From 61fad00cba1f444fe2551008ca51ebd9b9c27386 Mon Sep 17 00:00:00 2001 From: idriskalp Date: Mon, 13 Apr 2020 19:22:54 +0300 Subject: [PATCH] kernel 5.6.4 --- .../kernel/files/configs/kernel-x86_64-config | 5294 +- .../kernel/files/patches/linux/patch-5.6.4.xz | Bin 0 -> 34744 bytes .../mageia/3rd-3rdparty-1.0-tree.patch | 181 - .../patches/mageia/3rd-3rdparty-merge.patch | 191 - .../patches/mageia/3rd-acerhk-0.5.35.patch | 4212 - .../mageia/3rd-acerhk-2.6.36-buildfix.patch | 20 - .../mageia/3rd-acerhk-extra-cflags.patch | 33 - ...cerhk-fix-build-with-function-tracer.patch | 22 - .../mageia/3rd-acerhk-fix-include.patch | 23 - .../patches/mageia/3rd-acerhk-kbuild.patch | 37 - .../3rd-acerhk-proc_dir_entry-owner.patch | 67 - .../patches/mageia/3rd-aes2501-kbuild.patch | 47 - .../patches/mageia/3rd-aes2501-r19.patch | 2356 - .../mageia/3rd-aes2501-rmmod-oops-fix.patch | 21 - .../patches/mageia/3rd-ndiswrapper-1.61.patch | 26418 - .../3rd-ndiswrapper-4.10-buildfix.patch | 43 - .../3rd-ndiswrapper-4.13-buildfix.patch | 16 - .../mageia/3rd-ndiswrapper-Kconfig.patch | 7 - .../3rd-ndiswrapper-Makefile-build-fix.patch | 45 - .../patches/mageia/3rd-rfswitch-1.3.patch | 978 - .../mageia/3rd-rfswitch-3.0-buildfix.patch | 19 - .../mageia/3rd-rfswitch-build-fix.patch | 51 - .../files/patches/mageia/3rd-rtl8723de.patch | 411237 --------------- .../files/patches/mageia/3rd-rtl8812au.patch | 183101 ------- .../patches/mageia/3rd-viahss-0.92.patch | 189 - .../mageia/3rd-viahss-2.6.35-buildfix.patch | 20 - .../mageia/3rd-viahss-3.0-buildfix.patch | 19 - .../patches/mageia/3rd-viahss-config.patch | 18 - .../mageia/3rd-viahss-module-license.patch | 7 - .../files/patches/mageia/3rdparty.series | 3 - ...-quirk-to-force-acpi-video-backlight.patch | 40 - ...-quirk-for-Highpoint-RocketRAID-644L.patch | 34 - ...cc-Enable-autoload-of-pcc-cpufreq-fo.patch | 32 - .../acpi-CLEVO-M360S-disable_acpi_irq.patch | 28 - ...g-during-noirq-suspend_resume-phases.patch | 49 - .../acpi-processor-M720SR-limit-to-C2.patch | 21 - ...map3_save_secure_ram-on-non-OMAP3-bu.patch | 46 - ...r-the-Highpoint-Rocketraid-644L-card.patch | 37 - ...over-ide-drivers-when-both-are-built.patch | 34 - ...ssing-invocations-of-bfqg_stats_upda.patch | 107 - ...ssing-rq_pos_tree-update-on-rq-remov.patch | 41 - .../block-bfq-add-requeue-request-hook.patch | 224 - ...and-switch-back-to-interactive-wr-al.patch | 163 - ...low_latency-flag-in-bfq_bfqq_save_st.patch | 48 - ...er-also-past-I-O-in-soft-real-time-d.patch | 206 - ...se-burst-size-when-queues-in-burst-e.patch | 82 - ...currences-of-request-finish-method-s.patch | 91 - ...-unbalanced-decrements-of-burst-size.patch | 141 - ...ong-init-of-saved-start-time-for-wei.patch | 146 - ...ease-threshold-to-deem-I-O-as-random.patch | 68 - ...t-call-bfqg_and_blkg_put-for-CONFIG_.patch | 34 - ...queue-be-merged-only-shortly-after-s.patch | 186 - ...rly-merged-queues-be-weight-raised-o.patch | 89 - ...sectors-served-with-interactive-weig.patch | 202 - ...-limit-tags-for-writes-and-async-I-O.patch | 162 - ...ebug-blkio-stats-behind-CONFIG_DEBUG.patch | 467 - ...async-queues-for-root-bfq-groups-too.patch | 67 - ...e-oom-queue-ref-to-root-group-on-exi.patch | 39 - ...q-remove-batches-of-confusing-ifdefs.patch | 225 - ...-superfluous-check-in-queue-merging-.patch | 112 - ...-blkio-stats-outside-the-scheduler-l.patch | 283 - .../block-floppy-disable-pnp-modalias.patch | 21 - .../mageia/char-agp-intel-new-Q57-id.patch | 35 - .../disable-mrproper-in-devel-rpms.patch | 74 - .../patches/mageia/dm-raid-aliases.patch | 21 - ...update-max-IOPS-sustainable-with-BFQ.patch | 61 - .../firewire-ieee1394-module-aliases.patch | 29 - .../fs-MAINTAINERS-add-exfat-filesystem.patch | 39 + .../patches/mageia/fs-aufs-4.14-modular.patch | 431 - .../files/patches/mageia/fs-aufs-4.14.patch | 37170 -- .../patches/mageia/fs-aufs-5.4-version.patch | 12 - .../patches/mageia/fs-aufs-5.6-fix.patch | 39 + ...odular.patch => fs-aufs-5.6-modular.patch} | 147 +- .../{fs-aufs-5.4.patch => fs-aufs-5.6.patch} | 1120 +- .../mageia/fs-aufs-include-vmalloc.patch | 27 - .../fs-exfat-add-Kconfig-and-Makefile.patch | 96 + .../fs-exfat-add-bitmap-operations.patch | 309 + .../fs-exfat-add-directory-operations.patch | 1267 + .../mageia/fs-exfat-add-exfat-cache.patch | 354 + .../fs-exfat-add-fat-entry-operations.patch | 492 + .../mageia/fs-exfat-add-file-operations.patch | 390 + ...ory-and-on-disk-structures-and-heade.patch | 740 + .../fs-exfat-add-inode-operations.patch | 2156 + .../mageia/fs-exfat-add-misc-operations.patch | 193 + .../mageia/fs-exfat-add-module_alias_fs.patch | 30 + .../mageia/fs-exfat-add-nls-operations.patch | 860 + .../fs-exfat-add-super-block-operations.patch | 758 + .../mageia/fs-exfat-remove-from-staging.patch | 9152 + ...pdate-file-system-parameter-handling.patch | 84 + .../files/patches/mageia/fs-vboxsf.patch | 3410 - .../mageia/gpu-drm-mach64-2.6.31.patch | 100 - .../gpu-drm-mach64-2.6.36-buildfix.patch | 27 - .../gpu-drm-mach64-2.6.37-buildfix.patch | 24 - .../mageia/gpu-drm-mach64-3.0-buildfix.patch | 44 - .../mageia/gpu-drm-mach64-3.12-buildfix.patch | 17 - .../mageia/gpu-drm-mach64-3.17-buildfix.patch | 31 - .../mageia/gpu-drm-mach64-3.18-buildfix.patch | 142 - .../mageia/gpu-drm-mach64-3.3-buildfix.patch | 47 - .../mageia/gpu-drm-mach64-3.6-buildfix.patch | 15 - .../mageia/gpu-drm-mach64-3.7-buildfix.patch | 61 - ...drm-mach64-fix-for-changed-drm_ioctl.patch | 20 - ...mach64-fix-for-changed-drm_pci_alloc.patch | 12 - .../patches/mageia/gpu-drm-mach64-fixes.patch | 97 - .../gpu-drm-mach64-include-module.h.patch | 10 - .../gpu-drm-mach64-linux-3.14-buildfix.patch | 102 - ...pu-drm-mach64-restore-mach64_PCI_IDS.patch | 38 - .../files/patches/mageia/gpu-drm-mach64.patch | 4144 - ...hid-usbhid-IBM-BladeCenterHS20-quirk.patch | 37 - ...n-k10temp-Add-support-for-family-17h.patch | 70 - ...-Add-support-for-temperature-offsets.patch | 80 - ...ip-specific-code-into-probe-function.patch | 132 - .../patches/mageia/ide-pci-sis5513-965.patch | 23 - ...nput-goodix-add-support-for-GDIX1002.patch | 18 - ...-goodix-disable-IRQs-while-suspended.patch | 60 - ...ks-for-Fujitsu-Lifebook-A544-and-Lif.patch | 47 - ...edia-usb-pwc-lie-in-proc-usb-devices.patch | 13 - ...ge_vma_mapped-Introduce-pfn_in_hpage.patch | 58 - .../files/patches/mageia/mpt-vmware-fix.patch | 49 - .../files/patches/mageia/net-WireGuard.patch | 32579 -- ...v4-netfilter-ipt_IFWLOG-3.6-buildfix.patch | 33 - ...net-netfilter-IFWLOG-2.6.35-buildfix.patch | 32 - ...net-netfilter-IFWLOG-2.6.37-buildfix.patch | 15 - .../net-netfilter-IFWLOG-3.7-buildfix.patch | 20 - .../mageia/net-netfilter-IFWLOG-mdv.patch | 254 - ...netfilter-IFWLOG-remove-unused-label.patch | 10 - .../patches/mageia/net-netfilter-IFWLOG.patch | 273 - ...er-add-back-stackpointer-size-checks.patch | 84 - ...t-netfilter-ipt_IFWLOG-4.12-buildfix.patch | 16 - .../net-netfilter-psd-2.6.35-buildfix.patch | 11 - .../net-netfilter-psd-fix-redefines.patch | 86 - .../mageia/net-netfilter-psd-mdv.patch | 224 - .../patches/mageia/net-netfilter-psd.patch | 424 - ...t_addrtype-silence-BROADCAST-message.patch | 16 - .../mageia/net-sis190-fix-list-usage.patch | 30 - ...th-of-scatterlist-in-tls_sw_sendpage.patch | 37 - ...eless-realtek-rtl8xxxu-linux-4.11-rc.patch | 371 - .../patches/mageia/patch-4.14.25-rc1.patch | 4181 - ...I-M5229-ide-compatibility-mode-quirk.patch | 60 - .../mageia/pci-quirks-drop-devinit-exit.patch | 11 - .../platform-x86-add-shuttle-wmi-driver.patch | 1437 - ...eaPad-320-15IKB-to-no_hw_rfkill_list.patch | 24 - ...crease-timeout-to-wait-for-ec-answer.patch | 27 - ...atform-x86-shuttle-wmi-4.13-buildfix.patch | 30 - ...latform-x86-shuttle-wmi-4.2-buildfix.patch | 19 - ...rm-x86-shuttle-wmi-drop-devinit-exit.patch | 38 - ...Move-TSS_sp0-and-TSS_sp1-to-asm-offs.patch | 44 - ...ame-TSS_sysenter_sp0-to-TSS_entry_st.patch | 48 - ...d-task-stack-from-x86_tss.sp1-in-SYS.patch | 49 - ...ntry-32-Put-ESPFIX-code-into-a-macro.patch | 137 - ...x86-entry-32-Unshare-NMI-return-path.patch | 43 - ...y-32-Split-off-return-to-kernel-path.patch | 55 - ...estore-segments-before-int-registers.patch | 111 - ...nter-the-kernel-via-trampoline-stack.patch | 356 - ...eave-the-kernel-via-trampoline-stack.patch | 137 - ...roduce-SAVE_ALL_NMI-and-RESTORE_ALL_.patch | 84 - ...dle-Entry-from-Kernel-Mode-on-Entry-.patch | 198 - ...-entry-32-Simplify-debug-entry-point.patch | 69 - ...-PTI-cr3-switches-to-NMI-handler-cod.patch | 127 - ...-PTI-cr3-switch-to-non-NMI-entry-exi.patch | 187 - ...me-pti_set_user_pgd-to-pti_set_user_.patch | 81 - ...Unshare-kernel-PMDs-when-PTI-is-enab.patch | 35 - ...llocate-8k-page-tables-when-PTI-is-e.patch | 98 - ...-pgdp-kernel-user-conversion-functio.patch | 137 - ...Move-pti_set_user_pgtbl-to-pgtable.h.patch | 84 - ...-two-more-functions-from-pgtable_64..patch | 120 - ...-pae-Populate-valid-user-PGD-entries.patch | 73 - ...ate-the-user-page-table-with-user-pg.patch | 42 - ...pulate-the-user-page-table-with-user.patch | 50 - ...-an-overflow-check-to-pti_clone_pmds.patch | 33 - ...e-X86_CR3_PTI_PCID_USER_BIT-on-x86_3.patch | 41 - ...-CPU_ENTRY_AREA-on-PMD-level-on-x86_.patch | 56 - ...6-mm-dump_pagetables-Define-INIT_PGD.patch | 61 - ...Use-separate-kernel-PMDs-for-user-pa.patch | 213 - ...address-space-range-on-32-bit-for-th.patch | 75 - ...bit-0030-x86-ldt-Define-LDT_END_ADDR.patch | 64 - ...t-out-sanity-check-in-map_ldt_struct.patch | 146 - ...-ldt-Enable-LDT-user-mapping-for-PAE.patch | 107 - ...NFIG_PAGE_TABLE_ISOLATION-for-x86_32.patch | 25 - ...arning-when-booting-on-a-PCID-capabl.patch | 45 - ...0100-tone-down-PCID-on-32bit-message.patch | 32 - ...duce-NUMA-identity-node-sched-domain.patch | 123 - ...ng-can-trigger-a-kernel-hang-or-oops.patch | 126 - ...ID_OK-in-__scsi_error_from_host_byte.patch | 34 - .../mageia/scsi-megaraid-new-sysfs-name.patch | 15 - .../patches/mageia/scsi-ppscsi-2.6.2.patch | 5083 - .../mageia/scsi-ppscsi-3.0-buildfix.patch | 19 - .../mageia/scsi-ppscsi-mdvbz45393.patch | 31 - .../mageia/scsi-ppscsi-sg-helper-update.patch | 36 - ...i-ppscsi-update-for-scsi_data_buffer.patch | 88 - .../patches/mageia/scsi-ppscsi_fixes.patch | 226 - ...r-crash-due-to-active-timer-for-ABTS.patch | 119 - kernel/kernel/files/patches/mageia/series | 494 - ...ng-FIXUP-for-alc289-on-Dell-machines.patch | 35 - ...ke-Fix-jack-name-format-substitution.patch | 35 - .../sound-ASoC-Intel-kbl-fix-jack-name.patch | 32 - ...st-Makefile-remove-powerpc-reference.patch | 10 - ...-unusual_devs-add-id-2.6.37-buildfix.patch | 46 - .../usb-storage-unusual_devs-add-id.patch | 55 - .../patches/mageia/video-mageia-logo.patch | 949 - .../x86-boot-video-80x25-if-break.patch | 24 - .../x86-default_poweroff_up_machines.patch | 58 - ...inimum-vmalloc-area-by-64MB-to-192MB.patch | 28 - ...pci-toshiba-equium-a60-assign-busses.patch | 29 - ...c-Kill-array_index_nospec_mask_check.patch | 82 - ...pec-Include-asm-barrier.h-dependency.patch | 48 - ...opagate-return-value-from-updating-f.patch | 235 - ...-CPU-Add-a-microcode-loader-callback.patch | 90 - ...U-feature-bits-after-microcode-upgra.patch | 64 - ...-the-code-footprint-of-the-idtentry-.patch | 140 - ...se-xorl-for-faster-register-clearing.patch | 202 - kernel/kernel/pspec.xml | 38 +- 211 files changed, 21441 insertions(+), 733972 deletions(-) create mode 100644 kernel/kernel/files/patches/linux/patch-5.6.4.xz delete mode 100644 kernel/kernel/files/patches/mageia/3rd-3rdparty-1.0-tree.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-3rdparty-merge.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-acerhk-0.5.35.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-acerhk-2.6.36-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-acerhk-extra-cflags.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-acerhk-fix-build-with-function-tracer.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-acerhk-fix-include.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-acerhk-kbuild.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-acerhk-proc_dir_entry-owner.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-aes2501-kbuild.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-aes2501-r19.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-aes2501-rmmod-oops-fix.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-ndiswrapper-1.61.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-ndiswrapper-4.10-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-ndiswrapper-4.13-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-ndiswrapper-Kconfig.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-ndiswrapper-Makefile-build-fix.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-rfswitch-1.3.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-rfswitch-3.0-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-rfswitch-build-fix.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-rtl8723de.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-rtl8812au.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-viahss-0.92.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-viahss-2.6.35-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-viahss-3.0-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-viahss-config.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rd-viahss-module-license.patch delete mode 100644 kernel/kernel/files/patches/mageia/3rdparty.series delete mode 100644 kernel/kernel/files/patches/mageia/ACPI-video-Add-a-quirk-to-force-acpi-video-backlight.patch delete mode 100644 kernel/kernel/files/patches/mageia/PCI-Add-function-1-DMA-alias-quirk-for-Highpoint-RocketRAID-644L.patch delete mode 100644 kernel/kernel/files/patches/mageia/Revert-cpufreq-pcc-Enable-autoload-of-pcc-cpufreq-fo.patch delete mode 100644 kernel/kernel/files/patches/mageia/acpi-CLEVO-M360S-disable_acpi_irq.patch delete mode 100644 kernel/kernel/files/patches/mageia/acpi-ec-restore-polling-during-noirq-suspend_resume-phases.patch delete mode 100644 kernel/kernel/files/patches/mageia/acpi-processor-M720SR-limit-to-C2.patch delete mode 100644 kernel/kernel/files/patches/mageia/arch-ARM-omap2-hide-omap3_save_secure_ram-on-non-OMAP3-bu.patch delete mode 100644 kernel/kernel/files/patches/mageia/ata-ahci-Add-PCI-id-for-the-Highpoint-Rocketraid-644L-card.patch delete mode 100644 kernel/kernel/files/patches/mageia/ata-prefer-ata-drivers-over-ide-drivers-when-both-are-built.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-add-missing-invocations-of-bfqg_stats_upda.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-add-missing-rq_pos_tree-update-on-rq-remov.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-add-requeue-request-hook.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-check-and-switch-back-to-interactive-wr-al.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-check-low_latency-flag-in-bfq_bfqq_save_st.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-consider-also-past-I-O-in-soft-real-time-d.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-decrease-burst-size-when-queues-in-burst-e.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-fix-occurrences-of-request-finish-method-s.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-fix-unbalanced-decrements-of-burst-size.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-fix-wrong-init-of-saved-start-time-for-wei.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-increase-threshold-to-deem-I-O-as-random.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-iosched-don-t-call-bfqg_and_blkg_put-for-CONFIG_.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-let-a-queue-be-merged-only-shortly-after-s.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-let-early-merged-queues-be-weight-raised-o.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-limit-sectors-served-with-interactive-weig.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-limit-tags-for-writes-and-async-I-O.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-move-debug-blkio-stats-behind-CONFIG_DEBUG.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-put-async-queues-for-root-bfq-groups-too.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-release-oom-queue-ref-to-root-group-on-exi.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-remove-batches-of-confusing-ifdefs.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-remove-superfluous-check-in-queue-merging-.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-bfq-update-blkio-stats-outside-the-scheduler-l.patch delete mode 100644 kernel/kernel/files/patches/mageia/block-floppy-disable-pnp-modalias.patch delete mode 100644 kernel/kernel/files/patches/mageia/char-agp-intel-new-Q57-id.patch delete mode 100644 kernel/kernel/files/patches/mageia/disable-mrproper-in-devel-rpms.patch delete mode 100644 kernel/kernel/files/patches/mageia/dm-raid-aliases.patch delete mode 100644 kernel/kernel/files/patches/mageia/doc-block-bfq-update-max-IOPS-sustainable-with-BFQ.patch delete mode 100644 kernel/kernel/files/patches/mageia/firewire-ieee1394-module-aliases.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-MAINTAINERS-add-exfat-filesystem.patch delete mode 100644 kernel/kernel/files/patches/mageia/fs-aufs-4.14-modular.patch delete mode 100644 kernel/kernel/files/patches/mageia/fs-aufs-4.14.patch delete mode 100755 kernel/kernel/files/patches/mageia/fs-aufs-5.4-version.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-aufs-5.6-fix.patch rename kernel/kernel/files/patches/mageia/{fs-aufs-5.4-modular.patch => fs-aufs-5.6-modular.patch} (55%) rename kernel/kernel/files/patches/mageia/{fs-aufs-5.4.patch => fs-aufs-5.6.patch} (96%) delete mode 100644 kernel/kernel/files/patches/mageia/fs-aufs-include-vmalloc.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-add-Kconfig-and-Makefile.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-add-bitmap-operations.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-add-directory-operations.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-add-exfat-cache.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-add-fat-entry-operations.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-add-file-operations.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-add-in-memory-and-on-disk-structures-and-heade.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-add-inode-operations.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-add-misc-operations.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-add-module_alias_fs.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-add-nls-operations.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-add-super-block-operations.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-remove-from-staging.patch create mode 100644 kernel/kernel/files/patches/mageia/fs-exfat-update-file-system-parameter-handling.patch delete mode 100644 kernel/kernel/files/patches/mageia/fs-vboxsf.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-2.6.31.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-2.6.36-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-2.6.37-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.0-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.12-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.17-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.18-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.3-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.6-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.7-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-fix-for-changed-drm_ioctl.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-fix-for-changed-drm_pci_alloc.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-fixes.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-include-module.h.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-linux-3.14-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64-restore-mach64_PCI_IDS.patch delete mode 100644 kernel/kernel/files/patches/mageia/gpu-drm-mach64.patch delete mode 100644 kernel/kernel/files/patches/mageia/hid-usbhid-IBM-BladeCenterHS20-quirk.patch delete mode 100644 kernel/kernel/files/patches/mageia/hwmon-k10temp-Add-support-for-family-17h.patch delete mode 100644 kernel/kernel/files/patches/mageia/hwmon-k10temp-Add-support-for-temperature-offsets.patch delete mode 100644 kernel/kernel/files/patches/mageia/hwmon-k10temp-Move-chip-specific-code-into-probe-function.patch delete mode 100644 kernel/kernel/files/patches/mageia/ide-pci-sis5513-965.patch delete mode 100644 kernel/kernel/files/patches/mageia/input-goodix-add-support-for-GDIX1002.patch delete mode 100644 kernel/kernel/files/patches/mageia/input-goodix-disable-IRQs-while-suspended.patch delete mode 100644 kernel/kernel/files/patches/mageia/input-i8042-quirks-for-Fujitsu-Lifebook-A544-and-Lif.patch delete mode 100644 kernel/kernel/files/patches/mageia/media-usb-pwc-lie-in-proc-usb-devices.patch delete mode 100644 kernel/kernel/files/patches/mageia/mm-page_vma_mapped-Introduce-pfn_in_hpage.patch delete mode 100644 kernel/kernel/files/patches/mageia/mpt-vmware-fix.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-WireGuard.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-ipv4-netfilter-ipt_IFWLOG-3.6-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-2.6.35-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-2.6.37-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-3.7-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-mdv.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-remove-unused-label.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-add-back-stackpointer-size-checks.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-ipt_IFWLOG-4.12-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-psd-2.6.35-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-psd-fix-redefines.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-psd-mdv.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-psd.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-netfilter-xt_addrtype-silence-BROADCAST-message.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-sis190-fix-list-usage.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-tls-Correct-length-of-scatterlist-in-tls_sw_sendpage.patch delete mode 100644 kernel/kernel/files/patches/mageia/net-wireless-realtek-rtl8xxxu-linux-4.11-rc.patch delete mode 100644 kernel/kernel/files/patches/mageia/patch-4.14.25-rc1.patch delete mode 100644 kernel/kernel/files/patches/mageia/pci-add-ALI-M5229-ide-compatibility-mode-quirk.patch delete mode 100644 kernel/kernel/files/patches/mageia/pci-quirks-drop-devinit-exit.patch delete mode 100644 kernel/kernel/files/patches/mageia/platform-x86-add-shuttle-wmi-driver.patch delete mode 100644 kernel/kernel/files/patches/mageia/platform-x86-ideapad-Add-IdeaPad-320-15IKB-to-no_hw_rfkill_list.patch delete mode 100644 kernel/kernel/files/patches/mageia/platform-x86-ideapad-laptop-Increase-timeout-to-wait-for-ec-answer.patch delete mode 100644 kernel/kernel/files/patches/mageia/platform-x86-shuttle-wmi-4.13-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/platform-x86-shuttle-wmi-4.2-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/platform-x86-shuttle-wmi-drop-devinit-exit.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0001-x86-asm-offsets-Move-TSS_sp0-and-TSS_sp1-to-asm-offs.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0002-x86-entry-32-Rename-TSS_sysenter_sp0-to-TSS_entry_st.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0003-x86-entry-32-Load-task-stack-from-x86_tss.sp1-in-SYS.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0004-x86-entry-32-Put-ESPFIX-code-into-a-macro.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0005-x86-entry-32-Unshare-NMI-return-path.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0006-x86-entry-32-Split-off-return-to-kernel-path.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0007-x86-entry-32-Restore-segments-before-int-registers.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0008-x86-entry-32-Enter-the-kernel-via-trampoline-stack.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0009-x86-entry-32-Leave-the-kernel-via-trampoline-stack.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0010-x86-entry-32-Introduce-SAVE_ALL_NMI-and-RESTORE_ALL_.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0011-x86-entry-32-Handle-Entry-from-Kernel-Mode-on-Entry-.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0012-x86-entry-32-Simplify-debug-entry-point.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0013-x86-entry-32-Add-PTI-cr3-switches-to-NMI-handler-cod.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0014-x86-entry-32-Add-PTI-cr3-switch-to-non-NMI-entry-exi.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0015-x86-pgtable-Rename-pti_set_user_pgd-to-pti_set_user_.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0016-x86-pgtable-pae-Unshare-kernel-PMDs-when-PTI-is-enab.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0017-x86-pgtable-32-Allocate-8k-page-tables-when-PTI-is-e.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0018-x86-pgtable-Move-pgdp-kernel-user-conversion-functio.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0019-x86-pgtable-Move-pti_set_user_pgtbl-to-pgtable.h.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0020-x86-pgtable-Move-two-more-functions-from-pgtable_64..patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0021-x86-mm-pae-Populate-valid-user-PGD-entries.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0022-x86-mm-pae-Populate-the-user-page-table-with-user-pg.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0023-x86-mm-legacy-Populate-the-user-page-table-with-user.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0024-x86-mm-pti-Add-an-overflow-check-to-pti_clone_pmds.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0025-x86-mm-pti-Define-X86_CR3_PTI_PCID_USER_BIT-on-x86_3.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0026-x86-mm-pti-Clone-CPU_ENTRY_AREA-on-PMD-level-on-x86_.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0027-x86-mm-dump_pagetables-Define-INIT_PGD.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0028-x86-pgtable-pae-Use-separate-kernel-PMDs-for-user-pa.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0029-x86-ldt-Reserve-address-space-range-on-32-bit-for-th.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0030-x86-ldt-Define-LDT_END_ADDR.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0031-x86-ldt-Split-out-sanity-check-in-map_ldt_struct.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0032-x86-ldt-Enable-LDT-user-mapping-for-PAE.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0033-x86-pti-Allow-CONFIG_PAGE_TABLE_ISOLATION-for-x86_32.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0034-x86-mm-pti-Add-Warning-when-booting-on-a-PCID-capabl.patch delete mode 100644 kernel/kernel/files/patches/mageia/pti32bit-0100-tone-down-PCID-on-32bit-message.patch delete mode 100644 kernel/kernel/files/patches/mageia/sched-topology-Introduce-NUMA-identity-node-sched-domain.patch delete mode 100644 kernel/kernel/files/patches/mageia/scsi-core-Avoid-that-ATA-error-handling-can-trigger-a-kernel-hang-or-oops.patch delete mode 100644 kernel/kernel/files/patches/mageia/scsi-core-return-BLK_STS_OK-for-DID_OK-in-__scsi_error_from_host_byte.patch delete mode 100644 kernel/kernel/files/patches/mageia/scsi-megaraid-new-sysfs-name.patch delete mode 100644 kernel/kernel/files/patches/mageia/scsi-ppscsi-2.6.2.patch delete mode 100644 kernel/kernel/files/patches/mageia/scsi-ppscsi-3.0-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/scsi-ppscsi-mdvbz45393.patch delete mode 100644 kernel/kernel/files/patches/mageia/scsi-ppscsi-sg-helper-update.patch delete mode 100644 kernel/kernel/files/patches/mageia/scsi-ppscsi-update-for-scsi_data_buffer.patch delete mode 100644 kernel/kernel/files/patches/mageia/scsi-ppscsi_fixes.patch delete mode 100644 kernel/kernel/files/patches/mageia/scsi-qla2xxx-Fix-NULL-pointer-crash-due-to-active-timer-for-ABTS.patch delete mode 100644 kernel/kernel/files/patches/mageia/series delete mode 100644 kernel/kernel/files/patches/mageia/sound-ALSA-hda-Fix-a-wrong-FIXUP-for-alc289-on-Dell-machines.patch delete mode 100644 kernel/kernel/files/patches/mageia/sound-ASoC-Intel-Skylake-Fix-jack-name-format-substitution.patch delete mode 100644 kernel/kernel/files/patches/mageia/sound-ASoC-Intel-kbl-fix-jack-name.patch delete mode 100644 kernel/kernel/files/patches/mageia/tools-testing-selftest-Makefile-remove-powerpc-reference.patch delete mode 100644 kernel/kernel/files/patches/mageia/usb-storage-unusual_devs-add-id-2.6.37-buildfix.patch delete mode 100644 kernel/kernel/files/patches/mageia/usb-storage-unusual_devs-add-id.patch delete mode 100644 kernel/kernel/files/patches/mageia/video-mageia-logo.patch delete mode 100644 kernel/kernel/files/patches/mageia/x86-boot-video-80x25-if-break.patch delete mode 100644 kernel/kernel/files/patches/mageia/x86-default_poweroff_up_machines.patch delete mode 100644 kernel/kernel/files/patches/mageia/x86-increase-default-minimum-vmalloc-area-by-64MB-to-192MB.patch delete mode 100644 kernel/kernel/files/patches/mageia/x86-pci-toshiba-equium-a60-assign-busses.patch delete mode 100644 kernel/kernel/files/patches/mageia/x86-pti-0070-nospec-Kill-array_index_nospec_mask_check.patch delete mode 100644 kernel/kernel/files/patches/mageia/x86-pti-0072-nospec-Include-asm-barrier.h-dependency.patch delete mode 100644 kernel/kernel/files/patches/mageia/x86-pti-0073-x86-microcode-Propagate-return-value-from-updating-f.patch delete mode 100644 kernel/kernel/files/patches/mageia/x86-pti-0074-x86-CPU-Add-a-microcode-loader-callback.patch delete mode 100644 kernel/kernel/files/patches/mageia/x86-pti-0075-x86-CPU-Check-CPU-feature-bits-after-microcode-upgra.patch delete mode 100644 kernel/kernel/files/patches/mageia/x86-pti-0076-x86-entry-Reduce-the-code-footprint-of-the-idtentry-.patch delete mode 100644 kernel/kernel/files/patches/mageia/x86-pti-0077-x86-entry-64-Use-xorl-for-faster-register-clearing.patch diff --git a/kernel/kernel/files/configs/kernel-x86_64-config b/kernel/kernel/files/configs/kernel-x86_64-config index 9562431d..ba93bee0 100755 --- a/kernel/kernel/files/configs/kernel-x86_64-config +++ b/kernel/kernel/files/configs/kernel-x86_64-config @@ -1,6 +1,6 @@ # # Automatically generated file; DO NOT EDIT. -# Linux/x86_64 5.5.15 Kernel Configuration +# Linux/x86_64 5.6.4 Kernel Configuration # # @@ -14,7 +14,7 @@ CONFIG_CC_HAS_ASM_GOTO=y CONFIG_CC_HAS_ASM_INLINE=y CONFIG_CC_HAS_WARN_MAYBE_UNINITIALIZED=y CONFIG_IRQ_WORK=y -CONFIG_BUILDTIME_EXTABLE_SORT=y +CONFIG_BUILDTIME_TABLE_SORT=y CONFIG_THREAD_INFO_IN_TASK=y # @@ -31,13 +31,13 @@ CONFIG_HAVE_KERNEL_LZMA=y CONFIG_HAVE_KERNEL_XZ=y CONFIG_HAVE_KERNEL_LZO=y CONFIG_HAVE_KERNEL_LZ4=y -CONFIG_KERNEL_GZIP=y +# CONFIG_KERNEL_GZIP is not set # CONFIG_KERNEL_BZIP2 is not set # CONFIG_KERNEL_LZMA is not set -# CONFIG_KERNEL_XZ is not set +CONFIG_KERNEL_XZ=y # CONFIG_KERNEL_LZO is not set # CONFIG_KERNEL_LZ4 is not set -CONFIG_DEFAULT_HOSTNAME="" +CONFIG_DEFAULT_HOSTNAME="(none)" CONFIG_SWAP=y CONFIG_SYSVIPC=y CONFIG_SYSVIPC_SYSCTL=y @@ -59,7 +59,6 @@ CONFIG_GENERIC_PENDING_IRQ=y CONFIG_GENERIC_IRQ_MIGRATION=y CONFIG_GENERIC_IRQ_CHIP=y CONFIG_IRQ_DOMAIN=y -CONFIG_IRQ_SIM=y CONFIG_IRQ_DOMAIN_HIERARCHY=y CONFIG_GENERIC_MSI_IRQ=y CONFIG_GENERIC_MSI_IRQ_DOMAIN=y @@ -87,8 +86,10 @@ CONFIG_GENERIC_CMOS_UPDATE=y CONFIG_TICK_ONESHOT=y CONFIG_NO_HZ_COMMON=y # CONFIG_HZ_PERIODIC is not set -CONFIG_NO_HZ_IDLE=y -# CONFIG_NO_HZ_FULL is not set +# CONFIG_NO_HZ_IDLE is not set +CONFIG_NO_HZ_FULL=y +CONFIG_CONTEXT_TRACKING=y +# CONFIG_CONTEXT_TRACKING_FORCE is not set CONFIG_NO_HZ=y CONFIG_HIGH_RES_TIMERS=y # end of Timers subsystem @@ -100,10 +101,9 @@ CONFIG_PREEMPT_VOLUNTARY=y # # CPU/Task time and stats accounting # -CONFIG_TICK_CPU_ACCOUNTING=y -# CONFIG_VIRT_CPU_ACCOUNTING_GEN is not set +CONFIG_VIRT_CPU_ACCOUNTING=y +CONFIG_VIRT_CPU_ACCOUNTING_GEN=y # CONFIG_IRQ_TIME_ACCOUNTING is not set -CONFIG_HAVE_SCHED_AVG_IRQ=y CONFIG_BSD_PROCESS_ACCT=y CONFIG_BSD_PROCESS_ACCT_V3=y CONFIG_TASKSTATS=y @@ -122,14 +122,17 @@ CONFIG_TREE_RCU=y # CONFIG_RCU_EXPERT is not set CONFIG_SRCU=y CONFIG_TREE_SRCU=y +CONFIG_TASKS_RCU=y CONFIG_RCU_STALL_COMMON=y CONFIG_RCU_NEED_SEGCBLIST=y +CONFIG_RCU_NOCB_CPU=y # end of RCU Subsystem +CONFIG_BUILD_BIN2C=y CONFIG_IKCONFIG=y CONFIG_IKCONFIG_PROC=y # CONFIG_IKHEADERS is not set -CONFIG_LOG_BUF_SHIFT=18 +CONFIG_LOG_BUF_SHIFT=17 CONFIG_LOG_CPU_MAX_BUF_SHIFT=12 CONFIG_PRINTK_SAFE_LOG_BUF_SHIFT=13 CONFIG_HAVE_UNSTABLE_SCHED_CLOCK=y @@ -137,6 +140,7 @@ CONFIG_HAVE_UNSTABLE_SCHED_CLOCK=y # # Scheduler features # +# CONFIG_UCLAMP_TASK is not set # end of Scheduler features CONFIG_ARCH_SUPPORTS_NUMA_BALANCING=y @@ -148,32 +152,34 @@ CONFIG_CGROUPS=y CONFIG_PAGE_COUNTER=y CONFIG_MEMCG=y CONFIG_MEMCG_SWAP=y -CONFIG_MEMCG_SWAP_ENABLED=y +# CONFIG_MEMCG_SWAP_ENABLED is not set CONFIG_MEMCG_KMEM=y CONFIG_BLK_CGROUP=y CONFIG_CGROUP_WRITEBACK=y CONFIG_CGROUP_SCHED=y CONFIG_FAIR_GROUP_SCHED=y CONFIG_CFS_BANDWIDTH=y -CONFIG_RT_GROUP_SCHED=y -CONFIG_CGROUP_PIDS=y +# CONFIG_RT_GROUP_SCHED is not set +# CONFIG_CGROUP_PIDS is not set # CONFIG_CGROUP_RDMA is not set CONFIG_CGROUP_FREEZER=y -CONFIG_CGROUP_HUGETLB=y +# CONFIG_CGROUP_HUGETLB is not set CONFIG_CPUSETS=y CONFIG_PROC_PID_CPUSET=y CONFIG_CGROUP_DEVICE=y CONFIG_CGROUP_CPUACCT=y -CONFIG_CGROUP_PERF=y -# CONFIG_CGROUP_BPF is not set +# CONFIG_CGROUP_PERF is not set +CONFIG_CGROUP_BPF=y +# CONFIG_CGROUP_DEBUG is not set CONFIG_SOCK_CGROUP_DATA=y CONFIG_NAMESPACES=y CONFIG_UTS_NS=y +CONFIG_TIME_NS=y CONFIG_IPC_NS=y CONFIG_USER_NS=y CONFIG_PID_NS=y CONFIG_NET_NS=y -# CONFIG_CHECKPOINT_RESTORE is not set +CONFIG_CHECKPOINT_RESTORE=y CONFIG_SCHED_AUTOGROUP=y # CONFIG_SYSFS_DEPRECATED is not set CONFIG_RELAY=y @@ -185,6 +191,7 @@ CONFIG_RD_LZMA=y CONFIG_RD_XZ=y CONFIG_RD_LZO=y CONFIG_RD_LZ4=y +# CONFIG_BOOT_CONFIG is not set CONFIG_CC_OPTIMIZE_FOR_PERFORMANCE=y # CONFIG_CC_OPTIMIZE_FOR_SIZE is not set CONFIG_SYSCTL=y @@ -192,11 +199,11 @@ CONFIG_HAVE_UID16=y CONFIG_SYSCTL_EXCEPTION_TRACE=y CONFIG_HAVE_PCSPKR_PLATFORM=y CONFIG_BPF=y -# CONFIG_EXPERT is not set +CONFIG_EXPERT=y CONFIG_UID16=y CONFIG_MULTIUSER=y CONFIG_SGETMASK_SYSCALL=y -CONFIG_SYSFS_SYSCALL=y +# CONFIG_SYSFS_SYSCALL is not set CONFIG_FHANDLE=y CONFIG_POSIX_TIMERS=y CONFIG_PRINTK=y @@ -217,29 +224,40 @@ CONFIG_IO_URING=y CONFIG_ADVISE_SYSCALLS=y CONFIG_MEMBARRIER=y CONFIG_KALLSYMS=y +CONFIG_KALLSYMS_ALL=y CONFIG_KALLSYMS_ABSOLUTE_PERCPU=y CONFIG_KALLSYMS_BASE_RELATIVE=y CONFIG_BPF_SYSCALL=y -# CONFIG_BPF_JIT_ALWAYS_ON is not set +CONFIG_ARCH_WANT_DEFAULT_BPF_JIT=y +CONFIG_BPF_JIT_ALWAYS_ON=y +CONFIG_BPF_JIT_DEFAULT_ON=y # CONFIG_USERFAULTFD is not set CONFIG_ARCH_HAS_MEMBARRIER_SYNC_CORE=y CONFIG_RSEQ=y -# CONFIG_EMBEDDED is not set +# CONFIG_DEBUG_RSEQ is not set +CONFIG_EMBEDDED=y CONFIG_HAVE_PERF_EVENTS=y +# CONFIG_PC104 is not set # # Kernel Performance Events And Counters # CONFIG_PERF_EVENTS=y +# CONFIG_DEBUG_PERF_USE_VMALLOC is not set # end of Kernel Performance Events And Counters CONFIG_VM_EVENT_COUNTERS=y +CONFIG_SLUB_DEBUG=y +# CONFIG_SLUB_MEMCG_SYSFS_ON is not set # CONFIG_COMPAT_BRK is not set -CONFIG_SLAB=y -# CONFIG_SLUB is not set -CONFIG_SLAB_MERGE_DEFAULT=y -# CONFIG_SLAB_FREELIST_RANDOM is not set -# CONFIG_SHUFFLE_PAGE_ALLOCATOR is not set +# CONFIG_SLAB is not set +CONFIG_SLUB=y +# CONFIG_SLOB is not set +# CONFIG_SLAB_MERGE_DEFAULT is not set +CONFIG_SLAB_FREELIST_RANDOM=y +# CONFIG_SLAB_FREELIST_HARDENED is not set +CONFIG_SHUFFLE_PAGE_ALLOCATOR=y +CONFIG_SLUB_CPU_PARTIAL=y CONFIG_SYSTEM_DATA_VERIFICATION=y CONFIG_PROFILING=y CONFIG_TRACEPOINTS=y @@ -292,22 +310,23 @@ CONFIG_X86_X2APIC=y CONFIG_X86_MPPARSE=y # CONFIG_GOLDFISH is not set CONFIG_RETPOLINE=y -# CONFIG_X86_CPU_RESCTRL is not set +CONFIG_X86_CPU_RESCTRL=y CONFIG_X86_EXTENDED_PLATFORM=y # CONFIG_X86_NUMACHIP is not set # CONFIG_X86_VSMP is not set # CONFIG_X86_UV is not set # CONFIG_X86_GOLDFISH is not set # CONFIG_X86_INTEL_MID is not set -# CONFIG_X86_INTEL_LPSS is not set +CONFIG_X86_INTEL_LPSS=y CONFIG_X86_AMD_PLATFORM_DEVICE=y -CONFIG_IOSF_MBI=m +CONFIG_IOSF_MBI=y # CONFIG_IOSF_MBI_DEBUG is not set CONFIG_X86_SUPPORTS_MEMORY_FAILURE=y CONFIG_SCHED_OMIT_FRAME_POINTER=y CONFIG_HYPERVISOR_GUEST=y CONFIG_PARAVIRT=y CONFIG_PARAVIRT_XXL=y +# CONFIG_PARAVIRT_DEBUG is not set # CONFIG_PARAVIRT_SPINLOCKS is not set CONFIG_X86_HV_CALLBACK_VECTOR=y CONFIG_XEN=y @@ -324,10 +343,10 @@ CONFIG_KVM_GUEST=y CONFIG_ARCH_CPUIDLE_HALTPOLL=y CONFIG_PVH=y # CONFIG_KVM_DEBUG_FS is not set -CONFIG_PARAVIRT_TIME_ACCOUNTING=y +# CONFIG_PARAVIRT_TIME_ACCOUNTING is not set CONFIG_PARAVIRT_CLOCK=y # CONFIG_JAILHOUSE_GUEST is not set -# CONFIG_ACRN_GUEST is not set +CONFIG_ACRN_GUEST=y # CONFIG_MK8 is not set # CONFIG_MPSC is not set # CONFIG_MCORE2 is not set @@ -340,6 +359,9 @@ CONFIG_X86_CMPXCHG64=y CONFIG_X86_CMOV=y CONFIG_X86_MINIMUM_CPU_FAMILY=64 CONFIG_X86_DEBUGCTLMSR=y +CONFIG_IA32_FEAT_CTL=y +CONFIG_X86_VMX_FEATURE_NAMES=y +# CONFIG_PROCESSOR_SELECT is not set CONFIG_CPU_SUP_INTEL=y CONFIG_CPU_SUP_AMD=y CONFIG_CPU_SUP_HYGON=y @@ -349,10 +371,11 @@ CONFIG_HPET_TIMER=y CONFIG_HPET_EMULATE_RTC=y CONFIG_DMI=y CONFIG_GART_IOMMU=y +# CONFIG_MAXSMP is not set CONFIG_NR_CPUS_RANGE_BEGIN=2 CONFIG_NR_CPUS_RANGE_END=512 CONFIG_NR_CPUS_DEFAULT=64 -CONFIG_NR_CPUS=8 +CONFIG_NR_CPUS=128 CONFIG_SCHED_SMT=y CONFIG_SCHED_MC=y CONFIG_SCHED_MC_PRIO=y @@ -364,16 +387,16 @@ CONFIG_X86_MCE=y CONFIG_X86_MCE_INTEL=y CONFIG_X86_MCE_AMD=y CONFIG_X86_MCE_THRESHOLD=y -# CONFIG_X86_MCE_INJECT is not set +CONFIG_X86_MCE_INJECT=m CONFIG_X86_THERMAL_VECTOR=y # # Performance monitoring # -CONFIG_PERF_EVENTS_INTEL_UNCORE=y -CONFIG_PERF_EVENTS_INTEL_RAPL=y -CONFIG_PERF_EVENTS_INTEL_CSTATE=y -# CONFIG_PERF_EVENTS_AMD_POWER is not set +CONFIG_PERF_EVENTS_INTEL_UNCORE=m +CONFIG_PERF_EVENTS_INTEL_RAPL=m +CONFIG_PERF_EVENTS_INTEL_CSTATE=m +CONFIG_PERF_EVENTS_AMD_POWER=m # end of Performance monitoring CONFIG_X86_16BIT=y @@ -385,8 +408,8 @@ CONFIG_MICROCODE=y CONFIG_MICROCODE_INTEL=y CONFIG_MICROCODE_AMD=y CONFIG_MICROCODE_OLD_INTERFACE=y -CONFIG_X86_MSR=y -CONFIG_X86_CPUID=y +CONFIG_X86_MSR=m +CONFIG_X86_CPUID=m # CONFIG_X86_5LEVEL is not set CONFIG_X86_DIRECT_GBPAGES=y # CONFIG_X86_CPA_STATISTICS is not set @@ -396,7 +419,7 @@ CONFIG_AMD_NUMA=y CONFIG_X86_64_ACPI_NUMA=y CONFIG_NODES_SPAN_OTHER_NODES=y # CONFIG_NUMA_EMU is not set -CONFIG_NODES_SHIFT=10 +CONFIG_NODES_SHIFT=6 CONFIG_ARCH_SPARSEMEM_ENABLE=y CONFIG_ARCH_SPARSEMEM_DEFAULT=y CONFIG_ARCH_SELECT_MEMORY_MODEL=y @@ -405,25 +428,24 @@ CONFIG_ARCH_PROC_KCORE_TEXT=y CONFIG_ILLEGAL_POINTER_VALUE=0xdead000000000000 # CONFIG_X86_PMEM_LEGACY is not set CONFIG_X86_CHECK_BIOS_CORRUPTION=y -CONFIG_X86_BOOTPARAM_MEMORY_CORRUPTION_CHECK=y +# CONFIG_X86_BOOTPARAM_MEMORY_CORRUPTION_CHECK is not set CONFIG_X86_RESERVE_LOW=64 CONFIG_MTRR=y CONFIG_MTRR_SANITIZER=y -CONFIG_MTRR_SANITIZER_ENABLE_DEFAULT=1 +CONFIG_MTRR_SANITIZER_ENABLE_DEFAULT=0 CONFIG_MTRR_SANITIZER_SPARE_REG_NR_DEFAULT=1 CONFIG_X86_PAT=y CONFIG_ARCH_USES_PG_UNCACHED=y CONFIG_ARCH_RANDOM=y CONFIG_X86_SMAP=y CONFIG_X86_UMIP=y -# CONFIG_X86_INTEL_MPX is not set CONFIG_X86_INTEL_MEMORY_PROTECTION_KEYS=y -CONFIG_X86_INTEL_TSX_MODE_OFF=y +# CONFIG_X86_INTEL_TSX_MODE_OFF is not set # CONFIG_X86_INTEL_TSX_MODE_ON is not set -# CONFIG_X86_INTEL_TSX_MODE_AUTO is not set +CONFIG_X86_INTEL_TSX_MODE_AUTO=y CONFIG_EFI=y CONFIG_EFI_STUB=y -# CONFIG_EFI_MIXED is not set +CONFIG_EFI_MIXED=y CONFIG_SECCOMP=y # CONFIG_HZ_100 is not set # CONFIG_HZ_250 is not set @@ -453,6 +475,7 @@ CONFIG_LEGACY_VSYSCALL_EMULATE=y # CONFIG_CMDLINE_BOOL is not set CONFIG_MODIFY_LDT_SYSCALL=y CONFIG_HAVE_LIVEPATCH=y +CONFIG_LIVEPATCH=y # end of Processor type and features CONFIG_ARCH_HAS_ADD_PAGES=y @@ -469,6 +492,7 @@ CONFIG_ARCH_ENABLE_THP_MIGRATION=y CONFIG_ARCH_HIBERNATION_HEADER=y CONFIG_SUSPEND=y CONFIG_SUSPEND_FREEZER=y +# CONFIG_SUSPEND_SKIP_SYNC is not set CONFIG_HIBERNATE_CALLBACKS=y CONFIG_HIBERNATION=y CONFIG_PM_STD_PARTITION="" @@ -479,12 +503,15 @@ CONFIG_PM_SLEEP_SMP=y CONFIG_PM=y CONFIG_PM_DEBUG=y # CONFIG_PM_ADVANCED_DEBUG is not set -CONFIG_PM_TEST_SUSPEND=y +# CONFIG_PM_TEST_SUSPEND is not set CONFIG_PM_SLEEP_DEBUG=y +# CONFIG_DPM_WATCHDOG is not set CONFIG_PM_TRACE=y CONFIG_PM_TRACE_RTC=y CONFIG_PM_CLK=y +CONFIG_PM_GENERIC_DOMAINS=y # CONFIG_WQ_POWER_EFFICIENT_DEFAULT is not set +CONFIG_PM_GENERIC_DOMAINS_SLEEP=y # CONFIG_ENERGY_MODEL is not set CONFIG_ARCH_SUPPORTS_ACPI=y CONFIG_ACPI=y @@ -497,13 +524,13 @@ CONFIG_ACPI_LPIT=y CONFIG_ACPI_SLEEP=y # CONFIG_ACPI_PROCFS_POWER is not set CONFIG_ACPI_REV_OVERRIDE_POSSIBLE=y -CONFIG_ACPI_EC_DEBUGFS=m -CONFIG_ACPI_AC=y -CONFIG_ACPI_BATTERY=y -CONFIG_ACPI_BUTTON=y +# CONFIG_ACPI_EC_DEBUGFS is not set +CONFIG_ACPI_AC=m +CONFIG_ACPI_BATTERY=m +CONFIG_ACPI_BUTTON=m CONFIG_ACPI_VIDEO=m -CONFIG_ACPI_FAN=y -# CONFIG_ACPI_TAD is not set +CONFIG_ACPI_FAN=m +CONFIG_ACPI_TAD=m CONFIG_ACPI_DOCK=y CONFIG_ACPI_CPU_FREQ_PSS=y CONFIG_ACPI_PROCESSOR_CSTATE=y @@ -513,19 +540,22 @@ CONFIG_ACPI_PROCESSOR=y CONFIG_ACPI_IPMI=m CONFIG_ACPI_HOTPLUG_CPU=y CONFIG_ACPI_PROCESSOR_AGGREGATOR=m -CONFIG_ACPI_THERMAL=y +CONFIG_ACPI_THERMAL=m +CONFIG_ACPI_CUSTOM_DSDT_FILE="" CONFIG_ARCH_HAS_ACPI_TABLE_UPGRADE=y CONFIG_ACPI_TABLE_UPGRADE=y # CONFIG_ACPI_DEBUG is not set -CONFIG_ACPI_PCI_SLOT=y +# CONFIG_ACPI_PCI_SLOT is not set CONFIG_ACPI_CONTAINER=y -CONFIG_ACPI_HOTPLUG_MEMORY=y +# CONFIG_ACPI_HOTPLUG_MEMORY is not set CONFIG_ACPI_HOTPLUG_IOAPIC=y CONFIG_ACPI_SBS=m CONFIG_ACPI_HED=y -CONFIG_ACPI_CUSTOM_METHOD=m +# CONFIG_ACPI_CUSTOM_METHOD is not set CONFIG_ACPI_BGRT=y -# CONFIG_ACPI_NFIT is not set +# CONFIG_ACPI_REDUCED_HARDWARE_ONLY is not set +CONFIG_ACPI_NFIT=m +# CONFIG_NFIT_SECURITY_DEBUG is not set CONFIG_ACPI_NUMA=y # CONFIG_ACPI_HMAT is not set CONFIG_HAVE_ACPI_APEI=y @@ -534,16 +564,23 @@ CONFIG_ACPI_APEI=y CONFIG_ACPI_APEI_GHES=y CONFIG_ACPI_APEI_PCIEAER=y CONFIG_ACPI_APEI_MEMORY_FAILURE=y -# CONFIG_ACPI_APEI_EINJ is not set +CONFIG_ACPI_APEI_EINJ=m # CONFIG_ACPI_APEI_ERST_DEBUG is not set CONFIG_DPTF_POWER=m CONFIG_ACPI_WATCHDOG=y CONFIG_ACPI_EXTLOG=m CONFIG_ACPI_ADXL=y -# CONFIG_PMIC_OPREGION is not set +CONFIG_PMIC_OPREGION=y +CONFIG_BYTCRC_PMIC_OPREGION=y +CONFIG_CHTCRC_PMIC_OPREGION=y +# CONFIG_XPOWER_PMIC_OPREGION is not set +CONFIG_BXT_WC_PMIC_OPREGION=y +CONFIG_CHT_WC_PMIC_OPREGION=y +CONFIG_CHT_DC_TI_PMIC_OPREGION=y CONFIG_ACPI_CONFIGFS=m +# CONFIG_TPS68470_PMIC_OPREGION is not set CONFIG_X86_PM_TIMER=y -CONFIG_SFI=y +# CONFIG_SFI is not set # # CPU Frequency scaling @@ -551,36 +588,36 @@ CONFIG_SFI=y CONFIG_CPU_FREQ=y CONFIG_CPU_FREQ_GOV_ATTR_SET=y CONFIG_CPU_FREQ_GOV_COMMON=y -CONFIG_CPU_FREQ_STAT=y -CONFIG_CPU_FREQ_DEFAULT_GOV_PERFORMANCE=y +# CONFIG_CPU_FREQ_STAT is not set +# CONFIG_CPU_FREQ_DEFAULT_GOV_PERFORMANCE is not set # CONFIG_CPU_FREQ_DEFAULT_GOV_POWERSAVE is not set # CONFIG_CPU_FREQ_DEFAULT_GOV_USERSPACE is not set -# CONFIG_CPU_FREQ_DEFAULT_GOV_ONDEMAND is not set +CONFIG_CPU_FREQ_DEFAULT_GOV_ONDEMAND=y # CONFIG_CPU_FREQ_DEFAULT_GOV_CONSERVATIVE is not set # CONFIG_CPU_FREQ_DEFAULT_GOV_SCHEDUTIL is not set CONFIG_CPU_FREQ_GOV_PERFORMANCE=y -CONFIG_CPU_FREQ_GOV_POWERSAVE=m +CONFIG_CPU_FREQ_GOV_POWERSAVE=y CONFIG_CPU_FREQ_GOV_USERSPACE=y -CONFIG_CPU_FREQ_GOV_ONDEMAND=m -CONFIG_CPU_FREQ_GOV_CONSERVATIVE=m -# CONFIG_CPU_FREQ_GOV_SCHEDUTIL is not set +CONFIG_CPU_FREQ_GOV_ONDEMAND=y +CONFIG_CPU_FREQ_GOV_CONSERVATIVE=y +CONFIG_CPU_FREQ_GOV_SCHEDUTIL=y # # CPU frequency scaling drivers # CONFIG_X86_INTEL_PSTATE=y -CONFIG_X86_PCC_CPUFREQ=y -CONFIG_X86_ACPI_CPUFREQ=y +CONFIG_X86_PCC_CPUFREQ=m +CONFIG_X86_ACPI_CPUFREQ=m CONFIG_X86_ACPI_CPUFREQ_CPB=y -CONFIG_X86_POWERNOW_K8=y +CONFIG_X86_POWERNOW_K8=m CONFIG_X86_AMD_FREQ_SENSITIVITY=m -# CONFIG_X86_SPEEDSTEP_CENTRINO is not set -CONFIG_X86_P4_CLOCKMOD=y +CONFIG_X86_SPEEDSTEP_CENTRINO=m +CONFIG_X86_P4_CLOCKMOD=m # # shared options # -CONFIG_X86_SPEEDSTEP_LIB=y +CONFIG_X86_SPEEDSTEP_LIB=m # end of CPU Frequency scaling # @@ -589,9 +626,9 @@ CONFIG_X86_SPEEDSTEP_LIB=y CONFIG_CPU_IDLE=y CONFIG_CPU_IDLE_GOV_LADDER=y CONFIG_CPU_IDLE_GOV_MENU=y -# CONFIG_CPU_IDLE_GOV_TEO is not set -# CONFIG_CPU_IDLE_GOV_HALTPOLL is not set -CONFIG_HALTPOLL_CPUIDLE=y +CONFIG_CPU_IDLE_GOV_TEO=y +CONFIG_CPU_IDLE_GOV_HALTPOLL=y +CONFIG_HALTPOLL_CPUIDLE=m # end of CPU Idle CONFIG_INTEL_IDLE=y @@ -604,6 +641,8 @@ CONFIG_PCI_DIRECT=y CONFIG_PCI_MMCONFIG=y CONFIG_PCI_XEN=y CONFIG_MMCONF_FAM10H=y +# CONFIG_PCI_CNB20LE_QUIRK is not set +CONFIG_ISA_BUS=y CONFIG_ISA_DMA_API=y CONFIG_AMD_NB=y # CONFIG_X86_SYSFB is not set @@ -623,36 +662,35 @@ CONFIG_SYSVIPC_COMPAT=y # # Firmware Drivers # -CONFIG_EDD=m +CONFIG_EDD=y # CONFIG_EDD_OFF is not set CONFIG_FIRMWARE_MEMMAP=y CONFIG_DMIID=y -CONFIG_DMI_SYSFS=y +CONFIG_DMI_SYSFS=m CONFIG_DMI_SCAN_MACHINE_NON_EFI_FALLBACK=y CONFIG_ISCSI_IBFT_FIND=y CONFIG_ISCSI_IBFT=m -# CONFIG_FW_CFG_SYSFS is not set -CONFIG_GOOGLE_FIRMWARE=y -CONFIG_GOOGLE_SMI=m -# CONFIG_GOOGLE_COREBOOT_TABLE is not set -# CONFIG_GOOGLE_MEMCONSOLE_X86_LEGACY is not set +CONFIG_FW_CFG_SYSFS=m +# CONFIG_FW_CFG_SYSFS_CMDLINE is not set +# CONFIG_GOOGLE_FIRMWARE is not set # # EFI (Extensible Firmware Interface) Support # -CONFIG_EFI_VARS=m +CONFIG_EFI_VARS=y CONFIG_EFI_ESRT=y -CONFIG_EFI_VARS_PSTORE=m -# CONFIG_EFI_VARS_PSTORE_DEFAULT_DISABLE is not set +CONFIG_EFI_VARS_PSTORE=y +CONFIG_EFI_VARS_PSTORE_DEFAULT_DISABLE=y CONFIG_EFI_RUNTIME_MAP=y # CONFIG_EFI_FAKE_MEMMAP is not set CONFIG_EFI_RUNTIME_WRAPPERS=y CONFIG_EFI_BOOTLOADER_CONTROL=m CONFIG_EFI_CAPSULE_LOADER=m -CONFIG_EFI_TEST=m +# CONFIG_EFI_TEST is not set CONFIG_APPLE_PROPERTIES=y # CONFIG_RESET_ATTACK_MITIGATION is not set -# CONFIG_EFI_RCI2_TABLE is not set +CONFIG_EFI_RCI2_TABLE=y +# CONFIG_EFI_DISABLE_PCI_DMA is not set # end of EFI (Extensible Firmware Interface) Support CONFIG_UEFI_CPER=y @@ -682,10 +720,11 @@ CONFIG_HAVE_KVM_IRQ_BYPASS=y CONFIG_HAVE_KVM_NO_POLL=y CONFIG_VIRTUALIZATION=y CONFIG_KVM=m +CONFIG_KVM_WERROR=y CONFIG_KVM_INTEL=m CONFIG_KVM_AMD=m CONFIG_KVM_AMD_SEV=y -CONFIG_KVM_MMU_AUDIT=y +# CONFIG_KVM_MMU_AUDIT is not set CONFIG_VHOST_NET=m CONFIG_VHOST_SCSI=m CONFIG_VHOST_VSOCK=m @@ -741,8 +780,10 @@ CONFIG_HAVE_PERF_REGS=y CONFIG_HAVE_PERF_USER_STACK_DUMP=y CONFIG_HAVE_ARCH_JUMP_LABEL=y CONFIG_HAVE_ARCH_JUMP_LABEL_RELATIVE=y -CONFIG_HAVE_RCU_TABLE_FREE=y +CONFIG_MMU_GATHER_TABLE_FREE=y +CONFIG_MMU_GATHER_RCU_TABLE_FREE=y CONFIG_ARCH_HAVE_NMI_SAFE_CMPXCHG=y +CONFIG_HAVE_ALIGNED_STRUCT_PAGE=y CONFIG_HAVE_CMPXCHG_LOCAL=y CONFIG_HAVE_CMPXCHG_DOUBLE=y CONFIG_ARCH_WANT_COMPAT_IPC_PARSE_VERSION=y @@ -777,6 +818,7 @@ CONFIG_HAVE_ARCH_COMPAT_MMAP_BASES=y CONFIG_HAVE_COPY_THREAD_TLS=y CONFIG_HAVE_STACK_VALIDATION=y CONFIG_HAVE_RELIABLE_STACKTRACE=y +CONFIG_ISA_BUS_API=y CONFIG_OLD_SIGSUSPEND3=y CONFIG_COMPAT_OLD_SIGACTION=y CONFIG_COMPAT_32BIT_TIME=y @@ -798,8 +840,12 @@ CONFIG_ARCH_HAS_MEM_ENCRYPT=y CONFIG_ARCH_HAS_GCOV_PROFILE_ALL=y # end of GCOV-based kernel profiling -CONFIG_PLUGIN_HOSTCC="" +CONFIG_PLUGIN_HOSTCC="g++" CONFIG_HAVE_GCC_PLUGINS=y +CONFIG_GCC_PLUGINS=y +# CONFIG_GCC_PLUGIN_CYC_COMPLEXITY is not set +# CONFIG_GCC_PLUGIN_LATENT_ENTROPY is not set +# CONFIG_GCC_PLUGIN_RANDSTRUCT is not set # end of General architecture-dependent options CONFIG_RT_MUTEXES=y @@ -821,15 +867,17 @@ CONFIG_BLK_CGROUP_RWSTAT=y CONFIG_BLK_DEV_BSG=y CONFIG_BLK_DEV_BSGLIB=y CONFIG_BLK_DEV_INTEGRITY=y +CONFIG_BLK_DEV_INTEGRITY_T10=y # CONFIG_BLK_DEV_ZONED is not set CONFIG_BLK_DEV_THROTTLING=y # CONFIG_BLK_DEV_THROTTLING_LOW is not set -CONFIG_BLK_CMDLINE_PARSER=y -# CONFIG_BLK_WBT is not set +# CONFIG_BLK_CMDLINE_PARSER is not set +CONFIG_BLK_WBT=y # CONFIG_BLK_CGROUP_IOLATENCY is not set # CONFIG_BLK_CGROUP_IOCOST is not set -CONFIG_BLK_DEBUG_FS=y -# CONFIG_BLK_SED_OPAL is not set +CONFIG_BLK_WBT_MQ=y +# CONFIG_BLK_DEBUG_FS is not set +CONFIG_BLK_SED_OPAL=y # # Partition Types @@ -837,8 +885,8 @@ CONFIG_BLK_DEBUG_FS=y CONFIG_PARTITION_ADVANCED=y # CONFIG_ACORN_PARTITION is not set # CONFIG_AIX_PARTITION is not set -CONFIG_OSF_PARTITION=y -CONFIG_AMIGA_PARTITION=y +# CONFIG_OSF_PARTITION is not set +# CONFIG_AMIGA_PARTITION is not set # CONFIG_ATARI_PARTITION is not set CONFIG_MAC_PARTITION=y CONFIG_MSDOS_PARTITION=y @@ -846,14 +894,15 @@ CONFIG_BSD_DISKLABEL=y CONFIG_MINIX_SUBPARTITION=y CONFIG_SOLARIS_X86_PARTITION=y CONFIG_UNIXWARE_DISKLABEL=y -# CONFIG_LDM_PARTITION is not set +CONFIG_LDM_PARTITION=y +# CONFIG_LDM_DEBUG is not set CONFIG_SGI_PARTITION=y # CONFIG_ULTRIX_PARTITION is not set CONFIG_SUN_PARTITION=y CONFIG_KARMA_PARTITION=y CONFIG_EFI_PARTITION=y -# CONFIG_SYSV68_PARTITION is not set -CONFIG_CMDLINE_PARTITION=y +CONFIG_SYSV68_PARTITION=y +# CONFIG_CMDLINE_PARTITION is not set # end of Partition Types CONFIG_BLOCK_COMPAT=y @@ -867,7 +916,9 @@ CONFIG_BLK_PM=y # CONFIG_MQ_IOSCHED_DEADLINE=y CONFIG_MQ_IOSCHED_KYBER=y -# CONFIG_IOSCHED_BFQ is not set +CONFIG_IOSCHED_BFQ=y +CONFIG_BFQ_GROUP_IOSCHED=y +# CONFIG_BFQ_CGROUP_DEBUG is not set # end of IO Schedulers CONFIG_PREEMPT_NOTIFIERS=y @@ -896,7 +947,7 @@ CONFIG_FREEZER=y CONFIG_BINFMT_ELF=y CONFIG_COMPAT_BINFMT_ELF=y CONFIG_ELFCORE=y -CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS=y +# CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS is not set CONFIG_BINFMT_SCRIPT=y CONFIG_BINFMT_MISC=m CONFIG_COREDUMP=y @@ -932,29 +983,37 @@ CONFIG_BOUNCE=y CONFIG_VIRT_TO_BUS=y CONFIG_MMU_NOTIFIER=y CONFIG_KSM=y -CONFIG_DEFAULT_MMAP_MIN_ADDR=4096 +CONFIG_DEFAULT_MMAP_MIN_ADDR=65536 CONFIG_ARCH_SUPPORTS_MEMORY_FAILURE=y CONFIG_MEMORY_FAILURE=y +# CONFIG_HWPOISON_INJECT is not set CONFIG_TRANSPARENT_HUGEPAGE=y -CONFIG_TRANSPARENT_HUGEPAGE_ALWAYS=y -# CONFIG_TRANSPARENT_HUGEPAGE_MADVISE is not set +# CONFIG_TRANSPARENT_HUGEPAGE_ALWAYS is not set +CONFIG_TRANSPARENT_HUGEPAGE_MADVISE=y CONFIG_ARCH_WANTS_THP_SWAP=y CONFIG_THP_SWAP=y CONFIG_TRANSPARENT_HUGE_PAGECACHE=y CONFIG_CLEANCACHE=y CONFIG_FRONTSWAP=y -# CONFIG_CMA is not set -# CONFIG_ZSWAP is not set +CONFIG_CMA=y +# CONFIG_CMA_DEBUG is not set +# CONFIG_CMA_DEBUGFS is not set +CONFIG_CMA_AREAS=7 +# CONFIG_MEM_SOFT_DIRTY is not set +CONFIG_ZSWAP=y CONFIG_ZPOOL=y -# CONFIG_ZBUD is not set -# CONFIG_Z3FOLD is not set -# CONFIG_ZSMALLOC is not set +CONFIG_ZBUD=y +CONFIG_Z3FOLD=m +CONFIG_ZSMALLOC=y +# CONFIG_PGTABLE_MAPPING is not set +# CONFIG_ZSMALLOC_STAT is not set CONFIG_GENERIC_EARLY_IOREMAP=y # CONFIG_DEFERRED_STRUCT_PAGE_INIT is not set # CONFIG_IDLE_PAGE_TRACKING is not set CONFIG_ARCH_HAS_PTE_DEVMAP=y CONFIG_ZONE_DEVICE=y CONFIG_DEV_PAGEMAP_OPS=y +CONFIG_HMM_MIRROR=y # CONFIG_DEVICE_PRIVATE is not set CONFIG_FRAME_VECTOR=y CONFIG_ARCH_USES_HIGH_VMA_FLAGS=y @@ -976,28 +1035,32 @@ CONFIG_SKB_EXTENSIONS=y # # Networking options # -CONFIG_PACKET=y +CONFIG_PACKET=m CONFIG_PACKET_DIAG=m CONFIG_UNIX=y CONFIG_UNIX_SCM=y CONFIG_UNIX_DIAG=m -# CONFIG_TLS is not set +CONFIG_TLS=m +# CONFIG_TLS_DEVICE is not set +# CONFIG_TLS_TOE is not set CONFIG_XFRM=y -CONFIG_XFRM_ALGO=y -CONFIG_XFRM_USER=y -# CONFIG_XFRM_INTERFACE is not set +CONFIG_XFRM_OFFLOAD=y +CONFIG_XFRM_ALGO=m +CONFIG_XFRM_USER=m +CONFIG_XFRM_INTERFACE=m CONFIG_XFRM_SUB_POLICY=y CONFIG_XFRM_MIGRATE=y -CONFIG_XFRM_STATISTICS=y +# CONFIG_XFRM_STATISTICS is not set CONFIG_XFRM_IPCOMP=m CONFIG_NET_KEY=m CONFIG_NET_KEY_MIGRATE=y # CONFIG_SMC is not set -# CONFIG_XDP_SOCKETS is not set +CONFIG_XDP_SOCKETS=y +CONFIG_XDP_SOCKETS_DIAG=m CONFIG_INET=y CONFIG_IP_MULTICAST=y CONFIG_IP_ADVANCED_ROUTER=y -CONFIG_IP_FIB_TRIE_STATS=y +# CONFIG_IP_FIB_TRIE_STATS is not set CONFIG_IP_MULTIPLE_TABLES=y CONFIG_IP_ROUTE_MULTIPATH=y CONFIG_IP_ROUTE_VERBOSE=y @@ -1016,58 +1079,44 @@ CONFIG_IP_PIMSM_V2=y CONFIG_SYN_COOKIES=y CONFIG_NET_IPVTI=m CONFIG_NET_UDP_TUNNEL=m -# CONFIG_NET_FOU is not set -# CONFIG_NET_FOU_IP_TUNNELS is not set +CONFIG_NET_FOU=m +CONFIG_NET_FOU_IP_TUNNELS=y CONFIG_INET_AH=m CONFIG_INET_ESP=m -# CONFIG_INET_ESP_OFFLOAD is not set +CONFIG_INET_ESP_OFFLOAD=m +# CONFIG_INET_ESPINTCP is not set CONFIG_INET_IPCOMP=m CONFIG_INET_XFRM_TUNNEL=m CONFIG_INET_TUNNEL=m -CONFIG_INET_DIAG=m -CONFIG_INET_TCP_DIAG=m +CONFIG_INET_DIAG=y +CONFIG_INET_TCP_DIAG=y CONFIG_INET_UDP_DIAG=m -# CONFIG_INET_RAW_DIAG is not set +CONFIG_INET_RAW_DIAG=m # CONFIG_INET_DIAG_DESTROY is not set -CONFIG_TCP_CONG_ADVANCED=y -CONFIG_TCP_CONG_BIC=m +# CONFIG_TCP_CONG_ADVANCED is not set CONFIG_TCP_CONG_CUBIC=y -CONFIG_TCP_CONG_WESTWOOD=m -CONFIG_TCP_CONG_HTCP=m -CONFIG_TCP_CONG_HSTCP=m -CONFIG_TCP_CONG_HYBLA=m -CONFIG_TCP_CONG_VEGAS=m -CONFIG_TCP_CONG_NV=m -CONFIG_TCP_CONG_SCALABLE=m -CONFIG_TCP_CONG_LP=m -CONFIG_TCP_CONG_VENO=m -CONFIG_TCP_CONG_YEAH=m -CONFIG_TCP_CONG_ILLINOIS=m -# CONFIG_TCP_CONG_DCTCP is not set -# CONFIG_TCP_CONG_CDG is not set -# CONFIG_TCP_CONG_BBR is not set -CONFIG_DEFAULT_CUBIC=y -# CONFIG_DEFAULT_RENO is not set CONFIG_DEFAULT_TCP_CONG="cubic" -CONFIG_TCP_MD5SIG=y -CONFIG_IPV6=y +# CONFIG_TCP_MD5SIG is not set +CONFIG_IPV6=m CONFIG_IPV6_ROUTER_PREF=y CONFIG_IPV6_ROUTE_INFO=y CONFIG_IPV6_OPTIMISTIC_DAD=y CONFIG_INET6_AH=m CONFIG_INET6_ESP=m -# CONFIG_INET6_ESP_OFFLOAD is not set +CONFIG_INET6_ESP_OFFLOAD=m CONFIG_INET6_IPCOMP=m -CONFIG_IPV6_MIP6=y -CONFIG_IPV6_ILA=m +CONFIG_IPV6_MIP6=m +# CONFIG_IPV6_ILA is not set CONFIG_INET6_XFRM_TUNNEL=m CONFIG_INET6_TUNNEL=m CONFIG_IPV6_VTI=m CONFIG_IPV6_SIT=m -CONFIG_IPV6_SIT_6RD=y +# CONFIG_IPV6_SIT_6RD is not set CONFIG_IPV6_NDISC_NODETYPE=y CONFIG_IPV6_TUNNEL=m CONFIG_IPV6_GRE=m +CONFIG_IPV6_FOU=m +CONFIG_IPV6_FOU_TUNNEL=m CONFIG_IPV6_MULTIPLE_TABLES=y CONFIG_IPV6_SUBTREES=y CONFIG_IPV6_MROUTE=y @@ -1076,9 +1125,10 @@ CONFIG_IPV6_PIMSM_V2=y # CONFIG_IPV6_SEG6_LWTUNNEL is not set # CONFIG_IPV6_SEG6_HMAC is not set CONFIG_NETLABEL=y +# CONFIG_MPTCP is not set CONFIG_NETWORK_SECMARK=y CONFIG_NET_PTP_CLASSIFY=y -CONFIG_NETWORK_PHY_TIMESTAMPING=y +# CONFIG_NETWORK_PHY_TIMESTAMPING is not set CONFIG_NETFILTER=y CONFIG_NETFILTER_ADVANCED=y CONFIG_BRIDGE_NETFILTER=m @@ -1096,14 +1146,14 @@ CONFIG_NETFILTER_NETLINK_LOG=m CONFIG_NETFILTER_NETLINK_OSF=m CONFIG_NF_CONNTRACK=m CONFIG_NF_LOG_COMMON=m -# CONFIG_NF_LOG_NETDEV is not set +CONFIG_NF_LOG_NETDEV=m CONFIG_NETFILTER_CONNCOUNT=m CONFIG_NF_CONNTRACK_MARK=y CONFIG_NF_CONNTRACK_SECMARK=y CONFIG_NF_CONNTRACK_ZONES=y -CONFIG_NF_CONNTRACK_PROCFS=y +# CONFIG_NF_CONNTRACK_PROCFS is not set CONFIG_NF_CONNTRACK_EVENTS=y -# CONFIG_NF_CONNTRACK_TIMEOUT is not set +CONFIG_NF_CONNTRACK_TIMEOUT=y CONFIG_NF_CONNTRACK_TIMESTAMP=y CONFIG_NF_CONNTRACK_LABELS=y CONFIG_NF_CT_PROTO_DCCP=y @@ -1122,7 +1172,9 @@ CONFIG_NF_CONNTRACK_SANE=m CONFIG_NF_CONNTRACK_SIP=m CONFIG_NF_CONNTRACK_TFTP=m CONFIG_NF_CT_NETLINK=m -# CONFIG_NETFILTER_NETLINK_GLUE_CT is not set +CONFIG_NF_CT_NETLINK_TIMEOUT=m +CONFIG_NF_CT_NETLINK_HELPER=m +CONFIG_NETFILTER_NETLINK_GLUE_CT=y CONFIG_NF_NAT=m CONFIG_NF_NAT_AMANDA=m CONFIG_NF_NAT_FTP=m @@ -1131,32 +1183,41 @@ CONFIG_NF_NAT_SIP=m CONFIG_NF_NAT_TFTP=m CONFIG_NF_NAT_REDIRECT=y CONFIG_NF_NAT_MASQUERADE=y +CONFIG_NETFILTER_SYNPROXY=m CONFIG_NF_TABLES=m -# CONFIG_NF_TABLES_SET is not set +CONFIG_NF_TABLES_SET=m # CONFIG_NF_TABLES_INET is not set -# CONFIG_NF_TABLES_NETDEV is not set -# CONFIG_NFT_NUMGEN is not set +CONFIG_NF_TABLES_NETDEV=y +CONFIG_NFT_NUMGEN=m CONFIG_NFT_CT=m +CONFIG_NFT_FLOW_OFFLOAD=m CONFIG_NFT_COUNTER=m -# CONFIG_NFT_CONNLIMIT is not set +CONFIG_NFT_CONNLIMIT=m CONFIG_NFT_LOG=m CONFIG_NFT_LIMIT=m -# CONFIG_NFT_MASQ is not set -# CONFIG_NFT_REDIR is not set -# CONFIG_NFT_TUNNEL is not set -# CONFIG_NFT_OBJREF is not set +CONFIG_NFT_MASQ=m +CONFIG_NFT_REDIR=m +CONFIG_NFT_NAT=m +CONFIG_NFT_TUNNEL=m +CONFIG_NFT_OBJREF=m CONFIG_NFT_QUEUE=m -# CONFIG_NFT_QUOTA is not set +CONFIG_NFT_QUOTA=m CONFIG_NFT_REJECT=m CONFIG_NFT_COMPAT=m CONFIG_NFT_HASH=m -# CONFIG_NFT_XFRM is not set -# CONFIG_NFT_SOCKET is not set -# CONFIG_NFT_OSF is not set -# CONFIG_NFT_TPROXY is not set -# CONFIG_NFT_SYNPROXY is not set -# CONFIG_NF_FLOW_TABLE is not set -CONFIG_NETFILTER_XTABLES=y +CONFIG_NFT_FIB=m +CONFIG_NFT_XFRM=m +CONFIG_NFT_SOCKET=m +CONFIG_NFT_OSF=m +CONFIG_NFT_TPROXY=m +CONFIG_NFT_SYNPROXY=m +CONFIG_NF_DUP_NETDEV=m +CONFIG_NFT_DUP_NETDEV=m +CONFIG_NFT_FWD_NETDEV=m +CONFIG_NFT_FIB_NETDEV=m +CONFIG_NF_FLOW_TABLE_INET=m +CONFIG_NF_FLOW_TABLE=m +CONFIG_NETFILTER_XTABLES=m # # Xtables combined modules @@ -1185,7 +1246,7 @@ CONFIG_NETFILTER_XT_NAT=m CONFIG_NETFILTER_XT_TARGET_NETMAP=m CONFIG_NETFILTER_XT_TARGET_NFLOG=m CONFIG_NETFILTER_XT_TARGET_NFQUEUE=m -CONFIG_NETFILTER_XT_TARGET_NOTRACK=m +# CONFIG_NETFILTER_XT_TARGET_NOTRACK is not set CONFIG_NETFILTER_XT_TARGET_RATEEST=m CONFIG_NETFILTER_XT_TARGET_REDIRECT=m CONFIG_NETFILTER_XT_TARGET_MASQUERADE=m @@ -1238,7 +1299,7 @@ CONFIG_NETFILTER_XT_MATCH_RATEEST=m CONFIG_NETFILTER_XT_MATCH_REALM=m CONFIG_NETFILTER_XT_MATCH_RECENT=m CONFIG_NETFILTER_XT_MATCH_SCTP=m -# CONFIG_NETFILTER_XT_MATCH_SOCKET is not set +CONFIG_NETFILTER_XT_MATCH_SOCKET=m CONFIG_NETFILTER_XT_MATCH_STATE=m CONFIG_NETFILTER_XT_MATCH_STATISTIC=m CONFIG_NETFILTER_XT_MATCH_STRING=m @@ -1257,8 +1318,8 @@ CONFIG_IP_SET_HASH_IPMARK=m CONFIG_IP_SET_HASH_IPPORT=m CONFIG_IP_SET_HASH_IPPORTIP=m CONFIG_IP_SET_HASH_IPPORTNET=m -# CONFIG_IP_SET_HASH_IPMAC is not set -# CONFIG_IP_SET_HASH_MAC is not set +CONFIG_IP_SET_HASH_IPMAC=m +CONFIG_IP_SET_HASH_MAC=m CONFIG_IP_SET_HASH_NETPORTNET=m CONFIG_IP_SET_HASH_NET=m CONFIG_IP_SET_HASH_NETNET=m @@ -1267,7 +1328,7 @@ CONFIG_IP_SET_HASH_NETIFACE=m CONFIG_IP_SET_LIST_SET=m CONFIG_IP_VS=m CONFIG_IP_VS_IPV6=y -# CONFIG_IP_VS_DEBUG is not set +CONFIG_IP_VS_DEBUG=y CONFIG_IP_VS_TAB_BITS=12 # @@ -1287,13 +1348,13 @@ CONFIG_IP_VS_RR=m CONFIG_IP_VS_WRR=m CONFIG_IP_VS_LC=m CONFIG_IP_VS_WLC=m -# CONFIG_IP_VS_FO is not set +CONFIG_IP_VS_FO=m CONFIG_IP_VS_OVF=m CONFIG_IP_VS_LBLC=m CONFIG_IP_VS_LBLCR=m CONFIG_IP_VS_DH=m CONFIG_IP_VS_SH=m -# CONFIG_IP_VS_MH is not set +CONFIG_IP_VS_MH=m CONFIG_IP_VS_SED=m CONFIG_IP_VS_NQ=m @@ -1318,25 +1379,29 @@ CONFIG_IP_VS_PE_SIP=m # IP: Netfilter Configuration # CONFIG_NF_DEFRAG_IPV4=m -# CONFIG_NF_SOCKET_IPV4 is not set +CONFIG_NF_SOCKET_IPV4=m CONFIG_NF_TPROXY_IPV4=m -# CONFIG_NF_TABLES_IPV4 is not set -# CONFIG_NF_TABLES_ARP is not set +CONFIG_NF_TABLES_IPV4=y +CONFIG_NFT_REJECT_IPV4=m +CONFIG_NFT_DUP_IPV4=m +CONFIG_NFT_FIB_IPV4=m +CONFIG_NF_TABLES_ARP=y +CONFIG_NF_FLOW_TABLE_IPV4=m CONFIG_NF_DUP_IPV4=m CONFIG_NF_LOG_ARP=m CONFIG_NF_LOG_IPV4=m -CONFIG_NF_REJECT_IPV4=y +CONFIG_NF_REJECT_IPV4=m CONFIG_NF_NAT_SNMP_BASIC=m CONFIG_NF_NAT_PPTP=m CONFIG_NF_NAT_H323=m -CONFIG_IP_NF_IPTABLES=y +CONFIG_IP_NF_IPTABLES=m CONFIG_IP_NF_MATCH_AH=m CONFIG_IP_NF_MATCH_ECN=m CONFIG_IP_NF_MATCH_RPFILTER=m CONFIG_IP_NF_MATCH_TTL=m -CONFIG_IP_NF_FILTER=y -CONFIG_IP_NF_TARGET_REJECT=y -# CONFIG_IP_NF_TARGET_SYNPROXY is not set +CONFIG_IP_NF_FILTER=m +CONFIG_IP_NF_TARGET_REJECT=m +CONFIG_IP_NF_TARGET_SYNPROXY=m CONFIG_IP_NF_NAT=m CONFIG_IP_NF_TARGET_MASQUERADE=m CONFIG_IP_NF_TARGET_NETMAP=m @@ -1355,9 +1420,13 @@ CONFIG_IP_NF_ARP_MANGLE=m # # IPv6: Netfilter Configuration # -# CONFIG_NF_SOCKET_IPV6 is not set +CONFIG_NF_SOCKET_IPV6=m CONFIG_NF_TPROXY_IPV6=m -# CONFIG_NF_TABLES_IPV6 is not set +CONFIG_NF_TABLES_IPV6=y +CONFIG_NFT_REJECT_IPV6=m +CONFIG_NFT_DUP_IPV6=m +CONFIG_NFT_FIB_IPV6=m +CONFIG_NF_FLOW_TABLE_IPV6=m CONFIG_NF_DUP_IPV6=m CONFIG_NF_REJECT_IPV6=m CONFIG_NF_LOG_IPV6=m @@ -1371,11 +1440,11 @@ CONFIG_IP6_NF_MATCH_IPV6HEADER=m CONFIG_IP6_NF_MATCH_MH=m CONFIG_IP6_NF_MATCH_RPFILTER=m CONFIG_IP6_NF_MATCH_RT=m -# CONFIG_IP6_NF_MATCH_SRH is not set +CONFIG_IP6_NF_MATCH_SRH=m CONFIG_IP6_NF_TARGET_HL=m CONFIG_IP6_NF_FILTER=m CONFIG_IP6_NF_TARGET_REJECT=m -# CONFIG_IP6_NF_TARGET_SYNPROXY is not set +CONFIG_IP6_NF_TARGET_SYNPROXY=m CONFIG_IP6_NF_MANGLE=m CONFIG_IP6_NF_RAW=m CONFIG_IP6_NF_SECURITY=m @@ -1385,8 +1454,18 @@ CONFIG_IP6_NF_TARGET_NPT=m # end of IPv6: Netfilter Configuration CONFIG_NF_DEFRAG_IPV6=m -# CONFIG_NF_TABLES_BRIDGE is not set -# CONFIG_NF_CONNTRACK_BRIDGE is not set + +# +# DECnet: Netfilter Configuration +# +CONFIG_DECNET_NF_GRABULATOR=m +# end of DECnet: Netfilter Configuration + +CONFIG_NF_TABLES_BRIDGE=m +CONFIG_NFT_BRIDGE_META=m +CONFIG_NFT_BRIDGE_REJECT=m +CONFIG_NF_LOG_BRIDGE=m +CONFIG_NF_CONNTRACK_BRIDGE=m CONFIG_BRIDGE_NF_EBTABLES=m CONFIG_BRIDGE_EBT_BROUTE=m CONFIG_BRIDGE_EBT_T_FILTER=m @@ -1421,6 +1500,12 @@ CONFIG_IP_DCCP_CCID3=y CONFIG_IP_DCCP_TFRC_LIB=y # end of DCCP CCIDs Configuration +# +# DCCP Kernel Hacking +# +# CONFIG_IP_DCCP_DEBUG is not set +# end of DCCP Kernel Hacking + CONFIG_IP_SCTP=m # CONFIG_SCTP_DBG_OBJCNT is not set CONFIG_SCTP_DEFAULT_COOKIE_HMAC_MD5=y @@ -1433,19 +1518,21 @@ CONFIG_RDS=m CONFIG_RDS_RDMA=m CONFIG_RDS_TCP=m # CONFIG_RDS_DEBUG is not set -# CONFIG_TIPC is not set +CONFIG_TIPC=m +CONFIG_TIPC_MEDIA_IB=y +CONFIG_TIPC_MEDIA_UDP=y +CONFIG_TIPC_CRYPTO=y +CONFIG_TIPC_DIAG=m CONFIG_ATM=m CONFIG_ATM_CLIP=m # CONFIG_ATM_CLIP_NO_ICMP is not set CONFIG_ATM_LANE=m -# CONFIG_ATM_MPOA is not set +CONFIG_ATM_MPOA=m CONFIG_ATM_BR2684=m -# CONFIG_ATM_BR2684_IPFILTER is not set +CONFIG_ATM_BR2684_IPFILTER=y CONFIG_L2TP=m CONFIG_L2TP_DEBUGFS=m -CONFIG_L2TP_V3=y -CONFIG_L2TP_IP=m -CONFIG_L2TP_ETH=m +# CONFIG_L2TP_V3 is not set CONFIG_STP=m CONFIG_GARP=m CONFIG_MRP=m @@ -1454,32 +1541,34 @@ CONFIG_BRIDGE_IGMP_SNOOPING=y CONFIG_BRIDGE_VLAN_FILTERING=y CONFIG_HAVE_NET_DSA=y CONFIG_NET_DSA=m +# CONFIG_NET_DSA_TAG_AR9331 is not set CONFIG_NET_DSA_TAG_BRCM_COMMON=m CONFIG_NET_DSA_TAG_BRCM=m CONFIG_NET_DSA_TAG_BRCM_PREPEND=m -# CONFIG_NET_DSA_TAG_GSWIP is not set +CONFIG_NET_DSA_TAG_GSWIP=m CONFIG_NET_DSA_TAG_DSA=m CONFIG_NET_DSA_TAG_EDSA=m # CONFIG_NET_DSA_TAG_MTK is not set # CONFIG_NET_DSA_TAG_KSZ is not set # CONFIG_NET_DSA_TAG_OCELOT is not set -CONFIG_NET_DSA_TAG_QCA=m +# CONFIG_NET_DSA_TAG_QCA is not set # CONFIG_NET_DSA_TAG_LAN9303 is not set # CONFIG_NET_DSA_TAG_SJA1105 is not set CONFIG_NET_DSA_TAG_TRAILER=m CONFIG_VLAN_8021Q=m CONFIG_VLAN_8021Q_GVRP=y CONFIG_VLAN_8021Q_MVRP=y -# CONFIG_DECNET is not set +CONFIG_DECNET=m +# CONFIG_DECNET_ROUTER is not set CONFIG_LLC=m -# CONFIG_LLC2 is not set +CONFIG_LLC2=m CONFIG_ATALK=m CONFIG_DEV_APPLETALK=m CONFIG_IPDDP=m CONFIG_IPDDP_ENCAP=y -# CONFIG_X25 is not set -# CONFIG_LAPB is not set -# CONFIG_PHONET is not set +CONFIG_X25=m +CONFIG_LAPB=m +CONFIG_PHONET=m CONFIG_6LOWPAN=m # CONFIG_6LOWPAN_DEBUGFS is not set CONFIG_6LOWPAN_NHC=m @@ -1490,14 +1579,14 @@ CONFIG_6LOWPAN_NHC_IPV6=m CONFIG_6LOWPAN_NHC_MOBILITY=m CONFIG_6LOWPAN_NHC_ROUTING=m CONFIG_6LOWPAN_NHC_UDP=m -# CONFIG_6LOWPAN_GHC_EXT_HDR_HOP is not set -# CONFIG_6LOWPAN_GHC_UDP is not set -# CONFIG_6LOWPAN_GHC_ICMPV6 is not set -# CONFIG_6LOWPAN_GHC_EXT_HDR_DEST is not set -# CONFIG_6LOWPAN_GHC_EXT_HDR_FRAG is not set -# CONFIG_6LOWPAN_GHC_EXT_HDR_ROUTE is not set +CONFIG_6LOWPAN_GHC_EXT_HDR_HOP=m +CONFIG_6LOWPAN_GHC_UDP=m +CONFIG_6LOWPAN_GHC_ICMPV6=m +CONFIG_6LOWPAN_GHC_EXT_HDR_DEST=m +CONFIG_6LOWPAN_GHC_EXT_HDR_FRAG=m +CONFIG_6LOWPAN_GHC_EXT_HDR_ROUTE=m CONFIG_IEEE802154=m -# CONFIG_IEEE802154_NL802154_EXPERIMENTAL is not set +CONFIG_IEEE802154_NL802154_EXPERIMENTAL=y CONFIG_IEEE802154_SOCKET=m CONFIG_IEEE802154_6LOWPAN=m CONFIG_MAC802154=m @@ -1509,7 +1598,7 @@ CONFIG_NET_SCHED=y CONFIG_NET_SCH_CBQ=m CONFIG_NET_SCH_HTB=m CONFIG_NET_SCH_HFSC=m -CONFIG_NET_SCH_ATM=m +# CONFIG_NET_SCH_ATM is not set CONFIG_NET_SCH_PRIO=m CONFIG_NET_SCH_MULTIQ=m CONFIG_NET_SCH_RED=m @@ -1517,25 +1606,27 @@ CONFIG_NET_SCH_SFB=m CONFIG_NET_SCH_SFQ=m CONFIG_NET_SCH_TEQL=m CONFIG_NET_SCH_TBF=m -# CONFIG_NET_SCH_CBS is not set -# CONFIG_NET_SCH_ETF is not set -# CONFIG_NET_SCH_TAPRIO is not set +CONFIG_NET_SCH_CBS=m +CONFIG_NET_SCH_ETF=m +CONFIG_NET_SCH_TAPRIO=m CONFIG_NET_SCH_GRED=m CONFIG_NET_SCH_DSMARK=m CONFIG_NET_SCH_NETEM=m CONFIG_NET_SCH_DRR=m CONFIG_NET_SCH_MQPRIO=m -# CONFIG_NET_SCH_SKBPRIO is not set +CONFIG_NET_SCH_SKBPRIO=m CONFIG_NET_SCH_CHOKE=m CONFIG_NET_SCH_QFQ=m CONFIG_NET_SCH_CODEL=m CONFIG_NET_SCH_FQ_CODEL=m -# CONFIG_NET_SCH_CAKE is not set -# CONFIG_NET_SCH_FQ is not set +CONFIG_NET_SCH_CAKE=m +CONFIG_NET_SCH_FQ=m CONFIG_NET_SCH_HHF=m CONFIG_NET_SCH_PIE=m +# CONFIG_NET_SCH_FQ_PIE is not set CONFIG_NET_SCH_INGRESS=m CONFIG_NET_SCH_PLUG=m +CONFIG_NET_SCH_ETS=m # CONFIG_NET_SCH_DEFAULT is not set # @@ -1547,14 +1638,14 @@ CONFIG_NET_CLS_TCINDEX=m CONFIG_NET_CLS_ROUTE4=m CONFIG_NET_CLS_FW=m CONFIG_NET_CLS_U32=m -CONFIG_CLS_U32_PERF=y -CONFIG_CLS_U32_MARK=y +# CONFIG_CLS_U32_PERF is not set +# CONFIG_CLS_U32_MARK is not set CONFIG_NET_CLS_RSVP=m CONFIG_NET_CLS_RSVP6=m CONFIG_NET_CLS_FLOW=m CONFIG_NET_CLS_CGROUP=y CONFIG_NET_CLS_BPF=m -# CONFIG_NET_CLS_FLOWER is not set +CONFIG_NET_CLS_FLOWER=m CONFIG_NET_CLS_MATCHALL=m CONFIG_NET_EMATCH=y CONFIG_NET_EMATCH_STACK=32 @@ -1563,56 +1654,52 @@ CONFIG_NET_EMATCH_NBYTE=m CONFIG_NET_EMATCH_U32=m CONFIG_NET_EMATCH_META=m CONFIG_NET_EMATCH_TEXT=m +CONFIG_NET_EMATCH_CANID=m CONFIG_NET_EMATCH_IPSET=m -# CONFIG_NET_EMATCH_IPT is not set +CONFIG_NET_EMATCH_IPT=m CONFIG_NET_CLS_ACT=y -CONFIG_NET_ACT_POLICE=m +CONFIG_NET_ACT_POLICE=y CONFIG_NET_ACT_GACT=m CONFIG_GACT_PROB=y CONFIG_NET_ACT_MIRRED=m -# CONFIG_NET_ACT_SAMPLE is not set +CONFIG_NET_ACT_SAMPLE=m CONFIG_NET_ACT_IPT=m CONFIG_NET_ACT_NAT=m CONFIG_NET_ACT_PEDIT=m CONFIG_NET_ACT_SIMP=m CONFIG_NET_ACT_SKBEDIT=m CONFIG_NET_ACT_CSUM=m -# CONFIG_NET_ACT_MPLS is not set -# CONFIG_NET_ACT_VLAN is not set +CONFIG_NET_ACT_MPLS=m +CONFIG_NET_ACT_VLAN=m CONFIG_NET_ACT_BPF=m CONFIG_NET_ACT_CONNMARK=m -# CONFIG_NET_ACT_CTINFO is not set +CONFIG_NET_ACT_CTINFO=m # CONFIG_NET_ACT_SKBMOD is not set -# CONFIG_NET_ACT_IFE is not set +CONFIG_NET_ACT_IFE=m # CONFIG_NET_ACT_TUNNEL_KEY is not set -# CONFIG_NET_ACT_CT is not set +CONFIG_NET_ACT_CT=m +CONFIG_NET_IFE_SKBMARK=m +CONFIG_NET_IFE_SKBPRIO=m +CONFIG_NET_IFE_SKBTCINDEX=m # CONFIG_NET_TC_SKB_EXT is not set CONFIG_NET_SCH_FIFO=y CONFIG_DCB=y CONFIG_DNS_RESOLVER=y -CONFIG_BATMAN_ADV=m -# CONFIG_BATMAN_ADV_BATMAN_V is not set -CONFIG_BATMAN_ADV_BLA=y -CONFIG_BATMAN_ADV_DAT=y -# CONFIG_BATMAN_ADV_NC is not set -# CONFIG_BATMAN_ADV_MCAST is not set -CONFIG_BATMAN_ADV_DEBUGFS=y -# CONFIG_BATMAN_ADV_DEBUG is not set -CONFIG_BATMAN_ADV_SYSFS=y -# CONFIG_BATMAN_ADV_TRACING is not set +# CONFIG_BATMAN_ADV is not set CONFIG_OPENVSWITCH=m CONFIG_OPENVSWITCH_GRE=m CONFIG_OPENVSWITCH_VXLAN=m CONFIG_OPENVSWITCH_GENEVE=m CONFIG_VSOCKETS=m CONFIG_VSOCKETS_DIAG=m +CONFIG_VSOCKETS_LOOPBACK=m CONFIG_VMWARE_VMCI_VSOCKETS=m CONFIG_VIRTIO_VSOCKETS=m CONFIG_VIRTIO_VSOCKETS_COMMON=m -# CONFIG_HYPERV_VSOCKETS is not set +CONFIG_HYPERV_VSOCKETS=m CONFIG_NETLINK_DIAG=m CONFIG_MPLS=y -CONFIG_NET_MPLS_GSO=m +CONFIG_NET_MPLS_GSO=y CONFIG_MPLS_ROUTING=m CONFIG_MPLS_IPTUNNEL=m CONFIG_NET_NSH=m @@ -1623,18 +1710,19 @@ CONFIG_NET_L3_MASTER_DEV=y CONFIG_RPS=y CONFIG_RFS_ACCEL=y CONFIG_XPS=y -CONFIG_CGROUP_NET_PRIO=y +# CONFIG_CGROUP_NET_PRIO is not set CONFIG_CGROUP_NET_CLASSID=y CONFIG_NET_RX_BUSY_POLL=y CONFIG_BQL=y CONFIG_BPF_JIT=y +CONFIG_BPF_STREAM_PARSER=y CONFIG_NET_FLOW_LIMIT=y # # Network testing # CONFIG_NET_PKTGEN=m -CONFIG_NET_DROP_MONITOR=y +# CONFIG_NET_DROP_MONITOR is not set # end of Network testing # end of Networking options @@ -1660,7 +1748,69 @@ CONFIG_BAYCOM_PAR=m CONFIG_YAM=m # end of AX.25 network device drivers -# CONFIG_CAN is not set +CONFIG_CAN=m +CONFIG_CAN_RAW=m +CONFIG_CAN_BCM=m +CONFIG_CAN_GW=m +# CONFIG_CAN_J1939 is not set + +# +# CAN Device Drivers +# +CONFIG_CAN_VCAN=m +CONFIG_CAN_VXCAN=m +CONFIG_CAN_SLCAN=m +CONFIG_CAN_DEV=m +# CONFIG_CAN_CALC_BITTIMING is not set +# CONFIG_CAN_KVASER_PCIEFD is not set +CONFIG_CAN_C_CAN=m +CONFIG_CAN_C_CAN_PLATFORM=m +CONFIG_CAN_C_CAN_PCI=m +CONFIG_CAN_CC770=m +CONFIG_CAN_CC770_ISA=m +CONFIG_CAN_CC770_PLATFORM=m +CONFIG_CAN_IFI_CANFD=m +CONFIG_CAN_M_CAN=m +# CONFIG_CAN_M_CAN_PLATFORM is not set +# CONFIG_CAN_M_CAN_TCAN4X5X is not set +CONFIG_CAN_PEAK_PCIEFD=m +CONFIG_CAN_SJA1000=m +CONFIG_CAN_EMS_PCI=m +CONFIG_CAN_EMS_PCMCIA=m +# CONFIG_CAN_F81601 is not set +CONFIG_CAN_KVASER_PCI=m +CONFIG_CAN_PEAK_PCI=m +CONFIG_CAN_PEAK_PCIEC=y +CONFIG_CAN_PEAK_PCMCIA=m +CONFIG_CAN_PLX_PCI=m +CONFIG_CAN_SJA1000_ISA=m +# CONFIG_CAN_SJA1000_PLATFORM is not set +CONFIG_CAN_SOFTING=m +CONFIG_CAN_SOFTING_CS=m + +# +# CAN SPI interfaces +# +# CONFIG_CAN_HI311X is not set +CONFIG_CAN_MCP251X=m +# end of CAN SPI interfaces + +# +# CAN USB interfaces +# +CONFIG_CAN_8DEV_USB=m +CONFIG_CAN_EMS_USB=m +CONFIG_CAN_ESD_USB2=m +CONFIG_CAN_GS_USB=m +CONFIG_CAN_KVASER_USB=m +# CONFIG_CAN_MCBA_USB is not set +CONFIG_CAN_PEAK_USB=m +# CONFIG_CAN_UCAN is not set +# end of CAN USB interfaces + +# CONFIG_CAN_DEBUG_DEVICES is not set +# end of CAN Device Drivers + CONFIG_BT=m CONFIG_BT_BREDR=y CONFIG_BT_RFCOMM=m @@ -1673,8 +1823,9 @@ CONFIG_BT_HIDP=m CONFIG_BT_HS=y CONFIG_BT_LE=y CONFIG_BT_6LOWPAN=m -# CONFIG_BT_LEDS is not set -CONFIG_BT_DEBUGFS=y +CONFIG_BT_LEDS=y +# CONFIG_BT_SELFTEST is not set +# CONFIG_BT_DEBUGFS is not set # # Bluetooth device drivers @@ -1682,18 +1833,26 @@ CONFIG_BT_DEBUGFS=y CONFIG_BT_INTEL=m CONFIG_BT_BCM=m CONFIG_BT_RTL=m +CONFIG_BT_QCA=m CONFIG_BT_HCIBTUSB=m # CONFIG_BT_HCIBTUSB_AUTOSUSPEND is not set CONFIG_BT_HCIBTUSB_BCM=y -# CONFIG_BT_HCIBTUSB_MTK is not set +CONFIG_BT_HCIBTUSB_MTK=y CONFIG_BT_HCIBTUSB_RTL=y CONFIG_BT_HCIBTSDIO=m CONFIG_BT_HCIUART=m +CONFIG_BT_HCIUART_SERDEV=y CONFIG_BT_HCIUART_H4=y +# CONFIG_BT_HCIUART_NOKIA is not set CONFIG_BT_HCIUART_BCSP=y CONFIG_BT_HCIUART_ATH3K=y +CONFIG_BT_HCIUART_LL=y +CONFIG_BT_HCIUART_3WIRE=y CONFIG_BT_HCIUART_INTEL=y -# CONFIG_BT_HCIUART_AG6XX is not set +CONFIG_BT_HCIUART_RTL=y +CONFIG_BT_HCIUART_QCA=y +CONFIG_BT_HCIUART_AG6XX=y +CONFIG_BT_HCIUART_MRVL=y CONFIG_BT_HCIBCM203X=m CONFIG_BT_HCIBPA10X=m CONFIG_BT_HCIBFUSB=m @@ -1704,12 +1863,18 @@ CONFIG_BT_HCIVHCI=m CONFIG_BT_MRVL=m CONFIG_BT_MRVL_SDIO=m CONFIG_BT_ATH3K=m -# CONFIG_BT_MTKSDIO is not set +CONFIG_BT_MTKSDIO=m +CONFIG_BT_MTKUART=m CONFIG_BT_HCIRSI=m # end of Bluetooth device drivers -# CONFIG_AF_RXRPC is not set -# CONFIG_AF_KCM is not set +CONFIG_AF_RXRPC=m +CONFIG_AF_RXRPC_IPV6=y +# CONFIG_AF_RXRPC_INJECT_LOSS is not set +# CONFIG_AF_RXRPC_DEBUG is not set +# CONFIG_RXKAD is not set +CONFIG_AF_KCM=m +CONFIG_STREAM_PARSER=y CONFIG_FIB_RULES=y CONFIG_WIRELESS=y CONFIG_WIRELESS_EXT=y @@ -1720,10 +1885,11 @@ CONFIG_WEXT_PRIV=y CONFIG_CFG80211=m # CONFIG_NL80211_TESTMODE is not set # CONFIG_CFG80211_DEVELOPER_WARNINGS is not set +# CONFIG_CFG80211_CERTIFICATION_ONUS is not set CONFIG_CFG80211_REQUIRE_SIGNED_REGDB=y CONFIG_CFG80211_USE_KERNEL_REGDB_KEYS=y -# CONFIG_CFG80211_DEFAULT_PS is not set -CONFIG_CFG80211_DEBUGFS=y +CONFIG_CFG80211_DEFAULT_PS=y +# CONFIG_CFG80211_DEBUGFS is not set CONFIG_CFG80211_CRDA_SUPPORT=y CONFIG_CFG80211_WEXT=y CONFIG_CFG80211_WEXT_EXPORT=y @@ -1739,8 +1905,8 @@ CONFIG_MAC80211_RC_DEFAULT_MINSTREL=y CONFIG_MAC80211_RC_DEFAULT="minstrel_ht" CONFIG_MAC80211_MESH=y CONFIG_MAC80211_LEDS=y -CONFIG_MAC80211_DEBUGFS=y -CONFIG_MAC80211_MESSAGE_TRACING=y +# CONFIG_MAC80211_DEBUGFS is not set +# CONFIG_MAC80211_MESSAGE_TRACING is not set # CONFIG_MAC80211_DEBUG_MENU is not set CONFIG_MAC80211_STA_HASH_MAX_SIZE=0 CONFIG_WIMAX=m @@ -1751,56 +1917,69 @@ CONFIG_RFKILL_INPUT=y CONFIG_RFKILL_GPIO=m CONFIG_NET_9P=m CONFIG_NET_9P_VIRTIO=m -# CONFIG_NET_9P_XEN is not set +CONFIG_NET_9P_XEN=m CONFIG_NET_9P_RDMA=m # CONFIG_NET_9P_DEBUG is not set -# CONFIG_CAIF is not set +CONFIG_CAIF=m +# CONFIG_CAIF_DEBUG is not set +CONFIG_CAIF_NETDEV=m +CONFIG_CAIF_USB=m CONFIG_CEPH_LIB=m # CONFIG_CEPH_LIB_PRETTYDEBUG is not set # CONFIG_CEPH_LIB_USE_DNS_RESOLVER is not set CONFIG_NFC=m CONFIG_NFC_DIGITAL=m CONFIG_NFC_NCI=m -# CONFIG_NFC_NCI_UART is not set +# CONFIG_NFC_NCI_SPI is not set +CONFIG_NFC_NCI_UART=m CONFIG_NFC_HCI=m CONFIG_NFC_SHDLC=y # # Near Field Communication (NFC) devices # +CONFIG_NFC_TRF7970A=m CONFIG_NFC_MEI_PHY=m -# CONFIG_NFC_SIM is not set +CONFIG_NFC_SIM=m CONFIG_NFC_PORT100=m CONFIG_NFC_FDP=m CONFIG_NFC_FDP_I2C=m CONFIG_NFC_PN544=m CONFIG_NFC_PN544_I2C=m CONFIG_NFC_PN544_MEI=m -# CONFIG_NFC_PN533_USB is not set -# CONFIG_NFC_PN533_I2C is not set +CONFIG_NFC_PN533=m +CONFIG_NFC_PN533_USB=m +CONFIG_NFC_PN533_I2C=m +# CONFIG_NFC_PN532_UART is not set CONFIG_NFC_MICROREAD=m CONFIG_NFC_MICROREAD_I2C=m CONFIG_NFC_MICROREAD_MEI=m CONFIG_NFC_MRVL=m CONFIG_NFC_MRVL_USB=m +CONFIG_NFC_MRVL_UART=m CONFIG_NFC_MRVL_I2C=m CONFIG_NFC_ST21NFCA=m CONFIG_NFC_ST21NFCA_I2C=m -# CONFIG_NFC_ST_NCI_I2C is not set +CONFIG_NFC_ST_NCI=m +CONFIG_NFC_ST_NCI_I2C=m +CONFIG_NFC_ST_NCI_SPI=m # CONFIG_NFC_NXP_NCI is not set CONFIG_NFC_S3FWRN5=m CONFIG_NFC_S3FWRN5_I2C=m +CONFIG_NFC_ST95HF=m # end of Near Field Communication (NFC) devices -# CONFIG_PSAMPLE is not set -# CONFIG_NET_IFE is not set +CONFIG_PSAMPLE=m +CONFIG_NET_IFE=m CONFIG_LWTUNNEL=y CONFIG_LWTUNNEL_BPF=y CONFIG_DST_CACHE=y CONFIG_GRO_CELLS=y +CONFIG_NET_SOCK_MSG=y CONFIG_NET_DEVLINK=y CONFIG_PAGE_POOL=y CONFIG_FAILOVER=m +CONFIG_ETHTOOL_NETLINK=y CONFIG_HAVE_EBPF_JIT=y # @@ -1814,7 +1993,7 @@ CONFIG_PCI_DOMAINS=y CONFIG_PCIEPORTBUS=y CONFIG_HOTPLUG_PCI_PCIE=y CONFIG_PCIEAER=y -CONFIG_PCIEAER_INJECT=m +# CONFIG_PCIEAER_INJECT is not set CONFIG_PCIE_ECRC=y CONFIG_PCIEASPM=y CONFIG_PCIEASPM_DEFAULT=y @@ -1822,15 +2001,16 @@ CONFIG_PCIEASPM_DEFAULT=y # CONFIG_PCIEASPM_POWER_SUPERSAVE is not set # CONFIG_PCIEASPM_PERFORMANCE is not set CONFIG_PCIE_PME=y -# CONFIG_PCIE_DPC is not set +CONFIG_PCIE_DPC=y # CONFIG_PCIE_PTM is not set # CONFIG_PCIE_BW is not set CONFIG_PCI_MSI=y CONFIG_PCI_MSI_IRQ_DOMAIN=y CONFIG_PCI_QUIRKS=y +# CONFIG_PCI_DEBUG is not set # CONFIG_PCI_REALLOC_ENABLE_AUTO is not set -CONFIG_PCI_STUB=y -# CONFIG_PCI_PF_STUB is not set +CONFIG_PCI_STUB=m +CONFIG_PCI_PF_STUB=m CONFIG_XEN_PCIDEV_FRONTEND=m CONFIG_PCI_ATS=y CONFIG_PCI_LOCKLESS_CONFIG=y @@ -1839,23 +2019,28 @@ CONFIG_PCI_PRI=y CONFIG_PCI_PASID=y # CONFIG_PCI_P2PDMA is not set CONFIG_PCI_LABEL=y -# CONFIG_PCI_HYPERV is not set +CONFIG_PCI_HYPERV=m CONFIG_HOTPLUG_PCI=y CONFIG_HOTPLUG_PCI_ACPI=y CONFIG_HOTPLUG_PCI_ACPI_IBM=m -# CONFIG_HOTPLUG_PCI_CPCI is not set +CONFIG_HOTPLUG_PCI_CPCI=y +CONFIG_HOTPLUG_PCI_CPCI_ZT5550=m +CONFIG_HOTPLUG_PCI_CPCI_GENERIC=m # CONFIG_HOTPLUG_PCI_SHPC is not set # # PCI controller drivers # -# CONFIG_VMD is not set -# CONFIG_PCI_HYPERV_INTERFACE is not set +CONFIG_VMD=m +CONFIG_PCI_HYPERV_INTERFACE=m # # DesignWare PCI Core Support # -# CONFIG_PCIE_DW_PLAT_HOST is not set +CONFIG_PCIE_DW=y +CONFIG_PCIE_DW_HOST=y +CONFIG_PCIE_DW_PLAT=y +CONFIG_PCIE_DW_PLAT_HOST=y # CONFIG_PCI_MESON is not set # end of DesignWare PCI Core Support @@ -1877,8 +2062,8 @@ CONFIG_HOTPLUG_PCI_ACPI_IBM=m # CONFIG_PCI_SW_SWITCHTEC is not set # end of PCI switch controller drivers -CONFIG_PCCARD=y -CONFIG_PCMCIA=y +CONFIG_PCCARD=m +CONFIG_PCMCIA=m CONFIG_PCMCIA_LOAD_CIS=y CONFIG_CARDBUS=y @@ -1894,7 +2079,25 @@ CONFIG_YENTA_TOSHIBA=y CONFIG_PD6729=m CONFIG_I82092=m CONFIG_PCCARD_NONSTATIC=y -# CONFIG_RAPIDIO is not set +CONFIG_RAPIDIO=y +CONFIG_RAPIDIO_TSI721=y +CONFIG_RAPIDIO_DISC_TIMEOUT=30 +# CONFIG_RAPIDIO_ENABLE_RX_TX_PORTS is not set +CONFIG_RAPIDIO_DMA_ENGINE=y +# CONFIG_RAPIDIO_DEBUG is not set +CONFIG_RAPIDIO_ENUM_BASIC=m +CONFIG_RAPIDIO_CHMAN=m +CONFIG_RAPIDIO_MPORT_CDEV=m + +# +# RapidIO Switch drivers +# +CONFIG_RAPIDIO_TSI57X=y +CONFIG_RAPIDIO_CPS_XX=y +CONFIG_RAPIDIO_TSI568=y +CONFIG_RAPIDIO_CPS_GEN2=y +CONFIG_RAPIDIO_RXS_GEN3=y +# end of RapidIO Switch drivers # # Generic Driver Options @@ -1902,8 +2105,8 @@ CONFIG_PCCARD_NONSTATIC=y CONFIG_UEVENT_HELPER=y CONFIG_UEVENT_HELPER_PATH="" CONFIG_DEVTMPFS=y -CONFIG_DEVTMPFS_MOUNT=y -CONFIG_STANDALONE=y +# CONFIG_DEVTMPFS_MOUNT is not set +# CONFIG_STANDALONE is not set CONFIG_PREVENT_FIRMWARE_BUILD=y # @@ -1913,22 +2116,29 @@ CONFIG_FW_LOADER=y CONFIG_FW_LOADER_PAGED_BUF=y CONFIG_EXTRA_FIRMWARE="" CONFIG_FW_LOADER_USER_HELPER=y -CONFIG_FW_LOADER_USER_HELPER_FALLBACK=y -# CONFIG_FW_LOADER_COMPRESS is not set +# CONFIG_FW_LOADER_USER_HELPER_FALLBACK is not set +CONFIG_FW_LOADER_COMPRESS=y CONFIG_FW_CACHE=y # end of Firmware loader CONFIG_WANT_DEV_COREDUMP=y CONFIG_ALLOW_DEV_COREDUMP=y CONFIG_DEV_COREDUMP=y +# CONFIG_DEBUG_DRIVER is not set +# CONFIG_DEBUG_DEVRES is not set +# CONFIG_DEBUG_TEST_DRIVER_REMOVE is not set # CONFIG_TEST_ASYNC_DRIVER_PROBE is not set CONFIG_SYS_HYPERVISOR=y CONFIG_GENERIC_CPU_AUTOPROBE=y CONFIG_GENERIC_CPU_VULNERABILITIES=y CONFIG_REGMAP=y -CONFIG_REGMAP_I2C=m +CONFIG_REGMAP_I2C=y +CONFIG_REGMAP_SPI=y +CONFIG_REGMAP_SPMI=m CONFIG_REGMAP_MMIO=y CONFIG_REGMAP_IRQ=y +CONFIG_REGMAP_SOUNDWIRE=m +CONFIG_REGMAP_SCCB=m CONFIG_DMA_SHARED_BUFFER=y # CONFIG_DMA_FENCE_TRACE is not set # end of Generic Driver Options @@ -1938,82 +2148,151 @@ CONFIG_DMA_SHARED_BUFFER=y # # end of Bus devices -CONFIG_CONNECTOR=y -CONFIG_PROC_EVENTS=y -# CONFIG_GNSS is not set +CONFIG_CONNECTOR=m +CONFIG_GNSS=m +CONFIG_GNSS_SERIAL=m +# CONFIG_GNSS_MTK_SERIAL is not set +CONFIG_GNSS_SIRF_SERIAL=m +CONFIG_GNSS_UBX_SERIAL=m CONFIG_MTD=m -# CONFIG_MTD_TESTS is not set +CONFIG_MTD_TESTS=m # # Partition parsers # -# CONFIG_MTD_AR7_PARTS is not set +CONFIG_MTD_AR7_PARTS=m # CONFIG_MTD_CMDLINE_PARTS is not set -# CONFIG_MTD_REDBOOT_PARTS is not set +CONFIG_MTD_REDBOOT_PARTS=m +CONFIG_MTD_REDBOOT_DIRECTORY_BLOCK=-1 +# CONFIG_MTD_REDBOOT_PARTS_UNALLOCATED is not set +# CONFIG_MTD_REDBOOT_PARTS_READONLY is not set # end of Partition parsers # # User Modules And Translation Layers # -# CONFIG_MTD_BLOCK is not set -# CONFIG_MTD_BLOCK_RO is not set -# CONFIG_FTL is not set -# CONFIG_NFTL is not set -# CONFIG_INFTL is not set -# CONFIG_RFD_FTL is not set -# CONFIG_SSFDC is not set -# CONFIG_SM_FTL is not set -# CONFIG_MTD_OOPS is not set -# CONFIG_MTD_SWAP is not set -CONFIG_MTD_PARTITIONED_MASTER=y +CONFIG_MTD_BLKDEVS=m +CONFIG_MTD_BLOCK=m +CONFIG_MTD_BLOCK_RO=m +CONFIG_FTL=m +CONFIG_NFTL=m +# CONFIG_NFTL_RW is not set +CONFIG_INFTL=m +CONFIG_RFD_FTL=m +CONFIG_SSFDC=m +CONFIG_SM_FTL=m +CONFIG_MTD_OOPS=m +CONFIG_MTD_SWAP=m +# CONFIG_MTD_PARTITIONED_MASTER is not set # # RAM/ROM/Flash chip drivers # -# CONFIG_MTD_CFI is not set -# CONFIG_MTD_JEDECPROBE is not set +CONFIG_MTD_CFI=m +CONFIG_MTD_JEDECPROBE=m +CONFIG_MTD_GEN_PROBE=m +# CONFIG_MTD_CFI_ADV_OPTIONS is not set CONFIG_MTD_MAP_BANK_WIDTH_1=y CONFIG_MTD_MAP_BANK_WIDTH_2=y CONFIG_MTD_MAP_BANK_WIDTH_4=y CONFIG_MTD_CFI_I1=y CONFIG_MTD_CFI_I2=y -# CONFIG_MTD_RAM is not set -# CONFIG_MTD_ROM is not set -# CONFIG_MTD_ABSENT is not set +CONFIG_MTD_CFI_INTELEXT=m +CONFIG_MTD_CFI_AMDSTD=m +CONFIG_MTD_CFI_STAA=m +CONFIG_MTD_CFI_UTIL=m +CONFIG_MTD_RAM=m +CONFIG_MTD_ROM=m +CONFIG_MTD_ABSENT=m # end of RAM/ROM/Flash chip drivers # # Mapping drivers for chip access # # CONFIG_MTD_COMPLEX_MAPPINGS is not set -# CONFIG_MTD_INTEL_VR_NOR is not set +# CONFIG_MTD_PHYSMAP is not set +CONFIG_MTD_AMD76XROM=m +CONFIG_MTD_ICHXROM=m +CONFIG_MTD_ESB2ROM=m +CONFIG_MTD_CK804XROM=m +CONFIG_MTD_SCB2_FLASH=m +CONFIG_MTD_NETtel=m +CONFIG_MTD_L440GX=m +CONFIG_MTD_INTEL_VR_NOR=m # CONFIG_MTD_PLATRAM is not set # end of Mapping drivers for chip access # # Self-contained MTD device drivers # -# CONFIG_MTD_PMC551 is not set -# CONFIG_MTD_SLRAM is not set -# CONFIG_MTD_PHRAM is not set -# CONFIG_MTD_MTDRAM is not set -# CONFIG_MTD_BLOCK2MTD is not set +CONFIG_MTD_PMC551=m +# CONFIG_MTD_PMC551_BUGFIX is not set +# CONFIG_MTD_PMC551_DEBUG is not set +CONFIG_MTD_DATAFLASH=m +# CONFIG_MTD_DATAFLASH_WRITE_VERIFY is not set +# CONFIG_MTD_DATAFLASH_OTP is not set +# CONFIG_MTD_MCHP23K256 is not set +CONFIG_MTD_SST25L=m +CONFIG_MTD_SLRAM=m +CONFIG_MTD_PHRAM=m +CONFIG_MTD_MTDRAM=m +CONFIG_MTDRAM_TOTAL_SIZE=4096 +CONFIG_MTDRAM_ERASE_SIZE=128 +CONFIG_MTD_BLOCK2MTD=m # # Disk-On-Chip Device Drivers # -# CONFIG_MTD_DOCG3 is not set +CONFIG_MTD_DOCG3=m +CONFIG_BCH_CONST_M=14 +CONFIG_BCH_CONST_T=4 # end of Self-contained MTD device drivers -# CONFIG_MTD_ONENAND is not set -# CONFIG_MTD_RAW_NAND is not set +CONFIG_MTD_NAND_CORE=m +CONFIG_MTD_ONENAND=m +# CONFIG_MTD_ONENAND_VERIFY_WRITE is not set +# CONFIG_MTD_ONENAND_GENERIC is not set +CONFIG_MTD_ONENAND_OTP=y +CONFIG_MTD_ONENAND_2X_PROGRAM=y +CONFIG_MTD_NAND_ECC_SW_HAMMING=m +# CONFIG_MTD_NAND_ECC_SW_HAMMING_SMC is not set +CONFIG_MTD_RAW_NAND=m +CONFIG_MTD_NAND_ECC_SW_BCH=y + +# +# Raw/parallel NAND flash controllers +# +CONFIG_MTD_NAND_DENALI=m +CONFIG_MTD_NAND_DENALI_PCI=m +CONFIG_MTD_NAND_CAFE=m +CONFIG_MTD_NAND_MXIC=m +CONFIG_MTD_NAND_GPIO=m +# CONFIG_MTD_NAND_PLATFORM is not set + +# +# Misc +# +CONFIG_MTD_SM_COMMON=m +CONFIG_MTD_NAND_NANDSIM=m +CONFIG_MTD_NAND_RICOH=m +CONFIG_MTD_NAND_DISKONCHIP=m +# CONFIG_MTD_NAND_DISKONCHIP_PROBE_ADVANCED is not set +CONFIG_MTD_NAND_DISKONCHIP_PROBE_ADDRESS=0 +# CONFIG_MTD_NAND_DISKONCHIP_BBTWRITE is not set +CONFIG_MTD_SPI_NAND=m # # LPDDR & LPDDR2 PCM memory drivers # -# CONFIG_MTD_LPDDR is not set +CONFIG_MTD_LPDDR=m +CONFIG_MTD_QINFO_PROBE=m # end of LPDDR & LPDDR2 PCM memory drivers +CONFIG_MTD_SPI_NOR=m +CONFIG_MTD_SPI_NOR_USE_4K_SECTORS=y +# CONFIG_SPI_MTK_QUADSPI is not set +# CONFIG_SPI_INTEL_SPI_PCI is not set +# CONFIG_SPI_INTEL_SPI_PLATFORM is not set CONFIG_MTD_UBI=m CONFIG_MTD_UBI_WL_THRESHOLD=4096 CONFIG_MTD_UBI_BEB_LIMIT=20 @@ -2026,14 +2305,14 @@ CONFIG_ARCH_MIGHT_HAVE_PC_PARPORT=y CONFIG_PARPORT=m CONFIG_PARPORT_PC=m CONFIG_PARPORT_SERIAL=m -# CONFIG_PARPORT_PC_FIFO is not set -# CONFIG_PARPORT_PC_SUPERIO is not set +CONFIG_PARPORT_PC_FIFO=y +CONFIG_PARPORT_PC_SUPERIO=y CONFIG_PARPORT_PC_PCMCIA=m # CONFIG_PARPORT_AX88796 is not set CONFIG_PARPORT_1284=y CONFIG_PARPORT_NOT_PC=y CONFIG_PNP=y -# CONFIG_PNP_DEBUG_MESSAGES is not set +CONFIG_PNP_DEBUG_MESSAGES=y # # Protocols @@ -2043,47 +2322,77 @@ CONFIG_BLK_DEV=y # CONFIG_BLK_DEV_NULL_BLK is not set CONFIG_BLK_DEV_FD=m CONFIG_CDROM=y -# CONFIG_PARIDE is not set +CONFIG_PARIDE=m + +# +# Parallel IDE high-level drivers +# +CONFIG_PARIDE_PD=m +CONFIG_PARIDE_PCD=m +CONFIG_PARIDE_PF=m +CONFIG_PARIDE_PT=m +CONFIG_PARIDE_PG=m + +# +# Parallel IDE protocol modules +# +CONFIG_PARIDE_ATEN=m +CONFIG_PARIDE_BPCK=m +CONFIG_PARIDE_COMM=m +CONFIG_PARIDE_DSTR=m +CONFIG_PARIDE_FIT2=m +CONFIG_PARIDE_FIT3=m +CONFIG_PARIDE_EPAT=m +CONFIG_PARIDE_EPATC8=y +CONFIG_PARIDE_EPIA=m +CONFIG_PARIDE_FRIQ=m +CONFIG_PARIDE_FRPW=m +CONFIG_PARIDE_KBIC=m +CONFIG_PARIDE_KTTI=m +CONFIG_PARIDE_ON20=m +CONFIG_PARIDE_ON26=m CONFIG_BLK_DEV_PCIESSD_MTIP32XX=m +CONFIG_ZRAM=m +# CONFIG_ZRAM_WRITEBACK is not set +# CONFIG_ZRAM_MEMORY_TRACKING is not set CONFIG_BLK_DEV_UMEM=m -CONFIG_BLK_DEV_LOOP=y +CONFIG_BLK_DEV_LOOP=m CONFIG_BLK_DEV_LOOP_MIN_COUNT=8 CONFIG_BLK_DEV_CRYPTOLOOP=m -CONFIG_BLK_DEV_DRBD=m -# CONFIG_DRBD_FAULT_INJECTION is not set +# CONFIG_BLK_DEV_DRBD is not set CONFIG_BLK_DEV_NBD=m CONFIG_BLK_DEV_SKD=m CONFIG_BLK_DEV_SX8=m -CONFIG_BLK_DEV_RAM=m +CONFIG_BLK_DEV_RAM=y CONFIG_BLK_DEV_RAM_COUNT=16 -CONFIG_BLK_DEV_RAM_SIZE=16384 -CONFIG_CDROM_PKTCDVD=m +CONFIG_BLK_DEV_RAM_SIZE=32000 +CONFIG_CDROM_PKTCDVD=y CONFIG_CDROM_PKTCDVD_BUFFERS=8 # CONFIG_CDROM_PKTCDVD_WCACHE is not set CONFIG_ATA_OVER_ETH=m CONFIG_XEN_BLKDEV_FRONTEND=m CONFIG_XEN_BLKDEV_BACKEND=m CONFIG_VIRTIO_BLK=m -# CONFIG_VIRTIO_BLK_SCSI is not set CONFIG_BLK_DEV_RBD=m CONFIG_BLK_DEV_RSXX=m # # NVME Support # -CONFIG_NVME_CORE=m -CONFIG_BLK_DEV_NVME=m +CONFIG_NVME_CORE=y +CONFIG_BLK_DEV_NVME=y # CONFIG_NVME_MULTIPATH is not set -# CONFIG_NVME_HWMON is not set +CONFIG_NVME_HWMON=y CONFIG_NVME_FABRICS=m CONFIG_NVME_RDMA=m -# CONFIG_NVME_FC is not set -# CONFIG_NVME_TCP is not set +CONFIG_NVME_FC=m +CONFIG_NVME_TCP=m CONFIG_NVME_TARGET=m CONFIG_NVME_TARGET_LOOP=m CONFIG_NVME_TARGET_RDMA=m -# CONFIG_NVME_TARGET_FC is not set -# CONFIG_NVME_TARGET_TCP is not set +CONFIG_NVME_TARGET_FC=m +# CONFIG_NVME_TARGET_FCLOOP is not set +CONFIG_NVME_TARGET_TCP=m # end of NVME Support # @@ -2092,37 +2401,42 @@ CONFIG_NVME_TARGET_RDMA=m CONFIG_SENSORS_LIS3LV02D=m # CONFIG_AD525X_DPOT is not set CONFIG_DUMMY_IRQ=m -# CONFIG_IBM_ASM is not set -# CONFIG_PHANTOM is not set +CONFIG_IBM_ASM=m +CONFIG_PHANTOM=m CONFIG_TIFM_CORE=m CONFIG_TIFM_7XX1=m -# CONFIG_ICS932S401 is not set +CONFIG_ICS932S401=m CONFIG_ENCLOSURE_SERVICES=m CONFIG_HP_ILO=m CONFIG_APDS9802ALS=m -CONFIG_ISL29003=m +# CONFIG_ISL29003 is not set CONFIG_ISL29020=m CONFIG_SENSORS_TSL2550=m CONFIG_SENSORS_BH1770=m CONFIG_SENSORS_APDS990X=m -# CONFIG_HMC6352 is not set -# CONFIG_DS1682 is not set +CONFIG_HMC6352=m +CONFIG_DS1682=m CONFIG_VMWARE_BALLOON=m -# CONFIG_SRAM is not set +CONFIG_LATTICE_ECP3_CONFIG=m +CONFIG_SRAM=y # CONFIG_PCI_ENDPOINT_TEST is not set # CONFIG_XILINX_SDFEC is not set +CONFIG_MISC_RTSX=m CONFIG_PVPANIC=m -# CONFIG_C2PORT is not set +CONFIG_C2PORT=m +CONFIG_C2PORT_DURAMAR_2150=m # # EEPROM support # -CONFIG_EEPROM_AT24=m +# CONFIG_EEPROM_AT24 is not set +CONFIG_EEPROM_AT25=m CONFIG_EEPROM_LEGACY=m CONFIG_EEPROM_MAX6875=m CONFIG_EEPROM_93CX6=m -# CONFIG_EEPROM_IDT_89HPESX is not set -# CONFIG_EEPROM_EE1004 is not set +CONFIG_EEPROM_93XX46=m +CONFIG_EEPROM_IDT_89HPESX=m +CONFIG_EEPROM_EE1004=m # end of EEPROM support CONFIG_CB710_CORE=m @@ -2136,36 +2450,96 @@ CONFIG_TI_ST=m # end of Texas Instruments shared transport line discipline CONFIG_SENSORS_LIS3_I2C=m - -# -# Altera FPGA firmware download module (requires I2C) -# CONFIG_ALTERA_STAPL=m -CONFIG_INTEL_MEI=y +CONFIG_INTEL_MEI=m CONFIG_INTEL_MEI_ME=m CONFIG_INTEL_MEI_TXE=m -# CONFIG_INTEL_MEI_HDCP is not set +CONFIG_INTEL_MEI_HDCP=m CONFIG_VMWARE_VMCI=m # # Intel MIC & related support # CONFIG_INTEL_MIC_BUS=m -# CONFIG_SCIF_BUS is not set +CONFIG_SCIF_BUS=m # CONFIG_VOP_BUS is not set +CONFIG_SCIF=m +CONFIG_MIC_COSM=m # end of Intel MIC & related support CONFIG_GENWQE=m CONFIG_GENWQE_PLATFORM_ERROR_RECOVERY=1 -# CONFIG_ECHO is not set -# CONFIG_MISC_ALCOR_PCI is not set -# CONFIG_MISC_RTSX_PCI is not set -# CONFIG_MISC_RTSX_USB is not set +CONFIG_ECHO=m +CONFIG_MISC_ALCOR_PCI=m +CONFIG_MISC_RTSX_PCI=m +CONFIG_MISC_RTSX_USB=m # CONFIG_HABANA_AI is not set # end of Misc devices CONFIG_HAVE_IDE=y -# CONFIG_IDE is not set +CONFIG_IDE=m + +# +# Please see Documentation/ide/ide.rst for help/info on IDE drives +# +CONFIG_IDE_XFER_MODE=y +CONFIG_IDE_TIMINGS=y +CONFIG_IDE_ATAPI=y +# CONFIG_BLK_DEV_IDE_SATA is not set +CONFIG_IDE_GD=m +CONFIG_IDE_GD_ATA=y +CONFIG_IDE_GD_ATAPI=y +CONFIG_BLK_DEV_IDECS=m +CONFIG_BLK_DEV_DELKIN=m +CONFIG_BLK_DEV_IDECD=m +CONFIG_BLK_DEV_IDECD_VERBOSE_ERRORS=y +CONFIG_BLK_DEV_IDETAPE=m +CONFIG_BLK_DEV_IDEACPI=y +CONFIG_IDE_TASK_IOCTL=y +CONFIG_IDE_PROC_FS=y + +# +# IDE chipset support/bugfixes +# +CONFIG_IDE_GENERIC=m +# CONFIG_BLK_DEV_PLATFORM is not set +CONFIG_BLK_DEV_CMD640=m +# CONFIG_BLK_DEV_CMD640_ENHANCED is not set +# CONFIG_BLK_DEV_IDEPNP is not set +CONFIG_BLK_DEV_IDEDMA_SFF=y + +# +# PCI IDE chipsets support +# +CONFIG_BLK_DEV_IDEPCI=y +# CONFIG_BLK_DEV_OFFBOARD is not set +CONFIG_BLK_DEV_GENERIC=m +CONFIG_BLK_DEV_OPTI621=m +CONFIG_BLK_DEV_RZ1000=m +CONFIG_BLK_DEV_IDEDMA_PCI=y +CONFIG_BLK_DEV_AEC62XX=m +CONFIG_BLK_DEV_ALI15X3=m +CONFIG_BLK_DEV_AMD74XX=m +CONFIG_BLK_DEV_ATIIXP=m +CONFIG_BLK_DEV_CMD64X=m +CONFIG_BLK_DEV_TRIFLEX=m +CONFIG_BLK_DEV_HPT366=m +CONFIG_BLK_DEV_JMICRON=m +CONFIG_BLK_DEV_PIIX=m +CONFIG_BLK_DEV_IT8172=m +CONFIG_BLK_DEV_IT8213=m +CONFIG_BLK_DEV_IT821X=m +CONFIG_BLK_DEV_NS87415=m +CONFIG_BLK_DEV_PDC202XX_OLD=m +CONFIG_BLK_DEV_PDC202XX_NEW=m +CONFIG_BLK_DEV_SVWKS=m +CONFIG_BLK_DEV_SIIMAGE=m +CONFIG_BLK_DEV_SIS5513=m +CONFIG_BLK_DEV_SLC90E66=m +CONFIG_BLK_DEV_TRM290=m +CONFIG_BLK_DEV_VIA82CXXX=m +CONFIG_BLK_DEV_TC86C001=m +CONFIG_BLK_DEV_IDEDMA=y # # SCSI device support @@ -2182,14 +2556,14 @@ CONFIG_SCSI_PROC_FS=y # CONFIG_BLK_DEV_SD=y CONFIG_CHR_DEV_ST=m -CONFIG_BLK_DEV_SR=y +CONFIG_BLK_DEV_SR=m CONFIG_BLK_DEV_SR_VENDOR=y -CONFIG_CHR_DEV_SG=y +CONFIG_CHR_DEV_SG=m CONFIG_CHR_DEV_SCH=m CONFIG_SCSI_ENCLOSURE=m CONFIG_SCSI_CONSTANTS=y CONFIG_SCSI_LOGGING=y -CONFIG_SCSI_SCAN_ASYNC=y +# CONFIG_SCSI_SCAN_ASYNC is not set # # SCSI Transports @@ -2219,27 +2593,27 @@ CONFIG_SCSI_3W_SAS=m CONFIG_SCSI_ACARD=m CONFIG_SCSI_AACRAID=m CONFIG_SCSI_AIC7XXX=m -CONFIG_AIC7XXX_CMDS_PER_DEVICE=4 +CONFIG_AIC7XXX_CMDS_PER_DEVICE=253 CONFIG_AIC7XXX_RESET_DELAY_MS=15000 # CONFIG_AIC7XXX_DEBUG_ENABLE is not set CONFIG_AIC7XXX_DEBUG_MASK=0 -# CONFIG_AIC7XXX_REG_PRETTY_PRINT is not set +CONFIG_AIC7XXX_REG_PRETTY_PRINT=y CONFIG_SCSI_AIC79XX=m -CONFIG_AIC79XX_CMDS_PER_DEVICE=4 +CONFIG_AIC79XX_CMDS_PER_DEVICE=32 CONFIG_AIC79XX_RESET_DELAY_MS=15000 # CONFIG_AIC79XX_DEBUG_ENABLE is not set CONFIG_AIC79XX_DEBUG_MASK=0 -# CONFIG_AIC79XX_REG_PRETTY_PRINT is not set +CONFIG_AIC79XX_REG_PRETTY_PRINT=y CONFIG_SCSI_AIC94XX=m -# CONFIG_AIC94XX_DEBUG is not set +CONFIG_AIC94XX_DEBUG=y CONFIG_SCSI_MVSAS=m -# CONFIG_SCSI_MVSAS_DEBUG is not set -CONFIG_SCSI_MVSAS_TASKLET=y +CONFIG_SCSI_MVSAS_DEBUG=y +# CONFIG_SCSI_MVSAS_TASKLET is not set CONFIG_SCSI_MVUMI=m -# CONFIG_SCSI_DPT_I2O is not set +CONFIG_SCSI_DPT_I2O=m CONFIG_SCSI_ADVANSYS=m CONFIG_SCSI_ARCMSR=m -# CONFIG_SCSI_ESAS2R is not set +CONFIG_SCSI_ESAS2R=m CONFIG_MEGARAID_NEWGEN=y CONFIG_MEGARAID_MM=m CONFIG_MEGARAID_MAILBOX=m @@ -2249,62 +2623,70 @@ CONFIG_SCSI_MPT3SAS=m CONFIG_SCSI_MPT2SAS_MAX_SGE=128 CONFIG_SCSI_MPT3SAS_MAX_SGE=128 CONFIG_SCSI_MPT2SAS=m -# CONFIG_SCSI_SMARTPQI is not set +CONFIG_SCSI_SMARTPQI=m CONFIG_SCSI_UFSHCD=m CONFIG_SCSI_UFSHCD_PCI=m -CONFIG_SCSI_UFS_DWC_TC_PCI=m -CONFIG_SCSI_UFSHCD_PLATFORM=m -# CONFIG_SCSI_UFS_CDNS_PLATFORM is not set -CONFIG_SCSI_UFS_DWC_TC_PLATFORM=m -# CONFIG_SCSI_UFS_BSG is not set +# CONFIG_SCSI_UFS_DWC_TC_PCI is not set +# CONFIG_SCSI_UFSHCD_PLATFORM is not set +CONFIG_SCSI_UFS_BSG=y CONFIG_SCSI_HPTIOP=m CONFIG_SCSI_BUSLOGIC=m -# CONFIG_SCSI_FLASHPOINT is not set -# CONFIG_SCSI_MYRB is not set -# CONFIG_SCSI_MYRS is not set +CONFIG_SCSI_FLASHPOINT=y +CONFIG_SCSI_MYRB=m +CONFIG_SCSI_MYRS=m CONFIG_VMWARE_PVSCSI=m -# CONFIG_XEN_SCSI_FRONTEND is not set +CONFIG_XEN_SCSI_FRONTEND=m CONFIG_HYPERV_STORAGE=m CONFIG_LIBFC=m CONFIG_LIBFCOE=m CONFIG_FCOE=m CONFIG_FCOE_FNIC=m -# CONFIG_SCSI_SNIC is not set -# CONFIG_SCSI_DMX3191D is not set -# CONFIG_SCSI_FDOMAIN_PCI is not set +CONFIG_SCSI_SNIC=m +# CONFIG_SCSI_SNIC_DEBUG_FS is not set +CONFIG_SCSI_DMX3191D=m +CONFIG_SCSI_FDOMAIN=m +CONFIG_SCSI_FDOMAIN_PCI=m CONFIG_SCSI_GDTH=m CONFIG_SCSI_ISCI=m CONFIG_SCSI_IPS=m CONFIG_SCSI_INITIO=m CONFIG_SCSI_INIA100=m -# CONFIG_SCSI_PPA is not set -# CONFIG_SCSI_IMM is not set +CONFIG_SCSI_PPA=m +CONFIG_SCSI_IMM=m +# CONFIG_SCSI_IZIP_EPP16 is not set +# CONFIG_SCSI_IZIP_SLOW_CTR is not set CONFIG_SCSI_STEX=m CONFIG_SCSI_SYM53C8XX_2=m -CONFIG_SCSI_SYM53C8XX_DMA_ADDRESSING_MODE=1 +CONFIG_SCSI_SYM53C8XX_DMA_ADDRESSING_MODE=0 CONFIG_SCSI_SYM53C8XX_DEFAULT_TAGS=16 CONFIG_SCSI_SYM53C8XX_MAX_TAGS=64 CONFIG_SCSI_SYM53C8XX_MMIO=y -# CONFIG_SCSI_IPR is not set +CONFIG_SCSI_IPR=m +# CONFIG_SCSI_IPR_TRACE is not set +# CONFIG_SCSI_IPR_DUMP is not set CONFIG_SCSI_QLOGIC_1280=m CONFIG_SCSI_QLA_FC=m CONFIG_TCM_QLA2XXX=m # CONFIG_TCM_QLA2XXX_DEBUG is not set CONFIG_SCSI_QLA_ISCSI=m -# CONFIG_QEDI is not set -# CONFIG_QEDF is not set +CONFIG_QEDI=m +CONFIG_QEDF=m CONFIG_SCSI_LPFC=m # CONFIG_SCSI_LPFC_DEBUG_FS is not set CONFIG_SCSI_DC395x=m -# CONFIG_SCSI_AM53C974 is not set -# CONFIG_SCSI_WD719X is not set +CONFIG_SCSI_AM53C974=m +CONFIG_SCSI_WD719X=m CONFIG_SCSI_DEBUG=m CONFIG_SCSI_PMCRAID=m CONFIG_SCSI_PM8001=m CONFIG_SCSI_BFA_FC=m CONFIG_SCSI_VIRTIO=m CONFIG_SCSI_CHELSIO_FCOE=m -# CONFIG_SCSI_LOWLEVEL_PCMCIA is not set +CONFIG_SCSI_LOWLEVEL_PCMCIA=y +CONFIG_PCMCIA_AHA152X=m +CONFIG_PCMCIA_FDOMAIN=m +CONFIG_PCMCIA_QLOGIC=m +CONFIG_PCMCIA_SYM53C500=m CONFIG_SCSI_DH=y CONFIG_SCSI_DH_RDAC=m CONFIG_SCSI_DH_HP_SW=m @@ -2323,8 +2705,8 @@ CONFIG_SATA_PMP=y # CONFIG_SATA_AHCI=y CONFIG_SATA_MOBILE_LPM_POLICY=0 -CONFIG_SATA_AHCI_PLATFORM=m -CONFIG_SATA_INIC162X=m +CONFIG_SATA_AHCI_PLATFORM=y +# CONFIG_SATA_INIC162X is not set CONFIG_SATA_ACARD_AHCI=m CONFIG_SATA_SIL24=m CONFIG_ATA_SFF=y @@ -2340,7 +2722,7 @@ CONFIG_ATA_BMDMA=y # # SATA SFF controllers with BMDMA # -CONFIG_ATA_PIIX=y +CONFIG_ATA_PIIX=m # CONFIG_SATA_DWC is not set CONFIG_SATA_MV=m CONFIG_SATA_NV=m @@ -2367,7 +2749,7 @@ CONFIG_PATA_HPT366=m CONFIG_PATA_HPT37X=m CONFIG_PATA_HPT3X2N=m CONFIG_PATA_HPT3X3=m -# CONFIG_PATA_HPT3X3_DMA is not set +CONFIG_PATA_HPT3X3_DMA=y CONFIG_PATA_IT8213=m CONFIG_PATA_IT821X=m CONFIG_PATA_JMICRON=m @@ -2379,7 +2761,7 @@ CONFIG_PATA_OLDPIIX=m CONFIG_PATA_OPTIDMA=m CONFIG_PATA_PDC2027X=m CONFIG_PATA_PDC_OLD=m -# CONFIG_PATA_RADISYS is not set +CONFIG_PATA_RADISYS=m CONFIG_PATA_RDC=m CONFIG_PATA_SCH=m CONFIG_PATA_SERVERWORKS=m @@ -2398,17 +2780,18 @@ CONFIG_PATA_MPIIX=m CONFIG_PATA_NS87410=m CONFIG_PATA_OPTI=m CONFIG_PATA_PCMCIA=m -# CONFIG_PATA_RZ1000 is not set +# CONFIG_PATA_PLATFORM is not set +CONFIG_PATA_RZ1000=m # # Generic fallback / legacy drivers # CONFIG_PATA_ACPI=m CONFIG_ATA_GENERIC=m -# CONFIG_PATA_LEGACY is not set +CONFIG_PATA_LEGACY=m CONFIG_MD=y CONFIG_BLK_DEV_MD=y -CONFIG_MD_AUTODETECT=y +# CONFIG_MD_AUTODETECT is not set CONFIG_MD_LINEAR=m CONFIG_MD_RAID0=m CONFIG_MD_RAID1=m @@ -2421,39 +2804,38 @@ CONFIG_BCACHE=m # CONFIG_BCACHE_DEBUG is not set # CONFIG_BCACHE_CLOSURES_DEBUG is not set CONFIG_BLK_DEV_DM_BUILTIN=y -CONFIG_BLK_DEV_DM=y -CONFIG_DM_DEBUG=y -CONFIG_DM_BUFIO=y +CONFIG_BLK_DEV_DM=m +# CONFIG_DM_DEBUG is not set +CONFIG_DM_BUFIO=m # CONFIG_DM_DEBUG_BLOCK_MANAGER_LOCKING is not set CONFIG_DM_BIO_PRISON=m CONFIG_DM_PERSISTENT_DATA=m -# CONFIG_DM_UNSTRIPED is not set +CONFIG_DM_UNSTRIPED=m CONFIG_DM_CRYPT=m -CONFIG_DM_SNAPSHOT=y +CONFIG_DM_SNAPSHOT=m CONFIG_DM_THIN_PROVISIONING=m CONFIG_DM_CACHE=m CONFIG_DM_CACHE_SMQ=m -# CONFIG_DM_WRITECACHE is not set +CONFIG_DM_WRITECACHE=m CONFIG_DM_ERA=m -# CONFIG_DM_CLONE is not set -CONFIG_DM_MIRROR=y +CONFIG_DM_CLONE=m +CONFIG_DM_MIRROR=m CONFIG_DM_LOG_USERSPACE=m CONFIG_DM_RAID=m -CONFIG_DM_ZERO=y +CONFIG_DM_ZERO=m CONFIG_DM_MULTIPATH=m CONFIG_DM_MULTIPATH_QL=m CONFIG_DM_MULTIPATH_ST=m # CONFIG_DM_DELAY is not set # CONFIG_DM_DUST is not set -# CONFIG_DM_INIT is not set CONFIG_DM_UEVENT=y CONFIG_DM_FLAKEY=m CONFIG_DM_VERITY=m # CONFIG_DM_VERITY_VERIFY_ROOTHASH_SIG is not set # CONFIG_DM_VERITY_FEC is not set -# CONFIG_DM_SWITCH is not set +CONFIG_DM_SWITCH=m CONFIG_DM_LOG_WRITES=m -# CONFIG_DM_INTEGRITY is not set +CONFIG_DM_INTEGRITY=m CONFIG_TARGET_CORE=m CONFIG_TCM_IBLOCK=m CONFIG_TCM_FILEIO=m @@ -2462,13 +2844,13 @@ CONFIG_TCM_USER2=m CONFIG_LOOPBACK_TARGET=m CONFIG_TCM_FC=m CONFIG_ISCSI_TARGET=m -# CONFIG_ISCSI_TARGET_CXGB4 is not set +CONFIG_ISCSI_TARGET_CXGB4=m CONFIG_SBP_TARGET=m CONFIG_FUSION=y CONFIG_FUSION_SPI=m CONFIG_FUSION_FC=m CONFIG_FUSION_SAS=m -CONFIG_FUSION_MAX_SGE=40 +CONFIG_FUSION_MAX_SGE=128 CONFIG_FUSION_CTL=m CONFIG_FUSION_LAN=m CONFIG_FUSION_LOGGING=y @@ -2490,6 +2872,8 @@ CONFIG_MII=m CONFIG_NET_CORE=y CONFIG_BONDING=m CONFIG_DUMMY=m +CONFIG_WIREGUARD=m +# CONFIG_WIREGUARD_DEBUG is not set CONFIG_EQUALIZER=m CONFIG_NET_FC=y CONFIG_IFB=m @@ -2502,70 +2886,95 @@ CONFIG_NET_TEAM_MODE_LOADBALANCE=m CONFIG_MACVLAN=m CONFIG_MACVTAP=m CONFIG_IPVLAN_L3S=y -CONFIG_IPVLAN=y -# CONFIG_IPVTAP is not set +CONFIG_IPVLAN=m +CONFIG_IPVTAP=m CONFIG_VXLAN=m CONFIG_GENEVE=m -# CONFIG_GTP is not set -# CONFIG_MACSEC is not set +CONFIG_GTP=m +CONFIG_MACSEC=m CONFIG_NETCONSOLE=m CONFIG_NETCONSOLE_DYNAMIC=y CONFIG_NETPOLL=y CONFIG_NET_POLL_CONTROLLER=y +CONFIG_NTB_NETDEV=m +CONFIG_RIONET=m +CONFIG_RIONET_TX_SIZE=128 +CONFIG_RIONET_RX_SIZE=128 CONFIG_TUN=m CONFIG_TAP=m # CONFIG_TUN_VNET_CROSS_LE is not set CONFIG_VETH=m CONFIG_VIRTIO_NET=m -# CONFIG_NLMON is not set -# CONFIG_NET_VRF is not set -# CONFIG_VSOCKMON is not set +CONFIG_NLMON=m +CONFIG_NET_VRF=m +CONFIG_VSOCKMON=m CONFIG_SUNGEM_PHY=m -# CONFIG_ARCNET is not set +CONFIG_ARCNET=m +CONFIG_ARCNET_1201=m +CONFIG_ARCNET_1051=m +CONFIG_ARCNET_RAW=m +CONFIG_ARCNET_CAP=m +CONFIG_ARCNET_COM90xx=m +CONFIG_ARCNET_COM90xxIO=m +CONFIG_ARCNET_RIM_I=m +CONFIG_ARCNET_COM20020=m +CONFIG_ARCNET_COM20020_PCI=m +CONFIG_ARCNET_COM20020_CS=m CONFIG_ATM_DRIVERS=y # CONFIG_ATM_DUMMY is not set CONFIG_ATM_TCP=m -# CONFIG_ATM_LANAI is not set +CONFIG_ATM_LANAI=m CONFIG_ATM_ENI=m # CONFIG_ATM_ENI_DEBUG is not set # CONFIG_ATM_ENI_TUNE_BURST is not set CONFIG_ATM_FIRESTREAM=m -# CONFIG_ATM_ZATM is not set -CONFIG_ATM_NICSTAR=m -# CONFIG_ATM_NICSTAR_USE_SUNI is not set -# CONFIG_ATM_NICSTAR_USE_IDT77105 is not set -# CONFIG_ATM_IDT77252 is not set -# CONFIG_ATM_AMBASSADOR is not set -# CONFIG_ATM_HORIZON is not set -# CONFIG_ATM_IA is not set -# CONFIG_ATM_FORE200E is not set +CONFIG_ATM_ZATM=m +# CONFIG_ATM_ZATM_DEBUG is not set +# CONFIG_ATM_NICSTAR is not set +CONFIG_ATM_IDT77252=m +# CONFIG_ATM_IDT77252_DEBUG is not set +# CONFIG_ATM_IDT77252_RCV_ALL is not set +CONFIG_ATM_IDT77252_USE_SUNI=y +CONFIG_ATM_AMBASSADOR=m +# CONFIG_ATM_AMBASSADOR_DEBUG is not set +CONFIG_ATM_HORIZON=m +# CONFIG_ATM_HORIZON_DEBUG is not set +CONFIG_ATM_IA=m +# CONFIG_ATM_IA_DEBUG is not set +CONFIG_ATM_FORE200E=m +CONFIG_ATM_FORE200E_USE_TASKLET=y +CONFIG_ATM_FORE200E_TX_RETRY=16 +CONFIG_ATM_FORE200E_DEBUG=0 CONFIG_ATM_HE=m -# CONFIG_ATM_HE_USE_SUNI is not set +CONFIG_ATM_HE_USE_SUNI=y CONFIG_ATM_SOLOS=m +# CONFIG_CAIF_DRIVERS is not set # # Distributed Switch Architecture drivers # CONFIG_B53=m +CONFIG_B53_SPI_DRIVER=m CONFIG_B53_MDIO_DRIVER=m CONFIG_B53_MMAP_DRIVER=m CONFIG_B53_SRAB_DRIVER=m -# CONFIG_B53_SERDES is not set -# CONFIG_NET_DSA_BCM_SF2 is not set +CONFIG_B53_SERDES=m +CONFIG_NET_DSA_BCM_SF2=m # CONFIG_NET_DSA_LOOP is not set -# CONFIG_NET_DSA_LANTIQ_GSWIP is not set +CONFIG_NET_DSA_LANTIQ_GSWIP=m # CONFIG_NET_DSA_MT7530 is not set CONFIG_NET_DSA_MV88E6060=m # CONFIG_NET_DSA_MICROCHIP_KSZ9477 is not set # CONFIG_NET_DSA_MICROCHIP_KSZ8795 is not set -CONFIG_NET_DSA_MV88E6XXX=m -CONFIG_NET_DSA_MV88E6XXX_GLOBAL2=y -# CONFIG_NET_DSA_MV88E6XXX_PTP is not set -# CONFIG_NET_DSA_MSCC_FELIX is not set -CONFIG_NET_DSA_QCA8K=m -# CONFIG_NET_DSA_REALTEK_SMI is not set +# CONFIG_NET_DSA_MV88E6XXX is not set +# CONFIG_NET_DSA_AR9331 is not set +# CONFIG_NET_DSA_SJA1105 is not set +# CONFIG_NET_DSA_QCA8K is not set +CONFIG_NET_DSA_REALTEK_SMI=m # CONFIG_NET_DSA_SMSC_LAN9303_I2C is not set # CONFIG_NET_DSA_SMSC_LAN9303_MDIO is not set +# CONFIG_NET_DSA_VITESSE_VSC73XX_SPI is not set +# CONFIG_NET_DSA_VITESSE_VSC73XX_PLATFORM is not set # end of Distributed Switch Architecture drivers CONFIG_ETHERNET=y @@ -2578,9 +2987,9 @@ CONFIG_TYPHOON=m CONFIG_NET_VENDOR_ADAPTEC=y CONFIG_ADAPTEC_STARFIRE=m CONFIG_NET_VENDOR_AGERE=y -# CONFIG_ET131X is not set +CONFIG_ET131X=m CONFIG_NET_VENDOR_ALACRITECH=y -# CONFIG_SLICOSS is not set +CONFIG_SLICOSS=m CONFIG_NET_VENDOR_ALTEON=y CONFIG_ACENIC=m # CONFIG_ACENIC_OMIT_TIGON_I is not set @@ -2591,9 +3000,11 @@ CONFIG_NET_VENDOR_AMD=y CONFIG_AMD8111_ETH=m CONFIG_PCNET32=m CONFIG_PCMCIA_NMCLAN=m -# CONFIG_AMD_XGBE is not set +CONFIG_AMD_XGBE=m +CONFIG_AMD_XGBE_DCB=y +CONFIG_AMD_XGBE_HAVE_ECC=y CONFIG_NET_VENDOR_AQUANTIA=y -# CONFIG_AQTION is not set +CONFIG_AQTION=m CONFIG_NET_VENDOR_ARC=y CONFIG_NET_VENDOR_ATHEROS=y CONFIG_ATL2=m @@ -2601,39 +3012,40 @@ CONFIG_ATL1=m CONFIG_ATL1E=m CONFIG_ATL1C=m CONFIG_ALX=m -# CONFIG_NET_VENDOR_AURORA is not set +CONFIG_NET_VENDOR_AURORA=y +CONFIG_AURORA_NB8800=m CONFIG_NET_VENDOR_BROADCOM=y CONFIG_B44=m CONFIG_B44_PCI_AUTOSELECT=y CONFIG_B44_PCICORE_AUTOSELECT=y CONFIG_B44_PCI=y -# CONFIG_BCMGENET is not set +CONFIG_BCMGENET=m CONFIG_BNX2=m CONFIG_CNIC=m CONFIG_TIGON3=m CONFIG_TIGON3_HWMON=y CONFIG_BNX2X=m CONFIG_BNX2X_SRIOV=y -# CONFIG_SYSTEMPORT is not set +CONFIG_SYSTEMPORT=m CONFIG_BNXT=m CONFIG_BNXT_SRIOV=y CONFIG_BNXT_FLOWER_OFFLOAD=y -# CONFIG_BNXT_DCB is not set +CONFIG_BNXT_DCB=y CONFIG_BNXT_HWMON=y CONFIG_NET_VENDOR_BROCADE=y CONFIG_BNA=m CONFIG_NET_VENDOR_CADENCE=y CONFIG_MACB=m CONFIG_MACB_USE_HWSTAMP=y -# CONFIG_MACB_PCI is not set +CONFIG_MACB_PCI=m CONFIG_NET_VENDOR_CAVIUM=y -# CONFIG_THUNDER_NIC_PF is not set -# CONFIG_THUNDER_NIC_VF is not set -# CONFIG_THUNDER_NIC_BGX is not set +CONFIG_THUNDER_NIC_PF=m +CONFIG_THUNDER_NIC_VF=m +CONFIG_THUNDER_NIC_BGX=m CONFIG_THUNDER_NIC_RGX=m -CONFIG_CAVIUM_PTP=y -# CONFIG_LIQUIDIO is not set -# CONFIG_LIQUIDIO_VF is not set +CONFIG_CAVIUM_PTP=m +CONFIG_LIQUIDIO=m +CONFIG_LIQUIDIO_VF=m CONFIG_NET_VENDOR_CHELSIO=y CONFIG_CHELSIO_T1=m CONFIG_CHELSIO_T1_1G=y @@ -2647,14 +3059,14 @@ CONFIG_NET_VENDOR_CISCO=y CONFIG_ENIC=m CONFIG_NET_VENDOR_CORTINA=y CONFIG_CX_ECAT=m -CONFIG_DNET=m +# CONFIG_DNET is not set CONFIG_NET_VENDOR_DEC=y CONFIG_NET_TULIP=y CONFIG_DE2104X=m CONFIG_DE2104X_DSL=0 CONFIG_TULIP=m # CONFIG_TULIP_MWI is not set -CONFIG_TULIP_MMIO=y +# CONFIG_TULIP_MMIO is not set # CONFIG_TULIP_NAPI is not set CONFIG_DE4X5=m CONFIG_WINBOND_840=m @@ -2673,12 +3085,13 @@ CONFIG_BE2NET_BE3=y CONFIG_BE2NET_LANCER=y CONFIG_BE2NET_SKYHAWK=y CONFIG_NET_VENDOR_EZCHIP=y -# CONFIG_NET_VENDOR_FUJITSU is not set +CONFIG_NET_VENDOR_FUJITSU=y +CONFIG_PCMCIA_FMVJ18X=m CONFIG_NET_VENDOR_GOOGLE=y -# CONFIG_GVE is not set +CONFIG_GVE=m CONFIG_NET_VENDOR_HUAWEI=y -# CONFIG_HINIC is not set -# CONFIG_NET_VENDOR_I825XX is not set +CONFIG_HINIC=m +CONFIG_NET_VENDOR_I825XX=y CONFIG_NET_VENDOR_INTEL=y CONFIG_E100=m CONFIG_E1000=m @@ -2693,14 +3106,16 @@ CONFIG_IXGBE=m CONFIG_IXGBE_HWMON=y CONFIG_IXGBE_DCA=y CONFIG_IXGBE_DCB=y +CONFIG_IXGBE_IPSEC=y CONFIG_IXGBEVF=m +CONFIG_IXGBEVF_IPSEC=y CONFIG_I40E=m CONFIG_I40E_DCB=y CONFIG_IAVF=m CONFIG_I40EVF=m -# CONFIG_ICE is not set -# CONFIG_FM10K is not set -# CONFIG_IGC is not set +CONFIG_ICE=m +CONFIG_FM10K=m +CONFIG_IGC=m CONFIG_JME=m CONFIG_NET_VENDOR_MARVELL=y CONFIG_MVMDIO=m @@ -2713,9 +3128,21 @@ CONFIG_NET_VENDOR_MELLANOX=y CONFIG_MLX4_EN=m CONFIG_MLX4_EN_DCB=y CONFIG_MLX4_CORE=m -CONFIG_MLX4_DEBUG=y +# CONFIG_MLX4_DEBUG is not set CONFIG_MLX4_CORE_GEN2=y -# CONFIG_MLX5_CORE is not set +CONFIG_MLX5_CORE=m +CONFIG_MLX5_ACCEL=y +CONFIG_MLX5_FPGA=y +CONFIG_MLX5_CORE_EN=y +CONFIG_MLX5_EN_ARFS=y +CONFIG_MLX5_EN_RXNFC=y +CONFIG_MLX5_MPFS=y +CONFIG_MLX5_ESWITCH=y +CONFIG_MLX5_CORE_EN_DCB=y +# CONFIG_MLX5_CORE_IPOIB is not set +CONFIG_MLX5_FPGA_IPSEC=y +# CONFIG_MLX5_EN_IPSEC is not set +CONFIG_MLX5_SW_STEERING=y CONFIG_MLXSW_CORE=m CONFIG_MLXSW_CORE_HWMON=y CONFIG_MLXSW_CORE_THERMAL=y @@ -2728,13 +3155,17 @@ CONFIG_MLXSW_SPECTRUM_DCB=y CONFIG_MLXSW_MINIMAL=m CONFIG_MLXFW=m CONFIG_NET_VENDOR_MICREL=y -# CONFIG_KS8842 is not set +CONFIG_KS8842=m +CONFIG_KS8851=m # CONFIG_KS8851_MLL is not set CONFIG_KSZ884X_PCI=m CONFIG_NET_VENDOR_MICROCHIP=y -# CONFIG_LAN743X is not set +CONFIG_ENC28J60=m +# CONFIG_ENC28J60_WRITEVERIFY is not set +CONFIG_ENCX24J600=m +CONFIG_LAN743X=m CONFIG_NET_VENDOR_MICROSEMI=y -# CONFIG_MSCC_OCELOT_SWITCH is not set +CONFIG_MSCC_OCELOT_SWITCH=m CONFIG_NET_VENDOR_MYRI=y CONFIG_MYRI10GE=m CONFIG_MYRI10GE_DCA=y @@ -2747,9 +3178,12 @@ CONFIG_S2IO=m CONFIG_VXGE=m # CONFIG_VXGE_DEBUG_TRACE_ALL is not set CONFIG_NET_VENDOR_NETRONOME=y -# CONFIG_NFP is not set +CONFIG_NFP=m +# CONFIG_NFP_APP_FLOWER is not set +CONFIG_NFP_APP_ABM_NIC=y +# CONFIG_NFP_DEBUG is not set CONFIG_NET_VENDOR_NI=y -# CONFIG_NI_XGE_MANAGEMENT_ENET is not set +CONFIG_NI_XGE_MANAGEMENT_ENET=m CONFIG_NET_VENDOR_8390=y CONFIG_PCMCIA_AXNET=m CONFIG_NE2K_PCI=m @@ -2762,7 +3196,7 @@ CONFIG_NET_VENDOR_PACKET_ENGINES=y CONFIG_HAMACHI=m CONFIG_YELLOWFIN=m CONFIG_NET_VENDOR_PENSANDO=y -# CONFIG_IONIC is not set +CONFIG_IONIC=m CONFIG_NET_VENDOR_QLOGIC=y CONFIG_QLA3XXX=m CONFIG_QLCNIC=m @@ -2775,10 +3209,12 @@ CONFIG_QED_LL2=y CONFIG_QED_SRIOV=y CONFIG_QEDE=m CONFIG_QED_RDMA=y +CONFIG_QED_ISCSI=y +CONFIG_QED_FCOE=y CONFIG_QED_OOO=y CONFIG_NET_VENDOR_QUALCOMM=y CONFIG_QCOM_EMAC=m -# CONFIG_RMNET is not set +CONFIG_RMNET=m CONFIG_NET_VENDOR_RDC=y CONFIG_R6040=m CONFIG_NET_VENDOR_REALTEK=y @@ -2792,17 +3228,18 @@ CONFIG_8139TOO_8129=y CONFIG_R8169=m CONFIG_NET_VENDOR_RENESAS=y CONFIG_NET_VENDOR_ROCKER=y -CONFIG_ROCKER=m +# CONFIG_ROCKER is not set CONFIG_NET_VENDOR_SAMSUNG=y CONFIG_SXGBE_ETH=m -# CONFIG_NET_VENDOR_SEEQ is not set +CONFIG_NET_VENDOR_SEEQ=y CONFIG_NET_VENDOR_SOLARFLARE=y CONFIG_SFC=m -# CONFIG_SFC_MTD is not set +CONFIG_SFC_MTD=y CONFIG_SFC_MCDI_MON=y CONFIG_SFC_SRIOV=y CONFIG_SFC_MCDI_LOGGING=y -# CONFIG_SFC_FALCON is not set +CONFIG_SFC_FALCON=m +CONFIG_SFC_FALCON_MTD=y CONFIG_NET_VENDOR_SILAN=y CONFIG_SC92031=m CONFIG_NET_VENDOR_SIS=y @@ -2817,7 +3254,8 @@ CONFIG_NET_VENDOR_SOCIONEXT=y CONFIG_NET_VENDOR_STMICRO=y CONFIG_STMMAC_ETH=m # CONFIG_STMMAC_SELFTESTS is not set -# CONFIG_STMMAC_PLATFORM is not set +CONFIG_STMMAC_PLATFORM=m +CONFIG_DWMAC_GENERIC=m # CONFIG_STMMAC_PCI is not set CONFIG_NET_VENDOR_SUN=y CONFIG_HAPPYMEAL=m @@ -2825,7 +3263,8 @@ CONFIG_SUNGEM=m CONFIG_CASSINI=m CONFIG_NIU=m CONFIG_NET_VENDOR_SYNOPSYS=y -# CONFIG_DWC_XLGMAC is not set +CONFIG_DWC_XLGMAC=m +CONFIG_DWC_XLGMAC_PCI=m CONFIG_NET_VENDOR_TEHUTI=y CONFIG_TEHUTI=m CONFIG_NET_VENDOR_TI=y @@ -2833,7 +3272,7 @@ CONFIG_NET_VENDOR_TI=y CONFIG_TLAN=m CONFIG_NET_VENDOR_VIA=y CONFIG_VIA_RHINE=m -CONFIG_VIA_RHINE_MMIO=y +# CONFIG_VIA_RHINE_MMIO is not set CONFIG_VIA_VELOCITY=m CONFIG_NET_VENDOR_WIZNET=y CONFIG_WIZNET_W5100=m @@ -2841,32 +3280,37 @@ CONFIG_WIZNET_W5300=m # CONFIG_WIZNET_BUS_DIRECT is not set # CONFIG_WIZNET_BUS_INDIRECT is not set CONFIG_WIZNET_BUS_ANY=y +CONFIG_WIZNET_W5100_SPI=m CONFIG_NET_VENDOR_XILINX=y -# CONFIG_XILINX_AXI_EMAC is not set +CONFIG_XILINX_AXI_EMAC=m # CONFIG_XILINX_LL_TEMAC is not set CONFIG_NET_VENDOR_XIRCOM=y CONFIG_PCMCIA_XIRC2PS=m -# CONFIG_FDDI is not set +CONFIG_FDDI=y +CONFIG_DEFXX=m +# CONFIG_DEFXX_MMIO is not set +CONFIG_SKFP=m # CONFIG_HIPPI is not set -# CONFIG_NET_SB1000 is not set -CONFIG_MDIO_DEVICE=y -CONFIG_MDIO_BUS=y -# CONFIG_MDIO_BCM_UNIMAC is not set +CONFIG_NET_SB1000=m +CONFIG_MDIO_DEVICE=m +CONFIG_MDIO_BUS=m +CONFIG_MDIO_BCM_UNIMAC=m CONFIG_MDIO_BITBANG=m CONFIG_MDIO_CAVIUM=m CONFIG_MDIO_GPIO=m -# CONFIG_MDIO_MSCC_MIIM is not set +CONFIG_MDIO_I2C=m +CONFIG_MDIO_MSCC_MIIM=m CONFIG_MDIO_THUNDER=m CONFIG_PHYLINK=m -CONFIG_PHYLIB=y +CONFIG_PHYLIB=m CONFIG_SWPHY=y # CONFIG_LED_TRIGGER_PHY is not set # # MII PHY device drivers # -# CONFIG_SFP is not set -# CONFIG_ADIN_PHY is not set +CONFIG_SFP=m +CONFIG_ADIN_PHY=m CONFIG_AMD_PHY=m CONFIG_AQUANTIA_PHY=m # CONFIG_AX88796B_PHY is not set @@ -2875,36 +3319,38 @@ CONFIG_BCM87XX_PHY=m CONFIG_BCM_NET_PHYLIB=m CONFIG_BROADCOM_PHY=m CONFIG_CICADA_PHY=m -# CONFIG_CORTINA_PHY is not set +CONFIG_CORTINA_PHY=m CONFIG_DAVICOM_PHY=m # CONFIG_DP83822_PHY is not set # CONFIG_DP83TC811_PHY is not set CONFIG_DP83848_PHY=m -# CONFIG_DP83867_PHY is not set -# CONFIG_DP83869_PHY is not set -CONFIG_FIXED_PHY=y +CONFIG_DP83867_PHY=m +CONFIG_DP83869_PHY=m +CONFIG_FIXED_PHY=m CONFIG_ICPLUS_PHY=m CONFIG_INTEL_XWAY_PHY=m CONFIG_LSI_ET1011C_PHY=m CONFIG_LXT_PHY=m CONFIG_MARVELL_PHY=m -# CONFIG_MARVELL_10G_PHY is not set +CONFIG_MARVELL_10G_PHY=m CONFIG_MICREL_PHY=m CONFIG_MICROCHIP_PHY=m -# CONFIG_MICROCHIP_T1_PHY is not set +CONFIG_MICROCHIP_T1_PHY=m CONFIG_MICROSEMI_PHY=m CONFIG_NATIONAL_PHY=m -# CONFIG_NXP_TJA11XX_PHY is not set +CONFIG_NXP_TJA11XX_PHY=m +CONFIG_AT803X_PHY=m CONFIG_QSEMI_PHY=m CONFIG_REALTEK_PHY=m # CONFIG_RENESAS_PHY is not set -# CONFIG_ROCKCHIP_PHY is not set +CONFIG_ROCKCHIP_PHY=m CONFIG_SMSC_PHY=m CONFIG_STE10XP=m CONFIG_TERANETICS_PHY=m CONFIG_VITESSE_PHY=m CONFIG_XILINX_GMII2RGMII=m -# CONFIG_PLIP is not set +CONFIG_MICREL_KS8995MA=m +CONFIG_PLIP=m CONFIG_PPP=m CONFIG_PPP_BSDCOMP=m CONFIG_PPP_DEFLATE=m @@ -2921,7 +3367,11 @@ CONFIG_SLIP=m CONFIG_SLHC=m CONFIG_SLIP_COMPRESSED=y CONFIG_SLIP_SMART=y -# CONFIG_SLIP_MODE_SLIP6 is not set +CONFIG_SLIP_MODE_SLIP6=y + +# +# Host-side USB support is needed for USB Network Adapter support +# CONFIG_USB_NET_DRIVERS=m CONFIG_USB_CATC=m CONFIG_USB_KAWETH=m @@ -2961,43 +3411,42 @@ CONFIG_USB_NET_KALMIA=m CONFIG_USB_NET_QMI_WWAN=m CONFIG_USB_HSO=m CONFIG_USB_NET_INT51X1=m +CONFIG_USB_CDC_PHONET=m CONFIG_USB_IPHETH=m CONFIG_USB_SIERRA_NET=m CONFIG_USB_VL600=m CONFIG_USB_NET_CH9200=m -# CONFIG_USB_NET_AQC111 is not set +CONFIG_USB_NET_AQC111=m CONFIG_WLAN=y +# CONFIG_WIRELESS_WDS is not set CONFIG_WLAN_VENDOR_ADMTEK=y -# CONFIG_ADM8211 is not set +CONFIG_ADM8211=m CONFIG_ATH_COMMON=m CONFIG_WLAN_VENDOR_ATH=y -# CONFIG_ATH_DEBUG is not set +CONFIG_ATH_DEBUG=y +# CONFIG_ATH_TRACEPOINTS is not set CONFIG_ATH5K=m CONFIG_ATH5K_DEBUG=y # CONFIG_ATH5K_TRACER is not set CONFIG_ATH5K_PCI=y CONFIG_ATH9K_HW=m CONFIG_ATH9K_COMMON=m -CONFIG_ATH9K_COMMON_DEBUG=y CONFIG_ATH9K_BTCOEX_SUPPORT=y CONFIG_ATH9K=m CONFIG_ATH9K_PCI=y CONFIG_ATH9K_AHB=y -CONFIG_ATH9K_DEBUGFS=y -# CONFIG_ATH9K_STATION_STATISTICS is not set +# CONFIG_ATH9K_DEBUGFS is not set # CONFIG_ATH9K_DYNACK is not set CONFIG_ATH9K_WOW=y CONFIG_ATH9K_RFKILL=y # CONFIG_ATH9K_CHANNEL_CONTEXT is not set CONFIG_ATH9K_PCOEM=y -# CONFIG_ATH9K_PCI_NO_EEPROM is not set +CONFIG_ATH9K_PCI_NO_EEPROM=m CONFIG_ATH9K_HTC=m # CONFIG_ATH9K_HTC_DEBUGFS is not set CONFIG_ATH9K_HWRNG=y -# CONFIG_ATH9K_COMMON_SPECTRAL is not set CONFIG_CARL9170=m CONFIG_CARL9170_LEDS=y -# CONFIG_CARL9170_DEBUGFS is not set CONFIG_CARL9170_WPC=y CONFIG_CARL9170_HWRNG=y CONFIG_ATH6KL=m @@ -3009,19 +3458,21 @@ CONFIG_AR5523=m CONFIG_WIL6210=m CONFIG_WIL6210_ISR_COR=y CONFIG_WIL6210_TRACING=y -CONFIG_WIL6210_DEBUGFS=y +# CONFIG_WIL6210_DEBUGFS is not set CONFIG_ATH10K=m CONFIG_ATH10K_CE=y CONFIG_ATH10K_PCI=m -# CONFIG_ATH10K_SDIO is not set -# CONFIG_ATH10K_USB is not set +CONFIG_ATH10K_SDIO=m +CONFIG_ATH10K_USB=m CONFIG_ATH10K_DEBUG=y # CONFIG_ATH10K_DEBUGFS is not set # CONFIG_ATH10K_TRACING is not set CONFIG_WCN36XX=m # CONFIG_WCN36XX_DEBUGFS is not set CONFIG_WLAN_VENDOR_ATMEL=y -# CONFIG_ATMEL is not set +CONFIG_ATMEL=m +CONFIG_PCI_ATMEL=m +CONFIG_PCMCIA_ATMEL=m CONFIG_AT76C50X_USB=m CONFIG_WLAN_VENDOR_BROADCOM=y CONFIG_B43=m @@ -3064,8 +3515,8 @@ CONFIG_BRCMFMAC_PCIE=y # CONFIG_BRCM_TRACING is not set # CONFIG_BRCMDBG is not set CONFIG_WLAN_VENDOR_CISCO=y -# CONFIG_AIRO is not set -# CONFIG_AIRO_CS is not set +CONFIG_AIRO=m +CONFIG_AIRO_CS=m CONFIG_WLAN_VENDOR_INTEL=y CONFIG_IPW2100=m CONFIG_IPW2100_MONITOR=y @@ -3085,8 +3536,7 @@ CONFIG_IWL3945=m # # iwl3945 / iwl4965 Debugging Options # -CONFIG_IWLEGACY_DEBUG=y -CONFIG_IWLEGACY_DEBUGFS=y +# CONFIG_IWLEGACY_DEBUG is not set # end of iwl3945 / iwl4965 Debugging Options CONFIG_IWLWIFI=m @@ -3100,23 +3550,39 @@ CONFIG_IWLWIFI_OPMODE_MODULAR=y # Debugging Options # CONFIG_IWLWIFI_DEBUG=y -CONFIG_IWLWIFI_DEBUGFS=y -CONFIG_IWLWIFI_DEVICE_TRACING=y +# CONFIG_IWLWIFI_DEVICE_TRACING is not set # end of Debugging Options CONFIG_WLAN_VENDOR_INTERSIL=y -# CONFIG_HOSTAP is not set -# CONFIG_HERMES is not set +CONFIG_HOSTAP=m +CONFIG_HOSTAP_FIRMWARE=y +CONFIG_HOSTAP_FIRMWARE_NVRAM=y +CONFIG_HOSTAP_PLX=m +CONFIG_HOSTAP_PCI=m +CONFIG_HOSTAP_CS=m +CONFIG_HERMES=m +CONFIG_HERMES_PRISM=y +CONFIG_HERMES_CACHE_FW_ON_INIT=y +CONFIG_PLX_HERMES=m +CONFIG_TMD_HERMES=m +CONFIG_NORTEL_HERMES=m +CONFIG_PCI_HERMES=m +CONFIG_PCMCIA_HERMES=m +CONFIG_PCMCIA_SPECTRUM=m +CONFIG_ORINOCO_USB=m CONFIG_P54_COMMON=m CONFIG_P54_USB=m CONFIG_P54_PCI=m +CONFIG_P54_SPI=m +CONFIG_P54_SPI_DEFAULT_EEPROM=y CONFIG_P54_LEDS=y -# CONFIG_PRISM54 is not set +CONFIG_PRISM54=m CONFIG_WLAN_VENDOR_MARVELL=y CONFIG_LIBERTAS=m CONFIG_LIBERTAS_USB=m CONFIG_LIBERTAS_CS=m CONFIG_LIBERTAS_SDIO=m +CONFIG_LIBERTAS_SPI=m # CONFIG_LIBERTAS_DEBUG is not set CONFIG_LIBERTAS_MESH=y # CONFIG_LIBERTAS_THINFIRM is not set @@ -3127,12 +3593,19 @@ CONFIG_MWIFIEX_USB=m CONFIG_MWL8K=m CONFIG_WLAN_VENDOR_MEDIATEK=y CONFIG_MT7601U=m -# CONFIG_MT76x0U is not set -# CONFIG_MT76x0E is not set -# CONFIG_MT76x2E is not set -# CONFIG_MT76x2U is not set -# CONFIG_MT7603E is not set -# CONFIG_MT7615E is not set +CONFIG_MT76_CORE=m +CONFIG_MT76_LEDS=y +CONFIG_MT76_USB=m +CONFIG_MT76x02_LIB=m +CONFIG_MT76x02_USB=m +CONFIG_MT76x0_COMMON=m +CONFIG_MT76x0U=m +CONFIG_MT76x0E=m +CONFIG_MT76x2_COMMON=m +CONFIG_MT76x2E=m +CONFIG_MT76x2U=m +CONFIG_MT7603E=m +CONFIG_MT7615E=m CONFIG_WLAN_VENDOR_RALINK=y CONFIG_RT2X00=m CONFIG_RT2400PCI=m @@ -3148,7 +3621,7 @@ CONFIG_RT73USB=m CONFIG_RT2800USB=m CONFIG_RT2800USB_RT33XX=y CONFIG_RT2800USB_RT35XX=y -# CONFIG_RT2800USB_RT3573 is not set +CONFIG_RT2800USB_RT3573=y CONFIG_RT2800USB_RT53XX=y CONFIG_RT2800USB_RT55XX=y CONFIG_RT2800USB_UNKNOWN=y @@ -3161,7 +3634,6 @@ CONFIG_RT2X00_LIB=m CONFIG_RT2X00_LIB_FIRMWARE=y CONFIG_RT2X00_LIB_CRYPTO=y CONFIG_RT2X00_LIB_LEDS=y -CONFIG_RT2X00_LIB_DEBUGFS=y # CONFIG_RT2X00_DEBUG is not set CONFIG_WLAN_VENDOR_REALTEK=y CONFIG_RTL8180=m @@ -3180,13 +3652,19 @@ CONFIG_RTL8192CU=m CONFIG_RTLWIFI=m CONFIG_RTLWIFI_PCI=m CONFIG_RTLWIFI_USB=m -# CONFIG_RTLWIFI_DEBUG is not set +CONFIG_RTLWIFI_DEBUG=y CONFIG_RTL8192C_COMMON=m CONFIG_RTL8723_COMMON=m CONFIG_RTLBTCOEXIST=m CONFIG_RTL8XXXU=m # CONFIG_RTL8XXXU_UNTESTED is not set -# CONFIG_RTW88 is not set +CONFIG_RTW88=m +CONFIG_RTW88_CORE=m +CONFIG_RTW88_PCI=m +CONFIG_RTW88_8822BE=y +CONFIG_RTW88_8822CE=y +CONFIG_RTW88_DEBUG=y +CONFIG_RTW88_DEBUGFS=y CONFIG_WLAN_VENDOR_RSI=y CONFIG_RSI_91X=m CONFIG_RSI_DEBUGFS=y @@ -3196,19 +3674,25 @@ CONFIG_RSI_COEX=y CONFIG_WLAN_VENDOR_ST=y CONFIG_CW1200=m CONFIG_CW1200_WLAN_SDIO=m +CONFIG_CW1200_WLAN_SPI=m CONFIG_WLAN_VENDOR_TI=y -# CONFIG_WL1251 is not set -# CONFIG_WL12XX is not set -# CONFIG_WL18XX is not set -# CONFIG_WLCORE is not set +CONFIG_WL1251=m +CONFIG_WL1251_SPI=m +CONFIG_WL1251_SDIO=m +CONFIG_WL12XX=m +CONFIG_WL18XX=m +CONFIG_WLCORE=m +CONFIG_WLCORE_SDIO=m +CONFIG_WILINK_PLATFORM_DATA=y CONFIG_WLAN_VENDOR_ZYDAS=y -# CONFIG_USB_ZD1201 is not set +CONFIG_USB_ZD1201=m CONFIG_ZD1211RW=m # CONFIG_ZD1211RW_DEBUG is not set CONFIG_WLAN_VENDOR_QUANTENNA=y -# CONFIG_QTNFMAC_PCIE is not set -# CONFIG_PCMCIA_RAYCS is not set -# CONFIG_PCMCIA_WL3501 is not set +CONFIG_QTNFMAC=m +CONFIG_QTNFMAC_PCIE=m +CONFIG_PCMCIA_RAYCS=m +CONFIG_PCMCIA_WL3501=m CONFIG_MAC80211_HWSIM=m CONFIG_USB_NET_RNDIS_WLAN=m # CONFIG_VIRT_WIFI is not set @@ -3221,23 +3705,48 @@ CONFIG_WIMAX_I2400M_USB=m CONFIG_WIMAX_I2400M_DEBUG_LEVEL=8 # end of WiMAX Wireless Broadband devices -# CONFIG_WAN is not set +CONFIG_WAN=y +CONFIG_LANMEDIA=m +CONFIG_HDLC=m +CONFIG_HDLC_RAW=m +CONFIG_HDLC_RAW_ETH=m +CONFIG_HDLC_CISCO=m +CONFIG_HDLC_FR=m +CONFIG_HDLC_PPP=m +CONFIG_HDLC_X25=m +CONFIG_PCI200SYN=m +CONFIG_WANXL=m +CONFIG_PC300TOO=m +CONFIG_FARSYNC=m +CONFIG_DLCI=m +CONFIG_DLCI_MAX=8 +CONFIG_LAPBETHER=m +CONFIG_X25_ASY=m +CONFIG_SBNI=m +CONFIG_SBNI_MULTILINE=y CONFIG_IEEE802154_DRIVERS=m CONFIG_IEEE802154_FAKELB=m -# CONFIG_IEEE802154_ATUSB is not set +CONFIG_IEEE802154_AT86RF230=m +# CONFIG_IEEE802154_AT86RF230_DEBUGFS is not set +CONFIG_IEEE802154_MRF24J40=m +CONFIG_IEEE802154_CC2520=m +CONFIG_IEEE802154_ATUSB=m +CONFIG_IEEE802154_ADF7242=m +CONFIG_IEEE802154_CA8210=m +# CONFIG_IEEE802154_CA8210_DEBUGFS is not set +# CONFIG_IEEE802154_MCR20A is not set # CONFIG_IEEE802154_HWSIM is not set CONFIG_XEN_NETDEV_FRONTEND=m CONFIG_XEN_NETDEV_BACKEND=m CONFIG_VMXNET3=m CONFIG_FUJITSU_ES=m -# CONFIG_THUNDERBOLT_NET is not set +CONFIG_USB4_NET=m CONFIG_HYPERV_NET=m # CONFIG_NETDEVSIM is not set CONFIG_NET_FAILOVER=m CONFIG_ISDN=y -CONFIG_ISDN_CAPI=m -# CONFIG_CAPI_TRACE is not set -CONFIG_ISDN_CAPI_CAPI20=m +CONFIG_ISDN_CAPI=y +CONFIG_CAPI_TRACE=y CONFIG_ISDN_CAPI_MIDDLEWARE=y CONFIG_MISDN=m CONFIG_MISDN_DSP=m @@ -3257,14 +3766,15 @@ CONFIG_MISDN_NETJET=m CONFIG_MISDN_HDLC=m CONFIG_MISDN_IPAC=m CONFIG_MISDN_ISAR=m -# CONFIG_NVM is not set +CONFIG_NVM=y +# CONFIG_NVM_PBLK is not set # # Input device support # CONFIG_INPUT=y -CONFIG_INPUT_LEDS=y -CONFIG_INPUT_FF_MEMLESS=y +CONFIG_INPUT_LEDS=m +CONFIG_INPUT_FF_MEMLESS=m CONFIG_INPUT_POLLDEV=m CONFIG_INPUT_SPARSEKMAP=m CONFIG_INPUT_MATRIXKMAP=m @@ -3273,66 +3783,74 @@ CONFIG_INPUT_MATRIXKMAP=m # Userland interfaces # CONFIG_INPUT_MOUSEDEV=y -# CONFIG_INPUT_MOUSEDEV_PSAUX is not set +CONFIG_INPUT_MOUSEDEV_PSAUX=y CONFIG_INPUT_MOUSEDEV_SCREEN_X=1024 CONFIG_INPUT_MOUSEDEV_SCREEN_Y=768 CONFIG_INPUT_JOYDEV=m -CONFIG_INPUT_EVDEV=y +CONFIG_INPUT_EVDEV=m # CONFIG_INPUT_EVBUG is not set # # Input Device Drivers # CONFIG_INPUT_KEYBOARD=y +# CONFIG_KEYBOARD_ADC is not set +CONFIG_KEYBOARD_ADP5520=m # CONFIG_KEYBOARD_ADP5588 is not set # CONFIG_KEYBOARD_ADP5589 is not set +CONFIG_KEYBOARD_APPLESPI=m CONFIG_KEYBOARD_ATKBD=y # CONFIG_KEYBOARD_QT1050 is not set # CONFIG_KEYBOARD_QT1070 is not set -# CONFIG_KEYBOARD_QT2160 is not set -# CONFIG_KEYBOARD_DLINK_DIR685 is not set -# CONFIG_KEYBOARD_LKKBD is not set +CONFIG_KEYBOARD_QT2160=m +CONFIG_KEYBOARD_DLINK_DIR685=m +CONFIG_KEYBOARD_LKKBD=m CONFIG_KEYBOARD_GPIO=m CONFIG_KEYBOARD_GPIO_POLLED=m -# CONFIG_KEYBOARD_TCA6416 is not set -# CONFIG_KEYBOARD_TCA8418 is not set -CONFIG_KEYBOARD_MATRIX=m +CONFIG_KEYBOARD_TCA6416=m +CONFIG_KEYBOARD_TCA8418=m +# CONFIG_KEYBOARD_MATRIX is not set # CONFIG_KEYBOARD_LM8323 is not set # CONFIG_KEYBOARD_LM8333 is not set # CONFIG_KEYBOARD_MAX7359 is not set # CONFIG_KEYBOARD_MCS is not set # CONFIG_KEYBOARD_MPR121 is not set -# CONFIG_KEYBOARD_NEWTON is not set +CONFIG_KEYBOARD_NEWTON=m # CONFIG_KEYBOARD_OPENCORES is not set CONFIG_KEYBOARD_SAMSUNG=m -# CONFIG_KEYBOARD_STOWAWAY is not set -# CONFIG_KEYBOARD_SUNKBD is not set +CONFIG_KEYBOARD_STOWAWAY=m +CONFIG_KEYBOARD_SUNKBD=m # CONFIG_KEYBOARD_TM2_TOUCHKEY is not set -# CONFIG_KEYBOARD_XTKBD is not set +CONFIG_KEYBOARD_TWL4030=m +CONFIG_KEYBOARD_XTKBD=m CONFIG_KEYBOARD_CROS_EC=m -# CONFIG_KEYBOARD_MTK_PMIC is not set CONFIG_INPUT_MOUSE=y -CONFIG_MOUSE_PS2=y +CONFIG_MOUSE_PS2=m CONFIG_MOUSE_PS2_ALPS=y CONFIG_MOUSE_PS2_BYD=y CONFIG_MOUSE_PS2_LOGIPS2PP=y CONFIG_MOUSE_PS2_SYNAPTICS=y +CONFIG_MOUSE_PS2_SYNAPTICS_SMBUS=y CONFIG_MOUSE_PS2_CYPRESS=y CONFIG_MOUSE_PS2_LIFEBOOK=y CONFIG_MOUSE_PS2_TRACKPOINT=y CONFIG_MOUSE_PS2_ELANTECH=y +CONFIG_MOUSE_PS2_ELANTECH_SMBUS=y CONFIG_MOUSE_PS2_SENTELIC=y -# CONFIG_MOUSE_PS2_TOUCHKIT is not set +CONFIG_MOUSE_PS2_TOUCHKIT=y CONFIG_MOUSE_PS2_FOCALTECH=y CONFIG_MOUSE_PS2_VMMOUSE=y +CONFIG_MOUSE_PS2_SMBUS=y CONFIG_MOUSE_SERIAL=m CONFIG_MOUSE_APPLETOUCH=m CONFIG_MOUSE_BCM5974=m CONFIG_MOUSE_CYAPA=m -# CONFIG_MOUSE_ELAN_I2C is not set +CONFIG_MOUSE_ELAN_I2C=m +CONFIG_MOUSE_ELAN_I2C_I2C=y +CONFIG_MOUSE_ELAN_I2C_SMBUS=y CONFIG_MOUSE_VSXXXAA=m -CONFIG_MOUSE_GPIO=m -CONFIG_MOUSE_SYNAPTICS_I2C=m +# CONFIG_MOUSE_GPIO is not set +# CONFIG_MOUSE_SYNAPTICS_I2C is not set CONFIG_MOUSE_SYNAPTICS_USB=m CONFIG_INPUT_JOYSTICK=y CONFIG_JOYSTICK_ANALOG=m @@ -3359,13 +3877,14 @@ CONFIG_JOYSTICK_ZHENHUA=m CONFIG_JOYSTICK_DB9=m CONFIG_JOYSTICK_GAMECON=m CONFIG_JOYSTICK_TURBOGRAFX=m -# CONFIG_JOYSTICK_AS5011 is not set +CONFIG_JOYSTICK_AS5011=m CONFIG_JOYSTICK_JOYDUMP=m CONFIG_JOYSTICK_XPAD=m CONFIG_JOYSTICK_XPAD_FF=y CONFIG_JOYSTICK_XPAD_LEDS=y CONFIG_JOYSTICK_WALKERA0701=m -# CONFIG_JOYSTICK_PXRC is not set +# CONFIG_JOYSTICK_PSXPAD_SPI is not set +CONFIG_JOYSTICK_PXRC=m # CONFIG_JOYSTICK_FSIA6B is not set CONFIG_INPUT_TABLET=y CONFIG_TABLET_USB_ACECAD=m @@ -3377,39 +3896,48 @@ CONFIG_TABLET_USB_PEGASUS=m CONFIG_TABLET_SERIAL_WACOM4=m CONFIG_INPUT_TOUCHSCREEN=y CONFIG_TOUCHSCREEN_PROPERTIES=y +CONFIG_TOUCHSCREEN_88PM860X=m +CONFIG_TOUCHSCREEN_ADS7846=m +CONFIG_TOUCHSCREEN_AD7877=m CONFIG_TOUCHSCREEN_AD7879=m CONFIG_TOUCHSCREEN_AD7879_I2C=m +CONFIG_TOUCHSCREEN_AD7879_SPI=m +CONFIG_TOUCHSCREEN_ADC=m CONFIG_TOUCHSCREEN_ATMEL_MXT=m -CONFIG_TOUCHSCREEN_ATMEL_MXT_T37=y +# CONFIG_TOUCHSCREEN_ATMEL_MXT_T37 is not set CONFIG_TOUCHSCREEN_AUO_PIXCIR=m CONFIG_TOUCHSCREEN_BU21013=m -# CONFIG_TOUCHSCREEN_BU21029 is not set +CONFIG_TOUCHSCREEN_BU21029=m # CONFIG_TOUCHSCREEN_CHIPONE_ICN8505 is not set CONFIG_TOUCHSCREEN_CY8CTMG110=m CONFIG_TOUCHSCREEN_CYTTSP_CORE=m CONFIG_TOUCHSCREEN_CYTTSP_I2C=m +CONFIG_TOUCHSCREEN_CYTTSP_SPI=m CONFIG_TOUCHSCREEN_CYTTSP4_CORE=m CONFIG_TOUCHSCREEN_CYTTSP4_I2C=m +CONFIG_TOUCHSCREEN_CYTTSP4_SPI=m +CONFIG_TOUCHSCREEN_DA9034=m +CONFIG_TOUCHSCREEN_DA9052=m CONFIG_TOUCHSCREEN_DYNAPRO=m CONFIG_TOUCHSCREEN_HAMPSHIRE=m CONFIG_TOUCHSCREEN_EETI=m -# CONFIG_TOUCHSCREEN_EGALAX_SERIAL is not set +CONFIG_TOUCHSCREEN_EGALAX_SERIAL=m # CONFIG_TOUCHSCREEN_EXC3000 is not set CONFIG_TOUCHSCREEN_FUJITSU=m -# CONFIG_TOUCHSCREEN_GOODIX is not set +CONFIG_TOUCHSCREEN_GOODIX=m # CONFIG_TOUCHSCREEN_HIDEEP is not set CONFIG_TOUCHSCREEN_ILI210X=m # CONFIG_TOUCHSCREEN_S6SY761 is not set CONFIG_TOUCHSCREEN_GUNZE=m CONFIG_TOUCHSCREEN_EKTF2127=m -# CONFIG_TOUCHSCREEN_ELAN is not set +CONFIG_TOUCHSCREEN_ELAN=m CONFIG_TOUCHSCREEN_ELO=m CONFIG_TOUCHSCREEN_WACOM_W8001=m CONFIG_TOUCHSCREEN_WACOM_I2C=m CONFIG_TOUCHSCREEN_MAX11801=m CONFIG_TOUCHSCREEN_MCS5000=m CONFIG_TOUCHSCREEN_MMS114=m -# CONFIG_TOUCHSCREEN_MELFAS_MIP4 is not set +CONFIG_TOUCHSCREEN_MELFAS_MIP4=m CONFIG_TOUCHSCREEN_MTOUCH=m CONFIG_TOUCHSCREEN_INEXIO=m CONFIG_TOUCHSCREEN_MK712=m @@ -3418,14 +3946,15 @@ CONFIG_TOUCHSCREEN_EDT_FT5X06=m CONFIG_TOUCHSCREEN_TOUCHRIGHT=m CONFIG_TOUCHSCREEN_TOUCHWIN=m CONFIG_TOUCHSCREEN_TI_AM335X_TSC=m -CONFIG_TOUCHSCREEN_UCB1400=m CONFIG_TOUCHSCREEN_PIXCIR=m -# CONFIG_TOUCHSCREEN_WDT87XX_I2C is not set +CONFIG_TOUCHSCREEN_WDT87XX_I2C=m +CONFIG_TOUCHSCREEN_WM831X=m CONFIG_TOUCHSCREEN_WM97XX=m CONFIG_TOUCHSCREEN_WM9705=y CONFIG_TOUCHSCREEN_WM9712=y CONFIG_TOUCHSCREEN_WM9713=y CONFIG_TOUCHSCREEN_USB_COMPOSITE=m +CONFIG_TOUCHSCREEN_MC13783=m CONFIG_TOUCHSCREEN_USB_EGALAX=y CONFIG_TOUCHSCREEN_USB_PANJIT=y CONFIG_TOUCHSCREEN_USB_3M=y @@ -3448,44 +3977,68 @@ CONFIG_TOUCHSCREEN_TOUCHIT213=m CONFIG_TOUCHSCREEN_TSC_SERIO=m CONFIG_TOUCHSCREEN_TSC200X_CORE=m CONFIG_TOUCHSCREEN_TSC2004=m +CONFIG_TOUCHSCREEN_TSC2005=m CONFIG_TOUCHSCREEN_TSC2007=m +# CONFIG_TOUCHSCREEN_TSC2007_IIO is not set +CONFIG_TOUCHSCREEN_PCAP=m CONFIG_TOUCHSCREEN_RM_TS=m CONFIG_TOUCHSCREEN_SILEAD=m CONFIG_TOUCHSCREEN_SIS_I2C=m CONFIG_TOUCHSCREEN_ST1232=m -# CONFIG_TOUCHSCREEN_STMFTS is not set +CONFIG_TOUCHSCREEN_STMFTS=m CONFIG_TOUCHSCREEN_SUR40=m -CONFIG_TOUCHSCREEN_SX8654=m +CONFIG_TOUCHSCREEN_SURFACE3_SPI=m +# CONFIG_TOUCHSCREEN_SX8654 is not set CONFIG_TOUCHSCREEN_TPS6507X=m -# CONFIG_TOUCHSCREEN_ZET6223 is not set +CONFIG_TOUCHSCREEN_ZET6223=m CONFIG_TOUCHSCREEN_ZFORCE=m CONFIG_TOUCHSCREEN_ROHM_BU21023=m # CONFIG_TOUCHSCREEN_IQS5XX is not set CONFIG_INPUT_MISC=y -# CONFIG_INPUT_AD714X is not set -# CONFIG_INPUT_BMA150 is not set -CONFIG_INPUT_E3X0_BUTTON=m +CONFIG_INPUT_88PM860X_ONKEY=m +CONFIG_INPUT_88PM80X_ONKEY=m +CONFIG_INPUT_AD714X=m +CONFIG_INPUT_AD714X_I2C=m +CONFIG_INPUT_AD714X_SPI=m +# CONFIG_INPUT_ARIZONA_HAPTICS is not set +CONFIG_INPUT_BMA150=m +# CONFIG_INPUT_E3X0_BUTTON is not set # CONFIG_INPUT_MSM_VIBRATOR is not set CONFIG_INPUT_PCSPKR=m -CONFIG_INPUT_MMA8450=m +CONFIG_INPUT_MAX77693_HAPTIC=m +CONFIG_INPUT_MAX8925_ONKEY=m +CONFIG_INPUT_MAX8997_HAPTIC=m +CONFIG_INPUT_MC13783_PWRBUTTON=m +# CONFIG_INPUT_MMA8450 is not set CONFIG_INPUT_APANEL=m CONFIG_INPUT_GP2A=m CONFIG_INPUT_GPIO_BEEPER=m -CONFIG_INPUT_GPIO_DECODER=m +# CONFIG_INPUT_GPIO_DECODER is not set # CONFIG_INPUT_GPIO_VIBRA is not set CONFIG_INPUT_ATLAS_BTNS=m CONFIG_INPUT_ATI_REMOTE2=m CONFIG_INPUT_KEYSPAN_REMOTE=m -CONFIG_INPUT_KXTJ9=m +# CONFIG_INPUT_KXTJ9 is not set CONFIG_INPUT_POWERMATE=m CONFIG_INPUT_YEALINK=m CONFIG_INPUT_CM109=m +CONFIG_INPUT_REGULATOR_HAPTIC=m CONFIG_INPUT_RETU_PWRBUTTON=m +# CONFIG_INPUT_AXP20X_PEK is not set +CONFIG_INPUT_TWL4030_PWRBUTTON=m +CONFIG_INPUT_TWL4030_VIBRA=m +CONFIG_INPUT_TWL6040_VIBRA=m CONFIG_INPUT_UINPUT=m -# CONFIG_INPUT_PCF8574 is not set +CONFIG_INPUT_PALMAS_PWRBUTTON=m +CONFIG_INPUT_PCF8574=m CONFIG_INPUT_PWM_BEEPER=m -# CONFIG_INPUT_PWM_VIBRA is not set +CONFIG_INPUT_PWM_VIBRA=m CONFIG_INPUT_GPIO_ROTARY_ENCODER=m +CONFIG_INPUT_DA9052_ONKEY=m +CONFIG_INPUT_DA9055_ONKEY=m +CONFIG_INPUT_DA9063_ONKEY=m +CONFIG_INPUT_WM831X_ON=m +CONFIG_INPUT_PCAP=m # CONFIG_INPUT_ADXL34X is not set CONFIG_INPUT_IMS_PCU=m CONFIG_INPUT_CMA3000=m @@ -3494,20 +4047,21 @@ CONFIG_INPUT_XEN_KBDDEV_FRONTEND=y CONFIG_INPUT_IDEAPAD_SLIDEBAR=m CONFIG_INPUT_SOC_BUTTON_ARRAY=m CONFIG_INPUT_DRV260X_HAPTICS=m -# CONFIG_INPUT_DRV2665_HAPTICS is not set -# CONFIG_INPUT_DRV2667_HAPTICS is not set +CONFIG_INPUT_DRV2665_HAPTICS=m +CONFIG_INPUT_DRV2667_HAPTICS=m CONFIG_RMI4_CORE=m -# CONFIG_RMI4_I2C is not set -# CONFIG_RMI4_SMB is not set +CONFIG_RMI4_I2C=m +CONFIG_RMI4_SPI=m +CONFIG_RMI4_SMB=m CONFIG_RMI4_F03=y CONFIG_RMI4_F03_SERIO=m CONFIG_RMI4_2D_SENSOR=y CONFIG_RMI4_F11=y CONFIG_RMI4_F12=y CONFIG_RMI4_F30=y -# CONFIG_RMI4_F34 is not set -# CONFIG_RMI4_F54 is not set -# CONFIG_RMI4_F55 is not set +CONFIG_RMI4_F34=y +CONFIG_RMI4_F54=y +CONFIG_RMI4_F55=y # # Hardware I/O ports @@ -3515,7 +4069,7 @@ CONFIG_RMI4_F30=y CONFIG_SERIO=y CONFIG_ARCH_MIGHT_HAVE_PC_SERIO=y CONFIG_SERIO_I8042=y -CONFIG_SERIO_SERPORT=y +CONFIG_SERIO_SERPORT=m CONFIG_SERIO_CT82C710=m CONFIG_SERIO_PARKBD=m CONFIG_SERIO_PCIPS2=m @@ -3525,7 +4079,7 @@ CONFIG_SERIO_ALTERA_PS2=m CONFIG_SERIO_PS2MULT=m CONFIG_SERIO_ARC_PS2=m CONFIG_HYPERV_KEYBOARD=m -# CONFIG_SERIO_GPIO_PS2 is not set +CONFIG_SERIO_GPIO_PS2=m CONFIG_USERIO=m CONFIG_GAMEPORT=m CONFIG_GAMEPORT_NS558=m @@ -3546,21 +4100,23 @@ CONFIG_VT_CONSOLE_SLEEP=y CONFIG_HW_CONSOLE=y CONFIG_VT_HW_CONSOLE_BINDING=y CONFIG_UNIX98_PTYS=y -# CONFIG_LEGACY_PTYS is not set +CONFIG_LEGACY_PTYS=y +CONFIG_LEGACY_PTY_COUNT=0 CONFIG_SERIAL_NONSTANDARD=y CONFIG_ROCKETPORT=m CONFIG_CYCLADES=m # CONFIG_CYZ_INTR is not set -# CONFIG_MOXA_INTELLIO is not set -# CONFIG_MOXA_SMARTIO is not set +CONFIG_MOXA_INTELLIO=m +CONFIG_MOXA_SMARTIO=m CONFIG_SYNCLINK=m CONFIG_SYNCLINKMP=m CONFIG_SYNCLINK_GT=m CONFIG_NOZOMI=m -# CONFIG_ISI is not set +CONFIG_ISI=m CONFIG_N_HDLC=m CONFIG_N_GSM=m -# CONFIG_TRACE_SINK is not set +CONFIG_TRACE_ROUTER=m +CONFIG_TRACE_SINK=m # CONFIG_NULL_TTY is not set CONFIG_LDISC_AUTOLOAD=y CONFIG_DEVMEM=y @@ -3573,28 +4129,31 @@ CONFIG_SERIAL_EARLYCON=y CONFIG_SERIAL_8250=y # CONFIG_SERIAL_8250_DEPRECATED_OPTIONS is not set CONFIG_SERIAL_8250_PNP=y -# CONFIG_SERIAL_8250_FINTEK is not set +# CONFIG_SERIAL_8250_16550A_VARIANTS is not set +CONFIG_SERIAL_8250_FINTEK=y CONFIG_SERIAL_8250_CONSOLE=y CONFIG_SERIAL_8250_DMA=y CONFIG_SERIAL_8250_PCI=y CONFIG_SERIAL_8250_EXAR=y CONFIG_SERIAL_8250_CS=m -CONFIG_SERIAL_8250_NR_UARTS=32 +CONFIG_SERIAL_8250_NR_UARTS=4 CONFIG_SERIAL_8250_RUNTIME_UARTS=4 CONFIG_SERIAL_8250_EXTENDED=y -CONFIG_SERIAL_8250_MANY_PORTS=y +# CONFIG_SERIAL_8250_MANY_PORTS is not set CONFIG_SERIAL_8250_SHARE_IRQ=y # CONFIG_SERIAL_8250_DETECT_IRQ is not set CONFIG_SERIAL_8250_RSA=y CONFIG_SERIAL_8250_DWLIB=y CONFIG_SERIAL_8250_DW=m -# CONFIG_SERIAL_8250_RT288X is not set -CONFIG_SERIAL_8250_LPSS=y -CONFIG_SERIAL_8250_MID=y +CONFIG_SERIAL_8250_RT288X=y +CONFIG_SERIAL_8250_LPSS=m +CONFIG_SERIAL_8250_MID=m # # Non-8250 serial port support # +CONFIG_SERIAL_MAX3100=m +CONFIG_SERIAL_MAX310X=m CONFIG_SERIAL_UARTLITE=m CONFIG_SERIAL_UARTLITE_NR_UARTS=1 CONFIG_SERIAL_CORE=y @@ -3604,10 +4163,12 @@ CONFIG_SERIAL_SCCNXP=m CONFIG_SERIAL_SC16IS7XX_CORE=m CONFIG_SERIAL_SC16IS7XX=m CONFIG_SERIAL_SC16IS7XX_I2C=y +# CONFIG_SERIAL_SC16IS7XX_SPI is not set CONFIG_SERIAL_ALTERA_JTAGUART=m CONFIG_SERIAL_ALTERA_UART=m CONFIG_SERIAL_ALTERA_UART_MAXPORTS=4 CONFIG_SERIAL_ALTERA_UART_BAUDRATE=115200 +CONFIG_SERIAL_IFX6X60=m CONFIG_SERIAL_ARC=m CONFIG_SERIAL_ARC_NR_PORTS=1 CONFIG_SERIAL_RP2=m @@ -3617,7 +4178,8 @@ CONFIG_SERIAL_FSL_LPUART=m # end of Serial drivers CONFIG_SERIAL_MCTRL_GPIO=y -# CONFIG_SERIAL_DEV_BUS is not set +CONFIG_SERIAL_DEV_BUS=m +# CONFIG_TTY_PRINTK is not set CONFIG_PRINTER=m CONFIG_LP_CONSOLE=y CONFIG_PPDEV=m @@ -3625,46 +4187,50 @@ CONFIG_HVC_DRIVER=y CONFIG_HVC_IRQ=y CONFIG_HVC_XEN=y CONFIG_HVC_XEN_FRONTEND=y -CONFIG_VIRTIO_CONSOLE=y +CONFIG_VIRTIO_CONSOLE=m CONFIG_IPMI_HANDLER=m CONFIG_IPMI_DMI_DECODE=y CONFIG_IPMI_PLAT_DATA=y -# CONFIG_IPMI_PANIC_EVENT is not set +CONFIG_IPMI_PANIC_EVENT=y +CONFIG_IPMI_PANIC_STRING=y CONFIG_IPMI_DEVICE_INTERFACE=m CONFIG_IPMI_SI=m -# CONFIG_IPMI_SSIF is not set +CONFIG_IPMI_SSIF=m CONFIG_IPMI_WATCHDOG=m CONFIG_IPMI_POWEROFF=m -# CONFIG_IPMB_DEVICE_INTERFACE is not set +CONFIG_IPMB_DEVICE_INTERFACE=m CONFIG_HW_RANDOM=y CONFIG_HW_RANDOM_TIMERIOMEM=m CONFIG_HW_RANDOM_INTEL=m CONFIG_HW_RANDOM_AMD=m CONFIG_HW_RANDOM_VIA=m CONFIG_HW_RANDOM_VIRTIO=m -CONFIG_NVRAM=y -# CONFIG_APPLICOM is not set +CONFIG_NVRAM=m +CONFIG_APPLICOM=m # # PCMCIA character devices # -# CONFIG_SYNCLINK_CS is not set +CONFIG_SYNCLINK_CS=m CONFIG_CARDMAN_4000=m CONFIG_CARDMAN_4040=m -# CONFIG_SCR24X is not set +CONFIG_SCR24X=m CONFIG_IPWIRELESS=m # end of PCMCIA character devices CONFIG_MWAVE=m -CONFIG_RAW_DRIVER=y -CONFIG_MAX_RAW_DEVS=8192 +CONFIG_RAW_DRIVER=m +CONFIG_MAX_RAW_DEVS=256 CONFIG_HPET=y -# CONFIG_HPET_MMAP is not set +CONFIG_HPET_MMAP=y +CONFIG_HPET_MMAP_DEFAULT=y CONFIG_HANGCHECK_TIMER=m CONFIG_TCG_TPM=m CONFIG_HW_RANDOM_TPM=y CONFIG_TCG_TIS_CORE=m CONFIG_TCG_TIS=m +CONFIG_TCG_TIS_SPI=m +# CONFIG_TCG_TIS_SPI_CR50 is not set CONFIG_TCG_TIS_I2C_ATMEL=m CONFIG_TCG_TIS_I2C_INFINEON=m CONFIG_TCG_TIS_I2C_NUVOTON=m @@ -3676,19 +4242,21 @@ CONFIG_TCG_CRB=m CONFIG_TCG_VTPM_PROXY=m CONFIG_TCG_TIS_ST33ZP24=m CONFIG_TCG_TIS_ST33ZP24_I2C=m +CONFIG_TCG_TIS_ST33ZP24_SPI=m CONFIG_TELCLOCK=m CONFIG_DEVPORT=y CONFIG_XILLYBUS=m -# CONFIG_XILLYBUS_PCIE is not set +CONFIG_XILLYBUS_PCIE=m # end of Character devices -# CONFIG_RANDOM_TRUST_CPU is not set -# CONFIG_RANDOM_TRUST_BOOTLOADER is not set +CONFIG_RANDOM_TRUST_CPU=y +CONFIG_RANDOM_TRUST_BOOTLOADER=y # # I2C support # -CONFIG_I2C=m +CONFIG_I2C=y +CONFIG_ACPI_I2C_OPREGION=y CONFIG_I2C_BOARDINFO=y CONFIG_I2C_COMPAT=y CONFIG_I2C_CHARDEV=m @@ -3698,17 +4266,16 @@ CONFIG_I2C_MUX=m # Multiplexer I2C Chip support # CONFIG_I2C_MUX_GPIO=m -# CONFIG_I2C_MUX_LTC4306 is not set +CONFIG_I2C_MUX_LTC4306=m CONFIG_I2C_MUX_PCA9541=m CONFIG_I2C_MUX_PCA954x=m CONFIG_I2C_MUX_REG=m -# CONFIG_I2C_MUX_MLXCPLD is not set +CONFIG_I2C_MUX_MLXCPLD=m # end of Multiplexer I2C Chip support CONFIG_I2C_HELPER_AUTO=y CONFIG_I2C_SMBUS=m CONFIG_I2C_ALGOBIT=m -CONFIG_I2C_ALGOPCA=m # # I2C Hardware Bus support @@ -3717,22 +4284,23 @@ CONFIG_I2C_ALGOPCA=m # # PC SMBus host controller drivers # -# CONFIG_I2C_ALI1535 is not set -# CONFIG_I2C_ALI1563 is not set -# CONFIG_I2C_ALI15X3 is not set +CONFIG_I2C_ALI1535=m +CONFIG_I2C_ALI1563=m +CONFIG_I2C_ALI15X3=m CONFIG_I2C_AMD756=m CONFIG_I2C_AMD756_S4882=m CONFIG_I2C_AMD8111=m -# CONFIG_I2C_AMD_MP2 is not set +CONFIG_I2C_AMD_MP2=m CONFIG_I2C_I801=m CONFIG_I2C_ISCH=m CONFIG_I2C_ISMT=m CONFIG_I2C_PIIX4=m +CONFIG_I2C_CHT_WC=m CONFIG_I2C_NFORCE2=m CONFIG_I2C_NFORCE2_S4985=m -# CONFIG_I2C_NVIDIA_GPU is not set -# CONFIG_I2C_SIS5595 is not set -# CONFIG_I2C_SIS630 is not set +CONFIG_I2C_NVIDIA_GPU=m +CONFIG_I2C_SIS5595=m +CONFIG_I2C_SIS630=m CONFIG_I2C_SIS96X=m CONFIG_I2C_VIA=m CONFIG_I2C_VIAPRO=m @@ -3746,56 +4314,106 @@ CONFIG_I2C_SCMI=m # I2C system bus drivers (mostly embedded / system-on-chip) # CONFIG_I2C_CBUS_GPIO=m -CONFIG_I2C_DESIGNWARE_CORE=m -CONFIG_I2C_DESIGNWARE_PLATFORM=m -# CONFIG_I2C_DESIGNWARE_SLAVE is not set -# CONFIG_I2C_DESIGNWARE_PCI is not set -# CONFIG_I2C_DESIGNWARE_BAYTRAIL is not set +CONFIG_I2C_DESIGNWARE_CORE=y +CONFIG_I2C_DESIGNWARE_PLATFORM=y +CONFIG_I2C_DESIGNWARE_SLAVE=y +CONFIG_I2C_DESIGNWARE_PCI=m +CONFIG_I2C_DESIGNWARE_BAYTRAIL=y CONFIG_I2C_EMEV2=m -CONFIG_I2C_GPIO=m -# CONFIG_I2C_GPIO_FAULT_INJECTOR is not set +# CONFIG_I2C_GPIO is not set +CONFIG_I2C_KEMPLD=m # CONFIG_I2C_OCORES is not set -CONFIG_I2C_PCA_PLATFORM=m -CONFIG_I2C_SIMTEC=m -# CONFIG_I2C_XILINX is not set +# CONFIG_I2C_PCA_PLATFORM is not set +# CONFIG_I2C_SIMTEC is not set +CONFIG_I2C_XILINX=m # # External I2C/SMBus adapter drivers # CONFIG_I2C_DIOLAN_U2C=m +CONFIG_I2C_DLN2=m CONFIG_I2C_PARPORT=m -CONFIG_I2C_PARPORT_LIGHT=m CONFIG_I2C_ROBOTFUZZ_OSIF=m -# CONFIG_I2C_TAOS_EVM is not set +CONFIG_I2C_TAOS_EVM=m CONFIG_I2C_TINY_USB=m CONFIG_I2C_VIPERBOARD=m # # Other I2C/SMBus bus drivers # -# CONFIG_I2C_MLXCPLD is not set +CONFIG_I2C_MLXCPLD=m CONFIG_I2C_CROS_EC_TUNNEL=m # end of I2C Hardware Bus support -CONFIG_I2C_STUB=m +# CONFIG_I2C_STUB is not set CONFIG_I2C_SLAVE=y -# CONFIG_I2C_SLAVE_EEPROM is not set +CONFIG_I2C_SLAVE_EEPROM=m # CONFIG_I2C_DEBUG_CORE is not set # CONFIG_I2C_DEBUG_ALGO is not set # CONFIG_I2C_DEBUG_BUS is not set # end of I2C support -# CONFIG_I3C is not set -# CONFIG_SPI is not set +CONFIG_I3C=m +CONFIG_CDNS_I3C_MASTER=m +CONFIG_DW_I3C_MASTER=m +CONFIG_SPI=y +# CONFIG_SPI_DEBUG is not set +CONFIG_SPI_MASTER=y +CONFIG_SPI_MEM=y + +# +# SPI Master Controller Drivers +# +CONFIG_SPI_ALTERA=m +CONFIG_SPI_AXI_SPI_ENGINE=m +CONFIG_SPI_BITBANG=m +CONFIG_SPI_BUTTERFLY=m +# CONFIG_SPI_CADENCE is not set +CONFIG_SPI_DESIGNWARE=m +CONFIG_SPI_DW_PCI=m +CONFIG_SPI_DW_MID_DMA=y +CONFIG_SPI_DW_MMIO=m +# CONFIG_SPI_DLN2 is not set +# CONFIG_SPI_NXP_FLEXSPI is not set +CONFIG_SPI_GPIO=m +CONFIG_SPI_LM70_LLP=m +CONFIG_SPI_OC_TINY=m +CONFIG_SPI_PXA2XX=m +CONFIG_SPI_PXA2XX_PCI=m +CONFIG_SPI_ROCKCHIP=m +CONFIG_SPI_SC18IS602=m +# CONFIG_SPI_SIFIVE is not set +# CONFIG_SPI_MXIC is not set +CONFIG_SPI_XCOMM=m +CONFIG_SPI_XILINX=m +CONFIG_SPI_ZYNQMP_GQSPI=m + +# +# SPI Protocol Masters +# +CONFIG_SPI_SPIDEV=m +CONFIG_SPI_LOOPBACK_TEST=m +CONFIG_SPI_TLE62X0=m +# CONFIG_SPI_SLAVE is not set CONFIG_SPMI=m -# CONFIG_HSI is not set -CONFIG_PPS=y +CONFIG_HSI=m +CONFIG_HSI_BOARDINFO=y + +# +# HSI controllers +# + +# +# HSI clients +# +CONFIG_HSI_CHAR=m +CONFIG_PPS=m # CONFIG_PPS_DEBUG is not set # # PPS clients support # -# CONFIG_PPS_CLIENT_KTIMER is not set +CONFIG_PPS_CLIENT_KTIMER=m CONFIG_PPS_CLIENT_LDISC=m CONFIG_PPS_CLIENT_PARPORT=m CONFIG_PPS_CLIENT_GPIO=m @@ -3807,8 +4425,11 @@ CONFIG_PPS_CLIENT_GPIO=m # # PTP clock support # -CONFIG_PTP_1588_CLOCK=y -CONFIG_DP83640_PHY=m +CONFIG_PTP_1588_CLOCK=m + +# +# Enable PHYLIB and NETWORK_PHY_TIMESTAMPING to see the additional clocks. +# CONFIG_PTP_1588_CLOCK_KVM=m # CONFIG_PTP_1588_CLOCK_IDTCM is not set # end of PTP clock support @@ -3817,41 +4438,50 @@ CONFIG_PINCTRL=y CONFIG_PINMUX=y CONFIG_PINCONF=y CONFIG_GENERIC_PINCONF=y +# CONFIG_DEBUG_PINCTRL is not set CONFIG_PINCTRL_AMD=y # CONFIG_PINCTRL_MCP23S08 is not set +CONFIG_PINCTRL_SX150X=y CONFIG_PINCTRL_BAYTRAIL=y CONFIG_PINCTRL_CHERRYVIEW=m +CONFIG_PINCTRL_LYNXPOINT=m CONFIG_PINCTRL_INTEL=m CONFIG_PINCTRL_BROXTON=m -# CONFIG_PINCTRL_CANNONLAKE is not set -# CONFIG_PINCTRL_CEDARFORK is not set -# CONFIG_PINCTRL_DENVERTON is not set -# CONFIG_PINCTRL_GEMINILAKE is not set -# CONFIG_PINCTRL_ICELAKE is not set -# CONFIG_PINCTRL_LEWISBURG is not set +CONFIG_PINCTRL_CANNONLAKE=m +CONFIG_PINCTRL_CEDARFORK=m +CONFIG_PINCTRL_DENVERTON=m +CONFIG_PINCTRL_GEMINILAKE=m +CONFIG_PINCTRL_ICELAKE=m +CONFIG_PINCTRL_LEWISBURG=m CONFIG_PINCTRL_SUNRISEPOINT=m -# CONFIG_PINCTRL_TIGERLAKE is not set +CONFIG_PINCTRL_TIGERLAKE=m +CONFIG_PINCTRL_MADERA=m +CONFIG_PINCTRL_CS47L15=y +CONFIG_PINCTRL_CS47L35=y +CONFIG_PINCTRL_CS47L85=y +CONFIG_PINCTRL_CS47L90=y +CONFIG_PINCTRL_CS47L92=y CONFIG_GPIOLIB=y CONFIG_GPIOLIB_FASTPATH_LIMIT=512 CONFIG_GPIO_ACPI=y CONFIG_GPIOLIB_IRQCHIP=y +# CONFIG_DEBUG_GPIO is not set CONFIG_GPIO_SYSFS=y -CONFIG_GPIO_GENERIC=y +CONFIG_GPIO_GENERIC=m CONFIG_GPIO_MAX730X=m # # Memory mapped GPIO drivers # CONFIG_GPIO_AMDPT=m -CONFIG_GPIO_DWAPB=m -# CONFIG_GPIO_EXAR is not set -CONFIG_GPIO_GENERIC_PLATFORM=y +# CONFIG_GPIO_DWAPB is not set +CONFIG_GPIO_EXAR=m +CONFIG_GPIO_GENERIC_PLATFORM=m CONFIG_GPIO_ICH=m -CONFIG_GPIO_LYNXPOINT=m # CONFIG_GPIO_MB86S7X is not set CONFIG_GPIO_VX855=m -# CONFIG_GPIO_XILINX is not set -# CONFIG_GPIO_AMD_FCH is not set +CONFIG_GPIO_XILINX=m +CONFIG_GPIO_AMD_FCH=m # end of Memory mapped GPIO drivers # @@ -3861,8 +4491,8 @@ CONFIG_GPIO_F7188X=m CONFIG_GPIO_IT87=m CONFIG_GPIO_SCH=m CONFIG_GPIO_SCH311X=m -# CONFIG_GPIO_WINBOND is not set -# CONFIG_GPIO_WS16C48 is not set +CONFIG_GPIO_WINBOND=m +CONFIG_GPIO_WS16C48=m # end of Port-mapped I/O GPIO drivers # @@ -3873,15 +4503,35 @@ CONFIG_GPIO_MAX7300=m CONFIG_GPIO_MAX732X=m CONFIG_GPIO_PCA953X=m CONFIG_GPIO_PCF857X=m -# CONFIG_GPIO_TPIC2810 is not set +CONFIG_GPIO_TPIC2810=m # end of I2C GPIO expanders # # MFD GPIO expanders # +CONFIG_GPIO_ADP5520=m +CONFIG_GPIO_ARIZONA=m +CONFIG_GPIO_BD9571MWV=m +CONFIG_GPIO_CRYSTAL_COVE=y +CONFIG_GPIO_DA9052=m +CONFIG_GPIO_DA9055=m +CONFIG_GPIO_DLN2=m +CONFIG_GPIO_KEMPLD=m CONFIG_GPIO_LP3943=m -CONFIG_GPIO_LP873X=m -CONFIG_GPIO_UCB1400=m +CONFIG_GPIO_MADERA=m +CONFIG_GPIO_PALMAS=y +CONFIG_GPIO_RC5T583=y +CONFIG_GPIO_TPS65086=m +CONFIG_GPIO_TPS6586X=y +CONFIG_GPIO_TPS65910=y +CONFIG_GPIO_TPS65912=m +CONFIG_GPIO_TPS68470=y +CONFIG_GPIO_TWL4030=m +CONFIG_GPIO_TWL6040=m +CONFIG_GPIO_WHISKEY_COVE=m +CONFIG_GPIO_WM831X=m +CONFIG_GPIO_WM8350=m +CONFIG_GPIO_WM8994=m # end of MFD GPIO expanders # @@ -3889,30 +4539,40 @@ CONFIG_GPIO_UCB1400=m # CONFIG_GPIO_AMD8111=m CONFIG_GPIO_ML_IOH=m -# CONFIG_GPIO_PCI_IDIO_16 is not set +CONFIG_GPIO_PCI_IDIO_16=m # CONFIG_GPIO_PCIE_IDIO_24 is not set CONFIG_GPIO_RDC321X=m # end of PCI GPIO expanders +# +# SPI GPIO expanders +# +# CONFIG_GPIO_MAX3191X is not set +CONFIG_GPIO_MAX7301=m +CONFIG_GPIO_MC33880=m +CONFIG_GPIO_PISOSR=m +# CONFIG_GPIO_XRA1403 is not set +# end of SPI GPIO expanders + # # USB GPIO expanders # CONFIG_GPIO_VIPERBOARD=m # end of USB GPIO expanders -CONFIG_GPIO_MOCKUP=m +# CONFIG_GPIO_MOCKUP is not set CONFIG_W1=m CONFIG_W1_CON=y # # 1-wire Bus Masters # -# CONFIG_W1_MASTER_MATROX is not set +CONFIG_W1_MASTER_MATROX=m CONFIG_W1_MASTER_DS2490=m CONFIG_W1_MASTER_DS2482=m CONFIG_W1_MASTER_DS1WM=m -CONFIG_W1_MASTER_GPIO=m -# CONFIG_W1_MASTER_SGI is not set +# CONFIG_W1_MASTER_GPIO is not set +CONFIG_W1_MASTER_SGI=m # end of 1-wire Bus Masters # @@ -3927,10 +4587,10 @@ CONFIG_W1_SLAVE_DS2413=m CONFIG_W1_SLAVE_DS2406=m CONFIG_W1_SLAVE_DS2423=m # CONFIG_W1_SLAVE_DS2805 is not set -# CONFIG_W1_SLAVE_DS2430 is not set +CONFIG_W1_SLAVE_DS2430=m CONFIG_W1_SLAVE_DS2431=m CONFIG_W1_SLAVE_DS2433=m -CONFIG_W1_SLAVE_DS2433_CRC=y +# CONFIG_W1_SLAVE_DS2433_CRC is not set # CONFIG_W1_SLAVE_DS2438 is not set # CONFIG_W1_SLAVE_DS250X is not set CONFIG_W1_SLAVE_DS2780=m @@ -3940,42 +4600,65 @@ CONFIG_W1_SLAVE_DS28E04=m # end of 1-wire Slaves CONFIG_POWER_AVS=y +# CONFIG_QCOM_CPR is not set # CONFIG_POWER_RESET is not set CONFIG_POWER_SUPPLY=y # CONFIG_POWER_SUPPLY_DEBUG is not set CONFIG_POWER_SUPPLY_HWMON=y # CONFIG_PDA_POWER is not set +CONFIG_GENERIC_ADC_BATTERY=m +CONFIG_MAX8925_POWER=m +CONFIG_WM831X_BACKUP=m +CONFIG_WM831X_POWER=m +CONFIG_WM8350_POWER=m # CONFIG_TEST_POWER is not set -# CONFIG_CHARGER_ADP5061 is not set -# CONFIG_BATTERY_DS2760 is not set -# CONFIG_BATTERY_DS2780 is not set -# CONFIG_BATTERY_DS2781 is not set -# CONFIG_BATTERY_DS2782 is not set -# CONFIG_BATTERY_SBS is not set -# CONFIG_CHARGER_SBS is not set +CONFIG_BATTERY_88PM860X=m +CONFIG_CHARGER_ADP5061=m +CONFIG_BATTERY_DS2760=m +CONFIG_BATTERY_DS2780=m +CONFIG_BATTERY_DS2781=m +CONFIG_BATTERY_DS2782=m +CONFIG_BATTERY_SBS=m +CONFIG_CHARGER_SBS=m # CONFIG_MANAGER_SBS is not set CONFIG_BATTERY_BQ27XXX=m CONFIG_BATTERY_BQ27XXX_I2C=m CONFIG_BATTERY_BQ27XXX_HDQ=m # CONFIG_BATTERY_BQ27XXX_DT_UPDATES_NVM is not set +CONFIG_BATTERY_DA9030=m +CONFIG_BATTERY_DA9052=m +CONFIG_AXP20X_POWER=m +CONFIG_AXP288_CHARGER=m +CONFIG_AXP288_FUEL_GAUGE=m # CONFIG_BATTERY_MAX17040 is not set -# CONFIG_BATTERY_MAX17042 is not set +CONFIG_BATTERY_MAX17042=m # CONFIG_BATTERY_MAX1721X is not set -# CONFIG_CHARGER_ISP1704 is not set -# CONFIG_CHARGER_MAX8903 is not set -# CONFIG_CHARGER_LP8727 is not set +CONFIG_BATTERY_TWL4030_MADC=m +CONFIG_CHARGER_88PM860X=m +CONFIG_BATTERY_RX51=m +CONFIG_CHARGER_ISP1704=m +CONFIG_CHARGER_MAX8903=m +CONFIG_CHARGER_TWL4030=m +CONFIG_CHARGER_LP8727=m +CONFIG_CHARGER_LP8788=m CONFIG_CHARGER_GPIO=m -# CONFIG_CHARGER_LT3651 is not set +CONFIG_CHARGER_MANAGER=y +CONFIG_CHARGER_LT3651=m CONFIG_CHARGER_MAX14577=m +# CONFIG_CHARGER_MAX77693 is not set +CONFIG_CHARGER_MAX8997=m +CONFIG_CHARGER_MAX8998=m CONFIG_CHARGER_BQ2415X=m CONFIG_CHARGER_BQ24190=m -# CONFIG_CHARGER_BQ24257 is not set +CONFIG_CHARGER_BQ24257=m CONFIG_CHARGER_BQ24735=m -# CONFIG_CHARGER_BQ25890 is not set +CONFIG_CHARGER_BQ25890=m CONFIG_CHARGER_SMB347=m -CONFIG_BATTERY_GAUGE_LTC2941=m -# CONFIG_CHARGER_RT9455 is not set -# CONFIG_CHARGER_CROS_USBPD is not set +CONFIG_CHARGER_TPS65090=m +# CONFIG_BATTERY_GAUGE_LTC2941 is not set +CONFIG_CHARGER_RT9455=m +CONFIG_CHARGER_CROS_USBPD=m +CONFIG_CHARGER_WILCO=m CONFIG_HWMON=y CONFIG_HWMON_VID=m # CONFIG_HWMON_DEBUG_CHIP is not set @@ -3985,6 +4668,7 @@ CONFIG_HWMON_VID=m # CONFIG_SENSORS_ABITUGURU=m CONFIG_SENSORS_ABITUGURU3=m +CONFIG_SENSORS_AD7314=m CONFIG_SENSORS_AD7414=m CONFIG_SENSORS_AD7418=m CONFIG_SENSORS_ADM1021=m @@ -3992,66 +4676,82 @@ CONFIG_SENSORS_ADM1025=m CONFIG_SENSORS_ADM1026=m CONFIG_SENSORS_ADM1029=m CONFIG_SENSORS_ADM1031=m +CONFIG_SENSORS_ADM1177=m CONFIG_SENSORS_ADM9240=m CONFIG_SENSORS_ADT7X10=m +CONFIG_SENSORS_ADT7310=m CONFIG_SENSORS_ADT7410=m CONFIG_SENSORS_ADT7411=m CONFIG_SENSORS_ADT7462=m CONFIG_SENSORS_ADT7470=m CONFIG_SENSORS_ADT7475=m -# CONFIG_SENSORS_AS370 is not set +CONFIG_SENSORS_AS370=m CONFIG_SENSORS_ASC7621=m CONFIG_SENSORS_K8TEMP=m CONFIG_SENSORS_K10TEMP=m CONFIG_SENSORS_FAM15H_POWER=m CONFIG_SENSORS_APPLESMC=m CONFIG_SENSORS_ASB100=m -# CONFIG_SENSORS_ASPEED is not set +CONFIG_SENSORS_ASPEED=m CONFIG_SENSORS_ATXP1=m +CONFIG_SENSORS_DRIVETEMP=m CONFIG_SENSORS_DS620=m CONFIG_SENSORS_DS1621=m CONFIG_SENSORS_DELL_SMM=m +CONFIG_SENSORS_DA9052_ADC=m +CONFIG_SENSORS_DA9055=m CONFIG_SENSORS_I5K_AMB=m CONFIG_SENSORS_F71805F=m CONFIG_SENSORS_F71882FG=m CONFIG_SENSORS_F75375S=m +CONFIG_SENSORS_MC13783_ADC=m CONFIG_SENSORS_FSCHMD=m CONFIG_SENSORS_FTSTEUTATES=m CONFIG_SENSORS_GL518SM=m CONFIG_SENSORS_GL520SM=m -CONFIG_SENSORS_G760A=m +# CONFIG_SENSORS_G760A is not set CONFIG_SENSORS_G762=m CONFIG_SENSORS_HIH6130=m CONFIG_SENSORS_IBMAEM=m CONFIG_SENSORS_IBMPEX=m -# CONFIG_SENSORS_I5500 is not set +CONFIG_SENSORS_IIO_HWMON=m +CONFIG_SENSORS_I5500=m CONFIG_SENSORS_CORETEMP=m CONFIG_SENSORS_IT87=m -# CONFIG_SENSORS_JC42 is not set +CONFIG_SENSORS_JC42=m CONFIG_SENSORS_POWR1220=m CONFIG_SENSORS_LINEAGE=m CONFIG_SENSORS_LTC2945=m -# CONFIG_SENSORS_LTC2947_I2C is not set -# CONFIG_SENSORS_LTC2990 is not set +CONFIG_SENSORS_LTC2947=m +CONFIG_SENSORS_LTC2947_I2C=m +CONFIG_SENSORS_LTC2947_SPI=m +CONFIG_SENSORS_LTC2990=m CONFIG_SENSORS_LTC4151=m -CONFIG_SENSORS_LTC4215=m +# CONFIG_SENSORS_LTC4215 is not set CONFIG_SENSORS_LTC4222=m CONFIG_SENSORS_LTC4245=m CONFIG_SENSORS_LTC4260=m CONFIG_SENSORS_LTC4261=m +CONFIG_SENSORS_MAX1111=m CONFIG_SENSORS_MAX16065=m CONFIG_SENSORS_MAX1619=m CONFIG_SENSORS_MAX1668=m CONFIG_SENSORS_MAX197=m +CONFIG_SENSORS_MAX31722=m +CONFIG_SENSORS_MAX31730=m # CONFIG_SENSORS_MAX6621 is not set CONFIG_SENSORS_MAX6639=m CONFIG_SENSORS_MAX6642=m CONFIG_SENSORS_MAX6650=m -CONFIG_SENSORS_MAX6697=m +# CONFIG_SENSORS_MAX6697 is not set CONFIG_SENSORS_MAX31790=m CONFIG_SENSORS_MCP3021=m -# CONFIG_SENSORS_TC654 is not set +CONFIG_SENSORS_MLXREG_FAN=m +CONFIG_SENSORS_TC654=m +CONFIG_SENSORS_MENF21BMC_HWMON=m +CONFIG_SENSORS_ADCXX=m CONFIG_SENSORS_LM63=m +CONFIG_SENSORS_LM70=m CONFIG_SENSORS_LM73=m CONFIG_SENSORS_LM75=m CONFIG_SENSORS_LM77=m @@ -4071,42 +4771,45 @@ CONFIG_SENSORS_PC87427=m CONFIG_SENSORS_NTC_THERMISTOR=m CONFIG_SENSORS_NCT6683=m CONFIG_SENSORS_NCT6775=m -# CONFIG_SENSORS_NCT7802 is not set +CONFIG_SENSORS_NCT7802=m CONFIG_SENSORS_NCT7904=m -# CONFIG_SENSORS_NPCM7XX is not set +CONFIG_SENSORS_NPCM7XX=m CONFIG_SENSORS_PCF8591=m CONFIG_PMBUS=m CONFIG_SENSORS_PMBUS=m CONFIG_SENSORS_ADM1275=m # CONFIG_SENSORS_BEL_PFE is not set -# CONFIG_SENSORS_IBM_CFFPS is not set -# CONFIG_SENSORS_INSPUR_IPSPS is not set -# CONFIG_SENSORS_IR35221 is not set -# CONFIG_SENSORS_IR38064 is not set -# CONFIG_SENSORS_IRPS5401 is not set -# CONFIG_SENSORS_ISL68137 is not set +CONFIG_SENSORS_IBM_CFFPS=m +CONFIG_SENSORS_INSPUR_IPSPS=m +CONFIG_SENSORS_IR35221=m +CONFIG_SENSORS_IR38064=m +CONFIG_SENSORS_IRPS5401=m +CONFIG_SENSORS_ISL68137=m CONFIG_SENSORS_LM25066=m CONFIG_SENSORS_LTC2978=m -# CONFIG_SENSORS_LTC3815 is not set +CONFIG_SENSORS_LTC2978_REGULATOR=y +CONFIG_SENSORS_LTC3815=m CONFIG_SENSORS_MAX16064=m +CONFIG_SENSORS_MAX20730=m CONFIG_SENSORS_MAX20751=m # CONFIG_SENSORS_MAX31785 is not set CONFIG_SENSORS_MAX34440=m CONFIG_SENSORS_MAX8688=m -# CONFIG_SENSORS_PXE1610 is not set +CONFIG_SENSORS_PXE1610=m CONFIG_SENSORS_TPS40422=m -# CONFIG_SENSORS_TPS53679 is not set +CONFIG_SENSORS_TPS53679=m CONFIG_SENSORS_UCD9000=m CONFIG_SENSORS_UCD9200=m +CONFIG_SENSORS_XDPE122=m CONFIG_SENSORS_ZL6100=m -CONFIG_SENSORS_SHT15=m -CONFIG_SENSORS_SHT21=m -CONFIG_SENSORS_SHT3x=m +# CONFIG_SENSORS_SHT15 is not set +# CONFIG_SENSORS_SHT21 is not set +# CONFIG_SENSORS_SHT3x is not set CONFIG_SENSORS_SHTC1=m CONFIG_SENSORS_SIS5595=m CONFIG_SENSORS_DME1737=m CONFIG_SENSORS_EMC1403=m -# CONFIG_SENSORS_EMC2103 is not set +CONFIG_SENSORS_EMC2103=m CONFIG_SENSORS_EMC6W201=m CONFIG_SENSORS_SMSC47M1=m CONFIG_SENSORS_SMSC47M192=m @@ -4114,27 +4817,28 @@ CONFIG_SENSORS_SMSC47B397=m CONFIG_SENSORS_SCH56XX_COMMON=m CONFIG_SENSORS_SCH5627=m CONFIG_SENSORS_SCH5636=m -# CONFIG_SENSORS_STTS751 is not set -# CONFIG_SENSORS_SMM665 is not set +CONFIG_SENSORS_STTS751=m +CONFIG_SENSORS_SMM665=m CONFIG_SENSORS_ADC128D818=m -CONFIG_SENSORS_ADS7828=m -CONFIG_SENSORS_AMC6821=m +# CONFIG_SENSORS_ADS7828 is not set +CONFIG_SENSORS_ADS7871=m +# CONFIG_SENSORS_AMC6821 is not set CONFIG_SENSORS_INA209=m -CONFIG_SENSORS_INA2XX=m -CONFIG_SENSORS_INA3221=m -# CONFIG_SENSORS_TC74 is not set +# CONFIG_SENSORS_INA2XX is not set +# CONFIG_SENSORS_INA3221 is not set +CONFIG_SENSORS_TC74=m CONFIG_SENSORS_THMC50=m CONFIG_SENSORS_TMP102=m CONFIG_SENSORS_TMP103=m -# CONFIG_SENSORS_TMP108 is not set +CONFIG_SENSORS_TMP108=m CONFIG_SENSORS_TMP401=m CONFIG_SENSORS_TMP421=m -# CONFIG_SENSORS_TMP513 is not set +CONFIG_SENSORS_TMP513=m CONFIG_SENSORS_VIA_CPUTEMP=m CONFIG_SENSORS_VIA686A=m CONFIG_SENSORS_VT1211=m CONFIG_SENSORS_VT8231=m -# CONFIG_SENSORS_W83773G is not set +CONFIG_SENSORS_W83773G=m CONFIG_SENSORS_W83781D=m CONFIG_SENSORS_W83791D=m CONFIG_SENSORS_W83792D=m @@ -4145,7 +4849,9 @@ CONFIG_SENSORS_W83L785TS=m CONFIG_SENSORS_W83L786NG=m CONFIG_SENSORS_W83627HF=m CONFIG_SENSORS_W83627EHF=m -# CONFIG_SENSORS_XGENE is not set +CONFIG_SENSORS_WM831X=m +CONFIG_SENSORS_WM8350=m +CONFIG_SENSORS_XGENE=m # # ACPI drivers @@ -4164,14 +4870,14 @@ CONFIG_THERMAL_GOV_FAIR_SHARE=y CONFIG_THERMAL_GOV_STEP_WISE=y CONFIG_THERMAL_GOV_BANG_BANG=y CONFIG_THERMAL_GOV_USER_SPACE=y -# CONFIG_CLOCK_THERMAL is not set -# CONFIG_DEVFREQ_THERMAL is not set -# CONFIG_THERMAL_EMULATION is not set +CONFIG_CLOCK_THERMAL=y +CONFIG_DEVFREQ_THERMAL=y +CONFIG_THERMAL_EMULATION=y # # Intel thermal drivers # -# CONFIG_INTEL_POWERCLAMP is not set +CONFIG_INTEL_POWERCLAMP=m CONFIG_X86_PKG_TEMP_THERMAL=m CONFIG_INTEL_SOC_DTS_IOSF_CORE=m CONFIG_INTEL_SOC_DTS_THERMAL=m @@ -4179,53 +4885,61 @@ CONFIG_INTEL_SOC_DTS_THERMAL=m # # ACPI INT340X thermal drivers # -# CONFIG_INT340X_THERMAL is not set +CONFIG_INT340X_THERMAL=m +CONFIG_ACPI_THERMAL_REL=m +CONFIG_INT3406_THERMAL=m +CONFIG_PROC_THERMAL_MMIO_RAPL=y # end of ACPI INT340X thermal drivers +CONFIG_INTEL_BXT_PMIC_THERMAL=m CONFIG_INTEL_PCH_THERMAL=m # end of Intel thermal drivers +CONFIG_GENERIC_ADC_THERMAL=m CONFIG_WATCHDOG=y CONFIG_WATCHDOG_CORE=y -# CONFIG_WATCHDOG_NOWAYOUT is not set +CONFIG_WATCHDOG_NOWAYOUT=y CONFIG_WATCHDOG_HANDLE_BOOT_ENABLED=y CONFIG_WATCHDOG_OPEN_TIMEOUT=0 -# CONFIG_WATCHDOG_SYSFS is not set +CONFIG_WATCHDOG_SYSFS=y # # Watchdog Pretimeout Governors # -CONFIG_WATCHDOG_PRETIMEOUT_GOV=y -CONFIG_WATCHDOG_PRETIMEOUT_GOV_SEL=m -CONFIG_WATCHDOG_PRETIMEOUT_GOV_NOOP=m -CONFIG_WATCHDOG_PRETIMEOUT_GOV_PANIC=y -# CONFIG_WATCHDOG_PRETIMEOUT_DEFAULT_GOV_NOOP is not set -CONFIG_WATCHDOG_PRETIMEOUT_DEFAULT_GOV_PANIC=y +# CONFIG_WATCHDOG_PRETIMEOUT_GOV is not set # # Watchdog Device Drivers # CONFIG_SOFT_WATCHDOG=m -# CONFIG_SOFT_WATCHDOG_PRETIMEOUT is not set +CONFIG_DA9052_WATCHDOG=m +CONFIG_DA9055_WATCHDOG=m +CONFIG_DA9063_WATCHDOG=m +CONFIG_DA9062_WATCHDOG=m +CONFIG_MENF21BMC_WATCHDOG=m CONFIG_WDAT_WDT=m +CONFIG_WM831X_WATCHDOG=m +CONFIG_WM8350_WATCHDOG=m # CONFIG_XILINX_WATCHDOG is not set -# CONFIG_ZIIRAVE_WATCHDOG is not set -CONFIG_CADENCE_WATCHDOG=m +CONFIG_ZIIRAVE_WATCHDOG=m +CONFIG_MLX_WDT=m +# CONFIG_CADENCE_WATCHDOG is not set CONFIG_DW_WATCHDOG=m -# CONFIG_MAX63XX_WATCHDOG is not set +CONFIG_TWL4030_WATCHDOG=m +CONFIG_MAX63XX_WATCHDOG=m CONFIG_RETU_WATCHDOG=m -# CONFIG_ACQUIRE_WDT is not set -# CONFIG_ADVANTECH_WDT is not set +CONFIG_ACQUIRE_WDT=m +CONFIG_ADVANTECH_WDT=m CONFIG_ALIM1535_WDT=m CONFIG_ALIM7101_WDT=m -# CONFIG_EBC_C384_WDT is not set +CONFIG_EBC_C384_WDT=m CONFIG_F71808E_WDT=m -# CONFIG_SP5100_TCO is not set +CONFIG_SP5100_TCO=m CONFIG_SBC_FITPC2_WATCHDOG=m -# CONFIG_EUROTECH_WDT is not set +CONFIG_EUROTECH_WDT=m CONFIG_IB700_WDT=m CONFIG_IBMASR=m -# CONFIG_WAFER_WDT is not set +CONFIG_WAFER_WDT=m CONFIG_I6300ESB_WDT=m CONFIG_IE6XX_WDT=m CONFIG_ITCO_WDT=m @@ -4233,24 +4947,25 @@ CONFIG_ITCO_VENDOR_SUPPORT=y CONFIG_IT8712F_WDT=m CONFIG_IT87_WDT=m CONFIG_HP_WATCHDOG=m -CONFIG_HPWDT_NMI_DECODING=y -# CONFIG_SC1200_WDT is not set -# CONFIG_PC87413_WDT is not set +# CONFIG_HPWDT_NMI_DECODING is not set +CONFIG_KEMPLD_WDT=m +CONFIG_SC1200_WDT=m +CONFIG_PC87413_WDT=m CONFIG_NV_TCO=m -# CONFIG_60XX_WDT is not set -# CONFIG_CPU5_WDT is not set +CONFIG_60XX_WDT=m +CONFIG_CPU5_WDT=m CONFIG_SMSC_SCH311X_WDT=m -# CONFIG_SMSC37B787_WDT is not set +CONFIG_SMSC37B787_WDT=m # CONFIG_TQMX86_WDT is not set CONFIG_VIA_WDT=m CONFIG_W83627HF_WDT=m CONFIG_W83877F_WDT=m CONFIG_W83977F_WDT=m CONFIG_MACHZ_WDT=m -# CONFIG_SBC_EPX_C3_WATCHDOG is not set -# CONFIG_INTEL_MEI_WDT is not set -# CONFIG_NI903X_WDT is not set -# CONFIG_NIC7018_WDT is not set +CONFIG_SBC_EPX_C3_WATCHDOG=m +CONFIG_INTEL_MEI_WDT=m +CONFIG_NI903X_WDT=m +CONFIG_NIC7018_WDT=m CONFIG_MEN_A21_WDT=m CONFIG_XEN_WDT=m @@ -4283,8 +4998,9 @@ CONFIG_BCMA=m CONFIG_BCMA_BLOCKIO=y CONFIG_BCMA_HOST_PCI_POSSIBLE=y CONFIG_BCMA_HOST_PCI=y -# CONFIG_BCMA_HOST_SOC is not set +CONFIG_BCMA_HOST_SOC=y CONFIG_BCMA_DRIVER_PCI=y +CONFIG_BCMA_SFLASH=y CONFIG_BCMA_DRIVER_GMAC_CMN=y CONFIG_BCMA_DRIVER_GPIO=y # CONFIG_BCMA_DEBUG is not set @@ -4292,67 +5008,205 @@ CONFIG_BCMA_DRIVER_GPIO=y # # Multifunction device drivers # -CONFIG_MFD_CORE=m +CONFIG_MFD_CORE=y +CONFIG_MFD_AS3711=y +CONFIG_PMIC_ADP5520=y +CONFIG_MFD_AAT2870_CORE=y CONFIG_MFD_BCM590XX=m -# CONFIG_MFD_BD9571MWV is not set -# CONFIG_MFD_AXP20X_I2C is not set +CONFIG_MFD_BD9571MWV=m +CONFIG_MFD_AXP20X=m +CONFIG_MFD_AXP20X_I2C=m CONFIG_MFD_CROS_EC_DEV=m -# CONFIG_MFD_MADERA is not set -# CONFIG_MFD_DA9062 is not set -# CONFIG_MFD_DA9063 is not set +CONFIG_MFD_MADERA=m +CONFIG_MFD_MADERA_I2C=m +CONFIG_MFD_MADERA_SPI=m +CONFIG_MFD_CS47L15=y +CONFIG_MFD_CS47L35=y +CONFIG_MFD_CS47L85=y +CONFIG_MFD_CS47L90=y +CONFIG_MFD_CS47L92=y +CONFIG_PMIC_DA903X=y +CONFIG_PMIC_DA9052=y +CONFIG_MFD_DA9052_SPI=y +CONFIG_MFD_DA9052_I2C=y +CONFIG_MFD_DA9055=y +CONFIG_MFD_DA9062=m +CONFIG_MFD_DA9063=y # CONFIG_MFD_DA9150 is not set -# CONFIG_MFD_DLN2 is not set +CONFIG_MFD_DLN2=m +CONFIG_MFD_MC13XXX=m +CONFIG_MFD_MC13XXX_SPI=m # CONFIG_MFD_MC13XXX_I2C is not set # CONFIG_HTC_PASIC3 is not set +CONFIG_HTC_I2CPLD=y CONFIG_MFD_INTEL_QUARK_I2C_GPIO=m CONFIG_LPC_ICH=m CONFIG_LPC_SCH=m -# CONFIG_INTEL_SOC_PMIC_CHTDC_TI is not set +CONFIG_INTEL_SOC_PMIC=y +CONFIG_INTEL_SOC_PMIC_BXTWC=m +CONFIG_INTEL_SOC_PMIC_CHTWC=y +CONFIG_INTEL_SOC_PMIC_CHTDC_TI=m CONFIG_MFD_INTEL_LPSS=m CONFIG_MFD_INTEL_LPSS_ACPI=m CONFIG_MFD_INTEL_LPSS_PCI=m # CONFIG_MFD_JANZ_CMODIO is not set -# CONFIG_MFD_KEMPLD is not set -# CONFIG_MFD_88PM800 is not set -# CONFIG_MFD_88PM805 is not set -CONFIG_MFD_MAX14577=m -# CONFIG_MFD_MAX77693 is not set -# CONFIG_MFD_MAX8907 is not set -CONFIG_MFD_MT6397=m -# CONFIG_MFD_MENF21BMC is not set +CONFIG_MFD_KEMPLD=m +CONFIG_MFD_88PM800=m +CONFIG_MFD_88PM805=m +CONFIG_MFD_88PM860X=y +CONFIG_MFD_MAX14577=y +CONFIG_MFD_MAX77693=y +# CONFIG_MFD_MAX77843 is not set +CONFIG_MFD_MAX8907=m +CONFIG_MFD_MAX8925=y +CONFIG_MFD_MAX8997=y +CONFIG_MFD_MAX8998=y +# CONFIG_MFD_MT6397 is not set +CONFIG_MFD_MENF21BMC=m +CONFIG_EZX_PCAP=y CONFIG_MFD_VIPERBOARD=m CONFIG_MFD_RETU=m # CONFIG_MFD_PCF50633 is not set -CONFIG_UCB1400_CORE=m +# CONFIG_UCB1400_CORE is not set CONFIG_MFD_RDC321X=m # CONFIG_MFD_RT5033 is not set +CONFIG_MFD_RC5T583=y +CONFIG_MFD_SEC_CORE=y CONFIG_MFD_SI476X_CORE=m -CONFIG_MFD_SM501=m -CONFIG_MFD_SM501_GPIO=y -CONFIG_MFD_SKY81452=m +# CONFIG_MFD_SM501 is not set +# CONFIG_MFD_SKY81452 is not set +CONFIG_MFD_SMSC=y # CONFIG_ABX500_CORE is not set CONFIG_MFD_SYSCON=y CONFIG_MFD_TI_AM335X_TSCADC=m CONFIG_MFD_LP3943=m -# CONFIG_MFD_TI_LMU is not set +CONFIG_MFD_LP8788=y +CONFIG_MFD_TI_LMU=m +CONFIG_MFD_PALMAS=y # CONFIG_TPS6105X is not set -CONFIG_TPS65010=m +# CONFIG_TPS65010 is not set # CONFIG_TPS6507X is not set -# CONFIG_MFD_TPS65086 is not set -CONFIG_MFD_TI_LP873X=m -# CONFIG_MFD_TPS65912_I2C is not set +CONFIG_MFD_TPS65086=m +CONFIG_MFD_TPS65090=y +CONFIG_MFD_TPS68470=y +# CONFIG_MFD_TI_LP873X is not set +CONFIG_MFD_TPS6586X=y +CONFIG_MFD_TPS65910=y +CONFIG_MFD_TPS65912=y +CONFIG_MFD_TPS65912_I2C=y +CONFIG_MFD_TPS65912_SPI=y +CONFIG_MFD_TPS80031=y +CONFIG_TWL4030_CORE=y +CONFIG_MFD_TWL4030_AUDIO=y +CONFIG_TWL6040_CORE=y CONFIG_MFD_WL1273_CORE=m # CONFIG_MFD_LM3533 is not set # CONFIG_MFD_TQMX86 is not set CONFIG_MFD_VX855=m -# CONFIG_MFD_ARIZONA_I2C is not set -# CONFIG_MFD_WM8994 is not set +CONFIG_MFD_ARIZONA=y +CONFIG_MFD_ARIZONA_I2C=m +CONFIG_MFD_ARIZONA_SPI=m +CONFIG_MFD_CS47L24=y +CONFIG_MFD_WM5102=y +CONFIG_MFD_WM5110=y +CONFIG_MFD_WM8997=y +# CONFIG_MFD_WM8998 is not set +CONFIG_MFD_WM8400=y +CONFIG_MFD_WM831X=y +CONFIG_MFD_WM831X_I2C=y +CONFIG_MFD_WM831X_SPI=y +CONFIG_MFD_WM8350=y +CONFIG_MFD_WM8350_I2C=y +CONFIG_MFD_WM8994=y +# CONFIG_RAVE_SP_CORE is not set # end of Multifunction device drivers -# CONFIG_REGULATOR is not set +CONFIG_REGULATOR=y +# CONFIG_REGULATOR_DEBUG is not set +CONFIG_REGULATOR_FIXED_VOLTAGE=m +CONFIG_REGULATOR_VIRTUAL_CONSUMER=m +CONFIG_REGULATOR_USERSPACE_CONSUMER=m +# CONFIG_REGULATOR_88PG86X is not set +CONFIG_REGULATOR_88PM800=m +CONFIG_REGULATOR_88PM8607=m +CONFIG_REGULATOR_ACT8865=m +CONFIG_REGULATOR_AD5398=m +CONFIG_REGULATOR_ANATOP=m +CONFIG_REGULATOR_AAT2870=m +# CONFIG_REGULATOR_ARIZONA_LDO1 is not set +# CONFIG_REGULATOR_ARIZONA_MICSUPP is not set +CONFIG_REGULATOR_AS3711=m +CONFIG_REGULATOR_AXP20X=m +CONFIG_REGULATOR_BCM590XX=m +CONFIG_REGULATOR_BD9571MWV=m +CONFIG_REGULATOR_DA903X=m +CONFIG_REGULATOR_DA9052=m +CONFIG_REGULATOR_DA9055=m +CONFIG_REGULATOR_DA9062=m +CONFIG_REGULATOR_DA9210=m +CONFIG_REGULATOR_DA9211=m +CONFIG_REGULATOR_FAN53555=m +CONFIG_REGULATOR_GPIO=m +CONFIG_REGULATOR_ISL9305=m +CONFIG_REGULATOR_ISL6271A=m +# CONFIG_REGULATOR_LM363X is not set +CONFIG_REGULATOR_LP3971=m +CONFIG_REGULATOR_LP3972=m +CONFIG_REGULATOR_LP872X=m +CONFIG_REGULATOR_LP8755=m +CONFIG_REGULATOR_LP8788=m +CONFIG_REGULATOR_LTC3589=m +# CONFIG_REGULATOR_LTC3676 is not set +CONFIG_REGULATOR_MAX14577=m +CONFIG_REGULATOR_MAX1586=m +CONFIG_REGULATOR_MAX8649=m +CONFIG_REGULATOR_MAX8660=m +CONFIG_REGULATOR_MAX8907=m +CONFIG_REGULATOR_MAX8925=m +CONFIG_REGULATOR_MAX8952=m +CONFIG_REGULATOR_MAX8997=m +CONFIG_REGULATOR_MAX8998=m +CONFIG_REGULATOR_MAX77693=m +CONFIG_REGULATOR_MC13XXX_CORE=m +CONFIG_REGULATOR_MC13783=m +CONFIG_REGULATOR_MC13892=m +CONFIG_REGULATOR_MP8859=m +CONFIG_REGULATOR_MT6311=m +CONFIG_REGULATOR_PALMAS=m +CONFIG_REGULATOR_PCAP=m +CONFIG_REGULATOR_PFUZE100=m +CONFIG_REGULATOR_PV88060=m +CONFIG_REGULATOR_PV88080=m +CONFIG_REGULATOR_PV88090=m +CONFIG_REGULATOR_PWM=m +CONFIG_REGULATOR_QCOM_SPMI=m +CONFIG_REGULATOR_RC5T583=m +CONFIG_REGULATOR_S2MPA01=m +CONFIG_REGULATOR_S2MPS11=m +CONFIG_REGULATOR_S5M8767=m +# CONFIG_REGULATOR_SLG51000 is not set +CONFIG_REGULATOR_TPS51632=m +CONFIG_REGULATOR_TPS62360=m +CONFIG_REGULATOR_TPS65023=m +CONFIG_REGULATOR_TPS6507X=m +CONFIG_REGULATOR_TPS65086=m +CONFIG_REGULATOR_TPS65090=m +# CONFIG_REGULATOR_TPS65132 is not set +CONFIG_REGULATOR_TPS6524X=m +CONFIG_REGULATOR_TPS6586X=m +CONFIG_REGULATOR_TPS65910=m +CONFIG_REGULATOR_TPS65912=m +CONFIG_REGULATOR_TPS80031=m +CONFIG_REGULATOR_TWL4030=m +CONFIG_REGULATOR_WM831X=m +CONFIG_REGULATOR_WM8350=m +CONFIG_REGULATOR_WM8400=m +CONFIG_REGULATOR_WM8994=m +CONFIG_CEC_CORE=m +CONFIG_CEC_NOTIFIER=y CONFIG_RC_CORE=m CONFIG_RC_MAP=m -# CONFIG_LIRC is not set +CONFIG_LIRC=y CONFIG_RC_DECODERS=y CONFIG_IR_NEC_DECODER=m CONFIG_IR_RC5_DECODER=m @@ -4363,13 +5217,13 @@ CONFIG_IR_SANYO_DECODER=m CONFIG_IR_SHARP_DECODER=m CONFIG_IR_MCE_KBD_DECODER=m CONFIG_IR_XMP_DECODER=m -# CONFIG_IR_IMON_DECODER is not set -# CONFIG_IR_RCMM_DECODER is not set +CONFIG_IR_IMON_DECODER=m +CONFIG_IR_RCMM_DECODER=m CONFIG_RC_DEVICES=y CONFIG_RC_ATI_REMOTE=m CONFIG_IR_ENE=m CONFIG_IR_IMON=m -# CONFIG_IR_IMON_RAW is not set +CONFIG_IR_IMON_RAW=m CONFIG_IR_MCEUSB=m CONFIG_IR_ITE_CIR=m CONFIG_IR_FINTEK=m @@ -4377,13 +5231,14 @@ CONFIG_IR_NUVOTON=m CONFIG_IR_REDRAT3=m CONFIG_IR_STREAMZAP=m CONFIG_IR_WINBOND_CIR=m -# CONFIG_IR_IGORPLUGUSB is not set +CONFIG_IR_IGORPLUGUSB=m CONFIG_IR_IGUANA=m CONFIG_IR_TTUSBIR=m CONFIG_RC_LOOPBACK=m -# CONFIG_IR_SERIAL is not set -# CONFIG_IR_SIR is not set -# CONFIG_RC_XBOX_DVD is not set +CONFIG_IR_SERIAL=m +CONFIG_IR_SERIAL_TRANSMITTER=y +CONFIG_IR_SIR=m +CONFIG_RC_XBOX_DVD=m CONFIG_MEDIA_SUPPORT=m # @@ -4394,19 +5249,19 @@ CONFIG_MEDIA_ANALOG_TV_SUPPORT=y CONFIG_MEDIA_DIGITAL_TV_SUPPORT=y CONFIG_MEDIA_RADIO_SUPPORT=y CONFIG_MEDIA_SDR_SUPPORT=y -# CONFIG_MEDIA_CEC_SUPPORT is not set +CONFIG_MEDIA_CEC_SUPPORT=y +# CONFIG_MEDIA_CEC_RC is not set CONFIG_MEDIA_CONTROLLER=y CONFIG_MEDIA_CONTROLLER_DVB=y -# CONFIG_MEDIA_CONTROLLER_REQUEST_API is not set +CONFIG_MEDIA_CONTROLLER_REQUEST_API=y CONFIG_VIDEO_DEV=m -CONFIG_VIDEO_V4L2_SUBDEV_API=y +# CONFIG_VIDEO_V4L2_SUBDEV_API is not set CONFIG_VIDEO_V4L2=m CONFIG_VIDEO_V4L2_I2C=y # CONFIG_VIDEO_ADV_DEBUG is not set # CONFIG_VIDEO_FIXED_MINOR_RANGES is not set CONFIG_VIDEO_TUNER=m CONFIG_V4L2_MEM2MEM_DEV=m -# CONFIG_V4L2_FLASH_LED_CLASS is not set CONFIG_V4L2_FWNODE=m CONFIG_VIDEOBUF_GEN=m CONFIG_VIDEOBUF_DMA_SG=m @@ -4416,7 +5271,7 @@ CONFIG_DVB_CORE=m CONFIG_DVB_NET=y CONFIG_TTPCI_EEPROM=m CONFIG_DVB_MAX_ADAPTERS=8 -CONFIG_DVB_DYNAMIC_MINORS=y +# CONFIG_DVB_DYNAMIC_MINORS is not set # CONFIG_DVB_DEMUX_SECTION_LOSS_LOG is not set # CONFIG_DVB_ULE_DEBUG is not set @@ -4500,7 +5355,10 @@ CONFIG_VIDEO_HDPVR=m CONFIG_VIDEO_USBVISION=m CONFIG_VIDEO_STK1160_COMMON=m CONFIG_VIDEO_STK1160=m -# CONFIG_VIDEO_GO7007 is not set +CONFIG_VIDEO_GO7007=m +CONFIG_VIDEO_GO7007_USB=m +CONFIG_VIDEO_GO7007_LOADER=m +CONFIG_VIDEO_GO7007_USB_S2250_BOARD=m # # Analog/digital TV USB devices @@ -4559,14 +5417,14 @@ CONFIG_DVB_USB_GL861=m CONFIG_DVB_USB_LME2510=m CONFIG_DVB_USB_MXL111SF=m CONFIG_DVB_USB_RTL28XXU=m -# CONFIG_DVB_USB_DVBSKY is not set -# CONFIG_DVB_USB_ZD1301 is not set +CONFIG_DVB_USB_DVBSKY=m +CONFIG_DVB_USB_ZD1301=m CONFIG_DVB_TTUSB_BUDGET=m -CONFIG_DVB_TTUSB_DEC=m +# CONFIG_DVB_TTUSB_DEC is not set CONFIG_SMS_USB_DRV=m CONFIG_DVB_B2C2_FLEXCOP_USB=m # CONFIG_DVB_B2C2_FLEXCOP_USB_DEBUG is not set -# CONFIG_DVB_AS102 is not set +CONFIG_DVB_AS102=m # # Webcam, TV (analog/digital) USB devices @@ -4581,7 +5439,14 @@ CONFIG_VIDEO_EM28XX_RC=m # Software defined radio USB devices # CONFIG_USB_AIRSPY=m -# CONFIG_USB_HACKRF is not set +CONFIG_USB_HACKRF=m +CONFIG_USB_MSI2500=m + +# +# USB HDMI CEC adapters +# +CONFIG_USB_PULSE8_CEC=m +CONFIG_USB_RAINSHADOW_CEC=m CONFIG_MEDIA_PCI_SUPPORT=y # @@ -4590,8 +5455,8 @@ CONFIG_MEDIA_PCI_SUPPORT=y CONFIG_VIDEO_MEYE=m CONFIG_VIDEO_SOLO6X10=m CONFIG_VIDEO_TW5864=m -# CONFIG_VIDEO_TW68 is not set -# CONFIG_VIDEO_TW686X is not set +CONFIG_VIDEO_TW68=m +CONFIG_VIDEO_TW686X=m # # Media capture/analog TV support @@ -4604,7 +5469,7 @@ CONFIG_VIDEO_FB_IVTV=m CONFIG_VIDEO_HEXIUM_GEMINI=m CONFIG_VIDEO_HEXIUM_ORION=m CONFIG_VIDEO_MXB=m -# CONFIG_VIDEO_DT3155 is not set +CONFIG_VIDEO_DT3155=m # # Media capture/analog/hybrid TV support @@ -4613,7 +5478,8 @@ CONFIG_VIDEO_CX18=m CONFIG_VIDEO_CX18_ALSA=m CONFIG_VIDEO_CX23885=m CONFIG_MEDIA_ALTERA_CI=m -# CONFIG_VIDEO_CX25821 is not set +CONFIG_VIDEO_CX25821=m +CONFIG_VIDEO_CX25821_ALSA=m CONFIG_VIDEO_CX88=m CONFIG_VIDEO_CX88_ALSA=m CONFIG_VIDEO_CX88_BLACKBIRD=m @@ -4627,6 +5493,7 @@ CONFIG_VIDEO_SAA7134=m CONFIG_VIDEO_SAA7134_ALSA=m CONFIG_VIDEO_SAA7134_RC=y CONFIG_VIDEO_SAA7134_DVB=m +CONFIG_VIDEO_SAA7134_GO7007=m CONFIG_VIDEO_SAA7164=m # @@ -4645,25 +5512,33 @@ CONFIG_DVB_B2C2_FLEXCOP_PCI=m CONFIG_DVB_PLUTO2=m CONFIG_DVB_DM1105=m CONFIG_DVB_PT1=m -# CONFIG_DVB_PT3 is not set +CONFIG_DVB_PT3=m CONFIG_MANTIS_CORE=m CONFIG_DVB_MANTIS=m CONFIG_DVB_HOPPER=m CONFIG_DVB_NGENE=m CONFIG_DVB_DDBRIDGE=m # CONFIG_DVB_DDBRIDGE_MSIENABLE is not set -# CONFIG_DVB_SMIPCIE is not set -# CONFIG_VIDEO_IPU3_CIO2 is not set -# CONFIG_V4L_PLATFORM_DRIVERS is not set +CONFIG_DVB_SMIPCIE=m +CONFIG_DVB_NETUP_UNIDVB=m +CONFIG_V4L_PLATFORM_DRIVERS=y +CONFIG_VIDEO_CAFE_CCIC=m +CONFIG_VIDEO_VIA_CAMERA=m +CONFIG_VIDEO_CADENCE=y +CONFIG_VIDEO_ASPEED=m CONFIG_V4L_MEM2MEM_DRIVERS=y CONFIG_VIDEO_MEM2MEM_DEINTERLACE=m CONFIG_VIDEO_SH_VEU=m CONFIG_V4L_TEST_DRIVERS=y -# CONFIG_VIDEO_VIMC is not set -# CONFIG_VIDEO_VIVID is not set -# CONFIG_VIDEO_VIM2M is not set -# CONFIG_VIDEO_VICODEC is not set +CONFIG_VIDEO_VIVID=m +# CONFIG_VIDEO_VIVID_CEC is not set +CONFIG_VIDEO_VIVID_MAX_DEVS=64 +CONFIG_VIDEO_VIM2M=m +CONFIG_VIDEO_VICODEC=m CONFIG_DVB_PLATFORM_DRIVERS=y +CONFIG_CEC_PLATFORM_DRIVERS=y +CONFIG_VIDEO_CROS_EC_CEC=m +# CONFIG_VIDEO_SECO_CEC is not set # CONFIG_SDR_PLATFORM_DRIVERS is not set # @@ -4674,11 +5549,9 @@ CONFIG_RADIO_ADAPTERS=y CONFIG_RADIO_TEA575X=m CONFIG_RADIO_SI470X=m CONFIG_USB_SI470X=m -CONFIG_I2C_SI470X=m -CONFIG_RADIO_SI4713=m -CONFIG_USB_SI4713=m -CONFIG_PLATFORM_SI4713=m -CONFIG_I2C_SI4713=m +# CONFIG_I2C_SI470X is not set +# CONFIG_RADIO_SI4713 is not set +# CONFIG_RADIO_SI476X is not set CONFIG_USB_MR800=m CONFIG_USB_DSBR=m CONFIG_RADIO_MAXIRADIO=m @@ -4689,7 +5562,7 @@ CONFIG_USB_RAREMONO=m CONFIG_USB_MA901=m CONFIG_RADIO_TEA5764=m CONFIG_RADIO_SAA7706H=m -# CONFIG_RADIO_TEF6862 is not set +CONFIG_RADIO_TEF6862=m CONFIG_RADIO_WL1273=m # @@ -4724,17 +5597,17 @@ CONFIG_VIDEO_SAA7146_VV=m CONFIG_SMS_SIANO_MDTV=m CONFIG_SMS_SIANO_RC=y # CONFIG_SMS_SIANO_DEBUGFS is not set +CONFIG_VIDEO_V4L2_TPG=m # # Media ancillary drivers (tuners, sensors, i2c, spi, frontends) # CONFIG_MEDIA_SUBDRV_AUTOSELECT=y -CONFIG_MEDIA_HIDE_ANCILLARY_SUBDRV=y CONFIG_MEDIA_ATTACH=y CONFIG_VIDEO_IR_I2C=m # -# I2C drivers hidden by 'Autoselect ancillary drivers' +# I2C Encoders, decoders, sensors and other helper chips # # @@ -4749,9 +5622,12 @@ CONFIG_VIDEO_MSP3400=m CONFIG_VIDEO_CS3308=m CONFIG_VIDEO_CS5345=m CONFIG_VIDEO_CS53L32A=m +CONFIG_VIDEO_TLV320AIC23B=m +CONFIG_VIDEO_UDA1342=m CONFIG_VIDEO_WM8775=m CONFIG_VIDEO_WM8739=m CONFIG_VIDEO_VP27SMPX=m +CONFIG_VIDEO_SONY_BTF_MPX=m # # RDS decoders @@ -4761,8 +5637,22 @@ CONFIG_VIDEO_SAA6588=m # # Video decoders # +CONFIG_VIDEO_ADV7183=m +CONFIG_VIDEO_BT819=m +CONFIG_VIDEO_BT856=m +CONFIG_VIDEO_BT866=m +CONFIG_VIDEO_KS0127=m +CONFIG_VIDEO_ML86V7667=m +CONFIG_VIDEO_SAA7110=m CONFIG_VIDEO_SAA711X=m +CONFIG_VIDEO_TVP514X=m CONFIG_VIDEO_TVP5150=m +CONFIG_VIDEO_TVP7002=m +CONFIG_VIDEO_TW2804=m +CONFIG_VIDEO_TW9903=m +CONFIG_VIDEO_TW9906=m +CONFIG_VIDEO_TW9910=m +CONFIG_VIDEO_VPX3220=m # # Video and audio decoders @@ -4774,20 +5664,47 @@ CONFIG_VIDEO_CX25840=m # Video encoders # CONFIG_VIDEO_SAA7127=m +CONFIG_VIDEO_SAA7185=m +CONFIG_VIDEO_ADV7170=m +CONFIG_VIDEO_ADV7175=m +CONFIG_VIDEO_ADV7343=m +CONFIG_VIDEO_ADV7393=m +CONFIG_VIDEO_AK881X=m +CONFIG_VIDEO_THS8200=m # # Camera sensor devices # CONFIG_VIDEO_OV2640=m +CONFIG_VIDEO_OV2659=m +CONFIG_VIDEO_OV2680=m +CONFIG_VIDEO_OV2685=m +CONFIG_VIDEO_OV6650=m +CONFIG_VIDEO_OV5695=m +CONFIG_VIDEO_OV772X=m +CONFIG_VIDEO_OV7640=m +CONFIG_VIDEO_OV7670=m +CONFIG_VIDEO_OV7740=m +CONFIG_VIDEO_OV9640=m +CONFIG_VIDEO_VS6624=m +CONFIG_VIDEO_MT9M111=m +CONFIG_VIDEO_MT9T112=m CONFIG_VIDEO_MT9V011=m +CONFIG_VIDEO_MT9V111=m +CONFIG_VIDEO_SR030PC30=m +CONFIG_VIDEO_RJ54N1=m # # Lens drivers # +# CONFIG_VIDEO_AD5820 is not set # # Flash devices # +# CONFIG_VIDEO_ADP1653 is not set +# CONFIG_VIDEO_LM3560 is not set +# CONFIG_VIDEO_LM3646 is not set # # Video improvement chips @@ -4803,19 +5720,31 @@ CONFIG_VIDEO_SAA6752HS=m # # SDR tuner chips # +CONFIG_SDR_MAX2175=m # # Miscellaneous helper chips # +CONFIG_VIDEO_THS7303=m CONFIG_VIDEO_M52790=m +CONFIG_VIDEO_I2C=m +# end of I2C Encoders, decoders, sensors and other helper chips # -# SPI drivers hidden by 'Autoselect ancillary drivers' +# SPI helper chips # +# end of SPI helper chips + +# +# Media SPI Adapters +# +# CONFIG_CXD2880_SPI_DRV is not set +# end of Media SPI Adapters + CONFIG_MEDIA_TUNER=m # -# Tuner drivers hidden by 'Autoselect ancillary drivers' +# Customize TV tuners # CONFIG_MEDIA_TUNER_SIMPLE=m CONFIG_MEDIA_TUNER_TDA18250=m @@ -4825,6 +5754,7 @@ CONFIG_MEDIA_TUNER_TDA18271=m CONFIG_MEDIA_TUNER_TDA9887=m CONFIG_MEDIA_TUNER_TEA5761=m CONFIG_MEDIA_TUNER_TEA5767=m +CONFIG_MEDIA_TUNER_MSI001=m CONFIG_MEDIA_TUNER_MT20XX=m CONFIG_MEDIA_TUNER_MT2060=m CONFIG_MEDIA_TUNER_MT2063=m @@ -4850,11 +5780,13 @@ CONFIG_MEDIA_TUNER_TUA9001=m CONFIG_MEDIA_TUNER_SI2157=m CONFIG_MEDIA_TUNER_IT913X=m CONFIG_MEDIA_TUNER_R820T=m +CONFIG_MEDIA_TUNER_MXL301RF=m CONFIG_MEDIA_TUNER_QM1D1C0042=m CONFIG_MEDIA_TUNER_QM1D1B0004=m +# end of Customize TV tuners # -# DVB Frontend drivers hidden by 'Autoselect ancillary drivers' +# Customise DVB Frontends # # @@ -4916,6 +5848,7 @@ CONFIG_DVB_SP8870=m CONFIG_DVB_SP887X=m CONFIG_DVB_CX22700=m CONFIG_DVB_CX22702=m +CONFIG_DVB_S5H1432=m CONFIG_DVB_DRXD=m CONFIG_DVB_L64781=m CONFIG_DVB_TDA1004X=m @@ -4926,6 +5859,7 @@ CONFIG_DVB_DIB3000MB=m CONFIG_DVB_DIB3000MC=m CONFIG_DVB_DIB7000M=m CONFIG_DVB_DIB7000P=m +CONFIG_DVB_DIB9000=m CONFIG_DVB_TDA10048=m CONFIG_DVB_AF9013=m CONFIG_DVB_EC100=m @@ -4936,7 +5870,10 @@ CONFIG_DVB_RTL2830=m CONFIG_DVB_RTL2832=m CONFIG_DVB_RTL2832_SDR=m CONFIG_DVB_SI2168=m +CONFIG_DVB_AS102_FE=m +CONFIG_DVB_ZD1301_DEMOD=m CONFIG_DVB_GP8PSK_FE=m +CONFIG_DVB_CXD2880=m # # DVB-C (cable) frontends @@ -4974,6 +5911,7 @@ CONFIG_DVB_MB86A20S=m # ISDB-S (satellite) & ISDB-T (terrestrial) frontends # CONFIG_DVB_TC90522=m +CONFIG_DVB_MN88443X=m # # Digital terrestrial only tuners/PLL @@ -4987,28 +5925,35 @@ CONFIG_DVB_TUNER_DIB0090=m # CONFIG_DVB_DRX39XYJ=m CONFIG_DVB_LNBH25=m +# CONFIG_DVB_LNBH29 is not set CONFIG_DVB_LNBP21=m CONFIG_DVB_LNBP22=m CONFIG_DVB_ISL6405=m CONFIG_DVB_ISL6421=m CONFIG_DVB_ISL6423=m CONFIG_DVB_A8293=m +CONFIG_DVB_LGS8GL5=m CONFIG_DVB_LGS8GXX=m CONFIG_DVB_ATBM8830=m CONFIG_DVB_TDA665x=m CONFIG_DVB_IX2505V=m CONFIG_DVB_M88RS2000=m CONFIG_DVB_AF9033=m +CONFIG_DVB_HORUS3A=m +CONFIG_DVB_ASCOT2E=m +CONFIG_DVB_HELENE=m # # Common Interface (EN50221) controller drivers # CONFIG_DVB_CXD2099=m +CONFIG_DVB_SP2=m # # Tools to develop new frontends # CONFIG_DVB_DUMMY_FE=m +# end of Customise DVB Frontends # # Graphics support @@ -5025,18 +5970,22 @@ CONFIG_VGA_SWITCHEROO=y CONFIG_DRM=m CONFIG_DRM_MIPI_DSI=y # CONFIG_DRM_DP_AUX_CHARDEV is not set +# CONFIG_DRM_DEBUG_SELFTEST is not set CONFIG_DRM_KMS_HELPER=m CONFIG_DRM_KMS_FB_HELPER=y +# CONFIG_DRM_DEBUG_DP_MST_TOPOLOGY_REFS is not set CONFIG_DRM_FBDEV_EMULATION=y CONFIG_DRM_FBDEV_OVERALLOC=100 -CONFIG_DRM_LOAD_EDID_FIRMWARE=y -# CONFIG_DRM_DP_CEC is not set +# CONFIG_DRM_FBDEV_LEAK_PHYS_SMEM is not set +# CONFIG_DRM_LOAD_EDID_FIRMWARE is not set +CONFIG_DRM_DP_CEC=y CONFIG_DRM_TTM=m CONFIG_DRM_TTM_DMA_PAGE_POOL=y CONFIG_DRM_VRAM_HELPER=m CONFIG_DRM_TTM_HELPER=m CONFIG_DRM_GEM_SHMEM_HELPER=y CONFIG_DRM_VM=y +CONFIG_DRM_SCHED=m # # I2C encoder or helper chips @@ -5044,7 +5993,7 @@ CONFIG_DRM_VM=y CONFIG_DRM_I2C_CH7006=m CONFIG_DRM_I2C_SIL164=m CONFIG_DRM_I2C_NXP_TDA998X=m -# CONFIG_DRM_I2C_NXP_TDA9950 is not set +CONFIG_DRM_I2C_NXP_TDA9950=m # end of I2C encoder or helper chips # @@ -5054,37 +6003,72 @@ CONFIG_DRM_I2C_NXP_TDA998X=m CONFIG_DRM_RADEON=m CONFIG_DRM_RADEON_USERPTR=y -# CONFIG_DRM_AMDGPU is not set +CONFIG_DRM_AMDGPU=m +CONFIG_DRM_AMDGPU_SI=y +CONFIG_DRM_AMDGPU_CIK=y +CONFIG_DRM_AMDGPU_USERPTR=y +# CONFIG_DRM_AMDGPU_GART_DEBUGFS is not set # # ACP (Audio CoProcessor) Configuration # +CONFIG_DRM_AMD_ACP=y # end of ACP (Audio CoProcessor) Configuration +# +# Display Engine Configuration +# +CONFIG_DRM_AMD_DC=y +CONFIG_DRM_AMD_DC_DCN=y +CONFIG_DRM_AMD_DC_HDCP=y +# CONFIG_DEBUG_KERNEL_DC is not set +# end of Display Engine Configuration + +CONFIG_HSA_AMD=y CONFIG_DRM_NOUVEAU=m -CONFIG_NOUVEAU_LEGACY_CTX_SUPPORT=y +# CONFIG_NOUVEAU_LEGACY_CTX_SUPPORT is not set CONFIG_NOUVEAU_DEBUG=5 CONFIG_NOUVEAU_DEBUG_DEFAULT=3 # CONFIG_NOUVEAU_DEBUG_MMU is not set CONFIG_DRM_NOUVEAU_BACKLIGHT=y CONFIG_DRM_I915=m -# CONFIG_DRM_I915_ALPHA_SUPPORT is not set -CONFIG_DRM_I915_FORCE_PROBE="" +CONFIG_DRM_I915_ALPHA_SUPPORT=y +CONFIG_DRM_I915_FORCE_PROBE="*" CONFIG_DRM_I915_CAPTURE_ERROR=y CONFIG_DRM_I915_COMPRESS_ERROR=y CONFIG_DRM_I915_USERPTR=y -CONFIG_DRM_I915_GVT=y +# CONFIG_DRM_I915_GVT is not set + +# +# drm/i915 Debugging +# +# CONFIG_DRM_I915_WERROR is not set +# CONFIG_DRM_I915_DEBUG is not set +# CONFIG_DRM_I915_DEBUG_MMIO is not set +# CONFIG_DRM_I915_SW_FENCE_DEBUG_OBJECTS is not set +# CONFIG_DRM_I915_SW_FENCE_CHECK_DAG is not set +# CONFIG_DRM_I915_DEBUG_GUC is not set +# CONFIG_DRM_I915_SELFTEST is not set +# CONFIG_DRM_I915_LOW_LEVEL_TRACEPOINTS is not set +# CONFIG_DRM_I915_DEBUG_VBLANK_EVADE is not set +# CONFIG_DRM_I915_DEBUG_RUNTIME_PM is not set +# end of drm/i915 Debugging + +# +# drm/i915 Profile Guided Optimisation +# CONFIG_DRM_I915_USERFAULT_AUTOSUSPEND=250 CONFIG_DRM_I915_HEARTBEAT_INTERVAL=2500 CONFIG_DRM_I915_PREEMPT_TIMEOUT=640 CONFIG_DRM_I915_SPIN_REQUEST=5 CONFIG_DRM_I915_STOP_TIMEOUT=100 CONFIG_DRM_I915_TIMESLICE_DURATION=1 +# end of drm/i915 Profile Guided Optimisation + CONFIG_DRM_VGEM=m # CONFIG_DRM_VKMS is not set -CONFIG_DRM_ATI_PCIGART=y CONFIG_DRM_VMWGFX=m -CONFIG_DRM_VMWGFX_FBCON=y +# CONFIG_DRM_VMWGFX_FBCON is not set CONFIG_DRM_GMA500=m CONFIG_DRM_GMA600=y CONFIG_DRM_GMA3600=y @@ -5094,7 +6078,7 @@ CONFIG_DRM_MGAG200=m CONFIG_DRM_CIRRUS_QEMU=m CONFIG_DRM_QXL=m CONFIG_DRM_BOCHS=m -# CONFIG_DRM_VIRTIO_GPU is not set +CONFIG_DRM_VIRTIO_GPU=m CONFIG_DRM_PANEL=y # @@ -5113,17 +6097,25 @@ CONFIG_DRM_PANEL_BRIDGE=y # end of Display Interface Bridges # CONFIG_DRM_ETNAVIV is not set -# CONFIG_DRM_GM12U320 is not set -# CONFIG_DRM_XEN is not set -# CONFIG_DRM_VBOXVIDEO is not set +CONFIG_DRM_GM12U320=m +# CONFIG_TINYDRM_HX8357D is not set +# CONFIG_TINYDRM_ILI9225 is not set +# CONFIG_TINYDRM_ILI9341 is not set +# CONFIG_TINYDRM_MI0283QT is not set +# CONFIG_TINYDRM_REPAPER is not set +# CONFIG_TINYDRM_ST7586 is not set +# CONFIG_TINYDRM_ST7735R is not set +CONFIG_DRM_XEN=y +CONFIG_DRM_XEN_FRONTEND=m +CONFIG_DRM_VBOXVIDEO=m CONFIG_DRM_LEGACY=y -# CONFIG_DRM_TDFX is not set -# CONFIG_DRM_R128 is not set -# CONFIG_DRM_I810 is not set -# CONFIG_DRM_MGA is not set -# CONFIG_DRM_SIS is not set +CONFIG_DRM_TDFX=m +CONFIG_DRM_R128=m +CONFIG_DRM_I810=m +CONFIG_DRM_MGA=m +CONFIG_DRM_SIS=m # CONFIG_DRM_VIA is not set -# CONFIG_DRM_SAVAGE is not set +CONFIG_DRM_SAVAGE=m CONFIG_DRM_PANEL_ORIENTATION_QUIRKS=y # @@ -5133,6 +6125,7 @@ CONFIG_FB_CMDLINE=y CONFIG_FB_NOTIFY=y CONFIG_FB=y # CONFIG_FIRMWARE_EDID is not set +CONFIG_FB_DDC=m CONFIG_FB_BOOT_VESA_SUPPORT=y CONFIG_FB_CFB_FILLRECT=y CONFIG_FB_CFB_COPYAREA=y @@ -5146,16 +6139,20 @@ CONFIG_FB_BOTH_ENDIAN=y # CONFIG_FB_LITTLE_ENDIAN is not set CONFIG_FB_SYS_FOPS=y CONFIG_FB_DEFERRED_IO=y +CONFIG_FB_SVGALIB=m +CONFIG_FB_BACKLIGHT=m CONFIG_FB_MODE_HELPERS=y CONFIG_FB_TILEBLITTING=y # # Frame buffer hardware drivers # -# CONFIG_FB_CIRRUS is not set -# CONFIG_FB_PM2 is not set -# CONFIG_FB_CYBER2000 is not set -# CONFIG_FB_ARC is not set +CONFIG_FB_CIRRUS=m +CONFIG_FB_PM2=m +# CONFIG_FB_PM2_FIFO_DISCONNECT is not set +CONFIG_FB_CYBER2000=m +CONFIG_FB_CYBER2000_DDC=y +CONFIG_FB_ARC=m # CONFIG_FB_ASILIANT is not set # CONFIG_FB_IMSTT is not set CONFIG_FB_VGA16=m @@ -5166,37 +6163,72 @@ CONFIG_FB_EFI=y # CONFIG_FB_HGA is not set CONFIG_FB_OPENCORES=m # CONFIG_FB_S1D13XXX is not set -# CONFIG_FB_NVIDIA is not set -# CONFIG_FB_RIVA is not set -# CONFIG_FB_I740 is not set -# CONFIG_FB_LE80578 is not set -# CONFIG_FB_MATROX is not set -# CONFIG_FB_RADEON is not set -# CONFIG_FB_ATY128 is not set -# CONFIG_FB_ATY is not set -# CONFIG_FB_S3 is not set -# CONFIG_FB_SAVAGE is not set -# CONFIG_FB_SIS is not set -# CONFIG_FB_VIA is not set -# CONFIG_FB_NEOMAGIC is not set -# CONFIG_FB_KYRO is not set -# CONFIG_FB_3DFX is not set +CONFIG_FB_NVIDIA=m +CONFIG_FB_NVIDIA_I2C=y +# CONFIG_FB_NVIDIA_DEBUG is not set +CONFIG_FB_NVIDIA_BACKLIGHT=y +CONFIG_FB_RIVA=m +# CONFIG_FB_RIVA_I2C is not set +# CONFIG_FB_RIVA_DEBUG is not set +CONFIG_FB_RIVA_BACKLIGHT=y +CONFIG_FB_I740=m +CONFIG_FB_LE80578=m +CONFIG_FB_CARILLO_RANCH=m +CONFIG_FB_INTEL=m +# CONFIG_FB_INTEL_DEBUG is not set +CONFIG_FB_INTEL_I2C=y +CONFIG_FB_MATROX=m +CONFIG_FB_MATROX_MILLENIUM=y +CONFIG_FB_MATROX_MYSTIQUE=y +CONFIG_FB_MATROX_G=y +CONFIG_FB_MATROX_I2C=m +CONFIG_FB_MATROX_MAVEN=m +CONFIG_FB_RADEON=m +CONFIG_FB_RADEON_I2C=y +CONFIG_FB_RADEON_BACKLIGHT=y +# CONFIG_FB_RADEON_DEBUG is not set +CONFIG_FB_ATY128=m +CONFIG_FB_ATY128_BACKLIGHT=y +CONFIG_FB_ATY=m +CONFIG_FB_ATY_CT=y +CONFIG_FB_ATY_GENERIC_LCD=y +CONFIG_FB_ATY_GX=y +CONFIG_FB_ATY_BACKLIGHT=y +CONFIG_FB_S3=m +CONFIG_FB_S3_DDC=y +CONFIG_FB_SAVAGE=m +CONFIG_FB_SAVAGE_I2C=y +CONFIG_FB_SAVAGE_ACCEL=y +CONFIG_FB_SIS=m +CONFIG_FB_SIS_300=y +CONFIG_FB_SIS_315=y +CONFIG_FB_VIA=m +# CONFIG_FB_VIA_DIRECT_PROCFS is not set +# CONFIG_FB_VIA_X_COMPATIBILITY is not set +CONFIG_FB_NEOMAGIC=m +CONFIG_FB_KYRO=m +CONFIG_FB_3DFX=m +# CONFIG_FB_3DFX_ACCEL is not set +CONFIG_FB_3DFX_I2C=y CONFIG_FB_VOODOO1=m -# CONFIG_FB_VT8623 is not set -# CONFIG_FB_TRIDENT is not set -# CONFIG_FB_ARK is not set -# CONFIG_FB_PM3 is not set -# CONFIG_FB_CARMINE is not set -# CONFIG_FB_SM501 is not set -# CONFIG_FB_SMSCUFX is not set -# CONFIG_FB_UDL is not set +CONFIG_FB_VT8623=m +CONFIG_FB_TRIDENT=m +CONFIG_FB_ARK=m +CONFIG_FB_PM3=m +CONFIG_FB_CARMINE=m +CONFIG_FB_CARMINE_DRAM_EVAL=y +# CONFIG_CARMINE_DRAM_CUSTOM is not set +CONFIG_FB_SMSCUFX=m +CONFIG_FB_UDL=m CONFIG_FB_IBM_GXT4500=m -CONFIG_FB_VIRTUAL=m +# CONFIG_FB_VIRTUAL is not set CONFIG_XEN_FBDEV_FRONTEND=y # CONFIG_FB_METRONOME is not set -# CONFIG_FB_MB862XX is not set +CONFIG_FB_MB862XX=m +CONFIG_FB_MB862XX_PCI_GDC=y +CONFIG_FB_MB862XX_I2C=y CONFIG_FB_HYPERV=m -# CONFIG_FB_SIMPLE is not set +CONFIG_FB_SIMPLE=y CONFIG_FB_SM712=m # end of Frame buffer Devices @@ -5204,41 +6236,61 @@ CONFIG_FB_SM712=m # Backlight & LCD device support # CONFIG_LCD_CLASS_DEVICE=m -CONFIG_LCD_PLATFORM=m +CONFIG_LCD_L4F00242T03=m +CONFIG_LCD_LMS283GF05=m +CONFIG_LCD_LTV350QV=m +CONFIG_LCD_ILI922X=m +CONFIG_LCD_ILI9320=m +CONFIG_LCD_TDO24M=m +CONFIG_LCD_VGG2432A4=m +# CONFIG_LCD_PLATFORM is not set +CONFIG_LCD_AMS369FG06=m +CONFIG_LCD_LMS501KF03=m +CONFIG_LCD_HX8357=m +# CONFIG_LCD_OTM3225A is not set CONFIG_BACKLIGHT_CLASS_DEVICE=y # CONFIG_BACKLIGHT_GENERIC is not set +CONFIG_BACKLIGHT_CARILLO_RANCH=m CONFIG_BACKLIGHT_PWM=m +CONFIG_BACKLIGHT_DA903X=m +CONFIG_BACKLIGHT_DA9052=m +CONFIG_BACKLIGHT_MAX8925=m CONFIG_BACKLIGHT_APPLE=m # CONFIG_BACKLIGHT_QCOM_WLED is not set -# CONFIG_BACKLIGHT_SAHARA is not set -# CONFIG_BACKLIGHT_ADP8860 is not set -# CONFIG_BACKLIGHT_ADP8870 is not set +CONFIG_BACKLIGHT_SAHARA=m +CONFIG_BACKLIGHT_WM831X=m +CONFIG_BACKLIGHT_ADP5520=m +CONFIG_BACKLIGHT_ADP8860=m +CONFIG_BACKLIGHT_ADP8870=m +CONFIG_BACKLIGHT_88PM860X=m +CONFIG_BACKLIGHT_AAT2870=m CONFIG_BACKLIGHT_LM3630A=m CONFIG_BACKLIGHT_LM3639=m CONFIG_BACKLIGHT_LP855X=m -CONFIG_BACKLIGHT_SKY81452=m +CONFIG_BACKLIGHT_LP8788=m +CONFIG_BACKLIGHT_PANDORA=m +CONFIG_BACKLIGHT_AS3711=m CONFIG_BACKLIGHT_GPIO=m CONFIG_BACKLIGHT_LV5207LP=m CONFIG_BACKLIGHT_BD6107=m -# CONFIG_BACKLIGHT_ARCXCNN is not set +CONFIG_BACKLIGHT_ARCXCNN=m # end of Backlight & LCD device support CONFIG_VGASTATE=m +CONFIG_VIDEOMODE_HELPERS=y CONFIG_HDMI=y # # Console display driver support # CONFIG_VGA_CONSOLE=y -CONFIG_VGACON_SOFT_SCROLLBACK=y -CONFIG_VGACON_SOFT_SCROLLBACK_SIZE=64 -# CONFIG_VGACON_SOFT_SCROLLBACK_PERSISTENT_ENABLE_BY_DEFAULT is not set +# CONFIG_VGACON_SOFT_SCROLLBACK is not set CONFIG_DUMMY_CONSOLE=y CONFIG_DUMMY_CONSOLE_COLUMNS=80 CONFIG_DUMMY_CONSOLE_ROWS=25 CONFIG_FRAMEBUFFER_CONSOLE=y CONFIG_FRAMEBUFFER_CONSOLE_DETECT_PRIMARY=y -CONFIG_FRAMEBUFFER_CONSOLE_ROTATION=y +# CONFIG_FRAMEBUFFER_CONSOLE_ROTATION is not set # CONFIG_FRAMEBUFFER_CONSOLE_DEFERRED_TAKEOVER is not set # end of Console display driver support @@ -5247,13 +6299,16 @@ CONFIG_FRAMEBUFFER_CONSOLE_ROTATION=y CONFIG_SOUND=m CONFIG_SOUND_OSS_CORE=y -CONFIG_SOUND_OSS_CORE_PRECLAIM=y +# CONFIG_SOUND_OSS_CORE_PRECLAIM is not set CONFIG_SND=m CONFIG_SND_TIMER=m CONFIG_SND_PCM=m +CONFIG_SND_PCM_ELD=y +CONFIG_SND_PCM_IEC958=y CONFIG_SND_HWDEP=m CONFIG_SND_SEQ_DEVICE=m CONFIG_SND_RAWMIDI=m +CONFIG_SND_COMPRESS_OFFLOAD=m CONFIG_SND_JACK=y CONFIG_SND_JACK_INPUT_DEV=y CONFIG_SND_OSSEMUL=y @@ -5264,11 +6319,14 @@ CONFIG_SND_PCM_TIMER=y CONFIG_SND_HRTIMER=m CONFIG_SND_DYNAMIC_MINORS=y CONFIG_SND_MAX_CARDS=32 -# CONFIG_SND_SUPPORT_OLD_API is not set +CONFIG_SND_SUPPORT_OLD_API=y CONFIG_SND_PROC_FS=y CONFIG_SND_VERBOSE_PROCFS=y # CONFIG_SND_VERBOSE_PRINTK is not set -# CONFIG_SND_DEBUG is not set +CONFIG_SND_DEBUG=y +# CONFIG_SND_DEBUG_VERBOSE is not set +CONFIG_SND_PCM_XRUN_DEBUG=y +# CONFIG_SND_CTL_VALIDATION is not set CONFIG_SND_VMASTER=y CONFIG_SND_DMA_SGBUF=y CONFIG_SND_SEQUENCER=m @@ -5285,7 +6343,7 @@ CONFIG_SND_OPL3_LIB_SEQ=m CONFIG_SND_VX_LIB=m CONFIG_SND_AC97_CODEC=m CONFIG_SND_DRIVERS=y -CONFIG_SND_PCSP=m +# CONFIG_SND_PCSP is not set CONFIG_SND_DUMMY=m CONFIG_SND_ALOOP=m CONFIG_SND_VIRMIDI=m @@ -5308,7 +6366,7 @@ CONFIG_SND_ATIIXP_MODEM=m CONFIG_SND_AU8810=m CONFIG_SND_AU8820=m CONFIG_SND_AU8830=m -# CONFIG_SND_AW2 is not set +CONFIG_SND_AW2=m CONFIG_SND_AZT3328=m CONFIG_SND_BT87X=m # CONFIG_SND_BT87X_OVERCLOCK is not set @@ -5379,7 +6437,7 @@ CONFIG_SND_HDA_INTEL=m CONFIG_SND_HDA_HWDEP=y CONFIG_SND_HDA_RECONFIG=y CONFIG_SND_HDA_INPUT_BEEP=y -CONFIG_SND_HDA_INPUT_BEEP_MODE=0 +CONFIG_SND_HDA_INPUT_BEEP_MODE=1 CONFIG_SND_HDA_PATCH_LOADER=y CONFIG_SND_HDA_CODEC_REALTEK=m CONFIG_SND_HDA_CODEC_ANALOG=m @@ -5401,9 +6459,11 @@ CONFIG_SND_HDA_CORE=m CONFIG_SND_HDA_DSP_LOADER=y CONFIG_SND_HDA_COMPONENT=y CONFIG_SND_HDA_I915=y -CONFIG_SND_HDA_PREALLOC_SIZE=4096 +CONFIG_SND_HDA_EXT_CORE=m +CONFIG_SND_HDA_PREALLOC_SIZE=0 CONFIG_SND_INTEL_NHLT=y CONFIG_SND_INTEL_DSP_CONFIG=m +CONFIG_SND_SPI=y CONFIG_SND_USB=y CONFIG_SND_USB_AUDIO=m CONFIG_SND_USB_AUDIO_USE_MEDIA_CONTROLLER=y @@ -5413,77 +6473,402 @@ CONFIG_SND_USB_CAIAQ=m CONFIG_SND_USB_CAIAQ_INPUT=y CONFIG_SND_USB_US122L=m CONFIG_SND_USB_6FIRE=m -# CONFIG_SND_USB_HIFACE is not set +CONFIG_SND_USB_HIFACE=m CONFIG_SND_BCD2000=m CONFIG_SND_USB_LINE6=m -CONFIG_SND_USB_POD=m -CONFIG_SND_USB_PODHD=m -CONFIG_SND_USB_TONEPORT=m +# CONFIG_SND_USB_POD is not set +# CONFIG_SND_USB_PODHD is not set +# CONFIG_SND_USB_TONEPORT is not set CONFIG_SND_USB_VARIAX=m CONFIG_SND_FIREWIRE=y CONFIG_SND_FIREWIRE_LIB=m CONFIG_SND_DICE=m -# CONFIG_SND_OXFW is not set +CONFIG_SND_OXFW=m CONFIG_SND_ISIGHT=m CONFIG_SND_FIREWORKS=m CONFIG_SND_BEBOB=m CONFIG_SND_FIREWIRE_DIGI00X=m CONFIG_SND_FIREWIRE_TASCAM=m -# CONFIG_SND_FIREWIRE_MOTU is not set -# CONFIG_SND_FIREFACE is not set -# CONFIG_SND_PCMCIA is not set -# CONFIG_SND_SOC is not set +CONFIG_SND_FIREWIRE_MOTU=m +CONFIG_SND_FIREFACE=m +CONFIG_SND_PCMCIA=y +CONFIG_SND_VXPOCKET=m +CONFIG_SND_PDAUDIOCF=m +CONFIG_SND_SOC=m +CONFIG_SND_SOC_AC97_BUS=y +CONFIG_SND_SOC_COMPRESS=y +CONFIG_SND_SOC_TOPOLOGY=y +CONFIG_SND_SOC_ACPI=m +CONFIG_SND_SOC_AMD_ACP=m +CONFIG_SND_SOC_AMD_CZ_DA7219MX98357_MACH=m +CONFIG_SND_SOC_AMD_CZ_RT5645_MACH=m +CONFIG_SND_SOC_AMD_ACP3x=m +# CONFIG_SND_ATMEL_SOC is not set +# CONFIG_SND_DESIGNWARE_I2S is not set + +# +# SoC Audio for Freescale CPUs +# + +# +# Common SoC Audio options for Freescale CPUs: +# +# CONFIG_SND_SOC_FSL_ASRC is not set +# CONFIG_SND_SOC_FSL_SAI is not set +# CONFIG_SND_SOC_FSL_AUDMIX is not set +# CONFIG_SND_SOC_FSL_SSI is not set +# CONFIG_SND_SOC_FSL_SPDIF is not set +# CONFIG_SND_SOC_FSL_ESAI is not set +# CONFIG_SND_SOC_FSL_MICFIL is not set +# CONFIG_SND_SOC_IMX_AUDMUX is not set +# end of SoC Audio for Freescale CPUs + +# CONFIG_SND_I2S_HI6210_I2S is not set +# CONFIG_SND_SOC_IMG is not set +CONFIG_SND_SOC_INTEL_SST_TOPLEVEL=y +CONFIG_SND_SST_IPC=m +CONFIG_SND_SST_IPC_PCI=m +CONFIG_SND_SST_IPC_ACPI=m +CONFIG_SND_SOC_INTEL_SST_ACPI=m +CONFIG_SND_SOC_INTEL_SST=m +CONFIG_SND_SOC_INTEL_SST_FIRMWARE=m +CONFIG_SND_SOC_INTEL_HASWELL=m +CONFIG_SND_SST_ATOM_HIFI2_PLATFORM=m +CONFIG_SND_SST_ATOM_HIFI2_PLATFORM_PCI=m +CONFIG_SND_SST_ATOM_HIFI2_PLATFORM_ACPI=m +CONFIG_SND_SOC_INTEL_SKYLAKE=m +CONFIG_SND_SOC_INTEL_SKL=m +CONFIG_SND_SOC_INTEL_APL=m +CONFIG_SND_SOC_INTEL_KBL=m +CONFIG_SND_SOC_INTEL_GLK=m +CONFIG_SND_SOC_INTEL_CNL=m +CONFIG_SND_SOC_INTEL_CFL=m +CONFIG_SND_SOC_INTEL_CML_H=m +CONFIG_SND_SOC_INTEL_CML_LP=m +CONFIG_SND_SOC_INTEL_SKYLAKE_FAMILY=m +CONFIG_SND_SOC_INTEL_SKYLAKE_SSP_CLK=m +CONFIG_SND_SOC_INTEL_SKYLAKE_HDAUDIO_CODEC=y +CONFIG_SND_SOC_INTEL_SKYLAKE_COMMON=m +CONFIG_SND_SOC_ACPI_INTEL_MATCH=m +CONFIG_SND_SOC_INTEL_MACH=y +# CONFIG_SND_SOC_INTEL_USER_FRIENDLY_LONG_NAMES is not set +CONFIG_SND_SOC_INTEL_HASWELL_MACH=m +CONFIG_SND_SOC_INTEL_BDW_RT5650_MACH=m +CONFIG_SND_SOC_INTEL_BDW_RT5677_MACH=m +CONFIG_SND_SOC_INTEL_BROADWELL_MACH=m +CONFIG_SND_SOC_INTEL_BYTCR_RT5640_MACH=m +CONFIG_SND_SOC_INTEL_BYTCR_RT5651_MACH=m +CONFIG_SND_SOC_INTEL_CHT_BSW_RT5672_MACH=m +CONFIG_SND_SOC_INTEL_CHT_BSW_RT5645_MACH=m +CONFIG_SND_SOC_INTEL_CHT_BSW_MAX98090_TI_MACH=m +CONFIG_SND_SOC_INTEL_CHT_BSW_NAU8824_MACH=m +CONFIG_SND_SOC_INTEL_BYT_CHT_CX2072X_MACH=m +CONFIG_SND_SOC_INTEL_BYT_CHT_DA7213_MACH=m +CONFIG_SND_SOC_INTEL_BYT_CHT_ES8316_MACH=m +CONFIG_SND_SOC_INTEL_BYT_CHT_NOCODEC_MACH=m +CONFIG_SND_SOC_INTEL_SKL_RT286_MACH=m +CONFIG_SND_SOC_INTEL_SKL_NAU88L25_SSM4567_MACH=m +CONFIG_SND_SOC_INTEL_SKL_NAU88L25_MAX98357A_MACH=m +CONFIG_SND_SOC_INTEL_DA7219_MAX98357A_GENERIC=m +CONFIG_SND_SOC_INTEL_BXT_DA7219_MAX98357A_COMMON=m +CONFIG_SND_SOC_INTEL_BXT_DA7219_MAX98357A_MACH=m +CONFIG_SND_SOC_INTEL_BXT_RT298_MACH=m +CONFIG_SND_SOC_INTEL_KBL_RT5663_MAX98927_MACH=m +CONFIG_SND_SOC_INTEL_KBL_RT5663_RT5514_MAX98927_MACH=m +CONFIG_SND_SOC_INTEL_KBL_DA7219_MAX98357A_MACH=m +CONFIG_SND_SOC_INTEL_KBL_DA7219_MAX98927_MACH=m +CONFIG_SND_SOC_INTEL_KBL_RT5660_MACH=m +CONFIG_SND_SOC_INTEL_GLK_DA7219_MAX98357A_MACH=m +CONFIG_SND_SOC_INTEL_GLK_RT5682_MAX98357A_MACH=m +CONFIG_SND_SOC_INTEL_SKL_HDA_DSP_GENERIC_MACH=m +CONFIG_SND_SOC_INTEL_SOF_RT5682_MACH=m +CONFIG_SND_SOC_INTEL_CML_LP_DA7219_MAX98357A_MACH=m +CONFIG_SND_SOC_INTEL_SOF_CML_RT1011_RT5682_MACH=m +CONFIG_SND_SOC_INTEL_SOF_DA7219_MAX98373_MACH=m +CONFIG_SND_SOC_MTK_BTCVSD=m +CONFIG_SND_SOC_SOF_TOPLEVEL=y +CONFIG_SND_SOC_SOF_PCI=m +CONFIG_SND_SOC_SOF_ACPI=m +# CONFIG_SND_SOC_SOF_DEVELOPER_SUPPORT is not set +CONFIG_SND_SOC_SOF=m +CONFIG_SND_SOC_SOF_PROBE_WORK_QUEUE=y +CONFIG_SND_SOC_SOF_INTEL_TOPLEVEL=y +CONFIG_SND_SOC_SOF_INTEL_ACPI=m +CONFIG_SND_SOC_SOF_INTEL_PCI=m +CONFIG_SND_SOC_SOF_INTEL_HIFI_EP_IPC=m +CONFIG_SND_SOC_SOF_INTEL_ATOM_HIFI_EP=m +CONFIG_SND_SOC_SOF_INTEL_COMMON=m +CONFIG_SND_SOC_SOF_MERRIFIELD_SUPPORT=y +CONFIG_SND_SOC_SOF_MERRIFIELD=m +CONFIG_SND_SOC_SOF_APOLLOLAKE_SUPPORT=y +CONFIG_SND_SOC_SOF_APOLLOLAKE=m +CONFIG_SND_SOC_SOF_GEMINILAKE_SUPPORT=y +CONFIG_SND_SOC_SOF_GEMINILAKE=m +CONFIG_SND_SOC_SOF_CANNONLAKE_SUPPORT=y +CONFIG_SND_SOC_SOF_CANNONLAKE=m +CONFIG_SND_SOC_SOF_COFFEELAKE_SUPPORT=y +CONFIG_SND_SOC_SOF_COFFEELAKE=m +CONFIG_SND_SOC_SOF_ICELAKE_SUPPORT=y +CONFIG_SND_SOC_SOF_ICELAKE=m +CONFIG_SND_SOC_SOF_COMETLAKE_LP=m +CONFIG_SND_SOC_SOF_COMETLAKE_LP_SUPPORT=y +CONFIG_SND_SOC_SOF_COMETLAKE_H=m +CONFIG_SND_SOC_SOF_COMETLAKE_H_SUPPORT=y +CONFIG_SND_SOC_SOF_TIGERLAKE_SUPPORT=y +CONFIG_SND_SOC_SOF_TIGERLAKE=m +CONFIG_SND_SOC_SOF_ELKHARTLAKE_SUPPORT=y +CONFIG_SND_SOC_SOF_ELKHARTLAKE=m +CONFIG_SND_SOC_SOF_JASPERLAKE_SUPPORT=y +CONFIG_SND_SOC_SOF_JASPERLAKE=m +CONFIG_SND_SOC_SOF_HDA_COMMON=m +CONFIG_SND_SOC_SOF_HDA_LINK=y +CONFIG_SND_SOC_SOF_HDA_AUDIO_CODEC=y +# CONFIG_SND_SOC_SOF_HDA_ALWAYS_ENABLE_DMI_L1 is not set +CONFIG_SND_SOC_SOF_HDA_COMMON_HDMI_CODEC=y +CONFIG_SND_SOC_SOF_HDA_LINK_BASELINE=m +CONFIG_SND_SOC_SOF_HDA=m +CONFIG_SND_SOC_SOF_XTENSA=m + +# +# STMicroelectronics STM32 SOC audio support +# +# end of STMicroelectronics STM32 SOC audio support + +CONFIG_SND_SOC_XILINX_I2S=m +# CONFIG_SND_SOC_XILINX_AUDIO_FORMATTER is not set +# CONFIG_SND_SOC_XILINX_SPDIF is not set +# CONFIG_SND_SOC_XTFPGA_I2S is not set +# CONFIG_ZX_TDM is not set +CONFIG_SND_SOC_I2C_AND_SPI=m + +# +# CODEC drivers +# +CONFIG_SND_SOC_AC97_CODEC=m +CONFIG_SND_SOC_ADAU_UTILS=m +# CONFIG_SND_SOC_ADAU1701 is not set +CONFIG_SND_SOC_ADAU17X1=m +CONFIG_SND_SOC_ADAU1761=m +CONFIG_SND_SOC_ADAU1761_I2C=m +CONFIG_SND_SOC_ADAU1761_SPI=m +CONFIG_SND_SOC_ADAU7002=m +CONFIG_SND_SOC_ADAU7118=m +CONFIG_SND_SOC_ADAU7118_HW=m +CONFIG_SND_SOC_ADAU7118_I2C=m +# CONFIG_SND_SOC_AK4104 is not set +# CONFIG_SND_SOC_AK4118 is not set +# CONFIG_SND_SOC_AK4458 is not set +# CONFIG_SND_SOC_AK4554 is not set +# CONFIG_SND_SOC_AK4613 is not set +# CONFIG_SND_SOC_AK4642 is not set +# CONFIG_SND_SOC_AK5386 is not set +# CONFIG_SND_SOC_AK5558 is not set +# CONFIG_SND_SOC_ALC5623 is not set +# CONFIG_SND_SOC_BD28623 is not set +# CONFIG_SND_SOC_BT_SCO is not set +# CONFIG_SND_SOC_CROS_EC_CODEC is not set +# CONFIG_SND_SOC_CS35L32 is not set +# CONFIG_SND_SOC_CS35L33 is not set +CONFIG_SND_SOC_CS35L34=m +CONFIG_SND_SOC_CS35L35=m +CONFIG_SND_SOC_CS35L36=m +CONFIG_SND_SOC_CS42L42=m +# CONFIG_SND_SOC_CS42L51_I2C is not set +# CONFIG_SND_SOC_CS42L52 is not set +# CONFIG_SND_SOC_CS42L56 is not set +# CONFIG_SND_SOC_CS42L73 is not set +# CONFIG_SND_SOC_CS4265 is not set +# CONFIG_SND_SOC_CS4270 is not set +# CONFIG_SND_SOC_CS4271_I2C is not set +# CONFIG_SND_SOC_CS4271_SPI is not set +# CONFIG_SND_SOC_CS42XX8_I2C is not set +CONFIG_SND_SOC_CS43130=m +CONFIG_SND_SOC_CS4341=m +# CONFIG_SND_SOC_CS4349 is not set +# CONFIG_SND_SOC_CS53L30 is not set +CONFIG_SND_SOC_CX2072X=m +CONFIG_SND_SOC_DA7213=m +CONFIG_SND_SOC_DA7219=m +CONFIG_SND_SOC_DMIC=m +CONFIG_SND_SOC_HDMI_CODEC=m +# CONFIG_SND_SOC_ES7134 is not set +# CONFIG_SND_SOC_ES7241 is not set +CONFIG_SND_SOC_ES8316=m +# CONFIG_SND_SOC_ES8328_I2C is not set +# CONFIG_SND_SOC_ES8328_SPI is not set +# CONFIG_SND_SOC_GTM601 is not set +CONFIG_SND_SOC_HDAC_HDMI=m +CONFIG_SND_SOC_HDAC_HDA=m +# CONFIG_SND_SOC_INNO_RK3036 is not set +CONFIG_SND_SOC_MAX98088=m +CONFIG_SND_SOC_MAX98090=m +CONFIG_SND_SOC_MAX98357A=m +# CONFIG_SND_SOC_MAX98504 is not set +# CONFIG_SND_SOC_MAX9867 is not set +CONFIG_SND_SOC_MAX98927=m +CONFIG_SND_SOC_MAX98373=m +# CONFIG_SND_SOC_MAX9860 is not set +# CONFIG_SND_SOC_MSM8916_WCD_ANALOG is not set +# CONFIG_SND_SOC_MSM8916_WCD_DIGITAL is not set +# CONFIG_SND_SOC_PCM1681 is not set +# CONFIG_SND_SOC_PCM1789_I2C is not set +# CONFIG_SND_SOC_PCM179X_I2C is not set +# CONFIG_SND_SOC_PCM179X_SPI is not set +# CONFIG_SND_SOC_PCM186X_I2C is not set +# CONFIG_SND_SOC_PCM186X_SPI is not set +# CONFIG_SND_SOC_PCM3060_I2C is not set +# CONFIG_SND_SOC_PCM3060_SPI is not set +# CONFIG_SND_SOC_PCM3168A_I2C is not set +# CONFIG_SND_SOC_PCM3168A_SPI is not set +# CONFIG_SND_SOC_PCM512x_I2C is not set +# CONFIG_SND_SOC_PCM512x_SPI is not set +# CONFIG_SND_SOC_RK3328 is not set +CONFIG_SND_SOC_RL6231=m +CONFIG_SND_SOC_RL6347A=m +CONFIG_SND_SOC_RT286=m +CONFIG_SND_SOC_RT298=m +CONFIG_SND_SOC_RT1011=m +CONFIG_SND_SOC_RT1308_SDW=m +CONFIG_SND_SOC_RT5514=m +CONFIG_SND_SOC_RT5514_SPI=m +# CONFIG_SND_SOC_RT5616 is not set +# CONFIG_SND_SOC_RT5631 is not set +CONFIG_SND_SOC_RT5640=m +CONFIG_SND_SOC_RT5645=m +CONFIG_SND_SOC_RT5651=m +CONFIG_SND_SOC_RT5660=m +CONFIG_SND_SOC_RT5663=m +CONFIG_SND_SOC_RT5670=m +CONFIG_SND_SOC_RT5677=m +CONFIG_SND_SOC_RT5677_SPI=m +CONFIG_SND_SOC_RT5682=m +CONFIG_SND_SOC_RT700=m +CONFIG_SND_SOC_RT700_SDW=m +CONFIG_SND_SOC_RT711=m +CONFIG_SND_SOC_RT711_SDW=m +CONFIG_SND_SOC_RT715=m +CONFIG_SND_SOC_RT715_SDW=m +# CONFIG_SND_SOC_SGTL5000 is not set +CONFIG_SND_SOC_SIGMADSP=m +CONFIG_SND_SOC_SIGMADSP_REGMAP=m +# CONFIG_SND_SOC_SIMPLE_AMPLIFIER is not set +# CONFIG_SND_SOC_SIRF_AUDIO_CODEC is not set +# CONFIG_SND_SOC_SPDIF is not set +# CONFIG_SND_SOC_SSM2305 is not set +# CONFIG_SND_SOC_SSM2602_SPI is not set +# CONFIG_SND_SOC_SSM2602_I2C is not set +CONFIG_SND_SOC_SSM4567=m +# CONFIG_SND_SOC_STA32X is not set +# CONFIG_SND_SOC_STA350 is not set +# CONFIG_SND_SOC_STI_SAS is not set +# CONFIG_SND_SOC_TAS2552 is not set +# CONFIG_SND_SOC_TAS2562 is not set +# CONFIG_SND_SOC_TAS2770 is not set +# CONFIG_SND_SOC_TAS5086 is not set +# CONFIG_SND_SOC_TAS571X is not set +# CONFIG_SND_SOC_TAS5720 is not set +# CONFIG_SND_SOC_TAS6424 is not set +# CONFIG_SND_SOC_TDA7419 is not set +# CONFIG_SND_SOC_TFA9879 is not set +# CONFIG_SND_SOC_TLV320AIC23_I2C is not set +# CONFIG_SND_SOC_TLV320AIC23_SPI is not set +# CONFIG_SND_SOC_TLV320AIC31XX is not set +# CONFIG_SND_SOC_TLV320AIC32X4_I2C is not set +# CONFIG_SND_SOC_TLV320AIC32X4_SPI is not set +# CONFIG_SND_SOC_TLV320AIC3X is not set +CONFIG_SND_SOC_TS3A227E=m +# CONFIG_SND_SOC_TSCS42XX is not set +# CONFIG_SND_SOC_TSCS454 is not set +# CONFIG_SND_SOC_UDA1334 is not set +# CONFIG_SND_SOC_WM8510 is not set +# CONFIG_SND_SOC_WM8523 is not set +CONFIG_SND_SOC_WM8524=m +# CONFIG_SND_SOC_WM8580 is not set +# CONFIG_SND_SOC_WM8711 is not set +# CONFIG_SND_SOC_WM8728 is not set +# CONFIG_SND_SOC_WM8731 is not set +# CONFIG_SND_SOC_WM8737 is not set +# CONFIG_SND_SOC_WM8741 is not set +# CONFIG_SND_SOC_WM8750 is not set +# CONFIG_SND_SOC_WM8753 is not set +# CONFIG_SND_SOC_WM8770 is not set +# CONFIG_SND_SOC_WM8776 is not set +CONFIG_SND_SOC_WM8782=m +# CONFIG_SND_SOC_WM8804_I2C is not set +# CONFIG_SND_SOC_WM8804_SPI is not set +# CONFIG_SND_SOC_WM8903 is not set +# CONFIG_SND_SOC_WM8904 is not set +# CONFIG_SND_SOC_WM8960 is not set +# CONFIG_SND_SOC_WM8962 is not set +# CONFIG_SND_SOC_WM8974 is not set +# CONFIG_SND_SOC_WM8978 is not set +# CONFIG_SND_SOC_WM8985 is not set +CONFIG_SND_SOC_WSA881X=m +CONFIG_SND_SOC_ZX_AUD96P22=m +# CONFIG_SND_SOC_MAX9759 is not set +# CONFIG_SND_SOC_MT6351 is not set +# CONFIG_SND_SOC_MT6358 is not set +# CONFIG_SND_SOC_MT6660 is not set +CONFIG_SND_SOC_NAU8540=m +CONFIG_SND_SOC_NAU8810=m +# CONFIG_SND_SOC_NAU8822 is not set +CONFIG_SND_SOC_NAU8824=m +CONFIG_SND_SOC_NAU8825=m +# CONFIG_SND_SOC_TPA6130A2 is not set +# end of CODEC drivers + +# CONFIG_SND_SIMPLE_CARD is not set CONFIG_SND_X86=y -# CONFIG_HDMI_LPE_AUDIO is not set +CONFIG_HDMI_LPE_AUDIO=m CONFIG_SND_SYNTH_EMUX=m -# CONFIG_SND_XEN_FRONTEND is not set +CONFIG_SND_XEN_FRONTEND=m CONFIG_AC97_BUS=m # # HID support # -CONFIG_HID=y +CONFIG_HID=m CONFIG_HID_BATTERY_STRENGTH=y CONFIG_HIDRAW=y -CONFIG_UHID=y -CONFIG_HID_GENERIC=y +CONFIG_UHID=m +CONFIG_HID_GENERIC=m # # Special HID drivers # -CONFIG_HID_A4TECH=y +CONFIG_HID_A4TECH=m # CONFIG_HID_ACCUTOUCH is not set CONFIG_HID_ACRUX=m CONFIG_HID_ACRUX_FF=y -CONFIG_HID_APPLE=y +CONFIG_HID_APPLE=m CONFIG_HID_APPLEIR=m -# CONFIG_HID_ASUS is not set +CONFIG_HID_ASUS=m CONFIG_HID_AUREAL=m -CONFIG_HID_BELKIN=y +CONFIG_HID_BELKIN=m CONFIG_HID_BETOP_FF=m -# CONFIG_HID_BIGBEN_FF is not set -CONFIG_HID_CHERRY=y -CONFIG_HID_CHICONY=y +CONFIG_HID_BIGBEN_FF=m +CONFIG_HID_CHERRY=m +CONFIG_HID_CHICONY=m CONFIG_HID_CORSAIR=m -# CONFIG_HID_COUGAR is not set -# CONFIG_HID_MACALLY is not set +CONFIG_HID_COUGAR=m +CONFIG_HID_MACALLY=m CONFIG_HID_PRODIKEYS=m -# CONFIG_HID_CMEDIA is not set +CONFIG_HID_CMEDIA=m CONFIG_HID_CP2112=m -# CONFIG_HID_CREATIVE_SB0540 is not set -CONFIG_HID_CYPRESS=y +CONFIG_HID_CREATIVE_SB0540=m +CONFIG_HID_CYPRESS=m CONFIG_HID_DRAGONRISE=m CONFIG_DRAGONRISE_FF=y CONFIG_HID_EMS_FF=m -# CONFIG_HID_ELAN is not set +CONFIG_HID_ELAN=m CONFIG_HID_ELECOM=m CONFIG_HID_ELO=m -CONFIG_HID_EZKEY=y +CONFIG_HID_EZKEY=m CONFIG_HID_GEMBIRD=m CONFIG_HID_GFRM=m CONFIG_HID_HOLTEK=m CONFIG_HOLTEK_FF=y -# CONFIG_HID_GOOGLE_HAMMER is not set +CONFIG_HID_GOOGLE_HAMMER=m CONFIG_HID_GT683R=m CONFIG_HID_KEYTOUCH=m CONFIG_HID_KYE=m @@ -5492,14 +6877,14 @@ CONFIG_HID_WALTOP=m # CONFIG_HID_VIEWSONIC is not set CONFIG_HID_GYRATION=m CONFIG_HID_ICADE=m -CONFIG_HID_ITE=y -# CONFIG_HID_JABRA is not set +CONFIG_HID_ITE=m +CONFIG_HID_JABRA=m CONFIG_HID_TWINHAN=m -CONFIG_HID_KENSINGTON=y +CONFIG_HID_KENSINGTON=m CONFIG_HID_LCPOWER=m CONFIG_HID_LED=m CONFIG_HID_LENOVO=m -CONFIG_HID_LOGITECH=y +CONFIG_HID_LOGITECH=m CONFIG_HID_LOGITECH_DJ=m CONFIG_HID_LOGITECH_HIDPP=m CONFIG_LOGITECH_FF=y @@ -5508,17 +6893,17 @@ CONFIG_LOGIG940_FF=y CONFIG_LOGIWHEELS_FF=y CONFIG_HID_MAGICMOUSE=m # CONFIG_HID_MALTRON is not set -# CONFIG_HID_MAYFLASH is not set -CONFIG_HID_REDRAGON=y -CONFIG_HID_MICROSOFT=y -CONFIG_HID_MONTEREY=y +CONFIG_HID_MAYFLASH=m +CONFIG_HID_REDRAGON=m +CONFIG_HID_MICROSOFT=m +CONFIG_HID_MONTEREY=m CONFIG_HID_MULTITOUCH=m # CONFIG_HID_NTI is not set -CONFIG_HID_NTRIG=y +CONFIG_HID_NTRIG=m CONFIG_HID_ORTEK=m CONFIG_HID_PANTHERLORD=m CONFIG_PANTHERLORD_FF=y -# CONFIG_HID_PENMOUNT is not set +CONFIG_HID_PENMOUNT=m CONFIG_HID_PETALYNX=m CONFIG_HID_PICOLCD=m CONFIG_HID_PICOLCD_FB=y @@ -5526,16 +6911,16 @@ CONFIG_HID_PICOLCD_BACKLIGHT=y CONFIG_HID_PICOLCD_LCD=y CONFIG_HID_PICOLCD_LEDS=y CONFIG_HID_PICOLCD_CIR=y -CONFIG_HID_PLANTRONICS=y +CONFIG_HID_PLANTRONICS=m CONFIG_HID_PRIMAX=m -# CONFIG_HID_RETRODE is not set +CONFIG_HID_RETRODE=m CONFIG_HID_ROCCAT=m CONFIG_HID_SAITEK=m CONFIG_HID_SAMSUNG=m CONFIG_HID_SONY=m CONFIG_SONY_FF=y CONFIG_HID_SPEEDLINK=m -# CONFIG_HID_STEAM is not set +CONFIG_HID_STEAM=m CONFIG_HID_STEELSERIES=m CONFIG_HID_SUNPLUS=m CONFIG_HID_RMI=m @@ -5558,16 +6943,23 @@ CONFIG_HID_ZEROPLUS=m CONFIG_ZEROPLUS_FF=y CONFIG_HID_ZYDACRON=m CONFIG_HID_SENSOR_HUB=m -CONFIG_HID_SENSOR_CUSTOM_SENSOR=m -CONFIG_HID_ALPS=m +# CONFIG_HID_SENSOR_CUSTOM_SENSOR is not set +# CONFIG_HID_ALPS is not set # end of Special HID drivers # # USB HID support # -CONFIG_USB_HID=y +CONFIG_USB_HID=m CONFIG_HID_PID=y CONFIG_USB_HIDDEV=y + +# +# USB HID Boot Protocol drivers +# +# CONFIG_USB_KBD is not set +# CONFIG_USB_MOUSE is not set +# end of USB HID Boot Protocol drivers # end of USB HID support # @@ -5580,18 +6972,18 @@ CONFIG_I2C_HID=m # Intel ISH HID support # CONFIG_INTEL_ISH_HID=m -# CONFIG_INTEL_ISH_FIRMWARE_DOWNLOADER is not set +CONFIG_INTEL_ISH_FIRMWARE_DOWNLOADER=m # end of Intel ISH HID support # end of HID support CONFIG_USB_OHCI_LITTLE_ENDIAN=y CONFIG_USB_SUPPORT=y -CONFIG_USB_COMMON=y +CONFIG_USB_COMMON=m # CONFIG_USB_LED_TRIG is not set -# CONFIG_USB_ULPI_BUS is not set +CONFIG_USB_ULPI_BUS=m # CONFIG_USB_CONN_GPIO is not set CONFIG_USB_ARCH_HAS_HCD=y -CONFIG_USB=y +CONFIG_USB=m CONFIG_USB_PCI=y CONFIG_USB_ANNOUNCE_NEW_DEVICES=y @@ -5599,43 +6991,45 @@ CONFIG_USB_ANNOUNCE_NEW_DEVICES=y # Miscellaneous USB options # CONFIG_USB_DEFAULT_PERSIST=y -# CONFIG_USB_DYNAMIC_MINORS is not set +CONFIG_USB_DYNAMIC_MINORS=y CONFIG_USB_OTG=y # CONFIG_USB_OTG_WHITELIST is not set # CONFIG_USB_OTG_BLACKLIST_HUB is not set CONFIG_USB_OTG_FSM=m -CONFIG_USB_LEDS_TRIGGER_USBPORT=m +# CONFIG_USB_LEDS_TRIGGER_USBPORT is not set CONFIG_USB_AUTOSUSPEND_DELAY=2 -CONFIG_USB_MON=y +CONFIG_USB_MON=m # # USB Host Controller Drivers # # CONFIG_USB_C67X00_HCD is not set -CONFIG_USB_XHCI_HCD=y +CONFIG_USB_XHCI_HCD=m # CONFIG_USB_XHCI_DBGCAP is not set -CONFIG_USB_XHCI_PCI=y +CONFIG_USB_XHCI_PCI=m CONFIG_USB_XHCI_PLATFORM=m -CONFIG_USB_EHCI_HCD=y +CONFIG_USB_EHCI_HCD=m CONFIG_USB_EHCI_ROOT_HUB_TT=y CONFIG_USB_EHCI_TT_NEWSCHED=y -CONFIG_USB_EHCI_PCI=y +CONFIG_USB_EHCI_PCI=m # CONFIG_USB_EHCI_FSL is not set -# CONFIG_USB_EHCI_HCD_PLATFORM is not set +CONFIG_USB_EHCI_HCD_PLATFORM=m # CONFIG_USB_OXU210HP_HCD is not set # CONFIG_USB_ISP116X_HCD is not set CONFIG_USB_FOTG210_HCD=m -CONFIG_USB_OHCI_HCD=y -CONFIG_USB_OHCI_HCD_PCI=y -# CONFIG_USB_OHCI_HCD_PLATFORM is not set -CONFIG_USB_UHCI_HCD=y +CONFIG_USB_MAX3421_HCD=m +CONFIG_USB_OHCI_HCD=m +CONFIG_USB_OHCI_HCD_PCI=m +# CONFIG_USB_OHCI_HCD_SSB is not set +CONFIG_USB_OHCI_HCD_PLATFORM=m +CONFIG_USB_UHCI_HCD=m CONFIG_USB_U132_HCD=m CONFIG_USB_SL811_HCD=m -CONFIG_USB_SL811_HCD_ISO=y -# CONFIG_USB_SL811_CS is not set +# CONFIG_USB_SL811_HCD_ISO is not set +CONFIG_USB_SL811_CS=m # CONFIG_USB_R8A66597_HCD is not set -# CONFIG_USB_HCD_BCMA is not set -# CONFIG_USB_HCD_SSB is not set +CONFIG_USB_HCD_BCMA=m +CONFIG_USB_HCD_SSB=m # CONFIG_USB_HCD_TEST_MODE is not set # @@ -5676,8 +7070,15 @@ CONFIG_USB_UAS=m # CONFIG_USB_MDC800=m CONFIG_USB_MICROTEK=m -# CONFIG_USBIP_CORE is not set -# CONFIG_USB_CDNS3 is not set +CONFIG_USBIP_CORE=m +CONFIG_USBIP_VHCI_HCD=m +CONFIG_USBIP_VHCI_HC_PORTS=8 +CONFIG_USBIP_VHCI_NR_HCS=1 +CONFIG_USBIP_HOST=m +# CONFIG_USBIP_DEBUG is not set +CONFIG_USB_CDNS3=m +CONFIG_USB_CDNS3_HOST=y +CONFIG_USB_CDNS3_PCI_WRAP=m CONFIG_USB_MUSB_HDRC=m CONFIG_USB_MUSB_HOST=y @@ -5690,6 +7091,7 @@ CONFIG_USB_MUSB_HOST=y # CONFIG_MUSB_PIO_ONLY=y CONFIG_USB_DWC3=m +# CONFIG_USB_DWC3_ULPI is not set CONFIG_USB_DWC3_HOST=y # @@ -5697,28 +7099,25 @@ CONFIG_USB_DWC3_HOST=y # CONFIG_USB_DWC3_PCI=m CONFIG_USB_DWC3_HAPS=m -CONFIG_USB_DWC2=y +CONFIG_USB_DWC2=m CONFIG_USB_DWC2_HOST=y # # Gadget/Dual-role mode requires USB Gadget support to be enabled # -CONFIG_USB_DWC2_PCI=y +CONFIG_USB_DWC2_PCI=m # CONFIG_USB_DWC2_DEBUG is not set # CONFIG_USB_DWC2_TRACK_MISSED_SOFS is not set # CONFIG_USB_CHIPIDEA is not set -CONFIG_USB_ISP1760=m -CONFIG_USB_ISP1760_HCD=y -CONFIG_USB_ISP1760_HOST_ROLE=y +# CONFIG_USB_ISP1760 is not set # # USB port drivers # CONFIG_USB_USS720=m -CONFIG_USB_SERIAL=y -CONFIG_USB_SERIAL_CONSOLE=y +CONFIG_USB_SERIAL=m CONFIG_USB_SERIAL_GENERIC=y -# CONFIG_USB_SERIAL_SIMPLE is not set +CONFIG_USB_SERIAL_SIMPLE=m CONFIG_USB_SERIAL_AIRCABLE=m CONFIG_USB_SERIAL_ARK3116=m CONFIG_USB_SERIAL_BELKIN=m @@ -5734,8 +7133,8 @@ CONFIG_USB_SERIAL_IPAQ=m CONFIG_USB_SERIAL_IR=m CONFIG_USB_SERIAL_EDGEPORT=m CONFIG_USB_SERIAL_EDGEPORT_TI=m -# CONFIG_USB_SERIAL_F81232 is not set -# CONFIG_USB_SERIAL_F8153X is not set +CONFIG_USB_SERIAL_F81232=m +CONFIG_USB_SERIAL_F8153X=m CONFIG_USB_SERIAL_GARMIN=m CONFIG_USB_SERIAL_IPW=m CONFIG_USB_SERIAL_IUU=m @@ -5744,7 +7143,7 @@ CONFIG_USB_SERIAL_KEYSPAN=m CONFIG_USB_SERIAL_KLSI=m CONFIG_USB_SERIAL_KOBIL_SCT=m CONFIG_USB_SERIAL_MCT_U232=m -# CONFIG_USB_SERIAL_METRO is not set +CONFIG_USB_SERIAL_METRO=m CONFIG_USB_SERIAL_MOS7720=m CONFIG_USB_SERIAL_MOS7715_PARPORT=y CONFIG_USB_SERIAL_MOS7840=m @@ -5770,7 +7169,7 @@ CONFIG_USB_SERIAL_XSENS_MT=m CONFIG_USB_SERIAL_WISHBONE=m CONFIG_USB_SERIAL_SSU100=m CONFIG_USB_SERIAL_QT2=m -# CONFIG_USB_SERIAL_UPD78F0730 is not set +CONFIG_USB_SERIAL_UPD78F0730=m CONFIG_USB_SERIAL_DEBUG=m # @@ -5782,8 +7181,8 @@ CONFIG_USB_ADUTUX=m CONFIG_USB_SEVSEG=m CONFIG_USB_LEGOTOWER=m CONFIG_USB_LCD=m -# CONFIG_USB_CYPRESS_CY7C63 is not set -# CONFIG_USB_CYTHERM is not set +CONFIG_USB_CYPRESS_CY7C63=m +CONFIG_USB_CYTHERM=m CONFIG_USB_IDMOUSE=m CONFIG_USB_FTDI_ELAN=m CONFIG_USB_APPLEDISPLAY=m @@ -5792,7 +7191,7 @@ CONFIG_USB_SISUSBVGA_CON=y CONFIG_USB_LD=m CONFIG_USB_TRANCEVIBRATOR=m CONFIG_USB_IOWARRIOR=m -# CONFIG_USB_TEST is not set +CONFIG_USB_TEST=m # CONFIG_USB_EHSET_TEST_FIXTURE is not set CONFIG_USB_ISIGHTFW=m CONFIG_USB_YUREX=m @@ -5801,7 +7200,7 @@ CONFIG_USB_EZUSB_FX2=m CONFIG_USB_HSIC_USB3503=m CONFIG_USB_HSIC_USB4604=m # CONFIG_USB_LINK_LAYER_TEST is not set -CONFIG_USB_CHAOSKEY=m +# CONFIG_USB_CHAOSKEY is not set CONFIG_USB_ATM=m CONFIG_USB_SPEEDTOUCH=m CONFIG_USB_CXACRU=m @@ -5812,20 +7211,46 @@ CONFIG_USB_XUSBATM=m # USB Physical Layer drivers # CONFIG_USB_PHY=y -CONFIG_NOP_USB_XCEIV=y -CONFIG_USB_GPIO_VBUS=m -# CONFIG_TAHVO_USB is not set +CONFIG_NOP_USB_XCEIV=m +# CONFIG_USB_GPIO_VBUS is not set +CONFIG_TAHVO_USB=m +# CONFIG_TAHVO_USB_HOST_BY_DEFAULT is not set CONFIG_USB_ISP1301=m # end of USB Physical Layer drivers # CONFIG_USB_GADGET is not set -# CONFIG_TYPEC is not set -# CONFIG_USB_ROLE_SWITCH is not set +CONFIG_TYPEC=m +CONFIG_TYPEC_TCPM=m +CONFIG_TYPEC_TCPCI=m +CONFIG_TYPEC_RT1711H=m +CONFIG_TYPEC_FUSB302=m +CONFIG_TYPEC_WCOVE=m +CONFIG_TYPEC_UCSI=m +CONFIG_UCSI_CCG=m +CONFIG_UCSI_ACPI=m +# CONFIG_TYPEC_HD3SS3220 is not set +# CONFIG_TYPEC_TPS6598X is not set + +# +# USB Type-C Multiplexer/DeMultiplexer Switch support +# +# CONFIG_TYPEC_MUX_PI3USB30532 is not set +# end of USB Type-C Multiplexer/DeMultiplexer Switch support + +# +# USB Type-C Alternate Mode drivers +# +CONFIG_TYPEC_DP_ALTMODE=m +CONFIG_TYPEC_NVIDIA_ALTMODE=m +# end of USB Type-C Alternate Mode drivers + +CONFIG_USB_ROLE_SWITCH=m +CONFIG_USB_ROLES_INTEL_XHCI=m CONFIG_MMC=m CONFIG_MMC_BLOCK=m CONFIG_MMC_BLOCK_MINORS=8 CONFIG_SDIO_UART=m -# CONFIG_MMC_TEST is not set +CONFIG_MMC_TEST=m # # MMC/SD/SDIO Host Controller Drivers @@ -5837,19 +7262,23 @@ CONFIG_MMC_SDHCI_PCI=m CONFIG_MMC_RICOH_MMC=y CONFIG_MMC_SDHCI_ACPI=m CONFIG_MMC_SDHCI_PLTFM=m -# CONFIG_MMC_SDHCI_F_SDH30 is not set +CONFIG_MMC_SDHCI_F_SDH30=m CONFIG_MMC_WBSD=m +CONFIG_MMC_ALCOR=m CONFIG_MMC_TIFM_SD=m +CONFIG_MMC_SPI=m CONFIG_MMC_SDRICOH_CS=m CONFIG_MMC_CB710=m CONFIG_MMC_VIA_SDMMC=m CONFIG_MMC_VUB300=m CONFIG_MMC_USHC=m CONFIG_MMC_USDHI6ROL0=m +CONFIG_MMC_REALTEK_PCI=m +CONFIG_MMC_REALTEK_USB=m CONFIG_MMC_CQHCI=m -# CONFIG_MMC_TOSHIBA_PCI is not set -# CONFIG_MMC_MTK is not set -# CONFIG_MMC_SDHCI_XENON is not set +CONFIG_MMC_TOSHIBA_PCI=m +CONFIG_MMC_MTK=m +CONFIG_MMC_SDHCI_XENON=m CONFIG_MEMSTICK=m # CONFIG_MEMSTICK_DEBUG is not set @@ -5858,7 +7287,7 @@ CONFIG_MEMSTICK=m # # CONFIG_MEMSTICK_UNSAFE_RESUME is not set CONFIG_MSPRO_BLOCK=m -# CONFIG_MS_BLOCK is not set +CONFIG_MS_BLOCK=m # # MemoryStick Host Controller Drivers @@ -5866,49 +7295,58 @@ CONFIG_MSPRO_BLOCK=m CONFIG_MEMSTICK_TIFM_MS=m CONFIG_MEMSTICK_JMICRON_38X=m CONFIG_MEMSTICK_R592=m +CONFIG_MEMSTICK_REALTEK_PCI=m +CONFIG_MEMSTICK_REALTEK_USB=m CONFIG_NEW_LEDS=y CONFIG_LEDS_CLASS=y -CONFIG_LEDS_CLASS_FLASH=m +# CONFIG_LEDS_CLASS_FLASH is not set # CONFIG_LEDS_BRIGHTNESS_HW_CHANGED is not set # # LED drivers # +CONFIG_LEDS_88PM860X=m # CONFIG_LEDS_APU is not set -# CONFIG_LEDS_AS3645A is not set CONFIG_LEDS_LM3530=m # CONFIG_LEDS_LM3532 is not set CONFIG_LEDS_LM3642=m -# CONFIG_LEDS_LM3601X is not set -# CONFIG_LEDS_MT6323 is not set -CONFIG_LEDS_PCA9532=m -CONFIG_LEDS_PCA9532_GPIO=y +# CONFIG_LEDS_PCA9532 is not set CONFIG_LEDS_GPIO=m -CONFIG_LEDS_LP3944=m -CONFIG_LEDS_LP3952=m +# CONFIG_LEDS_LP3944 is not set +# CONFIG_LEDS_LP3952 is not set CONFIG_LEDS_LP55XX_COMMON=m CONFIG_LEDS_LP5521=m CONFIG_LEDS_LP5523=m CONFIG_LEDS_LP5562=m CONFIG_LEDS_LP8501=m +CONFIG_LEDS_LP8788=m CONFIG_LEDS_CLEVO_MAIL=m -CONFIG_LEDS_PCA955X=m -# CONFIG_LEDS_PCA955X_GPIO is not set +# CONFIG_LEDS_PCA955X is not set CONFIG_LEDS_PCA963X=m +CONFIG_LEDS_WM831X_STATUS=m +CONFIG_LEDS_WM8350=m +CONFIG_LEDS_DA903X=m +CONFIG_LEDS_DA9052=m +CONFIG_LEDS_DAC124S085=m CONFIG_LEDS_PWM=m -CONFIG_LEDS_BD2802=m +CONFIG_LEDS_REGULATOR=m +# CONFIG_LEDS_BD2802 is not set CONFIG_LEDS_INTEL_SS4200=m +CONFIG_LEDS_ADP5520=m +CONFIG_LEDS_MC13783=m CONFIG_LEDS_TCA6507=m -# CONFIG_LEDS_TLC591XX is not set +CONFIG_LEDS_TLC591XX=m +CONFIG_LEDS_MAX8997=m CONFIG_LEDS_LM355x=m +CONFIG_LEDS_MENF21BMC=m # # LED driver for blink(1) USB RGB LED is under Special HID drivers (HID_THINGM) # CONFIG_LEDS_BLINKM=m CONFIG_LEDS_MLXCPLD=m -# CONFIG_LEDS_MLXREG is not set -# CONFIG_LEDS_USER is not set +CONFIG_LEDS_MLXREG=m +CONFIG_LEDS_USER=m # CONFIG_LEDS_NIC78BX is not set # CONFIG_LEDS_TI_LMU_COMMON is not set @@ -5917,8 +7355,8 @@ CONFIG_LEDS_MLXCPLD=m # CONFIG_LEDS_TRIGGERS=y CONFIG_LEDS_TRIGGER_TIMER=m -CONFIG_LEDS_TRIGGER_ONESHOT=y -# CONFIG_LEDS_TRIGGER_DISK is not set +CONFIG_LEDS_TRIGGER_ONESHOT=m +CONFIG_LEDS_TRIGGER_DISK=y # CONFIG_LEDS_TRIGGER_MTD is not set CONFIG_LEDS_TRIGGER_HEARTBEAT=m CONFIG_LEDS_TRIGGER_BACKLIGHT=m @@ -5933,8 +7371,8 @@ CONFIG_LEDS_TRIGGER_DEFAULT_ON=m CONFIG_LEDS_TRIGGER_TRANSIENT=m CONFIG_LEDS_TRIGGER_CAMERA=m # CONFIG_LEDS_TRIGGER_PANIC is not set -# CONFIG_LEDS_TRIGGER_NETDEV is not set -# CONFIG_LEDS_TRIGGER_PATTERN is not set +CONFIG_LEDS_TRIGGER_NETDEV=m +CONFIG_LEDS_TRIGGER_PATTERN=m CONFIG_LEDS_TRIGGER_AUDIO=m CONFIG_ACCESSIBILITY=y CONFIG_A11Y_BRAILLE_CONSOLE=y @@ -5947,39 +7385,39 @@ CONFIG_INFINIBAND_ON_DEMAND_PAGING=y CONFIG_INFINIBAND_ADDR_TRANS=y CONFIG_INFINIBAND_ADDR_TRANS_CONFIGFS=y CONFIG_INFINIBAND_MTHCA=m -CONFIG_INFINIBAND_MTHCA_DEBUG=y +# CONFIG_INFINIBAND_MTHCA_DEBUG is not set CONFIG_INFINIBAND_QIB=m CONFIG_INFINIBAND_QIB_DCA=y CONFIG_INFINIBAND_CXGB4=m -# CONFIG_INFINIBAND_EFA is not set -# CONFIG_INFINIBAND_I40IW is not set +CONFIG_INFINIBAND_EFA=m +CONFIG_INFINIBAND_I40IW=m CONFIG_MLX4_INFINIBAND=m -# CONFIG_INFINIBAND_OCRDMA is not set -# CONFIG_INFINIBAND_VMWARE_PVRDMA is not set +CONFIG_MLX5_INFINIBAND=m +CONFIG_INFINIBAND_OCRDMA=m +CONFIG_INFINIBAND_VMWARE_PVRDMA=m CONFIG_INFINIBAND_USNIC=m -# CONFIG_INFINIBAND_BNXT_RE is not set +CONFIG_INFINIBAND_BNXT_RE=m CONFIG_INFINIBAND_HFI1=m -CONFIG_HFI1_DEBUG_SDMA_ORDER=y -CONFIG_SDMA_VERBOSITY=y +# CONFIG_HFI1_DEBUG_SDMA_ORDER is not set +# CONFIG_SDMA_VERBOSITY is not set CONFIG_INFINIBAND_QEDR=m CONFIG_INFINIBAND_RDMAVT=m CONFIG_RDMA_RXE=m -# CONFIG_RDMA_SIW is not set +CONFIG_RDMA_SIW=m CONFIG_INFINIBAND_IPOIB=m -CONFIG_INFINIBAND_IPOIB_CM=y -CONFIG_INFINIBAND_IPOIB_DEBUG=y -CONFIG_INFINIBAND_IPOIB_DEBUG_DATA=y +# CONFIG_INFINIBAND_IPOIB_CM is not set +# CONFIG_INFINIBAND_IPOIB_DEBUG is not set CONFIG_INFINIBAND_SRP=m CONFIG_INFINIBAND_SRPT=m CONFIG_INFINIBAND_ISER=m CONFIG_INFINIBAND_ISERT=m -# CONFIG_INFINIBAND_OPA_VNIC is not set +CONFIG_INFINIBAND_OPA_VNIC=m CONFIG_EDAC_ATOMIC_SCRUB=y CONFIG_EDAC_SUPPORT=y CONFIG_EDAC=y CONFIG_EDAC_LEGACY_SYSFS=y # CONFIG_EDAC_DEBUG is not set -CONFIG_EDAC_DECODE_MCE=m +CONFIG_EDAC_DECODE_MCE=y # CONFIG_EDAC_GHES is not set CONFIG_EDAC_AMD64=m # CONFIG_EDAC_AMD64_ERROR_INJECTION is not set @@ -5996,8 +7434,8 @@ CONFIG_EDAC_I5100=m CONFIG_EDAC_I7300=m CONFIG_EDAC_SBRIDGE=m CONFIG_EDAC_SKX=m -# CONFIG_EDAC_I10NM is not set -# CONFIG_EDAC_PND2 is not set +CONFIG_EDAC_I10NM=m +CONFIG_EDAC_PND2=m CONFIG_RTC_LIB=y CONFIG_RTC_MC146818_LIB=y CONFIG_RTC_CLASS=y @@ -6012,93 +7450,119 @@ CONFIG_RTC_NVMEM=y # RTC interfaces # CONFIG_RTC_INTF_SYSFS=y -CONFIG_RTC_INTF_PROC=y +# CONFIG_RTC_INTF_PROC is not set CONFIG_RTC_INTF_DEV=y -# CONFIG_RTC_INTF_DEV_UIE_EMUL is not set +CONFIG_RTC_INTF_DEV_UIE_EMUL=y # CONFIG_RTC_DRV_TEST is not set # # I2C RTC drivers # -CONFIG_RTC_DRV_ABB5ZES3=m +CONFIG_RTC_DRV_88PM860X=m +CONFIG_RTC_DRV_88PM80X=m +# CONFIG_RTC_DRV_ABB5ZES3 is not set # CONFIG_RTC_DRV_ABEOZ9 is not set -CONFIG_RTC_DRV_ABX80X=m -CONFIG_RTC_DRV_DS1307=m -# CONFIG_RTC_DRV_DS1307_CENTURY is not set -CONFIG_RTC_DRV_DS1374=m -# CONFIG_RTC_DRV_DS1374_WDT is not set -CONFIG_RTC_DRV_DS1672=m -CONFIG_RTC_DRV_MAX6900=m -CONFIG_RTC_DRV_RS5C372=m +# CONFIG_RTC_DRV_ABX80X is not set +# CONFIG_RTC_DRV_DS1307 is not set +# CONFIG_RTC_DRV_DS1374 is not set +# CONFIG_RTC_DRV_DS1672 is not set +CONFIG_RTC_DRV_LP8788=m +# CONFIG_RTC_DRV_MAX6900 is not set +CONFIG_RTC_DRV_MAX8907=m +CONFIG_RTC_DRV_MAX8925=m +CONFIG_RTC_DRV_MAX8998=m +CONFIG_RTC_DRV_MAX8997=m +# CONFIG_RTC_DRV_RS5C372 is not set CONFIG_RTC_DRV_ISL1208=m CONFIG_RTC_DRV_ISL12022=m -CONFIG_RTC_DRV_X1205=m +# CONFIG_RTC_DRV_X1205 is not set CONFIG_RTC_DRV_PCF8523=m CONFIG_RTC_DRV_PCF85063=m # CONFIG_RTC_DRV_PCF85363 is not set -CONFIG_RTC_DRV_PCF8563=m -CONFIG_RTC_DRV_PCF8583=m -CONFIG_RTC_DRV_M41T80=m -CONFIG_RTC_DRV_M41T80_WDT=y +# CONFIG_RTC_DRV_PCF8563 is not set +# CONFIG_RTC_DRV_PCF8583 is not set +# CONFIG_RTC_DRV_M41T80 is not set CONFIG_RTC_DRV_BQ32K=m +CONFIG_RTC_DRV_PALMAS=m +CONFIG_RTC_DRV_TPS6586X=m +CONFIG_RTC_DRV_TPS65910=m +CONFIG_RTC_DRV_TPS80031=m +CONFIG_RTC_DRV_RC5T583=m # CONFIG_RTC_DRV_S35390A is not set -CONFIG_RTC_DRV_FM3130=m -# CONFIG_RTC_DRV_RX8010 is not set -CONFIG_RTC_DRV_RX8581=m -CONFIG_RTC_DRV_RX8025=m -CONFIG_RTC_DRV_EM3027=m +# CONFIG_RTC_DRV_FM3130 is not set +CONFIG_RTC_DRV_RX8010=m +# CONFIG_RTC_DRV_RX8581 is not set +# CONFIG_RTC_DRV_RX8025 is not set +# CONFIG_RTC_DRV_EM3027 is not set # CONFIG_RTC_DRV_RV3028 is not set CONFIG_RTC_DRV_RV8803=m +CONFIG_RTC_DRV_S5M=m # CONFIG_RTC_DRV_SD3078 is not set # # SPI RTC drivers # -CONFIG_RTC_I2C_AND_SPI=m +CONFIG_RTC_DRV_M41T93=m +CONFIG_RTC_DRV_M41T94=m +CONFIG_RTC_DRV_DS1302=m +CONFIG_RTC_DRV_DS1305=m +CONFIG_RTC_DRV_DS1343=m +CONFIG_RTC_DRV_DS1347=m +CONFIG_RTC_DRV_DS1390=m +CONFIG_RTC_DRV_MAX6916=m +CONFIG_RTC_DRV_R9701=m +CONFIG_RTC_DRV_RX4581=m +CONFIG_RTC_DRV_RX6110=m +CONFIG_RTC_DRV_RS5C348=m +CONFIG_RTC_DRV_MAX6902=m +CONFIG_RTC_DRV_PCF2123=m +CONFIG_RTC_DRV_MCP795=m +CONFIG_RTC_I2C_AND_SPI=y # # SPI and I2C RTC drivers # -CONFIG_RTC_DRV_DS3232=m -CONFIG_RTC_DRV_DS3232_HWMON=y -# CONFIG_RTC_DRV_PCF2127 is not set -CONFIG_RTC_DRV_RV3029C2=m -CONFIG_RTC_DRV_RV3029_HWMON=y +# CONFIG_RTC_DRV_DS3232 is not set +CONFIG_RTC_DRV_PCF2127=m +# CONFIG_RTC_DRV_RV3029C2 is not set # # Platform RTC drivers # CONFIG_RTC_DRV_CMOS=y -CONFIG_RTC_DRV_DS1286=m -CONFIG_RTC_DRV_DS1511=m -CONFIG_RTC_DRV_DS1553=m -CONFIG_RTC_DRV_DS1685_FAMILY=m -CONFIG_RTC_DRV_DS1685=y -# CONFIG_RTC_DRV_DS1689 is not set -# CONFIG_RTC_DRV_DS17285 is not set -# CONFIG_RTC_DRV_DS17485 is not set -# CONFIG_RTC_DRV_DS17885 is not set -CONFIG_RTC_DRV_DS1742=m -CONFIG_RTC_DRV_DS2404=m -CONFIG_RTC_DRV_STK17TA8=m +# CONFIG_RTC_DRV_DS1286 is not set +# CONFIG_RTC_DRV_DS1511 is not set +# CONFIG_RTC_DRV_DS1553 is not set +# CONFIG_RTC_DRV_DS1685_FAMILY is not set +# CONFIG_RTC_DRV_DS1742 is not set +# CONFIG_RTC_DRV_DS2404 is not set +CONFIG_RTC_DRV_DA9052=m +CONFIG_RTC_DRV_DA9055=m +CONFIG_RTC_DRV_DA9063=m +# CONFIG_RTC_DRV_STK17TA8 is not set # CONFIG_RTC_DRV_M48T86 is not set -CONFIG_RTC_DRV_M48T35=m -CONFIG_RTC_DRV_M48T59=m -CONFIG_RTC_DRV_MSM6242=m -CONFIG_RTC_DRV_BQ4802=m -CONFIG_RTC_DRV_RP5C01=m -CONFIG_RTC_DRV_V3020=m -# CONFIG_RTC_DRV_CROS_EC is not set +# CONFIG_RTC_DRV_M48T35 is not set +# CONFIG_RTC_DRV_M48T59 is not set +# CONFIG_RTC_DRV_MSM6242 is not set +# CONFIG_RTC_DRV_BQ4802 is not set +# CONFIG_RTC_DRV_RP5C01 is not set +# CONFIG_RTC_DRV_V3020 is not set +CONFIG_RTC_DRV_WM831X=m +CONFIG_RTC_DRV_WM8350=m +CONFIG_RTC_DRV_CROS_EC=m # # on-CPU RTC drivers # # CONFIG_RTC_DRV_FTRTC010 is not set -# CONFIG_RTC_DRV_MT6397 is not set +CONFIG_RTC_DRV_PCAP=m +CONFIG_RTC_DRV_MC13XXX=m # # HID Sensor RTC drivers # +CONFIG_RTC_DRV_HID_SENSOR_TIME=m +CONFIG_RTC_DRV_WILCO_EC=m CONFIG_DMADEVICES=y # CONFIG_DMADEVICES_DEBUG is not set @@ -6106,27 +7570,29 @@ CONFIG_DMADEVICES=y # DMA Devices # CONFIG_DMA_ENGINE=y -CONFIG_DMA_VIRTUAL_CHANNELS=y +CONFIG_DMA_VIRTUAL_CHANNELS=m CONFIG_DMA_ACPI=y -# CONFIG_ALTERA_MSGDMA is not set +CONFIG_ALTERA_MSGDMA=m CONFIG_INTEL_IDMA64=m +CONFIG_INTEL_IDXD=m CONFIG_INTEL_IOATDMA=m CONFIG_INTEL_MIC_X100_DMA=m -# CONFIG_QCOM_HIDMA_MGMT is not set -# CONFIG_QCOM_HIDMA is not set -CONFIG_DW_DMAC_CORE=y -# CONFIG_DW_DMAC is not set -# CONFIG_DW_DMAC_PCI is not set -# CONFIG_DW_EDMA is not set -# CONFIG_DW_EDMA_PCIE is not set -CONFIG_HSU_DMA=y -# CONFIG_SF_PDMA is not set +CONFIG_PLX_DMA=m +CONFIG_QCOM_HIDMA_MGMT=m +CONFIG_QCOM_HIDMA=m +CONFIG_DW_DMAC_CORE=m +CONFIG_DW_DMAC=m +CONFIG_DW_DMAC_PCI=m +CONFIG_DW_EDMA=m +CONFIG_DW_EDMA_PCIE=m +CONFIG_HSU_DMA=m +CONFIG_SF_PDMA=m # # DMA Clients # -CONFIG_ASYNC_TX_DMA=y -# CONFIG_DMATEST is not set +# CONFIG_ASYNC_TX_DMA is not set +CONFIG_DMATEST=m CONFIG_DMA_ENGINE_RAID=y # @@ -6134,8 +7600,11 @@ CONFIG_DMA_ENGINE_RAID=y # CONFIG_SYNC_FILE=y # CONFIG_SW_SYNC is not set -# CONFIG_UDMABUF is not set +CONFIG_UDMABUF=y # CONFIG_DMABUF_SELFTESTS is not set +CONFIG_DMABUF_HEAPS=y +CONFIG_DMABUF_HEAPS_SYSTEM=y +CONFIG_DMABUF_HEAPS_CMA=y # end of DMABUF options CONFIG_DCA=m @@ -6147,11 +7616,15 @@ CONFIG_KS0108_DELAY=2 CONFIG_CFAG12864B=m CONFIG_CFAG12864B_RATE=20 # CONFIG_IMG_ASCII_LCD is not set -# CONFIG_PARPORT_PANEL is not set +CONFIG_PARPORT_PANEL=m +CONFIG_PANEL_PARPORT=0 +CONFIG_PANEL_PROFILE=5 +# CONFIG_PANEL_CHANGE_MESSAGE is not set # CONFIG_CHARLCD_BL_OFF is not set # CONFIG_CHARLCD_BL_ON is not set CONFIG_CHARLCD_BL_FLASH=y -# CONFIG_PANEL is not set +CONFIG_PANEL=m +CONFIG_CHARLCD=m CONFIG_UIO=m CONFIG_UIO_CIF=m # CONFIG_UIO_PDRV_GENIRQ is not set @@ -6159,26 +7632,29 @@ CONFIG_UIO_DMEM_GENIRQ=m CONFIG_UIO_AEC=m CONFIG_UIO_SERCOS3=m CONFIG_UIO_PCI_GENERIC=m -# CONFIG_UIO_NETX is not set -# CONFIG_UIO_PRUSS is not set -# CONFIG_UIO_MF624 is not set -# CONFIG_UIO_HV_GENERIC is not set -CONFIG_VFIO_IOMMU_TYPE1=y -CONFIG_VFIO_VIRQFD=y -CONFIG_VFIO=y +CONFIG_UIO_NETX=m +CONFIG_UIO_PRUSS=m +CONFIG_UIO_MF624=m +CONFIG_UIO_HV_GENERIC=m +CONFIG_VFIO_IOMMU_TYPE1=m +CONFIG_VFIO_VIRQFD=m +CONFIG_VFIO=m # CONFIG_VFIO_NOIOMMU is not set -CONFIG_VFIO_PCI=y +CONFIG_VFIO_PCI=m CONFIG_VFIO_PCI_VGA=y CONFIG_VFIO_PCI_MMAP=y CONFIG_VFIO_PCI_INTX=y CONFIG_VFIO_PCI_IGD=y -# CONFIG_VFIO_MDEV is not set -CONFIG_IRQ_BYPASS_MANAGER=y -# CONFIG_VIRT_DRIVERS is not set -CONFIG_VIRTIO=y +CONFIG_VFIO_MDEV=m +CONFIG_VFIO_MDEV_DEVICE=m +CONFIG_IRQ_BYPASS_MANAGER=m +CONFIG_VIRT_DRIVERS=y +CONFIG_VBOXGUEST=m +CONFIG_VIRTIO=m CONFIG_VIRTIO_MENU=y -CONFIG_VIRTIO_PCI=y +CONFIG_VIRTIO_PCI=m CONFIG_VIRTIO_PCI_LEGACY=y +CONFIG_VIRTIO_PMEM=m CONFIG_VIRTIO_BALLOON=m CONFIG_VIRTIO_INPUT=m CONFIG_VIRTIO_MMIO=m @@ -6212,42 +7688,256 @@ CONFIG_SWIOTLB_XEN=y CONFIG_XEN_PCIDEV_BACKEND=m # CONFIG_XEN_PVCALLS_FRONTEND is not set # CONFIG_XEN_PVCALLS_BACKEND is not set -# CONFIG_XEN_SCSI_BACKEND is not set +CONFIG_XEN_SCSI_BACKEND=m CONFIG_XEN_PRIVCMD=m CONFIG_XEN_ACPI_PROCESSOR=m -CONFIG_XEN_MCE_LOG=y +# CONFIG_XEN_MCE_LOG is not set CONFIG_XEN_HAVE_PVMMU=y CONFIG_XEN_EFI=y CONFIG_XEN_AUTO_XLATE=y CONFIG_XEN_ACPI=y CONFIG_XEN_SYMS=y CONFIG_XEN_HAVE_VPMU=y +CONFIG_XEN_FRONT_PGDIR_SHBUF=m # end of Xen driver support -CONFIG_GREYBUS=m -CONFIG_GREYBUS_ES2=m +# CONFIG_GREYBUS is not set CONFIG_STAGING=y -# CONFIG_PRISM2_USB is not set -# CONFIG_COMEDI is not set -# CONFIG_RTL8192U is not set -# CONFIG_RTLLIB is not set -# CONFIG_RTL8723BS is not set +CONFIG_PRISM2_USB=m +CONFIG_COMEDI=m +# CONFIG_COMEDI_DEBUG is not set +CONFIG_COMEDI_DEFAULT_BUF_SIZE_KB=2048 +CONFIG_COMEDI_DEFAULT_BUF_MAXSIZE_KB=20480 +CONFIG_COMEDI_MISC_DRIVERS=y +CONFIG_COMEDI_BOND=m +CONFIG_COMEDI_TEST=m +CONFIG_COMEDI_PARPORT=m +CONFIG_COMEDI_ISA_DRIVERS=y +CONFIG_COMEDI_PCL711=m +CONFIG_COMEDI_PCL724=m +CONFIG_COMEDI_PCL726=m +CONFIG_COMEDI_PCL730=m +CONFIG_COMEDI_PCL812=m +CONFIG_COMEDI_PCL816=m +CONFIG_COMEDI_PCL818=m +CONFIG_COMEDI_PCM3724=m +CONFIG_COMEDI_AMPLC_DIO200_ISA=m +CONFIG_COMEDI_AMPLC_PC236_ISA=m +CONFIG_COMEDI_AMPLC_PC263_ISA=m +CONFIG_COMEDI_RTI800=m +CONFIG_COMEDI_RTI802=m +# CONFIG_COMEDI_DAC02 is not set +CONFIG_COMEDI_DAS16M1=m +CONFIG_COMEDI_DAS08_ISA=m +CONFIG_COMEDI_DAS16=m +CONFIG_COMEDI_DAS800=m +CONFIG_COMEDI_DAS1800=m +CONFIG_COMEDI_DAS6402=m +CONFIG_COMEDI_DT2801=m +CONFIG_COMEDI_DT2811=m +CONFIG_COMEDI_DT2814=m +CONFIG_COMEDI_DT2815=m +CONFIG_COMEDI_DT2817=m +CONFIG_COMEDI_DT282X=m +CONFIG_COMEDI_DMM32AT=m +CONFIG_COMEDI_FL512=m +CONFIG_COMEDI_AIO_AIO12_8=m +CONFIG_COMEDI_AIO_IIRO_16=m +CONFIG_COMEDI_II_PCI20KC=m +CONFIG_COMEDI_C6XDIGIO=m +CONFIG_COMEDI_MPC624=m +CONFIG_COMEDI_ADQ12B=m +CONFIG_COMEDI_NI_AT_A2150=m +CONFIG_COMEDI_NI_AT_AO=m +CONFIG_COMEDI_NI_ATMIO=m +CONFIG_COMEDI_NI_ATMIO16D=m +CONFIG_COMEDI_NI_LABPC_ISA=m +CONFIG_COMEDI_PCMAD=m +CONFIG_COMEDI_PCMDA12=m +CONFIG_COMEDI_PCMMIO=m +CONFIG_COMEDI_PCMUIO=m +CONFIG_COMEDI_MULTIQ3=m +CONFIG_COMEDI_S526=m +CONFIG_COMEDI_PCI_DRIVERS=m +CONFIG_COMEDI_8255_PCI=m +CONFIG_COMEDI_ADDI_WATCHDOG=m +CONFIG_COMEDI_ADDI_APCI_1032=m +CONFIG_COMEDI_ADDI_APCI_1500=m +CONFIG_COMEDI_ADDI_APCI_1516=m +CONFIG_COMEDI_ADDI_APCI_1564=m +CONFIG_COMEDI_ADDI_APCI_16XX=m +CONFIG_COMEDI_ADDI_APCI_2032=m +CONFIG_COMEDI_ADDI_APCI_2200=m +CONFIG_COMEDI_ADDI_APCI_3120=m +CONFIG_COMEDI_ADDI_APCI_3501=m +CONFIG_COMEDI_ADDI_APCI_3XXX=m +CONFIG_COMEDI_ADL_PCI6208=m +CONFIG_COMEDI_ADL_PCI7X3X=m +CONFIG_COMEDI_ADL_PCI8164=m +CONFIG_COMEDI_ADL_PCI9111=m +CONFIG_COMEDI_ADL_PCI9118=m +CONFIG_COMEDI_ADV_PCI1710=m +CONFIG_COMEDI_ADV_PCI1720=m +CONFIG_COMEDI_ADV_PCI1723=m +CONFIG_COMEDI_ADV_PCI1724=m +CONFIG_COMEDI_ADV_PCI1760=m +CONFIG_COMEDI_ADV_PCI_DIO=m +CONFIG_COMEDI_AMPLC_DIO200_PCI=m +CONFIG_COMEDI_AMPLC_PC236_PCI=m +CONFIG_COMEDI_AMPLC_PC263_PCI=m +CONFIG_COMEDI_AMPLC_PCI224=m +CONFIG_COMEDI_AMPLC_PCI230=m +CONFIG_COMEDI_CONTEC_PCI_DIO=m +CONFIG_COMEDI_DAS08_PCI=m +CONFIG_COMEDI_DT3000=m +CONFIG_COMEDI_DYNA_PCI10XX=m +CONFIG_COMEDI_GSC_HPDI=m +CONFIG_COMEDI_MF6X4=m +CONFIG_COMEDI_ICP_MULTI=m +CONFIG_COMEDI_DAQBOARD2000=m +CONFIG_COMEDI_JR3_PCI=m +CONFIG_COMEDI_KE_COUNTER=m +CONFIG_COMEDI_CB_PCIDAS64=m +CONFIG_COMEDI_CB_PCIDAS=m +CONFIG_COMEDI_CB_PCIDDA=m +CONFIG_COMEDI_CB_PCIMDAS=m +CONFIG_COMEDI_CB_PCIMDDA=m +CONFIG_COMEDI_ME4000=m +CONFIG_COMEDI_ME_DAQ=m +CONFIG_COMEDI_NI_6527=m +CONFIG_COMEDI_NI_65XX=m +CONFIG_COMEDI_NI_660X=m +CONFIG_COMEDI_NI_670X=m +CONFIG_COMEDI_NI_LABPC_PCI=m +CONFIG_COMEDI_NI_PCIDIO=m +CONFIG_COMEDI_NI_PCIMIO=m +CONFIG_COMEDI_RTD520=m +CONFIG_COMEDI_S626=m +CONFIG_COMEDI_MITE=m +CONFIG_COMEDI_NI_TIOCMD=m +CONFIG_COMEDI_PCMCIA_DRIVERS=m +CONFIG_COMEDI_CB_DAS16_CS=m +CONFIG_COMEDI_DAS08_CS=m +CONFIG_COMEDI_NI_DAQ_700_CS=m +CONFIG_COMEDI_NI_DAQ_DIO24_CS=m +CONFIG_COMEDI_NI_LABPC_CS=m +CONFIG_COMEDI_NI_MIO_CS=m +CONFIG_COMEDI_QUATECH_DAQP_CS=m +CONFIG_COMEDI_USB_DRIVERS=m +CONFIG_COMEDI_DT9812=m +CONFIG_COMEDI_NI_USB6501=m +CONFIG_COMEDI_USBDUX=m +CONFIG_COMEDI_USBDUXFAST=m +CONFIG_COMEDI_USBDUXSIGMA=m +CONFIG_COMEDI_VMK80XX=m +CONFIG_COMEDI_8254=m +CONFIG_COMEDI_8255=m +CONFIG_COMEDI_8255_SA=m +CONFIG_COMEDI_KCOMEDILIB=m +CONFIG_COMEDI_AMPLC_DIO200=m +CONFIG_COMEDI_AMPLC_PC236=m +CONFIG_COMEDI_DAS08=m +CONFIG_COMEDI_ISADMA=m +CONFIG_COMEDI_NI_LABPC=m +CONFIG_COMEDI_NI_LABPC_ISADMA=m +CONFIG_COMEDI_NI_TIO=m +CONFIG_COMEDI_NI_ROUTING=m +CONFIG_RTL8192U=m +CONFIG_RTLLIB=m +CONFIG_RTLLIB_CRYPTO_CCMP=m +CONFIG_RTLLIB_CRYPTO_TKIP=m +CONFIG_RTLLIB_CRYPTO_WEP=m +CONFIG_RTL8192E=m +CONFIG_RTL8723BS=m CONFIG_R8712U=m CONFIG_R8188EU=m CONFIG_88EU_AP_MODE=y CONFIG_RTS5208=m -# CONFIG_VT6655 is not set -# CONFIG_VT6656 is not set -CONFIG_FB_SM750=m +CONFIG_VT6655=m +CONFIG_VT6656=m + +# +# IIO staging drivers +# + +# +# Accelerometers +# +CONFIG_ADIS16203=m +CONFIG_ADIS16240=m +# end of Accelerometers + +# +# Analog to digital converters +# +CONFIG_AD7816=m +CONFIG_AD7192=m +CONFIG_AD7280=m +# end of Analog to digital converters + +# +# Analog digital bi-direction converters +# +CONFIG_ADT7316=m +CONFIG_ADT7316_SPI=m +CONFIG_ADT7316_I2C=m +# end of Analog digital bi-direction converters + +# +# Capacitance to digital converters +# +CONFIG_AD7150=m +CONFIG_AD7746=m +# end of Capacitance to digital converters + +# +# Direct Digital Synthesis +# +CONFIG_AD9832=m +CONFIG_AD9834=m +# end of Direct Digital Synthesis + +# +# Network Analyzer, Impedance Converters +# +CONFIG_AD5933=m +# end of Network Analyzer, Impedance Converters + +# +# Active energy metering IC +# +CONFIG_ADE7854=m +CONFIG_ADE7854_I2C=m +CONFIG_ADE7854_SPI=m +# end of Active energy metering IC + +# +# Resolver to digital converters +# +CONFIG_AD2S1210=m +# end of Resolver to digital converters +# end of IIO staging drivers + +# CONFIG_FB_SM750 is not set # # Speakup console speech # -# CONFIG_SPEAKUP is not set +CONFIG_SPEAKUP=m +CONFIG_SPEAKUP_SYNTH_ACNTSA=m +CONFIG_SPEAKUP_SYNTH_APOLLO=m +CONFIG_SPEAKUP_SYNTH_AUDPTR=m +CONFIG_SPEAKUP_SYNTH_BNS=m +CONFIG_SPEAKUP_SYNTH_DECTLK=m +CONFIG_SPEAKUP_SYNTH_DECEXT=m +CONFIG_SPEAKUP_SYNTH_LTLK=m +CONFIG_SPEAKUP_SYNTH_SOFT=m +CONFIG_SPEAKUP_SYNTH_SPKOUT=m +CONFIG_SPEAKUP_SYNTH_TXPRT=m +CONFIG_SPEAKUP_SYNTH_DUMMY=m # end of Speakup console speech CONFIG_STAGING_MEDIA=y -# CONFIG_VIDEO_IPU3_IMGU is not set # # soc_camera sensor drivers @@ -6256,9 +7946,6 @@ CONFIG_STAGING_MEDIA=y # # Android # -# CONFIG_ASHMEM is not set -# CONFIG_ANDROID_VSOC is not set -# CONFIG_ION is not set # end of Android CONFIG_LTE_GDM724X=m @@ -6267,31 +7954,23 @@ CONFIG_FWTTY_MAX_TOTAL_PORTS=64 CONFIG_FWTTY_MAX_CARD_PORTS=32 # CONFIG_GS_FPGABOOT is not set CONFIG_UNISYSSPAR=y -# CONFIG_WILC1000_SDIO is not set +CONFIG_UNISYS_VISORNIC=m +CONFIG_UNISYS_VISORINPUT=m +CONFIG_UNISYS_VISORHBA=m +# CONFIG_FB_TFT is not set +CONFIG_WILC1000=m +CONFIG_WILC1000_SDIO=m +# CONFIG_WILC1000_SPI is not set +# CONFIG_WILC1000_HW_OOB_INTR is not set CONFIG_MOST=m -# CONFIG_MOST_CDEV is not set -# CONFIG_MOST_NET is not set -# CONFIG_MOST_SOUND is not set -# CONFIG_MOST_VIDEO is not set -# CONFIG_MOST_I2C is not set -# CONFIG_MOST_USB is not set +CONFIG_MOST_CDEV=m +CONFIG_MOST_NET=m +CONFIG_MOST_SOUND=m +CONFIG_MOST_VIDEO=m +CONFIG_MOST_I2C=m +CONFIG_MOST_USB=m CONFIG_KS7010=m -CONFIG_GREYBUS_AUDIO=m -CONFIG_GREYBUS_BOOTROM=m -CONFIG_GREYBUS_HID=m -CONFIG_GREYBUS_LIGHT=m -CONFIG_GREYBUS_LOG=m -CONFIG_GREYBUS_LOOPBACK=m -CONFIG_GREYBUS_POWER=m -CONFIG_GREYBUS_RAW=m -CONFIG_GREYBUS_VIBRATOR=m -CONFIG_GREYBUS_BRIDGED_PHY=m -CONFIG_GREYBUS_GPIO=m -CONFIG_GREYBUS_I2C=m -CONFIG_GREYBUS_PWM=m -CONFIG_GREYBUS_SDIO=m -CONFIG_GREYBUS_UART=m -CONFIG_GREYBUS_USB=m +# CONFIG_PI433 is not set # # Gasket devices @@ -6299,29 +7978,8 @@ CONFIG_GREYBUS_USB=m # CONFIG_STAGING_GASKET_FRAMEWORK is not set # end of Gasket devices -# CONFIG_FIELDBUS_DEV is not set +CONFIG_FIELDBUS_DEV=m # CONFIG_KPC2000 is not set - -# -# ISDN CAPI drivers -# -CONFIG_CAPI_AVM=y -CONFIG_ISDN_DRV_AVMB1_B1PCI=m -CONFIG_ISDN_DRV_AVMB1_B1PCIV4=y -CONFIG_ISDN_DRV_AVMB1_B1PCMCIA=m -CONFIG_ISDN_DRV_AVMB1_AVM_CS=m -CONFIG_ISDN_DRV_AVMB1_T1PCI=m -CONFIG_ISDN_DRV_AVMB1_C4=m -CONFIG_ISDN_DRV_GIGASET=m -CONFIG_GIGASET_CAPI=y -CONFIG_GIGASET_BASE=m -CONFIG_GIGASET_M105=m -CONFIG_GIGASET_M101=m -# CONFIG_GIGASET_DEBUG is not set -CONFIG_HYSDN=m -CONFIG_HYSDN_CAPI=y -# end of ISDN CAPI drivers - CONFIG_USB_WUSB=m CONFIG_USB_WUSB_CBAF=m # CONFIG_USB_WUSB_CBAF_DEBUG is not set @@ -6331,37 +7989,43 @@ CONFIG_UWB=m CONFIG_UWB_HWA=m CONFIG_UWB_WHCI=m CONFIG_UWB_I1480U=m -# CONFIG_EXFAT_FS is not set CONFIG_QLGE=m -# CONFIG_NET_VENDOR_HP is not set -# CONFIG_WFX is not set +CONFIG_NET_VENDOR_HP=y +CONFIG_HP100=m +CONFIG_WFX=m CONFIG_X86_PLATFORM_DEVICES=y CONFIG_ACER_WMI=m -# CONFIG_ACER_WIRELESS is not set +CONFIG_ACER_WIRELESS=m CONFIG_ACERHDF=m CONFIG_ALIENWARE_WMI=m CONFIG_ASUS_LAPTOP=m CONFIG_DCDBAS=m -# CONFIG_DELL_SMBIOS is not set +CONFIG_DELL_SMBIOS=m +CONFIG_DELL_SMBIOS_WMI=y +CONFIG_DELL_SMBIOS_SMM=y +CONFIG_DELL_LAPTOP=m +CONFIG_DELL_WMI=m +CONFIG_DELL_WMI_DESCRIPTOR=m CONFIG_DELL_WMI_AIO=m -# CONFIG_DELL_WMI_LED is not set +CONFIG_DELL_WMI_LED=m CONFIG_DELL_SMO8800=m -# CONFIG_DELL_RBTN is not set -CONFIG_DELL_RBU=m +CONFIG_DELL_RBTN=m +# CONFIG_DELL_RBU is not set CONFIG_FUJITSU_LAPTOP=m CONFIG_FUJITSU_TABLET=m CONFIG_AMILO_RFKILL=m -# CONFIG_GPD_POCKET_FAN is not set +CONFIG_GPD_POCKET_FAN=m CONFIG_HP_ACCEL=m CONFIG_HP_WIRELESS=m CONFIG_HP_WMI=m -# CONFIG_LG_LAPTOP is not set +CONFIG_LG_LAPTOP=m CONFIG_MSI_LAPTOP=m CONFIG_PANASONIC_LAPTOP=m CONFIG_COMPAL_LAPTOP=m CONFIG_SONY_LAPTOP=m CONFIG_SONYPI_COMPAT=y CONFIG_IDEAPAD_LAPTOP=m +CONFIG_SURFACE3_WMI=m CONFIG_THINKPAD_ACPI=m CONFIG_THINKPAD_ACPI_ALSA_SUPPORT=y # CONFIG_THINKPAD_ACPI_DEBUGFACILITIES is not set @@ -6375,68 +8039,81 @@ CONFIG_EEEPC_LAPTOP=m CONFIG_ASUS_WMI=m CONFIG_ASUS_NB_WMI=m CONFIG_EEEPC_WMI=m -# CONFIG_ASUS_WIRELESS is not set +CONFIG_ASUS_WIRELESS=m CONFIG_ACPI_WMI=m CONFIG_WMI_BMOF=m -# CONFIG_INTEL_WMI_THUNDERBOLT is not set -# CONFIG_XIAOMI_WMI is not set +CONFIG_INTEL_WMI_THUNDERBOLT=m +CONFIG_XIAOMI_WMI=m CONFIG_MSI_WMI=m -# CONFIG_PEAQ_WMI is not set +CONFIG_PEAQ_WMI=m CONFIG_TOPSTAR_LAPTOP=m +CONFIG_ACPI_TOSHIBA=m CONFIG_TOSHIBA_BT_RFKILL=m CONFIG_TOSHIBA_HAPS=m CONFIG_TOSHIBA_WMI=m CONFIG_ACPI_CMPC=m -# CONFIG_INTEL_INT0002_VGPIO is not set -# CONFIG_INTEL_HID_EVENT is not set +CONFIG_INTEL_INT0002_VGPIO=m +CONFIG_INTEL_HID_EVENT=m CONFIG_INTEL_VBTN=m CONFIG_INTEL_IPS=m -# CONFIG_INTEL_PMC_CORE is not set -# CONFIG_IBM_RTL is not set +CONFIG_INTEL_PMC_CORE=y +CONFIG_IBM_RTL=m CONFIG_SAMSUNG_LAPTOP=m CONFIG_MXM_WMI=m CONFIG_INTEL_OAKTRAIL=m CONFIG_SAMSUNG_Q10=m CONFIG_APPLE_GMUX=m CONFIG_INTEL_RST=m -# CONFIG_INTEL_SMARTCONNECT is not set -# CONFIG_INTEL_PMC_IPC is not set +CONFIG_INTEL_SMARTCONNECT=m +CONFIG_INTEL_PMC_IPC=m +CONFIG_INTEL_BXTWC_PMIC_TMU=m CONFIG_SURFACE_PRO3_BUTTON=m -# CONFIG_SURFACE_3_BUTTON is not set -# CONFIG_INTEL_PUNIT_IPC is not set -# CONFIG_MLX_PLATFORM is not set -# CONFIG_INTEL_TURBO_MAX_3 is not set -# CONFIG_I2C_MULTI_INSTANTIATE is not set -# CONFIG_INTEL_ATOMISP2_PM is not set -# CONFIG_HUAWEI_WMI is not set +CONFIG_SURFACE_3_BUTTON=m +CONFIG_INTEL_PUNIT_IPC=m +CONFIG_INTEL_TELEMETRY=m +CONFIG_MLX_PLATFORM=m +CONFIG_INTEL_TURBO_MAX_3=y +CONFIG_TOUCHSCREEN_DMI=y +CONFIG_INTEL_CHTDC_TI_PWRBTN=m +CONFIG_I2C_MULTI_INSTANTIATE=m +CONFIG_INTEL_ATOMISP2_PM=m +CONFIG_HUAWEI_WMI=m # CONFIG_PCENGINES_APU2 is not set +CONFIG_INTEL_UNCORE_FREQ_CONTROL=m # # Intel Speed Select Technology interface support # -# CONFIG_INTEL_SPEED_SELECT_INTERFACE is not set +CONFIG_INTEL_SPEED_SELECT_INTERFACE=m # end of Intel Speed Select Technology interface support -# CONFIG_SYSTEM76_ACPI is not set +CONFIG_SYSTEM76_ACPI=m CONFIG_PMC_ATOM=y CONFIG_MFD_CROS_EC=m CONFIG_CHROME_PLATFORMS=y CONFIG_CHROMEOS_LAPTOP=m CONFIG_CHROMEOS_PSTORE=m -# CONFIG_CHROMEOS_TBMC is not set +CONFIG_CHROMEOS_TBMC=m CONFIG_CROS_EC=m -# CONFIG_CROS_EC_I2C is not set -# CONFIG_CROS_EC_ISHTP is not set +CONFIG_CROS_EC_I2C=m +CONFIG_CROS_EC_ISHTP=m +CONFIG_CROS_EC_SPI=m CONFIG_CROS_EC_LPC=m CONFIG_CROS_EC_PROTO=y -# CONFIG_CROS_KBD_LED_BACKLIGHT is not set +CONFIG_CROS_KBD_LED_BACKLIGHT=m CONFIG_CROS_EC_CHARDEV=m CONFIG_CROS_EC_LIGHTBAR=m CONFIG_CROS_EC_DEBUGFS=m CONFIG_CROS_EC_SENSORHUB=m CONFIG_CROS_EC_SYSFS=m -# CONFIG_WILCO_EC is not set -# CONFIG_MELLANOX_PLATFORM is not set +CONFIG_CROS_USBPD_LOGGER=m +CONFIG_WILCO_EC=m +CONFIG_WILCO_EC_DEBUGFS=m +CONFIG_WILCO_EC_EVENTS=m +CONFIG_WILCO_EC_TELEMETRY=m +CONFIG_MELLANOX_PLATFORM=y +CONFIG_MLXREG_HOTPLUG=m +CONFIG_MLXREG_IO=m CONFIG_CLKDEV_LOOKUP=y CONFIG_HAVE_CLK_PREPARE=y CONFIG_COMMON_CLK=y @@ -6444,12 +8121,16 @@ CONFIG_COMMON_CLK=y # # Common Clock Framework # +CONFIG_COMMON_CLK_WM831X=m # CONFIG_COMMON_CLK_MAX9485 is not set # CONFIG_COMMON_CLK_SI5341 is not set CONFIG_COMMON_CLK_SI5351=m # CONFIG_COMMON_CLK_SI544 is not set -CONFIG_COMMON_CLK_CDCE706=m -# CONFIG_COMMON_CLK_CS2000_CP is not set +# CONFIG_COMMON_CLK_CDCE706 is not set +CONFIG_COMMON_CLK_CS2000_CP=m +CONFIG_COMMON_CLK_S2MPS11=m +CONFIG_CLK_TWL6040=m +CONFIG_COMMON_CLK_PALMAS=m CONFIG_COMMON_CLK_PWM=m # end of Common Clock Framework @@ -6485,6 +8166,7 @@ CONFIG_INTEL_IOMMU=y # CONFIG_INTEL_IOMMU_SVM is not set # CONFIG_INTEL_IOMMU_DEFAULT_ON is not set CONFIG_INTEL_IOMMU_FLOPPY_WA=y +# CONFIG_INTEL_IOMMU_SCALABLE_MODE_DEFAULT_ON is not set CONFIG_IRQ_REMAP=y CONFIG_HYPERV_IOMMU=y @@ -6497,11 +8179,20 @@ CONFIG_HYPERV_IOMMU=y # # Rpmsg drivers # -# CONFIG_RPMSG_QCOM_GLINK_RPM is not set -# CONFIG_RPMSG_VIRTIO is not set +CONFIG_RPMSG=m +# CONFIG_RPMSG_CHAR is not set +CONFIG_RPMSG_QCOM_GLINK_NATIVE=m +CONFIG_RPMSG_QCOM_GLINK_RPM=m +CONFIG_RPMSG_VIRTIO=m # end of Rpmsg drivers -# CONFIG_SOUNDWIRE is not set +CONFIG_SOUNDWIRE=y + +# +# SoundWire Devices +# +CONFIG_SOUNDWIRE_CADENCE=m +CONFIG_SOUNDWIRE_INTEL=m # # SOC (System On Chip) specific Drivers @@ -6542,7 +8233,7 @@ CONFIG_HYPERV_IOMMU=y # # Xilinx SoC drivers # -# CONFIG_XILINX_VCU is not set +CONFIG_XILINX_VCU=m # end of Xilinx SoC drivers # end of SOC (System On Chip) specific Drivers @@ -6560,66 +8251,583 @@ CONFIG_DEVFREQ_GOV_SIMPLE_ONDEMAND=m # # DEVFREQ Drivers # -CONFIG_PM_DEVFREQ_EVENT=y +# CONFIG_PM_DEVFREQ_EVENT is not set CONFIG_EXTCON=y # # Extcon Device Drivers # +CONFIG_EXTCON_ADC_JACK=m +# CONFIG_EXTCON_ARIZONA is not set +CONFIG_EXTCON_AXP288=m # CONFIG_EXTCON_FSA9480 is not set -# CONFIG_EXTCON_GPIO is not set -# CONFIG_EXTCON_INTEL_INT3496 is not set -# CONFIG_EXTCON_MAX14577 is not set -# CONFIG_EXTCON_MAX3355 is not set +CONFIG_EXTCON_GPIO=m +CONFIG_EXTCON_INTEL_INT3496=m +CONFIG_EXTCON_INTEL_CHT_WC=m +CONFIG_EXTCON_MAX14577=m +CONFIG_EXTCON_MAX3355=m +CONFIG_EXTCON_MAX77693=m +CONFIG_EXTCON_MAX8997=m +CONFIG_EXTCON_PALMAS=m # CONFIG_EXTCON_PTN5150 is not set -# CONFIG_EXTCON_RT8973A is not set -# CONFIG_EXTCON_SM5502 is not set -# CONFIG_EXTCON_USB_GPIO is not set -# CONFIG_EXTCON_USBC_CROS_EC is not set -# CONFIG_MEMORY is not set -# CONFIG_IIO is not set +CONFIG_EXTCON_RT8973A=m +CONFIG_EXTCON_SM5502=m +CONFIG_EXTCON_USB_GPIO=m +CONFIG_EXTCON_USBC_CROS_EC=m +CONFIG_MEMORY=y +CONFIG_IIO=m +CONFIG_IIO_BUFFER=y +CONFIG_IIO_BUFFER_CB=m +CONFIG_IIO_BUFFER_HW_CONSUMER=m +CONFIG_IIO_KFIFO_BUF=m +CONFIG_IIO_TRIGGERED_BUFFER=m +CONFIG_IIO_CONFIGFS=m +CONFIG_IIO_TRIGGER=y +CONFIG_IIO_CONSUMERS_PER_TRIGGER=2 +CONFIG_IIO_SW_DEVICE=m +CONFIG_IIO_SW_TRIGGER=m +CONFIG_IIO_TRIGGERED_EVENT=m + +# +# Accelerometers +# +CONFIG_ADIS16201=m +CONFIG_ADIS16209=m +CONFIG_ADXL345=m +CONFIG_ADXL345_I2C=m +CONFIG_ADXL345_SPI=m +# CONFIG_ADXL372_SPI is not set +# CONFIG_ADXL372_I2C is not set +CONFIG_BMA180=m +CONFIG_BMA220=m +# CONFIG_BMA400 is not set +CONFIG_BMC150_ACCEL=m +CONFIG_BMC150_ACCEL_I2C=m +CONFIG_BMC150_ACCEL_SPI=m +# CONFIG_DA280 is not set +# CONFIG_DA311 is not set +# CONFIG_DMARD09 is not set +# CONFIG_DMARD10 is not set +CONFIG_HID_SENSOR_ACCEL_3D=m +# CONFIG_IIO_CROS_EC_ACCEL_LEGACY is not set +CONFIG_IIO_ST_ACCEL_3AXIS=m +CONFIG_IIO_ST_ACCEL_I2C_3AXIS=m +CONFIG_IIO_ST_ACCEL_SPI_3AXIS=m +CONFIG_KXSD9=m +CONFIG_KXSD9_SPI=m +CONFIG_KXSD9_I2C=m +CONFIG_KXCJK1013=m +# CONFIG_MC3230 is not set +CONFIG_MMA7455=m +CONFIG_MMA7455_I2C=m +CONFIG_MMA7455_SPI=m +CONFIG_MMA7660=m +CONFIG_MMA8452=m +# CONFIG_MMA9551 is not set +# CONFIG_MMA9553 is not set +CONFIG_MXC4005=m +CONFIG_MXC6255=m +CONFIG_SCA3000=m +CONFIG_STK8312=m +CONFIG_STK8BA50=m +# end of Accelerometers + +# +# Analog to digital converters +# +CONFIG_AD_SIGMA_DELTA=m +# CONFIG_AD7091R5 is not set +CONFIG_AD7124=m +CONFIG_AD7266=m +CONFIG_AD7291=m +CONFIG_AD7292=m +CONFIG_AD7298=m +CONFIG_AD7476=m +CONFIG_AD7606=m +CONFIG_AD7606_IFACE_PARALLEL=m +CONFIG_AD7606_IFACE_SPI=m +CONFIG_AD7766=m +# CONFIG_AD7768_1 is not set +CONFIG_AD7780=m +CONFIG_AD7791=m +CONFIG_AD7793=m +CONFIG_AD7887=m +CONFIG_AD7923=m +CONFIG_AD7949=m +CONFIG_AD799X=m +# CONFIG_AXP20X_ADC is not set +CONFIG_AXP288_ADC=m +# CONFIG_CC10001_ADC is not set +CONFIG_DLN2_ADC=m +CONFIG_HI8435=m +# CONFIG_HX711 is not set +CONFIG_INA2XX_ADC=m +CONFIG_LP8788_ADC=m +CONFIG_LTC2471=m +# CONFIG_LTC2485 is not set +# CONFIG_LTC2496 is not set +# CONFIG_LTC2497 is not set +CONFIG_MAX1027=m +# CONFIG_MAX11100 is not set +# CONFIG_MAX1118 is not set +CONFIG_MAX1363=m +# CONFIG_MAX9611 is not set +CONFIG_MCP320X=m +CONFIG_MCP3422=m +# CONFIG_MCP3911 is not set +CONFIG_NAU7802=m +CONFIG_PALMAS_GPADC=m +CONFIG_QCOM_SPMI_IADC=m +# CONFIG_QCOM_SPMI_VADC is not set +# CONFIG_QCOM_SPMI_ADC5 is not set +CONFIG_TI_ADC081C=m +CONFIG_TI_ADC0832=m +CONFIG_TI_ADC084S021=m +# CONFIG_TI_ADC12138 is not set +CONFIG_TI_ADC108S102=m +CONFIG_TI_ADC128S052=m +# CONFIG_TI_ADC161S626 is not set +CONFIG_TI_ADS1015=m +# CONFIG_TI_ADS7950 is not set +CONFIG_TI_AM335X_ADC=m +# CONFIG_TI_TLC4541 is not set +CONFIG_TWL4030_MADC=m +CONFIG_TWL6030_GPADC=m +CONFIG_VIPERBOARD_ADC=m +CONFIG_XILINX_XADC=m +# end of Analog to digital converters + +# +# Analog Front Ends +# +# end of Analog Front Ends + +# +# Amplifiers +# +CONFIG_AD8366=m +# end of Amplifiers + +# +# Chemical Sensors +# +CONFIG_ATLAS_PH_SENSOR=m +# CONFIG_BME680 is not set +CONFIG_CCS811=m +CONFIG_IAQCORE=m +# CONFIG_PMS7003 is not set +# CONFIG_SENSIRION_SGP30 is not set +# CONFIG_SPS30 is not set +CONFIG_VZ89X=m +# end of Chemical Sensors + +CONFIG_IIO_CROS_EC_SENSORS_CORE=m +CONFIG_IIO_CROS_EC_SENSORS=m +CONFIG_IIO_CROS_EC_SENSORS_LID_ANGLE=m + +# +# Hid Sensor IIO Common +# +CONFIG_HID_SENSOR_IIO_COMMON=m +CONFIG_HID_SENSOR_IIO_TRIGGER=m +# end of Hid Sensor IIO Common + +CONFIG_IIO_MS_SENSORS_I2C=m + +# +# SSP Sensor Common +# +# CONFIG_IIO_SSP_SENSORHUB is not set +# end of SSP Sensor Common + +CONFIG_IIO_ST_SENSORS_I2C=m +CONFIG_IIO_ST_SENSORS_SPI=m +CONFIG_IIO_ST_SENSORS_CORE=m + +# +# Digital to analog converters +# +CONFIG_AD5064=m +CONFIG_AD5360=m +CONFIG_AD5380=m +CONFIG_AD5421=m +CONFIG_AD5446=m +CONFIG_AD5449=m +CONFIG_AD5592R_BASE=m +CONFIG_AD5592R=m +CONFIG_AD5593R=m +CONFIG_AD5504=m +CONFIG_AD5624R_SPI=m +# CONFIG_LTC1660 is not set +# CONFIG_LTC2632 is not set +CONFIG_AD5686=m +CONFIG_AD5686_SPI=m +CONFIG_AD5696_I2C=m +CONFIG_AD5755=m +CONFIG_AD5758=m +CONFIG_AD5761=m +CONFIG_AD5764=m +CONFIG_AD5791=m +CONFIG_AD7303=m +# CONFIG_CIO_DAC is not set +CONFIG_AD8801=m +# CONFIG_DS4424 is not set +CONFIG_M62332=m +CONFIG_MAX517=m +CONFIG_MCP4725=m +CONFIG_MCP4922=m +# CONFIG_TI_DAC082S085 is not set +# CONFIG_TI_DAC5571 is not set +# CONFIG_TI_DAC7311 is not set +# CONFIG_TI_DAC7612 is not set +# end of Digital to analog converters + +# +# IIO dummy driver +# +# CONFIG_IIO_SIMPLE_DUMMY is not set +# end of IIO dummy driver + +# +# Frequency Synthesizers DDS/PLL +# + +# +# Clock Generator/Distribution +# +CONFIG_AD9523=m +# end of Clock Generator/Distribution + +# +# Phase-Locked Loop (PLL) frequency synthesizers +# +CONFIG_ADF4350=m +CONFIG_ADF4371=m +# end of Phase-Locked Loop (PLL) frequency synthesizers +# end of Frequency Synthesizers DDS/PLL + +# +# Digital gyroscope sensors +# +CONFIG_ADIS16080=m +CONFIG_ADIS16130=m +CONFIG_ADIS16136=m +CONFIG_ADIS16260=m +CONFIG_ADXRS450=m +CONFIG_BMG160=m +CONFIG_BMG160_I2C=m +CONFIG_BMG160_SPI=m +# CONFIG_FXAS21002C is not set +CONFIG_HID_SENSOR_GYRO_3D=m +# CONFIG_MPU3050_I2C is not set +CONFIG_IIO_ST_GYRO_3AXIS=m +CONFIG_IIO_ST_GYRO_I2C_3AXIS=m +CONFIG_IIO_ST_GYRO_SPI_3AXIS=m +CONFIG_ITG3200=m +# end of Digital gyroscope sensors + +# +# Health Sensors +# + +# +# Heart Rate Monitors +# +CONFIG_AFE4403=m +CONFIG_AFE4404=m +CONFIG_MAX30100=m +# CONFIG_MAX30102 is not set +# end of Heart Rate Monitors +# end of Health Sensors + +# +# Humidity sensors +# +CONFIG_AM2315=m +CONFIG_DHT11=m +CONFIG_HDC100X=m +CONFIG_HID_SENSOR_HUMIDITY=m +CONFIG_HTS221=m +CONFIG_HTS221_I2C=m +CONFIG_HTS221_SPI=m +CONFIG_HTU21=m +CONFIG_SI7005=m +CONFIG_SI7020=m +# end of Humidity sensors + +# +# Inertial measurement units +# +CONFIG_ADIS16400=m +CONFIG_ADIS16460=m +CONFIG_ADIS16480=m +CONFIG_BMI160=m +CONFIG_BMI160_I2C=m +CONFIG_BMI160_SPI=m +CONFIG_FXOS8700=m +CONFIG_FXOS8700_I2C=m +CONFIG_FXOS8700_SPI=m +# CONFIG_KMX61 is not set +CONFIG_INV_MPU6050_IIO=m +CONFIG_INV_MPU6050_I2C=m +CONFIG_INV_MPU6050_SPI=m +# CONFIG_IIO_ST_LSM6DSX is not set +# end of Inertial measurement units + +CONFIG_IIO_ADIS_LIB=m +CONFIG_IIO_ADIS_LIB_BUFFER=y + +# +# Light sensors +# +CONFIG_ACPI_ALS=m +CONFIG_ADJD_S311=m +# CONFIG_ADUX1020 is not set +CONFIG_AL3320A=m +CONFIG_APDS9300=m +CONFIG_APDS9960=m +CONFIG_BH1750=m +CONFIG_BH1780=m +CONFIG_CM32181=m +# CONFIG_CM3232 is not set +# CONFIG_CM3323 is not set +CONFIG_CM36651=m +CONFIG_IIO_CROS_EC_LIGHT_PROX=m +CONFIG_GP2AP020A00F=m +CONFIG_SENSORS_ISL29018=m +CONFIG_SENSORS_ISL29028=m +CONFIG_ISL29125=m +CONFIG_HID_SENSOR_ALS=m +CONFIG_HID_SENSOR_PROX=m +# CONFIG_JSA1212 is not set +CONFIG_RPR0521=m +CONFIG_LTR501=m +# CONFIG_LV0104CS is not set +CONFIG_MAX44000=m +# CONFIG_MAX44009 is not set +# CONFIG_NOA1305 is not set +CONFIG_OPT3001=m +CONFIG_PA12203001=m +# CONFIG_SI1133 is not set +# CONFIG_SI1145 is not set +CONFIG_STK3310=m +CONFIG_ST_UVIS25=m +CONFIG_ST_UVIS25_I2C=m +CONFIG_ST_UVIS25_SPI=m +CONFIG_TCS3414=m +CONFIG_TCS3472=m +CONFIG_SENSORS_TSL2563=m +CONFIG_TSL2583=m +# CONFIG_TSL2772 is not set +CONFIG_TSL4531=m +CONFIG_US5182D=m +CONFIG_VCNL4000=m +# CONFIG_VCNL4035 is not set +# CONFIG_VEML6030 is not set +CONFIG_VEML6070=m +# CONFIG_VL6180 is not set +# CONFIG_ZOPT2201 is not set +# end of Light sensors + +# +# Magnetometer sensors +# +CONFIG_AK8975=m +CONFIG_AK09911=m +CONFIG_BMC150_MAGN=m +CONFIG_BMC150_MAGN_I2C=m +CONFIG_BMC150_MAGN_SPI=m +CONFIG_MAG3110=m +CONFIG_HID_SENSOR_MAGNETOMETER_3D=m +CONFIG_MMC35240=m +CONFIG_IIO_ST_MAGN_3AXIS=m +CONFIG_IIO_ST_MAGN_I2C_3AXIS=m +CONFIG_IIO_ST_MAGN_SPI_3AXIS=m +CONFIG_SENSORS_HMC5843=m +CONFIG_SENSORS_HMC5843_I2C=m +CONFIG_SENSORS_HMC5843_SPI=m +# CONFIG_SENSORS_RM3100_I2C is not set +# CONFIG_SENSORS_RM3100_SPI is not set +# end of Magnetometer sensors + +# +# Multiplexers +# +# end of Multiplexers + +# +# Inclinometer sensors +# +CONFIG_HID_SENSOR_INCLINOMETER_3D=m +CONFIG_HID_SENSOR_DEVICE_ROTATION=m +# end of Inclinometer sensors + +# +# Triggers - standalone +# +CONFIG_IIO_HRTIMER_TRIGGER=m +CONFIG_IIO_INTERRUPT_TRIGGER=m +# CONFIG_IIO_TIGHTLOOP_TRIGGER is not set +CONFIG_IIO_SYSFS_TRIGGER=m +# end of Triggers - standalone + +# +# Digital potentiometers +# +# CONFIG_AD5272 is not set +CONFIG_DS1803=m +# CONFIG_MAX5432 is not set +# CONFIG_MAX5481 is not set +# CONFIG_MAX5487 is not set +# CONFIG_MCP4018 is not set +CONFIG_MCP4131=m +CONFIG_MCP4531=m +# CONFIG_MCP41010 is not set +CONFIG_TPL0102=m +# end of Digital potentiometers + +# +# Digital potentiostats +# +# CONFIG_LMP91000 is not set +# end of Digital potentiostats + +# +# Pressure sensors +# +# CONFIG_ABP060MG is not set +# CONFIG_BMP280 is not set +CONFIG_IIO_CROS_EC_BARO=m +# CONFIG_DLHL60D is not set +# CONFIG_DPS310 is not set +CONFIG_HID_SENSOR_PRESS=m +CONFIG_HP03=m +CONFIG_MPL115=m +CONFIG_MPL115_I2C=m +CONFIG_MPL115_SPI=m +# CONFIG_MPL3115 is not set +# CONFIG_MS5611 is not set +CONFIG_MS5637=m +CONFIG_IIO_ST_PRESS=m +CONFIG_IIO_ST_PRESS_I2C=m +CONFIG_IIO_ST_PRESS_SPI=m +CONFIG_T5403=m +CONFIG_HP206C=m +# CONFIG_ZPA2326 is not set +# end of Pressure sensors + +# +# Lightning sensors +# +CONFIG_AS3935=m +# end of Lightning sensors + +# +# Proximity and distance sensors +# +# CONFIG_ISL29501 is not set +CONFIG_LIDAR_LITE_V2=m +# CONFIG_MB1232 is not set +# CONFIG_PING is not set +# CONFIG_RFD77402 is not set +# CONFIG_SRF04 is not set +# CONFIG_SX9500 is not set +# CONFIG_SRF08 is not set +# CONFIG_VL53L0X_I2C is not set +# end of Proximity and distance sensors + +# +# Resolver to digital converters +# +CONFIG_AD2S90=m +CONFIG_AD2S1200=m +# end of Resolver to digital converters + +# +# Temperature sensors +# +# CONFIG_LTC2983 is not set +# CONFIG_MAXIM_THERMOCOUPLE is not set +CONFIG_HID_SENSOR_TEMP=m +CONFIG_MLX90614=m +CONFIG_MLX90632=m +CONFIG_TMP006=m +# CONFIG_TMP007 is not set +CONFIG_TSYS01=m +CONFIG_TSYS02D=m +# CONFIG_MAX31856 is not set +# end of Temperature sensors + CONFIG_NTB=m # CONFIG_NTB_MSI is not set -# CONFIG_NTB_AMD is not set -# CONFIG_NTB_IDT is not set -# CONFIG_NTB_INTEL is not set +CONFIG_NTB_AMD=m +CONFIG_NTB_IDT=m +CONFIG_NTB_INTEL=m # CONFIG_NTB_SWITCHTEC is not set -# CONFIG_NTB_PINGPONG is not set -# CONFIG_NTB_TOOL is not set -# CONFIG_NTB_PERF is not set -# CONFIG_NTB_TRANSPORT is not set -# CONFIG_VME_BUS is not set +CONFIG_NTB_PINGPONG=m +CONFIG_NTB_TOOL=m +CONFIG_NTB_PERF=m +CONFIG_NTB_TRANSPORT=m +CONFIG_VME_BUS=y + +# +# VME Bridge Drivers +# +CONFIG_VME_CA91CX42=m +CONFIG_VME_TSI148=m +# CONFIG_VME_FAKE is not set + +# +# VME Board Drivers +# +CONFIG_VMIVME_7805=m + +# +# VME Device Drivers +# +CONFIG_VME_USER=m CONFIG_PWM=y CONFIG_PWM_SYSFS=y +CONFIG_PWM_CRC=y CONFIG_PWM_CROS_EC=m CONFIG_PWM_LP3943=m -# CONFIG_PWM_LPSS_PCI is not set -# CONFIG_PWM_LPSS_PLATFORM is not set +CONFIG_PWM_LPSS=m +CONFIG_PWM_LPSS_PCI=m +CONFIG_PWM_LPSS_PLATFORM=m CONFIG_PWM_PCA9685=m +CONFIG_PWM_TWL=m +CONFIG_PWM_TWL_LED=m # # IRQ chip support # +CONFIG_MADERA_IRQ=m # end of IRQ chip support # CONFIG_IPACK_BUS is not set CONFIG_RESET_CONTROLLER=y -# CONFIG_RESET_TI_SYSCON is not set +# CONFIG_RESET_BRCMSTB_RESCAL is not set +CONFIG_RESET_TI_SYSCON=m # # PHY Subsystem # CONFIG_GENERIC_PHY=y CONFIG_BCM_KONA_USB2_PHY=m -# CONFIG_PHY_PXA_28NM_HSIC is not set -# CONFIG_PHY_PXA_28NM_USB2 is not set +CONFIG_PHY_PXA_28NM_HSIC=m +CONFIG_PHY_PXA_28NM_USB2=m +CONFIG_PHY_CPCAP_USB=m +CONFIG_PHY_QCOM_USB_HS=m +CONFIG_PHY_QCOM_USB_HSIC=m CONFIG_PHY_SAMSUNG_USB2=m +CONFIG_PHY_TUSB1210=m +CONFIG_PHY_INTEL_EMMC=m # end of PHY Subsystem CONFIG_POWERCAP=y CONFIG_INTEL_RAPL_CORE=m CONFIG_INTEL_RAPL=m -# CONFIG_IDLE_INJECT is not set +CONFIG_IDLE_INJECT=y # CONFIG_MCB is not set # @@ -6629,37 +8837,47 @@ CONFIG_INTEL_RAPL=m CONFIG_RAS=y # CONFIG_RAS_CEC is not set -CONFIG_THUNDERBOLT=m +CONFIG_USB4=m # # Android # -CONFIG_ANDROID=y -CONFIG_ANDROID_BINDER_IPC=y -# CONFIG_ANDROID_BINDERFS is not set -CONFIG_ANDROID_BINDER_DEVICES="binder,hwbinder,vndbinder" -# CONFIG_ANDROID_BINDER_IPC_SELFTEST is not set +# CONFIG_ANDROID is not set # end of Android -# CONFIG_LIBNVDIMM is not set +CONFIG_LIBNVDIMM=m +CONFIG_BLK_DEV_PMEM=m +CONFIG_ND_BLK=m +CONFIG_ND_CLAIM=y +CONFIG_ND_BTT=m +CONFIG_BTT=y +CONFIG_ND_PFN=m +CONFIG_NVDIMM_PFN=y +CONFIG_NVDIMM_DAX=y +CONFIG_NVDIMM_KEYS=y +CONFIG_DAX_DRIVER=y CONFIG_DAX=y -# CONFIG_DEV_DAX is not set +CONFIG_DEV_DAX=m +CONFIG_DEV_DAX_PMEM=m +CONFIG_DEV_DAX_KMEM=m +CONFIG_DEV_DAX_PMEM_COMPAT=m CONFIG_NVMEM=y CONFIG_NVMEM_SYSFS=y +CONFIG_NVMEM_SPMI_SDAM=m # # HW tracing support # CONFIG_STM=m -# CONFIG_STM_PROTO_BASIC is not set -# CONFIG_STM_PROTO_SYS_T is not set +CONFIG_STM_PROTO_BASIC=m +CONFIG_STM_PROTO_SYS_T=m CONFIG_STM_DUMMY=m CONFIG_STM_SOURCE_CONSOLE=m -# CONFIG_STM_SOURCE_HEARTBEAT is not set +CONFIG_STM_SOURCE_HEARTBEAT=m # CONFIG_STM_SOURCE_FTRACE is not set CONFIG_INTEL_TH=m CONFIG_INTEL_TH_PCI=m -# CONFIG_INTEL_TH_ACPI is not set +CONFIG_INTEL_TH_ACPI=m CONFIG_INTEL_TH_GTH=m CONFIG_INTEL_TH_STH=m CONFIG_INTEL_TH_MSU=m @@ -6669,11 +8887,22 @@ CONFIG_INTEL_TH_PTI=m CONFIG_FPGA=m # CONFIG_ALTERA_PR_IP_CORE is not set +# CONFIG_FPGA_MGR_ALTERA_PS_SPI is not set # CONFIG_FPGA_MGR_ALTERA_CVP is not set +# CONFIG_FPGA_MGR_XILINX_SPI is not set +# CONFIG_FPGA_MGR_MACHXO2_SPI is not set # CONFIG_FPGA_BRIDGE is not set # CONFIG_FPGA_DFL is not set +CONFIG_TEE=m + +# +# TEE drivers +# +CONFIG_AMDTEE=m +# end of TEE drivers + CONFIG_PM_OPP=y -# CONFIG_UNISYS_VISORBUS is not set +CONFIG_UNISYS_VISORBUS=m # CONFIG_SIOX is not set # CONFIG_SLIMBUS is not set # CONFIG_INTERCONNECT is not set @@ -6686,9 +8915,9 @@ CONFIG_PM_OPP=y CONFIG_DCACHE_WORD_ACCESS=y # CONFIG_VALIDATE_FS_PARSER is not set CONFIG_FS_IOMAP=y -CONFIG_EXT2_FS=m +CONFIG_EXT2_FS=y CONFIG_EXT2_FS_XATTR=y -# CONFIG_EXT2_FS_POSIX_ACL is not set +CONFIG_EXT2_FS_POSIX_ACL=y CONFIG_EXT2_FS_SECURITY=y CONFIG_EXT3_FS=m CONFIG_EXT3_FS_POSIX_ACL=y @@ -6710,11 +8939,11 @@ CONFIG_JFS_FS=m CONFIG_JFS_POSIX_ACL=y CONFIG_JFS_SECURITY=y # CONFIG_JFS_DEBUG is not set -# CONFIG_JFS_STATISTICS is not set +CONFIG_JFS_STATISTICS=y CONFIG_XFS_FS=m CONFIG_XFS_QUOTA=y CONFIG_XFS_POSIX_ACL=y -# CONFIG_XFS_RT is not set +CONFIG_XFS_RT=y # CONFIG_XFS_ONLINE_SCRUB is not set # CONFIG_XFS_WARN is not set # CONFIG_XFS_DEBUG is not set @@ -6723,10 +8952,10 @@ CONFIG_GFS2_FS_LOCKING_DLM=y CONFIG_OCFS2_FS=m CONFIG_OCFS2_FS_O2CB=m CONFIG_OCFS2_FS_USERSPACE_CLUSTER=m -# CONFIG_OCFS2_FS_STATS is not set -# CONFIG_OCFS2_DEBUG_MASKLOG is not set +CONFIG_OCFS2_FS_STATS=y +CONFIG_OCFS2_DEBUG_MASKLOG=y # CONFIG_OCFS2_DEBUG_FS is not set -CONFIG_BTRFS_FS=m +CONFIG_BTRFS_FS=y CONFIG_BTRFS_FS_POSIX_ACL=y # CONFIG_BTRFS_FS_CHECK_INTEGRITY is not set # CONFIG_BTRFS_FS_RUN_SANITY_TESTS is not set @@ -6738,18 +8967,22 @@ CONFIG_F2FS_FS=m CONFIG_F2FS_STAT_FS=y CONFIG_F2FS_FS_XATTR=y CONFIG_F2FS_FS_POSIX_ACL=y -# CONFIG_F2FS_FS_SECURITY is not set +CONFIG_F2FS_FS_SECURITY=y # CONFIG_F2FS_CHECK_FS is not set -CONFIG_F2FS_IO_TRACE=y +# CONFIG_F2FS_IO_TRACE is not set # CONFIG_F2FS_FAULT_INJECTION is not set +CONFIG_F2FS_FS_COMPRESSION=y +CONFIG_F2FS_FS_LZO=y +CONFIG_F2FS_FS_LZ4=y CONFIG_FS_DAX=y CONFIG_FS_DAX_PMD=y CONFIG_FS_POSIX_ACL=y CONFIG_EXPORTFS=y -# CONFIG_EXPORTFS_BLOCK_OPS is not set +CONFIG_EXPORTFS_BLOCK_OPS=y CONFIG_FILE_LOCKING=y CONFIG_MANDATORY_FILE_LOCKING=y CONFIG_FS_ENCRYPTION=y +CONFIG_FS_ENCRYPTION_ALGS=y # CONFIG_FS_VERITY is not set CONFIG_FSNOTIFY=y CONFIG_DNOTIFY=y @@ -6758,24 +8991,42 @@ CONFIG_FANOTIFY=y CONFIG_FANOTIFY_ACCESS_PERMISSIONS=y CONFIG_QUOTA=y CONFIG_QUOTA_NETLINK_INTERFACE=y -# CONFIG_PRINT_QUOTA_WARNING is not set +CONFIG_PRINT_QUOTA_WARNING=y # CONFIG_QUOTA_DEBUG is not set CONFIG_QUOTA_TREE=y -# CONFIG_QFMT_V1 is not set +CONFIG_QFMT_V1=m CONFIG_QFMT_V2=y CONFIG_QUOTACTL=y CONFIG_QUOTACTL_COMPAT=y -CONFIG_AUTOFS4_FS=y -CONFIG_AUTOFS_FS=y +CONFIG_AUTOFS4_FS=m +CONFIG_AUTOFS_FS=m CONFIG_FUSE_FS=m CONFIG_CUSE=m -# CONFIG_VIRTIO_FS is not set -CONFIG_OVERLAY_FS=y +CONFIG_VIRTIO_FS=m +CONFIG_OVERLAY_FS=m # CONFIG_OVERLAY_FS_REDIRECT_DIR is not set CONFIG_OVERLAY_FS_REDIRECT_ALWAYS_FOLLOW=y # CONFIG_OVERLAY_FS_INDEX is not set # CONFIG_OVERLAY_FS_XINO_AUTO is not set # CONFIG_OVERLAY_FS_METACOPY is not set +CONFIG_AUFS_FS=m +# CONFIG_AUFS_BRANCH_MAX_127 is not set +CONFIG_AUFS_BRANCH_MAX_511=y +# CONFIG_AUFS_BRANCH_MAX_1023 is not set +# CONFIG_AUFS_BRANCH_MAX_32767 is not set +CONFIG_AUFS_SBILIST=y +# CONFIG_AUFS_HNOTIFY is not set +# CONFIG_AUFS_EXPORT is not set +# CONFIG_AUFS_XATTR is not set +# CONFIG_AUFS_FHSM is not set +# CONFIG_AUFS_RDU is not set +# CONFIG_AUFS_DIRREN is not set +CONFIG_AUFS_SHWH=y +# CONFIG_AUFS_BR_RAMFS is not set +# CONFIG_AUFS_BR_FUSE is not set +CONFIG_AUFS_BR_HFSPLUS=y +CONFIG_AUFS_BDEV_LOOP=y +# CONFIG_AUFS_DEBUG is not set # # Caches @@ -6783,33 +9034,37 @@ CONFIG_OVERLAY_FS_REDIRECT_ALWAYS_FOLLOW=y CONFIG_FSCACHE=m CONFIG_FSCACHE_STATS=y # CONFIG_FSCACHE_HISTOGRAM is not set -# CONFIG_FSCACHE_DEBUG is not set -CONFIG_FSCACHE_OBJECT_LIST=y +CONFIG_FSCACHE_DEBUG=y +# CONFIG_FSCACHE_OBJECT_LIST is not set CONFIG_CACHEFILES=m -# CONFIG_CACHEFILES_DEBUG is not set +CONFIG_CACHEFILES_DEBUG=y # CONFIG_CACHEFILES_HISTOGRAM is not set # end of Caches # # CD-ROM/DVD Filesystems # -CONFIG_ISO9660_FS=y +CONFIG_ISO9660_FS=m CONFIG_JOLIET=y CONFIG_ZISOFS=y CONFIG_UDF_FS=m # end of CD-ROM/DVD Filesystems # -# DOS/FAT/NT Filesystems +# DOS/FAT/EXFAT/NT Filesystems # CONFIG_FAT_FS=m CONFIG_MSDOS_FS=m CONFIG_VFAT_FS=m CONFIG_FAT_DEFAULT_CODEPAGE=437 -CONFIG_FAT_DEFAULT_IOCHARSET="ascii" -# CONFIG_FAT_DEFAULT_UTF8 is not set -# CONFIG_NTFS_FS is not set -# end of DOS/FAT/NT Filesystems +CONFIG_FAT_DEFAULT_IOCHARSET="iso8859-1" +CONFIG_FAT_DEFAULT_UTF8=y +CONFIG_EXFAT_FS=m +CONFIG_EXFAT_DEFAULT_IOCHARSET="utf8" +CONFIG_NTFS_FS=m +# CONFIG_NTFS_DEBUG is not set +# CONFIG_NTFS_RW is not set +# end of DOS/FAT/EXFAT/NT Filesystems # # Pseudo filesystems @@ -6820,8 +9075,9 @@ CONFIG_PROC_VMCORE=y # CONFIG_PROC_VMCORE_DEVICE_DUMP is not set CONFIG_PROC_SYSCTL=y CONFIG_PROC_PAGE_MONITOR=y -# CONFIG_PROC_CHILDREN is not set +CONFIG_PROC_CHILDREN=y CONFIG_PROC_PID_ARCH_STATUS=y +CONFIG_PROC_CPU_RESCTRL=y CONFIG_KERNFS=y CONFIG_SYSFS=y CONFIG_TMPFS=y @@ -6831,23 +9087,34 @@ CONFIG_HUGETLBFS=y CONFIG_HUGETLB_PAGE=y CONFIG_MEMFD_CREATE=y CONFIG_ARCH_HAS_GIGANTIC_PAGE=y -CONFIG_CONFIGFS_FS=y -CONFIG_EFIVAR_FS=y +CONFIG_CONFIGFS_FS=m +CONFIG_EFIVAR_FS=m # end of Pseudo filesystems CONFIG_MISC_FILESYSTEMS=y -# CONFIG_ORANGEFS_FS is not set -# CONFIG_ADFS_FS is not set +CONFIG_ORANGEFS_FS=m +CONFIG_ADFS_FS=m +# CONFIG_ADFS_FS_RW is not set CONFIG_AFFS_FS=m CONFIG_ECRYPT_FS=m -CONFIG_ECRYPT_FS_MESSAGING=y +# CONFIG_ECRYPT_FS_MESSAGING is not set CONFIG_HFS_FS=m CONFIG_HFSPLUS_FS=m CONFIG_BEFS_FS=m # CONFIG_BEFS_DEBUG is not set -# CONFIG_BFS_FS is not set -# CONFIG_EFS_FS is not set -# CONFIG_JFFS2_FS is not set +CONFIG_BFS_FS=m +CONFIG_EFS_FS=m +CONFIG_JFFS2_FS=m +CONFIG_JFFS2_FS_DEBUG=0 +CONFIG_JFFS2_FS_WRITEBUFFER=y +# CONFIG_JFFS2_FS_WBUF_VERIFY is not set +CONFIG_JFFS2_SUMMARY=y +CONFIG_JFFS2_FS_XATTR=y +CONFIG_JFFS2_FS_POSIX_ACL=y +CONFIG_JFFS2_FS_SECURITY=y +# CONFIG_JFFS2_COMPRESSION_OPTIONS is not set +CONFIG_JFFS2_ZLIB=y +CONFIG_JFFS2_RTIME=y CONFIG_UBIFS_FS=m # CONFIG_UBIFS_FS_ADVANCED_COMPR is not set CONFIG_UBIFS_FS_LZO=y @@ -6856,77 +9123,67 @@ CONFIG_UBIFS_FS_ZSTD=y # CONFIG_UBIFS_ATIME_SUPPORT is not set CONFIG_UBIFS_FS_XATTR=y CONFIG_UBIFS_FS_SECURITY=y -# CONFIG_UBIFS_FS_AUTHENTICATION is not set -CONFIG_CRAMFS=m +CONFIG_UBIFS_FS_AUTHENTICATION=y +CONFIG_CRAMFS=y CONFIG_CRAMFS_BLOCKDEV=y -# CONFIG_CRAMFS_MTD is not set CONFIG_SQUASHFS=m # CONFIG_SQUASHFS_FILE_CACHE is not set CONFIG_SQUASHFS_FILE_DIRECT=y # CONFIG_SQUASHFS_DECOMP_SINGLE is not set -# CONFIG_SQUASHFS_DECOMP_MULTI is not set -CONFIG_SQUASHFS_DECOMP_MULTI_PERCPU=y +CONFIG_SQUASHFS_DECOMP_MULTI=y +# CONFIG_SQUASHFS_DECOMP_MULTI_PERCPU is not set CONFIG_SQUASHFS_XATTR=y CONFIG_SQUASHFS_ZLIB=y -# CONFIG_SQUASHFS_LZ4 is not set +CONFIG_SQUASHFS_LZ4=y CONFIG_SQUASHFS_LZO=y CONFIG_SQUASHFS_XZ=y -# CONFIG_SQUASHFS_ZSTD is not set +CONFIG_SQUASHFS_ZSTD=y # CONFIG_SQUASHFS_4K_DEVBLK_SIZE is not set # CONFIG_SQUASHFS_EMBEDDED is not set CONFIG_SQUASHFS_FRAGMENT_CACHE_SIZE=3 -# CONFIG_VXFS_FS is not set +CONFIG_VXFS_FS=m CONFIG_MINIX_FS=m -# CONFIG_OMFS_FS is not set -# CONFIG_HPFS_FS is not set -# CONFIG_QNX4FS_FS is not set -# CONFIG_QNX6FS_FS is not set +CONFIG_OMFS_FS=m +CONFIG_HPFS_FS=m +CONFIG_QNX4FS_FS=m +CONFIG_QNX6FS_FS=m +# CONFIG_QNX6FS_DEBUG is not set CONFIG_ROMFS_FS=m -CONFIG_ROMFS_BACKED_BY_BLOCK=y +# CONFIG_ROMFS_BACKED_BY_BLOCK is not set # CONFIG_ROMFS_BACKED_BY_MTD is not set -# CONFIG_ROMFS_BACKED_BY_BOTH is not set +CONFIG_ROMFS_BACKED_BY_BOTH=y CONFIG_ROMFS_ON_BLOCK=y +CONFIG_ROMFS_ON_MTD=y CONFIG_PSTORE=y -CONFIG_PSTORE_DEFLATE_COMPRESS=y -# CONFIG_PSTORE_LZO_COMPRESS is not set -# CONFIG_PSTORE_LZ4_COMPRESS is not set -# CONFIG_PSTORE_LZ4HC_COMPRESS is not set -# CONFIG_PSTORE_842_COMPRESS is not set -# CONFIG_PSTORE_ZSTD_COMPRESS is not set +CONFIG_PSTORE_DEFLATE_COMPRESS=m +CONFIG_PSTORE_LZO_COMPRESS=m +CONFIG_PSTORE_LZ4_COMPRESS=m +CONFIG_PSTORE_LZ4HC_COMPRESS=m +CONFIG_PSTORE_842_COMPRESS=y +CONFIG_PSTORE_ZSTD_COMPRESS=y CONFIG_PSTORE_COMPRESS=y CONFIG_PSTORE_DEFLATE_COMPRESS_DEFAULT=y +# CONFIG_PSTORE_LZO_COMPRESS_DEFAULT is not set +# CONFIG_PSTORE_LZ4_COMPRESS_DEFAULT is not set +# CONFIG_PSTORE_LZ4HC_COMPRESS_DEFAULT is not set +# CONFIG_PSTORE_842_COMPRESS_DEFAULT is not set +# CONFIG_PSTORE_ZSTD_COMPRESS_DEFAULT is not set CONFIG_PSTORE_COMPRESS_DEFAULT="deflate" -CONFIG_PSTORE_CONSOLE=y -CONFIG_PSTORE_PMSG=y -CONFIG_PSTORE_FTRACE=y +# CONFIG_PSTORE_CONSOLE is not set +# CONFIG_PSTORE_PMSG is not set +# CONFIG_PSTORE_FTRACE is not set CONFIG_PSTORE_RAM=m CONFIG_SYSV_FS=m CONFIG_UFS_FS=m # CONFIG_UFS_FS_WRITE is not set # CONFIG_UFS_DEBUG is not set -# CONFIG_EROFS_FS is not set -CONFIG_AUFS_FS=y -# CONFIG_AUFS_BRANCH_MAX_127 is not set -# CONFIG_AUFS_BRANCH_MAX_511 is not set -# CONFIG_AUFS_BRANCH_MAX_1023 is not set -CONFIG_AUFS_BRANCH_MAX_32767=y -CONFIG_AUFS_SBILIST=y -CONFIG_AUFS_HNOTIFY=y -CONFIG_AUFS_HFSNOTIFY=y -CONFIG_AUFS_EXPORT=y -CONFIG_AUFS_INO_T_64=y -CONFIG_AUFS_XATTR=y -CONFIG_AUFS_FHSM=y -CONFIG_AUFS_RDU=y -# CONFIG_AUFS_DIRREN is not set -CONFIG_AUFS_SHWH=y -CONFIG_AUFS_BR_RAMFS=y -CONFIG_AUFS_BR_FUSE=y -CONFIG_AUFS_POLL=y -CONFIG_AUFS_BR_HFSPLUS=y -CONFIG_AUFS_BDEV_LOOP=y -CONFIG_AUFS_DEBUG=y -CONFIG_AUFS_MAGIC_SYSRQ=y +CONFIG_EROFS_FS=m +# CONFIG_EROFS_FS_DEBUG is not set +CONFIG_EROFS_FS_XATTR=y +CONFIG_EROFS_FS_POSIX_ACL=y +# CONFIG_EROFS_FS_SECURITY is not set +# CONFIG_EROFS_FS_ZIP is not set +CONFIG_VBOXSF_FS=m CONFIG_NETWORK_FILESYSTEMS=y CONFIG_NFS_FS=m CONFIG_NFS_V2=m @@ -6935,24 +9192,28 @@ CONFIG_NFS_V3_ACL=y CONFIG_NFS_V4=m CONFIG_NFS_SWAP=y CONFIG_NFS_V4_1=y -# CONFIG_NFS_V4_2 is not set +CONFIG_NFS_V4_2=y CONFIG_PNFS_FILE_LAYOUT=m CONFIG_PNFS_BLOCK=m CONFIG_PNFS_FLEXFILE_LAYOUT=m CONFIG_NFS_V4_1_IMPLEMENTATION_ID_DOMAIN="kernel.org" # CONFIG_NFS_V4_1_MIGRATION is not set +CONFIG_NFS_V4_SECURITY_LABEL=y CONFIG_NFS_FSCACHE=y # CONFIG_NFS_USE_LEGACY_DNS is not set CONFIG_NFS_USE_KERNEL_DNS=y CONFIG_NFS_DEBUG=y +CONFIG_NFS_DISABLE_UDP_SUPPORT=y CONFIG_NFSD=m CONFIG_NFSD_V2_ACL=y CONFIG_NFSD_V3=y CONFIG_NFSD_V3_ACL=y CONFIG_NFSD_V4=y -# CONFIG_NFSD_BLOCKLAYOUT is not set -# CONFIG_NFSD_SCSILAYOUT is not set -# CONFIG_NFSD_FLEXFILELAYOUT is not set +CONFIG_NFSD_PNFS=y +CONFIG_NFSD_BLOCKLAYOUT=y +CONFIG_NFSD_SCSILAYOUT=y +CONFIG_NFSD_FLEXFILELAYOUT=y +# CONFIG_NFSD_V4_2_INTER_SSC is not set # CONFIG_NFSD_V4_SECURITY_LABEL is not set CONFIG_GRACE_PERIOD=m CONFIG_LOCKD=m @@ -6968,29 +9229,34 @@ CONFIG_RPCSEC_GSS_KRB5=m CONFIG_SUNRPC_DEBUG=y CONFIG_SUNRPC_XPRT_RDMA=m CONFIG_CEPH_FS=m -# CONFIG_CEPH_FSCACHE is not set +CONFIG_CEPH_FSCACHE=y CONFIG_CEPH_FS_POSIX_ACL=y -# CONFIG_CEPH_FS_SECURITY_LABEL is not set +CONFIG_CEPH_FS_SECURITY_LABEL=y CONFIG_CIFS=m -# CONFIG_CIFS_STATS2 is not set +CONFIG_CIFS_STATS2=y CONFIG_CIFS_ALLOW_INSECURE_LEGACY=y CONFIG_CIFS_WEAK_PW_HASH=y CONFIG_CIFS_UPCALL=y CONFIG_CIFS_XATTR=y -# CONFIG_CIFS_POSIX is not set -# CONFIG_CIFS_DEBUG is not set +CONFIG_CIFS_POSIX=y +CONFIG_CIFS_DEBUG=y +# CONFIG_CIFS_DEBUG2 is not set +# CONFIG_CIFS_DEBUG_DUMP_KEYS is not set CONFIG_CIFS_DFS_UPCALL=y # CONFIG_CIFS_SMB_DIRECT is not set -CONFIG_CIFS_FSCACHE=y +# CONFIG_CIFS_FSCACHE is not set CONFIG_CODA_FS=m -# CONFIG_AFS_FS is not set +CONFIG_AFS_FS=m +# CONFIG_AFS_DEBUG is not set +CONFIG_AFS_FSCACHE=y +# CONFIG_AFS_DEBUG_CURSOR is not set CONFIG_9P_FS=m CONFIG_9P_FSCACHE=y CONFIG_9P_FS_POSIX_ACL=y # CONFIG_9P_FS_SECURITY is not set CONFIG_NLS=y CONFIG_NLS_DEFAULT="utf8" -CONFIG_NLS_CODEPAGE_437=y +CONFIG_NLS_CODEPAGE_437=m CONFIG_NLS_CODEPAGE_737=m CONFIG_NLS_CODEPAGE_775=m CONFIG_NLS_CODEPAGE_850=m @@ -7013,7 +9279,7 @@ CONFIG_NLS_CODEPAGE_874=m CONFIG_NLS_ISO8859_8=m CONFIG_NLS_CODEPAGE_1250=m CONFIG_NLS_CODEPAGE_1251=m -CONFIG_NLS_ASCII=y +CONFIG_NLS_ASCII=m CONFIG_NLS_ISO8859_1=m CONFIG_NLS_ISO8859_2=m CONFIG_NLS_ISO8859_3=m @@ -7040,7 +9306,7 @@ CONFIG_NLS_MAC_ROMANIAN=m CONFIG_NLS_MAC_TURKISH=m CONFIG_NLS_UTF8=m CONFIG_DLM=m -CONFIG_DLM_DEBUG=y +# CONFIG_DLM_DEBUG is not set # CONFIG_UNICODE is not set CONFIG_IO_WQ=y # end of File systems @@ -7064,17 +9330,30 @@ CONFIG_PAGE_TABLE_ISOLATION=y CONFIG_SECURITY_NETWORK_XFRM=y CONFIG_SECURITY_PATH=y CONFIG_INTEL_TXT=y +CONFIG_LSM_MMAP_MIN_ADDR=65536 CONFIG_HAVE_HARDENED_USERCOPY_ALLOCATOR=y -# CONFIG_HARDENED_USERCOPY is not set -# CONFIG_FORTIFY_SOURCE is not set +CONFIG_HARDENED_USERCOPY=y +CONFIG_HARDENED_USERCOPY_FALLBACK=y +# CONFIG_HARDENED_USERCOPY_PAGESPAN is not set +CONFIG_FORTIFY_SOURCE=y # CONFIG_STATIC_USERMODEHELPER is not set -# CONFIG_SECURITY_SELINUX is not set +CONFIG_SECURITY_SELINUX=y +CONFIG_SECURITY_SELINUX_BOOTPARAM=y +# CONFIG_SECURITY_SELINUX_DISABLE is not set +CONFIG_SECURITY_SELINUX_DEVELOP=y +# CONFIG_SECURITY_SELINUX_AVC_STATS is not set +CONFIG_SECURITY_SELINUX_CHECKREQPROT_VALUE=0 +CONFIG_SECURITY_SELINUX_SIDTAB_HASH_BITS=9 +CONFIG_SECURITY_SELINUX_SID2STR_CACHE_SIZE=256 # CONFIG_SECURITY_SMACK is not set -# CONFIG_SECURITY_TOMOYO is not set -CONFIG_SECURITY_APPARMOR=y -CONFIG_SECURITY_APPARMOR_HASH=y -CONFIG_SECURITY_APPARMOR_HASH_DEFAULT=y -# CONFIG_SECURITY_APPARMOR_DEBUG is not set +CONFIG_SECURITY_TOMOYO=y +CONFIG_SECURITY_TOMOYO_MAX_ACCEPT_ENTRY=2048 +CONFIG_SECURITY_TOMOYO_MAX_AUDIT_LOG=1024 +# CONFIG_SECURITY_TOMOYO_OMIT_USERSPACE_LOADER is not set +CONFIG_SECURITY_TOMOYO_POLICY_LOADER="/sbin/tomoyo-init" +CONFIG_SECURITY_TOMOYO_ACTIVATION_TRIGGER="/sbin/init" +# CONFIG_SECURITY_TOMOYO_INSECURE_BUILTIN_SETTING is not set +# CONFIG_SECURITY_APPARMOR is not set # CONFIG_SECURITY_LOADPIN is not set # CONFIG_SECURITY_YAMA is not set # CONFIG_SECURITY_SAFESETID is not set @@ -7084,9 +9363,10 @@ CONFIG_INTEGRITY=y CONFIG_INTEGRITY_AUDIT=y # CONFIG_IMA is not set # CONFIG_EVM is not set -CONFIG_DEFAULT_SECURITY_APPARMOR=y +CONFIG_DEFAULT_SECURITY_SELINUX=y +# CONFIG_DEFAULT_SECURITY_TOMOYO is not set # CONFIG_DEFAULT_SECURITY_DAC is not set -CONFIG_LSM="lockdown,yama,loadpin,safesetid,integrity,apparmor,selinux,smack,tomoyo" +CONFIG_LSM="" # # Kernel hardening options @@ -7096,13 +9376,17 @@ CONFIG_LSM="lockdown,yama,loadpin,safesetid,integrity,apparmor,selinux,smack,tom # Memory initialization # CONFIG_INIT_STACK_NONE=y +# CONFIG_GCC_PLUGIN_STRUCTLEAK_USER is not set +# CONFIG_GCC_PLUGIN_STRUCTLEAK_BYREF is not set +# CONFIG_GCC_PLUGIN_STRUCTLEAK_BYREF_ALL is not set +# CONFIG_GCC_PLUGIN_STACKLEAK is not set # CONFIG_INIT_ON_ALLOC_DEFAULT_ON is not set # CONFIG_INIT_ON_FREE_DEFAULT_ON is not set # end of Memory initialization # end of Kernel hardening options # end of Security options -CONFIG_XOR_BLOCKS=m +CONFIG_XOR_BLOCKS=y CONFIG_ASYNC_CORE=m CONFIG_ASYNC_MEMCPY=m CONFIG_ASYNC_XOR=m @@ -7132,12 +9416,12 @@ CONFIG_CRYPTO_ACOMP2=y CONFIG_CRYPTO_MANAGER=y CONFIG_CRYPTO_MANAGER2=y CONFIG_CRYPTO_USER=m -# CONFIG_CRYPTO_MANAGER_DISABLE_TESTS is not set -CONFIG_CRYPTO_GF128MUL=y +CONFIG_CRYPTO_MANAGER_DISABLE_TESTS=y +CONFIG_CRYPTO_GF128MUL=m CONFIG_CRYPTO_NULL=y CONFIG_CRYPTO_NULL2=y CONFIG_CRYPTO_PCRYPT=m -CONFIG_CRYPTO_CRYPTD=y +CONFIG_CRYPTO_CRYPTD=m CONFIG_CRYPTO_AUTHENC=m CONFIG_CRYPTO_TEST=m CONFIG_CRYPTO_SIMD=m @@ -7151,18 +9435,18 @@ CONFIG_CRYPTO_RSA=y CONFIG_CRYPTO_DH=m CONFIG_CRYPTO_ECC=m CONFIG_CRYPTO_ECDH=m -# CONFIG_CRYPTO_ECRDSA is not set -# CONFIG_CRYPTO_CURVE25519 is not set -# CONFIG_CRYPTO_CURVE25519_X86 is not set +CONFIG_CRYPTO_ECRDSA=m +CONFIG_CRYPTO_CURVE25519=m +CONFIG_CRYPTO_CURVE25519_X86=m # # Authenticated Encryption with Associated Data # CONFIG_CRYPTO_CCM=m CONFIG_CRYPTO_GCM=m -# CONFIG_CRYPTO_CHACHA20POLY1305 is not set -# CONFIG_CRYPTO_AEGIS128 is not set -# CONFIG_CRYPTO_AEGIS128_AESNI_SSE2 is not set +CONFIG_CRYPTO_CHACHA20POLY1305=m +CONFIG_CRYPTO_AEGIS128=m +CONFIG_CRYPTO_AEGIS128_AESNI_SSE2=m CONFIG_CRYPTO_SEQIV=y CONFIG_CRYPTO_ECHAINIV=m @@ -7170,18 +9454,19 @@ CONFIG_CRYPTO_ECHAINIV=m # Block modes # CONFIG_CRYPTO_CBC=y -# CONFIG_CRYPTO_CFB is not set +CONFIG_CRYPTO_CFB=m CONFIG_CRYPTO_CTR=y CONFIG_CRYPTO_CTS=y CONFIG_CRYPTO_ECB=y -CONFIG_CRYPTO_LRW=y -# CONFIG_CRYPTO_OFB is not set +CONFIG_CRYPTO_LRW=m +CONFIG_CRYPTO_OFB=m CONFIG_CRYPTO_PCBC=m CONFIG_CRYPTO_XTS=y CONFIG_CRYPTO_KEYWRAP=m -# CONFIG_CRYPTO_NHPOLY1305_SSE2 is not set -# CONFIG_CRYPTO_NHPOLY1305_AVX2 is not set -# CONFIG_CRYPTO_ADIANTUM is not set +CONFIG_CRYPTO_NHPOLY1305=m +CONFIG_CRYPTO_NHPOLY1305_SSE2=m +CONFIG_CRYPTO_NHPOLY1305_AVX2=m +CONFIG_CRYPTO_ADIANTUM=m CONFIG_CRYPTO_ESSIV=m # @@ -7197,14 +9482,14 @@ CONFIG_CRYPTO_VMAC=m # CONFIG_CRYPTO_CRC32C=y CONFIG_CRYPTO_CRC32C_INTEL=m -CONFIG_CRYPTO_CRC32=y +CONFIG_CRYPTO_CRC32=m CONFIG_CRYPTO_CRC32_PCLMUL=m -CONFIG_CRYPTO_XXHASH=m -CONFIG_CRYPTO_BLAKE2B=m -# CONFIG_CRYPTO_BLAKE2S is not set -# CONFIG_CRYPTO_BLAKE2S_X86 is not set +CONFIG_CRYPTO_XXHASH=y +CONFIG_CRYPTO_BLAKE2B=y +CONFIG_CRYPTO_BLAKE2S=m +CONFIG_CRYPTO_BLAKE2S_X86=m CONFIG_CRYPTO_CRCT10DIF=y -# CONFIG_CRYPTO_CRCT10DIF_PCLMUL is not set +CONFIG_CRYPTO_CRCT10DIF_PCLMUL=y CONFIG_CRYPTO_GHASH=m CONFIG_CRYPTO_POLY1305=m CONFIG_CRYPTO_POLY1305_X86_64=m @@ -7215,15 +9500,15 @@ CONFIG_CRYPTO_RMD128=m CONFIG_CRYPTO_RMD160=m CONFIG_CRYPTO_RMD256=m CONFIG_CRYPTO_RMD320=m -CONFIG_CRYPTO_SHA1=y +CONFIG_CRYPTO_SHA1=m CONFIG_CRYPTO_SHA1_SSSE3=m CONFIG_CRYPTO_SHA256_SSSE3=m CONFIG_CRYPTO_SHA512_SSSE3=m CONFIG_CRYPTO_SHA256=y CONFIG_CRYPTO_SHA512=y CONFIG_CRYPTO_SHA3=m -# CONFIG_CRYPTO_SM3 is not set -# CONFIG_CRYPTO_STREEBOG is not set +CONFIG_CRYPTO_SM3=m +CONFIG_CRYPTO_STREEBOG=m CONFIG_CRYPTO_TGR192=m CONFIG_CRYPTO_WP512=m CONFIG_CRYPTO_GHASH_CLMUL_NI_INTEL=m @@ -7232,7 +9517,7 @@ CONFIG_CRYPTO_GHASH_CLMUL_NI_INTEL=m # Ciphers # CONFIG_CRYPTO_AES=y -# CONFIG_CRYPTO_AES_TI is not set +CONFIG_CRYPTO_AES_TI=m CONFIG_CRYPTO_AES_NI_INTEL=m CONFIG_CRYPTO_ANUBIS=m CONFIG_CRYPTO_ARC4=m @@ -7260,7 +9545,7 @@ CONFIG_CRYPTO_SERPENT=m CONFIG_CRYPTO_SERPENT_SSE2_X86_64=m CONFIG_CRYPTO_SERPENT_AVX_X86_64=m CONFIG_CRYPTO_SERPENT_AVX2_X86_64=m -# CONFIG_CRYPTO_SM4 is not set +CONFIG_CRYPTO_SM4=m CONFIG_CRYPTO_TEA=m CONFIG_CRYPTO_TWOFISH=m CONFIG_CRYPTO_TWOFISH_COMMON=m @@ -7271,12 +9556,12 @@ CONFIG_CRYPTO_TWOFISH_AVX_X86_64=m # # Compression # -CONFIG_CRYPTO_DEFLATE=y +CONFIG_CRYPTO_DEFLATE=m CONFIG_CRYPTO_LZO=y -# CONFIG_CRYPTO_842 is not set +CONFIG_CRYPTO_842=y CONFIG_CRYPTO_LZ4=m CONFIG_CRYPTO_LZ4HC=m -CONFIG_CRYPTO_ZSTD=m +CONFIG_CRYPTO_ZSTD=y # # Random Number Generation @@ -7288,11 +9573,11 @@ CONFIG_CRYPTO_DRBG_HMAC=y # CONFIG_CRYPTO_DRBG_CTR is not set CONFIG_CRYPTO_DRBG=y CONFIG_CRYPTO_JITTERENTROPY=y -CONFIG_CRYPTO_USER_API=y -CONFIG_CRYPTO_USER_API_HASH=y -CONFIG_CRYPTO_USER_API_SKCIPHER=y +CONFIG_CRYPTO_USER_API=m +CONFIG_CRYPTO_USER_API_HASH=m +CONFIG_CRYPTO_USER_API_SKCIPHER=m CONFIG_CRYPTO_USER_API_RNG=m -# CONFIG_CRYPTO_USER_API_AEAD is not set +CONFIG_CRYPTO_USER_API_AEAD=m # CONFIG_CRYPTO_STATS is not set CONFIG_CRYPTO_HASH_INFO=y @@ -7301,24 +9586,29 @@ CONFIG_CRYPTO_HASH_INFO=y # CONFIG_CRYPTO_LIB_AES=y CONFIG_CRYPTO_LIB_ARC4=m -# CONFIG_CRYPTO_LIB_BLAKE2S is not set +CONFIG_CRYPTO_ARCH_HAVE_LIB_BLAKE2S=m +CONFIG_CRYPTO_LIB_BLAKE2S_GENERIC=m +CONFIG_CRYPTO_LIB_BLAKE2S=m CONFIG_CRYPTO_ARCH_HAVE_LIB_CHACHA=m CONFIG_CRYPTO_LIB_CHACHA_GENERIC=m -# CONFIG_CRYPTO_LIB_CHACHA is not set -# CONFIG_CRYPTO_LIB_CURVE25519 is not set +CONFIG_CRYPTO_LIB_CHACHA=m +CONFIG_CRYPTO_ARCH_HAVE_LIB_CURVE25519=m +CONFIG_CRYPTO_LIB_CURVE25519_GENERIC=m +CONFIG_CRYPTO_LIB_CURVE25519=m CONFIG_CRYPTO_LIB_DES=m -CONFIG_CRYPTO_LIB_POLY1305_RSIZE=4 +CONFIG_CRYPTO_LIB_POLY1305_RSIZE=11 CONFIG_CRYPTO_ARCH_HAVE_LIB_POLY1305=m CONFIG_CRYPTO_LIB_POLY1305_GENERIC=m -# CONFIG_CRYPTO_LIB_POLY1305 is not set -# CONFIG_CRYPTO_LIB_CHACHA20POLY1305 is not set +CONFIG_CRYPTO_LIB_POLY1305=m +CONFIG_CRYPTO_LIB_CHACHA20POLY1305=m CONFIG_CRYPTO_LIB_SHA256=y CONFIG_CRYPTO_HW=y CONFIG_CRYPTO_DEV_PADLOCK=m CONFIG_CRYPTO_DEV_PADLOCK_AES=m CONFIG_CRYPTO_DEV_PADLOCK_SHA=m -# CONFIG_CRYPTO_DEV_ATMEL_ECC is not set -# CONFIG_CRYPTO_DEV_ATMEL_SHA204A is not set +CONFIG_CRYPTO_DEV_ATMEL_I2C=m +CONFIG_CRYPTO_DEV_ATMEL_ECC=m +CONFIG_CRYPTO_DEV_ATMEL_SHA204A=m CONFIG_CRYPTO_DEV_CCP=y CONFIG_CRYPTO_DEV_CCP_DD=m CONFIG_CRYPTO_DEV_SP_CCP=y @@ -7327,24 +9617,28 @@ CONFIG_CRYPTO_DEV_SP_PSP=y # CONFIG_CRYPTO_DEV_CCP_DEBUGFS is not set CONFIG_CRYPTO_DEV_QAT=m CONFIG_CRYPTO_DEV_QAT_DH895xCC=m -# CONFIG_CRYPTO_DEV_QAT_C3XXX is not set -# CONFIG_CRYPTO_DEV_QAT_C62X is not set +CONFIG_CRYPTO_DEV_QAT_C3XXX=m +CONFIG_CRYPTO_DEV_QAT_C62X=m CONFIG_CRYPTO_DEV_QAT_DH895xCCVF=m -# CONFIG_CRYPTO_DEV_QAT_C3XXXVF is not set -# CONFIG_CRYPTO_DEV_QAT_C62XVF is not set -# CONFIG_CRYPTO_DEV_NITROX_CNN55XX is not set +CONFIG_CRYPTO_DEV_QAT_C3XXXVF=m +CONFIG_CRYPTO_DEV_QAT_C62XVF=m +CONFIG_CRYPTO_DEV_NITROX=m +CONFIG_CRYPTO_DEV_NITROX_CNN55XX=m CONFIG_CRYPTO_DEV_CHELSIO=m +CONFIG_CHELSIO_IPSEC_INLINE=y CONFIG_CRYPTO_DEV_VIRTIO=m -# CONFIG_CRYPTO_DEV_SAFEXCEL is not set -# CONFIG_CRYPTO_DEV_AMLOGIC_GXL is not set +CONFIG_CRYPTO_DEV_SAFEXCEL=m +CONFIG_CRYPTO_DEV_AMLOGIC_GXL=m +# CONFIG_CRYPTO_DEV_AMLOGIC_GXL_DEBUG is not set CONFIG_ASYMMETRIC_KEY_TYPE=y CONFIG_ASYMMETRIC_PUBLIC_KEY_SUBTYPE=y -# CONFIG_ASYMMETRIC_TPM_KEY_SUBTYPE is not set +CONFIG_ASYMMETRIC_TPM_KEY_SUBTYPE=m CONFIG_X509_CERTIFICATE_PARSER=y -# CONFIG_PKCS8_PRIVATE_KEY_PARSER is not set +CONFIG_PKCS8_PRIVATE_KEY_PARSER=m +CONFIG_TPM_KEY_PARSER=m CONFIG_PKCS7_MESSAGE_PARSER=y # CONFIG_PKCS7_TEST_KEY is not set -# CONFIG_SIGNED_PE_FILE_VERIFICATION is not set +CONFIG_SIGNED_PE_FILE_VERIFICATION=y # # Certificates for signature checking @@ -7361,7 +9655,7 @@ CONFIG_BINARY_PRINTF=y # # Library routines # -CONFIG_RAID6_PQ=m +CONFIG_RAID6_PQ=y CONFIG_RAID6_PQ_BENCHMARK=y # CONFIG_PACKING is not set CONFIG_BITREVERSE=y @@ -7375,7 +9669,7 @@ CONFIG_GENERIC_PCI_IOMAP=y CONFIG_GENERIC_IOMAP=y CONFIG_ARCH_USE_CMPXCHG_LOCKREF=y CONFIG_ARCH_HAS_FAST_MULTIPLIER=y -CONFIG_CRC_CCITT=y +CONFIG_CRC_CCITT=m CONFIG_CRC16=y CONFIG_CRC_T10DIF=y CONFIG_CRC_ITU_T=m @@ -7385,29 +9679,31 @@ CONFIG_CRC32_SLICEBY8=y # CONFIG_CRC32_SLICEBY4 is not set # CONFIG_CRC32_SARWATE is not set # CONFIG_CRC32_BIT is not set -CONFIG_CRC64=m -# CONFIG_CRC4 is not set -# CONFIG_CRC7 is not set -CONFIG_LIBCRC32C=m +CONFIG_CRC64=y +CONFIG_CRC4=m +CONFIG_CRC7=m +CONFIG_LIBCRC32C=y CONFIG_CRC8=m CONFIG_XXHASH=y # CONFIG_RANDOM32_SELFTEST is not set +CONFIG_842_COMPRESS=y +CONFIG_842_DECOMPRESS=y CONFIG_ZLIB_INFLATE=y CONFIG_ZLIB_DEFLATE=y CONFIG_LZO_COMPRESS=y CONFIG_LZO_DECOMPRESS=y -CONFIG_LZ4_COMPRESS=m +CONFIG_LZ4_COMPRESS=y CONFIG_LZ4HC_COMPRESS=m CONFIG_LZ4_DECOMPRESS=y -CONFIG_ZSTD_COMPRESS=m -CONFIG_ZSTD_DECOMPRESS=m +CONFIG_ZSTD_COMPRESS=y +CONFIG_ZSTD_DECOMPRESS=y CONFIG_XZ_DEC=y CONFIG_XZ_DEC_X86=y -CONFIG_XZ_DEC_POWERPC=y -CONFIG_XZ_DEC_IA64=y -CONFIG_XZ_DEC_ARM=y -CONFIG_XZ_DEC_ARMTHUMB=y -CONFIG_XZ_DEC_SPARC=y +# CONFIG_XZ_DEC_POWERPC is not set +# CONFIG_XZ_DEC_IA64 is not set +# CONFIG_XZ_DEC_ARM is not set +# CONFIG_XZ_DEC_ARMTHUMB is not set +# CONFIG_XZ_DEC_SPARC is not set CONFIG_XZ_DEC_BCJ=y # CONFIG_XZ_DEC_TEST is not set CONFIG_DECOMPRESS_GZIP=y @@ -7420,6 +9716,8 @@ CONFIG_GENERIC_ALLOCATOR=y CONFIG_REED_SOLOMON=m CONFIG_REED_SOLOMON_ENC8=y CONFIG_REED_SOLOMON_DEC8=y +CONFIG_REED_SOLOMON_DEC16=y +CONFIG_BCH=m CONFIG_TEXTSEARCH=y CONFIG_TEXTSEARCH_KMP=m CONFIG_TEXTSEARCH_BM=m @@ -7436,6 +9734,17 @@ CONFIG_NEED_DMA_MAP_STATE=y CONFIG_ARCH_DMA_ADDR_T_64BIT=y CONFIG_DMA_VIRT_OPS=y CONFIG_SWIOTLB=y +CONFIG_DMA_CMA=y + +# +# Default contiguous memory area size: +# +CONFIG_CMA_SIZE_MBYTES=0 +CONFIG_CMA_SIZE_SEL_MBYTES=y +# CONFIG_CMA_SIZE_SEL_PERCENTAGE is not set +# CONFIG_CMA_SIZE_SEL_MIN is not set +# CONFIG_CMA_SIZE_SEL_MAX is not set +CONFIG_CMA_ALIGNMENT=8 # CONFIG_DMA_API_DEBUG is not set CONFIG_SGL_ALLOC=y CONFIG_IOMMU_HELPER=y @@ -7445,7 +9754,6 @@ CONFIG_DQL=y CONFIG_GLOB=y # CONFIG_GLOB_SELFTEST is not set CONFIG_NLATTR=y -CONFIG_LRU_CACHE=m CONFIG_CLZ_TAB=y CONFIG_IRQ_POLL=y CONFIG_MPILIB=y @@ -7454,12 +9762,14 @@ CONFIG_OID_REGISTRY=y CONFIG_UCS2_STRING=y CONFIG_HAVE_GENERIC_VDSO=y CONFIG_GENERIC_GETTIMEOFDAY=y +CONFIG_GENERIC_VDSO_TIME_NS=y CONFIG_FONT_SUPPORT=y # CONFIG_FONTS is not set CONFIG_FONT_8x8=y CONFIG_FONT_8x16=y CONFIG_SG_POOL=y CONFIG_ARCH_HAS_PMEM_API=y +CONFIG_MEMREGION=y CONFIG_ARCH_HAS_UACCESS_FLUSHCACHE=y CONFIG_ARCH_HAS_UACCESS_MCSAFE=y CONFIG_ARCH_STACKWALK=y @@ -7481,6 +9791,7 @@ CONFIG_PRINTK_TIME=y CONFIG_CONSOLE_LOGLEVEL_DEFAULT=7 CONFIG_CONSOLE_LOGLEVEL_QUIET=4 CONFIG_MESSAGE_LOGLEVEL_DEFAULT=4 +CONFIG_BOOT_PRINTK_DELAY=y CONFIG_DYNAMIC_DEBUG=y CONFIG_SYMBOLIC_ERRNAME=y CONFIG_DEBUG_BUGVERBOSE=y @@ -7489,14 +9800,17 @@ CONFIG_DEBUG_BUGVERBOSE=y # # Compile-time checks and compiler options # +# CONFIG_DEBUG_INFO is not set CONFIG_ENABLE_MUST_CHECK=y CONFIG_FRAME_WARN=2048 CONFIG_STRIP_ASM_SYMS=y +# CONFIG_READABLE_ASM is not set # CONFIG_HEADERS_INSTALL is not set CONFIG_OPTIMIZE_INLINING=y -CONFIG_DEBUG_SECTION_MISMATCH=y +# CONFIG_DEBUG_SECTION_MISMATCH is not set CONFIG_SECTION_MISMATCH_WARN_ONLY=y CONFIG_STACK_VALIDATION=y +# CONFIG_DEBUG_FORCE_WEAK_PER_CPU is not set # end of Compile-time checks and compiler options # @@ -7507,22 +9821,40 @@ CONFIG_MAGIC_SYSRQ_DEFAULT_ENABLE=0x1 CONFIG_MAGIC_SYSRQ_SERIAL=y CONFIG_DEBUG_FS=y CONFIG_HAVE_ARCH_KGDB=y +# CONFIG_KGDB is not set CONFIG_ARCH_HAS_UBSAN_SANITIZE_ALL=y # CONFIG_UBSAN is not set CONFIG_UBSAN_ALIGNMENT=y # end of Generic Kernel Debugging Instruments -# CONFIG_DEBUG_KERNEL is not set +CONFIG_DEBUG_KERNEL=y +CONFIG_DEBUG_MISC=y # # Memory Debugging # # CONFIG_PAGE_EXTENSION is not set +# CONFIG_DEBUG_PAGEALLOC is not set +# CONFIG_PAGE_OWNER is not set # CONFIG_PAGE_POISONING is not set -CONFIG_DEBUG_RODATA_TEST=y +# CONFIG_DEBUG_PAGE_REF is not set +# CONFIG_DEBUG_RODATA_TEST is not set +CONFIG_GENERIC_PTDUMP=y +CONFIG_PTDUMP_CORE=y +# CONFIG_PTDUMP_DEBUGFS is not set +# CONFIG_DEBUG_OBJECTS is not set +# CONFIG_SLUB_DEBUG_ON is not set +# CONFIG_SLUB_STATS is not set CONFIG_HAVE_DEBUG_KMEMLEAK=y +# CONFIG_DEBUG_KMEMLEAK is not set +# CONFIG_DEBUG_STACK_USAGE is not set +# CONFIG_SCHED_STACK_END_CHECK is not set +# CONFIG_DEBUG_VM is not set CONFIG_ARCH_HAS_DEBUG_VIRTUAL=y +# CONFIG_DEBUG_VIRTUAL is not set CONFIG_DEBUG_MEMORY_INIT=y +CONFIG_MEMORY_NOTIFIER_ERROR_INJECT=m +# CONFIG_DEBUG_PER_CPU_MAPS is not set CONFIG_HAVE_ARCH_KASAN=y CONFIG_HAVE_ARCH_KASAN_VMALLOC=y CONFIG_CC_HAS_KASAN_GENERIC=y @@ -7530,45 +9862,83 @@ CONFIG_CC_HAS_KASAN_GENERIC=y CONFIG_KASAN_STACK=1 # end of Memory Debugging +# CONFIG_DEBUG_SHIRQ is not set + # # Debug Oops, Lockups and Hangs # # CONFIG_PANIC_ON_OOPS is not set CONFIG_PANIC_ON_OOPS_VALUE=0 CONFIG_PANIC_TIMEOUT=0 +# CONFIG_SOFTLOCKUP_DETECTOR is not set CONFIG_HARDLOCKUP_CHECK_TIMESTAMP=y +# CONFIG_HARDLOCKUP_DETECTOR is not set +CONFIG_DETECT_HUNG_TASK=y +CONFIG_DEFAULT_HUNG_TASK_TIMEOUT=120 +# CONFIG_BOOTPARAM_HUNG_TASK_PANIC is not set +CONFIG_BOOTPARAM_HUNG_TASK_PANIC_VALUE=0 +# CONFIG_WQ_WATCHDOG is not set # end of Debug Oops, Lockups and Hangs # # Scheduler Debugging # +CONFIG_SCHED_DEBUG=y CONFIG_SCHED_INFO=y +CONFIG_SCHEDSTATS=y # end of Scheduler Debugging -CONFIG_DEBUG_TIMEKEEPING=y +# CONFIG_DEBUG_TIMEKEEPING is not set # # Lock Debugging (spinlocks, mutexes, etc...) # CONFIG_LOCK_DEBUGGING_SUPPORT=y +# CONFIG_PROVE_LOCKING is not set +# CONFIG_LOCK_STAT is not set +# CONFIG_DEBUG_RT_MUTEXES is not set +# CONFIG_DEBUG_SPINLOCK is not set +# CONFIG_DEBUG_MUTEXES is not set +# CONFIG_DEBUG_WW_MUTEX_SLOWPATH is not set +# CONFIG_DEBUG_RWSEMS is not set +# CONFIG_DEBUG_LOCK_ALLOC is not set +# CONFIG_DEBUG_ATOMIC_SLEEP is not set +# CONFIG_DEBUG_LOCKING_API_SELFTESTS is not set +# CONFIG_LOCK_TORTURE_TEST is not set # CONFIG_WW_MUTEX_SELFTEST is not set # end of Lock Debugging (spinlocks, mutexes, etc...) CONFIG_STACKTRACE=y # CONFIG_WARN_ALL_UNSEEDED_RANDOM is not set +# CONFIG_DEBUG_KOBJECT is not set # # Debug kernel data structures # +# CONFIG_DEBUG_LIST is not set +# CONFIG_DEBUG_PLIST is not set +# CONFIG_DEBUG_SG is not set +# CONFIG_DEBUG_NOTIFIERS is not set # CONFIG_BUG_ON_DATA_CORRUPTION is not set # end of Debug kernel data structures +# CONFIG_DEBUG_CREDENTIALS is not set + # # RCU Debugging # +CONFIG_TORTURE_TEST=m +CONFIG_RCU_PERF_TEST=m +# CONFIG_RCU_TORTURE_TEST is not set CONFIG_RCU_CPU_STALL_TIMEOUT=60 +# CONFIG_RCU_TRACE is not set +# CONFIG_RCU_EQS_DEBUG is not set # end of RCU Debugging +# CONFIG_DEBUG_WQ_FORCE_RR_CPU is not set +# CONFIG_DEBUG_BLOCK_EXT_DEVT is not set +# CONFIG_CPU_HOTPLUG_STATE_CONTROL is not set +CONFIG_LATENCYTOP=y CONFIG_USER_STACKTRACE_SUPPORT=y CONFIG_NOP_TRACER=y CONFIG_HAVE_FUNCTION_TRACER=y @@ -7590,19 +9960,24 @@ CONFIG_TRACING=y CONFIG_GENERIC_TRACER=y CONFIG_TRACING_SUPPORT=y CONFIG_FTRACE=y +# CONFIG_BOOTTIME_TRACING is not set CONFIG_FUNCTION_TRACER=y -CONFIG_FUNCTION_GRAPH_TRACER=y +# CONFIG_FUNCTION_GRAPH_TRACER is not set +CONFIG_DYNAMIC_FTRACE=y +CONFIG_DYNAMIC_FTRACE_WITH_REGS=y +CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS=y +CONFIG_FUNCTION_PROFILER=y +CONFIG_STACK_TRACER=y # CONFIG_PREEMPTIRQ_EVENTS is not set # CONFIG_IRQSOFF_TRACER is not set CONFIG_SCHED_TRACER=y # CONFIG_HWLAT_TRACER is not set +CONFIG_MMIOTRACE=y CONFIG_FTRACE_SYSCALLS=y CONFIG_TRACER_SNAPSHOT=y -CONFIG_TRACER_SNAPSHOT_PER_CPU_SWAP=y +# CONFIG_TRACER_SNAPSHOT_PER_CPU_SWAP is not set CONFIG_BRANCH_PROFILE_NONE=y # CONFIG_PROFILE_ANNOTATED_BRANCHES is not set -# CONFIG_PROFILE_ALL_BRANCHES is not set -CONFIG_STACK_TRACER=y CONFIG_BLK_DEV_IO_TRACE=y CONFIG_KPROBE_EVENTS=y # CONFIG_KPROBE_EVENTS_ON_NOTRACE is not set @@ -7610,54 +9985,63 @@ CONFIG_UPROBE_EVENTS=y CONFIG_BPF_EVENTS=y CONFIG_DYNAMIC_EVENTS=y CONFIG_PROBE_EVENTS=y -CONFIG_DYNAMIC_FTRACE=y -CONFIG_DYNAMIC_FTRACE_WITH_REGS=y -CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS=y -CONFIG_FUNCTION_PROFILER=y # CONFIG_BPF_KPROBE_OVERRIDE is not set CONFIG_FTRACE_MCOUNT_RECORD=y -# CONFIG_FTRACE_STARTUP_TEST is not set -# CONFIG_MMIOTRACE is not set # CONFIG_HIST_TRIGGERS is not set # CONFIG_TRACE_EVENT_INJECT is not set # CONFIG_TRACEPOINT_BENCHMARK is not set CONFIG_RING_BUFFER_BENCHMARK=m -# CONFIG_RING_BUFFER_STARTUP_TEST is not set -# CONFIG_PREEMPTIRQ_DELAY_TEST is not set # CONFIG_TRACE_EVAL_MAP_FILE is not set +# CONFIG_FTRACE_STARTUP_TEST is not set +# CONFIG_RING_BUFFER_STARTUP_TEST is not set +# CONFIG_MMIOTRACE_TEST is not set +# CONFIG_PREEMPTIRQ_DELAY_TEST is not set +# CONFIG_KPROBE_EVENT_GEN_TEST is not set # CONFIG_PROVIDE_OHCI1394_DMA_INIT is not set # CONFIG_SAMPLES is not set CONFIG_ARCH_HAS_DEVMEM_IS_ALLOWED=y CONFIG_STRICT_DEVMEM=y -# CONFIG_IO_STRICT_DEVMEM is not set +CONFIG_IO_STRICT_DEVMEM=y # # x86 Debugging # CONFIG_TRACE_IRQFLAGS_SUPPORT=y -CONFIG_EARLY_PRINTK_USB=y -# CONFIG_X86_VERBOSE_BOOTUP is not set +CONFIG_X86_VERBOSE_BOOTUP=y CONFIG_EARLY_PRINTK=y -CONFIG_EARLY_PRINTK_DBGP=y +# CONFIG_EARLY_PRINTK_DBGP is not set # CONFIG_EARLY_PRINTK_USB_XDBC is not set # CONFIG_EFI_PGT_DUMP is not set -# CONFIG_DEBUG_WX is not set +CONFIG_DEBUG_WX=y CONFIG_DOUBLEFAULT=y +# CONFIG_DEBUG_TLBFLUSH is not set +# CONFIG_IOMMU_DEBUG is not set CONFIG_HAVE_MMIOTRACE_SUPPORT=y +# CONFIG_X86_DECODER_SELFTEST is not set CONFIG_IO_DELAY_0X80=y # CONFIG_IO_DELAY_0XED is not set # CONFIG_IO_DELAY_UDELAY is not set # CONFIG_IO_DELAY_NONE is not set -# CONFIG_PUNIT_ATOM_DEBUG is not set +# CONFIG_DEBUG_BOOT_PARAMS is not set +# CONFIG_CPA_DEBUG is not set +# CONFIG_DEBUG_ENTRY is not set +# CONFIG_DEBUG_NMI_SELFTEST is not set +CONFIG_X86_DEBUG_FPU=y +CONFIG_PUNIT_ATOM_DEBUG=m CONFIG_UNWINDER_ORC=y # CONFIG_UNWINDER_FRAME_POINTER is not set +# CONFIG_UNWINDER_GUESS is not set # end of x86 Debugging # # Kernel Testing and Coverage # # CONFIG_KUNIT is not set +CONFIG_NOTIFIER_ERROR_INJECTION=m +CONFIG_PM_NOTIFIER_ERROR_INJECT=m +# CONFIG_NETDEV_NOTIFIER_ERROR_INJECT is not set CONFIG_FUNCTION_ERROR_INJECTION=y +# CONFIG_FAULT_INJECTION is not set CONFIG_ARCH_HAS_KCOV=y CONFIG_CC_HAS_SANCOV_TRACE_PC=y # CONFIG_KCOV is not set @@ -7665,18 +10049,23 @@ CONFIG_RUNTIME_TESTING_MENU=y # CONFIG_LKDTM is not set # CONFIG_TEST_LIST_SORT is not set # CONFIG_TEST_SORT is not set +# CONFIG_KPROBES_SANITY_TEST is not set +# CONFIG_BACKTRACE_SELF_TEST is not set +CONFIG_RBTREE_TEST=m # CONFIG_REED_SOLOMON_TEST is not set -CONFIG_ATOMIC64_SELFTEST=y -CONFIG_ASYNC_RAID6_TEST=m -CONFIG_TEST_HEXDUMP=m +CONFIG_INTERVAL_TREE_TEST=m +# CONFIG_PERCPU_TEST is not set +# CONFIG_ATOMIC64_SELFTEST is not set +# CONFIG_ASYNC_RAID6_TEST is not set +# CONFIG_TEST_HEXDUMP is not set # CONFIG_TEST_STRING_HELPERS is not set # CONFIG_TEST_STRSCPY is not set -CONFIG_TEST_KSTRTOX=y -CONFIG_TEST_PRINTF=m +# CONFIG_TEST_KSTRTOX is not set +# CONFIG_TEST_PRINTF is not set # CONFIG_TEST_BITMAP is not set # CONFIG_TEST_BITFIELD is not set # CONFIG_TEST_UUID is not set -# CONFIG_TEST_XARRAY is not set +CONFIG_TEST_XARRAY=m # CONFIG_TEST_OVERFLOW is not set # CONFIG_TEST_RHASHTABLE is not set # CONFIG_TEST_HASH is not set @@ -7691,13 +10080,14 @@ CONFIG_TEST_PRINTF=m # CONFIG_TEST_FIRMWARE is not set # CONFIG_TEST_SYSCTL is not set # CONFIG_TEST_UDELAY is not set -CONFIG_TEST_STATIC_KEYS=m +# CONFIG_TEST_STATIC_KEYS is not set # CONFIG_TEST_KMOD is not set # CONFIG_TEST_MEMCAT_P is not set +# CONFIG_TEST_LIVEPATCH is not set # CONFIG_TEST_OBJAGG is not set # CONFIG_TEST_STACKINIT is not set # CONFIG_TEST_MEMINIT is not set -# CONFIG_MEMTEST is not set +CONFIG_MEMTEST=y # CONFIG_HYPERV_TESTING is not set # end of Kernel Testing and Coverage # end of Kernel hacking diff --git a/kernel/kernel/files/patches/linux/patch-5.6.4.xz b/kernel/kernel/files/patches/linux/patch-5.6.4.xz new file mode 100644 index 0000000000000000000000000000000000000000..98bfc2b1ca8ce2e46efd714ea3bc039919f3435b GIT binary patch literal 34744 zcmV(pK=8l)H+ooF000E$*0e?f03iV!0000G&sfai?!$+7T>vr~NeROI5q(hJ3QtGU zKJMkie+ghFHhM1u8w9;P0c>^eki4ZyF*FduB=U#&TcoySZOg~+IdSYm81i7NV=eCF zINUL6n56|CD5xqH`nw#5QUG=*pCL97&{VKztifduWuQ72R!qwR(fsUB$*Gy8*y?8X z!htV}-IP%im*Ev-HACS5F4V^epIee#_sbKh*nLA#HNUV%)f?qQ%baH!5r}YH&U0AO zOFm*km;=hO4yFA6ss1a4ViXcsAdqhJ;p{g_gmX3#U27Xr$Y5}qteh8M9gYOK|)7f0D!Kh!kTb~LSh0l1i6%X z<3wp_ywP}kMh5(JVLs?>kF8}3sXH={i+l=(ovk6xk2aY4D6Y>L|6R*Kk#j%!dVph4 z3JuHJ;%N2Q7LXv!)?+x+Nk<1j6He;NO(ra?am-n_H@E2VNPYdrUZ51SMY+zrSk_>p z)+!W%0^_JKxT!ynr{qxk{*vCw7NnSmHU0ckQC5c#U>%P%>NE11*+Pyd(dq>h)tuZ@ zfTly-g`mn5#*E_$+2|~GHJK-)Nqq0KFeu%MdJ+~chyIj?^>5<^*@)%b{59(7@-Zm> z5EA`>Z^?=h+zxkA-F{y+D@0s0kgQqH7e90Y>#Glkzp%m3f=KQ$}n(W^dL`T zTD#Pd_XTH7m|sX$M#PBkF3I~C&x`TW2!kpYomCAAP#Gdt7!XB~elP~N_$|=T{-sDl z9X_Aqnx7$~bWHHd9X@c4Z2Y4+@g$3bCd_u$$dZ6R4v>kxGP7$4gD$p)kL~45%(RiE zuR>Js3&cOerPl-5C6u$fLe@&jOzW?%_k9ACf{SY`53h7hOB2-Fr>Dbt>SeF(iX#Z_BLsfa)2^@yozrJTvY}L&7 zg=7Sh)d2$4dp))Bz~6AB2;r_Zv^zJ;ARr7GC8)ar80+nYAu~s1<3Wf<3BD>gqoR*< z;_q~T%oMl;?{{kxtzgtA{C8p6|j-gA}tayexLKSJ8QKK z4?|1Y^0TWS=HZ~HsQXxfGIT@BC(V)RJV7x#u0MI%pd8=h2NcLdCsQYy(zp74it!p1~{}5u!BbV2n z_)N147y_XfHUSKwv4~6ZXwG#9YE~N4YG=2k@j5MmY*45AGTI)L{p9C|3HieiM{Qqt z5(#A=JE0WVDn=gJSQgJ&SQ>=MlO(PeH~`isaHSm8AT%MAo2k}=0bjh_N<~wZ%$Ymyd z)#B>lQ!pLRY7{Mx+*(v*&sNEP{9y0b4c6f5{JjH8+d`YZU&t1_eV3iekSSIlkfQMc z8PJzdSSH?Vr5m1c$A(jIp`Wd^8Qj0h)~i_3MXO9hZIMF9d*Ibwgn9yXQt5r02wbx1 zoIC83O+-TM!_^tdQjFiRxoqq-dV_38HN*y%otmri;}8~on;sM!6)*D~K#$Sms)bz^ z6#~w2E|rbU0nVW)iVN*I){e3yN+cEE`iS?beNP6qDh-x1?g0JG=V&gr>Xm1F>t)-( zpq{ysHXG9ut~TV?=gtH)Fb6bzkfx?ML9T;zu`8#AaMq11(ON3Rwlrg90_ zNrTg^0qIJXLxOF9o$s49d|Xc{vhC+IA1EgX>wkP5YtM;(oHQQw8dnvQ91jR_z#yJr`J3(<8={v7Wnpxq6Ecb6mngZth@PQ}}(}s1R-&#A9bbv`O;r zr0kDUy0uWack`tcC;XCJxcX3&hemFk2yRmxI_p66agHB~j5Wl@~*9PhNdz$%=%d+_X ztu)v`7UzUJh>rmCc#@-!)BSbAi?R7*5CivAQPP?<{1lt$4;h!;?*K@j;N-?}b5~vR zTJf4?4PSCJ*9`^tqR;JRNK?2ov1|F$PK<+sA(!53XN!dT8RLH$!<_t}_IF&{&dplI z+^;5vE6LQ%ybg_n97;1d6cj5>BA6_3#krdR#f<6iU~0a(13NJ5Mbx^8eH@PBqz#;m zhH%^WocE>Z`Y$cd=g-!Rx|(DC@35x|mdY6eW|c zSm5ez(;z)I21qlXS5yD+V&Ck2JKlP;KVRO=!GteV1h@F|P}LA;W)gpXg(c zHZPQ{Uv#@ezuvQwZSR;$6;@YRaz0&&QJpN{0UD@DS0>W1x3xZ z%qD)luFUweHUfr}rFzEGPkK%KrP@28tm-vcp}9fTcM`q+4nuKZJ1P+F8sHT$$#i_h zsOCfd`T;+ZYXc!rt$TzX?J(W0MrxGQvC5YIYhlF{e*uL-_Q=Vnu^!d`Ap{JG5|^f= zX61L+B~0-iYVu~m&}MY-Ng88Xud$q1OcjnkEhxh_f_JBIw;zgo-;|XyEn`$83!Kr1 z>{rqXu3lj6i2`HBZy}BR$m!t3@VKLwE2Z_OH90x+lZp7+`$S?a&CWm5ng5|sjhJ5a z^m#lUllJ`KjUho1q~{wVFZchI=}$NF5?_9;V2I(N36C38sY5t%uY4-1lXN+eepN#Y zV|lb$-b{$f0cHdX5uxIkmY#i!HxK0e`Ur1)>}PY20#l(*f?Vha#ROXdEeuKu36vl6 zy3%0qo=SA0@YsHQ_WRnNqUD)N{XOt;s`z_!vaK6~=`mv~j-m|K9GWAuz@)yl8+{k% zV;-Ki?p119=2q=AiBOGu=iw?>|BqId-geBNSrFW0 zycA|v=af#h4+drfrO^)=fZ|3Xzp$La3M(nHYT(hWWV!i}K8*BZSrzZ_dN2q{ zk3ud77o+h>?bL~QI~^`nbpsoK??;7j;QZ%`7|V3QERBx(FBKmOal1;X^QPf^=|j^J znL4AnMa!vsbOLi0kiBQ7qx5H)Bf+O@SkN2KZXHQ;4;c7rml!zAdbG4eG}llsG;x_x zS>(6*&JUkLL9GvmWeVB`vqO#^$1Bgm!O~m}ln+4iEwm^5BAON7HKG!+xf*CS$xzo} z#h)uYj~YzL)JXndG!Zx|cOYm8mZgIOH8M~xV=#u+FOd(>s0ObVpCGt%An4V~ipQ$_ z>QVl%tW2Gw3NtKb8Cq=BoTGAjy48uN2^UI_xi$wS{_~eqAQM3AOFc5T%OQs!m;~ZU zSZvG{>US}1cI*iRlZyGiHmM?J);Oi;zXICoX2B%QQn+|opY!XIZ^*I9Ua||fIqX^6 zW6+zWlm!}l4&MT90jXsya@atSrSW*EndW!Gd?1hLMok%0?yiLlFSQ-}Gk+V zS_U7zRkv8d3~5e0)I^EspHPbO**UwN zXX31&R)sDcFgZ6HntdyGMt&dl+jTyR*BYTu!>9FYRnook946*Yx|X&S?zjp7FDg3NC^coO{9~P%%ABSTH0qzPH{)FY%#+so2JJ&PHgmlf> zVx50C7Pv4-&e{%=n(IvDHFaIKv>NLaL*EC$wm8(;C4RwA*KAZ9`FF!XNx-Uv-d#rp zhinZ=!#!ViEk6A87`b)j#mJHs7_9r>p3qg0&hExHMhyR*B^Cp;Cw%4od?xL4UrU8- z$@{f!rd@JAgb>29>lXhdS|?B2uT~8@TW-d2^&|6vO_WgkS?TMBV#wE)Ki2!DA23Y%!$AYW39GB&KWRfZw|8PSFXy>jU%{R9oaiS z-_pkMm?ULn$xm57RHjBeKemSlblOsRxZ!?f9J1bPneXf_&M)o{HebVRoV;*W&GaMS zWWji+45)%bPaW-Eqn+9@AJOdA1lxa}wK_Drt3Ip#abv$`@eng4Omi!Vm}r8v@(E>IN8B3Sw!IG+cq zK>Q8uFuO5|hB-l|x(&CljYpPbd7B|EnJzU_^`K#FG0Vol7J835WSh)MY5(%c){h6d zGhb4O?V%I-^T9rvIq1PGKpc1QkpO9ca#}}`ekIx4-KwJSZg214GNMWd9<{#5lLqw` zyK{*BOFSjF2SLeiVl}pfrjg4gc z(WOSZIHDv6W*7zh<>wW>=To;J6PxvW%kUFK(~uRYTD`PnLVk8K3Ml-Fg_wEs>PjNf z2*6CZf;62k0qc=L4t9MDP=vAC4@D~IFyX;zqAlm{!7iNmrSH}6Wa=XL`ri`Yt!SqB z{I@6=9eWzI+V)kX0XZvewClsi83%PJf{pPE%MbF=!lp3CLH$Pe9BGjD1!2IutXZRI zuk?U8CFeXufb9~(SuRivp2v6HHxBFad+r(eiM{pUW#p#R(z*14L8fTa*G}%oXS(F< zp)hSQb*1l8fVDuFl;zz^BYOw7q!}`0=%@>f#jx8Z7oxEem&>GEw1{CgV$L&unn1jA zSPPX=?)H5p)-=xQTGe;ngZ$@C{%~0jFII(_v8W_b@`TiIk6v5Z)e2V=$j__*8063( zFm4HRS^pvw>b<#KMrTisJHr!zC7DjNG_ek@`&v!?hvCzmnaxX80DI<8fTX&81JYKFx-)T!rAQ zZulY;ShB47yXJX7Q1~;^`FfTRK*^_?m{hW-*QohPiU+KV=)~^2C9`gkDl7lDzQ$8P zeyR$-UjiD#h*u~{Xh!?0t}?vtp&cFAzMN@4e#fhmygVU_*TAas$4I%{_}LeXzO}6t z5_TOTB-_Y+uY@gs*tlXw7bgdEHR+V2B2QehgJ;!vfE{<#%%(Ff&QXGa@gCbP(i4gM zo<^!w&cv&5{w`~o`kYXvjXV*3&7uR$jd1Y2Kko?KY|)^aa+XAP#>aAht@yr+-AVY+ zr^S3Tt&swt;~$E2vuo*7kgoujiXXYJ);*CTRk_-l3kc#|<`qBP>?ycG0VYRZ7^lV@dypxAo2>EP=JOwy z*k(>PNDlW!CH+`5V65rC^O7`j$G7uea&~rEPa9Q}xyOX2nrq4sgBE-c?SSm)3nRhR z)5$V;jJfMSmhh(|pueJXcxPKAIpjVTg0@o3oT*7;mP`w6%c2;9`0x74I)55#^WtYM zigDYFjL{RL>F7!ax52>rL(MpYX(_c<4phOXUoIJ`oYC5)T|P9CDj)MN?o|;em~B*$ zD__vO$i9SQgSP-$l0`o7#S-f(kLM|9NSH>#3qK)1-+1m&1}AzZk%r&|0RzMP)wb0K zv_U}$&dd4D3o{xDV${9-9(rOQBrRu35j;cGMPf`IXeEN#)AIF(5UOFMVeX9lte98c`!f1X36?RNUx!ygyei+fz~cPn)JX6|}(4VC3$>OL;$8j-N(7CZie z4nY7kW!-L)v`h#0<$Jsb*Q>Pp5Rq4SgMPRW3!4vgnZEMe1s_mYuFun>!pYbA)ye<5jOy9BBgI zGRXEla12!jKwj6{A;Nm*URtw=oF2=y{0&aZkZ;$oYMkJbQoX%7GTyFa9;A#)g+8FR^r>6-qkazne%WelSIDT zbFb%`C~4)b$wS67O4R~tRjXM*@TePTpEjse_z`#+V4g8+ai{=2{UHxDbP(cx<%E!JMH%P$3QFpDTkbq@wL z27Qww>AoP5L|;GX_3mnx@!vimWOHpf(u~A+(g4gKhNHp~f~R95cP!mFUS?C}ejQ4I zS=04;{r1=eN;~i7cuQJIp&$fKtpW1qw53x?hEana^_9z>9EqhS#(Srsck2CAn0e7) zpXV5JhQ_*Bxr|H@gOye-wq>sNr$xySFu7pX#o_2MkH;}NS-w0PXI9~+q^+eG27<{Q=iS|8%bUn-V;o8-KjtDrBKgznd|aCXf_Bgar} zutfvV8$&(d>Il!>YZiqyj0D!LD5qhI`7^A{v6yr?FxIe~^144mZhpvZMASHn04p_j zcTNCI_-=%EHsRTvd|3<-u{9Zp+~$JhECnZyHNB1LmK5E^)^z0(2s>S=dGp%j-HW-( ziMH#kNTS0?ATmnk<5cs5<2+CirY8{yh(DmEbmwqr_e8^p>_3l$sRr`&C|t2XgAMNb zY?BF+t!TFkk4t-YDea10JO4o1j66m6h8|`A1E9F)=J7%@>g;zJaNg4j?9+_`+}SkI zdM`W|gHG-nVNi7ZWw^W_Zc_t^EDS&PV>!YdQ9Rf-;wPkk!?B(HMJ)G2M8{VU=Xd)i zgvf^Pe?Wa>tUVYkIq5seG4hNx=|%Euh6Ta5dF0wPuW`x)vTMUlbiuIXb~v6nLimF| zAwid;79|9th5XaijdmA{)MDt>N;uM0Y8-+_`X}HLF<2wG3{E|!bYu!k^bz;o#`)! z;0fQwAeqa;1i!oOKH4f^7}rKTTRu<4Wl1=+DEJd^2^FmG17x&;74M*+imLLkE^Qk# z4&?H@?JIeWxRA-n9ZORo|47SYmV_``g==lmbZQ=5uI2_=7}btrE6S#kLu$9g-NK9<$U?R7*KtAu)Y>%Yt5z{7iRj@_7D-Q1?z8exs;WR+G!aJ zXrhF>J$wQYsHhH?Cz^!+G_f4Lbhub3H9M}Xrnty>#hEbJlO z8L{{NTXtH^%LktI-YJ5fhGy~{9BjOUGA`t89D92$KDmL>i`LWX(&w|kG@FHEpVVTv z6=D9CCzzYJRIhlroM6snowUrrmQG5?mtAaGMG4yF?6T94}E5hX2MtL~j&d?lD6mWU4Mz6ZQozqlD zh=Sd?zK6mc`C2tb4oNrJ^^4)B4%0lmQ9ny9Amo51=rK*)c!qzky7_Vn;Mhq z>!KV^wf_y(a*EP_=$ca=CN81yxTi8&MQ^)ya6cQ;6c?n z?T2fiEG`u8$OBs8MU%@}-*0v34|{Obz#A^lpn&)v|6vMx^EeKN&tWBbu%-~v30v+WYucS(kyu(gwIn4?ug_w%^JA6^}G~Z*)z@vsUp$oq? zxO^E;q%0&ohi&1)p$K|~@0&kVskE@Jqb8j(C{CNj;wf_lq)?SE7hGkZ2r`$+Is8BG znc3~KOTFL|Lo*T%Qsqc;L!AGeo%wwT_B0oAew$GglgxDP7IJ1}3f;s< ze}VYVtDQTVHx|b&kLk>jMKxealQ@mt2i?3>#W;b%YA#<=(r5DFWV1N&uUMf{jSxuh zFn+qwu)j#pwwXgBRD+WX6QorWQ{yM+^F8QuuFT7K)q)mN4*77vs09>2Gz{nb;$>>1 z(oP>LFCO7BcEsVkc|?rvFVNw^5)!8e($UX$^X?p^>Q*zA#83&`Qzwiz!$GM9<)Ju8 zsVDYz(^w%UwrEe8EuJFNi=A6R3QqBx!fVBKkqaqdex_B>BPxsQemLh=c(Qk6vLgl9 zv%I30U?^6!P7I^4=G2`=f$nDTzKzVI+Mw^(0o&Hu#!OrZcvOlBQi{(FpIRn9jC8dk zQVt&9Rk3u2e!TX{b|wPgIyfC(G?Aq3+p)dLTFT{|__2R0B+H*WnA}JW+=L+47z!=6 zu8Layabz3824!xFZ*ug@~@jOTho?+2mq)9iZxogu~qZU1yVoY}$C>_T_U zFep!`gzDZtr>4xSW3*CQs;+(U0%#_yxUOb(jiG~nt*FDtdcX$Enu4zA9-Se~Z+x!0 z{0d@VZVXgp8Sk>^13LNLj2VmD46y+ViA#|?LCM4^{!%&lNae9Osy{tc#gVNn+z?~1 zE>P~s>xNX!d&eWSXHfP>XG$xR32cP=o-S^gxb*{sPt(ucb1ahbI39fAkqa-S?_ZjY+~b{Bk= zPd)EKZLoKvT^s76Xzo3|(!P!E>VeKNGh}LgD!~wvN@JJ{S za)#f2vkz|FpjB+PFY9vGBfmxh+c)xOKx2$sk@K=vDD_E97ZjI-ne_{|+UXq@XOF)( zXN6XN<^(4(WKV%UVxO9Lrt5`}=v!3!wqXJ!7dq+mYmxxf>!vnqjEIvyV3#}eM5?1_ zpa(WBbsk!H0pM2!fdS@nakh}08WUPPw=dhvvhCGHuZ(TXn_Gm~^U=`anT`k>+b}?3 zT+5*(iL}shgWAV9Gbyv%b3(ptHtyMmT)h%iOs(PXMw0E>XxdWs$%IgRbJ0%;RSf-N zD0QLDrCe2!JJk?05#>PwXLmjy0!g{UZJ=QXHJyCLCN%~~cNb4;9Q>I+`hM4p2rl2} ze7k4PW82IjWx|g;L{xV3@*$|ZyVbdo1J7pS^LJ8~~+BIIrb)Du7#-(}p1q~ue+%{M8wwq=5TX*<@L>_H1OuoD_Ftc@bNg3Lw zOg(2b^QL>an~_CT>6Jt9WttU>Au zUvBg)#@a)H32yNgVB&gcOsVSJ!%3~GuB>)sI8&ds8iWjFM!z=Im{hx?d<*Sb_-=G3A-R?AigLx!K8639dT1_2XvqqrU;9)R7~fru~_ zg&e_H-G=kF(9aC~GIlf*$3N?A4l!@M^~o4tQx=RAc26|L$&*!OKL_}+DFgFx0OwJa z3wPV!SW%|dKmG<>Cg+j%tkX{GqZ}X1cMwA%wddrCMhP%|8YSUN&(!LRI+L>}C1v|gG7ra5J5EoOE+63aB8^mG0pYU|3e`68cnk$KS~)C^~^dd#NN;K z->-m0iR$HJB`YqE;bh-goV>%hK()#mtd8MkU>TQp5{VJ(W7r-tNkk@GekyMmf?H+z z(w`l8o*Xkbk8>N5q0qUI)!3oZ6TW2Lzz&Fmv5hgp(!!V#rI44$v{a4oU$eosz7zO7 z)y~-mic2lqBcv>OuO~=*aLRg3tQe*2x|BF%k+;mAzHKkNUHbF;jaoL`0{HD^Xp0I0 zxxhbA%WiW$4_oG8k1qWh%x6p-Js}yuNl_PDR%P}S#`hvYqEoSi!tx}G2unJ^Q>sI%+9=xpN(vk7Tb{^UBFgm#^UpWU=>O*TU2z>NFnze z7f<3f^cB`nq6{1Wps*q9$oC6?l^}k+TE#iMlOjSI)fyutokoWILBjn;#$7*rjqw?U z)%pEnSI0)&lN&x+{k@-KAiPPD00Nwc)jodn;`d>rC~=YY!|hR8Lk$JO6Vroh8{Axc zi~RG5$7vZ5AXeb`um+72SRRr3e=3~(^o(~6Uw3=npHdHu51##$F;s9ZVpp;1GbnPzjuG20E>Ww*&{@1sZOr|ZJ7_0= zq~*pR`u9KzgLB_kFkg0liVC4RB`*J7HMTHN6TyM$l;m-rj1=Yf2M?*sT1P9z$kCd| zJ>V^2DWV!eJ9(}qA3}(k_So`zcN*_$jsFTK)4A;d<@7Pi&TAIaphfOiz zo&dk5>i9Bh2w9skby<$NZ!hXC({(mbH4tlT(vJ`CPWxbdxRQ*p?&Uo$i$)-2-oN*( z!#xq2mgUvLx*TCKqdLsZgf+dKRAqs=CsHuNcl%7m4xh^^Lvw9m>dA#Ebknt?8tkYT zomYa*3qbwW^J6CS-?m@-cV^BBrHj6uAp{`Yxc_ZxSwDKwSPKHTi!`2z8bJ%ln`9Mz zX|Nx*=Zel{;`r_+Y3JycapEhPIF|DJqC=Mkx3KegQ{VNBvGX3Jie2>)*)QDiQ8Pf- z+2Cav#{~&f`};iwlILkXL!T0F2n_Jw!u>vm0YboZVL*Lccr&BbHCm8mt-m7f%KYJBN z$3U3BS=*v02HP8G&;z-+u&4PaQuVOejFL8d+OExECb^sB7_acGfFj&z6`S+})KBZh zg4MZ?7pZH&P%a;l__-?HB{ofGn)mz~V`z)mOGtKFu#4$*PbdnKO8sN~e1iMv_AxD;X_12>VY zG~VHdg%or*XfPuI3A{@H(0G%}!k+gkZIT|g!2^_Bfxm_F|8+$!;i5j4JeKulpkEF80X-aUmKa&Ew!+iH?F{jlE|l5 zk}p5h_*abR{e#mAWL)9ZQ~PEM*s*V2+bJ)7ss|?ri{WOD(xMMB(N0RXJ;*gB1Io(a z>P6CR#L7H0ZG}b;%h)`Rn(ie)SE$;E#;z%V)F8^4)2;A~94@LEFWa^EqYYI%yd<4C zQN@qp<0%oDUUyw?vaq5BKPY<-7W5~JqIG8KNVZvdAVO!|@#C1KAL0(3JQ^FdPx~g8 z!P?>I*LXSr%bDKbQFgy0zvf1|qkA&=33)1|*?c4)Qgn3jy91GJn=mL@cMXU!sA#OB z@v~_}O1@ahtV?Gx9X=O*=5QClC9q5KBP@e>DdWhK^EARBt%uYxKy4CNIVIesGs;Qv z%5<>zCi7={igZeBl%nI$CBXys8uQ%lAfSmQZx4lVv&+9}nFBVTJ$ zrZzj#{35+3n10OlMJ9nL434vd1!uS-(@Q5MoyS-e7>{JV$ZyvE{>IXNIO5dRPSje$<}+k zzp4I4<$NSv*Z=e0c>J|n*B5M*dClPrehx;H$-hgm$jJ=Fa-L5Xqg*hU8*3Hse9?OI z%!PTSjL1Km5^jNOUV(?odnJImD;DYiApR5N@v;WxeA6rY@Ad0rU+rBnLeWD2B3?p0<$R-m8-Ga<@6lCeqRol{zMf__W> z3k;XysIK{zvx2jt@?|CWOOx_-Zveym<(wsc+EWBJ~1DK~II)y;wgKu;u zc-*21w*0P&6vT1;X1{N|;(pPE=@{Fsg~F)pN3g0{gFwv`iy4gDzHJ$jheNt-36D!L z>WM|2ynJN_YW9?=ZthIJJO-ZR8yTnIqFf$yMn~k52)H#xH;67p>5@6g&but0a8vXb z{#u8$mF7Nb*#KyAwgyVD$+jq$Q_YNWOn`GP9FLba3j@75$T-yh+2HMl(w(vx{BDl4 ztk(@A?O3H?(PPxyeC$|LJS&cP*p2>r-<^sqwHv#8uIDuK+wfvz!+D;hU+^OfZAgd# zBTl2$r^5Nqb|PL*plRUD__w@^27Rv_ydn*75jrxO+~?E0=*Ccct-LBQJ0c$$_o--uiXh z6xfqpGmzQ$kel^rDbj$+Oda_DdJPHH$$tizXD9OCdd+VONNTi^(X}d#m8l!$o!ZLt zK~0rAGw2V;c*N1$!$z>D*zj!7%1}^om8o9wSYivuidfdHZeX?^82B=EO;Yt$v-X8( z4_-O^iY6+L=Z5z?QZ`ULFTp@SDZS*CCZ-aJh#F8FTIAjUq0N9pSoI&1Aav@fnsA2c^+2o z8lwsXr-xi| zVq=tQqN^bPmu4K_1fo?c`#d76>$WAo@yVb>35@F|dhn1cFgcscgtD`-hS_@cG=V#@ zjCLSJt;eIwbYzoJJql8e0@bR^{&$@t8~~|^AEGd9ev?`kp}1Q0tXI>=Ry<+h6qaJq z&pu*=GZ*zjS9~9wktM_@A&M6Q)ib4SWRSbsVlH!uM&zk%;E2eP2<@B{a4JW%^J;^;~9zcnvN@4LO{8e>kYvAOnk%VMA$=8s`9M{VyEwb|hsl0a8ptX&fX$ zyu{HJxO%khnd!Q~no%k&pwQ%rggx*N&qJr{Z2TQ{*o{>~e3rCKrT;~ra%W%#pMCMd z3DMzL|Rx}pI?3| zPMy2pJ=OBxZW@^hg9`sr0IRRUqFxvP3i7r^(xnz(?RWCX6H{I3%7@j?HpDclb{Yn{ zl07Ijx0>>OrECeCt*QvX!b&%?|CyJIu0UzGQ+%oY`X;;^Y~GBS$k;+%=)*-g;4$T|qWw!2E=;X?~ zoo?mCx(39wjy)=-8mBQzWkeEhc%XNY5t2qJe6MjB*_@mcJr?)2pW*k?2+U=yo<}+! z3gc3<6%ggu^|%n~hG}rY))1+Y=LnU840KXz+qIa_AtnOo1JHc2%++Zsq{p{V(tNWd zIxQp8Dv|*oUg@CQm2rn$uA0o{iggS-QXI3)VZ%!nhnB$&olJmEf zwA@fm$&I|-%O+$3Pwr+~D^)*aCLp{cUesVzxl6+s>X!pzEEh_+VdycDf@|?g-gWub zMXGAT%B;uE?N#K~Pdq5(iQ;CI1>9&kNevL|Elp7WqpF7Ozb0U8R)VgDy3X?$c`Kf8 zu#!04^P#SZcb;}mPtbgr4$$Yh3$H{EKWAX{*@&-lPjy)`i z&3-fr@t^~-!+zH3VG-d2p@Gw&6roy;ZkRd$Z(2C5n28nVqx;fR8K5RPu!~g<(wZM) zZ!WOuBNJxu zc}tS?fY3df1mW-5+#p=%283XoCBn8vJf<{SLmg2&eg_Vj^6B9njOo2ErDoKp{5S7$IhDaC2g= zUH@{3@WIi@F4~C8%Ym_QIR4=K;93~4p?7;jkB#0WQm4$Y1sowza_Y9pIEX5bn^q)K zCb}pqt{ZF|riR>^uhk=BFkp*5W+ELiRgk`$`PK)gI12XCs=F4`p!}-i8D7VWU)^Zs zV*i$KkavZBM{bjMSw(=AVSJy?bK==(Ym-@7jbr7#k7)+bUC~wUGVj;8lvoL^BwTIN zsQRm6hbQF{u)=4WKGzH42l8X8rj~vp2*R^wxd@cDYQ*fi?3>7#RF*VK{?yoD3ck6U z^`|;yR;N410IPDi8S&hE*d02AwW7ZWP7P*yxaE$s80fE@UVqLp_AfflGJ~t!%cL?w zG}XozS!D1LmPO)6>VmI3ib-d9^LH#5$|Yui306?0IG?)^b5M6jZ@h!+ZOj;ne|!=^ z9ALm@sB|&VSHx%yL=QD6jIw7!23=7Tkl~0~d35 z{t){>Kv_^u^R>)If!Z-6lzWGX;%CSfAP~sy?BJ$+03?O?p!X|6vkB6SA6sA8rZ-!^ zUw`*kj@ni_H+MSB@9~=SXsB(;Jx=9_?49@g2J!85?vMlUdKuMgnLM<;b&vc>-ab7} z5JiOH$XNGoScVP%WW?M>3Cgo05}pAd$O)NtPJ<&_-F^W z1%JTlxy83-rjCiOk`U1X7kDcS_XKZ3Y^6zwrblr2Mx}>5HJV$pEgA7dAOiGR!(sUa zO0nmW?9Zk2L93$@l8g&vL{m&#(l%cgmQpVV1kY#0J>co&b*5K_d1+B*QFD z8nhxopgz52>^}Z>3)*HGN|h!!V`d0oxx_+S58MOEVd8taBfn9G&0_2lxBUfMBmcME z6UXlKW4rC_yLw!jFVB@adc%7W5SWhBrr}bn64>+bPCf^>LMOBPFIsf?8?7+@R9@eh z+lWC~=3yo+JWxKAO`|PyYA#CNx}=)+0DO@!WIWeAsd~kHIv5lS_8dYt?(fU36@Mqc zL1#j@mVZ+LP3lvS96DFvZ6)D??1tXb^aaA}QN#H+y#IhMw_vN~!xLh2K9KLVQwSdF zGQV7gZr5<0DPN$GM)A!GZ$(g}!Q6W~q*f(xq?1KoWsHw_XtF{ROp603X3`^>7f=%n z;;$*i^KDEhyk%;>=fmAJemRBGSrK1vAs4)$$RT<>c@WFH^sMisAyPW>>TspeU7SiW zv9DdDJnuXhrN#FsFz6tL>p}CCxh|hsHR6k8M>u?fwwL`M>Ms47TS@HfP2DjWz|Y*G zC2MW?QY@b47!>Q;Ws#W*ef)C@TtMn4klCu6O`Z3#{NO9qw|-v5ShJT#m5o!DNfN#m zaYv?-9i2AxW@S}ZsiCd#!YM)D=_{#qFnddJ$v_8LTR-kOrZ2Z&MXs!1Q0f5aQh3kiUC8F#Q3iXSC8j zF-g19s}F8i%dM?jY(I7;RICz%Ycc9sYvGcoU%=HN2{qO3$-*&<;bDe2am*>99e3_U za~dGF4&Ua@ngafY>2@*4Yd%B~9bEmdd>}DxDaIZ@ZElL!LJ0tY#&7!rH3JNrggS)R z_B4|M%pOleX&zAwA6UMaj_MHkHqyK)8^+TV@g%2$o@iDSAjj@{y1u+>!?1}gaDSqp zwL-DlogEQ!>+Ov&$P$78AYXBuRMBIr>!dPlzse9&df1j;}C z1OHGdO?xY)gUZ%H=v97BQN@$ccDACW1kwQ~4&i7BOGnR-$A5a%7RS-ZwVHEm_uy%V zWgm%g(DBgg_1obGXl&dDm=rNL(cot4TK~!z_8XmIwh+ac;6BNCw`}{||09p-zhO5; zHhlORoJ*D1E!z8>ICo#fLGr3^-!F~Q2-WNwKL~A!+eG%tCHr&{wb2bx`NHT_?`ukt3*3F8CJ_Gte@n@xzN!#oF+)s=+ouhQ)gq?~!AkZRlB}duF)8l3; zPy2;-yxaYxLQd#t`CgJB+hX0s9uD?C?`))`MslPtO_o&mBrf_Z;gvlxvqGA$&i4Za z8D#b$gS)j0ysK@`a=+>^8pkx&QlZQe*@|o+4I}^C&alYb#r7(8<3^cOCc$G z-A%RVrwn$fI(>makb7u()*n}DX zKQUy6x!V+fn+mof?)YlKJ8B_o)KSn+C_=-yzj7(9(mj7){Ds(HZ;+yl_HiYCm`~KEtE< z1LP8vTwgJN?5anz5yk=J4fGJxl}8J_#GYy69H7GwPkf8z+uh)`iA6>7@z_0nWBi=? zUQE;_8MiLB{h;f%yT1sz6=RL)YDKHzfz-)d-RSBrujnV0Yf&Kd1S!0|M`z#da=HrVL z^^Z=g0g1ohmoYK$!<|^cwfH&T6Tbtrwd|3G0!0;{MC(uwSJ|Zd zQ-HooZZg+J%ZzsA!FnX%jWZS$6kTnS{z6_I~1L7jj5v2h)GKPY|C}n=d*X=5_BXhQ} z0u7#qf9S5ME#H1q6=U8+%So^H0Hp3+y$PoECI*$Y4ajIgu9x9=-m_9RdQR0;{X#;} z`3k?iK|Iclt@dP%=5eOi$dJVI zaRhZ?S!XfzGff75f;{qf@a7usSDg6i)_ggT1G}&=U;-JHTt;+eIGh2CM3mZ8RWfOO z9c;;V5l|lW?qb-hs)M)iqE1SA^{d}Ivk^Nt#kg&pJww4L(PQ+_JIswmk6+~u)d~rC z9KNQ>3zi*xXXn{^gFfr$^KMV42?E)KK{v+IQzM01*NC0=5v&ax%{B#t7TB!HEVimL z{knoIaW8`Ayhq041Rg?n#Cr zz;PF5IO%nSKh0Jw-IS{Xd`4X`T)Pn%2fm{yTnE&)Ju;+_0}L44Bl*(gs`}djqpEVG z$0DZgF$4ARJpQE2yc`IYjuvx~=NXV1aBldr$I^r@tS>`xHymUrbZ%sDgf8t*twR5I z(9_!+uR2=j1G}5D{N<=Ve}%J*KJ-B_Hhv5R94I1$Wm_&O<&5{QtU zaPckjCpNwlfS7x*&Q9F@c03*==AhcgkCuRbY7<>HvCtVX1TMSUfyMqkn+aUC{F@tG z6)To?%xx8mumUI*{QH+%zKuH%#;kzrkcDm>m0Rvfw&5<2V>t%) z!BY1qk6??oyf2!cN3@I7CsuJ;@g$}2Hah9$?Hx^vWC_d_#VXGfA#1bUN#_ROZRVp% z?gDSWweNW{S>ho1oSxO?a82ArcWWfk+tdL+`gyJ_)L@v^JUTry?q7w_=cpO&sSm$V z=#f7|qz9N%XtrSVb;mKzOu+;rgo;t9xTzQr?4)MQn7vgQB@#61j?W<7(6Wb=d z|CGyrDcWk{{?-1#4^Z#&4u`Itzb!HtIF>7K>Ok6r>HU-?eb3i8EVAO?q zw~l%&$0X5DXpH>z!uE_B%N?||D01us-PC8?^pN(Q{Y*jC!J*+iqUQNf%(?D>)zZ%`yrrFNX~ z3;WEvR~-!zc?(lEDt_vI_ef86%6g-^XUsGPOpSkGeXcSg{y2v5+VXR@3Nw*~kTr(| z&!HOZTw@OmsUor*>ZFFK{PX@?!AyoA1qwxhi*TCF5sP^ZS4ivl?9~i$J*(%p6xmO| zDlI~UPLb_uVLjOcF*QWN3TG`<2~k&bJ+91B8tX{};^4GHFGzl4>ziM2UE(~`-P}iU z_p79XV(KhA{4wxTb~}fnM%Ve-RK(DdA>5Ew;~*c`n$nYUnraq_igCo6W3PQZ_PC+C z48yv|d+kHQLEn|wV-gtdjK^6< z!VPNMRxz2Nl^Z!)o(;K~!H#pxfB8pYW~qETI*U~lXos@eFWrWkWt}tF3zOKn%!{U< z$Bt%`aGvGJzOf_eZlfF_qx6XQdV9*Zq6lyJH}HIE(Q}!pz@W=(8QHZ<(vV zsynA^k?dFRrE>pc^l|$5ZR}hQ$jwj=?0!kt4&y3cLdV92C&p-Z`kcBdyUC3KYPv=< zul8}dC@aK=X+^4il{k({M55bdJOLEvZopBk=ne;0j(d`^K#y`Td3_(TJ=oEAo18oU zaQWz5N!B3;OHx1BU5Vt`puy*Tl*7RTDWo4gM@bp1d`h9b6xKpQXM-rwsU_|Eq>VT& zohu}0oN?yKZ+qh*^oz2=wXl`}FRLuv+wm9Rzu_1=kNd0K-#4}8bUWd!w zB$Q&9ZN|J$5$Q3aS@uCYh*sif@)_9<`<2OF1gWK z2yT|bodAQA+5HEwtsu4Lo@LJMRr7alL&~0@%JLh!lk)lWRpivF6(54}p$$q;6c6EW zRf>=PD2kurwjA+_UFgq05y>kamu){wAQk=5g|Vvy4_jbFsp4k(!?1~rRWOn8?44gs z7=VCZB)-@yQ+W82qIsie*C$Il-@dt8P;iHGEqO@des9bKAZw^OAjxcwRB5@w+kyBF zeq)bBs{H$spt!6feti&i(%;V4fT%UDdFbI&9Lc%e`@g@MnJ5DKC&H>6} z+3dmSa;zRfdx|TP1Aj|D^;rJjXvl!a+)v+61nwUAYtTGlvK~P{cGxuG@r5|csa9^r znb?E6UOJG}b5xJYBcL-pBxLc_@37z~gSC30vw{7ONMg>{P3w=XNGKWw!y$yt}SC zi`-?|5_bo-OBt2W19C-}WznjMd174V&~gP^V8vPioP@laZkH+~YC89SZ@$LyWV5Q^ z))?*(N^Y-IH|cZ;>Up$68@817GRY4FMJKTukIbxkx)v zrth=HFB(+(D`a1I9(2|f@Bk{Nl3yPL%!m4G6gGSyw}*m;JG6y96^JeS2H8(7EY_W} zK<7FH5{2aT?*Jkb0jijtQ%XQmIns=8H?6p|-nxHxP6{M1c7oGDjtPA!*eAv)?t1Sr zx!eH#wjQubtrZKJ77OZZxHqVtjDQTw+AucoNL`=!JZ({A32%)sD_h-<0=nRXaO95V zIG&f0DK|L-k*Hv>_cc)^Ka(E4#d0W+3`svd{QxPMbHkI|LC%H4Qd>Y;s%|&w7j^r0XoU{g}4v+4;uYMR>JHysS)0RR~kEdPd zJPS+p$0l(Vl8#b_m^)fUPW-)?rUq^%%F}1)GC?T?qCsN>mdFk_oD-zofY;%$(cp$M zJ8z$yfxh*($G-}|+(0#Jm3Id(-pi-}(jMCZrWc&hbvIC{G%c})*>MLek4Xv|R1^rS z#9n*)fmT8jmTpWuZf13_2hu2;2Qz;chuEG>ETYmn&`}Q3g_Z0NGO~yA9tx8W?SHEx=c-;MDo{&tJRE4()j)d2$cn}_SOisIRQAJ< z?rPGxBsSuIt{VK!p7i!p#w1ijk!3g^u<%>fTbdI>$ZUK|vM{J~_Enh0cYe`EMgKXX z@s(Er99nwJacZHzbl4Ed^8=pAUy~|c6GQYuy9Q&kYdG|sv(t2f%50;zU;7IV3^b1{ zI(#i(sgs}RG((Q_5M3zE5J(EGUK>)Fya1)T!a-OS0`*~w5ExcAlo;05jbiql^zND% zIZuEBd~;=`A>fJR0C6gWRTk` zY7Ztb;I3Xc<^>TCj6%k36IZ9+ET;G-B=!j$0%WB17H7!ZmV6gtcBKFyn&i6Tm}BS8 zxQO_`ts&lF+L!o`hR%Fe&tjO-D~UB|l->r;sRW!qL&CukNvW-BN(PrpRBaAahr#I1 zD1H&{c7u;&%Pr#|_lKZ1NVcq>tc9vW9TqcSb7jcl9YSF(2JT5UNfNG2#5?6~S_0k8 zKXIi{;xNyk{bymN?#zVz8_I?-CF4G-h_u0&YXxN=?q-k+)F|1MS&p5f^O3wt`T5MD zB3JY(K2EHhJQ-(`?u7%3tXn;8iV_(ZXL0yUzy0)b^l|$Q-~92&6;EqN3jDfd?z}ra zi9;lNX}cW47X>gF`JA&=6&D3N9?x*EJqKZ6^KFnj(q&|lJW^5OiKYPXyL3_YRD97I zK_=kx9fYXSAHlO|b25{{$jJ`X;jhfakP+6lIzAl01BSus9JQm zgOCrz_lZG9Zv~EZLiV;r(WcxKgW+>Oo#Db<(~<$DPPeh@awQo@AUnRuv*j~3K>Ktv zDREyIB-hqRDmGYp+!v&5&#vhcj`FV&4eixo)EE!$l~bgh-&A(g4@aXr)Qc+Yjahz?9HSRlp`)Cc zL456*xsHZjsdHE{>@f*u3JSC~;P&<2qH2)Il>4;<94g2MNB^fIn`B3evHeysumbvIx>id6quG#U(wDs(BpY49+=p7ODFCA`Weo6*pefy z_}Hf6TP>>7%QFJ5EJfBxIJ)|qNUwcG6ANcEz$b zftvwdE5cg1k27SXDelA^rjf-D)MpgMb;i_xzV^Er&C>a4cqe~x@X@Lh3-C!wScKr? zVHt7H0G{!=-AeJ@0E`zs4Jn)g{fwx*t(bjkWCLV+M9SdJ$W0F3TLZ=Nbro)ClJQ(< zpMHaHn1723w&&{(IvLat`#1#DQLf&l31660X9%~M`dM8*g3?Q_TsP! zWzKVGI!SIu#QQvdb1Wi#dB!qXFpz?axHOPmk*j-Mtk6Ut$f(7wlCk7ku(f z?m9HE(BSO6;XD0l)WTgNF{C8{A#ARTEFEF2u{b8hsPt9fVC_@%_BfCo6FY%)&SP7^ zgGv5ZS>>v%Q2y)nR45aqxo%**fjgiZ=cLq`{qtvc>ihB@jSGntS}N!htQx?IrB+K54FNTuGjl#n>dc`GYJ#9N0N8_yqbTA11@*?{|)h{?TUVxawFkK)VguwBWl$t-2s zoZnn{mruDIHtFU0^Z?Cv%T(~X1KwG|YQac^C=GU2)r9p6x8}3#T+7>^2DfmX5{>+| z+Zu%gkCwtEOZ(?%FGT!9kI~%>aq*Rcn&2?`&_`27(PKePe`)?u$KgHX8qCo<;h#BI z>8DnpD{Ig*m7*=B8Fw<8t>q=PY?H#+TEypzEPJ2D*14!`b8&i4BbWU^mUD;-)F+t@-;hF_*En zHYzF3bForFF+euv>*>#+b9aMR39pEA*yd;!Vbuz{m$jV^u9g{INtdS>HdK4}=BLh8 zoPFrArbT;XP3VM9x8~yN-dwdc>W(i$pi|FiU|n=hv4~_D`^&54>VpR@i!9lh^$XZ= z6?sif-BIV9bENqc<8Xyr6T6gLO@VGiRd?+Oc39Ylm_$s>MH{ydVKTEgM0o|oihQ6U zAIb5HSv98$L>1iEX$>~OLHNdt?yV5ncWQr#`zzesgww6FDM3L7uSqCD4>HMh^A!u? z>?O9~1w&e6>b64%r}vHg?uh*>zbJXQOp6RC~7 z{D4#+lYg7SdZ>YmH{$FBfJO0S)icgSBiRv*v1FDN=kVWYdhG~O6$c8gYtoOR0wd35 znZ}&C&Rb+H%f@ya=J|}v-u#@ZrO3)wEWg6Xvki4QQ zKEaw4>@fGO`Ve7sXOm>$lPbXQ`J*oL_HPLs6+2CYxEtYy;%=A($dT<_n)EOWF@If& z5PupT^nt4y8zL`=;0O;>?Q~6yUT;ek;|l=aA}VCPRDKlIS zkv`Rpl(njKZ1@7&a{fCvpPTLk-gZ#^;msh6o1ksZuklhKDZxXwY;@1{6nyr(JO7s^ zGL_))`k$PeFA6v40)q^zqnnhc24>p&^J>J3=Zh5~aEw6LvRD;K55Gw>DIbhzC z&qEQFs?ezdyA)Ykb^>L+xR_$JsZtW)|fB9Of zmQ|f*%bb&!(6=R1(a48YB+VcIyq@MuxZ%haqq})#u|#oYq-NM^rvy zv0`XNSeofmA)#K^g!hQ^VvuGiaJG71NhlvN;opKQzVNZS*M>HQDWHXv&jpUGlUZEr zG{&W6HCqzY2H{rziqGeJ%J1HIa?k1dhl_I6{>VW)MV>iopm?BIKqTYq4 z)liunAoX-Oj`X`|B#{>;L%yosZI{ADZSZ6j3 zmu_f4EgL_Zq=dW3OxR9_`U5nR^)%+T7u>& zxYXy>><@-RHzMfP+QenY4i|^99gdqhj6sj^0xc!qF`Srd{^ei@-AiOBhE|H_q)~3+O#cl0I$)kr7t?sx}a+ z0J_>#kFLNFp17U5Wlc@-(VOsxA#sE6*e+!Aj-Ym11vlpeGDl8fj{~Uzsj_H(=m7dT zqrhmM?=q_hd0rxB)B8$dw7jrT5X+lW4Wy#0+}0Kqm0sMqu4_mnW2n@=6Z1-PB4V42 z&ur7y8&UjyWnuuMXRr5+L#UAc!QCQWH&Yc4Ml#N2;ji{p`;XKX4Kd(CfidgD>aRQc zEIN5H{3M3mYD=W#E@+K1(RSE69kV@yv5e`#GdsxP>zg^wo2$8b>3ho5QXO`b$sP~v zsjp(-8IQJ!Q&&FzkXQPJy7=dj_!z{=>iHgwtX+^LUUGSD1YhK~;PX~7M5JEs8p|(X z_dfU?avcX1Gh8c;N<-3mRhnxUwHT}F%AA3+q-~&|;BS#51r-ZZB=dFf7`Zi38mQQh z>!mrZq$nZo{D>}89z=$f7#|Voyc+r$G>9tKI($54-VuTK=lcHx{nume zVir%t!+WxX={U(2Aeoe2T1rQkZaN`P`8XEN-0;49rkUhzyERAKTgWQPlEzZ{eniax z0psYXD(;5CMR!&W4BsL7E#1eSeP7Q56AQzvROu$7*8m8riGvr+<+3 z??XX>#Pfgs(~0n+kj3#(kvF!w6M0tkCUZ^$v`Cqh{6Pt_thPg0)`LPN-qVlWGSw}u ztDn}V<8NS8F1%`-e(H}3$kx2a zb^3`&5^eLAAcNb5;T+Fqv)N@;pS|>ej&%n%u7yNCZu3rmyZIHDBK-UE-D32O)f8-9 ziPVCU;fRHwxFKf2krd>G6?3A6`LHGQ_Dd#RIji)dXLS>f0>VmVvc`mBv4$T{QEDue zD89JD54~S*E-pAeerFUHXJhq37FXWfdZQDCl3-|%8f*jaSA1&y=YKr03trnyXD)Kr zjqjFBSUxZ}A$O-Qigeb|@v7piG_3L&0gw}JBMx`w9{_Rzb!T5KpU_H+hWMibIQJx6 z4mDhDUinnR{q`@+w}~DK*xOvbV97C}W z6{7;6cVxK9B25IoTQff+rwNtFi0_U9uK=LZYQ78C*uwM=7R&K+ZrQ}kg6Qs4 z0xtxr<`h*Lj`)v z@Q;5qq9P1*D!KMPNAo3Yi_3BxWd?2-Y4f_HpoQG2YYts~bSnOS$`NWJ;K%qc_?Lif zW!gy*<5+dh)|(!GTWW|~4<-2yFrFt2+jVdj22QlvAE4#mY*Du!*HovWX5VI*s4iRIiXRt|l9 zj#eHg9wSt5r5=bcH}am!t<8!*Xla)yerXw{Ok64(L#h26`?_ve5!r@RQ;@(6$F{WP z=q(jXz%XSfvZOICe>I?LG-%J1*JrYm)Hj;v_T{_B!MGX$JVy$H=W#e8Cx78}Sq(I{ zfocozxDk3nYg86jl@^5Ip{8RCNOi;~521X=enOr*gF_PP6?E<70X2o!T5<>%Oshx* z1hR28{-eMk!4>F%nSb{&CF%bHjUyiX_M4yKu~XR!jJD&t|7y6f{r779yT|tKum!T^ z3>$@`$F;}JDZA+u8FG2R!#a0^>-9Thg*A;CZHVb=ZrG53kt^EyFb4i`^IQ4b&x&`y za-BtdBGk^J-PeY&{Hx#W*%$t+4dU6}^~`b$j*pQEJli+uR+4mN63C4IP)rIYMlKyW zF-NTl7w^n<(uv){_c_Zae#4wJx0pEQF$!GW#_}t@51hYl<2i64LS2o0E2i_m`iK9y zYeFU>cvGRuD4M^;cPRGFX%k;~d09+`u(rLJbYBCOm30}BJrjydd1~fbL7|MNImJ^F z!+%M8L6e#f1&|ki&Epc*B>yEXNVLCvt{%q% z*+@hs49Zy1aQ-shQa0b*HlE3>alD3l_GE95scD-tOBaT(n!|$gAtOcLw(Sib@=*!v zzwMR`^e;~?t}D>XK zxoqqX*`B0OR(Qa!UD&~DsB5Ym{v6A8P`YGf`CmIX!+o5*B;%#55pNd4`24kx)Y`E~ zmxEYOaG7UEW%R6iXmvsQO?(rt#gnqHgI8PWiavhA+PGjN_sX5|2U(pR`CdG;gaCU- zkvkaOUCTN^BDDbSkH7zmw$=Q%bm5HoB{R>}{H1rDXcpoYm>6T|i^DN@!JTt9)Q*2d z+Pr1Hrt>#L1uw?v4UZ*S90G*;+(vs=%2(>fP*ZB*(P7#ac4{Lhp;Eu)cPL6e6t|Jc zz?sb%<5O~nEmLy=&!^$7@yLB$j9M$pNc|%tEFB%pjasaBNlC~9v*8{ZV*)}#F^>?| zYxI%g*G+J3Um)(LEh7UzttYr62j0qac@gFOUtHc(E&{tru9vS1A(S3`4EhqXCs~qx zr&uyj;6i&z7tiRtI!ax+uf6uM00O}s7x#3~)%5$sPjrwm zD+CY-$RhOU$=j5?dRcLuN~0?>oqIv(Y0`Xg$tTo9L~*QR8f*zm1wJ0vEOS6<-Dv3| z%11&QURBW(a-FIBSkn?zT7G2G%-XB<5V$*7_mrqQY_4aO$)#Nss=GX~m%5U-JPD`w zQsjsI{MQ|~9W;y(^sZRvc>0K1r_f$iP**Ye_S=CIj@USzlBJ|6=)ph=?yZe>c|?p@ zxzf;{6CCt>7npu<7ap^qWQ@0N`O!%`W_b7nEci@?Gr8f`vQJC9GmOPBNzfsGHn@e& zXS(0D;7+Q&X5$9Gi^X@@pJpo`SQ!&YI^563pc!n*f=pf#W-eUu&N7n-F zr1{Y+5CXp|kGdxt*r_}J;ffJ2R8aVF^5y8GGsrH?&fIT4e2e~Nv%BI!rQcWxHb*oQ z@X*<6y>SL*OY~y^r^hN_GI~KJEV|kr{G8euXN$E0R}g&})QJxo)vJFT>h`4=vh&$_ zF{g+(XTXm1Jalad&#JB21e<+9%M*EzHXc9PLEzxoA53E;sc%2s%r3+e0QZ)OgA`_E z-%z=^if!pI&cO!pd39{Ho^@Uk1!g)qk#*f_1Xh}vxRrgNqz4F=Wni`V&emG)7EX4PuJO6*kWxKkny_gc^PEMMPo3X*YA9Kf}vtyNI<|Ic!kav|gr zrM?X09}uVG%=hfhm9TtX)TWDThfXLqU$BN(bFV3fbxUQD&zyD!1P~DU$smNGl>CP1 z?Z#D${`W~wo}RnHGpu!j7ziqyvVN*mw|1MTZR2y4R;qNxP7nPp9RoDHhdwc$#nud& zc?z=QE<-gGmQlCFpsdK)AipxjV1XtJ#_A(s(JKUkdUQT$*~t9HUPHsrll0=`Gs!K^b$5tBdCuxbkgq_I zy$lvj6D>zSDiXS3?hd%ghHv)ay#k0eg< z$H1}4)cTIliSS7~8bS4dVL*UfucYIuFokDRj1p{b?1s&R&Y*K==4($CfNEhQDa5AS6>S*_ zr@;gJ7Zp7HN3QBPV2xtWx52v^%I|j6ZSB2AP;@M;8XPAKAyC{8FP?|rVvXrg zXC|q*+$m(J;1qoCRGRdtsee}f>_CiO!X^fE^uHrYeMz;%W@^Us9U7;ShIs#2Vl?Kr zzfthCV3WI^NZ&dGo|ZsIJ&u2xikG z7k3NO(=m!%^qQ0#!oz*X(#5EWbU0DpV@zKx-&%lM3yR65OxoFSZv=mV1(-HxQ6l5L zuF0$LTdVVjs?Bk-E|FC)Mk-SYy&C8!{EK)#Z6X*>L0+UKsP{BU&iRV5kW?*7ZT>hw z)b>V^h<}Z(vx-E{7wAfa^>n26Hf}$qHL)kN(UND_*y5gw=ay82cz<{2%l67*)7#9I zzy6p67Fel(^aXB3H3JJdYDg4zead^C_n0HU4Id{tW}?|w?dyX#hQ~p5@Iw7V_T!t( zZkZEUCWkDnJ%3Y-H9x(KJ3f7AnaL4}*cS}yj6`H5@J8sR0$nTmr?6r~-%m5#Fu*c54QO=9C6>DFzOoUG8eX z@o;!lO|IBk(G^)If2OB?{wAPUPY`F#x2wpdgN_+pjfNNW>c3JLE+tPzv^KRB{qnQn zB{q*!DQLHb;khHPVNSX=E-=ehs?3xU&VcJOS(M%U+poWo^E4jMIXBhaHAwZJ+pHj# zN%95WdIm)5hp=xzL05CDyZ+=_?e_yg(*THzf|nJ(z!X!tf`5oLMQ@8C=`H*?bvdpu z`D)2;N0x-h|M9Z5FckZ5OP&iTf~R}xJ4P%XuyVL82rtF)9F=wxcX6}(W@6g~oUCKq zTo0sln9*WB5e6HLGuUOXLoHgywvEM#Ibl_;Htag0CHa+C<`Fgz zjuP^H$#Jzve?@}k!WQ2e?0j4ZDZ@gm>sz9A>~?}Jm8mH~B%|80?+Cx@O%M8$5#MEl zVGkQ#hNkQTc7hy`++dJEMe1M=}#Be%}_=CwE{Uyi;oKjhk7n-kG4{&&JA2yN;}G>V61H`VrB z5nB6?RR)6QpY*^1%5M`-pBv*e>c0;Lp)F2;7rV+&K!mYb&(Uy#zXeJ*WauB=6Jm|W z_qXmzZU|k}%**?=@eKX2Kvj;Eqhw;TI=n1Q*Zqf>?D1}$G=2DYzCcN{9Q|Kmm4g49 z8E*WU86P%^A{(b)5$bm1pdTE(!;1qMGNNkHY2L~2{ehSns^Y6!ta<9ZjXgTL z0Bs*(I5+60Dd^O?#29Kyrln$@I-XYT`d0H#HdKbXg=(0uJ&80&DY=?G0E+_(xt>FRtku8tZy|=ZV2PomQOjs(IM%V*AL)x zdP3Zn?jl`iwOQvCROKDq|0{JzG(zEhKQB}|AFSE9fq$X&r;;EXcUSTde& zFP`BclBZwD9=DcJznFt1+Z+cB3|diC+XymhctsmTQW*fe(8-qm2jZuVqe~L zXgqU`@`qB`to&)v@4;xH$=r*juCh!&29waYPS;e6j|K4uxdm!LIO4Tl%9kP5aXImj zC7G)l{&%zCNk|r^v|^>zp?hkh3ae3gc*L*06#h!itMQAgbijJ+<)u+$(oL~z{cW_w zhAkrw^jf;tyN496&tPA%J%S$UoqE>?WdE+9{mD19&v!CUPm-)$VS^<3z-7338`~>< zx_FM!we1(?ld!#$1Rrx~nB44}!-@AaP#UL{vjgM~6ou7ZyynEl2%~oQq-V~ps_}=p zhui?Xyi_>Ud3s|zMgy~|ek$kpDe95aLf42o531V9^esYysXlLR%Cq0y(0mC~EfAmm z&W?j8?pu`ALtE0I&seaTyt3 z+d5ZmkNdUWStdWNRziqJC@-HQ!aE7w0c+e*e-jDt-qlW zN=bYFYhRjQNk>t3%3%5eM2NU`j*_q+T~quU{=_O#Z5~%mfuhN4m<>C8fXuyU;4cn{^L0<3V1Q!I`h74 zMi9MbKb%(%$DRY@#sQ&4IG>z=Fp;&2pGh@ut~T<+`h0SEaN=SdTuD3RQf^1qQ1l!* zXOg^gpi_L7ogFRtPN~{nc&(ga*f!6L1=e;KIOx9 zWAg8tz>BRo*x2fw=aD=ylZ`(d**~4`{jU659@oI_Zb-^K9YETvp|G7N=XQ?=MLY{& zR{mIncjp%N$nzf$AHmgrpD@`)^16tdmrg{lb=%pAre7g|2i6Q70%{lfmG_pvJEWdD zJ>Xhw1=}PwJo;$!X}{nS9tY$q)~ZBt532e&GI70fJ+G-Bt5>hSOIpy*EiAffN-H~a zHn2Hk^|$;G3nFy*+Ij{F;seI*pZ2u(P*kr0;F!{>Ri%n?APv>8)m;(oM6pCtc`kqE z#)((36D~XckLR}l79b-utGS*(wTr9=6?v90?#6;(sO!`fE9Y(+7VITiputiy;F^-% zAosM#vz6&OP@>h_4`~CtX4$WKhwuWN;^+!Gem3nQRCh&UAdPniE*0AxyIHx z`N!IXQ>{Ta=1O3|LAy`hL`@Syuixtb#zolBnS+J7Uc~kEE=jmS26rS~I_3A;JUt0J zvpz!i1VOp2eT*9Uhes|H$~q+Q2d&KPI#%S}J zu3-}z^^*maJDF<4`m8}gK6oV($O4;Zbx_dq>%>kSYk8E!s@S1eb1qDNQ^b#xyW z^g$G?9V*drwcJrU>9M(|O6sMP{hQCA3FRGEW&H1>Z}b}Hx3SiM@rCYU z#xEwlif6NQ;0nNccHZu9!k{r@@@Q-w-oCP|0Du)cQ7%z2e0%3--9Xw|v#VUZ%Ye{o zz3QF#{fD?>ad0!fd`yd?k#m%I3R&=#rhp3L8~w(o^r4pJu6DU3ko=s2uqiFu%DBb* z!5^gG0CMmqN^kbM%)Br%~%g7tWUIbytj7)u$sY#gfo%Y({>3ahRJc2IZ7t z&8Q_C8YL3*qVHfc)Bt4{aA*^9UIA~5^<`DG-$rU^^uNSdHY@qC)>1)soG@|Zkzn3p z!NONnH?MrI`@&v6;q3y5$K4sh#=KDoLm-I5r)Ea2|avu3$Es+;5NmQj7B6StZHZ*c)tjgKwHU@ z#Dy;dJGE|o@$R3WbOXwe`{`1EH6wT7DLznia9zl6G-^jA%j^-@$OX@#>DQgiWh&*y zaV#qNYun4ZrFK$s&1v;A;mI2sU76%OIT>0#%&b1h-6l+Ryo3HuS6fq7uWpIF?mhDq zz)d^z)eNi9mtAqv46tObOvBKmTTpb)m+2|vlJ<Fk<0UFyCk z+9OK8=za5;K&~{m@jK<$8)W~`76;f1nRA3ux(6F-G12$IZ#_{ueMm>f3B^!u@S_t6sz&Vp@+3wI%kmy6KIP)) z0wE6xl+baysXXERDu5v1D^3bJ*wOh~SRY#>u{|z}U>sgb+kX`OW&SxCWre@usU~BI z)zxM}O=1m8aJ2^PdE?sO5V687^KdGi%SCGnZe~y}{AIMHT+mw+%UG?Q;x;g%H^BUH zscfG;ZZz7+;FiEwr?gEl$mqc<_M9LNQ`R*7Y(;Y;i8osXQY2nwuQUp}AH;O4AHXK| z#u9a(WOz&~o-%mSALm~ImBMpdV4?tIowEnAiF^vrWaTW5>}Yu9a$|Di0%^Dad6|q} z1ur1|txz;ih+SVtXDwOhfV{r=(WUB&KOcPzJln8T22))j#7s^w+#h}sa&=fw`RF|F za3fI7NJ>*_)|KIz?mFbLHt62)TPW>@XT`D( zVX8Z2#TiR8`bglk3*tBe`d@Zh2w-*6R`fL|(6V-ak{wA%#dWP%MSjj|!KkO*+D~_( zC_lq7F(uwdNHds25w<8;;u*O#C1yY>jeEbk$UP#K3Gq8=MFZ^m7~a{E(x`CrkcrR= z4lvSxIPwT#4~!gAL@Ly&N3zcN-zm_vmU$Lrm+zFxe=Sg_srz4XOrf*z=X1jMS~erU zG4c8cB22Wk>#YrOi#@q;o;5!oEUB3P6=Q~$G^ga|^vigU{e^}>V|VeXx&aNrR{pUV z#w7uMiM4SQjZ(H!whKhyG;MjX-?2(HW67d#b+K5}ou<<$oF;iU_ zB-U@Qs{g52+LlO)aKlU1nE;q(%@gueR`T@!ZjThsEKkrQ;adIQ*Z z0c)5$Ad@(D=IH>Ar~{4uB0!rtlZRU;*rvJ`%`8~Jm|l;gdWk7ga`jCQ!0P;wq|^4O zMgNXA#BtlqMo5B&|jm_z*DG}#^o`B!3VJ2U#;Fha*j2GGG7`fQoJ#_wo;PLNejk1a4zLXsDn zqx>8jq14^P@o$rB>*I0h*%z-5BxUT>Xdm#&XG(u}V}b;u=WG~QshyFP>E#`t27EZA4FbWR+D7cR*rtm?WF?91j`I%8 zKaGV~PpS6(>PzK|gu?*Ks83AXbPllNEa#-kR@gyP1+|YDF;Ib5Tt*Zo$jjJ$FLpqr z%y2DwyEQ2`@kXSD;IP&U=aWJ|cXrxvE2q$(P8BkQ?Rue?j>JNn>wuD4DjGd0w%0?^ zWww69nK?tYe)vP$MKg|v)VKj&1YK#jS$XSB0hvH@W^;Sq?7QIbdCE{sqwv(i&CA$f zjO=z6w0$-cAOw{6u$~H)w8X@J{fFDn@q9Rn1%{`k z+cjWrFze5m^rLOUEUJ?urNQj|+|GzZWUJMyGuMk9PC|_xy{Q4C)R?a$?NAME#aooH znocAlgZoFxJK#?e*Q!7t&U`OxojM(eOk1hXauyG3@nim~nmp%!m3?;zH8 zJVa0pgQ~#Gw^V1yt7T$;@Ns?;qa!Y4Piqs_-Qho(L_gv#`8HMQ;2jXmu8s)qs9!h$ zR_5veah4^E<<2i6$1N$2H}LNNML#4n=n(cxIY9|2?F%R(ZS~vMp4|YTp-meZoMfn8 zJe0aG+Pa5wU?%VWDX(XG-r?qYlgu;TKdO!u`fKluS<6&#D-X))q>R=Z2SiU<-V~y$ zga~`s*=P8&9IVBUD`lB-#|?Y<4Y5#FMRK?^Z5#7 zEiyftVVBV9psrkdJ3MpNdPd`UnsYrZdTC&p4N$9kA6U2YNl~AY>I$qi?8Nu7HiKRY znYR}Rfhg9mEcoeHnFN!l(T!||-pWIDHxrPFayds=%eh-o%+WGU0X724&!G50p!*ds z(Ik!k^bI;bKil+Kr|KdK5@PF64xt)TMaT(-NXg`e2c)$>_rH878jPBttIBjXvfzKh zc`^O0MNLPo3D1&z2TysUsNZhm7CLPbR+|!UbA5Q3Y&6Ghxtrsjq0YChcNI4=V>FE?K&eZZ}CDkJSR)y+G}Uj}&L;tq)je6sM@^WN`v1Dy|zh`^x&zqP%=V86q% zx;}XLr`jb%@grtI!-$rf$$Qglag$Va;o@3g>R=ihfA~^Z1N4MWm5TpUKOEZ&!d@$W z9GNO3MR6IK2P$_-%N`(_I=@i`Mvh&lj@S{3qKSFvW#b}7}X&5f{ z_*{!9q#lm3Z%^obR~onhRQv41`1&WOVQ4ZJu8b$TBnxbDG0tpo?pb%GM_yN zcF`pL0YeI(pC+SVT!H<=NC%BD5#TTWmHQ;1E>uW@74{?>mm6dD97g~E08xSqyQ~-v c82|y3j{?Nq2bE7u{jtPn`vL#}000D8S|W-WfB*mh literal 0 HcmV?d00001 diff --git a/kernel/kernel/files/patches/mageia/3rd-3rdparty-1.0-tree.patch b/kernel/kernel/files/patches/mageia/3rd-3rdparty-1.0-tree.patch deleted file mode 100644 index 233389b4..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-3rdparty-1.0-tree.patch +++ /dev/null @@ -1,181 +0,0 @@ - - 3rdparty/mkbuild.pl | 92 +++++++++++++++++++++++++++++++++++++++++++++ - Documentation/3rdparty.txt | 76 +++++++++++++++++++++++++++++++++++++ - 2 files changed, 168 insertions(+) - -diff -Nurp linux-2.6.37/3rdparty/mkbuild.pl linux-2.6.37.3rdparty/3rdparty/mkbuild.pl ---- linux-2.6.37/3rdparty/mkbuild.pl 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/mkbuild.pl 2004-04-23 14:59:03.000000000 +0300 -@@ -0,0 +1,92 @@ -+#!/usr/bin/perl -w -+# -+# Version 1.0 -+# -+# Copyright 2001 Jeff Garzik -+# Copyright 2002 Juan Quintela -+# Copyright 2003 Nicolas Planel -+# -+# This software may be used and distributed according to the terms -+# of the GNU General Public License, incorporated herein by reference. -+# -+# -+# Run "mkbuild.pl" -+# -+# This program generates the following files -+# Makefile -+# Makefile.drivers -+# Config.in -+# using the information in the subdirs of this directory. -+# -+# subdirs need to have: -+# a Config.in file -+# a Makefile with a O_TARGET/L_TARGET targets -+# The config.in should set a CONFIG_ to m/y. -+ -+use strict; -+ -+opendir(THISDIR, "."); -+# get dirs without . and .. garbage -+my (@modules) = grep(!/\.\.?$/,grep(-d, readdir(THISDIR))); -+closedir(THISDIR); -+ -+generate_kconfig(@modules); -+generate_makefile(@modules); -+exit(0); -+ -+########################################################################## -+ -+sub generate_makefile { -+ my (@modules) = @_; -+ -+ local *F; -+ open F, "> Makefile" or die "Cannot create new Makefile: $!\n"; -+ print F <<'EOM'; -+# -+# THIS IS AN AUTOMATICALLY GENERATED FILE. DO NOT EDIT. -+# -+ -+EOM -+ printf F "obj- := 3rdparty.o # Dummy rule to force built-in.o to be made\n"; -+ printf F "obj-\$(%s) += %s\n", to_CONFIG($_), $_ . '/' foreach @modules; -+} -+ -+sub generate_kconfig { -+ my (@modules) = @_; -+ -+ local *F; -+ open F, "> Kconfig" or die "Cannot create Kconfig: $!\n"; -+ print F <<"EOM"; -+# -+# THIS IS AN AUTOMATICALLY GENERATED FILE. DO NOT EDIT. -+# -+ -+menu "Unofficial 3rd party kernel additions" -+ -+EOM -+ -+ foreach (@modules) { -+ die "No Kconfig in $_.\n" if ! -r "$_/Kconfig"; -+ print F "source 3rdparty/$_/Kconfig\n"; -+ } -+ print F "\n\nendmenu\n"; -+} -+ -+sub to_CONFIG { -+ local $_ = $_[0]; -+ tr/a-z/A-Z/; -+ s/[\-\. ]/_/g; -+ "CONFIG_$_"; -+} -+ -+sub find_target { -+ my ($module_dir) = @_; -+ -+ local *F; -+ open(F, "$module_dir/Makefile") or die "$module_dir/Makefile: $!\n"; -+ while () { -+ chomp; -+ return $1 if (/[LO]_TARGET.*:=\s+(\S+)/); -+ } -+} -+ -diff -Nurp linux-2.6.37/Documentation/3rdparty.txt linux-2.6.37.3rdparty/Documentation/3rdparty.txt ---- linux-2.6.37/Documentation/3rdparty.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/Documentation/3rdparty.txt 2003-11-22 01:07:26.000000000 +0200 -@@ -0,0 +1,76 @@ -+ -+Third-Party Kernel Source Module Support, or -+an easy way to add modules to your kernel build. -+ -+ -+ -+Vendors quite often add additional drivers and features to the kernel -+which require nothing more than modifying Kconfig, Makefile, and -+adding one or more files to a sub-directory. As a single discrete task, -+this is not a problem. However, using patches to add modules to the -+kernel very often results in patch conflicts, resulting in needless time -+wastage as developers regenerate an otherwise working kernel patch. -+ -+This is designed as a solution to these problems. It is NOT designed as -+a replacement for the kernel build system, but merely as a tool for -+vendors and system administrators to ease the pain of patch management. -+ -+The key feature of this system is the distinct lack of patches. Drivers -+are installed via unpacking a tarball. -+ -+ -+ -+Adding a directory to the build (usually from a tarball) -+-------------------------------------------------------- -+If a directory exists inside the 3rdparty sub-directory that contains a -+proper Makefile, it can be added to the build. It also needs a -+Kconfig file. -+ -+ cd /usr/src/linux-2.4.3/3rdparty -+ bzcat /tmp/my-driver2.tar.bz2 | tar xf - # creates "my2" dir -+ -+ -+Limitations -+----------- -+There are some limitations to this system. This system is only -+designed to support a very common case. If you find yourself running -+into limitations (kernel build experts can spot them right off), -+then you should probably be patching the kernel instead of using -+mkbuild.pl for that particular module. -+ -+FIXME: actually list the limitations -+ -+ -+ -+Other notes -+----------- -+Link order is controlled by the order of mkbuild.pl executions. -+ -+"make mrproper" will erase Makefile.meta, and empty Kconfig, Makefile, -+and Makefile.drivers. -+ -+IMPORTANT NOTE: Because this feature modifies the kernel's makefiles and -+configuration system, you MUST complete all mkbuild.pl runs before -+running any "make" command. -+ -+Building in the 3rdparty dir -+---------------------------- -+ -+If you use modules that: -+ - are contained in one subdir with the name of the module -+ - has a Makefile -+ - has a Kconfig file -+ -+The system calls the ./mkbuild.pl script. It will search for -+subdirectories, and will try to build each of them as a module. -+Things to note: -+ -+ The dependencies will be done in a module called: -+ -+ 3rdparty// -+ -+depending of CONFIG_. -+ -+ is the value of O_TARGET/L_TARGET. -+ -+ diff --git a/kernel/kernel/files/patches/mageia/3rd-3rdparty-merge.patch b/kernel/kernel/files/patches/mageia/3rd-3rdparty-merge.patch deleted file mode 100644 index 35bab76a..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-3rdparty-merge.patch +++ /dev/null @@ -1,191 +0,0 @@ - -Include 3rdparty directory into the main build-system. - -Original author is unknown. -(Was either Juan Quintela or Jeff Garzik) - -Signed-off-by: Luiz Fernando N. Capitulino -Signed-off-by: Herton Ronaldo Krzesinski -Signed-off-by: Thomas Backlund - - Makefile | 2 +- - arch/alpha/Kconfig | 1 + - arch/ia64/Kconfig | 2 ++ - arch/mips/Kconfig | 2 ++ - arch/powerpc/Kconfig | 2 ++ - arch/sparc/Kconfig | 2 ++ - arch/x86/Kconfig | 2 ++ - scripts/kconfig/Makefile | 33 ++++++++++++++++++--------------- - 8 files changed, 30 insertions(+), 16 deletions(-) - -diff -Nurp linux-4.2.2/arch/alpha/Kconfig linux-4.2.2-3rd/arch/alpha/Kconfig ---- linux-4.2.2/arch/alpha/Kconfig 2015-08-30 21:34:09.000000000 +0300 -+++ linux-4.2.2-3rd/arch/alpha/Kconfig 2015-09-29 23:02:44.024347272 +0300 -@@ -750,3 +750,4 @@ source "crypto/Kconfig" - - source "lib/Kconfig" - -+source "3rdparty/Kconfig" -diff -Nurp linux-4.2.2/arch/ia64/Kconfig linux-4.2.2-3rd/arch/ia64/Kconfig ---- linux-4.2.2/arch/ia64/Kconfig 2015-08-30 21:34:09.000000000 +0300 -+++ linux-4.2.2-3rd/arch/ia64/Kconfig 2015-09-29 23:02:44.024347272 +0300 -@@ -613,3 +613,5 @@ source "lib/Kconfig" - - config IOMMU_HELPER - def_bool (IA64_HP_ZX1 || IA64_HP_ZX1_SWIOTLB || IA64_GENERIC || SWIOTLB) -+ -+source "3rdparty/Kconfig" -diff -Nurp linux-4.2.2/arch/mips/Kconfig linux-4.2.2-3rd/arch/mips/Kconfig ---- linux-4.2.2/arch/mips/Kconfig 2015-08-30 21:34:09.000000000 +0300 -+++ linux-4.2.2-3rd/arch/mips/Kconfig 2015-09-29 23:02:44.024347272 +0300 -@@ -2944,3 +2944,5 @@ source "crypto/Kconfig" - source "lib/Kconfig" - - source "arch/mips/kvm/Kconfig" -+ -+source "3rdparty/Kconfig" -diff -Nurp linux-4.2.2/arch/powerpc/Kconfig linux-4.2.2-3rd/arch/powerpc/Kconfig ---- linux-4.2.2/arch/powerpc/Kconfig 2015-08-30 21:34:09.000000000 +0300 -+++ linux-4.2.2-3rd/arch/powerpc/Kconfig 2015-09-29 23:02:44.025347276 +0300 -@@ -1112,3 +1112,5 @@ config PPC_LIB_RHEAP - source "arch/powerpc/kvm/Kconfig" - - source "kernel/livepatch/Kconfig" -+ -+source "3rdparty/Kconfig" -diff -Nurp linux-4.2.2/arch/sparc/Kconfig linux-4.2.2-3rd/arch/sparc/Kconfig ---- linux-4.2.2/arch/sparc/Kconfig 2015-08-30 21:34:09.000000000 +0300 -+++ linux-4.2.2-3rd/arch/sparc/Kconfig 2015-09-29 23:02:44.025347276 +0300 -@@ -569,3 +569,5 @@ source "security/Kconfig" - source "crypto/Kconfig" - - source "lib/Kconfig" -+ -+source "3rdparty/Kconfig" -diff -Nurp linux-4.2.2/arch/x86/Kconfig linux-4.2.2-3rd/arch/x86/Kconfig ---- linux-4.2.2/arch/x86/Kconfig 2015-08-30 21:34:09.000000000 +0300 -+++ linux-4.2.2-3rd/arch/x86/Kconfig 2015-09-29 23:02:44.025347276 +0300 -@@ -2601,3 +2601,5 @@ source "crypto/Kconfig" - source "arch/x86/kvm/Kconfig" - - source "lib/Kconfig" -+ -+source "3rdparty/Kconfig" -diff -Nurp linux-4.2.2/Makefile linux-4.2.2-3rd/Makefile ---- linux-4.2.2/Makefile 2015-09-29 22:13:44.743650710 +0300 -+++ linux-4.2.2-3rd/Makefile 2015-09-29 23:02:44.026347280 +0300 -@@ -546,7 +546,7 @@ scripts: scripts_basic include/config/au - - # Objects we will link into vmlinux / subdirs we need to visit - init-y := init/ --drivers-y := drivers/ sound/ firmware/ -+drivers-y := drivers/ sound/ firmware/ 3rdparty/ - net-y := net/ - libs-y := lib/ - core-y := usr/ -diff -Nurp linux-4.14/scripts/kconfig/Makefile linux-4.14-3rd/scripts/kconfig/Makefile ---- linux-4.14/scripts/kconfig/Makefile -+++ linux-4.14-3rd/scripts/kconfig/Makefile -@@ -19,28 +19,28 @@ endif - # We need this, in case the user has it in its environment - unexport CONFIG_ - --xconfig: $(obj)/qconf -+xconfig: $(obj)/qconf 3rdparty/Makefile - $< $(silent) $(Kconfig) - --gconfig: $(obj)/gconf -+gconfig: $(obj)/gconf 3rdparty/Makefile - $< $(silent) $(Kconfig) - --menuconfig: $(obj)/mconf -+menuconfig: $(obj)/mconf 3rdparty/Makefile - $< $(silent) $(Kconfig) - --config: $(obj)/conf -+config: $(obj)/conf 3rdparty/Makefile - $< $(silent) --oldaskconfig $(Kconfig) - --nconfig: $(obj)/nconf -+nconfig: $(obj)/nconf 3rdparty/Makefile - $< $(silent) $(Kconfig) - --silentoldconfig: $(obj)/conf -+silentoldconfig: $(obj)/conf 3rdparty/Makefile - $(Q)mkdir -p include/config include/generated - $(Q)test -e include/generated/autoksyms.h || \ - touch include/generated/autoksyms.h - $< $(silent) --$@ $(Kconfig) - --localyesconfig localmodconfig: $(obj)/streamline_config.pl $(obj)/conf -+localyesconfig localmodconfig: $(obj)/streamline_config.pl $(obj)/conf 3rdparty/Makefile - $(Q)mkdir -p include/config include/generated - $(Q)perl $< --$@ $(srctree) $(Kconfig) > .tmp.config - $(Q)if [ -f .config ]; then \ -@@ -83,7 +83,7 @@ simple-targets := oldconfig allnoconfig - alldefconfig randconfig listnewconfig olddefconfig - PHONY += $(simple-targets) - --$(simple-targets): $(obj)/conf -+$(simple-targets): $(obj)/conf 3rdparty/Makefile - $< $(silent) --$@ $(Kconfig) - - PHONY += oldnoconfig savedefconfig defconfig -@@ -91,12 +91,12 @@ PHONY += oldnoconfig savedefconfig defco - # oldnoconfig is an alias of olddefconfig, because people already are dependent - # on its behavior (sets new symbols to their default value but not 'n') with the - # counter-intuitive name. --oldnoconfig: olddefconfig -+oldnoconfig: olddefconfig 3rdparty/Makefile - --savedefconfig: $(obj)/conf -+savedefconfig: $(obj)/conf 3rdparty/Makefile - $< $(silent) --$@=defconfig $(Kconfig) - --defconfig: $(obj)/conf -+defconfig: $(obj)/conf 3rdparty/Makefile - ifeq ($(KBUILD_DEFCONFIG),) - $< $(silent) --defconfig $(Kconfig) - else -@@ -109,26 +109,26 @@ else - endif - endif - --%_defconfig: $(obj)/conf -+%_defconfig: $(obj)/conf 3rdparty/Makefile - $(Q)$< $(silent) --defconfig=arch/$(SRCARCH)/configs/$@ $(Kconfig) - - configfiles=$(wildcard $(srctree)/kernel/configs/$@ $(srctree)/arch/$(SRCARCH)/configs/$@) - --%.config: $(obj)/conf -+%.config: $(obj)/conf 3rdparty/Makefile - $(if $(call configfiles),, $(error No configuration exists for this target on this architecture)) - $(Q)$(CONFIG_SHELL) $(srctree)/scripts/kconfig/merge_config.sh -m .config $(configfiles) - +$(Q)yes "" | $(MAKE) -f $(srctree)/Makefile oldconfig - - PHONY += kvmconfig --kvmconfig: kvm_guest.config -+kvmconfig: kvm_guest.config 3rdparty/Makefile - @: - - PHONY += xenconfig --xenconfig: xen.config -+xenconfig: xen.config 3rdparty/Makefile - @: - - PHONY += tinyconfig --tinyconfig: -+tinyconfig: - $(Q)$(MAKE) -f $(srctree)/Makefile allnoconfig tiny.config - - # Help text used by make help -@@ -191,6 +191,9 @@ gconf-objs := gconf.o zconf.tab.o - - hostprogs-y := conf nconf mconf kxgettext qconf gconf - -+3rdparty/Makefile: -+ pushd $(srctree)/3rdparty ; $(PERL) ./mkbuild.pl ; popd -+ - clean-files := qconf.moc .tmp_qtcheck .tmp_gtkcheck - clean-files += zconf.tab.c zconf.lex.c gconf.glade.h - clean-files += config.pot linux.pot diff --git a/kernel/kernel/files/patches/mageia/3rd-acerhk-0.5.35.patch b/kernel/kernel/files/patches/mageia/3rd-acerhk-0.5.35.patch deleted file mode 100644 index 5d61570f..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-acerhk-0.5.35.patch +++ /dev/null @@ -1,4212 +0,0 @@ - 3rdparty/acerhk/AUTHORS | 1 - 3rdparty/acerhk/COPYING | 340 ++++ - 3rdparty/acerhk/INSTALL | 109 + - 3rdparty/acerhk/Makefile | 65 - 3rdparty/acerhk/NEWS | 16 - 3rdparty/acerhk/README | 215 ++ - 3rdparty/acerhk/acerhk.c | 2999 ++++++++++++++++++++++++++++++++++++++++ - 3rdparty/acerhk/acerhk.h | 91 + - 3rdparty/acerhk/doc/FAQ | 150 ++ - 3rdparty/acerhk/doc/IOCTL | 61 - 3rdparty/acerhk/doc/acertm.def | 56 - 3rdparty/acerhk/doc/keycodes | 26 - 3rdparty/acerhk/doc/md95400.def | 14 - 13 files changed, 4143 insertions(+) -diff -Nurp linux-2.6.37/3rdparty/acerhk/acerhk.c linux-2.6.37.3rdparty/3rdparty/acerhk/acerhk.c ---- linux-2.6.37/3rdparty/acerhk/acerhk.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/acerhk.c 2007-02-10 17:46:23.000000000 +0200 -@@ -0,0 +1,2999 @@ -+/********************************************************************* -+ * Filename: acerhk.c -+ * Version: 0.5 -+ * -+ * Copyright (C) 2002-2006, Olaf Tauber (olaf-tauber@versanet.de) -+ * -+ * Description: kernel driver for Acer Travelmate and similar -+ * laptops special keys -+ * Author: Olaf Tauber -+ * Created at: Mon Apr 29 22:16:42 2002 -+ * Modified at: Mon Oct 16 21:36:44 2006 -+ * Modified by: Olaf Tauber -+ * Modified at: Thu Nov 24 13:03:01 2005 -+ * Modified by: Antonio Cuni -+ * Modified at: Wed Oct 27 19:47:11 CEST 2004 -+ * Modified by: Joachim Fenkes -+ * -+ * This program is free software; you can redistribute -+ * it and/or modify it under the terms of the GNU General -+ * Public License as published by the Free Software -+ * Foundation; either version 2 of the License, or (at your -+ * option) any later version. -+ * -+ * This program is distributed in the hope that it will be -+ * useful, but WITHOUT ANY WARRANTY; without even the implied -+ * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR -+ * PURPOSE. See the GNU General Public License for more -+ * details. -+ * -+ * You should have received a copy of the GNU General Public -+ * License along with this program; if not, write to the -+ * Free Software Foundation, Inc., 59 Temple Place, -+ * Suite 330, Boston, MA 02111-1307 USA -+ * -+ * -+ */ -+ -+#ifndef AUTOCONF_INCLUDED -+#include -+#endif -+ -+/* This driver is heavily dependent on the architecture, don't let -+ * anyone without an X86 machine use it. On laptops with AMD64 -+ * architecture this driver is only useable in 32 bit mode. -+ */ -+#ifdef CONFIG_X86 -+ -+#include -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0) -+#define KERNEL26 -+#include -+#else -+#include -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,15) -+#define STATIC_INPUT_DEV -+#endif -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "acerhk.h" -+ -+/* #define ACERDEBUG */ -+/* #define DUMMYHW */ -+ -+#define ACERHK_VERSION "0.5.35" -+#define MODULE_NAME "acerhk" -+ -+/* maximum number of polling loops, adjust it if needed to values between -+ * 1 and 32 -+ */ -+#define MAX_POLLING_LOOPS 16U -+ -+/* maximum length for model string */ -+#define ACERHK_MODEL_STRLEN 16 -+/* size of mapped areas */ -+#define AREA_SIZE 0xffff -+/* needed for colussi algorithm */ -+#define XSIZE 20 -+ -+/* Module parameters */ -+static int poll=1; -+static int autowlan; -+static int usedritek=1; -+static int wlan_state=-1; -+static int bluetooth_state=-1; -+static int verbose; -+static unsigned int force_series; -+#ifdef KERNEL26 -+module_param(poll, int, 0444); -+module_param(autowlan, int, 0444); -+module_param(usedritek, int, 0444); -+module_param(verbose, int, 0444); -+module_param(wlan_state, int, 0444); -+module_param(bluetooth_state, int, 0444); -+module_param(force_series, uint, 0444); -+#else -+MODULE_PARM(poll, "i"); -+MODULE_PARM(autowlan, "i"); -+MODULE_PARM(wlan_state, "i"); -+MODULE_PARM(bluetooth_state, "i"); -+MODULE_PARM(usedritek, "i"); -+MODULE_PARM(verbose, "i"); -+MODULE_PARM(force_series, "i"); -+#endif -+MODULE_PARM_DESC(poll, "start polling timer"); -+MODULE_PARM_DESC(autowlan, "automatic switching of wlan hardware"); -+MODULE_PARM_DESC(wlan_state, "(assumed) initial state of WLAN LED/hardware"); -+MODULE_PARM_DESC(bluetooth_state, "(assumed) initial state of Bluetooth LED/hardware"); -+MODULE_PARM_DESC(usedritek, "enable dritek keyboard extension"); -+MODULE_PARM_DESC(verbose, "output additional information"); -+MODULE_PARM_DESC(force_series, "force laptop series, skip autodetection"); -+ -+/* input device */ -+static struct input_dev *acerhk_input_dev_ptr; -+#ifdef STATIC_INPUT_DEV -+static struct input_dev acerhk_input_dev; -+#endif -+ -+/* mapped IO area from 0xf0000 */ -+static void *reg1; -+/* mapped IO area from 0xe0000 */ -+static void *reg2; -+/* Pointer to mapped area at 0x400 on 520 series */ -+static void *preg400; -+/* location of IO routine in mapped area */ -+static unsigned int bios_routine; -+/* index of CMOS port to get key event */ -+static unsigned int cmos_index; -+/* function for bios call */ -+static bios_call call_bios; -+/* address of model string */ -+static char *acerhk_model_addr; -+/* copied string, maximum length 16 ('TravelMate xxx') */ -+static char acerhk_model_string[ACERHK_MODEL_STRLEN]; -+/* type of hardware access */ -+static t_acer_type acerhk_type; -+/* travelmate series */ -+static unsigned int acerhk_series; -+/* supported features for this model */ -+static unsigned int acerhk_model_features; -+/* map of acer key codes to acer key names */ -+static unsigned char acerhk_key2name[0xff]; -+/* map of acer key names to key events */ -+static t_map_name2event acerhk_name2event; -+/* timer for polling key presses */ -+static struct timer_list acerhk_timer_poll; -+/* polling active */ -+static int acerhk_polling_state; -+/* polling delay */ -+static unsigned acerhk_polling_delay = HZ/5; -+/* wlan hardware toggle */ -+static int acerhk_wlan_state; -+/* bluetooth hardware toggle */ -+static int acerhk_bluetooth_state; -+ -+/* bluetooth blinking state; added by Antonio Cuni -+ possible values: -+ -1: blinking disabled (default) -+ 0: blinking enabled, led currently off -+ 1: blinking enabled, led currently on -+*/ -+static int acerhk_blueled_blinking = -1; -+/* delay between two changes of state, in jiffies */ -+static unsigned acerhk_blueled_blinking_delay; -+/* timer for blinking */ -+static struct timer_list acerhk_timer_blinking; -+ -+/* function prototypes */ -+static void start_polling(void); -+static void stop_polling(void); -+ -+/* Added by Antonio Cuni */ -+static void start_blinking(void); -+static void stop_blinking(void); -+ -+/* {{{ Experimental use of dritek keyboard extension */ -+ -+#define EC_STATUS_REG 0x66 /* Status register of EC (R) */ -+#define EC_CNTL_REG 0x66 /* Controller command register of EC (W) */ -+#define EC_DATA_REG 0x62 /* EC data register (R/W) */ -+ -+#ifdef KERNEL26 -+ -+#include -+ -+#define KBD_STATUS_REG 0x64 /* Status register (R) */ -+#define KBD_CNTL_REG 0x64 /* Controller command register (W) */ -+#define KBD_DATA_REG 0x60 /* Keyboard data register (R/W) */ -+ -+#else -+ -+#ifndef KEY_MEDIA -+#define KEY_MEDIA 226 -+#endif -+ -+#define preempt_disable() do { } while (0) -+#define preempt_enable_no_resched() do { } while (0) -+#define preempt_enable() do { } while (0) -+#define preempt_check_resched() do { } while (0) -+#include -+ -+#endif -+ -+static inline int my_i8042_read_status(void) -+{ -+ return inb(KBD_STATUS_REG); -+} -+static int my_i8042_wait_write(void) -+{ -+ int i = 0; -+ while ((my_i8042_read_status() & 0x02) && (i < 10000)) { -+ udelay(50); -+ i++; -+ } -+ return -(i == 10000); -+} -+static void send_kbd_cmd(unsigned char cmd, unsigned char val) -+{ -+ if (usedritek) { -+ preempt_disable(); -+ if (!my_i8042_wait_write()) -+ outb(cmd, KBD_CNTL_REG); -+ if (!my_i8042_wait_write()) -+ outb(val, KBD_DATA_REG); -+ preempt_enable_no_resched(); -+ } else { -+ printk(KERN_INFO"acerhk: request for accessing EC ignored\n" -+ KERN_INFO"acerhk: Use of dritek keyboard extension not enabled, use module\n" -+ KERN_INFO"acerhk: parameter usedritek=1 to do that (possibly dangerous)\n"); -+ } -+} -+#ifdef ACERDEBUG -+static inline int my_i8042_read_ecstatus(void) -+{ -+ return inb(EC_STATUS_REG); -+} -+static int my_i8042_wait_ecwrite(void) -+{ -+ int i = 0; -+ while ((my_i8042_read_ecstatus() & 0x02) && (i < 10000)) { -+ udelay(50); -+ i++; -+ } -+ return -(i == 10000); -+} -+static void send_ec_cmd(unsigned char cmd, unsigned char val) -+{ -+ if (usedritek) { -+ preempt_disable(); -+ if (!my_i8042_wait_ecwrite()) -+ outb(cmd, EC_CNTL_REG); -+ if (!my_i8042_wait_ecwrite()) -+ outb(val, EC_DATA_REG); -+ preempt_enable_no_resched(); -+ } else { -+ printk(KERN_INFO"acerhk: request for accessing EC ignored\n" -+ KERN_INFO"acerhk: Use of dritek keyboard extension not enabled, use module\n" -+ KERN_INFO"acerhk: parameter usedritek=1 to do that (possibly dangerous)\n"); -+ } -+} -+#endif -+#ifdef ACERDEBUG -+static void enable_mute_led_ec(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: enabling mute led via EC\n"); -+ send_kbd_cmd(0x59, 0x94); -+} -+static void disable_mute_led_ec(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: disabling mute led via EC\n"); -+ send_kbd_cmd(0x59, 0x95); -+} -+static void enable_dmm_function(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: enabling WLAN via EC variant 2\n"); -+ send_kbd_cmd(0x45, 0xd3); -+} -+#endif -+static void enable_wlan_ec_1(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: enabling WLAN via EC variant 1\n"); -+ send_kbd_cmd(0xe7, 0x01); -+ acerhk_wlan_state = 1; -+} -+static void disable_wlan_ec_1(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: disabling WLAN via EC variant 1\n"); -+ send_kbd_cmd(0xe7, 0x00); -+ acerhk_wlan_state = 0; -+} -+static void enable_bluetooth_ec_1(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: enabling Bluetooth via EC variant 1\n"); -+ send_kbd_cmd(0xe7, 0x03); -+ acerhk_bluetooth_state = 1; -+} -+static void disable_bluetooth_ec_1(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: disabling Bluetooth via EC variant 1\n"); -+ send_kbd_cmd(0xe7, 0x02); -+ acerhk_bluetooth_state = 0; -+} -+static void enable_wlan_ec_2(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: enabling WLAN via EC variant 2\n"); -+ send_kbd_cmd(0x45, acerhk_bluetooth_state ? 0xa2 : 0xa0); -+ acerhk_wlan_state = 1; -+} -+static void disable_wlan_ec_2(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: disabling WLAN via EC variant 2\n"); -+ send_kbd_cmd(0x45, acerhk_bluetooth_state ? 0xa1 : 0xa3); -+ acerhk_wlan_state = 0; -+} -+static void enable_bluetooth_ec_2(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: enabling Bluetooth via EC variant 2\n"); -+ send_kbd_cmd(0x45, acerhk_wlan_state ? 0xa2 : 0xa1); -+ acerhk_bluetooth_state = 1; -+} -+static void disable_bluetooth_ec_2(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: disabling Bluetooth via EC variant 2\n"); -+ send_kbd_cmd(0x45, acerhk_wlan_state ? 0xa0 : 0xa3); -+ acerhk_bluetooth_state = 0; -+} -+#ifdef ACERDEBUG -+static void enable_wireless_ec(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: enabling wireless hardware\n"); -+ if (usedritek) { -+ preempt_disable(); -+ if (!my_i8042_wait_ecwrite()) -+ outb(0x4d, EC_CNTL_REG); -+ if (!my_i8042_wait_ecwrite()) -+ outb(0xd2, EC_DATA_REG); -+ if (!my_i8042_wait_ecwrite()) -+ outb(0x01, EC_DATA_REG); -+ preempt_enable_no_resched(); -+ } -+ acerhk_wlan_state = 1; -+} -+static void disable_wireless_ec(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: disabling wireless hardware\n"); -+ if (usedritek) { -+ preempt_disable(); -+ if (!my_i8042_wait_ecwrite()) -+ outb(0x4d, EC_CNTL_REG); -+ if (!my_i8042_wait_ecwrite()) -+ outb(0xd2, EC_DATA_REG); -+ if (!my_i8042_wait_ecwrite()) -+ outb(0x00, EC_DATA_REG); -+ preempt_enable_no_resched(); -+ } -+ acerhk_wlan_state = 0; -+} -+#endif -+static void enable_dritek_keyboard(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: enabling dritek keyboard extension\n"); -+ send_kbd_cmd(0x59, 0x90); -+} -+static void disable_dritek_keyboard(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: disabling dritek keyboard extension\n"); -+ send_kbd_cmd(0x59, 0x91); -+} -+static void enable_mail_led_ec_1(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: enabling mail led via EC variant 1\n"); -+ send_kbd_cmd(0xe8, 0x01); -+} -+static void disable_mail_led_ec_1(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: disabling mail led via EC variant 1\n"); -+ send_kbd_cmd(0xe8, 0x00); -+} -+ -+static void enable_mail_led_ec_2(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: enabling mail led via EC variant 2\n"); -+ send_kbd_cmd(0x59, 0x92); -+} -+static void disable_mail_led_ec_2(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: disabling mail led via EC variant 2\n"); -+ send_kbd_cmd(0x59, 0x93); -+} -+static void enable_mail_led_ec_3(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: enabling mail led via EC variant 3\n"); -+ if (usedritek) { -+ preempt_disable(); -+ if (!my_i8042_wait_write()) -+ outl(0x80008894, 0xCF8); -+ if (!my_i8042_wait_write()) -+ outw(0xC061, 0xCFC); -+ preempt_enable_no_resched(); -+ } -+} -+static void disable_mail_led_ec_3(void) -+{ -+ if (verbose) -+ printk(KERN_INFO "acerhk: disabling mail led via EC variant 3\n"); -+ if (usedritek) { -+ preempt_disable(); -+ if (!my_i8042_wait_write()) -+ outl(0x80008894, 0xCF8); -+ if (!my_i8042_wait_write()) -+ outw(0xC060, 0xCFC); -+ preempt_enable_no_resched(); -+ } -+} -+ -+/* }}} */ -+ -+/* {{{ string search functions */ -+ -+/* This is the Colussi algorithm, the code is taken from -+ http://www-igm.univ-mlv.fr/~lecroq/string -+*/ -+int preColussi(char *x, int m, int *h, int *next, int *shift) -+{ -+ int i, k, nd, q, r, s; -+ int hmax[XSIZE], kmin[XSIZE], nhd0[XSIZE], rmin[XSIZE]; -+ /* Computation of hmax */ -+ i = k = 1; -+ do { -+ while (x[i] == x[i - k]) -+ i++; -+ hmax[k] = i; -+ q = k + 1; -+ while (hmax[q - k] + k < i) { -+ hmax[q] = hmax[q - k] + k; -+ q++; -+ } -+ k = q; -+ if (k == i + 1) -+ i = k; -+ } while (k <= m); /* Computation of kmin */ -+ memset(kmin, 0, m*sizeof(int)); -+ r = 0; -+ for (i = m; i >= 1; --i) -+ if (hmax[i] < m) -+ kmin[hmax[i]] = i; /* Computation of rmin */ -+ for (i = m - 1; i >= 0; --i) { -+ if (hmax[i + 1] == m) -+ r = i + 1; -+ if (kmin[i] == 0) -+ rmin[i] = r; -+ else -+ rmin[i] = 0; -+ } /* Computation of h */ -+ s = -1; -+ r = m; -+ for (i = 0; i < m; ++i) -+ if (kmin[i] == 0) -+ h[--r] = i; -+ else -+ h[++s] = i; -+ nd = s; /* Computation of shift */ -+ for (i = 0; i <= nd; ++i) -+ shift[i] = kmin[h[i]]; -+ for (i = nd + 1; i < m; ++i) -+ shift[i] = rmin[h[i]]; -+ shift[m] = rmin[0]; /* Computation of nhd0 */ -+ s = 0; -+ for (i = 0; i < m; ++i) { -+ nhd0[i] = s; -+ if (kmin[i] > 0) -+ ++s; -+ } /* Computation of next */ -+ for (i = 0; i <= nd; ++i) -+ next[i] = nhd0[h[i] - kmin[h[i]]]; -+ for (i = nd + 1; i < m; ++i) -+ next[i] = nhd0[m - rmin[h[i]]]; -+ next[m] = nhd0[m - rmin[h[m - 1]]]; return(nd); -+} -+ -+int COLUSSI(char *x, int m, char *y, int n) { -+ int i, j, last, nd, -+ h[XSIZE], next[XSIZE], shift[XSIZE]; /* Processing */ -+ int match_pos; /* position of first match */ -+ nd = preColussi(x, m, h, next, shift); /* Searching */ -+ i = j = 0; -+ last = -1; -+ match_pos = -1; -+ while ( (match_pos == -1) -+ && (j <= n - m) ) { -+ while (i < m && last < j + h[i] && -+ x[h[i]] == y[j + h[i]]) -+ i++; -+ if (i >= m || last >= j + h[i]) { -+ /* Match found, bail out */ -+ match_pos = j; -+ i = m; -+ } -+ if (i > nd) -+ last = j + m - 1; -+ j += shift[i]; -+ i = next[i]; -+ } -+ return match_pos; -+} -+ -+/* }}} */ -+ -+/* {{{ hardware access functions */ -+ -+/* call_bios_ -+ * -+ * call request handler in mapped system rom -+ * -+ * the request is handed over via all 6 general purpose registers, results are -+ * taken from them and copied back to buf -+ */ -+static asmlinkage void call_bios_6xx(struct register_buffer *buf) -+{ -+ if (bios_routine) { -+ local_irq_disable(); -+ __asm__ __volatile__( -+ "movl %1,%%edx\n\t" -+ "pusha\n\t" -+ "movl %%edx,%%ebp\n\t" -+ "movl (%%ebp),%%eax\n\t" -+ "movl 4(%%ebp),%%ebx\n\t" -+ "movl 8(%%ebp),%%ecx\n\t" -+ "movl 12(%%ebp),%%edx\n\t" -+ "movl 16(%%ebp),%%edi\n\t" -+ "movl 20(%%ebp),%%esi\n\t" -+ "pushl %%ebp\n\t" -+ "call *%0\n\t" -+ "popl %%ebp\n\t" -+ "movl %%eax, (%%ebp)\n\t" -+ "movl %%ebx, 4(%%ebp)\n\t" -+ "movl %%ecx, 8(%%ebp)\n\t" -+ "movl %%edx, 12(%%ebp)\n\t" -+ "movl %%edi, 16(%%ebp)\n\t" -+ "movl %%esi, 20(%%ebp)\n\t" -+ "popa\n\t" -+ : -+ :"m" (bios_routine), "m" (buf) -+ :"%eax", "%ebx", "%ecx", "%edx", "%edi", "%esi", "%ebp" -+ ); -+ local_irq_enable(); -+ } -+} -+ -+static asmlinkage void call_bios_52x(struct register_buffer *buf) -+{ -+ if (bios_routine) { -+ local_irq_disable(); -+ __asm__ __volatile__( -+ "movl %2,%%edx\n\t" -+ "pusha\n\t" -+ "movl %%edx,%%ebp\n\t" -+ "movl (%%ebp),%%eax\n\t" -+ "movl 4(%%ebp),%%ebx\n\t" -+ "movl 8(%%ebp),%%ecx\n\t" -+ "movl 12(%%ebp),%%edx\n\t" -+ "movl 16(%%ebp),%%edi\n\t" -+ "movl 20(%%ebp),%%esi\n\t" -+ "pushl %%ebp\n\t" -+ "movl %1, %%ebp\n\t" -+ "call *%0\n\t" -+ "popl %%ebp\n\t" -+ "movl %%eax, (%%ebp)\n\t" -+ "movl %%ebx, 4(%%ebp)\n\t" -+ "movl %%ecx, 8(%%ebp)\n\t" -+ "movl %%edx, 12(%%ebp)\n\t" -+ "movl %%edi, 16(%%ebp)\n\t" -+ "movl %%esi, 20(%%ebp)\n\t" -+ "popa\n\t" -+ : -+ :"m" (bios_routine), "m" (preg400), "m" (buf) -+ :"%eax", "%ebx", "%ecx", "%edx", "%edi", "%esi", "%ebp" -+ ); -+ local_irq_enable(); -+ } -+} -+ -+#define PRINT_BUFFER(x) \ -+ printk(KERN_INFO"acerhk: eax=0x%x ebx=0x%x ecx=0x%x edx=0x%x\n" \ -+ "acerhk: edi=0x%x esi=0x%x ebp=0x%x\n", \ -+ x.eax, x.ebx, x.ecx, x.edx, x.edi, x.esi, x.ebp); -+ -+/* get_fnkey_event -+ * -+ * gets the first (oldest) key id from the queue of events -+ * -+ * return value: id of key -+ */ -+static int get_fnkey_event(void) -+{ -+ struct register_buffer regs; -+ regs.eax = 0x9610; -+ regs.ebx = 0x61C; -+ /* clear other registers, some models need this */ -+ regs.ecx = 0; -+ regs.edx = 0; -+ preempt_disable(); -+ call_bios(®s); -+ preempt_enable_no_resched(); -+ return regs.eax & 0xffff; -+} -+ -+/* get_thermal_event -+ * -+ * does what? -+ * -+ * return value: event ? -+ */ -+static int get_thermal_event(void) -+{ -+ struct register_buffer regs; -+ if (acerhk_model_features & TM_F_THERMAL) { -+ regs.eax = 0x9612; -+ regs.ebx = 0x12e; -+ preempt_disable(); -+ call_bios(®s); -+ preempt_enable_no_resched(); -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: thermal event = 0x%x\n", regs.eax); -+ } else { -+ regs.eax = 0x00; -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: thermal event not supported\n"); -+ } -+ return regs.eax & 0xffff; -+} -+ -+#ifdef ACERDEBUG -+/* pbutton_fct -+ * -+ * does what? -+ * -+ * return value: ? -+ */ -+static int pbutton_fct(void) -+{ -+ struct register_buffer regs; -+ if (acerhk_model_features & TM_F_PBUTTON) { -+ regs.eax = 0x9612; -+ regs.ebx = 0x10b; -+ regs.ecx = 0x2; -+ preempt_disable(); -+ call_bios(®s); -+ preempt_enable_no_resched(); -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: pbutton = 0x%x\n", regs.eax); -+ } else { -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: pbutton function not supported\n"); -+ regs.eax = 0x00; -+ } -+ return regs.eax & 0xffff; -+} -+#endif -+ -+/* wbutton_fct_1 -+ * -+ * turn on installed Bluetooth hardware together with the corresponding LED -+ * -+ * val: 0 turns off the LED -+ * 1 turns the LED to green/blue -+ * -+ * return value: ? -+ */ -+static int wbutton_fct_1(int val) -+{ -+ struct register_buffer regs; -+ if (acerhk_model_features & TM_F_WBUTTON) { -+ acerhk_bluetooth_state = val; -+ regs.eax = 0x9610; -+ regs.ebx = ((val & 0xff) << 8) | 0x34; -+ preempt_disable(); -+ call_bios(®s); -+ preempt_enable_no_resched(); -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: wbutton1 = 0x%x\n", regs.eax); -+ } else { -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: wbutton function 1 not supported\n"); -+ regs.eax = 0x00; -+ } -+ return regs.eax & 0xffff; -+} -+ -+/* wbutton_fct_2 -+ * -+ * turn on installed WLAN hardware together with the corresponding LED -+ * -+ * val: 0 turns off the LED -+ * 1 turns the LED to orange -+ * -+ * return value: ? -+ */ -+static int wbutton_fct_2(int val) -+{ -+ struct register_buffer regs; -+ if (acerhk_model_features & TM_F_WBUTTON) { -+ acerhk_wlan_state = val; -+ regs.eax = 0x9610; -+ regs.ebx = ((val & 0xff) << 8) | 0x35; -+ preempt_disable(); -+ call_bios(®s); -+ preempt_enable_no_resched(); -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: wbutton2 = 0x%x\n", regs.eax); -+ } else { -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: wbutton function 2 not supported\n"); -+ regs.eax = 0x00; -+ } -+ return regs.eax & 0xffff; -+} -+ -+/* get_cmos_index -+ * -+ * gets index of CMOS port from ROM. The number of events is monitored -+ * in this port. -+ * -+ * return value: index of CMOS port -+ */ -+static int get_cmos_index(void) -+{ -+ struct register_buffer regs; -+ regs.eax = 0x9610; -+ regs.ebx = 0x51C; -+ preempt_disable(); -+ call_bios(®s); -+ preempt_enable_no_resched(); -+ cmos_index = regs.ecx & 0xff; -+ if (verbose) -+ printk(KERN_INFO"acerhk: cmos index set to 0x%x\n", cmos_index); -+ return cmos_index; -+} -+ -+/* get_nr_events -+ * -+ * gets the number of cached events (keys pressed) in queue. Up to 31 events -+ * are cached. -+ * -+ * return value: number of events in queue -+ */ -+static int get_nr_events(void) -+{ -+ unsigned long flags; -+ unsigned char c = 0; -+ -+ spin_lock_irqsave (&rtc_lock, flags); -+#ifndef DUMMYHW -+ if (cmos_index) -+ c = CMOS_READ(cmos_index); -+ else if (verbose > 3) -+ printk(KERN_INFO"acerhk: get_nr_events - no valid cmos index set\n"); -+#endif -+ spin_unlock_irqrestore (&rtc_lock, flags); -+ return c; -+} -+ -+/* set_mail_led -+ * -+ * change state of mail led -+ * -+ * val: 0 - switch led off -+ * 1 - switch led on (blinking) -+ * -+ * return value: 1 - action succesfull (val valid) -+ * 0 - no action taken (val invalid) -+ */ -+static int set_mail_led(int val) -+{ -+ struct register_buffer regs; -+ if (acerhk_model_features & TM_F_MAIL_LED) { -+ regs.eax = 0x9610; -+ regs.ebx = ((val & 0xff) << 8) | 0x31; -+ preempt_disable(); -+ call_bios(®s); -+ preempt_enable_no_resched(); -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: mail led set to = 0x%x\n", val); -+ } else if (acerhk_model_features & TM_F_MAIL_LED_EC) { -+ if (val == 1) -+ enable_mail_led_ec_1(); -+ else if (val == 0) -+ disable_mail_led_ec_1(); -+ } else if (acerhk_model_features & TM_F_MAIL_LED_EC2) { -+ if (val == 1) -+ enable_mail_led_ec_2(); -+ else if (val == 0) -+ disable_mail_led_ec_2(); -+ } else if (acerhk_model_features & TM_F_MAIL_LED_EC3) { -+ if (val == 1) -+ enable_mail_led_ec_3(); -+ else if (val == 0) -+ disable_mail_led_ec_3(); -+ } else { -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: mail led not supported\n"); -+ regs.eax = 0x00; -+ } -+ return regs.eax & 0xffff; -+} -+ -+/* launch_connect -+ * -+ * does what? -+ * val: 1 - only known value from windows driver -+ */ -+static int launch_connect(int val) -+{ -+ struct register_buffer regs; -+ if (acerhk_model_features & TM_F_CONNECT) { -+ regs.eax = 0x9610; -+ regs.ebx = ((val & 0xff) << 8) | 0x2e; -+ preempt_disable(); -+ call_bios(®s); -+ preempt_enable_no_resched(); -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: connect(%d) = 0x%x\n", val, regs.eax); -+ } else { -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: connect not supported\n"); -+ regs.eax = 0x00; -+ } -+ return regs.eax & 0xffff; -+} -+ -+/* }}} */ -+ -+/* {{{ hardware probing */ -+ -+static struct proc_dir_entry *proc_acer_dir; -+ -+static unsigned int __init find_hk_area(void) -+{ -+ int offset, sig; -+ unsigned int fkt; -+ fkt = 0; -+ sig = -1; /* offset to signature in io area */ -+ /* Look for signature, start at 0xf0000, search until 0xffff0 */ -+ for (offset = 0;offset < 0xfffd; offset += 16) { -+ if (readl(reg1 + offset) == 0x30552142) { -+ sig = offset; -+ offset = 0xffff; -+ } -+ } -+ if (sig < 0) -+ printk(KERN_WARNING"acerhk: could not find request handler, possibly not all functions available\n"); -+ else { -+ /* compute location of bios routine */ -+ fkt = readl(reg1 + sig + 5); -+ /* adjust fkt to address of mapped IO area */ -+ if (fkt >= 0xf0000) -+ fkt = (unsigned int)reg1 + fkt - 0xf0000; -+ else if (fkt >= 0xe0000) -+ fkt = (unsigned int)reg1 + fkt - 0xe0000; -+ else -+ fkt = 0; -+ } -+ return fkt; -+} -+ -+static void print_features(void) -+{ -+ int i; -+ printk(KERN_INFO"acerhk: supported keys:"); -+ for (i = 0; i < 255; i++) { -+ switch (acerhk_key2name[i]) { -+ case k_help: printk(" help"); break; -+ case k_setup: printk(" setup"); break; -+ case k_p1: printk(" p1"); break; -+ case k_p2: printk(" p2"); break; -+ case k_p3: printk(" p3"); break; -+ case k_www: printk(" www"); break; -+ case k_mail: printk(" mail"); break; -+ case k_wireless: printk(" wireless"); break; -+ case k_power: printk(" power"); break; -+ case k_mute: printk(" mute"); break; -+ case k_volup: printk(" volup"); break; -+ case k_voldn: printk(" voldn"); break; -+ case k_res: printk(" res"); break; -+ case k_close: printk(" close"); break; -+ case k_open: printk(" open"); break; -+ case k_wireless2: printk(" wireless2"); break; -+ case k_play: printk(" play"); break; -+ case k_stop: printk(" stop"); break; -+ case k_prev: printk(" prev"); break; -+ case k_next: printk(" next"); break; -+ case k_display: printk(" display"); break; -+ default: break; -+ } -+ } -+ printk("\n"); -+ if (acerhk_model_features & TM_F_MUTE_LED_EC) -+ printk(KERN_INFO"acerhk: mute led is supported\n"); -+ if (acerhk_model_features & TM_F_MAIL_LED) -+ printk(KERN_INFO"acerhk: mail led is supported\n"); -+ else if (acerhk_model_features & TM_F_MAIL_LED_EC) -+ printk(KERN_INFO"acerhk: mail led (EC) is supported\n"); -+ else if (acerhk_model_features & TM_F_MAIL_LED_EC2) -+ printk(KERN_INFO"acerhk: mail led (EC2) is supported\n"); -+ else if (acerhk_model_features & TM_F_MAIL_LED_EC3) -+ printk(KERN_INFO"acerhk: mail led (EC3) is supported\n"); -+ if (acerhk_model_features & TM_F_WLAN_EC1) -+ printk(KERN_INFO"acerhk: wlan control (EC1) is supported\n"); -+ else if (acerhk_model_features & TM_F_WLAN_EC2) -+ printk(KERN_INFO"acerhk: wlan control (EC2) is supported\n"); -+ if (acerhk_model_features & TM_F_BLUE_EC1) -+ printk(KERN_INFO"acerhk: bluetooth control (EC1) is supported\n"); -+ else if (acerhk_model_features & TM_F_BLUE_EC2) -+ printk(KERN_INFO"acerhk: bluetooth control (EC2) is supported\n"); -+ printk(KERN_INFO"acerhk: supported functions:"); -+ if (acerhk_model_features & TM_F_CONNECT) -+ printk(" connect"); -+ if (acerhk_model_features & TM_F_THERMAL) -+ printk(" thermal"); -+ if (acerhk_model_features & TM_F_PBUTTON) -+ printk(" pbutton"); -+ if (acerhk_model_features & TM_F_WBUTTON) -+ printk(" wbutton"); -+ printk("\n"); -+} -+ -+static void __init setup_keymap_model(unsigned int series) -+{ -+ /* clear mapping keycode -> keyname, */ -+ memset(&acerhk_key2name[0], k_none, sizeof(acerhk_key2name)); -+ /* first set the common keys, namely FnF1 and FnF2, */ -+ acerhk_key2name[1] = k_help; -+ acerhk_key2name[2] = k_setup; -+ /* then set known keycodes according to model */ -+ switch (series) { -+ case 110: -+ acerhk_key2name[48] = k_wireless; -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ acerhk_key2name[54] = k_www; -+ acerhk_key2name[49] = k_mail; -+ acerhk_key2name[3] = k_power; -+ acerhk_key2name[8] = k_mute; -+ acerhk_key2name[32] = k_volup; -+ acerhk_key2name[33] = k_voldn; -+ /* C110 generates 2 extra codes when opening/closing the lid */ -+ acerhk_key2name[74] = k_close; -+ acerhk_key2name[75] = k_open; -+ break; -+ case 300: /* treat C300 like C100 with Bluetooth button */ -+ acerhk_key2name[68] = k_wireless2; -+ case 100: -+ acerhk_key2name[48] = k_wireless; -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ acerhk_key2name[49] = k_www; -+ acerhk_key2name[54] = k_mail; -+ acerhk_key2name[3] = k_power; -+ acerhk_key2name[8] = k_mute; -+ acerhk_key2name[32] = k_volup; -+ acerhk_key2name[33] = k_voldn; -+ break; -+ default: -+ /* only the two common keys are supported */ -+ break; -+ case 210: -+ acerhk_key2name[19] = k_p1; -+ acerhk_key2name[20] = k_p2; -+ acerhk_key2name[17] = k_www; -+ acerhk_key2name[18] = k_mail; -+ break; -+ case 220: -+ case 260: /* 260 with same keys? */ -+ acerhk_key2name[49] = k_p1; -+ acerhk_key2name[19] = k_p2; -+ acerhk_key2name[18] = k_www; -+ acerhk_key2name[17] = k_mail; -+ break; -+ case 230: -+ case 280: /* 280 with same keys? */ -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ acerhk_key2name[49] = k_mail; -+ acerhk_key2name[54] = k_www; -+ break; -+ case 1500: -+ acerhk_key2name[0x49] = k_setup; -+ acerhk_key2name[0x36] = k_www; -+ acerhk_key2name[0x31] = k_mail; -+ acerhk_key2name[0x11] = k_p1; -+ acerhk_key2name[0x12] = k_p2; -+ acerhk_key2name[0x30] = k_wireless; -+ acerhk_key2name[0x44] = k_wireless2; -+ acerhk_key2name[0x03] = k_power; -+ break; -+ case 240: -+ acerhk_key2name[0x31] = k_www; -+ acerhk_key2name[0x36] = k_mail; -+ acerhk_key2name[0x11] = k_p1; -+ acerhk_key2name[0x12] = k_p2; -+ acerhk_key2name[0x44] = k_wireless; -+ acerhk_key2name[0x30] = k_wireless2; -+ acerhk_key2name[0x03] = k_power; -+ acerhk_key2name[0x08] = k_mute; -+ // acerhk_key2name[] = k_volup; -+ // acerhk_key2name[] = k_voldn; -+ break; -+ case 2900: -+ acerhk_key2name[0x31] = k_mail; /* with led */ -+ acerhk_key2name[0x36] = k_www; -+ acerhk_key2name[0x11] = k_p1; -+ acerhk_key2name[0x12] = k_p2; -+ acerhk_key2name[0x30] = k_wireless; /* wireless, with led, related with autowlan=1 */ -+ break; -+ case 250: /* enriqueg@altern.org */ -+ /* TravelMate 254LMi_DT manual common for 240/250 series, but key order -+ differ from 240 already present on acerhk driver */ -+ /* TravelMate 254LMi_DT: 6 buttons: left to right: mail, www, p1, p2, bluetooth, wireless */ -+ acerhk_key2name[0x31] = k_mail; /* with led */ -+ acerhk_key2name[0x36] = k_www; -+ acerhk_key2name[0x11] = k_p1; -+ acerhk_key2name[0x12] = k_p2; -+ acerhk_key2name[0x44] = k_wireless2; /* bluetooth, hw optional */ -+ acerhk_key2name[0x30] = k_wireless; /* wireless, with led, related with autowlan=1 */ -+ acerhk_key2name[0x03] = k_power; /* Fn+F3 */ -+ acerhk_key2name[0x08] = k_mute; /* Fn+F8 */ -+ break; -+ case 380: -+ /* TM 380 has same codes as TM 370, with an additional one */ -+ acerhk_key2name[0x03] = k_power; -+ case 370: -+ acerhk_key2name[0x30] = k_wireless; -+ acerhk_key2name[0x11] = k_p1; -+ acerhk_key2name[0x12] = k_p2; -+ acerhk_key2name[0x13] = k_p3; -+ acerhk_key2name[0x36] = k_www; -+ acerhk_key2name[0x31] = k_mail; -+ break; -+ case 360: -+ /* 360 series has the same layout as 350, with an -+ additional wireless key */ -+ acerhk_key2name[64] = k_wireless; -+ case 350: -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ acerhk_key2name[20] = k_p3; -+ acerhk_key2name[21] = k_www; -+ acerhk_key2name[19] = k_mail; -+ break; -+ case 520: -+ acerhk_key2name[19] = k_p1; -+ acerhk_key2name[20] = k_p2; -+ acerhk_key2name[17] = k_www; -+ acerhk_key2name[18] = k_mail; -+ break; -+ case 610: -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ acerhk_key2name[19] = k_p3; -+ acerhk_key2name[21] = k_www; -+ acerhk_key2name[20] = k_mail; -+ acerhk_key2name[64] = k_wireless; -+ break; -+ case 630: -+ /* 630 has all keys of 620 plus one */ -+ acerhk_key2name[8] = k_mute; -+ case 620: -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ acerhk_key2name[19] = k_p3; -+ acerhk_key2name[54] = k_www; -+ acerhk_key2name[49] = k_mail; -+ acerhk_key2name[48] = k_wireless; -+ acerhk_key2name[3] = k_power; -+ acerhk_key2name[32] = k_volup; -+ acerhk_key2name[33] = k_voldn; -+ break; -+ case 290: -+ case 420: -+ case 430: -+ case 530: -+ case 540: -+ case 650: -+ case 660: -+ case 800: -+ case 1450: -+ case 2300: -+ case 2350: -+ case 4000: -+ case 4050: -+ case 6000: -+ case 8000: -+ case 4100: -+ case 4150: -+ case 4500: -+ case 4600: -+ case 4650: -+ case 1680: -+ case 1690: -+ /* keys are handled by dritek EC */ -+ acerhk_key2name[1] = k_none; -+ acerhk_key2name[2] = k_none; -+ break; -+ case 1300: -+ case 1310: -+ case 1350: -+ case 1360: -+ case 1400: -+ case 1700: -+ case 1800: -+ case 2000: -+ case 2010: -+ case 2020: -+ /* Aspire 13xx series laptops use dritek hardware, no -+ acerhk-mapping needed -+ VolUp and VolDown are managed as normal keys -+ 1300/1310 series should have P1, P2, Mail, WWW, Mute buttons -+ 1353 has bluetooth, wifi, p1, p2, www, mail, help, setup, power -+ and mute -+ Aspire 1400/1450/Ferrari use dritek EC, too -+ 1450 should have bluetooth, wifi, p1, p2, www, mail, help, -+ setup, power and mute -+ Aspire 1700 uses dritek EC, too -+ 1700 should have bluetooth, wifi, p1, p2, www, mail, help, -+ setup, power and mute -+ need the MM-buttons Activation? (forward, shuffle, ...) -+ 2000 hast lots of MM buttons -+ 2010 should have bluetooth, wifi, p1, p2, www, mail, help, -+ setup, power and mute -+ */ -+ acerhk_key2name[1] = k_none; -+ acerhk_key2name[2] = k_none; -+ break; -+ case 1600: -+ /* Aspire 1600 has acer keycode 0x49 for FnF2 */ -+ acerhk_key2name[73] = k_setup; -+ acerhk_key2name[48] = k_wireless; -+ acerhk_key2name[49] = k_mail; -+ acerhk_key2name[54] = k_www; -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ acerhk_key2name[19] = k_p3; -+ acerhk_key2name[3] = k_power; -+ acerhk_key2name[8] = k_mute; -+ /* VolUp and VolDown keys doesn't seem to be managed as special keys -+ but as normal keys ! */ -+ break; -+ case 5020: /* Aspire 5020 has 0x6a for Fn+F2 */ -+ acerhk_key2name[2] = k_none; -+ acerhk_key2name[106] = k_setup; -+ acerhk_key2name[3] = k_power; -+ acerhk_key2name[5] = k_display; -+ acerhk_key2name[49] = k_mail; -+ acerhk_key2name[54] = k_www; -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ acerhk_key2name[48] = k_wireless; -+ acerhk_key2name[68] = k_wireless2; -+ break; -+ case 2410: /* TM 2410 is very similar to Aspire 5020, but has 0x6s for Fn-F3 */ -+ acerhk_key2name[2] = k_none; -+ acerhk_key2name[106] = k_setup; -+ acerhk_key2name[109] = k_power; -+ acerhk_key2name[49] = k_mail; -+ acerhk_key2name[54] = k_www; -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ acerhk_key2name[48] = k_wireless; -+ acerhk_key2name[68] = k_wireless2; -+ break; -+ case 40100: -+ /* Medion MD40100, 4 keys */ -+ acerhk_key2name[54] = k_www; -+ acerhk_key2name[49] = k_mail; -+ acerhk_key2name[48] = k_wireless; -+ acerhk_key2name[55] = k_res; -+ break; -+ case 96500: -+ case 95400: -+ /* Medion MD95400, many keys */ -+ acerhk_key2name[49] = k_mail; /* 1 */ -+ acerhk_key2name[54] = k_www; /* 2 */ -+ acerhk_key2name[48] = k_wireless; /* 3 */ -+ acerhk_key2name[68] = k_wireless2; /* 4 (Bluetooth) */ -+ -+ acerhk_key2name[17] = k_p1; /* 5 */ -+ acerhk_key2name[18] = k_p2; /* 6 */ -+ acerhk_key2name[36] = k_play; /* 7 */ -+ acerhk_key2name[37] = k_stop; /* 8 */ -+ acerhk_key2name[34] = k_prev; /* 9 */ -+ acerhk_key2name[35] = k_next; /* 10 */ -+ acerhk_key2name[33] = k_voldn; /* 11 */ -+ acerhk_key2name[32] = k_volup; /* 12 */ -+ acerhk_key2name[38] = k_p3; /* 13 */ -+ acerhk_key2name[8] = k_mute; /* 14 */ -+ -+ acerhk_key2name[1] = k_help; /* FN+F1 (Help) */ -+ acerhk_key2name[5] = k_display; /* FN+F3 (Display switch) */ -+ acerhk_key2name[6] = k_res; /* FN+F4 (Display ein/ausschalten) */ -+ break; -+ case 42200: -+ /* Medion MD42200, 7 keys, no setup */ -+ acerhk_key2name[2] = k_none; -+ acerhk_key2name[5] = k_display; -+ acerhk_key2name[54] = k_www; -+ acerhk_key2name[48] = k_wireless; -+ acerhk_key2name[49] = k_mail; -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ break; -+ case 9783: -+ /* Medion MD9783, 6 keys + info, no setup */ -+ acerhk_key2name[2] = k_none; -+ acerhk_key2name[54] = k_www; -+ acerhk_key2name[49] = k_mail; -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ acerhk_key2name[19] = k_p3; -+ acerhk_key2name[8] = k_mute; -+ break; -+ case 7400: -+ /* Amilo Pro V2000 does not have Help and Setup key (?) -+ Amilo M 7400 has Help key, disabling only setup -+ */ -+ acerhk_key2name[2] = k_none; -+ acerhk_key2name[48] = k_wireless; -+ acerhk_key2name[49] = k_mail; -+ acerhk_key2name[54] = k_www; -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ break; -+ case 1559: -+ acerhk_key2name[6] = k_display; /* FN+F4 (Display ein/ausschalten) */ -+ case 1555: -+ /* AOpen (Ahtec Signal 1555M) is similar to FS Amilo M */ -+ acerhk_key2name[2] = k_none; -+ acerhk_key2name[48] = k_wireless; -+ acerhk_key2name[49] = k_mail; -+ acerhk_key2name[54] = k_www; -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ acerhk_key2name[34] = k_prev; -+ acerhk_key2name[35] = k_next; -+ acerhk_key2name[36] = k_play; -+ acerhk_key2name[37] = k_stop; -+ break; -+ case 6800: -+ case 7820: -+ /* Amilo D does not have Setup key */ -+ acerhk_key2name[2] = k_none; -+ acerhk_key2name[49] = k_mail; -+ acerhk_key2name[54] = k_www; -+ acerhk_key2name[17] = k_p1; -+ acerhk_key2name[18] = k_p2; -+ acerhk_key2name[19] = k_p3; -+ acerhk_key2name[8] = k_mute; -+ break; -+ } -+} -+ -+static void __init setup_model_features(unsigned int series) -+{ -+ switch (series) { -+ case 200: -+ case 210: -+ case 520: -+ /* nothing special */ -+ acerhk_model_features = 0; -+ acerhk_type = TM_old; -+ break; -+ case 220: -+ case 230: -+ case 260: -+ case 280: -+ case 360: -+ case 40100: /* Medion MD40100 */ -+ case 95400: /* Medion MD95400 */ -+ case 96500: /* Medion MD96500 */ -+ /* all special functions, no mail led */ -+ acerhk_model_features = 0x00f00000; -+ acerhk_type = TM_new; -+ break; -+ case 42200: /* Medion MD42200 */ -+ /* has WLAN button, should call connect() */ -+ acerhk_model_features = TM_F_WBUTTON | TM_F_CONNECT; -+ acerhk_type = TM_old; -+ break; -+ case 9783: /* Medion MD9783 */ -+ /* only email led */ -+ acerhk_model_features = TM_F_MAIL_LED; -+ acerhk_type = TM_new; -+ break; -+ case 1600: -+ acerhk_type = TM_new; -+ /* Do Aspire 1600 series have special functions or not ? I enable -+ them, perhaps it helps with problems Francois Valenduc has */ -+ acerhk_model_features = 0x00f00000; -+ break; -+ case 300: -+ case 100: -+ case 110: -+ case 240: -+ case 350: -+ case 610: -+ case 620: -+ case 630: -+ /* all special functions, mail led */ -+ acerhk_model_features = TM_F_MAIL_LED | 0x00f00000; -+ acerhk_type = TM_new; -+ break; -+ case 370: -+ case 380: -+ case 2410: -+ case 2900: /* Medion MD2900 */ -+ case 2100: /* TM 2100 uses same driver as 5020 */ -+ case 5020: /* Aspire 5020 is still old hardware */ -+ acerhk_model_features = TM_F_MAIL_LED | TM_F_CONNECT| TM_F_WBUTTON; -+ acerhk_type = TM_new; -+ break; -+ case 7400: -+ case 1555: -+ case 1559: -+ /* all special functions for Fujitsu-Siemens Amilo M7400, Pro V2000; AOpen */ -+ acerhk_model_features = 0x00f00000; -+ acerhk_type = TM_new; -+ break; -+ case 6800: -+ case 7820: -+ /* mail led and all special functions for FS Amilo D */ -+ acerhk_model_features = TM_F_MAIL_LED | 0x00f00000; -+ acerhk_type = TM_new; -+ break; -+ case 2350: -+ case 4050: -+ acerhk_wlan_state = 1; // Default state is on -+ case 290: -+ /* no special functions, wireless hardware controlled by EC */ -+ acerhk_model_features = TM_F_WLAN_EC2 | TM_F_BLUE_EC2; -+ acerhk_type = TM_dritek; -+ break; -+ case 650: -+ case 1300: -+ case 1310: -+ case 1400: -+ case 1700: -+ /* all special functions, wireless hardware can be controlled */ -+ acerhk_model_features = 0x00f00000; -+ acerhk_type = TM_dritek; -+ break; -+ case 4100: -+ case 4600: -+ case 1680: -+ case 1690: /* Aspire 1680/1690 should be similar to TM 4100/4600 */ -+ /* mail led, wireless and bluetooth controlled the old way, but keys are -+ controlled by normal keyboard controller, so mark as dritek and -+ deactivate dritek use */ -+ acerhk_model_features = TM_F_MAIL_LED | TM_F_WBUTTON; -+ acerhk_type = TM_dritek; -+ usedritek=0; -+ break; -+ case 660: -+ case 800: -+ /* all special functions, mail led */ -+ acerhk_model_features = TM_F_MAIL_LED | 0x00f00000; -+ acerhk_type = TM_dritek; -+ break; -+ case 1350: -+ case 1360: -+ /* mail led, handled by EC, wireless HW is not (yet) controllable ? */ -+ acerhk_model_features = TM_F_MAIL_LED_EC|TM_F_WLAN_EC1; -+ acerhk_type = TM_dritek; -+ break; -+ case 1450: -+ /* Bluetooth/Wlan led, Mail led handled by EC (variant 3) */ -+ acerhk_model_features = TM_F_MAIL_LED_EC3|TM_F_WBUTTON; -+ acerhk_type = TM_dritek; -+ break; -+ case 1500: -+ /* Bluetooth/Wlan led */ -+ acerhk_model_features = TM_F_WBUTTON; -+ acerhk_type = TM_new; -+ break; -+ case 420: -+ case 430: -+ /* all functions and dritek EC, mail LED is handled by EC, second -+ variant. An additional led is available, mute. (really?) -+ */ -+ acerhk_type = TM_dritek; -+ acerhk_model_features = TM_F_MUTE_LED_EC|TM_F_MAIL_LED_EC2; -+ break; -+ case 2300: -+ case 4000: -+ case 4500: -+ /* wireless hardware, hopefully under control of my driver */ -+ acerhk_type = TM_dritek; -+ acerhk_model_features = TM_F_BLUE_EC1|TM_F_WLAN_EC1; -+ break; -+ case 3200: -+ /* test, if this model uses old style wlan control */ -+ acerhk_model_features = TM_F_WBUTTON; -+ acerhk_type = TM_dritek; -+ break; -+ case 6000: -+ case 8000: -+ /* 6000 and 8000 have wireless hardware, but I don't know how to handle, -+ so I choose no features */ -+ acerhk_type = TM_dritek; -+ break; -+ case 530: -+ case 540: -+ case 2000: -+ /* No features (?) dritek EC, mail LED is handled by EC but -+ different from other Aspire series */ -+ acerhk_type = TM_dritek; -+ acerhk_model_features = TM_F_MAIL_LED_EC2; -+ break; -+ case 4150: -+ case 4650: -+ /* Dritek EC, bluetooth, wifi, mail */ -+ /* According to Andreas Stumpfl his TM 4652LMi does also work as series -+ 3200, which might mean that the BIOS function accesses the EC */ -+ acerhk_type = TM_dritek; -+ acerhk_model_features = TM_F_MAIL_LED_EC2 | TM_F_WLAN_EC2 | TM_F_BLUE_EC2; -+ break; -+ case 1800: -+ case 2010: -+ case 2020: -+ /* Dritek EC, bluetooth, wifi, mail */ -+ acerhk_type = TM_dritek; -+ acerhk_model_features = TM_F_MAIL_LED_EC2 | TM_F_WLAN_EC2 | TM_F_BLUE_EC2; -+ acerhk_wlan_state = 1; // Default state is on -+ break; -+ case 250: /* enriqueg@altern.org */ -+ /* TravelMate254LMi_DT : mail led, bluetooth (button present, hw optional), wifi (with led) */ -+ acerhk_model_features = TM_F_MAIL_LED| -+ TM_F_WBUTTON ; -+ acerhk_type = TM_new; -+ acerhk_wlan_state = 0; //Initial state is off on 254LMi_DT -+ break; -+ default: -+ /* nothing special */ -+ acerhk_model_features = 0; -+ acerhk_type = TM_unknown; -+ break; -+ } -+ /* set the correct bios call function according to type */ -+ if ((acerhk_type == TM_new) || (acerhk_type == TM_dritek)) { -+ call_bios = call_bios_6xx; -+ if (verbose > 2) -+ printk(KERN_INFO"acerhk: using call_bios_6xx mode\n"); -+ } else { -+ call_bios = call_bios_52x; -+ if (verbose > 2) -+ printk(KERN_INFO"acerhk: using call_bios_52x mode\n"); -+ } -+ /* remove key file on dritek hardware */ -+ if (acerhk_type == TM_dritek) { -+ remove_proc_entry("key", proc_acer_dir); -+ } -+ /* setup available keys */ -+ setup_keymap_model(acerhk_series); -+ if (verbose > 1) -+ print_features(); -+} -+ -+static unsigned int __init determine_laptop_series(char * str) -+{ -+ /* 0 means unknown series, handled like TM 200 */ -+ unsigned int series = 0; -+ if (strncmp(str, "TravelMate ", 11) == 0) { -+ switch (str[11]) { -+ case 'C': -+ if (str[12] == '1') { -+ if (str[13] == '0') { -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates TM C100 series\n"); -+ series = 100; -+ } else if (str[13] == '1') { -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates TM C110 series\n"); -+ series = 110; -+ } -+ } else if (str[12] == '3') { -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates TM C300 series\n"); -+ series = 300; -+ } -+ break; -+ case 'F': -+ if (str[12] == '4') { -+ series = 230; -+ } -+ break; -+ case '2': -+ if (str[14] == '0') { -+ /* newer Travelmate 2xxx series */ -+ switch (str[12]) { -+ case '0': -+ case '5': -+ series = 2000; // 2000 and 2500 are the same -+ break; -+ case '1': -+ if (str[13] == '0') -+ series = 2100; -+ break; -+ case '2': -+ case '7': -+ series = 2200; // 2200 and 2700 are the same -+ break; -+ case '3': -+ if (str[13] == '0') -+ series = 4000; // 2300 is the same as 4000 -+ else if (str[13] == '5') -+ series = 4050; // 2350 is the same as 4050 -+ break; -+ case '4': -+ if (str[13] == '1') -+ series = 2410; -+ break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM 2xxx series\n"); -+ break; -+ } -+ } else { -+ /* older Travelmate 2xx series */ -+ switch (str[12]) { -+ case '0': series = 200; break; -+ case '1': series = 210; break; -+ case '2': series = 220; break; -+ case '4': series = 240; break; -+ case '5': series = 250; break; /* enriqueg@altern.org */ -+ case '6': series = 260; break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM 2xx series\n"); -+ break; -+ } -+ } -+ break; -+ case '3': -+ switch (str[12]) { -+ case '0': series = 3200; break; /* TM 3000 works like TM 3200 */ -+ /* Travelmate 3xx series */ -+ case '5': series = 350; break; -+ case '6': series = 360; break; -+ case '7': series = 370; break; -+ case '8': series = 380; break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM 3xx series\n"); -+ break; -+ } -+ break; -+ case '4': -+ if ( (strnlen(str, ACERHK_MODEL_STRLEN-1) == 15) && -+ (str[14] == '0') ) { /* Travelmate 4xxx series */ -+ switch (str[12]) { -+ case '0': /* 4000 and 4500 are the same */ -+ case '5': -+ series = 4000; -+ break; -+ case '1': -+ case '6': /* 4100 and 4600 are the same */ -+ series = 4100; -+ break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM 4xxx series\n"); -+ break; -+ } -+ } else { /* Travelmate 4xx series */ -+ switch (str[12]) { -+ case '2': series = 420; break; -+ case '3': series = 430; break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM 4xx series\n"); -+ break; -+ } -+ } -+ break; -+ case '5': /* Travelmate 5xx series */ -+ if (str[12] == '2') -+ series = 520; -+ else if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM 5xx series\n"); -+ break; -+ case '6': /* older Travelmate 6xx series */ -+ switch (str[12]) { -+ case '1': series = 610; break; -+ case '2': series = 620; break; -+ case '3': series = 630; break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM 6xx series\n"); -+ break; -+ } -+ break; -+ default: -+ printk(KERN_INFO"acerhk: model string indicates unknown TM xxx series\n"); -+ break; -+ } -+ if (series && verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates TM %d series\n", series); -+ } -+ /* newer Travelmate series do not have a space after 'TravelMate' */ -+ else if (strncmp(str, "TravelMate", 10) == 0) { -+ switch (str[10]) { -+ case '2': -+ if (str[11] == '9') { -+ series = 290; -+ } else { -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM2xx series\n"); -+ } -+ break; -+ case '3': -+ if (str[11] == '2' && str[14] == '3') { -+ // TM 3200 uses "TravelMate32003" -+ series = 3200; -+ } else { -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM3xxx series\n"); -+ } -+ break; -+ case '4': -+ switch (str[11]) { -+ case '3': series = 430; break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM4xx series\n"); -+ break; -+ } -+ break; -+ case '5': -+ switch (str[11]) { -+ case '3': series = 530; break; -+ case '4': series = 540; break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM5xx series\n"); -+ break; -+ } -+ break; -+ case '6': -+ switch (str[11]) { -+ case '5': series = 650; break; -+ case '6': series = 660; break; -+ case '0': -+ if (strncmp(str, "TravelMate60003", 15) == 0) { -+ series = 6000; break; -+ } -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM6xx series\n"); -+ break; -+ } -+ break; -+ case '8': -+ if (strncmp(str, "TravelMate80003", 15) == 0) { -+ series = 8000; -+ } else if (str[11] == '0') { -+ series = 800; -+ } else { -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown TM8xx series\n"); -+ } -+ break; -+ default: -+ printk(KERN_INFO"acerhk: model string indicates unknown TMxxx series\n"); -+ break; -+ } -+ if (series && verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates TM%d series\n", series); -+ } -+ else if (strncmp(str, "Aspire ", 7) == 0) { -+ switch(str[7]) { -+ case '1': /* Aspire 1xxx series */ -+ switch(str[8]) { -+ case '3': /* Aspire 13xx series */ -+ switch (str[9]) { -+ case '0': series = 1300; break; -+ case '1': series = 1310; break; -+ case '5': series = 1350; break; -+ case '6': series = 1360; break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown Aspire 13xx series\n"); -+ break; -+ } -+ break; -+ case '4': /* Aspire 14xx series */ -+ switch (str[9]) { -+ case '0': series = 1400; break; -+ case '5': series = 1450; break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown Aspire 14xx series\n"); -+ break; -+ } -+ break; -+ case '5': series = 1500; break; -+ case '6': /* Aspire 14xx series */ -+ switch (str[9]) { -+ case '0': series = 1600; break; -+ case '8': -+ case '9': series = 1680; break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown Aspire 16xx series\n"); -+ break; -+ } -+ break; -+ case '7': series = 1700; break; -+ case '8': series = 1800; break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown Aspire 1xxx series\n"); -+ break; -+ } -+ break; -+ case '2': /* Aspire 2xxx series */ -+ if (str[8] == '0') { -+ switch (str[9]) { -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown Aspire 20xx series\n"); -+ break; -+ case '0': series = 2000; break; -+ case '1': series = 2010; break; -+ case '2': series = 2020; break; -+ } -+ } else { -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown Aspire 2xxx series\n"); -+ } -+ break; -+ case '3': /* Aspire 3xxx series */ -+ if (str[8] == '0') { -+ switch (str[9]) { -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown Aspire 30xx series\n"); -+ break; -+ case '2': series = 5020; break; /* Aspire 3020/5020 are identical */ -+ } -+ } else { -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown Aspire 3xxx series\n"); -+ } -+ break; -+ case '5': /* Aspire 5xxx series */ -+ if (str[8] == '0') { -+ switch (str[9]) { -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown Aspire 50xx series\n"); -+ break; -+ case '2': series = 5020; break; -+ } -+ } else { -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown Aspire 5xxx series\n"); -+ } -+ break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown Aspire series\n"); -+ break; -+ } -+ if (series && verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates Aspire %d series\n", series); -+ } -+ else if (strncmp(str, "Extensa ", 8) == 0) { -+ /* Extensa series */ -+ switch (str[8]) { -+ case '3': -+ switch (str[9]) { -+ case '0': -+ series = 3000; break; -+ default: break; -+ } -+ break; -+ default: break; -+ } -+ if (series && verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates Extensa %d series\n", series); -+ else if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown Extensa series\n"); -+ } -+ else if (strncmp(str, "Amilo ", 6) == 0) { -+ switch (str[6]) { -+ case 'D': /* complete string is "Amilo D-Series", there seems to be no model number */ -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates FS Amilo D series\n"); -+ /* this is the model number of my Amilo */ -+ series = 7820; -+ break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown FS Amilo XX series\n"); -+ series = 7820; -+ } -+ } -+ else if (strncmp(str, "AMILO ", 6) == 0) { -+ switch (str[6]) { -+ case 'D': /* AMILO D 6800 P4-2000 */ -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates FS AMILO D series\n"); -+ series = 6800; -+ break; -+ case 'M': -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates FS AMILO M(7400) series\n"); -+ series = 7400; -+ break; -+ case 'P': -+ /* it is assumed, that 'AMILO P' appears only on Amilo Pro Series */ -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates FS AMILO Pro (V2000) series\n"); -+ series = 7400; -+ break; -+ default: -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates unknown FS AMILO XX series\n"); -+ series = 6800; -+ } -+ } -+ else if (strncmp(str, "MEDIONPC", 8) == 0) { -+ uint medionmodel; -+ if ((medionmodel = COLUSSI("WIM 2040", 4, reg1, AREA_SIZE)) >= 0) { -+ printk(KERN_INFO"acerhk: found Medion model string:'%s'\n", (char*)reg1+medionmodel); -+ series = 96500; -+ } else { -+ if ((medionmodel = COLUSSI("MD 9", 4, reg1, AREA_SIZE)) >= 0) { -+ printk(KERN_INFO"acerhk: found Medion model string:'%s'\n", (char*)reg1+medionmodel); -+ } -+ series = 95400; -+ } -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates a medion MD %d\n", series); -+ } -+ else if (strncmp(str, "MEDIONNB", 8) == 0) { -+ /* Search for the Product string of the MD9783. */ -+ if (COLUSSI("MD 42200", 8, reg1, AREA_SIZE) >= 0) { -+ if (verbose>1) -+ printk(KERN_INFO"acerhk: model string indicates a Medion MD 42200\n"); -+ series = 42200; -+ } else if (COLUSSI("MD 9783", 7, reg1, AREA_SIZE) >= 0){ -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates a medion MD 9783\n"); -+ series = 9783; -+ } else if (COLUSSI("WIM 2000", 7, reg1, AREA_SIZE) >= 0){ -+ if (verbose>1) -+ printk(KERN_INFO"acerhk: model string indicates a Medion MD 2900\n"); -+ series = 2900; -+ } else { -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates a medion MD40100\n"); -+ series = 40100; -+ } -+ } else if (strncmp(str, "AOpen", 5) == 0) { -+ if (strncmp(str, "AOpen*EzRestore", 15) == 0) { -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates a AOpen 1559\n"); -+ series = 1559; -+ } else { -+ /* Unless I know of other models no further differentiation, -+ although there is a second part of the model string */ -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates a AOpen\n"); -+ series = 1555; -+ } -+ } else if (strncmp(str, "CL56", 4) == 0) { -+ /* Unless I know of other models no further differentiation, -+ although there are strings with more numbers ("CL561" on a Compal -+ CL56/Zepto 4200, reported by Stian B. Barmen) -+ It has the same functions as Acer Aspire 2010 -+ */ -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates a Compal CL56 (or similar)\n"); -+ series = 2010; -+ } else if (strncmp(str, "Geneva2", 7) == 0) { -+ /* This might be an Aspire 9110 which is very similar to 4650 */ -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates an Aspire 9110\n"); -+ series = 4650; -+ } else { -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: model string indicates no supported hardware\n"); -+ } -+ return (series); -+} -+ -+static void __init probe_model(void) { -+ int offset; /* offset from beginning of reg1 to Model string */ -+ if (verbose) -+ printk(KERN_INFO"acerhk: start search for model string at %p\n", reg1); -+ /* first we look for Travelmate, if it isn't one we try to identify other -+ laptops, such as Medion or Aspire */ -+ offset = COLUSSI("Travel", 6, reg1, AREA_SIZE); -+ /* Try to detect Aspire laptops */ -+ if (offset < 0) -+ offset = COLUSSI("Aspire", 6, reg1, AREA_SIZE); -+ /* Try to detect Extensa laptops */ -+ if (offset < 0) -+ offset = COLUSSI("Extensa", 7, reg1, AREA_SIZE); -+ /* Try to detect Medion laptops */ -+ if (offset < 0) -+ offset = COLUSSI("MEDION", 6, reg1, AREA_SIZE); -+ /* Try to detect AOpen laptops */ -+ if (offset < 0) -+ offset = COLUSSI("AOpen", 5, reg1, AREA_SIZE); -+ /* Try to detect Fujitsu Siemens Amilo laptops */ -+ if (offset < 0) -+ offset = COLUSSI("Amilo", 5, reg1, AREA_SIZE); -+ if (offset < 0) -+ offset = COLUSSI("AMILO", 5, reg1, AREA_SIZE); -+ /* Try to detect Compal */ -+ if (offset < 0) -+ offset = COLUSSI("CL56", 4, reg1, AREA_SIZE); -+ /* That might be an Aspire 9110 */ -+ if (offset < 0) -+ offset = COLUSSI("Geneva2", 7, reg1, AREA_SIZE); -+ if (offset >= 0) { -+ acerhk_model_addr = reg1 + offset; -+ /* copy the string, but not more than 15 characters */ -+ strncpy(acerhk_model_string, acerhk_model_addr, ACERHK_MODEL_STRLEN-1); -+ if (verbose) -+ printk(KERN_INFO"acerhk: found model string '%s' at %p\n", -+ acerhk_model_string, acerhk_model_addr); -+ if (bios_routine && verbose > 2) -+ printk(KERN_INFO"acerhk: offset from model string to function address: 0x%lx\n", -+ bios_routine - (unsigned long)acerhk_model_addr); -+ acerhk_series = determine_laptop_series(acerhk_model_string); -+ } else { -+ printk(KERN_WARNING"acerhk: Could not find model string, will assume type 200 series\n"); -+ acerhk_series = 200; -+ } -+} -+ -+/* }}} */ -+ -+/* {{{ key polling and translation */ -+ -+static void print_mapping(void) -+{ -+ printk(KERN_INFO"acerhk: key mapping:\n"); -+ printk("acerhk: help 0x%x\n", acerhk_name2event[k_help]); -+ printk("acerhk: setup 0x%x\n", acerhk_name2event[k_setup]); -+ printk("acerhk: p1 0x%x\n", acerhk_name2event[k_p1]); -+ printk("acerhk: p2 0x%x\n", acerhk_name2event[k_p2]); -+ printk("acerhk: p3 0x%x\n", acerhk_name2event[k_p3]); -+ printk("acerhk: www 0x%x\n", acerhk_name2event[k_www]); -+ printk("acerhk: mail 0x%x\n", acerhk_name2event[k_mail]); -+ printk("acerhk: wireless 0x%x\n", acerhk_name2event[k_wireless]); -+ printk("acerhk: power 0x%x\n", acerhk_name2event[k_power]); -+ printk("acerhk: mute 0x%x\n", acerhk_name2event[k_mute]); -+ printk("acerhk: volup 0x%x\n", acerhk_name2event[k_volup]); -+ printk("acerhk: voldn 0x%x\n", acerhk_name2event[k_voldn]); -+ printk("acerhk: res 0x%x\n", acerhk_name2event[k_res]); -+ printk("acerhk: close 0x%x\n", acerhk_name2event[k_close]); -+ printk("acerhk: open 0x%x\n", acerhk_name2event[k_open]); -+ printk("acerhk: wireless2 0x%x\n", acerhk_name2event[k_wireless2]); -+ printk("acerhk: play 0x%x\n", acerhk_name2event[k_play]); -+ printk("acerhk: stop 0x%x\n", acerhk_name2event[k_stop]); -+ printk("acerhk: prev 0x%x\n", acerhk_name2event[k_prev]); -+ printk("acerhk: next 0x%x\n", acerhk_name2event[k_next]); -+ printk("acerhk: display 0x%x\n", acerhk_name2event[k_display]); -+} -+ -+static void set_keymap_name(t_key_names name, unsigned int key) -+{ -+ acerhk_name2event[name] = key; -+} -+ -+static void init_keymap_input(void) -+{ -+ /* these values for input keys are chosen to match the key names on the -+ actual Acer laptop */ -+ set_keymap_name(k_none, KEY_RESERVED); -+ set_keymap_name(k_help, KEY_HELP); -+ set_keymap_name(k_setup, KEY_CONFIG); -+ set_keymap_name(k_p1, KEY_PROG1); -+ set_keymap_name(k_p2, KEY_PROG2); -+ set_keymap_name(k_p3, KEY_PROG3); -+ set_keymap_name(k_www, KEY_WWW); -+ set_keymap_name(k_mail, KEY_MAIL); -+ set_keymap_name(k_wireless, KEY_XFER); -+ set_keymap_name(k_power, KEY_POWER); -+ set_keymap_name(k_mute, KEY_MUTE); -+ set_keymap_name(k_volup, KEY_VOLUMEUP); -+ set_keymap_name(k_voldn, KEY_VOLUMEDOWN); -+ set_keymap_name(k_res, KEY_CONFIG); -+ set_keymap_name(k_close, KEY_CLOSE); -+ set_keymap_name(k_open, KEY_OPEN); -+ /* I am not really happy with the selections for wireless and wireless2, -+ but coffee looks good. Michal Veselenyi proposed this value */ -+ set_keymap_name(k_wireless2, KEY_COFFEE); -+ set_keymap_name(k_play, KEY_PLAYPAUSE); -+ set_keymap_name(k_stop, KEY_STOPCD); -+ set_keymap_name(k_prev, KEY_PREVIOUSSONG); -+ set_keymap_name(k_next, KEY_NEXTSONG); -+ set_keymap_name(k_display, KEY_MEDIA); /* also not happy with this */ -+ if (verbose > 1) -+ print_mapping(); -+} -+ -+static int filter_idle_value(int keycode) -+{ -+ int validkey = 0; -+ if (keycode != 0x0 && -+ keycode != 0x9610 && -+ keycode != 0xc100 && /* Francois Valenduc, Aspire 1601 LC */ -+ keycode != 0x8610 && -+ keycode != 0x861 && -+ keycode != 0x8650 && -+ keycode != 0x865) -+ validkey = keycode; -+ if (verbose > 4 && !validkey) -+ printk(KERN_INFO"acerhk: throw away idle value 0x%x\n", keycode); -+ return validkey; -+} -+ -+static void send_key_event(t_key_names key) -+{ -+ unsigned int input_key; -+ if (key != k_none) { -+ /* convert key name to kernel keycode */ -+ input_key = acerhk_name2event[key]; -+ if (verbose > 2) -+ printk(KERN_INFO"acerhk: translated acer key name 0x%x to input key 0x%x\n", -+ key, input_key); -+ /* send press and release together, as there is no such event from acer as 'release' */ -+ input_report_key(acerhk_input_dev_ptr, input_key, 1); -+ input_report_key(acerhk_input_dev_ptr, input_key, 0); -+ } -+} -+ -+static t_key_names transl8_key_code(int keycode) -+{ -+ t_key_names keyname = k_none; -+ /* first filter out idle values */ -+ if ( (keycode = filter_idle_value(keycode)) ) { -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: received key code 0x%x\n", keycode); -+ /* translate keycode to key name */ -+ if (keycode >= 0 && keycode <= 255) -+ keyname = acerhk_key2name[keycode]; -+ else { -+ if (verbose > 3) -+ printk(KERN_INFO"acerhk: keycode 0x%x too big, will use only 8 bits\n", keycode); -+ /* use only lower 8 bits of value to distinguish keys */ -+ keyname = acerhk_key2name[keycode&0xff]; -+ } -+ /* produce some log information for higher verbosity levels */ -+ if (keyname != k_none && verbose > 2) -+ printk(KERN_INFO"acerhk: translated acer key code 0x%x to key name 0x%x\n", -+ keycode, keyname); -+ else if (keyname == k_none && verbose > 3) -+ printk(KERN_INFO"acerhk: translated acer key code 0x%x to no key\n", -+ keycode); -+ if (autowlan) { -+ /* if automatic switching of wlan hardware is enabled, do it here -+ on wireless key press */ -+ if (keyname == k_wireless2) { -+ if (acerhk_bluetooth_state) -+ wbutton_fct_1(0); -+ else -+ wbutton_fct_1(1); -+ } -+ if (keyname == k_wireless) { -+ if (acerhk_wlan_state) -+ wbutton_fct_2(0); -+ else -+ wbutton_fct_2(1); -+ } -+ } -+ } -+ return keyname; -+} -+ -+/* polling timer handler */ -+static void acerhk_poll_event(unsigned long save_size) -+{ -+#ifndef DUMMYHW -+ unsigned int max = MAX_POLLING_LOOPS; -+ /* make sure not to loop more then 32 times */ -+ if (!max || max > 32) -+ max = 32; -+ if (acerhk_type != TM_dritek) { -+ while (get_nr_events() && max--) { -+ send_key_event(transl8_key_code(get_fnkey_event())); -+ } -+ } else { -+ send_key_event(transl8_key_code(get_fnkey_event())); -+ } -+#endif -+ acerhk_timer_poll.expires = jiffies + acerhk_polling_delay; -+ add_timer(&acerhk_timer_poll); -+} -+ -+/* blinking timer handler; added by Antonio Cuni */ -+static void acerhk_blink_event(unsigned long not_used) -+{ -+ if (acerhk_blueled_blinking != -1) { -+ acerhk_blueled_blinking = !acerhk_blueled_blinking; -+#ifndef DUMMYHW -+ wbutton_fct_1(acerhk_blueled_blinking); -+#endif -+ acerhk_timer_blinking.expires = jiffies + acerhk_blueled_blinking_delay; -+ add_timer(&acerhk_timer_blinking); -+ } -+ else -+ printk(KERN_WARNING "acerhk: blinking event called, but blinking not active\n"); -+} -+ -+static void init_input(void) -+{ -+ int i; -+ -+#ifndef KERNEL26 -+ /* request keyboard input module */ -+ request_module("keybdev"); -+ if (verbose > 3) -+ printk(KERN_INFO"requested keyboard input driver\n"); -+#endif -+ -+#ifndef STATIC_INPUT_DEV -+ /* allocate acerhk input device */ -+ acerhk_input_dev_ptr=input_allocate_device(); -+ /* enter some name */ -+ acerhk_input_dev_ptr->name = "Acer hotkey driver"; -+#else -+ acerhk_input_dev_ptr=&acerhk_input_dev; -+#endif -+ -+ /* some laptops have a mail led, should I announce it here? */ -+ acerhk_input_dev_ptr->evbit[0] = BIT(EV_KEY); -+ /* announce keys to input system -+ * the generated keys can be changed on runtime, -+ * but to publish those changes the device needs to -+ * get reconnected (I dont't know any other way) -+ * Therefore I enable all possible keys */ -+ for (i = KEY_RESERVED; i < BTN_MISC; i++) -+ set_bit(i, acerhk_input_dev_ptr->keybit); -+ /* set mapping keyname -> input event */ -+ init_keymap_input(); -+ if (verbose) -+ printk(KERN_INFO"acerhk: registered input device\n"); -+ input_register_device(acerhk_input_dev_ptr); -+ init_timer(&acerhk_timer_poll); -+ acerhk_polling_state = 0; -+} -+ -+static void stop_polling(void) -+{ -+ if (acerhk_polling_state == 1) { -+ del_timer(&acerhk_timer_poll); -+ if (verbose) -+ printk(KERN_INFO"acerhk: key polling stopped\n"); -+ acerhk_polling_state = 0; -+ } else -+ if (verbose) -+ printk(KERN_INFO"acerhk: key polling not active\n"); -+} -+ -+static void start_polling(void) -+{ -+ if (acerhk_polling_state != 1) { -+ acerhk_timer_poll.function = acerhk_poll_event; -+ acerhk_timer_poll.expires = jiffies + acerhk_polling_delay; -+ acerhk_timer_poll.data = get_nr_events(); -+ add_timer(&acerhk_timer_poll); -+ acerhk_polling_state = 1; -+ if (acerhk_type == TM_dritek) { -+ printk(KERN_INFO"acerhk: Your hardware does not need polling enabled for hotkeys to work, " -+ "you can safely disable polling by using the module parameter poll=0 (unless you " -+ "want to play around with the driver and see if there are buttons which need polling).\n"); -+ } -+ if (verbose) -+ printk(KERN_INFO"acerhk: starting key polling, every %d ms\n", acerhk_polling_delay); -+ } else -+ if (verbose) -+ printk(KERN_INFO"acerhk: key polling already active\n"); -+} -+ -+/* addedd by Antonio Cuni */ -+static void start_blinking(void) -+{ -+ if (acerhk_blueled_blinking == -1) { -+ // blinking was disabled... enable it! -+ acerhk_timer_blinking.function = acerhk_blink_event; -+ acerhk_timer_blinking.expires = jiffies + acerhk_blueled_blinking_delay; -+ acerhk_timer_blinking.data = 0; // not used -+ add_timer(&acerhk_timer_blinking); -+ acerhk_blueled_blinking = 0; -+ if (verbose) -+ printk(KERN_INFO "acerhk: starting blueled blinking\n"); -+ } else -+ if (verbose) -+ printk(KERN_INFO "acerhk: blueled already blinking\n"); -+} -+ -+/* Added by Antonio Cuni */ -+static void stop_blinking(void) -+{ -+ if (acerhk_blueled_blinking != -1) { -+ del_timer(&acerhk_timer_blinking); -+ if (verbose) -+ printk(KERN_INFO "acerhk: blueled blinking stopped\n"); -+ acerhk_blueled_blinking = -1; -+ } -+} -+ -+static void release_input(void) -+{ -+ stop_polling(); -+ input_unregister_device(acerhk_input_dev_ptr); -+} -+ -+/* }}} */ -+ -+/* {{{ procfs functions */ -+ -+#ifndef CONFIG_PROC_FS -+ -+static int acerhk_proc_init(void) -+{ -+ return 1; -+} -+#else -+ -+/* This macro frees the machine specific function from bounds checking and -+ * things like that... */ -+#define PRINT_PROC(fmt,args...) \ -+ do { \ -+ *len += sprintf( buffer+*len, fmt, ##args ); \ -+ if (*begin + *len > offset + size) \ -+ return( 0 ); \ -+ if (*begin + *len < offset) { \ -+ *begin += *len; \ -+ *len = 0; \ -+ } \ -+ } while(0) -+ -+static int pc_proc_infos( char *buffer, int *len, -+ off_t *begin, off_t offset, int size ) -+{ -+ PRINT_PROC( "Acer hotkeys version %s\n", ACERHK_VERSION); -+ PRINT_PROC( "Model(Type)\t: %s(", acerhk_model_string); -+ switch(acerhk_type) { -+ default: -+ PRINT_PROC( "unknown)\n"); -+ break; -+ case TM_old: -+ PRINT_PROC( "old)\n"); -+ break; -+ case TM_new: -+ PRINT_PROC( "new)\n"); -+ break; -+ case TM_dritek: -+ PRINT_PROC( "Dritek)\n"); -+ break; -+ } -+ if (bios_routine != 0) { -+ PRINT_PROC( "request handler\t: 0x%x\n", bios_routine); -+ if (cmos_index) { -+ PRINT_PROC( "CMOS index\t: 0x%x\n", cmos_index); -+ PRINT_PROC( "events pending\t: %u\n", get_nr_events()); -+ } else { -+ PRINT_PROC( "CMOS index\t: not available\n"); -+ } -+ if (acerhk_polling_state == 1) -+ PRINT_PROC( "kernel polling\t: active\n"); -+ else -+ PRINT_PROC( "kernel polling\t: inactive\n"); -+ PRINT_PROC( "autoswitch wlan\t: "); -+ if (autowlan == 1) -+ PRINT_PROC( "enabled\n"); -+ else -+ PRINT_PROC( "disabled\n"); -+ } else { -+ PRINT_PROC( "request handler\t: not found\n"); -+ PRINT_PROC( "kernel polling\t: not possible\n"); -+ } -+ /* model specific infos */ -+ if (acerhk_type == TM_dritek) { -+ PRINT_PROC( "use of Dritek EC: "); -+ if (usedritek) -+ PRINT_PROC( "enabled\n"); -+ else -+ PRINT_PROC( "disabled\n"); -+ } -+ if (acerhk_type == TM_old) -+ PRINT_PROC( "preg400\t\t: 0x%p\n", preg400); -+ return (1); -+} -+ -+static int acerhk_proc_info( char *buffer, char **start, off_t offset, -+ int size, int *eof, void *data ) -+{ -+ int len = 0; -+ off_t begin = 0; -+ -+ *eof = pc_proc_infos( buffer, &len, &begin, offset, size ); -+ -+ if (offset >= begin + len) -+ return( 0 ); -+ *start = buffer + (offset - begin); -+ return( size < begin + len - offset ? size : begin + len - offset ); -+ -+} -+ -+static int acerhk_proc_key( char *buffer, char **start, off_t offset, -+ int size, int *eof, void *data ) -+{ -+ if (size >= 5 && offset == 0) { -+ if (acerhk_type == TM_dritek || acerhk_polling_state == 1) { -+ snprintf(buffer+offset, size, "n/a\n"); -+ } else { -+ snprintf(buffer+offset, size, "0x%02x\n", filter_idle_value(get_fnkey_event())); -+ } -+ *eof = 1; -+ return 5; -+ } -+ *eof = 1; -+ return 0; -+} -+ -+static int acerhk_proc_led(struct file* file, const char* buffer, -+ unsigned long count, void* data) -+{ -+ char str[4]; -+ int len; -+ if (count > 4) -+ len = 4; -+ else -+ len = count; -+ if (copy_from_user(str, buffer, len)) -+ return -EFAULT; -+ str[3] = '\0'; -+ if ( ( (len >= 2) && (!strncmp(str, "on", 2) || !strncmp(str, "an", 2)) ) -+ || str[0] == '1') -+ set_mail_led(1); -+ else -+ set_mail_led(0); -+ return len; -+} -+ -+static int acerhk_proc_wirelessled(struct file* file, const char* buffer, -+ unsigned long count, void* data) -+{ -+ char str[4]; -+ int len; -+ if (count > 4) -+ len = 4; -+ else -+ len = count; -+ if (copy_from_user(str, buffer, len)) -+ return -EFAULT; -+ str[3] = '\0'; -+ if ( ( (len >= 2) && (!strncmp(str, "on", 2) || !strncmp(str, "an", 2)) ) -+ || str[0] == '1') { -+ if (acerhk_model_features & TM_F_WLAN_EC1) -+ enable_wlan_ec_1(); -+ else if (acerhk_model_features & TM_F_WLAN_EC2) -+ enable_wlan_ec_2(); -+ else -+ wbutton_fct_2(1); -+ } -+ else { -+ if (acerhk_model_features & TM_F_WLAN_EC1) -+ disable_wlan_ec_1(); -+ else if (acerhk_model_features & TM_F_WLAN_EC2) -+ disable_wlan_ec_2(); -+ else -+ wbutton_fct_2(0); -+ } -+ return len; -+} -+ -+ -+/* Modified by Antonio Cuni: added support for blinking -+ possible values: -+ - off, 0: led always off -+ - on, an, 1: led alway on -+ - n (a number): led blinking; n is the delay between -+ two changes of state, in jiffies; n must -+ be > 50, to prevent the user from overloading -+ the kernel. -+ -+ */ -+static int acerhk_proc_blueled(struct file* file, const char* buffer, -+ unsigned long count, void* data) -+{ -+ const int MAXLEN=11; -+ char str[MAXLEN]; -+ int len; -+ int isNumber; -+ -+ if (count > MAXLEN) -+ len = MAXLEN; -+ else -+ len = count; -+ if (copy_from_user(str, buffer, len)) -+ return -EFAULT; -+ str[MAXLEN - 1] = '\0'; -+ -+ /* try to parse a number */ -+ isNumber = sscanf(str, "%u", &acerhk_blueled_blinking_delay); -+ /* if the delay is 0, turn off the led */ -+ if (isNumber && acerhk_blueled_blinking_delay != 0 && acerhk_blueled_blinking_delay != 1) { -+ if (acerhk_blueled_blinking_delay < 50) -+ printk(KERN_INFO"acerhk: blinking request rejected. The delay must be > 50.\n"); -+ else { -+ if (verbose) -+ printk(KERN_INFO"acerhk: blinking delay set to %u.\n", acerhk_blueled_blinking_delay); -+ start_blinking(); -+ } -+ } else if (acerhk_blueled_blinking_delay == 1 || !strncmp(str, "on", 2) || !strncmp(str, "an", 2)) { -+ stop_blinking(); -+ if (acerhk_model_features & TM_F_BLUE_EC1) -+ enable_bluetooth_ec_1(); -+ else if (acerhk_model_features & TM_F_BLUE_EC2) -+ enable_bluetooth_ec_2(); -+ else -+ wbutton_fct_1(1); -+ } else { -+ /* it's 0 or everything else */ -+ stop_blinking(); -+ if (acerhk_model_features & TM_F_BLUE_EC1) -+ disable_bluetooth_ec_1(); -+ else if (acerhk_model_features & TM_F_BLUE_EC2) -+ disable_bluetooth_ec_2(); -+ else -+ wbutton_fct_1(0); -+ } -+ return len; -+} -+ -+#ifdef ACERDEBUG -+static void do_debug(const char* buffer, unsigned long len) -+{ -+ unsigned int h, i; -+ switch (buffer[0]) { -+ case 'b': -+ /* test WLAN on TM 4001 */ -+ switch (buffer[1]) { -+ case '0': -+ disable_wlan_ec_1(); -+ break; -+ case '1': -+ default: -+ enable_wlan_ec_1(); -+ } -+ break; -+ case 'B': -+ /* test BLUETOOTH on TM 4001 */ -+ switch (buffer[1]) { -+ case '0': -+ disable_bluetooth_ec_1(); -+ break; -+ case '1': -+ default: -+ enable_bluetooth_ec_1(); -+ } -+ break; -+ case 'D': -+ /* test "DMM Function Enabled" entry of TM 4150/4650 */ -+ enable_dmm_function(); -+ break; -+ case 'i': -+ case '1': -+#ifndef KERNEL26 -+ MOD_INC_USE_COUNT; -+#endif -+ break; -+ case 'e': -+ switch (buffer[1]) { -+ case '1': -+ start_polling(); -+ break; -+ default: -+ stop_polling(); -+ } -+ break; -+ case 'k': -+ for (i = 0; i <= 255;i++) { -+ input_report_key(acerhk_input_dev_ptr, i, 1); -+ input_report_key(acerhk_input_dev_ptr, i, 0); -+ } -+ break; -+ case 'm': -+ /* set mapping key names -> input events */ -+ sscanf(&buffer[2],"%x", &i); -+ h = buffer[1] - '0' + 1; -+ printk("acerhk: key name %x maps to %x\n", h, i); -+ acerhk_name2event[h] = i; -+ break; -+ case 'M': -+ /* test mute LED on dritek hardware */ -+ switch (buffer[1]) { -+ case '0': -+ disable_mute_led_ec(); -+ break; -+ case '1': -+ default: -+ enable_mute_led_ec(); -+ } -+ break; -+ case 'p': -+ printk("acerhk: pbutton = 0x%x\n", pbutton_fct()); -+ break; -+ case 's': -+ /* send key event to test the key translation in input system */ -+ sscanf(&buffer[1],"%x", &h); -+ printk("acerhk: sending key event 0x%x\n", h); -+ input_report_key(acerhk_input_dev_ptr, h, 1); -+ input_report_key(acerhk_input_dev_ptr, h, 0); -+ break; -+ case 'S': -+ /* simulate key codes to test the key translation in acerhk */ -+ sscanf(&buffer[1],"%x", &h); -+ send_key_event(transl8_key_code(h)); -+ break; -+ case 't': -+ printk("acerhk: thermal event = 0x%x\n", get_thermal_event()); -+ break; -+ case 'w': -+ /* test the wbutton functions, someone really needs to have another look -+ at the windows driver */ -+ switch (buffer[1]) { -+ case '2': -+ printk("acerhk: wbutton_2(%d) = 0x%x\n", buffer[2]-'0', wbutton_fct_2(buffer[2]-'0')); -+ break; -+ case '1': -+ default: -+ printk("acerhk: wbutton_1(%d) = 0x%x\n", buffer[2]-'0', wbutton_fct_1(buffer[2]-'0')); -+ } -+ break; -+ case 'W': -+ /* test wireless HW/LED on some models using dritek hardware */ -+ switch (buffer[1]) { -+ case '0': -+ disable_wireless_ec(); -+ break; -+ case '1': -+ default: -+ enable_wireless_ec(); -+ } -+ break; -+ case 'v': -+ verbose = buffer[1]-'0'; -+ printk("acerhk: verbosity level changed to %d\n", verbose); -+ break; -+ case 'd': -+ case '0': -+ default: -+#ifndef KERNEL26 -+ MOD_DEC_USE_COUNT; -+#endif -+ break; -+ } -+} -+ -+static int acerhk_proc_debug(struct file* file, const char* buffer, -+ unsigned long count, void* data) -+{ -+ char str[5]; -+ int len; -+ if (count > 5) -+ len = 5; -+ else -+ len = count; -+ if (copy_from_user(str, buffer, len)) -+ return -EFAULT; -+ str[4] = '\0'; -+ do_debug(str, len); -+ return len; -+} -+#endif -+ -+static int acerhk_proc_init(void) -+{ -+ int retval; -+ struct proc_dir_entry *entry; -+ /* create own directory */ -+ proc_acer_dir = proc_mkdir("driver/acerhk", NULL); -+ if (proc_acer_dir == NULL) { -+ retval = 0; -+ printk(KERN_INFO"acerhk: could not create /proc/driver/acerhk\n"); -+ } -+ else { -+ proc_acer_dir->owner = THIS_MODULE; -+ /* now create several files, first general info ... */ -+ entry = create_proc_read_entry("info", -+ 0444, proc_acer_dir, acerhk_proc_info, NULL); -+ if (entry == NULL) { -+ printk(KERN_INFO"acerhk: cannot create info file\n"); -+ remove_proc_entry("driver/acerhk", NULL); -+ retval = 0; -+ } else { -+ entry->owner = THIS_MODULE; -+ /* ... last pressed key ... */ -+ entry = create_proc_read_entry("key", -+ 0444, proc_acer_dir, acerhk_proc_key, NULL); -+ if (entry == NULL) { -+ printk(KERN_INFO"acerhk: cannot create key file\n"); -+ remove_proc_entry("info", proc_acer_dir); -+ remove_proc_entry("driver/acerhk", NULL); -+ retval = 0; -+ } else { -+ entry->owner = THIS_MODULE; -+ /* ... and led control file */ -+ entry = create_proc_entry("led", 0222, proc_acer_dir); -+ if (entry == NULL) { -+ printk(KERN_INFO"acerhk: cannot create LED file\n"); -+ remove_proc_entry("info", proc_acer_dir); -+ remove_proc_entry("key", proc_acer_dir); -+ remove_proc_entry("driver/acerhk", NULL); -+ retval = 0; -+ } -+ else { -+ entry->write_proc = acerhk_proc_led; -+ entry->owner = THIS_MODULE; -+ /* ... and wireless led controll file */ -+ entry = create_proc_entry("wirelessled", 0222, proc_acer_dir); -+ if (entry == NULL) { -+ printk(KERN_INFO"acerhk: cannot create wirelessled file\n"); -+ remove_proc_entry("info", proc_acer_dir); -+ remove_proc_entry("key", proc_acer_dir); -+ remove_proc_entry("led", proc_acer_dir); -+ remove_proc_entry("driver/acerhk", NULL); -+ retval = 0; -+ } -+ else { -+ entry->write_proc = acerhk_proc_wirelessled; -+ entry->owner = THIS_MODULE; -+ /* ... and bluetooth led controll file */ -+ entry = create_proc_entry("blueled", 0222, proc_acer_dir); -+ if (entry == NULL) { -+ printk(KERN_INFO"acerhk: cannot create blueled file\n"); -+ remove_proc_entry("info", proc_acer_dir); -+ remove_proc_entry("key", proc_acer_dir); -+ remove_proc_entry("led", proc_acer_dir); -+ remove_proc_entry("wirelessled", proc_acer_dir); -+ remove_proc_entry("driver/acerhk", NULL); -+ retval = 0; -+ } else { -+ entry->write_proc = acerhk_proc_blueled; -+ entry->owner = THIS_MODULE; -+ retval = 1; -+#ifdef ACERDEBUG -+ /* add extra file for debugging purposes */ -+ entry = create_proc_entry("debug", 0222, proc_acer_dir); -+ if (entry == NULL) { -+ printk(KERN_INFO"acerhk: cannot create debug file\n"); -+ remove_proc_entry("info", proc_acer_dir); -+ remove_proc_entry("key", proc_acer_dir); -+ remove_proc_entry("led", proc_acer_dir); -+ remove_proc_entry("wirelessled", proc_acer_dir); -+ remove_proc_entry("blueled", proc_acer_dir); -+ remove_proc_entry("driver/acerhk", NULL); -+ retval = 0; -+ } -+ else { -+ entry->write_proc = acerhk_proc_debug; -+ entry->owner = THIS_MODULE; -+ retval = 1; -+ } -+#endif -+ } -+ } -+ } -+ } -+ } -+ } -+ return retval; -+} -+ -+static void acerhk_proc_cleanup(void) -+{ -+ if (proc_acer_dir) { -+ remove_proc_entry("info", proc_acer_dir); -+ /* On dritek type hardware key file is already removed */ -+ if (acerhk_type != TM_dritek) -+ remove_proc_entry("key", proc_acer_dir); -+ remove_proc_entry("led", proc_acer_dir); -+ remove_proc_entry("wirelessled", proc_acer_dir); -+ remove_proc_entry("blueled", proc_acer_dir); -+#ifdef ACERDEBUG -+ remove_proc_entry("debug", proc_acer_dir); -+#endif -+ remove_proc_entry("driver/acerhk", NULL); -+ proc_acer_dir = NULL; -+ } -+} -+ -+#endif /* CONFIG_PROC_FS */ -+ -+/* }}} */ -+ -+/* {{{ file operations */ -+ -+static int acerhk_ioctl( struct inode *inode, struct file *file, -+ unsigned int cmd, unsigned long arg ) -+{ -+ int retval; -+ switch( cmd ) { -+ case ACERHK_GET_KEYCOUNT: -+ { -+ char nr; -+ nr = get_nr_events(); -+ put_user(nr, (char*)arg); -+ retval = 0; -+ break; -+ } -+ case ACERHK_GET_KEYID: -+ { -+ char id; -+ id = get_fnkey_event(); -+ put_user(id, (char*)arg); -+ retval = 0; -+ break; -+ } -+ case ACERHK_CONNECT: -+ launch_connect(1); -+ retval = 0; -+ break; -+ case ACERHK_START_POLLING: -+ start_polling(); -+ retval = 0; -+ break; -+ case ACERHK_STOP_POLLING: -+ stop_polling(); -+ retval = 0; -+ break; -+ case ACERHK_DISCONNECT: -+ launch_connect(0); -+ retval = 0; -+ break; -+ case ACERHK_GET_THERMAL_EVENT: -+ { -+ short event; -+ event = get_thermal_event(); -+ put_user(event, (short*)arg); -+ retval = 0; -+ break; -+ } -+ case ACERHK_MAIL_LED_OFF: -+ set_mail_led(0); -+ retval = 0; -+ break; -+ case ACERHK_MAIL_LED_ON: -+ set_mail_led(1); -+ retval = 0; -+ break; -+ case ACERHK_GET_KEY_MAP: -+ if (copy_to_user((t_map_name2event*)arg, &acerhk_name2event, sizeof(acerhk_name2event))) -+ retval = -EFAULT; -+ else -+ retval = 0; -+ break; -+ case ACERHK_SET_KEY_MAP: -+ if (copy_from_user(&acerhk_name2event, (t_map_name2event*)arg, sizeof(acerhk_name2event))) -+ retval = -EFAULT; -+ else { -+ if (verbose) { -+ printk(KERN_INFO"acerhk: changed key mapping\n"); -+ print_mapping(); -+ } -+ retval = 0; -+ } -+ break; -+ default: -+ retval = -EINVAL; -+ } -+ return retval; -+} -+ -+#ifdef ACERDEBUG -+static ssize_t acerhk_write (struct file* file, const char* buffer, size_t length, loff_t* offset) -+{ -+ if (length) -+ do_debug(buffer, length); -+ return length; -+} -+#endif -+ -+static int acerhk_open( struct inode *inode, struct file *file ) -+{ -+ return 0; -+} -+ -+static int acerhk_release( struct inode *inode, struct file *file ) -+{ -+ return 0; -+} -+ -+static struct file_operations acerhk_fops = { -+ owner: THIS_MODULE, -+ ioctl: acerhk_ioctl, -+ open: acerhk_open, -+#ifdef ACERDEBUG -+ write: acerhk_write, -+#endif -+ release: acerhk_release, -+}; -+ -+static struct miscdevice acerhk_dev = { -+ MISC_DYNAMIC_MINOR, -+ "acerhk", -+ &acerhk_fops -+}; -+ -+/* }}} */ -+ -+static void __init model_init(void) -+{ -+ /* set callroutine, features and keymap for model */ -+ setup_model_features(acerhk_series); -+ /* override initial state of wireless hardware if specified by module options */ -+ if (wlan_state >= 0) acerhk_wlan_state = wlan_state; -+ if (bluetooth_state >= 0) acerhk_bluetooth_state = bluetooth_state; -+ /* Launch connect only if available */ -+ if (acerhk_model_features & TM_F_CONNECT) { -+ if (verbose) -+ printk(KERN_INFO"acerhk: Model type %d, calling launch_connect(1)\n", -+ acerhk_type); -+ launch_connect(1); -+ } -+ if ( acerhk_type != TM_dritek ) { -+ get_cmos_index(); -+ } -+ if ( acerhk_type == TM_dritek ) { -+ enable_dritek_keyboard(); -+ } -+ /* added by Antonio Cuni */ -+ init_timer(&acerhk_timer_blinking); -+} -+ -+ -+static void __exit acerhk_cleanup_module (void); -+static int __init acerhk_init(void) -+{ -+ int ret; -+ -+ ret = misc_register( &acerhk_dev ); -+ if (ret) { -+ printk(KERN_ERR "acerhk: can't misc_register on minor=%d\n", ACERHK_MINOR); -+ ret = -EAGAIN; -+ } -+ else if (!acerhk_proc_init()) { -+ printk(KERN_ERR "acerhk: can't create procfs entries\n"); -+ ret = -ENOMEM; -+ misc_deregister( &acerhk_dev ); -+ } -+ else { -+ reg1 = ioremap(0xf0000, 0xffff); -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: area from 0xf000 to 0xffff mapped to %p\n", reg1); -+ reg2 = ioremap(0xe0000, 0xffff); -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: area from 0xe000 to 0xffff mapped to %p\n", reg2); -+ /* the area 0x400 is used as data area by earlier (520) series */ -+ preg400 = ioremap(0x400, 0xfff); -+ if (verbose > 1) -+ printk(KERN_INFO"acerhk: area from 0x400 to 0x13ff mapped to %p\n", preg400); -+ /* attach to input system */ -+ init_input(); -+ memset(acerhk_model_string, 0x00, ACERHK_MODEL_STRLEN); -+#ifdef DUMMYHW -+ acerhk_model_addr = (void*)0x12345678; -+ /* copy the string, but not more than 15 characters */ -+ strncpy(acerhk_model_string, "TravelmateDummy", ACERHK_MODEL_STRLEN-1); -+ /* set callroutine for model */ -+ if (force_series) -+ acerhk_series = force_series; -+ else -+ acerhk_series = 2000; -+ setup_model_features(acerhk_series); -+ printk(KERN_INFO "Acer Travelmate hotkey driver v" ACERHK_VERSION " dummy\n"); -+ if ( acerhk_type == TM_dritek ) -+ enable_dritek_keyboard(); -+ if (poll) -+ start_polling(); -+ init_timer(&acerhk_timer_blinking); -+#else -+ bios_routine = find_hk_area(); -+ if (!force_series) -+ probe_model(); -+ else { -+ if (verbose) -+ printk(KERN_INFO"acerhk: forced laptop series to %d\n", force_series); -+ acerhk_series = force_series; -+ } -+ /* do model specific initialization */ -+ model_init(); -+ /* Without a bios routine we cannot do anything except on dritek -+ type HW, unload on other types */ -+ if (bios_routine || (acerhk_type == TM_dritek)) { -+ ret = 0; -+ if (verbose && bios_routine) -+ printk(KERN_INFO"acerhk: bios routine found at 0x%x\n", bios_routine); -+ printk(KERN_INFO "Acer Travelmate hotkey driver v" ACERHK_VERSION "\n"); -+ /* If automatic switching of wlan is wanted but polling is disabled, -+ automatically enable it */ -+ if (!poll && autowlan) { -+ printk(KERN_INFO "Automatic switching of wireless hardware needs polling, enabling it\n"); -+ poll = 1; -+ } -+ /* start automatic polling of key presses if wanted and bios routine found */ -+ if (poll && bios_routine) -+ start_polling(); -+ } else { -+ printk(KERN_ERR "acerhk: can't find bios routine, cannot do anything for you, sorry!\n"); -+ ret = -ENOMEM; -+ acerhk_cleanup_module(); -+ } -+#endif -+ } -+ return ret; -+} -+ -+static void __exit acerhk_cleanup_module (void) -+{ -+ acerhk_proc_cleanup(); -+ stop_blinking(); -+ if (reg1) -+ iounmap(reg1); -+ if (reg2) -+ iounmap(reg2); -+ if (preg400) -+ iounmap(preg400); -+ release_input(); -+ misc_deregister( &acerhk_dev ); -+ if ( acerhk_type == TM_dritek ) { -+ disable_dritek_keyboard(); -+ } -+ if (verbose > 2) -+ printk(KERN_INFO "acerhk: unloaded\n"); -+} -+ -+module_init(acerhk_init); -+module_exit(acerhk_cleanup_module); -+ -+MODULE_AUTHOR("Olaf Tauber"); -+MODULE_DESCRIPTION("AcerHotkeys extra buttons keyboard driver"); -+MODULE_LICENSE("GPL"); -+ -+#ifndef KERNEL26 -+EXPORT_NO_SYMBOLS; -+#endif -+ -+#else -+#error This driver is only available for X86 architecture -+#endif -+/* -+ * Local variables: -+ * c-indent-level: 4 -+ * tab-width: 4 -+ * End: -+ */ -+ -diff -Nurp linux-2.6.37/3rdparty/acerhk/acerhk.h linux-2.6.37.3rdparty/3rdparty/acerhk/acerhk.h ---- linux-2.6.37/3rdparty/acerhk/acerhk.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/acerhk.h 2005-06-17 00:10:12.000000000 +0300 -@@ -0,0 +1,91 @@ -+#ifndef __ACERHK_H__ -+#define __ACERHK_H__ -+ -+#include -+ -+#define ACERHK_MINOR MISC_DYNAMIC_MINOR -+ -+#define ACERHK_GET_KEYCOUNT _IOR('p', 0x01, char) /* Get number of cached key presses */ -+#define ACERHK_GET_KEYID _IOR('p', 0x02, char) /* Get first key in queue */ -+#define ACERHK_CONNECT _IO('p', 0x03) /* ? */ -+#define ACERHK_DISCONNECT _IO('p', 0x04) /* ? */ -+#define ACERHK_GET_THERMAL_EVENT _IOR('p', 0x05, short) /* ? */ -+#define ACERHK_MAIL_LED_OFF _IO('p', 0x10) /* switch mail LED off */ -+#define ACERHK_MAIL_LED_ON _IO('p', 0x11) /* switch mail LED on (blinking) */ -+#define ACERHK_START_POLLING _IO('p', 0x12) /* poll keys in kernel, send real key events */ -+#define ACERHK_STOP_POLLING _IO('p', 0x13) /* stop key polling in kernel */ -+#define ACERHK_GET_KEY_MAP _IOR('p', 0x20, int) /* Get mapping of key names to key events, */ -+#define ACERHK_SET_KEY_MAP _IOW('p', 0x21, int) /* Set mapping of key names to key events */ -+ -+/* all possible keys (known to me) */ -+typedef enum e_key_names { -+ k_none = 0, -+ k_help = 1, /* Fn+F1 */ -+ k_setup = 2, /* Fn+F2 */ -+ k_p1 = 3, -+ k_p2 = 4, -+ k_p3 = 5, -+ k_www = 6, -+ k_mail = 7, -+ k_wireless = 8, -+ k_power = 9, /* Fn+F3 */ -+ k_mute = 10, /* Fn+F8 */ -+ k_volup = 11, /* Fn+Up */ -+ k_voldn = 12, /* Fn+Down */ -+ k_res = 13, /* resolution change on Medion MD 40100 */ -+ k_close = 14, /* if lid is closed in tablet mode */ -+ k_open = 15, /* if lid is opend in tablet mode */ -+ k_wireless2 = 16, /* second wireless button on TM 243LC */ -+ k_play = 17, /* Play/Pause found on AOpen */ -+ k_stop = 18, /* Stop/Eject found on AOpen */ -+ k_prev = 19, /* Prev found on AOpen */ -+ k_next = 20, /* Next found on AOpen */ -+ k_display = 21 /* Change internal/external display on MD 42200 */ -+} t_key_names; -+#define NR_KEY_NAMES 22 -+typedef unsigned int t_map_name2event[NR_KEY_NAMES]; -+ -+#ifdef __KERNEL__ -+ -+/* available features */ -+#define TM_F_WLAN_EC1 0x00000010 -+#define TM_F_BLUE_EC1 0x00000020 -+#define TM_F_WLAN_EC2 0x00000040 -+#define TM_F_BLUE_EC2 0x00000080 -+#define TM_F_MUTE_LED_EC 0x00001000 -+#define TM_F_MAIL_LED 0x00010000 -+#define TM_F_MAIL_LED_EC 0x00020000 -+#define TM_F_MAIL_LED_EC2 0x00040000 -+#define TM_F_MAIL_LED_EC3 0x00080000 -+ -+#define TM_F_CONNECT 0x00100000 -+#define TM_F_THERMAL 0x00200000 -+#define TM_F_PBUTTON 0x00400000 -+#define TM_F_WBUTTON 0x00800000 -+ -+typedef enum acer_type { -+ TM_unknown, -+ /* 200, 210, 520, 600 and 730 series, Medion MD42200 */ -+ TM_old, -+ /* C100, C110, 220, 230, 240, 260, 350, 360, 610, 620, 630, 740 series -+ Medion MD40100, Aspire 1600, FS Amilo */ -+ TM_new, -+ /* Aspire 13xx, 14xx, 1700, TM 290, 650, 660, 800 */ -+ TM_dritek -+} t_acer_type; -+ -+struct register_buffer { -+ unsigned int eax; -+ unsigned int ebx; -+ unsigned int ecx; -+ unsigned int edx; -+ unsigned int edi; -+ unsigned int esi; -+ unsigned int ebp; -+}; -+ -+typedef asmlinkage void (*bios_call) (struct register_buffer *); -+ -+#endif -+ -+#endif -diff -Nurp linux-2.6.37/3rdparty/acerhk/AUTHORS linux-2.6.37.3rdparty/3rdparty/acerhk/AUTHORS ---- linux-2.6.37/3rdparty/acerhk/AUTHORS 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/AUTHORS 2006-11-10 00:02:55.000000000 +0200 -@@ -0,0 +1 @@ -+Olaf Tauber -\ Ingen nyrad vid filslut -diff -Nurp linux-2.6.37/3rdparty/acerhk/COPYING linux-2.6.37.3rdparty/3rdparty/acerhk/COPYING ---- linux-2.6.37/3rdparty/acerhk/COPYING 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/COPYING 2002-05-08 22:01:52.000000000 +0300 -@@ -0,0 +1,340 @@ -+ GNU GENERAL PUBLIC LICENSE -+ Version 2, June 1991 -+ -+ Copyright (C) 1989, 1991 Free Software Foundation, Inc. -+ 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ Everyone is permitted to copy and distribute verbatim copies -+ of this license document, but changing it is not allowed. -+ -+ Preamble -+ -+ The licenses for most software are designed to take away your -+freedom to share and change it. By contrast, the GNU General Public -+License is intended to guarantee your freedom to share and change free -+software--to make sure the software is free for all its users. This -+General Public License applies to most of the Free Software -+Foundation's software and to any other program whose authors commit to -+using it. (Some other Free Software Foundation software is covered by -+the GNU Library General Public License instead.) You can apply it to -+your programs, too. -+ -+ When we speak of free software, we are referring to freedom, not -+price. Our General Public Licenses are designed to make sure that you -+have the freedom to distribute copies of free software (and charge for -+this service if you wish), that you receive source code or can get it -+if you want it, that you can change the software or use pieces of it -+in new free programs; and that you know you can do these things. -+ -+ To protect your rights, we need to make restrictions that forbid -+anyone to deny you these rights or to ask you to surrender the rights. -+These restrictions translate to certain responsibilities for you if you -+distribute copies of the software, or if you modify it. -+ -+ For example, if you distribute copies of such a program, whether -+gratis or for a fee, you must give the recipients all the rights that -+you have. You must make sure that they, too, receive or can get the -+source code. And you must show them these terms so they know their -+rights. -+ -+ We protect your rights with two steps: (1) copyright the software, and -+(2) offer you this license which gives you legal permission to copy, -+distribute and/or modify the software. -+ -+ Also, for each author's protection and ours, we want to make certain -+that everyone understands that there is no warranty for this free -+software. If the software is modified by someone else and passed on, we -+want its recipients to know that what they have is not the original, so -+that any problems introduced by others will not reflect on the original -+authors' reputations. -+ -+ Finally, any free program is threatened constantly by software -+patents. We wish to avoid the danger that redistributors of a free -+program will individually obtain patent licenses, in effect making the -+program proprietary. To prevent this, we have made it clear that any -+patent must be licensed for everyone's free use or not licensed at all. -+ -+ The precise terms and conditions for copying, distribution and -+modification follow. -+ -+ GNU GENERAL PUBLIC LICENSE -+ TERMS AND CONDITIONS FOR COPYING, DISTRIBUTION AND MODIFICATION -+ -+ 0. This License applies to any program or other work which contains -+a notice placed by the copyright holder saying it may be distributed -+under the terms of this General Public License. The "Program", below, -+refers to any such program or work, and a "work based on the Program" -+means either the Program or any derivative work under copyright law: -+that is to say, a work containing the Program or a portion of it, -+either verbatim or with modifications and/or translated into another -+language. (Hereinafter, translation is included without limitation in -+the term "modification".) Each licensee is addressed as "you". -+ -+Activities other than copying, distribution and modification are not -+covered by this License; they are outside its scope. The act of -+running the Program is not restricted, and the output from the Program -+is covered only if its contents constitute a work based on the -+Program (independent of having been made by running the Program). -+Whether that is true depends on what the Program does. -+ -+ 1. You may copy and distribute verbatim copies of the Program's -+source code as you receive it, in any medium, provided that you -+conspicuously and appropriately publish on each copy an appropriate -+copyright notice and disclaimer of warranty; keep intact all the -+notices that refer to this License and to the absence of any warranty; -+and give any other recipients of the Program a copy of this License -+along with the Program. -+ -+You may charge a fee for the physical act of transferring a copy, and -+you may at your option offer warranty protection in exchange for a fee. -+ -+ 2. You may modify your copy or copies of the Program or any portion -+of it, thus forming a work based on the Program, and copy and -+distribute such modifications or work under the terms of Section 1 -+above, provided that you also meet all of these conditions: -+ -+ a) You must cause the modified files to carry prominent notices -+ stating that you changed the files and the date of any change. -+ -+ b) You must cause any work that you distribute or publish, that in -+ whole or in part contains or is derived from the Program or any -+ part thereof, to be licensed as a whole at no charge to all third -+ parties under the terms of this License. -+ -+ c) If the modified program normally reads commands interactively -+ when run, you must cause it, when started running for such -+ interactive use in the most ordinary way, to print or display an -+ announcement including an appropriate copyright notice and a -+ notice that there is no warranty (or else, saying that you provide -+ a warranty) and that users may redistribute the program under -+ these conditions, and telling the user how to view a copy of this -+ License. (Exception: if the Program itself is interactive but -+ does not normally print such an announcement, your work based on -+ the Program is not required to print an announcement.) -+ -+These requirements apply to the modified work as a whole. If -+identifiable sections of that work are not derived from the Program, -+and can be reasonably considered independent and separate works in -+themselves, then this License, and its terms, do not apply to those -+sections when you distribute them as separate works. But when you -+distribute the same sections as part of a whole which is a work based -+on the Program, the distribution of the whole must be on the terms of -+this License, whose permissions for other licensees extend to the -+entire whole, and thus to each and every part regardless of who wrote it. -+ -+Thus, it is not the intent of this section to claim rights or contest -+your rights to work written entirely by you; rather, the intent is to -+exercise the right to control the distribution of derivative or -+collective works based on the Program. -+ -+In addition, mere aggregation of another work not based on the Program -+with the Program (or with a work based on the Program) on a volume of -+a storage or distribution medium does not bring the other work under -+the scope of this License. -+ -+ 3. You may copy and distribute the Program (or a work based on it, -+under Section 2) in object code or executable form under the terms of -+Sections 1 and 2 above provided that you also do one of the following: -+ -+ a) Accompany it with the complete corresponding machine-readable -+ source code, which must be distributed under the terms of Sections -+ 1 and 2 above on a medium customarily used for software interchange; or, -+ -+ b) Accompany it with a written offer, valid for at least three -+ years, to give any third party, for a charge no more than your -+ cost of physically performing source distribution, a complete -+ machine-readable copy of the corresponding source code, to be -+ distributed under the terms of Sections 1 and 2 above on a medium -+ customarily used for software interchange; or, -+ -+ c) Accompany it with the information you received as to the offer -+ to distribute corresponding source code. (This alternative is -+ allowed only for noncommercial distribution and only if you -+ received the program in object code or executable form with such -+ an offer, in accord with Subsection b above.) -+ -+The source code for a work means the preferred form of the work for -+making modifications to it. For an executable work, complete source -+code means all the source code for all modules it contains, plus any -+associated interface definition files, plus the scripts used to -+control compilation and installation of the executable. However, as a -+special exception, the source code distributed need not include -+anything that is normally distributed (in either source or binary -+form) with the major components (compiler, kernel, and so on) of the -+operating system on which the executable runs, unless that component -+itself accompanies the executable. -+ -+If distribution of executable or object code is made by offering -+access to copy from a designated place, then offering equivalent -+access to copy the source code from the same place counts as -+distribution of the source code, even though third parties are not -+compelled to copy the source along with the object code. -+ -+ 4. You may not copy, modify, sublicense, or distribute the Program -+except as expressly provided under this License. Any attempt -+otherwise to copy, modify, sublicense or distribute the Program is -+void, and will automatically terminate your rights under this License. -+However, parties who have received copies, or rights, from you under -+this License will not have their licenses terminated so long as such -+parties remain in full compliance. -+ -+ 5. You are not required to accept this License, since you have not -+signed it. However, nothing else grants you permission to modify or -+distribute the Program or its derivative works. These actions are -+prohibited by law if you do not accept this License. Therefore, by -+modifying or distributing the Program (or any work based on the -+Program), you indicate your acceptance of this License to do so, and -+all its terms and conditions for copying, distributing or modifying -+the Program or works based on it. -+ -+ 6. Each time you redistribute the Program (or any work based on the -+Program), the recipient automatically receives a license from the -+original licensor to copy, distribute or modify the Program subject to -+these terms and conditions. You may not impose any further -+restrictions on the recipients' exercise of the rights granted herein. -+You are not responsible for enforcing compliance by third parties to -+this License. -+ -+ 7. If, as a consequence of a court judgment or allegation of patent -+infringement or for any other reason (not limited to patent issues), -+conditions are imposed on you (whether by court order, agreement or -+otherwise) that contradict the conditions of this License, they do not -+excuse you from the conditions of this License. If you cannot -+distribute so as to satisfy simultaneously your obligations under this -+License and any other pertinent obligations, then as a consequence you -+may not distribute the Program at all. For example, if a patent -+license would not permit royalty-free redistribution of the Program by -+all those who receive copies directly or indirectly through you, then -+the only way you could satisfy both it and this License would be to -+refrain entirely from distribution of the Program. -+ -+If any portion of this section is held invalid or unenforceable under -+any particular circumstance, the balance of the section is intended to -+apply and the section as a whole is intended to apply in other -+circumstances. -+ -+It is not the purpose of this section to induce you to infringe any -+patents or other property right claims or to contest validity of any -+such claims; this section has the sole purpose of protecting the -+integrity of the free software distribution system, which is -+implemented by public license practices. Many people have made -+generous contributions to the wide range of software distributed -+through that system in reliance on consistent application of that -+system; it is up to the author/donor to decide if he or she is willing -+to distribute software through any other system and a licensee cannot -+impose that choice. -+ -+This section is intended to make thoroughly clear what is believed to -+be a consequence of the rest of this License. -+ -+ 8. If the distribution and/or use of the Program is restricted in -+certain countries either by patents or by copyrighted interfaces, the -+original copyright holder who places the Program under this License -+may add an explicit geographical distribution limitation excluding -+those countries, so that distribution is permitted only in or among -+countries not thus excluded. In such case, this License incorporates -+the limitation as if written in the body of this License. -+ -+ 9. The Free Software Foundation may publish revised and/or new versions -+of the General Public License from time to time. Such new versions will -+be similar in spirit to the present version, but may differ in detail to -+address new problems or concerns. -+ -+Each version is given a distinguishing version number. If the Program -+specifies a version number of this License which applies to it and "any -+later version", you have the option of following the terms and conditions -+either of that version or of any later version published by the Free -+Software Foundation. If the Program does not specify a version number of -+this License, you may choose any version ever published by the Free Software -+Foundation. -+ -+ 10. If you wish to incorporate parts of the Program into other free -+programs whose distribution conditions are different, write to the author -+to ask for permission. For software which is copyrighted by the Free -+Software Foundation, write to the Free Software Foundation; we sometimes -+make exceptions for this. Our decision will be guided by the two goals -+of preserving the free status of all derivatives of our free software and -+of promoting the sharing and reuse of software generally. -+ -+ NO WARRANTY -+ -+ 11. BECAUSE THE PROGRAM IS LICENSED FREE OF CHARGE, THERE IS NO WARRANTY -+FOR THE PROGRAM, TO THE EXTENT PERMITTED BY APPLICABLE LAW. EXCEPT WHEN -+OTHERWISE STATED IN WRITING THE COPYRIGHT HOLDERS AND/OR OTHER PARTIES -+PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESSED -+OR IMPLIED, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF -+MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. THE ENTIRE RISK AS -+TO THE QUALITY AND PERFORMANCE OF THE PROGRAM IS WITH YOU. SHOULD THE -+PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF ALL NECESSARY SERVICING, -+REPAIR OR CORRECTION. -+ -+ 12. IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING -+WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MAY MODIFY AND/OR -+REDISTRIBUTE THE PROGRAM AS PERMITTED ABOVE, BE LIABLE TO YOU FOR DAMAGES, -+INCLUDING ANY GENERAL, SPECIAL, INCIDENTAL OR CONSEQUENTIAL DAMAGES ARISING -+OUT OF THE USE OR INABILITY TO USE THE PROGRAM (INCLUDING BUT NOT LIMITED -+TO LOSS OF DATA OR DATA BEING RENDERED INACCURATE OR LOSSES SUSTAINED BY -+YOU OR THIRD PARTIES OR A FAILURE OF THE PROGRAM TO OPERATE WITH ANY OTHER -+PROGRAMS), EVEN IF SUCH HOLDER OR OTHER PARTY HAS BEEN ADVISED OF THE -+POSSIBILITY OF SUCH DAMAGES. -+ -+ END OF TERMS AND CONDITIONS -+ -+ How to Apply These Terms to Your New Programs -+ -+ If you develop a new program, and you want it to be of the greatest -+possible use to the public, the best way to achieve this is to make it -+free software which everyone can redistribute and change under these terms. -+ -+ To do so, attach the following notices to the program. It is safest -+to attach them to the start of each source file to most effectively -+convey the exclusion of warranty; and each file should have at least -+the "copyright" line and a pointer to where the full notice is found. -+ -+ -+ Copyright (C) 19yy -+ -+ This program is free software; you can redistribute it and/or modify -+ it under the terms of the GNU General Public License as published by -+ the Free Software Foundation; either version 2 of the License, or -+ (at your option) any later version. -+ -+ This program is distributed in the hope that it will be useful, -+ but WITHOUT ANY WARRANTY; without even the implied warranty of -+ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ GNU General Public License for more details. -+ -+ You should have received a copy of the GNU General Public License -+ along with this program; if not, write to the Free Software -+ Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ -+ -+Also add information on how to contact you by electronic and paper mail. -+ -+If the program is interactive, make it output a short notice like this -+when it starts in an interactive mode: -+ -+ Gnomovision version 69, Copyright (C) 19yy name of author -+ Gnomovision comes with ABSOLUTELY NO WARRANTY; for details type `show w'. -+ This is free software, and you are welcome to redistribute it -+ under certain conditions; type `show c' for details. -+ -+The hypothetical commands `show w' and `show c' should show the appropriate -+parts of the General Public License. Of course, the commands you use may -+be called something other than `show w' and `show c'; they could even be -+mouse-clicks or menu items--whatever suits your program. -+ -+You should also get your employer (if you work as a programmer) or your -+school, if any, to sign a "copyright disclaimer" for the program, if -+necessary. Here is a sample; alter the names: -+ -+ Yoyodyne, Inc., hereby disclaims all copyright interest in the program -+ `Gnomovision' (which makes passes at compilers) written by James Hacker. -+ -+ , 1 April 1989 -+ Ty Coon, President of Vice -+ -+This General Public License does not permit incorporating your program into -+proprietary programs. If your program is a subroutine library, you may -+consider it more useful to permit linking proprietary applications with the -+library. If this is what you want to do, use the GNU Library General -+Public License instead of this License. -diff -Nurp linux-2.6.37/3rdparty/acerhk/doc/acertm.def linux-2.6.37.3rdparty/3rdparty/acerhk/doc/acertm.def ---- linux-2.6.37/3rdparty/acerhk/doc/acertm.def 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/doc/acertm.def 2003-08-24 19:46:37.000000000 +0300 -@@ -0,0 +1,56 @@ -+ -+ -+ -+ -+ -+ -+ -+ -+ Konfiguration -+ -+ Mute/Unmute -+ Lauter -+ Leiser -+ -+ Terminal -+ XEmacs -+ Play/Pause -+ Play/Pause -+ -+ -+ -+ -diff -Nurp linux-2.6.37/3rdparty/acerhk/doc/FAQ linux-2.6.37.3rdparty/3rdparty/acerhk/doc/FAQ ---- linux-2.6.37/3rdparty/acerhk/doc/FAQ 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/doc/FAQ 2005-11-10 19:45:33.000000000 +0200 -@@ -0,0 +1,150 @@ -+****************************************************************************** -+ -+Q: I have a (non Acer) notebook which is not recognized by your driver but I -+think it should. What information do you need? -+ -+A: If it is a non-Acer laptop I would like to know, what makes you think that -+your laptop would work with my driver. A windows driver/utility package of the -+name "LaunchManager" or "EasyButton" is a good hint. If it is clear that your -+hardware is okay, I need the string with your model name from BIOS. Please -+don't ask me how to do it. To find out which functions of your laptop the -+driver will support, it is best, if you can tell me where to get this -+"LaunchManager" or "EasyButton" package. -+If it is a model from 2003 or newer then chances are good that it's a dritek -+type one. In this case try the option "force_series=6000" to at least enable -+the keys. -+ -+****************************************************************************** -+ -+Q: Why can't I activate my wireless hardware on Acer TM 420/430/6000/8000 ...? -+ -+A: On many newer laptops (Dritek type) I do not now how to do this, -+sorry. Someone would need to find out how windows does it. Volunteers? -+ -+****************************************************************************** -+ -+Q: I know that wireless hardware is supported on my Aspire 1690/TravelMate4600, -+but I cannot get it to work, why? -+ -+A: On these model (and similar) the wireless hardware is controlled on two -+different levels. One is controlled by acerhk's xxxled file, the other level -+is controlled by the key itself. To actually activate the hardware you need to -+write '1' to the xxled file and you need to press the corresponding button. -+Example: -+echo 1 > /proc/driver/acerhk/wirelessled -+ -+ -+****************************************************************************** -+ -+Q: Why do I always get 0x00 from /proc/driver/acerhk/key? -+ -+A1: Check the type of your laptop if /proc/driver/acerhk/info. If it is -+"Dritek", you cannot read the keys from the driver. Starting from version -+0.5.17 you get "n/a" out of the key file in this case. -+A2: If you have polling enabled (default) you will almost always read 0x00 -+from this file. This is because in every polling cycle it is checked for key -+events and if there is one, it is instantly translated and sent to the kernel -+input system. Starting with version 0.5.20 you get "n/a" out of the key file -+in this case. -+ -+****************************************************************************** -+ -+Q: When I press a key, nothing happens. Why are they not working? -+ -+A: Most keys won't do anything by themself. If nothing happens, that is -+because no programm knows what to do with the new keys. You need to assign -+actions to them, use the hotkey manager of your desktop to do that. If -+using Gnome, you find it under desktop settings - keyboard shortcuts. -+ -+****************************************************************************** -+ -+Q: The driver works for my laptop, but not all of the keys are working. What -+can I do? -+ -+A: There are some keys/key combinations which generate an ACPI event, -+e.g. Fn+F4 on some models or the lid button. -+If you have a different laptop than the one which got detected (or you used -+"force_series=xxx" anyway), then it is possible that the mapping acerhk uses -+to translate the codes from the buttons to key events is wrong. -+In this case, load the driver with "verbose=4" and press the buttons which do -+not work. Then look for messages from acerhk of the form "translated acer key -+code xxx to no key". Note these codes together with the button they belong to -+and send me this list along with the model name of your laptop. -+If you do not see a usable name in /proc/driver/acerhk/info please try the -+tools dmidecode/biosdecode/vpddecode to find this name. -+ -+****************************************************************************** -+Q: I press the wireless key but the hardware doesn't get activated, what's wrong? -+ -+A: The driver is only on older models (non-Dritek type) able to read -+keypresses by itself and toggle the hardware/LED automatically (with option -+autowlan=1). On Dritek type models this must be done by writing the desired -+value to one of the wireless files in the proc filesystem. In most -+cases this would be /proc/drivers/acerhk/wirelessled to control wlan -+hardware (blueled for Bluetooth hardware): -+ -+echo 1 > /proc/driver/acerhk/wirelessled -+ -+But you could use a hotkey manager to do that automatically when you press the -+button. In this case be aware that on some models the button generates -+different key events according to the actual state of the wireless hardware. -+ -+****************************************************************************** -+ -+Q: My keys do not work, I only get kernel messages of the form: -+atkbd.c: Unknown key pressed (translated set 2, code 0xf4 on isa0060/serio0). -+atkbd.c: Use 'setkeycodes e074 ' to make it known. -+ -+A: Press each of the buttons and note the mentioned -+code for it (e074 in this example). You should get a list like this: -+P1 e074 -+P2 e075 -+... -+If you are finished with it, look into /usr/include/linux/input.h, using -+your favourite text viewer/editor. Search for "KEY_STOP". You should see -+the following line in the file: -+ -+#define KEY_STOP 128 -+ -+After it many more lines with equal #defines should be visible. Look for -+key names which best match the names of your buttons, e.g. KEY_PROG1, -+KEY_WWW and so on. Note the numbers assigned to the names, for KEY_STOP -+this would be 128, for KEY_PROG1 148. -+Now you have a list with three items per entry, your button, a code -+from the kernel messages and a corresponding number from the file -+linux.h: -+P1 e074 148 -+P2 e075 149 -+... -+For each line in this list, issue the setkeycodes command as mentioned -+in the kernel message: -+setkeycodes e074 148 -+setkeycodes e075 149 -+... -+After doing that, the keys should be available for your hotkey manager. -+ -+****************************************************************************** -+ -+Q: My WLAN hardware gets activated through /proc/driver/acerhk/wirelessled, -+but the LED is not working. Why not? -+ -+A: Try if adding the option "led=1" to your wireless module helps. For the -+ipw2200 driver it works, as Didier CLERC found out: -+ -+ I have to load the module "ipw2200" with the option "led=1", then -+ the wifi button blinks until a network is detected. -+ -+****************************************************************************** -+ -+Q: I have an unsupported laptop, but the driver works when I force the series -+to a type like 610 or 2100. Only my buttons doesn't get recognized, why? -+ -+A: On models of the type TM_new (like TravelMate 600, 2100 and many other, see -+acerhk.c, function setup_model_features for details) the buttons use different -+codes on different models. Therefore the driver needs to know these codes. You -+can get them if you load the driver with verbose=4, press the buttons and key -+combinations (Fn+xx) you are interested in and look for kernel messages of the -+form "acerhk: translated acer key code 0xnn to ...". Write down the key code -+for each button/key combination and send them to me so I can patch the -+driver. I also need your model string to make autodetection work, so include -+/proc/driver/acerk/info. -\ Ingen nyrad vid filslut -diff -Nurp linux-2.6.37/3rdparty/acerhk/doc/IOCTL linux-2.6.37.3rdparty/3rdparty/acerhk/doc/IOCTL ---- linux-2.6.37/3rdparty/acerhk/doc/IOCTL 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/doc/IOCTL 2004-01-31 22:38:17.000000000 +0200 -@@ -0,0 +1,61 @@ -+Documentation of possible IOCTLs used by acerhk -++++++++++++++++++++++++++++++++++++++++++++++++ -+ -+ACERHK_GET_KEYCOUNT -+ Read the number of unread key presses in queue -+ Parameter: pointer to char -+ -+ACERHK_GET_KEYID -+ Read the code of the first key press (oldest) in queue -+ Parameter: pointer to char -+ -+ACERHK_CONNECT -+ Don't know what it does, used in windows driver -+ -+ACERHK_DISCONNECT -+ Don't know what it does, used in windows driver -+ -+ACERHK_GET_THERMAL_EVENT -+ Don't know what it does, used in windows driver -+ Parameter: pointer to short -+ -+ACERHK_MAIL_LED_OFF -+ Switch off the LED of the mail button(if available) -+ -+ACERHK_MAIL_LED_ON -+ Switch on the LED of the mail button (if available) -+ -+ACERHK_START_POLLING -+ Start polling (and translation to key events) in kernel -+ -+ACERHK_STOP_POLLING -+ Stop polling in kernel -+ -+ACERHK_GET_KEY_MAP -+ Get mapping of key names to key events -+ Parameter: pointer to t_map_name2event -+ -+ACERHK_SET_KEY_MAP -+ Set mapping of key names to key events -+ Parameter: pointer to t_map_name2event -+ -+IOCTLs used by windows driver -++++++++++++++++++++++++++++++ -+device name: -+\DosDevices\HOTKEY -+\Device\HOTKEY -+ -+ -+630 series: -+0x222404 -+ Get CMOS index -+0x222408 -+ ACERHK_GET_KEYCOUNT -+0x22240C -+ ACERHK_GET_KEYID -+0x222410 -+ ACERHK_MAIL_LED_OFF/ACERHK_MAIL_LED_ON -+0x222414 -+ ACERHK_CONNECT/ACERHK_DISCONNECT -+0x222418 -+ ACERHK_GET_THERMAL_EVENT -diff -Nurp linux-2.6.37/3rdparty/acerhk/doc/keycodes linux-2.6.37.3rdparty/3rdparty/acerhk/doc/keycodes ---- linux-2.6.37/3rdparty/acerhk/doc/keycodes 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/doc/keycodes 2004-04-18 20:42:59.000000000 +0300 -@@ -0,0 +1,26 @@ -+standard X keycodes with older (acerhk controlled) hardware from Acer -+********************************************************************* -+help (Fn+F1) 226 -+setup (Fn+F2) 129 -+p1 153 -+p2 144 -+p3 171 -+www 178 -+mail 236 -+wireless 147 -+power (Fn+F3) 222 -+mute (Fn+F8) 166 -+volup (Fn+Up) 158 -+voldn (Fn+Down) 165 -+ -+standard X keycodes with newer (acerhk activated) hardware from Dritek -+********************************************************************** -+help (Fn+F1) 226 -+setup (Fn+F2) 129 -+p1 153 -+p2 144 -+www 178 -+mail 236 -+volup (Fn+Up) 176 -+voldn (Fn+Down) 174 -+mute (Fn+F8) 160 -diff -Nurp linux-2.6.37/3rdparty/acerhk/doc/md95400.def linux-2.6.37.3rdparty/3rdparty/acerhk/doc/md95400.def ---- linux-2.6.37/3rdparty/acerhk/doc/md95400.def 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/doc/md95400.def 2005-03-01 22:46:53.000000000 +0200 -@@ -0,0 +1,14 @@ -+ -+ -+ -+Mail -+Web -+Play/Pause -+Stop -+Previous -+Next -+Leiser -+Lauter -+ -+ -+ -diff -Nurp linux-2.6.37/3rdparty/acerhk/INSTALL linux-2.6.37.3rdparty/3rdparty/acerhk/INSTALL ---- linux-2.6.37/3rdparty/acerhk/INSTALL 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/INSTALL 2005-12-07 14:27:16.000000000 +0200 -@@ -0,0 +1,109 @@ -+Installation -+************ -+ -+1. You need the kernel sources (or kernel headers for your kernel) -+installed to compile the driver. -+ -+2. Your kernel needs loadable module support with version information for -+modules enabled. Usage of procfs is highly recommended. -+If you want the driver to generate regular keyboard events using -+kernel version 2.4 you need the input system of the kernel enabled -+(Input core support AND keyboard support). In kernel version 2.6 all -+needed functionality should be available by default. -+ -+In most cases you can skip the next step, the Makefile tries do determine -+the correct directory on its own. Change KERNELSRC only if the autodetection -+does not work for you. Otherwise proceed directly with step 4. -+ -+3. Before you compile the driver, change KERNELSRC in the makefile to your -+path to the kernel build environment. If you are using a self compiled kernel, -+point it to the root of your sources. If you are using a packaged kernel of -+your distribution, install the package with kernel headers -+(Debian:kernel-headers) and point KERNELSRC to where the headers and config -+files are located. If you are using Debian, this -+would be "/lib/modules//build". -+ -+4. Do: -+ make -+to compile the driver. If you run into problems because of the makefile not -+recognizing your kernel version correctly, try this: -+ make acerhk.o - kernel version 2.4 -+ make acerhk.ko - kernel version 2.6 -+ -+5. Do: -+ make install -+to automatically copy the driver into the kernel module library. If you've -+done so, proceed directly with step 8. If you want to install the module -+binary yourself (because you want a different location), use steps 6 and 7 -+instead. -+ -+6. Copy the created file "acerhk.o" ("acerhk.ko" with version 2.6) to your -+kernel modules path. In Debian this could be -+"/lib/modules//kernel/drivers/extra/". -+ -+7. Update module dependencies: depmod -a -+ -+8. Try loading the module with: -+ insmod/modprobe acerhk -+If it succeeds - congratulations! If you have procfs enabled, you can try the -+following to test the driver: -+ -+Non-Dritek models: -+Press one of the special keys and after that: -+ cat /proc/driver/acerhk/key -+to read the (hexadezimal) code of the key pressed. It should -+be different from 0x00. -+(Note: You mustn't have the polling feature enabled for this to work, so load -+ the module with poll=0) -+ -+Dritek-models: -+Press one of the special keys and look for the generated key with "xev". If -+there is none, then you should see at least kernel messages about using -+setkeycodes. -+ -+If your notebook has a mail led you can try this: -+ echo on > /proc/driver/acerhk/led -+This should sete the mail led to blinking mode. -+ echo off > /proc/driver/acerhk/led -+turns it off again. -+See README for further usage information. -+ -+If the module didn't load look into your kernel messages what went wrong. If -+you see something like the following lines: -+ acerhk: could not find request handler -+ acerhk: can't find ROM area -+ acerhk: unloaded -+then your hardware is not recognized. See README for supported models. If it -+won't work on your notebook, please contact me and I will see if I can fix -+that. -+ -+Integrating the driver into kernel tree version 2.6 -+*************************************************** -+ -+If you want the driver to fully integrate into the kernel tree of version 2.6 -+proceed as follows: -+1. Copy the acerhk directory into the source tree, for instance -+ /usr/src/linux/drivers/misc/acerhk -+2. Include the driver directory in the config files. Add to the Kconfig -+file of the parent directory(/usr/src/linux/drivers/misc/Kconfig): -+ -+config ACERHK -+ tristate "Acerhk driver" -+ depends on EXPERIMENTAL -+ ---help--- -+ This is an experimental acer keyboard driver for -+ acer laptops -+ -+3. Include the acer directory in it's parents -+Makefile(/usr/src/linux/drivers/misc/Makefile): -+ -+obj-$(CONFIG_ACERHK) += acerhk/ -+ -+4. In this case you also need to activate the misc drivers first -+(/usr/src/linux/drivers/Kconfig): -+ -+source "drivers/misc/Kconfig" -+ -+If that's done, you should be able to select the driver from the configuration -+programm and build the module. -+ -diff -Nurp linux-2.6.37/3rdparty/acerhk/Makefile linux-2.6.37.3rdparty/3rdparty/acerhk/Makefile ---- linux-2.6.37/3rdparty/acerhk/Makefile 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/Makefile 2006-08-16 19:11:08.000000000 +0300 -@@ -0,0 +1,65 @@ -+# change KERNELSRC to the location of your kernel build tree only if -+# autodetection does not work -+#KERNELSRC=/usr/src/linux -+KERNELSRC?=/lib/modules/`uname -r`/build -+# Starting with 2.6.18, the kernel version is in utsrelease.h instead of version.h, accomodate both cases -+KERNELVERSION=$(shell awk -F\" '/REL/ {print $$2}' $(shell grep -s -l REL $(KERNELSRC)/include/linux/version.h $(KERNELSRC)/include/linux/utsrelease.h)) -+KERNELMAJOR=$(shell echo $(KERNELVERSION)|head -c3) -+ -+# next line is for kernel 2.6, if you integrate the driver in the kernel tree -+# /usr/src/linux/drivers/acerhk - or something similar -+# don't forget to add the following line to the parent dir's Makefile: -+# (/usr/src/linux/drivers/Makefile) -+# obj-m += acerhk/ -+CONFIG_ACERHK?=m -+obj-$(CONFIG_ACERHK) += acerhk.o -+ -+CFLAGS+=-c -Wall -Wstrict-prototypes -Wno-trigraphs -O2 -fomit-frame-pointer -fno-strict-aliasing -fno-common -pipe -+INCLUDE=-I$(KERNELSRC)/include -+ -+ifeq ($(KERNELMAJOR), 2.6) -+TARGET := acerhk.ko -+else -+TARGET := acerhk.o -+endif -+ -+SOURCE := acerhk.c -+ -+all: $(TARGET) -+ -+help: -+ @echo Possible targets: -+ @echo -e all\\t- default target, builds kernel module -+ @echo -e install\\t- copies module binary to /lib/modules/$(KERNELVERSION)/extra/ -+ @echo -e clean\\t- removes all binaries and temporary files -+ -+# this target is only for me, don't use it yourself (Olaf) -+export: -+ sh export.sh -+ -+acerhk.ko: $(SOURCE) acerhk.h -+ $(MAKE) -C $(KERNELSRC) SUBDIRS=$(PWD) modules -+ -+acerhk.o: $(SOURCE) acerhk.h -+ $(CC) $(INCLUDE) $(CFLAGS) -DMODVERSIONS -DMODULE -D__KERNEL__ -o $(TARGET) $(SOURCE) -+ -+asm: $(SOURCE) -+ifeq ($(KERNELMAJOR), 2.6) -+ $(CC) $(INCLUDE) $(INCLUDE)/asm-i386/mach-default $(CFLAGS) -fverbose-asm -S -DMODVERSIONS -DMODULE -D__KERNEL__ $(SOURCE) -+else -+ $(CC) $(INCLUDE) $(CFLAGS) -fverbose-asm -S -DMODVERSIONS -DMODULE -D__KERNEL__ $(SOURCE) -+endif -+ -+clean: -+ rm -f *~ *.o *.s *.ko .acerhk* *.mod.c -+ -+load: $(TARGET) -+ insmod $(TARGET) -+ -+unload: -+ rmmod acerhk -+ -+install: $(TARGET) -+ mkdir -p /lib/modules/$(KERNELVERSION)/extra -+ cp -v $(TARGET) /lib/modules/$(KERNELVERSION)/extra/ -+ depmod -a -diff -Nurp linux-2.6.37/3rdparty/acerhk/NEWS linux-2.6.37.3rdparty/3rdparty/acerhk/NEWS ---- linux-2.6.37/3rdparty/acerhk/NEWS 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/NEWS 2003-02-28 02:47:18.000000000 +0200 -@@ -0,0 +1,16 @@ -+2003-02-28 Version 0.5.0 -+ completely changed key polling/translation -+ support for more series -+2002-07-06 Version 0.4.2 -+ added debug functionality -+ bugfix with 520/210 -+2002-06-24 Version 0.4.1 -+ added support for TM 210 series -+ removed nvram dependency -+2002-06-15 Version 0.4 -+ added model recognition -+ added kernel polling an key event generation -+ added support for 520 series -+ -+2002-04-29 Version 0.3 -+ Initial release -\ Ingen nyrad vid filslut -diff -Nurp linux-2.6.37/3rdparty/acerhk/README linux-2.6.37.3rdparty/3rdparty/acerhk/README ---- linux-2.6.37/3rdparty/acerhk/README 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/acerhk/README 2006-11-10 00:01:46.000000000 +0200 -@@ -0,0 +1,215 @@ -+ -+What is this driver good for? -+***************************** -+ -+This driver will give access to the special keys on notebooks of the -+Acer Travelmate series, which are not handled by the keyboard -+driver. -+It also works on notebooks from other manufacturers (some Medion, -+Fujitsu-Siemens, ...). -+ -+It also has some other related functionality (depending on the model): -+- controlling LEDs (Mail, Wireless) -+- enable/disable wireless hardware -+ -+Usage -+***** -+ -+The driver provides a device /dev/misc/acerhk where you can access all -+functions through IOCTL's, look into acerhk.h for their definitions. -+I use devfs and don't care about the minor number. You may want to change -+ACERHK_MINOR in acerhk.h. -+If you don't use devfs you need to create the device node. The device uses -+major 10 (misc character devices), the minor is chosen by the kernel (if -+ACERHK_MINOR equals MISC_DYNAMIC_MINOR) or by yourself (any other value). -+Use something like -+ mknod /dev/acerhk c 10 123 -+to create the device node. -+You can also use most functions through procfs. You will find some files in -+/proc/driver/acerhk: -+ led - write "on" or "off" to set the mail led state -+ key - read it to get a key press, only useful on non-dritek models -+ and only if polling is disabled -+ This file exists only on non-dritek models -+ info - some information about the driver, including the number of -+ pending keys -+ wirelessled - write "on" or "off" to set the led state and enable -+ wlan hardware -+ On some laptops you need to load the ipw2200 (others -+ too?) with option "led=1" to make the led work. -+ blueled - write "on" or "off" to set the led state and enable -+ bluetooth hardware -+ write a value n >= 50 to let the led blink every n jiffies -+ Do not use blinking mode where not only the led but also the -+ bluetooth hardware is controlled! -+ -+Probably the best way to use the driver is to let it poll for the keys itself -+and generate real key events. this is the normal case when loading the module -+without an additional parameter : -+ -+ modprobe acerhk -+ -+or you can use the ioctl as specified in acerhk.h to control the polling. If -+your kernel has keyboard input support you will get real key events when -+pressing the special keys. -+You can then use whatever software you like to make use of those keys, -+i.e. 'hotkeys' or Linux Easy Access Keyboard 'lineakd'. I prefer hotkeys, just -+in case anyone is interested, you can find a sample configuration for this -+programm in doc/acertm.def. -+Gnome >= 2.4 has built in support for multimedia keys (acme), that's -+what I use now. -+ -+Have a look at -+ http://mmkc.sourceforge.net/ -+ -+Note: If you have one of the newer models using dritek hardware you don't need -+polling (nor the file /proc/driver/acerhk/key) to use your buttons. On this -+hardware the driver only needs to send a special command to the keyboard -+controller to make them work. The actual key presses are then handled by the -+normal keyboard driver of the kernel. You can switch of polling by -+loading the module with poll=0. It saves you precious cpu time. -+ -+ -+Module parameters -+***************** -+name values meaning -+autowlan 0,1 disable(default)/enable automatic switching of wlan hardware -+ on wireless keypress, only useful for older (no -+ dritek-hardware) models, works only will poll=1 -+poll 0,1 disable/enable(default) kernel polling of key events -+verbose 0-4 verbosity level, see below -+usedritek 0,1 disable/enable(default) use of dritek hardware on newer -+ series, needed to activate the keys on such models -+force_series set this to the laptop series number you want the driver to -+ assume, skip autodetection (look at function -+ setup_model_features() for possible values) -+ -+Debugging -+********* -+ -+You can make the the driver be more verbose. To do this, add the following -+parameter when loading the module: -+ -+ verbose= -+ -+n is an integer, 0 (default) means no additional information while increasing -+values provide an increasing amount of information. Currently 3 is maximum, -+bigger values will have the same effect as 3. The existing verbosity levels -+will generate information about: -+ Level Information -+ 1 state changes and variable initialization -+ 2 model probing -+ 3 key translation, only known keys -+ 4 key translation, also unknown keys -+ 5 misc. information (idle values) -+ -+If you have rather serious problems you can activate debugging functionality -+in the driver. To do this, uncomment the '#define ACERDEBUG' in acerhk.c. You -+will find a new file in /proc/driver/acerhk, named 'debug'. You cannot read -+from this file, but you can write commands consisting of up to 4 digits. The -+first one specifies the action, while the latter can give additional -+parameters. Implemented are: -+ 'd' decrement module usage counter -+ 'i' increment module usage counter -+ -+ 'p' call function pbutton_fct() -+ 't' call function get_thermal_event() -+ 'w1x' call function wbutton_fct_1() with parameter x (0-9) -+ 'w2x' call function wbutton_fct_2() with parameter x (0-9) -+ -+ 'vx' change verbosity level to x (0-9) -+ -+ 'mxyy' set mapping of key name x to key event yy (hex) -+ 'sxx' send key event xx (hex) to input system -+ 'Sxx' simulate acer key press with code xx (hex) -+ -+ 'e0' stop kernel polling -+ 'e1' start kernel polling -+ -+Example: -+ -+1) echo d > /proc/driver/acerhk/debug -+ -+will decrement the usage counter, very useful if a program using the driver -+segfaulted. This way you can still unload the driver. -+ -+2) echo v4 > /proc/driver/acerhk/debug -+ -+will set the verbosity level to maximum. -+ -+Keycodes -+******** -+ -+see doc/keycodes -+Also see http://bernd-wurst.de/linux/tm800.php#mmkeys (only in german) -+ -+If you have one of the newer models with the dritek hardware, use kernel 2.6 -+and get (after enabling it) kernel messages of the form: -+ -+ atkbd.c: Unknown key pressed (translated set 2, code 0xf4 on -+ isa0060/serio0). -+ atkbd.c: Use 'setkeycodes e074 ' to make it known. -+ -+then you should do exactly what your told. In this case you could do -+ -+ setkeycodes e074 158 -+ -+to map the button with scancode e074 (hex) to keycode 158 (decimal). To find -+out the scancodes of the buttons either look into the kernel log or into the -+file MMKEYBD.CFG of the windows launch manager package. There you should find -+lines like this: -+ -+Key 1 = 1,E0,74,E0,F4,F500,P1 -+ ** ** ** -+ -+The important information is marked in the example above. The numbers give the -+scancode produced by the button which's name is given last. -+The keycode you give as parameter to setkeycodes is one out of the header file -+linux/input.h, in the example above the one for KEY_BACK. -+Important note: I received mails from a number of people where setkeycodes -+rejected keycodes above a certain value. This is caused by an outdated version -+of setkeycodes, use a more recent one. -+To ease the setup of keymappings for the newer series I will try to include -+setup scripts for the different notebook series. If I have enough time to -+spare I will perhaps expand the driver itself do to that. -+ -+How does it work? -+***************** -+ -+The driver is based on the windows Me for series 610 driver and -+resembles its structure and functionality. -+Key presses are events, which are stored in a FIFO queue with 31 -+entries. You can access the event count via CMOS nvram, but the access to -+the actual queue (and other functionality like switching the mail led) is -+done through calling a system ROM function. -+Upon loading the driver looks for this function, if it cannot find it, -+loading aborts. -+Newer Dritek Hardware: -+Button handling is done entirely by the EC (embbedded/environment -+controller) which behaves like an extended keyboard controller. My -+driver only enables/disables this extension. -+ -+ -+Credits -+******* -+ -+Leif Jensen, whose driver inspired me to do the probing stuff -+http://www.math.columbia.edu/~jensen/linux/acertm/ -+ -+Thanks to all who contributed patches to this driver or who just tried it out -+on their laptops, without them it wouldn't support anything else but my -+TM 613. -+ -+Contact -+******* -+ -+If you have problems with the driver, please include the following information: -+1. name of your laptop (e.g. Acer TM 4001) -+2. content of /proc/driver/acerhk/info, if available -+3. kernel output after loading the module with verbose=2 -+ -+Email: Olaf Tauber -+ -+The latest version can be found here: -+ -+http://www.informatik.hu-berlin.de/~tauber/acerhk diff --git a/kernel/kernel/files/patches/mageia/3rd-acerhk-2.6.36-buildfix.patch b/kernel/kernel/files/patches/mageia/3rd-acerhk-2.6.36-buildfix.patch deleted file mode 100644 index 47a71053..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-acerhk-2.6.36-buildfix.patch +++ /dev/null @@ -1,20 +0,0 @@ ---- linux-2.6.35/3rdparty/acerhk/acerhk.c.orig 2010-10-03 12:50:33.000000000 +0000 -+++ linux-2.6.35/3rdparty/acerhk/acerhk.c 2010-10-03 13:13:22.093868410 +0000 -@@ -2730,7 +2730,7 @@ static void acerhk_proc_cleanup(void) - - /* {{{ file operations */ - --static int acerhk_ioctl( struct inode *inode, struct file *file, -+static long acerhk_ioctl( struct inode *inode, struct file *file, - unsigned int cmd, unsigned long arg ) - { - int retval; -@@ -2827,7 +2827,7 @@ static int acerhk_release( struct inode - - static struct file_operations acerhk_fops = { - owner: THIS_MODULE, -- ioctl: acerhk_ioctl, -+ unlocked_ioctl: acerhk_ioctl, - open: acerhk_open, - #ifdef ACERDEBUG - write: acerhk_write, diff --git a/kernel/kernel/files/patches/mageia/3rd-acerhk-extra-cflags.patch b/kernel/kernel/files/patches/mageia/3rd-acerhk-extra-cflags.patch deleted file mode 100644 index 7971c699..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-acerhk-extra-cflags.patch +++ /dev/null @@ -1,33 +0,0 @@ -CFLAGS use isn't allowed anymore with 2.6.24, we must use EXTRA_CFLAGS -in its place - -Signed-off-by: Herton Ronaldo Krzesinski - ---- linux-2.6.23/3rdparty/acerhk/Makefile.orig 2007-11-08 21:32:43.000000000 -0200 -+++ linux-2.6.23/3rdparty/acerhk/Makefile 2007-11-08 21:33:28.000000000 -0200 -@@ -14,7 +14,7 @@ - CONFIG_ACERHK?=m - obj-$(CONFIG_ACERHK) += acerhk.o - --CFLAGS+=-c -Wall -Wstrict-prototypes -Wno-trigraphs -O2 -fomit-frame-pointer -fno-strict-aliasing -fno-common -pipe -+EXTRA_CFLAGS+=-c -Wall -Wstrict-prototypes -Wno-trigraphs -O2 -fomit-frame-pointer -fno-strict-aliasing -fno-common -pipe - INCLUDE=-I$(KERNELSRC)/include - - ifeq ($(KERNELMAJOR), 2.6) -@@ -41,13 +41,13 @@ acerhk.ko: $(SOURCE) acerhk.h - $(MAKE) -C $(KERNELSRC) SUBDIRS=$(PWD) modules - - acerhk.o: $(SOURCE) acerhk.h -- $(CC) $(INCLUDE) $(CFLAGS) -DMODVERSIONS -DMODULE -D__KERNEL__ -o $(TARGET) $(SOURCE) -+ $(CC) $(INCLUDE) $(EXTRA_CFLAGS) -DMODVERSIONS -DMODULE -D__KERNEL__ -o $(TARGET) $(SOURCE) - - asm: $(SOURCE) - ifeq ($(KERNELMAJOR), 2.6) -- $(CC) $(INCLUDE) $(INCLUDE)/asm-i386/mach-default $(CFLAGS) -fverbose-asm -S -DMODVERSIONS -DMODULE -D__KERNEL__ $(SOURCE) -+ $(CC) $(INCLUDE) $(INCLUDE)/asm-i386/mach-default $(EXTRA_CFLAGS) -fverbose-asm -S -DMODVERSIONS -DMODULE -D__KERNEL__ $(SOURCE) - else -- $(CC) $(INCLUDE) $(CFLAGS) -fverbose-asm -S -DMODVERSIONS -DMODULE -D__KERNEL__ $(SOURCE) -+ $(CC) $(INCLUDE) $(EXTRA_CFLAGS) -fverbose-asm -S -DMODVERSIONS -DMODULE -D__KERNEL__ $(SOURCE) - endif - - clean: diff --git a/kernel/kernel/files/patches/mageia/3rd-acerhk-fix-build-with-function-tracer.patch b/kernel/kernel/files/patches/mageia/3rd-acerhk-fix-build-with-function-tracer.patch deleted file mode 100644 index c8d000b5..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-acerhk-fix-build-with-function-tracer.patch +++ /dev/null @@ -1,22 +0,0 @@ -Fix acerhk build with FUNCTION_TRACER enabled. - -Signed-off-by: Herton Ronaldo Krzesinski ---- - 3rdparty/acerhk/Makefile | 5 ++++- - 1 file changed, 4 insertions(+), 1 deletion(-) - -diff -p -up linux-2.6.31/3rdparty/acerhk/Makefile.orig linux-2.6.31/3rdparty/acerhk/Makefile ---- linux-2.6.31/3rdparty/acerhk/Makefile.orig 2009-10-02 16:39:06.000000000 -0300 -+++ linux-2.6.31/3rdparty/acerhk/Makefile 2009-10-02 16:45:13.000000000 -0300 -@@ -14,7 +14,10 @@ - CONFIG_ACERHK?=m - obj-$(CONFIG_ACERHK) += acerhk.o - --EXTRA_CFLAGS+=-c -Wall -Wstrict-prototypes -Wno-trigraphs -O2 -fomit-frame-pointer -fno-strict-aliasing -fno-common -pipe -+CFLAGS_acerhk.o += -c -Wall -Wstrict-prototypes -Wno-trigraphs -O2 -fomit-frame-pointer -fno-strict-aliasing -fno-common -pipe -+ifdef CONFIG_FUNCTION_TRACER -+CFLAGS_REMOVE_acerhk.o = -pg -+endif - INCLUDE=-I$(KERNELSRC)/include - - ifeq ($(KERNELMAJOR), 2.6) diff --git a/kernel/kernel/files/patches/mageia/3rd-acerhk-fix-include.patch b/kernel/kernel/files/patches/mageia/3rd-acerhk-fix-include.patch deleted file mode 100644 index cba26984..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-acerhk-fix-include.patch +++ /dev/null @@ -1,23 +0,0 @@ - -AUTOCONF_INCLUDED is not defined anymore in 2.6.38, so old include got exposed. - -Fix by removing the offending bits. - -Signed-off-by: Thomas Backlund - - 3rdparty/acerhk/acerhk.c | 4 ---- - 1 file changed, 4 deletions(-) - ---- linux-2.6.38/3rdparty/acerhk/acerhk.c.orig 2011-03-20 13:57:32.000000000 +0200 -+++ linux-2.6.38/3rdparty/acerhk/acerhk.c 2011-03-20 15:00:45.768659568 +0200 -@@ -35,10 +35,6 @@ - * - */ - --#ifndef AUTOCONF_INCLUDED --#include --#endif -- - /* This driver is heavily dependent on the architecture, don't let - * anyone without an X86 machine use it. On laptops with AMD64 - * architecture this driver is only useable in 32 bit mode. diff --git a/kernel/kernel/files/patches/mageia/3rd-acerhk-kbuild.patch b/kernel/kernel/files/patches/mageia/3rd-acerhk-kbuild.patch deleted file mode 100644 index f0c419ad..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-acerhk-kbuild.patch +++ /dev/null @@ -1,37 +0,0 @@ -Fix Makefile and add Kconfig for the acerhk driver ---- - 3rdparty/acerhk/Kconfig | 8 8 + 0 - 0 ! - 3rdparty/acerhk/Makefile | 6 3 + 3 - 0 ! - 2 files changed, 11 insertions(+), 3 deletions(-) - -Index: linux-2.6.21/3rdparty/acerhk/Makefile -=================================================================== ---- linux-2.6.21.orig/3rdparty/acerhk/Makefile 2007-05-15 15:34:48.000000000 +0200 -+++ linux-2.6.21/3rdparty/acerhk/Makefile 2007-05-15 15:37:17.000000000 +0200 -@@ -1,10 +1,10 @@ - # change KERNELSRC to the location of your kernel build tree only if - # autodetection does not work - #KERNELSRC=/usr/src/linux --KERNELSRC?=/lib/modules/`uname -r`/build -+#KERNELSRC?=/lib/modules/`uname -r`/build - # Starting with 2.6.18, the kernel version is in utsrelease.h instead of version.h, accomodate both cases --KERNELVERSION=$(shell awk -F\" '/REL/ {print $$2}' $(shell grep -s -l REL $(KERNELSRC)/include/linux/version.h $(KERNELSRC)/include/linux/utsrelease.h)) --KERNELMAJOR=$(shell echo $(KERNELVERSION)|head -c3) -+#KERNELVERSION=$(shell awk -F\" '/REL/ {print $$2}' $(shell grep -s -l REL $(KERNELSRC)/include/linux/version.h $(KERNELSRC)/include/linux/utsrelease.h)) -+#KERNELMAJOR=$(shell echo $(KERNELVERSION)|head -c3) - - # next line is for kernel 2.6, if you integrate the driver in the kernel tree - # /usr/src/linux/drivers/acerhk - or something similar -Index: linux-2.6.21/3rdparty/acerhk/Kconfig -=================================================================== ---- /dev/null 1970-01-01 00:00:00.000000000 +0000 -+++ linux-2.6.21/3rdparty/acerhk/Kconfig 2007-05-15 15:39:30.000000000 +0200 -@@ -0,0 +1,8 @@ -+config ACERHK -+ tristate "Acerhk driver" -+ depends on EXPERIMENTAL && X86 -+ ---help--- -+ This is an experimental acer keyboard driver for -+ acer laptops. If you have a notebook with a ipw2X00 -+ wireless card, it allows you to turn off the rf_kill -+ diff --git a/kernel/kernel/files/patches/mageia/3rd-acerhk-proc_dir_entry-owner.patch b/kernel/kernel/files/patches/mageia/3rd-acerhk-proc_dir_entry-owner.patch deleted file mode 100644 index e5821d46..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-acerhk-proc_dir_entry-owner.patch +++ /dev/null @@ -1,67 +0,0 @@ -Updated for owner removal from struct proc_dir_entry (2.6.30) - -Signed-off-by: Herton Ronaldo Krzesinski - ---- - 3rdparty/acerhk/acerhk.c | 7 ------- - 1 file changed, 7 deletions(-) - -diff -p -up linux-2.6.29/3rdparty/acerhk/acerhk.c.orig linux-2.6.29/3rdparty/acerhk/acerhk.c ---- linux-2.6.29/3rdparty/acerhk/acerhk.c.orig 2009-05-22 02:42:44.000000000 -0300 -+++ linux-2.6.29/3rdparty/acerhk/acerhk.c 2009-05-22 02:43:45.000000000 -0300 -@@ -2626,7 +2626,6 @@ static int acerhk_proc_init(void) - printk(KERN_INFO"acerhk: could not create /proc/driver/acerhk\n"); - } - else { -- proc_acer_dir->owner = THIS_MODULE; - /* now create several files, first general info ... */ - entry = create_proc_read_entry("info", - 0444, proc_acer_dir, acerhk_proc_info, NULL); -@@ -2635,7 +2634,6 @@ static int acerhk_proc_init(void) - remove_proc_entry("driver/acerhk", NULL); - retval = 0; - } else { -- entry->owner = THIS_MODULE; - /* ... last pressed key ... */ - entry = create_proc_read_entry("key", - 0444, proc_acer_dir, acerhk_proc_key, NULL); -@@ -2645,7 +2643,6 @@ static int acerhk_proc_init(void) - remove_proc_entry("driver/acerhk", NULL); - retval = 0; - } else { -- entry->owner = THIS_MODULE; - /* ... and led control file */ - entry = create_proc_entry("led", 0222, proc_acer_dir); - if (entry == NULL) { -@@ -2657,7 +2654,6 @@ static int acerhk_proc_init(void) - } - else { - entry->write_proc = acerhk_proc_led; -- entry->owner = THIS_MODULE; - /* ... and wireless led controll file */ - entry = create_proc_entry("wirelessled", 0222, proc_acer_dir); - if (entry == NULL) { -@@ -2670,7 +2666,6 @@ static int acerhk_proc_init(void) - } - else { - entry->write_proc = acerhk_proc_wirelessled; -- entry->owner = THIS_MODULE; - /* ... and bluetooth led controll file */ - entry = create_proc_entry("blueled", 0222, proc_acer_dir); - if (entry == NULL) { -@@ -2683,7 +2678,6 @@ static int acerhk_proc_init(void) - retval = 0; - } else { - entry->write_proc = acerhk_proc_blueled; -- entry->owner = THIS_MODULE; - retval = 1; - #ifdef ACERDEBUG - /* add extra file for debugging purposes */ -@@ -2700,7 +2694,6 @@ static int acerhk_proc_init(void) - } - else { - entry->write_proc = acerhk_proc_debug; -- entry->owner = THIS_MODULE; - retval = 1; - } - #endif diff --git a/kernel/kernel/files/patches/mageia/3rd-aes2501-kbuild.patch b/kernel/kernel/files/patches/mageia/3rd-aes2501-kbuild.patch deleted file mode 100644 index 1dcf8fa0..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-aes2501-kbuild.patch +++ /dev/null @@ -1,47 +0,0 @@ -Fix Makefile and add Kconfig for the aes2501 driver. - -Signed-off-by: Herton Ronaldo Krzesinski - ---- - linux-2.6.23/3rdparty/aes2501/Kconfig | 10 ++++++++++ - linux-2.6.23/3rdparty/aes2501/Makefile | 19 +------------------ - 2 files changed, 11 insertions(+), 18 deletions(-) - -diff -p -up linux-2.6.23/3rdparty/aes2501/Kconfig.orig linux-2.6.23/3rdparty/aes2501/Kconfig ---- linux-2.6.23/3rdparty/aes2501/Kconfig.orig 2008-01-13 23:14:47.000000000 -0200 -+++ linux-2.6.23/3rdparty/aes2501/Kconfig 2008-01-13 23:35:21.000000000 -0200 -@@ -0,0 +1,10 @@ -+config AES2501 -+ tristate "AuthenTec AES2501 Fingerprint Sensor Driver" -+ depends on USB -+ default m -+ ---help--- -+ Say Y here if you have a AuthenTec AES2501 Fingerprint -+ Sensor device. -+ -+ To compile this driver as a module, choose M here: the -+ module will be called aes2501. -diff -p -up linux-2.6.23/3rdparty/aes2501/Makefile.orig linux-2.6.23/3rdparty/aes2501/Makefile ---- linux-2.6.23/3rdparty/aes2501/Makefile.orig 2008-01-13 23:14:36.000000000 -0200 -+++ linux-2.6.23/3rdparty/aes2501/Makefile 2008-01-13 23:21:33.000000000 -0200 -@@ -1,19 +1,2 @@ -- --obj-m := aes2501.o -- --KERNELDIR ?= /lib/modules/$(shell uname -r)/build -- --PWD := $(shell pwd) -- --all: usertest -- $(MAKE) -C $(KERNELDIR) M=$(PWD) -- --usertest: -- gcc -I. -o usertest usertest.c -- --clean: -- rm -f *.o *~ aes2501.ko aes2501.mod.c Module.symvers usertest -- rm -rf .tmp_versions -- rm -f .*.cmd -- -+obj-$(CONFIG_AES2501) := aes2501.o - diff --git a/kernel/kernel/files/patches/mageia/3rd-aes2501-r19.patch b/kernel/kernel/files/patches/mageia/3rd-aes2501-r19.patch deleted file mode 100644 index a5f95e79..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-aes2501-r19.patch +++ /dev/null @@ -1,2356 +0,0 @@ - 3rdparty/aes2501/ChangeLog | 95 ++ - 3rdparty/aes2501/Makefile | 19 - 3rdparty/aes2501/aes2501.c | 1629 ++++++++++++++++++++++++++++++++++++++++ - 3rdparty/aes2501/aes2501.h | 40 - 3rdparty/aes2501/aes2501_regs.h | 464 +++++++++++ - 3rdparty/aes2501/usertest.c | 78 + - 6 files changed, 2325 insertions(+) -diff -Nurp linux-2.6.37/3rdparty/aes2501/aes2501.c linux-2.6.37.3rdparty/3rdparty/aes2501/aes2501.c ---- linux-2.6.37/3rdparty/aes2501/aes2501.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/aes2501/aes2501.c 2008-01-14 03:07:30.000000000 +0200 -@@ -0,0 +1,1629 @@ -+ -+/* -+ * aes2501.c -- AuthenTec AES2501 Fingerprint Sensor Driver for Linux -+ * -+ * Maintainer: Cyrille Bagard -+ * -+ * Copyright (C) 2007 Cyrille Bagard -+ * -+ * This file is part of the AES2501 driver. -+ * -+ * the AES2501 driver is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * the AES2501 driver is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with the AES2501 driver; if not, write to the Free Software -+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA -+ * -+ */ -+ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+ -+#include "aes2501.h" -+#include "aes2501_regs.h" -+ -+ -+static int major = 0; -+ -+module_param(major, int, 0); -+MODULE_PARM_DESC(major, "major number"); -+ -+ -+//#define DEBUG -+ -+ -+#define PRINTK_INFO(fmt, arg...) printk(KERN_INFO "aes2501: " fmt, ## arg) -+ -+#define PRINTK_CRIT(fmt, arg...) printk(KERN_CRIT "aes2501: " fmt, ## arg) -+ -+#define PRINTK_DBG(fmt, arg...) printk(KERN_DEBUG "aes2501: " fmt, ## arg) -+ -+ -+static struct workqueue_struct *comm_queue; -+ -+ -+static char *finger_print = NULL; -+static size_t finger_print_len; -+ -+ -+ -+static DECLARE_WAIT_QUEUE_HEAD(wq); -+static int flag = 0; -+ -+ -+ -+struct usb_aes2501 *_dev; -+ -+ -+ -+ -+ -+ -+struct aes2501 { -+ -+ struct usb_device *udev; -+ -+ int temp; -+ -+ unsigned char *int_in_buffer; -+ struct urb *int_in_urb; -+ -+}; -+ -+ -+/* -+#define VENDOR_ID 0x08f7 -+#define PRODUCT_ID 0x0002 -+*/ -+ -+#define VENDOR_ID 0x08ff -+#define PRODUCT_ID 0x2580 -+ -+ -+/* Table of devices that work with this driver */ -+ -+static struct usb_device_id id_table [] = { -+ { USB_DEVICE(VENDOR_ID, PRODUCT_ID) }, -+ { } -+}; -+ -+MODULE_DEVICE_TABLE(usb, id_table); -+ -+ -+/* Get a minor range for your devices from the usb maintainer */ -+#define USB_AES2501_MINOR_BASE 192 -+ -+ -+ -+#define WRITES_IN_FLIGHT 8 /* ??? */ -+ -+ -+ -+enum AES2501_Status { -+ -+ AESS_INIT_DONE, -+ AESS_IS_SCANNING, -+ -+ AESS_COUNT -+ -+}; -+ -+ -+#define BULK_OUT_BUFFER_SIZE 32 -+ -+ -+/* Read a register value from a dump sent by the device. */ -+static int read_register_value(const uint8_t *, Aes2501Registers); -+ -+/* Tells if a finger motion is still detected. */ -+static int sum_histogram_values(const uint8_t *, uint8_t); -+ -+ -+/* Structure to hold all device specific stuff */ -+struct usb_aes2501 { -+ -+ struct usb_device *udev; /* the usb device for this device */ -+ struct usb_interface *interface; /* the interface for this device */ -+ struct semaphore limit_sem; /* limiting the number of writes in progress */ -+ unsigned char *bulk_in_buffer; /* the buffer to receive data */ -+ size_t bulk_in_size; /* the size of the receive buffer */ -+ __u8 bulk_in_endpointAddr; /* the address of the bulk in endpoint */ -+ uint8_t bulk_out_buffer[BULK_OUT_BUFFER_SIZE]; /* the buffer to send data (32 / 8 = 4) */ -+ size_t bulk_out_buffer_used; /* the quantity of buffered data to send */ -+ __u8 bulk_out_endpointAddr; /* the address of the bulk out endpoint */ -+ struct kref kref; -+ struct mutex io_mutex; /* synchronize I/O with disconnect */ -+ -+ DECLARE_BITMAP(status, AESS_COUNT); /* Information about what has been set / is running */ -+ -+ struct work_struct scan_work; -+ uint8_t stop_scan; /* Flag to stop finger detecting during module removal */ -+}; -+ -+ -+#define to_aes2501_dev(r) container_of(r, struct usb_aes2501, kref) -+ -+static struct usb_driver aes2501_driver; -+ -+static void aes2501_delete(struct kref *kref) -+{ -+ struct usb_aes2501 *dev; -+ -+ dev = to_aes2501_dev(kref); -+ -+ usb_put_dev(dev->udev); -+ kfree(dev->bulk_in_buffer); -+ kfree(dev); -+ -+} -+ -+ -+static int aes2501_open(struct inode *inode, struct file *file); -+/* -+struct usb_aes2501 *_dev; -+static int aes2501_open(struct inode *inode, struct file *file) -+{ -+ printk(KERN_INFO "Plop !\n"); -+ -+ -+ -+ return 0; -+} -+*/ -+ -+static ssize_t aes2501_read(struct file *file, char *buffer, size_t count, loff_t *ppos) -+{ -+ int read_len; -+ -+ //printk(KERN_INFO "aes2501_read ! got %d -> need (%d ; %d)\n", finger_print_len, *ppos, count); -+ -+ if (flag == 0) -+ printk(KERN_INFO "Process %i (%s) is going to sleep\n", current->pid, current->comm); -+ -+ wait_event_interruptible(wq, flag == 1); -+ -+ if (signal_pending(current)) -+ return -ERESTARTSYS; -+ -+ if (finger_print_len == 0) -+ return -ENODATA; -+ -+ if (unlikely((*ppos < 0) || (loff_t)(*ppos + count) < 0)) -+ return -EINVAL; -+ -+ if (*ppos + count > finger_print_len) -+ read_len = finger_print_len - *ppos; -+ else read_len = count; -+ -+ if (read_len > 0) -+ { -+ if (!access_ok(VERIFY_WRITE, buffer, read_len)) -+ return -EFAULT; -+ -+ read_len -= copy_to_user(buffer, finger_print + *ppos, read_len); -+ *ppos += read_len; -+ -+ } -+ -+ /* !!!! */ -+ else flag = 0; -+ -+ return read_len; -+ -+} -+ -+ -+ -+static int detect_finger_on_aes2501(struct usb_aes2501 *dev); -+ -+static void do_scanning(struct work_struct *work); -+ -+ -+// ioctl - I/O control -+static int aes2501_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) -+{ -+ struct usb_aes2501 *dev; -+ int retval; -+ -+ dev = _dev; -+ -+ -+ printk(KERN_INFO "Get IOCtl :: cmd = %d vs %d\n", cmd, (AES2501_IOC_TEST)); -+ -+ switch (cmd) { -+ -+ case AES2501_IOC_TEST: -+ -+#if defined(_arch_um__) || !(LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 20)) -+ INIT_WORK(&dev->scan_work, do_scanning); -+#else -+ INIT_WORK(&dev->scan_work, do_scanning, NULL); -+#endif -+ -+ retval = queue_work(comm_queue, &dev->scan_work); -+ -+ -+ } -+ -+ -+ -+ return 0; -+ -+ -+#if 0 -+ int retval = 0; -+ switch ( cmd ) { -+ case CASE1:/* for writing data to arg */ -+ if (copy_from_user(&data, (int *)arg, sizeof(int))) -+ return -EFAULT; -+ break; -+ case CASE2:/* for reading data from arg */ -+ if (copy_to_user((int *)arg, &data, sizeof(int))) -+ return -EFAULT; -+ break; -+ default: -+ retval = -EINVAL; -+ } -+ return retval; -+#endif -+} -+ -+ -+ -+static const struct file_operations aes2501_fops = { -+ .owner = THIS_MODULE, -+ .read = aes2501_read,/* -+ .write = aes2501_write,*/ -+ .open = aes2501_open,/* -+ .release = skel_release,*/ -+ .ioctl = aes2501_ioctl -+}; -+ -+ -+ -+/* -+static int send_data_to_aes2501(struct usb_aes2501 *dev, unsigned char *buffer, int len) -+{ -+#ifdef DEBUG -+ int i; -+#endif -+ int bytes_written; -+ int ret; -+ -+#ifdef DEBUG -+ printk(KERN_INFO "\n:: OUT :: len=%d\n", len); -+ -+ for (i = 0; i < len; i++) -+ { -+ if (i > 0 && i % 16 == 0) -+ printk("\n"); -+ if (i % 16 == 0) -+ printk(KERN_INFO " %05x: ", i); -+ -+ if (i % 8 == 0) -+ printk(" "); -+ -+ printk("%02x ", buffer[i]); -+ -+ } -+ -+ printk("\n"); -+#endif -+ -+ ret = usb_bulk_msg(dev->udev, -+ usb_sndbulkpipe(dev->udev, dev->bulk_out_endpointAddr), -+ buffer, -+ len, -+ &bytes_written, 4000); -+ -+ if (ret < 0) -+ PRINTK_CRIT("error while sending data: %d\n", ret); -+ -+ if (bytes_written != len) -+ printk(KERN_INFO "did not write all ! %d vs %d\n", bytes_written, len); -+ -+ return ret; -+ -+} -+*/ -+ -+static int flush_aes2501_bulk_out(struct usb_aes2501 *dev) -+{ -+ int ret; -+ int bytes_written; -+ -+ ret = 0; -+ -+ if (dev->bulk_out_buffer_used > 0) { -+ -+ ret = usb_bulk_msg(dev->udev, -+ usb_sndbulkpipe(dev->udev, dev->bulk_out_endpointAddr), -+ dev->bulk_out_buffer, -+ dev->bulk_out_buffer_used, -+ &bytes_written, 4000); -+ -+ if (ret < 0) -+ PRINTK_CRIT("error while sending data: %d\n", ret); -+ -+ else if (bytes_written != dev->bulk_out_buffer_used) -+ { -+ printk(KERN_INFO "did not write all ! %d vs %d\n", bytes_written, dev->bulk_out_buffer_used); -+ /*ret = ... */ -+ } -+ -+ dev->bulk_out_buffer_used = 0; -+ -+ } -+ -+ return ret; -+ -+} -+ -+ -+static int write_aes2501_register(struct usb_aes2501 *dev, uint8_t reg, uint8_t data) -+{ -+ int ret; -+ -+ if (dev->bulk_out_buffer_used == BULK_OUT_BUFFER_SIZE) -+ ret = flush_aes2501_bulk_out(dev); -+ else -+ ret = 0; -+ -+ dev->bulk_out_buffer[dev->bulk_out_buffer_used++] = reg; -+ dev->bulk_out_buffer[dev->bulk_out_buffer_used++] = data; -+ -+ return ret; -+ -+} -+ -+ -+static int recv_data_to_aes2501(struct usb_aes2501 *dev, unsigned char *buffer, int len) -+{ -+ int bytes_read; -+ int ret; -+#ifdef DEBUG -+ int i; -+#endif -+ -+ ret = usb_bulk_msg(dev->udev, -+ usb_rcvbulkpipe(dev->udev, dev->bulk_in_endpointAddr), -+ buffer, -+ len, -+ &bytes_read, 4000); -+ -+ if (ret < 0) -+ PRINTK_CRIT("error while sending data: %d\n", ret); -+ -+ if (bytes_read != len) -+ printk(KERN_INFO "did not read all ! %d vs %d\n", bytes_read, len); -+ -+#ifdef DEBUG -+ if (ret == 0) -+ { -+ printk(KERN_INFO "\n:: IN :: len=%d\n", len); -+ -+ for (i = 0; i < len; i++) -+ { -+ if (i > 0 && i % 16 == 0) -+ printk("\n"); -+ if (i % 16 == 0) -+ printk(KERN_INFO " %05x: ", i); -+ -+ if (i % 8 == 0) -+ printk(" "); -+ -+ printk("%02x ", buffer[i]); -+ -+ } -+ -+ printk("\n"); -+ -+ } -+#endif -+ -+ return ret; -+ -+} -+ -+ -+ -+static int standby_aes2501(struct usb_aes2501 *dev) -+{ -+ -+ //unsigned char cmd[] = "\xac\x01\xad\x1a\x81\x02"; -+ -+ -+ unsigned char buffer[4]; -+ -+ -+ -+ -+ printk(KERN_INFO ">> Standby aes2501 !\n"); -+ -+ -+ //msleep(800); -+ -+ write_aes2501_register(dev, AES2501_REG_TREGC, AES2501_TREGC_ENABLE); -+ write_aes2501_register(dev, AES2501_REG_TREGD, 0x1a); -+ -+ flush_aes2501_bulk_out(dev); -+ -+ /** -+ * TODO: -+ * - lire ici les deux octets. -+ * - voir pour inverser les commandes. -+ */ -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL2, 0x02/* AES2501_CTRL2_READ_REGS ??? */); -+ flush_aes2501_bulk_out(dev); -+ -+ //send_data_to_aes2501(dev, cmd, 6); -+ recv_data_to_aes2501(dev, buffer, 2); -+ -+ -+ -+ printk(KERN_INFO " %02x %02x\n", buffer[0], buffer[1]); -+ -+ -+ if ((buffer[1] & AES2501_STAT_SCAN) == buffer[1]) -+ { -+ PRINTK_DBG("scan state: "); -+ -+ switch (buffer[1]) -+ { -+ case STATE_WAITING_FOR_FINGER: -+ printk("'Waiting for finger'\n"); -+ break; -+ case STATE_FINGER_SETTLING_DELAY: -+ printk("'In Finger settling delay'\n"); -+ break; -+ case STATE_POWER_UP_DELAY: -+ printk("'In power up delay'\n"); -+ break; -+ case STATE_WAITING_TO_START_SCAN: -+ printk("'Waiting to start image scan'\n"); -+ break; -+ case STATE_PRELOADING_SUBARRAY_0: -+ printk("'Pre-loading subarray 0'\n"); -+ break; -+ case STATE_SETUP_FOR_ROW_ADVANCE: -+ printk("'Setup for row advance'\n"); -+ break; -+ case STATE_WAITING_FOR_ROW_ADVANCE: -+ printk("'Waiting for row advance'\n"); -+ break; -+ case STATE_PRELOADING_COL_0: -+ printk("'Pre-loading column 0'\n"); -+ break; -+ case STATE_SETUP_FOR_COL_ADVANCE: -+ printk("'Setup for column advance'\n"); -+ break; -+ case STATE_WAITING_FOR_COL_ADVANCE: -+ printk("'Waiting for column advance'\n"); -+ break; -+ case STATE_WAITING_FOR_SCAN_START: -+ printk("'Waiting for scan start'\n"); -+ break; -+ case STATE_WAITING_FOR_SCAN_END: -+ printk("'Waiting for scan end'\n"); -+ break; -+ case STATE_WAITING_FOR_ROW_SETUP: -+ printk("'Waiting for row setup'\n"); -+ break; -+ case STATE_WAITING_FOR_COL_TIME: -+ printk("'Waiting for one column time (depends on scan rate)'\n"); -+ break; -+ case STATE_WAITING_FOR_QUEUED_DATA: -+ printk("'Waiting for queued data transmission to be completed'\n"); -+ break; -+ case STATE_WAIT_FOR_128_US: -+ printk("'Wait for 128 us'\n"); -+ break; -+ default: -+ printk("none (?!)\n"); -+ break; -+ -+ } -+ -+ } -+ -+ if (buffer[1] & AES2501_STAT_ERROR) -+ PRINTK_DBG("got serial interface framing error\n"); -+ -+ if (buffer[1] & AES2501_STAT_PAUSED) -+ PRINTK_DBG("scan was paused due to input buffer full\n"); -+ -+ if (buffer[1] & AES2501_STAT_RESET) -+ PRINTK_DBG("master reset input has been asserted\n"); -+ -+ -+ -+ -+ return 0; -+ -+ -+} -+ -+ -+ -+ -+static int setup_aes2501(struct usb_aes2501 *dev) -+{ -+ //unsigned char patch_msg[] = "\x80\x01"; -+ -+ -+ //unsigned char cmd[] = "\x80\x01\x81\x02"; -+ -+ //unsigned char cmd_00[] = "\xb0\x27"; -+ //unsigned char cmd_01[] = "\x80\x01\x82\x40"; -+ //unsigned char cmd_02[] = "\xff\x00"; -+ //unsigned char cmd_03[] = "\x80\x01\x82\x40\x83\x00\x88\x02\x89\x10\x8a\x05\x8c\x00\x8e\x13\x91\x44\x92\x34\x95\x16\x96\x16\x97\x18\xa1\x70\xa2\x02\xa7\x00\xac\x01\xad\x1a\x80\x04\x81\x04\xb4\x00";/*42*/ -+ //unsigned char cmd_04[] = "\x80\x01\x82\x40"; -+ -+ //unsigned char cmd2[] = "\x80\x01\xa8\x41\x82\x42\x83\x53\x80\x04\x81\x02";/*12*/ -+ -+ //unsigned char cmd3_00[] = "\xff\x00"; -+ //unsigned char cmd3_01[] = "\x80\x01\xa8\x41\x82\x42\x83\x53\x80\x04\x81\x02";/*12*/ -+ -+ //unsigned char cmd4[] = "\x80\x01\x82\x40\xb0\x27\x94\x0a\x80\x04\x83\x45\xa8\x41";/*14*/ -+ -+ //unsigned char cmd5_00[] = "\xb0\x27"; -+ //unsigned char cmd5_01[] = "\x80\x01\x82\x40"; -+ //unsigned char cmd5_02[] = "\xff\x00"; -+ //unsigned char cmd5_03[] = "\x80\x02"; -+ //unsigned char cmd5_04[] = "\x81\x02"; -+ -+ -+ int i; -+ -+ unsigned char buffer[128]; -+ -+ -+ /* To be sure the device will respond */ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ //send_data_to_aes2501(dev, patch_msg, 2); -+ flush_aes2501_bulk_out(dev);/* ... */ -+ -+ printk(KERN_INFO ">> Setting up aes2501 !\n"); -+ -+ /* Part 1 */ -+ -+ printk(KERN_INFO " -- part 1 --\n"); -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_CTRL2, AES2501_CTRL2_READ_REGS); -+ flush_aes2501_bulk_out(dev); -+ -+ //send_data_to_aes2501(dev, cmd, 4); -+ recv_data_to_aes2501(dev, buffer, 126); -+ -+ -+ -+ //send_data_to_aes2501(dev, cmd_00, 2); -+ -+ write_aes2501_register(dev, 0xb0, 0x27);/* Reserved */ -+ -+ -+ -+ //send_data_to_aes2501(dev, cmd_01, 4); -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x40);/* ??? */ -+ -+ for (i = 0; i <= 10; i++) -+ { -+ //msleep(200); -+ //send_data_to_aes2501(dev, cmd_02, 2); -+ write_aes2501_register(dev, 0xff, 0x00);/* Reserved */ -+ } -+ -+ //msleep(100); -+ -+ -+ //send_data_to_aes2501(dev, cmd_03, 42); -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x40);/* ??? */ -+ write_aes2501_register(dev, AES2501_REG_DETCTRL, AES2501_DETCTRL_DRATE_CONTINUOUS | AES2501_DETCTRL_SDELAY_31_MS); -+ write_aes2501_register(dev, AES2501_REG_COLSCAN, AES2501_COLSCAN_SRATE_128_US); -+ write_aes2501_register(dev, AES2501_REG_MEASDRV, AES2501_MEASDRV_MDRIVE_0_325 | AES2501_MEASDRV_MEASURE_SQUARE); -+ write_aes2501_register(dev, AES2501_REG_MEASFREQ, AES2501_MEASFREQ_2M); -+ write_aes2501_register(dev, AES2501_REG_DEMODPHASE1, DEMODPHASE_NONE);/* Default */ -+ write_aes2501_register(dev, AES2501_REG_DEMODPHASE2, DEMODPHASE_NONE); -+ write_aes2501_register(dev, AES2501_REG_CHANGAIN, AES2501_CHANGAIN_STAGE2_4X | AES2501_CHANGAIN_STAGE1_16X); -+ write_aes2501_register(dev, AES2501_REG_ADREFHI, 0x44); -+ write_aes2501_register(dev, AES2501_REG_ADREFLO, 0x34); -+ write_aes2501_register(dev, AES2501_REG_STRTCOL, 0x16); -+ write_aes2501_register(dev, AES2501_REG_ENDCOL, 0x16); -+ write_aes2501_register(dev, AES2501_REG_DATFMT, AES2501_DATFMT_BIN_IMG | 0x08);/* ??? */ -+ write_aes2501_register(dev, AES2501_REG_TREG1, 0x70);/* Reserved + 0xXX */ -+ write_aes2501_register(dev, 0xa2, 0x02);/* Reserved */ -+ write_aes2501_register(dev, 0xa7, 0x00);/* Reserved */ -+ write_aes2501_register(dev, AES2501_REG_TREGC, AES2501_TREGC_ENABLE); -+ write_aes2501_register(dev, AES2501_REG_TREGD, 0x1a); -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_REG_UPDATE); -+ write_aes2501_register(dev, AES2501_REG_CTRL2, AES2501_CTRL2_SET_ONE_SHOT); -+ write_aes2501_register(dev, AES2501_REG_LPONT, AES2501_LPONT_MIN_VALUE); -+ -+ -+ flush_aes2501_bulk_out(dev); -+ -+ recv_data_to_aes2501(dev, buffer, 20); -+ -+ -+ -+ //send_data_to_aes2501(dev, cmd_04, 4); -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x40);/* ??? */ -+ -+ /* Part 2 */ -+ -+ printk(KERN_INFO " -- part 2 --\n"); -+ -+ //msleep(100); -+ -+ //send_data_to_aes2501(dev, cmd2, 12); -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_AUTOCALOFFSET, 0x41); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x42);/* ??? */ -+ write_aes2501_register(dev, AES2501_REG_DETCTRL, 0x53);/* Cumul ??? */ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_REG_UPDATE); -+ write_aes2501_register(dev, AES2501_REG_CTRL2, AES2501_CTRL2_READ_REGS); -+ -+ -+ -+ -+ flush_aes2501_bulk_out(dev); -+ -+ -+ recv_data_to_aes2501(dev, buffer, 126); -+ -+ /* Part 3 */ -+ -+ printk(KERN_INFO " -- part 3 --\n"); -+ -+ i = 0; -+ -+ printk(KERN_INFO " reg 0xaf = 0x%x\n", buffer[0x5f]); -+ while (buffer[0x5f] == 0x6b) -+ { -+ //msleep(200); -+ -+ -+ //send_data_to_aes2501(dev, cmd3_00, 2); -+ write_aes2501_register(dev, 0xff, 0x00);/* Reserved */ -+ -+ //msleep(80); -+ -+ //send_data_to_aes2501(dev, cmd3_01, 12); -+ -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_AUTOCALOFFSET, 0x41); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x42);/* ??? */ -+ write_aes2501_register(dev, AES2501_REG_DETCTRL, 0x53);/* Cumul ??? */ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_REG_UPDATE); -+ write_aes2501_register(dev, AES2501_REG_CTRL2, AES2501_CTRL2_READ_REGS); -+ -+ flush_aes2501_bulk_out(dev); -+ -+ -+ -+ -+ recv_data_to_aes2501(dev, buffer, 126); -+ -+ printk(KERN_INFO " +reg 0xaf = 0x%x\n", buffer[0x5f]); -+ -+ if (++i == 13) break; -+ -+ } -+ -+ -+ -+ -+ -+ /* Part 4 */ -+ -+ printk(KERN_INFO " -- part 4 --\n"); -+ -+ //send_data_to_aes2501(dev, cmd4, 14); -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x40);/* ??? */ -+ write_aes2501_register(dev, 0xb0, 0x27);/* Reserved */ -+ write_aes2501_register(dev, AES2501_REG_ENDROW, 0x0a); -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_REG_UPDATE); -+ write_aes2501_register(dev, AES2501_REG_DETCTRL, 0x45);/* ???? */ -+ write_aes2501_register(dev, AES2501_REG_AUTOCALOFFSET, 0x41); -+ -+ -+ -+ -+ -+ -+ /* ... */ -+ -+ -+/* -+ for (i = 0; i < 126; i += 10) -+ { -+ printk(KERN_INFO " %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x", -+ buffer[i + 0], buffer[i + 1], buffer[i + 2], buffer[i + 3], buffer[i + 4], -+ buffer[i + 5], buffer[i + 6], buffer[i + 7], buffer[i + 8], buffer[i + 9]); -+ -+ if (i % 20 == 0) -+ printk(KERN_INFO "\n "); -+ -+ } -+ -+ printk(KERN_INFO "\n"); -+*/ -+ -+ -+ -+ /* Part 5 */ -+ -+ printk(KERN_INFO " -- part 5 --\n"); -+ -+ //send_data_to_aes2501(dev, cmd5_00, 2); -+ -+ write_aes2501_register(dev, 0xb0, 0x27);/* Reserved */ -+ -+ //send_data_to_aes2501(dev, cmd5_01, 4); -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x40);/* ??? */ -+ -+ //msleep(200); -+ -+ -+ //send_data_to_aes2501(dev, cmd5_02, 2); -+ //send_data_to_aes2501(dev, cmd5_01, 4); -+ //send_data_to_aes2501(dev, cmd5_01, 4); -+ -+ write_aes2501_register(dev, 0xff, 0x00);/* Reserved */ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x40);/* ??? */ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x40);/* ??? */ -+ -+ -+ -+ //msleep(50); -+ -+ //send_data_to_aes2501(dev, cmd5_01, 4); -+ //send_data_to_aes2501(dev, cmd5_01, 4); -+ //send_data_to_aes2501(dev, cmd5_01, 4); -+ //send_data_to_aes2501(dev, cmd5_03, 2); -+ //send_data_to_aes2501(dev, cmd5_03, 2); -+ //send_data_to_aes2501(dev, cmd5_04, 2); -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x40);/* ??? */ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x40);/* ??? */ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x40);/* ??? */ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_SCAN_RESET); -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_SCAN_RESET); -+ write_aes2501_register(dev, AES2501_REG_CTRL2, AES2501_CTRL2_READ_REGS); -+ flush_aes2501_bulk_out(dev); -+ -+ -+ recv_data_to_aes2501(dev, buffer, 126); -+ -+ -+ -+ -+ -+ return 0; -+ -+} -+ -+static int detect_finger_on_aes2501(struct usb_aes2501 *dev) -+{ -+ //uint8_t cmd1[] = "\x80\x01\x82\x40"; -+ //uint8_t cmd2[] = "\x80\x01\x82\x40\x83\x00\x88\x02\x89\x10\x8a\x05\x8c\x00\x8e\x13\x91\x44\x92\x34\x95\x16\x96\x16\x97\x18\xa1\x70\xa2\x02\xa7\x00\xac\x01\xad\x1a\x80\x04\x81\x04\xb4\x00";/*42*/ -+ -+ -+ unsigned char buffer[22]; -+ unsigned i, sum; -+ -+ //send_data_to_aes2501(dev, cmd1, 4); -+ -+ //msleep(30); -+ -+ -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x40);/* Reserved */ -+ write_aes2501_register(dev, AES2501_REG_DETCTRL, AES2501_DETCTRL_DRATE_CONTINUOUS | AES2501_DETCTRL_SDELAY_31_MS); -+ write_aes2501_register(dev, AES2501_REG_COLSCAN, AES2501_COLSCAN_SRATE_128_US);/* not the faster ??? */ -+ write_aes2501_register(dev, AES2501_REG_MEASDRV, AES2501_MEASDRV_MDRIVE_0_325 | AES2501_MEASDRV_MEASURE_SQUARE); -+ write_aes2501_register(dev, AES2501_REG_MEASFREQ, AES2501_MEASFREQ_2M); -+ write_aes2501_register(dev, AES2501_REG_DEMODPHASE1, DEMODPHASE_NONE);/* Default */ -+ write_aes2501_register(dev, AES2501_REG_DEMODPHASE2, DEMODPHASE_NONE); -+ write_aes2501_register(dev, AES2501_REG_CHANGAIN, AES2501_CHANGAIN_STAGE2_4X | AES2501_CHANGAIN_STAGE1_16X); -+ write_aes2501_register(dev, AES2501_REG_ADREFHI, 0x44); -+ write_aes2501_register(dev, AES2501_REG_ADREFLO, 0x34); -+ write_aes2501_register(dev, AES2501_REG_STRTCOL, 0x16); -+ write_aes2501_register(dev, AES2501_REG_ENDCOL, 0x16); -+ write_aes2501_register(dev, AES2501_REG_DATFMT, AES2501_DATFMT_BIN_IMG | 0x08); -+ write_aes2501_register(dev, AES2501_REG_TREG1, 0x70);/* Reserved + 0xXX */ -+ write_aes2501_register(dev, 0xa2, 0x02);/* Reserved */ -+ write_aes2501_register(dev, 0xa7, 0x00);/* Reserved */ -+ write_aes2501_register(dev, AES2501_REG_TREGC, AES2501_TREGC_ENABLE); -+ write_aes2501_register(dev, AES2501_REG_TREGD, 0x1a); -+ -+ flush_aes2501_bulk_out(dev); -+ -+ /** -+ * TODO: -+ * - lire ici les deux octets. -+ * - voir pour inverser les commandes. -+ */ -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_REG_UPDATE); -+ write_aes2501_register(dev, AES2501_REG_CTRL2, AES2501_CTRL2_SET_ONE_SHOT); -+ write_aes2501_register(dev, AES2501_REG_LPONT, AES2501_LPONT_MIN_VALUE); -+ -+ flush_aes2501_bulk_out(dev); -+ -+ -+ //send_data_to_aes2501(dev, cmd2, 42); -+ -+ recv_data_to_aes2501(dev, buffer, 20); -+ -+ -+ /* One column is returned here but I don't know which one. -+ Maybe an average over the whole sensor area. */ -+ sum = 0; -+ for (i = 1; i != 9; i++) { -+ sum += (buffer[i] & 0xf) + (buffer[i] >> 4); -+ } -+ -+ -+ //printk(KERN_INFO "===finger=== sum = %d vs %d\n", sum, 20); -+ -+ -+ /* -+ return (sum > aes->fingerTh1); -+ */ -+ -+ return sum > 20; -+ -+} -+ -+ -+static unsigned read_fingerprint_on_aes2501(struct usb_aes2501 *dev, void *raw_, unsigned maxstrip) -+{ -+ //unsigned char patch_msg[] = "\x80\x01"; -+ -+ /* 8e xx = set gain */ -+ //uint8_t cmd1_00[] = "0x80\x01\x82\x40"; -+ //uint8_t cmd1_01[] = "0x80\x01\x82\x40\x83\x00\x88\x02\x8c\x7c\x89\x10\x8d\x24\x9b\x00\x9c\x6c\x9d\x09\x9e\x54\x9f\x78\xa2\x02\xa7\x00\xb6\x26\xb7\x1a\x80\x04\x98\x23\x95\x10\x96\x1f\x8e\x00\x91\x70\x92\x20\x81\x04\xb4\x00";/*50*/ -+ -+ //uint8_t cmd2[] = "\x98\x23\x95\x10\x96\x1f\x8e\x03\x91\x70\x92\x20\x81\x04";/*14*/ -+ -+ //uint8_t cmd3[] = "\x98\x22\x95\x00\x96\x2f\x8e\x03\x91\x5b\x92\x20\x81\x04";/*14*/ -+ -+ uint8_t buf[1705]; -+ uint8_t *raw = (uint8_t *) raw_; -+ unsigned nstrips; -+ -+ int threshold; -+ int sum; -+ -+ -+ //send_data_to_aes2501(dev, patch_msg, 2); -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ flush_aes2501_bulk_out(dev); -+ -+ -+ -+ //send_data_to_aes2501(dev, cmd1_00, 4); -+ -+ -+ //send_data_to_aes2501(dev, cmd1_01, 50); -+ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_MASTER_RESET); -+ write_aes2501_register(dev, AES2501_REG_EXCITCTRL, 0x40);/* Reserved */ -+ write_aes2501_register(dev, AES2501_REG_DETCTRL, AES2501_DETCTRL_SDELAY_31_MS | AES2501_DETCTRL_DRATE_CONTINUOUS); -+ write_aes2501_register(dev, AES2501_REG_COLSCAN, AES2501_COLSCAN_SRATE_128_US); -+ write_aes2501_register(dev, AES2501_REG_DEMODPHASE2, 0x7c);/* ... */ -+ write_aes2501_register(dev, AES2501_REG_MEASDRV, AES2501_MEASDRV_MEASURE_SQUARE | AES2501_MEASDRV_MDRIVE_0_325); -+ write_aes2501_register(dev, AES2501_REG_DEMODPHASE1, 0x24);/* ... */ -+ write_aes2501_register(dev, AES2501_REG_CHWORD1, 0x00);/* Challenge Word */ -+ write_aes2501_register(dev, AES2501_REG_CHWORD2, 0x6c);/* Challenge Word */ -+ write_aes2501_register(dev, AES2501_REG_CHWORD3, 0x09);/* Challenge Word */ -+ write_aes2501_register(dev, AES2501_REG_CHWORD4, 0x54);/* Challenge Word */ -+ write_aes2501_register(dev, AES2501_REG_CHWORD5, 0x78);/* Challenge Word */ -+ write_aes2501_register(dev, 0xa2, 0x02);/* Reserved */ -+ write_aes2501_register(dev, 0xa7, 0x00);/* Reserved */ -+ write_aes2501_register(dev, 0xb6, 0x26);/* Reserved */ -+ write_aes2501_register(dev, 0xb7, 0x1a);/* Reserved */ -+ write_aes2501_register(dev, AES2501_REG_CTRL1, AES2501_CTRL1_REG_UPDATE); -+ write_aes2501_register(dev, AES2501_REG_IMAGCTRL, AES2501_IMAGCTRL_TST_REG_ENABLE | AES2501_IMAGCTRL_HISTO_DATA_ENABLE | AES2501_IMAGCTRL_IMG_DATA_DISABLE); -+ write_aes2501_register(dev, AES2501_REG_STRTCOL, 0x10); -+ write_aes2501_register(dev, AES2501_REG_ENDCOL, 0x1f); -+ write_aes2501_register(dev, AES2501_REG_CHANGAIN, AES2501_CHANGAIN_STAGE1_2X | AES2501_CHANGAIN_STAGE2_2X); -+ write_aes2501_register(dev, AES2501_REG_ADREFHI, 0x70); -+ write_aes2501_register(dev, AES2501_REG_ADREFLO, 0x20); -+ write_aes2501_register(dev, AES2501_REG_CTRL2, AES2501_CTRL2_SET_ONE_SHOT); -+ write_aes2501_register(dev, AES2501_REG_LPONT, AES2501_LPONT_MIN_VALUE); -+ -+ ///////recv_data_to_aes2501(dev, buf, 159); -+ /* TODO: calibration e.g setting gain (0x8e xx) */ -+ -+ -+ -+ -+ //send_data_to_aes2501(dev, cmd2, 14); -+ -+ -+ -+ write_aes2501_register(dev, AES2501_REG_IMAGCTRL, AES2501_IMAGCTRL_TST_REG_ENABLE | AES2501_IMAGCTRL_HISTO_DATA_ENABLE | AES2501_IMAGCTRL_IMG_DATA_DISABLE); -+ write_aes2501_register(dev, AES2501_REG_STRTCOL, 0x10); -+ write_aes2501_register(dev, AES2501_REG_ENDCOL, 0x1f); -+ write_aes2501_register(dev, AES2501_REG_CHANGAIN, AES2501_CHANGAIN_STAGE1_16X); -+ write_aes2501_register(dev, AES2501_REG_ADREFHI, 0x70); -+ write_aes2501_register(dev, AES2501_REG_ADREFLO, 0x20); -+ write_aes2501_register(dev, AES2501_REG_CTRL2, AES2501_CTRL2_SET_ONE_SHOT); -+ -+ flush_aes2501_bulk_out(dev); -+ -+ -+ recv_data_to_aes2501(dev, buf, 159); -+ -+ nstrips = 0; -+ do { -+ printk(KERN_INFO "-start-\n"); -+ /* Timing in this loop is critical. It decides how fast you can move your finger. -+ If one loop takes tl second, the maximum speed is: -+ (16/500 * 25.4) / tl [mm per sec] -+ */ -+ //send_data_to_aes2501(dev, cmd3, 14); -+ -+ write_aes2501_register(dev, AES2501_REG_IMAGCTRL, AES2501_IMAGCTRL_TST_REG_ENABLE | AES2501_IMAGCTRL_HISTO_DATA_ENABLE); -+ write_aes2501_register(dev, AES2501_REG_STRTCOL, 0x00); -+ write_aes2501_register(dev, AES2501_REG_ENDCOL, 0x2f); -+ write_aes2501_register(dev, AES2501_REG_CHANGAIN, AES2501_CHANGAIN_STAGE1_16X); -+ write_aes2501_register(dev, AES2501_REG_ADREFHI, 0x5b); -+ write_aes2501_register(dev, AES2501_REG_ADREFLO, 0x20); -+ write_aes2501_register(dev, AES2501_REG_CTRL2, AES2501_CTRL2_SET_ONE_SHOT); -+ -+ flush_aes2501_bulk_out(dev); -+ -+ -+ -+ recv_data_to_aes2501(dev, buf, 1705); -+ memcpy(raw, buf+1, 192*8); -+ raw += 192*8; -+ -+ printk(KERN_INFO "-end of copy-\n"); -+ -+ -+ threshold = read_register_value((buf + 1 + 192*8 + 1 + 16*2 + 1 + 8), _AES2501_REG_DATFMT); -+ /*if (threshold < 0) -+ return threshold;*/ -+ -+ threshold &= 0x0f; -+ -+ sum = sum_histogram_values((buf + 1 + 192*8), threshold); -+ /*if (threshold < 0) -+ return threshold;*/ -+ -+ nstrips++; -+ printk(KERN_INFO "-end- %d vs %d\n", nstrips, maxstrip); -+ } while (sum > 0 && nstrips < maxstrip); -+ printk(KERN_INFO "nstrips = %u\n", nstrips); -+ if (nstrips == maxstrip) -+ printk(KERN_INFO "nstrips == %u, swiping the finger too slowly?\n", maxstrip); -+ return nstrips; -+} -+ -+ -+ -+/** -+ * Read a register value from a dump sent by the device. -+ * @data: list of couples . -+ * @target: index of the register to process. -+ * @return: -EILSEQ,-EINVAL if error, value > 0 if a finger is here. -+ */ -+int read_register_value(const uint8_t *data, Aes2501Registers target) -+{ -+ int result; -+ uint8_t offset; -+ -+ if (*data == FIRST_AES2501_REG) -+ { -+ offset = target; -+ -+ if (!(FIRST_AES2501_REG <= offset && offset <= LAST_AES2501_REG)) -+ result = -EINVAL; -+ -+ else -+ { -+ offset -= FIRST_AES2501_REG; -+ offset *= 2; -+ -+ result = data[++offset]; -+ -+ } -+ -+ } -+ else result = -EILSEQ; -+ -+ return result; -+ -+} -+ -+ -+/** -+ * Tells if a finger motion is still detected. -+ * @data: start point of data to handle, preceded by 0xde. -+ * @threshold: index of values set to 1 by the device. -+ * @return: -EILSEQ,-EINVAL if error, value > 0 if a finger is here. -+ * -+ * Histograms always are a 16-uint16_t long message, where -+ * histogram[i] = number of pixels of value i. -+ */ -+int sum_histogram_values(const uint8_t *data, uint8_t threshold) -+{ -+ int result; -+ uint16_t *histogram; -+ uint8_t i; -+ -+ if (*data == 0xde) -+ { -+ if (threshold > 0x0f) -+ result = -EINVAL; -+ -+ else -+ { -+ result = 0; -+ histogram = (uint16_t *)(data + 1); -+ -+ for (i = threshold; i < 16; i++) -+ result += histogram[i]; -+ -+ } -+ -+ } -+ else result = -EILSEQ; -+ -+ return result; -+ -+} -+ -+ -+ -+/********************************************************** -+ ** Image processing -+ **********************************************************/ -+ -+/* This function finds overlapping parts of two frames -+ * Based on calculating normalized hamming distance -+ * between two frames -+ */ -+ -+static unsigned find_overlap(const uint8_t *first_frame, -+ const uint8_t *second_frame, -+ uint32_t frame_height, -+ uint32_t frame_width, -+ uint32_t *min_error) -+{ -+ uint32_t dy, i; -+ uint32_t error, not_overlapped_height = 0; -+ *min_error = 255 * frame_height * frame_width; -+ for (dy = 0; dy < frame_height; dy++) { -+ /* Calculating difference (error) between parts of frames */ -+ error = 0; -+ for (i = 0; i < frame_width * (frame_height - dy); i++) { -+ /* Using ? operator to avoid abs function */ -+ error += first_frame[i] > second_frame[i] ? -+ (first_frame[i] - second_frame[i]) : -+ (second_frame[i] - first_frame[i]); -+ } -+ -+ /* Normalizing error */ -+ error *= 15; -+ error /= i; -+ if (error < *min_error) { -+ *min_error = error; -+ not_overlapped_height = dy; -+ } -+ first_frame += frame_width; -+ } -+ -+ return not_overlapped_height; -+} -+ -+ -+/* This function assembles frames to single image, returns image height -+ * TODO: add Doxygen comments -+ */ -+static unsigned assemble(const uint8_t *input, /* Raw data received from device */ -+ uint8_t *output, /* Output buffer */ -+ uint32_t frame_height, /* Height of each frame */ -+ uint32_t frame_width, /* Width of each frame */ -+ uint32_t frames_count, /* Frames count */ -+ /*int overlap, */ -+ uint8_t reversed, -+ uint32_t *errors_sum -+ ) -+{ -+ uint8_t *assembled = output; -+ uint32_t frame, column, row, image_height = frame_height; -+ uint32_t error, not_overlapped; -+ -+ *errors_sum = 0; -+ -+ if (frames_count < 1) return 0; -+ -+ /* Rotating given data by 90 degrees -+ * Taken from document describing aes2501 image format -+ * TODO: move reversing detection here */ -+ if (reversed) { -+ output += (frames_count - 1) * frame_width * frame_height; -+ } -+ -+ for (frame = 0; frame < frames_count; frame++) { -+ for (column = 0; column < frame_width; column++) { -+ for (row = 0; row < (frame_height / 2); row++) { -+ output[frame_width * ( 2 * row) + column] = *input & 0x0F; -+ output[frame_width * ( 2 * row + 1) + column] = *input >> 4; -+ input++; -+ } -+ } -+ -+ if (reversed) { -+ output -= frame_width * frame_height; -+ } -+ else { -+ output += frame_width * frame_height; -+ } -+ } -+ -+ /* Detecting where frames overlaped */ -+ output = assembled; -+ for (frame = 1; frame < frames_count; frame++) -+ { -+ output += frame_width * frame_height; -+ not_overlapped = find_overlap(assembled, output, frame_height, frame_width, &error); -+ *errors_sum += error; -+ image_height += not_overlapped; -+ assembled += frame_width * not_overlapped; -+ memcpy(assembled, output, frame_width * frame_height); -+ } -+ -+ return image_height; -+} -+ -+ -+ -+static void store_new_aes2501_pnm(const uint8_t *data, unsigned int width, unsigned int height) -+{ -+ char header[20]; -+ __kernel_size_t header_len; -+ int i; -+ char *iter; -+ -+ sprintf(header, "P5\n%u %u\n255\n", width, height); -+ header_len = strlen(header); -+ -+ finger_print_len = header_len + width * height; -+ finger_print = kzalloc(finger_print_len, GFP_KERNEL); -+ -+ memcpy(finger_print, header, header_len); -+ -+ for (i = 0, iter = &finger_print[header_len]; i < width * height; i++, iter++) -+ *iter = (data[i] << 4) + 0x0f; -+ -+} -+ -+ -+ -+static void do_scanning(struct work_struct *work) -+{ -+ struct usb_aes2501 *dev; -+ -+ /* !!!!!!!!!!!!!!!!!!!!!!!!!!!!! */ -+ -+ uint8_t *raw, *cooked; -+ unsigned swidth = 192; -+ unsigned sheight = 16; -+ unsigned maxstrip = 150; -+ unsigned nstrips, height, mindiff_sum, mindiff_sum_r; -+ -+ /* !!!!!!!!!!!!!!!!!!!!!!!!!!!!! */ -+ -+ dev = container_of(work, struct usb_aes2501, scan_work); -+ -+ -+ -+ -+ -+ -+ setup_aes2501(dev); -+ -+ while (!detect_finger_on_aes2501(dev)) -+ { -+ if (dev->stop_scan) -+ { -+ PRINTK_INFO("aborting scan due to module removal\n"); -+ return; -+ } -+ }; -+ -+ /* We don't need physical continuity of allocated memory */ -+ raw = (uint8_t *)vmalloc((3 * maxstrip * sheight * swidth) / 2); -+ if (raw == NULL) -+ { -+ PRINTK_CRIT("failed to allocate memory\n"); -+ return; -+ } -+ -+ cooked = raw + (maxstrip * sheight * swidth)/2; -+ -+ -+ -+ printk(KERN_INFO "Raw is 0x%p\n", raw); -+ -+ -+ printk(KERN_INFO "Scanning...\n"); -+ nstrips = read_fingerprint_on_aes2501(dev, raw, maxstrip); -+ -+ printk(KERN_INFO "Assembling...\n"); -+ -+ -+ height = assemble(raw, cooked, 16, 192, nstrips, 0, &mindiff_sum); -+ height = assemble(raw, cooked, 16, 192, nstrips, 1, &mindiff_sum_r); -+ -+ -+ printk(KERN_INFO "Mindiff normal: %d, mindiff reversed: %d\n", mindiff_sum, mindiff_sum_r); -+ -+ if (mindiff_sum_r < mindiff_sum) -+ { -+ PRINTK_INFO("reversed image detected\n"); -+ } -+ else -+ { -+ height = assemble(raw, cooked, 16, 192, nstrips, 0, &mindiff_sum); -+ } -+ -+ printk(KERN_INFO "First height :: %d\n", height); -+ -+#if 0 -+ if (height < 100) { -+ /* It was a "touch", not a finger scan. */ -+ printk(KERN_INFO "Was only a 'touch' ;( [%d]\n", height); -+ /*break;*/ -+ } -+ else -+ -+ { -+ //store_new_aes2501_pnm(cooked, swidth, height); -+ height = assemble(raw, cooked, nstrips, 1, sensor_reversed); -+ printk(KERN_INFO "Second height :: %d\n", height); -+ store_new_aes2501_pnm(cooked, swidth, height); -+ } -+#endif -+ store_new_aes2501_pnm(cooked, swidth, height); -+ standby_aes2501(dev); -+ -+ vfree(raw); -+ -+ flag = 1; -+ wake_up_interruptible(&wq); -+ -+ -+} -+ -+ -+static int aes2501_open(struct inode *inode, struct file *file) -+{ -+ struct usb_aes2501 *dev; -+ -+ //return 0; -+ -+ -+ dev = _dev; -+ -+ printk(KERN_INFO "Plop !\n"); -+ -+ -+ return 0; -+} -+ -+ -+ -+ -+ -+ -+/* -+ * usb class driver info in order to get a minor number from the usb core, -+ * and to have the device registered with the driver core -+ */ -+static struct usb_class_driver aes2501_class = { -+ .name = "aes2501%d", -+ .fops = &aes2501_fops, -+ .minor_base = USB_AES2501_MINOR_BASE, -+}; -+ -+static int aes2501_probe(struct usb_interface *interface, const struct usb_device_id *id) -+{ -+ int retval; -+ struct usb_aes2501 *dev; -+ struct usb_host_interface *iface_desc; -+ __u8 i; -+ struct usb_endpoint_descriptor *endpoint; -+ __u16 buffer_size; -+ -+ -+ -+#if 0 -+ /* !!!!!!!!!!!!!!!!!!!!!!!!!!!!! */ -+ -+ uint8_t *raw, *cooked; -+ unsigned swidth = 192; -+ unsigned sheight = 16; -+ unsigned maxstrip = 150; -+ unsigned nstrips, height; -+ -+ /* !!!!!!!!!!!!!!!!!!!!!!!!!!!!! */ -+ -+ -+ raw = (uint8_t *)__get_free_page(GFP_KERNEL);//kmalloc((3 * maxstrip * sheight * swidth) / 2, GFP_KERNEL); -+ cooked = raw + (maxstrip * sheight * swidth)/2; -+#endif -+ -+ printk(KERN_INFO "aes2501 probe !\n"); -+ -+ -+ retval = -ENOMEM; -+ -+ /* Allocate memory for our device state and initialize it */ -+ -+ dev = kzalloc(sizeof(*dev), GFP_KERNEL); -+ if (dev == NULL) -+ { -+ PRINTK_CRIT("out of memory\n"); -+ goto error; -+ } -+ -+ _dev = dev; -+ -+ dev->stop_scan = 0; -+ -+ kref_init(&dev->kref); -+ sema_init(&dev->limit_sem, WRITES_IN_FLIGHT); -+ mutex_init(&dev->io_mutex); -+ -+ dev->udev = usb_get_dev(interface_to_usbdev(interface)); -+ dev->interface = interface; -+ -+ printk(KERN_INFO "num_altsetting == %d\n", interface->num_altsetting); -+ -+ /** -+ * Set up the endpoint information. -+ * Use only the first bulk-in and bulk-out endpoints. -+ */ -+ -+ iface_desc = interface->cur_altsetting; -+ -+ printk(KERN_INFO "BULK COUNT %d\n", iface_desc->desc.bNumEndpoints); -+ -+ for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) -+ { -+ endpoint = &iface_desc->endpoint[i].desc; -+ -+ if (!dev->bulk_in_endpointAddr && /*usb_endpoint_is_bulk_in(endpoint))*/ -+ ((endpoint->bEndpointAddress & USB_ENDPOINT_DIR_MASK) -+ == USB_DIR_IN) && -+ ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) -+ == USB_ENDPOINT_XFER_BULK)) -+ { -+ /* We found a bulk in endpoint */ -+ buffer_size = le16_to_cpu(endpoint->wMaxPacketSize); -+ dev->bulk_in_size = buffer_size; -+ dev->bulk_in_endpointAddr = endpoint->bEndpointAddress; -+ dev->bulk_in_buffer = kmalloc(buffer_size, GFP_KERNEL); -+ -+ printk(KERN_INFO "BULK IN %d ; size = %d\n", i, buffer_size); -+ -+ if (dev->bulk_in_buffer == NULL) -+ { -+ PRINTK_CRIT("could not allocate bulk_in_buffer\n"); -+ goto error; -+ } -+ -+ } -+ -+ if (!dev->bulk_out_endpointAddr && /*usb_endpoint_is_bulk_out(endpoint))*/ -+ ((endpoint->bEndpointAddress & USB_ENDPOINT_DIR_MASK) -+ == USB_DIR_OUT) && -+ ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) -+ == USB_ENDPOINT_XFER_BULK)) -+ { -+ printk(KERN_INFO "BULK OUT %d\n", i); -+ -+ /* We found a bulk out endpoint */ -+ dev->bulk_out_endpointAddr = endpoint->bEndpointAddress; -+ } -+ -+ } -+ -+ if (!(dev->bulk_in_endpointAddr && dev->bulk_out_endpointAddr)) -+ { -+ PRINTK_CRIT("could not find both bulk-in and bulk-out endpoints\n"); -+ goto error; -+ } -+ -+/* -+ dev->once_tasklet = kzalloc(sizeof(*dev->once_tasklet), GFP_KERNEL); -+ if (dev->once_tasklet == NULL) -+ { -+ PRINTK_CRIT("out of memory\n"); -+ goto error; -+ } -+*/ -+ /* Save our data pointer in this interface device */ -+ usb_set_intfdata(interface, dev); -+ -+ /* We can register the device now, as it is ready */ -+ retval = usb_register_dev(interface, &aes2501_class); -+ if (retval) { -+ /* something prevented us from registering this driver */ -+ PRINTK_CRIT("not able to get a minor for this device\n"); -+ usb_set_intfdata(interface, NULL); -+ goto error; -+ } -+ -+ /* Let the user know what node this device is now attached to */ -+ PRINTK_INFO("device now attached to aes2501-%d\n", interface->minor); -+ -+#if 0 -+ setup_aes2501(dev); -+ -+ while (!detect_finger_on_aes2501(dev)); -+ -+ -+ printk(KERN_INFO "Raw is 0x%p\n", raw); -+ -+ -+ printk(KERN_INFO "Scanning...\n"); -+ nstrips = read_fingerprint_on_aes2501(dev, raw, maxstrip); -+ -+ printk(KERN_INFO "Assembling...\n"); -+ -+ height = assemble(raw, cooked, nstrips, 1); -+ if (height < 100) { -+ /* It was a "touch", not a finger scan. */ -+ printk(KERN_INFO "Was only a 'touch' ;(\n"); -+ /*break;*/ -+ } -+ else -+ { -+ store_new_aes2501_pnm(cooked, swidth, height); -+ height = assemble(raw, cooked, nstrips, 0); -+ store_new_aes2501_pnm(cooked, swidth, height); -+ } -+ -+ standby_aes2501(dev); -+#endif -+ -+ return 0; -+ -+error: -+ if (dev != NULL) -+ kref_put(&dev->kref, aes2501_delete); -+ -+ return retval; -+ -+} -+ -+ -+static void aes2501_disconnect(struct usb_interface *interface) -+{ -+ int minor; -+ struct usb_aes2501 *dev; -+ -+ minor = interface->minor; -+ -+ /* Prevent aes2501_open() from racing aes2501_disconnect() */ -+ lock_kernel(); -+ -+ dev = usb_get_intfdata(interface); -+ usb_set_intfdata(interface, NULL); -+ -+ /* Give back our minor */ -+ usb_deregister_dev(interface, &aes2501_class); -+ -+ /* Prevent more I/O from starting */ -+ mutex_lock(&dev->io_mutex); -+ dev->interface = NULL; -+ mutex_unlock(&dev->io_mutex); -+ -+ unlock_kernel(); -+ -+ /* Decrement our usage count */ -+ kref_put(&dev->kref, aes2501_delete); -+ -+ PRINTK_INFO("aes2501 device #%d now disconnected\n", minor); -+ -+ -+ -+ -+ printk(KERN_INFO "aes2501 disconnect !\n"); -+ -+ -+} -+ -+ -+static struct usb_driver aes2501_driver = { -+ .name = "aes2501", -+ .probe = aes2501_probe, -+ .disconnect = aes2501_disconnect, -+ .id_table = id_table, -+}; -+ -+ -+static int __init aes2501_init(void) -+{ -+ int retval; -+ -+ comm_queue = create_singlethread_workqueue("aes2501"); -+ if (comm_queue == NULL) { -+ PRINTK_CRIT("could not create work queue\n"); -+ return -ENOMEM; -+ } -+ -+ retval = usb_register(&aes2501_driver); -+ if (retval == -EINVAL) -+ { -+ printk(KERN_ERR "usb_register failed. Error number %d\n", retval); -+ destroy_workqueue(comm_queue); -+ return retval; -+ } -+ -+ return 0; -+ -+} -+ -+static void __exit aes2501_exit(void) -+{ -+ _dev->stop_scan = 1; -+ destroy_workqueue(comm_queue); -+ usb_deregister(&aes2501_driver); -+} -+ -+module_init(aes2501_init); -+module_exit(aes2501_exit); -+ -+MODULE_AUTHOR("Cyrille Bagard"); -+MODULE_DESCRIPTION("AES 2501 fingerprint scanner driver"); -+MODULE_LICENSE("GPL"); -diff -Nurp linux-2.6.37/3rdparty/aes2501/aes2501.h linux-2.6.37.3rdparty/3rdparty/aes2501/aes2501.h ---- linux-2.6.37/3rdparty/aes2501/aes2501.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/aes2501/aes2501.h 2008-01-14 03:07:30.000000000 +0200 -@@ -0,0 +1,40 @@ -+ -+/* -+ * aes2501.h -- AuthenTec AES2501 Fingerprint Sensor Driver for Linux -+ * -+ * Maintainer: Cyrille Bagard -+ * -+ * Copyright (C) 2007 Cyrille Bagard -+ * -+ * This file is part of the AES2501 driver. -+ * -+ * the AES2501 driver is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * the AES2501 driver is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with the AES2501 driver; if not, write to the Free Software -+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA -+ * -+ */ -+ -+ -+#ifndef __AES2501_H -+#define __AES2501_H -+ -+ -+#define AES2501_IOC_MAGIC 'N' -+ -+ -+#define AES2501_IOC_TEST _IOW(AES2501_IOC_MAGIC, 1, int) -+ -+ -+ -+ -+#endif /* __AES2501_H */ -diff -Nurp linux-2.6.37/3rdparty/aes2501/aes2501_regs.h linux-2.6.37.3rdparty/3rdparty/aes2501/aes2501_regs.h ---- linux-2.6.37/3rdparty/aes2501/aes2501_regs.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/aes2501/aes2501_regs.h 2008-01-14 03:07:30.000000000 +0200 -@@ -0,0 +1,464 @@ -+ -+/* -+ * aes2501_regs.h -- AuthenTec AES2501 Fingerprint Sensor Driver for Linux -+ * -+ * Maintainer: Cyrille Bagard -+ * -+ * Copyright (C) 2007 Cyrille Bagard -+ * -+ * This file is part of the AES2501 driver. -+ * -+ * the AES2501 driver is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * the AES2501 driver is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with the AES2501 driver; if not, write to the Free Software -+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA -+ * -+ */ -+ -+ -+#ifndef __AES2501_REGS_H -+#define __AES2501_REGS_H -+ -+ -+ -+/* -+ * AES2501 Control Register 1 (CTRL1) -+ */ -+ -+#define AES2501_REG_CTRL1 0x80 -+ -+#define AES2501_CTRL1_MASTER_RESET 0x01 /* Master reset, same as Power On Reset */ -+#define AES2501_CTRL1_SCAN_RESET 0x02 /* Scan reset: stop and restart the scan sequencer */ -+#define AES2501_CTRL1_REG_UPDATE 0x04 /* 1 = continuously updated, 0 = updated prior to starting a scan */ -+ -+ -+/* -+ * AES2501 Control Register 2 (CTRL2) -+ */ -+ -+#define AES2501_REG_CTRL2 0x81 -+ -+#define AES2501_CTRL2_CONTINUOUS 0x01 /* 1 = continuous scans, 0 = single scans */ -+#define AES2501_CTRL2_READ_REGS 0x02 /* Read the current state of the local registers in the Sensor IC */ -+#define AES2501_CTRL2_SET_ONE_SHOT 0x04 /* Set the one-shot flip-flop */ -+#define AES2501_CTRL2_CLR_ONE_SHOT 0x08 /* Clear the one-shot flip-flop */ -+#define AES2501_CTRL2_READ_ID 0x10 /* Read the ID register of the chip */ -+ -+ -+/* -+ * AES2501 Excitation Common Control Register (EXCITCTRL) -+ */ -+ -+#define AES2501_REG_EXCITCTRL 0x82 -+ -+#define AES2501_EXCITCTRL_LO_PWR 0x01 /* If set, enable detection in sleep/suspend mode */ -+#define AES2501_EXCITCTRL_AUTO_CAL 0x02 /* If set, perform finger detection calibration */ -+#define AES2501_EXCITCTRL_SGC_ENABLE 0x04 /* ??? */ -+#define AES2501_EXCITCTRL_SGC_RESTART 0x08 /* ??? */ -+ -+#define AES2501_EXCITCTRL_EXCIT_SQR 0x20 /* Select the (1=square | 0=sine) wave finger drive signal */ -+#define AES2501_EXCITCTRL_EXCIT_BOOST 0x10 /* TODO: understand this part */ -+ -+ -+/* -+ * AES2501 Detect Control Register (DETCTRL) -+ */ -+ -+#define AES2501_REG_DETCTRL 0x83 -+ -+enum aes2501_detection_rate { -+ -+ AES2501_DETCTRL_DRATE_CONTINUOUS = 0x00, /* Detection cycles occur continuously */ -+ AES2501_DETCTRL_DRATE_16_MS = 0x01, /* Detection cycles occur every 16.62 ms */ -+ AES2501_DETCTRL_DRATE_31_MS = 0x02, /* Detection cycles occur every 31.24 ms */ -+ AES2501_DETCTRL_DRATE_62_MS = 0x03, /* Detection cycles occur every 62.50 ms */ -+ AES2501_DETCTRL_DRATE_125_MS = 0x04, /* Detection cycles occur every 125.0 ms */ -+ AES2501_DETCTRL_DRATE_250_MS = 0x05, /* Detection cycles occur every 250.0 ms */ -+ AES2501_DETCTRL_DRATE_500_MS = 0x06, /* Detection cycles occur every 500.0 ms */ -+ AES2501_DETCTRL_DRATE_1_S = 0x07 /* Detection cycles occur every 1 s */ -+ -+}; -+ -+enum aes2501_settling_delay { -+ -+ AES2501_DETCTRL_SDELAY_31_MS = 0x00, /* 31.25 ms */ -+ AES2501_DETCTRL_SSDELAY_62_MS = 0x10, /* 62.5 ms */ -+ AES2501_DETCTRL_SSDELAY_125_MS = 0x20, /* 125 ms */ -+ AES2501_DETCTRL_SSDELAY_250_MS = 0x30 /* 250 ms */ -+ -+}; -+ -+ -+ -+ -+ -+/* -+ * AES2501 Column Scan Rate Register (COLSCAN) -+ */ -+ -+#define AES2501_REG_COLSCAN 0x88 -+ -+enum aes2501_col_scan_rate { -+ -+ AES2501_COLSCAN_SRATE_32_US = 0x00, /* 32 us */ -+ AES2501_COLSCAN_SRATE_64_US = 0x01, /* 64 us */ -+ AES2501_COLSCAN_SRATE_128_US = 0x02, /* 128 us */ -+ AES2501_COLSCAN_SRATE_256_US = 0x03, /* 256 us */ -+ AES2501_COLSCAN_SRATE_512_US = 0x04, /* 512 us */ -+ AES2501_COLSCAN_SRATE_1024_US = 0x05, /* 1024 us */ -+ AES2501_COLSCAN_SRATE_2048_US = 0x06, /* 2048 us */ -+ -+}; -+ -+ -+/* -+ * AES2501 Measure Drive Register (MEASDRV) -+ */ -+ -+#define AES2501_REG_MEASDRV 0x89 -+ -+enum aes2501_mesure_drive { -+ -+ AES2501_MEASDRV_MDRIVE_0_325 = 0x00, /* 0.325 Vpp */ -+ AES2501_MEASDRV_MDRIVE_0_65 = 0x01, /* 0.65 Vpp */ -+ AES2501_MEASDRV_MDRIVE_1_3 = 0x02, /* 1.3 Vpp */ -+ AES2501_MEASDRV_MDRIVE_2_6 = 0x03 /* 2.6 Vpp */ -+ -+}; -+ -+#define AES2501_MEASDRV_SQUARE 0x20 /* Select (1=square | 0=sine) wave drive during measure */ -+#define AES2501_MEASDRV_MEASURE_SQUARE 0x10 /* 0 = use mesure drive setting, 1 = when sine wave is selected */ -+ -+ -+/* -+ * AES2501 Measure Frequency Register (MEASFREQ) -+ */ -+ -+#define AES2501_REG_MEASFREQ 0x8a -+ -+enum aes2501_measure_freq { -+ -+ AES2501_MEASFREQ_125K = 0x01, /* 125 kHz */ -+ AES2501_MEASFREQ_250K = 0x02, /* 250 kHz */ -+ AES2501_MEASFREQ_500K = 0x03, /* 500 kHz */ -+ AES2501_MEASFREQ_1M = 0x04, /* 1 MHz */ -+ AES2501_MEASFREQ_2M = 0x05 /* 2 MHz */ -+ -+}; -+ -+ -+ -+ -+/* -+ * AES2501 Demod Phase 2 Register (DEMODPHASE2) -+ */ -+ -+#define AES2501_REG_DEMODPHASE2 0x8c -+ -+#define DEMODPHASE_NONE 0x00 -+ -+#define DEMODPHASE_180_00 0x40 /* 180 degrees */ -+#define DEMODPHASE_2_81 0x01 /* 2.8125 degrees */ -+ -+ -+/* -+ * AES2501 Demod Phase 1 Register (DEMODPHASE1) -+ */ -+ -+#define AES2501_REG_DEMODPHASE1 0x8d -+ -+#define DEMODPHASE_1_40 0x40 /* 1.40625 degrees */ -+#define DEMODPHASE_0_02 0x01 /* 0.02197256 degrees */ -+ -+ -+/* -+ * AES2501 Channel Gain Register (CHANGAIN) -+ */ -+ -+#define AES2501_REG_CHANGAIN 0x8e -+ -+enum aes2501_sensor_gain1 { -+ -+ AES2501_CHANGAIN_STAGE1_2X = 0x00, /* 2x */ -+ AES2501_CHANGAIN_STAGE1_4X = 0x01, /* 4x */ -+ AES2501_CHANGAIN_STAGE1_8X = 0x02, /* 8x */ -+ AES2501_CHANGAIN_STAGE1_16X = 0x03 /* 16x */ -+ -+}; -+ -+enum aes2501_sensor_gain2 { -+ -+ AES2501_CHANGAIN_STAGE2_2X = 0x00, /* 2x */ -+ AES2501_CHANGAIN_STAGE2_4X = 0x10, /* 4x */ -+ AES2501_CHANGAIN_STAGE2_8X = 0x20, /* 8x */ -+ AES2501_CHANGAIN_STAGE2_16X = 0x30 /* 16x */ -+ -+}; -+ -+ -+ -+/* -+ * AES2501 A/D Reference High Register (ADREFHI) -+ */ -+ -+#define AES2501_REG_ADREFHI 0x91 -+ -+ -+/* -+ * AES2501 A/D Reference Low Register (ADREFLO) -+ */ -+ -+#define AES2501_REG_ADREFLO 0x92 -+ -+ -+/* -+ * AES2501 Start Row Register (STRTROW) -+ */ -+ -+#define AES2501_REG_STRTROW 0x93 -+ -+ -+/* -+ * AES2501 End Row Register (ENDROW) -+ */ -+ -+#define AES2501_REG_ENDROW 0x94 -+ -+ -+/* -+ * AES2501 Start Column Register (STRTCOL) -+ */ -+ -+#define AES2501_REG_STRTCOL 0x95 -+ -+ -+/* -+ * AES2501 End Column Register (ENDCOL) -+ */ -+ -+#define AES2501_REG_ENDCOL 0x96 -+ -+ -+/* -+ * AES2501 Data Format Register (DATFMT) -+ */ -+ -+#define AES2501_REG_DATFMT 0x97 -+ -+#define AES2501_DATFMT_EIGHT 0x40 /* 1 = 8-bit data, 0 = 4-bit data */ -+#define AES2501_DATFMT_LOW_RES 0x20 /* TODO: understand this part */ -+#define AES2501_DATFMT_BIN_IMG 0x10 /* TODO: understand this part */ -+ -+/* TODO: Threshold */ -+ -+ -+/* -+ * AES2501 Image Data Control Register (IMAGCTRL) -+ */ -+ -+#define AES2501_REG_IMAGCTRL 0x98 -+ -+#define AES2501_IMAGCTRL_IMG_DATA_DISABLE 0x01 /* If set, image data message and authentication message are not returned when imaging */ -+#define AES2501_IMAGCTRL_HISTO_DATA_ENABLE 0x02 /* if set, send histogram message when imaging */ -+#define AES2501_IMAGCTRL_HISTO_EACH_ROW 0x04 /* A histo message is sent at the end of (1=each row | 0 = scanning) */ -+#define AES2501_IMAGCTRL_HISTO_FULL_ARRAY 0x08 /* 1 = full image array, 0 = 64x64 center */ -+#define AES2501_IMAGCTRL_REG_FIRST 0x10 /* Registers are returned (1=before | 0=after) image data */ -+#define AES2501_IMAGCTRL_TST_REG_ENABLE 0x20 /* If set, Test Registers are returned with register messages */ -+ -+ -+ -+ -+ -+ -+ -+ -+/* -+ * AES2501 Status Register (STAT) -+ */ -+ -+#define AES2501_REG_STAT 0x9a -+ -+#define AES2501_STAT_SCAN 0x0f /* Scan state */ -+#define AES2501_STAT_ERROR 0x10 /* Framing error */ -+#define AES2501_STAT_PAUSED 0x20 /* Scan paused */ -+#define AES2501_STAT_RESET 0x40 /* Reset occurred */ -+ -+enum aes2501_scan_state { -+ -+ STATE_WAITING_FOR_FINGER = 0x00, /* Waiting for finger */ -+ STATE_FINGER_SETTLING_DELAY = 0x01, /* In Finger settling delay */ -+ STATE_POWER_UP_DELAY = 0x02, /* In power up delay */ -+ STATE_WAITING_TO_START_SCAN = 0x03, /* Waiting to start image scan */ -+ STATE_PRELOADING_SUBARRAY_0 = 0x04, /* Pre-loading subarray 0 */ -+ STATE_SETUP_FOR_ROW_ADVANCE = 0x05, /* Setup for row advance */ -+ STATE_WAITING_FOR_ROW_ADVANCE = 0x06, /* Waiting for row advance */ -+ STATE_PRELOADING_COL_0 = 0x07, /* Pre-loading column 0 */ -+ STATE_SETUP_FOR_COL_ADVANCE = 0x08, /* Setup for column advance */ -+ STATE_WAITING_FOR_COL_ADVANCE = 0x09, /* Waiting for column advance */ -+ STATE_WAITING_FOR_SCAN_START = 0x0a, /* Waiting for scan start */ -+ STATE_WAITING_FOR_SCAN_END = 0x0b, /* Waiting for scan end */ -+ STATE_WAITING_FOR_ROW_SETUP = 0x0c, /* Waiting for row setup */ -+ STATE_WAITING_FOR_COL_TIME = 0x0d, /* Waiting for one column time (depends on scan rate) */ -+ STATE_WAITING_FOR_QUEUED_DATA = 0x0e, /* Waiting for queued data transmission to be completed */ -+ STATE_WAIT_FOR_128_US = 0x0f /* Wait for 128 us */ -+ -+}; -+ -+ -+/* -+ * AES2501 Challenge Word 1 Register (CHWORD1) -+ */ -+ -+#define AES2501_REG_CHWORD1 0x9b -+ -+#define AES2501_CHWORD1_IS_FINGER 0x01 /* If set, finger is present */ -+ -+ -+/* -+ * AES2501 Challenge Word 2 Register (CHWORD2) -+ */ -+ -+#define AES2501_REG_CHWORD2 0x9c -+ -+ -+/* -+ * AES2501 Challenge Word 3 Register (CHWORD3) -+ */ -+ -+#define AES2501_REG_CHWORD3 0x9d -+ -+ -+/* -+ * AES2501 Challenge Word 4 Register (CHWORD4) -+ */ -+ -+#define AES2501_REG_CHWORD4 0x9e -+ -+ -+/* -+ * AES2501 Challenge Word 5 Register (CHWORD5) -+ */ -+ -+#define AES2501_REG_CHWORD5 0x9f -+ -+ -+ -+ -+ -+/* -+ * AES2501 Test Register 1 (TREG1) -+ */ -+ -+#define AES2501_REG_TREG1 0xa1 -+ -+#define AES2501_TREG1_SBIAS_UNLCK 0x10 /* 1 = unlock the controlling of sense amp bias, 0 = sense amp bias changes */ -+ -+enum aes2501_sense_amp_bias { -+ -+ AES2501_TREG1_SAMP_BIAS_2_UA = 0x00, /* 2.5 uA */ -+ AES2501_TREG1_SAMP_BIAS_5_UA = 0x01, /* 5 uA */ -+ AES2501_TREG1_SAMP_BIAS_8_UA = 0x02, /* 8 uA */ -+ AES2501_TREG1_SAMP_BIAS_10_UA = 0x03 /* 10 uA */ -+ -+}; -+ -+ -+ -+ -+/* -+ * AES2501 Auto-Calibration Offset Register (AUTOCALOFFSET) -+ */ -+ -+#define AES2501_REG_AUTOCALOFFSET 0xa8 -+ -+ -+ -+ -+ -+/* -+ * AES2501 Test Register C (TREGC) -+ */ -+ -+#define AES2501_REG_TREGC 0xac -+ -+#define AES2501_TREGC_ENABLE 0x01 /* Enable the reading of the register in TREGD */ -+ -+ -+/* -+ * AES2501 Test Register D (TREGD) -+ */ -+ -+#define AES2501_REG_TREGD 0xad -+ -+ -+ -+ -+ -+/* -+ * AES2501 Low Power Oscillator On Time Register (LPONT) -+ */ -+ -+#define AES2501_REG_LPONT 0xb4 -+ -+/* -+ * This register sets the low power oscillator on time. -+ * Units are roughly equivalent to milliseconds. -+ */ -+ -+#define AES2501_LPONT_MIN_VALUE 0x00 /* 0 ms */ -+#define AES2501_LPONT_MAX_VALUE 0x1f /* About 16 ms */ -+ -+ -+ -+#define ENUM_REG(reg) _ ## reg = reg -+ -+typedef enum _Aes2501Registers -+{ -+ ENUM_REG(AES2501_REG_CTRL1), -+ ENUM_REG(AES2501_REG_CTRL2), -+ ENUM_REG(AES2501_REG_EXCITCTRL), -+ ENUM_REG(AES2501_REG_DETCTRL), -+ ENUM_REG(AES2501_REG_COLSCAN), -+ ENUM_REG(AES2501_REG_MEASDRV), -+ ENUM_REG(AES2501_REG_MEASFREQ), -+ ENUM_REG(AES2501_REG_DEMODPHASE2), -+ ENUM_REG(AES2501_REG_DEMODPHASE1), -+ ENUM_REG(AES2501_REG_CHANGAIN), -+ ENUM_REG(AES2501_REG_ADREFHI), -+ ENUM_REG(AES2501_REG_ADREFLO), -+ ENUM_REG(AES2501_REG_STRTROW), -+ ENUM_REG(AES2501_REG_ENDROW), -+ ENUM_REG(AES2501_REG_STRTCOL), -+ ENUM_REG(AES2501_REG_ENDCOL), -+ ENUM_REG(AES2501_REG_DATFMT), -+ ENUM_REG(AES2501_REG_IMAGCTRL), -+ ENUM_REG(AES2501_REG_STAT), -+ ENUM_REG(AES2501_REG_CHWORD1), -+ ENUM_REG(AES2501_REG_CHWORD2), -+ ENUM_REG(AES2501_REG_CHWORD3), -+ ENUM_REG(AES2501_REG_CHWORD4), -+ ENUM_REG(AES2501_REG_CHWORD5), -+ ENUM_REG(AES2501_REG_TREG1), -+ ENUM_REG(AES2501_REG_AUTOCALOFFSET), -+ ENUM_REG(AES2501_REG_TREGC), -+ ENUM_REG(AES2501_REG_TREGD), -+ ENUM_REG(AES2501_REG_LPONT) -+ -+} Aes2501Registers; -+ -+ -+#define FIRST_AES2501_REG 0x80 -+#define LAST_AES2501_REG 0x9f -+ -+ -+ -+#endif /* __AES2501_REGS_H */ -diff -Nurp linux-2.6.37/3rdparty/aes2501/ChangeLog linux-2.6.37.3rdparty/3rdparty/aes2501/ChangeLog ---- linux-2.6.37/3rdparty/aes2501/ChangeLog 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/aes2501/ChangeLog 2008-01-14 03:07:30.000000000 +0200 -@@ -0,0 +1,95 @@ -+2007-11-05 Cyrille Bagard -+ -+ * aes2501.c: -+ Apply Vasily Khoruzhick's new patch: rewrite image processing functions. -+ Thus, there should be no more significant common points with aes2501-wy. -+ -+2007-11-05 Cyrille Bagard -+ -+ * aes2501.c: -+ In order to respect the license of aes2501-wy, on which this driver is -+ based, begin to rewrite some functions. Thus, better handle histograms. -+ One more strip is often processed, but that is more logical like this. -+ -+ * aes2501_regs.h: -+ Enumerate all used registers for convenience. -+ -+2007-11-03 Cyrille Bagard -+ -+ * aes2501.c: -+ Clean the code. Take care of signals when processes are awaking. -+ Apply Vasily Khoruzhick's new patch: autodetect picture reversing needs -+ and fix kernel oops in case of module removal. -+ -+ * Makefile: -+ Remove hidden files and clean the rules. KERNELDIR has to be overrided -+ from the sheel if needed now. -+ -+2007-10-29 Cyrille Bagard -+ -+ * aes2501.c: -+ Apply Vasily Khoruzhick's patch and thus increase the resulting pictures -+ quality. Many thanks to him ! -+ -+ * Makefile: -+ Add two new rules: usertest and clean. -+ -+ * usertest.c: -+ Initial commit. -+ -+2007-08-27 Cyrille Bagard -+ -+ * aes2501.c: -+ Make INIT_WORK macro working with 2.6.20+ kernels. Many thanks to -+ Miguel Gea Milvaques for the patch ! -+ -+2007-06-13 Cyrille Bagard -+ -+ * aes2501.c: -+ * aes2501_regs.h: -+ Complete translation of all binary communications using well documented -+ registers and values (as often as possible). -+ -+2007-06-13 Cyrille Bagard -+ -+ * aes2501.c: -+ Increase communication speed by buffering bulk out. Output data -+ need to be flushed at the end now. -+ -+2007-06-13 Cyrille Bagard -+ -+ * aes2501.c: -+ * aes2501_regs.h: -+ Translate binary data used in finger detection. Some register values -+ still need to be understood. Note: some hex values are reserved bits -+ in registers. -+ -+2007-06-12 Cyrille Bagard -+ -+ * aes2501.c: -+ Begin the binary translation: the "standby" function now uses understood -+ instructions and prints debug status information if needed. CTRL2 register -+ value needs to be checked. -+ -+ * aes2501_regs.h: -+ Define the interesting hex values for the following registers: -+ CTRL2, STAT, TREGC and TREGD. -+ -+2007-06-12 Cyrille Bagard -+ -+ * aes2501.c: -+ Clean the driver a little bit by removing old piece of code to handle -+ a character device in the old way. -+ -+2007-06-12 Cyrille Bagard -+ -+ * aes2501.c: -+ Use an own work queue. Scanning now starts with the AES2501_IOC_TEST -+ ioctl command. Reading the /dev entry blocks until data is available. -+ -+2007-06-12 Cyrille Bagard -+ -+ * aes2501.c: -+ * aes2501.h: -+ * Makefile: -+ Initial [crappy] commit. -diff -Nurp linux-2.6.37/3rdparty/aes2501/Makefile linux-2.6.37.3rdparty/3rdparty/aes2501/Makefile ---- linux-2.6.37/3rdparty/aes2501/Makefile 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/aes2501/Makefile 2008-01-14 03:07:30.000000000 +0200 -@@ -0,0 +1,19 @@ -+ -+obj-m := aes2501.o -+ -+KERNELDIR ?= /lib/modules/$(shell uname -r)/build -+ -+PWD := $(shell pwd) -+ -+all: usertest -+ $(MAKE) -C $(KERNELDIR) M=$(PWD) -+ -+usertest: -+ gcc -I. -o usertest usertest.c -+ -+clean: -+ rm -f *.o *~ aes2501.ko aes2501.mod.c Module.symvers usertest -+ rm -rf .tmp_versions -+ rm -f .*.cmd -+ -+ -diff -Nurp linux-2.6.37/3rdparty/aes2501/usertest.c linux-2.6.37.3rdparty/3rdparty/aes2501/usertest.c ---- linux-2.6.37/3rdparty/aes2501/usertest.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/aes2501/usertest.c 2008-01-14 03:07:30.000000000 +0200 -@@ -0,0 +1,78 @@ -+/** -+ * AES2501 Device Driver -+ * Userspace test program -+ * -+ * Compile with: -+ * gcc -I. -o usertest usertest.c -+ */ -+ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+ -+#define BUFFER_SIZE 256 -+ -+ -+int main(int argc, char *argv[]) -+{ -+ int fd_in; -+ int fd_out; -+ char buffer[BUFFER_SIZE]; -+ size_t len; -+ -+ fd_in = -1; -+ fd_out = -1; -+ -+ -+ int data, rdata; -+ -+ -+ -+ fd_in = open("/dev/aes2501", O_RDONLY); -+ if (fd_in == -1) { -+ perror("open() -- "); -+ goto err; -+ } -+ -+ fd_out = open("/root/pic.pnm", O_CREAT | O_WRONLY); -+ if (fd_out == -1) { -+ perror("open() -- "); -+ goto err; -+ } -+ -+ -+ -+ data = 0x55555555; -+ ioctl(fd_in, AES2501_IOC_TEST, data); -+ //ioctl(fd_in, CASE2, &rdata); -+ -+ printf("IOCTL test: written: '%x' - received: '%x'\n", data, rdata); -+ -+ -+ -+ -+ /* Write the fingerprint */ -+ while ((len = read(fd_in, buffer, BUFFER_SIZE)) > 0) -+ write(fd_out, buffer, len); -+ -+ close(fd_in); -+ close(fd_out); -+ -+ return EXIT_SUCCESS; -+ -+ err: -+ -+ if (fd_in != -1) -+ close(fd_in); -+ -+ if (fd_out != -1) -+ close(fd_out); -+ -+ return EXIT_FAILURE; -+ -+} diff --git a/kernel/kernel/files/patches/mageia/3rd-aes2501-rmmod-oops-fix.patch b/kernel/kernel/files/patches/mageia/3rd-aes2501-rmmod-oops-fix.patch deleted file mode 100644 index f11cc2e5..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-aes2501-rmmod-oops-fix.patch +++ /dev/null @@ -1,21 +0,0 @@ -Prevent oops on module removal when we don't have the device available. - -Signed-off-by: Herton Ronaldo Krzesinski - ---- - linux-2.6.23/3rdparty/aes2501/aes2501.c | 3 ++- - 1 file changed, 2 insertions(+), 1 deletion(-) - -diff -p -up linux-2.6.23/3rdparty/aes2501/aes2501.c.orig linux-2.6.23/3rdparty/aes2501/aes2501.c ---- linux-2.6.23/3rdparty/aes2501/aes2501.c.orig 2008-01-13 23:37:38.000000000 -0200 -+++ linux-2.6.23/3rdparty/aes2501/aes2501.c 2008-01-13 23:38:26.000000000 -0200 -@@ -1616,7 +1616,8 @@ static int __init aes2501_init(void) - - static void __exit aes2501_exit(void) - { -- _dev->stop_scan = 1; -+ if (_dev) -+ _dev->stop_scan = 1; - destroy_workqueue(comm_queue); - usb_deregister(&aes2501_driver); - } diff --git a/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-1.61.patch b/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-1.61.patch deleted file mode 100644 index dea2842c..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-1.61.patch +++ /dev/null @@ -1,26418 +0,0 @@ -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/crt.c linux-4.12.4-3rd/3rdparty/ndiswrapper/crt.c ---- linux-4.12.4/3rdparty/ndiswrapper/crt.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/crt.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,589 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include "ntoskernel.h" -+#include "crt_exports.h" -+ -+#ifdef CONFIG_X86_64 -+/* Windows long is 32-bit, so strip single 'l' in integer formats */ -+static void strip_l_modifier(char *str) -+{ -+ char *ptr = str; -+ int in_format = 0; -+ char *lptr = NULL; -+ char last = 0; -+ char *end_ptr; -+ char *wptr; -+ -+ /* Replace single 'l' inside integer formats with '\0' */ -+ for (ptr = str; *ptr; ptr++) { -+ if (!in_format) { -+ if (*ptr == '%') -+ in_format = 1; -+ last = *ptr; -+ continue; -+ } -+ switch (*ptr) { -+ case 'd': -+ case 'i': -+ case 'o': -+ case 'u': -+ case 'x': -+ case 'X': -+ case 'p': -+ case 'n': -+ case 'm': -+ if (lptr) { -+ *lptr = '\0'; -+ lptr = NULL; -+ } -+ in_format = 0; -+ break; -+ case 'c': -+ case 'C': -+ case 's': -+ case 'S': -+ case 'f': -+ case 'e': -+ case 'E': -+ case 'g': -+ case 'G': -+ case 'a': -+ case 'A': -+ lptr = NULL; -+ in_format = 0; -+ break; -+ case '%': -+ lptr = NULL; -+ if (last == '%') -+ in_format = 0; -+ else -+ in_format = 1; /* ignore previous junk */ -+ break; -+ case 'l': -+ if (last == 'l') -+ lptr = NULL; -+ else -+ lptr = ptr; -+ break; -+ default: -+ break; -+ } -+ last = *ptr; -+ } -+ -+ /* Purge zeroes from the resulting string */ -+ end_ptr = ptr; -+ wptr = str; -+ for (ptr = str; ptr < end_ptr; ptr++) -+ if (*ptr != 0) -+ *(wptr++) = *ptr; -+ *wptr = 0; -+} -+ -+/* -+ * va_list on x86_64 Linux is designed to allow passing arguments in registers -+ * even to variadic functions. va_list is a structure holding pointers to the -+ * register save area, which holds the arguments passed in registers, and to -+ * the stack, which may have the arguments that did not fit the registers. -+ * va_list also holds offsets in the register save area for the next general -+ * purpose and floating point registers that the next va_arg() would fetch. -+ * -+ * Unlike Linux, the Windows va_list is just a pointer to the stack. No -+ * arguments are passed in the registers. That's why we construct the Linux -+ * va_list so that the register save area is never used. For that goal, we set -+ * the offsets to the maximal allowed values, meaning that the arguments passed -+ * in the registers have been exhausted. The values are 48 for general purpose -+ * registers (6 registers, 8 bytes each) and 304 for floating point registers -+ * (16 registers, 16 bytes each, on top of general purpose register). -+ */ -+ -+struct x86_64_va_list { -+ int gp_offset; -+ int fp_offset; -+ void *overflow_arg_area; -+ void *reg_save_area; -+}; -+ -+#define VA_LIST_DECL(_args) \ -+ va_list _args##new; \ -+ struct x86_64_va_list *_args##x; -+#define VA_LIST_PREP(_args) \ -+do { \ -+ _args##x = (struct x86_64_va_list *)&_args##new; \ -+ _args##x->gp_offset = 6 * 8; /* GP registers exhausted */ \ -+ _args##x->fp_offset = 6 * 8 + 16 * 16; /* FP registers exhausted */ \ -+ _args##x->overflow_arg_area = (void *)_args; \ -+ _args##x->reg_save_area = NULL; \ -+} while (0) -+#define VA_LIST_CONV(_args) (_args##new) -+#define VA_LIST_FREE(_args) -+#define FMT_DECL(_fmt) \ -+ char *_fmt##copy; \ -+ int _fmt##len; -+#define FMT_PREP(_fmt) \ -+do { \ -+ _fmt##len = strlen(format) + 1; \ -+ _fmt##copy = kmalloc(_fmt##len, irql_gfp()); \ -+ if (_fmt##copy) { \ -+ memcpy(_fmt##copy, format, _fmt##len); \ -+ strip_l_modifier(_fmt##copy); \ -+ } \ -+} while (0) -+#define FMT_CONV(_fmt) (_fmt##copy ? _fmt##copy : format) -+#define FMT_FREE(_fmt) kfree(_fmt##copy) -+ -+#else /* !CONFIG_X86_64 */ -+ -+#define VA_LIST_DECL(_args) -+#define VA_LIST_PREP(_args) -+#define VA_LIST_CONV(_args) (_args) -+#define VA_LIST_FREE(_args) -+#define FMT_DECL(_fmt) -+#define FMT_PREP(_fmt) -+#define FMT_CONV(_fmt) (format) -+#define FMT_FREE(_fmt) -+ -+#endif /* !CONFIG_X86_64 */ -+ -+__attribute__((format(printf, 2, 3))) -+noregparm INT WIN_FUNC(_win_sprintf,12) -+ (char *buf, const char *format, ...) -+{ -+ va_list args; -+ int res; -+ FMT_DECL(format) -+ -+ FMT_PREP(format); -+ va_start(args, format); -+ res = vsprintf(buf, FMT_CONV(format), args); -+ va_end(args); -+ FMT_FREE(format); -+ -+ TRACE2("buf: %p: %s", buf, buf); -+ return res; -+} -+ -+noregparm INT WIN_FUNC(swprintf,12) -+ (wchar_t *buf, const wchar_t *format, ...) -+{ -+ TODO(); -+ EXIT2(return 0); -+} -+ -+noregparm INT WIN_FUNC(_win_vsprintf,3) -+ (char *str, const char *format, va_list ap) -+{ -+ INT i; -+ VA_LIST_DECL(ap) -+ FMT_DECL(format) -+ -+ VA_LIST_PREP(ap); -+ FMT_PREP(format); -+ -+ i = vsprintf(str, FMT_CONV(format), VA_LIST_CONV(ap)); -+ TRACE2("str: %p: %s", str, str); -+ -+ FMT_FREE(format); -+ VA_LIST_FREE(ap); -+ EXIT2(return i); -+} -+ -+__attribute__((format(printf, 3, 4))) -+noregparm INT WIN_FUNC(_win_snprintf,12) -+ (char *buf, SIZE_T count, const char *format, ...) -+{ -+ va_list args; -+ int res; -+ FMT_DECL(format) -+ -+ FMT_PREP(format); -+ va_start(args, format); -+ res = vsnprintf(buf, count, FMT_CONV(format), args); -+ va_end(args); -+ TRACE2("buf: %p: %s", buf, buf); -+ -+ FMT_FREE(format); -+ return res; -+} -+ -+__attribute__((format(printf, 3, 4))) -+noregparm INT WIN_FUNC(_win__snprintf,12) -+ (char *buf, SIZE_T count, const char *format, ...) -+{ -+ va_list args; -+ int res; -+ FMT_DECL(format) -+ -+ FMT_PREP(format); -+ va_start(args, format); -+ res = vsnprintf(buf, count, FMT_CONV(format), args); -+ va_end(args); -+ TRACE2("buf: %p: %s", buf, buf); -+ -+ FMT_FREE(format); -+ return res; -+} -+ -+noregparm INT WIN_FUNC(_win_vsnprintf,4) -+ (char *str, SIZE_T size, const char *format, va_list ap) -+{ -+ INT i; -+ VA_LIST_DECL(ap) -+ FMT_DECL(format) -+ -+ VA_LIST_PREP(ap); -+ FMT_PREP(format); -+ -+ i = vsnprintf(str, size, FMT_CONV(format), VA_LIST_CONV(ap)); -+ TRACE2("str: %p: %s", str, str); -+ -+ FMT_FREE(format); -+ VA_LIST_FREE(ap); -+ EXIT2(return i); -+} -+ -+noregparm INT WIN_FUNC(_win__vsnprintf,4) -+ (char *str, SIZE_T size, const char *format, va_list ap) -+{ -+ INT i; -+ VA_LIST_DECL(ap) -+ FMT_DECL(format) -+ -+ VA_LIST_PREP(ap); -+ FMT_PREP(format); -+ -+ i = vsnprintf(str, size, FMT_CONV(format), VA_LIST_CONV(ap)); -+ TRACE2("str: %p: %s", str, str); -+ -+ FMT_FREE(format); -+ VA_LIST_FREE(ap); -+ EXIT2(return i); -+} -+ -+noregparm INT WIN_FUNC(_win__vsnwprintf,4) -+ (wchar_t *str, SIZE_T size, const wchar_t *format, va_list ap) -+{ -+ int ret; -+ -+ TODO(); /* format expansion not implemented */ -+ _win_wcsncpy(str, format, size); -+ ret = _win_wcslen(format); -+ if (ret >= size) -+ ret = -1; -+ return ret; -+} -+ -+noregparm char *WIN_FUNC(_win_strncpy,3) -+ (char *dst, char *src, SIZE_T n) -+{ -+ return strncpy(dst, src, n); -+} -+ -+noregparm SIZE_T WIN_FUNC(_win_strlen,1) -+ (const char *s) -+{ -+ return strlen(s); -+} -+ -+noregparm INT WIN_FUNC(_win_strncmp,3) -+ (const char *s1, const char *s2, SIZE_T n) -+{ -+ return strncmp(s1, s2, n); -+} -+ -+noregparm INT WIN_FUNC(_win_strcmp,2) -+ (const char *s1, const char *s2) -+{ -+ return strcmp(s1, s2); -+} -+ -+noregparm INT WIN_FUNC(_win_stricmp,2) -+ (const char *s1, const char *s2) -+{ -+ return stricmp(s1, s2); -+} -+ -+noregparm char *WIN_FUNC(_win_strncat,3) -+ (char *dest, const char *src, SIZE_T n) -+{ -+ return strncat(dest, src, n); -+} -+ -+noregparm INT WIN_FUNC(_win_wcscmp,2) -+ (const wchar_t *s1, const wchar_t *s2) -+{ -+ while (*s1 && *s1 == *s2) { -+ s1++; -+ s2++; -+ } -+ return *s1 - *s2; -+} -+ -+noregparm INT WIN_FUNC(_win_wcsicmp,2) -+ (const wchar_t *s1, const wchar_t *s2) -+{ -+ while (*s1 && tolower((char)*s1) == tolower((char)*s2)) { -+ s1++; -+ s2++; -+ } -+ return tolower((char)*s1) - tolower((char)*s2); -+} -+ -+noregparm SIZE_T WIN_FUNC(_win_wcslen,1) -+ (const wchar_t *s) -+{ -+ const wchar_t *t = s; -+ while (*t) -+ t++; -+ return t - s; -+} -+ -+noregparm wchar_t *WIN_FUNC(_win_wcsncpy,3) -+ (wchar_t *dest, const wchar_t *src, SIZE_T n) -+{ -+ const wchar_t *s; -+ wchar_t *d; -+ s = src + n; -+ d = dest; -+ while (src < s && (*d++ = *src++)) -+ ; -+ if (s > src) -+ memset(d, 0, (s - src) * sizeof(wchar_t)); -+ return dest; -+} -+ -+noregparm wchar_t *WIN_FUNC(_win_wcscpy,2) -+ (wchar_t *dest, const wchar_t *src) -+{ -+ wchar_t *d = dest; -+ while ((*d++ = *src++)) -+ ; -+ return dest; -+} -+ -+noregparm wchar_t *WIN_FUNC(_win_wcscat,2) -+ (wchar_t *dest, const wchar_t *src) -+{ -+ wchar_t *d; -+ d = dest; -+ while (*d) -+ d++; -+ while ((*d++ = *src++)) -+ ; -+ return dest; -+} -+ -+noregparm INT WIN_FUNC(_win_towupper,1) -+ (wchar_t c) -+{ -+ return toupper(c); -+} -+ -+noregparm INT WIN_FUNC(_win_towlower,1) -+ (wchar_t c) -+{ -+ return tolower(c); -+} -+ -+noregparm INT WIN_FUNC(_win_tolower,1) -+ (INT c) -+{ -+ return tolower(c); -+} -+ -+noregparm INT WIN_FUNC(_win_toupper,1) -+ (INT c) -+{ -+ return toupper(c); -+} -+ -+noregparm void *WIN_FUNC(_win_strcpy,2) -+ (void *to, const void *from) -+{ -+ return strcpy(to, from); -+} -+ -+noregparm char *WIN_FUNC(_win_strstr,2) -+ (const char *s1, const char *s2) -+{ -+ return strstr(s1, s2); -+} -+ -+noregparm char *WIN_FUNC(_win_strchr,2) -+ (const char *s, int c) -+{ -+ return strchr(s, c); -+} -+ -+noregparm char *WIN_FUNC(_win_strrchr,2) -+ (const char *s, int c) -+{ -+ return strrchr(s, c); -+} -+ -+noregparm void *WIN_FUNC(_win_memmove,3) -+ (void *to, void *from, SIZE_T count) -+{ -+ return memmove(to, from, count); -+} -+ -+noregparm void *WIN_FUNC(_win_memchr,3) -+ (const void *s, INT c, SIZE_T n) -+{ -+ return memchr(s, c, n); -+} -+ -+noregparm void *WIN_FUNC(_win_memcpy,3) -+ (void *to, const void *from, SIZE_T n) -+{ -+ return memcpy(to, from, n); -+} -+ -+noregparm void *WIN_FUNC(_win_memset,3) -+ (void *s, char c, SIZE_T count) -+{ -+ return memset(s, c, count); -+} -+ -+noregparm int WIN_FUNC(_win_memcmp,3) -+ (void *s1, void *s2, SIZE_T n) -+{ -+ return memcmp(s1, s2, n); -+} -+ -+noregparm void WIN_FUNC(_win_srand,1) -+ (UINT seed) -+{ -+ prandom_seed(seed); -+} -+ -+noregparm int WIN_FUNC(rand,0) -+ (void) -+{ -+ char buf[6]; -+ int i, n; -+ -+ get_random_bytes(buf, sizeof(buf)); -+ for (n = i = 0; i < sizeof(buf); i++) -+ n += buf[i]; -+ return n; -+} -+ -+noregparm int WIN_FUNC(_win_atoi,1) -+ (const char *ptr) -+{ -+ int i = simple_strtol(ptr, NULL, 10); -+ return i; -+} -+ -+noregparm int WIN_FUNC(_win_isdigit,1) -+ (int c) -+{ -+ return isdigit(c); -+} -+ -+noregparm int WIN_FUNC(_win_isprint,1) -+ (int c) -+{ -+ return isprint(c); -+} -+ -+wstdcall s64 WIN_FUNC(_alldiv,2) -+ (s64 a, s64 b) -+{ -+ return a / b; -+} -+ -+wstdcall u64 WIN_FUNC(_aulldiv,2) -+ (u64 a, u64 b) -+{ -+ return a / b; -+} -+ -+wstdcall s64 WIN_FUNC(_allmul,2) -+ (s64 a, s64 b) -+{ -+ return a * b; -+} -+ -+wstdcall u64 WIN_FUNC(_aullmul,2) -+ (u64 a, u64 b) -+{ -+ return a * b; -+} -+ -+wstdcall s64 WIN_FUNC(_allrem,2) -+ (s64 a, s64 b) -+{ -+ return a % b; -+} -+ -+wstdcall u64 WIN_FUNC(_aullrem,2) -+ (u64 a, u64 b) -+{ -+ return a % b; -+} -+ -+regparm3 s64 WIN_FUNC(_allshl,2) -+ (s64 a, u8 b) -+{ -+ return a << b; -+} -+ -+regparm3 u64 WIN_FUNC(_aullshl,2) -+ (u64 a, u8 b) -+{ -+ return a << b; -+} -+ -+regparm3 s64 WIN_FUNC(_allshr,2) -+ (s64 a, u8 b) -+{ -+ return a >> b; -+} -+ -+regparm3 u64 WIN_FUNC(_aullshr,2) -+ (u64 a, u8 b) -+{ -+ return a >> b; -+} -+ -+int stricmp(const char *s1, const char *s2) -+{ -+ while (*s1 && tolower(*s1) == tolower(*s2)) { -+ s1++; -+ s2++; -+ } -+ return *s1 - *s2; -+} -+ -+void dump_bytes(const char *ctx, const u8 *from, int len) -+{ -+ int i, j; -+ u8 *buf; -+ -+ buf = kmalloc(len * 3 + 1, irql_gfp()); -+ if (!buf) { -+ ERROR("couldn't allocate memory"); -+ return; -+ } -+ for (i = j = 0; i < len; i++, j += 3) { -+ sprintf(&buf[j], "%02x ", from[i]); -+ } -+ buf[j] = 0; -+ printk(KERN_DEBUG "%s: %p: %s\n", ctx, from, buf); -+ kfree(buf); -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/divdi3.c linux-4.12.4-3rd/3rdparty/ndiswrapper/divdi3.c ---- linux-4.12.4/3rdparty/ndiswrapper/divdi3.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/divdi3.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,329 @@ -+/* 64-bit multiplication and division -+ Copyright (C) 1989, 1992-1999, 2000, 2001, 2002, 2003 -+ Free Software Foundation, Inc. -+ This file is part of the GNU C Library. -+ -+ The GNU C Library is free software; you can redistribute it and/or -+ modify it under the terms of the GNU Lesser General Public -+ License as published by the Free Software Foundation; either -+ version 2.1 of the License, or (at your option) any later version. -+ -+ The GNU C Library is distributed in the hope that it will be useful, -+ but WITHOUT ANY WARRANTY; without even the implied warranty of -+ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -+ Lesser General Public License for more details. -+ -+ You should have received a copy of the GNU Lesser General Public -+ License along with the GNU C Library; if not, write to the Free -+ Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA -+ 02111-1307 USA. */ -+ -+#include -+#include -+ -+#if BITS_PER_LONG != 32 -+#error This is for 32-bit targets only -+#endif -+ -+typedef unsigned int UQItype __attribute__ ((mode (QI))); -+typedef int SItype __attribute__ ((mode (SI))); -+typedef unsigned int USItype __attribute__ ((mode (SI))); -+typedef int DItype __attribute__ ((mode (DI))); -+typedef unsigned int UDItype __attribute__ ((mode (DI))); -+#define Wtype SItype -+#define HWtype SItype -+#define DWtype DItype -+#define UWtype USItype -+#define UHWtype USItype -+#define UDWtype UDItype -+#define W_TYPE_SIZE 32 -+ -+#include "longlong.h" -+ -+#if defined(__BIG_ENDIAN) -+struct DWstruct { Wtype high, low;}; -+#elif defined(__LITTLE_ENDIAN) -+struct DWstruct { Wtype low, high;}; -+#else -+#error Unhandled endianity -+#endif -+typedef union { struct DWstruct s; DWtype ll; } DWunion; -+ -+/* Prototypes of exported functions. */ -+extern DWtype __divdi3 (DWtype u, DWtype v); -+extern DWtype __moddi3 (DWtype u, DWtype v); -+extern UDWtype __udivdi3 (UDWtype u, UDWtype v); -+extern UDWtype __umoddi3 (UDWtype u, UDWtype v); -+ -+static UDWtype -+__udivmoddi4 (UDWtype n, UDWtype d, UDWtype *rp) -+{ -+ DWunion ww; -+ DWunion nn, dd; -+ DWunion rr; -+ UWtype d0, d1, n0, n1, n2; -+ UWtype q0, q1; -+ UWtype b, bm; -+ -+ nn.ll = n; -+ dd.ll = d; -+ -+ d0 = dd.s.low; -+ d1 = dd.s.high; -+ n0 = nn.s.low; -+ n1 = nn.s.high; -+ -+#if !UDIV_NEEDS_NORMALIZATION -+ if (d1 == 0) -+ { -+ if (d0 > n1) -+ { -+ /* 0q = nn / 0D */ -+ -+ udiv_qrnnd (q0, n0, n1, n0, d0); -+ q1 = 0; -+ -+ /* Remainder in n0. */ -+ } -+ else -+ { -+ /* qq = NN / 0d */ -+ -+ if (d0 == 0) -+ d0 = 1 / d0; /* Divide intentionally by zero. */ -+ -+ udiv_qrnnd (q1, n1, 0, n1, d0); -+ udiv_qrnnd (q0, n0, n1, n0, d0); -+ -+ /* Remainder in n0. */ -+ } -+ -+ if (rp != NULL) -+ { -+ rr.s.low = n0; -+ rr.s.high = 0; -+ *rp = rr.ll; -+ } -+ } -+ -+#else /* UDIV_NEEDS_NORMALIZATION */ -+ -+ if (d1 == 0) -+ { -+ if (d0 > n1) -+ { -+ /* 0q = nn / 0D */ -+ -+ count_leading_zeros (bm, d0); -+ -+ if (bm != 0) -+ { -+ /* Normalize, i.e. make the most significant bit of the -+ denominator set. */ -+ -+ d0 = d0 << bm; -+ n1 = (n1 << bm) | (n0 >> (W_TYPE_SIZE - bm)); -+ n0 = n0 << bm; -+ } -+ -+ udiv_qrnnd (q0, n0, n1, n0, d0); -+ q1 = 0; -+ -+ /* Remainder in n0 >> bm. */ -+ } -+ else -+ { -+ /* qq = NN / 0d */ -+ -+ if (d0 == 0) -+ d0 = 1 / d0; /* Divide intentionally by zero. */ -+ -+ count_leading_zeros (bm, d0); -+ -+ if (bm == 0) -+ { -+ /* From (n1 >= d0) /\ (the most significant bit of d0 is set), -+ conclude (the most significant bit of n1 is set) /\ (the -+ leading quotient digit q1 = 1). -+ -+ This special case is necessary, not an optimization. -+ (Shifts counts of W_TYPE_SIZE are undefined.) */ -+ -+ n1 -= d0; -+ q1 = 1; -+ } -+ else -+ { -+ /* Normalize. */ -+ -+ b = W_TYPE_SIZE - bm; -+ -+ d0 = d0 << bm; -+ n2 = n1 >> b; -+ n1 = (n1 << bm) | (n0 >> b); -+ n0 = n0 << bm; -+ -+ udiv_qrnnd (q1, n1, n2, n1, d0); -+ } -+ -+ /* n1 != d0... */ -+ -+ udiv_qrnnd (q0, n0, n1, n0, d0); -+ -+ /* Remainder in n0 >> bm. */ -+ } -+ -+ if (rp != NULL) -+ { -+ rr.s.low = n0 >> bm; -+ rr.s.high = 0; -+ *rp = rr.ll; -+ } -+ } -+#endif /* UDIV_NEEDS_NORMALIZATION */ -+ -+ else -+ { -+ if (d1 > n1) -+ { -+ /* 00 = nn / DD */ -+ -+ q0 = 0; -+ q1 = 0; -+ -+ /* Remainder in n1n0. */ -+ if (rp != NULL) -+ { -+ rr.s.low = n0; -+ rr.s.high = n1; -+ *rp = rr.ll; -+ } -+ } -+ else -+ { -+ /* 0q = NN / dd */ -+ -+ count_leading_zeros (bm, d1); -+ if (bm == 0) -+ { -+ /* From (n1 >= d1) /\ (the most significant bit of d1 is set), -+ conclude (the most significant bit of n1 is set) /\ (the -+ quotient digit q0 = 0 or 1). -+ -+ This special case is necessary, not an optimization. */ -+ -+ /* The condition on the next line takes advantage of that -+ n1 >= d1 (true due to program flow). */ -+ if (n1 > d1 || n0 >= d0) -+ { -+ q0 = 1; -+ sub_ddmmss (n1, n0, n1, n0, d1, d0); -+ } -+ else -+ q0 = 0; -+ -+ q1 = 0; -+ -+ if (rp != NULL) -+ { -+ rr.s.low = n0; -+ rr.s.high = n1; -+ *rp = rr.ll; -+ } -+ } -+ else -+ { -+ UWtype m1, m0; -+ /* Normalize. */ -+ -+ b = W_TYPE_SIZE - bm; -+ -+ d1 = (d1 << bm) | (d0 >> b); -+ d0 = d0 << bm; -+ n2 = n1 >> b; -+ n1 = (n1 << bm) | (n0 >> b); -+ n0 = n0 << bm; -+ -+ udiv_qrnnd (q0, n1, n2, n1, d1); -+ umul_ppmm (m1, m0, q0, d0); -+ -+ if (m1 > n1 || (m1 == n1 && m0 > n0)) -+ { -+ q0--; -+ sub_ddmmss (m1, m0, m1, m0, d1, d0); -+ } -+ -+ q1 = 0; -+ -+ /* Remainder in (n1n0 - m1m0) >> bm. */ -+ if (rp != NULL) -+ { -+ sub_ddmmss (n1, n0, n1, n0, m1, m0); -+ rr.s.low = (n1 << b) | (n0 >> bm); -+ rr.s.high = n1 >> bm; -+ *rp = rr.ll; -+ } -+ } -+ } -+ } -+ -+ ww.s.low = q0; -+ ww.s.high = q1; -+ return ww.ll; -+} -+ -+DWtype -+__divdi3 (DWtype u, DWtype v) -+{ -+ Wtype c = 0; -+ DWtype w; -+ -+ if (u < 0) -+ { -+ c = ~c; -+ u = -u; -+ } -+ if (v < 0) -+ { -+ c = ~c; -+ v = -v; -+ } -+ w = __udivmoddi4 (u, v, NULL); -+ if (c) -+ w = -w; -+ return w; -+} -+ -+DWtype -+__moddi3 (DWtype u, DWtype v) -+{ -+ Wtype c = 0; -+ DWtype w; -+ -+ if (u < 0) -+ { -+ c = ~c; -+ u = -u; -+ } -+ if (v < 0) -+ v = -v; -+ __udivmoddi4 (u, v, &w); -+ if (c) -+ w = -w; -+ return w; -+} -+ -+UDWtype -+__udivdi3 (UDWtype u, UDWtype v) -+{ -+ return __udivmoddi4 (u, v, NULL); -+} -+ -+UDWtype -+__umoddi3 (UDWtype u, UDWtype v) -+{ -+ UDWtype w; -+ -+ __udivmoddi4 (u, v, &w); -+ return w; -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/hal.c linux-4.12.4-3rd/3rdparty/ndiswrapper/hal.c ---- linux-4.12.4/3rdparty/ndiswrapper/hal.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/hal.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,157 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include "ntoskernel.h" -+#include "hal_exports.h" -+ -+wstdcall void WIN_FUNC(WRITE_PORT_ULONG,2) -+ (ULONG_PTR port, ULONG value) -+{ -+ outl(value, port); -+} -+ -+wstdcall ULONG WIN_FUNC(READ_PORT_ULONG,1) -+ (ULONG_PTR port) -+{ -+ return inl(port); -+} -+ -+wstdcall void WIN_FUNC(WRITE_PORT_USHORT,2) -+ (ULONG_PTR port, USHORT value) -+{ -+ outw(value, port); -+} -+ -+wstdcall USHORT WIN_FUNC(READ_PORT_USHORT,1) -+ (ULONG_PTR port) -+{ -+ return inw(port); -+} -+ -+wstdcall void WIN_FUNC(WRITE_PORT_UCHAR,2) -+ (ULONG_PTR port, UCHAR value) -+{ -+ outb(value, port); -+} -+ -+wstdcall UCHAR WIN_FUNC(READ_PORT_UCHAR,1) -+ (ULONG_PTR port) -+{ -+ return inb(port); -+} -+ -+wstdcall void WIN_FUNC(WRITE_PORT_BUFFER_USHORT,3) -+ (ULONG_PTR port, USHORT *buf, ULONG count) -+{ -+ outsw(port, buf, count); -+} -+ -+wstdcall void WIN_FUNC(READ_PORT_BUFFER_USHORT,3) -+ (ULONG_PTR port, USHORT *buf, ULONG count) -+{ -+ insw(port, buf, count); -+} -+ -+wstdcall void WIN_FUNC(WRITE_PORT_BUFFER_ULONG,3) -+ (ULONG_PTR port, ULONG *buf, ULONG count) -+{ -+ outsl(port, buf, count); -+} -+ -+wstdcall void WIN_FUNC(READ_PORT_BUFFER_ULONG,3) -+ (ULONG_PTR port, ULONG *buf, ULONG count) -+{ -+ insl(port, buf, count); -+} -+ -+wstdcall USHORT WIN_FUNC(READ_REGISTER_USHORT,1) -+ (void __iomem *reg) -+{ -+ return readw(reg); -+} -+ -+wstdcall void WIN_FUNC(WRITE_REGISTER_ULONG,2) -+ (void __iomem *reg, UINT val) -+{ -+ writel(val, reg); -+} -+ -+wstdcall void WIN_FUNC(WRITE_REGISTER_USHORT,2) -+ (void __iomem *reg, USHORT val) -+{ -+ writew(val, reg); -+} -+ -+wstdcall void WIN_FUNC(WRITE_REGISTER_UCHAR,2) -+ (void __iomem *reg, UCHAR val) -+{ -+ writeb(val, reg); -+} -+ -+wstdcall void WIN_FUNC(KeStallExecutionProcessor,1) -+ (ULONG usecs) -+{ -+ udelay(usecs); -+} -+ -+wstdcall KIRQL WIN_FUNC(KeGetCurrentIrql,0) -+ (void) -+{ -+ return current_irql(); -+} -+ -+wfastcall KIRQL WIN_FUNC(KfRaiseIrql,1) -+ (KIRQL newirql) -+{ -+ return raise_irql(newirql); -+} -+ -+wfastcall void WIN_FUNC(KfLowerIrql,1) -+ (KIRQL oldirql) -+{ -+ lower_irql(oldirql); -+} -+ -+wfastcall KIRQL WIN_FUNC(KfAcquireSpinLock,1) -+ (NT_SPIN_LOCK *lock) -+{ -+ return nt_spin_lock_irql(lock, DISPATCH_LEVEL); -+} -+ -+wfastcall void WIN_FUNC(KfReleaseSpinLock,2) -+ (NT_SPIN_LOCK *lock, KIRQL oldirql) -+{ -+ nt_spin_unlock_irql(lock, oldirql); -+} -+ -+wfastcall void WIN_FUNC(KefAcquireSpinLockAtDpcLevel,1) -+ (NT_SPIN_LOCK *lock) -+{ -+#ifdef DEBUG_IRQL -+ if (current_irql() != DISPATCH_LEVEL) -+ ERROR("irql != DISPATCH_LEVEL"); -+#endif -+ nt_spin_lock(lock); -+} -+ -+wfastcall void WIN_FUNC(KefReleaseSpinLockFromDpcLevel,1) -+ (NT_SPIN_LOCK *lock) -+{ -+#ifdef DEBUG_IRQL -+ if (current_irql() != DISPATCH_LEVEL) -+ ERROR("irql != DISPATCH_LEVEL"); -+#endif -+ nt_spin_unlock(lock); -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/iw_ndis.c linux-4.12.4-3rd/3rdparty/ndiswrapper/iw_ndis.c ---- linux-4.12.4/3rdparty/ndiswrapper/iw_ndis.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/iw_ndis.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,2001 @@ -+ /* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+ -+#include "iw_ndis.h" -+#include "wrapndis.h" -+ -+#ifdef CONFIG_WIRELESS_EXT -+ -+static int freq_chan[] = { 2412, 2417, 2422, 2427, 2432, 2437, 2442, -+ 2447, 2452, 2457, 2462, 2467, 2472, 2484 }; -+ -+static const char *network_names[] = {"IEEE 802.11FH", "IEEE 802.11b", -+ "IEEE 802.11a", "IEEE 802.11g", "Auto"}; -+ -+static int set_essid(struct ndis_device *wnd, const char *ssid, int ssid_len) -+{ -+ NDIS_STATUS res; -+ struct ndis_essid req; -+ -+ if (ssid_len > NDIS_ESSID_MAX_SIZE) -+ return -EINVAL; -+ -+ memset(&req, 0, sizeof(req)); -+ req.length = ssid_len; -+ if (ssid_len) -+ memcpy(&req.essid, ssid, ssid_len); -+ -+ res = mp_set(wnd, OID_802_11_SSID, &req, sizeof(req)); -+ if (res) { -+ WARNING("setting essid failed (%08X)", res); -+ EXIT2(return -EINVAL); -+ } -+ memcpy(&wnd->essid, &req, sizeof(req)); -+ EXIT2(return 0); -+} -+ -+static int set_iw_auth_mode(struct ndis_device *wnd, int wpa_version, -+ int auth_80211_alg) -+{ -+ NDIS_STATUS res; -+ ULONG auth_mode; -+ -+ ENTER2("%d, %d", wpa_version, auth_80211_alg); -+ if (wpa_version & IW_AUTH_WPA_VERSION_WPA2) { -+ if (wnd->iw_auth_key_mgmt & IW_AUTH_KEY_MGMT_802_1X) -+ auth_mode = Ndis802_11AuthModeWPA2; -+ else -+ auth_mode = Ndis802_11AuthModeWPA2PSK; -+ } else if (wpa_version & IW_AUTH_WPA_VERSION_WPA) { -+ if (wnd->iw_auth_key_mgmt & IW_AUTH_KEY_MGMT_802_1X) -+ auth_mode = Ndis802_11AuthModeWPA; -+ else if (wnd->iw_auth_key_mgmt & IW_AUTH_KEY_MGMT_PSK) -+ auth_mode = Ndis802_11AuthModeWPAPSK; -+ else -+ auth_mode = Ndis802_11AuthModeWPANone; -+ } else if (auth_80211_alg & IW_AUTH_ALG_SHARED_KEY) { -+ if (auth_80211_alg & IW_AUTH_ALG_OPEN_SYSTEM) -+ auth_mode = Ndis802_11AuthModeAutoSwitch; -+ else -+ auth_mode = Ndis802_11AuthModeShared; -+ } else -+ auth_mode = Ndis802_11AuthModeOpen; -+ -+ res = mp_set_int(wnd, OID_802_11_AUTHENTICATION_MODE, auth_mode); -+ if (res) { -+ WARNING("setting auth mode to %u failed (%08X)", -+ auth_mode, res); -+ if (res == NDIS_STATUS_INVALID_DATA) -+ EXIT2(return -EINVAL); -+ return -EOPNOTSUPP; -+ } -+ wnd->iw_auth_wpa_version = wpa_version; -+ wnd->iw_auth_80211_alg = auth_80211_alg; -+ EXIT2(return 0); -+} -+ -+static int set_auth_mode(struct ndis_device *wnd) -+{ -+ return set_iw_auth_mode(wnd, wnd->iw_auth_wpa_version, -+ wnd->iw_auth_80211_alg); -+} -+ -+static enum ndis_priv_filter ndis_priv_mode(struct ndis_device *wnd) -+{ -+ if (wnd->iw_auth_wpa_version & IW_AUTH_WPA_VERSION_WPA2 || -+ wnd->iw_auth_wpa_version & IW_AUTH_WPA_VERSION_WPA) -+ return Ndis802_11PrivFilter8021xWEP; -+ else -+ return Ndis802_11PrivFilterAcceptAll; -+} -+ -+static int set_priv_filter(struct ndis_device *wnd) -+{ -+ NDIS_STATUS res; -+ ULONG flags; -+ -+ flags = ndis_priv_mode(wnd); -+ ENTER2("filter: %d", flags); -+ res = mp_set_int(wnd, OID_802_11_PRIVACY_FILTER, flags); -+ if (res) -+ TRACE2("setting privacy filter to %d failed (%08X)", -+ flags, res); -+ EXIT2(return 0); -+} -+ -+static int set_encr_mode(struct ndis_device *wnd) -+{ -+ return set_iw_encr_mode(wnd, wnd->iw_auth_cipher_pairwise, -+ wnd->iw_auth_cipher_group); -+} -+ -+static int set_assoc_params(struct ndis_device *wnd) -+{ -+ TRACE2("wpa_version=0x%x auth_alg=0x%x key_mgmt=0x%x " -+ "cipher_pairwise=0x%x cipher_group=0x%x", -+ wnd->iw_auth_wpa_version, wnd->iw_auth_80211_alg, -+ wnd->iw_auth_key_mgmt, wnd->iw_auth_cipher_pairwise, -+ wnd->iw_auth_cipher_group); -+ set_auth_mode(wnd); -+ set_priv_filter(wnd); -+ set_encr_mode(wnd); -+ return 0; -+} -+ -+static int iw_set_essid(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ int length; -+ -+ ENTER2(""); -+ /* there is no way to turn off essid other than to set to -+ * random bytes; instead, we use off to mean any */ -+ if (wrqu->essid.flags) { -+ length = wrqu->essid.length; -+ /* Strip '\0' appended by wireless extensions 19 and older */ -+ if (length > 0 && extra[length - 1] == '\0') -+ length--; -+ TRACE2("%d", length); -+ if (length <= 0 || length > NDIS_ESSID_MAX_SIZE) -+ EXIT2(return -EINVAL); -+ } else -+ length = 0; -+ -+ set_assoc_params(wnd); -+ -+ if (set_essid(wnd, extra, length)) -+ EXIT2(return -EINVAL); -+ -+ EXIT2(return 0); -+} -+ -+static int iw_get_essid(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ NDIS_STATUS res; -+ struct ndis_essid req; -+ -+ ENTER2(""); -+ memset(&req, 0, sizeof(req)); -+ res = mp_query(wnd, OID_802_11_SSID, &req, sizeof(req)); -+ if (res) { -+ WARNING("getting essid failed (%08X)", res); -+ EXIT2(return -EOPNOTSUPP); -+ } -+ memcpy(extra, req.essid, req.length); -+ if (req.length > 0) -+ wrqu->essid.flags = 1; -+ else -+ wrqu->essid.flags = 0; -+ wrqu->essid.length = req.length; -+ EXIT2(return 0); -+} -+ -+/* index must be 0 - N, as per NDIS */ -+static int add_wep_key(struct ndis_device *wnd, char *key, int key_len, -+ int index) -+{ -+ struct ndis_encr_key ndis_key; -+ NDIS_STATUS res; -+ -+ ENTER2("key index: %d, length: %d", index, key_len); -+ if (key_len <= 0 || key_len > NDIS_ENCODING_TOKEN_MAX) { -+ WARNING("invalid key length (%d)", key_len); -+ EXIT2(return -EINVAL); -+ } -+ if (index < 0 || index >= MAX_ENCR_KEYS) { -+ WARNING("invalid key index (%d)", index); -+ EXIT2(return -EINVAL); -+ } -+ ndis_key.struct_size = sizeof(ndis_key); -+ ndis_key.length = key_len; -+ memcpy(&ndis_key.key, key, key_len); -+ ndis_key.index = index; -+ -+ if (index == wnd->encr_info.tx_key_index) { -+ ndis_key.index |= (1 << 31); -+ res = set_iw_encr_mode(wnd, IW_AUTH_CIPHER_WEP104, -+ IW_AUTH_CIPHER_NONE); -+ if (res) -+ WARNING("encryption couldn't be enabled (%08X)", res); -+ } -+ TRACE2("key %d: " MACSTRSEP, index, MAC2STR(key)); -+ res = mp_set(wnd, OID_802_11_ADD_WEP, &ndis_key, sizeof(ndis_key)); -+ if (res) { -+ WARNING("adding encryption key %d failed (%08X)", -+ index+1, res); -+ EXIT2(return -EINVAL); -+ } -+ -+ /* Atheros driver messes up ndis_key during ADD_WEP, so -+ * don't rely on that; instead use info in key and key_len */ -+ wnd->encr_info.keys[index].length = key_len; -+ memcpy(&wnd->encr_info.keys[index].key, key, key_len); -+ -+ EXIT2(return 0); -+} -+ -+static int set_infra_mode(struct ndis_device *wnd, -+ enum ndis_infrastructure_mode mode) -+{ -+ NDIS_STATUS res; -+ unsigned int i; -+ -+ ENTER2("%d", mode); -+ res = mp_query_int(wnd, OID_802_11_INFRASTRUCTURE_MODE, -+ &wnd->infrastructure_mode); -+ if (res != NDIS_STATUS_SUCCESS) { -+ WARNING("getting operating mode failed (%08X)", res); -+ EXIT2(return -EINVAL); -+ } -+ if (wnd->infrastructure_mode == mode) -+ EXIT2(return 0); -+ res = mp_set_int(wnd, OID_802_11_INFRASTRUCTURE_MODE, mode); -+ if (res) { -+ WARNING("setting operating mode to %d failed (%08X)", -+ mode, res); -+ EXIT2(return -EINVAL); -+ } -+ /* NDIS drivers clear keys when infrastructure mode is -+ * changed. But Linux tools assume otherwise. So set the -+ * keys */ -+ if (wnd->iw_auth_key_mgmt == 0 || -+ wnd->iw_auth_key_mgmt == IW_AUTH_KEY_MGMT_802_1X) { -+ for (i = 0; i < MAX_ENCR_KEYS; i++) { -+ if (wnd->encr_info.keys[i].length > 0) -+ add_wep_key(wnd, wnd->encr_info.keys[i].key, -+ wnd->encr_info.keys[i].length, i); -+ } -+ } -+ wnd->infrastructure_mode = mode; -+ EXIT2(return 0); -+} -+ -+static int iw_set_infra_mode(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ enum ndis_infrastructure_mode ndis_mode; -+ -+ ENTER2("%d", wrqu->mode); -+ switch (wrqu->mode) { -+ case IW_MODE_ADHOC: -+ ndis_mode = Ndis802_11IBSS; -+ break; -+ case IW_MODE_INFRA: -+ ndis_mode = Ndis802_11Infrastructure; -+ break; -+ case IW_MODE_AUTO: -+ ndis_mode = Ndis802_11AutoUnknown; -+ break; -+ default: -+ EXIT2(return -EINVAL); -+ } -+ -+ if (set_infra_mode(wnd, ndis_mode)) -+ EXIT2(return -EINVAL); -+ -+ EXIT2(return 0); -+} -+ -+static int iw_get_infra_mode(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ int ndis_mode, iw_mode; -+ NDIS_STATUS res; -+ -+ ENTER2(""); -+ res = mp_query_int(wnd, OID_802_11_INFRASTRUCTURE_MODE, &ndis_mode); -+ if (res) { -+ WARNING("getting operating mode failed (%08X)", res); -+ EXIT2(return -EOPNOTSUPP); -+ } -+ -+ switch (ndis_mode) { -+ case Ndis802_11IBSS: -+ iw_mode = IW_MODE_ADHOC; -+ break; -+ case Ndis802_11Infrastructure: -+ iw_mode = IW_MODE_INFRA; -+ break; -+ case Ndis802_11AutoUnknown: -+ iw_mode = IW_MODE_AUTO; -+ break; -+ default: -+ ERROR("invalid operating mode (%u)", ndis_mode); -+ EXIT2(return -EINVAL); -+ } -+ wrqu->mode = iw_mode; -+ EXIT2(return 0); -+} -+ -+static const char *network_type_to_name(int net_type) -+{ -+ if (net_type >= 0 && net_type < ARRAY_SIZE(network_names)) -+ return network_names[net_type]; -+ else -+ return network_names[ARRAY_SIZE(network_names) - 1]; -+} -+ -+static int iw_get_network_type(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ unsigned int network_type; -+ NDIS_STATUS res; -+ -+ ENTER2(""); -+ res = mp_query_int(wnd, OID_802_11_NETWORK_TYPE_IN_USE, -+ &network_type); -+ if (res) { -+ WARNING("getting network type failed: %08X", res); -+ network_type = -1; -+ } -+ strncpy(wrqu->name, network_type_to_name(network_type), -+ sizeof(wrqu->name) - 1); -+ wrqu->name[sizeof(wrqu->name)-1] = 0; -+ return 0; -+} -+ -+static int iw_get_freq(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ NDIS_STATUS res; -+ struct ndis_configuration req; -+ -+ ENTER2(""); -+ memset(&req, 0, sizeof(req)); -+ res = mp_query(wnd, OID_802_11_CONFIGURATION, &req, sizeof(req)); -+ if (res) { -+ WARNING("getting configuration failed (%08X)", res); -+ EXIT2(return -EOPNOTSUPP); -+ } -+ -+ memset(&(wrqu->freq), 0, sizeof(struct iw_freq)); -+ -+ /* see comment in wireless.h above the "struct iw_freq" -+ definition for an explanation of this if -+ NOTE: 1000000 is due to the kHz -+ */ -+ if (req.ds_config > 1000000) { -+ wrqu->freq.m = req.ds_config / 10; -+ wrqu->freq.e = 1; -+ } -+ else -+ wrqu->freq.m = req.ds_config; -+ -+ /* convert from kHz to Hz */ -+ wrqu->freq.e += 3; -+ -+ return 0; -+} -+ -+static int iw_set_freq(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ NDIS_STATUS res; -+ struct ndis_configuration req; -+ -+ ENTER2(""); -+ /* this OID is valid only when not associated */ -+ if (netif_carrier_ok(wnd->net_dev)) -+ EXIT2(return 0); -+ memset(&req, 0, sizeof(req)); -+ res = mp_query(wnd, OID_802_11_CONFIGURATION, &req, sizeof(req)); -+ if (res) { -+ WARNING("getting configuration failed (%08X)", res); -+ EXIT2(return 0); -+ } -+ -+ if (wrqu->freq.m < 1000 && wrqu->freq.e == 0) { -+ if (wrqu->freq.m >= 1 && wrqu->freq.m <= ARRAY_SIZE(freq_chan)) -+ req.ds_config = freq_chan[wrqu->freq.m - 1] * 1000; -+ else -+ return -EINVAL; -+ } else { -+ int i; -+ req.ds_config = wrqu->freq.m; -+ for (i = wrqu->freq.e; i > 0; i--) -+ req.ds_config *= 10; -+ req.ds_config /= 1000; -+ } -+ res = mp_set(wnd, OID_802_11_CONFIGURATION, &req, sizeof(req)); -+ if (res) -+ WARNING("setting configuration failed (%08X)", res); -+ return 0; -+} -+ -+static int iw_get_tx_power(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ ndis_tx_power_level ndis_power; -+ NDIS_STATUS res; -+ -+ ENTER2(""); -+ res = mp_query(wnd, OID_802_11_TX_POWER_LEVEL, -+ &ndis_power, sizeof(ndis_power)); -+ if (res) -+ return -EOPNOTSUPP; -+ wrqu->txpower.flags = IW_TXPOW_MWATT; -+ wrqu->txpower.disabled = 0; -+ wrqu->txpower.fixed = 0; -+ wrqu->txpower.value = ndis_power; -+ return 0; -+} -+ -+static int iw_set_tx_power(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ ndis_tx_power_level ndis_power; -+ NDIS_STATUS res; -+ -+ ENTER2(""); -+ if (wrqu->txpower.disabled) -+ ndis_power = 0; -+ else { -+ if (wrqu->txpower.flags == IW_TXPOW_MWATT) -+ ndis_power = wrqu->txpower.value; -+ else { // wrqu->txpower.flags == IW_TXPOW_DBM -+ if (wrqu->txpower.value > 20) -+ ndis_power = 128; -+ else if (wrqu->txpower.value < -43) -+ ndis_power = 127; -+ else { -+ signed char tmp; -+ tmp = wrqu->txpower.value; -+ tmp = -12 - tmp; -+ tmp <<= 2; -+ ndis_power = (unsigned char)tmp; -+ } -+ } -+ } -+ TRACE2("%d", ndis_power); -+ res = mp_set(wnd, OID_802_11_TX_POWER_LEVEL, -+ &ndis_power, sizeof(ndis_power)); -+ if (res) -+ EXIT2(return -EOPNOTSUPP); -+ if (ndis_power == 0) -+ res = disassociate(wnd, 0); -+ EXIT2(return 0); -+} -+ -+static int iw_get_bitrate(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ ULONG ndis_rate; -+ int res; -+ -+ ENTER2(""); -+ res = mp_query(wnd, OID_GEN_LINK_SPEED, &ndis_rate, sizeof(ndis_rate)); -+ if (res) { -+ WARNING("getting bitrate failed (%08X)", res); -+ ndis_rate = 0; -+ } -+ -+ wrqu->bitrate.value = ndis_rate * 100; -+ return 0; -+} -+ -+static int iw_set_bitrate(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ int i, n; -+ NDIS_STATUS res; -+ UCHAR rates[NDIS_MAX_RATES_EX]; -+ -+ ENTER2(""); -+ if (wrqu->bitrate.fixed == 0) -+ EXIT2(return 0); -+ -+ res = mp_query_info(wnd, OID_802_11_SUPPORTED_RATES, &rates, -+ sizeof(rates), &n, NULL); -+ if (res) { -+ WARNING("getting bit rate failed (%08X)", res); -+ EXIT2(return 0); -+ } -+ for (i = 0; i < n; i++) { -+ if (rates[i] & 0x80) -+ continue; -+ if ((rates[i] & 0x7f) * 500000 > wrqu->bitrate.value) { -+ TRACE2("setting rate %d to 0", -+ (rates[i] & 0x7f) * 500000); -+ rates[i] = 0; -+ } -+ } -+ -+ res = mp_set(wnd, OID_802_11_DESIRED_RATES, &rates, n); -+ if (res) { -+ WARNING("setting bit rate failed (%08X)", res); -+ EXIT2(return 0); -+ } -+ -+ return 0; -+} -+ -+static int iw_set_dummy(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ /* Do nothing. Used for ioctls that are not implemented. */ -+ return 0; -+} -+ -+static int iw_get_rts_threshold(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ ndis_rts_threshold threshold; -+ NDIS_STATUS res; -+ -+ ENTER2(""); -+ res = mp_query(wnd, OID_802_11_RTS_THRESHOLD, -+ &threshold, sizeof(threshold)); -+ if (res) -+ return -EOPNOTSUPP; -+ -+ wrqu->rts.value = threshold; -+ return 0; -+} -+ -+static int iw_set_rts_threshold(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ ndis_rts_threshold threshold; -+ NDIS_STATUS res; -+ -+ ENTER2(""); -+ threshold = wrqu->rts.value; -+ res = mp_set(wnd, OID_802_11_RTS_THRESHOLD, -+ &threshold, sizeof(threshold)); -+ if (res == NDIS_STATUS_INVALID_DATA) -+ return -EINVAL; -+ if (res) -+ return -EOPNOTSUPP; -+ -+ return 0; -+} -+ -+static int iw_get_frag_threshold(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ ndis_fragmentation_threshold frag_threshold; -+ NDIS_STATUS res; -+ -+ ENTER2(""); -+ res = mp_query(wnd, OID_802_11_FRAGMENTATION_THRESHOLD, -+ &frag_threshold, sizeof(frag_threshold)); -+ if (res) -+ return -ENOTSUPP; -+ -+ wrqu->frag.value = frag_threshold; -+ return 0; -+} -+ -+static int iw_set_frag_threshold(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ ndis_rts_threshold threshold; -+ NDIS_STATUS res; -+ -+ ENTER2(""); -+ threshold = wrqu->frag.value; -+ res = mp_set(wnd, OID_802_11_FRAGMENTATION_THRESHOLD, -+ &threshold, sizeof(threshold)); -+ if (res == NDIS_STATUS_INVALID_DATA) -+ return -EINVAL; -+ if (res) -+ return -EOPNOTSUPP; -+ return 0; -+} -+ -+int get_ap_address(struct ndis_device *wnd, mac_address ap_addr) -+{ -+ NDIS_STATUS res; -+ -+ res = mp_query(wnd, OID_802_11_BSSID, ap_addr, ETH_ALEN); -+ TRACE2(MACSTRSEP, MAC2STR(ap_addr)); -+ if (res) { -+ TRACE2("res: %08X", res); -+ memset(ap_addr, 0x0, ETH_ALEN); -+ EXIT2(return -EOPNOTSUPP); -+ } -+ EXIT2(return 0); -+} -+ -+static int iw_get_ap_address(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ mac_address ap_addr; -+ -+ ENTER2(""); -+ get_ap_address(wnd, ap_addr); -+ memcpy(wrqu->ap_addr.sa_data, ap_addr, ETH_ALEN); -+ wrqu->ap_addr.sa_family = ARPHRD_ETHER; -+ EXIT2(return 0); -+} -+ -+static int iw_set_ap_address(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ NDIS_STATUS res; -+ mac_address ap_addr; -+ -+ ENTER2(""); -+ memcpy(ap_addr, wrqu->ap_addr.sa_data, ETH_ALEN); -+ TRACE2(MACSTRSEP, MAC2STR(ap_addr)); -+ res = mp_set(wnd, OID_802_11_BSSID, ap_addr, ETH_ALEN); -+ /* user apps may set ap's mac address, which is not required; -+ * they may fail to work if this function fails, so return -+ * success */ -+ if (res) -+ WARNING("setting AP mac address failed (%08X)", res); -+ -+ EXIT2(return 0); -+} -+ -+int set_ndis_auth_mode(struct ndis_device *wnd, ULONG auth_mode) -+{ -+ NDIS_STATUS res; -+ -+ ENTER2("%d", auth_mode); -+ res = mp_set_int(wnd, OID_802_11_AUTHENTICATION_MODE, auth_mode); -+ if (res) { -+ WARNING("setting auth mode to %u failed (%08X)", -+ auth_mode, res); -+ if (res == NDIS_STATUS_INVALID_DATA) -+ EXIT2(return -EINVAL); -+ return -EOPNOTSUPP; -+ } -+ switch (auth_mode) { -+ case Ndis802_11AuthModeWPA: -+ wnd->iw_auth_wpa_version = IW_AUTH_WPA_VERSION_WPA; -+ wnd->iw_auth_key_mgmt = IW_AUTH_KEY_MGMT_802_1X; -+ break; -+ case Ndis802_11AuthModeWPAPSK: -+ wnd->iw_auth_wpa_version = IW_AUTH_WPA_VERSION_WPA; -+ wnd->iw_auth_key_mgmt = IW_AUTH_KEY_MGMT_PSK; -+ case Ndis802_11AuthModeWPANone: -+ wnd->iw_auth_wpa_version = IW_AUTH_WPA_VERSION_DISABLED; -+ wnd->iw_auth_key_mgmt = IW_AUTH_KEY_MGMT_PSK; -+ break; -+ case Ndis802_11AuthModeWPA2: -+ wnd->iw_auth_wpa_version = IW_AUTH_WPA_VERSION_WPA2; -+ wnd->iw_auth_key_mgmt = IW_AUTH_KEY_MGMT_802_1X; -+ break; -+ case Ndis802_11AuthModeWPA2PSK: -+ wnd->iw_auth_wpa_version = IW_AUTH_WPA_VERSION_WPA2; -+ wnd->iw_auth_key_mgmt = IW_AUTH_KEY_MGMT_PSK; -+ break; -+ case Ndis802_11AuthModeOpen: -+ wnd->iw_auth_wpa_version = IW_AUTH_WPA_VERSION_DISABLED; -+ wnd->iw_auth_80211_alg = IW_AUTH_ALG_OPEN_SYSTEM; -+ break; -+ case Ndis802_11AuthModeShared: -+ wnd->iw_auth_wpa_version = IW_AUTH_WPA_VERSION_DISABLED; -+ wnd->iw_auth_80211_alg = IW_AUTH_ALG_SHARED_KEY; -+ break; -+ case Ndis802_11AuthModeAutoSwitch: -+ wnd->iw_auth_wpa_version = IW_AUTH_WPA_VERSION_DISABLED; -+ wnd->iw_auth_80211_alg = IW_AUTH_ALG_SHARED_KEY; -+ wnd->iw_auth_80211_alg |= IW_AUTH_ALG_OPEN_SYSTEM; -+ break; -+ default: -+ WARNING("invalid authentication algorithm: %d", auth_mode); -+ break; -+ } -+ EXIT2(return 0); -+} -+ -+int get_ndis_auth_mode(struct ndis_device *wnd) -+{ -+ ULONG mode; -+ NDIS_STATUS res; -+ -+ res = mp_query_int(wnd, OID_802_11_AUTHENTICATION_MODE, &mode); -+ if (res) { -+ WARNING("getting authentication mode failed (%08X)", res); -+ EXIT2(return -EOPNOTSUPP); -+ } -+ TRACE2("%d", mode); -+ return mode; -+} -+ -+int set_iw_encr_mode(struct ndis_device *wnd, int cipher_pairwise, -+ int cipher_groupwise) -+{ -+ NDIS_STATUS res; -+ ULONG ndis_mode; -+ -+ ENTER2("%d, %d", cipher_pairwise, cipher_groupwise); -+ if (cipher_pairwise & IW_AUTH_CIPHER_CCMP) -+ ndis_mode = Ndis802_11Encryption3Enabled; -+ else if (cipher_pairwise & IW_AUTH_CIPHER_TKIP) -+ ndis_mode = Ndis802_11Encryption2Enabled; -+ else if (cipher_pairwise & -+ (IW_AUTH_CIPHER_WEP40 | IW_AUTH_CIPHER_WEP104)) -+ ndis_mode = Ndis802_11Encryption1Enabled; -+ else if (cipher_groupwise & IW_AUTH_CIPHER_CCMP) -+ ndis_mode = Ndis802_11Encryption3Enabled; -+ else if (cipher_groupwise & IW_AUTH_CIPHER_TKIP) -+ ndis_mode = Ndis802_11Encryption2Enabled; -+ else -+ ndis_mode = Ndis802_11EncryptionDisabled; -+ -+ res = mp_set_int(wnd, OID_802_11_ENCRYPTION_STATUS, ndis_mode); -+ if (res) { -+ WARNING("setting encryption mode to %u failed (%08X)", -+ ndis_mode, res); -+ if (res == NDIS_STATUS_INVALID_DATA) -+ EXIT2(return -EINVAL); -+ return -EOPNOTSUPP; -+ } -+ wnd->iw_auth_cipher_pairwise = cipher_pairwise; -+ wnd->iw_auth_cipher_group = cipher_groupwise; -+ EXIT2(return 0); -+} -+ -+int get_ndis_encr_mode(struct ndis_device *wnd) -+{ -+ ULONG mode; -+ NDIS_STATUS res; -+ -+ ENTER2(""); -+ res = mp_query_int(wnd, OID_802_11_ENCRYPTION_STATUS, &mode); -+ if (res) { -+ WARNING("getting encryption status failed (%08X)", res); -+ EXIT2(return -EOPNOTSUPP); -+ } else -+ EXIT2(return mode); -+} -+ -+static int iw_get_encr(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ int index, mode; -+ struct encr_info *encr_info = &wnd->encr_info; -+ -+ ENTER2("wnd = %p", wnd); -+ wrqu->data.length = 0; -+ extra[0] = 0; -+ -+ index = (wrqu->encoding.flags & IW_ENCODE_INDEX); -+ TRACE2("index = %u", index); -+ if (index > 0) -+ index--; -+ else -+ index = encr_info->tx_key_index; -+ -+ if (index < 0 || index >= MAX_ENCR_KEYS) { -+ WARNING("encryption index out of range (%u)", index); -+ EXIT2(return -EINVAL); -+ } -+ -+ if (index != encr_info->tx_key_index) { -+ if (encr_info->keys[index].length > 0) { -+ wrqu->data.flags |= IW_ENCODE_ENABLED; -+ wrqu->data.length = encr_info->keys[index].length; -+ memcpy(extra, encr_info->keys[index].key, -+ encr_info->keys[index].length); -+ } -+ else -+ wrqu->data.flags |= IW_ENCODE_DISABLED; -+ -+ EXIT2(return 0); -+ } -+ -+ /* transmit key */ -+ mode = get_ndis_encr_mode(wnd); -+ if (mode < 0) -+ EXIT2(return -EOPNOTSUPP); -+ -+ if (mode == Ndis802_11EncryptionDisabled || -+ mode == Ndis802_11EncryptionNotSupported) -+ wrqu->data.flags |= IW_ENCODE_DISABLED; -+ else { -+ if (mode == Ndis802_11Encryption1KeyAbsent || -+ mode == Ndis802_11Encryption2KeyAbsent || -+ mode == Ndis802_11Encryption3KeyAbsent) -+ wrqu->data.flags |= IW_ENCODE_NOKEY; -+ else { -+ wrqu->data.flags |= IW_ENCODE_ENABLED; -+ wrqu->encoding.flags |= index+1; -+ wrqu->data.length = encr_info->keys[index].length; -+ memcpy(extra, encr_info->keys[index].key, -+ encr_info->keys[index].length); -+ } -+ } -+ mode = get_ndis_auth_mode(wnd); -+ if (mode < 0) -+ EXIT2(return -EOPNOTSUPP); -+ -+ if (mode == Ndis802_11AuthModeOpen) -+ wrqu->data.flags |= IW_ENCODE_OPEN; -+ else if (mode == Ndis802_11AuthModeAutoSwitch) -+ wrqu->data.flags |= IW_ENCODE_RESTRICTED; -+ else // Ndis802_11AuthModeAutoSwitch, Ndis802_11AuthModeWPA etc. -+ wrqu->data.flags |= IW_ENCODE_RESTRICTED; -+ -+ EXIT2(return 0); -+} -+ -+/* remove_key is for both wep and wpa */ -+static int remove_key(struct ndis_device *wnd, int index, -+ mac_address bssid) -+{ -+ NDIS_STATUS res; -+ if (wnd->encr_info.keys[index].length == 0) -+ EXIT2(return 0); -+ wnd->encr_info.keys[index].length = 0; -+ memset(&wnd->encr_info.keys[index].key, 0, -+ sizeof(wnd->encr_info.keys[index].length)); -+ if (wnd->iw_auth_cipher_pairwise == IW_AUTH_CIPHER_TKIP || -+ wnd->iw_auth_cipher_pairwise == IW_AUTH_CIPHER_CCMP || -+ wnd->iw_auth_cipher_group == IW_AUTH_CIPHER_TKIP || -+ wnd->iw_auth_cipher_group == IW_AUTH_CIPHER_CCMP) { -+ struct ndis_remove_key rmkey; -+ rmkey.struct_size = sizeof(rmkey); -+ rmkey.index = index; -+ if (bssid) { -+ /* pairwise key */ -+ if (memcmp(bssid, "\xff\xff\xff\xff\xff\xff", -+ ETH_ALEN) != 0) -+ rmkey.index |= (1 << 30); -+ memcpy(rmkey.bssid, bssid, sizeof(rmkey.bssid)); -+ } else -+ memset(rmkey.bssid, 0xff, sizeof(rmkey.bssid)); -+ if (mp_set(wnd, OID_802_11_REMOVE_KEY, &rmkey, sizeof(rmkey))) -+ EXIT2(return -EINVAL); -+ } else { -+ ndis_key_index keyindex = index; -+ res = mp_set_int(wnd, OID_802_11_REMOVE_WEP, keyindex); -+ if (res) { -+ WARNING("removing encryption key %d failed (%08X)", -+ keyindex, res); -+ EXIT2(return -EINVAL); -+ } -+ } -+ /* if it is transmit key, disable encryption */ -+ if (index == wnd->encr_info.tx_key_index) { -+ res = set_iw_encr_mode(wnd, IW_AUTH_CIPHER_NONE, -+ IW_AUTH_CIPHER_NONE); -+ if (res) -+ WARNING("changing encr status failed (%08X)", res); -+ } -+ TRACE2("key %d removed", index); -+ EXIT2(return 0); -+} -+ -+static int iw_set_wep(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ NDIS_STATUS res; -+ unsigned int index, key_len; -+ struct encr_info *encr_info = &wnd->encr_info; -+ unsigned char *key; -+ -+ ENTER2(""); -+ index = (wrqu->encoding.flags & IW_ENCODE_INDEX); -+ TRACE2("index = %u", index); -+ -+ /* iwconfig gives index as 1 - N */ -+ if (index > 0) -+ index--; -+ else -+ index = encr_info->tx_key_index; -+ -+ if (index >= MAX_ENCR_KEYS) { -+ WARNING("encryption index out of range (%u)", index); -+ EXIT2(return -EINVAL); -+ } -+ -+ /* remove key if disabled */ -+ if (wrqu->data.flags & IW_ENCODE_DISABLED) { -+ if (remove_key(wnd, index, NULL)) -+ EXIT2(return -EINVAL); -+ else -+ EXIT2(return 0); -+ } -+ -+ /* global encryption state (for all keys) */ -+ if (wrqu->data.flags & IW_ENCODE_OPEN) -+ res = set_ndis_auth_mode(wnd, Ndis802_11AuthModeOpen); -+ else // if (wrqu->data.flags & IW_ENCODE_RESTRICTED) -+ res = set_ndis_auth_mode(wnd, Ndis802_11AuthModeShared); -+ if (res) { -+ WARNING("setting authentication mode failed (%08X)", res); -+ EXIT2(return -EINVAL); -+ } -+ -+ TRACE2("key length: %d", wrqu->data.length); -+ -+ if (wrqu->data.length > 0) { -+ key_len = wrqu->data.length; -+ key = extra; -+ } else { // must be set as tx key -+ if (encr_info->keys[index].length == 0) { -+ WARNING("key %d is not set", index+1); -+ EXIT2(return -EINVAL); -+ } -+ key_len = encr_info->keys[index].length; -+ key = encr_info->keys[index].key; -+ encr_info->tx_key_index = index; -+ } -+ -+ if (add_wep_key(wnd, key, key_len, index)) -+ EXIT2(return -EINVAL); -+ -+ if (index == encr_info->tx_key_index) { -+ /* if transmit key is at index other than 0, some -+ * drivers, at least Atheros and TI, want another -+ * (global) non-transmit key to be set; don't know why */ -+ if (index != 0) { -+ int i; -+ for (i = 0; i < MAX_ENCR_KEYS; i++) -+ if (i != index && -+ encr_info->keys[i].length != 0) -+ break; -+ if (i == MAX_ENCR_KEYS) { -+ if (index == 0) -+ i = index + 1; -+ else -+ i = index - 1; -+ if (add_wep_key(wnd, key, key_len, i)) -+ WARNING("couldn't add broadcast key" -+ " at %d", i); -+ } -+ } -+ /* ndis drivers want essid to be set after setting encr */ -+ set_essid(wnd, wnd->essid.essid, wnd->essid.length); -+ } -+ EXIT2(return 0); -+} -+ -+static int iw_set_nick(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ -+ if (wrqu->data.length >= sizeof(wnd->nick)) -+ return -EINVAL; -+ memcpy(wnd->nick, extra, wrqu->data.length); -+ wnd->nick[wrqu->data.length] = 0; -+ return 0; -+} -+ -+static int iw_get_nick(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ -+ wrqu->data.length = strlen(wnd->nick); -+ memcpy(extra, wnd->nick, wrqu->data.length); -+ return 0; -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 27) && !defined(IW_REQUEST_FLAG_COMPAT) -+#define iwe_stream_add_event(a, b, c, d, e) iwe_stream_add_event(b, c, d, e) -+#define iwe_stream_add_point(a, b, c, d, e) iwe_stream_add_point(b, c, d, e) -+#define iwe_stream_add_value(a, b, c, d, e, f) \ -+ iwe_stream_add_value(b, c, d, e, f) -+#define iwe_stream_lcp_len(a) IW_EV_LCP_LEN -+#endif -+ -+static char *ndis_translate_scan(struct net_device *dev, -+ struct iw_request_info *info, char *event, -+ char *end_buf, void *item) -+{ -+ struct iw_event iwe; -+ char *current_val; -+ char *ret; -+ int i, nrates; -+ unsigned char custom_str[64]; -+ struct ndis_wlan_bssid *bssid; -+ struct ndis_wlan_bssid_ex *bssid_ex; -+ int extended; -+ -+ ENTER2("%p, %p", event, item); -+ bssid = item; -+ bssid_ex = item; -+ extended = (bssid->length > offsetof(struct ndis_wlan_bssid_ex, var)); -+ -+ /* add mac address */ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = SIOCGIWAP; -+ iwe.u.ap_addr.sa_family = ARPHRD_ETHER; -+ iwe.len = IW_EV_ADDR_LEN; -+ memcpy(iwe.u.ap_addr.sa_data, bssid->mac, ETH_ALEN); -+ ret = iwe_stream_add_event(info, event, end_buf, &iwe, IW_EV_ADDR_LEN); -+ if (ret == event) -+ return NULL; -+ event = ret; -+ -+ /* add essid */ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = SIOCGIWESSID; -+ iwe.u.data.length = bssid->ssid.length; -+ if (iwe.u.data.length > IW_ESSID_MAX_SIZE) -+ iwe.u.data.length = IW_ESSID_MAX_SIZE; -+ iwe.u.data.flags = 1; -+ iwe.len = IW_EV_POINT_LEN + iwe.u.data.length; -+ ret = iwe_stream_add_point(info, event, end_buf, &iwe, -+ bssid->ssid.essid); -+ if (ret == event) -+ return NULL; -+ event = ret; -+ -+ /* add protocol name */ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = SIOCGIWNAME; -+ strncpy(iwe.u.name, network_type_to_name(bssid->net_type), IFNAMSIZ); -+ ret = iwe_stream_add_event(info, event, end_buf, &iwe, IW_EV_CHAR_LEN); -+ if (ret == event) -+ return NULL; -+ event = ret; -+ -+ /* add mode */ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = SIOCGIWMODE; -+ if (bssid->mode == Ndis802_11IBSS) -+ iwe.u.mode = IW_MODE_ADHOC; -+ else if (bssid->mode == Ndis802_11Infrastructure) -+ iwe.u.mode = IW_MODE_MASTER; -+ else // if (bssid->mode == Ndis802_11AutoUnknown) -+ iwe.u.mode = IW_MODE_AUTO; -+ ret = iwe_stream_add_event(info, event, end_buf, &iwe, IW_EV_UINT_LEN); -+ if (ret == event) -+ return NULL; -+ event = ret; -+ -+ /* add freq */ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = SIOCGIWFREQ; -+ iwe.u.freq.m = bssid->config.ds_config; -+ if (bssid->config.ds_config > 1000000) { -+ iwe.u.freq.m = bssid->config.ds_config / 10; -+ iwe.u.freq.e = 1; -+ } -+ else -+ iwe.u.freq.m = bssid->config.ds_config; -+ /* convert from kHz to Hz */ -+ iwe.u.freq.e += 3; -+ iwe.len = IW_EV_FREQ_LEN; -+ ret = iwe_stream_add_event(info, event, end_buf, &iwe, IW_EV_FREQ_LEN); -+ if (ret == event) -+ return NULL; -+ event = ret; -+ -+ /* add qual */ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVQUAL; -+ i = 100 * (bssid->rssi - WL_NOISE) / (WL_SIGMAX - WL_NOISE); -+ if (i < 0) -+ i = 0; -+ else if (i > 100) -+ i = 100; -+ iwe.u.qual.level = bssid->rssi; -+ iwe.u.qual.noise = WL_NOISE; -+ iwe.u.qual.qual = i; -+ iwe.len = IW_EV_QUAL_LEN; -+ ret = iwe_stream_add_event(info, event, end_buf, &iwe, IW_EV_QUAL_LEN); -+ if (ret == event) -+ return NULL; -+ event = ret; -+ -+ /* add key info */ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = SIOCGIWENCODE; -+ if (bssid->privacy == Ndis802_11PrivFilterAcceptAll) -+ iwe.u.data.flags = IW_ENCODE_DISABLED; -+ else -+ iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; -+ iwe.u.data.length = 0; -+ iwe.len = IW_EV_POINT_LEN; -+ ret = iwe_stream_add_point(info, event, end_buf, &iwe, -+ bssid->ssid.essid); -+ if (ret == event) -+ return NULL; -+ event = ret; -+ -+ /* add rate */ -+ memset(&iwe, 0, sizeof(iwe)); -+ current_val = event + iwe_stream_lcp_len(info); -+ iwe.cmd = SIOCGIWRATE; -+ if (extended) -+ nrates = ARRAY_SIZE(bssid->rates); -+ else -+ nrates = ARRAY_SIZE(bssid_ex->rates_ex); -+ for (i = 0; i < nrates; i++) { -+ if (bssid_ex->rates_ex[i] & 0x7f) { -+ iwe.u.bitrate.value = ((bssid->rates[i] & 0x7f) * -+ 500000); -+ ret = iwe_stream_add_value(info, event, current_val, -+ end_buf, &iwe, -+ IW_EV_PARAM_LEN); -+ if (ret == current_val) -+ return NULL; -+ current_val = ret; -+ } -+ } -+ -+ if ((current_val - event) > iwe_stream_lcp_len(info)) -+ event = current_val; -+ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ sprintf(custom_str, "bcn_int=%d", bssid->config.beacon_period); -+ iwe.u.data.length = strlen(custom_str); -+ ret = iwe_stream_add_point(info, event, end_buf, &iwe, custom_str); -+ if (ret == event) -+ return NULL; -+ event = ret; -+ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ sprintf(custom_str, "atim=%u", bssid->config.atim_window); -+ iwe.u.data.length = strlen(custom_str); -+ ret = iwe_stream_add_point(info, event, end_buf, &iwe, custom_str); -+ if (ret == event) -+ return NULL; -+ event = ret; -+ -+ TRACE2("%d, %zu", bssid->length, sizeof(*bssid)); -+ if (extended) { -+ struct ndis_variable_ies *iep = bssid_ex->var; -+ unsigned char *end = (unsigned char *)&bssid_ex->fixed + -+ bssid_ex->ie_length; -+ -+ while (&iep->length < end && &iep->data[iep->length] <= end) { -+ unsigned char ielen = iep->length + 2; -+ -+ memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVGENIE; -+ iwe.u.data.length = ielen; -+ ret = iwe_stream_add_point(info, event, end_buf, &iwe, -+ (char *)iep); -+ if (ret == event) -+ return NULL; -+ event = ret; -+ iep = (typeof(iep))&iep->data[iep->length]; -+ } -+ } -+ TRACE2("event = %p, current_val = %p", event, current_val); -+ EXIT2(return event); -+} -+ -+static int set_scan(struct ndis_device *wnd) -+{ -+ NDIS_STATUS res; -+ -+ ENTER2(""); -+ res = mp_set(wnd, OID_802_11_BSSID_LIST_SCAN, NULL, 0); -+ if (res) { -+ WARNING("scanning failed (%08X)", res); -+ EXIT2(return -EOPNOTSUPP); -+ } -+ wnd->scan_timestamp = jiffies; -+ EXIT2(return 0); -+} -+ -+static int iw_set_scan(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ return set_scan(wnd); -+} -+ -+static int iw_get_scan(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ unsigned int i, buf_len, needed, data_len; -+ NDIS_STATUS res; -+ struct ndis_bssid_list *bssid_list = NULL; -+ char *event = extra; -+ struct ndis_wlan_bssid *cur_item; -+ -+ ENTER2(""); -+ if (time_before(jiffies, wnd->scan_timestamp + 3 * HZ)) -+ return -EAGAIN; -+ /* try with space for a few scan items */ -+ buf_len = sizeof(ULONG) + offsetof(struct ndis_wlan_bssid_ex, var) * 8; -+ -+ /* Try many times, as the needed space may grow between queries */ -+ for (i = 0; i < 10; i++) { -+ bssid_list = kzalloc(buf_len, GFP_KERNEL); -+ if (!bssid_list) { -+ ERROR("couldn't allocate %u bytes for scan results", -+ buf_len); -+ return -ENOMEM; -+ } -+ -+ needed = 0; -+ data_len = 0; -+ res = mp_query_info(wnd, OID_802_11_BSSID_LIST, bssid_list, -+ buf_len, &data_len, &needed); -+ TRACE2("try %d: given %d bytes, needed %d, written %d", -+ i, buf_len, needed, data_len); -+ if (needed <= buf_len) -+ break; -+ kfree(bssid_list); -+ buf_len = needed; -+ } -+ if (res) { -+ WARNING("getting BSSID list failed (%08X)", res); -+ kfree(bssid_list); -+ EXIT2(return -EOPNOTSUPP); -+ } -+ -+ /* some drivers don't set bssid_list->num_items to 0 if -+ OID_802_11_BSSID_LIST returns no items (prism54 driver, e.g.,) */ -+ TRACE2("items: %d", bssid_list->num_items); -+ cur_item = &bssid_list->bssid[0]; -+ for (i = 0; i < bssid_list->num_items; i++) { -+ TRACE2("item %d: len %d, remaining data %d", -+ i, cur_item->length, data_len); -+ /* drop truncated items */ -+ if (cur_item->length > data_len) -+ break; -+ event = ndis_translate_scan(dev, info, event, -+ extra + wrqu->data.length, -+ cur_item); -+ if (!event) { -+ kfree(bssid_list); -+ return -E2BIG; -+ } -+ data_len -= cur_item->length; -+ cur_item = (struct ndis_wlan_bssid *)((char *)cur_item + -+ cur_item->length); -+ } -+ wrqu->data.length = event - extra; -+ wrqu->data.flags = 0; -+ kfree(bssid_list); -+ EXIT2(return 0); -+} -+ -+static int iw_set_power_mode(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ NDIS_STATUS res; -+ enum ndis_power power_mode; -+ -+ if (wrqu->power.disabled == 1) -+ power_mode = NDIS_POWER_OFF; -+ else if (wrqu->power.flags & IW_POWER_MIN) -+ power_mode = NDIS_POWER_MIN; -+ else // if (wrqu->power.flags & IW_POWER_MAX) -+ power_mode = NDIS_POWER_MAX; -+ -+ TRACE2("%d", power_mode); -+ res = mp_set(wnd, OID_802_11_POWER_MODE, -+ &power_mode, sizeof(power_mode)); -+ if (res) -+ WARNING("setting power mode failed (%08X)", res); -+ return 0; -+} -+ -+static int iw_get_power_mode(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ NDIS_STATUS res; -+ enum ndis_power power_mode; -+ -+ ENTER2(""); -+ res = mp_query(wnd, OID_802_11_POWER_MODE, -+ &power_mode, sizeof(power_mode)); -+ if (res) -+ return -ENOTSUPP; -+ -+ if (power_mode == NDIS_POWER_OFF) -+ wrqu->power.disabled = 1; -+ else { -+ if (wrqu->power.flags != 0) -+ return 0; -+ wrqu->power.flags |= IW_POWER_ALL_R; -+ wrqu->power.flags |= IW_POWER_TIMEOUT; -+ wrqu->power.value = 0; -+ wrqu->power.disabled = 0; -+ -+ if (power_mode == NDIS_POWER_MIN) -+ wrqu->power.flags |= IW_POWER_MIN; -+ else // if (power_mode == NDIS_POWER_MAX) -+ wrqu->power.flags |= IW_POWER_MAX; -+ } -+ return 0; -+} -+ -+static int iw_get_sensitivity(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ NDIS_STATUS res; -+ ndis_rssi rssi_trigger; -+ -+ ENTER2(""); -+ res = mp_query(wnd, OID_802_11_RSSI_TRIGGER, -+ &rssi_trigger, sizeof(rssi_trigger)); -+ if (res) -+ return -EOPNOTSUPP; -+ wrqu->param.value = rssi_trigger; -+ wrqu->param.disabled = (rssi_trigger == 0); -+ wrqu->param.fixed = 1; -+ return 0; -+} -+ -+static int iw_set_sensitivity(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ NDIS_STATUS res; -+ ndis_rssi rssi_trigger; -+ -+ ENTER2(""); -+ if (wrqu->param.disabled) -+ rssi_trigger = 0; -+ else -+ rssi_trigger = wrqu->param.value; -+ res = mp_set(wnd, OID_802_11_RSSI_TRIGGER, -+ &rssi_trigger, sizeof(rssi_trigger)); -+ if (res == NDIS_STATUS_INVALID_DATA) -+ return -EINVAL; -+ if (res) -+ return -EOPNOTSUPP; -+ return 0; -+} -+ -+static int iw_get_ndis_stats(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ struct iw_statistics *stats = &wnd->iw_stats; -+ memcpy(&wrqu->qual, &stats->qual, sizeof(stats->qual)); -+ return 0; -+} -+ -+static int iw_get_range(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct iw_range *range = (struct iw_range *)extra; -+ struct iw_point *data = &wrqu->data; -+ struct ndis_device *wnd = netdev_priv(dev); -+ unsigned int i, n; -+ NDIS_STATUS res; -+ UCHAR rates[NDIS_MAX_RATES_EX]; -+ ndis_tx_power_level tx_power; -+ -+ ENTER2(""); -+ data->length = sizeof(struct iw_range); -+ memset(range, 0, sizeof(struct iw_range)); -+ -+ range->txpower_capa = IW_TXPOW_MWATT; -+ range->num_txpower = 0; -+ -+ res = mp_query(wnd, OID_802_11_TX_POWER_LEVEL, -+ &tx_power, sizeof(tx_power)); -+ if (!res) { -+ range->num_txpower = 1; -+ range->txpower[0] = tx_power; -+ } -+ -+ range->we_version_compiled = WIRELESS_EXT; -+ range->we_version_source = 19; -+ -+ range->retry_capa = IW_RETRY_LIMIT; -+ range->retry_flags = IW_RETRY_LIMIT; -+ range->min_retry = 0; -+ range->max_retry = 255; -+ -+ range->num_channels = 1; -+ -+ range->max_qual.qual = 100; -+ range->max_qual.level = 154; -+ range->max_qual.noise = 154; -+ range->sensitivity = 3; -+ -+ range->max_encoding_tokens = 4; -+ range->num_encoding_sizes = 2; -+ range->encoding_size[0] = 5; -+ range->encoding_size[1] = 13; -+ -+ range->num_bitrates = 0; -+ memset(&rates, 0, sizeof(rates)); -+ res = mp_query_info(wnd, OID_802_11_SUPPORTED_RATES, -+ &rates, sizeof(rates), &n, NULL); -+ if (res) -+ WARNING("getting bit rates failed: %08X", res); -+ else { -+ for (i = 0; i < n && range->num_bitrates < IW_MAX_BITRATES; i++) -+ if (rates[i] & 0x80) -+ continue; -+ else if (rates[i] & 0x7f) { -+ range->bitrate[range->num_bitrates] = -+ (rates[i] & 0x7f) * 500000; -+ range->num_bitrates++; -+ } -+ } -+ -+ range->num_channels = ARRAY_SIZE(freq_chan); -+ -+ for (i = 0; i < ARRAY_SIZE(freq_chan) && i < IW_MAX_FREQUENCIES; i++) { -+ range->freq[i].i = i + 1; -+ range->freq[i].m = freq_chan[i] * 100000; -+ range->freq[i].e = 1; -+ } -+ range->num_frequency = i; -+ -+ range->min_rts = 0; -+ range->max_rts = 2347; -+ range->min_frag = 256; -+ range->max_frag = 2346; -+ -+ /* Event capability (kernel + driver) */ -+ range->event_capa[0] = (IW_EVENT_CAPA_K_0 | -+ IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) | -+ IW_EVENT_CAPA_MASK(SIOCGIWAP) | -+ IW_EVENT_CAPA_MASK(SIOCGIWSCAN)); -+ range->event_capa[1] = IW_EVENT_CAPA_K_1; -+ range->event_capa[4] = (IW_EVENT_CAPA_MASK(IWEVTXDROP) | -+ IW_EVENT_CAPA_MASK(IWEVCUSTOM) | -+ IW_EVENT_CAPA_MASK(IWEVREGISTERED) | -+ IW_EVENT_CAPA_MASK(IWEVEXPIRED)); -+ -+ range->enc_capa = 0; -+ -+ if (test_bit(Ndis802_11Encryption2Enabled, &wnd->capa.encr)) -+ range->enc_capa |= IW_ENC_CAPA_CIPHER_TKIP; -+ if (test_bit(Ndis802_11Encryption3Enabled, &wnd->capa.encr)) -+ range->enc_capa |= IW_ENC_CAPA_CIPHER_CCMP; -+ -+ if (test_bit(Ndis802_11AuthModeWPA, &wnd->capa.auth) || -+ test_bit(Ndis802_11AuthModeWPAPSK, &wnd->capa.auth)) -+ range->enc_capa |= IW_ENC_CAPA_WPA; -+ if (test_bit(Ndis802_11AuthModeWPA2, &wnd->capa.auth) || -+ test_bit(Ndis802_11AuthModeWPA2PSK, &wnd->capa.auth)) -+ range->enc_capa |= IW_ENC_CAPA_WPA2; -+ -+ return 0; -+} -+ -+void set_default_iw_params(struct ndis_device *wnd) -+{ -+ wnd->iw_auth_key_mgmt = 0; -+ wnd->iw_auth_wpa_version = 0; -+ set_infra_mode(wnd, Ndis802_11Infrastructure); -+ set_ndis_auth_mode(wnd, Ndis802_11AuthModeOpen); -+ set_priv_filter(wnd); -+ set_iw_encr_mode(wnd, IW_AUTH_CIPHER_NONE, IW_AUTH_CIPHER_NONE); -+} -+ -+static int deauthenticate(struct ndis_device *wnd) -+{ -+ int ret; -+ -+ ENTER2(""); -+ ret = disassociate(wnd, 1); -+ set_default_iw_params(wnd); -+ EXIT2(return ret); -+} -+ -+NDIS_STATUS disassociate(struct ndis_device *wnd, int reset_ssid) -+{ -+ NDIS_STATUS res; -+ u8 buf[NDIS_ESSID_MAX_SIZE]; -+ int i; -+ -+ TRACE2(""); -+ res = mp_set(wnd, OID_802_11_DISASSOCIATE, NULL, 0); -+ /* disassociate causes radio to be turned off; if reset_ssid -+ * is given, set ssid to random to enable radio */ -+ if (reset_ssid) { -+ get_random_bytes(buf, sizeof(buf)); -+ for (i = 0; i < sizeof(buf); i++) -+ buf[i] = 'a' + (buf[i] % 26); -+ set_essid(wnd, buf, sizeof(buf)); -+ } -+ return res; -+} -+ -+static int iw_set_mlme(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ struct iw_mlme *mlme = (struct iw_mlme *)extra; -+ -+ ENTER2(""); -+ switch (mlme->cmd) { -+ case IW_MLME_DEAUTH: -+ return deauthenticate(wnd); -+ case IW_MLME_DISASSOC: -+ TRACE2("cmd=%d reason_code=%d", mlme->cmd, mlme->reason_code); -+ return disassociate(wnd, 1); -+ default: -+ return -EOPNOTSUPP; -+ } -+ -+ return 0; -+} -+ -+static int iw_set_genie(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ /* -+ * NDIS drivers do not allow IEs to be configured; this is -+ * done by the driver based on other configuration. Return 0 -+ * to avoid causing issues with user space programs that -+ * expect this function to succeed. -+ */ -+ return 0; -+} -+ -+static int iw_set_auth(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ TRACE2("index=%d value=%d", wrqu->param.flags & IW_AUTH_INDEX, -+ wrqu->param.value); -+ switch (wrqu->param.flags & IW_AUTH_INDEX) { -+ case IW_AUTH_WPA_VERSION: -+ wnd->iw_auth_wpa_version = wrqu->param.value; -+ break; -+ case IW_AUTH_CIPHER_PAIRWISE: -+ wnd->iw_auth_cipher_pairwise = wrqu->param.value; -+ break; -+ case IW_AUTH_CIPHER_GROUP: -+ wnd->iw_auth_cipher_group = wrqu->param.value; -+ break; -+ case IW_AUTH_KEY_MGMT: -+ wnd->iw_auth_key_mgmt = wrqu->param.value; -+ break; -+ case IW_AUTH_80211_AUTH_ALG: -+ wnd->iw_auth_80211_alg = wrqu->param.value; -+ break; -+ case IW_AUTH_WPA_ENABLED: -+ if (wrqu->param.value) -+ deauthenticate(wnd); -+ break; -+#ifdef IW_AUTH_MFP -+ case IW_AUTH_MFP: -+ if (wrqu->param.value == IW_AUTH_MFP_DISABLED || -+ wrqu->param.value == IW_AUTH_MFP_OPTIONAL) -+ break; -+ WARNING("MFP not implemented"); -+ return -EOPNOTSUPP; -+#endif -+ case IW_AUTH_TKIP_COUNTERMEASURES: -+ case IW_AUTH_DROP_UNENCRYPTED: -+ case IW_AUTH_RX_UNENCRYPTED_EAPOL: -+ case IW_AUTH_PRIVACY_INVOKED: -+ TRACE2("%d not implemented: %d", -+ wrqu->param.flags & IW_AUTH_INDEX, wrqu->param.value); -+ break; -+ default: -+ WARNING("invalid cmd %d", wrqu->param.flags & IW_AUTH_INDEX); -+ return -EOPNOTSUPP; -+ } -+ return 0; -+} -+ -+static int iw_get_auth(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ -+ ENTER2("index=%d", wrqu->param.flags & IW_AUTH_INDEX); -+ switch (wrqu->param.flags & IW_AUTH_INDEX) { -+ case IW_AUTH_WPA_VERSION: -+ wrqu->param.value = wnd->iw_auth_wpa_version; -+ break; -+ case IW_AUTH_CIPHER_PAIRWISE: -+ wrqu->param.value = wnd->iw_auth_cipher_pairwise; -+ break; -+ case IW_AUTH_CIPHER_GROUP: -+ wrqu->param.value = wnd->iw_auth_cipher_group; -+ break; -+ case IW_AUTH_KEY_MGMT: -+ wrqu->param.value = wnd->iw_auth_key_mgmt; -+ break; -+ case IW_AUTH_80211_AUTH_ALG: -+ wrqu->param.value = wnd->iw_auth_80211_alg; -+ break; -+ default: -+ WARNING("invalid cmd %d", wrqu->param.flags & IW_AUTH_INDEX); -+ return -EOPNOTSUPP; -+ } -+ return 0; -+} -+ -+static int iw_set_encodeext(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct iw_encode_ext *ext = (struct iw_encode_ext *)extra; -+ struct ndis_device *wnd = netdev_priv(dev); -+ struct ndis_add_key ndis_key; -+ int i, keyidx; -+ NDIS_STATUS res; -+ u8 *addr; -+ -+ keyidx = wrqu->encoding.flags & IW_ENCODE_INDEX; -+ ENTER2("%d", keyidx); -+ if (keyidx) -+ keyidx--; -+ else -+ keyidx = wnd->encr_info.tx_key_index; -+ -+ if (keyidx < 0 || keyidx >= MAX_ENCR_KEYS) -+ return -EINVAL; -+ -+ if (ext->alg == WPA_ALG_WEP) { -+ if (!test_bit(Ndis802_11Encryption1Enabled, &wnd->capa.encr)) -+ EXIT2(return -1); -+ if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) -+ wnd->encr_info.tx_key_index = keyidx; -+ if (add_wep_key(wnd, ext->key, ext->key_len, keyidx)) -+ EXIT2(return -1); -+ else -+ EXIT2(return 0); -+ } -+ if ((wrqu->encoding.flags & IW_ENCODE_DISABLED) || -+ ext->alg == IW_ENCODE_ALG_NONE || ext->key_len == 0) -+ EXIT2(return remove_key(wnd, keyidx, ndis_key.bssid)); -+ -+ if (ext->key_len > sizeof(ndis_key.key)) { -+ TRACE2("incorrect key length (%u)", ext->key_len); -+ EXIT2(return -1); -+ } -+ -+ memset(&ndis_key, 0, sizeof(ndis_key)); -+ -+ ndis_key.struct_size = -+ sizeof(ndis_key) - sizeof(ndis_key.key) + ext->key_len; -+ ndis_key.length = ext->key_len; -+ ndis_key.index = keyidx; -+ -+ if (ext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) { -+ for (i = 0; i < 6; i++) -+ ndis_key.rsc |= (((u64)ext->rx_seq[i]) << (i * 8)); -+ TRACE2("0x%llx", ndis_key.rsc); -+ ndis_key.index |= 1 << 29; -+ } -+ -+ addr = ext->addr.sa_data; -+ if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) { -+ /* group key */ -+ if (wnd->infrastructure_mode == Ndis802_11IBSS) -+ memset(ndis_key.bssid, 0xff, ETH_ALEN); -+ else -+ get_ap_address(wnd, ndis_key.bssid); -+ } else { -+ /* pairwise key */ -+ ndis_key.index |= (1 << 30); -+ memcpy(ndis_key.bssid, addr, ETH_ALEN); -+ } -+ TRACE2(MACSTRSEP, MAC2STR(ndis_key.bssid)); -+ -+ if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) -+ ndis_key.index |= (1 << 31); -+ -+ if (ext->alg == IW_ENCODE_ALG_TKIP && ext->key_len == 32) { -+ /* wpa_supplicant gives us the Michael MIC RX/TX keys in -+ * different order than NDIS spec, so swap the order here. */ -+ memcpy(ndis_key.key, ext->key, 16); -+ memcpy(ndis_key.key + 16, ext->key + 24, 8); -+ memcpy(ndis_key.key + 24, ext->key + 16, 8); -+ } else -+ memcpy(ndis_key.key, ext->key, ext->key_len); -+ -+ res = mp_set(wnd, OID_802_11_ADD_KEY, &ndis_key, ndis_key.struct_size); -+ if (res) { -+ TRACE2("adding key failed (%08X), %u", -+ res, ndis_key.struct_size); -+ EXIT2(return -1); -+ } -+ wnd->encr_info.keys[keyidx].length = ext->key_len; -+ memcpy(&wnd->encr_info.keys[keyidx].key, ndis_key.key, ext->key_len); -+ if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) -+ wnd->encr_info.tx_key_index = keyidx; -+ TRACE2("key %d added", keyidx); -+ -+ EXIT2(return 0); -+} -+ -+static int iw_get_encodeext(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ /* struct iw_encode_ext *ext = (struct iw_encode_ext *) extra; */ -+ /* TODO */ -+ ENTER2(""); -+ return 0; -+} -+ -+static int iw_set_pmksa(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct iw_pmksa *pmksa = (struct iw_pmksa *)extra; -+ struct ndis_pmkid pmkid; -+ NDIS_STATUS res; -+ struct ndis_device *wnd = netdev_priv(dev); -+ -+ /* TODO: must keep local list of PMKIDs since NDIS drivers -+ * expect that all PMKID entries are included whenever a new -+ * one is added. */ -+ -+ ENTER2("%d", pmksa->cmd); -+ if ((pmksa->cmd == IW_PMKSA_ADD || pmksa->cmd == IW_PMKSA_REMOVE) && -+ (!(wnd->iw_auth_wpa_version & IW_AUTH_WPA_VERSION_WPA2))) -+ EXIT2(return -EOPNOTSUPP); -+ -+ memset(&pmkid, 0, sizeof(pmkid)); -+ if (pmksa->cmd == IW_PMKSA_ADD) { -+ pmkid.bssid_info_count = 1; -+ memcpy(pmkid.bssid_info[0].bssid, pmksa->bssid.sa_data, -+ ETH_ALEN); -+ memcpy(pmkid.bssid_info[0].pmkid, pmksa->pmkid, IW_PMKID_LEN); -+ } -+ pmkid.length = sizeof(pmkid); -+ -+ res = mp_set(wnd, OID_802_11_PMKID, &pmkid, pmkid.length); -+ if (res == NDIS_STATUS_FAILURE) -+ EXIT2(return -EOPNOTSUPP); -+ TRACE2("OID_802_11_PMKID -> %d", res); -+ if (res) -+ return -EINVAL; -+ -+ return 0; -+} -+ -+#define WEXT(id) [id - SIOCIWFIRST] -+ -+static const iw_handler ndis_handler[] = { -+ WEXT(SIOCGIWNAME) = iw_get_network_type, -+ WEXT(SIOCSIWESSID) = iw_set_essid, -+ WEXT(SIOCGIWESSID) = iw_get_essid, -+ WEXT(SIOCSIWMODE) = iw_set_infra_mode, -+ WEXT(SIOCGIWMODE) = iw_get_infra_mode, -+ WEXT(SIOCGIWFREQ) = iw_get_freq, -+ WEXT(SIOCSIWFREQ) = iw_set_freq, -+ WEXT(SIOCGIWTXPOW) = iw_get_tx_power, -+ WEXT(SIOCSIWTXPOW) = iw_set_tx_power, -+ WEXT(SIOCGIWRATE) = iw_get_bitrate, -+ WEXT(SIOCSIWRATE) = iw_set_bitrate, -+ WEXT(SIOCGIWRTS) = iw_get_rts_threshold, -+ WEXT(SIOCSIWRTS) = iw_set_rts_threshold, -+ WEXT(SIOCGIWFRAG) = iw_get_frag_threshold, -+ WEXT(SIOCSIWFRAG) = iw_set_frag_threshold, -+ WEXT(SIOCGIWAP) = iw_get_ap_address, -+ WEXT(SIOCSIWAP) = iw_set_ap_address, -+ WEXT(SIOCSIWENCODE) = iw_set_wep, -+ WEXT(SIOCGIWENCODE) = iw_get_encr, -+ WEXT(SIOCSIWSCAN) = iw_set_scan, -+ WEXT(SIOCGIWSCAN) = iw_get_scan, -+ WEXT(SIOCGIWPOWER) = iw_get_power_mode, -+ WEXT(SIOCSIWPOWER) = iw_set_power_mode, -+ WEXT(SIOCGIWRANGE) = iw_get_range, -+ WEXT(SIOCGIWSTATS) = iw_get_ndis_stats, -+ WEXT(SIOCGIWSENS) = iw_get_sensitivity, -+ WEXT(SIOCSIWSENS) = iw_set_sensitivity, -+ WEXT(SIOCGIWNICKN) = iw_get_nick, -+ WEXT(SIOCSIWNICKN) = iw_set_nick, -+ WEXT(SIOCSIWCOMMIT) = iw_set_dummy, -+ WEXT(SIOCSIWMLME) = iw_set_mlme, -+ WEXT(SIOCSIWGENIE) = iw_set_genie, -+ WEXT(SIOCSIWAUTH) = iw_set_auth, -+ WEXT(SIOCGIWAUTH) = iw_get_auth, -+ WEXT(SIOCSIWENCODEEXT) = iw_set_encodeext, -+ WEXT(SIOCGIWENCODEEXT) = iw_get_encodeext, -+ WEXT(SIOCSIWPMKSA) = iw_set_pmksa, -+}; -+ -+/* private ioctl's */ -+ -+static int priv_reset(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int res; -+ ENTER2(""); -+ res = mp_reset(netdev_priv(dev)); -+ if (res) { -+ WARNING("reset failed: %08X", res); -+ return -EOPNOTSUPP; -+ } -+ return 0; -+} -+ -+static int priv_deauthenticate(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int res; -+ ENTER2(""); -+ res = deauthenticate(netdev_priv(dev)); -+ return res; -+} -+ -+static int priv_power_profile(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ struct miniport *mp; -+ ULONG profile_inf; -+ -+ ENTER2(""); -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ if (!mp->pnp_event_notify) -+ EXIT2(return -EOPNOTSUPP); -+ -+ /* 1 for AC and 0 for Battery */ -+ if (wrqu->param.value) -+ profile_inf = NdisPowerProfileAcOnLine; -+ else -+ profile_inf = NdisPowerProfileBattery; -+ -+ LIN2WIN4(mp->pnp_event_notify, wnd->nmb->mp_ctx, -+ NdisDevicePnPEventPowerProfileChanged, -+ &profile_inf, sizeof(profile_inf)); -+ EXIT2(return 0); -+} -+ -+static int priv_network_type(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ enum network_type network_type; -+ NDIS_STATUS res; -+ char type; -+ -+ ENTER2(""); -+ type = wrqu->param.value; -+ if (type == 'f') -+ network_type = Ndis802_11FH; -+ else if (type == 'b') -+ network_type = Ndis802_11DS; -+ else if (type == 'a') -+ network_type = Ndis802_11OFDM5; -+ else if (type == 'g' || type == 'n') -+ network_type = Ndis802_11OFDM24; -+ else -+ network_type = Ndis802_11Automode; -+ -+ res = mp_set_int(wnd, OID_802_11_NETWORK_TYPE_IN_USE, network_type); -+ if (res) { -+ WARNING("setting network type to %d failed (%08X)", -+ network_type, res); -+ EXIT2(return -EINVAL); -+ } -+ -+ EXIT2(return 0); -+} -+ -+static int priv_media_stream_mode(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ NDIS_STATUS res; -+ int mode; -+ -+ ENTER2(""); -+ if (wrqu->param.value > 0) -+ mode = Ndis802_11MediaStreamOn; -+ else -+ mode = Ndis802_11MediaStreamOff; -+ res = mp_set_int(wnd, OID_802_11_MEDIA_STREAM_MODE, mode); -+ if (res) { -+ WARNING("oid failed (%08X)", res); -+ EXIT2(return -EINVAL); -+ } -+ EXIT2(return 0); -+} -+ -+static int priv_reload_defaults(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ int res; -+ ENTER2(""); -+ res = mp_set_int(wnd, OID_802_11_RELOAD_DEFAULTS, -+ Ndis802_11ReloadWEPKeys); -+ if (res) { -+ WARNING("reloading defaults failed: %08X", res); -+ return -EOPNOTSUPP; -+ } -+ return 0; -+} -+ -+static const struct iw_priv_args priv_args[] = { -+ {PRIV_RESET, 0, 0, "ndis_reset"}, -+ {PRIV_POWER_PROFILE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, -+ "power_profile"}, -+ {PRIV_DEAUTHENTICATE, 0, 0, "deauthenticate"}, -+ {PRIV_NETWORK_TYPE, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 1, 0, -+ "network_type"}, -+ {PRIV_MEDIA_STREAM_MODE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, -+ "media_stream"}, -+ -+ {PRIV_RELOAD_DEFAULTS, 0, 0, "reload_defaults"}, -+}; -+ -+#define WEPRIV(id) [id - SIOCIWFIRSTPRIV] -+ -+static const iw_handler priv_handler[] = { -+ WEPRIV(PRIV_RESET) = priv_reset, -+ WEPRIV(PRIV_POWER_PROFILE) = priv_power_profile, -+ WEPRIV(PRIV_DEAUTHENTICATE) = priv_deauthenticate, -+ WEPRIV(PRIV_NETWORK_TYPE) = priv_network_type, -+ WEPRIV(PRIV_MEDIA_STREAM_MODE) = priv_media_stream_mode, -+ WEPRIV(PRIV_RELOAD_DEFAULTS) = priv_reload_defaults, -+}; -+ -+const struct iw_handler_def ndis_handler_def = { -+ .num_standard = ARRAY_SIZE(ndis_handler), -+ .num_private = ARRAY_SIZE(priv_handler), -+ .num_private_args = ARRAY_SIZE(priv_args), -+ -+ .standard = (iw_handler *)ndis_handler, -+ .private = (iw_handler *)priv_handler, -+ .private_args = (struct iw_priv_args *)priv_args, -+ .get_wireless_stats = get_iw_stats, -+}; -+ -+#endif -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/iw_ndis.h linux-4.12.4-3rd/3rdparty/ndiswrapper/iw_ndis.h ---- linux-4.12.4/3rdparty/ndiswrapper/iw_ndis.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/iw_ndis.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,194 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifndef _IW_NDIS_H_ -+#define _IW_NDIS_H_ -+ -+#include "ndis.h" -+ -+#define WL_NOISE -96 /* typical noise level in dBm */ -+#define WL_SIGMAX -32 /* typical maximum signal level in dBm */ -+ -+struct ndis_encr_key { -+ ULONG struct_size; -+ ULONG index; -+ ULONG length; -+ UCHAR key[NDIS_ENCODING_TOKEN_MAX]; -+}; -+ -+struct ndis_add_key { -+ ULONG struct_size; -+ ndis_key_index index; -+ ULONG length; -+ mac_address bssid; -+ UCHAR pad[6]; -+ ndis_key_rsc rsc; -+ UCHAR key[NDIS_ENCODING_TOKEN_MAX]; -+}; -+ -+struct ndis_remove_key { -+ ULONG struct_size; -+ ndis_key_index index; -+ mac_address bssid; -+}; -+ -+struct ndis_fixed_ies { -+ UCHAR time_stamp[8]; -+ USHORT beacon_interval; -+ USHORT capa; -+}; -+ -+struct ndis_variable_ies { -+ UCHAR elem_id; -+ UCHAR length; -+ UCHAR data[]; -+}; -+ -+enum ndis_reload_defaults { Ndis802_11ReloadWEPKeys }; -+ -+struct ndis_assoc_info { -+ ULONG length; -+ USHORT req_ies; -+ struct req_ie { -+ USHORT capa; -+ USHORT listen_interval; -+ mac_address cur_ap_address; -+ } req_ie; -+ ULONG req_ie_length; -+ ULONG offset_req_ies; -+ USHORT resp_ies; -+ struct resp_ie { -+ USHORT capa; -+ USHORT status_code; -+ USHORT assoc_id; -+ } resp_ie; -+ ULONG resp_ie_length; -+ ULONG offset_resp_ies; -+}; -+ -+struct ndis_configuration_fh { -+ ULONG length; -+ ULONG hop_pattern; -+ ULONG hop_set; -+ ULONG dwell_time; -+}; -+ -+struct ndis_configuration { -+ ULONG length; -+ ULONG beacon_period; -+ ULONG atim_window; -+ ULONG ds_config; -+ struct ndis_configuration_fh fh_config; -+}; -+ -+struct ndis_wlan_bssid { -+ ULONG length; -+ mac_address mac; -+ UCHAR reserved[2]; -+ struct ndis_essid ssid; -+ ULONG privacy; -+ ndis_rssi rssi; -+ UINT net_type; -+ struct ndis_configuration config; -+ UINT mode; -+ UCHAR rates[NDIS_MAX_RATES]; -+}; -+ -+struct ndis_wlan_bssid_ex { -+ ULONG length; -+ mac_address mac; -+ UCHAR reserved[2]; -+ struct ndis_essid ssid; -+ ULONG privacy; -+ ndis_rssi rssi; -+ UINT net_type; -+ struct ndis_configuration config; -+ UINT mode; -+ UCHAR rates_ex[NDIS_MAX_RATES_EX]; -+ ULONG ie_length; -+ struct ndis_fixed_ies fixed; -+ struct ndis_variable_ies var[]; -+}; -+ -+/* we use bssid_list as bssid_list_ex also */ -+struct ndis_bssid_list { -+ ULONG num_items; -+ struct ndis_wlan_bssid bssid[1]; -+}; -+ -+enum ndis_priv_filter { -+ Ndis802_11PrivFilterAcceptAll, Ndis802_11PrivFilter8021xWEP -+}; -+ -+enum network_type { -+ Ndis802_11FH, Ndis802_11DS, Ndis802_11OFDM5, Ndis802_11OFDM24, -+ /* MSDN site uses Ndis802_11Automode, which is not mentioned -+ * in DDK, so add one and assign it to -+ * Ndis802_11NetworkTypeMax */ -+ Ndis802_11Automode, Ndis802_11NetworkTypeMax = Ndis802_11Automode -+}; -+ -+struct network_type_list { -+ ULONG num; -+ enum network_type types[1]; -+}; -+ -+enum ndis_power { -+ NDIS_POWER_OFF = 0, NDIS_POWER_MAX, NDIS_POWER_MIN, -+}; -+ -+struct ndis_auth_req { -+ ULONG length; -+ mac_address bssid; -+ ULONG flags; -+}; -+ -+struct ndis_bssid_info { -+ mac_address bssid; -+ UCHAR pmkid[IW_PMKID_LEN]; -+}; -+ -+struct ndis_pmkid { -+ ULONG length; -+ ULONG bssid_info_count; -+ struct ndis_bssid_info bssid_info[1]; -+}; -+ -+int get_ap_address(struct ndis_device *wnd, mac_address mac); -+int set_ndis_auth_mode(struct ndis_device *wnd, ULONG auth_mode); -+int get_ndis_encr_mode(struct ndis_device *wnd); -+int set_iw_encr_mode(struct ndis_device *wnd, int cipher_pairwise, -+ int cipher_groupwise); -+int get_ndis_auth_mode(struct ndis_device *wnd); -+NDIS_STATUS disassociate(struct ndis_device *wnd, int reset_ssid); -+void set_default_iw_params(struct ndis_device *wnd); -+extern const struct iw_handler_def ndis_handler_def; -+ -+#define PRIV_RESET SIOCIWFIRSTPRIV+16 -+#define PRIV_POWER_PROFILE SIOCIWFIRSTPRIV+17 -+#define PRIV_NETWORK_TYPE SIOCIWFIRSTPRIV+18 -+#define PRIV_DEAUTHENTICATE SIOCIWFIRSTPRIV+19 -+#define PRIV_MEDIA_STREAM_MODE SIOCIWFIRSTPRIV+20 -+#define PRIV_RELOAD_DEFAULTS SIOCIWFIRSTPRIV+23 -+ -+/* these have to match what is in wpa_supplicant */ -+ -+enum wpa_alg { WPA_ALG_NONE, WPA_ALG_WEP, WPA_ALG_TKIP, WPA_ALG_CCMP }; -+enum wpa_cipher { CIPHER_NONE, CIPHER_WEP40, CIPHER_TKIP, CIPHER_CCMP, -+ CIPHER_WEP104 }; -+enum wpa_key_mgmt { KEY_MGMT_802_1X, KEY_MGMT_PSK, KEY_MGMT_NONE, -+ KEY_MGMT_802_1X_NO_WPA, KEY_MGMT_WPA_NONE }; -+ -+#endif // IW_NDIS_H -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/lin2win.h linux-4.12.4-3rd/3rdparty/ndiswrapper/lin2win.h ---- linux-4.12.4/3rdparty/ndiswrapper/lin2win.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/lin2win.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,111 @@ -+/* -+ * Copyright (C) 2006 Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifdef CONFIG_X86_64 -+ -+u64 lin2win0(void *func); -+u64 lin2win1(void *func, u64 arg1); -+u64 lin2win2(void *func, u64 arg1, u64 arg2); -+u64 lin2win3(void *func, u64 arg1, u64 arg2, u64 arg3); -+u64 lin2win4(void *func, u64 arg1, u64 arg2, u64 arg3, u64 arg4); -+u64 lin2win5(void *func, u64 arg1, u64 arg2, u64 arg3, u64 arg4, u64 arg5); -+u64 lin2win6(void *func, u64 arg1, u64 arg2, u64 arg3, u64 arg4, u64 arg5, -+ u64 arg6); -+ -+#define LIN2WIN0(func) \ -+({ \ -+ if (0) \ -+ func(); \ -+ lin2win0(func); \ -+}) -+ -+#define LIN2WIN1(func, arg1) \ -+({ \ -+ if (0) \ -+ func(arg1); \ -+ lin2win1(func, (u64)arg1); \ -+}) -+ -+#define LIN2WIN2(func, arg1, arg2) \ -+({ \ -+ if (0) \ -+ func(arg1, arg2); \ -+ lin2win2(func, (u64)arg1, (u64)arg2); \ -+}) -+ -+#define LIN2WIN3(func, arg1, arg2, arg3) \ -+({ \ -+ if (0) \ -+ func(arg1, arg2, arg3); \ -+ lin2win3(func, (u64)arg1, (u64)arg2, (u64)arg3); \ -+}) -+ -+#define LIN2WIN4(func, arg1, arg2, arg3, arg4) \ -+({ \ -+ if (0) \ -+ func(arg1, arg2, arg3, arg4); \ -+ lin2win4(func, (u64)arg1, (u64)arg2, (u64)arg3, (u64)arg4); \ -+}) -+ -+#define LIN2WIN5(func, arg1, arg2, arg3, arg4, arg5) \ -+({ \ -+ if (0) \ -+ func(arg1, arg2, arg3, arg4, arg5); \ -+ lin2win5(func, (u64)arg1, (u64)arg2, (u64)arg3, (u64)arg4, \ -+ (u64)arg5); \ -+}) -+ -+#define LIN2WIN6(func, arg1, arg2, arg3, arg4, arg5, arg6) \ -+({ \ -+ if (0) \ -+ func(arg1, arg2, arg3, arg4, arg5, arg6); \ -+ lin2win6(func, (u64)arg1, (u64)arg2, (u64)arg3, (u64)arg4, \ -+ (u64)arg5, (u64)arg6); \ -+}) -+ -+#else // CONFIG_X86_64 -+ -+#define LIN2WIN1(func, arg1) \ -+({ \ -+ TRACE6("calling %p", func); \ -+ func(arg1); \ -+}) -+#define LIN2WIN2(func, arg1, arg2) \ -+({ \ -+ TRACE6("calling %p", func); \ -+ func(arg1, arg2); \ -+}) -+#define LIN2WIN3(func, arg1, arg2, arg3) \ -+({ \ -+ TRACE6("calling %p", func); \ -+ func(arg1, arg2, arg3); \ -+}) -+#define LIN2WIN4(func, arg1, arg2, arg3, arg4) \ -+({ \ -+ TRACE6("calling %p", func); \ -+ func(arg1, arg2, arg3, arg4); \ -+}) -+#define LIN2WIN5(func, arg1, arg2, arg3, arg4, arg5) \ -+({ \ -+ TRACE6("calling %p", func); \ -+ func(arg1, arg2, arg3, arg4, arg5); \ -+}) -+#define LIN2WIN6(func, arg1, arg2, arg3, arg4, arg5, arg6) \ -+({ \ -+ TRACE6("calling %p", func); \ -+ func(arg1, arg2, arg3, arg4, arg5, arg6); \ -+}) -+ -+#endif // CONFIG_X86_64 -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/lin2win.S linux-4.12.4-3rd/3rdparty/ndiswrapper/lin2win.S ---- linux-4.12.4/3rdparty/ndiswrapper/lin2win.S 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/lin2win.S 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,138 @@ -+/* -+ * Copyright (C) 2011 Pavel Roskin -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include -+ -+ .text -+ -+#define WORD_BYTES 8 -+#define LINUX_REG_ARGS 6 -+#define WINDOWS_REG_ARGS 4 -+ -+/* %rbp is saved to create a stack frame, which can help with debugging */ -+#define SAVED_REGS 1 -+ -+/* -+ * When calling a Windows function, stack space is allocated for at least 4 -+ * arguments even if the number of arguments is less than 4. The value of -+ * true is -1 in assembler, so we multiply it by another true value. -+ */ -+#define stack_args(argc) \ -+ (WINDOWS_REG_ARGS + \ -+ (0 < 1) * (argc > WINDOWS_REG_ARGS) * (argc - WINDOWS_REG_ARGS)) -+ -+/* Full required change of stack pointer, in words */ -+#define stack_words_raw(argc) (stack_args(argc) + SAVED_REGS + 1) -+ -+/* Full actual change of stack pointer, in words (must be even) */ -+#define stack_words_aligned(argc) ((stack_words_raw(argc) + 1) & ~1) -+ -+/* Space allocated for Linux arguments on stack */ -+#define stack_space(argc) \ -+ ((stack_words_aligned(argc) - SAVED_REGS - 1) * WORD_BYTES) -+ -+/* -+ * lin2win_win_arg(N) gives the address of the Nth Windows argument on our -+ * stack frame. %rsp points to the first argument. The Nth argument is -+ * therefore at ((N - 1) * 8)(%rsp). -+ * -+ * Don't call with N less than 5! -+ */ -+#define lin2win_win_arg(n) ((n - 1) * WORD_BYTES)(%rsp) -+ -+/* -+ * lin2win_lin_arg(N, ARGC) gives the address of the Nth Linux argument after -+ * the stack has been prepared for a Windows function call with ARGC arguments. -+ * -+ * When called from Linux, the Nth argument is at ((N - 6) * 8)(%rsp). We add -+ * the allocated stack space and saved registers to compensate for %rsp change. -+ * -+ * Don't call with N less than 7! -+ */ -+#define lin2win_lin_arg(n, argc) \ -+ (stack_space(argc) + \ -+ (SAVED_REGS + n - LINUX_REG_ARGS) * WORD_BYTES)(%rsp) -+ -+/* -+ * lin2win(func, winarg1, winarg2, ...) -+ * Call Windows FUNC function with ARGC arguments WINARG1, WINARG2, ... -+ * We get (ARGC + 1) arguments. -+ */ -+.macro lin2win name, argc -+ .type \name, @function -+ ENTRY(\name) -+ -+ /* Create a call frame - it's optional, but good for debugging */ -+ .cfi_startproc -+ push %rbp -+ .cfi_def_cfa %rsp, 2 * WORD_BYTES -+ .cfi_offset %rbp, -2 * WORD_BYTES -+ mov %rsp, %rbp -+ .cfi_def_cfa %rbp, 2 * WORD_BYTES -+ -+ /* Allocate space for Windows arguments */ -+ sub $stack_space(\argc), %rsp -+ -+ /* arg7 to winarg6 */ -+ .if (\argc >= 6) -+ mov lin2win_lin_arg(7, \argc), %r11 -+ mov %r11, lin2win_win_arg(6) -+ .endif -+ -+ /* arg6 to winarg5 */ -+ .if (\argc >= 5) -+ mov %r9, lin2win_win_arg(5) -+ .endif -+ -+ /* arg5 to winarg4 */ -+ .if (\argc >= 4) -+ mov %r8, %r9 -+ .endif -+ -+ /* arg4 to winarg3 */ -+ .if (\argc >= 3) -+ mov %rcx, %r8 -+ .endif -+ -+ /* arg3 to winarg2 - nothing needed, both are in %rdx */ -+ -+ /* arg2 to winarg1 */ -+ .if (\argc >= 1) -+ mov %rsi, %rcx -+ .endif -+ -+ /* Call function (arg1) */ -+ call *%rdi -+ -+ /* Reclaim space for Windows arguments */ -+ add $stack_space(\argc), %rsp -+ -+ /* Return to the caller */ -+ leave -+ .cfi_def_cfa %rsp, WORD_BYTES -+ .cfi_restore %rbp -+ ret -+ .cfi_endproc -+ .size \name, (. - \name) -+.endm -+ -+/* Define lin2winN functions */ -+lin2win lin2win0, 0 -+lin2win lin2win1, 1 -+lin2win lin2win2, 2 -+lin2win lin2win3, 3 -+lin2win lin2win4, 4 -+lin2win lin2win5, 5 -+lin2win lin2win6, 6 -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/loader.c linux-4.12.4-3rd/3rdparty/ndiswrapper/loader.c ---- linux-4.12.4/3rdparty/ndiswrapper/loader.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/loader.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,967 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include "ndis.h" -+#include "loader.h" -+#include "wrapndis.h" -+#include "pnp.h" -+ -+#include -+#include -+#include -+#include -+ -+/* -+ Network adapter: ClassGuid = {4d36e972-e325-11ce-bfc1-08002be10318} -+ Network client: ClassGuid = {4d36e973-e325-11ce-bfc1-08002be10318} -+ PCMCIA adapter: ClassGuid = {4d36e977-e325-11ce-bfc1-08002be10318} -+ USB: ClassGuid = {36fc9e60-c465-11cf-8056-444553540000} -+*/ -+ -+/* the indices used here must match macros WRAP_NDIS_DEVICE etc. */ -+static struct guid class_guids[] = { -+ /* Network */ -+ { .data1 = 0x4d36e972, .data2 = 0xe325, .data3 = 0x11ce }, -+ /* USB WDM */ -+ { .data1 = 0x36fc9e60, .data2 = 0xc465, .data3 = 0x11cf }, -+ /* Bluetooth */ -+ { .data1 = 0xe0cbf06c, .data2 = 0xcd8b, .data3 = 0x4647 }, -+ /* ivtcorporation.com's bluetooth device claims this is -+ * bluetooth guid */ -+ { .data1 = 0xf12d3cf8, .data2 = 0xb11d, .data3 = 0x457e}, -+}; -+ -+struct mutex loader_mutex; -+static struct completion loader_complete; -+ -+static struct nt_list wrap_devices; -+static struct nt_list wrap_drivers; -+ -+static int wrap_device_type(int data1) -+{ -+ int i; -+ for (i = 0; i < ARRAY_SIZE(class_guids); i++) -+ if (data1 == class_guids[i].data1) -+ return i; -+ ERROR("unknown device: 0x%x\n", data1); -+ return -1; -+} -+ -+/* load driver for given device, if not already loaded */ -+struct wrap_driver *load_wrap_driver(struct wrap_device *wd) -+{ -+ int ret; -+ struct nt_list *cur; -+ struct wrap_driver *wrap_driver; -+ -+ ENTER1("device: %04X:%04X:%04X:%04X", wd->vendor, wd->device, -+ wd->subvendor, wd->subdevice); -+ mutex_lock(&loader_mutex); -+ wrap_driver = NULL; -+ nt_list_for_each(cur, &wrap_drivers) { -+ wrap_driver = container_of(cur, struct wrap_driver, list); -+ if (!stricmp(wrap_driver->name, wd->driver_name)) { -+ TRACE1("driver %s already loaded", wrap_driver->name); -+ break; -+ } else -+ wrap_driver = NULL; -+ } -+ mutex_unlock(&loader_mutex); -+ -+ if (!wrap_driver) { -+ char *argv[] = {"loadndisdriver", WRAP_CMD_LOAD_DRIVER, -+#if DEBUG >= 1 -+ "1", -+#else -+ "0", -+#endif -+ UTILS_VERSION, wd->driver_name, -+ wd->conf_file_name, NULL}; -+ char *env[] = {NULL}; -+ -+ TRACE1("loading driver %s", wd->driver_name); -+ mutex_lock(&loader_mutex); -+ reinit_completion(&loader_complete); -+ ret = call_usermodehelper("/sbin/loadndisdriver", argv, env, -+ UMH_WAIT_PROC); -+ if (ret) { -+ mutex_unlock(&loader_mutex); -+ ERROR("couldn't load driver %s; check system log " -+ "for messages from 'loadndisdriver'", -+ wd->driver_name); -+ EXIT1(return NULL); -+ } -+ wait_for_completion(&loader_complete); -+ TRACE1("%s", wd->driver_name); -+ wrap_driver = NULL; -+ nt_list_for_each(cur, &wrap_drivers) { -+ wrap_driver = container_of(cur, struct wrap_driver, -+ list); -+ if (!stricmp(wrap_driver->name, wd->driver_name)) { -+ wd->driver = wrap_driver; -+ break; -+ } else -+ wrap_driver = NULL; -+ } -+ mutex_unlock(&loader_mutex); -+ if (wrap_driver) -+ TRACE1("driver %s is loaded", wrap_driver->name); -+ else -+ ERROR("couldn't load driver '%s'", wd->driver_name); -+ } -+ EXIT1(return wrap_driver); -+} -+ -+/* load the driver files from userspace. */ -+static int load_sys_files(struct wrap_driver *driver, -+ struct load_driver *load_driver) -+{ -+ int i, err; -+ -+ TRACE1("num_pe_images = %d", load_driver->num_sys_files); -+ TRACE1("loading driver: %s", load_driver->name); -+ strncpy(driver->name, load_driver->name, sizeof(driver->name)); -+ driver->name[sizeof(driver->name)-1] = 0; -+ TRACE1("driver: %s", driver->name); -+ err = 0; -+ driver->num_pe_images = 0; -+ for (i = 0; i < load_driver->num_sys_files; i++) { -+ struct pe_image *pe_image; -+ pe_image = &driver->pe_images[driver->num_pe_images]; -+ -+ strncpy(pe_image->name, load_driver->sys_files[i].name, -+ sizeof(pe_image->name)); -+ pe_image->name[sizeof(pe_image->name)-1] = 0; -+ TRACE1("image size: %zu bytes", load_driver->sys_files[i].size); -+ -+#ifdef CONFIG_X86_64 -+#ifdef PAGE_KERNEL_EXECUTABLE -+ pe_image->image = -+ __vmalloc(load_driver->sys_files[i].size, -+ GFP_KERNEL | __GFP_HIGHMEM, -+ PAGE_KERNEL_EXECUTABLE); -+#elif defined PAGE_KERNEL_EXEC -+ pe_image->image = -+ __vmalloc(load_driver->sys_files[i].size, -+ GFP_KERNEL | __GFP_HIGHMEM, -+ PAGE_KERNEL_EXEC); -+#else -+#error x86_64 should have either PAGE_KERNEL_EXECUTABLE or PAGE_KERNEL_EXEC -+#endif -+#else -+ /* hate to play with kernel macros, but PAGE_KERNEL_EXEC is -+ * not available to modules! */ -+#ifdef cpu_has_nx -+ if (cpu_has_nx) -+ pe_image->image = -+ __vmalloc(load_driver->sys_files[i].size, -+ GFP_KERNEL | __GFP_HIGHMEM, -+ __pgprot(__PAGE_KERNEL & ~_PAGE_NX)); -+ else -+ pe_image->image = -+ vmalloc(load_driver->sys_files[i].size); -+#else -+ pe_image->image = -+ vmalloc(load_driver->sys_files[i].size); -+#endif -+#endif -+ if (!pe_image->image) { -+ ERROR("couldn't allocate memory"); -+ err = -ENOMEM; -+ break; -+ } -+ TRACE1("image is at %p", pe_image->image); -+ -+ if (copy_from_user(pe_image->image, -+ load_driver->sys_files[i].data, -+ load_driver->sys_files[i].size)) { -+ ERROR("couldn't load file %s", -+ load_driver->sys_files[i].name); -+ err = -EFAULT; -+ break; -+ } -+ pe_image->size = load_driver->sys_files[i].size; -+ driver->num_pe_images++; -+ } -+ -+ if (!err && link_pe_images(driver->pe_images, driver->num_pe_images)) { -+ ERROR("couldn't prepare driver '%s'", load_driver->name); -+ err = -EINVAL; -+ } -+ -+ if (driver->num_pe_images < load_driver->num_sys_files || err) { -+ for (i = 0; i < driver->num_pe_images; i++) -+ if (driver->pe_images[i].image) -+ vfree(driver->pe_images[i].image); -+ driver->num_pe_images = 0; -+ EXIT1(return err); -+ } else -+ EXIT1(return 0); -+} -+ -+struct wrap_bin_file *get_bin_file(char *bin_file_name) -+{ -+ int i = 0; -+ struct wrap_driver *driver, *cur; -+ -+ ENTER1("%s", bin_file_name); -+ mutex_lock(&loader_mutex); -+ driver = NULL; -+ nt_list_for_each_entry(cur, &wrap_drivers, list) { -+ for (i = 0; i < cur->num_bin_files; i++) -+ if (!stricmp(cur->bin_files[i].name, bin_file_name)) { -+ driver = cur; -+ break; -+ } -+ if (driver) -+ break; -+ } -+ mutex_unlock(&loader_mutex); -+ if (!driver) { -+ TRACE1("couldn't find bin file '%s'", bin_file_name); -+ return NULL; -+ } -+ -+ if (!driver->bin_files[i].data) { -+ char *argv[] = {"loadndisdriver", WRAP_CMD_LOAD_BIN_FILE, -+#if DEBUG >= 1 -+ "1", -+#else -+ "0", -+#endif -+ UTILS_VERSION, driver->name, -+ driver->bin_files[i].name, NULL}; -+ char *env[] = {NULL}; -+ int ret; -+ -+ TRACE1("loading bin file %s/%s", driver->name, -+ driver->bin_files[i].name); -+ mutex_lock(&loader_mutex); -+ reinit_completion(&loader_complete); -+ ret = call_usermodehelper("/sbin/loadndisdriver", argv, env, -+ UMH_WAIT_PROC); -+ if (ret) { -+ mutex_unlock(&loader_mutex); -+ ERROR("couldn't load file %s/%s; check system log " -+ "for messages from 'loadndisdriver' (%d)", -+ driver->name, driver->bin_files[i].name, ret); -+ EXIT1(return NULL); -+ } -+ wait_for_completion(&loader_complete); -+ mutex_unlock(&loader_mutex); -+ if (!driver->bin_files[i].data) { -+ WARNING("couldn't load binary file %s", -+ driver->bin_files[i].name); -+ EXIT1(return NULL); -+ } -+ } -+ EXIT2(return &(driver->bin_files[i])); -+} -+ -+/* called with loader_mutex down */ -+static int add_bin_file(struct load_driver_file *driver_file) -+{ -+ struct wrap_driver *driver, *cur; -+ struct wrap_bin_file *bin_file; -+ int i = 0; -+ -+ driver = NULL; -+ nt_list_for_each_entry(cur, &wrap_drivers, list) { -+ for (i = 0; i < cur->num_bin_files; i++) -+ if (!stricmp(cur->bin_files[i].name, -+ driver_file->name)) { -+ driver = cur; -+ break; -+ } -+ if (driver) -+ break; -+ } -+ if (!driver) { -+ ERROR("couldn't find %s", driver_file->name); -+ return -EINVAL; -+ } -+ bin_file = &driver->bin_files[i]; -+ strncpy(bin_file->name, driver_file->name, sizeof(bin_file->name)); -+ bin_file->name[sizeof(bin_file->name)-1] = 0; -+ bin_file->data = vmalloc(driver_file->size); -+ if (!bin_file->data) { -+ ERROR("couldn't allocate memory"); -+ return -ENOMEM; -+ } -+ bin_file->size = driver_file->size; -+ if (copy_from_user(bin_file->data, driver_file->data, bin_file->size)) { -+ ERROR("couldn't copy data"); -+ free_bin_file(bin_file); -+ return -EFAULT; -+ } -+ return 0; -+} -+ -+void free_bin_file(struct wrap_bin_file *bin_file) -+{ -+ TRACE2("unloading %s", bin_file->name); -+ if (bin_file->data) -+ vfree(bin_file->data); -+ bin_file->data = NULL; -+ bin_file->size = 0; -+ EXIT2(return); -+} -+ -+/* load firmware files from userspace */ -+static int load_bin_files_info(struct wrap_driver *driver, -+ struct load_driver *load_driver) -+{ -+ struct wrap_bin_file *bin_files; -+ int i; -+ -+ ENTER1("%s, %d", load_driver->name, load_driver->num_bin_files); -+ driver->num_bin_files = 0; -+ driver->bin_files = NULL; -+ if (load_driver->num_bin_files == 0) -+ EXIT1(return 0); -+ bin_files = kzalloc(load_driver->num_bin_files * sizeof(*bin_files), -+ GFP_KERNEL); -+ if (!bin_files) { -+ ERROR("couldn't allocate memory"); -+ EXIT1(return -ENOMEM); -+ } -+ -+ for (i = 0; i < load_driver->num_bin_files; i++) { -+ strncpy(bin_files[i].name, load_driver->bin_files[i].name, -+ sizeof(bin_files[i].name)); -+ bin_files[i].name[sizeof(bin_files[i].name)-1] = 0; -+ TRACE2("loaded bin file %s", bin_files[i].name); -+ } -+ driver->num_bin_files = load_driver->num_bin_files; -+ driver->bin_files = bin_files; -+ EXIT1(return 0); -+} -+ -+/* load settings for a device. called with loader_mutex down */ -+static int load_settings(struct wrap_driver *wrap_driver, -+ struct load_driver *load_driver) -+{ -+ int i, num_settings; -+ -+ ENTER1("%p, %p", wrap_driver, load_driver); -+ -+ num_settings = 0; -+ for (i = 0; i < load_driver->num_settings; i++) { -+ struct load_device_setting *load_setting = -+ &load_driver->settings[i]; -+ struct wrap_device_setting *setting; -+ ULONG data1; -+ -+ setting = kzalloc(sizeof(*setting), GFP_KERNEL); -+ if (!setting) { -+ ERROR("couldn't allocate memory"); -+ break; -+ } -+ strncpy(setting->name, load_setting->name, -+ sizeof(setting->name)); -+ setting->name[sizeof(setting->name)-1] = 0; -+ strncpy(setting->value, load_setting->value, -+ sizeof(setting->value)); -+ setting->value[sizeof(setting->value)-1] = 0; -+ TRACE2("%p: %s=%s", setting, setting->name, setting->value); -+ -+ if (strcmp(setting->name, "driver_version") == 0) { -+ strncpy(wrap_driver->version, setting->value, -+ sizeof(wrap_driver->version)); -+ wrap_driver->version[sizeof(wrap_driver->version)-1] = 0; -+ } else if (strcmp(setting->name, "class_guid") == 0 && -+ sscanf(setting->value, "%x", &data1) == 1) { -+ wrap_driver->dev_type = wrap_device_type(data1); -+ if (wrap_driver->dev_type < 0) { -+ WARNING("unknown guid: %x", data1); -+ wrap_driver->dev_type = 0; -+ } -+ } -+ InsertTailList(&wrap_driver->settings, &setting->list); -+ num_settings++; -+ } -+ /* it is not a fatal error if some settings couldn't be loaded */ -+ if (num_settings > 0) -+ EXIT1(return 0); -+ else -+ EXIT1(return -EINVAL); -+} -+ -+void unload_wrap_device(struct wrap_device *wd) -+{ -+ struct nt_list *cur; -+ ENTER1("unloading device %p (%04X:%04X:%04X:%04X), driver %s", wd, -+ wd->vendor, wd->device, wd->subvendor, wd->subdevice, -+ wd->driver_name); -+ mutex_lock(&loader_mutex); -+ while ((cur = RemoveHeadList(&wd->settings))) { -+ struct wrap_device_setting *setting; -+ setting = container_of(cur, struct wrap_device_setting, list); -+ kfree(setting); -+ } -+ RemoveEntryList(&wd->list); -+ mutex_unlock(&loader_mutex); -+ kfree(wd); -+ EXIT1(return); -+} -+ -+/* should be called with loader_mutex down */ -+void unload_wrap_driver(struct wrap_driver *driver) -+{ -+ int i; -+ struct driver_object *drv_obj; -+ struct nt_list *cur, *next; -+ -+ ENTER1("unloading driver: %s (%p)", driver->name, driver); -+ TRACE1("freeing %d images", driver->num_pe_images); -+ drv_obj = driver->drv_obj; -+ for (i = 0; i < driver->num_pe_images; i++) -+ if (driver->pe_images[i].image) { -+ TRACE1("freeing image at %p", -+ driver->pe_images[i].image); -+ vfree(driver->pe_images[i].image); -+ } -+ -+ TRACE1("freeing %d bin files", driver->num_bin_files); -+ for (i = 0; i < driver->num_bin_files; i++) { -+ TRACE1("freeing image at %p", driver->bin_files[i].data); -+ if (driver->bin_files[i].data) -+ vfree(driver->bin_files[i].data); -+ } -+ kfree(driver->bin_files); -+ RtlFreeUnicodeString(&drv_obj->name); -+ RemoveEntryList(&driver->list); -+ nt_list_for_each_safe(cur, next, &driver->settings) { -+ struct wrap_device_setting *setting; -+ struct ndis_configuration_parameter *param; -+ -+ setting = container_of(cur, struct wrap_device_setting, list); -+ TRACE2("%p", setting); -+ param = setting->encoded; -+ if (param) { -+ TRACE2("%p", param); -+ if (param->type == NdisParameterString) -+ RtlFreeUnicodeString(¶m->data.string); -+ ExFreePool(param); -+ } -+ kfree(setting); -+ } -+ /* this frees driver */ -+ free_custom_extensions(drv_obj->drv_ext); -+ kfree(drv_obj->drv_ext); -+ TRACE1("drv_obj: %p", drv_obj); -+ -+ EXIT1(return); -+} -+ -+/* call the entry point of the driver */ -+static int start_wrap_driver(struct wrap_driver *driver) -+{ -+ int i; -+ NTSTATUS ret, res; -+ struct driver_object *drv_obj; -+ typeof(driver->pe_images[0].entry) entry; -+ -+ ENTER1("%s", driver->name); -+ drv_obj = driver->drv_obj; -+ for (ret = res = 0, i = 0; i < driver->num_pe_images; i++) -+ /* dlls are already started by loader */ -+ if (driver->pe_images[i].type == IMAGE_FILE_EXECUTABLE_IMAGE) { -+ entry = driver->pe_images[i].entry; -+ drv_obj->start = driver->pe_images[i].entry; -+ drv_obj->driver_size = driver->pe_images[i].size; -+ TRACE1("entry: %p, %p, drv_obj: %p", -+ entry, *entry, drv_obj); -+ res = LIN2WIN2(entry, drv_obj, &drv_obj->name); -+ ret |= res; -+ TRACE1("entry returns %08X", res); -+ break; -+ } -+ if (ret) { -+ ERROR("driver initialization failed: %08X", ret); -+ RtlFreeUnicodeString(&drv_obj->name); -+ /* this frees ndis_driver */ -+ free_custom_extensions(drv_obj->drv_ext); -+ kfree(drv_obj->drv_ext); -+ TRACE1("drv_obj: %p", drv_obj); -+ ObDereferenceObject(drv_obj); -+ EXIT1(return -EINVAL); -+ } -+ EXIT1(return 0); -+} -+ -+/* -+ * add driver to list of loaded driver but make sure this driver is -+ * not loaded before. called with loader_mutex down -+ */ -+static int add_wrap_driver(struct wrap_driver *driver) -+{ -+ struct wrap_driver *tmp; -+ -+ ENTER1("name: %s", driver->name); -+ nt_list_for_each_entry(tmp, &wrap_drivers, list) { -+ if (stricmp(tmp->name, driver->name) == 0) { -+ ERROR("cannot add duplicate driver"); -+ EXIT1(return -EBUSY); -+ } -+ } -+ InsertHeadList(&wrap_drivers, &driver->list); -+ EXIT1(return 0); -+} -+ -+/* load a driver from userspace and initialize it. called with -+ * loader_mutex down */ -+static int load_user_space_driver(struct load_driver *load_driver) -+{ -+ struct driver_object *drv_obj; -+ struct ansi_string ansi_reg; -+ struct wrap_driver *wrap_driver = NULL; -+ -+ ENTER1("%p", load_driver); -+ drv_obj = allocate_object(sizeof(*drv_obj), OBJECT_TYPE_DRIVER, NULL); -+ if (!drv_obj) { -+ ERROR("couldn't allocate memory"); -+ EXIT1(return -ENOMEM); -+ } -+ TRACE1("drv_obj: %p", drv_obj); -+ drv_obj->drv_ext = kzalloc(sizeof(*(drv_obj->drv_ext)), GFP_KERNEL); -+ if (!drv_obj->drv_ext) { -+ ERROR("couldn't allocate memory"); -+ ObDereferenceObject(drv_obj); -+ EXIT1(return -ENOMEM); -+ } -+ InitializeListHead(&drv_obj->drv_ext->custom_ext); -+ if (IoAllocateDriverObjectExtension(drv_obj, -+ (void *)WRAP_DRIVER_CLIENT_ID, -+ sizeof(*wrap_driver), -+ (void **)&wrap_driver) != -+ STATUS_SUCCESS) -+ EXIT1(return -ENOMEM); -+ TRACE1("driver: %p", wrap_driver); -+ memset(wrap_driver, 0, sizeof(*wrap_driver)); -+ InitializeListHead(&wrap_driver->list); -+ InitializeListHead(&wrap_driver->settings); -+ wrap_driver->drv_obj = drv_obj; -+ RtlInitAnsiString(&ansi_reg, "/tmp"); -+ if (RtlAnsiStringToUnicodeString(&drv_obj->name, &ansi_reg, TRUE) != -+ STATUS_SUCCESS) { -+ ERROR("couldn't initialize registry path"); -+ free_custom_extensions(drv_obj->drv_ext); -+ kfree(drv_obj->drv_ext); -+ TRACE1("drv_obj: %p", drv_obj); -+ ObDereferenceObject(drv_obj); -+ EXIT1(return -EINVAL); -+ } -+ strncpy(wrap_driver->name, load_driver->name, sizeof(wrap_driver->name)); -+ wrap_driver->name[sizeof(wrap_driver->name)-1] = 0; -+ if (load_sys_files(wrap_driver, load_driver) || -+ load_bin_files_info(wrap_driver, load_driver) || -+ load_settings(wrap_driver, load_driver) || -+ start_wrap_driver(wrap_driver) || -+ add_wrap_driver(wrap_driver)) { -+ unload_wrap_driver(wrap_driver); -+ ObDereferenceObject(drv_obj); -+ EXIT1(return -EINVAL); -+ } else { -+ printk(KERN_INFO "%s: driver %s (%s) loaded\n", -+ DRIVER_NAME, wrap_driver->name, wrap_driver->version); -+ add_taint(TAINT_PROPRIETARY_MODULE, LOCKDEP_NOW_UNRELIABLE); -+ EXIT1(return 0); -+ } -+} -+ -+static struct pci_device_id wrap_pci_id_table[] = { -+ { -+ .vendor = PCI_ANY_ID, -+ .device = PCI_ANY_ID, -+ .subvendor = PCI_ANY_ID, -+ .subdevice = PCI_ANY_ID, -+ .class = 0, -+ .class_mask = 0, -+ .driver_data = 0 -+ } -+}; -+ -+static struct pci_driver wrap_pci_driver = { -+ .name = DRIVER_NAME, -+ .id_table = wrap_pci_id_table, -+ .probe = wrap_pnp_start_pci_device, -+ .remove = wrap_pnp_remove_pci_device, -+ .suspend = wrap_pnp_suspend_pci_device, -+ .resume = wrap_pnp_resume_pci_device, -+}; -+ -+#ifdef ENABLE_USB -+static struct usb_device_id wrap_usb_id_table[] = { -+ { -+ .driver_info = 1 -+ }, -+}; -+ -+static struct usb_driver wrap_usb_driver = { -+ .name = DRIVER_NAME, -+ .id_table = wrap_usb_id_table, -+ .probe = wrap_pnp_start_usb_device, -+ .disconnect = wrap_pnp_remove_usb_device, -+ .suspend = wrap_pnp_suspend_usb_device, -+ .resume = wrap_pnp_resume_usb_device, -+}; -+#endif -+ -+/* register drivers for pci and usb */ -+static void register_devices(void) -+{ -+ int res; -+ -+ res = pci_register_driver(&wrap_pci_driver); -+ if (res < 0) { -+ ERROR("couldn't register pci driver: %d", res); -+ wrap_pci_driver.name = NULL; -+ } -+ -+#ifdef ENABLE_USB -+ res = usb_register(&wrap_usb_driver); -+ if (res < 0) { -+ ERROR("couldn't register usb driver: %d", res); -+ wrap_usb_driver.name = NULL; -+ } -+#endif -+ EXIT1(return); -+} -+ -+static void unregister_devices(void) -+{ -+ struct nt_list *cur, *next; -+ -+ mutex_lock(&loader_mutex); -+ nt_list_for_each_safe(cur, next, &wrap_devices) { -+ struct wrap_device *wd; -+ wd = container_of(cur, struct wrap_device, list); -+ set_bit(HW_DISABLED, &wd->hw_status); -+ } -+ mutex_unlock(&loader_mutex); -+ -+ if (wrap_pci_driver.name) -+ pci_unregister_driver(&wrap_pci_driver); -+#ifdef ENABLE_USB -+ if (wrap_usb_driver.name) -+ usb_deregister(&wrap_usb_driver); -+#endif -+} -+ -+struct wrap_device *load_wrap_device(struct load_device *load_device) -+{ -+ int ret; -+ struct nt_list *cur; -+ struct wrap_device *wd = NULL; -+ char vendor[5], device[5], subvendor[5], subdevice[5], bus[5]; -+ -+ ENTER1("%04x, %04x, %04x, %04x", load_device->vendor, -+ load_device->device, load_device->subvendor, -+ load_device->subdevice); -+ if (sprintf(vendor, "%04x", load_device->vendor) == 4 && -+ sprintf(device, "%04x", load_device->device) == 4 && -+ sprintf(subvendor, "%04x", load_device->subvendor) == 4 && -+ sprintf(subdevice, "%04x", load_device->subdevice) == 4 && -+ sprintf(bus, "%04x", load_device->bus) == 4) { -+ char *argv[] = {"loadndisdriver", WRAP_CMD_LOAD_DEVICE, -+#if DEBUG >= 1 -+ "1", -+#else -+ "0", -+#endif -+ UTILS_VERSION, vendor, device, -+ subvendor, subdevice, bus, NULL}; -+ char *env[] = {NULL}; -+ TRACE2("%s, %s, %s, %s, %s", vendor, device, -+ subvendor, subdevice, bus); -+ mutex_lock(&loader_mutex); -+ reinit_completion(&loader_complete); -+ ret = call_usermodehelper("/sbin/loadndisdriver", argv, env, -+ UMH_WAIT_PROC); -+ if (ret) { -+ mutex_unlock(&loader_mutex); -+ TRACE1("couldn't load device %04x:%04x; check system " -+ "log for messages from 'loadndisdriver'", -+ load_device->vendor, load_device->device); -+ EXIT1(return NULL); -+ } -+ wait_for_completion(&loader_complete); -+ wd = NULL; -+ nt_list_for_each(cur, &wrap_devices) { -+ wd = container_of(cur, struct wrap_device, list); -+ TRACE2("%p, %04x, %04x, %04x, %04x", wd, wd->vendor, -+ wd->device, wd->subvendor, wd->subdevice); -+ if (wd->vendor == load_device->vendor && -+ wd->device == load_device->device) -+ break; -+ else -+ wd = NULL; -+ } -+ mutex_unlock(&loader_mutex); -+ } else -+ wd = NULL; -+ EXIT1(return wd); -+} -+ -+struct wrap_device *get_wrap_device(void *dev, int bus) -+{ -+ struct nt_list *cur; -+ struct wrap_device *wd; -+ -+ mutex_lock(&loader_mutex); -+ wd = NULL; -+ nt_list_for_each(cur, &wrap_devices) { -+ wd = container_of(cur, struct wrap_device, list); -+ if (bus == WRAP_PCI_BUS && -+ wrap_is_pci_bus(wd->dev_bus) && wd->pci.pdev == dev) -+ break; -+ else if (bus == WRAP_USB_BUS && -+ wrap_is_usb_bus(wd->dev_bus) && wd->usb.udev == dev) -+ break; -+ else -+ wd = NULL; -+ } -+ mutex_unlock(&loader_mutex); -+ return wd; -+} -+ -+/* called with loader_mutex is down */ -+static long wrapper_ioctl(struct file *file, unsigned int cmd, -+ unsigned long arg) -+{ -+ struct load_driver *load_driver; -+ struct load_device load_device; -+ struct load_driver_file load_bin_file; -+ int ret; -+ void __user *addr = (void __user *)arg; -+ -+ ENTER1("cmd: 0x%x", cmd); -+ -+ ret = 0; -+ switch (cmd) { -+ case WRAP_IOCTL_LOAD_DEVICE: -+ if (copy_from_user(&load_device, addr, sizeof(load_device))) { -+ ret = -EFAULT; -+ break; -+ } -+ TRACE2("%04x, %04x, %04x, %04x", load_device.vendor, -+ load_device.device, load_device.subvendor, -+ load_device.subdevice); -+ if (load_device.vendor) { -+ struct wrap_device *wd; -+ wd = kzalloc(sizeof(*wd), GFP_KERNEL); -+ if (!wd) { -+ ret = -ENOMEM; -+ break; -+ } -+ InitializeListHead(&wd->settings); -+ wd->dev_bus = WRAP_BUS(load_device.bus); -+ wd->vendor = load_device.vendor; -+ wd->device = load_device.device; -+ wd->subvendor = load_device.subvendor; -+ wd->subdevice = load_device.subdevice; -+ strncpy(wd->conf_file_name, load_device.conf_file_name, -+ sizeof(wd->conf_file_name)); -+ wd->conf_file_name[sizeof(wd->conf_file_name)-1] = 0; -+ strncpy(wd->driver_name, load_device.driver_name, -+ sizeof(wd->driver_name)); -+ wd->driver_name[sizeof(wd->driver_name)-1] = 0; -+ InsertHeadList(&wrap_devices, &wd->list); -+ ret = 0; -+ } else -+ ret = -EINVAL; -+ break; -+ case WRAP_IOCTL_LOAD_DRIVER: -+ TRACE1("loading driver at %p", addr); -+ load_driver = vmalloc(sizeof(*load_driver)); -+ if (!load_driver) { -+ ret = -ENOMEM; -+ break; -+ } -+ if (copy_from_user(load_driver, addr, sizeof(*load_driver))) -+ ret = -EFAULT; -+ else -+ ret = load_user_space_driver(load_driver); -+ vfree(load_driver); -+ break; -+ case WRAP_IOCTL_LOAD_BIN_FILE: -+ if (copy_from_user(&load_bin_file, addr, sizeof(load_bin_file))) -+ ret = -EFAULT; -+ else -+ ret = add_bin_file(&load_bin_file); -+ break; -+ default: -+ ERROR("unknown ioctl 0x%x", cmd); -+ ret = -EINVAL; -+ break; -+ } -+ complete(&loader_complete); -+ EXIT1(return ret); -+} -+ -+#ifdef CONFIG_COMPAT -+static int copy_load_driver_file32(struct load_driver_file *k, -+ struct load_driver_file32 __user *u) -+{ -+ u32 data; -+ -+ if (copy_from_user(&k->driver_name, &u->driver_name, -+ sizeof(u->driver_name) + sizeof(u->name))) -+ return -EFAULT; -+ -+ if (get_user(k->size, &u->size)) -+ return -EFAULT; -+ if (get_user(data, &u->data)) -+ return -EFAULT; -+ -+ k->data = (void __user *)(unsigned long)data; -+ return 0; -+} -+ -+static int copy_load_driver32(struct load_driver *k, -+ struct load_driver32 __user *u) -+{ -+ int i; -+ -+ if (copy_from_user(&k->name, &u->name, -+ sizeof(u->name) + sizeof(u->conf_file_name))) -+ return -EFAULT; -+ -+ if (get_user(k->num_sys_files, &u->num_sys_files)) -+ return -EFAULT; -+ -+ for (i = 0; i < k->num_sys_files; i++) -+ if (copy_load_driver_file32(&k->sys_files[i], &u->sys_files[i])) -+ return -EFAULT; -+ -+ if (get_user(k->num_settings, &u->num_settings)) -+ return -EFAULT; -+ -+ if (copy_from_user(&k->settings, &u->settings, -+ sizeof(u->settings[0]) * k->num_settings)) -+ return -EFAULT; -+ -+ if (get_user(k->num_bin_files, &u->num_bin_files)) -+ return -EFAULT; -+ -+ for (i = 0; i < k->num_bin_files; i++) -+ if (copy_load_driver_file32(&k->bin_files[i], &u->bin_files[i])) -+ return -EFAULT; -+ -+ return 0; -+} -+ -+static long wrapper_ioctl_compat(struct file *file, unsigned int cmd, -+ unsigned long arg) -+{ -+ int ret = 0; -+ void __user *addr = (void __user *)arg; -+ struct load_driver *kdriver; -+ struct load_driver32 __user *udriver = addr; -+ struct load_driver_file kfile; -+ struct load_driver_file32 __user *ufile = addr; -+ -+ ENTER1("cmd: 0x%x", cmd); -+ -+ switch (cmd) { -+ case WRAP_IOCTL_LOAD_DEVICE32: -+ return wrapper_ioctl(file, WRAP_IOCTL_LOAD_DEVICE, arg); -+ case WRAP_IOCTL_LOAD_DRIVER32: -+ TRACE1("loading driver at %p", addr); -+ kdriver = vmalloc(sizeof(*kdriver)); -+ if (!kdriver) { -+ ret = -ENOMEM; -+ break; -+ } -+ -+ ret = copy_load_driver32(kdriver, udriver); -+ if (!ret) -+ ret = load_user_space_driver(kdriver); -+ -+ vfree(kdriver); -+ break; -+ case WRAP_IOCTL_LOAD_BIN_FILE32: -+ ret = copy_load_driver_file32(&kfile, ufile); -+ if (ret) -+ break; -+ -+ ret = add_bin_file(&kfile); -+ break; -+ default: -+ ERROR("unknown ioctl 0x%x", cmd); -+ ret = -EINVAL; -+ break; -+ } -+ complete(&loader_complete); -+ EXIT1(return ret); -+} -+#endif -+ -+static int wrapper_ioctl_release(struct inode *inode, struct file *file) -+{ -+ ENTER1(""); -+ complete(&loader_complete); -+ return 0; -+} -+ -+static struct file_operations wrapper_fops = { -+ .owner = THIS_MODULE, -+ .unlocked_ioctl = wrapper_ioctl, -+#ifdef CONFIG_COMPAT -+ .compat_ioctl = wrapper_ioctl_compat, -+#endif -+ .release = wrapper_ioctl_release, -+}; -+ -+static struct miscdevice wrapper_misc = { -+ .name = DRIVER_NAME, -+ .minor = MISC_DYNAMIC_MINOR, -+ .fops = &wrapper_fops -+}; -+ -+int loader_init(void) -+{ -+ int err; -+ -+ InitializeListHead(&wrap_drivers); -+ InitializeListHead(&wrap_devices); -+ mutex_init(&loader_mutex); -+ init_completion(&loader_complete); -+ if ((err = misc_register(&wrapper_misc)) < 0) { -+ ERROR("couldn't register module (%d)", err); -+ unregister_devices(); -+ EXIT1(return err); -+ } -+ register_devices(); -+ EXIT1(return 0); -+} -+ -+void loader_exit(void) -+{ -+ struct nt_list *cur, *next; -+ -+ ENTER1(""); -+ misc_deregister(&wrapper_misc); -+ unregister_devices(); -+ mutex_lock(&loader_mutex); -+ nt_list_for_each_safe(cur, next, &wrap_drivers) { -+ struct wrap_driver *driver; -+ driver = container_of(cur, struct wrap_driver, list); -+ unload_wrap_driver(driver); -+ } -+ mutex_unlock(&loader_mutex); -+ EXIT1(return); -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/loader.h linux-4.12.4-3rd/3rdparty/ndiswrapper/loader.h ---- linux-4.12.4/3rdparty/ndiswrapper/loader.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/loader.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,108 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifndef _LOADER_H_ -+#define _LOADER_H_ -+ -+#include "ndiswrapper.h" -+ -+#ifndef __KERNEL__ -+#define __user -+#endif -+ -+struct load_driver_file { -+ char driver_name[MAX_DRIVER_NAME_LEN]; -+ char name[MAX_DRIVER_NAME_LEN]; -+ size_t size; -+ void __user *data; -+}; -+ -+struct load_device_setting { -+ char name[MAX_SETTING_NAME_LEN]; -+ char value[MAX_SETTING_VALUE_LEN]; -+}; -+ -+struct load_device { -+ int bus; -+ int vendor; -+ int device; -+ int subvendor; -+ int subdevice; -+ char conf_file_name[MAX_DRIVER_NAME_LEN]; -+ char driver_name[MAX_DRIVER_NAME_LEN]; -+}; -+ -+struct load_driver { -+ char name[MAX_DRIVER_NAME_LEN]; -+ char conf_file_name[MAX_DRIVER_NAME_LEN]; -+ unsigned int num_sys_files; -+ struct load_driver_file sys_files[MAX_DRIVER_PE_IMAGES]; -+ unsigned int num_settings; -+ struct load_device_setting settings[MAX_DEVICE_SETTINGS]; -+ unsigned int num_bin_files; -+ struct load_driver_file bin_files[MAX_DRIVER_BIN_FILES]; -+}; -+ -+#define WRAP_IOCTL_LOAD_DEVICE _IOW(('N' + 'd' + 'i' + 'S'), 0, \ -+ struct load_device *) -+#define WRAP_IOCTL_LOAD_DRIVER _IOW(('N' + 'd' + 'i' + 'S'), 1, \ -+ struct load_driver *) -+#define WRAP_IOCTL_LOAD_BIN_FILE _IOW(('N' + 'd' + 'i' + 'S'), 2, \ -+ struct load_driver_file *) -+ -+#ifdef CONFIG_COMPAT -+struct load_driver_file32 { -+ char driver_name[MAX_DRIVER_NAME_LEN]; -+ char name[MAX_DRIVER_NAME_LEN]; -+ u32 size; -+ u32 data; -+}; -+ -+struct load_driver32 { -+ char name[MAX_DRIVER_NAME_LEN]; -+ char conf_file_name[MAX_DRIVER_NAME_LEN]; -+ u32 num_sys_files; -+ struct load_driver_file32 sys_files[MAX_DRIVER_PE_IMAGES]; -+ u32 num_settings; -+ struct load_device_setting settings[MAX_DEVICE_SETTINGS]; -+ u32 num_bin_files; -+ struct load_driver_file32 bin_files[MAX_DRIVER_BIN_FILES]; -+} __packed; -+ -+#define WRAP_IOCTL_LOAD_DEVICE32 _IOW(('N' + 'd' + 'i' + 'S'), 0, u32) -+#define WRAP_IOCTL_LOAD_DRIVER32 _IOW(('N' + 'd' + 'i' + 'S'), 1, u32) -+#define WRAP_IOCTL_LOAD_BIN_FILE32 _IOW(('N' + 'd' + 'i' + 'S'), 2, u32) -+#endif -+ -+#define WRAP_CMD_LOAD_DEVICE "load_device" -+#define WRAP_CMD_LOAD_DRIVER "load_driver" -+#define WRAP_CMD_LOAD_BIN_FILE "load_bin_file" -+ -+int loader_init(void); -+void loader_exit(void); -+ -+#ifdef __KERNEL__ -+struct wrap_device *load_wrap_device(struct load_device *load_device); -+struct wrap_driver *load_wrap_driver(struct wrap_device *device); -+struct wrap_bin_file *get_bin_file(char *bin_file_name); -+void free_bin_file(struct wrap_bin_file *bin_file); -+void unload_wrap_driver(struct wrap_driver *driver); -+void unload_wrap_device(struct wrap_device *wd); -+struct wrap_device *get_wrap_device(void *dev, int bus_type); -+ -+extern struct mutex loader_mutex; -+#endif -+ -+#endif /* LOADER_H */ -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/longlong.h linux-4.12.4-3rd/3rdparty/ndiswrapper/longlong.h ---- linux-4.12.4/3rdparty/ndiswrapper/longlong.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/longlong.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,1333 @@ -+/* longlong.h -- definitions for mixed size 32/64 bit arithmetic. -+ Copyright (C) 1991, 1992, 1994, 1995, 1996, 1997, 1998, 1999, 2000 -+ Free Software Foundation, Inc. -+ -+ This file is part of the GNU C Library. -+ -+ The GNU C Library is free software; you can redistribute it and/or -+ modify it under the terms of the GNU Lesser General Public -+ License as published by the Free Software Foundation; either -+ version 2.1 of the License, or (at your option) any later version. -+ -+ The GNU C Library is distributed in the hope that it will be useful, -+ but WITHOUT ANY WARRANTY; without even the implied warranty of -+ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -+ Lesser General Public License for more details. -+ -+ You should have received a copy of the GNU Lesser General Public -+ License along with the GNU C Library; if not, write to the Free -+ Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA -+ 02111-1307 USA. */ -+ -+/* You have to define the following before including this file: -+ -+ UWtype -- An unsigned type, default type for operations (typically a "word") -+ UHWtype -- An unsigned type, at least half the size of UWtype. -+ UDWtype -- An unsigned type, at least twice as large a UWtype -+ W_TYPE_SIZE -- size in bits of UWtype -+ -+ UQItype -- Unsigned 8 bit type. -+ SItype, USItype -- Signed and unsigned 32 bit types. -+ DItype, UDItype -- Signed and unsigned 64 bit types. -+ -+ On a 32 bit machine UWtype should typically be USItype; -+ on a 64 bit machine, UWtype should typically be UDItype. -+*/ -+ -+#define __BITS4 (W_TYPE_SIZE / 4) -+#define __ll_B ((UWtype) 1 << (W_TYPE_SIZE / 2)) -+#define __ll_lowpart(t) ((UWtype) (t) & (__ll_B - 1)) -+#define __ll_highpart(t) ((UWtype) (t) >> (W_TYPE_SIZE / 2)) -+ -+#ifndef W_TYPE_SIZE -+#define W_TYPE_SIZE 32 -+#define UWtype USItype -+#define UHWtype USItype -+#define UDWtype UDItype -+#endif -+ -+/* Define auxiliary asm macros. -+ -+ 1) umul_ppmm(high_prod, low_prod, multipler, multiplicand) multiplies two -+ UWtype integers MULTIPLER and MULTIPLICAND, and generates a two UWtype -+ word product in HIGH_PROD and LOW_PROD. -+ -+ 2) __umulsidi3(a,b) multiplies two UWtype integers A and B, and returns a -+ UDWtype product. This is just a variant of umul_ppmm. -+ -+ 3) udiv_qrnnd(quotient, remainder, high_numerator, low_numerator, -+ denominator) divides a UDWtype, composed by the UWtype integers -+ HIGH_NUMERATOR and LOW_NUMERATOR, by DENOMINATOR and places the quotient -+ in QUOTIENT and the remainder in REMAINDER. HIGH_NUMERATOR must be less -+ than DENOMINATOR for correct operation. If, in addition, the most -+ significant bit of DENOMINATOR must be 1, then the pre-processor symbol -+ UDIV_NEEDS_NORMALIZATION is defined to 1. -+ -+ 4) sdiv_qrnnd(quotient, remainder, high_numerator, low_numerator, -+ denominator). Like udiv_qrnnd but the numbers are signed. The quotient -+ is rounded towards 0. -+ -+ 5) count_leading_zeros(count, x) counts the number of zero-bits from the -+ msb to the first nonzero bit in the UWtype X. This is the number of -+ steps X needs to be shifted left to set the msb. Undefined for X == 0, -+ unless the symbol COUNT_LEADING_ZEROS_0 is defined to some value. -+ -+ 6) count_trailing_zeros(count, x) like count_leading_zeros, but counts -+ from the least significant end. -+ -+ 7) add_ssaaaa(high_sum, low_sum, high_addend_1, low_addend_1, -+ high_addend_2, low_addend_2) adds two UWtype integers, composed by -+ HIGH_ADDEND_1 and LOW_ADDEND_1, and HIGH_ADDEND_2 and LOW_ADDEND_2 -+ respectively. The result is placed in HIGH_SUM and LOW_SUM. Overflow -+ (i.e. carry out) is not stored anywhere, and is lost. -+ -+ 8) sub_ddmmss(high_difference, low_difference, high_minuend, low_minuend, -+ high_subtrahend, low_subtrahend) subtracts two two-word UWtype integers, -+ composed by HIGH_MINUEND_1 and LOW_MINUEND_1, and HIGH_SUBTRAHEND_2 and -+ LOW_SUBTRAHEND_2 respectively. The result is placed in HIGH_DIFFERENCE -+ and LOW_DIFFERENCE. Overflow (i.e. carry out) is not stored anywhere, -+ and is lost. -+ -+ If any of these macros are left undefined for a particular CPU, -+ C macros are used. */ -+ -+/* The CPUs come in alphabetical order below. -+ -+ Please add support for more CPUs here, or improve the current support -+ for the CPUs below! -+ (E.g. WE32100, IBM360.) */ -+ -+#if defined (__GNUC__) && !defined (NO_ASM) -+ -+/* We sometimes need to clobber "cc" with gcc2, but that would not be -+ understood by gcc1. Use cpp to avoid major code duplication. */ -+#if __GNUC__ < 2 -+#define __CLOBBER_CC -+#define __AND_CLOBBER_CC -+#else /* __GNUC__ >= 2 */ -+#define __CLOBBER_CC : "cc" -+#define __AND_CLOBBER_CC , "cc" -+#endif /* __GNUC__ < 2 */ -+ -+#if defined (__alpha) && W_TYPE_SIZE == 64 -+#define umul_ppmm(ph, pl, m0, m1) \ -+ do { \ -+ UDItype __m0 = (m0), __m1 = (m1); \ -+ __asm__ ("umulh %r1,%2,%0" \ -+ : "=r" ((UDItype) ph) \ -+ : "%rJ" (__m0), \ -+ "rI" (__m1)); \ -+ (pl) = __m0 * __m1; \ -+ } while (0) -+#define UMUL_TIME 46 -+#ifndef LONGLONG_STANDALONE -+#define udiv_qrnnd(q, r, n1, n0, d) \ -+ do { UDItype __r; \ -+ (q) = __udiv_qrnnd (&__r, (n1), (n0), (d)); \ -+ (r) = __r; \ -+ } while (0) -+extern UDItype __udiv_qrnnd (UDItype *, UDItype, UDItype, UDItype); -+#define UDIV_TIME 220 -+#endif /* LONGLONG_STANDALONE */ -+#ifdef __alpha_cix__ -+#define count_leading_zeros(COUNT,X) \ -+ __asm__("ctlz %1,%0" : "=r"(COUNT) : "r"(X)) -+#define count_trailing_zeros(COUNT,X) \ -+ __asm__("cttz %1,%0" : "=r"(COUNT) : "r"(X)) -+#define COUNT_LEADING_ZEROS_0 64 -+#else -+extern const UQItype __clz_tab[]; -+#define count_leading_zeros(COUNT,X) \ -+ do { \ -+ UDItype __xr = (X), __t, __a; \ -+ __asm__("cmpbge $31,%1,%0" : "=r"(__t) : "r"(__xr)); \ -+ __a = __clz_tab[__t ^ 0xff] - 1; \ -+ __asm__("extbl %1,%2,%0" : "=r"(__t) : "r"(__xr), "r"(__a)); \ -+ (COUNT) = 64 - (__clz_tab[__t] + __a*8); \ -+ } while (0) -+#define count_trailing_zeros(COUNT,X) \ -+ do { \ -+ UDItype __xr = (X), __t, __a; \ -+ __asm__("cmpbge $31,%1,%0" : "=r"(__t) : "r"(__xr)); \ -+ __t = ~__t & -~__t; \ -+ __a = ((__t & 0xCC) != 0) * 2; \ -+ __a += ((__t & 0xF0) != 0) * 4; \ -+ __a += ((__t & 0xAA) != 0); \ -+ __asm__("extbl %1,%2,%0" : "=r"(__t) : "r"(__xr), "r"(__a)); \ -+ __a <<= 3; \ -+ __t &= -__t; \ -+ __a += ((__t & 0xCC) != 0) * 2; \ -+ __a += ((__t & 0xF0) != 0) * 4; \ -+ __a += ((__t & 0xAA) != 0); \ -+ (COUNT) = __a; \ -+ } while (0) -+#endif /* __alpha_cix__ */ -+#endif /* __alpha */ -+ -+#if defined (__arc__) && W_TYPE_SIZE == 32 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("add.f %1, %4, %5\n\tadc %0, %2, %3" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "%r" ((USItype) (ah)), \ -+ "rIJ" ((USItype) (bh)), \ -+ "%r" ((USItype) (al)), \ -+ "rIJ" ((USItype) (bl))) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("sub.f %1, %4, %5\n\tsbc %0, %2, %3" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "r" ((USItype) (ah)), \ -+ "rIJ" ((USItype) (bh)), \ -+ "r" ((USItype) (al)), \ -+ "rIJ" ((USItype) (bl))) -+/* Call libgcc routine. */ -+#define umul_ppmm(w1, w0, u, v) \ -+do { \ -+ DWunion __w; \ -+ __w.ll = __umulsidi3 (u, v); \ -+ w1 = __w.s.high; \ -+ w0 = __w.s.low; \ -+} while (0) -+#define __umulsidi3 __umulsidi3 -+UDItype __umulsidi3 (USItype, USItype); -+#endif -+ -+#if defined (__arm__) && W_TYPE_SIZE == 32 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("adds %1, %4, %5\n\tadc %0, %2, %3" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "%r" ((USItype) (ah)), \ -+ "rI" ((USItype) (bh)), \ -+ "%r" ((USItype) (al)), \ -+ "rI" ((USItype) (bl))) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("subs %1, %4, %5\n\tsbc %0, %2, %3" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "r" ((USItype) (ah)), \ -+ "rI" ((USItype) (bh)), \ -+ "r" ((USItype) (al)), \ -+ "rI" ((USItype) (bl))) -+#define umul_ppmm(xh, xl, a, b) \ -+{register USItype __t0, __t1, __t2; \ -+ __asm__ ("%@ Inlined umul_ppmm\n" \ -+ " mov %2, %5, lsr #16\n" \ -+ " mov %0, %6, lsr #16\n" \ -+ " bic %3, %5, %2, lsl #16\n" \ -+ " bic %4, %6, %0, lsl #16\n" \ -+ " mul %1, %3, %4\n" \ -+ " mul %4, %2, %4\n" \ -+ " mul %3, %0, %3\n" \ -+ " mul %0, %2, %0\n" \ -+ " adds %3, %4, %3\n" \ -+ " addcs %0, %0, #65536\n" \ -+ " adds %1, %1, %3, lsl #16\n" \ -+ " adc %0, %0, %3, lsr #16" \ -+ : "=&r" ((USItype) (xh)), \ -+ "=r" ((USItype) (xl)), \ -+ "=&r" (__t0), "=&r" (__t1), "=r" (__t2) \ -+ : "r" ((USItype) (a)), \ -+ "r" ((USItype) (b)));} -+#define UMUL_TIME 20 -+#define UDIV_TIME 100 -+#endif /* __arm__ */ -+ -+#if defined (__hppa) && W_TYPE_SIZE == 32 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("add %4,%5,%1\n\taddc %2,%3,%0" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "%rM" ((USItype) (ah)), \ -+ "rM" ((USItype) (bh)), \ -+ "%rM" ((USItype) (al)), \ -+ "rM" ((USItype) (bl))) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("sub %4,%5,%1\n\tsubb %2,%3,%0" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "rM" ((USItype) (ah)), \ -+ "rM" ((USItype) (bh)), \ -+ "rM" ((USItype) (al)), \ -+ "rM" ((USItype) (bl))) -+#if defined (_PA_RISC1_1) -+#define umul_ppmm(w1, w0, u, v) \ -+ do { \ -+ union \ -+ { \ -+ UDItype __f; \ -+ struct {USItype __w1, __w0;} __w1w0; \ -+ } __t; \ -+ __asm__ ("xmpyu %1,%2,%0" \ -+ : "=x" (__t.__f) \ -+ : "x" ((USItype) (u)), \ -+ "x" ((USItype) (v))); \ -+ (w1) = __t.__w1w0.__w1; \ -+ (w0) = __t.__w1w0.__w0; \ -+ } while (0) -+#define UMUL_TIME 8 -+#else -+#define UMUL_TIME 30 -+#endif -+#define UDIV_TIME 40 -+#define count_leading_zeros(count, x) \ -+ do { \ -+ USItype __tmp; \ -+ __asm__ ( \ -+ "ldi 1,%0\n" \ -+" extru,= %1,15,16,%%r0 ; Bits 31..16 zero?\n" \ -+" extru,tr %1,15,16,%1 ; No. Shift down, skip add.\n"\ -+" ldo 16(%0),%0 ; Yes. Perform add.\n" \ -+" extru,= %1,23,8,%%r0 ; Bits 15..8 zero?\n" \ -+" extru,tr %1,23,8,%1 ; No. Shift down, skip add.\n"\ -+" ldo 8(%0),%0 ; Yes. Perform add.\n" \ -+" extru,= %1,27,4,%%r0 ; Bits 7..4 zero?\n" \ -+" extru,tr %1,27,4,%1 ; No. Shift down, skip add.\n"\ -+" ldo 4(%0),%0 ; Yes. Perform add.\n" \ -+" extru,= %1,29,2,%%r0 ; Bits 3..2 zero?\n" \ -+" extru,tr %1,29,2,%1 ; No. Shift down, skip add.\n"\ -+" ldo 2(%0),%0 ; Yes. Perform add.\n" \ -+" extru %1,30,1,%1 ; Extract bit 1.\n" \ -+" sub %0,%1,%0 ; Subtract it.\n" \ -+ : "=r" (count), "=r" (__tmp) : "1" (x)); \ -+ } while (0) -+#endif -+ -+#if (defined (__i370__) || defined (__mvs__)) && W_TYPE_SIZE == 32 -+#define umul_ppmm(xh, xl, m0, m1) \ -+ do { \ -+ union {UDItype __ll; \ -+ struct {USItype __h, __l;} __i; \ -+ } __xx; \ -+ USItype __m0 = (m0), __m1 = (m1); \ -+ __asm__ ("mr %0,%3" \ -+ : "=r" (__xx.__i.__h), \ -+ "=r" (__xx.__i.__l) \ -+ : "%1" (__m0), \ -+ "r" (__m1)); \ -+ (xh) = __xx.__i.__h; (xl) = __xx.__i.__l; \ -+ (xh) += ((((SItype) __m0 >> 31) & __m1) \ -+ + (((SItype) __m1 >> 31) & __m0)); \ -+ } while (0) -+#define smul_ppmm(xh, xl, m0, m1) \ -+ do { \ -+ union {DItype __ll; \ -+ struct {USItype __h, __l;} __i; \ -+ } __xx; \ -+ __asm__ ("mr %0,%3" \ -+ : "=r" (__xx.__i.__h), \ -+ "=r" (__xx.__i.__l) \ -+ : "%1" (m0), \ -+ "r" (m1)); \ -+ (xh) = __xx.__i.__h; (xl) = __xx.__i.__l; \ -+ } while (0) -+#define sdiv_qrnnd(q, r, n1, n0, d) \ -+ do { \ -+ union {DItype __ll; \ -+ struct {USItype __h, __l;} __i; \ -+ } __xx; \ -+ __xx.__i.__h = n1; __xx.__i.__l = n0; \ -+ __asm__ ("dr %0,%2" \ -+ : "=r" (__xx.__ll) \ -+ : "0" (__xx.__ll), "r" (d)); \ -+ (q) = __xx.__i.__l; (r) = __xx.__i.__h; \ -+ } while (0) -+#endif -+ -+#if (defined (__i386__) || defined (__i486__)) && W_TYPE_SIZE == 32 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("addl %5,%1\n\tadcl %3,%0" \ -+ : "=r" (sh), \ -+ "=&r" (sl) \ -+ : "%0" ((USItype) (ah)), \ -+ "g" ((USItype) (bh)), \ -+ "%1" ((USItype) (al)), \ -+ "g" ((USItype) (bl))) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("subl %5,%1\n\tsbbl %3,%0" \ -+ : "=r" (sh), \ -+ "=&r" (sl) \ -+ : "0" ((USItype) (ah)), \ -+ "g" ((USItype) (bh)), \ -+ "1" ((USItype) (al)), \ -+ "g" ((USItype) (bl))) -+#define umul_ppmm(w1, w0, u, v) \ -+ __asm__ ("mull %3" \ -+ : "=a" (w0), \ -+ "=d" (w1) \ -+ : "%0" ((USItype) (u)), \ -+ "rm" ((USItype) (v))) -+#define udiv_qrnnd(q, r, n1, n0, dv) \ -+ __asm__ ("divl %4" \ -+ : "=a" (q), \ -+ "=d" (r) \ -+ : "0" ((USItype) (n0)), \ -+ "1" ((USItype) (n1)), \ -+ "rm" ((USItype) (dv))) -+#define count_leading_zeros(count, x) \ -+ do { \ -+ USItype __cbtmp; \ -+ __asm__ ("bsrl %1,%0" \ -+ : "=r" (__cbtmp) : "rm" ((USItype) (x))); \ -+ (count) = __cbtmp ^ 31; \ -+ } while (0) -+#define count_trailing_zeros(count, x) \ -+ __asm__ ("bsfl %1,%0" : "=r" (count) : "rm" ((USItype)(x))) -+#define UMUL_TIME 40 -+#define UDIV_TIME 40 -+#endif /* 80x86 */ -+ -+#if defined (__i960__) && W_TYPE_SIZE == 32 -+#define umul_ppmm(w1, w0, u, v) \ -+ ({union {UDItype __ll; \ -+ struct {USItype __l, __h;} __i; \ -+ } __xx; \ -+ __asm__ ("emul %2,%1,%0" \ -+ : "=d" (__xx.__ll) \ -+ : "%dI" ((USItype) (u)), \ -+ "dI" ((USItype) (v))); \ -+ (w1) = __xx.__i.__h; (w0) = __xx.__i.__l;}) -+#define __umulsidi3(u, v) \ -+ ({UDItype __w; \ -+ __asm__ ("emul %2,%1,%0" \ -+ : "=d" (__w) \ -+ : "%dI" ((USItype) (u)), \ -+ "dI" ((USItype) (v))); \ -+ __w; }) -+#endif /* __i960__ */ -+ -+#if defined (__M32R__) && W_TYPE_SIZE == 32 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ /* The cmp clears the condition bit. */ \ -+ __asm__ ("cmp %0,%0\n\taddx %%5,%1\n\taddx %%3,%0" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "%0" ((USItype) (ah)), \ -+ "r" ((USItype) (bh)), \ -+ "%1" ((USItype) (al)), \ -+ "r" ((USItype) (bl)) \ -+ : "cbit") -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ /* The cmp clears the condition bit. */ \ -+ __asm__ ("cmp %0,%0\n\tsubx %5,%1\n\tsubx %3,%0" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "0" ((USItype) (ah)), \ -+ "r" ((USItype) (bh)), \ -+ "1" ((USItype) (al)), \ -+ "r" ((USItype) (bl)) \ -+ : "cbit") -+#endif /* __M32R__ */ -+ -+#if defined (__mc68000__) && W_TYPE_SIZE == 32 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("add%.l %5,%1\n\taddx%.l %3,%0" \ -+ : "=d" ((USItype) (sh)), \ -+ "=&d" ((USItype) (sl)) \ -+ : "%0" ((USItype) (ah)), \ -+ "d" ((USItype) (bh)), \ -+ "%1" ((USItype) (al)), \ -+ "g" ((USItype) (bl))) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("sub%.l %5,%1\n\tsubx%.l %3,%0" \ -+ : "=d" ((USItype) (sh)), \ -+ "=&d" ((USItype) (sl)) \ -+ : "0" ((USItype) (ah)), \ -+ "d" ((USItype) (bh)), \ -+ "1" ((USItype) (al)), \ -+ "g" ((USItype) (bl))) -+ -+/* The '020, '030, '040 and CPU32 have 32x32->64 and 64/32->32q-32r. */ -+#if defined (__mc68020__) || defined(mc68020) \ -+ || defined(__mc68030__) || defined(mc68030) \ -+ || defined(__mc68040__) || defined(mc68040) \ -+ || defined(__mcpu32__) || defined(mcpu32) -+#define umul_ppmm(w1, w0, u, v) \ -+ __asm__ ("mulu%.l %3,%1:%0" \ -+ : "=d" ((USItype) (w0)), \ -+ "=d" ((USItype) (w1)) \ -+ : "%0" ((USItype) (u)), \ -+ "dmi" ((USItype) (v))) -+#define UMUL_TIME 45 -+#define udiv_qrnnd(q, r, n1, n0, d) \ -+ __asm__ ("divu%.l %4,%1:%0" \ -+ : "=d" ((USItype) (q)), \ -+ "=d" ((USItype) (r)) \ -+ : "0" ((USItype) (n0)), \ -+ "1" ((USItype) (n1)), \ -+ "dmi" ((USItype) (d))) -+#define UDIV_TIME 90 -+#define sdiv_qrnnd(q, r, n1, n0, d) \ -+ __asm__ ("divs%.l %4,%1:%0" \ -+ : "=d" ((USItype) (q)), \ -+ "=d" ((USItype) (r)) \ -+ : "0" ((USItype) (n0)), \ -+ "1" ((USItype) (n1)), \ -+ "dmi" ((USItype) (d))) -+ -+#else /* not mc68020 */ -+#if !defined(__mcf5200__) -+/* %/ inserts REGISTER_PREFIX, %# inserts IMMEDIATE_PREFIX. */ -+#define umul_ppmm(xh, xl, a, b) \ -+ __asm__ ("| Inlined umul_ppmm\n" \ -+ " move%.l %2,%/d0\n" \ -+ " move%.l %3,%/d1\n" \ -+ " move%.l %/d0,%/d2\n" \ -+ " swap %/d0\n" \ -+ " move%.l %/d1,%/d3\n" \ -+ " swap %/d1\n" \ -+ " move%.w %/d2,%/d4\n" \ -+ " mulu %/d3,%/d4\n" \ -+ " mulu %/d1,%/d2\n" \ -+ " mulu %/d0,%/d3\n" \ -+ " mulu %/d0,%/d1\n" \ -+ " move%.l %/d4,%/d0\n" \ -+ " eor%.w %/d0,%/d0\n" \ -+ " swap %/d0\n" \ -+ " add%.l %/d0,%/d2\n" \ -+ " add%.l %/d3,%/d2\n" \ -+ " jcc 1f\n" \ -+ " add%.l %#65536,%/d1\n" \ -+ "1: swap %/d2\n" \ -+ " moveq %#0,%/d0\n" \ -+ " move%.w %/d2,%/d0\n" \ -+ " move%.w %/d4,%/d2\n" \ -+ " move%.l %/d2,%1\n" \ -+ " add%.l %/d1,%/d0\n" \ -+ " move%.l %/d0,%0" \ -+ : "=g" ((USItype) (xh)), \ -+ "=g" ((USItype) (xl)) \ -+ : "g" ((USItype) (a)), \ -+ "g" ((USItype) (b)) \ -+ : "d0", "d1", "d2", "d3", "d4") -+#define UMUL_TIME 100 -+#define UDIV_TIME 400 -+#endif /* not mcf5200 */ -+#endif /* not mc68020 */ -+ -+/* The '020, '030, '040 and '060 have bitfield insns. */ -+#if defined (__mc68020__) || defined(mc68020) \ -+ || defined(__mc68030__) || defined(mc68030) \ -+ || defined(__mc68040__) || defined(mc68040) \ -+ || defined(__mc68060__) || defined(mc68060) -+#define count_leading_zeros(count, x) \ -+ __asm__ ("bfffo %1{%b2:%b2},%0" \ -+ : "=d" ((USItype) (count)) \ -+ : "od" ((USItype) (x)), "n" (0)) -+#endif -+#endif /* mc68000 */ -+ -+#if defined (__m88000__) && W_TYPE_SIZE == 32 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("addu.co %1,%r4,%r5\n\taddu.ci %0,%r2,%r3" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "%rJ" ((USItype) (ah)), \ -+ "rJ" ((USItype) (bh)), \ -+ "%rJ" ((USItype) (al)), \ -+ "rJ" ((USItype) (bl))) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("subu.co %1,%r4,%r5\n\tsubu.ci %0,%r2,%r3" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "rJ" ((USItype) (ah)), \ -+ "rJ" ((USItype) (bh)), \ -+ "rJ" ((USItype) (al)), \ -+ "rJ" ((USItype) (bl))) -+#define count_leading_zeros(count, x) \ -+ do { \ -+ USItype __cbtmp; \ -+ __asm__ ("ff1 %0,%1" \ -+ : "=r" (__cbtmp) \ -+ : "r" ((USItype) (x))); \ -+ (count) = __cbtmp ^ 31; \ -+ } while (0) -+#define COUNT_LEADING_ZEROS_0 63 /* sic */ -+#if defined (__mc88110__) -+#define umul_ppmm(wh, wl, u, v) \ -+ do { \ -+ union {UDItype __ll; \ -+ struct {USItype __h, __l;} __i; \ -+ } __xx; \ -+ __asm__ ("mulu.d %0,%1,%2" \ -+ : "=r" (__xx.__ll) \ -+ : "r" ((USItype) (u)), \ -+ "r" ((USItype) (v))); \ -+ (wh) = __xx.__i.__h; \ -+ (wl) = __xx.__i.__l; \ -+ } while (0) -+#define udiv_qrnnd(q, r, n1, n0, d) \ -+ ({union {UDItype __ll; \ -+ struct {USItype __h, __l;} __i; \ -+ } __xx; \ -+ USItype __q; \ -+ __xx.__i.__h = (n1); __xx.__i.__l = (n0); \ -+ __asm__ ("divu.d %0,%1,%2" \ -+ : "=r" (__q) \ -+ : "r" (__xx.__ll), \ -+ "r" ((USItype) (d))); \ -+ (r) = (n0) - __q * (d); (q) = __q; }) -+#define UMUL_TIME 5 -+#define UDIV_TIME 25 -+#else -+#define UMUL_TIME 17 -+#define UDIV_TIME 150 -+#endif /* __mc88110__ */ -+#endif /* __m88000__ */ -+ -+#if defined (__mips__) && W_TYPE_SIZE == 32 -+#define umul_ppmm(w1, w0, u, v) \ -+ __asm__ ("multu %2,%3" \ -+ : "=l" ((USItype) (w0)), \ -+ "=h" ((USItype) (w1)) \ -+ : "d" ((USItype) (u)), \ -+ "d" ((USItype) (v))) -+#define UMUL_TIME 10 -+#define UDIV_TIME 100 -+#endif /* __mips__ */ -+ -+#if defined (__ns32000__) && W_TYPE_SIZE == 32 -+#define umul_ppmm(w1, w0, u, v) \ -+ ({union {UDItype __ll; \ -+ struct {USItype __l, __h;} __i; \ -+ } __xx; \ -+ __asm__ ("meid %2,%0" \ -+ : "=g" (__xx.__ll) \ -+ : "%0" ((USItype) (u)), \ -+ "g" ((USItype) (v))); \ -+ (w1) = __xx.__i.__h; (w0) = __xx.__i.__l;}) -+#define __umulsidi3(u, v) \ -+ ({UDItype __w; \ -+ __asm__ ("meid %2,%0" \ -+ : "=g" (__w) \ -+ : "%0" ((USItype) (u)), \ -+ "g" ((USItype) (v))); \ -+ __w; }) -+#define udiv_qrnnd(q, r, n1, n0, d) \ -+ ({union {UDItype __ll; \ -+ struct {USItype __l, __h;} __i; \ -+ } __xx; \ -+ __xx.__i.__h = (n1); __xx.__i.__l = (n0); \ -+ __asm__ ("deid %2,%0" \ -+ : "=g" (__xx.__ll) \ -+ : "0" (__xx.__ll), \ -+ "g" ((USItype) (d))); \ -+ (r) = __xx.__i.__l; (q) = __xx.__i.__h; }) -+#define count_trailing_zeros(count,x) \ -+ do { \ -+ __asm__ ("ffsd %2,%0" \ -+ : "=r" ((USItype) (count)) \ -+ : "0" ((USItype) 0), \ -+ "r" ((USItype) (x))); \ -+ } while (0) -+#endif /* __ns32000__ */ -+ -+/* FIXME: We should test _IBMR2 here when we add assembly support for the -+ system vendor compilers. -+ FIXME: What's needed for gcc PowerPC VxWorks? __vxworks__ is not good -+ enough, since that hits ARM and m68k too. */ -+#if (defined (_ARCH_PPC) /* AIX */ \ -+ || defined (_ARCH_PWR) /* AIX */ \ -+ || defined (_ARCH_COM) /* AIX */ \ -+ || defined (__powerpc__) /* gcc */ \ -+ || defined (__POWERPC__) /* BEOS */ \ -+ || defined (__ppc__) /* Darwin */ \ -+ || defined (PPC) /* GNU/Linux, SysV */ \ -+ ) && W_TYPE_SIZE == 32 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ do { \ -+ if (__builtin_constant_p (bh) && (bh) == 0) \ -+ __asm__ ("{a%I4|add%I4c} %1,%3,%4\n\t{aze|addze} %0,%2" \ -+ : "=r" (sh), "=&r" (sl) : "r" (ah), "%r" (al), "rI" (bl));\ -+ else if (__builtin_constant_p (bh) && (bh) == ~(USItype) 0) \ -+ __asm__ ("{a%I4|add%I4c} %1,%3,%4\n\t{ame|addme} %0,%2" \ -+ : "=r" (sh), "=&r" (sl) : "r" (ah), "%r" (al), "rI" (bl));\ -+ else \ -+ __asm__ ("{a%I5|add%I5c} %1,%4,%5\n\t{ae|adde} %0,%2,%3" \ -+ : "=r" (sh), "=&r" (sl) \ -+ : "%r" (ah), "r" (bh), "%r" (al), "rI" (bl)); \ -+ } while (0) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ do { \ -+ if (__builtin_constant_p (ah) && (ah) == 0) \ -+ __asm__ ("{sf%I3|subf%I3c} %1,%4,%3\n\t{sfze|subfze} %0,%2" \ -+ : "=r" (sh), "=&r" (sl) : "r" (bh), "rI" (al), "r" (bl));\ -+ else if (__builtin_constant_p (ah) && (ah) == ~(USItype) 0) \ -+ __asm__ ("{sf%I3|subf%I3c} %1,%4,%3\n\t{sfme|subfme} %0,%2" \ -+ : "=r" (sh), "=&r" (sl) : "r" (bh), "rI" (al), "r" (bl));\ -+ else if (__builtin_constant_p (bh) && (bh) == 0) \ -+ __asm__ ("{sf%I3|subf%I3c} %1,%4,%3\n\t{ame|addme} %0,%2" \ -+ : "=r" (sh), "=&r" (sl) : "r" (ah), "rI" (al), "r" (bl));\ -+ else if (__builtin_constant_p (bh) && (bh) == ~(USItype) 0) \ -+ __asm__ ("{sf%I3|subf%I3c} %1,%4,%3\n\t{aze|addze} %0,%2" \ -+ : "=r" (sh), "=&r" (sl) : "r" (ah), "rI" (al), "r" (bl));\ -+ else \ -+ __asm__ ("{sf%I4|subf%I4c} %1,%5,%4\n\t{sfe|subfe} %0,%3,%2" \ -+ : "=r" (sh), "=&r" (sl) \ -+ : "r" (ah), "r" (bh), "rI" (al), "r" (bl)); \ -+ } while (0) -+#define count_leading_zeros(count, x) \ -+ __asm__ ("{cntlz|cntlzw} %0,%1" : "=r" (count) : "r" (x)) -+#define COUNT_LEADING_ZEROS_0 32 -+#if defined (_ARCH_PPC) || defined (__powerpc__) || defined (__POWERPC__) \ -+ || defined (__ppc__) || defined (PPC) || defined (__vxworks__) -+#define umul_ppmm(ph, pl, m0, m1) \ -+ do { \ -+ USItype __m0 = (m0), __m1 = (m1); \ -+ __asm__ ("mulhwu %0,%1,%2" : "=r" (ph) : "%r" (m0), "r" (m1)); \ -+ (pl) = __m0 * __m1; \ -+ } while (0) -+#define UMUL_TIME 15 -+#define smul_ppmm(ph, pl, m0, m1) \ -+ do { \ -+ SItype __m0 = (m0), __m1 = (m1); \ -+ __asm__ ("mulhw %0,%1,%2" : "=r" (ph) : "%r" (m0), "r" (m1)); \ -+ (pl) = __m0 * __m1; \ -+ } while (0) -+#define SMUL_TIME 14 -+#define UDIV_TIME 120 -+#elif defined (_ARCH_PWR) -+#define UMUL_TIME 8 -+#define smul_ppmm(xh, xl, m0, m1) \ -+ __asm__ ("mul %0,%2,%3" : "=r" (xh), "=q" (xl) : "r" (m0), "r" (m1)) -+#define SMUL_TIME 4 -+#define sdiv_qrnnd(q, r, nh, nl, d) \ -+ __asm__ ("div %0,%2,%4" : "=r" (q), "=q" (r) : "r" (nh), "1" (nl), "r" (d)) -+#define UDIV_TIME 100 -+#endif -+#endif /* 32-bit POWER architecture variants. */ -+ -+/* We should test _IBMR2 here when we add assembly support for the system -+ vendor compilers. */ -+#if (defined (_ARCH_PPC64) || defined (__powerpc64__)) && W_TYPE_SIZE == 64 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ do { \ -+ if (__builtin_constant_p (bh) && (bh) == 0) \ -+ __asm__ ("{a%I4|add%I4c} %1,%3,%4\n\t{aze|addze} %0,%2" \ -+ : "=r" (sh), "=&r" (sl) : "r" (ah), "%r" (al), "rI" (bl));\ -+ else if (__builtin_constant_p (bh) && (bh) == ~(UDItype) 0) \ -+ __asm__ ("{a%I4|add%I4c} %1,%3,%4\n\t{ame|addme} %0,%2" \ -+ : "=r" (sh), "=&r" (sl) : "r" (ah), "%r" (al), "rI" (bl));\ -+ else \ -+ __asm__ ("{a%I5|add%I5c} %1,%4,%5\n\t{ae|adde} %0,%2,%3" \ -+ : "=r" (sh), "=&r" (sl) \ -+ : "%r" (ah), "r" (bh), "%r" (al), "rI" (bl)); \ -+ } while (0) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ do { \ -+ if (__builtin_constant_p (ah) && (ah) == 0) \ -+ __asm__ ("{sf%I3|subf%I3c} %1,%4,%3\n\t{sfze|subfze} %0,%2" \ -+ : "=r" (sh), "=&r" (sl) : "r" (bh), "rI" (al), "r" (bl));\ -+ else if (__builtin_constant_p (ah) && (ah) == ~(UDItype) 0) \ -+ __asm__ ("{sf%I3|subf%I3c} %1,%4,%3\n\t{sfme|subfme} %0,%2" \ -+ : "=r" (sh), "=&r" (sl) : "r" (bh), "rI" (al), "r" (bl));\ -+ else if (__builtin_constant_p (bh) && (bh) == 0) \ -+ __asm__ ("{sf%I3|subf%I3c} %1,%4,%3\n\t{ame|addme} %0,%2" \ -+ : "=r" (sh), "=&r" (sl) : "r" (ah), "rI" (al), "r" (bl));\ -+ else if (__builtin_constant_p (bh) && (bh) == ~(UDItype) 0) \ -+ __asm__ ("{sf%I3|subf%I3c} %1,%4,%3\n\t{aze|addze} %0,%2" \ -+ : "=r" (sh), "=&r" (sl) : "r" (ah), "rI" (al), "r" (bl));\ -+ else \ -+ __asm__ ("{sf%I4|subf%I4c} %1,%5,%4\n\t{sfe|subfe} %0,%3,%2" \ -+ : "=r" (sh), "=&r" (sl) \ -+ : "r" (ah), "r" (bh), "rI" (al), "r" (bl)); \ -+ } while (0) -+#define count_leading_zeros(count, x) \ -+ __asm__ ("cntlzd %0,%1" : "=r" (count) : "r" (x)) -+#define COUNT_LEADING_ZEROS_0 64 -+#define umul_ppmm(ph, pl, m0, m1) \ -+ do { \ -+ UDItype __m0 = (m0), __m1 = (m1); \ -+ __asm__ ("mulhdu %0,%1,%2" : "=r" (ph) : "%r" (m0), "r" (m1)); \ -+ (pl) = __m0 * __m1; \ -+ } while (0) -+#define UMUL_TIME 15 -+#define smul_ppmm(ph, pl, m0, m1) \ -+ do { \ -+ DItype __m0 = (m0), __m1 = (m1); \ -+ __asm__ ("mulhd %0,%1,%2" : "=r" (ph) : "%r" (m0), "r" (m1)); \ -+ (pl) = __m0 * __m1; \ -+ } while (0) -+#define SMUL_TIME 14 /* ??? */ -+#define UDIV_TIME 120 /* ??? */ -+#endif /* 64-bit PowerPC. */ -+ -+#if defined (__ibm032__) /* RT/ROMP */ && W_TYPE_SIZE == 32 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("a %1,%5\n\tae %0,%3" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "%0" ((USItype) (ah)), \ -+ "r" ((USItype) (bh)), \ -+ "%1" ((USItype) (al)), \ -+ "r" ((USItype) (bl))) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("s %1,%5\n\tse %0,%3" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "0" ((USItype) (ah)), \ -+ "r" ((USItype) (bh)), \ -+ "1" ((USItype) (al)), \ -+ "r" ((USItype) (bl))) -+#define umul_ppmm(ph, pl, m0, m1) \ -+ do { \ -+ USItype __m0 = (m0), __m1 = (m1); \ -+ __asm__ ( \ -+ "s r2,r2\n" \ -+" mts r10,%2\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" m r2,%3\n" \ -+" cas %0,r2,r0\n" \ -+" mfs r10,%1" \ -+ : "=r" ((USItype) (ph)), \ -+ "=r" ((USItype) (pl)) \ -+ : "%r" (__m0), \ -+ "r" (__m1) \ -+ : "r2"); \ -+ (ph) += ((((SItype) __m0 >> 31) & __m1) \ -+ + (((SItype) __m1 >> 31) & __m0)); \ -+ } while (0) -+#define UMUL_TIME 20 -+#define UDIV_TIME 200 -+#define count_leading_zeros(count, x) \ -+ do { \ -+ if ((x) >= 0x10000) \ -+ __asm__ ("clz %0,%1" \ -+ : "=r" ((USItype) (count)) \ -+ : "r" ((USItype) (x) >> 16)); \ -+ else \ -+ { \ -+ __asm__ ("clz %0,%1" \ -+ : "=r" ((USItype) (count)) \ -+ : "r" ((USItype) (x))); \ -+ (count) += 16; \ -+ } \ -+ } while (0) -+#endif -+ -+#if defined (__sh2__) && W_TYPE_SIZE == 32 -+#define umul_ppmm(w1, w0, u, v) \ -+ __asm__ ( \ -+ "dmulu.l %2,%3\n\tsts macl,%1\n\tsts mach,%0" \ -+ : "=r" ((USItype)(w1)), \ -+ "=r" ((USItype)(w0)) \ -+ : "r" ((USItype)(u)), \ -+ "r" ((USItype)(v)) \ -+ : "macl", "mach") -+#define UMUL_TIME 5 -+#endif -+ -+#if defined (__SH5__) && __SHMEDIA__ && W_TYPE_SIZE == 32 -+#define __umulsidi3(u,v) ((UDItype)(USItype)u*(USItype)v) -+#define count_leading_zeros(count, x) \ -+ do \ -+ { \ -+ UDItype x_ = (USItype)(x); \ -+ SItype c_; \ -+ \ -+ __asm__ ("nsb %1, %0" : "=r" (c_) : "r" (x_)); \ -+ (count) = c_ - 31; \ -+ } \ -+ while (0) -+#define COUNT_LEADING_ZEROS_0 32 -+#endif -+ -+#if defined (__sparc__) && !defined (__arch64__) && !defined (__sparcv9) \ -+ && W_TYPE_SIZE == 32 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("addcc %r4,%5,%1\n\taddx %r2,%3,%0" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "%rJ" ((USItype) (ah)), \ -+ "rI" ((USItype) (bh)), \ -+ "%rJ" ((USItype) (al)), \ -+ "rI" ((USItype) (bl)) \ -+ __CLOBBER_CC) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("subcc %r4,%5,%1\n\tsubx %r2,%3,%0" \ -+ : "=r" ((USItype) (sh)), \ -+ "=&r" ((USItype) (sl)) \ -+ : "rJ" ((USItype) (ah)), \ -+ "rI" ((USItype) (bh)), \ -+ "rJ" ((USItype) (al)), \ -+ "rI" ((USItype) (bl)) \ -+ __CLOBBER_CC) -+#if defined (__sparc_v8__) -+#define umul_ppmm(w1, w0, u, v) \ -+ __asm__ ("umul %2,%3,%1;rd %%y,%0" \ -+ : "=r" ((USItype) (w1)), \ -+ "=r" ((USItype) (w0)) \ -+ : "r" ((USItype) (u)), \ -+ "r" ((USItype) (v))) -+#define udiv_qrnnd(__q, __r, __n1, __n0, __d) \ -+ __asm__ ("mov %2,%%y;nop;nop;nop;udiv %3,%4,%0;umul %0,%4,%1;sub %3,%1,%1"\ -+ : "=&r" ((USItype) (__q)), \ -+ "=&r" ((USItype) (__r)) \ -+ : "r" ((USItype) (__n1)), \ -+ "r" ((USItype) (__n0)), \ -+ "r" ((USItype) (__d))) -+#else -+#if defined (__sparclite__) -+/* This has hardware multiply but not divide. It also has two additional -+ instructions scan (ffs from high bit) and divscc. */ -+#define umul_ppmm(w1, w0, u, v) \ -+ __asm__ ("umul %2,%3,%1;rd %%y,%0" \ -+ : "=r" ((USItype) (w1)), \ -+ "=r" ((USItype) (w0)) \ -+ : "r" ((USItype) (u)), \ -+ "r" ((USItype) (v))) -+#define udiv_qrnnd(q, r, n1, n0, d) \ -+ __asm__ ("! Inlined udiv_qrnnd\n" \ -+" wr %%g0,%2,%%y ! Not a delayed write for sparclite\n" \ -+" tst %%g0\n" \ -+" divscc %3,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%%g1\n" \ -+" divscc %%g1,%4,%0\n" \ -+" rd %%y,%1\n" \ -+" bl,a 1f\n" \ -+" add %1,%4,%1\n" \ -+"1: ! End of inline udiv_qrnnd" \ -+ : "=r" ((USItype) (q)), \ -+ "=r" ((USItype) (r)) \ -+ : "r" ((USItype) (n1)), \ -+ "r" ((USItype) (n0)), \ -+ "rI" ((USItype) (d)) \ -+ : "g1" __AND_CLOBBER_CC) -+#define UDIV_TIME 37 -+#define count_leading_zeros(count, x) \ -+ do { \ -+ __asm__ ("scan %1,1,%0" \ -+ : "=r" ((USItype) (count)) \ -+ : "r" ((USItype) (x))); \ -+ } while (0) -+/* Early sparclites return 63 for an argument of 0, but they warn that future -+ implementations might change this. Therefore, leave COUNT_LEADING_ZEROS_0 -+ undefined. */ -+#else -+/* SPARC without integer multiplication and divide instructions. -+ (i.e. at least Sun4/20,40,60,65,75,110,260,280,330,360,380,470,490) */ -+#define umul_ppmm(w1, w0, u, v) \ -+ __asm__ ("! Inlined umul_ppmm\n" \ -+" wr %%g0,%2,%%y ! SPARC has 0-3 delay insn after a wr\n"\ -+" sra %3,31,%%o5 ! Don't move this insn\n" \ -+" and %2,%%o5,%%o5 ! Don't move this insn\n" \ -+" andcc %%g0,0,%%g1 ! Don't move this insn\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,%3,%%g1\n" \ -+" mulscc %%g1,0,%%g1\n" \ -+" add %%g1,%%o5,%0\n" \ -+" rd %%y,%1" \ -+ : "=r" ((USItype) (w1)), \ -+ "=r" ((USItype) (w0)) \ -+ : "%rI" ((USItype) (u)), \ -+ "r" ((USItype) (v)) \ -+ : "g1", "o5" __AND_CLOBBER_CC) -+#define UMUL_TIME 39 /* 39 instructions */ -+/* It's quite necessary to add this much assembler for the sparc. -+ The default udiv_qrnnd (in C) is more than 10 times slower! */ -+#define udiv_qrnnd(__q, __r, __n1, __n0, __d) \ -+ __asm__ ("! Inlined udiv_qrnnd\n" \ -+" mov 32,%%g1\n" \ -+" subcc %1,%2,%%g0\n" \ -+"1: bcs 5f\n" \ -+" addxcc %0,%0,%0 ! shift n1n0 and a q-bit in lsb\n" \ -+" sub %1,%2,%1 ! this kills msb of n\n" \ -+" addx %1,%1,%1 ! so this can't give carry\n" \ -+" subcc %%g1,1,%%g1\n" \ -+"2: bne 1b\n" \ -+" subcc %1,%2,%%g0\n" \ -+" bcs 3f\n" \ -+" addxcc %0,%0,%0 ! shift n1n0 and a q-bit in lsb\n" \ -+" b 3f\n" \ -+" sub %1,%2,%1 ! this kills msb of n\n" \ -+"4: sub %1,%2,%1\n" \ -+"5: addxcc %1,%1,%1\n" \ -+" bcc 2b\n" \ -+" subcc %%g1,1,%%g1\n" \ -+"! Got carry from n. Subtract next step to cancel this carry.\n" \ -+" bne 4b\n" \ -+" addcc %0,%0,%0 ! shift n1n0 and a 0-bit in lsb\n" \ -+" sub %1,%2,%1\n" \ -+"3: xnor %0,0,%0\n" \ -+" ! End of inline udiv_qrnnd" \ -+ : "=&r" ((USItype) (__q)), \ -+ "=&r" ((USItype) (__r)) \ -+ : "r" ((USItype) (__d)), \ -+ "1" ((USItype) (__n1)), \ -+ "0" ((USItype) (__n0)) : "g1" __AND_CLOBBER_CC) -+#define UDIV_TIME (3+7*32) /* 7 instructions/iteration. 32 iterations. */ -+#endif /* __sparclite__ */ -+#endif /* __sparc_v8__ */ -+#endif /* sparc32 */ -+ -+#if ((defined (__sparc__) && defined (__arch64__)) || defined (__sparcv9)) \ -+ && W_TYPE_SIZE == 64 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("addcc %r4,%5,%1\n\t" \ -+ "add %r2,%3,%0\n\t" \ -+ "bcs,a,pn %%xcc, 1f\n\t" \ -+ "add %0, 1, %0\n" \ -+ "1:" \ -+ : "=r" ((UDItype)(sh)), \ -+ "=&r" ((UDItype)(sl)) \ -+ : "%rJ" ((UDItype)(ah)), \ -+ "rI" ((UDItype)(bh)), \ -+ "%rJ" ((UDItype)(al)), \ -+ "rI" ((UDItype)(bl)) \ -+ __CLOBBER_CC) -+ -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("subcc %r4,%5,%1\n\t" \ -+ "sub %r2,%3,%0\n\t" \ -+ "bcs,a,pn %%xcc, 1f\n\t" \ -+ "sub %0, 1, %0\n\t" \ -+ "1:" \ -+ : "=r" ((UDItype)(sh)), \ -+ "=&r" ((UDItype)(sl)) \ -+ : "rJ" ((UDItype)(ah)), \ -+ "rI" ((UDItype)(bh)), \ -+ "rJ" ((UDItype)(al)), \ -+ "rI" ((UDItype)(bl)) \ -+ __CLOBBER_CC) -+ -+#define umul_ppmm(wh, wl, u, v) \ -+ do { \ -+ UDItype tmp1, tmp2, tmp3, tmp4; \ -+ __asm__ __volatile__ ( \ -+ "srl %7,0,%3\n\t" \ -+ "mulx %3,%6,%1\n\t" \ -+ "srlx %6,32,%2\n\t" \ -+ "mulx %2,%3,%4\n\t" \ -+ "sllx %4,32,%5\n\t" \ -+ "srl %6,0,%3\n\t" \ -+ "sub %1,%5,%5\n\t" \ -+ "srlx %5,32,%5\n\t" \ -+ "addcc %4,%5,%4\n\t" \ -+ "srlx %7,32,%5\n\t" \ -+ "mulx %3,%5,%3\n\t" \ -+ "mulx %2,%5,%5\n\t" \ -+ "sethi %%hi(0x80000000),%2\n\t" \ -+ "addcc %4,%3,%4\n\t" \ -+ "srlx %4,32,%4\n\t" \ -+ "add %2,%2,%2\n\t" \ -+ "movcc %%xcc,%%g0,%2\n\t" \ -+ "addcc %5,%4,%5\n\t" \ -+ "sllx %3,32,%3\n\t" \ -+ "add %1,%3,%1\n\t" \ -+ "add %5,%2,%0" \ -+ : "=r" ((UDItype)(wh)), \ -+ "=&r" ((UDItype)(wl)), \ -+ "=&r" (tmp1), "=&r" (tmp2), "=&r" (tmp3), "=&r" (tmp4) \ -+ : "r" ((UDItype)(u)), \ -+ "r" ((UDItype)(v)) \ -+ __CLOBBER_CC); \ -+ } while (0) -+#define UMUL_TIME 96 -+#define UDIV_TIME 230 -+#endif /* sparc64 */ -+ -+#if defined (__vax__) && W_TYPE_SIZE == 32 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("addl2 %5,%1\n\tadwc %3,%0" \ -+ : "=g" ((USItype) (sh)), \ -+ "=&g" ((USItype) (sl)) \ -+ : "%0" ((USItype) (ah)), \ -+ "g" ((USItype) (bh)), \ -+ "%1" ((USItype) (al)), \ -+ "g" ((USItype) (bl))) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("subl2 %5,%1\n\tsbwc %3,%0" \ -+ : "=g" ((USItype) (sh)), \ -+ "=&g" ((USItype) (sl)) \ -+ : "0" ((USItype) (ah)), \ -+ "g" ((USItype) (bh)), \ -+ "1" ((USItype) (al)), \ -+ "g" ((USItype) (bl))) -+#define umul_ppmm(xh, xl, m0, m1) \ -+ do { \ -+ union { \ -+ UDItype __ll; \ -+ struct {USItype __l, __h;} __i; \ -+ } __xx; \ -+ USItype __m0 = (m0), __m1 = (m1); \ -+ __asm__ ("emul %1,%2,$0,%0" \ -+ : "=r" (__xx.__ll) \ -+ : "g" (__m0), \ -+ "g" (__m1)); \ -+ (xh) = __xx.__i.__h; \ -+ (xl) = __xx.__i.__l; \ -+ (xh) += ((((SItype) __m0 >> 31) & __m1) \ -+ + (((SItype) __m1 >> 31) & __m0)); \ -+ } while (0) -+#define sdiv_qrnnd(q, r, n1, n0, d) \ -+ do { \ -+ union {DItype __ll; \ -+ struct {SItype __l, __h;} __i; \ -+ } __xx; \ -+ __xx.__i.__h = n1; __xx.__i.__l = n0; \ -+ __asm__ ("ediv %3,%2,%0,%1" \ -+ : "=g" (q), "=g" (r) \ -+ : "g" (__xx.__ll), "g" (d)); \ -+ } while (0) -+#endif /* __vax__ */ -+ -+#if defined (__z8000__) && W_TYPE_SIZE == 16 -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("add %H1,%H5\n\tadc %H0,%H3" \ -+ : "=r" ((unsigned int)(sh)), \ -+ "=&r" ((unsigned int)(sl)) \ -+ : "%0" ((unsigned int)(ah)), \ -+ "r" ((unsigned int)(bh)), \ -+ "%1" ((unsigned int)(al)), \ -+ "rQR" ((unsigned int)(bl))) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ __asm__ ("sub %H1,%H5\n\tsbc %H0,%H3" \ -+ : "=r" ((unsigned int)(sh)), \ -+ "=&r" ((unsigned int)(sl)) \ -+ : "0" ((unsigned int)(ah)), \ -+ "r" ((unsigned int)(bh)), \ -+ "1" ((unsigned int)(al)), \ -+ "rQR" ((unsigned int)(bl))) -+#define umul_ppmm(xh, xl, m0, m1) \ -+ do { \ -+ union {long int __ll; \ -+ struct {unsigned int __h, __l;} __i; \ -+ } __xx; \ -+ unsigned int __m0 = (m0), __m1 = (m1); \ -+ __asm__ ("mult %S0,%H3" \ -+ : "=r" (__xx.__i.__h), \ -+ "=r" (__xx.__i.__l) \ -+ : "%1" (__m0), \ -+ "rQR" (__m1)); \ -+ (xh) = __xx.__i.__h; (xl) = __xx.__i.__l; \ -+ (xh) += ((((signed int) __m0 >> 15) & __m1) \ -+ + (((signed int) __m1 >> 15) & __m0)); \ -+ } while (0) -+#endif /* __z8000__ */ -+ -+#endif /* __GNUC__ */ -+ -+/* If this machine has no inline assembler, use C macros. */ -+ -+#if !defined (add_ssaaaa) -+#define add_ssaaaa(sh, sl, ah, al, bh, bl) \ -+ do { \ -+ UWtype __x; \ -+ __x = (al) + (bl); \ -+ (sh) = (ah) + (bh) + (__x < (al)); \ -+ (sl) = __x; \ -+ } while (0) -+#endif -+ -+#if !defined (sub_ddmmss) -+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \ -+ do { \ -+ UWtype __x; \ -+ __x = (al) - (bl); \ -+ (sh) = (ah) - (bh) - (__x > (al)); \ -+ (sl) = __x; \ -+ } while (0) -+#endif -+ -+#if !defined (umul_ppmm) -+#define umul_ppmm(w1, w0, u, v) \ -+ do { \ -+ UWtype __x0, __x1, __x2, __x3; \ -+ UHWtype __ul, __vl, __uh, __vh; \ -+ \ -+ __ul = __ll_lowpart (u); \ -+ __uh = __ll_highpart (u); \ -+ __vl = __ll_lowpart (v); \ -+ __vh = __ll_highpart (v); \ -+ \ -+ __x0 = (UWtype) __ul * __vl; \ -+ __x1 = (UWtype) __ul * __vh; \ -+ __x2 = (UWtype) __uh * __vl; \ -+ __x3 = (UWtype) __uh * __vh; \ -+ \ -+ __x1 += __ll_highpart (__x0);/* this can't give carry */ \ -+ __x1 += __x2; /* but this indeed can */ \ -+ if (__x1 < __x2) /* did we get it? */ \ -+ __x3 += __ll_B; /* yes, add it in the proper pos. */ \ -+ \ -+ (w1) = __x3 + __ll_highpart (__x1); \ -+ (w0) = __ll_lowpart (__x1) * __ll_B + __ll_lowpart (__x0); \ -+ } while (0) -+#endif -+ -+#if !defined (__umulsidi3) -+#define __umulsidi3(u, v) \ -+ ({DWunion __w; \ -+ umul_ppmm (__w.s.high, __w.s.low, u, v); \ -+ __w.ll; }) -+#endif -+ -+/* Define this unconditionally, so it can be used for debugging. */ -+#define __udiv_qrnnd_c(q, r, n1, n0, d) \ -+ do { \ -+ UWtype __d1, __d0, __q1, __q0; \ -+ UWtype __r1, __r0, __m; \ -+ __d1 = __ll_highpart (d); \ -+ __d0 = __ll_lowpart (d); \ -+ \ -+ __r1 = (n1) % __d1; \ -+ __q1 = (n1) / __d1; \ -+ __m = (UWtype) __q1 * __d0; \ -+ __r1 = __r1 * __ll_B | __ll_highpart (n0); \ -+ if (__r1 < __m) \ -+ { \ -+ __q1--, __r1 += (d); \ -+ if (__r1 >= (d)) /* i.e. we didn't get carry when adding to __r1 */\ -+ if (__r1 < __m) \ -+ __q1--, __r1 += (d); \ -+ } \ -+ __r1 -= __m; \ -+ \ -+ __r0 = __r1 % __d1; \ -+ __q0 = __r1 / __d1; \ -+ __m = (UWtype) __q0 * __d0; \ -+ __r0 = __r0 * __ll_B | __ll_lowpart (n0); \ -+ if (__r0 < __m) \ -+ { \ -+ __q0--, __r0 += (d); \ -+ if (__r0 >= (d)) \ -+ if (__r0 < __m) \ -+ __q0--, __r0 += (d); \ -+ } \ -+ __r0 -= __m; \ -+ \ -+ (q) = (UWtype) __q1 * __ll_B | __q0; \ -+ (r) = __r0; \ -+ } while (0) -+ -+/* If the processor has no udiv_qrnnd but sdiv_qrnnd, go through -+ __udiv_w_sdiv (defined in libgcc or elsewhere). */ -+#if !defined (udiv_qrnnd) && defined (sdiv_qrnnd) -+#define udiv_qrnnd(q, r, nh, nl, d) \ -+ do { \ -+ USItype __r; \ -+ (q) = __udiv_w_sdiv (&__r, nh, nl, d); \ -+ (r) = __r; \ -+ } while (0) -+#endif -+ -+/* If udiv_qrnnd was not defined for this processor, use __udiv_qrnnd_c. */ -+#if !defined (udiv_qrnnd) -+#define UDIV_NEEDS_NORMALIZATION 1 -+#define udiv_qrnnd __udiv_qrnnd_c -+#endif -+ -+#if !defined (count_leading_zeros) -+extern const UQItype __clz_tab[]; -+#define count_leading_zeros(count, x) \ -+ do { \ -+ UWtype __xr = (x); \ -+ UWtype __a; \ -+ \ -+ if (W_TYPE_SIZE <= 32) \ -+ { \ -+ __a = __xr < ((UWtype)1<<2*__BITS4) \ -+ ? (__xr < ((UWtype)1<<__BITS4) ? 0 : __BITS4) \ -+ : (__xr < ((UWtype)1<<3*__BITS4) ? 2*__BITS4 : 3*__BITS4); \ -+ } \ -+ else \ -+ { \ -+ for (__a = W_TYPE_SIZE - 8; __a > 0; __a -= 8) \ -+ if (((__xr >> __a) & 0xff) != 0) \ -+ break; \ -+ } \ -+ \ -+ (count) = W_TYPE_SIZE - (__clz_tab[__xr >> __a] + __a); \ -+ } while (0) -+#define COUNT_LEADING_ZEROS_0 W_TYPE_SIZE -+#endif -+ -+#if !defined (count_trailing_zeros) -+/* Define count_trailing_zeros using count_leading_zeros. The latter might be -+ defined in asm, but if it is not, the C version above is good enough. */ -+#define count_trailing_zeros(count, x) \ -+ do { \ -+ UWtype __ctz_x = (x); \ -+ UWtype __ctz_c; \ -+ count_leading_zeros (__ctz_c, __ctz_x & -__ctz_x); \ -+ (count) = W_TYPE_SIZE - 1 - __ctz_c; \ -+ } while (0) -+#endif -+ -+#ifndef UDIV_NEEDS_NORMALIZATION -+#define UDIV_NEEDS_NORMALIZATION 0 -+#endif -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/Makefile linux-4.12.4-3rd/3rdparty/ndiswrapper/Makefile ---- linux-4.12.4/3rdparty/ndiswrapper/Makefile 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/Makefile 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,213 @@ -+# Name of the module -+MODNAME = ndiswrapper -+ -+DISTFILES = \ -+ Makefile crt.c divdi3.c hal.c iw_ndis.c iw_ndis.h lin2win.S lin2win.h \ -+ loader.c loader.h longlong.h mkexport.sh mkstubs.sh ndis.c ndis.h \ -+ ndiswrapper.h ntoskernel.c ntoskernel.h ntoskernel_io.c pe_linker.c \ -+ pe_linker.h pnp.c pnp.h proc.c rtl.c usb.c usb.h win2lin_stubs.S \ -+ winnt_types.h workqueue.c wrapmem.c wrapmem.h wrapndis.c wrapndis.h \ -+ wrapper.c wrapper.h -+ -+# By default, we try to compile the modules for the currently running -+# kernel. But it's the first approximation, as we will re-read the -+# version from the kernel sources. -+KVERS_UNAME ?= $(shell uname -r) -+ -+# KBUILD is the path to the Linux kernel build tree. It is usually the -+# same as the kernel source tree, except when the kernel was compiled in -+# a separate directory. -+KBUILD ?= $(shell readlink -f /lib/modules/$(KVERS_UNAME)/build) -+ -+ifeq (,$(KBUILD)) -+$(error Kernel build tree not found - please set KBUILD to configured kernel) -+endif -+ -+KCONFIG := $(KBUILD)/.config -+ifeq (,$(wildcard $(KCONFIG))) -+$(error No .config found in $(KBUILD), please set KBUILD to configured kernel) -+endif -+ -+ifneq (,$(wildcard $(KBUILD)/include/linux/version.h)) -+ifneq (,$(wildcard $(KBUILD)/include/generated/uapi/linux/version.h)) -+$(error Multiple copies of version.h found, please clean your build tree) -+endif -+endif -+ -+# Kernel Makefile doesn't always know the exact kernel version, so we -+# get it from the kernel headers instead and pass it to make. -+VERSION_H := $(KBUILD)/include/generated/utsrelease.h -+ifeq (,$(wildcard $(VERSION_H))) -+VERSION_H := $(KBUILD)/include/linux/utsrelease.h -+endif -+ifeq (,$(wildcard $(VERSION_H))) -+VERSION_H := $(KBUILD)/include/linux/version.h -+endif -+ifeq (,$(wildcard $(VERSION_H))) -+$(error Please run 'make modules_prepare' in $(KBUILD)) -+endif -+ -+KVERS := $(shell sed -ne 's/"//g;s/^\#define UTS_RELEASE //p' $(VERSION_H)) -+ -+ifeq (,$(KVERS)) -+$(error Cannot find UTS_RELEASE in $(VERSION_H), please report) -+endif -+ -+INST_DIR = /lib/modules/$(KVERS)/misc -+ -+SRC_DIR=$(shell pwd) -+ -+include $(KCONFIG) -+ -+# returns of structs and unions in registers when possible, like Windows -+EXTRA_CFLAGS += -freg-struct-return -+ -+# to produce debug trace, add option "DEBUG=" where is 1 to 6 -+ifdef DEBUG -+EXTRA_CFLAGS += -DDEBUG=$(DEBUG) -g -+endif -+ -+# to debug timers, add option "TIMER_DEBUG=1" -+ifdef TIMER_DEBUG -+EXTRA_CFLAGS += -DTIMER_DEBUG -+endif -+ -+# to debug event layer, add option "EVENT_DEBUG=1" -+ifdef EVENT_DEBUG -+EXTRA_CFLAGS += -DEVENT_DEBUG -+endif -+ -+# to debug USB layer, add option "USB_DEBUG=1" -+ifdef USB_DEBUG -+EXTRA_CFLAGS += -DUSB_DEBUG -+endif -+ -+# to debug I/O layer, add option "IO_DEBUG=1" -+ifdef IO_DEBUG -+EXTRA_CFLAGS += -DIO_DEBUG -+endif -+ -+# to debug worker threads, add option "WORK_DEBUG=1" -+ifdef WORK_DEBUG -+EXTRA_CFLAGS += -DWORK_DEBUG -+endif -+ -+# to debug memory allocation, add option "ALLOC_DEBUG=" where is 1 or 2 -+ifdef ALLOC_DEBUG -+EXTRA_CFLAGS += -DALLOC_DEBUG=$(ALLOC_DEBUG) -+endif -+ -+OBJS = crt.o hal.o iw_ndis.o loader.o ndis.o ntoskernel.o ntoskernel_io.o \ -+ pe_linker.o pnp.o proc.o rtl.o wrapmem.o wrapndis.o wrapper.o -+ -+EXPORT_SRCS = crt.c hal.c ndis.c ntoskernel.c ntoskernel_io.c rtl.c -+ -+STUB_SRCS = crt.c hal.c ndis.c ntoskernel.c ntoskernel_io.c \ -+ pnp.c rtl.c wrapndis.c -+ -+ -+# By default, USB layer is compiled in if USB support is in kernel; -+# to disable USB support in ndiswrapper even if USB support is in kernel, -+# add option "DISABLE_USB=1" -+ifndef DISABLE_USB -+ifeq ($(CONFIG_USB),y) -+ENABLE_USB = 1 -+endif -+ifeq ($(CONFIG_USB),m) -+ENABLE_USB = 1 -+endif -+endif -+ -+ifdef ENABLE_USB -+EXPORT_SRCS += usb.c -+STUB_SRCS += usb.c -+OBJS += usb.o -+EXTRA_CFLAGS += -DENABLE_USB -+endif -+ -+ifdef WRAP_WQ -+EXTRA_CFLAGS += -DWRAP_WQ -+OBJS += workqueue.o -+endif -+ -+ -+all: config_check modules -+ -+# generate exports symbol table from C files -+quiet_cmd_mkexport = MKEXPORT $@ -+cmd_mkexport = $(SHELL) $(obj)/mkexport.sh $< $@ -+ -+extra-y += $(EXPORT_SRCS:.c=_exports.h) -+%_exports.h: %.c $(obj)/mkexport.sh FORCE -+ $(call if_changed,mkexport) -+ -+$(addprefix $(obj)/,$(EXPORT_SRCS:.c=.o)): %.o: %_exports.h -+ -+ifeq ($(CONFIG_X86_64),y) -+quiet_cmd_mkstubs = MKSTUBS $@ -+cmd_mkstubs = $(SHELL) $(obj)/mkstubs.sh $(addprefix $(src)/,$(STUB_SRCS)) >$@ -+ -+extra-y += win2lin_stubs.h -+$(obj)/win2lin_stubs.h: $(addprefix $(src)/,$(STUB_SRCS)) FORCE -+ $(call if_changed,mkstubs) -+ -+$(obj)/win2lin_stubs.o: $(obj)/win2lin_stubs.h -+OBJS += win2lin_stubs.o lin2win.o -+else -+OBJS += divdi3.o -+endif -+ -+MODULE := $(MODNAME).ko -+obj-m := $(MODNAME).o -+ -+$(MODNAME)-objs := $(OBJS) -+ -+ -+config_check: -+ @if [ -z "$(CONFIG_WIRELESS_EXT)$(CONFIG_NET_RADIO)" ]; then \ -+ echo; echo; \ -+ echo "*** WARNING: This kernel lacks wireless extensions."; \ -+ echo "Wireless drivers will not work properly."; \ -+ echo; echo; \ -+ fi -+ @if [ -z "$(CONFIG_X86_64)" ] && [ -n "$(CONFIG_4KSTACKS)" ]; then \ -+ echo; echo; \ -+ echo "*** WARNING: This kernel uses 4K stack size option"; \ -+ echo "(CONFIG_4KSTACKS); many Windows drivers will not work"; \ -+ echo "with this option enabled. Disable CONFIG_4KSTACKS"; \ -+ echo "in kernel's .config file, recompile and install kernel"; \ -+ echo; echo; \ -+ fi -+ -+modules: -+ $(MAKE) -C $(KBUILD) M=$(SRC_DIR) -+ -+$(MODULE): -+ $(MAKE) modules -+ -+clean: -+ rm -f *.o *.ko .*.cmd *.mod.c *.symvers modules.order *~ .\#* -+ rm -f *_exports.h win2lin_stubs.h -+ rm -rf .tmp_versions -+ -+install: config_check $(MODULE) -+ @/sbin/modinfo $(MODULE) | grep -q "^vermagic: *$(KVERS) " || \ -+ { echo "$(MODULE)" is not for Linux $(KVERS); exit 1; } -+ mkdir -p -m 755 $(DESTDIR)$(INST_DIR) -+ install -m 0644 $(MODULE) $(DESTDIR)$(INST_DIR) -+ifndef DESTDIR -+ -/sbin/depmod -a $(KVERS) -+endif -+ -+uninstall: -+ rm -f $(DESTDIR)$(INST_DIR)/$(MODULE) -+ifndef DESTDIR -+ -/sbin/depmod -a $(KVERS) -+endif -+ -+dist: -+ @for file in $(DISTFILES); do \ -+ cp $$file $(distdir)/$$file || exit 1; \ -+ done -+ -+.PHONY: all modules clean install config_check dist -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/mkexport.sh linux-4.12.4-3rd/3rdparty/ndiswrapper/mkexport.sh ---- linux-4.12.4/3rdparty/ndiswrapper/mkexport.sh 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/mkexport.sh 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,42 @@ -+#! /bin/sh -+ -+# Generate exports symbol table from C files -+ -+input="$1" -+output="$2" -+exports=$(basename "$output" .h) -+exec >"$output" -+ -+echo "/* automatically generated from src */"; -+ -+sed -n -e '/^\(wstdcall\|wfastcall\|noregparm\|regparm3\|__attribute__\)/{ -+:more -+N -+s/\([^{]\)$/\1/ -+t more -+s/\n{$/;/ -+p -+}' $input -+ -+echo "#ifdef CONFIG_X86_64"; -+ -+sed -n \ -+ -e 's/.*WIN_FUNC(\([^\,]\+\) *\, *\([0-9]\+\)).*/'\ -+'WIN_FUNC_DECL(\1, \2)/p' \ -+ -e 's/.*WIN_FUNC_PTR(\([^\,]\+\) *\, *\([0-9]\+\)).*/'\ -+'WIN_FUNC_DECL(\1, \2)/p' $input | sort -u -+ -+echo "#endif" -+echo "extern struct wrap_export $exports[];" -+echo "struct wrap_export $exports[] = {" -+ -+sed -n \ -+ -e 's/.*WIN_FUNC(_win_\([^\,]\+\) *\, *\([0-9]\+\)).*/'\ -+' WIN_WIN_SYMBOL(\1, \2),/p' \ -+ -e 's/.*WIN_FUNC(\([^\,]\+\) *\, *\([0-9]\+\)).*/'\ -+' WIN_SYMBOL(\1, \2),/p' \ -+ -e 's/.*WIN_SYMBOL_MAP(\("[^"]\+"\)[ ,\n]\+\([^)]\+\)).*/'\ -+' {\1, (generic_func)\2},/p' $input | sort -u -+ -+echo " {NULL, NULL}" -+echo "};" -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/mkstubs.sh linux-4.12.4-3rd/3rdparty/ndiswrapper/mkstubs.sh ---- linux-4.12.4/3rdparty/ndiswrapper/mkstubs.sh 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/mkstubs.sh 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,12 @@ -+#! /bin/sh -+ -+for file in "$@"; do -+ echo -+ echo "# automatically generated from $file" -+ sed -n \ -+ -e 's/.*WIN_FUNC(\([^\,]\+\) *\, *\([0-9]\+\)).*/\ -+ win2lin(\1, \2)/p' \ -+ -e 's/.*WIN_FUNC_PTR(\([^\,]\+\) *\, *\([0-9]\+\)).*/\ -+ win2lin(\1, \2)/p' \ -+ $file | sed -e 's/[ \t ]\+//' | sort -u; \ -+done -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/ndis.c linux-4.12.4-3rd/3rdparty/ndiswrapper/ndis.c ---- linux-4.12.4/3rdparty/ndiswrapper/ndis.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/ndis.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,3025 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include "ndis.h" -+#include "iw_ndis.h" -+#include "wrapndis.h" -+#include "pnp.h" -+#include "loader.h" -+#include -+#include -+#include "ndis_exports.h" -+ -+#define MAX_ALLOCATED_NDIS_PACKETS TX_RING_SIZE -+#define MAX_ALLOCATED_NDIS_BUFFERS TX_RING_SIZE -+ -+static struct work_struct ndis_work; -+static struct nt_list ndis_work_list; -+static spinlock_t ndis_work_list_lock; -+ -+struct workqueue_struct *ndis_wq; -+ -+static void *ndis_get_routine_address(char *name); -+ -+wstdcall void WIN_FUNC(NdisInitializeWrapper,4) -+ (void **driver_handle, struct driver_object *driver, -+ struct unicode_string *reg_path, void *unused) -+{ -+ ENTER1("handle: %p, driver: %p", driver_handle, driver); -+ *driver_handle = driver; -+ EXIT1(return); -+} -+ -+wstdcall void WIN_FUNC(NdisTerminateWrapper,2) -+ (struct device_object *dev_obj, void *system_specific) -+{ -+ EXIT1(return); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMRegisterMiniport,3) -+ (struct driver_object *drv_obj, struct miniport *mp, UINT length) -+{ -+ int min_length; -+ struct wrap_driver *wrap_driver; -+ struct ndis_driver *ndis_driver; -+ -+ min_length = ((char *)&mp->co_create_vc) - ((char *)mp); -+ -+ ENTER1("%p %p %d", drv_obj, mp, length); -+ -+ if (mp->major_version < 4) { -+ ERROR("Driver is using ndis version %d which is too old.", -+ mp->major_version); -+ EXIT1(return NDIS_STATUS_BAD_VERSION); -+ } -+ -+ if (length < min_length) { -+ ERROR("Characteristics length %d is too small", length); -+ EXIT1(return NDIS_STATUS_BAD_CHARACTERISTICS); -+ } -+ -+ TRACE1("%d.%d, %d, %u", mp->major_version, mp->minor_version, length, -+ (u32)sizeof(struct miniport)); -+ wrap_driver = IoGetDriverObjectExtension(drv_obj, -+ (void *)WRAP_DRIVER_CLIENT_ID); -+ if (!wrap_driver) { -+ ERROR("couldn't get wrap_driver"); -+ EXIT1(return NDIS_STATUS_RESOURCES); -+ } -+ if (IoAllocateDriverObjectExtension( -+ drv_obj, (void *)NDIS_DRIVER_CLIENT_ID, -+ sizeof(*ndis_driver), (void **)&ndis_driver) != -+ STATUS_SUCCESS) -+ EXIT1(return NDIS_STATUS_RESOURCES); -+ wrap_driver->ndis_driver = ndis_driver; -+ TRACE1("driver: %p", ndis_driver); -+ memcpy(&ndis_driver->mp, mp, min_t(int, sizeof(*mp), length)); -+ -+ DBG_BLOCK(2) { -+ int i; -+ void **func; -+ char *mp_funcs[] = { -+ "queryinfo", "reconfig", "reset", "send", "setinfo", -+ "tx_data", "return_packet", "send_packets", -+ "alloc_complete", "co_create_vc", "co_delete_vc", -+ "co_activate_vc", "co_deactivate_vc", -+ "co_send_packets", "co_request", "cancel_send_packets", -+ "pnp_event_notify", "shutdown", -+ }; -+ func = (void **)&ndis_driver->mp.queryinfo; -+ for (i = 0; i < ARRAY_SIZE(mp_funcs); i++) -+ TRACE0("function '%s' is at %p", mp_funcs[i], func[i]); -+ } -+ EXIT1(return NDIS_STATUS_SUCCESS); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMRegisterDevice,6) -+ (struct driver_object *drv_obj, struct unicode_string *dev_name, -+ struct unicode_string *link, void **funcs, -+ struct device_object **dev_obj, void **dev_obj_handle) -+{ -+ NTSTATUS status; -+ struct device_object *tmp; -+ int i; -+ -+ ENTER1("%p, %p, %p", drv_obj, dev_name, link); -+ status = IoCreateDevice(drv_obj, 0, dev_name, FILE_DEVICE_NETWORK, 0, -+ FALSE, &tmp); -+ -+ if (status != STATUS_SUCCESS) -+ EXIT1(return NDIS_STATUS_RESOURCES); -+ if (link) -+ status = IoCreateSymbolicLink(link, dev_name); -+ if (status != STATUS_SUCCESS) { -+ IoDeleteDevice(tmp); -+ EXIT1(return NDIS_STATUS_RESOURCES); -+ } -+ -+ *dev_obj = tmp; -+ *dev_obj_handle = *dev_obj; -+ for (i = 0; i < IRP_MJ_MAXIMUM_FUNCTION; i++) -+ if (funcs[i] && i != IRP_MJ_PNP && i != IRP_MJ_POWER) { -+ drv_obj->major_func[i] = funcs[i]; -+ TRACE1("mj_fn for 0x%x is at %p", i, funcs[i]); -+ } -+ EXIT1(return NDIS_STATUS_SUCCESS); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMDeregisterDevice,1) -+ (struct device_object *dev_obj) -+{ -+ ENTER2("%p", dev_obj); -+ IoDeleteDevice(dev_obj); -+ return NDIS_STATUS_SUCCESS; -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisAllocateMemoryWithTag,3) -+ (void **dest, UINT length, ULONG tag) -+{ -+ void *addr; -+ -+ assert_irql(_irql_ <= DISPATCH_LEVEL); -+ addr = ExAllocatePoolWithTag(NonPagedPool, length, tag); -+ TRACE4("%p", addr); -+ if (addr) { -+ *dest = addr; -+ EXIT4(return NDIS_STATUS_SUCCESS); -+ } else -+ EXIT4(return NDIS_STATUS_FAILURE); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisAllocateMemory,4) -+ (void **dest, UINT length, UINT flags, NDIS_PHY_ADDRESS highest_address) -+{ -+ return NdisAllocateMemoryWithTag(dest, length, 0); -+} -+ -+/* length_tag is either length or tag, depending on if -+ * NdisAllocateMemory or NdisAllocateMemoryTag is used to allocate -+ * memory */ -+wstdcall void WIN_FUNC(NdisFreeMemory,3) -+ (void *addr, UINT length_tag, UINT flags) -+{ -+ TRACE4("%p", addr); -+ ExFreePool(addr); -+} -+ -+noregparm void WIN_FUNC(NdisWriteErrorLogEntry,12) -+ (struct driver_object *drv_obj, ULONG error, ULONG count, ...) -+{ -+ va_list args; -+ int i; -+ ULONG code; -+ -+ va_start(args, count); -+ ERROR("log: %08X, count: %d, return_address: %p", -+ error, count, __builtin_return_address(0)); -+ for (i = 0; i < count; i++) { -+ code = va_arg(args, ULONG); -+ ERROR("code: 0x%x", code); -+ } -+ va_end(args); -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisOpenConfiguration,3) -+ (NDIS_STATUS *status, struct ndis_mp_block **conf_handle, -+ struct ndis_mp_block *handle) -+{ -+ ENTER2("%p", conf_handle); -+ *conf_handle = handle; -+ *status = NDIS_STATUS_SUCCESS; -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisOpenProtocolConfiguration,3) -+ (NDIS_STATUS *status, void **confhandle, -+ struct unicode_string *section) -+{ -+ ENTER2("%p", confhandle); -+ *status = NDIS_STATUS_SUCCESS; -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisOpenConfigurationKeyByName,4) -+ (NDIS_STATUS *status, void *handle, -+ struct unicode_string *key, void **subkeyhandle) -+{ -+ struct ansi_string ansi; -+ ENTER2(""); -+ if (RtlUnicodeStringToAnsiString(&ansi, key, TRUE) == STATUS_SUCCESS) { -+ TRACE2("%s", ansi.buf); -+ RtlFreeAnsiString(&ansi); -+ } -+ *subkeyhandle = handle; -+ *status = NDIS_STATUS_SUCCESS; -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisOpenConfigurationKeyByIndex,5) -+ (NDIS_STATUS *status, void *handle, ULONG index, -+ struct unicode_string *key, void **subkeyhandle) -+{ -+ ENTER2("%u", index); -+// *subkeyhandle = handle; -+ *status = NDIS_STATUS_FAILURE; -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisCloseConfiguration,1) -+ (void *handle) -+{ -+ /* instead of freeing all configuration parameters as we are -+ * supposed to do here, we free them when the device is -+ * removed */ -+ ENTER2("%p", handle); -+ return; -+} -+ -+wstdcall void WIN_FUNC(NdisOpenFile,5) -+ (NDIS_STATUS *status, struct wrap_bin_file **file, -+ UINT *filelength, struct unicode_string *filename, -+ NDIS_PHY_ADDRESS highest_address) -+{ -+ struct ansi_string ansi; -+ struct wrap_bin_file *bin_file; -+ -+ ENTER2("%p, %d, %llx, %p", status, *filelength, highest_address, *file); -+ if (RtlUnicodeStringToAnsiString(&ansi, filename, TRUE) != -+ STATUS_SUCCESS) { -+ *status = NDIS_STATUS_RESOURCES; -+ EXIT2(return); -+ } -+ TRACE2("%s", ansi.buf); -+ bin_file = get_bin_file(ansi.buf); -+ if (bin_file) { -+ *file = bin_file; -+ *filelength = bin_file->size; -+ *status = NDIS_STATUS_SUCCESS; -+ } else -+ *status = NDIS_STATUS_FILE_NOT_FOUND; -+ -+ RtlFreeAnsiString(&ansi); -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisMapFile,3) -+ (NDIS_STATUS *status, void **mappedbuffer, struct wrap_bin_file *file) -+{ -+ ENTER2("%p", file); -+ -+ if (!file) { -+ *status = NDIS_STATUS_ALREADY_MAPPED; -+ EXIT2(return); -+ } -+ -+ *status = NDIS_STATUS_SUCCESS; -+ *mappedbuffer = file->data; -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisUnmapFile,1) -+ (struct wrap_bin_file *file) -+{ -+ ENTER2("%p", file); -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisCloseFile,1) -+ (struct wrap_bin_file *file) -+{ -+ ENTER2("%p", file); -+ free_bin_file(file); -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisGetSystemUpTime,1) -+ (ULONG *ms) -+{ -+ *ms = 1000 * jiffies / HZ; -+ EXIT5(return); -+} -+ -+wstdcall ULONG WIN_FUNC(NDIS_BUFFER_TO_SPAN_PAGES,1) -+ (ndis_buffer *buffer) -+{ -+ ULONG n, length; -+ -+ if (buffer == NULL) -+ EXIT2(return 0); -+ if (MmGetMdlByteCount(buffer) == 0) -+ EXIT2(return 1); -+ -+ length = MmGetMdlByteCount(buffer); -+ n = SPAN_PAGES(MmGetMdlVirtualAddress(buffer), length); -+ TRACE4("%p, %p, %d, %d", buffer->startva, buffer->mappedsystemva, -+ length, n); -+ EXIT3(return n); -+} -+ -+wstdcall void WIN_FUNC(NdisGetBufferPhysicalArraySize,2) -+ (ndis_buffer *buffer, UINT *arraysize) -+{ -+ ENTER3("%p", buffer); -+ *arraysize = NDIS_BUFFER_TO_SPAN_PAGES(buffer); -+ EXIT3(return); -+} -+ -+static struct ndis_configuration_parameter * -+ndis_encode_setting(struct wrap_device_setting *setting, -+ enum ndis_parameter_type type) -+{ -+ struct ansi_string ansi; -+ struct ndis_configuration_parameter *param; -+ -+ param = setting->encoded; -+ if (param) { -+ if (param->type == type) -+ EXIT2(return param); -+ if (param->type == NdisParameterString) -+ RtlFreeUnicodeString(¶m->data.string); -+ setting->encoded = NULL; -+ } else -+ param = ExAllocatePoolWithTag(NonPagedPool, sizeof(*param), 0); -+ if (!param) { -+ ERROR("couldn't allocate memory"); -+ return NULL; -+ } -+ switch (type) { -+ case NdisParameterInteger: -+ param->data.integer = simple_strtol(setting->value, NULL, 0); -+ TRACE2("0x%x", param->data.integer); -+ break; -+ case NdisParameterHexInteger: -+ param->data.integer = simple_strtol(setting->value, NULL, 16); -+ TRACE2("0x%x", param->data.integer); -+ break; -+ case NdisParameterString: -+ RtlInitAnsiString(&ansi, setting->value); -+ TRACE2("'%s'", ansi.buf); -+ if (RtlAnsiStringToUnicodeString(¶m->data.string, -+ &ansi, TRUE)) { -+ ExFreePool(param); -+ EXIT2(return NULL); -+ } -+ break; -+ case NdisParameterBinary: -+ param->data.integer = simple_strtol(setting->value, NULL, 2); -+ TRACE2("0x%x", param->data.integer); -+ break; -+ default: -+ ERROR("unknown type: %d", type); -+ ExFreePool(param); -+ return NULL; -+ } -+ param->type = type; -+ setting->encoded = param; -+ EXIT2(return param); -+} -+ -+static int ndis_decode_setting(struct wrap_device_setting *setting, -+ struct ndis_configuration_parameter *param) -+{ -+ struct ansi_string ansi; -+ struct ndis_configuration_parameter *prev; -+ -+ ENTER2("%p, %p", setting, param); -+ prev = setting->encoded; -+ if (prev && prev->type == NdisParameterString) { -+ RtlFreeUnicodeString(&prev->data.string); -+ setting->encoded = NULL; -+ } -+ switch (param->type) { -+ case NdisParameterInteger: -+ snprintf(setting->value, MAX_SETTING_VALUE_LEN, "%u", -+ param->data.integer); -+ break; -+ case NdisParameterHexInteger: -+ snprintf(setting->value, MAX_SETTING_VALUE_LEN, "%x", -+ param->data.integer); -+ break; -+ case NdisParameterString: -+ ansi.buf = setting->value; -+ ansi.max_length = MAX_SETTING_VALUE_LEN; -+ if ((RtlUnicodeStringToAnsiString(&ansi, ¶m->data.string, -+ FALSE) != STATUS_SUCCESS) -+ || ansi.length >= MAX_SETTING_VALUE_LEN) { -+ EXIT1(return -1); -+ } -+ if (ansi.length == ansi.max_length) -+ ansi.length--; -+ setting->value[ansi.length] = 0; -+ break; -+ default: -+ TRACE2("unknown setting type: %d", param->type); -+ return -1; -+ } -+ TRACE2("setting changed %s='%s', %d", setting->name, setting->value, -+ ansi.length); -+ return 0; -+} -+ -+static int read_setting(struct nt_list *setting_list, char *keyname, int length, -+ struct ndis_configuration_parameter **param, -+ enum ndis_parameter_type type) -+{ -+ struct wrap_device_setting *setting; -+ mutex_lock(&loader_mutex); -+ nt_list_for_each_entry(setting, setting_list, list) { -+ if (strncasecmp(keyname, setting->name, length) == 0) { -+ TRACE2("setting %s='%s'", keyname, setting->value); -+ mutex_unlock(&loader_mutex); -+ *param = ndis_encode_setting(setting, type); -+ if (*param) -+ EXIT2(return 0); -+ else -+ EXIT2(return -1); -+ } -+ } -+ mutex_unlock(&loader_mutex); -+ EXIT2(return -1); -+} -+ -+wstdcall void WIN_FUNC(NdisReadConfiguration,5) -+ (NDIS_STATUS *status, struct ndis_configuration_parameter **param, -+ struct ndis_mp_block *nmb, struct unicode_string *key, -+ enum ndis_parameter_type type) -+{ -+ struct ansi_string ansi; -+ int ret; -+ -+ ENTER2("nmb: %p", nmb); -+ ret = RtlUnicodeStringToAnsiString(&ansi, key, TRUE); -+ if (ret != STATUS_SUCCESS || ansi.buf == NULL) { -+ *param = NULL; -+ *status = NDIS_STATUS_FAILURE; -+ RtlFreeAnsiString(&ansi); -+ EXIT2(return); -+ } -+ TRACE2("%d, %s", type, ansi.buf); -+ -+ if (read_setting(&nmb->wnd->wd->settings, ansi.buf, -+ ansi.length, param, type) == 0 || -+ read_setting(&nmb->wnd->wd->driver->settings, ansi.buf, -+ ansi.length, param, type) == 0) -+ *status = NDIS_STATUS_SUCCESS; -+ else { -+ TRACE2("setting %s not found (type:%d)", ansi.buf, type); -+ *status = NDIS_STATUS_FAILURE; -+ } -+ RtlFreeAnsiString(&ansi); -+ EXIT2(return); -+ -+} -+ -+wstdcall void WIN_FUNC(NdisWriteConfiguration,4) -+ (NDIS_STATUS *status, struct ndis_mp_block *nmb, -+ struct unicode_string *key, struct ndis_configuration_parameter *param) -+{ -+ struct ansi_string ansi; -+ char *keyname; -+ struct wrap_device_setting *setting; -+ -+ ENTER2("nmb: %p", nmb); -+ if (RtlUnicodeStringToAnsiString(&ansi, key, TRUE)) { -+ *status = NDIS_STATUS_FAILURE; -+ EXIT2(return); -+ } -+ keyname = ansi.buf; -+ TRACE2("%s", keyname); -+ -+ mutex_lock(&loader_mutex); -+ nt_list_for_each_entry(setting, &nmb->wnd->wd->settings, list) { -+ if (strncasecmp(keyname, setting->name, ansi.length) == 0) { -+ mutex_unlock(&loader_mutex); -+ if (ndis_decode_setting(setting, param)) -+ *status = NDIS_STATUS_FAILURE; -+ else -+ *status = NDIS_STATUS_SUCCESS; -+ RtlFreeAnsiString(&ansi); -+ EXIT2(return); -+ } -+ } -+ mutex_unlock(&loader_mutex); -+ setting = kzalloc(sizeof(*setting), GFP_KERNEL); -+ if (setting) { -+ if (ansi.length == ansi.max_length) -+ ansi.length--; -+ memcpy(setting->name, keyname, ansi.length); -+ setting->name[ansi.length] = 0; -+ if (ndis_decode_setting(setting, param)) -+ *status = NDIS_STATUS_FAILURE; -+ else { -+ *status = NDIS_STATUS_SUCCESS; -+ mutex_lock(&loader_mutex); -+ InsertTailList(&nmb->wnd->wd->settings, &setting->list); -+ mutex_unlock(&loader_mutex); -+ } -+ } else -+ *status = NDIS_STATUS_RESOURCES; -+ -+ RtlFreeAnsiString(&ansi); -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisReadNetworkAddress,4) -+ (NDIS_STATUS *status, void **addr, UINT *len, -+ struct ndis_mp_block *nmb) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ struct ndis_configuration_parameter *param; -+ struct unicode_string key; -+ struct ansi_string ansi; -+ typeof(wnd->mac) mac; -+ int i, ret; -+ -+ ENTER2("%p", nmb); -+ RtlInitAnsiString(&ansi, "NetworkAddress"); -+ *status = NDIS_STATUS_FAILURE; -+ if (RtlAnsiStringToUnicodeString(&key, &ansi, TRUE) != STATUS_SUCCESS) -+ EXIT1(return); -+ -+ NdisReadConfiguration(&ret, ¶m, nmb, &key, NdisParameterString); -+ RtlFreeUnicodeString(&key); -+ if (ret != NDIS_STATUS_SUCCESS) -+ EXIT1(return); -+ ret = RtlUnicodeStringToAnsiString(&ansi, ¶m->data.string, TRUE); -+ if (ret != STATUS_SUCCESS) -+ EXIT1(return); -+ -+ i = 0; -+ if (ansi.length >= 2 * sizeof(mac)) { -+ for (i = 0; i < sizeof(mac); i++) { -+ char c[3]; -+ int x; -+ c[0] = ansi.buf[i*2]; -+ c[1] = ansi.buf[i*2+1]; -+ c[2] = 0; -+ ret = sscanf(c, "%x", &x); -+ if (ret != 1) -+ break; -+ mac[i] = x; -+ } -+ } -+ TRACE2("%s, %d, " MACSTR, ansi.buf, i, MAC2STR(mac)); -+ RtlFreeAnsiString(&ansi); -+ if (i == sizeof(mac)) { -+ memcpy(wnd->mac, mac, sizeof(wnd->mac)); -+ *len = sizeof(mac); -+ *addr = wnd->mac; -+ *status = NDIS_STATUS_SUCCESS; -+ } -+ EXIT1(return); -+} -+ -+wstdcall void WIN_FUNC(NdisInitializeString,2) -+ (struct unicode_string *dest, UCHAR *src) -+{ -+ struct ansi_string ansi; -+ -+ ENTER2(""); -+ if (src == NULL) { -+ dest->length = dest->max_length = 0; -+ dest->buf = NULL; -+ } else { -+ RtlInitAnsiString(&ansi, src); -+ /* the string is freed with NdisFreeMemory */ -+ RtlAnsiStringToUnicodeString(dest, &ansi, TRUE); -+ } -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisInitAnsiString,2) -+ (struct ansi_string *dst, CHAR *src) -+{ -+ RtlInitAnsiString(dst, src); -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisInitUnicodeString,2) -+ (struct unicode_string *dest, const wchar_t *src) -+{ -+ RtlInitUnicodeString(dest, src); -+ return; -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisAnsiStringToUnicodeString,2) -+ (struct unicode_string *dst, struct ansi_string *src) -+{ -+ ENTER2(""); -+ if (dst == NULL || src == NULL) -+ EXIT2(return NDIS_STATUS_FAILURE); -+ if (RtlAnsiStringToUnicodeString(dst, src, FALSE) == STATUS_SUCCESS) -+ return NDIS_STATUS_SUCCESS; -+ else -+ return NDIS_STATUS_FAILURE; -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisUnicodeStringToAnsiString,2) -+ (struct ansi_string *dst, struct unicode_string *src) -+{ -+ ENTER2(""); -+ if (dst == NULL || src == NULL) -+ EXIT2(return NDIS_STATUS_FAILURE); -+ if (RtlUnicodeStringToAnsiString(dst, src, FALSE) == STATUS_SUCCESS) -+ return NDIS_STATUS_SUCCESS; -+ else -+ return NDIS_STATUS_FAILURE; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(NdisUpcaseUnicodeString,2) -+ (struct unicode_string *dst, struct unicode_string *src) -+{ -+ EXIT2(return RtlUpcaseUnicodeString(dst, src, FALSE)); -+} -+ -+wstdcall void WIN_FUNC(NdisMSetAttributesEx,5) -+ (struct ndis_mp_block *nmb, void *mp_ctx, -+ UINT hangcheck_interval, UINT attributes, ULONG adaptertype) -+{ -+ struct ndis_device *wnd; -+ -+ ENTER1("%p, %p, %d, %08x, %d", nmb, mp_ctx, hangcheck_interval, -+ attributes, adaptertype); -+ wnd = nmb->wnd; -+ nmb->mp_ctx = mp_ctx; -+ wnd->attributes = attributes; -+ -+ if ((attributes & NDIS_ATTRIBUTE_BUS_MASTER) && -+ wrap_is_pci_bus(wnd->wd->dev_bus)) -+ pci_set_master(wnd->wd->pci.pdev); -+ -+ if (hangcheck_interval > 0) -+ wnd->hangcheck_interval = 2 * hangcheck_interval * HZ; -+ else -+ wnd->hangcheck_interval = 2 * HZ; -+ -+ EXIT1(return); -+} -+ -+wstdcall ULONG WIN_FUNC(NdisReadPciSlotInformation,5) -+ (struct ndis_mp_block *nmb, ULONG slot, -+ ULONG offset, char *buf, ULONG len) -+{ -+ struct wrap_device *wd = nmb->wnd->wd; -+ ULONG i; -+ if (!wrap_is_pci_bus(wd->dev_bus)) { -+ ERROR("used on a non-PCI device"); -+ return 0; -+ } -+ for (i = 0; i < len; i++) -+ if (pci_read_config_byte(wd->pci.pdev, offset + i, &buf[i]) != -+ PCIBIOS_SUCCESSFUL) -+ break; -+ DBG_BLOCK(2) { -+ if (i != len) -+ WARNING("%u, %u", i, len); -+ } -+ return i; -+} -+ -+wstdcall ULONG WIN_FUNC(NdisImmediateReadPciSlotInformation,5) -+ (struct ndis_mp_block *nmb, ULONG slot, -+ ULONG offset, char *buf, ULONG len) -+{ -+ return NdisReadPciSlotInformation(nmb, slot, offset, buf, len); -+} -+ -+wstdcall ULONG WIN_FUNC(NdisWritePciSlotInformation,5) -+ (struct ndis_mp_block *nmb, ULONG slot, -+ ULONG offset, char *buf, ULONG len) -+{ -+ struct wrap_device *wd = nmb->wnd->wd; -+ ULONG i; -+ if (!wrap_is_pci_bus(wd->dev_bus)) { -+ ERROR("used on a non-PCI device"); -+ return 0; -+ } -+ for (i = 0; i < len; i++) -+ if (pci_write_config_byte(wd->pci.pdev, offset + i, buf[i]) != -+ PCIBIOS_SUCCESSFUL) -+ break; -+ DBG_BLOCK(2) { -+ if (i != len) -+ WARNING("%u, %u", i, len); -+ } -+ return i; -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMRegisterIoPortRange,4) -+ (void **virt, struct ndis_mp_block *nmb, UINT start, UINT len) -+{ -+ ENTER3("%08x %08x", start, len); -+ *virt = (void *)(ULONG_PTR)start; -+ return NDIS_STATUS_SUCCESS; -+} -+ -+wstdcall void WIN_FUNC(NdisMDeregisterIoPortRange,4) -+ (struct ndis_mp_block *nmb, UINT start, UINT len, void* virt) -+{ -+ ENTER1("%08x %08x", start, len); -+} -+ -+wstdcall void WIN_FUNC(NdisReadPortUchar,3) -+ (struct ndis_mp_block *nmb, ULONG port, char *data) -+{ -+ *data = inb(port); -+} -+ -+wstdcall void WIN_FUNC(NdisImmediateReadPortUchar,3) -+ (struct ndis_mp_block *nmb, ULONG port, char *data) -+{ -+ *data = inb(port); -+} -+ -+wstdcall void WIN_FUNC(NdisWritePortUchar,3) -+ (struct ndis_mp_block *nmb, ULONG port, char data) -+{ -+ outb(data, port); -+} -+ -+wstdcall void WIN_FUNC(NdisImmediateWritePortUchar,3) -+ (struct ndis_mp_block *nmb, ULONG port, char data) -+{ -+ outb(data, port); -+} -+ -+wstdcall void WIN_FUNC(NdisMQueryAdapterResources,4) -+ (NDIS_STATUS *status, struct ndis_mp_block *nmb, -+ NDIS_RESOURCE_LIST *resource_list, UINT *size) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ NDIS_RESOURCE_LIST *list; -+ UINT resource_length; -+ -+ list = &wnd->wd->resource_list->list->partial_resource_list; -+ resource_length = sizeof(struct cm_partial_resource_list) + -+ sizeof(struct cm_partial_resource_descriptor) * -+ (list->count - 1); -+ TRACE2("%p, %p,%d (%d), %p %d %d", wnd, resource_list, *size, -+ resource_length, &list->partial_descriptors[list->count-1], -+ list->partial_descriptors[list->count-1].u.interrupt.level, -+ list->partial_descriptors[list->count-1].u.interrupt.vector); -+ if (*size < sizeof(*list)) { -+ *size = resource_length; -+ *status = NDIS_STATUS_BUFFER_TOO_SHORT; -+ } else { -+ ULONG count; -+ if (*size >= resource_length) { -+ *size = resource_length; -+ count = list->count; -+ } else { -+ UINT n = sizeof(*list); -+ count = 1; -+ while (count++ < list->count && n < *size) -+ n += sizeof(list->partial_descriptors); -+ *size = n; -+ } -+ memcpy(resource_list, list, *size); -+ resource_list->count = count; -+ *status = NDIS_STATUS_SUCCESS; -+ } -+ EXIT2(return); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMPciAssignResources,3) -+ (struct ndis_mp_block *nmb, ULONG slot_number, -+ NDIS_RESOURCE_LIST **resources) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ -+ ENTER2("%p, %p", wnd, wnd->wd->resource_list); -+ *resources = &wnd->wd->resource_list->list->partial_resource_list; -+ EXIT2(return NDIS_STATUS_SUCCESS); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMMapIoSpace,4) -+ (void __iomem **virt, struct ndis_mp_block *nmb, -+ NDIS_PHY_ADDRESS phy_addr, UINT len) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ -+ ENTER2("%llx, %d", phy_addr, len); -+ *virt = MmMapIoSpace(phy_addr, len, MmCached); -+ if (*virt == NULL) { -+ ERROR("ioremap failed"); -+ EXIT2(return NDIS_STATUS_FAILURE); -+ } -+ wnd->mem_start = phy_addr; -+ wnd->mem_end = phy_addr + len; -+ TRACE2("%p", *virt); -+ EXIT2(return NDIS_STATUS_SUCCESS); -+} -+ -+wstdcall void WIN_FUNC(NdisMUnmapIoSpace,3) -+ (struct ndis_mp_block *nmb, void __iomem *virt, UINT len) -+{ -+ ENTER2("%p, %d", virt, len); -+ MmUnmapIoSpace(virt, len); -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisAllocateSpinLock,1) -+ (struct ndis_spinlock *lock) -+{ -+ TRACE4("lock %p, %p", lock, &lock->klock); -+ KeInitializeSpinLock(&lock->klock); -+ lock->irql = PASSIVE_LEVEL; -+ return; -+} -+ -+wstdcall void WIN_FUNC(NdisFreeSpinLock,1) -+ (struct ndis_spinlock *lock) -+{ -+ TRACE4("lock %p, %p", lock, &lock->klock); -+ return; -+} -+ -+wstdcall void WIN_FUNC(NdisAcquireSpinLock,1) -+ (struct ndis_spinlock *lock) -+{ -+ ENTER6("lock %p, %p", lock, &lock->klock); -+// assert_irql(_irql_ <= DISPATCH_LEVEL); -+ lock->irql = nt_spin_lock_irql(&lock->klock, DISPATCH_LEVEL); -+ return; -+} -+ -+wstdcall void WIN_FUNC(NdisReleaseSpinLock,1) -+ (struct ndis_spinlock *lock) -+{ -+ ENTER6("lock %p, %p", lock, &lock->klock); -+// assert_irql(_irql_ == DISPATCH_LEVEL); -+ nt_spin_unlock_irql(&lock->klock, lock->irql); -+ return; -+} -+ -+wstdcall void WIN_FUNC(NdisDprAcquireSpinLock,1) -+ (struct ndis_spinlock *lock) -+{ -+ ENTER6("lock %p", &lock->klock); -+// assert_irql(_irql_ == DISPATCH_LEVEL); -+ nt_spin_lock(&lock->klock); -+ return; -+} -+ -+wstdcall void WIN_FUNC(NdisDprReleaseSpinLock,1) -+ (struct ndis_spinlock *lock) -+{ -+ ENTER6("lock %p", &lock->klock); -+// assert_irql(_irql_ == DISPATCH_LEVEL); -+ nt_spin_unlock(&lock->klock); -+ return; -+} -+ -+wstdcall void WIN_FUNC(NdisInitializeReadWriteLock,1) -+ (struct ndis_rw_lock *rw_lock) -+{ -+ ENTER3("%p", rw_lock); -+ memset(rw_lock, 0, sizeof(*rw_lock)); -+ KeInitializeSpinLock(&rw_lock->klock); -+ return; -+} -+ -+/* read/write locks are implemented in a rather simplistic way - we -+ * should probably use Linux's rw_lock implementation */ -+ -+wstdcall void WIN_FUNC(NdisAcquireReadWriteLock,3) -+ (struct ndis_rw_lock *rw_lock, BOOLEAN write, -+ struct lock_state *lock_state) -+{ -+ if (write) { -+ while (1) { -+ if (cmpxchg(&rw_lock->count, 0, -1) == 0) -+ return; -+ while (rw_lock->count) -+ cpu_relax(); -+ } -+ return; -+ } -+ while (1) { -+ typeof(rw_lock->count) count; -+ while ((count = rw_lock->count) < 0) -+ cpu_relax(); -+ if (cmpxchg(&rw_lock->count, count, count + 1) == count) -+ return; -+ } -+} -+ -+wstdcall void WIN_FUNC(NdisReleaseReadWriteLock,2) -+ (struct ndis_rw_lock *rw_lock, struct lock_state *lock_state) -+{ -+ if (rw_lock->count > 0) -+ pre_atomic_add(rw_lock->count, -1); -+ else if (rw_lock->count == -1) -+ rw_lock->count = 0; -+ else -+ WARNING("invalid state: %d", rw_lock->count); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMAllocateMapRegisters,5) -+ (struct ndis_mp_block *nmb, UINT dmachan, -+ NDIS_DMA_SIZE dmasize, ULONG basemap, ULONG max_buf_size) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ -+ ENTER2("%p, %d %d %d %d", wnd, dmachan, dmasize, basemap, max_buf_size); -+ if (!wrap_is_pci_bus(wnd->wd->dev_bus)) { -+ ERROR("used on a non-PCI device"); -+ return NDIS_STATUS_NOT_SUPPORTED; -+ } -+ if (wnd->dma_map_count > 0) { -+ WARNING("%s: map registers already allocated: %u", -+ wnd->net_dev->name, wnd->dma_map_count); -+ EXIT2(return NDIS_STATUS_RESOURCES); -+ } -+ if (dmasize == NDIS_DMA_24BITS) { -+ if (pci_set_dma_mask(wnd->wd->pci.pdev, DMA_BIT_MASK(24)) || -+ pci_set_consistent_dma_mask(wnd->wd->pci.pdev, -+ DMA_BIT_MASK(24))) -+ WARNING("setting dma mask failed"); -+ } else if (dmasize == NDIS_DMA_32BITS) { -+ /* consistent dma is in low 32-bits by default */ -+ if (pci_set_dma_mask(wnd->wd->pci.pdev, DMA_BIT_MASK(32))) -+ WARNING("setting dma mask failed"); -+#ifdef CONFIG_X86_64 -+ } else if (dmasize == NDIS_DMA_64BITS) { -+ if (pci_set_dma_mask(wnd->wd->pci.pdev, DMA_BIT_MASK(64)) || -+ pci_set_consistent_dma_mask(wnd->wd->pci.pdev, -+ DMA_BIT_MASK(64))) -+ WARNING("setting dma mask failed"); -+ else -+ wnd->net_dev->features |= NETIF_F_HIGHDMA; -+#endif -+ } else { -+ ERROR("dmasize %d not supported", dmasize); -+ EXIT2(return NDIS_STATUS_NOT_SUPPORTED); -+ } -+ /* since memory for buffer is allocated with kmalloc, buffer -+ * is physically contiguous, so entire map will fit in one -+ * register */ -+ if (basemap > 64) { -+ WARNING("Windows driver %s requesting too many (%u) " -+ "map registers", wnd->wd->driver->name, basemap); -+ /* As per NDIS, NDIS_STATUS_RESOURCES should be -+ * returned, but with that Atheros PCI driver fails - -+ * for now tolerate it */ -+// EXIT2(return NDIS_STATUS_RESOURCES); -+ } -+ -+ wnd->dma_map_addr = kzalloc(basemap * sizeof(*(wnd->dma_map_addr)), -+ GFP_KERNEL); -+ if (!wnd->dma_map_addr) -+ EXIT2(return NDIS_STATUS_RESOURCES); -+ wnd->dma_map_count = basemap; -+ TRACE2("%u", wnd->dma_map_count); -+ EXIT2(return NDIS_STATUS_SUCCESS); -+} -+ -+wstdcall void WIN_FUNC(NdisMFreeMapRegisters,1) -+ (struct ndis_mp_block *nmb) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ int i; -+ -+ ENTER2("wnd: %p", wnd); -+ if (wnd->dma_map_addr) { -+ for (i = 0; i < wnd->dma_map_count; i++) { -+ if (wnd->dma_map_addr[i]) -+ WARNING("%s: dma addr 0x%llx not freed by " -+ "Windows driver", wnd->net_dev->name, -+ (unsigned long long)wnd->dma_map_addr[i]); -+ } -+ kfree(wnd->dma_map_addr); -+ wnd->dma_map_addr = NULL; -+ } else -+ WARNING("map registers already freed?"); -+ wnd->dma_map_count = 0; -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisMStartBufferPhysicalMapping,6) -+ (struct ndis_mp_block *nmb, ndis_buffer *buf, -+ ULONG index, BOOLEAN write_to_dev, -+ struct ndis_phy_addr_unit *phy_addr_array, UINT *array_size) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ -+ ENTER3("%p, %p, %u, %u", wnd, buf, index, wnd->dma_map_count); -+ if (!wrap_is_pci_bus(wnd->wd->dev_bus)) { -+ ERROR("used on a non-PCI device"); -+ return; -+ } -+ if (unlikely(wnd->sg_dma_size || !write_to_dev || -+ index >= wnd->dma_map_count)) { -+ WARNING("invalid request: %d, %d, %d, %d", wnd->sg_dma_size, -+ write_to_dev, index, wnd->dma_map_count); -+ phy_addr_array[0].phy_addr = 0; -+ phy_addr_array[0].length = 0; -+ *array_size = 0; -+ return; -+ } -+ if (wnd->dma_map_addr[index]) { -+ TRACE2("buffer %p at %d is already mapped: %llx", buf, index, -+ (unsigned long long)wnd->dma_map_addr[index]); -+// *array_size = 1; -+ return; -+ } -+ TRACE3("%p, %p, %u", buf, MmGetSystemAddressForMdl(buf), -+ MmGetMdlByteCount(buf)); -+ DBG_BLOCK(4) { -+ dump_bytes(__func__, MmGetSystemAddressForMdl(buf), -+ MmGetMdlByteCount(buf)); -+ } -+ wnd->dma_map_addr[index] = -+ PCI_DMA_MAP_SINGLE(wnd->wd->pci.pdev, -+ MmGetSystemAddressForMdl(buf), -+ MmGetMdlByteCount(buf), PCI_DMA_TODEVICE); -+ phy_addr_array[0].phy_addr = wnd->dma_map_addr[index]; -+ phy_addr_array[0].length = MmGetMdlByteCount(buf); -+ TRACE4("%llx, %d, %d", phy_addr_array[0].phy_addr, -+ phy_addr_array[0].length, index); -+ *array_size = 1; -+} -+ -+wstdcall void WIN_FUNC(NdisMCompleteBufferPhysicalMapping,3) -+ (struct ndis_mp_block *nmb, ndis_buffer *buf, ULONG index) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ -+ ENTER3("%p, %p %u (%u)", wnd, buf, index, wnd->dma_map_count); -+ -+ if (!wrap_is_pci_bus(wnd->wd->dev_bus)) { -+ ERROR("used on a non-PCI device"); -+ return; -+ } -+ if (unlikely(wnd->sg_dma_size)) -+ WARNING("buffer %p may have been unmapped already", buf); -+ if (index >= wnd->dma_map_count) { -+ ERROR("invalid map register (%u >= %u)", -+ index, wnd->dma_map_count); -+ return; -+ } -+ TRACE4("%llx", (unsigned long long)wnd->dma_map_addr[index]); -+ if (wnd->dma_map_addr[index]) { -+ PCI_DMA_UNMAP_SINGLE(wnd->wd->pci.pdev, wnd->dma_map_addr[index], -+ MmGetMdlByteCount(buf), PCI_DMA_TODEVICE); -+ wnd->dma_map_addr[index] = 0; -+ } else -+ WARNING("map registers at %u not used", index); -+} -+ -+wstdcall void WIN_FUNC(NdisMAllocateSharedMemory,5) -+ (struct ndis_mp_block *nmb, ULONG size, -+ BOOLEAN cached, void **virt, NDIS_PHY_ADDRESS *phys) -+{ -+ dma_addr_t dma_addr; -+ struct wrap_device *wd = nmb->wnd->wd; -+ -+ ENTER3("size: %u, cached: %d", size, cached); -+ if (!wrap_is_pci_bus(wd->dev_bus)) { -+ ERROR("used on a non-PCI device"); -+ return; -+ } -+ *virt = PCI_DMA_ALLOC_COHERENT(wd->pci.pdev, size, &dma_addr); -+ if (*virt) -+ *phys = dma_addr; -+ else -+ WARNING("couldn't allocate %d bytes of %scached DMA memory", -+ size, cached ? "" : "un-"); -+ EXIT3(return); -+} -+ -+wstdcall void WIN_FUNC(NdisMFreeSharedMemory,5) -+ (struct ndis_mp_block *nmb, ULONG size, BOOLEAN cached, -+ void *virt, NDIS_PHY_ADDRESS addr) -+{ -+ struct wrap_device *wd = nmb->wnd->wd; -+ ENTER3("%p, %llx, %u", virt, addr, size); -+ if (!wrap_is_pci_bus(wd->dev_bus)) { -+ ERROR("used on a non-PCI device"); -+ return; -+ } -+ PCI_DMA_FREE_COHERENT(wd->pci.pdev, size, virt, addr); -+ EXIT3(return); -+} -+ -+wstdcall void alloc_shared_memory_async(void *arg1, void *arg2) -+{ -+ struct ndis_device *wnd; -+ struct alloc_shared_mem *alloc_shared_mem; -+ struct miniport *mp; -+ void *virt; -+ NDIS_PHY_ADDRESS phys; -+ KIRQL irql; -+ -+ wnd = arg1; -+ alloc_shared_mem = arg2; -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ NdisMAllocateSharedMemory(wnd->nmb, alloc_shared_mem->size, -+ alloc_shared_mem->cached, &virt, &phys); -+ irql = serialize_lock_irql(wnd); -+ assert_irql(_irql_ == DISPATCH_LEVEL); -+ LIN2WIN5(mp->alloc_complete, wnd->nmb, virt, -+ &phys, alloc_shared_mem->size, alloc_shared_mem->ctx); -+ serialize_unlock_irql(wnd, irql); -+ kfree(alloc_shared_mem); -+} -+WIN_FUNC_DECL(alloc_shared_memory_async,2) -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMAllocateSharedMemoryAsync,4) -+ (struct ndis_mp_block *nmb, ULONG size, BOOLEAN cached, void *ctx) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ struct alloc_shared_mem *alloc_shared_mem; -+ -+ ENTER3("wnd: %p", wnd); -+ alloc_shared_mem = kmalloc(sizeof(*alloc_shared_mem), irql_gfp()); -+ if (!alloc_shared_mem) { -+ WARNING("couldn't allocate memory"); -+ return NDIS_STATUS_FAILURE; -+ } -+ -+ alloc_shared_mem->size = size; -+ alloc_shared_mem->cached = cached; -+ alloc_shared_mem->ctx = ctx; -+ if (schedule_ntos_work_item(WIN_FUNC_PTR(alloc_shared_memory_async,2), -+ wnd, alloc_shared_mem)) -+ EXIT3(return NDIS_STATUS_FAILURE); -+ EXIT3(return NDIS_STATUS_PENDING); -+} -+ -+/* Some drivers allocate NDIS_BUFFER (aka MDL) very often; instead of -+ * allocating and freeing with kernel functions, we chain them into -+ * ndis_buffer_pool. When an MDL is freed, it is added to the list of -+ * free MDLs. When allocated, we first check if there is one in free -+ * list and if so just return it; otherwise, we allocate a new one and -+ * return that. This reduces memory fragmentation. Windows DDK says -+ * that the driver itself shouldn't check what is returned in -+ * pool_handle, presumably because buffer pools are not used in -+ * XP. However, as long as driver follows rest of the semantics - that -+ * it should indicate maximum number of MDLs used with num_descr and -+ * pass the same pool_handle in other buffer functions, this should -+ * work. Sadly, though, NdisFreeBuffer doesn't pass the pool_handle, -+ * so we use 'process' field of MDL to store pool_handle. */ -+ -+wstdcall void WIN_FUNC(NdisAllocateBufferPool,3) -+ (NDIS_STATUS *status, struct ndis_buffer_pool **pool_handle, -+ UINT num_descr) -+{ -+ struct ndis_buffer_pool *pool; -+ -+ ENTER1("buffers: %d", num_descr); -+ pool = kmalloc(sizeof(*pool), irql_gfp()); -+ if (!pool) { -+ *status = NDIS_STATUS_RESOURCES; -+ EXIT3(return); -+ } -+ spin_lock_init(&pool->lock); -+ pool->max_descr = num_descr; -+ pool->num_allocated_descr = 0; -+ pool->free_descr = NULL; -+ *pool_handle = pool; -+ *status = NDIS_STATUS_SUCCESS; -+ TRACE1("pool: %p, num_descr: %d", pool, num_descr); -+ EXIT1(return); -+} -+ -+wstdcall void WIN_FUNC(NdisAllocateBuffer,5) -+ (NDIS_STATUS *status, ndis_buffer **buffer, -+ struct ndis_buffer_pool *pool, void *virt, UINT length) -+{ -+ ndis_buffer *descr; -+ -+ ENTER4("pool: %p (%d)", pool, pool->num_allocated_descr); -+ /* NDIS drivers should call this at DISPATCH_LEVEL, but -+ * alloc_tx_packet calls at SOFT_IRQL */ -+ assert_irql(_irql_ <= SOFT_LEVEL); -+ if (!pool) { -+ *status = NDIS_STATUS_FAILURE; -+ *buffer = NULL; -+ EXIT4(return); -+ } -+ spin_lock_bh(&pool->lock); -+ if ((descr = pool->free_descr)) -+ pool->free_descr = descr->next; -+ spin_unlock_bh(&pool->lock); -+ if (descr) { -+ typeof(descr->flags) flags; -+ flags = descr->flags; -+ memset(descr, 0, sizeof(*descr)); -+ MmInitializeMdl(descr, virt, length); -+ if (flags & MDL_CACHE_ALLOCATED) -+ descr->flags |= MDL_CACHE_ALLOCATED; -+ } else { -+ if (pool->num_allocated_descr > pool->max_descr) { -+ TRACE2("pool %p is full: %d(%d)", pool, -+ pool->num_allocated_descr, pool->max_descr); -+#ifndef ALLOW_POOL_OVERFLOW -+ *status = NDIS_STATUS_FAILURE; -+ *buffer = NULL; -+ return; -+#endif -+ } -+ descr = allocate_init_mdl(virt, length); -+ if (!descr) { -+ WARNING("couldn't allocate buffer"); -+ *status = NDIS_STATUS_FAILURE; -+ *buffer = NULL; -+ EXIT4(return); -+ } -+ TRACE4("buffer %p for %p, %d", descr, virt, length); -+ atomic_inc_var(pool->num_allocated_descr); -+ } -+ /* TODO: make sure this mdl can map given buffer */ -+ MmBuildMdlForNonPagedPool(descr); -+// descr->flags |= MDL_ALLOCATED_FIXED_SIZE | -+// MDL_MAPPED_TO_SYSTEM_VA | MDL_PAGES_LOCKED; -+ descr->pool = pool; -+ *buffer = descr; -+ *status = NDIS_STATUS_SUCCESS; -+ TRACE4("buffer: %p", descr); -+ EXIT4(return); -+} -+ -+wstdcall void WIN_FUNC(NdisFreeBuffer,1) -+ (ndis_buffer *buffer) -+{ -+ struct ndis_buffer_pool *pool; -+ -+ ENTER4("%p", buffer); -+ if (!buffer || !buffer->pool) { -+ ERROR("invalid buffer"); -+ EXIT4(return); -+ } -+ pool = buffer->pool; -+ if (pool->num_allocated_descr > MAX_ALLOCATED_NDIS_BUFFERS) { -+ /* NB NB NB: set mdl's 'pool' field to NULL before -+ * calling free_mdl; otherwise free_mdl calls -+ * NdisFreeBuffer back */ -+ atomic_dec_var(pool->num_allocated_descr); -+ buffer->pool = NULL; -+ free_mdl(buffer); -+ } else { -+ spin_lock_bh(&pool->lock); -+ buffer->next = pool->free_descr; -+ pool->free_descr = buffer; -+ spin_unlock_bh(&pool->lock); -+ } -+ EXIT4(return); -+} -+ -+wstdcall void WIN_FUNC(NdisFreeBufferPool,1) -+ (struct ndis_buffer_pool *pool) -+{ -+ ndis_buffer *cur, *next; -+ -+ TRACE3("pool: %p", pool); -+ if (!pool) { -+ WARNING("invalid pool"); -+ EXIT3(return); -+ } -+ spin_lock_bh(&pool->lock); -+ cur = pool->free_descr; -+ while (cur) { -+ next = cur->next; -+ cur->pool = NULL; -+ free_mdl(cur); -+ cur = next; -+ } -+ spin_unlock_bh(&pool->lock); -+ kfree(pool); -+ pool = NULL; -+ EXIT3(return); -+} -+ -+wstdcall void WIN_FUNC(NdisAdjustBufferLength,2) -+ (ndis_buffer *buffer, UINT length) -+{ -+ ENTER4("%p, %d", buffer, length); -+ buffer->bytecount = length; -+} -+ -+wstdcall void WIN_FUNC(NdisQueryBuffer,3) -+ (ndis_buffer *buffer, void **virt, UINT *length) -+{ -+ ENTER4("buffer: %p", buffer); -+ if (virt) -+ *virt = MmGetSystemAddressForMdl(buffer); -+ *length = MmGetMdlByteCount(buffer); -+ TRACE4("%p, %u", virt ? *virt : NULL, *length); -+ return; -+} -+ -+wstdcall void WIN_FUNC(NdisQueryBufferSafe,4) -+ (ndis_buffer *buffer, void **virt, UINT *length, -+ enum mm_page_priority priority) -+{ -+ ENTER4("%p, %p, %p, %d", buffer, virt, length, priority); -+ if (virt) -+ *virt = MmGetSystemAddressForMdlSafe(buffer, priority); -+ *length = MmGetMdlByteCount(buffer); -+ TRACE4("%p, %u", virt ? *virt : NULL, *length); -+} -+ -+wstdcall void *WIN_FUNC(NdisBufferVirtualAddress,1) -+ (ndis_buffer *buffer) -+{ -+ ENTER3("%p", buffer); -+ return MmGetSystemAddressForMdl(buffer); -+} -+ -+wstdcall ULONG WIN_FUNC(NdisBufferLength,1) -+ (ndis_buffer *buffer) -+{ -+ ENTER3("%p", buffer); -+ return MmGetMdlByteCount(buffer); -+} -+ -+wstdcall void WIN_FUNC(NdisQueryBufferOffset,3) -+ (ndis_buffer *buffer, UINT *offset, UINT *length) -+{ -+ ENTER3("%p", buffer); -+ *offset = MmGetMdlByteOffset(buffer); -+ *length = MmGetMdlByteCount(buffer); -+ TRACE3("%d, %d", *offset, *length); -+} -+ -+wstdcall void WIN_FUNC(NdisUnchainBufferAtBack,2) -+ (struct ndis_packet *packet, ndis_buffer **buffer) -+{ -+ ndis_buffer *b, *btail; -+ -+ ENTER3("%p", packet); -+ b = packet->private.buffer_head; -+ if (!b) { -+ /* no buffer in packet */ -+ *buffer = NULL; -+ EXIT3(return); -+ } -+ btail = packet->private.buffer_tail; -+ *buffer = btail; -+ if (b == btail) { -+ /* one buffer in packet */ -+ packet->private.buffer_head = NULL; -+ packet->private.buffer_tail = NULL; -+ } else { -+ while (b->next != btail) -+ b = b->next; -+ packet->private.buffer_tail = b; -+ b->next = NULL; -+ } -+ packet->private.valid_counts = FALSE; -+ EXIT3(return); -+} -+ -+wstdcall void WIN_FUNC(NdisUnchainBufferAtFront,2) -+ (struct ndis_packet *packet, ndis_buffer **buffer) -+{ -+ ENTER3("%p", packet); -+ if (packet->private.buffer_head == NULL) { -+ /* no buffer in packet */ -+ *buffer = NULL; -+ EXIT3(return); -+ } -+ -+ *buffer = packet->private.buffer_head; -+ if (packet->private.buffer_head == packet->private.buffer_tail) { -+ /* one buffer in packet */ -+ packet->private.buffer_head = NULL; -+ packet->private.buffer_tail = NULL; -+ } else -+ packet->private.buffer_head = (*buffer)->next; -+ -+ packet->private.valid_counts = FALSE; -+ EXIT3(return); -+} -+ -+wstdcall void WIN_FUNC(NdisGetFirstBufferFromPacketSafe,6) -+ (struct ndis_packet *packet, ndis_buffer **first_buffer, -+ void **first_buffer_va, UINT *first_buffer_length, -+ UINT *total_buffer_length, enum mm_page_priority priority) -+{ -+ ndis_buffer *b = packet->private.buffer_head; -+ -+ ENTER3("%p(%p)", packet, b); -+ *first_buffer = b; -+ if (b) { -+ *first_buffer_va = MmGetSystemAddressForMdlSafe(b, priority); -+ *first_buffer_length = *total_buffer_length = -+ MmGetMdlByteCount(b); -+ for (b = b->next; b; b = b->next) -+ *total_buffer_length += MmGetMdlByteCount(b); -+ } else { -+ *first_buffer_va = NULL; -+ *first_buffer_length = 0; -+ *total_buffer_length = 0; -+ } -+ TRACE3("%p, %d, %d", *first_buffer_va, *first_buffer_length, -+ *total_buffer_length); -+ EXIT3(return); -+} -+ -+wstdcall void WIN_FUNC(NdisGetFirstBufferFromPacket,6) -+ (struct ndis_packet *packet, ndis_buffer **first_buffer, -+ void **first_buffer_va, UINT *first_buffer_length, -+ UINT *total_buffer_length, enum mm_page_priority priority) -+{ -+ NdisGetFirstBufferFromPacketSafe(packet, first_buffer, -+ first_buffer_va, first_buffer_length, -+ total_buffer_length, -+ NormalPagePriority); -+} -+ -+wstdcall void WIN_FUNC(NdisAllocatePacketPoolEx,5) -+ (NDIS_STATUS *status, struct ndis_packet_pool **pool_handle, -+ UINT num_descr, UINT overflowsize, UINT proto_rsvd_length) -+{ -+ struct ndis_packet_pool *pool; -+ -+ ENTER3("buffers: %d, length: %d", num_descr, proto_rsvd_length); -+ pool = kzalloc(sizeof(*pool), irql_gfp()); -+ if (!pool) { -+ *status = NDIS_STATUS_RESOURCES; -+ EXIT3(return); -+ } -+ spin_lock_init(&pool->lock); -+ pool->max_descr = num_descr; -+ pool->num_allocated_descr = 0; -+ pool->num_used_descr = 0; -+ pool->free_descr = NULL; -+ pool->proto_rsvd_length = proto_rsvd_length; -+ *pool_handle = pool; -+ *status = NDIS_STATUS_SUCCESS; -+ TRACE3("pool: %p", pool); -+ EXIT3(return); -+} -+ -+wstdcall void WIN_FUNC(NdisAllocatePacketPool,4) -+ (NDIS_STATUS *status, struct ndis_packet_pool **pool_handle, -+ UINT num_descr, UINT proto_rsvd_length) -+{ -+ NdisAllocatePacketPoolEx(status, pool_handle, num_descr, 0, -+ proto_rsvd_length); -+ EXIT3(return); -+} -+ -+wstdcall void WIN_FUNC(NdisFreePacketPool,1) -+ (struct ndis_packet_pool *pool) -+{ -+ struct ndis_packet *packet, *next; -+ -+ ENTER3("pool: %p", pool); -+ if (!pool) { -+ WARNING("invalid pool"); -+ EXIT3(return); -+ } -+ spin_lock_bh(&pool->lock); -+ packet = pool->free_descr; -+ while (packet) { -+ next = (struct ndis_packet *)packet->reserved[0]; -+ kfree(packet); -+ packet = next; -+ } -+ pool->num_allocated_descr = 0; -+ pool->num_used_descr = 0; -+ pool->free_descr = NULL; -+ spin_unlock_bh(&pool->lock); -+ kfree(pool); -+ EXIT3(return); -+} -+ -+wstdcall UINT WIN_FUNC(NdisPacketPoolUsage,1) -+ (struct ndis_packet_pool *pool) -+{ -+ EXIT4(return pool->num_used_descr); -+} -+ -+wstdcall void WIN_FUNC(NdisAllocatePacket,3) -+ (NDIS_STATUS *status, struct ndis_packet **ndis_packet, -+ struct ndis_packet_pool *pool) -+{ -+ struct ndis_packet *packet; -+ int packet_length; -+ -+ ENTER4("pool: %p", pool); -+ if (!pool) { -+ *status = NDIS_STATUS_RESOURCES; -+ *ndis_packet = NULL; -+ EXIT4(return); -+ } -+ assert_irql(_irql_ <= SOFT_LEVEL); -+ if (pool->num_used_descr > pool->max_descr) { -+ TRACE3("pool %p is full: %d(%d)", pool, -+ pool->num_used_descr, pool->max_descr); -+#ifndef ALLOW_POOL_OVERFLOW -+ *status = NDIS_STATUS_RESOURCES; -+ *ndis_packet = NULL; -+ return; -+#endif -+ } -+ /* packet has space for 1 byte in protocol_reserved field */ -+ packet_length = sizeof(*packet) - 1 + pool->proto_rsvd_length + -+ sizeof(struct ndis_packet_oob_data); -+ spin_lock_bh(&pool->lock); -+ if ((packet = pool->free_descr)) -+ pool->free_descr = (void *)packet->reserved[0]; -+ spin_unlock_bh(&pool->lock); -+ if (!packet) { -+ packet = kmalloc(packet_length, irql_gfp()); -+ if (!packet) { -+ WARNING("couldn't allocate packet"); -+ *status = NDIS_STATUS_RESOURCES; -+ *ndis_packet = NULL; -+ return; -+ } -+ atomic_inc_var(pool->num_allocated_descr); -+ } -+ TRACE4("%p, %p", pool, packet); -+ atomic_inc_var(pool->num_used_descr); -+ memset(packet, 0, packet_length); -+ packet->private.oob_offset = -+ packet_length - sizeof(struct ndis_packet_oob_data); -+ packet->private.packet_flags = fPACKET_ALLOCATED_BY_NDIS; -+ packet->private.pool = pool; -+ *ndis_packet = packet; -+ *status = NDIS_STATUS_SUCCESS; -+ EXIT4(return); -+} -+ -+wstdcall void WIN_FUNC(NdisDprAllocatePacket,3) -+ (NDIS_STATUS *status, struct ndis_packet **packet, -+ struct ndis_packet_pool *pool) -+{ -+ NdisAllocatePacket(status, packet, pool); -+} -+ -+wstdcall void WIN_FUNC(NdisFreePacket,1) -+ (struct ndis_packet *packet) -+{ -+ struct ndis_packet_pool *pool; -+ -+ ENTER4("%p, %p", packet, packet->private.pool); -+ pool = packet->private.pool; -+ if (!pool) { -+ ERROR("invalid pool %p", packet); -+ EXIT4(return); -+ } -+ assert((int)pool->num_used_descr > 0); -+ atomic_dec_var(pool->num_used_descr); -+ if (packet->reserved[1]) { -+ TRACE3("%p, %p", packet, (void *)packet->reserved[1]); -+ kfree((void *)packet->reserved[1]); -+ packet->reserved[1] = 0; -+ } -+ if (pool->num_allocated_descr > MAX_ALLOCATED_NDIS_PACKETS) { -+ TRACE3("%p", pool); -+ atomic_dec_var(pool->num_allocated_descr); -+ kfree(packet); -+ } else { -+ TRACE4("%p, %p, %p", pool, packet, pool->free_descr); -+ spin_lock_bh(&pool->lock); -+ packet->reserved[0] = -+ (typeof(packet->reserved[0]))pool->free_descr; -+ pool->free_descr = packet; -+ spin_unlock_bh(&pool->lock); -+ } -+ EXIT4(return); -+} -+ -+wstdcall struct ndis_packet_stack *WIN_FUNC(NdisIMGetCurrentPacketStack,2) -+ (struct ndis_packet *packet, BOOLEAN *stacks_remain) -+{ -+ struct ndis_packet_stack *stack; -+ -+ if (!packet->reserved[1]) { -+ stack = kzalloc(2 * sizeof(*stack), irql_gfp()); -+ TRACE3("%p, %p", packet, stack); -+ packet->reserved[1] = (typeof(packet->reserved[1]))stack; -+ } else { -+ stack = (void *)packet->reserved[1];; -+ if (xchg(&stack->ndis_reserved[0], 1)) { -+ stack++; -+ if (xchg(&stack->ndis_reserved[0], 1)) -+ stack = NULL; -+ } -+ TRACE3("%p", stack); -+ } -+ if (stack) -+ *stacks_remain = TRUE; -+ else -+ *stacks_remain = FALSE; -+ -+ EXIT3(return stack); -+} -+ -+wstdcall void WIN_FUNC(NdisCopyFromPacketToPacketSafe,7) -+ (struct ndis_packet *dst, UINT dst_offset, UINT num_to_copy, -+ struct ndis_packet *src, UINT src_offset, UINT *num_copied, -+ enum mm_page_priority priority) -+{ -+ UINT dst_n, src_n, n, left; -+ ndis_buffer *dst_buf; -+ ndis_buffer *src_buf; -+ -+ ENTER4(""); -+ if (!dst || !src) { -+ *num_copied = 0; -+ EXIT4(return); -+ } -+ -+ dst_buf = dst->private.buffer_head; -+ src_buf = src->private.buffer_head; -+ -+ if (!dst_buf || !src_buf) { -+ *num_copied = 0; -+ EXIT4(return); -+ } -+ dst_n = MmGetMdlByteCount(dst_buf) - dst_offset; -+ src_n = MmGetMdlByteCount(src_buf) - src_offset; -+ -+ n = min(src_n, dst_n); -+ n = min(n, num_to_copy); -+ memcpy(MmGetSystemAddressForMdl(dst_buf) + dst_offset, -+ MmGetSystemAddressForMdl(src_buf) + src_offset, n); -+ -+ left = num_to_copy - n; -+ while (left > 0) { -+ src_offset += n; -+ dst_offset += n; -+ dst_n -= n; -+ src_n -= n; -+ if (dst_n == 0) { -+ dst_buf = dst_buf->next; -+ if (!dst_buf) -+ break; -+ dst_n = MmGetMdlByteCount(dst_buf); -+ dst_offset = 0; -+ } -+ if (src_n == 0) { -+ src_buf = src_buf->next; -+ if (!src_buf) -+ break; -+ src_n = MmGetMdlByteCount(src_buf); -+ src_offset = 0; -+ } -+ -+ n = min(src_n, dst_n); -+ n = min(n, left); -+ memcpy(MmGetSystemAddressForMdl(dst_buf) + dst_offset, -+ MmGetSystemAddressForMdl(src_buf) + src_offset, n); -+ left -= n; -+ } -+ *num_copied = num_to_copy - left; -+ EXIT4(return); -+} -+ -+wstdcall void WIN_FUNC(NdisCopyFromPacketToPacket,6) -+ (struct ndis_packet *dst, UINT dst_offset, UINT num_to_copy, -+ struct ndis_packet *src, UINT src_offset, UINT *num_copied) -+{ -+ NdisCopyFromPacketToPacketSafe(dst, dst_offset, num_to_copy, -+ src, src_offset, num_copied, -+ NormalPagePriority); -+ return; -+} -+ -+wstdcall void WIN_FUNC(NdisIMCopySendPerPacketInfo,2) -+ (struct ndis_packet *dst, struct ndis_packet *src) -+{ -+ struct ndis_packet_oob_data *dst_oob, *src_oob; -+ dst_oob = NDIS_PACKET_OOB_DATA(dst); -+ src_oob = NDIS_PACKET_OOB_DATA(src); -+ memcpy(&dst_oob->ext, &src_oob->ext, sizeof(dst_oob->ext)); -+ return; -+} -+ -+wstdcall void WIN_FUNC(NdisSend,3) -+ (NDIS_STATUS *status, struct ndis_mp_block *nmb, -+ struct ndis_packet *packet) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ struct miniport *mp; -+ KIRQL irql; -+ -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ if (mp->send_packets) { -+ irql = serialize_lock_irql(wnd); -+ assert_irql(_irql_ == DISPATCH_LEVEL); -+ LIN2WIN3(mp->send_packets, wnd->nmb->mp_ctx, &packet, 1); -+ serialize_unlock_irql(wnd, irql); -+ if (deserialized_driver(wnd)) -+ *status = NDIS_STATUS_PENDING; -+ else { -+ struct ndis_packet_oob_data *oob_data; -+ oob_data = NDIS_PACKET_OOB_DATA(packet); -+ *status = oob_data->status; -+ switch (*status) { -+ case NDIS_STATUS_SUCCESS: -+ free_tx_packet(wnd, packet, *status); -+ break; -+ case NDIS_STATUS_PENDING: -+ break; -+ case NDIS_STATUS_RESOURCES: -+ wnd->tx_ok = 0; -+ break; -+ case NDIS_STATUS_FAILURE: -+ default: -+ free_tx_packet(wnd, packet, *status); -+ break; -+ } -+ } -+ } else { -+ irql = serialize_lock_irql(wnd); -+ assert_irql(_irql_ == DISPATCH_LEVEL); -+ *status = LIN2WIN3(mp->send, wnd->nmb->mp_ctx, packet, 0); -+ serialize_unlock_irql(wnd, irql); -+ switch (*status) { -+ case NDIS_STATUS_SUCCESS: -+ free_tx_packet(wnd, packet, *status); -+ break; -+ case NDIS_STATUS_PENDING: -+ break; -+ case NDIS_STATUS_RESOURCES: -+ wnd->tx_ok = 0; -+ break; -+ case NDIS_STATUS_FAILURE: -+ default: -+ free_tx_packet(wnd, packet, *status); -+ break; -+ } -+ } -+ EXIT3(return); -+} -+ -+/* called for serialized drivers only */ -+wstdcall void mp_timer_dpc(struct kdpc *kdpc, void *ctx, void *arg1, void *arg2) -+{ -+ struct ndis_mp_timer *timer; -+ struct ndis_mp_block *nmb; -+ -+ timer = ctx; -+ TIMERENTER("%p, %p, %p, %p", timer, timer->func, timer->ctx, timer->nmb); -+ assert_irql(_irql_ == DISPATCH_LEVEL); -+ nmb = timer->nmb; -+ serialize_lock(nmb->wnd); -+ LIN2WIN4(timer->func, NULL, timer->ctx, NULL, NULL); -+ serialize_unlock(nmb->wnd); -+ TIMEREXIT(return); -+} -+WIN_FUNC_DECL(mp_timer_dpc,4) -+ -+wstdcall void WIN_FUNC(NdisMInitializeTimer,4) -+ (struct ndis_mp_timer *timer, struct ndis_mp_block *nmb, -+ DPC func, void *ctx) -+{ -+ TIMERENTER("%p, %p, %p, %p", timer, func, ctx, nmb); -+ assert_irql(_irql_ == PASSIVE_LEVEL); -+ timer->func = func; -+ timer->ctx = ctx; -+ timer->nmb = nmb; -+ if (deserialized_driver(nmb->wnd)) -+ KeInitializeDpc(&timer->kdpc, func, ctx); -+ else -+ KeInitializeDpc(&timer->kdpc, WIN_FUNC_PTR(mp_timer_dpc,4), -+ timer); -+ wrap_init_timer(&timer->nt_timer, NotificationTimer, nmb); -+ TIMEREXIT(return); -+} -+ -+wstdcall void WIN_FUNC(NdisMSetPeriodicTimer,2) -+ (struct ndis_mp_timer *timer, UINT period_ms) -+{ -+ unsigned long expires = MSEC_TO_HZ(period_ms); -+ -+ TIMERENTER("%p, %u, %ld", timer, period_ms, expires); -+ assert_irql(_irql_ <= DISPATCH_LEVEL); -+ wrap_set_timer(&timer->nt_timer, expires, expires, &timer->kdpc); -+ TIMEREXIT(return); -+} -+ -+wstdcall void WIN_FUNC(NdisMCancelTimer,2) -+ (struct ndis_mp_timer *timer, BOOLEAN *canceled) -+{ -+ TIMERENTER("%p", timer); -+ assert_irql(_irql_ <= DISPATCH_LEVEL); -+ *canceled = KeCancelTimer(&timer->nt_timer); -+ TIMERTRACE("%d", *canceled); -+ return; -+} -+ -+wstdcall void WIN_FUNC(NdisInitializeTimer,3) -+ (struct ndis_timer *timer, void *func, void *ctx) -+{ -+ TIMERENTER("%p, %p, %p", timer, func, ctx); -+ assert_irql(_irql_ == PASSIVE_LEVEL); -+ KeInitializeDpc(&timer->kdpc, func, ctx); -+ wrap_init_timer(&timer->nt_timer, NotificationTimer, NULL); -+ TIMEREXIT(return); -+} -+ -+/* NdisMSetTimer is a macro that calls NdisSetTimer with -+ * ndis_mp_timer typecast to ndis_timer */ -+ -+wstdcall void WIN_FUNC(NdisSetTimer,2) -+ (struct ndis_timer *timer, UINT duetime_ms) -+{ -+ unsigned long expires = MSEC_TO_HZ(duetime_ms); -+ -+ TIMERENTER("%p, %p, %u, %ld", timer, timer->nt_timer.wrap_timer, -+ duetime_ms, expires); -+ assert_irql(_irql_ <= DISPATCH_LEVEL); -+ wrap_set_timer(&timer->nt_timer, expires, 0, &timer->kdpc); -+ TIMEREXIT(return); -+} -+ -+wstdcall void WIN_FUNC(NdisCancelTimer,2) -+ (struct ndis_timer *timer, BOOLEAN *canceled) -+{ -+ TIMERENTER("%p", timer); -+ assert_irql(_irql_ <= DISPATCH_LEVEL); -+ *canceled = KeCancelTimer(&timer->nt_timer); -+ TIMEREXIT(return); -+} -+ -+wstdcall void WIN_FUNC(NdisMRegisterAdapterShutdownHandler,3) -+ (struct ndis_mp_block *nmb, void *ctx, void *func) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ ENTER1("%p", func); -+ wnd->wd->driver->ndis_driver->mp.shutdown = func; -+ wnd->shutdown_ctx = ctx; -+} -+ -+wstdcall void WIN_FUNC(NdisMDeregisterAdapterShutdownHandler,1) -+ (struct ndis_mp_block *nmb) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ wnd->wd->driver->ndis_driver->mp.shutdown = NULL; -+ wnd->shutdown_ctx = NULL; -+} -+ -+/* TODO: rt61 (serialized) driver doesn't want MiniportEnableInterrupt -+ * to be called in irq handler, but mrv800c (deserialized) driver -+ * wants. NDIS is confusing about when to call MiniportEnableInterrupt -+ * For now, handle these cases with two separate irq handlers based on -+ * observation of these two drivers. However, it is likely not -+ * correct. */ -+wstdcall void deserialized_irq_handler(struct kdpc *kdpc, void *ctx, -+ void *arg1, void *arg2) -+{ -+ struct ndis_device *wnd = ctx; -+ ndis_interrupt_handler irq_handler = arg1; -+ struct miniport *mp = arg2; -+ -+ TRACE6("%p", irq_handler); -+ assert_irql(_irql_ == DISPATCH_LEVEL); -+ LIN2WIN1(irq_handler, wnd->nmb->mp_ctx); -+ if (mp->enable_interrupt) -+ LIN2WIN1(mp->enable_interrupt, wnd->nmb->mp_ctx); -+ EXIT6(return); -+} -+WIN_FUNC_DECL(deserialized_irq_handler,4) -+ -+wstdcall void serialized_irq_handler(struct kdpc *kdpc, void *ctx, -+ void *arg1, void *arg2) -+{ -+ struct ndis_device *wnd = ctx; -+ ndis_interrupt_handler irq_handler = arg1; -+ -+ TRACE6("%p, %p, %p", wnd, irq_handler, arg2); -+ assert_irql(_irql_ == DISPATCH_LEVEL); -+ serialize_lock(wnd); -+ LIN2WIN1(irq_handler, arg2); -+ serialize_unlock(wnd); -+ EXIT6(return); -+} -+WIN_FUNC_DECL(serialized_irq_handler,4) -+ -+wstdcall BOOLEAN ndis_isr(struct kinterrupt *kinterrupt, void *ctx) -+{ -+ struct ndis_mp_interrupt *mp_interrupt = ctx; -+ struct ndis_device *wnd = mp_interrupt->nmb->wnd; -+ BOOLEAN recognized = TRUE, queue_handler = TRUE; -+ -+ TRACE6("%p", wnd); -+ /* kernel may call ISR when registering interrupt, in -+ * the same context if DEBUG_SHIRQ is enabled */ -+ assert_irql(_irql_ == DIRQL || _irql_ == PASSIVE_LEVEL); -+ if (mp_interrupt->shared) -+ LIN2WIN3(mp_interrupt->isr, &recognized, &queue_handler, -+ wnd->nmb->mp_ctx); -+ else { -+ struct miniport *mp; -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ LIN2WIN1(mp->disable_interrupt, wnd->nmb->mp_ctx); -+ /* it is not shared interrupt, so handler must be called */ -+ recognized = queue_handler = TRUE; -+ } -+ if (recognized) { -+ if (queue_handler) { -+ TRACE5("%p", &wnd->irq_kdpc); -+ queue_kdpc(&wnd->irq_kdpc); -+ } -+ EXIT6(return TRUE); -+ } -+ EXIT6(return FALSE); -+} -+WIN_FUNC_DECL(ndis_isr,2) -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMRegisterInterrupt,7) -+ (struct ndis_mp_interrupt *mp_interrupt, -+ struct ndis_mp_block *nmb, UINT vector, UINT level, -+ BOOLEAN req_isr, BOOLEAN shared, enum kinterrupt_mode mode) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ struct miniport *mp; -+ -+ ENTER1("%p, vector:%d, level:%d, req_isr:%d, shared:%d, mode:%d", -+ mp_interrupt, vector, level, req_isr, shared, mode); -+ -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ nt_spin_lock_init(&mp_interrupt->lock); -+ mp_interrupt->irq = vector; -+ mp_interrupt->isr = mp->isr; -+ mp_interrupt->mp_dpc = mp->handle_interrupt; -+ mp_interrupt->nmb = nmb; -+ mp_interrupt->req_isr = req_isr; -+ if (shared && !req_isr) -+ WARNING("shared but dynamic interrupt!"); -+ mp_interrupt->shared = shared; -+ wnd->mp_interrupt = mp_interrupt; -+ if (mp->enable_interrupt) -+ mp_interrupt->enable = TRUE; -+ else -+ mp_interrupt->enable = FALSE; -+ -+ if (deserialized_driver(wnd)) { -+ KeInitializeDpc(&wnd->irq_kdpc, -+ WIN_FUNC_PTR(deserialized_irq_handler,4), -+ nmb->wnd); -+ wnd->irq_kdpc.arg1 = mp->handle_interrupt; -+ wnd->irq_kdpc.arg2 = mp; -+ TRACE2("%p, %p, %p, %p", wnd->irq_kdpc.arg1, wnd->irq_kdpc.arg2, -+ nmb->wnd, nmb->mp_ctx); -+ } else { -+ KeInitializeDpc(&wnd->irq_kdpc, -+ WIN_FUNC_PTR(serialized_irq_handler,4), -+ nmb->wnd); -+ wnd->irq_kdpc.arg1 = mp->handle_interrupt; -+ wnd->irq_kdpc.arg2 = nmb->mp_ctx; -+ TRACE2("%p, %p, %p", wnd->irq_kdpc.arg1, wnd->irq_kdpc.arg2, -+ nmb->wnd); -+ } -+ -+ if (IoConnectInterrupt(&mp_interrupt->kinterrupt, -+ WIN_FUNC_PTR(ndis_isr,2), mp_interrupt, NULL, -+ vector, DIRQL, DIRQL, mode, shared, 0, FALSE) != -+ STATUS_SUCCESS) { -+ printk(KERN_WARNING "%s: request for IRQ %d failed\n", -+ DRIVER_NAME, vector); -+ return NDIS_STATUS_RESOURCES; -+ } -+ printk(KERN_INFO "%s: using IRQ %d\n", DRIVER_NAME, vector); -+ EXIT1(return NDIS_STATUS_SUCCESS); -+} -+ -+wstdcall void WIN_FUNC(NdisMDeregisterInterrupt,1) -+ (struct ndis_mp_interrupt *mp_interrupt) -+{ -+ struct ndis_mp_block *nmb; -+ -+ ENTER1("%p", mp_interrupt); -+ nmb = xchg(&mp_interrupt->nmb, NULL); -+ TRACE1("%p", nmb); -+ if (!nmb) { -+ WARNING("interrupt already freed?"); -+ return; -+ } -+ nmb->wnd->mp_interrupt = NULL; -+ if (dequeue_kdpc(&nmb->wnd->irq_kdpc)) -+ TRACE2("interrupt kdpc was pending"); -+ flush_workqueue(wrapndis_wq); -+ IoDisconnectInterrupt(mp_interrupt->kinterrupt); -+ EXIT1(return); -+} -+ -+wstdcall BOOLEAN WIN_FUNC(NdisMSynchronizeWithInterrupt,3) -+ (struct ndis_mp_interrupt *mp_interrupt, -+ PKSYNCHRONIZE_ROUTINE sync_func, void *ctx) -+{ -+ return KeSynchronizeExecution(mp_interrupt->kinterrupt, sync_func, ctx); -+} -+ -+/* called via function pointer; but 64-bit RNDIS driver calls directly */ -+wstdcall void WIN_FUNC(NdisMIndicateStatus,4) -+ (struct ndis_mp_block *nmb, NDIS_STATUS status, void *buf, UINT len) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ struct ndis_status_indication *si; -+ -+ ENTER2("status=0x%x len=%d", status, len); -+ switch (status) { -+ case NDIS_STATUS_MEDIA_CONNECT: -+ set_media_state(wnd, NdisMediaStateConnected); -+ break; -+ case NDIS_STATUS_MEDIA_DISCONNECT: -+ set_media_state(wnd, NdisMediaStateDisconnected); -+ break; -+ case NDIS_STATUS_MEDIA_SPECIFIC_INDICATION: -+ if (!buf) -+ break; -+ si = buf; -+ TRACE2("status_type=%d", si->status_type); -+ switch (si->status_type) { -+ case Ndis802_11StatusType_MediaStreamMode: -+ break; -+#ifdef CONFIG_WIRELESS_EXT -+ case Ndis802_11StatusType_Authentication: -+ buf = (char *)buf + sizeof(*si); -+ len -= sizeof(*si); -+ while (len > 0) { -+ int pairwise_error = 0, group_error = 0; -+ struct ndis_auth_req *auth_req = -+ (struct ndis_auth_req *)buf; -+ TRACE1(MACSTRSEP, MAC2STR(auth_req->bssid)); -+ if (auth_req->flags & 0x01) -+ TRACE2("reauth request"); -+ if (auth_req->flags & 0x02) -+ TRACE2("key update request"); -+ if (auth_req->flags & 0x06) { -+ pairwise_error = 1; -+ TRACE2("pairwise_error"); -+ } -+ if (auth_req->flags & 0x0E) { -+ group_error = 1; -+ TRACE2("group_error"); -+ } -+ if (pairwise_error || group_error) { -+ union iwreq_data wrqu; -+ struct iw_michaelmicfailure micfailure; -+ -+ memset(&micfailure, 0, sizeof(micfailure)); -+ if (pairwise_error) -+ micfailure.flags |= -+ IW_MICFAILURE_PAIRWISE; -+ if (group_error) -+ micfailure.flags |= -+ IW_MICFAILURE_GROUP; -+ memcpy(micfailure.src_addr.sa_data, -+ auth_req->bssid, ETH_ALEN); -+ memset(&wrqu, 0, sizeof(wrqu)); -+ wrqu.data.length = sizeof(micfailure); -+ wireless_send_event(wnd->net_dev, -+ IWEVMICHAELMICFAILURE, -+ &wrqu, (u8 *)&micfailure); -+ } -+ len -= auth_req->length; -+ buf = (char *)buf + auth_req->length; -+ } -+ break; -+ case Ndis802_11StatusType_PMKID_CandidateList: -+ { -+ u8 *end; -+ unsigned long i; -+ struct ndis_pmkid_candidate_list *cand; -+ -+ cand = buf + sizeof(struct ndis_status_indication); -+ if (len < sizeof(struct ndis_status_indication) + -+ sizeof(struct ndis_pmkid_candidate_list) || -+ cand->version != 1) { -+ WARNING("unrecognized PMKID ignored"); -+ EXIT1(return); -+ } -+ -+ end = (u8 *)buf + len; -+ TRACE2("PMKID ver %d num_cand %d", -+ cand->version, cand->num_candidates); -+ for (i = 0; i < cand->num_candidates; i++) { -+ struct iw_pmkid_cand pcand; -+ union iwreq_data wrqu; -+ struct ndis_pmkid_candidate *c = -+ &cand->candidates[i]; -+ if ((u8 *)(c + 1) > end) { -+ TRACE2("truncated PMKID"); -+ break; -+ } -+ TRACE2("%ld: " MACSTRSEP " 0x%x", -+ i, MAC2STR(c->bssid), c->flags); -+ memset(&pcand, 0, sizeof(pcand)); -+ if (c->flags & 0x01) -+ pcand.flags |= IW_PMKID_CAND_PREAUTH; -+ pcand.index = i; -+ memcpy(pcand.bssid.sa_data, c->bssid, ETH_ALEN); -+ -+ memset(&wrqu, 0, sizeof(wrqu)); -+ wrqu.data.length = sizeof(pcand); -+ wireless_send_event(wnd->net_dev, IWEVPMKIDCAND, -+ &wrqu, (u8 *)&pcand); -+ } -+ break; -+ } -+ case Ndis802_11StatusType_RadioState: -+ { -+ struct ndis_radio_status_indication *radio_status = buf; -+ if (radio_status->radio_state == -+ Ndis802_11RadioStatusOn) -+ INFO("radio is turned on"); -+ else if (radio_status->radio_state == -+ Ndis802_11RadioStatusHardwareOff) -+ INFO("radio is turned off by hardware"); -+ else if (radio_status->radio_state == -+ Ndis802_11RadioStatusSoftwareOff) -+ INFO("radio is turned off by software"); -+ break; -+ } -+#endif -+ default: -+ /* is this RSSI indication? */ -+ TRACE2("unknown indication: %x", si->status_type); -+ break; -+ } -+ break; -+ default: -+ TRACE2("unknown status: %08X", status); -+ break; -+ } -+ -+ EXIT2(return); -+} -+ -+/* called via function pointer; but 64-bit RNDIS driver calls directly */ -+wstdcall void WIN_FUNC(NdisMIndicateStatusComplete,1) -+ (struct ndis_mp_block *nmb) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ ENTER2("%p", wnd); -+ if (wnd->tx_ok) -+ queue_work(wrapndis_wq, &wnd->tx_work); -+} -+ -+/* called via function pointer */ -+wstdcall void NdisMSendComplete(struct ndis_mp_block *nmb, -+ struct ndis_packet *packet, NDIS_STATUS status) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ ENTER4("%p, %08X", packet, status); -+ assert_irql(_irql_ <= DISPATCH_LEVEL); -+ if (deserialized_driver(wnd)) -+ free_tx_packet(wnd, packet, status); -+ else { -+ struct ndis_packet_oob_data *oob_data; -+ NDIS_STATUS pkt_status; -+ TRACE3("%p, %08x", packet, status); -+ oob_data = NDIS_PACKET_OOB_DATA(packet); -+ switch ((pkt_status = xchg(&oob_data->status, status))) { -+ case NDIS_STATUS_NOT_RECOGNIZED: -+ free_tx_packet(wnd, packet, status); -+ break; -+ case NDIS_STATUS_PENDING: -+ case 0: -+ break; -+ default: -+ WARNING("%p: invalid status: %08X", packet, pkt_status); -+ break; -+ } -+ /* In case a serialized driver has earlier requested a -+ * pause by returning NDIS_STATUS_RESOURCES during -+ * MiniportSend(Packets), wakeup tx worker now. -+ */ -+ if (xchg(&wnd->tx_ok, 1) == 0) { -+ TRACE3("%d, %d", wnd->tx_ring_start, wnd->tx_ring_end); -+ queue_work(wrapndis_wq, &wnd->tx_work); -+ } -+ } -+ EXIT3(return); -+} -+ -+/* called via function pointer */ -+wstdcall void NdisMSendResourcesAvailable(struct ndis_mp_block *nmb) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ ENTER3("%d, %d", wnd->tx_ring_start, wnd->tx_ring_end); -+ wnd->tx_ok = 1; -+ queue_work(wrapndis_wq, &wnd->tx_work); -+ EXIT3(return); -+} -+ -+wstdcall void return_packet(void *arg1, void *arg2) -+{ -+ struct ndis_device *wnd; -+ struct ndis_packet *packet; -+ struct miniport *mp; -+ KIRQL irql; -+ -+ wnd = arg1; -+ packet = arg2; -+ ENTER4("%p, %p", wnd, packet); -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ irql = serialize_lock_irql(wnd); -+ assert_irql(_irql_ == DISPATCH_LEVEL); -+ LIN2WIN2(mp->return_packet, wnd->nmb->mp_ctx, packet); -+ serialize_unlock_irql(wnd, irql); -+ EXIT4(return); -+} -+WIN_FUNC_DECL(return_packet,2) -+ -+/* called via function pointer */ -+wstdcall void NdisMIndicateReceivePacket(struct ndis_mp_block *nmb, -+ struct ndis_packet **packets, -+ UINT nr_packets) -+{ -+ struct ndis_device *wnd; -+ ndis_buffer *buffer; -+ struct ndis_packet *packet; -+ struct sk_buff *skb; -+ ULONG i, length, total_length; -+ struct ndis_packet_oob_data *oob_data; -+ void *virt; -+ struct ndis_tcp_ip_checksum_packet_info csum; -+ -+ ENTER3("%p, %d", nmb, nr_packets); -+ assert_irql(_irql_ <= DISPATCH_LEVEL); -+ wnd = nmb->wnd; -+ for (i = 0; i < nr_packets; i++) { -+ packet = packets[i]; -+ if (!packet) { -+ WARNING("empty packet ignored"); -+ continue; -+ } -+ wnd->net_dev->last_rx = jiffies; -+ /* get total number of bytes in packet */ -+ NdisGetFirstBufferFromPacketSafe(packet, &buffer, &virt, -+ &length, &total_length, -+ NormalPagePriority); -+ TRACE3("%d, %d", length, total_length); -+ oob_data = NDIS_PACKET_OOB_DATA(packet); -+ TRACE3("0x%x, 0x%x, %llu", packet->private.flags, -+ packet->private.packet_flags, oob_data->time_rxed); -+ skb = dev_alloc_skb(total_length); -+ if (skb) { -+ while (buffer) { -+ memcpy_skb(skb, MmGetSystemAddressForMdl(buffer), -+ MmGetMdlByteCount(buffer)); -+ buffer = buffer->next; -+ } -+ skb->dev = wnd->net_dev; -+ skb->protocol = eth_type_trans(skb, wnd->net_dev); -+ pre_atomic_add(wnd->net_stats.rx_bytes, total_length); -+ atomic_inc_var(wnd->net_stats.rx_packets); -+ csum.value = (typeof(csum.value))(ULONG_PTR) -+ oob_data->ext.info[TcpIpChecksumPacketInfo]; -+ TRACE3("0x%05x", csum.value); -+ if (wnd->rx_csum.value && -+ (csum.rx.tcp_succeeded || csum.rx.udp_succeeded || -+ csum.rx.ip_succeeded)) -+ skb->ip_summed = CHECKSUM_UNNECESSARY; -+ else -+ skb->ip_summed = CHECKSUM_NONE; -+ -+ if (in_interrupt()) -+ netif_rx(skb); -+ else -+ netif_rx_ni(skb); -+ } else { -+ WARNING("couldn't allocate skb; packet dropped"); -+ atomic_inc_var(wnd->net_stats.rx_dropped); -+ } -+ -+ /* serialized drivers check the status upon return -+ * from this function */ -+ if (!deserialized_driver(wnd)) { -+ oob_data->status = NDIS_STATUS_SUCCESS; -+ continue; -+ } -+ -+ /* if a deserialized driver sets -+ * NDIS_STATUS_RESOURCES, then it reclaims the packet -+ * upon return from this function */ -+ if (oob_data->status == NDIS_STATUS_RESOURCES) -+ continue; -+ -+ assert(oob_data->status == NDIS_STATUS_SUCCESS); -+ /* deserialized driver doesn't check the status upon -+ * return from this function; we need to call -+ * MiniportReturnPacket later for this packet. Calling -+ * MiniportReturnPacket from here is not correct - the -+ * driver doesn't expect it (at least Centrino driver -+ * crashes) */ -+ schedule_ntos_work_item(WIN_FUNC_PTR(return_packet,2), -+ wnd, packet); -+ } -+ EXIT3(return); -+} -+ -+/* called via function pointer (by NdisMEthIndicateReceive macro); the -+ * first argument is nmb->eth_db */ -+wstdcall void EthRxIndicateHandler(struct ndis_mp_block *nmb, void *rx_ctx, -+ char *header1, char *header, UINT header_size, -+ void *look_ahead, UINT look_ahead_size, -+ UINT packet_size) -+{ -+ struct sk_buff *skb = NULL; -+ struct ndis_device *wnd; -+ unsigned int skb_size = 0; -+ KIRQL irql; -+ struct ndis_packet_oob_data *oob_data; -+ -+ ENTER3("nmb = %p, rx_ctx = %p, buf = %p, size = %d, buf = %p, " -+ "size = %d, packet = %d", nmb, rx_ctx, header, header_size, -+ look_ahead, look_ahead_size, packet_size); -+ -+ wnd = nmb->wnd; -+ TRACE3("wnd = %p", wnd); -+ if (!wnd) { -+ ERROR("nmb is NULL"); -+ EXIT3(return); -+ } -+ wnd->net_dev->last_rx = jiffies; -+ -+ if (look_ahead_size < packet_size) { -+ struct ndis_packet *packet; -+ struct miniport *mp; -+ unsigned int bytes_txed; -+ NDIS_STATUS res; -+ -+ NdisAllocatePacket(&res, &packet, wnd->tx_packet_pool); -+ if (res != NDIS_STATUS_SUCCESS) { -+ atomic_inc_var(wnd->net_stats.rx_dropped); -+ EXIT3(return); -+ } -+ oob_data = NDIS_PACKET_OOB_DATA(packet); -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ irql = serialize_lock_irql(wnd); -+ assert_irql(_irql_ == DISPATCH_LEVEL); -+ res = LIN2WIN6(mp->tx_data, packet, &bytes_txed, nmb, -+ rx_ctx, look_ahead_size, packet_size); -+ serialize_unlock_irql(wnd, irql); -+ TRACE3("%d, %d, %d", header_size, look_ahead_size, bytes_txed); -+ if (res == NDIS_STATUS_SUCCESS) { -+ ndis_buffer *buffer; -+ struct ndis_tcp_ip_checksum_packet_info csum; -+ skb = dev_alloc_skb(header_size + look_ahead_size + -+ bytes_txed); -+ if (!skb) { -+ ERROR("couldn't allocate skb; packet dropped"); -+ atomic_inc_var(wnd->net_stats.rx_dropped); -+ NdisFreePacket(packet); -+ return; -+ } -+ memcpy_skb(skb, header, header_size); -+ memcpy_skb(skb, look_ahead, look_ahead_size); -+ buffer = packet->private.buffer_head; -+ while (buffer) { -+ memcpy_skb(skb, -+ MmGetSystemAddressForMdl(buffer), -+ MmGetMdlByteCount(buffer)); -+ buffer = buffer->next; -+ } -+ skb_size = header_size + look_ahead_size + bytes_txed; -+ csum.value = (typeof(csum.value))(ULONG_PTR) -+ oob_data->ext.info[TcpIpChecksumPacketInfo]; -+ TRACE3("0x%05x", csum.value); -+ if (wnd->rx_csum.value && -+ (csum.rx.tcp_succeeded || csum.rx.udp_succeeded)) -+ skb->ip_summed = CHECKSUM_UNNECESSARY; -+ else -+ skb->ip_summed = CHECKSUM_NONE; -+ NdisFreePacket(packet); -+ } else if (res == NDIS_STATUS_PENDING) { -+ /* driver will call td_complete */ -+ oob_data->look_ahead = kmalloc(look_ahead_size, -+ GFP_ATOMIC); -+ if (!oob_data->look_ahead) { -+ NdisFreePacket(packet); -+ ERROR("packet dropped"); -+ atomic_inc_var(wnd->net_stats.rx_dropped); -+ EXIT3(return); -+ } -+ assert(sizeof(oob_data->header) == header_size); -+ memcpy(oob_data->header, header, -+ sizeof(oob_data->header)); -+ memcpy(oob_data->look_ahead, look_ahead, -+ look_ahead_size); -+ oob_data->look_ahead_size = look_ahead_size; -+ EXIT3(return); -+ } else { -+ WARNING("packet dropped: %08X", res); -+ atomic_inc_var(wnd->net_stats.rx_dropped); -+ NdisFreePacket(packet); -+ EXIT3(return); -+ } -+ } else { -+ skb_size = header_size + packet_size; -+ skb = dev_alloc_skb(skb_size); -+ if (skb) { -+ memcpy_skb(skb, header, header_size); -+ memcpy_skb(skb, look_ahead, packet_size); -+ } -+ } -+ -+ if (skb) { -+ skb->dev = wnd->net_dev; -+ skb->protocol = eth_type_trans(skb, wnd->net_dev); -+ pre_atomic_add(wnd->net_stats.rx_bytes, skb_size); -+ atomic_inc_var(wnd->net_stats.rx_packets); -+ if (in_interrupt()) -+ netif_rx(skb); -+ else -+ netif_rx_ni(skb); -+ } -+ -+ EXIT3(return); -+} -+ -+/* called via function pointer */ -+wstdcall void NdisMTransferDataComplete(struct ndis_mp_block *nmb, -+ struct ndis_packet *packet, -+ NDIS_STATUS status, UINT bytes_txed) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ struct sk_buff *skb; -+ unsigned int skb_size; -+ struct ndis_packet_oob_data *oob_data; -+ ndis_buffer *buffer; -+ struct ndis_tcp_ip_checksum_packet_info csum; -+ -+ ENTER3("wnd = %p, packet = %p, bytes_txed = %d", -+ wnd, packet, bytes_txed); -+ if (!packet) { -+ WARNING("illegal packet"); -+ EXIT3(return); -+ } -+ wnd->net_dev->last_rx = jiffies; -+ oob_data = NDIS_PACKET_OOB_DATA(packet); -+ skb_size = sizeof(oob_data->header) + oob_data->look_ahead_size + -+ bytes_txed; -+ skb = dev_alloc_skb(skb_size); -+ if (!skb) { -+ kfree(oob_data->look_ahead); -+ NdisFreePacket(packet); -+ ERROR("couldn't allocate skb; packet dropped"); -+ atomic_inc_var(wnd->net_stats.rx_dropped); -+ EXIT3(return); -+ } -+ memcpy_skb(skb, oob_data->header, sizeof(oob_data->header)); -+ memcpy_skb(skb, oob_data->look_ahead, oob_data->look_ahead_size); -+ buffer = packet->private.buffer_head; -+ while (buffer) { -+ memcpy_skb(skb, MmGetSystemAddressForMdl(buffer), -+ MmGetMdlByteCount(buffer)); -+ buffer = buffer->next; -+ } -+ kfree(oob_data->look_ahead); -+ NdisFreePacket(packet); -+ skb->dev = wnd->net_dev; -+ skb->protocol = eth_type_trans(skb, wnd->net_dev); -+ pre_atomic_add(wnd->net_stats.rx_bytes, skb_size); -+ atomic_inc_var(wnd->net_stats.rx_packets); -+ -+ csum.value = (typeof(csum.value))(ULONG_PTR) -+ oob_data->ext.info[TcpIpChecksumPacketInfo]; -+ TRACE3("0x%05x", csum.value); -+ if (wnd->rx_csum.value && -+ (csum.rx.tcp_succeeded || csum.rx.udp_succeeded)) -+ skb->ip_summed = CHECKSUM_UNNECESSARY; -+ else -+ skb->ip_summed = CHECKSUM_NONE; -+ -+ if (in_interrupt()) -+ netif_rx(skb); -+ else -+ netif_rx_ni(skb); -+} -+ -+/* called via function pointer */ -+wstdcall void EthRxComplete(struct ndis_mp_block *nmb) -+{ -+ TRACE3(""); -+} -+ -+/* called via function pointer */ -+wstdcall void NdisMQueryInformationComplete(struct ndis_mp_block *nmb, -+ NDIS_STATUS status) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ typeof(wnd->ndis_req_task) task; -+ -+ ENTER2("nmb: %p, wnd: %p, %08X", nmb, wnd, status); -+ wnd->ndis_req_status = status; -+ wnd->ndis_req_done = 1; -+ if ((task = xchg(&wnd->ndis_req_task, NULL))) -+ wake_up_process(task); -+ else -+ WARNING("invalid task"); -+ EXIT2(return); -+} -+ -+/* called via function pointer */ -+wstdcall void NdisMSetInformationComplete(struct ndis_mp_block *nmb, -+ NDIS_STATUS status) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ typeof(wnd->ndis_req_task) task; -+ -+ ENTER2("status = %08X", status); -+ wnd->ndis_req_status = status; -+ wnd->ndis_req_done = 1; -+ if ((task = xchg(&wnd->ndis_req_task, NULL))) -+ wake_up_process(task); -+ else -+ WARNING("invalid task"); -+ EXIT2(return); -+} -+ -+/* called via function pointer */ -+wstdcall void NdisMResetComplete(struct ndis_mp_block *nmb, -+ NDIS_STATUS status, BOOLEAN address_reset) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ typeof(wnd->ndis_req_task) task; -+ -+ ENTER2("status: %08X, %u", status, address_reset); -+ wnd->ndis_req_status = status; -+ wnd->ndis_req_done = address_reset + 1; -+ if ((task = xchg(&wnd->ndis_req_task, NULL))) -+ wake_up_process(task); -+ else -+ WARNING("invalid task"); -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(NdisMSleep,1) -+ (ULONG us) -+{ -+ unsigned long delay; -+ -+ ENTER4("%p: us: %u", current, us); -+ delay = USEC_TO_HZ(us); -+ sleep_hz(delay); -+ TRACE4("%p: done", current); -+} -+ -+wstdcall void WIN_FUNC(NdisGetCurrentSystemTime,1) -+ (LARGE_INTEGER *time) -+{ -+ *time = ticks_1601(); -+ TRACE5("%llu, %lu", *time, jiffies); -+} -+ -+wstdcall LONG WIN_FUNC(NdisInterlockedDecrement,1) -+ (LONG *val) -+{ -+ return InterlockedDecrement(val); -+} -+ -+wstdcall LONG WIN_FUNC(NdisInterlockedIncrement,1) -+ (LONG *val) -+{ -+ return InterlockedIncrement(val); -+} -+ -+wstdcall struct nt_list *WIN_FUNC(NdisInterlockedInsertHeadList,3) -+ (struct nt_list *head, struct nt_list *entry, -+ struct ndis_spinlock *lock) -+{ -+ return ExInterlockedInsertHeadList(head, entry, &lock->klock); -+} -+ -+wstdcall struct nt_list *WIN_FUNC(NdisInterlockedInsertTailList,3) -+ (struct nt_list *head, struct nt_list *entry, -+ struct ndis_spinlock *lock) -+{ -+ return ExInterlockedInsertTailList(head, entry, &lock->klock); -+} -+ -+wstdcall struct nt_list *WIN_FUNC(NdisInterlockedRemoveHeadList,2) -+ (struct nt_list *head, struct ndis_spinlock *lock) -+{ -+ return ExInterlockedRemoveHeadList(head, &lock->klock); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMInitializeScatterGatherDma,3) -+ (struct ndis_mp_block *nmb, BOOLEAN dma64_supported, ULONG max_phy_map) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ ENTER2("dma64_supported=%d, maxtransfer=%u", dma64_supported, -+ max_phy_map); -+ if (!wrap_is_pci_bus(wnd->wd->dev_bus)) { -+ ERROR("used on a non-PCI device"); -+ return NDIS_STATUS_NOT_SUPPORTED; -+ } -+#ifdef CONFIG_X86_64 -+ if (!dma64_supported) { -+ TRACE1("64-bit DMA size is not supported"); -+ if (pci_set_dma_mask(wnd->wd->pci.pdev, DMA_BIT_MASK(32)) || -+ pci_set_consistent_dma_mask(wnd->wd->pci.pdev, -+ DMA_BIT_MASK(32))) -+ WARNING("setting dma mask failed"); -+ } -+#endif -+ if ((wnd->attributes & NDIS_ATTRIBUTE_BUS_MASTER) && -+ wrap_is_pci_bus(wnd->wd->dev_bus)) { -+ wnd->sg_dma_size = max_phy_map; -+ return NDIS_STATUS_SUCCESS; -+ } else -+ EXIT1(return NDIS_STATUS_NOT_SUPPORTED); -+} -+ -+wstdcall ULONG WIN_FUNC(NdisMGetDmaAlignment,1) -+ (struct ndis_mp_block *nmb) -+{ -+ ENTER3(""); -+ return dma_get_cache_alignment(); -+} -+ -+wstdcall CHAR WIN_FUNC(NdisSystemProcessorCount,0) -+ (void) -+{ -+ return num_online_cpus(); -+} -+ -+wstdcall void WIN_FUNC(NdisGetCurrentProcessorCounts,3) -+ (ULONG *idle, ULONG *kernel_user, ULONG *index) -+{ -+ int cpu = smp_processor_id(); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,3,0) -+ *idle = kcpustat_cpu(cpu).cpustat[CPUTIME_IDLE]; -+ *kernel_user = kcpustat_cpu(cpu).cpustat[CPUTIME_SYSTEM] + -+ kcpustat_cpu(cpu).cpustat[CPUTIME_USER]; -+#else -+ *idle = kstat_cpu(cpu).cpustat.idle; -+ *kernel_user = kstat_cpu(cpu).cpustat.system + -+ kstat_cpu(cpu).cpustat.user; -+#endif -+ *index = cpu; -+} -+ -+wstdcall void WIN_FUNC(NdisInitializeEvent,1) -+ (struct ndis_event *ndis_event) -+{ -+ EVENTENTER("%p", ndis_event); -+ KeInitializeEvent(&ndis_event->nt_event, NotificationEvent, 0); -+} -+ -+wstdcall BOOLEAN WIN_FUNC(NdisWaitEvent,2) -+ (struct ndis_event *ndis_event, UINT ms) -+{ -+ LARGE_INTEGER ticks; -+ NTSTATUS res; -+ -+ EVENTENTER("%p %u", ndis_event, ms); -+ ticks = -((LARGE_INTEGER)ms * TICKSPERMSEC); -+ res = KeWaitForSingleObject(&ndis_event->nt_event, 0, 0, TRUE, -+ ms == 0 ? NULL : &ticks); -+ if (res == STATUS_SUCCESS) -+ EXIT3(return TRUE); -+ else -+ EXIT3(return FALSE); -+} -+ -+wstdcall void WIN_FUNC(NdisSetEvent,1) -+ (struct ndis_event *ndis_event) -+{ -+ EVENTENTER("%p", ndis_event); -+ KeSetEvent(&ndis_event->nt_event, 0, 0); -+} -+ -+wstdcall void WIN_FUNC(NdisResetEvent,1) -+ (struct ndis_event *ndis_event) -+{ -+ EVENTENTER("%p", ndis_event); -+ KeResetEvent(&ndis_event->nt_event); -+} -+ -+static void ndis_worker(struct work_struct *dummy) -+{ -+ struct nt_list *ent; -+ struct ndis_work_item *ndis_work_item; -+ -+ WORKENTER(""); -+ while (1) { -+ spin_lock_bh(&ndis_work_list_lock); -+ ent = RemoveHeadList(&ndis_work_list); -+ spin_unlock_bh(&ndis_work_list_lock); -+ if (!ent) -+ break; -+ ndis_work_item = container_of(ent, struct ndis_work_item, list); -+ WORKTRACE("%p: %p, %p", ndis_work_item, -+ ndis_work_item->func, ndis_work_item->ctx); -+ LIN2WIN2(ndis_work_item->func, ndis_work_item, -+ ndis_work_item->ctx); -+ WORKTRACE("%p done", ndis_work_item); -+ } -+ WORKEXIT(return); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisScheduleWorkItem,1) -+ (struct ndis_work_item *ndis_work_item) -+{ -+ ENTER3("%p", ndis_work_item); -+ spin_lock_bh(&ndis_work_list_lock); -+ InsertTailList(&ndis_work_list, &ndis_work_item->list); -+ spin_unlock_bh(&ndis_work_list_lock); -+ WORKTRACE("scheduling %p", ndis_work_item); -+ queue_work(ndis_wq, &ndis_work); -+ EXIT3(return NDIS_STATUS_SUCCESS); -+} -+ -+wstdcall void WIN_FUNC(NdisMGetDeviceProperty,6) -+ (struct ndis_mp_block *nmb, void **phy_dev, void **func_dev, -+ void **next_dev, void **alloc_res, void**trans_res) -+{ -+ ENTER2("nmb: %p, phy_dev = %p, func_dev = %p, next_dev = %p, " -+ "alloc_res = %p, trans_res = %p", nmb, phy_dev, func_dev, -+ next_dev, alloc_res, trans_res); -+ if (phy_dev) -+ *phy_dev = nmb->pdo; -+ if (func_dev) -+ *func_dev = nmb->fdo; -+ if (next_dev) -+ *next_dev = nmb->next_device; -+} -+ -+wstdcall void WIN_FUNC(NdisMRegisterUnloadHandler,2) -+ (struct driver_object *drv_obj, void *unload) -+{ -+ if (drv_obj) -+ drv_obj->unload = unload; -+ return; -+} -+ -+wstdcall UINT WIN_FUNC(NdisGetVersion,0) -+ (void) -+{ -+ return 0x00050001; -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMQueryAdapterInstanceName,2) -+ (struct unicode_string *name, struct ndis_mp_block *nmb) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ struct ansi_string ansi; -+ -+ if (wrap_is_pci_bus(wnd->wd->dev_bus)) -+ RtlInitAnsiString(&ansi, "PCI Ethernet Adapter"); -+ else -+ RtlInitAnsiString(&ansi, "USB Ethernet Adapter"); -+ -+ if (RtlAnsiStringToUnicodeString(name, &ansi, TRUE)) -+ EXIT2(return NDIS_STATUS_RESOURCES); -+ else -+ EXIT2(return NDIS_STATUS_SUCCESS); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisWriteEventLogEntry,7) -+ (void *handle, NDIS_STATUS code, ULONG value, USHORT n, -+ void *strings, ULONG datasize, void *data) -+{ -+ TRACE1("0x%x, 0x%x, %u, %u", code, value, n, datasize); -+ return NDIS_STATUS_SUCCESS; -+} -+ -+wstdcall void *WIN_FUNC(NdisGetRoutineAddress,1) -+ (struct unicode_string *unicode_string) -+{ -+ struct ansi_string ansi_string; -+ void *address; -+ -+ if (RtlUnicodeStringToAnsiString(&ansi_string, unicode_string, TRUE) != -+ STATUS_SUCCESS) -+ EXIT1(return NULL); -+ INFO("%s", ansi_string.buf); -+ address = ndis_get_routine_address(ansi_string.buf); -+ RtlFreeAnsiString(&ansi_string); -+ return address; -+} -+ -+wstdcall ULONG WIN_FUNC(NdisReadPcmciaAttributeMemory,4) -+ (struct ndis_mp_block *nmb, ULONG offset, void *buffer, -+ ULONG length) -+{ -+ TODO(); -+ return 0; -+} -+ -+wstdcall ULONG WIN_FUNC(NdisWritePcmciaAttributeMemory,4) -+ (struct ndis_mp_block *nmb, ULONG offset, void *buffer, -+ ULONG length) -+{ -+ TODO(); -+ return 0; -+} -+ -+wstdcall void WIN_FUNC(NdisMCoIndicateReceivePacket,3) -+ (struct ndis_mp_block *nmb, struct ndis_packet **packets, -+ UINT nr_packets) -+{ -+ ENTER3("nmb = %p", nmb); -+ NdisMIndicateReceivePacket(nmb, packets, nr_packets); -+ EXIT3(return); -+} -+ -+wstdcall void WIN_FUNC(NdisMCoSendComplete,3) -+ (NDIS_STATUS status, struct ndis_mp_block *nmb, -+ struct ndis_packet *packet) -+{ -+ ENTER3("%08x", status); -+ NdisMSendComplete(nmb, packet, status); -+ EXIT3(return); -+} -+ -+wstdcall void WIN_FUNC(NdisMCoRequestComplete,3) -+ (NDIS_STATUS status, struct ndis_mp_block *nmb, -+ struct ndis_request *ndis_request) -+{ -+ struct ndis_device *wnd = nmb->wnd; -+ typeof(wnd->ndis_req_task) task; -+ -+ ENTER3("%08X", status); -+ wnd->ndis_req_status = status; -+ wnd->ndis_req_done = 1; -+ if ((task = xchg(&wnd->ndis_req_task, NULL))) -+ wake_up_process(task); -+ else -+ WARNING("invalid task"); -+ EXIT3(return); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisIMNotifiyPnPEvent,2) -+ (struct ndis_mp_block *nmb, struct net_pnp_event *event) -+{ -+ ENTER2("%p, %d", nmb, event->code); -+ /* NdisWrapper never calls protocol's pnp event notifier, so -+ * nothing to do here */ -+ EXIT2(return NDIS_STATUS_SUCCESS); -+} -+ -+wstdcall void WIN_FUNC(NdisCompletePnPEvent,3) -+ (NDIS_STATUS status, void *handle, struct net_pnp_event *event) -+{ -+ ENTER2("%d, %p, %d", status, handle, event->code); -+ /* NdisWrapper never calls protocol's pnp event notifier, so -+ * nothing to do here */ -+ EXIT2(return); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMSetMiniportSecondary,2) -+ (struct ndis_mp_block *nmb2, struct ndis_mp_block *nmb1) -+{ -+ ENTER3("%p, %p", nmb1, nmb2); -+ TODO(); -+ EXIT3(return NDIS_STATUS_SUCCESS); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMPromoteMiniport,1) -+ (struct ndis_mp_block *nmb) -+{ -+ ENTER3("%p", nmb); -+ TODO(); -+ EXIT3(return NDIS_STATUS_SUCCESS); -+} -+ -+wstdcall void WIN_FUNC(NdisMCoActivateVcComplete,3) -+ (NDIS_STATUS status, void *handle, void *params) -+{ -+ TODO(); -+} -+ -+wstdcall void WIN_FUNC(NdisMCoDeactivateVcComplete,2) -+ (NDIS_STATUS status, void *handle) -+{ -+ TODO(); -+} -+ -+wstdcall void WIN_FUNC(NdisMRemoveMiniport,1) -+ (void *handle) -+{ -+ TODO(); -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMOpenLog,3) -+ (struct ndis_device *wnd, UINT size, void *handle) -+{ -+ if (size >= sizeof(int)) -+ *((int *)handle) = 42; -+ return NDIS_STATUS_SUCCESS; -+} -+ -+wstdcall NDIS_STATUS WIN_FUNC(NdisMWriteLogData,3) -+ (void *handle, char *buffer, UINT buffer_size) -+{ -+ TODO(); -+ return NDIS_STATUS_SUCCESS; -+} -+ -+wstdcall void WIN_FUNC(NdisMFlushLog,1) -+ (void *handle) -+{ -+ TODO(); -+} -+ -+wstdcall void WIN_FUNC(NdisMCloseLog,1) -+ (void *handle) -+{ -+ TODO(); -+} -+ -+static void *ndis_get_routine_address(char *name) -+{ -+ int i; -+ ENTER2("%p", name); -+ for (i = 0; i < ARRAY_SIZE(ndis_exports); i++) { -+ if (strcmp(name, ndis_exports[i].name) == 0) { -+ TRACE2("%p", ndis_exports[i].func); -+ return ndis_exports[i].func; -+ } -+ } -+ EXIT2(return NULL); -+} -+ -+/* ndis_init_device is called for each device */ -+int ndis_init_device(struct ndis_device *wnd) -+{ -+ struct ndis_mp_block *nmb = wnd->nmb; -+ -+ KeInitializeSpinLock(&nmb->lock); -+ wnd->mp_interrupt = NULL; -+ wnd->wrap_timer_slist.next = NULL; -+ if (wnd->wd->driver->ndis_driver) -+ wnd->wd->driver->ndis_driver->mp.shutdown = NULL; -+ -+ nmb->filterdbs.eth_db = nmb; -+ nmb->filterdbs.tr_db = nmb; -+ nmb->filterdbs.fddi_db = nmb; -+ nmb->filterdbs.arc_db = nmb; -+ -+ nmb->rx_packet = WIN_FUNC_PTR(NdisMIndicateReceivePacket,3); -+ nmb->send_complete = WIN_FUNC_PTR(NdisMSendComplete,3); -+ nmb->send_resource_avail = WIN_FUNC_PTR(NdisMSendResourcesAvailable,1); -+ nmb->status = WIN_FUNC_PTR(NdisMIndicateStatus,4); -+ nmb->status_complete = WIN_FUNC_PTR(NdisMIndicateStatusComplete,1); -+ nmb->queryinfo_complete = WIN_FUNC_PTR(NdisMQueryInformationComplete,2); -+ nmb->setinfo_complete = WIN_FUNC_PTR(NdisMSetInformationComplete,2); -+ nmb->reset_complete = WIN_FUNC_PTR(NdisMResetComplete,3); -+ nmb->eth_rx_indicate = WIN_FUNC_PTR(EthRxIndicateHandler,8); -+ nmb->eth_rx_complete = WIN_FUNC_PTR(EthRxComplete,1); -+ nmb->td_complete = WIN_FUNC_PTR(NdisMTransferDataComplete,4); -+ return 0; -+} -+ -+/* ndis_exit_device is called for each device */ -+void ndis_exit_device(struct ndis_device *wnd) -+{ -+ struct wrap_device_setting *setting; -+ ENTER2("%p", wnd); -+ mutex_lock(&loader_mutex); -+ nt_list_for_each_entry(setting, &wnd->wd->settings, list) { -+ struct ndis_configuration_parameter *param; -+ param = setting->encoded; -+ if (param) { -+ if (param->type == NdisParameterString) -+ RtlFreeUnicodeString(¶m->data.string); -+ ExFreePool(param); -+ setting->encoded = NULL; -+ } -+ } -+ mutex_unlock(&loader_mutex); -+} -+ -+/* ndis_init is called once when module is loaded */ -+int ndis_init(void) -+{ -+ InitializeListHead(&ndis_work_list); -+ spin_lock_init(&ndis_work_list_lock); -+ INIT_WORK(&ndis_work, ndis_worker); -+ -+ ndis_wq = create_singlethread_workqueue("ndis_wq"); -+ if (!ndis_wq) { -+ WARNING("couldn't create worker thread"); -+ EXIT1(return -ENOMEM); -+ } -+ -+ TRACE1("ndis_wq: %p", ndis_wq); -+ return 0; -+} -+ -+/* ndis_exit is called once when module is removed */ -+void ndis_exit(void) -+{ -+ ENTER1(""); -+ if (ndis_wq) -+ destroy_workqueue(ndis_wq); -+ EXIT1(return); -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/ndis.h linux-4.12.4-3rd/3rdparty/ndiswrapper/ndis.h ---- linux-4.12.4/3rdparty/ndiswrapper/ndis.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/ndis.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,1309 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifndef _NDIS_H_ -+#define _NDIS_H_ -+ -+#include "ntoskernel.h" -+ -+//#define ALLOW_POOL_OVERFLOW 1 -+ -+#define NDIS_DMA_24BITS 0 -+#define NDIS_DMA_32BITS 1 -+#define NDIS_DMA_64BITS 2 -+ -+#ifdef CONFIG_X86_64 -+#define MAXIMUM_PROCESSORS 64 -+#else -+#define MAXIMUM_PROCESSORS 32 -+#endif -+ -+typedef UINT NDIS_STATUS; -+typedef UCHAR NDIS_DMA_SIZE; -+typedef LONG ndis_rssi; -+typedef ULONG ndis_key_index; -+typedef ULONG ndis_tx_power_level; -+typedef ULONGULONG ndis_key_rsc; -+typedef UCHAR mac_address[ETH_ALEN]; -+typedef ULONG ndis_fragmentation_threshold; -+typedef ULONG ndis_rts_threshold; -+typedef ULONG ndis_antenna; -+typedef ULONG ndis_oid; -+ -+typedef uint64_t NDIS_PHY_ADDRESS; -+ -+struct ndis_sg_element { -+ PHYSICAL_ADDRESS address; -+ ULONG length; -+ ULONG_PTR reserved; -+}; -+ -+struct ndis_sg_list { -+ ULONG nent; -+ ULONG_PTR reserved; -+ struct ndis_sg_element elements[]; -+}; -+ -+/* when sending packets, ndiswrapper associates exactly one sg element -+ * in sg list */ -+struct wrap_tx_sg_list { -+ ULONG nent; -+ ULONG_PTR reserved; -+ struct ndis_sg_element elements[1]; -+}; -+ -+struct ndis_phy_addr_unit { -+ NDIS_PHY_ADDRESS phy_addr; -+ UINT length; -+}; -+ -+typedef struct mdl ndis_buffer; -+ -+struct ndis_buffer_pool { -+ ndis_buffer *free_descr; -+// NT_SPIN_LOCK lock; -+ spinlock_t lock; -+ UINT max_descr; -+ UINT num_allocated_descr; -+}; -+ -+#define NDIS_PROTOCOL_ID_DEFAULT 0x00 -+#define NDIS_PROTOCOL_ID_TCP_IP 0x02 -+#define NDIS_PROTOCOL_ID_IPX 0x06 -+#define NDIS_PROTOCOL_ID_NBF 0x07 -+#define NDIS_PROTOCOL_ID_MAX 0x0F -+#define NDIS_PROTOCOL_ID_MASK 0x0F -+ -+#define fPACKET_WRAPPER_RESERVED 0x3F -+#define fPACKET_CONTAINS_MEDIA_SPECIFIC_INFO 0x40 -+#define fPACKET_ALLOCATED_BY_NDIS 0x80 -+ -+#define PROTOCOL_RESERVED_SIZE_IN_PACKET (4 * sizeof(void *)) -+ -+struct transport_header_offset { -+ USHORT protocol_type; -+ USHORT header_offset; -+}; -+ -+struct ndis_network_address { -+ USHORT length; -+ USHORT type; -+ UCHAR address[1]; -+}; -+ -+struct ndis_network_address_list { -+ LONG count; -+ USHORT type; -+ struct ndis_network_address address[1]; -+}; -+ -+struct ndis_tcp_ip_checksum_packet_info { -+ union { -+ struct { -+ ULONG v4:1; -+ ULONG v6:1; -+ ULONG tcp:1; -+ ULONG udp:1; -+ ULONG ip:1; -+ } tx; -+ struct { -+ ULONG tcp_failed:1; -+ ULONG udp_failed:1; -+ ULONG ip_failed:1; -+ ULONG tcp_succeeded:1; -+ ULONG udp_succeeded:1; -+ ULONG ip_succeeded:1; -+ ULONG loopback:1; -+ } rx; -+ ULONG value; -+ }; -+}; -+ -+enum ndis_task { -+ TcpIpChecksumNdisTask, IpSecNdisTask, TcpLargeSendNdisTask, MaxNdisTask -+}; -+ -+enum ndis_encapsulation { -+ UNSPECIFIED_Encapsulation, NULL_Encapsulation, -+ IEEE_802_3_Encapsulation, IEEE_802_5_Encapsulation, -+ LLC_SNAP_ROUTED_Encapsulation, LLC_SNAP_BRIDGED_Encapsulation -+}; -+ -+#define NDIS_TASK_OFFLOAD_VERSION 1 -+ -+struct ndis_encapsulation_format { -+ enum ndis_encapsulation encap; -+ struct { -+ ULONG fixed_header_size:1; -+ ULONG reserved:31; -+ } flags; -+ ULONG header_size; -+}; -+ -+struct ndis_task_offload_header { -+ ULONG version; -+ ULONG size; -+ ULONG reserved; -+ ULONG offset_first_task; -+ struct ndis_encapsulation_format encap_format; -+}; -+ -+struct ndis_task_offload { -+ ULONG version; -+ ULONG size; -+ enum ndis_task task; -+ ULONG offset_next_task; -+ ULONG task_buf_length; -+ UCHAR task_buf[1]; -+}; -+ -+struct v4_checksum { -+ union { -+ struct { -+ ULONG ip_opts:1; -+ ULONG tcp_opts:1; -+ ULONG tcp_csum:1; -+ ULONG udp_csum:1; -+ ULONG ip_csum:1; -+ }; -+ ULONG value; -+ }; -+}; -+ -+struct v6_checksum { -+ ULONG ip_supported:1; -+ ULONG tcp_supported:1; -+ ULONG tcp_csum:1; -+ ULONG udp_csum:1; -+}; -+ -+struct ndis_task_tcp_ip_checksum { -+ struct v4_checksum v4_tx; -+ struct v4_checksum v4_rx; -+ struct v6_checksum v6_tx; -+ struct v6_checksum v6_rx; -+}; -+ -+struct ndis_task_tcp_large_send { -+ ULONG version; -+ ULONG max_size; -+ ULONG min_seg_count; -+ BOOLEAN tcp_opts; -+ BOOLEAN ip_opts; -+}; -+ -+struct ndis_packet; -+ -+struct ndis_packet_pool { -+ struct ndis_packet *free_descr; -+// NT_SPIN_LOCK lock; -+ spinlock_t lock; -+ UINT max_descr; -+ UINT num_allocated_descr; -+ UINT num_used_descr; -+ UINT proto_rsvd_length; -+}; -+ -+struct ndis_packet_stack { -+ ULONG_PTR IM_reserved[2]; -+ ULONG_PTR ndis_reserved[4]; -+}; -+ -+enum ndis_per_packet_info { -+ TcpIpChecksumPacketInfo, IpSecPacketInfo, TcpLargeSendPacketInfo, -+ ClassificationHandlePacketInfo, NdisReserved, -+ ScatterGatherListPacketInfo, Ieee8021QInfo, OriginalPacketInfo, -+ PacketCancelId, MaxPerPacketInfo -+}; -+ -+struct ndis_packet_extension { -+ void *info[MaxPerPacketInfo]; -+}; -+ -+struct ndis_packet_private { -+ UINT nr_pages; -+ UINT len; -+ ndis_buffer *buffer_head; -+ ndis_buffer *buffer_tail; -+ struct ndis_packet_pool *pool; -+ UINT count; -+ ULONG flags; -+ BOOLEAN valid_counts; -+ UCHAR packet_flags; -+ USHORT oob_offset; -+}; -+ -+struct ndis_packet { -+ struct ndis_packet_private private; -+ /* for use by miniport */ -+ union { -+ /* for connectionless mininports */ -+ struct { -+ UCHAR miniport_reserved[2 * sizeof(void *)]; -+ UCHAR wrapper_reserved[2 * sizeof(void *)]; -+ } cl_reserved; -+ /* for deserialized miniports */ -+ struct { -+ UCHAR miniport_reserved_ex[3 * sizeof(void *)]; -+ UCHAR wrapper_reserved_ex[sizeof(void *)]; -+ } deserialized_reserved; -+ struct { -+ UCHAR mac_reserved[4 * sizeof(void *)]; -+ } mac_reserved; -+ }; -+ ULONG_PTR reserved[2]; -+ UCHAR protocol_reserved[1]; -+}; -+ -+/* OOB data */ -+struct ndis_packet_oob_data { -+ union { -+ ULONGLONG time_to_tx; -+ ULONGLONG time_txed; -+ }; -+ ULONGLONG time_rxed; -+ UINT header_size; -+ UINT media_size; -+ void *media; -+ NDIS_STATUS status; -+ -+ /* ndiswrapper specific info; extension should be right after -+ * ndis's oob_data */ -+ struct ndis_packet_extension ext; -+ union { -+ /* used for tx only */ -+ struct { -+ struct sk_buff *tx_skb; -+ union { -+ struct wrap_tx_sg_list wrap_tx_sg_list; -+ struct ndis_sg_list *tx_sg_list; -+ }; -+ }; -+ /* used for rx only */ -+ struct { -+ unsigned char header[ETH_HLEN]; -+ unsigned char *look_ahead; -+ UINT look_ahead_size; -+ }; -+ }; -+}; -+ -+#define NDIS_PACKET_OOB_DATA(packet) \ -+ (struct ndis_packet_oob_data *)(((void *)(packet)) + \ -+ (packet)->private.oob_offset) -+ -+enum ndis_device_pnp_event { -+ NdisDevicePnPEventQueryRemoved, NdisDevicePnPEventRemoved, -+ NdisDevicePnPEventSurpriseRemoved, NdisDevicePnPEventQueryStopped, -+ NdisDevicePnPEventStopped, NdisDevicePnPEventPowerProfileChanged, -+ NdisDevicePnPEventMaximum -+}; -+ -+enum ndis_request_type { -+ NdisRequestQueryInformation, NdisRequestSetInformation, -+ NdisRequestQueryStatistics, NdisRequestOpen, NdisRequestClose, -+ NdisRequestSend, NdisRequestTransferData, NdisRequestReset, -+ NdisRequestGeneric1, NdisRequestGeneric2, NdisRequestGeneric3, -+ NdisRequestGeneric4 -+}; -+ -+struct ndis_request { -+ mac_address mac; -+ enum ndis_request_type request_type; -+ union data { -+ struct query_info { -+ UINT oid; -+ void *buf; -+ UINT buf_len; -+ UINT written; -+ UINT needed; -+ } query_info; -+ struct set_info { -+ UINT oid; -+ void *buf; -+ UINT buf_len; -+ UINT written; -+ UINT needed; -+ } set_info; -+ } data; -+}; -+ -+enum ndis_medium { -+ NdisMedium802_3, NdisMedium802_5, NdisMediumFddi, NdisMediumWan, -+ NdisMediumLocalTalk, NdisMediumDix, NdisMediumArcnetRaw, -+ NdisMediumArcnet878_2, NdisMediumAtm, NdisMediumWirelessWan, -+ NdisMediumIrda, NdisMediumBpc, NdisMediumCoWan, -+ NdisMedium1394, NdisMediumMax -+}; -+ -+enum ndis_physical_medium { -+ NdisPhysicalMediumUnspecified, NdisPhysicalMediumWirelessLan, -+ NdisPhysicalMediumCableModem, NdisPhysicalMediumPhoneLine, -+ NdisPhysicalMediumPowerLine, NdisPhysicalMediumDSL, -+ NdisPhysicalMediumFibreChannel, NdisPhysicalMedium1394, -+ NdisPhysicalMediumWirelessWan, NdisPhysicalMediumMax -+}; -+ -+enum ndis_power_state { -+ NdisDeviceStateUnspecified = 0, -+ NdisDeviceStateD0, NdisDeviceStateD1, NdisDeviceStateD2, -+ NdisDeviceStateD3, NdisDeviceStateMaximum -+}; -+ -+enum ndis_power_profile { -+ NdisPowerProfileBattery, NdisPowerProfileAcOnLine -+}; -+ -+struct ndis_pm_wakeup_capabilities { -+ enum ndis_power_state min_magic_packet_wakeup; -+ enum ndis_power_state min_pattern_wakeup; -+ enum ndis_power_state min_link_change_wakeup; -+}; -+ -+#define NDIS_PNP_WAKE_UP_MAGIC_PACKET 0x00000001 -+#define NDIS_PNP_WAKE_UP_PATTERN_MATCH 0x00000002 -+#define NDIS_PNP_WAKE_UP_LINK_CHANGE 0x00000004 -+ -+enum net_pnp_event_code { -+ NetEventSetPower, NetEventQueryPower, NetEventQueryRemoveDevice, -+ NetEventCancelRemoveDevice, NetEventReconfigure, NetEventBindList, -+ NetEventBindsComplete, NetEventPnPCapabilities, NetEventMaximum -+}; -+ -+struct net_pnp_event { -+ enum net_pnp_event_code code; -+ void *buf; -+ ULONG buf_length; -+ ULONG_PTR ndis_reserved[4]; -+ ULONG_PTR transport_reserved[4]; -+ ULONG_PTR tdi_reserved[4]; -+ ULONG_PTR tdi_client_reserved[4]; -+}; -+ -+struct ndis_pnp_capabilities { -+ ULONG flags; -+ struct ndis_pm_wakeup_capabilities wakeup; -+}; -+ -+typedef void (*ndis_isr_handler)(BOOLEAN *recognized, BOOLEAN *queue_handler, -+ void *handle) wstdcall; -+typedef void (*ndis_interrupt_handler)(void *ctx) wstdcall; -+ -+struct miniport { -+ /* NDIS 3.0 */ -+ UCHAR major_version; -+ UCHAR minor_version; -+ USHORT filler; -+ UINT reserved; -+ BOOLEAN (*hangcheck)(void *ctx) wstdcall; -+ void (*disable_interrupt)(void *ctx) wstdcall; -+ void (*enable_interrupt)(void *ctx) wstdcall; -+ void (*mp_halt)(void *ctx) wstdcall; -+ ndis_interrupt_handler handle_interrupt; -+ NDIS_STATUS (*init)(NDIS_STATUS *error_status, UINT *medium_index, -+ enum ndis_medium medium[], UINT medium_array_size, -+ void *handle, void *conf_handle) wstdcall; -+ ndis_isr_handler isr; -+ NDIS_STATUS (*queryinfo)(void *ctx, ndis_oid oid, void *buffer, -+ ULONG buflen, ULONG *written, -+ ULONG *needed) wstdcall; -+ void *reconfig; -+ NDIS_STATUS (*reset)(BOOLEAN *reset_address, void *ctx) wstdcall; -+ NDIS_STATUS (*send)(void *ctx, struct ndis_packet *packet, -+ UINT flags) wstdcall; -+ NDIS_STATUS (*setinfo)(void *ctx, ndis_oid oid, void *buffer, -+ ULONG buflen, ULONG *written, -+ ULONG *needed) wstdcall; -+ NDIS_STATUS (*tx_data)(struct ndis_packet *ndis_packet, -+ UINT *bytes_txed, void *mp_ctx, void *rx_ctx, -+ UINT offset, UINT bytes_to_tx) wstdcall; -+ /* NDIS 4.0 extensions */ -+ void (*return_packet)(void *ctx, void *packet) wstdcall; -+ void (*send_packets)(void *ctx, struct ndis_packet **packets, -+ INT nr_of_packets) wstdcall; -+ void (*alloc_complete)(void *handle, void *virt, -+ NDIS_PHY_ADDRESS *phys, -+ ULONG size, void *ctx) wstdcall; -+ /* NDIS 5.0 extensions */ -+ NDIS_STATUS (*co_create_vc)(void *ctx, void *vc_handle, -+ void *vc_ctx) wstdcall; -+ NDIS_STATUS (*co_delete_vc)(void *vc_ctx) wstdcall; -+ NDIS_STATUS (*co_activate_vc)(void *vc_ctx, void *call_params) wstdcall; -+ NDIS_STATUS (*co_deactivate_vc)(void *vc_ctx) wstdcall; -+ NDIS_STATUS (*co_send_packets)(void *vc_ctx, void **packets, -+ UINT nr_of_packets) wstdcall; -+ NDIS_STATUS (*co_request)(void *ctx, void *vc_ctx, UINT *req) wstdcall; -+ /* NDIS 5.1 extensions */ -+ void (*cancel_send_packets)(void *ctx, void *id) wstdcall; -+ void (*pnp_event_notify)(void *ctx, enum ndis_device_pnp_event event, -+ void *inf_buf, ULONG inf_buf_len) wstdcall; -+ void (*shutdown)(void *ctx) wstdcall; -+ void *reserved1; -+ void *reserved2; -+ void *reserved3; -+ void *reserved4; -+}; -+ -+struct ndis_spinlock { -+ NT_SPIN_LOCK klock; -+ KIRQL irql; -+}; -+ -+union ndis_rw_lock_refcount { -+ UCHAR cache_line[16]; -+}; -+ -+struct ndis_rw_lock { -+ union { -+ struct { -+ NT_SPIN_LOCK klock; -+ void *context; -+ }; -+ UCHAR reserved[16]; -+ }; -+ union { -+ union ndis_rw_lock_refcount ref_count[MAXIMUM_PROCESSORS]; -+ /* ndiswrapper specific */ -+ volatile int count; -+ }; -+}; -+ -+struct lock_state { -+ USHORT state; -+ KIRQL irql; -+}; -+ -+struct ndis_work_item; -+typedef void (*NDIS_PROC)(struct ndis_work_item *, void *) wstdcall; -+ -+struct ndis_work_item { -+ void *ctx; -+ NDIS_PROC func; -+ union { -+ UCHAR reserved[8 * sizeof(void *)]; -+ /* ndiswrapper specific */ -+ struct nt_list list; -+ }; -+}; -+ -+struct alloc_shared_mem { -+ void *ctx; -+ ULONG size; -+ BOOLEAN cached; -+}; -+ -+struct ndis_mp_block; -+ -+/* this is opaque to drivers, so we can use it as we please */ -+struct ndis_mp_interrupt { -+ struct kinterrupt *kinterrupt; -+ NT_SPIN_LOCK lock; -+ union { -+ void *reserved; -+ unsigned int irq; -+ }; -+ ndis_isr_handler isr; -+ ndis_interrupt_handler mp_dpc; -+ struct kdpc intr_dpc; -+ struct ndis_mp_block *nmb; -+ UCHAR dpc_count; -+ BOOLEAN enable; -+ struct nt_event dpc_completed_event; -+ BOOLEAN shared; -+ BOOLEAN req_isr; -+}; -+ -+struct ndis_binary_data { -+ USHORT len; -+ void *buf; -+}; -+ -+enum ndis_parameter_type { -+ NdisParameterInteger, NdisParameterHexInteger, -+ NdisParameterString, NdisParameterMultiString, NdisParameterBinary, -+}; -+ -+typedef struct unicode_string NDIS_STRING; -+ -+struct ndis_configuration_parameter { -+ enum ndis_parameter_type type; -+ union { -+ ULONG integer; -+ NDIS_STRING string; -+ } data; -+}; -+ -+struct ndis_driver { -+ struct miniport mp; -+}; -+ -+/* IDs used to store extensions in driver_object's custom extension */ -+#define NDIS_DRIVER_CLIENT_ID 10 -+ -+struct ndis_wireless_stats { -+ ULONG length; -+ LARGE_INTEGER tx_frag; -+ LARGE_INTEGER tx_multi_frag; -+ LARGE_INTEGER failed; -+ LARGE_INTEGER retry; -+ LARGE_INTEGER multi_retry; -+ LARGE_INTEGER rtss_succ; -+ LARGE_INTEGER rtss_fail; -+ LARGE_INTEGER ack_fail; -+ LARGE_INTEGER frame_dup; -+ LARGE_INTEGER rx_frag; -+ LARGE_INTEGER rx_multi_frag; -+ LARGE_INTEGER fcs_err; -+ LARGE_INTEGER tkip_local_mic_failures; -+ LARGE_INTEGER tkip_icv_errors; -+ LARGE_INTEGER tkip_counter_measures_invoked; -+ LARGE_INTEGER tkip_replays; -+ LARGE_INTEGER ccmp_format_errors; -+ LARGE_INTEGER ccmp_replays; -+ LARGE_INTEGER ccmp_decrypt_errors; -+ LARGE_INTEGER fourway_handshake_failures; -+ LARGE_INTEGER wep_undecryptable_count; -+ LARGE_INTEGER wep_icv_errorcount; -+ LARGE_INTEGER decrypt_success_count; -+ LARGE_INTEGER decrypt_failure_count; -+}; -+ -+enum ndis_status_type { -+ Ndis802_11StatusType_Authentication, -+ Ndis802_11StatusType_MediaStreamMode, -+ Ndis802_11StatusType_PMKID_CandidateList, -+ Ndis802_11StatusType_RadioState, -+}; -+ -+struct ndis_status_indication { -+ enum ndis_status_type status_type; -+}; -+ -+enum ndis_radio_status { -+ Ndis802_11RadioStatusOn, Ndis802_11RadioStatusHardwareOff, -+ Ndis802_11RadioStatusSoftwareOff, -+}; -+ -+struct ndis_radio_status_indication -+{ -+ enum ndis_status_type status_type; -+ enum ndis_radio_status radio_state; -+}; -+ -+enum ndis_media_state { -+ NdisMediaStateConnected, -+ NdisMediaStateDisconnected, -+}; -+ -+enum ndis_media_stream_mode { -+ Ndis802_11MediaStreamOff, Ndis802_11MediaStreamOn -+}; -+ -+enum wrapper_work { -+ LINK_STATUS_OFF, LINK_STATUS_ON, SET_MULTICAST_LIST, COLLECT_IW_STATS, -+ HANGCHECK, NETIF_WAKEQ, -+}; -+ -+struct encr_info { -+ struct encr_key { -+ ULONG length; -+ UCHAR key[NDIS_ENCODING_TOKEN_MAX]; -+ } keys[MAX_ENCR_KEYS]; -+ unsigned short tx_key_index; -+}; -+ -+struct ndis_essid { -+ ULONG length; -+ UCHAR essid[NDIS_ESSID_MAX_SIZE]; -+}; -+ -+enum ndis_infrastructure_mode { -+ Ndis802_11IBSS, Ndis802_11Infrastructure, Ndis802_11AutoUnknown, -+ Ndis802_11InfrastructureMax -+}; -+ -+enum authentication_mode { -+ Ndis802_11AuthModeOpen, Ndis802_11AuthModeShared, -+ Ndis802_11AuthModeAutoSwitch, Ndis802_11AuthModeWPA, -+ Ndis802_11AuthModeWPAPSK, Ndis802_11AuthModeWPANone, -+ Ndis802_11AuthModeWPA2, Ndis802_11AuthModeWPA2PSK, -+ Ndis802_11AuthModeMax -+}; -+ -+enum encryption_status { -+ Ndis802_11WEPEnabled, -+ Ndis802_11Encryption1Enabled = Ndis802_11WEPEnabled, -+ Ndis802_11WEPDisabled, -+ Ndis802_11EncryptionDisabled = Ndis802_11WEPDisabled, -+ Ndis802_11WEPKeyAbsent, -+ Ndis802_11Encryption1KeyAbsent = Ndis802_11WEPKeyAbsent, -+ Ndis802_11WEPNotSupported, -+ Ndis802_11EncryptionNotSupported = Ndis802_11WEPNotSupported, -+ Ndis802_11Encryption2Enabled, Ndis802_11Encryption2KeyAbsent, -+ Ndis802_11Encryption3Enabled, Ndis802_11Encryption3KeyAbsent -+}; -+ -+struct ndis_auth_encr_pair { -+ enum authentication_mode auth_mode; -+ enum encryption_status encr_mode; -+}; -+ -+struct ndis_capability { -+ ULONG length; -+ ULONG version; -+ ULONG num_PMKIDs; -+ ULONG num_auth_encr_pair; -+ struct ndis_auth_encr_pair auth_encr_pair[1]; -+}; -+ -+struct ndis_guid { -+ struct guid guid; -+ union { -+ ndis_oid oid; -+ NDIS_STATUS status; -+ }; -+ ULONG size; -+ ULONG flags; -+}; -+ -+struct ndis_timer { -+ struct nt_timer nt_timer; -+ struct kdpc kdpc; -+}; -+ -+struct ndis_mp_timer { -+ struct nt_timer nt_timer; -+ struct kdpc kdpc; -+ DPC func; -+ void *ctx; -+ struct ndis_mp_block *nmb; -+ struct ndis_mp_timer *next; -+}; -+ -+typedef struct cm_partial_resource_list NDIS_RESOURCE_LIST; -+ -+struct ndis_event { -+ struct nt_event nt_event; -+}; -+ -+struct ndis_bind_paths { -+ UINT number; -+ struct unicode_string paths[1]; -+}; -+ -+struct ndis_reference { -+ NT_SPIN_LOCK lock; -+ USHORT ref_count; -+ BOOLEAN closing; -+}; -+ -+struct ndis_filterdbs { -+ union { -+ void *eth_db; -+ void *null_db; -+ }; -+ void *tr_db; -+ void *fddi_db; -+ void *arc_db; -+}; -+ -+enum ndis_interface_type { -+ NdisInterfaceInternal, NdisInterfaceIsa, NdisInterfaceEisa, -+ NdisInterfaceMca, NdisInterfaceTurboChannel, NdisInterfacePci, -+ NdisInterfacePcMcia, -+}; -+ -+struct auth_encr_capa { -+ unsigned long auth; -+ unsigned long encr; -+}; -+ -+struct ndis_pmkid_candidate { -+ mac_address bssid; -+ DWORD flags; -+}; -+ -+struct ndis_pmkid_candidate_list { -+ ULONG version; -+ ULONG num_candidates; -+ struct ndis_pmkid_candidate candidates[1]; -+}; -+ -+/* -+ * This struct contains function pointers that the drivers references -+ * directly via macros, so it's important that they are at the correct -+ * position. -+ */ -+struct ndis_mp_block { -+ void *signature; -+ struct ndis_mp_block *next; -+ struct driver_object *drv_obj; -+ void *mp_ctx; -+ struct unicode_string name; -+ struct ndis_bind_paths *bindpaths; -+ void *openqueue; -+ struct ndis_reference reference; -+ void *device_ctx; -+ UCHAR padding; -+ UCHAR lock_acquired; -+ UCHAR pmode_opens; -+ UCHAR assigned_cpu; -+ NT_SPIN_LOCK lock; -+ enum ndis_request_type *mediarequest; -+ struct ndis_mp_interrupt *interrupt; -+ ULONG flags; -+ ULONG pnp_flags; -+ struct nt_list packet_list; -+ struct ndis_packet *first_pending_tx_packet; -+ struct ndis_packet *return_packet_queue; -+ ULONG request_buffer; -+ void *set_mcast_buffer; -+ struct ndis_mp_block *primary_mp; -+ void *wrapper_ctx; -+ void *bus_data_ctx; -+ ULONG pnp_capa; -+ void *resources; -+ struct ndis_timer wakeup_dpc_timer; -+ struct unicode_string basename; -+ struct unicode_string symlink_name; -+ ULONG ndis_hangcheck_interval; -+ USHORT hangcheck_ticks; -+ USHORT hangcheck_tick; -+ NDIS_STATUS ndis_reset_status; -+ void *resetopen; -+ struct ndis_filterdbs filterdbs; -+ void *rx_packet; -+ void *send_complete; -+ void *send_resource_avail; -+ void *reset_complete; -+ -+ enum ndis_medium media_type; -+ ULONG bus_number; -+ enum ndis_interface_type bus_type; -+ enum ndis_interface_type adapter_type; -+ struct device_object *fdo; -+ struct device_object *pdo; -+ struct device_object *next_device; -+ void *mapreg; -+ void *call_mgraflist; -+ void *mp_thread; -+ void *setinfobuf; -+ USHORT setinfo_buf_len; -+ USHORT max_send_pkts; -+ NDIS_STATUS fake_status; -+ void *lock_handler; -+ struct unicode_string *adapter_instance_name; -+ void *timer_queue; -+ UINT mac_options; -+ void *pending_req; -+ UINT max_long_addrs; -+ UINT max_short_addrs; -+ UINT cur_lookahead; -+ UINT max_lookahead; -+ -+ ndis_interrupt_handler irq_bh; -+ void *disable_intr; -+ void *enable_intr; -+ void *send_pkts; -+ void *deferred_send; -+ void *eth_rx_indicate; -+ void *tr_rx_indicate; -+ void *fddi_rx_indicate; -+ void *eth_rx_complete; -+ void *tr_rx_complete; -+ void *fddi_rx_complete; -+ -+ void *status; -+ void *status_complete; -+ void *td_complete; -+ -+ void *queryinfo_complete; -+ void *setinfo_complete; -+ void *wan_tx_complete; -+ void *wan_rx; -+ void *wan_rx_complete; -+ /* ndiswrapper specific */ -+ struct ndis_device *wnd; -+}; -+ -+struct ndis_device { -+ struct ndis_mp_block *nmb; -+ struct wrap_device *wd; -+ struct net_device *net_dev; -+ void *shutdown_ctx; -+ struct ndis_mp_interrupt *mp_interrupt; -+ struct kdpc irq_kdpc; -+ unsigned long mem_start; -+ unsigned long mem_end; -+ -+ struct net_device_stats net_stats; -+ struct iw_statistics iw_stats; -+ BOOLEAN iw_stats_enabled; -+ struct ndis_wireless_stats ndis_stats; -+ -+ struct work_struct tx_work; -+ struct ndis_packet *tx_ring[TX_RING_SIZE]; -+ u8 tx_ring_start; -+ u8 tx_ring_end; -+ u8 is_tx_ring_full; -+ u8 tx_ok; -+ spinlock_t tx_ring_lock; -+ struct mutex tx_ring_mutex; -+ unsigned int max_tx_packets; -+ struct mutex ndis_req_mutex; -+ struct task_struct *ndis_req_task; -+ int ndis_req_done; -+ NDIS_STATUS ndis_req_status; -+ ULONG packet_filter; -+ -+ ULONG sg_dma_size; -+ ULONG dma_map_count; -+ dma_addr_t *dma_map_addr; -+ -+ int hangcheck_interval; -+ struct timer_list hangcheck_timer; -+ int iw_stats_interval; -+ struct timer_list iw_stats_timer; -+ unsigned long scan_timestamp; -+ struct encr_info encr_info; -+ char nick[IW_ESSID_MAX_SIZE + 1]; -+ struct ndis_essid essid; -+ struct auth_encr_capa capa; -+ enum ndis_infrastructure_mode infrastructure_mode; -+ int max_pmkids; -+ int num_pmkids; -+ struct ndis_pmkid *pmkids; -+ mac_address mac; -+ struct proc_dir_entry *procfs_iface; -+ -+ struct work_struct ndis_work; -+ unsigned long ndis_pending_work; -+ UINT attributes; -+ int iw_auth_wpa_version; -+ int iw_auth_cipher_pairwise; -+ int iw_auth_cipher_group; -+ int iw_auth_key_mgmt; -+ int iw_auth_80211_alg; -+ struct ndis_packet_pool *tx_packet_pool; -+ struct ndis_buffer_pool *tx_buffer_pool; -+ int multicast_size; -+ struct v4_checksum rx_csum; -+ struct v4_checksum tx_csum; -+ enum ndis_physical_medium physical_medium; -+ ULONG ndis_wolopts; -+ struct nt_slist wrap_timer_slist; -+ int drv_ndis_version; -+ struct ndis_pnp_capabilities pnp_capa; -+}; -+ -+BOOLEAN ndis_isr(struct kinterrupt *kinterrupt, void *ctx) wstdcall; -+ -+int ndis_init(void); -+void ndis_exit(void); -+int ndis_init_device(struct ndis_device *wnd); -+void ndis_exit_device(struct ndis_device *wnd); -+ -+int wrap_procfs_add_ndis_device(struct ndis_device *wnd); -+void wrap_procfs_remove_ndis_device(struct ndis_device *wnd); -+ -+void NdisAllocatePacketPoolEx(NDIS_STATUS *status, -+ struct ndis_packet_pool **pool_handle, -+ UINT num_descr, UINT overflowsize, -+ UINT proto_rsvd_length) wstdcall; -+void NdisFreePacketPool(struct ndis_packet_pool *pool) wstdcall; -+void NdisAllocatePacket(NDIS_STATUS *status, struct ndis_packet **packet, -+ struct ndis_packet_pool *pool) wstdcall; -+void NdisFreePacket(struct ndis_packet *descr) wstdcall; -+void NdisAllocateBufferPool(NDIS_STATUS *status, -+ struct ndis_buffer_pool **pool_handle, -+ UINT num_descr) wstdcall; -+void NdisFreeBufferPool(struct ndis_buffer_pool *pool) wstdcall; -+void NdisAllocateBuffer(NDIS_STATUS *status, ndis_buffer **buffer, -+ struct ndis_buffer_pool *pool, void *virt, -+ UINT length) wstdcall; -+void NdisFreeBuffer(ndis_buffer *descr) wstdcall; -+void NdisMIndicateReceivePacket(struct ndis_mp_block *nmb, -+ struct ndis_packet **packets, -+ UINT nr_packets) wstdcall; -+void NdisMSendComplete(struct ndis_mp_block *nmb, struct ndis_packet *packet, -+ NDIS_STATUS status) wstdcall; -+void NdisMSendResourcesAvailable(struct ndis_mp_block *nmb) wstdcall; -+void NdisMIndicateStatus(struct ndis_mp_block *nmb, -+ NDIS_STATUS status, void *buf, UINT len) wstdcall; -+void NdisMIndicateStatusComplete(struct ndis_mp_block *nmb) wstdcall; -+void NdisMQueryInformationComplete(struct ndis_mp_block *nmb, -+ NDIS_STATUS status) wstdcall; -+void NdisMSetInformationComplete(struct ndis_mp_block *nmb, -+ NDIS_STATUS status) wstdcall; -+void NdisMResetComplete(struct ndis_mp_block *nmb, NDIS_STATUS status, -+ BOOLEAN address_reset) wstdcall; -+ULONG NDIS_BUFFER_TO_SPAN_PAGES(ndis_buffer *buffer) wstdcall; -+BOOLEAN NdisWaitEvent(struct ndis_event *event, UINT timeout) wstdcall; -+void NdisSetEvent(struct ndis_event *event) wstdcall; -+void NdisMDeregisterInterrupt(struct ndis_mp_interrupt *mp_interrupt) wstdcall; -+void EthRxIndicateHandler(struct ndis_mp_block *nmb, void *rx_ctx, -+ char *header1, char *header, UINT header_size, -+ void *look_ahead, UINT look_ahead_size, -+ UINT packet_size) wstdcall; -+void EthRxComplete(struct ndis_mp_block *nmb) wstdcall; -+void NdisMTransferDataComplete(struct ndis_mp_block *nmb, -+ struct ndis_packet *packet, NDIS_STATUS status, -+ UINT bytes_txed) wstdcall; -+void NdisWriteConfiguration(NDIS_STATUS *status, struct ndis_mp_block *nmb, -+ struct unicode_string *key, -+ struct ndis_configuration_parameter *param) wstdcall; -+void NdisReadConfiguration(NDIS_STATUS *status, -+ struct ndis_configuration_parameter **param, -+ struct ndis_mp_block *nmb, -+ struct unicode_string *key, -+ enum ndis_parameter_type type) wstdcall; -+ -+/* Required OIDs */ -+#define OID_GEN_SUPPORTED_LIST 0x00010101 -+#define OID_GEN_HARDWARE_STATUS 0x00010102 -+#define OID_GEN_MEDIA_SUPPORTED 0x00010103 -+#define OID_GEN_MEDIA_IN_USE 0x00010104 -+#define OID_GEN_MAXIMUM_LOOKAHEAD 0x00010105 -+#define OID_GEN_MAXIMUM_FRAME_SIZE 0x00010106 -+#define OID_GEN_LINK_SPEED 0x00010107 -+#define OID_GEN_TRANSMIT_BUFFER_SPACE 0x00010108 -+#define OID_GEN_RECEIVE_BUFFER_SPACE 0x00010109 -+#define OID_GEN_TRANSMIT_BLOCK_SIZE 0x0001010A -+#define OID_GEN_RECEIVE_BLOCK_SIZE 0x0001010B -+#define OID_GEN_VENDOR_ID 0x0001010C -+#define OID_GEN_VENDOR_DESCRIPTION 0x0001010D -+#define OID_GEN_CURRENT_PACKET_FILTER 0x0001010E -+#define OID_GEN_CURRENT_LOOKAHEAD 0x0001010F -+#define OID_GEN_DRIVER_VERSION 0x00010110 -+#define OID_GEN_MAXIMUM_TOTAL_SIZE 0x00010111 -+#define OID_GEN_PROTOCOL_OPTIONS 0x00010112 -+#define OID_GEN_MAC_OPTIONS 0x00010113 -+#define OID_GEN_MEDIA_CONNECT_STATUS 0x00010114 -+#define OID_GEN_MAXIMUM_SEND_PACKETS 0x00010115 -+#define OID_GEN_VENDOR_DRIVER_VERSION 0x00010116 -+#define OID_GEN_SUPPORTED_GUIDS 0x00010117 -+#define OID_GEN_NETWORK_LAYER_ADDRESSES 0x00010118 /* Set only */ -+#define OID_GEN_TRANSPORT_HEADER_OFFSET 0x00010119 /* Set only */ -+#define OID_GEN_MACHINE_NAME 0x0001021A -+#define OID_GEN_RNDIS_CONFIG_PARAMETER 0x0001021B /* Set only */ -+#define OID_GEN_VLAN_ID 0x0001021C -+ -+/* Optional OIDs. */ -+#define OID_GEN_MEDIA_CAPABILITIES 0x00010201 -+#define OID_GEN_PHYSICAL_MEDIUM 0x00010202 -+ -+/* Required statistics OIDs. */ -+#define OID_GEN_XMIT_OK 0x00020101 -+#define OID_GEN_RCV_OK 0x00020102 -+#define OID_GEN_XMIT_ERROR 0x00020103 -+#define OID_GEN_RCV_ERROR 0x00020104 -+#define OID_GEN_RCV_NO_BUFFER 0x00020105 -+ -+/* Optional OID statistics */ -+#define OID_GEN_DIRECTED_BYTES_XMIT 0x00020201 -+#define OID_GEN_DIRECTED_FRAMES_XMIT 0x00020202 -+#define OID_GEN_MULTICAST_BYTES_XMIT 0x00020203 -+#define OID_GEN_MULTICAST_FRAMES_XMIT 0x00020204 -+#define OID_GEN_BROADCAST_BYTES_XMIT 0x00020205 -+#define OID_GEN_BROADCAST_FRAMES_XMIT 0x00020206 -+#define OID_GEN_DIRECTED_BYTES_RCV 0x00020207 -+#define OID_GEN_DIRECTED_FRAMES_RCV 0x00020208 -+#define OID_GEN_MULTICAST_BYTES_RCV 0x00020209 -+#define OID_GEN_MULTICAST_FRAMES_RCV 0x0002020A -+#define OID_GEN_BROADCAST_BYTES_RCV 0x0002020B -+#define OID_GEN_BROADCAST_FRAMES_RCV 0x0002020C -+#define OID_GEN_RCV_CRC_ERROR 0x0002020D -+#define OID_GEN_TRANSMIT_QUEUE_LENGTH 0x0002020E -+#define OID_GEN_GET_TIME_CAPS 0x0002020F -+#define OID_GEN_GET_NETCARD_TIME 0x00020210 -+#define OID_GEN_NETCARD_LOAD 0x00020211 -+#define OID_GEN_DEVICE_PROFILE 0x00020212 -+ -+/* 802.3 (ethernet) OIDs */ -+#define OID_802_3_PERMANENT_ADDRESS 0x01010101 -+#define OID_802_3_CURRENT_ADDRESS 0x01010102 -+#define OID_802_3_MULTICAST_LIST 0x01010103 -+#define OID_802_3_MAXIMUM_LIST_SIZE 0x01010104 -+#define OID_802_3_MAC_OPTIONS 0x01010105 -+#define NDIS_802_3_MAC_OPTION_PRIORITY 0x00000001 -+#define OID_802_3_RCV_ERROR_ALIGNMENT 0x01020101 -+#define OID_802_3_XMIT_ONE_COLLISION 0x01020102 -+#define OID_802_3_XMIT_MORE_COLLISIONS 0x01020103 -+#define OID_802_3_XMIT_DEFERRED 0x01020201 -+#define OID_802_3_XMIT_MAX_COLLISIONS 0x01020202 -+#define OID_802_3_RCV_OVERRUN 0x01020203 -+#define OID_802_3_XMIT_UNDERRUN 0x01020204 -+#define OID_802_3_XMIT_HEARTBEAT_FAILURE 0x01020205 -+#define OID_802_3_XMIT_TIMES_CRS_LOST 0x01020206 -+#define OID_802_3_XMIT_LATE_COLLISIONS 0x01020207 -+ -+/* PnP and power management OIDs */ -+#define OID_PNP_CAPABILITIES 0xFD010100 -+#define OID_PNP_SET_POWER 0xFD010101 -+#define OID_PNP_QUERY_POWER 0xFD010102 -+#define OID_PNP_ADD_WAKE_UP_PATTERN 0xFD010103 -+#define OID_PNP_REMOVE_WAKE_UP_PATTERN 0xFD010104 -+#define OID_PNP_WAKE_UP_PATTERN_LIST 0xFD010105 -+#define OID_PNP_ENABLE_WAKE_UP 0xFD010106 -+ -+/* PnP/PM Statistics (Optional). */ -+#define OID_PNP_WAKE_UP_OK 0xFD020200 -+#define OID_PNP_WAKE_UP_ERROR 0xFD020201 -+ -+/* The following bits are defined for OID_PNP_ENABLE_WAKE_UP */ -+#define NDIS_PNP_WAKE_UP_MAGIC_PACKET 0x00000001 -+#define NDIS_PNP_WAKE_UP_PATTERN_MATCH 0x00000002 -+#define NDIS_PNP_WAKE_UP_LINK_CHANGE 0x00000004 -+ -+/* 802.11 OIDs */ -+#define OID_802_11_BSSID 0x0D010101 -+#define OID_802_11_SSID 0x0D010102 -+#define OID_802_11_NETWORK_TYPES_SUPPORTED 0x0D010203 -+#define OID_802_11_NETWORK_TYPE_IN_USE 0x0D010204 -+#define OID_802_11_TX_POWER_LEVEL 0x0D010205 -+#define OID_802_11_RSSI 0x0D010206 -+#define OID_802_11_RSSI_TRIGGER 0x0D010207 -+#define OID_802_11_INFRASTRUCTURE_MODE 0x0D010108 -+#define OID_802_11_FRAGMENTATION_THRESHOLD 0x0D010209 -+#define OID_802_11_RTS_THRESHOLD 0x0D01020A -+#define OID_802_11_NUMBER_OF_ANTENNAS 0x0D01020B -+#define OID_802_11_RX_ANTENNA_SELECTED 0x0D01020C -+#define OID_802_11_TX_ANTENNA_SELECTED 0x0D01020D -+#define OID_802_11_SUPPORTED_RATES 0x0D01020E -+#define OID_802_11_DESIRED_RATES 0x0D010210 -+#define OID_802_11_CONFIGURATION 0x0D010211 -+#define OID_802_11_STATISTICS 0x0D020212 -+#define OID_802_11_ADD_WEP 0x0D010113 -+#define OID_802_11_REMOVE_WEP 0x0D010114 -+#define OID_802_11_DISASSOCIATE 0x0D010115 -+#define OID_802_11_POWER_MODE 0x0D010216 -+#define OID_802_11_BSSID_LIST 0x0D010217 -+#define OID_802_11_AUTHENTICATION_MODE 0x0D010118 -+#define OID_802_11_PRIVACY_FILTER 0x0D010119 -+#define OID_802_11_BSSID_LIST_SCAN 0x0D01011A -+#define OID_802_11_WEP_STATUS 0x0D01011B -+#define OID_802_11_ENCRYPTION_STATUS OID_802_11_WEP_STATUS -+#define OID_802_11_RELOAD_DEFAULTS 0x0D01011C -+#define OID_802_11_ADD_KEY 0x0D01011D -+#define OID_802_11_REMOVE_KEY 0x0D01011E -+#define OID_802_11_ASSOCIATION_INFORMATION 0x0D01011F -+#define OID_802_11_TEST 0x0D010120 -+#define OID_802_11_MEDIA_STREAM_MODE 0x0D010121 -+#define OID_802_11_CAPABILITY 0x0D010122 -+#define OID_802_11_PMKID 0x0D010123 -+ -+#define NDIS_STATUS_SUCCESS 0 -+#define NDIS_STATUS_PENDING 0x00000103 -+#define NDIS_STATUS_NOT_RECOGNIZED 0x00010001 -+#define NDIS_STATUS_NOT_COPIED 0x00010002 -+#define NDIS_STATUS_NOT_ACCEPTED 0x00010003 -+#define NDIS_STATUS_CALL_ACTIVE 0x00010007 -+#define NDIS_STATUS_ONLINE 0x40010003 -+#define NDIS_STATUS_RESET_START 0x40010004 -+#define NDIS_STATUS_RESET_END 0x40010005 -+#define NDIS_STATUS_RING_STATUS 0x40010006 -+#define NDIS_STATUS_CLOSED 0x40010007 -+#define NDIS_STATUS_WAN_LINE_UP 0x40010008 -+#define NDIS_STATUS_WAN_LINE_DOWN 0x40010009 -+#define NDIS_STATUS_WAN_FRAGMENT 0x4001000A -+#define NDIS_STATUS_MEDIA_CONNECT 0x4001000B -+#define NDIS_STATUS_MEDIA_DISCONNECT 0x4001000C -+#define NDIS_STATUS_HARDWARE_LINE_UP 0x4001000D -+#define NDIS_STATUS_HARDWARE_LINE_DOWN 0x4001000E -+#define NDIS_STATUS_INTERFACE_UP 0x4001000F -+#define NDIS_STATUS_INTERFACE_DOWN 0x40010010 -+#define NDIS_STATUS_MEDIA_BUSY 0x40010011 -+#define NDIS_STATUS_MEDIA_SPECIFIC_INDICATION 0x40010012 -+#define NDIS_STATUS_WW_INDICATION NDIS_STATUS_MEDIA_SPECIFIC_INDICATION -+#define NDIS_STATUS_LINK_SPEED_CHANGE 0x40010013 -+#define NDIS_STATUS_WAN_GET_STATS 0x40010014 -+#define NDIS_STATUS_WAN_CO_FRAGMENT 0x40010015 -+#define NDIS_STATUS_WAN_CO_LINKPARAMS 0x40010016 -+#define NDIS_STATUS_NOT_RESETTABLE 0x80010001 -+#define NDIS_STATUS_SOFT_ERRORS 0x80010003 -+#define NDIS_STATUS_HARD_ERRORS 0x80010004 -+#define NDIS_STATUS_BUFFER_OVERFLOW 0x80000005 -+#define NDIS_STATUS_FAILURE 0xC0000001 -+#define NDIS_STATUS_INVALID_PARAMETER 0xC000000D -+#define NDIS_STATUS_RESOURCES 0xC000009A -+#define NDIS_STATUS_CLOSING 0xC0010002 -+#define NDIS_STATUS_BAD_VERSION 0xC0010004 -+#define NDIS_STATUS_BAD_CHARACTERISTICS 0xC0010005 -+#define NDIS_STATUS_ADAPTER_NOT_FOUND 0xC0010006 -+#define NDIS_STATUS_OPEN_FAILED 0xC0010007 -+#define NDIS_STATUS_DEVICE_FAILED 0xC0010008 -+#define NDIS_STATUS_MULTICAST_FULL 0xC0010009 -+#define NDIS_STATUS_MULTICAST_EXISTS 0xC001000A -+#define NDIS_STATUS_MULTICAST_NOT_FOUND 0xC001000B -+#define NDIS_STATUS_REQUEST_ABORTED 0xC001000C -+#define NDIS_STATUS_RESET_IN_PROGRESS 0xC001000D -+#define NDIS_STATUS_CLOSING_INDICATING 0xC001000E -+#define NDIS_STATUS_BAD_VERSION 0xC0010004 -+#define NDIS_STATUS_NOT_SUPPORTED 0xC00000BB -+#define NDIS_STATUS_INVALID_PACKET 0xC001000F -+#define NDIS_STATUS_OPEN_LIST_FULL 0xC0010010 -+#define NDIS_STATUS_ADAPTER_NOT_READY 0xC0010011 -+#define NDIS_STATUS_ADAPTER_NOT_OPEN 0xC0010012 -+#define NDIS_STATUS_NOT_INDICATING 0xC0010013 -+#define NDIS_STATUS_INVALID_LENGTH 0xC0010014 -+#define NDIS_STATUS_INVALID_DATA 0xC0010015 -+#define NDIS_STATUS_BUFFER_TOO_SHORT 0xC0010016 -+#define NDIS_STATUS_INVALID_OID 0xC0010017 -+#define NDIS_STATUS_ADAPTER_REMOVED 0xC0010018 -+#define NDIS_STATUS_UNSUPPORTED_MEDIA 0xC0010019 -+#define NDIS_STATUS_GROUP_ADDRESS_IN_USE 0xC001001A -+#define NDIS_STATUS_FILE_NOT_FOUND 0xC001001B -+#define NDIS_STATUS_ERROR_READING_FILE 0xC001001C -+#define NDIS_STATUS_ALREADY_MAPPED 0xC001001D -+#define NDIS_STATUS_RESOURCE_CONFLICT 0xC001001E -+#define NDIS_STATUS_NO_CABLE 0xC001001F -+#define NDIS_STATUS_INVALID_SAP 0xC0010020 -+#define NDIS_STATUS_SAP_IN_USE 0xC0010021 -+#define NDIS_STATUS_INVALID_ADDRESS 0xC0010022 -+#define NDIS_STATUS_VC_NOT_ACTIVATED 0xC0010023 -+#define NDIS_STATUS_DEST_OUT_OF_ORDER 0xC0010024 -+#define NDIS_STATUS_VC_NOT_AVAILABLE 0xC0010025 -+#define NDIS_STATUS_CELLRATE_NOT_AVAILABLE 0xC0010026 -+#define NDIS_STATUS_INCOMPATABLE_QOS 0xC0010027 -+#define NDIS_STATUS_AAL_PARAMS_UNSUPPORTED 0xC0010028 -+#define NDIS_STATUS_NO_ROUTE_TO_DESTINATION 0xC0010029 -+#define NDIS_STATUS_TOKEN_RING_OPEN_ERROR 0xC0011000 -+#define NDIS_STATUS_INVALID_DEVICE_REQUEST 0xC0000010 -+#define NDIS_STATUS_NETWORK_UNREACHABLE 0xC000023C -+ -+/* Event codes */ -+ -+#define EVENT_NDIS_RESOURCE_CONFLICT 0xC0001388 -+#define EVENT_NDIS_OUT_OF_RESOURCE 0xC0001389 -+#define EVENT_NDIS_HARDWARE_FAILURE 0xC000138A -+#define EVENT_NDIS_ADAPTER_NOT_FOUND 0xC000138B -+#define EVENT_NDIS_INTERRUPT_CONNECT 0xC000138C -+#define EVENT_NDIS_DRIVER_FAILURE 0xC000138D -+#define EVENT_NDIS_BAD_VERSION 0xC000138E -+#define EVENT_NDIS_TIMEOUT 0x8000138F -+#define EVENT_NDIS_NETWORK_ADDRESS 0xC0001390 -+#define EVENT_NDIS_UNSUPPORTED_CONFIGURATION 0xC0001391 -+#define EVENT_NDIS_INVALID_VALUE_FROM_ADAPTER 0xC0001392 -+#define EVENT_NDIS_MISSING_CONFIGURATION_PARAMETER 0xC0001393 -+#define EVENT_NDIS_BAD_IO_BASE_ADDRESS 0xC0001394 -+#define EVENT_NDIS_RECEIVE_SPACE_SMALL 0x40001395 -+#define EVENT_NDIS_ADAPTER_DISABLED 0x80001396 -+#define EVENT_NDIS_IO_PORT_CONFLICT 0x80001397 -+#define EVENT_NDIS_PORT_OR_DMA_CONFLICT 0x80001398 -+#define EVENT_NDIS_MEMORY_CONFLICT 0x80001399 -+#define EVENT_NDIS_INTERRUPT_CONFLICT 0x8000139A -+#define EVENT_NDIS_DMA_CONFLICT 0x8000139B -+#define EVENT_NDIS_INVALID_DOWNLOAD_FILE_ERROR 0xC000139C -+#define EVENT_NDIS_MAXRECEIVES_ERROR 0x8000139D -+#define EVENT_NDIS_MAXTRANSMITS_ERROR 0x8000139E -+#define EVENT_NDIS_MAXFRAMESIZE_ERROR 0x8000139F -+#define EVENT_NDIS_MAXINTERNALBUFS_ERROR 0x800013A0 -+#define EVENT_NDIS_MAXMULTICAST_ERROR 0x800013A1 -+#define EVENT_NDIS_PRODUCTID_ERROR 0x800013A2 -+#define EVENT_NDIS_LOBE_FAILUE_ERROR 0x800013A3 -+#define EVENT_NDIS_SIGNAL_LOSS_ERROR 0x800013A4 -+#define EVENT_NDIS_REMOVE_RECEIVED_ERROR 0x800013A5 -+#define EVENT_NDIS_TOKEN_RING_CORRECTION 0x400013A6 -+#define EVENT_NDIS_ADAPTER_CHECK_ERROR 0xC00013A7 -+#define EVENT_NDIS_RESET_FAILURE_ERROR 0x800013A8 -+#define EVENT_NDIS_CABLE_DISCONNECTED_ERROR 0x800013A9 -+#define EVENT_NDIS_RESET_FAILURE_CORRECTION 0x800013AA -+ -+/* packet filter bits used by NDIS_OID_PACKET_FILTER */ -+#define NDIS_PACKET_TYPE_DIRECTED 0x00000001 -+#define NDIS_PACKET_TYPE_MULTICAST 0x00000002 -+#define NDIS_PACKET_TYPE_ALL_MULTICAST 0x00000004 -+#define NDIS_PACKET_TYPE_BROADCAST 0x00000008 -+#define NDIS_PACKET_TYPE_SOURCE_ROUTING 0x00000010 -+#define NDIS_PACKET_TYPE_PROMISCUOUS 0x00000020 -+#define NDIS_PACKET_TYPE_SMT 0x00000040 -+#define NDIS_PACKET_TYPE_ALL_LOCAL 0x00000080 -+#define NDIS_PACKET_TYPE_GROUP 0x00001000 -+#define NDIS_PACKET_TYPE_ALL_FUNCTIONAL 0x00002000 -+#define NDIS_PACKET_TYPE_FUNCTIONAL 0x00004000 -+#define NDIS_PACKET_TYPE_MAC_FRAME 0x00008000 -+ -+/* memory allocation flags */ -+#define NDIS_MEMORY_CONTIGUOUS 0x00000001 -+#define NDIS_MEMORY_NONCACHED 0x00000002 -+ -+/* Attribute flags to NdisMSetAtrributesEx */ -+#define NDIS_ATTRIBUTE_IGNORE_PACKET_TIMEOUT 0x00000001 -+#define NDIS_ATTRIBUTE_IGNORE_REQUEST_TIMEOUT 0x00000002 -+#define NDIS_ATTRIBUTE_IGNORE_TOKEN_RING_ERRORS 0x00000004 -+#define NDIS_ATTRIBUTE_BUS_MASTER 0x00000008 -+#define NDIS_ATTRIBUTE_INTERMEDIATE_DRIVER 0x00000010 -+#define NDIS_ATTRIBUTE_DESERIALIZE 0x00000020 -+#define NDIS_ATTRIBUTE_NO_HALT_ON_SUSPEND 0x00000040 -+#define NDIS_ATTRIBUTE_SURPRISE_REMOVE_OK 0x00000080 -+#define NDIS_ATTRIBUTE_NOT_CO_NDIS 0x00000100 -+#define NDIS_ATTRIBUTE_USES_SAFE_BUFFER_APIS 0x00000200 -+ -+#define OID_TCP_TASK_OFFLOAD 0xFC010201 -+ -+#define NDIS_MAC_OPTION_COPY_LOOKAHEAD_DATA 0x00000001 -+#define NDIS_MAC_OPTION_RECEIVE_SERIALIZED 0x00000002 -+#define NDIS_MAC_OPTION_TRANSFERS_NOT_PEND 0x00000004 -+#define NDIS_MAC_OPTION_NO_LOOPBACK 0x00000008 -+#define NDIS_MAC_OPTION_FULL_DUPLEX 0x00000010 -+#define NDIS_MAC_OPTION_EOTX_INDICATION 0x00000020 -+#define NDIS_MAC_OPTION_8021P_PRIORITY 0x00000040 -+#define NDIS_MAC_OPTION_SUPPORTS_MAC_ADDRESS_OVERWRITE 0x00000080 -+#define NDIS_MAC_OPTION_RECEIVE_AT_DPC 0x00000100 -+#define NDIS_MAC_OPTION_8021Q_VLAN 0x00000200 -+#define NDIS_MAC_OPTION_RESERVED 0x80000000 -+ -+#define deserialized_driver(wnd) (wnd->attributes & NDIS_ATTRIBUTE_DESERIALIZE) -+ -+static inline void serialize_lock(struct ndis_device *wnd) -+{ -+ nt_spin_lock(&wnd->nmb->lock); -+} -+ -+static inline void serialize_unlock(struct ndis_device *wnd) -+{ -+ nt_spin_unlock(&wnd->nmb->lock); -+} -+ -+static inline KIRQL serialize_lock_irql(struct ndis_device *wnd) -+{ -+ if (deserialized_driver(wnd)) -+ return raise_irql(DISPATCH_LEVEL); -+ else -+ return nt_spin_lock_irql(&wnd->nmb->lock, DISPATCH_LEVEL); -+} -+ -+static inline void serialize_unlock_irql(struct ndis_device *wnd, -+ KIRQL irql) -+{ -+ if (deserialized_driver(wnd)) -+ lower_irql(irql); -+ else -+ nt_spin_unlock_irql(&wnd->nmb->lock, irql); -+} -+ -+static inline void if_serialize_lock(struct ndis_device *wnd) -+{ -+ if (!deserialized_driver(wnd)) -+ nt_spin_lock(&wnd->nmb->lock); -+} -+ -+static inline void if_serialize_unlock(struct ndis_device *wnd) -+{ -+ if (!deserialized_driver(wnd)) -+ nt_spin_unlock(&wnd->nmb->lock); -+} -+ -+#endif /* NDIS_H */ -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/ndiswrapper.h linux-4.12.4-3rd/3rdparty/ndiswrapper/ndiswrapper.h ---- linux-4.12.4/3rdparty/ndiswrapper/ndiswrapper.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/ndiswrapper.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,219 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifndef _NDISWRAPPER_H_ -+#define _NDISWRAPPER_H_ -+ -+#define DRIVER_VERSION "1.61" -+#define UTILS_VERSION "1.9" -+ -+#define DRIVER_NAME "ndiswrapper" -+#define DRIVER_CONFIG_DIR "/etc/ndiswrapper" -+ -+#define NDIS_ESSID_MAX_SIZE 32 -+#define NDIS_ENCODING_TOKEN_MAX 32 -+#define MAX_ENCR_KEYS 4 -+#define TX_RING_SIZE 16 -+#define NDIS_MAX_RATES 8 -+#define NDIS_MAX_RATES_EX 16 -+ -+#define WRAP_PCI_BUS 5 -+#define WRAP_PCMCIA_BUS 8 -+/* some USB devices, e.g., DWL-G120 have BusType as 0 */ -+#define WRAP_INTERNAL_BUS 0 -+/* documentation at msdn says 15 is PNP bus, but inf files from all -+ * vendors say 15 is USB; which is correct? */ -+#define WRAP_USB_BUS 15 -+ -+/* NDIS device must be 0, for compatibility with old versions of -+ * ndiswrapper where device type for NDIS drivers is 0 */ -+#define WRAP_NDIS_DEVICE 0 -+#define WRAP_USB_DEVICE 1 -+#define WRAP_BLUETOOTH_DEVICE1 2 -+#define WRAP_BLUETOOTH_DEVICE2 3 -+ -+#define WRAP_DEVICE_BUS(dev, bus) ((dev) << 8 | (bus)) -+#define WRAP_BUS(dev_bus) ((dev_bus) & 0x000FF) -+#define WRAP_DEVICE(dev_bus) ((dev_bus) >> 8) -+ -+#define MAX_DRIVER_NAME_LEN 32 -+#define MAX_VERSION_STRING_LEN 64 -+#define MAX_SETTING_NAME_LEN 128 -+#define MAX_SETTING_VALUE_LEN 256 -+ -+#define MAX_DRIVER_PE_IMAGES 4 -+#define MAX_DRIVER_BIN_FILES 5 -+#define MAX_DEVICE_SETTINGS 512 -+ -+#define MAX_ALLOCATED_URBS 15 -+ -+#define DEV_ANY_ID -1 -+ -+#define MAC2STR(a) (a)[0], (a)[1], (a)[2], (a)[3], (a)[4], (a)[5] -+#define MACSTRSEP "%02x:%02x:%02x:%02x:%02x:%02x" -+#define MACSTR "%02x%02x%02x%02x%02x%02x" -+#define MACINTADR(a) (int*)&((a)[0]), (int*)&((a)[1]), (int*)&((a)[2]), \ -+ (int*)&((a)[3]), (int*)&((a)[4]), (int*)&((a)[5]) -+ -+#ifdef __KERNEL__ -+/* DEBUG macros */ -+ -+#define MSG(level, fmt, ...) \ -+ printk(level DRIVER_NAME " (%s:%d): " fmt "\n", \ -+ __func__, __LINE__ , ## __VA_ARGS__) -+ -+#define WARNING(fmt, ...) MSG(KERN_WARNING, fmt, ## __VA_ARGS__) -+#define ERROR(fmt, ...) MSG(KERN_ERR, fmt , ## __VA_ARGS__) -+#define INFO(fmt, ...) MSG(KERN_INFO, fmt , ## __VA_ARGS__) -+#define TODO() WARNING("not fully implemented (yet)") -+ -+#define TRACE(level, fmt, ...) \ -+do { \ -+ if (debug >= level) \ -+ printk(KERN_INFO "%s (%s:%d): " fmt "\n", DRIVER_NAME, \ -+ __func__, __LINE__ , ## __VA_ARGS__); \ -+} while (0) -+#define TRACE0(fmt, ...) TRACE(0, fmt , ## __VA_ARGS__) -+ -+extern int debug; -+ -+#ifndef DEBUG -+#define DEBUG 0 -+#endif -+ -+/* for a block of code */ -+#if DEBUG >= 1 -+#define DBG_BLOCK(level) if (debug >= level) -+#else -+#define DBG_BLOCK(level) while (0) -+#endif -+ -+#if DEBUG >= 1 -+#define TRACE1(fmt, ...) TRACE(1, fmt , ## __VA_ARGS__) -+#else -+#define TRACE1(fmt, ...) do { } while (0) -+#endif -+ -+#if DEBUG >= 2 -+#define TRACE2(fmt, ...) TRACE(2, fmt , ## __VA_ARGS__) -+#else -+#define TRACE2(fmt, ...) do { } while (0) -+#endif -+ -+#if DEBUG >= 3 -+#define TRACE3(fmt, ...) TRACE(3, fmt , ## __VA_ARGS__) -+#else -+#define TRACE3(fmt, ...) do { } while (0) -+#endif -+ -+#if DEBUG >= 4 -+#define TRACE4(fmt, ...) TRACE(4, fmt , ## __VA_ARGS__) -+#else -+#define TRACE4(fmt, ...) do { } while (0) -+#endif -+ -+#if DEBUG >= 5 -+#define TRACE5(fmt, ...) TRACE(5, fmt , ## __VA_ARGS__) -+#else -+#define TRACE5(fmt, ...) do { } while (0) -+#endif -+ -+#if DEBUG >= 6 -+#define TRACE6(fmt, ...) TRACE(6, fmt , ## __VA_ARGS__) -+#else -+#define TRACE6(fmt, ...) do { } while (0) -+#endif -+ -+#define ENTER0(fmt, ...) TRACE0("Enter " fmt , ## __VA_ARGS__) -+#define ENTER1(fmt, ...) TRACE1("Enter " fmt , ## __VA_ARGS__) -+#define ENTER2(fmt, ...) TRACE2("Enter " fmt , ## __VA_ARGS__) -+#define ENTER3(fmt, ...) TRACE3("Enter " fmt , ## __VA_ARGS__) -+#define ENTER4(fmt, ...) TRACE4("Enter " fmt , ## __VA_ARGS__) -+#define ENTER5(fmt, ...) TRACE5("Enter " fmt , ## __VA_ARGS__) -+#define ENTER6(fmt, ...) TRACE6("Enter " fmt , ## __VA_ARGS__) -+ -+#define EXIT0(stmt) do { TRACE0("Exit"); stmt; } while (0) -+#define EXIT1(stmt) do { TRACE1("Exit"); stmt; } while (0) -+#define EXIT2(stmt) do { TRACE2("Exit"); stmt; } while (0) -+#define EXIT3(stmt) do { TRACE3("Exit"); stmt; } while (0) -+#define EXIT4(stmt) do { TRACE4("Exit"); stmt; } while (0) -+#define EXIT5(stmt) do { TRACE5("Exit"); stmt; } while (0) -+#define EXIT6(stmt) do { TRACE6("Exit"); stmt; } while (0) -+ -+#if defined(USB_DEBUG) -+#define USBTRACE TRACE0 -+#define USBENTER ENTER0 -+#define USBEXIT EXIT0 -+#else -+#define USBTRACE(fmt, ...) do { } while (0) -+#define USBENTER(fmt, ...) -+#define USBEXIT(stmt) stmt -+#endif -+ -+#if defined(EVENT_DEBUG) -+#define EVENTTRACE TRACE0 -+#define EVENTENTER ENTER0 -+#define EVENTEXIT EXIT0 -+#else -+#define EVENTTRACE(fmt, ...) do { } while (0) -+#define EVENTENTER(fmt, ...) -+#define EVENTEXIT(stmt) stmt -+#endif -+ -+#if defined(TIMER_DEBUG) -+#define TIMERTRACE TRACE0 -+#define TIMERENTER ENTER0 -+#define TIMEREXIT EXIT0 -+#else -+#define TIMERTRACE(fmt, ...) do { } while (0) -+#define TIMERENTER(fmt, ...) -+#define TIMEREXIT(stmt) stmt -+#endif -+ -+#if defined(IO_DEBUG) -+#define IOTRACE TRACE0 -+#define IOENTER ENTER0 -+#define IOEXIT EXIT0 -+#else -+#define IOTRACE(fmt, ...) do { } while (0) -+#define IOENTER(fmt, ...) -+#define IOEXIT(stmt) stmt -+#endif -+ -+#if defined(WORK_DEBUG) -+#define WORKTRACE TRACE0 -+#define WORKENTER ENTER0 -+#define WORKEXIT EXIT0 -+#else -+#define WORKTRACE(fmt, ...) do { } while (0) -+#define WORKENTER(fmt, ...) -+#define WORKEXIT(stmt) stmt -+#endif -+ -+#if DEBUG >= 1 -+#define assert(expr) \ -+do { \ -+ if (!(expr)) { \ -+ ERROR("assertion '%s' failed", #expr); \ -+ dump_stack(); \ -+ } \ -+} while (0) -+#else -+#define assert(expr) do { } while (0) -+#endif -+ -+#endif // __KERNEL__ -+ -+#endif // NDISWRAPPER_H -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/ntoskernel.c linux-4.12.4-3rd/3rdparty/ndiswrapper/ntoskernel.c ---- linux-4.12.4/3rdparty/ndiswrapper/ntoskernel.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/ntoskernel.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,2677 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include "ntoskernel.h" -+#include "ndis.h" -+#include "usb.h" -+#include "pnp.h" -+#include "loader.h" -+#include "ntoskernel_exports.h" -+ -+/* MDLs describe a range of virtual address with an array of physical -+ * pages right after the header. For different ranges of virtual -+ * addresses, the number of entries of physical pages may be different -+ * (depending on number of entries required). If we want to allocate -+ * MDLs from a pool, the size has to be constant. So we assume that -+ * maximum range used by a driver is MDL_CACHE_PAGES; if a driver -+ * requests an MDL for a bigger region, we allocate it with kmalloc; -+ * otherwise, we allocate from the pool */ -+ -+#define MDL_CACHE_PAGES 3 -+#define MDL_CACHE_SIZE (sizeof(struct mdl) + \ -+ (sizeof(PFN_NUMBER) * MDL_CACHE_PAGES)) -+struct wrap_mdl { -+ struct nt_list list; -+ struct mdl mdl[0]; -+}; -+ -+/* everything here is for all drivers/devices - not per driver/device */ -+static spinlock_t dispatcher_lock; -+spinlock_t ntoskernel_lock; -+static void *mdl_cache; -+static struct nt_list wrap_mdl_list; -+ -+static struct work_struct kdpc_work; -+static void kdpc_worker(struct work_struct *dummy); -+ -+static struct nt_list kdpc_list; -+static spinlock_t kdpc_list_lock; -+ -+static struct nt_list callback_objects; -+ -+struct nt_list object_list; -+ -+struct bus_driver { -+ struct nt_list list; -+ char name[MAX_DRIVER_NAME_LEN]; -+ struct driver_object drv_obj; -+}; -+ -+static struct nt_list bus_driver_list; -+ -+static struct work_struct ntos_work; -+static struct nt_list ntos_work_list; -+static spinlock_t ntos_work_lock; -+static void ntos_work_worker(struct work_struct *dummy); -+spinlock_t irp_cancel_lock; -+static NT_SPIN_LOCK nt_list_lock; -+static struct nt_slist wrap_timer_slist; -+CCHAR cpu_count; -+ -+/* compute ticks (100ns) since 1601 until when system booted into -+ * wrap_ticks_to_boot */ -+u64 wrap_ticks_to_boot; -+ -+#if defined(CONFIG_X86_64) -+static struct timer_list shared_data_timer; -+struct kuser_shared_data kuser_shared_data; -+static void update_user_shared_data_proc(unsigned long data); -+#endif -+ -+WIN_SYMBOL_MAP("KeTickCount", &jiffies) -+WIN_SYMBOL_MAP("KeNumberProcessors", &cpu_count) -+WIN_SYMBOL_MAP("NlsMbCodePageTag", FALSE) -+ -+struct workqueue_struct *ntos_wq; -+ -+#ifdef WRAP_PREEMPT -+DEFINE_PER_CPU(struct irql_info, irql_info); -+#endif -+ -+#if defined(CONFIG_X86_64) -+static void update_user_shared_data_proc(unsigned long data) -+{ -+ /* timer is supposed to be scheduled every 10ms, but bigger -+ * intervals seem to work (tried up to 50ms) */ -+ *((ULONG64 *)&kuser_shared_data.system_time) = ticks_1601(); -+ *((ULONG64 *)&kuser_shared_data.interrupt_time) = -+ jiffies * TICKSPERSEC / HZ; -+ *((ULONG64 *)&kuser_shared_data.tick) = jiffies; -+ -+ mod_timer(&shared_data_timer, jiffies + MSEC_TO_HZ(30)); -+} -+#endif -+ -+void *allocate_object(ULONG size, enum common_object_type type, -+ struct unicode_string *name) -+{ -+ struct common_object_header *hdr; -+ void *body; -+ -+ /* we pad header as prefix to body */ -+ hdr = ExAllocatePoolWithTag(NonPagedPool, OBJECT_SIZE(size), 0); -+ if (!hdr) { -+ WARNING("couldn't allocate memory"); -+ return NULL; -+ } -+ memset(hdr, 0, OBJECT_SIZE(size)); -+ if (name) { -+ hdr->name.buf = ExAllocatePoolWithTag(NonPagedPool, -+ name->max_length, 0); -+ if (!hdr->name.buf) { -+ ExFreePool(hdr); -+ return NULL; -+ } -+ memcpy(hdr->name.buf, name->buf, name->max_length); -+ hdr->name.length = name->length; -+ hdr->name.max_length = name->max_length; -+ } -+ hdr->type = type; -+ hdr->ref_count = 1; -+ spin_lock_bh(&ntoskernel_lock); -+ /* threads are looked up often (in KeWaitForXXX), so optimize -+ * for fast lookups of threads */ -+ if (type == OBJECT_TYPE_NT_THREAD) -+ InsertHeadList(&object_list, &hdr->list); -+ else -+ InsertTailList(&object_list, &hdr->list); -+ spin_unlock_bh(&ntoskernel_lock); -+ body = HEADER_TO_OBJECT(hdr); -+ TRACE3("allocated hdr: %p, body: %p", hdr, body); -+ return body; -+} -+ -+static void free_object(void *object) -+{ -+ struct common_object_header *hdr; -+ -+ hdr = OBJECT_TO_HEADER(object); -+ spin_lock_bh(&ntoskernel_lock); -+ RemoveEntryList(&hdr->list); -+ spin_unlock_bh(&ntoskernel_lock); -+ TRACE3("freed hdr: %p, body: %p", hdr, object); -+ if (hdr->name.buf) -+ ExFreePool(hdr->name.buf); -+ ExFreePool(hdr); -+} -+ -+static int add_bus_driver(const char *name) -+{ -+ struct bus_driver *bus_driver; -+ -+ bus_driver = kzalloc(sizeof(*bus_driver), GFP_KERNEL); -+ if (!bus_driver) { -+ ERROR("couldn't allocate memory"); -+ return -ENOMEM; -+ } -+ strncpy(bus_driver->name, name, sizeof(bus_driver->name)); -+ bus_driver->name[sizeof(bus_driver->name)-1] = 0; -+ spin_lock_bh(&ntoskernel_lock); -+ InsertTailList(&bus_driver_list, &bus_driver->list); -+ spin_unlock_bh(&ntoskernel_lock); -+ TRACE1("bus driver %s is at %p", name, &bus_driver->drv_obj); -+ return STATUS_SUCCESS; -+} -+ -+struct driver_object *find_bus_driver(const char *name) -+{ -+ struct bus_driver *bus_driver; -+ struct driver_object *drv_obj; -+ -+ spin_lock_bh(&ntoskernel_lock); -+ drv_obj = NULL; -+ nt_list_for_each_entry(bus_driver, &bus_driver_list, list) { -+ if (strcmp(bus_driver->name, name) == 0) { -+ drv_obj = &bus_driver->drv_obj; -+ break; -+ } -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ return drv_obj; -+} -+ -+wfastcall struct nt_list *WIN_FUNC(ExfInterlockedInsertHeadList,3) -+ (struct nt_list *head, struct nt_list *entry, NT_SPIN_LOCK *lock) -+{ -+ struct nt_list *first; -+ unsigned long flags; -+ -+ ENTER5("head = %p, entry = %p", head, entry); -+ nt_spin_lock_irqsave(lock, flags); -+ first = InsertHeadList(head, entry); -+ nt_spin_unlock_irqrestore(lock, flags); -+ TRACE5("head = %p, old = %p", head, first); -+ return first; -+} -+ -+wfastcall struct nt_list *WIN_FUNC(ExInterlockedInsertHeadList,3) -+ (struct nt_list *head, struct nt_list *entry, NT_SPIN_LOCK *lock) -+{ -+ ENTER5("%p", head); -+ return ExfInterlockedInsertHeadList(head, entry, lock); -+} -+ -+wfastcall struct nt_list *WIN_FUNC(ExfInterlockedInsertTailList,3) -+ (struct nt_list *head, struct nt_list *entry, NT_SPIN_LOCK *lock) -+{ -+ struct nt_list *last; -+ unsigned long flags; -+ -+ ENTER5("head = %p, entry = %p", head, entry); -+ nt_spin_lock_irqsave(lock, flags); -+ last = InsertTailList(head, entry); -+ nt_spin_unlock_irqrestore(lock, flags); -+ TRACE5("head = %p, old = %p", head, last); -+ return last; -+} -+ -+wfastcall struct nt_list *WIN_FUNC(ExInterlockedInsertTailList,3) -+ (struct nt_list *head, struct nt_list *entry, NT_SPIN_LOCK *lock) -+{ -+ ENTER5("%p", head); -+ return ExfInterlockedInsertTailList(head, entry, lock); -+} -+ -+wfastcall struct nt_list *WIN_FUNC(ExfInterlockedRemoveHeadList,2) -+ (struct nt_list *head, NT_SPIN_LOCK *lock) -+{ -+ struct nt_list *ret; -+ unsigned long flags; -+ -+ ENTER5("head = %p", head); -+ nt_spin_lock_irqsave(lock, flags); -+ ret = RemoveHeadList(head); -+ nt_spin_unlock_irqrestore(lock, flags); -+ TRACE5("head = %p, ret = %p", head, ret); -+ return ret; -+} -+ -+wfastcall struct nt_list *WIN_FUNC(ExInterlockedRemoveHeadList,2) -+ (struct nt_list *head, NT_SPIN_LOCK *lock) -+{ -+ ENTER5("%p", head); -+ return ExfInterlockedRemoveHeadList(head, lock); -+} -+ -+wfastcall struct nt_list *WIN_FUNC(ExfInterlockedRemoveTailList,2) -+ (struct nt_list *head, NT_SPIN_LOCK *lock) -+{ -+ struct nt_list *ret; -+ unsigned long flags; -+ -+ ENTER5("head = %p", head); -+ nt_spin_lock_irqsave(lock, flags); -+ ret = RemoveTailList(head); -+ nt_spin_unlock_irqrestore(lock, flags); -+ TRACE5("head = %p, ret = %p", head, ret); -+ return ret; -+} -+ -+wfastcall struct nt_list *WIN_FUNC(ExInterlockedRemoveTailList,2) -+ (struct nt_list *head, NT_SPIN_LOCK *lock) -+{ -+ ENTER5("%p", head); -+ return ExfInterlockedRemoveTailList(head, lock); -+} -+ -+wfastcall void WIN_FUNC(InitializeSListHead,1) -+ (nt_slist_header *head) -+{ -+ memset(head, 0, sizeof(*head)); -+} -+ -+wfastcall struct nt_slist *WIN_FUNC(ExInterlockedPushEntrySList,3) -+ (nt_slist_header *head, struct nt_slist *entry, NT_SPIN_LOCK *lock) -+{ -+ struct nt_slist *ret; -+ -+ ret = PushEntrySList(head, entry, lock); -+ return ret; -+} -+ -+wstdcall struct nt_slist *WIN_FUNC(ExpInterlockedPushEntrySList,2) -+ (nt_slist_header *head, struct nt_slist *entry) -+{ -+ struct nt_slist *ret; -+ -+ ret = PushEntrySList(head, entry, &nt_list_lock); -+ return ret; -+} -+ -+wfastcall struct nt_slist *WIN_FUNC(InterlockedPushEntrySList,2) -+ (nt_slist_header *head, struct nt_slist *entry) -+{ -+ struct nt_slist *ret; -+ -+ ret = PushEntrySList(head, entry, &nt_list_lock); -+ return ret; -+} -+ -+wfastcall struct nt_slist *WIN_FUNC(ExInterlockedPopEntrySList,2) -+ (nt_slist_header *head, NT_SPIN_LOCK *lock) -+{ -+ struct nt_slist *ret; -+ -+ ret = PopEntrySList(head, lock); -+ return ret; -+} -+ -+wstdcall struct nt_slist *WIN_FUNC(ExpInterlockedPopEntrySList,1) -+ (nt_slist_header *head) -+{ -+ struct nt_slist *ret; -+ -+ ret = PopEntrySList(head, &nt_list_lock); -+ return ret; -+} -+ -+wfastcall struct nt_slist *WIN_FUNC(InterlockedPopEntrySList,1) -+ (nt_slist_header *head) -+{ -+ struct nt_slist *ret; -+ -+ ret = PopEntrySList(head, &nt_list_lock); -+ return ret; -+} -+ -+wstdcall USHORT WIN_FUNC(ExQueryDepthSList,1) -+ (nt_slist_header *head) -+{ -+ USHORT depth; -+ ENTER5("%p", head); -+ depth = head->depth; -+ TRACE5("%d, %p", depth, head->next); -+ return depth; -+} -+ -+wfastcall LONG WIN_FUNC(InterlockedIncrement,1) -+ (LONG volatile *val) -+{ -+ return post_atomic_add(*val, 1); -+} -+ -+wfastcall LONG WIN_FUNC(InterlockedDecrement,1) -+ (LONG volatile *val) -+{ -+ return post_atomic_add(*val, -1); -+} -+ -+wfastcall LONG WIN_FUNC(InterlockedExchange,2) -+ (LONG volatile *target, LONG val) -+{ -+ return xchg(target, val); -+} -+ -+wfastcall LONG WIN_FUNC(InterlockedCompareExchange,3) -+ (LONG volatile *dest, LONG new, LONG old) -+{ -+ return cmpxchg(dest, old, new); -+} -+ -+wfastcall void WIN_FUNC(ExInterlockedAddLargeStatistic,2) -+ (LARGE_INTEGER volatile *plint, ULONG n) -+{ -+ unsigned long flags; -+ -+ local_irq_save(flags); -+#ifdef CONFIG_X86_64 -+ __asm__ __volatile__( -+ "\n" -+ LOCK_PREFIX "add %1, %0\n\t" -+ : "+m" (*plint) -+ : "r" (n)); -+#else -+ __asm__ __volatile__( -+ "1:\t" -+ " movl %1, %%ebx\n\t" -+ " movl %%edx, %%ecx\n\t" -+ " addl %%eax, %%ebx\n\t" -+ " adcl $0, %%ecx\n\t" -+ LOCK_PREFIX "cmpxchg8b %0\n\t" -+ " jnz 1b\n\t" -+ : "+m" (*plint) -+ : "m" (n), "A" (*plint) -+ : "ebx", "ecx"); -+#endif -+ local_irq_restore(flags); -+} -+ -+static void initialize_object(struct dispatcher_header *dh, enum dh_type type, -+ int state) -+{ -+ memset(dh, 0, sizeof(*dh)); -+ set_object_type(dh, type); -+ dh->signal_state = state; -+ InitializeListHead(&dh->wait_blocks); -+} -+ -+static void timer_proc(unsigned long data) -+{ -+ struct wrap_timer *wrap_timer = (struct wrap_timer *)data; -+ struct nt_timer *nt_timer; -+ struct kdpc *kdpc; -+ -+ nt_timer = wrap_timer->nt_timer; -+ TIMERENTER("%p(%p), %lu", wrap_timer, nt_timer, jiffies); -+#ifdef TIMER_DEBUG -+ BUG_ON(wrap_timer->wrap_timer_magic != WRAP_TIMER_MAGIC); -+ BUG_ON(nt_timer->wrap_timer_magic != WRAP_TIMER_MAGIC); -+#endif -+ KeSetEvent((struct nt_event *)nt_timer, 0, FALSE); -+ if (wrap_timer->repeat) -+ mod_timer(&wrap_timer->timer, jiffies + wrap_timer->repeat); -+ kdpc = nt_timer->kdpc; -+ if (kdpc) -+ queue_kdpc(kdpc); -+ TIMEREXIT(return); -+} -+ -+void wrap_init_timer(struct nt_timer *nt_timer, enum timer_type type, -+ struct ndis_mp_block *nmb) -+{ -+ struct wrap_timer *wrap_timer; -+ -+ /* TODO: if a timer is initialized more than once, we allocate -+ * memory for wrap_timer more than once for the same nt_timer, -+ * wasting memory. We can check if nt_timer->wrap_timer_magic is -+ * set and not allocate, but it is not guaranteed always to be -+ * safe */ -+ TIMERENTER("%p", nt_timer); -+ /* we allocate memory for wrap_timer behind driver's back and -+ * there is no NDIS/DDK function where this memory can be -+ * freed, so we use slack_kmalloc so it gets freed when driver -+ * is unloaded */ -+ if (nmb) -+ wrap_timer = kzalloc(sizeof(*wrap_timer), irql_gfp()); -+ else -+ wrap_timer = slack_kzalloc(sizeof(*wrap_timer)); -+ if (!wrap_timer) { -+ ERROR("couldn't allocate memory for timer"); -+ return; -+ } -+ -+ init_timer(&wrap_timer->timer); -+ wrap_timer->timer.data = (unsigned long)wrap_timer; -+ wrap_timer->timer.function = timer_proc; -+ wrap_timer->nt_timer = nt_timer; -+#ifdef TIMER_DEBUG -+ wrap_timer->wrap_timer_magic = WRAP_TIMER_MAGIC; -+#endif -+ nt_timer->wrap_timer = wrap_timer; -+ nt_timer->kdpc = NULL; -+ initialize_object(&nt_timer->dh, (enum dh_type)type, 0); -+ nt_timer->wrap_timer_magic = WRAP_TIMER_MAGIC; -+ TIMERTRACE("timer %p (%p)", wrap_timer, nt_timer); -+ spin_lock_bh(&ntoskernel_lock); -+ if (nmb) { -+ wrap_timer->slist.next = nmb->wnd->wrap_timer_slist.next; -+ nmb->wnd->wrap_timer_slist.next = &wrap_timer->slist; -+ } else { -+ wrap_timer->slist.next = wrap_timer_slist.next; -+ wrap_timer_slist.next = &wrap_timer->slist; -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ TIMEREXIT(return); -+} -+ -+wstdcall void WIN_FUNC(KeInitializeTimerEx,2) -+ (struct nt_timer *nt_timer, enum timer_type type) -+{ -+ TIMERENTER("%p", nt_timer); -+ wrap_init_timer(nt_timer, type, NULL); -+} -+ -+wstdcall void WIN_FUNC(KeInitializeTimer,1) -+ (struct nt_timer *nt_timer) -+{ -+ TIMERENTER("%p", nt_timer); -+ wrap_init_timer(nt_timer, NotificationTimer, NULL); -+} -+ -+/* expires and repeat are in HZ */ -+BOOLEAN wrap_set_timer(struct nt_timer *nt_timer, unsigned long expires_hz, -+ unsigned long repeat_hz, struct kdpc *kdpc) -+{ -+ struct wrap_timer *wrap_timer; -+ -+ TIMERENTER("%p, %lu, %lu, %p, %lu", -+ nt_timer, expires_hz, repeat_hz, kdpc, jiffies); -+ -+ wrap_timer = nt_timer->wrap_timer; -+ TIMERTRACE("%p", wrap_timer); -+#ifdef TIMER_DEBUG -+ if (wrap_timer->nt_timer != nt_timer) -+ WARNING("bad timers: %p, %p, %p", wrap_timer, nt_timer, -+ wrap_timer->nt_timer); -+ if (nt_timer->wrap_timer_magic != WRAP_TIMER_MAGIC) { -+ WARNING("buggy Windows timer didn't initialize timer %p", -+ nt_timer); -+ return FALSE; -+ } -+ if (wrap_timer->wrap_timer_magic != WRAP_TIMER_MAGIC) { -+ WARNING("timer %p is not initialized (%lx)?", -+ wrap_timer, wrap_timer->wrap_timer_magic); -+ wrap_timer->wrap_timer_magic = WRAP_TIMER_MAGIC; -+ } -+#endif -+ KeClearEvent((struct nt_event *)nt_timer); -+ nt_timer->kdpc = kdpc; -+ wrap_timer->repeat = repeat_hz; -+ if (mod_timer(&wrap_timer->timer, jiffies + expires_hz)) -+ TIMEREXIT(return TRUE); -+ else -+ TIMEREXIT(return FALSE); -+} -+ -+wstdcall BOOLEAN WIN_FUNC(KeSetTimerEx,4) -+ (struct nt_timer *nt_timer, LARGE_INTEGER duetime_ticks, -+ LONG period_ms, struct kdpc *kdpc) -+{ -+ unsigned long expires_hz, repeat_hz; -+ -+ TIMERENTER("%p, %lld, %d", nt_timer, duetime_ticks, period_ms); -+ expires_hz = SYSTEM_TIME_TO_HZ(duetime_ticks); -+ repeat_hz = MSEC_TO_HZ(period_ms); -+ return wrap_set_timer(nt_timer, expires_hz, repeat_hz, kdpc); -+} -+ -+wstdcall BOOLEAN WIN_FUNC(KeSetTimer,3) -+ (struct nt_timer *nt_timer, LARGE_INTEGER duetime_ticks, -+ struct kdpc *kdpc) -+{ -+ TIMERENTER("%p, %lld, %p", nt_timer, duetime_ticks, kdpc); -+ return KeSetTimerEx(nt_timer, duetime_ticks, 0, kdpc); -+} -+ -+wstdcall BOOLEAN WIN_FUNC(KeCancelTimer,1) -+ (struct nt_timer *nt_timer) -+{ -+ struct wrap_timer *wrap_timer; -+ int ret; -+ -+ TIMERENTER("%p", nt_timer); -+ wrap_timer = nt_timer->wrap_timer; -+ if (!wrap_timer) { -+ ERROR("invalid wrap_timer"); -+ return TRUE; -+ } -+#ifdef TIMER_DEBUG -+ BUG_ON(wrap_timer->wrap_timer_magic != WRAP_TIMER_MAGIC); -+#endif -+ /* disable timer before deleting so if it is periodic timer, it -+ * won't be re-armed after deleting */ -+ wrap_timer->repeat = 0; -+ ret = del_timer_sync(&wrap_timer->timer); -+ /* the documentation for KeCancelTimer suggests the DPC is -+ * deqeued, but actually DPC is left to run */ -+ if (ret) -+ TIMEREXIT(return TRUE); -+ else -+ TIMEREXIT(return FALSE); -+} -+ -+wstdcall BOOLEAN WIN_FUNC(KeReadStateTimer,1) -+ (struct nt_timer *nt_timer) -+{ -+ if (nt_timer->dh.signal_state) -+ return TRUE; -+ else -+ return FALSE; -+} -+ -+wstdcall void WIN_FUNC(KeInitializeDpc,3) -+ (struct kdpc *kdpc, void *func, void *ctx) -+{ -+ ENTER3("%p, %p, %p", kdpc, func, ctx); -+ memset(kdpc, 0, sizeof(*kdpc)); -+ kdpc->func = func; -+ kdpc->ctx = ctx; -+ InitializeListHead(&kdpc->list); -+} -+ -+static void kdpc_worker(struct work_struct *dummy) -+{ -+ struct nt_list *entry; -+ struct kdpc *kdpc; -+ unsigned long flags; -+ KIRQL irql; -+ -+ WORKENTER(""); -+ irql = raise_irql(DISPATCH_LEVEL); -+ while (1) { -+ spin_lock_irqsave(&kdpc_list_lock, flags); -+ entry = RemoveHeadList(&kdpc_list); -+ if (entry) { -+ kdpc = container_of(entry, struct kdpc, list); -+ assert(kdpc->queued); -+ kdpc->queued = 0; -+ } else -+ kdpc = NULL; -+ spin_unlock_irqrestore(&kdpc_list_lock, flags); -+ if (!kdpc) -+ break; -+ WORKTRACE("%p, %p, %p, %p, %p", kdpc, kdpc->func, kdpc->ctx, -+ kdpc->arg1, kdpc->arg2); -+ assert_irql(_irql_ == DISPATCH_LEVEL); -+ LIN2WIN4(kdpc->func, kdpc, kdpc->ctx, kdpc->arg1, kdpc->arg2); -+ assert_irql(_irql_ == DISPATCH_LEVEL); -+ } -+ lower_irql(irql); -+ WORKEXIT(return); -+} -+ -+wstdcall void WIN_FUNC(KeFlushQueuedDpcs,0) -+ (void) -+{ -+ kdpc_worker(NULL); -+} -+ -+BOOLEAN queue_kdpc(struct kdpc *kdpc) -+{ -+ BOOLEAN ret; -+ unsigned long flags; -+ -+ WORKENTER("%p", kdpc); -+ spin_lock_irqsave(&kdpc_list_lock, flags); -+ if (kdpc->queued) -+ ret = FALSE; -+ else { -+ if (unlikely(kdpc->importance == HighImportance)) -+ InsertHeadList(&kdpc_list, &kdpc->list); -+ else -+ InsertTailList(&kdpc_list, &kdpc->list); -+ kdpc->queued = 1; -+ ret = TRUE; -+ } -+ spin_unlock_irqrestore(&kdpc_list_lock, flags); -+ if (ret == TRUE) -+ queue_work(ntos_wq, &kdpc_work); -+ WORKTRACE("%d", ret); -+ return ret; -+} -+ -+BOOLEAN dequeue_kdpc(struct kdpc *kdpc) -+{ -+ BOOLEAN ret; -+ unsigned long flags; -+ -+ WORKENTER("%p", kdpc); -+ spin_lock_irqsave(&kdpc_list_lock, flags); -+ if (kdpc->queued) { -+ RemoveEntryList(&kdpc->list); -+ kdpc->queued = 0; -+ ret = TRUE; -+ } else -+ ret = FALSE; -+ spin_unlock_irqrestore(&kdpc_list_lock, flags); -+ WORKTRACE("%d", ret); -+ return ret; -+} -+ -+wstdcall BOOLEAN WIN_FUNC(KeInsertQueueDpc,3) -+ (struct kdpc *kdpc, void *arg1, void *arg2) -+{ -+ WORKENTER("%p, %p, %p", kdpc, arg1, arg2); -+ kdpc->arg1 = arg1; -+ kdpc->arg2 = arg2; -+ return queue_kdpc(kdpc); -+} -+ -+wstdcall BOOLEAN WIN_FUNC(KeRemoveQueueDpc,1) -+ (struct kdpc *kdpc) -+{ -+ return dequeue_kdpc(kdpc); -+} -+ -+wstdcall void WIN_FUNC(KeSetImportanceDpc,2) -+ (struct kdpc *kdpc, enum kdpc_importance importance) -+{ -+ kdpc->importance = importance; -+} -+ -+static void ntos_work_worker(struct work_struct *dummy) -+{ -+ struct ntos_work_item *ntos_work_item; -+ struct nt_list *cur; -+ -+ while (1) { -+ spin_lock_bh(&ntos_work_lock); -+ cur = RemoveHeadList(&ntos_work_list); -+ spin_unlock_bh(&ntos_work_lock); -+ if (!cur) -+ break; -+ ntos_work_item = container_of(cur, struct ntos_work_item, list); -+ WORKTRACE("%p: executing %p, %p, %p", current, -+ ntos_work_item->func, ntos_work_item->arg1, -+ ntos_work_item->arg2); -+ LIN2WIN2(ntos_work_item->func, ntos_work_item->arg1, -+ ntos_work_item->arg2); -+ kfree(ntos_work_item); -+ } -+ WORKEXIT(return); -+} -+ -+int schedule_ntos_work_item(NTOS_WORK_FUNC func, void *arg1, void *arg2) -+{ -+ struct ntos_work_item *ntos_work_item; -+ -+ WORKENTER("adding work: %p, %p, %p", func, arg1, arg2); -+ ntos_work_item = kmalloc(sizeof(*ntos_work_item), irql_gfp()); -+ if (!ntos_work_item) { -+ ERROR("couldn't allocate memory"); -+ return -ENOMEM; -+ } -+ ntos_work_item->func = func; -+ ntos_work_item->arg1 = arg1; -+ ntos_work_item->arg2 = arg2; -+ spin_lock_bh(&ntos_work_lock); -+ InsertTailList(&ntos_work_list, &ntos_work_item->list); -+ spin_unlock_bh(&ntos_work_lock); -+ queue_work(ntos_wq, &ntos_work); -+ WORKEXIT(return 0); -+} -+ -+wstdcall void WIN_FUNC(KeInitializeSpinLock,1) -+ (NT_SPIN_LOCK *lock) -+{ -+ ENTER6("%p", lock); -+ nt_spin_lock_init(lock); -+} -+ -+wstdcall void WIN_FUNC(KeAcquireSpinLock,2) -+ (NT_SPIN_LOCK *lock, KIRQL *irql) -+{ -+ ENTER6("%p", lock); -+ *irql = nt_spin_lock_irql(lock, DISPATCH_LEVEL); -+} -+ -+wstdcall void WIN_FUNC(KeReleaseSpinLock,2) -+ (NT_SPIN_LOCK *lock, KIRQL oldirql) -+{ -+ ENTER6("%p", lock); -+ nt_spin_unlock_irql(lock, oldirql); -+} -+ -+wstdcall void WIN_FUNC(KeAcquireSpinLockAtDpcLevel,1) -+ (NT_SPIN_LOCK *lock) -+{ -+ ENTER6("%p", lock); -+ nt_spin_lock(lock); -+} -+ -+wstdcall void WIN_FUNC(KeReleaseSpinLockFromDpcLevel,1) -+ (NT_SPIN_LOCK *lock) -+{ -+ ENTER6("%p", lock); -+ nt_spin_unlock(lock); -+} -+ -+wstdcall void WIN_FUNC(KeRaiseIrql,2) -+ (KIRQL newirql, KIRQL *oldirql) -+{ -+ ENTER6("%d", newirql); -+ *oldirql = raise_irql(newirql); -+} -+ -+wstdcall KIRQL WIN_FUNC(KeRaiseIrqlToDpcLevel,0) -+ (void) -+{ -+ return raise_irql(DISPATCH_LEVEL); -+} -+ -+wstdcall void WIN_FUNC(KeLowerIrql,1) -+ (KIRQL irql) -+{ -+ ENTER6("%d", irql); -+ lower_irql(irql); -+} -+ -+wstdcall KIRQL WIN_FUNC(KeAcquireSpinLockRaiseToDpc,1) -+ (NT_SPIN_LOCK *lock) -+{ -+ ENTER6("%p", lock); -+ return nt_spin_lock_irql(lock, DISPATCH_LEVEL); -+} -+ -+wstdcall void *WIN_FUNC(ExAllocatePoolWithTag,3) -+ (enum pool_type pool_type, SIZE_T size, ULONG tag) -+{ -+ void *addr; -+ -+ ENTER4("pool_type: %d, size: %zu, tag: 0x%x", pool_type, size, tag); -+ assert_irql(_irql_ <= DISPATCH_LEVEL); -+ if (size < PAGE_SIZE) -+ addr = kmalloc(size, irql_gfp()); -+ else { -+ if (irql_gfp() & GFP_ATOMIC) { -+ addr = __vmalloc(size, GFP_ATOMIC | __GFP_HIGHMEM, -+ PAGE_KERNEL); -+ TRACE1("%p, %zu", addr, size); -+ } else { -+ addr = vmalloc(size); -+ TRACE1("%p, %zu", addr, size); -+ } -+ } -+ DBG_BLOCK(1) { -+ if (addr) -+ TRACE4("addr: %p, %zu", addr, size); -+ else -+ TRACE1("failed: %zu", size); -+ } -+ return addr; -+} -+WIN_FUNC_DECL(ExAllocatePoolWithTag,3) -+ -+wstdcall void WIN_FUNC(ExFreePoolWithTag,2) -+ (void *addr, ULONG tag) -+{ -+ TRACE4("%p", addr); -+ if ((unsigned long)addr < VMALLOC_START || -+ (unsigned long)addr >= VMALLOC_END) -+ kfree(addr); -+ else -+ vfree(addr); -+ -+ EXIT4(return); -+} -+ -+wstdcall void WIN_FUNC(ExFreePool,1) -+ (void *addr) -+{ -+ ExFreePoolWithTag(addr, 0); -+} -+WIN_FUNC_DECL(ExFreePool,1) -+ -+wstdcall void WIN_FUNC(ExInitializeNPagedLookasideList,7) -+ (struct npaged_lookaside_list *lookaside, -+ LOOKASIDE_ALLOC_FUNC *alloc_func, LOOKASIDE_FREE_FUNC *free_func, -+ ULONG flags, SIZE_T size, ULONG tag, USHORT depth) -+{ -+ ENTER3("lookaside: %p, size: %zu, flags: %u, head: %p, " -+ "alloc: %p, free: %p", lookaside, size, flags, -+ lookaside, alloc_func, free_func); -+ -+ memset(lookaside, 0, sizeof(*lookaside)); -+ -+ lookaside->size = size; -+ lookaside->tag = tag; -+ lookaside->depth = 4; -+ lookaside->maxdepth = 256; -+ lookaside->pool_type = NonPagedPool; -+ -+ if (alloc_func) -+ lookaside->alloc_func = alloc_func; -+ else -+ lookaside->alloc_func = WIN_FUNC_PTR(ExAllocatePoolWithTag,3); -+ if (free_func) -+ lookaside->free_func = free_func; -+ else -+ lookaside->free_func = WIN_FUNC_PTR(ExFreePool,1); -+ -+#ifndef CONFIG_X86_64 -+ nt_spin_lock_init(&lookaside->obsolete); -+#endif -+ EXIT3(return); -+} -+ -+wstdcall void WIN_FUNC(ExDeleteNPagedLookasideList,1) -+ (struct npaged_lookaside_list *lookaside) -+{ -+ struct nt_slist *entry; -+ -+ ENTER3("lookaside = %p", lookaside); -+ while ((entry = ExpInterlockedPopEntrySList(&lookaside->head))) -+ LIN2WIN1(lookaside->free_func, entry); -+ EXIT3(return); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ExCreateCallback,4) -+ (struct callback_object **object, struct object_attributes *attributes, -+ BOOLEAN create, BOOLEAN allow_multiple_callbacks) -+{ -+ struct callback_object *obj; -+ -+ ENTER2(""); -+ spin_lock_bh(&ntoskernel_lock); -+ nt_list_for_each_entry(obj, &callback_objects, callback_funcs) { -+ if (obj->attributes == attributes) { -+ spin_unlock_bh(&ntoskernel_lock); -+ *object = obj; -+ return STATUS_SUCCESS; -+ } -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ obj = allocate_object(sizeof(struct callback_object), -+ OBJECT_TYPE_CALLBACK, NULL); -+ if (!obj) -+ EXIT2(return STATUS_INSUFFICIENT_RESOURCES); -+ InitializeListHead(&obj->callback_funcs); -+ nt_spin_lock_init(&obj->lock); -+ obj->allow_multiple_callbacks = allow_multiple_callbacks; -+ obj->attributes = attributes; -+ *object = obj; -+ EXIT2(return STATUS_SUCCESS); -+} -+ -+wstdcall void *WIN_FUNC(ExRegisterCallback,3) -+ (struct callback_object *object, PCALLBACK_FUNCTION func, void *context) -+{ -+ struct callback_func *callback; -+ KIRQL irql; -+ -+ ENTER2(""); -+ irql = nt_spin_lock_irql(&object->lock, DISPATCH_LEVEL); -+ if (object->allow_multiple_callbacks == FALSE && -+ !IsListEmpty(&object->callback_funcs)) { -+ nt_spin_unlock_irql(&object->lock, irql); -+ EXIT2(return NULL); -+ } -+ nt_spin_unlock_irql(&object->lock, irql); -+ callback = kmalloc(sizeof(*callback), GFP_KERNEL); -+ if (!callback) { -+ ERROR("couldn't allocate memory"); -+ return NULL; -+ } -+ callback->func = func; -+ callback->context = context; -+ callback->object = object; -+ irql = nt_spin_lock_irql(&object->lock, DISPATCH_LEVEL); -+ InsertTailList(&object->callback_funcs, &callback->list); -+ nt_spin_unlock_irql(&object->lock, irql); -+ EXIT2(return callback); -+} -+ -+wstdcall void WIN_FUNC(ExUnregisterCallback,1) -+ (struct callback_func *callback) -+{ -+ struct callback_object *object; -+ KIRQL irql; -+ -+ ENTER3("%p", callback); -+ if (!callback) -+ return; -+ object = callback->object; -+ irql = nt_spin_lock_irql(&object->lock, DISPATCH_LEVEL); -+ RemoveEntryList(&callback->list); -+ nt_spin_unlock_irql(&object->lock, irql); -+ kfree(callback); -+ return; -+} -+ -+wstdcall void WIN_FUNC(ExNotifyCallback,3) -+ (struct callback_object *object, void *arg1, void *arg2) -+{ -+ struct callback_func *callback; -+ KIRQL irql; -+ -+ ENTER3("%p", object); -+ irql = nt_spin_lock_irql(&object->lock, DISPATCH_LEVEL); -+ nt_list_for_each_entry(callback, &object->callback_funcs, list) { -+ LIN2WIN3(callback->func, callback->context, arg1, arg2); -+ } -+ nt_spin_unlock_irql(&object->lock, irql); -+ return; -+} -+ -+/* check and set signaled state; should be called with dispatcher_lock held */ -+/* @grab indicates if the event should be grabbed or checked -+ * - note that a semaphore may stay in signaled state for multiple -+ * 'grabs' if the count is > 1 */ -+static int grab_object(struct dispatcher_header *dh, -+ struct task_struct *thread, int grab) -+{ -+ EVENTTRACE("%p, %p, %d, %d", dh, thread, grab, dh->signal_state); -+ if (unlikely(is_mutex_object(dh))) { -+ struct nt_mutex *nt_mutex; -+ nt_mutex = container_of(dh, struct nt_mutex, dh); -+ EVENTTRACE("%p, %p, %d, %p, %d", nt_mutex, -+ nt_mutex->owner_thread, dh->signal_state, -+ thread, grab); -+ /* either no thread owns the mutex or this thread owns -+ * it */ -+ assert(dh->signal_state == 1 && nt_mutex->owner_thread == NULL); -+ assert(dh->signal_state < 1 && nt_mutex->owner_thread != NULL); -+ if ((dh->signal_state == 1 && nt_mutex->owner_thread == NULL) || -+ nt_mutex->owner_thread == thread) { -+ if (grab) { -+ dh->signal_state--; -+ nt_mutex->owner_thread = thread; -+ } -+ EVENTEXIT(return 1); -+ } -+ } else if (dh->signal_state > 0) { -+ /* to grab, decrement signal_state for synchronization -+ * or semaphore objects */ -+ if (grab && (is_synch_object(dh) || is_semaphore_object(dh))) -+ dh->signal_state--; -+ EVENTEXIT(return 1); -+ } -+ EVENTEXIT(return 0); -+} -+ -+/* this function should be called holding dispatcher_lock */ -+static void object_signaled(struct dispatcher_header *dh) -+{ -+ struct nt_list *cur, *next; -+ struct wait_block *wb; -+ -+ EVENTENTER("%p", dh); -+ nt_list_for_each_safe(cur, next, &dh->wait_blocks) { -+ wb = container_of(cur, struct wait_block, list); -+ assert(wb->thread != NULL); -+ assert(wb->object == NULL); -+ if (!grab_object(dh, wb->thread, 1)) -+ continue; -+ EVENTTRACE("%p (%p): waking %p", dh, wb, wb->thread); -+ RemoveEntryList(cur); -+ wb->object = dh; -+ *(wb->wait_done) = 1; -+ wake_up_process(wb->thread); -+ } -+ EVENTEXIT(return); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(KeWaitForMultipleObjects,8) -+ (ULONG count, void *object[], enum wait_type wait_type, -+ KWAIT_REASON wait_reason, KPROCESSOR_MODE wait_mode, -+ BOOLEAN alertable, LARGE_INTEGER *timeout, -+ struct wait_block *wait_block_array) -+{ -+ int i, res = 0, wait_count, wait_done; -+ typeof(jiffies) wait_hz = 0; -+ struct wait_block *wb, wb_array[THREAD_WAIT_OBJECTS]; -+ struct dispatcher_header *dh; -+ KIRQL irql = current_irql(); -+ -+ EVENTENTER("%p, %d, %u, %p", current, count, wait_type, timeout); -+ -+ if (count > MAX_WAIT_OBJECTS || -+ (count > THREAD_WAIT_OBJECTS && wait_block_array == NULL)) -+ EVENTEXIT(return STATUS_INVALID_PARAMETER); -+ -+ if (wait_block_array == NULL) -+ wb = wb_array; -+ else -+ wb = wait_block_array; -+ -+ /* If *timeout == 0: In the case of WaitAny, if an object can -+ * be grabbed (object is in signaled state), grab and -+ * return. In the case of WaitAll, we have to first make sure -+ * all objects can be grabbed. If any/some of them can't be -+ * grabbed, either we return STATUS_TIMEOUT or wait for them, -+ * depending on how to satisfy wait. If all of them can be -+ * grabbed, we will grab them in the next loop below */ -+ -+ spin_lock_bh(&dispatcher_lock); -+ for (i = wait_count = 0; i < count; i++) { -+ dh = object[i]; -+ EVENTTRACE("%p: event %p (%d)", current, dh, dh->signal_state); -+ /* wait_type == 1 for WaitAny, 0 for WaitAll */ -+ if (grab_object(dh, current, wait_type)) { -+ if (wait_type == WaitAny) { -+ spin_unlock_bh(&dispatcher_lock); -+ EVENTEXIT(return STATUS_WAIT_0 + i); -+ } -+ } else { -+ EVENTTRACE("%p: wait for %p", current, dh); -+ wait_count++; -+ } -+ } -+ -+ if (timeout && *timeout == 0 && wait_count) { -+ spin_unlock_bh(&dispatcher_lock); -+ EVENTEXIT(return STATUS_TIMEOUT); -+ } -+ -+ /* get the list of objects the thread needs to wait on and add -+ * the thread on the wait list for each such object */ -+ /* if *timeout == 0, this step will grab all the objects */ -+ wait_done = 0; -+ for (i = 0; i < count; i++) { -+ dh = object[i]; -+ EVENTTRACE("%p: event %p (%d)", current, dh, dh->signal_state); -+ wb[i].object = NULL; -+ if (grab_object(dh, current, 1)) { -+ EVENTTRACE("%p: no wait for %p (%d)", -+ current, dh, dh->signal_state); -+ /* mark that we are not waiting on this object */ -+ wb[i].thread = NULL; -+ } else { -+ wb[i].wait_done = &wait_done; -+ wb[i].thread = current; -+ EVENTTRACE("%p: wait for %p", current, dh); -+ InsertTailList(&dh->wait_blocks, &wb[i].list); -+ } -+ } -+ spin_unlock_bh(&dispatcher_lock); -+ if (wait_count == 0) -+ EVENTEXIT(return STATUS_SUCCESS); -+ -+ assert(timeout == NULL || *timeout != 0); -+ if (timeout == NULL) -+ wait_hz = 0; -+ else -+ wait_hz = SYSTEM_TIME_TO_HZ(*timeout); -+ -+ if (irql >= DISPATCH_LEVEL) { -+ WARNING("attempt to wait with irql %d", irql); -+ EVENTEXIT(return STATUS_INVALID_PARAMETER); -+ } -+ EVENTTRACE("%p: sleep for %ld on %p", current, wait_hz, &wait_done); -+ /* we don't honor 'alertable' - according to description for -+ * this, even if waiting in non-alertable state, thread may be -+ * alerted in some circumstances */ -+ while (wait_count) { -+ res = wait_condition(wait_done, wait_hz, TASK_INTERRUPTIBLE); -+ spin_lock_bh(&dispatcher_lock); -+ EVENTTRACE("%p woke up: %d, %d", current, res, wait_done); -+ /* the event may have been set by the time -+ * wrap_wait_event returned and spinlock obtained, so -+ * don't rely on value of 'res' - check event status */ -+ if (!wait_done) { -+ assert(res <= 0); -+ /* timed out or interrupted; remove from wait list */ -+ for (i = 0; i < count; i++) { -+ if (!wb[i].thread) -+ continue; -+ EVENTTRACE("%p: timedout, dequeue %p (%p)", -+ current, object[i], wb[i].object); -+ assert(wb[i].object == NULL); -+ RemoveEntryList(&wb[i].list); -+ } -+ spin_unlock_bh(&dispatcher_lock); -+ if (res < 0) -+ EVENTEXIT(return STATUS_ALERTED); -+ else -+ EVENTEXIT(return STATUS_TIMEOUT); -+ } -+ assert(res > 0); -+ /* woken because object(s) signaled */ -+ for (i = 0; wait_count && i < count; i++) { -+ if (!wb[i].thread || !wb[i].object) -+ continue; -+ DBG_BLOCK(1) { -+ if (wb[i].object != object[i]) { -+ EVENTTRACE("oops %p != %p", -+ wb[i].object, object[i]); -+ continue; -+ } -+ } -+ wait_count--; -+ if (wait_type == WaitAny) { -+ int j; -+ /* done; remove from rest of wait list */ -+ for (j = i + 1; j < count; j++) { -+ if (wb[j].thread && !wb[j].object) -+ RemoveEntryList(&wb[j].list); -+ } -+ spin_unlock_bh(&dispatcher_lock); -+ EVENTEXIT(return STATUS_WAIT_0 + i); -+ } -+ } -+ wait_done = 0; -+ spin_unlock_bh(&dispatcher_lock); -+ if (wait_count == 0) -+ EVENTEXIT(return STATUS_SUCCESS); -+ -+ /* this thread is still waiting for more objects, so -+ * let it wait for remaining time and those objects */ -+ if (timeout) -+ wait_hz = res; -+ else -+ wait_hz = 0; -+ } -+ /* should never reach here, but compiler wants return value */ -+ ERROR("%p: wait_hz: %ld", current, wait_hz); -+ EVENTEXIT(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(KeWaitForSingleObject,5) -+ (void *object, KWAIT_REASON wait_reason, KPROCESSOR_MODE wait_mode, -+ BOOLEAN alertable, LARGE_INTEGER *timeout) -+{ -+ return KeWaitForMultipleObjects(1, &object, WaitAny, wait_reason, -+ wait_mode, alertable, timeout, NULL); -+} -+ -+wstdcall void WIN_FUNC(KeInitializeEvent,3) -+ (struct nt_event *nt_event, enum event_type type, BOOLEAN state) -+{ -+ EVENTENTER("event = %p, type = %d, state = %d", nt_event, type, state); -+ initialize_object(&nt_event->dh, (enum dh_type)type, state); -+ EVENTEXIT(return); -+} -+ -+wstdcall LONG WIN_FUNC(KeSetEvent,3) -+ (struct nt_event *nt_event, KPRIORITY incr, BOOLEAN wait) -+{ -+ LONG old_state; -+ -+ EVENTENTER("%p, %d", nt_event, nt_event->dh.type); -+ if (wait == TRUE) -+ WARNING("wait = %d, not yet implemented", wait); -+ spin_lock_bh(&dispatcher_lock); -+ old_state = nt_event->dh.signal_state; -+ nt_event->dh.signal_state = 1; -+ if (old_state == 0) -+ object_signaled(&nt_event->dh); -+ spin_unlock_bh(&dispatcher_lock); -+ EVENTEXIT(return old_state); -+} -+ -+wstdcall void WIN_FUNC(KeClearEvent,1) -+ (struct nt_event *nt_event) -+{ -+ EVENTENTER("%p", nt_event); -+ nt_event->dh.signal_state = 0; -+ EVENTEXIT(return); -+} -+ -+wstdcall LONG WIN_FUNC(KeResetEvent,1) -+ (struct nt_event *nt_event) -+{ -+ LONG old_state; -+ -+ EVENTENTER("%p", nt_event); -+ old_state = xchg(&nt_event->dh.signal_state, 0); -+ EVENTEXIT(return old_state); -+} -+ -+wstdcall LONG WIN_FUNC(KeReadStateEvent,1) -+ (struct nt_event *nt_event) -+{ -+ LONG state; -+ -+ state = nt_event->dh.signal_state; -+ EVENTTRACE("%d", state); -+ return state; -+} -+ -+wstdcall void WIN_FUNC(KeInitializeMutex,2) -+ (struct nt_mutex *mutex, ULONG level) -+{ -+ EVENTENTER("%p", mutex); -+ initialize_object(&mutex->dh, MutexObject, 1); -+ mutex->dh.size = sizeof(*mutex); -+ InitializeListHead(&mutex->list); -+ mutex->abandoned = FALSE; -+ mutex->apc_disable = 1; -+ mutex->owner_thread = NULL; -+ EVENTEXIT(return); -+} -+ -+wstdcall LONG WIN_FUNC(KeReleaseMutex,2) -+ (struct nt_mutex *mutex, BOOLEAN wait) -+{ -+ LONG ret; -+ struct task_struct *thread; -+ -+ EVENTENTER("%p, %d, %p", mutex, wait, current); -+ if (wait == TRUE) -+ WARNING("wait: %d", wait); -+ thread = current; -+ spin_lock_bh(&dispatcher_lock); -+ EVENTTRACE("%p, %p, %p, %d", mutex, thread, mutex->owner_thread, -+ mutex->dh.signal_state); -+ if ((mutex->owner_thread == thread) && (mutex->dh.signal_state <= 0)) { -+ ret = mutex->dh.signal_state++; -+ if (ret == 0) { -+ mutex->owner_thread = NULL; -+ object_signaled(&mutex->dh); -+ } -+ } else { -+ ret = STATUS_MUTANT_NOT_OWNED; -+ WARNING("invalid mutex: %p, %p, %p", mutex, mutex->owner_thread, -+ thread); -+ } -+ EVENTTRACE("%p, %p, %p, %d", mutex, thread, mutex->owner_thread, -+ mutex->dh.signal_state); -+ spin_unlock_bh(&dispatcher_lock); -+ EVENTEXIT(return ret); -+} -+ -+wstdcall void WIN_FUNC(KeInitializeSemaphore,3) -+ (struct nt_semaphore *semaphore, LONG count, LONG limit) -+{ -+ EVENTENTER("%p: %d", semaphore, count); -+ /* if limit > 1, we need to satisfy as many waits (until count -+ * becomes 0); so we keep decrementing count every time a wait -+ * is satisfied */ -+ initialize_object(&semaphore->dh, SemaphoreObject, count); -+ semaphore->dh.size = sizeof(*semaphore); -+ semaphore->limit = limit; -+ EVENTEXIT(return); -+} -+ -+wstdcall LONG WIN_FUNC(KeReleaseSemaphore,4) -+ (struct nt_semaphore *semaphore, KPRIORITY incr, LONG adjustment, -+ BOOLEAN wait) -+{ -+ LONG ret; -+ -+ EVENTENTER("%p", semaphore); -+ spin_lock_bh(&dispatcher_lock); -+ ret = semaphore->dh.signal_state; -+ assert(ret >= 0); -+ if (semaphore->dh.signal_state + adjustment <= semaphore->limit) -+ semaphore->dh.signal_state += adjustment; -+ else { -+ WARNING("releasing %d over limit %d", adjustment, -+ semaphore->limit); -+ semaphore->dh.signal_state = semaphore->limit; -+ } -+ if (semaphore->dh.signal_state > 0) -+ object_signaled(&semaphore->dh); -+ spin_unlock_bh(&dispatcher_lock); -+ EVENTEXIT(return ret); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(KeDelayExecutionThread,3) -+ (KPROCESSOR_MODE wait_mode, BOOLEAN alertable, LARGE_INTEGER *interval) -+{ -+ int res; -+ long timeout; -+ -+ if (wait_mode != 0) -+ ERROR("invalid wait_mode %d", wait_mode); -+ -+ timeout = SYSTEM_TIME_TO_HZ(*interval); -+ EVENTTRACE("%p, %lld, %ld", current, *interval, timeout); -+ if (timeout <= 0) -+ EVENTEXIT(return STATUS_SUCCESS); -+ -+ if (alertable) -+ set_current_state(TASK_INTERRUPTIBLE); -+ else -+ set_current_state(TASK_UNINTERRUPTIBLE); -+ -+ res = schedule_timeout(timeout); -+ EVENTTRACE("%p, %d", current, res); -+ if (res == 0) -+ EVENTEXIT(return STATUS_SUCCESS); -+ else -+ EVENTEXIT(return STATUS_ALERTED); -+} -+ -+wstdcall ULONGLONG WIN_FUNC(KeQueryInterruptTime,0) -+ (void) -+{ -+ EXIT5(return jiffies * TICKSPERJIFFY); -+} -+ -+wstdcall ULONG WIN_FUNC(KeQueryTimeIncrement,0) -+ (void) -+{ -+ EXIT5(return TICKSPERSEC / HZ); -+} -+ -+wstdcall void WIN_FUNC(KeQuerySystemTime,1) -+ (LARGE_INTEGER *time) -+{ -+ *time = ticks_1601(); -+ TRACE5("%llu, %lu", *time, jiffies); -+} -+ -+wstdcall void WIN_FUNC(KeQueryTickCount,1) -+ (LARGE_INTEGER *count) -+{ -+ *count = jiffies; -+} -+ -+wstdcall LARGE_INTEGER WIN_FUNC(KeQueryPerformanceCounter,1) -+ (LARGE_INTEGER *counter) -+{ -+ if (counter) -+ *counter = HZ; -+ return jiffies; -+} -+ -+wstdcall KAFFINITY WIN_FUNC(KeQueryActiveProcessors,0) -+ (void) -+{ -+ int i, n; -+ KAFFINITY bits = 0; -+ n = num_online_cpus(); -+ for (i = 0; i < n; i++) -+ bits = (bits << 1) | 1; -+ return bits; -+} -+ -+struct nt_thread *get_current_nt_thread(void) -+{ -+ struct task_struct *task = current; -+ struct nt_thread *thread; -+ struct common_object_header *header; -+ -+ TRACE6("task: %p", task); -+ thread = NULL; -+ spin_lock_bh(&ntoskernel_lock); -+ nt_list_for_each_entry(header, &object_list, list) { -+ TRACE6("%p, %d", header, header->type); -+ if (header->type != OBJECT_TYPE_NT_THREAD) -+ break; -+ thread = HEADER_TO_OBJECT(header); -+ TRACE6("%p, %p", thread, thread->task); -+ if (thread->task == task) -+ break; -+ else -+ thread = NULL; -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ if (thread == NULL) -+ TRACE4("couldn't find thread for task %p, %d", task, task->pid); -+ TRACE6("%p", thread); -+ return thread; -+} -+ -+static struct task_struct *get_nt_thread_task(struct nt_thread *thread) -+{ -+ struct task_struct *task; -+ struct common_object_header *header; -+ -+ TRACE6("%p", thread); -+ task = NULL; -+ spin_lock_bh(&ntoskernel_lock); -+ nt_list_for_each_entry(header, &object_list, list) { -+ TRACE6("%p, %d", header, header->type); -+ if (header->type != OBJECT_TYPE_NT_THREAD) -+ break; -+ if (thread == HEADER_TO_OBJECT(header)) { -+ task = thread->task; -+ break; -+ } -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ if (task == NULL) -+ TRACE2("%p: couldn't find task for %p", current, thread); -+ return task; -+} -+ -+static struct nt_thread *create_nt_thread(struct task_struct *task) -+{ -+ struct nt_thread *thread; -+ thread = allocate_object(sizeof(*thread), OBJECT_TYPE_NT_THREAD, NULL); -+ if (!thread) { -+ ERROR("couldn't allocate thread object"); -+ EXIT2(return NULL); -+ } -+ thread->task = task; -+ if (task) -+ thread->pid = task->pid; -+ else -+ thread->pid = 0; -+ nt_spin_lock_init(&thread->lock); -+ InitializeListHead(&thread->irps); -+ initialize_object(&thread->dh, ThreadObject, 0); -+ thread->dh.size = sizeof(*thread); -+ thread->prio = LOW_PRIORITY; -+ return thread; -+} -+ -+wstdcall struct nt_thread *WIN_FUNC(KeGetCurrentThread,0) -+ (void) -+{ -+ struct nt_thread *thread = get_current_nt_thread(); -+ TRACE2("%p, %p", thread, current); -+ return thread; -+} -+ -+wstdcall KPRIORITY WIN_FUNC(KeQueryPriorityThread,1) -+ (struct nt_thread *thread) -+{ -+ KPRIORITY prio; -+ struct task_struct *task; -+ -+ TRACE2("%p", thread); -+#ifdef CONFIG_X86_64 -+ /* sis163u driver for amd64 passes 0x1f from thread created by -+ * PsCreateSystemThread - no idea what is 0x1f */ -+ if (thread == (void *)0x1f) -+ thread = get_current_nt_thread(); -+#endif -+ if (!thread) { -+ TRACE2("invalid thread"); -+ EXIT2(return LOW_REALTIME_PRIORITY); -+ } -+ task = get_nt_thread_task(thread); -+ if (!task) { -+ TRACE2("couldn't find task for thread: %p", thread); -+ EXIT2(return LOW_REALTIME_PRIORITY); -+ } -+ -+ prio = thread->prio; -+ -+ TRACE2("%d", prio); -+ return prio; -+} -+ -+wstdcall KPRIORITY WIN_FUNC(KeSetPriorityThread,2) -+ (struct nt_thread *thread, KPRIORITY prio) -+{ -+ KPRIORITY old_prio; -+ struct task_struct *task; -+ -+ TRACE2("thread: %p, priority = %u", thread, prio); -+#ifdef CONFIG_X86_64 -+ if (thread == (void *)0x1f) -+ thread = get_current_nt_thread(); -+#endif -+ if (!thread) { -+ TRACE2("invalid thread"); -+ EXIT2(return LOW_REALTIME_PRIORITY); -+ } -+ task = get_nt_thread_task(thread); -+ if (!task) { -+ TRACE2("couldn't find task for thread: %p", thread); -+ EXIT2(return LOW_REALTIME_PRIORITY); -+ } -+ -+ old_prio = thread->prio; -+ thread->prio = prio; -+ -+ TRACE2("%d, %d", old_prio, thread->prio); -+ return old_prio; -+} -+ -+struct thread_trampoline { -+ void (*func)(void *) wstdcall; -+ void *ctx; -+ struct nt_thread *thread; -+ struct completion started; -+}; -+ -+static int ntdriver_thread(void *data) -+{ -+ struct thread_trampoline *thread_tramp = data; -+ /* yes, a tramp! */ -+ typeof(thread_tramp->func) func = thread_tramp->func; -+ typeof(thread_tramp->ctx) ctx = thread_tramp->ctx; -+ -+ thread_tramp->thread->task = current; -+ thread_tramp->thread->pid = current->pid; -+ TRACE2("thread: %p, task: %p (%d)", thread_tramp->thread, -+ current, current->pid); -+ complete(&thread_tramp->started); -+ -+#ifdef PF_NOFREEZE -+ current->flags |= PF_NOFREEZE; -+#endif -+ strncpy(current->comm, "ntdriver", sizeof(current->comm)); -+ current->comm[sizeof(current->comm)-1] = 0; -+ LIN2WIN1(func, ctx); -+ ERROR("task: %p", current); -+ return 0; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(PsCreateSystemThread,7) -+ (void **handle, ULONG access, void *obj_attr, void *process, -+ void *client_id, void (*func)(void *) wstdcall, void *ctx) -+{ -+ struct thread_trampoline thread_tramp; -+ -+ ENTER2("handle = %p, access = %u, obj_attr = %p, process = %p, " -+ "client_id = %p, func = %p, context = %p", handle, access, -+ obj_attr, process, client_id, func, ctx); -+ -+ thread_tramp.thread = create_nt_thread(NULL); -+ if (!thread_tramp.thread) { -+ ERROR("couldn't allocate thread object"); -+ EXIT2(return STATUS_RESOURCES); -+ } -+ TRACE2("thread: %p", thread_tramp.thread); -+ thread_tramp.func = func; -+ thread_tramp.ctx = ctx; -+ init_completion(&thread_tramp.started); -+ -+ thread_tramp.thread->task = kthread_run(ntdriver_thread, -+ &thread_tramp, "ntdriver"); -+ if (IS_ERR(thread_tramp.thread->task)) { -+ free_object(thread_tramp.thread); -+ EXIT2(return STATUS_FAILURE); -+ } -+ TRACE2("created task: %p", thread_tramp.thread->task); -+ -+ wait_for_completion(&thread_tramp.started); -+ *handle = OBJECT_TO_HEADER(thread_tramp.thread); -+ TRACE2("created thread: %p, %p", thread_tramp.thread, *handle); -+ EXIT2(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(PsTerminateSystemThread,1) -+ (NTSTATUS status) -+{ -+ struct nt_thread *thread; -+ -+ TRACE2("%p, %08X", current, status); -+ thread = get_current_nt_thread(); -+ TRACE2("%p", thread); -+ if (thread) { -+ KeSetEvent((struct nt_event *)&thread->dh, 0, FALSE); -+ while (1) { -+ struct nt_list *ent; -+ struct irp *irp; -+ KIRQL irql; -+ irql = nt_spin_lock_irql(&thread->lock, DISPATCH_LEVEL); -+ ent = RemoveHeadList(&thread->irps); -+ nt_spin_unlock_irql(&thread->lock, irql); -+ if (!ent) -+ break; -+ irp = container_of(ent, struct irp, thread_list); -+ IOTRACE("%p", irp); -+ IoCancelIrp(irp); -+ } -+ /* the driver may later query this status with -+ * ZwQueryInformationThread */ -+ thread->status = status; -+ } else -+ ERROR("couldn't find thread for task: %p", current); -+ -+ complete_and_exit(NULL, status); -+ ERROR("oops: %p, %d", thread->task, thread->pid); -+ return STATUS_FAILURE; -+} -+ -+wstdcall BOOLEAN WIN_FUNC(KeRemoveEntryDeviceQueue,2) -+ (struct kdevice_queue *dev_queue, struct kdevice_queue_entry *entry) -+{ -+ struct kdevice_queue_entry *e; -+ KIRQL irql; -+ -+ irql = nt_spin_lock_irql(&dev_queue->lock, DISPATCH_LEVEL); -+ nt_list_for_each_entry(e, &dev_queue->list, list) { -+ if (e == entry) { -+ RemoveEntryList(&e->list); -+ nt_spin_unlock_irql(&dev_queue->lock, irql); -+ return TRUE; -+ } -+ } -+ nt_spin_unlock_irql(&dev_queue->lock, irql); -+ return FALSE; -+} -+ -+wstdcall BOOLEAN WIN_FUNC(KeSynchronizeExecution,3) -+ (struct kinterrupt *interrupt, PKSYNCHRONIZE_ROUTINE synch_routine, -+ void *ctx) -+{ -+ BOOLEAN ret; -+ unsigned long flags; -+ -+ nt_spin_lock_irqsave(interrupt->actual_lock, flags); -+ ret = LIN2WIN1(synch_routine, ctx); -+ nt_spin_unlock_irqrestore(interrupt->actual_lock, flags); -+ TRACE6("%d", ret); -+ return ret; -+} -+ -+wstdcall BOOLEAN WIN_FUNC(KeRegisterBugCheckReasonCallback,4) -+ (void *callback_record, void *callback_routine, UINT reason, -+ char *component) -+{ -+ TRACE1("callback_record: %p, callback_routine: %p, reason: %d, " -+ "component: %s", callback_record, callback_routine, reason, -+ component); -+ TODO(); -+ return FALSE; -+} -+ -+wstdcall BOOLEAN WIN_FUNC(KeDeregisterBugCheckReasonCallback,1) -+ (void *callback_record) -+{ -+ TRACE1("callback_record: %p", callback_record); -+ TODO(); -+ return TRUE; -+} -+ -+wstdcall void *WIN_FUNC(MmAllocateContiguousMemorySpecifyCache,5) -+ (SIZE_T size, PHYSICAL_ADDRESS lowest, PHYSICAL_ADDRESS highest, -+ PHYSICAL_ADDRESS boundary, enum memory_caching_type cache_type) -+{ -+ void *addr; -+ gfp_t flags; -+ -+ ENTER2("%zu, 0x%llx, 0x%llx, 0x%llx, %d", size, lowest, -+ highest, boundary, cache_type); -+ flags = irql_gfp(); -+ addr = wrap_get_free_pages(flags, size); -+ TRACE2("%p, %zu, 0x%x", addr, size, flags); -+ if (addr && ((virt_to_phys(addr) + size) <= highest)) -+ EXIT2(return addr); -+#ifdef CONFIG_X86_64 -+ /* GFP_DMA is really only 16MB even on x86-64, but there is no -+ * other zone available */ -+ if (highest <= DMA_BIT_MASK(31)) -+ flags |= __GFP_DMA; -+ else if (highest <= DMA_BIT_MASK(32)) -+ flags |= __GFP_DMA32; -+#else -+ if (highest <= DMA_BIT_MASK(24)) -+ flags |= __GFP_DMA; -+ else if (highest > DMA_BIT_MASK(30)) -+ flags |= __GFP_HIGHMEM; -+#endif -+ if (addr) -+ free_pages((unsigned long)addr, get_order(size)); -+ addr = wrap_get_free_pages(flags, size); -+ TRACE2("%p, %zu, 0x%x", addr, size, flags); -+ return addr; -+} -+ -+wstdcall void WIN_FUNC(MmFreeContiguousMemorySpecifyCache,3) -+ (void *base, SIZE_T size, enum memory_caching_type cache_type) -+{ -+ TRACE2("%p, %zu", base, size); -+ free_pages((unsigned long)base, get_order(size)); -+} -+ -+wstdcall PHYSICAL_ADDRESS WIN_FUNC(MmGetPhysicalAddress,1) -+ (void *base) -+{ -+ unsigned long phy = virt_to_phys(base); -+ TRACE2("%p, %p", base, (void *)phy); -+ return phy; -+} -+ -+/* Atheros card with pciid 168C:0014 calls this function with 0xf0000 -+ * and 0xf6ef0 address, and then check for things that seem to be -+ * related to ACPI: "_SM_" and "_DMI_". This may be the hack they do -+ * to check if this card is installed in IBM thinkpads; we can -+ * probably get this device to work if we create a buffer with the -+ * strings as required by the driver and return virtual address for -+ * that address instead */ -+wstdcall void __iomem *WIN_FUNC(MmMapIoSpace,3) -+ (PHYSICAL_ADDRESS phys_addr, SIZE_T size, -+ enum memory_caching_type cache) -+{ -+ void __iomem *virt; -+ ENTER1("cache type: %d", cache); -+ if (cache == MmCached) -+ virt = ioremap(phys_addr, size); -+ else -+ virt = ioremap_nocache(phys_addr, size); -+ TRACE1("%llx, %zu, %p", phys_addr, size, virt); -+ return virt; -+} -+ -+wstdcall void WIN_FUNC(MmUnmapIoSpace,2) -+ (void __iomem *addr, SIZE_T size) -+{ -+ ENTER1("%p, %zu", addr, size); -+ iounmap(addr); -+ return; -+} -+ -+wstdcall ULONG WIN_FUNC(MmSizeOfMdl,2) -+ (void *base, ULONG length) -+{ -+ return sizeof(struct mdl) + -+ (sizeof(PFN_NUMBER) * SPAN_PAGES(base, length)); -+} -+ -+struct mdl *allocate_init_mdl(void *virt, ULONG length) -+{ -+ struct wrap_mdl *wrap_mdl; -+ struct mdl *mdl; -+ int mdl_size = MmSizeOfMdl(virt, length); -+ -+ if (mdl_size <= MDL_CACHE_SIZE) { -+ wrap_mdl = kmem_cache_alloc(mdl_cache, irql_gfp()); -+ if (!wrap_mdl) -+ return NULL; -+ spin_lock_bh(&dispatcher_lock); -+ InsertHeadList(&wrap_mdl_list, &wrap_mdl->list); -+ spin_unlock_bh(&dispatcher_lock); -+ mdl = wrap_mdl->mdl; -+ TRACE3("allocated mdl from cache: %p(%p), %p(%d)", -+ wrap_mdl, mdl, virt, length); -+ memset(mdl, 0, MDL_CACHE_SIZE); -+ MmInitializeMdl(mdl, virt, length); -+ /* mark the MDL as allocated from cache pool so when -+ * it is freed, we free it back to the pool */ -+ mdl->flags = MDL_ALLOCATED_FIXED_SIZE | MDL_CACHE_ALLOCATED; -+ } else { -+ wrap_mdl = -+ kmalloc(sizeof(*wrap_mdl) + mdl_size, irql_gfp()); -+ if (!wrap_mdl) -+ return NULL; -+ mdl = wrap_mdl->mdl; -+ TRACE3("allocated mdl from memory: %p(%p), %p(%d)", -+ wrap_mdl, mdl, virt, length); -+ spin_lock_bh(&dispatcher_lock); -+ InsertHeadList(&wrap_mdl_list, &wrap_mdl->list); -+ spin_unlock_bh(&dispatcher_lock); -+ memset(mdl, 0, mdl_size); -+ MmInitializeMdl(mdl, virt, length); -+ mdl->flags = MDL_ALLOCATED_FIXED_SIZE; -+ } -+ return mdl; -+} -+ -+void free_mdl(struct mdl *mdl) -+{ -+ /* A driver may allocate Mdl with NdisAllocateBuffer and free -+ * with IoFreeMdl (e.g., 64-bit Broadcom). Since we need to -+ * treat buffers allocated with Ndis calls differently, we -+ * must call NdisFreeBuffer if it is allocated with Ndis -+ * function. We set 'pool' field in Ndis functions. */ -+ if (!mdl) -+ return; -+ if (mdl->pool) -+ NdisFreeBuffer(mdl); -+ else { -+ struct wrap_mdl *wrap_mdl = (struct wrap_mdl *) -+ ((char *)mdl - offsetof(struct wrap_mdl, mdl)); -+ spin_lock_bh(&dispatcher_lock); -+ RemoveEntryList(&wrap_mdl->list); -+ spin_unlock_bh(&dispatcher_lock); -+ -+ if (mdl->flags & MDL_CACHE_ALLOCATED) { -+ TRACE3("freeing mdl cache: %p, %p, %p", -+ wrap_mdl, mdl, mdl->mappedsystemva); -+ kmem_cache_free(mdl_cache, wrap_mdl); -+ } else { -+ TRACE3("freeing mdl: %p, %p, %p", -+ wrap_mdl, mdl, mdl->mappedsystemva); -+ kfree(wrap_mdl); -+ } -+ } -+ return; -+} -+ -+wstdcall void WIN_FUNC(IoBuildPartialMdl,4) -+ (struct mdl *source, struct mdl *target, void *virt, ULONG length) -+{ -+ MmInitializeMdl(target, virt, length); -+ target->flags |= MDL_PARTIAL; -+} -+ -+wstdcall void WIN_FUNC(MmBuildMdlForNonPagedPool,1) -+ (struct mdl *mdl) -+{ -+ PFN_NUMBER *mdl_pages; -+ int i, n; -+ -+ ENTER4("%p", mdl); -+ /* already mapped */ -+// mdl->mappedsystemva = MmGetMdlVirtualAddress(mdl); -+ mdl->flags |= MDL_SOURCE_IS_NONPAGED_POOL; -+ TRACE4("%p, %p, %p, %d, %d", mdl, mdl->mappedsystemva, mdl->startva, -+ mdl->byteoffset, mdl->bytecount); -+ n = SPAN_PAGES(MmGetSystemAddressForMdl(mdl), MmGetMdlByteCount(mdl)); -+ if (n > MDL_CACHE_PAGES) -+ WARNING("%p, %d, %d", MmGetSystemAddressForMdl(mdl), -+ MmGetMdlByteCount(mdl), n); -+ mdl_pages = MmGetMdlPfnArray(mdl); -+ for (i = 0; i < n; i++) -+ mdl_pages[i] = (ULONG_PTR)mdl->startva + (i * PAGE_SIZE); -+ EXIT4(return); -+} -+ -+wstdcall void *WIN_FUNC(MmMapLockedPages,2) -+ (struct mdl *mdl, KPROCESSOR_MODE access_mode) -+{ -+ /* already mapped */ -+// mdl->mappedsystemva = MmGetMdlVirtualAddress(mdl); -+ mdl->flags |= MDL_MAPPED_TO_SYSTEM_VA; -+ /* what is the need for MDL_PARTIAL_HAS_BEEN_MAPPED? */ -+ if (mdl->flags & MDL_PARTIAL) -+ mdl->flags |= MDL_PARTIAL_HAS_BEEN_MAPPED; -+ return mdl->mappedsystemva; -+} -+ -+wstdcall void *WIN_FUNC(MmMapLockedPagesSpecifyCache,6) -+ (struct mdl *mdl, KPROCESSOR_MODE access_mode, -+ enum memory_caching_type cache_type, void *base_address, -+ ULONG bug_check, enum mm_page_priority priority) -+{ -+ return MmMapLockedPages(mdl, access_mode); -+} -+ -+wstdcall void WIN_FUNC(MmUnmapLockedPages,2) -+ (void *base, struct mdl *mdl) -+{ -+ mdl->flags &= ~MDL_MAPPED_TO_SYSTEM_VA; -+ return; -+} -+ -+wstdcall void WIN_FUNC(MmProbeAndLockPages,3) -+ (struct mdl *mdl, KPROCESSOR_MODE access_mode, -+ enum lock_operation operation) -+{ -+ /* already locked */ -+ mdl->flags |= MDL_PAGES_LOCKED; -+ return; -+} -+ -+wstdcall void WIN_FUNC(MmUnlockPages,1) -+ (struct mdl *mdl) -+{ -+ mdl->flags &= ~MDL_PAGES_LOCKED; -+ return; -+} -+ -+wstdcall BOOLEAN WIN_FUNC(MmIsAddressValid,1) -+ (void *virt_addr) -+{ -+ if (virt_addr_valid(virt_addr)) -+ return TRUE; -+ else -+ return FALSE; -+} -+ -+wstdcall void *WIN_FUNC(MmLockPagableDataSection,1) -+ (void *address) -+{ -+ return address; -+} -+ -+wstdcall void WIN_FUNC(MmUnlockPagableImageSection,1) -+ (void *handle) -+{ -+ return; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ObReferenceObjectByHandle,6) -+ (void *handle, ACCESS_MASK desired_access, void *obj_type, -+ KPROCESSOR_MODE access_mode, void **object, void *handle_info) -+{ -+ struct common_object_header *hdr; -+ -+ TRACE2("%p", handle); -+ hdr = HANDLE_TO_HEADER(handle); -+ atomic_inc_var(hdr->ref_count); -+ *object = HEADER_TO_OBJECT(hdr); -+ TRACE2("%p, %p, %d, %p", hdr, object, hdr->ref_count, *object); -+ return STATUS_SUCCESS; -+} -+ -+/* DDK doesn't say if return value should be before incrementing or -+ * after incrementing reference count, but according to #reactos -+ * developers, it should be return value after incrementing */ -+wfastcall LONG WIN_FUNC(ObfReferenceObject,1) -+ (void *object) -+{ -+ struct common_object_header *hdr; -+ LONG ret; -+ -+ hdr = OBJECT_TO_HEADER(object); -+ ret = post_atomic_add(hdr->ref_count, 1); -+ TRACE2("%p, %d, %p", hdr, hdr->ref_count, object); -+ return ret; -+} -+ -+static int dereference_object(void *object) -+{ -+ struct common_object_header *hdr; -+ int ref_count; -+ -+ ENTER2("object: %p", object); -+ hdr = OBJECT_TO_HEADER(object); -+ TRACE2("hdr: %p", hdr); -+ ref_count = post_atomic_add(hdr->ref_count, -1); -+ TRACE2("object: %p, %d", object, ref_count); -+ if (ref_count < 0) -+ ERROR("invalid object: %p (%d)", object, ref_count); -+ if (ref_count <= 0) { -+ free_object(object); -+ return 1; -+ } else -+ return 0; -+} -+ -+wfastcall void WIN_FUNC(ObfDereferenceObject,1) -+ (void *object) -+{ -+ TRACE2("%p", object); -+ dereference_object(object); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwCreateFile,11) -+ (void **handle, ACCESS_MASK access_mask, -+ struct object_attributes *obj_attr, struct io_status_block *iosb, -+ LARGE_INTEGER *size, ULONG file_attr, ULONG share_access, -+ ULONG create_disposition, ULONG create_options, void *ea_buffer, -+ ULONG ea_length) -+{ -+ struct common_object_header *coh; -+ struct file_object *fo; -+ struct ansi_string ansi; -+ struct wrap_bin_file *bin_file; -+ char *file_basename; -+ NTSTATUS status; -+ -+ spin_lock_bh(&ntoskernel_lock); -+ nt_list_for_each_entry(coh, &object_list, list) { -+ if (coh->type != OBJECT_TYPE_FILE) -+ continue; -+ /* TODO: check if file is opened in shared mode */ -+ if (!RtlCompareUnicodeString(&coh->name, obj_attr->name, TRUE)) { -+ fo = HEADER_TO_OBJECT(coh); -+ bin_file = fo->wrap_bin_file; -+ *handle = coh; -+ spin_unlock_bh(&ntoskernel_lock); -+ ObReferenceObject(fo); -+ iosb->status = FILE_OPENED; -+ iosb->info = bin_file->size; -+ EXIT2(return STATUS_SUCCESS); -+ } -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ -+ if (RtlUnicodeStringToAnsiString(&ansi, obj_attr->name, TRUE) != -+ STATUS_SUCCESS) -+ EXIT2(return STATUS_INSUFFICIENT_RESOURCES); -+ -+ file_basename = strrchr(ansi.buf, '\\'); -+ if (file_basename) -+ file_basename++; -+ else -+ file_basename = ansi.buf; -+ TRACE2("file: '%s', '%s'", ansi.buf, file_basename); -+ -+ fo = allocate_object(sizeof(struct file_object), OBJECT_TYPE_FILE, -+ obj_attr->name); -+ if (!fo) { -+ RtlFreeAnsiString(&ansi); -+ iosb->status = STATUS_INSUFFICIENT_RESOURCES; -+ iosb->info = 0; -+ EXIT2(return STATUS_FAILURE); -+ } -+ coh = OBJECT_TO_HEADER(fo); -+ bin_file = get_bin_file(file_basename); -+ if (bin_file) { -+ TRACE2("%s, %s", bin_file->name, file_basename); -+ fo->flags = FILE_OPENED; -+ } else if (access_mask & FILE_WRITE_DATA) { -+ bin_file = kzalloc(sizeof(*bin_file), GFP_KERNEL); -+ if (bin_file) { -+ strncpy(bin_file->name, file_basename, -+ sizeof(bin_file->name)); -+ bin_file->name[sizeof(bin_file->name)-1] = 0; -+ bin_file->data = vmalloc(*size); -+ if (bin_file->data) { -+ memset(bin_file->data, 0, *size); -+ bin_file->size = *size; -+ fo->flags = FILE_CREATED; -+ } else { -+ kfree(bin_file); -+ bin_file = NULL; -+ } -+ } -+ } else -+ bin_file = NULL; -+ -+ RtlFreeAnsiString(&ansi); -+ if (!bin_file) { -+ iosb->status = FILE_DOES_NOT_EXIST; -+ iosb->info = 0; -+ free_object(fo); -+ EXIT2(return STATUS_FAILURE); -+ } -+ -+ fo->wrap_bin_file = bin_file; -+ fo->current_byte_offset = 0; -+ if (access_mask & FILE_READ_DATA) -+ fo->read_access = TRUE; -+ if (access_mask & FILE_WRITE_DATA) -+ fo->write_access = TRUE; -+ iosb->status = FILE_OPENED; -+ iosb->info = bin_file->size; -+ *handle = coh; -+ TRACE2("handle: %p", *handle); -+ status = STATUS_SUCCESS; -+ EXIT2(return status); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwOpenFile,6) -+ (void **handle, ACCESS_MASK access_mask, -+ struct object_attributes *obj_attr, struct io_status_block *iosb, -+ ULONG share_access, ULONG open_options) -+{ -+ LARGE_INTEGER size; -+ return ZwCreateFile(handle, access_mask, obj_attr, iosb, &size, 0, -+ share_access, 0, open_options, NULL, 0); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwReadFile,9) -+ (void *handle, struct nt_event *event, void *apc_routine, -+ void *apc_context, struct io_status_block *iosb, void *buffer, -+ ULONG length, LARGE_INTEGER *byte_offset, ULONG *key) -+{ -+ struct file_object *fo; -+ struct common_object_header *coh; -+ ULONG count; -+ size_t offset; -+ struct wrap_bin_file *file; -+ -+ TRACE2("%p", handle); -+ coh = handle; -+ if (coh->type != OBJECT_TYPE_FILE) { -+ ERROR("handle %p is invalid: %d", handle, coh->type); -+ EXIT2(return STATUS_FAILURE); -+ } -+ fo = HANDLE_TO_OBJECT(coh); -+ file = fo->wrap_bin_file; -+ TRACE2("file: %s (%zu)", file->name, file->size); -+ spin_lock_bh(&ntoskernel_lock); -+ if (byte_offset) -+ offset = *byte_offset; -+ else -+ offset = fo->current_byte_offset; -+ count = min((size_t)length, file->size - offset); -+ TRACE2("count: %u, offset: %zu, length: %u", count, offset, length); -+ memcpy(buffer, ((void *)file->data) + offset, count); -+ fo->current_byte_offset = offset + count; -+ spin_unlock_bh(&ntoskernel_lock); -+ iosb->status = STATUS_SUCCESS; -+ iosb->info = count; -+ EXIT2(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwWriteFile,9) -+ (void *handle, struct nt_event *event, void *apc_routine, -+ void *apc_context, struct io_status_block *iosb, void *buffer, -+ ULONG length, LARGE_INTEGER *byte_offset, ULONG *key) -+{ -+ struct file_object *fo; -+ struct common_object_header *coh; -+ struct wrap_bin_file *file; -+ unsigned long offset; -+ -+ TRACE2("%p", handle); -+ coh = handle; -+ if (coh->type != OBJECT_TYPE_FILE) { -+ ERROR("handle %p is invalid: %d", handle, coh->type); -+ EXIT2(return STATUS_FAILURE); -+ } -+ fo = HANDLE_TO_OBJECT(coh); -+ file = fo->wrap_bin_file; -+ TRACE2("file: %zu, %u", file->size, length); -+ spin_lock_bh(&ntoskernel_lock); -+ if (byte_offset) -+ offset = *byte_offset; -+ else -+ offset = fo->current_byte_offset; -+ if (length + offset > file->size) { -+ WARNING("%lu, %zu", length + offset, file->size); -+ /* TODO: implement writing past end of current size */ -+ iosb->status = STATUS_FAILURE; -+ iosb->info = 0; -+ } else { -+ memcpy(file->data + offset, buffer, length); -+ iosb->status = STATUS_SUCCESS; -+ iosb->info = length; -+ fo->current_byte_offset = offset + length; -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ EXIT2(return iosb->status); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwClose,1) -+ (void *handle) -+{ -+ struct common_object_header *coh; -+ -+ TRACE2("%p", handle); -+ if (handle == NULL) { -+ TRACE1(""); -+ EXIT2(return STATUS_SUCCESS); -+ } -+ coh = handle; -+ if (coh->type == OBJECT_TYPE_FILE) { -+ struct file_object *fo; -+ struct wrap_bin_file *bin_file; -+ typeof(fo->flags) flags; -+ -+ fo = HANDLE_TO_OBJECT(handle); -+ flags = fo->flags; -+ bin_file = fo->wrap_bin_file; -+ if (dereference_object(fo)) { -+ if (flags == FILE_CREATED) { -+ vfree(bin_file->data); -+ kfree(bin_file); -+ } else -+ free_bin_file(bin_file); -+ } -+ } else if (coh->type == OBJECT_TYPE_NT_THREAD) { -+ struct nt_thread *thread = HANDLE_TO_OBJECT(handle); -+ TRACE2("thread: %p (%p)", thread, handle); -+ ObDereferenceObject(thread); -+ } else { -+ /* TODO: can we just dereference object here? */ -+ WARNING("closing handle 0x%x not implemented", coh->type); -+ } -+ EXIT2(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwQueryInformationFile,5) -+ (void *handle, struct io_status_block *iosb, void *info, -+ ULONG length, enum file_info_class class) -+{ -+ struct file_object *fo; -+ struct file_name_info *fni; -+ struct file_std_info *fsi; -+ struct wrap_bin_file *file; -+ struct common_object_header *coh; -+ -+ ENTER2("%p", handle); -+ coh = handle; -+ if (coh->type != OBJECT_TYPE_FILE) { -+ ERROR("handle %p is invalid: %d", coh, coh->type); -+ EXIT2(return STATUS_FAILURE); -+ } -+ fo = HANDLE_TO_OBJECT(handle); -+ TRACE2("fo: %p, %d", fo, class); -+ switch (class) { -+ case FileNameInformation: -+ fni = info; -+ fni->length = min(length, (typeof(length))coh->name.length); -+ memcpy(fni->name, coh->name.buf, fni->length); -+ iosb->status = STATUS_SUCCESS; -+ iosb->info = fni->length; -+ break; -+ case FileStandardInformation: -+ fsi = info; -+ file = fo->wrap_bin_file; -+ fsi->alloc_size = file->size; -+ fsi->eof = file->size; -+ fsi->num_links = 1; -+ fsi->delete_pending = FALSE; -+ fsi->dir = FALSE; -+ iosb->status = STATUS_SUCCESS; -+ iosb->info = 0; -+ break; -+ default: -+ WARNING("type %d not implemented yet", class); -+ iosb->status = STATUS_FAILURE; -+ iosb->info = 0; -+ break; -+ } -+ EXIT2(return iosb->status); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwOpenSection,3) -+ (void **handle, ACCESS_MASK access, struct object_attributes *obj_attrs) -+{ -+ INFO("%p, 0x%x, %d", obj_attrs, obj_attrs->attributes, access); -+ TODO(); -+ *handle = obj_attrs; -+ return STATUS_SUCCESS; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwMapViewOfSection,10) -+ (void *secn_handle, void *process_handle, void **base_address, -+ ULONG zero_bits, SIZE_T commit_size, LARGE_INTEGER *secn_offset, -+ SIZE_T *view_size, enum section_inherit inherit, ULONG alloc_type, -+ ULONG protect) -+{ -+ INFO("%p, %p, %p", secn_handle, process_handle, base_address); -+ TODO(); -+ *base_address = (void *)0xdeadbeef; -+ return STATUS_SUCCESS; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwUnmapViewOfSection,2) -+ (void *process_handle, void *base_address) -+{ -+ INFO("%p, %p", process_handle, base_address); -+ TODO(); -+ return STATUS_SUCCESS; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwCreateKey,7) -+ (void **handle, ACCESS_MASK desired_access, -+ struct object_attributes *attr, ULONG title_index, -+ struct unicode_string *class, ULONG create_options, -+ ULONG *disposition) -+{ -+ struct ansi_string ansi; -+ if (RtlUnicodeStringToAnsiString(&ansi, attr->name, TRUE) == -+ STATUS_SUCCESS) { -+ TRACE1("key: %s", ansi.buf); -+ RtlFreeAnsiString(&ansi); -+ } -+ *handle = NULL; -+ return STATUS_SUCCESS; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwOpenKey,3) -+ (void **handle, ACCESS_MASK desired_access, -+ struct object_attributes *attr) -+{ -+ struct ansi_string ansi; -+ if (RtlUnicodeStringToAnsiString(&ansi, attr->name, TRUE) == -+ STATUS_SUCCESS) { -+ TRACE1("key: %s", ansi.buf); -+ RtlFreeAnsiString(&ansi); -+ } -+ *handle = NULL; -+ return STATUS_SUCCESS; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwSetValueKey,6) -+ (void *handle, struct unicode_string *name, ULONG title_index, -+ ULONG type, void *data, ULONG data_size) -+{ -+ struct ansi_string ansi; -+ if (RtlUnicodeStringToAnsiString(&ansi, name, TRUE) == -+ STATUS_SUCCESS) { -+ TRACE1("key: %s", ansi.buf); -+ RtlFreeAnsiString(&ansi); -+ } -+ return STATUS_SUCCESS; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwQueryValueKey,6) -+ (void *handle, struct unicode_string *name, -+ enum key_value_information_class class, void *info, -+ ULONG length, ULONG *res_length) -+{ -+ struct ansi_string ansi; -+ if (RtlUnicodeStringToAnsiString(&ansi, name, TRUE) == STATUS_SUCCESS) { -+ TRACE1("key: %s", ansi.buf); -+ RtlFreeAnsiString(&ansi); -+ } -+ TODO(); -+ return STATUS_INVALID_PARAMETER; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwDeleteKey,1) -+ (void *handle) -+{ -+ ENTER2("%p", handle); -+ return STATUS_SUCCESS; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(ZwPowerInformation,5) -+ (INT info_level, void *in_buf, ULONG in_buf_len, void *out_buf, -+ ULONG out_buf_len) -+{ -+ INFO("%d, %u, %u", info_level, in_buf_len, out_buf_len); -+ TODO(); -+ return STATUS_ACCESS_DENIED; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(WmiSystemControl,4) -+ (struct wmilib_context *info, struct device_object *dev_obj, -+ struct irp *irp, void *irp_disposition) -+{ -+ TODO(); -+ return STATUS_SUCCESS; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(WmiCompleteRequest,5) -+ (struct device_object *dev_obj, struct irp *irp, NTSTATUS status, -+ ULONG buffer_used, CCHAR priority_boost) -+{ -+ TODO(); -+ return STATUS_SUCCESS; -+} -+ -+noregparm NTSTATUS WIN_FUNC(WmiTraceMessage,12) -+ (void *tracehandle, ULONG message_flags, -+ void *message_guid, USHORT message_no, ...) -+{ -+ TODO(); -+ EXIT2(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(WmiQueryTraceInformation,4) -+ (enum trace_information_class trace_info_class, void *trace_info, -+ ULONG *req_length, void *buf) -+{ -+ TODO(); -+ EXIT2(return STATUS_SUCCESS); -+} -+ -+/* this function can't be wstdcall as it takes variable number of args */ -+__attribute__((format(printf, 1, 2))) -+noregparm ULONG WIN_FUNC(DbgPrint,12) -+ (char *format, ...) -+{ -+#if DEBUG >= 1 -+ va_list args; -+ static char buf[100]; -+ -+ va_start(args, format); -+ vsnprintf(buf, sizeof(buf), format, args); -+ printk(KERN_DEBUG "%s (%s): %s", DRIVER_NAME, __func__, buf); -+ va_end(args); -+#endif -+ return STATUS_SUCCESS; -+} -+ -+__attribute__((format(printf, 3, 4))) -+noregparm ULONG WIN_FUNC(DbgPrintEx,12) -+ (ULONG component_id, ULONG severity, char *format, ...) -+{ -+#if DEBUG >= 1 -+ va_list args; -+ static char buf[100]; -+ -+ va_start(args, format); -+ vsnprintf(buf, sizeof(buf), format, args); -+ TRACE1("component_id: %d, severity: %d\n", component_id, severity); -+ printk(KERN_DEBUG "%s (%s): %s", DRIVER_NAME, __func__, buf); -+ va_end(args); -+#endif -+ return STATUS_SUCCESS; -+} -+ -+wstdcall void WIN_FUNC(KeBugCheck,1) -+ (ULONG code) -+{ -+ ERROR("Unrecoverable error reported by the driver"); -+ ERROR("code: 0x%x\n", code); -+ dump_stack(); -+ return; -+} -+ -+wstdcall void WIN_FUNC(KeBugCheckEx,5) -+ (ULONG code, ULONG_PTR param1, ULONG_PTR param2, -+ ULONG_PTR param3, ULONG_PTR param4) -+{ -+ ERROR("Unrecoverable error reported by the driver"); -+ ERROR("code: 0x%x, params: 0x%lx 0x%lx 0x%lx 0x%lx\n", code, param1, -+ param2, param3, param4); -+ dump_stack(); -+ return; -+} -+ -+wstdcall void WIN_FUNC(ExSystemTimeToLocalTime,2) -+ (LARGE_INTEGER *system_time, LARGE_INTEGER *local_time) -+{ -+ *local_time = *system_time; -+} -+ -+wstdcall ULONG WIN_FUNC(ExSetTimerResolution,2) -+ (ULONG time, BOOLEAN set) -+{ -+ /* why a driver should change system wide timer resolution is -+ * beyond me */ -+ return time; -+} -+ -+wstdcall void WIN_FUNC(DbgBreakPoint,0) -+ (void) -+{ -+ TODO(); -+} -+ -+wstdcall void WIN_FUNC(_except_handler3,0) -+ (void) -+{ -+ TODO(); -+} -+ -+wstdcall void WIN_FUNC(__C_specific_handler,0) -+ (void) -+{ -+ TODO(); -+} -+ -+wstdcall void WIN_FUNC(_purecall,0) -+ (void) -+{ -+ TODO(); -+} -+ -+struct worker_init_struct { -+ struct work_struct work; -+ struct completion completion; -+ struct nt_thread *nt_thread; -+}; -+ -+int ntoskernel_init(void) -+{ -+ struct timeval now; -+ -+ spin_lock_init(&dispatcher_lock); -+ spin_lock_init(&ntoskernel_lock); -+ spin_lock_init(&ntos_work_lock); -+ spin_lock_init(&kdpc_list_lock); -+ spin_lock_init(&irp_cancel_lock); -+ InitializeListHead(&wrap_mdl_list); -+ InitializeListHead(&kdpc_list); -+ InitializeListHead(&callback_objects); -+ InitializeListHead(&bus_driver_list); -+ InitializeListHead(&object_list); -+ InitializeListHead(&ntos_work_list); -+ -+ nt_spin_lock_init(&nt_list_lock); -+ -+ INIT_WORK(&kdpc_work, kdpc_worker); -+ INIT_WORK(&ntos_work, ntos_work_worker); -+ wrap_timer_slist.next = NULL; -+ -+ do_gettimeofday(&now); -+ wrap_ticks_to_boot = TICKS_1601_TO_1970; -+ wrap_ticks_to_boot += (u64)now.tv_sec * TICKSPERSEC; -+ wrap_ticks_to_boot += now.tv_usec * 10; -+ wrap_ticks_to_boot -= jiffies * TICKSPERJIFFY; -+ TRACE2("%llu", wrap_ticks_to_boot); -+ -+ cpu_count = num_online_cpus(); -+ -+#ifdef WRAP_PREEMPT -+ do { -+ int cpu; -+ for_each_possible_cpu(cpu) { -+ struct irql_info *info; -+ info = &per_cpu(irql_info, cpu); -+ mutex_init(&(info->lock)); -+ info->task = NULL; -+ info->count = 0; -+#ifdef CONFIG_SMP -+ cpumask_setall(&info->cpus_allowed); -+#endif -+ } -+ } while (0); -+#endif -+ -+ ntos_wq = create_singlethread_workqueue("ntos_wq"); -+ if (!ntos_wq) { -+ WARNING("couldn't create ntos_wq thread"); -+ return -ENOMEM; -+ } -+ TRACE1("ntos_wq: %p", ntos_wq); -+ -+ if (add_bus_driver("PCI") -+#ifdef ENABLE_USB -+ || add_bus_driver("USB") -+#endif -+ ) { -+ ntoskernel_exit(); -+ return -ENOMEM; -+ } -+ mdl_cache = -+ wrap_kmem_cache_create(DRIVER_NAME "_mdl", -+ sizeof(struct wrap_mdl) + MDL_CACHE_SIZE, -+ 0, 0); -+ TRACE2("%p", mdl_cache); -+ if (!mdl_cache) { -+ ERROR("couldn't allocate MDL cache"); -+ ntoskernel_exit(); -+ return -ENOMEM; -+ } -+ -+#if defined(CONFIG_X86_64) -+ memset(&kuser_shared_data, 0, sizeof(kuser_shared_data)); -+ *((ULONG64 *)&kuser_shared_data.system_time) = ticks_1601(); -+ init_timer(&shared_data_timer); -+ shared_data_timer.function = update_user_shared_data_proc; -+ shared_data_timer.data = 0; -+#endif -+ return 0; -+} -+ -+int ntoskernel_init_device(struct wrap_device *wd) -+{ -+#if defined(CONFIG_X86_64) -+ if (kuser_shared_data.reserved1) -+ mod_timer(&shared_data_timer, jiffies + MSEC_TO_HZ(30)); -+#endif -+ return 0; -+} -+ -+void ntoskernel_exit_device(struct wrap_device *wd) -+{ -+ ENTER2(""); -+ -+ KeFlushQueuedDpcs(); -+ EXIT2(return); -+} -+ -+void ntoskernel_exit(void) -+{ -+ struct nt_list *cur; -+ -+ ENTER2(""); -+ -+ /* free kernel (Ke) timers */ -+ TRACE2("freeing timers"); -+ while (1) { -+ struct wrap_timer *wrap_timer; -+ struct nt_slist *slist; -+ -+ spin_lock_bh(&ntoskernel_lock); -+ if ((slist = wrap_timer_slist.next)) -+ wrap_timer_slist.next = slist->next; -+ spin_unlock_bh(&ntoskernel_lock); -+ TIMERTRACE("%p", slist); -+ if (!slist) -+ break; -+ wrap_timer = container_of(slist, struct wrap_timer, slist); -+ if (del_timer_sync(&wrap_timer->timer)) -+ WARNING("Buggy Windows driver left timer %p running", -+ wrap_timer->nt_timer); -+ memset(wrap_timer, 0, sizeof(*wrap_timer)); -+ slack_kfree(wrap_timer); -+ } -+ -+ TRACE2("freeing MDLs"); -+ if (mdl_cache) { -+ spin_lock_bh(&ntoskernel_lock); -+ if (!IsListEmpty(&wrap_mdl_list)) -+ ERROR("Windows driver didn't free all MDLs; " -+ "freeing them now"); -+ while ((cur = RemoveHeadList(&wrap_mdl_list))) { -+ struct wrap_mdl *wrap_mdl; -+ wrap_mdl = container_of(cur, struct wrap_mdl, list); -+ if (wrap_mdl->mdl->flags & MDL_CACHE_ALLOCATED) -+ kmem_cache_free(mdl_cache, wrap_mdl); -+ else -+ kfree(wrap_mdl); -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ kmem_cache_destroy(mdl_cache); -+ mdl_cache = NULL; -+ } -+ -+ TRACE2("freeing callbacks"); -+ spin_lock_bh(&ntoskernel_lock); -+ while ((cur = RemoveHeadList(&callback_objects))) { -+ struct callback_object *object; -+ struct nt_list *ent; -+ object = container_of(cur, struct callback_object, list); -+ while ((ent = RemoveHeadList(&object->callback_funcs))) { -+ struct callback_func *f; -+ f = container_of(ent, struct callback_func, list); -+ kfree(f); -+ } -+ kfree(object); -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ -+ spin_lock_bh(&ntoskernel_lock); -+ while ((cur = RemoveHeadList(&bus_driver_list))) { -+ struct bus_driver *bus_driver; -+ bus_driver = container_of(cur, struct bus_driver, list); -+ /* TODO: make sure all all drivers are shutdown/removed */ -+ kfree(bus_driver); -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ -+#if defined(CONFIG_X86_64) -+ del_timer_sync(&shared_data_timer); -+#endif -+ if (ntos_wq) -+ destroy_workqueue(ntos_wq); -+ ENTER2("freeing objects"); -+ spin_lock_bh(&ntoskernel_lock); -+ while ((cur = RemoveHeadList(&object_list))) { -+ struct common_object_header *hdr; -+ hdr = container_of(cur, struct common_object_header, list); -+ if (hdr->type == OBJECT_TYPE_NT_THREAD) -+ TRACE1("object %p(%d) was not freed, freeing it now", -+ HEADER_TO_OBJECT(hdr), hdr->type); -+ else -+ WARNING("object %p(%d) was not freed, freeing it now", -+ HEADER_TO_OBJECT(hdr), hdr->type); -+ ExFreePool(hdr); -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ -+ EXIT2(return); -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/ntoskernel.h linux-4.12.4-3rd/3rdparty/ndiswrapper/ntoskernel.h ---- linux-4.12.4/3rdparty/ndiswrapper/ntoskernel.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/ntoskernel.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,1102 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifndef _NTOSKERNEL_H_ -+#define _NTOSKERNEL_H_ -+ -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+ -+#if !defined(CONFIG_X86) && !defined(CONFIG_X86_64) -+#error "this module is for x86 or x86_64 architectures only" -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,14) -+#define gfp_t unsigned int __nocast -+ -+static inline void *_kzalloc(size_t size, gfp_t flags) -+{ -+ void *p = kmalloc(size, flags); -+ if (likely(p != NULL)) -+ memset(p, 0, size); -+ return p; -+} -+ -+#define kzalloc(size, flags) _kzalloc(size, flags) -+#endif -+ -+/* Interrupt backwards compatibility stuff */ -+#include -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,29) -+#ifndef IRQ_HANDLED -+#define IRQ_HANDLED -+#define IRQ_NONE -+#define irqreturn_t void -+#endif -+#endif /* Linux < 2.6.29 */ -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,16) -+#ifndef mutex_init -+#define mutex semaphore -+#define mutex_init(m) sema_init(m, 1) -+#define mutex_lock(m) down(m) -+#define mutex_trylock(m) (!down_trylock(m)) -+#define mutex_unlock(m) up(m) -+#define mutex_is_locked(m) (atomic_read(m.count) == 0) -+#endif -+#endif /* Linux < 2.6.16 */ -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26) -+#define set_cpus_allowed_ptr(task, mask) set_cpus_allowed(task, *mask) -+#endif /* Linux < 2.6.26 */ -+ -+#ifdef CONFIG_SMP -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,28) -+#define cpumask_copy(dst, src) do { *dst = *src; } while (0) -+#define cpumask_equal(mask1, mask2) cpus_equal(*mask1, *mask2) -+#define cpumask_setall(mask) cpus_setall(*mask) -+static cpumask_t cpumasks[NR_CPUS]; -+#define cpumask_of(cpu) \ -+({ \ -+ cpumasks[cpu] = cpumask_of_cpu(cpu); \ -+ &cpumasks[cpu]; \ -+}) -+#endif /* Linux < 2.6.28 */ -+#endif /* CONFIG_SMP */ -+ -+#ifndef tsk_cpus_allowed -+#define tsk_cpus_allowed(tsk) (&(tsk)->cpus_allowed) -+#endif -+ -+#ifndef __packed -+#define __packed __attribute__((packed)) -+#endif -+ -+/* pci functions in 2.6 kernels have problems allocating dma buffers, -+ * but seem to work fine with dma functions -+ */ -+#include -+ -+#define PCI_DMA_ALLOC_COHERENT(pci_dev,size,dma_handle) \ -+ dma_alloc_coherent(&pci_dev->dev,size,dma_handle, \ -+ GFP_KERNEL | __GFP_REPEAT) -+#define PCI_DMA_FREE_COHERENT(pci_dev,size,cpu_addr,dma_handle) \ -+ dma_free_coherent(&pci_dev->dev,size,cpu_addr,dma_handle) -+#define PCI_DMA_MAP_SINGLE(pci_dev,addr,size,direction) \ -+ dma_map_single(&pci_dev->dev,addr,size,direction) -+#define PCI_DMA_UNMAP_SINGLE(pci_dev,dma_handle,size,direction) \ -+ dma_unmap_single(&pci_dev->dev,dma_handle,size,direction) -+#define MAP_SG(pci_dev, sglist, nents, direction) \ -+ dma_map_sg(&pci_dev->dev, sglist, nents, direction) -+#define UNMAP_SG(pci_dev, sglist, nents, direction) \ -+ dma_unmap_sg(&pci_dev->dev, sglist, nents, direction) -+#define PCI_DMA_MAP_ERROR(dma_addr) dma_mapping_error(dma_addr) -+ -+ -+#if defined(CONFIG_NET_RADIO) && !defined(CONFIG_WIRELESS_EXT) -+#define CONFIG_WIRELESS_EXT -+#endif -+ -+#define prepare_wait_condition(task, var, value) \ -+do { \ -+ var = value; \ -+ task = current; \ -+ barrier(); \ -+} while (0) -+ -+/* Wait in wait_state (e.g., TASK_INTERRUPTIBLE) for condition to -+ * become true; timeout is either jiffies (> 0) to wait or 0 to wait -+ * forever. -+ * When timeout == 0, return value is -+ * > 0 if condition becomes true, or -+ * < 0 if signal is pending on the thread. -+ * When timeout > 0, return value is -+ * > 0 if condition becomes true before timeout, -+ * < 0 if signal is pending on the thread before timeout, or -+ * 0 if timedout (condition may have become true at the same time) -+ */ -+ -+#define wait_condition(condition, timeout, wait_state) \ -+({ \ -+ long ret = timeout ? timeout : 1; \ -+ while (1) { \ -+ if (signal_pending(current)) { \ -+ ret = -ERESTARTSYS; \ -+ break; \ -+ } \ -+ set_current_state(wait_state); \ -+ if (condition) { \ -+ __set_current_state(TASK_RUNNING); \ -+ break; \ -+ } \ -+ if (timeout) { \ -+ ret = schedule_timeout(ret); \ -+ if (!ret) \ -+ break; \ -+ } else \ -+ schedule(); \ -+ } \ -+ ret; \ -+}) -+ -+#ifdef WRAP_WQ -+ -+struct wrap_workqueue_struct; -+ -+struct wrap_work_struct { -+ struct list_head list; -+ void (*func)(struct wrap_work_struct *data); -+ void *data; -+ /* whether/on which thread scheduled */ -+ struct workqueue_thread *thread; -+}; -+ -+#define work_struct wrap_work_struct -+#define workqueue_struct wrap_workqueue_struct -+ -+#undef INIT_WORK -+#define INIT_WORK(work, pfunc) \ -+ do { \ -+ (work)->func = (pfunc); \ -+ (work)->data = (work); \ -+ (work)->thread = NULL; \ -+ } while (0) -+ -+#undef create_singlethread_workqueue -+#define create_singlethread_workqueue(wq) wrap_create_wq(wq, 1, 0) -+#undef create_workqueue -+#define create_workqueue(wq) wrap_create_wq(wq, 0, 0) -+#undef destroy_workqueue -+#define destroy_workqueue(wq) wrap_destroy_wq(wq) -+#undef queue_work -+#define queue_work(wq, work) wrap_queue_work(wq, work) -+#undef flush_workqueue -+#define flush_workqueue(wq) wrap_flush_wq(wq) -+ -+struct workqueue_struct *wrap_create_wq(const char *name, u8 singlethread, -+ u8 freeze); -+void wrap_destroy_wq(struct workqueue_struct *workq); -+int wrap_queue_work(struct workqueue_struct *workq, struct work_struct *work); -+void wrap_cancel_work(struct work_struct *work); -+void wrap_flush_wq(struct workqueue_struct *workq); -+ -+#else // WRAP_WQ -+ -+/* Compatibility for Linux before 2.6.20 where INIT_WORK takes 3 arguments */ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20) && \ -+ !defined(INIT_WORK_NAR) && \ -+ !defined(INIT_DELAYED_WORK_DEFERRABLE) -+typedef void (*compat_work_func_t)(void *work); -+typedef void (*work_func_t)(struct work_struct *work); -+static inline void (INIT_WORK)(struct work_struct *work, work_func_t func) -+{ -+ INIT_WORK(work, (compat_work_func_t)func, work); -+} -+#undef INIT_WORK -+#endif -+ -+#endif // WRAP_WQ -+ -+#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,18) -+#define ISR_PT_REGS_PARAM_DECL -+#else -+#define ISR_PT_REGS_PARAM_DECL , struct pt_regs *regs -+#endif -+ -+#if LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,16) -+#define for_each_possible_cpu(_cpu) for_each_cpu(_cpu) -+#endif -+ -+#ifndef CHECKSUM_PARTIAL -+#define CHECKSUM_PARTIAL CHECKSUM_HW -+#endif -+ -+#ifndef IRQF_SHARED -+#define IRQF_SHARED SA_SHIRQ -+#endif -+ -+#ifndef UMH_WAIT_PROC -+#define UMH_WAIT_PROC 1 -+#endif -+ -+#define memcpy_skb(skb, from, length) \ -+ memcpy(skb_put(skb, length), from, length) -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24) -+#ifndef DMA_BIT_MASK -+#define DMA_BIT_MASK(n) (((n) == 64) ? ~0ULL : ((1ULL<<(n))-1)) -+#endif -+#endif -+ -+#ifndef __GFP_DMA32 -+#define __GFP_DMA32 GFP_DMA -+#endif -+ -+#if LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,22) -+#define wrap_kmem_cache_create(name, size, align, flags) \ -+ kmem_cache_create(name, size, align, flags, NULL, NULL) -+#else -+#define wrap_kmem_cache_create(name, size, align, flags) \ -+ kmem_cache_create(name, size, align, flags, NULL) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,34) -+#define netdev_mc_count(dev) ((dev)->mc_count) -+#define usb_alloc_coherent(dev, size, mem_flags, dma) (usb_buffer_alloc((dev), (size), (mem_flags), (dma))) -+#define usb_free_coherent(dev, size, addr, dma) (usb_buffer_free((dev), (size), (addr), (dma))) -+#endif -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,8,0) -+#define daemonize(name, ...) do {} while (0) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,9,0) -+#define add_taint(flag, lockdep_ok) add_taint(flag) -+#endif -+ -+#include "winnt_types.h" -+#include "ndiswrapper.h" -+#include "pe_linker.h" -+#include "wrapmem.h" -+#include "lin2win.h" -+#include "loader.h" -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18) -+static inline void netif_tx_lock(struct net_device *dev) -+{ -+ spin_lock(&dev->xmit_lock); -+} -+static inline void netif_tx_unlock(struct net_device *dev) -+{ -+ spin_unlock(&dev->xmit_lock); -+} -+static inline void netif_tx_lock_bh(struct net_device *dev) -+{ -+ spin_lock_bh(&dev->xmit_lock); -+} -+static inline void netif_tx_unlock_bh(struct net_device *dev) -+{ -+ spin_unlock_bh(&dev->xmit_lock); -+} -+#endif -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,24) -+static inline void netif_poll_enable(struct net_device *dev) -+{ -+} -+static inline void netif_poll_disable(struct net_device *dev) -+{ -+} -+#endif -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,24) -+#define proc_net_root init_net.proc_net -+#else -+#define proc_net_root proc_net -+#endif -+ -+#if ((LINUX_VERSION_CODE < KERNEL_VERSION(3,2,0)) && \ -+ (LINUX_VERSION_CODE >= KERNEL_VERSION(3,0,0))) || \ -+ (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,42)) -+#ifndef skb_frag_page -+#define skb_frag_page(frag) ((frag)->page) -+#endif -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,11,0) -+#define netdev_notifier_info_to_dev(x) ((struct net_device *)(x)) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,13,0) -+static inline void reinit_completion(struct completion *x) -+{ -+ INIT_COMPLETION(*x); -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0) -+#define prandom_seed(seed) net_srandom(seed) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22) -+static int strncasecmp(const char *s1, const char *s2, size_t n) -+{ -+ strnicmp(s1, s2, n); -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4,7,0) -+static inline void netif_trans_update(struct net_device *dev) -+{ -+ dev->trans_start = jiffies; -+} -+#endif -+ -+/* TICK is 100ns */ -+#define TICKSPERSEC 10000000 -+#define TICKSPERMSEC 10000 -+#define SECSPERDAY 86400 -+#define TICKSPERJIFFY ((TICKSPERSEC + HZ - 1) / HZ) -+ -+#define int_div_round(x, y) (((x) + (y - 1)) / (y)) -+ -+/* 1601 to 1970 is 369 years plus 89 leap days */ -+#define SECS_1601_TO_1970 ((369 * 365 + 89) * (u64)SECSPERDAY) -+#define TICKS_1601_TO_1970 (SECS_1601_TO_1970 * TICKSPERSEC) -+ -+/* 100ns units to HZ; if sys_time is negative, relative to current -+ * clock, otherwise from year 1601 */ -+#define SYSTEM_TIME_TO_HZ(sys_time) \ -+ (((sys_time) <= 0) ? \ -+ int_div_round(((u64)HZ * (-(sys_time))), TICKSPERSEC) : \ -+ int_div_round(((s64)HZ * ((sys_time) - ticks_1601())), TICKSPERSEC)) -+ -+#define MSEC_TO_HZ(ms) int_div_round((ms * HZ), 1000) -+#define USEC_TO_HZ(us) int_div_round((us * HZ), 1000000) -+ -+extern u64 wrap_ticks_to_boot; -+ -+static inline u64 ticks_1601(void) -+{ -+ return wrap_ticks_to_boot + (u64)jiffies * TICKSPERJIFFY; -+} -+ -+typedef void (*generic_func)(void); -+ -+struct wrap_export { -+ const char *name; -+ generic_func func; -+}; -+ -+#ifdef CONFIG_X86_64 -+ -+#define WIN_SYMBOL(name, argc) \ -+ {#name, (generic_func) win2lin_ ## name ## _ ## argc} -+#define WIN_WIN_SYMBOL(name, argc) \ -+ {#name, (generic_func) win2lin__win_ ## name ## _ ## argc} -+#define WIN_FUNC_DECL(name, argc) \ -+ extern typeof(name) win2lin_ ## name ## _ ## argc; -+#define WIN_FUNC_PTR(name, argc) win2lin_ ## name ## _ ## argc -+ -+#else -+ -+#define WIN_SYMBOL(name, argc) {#name, (generic_func)name} -+#define WIN_WIN_SYMBOL(name, argc) {#name, (generic_func)_win_ ## name} -+#define WIN_FUNC_DECL(name, argc) -+#define WIN_FUNC_PTR(name, argc) name -+ -+#endif -+ -+#define WIN_FUNC(name, argc) (name) -+/* map name s to f - if f is different from s */ -+#define WIN_SYMBOL_MAP(s, f) -+ -+#define POOL_TAG(A, B, C, D) \ -+ ((ULONG)((A) + ((B) << 8) + ((C) << 16) + ((D) << 24))) -+ -+struct pe_image { -+ char name[MAX_DRIVER_NAME_LEN]; -+ UINT (*entry)(struct driver_object *, struct unicode_string *) wstdcall; -+ void *image; -+ int size; -+ int type; -+ -+ IMAGE_NT_HEADERS *nt_hdr; -+ IMAGE_OPTIONAL_HEADER *opt_hdr; -+}; -+ -+struct ndis_mp_block; -+ -+struct wrap_timer { -+ struct nt_slist slist; -+ struct timer_list timer; -+ struct nt_timer *nt_timer; -+ long repeat; -+#ifdef TIMER_DEBUG -+ unsigned long wrap_timer_magic; -+#endif -+}; -+ -+struct ntos_work_item { -+ struct nt_list list; -+ void *arg1; -+ void *arg2; -+ NTOS_WORK_FUNC func; -+}; -+ -+struct wrap_device_setting { -+ struct nt_list list; -+ char name[MAX_SETTING_NAME_LEN]; -+ char value[MAX_SETTING_VALUE_LEN]; -+ void *encoded; -+}; -+ -+struct wrap_bin_file { -+ char name[MAX_DRIVER_NAME_LEN]; -+ size_t size; -+ void *data; -+}; -+ -+#define WRAP_DRIVER_CLIENT_ID 1 -+ -+struct wrap_driver { -+ struct nt_list list; -+ struct driver_object *drv_obj; -+ char name[MAX_DRIVER_NAME_LEN]; -+ char version[MAX_SETTING_VALUE_LEN]; -+ unsigned short num_pe_images; -+ struct pe_image pe_images[MAX_DRIVER_PE_IMAGES]; -+ unsigned short num_bin_files; -+ struct wrap_bin_file *bin_files; -+ struct nt_list settings; -+ int dev_type; -+ struct ndis_driver *ndis_driver; -+}; -+ -+enum hw_status { -+ HW_INITIALIZED = 1, HW_SUSPENDED, HW_HALTED, HW_DISABLED, -+}; -+ -+struct wrap_device { -+ /* first part is (de)initialized once by loader */ -+ struct nt_list list; -+ int dev_bus; -+ int vendor; -+ int device; -+ int subvendor; -+ int subdevice; -+ char conf_file_name[MAX_DRIVER_NAME_LEN]; -+ char driver_name[MAX_DRIVER_NAME_LEN]; -+ struct wrap_driver *driver; -+ struct nt_list settings; -+ -+ /* rest should be (de)initialized when a device is -+ * (un)plugged */ -+ struct cm_resource_list *resource_list; -+ unsigned long hw_status; -+ struct device_object *pdo; -+ union { -+ struct { -+ struct pci_dev *pdev; -+ enum device_power_state wake_state; -+ } pci; -+ struct { -+ struct usb_device *udev; -+ struct usb_interface *intf; -+ int num_alloc_urbs; -+ struct nt_list wrap_urb_list; -+ } usb; -+ }; -+}; -+ -+#define wrap_is_pci_bus(dev_bus) \ -+ (WRAP_BUS(dev_bus) == WRAP_PCI_BUS || \ -+ WRAP_BUS(dev_bus) == WRAP_PCMCIA_BUS) -+#ifdef ENABLE_USB -+/* earlier versions of ndiswrapper used 0 as USB_BUS */ -+#define wrap_is_usb_bus(dev_bus) \ -+ (WRAP_BUS(dev_bus) == WRAP_USB_BUS || \ -+ WRAP_BUS(dev_bus) == WRAP_INTERNAL_BUS) -+#else -+#define wrap_is_usb_bus(dev_bus) 0 -+#endif -+#define wrap_is_bluetooth_device(dev_bus) \ -+ (WRAP_DEVICE(dev_bus) == WRAP_BLUETOOTH_DEVICE1 || \ -+ WRAP_DEVICE(dev_bus) == WRAP_BLUETOOTH_DEVICE2) -+ -+extern struct workqueue_struct *ntos_wq; -+extern struct workqueue_struct *ndis_wq; -+extern struct workqueue_struct *wrapndis_wq; -+ -+#define atomic_unary_op(var, size, oper) \ -+do { \ -+ if (size == 1) \ -+ __asm__ __volatile__( \ -+ LOCK_PREFIX oper "b %b0\n\t" : "+m" (var)); \ -+ else if (size == 2) \ -+ __asm__ __volatile__( \ -+ LOCK_PREFIX oper "w %w0\n\t" : "+m" (var)); \ -+ else if (size == 4) \ -+ __asm__ __volatile__( \ -+ LOCK_PREFIX oper "l %0\n\t" : "+m" (var)); \ -+ else if (size == 8) \ -+ __asm__ __volatile__( \ -+ LOCK_PREFIX oper "q %q0\n\t" : "+m" (var)); \ -+ else { \ -+ extern void _invalid_op_size_(void); \ -+ _invalid_op_size_(); \ -+ } \ -+} while (0) -+ -+#define atomic_inc_var_size(var, size) atomic_unary_op(var, size, "inc") -+ -+#define atomic_inc_var(var) atomic_inc_var_size(var, sizeof(var)) -+ -+#define atomic_dec_var_size(var, size) atomic_unary_op(var, size, "dec") -+ -+#define atomic_dec_var(var) atomic_dec_var_size(var, sizeof(var)) -+ -+#define pre_atomic_add(var, i) \ -+({ \ -+ typeof(var) pre; \ -+ __asm__ __volatile__( \ -+ LOCK_PREFIX "xadd %0, %1\n\t" \ -+ : "=r"(pre), "+m"(var) \ -+ : "0"(i)); \ -+ pre; \ -+}) -+ -+#define post_atomic_add(var, i) (pre_atomic_add(var, i) + i) -+ -+//#define DEBUG_IRQL 1 -+ -+#ifdef DEBUG_IRQL -+#define assert_irql(cond) \ -+do { \ -+ KIRQL _irql_ = current_irql(); \ -+ if (!(cond)) { \ -+ WARNING("assertion '%s' failed: %d", #cond, _irql_); \ -+ DBG_BLOCK(4) { \ -+ dump_stack(); \ -+ } \ -+ } \ -+} while (0) -+#else -+#define assert_irql(cond) do { } while (0) -+#endif -+ -+/* When preempt is enabled, we should preempt_disable to raise IRQL to -+ * DISPATCH_LEVEL, to be consistent with the semantics. However, using -+ * a mutex instead, so that only ndiswrapper threads run one at a time -+ * on a processor when at DISPATCH_LEVEL seems to be enough. So that -+ * is what we will use until we learn otherwise. If -+ * preempt_(en|dis)able is required for some reason, comment out -+ * following #define. */ -+ -+#define WRAP_PREEMPT 1 -+ -+#if !defined(CONFIG_PREEMPT) || defined(CONFIG_PREEMPT_RT) -+#ifndef WRAP_PREEMPT -+#define WRAP_PREEMPT 1 -+#endif -+#endif -+ -+//#undef WRAP_PREEMPT -+ -+#ifdef WRAP_PREEMPT -+ -+struct irql_info { -+ int count; -+ struct mutex lock; -+#ifdef CONFIG_SMP -+ cpumask_t cpus_allowed; -+#endif -+ struct task_struct *task; -+}; -+ -+DECLARE_PER_CPU(struct irql_info, irql_info); -+ -+static inline KIRQL raise_irql(KIRQL newirql) -+{ -+ struct irql_info *info; -+ -+ assert(newirql == DISPATCH_LEVEL); -+ info = &get_cpu_var(irql_info); -+ if (info->task == current) { -+ assert(info->count > 0); -+ assert(mutex_is_locked(&info->lock)); -+#if defined(CONFIG_SMP) && DEBUG >= 1 -+ assert(cpumask_equal(tsk_cpus_allowed(current), -+ cpumask_of(smp_processor_id()))); -+#endif -+ info->count++; -+ put_cpu_var(irql_info); -+ return DISPATCH_LEVEL; -+ } -+ /* TODO: is this enough to pin down to current cpu? */ -+#ifdef CONFIG_SMP -+ assert(task_cpu(current) == smp_processor_id()); -+ cpumask_copy(&info->cpus_allowed, tsk_cpus_allowed(current)); -+ set_cpus_allowed_ptr(current, cpumask_of(smp_processor_id())); -+#endif -+ put_cpu_var(irql_info); -+ mutex_lock(&info->lock); -+ assert(info->count == 0); -+ assert(info->task == NULL); -+ info->count = 1; -+ info->task = current; -+ return PASSIVE_LEVEL; -+} -+ -+static inline void lower_irql(KIRQL oldirql) -+{ -+ struct irql_info *info; -+ -+ assert(oldirql <= DISPATCH_LEVEL); -+ info = &get_cpu_var(irql_info); -+ assert(info->task == current); -+ assert(mutex_is_locked(&info->lock)); -+ assert(info->count > 0); -+ if (--info->count == 0) { -+ info->task = NULL; -+#ifdef CONFIG_SMP -+ set_cpus_allowed_ptr(current, &info->cpus_allowed); -+#endif -+ mutex_unlock(&info->lock); -+ } -+ put_cpu_var(irql_info); -+} -+ -+static inline KIRQL current_irql(void) -+{ -+ int count; -+ if (in_irq() || irqs_disabled()) -+ EXIT4(return DIRQL); -+ if (in_atomic() || in_interrupt()) -+ EXIT4(return SOFT_IRQL); -+ count = get_cpu_var(irql_info).count; -+ put_cpu_var(irql_info); -+ if (count) -+ EXIT6(return DISPATCH_LEVEL); -+ else -+ EXIT6(return PASSIVE_LEVEL); -+} -+ -+#else -+ -+static inline KIRQL current_irql(void) -+{ -+ if (in_irq() || irqs_disabled()) -+ EXIT4(return DIRQL); -+ if (in_interrupt()) -+ EXIT4(return SOFT_IRQL); -+ if (in_atomic()) -+ EXIT6(return DISPATCH_LEVEL); -+ else -+ EXIT6(return PASSIVE_LEVEL); -+} -+ -+static inline KIRQL raise_irql(KIRQL newirql) -+{ -+ KIRQL ret = in_atomic() ? DISPATCH_LEVEL : PASSIVE_LEVEL; -+ assert(newirql == DISPATCH_LEVEL); -+ assert(current_irql() <= DISPATCH_LEVEL); -+ preempt_disable(); -+ return ret; -+} -+ -+static inline void lower_irql(KIRQL oldirql) -+{ -+ assert(current_irql() == DISPATCH_LEVEL); -+ preempt_enable(); -+} -+ -+#endif -+ -+#define irql_gfp() (in_atomic() ? GFP_ATOMIC : GFP_KERNEL) -+ -+/* Windows spinlocks are of type ULONG_PTR which is not big enough to -+ * store Linux spinlocks; so we implement Windows spinlocks using -+ * ULONG_PTR space with our own functions/macros */ -+ -+/* Windows seems to use 0 for unlocked state of spinlock - if Linux -+ * convention of 1 for unlocked state is used, at least prism54 driver -+ * crashes */ -+ -+#define NT_SPIN_LOCK_UNLOCKED 0 -+#define NT_SPIN_LOCK_LOCKED 1 -+ -+static inline void nt_spin_lock_init(NT_SPIN_LOCK *lock) -+{ -+ *lock = NT_SPIN_LOCK_UNLOCKED; -+} -+ -+#ifdef CONFIG_SMP -+ -+static inline void nt_spin_lock(NT_SPIN_LOCK *lock) -+{ -+ while (1) { -+ unsigned long lockval = xchg(lock, NT_SPIN_LOCK_LOCKED); -+ -+ if (likely(lockval == NT_SPIN_LOCK_UNLOCKED)) -+ break; -+ if (unlikely(lockval > NT_SPIN_LOCK_LOCKED)) { -+ ERROR("bad spinlock: 0x%lx at %p", lockval, lock); -+ return; -+ } -+ /* "rep; nop" doesn't change cx register, it's a "pause" */ -+ __asm__ __volatile__("rep; nop"); -+ } -+} -+ -+static inline void nt_spin_unlock(NT_SPIN_LOCK *lock) -+{ -+ unsigned long lockval = xchg(lock, NT_SPIN_LOCK_UNLOCKED); -+ -+ if (likely(lockval == NT_SPIN_LOCK_LOCKED)) -+ return; -+ WARNING("unlocking unlocked spinlock: 0x%lx at %p", lockval, lock); -+} -+ -+#else // CONFIG_SMP -+ -+#define nt_spin_lock(lock) do { } while (0) -+ -+#define nt_spin_unlock(lock) do { } while (0) -+ -+#endif // CONFIG_SMP -+ -+/* When kernel would've disabled preempt (e.g., in interrupt -+ * handlers), we need to fake preempt so driver thinks it is running -+ * at right IRQL */ -+ -+/* raise IRQL to given (higher) IRQL if necessary before locking */ -+static inline KIRQL nt_spin_lock_irql(NT_SPIN_LOCK *lock, KIRQL newirql) -+{ -+ KIRQL oldirql = raise_irql(newirql); -+ nt_spin_lock(lock); -+ return oldirql; -+} -+ -+/* lower IRQL to given (lower) IRQL if necessary after unlocking */ -+static inline void nt_spin_unlock_irql(NT_SPIN_LOCK *lock, KIRQL oldirql) -+{ -+ nt_spin_unlock(lock); -+ lower_irql(oldirql); -+} -+ -+#define nt_spin_lock_irqsave(lock, flags) \ -+do { \ -+ local_irq_save(flags); \ -+ preempt_disable(); \ -+ nt_spin_lock(lock); \ -+} while (0) -+ -+#define nt_spin_unlock_irqrestore(lock, flags) \ -+do { \ -+ nt_spin_unlock(lock); \ -+ preempt_enable(); \ -+ local_irq_restore(flags); \ -+} while (0) -+ -+static inline ULONG SPAN_PAGES(void *ptr, SIZE_T length) -+{ -+ return PAGE_ALIGN(((unsigned long)ptr & (PAGE_SIZE - 1)) + length) -+ >> PAGE_SHIFT; -+} -+ -+#ifdef CONFIG_X86_64 -+ -+/* TODO: can these be implemented without using spinlock? */ -+ -+static inline struct nt_slist *PushEntrySList(nt_slist_header *head, -+ struct nt_slist *entry, -+ NT_SPIN_LOCK *lock) -+{ -+ KIRQL irql = nt_spin_lock_irql(lock, DISPATCH_LEVEL); -+ entry->next = head->next; -+ head->next = entry; -+ head->depth++; -+ nt_spin_unlock_irql(lock, irql); -+ TRACE4("%p, %p, %p", head, entry, entry->next); -+ return entry->next; -+} -+ -+static inline struct nt_slist *PopEntrySList(nt_slist_header *head, -+ NT_SPIN_LOCK *lock) -+{ -+ struct nt_slist *entry; -+ KIRQL irql = nt_spin_lock_irql(lock, DISPATCH_LEVEL); -+ entry = head->next; -+ if (entry) { -+ head->next = entry->next; -+ head->depth--; -+ } -+ nt_spin_unlock_irql(lock, irql); -+ TRACE4("%p, %p", head, entry); -+ return entry; -+} -+ -+#else -+ -+#define u64_low_32(x) ((u32)x) -+#define u64_high_32(x) ((u32)(x >> 32)) -+ -+static inline u64 nt_cmpxchg8b(volatile u64 *ptr, u64 old, u64 new) -+{ -+ u64 prev; -+ -+ __asm__ __volatile__( -+ "\n" -+ LOCK_PREFIX "cmpxchg8b %0\n" -+ : "+m" (*ptr), "=A" (prev) -+ : "A" (old), "b" (u64_low_32(new)), "c" (u64_high_32(new))); -+ return prev; -+} -+ -+/* slist routines below update slist atomically - no need for -+ * spinlocks */ -+ -+static inline struct nt_slist *PushEntrySList(nt_slist_header *head, -+ struct nt_slist *entry, -+ NT_SPIN_LOCK *lock) -+{ -+ nt_slist_header old, new; -+ do { -+ old.align = head->align; -+ entry->next = old.next; -+ new.next = entry; -+ new.depth = old.depth + 1; -+ } while (nt_cmpxchg8b(&head->align, old.align, new.align) != old.align); -+ TRACE4("%p, %p, %p", head, entry, old.next); -+ return old.next; -+} -+ -+static inline struct nt_slist *PopEntrySList(nt_slist_header *head, -+ NT_SPIN_LOCK *lock) -+{ -+ struct nt_slist *entry; -+ nt_slist_header old, new; -+ do { -+ old.align = head->align; -+ entry = old.next; -+ if (!entry) -+ break; -+ new.next = entry->next; -+ new.depth = old.depth - 1; -+ } while (nt_cmpxchg8b(&head->align, old.align, new.align) != old.align); -+ TRACE4("%p, %p", head, entry); -+ return entry; -+} -+ -+#endif -+ -+#define sleep_hz(n) \ -+do { \ -+ set_current_state(TASK_INTERRUPTIBLE); \ -+ schedule_timeout(n); \ -+} while (0) -+ -+int ntoskernel_init(void); -+void ntoskernel_exit(void); -+int ntoskernel_init_device(struct wrap_device *wd); -+void ntoskernel_exit_device(struct wrap_device *wd); -+void *allocate_object(ULONG size, enum common_object_type type, -+ struct unicode_string *name); -+ -+#ifdef ENABLE_USB -+int usb_init(void); -+void usb_exit(void); -+#else -+static inline int usb_init(void) { return 0; } -+static inline void usb_exit(void) {} -+#endif -+int usb_init_device(struct wrap_device *wd); -+void usb_exit_device(struct wrap_device *wd); -+ -+int wrap_procfs_init(void); -+void wrap_procfs_remove(void); -+ -+int link_pe_images(struct pe_image *pe_image, unsigned short n); -+ -+int stricmp(const char *s1, const char *s2); -+void dump_bytes(const char *name, const u8 *from, int len); -+struct mdl *allocate_init_mdl(void *virt, ULONG length); -+void free_mdl(struct mdl *mdl); -+struct driver_object *find_bus_driver(const char *name); -+void free_custom_extensions(struct driver_extension *drv_obj_ext); -+struct nt_thread *get_current_nt_thread(void); -+u64 ticks_1601(void); -+int schedule_ntos_work_item(NTOS_WORK_FUNC func, void *arg1, void *arg2); -+void wrap_init_timer(struct nt_timer *nt_timer, enum timer_type type, -+ struct ndis_mp_block *nmb); -+BOOLEAN wrap_set_timer(struct nt_timer *nt_timer, unsigned long expires_hz, -+ unsigned long repeat_hz, struct kdpc *kdpc); -+ -+LONG InterlockedDecrement(LONG volatile *val) wfastcall; -+LONG InterlockedIncrement(LONG volatile *val) wfastcall; -+struct nt_list *ExInterlockedInsertHeadList -+ (struct nt_list *head, struct nt_list *entry, -+ NT_SPIN_LOCK *lock) wfastcall; -+struct nt_list *ExInterlockedInsertTailList -+ (struct nt_list *head, struct nt_list *entry, -+ NT_SPIN_LOCK *lock) wfastcall; -+struct nt_list *ExInterlockedRemoveHeadList -+ (struct nt_list *head, NT_SPIN_LOCK *lock) wfastcall; -+NTSTATUS IofCallDriver(struct device_object *dev_obj, struct irp *irp) wfastcall; -+KIRQL KfRaiseIrql(KIRQL newirql) wfastcall; -+void KfLowerIrql(KIRQL oldirql) wfastcall; -+KIRQL KfAcquireSpinLock(NT_SPIN_LOCK *lock) wfastcall; -+void KfReleaseSpinLock(NT_SPIN_LOCK *lock, KIRQL oldirql) wfastcall; -+void IofCompleteRequest(struct irp *irp, CHAR prio_boost) wfastcall; -+void KefReleaseSpinLockFromDpcLevel(NT_SPIN_LOCK *lock) wfastcall; -+ -+LONG ObfReferenceObject(void *object) wfastcall; -+void ObfDereferenceObject(void *object) wfastcall; -+ -+#define ObReferenceObject(object) ObfReferenceObject(object) -+#define ObDereferenceObject(object) ObfDereferenceObject(object) -+ -+/* prevent expansion of ExAllocatePoolWithTag macro */ -+void *(ExAllocatePoolWithTag)(enum pool_type pool_type, SIZE_T size, -+ ULONG tag) wstdcall; -+ -+void ExFreePool(void *p) wstdcall; -+ULONG MmSizeOfMdl(void *base, ULONG length) wstdcall; -+void __iomem *MmMapIoSpace(PHYSICAL_ADDRESS phys_addr, SIZE_T size, -+ enum memory_caching_type cache) wstdcall; -+void MmUnmapIoSpace(void __iomem *addr, SIZE_T size) wstdcall; -+void MmProbeAndLockPages(struct mdl *mdl, KPROCESSOR_MODE access_mode, -+ enum lock_operation operation) wstdcall; -+void MmUnlockPages(struct mdl *mdl) wstdcall; -+void KeInitializeEvent(struct nt_event *nt_event, -+ enum event_type type, BOOLEAN state) wstdcall; -+LONG KeSetEvent(struct nt_event *nt_event, KPRIORITY incr, -+ BOOLEAN wait) wstdcall; -+LONG KeResetEvent(struct nt_event *nt_event) wstdcall; -+BOOLEAN queue_kdpc(struct kdpc *kdpc); -+BOOLEAN dequeue_kdpc(struct kdpc *kdpc); -+ -+NTSTATUS IoConnectInterrupt(struct kinterrupt **kinterrupt, -+ PKSERVICE_ROUTINE service_routine, -+ void *service_context, NT_SPIN_LOCK *lock, -+ ULONG vector, KIRQL irql, KIRQL synch_irql, -+ enum kinterrupt_mode interrupt_mode, -+ BOOLEAN shareable, KAFFINITY processor_enable_mask, -+ BOOLEAN floating_save) wstdcall; -+void IoDisconnectInterrupt(struct kinterrupt *interrupt) wstdcall; -+BOOLEAN KeSynchronizeExecution(struct kinterrupt *interrupt, -+ PKSYNCHRONIZE_ROUTINE synch_routine, -+ void *ctx) wstdcall; -+ -+NTSTATUS KeWaitForSingleObject(void *object, KWAIT_REASON reason, -+ KPROCESSOR_MODE waitmode, BOOLEAN alertable, -+ LARGE_INTEGER *timeout) wstdcall; -+void MmBuildMdlForNonPagedPool(struct mdl *mdl) wstdcall; -+NTSTATUS IoCreateDevice(struct driver_object *driver, ULONG dev_ext_length, -+ struct unicode_string *dev_name, DEVICE_TYPE dev_type, -+ ULONG dev_chars, BOOLEAN exclusive, -+ struct device_object **dev_obj) wstdcall; -+NTSTATUS IoCreateSymbolicLink(struct unicode_string *link, -+ struct unicode_string *dev_name) wstdcall; -+void IoDeleteDevice(struct device_object *dev) wstdcall; -+void IoDetachDevice(struct device_object *topdev) wstdcall; -+struct device_object *IoGetAttachedDevice(struct device_object *dev) wstdcall; -+struct device_object *IoGetAttachedDeviceReference -+ (struct device_object *dev) wstdcall; -+NTSTATUS IoAllocateDriverObjectExtension -+ (struct driver_object *drv_obj, void *client_id, ULONG extlen, -+ void **ext) wstdcall; -+void *IoGetDriverObjectExtension(struct driver_object *drv, -+ void *client_id) wstdcall; -+struct device_object *IoAttachDeviceToDeviceStack -+ (struct device_object *src, struct device_object *dst) wstdcall; -+BOOLEAN IoCancelIrp(struct irp *irp) wstdcall; -+struct irp *IoBuildSynchronousFsdRequest -+ (ULONG major_func, struct device_object *dev_obj, void *buf, -+ ULONG length, LARGE_INTEGER *offset, struct nt_event *event, -+ struct io_status_block *status) wstdcall; -+ -+NTSTATUS IoPassIrpDown(struct device_object *dev_obj, struct irp *irp) wstdcall; -+WIN_FUNC_DECL(IoPassIrpDown,2); -+NTSTATUS IoSyncForwardIrp(struct device_object *dev_obj, -+ struct irp *irp) wstdcall; -+NTSTATUS IoAsyncForwardIrp(struct device_object *dev_obj, -+ struct irp *irp) wstdcall; -+NTSTATUS IoInvalidDeviceRequest(struct device_object *dev_obj, -+ struct irp *irp) wstdcall; -+ -+void KeInitializeSpinLock(NT_SPIN_LOCK *lock) wstdcall; -+void IoAcquireCancelSpinLock(KIRQL *irql) wstdcall; -+void IoReleaseCancelSpinLock(KIRQL irql) wstdcall; -+ -+NTSTATUS RtlUnicodeStringToAnsiString -+ (struct ansi_string *dst, const struct unicode_string *src, -+ BOOLEAN dup) wstdcall; -+NTSTATUS RtlAnsiStringToUnicodeString -+ (struct unicode_string *dst, const struct ansi_string *src, -+ BOOLEAN dup) wstdcall; -+void RtlInitAnsiString(struct ansi_string *dst, const char *src) wstdcall; -+void RtlInitUnicodeString(struct unicode_string *dest, -+ const wchar_t *src) wstdcall; -+void RtlFreeUnicodeString(struct unicode_string *string) wstdcall; -+void RtlFreeAnsiString(struct ansi_string *string) wstdcall; -+LONG RtlCompareUnicodeString(const struct unicode_string *s1, -+ const struct unicode_string *s2, -+ BOOLEAN case_insensitive) wstdcall; -+NTSTATUS RtlUpcaseUnicodeString(struct unicode_string *dst, -+ struct unicode_string *src, -+ BOOLEAN alloc) wstdcall; -+BOOLEAN KeCancelTimer(struct nt_timer *nt_timer) wstdcall; -+void KeInitializeDpc(struct kdpc *kdpc, void *func, void *ctx) wstdcall; -+ -+extern spinlock_t ntoskernel_lock; -+extern spinlock_t irp_cancel_lock; -+extern struct nt_list object_list; -+extern CCHAR cpu_count; -+#ifdef CONFIG_X86_64 -+extern struct kuser_shared_data kuser_shared_data; -+#endif -+ -+#define IoCompleteRequest(irp, prio) IofCompleteRequest(irp, prio) -+#define IoCallDriver(dev, irp) IofCallDriver(dev, irp) -+ -+#if defined(IO_DEBUG) -+#define DUMP_IRP(_irp) \ -+do { \ -+ struct io_stack_location *_irp_sl; \ -+ _irp_sl = IoGetCurrentIrpStackLocation(_irp); \ -+ IOTRACE("irp: %p, stack size: %d, cl: %d, sl: %p, dev_obj: %p, " \ -+ "mj_fn: %d, minor_fn: %d, nt_urb: %p, event: %p", \ -+ _irp, _irp->stack_count, (_irp)->current_location, \ -+ _irp_sl, _irp_sl->dev_obj, _irp_sl->major_fn, \ -+ _irp_sl->minor_fn, IRP_URB(_irp), \ -+ (_irp)->user_event); \ -+} while (0) -+#else -+#define DUMP_IRP(_irp) do { } while (0) -+#endif -+ -+#endif // _NTOSKERNEL_H_ -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/ntoskernel_io.c linux-4.12.4-3rd/3rdparty/ndiswrapper/ntoskernel_io.c ---- linux-4.12.4/3rdparty/ndiswrapper/ntoskernel_io.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/ntoskernel_io.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,1161 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include "ntoskernel.h" -+#include "ndis.h" -+#include "wrapndis.h" -+#include "usb.h" -+#include "loader.h" -+#include "ntoskernel_io_exports.h" -+ -+wstdcall void WIN_FUNC(IoAcquireCancelSpinLock,1) -+ (KIRQL *irql) __acquires(irql) -+{ -+ spin_lock_bh(&irp_cancel_lock); -+ *irql = 0; -+} -+ -+wstdcall void WIN_FUNC(IoReleaseCancelSpinLock,1) -+ (KIRQL irql) __releases(irql) -+{ -+ spin_unlock_bh(&irp_cancel_lock); -+} -+ -+wstdcall int WIN_FUNC(IoIsWdmVersionAvailable,2) -+ (UCHAR major, UCHAR minor) -+{ -+ IOENTER("%d, %x", major, minor); -+ if (major == 1 && -+ (minor == 0x30 || // Windows 2003 -+ minor == 0x20 || // Windows XP -+ minor == 0x10)) // Windows 2000 -+ IOEXIT(return TRUE); -+ IOEXIT(return FALSE); -+} -+ -+wstdcall BOOLEAN WIN_FUNC(IoIs32bitProcess,1) -+ (struct irp *irp) -+{ -+#ifdef CONFIG_X86_64 -+ return FALSE; -+#else -+ return TRUE; -+#endif -+} -+ -+wstdcall void WIN_FUNC(IoInitializeIrp,3) -+ (struct irp *irp, USHORT size, CCHAR stack_count) -+{ -+ IOENTER("irp: %p, %d, %d", irp, size, stack_count); -+ -+ memset(irp, 0, size); -+ irp->size = size; -+ irp->stack_count = stack_count; -+ irp->current_location = stack_count; -+ IoGetCurrentIrpStackLocation(irp) = IRP_SL(irp, stack_count); -+ IOEXIT(return); -+} -+ -+wstdcall void WIN_FUNC(IoReuseIrp,2) -+ (struct irp *irp, NTSTATUS status) -+{ -+ IOENTER("%p, %d", irp, status); -+ if (irp) { -+ UCHAR alloc_flags; -+ -+ alloc_flags = irp->alloc_flags; -+ IoInitializeIrp(irp, irp->size, irp->stack_count); -+ irp->alloc_flags = alloc_flags; -+ irp->io_status.status = status; -+ } -+ IOEXIT(return); -+} -+ -+wstdcall struct irp *WIN_FUNC(IoAllocateIrp,2) -+ (char stack_count, BOOLEAN charge_quota) -+{ -+ struct irp *irp; -+ int irp_size; -+ -+ IOENTER("count: %d", stack_count); -+ stack_count++; -+ irp_size = IoSizeOfIrp(stack_count); -+ irp = kmalloc(irp_size, irql_gfp()); -+ if (irp) -+ IoInitializeIrp(irp, irp_size, stack_count); -+ IOTRACE("irp %p", irp); -+ IOEXIT(return irp); -+} -+ -+wstdcall BOOLEAN WIN_FUNC(IoCancelIrp,1) -+ (struct irp *irp) -+{ -+ typeof(irp->cancel_routine) cancel_routine; -+ -+ /* NB: this function may be called at DISPATCH_LEVEL */ -+ IOTRACE("irp: %p", irp); -+ if (!irp) -+ return FALSE; -+ DUMP_IRP(irp); -+ IoAcquireCancelSpinLock(&irp->cancel_irql); -+ cancel_routine = xchg(&irp->cancel_routine, NULL); -+ IOTRACE("%p", cancel_routine); -+ irp->cancel = TRUE; -+ if (cancel_routine) { -+ struct device_object *dev_obj; -+ -+ if (irp->current_location >= 0 && -+ irp->current_location < irp->stack_count) -+ dev_obj = IoGetCurrentIrpStackLocation(irp)->dev_obj; -+ else -+ dev_obj = NULL; -+ IOTRACE("current_location: %d, dev_obj: %p", -+ irp->current_location, dev_obj); -+ /* cancel_routine will release the spin lock */ -+ __release(irp->cancel_irql); -+ LIN2WIN2(cancel_routine, dev_obj, irp); -+ /* in usb's cancel, irp->cancel is set to indicate -+ * status of cancel */ -+ IOEXIT(return xchg(&irp->cancel, TRUE)); -+ } else { -+ IOTRACE("irp %p already canceled", irp); -+ IoReleaseCancelSpinLock(irp->cancel_irql); -+ IOEXIT(return FALSE); -+ } -+} -+ -+wstdcall void IoQueueThreadIrp(struct irp *irp) -+{ -+ struct nt_thread *thread; -+ KIRQL irql; -+ -+ thread = get_current_nt_thread(); -+ if (thread) { -+ IOTRACE("thread: %p, task: %p", thread, thread->task); -+ irp->flags |= IRP_SYNCHRONOUS_API; -+ irql = nt_spin_lock_irql(&thread->lock, DISPATCH_LEVEL); -+ InsertTailList(&thread->irps, &irp->thread_list); -+ IoIrpThread(irp) = thread; -+ nt_spin_unlock_irql(&thread->lock, irql); -+ } else -+ IoIrpThread(irp) = NULL; -+} -+ -+wstdcall void IoDequeueThreadIrp(struct irp *irp) -+{ -+ struct nt_thread *thread; -+ KIRQL irql; -+ -+ thread = IoIrpThread(irp); -+ if (thread) { -+ irql = nt_spin_lock_irql(&thread->lock, DISPATCH_LEVEL); -+ RemoveEntryList(&irp->thread_list); -+ nt_spin_unlock_irql(&thread->lock, irql); -+ } -+} -+ -+wstdcall void WIN_FUNC(IoFreeIrp,1) -+ (struct irp *irp) -+{ -+ IOENTER("irp = %p", irp); -+ if (!irp) { -+ WARNING("irp is NULL"); -+ return; -+ } -+ -+ if (irp->flags & IRP_SYNCHRONOUS_API) -+ IoDequeueThreadIrp(irp); -+ IoCancelIrp(irp); -+ kfree(irp); -+ -+ IOEXIT(return); -+} -+ -+wstdcall struct irp *WIN_FUNC(IoBuildAsynchronousFsdRequest,6) -+ (ULONG major_fn, struct device_object *dev_obj, void *buffer, -+ ULONG length, LARGE_INTEGER *offset, -+ struct io_status_block *user_status) -+{ -+ struct irp *irp; -+ struct io_stack_location *irp_sl; -+ -+ IOENTER("%p", dev_obj); -+ if (!dev_obj) -+ IOEXIT(return NULL); -+ irp = IoAllocateIrp(dev_obj->stack_count, FALSE); -+ if (irp == NULL) { -+ WARNING("couldn't allocate irp"); -+ IOEXIT(return NULL); -+ } -+ -+ irp_sl = IoGetNextIrpStackLocation(irp); -+ irp_sl->major_fn = major_fn; -+ IOTRACE("major_fn: %d", major_fn); -+ irp_sl->minor_fn = 0; -+ irp_sl->flags = 0; -+ irp_sl->control = 0; -+ irp_sl->dev_obj = dev_obj; -+ irp_sl->file_obj = NULL; -+ irp_sl->completion_routine = NULL; -+ -+ if (dev_obj->flags & DO_DIRECT_IO) { -+ irp->mdl = IoAllocateMdl(buffer, length, FALSE, FALSE, irp); -+ if (irp->mdl == NULL) { -+ IoFreeIrp(irp); -+ return NULL; -+ } -+ MmProbeAndLockPages(irp->mdl, KernelMode, -+ major_fn == IRP_MJ_WRITE ? -+ IoReadAccess : IoWriteAccess); -+ IOTRACE("mdl: %p", irp->mdl); -+ } else if (dev_obj->flags & DO_BUFFERED_IO) { -+ irp->associated_irp.system_buffer = buffer; -+ irp->flags = IRP_BUFFERED_IO; -+ irp->mdl = NULL; -+ IOTRACE("buffer: %p", buffer); -+ } -+ if (major_fn == IRP_MJ_READ) { -+ irp_sl->params.read.length = length; -+ irp_sl->params.read.byte_offset = *offset; -+ } else if (major_fn == IRP_MJ_WRITE) { -+ irp_sl->params.write.length = length; -+ irp_sl->params.write.byte_offset = *offset; -+ } -+ irp->user_status = user_status; -+ IOTRACE("irp: %p", irp); -+ return irp; -+} -+ -+wstdcall struct irp *WIN_FUNC(IoBuildSynchronousFsdRequest,7) -+ (ULONG major_fn, struct device_object *dev_obj, void *buf, -+ ULONG length, LARGE_INTEGER *offset, struct nt_event *event, -+ struct io_status_block *user_status) -+{ -+ struct irp *irp; -+ -+ irp = IoBuildAsynchronousFsdRequest(major_fn, dev_obj, buf, length, -+ offset, user_status); -+ if (irp == NULL) -+ return NULL; -+ irp->user_event = event; -+ IoQueueThreadIrp(irp); -+ return irp; -+} -+ -+wstdcall struct irp *WIN_FUNC(IoBuildDeviceIoControlRequest,9) -+ (ULONG ioctl, struct device_object *dev_obj, -+ void *input_buf, ULONG input_buf_len, void *output_buf, -+ ULONG output_buf_len, BOOLEAN internal_ioctl, -+ struct nt_event *event, struct io_status_block *io_status) -+{ -+ struct irp *irp; -+ struct io_stack_location *irp_sl; -+ ULONG buf_len; -+ -+ IOENTER("%p, 0x%08x, %d", dev_obj, ioctl, internal_ioctl); -+ if (!dev_obj) -+ IOEXIT(return NULL); -+ irp = IoAllocateIrp(dev_obj->stack_count, FALSE); -+ if (irp == NULL) { -+ WARNING("couldn't allocate irp"); -+ return NULL; -+ } -+ irp_sl = IoGetNextIrpStackLocation(irp); -+ irp_sl->params.dev_ioctl.code = ioctl; -+ irp_sl->params.dev_ioctl.input_buf_len = input_buf_len; -+ irp_sl->params.dev_ioctl.output_buf_len = output_buf_len; -+ irp_sl->major_fn = (internal_ioctl) ? -+ IRP_MJ_INTERNAL_DEVICE_CONTROL : IRP_MJ_DEVICE_CONTROL; -+ IOTRACE("%d", IO_METHOD_FROM_CTL_CODE(ioctl)); -+ -+ switch (IO_METHOD_FROM_CTL_CODE(ioctl)) { -+ case METHOD_BUFFERED: -+ buf_len = max(input_buf_len, output_buf_len); -+ if (buf_len) { -+ irp->associated_irp.system_buffer = -+ ExAllocatePoolWithTag(NonPagedPool, buf_len, 0); -+ if (!irp->associated_irp.system_buffer) { -+ IoFreeIrp(irp); -+ IOEXIT(return NULL); -+ } -+ irp->associated_irp.system_buffer = input_buf; -+ if (input_buf) -+ memcpy(irp->associated_irp.system_buffer, -+ input_buf, input_buf_len); -+ irp->flags = IRP_BUFFERED_IO | IRP_DEALLOCATE_BUFFER; -+ if (output_buf) -+ irp->flags = IRP_INPUT_OPERATION; -+ irp->user_buf = output_buf; -+ } else -+ irp->user_buf = NULL; -+ break; -+ case METHOD_IN_DIRECT: -+ case METHOD_OUT_DIRECT: -+ if (input_buf) { -+ irp->associated_irp.system_buffer = -+ ExAllocatePoolWithTag(NonPagedPool, -+ input_buf_len, 0); -+ if (!irp->associated_irp.system_buffer) { -+ IoFreeIrp(irp); -+ IOEXIT(return NULL); -+ } -+ memcpy(irp->associated_irp.system_buffer, -+ input_buf, input_buf_len); -+ irp->flags = IRP_BUFFERED_IO | IRP_DEALLOCATE_BUFFER; -+ } -+ /* TODO: we are supposed to setup MDL, but USB layer -+ * doesn't use MDLs. Moreover, USB layer mirrors -+ * non-DMAable buffers, so no need to allocate -+ * DMAable buffer here */ -+ if (output_buf) { -+ irp->associated_irp.system_buffer = -+ ExAllocatePoolWithTag(NonPagedPool, -+ output_buf_len, 0); -+ if (!irp->associated_irp.system_buffer) { -+ IoFreeIrp(irp); -+ IOEXIT(return NULL); -+ } -+ irp->flags = IRP_BUFFERED_IO | IRP_DEALLOCATE_BUFFER; -+ } -+ break; -+ case METHOD_NEITHER: -+ irp->user_buf = output_buf; -+ irp_sl->params.dev_ioctl.type3_input_buf = input_buf; -+ break; -+ } -+ -+ irp->user_status = io_status; -+ irp->user_event = event; -+ IoQueueThreadIrp(irp); -+ -+ IOTRACE("irp: %p", irp); -+ IOEXIT(return irp); -+} -+ -+wfastcall NTSTATUS WIN_FUNC(IofCallDriver,2) -+ (struct device_object *dev_obj, struct irp *irp) -+{ -+ struct io_stack_location *irp_sl; -+ NTSTATUS status; -+ driver_dispatch_t *major_func; -+ struct driver_object *drv_obj; -+ -+ if (irp->current_location <= 0) { -+ ERROR("invalid irp: %p, %d", irp, irp->current_location); -+ return STATUS_INVALID_PARAMETER; -+ } -+ IOTRACE("%p, %p, %p, %d, %d, %p", dev_obj, irp, dev_obj->drv_obj, -+ irp->current_location, irp->stack_count, -+ IoGetCurrentIrpStackLocation(irp)); -+ IoSetNextIrpStackLocation(irp); -+ DUMP_IRP(irp); -+ irp_sl = IoGetCurrentIrpStackLocation(irp); -+ drv_obj = dev_obj->drv_obj; -+ irp_sl->dev_obj = dev_obj; -+ major_func = drv_obj->major_func[irp_sl->major_fn]; -+ IOTRACE("major_func: %p, dev_obj: %p", major_func, dev_obj); -+ if (major_func) -+ status = LIN2WIN2(major_func, dev_obj, irp); -+ else { -+ ERROR("major_function %d is not implemented", -+ irp_sl->major_fn); -+ status = STATUS_NOT_SUPPORTED; -+ } -+ IOEXIT(return status); -+} -+ -+wfastcall void WIN_FUNC(IofCompleteRequest,2) -+ (struct irp *irp, CHAR prio_boost) -+{ -+ struct io_stack_location *irp_sl; -+ -+#ifdef IO_DEBUG -+ DUMP_IRP(irp); -+ if (irp->io_status.status == STATUS_PENDING) { -+ ERROR("invalid irp: %p, STATUS_PENDING", irp); -+ return; -+ } -+ if (irp->current_location < 0 || -+ irp->current_location >= irp->stack_count) { -+ ERROR("invalid irp: %p, %d", irp, irp->current_location); -+ return; -+ } -+#endif -+ for (irp_sl = IoGetCurrentIrpStackLocation(irp); -+ irp->current_location < irp->stack_count; irp_sl++) { -+ struct device_object *dev_obj; -+ NTSTATUS status; -+ -+ DUMP_IRP(irp); -+ if (irp_sl->control & SL_PENDING_RETURNED) -+ irp->pending_returned = TRUE; -+ -+ /* current_location and dev_obj must be same as when -+ * driver called IoSetCompletionRoutine, which sets -+ * completion routine at next (lower) location, which -+ * is what we are going to call below; so we set -+ * current_location and dev_obj for the previous -+ * (higher) location */ -+ IoSkipCurrentIrpStackLocation(irp); -+ if (irp->current_location < irp->stack_count) -+ dev_obj = IoGetCurrentIrpStackLocation(irp)->dev_obj; -+ else -+ dev_obj = NULL; -+ -+ IOTRACE("%d, %d, %p", irp->current_location, irp->stack_count, -+ dev_obj); -+ if (irp_sl->completion_routine && -+ ((irp->io_status.status == STATUS_SUCCESS && -+ irp_sl->control & SL_INVOKE_ON_SUCCESS) || -+ (irp->io_status.status != STATUS_SUCCESS && -+ irp_sl->control & SL_INVOKE_ON_ERROR) || -+ (irp->cancel == TRUE && -+ irp_sl->control & SL_INVOKE_ON_CANCEL))) { -+ IOTRACE("calling completion_routine at: %p, %p", -+ irp_sl->completion_routine, irp_sl->context); -+ status = LIN2WIN3(irp_sl->completion_routine, -+ dev_obj, irp, irp_sl->context); -+ IOTRACE("status: %08X", status); -+ if (status == STATUS_MORE_PROCESSING_REQUIRED) -+ IOEXIT(return); -+ } else { -+ /* propagate pending status to next irp_sl */ -+ if (irp->pending_returned && -+ irp->current_location < irp->stack_count) -+ IoMarkIrpPending(irp); -+ } -+ } -+ -+ if (irp->user_status) { -+ irp->user_status->status = irp->io_status.status; -+ irp->user_status->info = irp->io_status.info; -+ } -+ -+ if (irp->user_event) { -+ IOTRACE("setting event %p", irp->user_event); -+ KeSetEvent(irp->user_event, prio_boost, FALSE); -+ } -+ -+ if (irp->associated_irp.system_buffer && -+ (irp->flags & IRP_DEALLOCATE_BUFFER)) -+ ExFreePool(irp->associated_irp.system_buffer); -+ else { -+ struct mdl *mdl; -+ while ((mdl = irp->mdl)) { -+ irp->mdl = mdl->next; -+ MmUnlockPages(mdl); -+ IoFreeMdl(mdl); -+ } -+ } -+ IOTRACE("freeing irp %p", irp); -+ IoFreeIrp(irp); -+ IOEXIT(return); -+} -+ -+wstdcall NTSTATUS IoPassIrpDown(struct device_object *dev_obj, struct irp *irp) -+{ -+ IoSkipCurrentIrpStackLocation(irp); -+ IOEXIT(return IoCallDriver(dev_obj, irp)); -+} -+ -+wstdcall NTSTATUS IoIrpSyncComplete(struct device_object *dev_obj, -+ struct irp *irp, void *context) -+{ -+ if (irp->pending_returned == TRUE) -+ KeSetEvent(context, IO_NO_INCREMENT, FALSE); -+ IOEXIT(return STATUS_MORE_PROCESSING_REQUIRED); -+} -+WIN_FUNC_DECL(IoIrpSyncComplete,3) -+ -+wstdcall NTSTATUS IoSyncForwardIrp(struct device_object *dev_obj, -+ struct irp *irp) -+{ -+ struct nt_event event; -+ NTSTATUS status; -+ -+ IoCopyCurrentIrpStackLocationToNext(irp); -+ KeInitializeEvent(&event, SynchronizationEvent, FALSE); -+ /* completion function is called as Windows function */ -+ IoSetCompletionRoutine(irp, WIN_FUNC_PTR(IoIrpSyncComplete,3), &event, -+ TRUE, TRUE, TRUE); -+ status = IoCallDriver(dev_obj, irp); -+ IOTRACE("%08X", status); -+ if (status == STATUS_PENDING) { -+ KeWaitForSingleObject(&event, Executive, KernelMode, FALSE, -+ NULL); -+ status = irp->io_status.status; -+ } -+ IOTRACE("%08X", status); -+ IOEXIT(return status); -+} -+WIN_FUNC_DECL(IoSyncForwardIrp,2) -+ -+wstdcall NTSTATUS IoAsyncForwardIrp(struct device_object *dev_obj, -+ struct irp *irp) -+{ -+ NTSTATUS status; -+ -+ IoCopyCurrentIrpStackLocationToNext(irp); -+ status = IoCallDriver(dev_obj, irp); -+ IOEXIT(return status); -+} -+WIN_FUNC_DECL(IoAsyncForwardIrp,2) -+ -+wstdcall NTSTATUS IoInvalidDeviceRequest(struct device_object *dev_obj, -+ struct irp *irp) -+{ -+ struct io_stack_location *irp_sl; -+ NTSTATUS status; -+ -+ irp_sl = IoGetCurrentIrpStackLocation(irp); -+ WARNING("%d:%d not implemented", irp_sl->major_fn, irp_sl->minor_fn); -+ irp->io_status.status = STATUS_SUCCESS; -+ irp->io_status.info = 0; -+ status = irp->io_status.status; -+ IoCompleteRequest(irp, IO_NO_INCREMENT); -+ IOEXIT(return status); -+} -+WIN_FUNC_DECL(IoInvalidDeviceRequest,2) -+ -+static irqreturn_t io_irq_isr(int irq, void *data ISR_PT_REGS_PARAM_DECL) -+{ -+ struct kinterrupt *interrupt = data; -+ BOOLEAN ret; -+ -+#ifdef CONFIG_DEBUG_SHIRQ -+ if (!interrupt->u.enabled) -+ EXIT1(return IRQ_NONE); -+#endif -+ TRACE6("%p", interrupt); -+ nt_spin_lock(interrupt->actual_lock); -+ ret = LIN2WIN2(interrupt->isr, interrupt, interrupt->isr_ctx); -+ nt_spin_unlock(interrupt->actual_lock); -+ if (ret == TRUE) -+ EXIT6(return IRQ_HANDLED); -+ else -+ EXIT6(return IRQ_NONE); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoConnectInterrupt,11) -+ (struct kinterrupt **kinterrupt, PKSERVICE_ROUTINE isr, void *isr_ctx, -+ NT_SPIN_LOCK *lock, ULONG vector, KIRQL irql, KIRQL synch_irql, -+ enum kinterrupt_mode mode, BOOLEAN shared, KAFFINITY cpu_mask, -+ BOOLEAN save_fp) -+{ -+ struct kinterrupt *interrupt; -+ IOENTER(""); -+ interrupt = kzalloc(sizeof(*interrupt), GFP_KERNEL); -+ if (!interrupt) -+ IOEXIT(return STATUS_INSUFFICIENT_RESOURCES); -+ interrupt->vector = vector; -+ interrupt->cpu_mask = cpu_mask; -+ nt_spin_lock_init(&interrupt->lock); -+ if (lock) -+ interrupt->actual_lock = lock; -+ else -+ interrupt->actual_lock = &interrupt->lock; -+ interrupt->shared = shared; -+ interrupt->save_fp = save_fp; -+ interrupt->isr = isr; -+ interrupt->isr_ctx = isr_ctx; -+ InitializeListHead(&interrupt->list); -+ interrupt->irql = irql; -+ interrupt->synch_irql = synch_irql; -+ interrupt->mode = mode; -+ if (request_irq(vector, io_irq_isr, shared ? IRQF_SHARED : 0, -+ DRIVER_NAME, interrupt)) { -+ WARNING("request for irq %d failed", vector); -+ kfree(interrupt); -+ IOEXIT(return STATUS_INSUFFICIENT_RESOURCES); -+ } -+ *kinterrupt = interrupt; -+#ifdef CONFIG_DEBUG_SHIRQ -+ interrupt->u.enabled = 1; -+#endif -+ IOEXIT(return STATUS_SUCCESS); -+} -+ -+wstdcall void WIN_FUNC(IoDisconnectInterrupt,1) -+ (struct kinterrupt *interrupt) -+{ -+#ifdef CONFIG_DEBUG_SHIRQ -+ interrupt->u.enabled = 0; -+#endif -+ free_irq(interrupt->vector, interrupt); -+ kfree(interrupt); -+} -+ -+wstdcall struct mdl *WIN_FUNC(IoAllocateMdl,5) -+ (void *virt, ULONG length, BOOLEAN second_buf, BOOLEAN charge_quota, -+ struct irp *irp) -+{ -+ struct mdl *mdl; -+ mdl = allocate_init_mdl(virt, length); -+ if (!mdl) -+ return NULL; -+ if (irp) { -+ if (second_buf == TRUE) { -+ struct mdl *last; -+ -+ last = irp->mdl; -+ while (last->next) -+ last = last->next; -+ last->next = mdl; -+ } else -+ irp->mdl = mdl; -+ } -+ IOTRACE("%p", mdl); -+ return mdl; -+} -+ -+wstdcall void WIN_FUNC(IoFreeMdl,1) -+ (struct mdl *mdl) -+{ -+ IOTRACE("%p", mdl); -+ free_mdl(mdl); -+} -+ -+wstdcall struct io_workitem *WIN_FUNC(IoAllocateWorkItem,1) -+ (struct device_object *dev_obj) -+{ -+ struct io_workitem *io_workitem; -+ -+ IOENTER("%p", dev_obj); -+ io_workitem = kmalloc(sizeof(*io_workitem), irql_gfp()); -+ if (!io_workitem) -+ IOEXIT(return NULL); -+ io_workitem->dev_obj = dev_obj; -+ IOEXIT(return io_workitem); -+} -+ -+wstdcall void WIN_FUNC(IoFreeWorkItem,1) -+ (struct io_workitem *io_workitem) -+{ -+ kfree(io_workitem); -+ IOEXIT(return); -+} -+ -+wstdcall void WIN_FUNC(IoQueueWorkItem,4) -+ (struct io_workitem *io_workitem, void *func, -+ enum work_queue_type queue_type, void *context) -+{ -+ IOENTER("%p, %p", io_workitem, io_workitem->dev_obj); -+ io_workitem->worker_routine = func; -+ io_workitem->context = context; -+ schedule_ntos_work_item(func, io_workitem->dev_obj, context); -+ IOEXIT(return); -+} -+ -+wstdcall void WIN_FUNC(ExQueueWorkItem,2) -+ (struct io_workitem *io_workitem, enum work_queue_type queue_type) -+{ -+ IOENTER("%p", io_workitem); -+ schedule_ntos_work_item(io_workitem->worker_routine, -+ io_workitem->dev_obj, io_workitem->context); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoAllocateDriverObjectExtension,4) -+ (struct driver_object *drv_obj, void *client_id, ULONG extlen, -+ void **ext) -+{ -+ struct custom_ext *ce; -+ -+ IOENTER("%p, %p", drv_obj, client_id); -+ ce = kmalloc(sizeof(*ce) + extlen, irql_gfp()); -+ if (ce == NULL) -+ return STATUS_INSUFFICIENT_RESOURCES; -+ -+ IOTRACE("custom_ext: %p", ce); -+ ce->client_id = client_id; -+ spin_lock_bh(&ntoskernel_lock); -+ InsertTailList(&drv_obj->drv_ext->custom_ext, &ce->list); -+ spin_unlock_bh(&ntoskernel_lock); -+ -+ *ext = (void *)ce + sizeof(*ce); -+ IOTRACE("ext: %p", *ext); -+ IOEXIT(return STATUS_SUCCESS); -+} -+ -+wstdcall void *WIN_FUNC(IoGetDriverObjectExtension,2) -+ (struct driver_object *drv_obj, void *client_id) -+{ -+ struct custom_ext *ce; -+ void *ret; -+ -+ IOENTER("drv_obj: %p, client_id: %p", drv_obj, client_id); -+ ret = NULL; -+ spin_lock_bh(&ntoskernel_lock); -+ nt_list_for_each_entry(ce, &drv_obj->drv_ext->custom_ext, list) { -+ if (ce->client_id == client_id) { -+ ret = (void *)ce + sizeof(*ce); -+ break; -+ } -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ IOTRACE("ret: %p", ret); -+ return ret; -+} -+ -+void free_custom_extensions(struct driver_extension *drv_ext) -+{ -+ struct nt_list *ent; -+ -+ IOENTER("%p", drv_ext); -+ spin_lock_bh(&ntoskernel_lock); -+ while ((ent = RemoveHeadList(&drv_ext->custom_ext))) -+ kfree(ent); -+ spin_unlock_bh(&ntoskernel_lock); -+ IOEXIT(return); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoCreateDevice,7) -+ (struct driver_object *drv_obj, ULONG dev_ext_length, -+ struct unicode_string *dev_name, DEVICE_TYPE dev_type, -+ ULONG dev_chars, BOOLEAN exclusive, struct device_object **newdev) -+{ -+ struct device_object *dev; -+ struct dev_obj_ext *dev_obj_ext; -+ int size; -+ -+ IOENTER("%p, %u, %p", drv_obj, dev_ext_length, dev_name); -+ -+ size = sizeof(*dev) + dev_ext_length + sizeof(*dev_obj_ext); -+ dev = allocate_object(size, OBJECT_TYPE_DEVICE, dev_name); -+ if (!dev) -+ IOEXIT(return STATUS_INSUFFICIENT_RESOURCES); -+ if (dev_ext_length) -+ dev->dev_ext = dev + 1; -+ else -+ dev->dev_ext = NULL; -+ -+ dev_obj_ext = ((void *)(dev + 1)) + dev_ext_length; -+ dev_obj_ext->dev_obj = dev; -+ dev_obj_ext->size = 0; -+ dev_obj_ext->type = IO_TYPE_DEVICE; -+ dev->dev_obj_ext = dev_obj_ext; -+ -+ dev->type = dev_type; -+ dev->flags = 0; -+ dev->size = sizeof(*dev) + dev_ext_length; -+ dev->ref_count = 1; -+ dev->attached = NULL; -+ dev->stack_count = 1; -+ -+ dev->drv_obj = drv_obj; -+ dev->next = drv_obj->dev_obj; -+ drv_obj->dev_obj = dev; -+ -+ dev->align_req = 1; -+ dev->characteristics = dev_chars; -+ dev->io_timer = NULL; -+ KeInitializeEvent(&dev->lock, SynchronizationEvent, TRUE); -+ dev->vpb = NULL; -+ -+ IOTRACE("dev: %p, ext: %p", dev, dev->dev_ext); -+ *newdev = dev; -+ IOEXIT(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoCreateUnprotectedSymbolicLink,2) -+ (struct unicode_string *link, struct unicode_string *dev_name) -+{ -+ struct ansi_string ansi; -+ -+ IOENTER("%p, %p", dev_name, link); -+ if (dev_name && (RtlUnicodeStringToAnsiString(&ansi, dev_name, TRUE) == -+ STATUS_SUCCESS)) { -+ IOTRACE("dev_name: %s", ansi.buf); -+ RtlFreeAnsiString(&ansi); -+ } -+ if (link && (RtlUnicodeStringToAnsiString(&ansi, link, TRUE) == -+ STATUS_SUCCESS)) { -+ IOTRACE("link: %s", ansi.buf); -+ RtlFreeAnsiString(&ansi); -+ } -+// TODO(); -+ IOEXIT(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoCreateSymbolicLink,2) -+ (struct unicode_string *link, struct unicode_string *dev_name) -+{ -+ IOEXIT(return IoCreateUnprotectedSymbolicLink(link, dev_name)); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoDeleteSymbolicLink,1) -+ (struct unicode_string *link) -+{ -+ struct ansi_string ansi; -+ -+ IOENTER("%p", link); -+ if (link && (RtlUnicodeStringToAnsiString(&ansi, link, TRUE) == -+ STATUS_SUCCESS)) { -+ IOTRACE("dev_name: %s", ansi.buf); -+ RtlFreeAnsiString(&ansi); -+ } -+ IOEXIT(return STATUS_SUCCESS); -+} -+ -+wstdcall void WIN_FUNC(IoDeleteDevice,1) -+ (struct device_object *dev) -+{ -+ IOENTER("%p", dev); -+ if (dev == NULL) -+ IOEXIT(return); -+ IOTRACE("drv_obj: %p", dev->drv_obj); -+ if (dev->drv_obj) { -+ struct device_object *prev; -+ -+ prev = dev->drv_obj->dev_obj; -+ IOTRACE("dev_obj: %p", prev); -+ if (prev == dev) -+ dev->drv_obj->dev_obj = dev->next; -+ else if (prev) { -+ while (prev->next != dev) -+ prev = prev->next; -+ prev->next = dev->next; -+ } -+ } -+ ObDereferenceObject(dev); -+ IOEXIT(return); -+} -+ -+wstdcall void WIN_FUNC(IoDetachDevice,1) -+ (struct device_object *tgt) -+{ -+ struct device_object *tail; -+ -+ IOENTER("%p", tgt); -+ if (!tgt) -+ IOEXIT(return); -+ tail = tgt->attached; -+ if (!tail) -+ IOEXIT(return); -+ IOTRACE("tail: %p", tail); -+ -+ spin_lock_bh(&ntoskernel_lock); -+ tgt->attached = tail->attached; -+ IOTRACE("attached:%p", tgt->attached); -+ for ( ; tail; tail = tail->attached) { -+ IOTRACE("tail:%p", tail); -+ tail->stack_count--; -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ IOEXIT(return); -+} -+ -+wstdcall struct device_object *WIN_FUNC(IoGetAttachedDevice,1) -+ (struct device_object *dev) -+{ -+ IOENTER("%p", dev); -+ if (!dev) -+ IOEXIT(return NULL); -+ spin_lock_bh(&ntoskernel_lock); -+ while (dev->attached) -+ dev = dev->attached; -+ spin_unlock_bh(&ntoskernel_lock); -+ IOEXIT(return dev); -+} -+ -+wstdcall struct device_object *WIN_FUNC(IoGetAttachedDeviceReference,1) -+ (struct device_object *dev) -+{ -+ IOENTER("%p", dev); -+ if (!dev) -+ IOEXIT(return NULL); -+ dev = IoGetAttachedDevice(dev); -+ ObReferenceObject(dev); -+ IOEXIT(return dev); -+} -+ -+wstdcall struct device_object *WIN_FUNC(IoAttachDeviceToDeviceStack,2) -+ (struct device_object *src, struct device_object *tgt) -+{ -+ struct device_object *attached; -+ struct dev_obj_ext *src_dev_ext; -+ -+ IOENTER("%p, %p", src, tgt); -+ attached = IoGetAttachedDevice(tgt); -+ IOTRACE("%p", attached); -+ src_dev_ext = src->dev_obj_ext; -+ spin_lock_bh(&ntoskernel_lock); -+ if (attached) -+ attached->attached = src; -+ src->attached = NULL; -+ src->stack_count = attached->stack_count + 1; -+ src_dev_ext->attached_to = attached; -+ spin_unlock_bh(&ntoskernel_lock); -+ IOTRACE("stack_count: %d -> %d", attached->stack_count, -+ src->stack_count); -+ IOEXIT(return attached); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoGetDeviceProperty,5) -+ (struct device_object *pdo, enum device_registry_property dev_property, -+ ULONG buffer_len, void *buffer, ULONG *result_len) -+{ -+ struct ansi_string ansi; -+ struct unicode_string unicode; -+ struct wrap_device *wd; -+ ULONG need; -+ -+ IOENTER("dev_obj = %p, dev_property = %d, buffer_len = %u, " -+ "buffer = %p, result_len = %p", pdo, dev_property, -+ buffer_len, buffer, result_len); -+ -+ wd = pdo->reserved; -+ switch (dev_property) { -+ case DevicePropertyDeviceDescription: -+ case DevicePropertyFriendlyName: -+ case DevicePropertyDriverKeyName: -+ if (wrap_is_pci_bus(wd->dev_bus)) -+ RtlInitAnsiString(&ansi, "PCI"); -+ else // if (wrap_is_usb_bus(wd->dev_bus)) -+ RtlInitAnsiString(&ansi, "USB"); -+ need = sizeof(wchar_t) * (ansi.max_length + 1); -+ if (buffer_len < need) { -+ *result_len = need; -+ IOEXIT(return STATUS_BUFFER_TOO_SMALL); -+ } -+ unicode.max_length = buffer_len; -+ unicode.buf = buffer; -+ if (RtlAnsiStringToUnicodeString(&unicode, &ansi, -+ FALSE) != STATUS_SUCCESS) { -+ *result_len = unicode.length; -+ IOEXIT(return STATUS_BUFFER_TOO_SMALL); -+ } -+ IOEXIT(return STATUS_SUCCESS); -+ default: -+ WARNING("%d not implemented", dev_property); -+ IOEXIT(return STATUS_INVALID_PARAMETER_2); -+ } -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoGetDeviceObjectPointer,4) -+ (struct unicode_string *name, ACCESS_MASK desired_access, -+ struct file_object *file_obj, struct device_object *dev_obj) -+{ -+ struct common_object_header *coh; -+ -+ dev_obj = NULL; -+ /* TODO: access is not checked and file_obj is filled with zeroes */ -+ spin_lock_bh(&ntoskernel_lock); -+ nt_list_for_each_entry(coh, &object_list, list) { -+ TRACE5("header: %p, type: %d", coh, coh->type); -+ if (coh->type != OBJECT_TYPE_DEVICE) -+ continue; -+ if (!RtlCompareUnicodeString(&coh->name, name, TRUE)) { -+ dev_obj = HEADER_TO_OBJECT(coh); -+ TRACE5("dev_obj: %p", dev_obj); -+ break; -+ } -+ } -+ spin_unlock_bh(&ntoskernel_lock); -+ if (dev_obj) { -+ memset(file_obj, 0, sizeof(*file_obj)); -+ WARNING("file_obj filled with zeroes"); -+ IOEXIT(return STATUS_SUCCESS); -+ } else -+ IOEXIT(return STATUS_OBJECT_NAME_INVALID); -+} -+ -+/* NOTE: Make sure to compile with -freg-struct-return, so gcc will -+ * return union in register, like Windows */ -+wstdcall union power_state WIN_FUNC(PoSetPowerState,3) -+ (struct device_object *dev_obj, enum power_state_type type, -+ union power_state state) -+{ -+ IOEXIT(return state); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(PoCallDriver,2) -+ (struct device_object *dev_obj, struct irp *irp) -+{ -+ return IoCallDriver(dev_obj, irp); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(PoRequestPowerIrp,6) -+ (struct device_object *dev_obj, UCHAR minor_fn, -+ union power_state power_state, void *completion_func, -+ void *context, struct irp **pirp) -+{ -+ struct irp *irp; -+ struct io_stack_location *irp_sl; -+ -+ TRACE1("%p, %d, %p", dev_obj, dev_obj->stack_count, dev_obj->drv_obj); -+ irp = IoAllocateIrp(dev_obj->stack_count, FALSE); -+ if (!irp) -+ return STATUS_INSUFFICIENT_RESOURCES; -+ irp_sl = IoGetNextIrpStackLocation(irp); -+ irp_sl->major_fn = IRP_MJ_POWER; -+ irp_sl->minor_fn = minor_fn; -+ if (minor_fn == IRP_MN_WAIT_WAKE) -+ irp_sl->params.power.type = SystemPowerState; -+ else -+ irp_sl->params.power.type = DevicePowerState; -+ irp_sl->params.power.state = power_state; -+ irp_sl->completion_routine = completion_func; -+ irp->io_status.status = STATUS_NOT_SUPPORTED; -+ *pirp = irp; -+ return PoCallDriver(dev_obj, irp); -+} -+ -+wstdcall void WIN_FUNC(PoStartNextPowerIrp,1) -+ (struct irp *irp) -+{ -+ IOENTER("irp = %p", irp); -+ IOEXIT(return); -+} -+ -+wstdcall void WIN_FUNC(IoInitializeRemoveLockEx,5) -+ (struct io_remove_lock *lock, ULONG alloc_tag, ULONG max_locked_min, -+ ULONG high_mark, ULONG lock_size) -+{ -+ TODO(); -+} -+ -+wstdcall void *WIN_FUNC(IoAllocateErrorLogEntry,2) -+ (void *io_object, UCHAR entry_size) -+{ -+ /* not implemented fully */ -+ void *ret = kmalloc(sizeof(struct io_error_log_packet) + entry_size, -+ irql_gfp()); -+ TRACE2("%p", ret); -+ if (ret) -+ return ret + sizeof(struct io_error_log_packet); -+ else -+ return NULL; -+} -+ -+wstdcall void WIN_FUNC(IoWriteErrorLogEntry,1) -+ (void *entry) -+{ -+ /* TODO: log error with codes and message */ -+ ERROR(""); -+} -+ -+wstdcall void WIN_FUNC(IoFreeErrorLogEntry,1) -+ (void *entry) -+{ -+ TRACE2("%p", entry); -+ kfree(entry - sizeof(struct io_error_log_packet)); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoAcquireRemoveLockEx,5) -+ (struct io_remove_lock *lock, void *tag, char *file, ULONG line, -+ ULONG lock_size) -+{ -+ TODO(); -+ IOEXIT(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoReleaseRemoveLockEx,3) -+ (struct io_remove_lock *lock, void *tag, ULONG lock_size) -+{ -+ TODO(); -+ IOEXIT(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoRegisterDeviceInterface,4) -+ (struct device_object *pdo, struct guid *guid_class, -+ struct unicode_string *reference, struct unicode_string *link) -+{ -+ struct ansi_string ansi; -+ -+ /* TODO: check if pdo is valid */ -+ RtlInitAnsiString(&ansi, "ndis"); -+ ENTER1("pdo: %p, ref: %p, link: %p, %x, %x, %x", pdo, reference, link, -+ guid_class->data1, guid_class->data2, guid_class->data3); -+ return RtlAnsiStringToUnicodeString(link, &ansi, TRUE); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoSetDeviceInterfaceState,2) -+ (struct unicode_string *link, BOOLEAN enable) -+{ -+ ENTER1("link: %p, enable: %d", link, enable); -+ return STATUS_SUCCESS; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoOpenDeviceRegistryKey,4) -+ (struct device_object *dev_obj, ULONG type, ACCESS_MASK mask, -+ void **handle) -+{ -+ ENTER1("dev_obj: %p", dev_obj); -+ *handle = dev_obj; -+ return STATUS_SUCCESS; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoWMIRegistrationControl,2) -+ (struct device_object *dev_obj, ULONG action) -+{ -+ ENTER2("%p, %d", dev_obj, action); -+ EXIT2(return STATUS_SUCCESS); -+} -+ -+wstdcall void WIN_FUNC(IoInvalidateDeviceRelations,2) -+ (struct device_object *dev_obj, enum device_relation_type type) -+{ -+ INFO("%p, %d", dev_obj, type); -+ TODO(); -+} -+ -+wstdcall void WIN_FUNC(IoInvalidateDeviceState,1) -+ (struct device_object *pdo) -+{ -+ INFO("%p", pdo); -+ TODO(); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoRegisterPlugPlayNotification,7) -+ (UINT category, ULONG flags, void *data, struct driver_object *object, -+ void *callback, void *context, void **notification_entry) -+{ -+ TRACE2("category: %d, flags 0x%x, data: %p, object: %p, callback: %p, " -+ "context: %p, notification_entry: %p", category, flags, data, -+ object, callback, context, notification_entry); -+ TODO(); -+ IOEXIT(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoUnregisterPlugPlayNotification,1) -+ (void *notification_entry) -+{ -+ TRACE2("%p", notification_entry); -+ TODO(); -+ IOEXIT(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoWMIOpenBlock,3) -+ (struct guid *guid, ULONG access, void *object) -+{ -+ TODO(); -+ IOEXIT(return STATUS_NOT_IMPLEMENTED); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(IoWMIQueryAllData,3) -+ (void *data_block_object, UINT *buffer_size, void *buffer) -+{ -+ TODO(); -+ IOEXIT(return STATUS_NOT_IMPLEMENTED); -+} -+ -+wstdcall void WIN_FUNC(IoGetStackLimits,2) -+ (ULONG_PTR *LowLimit, ULONG_PTR *HighLimit) -+{ -+ *LowLimit = (ULONG_PTR)&LowLimit & ~(THREAD_SIZE - 1); -+ *HighLimit = *LowLimit + THREAD_SIZE; -+ IOTRACE("LowLimit: 0x%lx, HighLimit: 0x%lx", *LowLimit, *HighLimit); -+ IOEXIT(return); -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/pe_linker.c linux-4.12.4-3rd/3rdparty/ndiswrapper/pe_linker.c ---- linux-4.12.4/3rdparty/ndiswrapper/pe_linker.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/pe_linker.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,600 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifdef TEST_LOADER -+ -+#include "usr_linker.h" -+ -+#else -+ -+#include -+#include -+ -+//#define DEBUGLINKER 2 -+ -+#include "ntoskernel.h" -+ -+#endif -+ -+struct pe_exports { -+ char *dll; -+ char *name; -+ generic_func addr; -+}; -+ -+static struct pe_exports pe_exports[40]; -+static int num_pe_exports; -+ -+#define RVA2VA(image, rva, type) (type)(ULONG_PTR)((void *)image + rva) -+#define CHECK_SZ(a,b) { if (sizeof(a) != b) { \ -+ ERROR("%s is bad, got %zd, expected %d", \ -+ #a , sizeof(a), (b)); return -EINVAL; } } -+ -+#if defined(DEBUGLINKER) && DEBUGLINKER > 0 -+#define DBGLINKER(fmt, ...) printk(KERN_INFO "%s (%s:%d): " fmt "\n", \ -+ DRIVER_NAME, __func__, \ -+ __LINE__ , ## __VA_ARGS__); -+static const char *image_directory_name[] = { -+ "EXPORT", -+ "IMPORT", -+ "RESOURCE", -+ "EXCEPTION", -+ "SECURITY", -+ "BASERELOC", -+ "DEBUG", -+ "COPYRIGHT", -+ "GLOBALPTR", -+ "TLS", -+ "LOAD_CONFIG", -+ "BOUND_IMPORT", -+ "IAT", -+ "DELAY_IMPORT", -+ "COM_DESCRIPTOR" }; -+#else -+#define DBGLINKER(fmt, ...) do { } while (0) -+#endif -+ -+#ifndef TEST_LOADER -+extern struct wrap_export ntoskernel_exports[], ntoskernel_io_exports[], -+ ndis_exports[], crt_exports[], hal_exports[], rtl_exports[]; -+#ifdef ENABLE_USB -+extern struct wrap_export usb_exports[]; -+#endif -+ -+static int get_export(char *name, generic_func *func) -+{ -+ int i, j; -+ -+ struct wrap_export *exports[] = { -+ ntoskernel_exports, -+ ntoskernel_io_exports, -+ ndis_exports, -+ crt_exports, -+ hal_exports, -+ rtl_exports, -+#ifdef ENABLE_USB -+ usb_exports, -+#endif -+ }; -+ -+ for (j = 0; j < ARRAY_SIZE(exports); j++) -+ for (i = 0; exports[j][i].name != NULL; i++) -+ if (strcmp(exports[j][i].name, name) == 0) { -+ *func = exports[j][i].func; -+ return 0; -+ } -+ -+ for (i = 0; i < num_pe_exports; i++) -+ if (strcmp(pe_exports[i].name, name) == 0) { -+ *func = pe_exports[i].addr; -+ return 0; -+ } -+ -+ return -1; -+} -+#endif // TEST_LOADER -+ -+static void *get_dll_init(char *name) -+{ -+ int i; -+ for (i = 0; i < num_pe_exports; i++) -+ if ((strcmp(pe_exports[i].dll, name) == 0) && -+ (strcmp(pe_exports[i].name, "DllInitialize") == 0)) -+ return (void *)pe_exports[i].addr; -+ return NULL; -+} -+ -+/* -+ * Find and validate the coff header -+ * -+ */ -+static int check_nt_hdr(IMAGE_NT_HEADERS *nt_hdr) -+{ -+ int i; -+ WORD attr; -+ PIMAGE_OPTIONAL_HEADER opt_hdr; -+ -+ /* Validate the "PE\0\0" signature */ -+ if (nt_hdr->Signature != IMAGE_NT_SIGNATURE) { -+ ERROR("is this driver file? bad signature %08x", -+ nt_hdr->Signature); -+ return -EINVAL; -+ } -+ -+ opt_hdr = &nt_hdr->OptionalHeader; -+ /* Make sure Image is PE32 or PE32+ */ -+#ifdef CONFIG_X86_64 -+ if (opt_hdr->Magic != IMAGE_NT_OPTIONAL_HDR64_MAGIC) { -+ ERROR("kernel is 64-bit, but Windows driver is not 64-bit;" -+ "bad magic: %04X", opt_hdr->Magic); -+ return -EINVAL; -+ } -+#else -+ if (opt_hdr->Magic != IMAGE_NT_OPTIONAL_HDR32_MAGIC) { -+ ERROR("kernel is 32-bit, but Windows driver is not 32-bit;" -+ "bad magic: %04X", opt_hdr->Magic); -+ return -EINVAL; -+ } -+#endif -+ -+ /* Validate the image for the current architecture. */ -+#ifdef CONFIG_X86_64 -+ if (nt_hdr->FileHeader.Machine != IMAGE_FILE_MACHINE_AMD64) { -+ ERROR("kernel is 64-bit, but Windows driver is not 64-bit;" -+ " (PE signature is %04X)", nt_hdr->FileHeader.Machine); -+ return -EINVAL; -+ } -+#else -+ if (nt_hdr->FileHeader.Machine != IMAGE_FILE_MACHINE_I386) { -+ ERROR("kernel is 32-bit, but Windows driver is not 32-bit;" -+ " (PE signature is %04X)", nt_hdr->FileHeader.Machine); -+ return -EINVAL; -+ } -+#endif -+ -+ /* Must have attributes */ -+#ifdef CONFIG_X86_64 -+ attr = IMAGE_FILE_EXECUTABLE_IMAGE | IMAGE_FILE_LARGE_ADDRESS_AWARE; -+#else -+ attr = IMAGE_FILE_EXECUTABLE_IMAGE | IMAGE_FILE_32BIT_MACHINE; -+#endif -+ if ((nt_hdr->FileHeader.Characteristics & attr) != attr) -+ return -EINVAL; -+ -+ /* Must be relocatable */ -+ attr = IMAGE_FILE_RELOCS_STRIPPED; -+ if ((nt_hdr->FileHeader.Characteristics & attr)) -+ return -EINVAL; -+ -+ /* Make sure we have at least one section */ -+ if (nt_hdr->FileHeader.NumberOfSections == 0) -+ return -EINVAL; -+ -+ if (opt_hdr->SectionAlignment < opt_hdr->FileAlignment) { -+ ERROR("alignment mismatch: section: 0x%x, file: 0x%x", -+ opt_hdr->SectionAlignment, opt_hdr->FileAlignment); -+ return -EINVAL; -+ } -+ -+ DBGLINKER("number of datadictionary entries %d", -+ opt_hdr->NumberOfRvaAndSizes); -+ for (i = 0; i < opt_hdr->NumberOfRvaAndSizes; i++) { -+ DBGLINKER("datadirectory %s RVA:%X Size:%d", -+ (i <= IMAGE_DIRECTORY_ENTRY_COM_DESCRIPTOR) ? -+ image_directory_name[i] : "unknown", -+ opt_hdr->DataDirectory[i].VirtualAddress, -+ opt_hdr->DataDirectory[i].Size); -+ } -+ -+ if ((nt_hdr->FileHeader.Characteristics & IMAGE_FILE_EXECUTABLE_IMAGE)) -+ return IMAGE_FILE_EXECUTABLE_IMAGE; -+ if ((nt_hdr->FileHeader.Characteristics & IMAGE_FILE_DLL)) -+ return IMAGE_FILE_DLL; -+ return -EINVAL; -+} -+ -+static int import(void *image, IMAGE_IMPORT_DESCRIPTOR *dirent, char *dll) -+{ -+ ULONG_PTR *lookup_tbl, *address_tbl; -+ char *symname = NULL; -+ int i; -+ int ret = 0; -+ generic_func adr; -+ -+ lookup_tbl = RVA2VA(image, dirent->u.OriginalFirstThunk, ULONG_PTR *); -+ address_tbl = RVA2VA(image, dirent->FirstThunk, ULONG_PTR *); -+ -+ for (i = 0; lookup_tbl[i]; i++) { -+ if (IMAGE_SNAP_BY_ORDINAL(lookup_tbl[i])) { -+ ERROR("ordinal import not supported: %llu", -+ (uint64_t)lookup_tbl[i]); -+ return -1; -+ } -+ else { -+ symname = RVA2VA(image, -+ ((lookup_tbl[i] & -+ ~IMAGE_ORDINAL_FLAG) + 2), char *); -+ } -+ -+ if (get_export(symname, &adr) < 0) { -+ ERROR("unknown symbol: %s:'%s'", dll, symname); -+ ret = -1; -+ } else { -+ DBGLINKER("found symbol: %s:%s: addr: %p, rva = %llu", -+ dll, symname, adr, (uint64_t)address_tbl[i]); -+ address_tbl[i] = (ULONG_PTR)adr; -+ } -+ } -+ return ret; -+} -+ -+static int read_exports(struct pe_image *pe) -+{ -+ IMAGE_EXPORT_DIRECTORY *export_dir_table; -+ uint32_t *export_addr_table; -+ int i; -+ uint32_t *name_table; -+ PIMAGE_OPTIONAL_HEADER opt_hdr; -+ IMAGE_DATA_DIRECTORY *export_data_dir; -+ -+ opt_hdr = &pe->nt_hdr->OptionalHeader; -+ export_data_dir = -+ &opt_hdr->DataDirectory[IMAGE_DIRECTORY_ENTRY_EXPORT]; -+ -+ if (export_data_dir->Size == 0) { -+ DBGLINKER("no exports"); -+ return 0; -+ } -+ -+ export_dir_table = -+ RVA2VA(pe->image, export_data_dir->VirtualAddress, -+ IMAGE_EXPORT_DIRECTORY *); -+ -+ name_table = (unsigned int *)(pe->image + -+ export_dir_table->AddressOfNames); -+ export_addr_table = (uint32_t *) -+ (pe->image + export_dir_table->AddressOfFunctions); -+ -+ for (i = 0; i < export_dir_table->NumberOfNames; i++) { -+ -+ if (export_data_dir->VirtualAddress <= *export_addr_table || -+ *export_addr_table >= (export_data_dir->VirtualAddress + -+ export_data_dir->Size)) -+ DBGLINKER("forwarder rva"); -+ -+ DBGLINKER("export symbol: %s, at %p", -+ (char *)(pe->image + *name_table), -+ pe->image + *export_addr_table); -+ -+ pe_exports[num_pe_exports].dll = pe->name; -+ pe_exports[num_pe_exports].name = pe->image + *name_table; -+ pe_exports[num_pe_exports].addr = -+ pe->image + *export_addr_table; -+ -+ num_pe_exports++; -+ name_table++; -+ export_addr_table++; -+ } -+ return 0; -+} -+ -+static int fixup_imports(void *image, IMAGE_NT_HEADERS *nt_hdr) -+{ -+ int i; -+ char *name; -+ int ret = 0; -+ IMAGE_IMPORT_DESCRIPTOR *dirent; -+ IMAGE_DATA_DIRECTORY *import_data_dir; -+ PIMAGE_OPTIONAL_HEADER opt_hdr; -+ -+ opt_hdr = &nt_hdr->OptionalHeader; -+ import_data_dir = -+ &opt_hdr->DataDirectory[IMAGE_DIRECTORY_ENTRY_IMPORT]; -+ dirent = RVA2VA(image, import_data_dir->VirtualAddress, -+ IMAGE_IMPORT_DESCRIPTOR *); -+ -+ for (i = 0; dirent[i].Name; i++) { -+ name = RVA2VA(image, dirent[i].Name, char*); -+ -+ DBGLINKER("imports from dll: %s", name); -+ ret += import(image, &dirent[i], name); -+ } -+ return ret; -+} -+ -+static int fixup_reloc(void *image, IMAGE_NT_HEADERS *nt_hdr) -+{ -+ ULONG_PTR base; -+ ULONG_PTR size; -+ IMAGE_BASE_RELOCATION *fixup_block; -+ IMAGE_DATA_DIRECTORY *base_reloc_data_dir; -+ PIMAGE_OPTIONAL_HEADER opt_hdr; -+ -+ opt_hdr = &nt_hdr->OptionalHeader; -+ base = opt_hdr->ImageBase; -+ base_reloc_data_dir = -+ &opt_hdr->DataDirectory[IMAGE_DIRECTORY_ENTRY_BASERELOC]; -+ if (base_reloc_data_dir->Size == 0) -+ return 0; -+ -+ fixup_block = RVA2VA(image, base_reloc_data_dir->VirtualAddress, -+ IMAGE_BASE_RELOCATION *); -+ DBGLINKER("fixup_block=%p, image=%p", fixup_block, image); -+ DBGLINKER("fixup_block info: %x %d", -+ fixup_block->VirtualAddress, fixup_block->SizeOfBlock); -+ -+ while (fixup_block->SizeOfBlock) { -+ int i; -+ WORD fixup, offset; -+ -+ size = (fixup_block->SizeOfBlock - -+ sizeof(IMAGE_BASE_RELOCATION)) / sizeof(WORD); -+ DBGLINKER("found %llu relocations in this block", -+ (uint64_t)size); -+ -+ for (i = 0; i < size; i++) { -+ fixup = fixup_block->TypeOffset[i]; -+ offset = fixup & 0xfff; -+ switch ((fixup >> 12) & 0x0f) { -+ case IMAGE_REL_BASED_ABSOLUTE: -+ break; -+ -+ case IMAGE_REL_BASED_HIGHLOW: { -+ uint32_t addr; -+ uint32_t *loc = -+ RVA2VA(image, -+ fixup_block->VirtualAddress + -+ offset, uint32_t *); -+ addr = RVA2VA(image, (*loc - base), uint32_t); -+ DBGLINKER("relocation: *%p (Val:%X)= %X", -+ loc, *loc, addr); -+ *loc = addr; -+ } -+ break; -+ -+ case IMAGE_REL_BASED_DIR64: { -+ uint64_t addr; -+ uint64_t *loc = -+ RVA2VA(image, -+ fixup_block->VirtualAddress + -+ offset, uint64_t *); -+ addr = RVA2VA(image, (*loc - base), uint64_t); -+ DBGLINKER("relocation: *%p (Val:%llX)= %llx", -+ loc, *loc, addr); -+ *loc = addr; -+ } -+ break; -+ -+ default: -+ ERROR("unknown fixup: %08X", -+ (fixup >> 12) & 0x0f); -+ return -EOPNOTSUPP; -+ break; -+ } -+ } -+ DBGLINKER("finished relocating block"); -+ -+ fixup_block = (IMAGE_BASE_RELOCATION *) -+ ((void *)fixup_block + fixup_block->SizeOfBlock); -+ }; -+ DBGLINKER("done relocating all"); -+ -+ return 0; -+} -+ -+/* Expand the image in memory if necessary. The image on disk does not -+ * necessarily maps the image of the driver in memory, so we have to -+ * re-write it in order to fulfill the sections alignments. The -+ * advantage to do that is that rva_to_va becomes a simple -+ * addition. */ -+static int fix_pe_image(struct pe_image *pe) -+{ -+ void *image; -+ IMAGE_SECTION_HEADER *sect_hdr; -+ int i, sections; -+ int image_size; -+ -+ if (pe->size == pe->opt_hdr->SizeOfImage) { -+ /* Nothing to do */ -+ return 0; -+ } -+ -+ image_size = pe->opt_hdr->SizeOfImage; -+#ifdef CONFIG_X86_64 -+#ifdef PAGE_KERNEL_EXECUTABLE -+ image = __vmalloc(image_size, GFP_KERNEL | __GFP_HIGHMEM, -+ PAGE_KERNEL_EXECUTABLE); -+#elif defined PAGE_KERNEL_EXEC -+ image = __vmalloc(image_size, GFP_KERNEL | __GFP_HIGHMEM, -+ PAGE_KERNEL_EXEC); -+#else -+#error x86_64 should have either PAGE_KERNEL_EXECUTABLE or PAGE_KERNEL_EXEC -+#endif -+#else -+#ifdef cpu_has_nx -+ /* hate to play with kernel macros, but PAGE_KERNEL_EXEC is -+ * not available to modules! */ -+ if (cpu_has_nx) -+ image = __vmalloc(image_size, GFP_KERNEL | __GFP_HIGHMEM, -+ __pgprot(__PAGE_KERNEL & ~_PAGE_NX)); -+ else -+ image = vmalloc(image_size); -+#else -+ image = vmalloc(image_size); -+#endif -+#endif -+ if (image == NULL) { -+ ERROR("failed to allocate enough space for new image:" -+ " %d bytes", image_size); -+ return -ENOMEM; -+ } -+ memset(image, 0, image_size); -+ -+ /* Copy all the headers, ie everything before the first section. */ -+ -+ sections = pe->nt_hdr->FileHeader.NumberOfSections; -+ sect_hdr = IMAGE_FIRST_SECTION(pe->nt_hdr); -+ -+ DBGLINKER("copying headers: %u bytes", sect_hdr->PointerToRawData); -+ -+ memcpy(image, pe->image, sect_hdr->PointerToRawData); -+ -+ /* Copy all the sections */ -+ for (i = 0; i < sections; i++) { -+ DBGLINKER("Copy section %s from %x to %x", -+ sect_hdr->Name, sect_hdr->PointerToRawData, -+ sect_hdr->VirtualAddress); -+ if (sect_hdr->VirtualAddress+sect_hdr->SizeOfRawData > -+ image_size) { -+ ERROR("Invalid section %s in driver", sect_hdr->Name); -+ vfree(image); -+ return -EINVAL; -+ } -+ -+ memcpy(image+sect_hdr->VirtualAddress, -+ pe->image + sect_hdr->PointerToRawData, -+ sect_hdr->SizeOfRawData); -+ sect_hdr++; -+ } -+ -+ vfree(pe->image); -+ pe->image = image; -+ pe->size = image_size; -+ -+ /* Update our internal pointers */ -+ pe->nt_hdr = (IMAGE_NT_HEADERS *) -+ (pe->image + ((IMAGE_DOS_HEADER *)pe->image)->e_lfanew); -+ pe->opt_hdr = &pe->nt_hdr->OptionalHeader; -+ -+ DBGLINKER("set nt headers: nt_hdr=%p, opt_hdr=%p, image=%p", -+ pe->nt_hdr, pe->opt_hdr, pe->image); -+ -+ return 0; -+} -+ -+#if defined(CONFIG_X86_64) -+static void fix_user_shared_data_addr(char *driver, unsigned long length) -+{ -+ unsigned long i, n, max_addr, *addr; -+ -+ TRACE1("fixing KI_USER_SHARED_DATA address in the driver"); -+ n = length - sizeof(unsigned long); -+ max_addr = KI_USER_SHARED_DATA + sizeof(kuser_shared_data); -+ for (i = 0; i < n; i++) { -+ addr = (unsigned long *)(driver + i); -+ if (*addr >= KI_USER_SHARED_DATA && *addr < max_addr) { -+ *addr -= KI_USER_SHARED_DATA; -+ *addr += (unsigned long)&kuser_shared_data; -+ kuser_shared_data.reserved1 = 1; -+ } -+ } -+} -+#endif -+ -+int link_pe_images(struct pe_image *pe_image, unsigned short n) -+{ -+ int i; -+ struct pe_image *pe; -+ -+#if DEBUG >= 1 -+ /* Sanity checks */ -+ CHECK_SZ(IMAGE_SECTION_HEADER, IMAGE_SIZEOF_SECTION_HEADER); -+ CHECK_SZ(IMAGE_FILE_HEADER, IMAGE_SIZEOF_FILE_HEADER); -+ CHECK_SZ(IMAGE_OPTIONAL_HEADER, IMAGE_SIZEOF_NT_OPTIONAL_HEADER); -+ CHECK_SZ(IMAGE_NT_HEADERS, 4 + IMAGE_SIZEOF_FILE_HEADER + -+ IMAGE_SIZEOF_NT_OPTIONAL_HEADER); -+ CHECK_SZ(IMAGE_DOS_HEADER, 0x40); -+ CHECK_SZ(IMAGE_EXPORT_DIRECTORY, 40); -+ CHECK_SZ(IMAGE_BASE_RELOCATION, 8); -+ CHECK_SZ(IMAGE_IMPORT_DESCRIPTOR, 20); -+#endif -+ -+ for (i = 0; i < n; i++) { -+ IMAGE_DOS_HEADER *dos_hdr; -+ pe = &pe_image[i]; -+ dos_hdr = pe->image; -+ -+ if (pe->size < sizeof(IMAGE_DOS_HEADER)) { -+ TRACE1("image too small: %d", pe->size); -+ return -EINVAL; -+ } -+ -+ pe->nt_hdr = -+ (IMAGE_NT_HEADERS *)(pe->image + dos_hdr->e_lfanew); -+ pe->opt_hdr = &pe->nt_hdr->OptionalHeader; -+ -+ pe->type = check_nt_hdr(pe->nt_hdr); -+ if (pe->type <= 0) { -+ TRACE1("type <= 0"); -+ return -EINVAL; -+ } -+ -+ if (fix_pe_image(pe)) { -+ TRACE1("bad PE image"); -+ return -EINVAL; -+ } -+ -+ if (read_exports(pe)) { -+ TRACE1("read exports failed"); -+ return -EINVAL; -+ } -+ } -+ -+ for (i = 0; i < n; i++) { -+ pe = &pe_image[i]; -+ -+ if (fixup_reloc(pe->image, pe->nt_hdr)) { -+ TRACE1("fixup reloc failed"); -+ return -EINVAL; -+ } -+ if (fixup_imports(pe->image, pe->nt_hdr)) { -+ TRACE1("fixup imports failed"); -+ return -EINVAL; -+ } -+#if defined(CONFIG_X86_64) -+ fix_user_shared_data_addr(pe_image[i].image, pe_image[i].size); -+#endif -+ flush_icache_range((unsigned long)pe->image, pe->size); -+ -+ pe->entry = -+ RVA2VA(pe->image, -+ pe->opt_hdr->AddressOfEntryPoint, void *); -+ TRACE1("entry is at %p, rva at %08X", pe->entry, -+ pe->opt_hdr->AddressOfEntryPoint); -+ } -+ -+ for (i = 0; i < n; i++) { -+ pe = &pe_image[i]; -+ -+ if (pe->type == IMAGE_FILE_DLL) { -+ struct unicode_string ustring; -+ char *buf = "0/0t0m0p00"; -+ int (*dll_entry)(struct unicode_string *ustring) -+ wstdcall; -+ -+ memset(&ustring, 0, sizeof(ustring)); -+ ustring.buf = (wchar_t *)buf; -+ dll_entry = (void *)get_dll_init(pe->name); -+ -+ TRACE1("calling dll_init at %p", dll_entry); -+ if (!dll_entry || dll_entry(&ustring)) -+ ERROR("DLL initialize failed for %s", -+ pe->name); -+ } -+ else if (pe->type != IMAGE_FILE_EXECUTABLE_IMAGE) -+ ERROR("illegal image type: %d", pe->type); -+ } -+ return 0; -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/pe_linker.h linux-4.12.4-3rd/3rdparty/ndiswrapper/pe_linker.h ---- linux-4.12.4/3rdparty/ndiswrapper/pe_linker.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/pe_linker.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,992 @@ -+/* -+ * This file is an excerpt of winnt.h from WINE, which bears the -+ * following copyright: -+ * -+ * Win32 definitions for Windows NT -+ * -+ * Copyright 1996 Alexandre Julliard -+ * -+ * This library is free software; you can redistribute it and/or -+ * modify it under the terms of the GNU Lesser General Public -+ * License as published by the Free Software Foundation; either -+ * version 2.1 of the License, or (at your option) any later version. -+ * -+ * This library is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -+ * Lesser General Public License for more details. -+ * -+ * You should have received a copy of the GNU Lesser General Public -+ * License along with this library; if not, write to the Free Software -+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA -+ */ -+ -+/* -+ * File formats definitions -+ */ -+typedef struct _IMAGE_DOS_HEADER { -+ WORD e_magic; /* 00: MZ Header signature */ -+ WORD e_cblp; /* 02: Bytes on last page of file */ -+ WORD e_cp; /* 04: Pages in file */ -+ WORD e_crlc; /* 06: Relocations */ -+ WORD e_cparhdr; /* 08: Size of header in paragraphs */ -+ WORD e_minalloc; /* 0a: Minimum extra paragraphs needed */ -+ WORD e_maxalloc; /* 0c: Maximum extra paragraphs needed */ -+ WORD e_ss; /* 0e: Initial (relative) SS value */ -+ WORD e_sp; /* 10: Initial SP value */ -+ WORD e_csum; /* 12: Checksum */ -+ WORD e_ip; /* 14: Initial IP value */ -+ WORD e_cs; /* 16: Initial (relative) CS value */ -+ WORD e_lfarlc; /* 18: File address of relocation table */ -+ WORD e_ovno; /* 1a: Overlay number */ -+ WORD e_res[4]; /* 1c: Reserved words */ -+ WORD e_oemid; /* 24: OEM identifier (for e_oeminfo) */ -+ WORD e_oeminfo; /* 26: OEM information; e_oemid specific */ -+ WORD e_res2[10]; /* 28: Reserved words */ -+ DWORD e_lfanew; /* 3c: Offset to extended header */ -+} IMAGE_DOS_HEADER, *PIMAGE_DOS_HEADER; -+ -+#define IMAGE_DOS_SIGNATURE 0x5A4D /* MZ */ -+#define IMAGE_OS2_SIGNATURE 0x454E /* NE */ -+#define IMAGE_OS2_SIGNATURE_LE 0x454C /* LE */ -+#define IMAGE_OS2_SIGNATURE_LX 0x584C /* LX */ -+#define IMAGE_VXD_SIGNATURE 0x454C /* LE */ -+#define IMAGE_NT_SIGNATURE 0x00004550 /* PE00 */ -+ -+/* -+ * This is the Windows executable (NE) header. -+ * the name IMAGE_OS2_HEADER is misleading, but in the SDK this way. -+ */ -+typedef struct -+{ -+ WORD ne_magic; /* 00 NE signature 'NE' */ -+ BYTE ne_ver; /* 02 Linker version number */ -+ BYTE ne_rev; /* 03 Linker revision number */ -+ WORD ne_enttab; /* 04 Offset to entry table relative to NE */ -+ WORD ne_cbenttab; /* 06 Length of entry table in bytes */ -+ LONG ne_crc; /* 08 Checksum */ -+ WORD ne_flags; /* 0c Flags about segments in this file */ -+ WORD ne_autodata; /* 0e Automatic data segment number */ -+ WORD ne_heap; /* 10 Initial size of local heap */ -+ WORD ne_stack; /* 12 Initial size of stack */ -+ DWORD ne_csip; /* 14 Initial CS:IP */ -+ DWORD ne_sssp; /* 18 Initial SS:SP */ -+ WORD ne_cseg; /* 1c # of entries in segment table */ -+ WORD ne_cmod; /* 1e # of entries in module reference tab. */ -+ WORD ne_cbnrestab; /* 20 Length of nonresident-name table */ -+ WORD ne_segtab; /* 22 Offset to segment table */ -+ WORD ne_rsrctab; /* 24 Offset to resource table */ -+ WORD ne_restab; /* 26 Offset to resident-name table */ -+ WORD ne_modtab; /* 28 Offset to module reference table */ -+ WORD ne_imptab; /* 2a Offset to imported name table */ -+ DWORD ne_nrestab; /* 2c Offset to nonresident-name table */ -+ WORD ne_cmovent; /* 30 # of movable entry points */ -+ WORD ne_align; /* 32 Logical sector alignment shift count */ -+ WORD ne_cres; /* 34 # of resource segments */ -+ BYTE ne_exetyp; /* 36 Flags indicating target OS */ -+ BYTE ne_flagsothers; /* 37 Additional information flags */ -+ WORD ne_pretthunks; /* 38 Offset to return thunks */ -+ WORD ne_psegrefbytes; /* 3a Offset to segment ref. bytes */ -+ WORD ne_swaparea; /* 3c Reserved by Microsoft */ -+ WORD ne_expver; /* 3e Expected Windows version number */ -+} IMAGE_OS2_HEADER, *PIMAGE_OS2_HEADER; -+ -+typedef struct _IMAGE_VXD_HEADER { -+ WORD e32_magic; -+ BYTE e32_border; -+ BYTE e32_worder; -+ DWORD e32_level; -+ WORD e32_cpu; -+ WORD e32_os; -+ DWORD e32_ver; -+ DWORD e32_mflags; -+ DWORD e32_mpages; -+ DWORD e32_startobj; -+ DWORD e32_eip; -+ DWORD e32_stackobj; -+ DWORD e32_esp; -+ DWORD e32_pagesize; -+ DWORD e32_lastpagesize; -+ DWORD e32_fixupsize; -+ DWORD e32_fixupsum; -+ DWORD e32_ldrsize; -+ DWORD e32_ldrsum; -+ DWORD e32_objtab; -+ DWORD e32_objcnt; -+ DWORD e32_objmap; -+ DWORD e32_itermap; -+ DWORD e32_rsrctab; -+ DWORD e32_rsrccnt; -+ DWORD e32_restab; -+ DWORD e32_enttab; -+ DWORD e32_dirtab; -+ DWORD e32_dircnt; -+ DWORD e32_fpagetab; -+ DWORD e32_frectab; -+ DWORD e32_impmod; -+ DWORD e32_impmodcnt; -+ DWORD e32_impproc; -+ DWORD e32_pagesum; -+ DWORD e32_datapage; -+ DWORD e32_preload; -+ DWORD e32_nrestab; -+ DWORD e32_cbnrestab; -+ DWORD e32_nressum; -+ DWORD e32_autodata; -+ DWORD e32_debuginfo; -+ DWORD e32_debuglen; -+ DWORD e32_instpreload; -+ DWORD e32_instdemand; -+ DWORD e32_heapsize; -+ BYTE e32_res3[12]; -+ DWORD e32_winresoff; -+ DWORD e32_winreslen; -+ WORD e32_devid; -+ WORD e32_ddkver; -+} IMAGE_VXD_HEADER, *PIMAGE_VXD_HEADER; -+ -+/* These defines describe the meanings of the bits in the -+ Characteristics field */ -+ -+#define IMAGE_FILE_RELOCS_STRIPPED 0x0001 /* No relocation info */ -+#define IMAGE_FILE_EXECUTABLE_IMAGE 0x0002 -+#define IMAGE_FILE_LINE_NUMS_STRIPPED 0x0004 -+#define IMAGE_FILE_LOCAL_SYMS_STRIPPED 0x0008 -+#define IMAGE_FILE_AGGRESIVE_WS_TRIM 0x0010 -+#define IMAGE_FILE_LARGE_ADDRESS_AWARE 0x0020 -+#define IMAGE_FILE_16BIT_MACHINE 0x0040 -+#define IMAGE_FILE_BYTES_REVERSED_LO 0x0080 -+#define IMAGE_FILE_32BIT_MACHINE 0x0100 -+#define IMAGE_FILE_DEBUG_STRIPPED 0x0200 -+#define IMAGE_FILE_REMOVABLE_RUN_FROM_SWAP 0x0400 -+#define IMAGE_FILE_NET_RUN_FROM_SWAP 0x0800 -+#define IMAGE_FILE_SYSTEM 0x1000 -+#define IMAGE_FILE_DLL 0x2000 -+#define IMAGE_FILE_UP_SYSTEM_ONLY 0x4000 -+#define IMAGE_FILE_BYTES_REVERSED_HI 0x8000 -+ -+/* These are the settings of the Machine field. */ -+#define IMAGE_FILE_MACHINE_UNKNOWN 0 -+#define IMAGE_FILE_MACHINE_I860 0x014d -+#define IMAGE_FILE_MACHINE_I386 0x014c -+#define IMAGE_FILE_MACHINE_R3000 0x0162 -+#define IMAGE_FILE_MACHINE_R4000 0x0166 -+#define IMAGE_FILE_MACHINE_R10000 0x0168 -+#define IMAGE_FILE_MACHINE_WCEMIPSV2 0x0169 -+#define IMAGE_FILE_MACHINE_ALPHA 0x0184 -+#define IMAGE_FILE_MACHINE_SH3 0x01a2 -+#define IMAGE_FILE_MACHINE_SH3DSP 0x01a3 -+#define IMAGE_FILE_MACHINE_SH3E 0x01a4 -+#define IMAGE_FILE_MACHINE_SH4 0x01a6 -+#define IMAGE_FILE_MACHINE_SH5 0x01a8 -+#define IMAGE_FILE_MACHINE_ARM 0x01c0 -+#define IMAGE_FILE_MACHINE_THUMB 0x01c2 -+#define IMAGE_FILE_MACHINE_AM33 0x01d3 -+#define IMAGE_FILE_MACHINE_POWERPC 0x01f0 -+#define IMAGE_FILE_MACHINE_POWERPCFP 0x01f1 -+#define IMAGE_FILE_MACHINE_IA64 0x0200 -+#define IMAGE_FILE_MACHINE_MIPS16 0x0266 -+#define IMAGE_FILE_MACHINE_ALPHA64 0x0284 -+#define IMAGE_FILE_MACHINE_MIPSFPU 0x0366 -+#define IMAGE_FILE_MACHINE_MIPSFPU16 0x0466 -+#define IMAGE_FILE_MACHINE_AXP64 IMAGE_FILE_MACHINE_ALPHA64 -+#define IMAGE_FILE_MACHINE_TRICORE 0x0520 -+#define IMAGE_FILE_MACHINE_CEF 0x0cef -+#define IMAGE_FILE_MACHINE_EBC 0x0ebc -+#define IMAGE_FILE_MACHINE_AMD64 0x8664 -+#define IMAGE_FILE_MACHINE_M32R 0x9041 -+#define IMAGE_FILE_MACHINE_CEE 0xc0ee -+ -+#define IMAGE_SIZEOF_FILE_HEADER 20 -+#define IMAGE_SIZEOF_ROM_OPTIONAL_HEADER 56 -+#define IMAGE_SIZEOF_STD_OPTIONAL_HEADER 28 -+#define IMAGE_SIZEOF_NT_OPTIONAL_HEADER32 224 -+#define IMAGE_SIZEOF_NT_OPTIONAL_HEADER64 240 -+#define IMAGE_SIZEOF_SHORT_NAME 8 -+#define IMAGE_SIZEOF_SECTION_HEADER 40 -+#define IMAGE_SIZEOF_SYMBOL 18 -+#define IMAGE_SIZEOF_AUX_SYMBOL 18 -+#define IMAGE_SIZEOF_RELOCATION 10 -+#define IMAGE_SIZEOF_BASE_RELOCATION 8 -+#define IMAGE_SIZEOF_LINENUMBER 6 -+#define IMAGE_SIZEOF_ARCHIVE_MEMBER_HDR 60 -+ -+/* Possible Magic values */ -+#define IMAGE_NT_OPTIONAL_HDR32_MAGIC 0x010b -+#define IMAGE_NT_OPTIONAL_HDR64_MAGIC 0x020b -+#define IMAGE_ROM_OPTIONAL_HDR_MAGIC 0x0107 -+ -+#ifdef CONFIG_X86_64 -+#define IMAGE_SIZEOF_NT_OPTIONAL_HEADER IMAGE_SIZEOF_NT_OPTIONAL_HEADER64 -+#define IMAGE_NT_OPTIONAL_HDR_MAGIC IMAGE_NT_OPTIONAL_HDR64_MAGIC -+#else -+#define IMAGE_SIZEOF_NT_OPTIONAL_HEADER IMAGE_SIZEOF_NT_OPTIONAL_HEADER32 -+#define IMAGE_NT_OPTIONAL_HDR_MAGIC IMAGE_NT_OPTIONAL_HDR32_MAGIC -+#endif -+ -+/* These are indexes into the DataDirectory array */ -+#define IMAGE_FILE_EXPORT_DIRECTORY 0 -+#define IMAGE_FILE_IMPORT_DIRECTORY 1 -+#define IMAGE_FILE_RESOURCE_DIRECTORY 2 -+#define IMAGE_FILE_EXCEPTION_DIRECTORY 3 -+#define IMAGE_FILE_SECURITY_DIRECTORY 4 -+#define IMAGE_FILE_BASE_RELOCATION_TABLE 5 -+#define IMAGE_FILE_DEBUG_DIRECTORY 6 -+#define IMAGE_FILE_DESCRIPTION_STRING 7 -+#define IMAGE_FILE_MACHINE_VALUE 8 /* Mips */ -+#define IMAGE_FILE_THREAD_LOCAL_STORAGE 9 -+#define IMAGE_FILE_CALLBACK_DIRECTORY 10 -+ -+/* Directory Entries, indices into the DataDirectory array */ -+ -+#define IMAGE_DIRECTORY_ENTRY_EXPORT 0 -+#define IMAGE_DIRECTORY_ENTRY_IMPORT 1 -+#define IMAGE_DIRECTORY_ENTRY_RESOURCE 2 -+#define IMAGE_DIRECTORY_ENTRY_EXCEPTION 3 -+#define IMAGE_DIRECTORY_ENTRY_SECURITY 4 -+#define IMAGE_DIRECTORY_ENTRY_BASERELOC 5 -+#define IMAGE_DIRECTORY_ENTRY_DEBUG 6 -+#define IMAGE_DIRECTORY_ENTRY_COPYRIGHT 7 -+#define IMAGE_DIRECTORY_ENTRY_GLOBALPTR 8 /* (MIPS GP) */ -+#define IMAGE_DIRECTORY_ENTRY_TLS 9 -+#define IMAGE_DIRECTORY_ENTRY_LOAD_CONFIG 10 -+#define IMAGE_DIRECTORY_ENTRY_BOUND_IMPORT 11 -+#define IMAGE_DIRECTORY_ENTRY_IAT 12 /* Import Address Table */ -+#define IMAGE_DIRECTORY_ENTRY_DELAY_IMPORT 13 -+#define IMAGE_DIRECTORY_ENTRY_COM_DESCRIPTOR 14 -+ -+/* Subsystem Values */ -+ -+#define IMAGE_SUBSYSTEM_UNKNOWN 0 -+#define IMAGE_SUBSYSTEM_NATIVE 1 -+#define IMAGE_SUBSYSTEM_WINDOWS_GUI 2 /* Windows GUI subsystem */ -+#define IMAGE_SUBSYSTEM_WINDOWS_CUI 3 /* Windows character subsystem */ -+#define IMAGE_SUBSYSTEM_OS2_CUI 5 -+#define IMAGE_SUBSYSTEM_POSIX_CUI 7 -+#define IMAGE_SUBSYSTEM_NATIVE_WINDOWS 8 /* native Win9x driver */ -+#define IMAGE_SUBSYSTEM_WINDOWS_CE_GUI 9 /* Windows CE subsystem */ -+#define IMAGE_SUBSYSTEM_EFI_APPLICATION 10 -+#define IMAGE_SUBSYSTEM_EFI_BOOT_SERVICE_DRIVER 11 -+#define IMAGE_SUBSYSTEM_EFI_RUNTIME_DRIVER 12 -+#define IMAGE_SUBSYSTEM_EFI_ROM 13 -+#define IMAGE_SUBSYSTEM_XBOX 14 -+ -+typedef struct _IMAGE_FILE_HEADER { -+ WORD Machine; -+ WORD NumberOfSections; -+ DWORD TimeDateStamp; -+ DWORD PointerToSymbolTable; -+ DWORD NumberOfSymbols; -+ WORD SizeOfOptionalHeader; -+ WORD Characteristics; -+} IMAGE_FILE_HEADER, *PIMAGE_FILE_HEADER; -+ -+typedef struct _IMAGE_DATA_DIRECTORY { -+ DWORD VirtualAddress; -+ DWORD Size; -+} IMAGE_DATA_DIRECTORY, *PIMAGE_DATA_DIRECTORY; -+ -+#define IMAGE_NUMBEROF_DIRECTORY_ENTRIES 16 -+ -+typedef struct _IMAGE_OPTIONAL_HEADER32 { -+ -+ /* Standard fields */ -+ -+ WORD Magic; -+ BYTE MajorLinkerVersion; -+ BYTE MinorLinkerVersion; -+ DWORD SizeOfCode; -+ DWORD SizeOfInitializedData; -+ DWORD SizeOfUninitializedData; -+ DWORD AddressOfEntryPoint; -+ DWORD BaseOfCode; -+ DWORD BaseOfData; -+ -+ /* NT additional fields */ -+ DWORD ImageBase; -+ DWORD SectionAlignment; -+ DWORD FileAlignment; -+ WORD MajorOperatingSystemVersion; -+ WORD MinorOperatingSystemVersion; -+ WORD MajorImageVersion; -+ WORD MinorImageVersion; -+ WORD MajorSubsystemVersion; -+ WORD MinorSubsystemVersion; -+ DWORD Win32VersionValue; -+ DWORD SizeOfImage; -+ DWORD SizeOfHeaders; -+ DWORD CheckSum; -+ WORD Subsystem; -+ WORD DllCharacteristics; -+ DWORD SizeOfStackReserve; -+ DWORD SizeOfStackCommit; -+ DWORD SizeOfHeapReserve; -+ DWORD SizeOfHeapCommit; -+ DWORD LoaderFlags; -+ DWORD NumberOfRvaAndSizes; -+ IMAGE_DATA_DIRECTORY DataDirectory[IMAGE_NUMBEROF_DIRECTORY_ENTRIES]; -+} IMAGE_OPTIONAL_HEADER32, *PIMAGE_OPTIONAL_HEADER32; -+ -+typedef struct _IMAGE_OPTIONAL_HEADER64 { -+ -+ /* Standard fields */ -+ -+ WORD Magic; -+ BYTE MajorLinkerVersion; -+ BYTE MinorLinkerVersion; -+ DWORD SizeOfCode; -+ DWORD SizeOfInitializedData; -+ DWORD SizeOfUninitializedData; -+ DWORD AddressOfEntryPoint; -+ DWORD BaseOfCode; -+ -+ /* NT additional fields */ -+ ULONGLONG ImageBase; -+ DWORD SectionAlignment; -+ DWORD FileAlignment; -+ WORD MajorOperatingSystemVersion; -+ WORD MinorOperatingSystemVersion; -+ WORD MajorImageVersion; -+ WORD MinorImageVersion; -+ WORD MajorSubsystemVersion; -+ WORD MinorSubsystemVersion; -+ DWORD Win32VersionValue; -+ DWORD SizeOfImage; -+ DWORD SizeOfHeaders; -+ DWORD CheckSum; -+ WORD Subsystem; -+ WORD DllCharacteristics; -+ ULONGLONG SizeOfStackReserve; -+ ULONGLONG SizeOfStackCommit; -+ ULONGLONG SizeOfHeapReserve; -+ ULONGLONG SizeOfHeapCommit; -+ DWORD LoaderFlags; -+ DWORD NumberOfRvaAndSizes; -+ IMAGE_DATA_DIRECTORY DataDirectory[IMAGE_NUMBEROF_DIRECTORY_ENTRIES]; -+} IMAGE_OPTIONAL_HEADER64, *PIMAGE_OPTIONAL_HEADER64; -+ -+#ifdef CONFIG_X86_64 -+typedef IMAGE_OPTIONAL_HEADER64 IMAGE_OPTIONAL_HEADER; -+typedef PIMAGE_OPTIONAL_HEADER64 PIMAGE_OPTIONAL_HEADER; -+#else -+typedef IMAGE_OPTIONAL_HEADER32 IMAGE_OPTIONAL_HEADER; -+typedef PIMAGE_OPTIONAL_HEADER32 PIMAGE_OPTIONAL_HEADER; -+#endif -+ -+typedef struct _IMAGE_NT_HEADERS32 { -+ DWORD Signature; /* "PE"\0\0 */ /* 0x00 */ -+ IMAGE_FILE_HEADER FileHeader; /* 0x04 */ -+ IMAGE_OPTIONAL_HEADER32 OptionalHeader; /* 0x18 */ -+} IMAGE_NT_HEADERS32, *PIMAGE_NT_HEADERS32; -+ -+typedef struct _IMAGE_NT_HEADERS64 { -+ DWORD Signature; /* "PE"\0\0 */ /* 0x00 */ -+ IMAGE_FILE_HEADER FileHeader; /* 0x04 */ -+ IMAGE_OPTIONAL_HEADER64 OptionalHeader; /* 0x18 */ -+} IMAGE_NT_HEADERS64, *PIMAGE_NT_HEADERS64; -+ -+#ifdef CONFIG_X86_64 -+typedef IMAGE_NT_HEADERS64 IMAGE_NT_HEADERS; -+typedef PIMAGE_NT_HEADERS64 PIMAGE_NT_HEADERS; -+#else -+typedef IMAGE_NT_HEADERS32 IMAGE_NT_HEADERS; -+typedef PIMAGE_NT_HEADERS32 PIMAGE_NT_HEADERS; -+#endif -+ -+#define IMAGE_SIZEOF_SHORT_NAME 8 -+ -+typedef struct _IMAGE_SECTION_HEADER { -+ BYTE Name[IMAGE_SIZEOF_SHORT_NAME]; -+ union { -+ DWORD PhysicalAddress; -+ DWORD VirtualSize; -+ } Misc; -+ DWORD VirtualAddress; -+ DWORD SizeOfRawData; -+ DWORD PointerToRawData; -+ DWORD PointerToRelocations; -+ DWORD PointerToLinenumbers; -+ WORD NumberOfRelocations; -+ WORD NumberOfLinenumbers; -+ DWORD Characteristics; -+} IMAGE_SECTION_HEADER, *PIMAGE_SECTION_HEADER; -+ -+#define IMAGE_SIZEOF_SECTION_HEADER 40 -+ -+#define IMAGE_FIRST_SECTION(ntheader) \ -+((PIMAGE_SECTION_HEADER)((LPBYTE)&((PIMAGE_NT_HEADERS)(ntheader))->OptionalHeader + \ -+((PIMAGE_NT_HEADERS)(ntheader))->FileHeader.SizeOfOptionalHeader)) -+ -+/* These defines are for the Characteristics bitfield. */ -+/* #define IMAGE_SCN_TYPE_REG 0x00000000 - Reserved */ -+/* #define IMAGE_SCN_TYPE_DSECT 0x00000001 - Reserved */ -+/* #define IMAGE_SCN_TYPE_NOLOAD 0x00000002 - Reserved */ -+/* #define IMAGE_SCN_TYPE_GROUP 0x00000004 - Reserved */ -+#define IMAGE_SCN_TYPE_NO_PAD 0x00000008 /* Reserved */ -+/* #define IMAGE_SCN_TYPE_COPY 0x00000010 - Reserved */ -+ -+#define IMAGE_SCN_CNT_CODE 0x00000020 -+#define IMAGE_SCN_CNT_INITIALIZED_DATA 0x00000040 -+#define IMAGE_SCN_CNT_UNINITIALIZED_DATA 0x00000080 -+ -+#define IMAGE_SCN_LNK_OTHER 0x00000100 -+#define IMAGE_SCN_LNK_INFO 0x00000200 -+/* #define IMAGE_SCN_TYPE_OVER 0x00000400 - Reserved */ -+#define IMAGE_SCN_LNK_REMOVE 0x00000800 -+#define IMAGE_SCN_LNK_COMDAT 0x00001000 -+ -+/* 0x00002000 - Reserved */ -+/* #define IMAGE_SCN_MEM_PROTECTED 0x00004000 - Obsolete */ -+#define IMAGE_SCN_MEM_FARDATA 0x00008000 -+ -+/* #define IMAGE_SCN_MEM_SYSHEAP 0x00010000 - Obsolete */ -+#define IMAGE_SCN_MEM_PURGEABLE 0x00020000 -+#define IMAGE_SCN_MEM_16BIT 0x00020000 -+#define IMAGE_SCN_MEM_LOCKED 0x00040000 -+#define IMAGE_SCN_MEM_PRELOAD 0x00080000 -+ -+#define IMAGE_SCN_ALIGN_1BYTES 0x00100000 -+#define IMAGE_SCN_ALIGN_2BYTES 0x00200000 -+#define IMAGE_SCN_ALIGN_4BYTES 0x00300000 -+#define IMAGE_SCN_ALIGN_8BYTES 0x00400000 -+#define IMAGE_SCN_ALIGN_16BYTES 0x00500000 /* Default */ -+#define IMAGE_SCN_ALIGN_32BYTES 0x00600000 -+#define IMAGE_SCN_ALIGN_64BYTES 0x00700000 -+#define IMAGE_SCN_ALIGN_128BYTES 0x00800000 -+#define IMAGE_SCN_ALIGN_256BYTES 0x00900000 -+#define IMAGE_SCN_ALIGN_512BYTES 0x00A00000 -+#define IMAGE_SCN_ALIGN_1024BYTES 0x00B00000 -+#define IMAGE_SCN_ALIGN_2048BYTES 0x00C00000 -+#define IMAGE_SCN_ALIGN_4096BYTES 0x00D00000 -+#define IMAGE_SCN_ALIGN_8192BYTES 0x00E00000 -+/* 0x00F00000 - Unused */ -+#define IMAGE_SCN_ALIGN_MASK 0x00F00000 -+ -+#define IMAGE_SCN_LNK_NRELOC_OVFL 0x01000000 -+ -+ -+#define IMAGE_SCN_MEM_DISCARDABLE 0x02000000 -+#define IMAGE_SCN_MEM_NOT_CACHED 0x04000000 -+#define IMAGE_SCN_MEM_NOT_PAGED 0x08000000 -+#define IMAGE_SCN_MEM_SHARED 0x10000000 -+#define IMAGE_SCN_MEM_EXECUTE 0x20000000 -+#define IMAGE_SCN_MEM_READ 0x40000000 -+#define IMAGE_SCN_MEM_WRITE 0x80000000 -+ -+typedef struct _IMAGE_SYMBOL { -+ union { -+ BYTE ShortName[8]; -+ struct { -+ DWORD Short; -+ DWORD Long; -+ } Name; -+ DWORD LongName[2]; -+ } N; -+ DWORD Value; -+ SHORT SectionNumber; -+ WORD Type; -+ BYTE StorageClass; -+ BYTE NumberOfAuxSymbols; -+} IMAGE_SYMBOL; -+typedef IMAGE_SYMBOL *PIMAGE_SYMBOL; -+ -+#define IMAGE_SIZEOF_SYMBOL 18 -+ -+typedef struct _IMAGE_LINENUMBER { -+ union { -+ DWORD SymbolTableIndex; -+ DWORD VirtualAddress; -+ } Type; -+ WORD Linenumber; -+} IMAGE_LINENUMBER; -+typedef IMAGE_LINENUMBER *PIMAGE_LINENUMBER; -+ -+#define IMAGE_SIZEOF_LINENUMBER 6 -+ -+typedef union _IMAGE_AUX_SYMBOL { -+ struct { -+ DWORD TagIndex; -+ union { -+ struct { -+ WORD Linenumber; -+ WORD Size; -+ } LnSz; -+ DWORD TotalSize; -+ } Misc; -+ union { -+ struct { -+ DWORD PointerToLinenumber; -+ DWORD PointerToNextFunction; -+ } Function; -+ struct { -+ WORD Dimension[4]; -+ } Array; -+ } FcnAry; -+ WORD TvIndex; -+ } Sym; -+ struct { -+ BYTE Name[IMAGE_SIZEOF_SYMBOL]; -+ } File; -+ struct { -+ DWORD Length; -+ WORD NumberOfRelocations; -+ WORD NumberOfLinenumbers; -+ DWORD CheckSum; -+ SHORT Number; -+ BYTE Selection; -+ } Section; -+} IMAGE_AUX_SYMBOL; -+typedef IMAGE_AUX_SYMBOL *PIMAGE_AUX_SYMBOL; -+ -+#define IMAGE_SIZEOF_AUX_SYMBOL 18 -+ -+#define IMAGE_SYM_UNDEFINED (SHORT)0 -+#define IMAGE_SYM_ABSOLUTE (SHORT)-1 -+#define IMAGE_SYM_DEBUG (SHORT)-2 -+ -+#define IMAGE_SYM_TYPE_NULL 0x0000 -+#define IMAGE_SYM_TYPE_VOID 0x0001 -+#define IMAGE_SYM_TYPE_CHAR 0x0002 -+#define IMAGE_SYM_TYPE_SHORT 0x0003 -+#define IMAGE_SYM_TYPE_INT 0x0004 -+#define IMAGE_SYM_TYPE_LONG 0x0005 -+#define IMAGE_SYM_TYPE_FLOAT 0x0006 -+#define IMAGE_SYM_TYPE_DOUBLE 0x0007 -+#define IMAGE_SYM_TYPE_STRUCT 0x0008 -+#define IMAGE_SYM_TYPE_UNION 0x0009 -+#define IMAGE_SYM_TYPE_ENUM 0x000A -+#define IMAGE_SYM_TYPE_MOE 0x000B -+#define IMAGE_SYM_TYPE_BYTE 0x000C -+#define IMAGE_SYM_TYPE_WORD 0x000D -+#define IMAGE_SYM_TYPE_UINT 0x000E -+#define IMAGE_SYM_TYPE_DWORD 0x000F -+#define IMAGE_SYM_TYPE_PCODE 0x8000 -+ -+#define IMAGE_SYM_DTYPE_NULL 0 -+#define IMAGE_SYM_DTYPE_POINTER 1 -+#define IMAGE_SYM_DTYPE_FUNCTION 2 -+#define IMAGE_SYM_DTYPE_ARRAY 3 -+ -+#define IMAGE_SYM_CLASS_END_OF_FUNCTION (BYTE )-1 -+#define IMAGE_SYM_CLASS_NULL 0x0000 -+#define IMAGE_SYM_CLASS_AUTOMATIC 0x0001 -+#define IMAGE_SYM_CLASS_EXTERNAL 0x0002 -+#define IMAGE_SYM_CLASS_STATIC 0x0003 -+#define IMAGE_SYM_CLASS_REGISTER 0x0004 -+#define IMAGE_SYM_CLASS_EXTERNAL_DEF 0x0005 -+#define IMAGE_SYM_CLASS_LABEL 0x0006 -+#define IMAGE_SYM_CLASS_UNDEFINED_LABEL 0x0007 -+#define IMAGE_SYM_CLASS_MEMBER_OF_STRUCT 0x0008 -+#define IMAGE_SYM_CLASS_ARGUMENT 0x0009 -+#define IMAGE_SYM_CLASS_STRUCT_TAG 0x000A -+#define IMAGE_SYM_CLASS_MEMBER_OF_UNION 0x000B -+#define IMAGE_SYM_CLASS_UNION_TAG 0x000C -+#define IMAGE_SYM_CLASS_TYPE_DEFINITION 0x000D -+#define IMAGE_SYM_CLASS_UNDEFINED_STATIC 0x000E -+#define IMAGE_SYM_CLASS_ENUM_TAG 0x000F -+#define IMAGE_SYM_CLASS_MEMBER_OF_ENUM 0x0010 -+#define IMAGE_SYM_CLASS_REGISTER_PARAM 0x0011 -+#define IMAGE_SYM_CLASS_BIT_FIELD 0x0012 -+ -+#define IMAGE_SYM_CLASS_FAR_EXTERNAL 0x0044 -+#define IMAGE_SYM_CLASS_BLOCK 0x0064 -+#define IMAGE_SYM_CLASS_FUNCTION 0x0065 -+#define IMAGE_SYM_CLASS_END_OF_STRUCT 0x0066 -+#define IMAGE_SYM_CLASS_FILE 0x0067 -+#define IMAGE_SYM_CLASS_SECTION 0x0068 -+#define IMAGE_SYM_CLASS_WEAK_EXTERNAL 0x0069 -+ -+#define N_BTMASK 0x000F -+#define N_TMASK 0x0030 -+#define N_TMASK1 0x00C0 -+#define N_TMASK2 0x00F0 -+#define N_BTSHFT 4 -+#define N_TSHIFT 2 -+ -+#define BTYPE(x) ((x) & N_BTMASK) -+ -+#ifndef ISPTR -+#define ISPTR(x) (((x) & N_TMASK) == (IMAGE_SYM_DTYPE_POINTER << N_BTSHFT)) -+#endif -+ -+#ifndef ISFCN -+#define ISFCN(x) (((x) & N_TMASK) == (IMAGE_SYM_DTYPE_FUNCTION << N_BTSHFT)) -+#endif -+ -+#ifndef ISARY -+#define ISARY(x) (((x) & N_TMASK) == (IMAGE_SYM_DTYPE_ARRAY << N_BTSHFT)) -+#endif -+ -+#ifndef ISTAG -+#define ISTAG(x) ((x)==IMAGE_SYM_CLASS_STRUCT_TAG || (x)==IMAGE_SYM_CLASS_UNION_TAG || (x)==IMAGE_SYM_CLASS_ENUM_TAG) -+#endif -+ -+#ifndef INCREF -+#define INCREF(x) ((((x)&~N_BTMASK)<>N_TSHIFT)&~N_BTMASK)|((x)&N_BTMASK)) -+#endif -+ -+#define IMAGE_COMDAT_SELECT_NODUPLICATES 1 -+#define IMAGE_COMDAT_SELECT_ANY 2 -+#define IMAGE_COMDAT_SELECT_SAME_SIZE 3 -+#define IMAGE_COMDAT_SELECT_EXACT_MATCH 4 -+#define IMAGE_COMDAT_SELECT_ASSOCIATIVE 5 -+#define IMAGE_COMDAT_SELECT_LARGEST 6 -+#define IMAGE_COMDAT_SELECT_NEWEST 7 -+ -+#define IMAGE_WEAK_EXTERN_SEARCH_NOLIBRARY 1 -+#define IMAGE_WEAK_EXTERN_SEARCH_LIBRARY 2 -+#define IMAGE_WEAK_EXTERN_SEARCH_ALIAS 3 -+ -+/* Export module directory */ -+ -+typedef struct _IMAGE_EXPORT_DIRECTORY { -+ DWORD Characteristics; -+ DWORD TimeDateStamp; -+ WORD MajorVersion; -+ WORD MinorVersion; -+ DWORD Name; -+ DWORD Base; -+ DWORD NumberOfFunctions; -+ DWORD NumberOfNames; -+ DWORD AddressOfFunctions; -+ DWORD AddressOfNames; -+ DWORD AddressOfNameOrdinals; -+} IMAGE_EXPORT_DIRECTORY,*PIMAGE_EXPORT_DIRECTORY; -+ -+/* Import name entry */ -+typedef struct _IMAGE_IMPORT_BY_NAME { -+ WORD Hint; -+ BYTE Name[1]; -+} IMAGE_IMPORT_BY_NAME,*PIMAGE_IMPORT_BY_NAME; -+ -+/* Import thunk */ -+typedef struct _IMAGE_THUNK_DATA32 { -+ union { -+ DWORD ForwarderString; -+ DWORD Function; -+ DWORD Ordinal; -+ DWORD AddressOfData; -+ } u1; -+} IMAGE_THUNK_DATA32,*PIMAGE_THUNK_DATA32; -+ -+typedef struct _IMAGE_THUNK_DATA64 { -+ union { -+ ULONGLONG ForwarderString; -+ ULONGLONG Function; -+ ULONGLONG Ordinal; -+ ULONGLONG AddressOfData; -+ } u1; -+} IMAGE_THUNK_DATA64,*PIMAGE_THUNK_DATA64; -+ -+#ifdef CONFIG_X86_64 -+typedef IMAGE_THUNK_DATA32 IMAGE_THUNK_DATA; -+typedef PIMAGE_THUNK_DATA32 PIMAGE_THUNK_DATA; -+#else -+typedef IMAGE_THUNK_DATA64 IMAGE_THUNK_DATA; -+typedef PIMAGE_THUNK_DATA64 PIMAGE_THUNK_DATA; -+#endif -+ -+/* Import module directory */ -+ -+typedef struct __packed _IMAGE_IMPORT_DESCRIPTOR { -+ union { -+ DWORD Characteristics; /* 0 for terminating null -+ * import descriptor */ -+ DWORD OriginalFirstThunk; /* RVA to original unbound -+ * IAT */ -+ } u; -+ DWORD TimeDateStamp; /* 0 if not bound, -+ * -1 if bound, and real date\time stamp -+ * in IMAGE_DIRECTORY_ENTRY_BOUND_IMPORT -+ * (new BIND) -+ * otherwise date/time stamp of DLL bound to -+ * (Old BIND) -+ */ -+ DWORD ForwarderChain; /* -1 if no forwarders */ -+ DWORD Name; -+ /* RVA to IAT (if bound this IAT has actual addresses) */ -+ DWORD FirstThunk; -+} IMAGE_IMPORT_DESCRIPTOR,*PIMAGE_IMPORT_DESCRIPTOR; -+ -+#define IMAGE_ORDINAL_FLAG32 0x80000000 -+#define IMAGE_ORDINAL_FLAG64 0x8000000000000000UL -+#define IMAGE_SNAP_BY_ORDINAL32(Ordinal) ((Ordinal & IMAGE_ORDINAL_FLAG32) != 0) -+#define IMAGE_SNAP_BY_ORDINAL64(Ordinal) ((Ordinal & IMAGE_ORDINAL_FLAG64) != 0) -+#define IMAGE_ORDINAL(Ordinal) (Ordinal & 0xffff) -+ -+#ifdef CONFIG_X86_64 -+#define IMAGE_ORDINAL_FLAG IMAGE_ORDINAL_FLAG64 -+#define IMAGE_SNAP_BY_ORDINAL IMAGE_SNAP_BY_ORDINAL64 -+#else -+#define IMAGE_ORDINAL_FLAG IMAGE_ORDINAL_FLAG32 -+#define IMAGE_SNAP_BY_ORDINAL IMAGE_SNAP_BY_ORDINAL32 -+#endif -+ -+typedef struct _IMAGE_BOUND_IMPORT_DESCRIPTOR -+{ -+ DWORD TimeDateStamp; -+ WORD OffsetModuleName; -+ WORD NumberOfModuleForwarderRefs; -+/* Array of zero or more IMAGE_BOUND_FORWARDER_REF follows */ -+} IMAGE_BOUND_IMPORT_DESCRIPTOR, *PIMAGE_BOUND_IMPORT_DESCRIPTOR; -+ -+typedef struct _IMAGE_BOUND_FORWARDER_REF -+{ -+ DWORD TimeDateStamp; -+ WORD OffsetModuleName; -+ WORD Reserved; -+} IMAGE_BOUND_FORWARDER_REF, *PIMAGE_BOUND_FORWARDER_REF; -+ -+typedef struct _IMAGE_BASE_RELOCATION -+{ -+ DWORD VirtualAddress; -+ DWORD SizeOfBlock; -+ WORD TypeOffset[0]; -+} IMAGE_BASE_RELOCATION,*PIMAGE_BASE_RELOCATION; -+ -+typedef struct _IMAGE_RELOCATION -+{ -+ union { -+ DWORD VirtualAddress; -+ DWORD RelocCount; -+ } DUMMYUNIONNAME; -+ DWORD SymbolTableIndex; -+ WORD Type; -+} IMAGE_RELOCATION, *PIMAGE_RELOCATION; -+ -+#define IMAGE_SIZEOF_RELOCATION 10 -+ -+/* generic relocation types */ -+#define IMAGE_REL_BASED_ABSOLUTE 0 -+#define IMAGE_REL_BASED_HIGH 1 -+#define IMAGE_REL_BASED_LOW 2 -+#define IMAGE_REL_BASED_HIGHLOW 3 -+#define IMAGE_REL_BASED_HIGHADJ 4 -+#define IMAGE_REL_BASED_MIPS_JMPADDR 5 -+#define IMAGE_REL_BASED_SECTION 6 -+#define IMAGE_REL_BASED_REL 7 -+#define IMAGE_REL_BASED_MIPS_JMPADDR16 9 -+#define IMAGE_REL_BASED_IA64_IMM64 9 /* yes, 9 too */ -+#define IMAGE_REL_BASED_DIR64 10 -+#define IMAGE_REL_BASED_HIGH3ADJ 11 -+ -+/* I386 relocation types */ -+#define IMAGE_REL_I386_ABSOLUTE 0 -+#define IMAGE_REL_I386_DIR16 1 -+#define IMAGE_REL_I386_REL16 2 -+#define IMAGE_REL_I386_DIR32 6 -+#define IMAGE_REL_I386_DIR32NB 7 -+#define IMAGE_REL_I386_SEG12 9 -+#define IMAGE_REL_I386_SECTION 10 -+#define IMAGE_REL_I386_SECREL 11 -+#define IMAGE_REL_I386_REL32 20 -+ -+/* MIPS relocation types */ -+#define IMAGE_REL_MIPS_ABSOLUTE 0x0000 -+#define IMAGE_REL_MIPS_REFHALF 0x0001 -+#define IMAGE_REL_MIPS_REFWORD 0x0002 -+#define IMAGE_REL_MIPS_JMPADDR 0x0003 -+#define IMAGE_REL_MIPS_REFHI 0x0004 -+#define IMAGE_REL_MIPS_REFLO 0x0005 -+#define IMAGE_REL_MIPS_GPREL 0x0006 -+#define IMAGE_REL_MIPS_LITERAL 0x0007 -+#define IMAGE_REL_MIPS_SECTION 0x000A -+#define IMAGE_REL_MIPS_SECREL 0x000B -+#define IMAGE_REL_MIPS_SECRELLO 0x000C -+#define IMAGE_REL_MIPS_SECRELHI 0x000D -+#define IMAGE_REL_MIPS_JMPADDR16 0x0010 -+#define IMAGE_REL_MIPS_REFWORDNB 0x0022 -+#define IMAGE_REL_MIPS_PAIR 0x0025 -+ -+/* ALPHA relocation types */ -+#define IMAGE_REL_ALPHA_ABSOLUTE 0x0000 -+#define IMAGE_REL_ALPHA_REFLONG 0x0001 -+#define IMAGE_REL_ALPHA_REFQUAD 0x0002 -+#define IMAGE_REL_ALPHA_GPREL 0x0003 -+#define IMAGE_REL_ALPHA_LITERAL 0x0004 -+#define IMAGE_REL_ALPHA_LITUSE 0x0005 -+#define IMAGE_REL_ALPHA_GPDISP 0x0006 -+#define IMAGE_REL_ALPHA_BRADDR 0x0007 -+#define IMAGE_REL_ALPHA_HINT 0x0008 -+#define IMAGE_REL_ALPHA_INLINE_REFLONG 0x0009 -+#define IMAGE_REL_ALPHA_REFHI 0x000A -+#define IMAGE_REL_ALPHA_REFLO 0x000B -+#define IMAGE_REL_ALPHA_PAIR 0x000C -+#define IMAGE_REL_ALPHA_MATCH 0x000D -+#define IMAGE_REL_ALPHA_SECTION 0x000E -+#define IMAGE_REL_ALPHA_SECREL 0x000F -+#define IMAGE_REL_ALPHA_REFLONGNB 0x0010 -+#define IMAGE_REL_ALPHA_SECRELLO 0x0011 -+#define IMAGE_REL_ALPHA_SECRELHI 0x0012 -+#define IMAGE_REL_ALPHA_REFQ3 0x0013 -+#define IMAGE_REL_ALPHA_REFQ2 0x0014 -+#define IMAGE_REL_ALPHA_REFQ1 0x0015 -+#define IMAGE_REL_ALPHA_GPRELLO 0x0016 -+#define IMAGE_REL_ALPHA_GPRELHI 0x0017 -+ -+/* PowerPC relocation types */ -+#define IMAGE_REL_PPC_ABSOLUTE 0x0000 -+#define IMAGE_REL_PPC_ADDR64 0x0001 -+#define IMAGE_REL_PPC_ADDR 0x0002 -+#define IMAGE_REL_PPC_ADDR24 0x0003 -+#define IMAGE_REL_PPC_ADDR16 0x0004 -+#define IMAGE_REL_PPC_ADDR14 0x0005 -+#define IMAGE_REL_PPC_REL24 0x0006 -+#define IMAGE_REL_PPC_REL14 0x0007 -+#define IMAGE_REL_PPC_TOCREL16 0x0008 -+#define IMAGE_REL_PPC_TOCREL14 0x0009 -+#define IMAGE_REL_PPC_ADDR32NB 0x000A -+#define IMAGE_REL_PPC_SECREL 0x000B -+#define IMAGE_REL_PPC_SECTION 0x000C -+#define IMAGE_REL_PPC_IFGLUE 0x000D -+#define IMAGE_REL_PPC_IMGLUE 0x000E -+#define IMAGE_REL_PPC_SECREL16 0x000F -+#define IMAGE_REL_PPC_REFHI 0x0010 -+#define IMAGE_REL_PPC_REFLO 0x0011 -+#define IMAGE_REL_PPC_PAIR 0x0012 -+#define IMAGE_REL_PPC_SECRELLO 0x0013 -+#define IMAGE_REL_PPC_SECRELHI 0x0014 -+#define IMAGE_REL_PPC_GPREL 0x0015 -+#define IMAGE_REL_PPC_TYPEMASK 0x00FF -+/* modifier bits */ -+#define IMAGE_REL_PPC_NEG 0x0100 -+#define IMAGE_REL_PPC_BRTAKEN 0x0200 -+#define IMAGE_REL_PPC_BRNTAKEN 0x0400 -+#define IMAGE_REL_PPC_TOCDEFN 0x0800 -+ -+/* SH3 ? relocation type */ -+#define IMAGE_REL_SH3_ABSOLUTE 0x0000 -+#define IMAGE_REL_SH3_DIRECT16 0x0001 -+#define IMAGE_REL_SH3_DIRECT 0x0002 -+#define IMAGE_REL_SH3_DIRECT8 0x0003 -+#define IMAGE_REL_SH3_DIRECT8_WORD 0x0004 -+#define IMAGE_REL_SH3_DIRECT8_LONG 0x0005 -+#define IMAGE_REL_SH3_DIRECT4 0x0006 -+#define IMAGE_REL_SH3_DIRECT4_WORD 0x0007 -+#define IMAGE_REL_SH3_DIRECT4_LONG 0x0008 -+#define IMAGE_REL_SH3_PCREL8_WORD 0x0009 -+#define IMAGE_REL_SH3_PCREL8_LONG 0x000A -+#define IMAGE_REL_SH3_PCREL12_WORD 0x000B -+#define IMAGE_REL_SH3_STARTOF_SECTION 0x000C -+#define IMAGE_REL_SH3_SIZEOF_SECTION 0x000D -+#define IMAGE_REL_SH3_SECTION 0x000E -+#define IMAGE_REL_SH3_SECREL 0x000F -+#define IMAGE_REL_SH3_DIRECT32_NB 0x0010 -+ -+/* ARM (Archimedes?) relocation types */ -+#define IMAGE_REL_ARM_ABSOLUTE 0x0000 -+#define IMAGE_REL_ARM_ADDR 0x0001 -+#define IMAGE_REL_ARM_ADDR32NB 0x0002 -+#define IMAGE_REL_ARM_BRANCH24 0x0003 -+#define IMAGE_REL_ARM_BRANCH11 0x0004 -+#define IMAGE_REL_ARM_SECTION 0x000E -+#define IMAGE_REL_ARM_SECREL 0x000F -+ -+/* IA64 relocation types */ -+#define IMAGE_REL_IA64_ABSOLUTE 0x0000 -+#define IMAGE_REL_IA64_IMM14 0x0001 -+#define IMAGE_REL_IA64_IMM22 0x0002 -+#define IMAGE_REL_IA64_IMM64 0x0003 -+#define IMAGE_REL_IA64_DIR 0x0004 -+#define IMAGE_REL_IA64_DIR64 0x0005 -+#define IMAGE_REL_IA64_PCREL21B 0x0006 -+#define IMAGE_REL_IA64_PCREL21M 0x0007 -+#define IMAGE_REL_IA64_PCREL21F 0x0008 -+#define IMAGE_REL_IA64_GPREL22 0x0009 -+#define IMAGE_REL_IA64_LTOFF22 0x000A -+#define IMAGE_REL_IA64_SECTION 0x000B -+#define IMAGE_REL_IA64_SECREL22 0x000C -+#define IMAGE_REL_IA64_SECREL64I 0x000D -+#define IMAGE_REL_IA64_SECREL 0x000E -+#define IMAGE_REL_IA64_LTOFF64 0x000F -+#define IMAGE_REL_IA64_DIR32NB 0x0010 -+#define IMAGE_REL_IA64_RESERVED_11 0x0011 -+#define IMAGE_REL_IA64_RESERVED_12 0x0012 -+#define IMAGE_REL_IA64_RESERVED_13 0x0013 -+#define IMAGE_REL_IA64_RESERVED_14 0x0014 -+#define IMAGE_REL_IA64_RESERVED_15 0x0015 -+#define IMAGE_REL_IA64_RESERVED_16 0x0016 -+#define IMAGE_REL_IA64_ADDEND 0x001F -+ -+/* archive format */ -+ -+#define IMAGE_ARCHIVE_START_SIZE 8 -+#define IMAGE_ARCHIVE_START "!\n" -+#define IMAGE_ARCHIVE_END "`\n" -+#define IMAGE_ARCHIVE_PAD "\n" -+#define IMAGE_ARCHIVE_LINKER_MEMBER "/ " -+#define IMAGE_ARCHIVE_LONGNAMES_MEMBER "// " -+ -+typedef struct _IMAGE_ARCHIVE_MEMBER_HEADER -+{ -+ BYTE Name[16]; -+ BYTE Date[12]; -+ BYTE UserID[6]; -+ BYTE GroupID[6]; -+ BYTE Mode[8]; -+ BYTE Size[10]; -+ BYTE EndHeader[2]; -+} IMAGE_ARCHIVE_MEMBER_HEADER, *PIMAGE_ARCHIVE_MEMBER_HEADER; -+ -+#define IMAGE_SIZEOF_ARCHIVE_MEMBER_HDR 60 -+ -+/* -+ * Resource directory stuff -+ */ -+typedef struct _IMAGE_RESOURCE_DIRECTORY { -+ DWORD Characteristics; -+ DWORD TimeDateStamp; -+ WORD MajorVersion; -+ WORD MinorVersion; -+ WORD NumberOfNamedEntries; -+ WORD NumberOfIdEntries; -+ /* IMAGE_RESOURCE_DIRECTORY_ENTRY DirectoryEntries[]; */ -+} IMAGE_RESOURCE_DIRECTORY,*PIMAGE_RESOURCE_DIRECTORY; -+ -+#define IMAGE_RESOURCE_NAME_IS_STRING 0x80000000 -+#define IMAGE_RESOURCE_DATA_IS_DIRECTORY 0x80000000 -+ -+typedef struct _IMAGE_RESOURCE_DIRECTORY_ENTRY { -+ union { -+ struct { -+#ifdef BITFIELDS_BIGENDIAN -+ unsigned NameIsString:1; -+ unsigned NameOffset:31; -+#else -+ unsigned NameOffset:31; -+ unsigned NameIsString:1; -+#endif -+ } DUMMYSTRUCTNAME1; -+ DWORD Name; -+ struct { -+#ifdef WORDS_BIGENDIAN -+ WORD __pad; -+ WORD Id; -+#else -+ WORD Id; -+ WORD __pad; -+#endif -+ } DUMMYSTRUCTNAME2; -+ } DUMMYUNIONNAME1; -+ union { -+ DWORD OffsetToData; -+ struct { -+#ifdef BITFIELDS_BIGENDIAN -+ unsigned DataIsDirectory:1; -+ unsigned OffsetToDirectory:31; -+#else -+ unsigned OffsetToDirectory:31; -+ unsigned DataIsDirectory:1; -+#endif -+ } DUMMYSTRUCTNAME3; -+ } DUMMYUNIONNAME2; -+} IMAGE_RESOURCE_DIRECTORY_ENTRY,*PIMAGE_RESOURCE_DIRECTORY_ENTRY; -+ -+ -+typedef struct _IMAGE_RESOURCE_DIRECTORY_STRING { -+ WORD Length; -+ CHAR NameString[ 1 ]; -+} IMAGE_RESOURCE_DIRECTORY_STRING,*PIMAGE_RESOURCE_DIRECTORY_STRING; -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/pnp.c linux-4.12.4-3rd/3rdparty/ndiswrapper/pnp.c ---- linux-4.12.4/3rdparty/ndiswrapper/pnp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/pnp.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,697 @@ -+/* -+ * Copyright (C) 2005 Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include "usb.h" -+#include "pnp.h" -+#include "wrapndis.h" -+#include "loader.h" -+ -+/* Functions callable from the NDIS driver */ -+wstdcall NTSTATUS pdoDispatchDeviceControl(struct device_object *pdo, -+ struct irp *irp); -+wstdcall NTSTATUS pdoDispatchPnp(struct device_object *pdo, struct irp *irp); -+wstdcall NTSTATUS pdoDispatchPower(struct device_object *pdo, struct irp *irp); -+ -+static NTSTATUS start_pdo(struct device_object *pdo) -+{ -+ int i, ret, count, resources_size; -+ struct wrap_device *wd; -+ struct pci_dev *pdev; -+ struct cm_partial_resource_descriptor *entry; -+ struct cm_partial_resource_list *partial_resource_list; -+ -+ ENTER1("%p, %p", pdo, pdo->reserved); -+ wd = pdo->reserved; -+ if (ntoskernel_init_device(wd)) -+ EXIT1(return STATUS_FAILURE); -+ if (wrap_is_usb_bus(wd->dev_bus)) { -+ if (usb_init_device(wd)) { -+ ntoskernel_exit_device(wd); -+ EXIT1(return STATUS_FAILURE); -+ } -+ EXIT1(return STATUS_SUCCESS); -+ } -+ if (!wrap_is_pci_bus(wd->dev_bus)) -+ EXIT1(return STATUS_SUCCESS); -+ pdev = wd->pci.pdev; -+ ret = pci_enable_device(pdev); -+ if (ret) { -+ ERROR("couldn't enable PCI device: %x", ret); -+ return STATUS_FAILURE; -+ } -+ ret = pci_request_regions(pdev, DRIVER_NAME); -+ if (ret) { -+ ERROR("couldn't request PCI regions: %x", ret); -+ goto err_enable; -+ } -+ pci_set_power_state(pdev, PCI_D0); -+#ifdef CONFIG_X86_64 -+ /* 64-bit broadcom driver doesn't work if DMA is allocated -+ * from over 1GB */ -+ if (wd->vendor == 0x14e4) { -+ if (pci_set_dma_mask(pdev, DMA_BIT_MASK(30)) || -+ pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(30))) -+ WARNING("couldn't set DMA mask; this driver " -+ "may not work with more than 1GB RAM"); -+ } -+#endif -+ /* IRQ resource entry is filled in from pdev, instead of -+ * pci_resource macros */ -+ for (i = count = 0; pci_resource_start(pdev, i); i++) -+ if ((pci_resource_flags(pdev, i) & IORESOURCE_MEM) || -+ (pci_resource_flags(pdev, i) & IORESOURCE_IO)) -+ count++; -+ /* space for entry for IRQ is already in -+ * cm_partial_resource_list */ -+ resources_size = sizeof(struct cm_resource_list) + -+ sizeof(struct cm_partial_resource_descriptor) * count; -+ TRACE2("resources: %d, %d", count, resources_size); -+ wd->resource_list = kzalloc(resources_size, GFP_KERNEL); -+ if (!wd->resource_list) { -+ WARNING("couldn't allocate memory"); -+ goto err_regions; -+ } -+ wd->resource_list->count = 1; -+ wd->resource_list->list[0].interface_type = PCIBus; -+ /* bus_number is not used by WDM drivers */ -+ wd->resource_list->list[0].bus_number = pdev->bus->number; -+ -+ partial_resource_list = -+ &wd->resource_list->list->partial_resource_list; -+ partial_resource_list->version = 1; -+ partial_resource_list->revision = 1; -+ partial_resource_list->count = count + 1; -+ -+ for (i = count = 0; pci_resource_start(pdev, i); i++) { -+ entry = &partial_resource_list->partial_descriptors[count]; -+ TRACE2("%d", count); -+ if (pci_resource_flags(pdev, i) & IORESOURCE_MEM) { -+ entry->type = CmResourceTypeMemory; -+ entry->flags = CM_RESOURCE_MEMORY_READ_WRITE; -+ entry->share = CmResourceShareDeviceExclusive; -+ } else if (pci_resource_flags(pdev, i) & IORESOURCE_IO) { -+ entry->type = CmResourceTypePort; -+ entry->flags = CM_RESOURCE_PORT_IO; -+ entry->share = CmResourceShareDeviceExclusive; -+#if 0 -+ } else if (pci_resource_flags(pdev, i) & IORESOURCE_DMA) { -+ /* it looks like no driver uses this resource */ -+ typeof(pci_resource_flags(pdev, 0)) flags; -+ entry->type = CmResourceTypeDma; -+ flags = pci_resource_flags(pdev, i); -+ if (flags & IORESOURCE_DMA_TYPEA) -+ entry->flags |= CM_RESOURCE_DMA_TYPE_A; -+ else if (flags & IORESOURCE_DMA_TYPEB) -+ entry->flags |= CM_RESOURCE_DMA_TYPE_B; -+ else if (flags & IORESOURCE_DMA_TYPEF) -+ entry->flags |= CM_RESOURCE_DMA_TYPE_F; -+ if (flags & IORESOURCE_DMA_8BIT) -+ entry->flags |= CM_RESOURCE_DMA_8; -+ else if (flags & IORESOURCE_DMA_16BIT) -+ entry->flags |= CM_RESOURCE_DMA_16; -+ /* what about 32bit DMA? */ -+ else if (flags & IORESOURCE_DMA_8AND16BIT) -+ entry->flags |= CM_RESOURCE_DMA_8_AND_16; -+ if (flags & IORESOURCE_DMA_MASTER) -+ entry->flags |= CM_RESOURCE_DMA_BUS_MASTER; -+ entry->u.dma.channel = pci_resource_start(pdev, i); -+ /* what should this be? */ -+ entry->u.dma.port = 1; -+#endif -+ } else -+ continue; -+ /* TODO: Add other resource types? */ -+ entry->u.generic.start = -+ (ULONG_PTR)pci_resource_start(pdev, i); -+ entry->u.generic.length = pci_resource_len(pdev, i); -+ count++; -+ } -+ -+ /* put IRQ resource at the end */ -+ entry = &partial_resource_list->partial_descriptors[count++]; -+ entry->type = CmResourceTypeInterrupt; -+ entry->flags = CM_RESOURCE_INTERRUPT_LEVEL_SENSITIVE; -+ /* we assume all devices use shared IRQ */ -+ entry->share = CmResourceShareShared; -+ /* as per documentation, interrupt level should be DIRQL, but -+ * examples from DDK as well some drivers, such as AR5211, -+ * RT8180L use interrupt level as interrupt vector also in -+ * NdisMRegisterInterrupt */ -+ entry->u.interrupt.level = pdev->irq; -+ entry->u.interrupt.vector = pdev->irq; -+ entry->u.interrupt.affinity = -1; -+ -+ TRACE2("resource list count %d, irq: %d", -+ partial_resource_list->count, pdev->irq); -+ pci_set_drvdata(pdev, wd); -+ EXIT1(return STATUS_SUCCESS); -+err_regions: -+ pci_release_regions(pdev); -+err_enable: -+ pci_disable_device(pdev); -+ wd->pci.pdev = NULL; -+ wd->pdo = NULL; -+ EXIT1(return STATUS_FAILURE); -+} -+ -+static void remove_pdo(struct device_object *pdo) -+{ -+ struct wrap_device *wd = pdo->reserved; -+ -+ ntoskernel_exit_device(wd); -+ if (wrap_is_pci_bus(wd->dev_bus)) { -+ struct pci_dev *pdev = wd->pci.pdev; -+ pci_release_regions(pdev); -+ pci_disable_device(pdev); -+ wd->pci.pdev = NULL; -+ pci_set_drvdata(pdev, NULL); -+ } else if (wrap_is_usb_bus(wd->dev_bus)) { -+ usb_exit_device(wd); -+ } -+ kfree(wd->resource_list); -+ wd->resource_list = NULL; -+ return; -+} -+ -+static NTSTATUS IoSendIrpTopDev(struct device_object *dev_obj, ULONG major_fn, -+ ULONG minor_fn, struct io_stack_location *sl) -+{ -+ NTSTATUS status; -+ struct nt_event event; -+ struct irp *irp; -+ struct io_stack_location *irp_sl; -+ struct device_object *top_dev = IoGetAttachedDeviceReference(dev_obj); -+ -+ KeInitializeEvent(&event, NotificationEvent, FALSE); -+ irp = IoBuildSynchronousFsdRequest(IRP_MJ_PNP, top_dev, NULL, 0, NULL, -+ &event, NULL); -+ irp->io_status.status = STATUS_NOT_IMPLEMENTED; -+ irp->io_status.info = 0; -+ irp_sl = IoGetNextIrpStackLocation(irp); -+ if (sl) -+ memcpy(irp_sl, sl, sizeof(*irp_sl)); -+ irp_sl->major_fn = major_fn; -+ irp_sl->minor_fn = minor_fn; -+ status = IoCallDriver(top_dev, irp); -+ if (status == STATUS_PENDING) { -+ KeWaitForSingleObject(&event, Executive, KernelMode, -+ FALSE, NULL); -+ status = irp->io_status.status; -+ } -+ ObDereferenceObject(top_dev); -+ return status; -+} -+ -+wstdcall NTSTATUS pdoDispatchDeviceControl(struct device_object *pdo, -+ struct irp *irp) -+{ -+ NTSTATUS status; -+ struct wrap_device *wd = pdo->reserved; -+ -+ DUMP_IRP(irp); -+ (void)wd; -+ if (wrap_is_usb_bus(wd->dev_bus)) { -+ status = wrap_submit_irp(pdo, irp); -+ IOTRACE("status: %08X", status); -+ if (status != STATUS_PENDING) -+ IoCompleteRequest(irp, IO_NO_INCREMENT); -+ } else { -+ status = irp->io_status.status = STATUS_NOT_IMPLEMENTED; -+ IoCompleteRequest(irp, IO_NO_INCREMENT); -+ } -+ IOEXIT(return status); -+} -+WIN_FUNC_DECL(pdoDispatchDeviceControl,2) -+ -+wstdcall NTSTATUS pdoDispatchPnp(struct device_object *pdo, struct irp *irp) -+{ -+ struct io_stack_location *irp_sl; -+ NTSTATUS status; -+ struct wrap_device *wd = pdo->reserved; -+ -+ irp_sl = IoGetCurrentIrpStackLocation(irp); -+ TRACE2("%p %d:%d", pdo, irp_sl->major_fn, irp_sl->minor_fn); -+ switch (irp_sl->minor_fn) { -+ case IRP_MN_START_DEVICE: -+ status = start_pdo(pdo); -+ break; -+ case IRP_MN_QUERY_STOP_DEVICE: -+ case IRP_MN_STOP_DEVICE: -+ case IRP_MN_QUERY_REMOVE_DEVICE: -+ status = STATUS_SUCCESS; -+ break; -+ case IRP_MN_REMOVE_DEVICE: -+ remove_pdo(pdo); -+ status = STATUS_SUCCESS; -+ break; -+ case IRP_MN_QUERY_INTERFACE: -+ if (wrap_is_usb_bus(wd->dev_bus)) -+ status = usb_query_interface(wd, irp_sl); -+ else -+ status = STATUS_NOT_IMPLEMENTED; -+ break; -+ default: -+ TRACE2("fn %d not implemented", irp_sl->minor_fn); -+ status = STATUS_SUCCESS; -+ break; -+ } -+ irp->io_status.status = status; -+ TRACE2("status: %08X", status); -+ IoCompleteRequest(irp, IO_NO_INCREMENT); -+ IOEXIT(return status); -+} -+WIN_FUNC_DECL(pdoDispatchPnp,2) -+ -+wstdcall NTSTATUS pdoDispatchPower(struct device_object *pdo, struct irp *irp) -+{ -+ struct io_stack_location *irp_sl; -+ struct wrap_device *wd; -+ union power_state power_state; -+ struct pci_dev *pdev; -+ NTSTATUS status; -+ -+ irp_sl = IoGetCurrentIrpStackLocation(irp); -+ wd = pdo->reserved; -+ TRACE2("pdo: %p, fn: %d:%d, wd: %p", -+ pdo, irp_sl->major_fn, irp_sl->minor_fn, wd); -+ switch (irp_sl->minor_fn) { -+ case IRP_MN_WAIT_WAKE: -+ /* TODO: this is not complete/correct */ -+ TRACE2("state: %d, completion: %p", -+ irp_sl->params.power.state.system_state, -+ irp_sl->completion_routine); -+ IoMarkIrpPending(irp); -+ status = STATUS_PENDING; -+ break; -+ case IRP_MN_SET_POWER: -+ power_state = irp_sl->params.power.state; -+ if (power_state.device_state == PowerDeviceD0) { -+ TRACE2("resuming %p", wd); -+ if (wrap_is_pci_bus(wd->dev_bus)) { -+ pdev = wd->pci.pdev; -+ pci_restore_state(pdev); -+ if (wd->pci.wake_state == PowerDeviceD3) { -+ pci_enable_wake(wd->pci.pdev, -+ PCI_D3hot, 0); -+ pci_enable_wake(wd->pci.pdev, -+ PCI_D3cold, 0); -+ } -+ pci_set_power_state(pdev, PCI_D0); -+ } else if (wrap_is_usb_bus(wd->dev_bus)) { -+ wrap_resume_urbs(wd); -+ } -+ } else { -+ TRACE2("suspending device %p", wd); -+ if (wrap_is_pci_bus(wd->dev_bus)) { -+ pdev = wd->pci.pdev; -+ pci_save_state(pdev); -+ TRACE2("%d", wd->pci.wake_state); -+ if (wd->pci.wake_state == PowerDeviceD3) { -+ pci_enable_wake(wd->pci.pdev, -+ PCI_D3hot, 1); -+ pci_enable_wake(wd->pci.pdev, -+ PCI_D3cold, 1); -+ } -+ pci_set_power_state(pdev, PCI_D3hot); -+ } else if (wrap_is_usb_bus(wd->dev_bus)) { -+ wrap_suspend_urbs(wd); -+ } -+ } -+ status = STATUS_SUCCESS; -+ break; -+ case IRP_MN_QUERY_POWER: -+ status = STATUS_SUCCESS; -+ break; -+ default: -+ TRACE2("fn %d not implemented", irp_sl->minor_fn); -+ status = STATUS_SUCCESS; -+ break; -+ } -+ irp->io_status.status = status; -+ IoCompleteRequest(irp, IO_NO_INCREMENT); -+ return status; -+} -+WIN_FUNC_DECL(pdoDispatchPower,2) -+ -+static NTSTATUS pnp_set_device_power_state(struct wrap_device *wd, -+ enum device_power_state state) -+{ -+ NTSTATUS status; -+ struct device_object *pdo; -+ struct io_stack_location irp_sl; -+ -+ pdo = wd->pdo; -+ IOTRACE("%p, %p", pdo, IoGetAttachedDevice(pdo)); -+ memset(&irp_sl, 0, sizeof(irp_sl)); -+ irp_sl.params.power.state.device_state = state; -+ irp_sl.params.power.type = DevicePowerState; -+ if (state > PowerDeviceD0) { -+ status = IoSendIrpTopDev(pdo, IRP_MJ_POWER, IRP_MN_QUERY_POWER, -+ &irp_sl); -+ if (status != STATUS_SUCCESS) { -+ TRACE1("query of power to %d returns %08X", -+ state, status); -+ EXIT1(return status); -+ } -+ } -+ status = IoSendIrpTopDev(pdo, IRP_MJ_POWER, IRP_MN_SET_POWER, &irp_sl); -+ if (status != STATUS_SUCCESS) -+ WARNING("setting power to %d failed: %08X", state, status); -+ EXIT1(return status); -+} -+ -+static NTSTATUS pnp_start_device(struct wrap_device *wd) -+{ -+ struct device_object *fdo; -+ struct device_object *pdo; -+ struct io_stack_location irp_sl; -+ NTSTATUS status; -+ -+ pdo = wd->pdo; -+ /* TODO: for now we use same resources for both translated -+ * resources and raw resources */ -+ memset(&irp_sl, 0, sizeof(irp_sl)); -+ irp_sl.params.start_device.allocated_resources = -+ wd->resource_list; -+ irp_sl.params.start_device.allocated_resources_translated = -+ wd->resource_list; -+ status = IoSendIrpTopDev(pdo, IRP_MJ_PNP, IRP_MN_START_DEVICE, &irp_sl); -+ fdo = IoGetAttachedDevice(pdo); -+ fdo->drv_obj->drv_ext->count++; -+ if (status != STATUS_SUCCESS) -+ WARNING("Windows driver couldn't initialize the device (%08X)", -+ status); -+ EXIT1(return status); -+} -+ -+#if 0 -+static NTSTATUS pnp_stop_device(struct wrap_device *wd) -+{ -+ struct device_object *pdo; -+ NTSTATUS status; -+ -+ pdo = wd->pdo; -+ status = IoSendIrpTopDev(pdo, IRP_MJ_PNP, IRP_MN_QUERY_STOP_DEVICE, -+ NULL); -+ if (status != STATUS_SUCCESS) -+ WARNING("status: %08X", status); -+ /* for now we ignore query status */ -+ status = IoSendIrpTopDev(pdo, IRP_MJ_PNP, IRP_MN_STOP_DEVICE, NULL); -+ if (status != STATUS_SUCCESS) -+ WARNING("status: %08X", status); -+ if (status != STATUS_SUCCESS) -+ WARNING("status: %08X", status); -+ EXIT2(return status); -+} -+#endif -+ -+static NTSTATUS pnp_remove_device(struct wrap_device *wd) -+{ -+ struct device_object *pdo, *fdo; -+ struct driver_object *fdo_drv_obj; -+ NTSTATUS status; -+ -+ pdo = wd->pdo; -+ fdo = IoGetAttachedDevice(pdo); -+ fdo_drv_obj = fdo->drv_obj; -+ TRACE2("%p, %p, %p", pdo, fdo, fdo_drv_obj); -+ status = IoSendIrpTopDev(pdo, IRP_MJ_PNP, IRP_MN_QUERY_REMOVE_DEVICE, -+ NULL); -+ if (status != STATUS_SUCCESS) -+ WARNING("status: %08X", status); -+ -+ status = IoSendIrpTopDev(pdo, IRP_MJ_PNP, IRP_MN_REMOVE_DEVICE, NULL); -+ if (status != STATUS_SUCCESS) -+ WARNING("status: %08X", status); -+ /* TODO: should we use count in drv_ext or driver's Object -+ * header reference count to keep count of devices associated -+ * with a driver? */ -+ if (status == STATUS_SUCCESS) -+ fdo_drv_obj->drv_ext->count--; -+ TRACE1("count: %d", fdo_drv_obj->drv_ext->count); -+ if ((LONG)fdo_drv_obj->drv_ext->count < 0) -+ WARNING("wrong count: %d", fdo_drv_obj->drv_ext->count); -+ if (fdo_drv_obj->drv_ext->count == 0) { -+ struct wrap_driver *wrap_driver; -+ TRACE1("unloading driver: %p", fdo_drv_obj); -+ wrap_driver = -+ IoGetDriverObjectExtension(fdo_drv_obj, -+ (void *)WRAP_DRIVER_CLIENT_ID); -+ if (fdo_drv_obj->unload) -+ LIN2WIN1(fdo_drv_obj->unload, fdo_drv_obj); -+ if (wrap_driver) { -+ mutex_lock(&loader_mutex); -+ unload_wrap_driver(wrap_driver); -+ mutex_unlock(&loader_mutex); -+ } else -+ ERROR("couldn't get wrap_driver"); -+ ObDereferenceObject(fdo_drv_obj); -+ } -+ IoDeleteDevice(pdo); -+ unload_wrap_device(wd); -+ EXIT1(return status); -+} -+ -+WIN_FUNC_DECL(IoInvalidDeviceRequest,2) -+ -+static struct device_object *alloc_pdo(struct driver_object *drv_obj) -+{ -+ struct device_object *pdo; -+ NTSTATUS status; -+ int i; -+ struct ansi_string ansi_name; -+ struct unicode_string unicode_name; -+ -+ RtlInitAnsiString(&ansi_name, "NDISpdo"); -+ if (RtlAnsiStringToUnicodeString(&unicode_name, &ansi_name, TRUE) == -+ STATUS_SUCCESS) { -+ status = IoCreateDevice(drv_obj, 0, &unicode_name, -+ FILE_DEVICE_UNKNOWN, -+ FILE_AUTOGENERATED_DEVICE_NAME, -+ FALSE, &pdo); -+ RtlFreeUnicodeString(&unicode_name); -+ } else { -+ status = IoCreateDevice(drv_obj, 0, NULL, -+ FILE_DEVICE_UNKNOWN, -+ FILE_AUTOGENERATED_DEVICE_NAME, -+ FALSE, &pdo); -+ } -+ TRACE1("%p, %d, %p", drv_obj, status, pdo); -+ if (status != STATUS_SUCCESS) -+ return NULL; -+ /* dispatch routines are called as Windows functions */ -+ for (i = 0; i <= IRP_MJ_MAXIMUM_FUNCTION; i++) -+ drv_obj->major_func[i] = WIN_FUNC_PTR(IoInvalidDeviceRequest,2); -+ drv_obj->major_func[IRP_MJ_INTERNAL_DEVICE_CONTROL] = -+ WIN_FUNC_PTR(pdoDispatchDeviceControl,2); -+ drv_obj->major_func[IRP_MJ_DEVICE_CONTROL] = -+ WIN_FUNC_PTR(pdoDispatchDeviceControl,2); -+ drv_obj->major_func[IRP_MJ_POWER] = WIN_FUNC_PTR(pdoDispatchPower,2); -+ drv_obj->major_func[IRP_MJ_PNP] = WIN_FUNC_PTR(pdoDispatchPnp,2); -+ return pdo; -+} -+ -+static int wrap_pnp_start_device(struct wrap_device *wd) -+{ -+ struct wrap_driver *driver; -+ struct device_object *pdo; -+ struct driver_object *pdo_drv_obj; -+ -+ ENTER1("wd: %p", wd); -+ -+ if (!((wrap_is_pci_bus(wd->dev_bus)) || -+ (wrap_is_usb_bus(wd->dev_bus)))) { -+ ERROR("bus type %d (%d) not supported", -+ WRAP_BUS(wd->dev_bus), wd->dev_bus); -+ EXIT1(return -EINVAL); -+ } -+ driver = load_wrap_driver(wd); -+ if (!driver) -+ return -ENODEV; -+ -+ wd->driver = driver; -+ wd->dev_bus = WRAP_DEVICE_BUS(driver->dev_type, WRAP_BUS(wd->dev_bus)); -+ TRACE1("dev type: %d, bus type: %d, %d", WRAP_DEVICE(wd->dev_bus), -+ WRAP_BUS(wd->dev_bus), wd->dev_bus); -+ TRACE1("%d, %d", driver->dev_type, wrap_is_usb_bus(wd->dev_bus)); -+ /* first create pdo */ -+ if (wrap_is_pci_bus(wd->dev_bus)) -+ pdo_drv_obj = find_bus_driver("PCI"); -+ else // if (wrap_is_usb_bus(wd->dev_bus)) -+ pdo_drv_obj = find_bus_driver("USB"); -+ if (!pdo_drv_obj) -+ return -EINVAL; -+ pdo = alloc_pdo(pdo_drv_obj); -+ if (!pdo) -+ return -ENOMEM; -+ wd->pdo = pdo; -+ pdo->reserved = wd; -+ if (WRAP_DEVICE(wd->dev_bus) == WRAP_NDIS_DEVICE) { -+ if (init_ndis_driver(driver->drv_obj)) { -+ IoDeleteDevice(pdo); -+ return -EINVAL; -+ } -+ } -+ TRACE1("%p", driver->drv_obj->drv_ext->add_device); -+ if (driver->drv_obj->drv_ext->add_device(driver->drv_obj, pdo) != -+ STATUS_SUCCESS) { -+ IoDeleteDevice(pdo); -+ return -ENOMEM; -+ } -+ if (pnp_start_device(wd) != STATUS_SUCCESS) { -+ /* TODO: we need proper cleanup, to deallocate memory, -+ * for example */ -+ pnp_remove_device(wd); -+ return -EINVAL; -+ } -+ return 0; -+} -+ -+int wrap_pnp_start_pci_device(struct pci_dev *pdev, -+ const struct pci_device_id *ent) -+{ -+ struct load_device load_device; -+ struct wrap_device *wd; -+ -+ ENTER1("called for %04x:%04x:%04x:%04x", pdev->vendor, pdev->device, -+ pdev->subsystem_vendor, pdev->subsystem_device); -+ -+ load_device.bus = WRAP_PCI_BUS; -+ load_device.vendor = pdev->vendor; -+ load_device.device = pdev->device; -+ load_device.subvendor = pdev->subsystem_vendor; -+ load_device.subdevice = pdev->subsystem_device; -+ wd = load_wrap_device(&load_device); -+ if (!wd) -+ EXIT1(return -ENODEV); -+ wd->pci.pdev = pdev; -+ return wrap_pnp_start_device(wd); -+} -+ -+void wrap_pnp_remove_pci_device(struct pci_dev *pdev) -+{ -+ struct wrap_device *wd; -+ -+ wd = (struct wrap_device *)pci_get_drvdata(pdev); -+ ENTER1("%p, %p", pdev, wd); -+ if (!wd) -+ EXIT1(return); -+ pnp_remove_device(wd); -+} -+ -+int wrap_pnp_suspend_pci_device(struct pci_dev *pdev, pm_message_t state) -+{ -+ struct wrap_device *wd; -+ -+ wd = (struct wrap_device *)pci_get_drvdata(pdev); -+ return pnp_set_device_power_state(wd, PowerDeviceD3); -+} -+ -+int wrap_pnp_resume_pci_device(struct pci_dev *pdev) -+{ -+ struct wrap_device *wd; -+ -+ wd = (struct wrap_device *)pci_get_drvdata(pdev); -+ return pnp_set_device_power_state(wd, PowerDeviceD0); -+} -+ -+#ifdef ENABLE_USB -+int wrap_pnp_start_usb_device(struct usb_interface *intf, -+ const struct usb_device_id *usb_id) -+{ -+ struct wrap_device *wd; -+ int ret; -+ struct usb_device *udev = interface_to_usbdev(intf); -+ ENTER1("%04x, %04x, %04x", udev->descriptor.idVendor, -+ udev->descriptor.idProduct, udev->descriptor.bDeviceClass); -+ -+ /* USB device (e.g., RNDIS) may have multiple interfaces; -+ initialize one interface only (is there a way to know which -+ of these interfaces is for network?) */ -+ -+ if ((wd = get_wrap_device(udev, WRAP_USB_BUS))) { -+ TRACE1("device already initialized: %p", wd); -+ usb_set_intfdata(intf, NULL); -+ ret = 0; -+ } else { -+ struct load_device load_device; -+ -+ load_device.bus = WRAP_USB_BUS; -+ load_device.vendor = le16_to_cpu(udev->descriptor.idVendor); -+ load_device.device = le16_to_cpu(udev->descriptor.idProduct); -+ load_device.subvendor = 0; -+ load_device.subdevice = 0; -+ wd = load_wrap_device(&load_device); -+ TRACE2("%p", wd); -+ if (wd) { -+ /* some devices (e.g., TI 4150, RNDIS) need -+ * full reset */ -+ ret = usb_reset_device(udev); -+ if (ret) -+ WARNING("reset failed: %d", ret); -+ usb_set_intfdata(intf, wd); -+ wd->usb.intf = intf; -+ wd->usb.udev = udev; -+ ret = wrap_pnp_start_device(wd); -+ } else -+ ret = -ENODEV; -+ } -+ -+ TRACE2("ret: %d", ret); -+ if (ret) -+ EXIT1(return ret); -+ else -+ return 0; -+} -+ -+void wrap_pnp_remove_usb_device(struct usb_interface *intf) -+{ -+ struct wrap_device *wd; -+ -+ wd = (struct wrap_device *)usb_get_intfdata(intf); -+ TRACE1("%p, %p", intf, wd); -+ if (wd == NULL) -+ EXIT1(return); -+ usb_set_intfdata(intf, NULL); -+ wd->usb.intf = NULL; -+ pnp_remove_device(wd); -+} -+ -+int wrap_pnp_suspend_usb_device(struct usb_interface *intf, pm_message_t state) -+{ -+ struct wrap_device *wd; -+ -+ wd = usb_get_intfdata(intf); -+ ENTER1("%p, %p", intf, wd); -+ if (!wd) -+ EXIT1(return 0); -+ if (pnp_set_device_power_state(wd, PowerDeviceD3)) -+ return -1; -+ return 0; -+} -+ -+int wrap_pnp_resume_usb_device(struct usb_interface *intf) -+{ -+ struct wrap_device *wd; -+ wd = usb_get_intfdata(intf); -+ ENTER1("%p, %p", intf, wd); -+ if (!wd) -+ EXIT1(return 0); -+ if (pnp_set_device_power_state(wd, PowerDeviceD0)) -+ return -1; -+ return 0; -+} -+ -+#endif // USB -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/pnp.h linux-4.12.4-3rd/3rdparty/ndiswrapper/pnp.h ---- linux-4.12.4/3rdparty/ndiswrapper/pnp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/pnp.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,36 @@ -+/* -+ * Copyright (C) 2005 Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifndef _PNP_H_ -+#define _PNP_H_ -+ -+#include "ntoskernel.h" -+#include "ndis.h" -+#include "wrapndis.h" -+ -+int wrap_pnp_start_pci_device(struct pci_dev *pdev, -+ const struct pci_device_id *ent); -+void wrap_pnp_remove_pci_device(struct pci_dev *pdev); -+int wrap_pnp_suspend_pci_device(struct pci_dev *pdev, pm_message_t state); -+int wrap_pnp_resume_pci_device(struct pci_dev *pdev); -+ -+int wrap_pnp_start_usb_device(struct usb_interface *intf, -+ const struct usb_device_id *usb_id); -+void wrap_pnp_remove_usb_device(struct usb_interface *intf); -+int wrap_pnp_suspend_usb_device(struct usb_interface *intf, -+ pm_message_t state); -+int wrap_pnp_resume_usb_device(struct usb_interface *intf); -+ -+#endif -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/proc.c linux-4.12.4-3rd/3rdparty/ndiswrapper/proc.c ---- linux-4.12.4/3rdparty/ndiswrapper/proc.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/proc.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,588 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+#include -+#include -+#include -+#include -+ -+#include "ndis.h" -+#include "iw_ndis.h" -+#include "wrapndis.h" -+#include "pnp.h" -+#include "wrapper.h" -+ -+#define MAX_PROC_STR_LEN 32 -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,5,0) -+static kuid_t proc_kuid; -+static kgid_t proc_kgid; -+#else -+#define proc_kuid proc_uid -+#define proc_kgid proc_gid -+#define kuid_t uid_t -+#define kgid_t gid_t -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20) -+static inline struct inode *file_inode(struct file *f) -+{ -+ return f->f_dentry->d_inode; -+} -+#elif LINUX_VERSION_CODE < KERNEL_VERSION(3,9,0) -+static inline struct inode *file_inode(struct file *f) -+{ -+ return f->f_path.dentry->d_inode; -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0) -+static inline void proc_set_user(struct proc_dir_entry *de, kuid_t uid, -+ kgid_t gid) -+{ -+ de->uid = uid; -+ de->gid = gid; -+} -+ -+static inline void proc_remove(struct proc_dir_entry *de) -+{ -+ if (de) -+ remove_proc_entry(de->name, de->parent); -+} -+ -+static inline void *PDE_DATA(const struct inode *inode) -+{ -+ return PDE(inode)->data; -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26) -+static inline struct proc_dir_entry *proc_create_data(const char *name, -+ umode_t mode, struct proc_dir_entry *parent, -+ struct file_operations *fops, void *data) -+{ -+ struct proc_dir_entry *de; -+ -+ de = create_proc_entry(name, mode, parent); -+ if (de) { -+ de->data = data; -+ de->proc_fops = fops; -+ } -+ -+ return de; -+} -+#endif -+ -+static int do_proc_make_entry(const char *name, umode_t mode, -+ struct proc_dir_entry *parent, -+ struct file_operations *fops, kuid_t uid, -+ kgid_t gid, struct ndis_device *wnd) -+{ -+ struct proc_dir_entry *de; -+ -+ de = proc_create_data(name, mode, parent, fops, wnd); -+ if (de == NULL) { -+ ERROR("couldn't create proc entry for '%s'", name); -+ return -ENOMEM; -+ } -+ proc_set_user(de, uid, gid); -+ return 0; -+} -+ -+#define PROC_DECLARE_RO(name) \ -+ static int proc_##name##_open(struct inode *inode, struct file *file) \ -+ { \ -+ return single_open(file, proc_##name##_read, PDE_DATA(inode)); \ -+ } \ -+ static struct file_operations name##_fops = { \ -+ .owner = THIS_MODULE, \ -+ .open = proc_##name##_open, \ -+ .read = seq_read, \ -+ .llseek = seq_lseek, \ -+ .release = single_release, \ -+ }; -+ -+#define PROC_DECLARE_RW(name) \ -+ static int proc_##name##_open(struct inode *inode, struct file *file) \ -+ { \ -+ return single_open(file, proc_##name##_read, PDE_DATA(inode)); \ -+ } \ -+ static struct file_operations name##_fops = { \ -+ .owner = THIS_MODULE, \ -+ .open = proc_##name##_open, \ -+ .read = seq_read, \ -+ .llseek = seq_lseek, \ -+ .release = single_release, \ -+ .write = proc_##name##_write, \ -+ }; -+ -+#define proc_make_entry_ro(name, parent, wnd) \ -+ do_proc_make_entry(#name, S_IFREG | S_IRUSR | S_IRGRP, parent, \ -+ &name##_fops, proc_kuid, proc_kgid, wnd) -+#define proc_make_entry_rw(name, parent, wnd) \ -+ do_proc_make_entry(#name, \ -+ S_IFREG | S_IRUSR | S_IRGRP | S_IWUSR | S_IWGRP, \ -+ parent, &name##_fops, proc_kuid, proc_kgid, wnd) -+ -+#define add_text(fmt, ...) seq_printf(sf, fmt, ##__VA_ARGS__) -+ -+static struct proc_dir_entry *wrap_procfs_entry; -+ -+static int proc_stats_read(struct seq_file *sf, void *v) -+{ -+ struct ndis_device *wnd = (struct ndis_device *)sf->private; -+ struct ndis_wireless_stats stats; -+ NDIS_STATUS res; -+ ndis_rssi rssi; -+ -+ res = mp_query(wnd, OID_802_11_RSSI, &rssi, sizeof(rssi)); -+ if (!res) -+ add_text("signal_level=%d dBm\n", (s32)rssi); -+ -+ res = mp_query(wnd, OID_802_11_STATISTICS, &stats, sizeof(stats)); -+ if (!res) { -+ add_text("tx_frames=%llu\n", stats.tx_frag); -+ add_text("tx_multicast_frames=%llu\n", stats.tx_multi_frag); -+ add_text("tx_failed=%llu\n", stats.failed); -+ add_text("tx_retry=%llu\n", stats.retry); -+ add_text("tx_multi_retry=%llu\n", stats.multi_retry); -+ add_text("tx_rtss_success=%llu\n", stats.rtss_succ); -+ add_text("tx_rtss_fail=%llu\n", stats.rtss_fail); -+ add_text("ack_fail=%llu\n", stats.ack_fail); -+ add_text("frame_duplicates=%llu\n", stats.frame_dup); -+ add_text("rx_frames=%llu\n", stats.rx_frag); -+ add_text("rx_multicast_frames=%llu\n", stats.rx_multi_frag); -+ add_text("fcs_errors=%llu\n", stats.fcs_err); -+ } -+ -+ return 0; -+} -+ -+PROC_DECLARE_RO(stats) -+ -+static int proc_encr_read(struct seq_file *sf, void *v) -+{ -+ struct ndis_device *wnd = (struct ndis_device *)sf->private; -+ int i, encr_status, auth_mode, infra_mode; -+ NDIS_STATUS res; -+ struct ndis_essid essid; -+ mac_address ap_address; -+ -+ res = mp_query(wnd, OID_802_11_BSSID, -+ &ap_address, sizeof(ap_address)); -+ if (res) -+ memset(ap_address, 0, ETH_ALEN); -+ add_text("ap_address=" MACSTRSEP "\n", MAC2STR(ap_address)); -+ -+ res = mp_query(wnd, OID_802_11_SSID, &essid, sizeof(essid)); -+ if (!res) -+ add_text("essid=%.*s\n", essid.length, essid.essid); -+ -+ res = mp_query_int(wnd, OID_802_11_ENCRYPTION_STATUS, &encr_status); -+ if (!res) { -+ typeof(&wnd->encr_info.keys[0]) tx_key; -+ add_text("tx_key=%u\n", wnd->encr_info.tx_key_index); -+ add_text("key="); -+ tx_key = &wnd->encr_info.keys[wnd->encr_info.tx_key_index]; -+ if (tx_key->length > 0) -+ for (i = 0; i < tx_key->length; i++) -+ add_text("%2.2X", tx_key->key[i]); -+ else -+ add_text("off"); -+ add_text("\n"); -+ add_text("encr_mode=%d\n", encr_status); -+ } -+ res = mp_query_int(wnd, OID_802_11_AUTHENTICATION_MODE, &auth_mode); -+ if (!res) -+ add_text("auth_mode=%d\n", auth_mode); -+ res = mp_query_int(wnd, OID_802_11_INFRASTRUCTURE_MODE, &infra_mode); -+ add_text("mode=%s\n", (infra_mode == Ndis802_11IBSS) ? "adhoc" : -+ (infra_mode == Ndis802_11Infrastructure) ? "managed" : "auto"); -+ -+ return 0; -+} -+ -+PROC_DECLARE_RO(encr) -+ -+static int proc_hw_read(struct seq_file *sf, void *v) -+{ -+ struct ndis_device *wnd = (struct ndis_device *)sf->private; -+ struct ndis_configuration config; -+ enum ndis_power power_mode; -+ NDIS_STATUS res; -+ ndis_tx_power_level tx_power; -+ ULONG bit_rate; -+ ndis_rts_threshold rts_threshold; -+ ndis_fragmentation_threshold frag_threshold; -+ ndis_antenna antenna; -+ ULONG packet_filter; -+ int n; -+ mac_address mac; -+ char *hw_status[] = {"ready", "initializing", "resetting", "closing", -+ "not ready"}; -+ -+ res = mp_query_int(wnd, OID_GEN_HARDWARE_STATUS, &n); -+ if (res == NDIS_STATUS_SUCCESS && n >= 0 && n < ARRAY_SIZE(hw_status)) -+ add_text("status=%s\n", hw_status[n]); -+ -+ res = mp_query(wnd, OID_802_3_CURRENT_ADDRESS, mac, sizeof(mac)); -+ if (!res) -+ add_text("mac: " MACSTRSEP "\n", MAC2STR(mac)); -+ res = mp_query(wnd, OID_802_11_CONFIGURATION, &config, sizeof(config)); -+ if (!res) { -+ add_text("beacon_period=%u msec\n", config.beacon_period); -+ add_text("atim_window=%u msec\n", config.atim_window); -+ add_text("frequency=%u kHz\n", config.ds_config); -+ add_text("hop_pattern=%u\n", config.fh_config.hop_pattern); -+ add_text("hop_set=%u\n", config.fh_config.hop_set); -+ add_text("dwell_time=%u msec\n", config.fh_config.dwell_time); -+ } -+ -+ res = mp_query(wnd, OID_802_11_TX_POWER_LEVEL, -+ &tx_power, sizeof(tx_power)); -+ if (!res) -+ add_text("tx_power=%u mW\n", tx_power); -+ -+ res = mp_query(wnd, OID_GEN_LINK_SPEED, &bit_rate, sizeof(bit_rate)); -+ if (!res) -+ add_text("bit_rate=%u kBps\n", (u32)bit_rate / 10); -+ -+ res = mp_query(wnd, OID_802_11_RTS_THRESHOLD, -+ &rts_threshold, sizeof(rts_threshold)); -+ if (!res) -+ add_text("rts_threshold=%u bytes\n", rts_threshold); -+ -+ res = mp_query(wnd, OID_802_11_FRAGMENTATION_THRESHOLD, -+ &frag_threshold, sizeof(frag_threshold)); -+ if (!res) -+ add_text("frag_threshold=%u bytes\n", frag_threshold); -+ -+ res = mp_query_int(wnd, OID_802_11_POWER_MODE, &power_mode); -+ if (!res) -+ add_text("power_mode=%s\n", -+ (power_mode == NDIS_POWER_OFF) ? "always_on" : -+ (power_mode == NDIS_POWER_MAX) ? "max_savings" : -+ "min_savings"); -+ -+ res = mp_query(wnd, OID_802_11_NUMBER_OF_ANTENNAS, -+ &antenna, sizeof(antenna)); -+ if (!res) -+ add_text("num_antennas=%u\n", antenna); -+ -+ res = mp_query(wnd, OID_802_11_TX_ANTENNA_SELECTED, -+ &antenna, sizeof(antenna)); -+ if (!res) -+ add_text("tx_antenna=%u\n", antenna); -+ -+ res = mp_query(wnd, OID_802_11_RX_ANTENNA_SELECTED, -+ &antenna, sizeof(antenna)); -+ if (!res) -+ add_text("rx_antenna=%u\n", antenna); -+ -+ add_text("encryption_modes=%s%s%s%s%s%s%s\n", -+ test_bit(Ndis802_11Encryption1Enabled, &wnd->capa.encr) ? -+ "WEP" : "none", -+ test_bit(Ndis802_11Encryption2Enabled, &wnd->capa.encr) ? -+ "; TKIP with WPA" : "", -+ test_bit(Ndis802_11AuthModeWPA2, &wnd->capa.auth) ? -+ ", WPA2" : "", -+ test_bit(Ndis802_11AuthModeWPA2PSK, &wnd->capa.auth) ? -+ ", WPA2PSK" : "", -+ test_bit(Ndis802_11Encryption3Enabled, &wnd->capa.encr) ? -+ "; AES/CCMP with WPA" : "", -+ test_bit(Ndis802_11AuthModeWPA2, &wnd->capa.auth) ? -+ ", WPA2" : "", -+ test_bit(Ndis802_11AuthModeWPA2PSK, &wnd->capa.auth) ? -+ ", WPA2PSK" : ""); -+ -+ res = mp_query_int(wnd, OID_GEN_CURRENT_PACKET_FILTER, &packet_filter); -+ if (!res) { -+ if (packet_filter != wnd->packet_filter) -+ WARNING("wrong packet_filter? 0x%08x, 0x%08x\n", -+ packet_filter, wnd->packet_filter); -+ add_text("packet_filter: 0x%08x\n", packet_filter); -+ } -+ -+ return 0; -+} -+ -+PROC_DECLARE_RO(hw) -+ -+static int proc_settings_read(struct seq_file *sf, void *v) -+{ -+ struct ndis_device *wnd = (struct ndis_device *)sf->private; -+ struct wrap_device_setting *setting; -+ -+ add_text("hangcheck_interval=%d\n", (hangcheck_interval == 0) ? -+ (wnd->hangcheck_interval / HZ) : -1); -+ -+ list_for_each_entry(setting, &wnd->wd->settings, list) { -+ add_text("%s=%s\n", setting->name, setting->value); -+ } -+ -+ list_for_each_entry(setting, &wnd->wd->driver->settings, list) { -+ add_text("%s=%s\n", setting->name, setting->value); -+ } -+ -+ return 0; -+} -+ -+static ssize_t proc_settings_write(struct file *file, const char __user *buf, -+ size_t count, loff_t *ppos) -+{ -+ struct ndis_device *wnd = PDE_DATA(file_inode(file)); -+ char setting[MAX_PROC_STR_LEN], *p; -+ unsigned int i; -+ NDIS_STATUS res; -+ -+ if (count > MAX_PROC_STR_LEN) -+ return -EINVAL; -+ -+ memset(setting, 0, sizeof(setting)); -+ if (copy_from_user(setting, buf, count)) -+ return -EFAULT; -+ -+ if ((p = strchr(setting, '\n'))) -+ *p = 0; -+ -+ if ((p = strchr(setting, '='))) -+ *p = 0; -+ -+ if (!strcmp(setting, "hangcheck_interval")) { -+ if (!p) -+ return -EINVAL; -+ p++; -+ i = simple_strtol(p, NULL, 10); -+ hangcheck_del(wnd); -+ if (i > 0) { -+ wnd->hangcheck_interval = i * HZ; -+ hangcheck_add(wnd); -+ } -+ } else if (!strcmp(setting, "suspend")) { -+ if (!p) -+ return -EINVAL; -+ p++; -+ i = simple_strtol(p, NULL, 10); -+ if (i <= 0 || i > 3) -+ return -EINVAL; -+ i = -1; -+ if (wrap_is_pci_bus(wnd->wd->dev_bus)) -+ i = wrap_pnp_suspend_pci_device(wnd->wd->pci.pdev, -+ PMSG_SUSPEND); -+ else if (wrap_is_usb_bus(wnd->wd->dev_bus)) -+ i = wrap_pnp_suspend_usb_device(wnd->wd->usb.intf, -+ PMSG_SUSPEND); -+ if (i) -+ return -EINVAL; -+ } else if (!strcmp(setting, "resume")) { -+ i = -1; -+ if (wrap_is_pci_bus(wnd->wd->dev_bus)) -+ i = wrap_pnp_resume_pci_device(wnd->wd->pci.pdev); -+ else if (wrap_is_usb_bus(wnd->wd->dev_bus)) -+ i = wrap_pnp_resume_usb_device(wnd->wd->usb.intf); -+ if (i) -+ return -EINVAL; -+ } else if (!strcmp(setting, "stats_enabled")) { -+ if (!p) -+ return -EINVAL; -+ p++; -+ i = simple_strtol(p, NULL, 10); -+ if (i > 0) -+ wnd->iw_stats_enabled = TRUE; -+ else -+ wnd->iw_stats_enabled = FALSE; -+ } else if (!strcmp(setting, "packet_filter")) { -+ if (!p) -+ return -EINVAL; -+ p++; -+ i = simple_strtol(p, NULL, 10); -+ res = mp_set_int(wnd, OID_GEN_CURRENT_PACKET_FILTER, i); -+ if (res) -+ WARNING("setting packet_filter failed: %08X", res); -+ } else if (!strcmp(setting, "reinit")) { -+ if (ndis_reinit(wnd) != NDIS_STATUS_SUCCESS) -+ return -EFAULT; -+ } else { -+ struct ndis_configuration_parameter param; -+ struct unicode_string key; -+ struct ansi_string ansi; -+ -+ if (!p) -+ return -EINVAL; -+ p++; -+ RtlInitAnsiString(&ansi, p); -+ if (RtlAnsiStringToUnicodeString(¶m.data.string, &ansi, -+ TRUE) != STATUS_SUCCESS) -+ EXIT1(return -EFAULT); -+ param.type = NdisParameterString; -+ RtlInitAnsiString(&ansi, setting); -+ if (RtlAnsiStringToUnicodeString(&key, &ansi, -+ TRUE) != STATUS_SUCCESS) { -+ RtlFreeUnicodeString(¶m.data.string); -+ EXIT1(return -EINVAL); -+ } -+ NdisWriteConfiguration(&res, wnd->nmb, &key, ¶m); -+ RtlFreeUnicodeString(&key); -+ RtlFreeUnicodeString(¶m.data.string); -+ if (res != NDIS_STATUS_SUCCESS) -+ return -EFAULT; -+ } -+ return count; -+} -+ -+PROC_DECLARE_RW(settings) -+ -+int wrap_procfs_add_ndis_device(struct ndis_device *wnd) -+{ -+ int ret; -+ -+ if (wrap_procfs_entry == NULL) -+ return -ENOMEM; -+ -+ if (wnd->procfs_iface) { -+ ERROR("%s already registered?", wnd->net_dev->name); -+ return -EINVAL; -+ } -+ wnd->procfs_iface = proc_mkdir(wnd->net_dev->name, wrap_procfs_entry); -+ if (wnd->procfs_iface == NULL) { -+ ERROR("couldn't create proc directory"); -+ return -ENOMEM; -+ } -+ proc_set_user(wnd->procfs_iface, proc_kuid, proc_kgid); -+ -+ ret = proc_make_entry_ro(hw, wnd->procfs_iface, wnd); -+ if (ret) -+ goto err_hw; -+ -+ ret = proc_make_entry_ro(stats, wnd->procfs_iface, wnd); -+ if (ret) -+ goto err_stats; -+ -+ ret = proc_make_entry_ro(encr, wnd->procfs_iface, wnd); -+ if (ret) -+ goto err_encr; -+ -+ ret = proc_make_entry_rw(settings, wnd->procfs_iface, wnd); -+ if (ret) -+ goto err_settings; -+ -+ return 0; -+ -+err_settings: -+ remove_proc_entry("encr", wnd->procfs_iface); -+err_encr: -+ remove_proc_entry("stats", wnd->procfs_iface); -+err_stats: -+ remove_proc_entry("hw", wnd->procfs_iface); -+err_hw: -+ proc_remove(wnd->procfs_iface); -+ wnd->procfs_iface = NULL; -+ return -ENOMEM; -+} -+ -+void wrap_procfs_remove_ndis_device(struct ndis_device *wnd) -+{ -+ struct proc_dir_entry *procfs_iface = xchg(&wnd->procfs_iface, NULL); -+ -+ if (procfs_iface == NULL) -+ return; -+ remove_proc_entry("hw", procfs_iface); -+ remove_proc_entry("stats", procfs_iface); -+ remove_proc_entry("encr", procfs_iface); -+ remove_proc_entry("settings", procfs_iface); -+ if (wrap_procfs_entry) -+ proc_remove(procfs_iface); -+} -+ -+static int proc_debug_read(struct seq_file *sf, void *v) -+{ -+#if ALLOC_DEBUG -+ enum alloc_type type; -+#endif -+ -+ add_text("%d\n", debug); -+#if ALLOC_DEBUG -+ for (type = 0; type < ALLOC_TYPE_MAX; type++) -+ add_text("total size of allocations in %s: %d\n", -+ alloc_type_name[type], alloc_size(type)); -+#endif -+ return 0; -+} -+ -+static ssize_t proc_debug_write(struct file *file, const char __user *buf, -+ size_t count, loff_t *ppos) -+{ -+ int i; -+ char setting[MAX_PROC_STR_LEN], *p; -+ -+ if (count > MAX_PROC_STR_LEN) -+ return -EINVAL; -+ -+ memset(setting, 0, sizeof(setting)); -+ if (copy_from_user(setting, buf, count)) -+ return -EFAULT; -+ -+ if ((p = strchr(setting, '\n'))) -+ *p = 0; -+ -+ if ((p = strchr(setting, '='))) -+ *p = 0; -+ -+ i = simple_strtol(setting, NULL, 10); -+ if (i >= 0 && i < 10) -+ debug = i; -+ else -+ return -EINVAL; -+ return count; -+} -+ -+PROC_DECLARE_RW(debug) -+ -+int wrap_procfs_init(void) -+{ -+ int ret; -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,5,0) -+ struct user_namespace *ns = current_user_ns(); -+ proc_kuid = make_kuid(ns, proc_uid); -+ if (!uid_valid(proc_kuid)) { -+ ERROR("invalid UID\n"); -+ return -EINVAL; -+ } -+ proc_kgid = make_kgid(ns, proc_gid); -+ if (!gid_valid(proc_kgid)) { -+ ERROR("invalid GID\n"); -+ return -EINVAL; -+ } -+#endif -+ -+ wrap_procfs_entry = proc_mkdir(DRIVER_NAME, proc_net_root); -+ if (wrap_procfs_entry == NULL) { -+ ERROR("couldn't create procfs directory"); -+ return -ENOMEM; -+ } -+ proc_set_user(wrap_procfs_entry, proc_kuid, proc_kgid); -+ -+ ret = proc_make_entry_rw(debug, wrap_procfs_entry, NULL); -+ -+ return ret; -+} -+ -+void wrap_procfs_remove(void) -+{ -+ if (wrap_procfs_entry == NULL) -+ return; -+ remove_proc_entry("debug", wrap_procfs_entry); -+ proc_remove(wrap_procfs_entry); -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/rtl.c linux-4.12.4-3rd/3rdparty/ndiswrapper/rtl.c ---- linux-4.12.4/3rdparty/ndiswrapper/rtl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/rtl.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,715 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * Copyright (C) 2006-2007 Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include "ntoskernel.h" -+#include "rtl_exports.h" -+ -+wstdcall SIZE_T WIN_FUNC(RtlCompareMemory,3) -+ (const void *a, const void *b, SIZE_T len) -+{ -+ size_t i; -+ char *x, *y; -+ -+ ENTER1("%p %p %zd", a, b, len); -+ x = (char *)a; -+ y = (char *)b; -+ /* MSDN says this should return number of bytes that compare as -+ * equal. This can be interpreted as either all bytes that are -+ * equal in 'len' bytes or that only until the bytes compare as -+ * not equal. Initially we had it the former way, but Realtek driver -+ * doesn't like it that way - it takes many attempts to associate -+ * with WPA. ReactOS returns the number of bytes that are equal -+ * before the first differing byte. -+ * According to lords at #reactos, that is the way it should be -+ * and that msdn is wrong about it! -+ */ -+ for (i = 0; i < len && x[i] == y[i]; i++) -+ ; -+ return i; -+} -+ -+wstdcall void WIN_FUNC(RtlCopyMemory,3) -+ (void *dst, const void *src, SIZE_T length) -+{ -+ memcpy(dst, src, length); -+} -+ -+wstdcall void WIN_FUNC(RtlZeroMemory,2) -+ (void *dst, SIZE_T length) -+{ -+ memset(dst, 0, length); -+} -+ -+wstdcall void WIN_FUNC(RtlSecureZeroMemory,2) -+ (void *dst, SIZE_T length) -+{ -+ memset(dst, 0, length); -+} -+ -+wstdcall void WIN_FUNC(RtlFillMemory,3) -+ (void *dest, SIZE_T length, UCHAR fill) -+{ -+ memset(dest, fill, length); -+} -+ -+wstdcall void WIN_FUNC(RtlMoveMemory,3) -+ (void *dest, const void *src, SIZE_T length) -+{ -+ memmove(dest, src, length); -+} -+ -+wstdcall LONG WIN_FUNC(RtlCompareString,3) -+ (const struct ansi_string *s1, const struct ansi_string *s2, -+ BOOLEAN case_insensitive) -+{ -+ unsigned int len; -+ LONG ret = 0; -+ const char *p1, *p2; -+ -+ ENTER2(""); -+ len = min(s1->length, s2->length); -+ p1 = s1->buf; -+ p2 = s2->buf; -+ if (case_insensitive) -+ while (!ret && len--) -+ ret = toupper(*p1++) - toupper(*p2++); -+ else -+ while (!ret && len--) -+ ret = *p1++ - *p2++; -+ if (!ret) -+ ret = s1->length - s2->length; -+ EXIT2(return ret); -+} -+ -+wstdcall LONG WIN_FUNC(RtlCompareUnicodeString,3) -+ (const struct unicode_string *s1, const struct unicode_string *s2, -+ BOOLEAN case_insensitive) -+{ -+ unsigned int len; -+ LONG ret = 0; -+ const wchar_t *p1, *p2; -+ -+ ENTER2(""); -+ -+ len = min(s1->length, s2->length) / sizeof(wchar_t); -+ p1 = s1->buf; -+ p2 = s2->buf; -+ if (case_insensitive) -+ while (!ret && len--) -+ ret = toupper((u8)*p1++) - toupper((u8)*p2++); -+ else -+ while (!ret && len--) -+ ret = (u8)*p1++ - (u8)*p2++; -+ if (!ret) -+ ret = s1->length - s2->length; -+ TRACE2("len: %d, ret: %d", len, ret); -+ EXIT2(return ret); -+} -+ -+wstdcall BOOLEAN WIN_FUNC(RtlEqualString,3) -+ (const struct ansi_string *s1, const struct ansi_string *s2, -+ BOOLEAN case_insensitive) -+{ -+ ENTER1(""); -+ if (s1->length != s2->length) -+ return FALSE; -+ return !RtlCompareString(s1, s2, case_insensitive); -+} -+ -+wstdcall BOOLEAN WIN_FUNC(RtlEqualUnicodeString,3) -+ (const struct unicode_string *s1, const struct unicode_string *s2, -+ BOOLEAN case_insensitive) -+{ -+ if (s1->length != s2->length) -+ return FALSE; -+ return !RtlCompareUnicodeString(s1, s2, case_insensitive); -+} -+ -+wstdcall void WIN_FUNC(RtlCopyUnicodeString,2) -+ (struct unicode_string *dst, struct unicode_string *src) -+{ -+ ENTER1("%p, %p", dst, src); -+ if (src && src->buf && dst->buf) { -+ dst->length = min(src->length, dst->max_length); -+ memcpy(dst->buf, src->buf, dst->length); -+ if (dst->length < dst->max_length) -+ dst->buf[dst->length / sizeof(dst->buf[0])] = 0; -+ } else -+ dst->length = 0; -+ EXIT1(return); -+} -+ -+wstdcall void WIN_FUNC(RtlCopyString,2) -+ (struct ansi_string *dst, struct ansi_string *src) -+{ -+ ENTER1("%p, %p", dst, src); -+ if (src && src->buf && dst->buf) { -+ dst->length = min(src->length, dst->max_length); -+ memcpy(dst->buf, src->buf, dst->length); -+ if (dst->length < dst->max_length) -+ dst->buf[dst->length] = 0; -+ } else -+ dst->length = 0; -+ EXIT1(return); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(RtlAppendUnicodeToString,2) -+ (struct unicode_string *dst, wchar_t *src) -+{ -+ if (src) { -+ int len; -+ for (len = 0; src[len]; len++) -+ ; -+ if (dst->length + (len * sizeof(dst->buf[0])) > dst->max_length) -+ return STATUS_BUFFER_TOO_SMALL; -+ memcpy(&dst->buf[dst->length], src, len * sizeof(dst->buf[0])); -+ dst->length += len * sizeof(dst->buf[0]); -+ if (dst->max_length > dst->length) -+ dst->buf[dst->length / sizeof(dst->buf[0])] = 0; -+ } -+ return STATUS_SUCCESS; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(RtlAppendUnicodeStringToString,2) -+ (struct unicode_string *dst, struct unicode_string *src) -+{ -+ if (dst->max_length < src->length + dst->length) -+ return STATUS_BUFFER_TOO_SMALL; -+ if (src->length) { -+ memcpy(&dst->buf[dst->length], src->buf, src->length); -+ dst->length += src->length; -+ if (dst->max_length > dst->length) -+ dst->buf[dst->length / sizeof(dst->buf[0])] = 0; -+ } -+ EXIT2(return STATUS_SUCCESS); -+} -+ -+wstdcall ULONG WIN_FUNC(RtlxAnsiStringToUnicodeSize,1) -+ (const struct ansi_string *string) -+{ -+ int i; -+ -+ for (i = 0; i < string->max_length && string->buf[i]; i++) -+ ; -+ return i * sizeof(wchar_t); -+} -+ -+wstdcall ULONG WIN_FUNC(RtlxUnicodeStringToAnsiSize,1) -+ (const struct unicode_string *string) -+{ -+ int i; -+ -+ for (i = 0; i < string->max_length && string->buf[i]; i++) -+ ; -+ return i; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(RtlAnsiStringToUnicodeString,3) -+ (struct unicode_string *dst, const struct ansi_string *src, -+ BOOLEAN alloc) -+{ -+ int i, n; -+ -+ n = RtlxAnsiStringToUnicodeSize(src); -+ TRACE2("%d, %d, %d, %d, %p", n, dst->max_length, src->length, -+ src->max_length, src->buf); -+ if (alloc == TRUE) { -+#if 0 -+ if (n == 0) { -+ dst->length = dst->max_length = 0; -+ dst->buf = NULL; -+ EXIT2(return STATUS_SUCCESS); -+ } -+#endif -+ dst->max_length = n + sizeof(dst->buf[0]); -+ dst->buf = ExAllocatePoolWithTag(NonPagedPool, -+ dst->max_length, 0); -+ if (!dst->buf) { -+ dst->max_length = dst->length = 0; -+ EXIT2(return STATUS_NO_MEMORY); -+ } -+ } else if (dst->max_length < n) -+ EXIT2(return STATUS_BUFFER_TOO_SMALL); -+ -+ dst->length = n; -+ n /= sizeof(dst->buf[0]); -+ for (i = 0; i < n; i++) -+ dst->buf[i] = src->buf[i]; -+ if (i * sizeof(dst->buf[0]) < dst->max_length) -+ dst->buf[i] = 0; -+ TRACE2("dst: length: %d, max_length: %d, string: %p", -+ dst->length, dst->max_length, src->buf); -+ EXIT2(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(RtlUnicodeStringToAnsiString,3) -+ (struct ansi_string *dst, const struct unicode_string *src, -+ BOOLEAN alloc) -+{ -+ int i, n; -+ -+ n = RtlxUnicodeStringToAnsiSize(src); -+ TRACE2("%d, %d, %d, %d, %p", n, dst->max_length, src->length, -+ src->max_length, src->buf); -+ if (alloc == TRUE) { -+#if 0 -+ if (n == 0) { -+ dst->length = dst->max_length = 0; -+ dst->buf = NULL; -+ EXIT2(return STATUS_SUCCESS); -+ } -+#endif -+ dst->max_length = n + sizeof(dst->buf[0]); -+ dst->buf = ExAllocatePoolWithTag(NonPagedPool, -+ dst->max_length, 0); -+ if (!dst->buf) { -+ dst->max_length = dst->length = 0; -+ EXIT1(return STATUS_NO_MEMORY); -+ } -+ } else if (dst->max_length < n) -+ EXIT2(return STATUS_BUFFER_TOO_SMALL); -+ -+ dst->length = n; -+ for (i = 0; i < n; i++) -+ dst->buf[i] = src->buf[i]; -+ if (i < dst->max_length) -+ dst->buf[i] = 0; -+ TRACE2("string: %p, len: %d(%d)", dst->buf, dst->length, -+ dst->max_length); -+ EXIT2(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(RtlUnicodeStringToInteger,3) -+ (struct unicode_string *ustring, ULONG base, ULONG *value) -+{ -+ int i, sign = 1; -+ ULONG res; -+ typeof(ustring->buf) string; -+ -+ if (ustring->length == 0) { -+ *value = 0; -+ return STATUS_SUCCESS; -+ } -+ -+ string = ustring->buf; -+ i = 0; -+ while (i < (ustring->length / sizeof(*string)) && string[i] == ' ') -+ i++; -+ if (string[i] == '+') -+ i++; -+ else if (string[i] == '-') { -+ i++; -+ sign = -1; -+ } -+ if (base == 0) { -+ base = 10; -+ if (i <= ((ustring->length / sizeof(*string)) - 2) && -+ string[i] == '0') { -+ i++; -+ if (string[i] == 'b') { -+ base = 2; -+ i++; -+ } else if (string[i] == 'o') { -+ base = 8; -+ i++; -+ } else if (string[i] == 'x') { -+ base = 16; -+ i++; -+ } -+ } -+ } -+ if (!(base == 2 || base == 8 || base == 10 || base == 16)) -+ EXIT2(return STATUS_INVALID_PARAMETER); -+ -+ for (res = 0; i < (ustring->length / sizeof(*string)); i++) { -+ int v; -+ if (isdigit((char)string[i])) -+ v = string[i] - '0'; -+ else if (isxdigit((char)string[i])) -+ v = tolower((char)string[i]) - 'a' + 10; -+ else -+ v = base; -+ if (v >= base) -+ EXIT2(return STATUS_INVALID_PARAMETER); -+ res = res * base + v; -+ } -+ *value = sign * res; -+ EXIT3(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(RtlCharToInteger,3) -+ (const char *string, ULONG base, ULONG *value) -+{ -+ int sign = 1; -+ ULONG res; -+ -+ if (!string || !value) -+ EXIT2(return STATUS_INVALID_PARAMETER); -+ while (*string == ' ') -+ string++; -+ if (*string == '+') -+ string++; -+ else if (*string == '-') { -+ string++; -+ sign = -1; -+ } -+ if (base == 0) { -+ base = 10; -+ if (*string == '0') { -+ string++; -+ if (*string == 'b') { -+ base = 2; -+ string++; -+ } else if (*string == 'o') { -+ base = 8; -+ string++; -+ } else if (*string == 'x') { -+ base = 16; -+ string++; -+ } -+ } -+ } -+ if (!(base == 2 || base == 8 || base == 10 || base == 16)) -+ EXIT2(return STATUS_INVALID_PARAMETER); -+ -+ for (res = 0; *string; string++) { -+ int v; -+ if (isdigit(*string)) -+ v = *string - '0'; -+ else if (isxdigit(*string)) -+ v = tolower(*string) - 'a' + 10; -+ else -+ v = base; -+ if (v >= base) -+ EXIT2(return STATUS_INVALID_PARAMETER); -+ res = res * base + v; -+ } -+ *value = sign * res; -+ EXIT3(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(RtlIntegerToUnicodeString,3) -+ (ULONG value, ULONG base, struct unicode_string *ustring) -+{ -+ typeof(ustring->buf) buf = ustring->buf; -+ int i; -+ -+ if (base == 0) -+ base = 10; -+ if (!(base == 2 || base == 8 || base == 10 || base == 16)) -+ return STATUS_INVALID_PARAMETER; -+ for (i = 0; value && i < ustring->max_length / sizeof(*buf); i++) { -+ int r; -+ r = value % base; -+ value /= base; -+ if (r < 10) -+ buf[i] = r + '0'; -+ else -+ buf[i] = r + 'a' - 10; -+ } -+ if (value) -+ return STATUS_BUFFER_OVERFLOW; -+ ustring->length = i * sizeof(*buf); -+ return STATUS_SUCCESS; -+} -+ -+wstdcall LARGE_INTEGER WIN_FUNC(RtlConvertUlongToLargeInteger,1) -+ (ULONG ul) -+{ -+ LARGE_INTEGER li = ul; -+ return li; -+} -+ -+wfastcall USHORT WIN_FUNC(RtlUshortByteSwap,1) -+ (USHORT src) -+{ -+ return __swab16(src); -+} -+ -+wfastcall ULONG WIN_FUNC(RtlUlongByteSwap,1) -+ (ULONG src) -+{ -+ /* ULONG is 32 bits for both 32-bit and 64-bit architectures */ -+ return __swab32(src); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(RtlUpcaseUnicodeString,3) -+ (struct unicode_string *dst, struct unicode_string *src, BOOLEAN alloc) -+{ -+ USHORT i, n; -+ -+ if (alloc) { -+ dst->buf = ExAllocatePoolWithTag(NonPagedPool, src->length, 0); -+ if (dst->buf) -+ dst->max_length = src->length; -+ else -+ EXIT2(return STATUS_NO_MEMORY); -+ } else { -+ if (dst->max_length < src->length) -+ EXIT2(return STATUS_BUFFER_OVERFLOW); -+ } -+ -+ n = src->length / sizeof(src->buf[0]); -+ for (i = 0; i < n; i++) -+ dst->buf[i] = toupper(src->buf[i]); -+ -+ dst->length = src->length; -+ EXIT3(return STATUS_SUCCESS); -+} -+ -+wstdcall void WIN_FUNC(RtlInitUnicodeString,2) -+ (struct unicode_string *dst, const wchar_t *src) -+{ -+ ENTER2("%p", dst); -+ if (dst == NULL) -+ EXIT1(return); -+ if (src == NULL) { -+ dst->max_length = dst->length = 0; -+ dst->buf = NULL; -+ } else { -+ int i; -+ for (i = 0; (char)src[i]; i++) -+ ; -+ dst->buf = (typeof(dst->buf))src; -+ dst->length = i * sizeof(dst->buf[0]); -+ dst->max_length = (i + 1) * sizeof(dst->buf[0]); -+ } -+ EXIT1(return); -+} -+ -+wstdcall void WIN_FUNC(RtlInitAnsiString,2) -+ (struct ansi_string *dst, const char *src) -+{ -+ ENTER2("%p", dst); -+ if (dst == NULL) -+ EXIT2(return); -+ if (src == NULL) { -+ dst->max_length = dst->length = 0; -+ dst->buf = NULL; -+ } else { -+ int i; -+ for (i = 0; src[i]; i++) -+ ; -+ dst->buf = (typeof(dst->buf))src; -+ dst->length = i; -+ dst->max_length = i + 1; -+ } -+ TRACE2("%p", dst->buf); -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(RtlInitString,2) -+ (struct ansi_string *dst, const char *src) -+{ -+ ENTER2("%p", dst); -+ RtlInitAnsiString(dst, src); -+ EXIT2(return); -+} -+ -+wstdcall void WIN_FUNC(RtlFreeUnicodeString,1) -+ (struct unicode_string *string) -+{ -+ ENTER2("%p", string); -+ if (string == NULL) -+ return; -+ if (string->buf) -+ ExFreePool(string->buf); -+ string->length = string->max_length = 0; -+ string->buf = NULL; -+ return; -+} -+ -+wstdcall void WIN_FUNC(RtlFreeAnsiString,1) -+ (struct ansi_string *string) -+{ -+ ENTER2("%p", string); -+ if (string == NULL) -+ return; -+ if (string->buf) -+ ExFreePool(string->buf); -+ string->length = string->max_length = 0; -+ string->buf = NULL; -+ return; -+} -+ -+/* guid string is of the form: {XXXXXXXX-XXXX-XXXX-XXXX-XXXXXXXXXXXX} */ -+wstdcall NTSTATUS WIN_FUNC(RtlGUIDFromString,2) -+ (struct unicode_string *guid_string, struct guid *guid) -+{ -+ struct ansi_string ansi; -+ NTSTATUS ret; -+ int i, j, k, l, m; -+ -+ ret = RtlUnicodeStringToAnsiString(&ansi, guid_string, TRUE); -+ if (ret != STATUS_SUCCESS) -+ return ret; -+ if (ansi.length != 37 || ansi.buf[0] != '{' || -+ ansi.buf[36] != '}' || ansi.buf[9] != '-' || -+ ansi.buf[14] != '-' || ansi.buf[19] != '-' || -+ ansi.buf[24] != '-') { -+ RtlFreeAnsiString(&ansi); -+ EXIT2(return STATUS_INVALID_PARAMETER); -+ } -+ memcpy(&guid->data4, &ansi.buf[29], sizeof(guid->data3)); -+ /* set end of data3 for scanf */ -+ ansi.buf[29] = 0; -+ if (sscanf(&ansi.buf[1], "%x", &i) == 1 && -+ sscanf(&ansi.buf[10], "%x", &j) == 1 && -+ sscanf(&ansi.buf[15], "%x", &k) == 1 && -+ sscanf(&ansi.buf[20], "%x", &l) == 1 && -+ sscanf(&ansi.buf[25], "%x", &m) == 1) { -+ guid->data1 = (i << 16) | (j < 8) | k; -+ guid->data2 = l; -+ guid->data3 = m; -+ ret = STATUS_SUCCESS; -+ } else -+ ret = STATUS_INVALID_PARAMETER; -+ RtlFreeAnsiString(&ansi); -+ return ret; -+} -+ -+wstdcall NTSTATUS WIN_FUNC(RtlQueryRegistryValues,5) -+ (ULONG relative, wchar_t *path, struct rtl_query_registry_table *tbl, -+ void *context, void *env) -+{ -+ struct ansi_string ansi; -+ struct unicode_string unicode; -+ NTSTATUS status, ret; -+ static int i = 0; -+ -+ ENTER3("%x, %p", relative, tbl); -+// TODO(); -+ -+ RtlInitUnicodeString(&unicode, path); -+ if (RtlUnicodeStringToAnsiString(&ansi, &unicode, TRUE) == -+ STATUS_SUCCESS) { -+ TRACE2("%s", ansi.buf); -+ RtlFreeAnsiString(&ansi); -+ } -+ ret = STATUS_SUCCESS; -+ for (; tbl->name; tbl++) { -+ RtlInitUnicodeString(&unicode, tbl->name); -+ if (RtlUnicodeStringToAnsiString(&ansi, &unicode, TRUE) == -+ STATUS_SUCCESS) { -+ TRACE2("name: %s", ansi.buf); -+ RtlFreeAnsiString(&ansi); -+ } -+ TRACE2("flags: %08X", tbl->flags); -+ if (tbl->flags == RTL_QUERY_REGISTRY_DIRECT) { -+ TRACE2("type: %08X", tbl->def_type); -+ if (tbl->def_type == REG_DWORD) { -+ /* Atheros USB driver needs this, but -+ * don't know where and how to get its -+ * value */ -+ if (tbl->def_data) { -+ TRACE2("def_data: %x", -+ *(int *)tbl->def_data); -+ *(DWORD *)tbl->context = 0x5f292a + i++; -+// *(DWORD *)tbl->def_data; -+ } else -+ *(DWORD *)tbl->context = 0x2345dbe; -+ } -+ } else { -+ void *data; -+ ULONG type, length; -+ -+ if (!tbl->query_func) { -+ ERROR("oops: no query_func"); -+ ret = STATUS_INVALID_PARAMETER; -+ break; -+ } -+ if (tbl->flags & RTL_QUERY_REGISTRY_NOVALUE) { -+ data = NULL; -+ type = REG_NONE; -+ length = 0; -+ } else { -+ data = tbl->def_data; -+ type = tbl->def_type; -+ length = tbl->def_length;; -+ } -+ TRACE2("calling query_func: %p", tbl->query_func); -+ status = LIN2WIN6(tbl->query_func, tbl->name, type, -+ data, length, context, env); -+ TRACE2("status: %08X", status); -+ if (status) { -+ if (status == STATUS_BUFFER_TOO_SMALL) -+ ret = STATUS_BUFFER_TOO_SMALL; -+ else -+ EXIT2(return STATUS_INVALID_PARAMETER); -+ } -+ } -+ } -+ EXIT3(return ret); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(RtlWriteRegistryValue,6) -+ (ULONG relative, wchar_t *path, wchar_t *name, ULONG type, -+ void *data, ULONG length) -+{ -+ struct ansi_string ansi; -+ struct unicode_string unicode; -+ -+ ENTER3("%d", relative); -+ TODO(); -+ -+ RtlInitUnicodeString(&unicode, path); -+ if (RtlUnicodeStringToAnsiString(&ansi, &unicode, TRUE) == -+ STATUS_SUCCESS) { -+ TRACE2("%s", ansi.buf); -+ RtlFreeAnsiString(&ansi); -+ } -+ RtlInitUnicodeString(&unicode, name); -+ if (RtlUnicodeStringToAnsiString(&ansi, &unicode, TRUE) == -+ STATUS_SUCCESS) { -+ TRACE2("%s", ansi.buf); -+ RtlFreeAnsiString(&ansi); -+ } -+ EXIT5(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS WIN_FUNC(RtlDeleteRegistryValue,3) -+ (ULONG relative, wchar_t *path, wchar_t *name) -+{ -+ return STATUS_SUCCESS; -+} -+ -+wstdcall void WIN_FUNC(RtlAssert,4) -+ (char *failed_assertion, char *file_name, ULONG line_num, char *message) -+{ -+ ERROR("assertion '%s' failed at %s line %d%s", -+ failed_assertion, file_name, line_num, message ? message : ""); -+ return; -+} -+ -+wstdcall void WIN_FUNC(RtlUnwind,0) -+ (void) -+{ -+ TODO(); -+} -+ -+wstdcall void WIN_FUNC(RtlRaiseException,1) -+ (void *exception_record) -+{ -+ TODO(); -+} -+ -+wstdcall BOOLEAN WIN_FUNC(RtlIsServicePackVersionInstalled,1) -+ (ULONG version) -+{ -+ /* Assume we have all service packs */ -+ TRACE1("version: %d", version); -+ return TRUE; -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/usb.c linux-4.12.4-3rd/3rdparty/ndiswrapper/usb.c ---- linux-4.12.4/3rdparty/ndiswrapper/usb.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/usb.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,1496 @@ -+/* -+ * Copyright (C) 2004 Jan Kiszka -+ * Copyright (C) 2005 Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include "ndis.h" -+#include "usb.h" -+#include "usb_exports.h" -+ -+#ifdef USB_DEBUG -+static unsigned int urb_id = 0; -+ -+#define DUMP_WRAP_URB(wrap_urb, dir) \ -+ USBTRACE("urb %p (%d) %s: buf: %p, len: %d, pipe: 0x%x, %d", \ -+ (wrap_urb)->urb, (wrap_urb)->id, \ -+ (dir == USB_DIR_OUT) ? "going down" : "coming back", \ -+ (wrap_urb)->urb->transfer_buffer, \ -+ (wrap_urb)->urb->transfer_buffer_length, \ -+ (wrap_urb)->urb->pipe, (wrap_urb)->urb->status) -+ -+#define DUMP_URB_BUFFER(urb, dir) \ -+ while (debug >= 2) { \ -+ int i; \ -+ char msg[20], *t; \ -+ if (!urb->transfer_buffer) \ -+ break; \ -+ if (!((usb_pipein(urb->pipe) && dir == USB_DIR_IN) || \ -+ (usb_pipeout(urb->pipe) && dir == USB_DIR_OUT))) \ -+ break; \ -+ t = msg; \ -+ t += sprintf(t, "%d: ", (urb)->actual_length); \ -+ for (i = 0; i < urb->actual_length && \ -+ t < &msg[sizeof(msg) - 4]; i++) \ -+ t += sprintf(t, "%02X ", \ -+ ((char *)urb->transfer_buffer)[i]); \ -+ *t = 0; \ -+ USBTRACE("%s", msg); \ -+ break; \ -+ } -+ -+#else -+ -+#define DUMP_WRAP_URB(wrap_urb, dir) (void)0 -+#define DUMP_URB_BUFFER(urb, dir) (void)0 -+ -+#endif -+ -+#define CUR_ALT_SETTING(intf) (intf)->cur_altsetting -+ -+#ifndef USB_CTRL_SET_TIMEOUT -+#define USB_CTRL_SET_TIMEOUT 5000 -+#endif -+ -+#ifndef USB_CTRL_GET_TIMEOUT -+#define USB_CTRL_GET_TIMEOUT 5000 -+#endif -+ -+#ifndef URB_NO_TRANSFER_DMA_MAP -+#define URB_NO_TRANSFER_DMA_MAP 0 -+#endif -+ -+/* wrap_urb->flags */ -+/* transfer_buffer for urb is allocated; free it in wrap_free_urb */ -+#define WRAP_URB_COPY_BUFFER 0x01 -+ -+static inline int wrap_cancel_urb(struct wrap_urb *wrap_urb) -+{ -+ int ret; -+ USBTRACE("%p, %p, %d", wrap_urb, wrap_urb->urb, wrap_urb->state); -+ if (wrap_urb->state != URB_SUBMITTED) -+ USBEXIT(return -1); -+ ret = usb_unlink_urb(wrap_urb->urb); -+ USBTRACE("ret: %d", ret); -+ if (ret == -EINPROGRESS) -+ return 0; -+ else { -+ WARNING("unlink failed: %d", ret); -+ return ret; -+ } -+} -+ -+#define URB_STATUS(wrap_urb) (wrap_urb->urb->status) -+ -+static struct nt_list wrap_urb_complete_list; -+static spinlock_t wrap_urb_complete_list_lock; -+ -+static struct work_struct wrap_urb_complete_work; -+static void wrap_urb_complete_worker(struct work_struct *dummy); -+ -+static void kill_all_urbs(struct wrap_device *wd, int complete) -+{ -+ struct nt_list *ent; -+ struct wrap_urb *wrap_urb; -+ KIRQL irql; -+ -+ USBTRACE("%d", wd->usb.num_alloc_urbs); -+ while (1) { -+ IoAcquireCancelSpinLock(&irql); -+ ent = RemoveHeadList(&wd->usb.wrap_urb_list); -+ IoReleaseCancelSpinLock(irql); -+ if (!ent) -+ break; -+ wrap_urb = container_of(ent, struct wrap_urb, list); -+ if (wrap_urb->state == URB_SUBMITTED) { -+ WARNING("Windows driver %s didn't free urb: %p", -+ wd->driver->name, wrap_urb->urb); -+ if (!complete) -+ wrap_urb->urb->complete = NULL; -+ usb_kill_urb(wrap_urb->urb); -+ } -+ USBTRACE("%p, %p", wrap_urb, wrap_urb->urb); -+ usb_free_urb(wrap_urb->urb); -+ kfree(wrap_urb); -+ } -+ wd->usb.num_alloc_urbs = 0; -+} -+ -+/* for a given Linux urb status code, return corresponding NT urb status */ -+static USBD_STATUS wrap_urb_status(int urb_status) -+{ -+ switch (urb_status) { -+ case 0: -+ return USBD_STATUS_SUCCESS; -+ case -EPROTO: -+ return USBD_STATUS_TIMEOUT; -+ case -EILSEQ: -+ return USBD_STATUS_CRC; -+ case -EPIPE: -+ return USBD_STATUS_INVALID_PIPE_HANDLE; -+ case -ECOMM: -+ return USBD_STATUS_DATA_OVERRUN; -+ case -ENOSR: -+ return USBD_STATUS_DATA_UNDERRUN; -+ case -EOVERFLOW: -+ return USBD_STATUS_BABBLE_DETECTED; -+ case -EREMOTEIO: -+ return USBD_STATUS_ERROR_SHORT_TRANSFER;; -+ case -ENODEV: -+ case -ESHUTDOWN: -+ case -ENOENT: -+ return USBD_STATUS_DEVICE_GONE; -+ case -ENOMEM: -+ return USBD_STATUS_NO_MEMORY; -+ case -EINVAL: -+ return USBD_STATUS_REQUEST_FAILED; -+ default: -+ return USBD_STATUS_NOT_SUPPORTED; -+ } -+} -+ -+/* for a given USBD_STATUS, return its corresponding NTSTATUS (for irp) */ -+static NTSTATUS nt_urb_irp_status(USBD_STATUS nt_urb_status) -+{ -+ switch (nt_urb_status) { -+ case USBD_STATUS_SUCCESS: -+ return STATUS_SUCCESS; -+ case USBD_STATUS_DEVICE_GONE: -+ return STATUS_DEVICE_REMOVED; -+ case USBD_STATUS_PENDING: -+ return STATUS_PENDING; -+ case USBD_STATUS_NOT_SUPPORTED: -+ return STATUS_NOT_IMPLEMENTED; -+ case USBD_STATUS_NO_MEMORY: -+ return STATUS_NO_MEMORY; -+ case USBD_STATUS_REQUEST_FAILED: -+ return STATUS_NOT_SUPPORTED; -+ default: -+ return STATUS_FAILURE; -+ } -+} -+ -+static void wrap_free_urb(struct urb *urb) -+{ -+ struct wrap_urb *wrap_urb = urb->context; -+ struct irp *irp = wrap_urb->irp; -+ struct wrap_device *wd = IRP_WRAP_DEVICE(irp); -+ -+ USBTRACE("freeing urb: %p", urb); -+ irp->cancel_routine = NULL; -+ IRP_WRAP_URB(irp) = NULL; -+ if (wrap_urb->flags & WRAP_URB_COPY_BUFFER) { -+ USBTRACE("freeing DMA buffer for URB: %p %p", -+ urb, urb->transfer_buffer); -+ usb_free_coherent(wd->usb.udev, urb->transfer_buffer_length, -+ urb->transfer_buffer, urb->transfer_dma); -+ } -+ kfree(urb->setup_packet); -+ if (wd->usb.num_alloc_urbs > MAX_ALLOCATED_URBS) { -+ IoAcquireCancelSpinLock(&irp->cancel_irql); -+ RemoveEntryList(&wrap_urb->list); -+ wd->usb.num_alloc_urbs--; -+ IoReleaseCancelSpinLock(irp->cancel_irql); -+ usb_free_urb(urb); -+ kfree(wrap_urb); -+ } else { -+ wrap_urb->state = URB_FREE; -+ wrap_urb->flags = 0; -+ wrap_urb->irp = NULL; -+ } -+ return; -+} -+ -+void wrap_suspend_urbs(struct wrap_device *wd) -+{ -+ /* TODO: do we need to cancel urbs? */ -+ USBTRACE("%p, %d", wd, wd->usb.num_alloc_urbs); -+} -+ -+void wrap_resume_urbs(struct wrap_device *wd) -+{ -+ /* TODO: do we need to resubmit urbs? */ -+ USBTRACE("%p, %d", wd, wd->usb.num_alloc_urbs); -+} -+ -+wstdcall void wrap_cancel_irp(struct device_object *dev_obj, struct irp *irp) -+{ -+ struct urb *urb; -+ struct wrap_urb *wrap_urb = IRP_WRAP_URB(irp); -+ -+ /* NB: this function is called holding Cancel spinlock */ -+ USBENTER("irp: %p", irp); -+ urb = wrap_urb->urb; -+ USBTRACE("canceling urb %p", urb); -+ if (wrap_cancel_urb(IRP_WRAP_URB(irp))) { -+ irp->cancel = FALSE; -+ ERROR("urb %p can't be canceled: %d", urb, wrap_urb->state); -+ } else -+ USBTRACE("urb %p canceled", urb); -+ IoReleaseCancelSpinLock(irp->cancel_irql); -+ return; -+} -+WIN_FUNC_DECL(wrap_cancel_irp,2) -+ -+static struct urb *wrap_alloc_urb(struct irp *irp, unsigned int pipe, -+ void *buf, unsigned int buf_len) -+{ -+ struct urb *urb; -+ gfp_t alloc_flags; -+ struct wrap_urb *wrap_urb; -+ struct wrap_device *wd; -+ -+ USBENTER("irp: %p", irp); -+ wd = IRP_WRAP_DEVICE(irp); -+ -+ /* Don't interfere with URB cleanup by the kernel */ -+ if (test_bit(HW_DISABLED, &wd->hw_status)) -+ return NULL; -+ -+ alloc_flags = irql_gfp(); -+ IoAcquireCancelSpinLock(&irp->cancel_irql); -+ urb = NULL; -+ nt_list_for_each_entry(wrap_urb, &wd->usb.wrap_urb_list, list) { -+ if (cmpxchg(&wrap_urb->state, URB_FREE, -+ URB_ALLOCATED) == URB_FREE) { -+ urb = wrap_urb->urb; -+ /* Clean URB but keep the refcount */ -+ memset((char *)urb + sizeof(urb->kref), 0, -+ sizeof(*urb) - sizeof(urb->kref)); -+ break; -+ } -+ } -+ if (!urb) { -+ IoReleaseCancelSpinLock(irp->cancel_irql); -+ wrap_urb = kzalloc(sizeof(*wrap_urb), alloc_flags); -+ if (!wrap_urb) { -+ WARNING("couldn't allocate memory"); -+ return NULL; -+ } -+ urb = usb_alloc_urb(0, alloc_flags); -+ if (!urb) { -+ WARNING("couldn't allocate urb"); -+ kfree(wrap_urb); -+ return NULL; -+ } -+ IoAcquireCancelSpinLock(&irp->cancel_irql); -+ wrap_urb->urb = urb; -+ wrap_urb->state = URB_ALLOCATED; -+ InsertTailList(&wd->usb.wrap_urb_list, &wrap_urb->list); -+ wd->usb.num_alloc_urbs++; -+ } -+ -+#ifdef URB_ASYNC_UNLINK -+ urb->transfer_flags |= URB_ASYNC_UNLINK; -+#elif defined(USB_ASYNC_UNLINK) -+ urb->transfer_flags |= USB_ASYNC_UNLINK; -+#endif -+ urb->context = wrap_urb; -+ wrap_urb->irp = irp; -+ IRP_WRAP_URB(irp) = wrap_urb; -+ /* called as Windows function */ -+ irp->cancel_routine = WIN_FUNC_PTR(wrap_cancel_irp,2); -+ IoReleaseCancelSpinLock(irp->cancel_irql); -+ USBTRACE("urb: %p", urb); -+ -+ urb->transfer_buffer_length = buf_len; -+ if (buf_len && buf && (!virt_addr_valid(buf) -+#if defined(CONFIG_HIGHMEM) || defined(CONFIG_HIGHMEM4G) -+ || PageHighMem(virt_to_page(buf)) -+#endif -+ )) { -+ urb->transfer_buffer = -+ usb_alloc_coherent(wd->usb.udev, buf_len, alloc_flags, -+ &urb->transfer_dma); -+ if (!urb->transfer_buffer) { -+ WARNING("couldn't allocate dma buf"); -+ IoAcquireCancelSpinLock(&irp->cancel_irql); -+ irp->cancel_routine = NULL; -+ wrap_urb->state = URB_FREE; -+ wrap_urb->irp = NULL; -+ IRP_WRAP_URB(irp) = NULL; -+ IoReleaseCancelSpinLock(irp->cancel_irql); -+ return NULL; -+ } -+ if (urb->transfer_dma) -+ urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; -+ wrap_urb->flags |= WRAP_URB_COPY_BUFFER; -+ if (usb_pipeout(pipe)) -+ memcpy(urb->transfer_buffer, buf, buf_len); -+ USBTRACE("DMA buf for urb %p: %p", urb, urb->transfer_buffer); -+ } else -+ urb->transfer_buffer = buf; -+ return urb; -+} -+ -+static USBD_STATUS wrap_submit_urb(struct irp *irp) -+{ -+ int ret; -+ struct wrap_urb *wrap_urb = IRP_WRAP_URB(irp); -+ struct urb *urb = wrap_urb->urb; -+ union nt_urb *nt_urb = IRP_URB(irp); -+ -+#ifdef USB_DEBUG -+ if (wrap_urb->state != URB_ALLOCATED) { -+ ERROR("urb %p is in wrong state: %d", -+ urb, wrap_urb->state); -+ NT_URB_STATUS(nt_urb) = USBD_STATUS_REQUEST_FAILED; -+ return NT_URB_STATUS(nt_urb); -+ } -+ wrap_urb->id = pre_atomic_add(urb_id, 1); -+#endif -+ DUMP_WRAP_URB(IRP_WRAP_URB(irp), USB_DIR_OUT); -+ irp->io_status.status = STATUS_PENDING; -+ irp->io_status.info = 0; -+ NT_URB_STATUS(nt_urb) = USBD_STATUS_PENDING; -+ IoMarkIrpPending(irp); -+ DUMP_URB_BUFFER(urb, USB_DIR_OUT); -+ USBTRACE("%p", urb); -+ wrap_urb->state = URB_SUBMITTED; -+ ret = usb_submit_urb(urb, irql_gfp()); -+ if (ret) { -+ USBTRACE("ret: %d", ret); -+ wrap_free_urb(urb); -+ /* we assume that IRP was not in pending state before */ -+ IoUnmarkIrpPending(irp); -+ NT_URB_STATUS(nt_urb) = wrap_urb_status(ret); -+ USBEXIT(return NT_URB_STATUS(nt_urb)); -+ } else -+ USBEXIT(return USBD_STATUS_PENDING); -+} -+ -+static void wrap_urb_complete(struct urb *urb ISR_PT_REGS_PARAM_DECL) -+{ -+ struct irp *irp; -+ struct wrap_urb *wrap_urb; -+ -+ wrap_urb = urb->context; -+ USBTRACE("%p (%p) completed", wrap_urb, urb); -+ irp = wrap_urb->irp; -+ DUMP_WRAP_URB(wrap_urb, USB_DIR_IN); -+ irp->cancel_routine = NULL; -+#ifdef USB_DEBUG -+ if (wrap_urb->state != URB_SUBMITTED) { -+ WARNING("urb %p in wrong state: %d (%d)", urb, wrap_urb->state, -+ urb->status); -+ return; -+ } -+#endif -+ wrap_urb->state = URB_COMPLETED; -+ spin_lock(&wrap_urb_complete_list_lock); -+ InsertTailList(&wrap_urb_complete_list, &wrap_urb->complete_list); -+ spin_unlock(&wrap_urb_complete_list_lock); -+ queue_work(ntos_wq, &wrap_urb_complete_work); -+} -+ -+/* one worker for all devices */ -+static void wrap_urb_complete_worker(struct work_struct *dummy) -+{ -+ struct irp *irp; -+ struct urb *urb; -+ struct usbd_bulk_or_intr_transfer *bulk_int_tx; -+ struct usbd_vendor_or_class_request *vc_req; -+ union nt_urb *nt_urb; -+ struct wrap_urb *wrap_urb; -+ struct nt_list *ent; -+ unsigned long flags; -+ -+ USBENTER(""); -+ while (1) { -+ spin_lock_irqsave(&wrap_urb_complete_list_lock, flags); -+ ent = RemoveHeadList(&wrap_urb_complete_list); -+ spin_unlock_irqrestore(&wrap_urb_complete_list_lock, flags); -+ if (!ent) -+ break; -+ wrap_urb = container_of(ent, struct wrap_urb, complete_list); -+ urb = wrap_urb->urb; -+#ifdef USB_DEBUG -+ if (wrap_urb->state != URB_COMPLETED && -+ wrap_urb->state != URB_INT_UNLINKED) -+ WARNING("urb %p in wrong state: %d", -+ urb, wrap_urb->state); -+#endif -+ irp = wrap_urb->irp; -+ DUMP_IRP(irp); -+ nt_urb = IRP_URB(irp); -+ USBTRACE("urb: %p, nt_urb: %p, status: %d", -+ urb, nt_urb, urb->status); -+ switch (urb->status) { -+ case 0: -+ /* successfully transferred */ -+ irp->io_status.info = urb->actual_length; -+ if (nt_urb->header.function == -+ URB_FUNCTION_BULK_OR_INTERRUPT_TRANSFER) { -+ bulk_int_tx = &nt_urb->bulk_int_transfer; -+ bulk_int_tx->transfer_buffer_length = -+ urb->actual_length; -+ DUMP_URB_BUFFER(urb, USB_DIR_IN); -+ if ((wrap_urb->flags & WRAP_URB_COPY_BUFFER) && -+ usb_pipein(urb->pipe)) -+ memcpy(bulk_int_tx->transfer_buffer, -+ urb->transfer_buffer, -+ urb->actual_length); -+ } else { // vendor or class request -+ vc_req = &nt_urb->vendor_class_request; -+ vc_req->transfer_buffer_length = -+ urb->actual_length; -+ DUMP_URB_BUFFER(urb, USB_DIR_IN); -+ if ((wrap_urb->flags & WRAP_URB_COPY_BUFFER) && -+ usb_pipein(urb->pipe)) -+ memcpy(vc_req->transfer_buffer, -+ urb->transfer_buffer, -+ urb->actual_length); -+ } -+ NT_URB_STATUS(nt_urb) = USBD_STATUS_SUCCESS; -+ irp->io_status.status = STATUS_SUCCESS; -+ break; -+ case -ENOENT: -+ case -ECONNRESET: -+ /* urb canceled */ -+ irp->io_status.info = 0; -+ TRACE2("urb %p canceled", urb); -+ NT_URB_STATUS(nt_urb) = USBD_STATUS_SUCCESS; -+ irp->io_status.status = STATUS_CANCELLED; -+ break; -+ default: -+ TRACE2("irp: %p, urb: %p, status: %d/%d", -+ irp, urb, urb->status, wrap_urb->state); -+ irp->io_status.info = 0; -+ NT_URB_STATUS(nt_urb) = wrap_urb_status(urb->status); -+ irp->io_status.status = -+ nt_urb_irp_status(NT_URB_STATUS(nt_urb)); -+ break; -+ } -+ wrap_free_urb(urb); -+ IoCompleteRequest(irp, IO_NO_INCREMENT); -+ } -+ USBEXIT(return); -+} -+ -+static USBD_STATUS wrap_bulk_or_intr_trans(struct irp *irp) -+{ -+ struct usb_endpoint_descriptor *pipe_handle; -+ struct urb *urb; -+ unsigned int pipe; -+ struct usbd_bulk_or_intr_transfer *bulk_int_tx; -+ USBD_STATUS status; -+ struct wrap_device *wd = IRP_WRAP_DEVICE(irp); -+ struct usb_device *udev = wd->usb.udev; -+ union nt_urb *nt_urb = IRP_URB(irp); -+ -+ bulk_int_tx = &nt_urb->bulk_int_transfer; -+ pipe_handle = bulk_int_tx->pipe_handle; -+ USBTRACE("flags: 0x%x, length: %u, buffer: %p, handle: %p", -+ bulk_int_tx->transfer_flags, -+ bulk_int_tx->transfer_buffer_length, -+ bulk_int_tx->transfer_buffer, pipe_handle); -+ -+ if (USBD_IS_BULK_PIPE(pipe_handle)) { -+ if (bulk_int_tx->transfer_flags & USBD_TRANSFER_DIRECTION_IN) -+ pipe = usb_rcvbulkpipe(udev, -+ pipe_handle->bEndpointAddress); -+ else -+ pipe = usb_sndbulkpipe(udev, -+ pipe_handle->bEndpointAddress); -+ } else { -+ if (bulk_int_tx->transfer_flags & USBD_TRANSFER_DIRECTION_IN) -+ pipe = usb_rcvintpipe(udev, -+ pipe_handle->bEndpointAddress); -+ else -+ pipe = usb_sndintpipe(udev, -+ pipe_handle->bEndpointAddress); -+ } -+ -+ DUMP_IRP(irp); -+ urb = wrap_alloc_urb(irp, pipe, bulk_int_tx->transfer_buffer, -+ bulk_int_tx->transfer_buffer_length); -+ if (!urb) { -+ ERROR("couldn't allocate urb"); -+ return USBD_STATUS_NO_MEMORY; -+ } -+ if (usb_pipein(pipe) && -+ (!(bulk_int_tx->transfer_flags & USBD_SHORT_TRANSFER_OK))) { -+ USBTRACE("short not ok"); -+ urb->transfer_flags |= URB_SHORT_NOT_OK; -+ } -+ if (usb_pipebulk(pipe)) { -+ usb_fill_bulk_urb(urb, udev, pipe, urb->transfer_buffer, -+ bulk_int_tx->transfer_buffer_length, -+ wrap_urb_complete, urb->context); -+ USBTRACE("submitting bulk urb %p on pipe 0x%x (ep 0x%x)", -+ urb, urb->pipe, pipe_handle->bEndpointAddress); -+ } else { -+ usb_fill_int_urb(urb, udev, pipe, urb->transfer_buffer, -+ bulk_int_tx->transfer_buffer_length, -+ wrap_urb_complete, urb->context, -+ pipe_handle->bInterval); -+ USBTRACE("submitting interrupt urb %p on pipe 0x%x (ep 0x%x), " -+ "intvl: %d", urb, urb->pipe, -+ pipe_handle->bEndpointAddress, pipe_handle->bInterval); -+ } -+ status = wrap_submit_urb(irp); -+ USBTRACE("status: %08X", status); -+ USBEXIT(return status); -+} -+ -+static USBD_STATUS wrap_vendor_or_class_req(struct irp *irp) -+{ -+ u8 req_type; -+ unsigned int pipe; -+ struct usbd_vendor_or_class_request *vc_req; -+ USBD_STATUS status; -+ struct urb *urb; -+ struct usb_ctrlrequest *dr; -+ struct wrap_device *wd = IRP_WRAP_DEVICE(irp); -+ struct usb_device *udev = wd->usb.udev; -+ union nt_urb *nt_urb = IRP_URB(irp); -+ -+ vc_req = &nt_urb->vendor_class_request; -+ USBTRACE("bits: %x, req: %x, val: %08x, index: %08x, flags: %x," -+ "buf: %p, len: %d", vc_req->reserved_bits, vc_req->request, -+ vc_req->value, vc_req->index, vc_req->transfer_flags, -+ vc_req->transfer_buffer, vc_req->transfer_buffer_length); -+ -+ USBTRACE("%x", nt_urb->header.function); -+ switch (nt_urb->header.function) { -+ case URB_FUNCTION_VENDOR_DEVICE: -+ req_type = USB_TYPE_VENDOR | USB_RECIP_DEVICE; -+ break; -+ case URB_FUNCTION_VENDOR_INTERFACE: -+ req_type = USB_TYPE_VENDOR | USB_RECIP_INTERFACE; -+ break; -+ case URB_FUNCTION_VENDOR_ENDPOINT: -+ req_type = USB_TYPE_VENDOR | USB_RECIP_ENDPOINT; -+ break; -+ case URB_FUNCTION_VENDOR_OTHER: -+ req_type = USB_TYPE_VENDOR | USB_RECIP_OTHER; -+ break; -+ case URB_FUNCTION_CLASS_DEVICE: -+ req_type = USB_TYPE_CLASS | USB_RECIP_DEVICE; -+ break; -+ case URB_FUNCTION_CLASS_INTERFACE: -+ req_type = USB_TYPE_CLASS | USB_RECIP_INTERFACE; -+ break; -+ case URB_FUNCTION_CLASS_ENDPOINT: -+ req_type = USB_TYPE_CLASS | USB_RECIP_ENDPOINT; -+ break; -+ case URB_FUNCTION_CLASS_OTHER: -+ req_type = USB_TYPE_CLASS | USB_RECIP_OTHER; -+ break; -+ default: -+ ERROR("unknown request type: %x", nt_urb->header.function); -+ req_type = 0; -+ break; -+ } -+ -+ req_type |= vc_req->reserved_bits; -+ USBTRACE("req type: %08x", req_type); -+ -+ if (vc_req->transfer_flags & USBD_TRANSFER_DIRECTION_IN) { -+ pipe = usb_rcvctrlpipe(udev, 0); -+ req_type |= USB_DIR_IN; -+ USBTRACE("pipe: %x, dir in", pipe); -+ } else { -+ pipe = usb_sndctrlpipe(udev, 0); -+ req_type |= USB_DIR_OUT; -+ USBTRACE("pipe: %x, dir out", pipe); -+ } -+ urb = wrap_alloc_urb(irp, pipe, vc_req->transfer_buffer, -+ vc_req->transfer_buffer_length); -+ if (!urb) { -+ ERROR("couldn't allocate urb"); -+ return USBD_STATUS_NO_MEMORY; -+ } -+ -+ if (usb_pipein(pipe) && -+ (!(vc_req->transfer_flags & USBD_SHORT_TRANSFER_OK))) { -+ USBTRACE("short not ok"); -+ urb->transfer_flags |= URB_SHORT_NOT_OK; -+ } -+ -+ dr = kzalloc(sizeof(*dr), irql_gfp()); -+ if (!dr) { -+ ERROR("couldn't allocate memory"); -+ wrap_free_urb(urb); -+ return USBD_STATUS_NO_MEMORY; -+ } -+ dr->bRequestType = req_type; -+ dr->bRequest = vc_req->request; -+ dr->wValue = cpu_to_le16(vc_req->value); -+ dr->wIndex = cpu_to_le16((u16)vc_req->index); -+ dr->wLength = cpu_to_le16((u16)urb->transfer_buffer_length); -+ -+ usb_fill_control_urb(urb, udev, pipe, (unsigned char *)dr, -+ urb->transfer_buffer, urb->transfer_buffer_length, -+ wrap_urb_complete, urb->context); -+ status = wrap_submit_urb(irp); -+ USBTRACE("status: %08X", status); -+ USBEXIT(return status); -+} -+ -+static USBD_STATUS wrap_reset_pipe(struct usb_device *udev, struct irp *irp) -+{ -+ int ret; -+ union nt_urb *nt_urb; -+ struct usb_endpoint_descriptor *pipe_handle; -+ unsigned int pipe1, pipe2; -+ -+ nt_urb = IRP_URB(irp); -+ pipe_handle = nt_urb->pipe_req.pipe_handle; -+ /* TODO: not clear if both directions should be cleared? */ -+ if (USBD_IS_BULK_PIPE(pipe_handle)) { -+ pipe1 = usb_rcvbulkpipe(udev, pipe_handle->bEndpointAddress); -+ pipe2 = usb_sndbulkpipe(udev, pipe_handle->bEndpointAddress); -+ } else if (USBD_IS_INT_PIPE(pipe_handle)) { -+ pipe1 = usb_rcvintpipe(udev, pipe_handle->bEndpointAddress); -+ pipe2 = pipe1; -+ } else { -+ WARNING("invalid pipe %d", pipe_handle->bEndpointAddress); -+ return USBD_STATUS_INVALID_PIPE_HANDLE; -+ } -+ USBTRACE("ep: %d, pipe: 0x%x", pipe_handle->bEndpointAddress, pipe1); -+ ret = usb_clear_halt(udev, pipe1); -+ if (ret) -+ USBTRACE("resetting pipe %d failed: %d", pipe1, ret); -+ if (pipe2 != pipe1) { -+ ret = usb_clear_halt(udev, pipe2); -+ if (ret) -+ USBTRACE("resetting pipe %d failed: %d", pipe2, ret); -+ } -+// return wrap_urb_status(ret); -+ return USBD_STATUS_SUCCESS; -+} -+ -+static USBD_STATUS wrap_abort_pipe(struct usb_device *udev, struct irp *irp) -+{ -+ union nt_urb *nt_urb; -+ struct usb_endpoint_descriptor *pipe_handle; -+ struct wrap_urb *wrap_urb; -+ struct wrap_device *wd; -+ KIRQL irql; -+ -+ wd = IRP_WRAP_DEVICE(irp); -+ nt_urb = IRP_URB(irp); -+ pipe_handle = nt_urb->pipe_req.pipe_handle; -+ USBENTER("%p, %x", irp, pipe_handle->bEndpointAddress); -+ IoAcquireCancelSpinLock(&irql); -+ nt_list_for_each_entry(wrap_urb, &wd->usb.wrap_urb_list, list) { -+ USBTRACE("%p, %p, %d, %x, %x", wrap_urb, wrap_urb->urb, -+ wrap_urb->state, wrap_urb->urb->pipe, -+ usb_pipeendpoint(wrap_urb->urb->pipe)); -+ /* for WG111T driver, urbs for endpoint 0 should also -+ * be canceled */ -+ if ((usb_pipeendpoint(wrap_urb->urb->pipe) == -+ pipe_handle->bEndpointAddress) || -+ (usb_pipeendpoint(wrap_urb->urb->pipe) == 0)) { -+ if (wrap_cancel_urb(wrap_urb) == 0) -+ USBTRACE("canceled wrap_urb: %p", wrap_urb); -+ } -+ } -+ IoReleaseCancelSpinLock(irql); -+ NT_URB_STATUS(nt_urb) = USBD_STATUS_CANCELED; -+ USBEXIT(return USBD_STATUS_SUCCESS); -+} -+ -+static USBD_STATUS wrap_set_clear_feature(struct usb_device *udev, -+ struct irp *irp) -+{ -+ union nt_urb *nt_urb; -+ struct urb_control_feature_request *feat_req; -+ int ret = 0; -+ __u8 request, type; -+ __u16 feature; -+ -+ nt_urb = IRP_URB(irp); -+ feat_req = &nt_urb->feat_req; -+ feature = feat_req->feature_selector; -+ switch (nt_urb->header.function) { -+ case URB_FUNCTION_SET_FEATURE_TO_DEVICE: -+ request = USB_REQ_SET_FEATURE; -+ type = USB_DT_DEVICE; -+ break; -+ case URB_FUNCTION_SET_FEATURE_TO_INTERFACE: -+ request = USB_REQ_SET_FEATURE; -+ type = USB_DT_INTERFACE; -+ break; -+ case URB_FUNCTION_SET_FEATURE_TO_ENDPOINT: -+ request = USB_REQ_SET_FEATURE; -+ type = USB_DT_ENDPOINT; -+ break; -+ case URB_FUNCTION_CLEAR_FEATURE_TO_DEVICE: -+ request = USB_REQ_CLEAR_FEATURE; -+ type = USB_DT_DEVICE; -+ break; -+ case URB_FUNCTION_CLEAR_FEATURE_TO_INTERFACE: -+ request = USB_REQ_CLEAR_FEATURE; -+ type = USB_DT_INTERFACE; -+ break; -+ case URB_FUNCTION_CLEAR_FEATURE_TO_ENDPOINT: -+ request = USB_REQ_CLEAR_FEATURE; -+ type = USB_DT_ENDPOINT; -+ break; -+ default: -+ WARNING("invalid function: %x", nt_urb->header.function); -+ NT_URB_STATUS(nt_urb) = USBD_STATUS_NOT_SUPPORTED; -+ return NT_URB_STATUS(nt_urb); -+ } -+ ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), request, type, -+ feature, feat_req->index, NULL, 0, 1000); -+ NT_URB_STATUS(nt_urb) = wrap_urb_status(ret); -+ USBEXIT(return NT_URB_STATUS(nt_urb)); -+} -+ -+static USBD_STATUS wrap_get_status_request(struct usb_device *udev, -+ struct irp *irp) -+{ -+ union nt_urb *nt_urb; -+ struct urb_control_get_status_request *status_req; -+ int ret = 0; -+ __u8 type; -+ -+ nt_urb = IRP_URB(irp); -+ status_req = &nt_urb->status_req; -+ switch (nt_urb->header.function) { -+ case URB_FUNCTION_GET_STATUS_FROM_DEVICE: -+ type = USB_RECIP_DEVICE; -+ break; -+ case URB_FUNCTION_GET_STATUS_FROM_INTERFACE: -+ type = USB_RECIP_INTERFACE; -+ break; -+ case URB_FUNCTION_GET_STATUS_FROM_ENDPOINT: -+ type = USB_RECIP_ENDPOINT; -+ break; -+ default: -+ WARNING("invalid function: %x", nt_urb->header.function); -+ NT_URB_STATUS(nt_urb) = USBD_STATUS_NOT_SUPPORTED; -+ return NT_URB_STATUS(nt_urb); -+ } -+ assert(status_req->transfer_buffer_length == sizeof(u16)); -+ ret = usb_get_status(udev, type, status_req->index, -+ status_req->transfer_buffer); -+ if (ret >= 0) { -+ assert(ret <= status_req->transfer_buffer_length); -+ status_req->transfer_buffer_length = ret; -+ NT_URB_STATUS(nt_urb) = USBD_STATUS_SUCCESS; -+ } else -+ NT_URB_STATUS(nt_urb) = wrap_urb_status(ret); -+ USBEXIT(return NT_URB_STATUS(nt_urb)); -+} -+ -+static void set_intf_pipe_info(struct wrap_device *wd, -+ struct usb_interface *usb_intf, -+ struct usbd_interface_information *intf) -+{ -+ int i; -+ struct usb_endpoint_descriptor *ep; -+ struct usbd_pipe_information *pipe; -+ -+ for (i = 0; i < CUR_ALT_SETTING(usb_intf)->desc.bNumEndpoints; i++) { -+ ep = &(CUR_ALT_SETTING(usb_intf)->endpoint[i]).desc; -+ if (i >= intf->bNumEndpoints) { -+ ERROR("intf %p has only %d endpoints, " -+ "ignoring endpoints above %d", -+ intf, intf->bNumEndpoints, i); -+ break; -+ } -+ pipe = &intf->pipes[i]; -+ -+ if (pipe->flags & USBD_PF_CHANGE_MAX_PACKET) -+ USBTRACE("pkt_sz: %d: %d", pipe->wMaxPacketSize, -+ pipe->max_tx_size); -+ USBTRACE("driver wants max_tx_size to %d", -+ pipe->max_tx_size); -+ -+ pipe->wMaxPacketSize = le16_to_cpu(ep->wMaxPacketSize); -+ pipe->bEndpointAddress = ep->bEndpointAddress; -+ pipe->type = ep->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; -+ if (pipe->type == UsbdPipeTypeInterrupt) { -+ /* Windows and Linux differ in how the -+ * bInterval is interpreted */ -+ /* for low speed: -+ interval (Windows) -> frames per ms (Linux) -+ 0 to 15 -> 8 -+ 16 to 35 -> 16 -+ 36 to 255 -> 32 -+ -+ for full speed: interval -> frames per ms -+ 1 -> 1 -+ 2 to 3 -> 2 -+ 4 to 7 -> 4 -+ 8 to 15 -> 8 -+ 16 to 31 -> 16 -+ 32 to 255 -> 32 -+ -+ for high speed: interval -> microframes -+ 1 -> 1 -+ 2 -> 2 -+ 3 -> 4 -+ 4 -> 8 -+ 5 -> 16 -+ 6 -> 32 -+ 7 to 255 -> 32 -+ */ -+ if (wd->usb.udev->speed == USB_SPEED_LOW) -+ pipe->bInterval = ep->bInterval + 5; -+ else if (wd->usb.udev->speed == USB_SPEED_FULL) -+ pipe->bInterval = ep->bInterval; -+ else { -+ int j, k; -+ for (j = k = 1; j < ep->bInterval; k++) -+ j *= 2; -+ pipe->bInterval = k; -+ } -+ } -+ pipe->handle = ep; -+ USBTRACE("%d: ep 0x%x, type %d, pkt_sz %d, intv %d (%d)," -+ "type: %d, handle %p", i, ep->bEndpointAddress, -+ ep->bmAttributes, pipe->wMaxPacketSize, ep->bInterval, -+ pipe->bInterval, pipe->type, pipe->handle); -+ } -+} -+ -+static USBD_STATUS wrap_select_configuration(struct wrap_device *wd, -+ union nt_urb *nt_urb, -+ struct irp *irp) -+{ -+ int i, ret; -+ struct usbd_select_configuration *sel_conf; -+ struct usb_device *udev; -+ struct usbd_interface_information *intf; -+ struct usb_config_descriptor *config; -+ struct usb_interface *usb_intf; -+ -+ udev = wd->usb.udev; -+ sel_conf = &nt_urb->select_conf; -+ config = sel_conf->config; -+ USBTRACE("%p", config); -+ if (config == NULL) { -+ kill_all_urbs(wd, 1); -+ ret = usb_reset_configuration(udev); -+ return wrap_urb_status(ret); -+ } -+ -+ USBTRACE("conf: %d, type: %d, length: %d, numif: %d, attr: %08x", -+ config->bConfigurationValue, config->bDescriptorType, -+ config->wTotalLength, config->bNumInterfaces, -+ config->bmAttributes); -+ ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), -+ USB_REQ_SET_CONFIGURATION, 0, -+ config->bConfigurationValue, 0, -+ NULL, 0, USB_CTRL_SET_TIMEOUT); -+ if (ret < 0) { -+ ERROR("ret: %d", ret); -+ return wrap_urb_status(ret); -+ } -+ sel_conf->handle = udev->actconfig; -+ intf = &sel_conf->intf; -+ for (i = 0; i < config->bNumInterfaces && intf->bLength > 0; -+ i++, intf = (((void *)intf) + intf->bLength)) { -+ -+ USBTRACE("intf: %d, alt setting: %d", -+ intf->bInterfaceNumber, intf->bAlternateSetting); -+ ret = usb_set_interface(udev, intf->bInterfaceNumber, -+ intf->bAlternateSetting); -+ if (ret < 0) { -+ ERROR("failed with %d", ret); -+ return wrap_urb_status(ret); -+ } -+ usb_intf = usb_ifnum_to_if(udev, intf->bInterfaceNumber); -+ if (!usb_intf) { -+ ERROR("couldn't obtain ifnum"); -+ return USBD_STATUS_REQUEST_FAILED; -+ } -+ USBTRACE("intf: %p, num ep: %d", intf, intf->bNumEndpoints); -+ set_intf_pipe_info(wd, usb_intf, intf); -+ } -+ return USBD_STATUS_SUCCESS; -+} -+ -+static USBD_STATUS wrap_select_interface(struct wrap_device *wd, -+ union nt_urb *nt_urb, -+ struct irp *irp) -+{ -+ int ret; -+ struct usbd_select_interface *sel_intf; -+ struct usb_device *udev; -+ struct usbd_interface_information *intf; -+ struct usb_interface *usb_intf; -+ -+ udev = wd->usb.udev; -+ sel_intf = &nt_urb->select_intf; -+ intf = &sel_intf->intf; -+ -+ ret = usb_set_interface(udev, intf->bInterfaceNumber, -+ intf->bAlternateSetting); -+ if (ret < 0) { -+ ERROR("failed with %d", ret); -+ return wrap_urb_status(ret); -+ } -+ usb_intf = usb_ifnum_to_if(udev, intf->bInterfaceNumber); -+ if (!usb_intf) { -+ ERROR("couldn't get interface information"); -+ return USBD_STATUS_REQUEST_FAILED; -+ } -+ USBTRACE("intf: %p, num ep: %d", usb_intf, intf->bNumEndpoints); -+ set_intf_pipe_info(wd, usb_intf, intf); -+ return USBD_STATUS_SUCCESS; -+} -+ -+static int wrap_usb_get_string(struct usb_device *udev, unsigned short langid, -+ unsigned char index, void *buf, int size) -+{ -+ int i, ret; -+ /* if langid is 0, return array of languages supported in -+ * buf */ -+ for (i = 0; i < 3; i++) { -+ ret = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), -+ USB_REQ_GET_DESCRIPTOR, USB_DIR_IN, -+ (USB_DT_STRING << 8) + index, langid, -+ buf, size, USB_CTRL_GET_TIMEOUT); -+ if (ret > 0 || ret == -EPIPE) -+ break; -+ } -+ return ret; -+} -+ -+static USBD_STATUS wrap_get_descriptor(struct wrap_device *wd, -+ union nt_urb *nt_urb, struct irp *irp) -+{ -+ struct usbd_control_descriptor_request *control_desc; -+ int ret = 0; -+ struct usb_device *udev; -+ -+ udev = wd->usb.udev; -+ control_desc = &nt_urb->control_desc; -+ USBTRACE("desctype = %d, descindex = %d, transfer_buffer = %p," -+ "transfer_buffer_length = %d", control_desc->desc_type, -+ control_desc->index, control_desc->transfer_buffer, -+ control_desc->transfer_buffer_length); -+ -+ if (control_desc->desc_type == USB_DT_STRING) { -+ USBTRACE("langid: %x", control_desc->language_id); -+ ret = wrap_usb_get_string(udev, control_desc->language_id, -+ control_desc->index, -+ control_desc->transfer_buffer, -+ control_desc->transfer_buffer_length); -+ } else { -+ ret = usb_get_descriptor(udev, control_desc->desc_type, -+ control_desc->index, -+ control_desc->transfer_buffer, -+ control_desc->transfer_buffer_length); -+ } -+ if (ret < 0) { -+ USBTRACE("request %d failed: %d", control_desc->desc_type, ret); -+ control_desc->transfer_buffer_length = 0; -+ return wrap_urb_status(ret); -+ } else { -+ USBTRACE("ret: %08x", ret); -+ control_desc->transfer_buffer_length = ret; -+ irp->io_status.info = ret; -+ return USBD_STATUS_SUCCESS; -+ } -+} -+ -+static USBD_STATUS wrap_process_nt_urb(struct irp *irp) -+{ -+ USBD_STATUS status; -+ struct wrap_device *wd = IRP_WRAP_DEVICE(irp); -+ struct usb_device *udev = wd->usb.udev; -+ union nt_urb *nt_urb = IRP_URB(irp); -+ -+ USBENTER("nt_urb = %p, irp = %p, length = %d, function = %x", -+ nt_urb, irp, nt_urb->header.length, nt_urb->header.function); -+ -+ if (test_bit(HW_DISABLED, &wd->hw_status)) { -+ status = USBD_STATUS_DEVICE_GONE; -+ NT_URB_STATUS(nt_urb) = status; -+ return status; -+ } -+ -+ DUMP_IRP(irp); -+ switch (nt_urb->header.function) { -+ /* bulk/int and vendor/class urbs are submitted to -+ * Linux USB core; if the call is successful, urb's -+ * completion worker will return IRP later */ -+ case URB_FUNCTION_BULK_OR_INTERRUPT_TRANSFER: -+ USBTRACE("submitting bulk/int irp: %p", irp); -+ status = wrap_bulk_or_intr_trans(irp); -+ break; -+ -+ case URB_FUNCTION_VENDOR_DEVICE: -+ case URB_FUNCTION_VENDOR_INTERFACE: -+ case URB_FUNCTION_VENDOR_ENDPOINT: -+ case URB_FUNCTION_VENDOR_OTHER: -+ case URB_FUNCTION_CLASS_DEVICE: -+ case URB_FUNCTION_CLASS_INTERFACE: -+ case URB_FUNCTION_CLASS_ENDPOINT: -+ case URB_FUNCTION_CLASS_OTHER: -+ USBTRACE("submitting vendor/class irp: %p", irp); -+ status = wrap_vendor_or_class_req(irp); -+ break; -+ -+ /* rest are synchronous */ -+ case URB_FUNCTION_SELECT_CONFIGURATION: -+ status = wrap_select_configuration(wd, nt_urb, irp); -+ NT_URB_STATUS(nt_urb) = status; -+ break; -+ -+ case URB_FUNCTION_SELECT_INTERFACE: -+ status = wrap_select_interface(wd, nt_urb, irp); -+ NT_URB_STATUS(nt_urb) = status; -+ break; -+ -+ case URB_FUNCTION_GET_DESCRIPTOR_FROM_DEVICE: -+ status = wrap_get_descriptor(wd, nt_urb, irp); -+ NT_URB_STATUS(nt_urb) = status; -+ break; -+ -+ case URB_FUNCTION_SYNC_RESET_PIPE_AND_CLEAR_STALL: -+ status = wrap_reset_pipe(udev, irp); -+ NT_URB_STATUS(nt_urb) = status; -+ break; -+ -+ case URB_FUNCTION_ABORT_PIPE: -+ status = wrap_abort_pipe(udev, irp); -+ break; -+ -+ case URB_FUNCTION_SET_FEATURE_TO_DEVICE: -+ case URB_FUNCTION_SET_FEATURE_TO_INTERFACE: -+ case URB_FUNCTION_SET_FEATURE_TO_ENDPOINT: -+ case URB_FUNCTION_CLEAR_FEATURE_TO_DEVICE: -+ case URB_FUNCTION_CLEAR_FEATURE_TO_INTERFACE: -+ case URB_FUNCTION_CLEAR_FEATURE_TO_ENDPOINT: -+ status = wrap_set_clear_feature(udev, irp); -+ break; -+ -+ case URB_FUNCTION_GET_STATUS_FROM_DEVICE: -+ case URB_FUNCTION_GET_STATUS_FROM_INTERFACE: -+ case URB_FUNCTION_GET_STATUS_FROM_ENDPOINT: -+ status = wrap_get_status_request(udev, irp); -+ break; -+ -+ default: -+ ERROR("function %x not implemented", nt_urb->header.function); -+ status = NT_URB_STATUS(nt_urb) = USBD_STATUS_NOT_SUPPORTED; -+ break; -+ } -+ USBTRACE("status: %08X", status); -+ return status; -+} -+ -+static USBD_STATUS wrap_reset_port(struct irp *irp) -+{ -+ int ret, lock = 0; -+ struct wrap_device *wd; -+ -+ wd = IRP_WRAP_DEVICE(irp); -+ USBENTER("%p, %p", wd, wd->usb.udev); -+ lock = usb_lock_device_for_reset(wd->usb.udev, wd->usb.intf); -+ if (lock < 0) { -+ WARNING("locking failed: %d", lock); -+// return wrap_urb_status(lock); -+ return USBD_STATUS_SUCCESS; -+ } -+ ret = usb_reset_device(wd->usb.udev); -+ if (ret < 0) -+ USBTRACE("reset failed: %d", ret); -+ /* TODO: should reconfigure? */ -+ if (lock) -+ usb_unlock_device(wd->usb.udev); -+// return wrap_urb_status(ret); -+ return USBD_STATUS_SUCCESS; -+} -+ -+static USBD_STATUS wrap_get_port_status(struct irp *irp) -+{ -+ struct wrap_device *wd; -+ ULONG *status; -+ enum usb_device_state state; -+ -+ wd = IRP_WRAP_DEVICE(irp); -+ USBENTER("%p, %p", wd, wd->usb.udev); -+ status = IoGetCurrentIrpStackLocation(irp)->params.others.arg1; -+ state = wd->usb.udev->state; -+ if (state != USB_STATE_NOTATTACHED && -+ state != USB_STATE_SUSPENDED) { -+ *status |= USBD_PORT_CONNECTED; -+ if (state == USB_STATE_CONFIGURED) -+ *status |= USBD_PORT_ENABLED; -+ } -+ USBTRACE("state: %d, *status: %08X", state, *status); -+ return USBD_STATUS_SUCCESS; -+} -+ -+NTSTATUS wrap_submit_irp(struct device_object *pdo, struct irp *irp) -+{ -+ struct io_stack_location *irp_sl; -+ struct wrap_device *wd; -+ USBD_STATUS status; -+ struct usbd_idle_callback *idle_callback; -+ -+ USBENTER("%p, %p", pdo, irp); -+ wd = pdo->reserved; -+ if (wd->usb.intf == NULL) { -+ USBTRACE("%p", irp); -+ irp->io_status.status = STATUS_DEVICE_REMOVED; -+ irp->io_status.info = 0; -+ USBEXIT(return STATUS_DEVICE_REMOVED); -+ } -+ IRP_WRAP_DEVICE(irp) = wd; -+ irp_sl = IoGetCurrentIrpStackLocation(irp); -+ switch (irp_sl->params.dev_ioctl.code) { -+ case IOCTL_INTERNAL_USB_SUBMIT_URB: -+ status = wrap_process_nt_urb(irp); -+ break; -+ case IOCTL_INTERNAL_USB_RESET_PORT: -+ status = wrap_reset_port(irp); -+ break; -+ case IOCTL_INTERNAL_USB_GET_PORT_STATUS: -+ status = wrap_get_port_status(irp); -+ break; -+ case IOCTL_INTERNAL_USB_SUBMIT_IDLE_NOTIFICATION: -+ idle_callback = irp_sl->params.dev_ioctl.type3_input_buf; -+ (void)idle_callback; -+ USBTRACE("suspend function: %p", idle_callback->callback); -+ status = USBD_STATUS_NOT_SUPPORTED; -+ break; -+ default: -+ ERROR("ioctl %08X NOT IMPLEMENTED", -+ irp_sl->params.dev_ioctl.code); -+ status = USBD_STATUS_NOT_SUPPORTED; -+ break; -+ } -+ -+ USBTRACE("status: %08X", status); -+ if (status == USBD_STATUS_PENDING) { -+ /* don't touch this IRP - it may have been already -+ * completed/returned */ -+ return STATUS_PENDING; -+ } else { -+ irp->io_status.status = nt_urb_irp_status(status); -+ if (status != USBD_STATUS_SUCCESS) -+ irp->io_status.info = 0; -+ USBEXIT(return irp->io_status.status); -+ } -+} -+ -+/* TODO: The example on msdn in reference section suggests that second -+ * argument should be an array of usbd_interface_information, but -+ * description and examples elsewhere suggest that it should be -+ * usbd_interface_list_entry structre. Which is correct? */ -+ -+wstdcall union nt_urb *WIN_FUNC(USBD_CreateConfigurationRequestEx,2) -+ (struct usb_config_descriptor *config, -+ struct usbd_interface_list_entry *intf_list) -+{ -+ int size, i, n; -+ struct usbd_interface_information *intf; -+ struct usbd_pipe_information *pipe; -+ struct usb_interface_descriptor *intf_desc; -+ struct usbd_select_configuration *select_conf; -+ -+ USBENTER("config = %p, intf_list = %p", config, intf_list); -+ -+ /* calculate size required; select_conf already has space for -+ * one intf structure */ -+ size = sizeof(*select_conf) - sizeof(*intf); -+ for (n = 0; n < config->bNumInterfaces; n++) { -+ i = intf_list[n].intf_desc->bNumEndpoints; -+ /* intf already has space for one pipe */ -+ size += sizeof(*intf) + (i - 1) * sizeof(*pipe); -+ } -+ /* don't use kmalloc - driver frees it with ExFreePool */ -+ select_conf = ExAllocatePoolWithTag(NonPagedPool, size, -+ POOL_TAG('L', 'U', 'S', 'B')); -+ if (!select_conf) { -+ WARNING("couldn't allocate memory"); -+ return NULL; -+ } -+ memset(select_conf, 0, size); -+ intf = &select_conf->intf; -+ select_conf->handle = config; -+ for (n = 0; n < config->bNumInterfaces && intf_list[n].intf_desc; n++) { -+ /* initialize 'intf' fields in intf_list so they point -+ * to appropriate entry; these may be read/written by -+ * driver after this function returns */ -+ intf_list[n].intf = intf; -+ intf_desc = intf_list[n].intf_desc; -+ -+ i = intf_desc->bNumEndpoints; -+ intf->bLength = sizeof(*intf) + (i - 1) * sizeof(*pipe); -+ -+ intf->bInterfaceNumber = intf_desc->bInterfaceNumber; -+ intf->bAlternateSetting = intf_desc->bAlternateSetting; -+ intf->bInterfaceClass = intf_desc->bInterfaceClass; -+ intf->bInterfaceSubClass = intf_desc->bInterfaceSubClass; -+ intf->bInterfaceProtocol = intf_desc->bInterfaceProtocol; -+ intf->bNumEndpoints = intf_desc->bNumEndpoints; -+ -+ pipe = &intf->pipes[0]; -+ for (i = 0; i < intf->bNumEndpoints; i++) { -+ memset(&pipe[i], 0, sizeof(*pipe)); -+ pipe[i].max_tx_size = -+ USBD_DEFAULT_MAXIMUM_TRANSFER_SIZE; -+ } -+ intf->handle = intf_desc; -+ intf = (((void *)intf) + intf->bLength); -+ } -+ select_conf->header.function = URB_FUNCTION_SELECT_CONFIGURATION; -+ select_conf->header.length = size; -+ select_conf->config = config; -+ USBEXIT(return (union nt_urb *)select_conf); -+} -+ -+WIN_SYMBOL_MAP("_USBD_CreateConfigurationRequestEx@8", USBD_CreateConfigurationRequestEx) -+ -+wstdcall struct usb_interface_descriptor * -+WIN_FUNC(USBD_ParseConfigurationDescriptorEx,7) -+ (struct usb_config_descriptor *config, void *start, -+ LONG bInterfaceNumber, LONG bAlternateSetting, LONG bInterfaceClass, -+ LONG bInterfaceSubClass, LONG bInterfaceProtocol) -+{ -+ void *pos; -+ struct usb_interface_descriptor *intf; -+ -+ USBENTER("config = %p, start = %p, ifnum = %d, alt_setting = %d," -+ " class = %d, subclass = %d, proto = %d", config, start, -+ bInterfaceNumber, bAlternateSetting, bInterfaceClass, -+ bInterfaceSubClass, bInterfaceProtocol); -+ -+ for (pos = start; -+ pos < ((void *)config + le16_to_cpu(config->wTotalLength)); -+ pos += intf->bLength) { -+ -+ intf = pos; -+ -+ if ((intf->bDescriptorType == USB_DT_INTERFACE) && -+ ((bInterfaceNumber == -1) || -+ (intf->bInterfaceNumber == bInterfaceNumber)) && -+ ((bAlternateSetting == -1) || -+ (intf->bAlternateSetting == bAlternateSetting)) && -+ ((bInterfaceClass == -1) || -+ (intf->bInterfaceClass == bInterfaceClass)) && -+ ((bInterfaceSubClass == -1) || -+ (intf->bInterfaceSubClass == bInterfaceSubClass)) && -+ ((bInterfaceProtocol == -1) || -+ (intf->bInterfaceProtocol == bInterfaceProtocol))) { -+ USBTRACE("selected interface = %p", intf); -+ USBEXIT(return intf); -+ } -+ } -+ USBEXIT(return NULL); -+} -+ -+WIN_SYMBOL_MAP("_USBD_ParseConfigurationDescriptorEx@28", USBD_ParseConfigurationDescriptorEx) -+ -+wstdcall union nt_urb *WIN_FUNC(USBD_CreateConfigurationRequest,2) -+ (struct usb_config_descriptor *config, USHORT *size) -+{ -+ union nt_urb *nt_urb; -+ struct usbd_interface_list_entry intf_list[2]; -+ struct usb_interface_descriptor *intf_desc; -+ -+ USBENTER("config = %p, urb_size = %p", config, size); -+ -+ intf_desc = USBD_ParseConfigurationDescriptorEx(config, config, -1, -1, -+ -1, -1, -1); -+ intf_list[0].intf_desc = intf_desc; -+ intf_list[0].intf = NULL; -+ intf_list[1].intf_desc = NULL; -+ intf_list[1].intf = NULL; -+ nt_urb = USBD_CreateConfigurationRequestEx(config, intf_list); -+ if (!nt_urb) -+ return NULL; -+ -+ *size = nt_urb->select_conf.header.length; -+ USBEXIT(return nt_urb); -+} -+ -+wstdcall struct usb_interface_descriptor * -+WIN_FUNC(USBD_ParseConfigurationDescriptor,3) -+ (struct usb_config_descriptor *config, UCHAR bInterfaceNumber, -+ UCHAR bAlternateSetting) -+{ -+ return USBD_ParseConfigurationDescriptorEx(config, config, -+ bInterfaceNumber, -+ bAlternateSetting, -+ -1, -1, -1); -+} -+ -+wstdcall struct usb_descriptor_header *WIN_FUNC(USBD_ParseDescriptors,4) -+ (void *buf, ULONG length, struct usb_descriptor_header *descr, -+ LONG type) -+{ -+ while ((void *)descr < buf + length) { -+ if (descr->bDescriptorType == type) -+ return descr; -+ if (descr->bLength == 0) -+ break; -+ descr = (void *)descr + descr->bLength; -+ } -+ USBEXIT(return NULL); -+} -+ -+WIN_SYMBOL_MAP("_USBD_ParseDescriptors@16", USBD_ParseDescriptors) -+ -+wstdcall void WIN_FUNC(USBD_GetUSBDIVersion,1) -+ (struct usbd_version_info *version_info) -+{ -+ /* this function is obsolete in Windows XP */ -+ if (version_info) { -+ version_info->usbdi_version = USBDI_VERSION_XP; -+ /* TODO: how do we get this correctly? */ -+ version_info->supported_usb_version = 0x110; -+ } -+ USBEXIT(return); -+} -+ -+wstdcall void -+USBD_InterfaceGetUSBDIVersion(void *context, -+ struct usbd_version_info *version_info, -+ ULONG *hcd_capa) -+{ -+ struct wrap_device *wd = context; -+ -+ if (version_info) { -+ version_info->usbdi_version = USBDI_VERSION_XP; -+ if (wd->usb.udev->speed == USB_SPEED_HIGH) -+ version_info->supported_usb_version = 0x200; -+ else -+ version_info->supported_usb_version = 0x110; -+ } -+ *hcd_capa = USB_HCD_CAPS_SUPPORTS_RT_THREADS; -+ USBEXIT(return); -+} -+ -+wstdcall BOOLEAN USBD_InterfaceIsDeviceHighSpeed(void *context) -+{ -+ struct wrap_device *wd = context; -+ -+ USBTRACE("wd: %p", wd); -+ if (wd->usb.udev->speed == USB_SPEED_HIGH) -+ USBEXIT(return TRUE); -+ else -+ USBEXIT(return FALSE); -+} -+ -+wstdcall void USBD_InterfaceReference(void *context) -+{ -+ USBTRACE("%p", context); -+ TODO(); -+} -+ -+wstdcall void USBD_InterfaceDereference(void *context) -+{ -+ USBTRACE("%p", context); -+ TODO(); -+} -+ -+wstdcall NTSTATUS USBD_InterfaceQueryBusTime(void *context, ULONG *frame) -+{ -+ struct wrap_device *wd = context; -+ -+ *frame = usb_get_current_frame_number(wd->usb.udev); -+ USBEXIT(return STATUS_SUCCESS); -+} -+ -+wstdcall NTSTATUS USBD_InterfaceSubmitIsoOutUrb(void *context, -+ union nt_urb *nt_urb) -+{ -+ /* TODO: implement this */ -+ TODO(); -+ USBEXIT(return STATUS_NOT_IMPLEMENTED); -+} -+ -+wstdcall NTSTATUS -+USBD_InterfaceQueryBusInformation(void *context, ULONG level, void *buf, -+ ULONG *buf_length, ULONG *buf_actual_length) -+{ -+#if 0 -+ struct wrap_device *wd = context; -+ struct usb_bus *bus = wd->usb.udev->bus; -+ struct usb_bus_information_level *bus_info = buf; -+#endif -+ -+ TODO(); -+ USBEXIT(return STATUS_NOT_IMPLEMENTED); -+} -+ -+wstdcall NTSTATUS -+USBD_InterfaceLogEntry(void *context, ULONG driver_tag, ULONG enum_tag, -+ ULONG p1, ULONG p2) -+{ -+ ERROR("%p, %x, %x, %x, %x", context, driver_tag, enum_tag, p1, p2); -+ USBEXIT(return STATUS_SUCCESS); -+} -+ -+NTSTATUS -+usb_query_interface(struct wrap_device *wd, struct io_stack_location *irp_sl) -+{ -+ struct usbd_bus_interface_usbdi *intf = -+ (struct usbd_bus_interface_usbdi *) -+ irp_sl->params.query_intf.intf; -+ -+ TRACE2("type: %x, size: %d, version: %d", -+ irp_sl->params.query_intf.type->data1, -+ irp_sl->params.query_intf.size, -+ irp_sl->params.query_intf.version); -+ intf->Context = wd; -+ intf->InterfaceReference = -+ WIN_FUNC_PTR(USBD_InterfaceReference, 1); -+ intf->InterfaceDereference = -+ WIN_FUNC_PTR(USBD_InterfaceDereference, 1); -+ intf->GetUSBDIVersion = -+ WIN_FUNC_PTR(USBD_InterfaceGetUSBDIVersion, 3); -+ intf->QueryBusTime = -+ WIN_FUNC_PTR(USBD_InterfaceQueryBusTime, 2); -+ intf->SubmitIsoOutUrb = -+ WIN_FUNC_PTR(USBD_InterfaceSubmitIsoOutUrb, 2); -+ intf->QueryBusInformation = -+ WIN_FUNC_PTR(USBD_InterfaceQueryBusInformation, 5); -+ if (irp_sl->params.query_intf.version >= USB_BUSIF_USBDI_VERSION_1) -+ intf->IsDeviceHighSpeed = -+ WIN_FUNC_PTR(USBD_InterfaceIsDeviceHighSpeed, 1); -+ if (irp_sl->params.query_intf.version >= USB_BUSIF_USBDI_VERSION_2) -+ intf->LogEntry = WIN_FUNC_PTR(USBD_InterfaceLogEntry, 5); -+ return STATUS_SUCCESS; -+} -+ -+int usb_init(void) -+{ -+ InitializeListHead(&wrap_urb_complete_list); -+ spin_lock_init(&wrap_urb_complete_list_lock); -+ INIT_WORK(&wrap_urb_complete_work, wrap_urb_complete_worker); -+#ifdef USB_DEBUG -+ urb_id = 0; -+#endif -+ return 0; -+} -+ -+void usb_exit(void) -+{ -+ USBEXIT(return); -+} -+ -+int usb_init_device(struct wrap_device *wd) -+{ -+ InitializeListHead(&wd->usb.wrap_urb_list); -+ wd->usb.num_alloc_urbs = 0; -+ USBEXIT(return 0); -+} -+ -+void usb_exit_device(struct wrap_device *wd) -+{ -+ kill_all_urbs(wd, 0); -+ USBEXIT(return); -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/usb.h linux-4.12.4-3rd/3rdparty/ndiswrapper/usb.h ---- linux-4.12.4/3rdparty/ndiswrapper/usb.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/usb.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,360 @@ -+/* -+ * Copyright (C) 2004 Jan Kiszka -+ * Copyright (C) 2005 Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifndef _USB_H_ -+#define _USB_H_ -+ -+#include "ntoskernel.h" -+ -+#define IOCTL_INTERNAL_USB_SUBMIT_URB 0x00220003 -+#define IOCTL_INTERNAL_USB_RESET_PORT 0x00220007 -+#define IOCTL_INTERNAL_USB_GET_PORT_STATUS 0x00220013 -+#define IOCTL_INTERNAL_USB_CYCLE_PORT 0x0022001F -+#define IOCTL_INTERNAL_USB_SUBMIT_IDLE_NOTIFICATION 0x00220027 -+ -+#define URB_FUNCTION_SELECT_CONFIGURATION 0x0000 -+#define URB_FUNCTION_SELECT_INTERFACE 0x0001 -+#define URB_FUNCTION_ABORT_PIPE 0x0002 -+#define URB_FUNCTION_TAKE_FRAME_LENGTH_CONTROL 0x0003 -+#define URB_FUNCTION_RELEASE_FRAME_LENGTH_CONTROL 0x0004 -+#define URB_FUNCTION_GET_FRAME_LENGTH 0x0005 -+#define URB_FUNCTION_SET_FRAME_LENGTH 0x0006 -+#define URB_FUNCTION_GET_CURRENT_FRAME_NUMBER 0x0007 -+#define URB_FUNCTION_CONTROL_TRANSFER 0x0008 -+#define URB_FUNCTION_BULK_OR_INTERRUPT_TRANSFER 0x0009 -+#define URB_FUNCTION_ISOCH_TRANSFER 0x000A -+#define URB_FUNCTION_GET_DESCRIPTOR_FROM_DEVICE 0x000B -+#define URB_FUNCTION_SET_DESCRIPTOR_TO_DEVICE 0x000C -+#define URB_FUNCTION_SET_FEATURE_TO_DEVICE 0x000D -+#define URB_FUNCTION_SET_FEATURE_TO_INTERFACE 0x000E -+#define URB_FUNCTION_SET_FEATURE_TO_ENDPOINT 0x000F -+#define URB_FUNCTION_CLEAR_FEATURE_TO_DEVICE 0x0010 -+#define URB_FUNCTION_CLEAR_FEATURE_TO_INTERFACE 0x0011 -+#define URB_FUNCTION_CLEAR_FEATURE_TO_ENDPOINT 0x0012 -+#define URB_FUNCTION_GET_STATUS_FROM_DEVICE 0x0013 -+#define URB_FUNCTION_GET_STATUS_FROM_INTERFACE 0x0014 -+#define URB_FUNCTION_GET_STATUS_FROM_ENDPOINT 0x0015 -+#define URB_FUNCTION_RESERVED_0X0016 0x0016 -+#define URB_FUNCTION_VENDOR_DEVICE 0x0017 -+#define URB_FUNCTION_VENDOR_INTERFACE 0x0018 -+#define URB_FUNCTION_VENDOR_ENDPOINT 0x0019 -+#define URB_FUNCTION_CLASS_DEVICE 0x001A -+#define URB_FUNCTION_CLASS_INTERFACE 0x001B -+#define URB_FUNCTION_CLASS_ENDPOINT 0x001C -+#define URB_FUNCTION_RESERVE_0X001D 0x001D -+#define URB_FUNCTION_SYNC_RESET_PIPE_AND_CLEAR_STALL 0x001E -+#define URB_FUNCTION_CLASS_OTHER 0x001F -+#define URB_FUNCTION_VENDOR_OTHER 0x0020 -+#define URB_FUNCTION_GET_STATUS_FROM_OTHER 0x0021 -+#define URB_FUNCTION_CLEAR_FEATURE_TO_OTHER 0x0022 -+#define URB_FUNCTION_SET_FEATURE_TO_OTHER 0x0023 -+#define URB_FUNCTION_GET_DESCRIPTOR_FROM_ENDPOINT 0x0024 -+#define URB_FUNCTION_SET_DESCRIPTOR_TO_ENDPOINT 0x0025 -+#define URB_FUNCTION_GET_CONFIGURATION 0x0026 -+#define URB_FUNCTION_GET_INTERFACE 0x0027 -+#define URB_FUNCTION_GET_DESCRIPTOR_FROM_INTERFACE 0x0028 -+#define URB_FUNCTION_SET_DESCRIPTOR_TO_INTERFACE 0x0029 -+#define URB_FUNCTION_GET_MS_FEATURE_DESCRIPTOR 0x002A -+#define URB_FUNCTION_RESERVE_0X002B 0x002B -+#define URB_FUNCTION_RESERVE_0X002C 0x002C -+#define URB_FUNCTION_RESERVE_0X002D 0x002D -+#define URB_FUNCTION_RESERVE_0X002E 0x002E -+#define URB_FUNCTION_RESERVE_0X002F 0x002F -+// USB 2.0 calls start at 0x0030 -+#define URB_FUNCTION_SYNC_RESET_PIPE 0x0030 -+#define URB_FUNCTION_SYNC_CLEAR_STALL 0x0031 -+#define URB_FUNCTION_CONTROL_TRANSFER_EX 0x0032 -+ -+#define USBD_PF_CHANGE_MAX_PACKET 0x00000001 -+ -+#define USBD_TRANSFER_DIRECTION_OUT 0 -+#define USBD_TRANSFER_DIRECTION_IN 1 -+ -+#define USBD_SHORT_TRANSFER_OK 0x00000002 -+#define USBD_START_ISO_TRANSFER_ASAP 0x00000004 -+#define USBD_DEFAULT_PIPE_TRANSFER 0x00000008 -+ -+#define USBD_TRANSFER_DIRECTION(flags) \ -+ ((flags) & USBD_TRANSFER_DIRECTION_IN) -+ -+enum pipe_type {UsbdPipeTypeControl = USB_ENDPOINT_XFER_CONTROL, -+ UsbdPipeTypeIsochronous = USB_ENDPOINT_XFER_ISOC, -+ UsbdPipeTypeBulk = USB_ENDPOINT_XFER_BULK, -+ UsbdPipeTypeInterrupt = USB_ENDPOINT_XFER_INT}; -+ -+#define USBD_IS_BULK_PIPE(pipe_handle) \ -+ (((pipe_handle)->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) \ -+ == USB_ENDPOINT_XFER_BULK) -+ -+#define USBD_IS_INT_PIPE(pipe_handle) \ -+ (((pipe_handle)->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) \ -+ == USB_ENDPOINT_XFER_INT) -+ -+#define USBD_PORT_ENABLED 0x00000001 -+#define USBD_PORT_CONNECTED 0x00000002 -+ -+typedef LONG USBD_STATUS; -+ -+#define USBD_STATUS_SUCCESS 0x0 -+#define USBD_STATUS_PENDING 0x40000000 -+#define USBD_STATUS_CANCELED 0x00010000 -+ -+#define USBD_STATUS_CRC 0xC0000001 -+#define USBD_STATUS_BTSTUFF 0xC0000002 -+#define USBD_STATUS_DATA_TOGGLE_MISMATCH 0xC0000003 -+#define USBD_STATUS_STALL_PID 0xC0000004 -+#define USBD_STATUS_DEV_NOT_RESPONDING 0xC0000005 -+#define USBD_STATUS_PID_CHECK_FAILURE 0xC0000006 -+#define USBD_STATUS_UNEXPECTED_PID 0xC0000007 -+#define USBD_STATUS_DATA_OVERRUN 0xC0000008 -+#define USBD_STATUS_DATA_UNDERRUN 0xC0000009 -+#define USBD_STATUS_RESERVED1 0xC000000A -+#define USBD_STATUS_RESERVED2 0xC000000B -+#define USBD_STATUS_BUFFER_OVERRUN 0xC000000C -+#define USBD_STATUS_BUFFER_UNDERRUN 0xC000000D -+#define USBD_STATUS_NOT_ACCESSED 0xC000000F -+#define USBD_STATUS_FIFO 0xC0000010 -+#define USBD_STATUS_XACT_ERROR 0xC0000011 -+#define USBD_STATUS_BABBLE_DETECTED 0xC0000012 -+#define USBD_STATUS_DATA_BUFFER_ERROR 0xC0000013 -+ -+#define USBD_STATUS_NOT_SUPPORTED 0xC0000E00 -+#define USBD_STATUS_BUFFER_TOO_SMALL 0xC0003000 -+#define USBD_STATUS_TIMEOUT 0xC0006000 -+#define USBD_STATUS_DEVICE_GONE 0xC0007000 -+ -+#define USBD_STATUS_NO_MEMORY 0x80000100 -+#define USBD_STATUS_INVALID_URB_FUNCTION 0x80000200 -+#define USBD_STATUS_INVALID_PARAMETER 0x80000300 -+#define USBD_STATUS_REQUEST_FAILED 0x80000500 -+#define USBD_STATUS_INVALID_PIPE_HANDLE 0x80000600 -+#define USBD_STATUS_ERROR_SHORT_TRANSFER 0x80000900 -+ -+#define USBD_DEFAULT_MAXIMUM_TRANSFER_SIZE PAGE_SIZE -+ -+struct urb_hcd_area { -+ void *reserved8[8]; -+}; -+ -+struct usbd_pipe_information { -+ USHORT wMaxPacketSize; -+ UCHAR bEndpointAddress; -+ UCHAR bInterval; -+ enum pipe_type type; -+ struct usb_endpoint_descriptor *handle; -+ ULONG max_tx_size; -+ ULONG flags; -+}; -+ -+struct usbd_interface_information { -+ USHORT bLength; -+ UCHAR bInterfaceNumber; -+ UCHAR bAlternateSetting; -+ UCHAR bInterfaceClass; -+ UCHAR bInterfaceSubClass; -+ UCHAR bInterfaceProtocol; -+ UCHAR reserved; -+ void *handle; -+ ULONG bNumEndpoints; -+ struct usbd_pipe_information pipes[1]; -+}; -+ -+struct usbd_interface_list_entry { -+ struct usb_interface_descriptor *intf_desc; -+ struct usbd_interface_information *intf; -+}; -+ -+struct nt_urb_header { -+ USHORT length; -+ USHORT function; -+ USBD_STATUS status; -+ void *usbd_dev_handle; -+ ULONG usbd_flags; -+}; -+ -+struct usbd_select_interface { -+ struct nt_urb_header header; -+ void *handle; -+ struct usbd_interface_information intf; -+}; -+ -+struct usbd_select_configuration { -+ struct nt_urb_header header; -+ struct usb_config_descriptor *config; -+ void *handle; -+ struct usbd_interface_information intf; -+}; -+ -+struct usbd_control_descriptor_request { -+ struct nt_urb_header header; -+ void *reserved; -+ ULONG reserved0; -+ ULONG transfer_buffer_length; -+ void *transfer_buffer; -+ struct mdl *mdl; -+ union nt_urb *urb_link; -+ struct urb_hcd_area hca; -+ USHORT reserved1; -+ UCHAR index; -+ UCHAR desc_type; -+ USHORT language_id; -+ USHORT reserved2; -+}; -+ -+struct usbd_bulk_or_intr_transfer { -+ struct nt_urb_header header; -+ struct usb_endpoint_descriptor *pipe_handle; -+ ULONG transfer_flags; -+ ULONG transfer_buffer_length; -+ void *transfer_buffer; -+ struct mdl *mdl; -+ union nt_urb *urb_link; -+ struct urb_hcd_area hca; -+}; -+ -+struct usbd_pipe_request { -+ struct nt_urb_header header; -+ struct usb_endpoint_descriptor *pipe_handle; -+}; -+ -+struct usbd_vendor_or_class_request { -+ struct nt_urb_header header; -+ void *reserved; -+ ULONG transfer_flags; -+ ULONG transfer_buffer_length; -+ void *transfer_buffer; -+ struct mdl *mdl; -+ union nt_urb *link; -+ struct urb_hcd_area hca; -+ UCHAR reserved_bits; -+ UCHAR request; -+ USHORT value; -+ USHORT index; -+ USHORT reserved1; -+}; -+ -+struct urb_control_feature_request { -+ struct nt_urb_header header; -+ void *reserved; -+ ULONG reserved2; -+ ULONG reserved3; -+ void *reserved4; -+ struct mdl *reserved5; -+ union nt_urb *link; -+ struct urb_hcd_area hca; -+ USHORT reserved0; -+ USHORT feature_selector; -+ USHORT index; -+ USHORT reserved1; -+}; -+ -+struct urb_control_get_status_request { -+ struct nt_urb_header header; -+ void *reserved; -+ ULONG reserved0; -+ ULONG transfer_buffer_length; -+ void *transfer_buffer; -+ struct mdl *mdl; -+ union nt_urb *link; -+ struct urb_hcd_area hca; -+ UCHAR reserved1[4]; -+ USHORT index; -+ USHORT reserved2; -+}; -+ -+struct usbd_iso_packet_desc { -+ ULONG offset; -+ ULONG length; -+ USBD_STATUS status; -+}; -+ -+struct usbd_isochronous_transfer { -+ struct nt_urb_header header; -+ struct usb_endpoint_descriptor *pipe_handle; -+ ULONG transfer_flags; -+ ULONG transfer_buffer_length; -+ void *transfer_buffer; -+ struct mdl *mdl; -+ union nt_urb *urb_link; -+ struct urb_hcd_area hca; -+ ULONG start_frame; -+ ULONG number_of_packets; -+ ULONG error_count; -+ struct usbd_iso_packet_desc iso_packet[1]; -+}; -+ -+union nt_urb { -+ struct nt_urb_header header; -+ struct usbd_select_interface select_intf; -+ struct usbd_select_configuration select_conf; -+ struct usbd_bulk_or_intr_transfer bulk_int_transfer; -+ struct usbd_control_descriptor_request control_desc; -+ struct usbd_vendor_or_class_request vendor_class_request; -+ struct usbd_isochronous_transfer isochronous; -+ struct usbd_pipe_request pipe_req; -+ struct urb_control_feature_request feat_req; -+ struct urb_control_get_status_request status_req; -+}; -+ -+struct usbd_bus_interface_usbdi { -+ USHORT Size; -+ USHORT Version; -+ void *Context; -+ void *InterfaceReference; -+ void *InterfaceDereference; -+ void *GetUSBDIVersion; -+ void *QueryBusTime; -+ void *SubmitIsoOutUrb; -+ void *QueryBusInformation; -+ /* version 1 and above have following field */ -+ void *IsDeviceHighSpeed; -+ /* version 2 (and above) have following field */ -+ void *LogEntry; -+}; -+ -+struct usbd_bus_information_level { -+ ULONG TotalBandwidth; -+ ULONG ConsumedBandwidth; -+ /* level 1 and above have following fields */ -+ ULONG ControllerNameLength; -+ wchar_t ControllerName[1]; -+}; -+ -+#define USBDI_VERSION_XP 0x00000500 // Windows XP -+#define USB_HCD_CAPS_SUPPORTS_RT_THREADS 0x00000001 -+#define USB_BUSIF_USBDI_VERSION_0 0x0000 -+#define USB_BUSIF_USBDI_VERSION_1 0x0001 -+#define USB_BUSIF_USBDI_VERSION_2 0x0002 -+ -+struct usbd_version_info { -+ ULONG usbdi_version; -+ ULONG supported_usb_version; -+}; -+ -+struct usbd_idle_callback { -+ void *callback; -+ void *context; -+}; -+ -+#define NT_URB_STATUS(nt_urb) ((nt_urb)->header.status) -+ -+NTSTATUS wrap_submit_irp(struct device_object *pdo, struct irp *irp); -+void wrap_suspend_urbs(struct wrap_device *wd); -+void wrap_resume_urbs(struct wrap_device *wd); -+NTSTATUS usb_query_interface(struct wrap_device *wd, -+ struct io_stack_location *irp_sl); -+ -+#endif /* USB_H */ -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/win2lin_stubs.S linux-4.12.4-3rd/3rdparty/ndiswrapper/win2lin_stubs.S ---- linux-4.12.4/3rdparty/ndiswrapper/win2lin_stubs.S 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/win2lin_stubs.S 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,253 @@ -+/* -+ * Copyright (C) 2005 Karl Vogel, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include -+ -+#ifdef CONFIG_X86_64 -+ -+/* -+# Windows <---> Linux register usage conversion when calling functions -+# V = Volatile -+# NV = Non Volatile (needs to be saved) -+# -+# Win Lin -+# --------------------------------------- -+# Rax Return V Return V -+# Rbx NV NV -+# Rcx Arg1 V Arg4 V -+# Rdx Arg2 V Arg3 V -+# Rsi NV Arg2 V -+# Rdi NV Arg1 V -+# Rsp NV NV -+# Rbp NV NV -+# R8 Arg3 V Arg5 V -+# R9 Arg4 V Arg6 V -+# R10 V V -+# R11 V V -+# R12 NV NV -+# R13 NV NV -+# R14 NV NV -+# R15 NV NV -+# -+# In addition, Linux uses %rax to indicate number of SSE registers used -+# when variadic functions are called. Since there is no way to obtain this -+# from Windows, for now, we just assume this is 0 (hence %rax is cleared). -+# -+# Windows pushes arguments 5 and higher onto stack in case of integer -+# variables and 4 and higher in case of floating point variables (passed -+# in SSE registers). -+ -+In a windows function, the stackframe/registers look like this: -+ -+# 0x0048 .... -+# 0x0040 arg8 -+# 0x0038 arg7 -+# 0x0030 arg6 -+# 0x0028 arg5 -+# 0x0020 shadow/spill space for arg4 -+# 0x0018 shadow/spill space for arg3 -+# 0x0010 shadow/spill space for arg2 -+# 0x0008 shadow/spill space for arg1 -+# 0x0000 ret -+ -+# register spill space is same irrespective of number of arguments - even -+# if Windows function takes less than 4 arguments, 32 bytes above return -+# address is reserved for the function -+ -+In Linux it should look like: -+ -+# 0x0018 .... -+# 0x0010 arg8 -+# 0x0008 arg7 -+# 0x0000 ret -+ -+*/ -+ -+ .text -+ -+#define LINUX_REG_ARGS 6 -+#define LOOP_THRESHOLD 9 -+#define WORD_BYTES 8 -+ -+/* -+ * %rsi and %rdi must be saved because they are not saved by Linux calls, but -+ * Windows callers expect them to be saved. %rbp is saved to create a stack -+ * frame, which can help with debugging. We need to reserve space for an odd -+ * number of registers anyway to keep 16-bit alignment of the stack (one more -+ * position is used by the return address). -+ */ -+#define SAVED_REGS 3 -+ -+/* -+ * When calling the Linux function, several registers are saved on the stack. -+ * When passing more than 6 arguments, arguments starting with argument 7 are -+ * pushed to the stack as well. -+ * -+ * We also need to allocate an additional word on the stack to keep it aligned -+ * to the 16-bit boundary if the number of saved arguments plus one (for the -+ * return address) is odd. -+ */ -+ -+/* -+ * Number of arguments we pass on stack to the Linux function. -+ * The value of true is -1 in assembler, so we multiply it by another true -+ * value. -+ */ -+#define stack_args(argc) \ -+ ((0 < 1) * (argc > LINUX_REG_ARGS) * (argc - LINUX_REG_ARGS)) -+ -+/* Full required change of stack pointer, in words */ -+#define stack_words_raw(argc) (stack_args(argc) + SAVED_REGS + 1) -+ -+/* Full actual change of stack pointer, in words (must be even) */ -+#define stack_words_aligned(argc) ((stack_words_raw(argc) + 1) & ~1) -+ -+/* Space allocated for Linux arguments on stack */ -+#define stack_space(argc) \ -+ ((stack_words_aligned(argc) - SAVED_REGS - 1) * WORD_BYTES) -+ -+/* -+ * win2lin_win_arg(N, ARGC) gives the address of the Windows argument N out of -+ * total ARGC after the stack has been prepared for the Linux function call. -+ * -+ * When called from Windows, the Nth argument is at (N * 8)(%rsp). We add the -+ * stack space allocated by the Linux function to compensate for %rsp change. -+ * -+ * Don't call with N less than 5! -+ */ -+#define win2lin_win_arg(n, argc) \ -+ ((n + SAVED_REGS) * WORD_BYTES + stack_space(argc))(%rsp) -+ -+/* -+ * win2lin_lin_arg(N) gives the address of the Nth Linux argument on the extra -+ * Linux stack frame. When more than 6 arguments are used, %rsp points to the -+ * 7th argument. The Nth argument is therefore at ((N - 7) * 8)(%rsp). -+ * -+ * Don't call with N less than 7! -+ */ -+#define win2lin_lin_arg(n) ((n - 1 - LINUX_REG_ARGS) * WORD_BYTES)(%rsp) -+ -+/* Declare function LONGNAME, call function SHORTNAME with ARGC arguments */ -+.macro win2linm longname, shortname, argc -+ .type \longname, @function -+ ENTRY(\longname) -+ -+ /* Create a call frame - it's optional, but good for debugging */ -+ .cfi_startproc -+ push %rbp -+ .cfi_def_cfa %rsp, 2 * WORD_BYTES -+ .cfi_offset %rbp, -2 * WORD_BYTES -+ mov %rsp, %rbp -+ .cfi_def_cfa %rbp, 2 * WORD_BYTES -+ -+ /* -+ * Registers %rdi and %rsi are volatile on Linux, but not on Windows, -+ * so save them on the stack. -+ */ -+ push %rsi -+ push %rdi -+ -+ /* Allocate extra stack space for arguments 7 and up */ -+ sub $stack_space(\argc), %rsp -+ -+ /* -+ * Copy arguments 7 and up. We do it early, before %rdi and %rsi -+ * are used for arguments 1 and 2, so we don't have to save them. -+ * We still need to save %rcx if using a string copy. -+ */ -+ .if (\argc < LOOP_THRESHOLD) -+ /* If a few arguments, copy them individually through %r11 */ -+ .if (\argc >= 7) -+ mov win2lin_win_arg(7, \argc), %r11 -+ mov %r11, win2lin_lin_arg(7) -+ .endif -+ .if (\argc >= 8) -+ mov win2lin_win_arg(8, \argc), %r11 -+ mov %r11, win2lin_lin_arg(8) -+ .endif -+ .else -+ /* If there are many arguments, copy them in a loop */ -+ /* Save arg1 to %r11 */ -+ mov %rcx, %r11 -+ /* Source and destination */ -+ lea win2lin_win_arg(LINUX_REG_ARGS + 1, \argc), %rsi -+ lea win2lin_lin_arg(LINUX_REG_ARGS + 1), %rdi -+ /* Number of arguments to copy (%ecx zero-extends to %rcx) */ -+ mov $(\argc - LINUX_REG_ARGS), %ecx -+ rep movsq -+ /* Restore arg1 directly to %rdi */ -+ mov %r11, %rdi -+ .endif -+ -+ /* -+ * Argument 1 - %rcx on Windows, %rdi on Linux -+ * Micro-optimization - if we used loop, arg1 is already in %rdi -+ */ -+ .if (\argc >= 1) && (\argc < LOOP_THRESHOLD) -+ mov %rcx, %rdi -+ .endif -+ -+ /* Argument 2 - %rdx on Windows, %rsi on Linux */ -+ .if (\argc >= 2) -+ mov %rdx, %rsi -+ .endif -+ -+ /* Argument 3 - %r8 on Windows, %rdx on Linux */ -+ .if (\argc >= 3) -+ mov %r8, %rdx -+ .endif -+ -+ /* Argument 4 - %r9 on Windows, %rcx on Linux */ -+ .if (\argc >= 4) -+ mov %r9, %rcx -+ .endif -+ -+ /* Argument 5 - first argument on stack on Windows, %r8 Linux */ -+ .if (\argc >= 5) -+ mov win2lin_win_arg(5, \argc), %r8 -+ .endif -+ -+ /* Argument 6 - second argument on stack on Windows, %r9 Linux */ -+ .if (\argc >= 6) -+ mov win2lin_win_arg(6, \argc), %r9 -+ .endif -+ -+ /* %rax on Linux is the number of arguments in SSE registers (zero) */ -+ xor %rax, %rax -+ -+ /* Call the function */ -+ call \shortname -+ -+ /* Free stack space for arguments 7 and up */ -+ add $stack_space(\argc), %rsp -+ -+ /* Restore saved registers */ -+ pop %rdi -+ pop %rsi -+ -+ /* Return to Windows code */ -+ leave -+ .cfi_def_cfa %rsp, WORD_BYTES -+ .cfi_restore %rbp -+ ret -+ .cfi_endproc -+ .size \longname, (. - \longname) -+.endm -+ -+#define win2lin(name, argc) win2linm win2lin_ ## name ## _ ## argc, name, argc -+ -+#include "win2lin_stubs.h" -+ -+#endif /* CONFIG_X86_64 */ -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/winnt_types.h linux-4.12.4-3rd/3rdparty/ndiswrapper/winnt_types.h ---- linux-4.12.4/3rdparty/ndiswrapper/winnt_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/winnt_types.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,1701 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifndef _WINNT_TYPES_H_ -+#define _WINNT_TYPES_H_ -+ -+#define TRUE 1 -+#define FALSE 0 -+ -+#define PASSIVE_LEVEL 0 -+#define APC_LEVEL 1 -+#define DISPATCH_LEVEL 2 -+#define DEVICE_LEVEL_BASE 4 -+ -+/* soft interrupts / bottom-half's are disabled at SOFT_IRQL */ -+#define SOFT_IRQL (DEVICE_LEVEL_BASE + 1) -+#define DIRQL (DEVICE_LEVEL_BASE + 2) -+ -+#define STATUS_WAIT_0 0 -+#define STATUS_SUCCESS 0 -+#define STATUS_ALERTED 0x00000101 -+#define STATUS_TIMEOUT 0x00000102 -+#define STATUS_PENDING 0x00000103 -+#define STATUS_FAILURE 0xC0000001 -+#define STATUS_NOT_IMPLEMENTED 0xC0000002 -+#define STATUS_INVALID_PARAMETER 0xC000000D -+#define STATUS_INVALID_DEVICE_REQUEST 0xC0000010 -+#define STATUS_MORE_PROCESSING_REQUIRED 0xC0000016 -+#define STATUS_ACCESS_DENIED 0xC0000022 -+#define STATUS_BUFFER_TOO_SMALL 0xC0000023 -+#define STATUS_OBJECT_NAME_INVALID 0xC0000023 -+#define STATUS_MUTANT_NOT_OWNED 0xC0000046 -+#define STATUS_RESOURCES 0xC000009A -+#define STATUS_DELETE_PENDING 0xC0000056 -+#define STATUS_INSUFFICIENT_RESOURCES 0xC000009A -+#define STATUS_NOT_SUPPORTED 0xC00000BB -+#define STATUS_INVALID_PARAMETER_2 0xC00000F0 -+#define STATUS_NO_MEMORY 0xC0000017 -+#define STATUS_CANCELLED 0xC0000120 -+#define STATUS_DEVICE_REMOVED 0xC00002B6 -+#define STATUS_DEVICE_NOT_CONNECTED 0xC000009D -+ -+#define STATUS_BUFFER_OVERFLOW 0x80000005 -+ -+#define SL_PENDING_RETURNED 0x01 -+#define SL_INVOKE_ON_CANCEL 0x20 -+#define SL_INVOKE_ON_SUCCESS 0x40 -+#define SL_INVOKE_ON_ERROR 0x80 -+ -+#define IRP_MJ_CREATE 0x00 -+#define IRP_MJ_CREATE_NAMED_PIPE 0x01 -+#define IRP_MJ_CLOSE 0x02 -+#define IRP_MJ_READ 0x03 -+#define IRP_MJ_WRITE 0x04 -+ -+#define IRP_MJ_DEVICE_CONTROL 0x0E -+#define IRP_MJ_INTERNAL_DEVICE_CONTROL 0x0F -+#define IRP_MJ_POWER 0x16 -+#define IRP_MJ_SYSTEM_CONTROL 0x0E -+#define IRP_MJ_PNP 0x1b -+#define IRP_MJ_MAXIMUM_FUNCTION 0x1b -+ -+#define IRP_MN_WAIT_WAKE 0x00 -+#define IRP_MN_POWER_SEQUENCE 0x01 -+#define IRP_MN_SET_POWER 0x02 -+#define IRP_MN_QUERY_POWER 0x03 -+ -+#define IRP_MN_REGINFO 0x08 -+#define IRP_MN_REGINFO_EX 0x0b -+ -+#define IRP_MN_START_DEVICE 0x00 -+#define IRP_MN_QUERY_REMOVE_DEVICE 0x01 -+#define IRP_MN_REMOVE_DEVICE 0x02 -+#define IRP_MN_CANCEL_REMOVE_DEVICE 0x03 -+#define IRP_MN_STOP_DEVICE 0x04 -+#define IRP_MN_QUERY_STOP_DEVICE 0x05 -+#define IRP_MN_CANCEL_STOP_DEVICE 0x06 -+#define IRP_MN_QUERY_DEVICE_RELATIONS 0x07 -+#define IRP_MN_QUERY_INTERFACE 0x08 -+ -+#define IRP_BUFFERED_IO 0x00000010 -+#define IRP_DEALLOCATE_BUFFER 0x00000020 -+#define IRP_INPUT_OPERATION 0x00000040 -+ -+#define IRP_DEFFER_IO_COMPLETION 0x00000800 -+ -+#define THREAD_WAIT_OBJECTS 3 -+#define MAX_WAIT_OBJECTS 64 -+ -+#define LOW_PRIORITY 0 -+#define LOW_REALTIME_PRIORITY 16 -+#define HIGH_PRIORITY 31 -+#define MAXIMUM_PRIORITY 32 -+ -+#define PROCESSOR_FEATURE_MAX 64 -+ -+#define IO_NO_INCREMENT 0 -+ -+#define WMIREG_ACTION_REGISTER 1 -+#define WMIREG_ACTION_DEREGISTER 2 -+#define WMIREG_ACTION_REREGISTER 3 -+#define WMIREG_ACTION_UPDATE_GUIDS 4 -+ -+#define WMIREGISTER 0 -+#define WMIUPDATE 1 -+ -+#ifdef CONFIG_X86_64 -+#define wstdcall -+#define wfastcall -+#define noregparm -+#define regparm3 -+ -+#define KI_USER_SHARED_DATA 0xfffff78000000000UL -+ -+#else -+ -+#define noregparm __attribute__((regparm(0))) -+#define regparm3 __attribute__((regparm(3))) -+#define wstdcall __attribute__((__stdcall__, regparm(0))) -+#if defined(__GNUC__) && ((__GNUC__ == 3 && __GNUC_MINOR__ > 3) || __GNUC__ > 3) -+#undef fastcall -+#define wfastcall __attribute__((fastcall)) -+#else -+#error "gcc 3.4 or newer should be used for compiling this module" -+#endif -+ -+#define KI_USER_SHARED_DATA 0xffdf0000 -+ -+#endif -+ -+typedef u8 BOOLEAN; -+typedef u8 BYTE; -+typedef u8 *LPBYTE; -+typedef s8 CHAR; -+typedef u8 UCHAR; -+typedef s16 SHORT; -+typedef u16 USHORT; -+typedef u16 WORD; -+typedef s32 INT; -+typedef u32 UINT; -+typedef u32 DWORD; -+typedef s32 LONG; -+typedef u32 ULONG; -+typedef s64 LONGLONG; -+typedef u64 ULONGLONG; -+typedef u64 ULONGULONG; -+typedef u64 ULONG64; -+ -+typedef CHAR CCHAR; -+typedef USHORT wchar_t; -+typedef SHORT CSHORT; -+typedef LONGLONG LARGE_INTEGER; -+ -+typedef LONG NTSTATUS; -+ -+typedef LONG KPRIORITY; -+typedef LARGE_INTEGER PHYSICAL_ADDRESS; -+typedef UCHAR KIRQL; -+typedef CHAR KPROCESSOR_MODE; -+ -+/* ULONG_PTR is 32 bits on 32-bit platforms and 64 bits on 64-bit -+ * platform, which is same as 'unsigned long' in Linux */ -+typedef unsigned long ULONG_PTR; -+ -+typedef size_t SIZE_T; -+typedef ULONG_PTR KAFFINITY; -+typedef ULONG ACCESS_MASK; -+ -+typedef ULONG_PTR PFN_NUMBER; -+typedef ULONG SECURITY_INFORMATION; -+ -+/* non-negative numbers indicate success */ -+#define NT_SUCCESS(status) ((NTSTATUS)(status) >= 0) -+ -+struct ansi_string { -+ USHORT length; -+ USHORT max_length; -+ char *buf; -+}; -+ -+struct unicode_string { -+ USHORT length; -+ USHORT max_length; -+ wchar_t *buf; -+}; -+ -+struct nt_slist { -+ struct nt_slist *next; -+}; -+ -+#ifdef CONFIG_X86_64 -+/* it is not clear how nt_slist_head is used to store pointer to -+ * slists and depth; here we assume 'align' field is used to store -+ * depth and 'region' field is used to store slist pointers */ -+struct nt_slist_head { -+ union { -+ USHORT depth; -+ ULONGLONG align; -+ }; -+ union { -+ ULONGLONG region; -+ struct nt_slist *next; -+ }; -+} __attribute__((aligned(16))); -+typedef struct nt_slist_head nt_slist_header; -+#else -+union nt_slist_head { -+ ULONGLONG align; -+ struct { -+ struct nt_slist *next; -+ USHORT depth; -+ USHORT sequence; -+ }; -+}; -+typedef union nt_slist_head nt_slist_header; -+#endif -+ -+struct nt_list { -+ struct nt_list *next; -+ struct nt_list *prev; -+}; -+ -+typedef ULONG_PTR NT_SPIN_LOCK; -+ -+enum kdpc_importance {LowImportance, MediumImportance, HighImportance}; -+ -+struct kdpc; -+typedef void (*DPC)(struct kdpc *kdpc, void *ctx, void *arg1, -+ void *arg2) wstdcall; -+struct kdpc { -+ SHORT type; -+ UCHAR nr_cpu; -+ UCHAR importance; -+ struct nt_list list; -+ DPC func; -+ void *ctx; -+ void *arg1; -+ void *arg2; -+ union { -+ NT_SPIN_LOCK *lock; -+ /* 'lock' is not used; 'queued' represents whether -+ * kdpc is queued or not */ -+ int queued; -+ }; -+}; -+ -+enum pool_type { -+ NonPagedPool, PagedPool, NonPagedPoolMustSucceed, DontUseThisType, -+ NonPagedPoolCacheAligned, PagedPoolCacheAligned, -+ NonPagedPoolCacheAlignedMustS, MaxPoolType, -+ NonPagedPoolSession = 32, -+ PagedPoolSession = NonPagedPoolSession + 1, -+ NonPagedPoolMustSucceedSession = PagedPoolSession + 1, -+ DontUseThisTypeSession = NonPagedPoolMustSucceedSession + 1, -+ NonPagedPoolCacheAlignedSession = DontUseThisTypeSession + 1, -+ PagedPoolCacheAlignedSession = NonPagedPoolCacheAlignedSession + 1, -+ NonPagedPoolCacheAlignedMustSSession = PagedPoolCacheAlignedSession + 1 -+}; -+ -+enum memory_caching_type_orig { -+ MmFrameBufferCached = 2 -+}; -+ -+enum memory_caching_type { -+ MmNonCached = FALSE, MmCached = TRUE, -+ MmWriteCombined = MmFrameBufferCached, MmHardwareCoherentCached, -+ MmNonCachedUnordered, MmUSWCCached, MmMaximumCacheType -+}; -+ -+enum lock_operation { -+ IoReadAccess, IoWriteAccess, IoModifyAccess -+}; -+ -+enum mode { -+ KernelMode, UserMode, MaximumMode -+}; -+ -+struct mdl { -+ struct mdl *next; -+ CSHORT size; -+ CSHORT flags; -+ /* NdisFreeBuffer doesn't pass pool, so we store pool in -+ * unused field 'process' */ -+ union { -+ void *process; -+ void *pool; -+ }; -+ void *mappedsystemva; -+ void *startva; -+ ULONG bytecount; -+ ULONG byteoffset; -+}; -+ -+#define MDL_MAPPED_TO_SYSTEM_VA 0x0001 -+#define MDL_PAGES_LOCKED 0x0002 -+#define MDL_SOURCE_IS_NONPAGED_POOL 0x0004 -+#define MDL_ALLOCATED_FIXED_SIZE 0x0008 -+#define MDL_PARTIAL 0x0010 -+#define MDL_PARTIAL_HAS_BEEN_MAPPED 0x0020 -+#define MDL_IO_PAGE_READ 0x0040 -+#define MDL_WRITE_OPERATION 0x0080 -+#define MDL_PARENT_MAPPED_SYSTEM_VA 0x0100 -+#define MDL_FREE_EXTRA_PTES 0x0200 -+#define MDL_IO_SPACE 0x0800 -+#define MDL_NETWORK_HEADER 0x1000 -+#define MDL_MAPPING_CAN_FAIL 0x2000 -+#define MDL_ALLOCATED_MUST_SUCCEED 0x4000 -+ -+#define MDL_POOL_ALLOCATED 0x0400 -+#define MDL_CACHE_ALLOCATED 0x8000 -+ -+#define PAGE_START(ptr) ((void *)((ULONG_PTR)(ptr) & ~(PAGE_SIZE - 1))) -+#define BYTE_OFFSET(ptr) ((ULONG)((ULONG_PTR)(ptr) & (PAGE_SIZE - 1))) -+ -+#define MmGetMdlByteCount(mdl) ((mdl)->bytecount) -+#define MmGetMdlVirtualAddress(mdl) ((mdl)->startva + (mdl)->byteoffset) -+#define MmGetMdlByteOffset(mdl) ((mdl)->byteoffset) -+#define MmGetSystemAddressForMdl(mdl) ((mdl)->mappedsystemva) -+#define MmGetSystemAddressForMdlSafe(mdl, priority) ((mdl)->mappedsystemva) -+#define MmGetMdlPfnArray(mdl) ((PFN_NUMBER *)(mdl + 1)) -+#define MmInitializeMdl(mdl, baseva, length) \ -+do { \ -+ (mdl)->next = NULL; \ -+ (mdl)->size = MmSizeOfMdl(baseva, length); \ -+ (mdl)->flags = 0; \ -+ (mdl)->startva = PAGE_START(baseva); \ -+ (mdl)->byteoffset = BYTE_OFFSET(baseva); \ -+ (mdl)->bytecount = length; \ -+ (mdl)->mappedsystemva = baseva; \ -+ TRACE4("%p %p %p %d %d", (mdl), baseva, (mdl)->startva, \ -+ (mdl)->byteoffset, length); \ -+} while (0) -+ -+struct kdevice_queue_entry { -+ struct nt_list list; -+ ULONG sort_key; -+ BOOLEAN inserted; -+}; -+ -+struct kdevice_queue { -+ USHORT type; -+ USHORT size; -+ struct nt_list list; -+ NT_SPIN_LOCK lock; -+ BOOLEAN busy; -+}; -+ -+struct wait_context_block { -+ struct kdevice_queue_entry wait_queue_entry; -+ void *device_routine; -+ void *device_context; -+ ULONG num_regs; -+ void *device_object; -+ void *current_irp; -+ void *buffer_chaining_dpc; -+}; -+ -+struct wait_block { -+ struct nt_list list; -+ struct task_struct *thread; -+ void *object; -+ int *wait_done; -+ USHORT wait_key; -+ USHORT wait_type; -+}; -+ -+struct dispatcher_header { -+ UCHAR type; -+ UCHAR absolute; -+ UCHAR size; -+ UCHAR inserted; -+ LONG signal_state; -+ struct nt_list wait_blocks; -+}; -+ -+enum event_type { -+ NotificationEvent, -+ SynchronizationEvent, -+}; -+ -+enum timer_type { -+ NotificationTimer = NotificationEvent, -+ SynchronizationTimer = SynchronizationEvent, -+}; -+ -+enum dh_type { -+ NotificationObject = NotificationEvent, -+ SynchronizationObject = SynchronizationEvent, -+ MutexObject, -+ SemaphoreObject, -+ ThreadObject, -+}; -+ -+enum wait_type { -+ WaitAll, WaitAny -+}; -+ -+/* objects that use dispatcher_header have it as the first field, so -+ * whenever we need to initialize dispatcher_header, we can convert -+ * that object into a nt_event and access dispatcher_header */ -+struct nt_event { -+ struct dispatcher_header dh; -+}; -+ -+struct wrap_timer; -+ -+#define WRAP_TIMER_MAGIC 47697249 -+ -+struct nt_timer { -+ struct dispatcher_header dh; -+ /* We can't fit Linux timer in this structure. Instead of -+ * padding the nt_timer structure, we replace due_time field -+ * with *wrap_timer and allocate memory for it when nt_timer is -+ * initialized */ -+ union { -+ ULONGLONG due_time; -+ struct wrap_timer *wrap_timer; -+ }; -+ struct nt_list nt_timer_list; -+ struct kdpc *kdpc; -+ union { -+ LONG period; -+ LONG wrap_timer_magic; -+ }; -+}; -+ -+struct nt_mutex { -+ struct dispatcher_header dh; -+ struct nt_list list; -+ struct task_struct *owner_thread; -+ BOOLEAN abandoned; -+ BOOLEAN apc_disable; -+}; -+ -+struct nt_semaphore { -+ struct dispatcher_header dh; -+ LONG limit; -+}; -+ -+struct nt_thread { -+ struct dispatcher_header dh; -+ /* the rest in Windows is a long structure; since this -+ * structure is opaque to drivers, we just define what we -+ * need */ -+ int pid; -+ NTSTATUS status; -+ struct task_struct *task; -+ struct nt_list irps; -+ NT_SPIN_LOCK lock; -+ KPRIORITY prio; -+}; -+ -+#define set_object_type(dh, type) ((dh)->type = (type)) -+#define is_notify_object(dh) ((dh)->type == NotificationObject) -+#define is_synch_object(dh) ((dh)->type == SynchronizationObject) -+#define is_mutex_object(dh) ((dh)->type == MutexObject) -+#define is_semaphore_object(dh) ((dh)->type == SemaphoreObject) -+#define is_nt_thread_object(dh) ((dh)->type == ThreadObject) -+ -+#define IO_TYPE_ADAPTER 1 -+#define IO_TYPE_CONTROLLER 2 -+#define IO_TYPE_DEVICE 3 -+#define IO_TYPE_DRIVER 4 -+#define IO_TYPE_FILE 5 -+#define IO_TYPE_IRP 6 -+#define IO_TYPE_DEVICE_OBJECT_EXTENSION 13 -+ -+struct irp; -+struct dev_obj_ext; -+struct driver_object; -+ -+struct device_object { -+ CSHORT type; -+ USHORT size; -+ LONG ref_count; -+ struct driver_object *drv_obj; -+ struct device_object *next; -+ struct device_object *attached; -+ struct irp *current_irp; -+ void *io_timer; -+ ULONG flags; -+ ULONG characteristics; -+ void *vpb; -+ void *dev_ext; -+ CCHAR stack_count; -+ union { -+ struct nt_list queue_list; -+ struct wait_context_block wcb; -+ } queue; -+ ULONG align_req; -+ struct kdevice_queue dev_queue; -+ struct kdpc dpc; -+ ULONG active_threads; -+ void *security_desc; -+ struct nt_event lock; -+ USHORT sector_size; -+ USHORT spare1; -+ struct dev_obj_ext *dev_obj_ext; -+ void *reserved; -+}; -+ -+struct dev_obj_ext { -+ CSHORT type; -+ CSHORT size; -+ struct device_object *dev_obj; -+ struct device_object *attached_to; -+}; -+ -+struct io_status_block { -+ union { -+ NTSTATUS status; -+ void *pointer; -+ }; -+ ULONG_PTR info; -+}; -+ -+#ifdef CONFIG_X86_64 -+struct io_status_block32 { -+ NTSTATUS status; -+ ULONG info; -+}; -+#endif -+ -+#define DEVICE_TYPE ULONG -+ -+struct driver_extension; -+ -+typedef NTSTATUS driver_dispatch_t(struct device_object *dev_obj, -+ struct irp *irp) wstdcall; -+ -+struct driver_object { -+ CSHORT type; -+ CSHORT size; -+ struct device_object *dev_obj; -+ ULONG flags; -+ void *start; -+ ULONG driver_size; -+ void *section; -+ struct driver_extension *drv_ext; -+ struct unicode_string name; -+ struct unicode_string *hardware_database; -+ void *fast_io_dispatch; -+ void *init; -+ void *start_io; -+ void (*unload)(struct driver_object *driver) wstdcall; -+ driver_dispatch_t *major_func[IRP_MJ_MAXIMUM_FUNCTION + 1]; -+}; -+ -+struct driver_extension { -+ struct driver_object *drv_obj; -+ NTSTATUS (*add_device)(struct driver_object *drv_obj, -+ struct device_object *dev_obj); -+ ULONG count; -+ struct unicode_string service_key_name; -+ struct nt_list custom_ext; -+}; -+ -+struct custom_ext { -+ struct nt_list list; -+ void *client_id; -+}; -+ -+struct wrap_bin_file; -+ -+struct file_object { -+ CSHORT type; -+ CSHORT size; -+ struct device_object *dev_obj; -+ void *volume_parameter_block; -+ void *fs_context; -+ void *fs_context2; -+ void *section_object_pointer; -+ void *private_cache_map; -+ NTSTATUS final_status; -+ union { -+ struct file_object *related_file_object; -+ struct wrap_bin_file *wrap_bin_file; -+ }; -+ BOOLEAN lock_operation; -+ BOOLEAN delete_pending; -+ BOOLEAN read_access; -+ BOOLEAN write_access; -+ BOOLEAN delete_access; -+ BOOLEAN shared_read; -+ BOOLEAN shared_write; -+ BOOLEAN shared_delete; -+ ULONG flags; -+ struct unicode_string _name_; -+ LARGE_INTEGER current_byte_offset; -+ ULONG waiters; -+ ULONG busy; -+ void *last_lock; -+ struct nt_event lock; -+ struct nt_event event; -+ void *completion_context; -+}; -+ -+#ifdef CONFIG_X86_64 -+#define POINTER_ALIGN __attribute__((aligned(8))) -+#else -+#define POINTER_ALIGN -+#endif -+ -+#define CACHE_ALIGN __attribute__((aligned(128))) -+ -+enum system_power_state { -+ PowerSystemUnspecified = 0, -+ PowerSystemWorking, PowerSystemSleeping1, PowerSystemSleeping2, -+ PowerSystemSleeping3, PowerSystemHibernate, PowerSystemShutdown, -+ PowerSystemMaximum, -+}; -+ -+enum device_power_state { -+ PowerDeviceUnspecified = 0, -+ PowerDeviceD0, PowerDeviceD1, PowerDeviceD2, PowerDeviceD3, -+ PowerDeviceMaximum, -+}; -+ -+union power_state { -+ enum system_power_state system_state; -+ enum device_power_state device_state; -+}; -+ -+enum power_state_type { -+ SystemPowerState = 0, DevicePowerState, -+}; -+ -+enum power_action { -+ PowerActionNone = 0, -+ PowerActionReserved, PowerActionSleep, PowerActionHibernate, -+ PowerActionShutdown, PowerActionShutdownReset, PowerActionShutdownOff, -+ PowerActionWarmEject, -+}; -+ -+struct guid { -+ ULONG data1; -+ USHORT data2; -+ USHORT data3; -+ UCHAR data4[8]; -+}; -+ -+struct nt_interface { -+ USHORT size; -+ USHORT version; -+ void *context; -+ void (*reference)(void *context) wstdcall; -+ void (*dereference)(void *context) wstdcall; -+}; -+ -+enum interface_type { -+ InterfaceTypeUndefined = -1, Internal, Isa, Eisa, MicroChannel, -+ TurboChannel, PCIBus, VMEBus, NuBus, PCMCIABus, CBus, MPIBus, -+ MPSABus, ProcessorInternal, InternalPowerBus, PNPISABus, -+ PNPBus, MaximumInterfaceType, -+}; -+ -+#define CmResourceTypeNull 0 -+#define CmResourceTypePort 1 -+#define CmResourceTypeInterrupt 2 -+#define CmResourceTypeMemory 3 -+#define CmResourceTypeDma 4 -+#define CmResourceTypeDeviceSpecific 5 -+#define CmResourceTypeBusNumber 6 -+#define CmResourceTypeMaximum 7 -+ -+#define CmResourceTypeNonArbitrated 128 -+#define CmResourceTypeConfigData 128 -+#define CmResourceTypeDevicePrivate 129 -+#define CmResourceTypePcCardConfig 130 -+#define CmResourceTypeMfCardConfig 131 -+ -+enum cm_share_disposition { -+ CmResourceShareUndetermined = 0, CmResourceShareDeviceExclusive, -+ CmResourceShareDriverExclusive, CmResourceShareShared -+}; -+ -+#define CM_RESOURCE_INTERRUPT_LEVEL_SENSITIVE 0 -+#define CM_RESOURCE_INTERRUPT_LATCHED 1 -+#define CM_RESOURCE_MEMORY_READ_WRITE 0x0000 -+#define CM_RESOURCE_MEMORY_READ_ONLY 0x0001 -+#define CM_RESOURCE_MEMORY_WRITE_ONLY 0x0002 -+#define CM_RESOURCE_MEMORY_PREFETCHABLE 0x0004 -+ -+#define CM_RESOURCE_MEMORY_COMBINEDWRITE 0x0008 -+#define CM_RESOURCE_MEMORY_24 0x0010 -+#define CM_RESOURCE_MEMORY_CACHEABLE 0x0020 -+ -+#define CM_RESOURCE_PORT_MEMORY 0x0000 -+#define CM_RESOURCE_PORT_IO 0x0001 -+#define CM_RESOURCE_PORT_10_BIT_DECODE 0x0004 -+#define CM_RESOURCE_PORT_12_BIT_DECODE 0x0008 -+#define CM_RESOURCE_PORT_16_BIT_DECODE 0x0010 -+#define CM_RESOURCE_PORT_POSITIVE_DECODE 0x0020 -+#define CM_RESOURCE_PORT_PASSIVE_DECODE 0x0040 -+#define CM_RESOURCE_PORT_WINDOW_DECODE 0x0080 -+ -+#define CM_RESOURCE_DMA_8 0x0000 -+#define CM_RESOURCE_DMA_16 0x0001 -+#define CM_RESOURCE_DMA_32 0x0002 -+#define CM_RESOURCE_DMA_8_AND_16 0x0004 -+#define CM_RESOURCE_DMA_BUS_MASTER 0x0008 -+#define CM_RESOURCE_DMA_TYPE_A 0x0010 -+#define CM_RESOURCE_DMA_TYPE_B 0x0020 -+#define CM_RESOURCE_DMA_TYPE_F 0x0040 -+ -+#define MAX_RESOURCES 20 -+ -+#pragma pack(push,4) -+struct cm_partial_resource_descriptor { -+ UCHAR type; -+ UCHAR share; -+ USHORT flags; -+ union { -+ struct { -+ PHYSICAL_ADDRESS start; -+ ULONG length; -+ } generic; -+ struct { -+ PHYSICAL_ADDRESS start; -+ ULONG length; -+ } port; -+ struct { -+ ULONG level; -+ ULONG vector; -+ KAFFINITY affinity; -+ } interrupt; -+ struct { -+ PHYSICAL_ADDRESS start; -+ ULONG length; -+ } memory; -+ struct { -+ ULONG channel; -+ ULONG port; -+ ULONG reserved1; -+ } dma; -+ struct { -+ ULONG data[3]; -+ } device_private; -+ struct { -+ ULONG start; -+ ULONG length; -+ ULONG reserved; -+ } bus_number; -+ struct { -+ ULONG data_size; -+ ULONG reserved1; -+ ULONG reserved2; -+ } device_specific_data; -+ } u; -+}; -+#pragma pack(pop) -+ -+struct cm_partial_resource_list { -+ USHORT version; -+ USHORT revision; -+ ULONG count; -+ struct cm_partial_resource_descriptor partial_descriptors[1]; -+}; -+ -+struct cm_full_resource_descriptor { -+ enum interface_type interface_type; -+ ULONG bus_number; -+ struct cm_partial_resource_list partial_resource_list; -+}; -+ -+struct cm_resource_list { -+ ULONG count; -+ struct cm_full_resource_descriptor list[1]; -+}; -+ -+enum file_info_class { -+ FileDirectoryInformation = 1, -+ FileBasicInformation = 4, -+ FileStandardInformation = 5, -+ FileNameInformation = 9, -+ FilePositionInformation = 14, -+ FileAlignmentInformation = 17, -+ FileNetworkOpenInformation = 34, -+ FileAttributeTagInformation = 35, -+ FileMaximumInformation = 41, -+}; -+ -+enum fs_info_class { -+ FileFsVolumeInformation = 1, -+ /* ... */ -+ FileFsMaximumInformation = 9, -+}; -+ -+enum device_relation_type { -+ BusRelations, EjectionRelations, PowerRelations, RemovalRelations, -+ TargetDeviceRelation, SingleBusRelations, -+}; -+ -+enum bus_query_id_type { -+ BusQueryDeviceID = 0, BusQueryHardwareIDs = 1, -+ BusQueryCompatibleIDs = 2, BusQueryInstanceID = 3, -+ BusQueryDeviceSerialNumber = 4, -+}; -+ -+enum device_text_type { -+ DeviceTextDescription = 0, DeviceTextLocationInformation = 1, -+}; -+ -+enum device_usage_notification_type { -+ DeviceUsageTypeUndefined, DeviceUsageTypePaging, -+ DeviceUsageTypeHibernation, DevbiceUsageTypeDumpFile, -+}; -+ -+#define METHOD_BUFFERED 0 -+#define METHOD_IN_DIRECT 1 -+#define METHOD_OUT_DIRECT 2 -+#define METHOD_NEITHER 3 -+ -+#define CTL_CODE(dev_type, func, method, access) \ -+ (((dev_type) << 16) | ((access) << 14) | ((func) << 2) | (method)) -+ -+#define IO_METHOD_FROM_CTL_CODE(code) (code & 0x3) -+ -+#ifndef CONFIG_X86_64 -+#pragma pack(push,4) -+#endif -+struct io_stack_location { -+ UCHAR major_fn; -+ UCHAR minor_fn; -+ UCHAR flags; -+ UCHAR control; -+ union { -+ struct { -+ void *security_context; -+ ULONG options; -+ USHORT POINTER_ALIGN file_attributes; -+ USHORT share_access; -+ ULONG POINTER_ALIGN ea_length; -+ } create; -+ struct { -+ ULONG length; -+ ULONG POINTER_ALIGN key; -+ LARGE_INTEGER byte_offset; -+ } read; -+ struct { -+ ULONG length; -+ ULONG POINTER_ALIGN key; -+ LARGE_INTEGER byte_offset; -+ } write; -+ struct { -+ ULONG length; -+ enum file_info_class POINTER_ALIGN file_info_class; -+ } query_file; -+ struct { -+ ULONG length; -+ enum file_info_class POINTER_ALIGN file_info_class; -+ struct file_object *file_object; -+ union { -+ struct { -+ BOOLEAN replace_if_exists; -+ BOOLEAN advance_only; -+ }; -+ ULONG cluster_count; -+ void *delete_handle; -+ }; -+ } set_file; -+ struct { -+ ULONG length; -+ enum fs_info_class POINTER_ALIGN fs_info_class; -+ } query_volume; -+ struct { -+ ULONG output_buf_len; -+ ULONG POINTER_ALIGN input_buf_len; -+ ULONG POINTER_ALIGN code; -+ void *type3_input_buf; -+ } dev_ioctl; -+ struct { -+ SECURITY_INFORMATION security_info; -+ ULONG POINTER_ALIGN length; -+ } query_security; -+ struct { -+ SECURITY_INFORMATION security_info; -+ void *security_descriptor; -+ } set_security; -+ struct { -+ void *vpb; -+ struct device_object *device_object; -+ } mount_volume; -+ struct { -+ void *vpb; -+ struct device_object *device_object; -+ } verify_volume; -+ struct { -+ void *srb; -+ } scsi; -+ struct { -+ enum device_relation_type type; -+ } query_device_relations; -+ struct { -+ const struct guid *type; -+ USHORT size; -+ USHORT version; -+ struct nt_interface *intf; -+ void *intf_data; -+ } query_intf; -+ struct { -+ void *capabilities; -+ } device_capabilities; -+ struct { -+ void *io_resource_requirement_list; -+ } filter_resource_requirements; -+ struct { -+ ULONG which_space; -+ void *buffer; -+ ULONG offset; -+ ULONG POINTER_ALIGN length; -+ } read_write_config; -+ struct { -+ BOOLEAN lock; -+ } set_lock; -+ struct { -+ enum bus_query_id_type id_type; -+ } query_id; -+ struct { -+ enum device_text_type device_text_type; -+ ULONG POINTER_ALIGN locale_id; -+ } query_device_text; -+ struct { -+ BOOLEAN in_path; -+ BOOLEAN reserved[3]; -+ enum device_usage_notification_type POINTER_ALIGN type; -+ } usage_notification; -+ struct { -+ enum system_power_state power_state; -+ } wait_wake; -+ struct { -+ void *power_sequence; -+ } power_sequence; -+ struct { -+ ULONG sys_context; -+ enum power_state_type POINTER_ALIGN type; -+ union power_state POINTER_ALIGN state; -+ enum power_action POINTER_ALIGN shutdown_type; -+ } power; -+ struct { -+ struct cm_resource_list *allocated_resources; -+ struct cm_resource_list *allocated_resources_translated; -+ } start_device; -+ struct { -+ ULONG_PTR provider_id; -+ void *data_path; -+ ULONG buf_len; -+ void *buf; -+ } wmi; -+ struct { -+ void *arg1; -+ void *arg2; -+ void *arg3; -+ void *arg4; -+ } others; -+ } params; -+ struct device_object *dev_obj; -+ struct file_object *file_obj; -+ NTSTATUS (*completion_routine)(struct device_object *, -+ struct irp *, void *) wstdcall; -+ void *context; -+}; -+#ifndef CONFIG_X86_64 -+#pragma pack(pop) -+#endif -+ -+struct kapc { -+ CSHORT type; -+ CSHORT size; -+ ULONG spare0; -+ struct nt_thread *thread; -+ struct nt_list list; -+ void *kernele_routine; -+ void *rundown_routine; -+ void *normal_routine; -+ void *normal_context; -+ void *sys_arg1; -+ void *sys_arg2; -+ CCHAR apc_state_index; -+ KPROCESSOR_MODE apc_mode; -+ BOOLEAN inserted; -+}; -+ -+#define IRP_NOCACHE 0x00000001 -+#define IRP_SYNCHRONOUS_API 0x00000004 -+#define IRP_ASSOCIATED_IRP 0x00000008 -+ -+enum urb_state { -+ URB_INVALID = 1, URB_ALLOCATED, URB_SUBMITTED, -+ URB_COMPLETED, URB_FREE, URB_SUSPEND, URB_INT_UNLINKED }; -+ -+struct wrap_urb { -+ struct nt_list list; -+ enum urb_state state; -+ struct nt_list complete_list; -+ unsigned int flags; -+ struct urb *urb; -+ struct irp *irp; -+#ifdef USB_DEBUG -+ unsigned int id; -+#endif -+}; -+ -+struct irp { -+ SHORT type; -+ USHORT size; -+ struct mdl *mdl; -+ ULONG flags; -+ union { -+ struct irp *master_irp; -+ LONG irp_count; -+ void *system_buffer; -+ } associated_irp; -+ struct nt_list thread_list; -+ struct io_status_block io_status; -+ KPROCESSOR_MODE requestor_mode; -+ BOOLEAN pending_returned; -+ CHAR stack_count; -+ CHAR current_location; -+ BOOLEAN cancel; -+ KIRQL cancel_irql; -+ CCHAR apc_env; -+ UCHAR alloc_flags; -+ struct io_status_block *user_status; -+ struct nt_event *user_event; -+ union { -+ struct { -+ void *user_apc_routine; -+ void *user_apc_context; -+ } async_params; -+ LARGE_INTEGER alloc_size; -+ } overlay; -+ void (*cancel_routine)(struct device_object *, struct irp *) wstdcall; -+ void *user_buf; -+ union { -+ struct { -+ union { -+ struct kdevice_queue_entry dev_q_entry; -+ struct { -+ void *driver_context[4]; -+ }; -+ }; -+ void *thread; -+ char *aux_buf; -+ struct { -+ struct nt_list list; -+ union { -+ struct io_stack_location *csl; -+ ULONG packet_type; -+ }; -+ }; -+ struct file_object *file_object; -+ } overlay; -+ union { -+ struct kapc apc; -+ /* space for apc is used for ndiswrapper -+ * specific fields */ -+ struct { -+ struct wrap_urb *wrap_urb; -+ struct wrap_device *wrap_device; -+ }; -+ }; -+ void *completion_key; -+ } tail; -+}; -+ -+#define IoSizeOfIrp(stack_count) \ -+ ((USHORT)(sizeof(struct irp) + \ -+ ((stack_count) * sizeof(struct io_stack_location)))) -+#define IoGetCurrentIrpStackLocation(irp) \ -+ (irp)->tail.overlay.csl -+#define IoGetNextIrpStackLocation(irp) \ -+ (IoGetCurrentIrpStackLocation(irp) - 1) -+#define IoGetPreviousIrpStackLocation(irp) \ -+ (IoGetCurrentIrpStackLocation(irp) + 1) -+ -+#define IoSetNextIrpStackLocation(irp) \ -+do { \ -+ KIRQL _irql_; \ -+ IoAcquireCancelSpinLock(&_irql_); \ -+ (irp)->current_location--; \ -+ IoGetCurrentIrpStackLocation(irp)--; \ -+ IoReleaseCancelSpinLock(_irql_); \ -+} while (0) -+ -+#define IoSkipCurrentIrpStackLocation(irp) \ -+do { \ -+ KIRQL _irql_; \ -+ IoAcquireCancelSpinLock(&_irql_); \ -+ (irp)->current_location++; \ -+ IoGetCurrentIrpStackLocation(irp)++; \ -+ IoReleaseCancelSpinLock(_irql_); \ -+} while (0) -+ -+static inline void -+IoCopyCurrentIrpStackLocationToNext(struct irp *irp) -+{ -+ struct io_stack_location *next; -+ next = IoGetNextIrpStackLocation(irp); -+ memcpy(next, IoGetCurrentIrpStackLocation(irp), -+ offsetof(struct io_stack_location, completion_routine)); -+ next->control = 0; -+} -+ -+static inline void -+IoSetCompletionRoutine(struct irp *irp, void *routine, void *context, -+ BOOLEAN success, BOOLEAN error, BOOLEAN cancel) -+{ -+ struct io_stack_location *irp_sl = IoGetNextIrpStackLocation(irp); -+ irp_sl->completion_routine = routine; -+ irp_sl->context = context; -+ irp_sl->control = 0; -+ if (success) -+ irp_sl->control |= SL_INVOKE_ON_SUCCESS; -+ if (error) -+ irp_sl->control |= SL_INVOKE_ON_ERROR; -+ if (cancel) -+ irp_sl->control |= SL_INVOKE_ON_CANCEL; -+} -+ -+#define IoMarkIrpPending(irp) \ -+ (IoGetCurrentIrpStackLocation((irp))->control |= SL_PENDING_RETURNED) -+#define IoUnmarkIrpPending(irp) \ -+ (IoGetCurrentIrpStackLocation((irp))->control &= ~SL_PENDING_RETURNED) -+ -+#define IRP_SL(irp, n) (((struct io_stack_location *)((irp) + 1)) + (n)) -+#define IRP_DRIVER_CONTEXT(irp) (irp)->tail.overlay.driver_context -+#define IoIrpThread(irp) ((irp)->tail.overlay.thread) -+ -+#define IRP_URB(irp) \ -+ (union nt_urb *)(IoGetCurrentIrpStackLocation(irp)->params.others.arg1) -+ -+#define IRP_WRAP_DEVICE(irp) (irp)->tail.wrap_device -+#define IRP_WRAP_URB(irp) (irp)->tail.wrap_urb -+ -+struct wmi_guid_reg_info { -+ struct guid *guid; -+ ULONG instance_count; -+ ULONG flags; -+}; -+ -+struct wmilib_context { -+ ULONG guid_count; -+ struct wmi_guid_reg_info *guid_list; -+ void *query_wmi_reg_info; -+ void *query_wmi_data_block; -+ void *set_wmi_data_block; -+ void *set_wmi_data_item; -+ void *execute_wmi_method; -+ void *wmi_function_control; -+}; -+ -+enum key_value_information_class { -+ KeyValueBasicInformation, KeyValueFullInformation, -+ KeyValuePartialInformation, KeyValueFullInformationAlign64, -+ KeyValuePartialInformationAlign64 -+}; -+ -+struct file_name_info { -+ ULONG length; -+ wchar_t *name; -+}; -+ -+struct file_std_info { -+ LARGE_INTEGER alloc_size; -+ LARGE_INTEGER eof; -+ ULONG num_links; -+ BOOLEAN delete_pending; -+ BOOLEAN dir; -+}; -+ -+enum nt_obj_type { -+ NT_OBJ_EVENT = 10, NT_OBJ_MUTEX, NT_OBJ_THREAD, NT_OBJ_TIMER, -+ NT_OBJ_SEMAPHORE, -+}; -+ -+enum common_object_type { -+ OBJECT_TYPE_NONE, OBJECT_TYPE_DEVICE, OBJECT_TYPE_DRIVER, -+ OBJECT_TYPE_NT_THREAD, OBJECT_TYPE_FILE, OBJECT_TYPE_CALLBACK, -+}; -+ -+struct common_object_header { -+ struct nt_list list; -+ enum common_object_type type; -+ UINT size; -+ UINT ref_count; -+ BOOLEAN close_in_process; -+ BOOLEAN permanent; -+ struct unicode_string name; -+}; -+ -+#define OBJECT_TO_HEADER(object) \ -+ (struct common_object_header *)((void *)(object) - \ -+ sizeof(struct common_object_header)) -+#define OBJECT_SIZE(size) \ -+ ((size) + sizeof(struct common_object_header)) -+#define HEADER_TO_OBJECT(hdr) \ -+ ((void *)(hdr) + sizeof(struct common_object_header)) -+#define HANDLE_TO_OBJECT(handle) HEADER_TO_OBJECT(handle) -+#define HANDLE_TO_HEADER(handle) (handle) -+ -+enum work_queue_type { -+ CriticalWorkQueue, DelayedWorkQueue, HyperCriticalWorkQueue, -+ MaximumWorkQueue -+}; -+ -+typedef void (*NTOS_WORK_FUNC)(void *arg1, void *arg2) wstdcall; -+ -+struct io_workitem { -+ enum work_queue_type type; -+ struct device_object *dev_obj; -+ NTOS_WORK_FUNC worker_routine; -+ void *context; -+}; -+ -+struct io_workitem_entry { -+ struct nt_list list; -+ struct io_workitem *io_workitem; -+}; -+ -+enum mm_page_priority { -+ LowPagePriority, NormalPagePriority = 16, HighPagePriority = 32 -+}; -+ -+enum kinterrupt_mode { -+ LevelSensitive, Latched -+}; -+ -+enum ntos_wait_reason { -+ Executive, FreePage, PageIn, PoolAllocation, DelayExecution, -+ Suspended, UserRequest, WrExecutive, WrFreePage, WrPageIn, -+ WrPoolAllocation, WrDelayExecution, WrSuspended, WrUserRequest, -+ WrEventPair, WrQueue, WrLpcReceive, WrLpcReply, WrVirtualMemory, -+ WrPageOut, WrRendezvous, Spare2, Spare3, Spare4, Spare5, Spare6, -+ WrKernel, MaximumWaitReason -+}; -+ -+typedef enum ntos_wait_reason KWAIT_REASON; -+ -+typedef void *LOOKASIDE_ALLOC_FUNC(enum pool_type pool_type, -+ SIZE_T size, ULONG tag) wstdcall; -+typedef void LOOKASIDE_FREE_FUNC(void *) wstdcall; -+ -+struct npaged_lookaside_list { -+ nt_slist_header head; -+ USHORT depth; -+ USHORT maxdepth; -+ ULONG totalallocs; -+ union { -+ ULONG allocmisses; -+ ULONG allochits; -+ } u1; -+ ULONG totalfrees; -+ union { -+ ULONG freemisses; -+ ULONG freehits; -+ } u2; -+ enum pool_type pool_type; -+ ULONG tag; -+ ULONG size; -+ LOOKASIDE_ALLOC_FUNC *alloc_func; -+ LOOKASIDE_FREE_FUNC *free_func; -+ struct nt_list list; -+ ULONG lasttotallocs; -+ union { -+ ULONG lastallocmisses; -+ ULONG lastallochits; -+ } u3; -+ ULONG pad[2]; -+#ifndef CONFIG_X86_64 -+ NT_SPIN_LOCK obsolete; -+#endif -+} -+#ifdef CONFIG_X86_64 -+CACHE_ALIGN -+#endif -+; -+ -+enum device_registry_property { -+ DevicePropertyDeviceDescription, DevicePropertyHardwareID, -+ DevicePropertyCompatibleIDs, DevicePropertyBootConfiguration, -+ DevicePropertyBootConfigurationTranslated, -+ DevicePropertyClassName, DevicePropertyClassGuid, -+ DevicePropertyDriverKeyName, DevicePropertyManufacturer, -+ DevicePropertyFriendlyName, DevicePropertyLocationInformation, -+ DevicePropertyPhysicalDeviceObjectName, DevicePropertyBusTypeGuid, -+ DevicePropertyLegacyBusType, DevicePropertyBusNumber, -+ DevicePropertyEnumeratorName, DevicePropertyAddress, -+ DevicePropertyUINumber, DevicePropertyInstallState, -+ DevicePropertyRemovalPolicy -+}; -+ -+enum trace_information_class { -+ TraceIdClass, TraceHandleClass, TraceEnableFlagsClass, -+ TraceEnableLevelClass, GlobalLoggerHandleClass, EventLoggerHandleClass, -+ AllLoggerHandlesClass, TraceHandleByNameClass -+}; -+ -+struct kinterrupt; -+typedef BOOLEAN (*PKSERVICE_ROUTINE)(struct kinterrupt *interrupt, -+ void *context) wstdcall; -+typedef BOOLEAN (*PKSYNCHRONIZE_ROUTINE)(void *context) wstdcall; -+ -+struct kinterrupt { -+ ULONG vector; -+ KAFFINITY cpu_mask; -+ NT_SPIN_LOCK lock; -+ NT_SPIN_LOCK *actual_lock; -+ BOOLEAN shared; -+ BOOLEAN save_fp; -+ union { -+ CHAR processor_number; -+#ifdef CONFIG_DEBUG_SHIRQ -+ CHAR enabled; -+#endif -+ } u; -+ PKSERVICE_ROUTINE isr; -+ void *isr_ctx; -+ struct nt_list list; -+ KIRQL irql; -+ KIRQL synch_irql; -+ enum kinterrupt_mode mode; -+}; -+ -+struct time_fields { -+ CSHORT year; -+ CSHORT month; -+ CSHORT day; -+ CSHORT hour; -+ CSHORT minute; -+ CSHORT second; -+ CSHORT milliseconds; -+ CSHORT weekday; -+}; -+ -+struct object_attributes { -+ ULONG length; -+ void *root_dir; -+ struct unicode_string *name; -+ ULONG attributes; -+ void *security_descr; -+ void *security_qos; -+}; -+ -+typedef void (*PCALLBACK_FUNCTION)(void *context, void *arg1, -+ void *arg2) wstdcall; -+ -+struct callback_object; -+struct callback_func { -+ PCALLBACK_FUNCTION func; -+ void *context; -+ struct nt_list list; -+ struct callback_object *object; -+}; -+ -+struct callback_object { -+ NT_SPIN_LOCK lock; -+ struct nt_list list; -+ struct nt_list callback_funcs; -+ BOOLEAN allow_multiple_callbacks; -+ struct object_attributes *attributes; -+}; -+ -+enum section_inherit { -+ ViewShare = 1, ViewUnmap = 2 -+}; -+ -+struct ksystem_time { -+ ULONG low_part; -+ LONG high1_time; -+ LONG high2_time; -+}; -+ -+enum nt_product_type { -+ nt_product_win_nt = 1, nt_product_lan_man_nt, nt_product_server -+}; -+ -+enum alt_arch_type { -+ arch_type_standard, arch_type_nex98x86, end_alternatives -+}; -+ -+struct kuser_shared_data { -+ ULONG tick_count; -+ ULONG tick_count_multiplier; -+ volatile struct ksystem_time interrupt_time; -+ volatile struct ksystem_time system_time; -+ volatile struct ksystem_time time_zone_bias; -+ USHORT image_number_low; -+ USHORT image_number_high; -+ wchar_t nt_system_root[260]; -+ ULONG max_stack_trace_depth; -+ ULONG crypto_exponent; -+ ULONG time_zone_id; -+ ULONG large_page_min; -+ ULONG reserved2[7]; -+ enum nt_product_type nt_product_type; -+ BOOLEAN product_type_is_valid; -+ ULONG nt_major_version; -+ ULONG nt_minor_version; -+ BOOLEAN processor_features[PROCESSOR_FEATURE_MAX]; -+ ULONG reserved1; -+ ULONG reserved3; -+ volatile LONG time_slip; -+ enum alt_arch_type alt_arch_type; -+ LARGE_INTEGER system_expiration_date; -+ ULONG suite_mask; -+ BOOLEAN kdbg_enabled; -+ volatile ULONG active_console; -+ volatile ULONG dismount_count; -+ ULONG com_plus_package; -+ ULONG last_system_rite_event_tick_count; -+ ULONG num_phys_pages; -+ BOOLEAN safe_boot_mode; -+ ULONG trace_log; -+ ULONGLONG fill0; -+ ULONGLONG sys_call[4]; -+ union { -+ volatile struct ksystem_time tick_count; -+ volatile ULONG64 tick_count_quad; -+ } tick; -+}; -+ -+#define REG_NONE (0) -+#define REG_SZ (1) -+#define REG_EXPAND_SZ (2) -+#define REG_BINARY (3) -+#define REG_DWORD (4) -+ -+#define RTL_REGISTRY_ABSOLUTE 0 -+#define RTL_REGISTRY_SERVICES 1 -+#define RTL_REGISTRY_CONTROL 2 -+#define RTL_REGISTRY_WINDOWS_NT 3 -+#define RTL_REGISTRY_DEVICEMAP 4 -+#define RTL_REGISTRY_USER 5 -+#define RTL_REGISTRY_MAXIMUM 6 -+#define RTL_REGISTRY_HANDLE 0x40000000 -+#define RTL_REGISTRY_OPTIONAL 0x80000000 -+ -+#define RTL_QUERY_REGISTRY_SUBKEY 0x00000001 -+#define RTL_QUERY_REGISTRY_TOPKEY 0x00000002 -+#define RTL_QUERY_REGISTRY_REQUIRED 0x00000004 -+#define RTL_QUERY_REGISTRY_NOVALUE 0x00000008 -+#define RTL_QUERY_REGISTRY_NOEXPAND 0x00000010 -+#define RTL_QUERY_REGISTRY_DIRECT 0x00000020 -+#define RTL_QUERY_REGISTRY_DELETE 0x00000040 -+ -+typedef NTSTATUS (*PRTL_QUERY_REGISTRY_ROUTINE)(wchar_t *name, ULONG type, -+ void *data, ULONG length, -+ void *context, -+ void *entry) wstdcall; -+ -+struct rtl_query_registry_table { -+ PRTL_QUERY_REGISTRY_ROUTINE query_func; -+ ULONG flags; -+ wchar_t *name; -+ void *context; -+ ULONG def_type; -+ void *def_data; -+ ULONG def_length; -+}; -+ -+struct io_remove_lock { -+ BOOLEAN removed; -+ BOOLEAN reserved[3]; -+ LONG io_count; -+ struct nt_event remove_event; -+}; -+ -+struct io_error_log_packet { -+ UCHAR major_fn_code; -+ UCHAR retry_count; -+ USHORT dump_data_size; -+ USHORT nr_of_strings; -+ USHORT string_offset; -+ USHORT event_category; -+ NTSTATUS error_code; -+ ULONG unique_error_value; -+ NTSTATUS final_status; -+ ULONG sequence_number; -+ ULONG io_control_code; -+ LARGE_INTEGER device_offset; -+ ULONG dump_data[1]; -+}; -+ -+/* some of the functions below are slightly different from DDK's -+ * implementation; e.g., Insert functions return appropriate -+ * pointer */ -+ -+/* instead of using Linux's lists, we implement list manipulation -+ * functions because nt_list is used by drivers and we don't want to -+ * worry about Linux's list being different from nt_list (right now -+ * they are same, but in future they could be different) */ -+ -+static inline void InitializeListHead(struct nt_list *head) -+{ -+ head->next = head->prev = head; -+} -+ -+static inline BOOLEAN IsListEmpty(struct nt_list *head) -+{ -+ if (head == head->next) -+ return TRUE; -+ else -+ return FALSE; -+} -+ -+static inline void RemoveEntryList(struct nt_list *entry) -+{ -+ entry->prev->next = entry->next; -+ entry->next->prev = entry->prev; -+} -+ -+static inline struct nt_list *RemoveHeadList(struct nt_list *head) -+{ -+ struct nt_list *entry; -+ -+ entry = head->next; -+ if (entry == head) -+ return NULL; -+ else { -+ RemoveEntryList(entry); -+ return entry; -+ } -+} -+ -+static inline struct nt_list *RemoveTailList(struct nt_list *head) -+{ -+ struct nt_list *entry; -+ -+ entry = head->prev; -+ if (entry == head) -+ return NULL; -+ else { -+ RemoveEntryList(entry); -+ return entry; -+ } -+} -+ -+static inline void InsertListEntry(struct nt_list *entry, struct nt_list *prev, -+ struct nt_list *next) -+{ -+ next->prev = entry; -+ entry->next = next; -+ entry->prev = prev; -+ prev->next = entry; -+} -+ -+static inline struct nt_list *InsertHeadList(struct nt_list *head, -+ struct nt_list *entry) -+{ -+ struct nt_list *ret; -+ -+ if (IsListEmpty(head)) -+ ret = NULL; -+ else -+ ret = head->next; -+ -+ InsertListEntry(entry, head, head->next); -+ return ret; -+} -+ -+static inline struct nt_list *InsertTailList(struct nt_list *head, -+ struct nt_list *entry) -+{ -+ struct nt_list *ret; -+ -+ if (IsListEmpty(head)) -+ ret = NULL; -+ else -+ ret = head->prev; -+ -+ InsertListEntry(entry, head->prev, head); -+ return ret; -+} -+ -+#define nt_list_for_each(pos, head) \ -+ for (pos = (head)->next; pos != (head); pos = pos->next) -+ -+#define nt_list_for_each_entry(pos, head, member) \ -+ for (pos = container_of((head)->next, typeof(*pos), member); \ -+ &pos->member != (head); \ -+ pos = container_of(pos->member.next, typeof(*pos), member)) -+ -+#define nt_list_for_each_safe(pos, n, head) \ -+ for (pos = (head)->next, n = pos->next; pos != (head); \ -+ pos = n, n = pos->next) -+ -+/* device object flags */ -+#define DO_VERIFY_VOLUME 0x00000002 -+#define DO_BUFFERED_IO 0x00000004 -+#define DO_EXCLUSIVE 0x00000008 -+#define DO_DIRECT_IO 0x00000010 -+#define DO_MAP_IO_BUFFER 0x00000020 -+#define DO_DEVICE_HAS_NAME 0x00000040 -+#define DO_DEVICE_INITIALIZING 0x00000080 -+#define DO_SYSTEM_BOOT_PARTITION 0x00000100 -+#define DO_LONG_TERM_REQUESTS 0x00000200 -+#define DO_NEVER_LAST_DEVICE 0x00000400 -+#define DO_SHUTDOWN_REGISTERED 0x00000800 -+#define DO_BUS_ENUMERATED_DEVICE 0x00001000 -+#define DO_POWER_PAGABLE 0x00002000 -+#define DO_POWER_INRUSH 0x00004000 -+#define DO_LOW_PRIORITY_FILESYSTEM 0x00010000 -+ -+/* Various supported device types (used with IoCreateDevice()) */ -+ -+#define FILE_DEVICE_BEEP 0x00000001 -+#define FILE_DEVICE_CD_ROM 0x00000002 -+#define FILE_DEVICE_CD_ROM_FILE_SYSTEM 0x00000003 -+#define FILE_DEVICE_CONTROLLER 0x00000004 -+#define FILE_DEVICE_DATALINK 0x00000005 -+#define FILE_DEVICE_DFS 0x00000006 -+#define FILE_DEVICE_DISK 0x00000007 -+#define FILE_DEVICE_DISK_FILE_SYSTEM 0x00000008 -+#define FILE_DEVICE_FILE_SYSTEM 0x00000009 -+#define FILE_DEVICE_INPORT_PORT 0x0000000A -+#define FILE_DEVICE_KEYBOARD 0x0000000B -+#define FILE_DEVICE_MAILSLOT 0x0000000C -+#define FILE_DEVICE_MIDI_IN 0x0000000D -+#define FILE_DEVICE_MIDI_OUT 0x0000000E -+#define FILE_DEVICE_MOUSE 0x0000000F -+#define FILE_DEVICE_MULTI_UNC_PROVIDER 0x00000010 -+#define FILE_DEVICE_NAMED_PIPE 0x00000011 -+#define FILE_DEVICE_NETWORK 0x00000012 -+#define FILE_DEVICE_NETWORK_BROWSER 0x00000013 -+#define FILE_DEVICE_NETWORK_FILE_SYSTEM 0x00000014 -+#define FILE_DEVICE_NULL 0x00000015 -+#define FILE_DEVICE_PARALLEL_PORT 0x00000016 -+#define FILE_DEVICE_PHYSICAL_NETCARD 0x00000017 -+#define FILE_DEVICE_PRINTER 0x00000018 -+#define FILE_DEVICE_SCANNER 0x00000019 -+#define FILE_DEVICE_SERIAL_MOUSE_PORT 0x0000001A -+#define FILE_DEVICE_SERIAL_PORT 0x0000001B -+#define FILE_DEVICE_SCREEN 0x0000001C -+#define FILE_DEVICE_SOUND 0x0000001D -+#define FILE_DEVICE_STREAMS 0x0000001E -+#define FILE_DEVICE_TAPE 0x0000001F -+#define FILE_DEVICE_TAPE_FILE_SYSTEM 0x00000020 -+#define FILE_DEVICE_TRANSPORT 0x00000021 -+#define FILE_DEVICE_UNKNOWN 0x00000022 -+#define FILE_DEVICE_VIDEO 0x00000023 -+#define FILE_DEVICE_VIRTUAL_DISK 0x00000024 -+#define FILE_DEVICE_WAVE_IN 0x00000025 -+#define FILE_DEVICE_WAVE_OUT 0x00000026 -+#define FILE_DEVICE_8042_PORT 0x00000027 -+#define FILE_DEVICE_NETWORK_REDIRECTOR 0x00000028 -+#define FILE_DEVICE_BATTERY 0x00000029 -+#define FILE_DEVICE_BUS_EXTENDER 0x0000002A -+#define FILE_DEVICE_MODEM 0x0000002B -+#define FILE_DEVICE_VDM 0x0000002C -+#define FILE_DEVICE_MASS_STORAGE 0x0000002D -+#define FILE_DEVICE_SMB 0x0000002E -+#define FILE_DEVICE_KS 0x0000002F -+#define FILE_DEVICE_CHANGER 0x00000030 -+#define FILE_DEVICE_SMARTCARD 0x00000031 -+#define FILE_DEVICE_ACPI 0x00000032 -+#define FILE_DEVICE_DVD 0x00000033 -+#define FILE_DEVICE_FULLSCREEN_VIDEO 0x00000034 -+#define FILE_DEVICE_DFS_FILE_SYSTEM 0x00000035 -+#define FILE_DEVICE_DFS_VOLUME 0x00000036 -+#define FILE_DEVICE_SERENUM 0x00000037 -+#define FILE_DEVICE_TERMSRV 0x00000038 -+#define FILE_DEVICE_KSEC 0x00000039 -+#define FILE_DEVICE_FIPS 0x0000003A -+ -+/* Device characteristics */ -+ -+#define FILE_REMOVABLE_MEDIA 0x00000001 -+#define FILE_READ_ONLY_DEVICE 0x00000002 -+#define FILE_FLOPPY_DISKETTE 0x00000004 -+#define FILE_WRITE_ONCE_MEDIA 0x00000008 -+#define FILE_REMOTE_DEVICE 0x00000010 -+#define FILE_DEVICE_IS_MOUNTED 0x00000020 -+#define FILE_VIRTUAL_VOLUME 0x00000040 -+#define FILE_AUTOGENERATED_DEVICE_NAME 0x00000080 -+#define FILE_DEVICE_SECURE_OPEN 0x00000100 -+ -+#define FILE_READ_DATA 0x0001 -+#define FILE_WRITE_DATA 0x0002 -+ -+#define FILE_SUPERSEDED 0x00000000 -+#define FILE_OPENED 0x00000001 -+#define FILE_CREATED 0x00000002 -+#define FILE_OVERWRITTEN 0x00000003 -+#define FILE_EXISTS 0x00000004 -+#define FILE_DOES_NOT_EXIST 0x00000005 -+ -+ -+#endif /* WINNT_TYPES_H */ -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/workqueue.c linux-4.12.4-3rd/3rdparty/ndiswrapper/workqueue.c ---- linux-4.12.4/3rdparty/ndiswrapper/workqueue.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/workqueue.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,279 @@ -+/* -+ * Copyright (C) 2006 Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include "ntoskernel.h" -+ -+struct workqueue_thread { -+ spinlock_t lock; -+ struct task_struct *task; -+ struct completion *completion; -+ char name[16]; -+ int pid; -+ /* whether any work_structs pending? <0 implies quit */ -+ s8 pending; -+ /* list of work_structs pending */ -+ struct list_head work_list; -+}; -+ -+struct workq_thread_data { -+ struct workqueue_struct *workq; -+ int index; -+}; -+ -+struct wrap_workqueue_struct { -+ u8 singlethread; -+ u8 qon; -+ int num_cpus; -+ struct workqueue_thread threads[0]; -+}; -+ -+static void wrap_destroy_wq_on(struct workqueue_struct *workq, int cpu); -+ -+static int workq_thread(void *data) -+{ -+ struct workq_thread_data *thread_data = data; -+ struct workqueue_thread *thread; -+ struct workqueue_struct *workq; -+ struct work_struct *work; -+ -+ workq = thread_data->workq; -+ thread = &workq->threads[thread_data->index]; -+ WORKTRACE("%p, %d, %p", workq, thread_data->index, thread); -+ strncpy(thread->name, current->comm, sizeof(thread->name)); -+ -+ daemonize(thread->name); -+ set_user_nice(current, -5); -+ -+ if (thread->task != current) { -+ WARNING("invalid task: %p, %p", thread->task, current); -+ thread->task = current; -+ } -+ thread->pid = current->pid; -+ complete(xchg(&thread->completion, NULL)); -+ WORKTRACE("%s (%d) started", thread->name, thread->pid); -+ while (1) { -+ if (wait_condition(thread->pending, 0, TASK_INTERRUPTIBLE) < 0) { -+ /* TODO: deal with signal */ -+ WARNING("signal not blocked?"); -+ flush_signals(current); -+ continue; -+ } -+ while (1) { -+ struct list_head *entry; -+ unsigned long flags; -+ -+ spin_lock_irqsave(&thread->lock, flags); -+ if (list_empty(&thread->work_list)) { -+ struct completion *completion; -+ if (thread->pending < 0) { -+ spin_unlock_irqrestore(&thread->lock, -+ flags); -+ goto out; -+ } -+ thread->pending = 0; -+ completion = thread->completion; -+ thread->completion = NULL; -+ spin_unlock_irqrestore(&thread->lock, flags); -+ if (completion) -+ complete(completion); -+ break; -+ } -+ entry = thread->work_list.next; -+ work = list_entry(entry, struct work_struct, list); -+ if (xchg(&work->thread, NULL)) -+ list_del(entry); -+ else -+ work = NULL; -+ spin_unlock_irqrestore(&thread->lock, flags); -+ DBG_BLOCK(4) { -+ WORKTRACE("%p, %p", work, thread); -+ } -+ if (work) -+ work->func(work->data); -+ } -+ } -+ -+out: -+ WORKTRACE("%s exiting", thread->name); -+ thread->pid = 0; -+ return 0; -+} -+ -+static int wrap_queue_work_on(struct workqueue_struct *workq, -+ struct work_struct *work, int cpu) -+{ -+ struct workqueue_thread *thread = &workq->threads[cpu]; -+ unsigned long flags; -+ int ret; -+ -+ assert(thread->pid > 0); -+ DBG_BLOCK(4) { -+ WORKTRACE("%p, %d", workq, cpu); -+ } -+ spin_lock_irqsave(&thread->lock, flags); -+ if (work->thread) -+ ret = 0; -+ else { -+ work->thread = thread; -+ list_add_tail(&work->list, &thread->work_list); -+ thread->pending = 1; -+ wake_up_process(thread->task); -+ ret = 1; -+ } -+ spin_unlock_irqrestore(&thread->lock, flags); -+ return ret; -+} -+ -+int wrap_queue_work(struct workqueue_struct *workq, struct work_struct *work) -+{ -+ if (num_online_cpus() == 1 || workq->singlethread) -+ return wrap_queue_work_on(workq, work, 0); -+ else { -+ typeof(workq->qon) qon; -+ /* work is queued on threads in a round-robin fashion */ -+ do { -+ qon = workq->qon % workq->num_cpus; -+ atomic_inc_var(workq->qon); -+ } while (!workq->threads[qon].pid); -+ return wrap_queue_work_on(workq, work, qon); -+ } -+} -+ -+void wrap_cancel_work(struct work_struct *work) -+{ -+ struct workqueue_thread *thread; -+ unsigned long flags; -+ -+ WORKTRACE("%p", work); -+ if ((thread = xchg(&work->thread, NULL))) { -+ WORKTRACE("%p", thread); -+ spin_lock_irqsave(&thread->lock, flags); -+ list_del(&work->list); -+ spin_unlock_irqrestore(&thread->lock, flags); -+ } -+} -+ -+struct workqueue_struct *wrap_create_wq(const char *name, u8 singlethread, -+ u8 freeze) -+{ -+ struct completion started; -+ struct workqueue_struct *workq; -+ int i, n; -+ -+ if (singlethread) -+ n = 1; -+ else -+ n = num_online_cpus(); -+ workq = kzalloc(sizeof(*workq) + n * sizeof(workq->threads[0]), -+ GFP_KERNEL); -+ if (!workq) { -+ WARNING("couldn't allocate memory"); -+ return NULL; -+ } -+ WORKTRACE("%p", workq); -+ workq->singlethread = singlethread; -+ init_completion(&started); -+ for_each_online_cpu(i) { -+ struct workq_thread_data thread_data; -+ spin_lock_init(&workq->threads[i].lock); -+ INIT_LIST_HEAD(&workq->threads[i].work_list); -+ reinit_completion(&started); -+ workq->threads[i].completion = &started; -+ thread_data.workq = workq; -+ thread_data.index = i; -+ WORKTRACE("%p, %d, %p", workq, i, &workq->threads[i]); -+ workq->threads[i].task = -+ kthread_create(workq_thread, &thread_data, -+ "%s/%d", name, i); -+ if (IS_ERR(workq->threads[i].task)) { -+ int j; -+ for (j = 0; j < i; j++) -+ wrap_destroy_wq_on(workq, j); -+ kfree(workq); -+ WARNING("couldn't start thread %s", name); -+ return NULL; -+ } -+#ifdef PF_NOFREEZE -+ if (!freeze) -+ workq->threads[i].task->flags |= PF_NOFREEZE; -+#endif -+ kthread_bind(workq->threads[i].task, i); -+ workq->num_cpus = max(workq->num_cpus, i); -+ wake_up_process(workq->threads[i].task); -+ wait_for_completion(&started); -+ WORKTRACE("%s, %d: %p, %d", name, i, -+ workq, workq->threads[i].pid); -+ if (singlethread) -+ break; -+ } -+ workq->num_cpus++; -+ return workq; -+} -+ -+static void wrap_flush_wq_on(struct workqueue_struct *workq, int cpu) -+{ -+ struct workqueue_thread *thread = &workq->threads[cpu]; -+ struct completion done; -+ -+ WORKTRACE("%p: %d, %s", workq, cpu, thread->name); -+ init_completion(&done); -+ thread->completion = &done; -+ thread->pending = 1; -+ wake_up_process(thread->task); -+ wait_for_completion(&done); -+ return; -+} -+ -+void wrap_flush_wq(struct workqueue_struct *workq) -+{ -+ int i, n; -+ -+ WORKTRACE("%p", workq); -+ if (workq->singlethread) -+ n = 1; -+ else -+ n = num_online_cpus(); -+ for (i = 0; i < n; i++) -+ wrap_flush_wq_on(workq, i); -+} -+ -+static void wrap_destroy_wq_on(struct workqueue_struct *workq, int cpu) -+{ -+ struct workqueue_thread *thread = &workq->threads[cpu]; -+ -+ WORKTRACE("%p: %d, %s", workq, cpu, thread->name); -+ if (!thread->pid) -+ return; -+ thread->pending = -1; -+ wake_up_process(thread->task); -+ while (thread->pid) { -+ WORKTRACE("%d", thread->pid); -+ schedule(); -+ } -+} -+ -+void wrap_destroy_wq(struct workqueue_struct *workq) -+{ -+ int i, n; -+ -+ WORKTRACE("%p", workq); -+ if (workq->singlethread) -+ n = 1; -+ else -+ n = num_online_cpus(); -+ for (i = 0; i < n; i++) -+ wrap_destroy_wq_on(workq, i); -+ kfree(workq); -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/wrapmem.c linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapmem.c ---- linux-4.12.4/3rdparty/ndiswrapper/wrapmem.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapmem.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,366 @@ -+/* -+ * Copyright (C) 2006 Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#define _WRAPMEM_C_ -+ -+#include "ntoskernel.h" -+#include "wrapmem.h" -+ -+struct slack_alloc_info { -+ struct nt_list list; -+ size_t size; -+}; -+ -+#if ALLOC_DEBUG > 1 -+static struct nt_list allocs; -+#endif -+ -+static struct nt_list slack_allocs; -+static spinlock_t alloc_lock; -+ -+#if ALLOC_DEBUG -+const char *alloc_type_name[ALLOC_TYPE_MAX] = { -+ "kmalloc_atomic", -+ "kmalloc_nonatomic", -+ "vmalloc_atomic", -+ "vmalloc_nonatomic", -+ "kmalloc_slack", -+ "pages" -+}; -+ -+struct alloc_info { -+ enum alloc_type type; -+ size_t size; -+#if ALLOC_DEBUG > 1 -+ struct nt_list list; -+ const char *file; -+ int line; -+ ULONG tag; -+#endif -+}; -+ -+static atomic_t alloc_sizes[ALLOC_TYPE_MAX]; -+#endif -+ -+/* allocate memory and add it to list of allocated pointers; if a -+ * driver doesn't free this memory for any reason (buggy driver or we -+ * allocate space behind driver's back since we need more space than -+ * corresponding Windows structure provides etc.), this gets freed -+ * automatically when module is unloaded -+ */ -+void *slack_kmalloc(size_t size) -+{ -+ struct slack_alloc_info *info; -+ -+ ENTER4("size = %zu", size); -+ info = kmalloc(size + sizeof(*info), irql_gfp()); -+ if (!info) -+ return NULL; -+ info->size = size; -+ spin_lock_bh(&alloc_lock); -+ InsertTailList(&slack_allocs, &info->list); -+ spin_unlock_bh(&alloc_lock); -+#if ALLOC_DEBUG -+ atomic_add(size, &alloc_sizes[ALLOC_TYPE_SLACK]); -+#endif -+ TRACE4("%p, %p", info, info + 1); -+ EXIT4(return info + 1); -+} -+ -+/* free pointer and remove from list of allocated pointers */ -+void slack_kfree(void *ptr) -+{ -+ struct slack_alloc_info *info; -+ -+ ENTER4("%p", ptr); -+ info = ptr - sizeof(*info); -+ spin_lock_bh(&alloc_lock); -+ RemoveEntryList(&info->list); -+ spin_unlock_bh(&alloc_lock); -+#if ALLOC_DEBUG -+ atomic_sub(info->size, &alloc_sizes[ALLOC_TYPE_SLACK]); -+#endif -+ kfree(info); -+ EXIT4(return); -+} -+ -+void *slack_kzalloc(size_t size) -+{ -+ void *ptr = slack_kmalloc(size); -+ if (ptr) -+ memset(ptr, 0, size); -+ return ptr; -+} -+ -+#if ALLOC_DEBUG -+void *wrap_kmalloc(size_t size, gfp_t flags, const char *file, int line) -+{ -+ struct alloc_info *info; -+ -+ info = kmalloc(size + sizeof(*info), flags); -+ if (!info) -+ return NULL; -+ if (flags & GFP_ATOMIC) -+ info->type = ALLOC_TYPE_KMALLOC_ATOMIC; -+ else -+ info->type = ALLOC_TYPE_KMALLOC_NON_ATOMIC; -+ info->size = size; -+ atomic_add(size, &alloc_sizes[info->type]); -+#if ALLOC_DEBUG > 1 -+ info->file = file; -+ info->line = line; -+ info->tag = 0; -+ spin_lock_bh(&alloc_lock); -+ InsertTailList(&allocs, &info->list); -+ spin_unlock_bh(&alloc_lock); -+#endif -+ TRACE4("%p", info + 1); -+ return info + 1; -+} -+ -+void *wrap_kzalloc(size_t size, gfp_t flags, const char *file, int line) -+{ -+ void *ptr = wrap_kmalloc(size, flags, file, line); -+ if (ptr) -+ memset(ptr, 0, size); -+ return ptr; -+} -+ -+void wrap_kfree(void *ptr) -+{ -+ struct alloc_info *info; -+ -+ TRACE4("%p", ptr); -+ if (!ptr) -+ return; -+ info = ptr - sizeof(*info); -+ atomic_sub(info->size, &alloc_sizes[info->type]); -+#if ALLOC_DEBUG > 1 -+ spin_lock_bh(&alloc_lock); -+ RemoveEntryList(&info->list); -+ spin_unlock_bh(&alloc_lock); -+ if (!(info->type == ALLOC_TYPE_KMALLOC_ATOMIC || -+ info->type == ALLOC_TYPE_KMALLOC_NON_ATOMIC)) { -+ WARNING("invalid type: %d", info->type); -+ return; -+ } -+#endif -+ kfree(info); -+} -+ -+void *wrap_vmalloc(unsigned long size, const char *file, int line) -+{ -+ struct alloc_info *info; -+ -+ info = vmalloc(size + sizeof(*info)); -+ if (!info) -+ return NULL; -+ info->type = ALLOC_TYPE_VMALLOC_NON_ATOMIC; -+ info->size = size; -+ atomic_add(size, &alloc_sizes[info->type]); -+#if ALLOC_DEBUG > 1 -+ info->file = file; -+ info->line = line; -+ info->tag = 0; -+ spin_lock_bh(&alloc_lock); -+ InsertTailList(&allocs, &info->list); -+ spin_unlock_bh(&alloc_lock); -+#endif -+ return info + 1; -+} -+ -+void *wrap__vmalloc(unsigned long size, gfp_t gfp_mask, pgprot_t prot, -+ const char *file, int line) -+{ -+ struct alloc_info *info; -+ -+ info = __vmalloc(size + sizeof(*info), gfp_mask, prot); -+ if (!info) -+ return NULL; -+ if (gfp_mask & GFP_ATOMIC) -+ info->type = ALLOC_TYPE_VMALLOC_ATOMIC; -+ else -+ info->type = ALLOC_TYPE_VMALLOC_NON_ATOMIC; -+ info->size = size; -+ atomic_add(size, &alloc_sizes[info->type]); -+#if ALLOC_DEBUG > 1 -+ info->file = file; -+ info->line = line; -+ info->tag = 0; -+ spin_lock_bh(&alloc_lock); -+ InsertTailList(&allocs, &info->list); -+ spin_unlock_bh(&alloc_lock); -+#endif -+ return info + 1; -+} -+ -+void wrap_vfree(void *ptr) -+{ -+ struct alloc_info *info; -+ -+ info = ptr - sizeof(*info); -+ atomic_sub(info->size, &alloc_sizes[info->type]); -+#if ALLOC_DEBUG > 1 -+ spin_lock_bh(&alloc_lock); -+ RemoveEntryList(&info->list); -+ spin_unlock_bh(&alloc_lock); -+ if (!(info->type == ALLOC_TYPE_VMALLOC_ATOMIC || -+ info->type == ALLOC_TYPE_VMALLOC_NON_ATOMIC)) { -+ WARNING("invalid type: %d", info->type); -+ return; -+ } -+#endif -+ vfree(info); -+} -+ -+void *wrap_alloc_pages(gfp_t flags, unsigned int size, -+ const char *file, int line) -+{ -+ struct alloc_info *info; -+ -+ size += sizeof(*info); -+ info = (struct alloc_info *)__get_free_pages(flags, get_order(size)); -+ if (!info) -+ return NULL; -+ info->type = ALLOC_TYPE_PAGES; -+ info->size = size; -+ atomic_add(size, &alloc_sizes[info->type]); -+#if ALLOC_DEBUG > 1 -+ info->file = file; -+ info->line = line; -+ info->tag = 0; -+ spin_lock_bh(&alloc_lock); -+ InsertTailList(&allocs, &info->list); -+ spin_unlock_bh(&alloc_lock); -+#endif -+ return info + 1; -+} -+ -+void wrap_free_pages(unsigned long ptr, int order) -+{ -+ struct alloc_info *info; -+ -+ info = (void *)ptr - sizeof(*info); -+ atomic_sub(info->size, &alloc_sizes[info->type]); -+#if ALLOC_DEBUG > 1 -+ spin_lock_bh(&alloc_lock); -+ RemoveEntryList(&info->list); -+ spin_unlock_bh(&alloc_lock); -+ if (info->type != ALLOC_TYPE_PAGES) { -+ WARNING("invalid type: %d", info->type); -+ return; -+ } -+#endif -+ free_pages((unsigned long)info, get_order(info->size)); -+} -+ -+#if ALLOC_DEBUG > 1 -+void *wrap_ExAllocatePoolWithTag(enum pool_type pool_type, SIZE_T size, -+ ULONG tag, const char *file, int line) -+{ -+ void *addr; -+ struct alloc_info *info; -+ -+ ENTER4("pool_type: %d, size: %zu, tag: %u", pool_type, size, tag); -+ addr = (ExAllocatePoolWithTag)(pool_type, size, tag); -+ if (!addr) -+ return NULL; -+ info = addr - sizeof(*info); -+ info->file = file; -+ info->line = line; -+ info->tag = tag; -+ EXIT4(return addr); -+} -+#endif -+ -+int alloc_size(enum alloc_type type) -+{ -+ if ((int)type >= 0 && type < ALLOC_TYPE_MAX) -+ return atomic_read(&alloc_sizes[type]); -+ else -+ return -EINVAL; -+} -+ -+#endif // ALLOC_DEBUG -+ -+int wrapmem_init(void) -+{ -+#if ALLOC_DEBUG > 1 -+ InitializeListHead(&allocs); -+#endif -+ InitializeListHead(&slack_allocs); -+ spin_lock_init(&alloc_lock); -+ return 0; -+} -+ -+void wrapmem_exit(void) -+{ -+#if ALLOC_DEBUG -+ enum alloc_type type; -+#endif -+ struct nt_list *ent; -+ -+ /* free all pointers on the slack list */ -+ while (1) { -+ struct slack_alloc_info *info; -+ spin_lock_bh(&alloc_lock); -+ ent = RemoveHeadList(&slack_allocs); -+ spin_unlock_bh(&alloc_lock); -+ if (!ent) -+ break; -+ info = container_of(ent, struct slack_alloc_info, list); -+#if ALLOC_DEBUG -+ atomic_sub(info->size, &alloc_sizes[ALLOC_TYPE_SLACK]); -+#endif -+ kfree(info); -+ } -+#if ALLOC_DEBUG -+ for (type = 0; type < ALLOC_TYPE_MAX; type++) { -+ int n = atomic_read(&alloc_sizes[type]); -+ if (n) -+ WARNING("%d bytes of memory in %s leaking", n, -+ alloc_type_name[type]); -+ } -+ -+#if ALLOC_DEBUG > 1 -+ while (1) { -+ struct alloc_info *info; -+ -+ spin_lock_bh(&alloc_lock); -+ ent = RemoveHeadList(&allocs); -+ spin_unlock_bh(&alloc_lock); -+ if (!ent) -+ break; -+ info = container_of(ent, struct alloc_info, list); -+ atomic_sub(info->size, &alloc_sizes[ALLOC_TYPE_SLACK]); -+ printk(KERN_DEBUG DRIVER_NAME -+ ": %s:%d leaked %zd bytes at %p (%s, tag 0x%08X)\n", -+ info->file, info->line, info->size, info + 1, -+ alloc_type_name[info->type], info->tag); -+ if (info->type == ALLOC_TYPE_KMALLOC_ATOMIC || -+ info->type == ALLOC_TYPE_KMALLOC_NON_ATOMIC) -+ kfree(info); -+ else if (info->type == ALLOC_TYPE_VMALLOC_ATOMIC || -+ info->type == ALLOC_TYPE_VMALLOC_NON_ATOMIC) -+ vfree(info); -+ else if (info->type == ALLOC_TYPE_PAGES) -+ free_pages((unsigned long)info, get_order(info->size)); -+ else -+ WARNING("invalid type: %d; not freed", info->type); -+ } -+#endif -+#endif -+ return; -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/wrapmem.h linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapmem.h ---- linux-4.12.4/3rdparty/ndiswrapper/wrapmem.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapmem.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,97 @@ -+/* -+ * Copyright (C) 2006 Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifndef _WRAPMEM_H_ -+#define _WRAPMEM_H_ -+ -+/* -+ * Set ALLOC_DEBUG to 1 to show information about memory used by both -+ * ndiswrapper and Windows driver in /proc/net/ndiswrapper/debug -+ * This will also show memory leaks (memory allocated but not freed) when -+ * ndiswrapper module is unloaded. -+ * -+ * Set ALLOC_DEBUG to 2 to see details about every leaking allocation. -+*/ -+ -+#ifndef ALLOC_DEBUG -+#define ALLOC_DEBUG 0 -+#endif -+ -+int wrapmem_init(void); -+void wrapmem_exit(void); -+void *slack_kmalloc(size_t size); -+void *slack_kzalloc(size_t size); -+void slack_kfree(void *ptr); -+ -+#if ALLOC_DEBUG -+enum alloc_type { ALLOC_TYPE_KMALLOC_ATOMIC, -+ ALLOC_TYPE_KMALLOC_NON_ATOMIC, -+ ALLOC_TYPE_VMALLOC_ATOMIC, ALLOC_TYPE_VMALLOC_NON_ATOMIC, -+ ALLOC_TYPE_SLACK, ALLOC_TYPE_PAGES, ALLOC_TYPE_MAX }; -+ -+extern const char *alloc_type_name[ALLOC_TYPE_MAX]; -+ -+void *wrap_kmalloc(size_t size, gfp_t flags, const char *file, int line); -+void *wrap_kzalloc(size_t size, gfp_t flags, const char *file, int line); -+void wrap_kfree(void *ptr); -+void *wrap_vmalloc(unsigned long size, const char *file, int line); -+void *wrap__vmalloc(unsigned long size, gfp_t flags, pgprot_t prot, -+ const char *file, int line); -+void wrap_vfree(void *ptr); -+void *wrap_alloc_pages(gfp_t flags, unsigned int size, -+ const char *file, int line); -+void wrap_free_pages(unsigned long ptr, int order); -+int alloc_size(enum alloc_type type); -+ -+#if ALLOC_DEBUG > 1 -+void *wrap_ExAllocatePoolWithTag(enum pool_type pool_type, SIZE_T size, -+ ULONG tag, const char *file, int line); -+#define ExAllocatePoolWithTag(pool_type, size, tag) \ -+ wrap_ExAllocatePoolWithTag(pool_type, size, tag, __FILE__, __LINE__) -+#endif -+ -+#ifndef _WRAPMEM_C_ -+#undef kmalloc -+#undef kzalloc -+#undef kfree -+#undef vmalloc -+#undef __vmalloc -+#undef vfree -+#define kmalloc(size, flags) \ -+ wrap_kmalloc(size, flags, __FILE__, __LINE__) -+#define kzalloc(size, flags) \ -+ wrap_kzalloc(size, flags, __FILE__, __LINE__) -+#define vmalloc(size) \ -+ wrap_vmalloc(size, __FILE__, __LINE__) -+#define __vmalloc(size, flags, prot) \ -+ wrap__vmalloc(size, flags, prot, __FILE__, __LINE__) -+#define kfree(ptr) wrap_kfree(ptr) -+#define vfree(ptr) wrap_vfree(ptr) -+ -+#define wrap_get_free_pages(flags, size) \ -+ wrap_alloc_pages(flags, size, __FILE__, __LINE__) -+#undef free_pages -+#define free_pages(ptr, order) wrap_free_pages(ptr, order) -+ -+#endif // _WRAPMEM_C_ -+ -+#else -+ -+#define wrap_get_free_pages(flags, size) \ -+ (void *)__get_free_pages(flags, get_order(size)) -+ -+#endif // ALLOC_DEBUG -+ -+#endif -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/wrapndis.c linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapndis.c ---- linux-4.12.4/3rdparty/ndiswrapper/wrapndis.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapndis.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,2186 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include -+#include -+#include -+#include -+#include "ndis.h" -+#include "iw_ndis.h" -+#include "pnp.h" -+#include "loader.h" -+#include "wrapndis.h" -+#include "wrapper.h" -+ -+/* Functions callable from the NDIS driver */ -+wstdcall NTSTATUS NdisDispatchDeviceControl(struct device_object *fdo, -+ struct irp *irp); -+wstdcall NTSTATUS NdisDispatchPnp(struct device_object *fdo, struct irp *irp); -+wstdcall NTSTATUS NdisDispatchPower(struct device_object *fdo, struct irp *irp); -+ -+struct workqueue_struct *wrapndis_wq; -+ -+static int set_packet_filter(struct ndis_device *wnd, -+ ULONG packet_filter); -+static void add_iw_stats_timer(struct ndis_device *wnd); -+static void del_iw_stats_timer(struct ndis_device *wnd); -+static NDIS_STATUS ndis_start_device(struct ndis_device *wnd); -+static int ndis_remove_device(struct ndis_device *wnd); -+static void set_multicast_list(struct ndis_device *wnd); -+static int ndis_net_dev_open(struct net_device *net_dev); -+static int ndis_net_dev_close(struct net_device *net_dev); -+ -+/* MiniportReset */ -+NDIS_STATUS mp_reset(struct ndis_device *wnd) -+{ -+ NDIS_STATUS res; -+ struct miniport *mp; -+ BOOLEAN reset_address; -+ KIRQL irql; -+ -+ ENTER2("wnd: %p", wnd); -+ mutex_lock(&wnd->tx_ring_mutex); -+ mutex_lock(&wnd->ndis_req_mutex); -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ prepare_wait_condition(wnd->ndis_req_task, wnd->ndis_req_done, 0); -+ WARNING("%s is being reset", wnd->net_dev->name); -+ irql = serialize_lock_irql(wnd); -+ assert_irql(_irql_ == DISPATCH_LEVEL); -+ res = LIN2WIN2(mp->reset, &reset_address, wnd->nmb->mp_ctx); -+ serialize_unlock_irql(wnd, irql); -+ -+ TRACE2("%08X, %08X", res, reset_address); -+ if (res == NDIS_STATUS_PENDING) { -+ /* wait for NdisMResetComplete */ -+ if (wait_condition((wnd->ndis_req_done > 0), 0, -+ TASK_INTERRUPTIBLE) < 0) -+ res = NDIS_STATUS_FAILURE; -+ else { -+ res = wnd->ndis_req_status; -+ reset_address = wnd->ndis_req_done - 1; -+ } -+ TRACE2("%08X, %08X", res, reset_address); -+ } -+ mutex_unlock(&wnd->ndis_req_mutex); -+ if (res == NDIS_STATUS_SUCCESS && reset_address) { -+ set_packet_filter(wnd, wnd->packet_filter); -+ set_multicast_list(wnd); -+ } -+ mutex_unlock(&wnd->tx_ring_mutex); -+ EXIT3(return res); -+} -+ -+/* MiniportRequest(Query/Set)Information */ -+NDIS_STATUS mp_request(enum ndis_request_type request, -+ struct ndis_device *wnd, ndis_oid oid, -+ void *buf, ULONG buflen, ULONG *written, ULONG *needed) -+{ -+ NDIS_STATUS res; -+ ULONG w, n; -+ struct miniport *mp; -+ KIRQL irql; -+ -+ mutex_lock(&wnd->ndis_req_mutex); -+ if (!written) -+ written = &w; -+ if (!needed) -+ needed = &n; -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ prepare_wait_condition(wnd->ndis_req_task, wnd->ndis_req_done, 0); -+ irql = serialize_lock_irql(wnd); -+ assert_irql(_irql_ == DISPATCH_LEVEL); -+ switch (request) { -+ case NdisRequestQueryInformation: -+ TRACE2("%p, %08X, %p", mp->queryinfo, oid, wnd->nmb->mp_ctx); -+ res = LIN2WIN6(mp->queryinfo, wnd->nmb->mp_ctx, oid, buf, -+ buflen, written, needed); -+ break; -+ case NdisRequestSetInformation: -+ TRACE2("%p, %08X, %p", mp->setinfo, oid, wnd->nmb->mp_ctx); -+ res = LIN2WIN6(mp->setinfo, wnd->nmb->mp_ctx, oid, buf, -+ buflen, written, needed); -+ break; -+ default: -+ WARNING("invalid request %d, %08X", request, oid); -+ res = NDIS_STATUS_NOT_SUPPORTED; -+ break; -+ } -+ serialize_unlock_irql(wnd, irql); -+ TRACE2("%08X, %08X", res, oid); -+ if (res == NDIS_STATUS_PENDING) { -+ /* wait for NdisMQueryInformationComplete */ -+ if (wait_condition((wnd->ndis_req_done > 0), 0, -+ TASK_INTERRUPTIBLE) < 0) -+ res = NDIS_STATUS_FAILURE; -+ else -+ res = wnd->ndis_req_status; -+ TRACE2("%08X, %08X", res, oid); -+ } -+ mutex_unlock(&wnd->ndis_req_mutex); -+ DBG_BLOCK(2) { -+ if (res || needed) -+ TRACE2("%08X, %d, %d, %d", res, buflen, *written, -+ *needed); -+ } -+ EXIT3(return res); -+} -+ -+/* MiniportPnPEventNotify */ -+static NDIS_STATUS mp_pnp_event(struct ndis_device *wnd, -+ enum ndis_device_pnp_event event, -+ ULONG power_profile) -+{ -+ struct miniport *mp; -+ -+ ENTER1("%p, %d", wnd, event); -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ if (!mp->pnp_event_notify) { -+ TRACE1("Windows driver %s doesn't support " -+ "MiniportPnpEventNotify", wnd->wd->driver->name); -+ return NDIS_STATUS_FAILURE; -+ } -+ /* RNDIS driver doesn't like to be notified if device is -+ * already halted */ -+ if (!test_bit(HW_INITIALIZED, &wnd->wd->hw_status)) -+ EXIT1(return NDIS_STATUS_SUCCESS); -+ switch (event) { -+ case NdisDevicePnPEventSurpriseRemoved: -+ TRACE1("%u, %p", -+ (wnd->attributes & NDIS_ATTRIBUTE_SURPRISE_REMOVE_OK), -+ mp->pnp_event_notify); -+ if ((wnd->attributes & NDIS_ATTRIBUTE_SURPRISE_REMOVE_OK) && -+ !test_bit(HW_DISABLED, &wnd->wd->hw_status) && -+ mp->pnp_event_notify) { -+ TRACE1("calling surprise_removed"); -+ LIN2WIN4(mp->pnp_event_notify, wnd->nmb->mp_ctx, -+ NdisDevicePnPEventSurpriseRemoved, NULL, 0); -+ } else -+ TRACE1("Windows driver %s doesn't support " -+ "MiniportPnpEventNotify for safe unplugging", -+ wnd->wd->driver->name); -+ return NDIS_STATUS_SUCCESS; -+ case NdisDevicePnPEventPowerProfileChanged: -+ if (power_profile) -+ power_profile = NdisPowerProfileAcOnLine; -+ LIN2WIN4(mp->pnp_event_notify, wnd->nmb->mp_ctx, -+ NdisDevicePnPEventPowerProfileChanged, -+ &power_profile, sizeof(power_profile)); -+ return NDIS_STATUS_SUCCESS; -+ default: -+ WARNING("event %d not yet implemented", event); -+ return NDIS_STATUS_SUCCESS; -+ } -+} -+ -+/* MiniportInitialize */ -+static NDIS_STATUS mp_init(struct ndis_device *wnd) -+{ -+ NDIS_STATUS error_status, status; -+ UINT medium_index; -+ enum ndis_medium medium_array[] = {NdisMedium802_3}; -+ struct miniport *mp; -+ -+ ENTER1("irql: %d", current_irql()); -+ if (test_bit(HW_INITIALIZED, &wnd->wd->hw_status)) { -+ WARNING("device %p already initialized!", wnd); -+ return NDIS_STATUS_FAILURE; -+ } -+ -+ if (!wnd->wd->driver->ndis_driver || -+ !wnd->wd->driver->ndis_driver->mp.init) { -+ WARNING("assuming WDM (non-NDIS) driver"); -+ EXIT1(return NDIS_STATUS_NOT_RECOGNIZED); -+ } -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ status = LIN2WIN6(mp->init, &error_status, &medium_index, medium_array, -+ ARRAY_SIZE(medium_array), wnd->nmb, wnd->nmb); -+ TRACE1("init returns: %08X, irql: %d", status, current_irql()); -+ if (status != NDIS_STATUS_SUCCESS) { -+ WARNING("couldn't initialize device: %08X", status); -+ EXIT1(return NDIS_STATUS_FAILURE); -+ } -+ -+ /* Wait a little to let card power up otherwise ifup might -+ * fail after boot */ -+ sleep_hz(HZ / 5); -+ status = mp_pnp_event(wnd, NdisDevicePnPEventPowerProfileChanged, -+ NdisPowerProfileAcOnLine); -+ if (status != NDIS_STATUS_SUCCESS) -+ TRACE1("setting power failed: %08X", status); -+ set_bit(HW_INITIALIZED, &wnd->wd->hw_status); -+ /* the description about NDIS_ATTRIBUTE_NO_HALT_ON_SUSPEND is -+ * misleading/confusing */ -+ status = mp_query(wnd, OID_PNP_CAPABILITIES, -+ &wnd->pnp_capa, sizeof(wnd->pnp_capa)); -+ if (status == NDIS_STATUS_SUCCESS) { -+ TRACE1("%d, %d", wnd->pnp_capa.wakeup.min_magic_packet_wakeup, -+ wnd->pnp_capa.wakeup.min_pattern_wakeup); -+ wnd->attributes |= NDIS_ATTRIBUTE_NO_HALT_ON_SUSPEND; -+ status = mp_query_int(wnd, OID_PNP_ENABLE_WAKE_UP, -+ &wnd->ndis_wolopts); -+ TRACE1("%08X, %x", status, wnd->ndis_wolopts); -+ } else if (status == NDIS_STATUS_NOT_SUPPORTED) -+ wnd->attributes &= ~NDIS_ATTRIBUTE_NO_HALT_ON_SUSPEND; -+ TRACE1("%d", wnd->pnp_capa.wakeup.min_magic_packet_wakeup); -+ /* although some NDIS drivers support suspend, Linux kernel -+ * has issues with suspending USB devices */ -+ if (wrap_is_usb_bus(wnd->wd->dev_bus)) { -+ wnd->attributes &= ~NDIS_ATTRIBUTE_NO_HALT_ON_SUSPEND; -+ wnd->ndis_wolopts = 0; -+ } -+ mp_set_int(wnd, OID_802_11_POWER_MODE, NDIS_POWER_OFF); -+ EXIT1(return NDIS_STATUS_SUCCESS); -+} -+ -+/* MiniportHalt */ -+static void mp_halt(struct ndis_device *wnd) -+{ -+ struct miniport *mp; -+ -+ ENTER1("%p", wnd); -+ if (!test_and_clear_bit(HW_INITIALIZED, &wnd->wd->hw_status)) { -+ WARNING("device %p is not initialized - not halting", wnd); -+ return; -+ } -+ hangcheck_del(wnd); -+ del_iw_stats_timer(wnd); -+#ifdef CONFIG_WIRELESS_EXT -+ if (wnd->physical_medium == NdisPhysicalMediumWirelessLan && -+ wrap_is_pci_bus(wnd->wd->dev_bus)) { -+ mutex_unlock(&wnd->ndis_req_mutex); -+ disassociate(wnd, 0); -+ mutex_lock(&wnd->ndis_req_mutex); -+ } -+#endif -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ TRACE1("halt: %p", mp->mp_halt); -+ LIN2WIN1(mp->mp_halt, wnd->nmb->mp_ctx); -+ /* if a driver doesn't call NdisMDeregisterInterrupt during -+ * halt, deregister it now */ -+ if (wnd->mp_interrupt) -+ NdisMDeregisterInterrupt(wnd->mp_interrupt); -+ /* cancel any timers left by buggy windows driver; also free -+ * the memory for timers */ -+ while (1) { -+ struct nt_slist *slist; -+ struct wrap_timer *wrap_timer; -+ -+ spin_lock_bh(&ntoskernel_lock); -+ if ((slist = wnd->wrap_timer_slist.next)) -+ wnd->wrap_timer_slist.next = slist->next; -+ spin_unlock_bh(&ntoskernel_lock); -+ TIMERTRACE("%p", slist); -+ if (!slist) -+ break; -+ wrap_timer = container_of(slist, struct wrap_timer, slist); -+ wrap_timer->repeat = 0; -+ /* ktimer that this wrap_timer is associated to can't -+ * be touched, as it may have been freed by the driver -+ * already */ -+ if (del_timer_sync(&wrap_timer->timer)) -+ WARNING("Buggy Windows driver left timer %p " -+ "running", wrap_timer->nt_timer); -+ memset(wrap_timer, 0, sizeof(*wrap_timer)); -+ kfree(wrap_timer); -+ } -+ EXIT1(return); -+} -+ -+static NDIS_STATUS mp_set_power_state(struct ndis_device *wnd, -+ enum ndis_power_state state) -+{ -+ NDIS_STATUS status; -+ -+ TRACE1("%d", state); -+ if (state == NdisDeviceStateD0) { -+ status = NDIS_STATUS_SUCCESS; -+ mutex_unlock(&wnd->ndis_req_mutex); -+ if (test_and_clear_bit(HW_HALTED, &wnd->wd->hw_status)) { -+ status = mp_init(wnd); -+ if (status == NDIS_STATUS_SUCCESS) { -+ set_packet_filter(wnd, wnd->packet_filter); -+ set_multicast_list(wnd); -+ } -+ } else if (test_and_clear_bit(HW_SUSPENDED, -+ &wnd->wd->hw_status)) { -+ status = mp_set_int(wnd, OID_PNP_SET_POWER, state); -+ if (status != NDIS_STATUS_SUCCESS) -+ WARNING("%s: setting power to state %d failed? " -+ "%08X", wnd->net_dev->name, state, -+ status); -+ } else -+ return NDIS_STATUS_FAILURE; -+ -+ if (wrap_is_pci_bus(wnd->wd->dev_bus)) { -+ pci_enable_wake(wnd->wd->pci.pdev, PCI_D3hot, 0); -+ pci_enable_wake(wnd->wd->pci.pdev, PCI_D3cold, 0); -+ } -+ if (status == NDIS_STATUS_SUCCESS) { -+ mutex_unlock(&wnd->tx_ring_mutex); -+ netif_device_attach(wnd->net_dev); -+ hangcheck_add(wnd); -+ add_iw_stats_timer(wnd); -+ } else -+ WARNING("%s: couldn't set power to state %d; device not" -+ " resumed", wnd->net_dev->name, state); -+ EXIT1(return status); -+ } else { -+ mutex_lock(&wnd->tx_ring_mutex); -+ netif_device_detach(wnd->net_dev); -+ hangcheck_del(wnd); -+ del_iw_stats_timer(wnd); -+ status = NDIS_STATUS_NOT_SUPPORTED; -+ if (wnd->attributes & NDIS_ATTRIBUTE_NO_HALT_ON_SUSPEND) { -+ status = mp_set_int(wnd, OID_PNP_ENABLE_WAKE_UP, -+ wnd->ndis_wolopts); -+ TRACE2("0x%x, 0x%x", status, wnd->ndis_wolopts); -+ if (status == NDIS_STATUS_SUCCESS && -+ wrap_is_pci_bus(wnd->wd->dev_bus)) { -+ if (wnd->ndis_wolopts) -+ wnd->wd->pci.wake_state = -+ PowerDeviceD3; -+ else -+ wnd->wd->pci.wake_state = -+ PowerDeviceUnspecified; -+ } else -+ WARNING("couldn't set wake-on-lan options: " -+ "0x%x, %08X", wnd->ndis_wolopts, status); -+ status = mp_set_int(wnd, OID_PNP_SET_POWER, state); -+ if (status == NDIS_STATUS_SUCCESS) -+ set_bit(HW_SUSPENDED, &wnd->wd->hw_status); -+ else -+ WARNING("suspend failed: %08X", status); -+ } -+ if (status != NDIS_STATUS_SUCCESS) { -+ WARNING("%s does not support power management; " -+ "halting the device", wnd->net_dev->name); -+ mp_halt(wnd); -+ set_bit(HW_HALTED, &wnd->wd->hw_status); -+ status = STATUS_SUCCESS; -+ } -+ mutex_lock(&wnd->ndis_req_mutex); -+ EXIT1(return status); -+ } -+} -+ -+static int ndis_set_mac_address(struct net_device *dev, void *p) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ struct sockaddr *addr = p; -+ struct ndis_configuration_parameter param; -+ struct unicode_string key; -+ struct ansi_string ansi; -+ NDIS_STATUS res; -+ unsigned char mac_string[2 * ETH_ALEN + 1]; -+ mac_address mac; -+ -+ memcpy(mac, addr->sa_data, sizeof(mac)); -+ memset(mac_string, 0, sizeof(mac_string)); -+ res = snprintf(mac_string, sizeof(mac_string), MACSTR, MAC2STR(mac)); -+ if (res != (sizeof(mac_string) - 1)) -+ EXIT1(return -EINVAL); -+ TRACE1("new mac: %s", mac_string); -+ -+ RtlInitAnsiString(&ansi, mac_string); -+ if (RtlAnsiStringToUnicodeString(¶m.data.string, &ansi, -+ TRUE) != STATUS_SUCCESS) -+ EXIT1(return -EINVAL); -+ -+ param.type = NdisParameterString; -+ RtlInitAnsiString(&ansi, "NetworkAddress"); -+ if (RtlAnsiStringToUnicodeString(&key, &ansi, TRUE) != STATUS_SUCCESS) { -+ RtlFreeUnicodeString(¶m.data.string); -+ EXIT1(return -EINVAL); -+ } -+ NdisWriteConfiguration(&res, wnd->nmb, &key, ¶m); -+ RtlFreeUnicodeString(&key); -+ RtlFreeUnicodeString(¶m.data.string); -+ -+ if (res != NDIS_STATUS_SUCCESS) -+ EXIT1(return -EFAULT); -+ if (ndis_reinit(wnd) == NDIS_STATUS_SUCCESS) { -+ res = mp_query(wnd, OID_802_3_CURRENT_ADDRESS, -+ mac, sizeof(mac)); -+ if (res == NDIS_STATUS_SUCCESS) { -+ TRACE1("mac:" MACSTRSEP, MAC2STR(mac)); -+ memcpy(dev->dev_addr, mac, sizeof(mac)); -+ } else -+ ERROR("couldn't get mac address: %08X", res); -+ } -+ EXIT1(return 0); -+} -+ -+static int setup_tx_sg_list(struct ndis_device *wnd, struct sk_buff *skb, -+ struct ndis_packet_oob_data *oob_data) -+{ -+ struct ndis_sg_element *sg_element; -+ struct ndis_sg_list *sg_list; -+ int i; -+ -+ ENTER3("%p, %d", skb, skb_shinfo(skb)->nr_frags); -+ if (skb_shinfo(skb)->nr_frags <= 1) { -+ sg_element = &oob_data->wrap_tx_sg_list.elements[0]; -+ sg_element->address = -+ PCI_DMA_MAP_SINGLE(wnd->wd->pci.pdev, skb->data, -+ skb->len, PCI_DMA_TODEVICE); -+ sg_element->length = skb->len; -+ oob_data->wrap_tx_sg_list.nent = 1; -+ oob_data->ext.info[ScatterGatherListPacketInfo] = -+ &oob_data->wrap_tx_sg_list; -+ TRACE3("%llx, %u", sg_element->address, sg_element->length); -+ return 0; -+ } -+ sg_list = kmalloc(sizeof(*sg_list) + -+ (skb_shinfo(skb)->nr_frags + 1) * sizeof(*sg_element), -+ GFP_ATOMIC); -+ if (!sg_list) -+ return -ENOMEM; -+ sg_list->nent = skb_shinfo(skb)->nr_frags + 1; -+ TRACE3("%p, %d", sg_list, sg_list->nent); -+ sg_element = sg_list->elements; -+ sg_element->length = skb_headlen(skb); -+ sg_element->address = -+ PCI_DMA_MAP_SINGLE(wnd->wd->pci.pdev, skb->data, -+ skb_headlen(skb), PCI_DMA_TODEVICE); -+ for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) { -+ skb_frag_t *frag = &skb_shinfo(skb)->frags[i]; -+ sg_element++; -+ sg_element->length = frag->size; -+ sg_element->address = -+ pci_map_page(wnd->wd->pci.pdev, skb_frag_page(frag), -+ frag->page_offset, frag->size, -+ PCI_DMA_TODEVICE); -+ TRACE3("%llx, %u", sg_element->address, sg_element->length); -+ } -+ oob_data->ext.info[ScatterGatherListPacketInfo] = sg_list; -+ return 0; -+} -+ -+static void free_tx_sg_list(struct ndis_device *wnd, -+ struct ndis_packet_oob_data *oob_data) -+{ -+ int i; -+ struct ndis_sg_element *sg_element; -+ struct ndis_sg_list *sg_list = -+ oob_data->ext.info[ScatterGatherListPacketInfo]; -+ sg_element = sg_list->elements; -+ TRACE3("%p, %d", sg_list, sg_list->nent); -+ PCI_DMA_UNMAP_SINGLE(wnd->wd->pci.pdev, sg_element->address, -+ sg_element->length, PCI_DMA_TODEVICE); -+ if (sg_list->nent == 1) -+ EXIT3(return); -+ for (i = 1; i < sg_list->nent; i++, sg_element++) { -+ TRACE3("%llx, %u", sg_element->address, sg_element->length); -+ pci_unmap_page(wnd->wd->pci.pdev, sg_element->address, -+ sg_element->length, PCI_DMA_TODEVICE); -+ } -+ TRACE3("%p", sg_list); -+ kfree(sg_list); -+} -+ -+static struct ndis_packet *alloc_tx_packet(struct ndis_device *wnd, -+ struct sk_buff *skb) -+{ -+ struct ndis_packet *packet; -+ ndis_buffer *buffer; -+ struct ndis_packet_oob_data *oob_data; -+ NDIS_STATUS status; -+ -+ NdisAllocatePacket(&status, &packet, wnd->tx_packet_pool); -+ if (status != NDIS_STATUS_SUCCESS) -+ return NULL; -+ NdisAllocateBuffer(&status, &buffer, wnd->tx_buffer_pool, -+ skb->data, skb->len); -+ if (status != NDIS_STATUS_SUCCESS) { -+ NdisFreePacket(packet); -+ return NULL; -+ } -+ packet->private.buffer_head = buffer; -+ packet->private.buffer_tail = buffer; -+ -+ oob_data = NDIS_PACKET_OOB_DATA(packet); -+ oob_data->tx_skb = skb; -+ if (wnd->sg_dma_size) { -+ if (setup_tx_sg_list(wnd, skb, oob_data)) { -+ NdisFreeBuffer(buffer); -+ NdisFreePacket(packet); -+ return NULL; -+ } -+ } -+ if (skb->ip_summed == CHECKSUM_PARTIAL) { -+ struct ndis_tcp_ip_checksum_packet_info csum; -+ int protocol; -+#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,21) -+ protocol = ntohs(skb->protocol); -+#else -+ protocol = skb->nh.iph->protocol; -+#endif -+ csum.value = 0; -+ csum.tx.v4 = 1; -+ if (protocol == IPPROTO_TCP) -+ csum.tx.tcp = 1; -+ else if (protocol == IPPROTO_UDP) -+ csum.tx.udp = 1; -+// csum->tx.ip = 1; -+ packet->private.flags |= NDIS_PROTOCOL_ID_TCP_IP; -+ oob_data->ext.info[TcpIpChecksumPacketInfo] = -+ (void *)(ULONG_PTR)csum.value; -+ } -+ DBG_BLOCK(4) { -+ dump_bytes(__func__, skb->data, skb->len); -+ } -+ TRACE4("%p, %p, %p", packet, buffer, skb); -+ return packet; -+} -+ -+void free_tx_packet(struct ndis_device *wnd, struct ndis_packet *packet, -+ NDIS_STATUS status) -+{ -+ ndis_buffer *buffer; -+ struct ndis_packet_oob_data *oob_data; -+ struct sk_buff *skb; -+ struct ndis_packet_pool *pool; -+ -+ assert_irql(_irql_ <= DISPATCH_LEVEL); -+ assert(packet->private.packet_flags); -+ oob_data = NDIS_PACKET_OOB_DATA(packet); -+ skb = oob_data->tx_skb; -+ buffer = packet->private.buffer_head; -+ TRACE4("%p, %p, %p, %08X", packet, buffer, skb, status); -+ if (status == NDIS_STATUS_SUCCESS) { -+ pre_atomic_add(wnd->net_stats.tx_bytes, packet->private.len); -+ atomic_inc_var(wnd->net_stats.tx_packets); -+ } else { -+ TRACE1("packet dropped: %08X", status); -+ atomic_inc_var(wnd->net_stats.tx_dropped); -+ } -+ if (wnd->sg_dma_size) -+ free_tx_sg_list(wnd, oob_data); -+ NdisFreeBuffer(buffer); -+ dev_kfree_skb_any(skb); -+ pool = packet->private.pool; -+ NdisFreePacket(packet); -+ if (netif_queue_stopped(wnd->net_dev) && -+ ((pool->max_descr - pool->num_used_descr) >= -+ (wnd->max_tx_packets / 4))) { -+ set_bit(NETIF_WAKEQ, &wnd->ndis_pending_work); -+ queue_work(wrapndis_wq, &wnd->ndis_work); -+ } -+ EXIT4(return); -+} -+ -+/* MiniportSend and MiniportSendPackets */ -+/* this function is called holding tx_ring_mutex. start and n are such -+ * that start + n < TX_RING_SIZE; i.e., packets don't wrap around -+ * ring */ -+static u8 mp_tx_packets(struct ndis_device *wnd, u8 start, u8 n) -+{ -+ NDIS_STATUS res; -+ struct miniport *mp; -+ struct ndis_packet *packet; -+ u8 sent; -+ KIRQL irql; -+ -+ ENTER3("%d, %d", start, n); -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ if (mp->send_packets) { -+ if (deserialized_driver(wnd)) { -+ LIN2WIN3(mp->send_packets, wnd->nmb->mp_ctx, -+ &wnd->tx_ring[start], n); -+ sent = n; -+ } else { -+ irql = serialize_lock_irql(wnd); -+ LIN2WIN3(mp->send_packets, wnd->nmb->mp_ctx, -+ &wnd->tx_ring[start], n); -+ serialize_unlock_irql(wnd, irql); -+ for (sent = 0; sent < n && wnd->tx_ok; sent++) { -+ struct ndis_packet_oob_data *oob_data; -+ packet = wnd->tx_ring[start + sent]; -+ oob_data = NDIS_PACKET_OOB_DATA(packet); -+ switch ((res = -+ xchg(&oob_data->status, -+ NDIS_STATUS_NOT_RECOGNIZED))) { -+ case NDIS_STATUS_SUCCESS: -+ free_tx_packet(wnd, packet, -+ NDIS_STATUS_SUCCESS); -+ break; -+ case NDIS_STATUS_PENDING: -+ break; -+ case NDIS_STATUS_RESOURCES: -+ wnd->tx_ok = 0; -+ /* resubmit this packet and -+ * the rest when resources -+ * become available */ -+ sent--; -+ break; -+ case NDIS_STATUS_FAILURE: -+ free_tx_packet(wnd, packet, -+ NDIS_STATUS_FAILURE); -+ break; -+ default: -+ ERROR("%p: invalid status: %08X", -+ packet, res); -+ free_tx_packet(wnd, packet, -+ oob_data->status); -+ break; -+ } -+ TRACE3("%p, %d", packet, res); -+ } -+ } -+ TRACE3("sent: %d(%d)", sent, n); -+ } else { -+ for (sent = 0; sent < n && wnd->tx_ok; sent++) { -+ struct ndis_packet_oob_data *oob_data; -+ packet = wnd->tx_ring[start + sent]; -+ oob_data = NDIS_PACKET_OOB_DATA(packet); -+ oob_data->status = NDIS_STATUS_NOT_RECOGNIZED; -+ irql = serialize_lock_irql(wnd); -+ res = LIN2WIN3(mp->send, wnd->nmb->mp_ctx, -+ packet, packet->private.flags); -+ serialize_unlock_irql(wnd, irql); -+ switch (res) { -+ case NDIS_STATUS_SUCCESS: -+ free_tx_packet(wnd, packet, res); -+ break; -+ case NDIS_STATUS_PENDING: -+ break; -+ case NDIS_STATUS_RESOURCES: -+ wnd->tx_ok = 0; -+ /* resend this packet when resources -+ * become available */ -+ sent--; -+ break; -+ case NDIS_STATUS_FAILURE: -+ free_tx_packet(wnd, packet, res); -+ break; -+ default: -+ ERROR("packet %p: invalid status: %08X", -+ packet, res); -+ break; -+ } -+ } -+ } -+ EXIT3(return sent); -+} -+ -+static void tx_worker(struct work_struct *work) -+{ -+ struct ndis_device *wnd; -+ s8 n; -+ -+ wnd = container_of(work, struct ndis_device, tx_work); -+ ENTER3("tx_ok %d", wnd->tx_ok); -+ while (wnd->tx_ok) { -+ mutex_lock(&wnd->tx_ring_mutex); -+ spin_lock_bh(&wnd->tx_ring_lock); -+ n = wnd->tx_ring_end - wnd->tx_ring_start; -+ TRACE3("%d, %d, %d", wnd->tx_ring_start, wnd->tx_ring_end, n); -+ /* end == start if either ring is empty or full; in -+ * the latter case is_tx_ring_full is set */ -+ if (n == 0) { -+ if (wnd->is_tx_ring_full) -+ n = TX_RING_SIZE - wnd->tx_ring_start; -+ else { -+ spin_unlock_bh(&wnd->tx_ring_lock); -+ mutex_unlock(&wnd->tx_ring_mutex); -+ break; -+ } -+ } else if (n < 0) -+ n = TX_RING_SIZE - wnd->tx_ring_start; -+ spin_unlock_bh(&wnd->tx_ring_lock); -+ if (unlikely(n > wnd->max_tx_packets)) -+ n = wnd->max_tx_packets; -+ n = mp_tx_packets(wnd, wnd->tx_ring_start, n); -+ if (n) { -+ netif_trans_update(wnd->net_dev); -+ wnd->tx_ring_start = -+ (wnd->tx_ring_start + n) % TX_RING_SIZE; -+ wnd->is_tx_ring_full = 0; -+ } -+ mutex_unlock(&wnd->tx_ring_mutex); -+ TRACE3("%d, %d, %d", wnd->tx_ring_start, wnd->tx_ring_end, n); -+ } -+ EXIT3(return); -+} -+ -+static int tx_skbuff(struct sk_buff *skb, struct net_device *dev) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ struct ndis_packet *packet; -+ -+ packet = alloc_tx_packet(wnd, skb); -+ if (!packet) { -+ TRACE2("couldn't allocate packet"); -+ netif_tx_lock(dev); -+ netif_stop_queue(dev); -+ netif_tx_unlock(dev); -+ return NETDEV_TX_BUSY; -+ } -+ spin_lock(&wnd->tx_ring_lock); -+ wnd->tx_ring[wnd->tx_ring_end++] = packet; -+ if (wnd->tx_ring_end == TX_RING_SIZE) -+ wnd->tx_ring_end = 0; -+ if (wnd->tx_ring_end == wnd->tx_ring_start) { -+ netif_tx_lock(dev); -+ wnd->is_tx_ring_full = 1; -+ netif_stop_queue(dev); -+ netif_tx_unlock(dev); -+ } -+ spin_unlock(&wnd->tx_ring_lock); -+ TRACE4("ring: %d, %d", wnd->tx_ring_start, wnd->tx_ring_end); -+ queue_work(wrapndis_wq, &wnd->tx_work); -+ return NETDEV_TX_OK; -+} -+ -+static int set_packet_filter(struct ndis_device *wnd, ULONG packet_filter) -+{ -+ NDIS_STATUS res; -+ -+ while (1) { -+ res = mp_set_int(wnd, OID_GEN_CURRENT_PACKET_FILTER, -+ packet_filter); -+ if (res == NDIS_STATUS_SUCCESS) -+ break; -+ TRACE2("couldn't set filter 0x%08x", packet_filter); -+ /* NDIS_PACKET_TYPE_PROMISCUOUS may not work with 802.11 */ -+ if (packet_filter & NDIS_PACKET_TYPE_PROMISCUOUS) { -+ packet_filter &= ~NDIS_PACKET_TYPE_PROMISCUOUS; -+ continue; -+ } -+ if (packet_filter & NDIS_PACKET_TYPE_ALL_LOCAL) { -+ packet_filter &= ~NDIS_PACKET_TYPE_ALL_LOCAL; -+ continue; -+ } -+ if (packet_filter & NDIS_PACKET_TYPE_ALL_FUNCTIONAL) { -+ packet_filter &= ~NDIS_PACKET_TYPE_ALL_FUNCTIONAL; -+ continue; -+ } -+ if (packet_filter & NDIS_PACKET_TYPE_MULTICAST) { -+ packet_filter &= ~NDIS_PACKET_TYPE_MULTICAST; -+ packet_filter |= NDIS_PACKET_TYPE_ALL_MULTICAST; -+ continue; -+ } -+ if (packet_filter & NDIS_PACKET_TYPE_ALL_MULTICAST) { -+ packet_filter &= ~NDIS_PACKET_TYPE_ALL_MULTICAST; -+ continue; -+ } -+ break; -+ } -+ -+ wnd->packet_filter = packet_filter; -+ res = mp_query_int(wnd, OID_GEN_CURRENT_PACKET_FILTER, &packet_filter); -+ if (packet_filter != wnd->packet_filter) { -+ WARNING("filter not set: 0x%08x, 0x%08x", -+ packet_filter, wnd->packet_filter); -+ wnd->packet_filter = packet_filter; -+ } -+ if (wnd->packet_filter) -+ EXIT3(return 0); -+ else -+ EXIT3(return -1); -+} -+ -+void set_media_state(struct ndis_device *wnd, enum ndis_media_state state) -+{ -+ struct net_device *net_dev = wnd->net_dev; -+ -+ ENTER2("state: 0x%x, carrier %d", state, netif_carrier_ok(net_dev)); -+ switch (state) { -+ case NdisMediaStateConnected: -+ if (netif_carrier_ok(net_dev)) -+ return; -+ netif_carrier_on(net_dev); -+ wnd->tx_ok = 1; -+ if (netif_queue_stopped(net_dev)) -+ netif_wake_queue(net_dev); -+ if (wnd->physical_medium == NdisPhysicalMediumWirelessLan) { -+ set_bit(LINK_STATUS_ON, &wnd->ndis_pending_work); -+ queue_work(wrapndis_wq, &wnd->ndis_work); -+ } -+ break; -+ case NdisMediaStateDisconnected: -+ if (!netif_carrier_ok(net_dev)) -+ return; -+ netif_carrier_off(net_dev); -+ netif_stop_queue(net_dev); -+ wnd->tx_ok = 0; -+ if (wnd->physical_medium == NdisPhysicalMediumWirelessLan) { -+ memset(&wnd->essid, 0, sizeof(wnd->essid)); -+ set_bit(LINK_STATUS_OFF, &wnd->ndis_pending_work); -+ queue_work(wrapndis_wq, &wnd->ndis_work); -+ } -+ break; -+ default: -+ WARNING("invalid media state: 0x%x", state); -+ break; -+ } -+} -+ -+static int ndis_net_dev_init(struct net_device *net_dev) -+{ -+ struct ndis_device *wnd = netdev_priv(net_dev); -+ -+ ENTER1("%p", wnd); -+ wrap_procfs_add_ndis_device(wnd); -+ EXIT1(return 0); -+} -+ -+static void ndis_net_dev_uninit(struct net_device *net_dev) -+{ -+ struct ndis_device *wnd = netdev_priv(net_dev); -+ -+ ENTER1("%p", wnd); -+ wrap_procfs_remove_ndis_device(wnd); -+ EXIT1(return); -+} -+ -+static int ndis_net_dev_open(struct net_device *net_dev) -+{ -+ int status, res; -+ struct ndis_device *wnd = netdev_priv(net_dev); -+ -+ ENTER1("%p", wnd); -+ res = mp_query_int(wnd, OID_GEN_MEDIA_CONNECT_STATUS, &status); -+ if (res == NDIS_STATUS_SUCCESS && status >= NdisMediaStateConnected && -+ status <= NdisMediaStateDisconnected) -+ set_media_state(wnd, status); -+ netif_start_queue(net_dev); -+ netif_poll_enable(net_dev); -+ EXIT1(return 0); -+} -+ -+static int ndis_net_dev_close(struct net_device *net_dev) -+{ -+ ENTER1("%p", netdev_priv(net_dev)); -+ netif_poll_disable(net_dev); -+ netif_tx_disable(net_dev); -+ EXIT1(return 0); -+} -+ -+static int ndis_change_mtu(struct net_device *net_dev, int mtu) -+{ -+ struct ndis_device *wnd = netdev_priv(net_dev); -+ int max; -+ -+ if (mtu < ETH_ZLEN) -+ return -EINVAL; -+ if (mp_query_int(wnd, OID_GEN_MAXIMUM_TOTAL_SIZE, &max) != -+ NDIS_STATUS_SUCCESS) -+ return -EOPNOTSUPP; -+ TRACE1("%d", max); -+ max -= ETH_HLEN; -+ if (max <= ETH_ZLEN) -+ return -EINVAL; -+ if (mtu + ETH_HLEN > max) -+ return -EINVAL; -+ net_dev->mtu = mtu; -+ return 0; -+} -+ -+#ifdef CONFIG_NET_POLL_CONTROLLER -+static void ndis_poll_controller(struct net_device *dev) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ -+ disable_irq(dev->irq); -+ ndis_isr(wnd->mp_interrupt->kinterrupt, wnd->mp_interrupt); -+ enable_irq(dev->irq); -+} -+#endif -+ -+/* called from BH context */ -+static struct net_device_stats *ndis_get_stats(struct net_device *dev) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ return &wnd->net_stats; -+} -+ -+/* called from BH context */ -+static void ndis_set_multicast_list(struct net_device *dev) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ set_bit(SET_MULTICAST_LIST, &wnd->ndis_pending_work); -+ queue_work(wrapndis_wq, &wnd->ndis_work); -+} -+ -+/* called from BH context */ -+struct iw_statistics *get_iw_stats(struct net_device *dev) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ return &wnd->iw_stats; -+} -+ -+static void update_iw_stats(struct ndis_device *wnd) -+{ -+ struct iw_statistics *iw_stats = &wnd->iw_stats; -+ struct ndis_wireless_stats ndis_stats; -+ NDIS_STATUS res; -+ ndis_rssi rssi; -+ int qual; -+ -+ ENTER2("%p", wnd); -+ if (wnd->iw_stats_enabled == FALSE || !netif_carrier_ok(wnd->net_dev)) { -+ memset(iw_stats, 0, sizeof(*iw_stats)); -+ EXIT2(return); -+ } -+ res = mp_query(wnd, OID_802_11_RSSI, &rssi, sizeof(rssi)); -+ if (res == NDIS_STATUS_SUCCESS) -+ iw_stats->qual.level = rssi; -+ -+ qual = 100 * (rssi - WL_NOISE) / (WL_SIGMAX - WL_NOISE); -+ if (qual < 0) -+ qual = 0; -+ else if (qual > 100) -+ qual = 100; -+ -+ iw_stats->qual.noise = WL_NOISE; -+ iw_stats->qual.qual = qual; -+ -+ res = mp_query(wnd, OID_802_11_STATISTICS, -+ &ndis_stats, sizeof(ndis_stats)); -+ if (res != NDIS_STATUS_SUCCESS) -+ EXIT2(return); -+ iw_stats->discard.retries = (unsigned long)ndis_stats.retry + -+ (unsigned long)ndis_stats.multi_retry; -+ iw_stats->discard.misc = (unsigned long)ndis_stats.fcs_err + -+ (unsigned long)ndis_stats.rtss_fail + -+ (unsigned long)ndis_stats.ack_fail + -+ (unsigned long)ndis_stats.frame_dup; -+ -+ EXIT2(return); -+} -+ -+static void set_multicast_list(struct ndis_device *wnd) -+{ -+ struct net_device *net_dev; -+ ULONG packet_filter; -+ NDIS_STATUS res; -+ -+ net_dev = wnd->net_dev; -+ packet_filter = wnd->packet_filter; -+ -+ TRACE2("0x%08x", packet_filter); -+ if (net_dev->flags & IFF_PROMISC) { -+ packet_filter |= NDIS_PACKET_TYPE_PROMISCUOUS | -+ NDIS_PACKET_TYPE_ALL_LOCAL; -+ } else if (net_dev->flags & IFF_ALLMULTI || -+ netdev_mc_count(net_dev) > wnd->multicast_size) { -+ packet_filter |= NDIS_PACKET_TYPE_ALL_MULTICAST; -+ TRACE2("0x%08x", packet_filter); -+ } else if (netdev_mc_count(net_dev) > 0) { -+ int i, size; -+ char *buf; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35) -+ struct netdev_hw_addr *ha; -+#else -+ struct dev_mc_list *mclist; -+#endif -+ size = min(wnd->multicast_size, netdev_mc_count(net_dev)); -+ TRACE2("%d, %d", wnd->multicast_size, netdev_mc_count(net_dev)); -+ buf = kmalloc(size * ETH_ALEN, GFP_KERNEL); -+ if (!buf) { -+ WARNING("couldn't allocate memory"); -+ EXIT2(return); -+ } -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35) -+ i = 0; -+ netdev_for_each_mc_addr(ha, net_dev) { -+ if (i >= size) -+ break; -+ memcpy(buf + i * ETH_ALEN, ha->addr, ETH_ALEN); -+ TRACE2(MACSTRSEP, MAC2STR(ha->addr)); -+ i++; -+ } -+#else -+ mclist = net_dev->mc_list; -+ for (i = 0; i < size && mclist; mclist = mclist->next) { -+ if (mclist->dmi_addrlen != ETH_ALEN) -+ continue; -+ memcpy(buf + i * ETH_ALEN, mclist->dmi_addr, ETH_ALEN); -+ TRACE2(MACSTRSEP, MAC2STR(mclist->dmi_addr)); -+ i++; -+ } -+#endif -+ res = mp_set(wnd, OID_802_3_MULTICAST_LIST, buf, i * ETH_ALEN); -+ if (res == NDIS_STATUS_SUCCESS && i > 0) -+ packet_filter |= NDIS_PACKET_TYPE_MULTICAST; -+ else -+ packet_filter |= NDIS_PACKET_TYPE_ALL_MULTICAST; -+ kfree(buf); -+ } -+ TRACE2("0x%08x", packet_filter); -+ res = set_packet_filter(wnd, packet_filter); -+ if (res) -+ TRACE1("couldn't set packet filter (%08X)", res); -+ EXIT2(return); -+} -+ -+static void link_status_off(struct ndis_device *wnd) -+{ -+#ifdef CONFIG_WIRELESS_EXT -+ union iwreq_data wrqu; -+ -+ memset(&wrqu, 0, sizeof(wrqu)); -+ wrqu.ap_addr.sa_family = ARPHRD_ETHER; -+ wireless_send_event(wnd->net_dev, SIOCGIWAP, &wrqu, NULL); -+#endif -+ EXIT2(return); -+} -+ -+static void link_status_on(struct ndis_device *wnd) -+{ -+#ifdef CONFIG_WIRELESS_EXT -+ struct ndis_assoc_info *ndis_assoc_info; -+ union iwreq_data wrqu; -+ NDIS_STATUS res; -+ const int assoc_size = sizeof(*ndis_assoc_info) + IW_CUSTOM_MAX + 32; -+#endif -+ -+ ENTER2(""); -+#ifdef CONFIG_WIRELESS_EXT -+ memset(&wrqu, 0, sizeof(wrqu)); -+ ndis_assoc_info = kzalloc(assoc_size, GFP_KERNEL); -+ if (!ndis_assoc_info) { -+ ERROR("couldn't allocate memory"); -+ goto send_assoc_event; -+ } -+ res = mp_query(wnd, OID_802_11_ASSOCIATION_INFORMATION, -+ ndis_assoc_info, assoc_size); -+ if (res) { -+ TRACE2("query assoc_info failed (%08X)", res); -+ kfree(ndis_assoc_info); -+ goto send_assoc_event; -+ } -+ TRACE2("%u, 0x%x, %u, 0x%x, %u", ndis_assoc_info->length, -+ ndis_assoc_info->req_ies, ndis_assoc_info->req_ie_length, -+ ndis_assoc_info->resp_ies, ndis_assoc_info->resp_ie_length); -+ if (ndis_assoc_info->req_ie_length > 0) { -+ wrqu.data.length = ndis_assoc_info->req_ie_length; -+ wireless_send_event(wnd->net_dev, IWEVASSOCREQIE, &wrqu, -+ ((char *)ndis_assoc_info) + -+ ndis_assoc_info->offset_req_ies); -+ } -+ if (ndis_assoc_info->resp_ie_length > 0) { -+ wrqu.data.length = ndis_assoc_info->resp_ie_length; -+ wireless_send_event(wnd->net_dev, IWEVASSOCRESPIE, &wrqu, -+ ((char *)ndis_assoc_info) + -+ ndis_assoc_info->offset_resp_ies); -+ } -+ kfree(ndis_assoc_info); -+ -+send_assoc_event: -+ get_ap_address(wnd, wrqu.ap_addr.sa_data); -+ wrqu.ap_addr.sa_family = ARPHRD_ETHER; -+ TRACE2(MACSTRSEP, MAC2STR(wrqu.ap_addr.sa_data)); -+ wireless_send_event(wnd->net_dev, SIOCGIWAP, &wrqu, NULL); -+#endif -+ EXIT2(return); -+} -+ -+static void iw_stats_timer_proc(unsigned long data) -+{ -+ struct ndis_device *wnd = (struct ndis_device *)data; -+ -+ ENTER2("%d", wnd->iw_stats_interval); -+ if (wnd->iw_stats_interval > 0) { -+ set_bit(COLLECT_IW_STATS, &wnd->ndis_pending_work); -+ queue_work(wrapndis_wq, &wnd->ndis_work); -+ } -+ mod_timer(&wnd->iw_stats_timer, jiffies + wnd->iw_stats_interval); -+} -+ -+static void add_iw_stats_timer(struct ndis_device *wnd) -+{ -+ if (wnd->physical_medium != NdisPhysicalMediumWirelessLan) -+ return; -+ if (wnd->iw_stats_interval < 0) -+ wnd->iw_stats_interval *= -1; -+ wnd->iw_stats_timer.data = (unsigned long)wnd; -+ wnd->iw_stats_timer.function = iw_stats_timer_proc; -+ mod_timer(&wnd->iw_stats_timer, jiffies + wnd->iw_stats_interval); -+} -+ -+static void del_iw_stats_timer(struct ndis_device *wnd) -+{ -+ ENTER2("%d", wnd->iw_stats_interval); -+ wnd->iw_stats_interval *= -1; -+ del_timer_sync(&wnd->iw_stats_timer); -+ EXIT2(return); -+} -+ -+static void hangcheck_proc(unsigned long data) -+{ -+ struct ndis_device *wnd = (struct ndis_device *)data; -+ -+ ENTER3("%d", wnd->hangcheck_interval); -+ if (wnd->hangcheck_interval > 0) { -+ set_bit(HANGCHECK, &wnd->ndis_pending_work); -+ queue_work(wrapndis_wq, &wnd->ndis_work); -+ } -+ mod_timer(&wnd->hangcheck_timer, jiffies + wnd->hangcheck_interval); -+ EXIT3(return); -+} -+ -+void hangcheck_add(struct ndis_device *wnd) -+{ -+ if (!wnd->wd->driver->ndis_driver->mp.hangcheck || -+ hangcheck_interval < 0) -+ EXIT2(return); -+ -+ if (hangcheck_interval > 0) -+ wnd->hangcheck_interval = hangcheck_interval * HZ; -+ if (wnd->hangcheck_interval < 0) -+ wnd->hangcheck_interval *= -1; -+ wnd->hangcheck_timer.data = (unsigned long)wnd; -+ wnd->hangcheck_timer.function = hangcheck_proc; -+ mod_timer(&wnd->hangcheck_timer, jiffies + wnd->hangcheck_interval); -+ EXIT2(return); -+} -+ -+void hangcheck_del(struct ndis_device *wnd) -+{ -+ ENTER2("%d", wnd->hangcheck_interval); -+ if (wnd->hangcheck_interval > 0) -+ wnd->hangcheck_interval *= -1; -+ del_timer_sync(&wnd->hangcheck_timer); -+ EXIT2(return); -+} -+ -+/* worker procedure to take care of setting/checking various states */ -+static void wrapndis_worker(struct work_struct *work) -+{ -+ struct ndis_device *wnd; -+ -+ wnd = container_of(work, struct ndis_device, ndis_work); -+ WORKTRACE("0x%lx", wnd->ndis_pending_work); -+ -+ if (test_and_clear_bit(NETIF_WAKEQ, &wnd->ndis_pending_work)) { -+ netif_tx_lock_bh(wnd->net_dev); -+ netif_wake_queue(wnd->net_dev); -+ netif_tx_unlock_bh(wnd->net_dev); -+ } -+ -+ if (test_and_clear_bit(LINK_STATUS_OFF, &wnd->ndis_pending_work)) -+ link_status_off(wnd); -+ -+ if (test_and_clear_bit(LINK_STATUS_ON, &wnd->ndis_pending_work)) -+ link_status_on(wnd); -+ -+ if (test_and_clear_bit(COLLECT_IW_STATS, &wnd->ndis_pending_work)) -+ update_iw_stats(wnd); -+ -+ if (test_and_clear_bit(SET_MULTICAST_LIST, -+ &wnd->ndis_pending_work)) -+ set_multicast_list(wnd); -+ -+ if (test_and_clear_bit(HANGCHECK, &wnd->ndis_pending_work)) { -+ struct miniport *mp; -+ BOOLEAN reset; -+ KIRQL irql; -+ -+ mp = &wnd->wd->driver->ndis_driver->mp; -+ irql = serialize_lock_irql(wnd); -+ reset = LIN2WIN1(mp->hangcheck, wnd->nmb->mp_ctx); -+ serialize_unlock_irql(wnd, irql); -+ if (reset) { -+ TRACE2("%s needs reset", wnd->net_dev->name); -+ mp_reset(wnd); -+ } -+ } -+ WORKEXIT(return); -+} -+ -+NDIS_STATUS ndis_reinit(struct ndis_device *wnd) -+{ -+ NDIS_STATUS status; -+ -+ wnd->attributes &= ~NDIS_ATTRIBUTE_NO_HALT_ON_SUSPEND; -+ status = mp_set_power_state(wnd, NdisDeviceStateD3); -+ if (status != NDIS_STATUS_SUCCESS) { -+ ERROR("halting device %s failed: %08X", wnd->net_dev->name, -+ status); -+ return status; -+ } -+ status = mp_set_power_state(wnd, NdisDeviceStateD0); -+ if (status != NDIS_STATUS_SUCCESS) -+ ERROR("starting device %s failed: %08X", wnd->net_dev->name, -+ status); -+ return status; -+} -+ -+#ifdef CONFIG_WIRELESS_EXT -+static void get_encryption_capa(struct ndis_device *wnd, char *buf, -+ const int buf_len) -+{ -+ int i, mode; -+ NDIS_STATUS res; -+ struct ndis_assoc_info ndis_assoc_info; -+ struct ndis_add_key ndis_key; -+ struct ndis_capability *c; -+ -+ ENTER1("%p", wnd); -+ /* set network type to g, b, or a, in that order */ -+ res = mp_query(wnd, OID_802_11_NETWORK_TYPES_SUPPORTED, buf, buf_len); -+ if (res == NDIS_STATUS_SUCCESS) { -+ struct network_type_list *net_types; -+ unsigned long types = 0; -+ net_types = (typeof(net_types))buf; -+ for (i = 0; i < net_types->num; i++) { -+ TRACE2("%d", net_types->types[i]); -+ set_bit(net_types->types[i], &types); -+ } -+ if (test_bit(Ndis802_11OFDM24, &types)) -+ mode = Ndis802_11OFDM24; -+ else if (test_bit(Ndis802_11DS, &types)) -+ mode = Ndis802_11DS; -+ else if (test_bit(Ndis802_11OFDM5, &types)) -+ mode = Ndis802_11OFDM5; -+ else -+ mode = Ndis802_11DS; -+ mp_set_int(wnd, OID_802_11_NETWORK_TYPE_IN_USE, mode); -+ } -+ /* check if WEP is supported */ -+ if (set_iw_encr_mode(wnd, IW_AUTH_CIPHER_WEP104, -+ IW_AUTH_CIPHER_NONE) == 0 && -+ get_ndis_encr_mode(wnd) == Ndis802_11Encryption1KeyAbsent) -+ set_bit(Ndis802_11Encryption1Enabled, &wnd->capa.encr); -+ -+ /* check if WPA is supported */ -+ if (set_ndis_auth_mode(wnd, Ndis802_11AuthModeWPA) == 0 && -+ get_ndis_auth_mode(wnd) == Ndis802_11AuthModeWPA) -+ set_bit(Ndis802_11AuthModeWPA, &wnd->capa.encr); -+ else -+ EXIT1(return); -+ -+ if (set_ndis_auth_mode(wnd, Ndis802_11AuthModeWPAPSK) == 0 && -+ get_ndis_auth_mode(wnd) == Ndis802_11AuthModeWPAPSK) -+ set_bit(Ndis802_11AuthModeWPAPSK, &wnd->capa.encr); -+ -+ /* check for highest encryption */ -+ mode = 0; -+ if (set_iw_encr_mode(wnd, IW_AUTH_CIPHER_CCMP, -+ IW_AUTH_CIPHER_NONE) == 0 && -+ (i = get_ndis_encr_mode(wnd)) > 0 && -+ (i == Ndis802_11Encryption3KeyAbsent || -+ i == Ndis802_11Encryption3Enabled)) -+ mode = Ndis802_11Encryption3Enabled; -+ else if (set_iw_encr_mode(wnd, IW_AUTH_CIPHER_TKIP, -+ IW_AUTH_CIPHER_NONE) == 0 && -+ (i = get_ndis_encr_mode(wnd)) > 0 && -+ (i == Ndis802_11Encryption2KeyAbsent || -+ i == Ndis802_11Encryption2Enabled)) -+ mode = Ndis802_11Encryption2Enabled; -+ else if (set_iw_encr_mode(wnd, IW_AUTH_CIPHER_WEP104, -+ IW_AUTH_CIPHER_NONE) == 0 && -+ (i = get_ndis_encr_mode(wnd)) > 0 && -+ (i == Ndis802_11Encryption1KeyAbsent || -+ i == Ndis802_11Encryption1Enabled)) -+ mode = Ndis802_11Encryption1Enabled; -+ -+ TRACE1("mode: %d", mode); -+ if (mode == 0) -+ EXIT1(return); -+ set_bit(Ndis802_11Encryption1Enabled, &wnd->capa.encr); -+ if (mode == Ndis802_11Encryption1Enabled) -+ EXIT1(return); -+ -+ ndis_key.length = 32; -+ ndis_key.index = 0xC0000001; -+ ndis_key.struct_size = sizeof(ndis_key); -+ res = mp_set(wnd, OID_802_11_ADD_KEY, &ndis_key, ndis_key.struct_size); -+ TRACE2("%08X, %zu", res, sizeof(ndis_key)); -+ if (res && res != NDIS_STATUS_INVALID_DATA) -+ EXIT1(return); -+ res = mp_query(wnd, OID_802_11_ASSOCIATION_INFORMATION, -+ &ndis_assoc_info, sizeof(ndis_assoc_info)); -+ TRACE1("%08X", res); -+ if (res == NDIS_STATUS_NOT_SUPPORTED) -+ EXIT1(return); -+ -+ set_bit(Ndis802_11Encryption2Enabled, &wnd->capa.encr); -+ if (mode == Ndis802_11Encryption3Enabled) -+ set_bit(Ndis802_11Encryption3Enabled, &wnd->capa.encr); -+ /* not all drivers support OID_802_11_CAPABILITY, so we don't -+ * know for sure if driver support WPA or WPAPSK; assume -+ * WPAPSK */ -+ set_bit(Ndis802_11AuthModeWPAPSK, &wnd->capa.auth); -+ wnd->max_pmkids = 1; -+ -+ memset(buf, 0, buf_len); -+ c = (struct ndis_capability *)buf; -+ res = mp_query(wnd, OID_802_11_CAPABILITY, buf, buf_len); -+ if (!(res == NDIS_STATUS_SUCCESS && c->version == 2)) -+ EXIT1(return); -+ wnd->max_pmkids = c->num_PMKIDs; -+ -+ for (i = 0; i < c->num_auth_encr_pair; i++) { -+ struct ndis_auth_encr_pair *ae; -+ -+ ae = &c->auth_encr_pair[i]; -+ if ((char *)(ae + 1) > buf + buf_len) -+ break; -+ switch (ae->auth_mode) { -+ case Ndis802_11AuthModeOpen: -+ case Ndis802_11AuthModeShared: -+ case Ndis802_11AuthModeWPA: -+ case Ndis802_11AuthModeWPAPSK: -+ case Ndis802_11AuthModeWPANone: -+ case Ndis802_11AuthModeWPA2: -+ case Ndis802_11AuthModeWPA2PSK: -+ set_bit(ae->auth_mode, &wnd->capa.auth); -+ break; -+ default: -+ WARNING("unknown auth_mode: %d", ae->auth_mode); -+ break; -+ } -+ switch (ae->encr_mode) { -+ case Ndis802_11EncryptionDisabled: -+ case Ndis802_11Encryption1Enabled: -+ case Ndis802_11Encryption2Enabled: -+ case Ndis802_11Encryption3Enabled: -+ set_bit(ae->encr_mode, &wnd->capa.encr); -+ break; -+ default: -+ WARNING("unknown encr_mode: %d", ae->encr_mode); -+ break; -+ } -+ } -+ EXIT1(return); -+} -+#endif -+ -+wstdcall NTSTATUS NdisDispatchDeviceControl(struct device_object *fdo, -+ struct irp *irp) -+{ -+ struct ndis_device *wnd; -+ -+ TRACE3("fdo: %p", fdo); -+ /* for now, we don't have anything interesting here, so pass it -+ * down to bus driver */ -+ wnd = fdo->reserved; -+ return IoPassIrpDown(wnd->nmb->pdo, irp); -+} -+WIN_FUNC_DECL(NdisDispatchDeviceControl,2) -+ -+wstdcall NTSTATUS NdisDispatchPower(struct device_object *fdo, struct irp *irp) -+{ -+ struct io_stack_location *irp_sl; -+ struct ndis_device *wnd; -+ enum ndis_power_state state; -+ NTSTATUS status; -+ NDIS_STATUS ndis_status; -+ -+ irp_sl = IoGetCurrentIrpStackLocation(irp); -+ wnd = fdo->reserved; -+ IOTRACE("fdo: %p, fn: %d:%d, wnd: %p", fdo, irp_sl->major_fn, -+ irp_sl->minor_fn, wnd); -+ if ((irp_sl->params.power.type == SystemPowerState && -+ irp_sl->params.power.state.system_state > PowerSystemWorking) || -+ (irp_sl->params.power.type == DevicePowerState && -+ irp_sl->params.power.state.device_state > PowerDeviceD0)) -+ state = NdisDeviceStateD3; -+ else -+ state = NdisDeviceStateD0; -+ switch (irp_sl->minor_fn) { -+ case IRP_MN_SET_POWER: -+ if (state == NdisDeviceStateD0) { -+ status = IoSyncForwardIrp(wnd->nmb->pdo, irp); -+ if (status != STATUS_SUCCESS) -+ break; -+ ndis_status = mp_set_power_state(wnd, state); -+ if (ndis_status != NDIS_STATUS_SUCCESS) -+ WARNING("couldn't set power to %d: %08X", -+ state, ndis_status); -+ TRACE2("%s: device resumed", wnd->net_dev->name); -+ irp->io_status.status = status = STATUS_SUCCESS; -+ IoCompleteRequest(irp, IO_NO_INCREMENT); -+ break; -+ } else { -+ ndis_status = mp_set_power_state(wnd, state); -+ /* TODO: handle error case */ -+ if (ndis_status != NDIS_STATUS_SUCCESS) -+ WARNING("setting power to %d failed: %08X", -+ state, ndis_status); -+ status = IoAsyncForwardIrp(wnd->nmb->pdo, irp); -+ } -+ break; -+ case IRP_MN_QUERY_POWER: -+ if (wnd->attributes & NDIS_ATTRIBUTE_NO_HALT_ON_SUSPEND) { -+ ndis_status = mp_query(wnd, OID_PNP_QUERY_POWER, -+ &state, sizeof(state)); -+ TRACE2("%d, %08X", state, ndis_status); -+ /* this OID must always succeed */ -+ if (ndis_status != NDIS_STATUS_SUCCESS) -+ TRACE1("query power returns %08X", ndis_status); -+ irp->io_status.status = STATUS_SUCCESS; -+ } else -+ irp->io_status.status = STATUS_SUCCESS; -+ status = IoPassIrpDown(wnd->nmb->pdo, irp); -+ break; -+ case IRP_MN_WAIT_WAKE: -+ case IRP_MN_POWER_SEQUENCE: -+ /* TODO: implement WAIT_WAKE */ -+ status = IoPassIrpDown(wnd->nmb->pdo, irp); -+ break; -+ default: -+ status = IoPassIrpDown(wnd->nmb->pdo, irp); -+ break; -+ } -+ IOEXIT(return status); -+} -+WIN_FUNC_DECL(NdisDispatchPower,2) -+ -+wstdcall NTSTATUS NdisDispatchPnp(struct device_object *fdo, struct irp *irp) -+{ -+ struct io_stack_location *irp_sl; -+ struct ndis_device *wnd; -+ struct device_object *pdo; -+ NTSTATUS status; -+ -+ IOTRACE("fdo: %p, irp: %p", fdo, irp); -+ irp_sl = IoGetCurrentIrpStackLocation(irp); -+ wnd = fdo->reserved; -+ pdo = wnd->nmb->pdo; -+ switch (irp_sl->minor_fn) { -+ case IRP_MN_START_DEVICE: -+ status = IoSyncForwardIrp(pdo, irp); -+ if (status != STATUS_SUCCESS) -+ break; -+ if (ndis_start_device(wnd) == NDIS_STATUS_SUCCESS) -+ status = STATUS_SUCCESS; -+ else -+ status = STATUS_FAILURE; -+ irp->io_status.status = status; -+ IoCompleteRequest(irp, IO_NO_INCREMENT); -+ break; -+ case IRP_MN_QUERY_STOP_DEVICE: -+ /* TODO: implement in NDIS */ -+ status = IoPassIrpDown(wnd->nmb->pdo, irp); -+ break; -+ case IRP_MN_STOP_DEVICE: -+ mp_halt(wnd); -+ irp->io_status.status = STATUS_SUCCESS; -+ status = IoAsyncForwardIrp(pdo, irp); -+ break; -+ case IRP_MN_REMOVE_DEVICE: -+ TRACE1("%s", wnd->net_dev->name); -+ mp_pnp_event(wnd, NdisDevicePnPEventSurpriseRemoved, 0); -+ if (ndis_remove_device(wnd)) { -+ status = STATUS_FAILURE; -+ break; -+ } -+ /* wnd is already freed */ -+ status = IoAsyncForwardIrp(pdo, irp); -+ IoDetachDevice(fdo); -+ IoDeleteDevice(fdo); -+ break; -+ default: -+ status = IoAsyncForwardIrp(pdo, irp); -+ break; -+ } -+ IOTRACE("status: %08X", status); -+ IOEXIT(return status); -+} -+WIN_FUNC_DECL(NdisDispatchPnp,2) -+ -+static void set_task_offload(struct ndis_device *wnd, void *buf, -+ const int buf_size) -+{ -+ struct ndis_task_offload_header *task_offload_header; -+ struct ndis_task_offload *task_offload; -+ struct ndis_task_tcp_ip_checksum *csum = NULL; -+ struct ndis_task_tcp_large_send *tso = NULL; -+ NDIS_STATUS status; -+ -+ memset(buf, 0, buf_size); -+ task_offload_header = buf; -+ task_offload_header->version = NDIS_TASK_OFFLOAD_VERSION; -+ task_offload_header->size = sizeof(*task_offload_header); -+ task_offload_header->encap_format.flags.fixed_header_size = 1; -+ task_offload_header->encap_format.header_size = sizeof(struct ethhdr); -+ task_offload_header->encap_format.encap = IEEE_802_3_Encapsulation; -+ status = mp_query(wnd, OID_TCP_TASK_OFFLOAD, buf, buf_size); -+ TRACE1("%08X", status); -+ if (status != NDIS_STATUS_SUCCESS) -+ EXIT1(return); -+ if (task_offload_header->offset_first_task == 0) -+ EXIT1(return); -+ task_offload = ((void *)task_offload_header + -+ task_offload_header->offset_first_task); -+ while (1) { -+ TRACE1("%d, %d", task_offload->version, task_offload->task); -+ switch (task_offload->task) { -+ case TcpIpChecksumNdisTask: -+ csum = (void *)task_offload->task_buf; -+ break; -+ case TcpLargeSendNdisTask: -+ tso = (void *)task_offload->task_buf; -+ break; -+ default: -+ TRACE1("%d", task_offload->task); -+ break; -+ } -+ if (task_offload->offset_next_task == 0) -+ break; -+ task_offload = (void *)task_offload + -+ task_offload->offset_next_task; -+ } -+ if (tso) -+ TRACE1("%u, %u, %d, %d", tso->max_size, tso->min_seg_count, -+ tso->tcp_opts, tso->ip_opts); -+ if (!csum) -+ EXIT1(return); -+ TRACE1("%08x, %08x", csum->v4_tx.value, csum->v4_rx.value); -+ task_offload_header->encap_format.flags.fixed_header_size = 1; -+ task_offload_header->encap_format.header_size = sizeof(struct ethhdr); -+ task_offload_header->offset_first_task = sizeof(*task_offload_header); -+ task_offload = ((void *)task_offload_header + -+ task_offload_header->offset_first_task); -+ task_offload->offset_next_task = 0; -+ task_offload->size = sizeof(*task_offload); -+ task_offload->task = TcpIpChecksumNdisTask; -+ memcpy(task_offload->task_buf, csum, sizeof(*csum)); -+ task_offload->task_buf_length = sizeof(*csum); -+ status = mp_set(wnd, OID_TCP_TASK_OFFLOAD, task_offload_header, -+ sizeof(*task_offload_header) + -+ sizeof(*task_offload) + sizeof(*csum)); -+ TRACE1("%08X", status); -+ if (status != NDIS_STATUS_SUCCESS) -+ EXIT2(return); -+ wnd->tx_csum = csum->v4_tx; -+ if (csum->v4_tx.tcp_csum && csum->v4_tx.udp_csum) { -+ if (csum->v4_tx.ip_csum) { -+ wnd->net_dev->features |= NETIF_F_HW_CSUM; -+ TRACE1("hw checksum enabled"); -+ } else { -+ wnd->net_dev->features |= NETIF_F_IP_CSUM; -+ TRACE1("IP checksum enabled"); -+ } -+ if (wnd->sg_dma_size) -+ wnd->net_dev->features |= NETIF_F_SG; -+ } -+ wnd->rx_csum = csum->v4_rx; -+ EXIT1(return); -+} -+ -+static void get_supported_oids(struct ndis_device *wnd) -+{ -+ NDIS_STATUS res; -+ int i, n, needed; -+ ndis_oid *oids; -+ -+ res = mp_query_info(wnd, OID_GEN_SUPPORTED_LIST, NULL, 0, NULL, -+ &needed); -+ if (!(res == NDIS_STATUS_BUFFER_TOO_SHORT || -+ res == NDIS_STATUS_INVALID_LENGTH)) -+ EXIT1(return); -+ oids = kmalloc(needed, GFP_KERNEL); -+ if (!oids) { -+ TRACE1("couldn't allocate memory"); -+ EXIT1(return); -+ } -+ res = mp_query(wnd, OID_GEN_SUPPORTED_LIST, oids, needed); -+ if (res) { -+ TRACE1("failed: %08X", res); -+ kfree(oids); -+ EXIT1(return); -+ } -+ for (i = 0, n = needed / sizeof(*oids); i < n; i++) { -+ TRACE1("oid: %08X", oids[i]); -+ /* if a wireless device didn't say so for -+ * OID_GEN_PHYSICAL_MEDIUM (they should, but in case) */ -+ if (wnd->physical_medium != NdisPhysicalMediumWirelessLan && -+ oids[i] == OID_802_11_SSID) -+ wnd->physical_medium = NdisPhysicalMediumWirelessLan; -+ } -+ kfree(oids); -+ EXIT1(return); -+} -+ -+static void ndis_get_drvinfo(struct net_device *dev, -+ struct ethtool_drvinfo *info) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ strncpy(info->driver, DRIVER_NAME, sizeof(info->driver) - 2); -+ strcat(info->driver, "+"); -+ strncat(info->driver, wnd->wd->driver->name, -+ sizeof(info->driver) - strlen(DRIVER_NAME) - 1); -+ strncpy(info->version, DRIVER_VERSION, sizeof(info->version) - 2); -+ strcat(info->version, "+"); -+ strncat(info->version, wnd->wd->driver->version, -+ sizeof(info->version) - strlen(DRIVER_VERSION) - 1); -+ if (wrap_is_pci_bus(wnd->wd->dev_bus)) -+ strncpy(info->bus_info, pci_name(wnd->wd->pci.pdev), -+ sizeof(info->bus_info) - 1); -+#ifdef ENABLE_USB -+ else -+ usb_make_path(wnd->wd->usb.udev, info->bus_info, -+ sizeof(info->bus_info) - 1); -+#endif -+ return; -+} -+ -+static u32 ndis_get_link(struct net_device *dev) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ return netif_carrier_ok(wnd->net_dev); -+} -+ -+static void ndis_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ -+ wol->supported = 0; -+ wol->wolopts = 0; -+ if (!(wnd->attributes & NDIS_ATTRIBUTE_NO_HALT_ON_SUSPEND)) -+ EXIT2(return); -+ if (!wrap_is_pci_bus(wnd->wd->dev_bus)) -+ EXIT2(return); -+ /* we always suspend to D3 */ -+ if (wnd->pnp_capa.wakeup.min_magic_packet_wakeup < NdisDeviceStateD3) -+ return; -+ wol->supported |= WAKE_MAGIC; -+ if (wnd->ndis_wolopts & NDIS_PNP_WAKE_UP_MAGIC_PACKET) -+ wol->wolopts |= WAKE_MAGIC; -+ return; -+} -+ -+static int ndis_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ -+ if (!(wnd->attributes & NDIS_ATTRIBUTE_NO_HALT_ON_SUSPEND)) -+ return -EOPNOTSUPP; -+ if (wnd->pnp_capa.wakeup.min_magic_packet_wakeup < NdisDeviceStateD3) -+ EXIT2(return -EOPNOTSUPP); -+ TRACE2("0x%x", wol->wolopts); -+ if (wol->wolopts & WAKE_MAGIC) { -+ wnd->ndis_wolopts |= NDIS_PNP_WAKE_UP_MAGIC_PACKET; -+ if (wol->wolopts != WAKE_MAGIC) -+ WARNING("ignored wake-on-lan options: 0x%x", -+ wol->wolopts & ~WAKE_MAGIC); -+ } else if (!wol->wolopts) -+ wnd->ndis_wolopts = 0; -+ else -+ return -EOPNOTSUPP; -+ TRACE2("0x%x", wnd->ndis_wolopts); -+ return 0; -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,3,0) -+static u32 ndis_get_tx_csum(struct net_device *dev) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ if (wnd->tx_csum.tcp_csum && wnd->tx_csum.udp_csum) -+ return 1; -+ else -+ return 0; -+} -+ -+static u32 ndis_get_rx_csum(struct net_device *dev) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ if (wnd->rx_csum.value) -+ return 1; -+ else -+ return 0; -+} -+ -+static int ndis_set_tx_csum(struct net_device *dev, u32 data) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ -+ if (data && (wnd->tx_csum.value == 0)) -+ return -EOPNOTSUPP; -+ -+ if (wnd->tx_csum.ip_csum) -+ ethtool_op_set_tx_hw_csum(dev, data); -+ else -+ ethtool_op_set_tx_csum(dev, data); -+ return 0; -+} -+ -+static int ndis_set_rx_csum(struct net_device *dev, u32 data) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ -+ if (data && (wnd->tx_csum.value == 0)) -+ return -EOPNOTSUPP; -+ -+ /* TODO: enable/disable rx csum through NDIS */ -+ return 0; -+} -+ -+static u32 ndis_get_sg(struct net_device *dev) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ if (wnd->sg_dma_size) -+ return ethtool_op_get_sg(dev); -+ else -+ return 0; -+} -+ -+static int ndis_set_sg(struct net_device *dev, u32 data) -+{ -+ struct ndis_device *wnd = netdev_priv(dev); -+ if (wnd->sg_dma_size) -+ return ethtool_op_set_sg(dev, data); -+ else -+ return -EOPNOTSUPP; -+} -+#endif -+ -+static struct ethtool_ops ndis_ethtool_ops = { -+ .get_drvinfo = ndis_get_drvinfo, -+ .get_link = ndis_get_link, -+ .get_wol = ndis_get_wol, -+ .set_wol = ndis_set_wol, -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,3,0) -+ .get_tx_csum = ndis_get_tx_csum, -+ .get_rx_csum = ndis_get_rx_csum, -+ .set_tx_csum = ndis_set_tx_csum, -+ .set_rx_csum = ndis_set_rx_csum, -+ .get_sg = ndis_get_sg, -+ .set_sg = ndis_set_sg, -+#endif -+}; -+ -+static int notifier_event(struct notifier_block *notifier, unsigned long event, -+ void *ptr) -+{ -+ struct net_device *net_dev = netdev_notifier_info_to_dev(ptr); -+ -+ ENTER2("0x%lx", event); -+ if (net_dev->ethtool_ops == &ndis_ethtool_ops -+ && event == NETDEV_CHANGENAME) { -+ struct ndis_device *wnd = netdev_priv(net_dev); -+ -+ /* called with rtnl lock held, so no need to lock */ -+ if (likely(wnd->procfs_iface)) { -+ printk(KERN_INFO "%s: interface renamed to '%s'\n", -+ DRIVER_NAME, net_dev->name); -+ wrap_procfs_remove_ndis_device(wnd); -+ wrap_procfs_add_ndis_device(wnd); -+ } -+ } -+ return NOTIFY_DONE; -+} -+ -+static struct notifier_block netdev_notifier = { -+ .notifier_call = notifier_event, -+}; -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29) -+static const struct net_device_ops ndis_netdev_ops = { -+ .ndo_init = ndis_net_dev_init, -+ .ndo_uninit = ndis_net_dev_uninit, -+ .ndo_open = ndis_net_dev_open, -+ .ndo_stop = ndis_net_dev_close, -+ .ndo_start_xmit = tx_skbuff, -+ .ndo_change_mtu = ndis_change_mtu, -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0) -+ .ndo_set_rx_mode = ndis_set_multicast_list, -+#else -+ .ndo_set_multicast_list = ndis_set_multicast_list, -+#endif -+ .ndo_set_mac_address = ndis_set_mac_address, -+ .ndo_get_stats = ndis_get_stats, -+#ifdef CONFIG_NET_POLL_CONTROLLER -+ .ndo_poll_controller = ndis_poll_controller, -+#endif -+}; -+#endif -+ -+static NDIS_STATUS ndis_start_device(struct ndis_device *wnd) -+{ -+ struct wrap_device *wd; -+ struct net_device *net_dev; -+ NDIS_STATUS status; -+ char *buf; -+ const int buf_len = 256; -+ mac_address mac; -+ struct transport_header_offset *tx_header_offset; -+ int n; -+ -+ ENTER2("%d", in_atomic()); -+ status = mp_init(wnd); -+ if (status == NDIS_STATUS_NOT_RECOGNIZED) -+ EXIT1(return NDIS_STATUS_SUCCESS); -+ if (status != NDIS_STATUS_SUCCESS) -+ EXIT1(return status); -+ wd = wnd->wd; -+ net_dev = wnd->net_dev; -+ -+ get_supported_oids(wnd); -+ memset(mac, 0, sizeof(mac)); -+ status = mp_query(wnd, OID_802_3_CURRENT_ADDRESS, mac, sizeof(mac)); -+ if (memcmp(mac, "\x00\x00\x00\x00\x00\x00", sizeof(mac)) == 0) { -+ status = mp_query(wnd, OID_802_3_PERMANENT_ADDRESS, mac, -+ sizeof(mac)); -+ if (status != NDIS_STATUS_SUCCESS) { -+ ERROR("couldn't get mac address: %08X", status); -+ goto err_start; -+ } -+ } -+ TRACE1("mac:" MACSTRSEP, MAC2STR(mac)); -+ memcpy(net_dev->dev_addr, mac, ETH_ALEN); -+ -+ strncpy(net_dev->name, if_name, IFNAMSIZ - 1); -+ net_dev->name[IFNAMSIZ - 1] = 0; -+ -+ wnd->packet_filter = NDIS_PACKET_TYPE_DIRECTED | -+ NDIS_PACKET_TYPE_BROADCAST | NDIS_PACKET_TYPE_MULTICAST; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29) -+ net_dev->netdev_ops = &ndis_netdev_ops; -+#else -+ net_dev->init = ndis_net_dev_init; -+ net_dev->uninit = ndis_net_dev_uninit; -+ net_dev->open = ndis_net_dev_open; -+ net_dev->hard_start_xmit = tx_skbuff; -+ net_dev->stop = ndis_net_dev_close; -+ net_dev->get_stats = ndis_get_stats; -+ net_dev->change_mtu = ndis_change_mtu; -+ net_dev->set_multicast_list = ndis_set_multicast_list; -+ net_dev->set_mac_address = ndis_set_mac_address; -+#ifdef CONFIG_NET_POLL_CONTROLLER -+ net_dev->poll_controller = ndis_poll_controller; -+#endif -+#endif -+#ifdef CONFIG_WIRELESS_EXT -+ if (wnd->physical_medium == NdisPhysicalMediumWirelessLan) { -+ net_dev->wireless_handlers = &ndis_handler_def; -+ } -+#endif -+ net_dev->ethtool_ops = &ndis_ethtool_ops; -+ if (wnd->mp_interrupt) -+ net_dev->irq = wnd->mp_interrupt->irq; -+ net_dev->mem_start = wnd->mem_start; -+ net_dev->mem_end = wnd->mem_end; -+ status = mp_query_int(wnd, OID_802_3_MAXIMUM_LIST_SIZE, -+ &wnd->multicast_size); -+ if (status != NDIS_STATUS_SUCCESS || wnd->multicast_size < 0) -+ wnd->multicast_size = 0; -+ if (wnd->multicast_size > 0) -+ net_dev->flags |= IFF_MULTICAST; -+ else -+ net_dev->flags &= ~IFF_MULTICAST; -+ -+ buf = kmalloc(buf_len, GFP_KERNEL); -+ if (!buf) { -+ WARNING("couldn't allocate memory"); -+ goto err_start; -+ } -+ -+ set_task_offload(wnd, buf, buf_len); -+#ifdef NETIF_F_LLTX -+ net_dev->features |= NETIF_F_LLTX; -+#endif -+ -+ if (register_netdev(net_dev)) { -+ ERROR("cannot register net device %s", net_dev->name); -+ goto err_register; -+ } -+ memset(buf, 0, buf_len); -+ status = mp_query(wnd, OID_GEN_VENDOR_DESCRIPTION, buf, buf_len); -+ if (status != NDIS_STATUS_SUCCESS) { -+ WARNING("couldn't get vendor information: 0x%x", status); -+ buf[0] = 0; -+ } -+ wnd->drv_ndis_version = n = 0; -+ mp_query_int(wnd, OID_GEN_DRIVER_VERSION, &wnd->drv_ndis_version); -+ mp_query_int(wnd, OID_GEN_VENDOR_DRIVER_VERSION, &n); -+ -+ printk(KERN_INFO "%s: ethernet device " MACSTRSEP " using %sNDIS " -+ "driver: %s, version: 0x%x, NDIS version: 0x%x, vendor: '%s', " -+ "%s\n", net_dev->name, MAC2STR(net_dev->dev_addr), -+ deserialized_driver(wnd) ? "" : "serialized ", -+ wd->driver->name, n, wnd->drv_ndis_version, buf, -+ wd->conf_file_name); -+ -+ if (deserialized_driver(wnd)) { -+ /* deserialized drivers don't have a limit, but we -+ * keep max at TX_RING_SIZE */ -+ wnd->max_tx_packets = TX_RING_SIZE; -+ } else { -+ status = mp_query_int(wnd, OID_GEN_MAXIMUM_SEND_PACKETS, -+ &wnd->max_tx_packets); -+ if (status != NDIS_STATUS_SUCCESS) -+ wnd->max_tx_packets = 1; -+ if (wnd->max_tx_packets > TX_RING_SIZE) -+ wnd->max_tx_packets = TX_RING_SIZE; -+ } -+ TRACE2("maximum send packets: %d", wnd->max_tx_packets); -+ NdisAllocatePacketPoolEx(&status, &wnd->tx_packet_pool, -+ wnd->max_tx_packets, 0, -+ PROTOCOL_RESERVED_SIZE_IN_PACKET); -+ if (status != NDIS_STATUS_SUCCESS) { -+ ERROR("couldn't allocate packet pool"); -+ goto packet_pool_err; -+ } -+ NdisAllocateBufferPool(&status, &wnd->tx_buffer_pool, -+ wnd->max_tx_packets + 4); -+ if (status != NDIS_STATUS_SUCCESS) { -+ ERROR("couldn't allocate buffer pool"); -+ goto buffer_pool_err; -+ } -+ TRACE1("pool: %p", wnd->tx_buffer_pool); -+ -+ if (mp_query_int(wnd, OID_GEN_MAXIMUM_TOTAL_SIZE, &n) == -+ NDIS_STATUS_SUCCESS && n > ETH_HLEN) -+ ndis_change_mtu(wnd->net_dev, n - ETH_HLEN); -+ -+ if (mp_query_int(wnd, OID_GEN_MAC_OPTIONS, &n) == NDIS_STATUS_SUCCESS) -+ TRACE2("mac options supported: 0x%x", n); -+ -+ tx_header_offset = (typeof(tx_header_offset))buf; -+ tx_header_offset->protocol_type = NDIS_PROTOCOL_ID_TCP_IP; -+ tx_header_offset->header_offset = sizeof(ETH_HLEN); -+ status = mp_set(wnd, OID_GEN_TRANSPORT_HEADER_OFFSET, -+ tx_header_offset, sizeof(*tx_header_offset)); -+ TRACE2("%08X", status); -+ -+ status = mp_query_int(wnd, OID_GEN_PHYSICAL_MEDIUM, -+ &wnd->physical_medium); -+ if (status != NDIS_STATUS_SUCCESS) -+ wnd->physical_medium = NdisPhysicalMediumUnspecified; -+ -+#ifdef CONFIG_WIRELESS_EXT -+ if (wnd->physical_medium == NdisPhysicalMediumWirelessLan) { -+ mp_set_int(wnd, OID_802_11_POWER_MODE, NDIS_POWER_OFF); -+ get_encryption_capa(wnd, buf, buf_len); -+ TRACE1("capabilities = %ld", wnd->capa.encr); -+ printk(KERN_INFO "%s: encryption modes supported: " -+ "%s%s%s%s%s%s%s\n", net_dev->name, -+ test_bit(Ndis802_11Encryption1Enabled, &wnd->capa.encr) ? -+ "WEP" : "none", -+ -+ test_bit(Ndis802_11Encryption2Enabled, &wnd->capa.encr) ? -+ "; TKIP with WPA" : "", -+ test_bit(Ndis802_11AuthModeWPA2, &wnd->capa.auth) ? -+ ", WPA2" : "", -+ test_bit(Ndis802_11AuthModeWPA2PSK, &wnd->capa.auth) ? -+ ", WPA2-PSK" : "", -+ -+ test_bit(Ndis802_11Encryption3Enabled, &wnd->capa.encr) ? -+ "; AES/CCMP with WPA" : "", -+ test_bit(Ndis802_11AuthModeWPA2, &wnd->capa.auth) ? -+ ", WPA2" : "", -+ test_bit(Ndis802_11AuthModeWPA2PSK, &wnd->capa.auth) ? -+ ", WPA2-PSK" : ""); -+ -+ set_default_iw_params(wnd); -+ } -+#endif -+ kfree(buf); -+ hangcheck_add(wnd); -+ add_iw_stats_timer(wnd); -+ EXIT1(return NDIS_STATUS_SUCCESS); -+ -+buffer_pool_err: -+ wnd->tx_buffer_pool = NULL; -+ if (wnd->tx_packet_pool) { -+ NdisFreePacketPool(wnd->tx_packet_pool); -+ wnd->tx_packet_pool = NULL; -+ } -+packet_pool_err: -+ unregister_netdev(net_dev); -+ wnd->max_tx_packets = 0; -+err_register: -+ kfree(buf); -+err_start: -+ mp_halt(wnd); -+ EXIT1(return NDIS_STATUS_FAILURE); -+} -+ -+static int ndis_remove_device(struct ndis_device *wnd) -+{ -+ s8 tx_pending; -+ int our_mutex; -+ -+ /* prevent setting essid during disassociation */ -+ memset(&wnd->essid, 0, sizeof(wnd->essid)); -+ wnd->tx_ok = 0; -+ netif_carrier_off(wnd->net_dev); -+ if (wnd->max_tx_packets) -+ unregister_netdev(wnd->net_dev); -+ /* if device is suspended, but resume failed, tx_ring_mutex -+ * may already be locked */ -+ our_mutex = mutex_trylock(&wnd->tx_ring_mutex); -+ if (!our_mutex) -+ WARNING("couldn't obtain tx_ring_mutex"); -+ spin_lock_bh(&wnd->tx_ring_lock); -+ tx_pending = wnd->tx_ring_end - wnd->tx_ring_start; -+ if (tx_pending < 0) -+ tx_pending += TX_RING_SIZE; -+ else if (tx_pending == 0 && wnd->is_tx_ring_full) -+ tx_pending = TX_RING_SIZE - 1; -+ wnd->is_tx_ring_full = 0; -+ /* throw away pending packets */ -+ while (tx_pending-- > 0) { -+ struct ndis_packet *packet; -+ -+ packet = wnd->tx_ring[wnd->tx_ring_start]; -+ free_tx_packet(wnd, packet, NDIS_STATUS_CLOSING); -+ wnd->tx_ring_start = (wnd->tx_ring_start + 1) % TX_RING_SIZE; -+ } -+ spin_unlock_bh(&wnd->tx_ring_lock); -+ if (our_mutex) -+ mutex_unlock(&wnd->tx_ring_mutex); -+ mp_halt(wnd); -+ ndis_exit_device(wnd); -+ -+ if (wnd->tx_packet_pool) { -+ NdisFreePacketPool(wnd->tx_packet_pool); -+ wnd->tx_packet_pool = NULL; -+ } -+ if (wnd->tx_buffer_pool) { -+ NdisFreeBufferPool(wnd->tx_buffer_pool); -+ wnd->tx_buffer_pool = NULL; -+ } -+ kfree(wnd->pmkids); -+ printk(KERN_INFO "%s: device %s removed\n", DRIVER_NAME, -+ wnd->net_dev->name); -+ kfree(wnd->nmb); -+ free_netdev(wnd->net_dev); -+ EXIT2(return 0); -+} -+ -+static NTSTATUS ndis_add_device(struct driver_object *drv_obj, -+ struct device_object *pdo) -+{ -+ struct device_object *fdo; -+ struct ndis_mp_block *nmb; -+ NTSTATUS status; -+ struct ndis_device *wnd; -+ struct net_device *net_dev; -+ struct wrap_device *wd; -+ unsigned long i; -+ -+ ENTER2("%p, %p", drv_obj, pdo); -+ if (strlen(if_name) >= IFNAMSIZ) { -+ ERROR("interface name '%s' is too long", if_name); -+ return STATUS_INVALID_PARAMETER; -+ } -+ net_dev = alloc_etherdev(sizeof(*wnd)); -+ if (!net_dev) { -+ ERROR("couldn't allocate device"); -+ return STATUS_RESOURCES; -+ } -+ wd = pdo->reserved; -+ if (wrap_is_pci_bus(wd->dev_bus)) -+ SET_NETDEV_DEV(net_dev, &wd->pci.pdev->dev); -+ if (wrap_is_usb_bus(wd->dev_bus)) -+ SET_NETDEV_DEV(net_dev, &wd->usb.intf->dev); -+ status = IoCreateDevice(drv_obj, 0, NULL, FILE_DEVICE_UNKNOWN, 0, -+ FALSE, &fdo); -+ if (status != STATUS_SUCCESS) { -+ free_netdev(net_dev); -+ EXIT2(return status); -+ } -+ wnd = netdev_priv(net_dev); -+ TRACE1("wnd: %p", wnd); -+ -+ nmb = kmalloc(sizeof(*nmb), GFP_KERNEL); -+ if (!nmb) { -+ WARNING("couldn't allocate memory"); -+ IoDeleteDevice(fdo); -+ free_netdev(net_dev); -+ return STATUS_RESOURCES; -+ } -+#if DEBUG >= 6 -+ /* poison nmb so if a driver accesses uninitialized pointers, we -+ * know what it is */ -+ for (i = 0; i < sizeof(*nmb) / sizeof(unsigned long); i++) -+ ((unsigned long *)nmb)[i] = i + 0x8a3fc1; -+#endif -+ -+ wnd->nmb = nmb; -+ nmb->wnd = wnd; -+ nmb->pdo = pdo; -+ wnd->wd = wd; -+ wnd->net_dev = net_dev; -+ fdo->reserved = wnd; -+ nmb->fdo = fdo; -+ if (ndis_init_device(wnd)) { -+ IoDeleteDevice(fdo); -+ kfree(nmb); -+ free_netdev(net_dev); -+ EXIT1(return STATUS_RESOURCES); -+ } -+ nmb->next_device = IoAttachDeviceToDeviceStack(fdo, pdo); -+ spin_lock_init(&wnd->tx_ring_lock); -+ mutex_init(&wnd->tx_ring_mutex); -+ mutex_init(&wnd->ndis_req_mutex); -+ wnd->ndis_req_done = 0; -+ INIT_WORK(&wnd->tx_work, tx_worker); -+ wnd->tx_ring_start = 0; -+ wnd->tx_ring_end = 0; -+ wnd->is_tx_ring_full = 0; -+ wnd->capa.encr = 0; -+ wnd->capa.auth = 0; -+ wnd->attributes = 0; -+ wnd->dma_map_count = 0; -+ wnd->dma_map_addr = NULL; -+ wnd->nick[0] = 0; -+ init_timer(&wnd->hangcheck_timer); -+ wnd->scan_timestamp = 0; -+ init_timer(&wnd->iw_stats_timer); -+ wnd->iw_stats_interval = 10 * HZ; -+ wnd->ndis_pending_work = 0; -+ memset(&wnd->essid, 0, sizeof(wnd->essid)); -+ memset(&wnd->encr_info, 0, sizeof(wnd->encr_info)); -+ wnd->infrastructure_mode = Ndis802_11Infrastructure; -+ INIT_WORK(&wnd->ndis_work, wrapndis_worker); -+ wnd->iw_stats_enabled = TRUE; -+ -+ TRACE1("nmb: %p, pdo: %p, fdo: %p, attached: %p, next: %p", -+ nmb, pdo, fdo, fdo->attached, nmb->next_device); -+ -+ /* dispatch routines are called as Windows functions */ -+ for (i = 0; i <= IRP_MJ_MAXIMUM_FUNCTION; i++) -+ drv_obj->major_func[i] = WIN_FUNC_PTR(IoPassIrpDown,2); -+ -+ drv_obj->major_func[IRP_MJ_PNP] = WIN_FUNC_PTR(NdisDispatchPnp,2); -+ drv_obj->major_func[IRP_MJ_POWER] = WIN_FUNC_PTR(NdisDispatchPower,2); -+ drv_obj->major_func[IRP_MJ_INTERNAL_DEVICE_CONTROL] = -+ WIN_FUNC_PTR(NdisDispatchDeviceControl,2); -+// drv_obj->major_func[IRP_MJ_DEVICE_CONTROL] = -+// WIN_FUNC_PTR(NdisDispatchDeviceControl,2); -+ EXIT2(return STATUS_SUCCESS); -+} -+ -+int init_ndis_driver(struct driver_object *drv_obj) -+{ -+ ENTER1("%p", drv_obj); -+ drv_obj->drv_ext->add_device = ndis_add_device; -+ return 0; -+} -+ -+int wrapndis_init(void) -+{ -+ wrapndis_wq = create_singlethread_workqueue("wrapndis_wq"); -+ if (!wrapndis_wq) -+ EXIT1(return -ENOMEM); -+ TRACE1("wrapndis_wq: %p", wrapndis_wq); -+ register_netdevice_notifier(&netdev_notifier); -+ return 0; -+} -+ -+void wrapndis_exit(void) -+{ -+ unregister_netdevice_notifier(&netdev_notifier); -+ if (wrapndis_wq) -+ destroy_workqueue(wrapndis_wq); -+} -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/wrapndis.h linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapndis.h ---- linux-4.12.4/3rdparty/ndiswrapper/wrapndis.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapndis.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,86 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifndef _WRAPNDIS_H_ -+#define _WRAPNDIS_H_ -+ -+#include "ndis.h" -+#include "pnp.h" -+ -+int wrapndis_init(void); -+void wrapndis_exit(void); -+ -+NDIS_STATUS mp_reset(struct ndis_device *wnd); -+ -+NDIS_STATUS mp_request(enum ndis_request_type request, -+ struct ndis_device *wnd, ndis_oid oid, -+ void *buf, ULONG buflen, ULONG *written, ULONG *needed); -+ -+static inline NDIS_STATUS mp_query_info(struct ndis_device *wnd, -+ ndis_oid oid, void *buf, ULONG buflen, -+ ULONG *written, ULONG *needed) -+{ -+ return mp_request(NdisRequestQueryInformation, wnd, oid, -+ buf, buflen, written, needed); -+} -+ -+static inline NDIS_STATUS mp_set_info(struct ndis_device *wnd, -+ ndis_oid oid, void *buf, ULONG buflen, -+ ULONG *written, ULONG *needed) -+{ -+ return mp_request(NdisRequestSetInformation, wnd, oid, -+ buf, buflen, written, needed); -+} -+ -+static inline NDIS_STATUS mp_query(struct ndis_device *wnd, ndis_oid oid, -+ void *buf, ULONG buflen) -+{ -+ return mp_request(NdisRequestQueryInformation, wnd, oid, -+ buf, buflen, NULL, NULL); -+} -+ -+static inline NDIS_STATUS mp_query_int(struct ndis_device *wnd, -+ ndis_oid oid, ULONG *data) -+{ -+ return mp_request(NdisRequestQueryInformation, wnd, oid, -+ data, sizeof(ULONG), NULL, NULL); -+} -+ -+static inline NDIS_STATUS mp_set(struct ndis_device *wnd, ndis_oid oid, -+ void *buf, ULONG buflen) -+{ -+ return mp_request(NdisRequestSetInformation, wnd, oid, -+ buf, buflen, NULL, NULL); -+} -+ -+static inline NDIS_STATUS mp_set_int(struct ndis_device *wnd, -+ ndis_oid oid, ULONG data) -+{ -+ return mp_request(NdisRequestSetInformation, wnd, oid, -+ &data, sizeof(ULONG), NULL, NULL); -+} -+ -+void free_tx_packet(struct ndis_device *wnd, struct ndis_packet *packet, -+ NDIS_STATUS status); -+int init_ndis_driver(struct driver_object *drv_obj); -+NDIS_STATUS ndis_reinit(struct ndis_device *wnd); -+void set_media_state(struct ndis_device *wnd, enum ndis_media_state state); -+ -+void hangcheck_add(struct ndis_device *wnd); -+void hangcheck_del(struct ndis_device *wnd); -+ -+struct iw_statistics *get_iw_stats(struct net_device *dev); -+ -+#endif -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/wrapper.c linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapper.c ---- linux-4.12.4/3rdparty/ndiswrapper/wrapper.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapper.c 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,111 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#include "ndis.h" -+#include "iw_ndis.h" -+#include "loader.h" -+#include "pnp.h" -+#include "wrapper.h" -+ -+char *if_name = "wlan%d"; -+int proc_uid, proc_gid; -+int hangcheck_interval; -+static char *utils_version = UTILS_VERSION; -+int debug = DEBUG; -+ -+module_param(if_name, charp, 0400); -+MODULE_PARM_DESC(if_name, "Network interface name or template " -+ "(default: wlan%d)"); -+module_param(proc_uid, int, 0600); -+MODULE_PARM_DESC(proc_uid, "The uid of the files created in /proc " -+ "(default: 0)."); -+module_param(proc_gid, int, 0600); -+MODULE_PARM_DESC(proc_gid, "The gid of the files created in /proc " -+ "(default: 0)."); -+module_param(debug, int, 0600); -+MODULE_PARM_DESC(debug, "debug level"); -+ -+/* 0 - default value provided by NDIS driver, -+ * positive value - force hangcheck interval to that many seconds -+ * negative value - disable hangcheck -+ */ -+module_param(hangcheck_interval, int, 0600); -+MODULE_PARM_DESC(hangcheck_interval, "The interval, in seconds, for checking" -+ " if driver is hung. (default: 0)"); -+ -+module_param(utils_version, charp, 0400); -+MODULE_PARM_DESC(utils_version, "Compatible version of utils " -+ "(read only: " UTILS_VERSION ")"); -+ -+MODULE_AUTHOR("ndiswrapper team "); -+#ifdef MODULE_DESCRIPTION -+MODULE_DESCRIPTION("NDIS wrapper driver"); -+#endif -+#ifdef MODULE_VERSION -+MODULE_VERSION(DRIVER_VERSION); -+#endif -+MODULE_LICENSE("GPL"); -+ -+static void module_cleanup(void) -+{ -+ loader_exit(); -+ usb_exit(); -+ wrap_procfs_remove(); -+ wrapndis_exit(); -+ ndis_exit(); -+ ntoskernel_exit(); -+ wrapmem_exit(); -+} -+ -+static int __init wrapper_init(void) -+{ -+#ifdef TAINT_OOT_MODULE -+ add_taint(TAINT_OOT_MODULE, LOCKDEP_NOW_UNRELIABLE); -+#endif -+ printk(KERN_INFO "%s version %s loaded (smp=%s, preempt=%s)\n", -+ DRIVER_NAME, DRIVER_VERSION, -+#ifdef CONFIG_SMP -+ "yes" -+#else -+ "no" -+#endif -+ , -+#ifdef CONFIG_PREEMPT_RT -+ "rt" -+#elif defined(CONFIG_PREEMPT) -+ "yes" -+#else -+ "no" -+#endif -+ ); -+ -+ if (wrapmem_init() || ntoskernel_init() || ndis_init() || -+ wrapndis_init() || usb_init() || wrap_procfs_init() || -+ loader_init()) { -+ module_cleanup(); -+ ERROR("%s: initialization failed", DRIVER_NAME); -+ return -EINVAL; -+ } -+ EXIT1(return 0); -+} -+ -+static void __exit wrapper_exit(void) -+{ -+ ENTER1(""); -+ module_cleanup(); -+} -+ -+module_init(wrapper_init); -+module_exit(wrapper_exit); -diff -Nurp linux-4.12.4/3rdparty/ndiswrapper/wrapper.h linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapper.h ---- linux-4.12.4/3rdparty/ndiswrapper/wrapper.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.12.4-3rd/3rdparty/ndiswrapper/wrapper.h 2016-10-09 18:45:08.027226096 +0300 -@@ -0,0 +1,24 @@ -+/* -+ * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ * -+ * This program is distributed in the hope that it will be useful, -+ * but WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -+ * GNU General Public License for more details. -+ * -+ */ -+ -+#ifndef WRAPPER_H -+#define WRAPPER_H -+ -+extern char *if_name; -+extern int proc_uid; -+extern int proc_gid; -+extern int hangcheck_interval; -+ -+#endif /* WRAPPER_H */ diff --git a/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-4.10-buildfix.patch b/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-4.10-buildfix.patch deleted file mode 100644 index bf5f1f81..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-4.10-buildfix.patch +++ /dev/null @@ -1,43 +0,0 @@ - -last_rx is gone, most drivers does not really need/use it anyway. - -Also, include signal.h to fix implicit deklaration of function â€signal_pending†- -Signed-off-by: Thomas Backlund - ---- linux/3rdparty/ndiswrapper/ndis.c.orig 2016-10-09 18:45:08.027226096 +0300 -+++ linux/3rdparty/ndiswrapper/ndis.c 2017-08-04 00:09:49.264110609 +0300 -@@ -2258,7 +2258,6 @@ wstdcall void NdisMIndicateReceivePacket - WARNING("empty packet ignored"); - continue; - } -- wnd->net_dev->last_rx = jiffies; - /* get total number of bytes in packet */ - NdisGetFirstBufferFromPacketSafe(packet, &buffer, &virt, - &length, &total_length, -@@ -2346,7 +2345,6 @@ wstdcall void EthRxIndicateHandler(struc - ERROR("nmb is NULL"); - EXIT3(return); - } -- wnd->net_dev->last_rx = jiffies; - - if (look_ahead_size < packet_size) { - struct ndis_packet *packet; -@@ -2461,7 +2459,6 @@ wstdcall void NdisMTransferDataComplete( - WARNING("illegal packet"); - EXIT3(return); - } -- wnd->net_dev->last_rx = jiffies; - oob_data = NDIS_PACKET_OOB_DATA(packet); - skb_size = sizeof(oob_data->header) + oob_data->look_ahead_size + - bytes_txed; ---- linux/3rdparty/ndiswrapper/ntoskernel.h.orig 2017-08-03 23:52:29.015367906 +0300 -+++ linux/3rdparty/ndiswrapper/ntoskernel.h 2017-08-04 00:17:41.334914691 +0300 -@@ -33,6 +33,7 @@ - #include - #include - #include -+#include - #include - #include - #include diff --git a/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-4.13-buildfix.patch b/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-4.13-buildfix.patch deleted file mode 100644 index a2611504..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-4.13-buildfix.patch +++ /dev/null @@ -1,16 +0,0 @@ - -__GFP_REPEAT is now __GFP_RETRY_MAYFAIL - -Signed-off-by: Thomas Backlund - ---- linux/3rdparty/ndiswrapper/ntoskernel.h.orig 2017-10-15 01:11:56.041892449 +0300 -+++ linux/3rdparty/ndiswrapper/ntoskernel.h 2017-10-15 01:11:06.159204294 +0300 -@@ -122,7 +122,7 @@ static cpumask_t cpumasks[NR_CPUS]; - - #define PCI_DMA_ALLOC_COHERENT(pci_dev,size,dma_handle) \ - dma_alloc_coherent(&pci_dev->dev,size,dma_handle, \ -- GFP_KERNEL | __GFP_REPEAT) -+ GFP_KERNEL | __GFP_RETRY_MAYFAIL) - #define PCI_DMA_FREE_COHERENT(pci_dev,size,cpu_addr,dma_handle) \ - dma_free_coherent(&pci_dev->dev,size,cpu_addr,dma_handle) - #define PCI_DMA_MAP_SINGLE(pci_dev,addr,size,direction) \ diff --git a/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-Kconfig.patch b/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-Kconfig.patch deleted file mode 100644 index f7d26e62..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-Kconfig.patch +++ /dev/null @@ -1,7 +0,0 @@ ---- linux-2.6.24.orig/3rdparty/ndiswrapper/Kconfig 1969-12-31 21:00:00.000000000 -0300 -+++ linux-2.6.24/3rdparty/ndiswrapper/Kconfig 2007-11-26 15:11:31.000000000 -0200 -@@ -0,0 +1,4 @@ -+ -+config NDISWRAPPER -+ tristate "NDIS driver wrapper support" -+ depends on PCI && USB && !X86_64_XEN diff --git a/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-Makefile-build-fix.patch b/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-Makefile-build-fix.patch deleted file mode 100644 index b44f4b29..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-ndiswrapper-Makefile-build-fix.patch +++ /dev/null @@ -1,45 +0,0 @@ ---- linux-3.12.2-ndiswrapper-1.59/3rdparty/ndiswrapper/Makefile.orig 2013-11-28 21:42:10.000000000 +0200 -+++ linux-3.12.2-ndiswrapper-1.59/3rdparty/ndiswrapper/Makefile 2013-11-30 21:41:19.550504380 +0200 -@@ -9,24 +9,10 @@ DISTFILES = \ - winnt_types.h workqueue.c wrapmem.c wrapmem.h wrapndis.c wrapndis.h \ - wrapper.c wrapper.h - --# By default, we try to compile the modules for the currently running --# kernel. But it's the first approximation, as we will re-read the --# version from the kernel sources. --KVERS_UNAME ?= $(shell uname -r) -- - # KBUILD is the path to the Linux kernel build tree. It is usually the - # same as the kernel source tree, except when the kernel was compiled in - # a separate directory. --KBUILD ?= $(shell readlink -f /lib/modules/$(KVERS_UNAME)/build) -- --ifeq (,$(KBUILD)) --$(error Kernel build tree not found - please set KBUILD to configured kernel) --endif -- --KCONFIG := $(KBUILD)/.config --ifeq (,$(wildcard $(KCONFIG))) --$(error No .config found in $(KBUILD), please set KBUILD to configured kernel) --endif -+KBUILD ?= $(srctree) - - ifneq (,$(wildcard $(KBUILD)/include/linux/version.h)) - ifneq (,$(wildcard $(KBUILD)/include/generated/uapi/linux/version.h)) -@@ -43,16 +29,9 @@ endif - ifeq (,$(wildcard $(VERSION_H))) - VERSION_H := $(KBUILD)/include/linux/version.h - endif --ifeq (,$(wildcard $(VERSION_H))) --$(error Please run 'make modules_prepare' in $(KBUILD)) --endif - - KVERS := $(shell sed -ne 's/"//g;s/^\#define UTS_RELEASE //p' $(VERSION_H)) - --ifeq (,$(KVERS)) --$(error Cannot find UTS_RELEASE in $(VERSION_H), please report) --endif -- - INST_DIR = /lib/modules/$(KVERS)/misc - - SRC_DIR=$(shell pwd) diff --git a/kernel/kernel/files/patches/mageia/3rd-rfswitch-1.3.patch b/kernel/kernel/files/patches/mageia/3rd-rfswitch-1.3.patch deleted file mode 100644 index e87bf7e0..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-rfswitch-1.3.patch +++ /dev/null @@ -1,978 +0,0 @@ - 3rdparty/rfswitch/FILES | 6 - 3rdparty/rfswitch/ISSUES | 28 +++ - 3rdparty/rfswitch/Kconfig | 22 ++ - 3rdparty/rfswitch/LICENSE | 339 +++++++++++++++++++++++++++++++++++++++++++++ - 3rdparty/rfswitch/Makefile | 119 +++++++++++++++ - 3rdparty/rfswitch/README | 44 +++++ - 3rdparty/rfswitch/av5100.c | 174 +++++++++++++++++++++++ - 3rdparty/rfswitch/pbe5.c | 205 +++++++++++++++++++++++++++ - 8 files changed, 937 insertions(+) -diff -Nurp linux-2.6.37/3rdparty/rfswitch/av5100.c linux-2.6.37.3rdparty/3rdparty/rfswitch/av5100.c ---- linux-2.6.37/3rdparty/rfswitch/av5100.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/rfswitch/av5100.c 2008-03-28 05:25:28.000000000 +0200 -@@ -0,0 +1,174 @@ -+/******************************************************************************* -+ -+ Copyright(c) 2003 - 2004 Intel Corporation. All rights reserved. -+ -+ This program is free software; you can redistribute it and/or modify it -+ under the terms of version 2 of the GNU General Public License as -+ published by the Free Software Foundation. -+ -+ This program is distributed in the hope that it will be useful, but WITHOUT -+ ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ more details. -+ -+ You should have received a copy of the GNU General Public License along with -+ this program; if not, write to the Free Software Foundation, Inc., 59 -+ Temple Place - Suite 330, Boston, MA 02111-1307, USA. -+ -+ The full GNU General Public License is included in this distribution in the -+ file called LICENSE. -+ -+ Contact Information: -+ James P. Ketrenos -+ Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 -+ -+*******************************************************************************/ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+ -+#define DRV_NAME "av5100" -+#define DRV_VERSION "1.3" -+#define DRV_DESCRIPTION "SW RF kill switch for Averatec 5100P" -+#define DRV_COPYRIGHT "Copyright(c) 2003-2004 Intel Corporation" -+ -+static int radio = 1; -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) -+ -+MODULE_PARM(radio, "i"); -+ -+#else /* LINUX_VERSION_CODE < 2.6.0 */ -+ -+#include -+module_param(radio, int, 1); -+ -+#endif /* LINUX_VERSION_CODE < 2.6.0 */ -+ -+MODULE_PARM_DESC(radio, "controls state of radio (1=on, 0=off)"); -+ -+MODULE_DESCRIPTION(DRV_DESCRIPTION); -+MODULE_AUTHOR(DRV_COPYRIGHT); -+MODULE_LICENSE("GPL"); -+ -+#define AV5100_RADIO_ON (0xe0) -+#define AV5100_RADIO_OFF (0xe1) -+ -+static int av5100_radio = AV5100_RADIO_OFF; -+ -+static void av5100_set_radio(int state) -+{ -+ printk(KERN_INFO DRV_NAME ": Radio being turned %s\n", -+ (state == AV5100_RADIO_ON) ? "ON" : "OFF"); -+ outl(0x80020800, 0xcf8); -+ outb(0x6f, 0x0072); -+ outl(0x1800ffff, 0x1184); -+ outb(state, 0x00b2); -+ av5100_radio = state; -+} -+ -+ -+/* -+ * proc stuff -+ */ -+static struct proc_dir_entry *dir_base = NULL; -+ -+static int proc_set_radio(struct file *file, const char *buffer, -+ unsigned long count, void *data) -+{ -+ av5100_set_radio(buffer[0] == '0' ? AV5100_RADIO_OFF : AV5100_RADIO_ON); -+ -+ return count; -+} -+ -+static int proc_get_radio(char *page, char **start, off_t offset, -+ int count, int *eof, void *data) -+{ -+ int len = 0; -+ -+ len += snprintf(page, count, DRV_NAME ": %d\n", -+ av5100_radio == AV5100_RADIO_OFF ? 0 : 1); -+ -+ *eof = 1; -+ return len; -+} -+ -+ -+static void av5100_proc_cleanup(void) -+{ -+ if (dir_base) { -+ remove_proc_entry("radio", dir_base); -+ remove_proc_entry(DRV_NAME, &proc_root); -+ dir_base = NULL; -+ } -+} -+ -+ -+static int av5100_proc_init(void) -+{ -+ struct proc_dir_entry *ent; -+ int err = 0; -+ -+ dir_base = create_proc_entry(DRV_NAME, S_IFDIR, &proc_root); -+ if (dir_base == NULL) { -+ printk(KERN_ERR DRV_NAME ": Unable to initialise /proc/" -+ DRV_NAME "\n"); -+ err = -ENOMEM; -+ goto fail; -+ } -+ -+ -+ ent = create_proc_entry("radio", S_IFREG | S_IRUGO | S_IWUSR, -+ dir_base); -+ if (ent) { -+ ent->read_proc = proc_get_radio; -+ ent->write_proc = proc_set_radio; -+ } else { -+ printk(KERN_ERR -+ "Unable to initialize /proc/" DRV_NAME "/radio\n"); -+ err = -ENOMEM; -+ goto fail; -+ } -+ -+ return 0; -+ -+ fail: -+ av5100_proc_cleanup(); -+ return err; -+} -+ -+/* -+ * module stuff -+ */ -+static int __init av5100_init(void) -+{ -+ av5100_proc_init(); -+ -+ av5100_set_radio((radio == 1) ? AV5100_RADIO_ON : AV5100_RADIO_OFF); -+ -+ return 0; -+} -+ -+static void __exit av5100_exit(void) -+{ -+ av5100_set_radio(AV5100_RADIO_OFF); -+ -+ av5100_proc_cleanup(); -+} -+ -+module_init(av5100_init); -+module_exit(av5100_exit); -+ -+/* -+ 1 2 3 4 5 6 7 -+12345678901234567890123456789012345678901234567890123456789012345678901234567890 -+*/ -diff -Nurp linux-2.6.37/3rdparty/rfswitch/FILES linux-2.6.37.3rdparty/3rdparty/rfswitch/FILES ---- linux-2.6.37/3rdparty/rfswitch/FILES 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/rfswitch/FILES 2004-07-09 07:44:19.000000000 +0300 -@@ -0,0 +1,6 @@ -+Makefile Used for building on 2.4, 2.6, internally and exteranlly -+ -+FILES This file -+ -+av5100.c Averatec 5100P SW Switch Module -+pbe5.c Packard Bell Easynote SW Switch Module -diff -Nurp linux-2.6.37/3rdparty/rfswitch/ISSUES linux-2.6.37.3rdparty/3rdparty/rfswitch/ISSUES ---- linux-2.6.37/3rdparty/rfswitch/ISSUES 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/rfswitch/ISSUES 2004-07-09 07:43:22.000000000 +0300 -@@ -0,0 +1,28 @@ -+ -+ISSUES -+------------ ----- ----- ---- --- -- - -+ -+No packets! - RF kill switch -+ -+If the module loads, but no packets are transferred you may have a SW based -+radio kill switch. All laptops have some capability to disable the radio -+via a button or switch. On some laptops that switch is physically tied to the -+IPW2100; simply toggling the switch should enable the radio. -+ -+On other laptops, the switch is a button that when pressed requires some -+software driver to send some hardware command to some other piece of hardware -+on the laptop, that then controls the radio. The driver currently has support -+for the Averatec 5100P laptop's SW switch. Support will be added for other -+laptop vendors as we become aware of them and figure out how to enable the -+radio. -+ -+To know if the radio is being disabled via the RF switch, perform the following: -+ -+% cat /proc/net/ipw2100/eth1/state -+Radio is disabled by RF switch -+ -+If it says that, then your RF switch is currently disabling the radio. The -+driver doesn't currently support switching back to the on state if you have a -+physical RF switch (the radio may turn on and packets will work, but the proc -+entry won't be updated) -+ -diff -Nurp linux-2.6.37/3rdparty/rfswitch/Kconfig linux-2.6.37.3rdparty/3rdparty/rfswitch/Kconfig ---- linux-2.6.37/3rdparty/rfswitch/Kconfig 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/rfswitch/Kconfig 2008-05-27 23:39:10.000000000 +0300 -@@ -0,0 +1,22 @@ -+menu "RF Switch" -+ depends on EXPERIMENTAL -+ -+config RFSWITCH -+ tristate "RF Switch" -+ depends on EXPERIMENTAL -+ -+config AVERATEC_5100P -+ tristate "averatec 5100P driver" -+ depends on RFSWITCH -+ ---help--- -+ This is an experimental driver for the wireless switch -+ of some laptops (usefull with some ipw2x00 cards) -+ -+config PACKARDBELL_E5 -+ tristate "pbe5 driver" -+ depends on RFSWITCH -+ ---help--- -+ This is an experimental driver for the wireless switch -+ of some laptops (usefull with some ipw2x00 cards) -+ -+endmenu -diff -Nurp linux-2.6.37/3rdparty/rfswitch/LICENSE linux-2.6.37.3rdparty/3rdparty/rfswitch/LICENSE ---- linux-2.6.37/3rdparty/rfswitch/LICENSE 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/rfswitch/LICENSE 2004-07-09 07:43:22.000000000 +0300 -@@ -0,0 +1,339 @@ -+ -+"This software program is licensed subject to the GNU General Public License -+(GPL). Version 2, June 1991, available at -+" -+ -+GNU General Public License -+ -+Version 2, June 1991 -+ -+Copyright (C) 1989, 1991 Free Software Foundation, Inc. -+59 Temple Place - Suite 330, Boston, MA 02111-1307, USA -+ -+Everyone is permitted to copy and distribute verbatim copies of this license -+document, but changing it is not allowed. -+ -+Preamble -+ -+The licenses for most software are designed to take away your freedom to -+share and change it. By contrast, the GNU General Public License is intended -+to guarantee your freedom to share and change free software--to make sure -+the software is free for all its users. This General Public License applies -+to most of the Free Software Foundation's software and to any other program -+whose authors commit to using it. (Some other Free Software Foundation -+software is covered by the GNU Library General Public License instead.) You -+can apply it to your programs, too. -+ -+When we speak of free software, we are referring to freedom, not price. Our -+General Public Licenses are designed to make sure that you have the freedom -+to distribute copies of free software (and charge for this service if you -+wish), that you receive source code or can get it if you want it, that you -+can change the software or use pieces of it in new free programs; and that -+you know you can do these things. -+ -+To protect your rights, we need to make restrictions that forbid anyone to -+deny you these rights or to ask you to surrender the rights. These -+restrictions translate to certain responsibilities for you if you distribute -+copies of the software, or if you modify it. -+ -+For example, if you distribute copies of such a program, whether gratis or -+for a fee, you must give the recipients all the rights that you have. You -+must make sure that they, too, receive or can get the source code. And you -+must show them these terms so they know their rights. -+ -+We protect your rights with two steps: (1) copyright the software, and (2) -+offer you this license which gives you legal permission to copy, distribute -+and/or modify the software. -+ -+Also, for each author's protection and ours, we want to make certain that -+everyone understands that there is no warranty for this free software. If -+the software is modified by someone else and passed on, we want its -+recipients to know that what they have is not the original, so that any -+problems introduced by others will not reflect on the original authors' -+reputations. -+ -+Finally, any free program is threatened constantly by software patents. We -+wish to avoid the danger that redistributors of a free program will -+individually obtain patent licenses, in effect making the program -+proprietary. To prevent this, we have made it clear that any patent must be -+licensed for everyone's free use or not licensed at all. -+ -+The precise terms and conditions for copying, distribution and modification -+follow. -+ -+TERMS AND CONDITIONS FOR COPYING, DISTRIBUTION AND MODIFICATION -+ -+0. This License applies to any program or other work which contains a notice -+ placed by the copyright holder saying it may be distributed under the -+ terms of this General Public License. The "Program", below, refers to any -+ such program or work, and a "work based on the Program" means either the -+ Program or any derivative work under copyright law: that is to say, a -+ work containing the Program or a portion of it, either verbatim or with -+ modifications and/or translated into another language. (Hereinafter, -+ translation is included without limitation in the term "modification".) -+ Each licensee is addressed as "you". -+ -+ Activities other than copying, distribution and modification are not -+ covered by this License; they are outside its scope. The act of running -+ the Program is not restricted, and the output from the Program is covered -+ only if its contents constitute a work based on the Program (independent -+ of having been made by running the Program). Whether that is true depends -+ on what the Program does. -+ -+1. You may copy and distribute verbatim copies of the Program's source code -+ as you receive it, in any medium, provided that you conspicuously and -+ appropriately publish on each copy an appropriate copyright notice and -+ disclaimer of warranty; keep intact all the notices that refer to this -+ License and to the absence of any warranty; and give any other recipients -+ of the Program a copy of this License along with the Program. -+ -+ You may charge a fee for the physical act of transferring a copy, and you -+ may at your option offer warranty protection in exchange for a fee. -+ -+2. You may modify your copy or copies of the Program or any portion of it, -+ thus forming a work based on the Program, and copy and distribute such -+ modifications or work under the terms of Section 1 above, provided that -+ you also meet all of these conditions: -+ -+ * a) You must cause the modified files to carry prominent notices stating -+ that you changed the files and the date of any change. -+ -+ * b) You must cause any work that you distribute or publish, that in -+ whole or in part contains or is derived from the Program or any part -+ thereof, to be licensed as a whole at no charge to all third parties -+ under the terms of this License. -+ -+ * c) If the modified program normally reads commands interactively when -+ run, you must cause it, when started running for such interactive -+ use in the most ordinary way, to print or display an announcement -+ including an appropriate copyright notice and a notice that there is -+ no warranty (or else, saying that you provide a warranty) and that -+ users may redistribute the program under these conditions, and -+ telling the user how to view a copy of this License. (Exception: if -+ the Program itself is interactive but does not normally print such -+ an announcement, your work based on the Program is not required to -+ print an announcement.) -+ -+ These requirements apply to the modified work as a whole. If identifiable -+ sections of that work are not derived from the Program, and can be -+ reasonably considered independent and separate works in themselves, then -+ this License, and its terms, do not apply to those sections when you -+ distribute them as separate works. But when you distribute the same -+ sections as part of a whole which is a work based on the Program, the -+ distribution of the whole must be on the terms of this License, whose -+ permissions for other licensees extend to the entire whole, and thus to -+ each and every part regardless of who wrote it. -+ -+ Thus, it is not the intent of this section to claim rights or contest -+ your rights to work written entirely by you; rather, the intent is to -+ exercise the right to control the distribution of derivative or -+ collective works based on the Program. -+ -+ In addition, mere aggregation of another work not based on the Program -+ with the Program (or with a work based on the Program) on a volume of a -+ storage or distribution medium does not bring the other work under the -+ scope of this License. -+ -+3. You may copy and distribute the Program (or a work based on it, under -+ Section 2) in object code or executable form under the terms of Sections -+ 1 and 2 above provided that you also do one of the following: -+ -+ * a) Accompany it with the complete corresponding machine-readable source -+ code, which must be distributed under the terms of Sections 1 and 2 -+ above on a medium customarily used for software interchange; or, -+ -+ * b) Accompany it with a written offer, valid for at least three years, -+ to give any third party, for a charge no more than your cost of -+ physically performing source distribution, a complete machine- -+ readable copy of the corresponding source code, to be distributed -+ under the terms of Sections 1 and 2 above on a medium customarily -+ used for software interchange; or, -+ -+ * c) Accompany it with the information you received as to the offer to -+ distribute corresponding source code. (This alternative is allowed -+ only for noncommercial distribution and only if you received the -+ program in object code or executable form with such an offer, in -+ accord with Subsection b above.) -+ -+ The source code for a work means the preferred form of the work for -+ making modifications to it. For an executable work, complete source code -+ means all the source code for all modules it contains, plus any -+ associated interface definition files, plus the scripts used to control -+ compilation and installation of the executable. However, as a special -+ exception, the source code distributed need not include anything that is -+ normally distributed (in either source or binary form) with the major -+ components (compiler, kernel, and so on) of the operating system on which -+ the executable runs, unless that component itself accompanies the -+ executable. -+ -+ If distribution of executable or object code is made by offering access -+ to copy from a designated place, then offering equivalent access to copy -+ the source code from the same place counts as distribution of the source -+ code, even though third parties are not compelled to copy the source -+ along with the object code. -+ -+4. You may not copy, modify, sublicense, or distribute the Program except as -+ expressly provided under this License. Any attempt otherwise to copy, -+ modify, sublicense or distribute the Program is void, and will -+ automatically terminate your rights under this License. However, parties -+ who have received copies, or rights, from you under this License will not -+ have their licenses terminated so long as such parties remain in full -+ compliance. -+ -+5. You are not required to accept this License, since you have not signed -+ it. However, nothing else grants you permission to modify or distribute -+ the Program or its derivative works. These actions are prohibited by law -+ if you do not accept this License. Therefore, by modifying or -+ distributing the Program (or any work based on the Program), you -+ indicate your acceptance of this License to do so, and all its terms and -+ conditions for copying, distributing or modifying the Program or works -+ based on it. -+ -+6. Each time you redistribute the Program (or any work based on the -+ Program), the recipient automatically receives a license from the -+ original licensor to copy, distribute or modify the Program subject to -+ these terms and conditions. You may not impose any further restrictions -+ on the recipients' exercise of the rights granted herein. You are not -+ responsible for enforcing compliance by third parties to this License. -+ -+7. If, as a consequence of a court judgment or allegation of patent -+ infringement or for any other reason (not limited to patent issues), -+ conditions are imposed on you (whether by court order, agreement or -+ otherwise) that contradict the conditions of this License, they do not -+ excuse you from the conditions of this License. If you cannot distribute -+ so as to satisfy simultaneously your obligations under this License and -+ any other pertinent obligations, then as a consequence you may not -+ distribute the Program at all. For example, if a patent license would -+ not permit royalty-free redistribution of the Program by all those who -+ receive copies directly or indirectly through you, then the only way you -+ could satisfy both it and this License would be to refrain entirely from -+ distribution of the Program. -+ -+ If any portion of this section is held invalid or unenforceable under any -+ particular circumstance, the balance of the section is intended to apply -+ and the section as a whole is intended to apply in other circumstances. -+ -+ It is not the purpose of this section to induce you to infringe any -+ patents or other property right claims or to contest validity of any -+ such claims; this section has the sole purpose of protecting the -+ integrity of the free software distribution system, which is implemented -+ by public license practices. Many people have made generous contributions -+ to the wide range of software distributed through that system in -+ reliance on consistent application of that system; it is up to the -+ author/donor to decide if he or she is willing to distribute software -+ through any other system and a licensee cannot impose that choice. -+ -+ This section is intended to make thoroughly clear what is believed to be -+ a consequence of the rest of this License. -+ -+8. If the distribution and/or use of the Program is restricted in certain -+ countries either by patents or by copyrighted interfaces, the original -+ copyright holder who places the Program under this License may add an -+ explicit geographical distribution limitation excluding those countries, -+ so that distribution is permitted only in or among countries not thus -+ excluded. In such case, this License incorporates the limitation as if -+ written in the body of this License. -+ -+9. The Free Software Foundation may publish revised and/or new versions of -+ the General Public License from time to time. Such new versions will be -+ similar in spirit to the present version, but may differ in detail to -+ address new problems or concerns. -+ -+ Each version is given a distinguishing version number. If the Program -+ specifies a version number of this License which applies to it and "any -+ later version", you have the option of following the terms and -+ conditions either of that version or of any later version published by -+ the Free Software Foundation. If the Program does not specify a version -+ number of this License, you may choose any version ever published by the -+ Free Software Foundation. -+ -+10. If you wish to incorporate parts of the Program into other free programs -+ whose distribution conditions are different, write to the author to ask -+ for permission. For software which is copyrighted by the Free Software -+ Foundation, write to the Free Software Foundation; we sometimes make -+ exceptions for this. Our decision will be guided by the two goals of -+ preserving the free status of all derivatives of our free software and -+ of promoting the sharing and reuse of software generally. -+ -+ NO WARRANTY -+ -+11. BECAUSE THE PROGRAM IS LICENSED FREE OF CHARGE, THERE IS NO WARRANTY -+ FOR THE PROGRAM, TO THE EXTENT PERMITTED BY APPLICABLE LAW. EXCEPT WHEN -+ OTHERWISE STATED IN WRITING THE COPYRIGHT HOLDERS AND/OR OTHER PARTIES -+ PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY OF ANY KIND, EITHER -+ EXPRESSED OR IMPLIED, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED -+ WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. THE -+ ENTIRE RISK AS TO THE QUALITY AND PERFORMANCE OF THE PROGRAM IS WITH -+ YOU. SHOULD THE PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF ALL -+ NECESSARY SERVICING, REPAIR OR CORRECTION. -+ -+12. IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING -+ WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MAY MODIFY AND/OR -+ REDISTRIBUTE THE PROGRAM AS PERMITTED ABOVE, BE LIABLE TO YOU FOR -+ DAMAGES, INCLUDING ANY GENERAL, SPECIAL, INCIDENTAL OR CONSEQUENTIAL -+ DAMAGES ARISING OUT OF THE USE OR INABILITY TO USE THE PROGRAM -+ (INCLUDING BUT NOT LIMITED TO LOSS OF DATA OR DATA BEING RENDERED -+ INACCURATE OR LOSSES SUSTAINED BY YOU OR THIRD PARTIES OR A FAILURE OF -+ THE PROGRAM TO OPERATE WITH ANY OTHER PROGRAMS), EVEN IF SUCH HOLDER OR -+ OTHER PARTY HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGES. -+ -+END OF TERMS AND CONDITIONS -+ -+How to Apply These Terms to Your New Programs -+ -+If you develop a new program, and you want it to be of the greatest -+possible use to the public, the best way to achieve this is to make it free -+software which everyone can redistribute and change under these terms. -+ -+To do so, attach the following notices to the program. It is safest to -+attach them to the start of each source file to most effectively convey the -+exclusion of warranty; and each file should have at least the "copyright" -+line and a pointer to where the full notice is found. -+ -+one line to give the program's name and an idea of what it does. -+Copyright (C) yyyy name of author -+ -+This program is free software; you can redistribute it and/or modify it -+under the terms of the GNU General Public License as published by the Free -+Software Foundation; either version 2 of the License, or (at your option) -+any later version. -+ -+This program is distributed in the hope that it will be useful, but WITHOUT -+ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+more details. -+ -+You should have received a copy of the GNU General Public License along with -+this program; if not, write to the Free Software Foundation, Inc., 59 -+Temple Place - Suite 330, Boston, MA 02111-1307, USA. -+ -+Also add information on how to contact you by electronic and paper mail. -+ -+If the program is interactive, make it output a short notice like this when -+it starts in an interactive mode: -+ -+Gnomovision version 69, Copyright (C) year name of author Gnomovision comes -+with ABSOLUTELY NO WARRANTY; for details type 'show w'. This is free -+software, and you are welcome to redistribute it under certain conditions; -+type 'show c' for details. -+ -+The hypothetical commands 'show w' and 'show c' should show the appropriate -+parts of the General Public License. Of course, the commands you use may be -+called something other than 'show w' and 'show c'; they could even be -+mouse-clicks or menu items--whatever suits your program. -+ -+You should also get your employer (if you work as a programmer) or your -+school, if any, to sign a "copyright disclaimer" for the program, if -+necessary. Here is a sample; alter the names: -+ -+Yoyodyne, Inc., hereby disclaims all copyright interest in the program -+'Gnomovision' (which makes passes at compilers) written by James Hacker. -+ -+signature of Ty Coon, 1 April 1989 -+Ty Coon, President of Vice -+ -+This General Public License does not permit incorporating your program into -+proprietary programs. If your program is a subroutine library, you may -+consider it more useful to permit linking proprietary applications with the -+library. If this is what you want to do, use the GNU Library General Public -+License instead of this License. -diff -Nurp linux-2.6.37/3rdparty/rfswitch/Makefile linux-2.6.37.3rdparty/3rdparty/rfswitch/Makefile ---- linux-2.6.37/3rdparty/rfswitch/Makefile 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/rfswitch/Makefile 2008-03-28 05:17:16.000000000 +0200 -@@ -0,0 +1,119 @@ -+# -+# Makefile for the SW RF Switch kernel modules -+# -+# NOTE: This make file can serve as both an external Makefile (launched -+# directly by the user), or as the sub-dir Makefile used by the kernel -+# build system. -+ -+ -+CONFIG_AVERATEC_5100P=m -+CONFIG_PACKARDBELL_E5=m -+ -+ -+ -+list-m := -+list-$(CONFIG_AVERATEC_5100P) += av5100 -+list-$(CONFIG_PACKARDBELL_E5) += pbe5 -+ -+ -+obj-$(CONFIG_AVERATEC_5100P) += av5100.o -+obj-$(CONFIG_PACKARDBELL_E5) += pbe5.o -+ -+# -+# Begin dual Makefile mode here. First we provide support for when we -+# are being invoked by the kernel build system -+# -+ifneq ($(KERNELRELEASE),) -+ -+ifneq ($(PATCHLEVEL),6) # If we are not on a 2.6, then do 2.4 specific things -+ -+O_TARGET := rfswitch.o -+ -+include $(TOPDIR)/Rules.make -+ -+endif # End if 2.4 specific settings -+ -+else -+# Here we begin the portion that is executed if the user invoked this Makefile -+# directly. -+ -+# KSRC should be set to the path to your sources -+# modules are installed into KMISC -+KVER := $(shell uname -r) -+KSRC := /lib/modules/$(KVER)/build -+KMISC := /lib/modules/$(KVER)/kernel/drivers/net/wireless/ -+ -+# KSRC_OUTPUT should be overridden if you are using a 2.6 kernel that -+# has it's output sent elsewhere via KBUILD_OUTPUT= or O= -+KSRC_OUTPUT := $(KSRC) -+ -+# If we find Rules.make, we can assume we're using the old 2.4 style building -+OLDMAKE=$(wildcard $(KSRC)/Rules.make) -+PWD=$(shell pwd) -+ -+VERFILE := $(KSRC_OUTPUT)/include/linux/version.h -+KERNELRELEASE := $(shell \ -+ if [ -r $(VERFILE) ]; then \ -+ (cat $(VERFILE); echo UTS_RELEASE) | \ -+ $(CC) -I$(KSRC_OUTPUT) $(CFLAGS) -E - | \ -+ tail -n 1 | \ -+ xargs echo; \ -+ else \ -+ uname -r; \ -+ fi) -+ -+MODPATH := $(DESTDIR)/lib/modules/$(KERNELRELEASE) -+ -+all: modules -+ -+clean: -+ rm -f *.mod.c *.mod *.o *.ko .*.cmd .*.flags Modules.symvers -+ rm -rf $(PWD)/tmp -+ -+ -+ifeq ($(OLDMAKE),) -+ -+TMP=$(PWD)/tmp -+MODVERDIR=$(TMP)/.tmp_versions -+ -+modules: -+ifdef ($(KSRC_OUTPUT)/.tmp_versions) -+ mkdir -p $(MODVERDIR) -+ -cp $(KSRC_OUTPUT)/.tmp_versions/*.mod $(MODVERDIR) -+endif -+ifeq ($(KSRC),$(KSRC_OUTPUT)) # We're not outputting elsewhere -+ifdef ($(KSRC)/.tmp_versions) -+ -cp $(KSRC)/.tmp_versions/*.mod $(MODVERDIR) -+endif -+ $(MAKE) -C $(KSRC) SUBDIRS=$(PWD) MODVERDIR=$(MODVERDIR) modules -+else # We've got a kernel with seperate output, copy the config, and use O= -+ mkdir -p $(TMP) -+ cp $(KSRC_OUTPUT)/.config $(TMP) -+ $(MAKE) -C $(KSRC) SUBDIRS=$(PWD) MODVERDIR=$(MODVERDIR) O=$(PWD)/tmp modules -+endif -+ -+install: modules -+ install -d $(KMISC) -+ install -m 644 -c $(addsuffix .ko,$(list-m)) $(KMISC) -+ /sbin/depmod -a -+ -+ -+else # We're on 2.4, and things are slightly different -+ -+modules: -+ $(MAKE) -C $(KSRC) SUBDIRS=$(PWD) BUILD_DIR=$(PWD) modules -+ -+install: modules -+ install -d $(KMISC) -+ install -m 644 -c $(addsuffix .o,$(list-m)) $(KMISC) -+ /sbin/depmod -a -+ -+endif -+ -+uninstall: -+ cd $(KMISC) -+ rm -rf $(addsuffix .ko,$(list-m)) -+ cd - -+ /sbin/depmod -a -+ -+endif -diff -Nurp linux-2.6.37/3rdparty/rfswitch/pbe5.c linux-2.6.37.3rdparty/3rdparty/rfswitch/pbe5.c ---- linux-2.6.37/3rdparty/rfswitch/pbe5.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/rfswitch/pbe5.c 2008-03-28 05:25:16.000000000 +0200 -@@ -0,0 +1,205 @@ -+/******************************************************************************* -+ -+ This program is free software; you can redistribute it and/or modify it -+ under the terms of version 2 of the GNU General Public License as -+ published by the Free Software Foundation. -+ -+ This program is distributed in the hope that it will be useful, but WITHOUT -+ ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ more details. -+ -+ You should have received a copy of the GNU General Public License along with -+ this program; if not, write to the Free Software Foundation, Inc., 59 -+ Temple Place - Suite 330, Boston, MA 02111-1307, USA. -+ -+ The full GNU General Public License is included in this distribution in the -+ file called LICENSE. -+ -+ Author: -+ Pedro Ramalhais -+ -+ Based on: -+ av5100.c from http://ipw2100.sourceforge.net/ -+ -+*******************************************************************************/ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#define DRV_NAME "pbe5" -+#define DRV_VERSION "1.3" -+#define DRV_DESCRIPTION "SW RF kill switch for Packard Bell EasyNote E5" -+#define DRV_AUTHOR "Pedro Ramalhais" -+#define DRV_LICENSE "GPL" -+ -+static int radio = 1; -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) -+ -+MODULE_PARM(radio, "i"); -+ -+#else /* LINUX_VERSION_CODE < 2.6.0 */ -+ -+#include -+module_param(radio, int, 1); -+ -+#endif /* LINUX_VERSION_CODE < 2.6.0 */ -+ -+MODULE_PARM_DESC(radio, "controls state of radio (1=on, 0=off)"); -+ -+MODULE_DESCRIPTION(DRV_DESCRIPTION); -+MODULE_AUTHOR(DRV_AUTHOR); -+MODULE_LICENSE(DRV_LICENSE); -+ -+/* -+ * NOTE: These values were obtained from disassembling the Icon.exe program -+ * installed in the Packard Bell EasyNote E5 laptop. The names were guessed, -+ * so don't rely on them. -+ */ -+#define PBE5_PORT_TOGGLE 0x0b3 -+#define PBE5_VALUE_TOGGLE_ON 0x01 -+#define PBE5_VALUE_TOGGLE_OFF 0x00 -+#define PBE5_PORT_APPLY 0x0b2 -+#define PBE5_VALUE_APPLY 0xef -+ -+// Some "booleans" =;-) -+#define PBE5_RADIO_OFF 0 -+#define PBE5_RADIO_ON 1 -+ -+static int pbe5_radio_status = PBE5_RADIO_ON; -+ -+unsigned char pbe5_get_radio(void) -+{ -+ unsigned char val = 0x00; -+ -+ val = inb(PBE5_PORT_TOGGLE); -+ -+ return val; -+} -+ -+static void pbe5_set_radio(int state_set) -+{ -+ pbe5_radio_status = pbe5_get_radio(); -+ -+ if (pbe5_radio_status != state_set) { -+ // Set the radio toggle register -+ outb(PBE5_VALUE_TOGGLE_ON, PBE5_PORT_TOGGLE); -+ // Commit the radio toggle register value -+ outb(PBE5_VALUE_APPLY, PBE5_PORT_APPLY); -+ // Update the radio status -+ pbe5_radio_status = pbe5_get_radio(); -+ -+ printk(KERN_INFO DRV_NAME ": Radio turned %s\n", -+ (state_set == PBE5_RADIO_ON) ? "ON" : "OFF"); -+ } else { -+ printk(KERN_INFO DRV_NAME ": Radio already %s\n", -+ (state_set == PBE5_RADIO_ON) ? "ON" : "OFF"); -+ } -+} -+ -+ -+/* -+ * proc stuff -+ */ -+static struct proc_dir_entry *dir_base = NULL; -+ -+static int proc_set_radio(struct file *file, const char *buffer, -+ unsigned long count, void *data) -+{ -+ pbe5_set_radio(buffer[0] == '0' ? PBE5_RADIO_OFF : PBE5_RADIO_ON); -+ -+ return count; -+} -+ -+static int proc_get_radio(char *page, char **start, off_t offset, -+ int count, int *eof, void *data) -+{ -+ int len = 0; -+ -+ len += snprintf(page, count, DRV_NAME ": %d\n", -+ pbe5_radio_status == PBE5_RADIO_OFF ? 0 : 1); -+ -+ *eof = 1; -+ return len; -+} -+ -+ -+static void pbe5_proc_cleanup(void) -+{ -+ if (dir_base) { -+ remove_proc_entry("radio", dir_base); -+ remove_proc_entry(DRV_NAME, &proc_root); -+ dir_base = NULL; -+ } -+} -+ -+ -+static int pbe5_proc_init(void) -+{ -+ struct proc_dir_entry *ent; -+ int err = 0; -+ -+ dir_base = create_proc_entry(DRV_NAME, S_IFDIR, &proc_root); -+ if (dir_base == NULL) { -+ printk(KERN_ERR DRV_NAME ": Unable to initialise /proc/" -+ DRV_NAME "\n"); -+ err = -ENOMEM; -+ goto fail; -+ } -+ -+ -+ ent = create_proc_entry("radio", S_IFREG | S_IRUGO | S_IWUSR, -+ dir_base); -+ if (ent) { -+ ent->read_proc = proc_get_radio; -+ ent->write_proc = proc_set_radio; -+ } else { -+ printk(KERN_ERR -+ "Unable to initialize /proc/" DRV_NAME "/radio\n"); -+ err = -ENOMEM; -+ goto fail; -+ } -+ -+ return 0; -+ -+ fail: -+ pbe5_proc_cleanup(); -+ return err; -+} -+ -+/* -+ * module stuff -+ */ -+static int __init pbe5_init(void) -+{ -+ pbe5_proc_init(); -+ -+ pbe5_set_radio((radio == 1) ? PBE5_RADIO_ON : PBE5_RADIO_OFF); -+ -+ return 0; -+} -+ -+static void __exit pbe5_exit(void) -+{ -+ pbe5_set_radio(PBE5_RADIO_OFF); -+ -+ pbe5_proc_cleanup(); -+} -+ -+module_init(pbe5_init); -+module_exit(pbe5_exit); -+ -+/* -+ 1 2 3 4 5 6 7 -+12345678901234567890123456789012345678901234567890123456789012345678901234567890 -+*/ -diff -Nurp linux-2.6.37/3rdparty/rfswitch/README linux-2.6.37.3rdparty/3rdparty/rfswitch/README ---- linux-2.6.37/3rdparty/rfswitch/README 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/rfswitch/README 2004-07-09 17:26:20.000000000 +0300 -@@ -0,0 +1,44 @@ -+Radio Kill Switch -+------------ ----- ----- ---- --- -- - -+Most laptops provide the ability for the user to physically disable the radio. -+Some vendors have implemented this as a physical switch that requires no -+software to turn the radio off and on. On other laptops, however, the switch -+is controlled through a button being pressed and a software driver then making -+calls to turn the radio off and on. This is referred to as a "software based -+RF kill switch" -+ -+Currently this project provides modules for controlling the software RF kill -+switch on the Averatec 5100P and Packard Bell EasyNote E5. The code may work -+on other laptops, but these are the only models on which it has been tested. -+ -+To determine if you have a system that might be compatible with one of the -+provided SW RF Kill switch modules, you can run: -+ -+ -+ To check for the Packard Bell (to use module pbe) -- -+ -+ % dd if=/dev/mem bs=1 skip=983040 count=65535 2>/dev/null | strings | egrep "NEW-PC|Insyde Software MobilePRO BIOS" -+ -+ To check for the Averatec (to use module av5100) -- -+ -+ % dd if=/dev/mem bs=1 skip=983040 count=65535 2>/dev/null | strings | egrep "AVERATEC" -+ -+If you have one of those laptop models you can imply loading the av5100/pbe5 -+module and the radio will be toggled on and off. In addition, you can turn -+the driver on and off by writing either a 1 or 0 to /proc/av5100/radio or -+/proc/pbe5/radio. If you automatically load the av5100/pbe5 module when your -+system boots, you may wish to use the radio module parameter to control the -+state of the radio upon loading: -+ -+ modprobe av5100 radio=0 -+ modprobe pbe5 radio=0 -+ -+results in the module loading with the radio turned off. You can then turn the -+radio on by: -+ -+ echo 1 > /proc/av5100/radio -+ echo 1 > /proc/pbe5/radio -+ -+If you have a SW RF kill switch and can not use one of the above modules, -+please join us on IRC (irc.freenode.net) on channel #ipw2100 and someone may -+be able to help. diff --git a/kernel/kernel/files/patches/mageia/3rd-rfswitch-3.0-buildfix.patch b/kernel/kernel/files/patches/mageia/3rd-rfswitch-3.0-buildfix.patch deleted file mode 100644 index 7bfc2c64..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-rfswitch-3.0-buildfix.patch +++ /dev/null @@ -1,19 +0,0 @@ - -fix build with 3.0 - -Signed-off-by: Thomas Backlund - - 3rdparty/rfswitch/Makefile | 2 -- - 1 file changed, 2 deletions(-) - ---- a/3rdparty/rfswitch/Makefile.orig 2011-07-15 02:37:27.000000000 +0300 -+++ a/3rdparty/rfswitch/Makefile 2011-07-15 13:47:10.463914526 +0300 -@@ -29,8 +29,6 @@ ifneq ($(PATCHLEVEL),6) # If we are not - - O_TARGET := rfswitch.o - --include $(TOPDIR)/Rules.make -- - endif # End if 2.4 specific settings - - else diff --git a/kernel/kernel/files/patches/mageia/3rd-rfswitch-build-fix.patch b/kernel/kernel/files/patches/mageia/3rd-rfswitch-build-fix.patch deleted file mode 100644 index ab1c279c..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-rfswitch-build-fix.patch +++ /dev/null @@ -1,51 +0,0 @@ -Remove 'proc_root' usage - -Commit c74c120a21d87b0b6925ada5830d8cac21e852d9 (Linus's tree) removed -the export of 'proc_root' variable, because you can create on the proc's -root directory by passing NULL where you would pass 'proc_root'. - -Signed-off-by: Luiz Fernando N. Capitulino -Index: linux-2.6.25/3rdparty/rfswitch/av5100.c -=================================================================== ---- linux-2.6.25.orig/3rdparty/rfswitch/av5100.c -+++ linux-2.6.25/3rdparty/rfswitch/av5100.c -@@ -107,7 +107,7 @@ static void av5100_proc_cleanup(void) - { - if (dir_base) { - remove_proc_entry("radio", dir_base); -- remove_proc_entry(DRV_NAME, &proc_root); -+ remove_proc_entry(DRV_NAME, NULL); - dir_base = NULL; - } - } -@@ -118,7 +118,7 @@ static int av5100_proc_init(void) - struct proc_dir_entry *ent; - int err = 0; - -- dir_base = create_proc_entry(DRV_NAME, S_IFDIR, &proc_root); -+ dir_base = create_proc_entry(DRV_NAME, S_IFDIR, NULL); - if (dir_base == NULL) { - printk(KERN_ERR DRV_NAME ": Unable to initialise /proc/" - DRV_NAME "\n"); -Index: linux-2.6.25/3rdparty/rfswitch/pbe5.c -=================================================================== ---- linux-2.6.25.orig/3rdparty/rfswitch/pbe5.c -+++ linux-2.6.25/3rdparty/rfswitch/pbe5.c -@@ -138,7 +138,7 @@ static void pbe5_proc_cleanup(void) - { - if (dir_base) { - remove_proc_entry("radio", dir_base); -- remove_proc_entry(DRV_NAME, &proc_root); -+ remove_proc_entry(DRV_NAME, NULL); - dir_base = NULL; - } - } -@@ -149,7 +149,7 @@ static int pbe5_proc_init(void) - struct proc_dir_entry *ent; - int err = 0; - -- dir_base = create_proc_entry(DRV_NAME, S_IFDIR, &proc_root); -+ dir_base = create_proc_entry(DRV_NAME, S_IFDIR, NULL); - if (dir_base == NULL) { - printk(KERN_ERR DRV_NAME ": Unable to initialise /proc/" - DRV_NAME "\n"); diff --git a/kernel/kernel/files/patches/mageia/3rd-rtl8723de.patch b/kernel/kernel/files/patches/mageia/3rd-rtl8723de.patch deleted file mode 100644 index ac35efe4..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-rtl8723de.patch +++ /dev/null @@ -1,411237 +0,0 @@ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/efuse/rtw_efuse.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/efuse/rtw_efuse.c ---- linux-4.14.18/3rdparty/rtl8723de/core/efuse/rtw_efuse.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/efuse/rtw_efuse.c 2018-02-11 21:44:27.134145888 +0200 -@@ -0,0 +1,2612 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_EFUSE_C_ -+ -+#include -+#include -+ -+#include "../hal/efuse/efuse_mask.h" -+ -+/*------------------------Define local variable------------------------------*/ -+u8 fakeEfuseBank = {0}; -+u32 fakeEfuseUsedBytes = {0}; -+u8 fakeEfuseContent[EFUSE_MAX_HW_SIZE] = {0}; -+u8 fakeEfuseInitMap[EFUSE_MAX_MAP_LEN] = {0}; -+u8 fakeEfuseModifiedMap[EFUSE_MAX_MAP_LEN] = {0}; -+ -+u32 BTEfuseUsedBytes = {0}; -+u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+u8 BTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN] = {0}; -+u8 BTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN] = {0}; -+ -+u32 fakeBTEfuseUsedBytes = {0}; -+u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+u8 fakeBTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN] = {0}; -+u8 fakeBTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN] = {0}; -+ -+u8 maskfileBuffer[64]; -+/*------------------------Define local variable------------------------------*/ -+BOOLEAN rtw_file_efuse_IsMasked(PADAPTER pAdapter, u16 Offset) -+{ -+ int r = Offset / 16; -+ int c = (Offset % 16) / 2; -+ int result = 0; -+ -+ if (pAdapter->registrypriv.boffefusemask) -+ return FALSE; -+ -+ if (c < 4) /* Upper double word */ -+ result = (maskfileBuffer[r] & (0x10 << c)); -+ else -+ result = (maskfileBuffer[r] & (0x01 << (c - 4))); -+ -+ return (result > 0) ? 0 : 1; -+} -+ -+BOOLEAN efuse_IsMasked(PADAPTER pAdapter, u16 Offset) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ -+ if (pAdapter->registrypriv.boffefusemask) -+ return FALSE; -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ return (IS_MASKED(8188E, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8812A) -+ if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ return (IS_MASKED(8812A, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8821A) -+#if 0 -+ if (IS_HARDWARE_TYPE_8811AU(pAdapter)) -+ return (IS_MASKED(8811A, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+ if (IS_HARDWARE_TYPE_8821(pAdapter)) -+ return (IS_MASKED(8821A, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8192E) -+ if (IS_HARDWARE_TYPE_8192E(pAdapter)) -+ return (IS_MASKED(8192E, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8723B) -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) -+ return (IS_MASKED(8723B, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8703B) -+ if (IS_HARDWARE_TYPE_8703B(pAdapter)) -+ return (IS_MASKED(8703B, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8814A) -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ return (IS_MASKED(8814A, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8188F) -+ if (IS_HARDWARE_TYPE_8188F(pAdapter)) -+ return (IS_MASKED(8188F, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8822B) -+ if (IS_HARDWARE_TYPE_8822B(pAdapter)) -+ return (IS_MASKED(8822B, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8723D) -+ if (IS_HARDWARE_TYPE_8723D(pAdapter)) -+ return (IS_MASKED(8723D, _MUSB, Offset)) ? TRUE : FALSE; -+#endif -+ -+ /*#if defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_8821C(pAdapter)) -+ return (IS_MASKED(8821C,_MUSB,Offset)) ? TRUE : FALSE; -+ #endif*/ -+ -+#elif DEV_BUS_TYPE == RT_PCI_INTERFACE -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ return (IS_MASKED(8188E, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8192E) -+ if (IS_HARDWARE_TYPE_8192E(pAdapter)) -+ return (IS_MASKED(8192E, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8812A) -+ if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ return (IS_MASKED(8812A, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8821A) -+ if (IS_HARDWARE_TYPE_8821(pAdapter)) -+ return (IS_MASKED(8821A, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8723B) -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) -+ return (IS_MASKED(8723B, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8814A) -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ return (IS_MASKED(8814A, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+#if defined(CONFIG_RTL8822B) -+ if (IS_HARDWARE_TYPE_8822B(pAdapter)) -+ return (IS_MASKED(8822B, _MPCIE, Offset)) ? TRUE : FALSE; -+#endif -+ -+#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE -+#ifdef CONFIG_RTL8188E_SDIO -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ return (IS_MASKED(8188E, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#ifdef CONFIG_RTL8188F_SDIO -+ if (IS_HARDWARE_TYPE_8188F(pAdapter)) -+ return (IS_MASKED(8188F, _MSDIO, Offset)) ? TRUE : FALSE; -+#endif -+#endif -+ -+ return FALSE; -+} -+ -+void rtw_efuse_mask_array(PADAPTER pAdapter, u8 *pArray) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ GET_MASK_ARRAY(8188E, _MUSB, pArray); -+#endif -+#if defined(CONFIG_RTL8812A) -+ if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ GET_MASK_ARRAY(8812A, _MUSB, pArray); -+#endif -+#if defined(CONFIG_RTL8821A) -+ if (IS_HARDWARE_TYPE_8821(pAdapter)) -+ GET_MASK_ARRAY(8821A, _MUSB, pArray); -+#endif -+#if defined(CONFIG_RTL8192E) -+ if (IS_HARDWARE_TYPE_8192E(pAdapter)) -+ GET_MASK_ARRAY(8192E, _MUSB, pArray); -+#endif -+#if defined(CONFIG_RTL8723B) -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) -+ GET_MASK_ARRAY(8723B, _MUSB, pArray); -+#endif -+#if defined(CONFIG_RTL8703B) -+ if (IS_HARDWARE_TYPE_8703B(pAdapter)) -+ GET_MASK_ARRAY(8703B, _MUSB, pArray); -+#endif -+#if defined(CONFIG_RTL8188F) -+ if (IS_HARDWARE_TYPE_8188F(pAdapter)) -+ GET_MASK_ARRAY(8188F, _MUSB, pArray); -+#endif -+#if defined(CONFIG_RTL8814A) -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ GET_MASK_ARRAY(8814A, _MUSB, pArray); -+#endif -+#if defined(CONFIG_RTL8822B) -+ if (IS_HARDWARE_TYPE_8822B(pAdapter)) -+ GET_MASK_ARRAY(8822B, _MUSB, pArray); -+#endif -+ /*#if defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_8821C(pAdapter)) -+ GET_MASK_ARRAY(8821C,_MUSB,pArray); -+ #endif*/ -+#elif DEV_BUS_TYPE == RT_PCI_INTERFACE -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ GET_MASK_ARRAY(8188E, _MPCIE, pArray); -+#endif -+#if defined(CONFIG_RTL8192E) -+ if (IS_HARDWARE_TYPE_8192E(pAdapter)) -+ GET_MASK_ARRAY(8192E, _MPCIE, pArray); -+#endif -+#if defined(CONFIG_RTL8812A) -+ if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ GET_MASK_ARRAY(8812A, _MPCIE, pArray); -+#endif -+#if defined(CONFIG_RTL8821A) -+ if (IS_HARDWARE_TYPE_8821(pAdapter)) -+ GET_MASK_ARRAY(8821A, _MPCIE, pArray); -+#endif -+#if defined(CONFIG_RTL8723B) -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) -+ GET_MASK_ARRAY(8723B, _MPCIE, pArray); -+#endif -+#if defined(CONFIG_RTL8814A) -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ GET_MASK_ARRAY(8814A, _MPCIE, pArray); -+#endif -+#if defined(CONFIG_RTL8822B) -+ if (IS_HARDWARE_TYPE_8822B(pAdapter)) -+ GET_MASK_ARRAY(8822B, _MPCIE, pArray); -+#endif -+#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ GET_MASK_ARRAY(8188E, _MSDIO, pArray); -+#endif -+#if defined(CONFIG_RTL8188F) -+ if (IS_HARDWARE_TYPE_8188F(pAdapter)) -+ GET_MASK_ARRAY(8188F, _MSDIO, pArray); -+#endif -+#endif /*#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE*/ -+} -+ -+u16 rtw_get_efuse_mask_arraylen(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8188E, _MUSB); -+#endif -+#if defined(CONFIG_RTL8812A) -+ if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8812A, _MUSB); -+#endif -+#if defined(CONFIG_RTL8821A) -+ if (IS_HARDWARE_TYPE_8821(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8821A, _MUSB); -+#endif -+#if defined(CONFIG_RTL8192E) -+ if (IS_HARDWARE_TYPE_8192E(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8192E, _MUSB); -+#endif -+#if defined(CONFIG_RTL8723B) -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8723B, _MUSB); -+#endif -+#if defined(CONFIG_RTL8703B) -+ if (IS_HARDWARE_TYPE_8703B(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8703B, _MUSB); -+#endif -+#if defined(CONFIG_RTL8188F) -+ if (IS_HARDWARE_TYPE_8188F(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8188F, _MUSB); -+#endif -+#if defined(CONFIG_RTL8814A) -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8814A, _MUSB); -+#endif -+#if defined(CONFIG_RTL8822B) -+ if (IS_HARDWARE_TYPE_8822B(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8822B, _MUSB); -+#endif -+ /*#if defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_8821C(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8821C,_MUSB); -+ #endif*/ -+#elif DEV_BUS_TYPE == RT_PCI_INTERFACE -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8188E, _MPCIE); -+#endif -+#if defined(CONFIG_RTL8192E) -+ if (IS_HARDWARE_TYPE_8192E(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8192E, _MPCIE); -+#endif -+#if defined(CONFIG_RTL8812A) -+ if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8812A, _MPCIE); -+#endif -+#if defined(CONFIG_RTL8821A) -+ if (IS_HARDWARE_TYPE_8821(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8821A, _MPCIE); -+#endif -+#if defined(CONFIG_RTL8723B) -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8723B, _MPCIE); -+#endif -+#if defined(CONFIG_RTL8814A) -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8814A, _MPCIE); -+#endif -+#if defined(CONFIG_RTL8822B) -+ if (IS_HARDWARE_TYPE_8822B(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8822B, _MPCIE); -+#endif -+#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8188E, _MSDIO); -+#endif -+#if defined(CONFIG_RTL8188F) -+ if (IS_HARDWARE_TYPE_8188F(pAdapter)) -+ return GET_MASK_ARRAY_LEN(8188F, _MSDIO); -+#endif -+ -+#endif -+ return 0; -+} -+ -+ -+#ifdef RTW_HALMAC -+#include "../../hal/hal_halmac.h" -+ -+void Efuse_PowerSwitch(PADAPTER adapter, u8 write, u8 pwrstate) -+{ -+} -+ -+void BTEfuse_PowerSwitch(PADAPTER adapter, u8 write, u8 pwrstate) -+{ -+} -+ -+u8 efuse_GetCurrentSize(PADAPTER adapter, u16 *size) -+{ -+ *size = 0; -+ -+ return _FAIL; -+} -+ -+u16 efuse_GetMaxSize(PADAPTER adapter) -+{ -+ struct dvobj_priv *d; -+ u32 size = 0; -+ int err; -+ -+ d = adapter_to_dvobj(adapter); -+ err = rtw_halmac_get_physical_efuse_size(d, &size); -+ if (err) -+ return 0; -+ -+ return size; -+} -+ -+u8 efuse_bt_GetCurrentSize(PADAPTER adapter, u16 *size) -+{ -+ *size = 0; -+ -+ return _FAIL; -+} -+ -+u16 efuse_bt_GetMaxSize(PADAPTER adapter) -+{ -+ return 0; -+} -+ -+void EFUSE_GetEfuseDefinition(PADAPTER adapter, u8 efusetype, u8 type, void *out, BOOLEAN test) -+{ -+ struct dvobj_priv *d; -+ u32 v32 = 0; -+ -+ -+ d = adapter_to_dvobj(adapter); -+ -+ if (adapter->HalFunc.EFUSEGetEfuseDefinition) { -+ adapter->HalFunc.EFUSEGetEfuseDefinition(adapter, efusetype, type, out, test); -+ return; -+ } -+ -+ if (EFUSE_WIFI == efusetype) { -+ switch (type) { -+ case TYPE_EFUSE_MAP_LEN: -+ rtw_halmac_get_logical_efuse_size(d, &v32); -+ *(u16 *)out = (u16)v32; -+ return; -+ } -+ } -+} -+ -+/* -+ * read/write raw efuse data -+ */ -+u8 rtw_efuse_access(PADAPTER adapter, u8 write, u16 addr, u16 cnts, u8 *data) -+{ -+ struct dvobj_priv *d; -+ u8 *efuse = NULL; -+ u32 size, i; -+ int err; -+ -+ -+ d = adapter_to_dvobj(adapter); -+ err = rtw_halmac_get_physical_efuse_size(d, &size); -+ if (err) -+ size = EFUSE_MAX_SIZE; -+ -+ if ((addr + cnts) > size) -+ return _FAIL; -+ -+ if (_TRUE == write) { -+ err = rtw_halmac_write_physical_efuse(d, addr, cnts, data); -+ if (err) -+ return _FAIL; -+ } else { -+ if (cnts > 16) -+ efuse = rtw_zmalloc(size); -+ -+ if (efuse) { -+ err = rtw_halmac_read_physical_efuse_map(d, efuse, size); -+ if (err) { -+ rtw_mfree(efuse, size); -+ return _FAIL; -+ } -+ -+ _rtw_memcpy(data, efuse + addr, cnts); -+ rtw_mfree(efuse, size); -+ } else { -+ err = rtw_halmac_read_physical_efuse(d, addr, cnts, data); -+ if (err) -+ return _FAIL; -+ } -+ } -+ -+ return _SUCCESS; -+} -+ -+static inline void dump_buf(u8 *buf, u32 len) -+{ -+ u32 i; -+ -+ RTW_INFO("-----------------Len %d----------------\n", len); -+ for (i = 0; i < len; i++) -+ printk("%2.2x-", *(buf + i)); -+ printk("\n"); -+} -+ -+/* -+ * read/write raw efuse data -+ */ -+u8 rtw_efuse_bt_access(PADAPTER adapter, u8 write, u16 addr, u16 cnts, u8 *data) -+{ -+ struct dvobj_priv *d; -+ u8 *efuse = NULL; -+ u32 size, i; -+ int err = _FAIL; -+ -+ -+ d = adapter_to_dvobj(adapter); -+ -+ size = EFUSE_BT_REAL_BANK_CONTENT_LEN; -+ -+ if ((addr + cnts) > size) -+ return _FAIL; -+ -+ if (_TRUE == write) { -+ err = rtw_halmac_write_bt_physical_efuse(d, addr, cnts, data); -+ if (err == -1) { -+ RTW_ERR("%s: rtw_halmac_write_bt_physical_efuse fail!\n", __FUNCTION__); -+ return _FAIL; -+ } -+ RTW_INFO("%s: rtw_halmac_write_bt_physical_efuse OK! data 0x%x\n", __FUNCTION__, *data); -+ } else { -+ efuse = rtw_zmalloc(size); -+ -+ if (efuse) { -+ err = rtw_halmac_read_bt_physical_efuse_map(d, efuse, size); -+ -+ if (err == -1) { -+ RTW_ERR("%s: rtw_halmac_read_bt_physical_efuse_map fail!\n", __FUNCTION__); -+ rtw_mfree(efuse, size); -+ return _FAIL; -+ } -+ dump_buf(efuse + addr, cnts); -+ -+ RTW_INFO("%s: rtw_halmac_read_bt_physical_efuse_map ok!\n", __FUNCTION__); -+ _rtw_memcpy(data, efuse + addr, cnts); -+ rtw_mfree(efuse, size); -+ } -+ } -+ -+ return _SUCCESS; -+} -+ -+u8 rtw_efuse_map_read(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) -+{ -+ struct dvobj_priv *d; -+ u8 *efuse = NULL; -+ u32 size, i; -+ int err; -+ -+ -+ d = adapter_to_dvobj(adapter); -+ err = rtw_halmac_get_logical_efuse_size(d, &size); -+ if (err) -+ return _FAIL; -+ -+ /* size error handle */ -+ if ((addr + cnts) > size) { -+ if (addr < size) -+ cnts = size - addr; -+ else -+ return _FAIL; -+ } -+ -+ if (cnts > 16) -+ efuse = rtw_zmalloc(size); -+ -+ if (efuse) { -+ err = rtw_halmac_read_logical_efuse_map(d, efuse, size); -+ if (err) { -+ rtw_mfree(efuse, size); -+ return _FAIL; -+ } -+ -+ _rtw_memcpy(data, efuse + addr, cnts); -+ rtw_mfree(efuse, size); -+ } else { -+ err = rtw_halmac_read_logical_efuse(d, addr, cnts, data); -+ if (err) -+ return _FAIL; -+ } -+ -+ return _SUCCESS; -+} -+ -+u8 rtw_efuse_mask_map_read(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) -+{ -+ return rtw_efuse_map_read(adapter, addr, cnts, data); -+} -+ -+u8 rtw_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) -+{ -+ struct dvobj_priv *d; -+ u8 *efuse = NULL; -+ u32 size, i; -+ int err; -+ u8 mask_buf[64] = ""; -+ u16 mask_len = sizeof(u8) * rtw_get_efuse_mask_arraylen(adapter); -+ -+ d = adapter_to_dvobj(adapter); -+ err = rtw_halmac_get_logical_efuse_size(d, &size); -+ if (err) -+ return _FAIL; -+ -+ if ((addr + cnts) > size) -+ return _FAIL; -+ -+ efuse = rtw_zmalloc(size); -+ if (!efuse) -+ return _FAIL; -+ -+ err = rtw_halmac_read_logical_efuse_map(d, efuse, size); -+ if (err) { -+ rtw_mfree(efuse, size); -+ return _FAIL; -+ } -+ -+ _rtw_memcpy(efuse + addr, data, cnts); -+ -+ if (adapter->registrypriv.boffefusemask == 0) { -+ RTW_INFO("Use mask Array Len: %d\n", mask_len); -+ -+ if (mask_len != 0) { -+ if (adapter->registrypriv.bFileMaskEfuse == _TRUE) -+ _rtw_memcpy(mask_buf, maskfileBuffer, mask_len); -+ else -+ rtw_efuse_mask_array(adapter, mask_buf); -+ -+ err = rtw_halmac_write_logical_efuse_map(d, efuse, size, mask_buf, mask_len); -+ } else -+ err = rtw_halmac_write_logical_efuse_map(d, efuse, size, NULL, 0); -+ } else { -+ _rtw_memset(mask_buf, 0xFF, sizeof(mask_buf)); -+ RTW_INFO("Efuse mask off\n"); -+ err = rtw_halmac_write_logical_efuse_map(d, efuse, size, mask_buf, size/16); -+ } -+ -+ if (err) { -+ rtw_mfree(efuse, size); -+ return _FAIL; -+ } -+ -+ rtw_mfree(efuse, size); -+ -+ return _SUCCESS; -+} -+ -+int Efuse_PgPacketRead(PADAPTER adapter, u8 offset, u8 *data, BOOLEAN test) -+{ -+ return _FALSE; -+} -+ -+int Efuse_PgPacketWrite(PADAPTER adapter, u8 offset, u8 word_en, u8 *data, BOOLEAN test) -+{ -+ return _FALSE; -+} -+ -+u8 rtw_BT_efuse_map_read(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) -+{ -+ hal_ReadEFuse_BT_logic_map(adapter,addr, cnts, data); -+ -+ return _SUCCESS; -+} -+ -+u8 rtw_BT_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) -+{ -+#define RT_ASSERT_RET(expr) \ -+ if (!(expr)) { \ -+ printk("Assertion failed! %s at ......\n", #expr); \ -+ printk(" ......%s,%s, line=%d\n",__FILE__, __FUNCTION__, __LINE__); \ -+ return _FAIL; \ -+ } -+ -+ u8 offset, word_en; -+ u8 *map; -+ u8 newdata[PGPKT_DATA_SIZE]; -+ s32 i = 0, j = 0, idx; -+ u8 ret = _SUCCESS; -+ u16 mapLen = 1024; -+ -+ if ((addr + cnts) > mapLen) -+ return _FAIL; -+ -+ RT_ASSERT_RET(PGPKT_DATA_SIZE == 8); /* have to be 8 byte alignment */ -+ RT_ASSERT_RET((mapLen & 0x7) == 0); /* have to be PGPKT_DATA_SIZE alignment for memcpy */ -+ -+ map = rtw_zmalloc(mapLen); -+ if (map == NULL) -+ return _FAIL; -+ -+ ret = rtw_BT_efuse_map_read(adapter, 0, mapLen, map); -+ if (ret == _FAIL) -+ goto exit; -+ RTW_INFO("OFFSET\tVALUE(hex)\n"); -+ for (i = 0; i < 1024; i += 16) { /* set 512 because the iwpriv's extra size have limit 0x7FF */ -+ RTW_INFO("0x%03x\t", i); -+ for (j = 0; j < 8; j++) -+ RTW_INFO("%02X ", map[i + j]); -+ RTW_INFO("\t"); -+ for (; j < 16; j++) -+ RTW_INFO("%02X ", map[i + j]); -+ RTW_INFO("\n"); -+ } -+ RTW_INFO("\n"); -+ -+ idx = 0; -+ offset = (addr >> 3); -+ while (idx < cnts) { -+ word_en = 0xF; -+ j = (addr + idx) & 0x7; -+ _rtw_memcpy(newdata, &map[offset << 3], PGPKT_DATA_SIZE); -+ for (i = j; i < PGPKT_DATA_SIZE && idx < cnts; i++, idx++) { -+ if (data[idx] != map[addr + idx]) { -+ word_en &= ~BIT(i >> 1); -+ newdata[i] = data[idx]; -+ } -+ } -+ -+ if (word_en != 0xF) { -+ RTW_INFO("offset=%x\n", offset); -+ RTW_INFO("word_en=%x\n", word_en); -+ RTW_INFO("%s: data=", __FUNCTION__); -+ for (i = 0; i < PGPKT_DATA_SIZE; i++) -+ RTW_INFO("0x%02X ", newdata[i]); -+ RTW_INFO("\n"); -+ ret = EfusePgPacketWrite_BT(adapter, offset, word_en, newdata, _FALSE); -+ if (ret == _FAIL) -+ break; -+ } -+ offset++; -+ } -+exit: -+ rtw_mfree(map, mapLen); -+ return _SUCCESS; -+} -+ -+VOID hal_ReadEFuse_BT_logic_map( -+ PADAPTER padapter, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf -+) -+{ -+ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+ -+ u8 *efuseTbl, *phyefuse; -+ u8 bank; -+ u16 eFuse_Addr = 0; -+ u8 efuseHeader, efuseExtHdr, efuseData; -+ u8 offset, wden; -+ u16 i, total, used; -+ u8 efuse_usage; -+ -+ -+ /* */ -+ /* Do NOT excess total size of EFuse table. Added by Roger, 2008.11.10. */ -+ /* */ -+ if ((_offset + _size_byte) > EFUSE_BT_MAP_LEN) { -+ RTW_INFO("%s: Invalid offset(%#x) with read bytes(%#x)!!\n", __FUNCTION__, _offset, _size_byte); -+ return; -+ } -+ -+ efuseTbl = rtw_malloc(EFUSE_BT_MAP_LEN); -+ phyefuse = rtw_malloc(EFUSE_BT_REAL_BANK_CONTENT_LEN); -+ if (efuseTbl == NULL || phyefuse == NULL) { -+ RTW_INFO("%s: efuseTbl or phyefuse malloc fail!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ /* 0xff will be efuse default value instead of 0x00. */ -+ _rtw_memset(efuseTbl, 0xFF, EFUSE_BT_MAP_LEN); -+ _rtw_memset(phyefuse, 0xFF, EFUSE_BT_REAL_BANK_CONTENT_LEN); -+ -+ if(rtw_efuse_bt_access(padapter, _FALSE, 0, EFUSE_BT_REAL_BANK_CONTENT_LEN, phyefuse)) -+ dump_buf(phyefuse, EFUSE_BT_REAL_BANK_CONTENT_LEN); -+ -+ total = BANK_NUM; -+ for (bank = 1; bank <= total; bank++) { /* 8723d Max bake 0~2 */ -+ eFuse_Addr = 0; -+ -+ while (AVAILABLE_EFUSE_ADDR(eFuse_Addr)) { -+ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); */ -+ efuseHeader = phyefuse[eFuse_Addr++]; -+ -+ if (efuseHeader == 0xFF) -+ break; -+ RTW_INFO("%s: efuse[%#X]=0x%02x (header)\n", __FUNCTION__, (((bank - 1) * EFUSE_BT_REAL_CONTENT_LEN) + eFuse_Addr - 1), efuseHeader); -+ -+ /* Check PG header for section num. */ -+ if (EXT_HEADER(efuseHeader)) { /* extended header */ -+ offset = GET_HDR_OFFSET_2_0(efuseHeader); -+ RTW_INFO("%s: extended header offset_2_0=0x%X\n", __FUNCTION__, offset); -+ -+ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); */ -+ efuseExtHdr = phyefuse[eFuse_Addr++]; -+ -+ RTW_INFO("%s: efuse[%#X]=0x%02x (ext header)\n", __FUNCTION__, (((bank - 1) * EFUSE_BT_REAL_CONTENT_LEN) + eFuse_Addr - 1), efuseExtHdr); -+ if (ALL_WORDS_DISABLED(efuseExtHdr)) -+ continue; -+ -+ offset |= ((efuseExtHdr & 0xF0) >> 1); -+ wden = (efuseExtHdr & 0x0F); -+ } else { -+ offset = ((efuseHeader >> 4) & 0x0f); -+ wden = (efuseHeader & 0x0f); -+ } -+ -+ if (offset < EFUSE_BT_MAX_SECTION) { -+ u16 addr; -+ -+ /* Get word enable value from PG header */ -+ RTW_INFO("%s: Offset=%d Worden=%#X\n", __FUNCTION__, offset, wden); -+ -+ addr = offset * PGPKT_DATA_SIZE; -+ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { -+ /* Check word enable condition in the section */ -+ if (!(wden & (0x01 << i))) { -+ efuseData = 0; -+ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseData, bPseudoTest); */ -+ efuseData = phyefuse[eFuse_Addr++]; -+ -+ RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, eFuse_Addr - 1, efuseData); -+ efuseTbl[addr] = efuseData; -+ -+ efuseData = 0; -+ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseData, bPseudoTest); */ -+ efuseData = phyefuse[eFuse_Addr++]; -+ -+ RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, eFuse_Addr - 1, efuseData); -+ efuseTbl[addr + 1] = efuseData; -+ } -+ addr += 2; -+ } -+ } else { -+ RTW_INFO("%s: offset(%d) is illegal!!\n", __FUNCTION__, offset); -+ eFuse_Addr += Efuse_CalculateWordCnts(wden) * 2; -+ } -+ } -+ -+ if ((eFuse_Addr - 1) < total) { -+ RTW_INFO("%s: bank(%d) data end at %#x\n", __FUNCTION__, bank, eFuse_Addr - 1); -+ break; -+ } -+ } -+ -+ /* switch bank back to bank 0 for later BT and wifi use. */ -+ //hal_EfuseSwitchToBank(padapter, 0, bPseudoTest); -+ -+ /* Copy from Efuse map to output pointer memory!!! */ -+ for (i = 0; i < _size_byte; i++) -+ pbuf[i] = efuseTbl[_offset + i]; -+ /* Calculate Efuse utilization */ -+ total = EFUSE_BT_REAL_BANK_CONTENT_LEN; -+ -+ used = eFuse_Addr - 1; -+ -+ if (total) -+ efuse_usage = (u8)((used * 100) / total); -+ else -+ efuse_usage = 100; -+ -+ fakeBTEfuseUsedBytes = used; -+ -+exit: -+ if (efuseTbl) -+ rtw_mfree(efuseTbl, EFUSE_BT_MAP_LEN); -+ if (phyefuse) -+ rtw_mfree(phyefuse, EFUSE_BT_REAL_BANK_CONTENT_LEN); -+} -+ -+ -+static u8 hal_EfusePartialWriteCheck( -+ PADAPTER padapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+ u8 bRet = _FALSE; -+ u16 startAddr = 0, efuse_max_available_len = EFUSE_BT_REAL_BANK_CONTENT_LEN, efuse_max = EFUSE_BT_REAL_BANK_CONTENT_LEN; -+ u8 efuse_data = 0; -+ -+ startAddr = (u16)fakeBTEfuseUsedBytes; -+ -+ startAddr %= efuse_max; -+ RTW_INFO("%s: startAddr=%#X\n", __FUNCTION__, startAddr); -+ -+ while (1) { -+ if (startAddr >= efuse_max_available_len) { -+ bRet = _FALSE; -+ RTW_INFO("%s: startAddr(%d) >= efuse_max_available_len(%d)\n", -+ __FUNCTION__, startAddr, efuse_max_available_len); -+ break; -+ } -+ if (rtw_efuse_bt_access(padapter, _FALSE, startAddr, 1, &efuse_data)&& (efuse_data != 0xFF)) { -+ bRet = _FALSE; -+ RTW_INFO("%s: Something Wrong! last bytes(%#X=0x%02X) is not 0xFF\n", -+ __FUNCTION__, startAddr, efuse_data); -+ break; -+ } else { -+ /* not used header, 0xff */ -+ *pAddr = startAddr; -+ /* RTW_INFO("%s: Started from unused header offset=%d\n", __FUNCTION__, startAddr)); */ -+ bRet = _TRUE; -+ break; -+ } -+ } -+ -+ return bRet; -+} -+ -+ -+static u8 hal_EfusePgPacketWrite2ByteHeader( -+ PADAPTER padapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest) -+{ -+ u16 efuse_addr, efuse_max_available_len = EFUSE_BT_REAL_BANK_CONTENT_LEN; -+ u8 pg_header = 0, tmp_header = 0; -+ u8 repeatcnt = 0; -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ efuse_addr = *pAddr; -+ if (efuse_addr >= efuse_max_available_len) { -+ RTW_INFO("%s: addr(%d) over avaliable(%d)!!\n", __FUNCTION__, efuse_addr, efuse_max_available_len); -+ return _FALSE; -+ } -+ -+ pg_header = ((pTargetPkt->offset & 0x07) << 5) | 0x0F; -+ /* RTW_INFO("%s: pg_header=0x%x\n", __FUNCTION__, pg_header); */ -+ -+ do { -+ -+ rtw_efuse_bt_access(padapter, _TRUE, efuse_addr, 1, &pg_header); -+ rtw_efuse_bt_access(padapter, _FALSE, efuse_addr, 1, &tmp_header); -+ -+ if (tmp_header != 0xFF) -+ break; -+ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { -+ RTW_INFO("%s: Repeat over limit for pg_header!!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ } while (1); -+ -+ if (tmp_header != pg_header) { -+ RTW_ERR("%s: PG Header Fail!!(pg=0x%02X read=0x%02X)\n", __FUNCTION__, pg_header, tmp_header); -+ return _FALSE; -+ } -+ -+ /* to write ext_header */ -+ efuse_addr++; -+ pg_header = ((pTargetPkt->offset & 0x78) << 1) | pTargetPkt->word_en; -+ -+ do { -+ rtw_efuse_bt_access(padapter, _TRUE, efuse_addr, 1, &pg_header); -+ rtw_efuse_bt_access(padapter, _FALSE, efuse_addr, 1, &tmp_header); -+ -+ if (tmp_header != 0xFF) -+ break; -+ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { -+ RTW_INFO("%s: Repeat over limit for ext_header!!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ } while (1); -+ -+ if (tmp_header != pg_header) { /* offset PG fail */ -+ RTW_ERR("%s: PG EXT Header Fail!!(pg=0x%02X read=0x%02X)\n", __FUNCTION__, pg_header, tmp_header); -+ return _FALSE; -+ } -+ -+ *pAddr = efuse_addr; -+ -+ return _TRUE; -+} -+ -+ -+static u8 hal_EfusePgPacketWrite1ByteHeader( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest) -+{ -+ u8 bRet = _FALSE; -+ u8 pg_header = 0, tmp_header = 0; -+ u16 efuse_addr = *pAddr; -+ u8 repeatcnt = 0; -+ -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ pg_header = ((pTargetPkt->offset << 4) & 0xf0) | pTargetPkt->word_en; -+ -+ do { -+ rtw_efuse_bt_access(pAdapter, _TRUE, efuse_addr, 1, &pg_header); -+ rtw_efuse_bt_access(pAdapter, _FALSE, efuse_addr, 1, &tmp_header); -+ -+ if (tmp_header != 0xFF) -+ break; -+ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { -+ RTW_INFO("%s: Repeat over limit for pg_header!!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ } while (1); -+ -+ if (tmp_header != pg_header) { -+ RTW_ERR("%s: PG Header Fail!!(pg=0x%02X read=0x%02X)\n", __FUNCTION__, pg_header, tmp_header); -+ return _FALSE; -+ } -+ -+ *pAddr = efuse_addr; -+ -+ return _TRUE; -+} -+ -+static u8 hal_EfusePgPacketWriteHeader( -+ PADAPTER padapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest) -+{ -+ u8 bRet = _FALSE; -+ -+ if (pTargetPkt->offset >= EFUSE_MAX_SECTION_BASE) -+ bRet = hal_EfusePgPacketWrite2ByteHeader(padapter, efuseType, pAddr, pTargetPkt, bPseudoTest); -+ else -+ bRet = hal_EfusePgPacketWrite1ByteHeader(padapter, efuseType, pAddr, pTargetPkt, bPseudoTest); -+ -+ return bRet; -+} -+ -+ -+static u8 -+Hal_EfuseWordEnableDataWrite( -+ PADAPTER padapter, -+ u16 efuse_addr, -+ u8 word_en, -+ u8 *data, -+ u8 bPseudoTest) -+{ -+ u16 tmpaddr = 0; -+ u16 start_addr = efuse_addr; -+ u8 badworden = 0x0F; -+ u8 tmpdata[PGPKT_DATA_SIZE]; -+ -+ -+ /* RTW_INFO("%s: efuse_addr=%#x word_en=%#x\n", __FUNCTION__, efuse_addr, word_en); */ -+ _rtw_memset(tmpdata, 0xFF, PGPKT_DATA_SIZE); -+ -+ if (!(word_en & BIT(0))) { -+ tmpaddr = start_addr; -+ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[0]); -+ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[1]); -+ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr, 1, &tmpdata[0]); -+ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr + 1, 1, &tmpdata[1]); -+ if ((data[0] != tmpdata[0]) || (data[1] != tmpdata[1])) -+ badworden &= (~BIT(0)); -+ } -+ if (!(word_en & BIT(1))) { -+ tmpaddr = start_addr; -+ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[2]); -+ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[3]); -+ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr, 1, &tmpdata[2]); -+ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr + 1, 1, &tmpdata[3]); -+ if ((data[2] != tmpdata[2]) || (data[3] != tmpdata[3])) -+ badworden &= (~BIT(1)); -+ } -+ if (!(word_en & BIT(2))) { -+ tmpaddr = start_addr; -+ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[4]); -+ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[5]); -+ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr, 1, &tmpdata[4]); -+ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr + 1, 1, &tmpdata[5]); -+ if ((data[4] != tmpdata[4]) || (data[5] != tmpdata[5])) -+ badworden &= (~BIT(2)); -+ } -+ if (!(word_en & BIT(3))) { -+ tmpaddr = start_addr; -+ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[6]); -+ rtw_efuse_bt_access(padapter, _TRUE, start_addr++, 1, &data[7]); -+ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr, 1, &tmpdata[6]); -+ rtw_efuse_bt_access(padapter, _FALSE, tmpaddr + 1, 1, &tmpdata[7]); -+ -+ if ((data[6] != tmpdata[6]) || (data[7] != tmpdata[7])) -+ badworden &= (~BIT(3)); -+ } -+ -+ return badworden; -+} -+ -+static void -+hal_EfuseConstructPGPkt( -+ u8 offset, -+ u8 word_en, -+ u8 *pData, -+ PPGPKT_STRUCT pTargetPkt) -+{ -+ _rtw_memset(pTargetPkt->data, 0xFF, PGPKT_DATA_SIZE); -+ pTargetPkt->offset = offset; -+ pTargetPkt->word_en = word_en; -+ efuse_WordEnableDataRead(word_en, pData, pTargetPkt->data); -+ pTargetPkt->word_cnts = Efuse_CalculateWordCnts(pTargetPkt->word_en); -+} -+ -+static u8 -+hal_EfusePgPacketWriteData( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest) -+{ -+ u16 efuse_addr; -+ u8 badworden; -+ -+ efuse_addr = *pAddr; -+ badworden = Hal_EfuseWordEnableDataWrite(pAdapter, efuse_addr + 1, pTargetPkt->word_en, pTargetPkt->data, bPseudoTest); -+ if (badworden != 0x0F) { -+ RTW_INFO("%s: Fail!!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ -+ /* RTW_INFO("%s: ok\n", __FUNCTION__); */ -+ return _TRUE; -+} -+ -+u8 EfusePgPacketWrite_BT( -+ PADAPTER pAdapter, -+ u8 offset, -+ u8 word_en, -+ u8 *pData, -+ u8 bPseudoTest) -+{ -+ PGPKT_STRUCT targetPkt; -+ u16 startAddr = 0; -+ u8 efuseType = EFUSE_BT; -+ -+ hal_EfuseConstructPGPkt(offset, word_en, pData, &targetPkt); -+ -+ if (!hal_EfusePartialWriteCheck(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return _FALSE; -+ -+ if (!hal_EfusePgPacketWriteHeader(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return _FALSE; -+ -+ if (!hal_EfusePgPacketWriteData(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+ -+#else /* !RTW_HALMAC */ -+/* ------------------------------------------------------------------------------ */ -+#define REG_EFUSE_CTRL 0x0030 -+#define EFUSE_CTRL REG_EFUSE_CTRL /* E-Fuse Control. */ -+/* ------------------------------------------------------------------------------ */ -+ -+BOOLEAN -+Efuse_Read1ByteFromFakeContent( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN OUT u8 *Value); -+BOOLEAN -+Efuse_Read1ByteFromFakeContent( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN OUT u8 *Value) -+{ -+ if (Offset >= EFUSE_MAX_HW_SIZE) -+ return _FALSE; -+ /* DbgPrint("Read fake content, offset = %d\n", Offset); */ -+ if (fakeEfuseBank == 0) -+ *Value = fakeEfuseContent[Offset]; -+ else -+ *Value = fakeBTEfuseContent[fakeEfuseBank - 1][Offset]; -+ return _TRUE; -+} -+ -+BOOLEAN -+Efuse_Write1ByteToFakeContent( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN u8 Value); -+BOOLEAN -+Efuse_Write1ByteToFakeContent( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN u8 Value) -+{ -+ if (Offset >= EFUSE_MAX_HW_SIZE) -+ return _FALSE; -+ if (fakeEfuseBank == 0) -+ fakeEfuseContent[Offset] = Value; -+ else -+ fakeBTEfuseContent[fakeEfuseBank - 1][Offset] = Value; -+ return _TRUE; -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: Efuse_PowerSwitch -+ * -+ * Overview: When we want to enable write operation, we should change to -+ * pwr on state. When we stop write, we should switch to 500k mode -+ * and disable LDO 2.5V. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/17/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+VOID -+Efuse_PowerSwitch( -+ IN PADAPTER pAdapter, -+ IN u8 bWrite, -+ IN u8 PwrState) -+{ -+ pAdapter->HalFunc.EfusePowerSwitch(pAdapter, bWrite, PwrState); -+} -+ -+VOID -+BTEfuse_PowerSwitch( -+ IN PADAPTER pAdapter, -+ IN u8 bWrite, -+ IN u8 PwrState) -+{ -+ if (pAdapter->HalFunc.BTEfusePowerSwitch) -+ pAdapter->HalFunc.BTEfusePowerSwitch(pAdapter, bWrite, PwrState); -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: efuse_GetCurrentSize -+ * -+ * Overview: Get current efuse size!!! -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/16/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+u16 -+Efuse_GetCurrentSize( -+ IN PADAPTER pAdapter, -+ IN u8 efuseType, -+ IN BOOLEAN bPseudoTest) -+{ -+ u16 ret = 0; -+ -+ ret = pAdapter->HalFunc.EfuseGetCurrentSize(pAdapter, efuseType, bPseudoTest); -+ -+ return ret; -+} -+ -+/* -+ * Description: -+ * Execute E-Fuse read byte operation. -+ * Refered from SD1 Richard. -+ * -+ * Assumption: -+ * 1. Boot from E-Fuse and successfully auto-load. -+ * 2. PASSIVE_LEVEL (USB interface) -+ * -+ * Created by Roger, 2008.10.21. -+ * */ -+VOID -+ReadEFuseByte( -+ PADAPTER Adapter, -+ u16 _offset, -+ u8 *pbuf, -+ IN BOOLEAN bPseudoTest) -+{ -+ u32 value32; -+ u8 readbyte; -+ u16 retry; -+ /* u32 start=rtw_get_current_time(); */ -+ -+ if (bPseudoTest) { -+ Efuse_Read1ByteFromFakeContent(Adapter, _offset, pbuf); -+ return; -+ } -+ if (IS_HARDWARE_TYPE_8723B(Adapter)) { -+ /* <20130121, Kordan> For SMIC S55 EFUSE specificatoin. */ -+ /* 0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) */ -+ PHY_SetMacReg(Adapter, EFUSE_TEST, BIT11, 0); -+ } -+ /* Write Address */ -+ rtw_write8(Adapter, EFUSE_CTRL + 1, (_offset & 0xff)); -+ readbyte = rtw_read8(Adapter, EFUSE_CTRL + 2); -+ rtw_write8(Adapter, EFUSE_CTRL + 2, ((_offset >> 8) & 0x03) | (readbyte & 0xfc)); -+ -+ /* Write bit 32 0 */ -+ readbyte = rtw_read8(Adapter, EFUSE_CTRL + 3); -+ rtw_write8(Adapter, EFUSE_CTRL + 3, (readbyte & 0x7f)); -+ -+ /* Check bit 32 read-ready */ -+ retry = 0; -+ value32 = rtw_read32(Adapter, EFUSE_CTRL); -+ /* while(!(((value32 >> 24) & 0xff) & 0x80) && (retry<10)) */ -+ while (!(((value32 >> 24) & 0xff) & 0x80) && (retry < 10000)) { -+ value32 = rtw_read32(Adapter, EFUSE_CTRL); -+ retry++; -+ } -+ -+ /* 20100205 Joseph: Add delay suggested by SD1 Victor. */ -+ /* This fix the problem that Efuse read error in high temperature condition. */ -+ /* Designer says that there shall be some delay after ready bit is set, or the */ -+ /* result will always stay on last data we read. */ -+ rtw_udelay_os(50); -+ value32 = rtw_read32(Adapter, EFUSE_CTRL); -+ -+ *pbuf = (u8)(value32 & 0xff); -+ /* RTW_INFO("ReadEFuseByte _offset:%08u, in %d ms\n",_offset ,rtw_get_passing_time_ms(start)); */ -+ -+} -+ -+/* -+ * Description: -+ * 1. Execute E-Fuse read byte operation according as map offset and -+ * save to E-Fuse table. -+ * 2. Refered from SD1 Richard. -+ * -+ * Assumption: -+ * 1. Boot from E-Fuse and successfully auto-load. -+ * 2. PASSIVE_LEVEL (USB interface) -+ * -+ * Created by Roger, 2008.10.21. -+ * -+ * 2008/12/12 MH 1. Reorganize code flow and reserve bytes. and add description. -+ * 2. Add efuse utilization collect. -+ * 2008/12/22 MH Read Efuse must check if we write section 1 data again!!! Sec1 -+ * write addr must be after sec5. -+ * */ -+ -+VOID -+efuse_ReadEFuse( -+ PADAPTER Adapter, -+ u8 efuseType, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ IN BOOLEAN bPseudoTest -+); -+VOID -+efuse_ReadEFuse( -+ PADAPTER Adapter, -+ u8 efuseType, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ IN BOOLEAN bPseudoTest -+) -+{ -+ Adapter->HalFunc.ReadEFuse(Adapter, efuseType, _offset, _size_byte, pbuf, bPseudoTest); -+} -+ -+VOID -+EFUSE_GetEfuseDefinition( -+ IN PADAPTER pAdapter, -+ IN u8 efuseType, -+ IN u8 type, -+ OUT void *pOut, -+ IN BOOLEAN bPseudoTest -+) -+{ -+ pAdapter->HalFunc.EFUSEGetEfuseDefinition(pAdapter, efuseType, type, pOut, bPseudoTest); -+} -+ -+ -+/* 11/16/2008 MH Read one byte from real Efuse. */ -+u8 -+efuse_OneByteRead( -+ IN PADAPTER pAdapter, -+ IN u16 addr, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) -+{ -+ u32 tmpidx = 0; -+ u8 bResult; -+ u8 readbyte; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ /* RTW_INFO("===> EFUSE_OneByteRead(), addr = %x\n", addr); */ -+ /* RTW_INFO("===> EFUSE_OneByteRead() start, 0x34 = 0x%X\n", rtw_read32(pAdapter, EFUSE_TEST)); */ -+ -+ if (bPseudoTest) { -+ bResult = Efuse_Read1ByteFromFakeContent(pAdapter, addr, data); -+ return bResult; -+ } -+ -+ if (IS_HARDWARE_TYPE_8723B(pAdapter) || -+ (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->VersionID))) || -+ (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->VersionID)) -+ ) { -+ /* <20130121, Kordan> For SMIC EFUSE specificatoin. */ -+ /* 0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) */ -+ /* PHY_SetMacReg(pAdapter, 0x34, BIT11, 0); */ -+ rtw_write16(pAdapter, 0x34, rtw_read16(pAdapter, 0x34) & (~BIT11)); -+ } -+ -+ /* -----------------e-fuse reg ctrl --------------------------------- */ -+ /* address */ -+ rtw_write8(pAdapter, EFUSE_CTRL + 1, (u8)(addr & 0xff)); -+ rtw_write8(pAdapter, EFUSE_CTRL + 2, ((u8)((addr >> 8) & 0x03)) | -+ (rtw_read8(pAdapter, EFUSE_CTRL + 2) & 0xFC)); -+ -+ /* rtw_write8(pAdapter, EFUSE_CTRL+3, 0x72); */ /* read cmd */ -+ /* Write bit 32 0 */ -+ readbyte = rtw_read8(pAdapter, EFUSE_CTRL + 3); -+ rtw_write8(pAdapter, EFUSE_CTRL + 3, (readbyte & 0x7f)); -+ -+ while (!(0x80 & rtw_read8(pAdapter, EFUSE_CTRL + 3)) && (tmpidx < 1000)) { -+ rtw_mdelay_os(1); -+ tmpidx++; -+ } -+ if (tmpidx < 100) { -+ *data = rtw_read8(pAdapter, EFUSE_CTRL); -+ bResult = _TRUE; -+ } else { -+ *data = 0xff; -+ bResult = _FALSE; -+ RTW_INFO("%s: [ERROR] addr=0x%x bResult=%d time out 1s !!!\n", __FUNCTION__, addr, bResult); -+ RTW_INFO("%s: [ERROR] EFUSE_CTRL =0x%08x !!!\n", __FUNCTION__, rtw_read32(pAdapter, EFUSE_CTRL)); -+ } -+ -+ return bResult; -+} -+ -+/* 11/16/2008 MH Write one byte to reald Efuse. */ -+u8 -+efuse_OneByteWrite( -+ IN PADAPTER pAdapter, -+ IN u16 addr, -+ IN u8 data, -+ IN BOOLEAN bPseudoTest) -+{ -+ u8 tmpidx = 0; -+ u8 bResult = _FALSE; -+ u32 efuseValue = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ /* RTW_INFO("===> EFUSE_OneByteWrite(), addr = %x data=%x\n", addr, data); */ -+ /* RTW_INFO("===> EFUSE_OneByteWrite() start, 0x34 = 0x%X\n", rtw_read32(pAdapter, EFUSE_TEST)); */ -+ -+ if (bPseudoTest) { -+ bResult = Efuse_Write1ByteToFakeContent(pAdapter, addr, data); -+ return bResult; -+ } -+ -+ -+ /* -----------------e-fuse reg ctrl --------------------------------- */ -+ /* address */ -+ -+ -+ efuseValue = rtw_read32(pAdapter, EFUSE_CTRL); -+ efuseValue |= (BIT21 | BIT31); -+ efuseValue &= ~(0x3FFFF); -+ efuseValue |= ((addr << 8 | data) & 0x3FFFF); -+ -+ /* <20130227, Kordan> 8192E MP chip A-cut had better not set 0x34[11] until B-Cut. */ -+ if (IS_HARDWARE_TYPE_8723B(pAdapter) || -+ (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->VersionID))) || -+ (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->VersionID)) -+ ) { -+ /* <20130121, Kordan> For SMIC EFUSE specificatoin. */ -+ /* 0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) */ -+ /* PHY_SetMacReg(pAdapter, 0x34, BIT11, 1); */ -+ rtw_write16(pAdapter, 0x34, rtw_read16(pAdapter, 0x34) | (BIT11)); -+ rtw_write32(pAdapter, EFUSE_CTRL, 0x90600000 | ((addr << 8 | data))); -+ } else -+ rtw_write32(pAdapter, EFUSE_CTRL, efuseValue); -+ -+ while ((0x80 & rtw_read8(pAdapter, EFUSE_CTRL + 3)) && (tmpidx < 100)) { -+ rtw_mdelay_os(1); -+ tmpidx++; -+ } -+ -+ if (tmpidx < 100) -+ bResult = _TRUE; -+ else { -+ bResult = _FALSE; -+ RTW_INFO("%s: [ERROR] addr=0x%x ,efuseValue=0x%x ,bResult=%d time out 1s !!!\n", -+ __FUNCTION__, addr, efuseValue, bResult); -+ RTW_INFO("%s: [ERROR] EFUSE_CTRL =0x%08x !!!\n", __FUNCTION__, rtw_read32(pAdapter, EFUSE_CTRL)); -+ } -+ -+ /* disable Efuse program enable */ -+ if (IS_HARDWARE_TYPE_8723B(pAdapter) || -+ (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->VersionID))) || -+ (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->VersionID)) -+ ) -+ PHY_SetMacReg(pAdapter, EFUSE_TEST, BIT(11), 0); -+ -+ return bResult; -+} -+ -+int -+Efuse_PgPacketRead(IN PADAPTER pAdapter, -+ IN u8 offset, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) -+{ -+ int ret = 0; -+ -+ ret = pAdapter->HalFunc.Efuse_PgPacketRead(pAdapter, offset, data, bPseudoTest); -+ -+ return ret; -+} -+ -+int -+Efuse_PgPacketWrite(IN PADAPTER pAdapter, -+ IN u8 offset, -+ IN u8 word_en, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) -+{ -+ int ret; -+ -+ ret = pAdapter->HalFunc.Efuse_PgPacketWrite(pAdapter, offset, word_en, data, bPseudoTest); -+ -+ return ret; -+} -+ -+ -+int -+Efuse_PgPacketWrite_BT(IN PADAPTER pAdapter, -+ IN u8 offset, -+ IN u8 word_en, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) -+{ -+ int ret; -+ -+ ret = pAdapter->HalFunc.Efuse_PgPacketWrite_BT(pAdapter, offset, word_en, data, bPseudoTest); -+ -+ return ret; -+} -+ -+ -+u8 -+Efuse_WordEnableDataWrite(IN PADAPTER pAdapter, -+ IN u16 efuse_addr, -+ IN u8 word_en, -+ IN u8 *data, -+ IN BOOLEAN bPseudoTest) -+{ -+ u8 ret = 0; -+ -+ ret = pAdapter->HalFunc.Efuse_WordEnableDataWrite(pAdapter, efuse_addr, word_en, data, bPseudoTest); -+ -+ return ret; -+} -+ -+static u8 efuse_read8(PADAPTER padapter, u16 address, u8 *value) -+{ -+ return efuse_OneByteRead(padapter, address, value, _FALSE); -+} -+ -+static u8 efuse_write8(PADAPTER padapter, u16 address, u8 *value) -+{ -+ return efuse_OneByteWrite(padapter, address, *value, _FALSE); -+} -+ -+/* -+ * read/wirte raw efuse data -+ */ -+u8 rtw_efuse_access(PADAPTER padapter, u8 bWrite, u16 start_addr, u16 cnts, u8 *data) -+{ -+ int i = 0; -+ u16 real_content_len = 0, max_available_size = 0; -+ u8 res = _FAIL ; -+ u8(*rw8)(PADAPTER, u16, u8 *); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN, (PVOID)&real_content_len, _FALSE); -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); -+ -+ if (start_addr > real_content_len) -+ return _FAIL; -+ -+ if (_TRUE == bWrite) { -+ if ((start_addr + cnts) > max_available_size) -+ return _FAIL; -+ rw8 = &efuse_write8; -+ } else -+ rw8 = &efuse_read8; -+ -+ Efuse_PowerSwitch(padapter, bWrite, _TRUE); -+ -+ /* e-fuse one byte read / write */ -+ for (i = 0; i < cnts; i++) { -+ if (start_addr >= real_content_len) { -+ res = _FAIL; -+ break; -+ } -+ -+ res = rw8(padapter, start_addr++, data++); -+ if (_FAIL == res) -+ break; -+ } -+ -+ Efuse_PowerSwitch(padapter, bWrite, _FALSE); -+ -+ return res; -+} -+/* ------------------------------------------------------------------------------ */ -+u16 efuse_GetMaxSize(PADAPTER padapter) -+{ -+ u16 max_size; -+ -+ max_size = 0; -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI , TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_size, _FALSE); -+ return max_size; -+} -+/* ------------------------------------------------------------------------------ */ -+u8 efuse_GetCurrentSize(PADAPTER padapter, u16 *size) -+{ -+ Efuse_PowerSwitch(padapter, _FALSE, _TRUE); -+ *size = Efuse_GetCurrentSize(padapter, EFUSE_WIFI, _FALSE); -+ Efuse_PowerSwitch(padapter, _FALSE, _FALSE); -+ -+ return _SUCCESS; -+} -+/* ------------------------------------------------------------------------------ */ -+u16 efuse_bt_GetMaxSize(PADAPTER padapter) -+{ -+ u16 max_size; -+ -+ max_size = 0; -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT , TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_size, _FALSE); -+ return max_size; -+} -+ -+u8 efuse_bt_GetCurrentSize(PADAPTER padapter, u16 *size) -+{ -+ Efuse_PowerSwitch(padapter, _FALSE, _TRUE); -+ *size = Efuse_GetCurrentSize(padapter, EFUSE_BT, _FALSE); -+ Efuse_PowerSwitch(padapter, _FALSE, _FALSE); -+ -+ return _SUCCESS; -+} -+ -+u8 rtw_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -+{ -+ u16 mapLen = 0; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); -+ -+ if ((addr + cnts) > mapLen) -+ return _FAIL; -+ -+ Efuse_PowerSwitch(padapter, _FALSE, _TRUE); -+ -+ efuse_ReadEFuse(padapter, EFUSE_WIFI, addr, cnts, data, _FALSE); -+ -+ Efuse_PowerSwitch(padapter, _FALSE, _FALSE); -+ -+ return _SUCCESS; -+} -+ -+u8 rtw_BT_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -+{ -+ u16 mapLen = 0; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); -+ -+ if ((addr + cnts) > mapLen) -+ return _FAIL; -+ -+ Efuse_PowerSwitch(padapter, _FALSE, _TRUE); -+ -+ efuse_ReadEFuse(padapter, EFUSE_BT, addr, cnts, data, _FALSE); -+ -+ Efuse_PowerSwitch(padapter, _FALSE, _FALSE); -+ -+ return _SUCCESS; -+} -+ -+/* ------------------------------------------------------------------------------ */ -+u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -+{ -+#define RT_ASSERT_RET(expr) \ -+ if (!(expr)) { \ -+ printk("Assertion failed! %s at ......\n", #expr); \ -+ printk(" ......%s,%s, line=%d\n",__FILE__, __FUNCTION__, __LINE__); \ -+ return _FAIL; \ -+ } -+ -+ u8 offset, word_en; -+ u8 *map; -+ u8 newdata[PGPKT_DATA_SIZE]; -+ s32 i, j, idx, chk_total_byte; -+ u8 ret = _SUCCESS; -+ u16 mapLen = 0, startAddr = 0, efuse_max_available_len = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &efuse_max_available_len, _FALSE); -+ -+ if ((addr + cnts) > mapLen) -+ return _FAIL; -+ -+ RT_ASSERT_RET(PGPKT_DATA_SIZE == 8); /* have to be 8 byte alignment */ -+ RT_ASSERT_RET((mapLen & 0x7) == 0); /* have to be PGPKT_DATA_SIZE alignment for memcpy */ -+ -+ map = rtw_zmalloc(mapLen); -+ if (map == NULL) -+ return _FAIL; -+ -+ _rtw_memset(map, 0xFF, mapLen); -+ -+ ret = rtw_efuse_map_read(padapter, 0, mapLen, map); -+ if (ret == _FAIL) -+ goto exit; -+ -+ if (padapter->registrypriv.boffefusemask == 0) { -+ for (i = 0; i < cnts; i++) { -+ if (padapter->registrypriv.bFileMaskEfuse == _TRUE) { -+ if (rtw_file_efuse_IsMasked(padapter, addr + i)) /*use file efuse mask. */ -+ data[i] = map[addr + i]; -+ } else { -+ if (efuse_IsMasked(padapter, addr + i)) -+ data[i] = map[addr + i]; -+ } -+ RTW_INFO("%s , data[%d] = %x, map[addr+i]= %x\n", __func__, i, data[i], map[addr + i]); -+ } -+ } -+ Efuse_PowerSwitch(padapter, _TRUE, _TRUE); -+ -+ chk_total_byte = 0; -+ idx = 0; -+ offset = (addr >> 3); -+ -+ while (idx < cnts) { -+ word_en = 0xF; -+ j = (addr + idx) & 0x7; -+ for (i = j; i < PGPKT_DATA_SIZE && idx < cnts; i++, idx++) { -+ if (data[idx] != map[addr + idx]) -+ word_en &= ~BIT(i >> 1); -+ } -+ -+ if (word_en != 0xF) { -+ chk_total_byte += Efuse_CalculateWordCnts(word_en) * 2; -+ -+ if (offset >= EFUSE_MAX_SECTION_BASE) /* Over EFUSE_MAX_SECTION 16 for 2 ByteHeader */ -+ chk_total_byte += 2; -+ else -+ chk_total_byte += 1; -+ } -+ -+ offset++; -+ } -+ -+ RTW_INFO("Total PG bytes Count = %d\n", chk_total_byte); -+ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&startAddr); -+ -+ if (startAddr == 0) { -+ startAddr = Efuse_GetCurrentSize(padapter, EFUSE_WIFI, _FALSE); -+ RTW_INFO("%s: Efuse_GetCurrentSize startAddr=%#X\n", __func__, startAddr); -+ } -+ RTW_DBG("%s: startAddr=%#X\n", __func__, startAddr); -+ -+ if ((startAddr + chk_total_byte) >= efuse_max_available_len) { -+ RTW_INFO("%s: startAddr(0x%X) + PG data len %d >= efuse_max_available_len(0x%X)\n", -+ __func__, startAddr, chk_total_byte, efuse_max_available_len); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ -+ idx = 0; -+ offset = (addr >> 3); -+ while (idx < cnts) { -+ word_en = 0xF; -+ j = (addr + idx) & 0x7; -+ _rtw_memcpy(newdata, &map[offset << 3], PGPKT_DATA_SIZE); -+ for (i = j; i < PGPKT_DATA_SIZE && idx < cnts; i++, idx++) { -+ if (data[idx] != map[addr + idx]) { -+ word_en &= ~BIT(i >> 1); -+ newdata[i] = data[idx]; -+#ifdef CONFIG_RTL8723B -+ if (addr + idx == 0x8) { -+ if (IS_C_CUT(pHalData->VersionID) || IS_B_CUT(pHalData->VersionID)) { -+ if (pHalData->adjuseVoltageVal == 6) { -+ newdata[i] = map[addr + idx]; -+ RTW_INFO(" %s ,\n adjuseVoltageVal = %d ,newdata[%d] = %x\n", __func__, pHalData->adjuseVoltageVal, i, newdata[i]); -+ } -+ } -+ } -+#endif -+ } -+ } -+ -+ if (word_en != 0xF) { -+ ret = Efuse_PgPacketWrite(padapter, offset, word_en, newdata, _FALSE); -+ RTW_INFO("offset=%x\n", offset); -+ RTW_INFO("word_en=%x\n", word_en); -+ -+ for (i = 0; i < PGPKT_DATA_SIZE; i++) -+ RTW_INFO("data=%x \t", newdata[i]); -+ if (ret == _FAIL) -+ break; -+ } -+ -+ offset++; -+ } -+ -+ Efuse_PowerSwitch(padapter, _TRUE, _FALSE); -+ -+exit: -+ -+ rtw_mfree(map, mapLen); -+ -+ return ret; -+} -+ -+u8 rtw_efuse_mask_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -+{ -+ u8 ret = _SUCCESS; -+ u16 mapLen = 0, i = 0; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); -+ -+ ret = rtw_efuse_map_read(padapter, addr, cnts , data); -+ -+ if (padapter->registrypriv.boffefusemask == 0) { -+ -+ for (i = 0; i < cnts; i++) { -+ if (padapter->registrypriv.bFileMaskEfuse == _TRUE) { -+ if (rtw_file_efuse_IsMasked(padapter, addr + i)) /*use file efuse mask.*/ -+ data[i] = 0xff; -+ } else { -+ /*RTW_INFO(" %s , data[%d] = %x\n", __func__, i, data[i]);*/ -+ if (efuse_IsMasked(padapter, addr + i)) { -+ data[i] = 0xff; -+ /*RTW_INFO(" %s ,mask data[%d] = %x\n", __func__, i, data[i]);*/ -+ } -+ } -+ } -+ -+ } -+ return ret; -+ -+} -+ -+u8 rtw_BT_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -+{ -+#define RT_ASSERT_RET(expr) \ -+ if (!(expr)) { \ -+ printk("Assertion failed! %s at ......\n", #expr); \ -+ printk(" ......%s,%s, line=%d\n",__FILE__, __FUNCTION__, __LINE__); \ -+ return _FAIL; \ -+ } -+ -+ u8 offset, word_en; -+ u8 *map; -+ u8 newdata[PGPKT_DATA_SIZE]; -+ s32 i = 0, j = 0, idx; -+ u8 ret = _SUCCESS; -+ u16 mapLen = 0; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); -+ -+ if ((addr + cnts) > mapLen) -+ return _FAIL; -+ -+ RT_ASSERT_RET(PGPKT_DATA_SIZE == 8); /* have to be 8 byte alignment */ -+ RT_ASSERT_RET((mapLen & 0x7) == 0); /* have to be PGPKT_DATA_SIZE alignment for memcpy */ -+ -+ map = rtw_zmalloc(mapLen); -+ if (map == NULL) -+ return _FAIL; -+ -+ ret = rtw_BT_efuse_map_read(padapter, 0, mapLen, map); -+ if (ret == _FAIL) -+ goto exit; -+ RTW_INFO("OFFSET\tVALUE(hex)\n"); -+ for (i = 0; i < 1024; i += 16) { /* set 512 because the iwpriv's extra size have limit 0x7FF */ -+ RTW_INFO("0x%03x\t", i); -+ for (j = 0; j < 8; j++) -+ RTW_INFO("%02X ", map[i + j]); -+ RTW_INFO("\t"); -+ for (; j < 16; j++) -+ RTW_INFO("%02X ", map[i + j]); -+ RTW_INFO("\n"); -+ } -+ RTW_INFO("\n"); -+ Efuse_PowerSwitch(padapter, _TRUE, _TRUE); -+ -+ idx = 0; -+ offset = (addr >> 3); -+ while (idx < cnts) { -+ word_en = 0xF; -+ j = (addr + idx) & 0x7; -+ _rtw_memcpy(newdata, &map[offset << 3], PGPKT_DATA_SIZE); -+ for (i = j; i < PGPKT_DATA_SIZE && idx < cnts; i++, idx++) { -+ if (data[idx] != map[addr + idx]) { -+ word_en &= ~BIT(i >> 1); -+ newdata[i] = data[idx]; -+ } -+ } -+ -+ if (word_en != 0xF) { -+ RTW_INFO("offset=%x\n", offset); -+ RTW_INFO("word_en=%x\n", word_en); -+ RTW_INFO("%s: data=", __FUNCTION__); -+ for (i = 0; i < PGPKT_DATA_SIZE; i++) -+ RTW_INFO("0x%02X ", newdata[i]); -+ RTW_INFO("\n"); -+ ret = Efuse_PgPacketWrite_BT(padapter, offset, word_en, newdata, _FALSE); -+ if (ret == _FAIL) -+ break; -+ } -+ -+ offset++; -+ } -+ -+ Efuse_PowerSwitch(padapter, _TRUE, _FALSE); -+ -+exit: -+ -+ rtw_mfree(map, mapLen); -+ -+ return ret; -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: Efuse_ReadAllMap -+ * -+ * Overview: Read All Efuse content -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/11/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+VOID -+Efuse_ReadAllMap( -+ IN PADAPTER pAdapter, -+ IN u8 efuseType, -+ IN OUT u8 *Efuse, -+ IN BOOLEAN bPseudoTest); -+VOID -+Efuse_ReadAllMap( -+ IN PADAPTER pAdapter, -+ IN u8 efuseType, -+ IN OUT u8 *Efuse, -+ IN BOOLEAN bPseudoTest) -+{ -+ u16 mapLen = 0; -+ -+ Efuse_PowerSwitch(pAdapter, _FALSE, _TRUE); -+ -+ EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, bPseudoTest); -+ -+ efuse_ReadEFuse(pAdapter, efuseType, 0, mapLen, Efuse, bPseudoTest); -+ -+ Efuse_PowerSwitch(pAdapter, _FALSE, _FALSE); -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: efuse_ShadowRead1Byte -+ * efuse_ShadowRead2Byte -+ * efuse_ShadowRead4Byte -+ * -+ * Overview: Read from efuse init map by one/two/four bytes !!!!! -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/12/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+static VOID -+efuse_ShadowRead1Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN OUT u8 *Value) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ -+ *Value = pHalData->efuse_eeprom_data[Offset]; -+ -+} /* EFUSE_ShadowRead1Byte */ -+ -+/* ---------------Read Two Bytes */ -+static VOID -+efuse_ShadowRead2Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN OUT u16 *Value) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ -+ *Value = pHalData->efuse_eeprom_data[Offset]; -+ *Value |= pHalData->efuse_eeprom_data[Offset + 1] << 8; -+ -+} /* EFUSE_ShadowRead2Byte */ -+ -+/* ---------------Read Four Bytes */ -+static VOID -+efuse_ShadowRead4Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN OUT u32 *Value) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ -+ *Value = pHalData->efuse_eeprom_data[Offset]; -+ *Value |= pHalData->efuse_eeprom_data[Offset + 1] << 8; -+ *Value |= pHalData->efuse_eeprom_data[Offset + 2] << 16; -+ *Value |= pHalData->efuse_eeprom_data[Offset + 3] << 24; -+ -+} /* efuse_ShadowRead4Byte */ -+ -+ -+/*----------------------------------------------------------------------------- -+ * Function: efuse_ShadowWrite1Byte -+ * efuse_ShadowWrite2Byte -+ * efuse_ShadowWrite4Byte -+ * -+ * Overview: Write efuse modify map by one/two/four byte. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/12/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+#ifdef PLATFORM -+static VOID -+efuse_ShadowWrite1Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN u8 Value); -+#endif /* PLATFORM */ -+static VOID -+efuse_ShadowWrite1Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN u8 Value) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ -+ pHalData->efuse_eeprom_data[Offset] = Value; -+ -+} /* efuse_ShadowWrite1Byte */ -+ -+/* ---------------Write Two Bytes */ -+static VOID -+efuse_ShadowWrite2Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN u16 Value) -+{ -+ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ -+ -+ pHalData->efuse_eeprom_data[Offset] = Value & 0x00FF; -+ pHalData->efuse_eeprom_data[Offset + 1] = Value >> 8; -+ -+} /* efuse_ShadowWrite1Byte */ -+ -+/* ---------------Write Four Bytes */ -+static VOID -+efuse_ShadowWrite4Byte( -+ IN PADAPTER pAdapter, -+ IN u16 Offset, -+ IN u32 Value) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ -+ pHalData->efuse_eeprom_data[Offset] = (u8)(Value & 0x000000FF); -+ pHalData->efuse_eeprom_data[Offset + 1] = (u8)((Value >> 8) & 0x0000FF); -+ pHalData->efuse_eeprom_data[Offset + 2] = (u8)((Value >> 16) & 0x00FF); -+ pHalData->efuse_eeprom_data[Offset + 3] = (u8)((Value >> 24) & 0xFF); -+ -+} /* efuse_ShadowWrite1Byte */ -+ -+ -+/*----------------------------------------------------------------------------- -+ * Function: EFUSE_ShadowRead -+ * -+ * Overview: Read from efuse init map !!!!! -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/12/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+EFUSE_ShadowRead( -+ IN PADAPTER pAdapter, -+ IN u8 Type, -+ IN u16 Offset, -+ IN OUT u32 *Value) -+{ -+ if (Type == 1) -+ efuse_ShadowRead1Byte(pAdapter, Offset, (u8 *)Value); -+ else if (Type == 2) -+ efuse_ShadowRead2Byte(pAdapter, Offset, (u16 *)Value); -+ else if (Type == 4) -+ efuse_ShadowRead4Byte(pAdapter, Offset, (u32 *)Value); -+ -+} /* EFUSE_ShadowRead */ -+ -+/*----------------------------------------------------------------------------- -+ * Function: EFUSE_ShadowWrite -+ * -+ * Overview: Write efuse modify map for later update operation to use!!!!! -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/12/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+VOID -+EFUSE_ShadowWrite( -+ IN PADAPTER pAdapter, -+ IN u8 Type, -+ IN u16 Offset, -+ IN OUT u32 Value); -+VOID -+EFUSE_ShadowWrite( -+ IN PADAPTER pAdapter, -+ IN u8 Type, -+ IN u16 Offset, -+ IN OUT u32 Value) -+{ -+#if (MP_DRIVER == 0) -+ return; -+#endif -+ if (pAdapter->registrypriv.mp_mode == 0) -+ return; -+ -+ -+ if (Type == 1) -+ efuse_ShadowWrite1Byte(pAdapter, Offset, (u8)Value); -+ else if (Type == 2) -+ efuse_ShadowWrite2Byte(pAdapter, Offset, (u16)Value); -+ else if (Type == 4) -+ efuse_ShadowWrite4Byte(pAdapter, Offset, (u32)Value); -+ -+} /* EFUSE_ShadowWrite */ -+ -+VOID -+Efuse_InitSomeVar( -+ IN PADAPTER pAdapter -+); -+VOID -+Efuse_InitSomeVar( -+ IN PADAPTER pAdapter -+) -+{ -+ u8 i; -+ -+ _rtw_memset((PVOID)&fakeEfuseContent[0], 0xff, EFUSE_MAX_HW_SIZE); -+ _rtw_memset((PVOID)&fakeEfuseInitMap[0], 0xff, EFUSE_MAX_MAP_LEN); -+ _rtw_memset((PVOID)&fakeEfuseModifiedMap[0], 0xff, EFUSE_MAX_MAP_LEN); -+ -+ for (i = 0; i < EFUSE_MAX_BT_BANK; i++) -+ _rtw_memset((PVOID)&BTEfuseContent[i][0], EFUSE_MAX_HW_SIZE, 0xff); -+ _rtw_memset((PVOID)&BTEfuseInitMap[0], 0xff, EFUSE_BT_MAX_MAP_LEN); -+ _rtw_memset((PVOID)&BTEfuseModifiedMap[0], 0xff, EFUSE_BT_MAX_MAP_LEN); -+ -+ for (i = 0; i < EFUSE_MAX_BT_BANK; i++) -+ _rtw_memset((PVOID)&fakeBTEfuseContent[i][0], 0xff, EFUSE_MAX_HW_SIZE); -+ _rtw_memset((PVOID)&fakeBTEfuseInitMap[0], 0xff, EFUSE_BT_MAX_MAP_LEN); -+ _rtw_memset((PVOID)&fakeBTEfuseModifiedMap[0], 0xff, EFUSE_BT_MAX_MAP_LEN); -+} -+#endif /* !RTW_HALMAC */ -+/* 11/16/2008 MH Add description. Get current efuse area enabled word!!. */ -+u8 -+Efuse_CalculateWordCnts(IN u8 word_en) -+{ -+ u8 word_cnts = 0; -+ if (!(word_en & BIT(0))) -+ word_cnts++; /* 0 : write enable */ -+ if (!(word_en & BIT(1))) -+ word_cnts++; -+ if (!(word_en & BIT(2))) -+ word_cnts++; -+ if (!(word_en & BIT(3))) -+ word_cnts++; -+ return word_cnts; -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: efuse_WordEnableDataRead -+ * -+ * Overview: Read allowed word in current efuse section data. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/16/2008 MHC Create Version 0. -+ * 11/21/2008 MHC Fix Write bug when we only enable late word. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+efuse_WordEnableDataRead(IN u8 word_en, -+ IN u8 *sourdata, -+ IN u8 *targetdata) -+{ -+ if (!(word_en & BIT(0))) { -+ targetdata[0] = sourdata[0]; -+ targetdata[1] = sourdata[1]; -+ } -+ if (!(word_en & BIT(1))) { -+ targetdata[2] = sourdata[2]; -+ targetdata[3] = sourdata[3]; -+ } -+ if (!(word_en & BIT(2))) { -+ targetdata[4] = sourdata[4]; -+ targetdata[5] = sourdata[5]; -+ } -+ if (!(word_en & BIT(3))) { -+ targetdata[6] = sourdata[6]; -+ targetdata[7] = sourdata[7]; -+ } -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: EFUSE_ShadowMapUpdate -+ * -+ * Overview: Transfer current EFUSE content to shadow init and modify map. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/13/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void EFUSE_ShadowMapUpdate( -+ IN PADAPTER pAdapter, -+ IN u8 efuseType, -+ IN BOOLEAN bPseudoTest) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ u16 mapLen = 0; -+#ifdef RTW_HALMAC -+ u8 *efuse_map = NULL; -+ int err; -+ -+ -+ mapLen = EEPROM_MAX_SIZE; -+ efuse_map = pHalData->efuse_eeprom_data; -+ /* efuse default content is 0xFF */ -+ _rtw_memset(efuse_map, 0xFF, EEPROM_MAX_SIZE); -+ -+ EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, bPseudoTest); -+ if (!mapLen) { -+ RTW_WARN("%s: fail to get efuse size!\n", __FUNCTION__); -+ mapLen = EEPROM_MAX_SIZE; -+ } -+ if (mapLen > EEPROM_MAX_SIZE) { -+ RTW_WARN("%s: size of efuse data(%d) is large than expected(%d)!\n", -+ __FUNCTION__, mapLen, EEPROM_MAX_SIZE); -+ mapLen = EEPROM_MAX_SIZE; -+ } -+ -+ if (pHalData->bautoload_fail_flag == _FALSE) { -+ err = rtw_halmac_read_logical_efuse_map(adapter_to_dvobj(pAdapter), efuse_map, mapLen); -+ if (err) -+ RTW_ERR("%s: fail to get efuse map!\n", __FUNCTION__); -+ } -+#else /* !RTW_HALMAC */ -+ EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, bPseudoTest); -+ -+ if (pHalData->bautoload_fail_flag == _TRUE) -+ _rtw_memset(pHalData->efuse_eeprom_data, 0xFF, mapLen); -+ else { -+#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+ if (_SUCCESS != retriveAdaptorInfoFile(pAdapter->registrypriv.adaptor_info_caching_file_path, pHalData->efuse_eeprom_data)) { -+#endif -+ -+ Efuse_ReadAllMap(pAdapter, efuseType, pHalData->efuse_eeprom_data, bPseudoTest); -+ -+#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+ storeAdaptorInfoFile(pAdapter->registrypriv.adaptor_info_caching_file_path, pHalData->efuse_eeprom_data); -+ } -+#endif -+ } -+ -+ /* PlatformMoveMemory((PVOID)&pHalData->EfuseMap[EFUSE_MODIFY_MAP][0], */ -+ /* (PVOID)&pHalData->EfuseMap[EFUSE_INIT_MAP][0], mapLen); */ -+#endif /* !RTW_HALMAC */ -+ -+ rtw_dump_cur_efuse(pAdapter); -+} /* EFUSE_ShadowMapUpdate */ -+ -+const u8 _mac_hidden_max_bw_to_hal_bw_cap[MAC_HIDDEN_MAX_BW_NUM] = { -+ 0, -+ 0, -+ (BW_CAP_160M | BW_CAP_80M | BW_CAP_40M | BW_CAP_20M | BW_CAP_10M | BW_CAP_5M), -+ (BW_CAP_5M), -+ (BW_CAP_10M | BW_CAP_5M), -+ (BW_CAP_20M | BW_CAP_10M | BW_CAP_5M), -+ (BW_CAP_40M | BW_CAP_20M | BW_CAP_10M | BW_CAP_5M), -+ (BW_CAP_80M | BW_CAP_40M | BW_CAP_20M | BW_CAP_10M | BW_CAP_5M), -+}; -+ -+const u8 _mac_hidden_proto_to_hal_proto_cap[MAC_HIDDEN_PROTOCOL_NUM] = { -+ 0, -+ 0, -+ (PROTO_CAP_11N | PROTO_CAP_11G | PROTO_CAP_11B), -+ (PROTO_CAP_11AC | PROTO_CAP_11N | PROTO_CAP_11G | PROTO_CAP_11B), -+}; -+ -+u8 mac_hidden_wl_func_to_hal_wl_func(u8 func) -+{ -+ u8 wl_func = 0; -+ -+ if (func & BIT0) -+ wl_func |= WL_FUNC_MIRACAST; -+ if (func & BIT1) -+ wl_func |= WL_FUNC_P2P; -+ if (func & BIT2) -+ wl_func |= WL_FUNC_TDLS; -+ if (func & BIT3) -+ wl_func |= WL_FUNC_FTM; -+ -+ return wl_func; -+} -+ -+#ifdef PLATFORM_LINUX -+#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+/* #include */ -+ -+int isAdaptorInfoFileValid(void) -+{ -+ return _TRUE; -+} -+ -+int storeAdaptorInfoFile(char *path, u8 *efuse_data) -+{ -+ int ret = _SUCCESS; -+ -+ if (path && efuse_data) { -+ ret = rtw_store_to_file(path, efuse_data, EEPROM_MAX_SIZE_512); -+ if (ret == EEPROM_MAX_SIZE) -+ ret = _SUCCESS; -+ else -+ ret = _FAIL; -+ } else { -+ RTW_INFO("%s NULL pointer\n", __FUNCTION__); -+ ret = _FAIL; -+ } -+ return ret; -+} -+ -+int retriveAdaptorInfoFile(char *path, u8 *efuse_data) -+{ -+ int ret = _SUCCESS; -+ mm_segment_t oldfs; -+ struct file *fp; -+ -+ if (path && efuse_data) { -+ -+ ret = rtw_retrieve_from_file(path, efuse_data, EEPROM_MAX_SIZE); -+ -+ if (ret == EEPROM_MAX_SIZE) -+ ret = _SUCCESS; -+ else -+ ret = _FAIL; -+ -+#if 0 -+ if (isAdaptorInfoFileValid()) -+ return 0; -+ else -+ return _FAIL; -+#endif -+ -+ } else { -+ RTW_INFO("%s NULL pointer\n", __FUNCTION__); -+ ret = _FAIL; -+ } -+ return ret; -+} -+#endif /* CONFIG_ADAPTOR_INFO_CACHING_FILE */ -+ -+u8 rtw_efuse_file_read(PADAPTER padapter, u8 *filepatch, u8 *buf, u32 len) -+{ -+ char *ptmpbuf = NULL, *ptr; -+ u8 val8; -+ u32 count, i, j; -+ int err; -+ u32 bufsize = 4096; -+ -+ ptmpbuf = rtw_zmalloc(bufsize); -+ if (ptmpbuf == NULL) -+ return _FALSE; -+ -+ count = rtw_retrieve_from_file(filepatch, ptmpbuf, bufsize); -+ if (count <= 100) { -+ rtw_mfree(ptmpbuf, bufsize); -+ RTW_ERR("%s, filepatch %s, size=%d, FAIL!!\n", __FUNCTION__, filepatch, count); -+ return _FALSE; -+ } -+ -+ i = 0; -+ j = 0; -+ ptr = ptmpbuf; -+ while ((j < len) && (i < count)) { -+ if (ptmpbuf[i] == '\0') -+ break; -+ -+ ptr = strpbrk(&ptmpbuf[i], " \t\n\r"); -+ if (ptr) { -+ if (ptr == &ptmpbuf[i]) { -+ i++; -+ continue; -+ } -+ -+ /* Add string terminating null */ -+ *ptr = 0; -+ } else { -+ ptr = &ptmpbuf[count-1]; -+ } -+ -+ err = sscanf(&ptmpbuf[i], "%hhx", &val8); -+ if (err != 1) { -+ RTW_WARN("Something wrong to parse efuse file, string=%s\n", &ptmpbuf[i]); -+ } else { -+ buf[j] = val8; -+ RTW_DBG("i=%d, j=%d, 0x%02x\n", i, j, buf[j]); -+ j++; -+ } -+ -+ i = ptr - ptmpbuf + 1; -+ } -+ -+ rtw_mfree(ptmpbuf, bufsize); -+ RTW_INFO("%s, filepatch %s, size=%d, done\n", __FUNCTION__, filepatch, count); -+ return _TRUE; -+} -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+u32 rtw_read_efuse_from_file(const char *path, u8 *buf, int map_size) -+{ -+ u32 i; -+ u8 c; -+ u8 temp[3]; -+ u8 temp_i; -+ u8 end = _FALSE; -+ u32 ret = _FAIL; -+ -+ u8 *file_data = NULL; -+ u32 file_size, read_size, pos = 0; -+ u8 *map = NULL; -+ -+ if (rtw_is_file_readable_with_size(path, &file_size) != _TRUE) { -+ RTW_PRINT("%s %s is not readable\n", __func__, path); -+ goto exit; -+ } -+ -+ file_data = rtw_vmalloc(file_size); -+ if (!file_data) { -+ RTW_ERR("%s rtw_vmalloc(%d) fail\n", __func__, file_size); -+ goto exit; -+ } -+ -+ read_size = rtw_retrieve_from_file(path, file_data, file_size); -+ if (read_size == 0) { -+ RTW_ERR("%s read from %s fail\n", __func__, path); -+ goto exit; -+ } -+ -+ map = rtw_vmalloc(map_size); -+ if (!map) { -+ RTW_ERR("%s rtw_vmalloc(%d) fail\n", __func__, map_size); -+ goto exit; -+ } -+ _rtw_memset(map, 0xff, map_size); -+ -+ temp[2] = 0; /* end of string '\0' */ -+ -+ for (i = 0 ; i < map_size ; i++) { -+ temp_i = 0; -+ -+ while (1) { -+ if (pos >= read_size) { -+ end = _TRUE; -+ break; -+ } -+ c = file_data[pos++]; -+ -+ /* bypass spece or eol or null before first hex digit */ -+ if (temp_i == 0 && (is_eol(c) == _TRUE || is_space(c) == _TRUE || is_null(c) == _TRUE)) -+ continue; -+ -+ if (IsHexDigit(c) == _FALSE) { -+ RTW_ERR("%s invalid 8-bit hex format for offset:0x%03x\n", __func__, i); -+ goto exit; -+ } -+ -+ temp[temp_i++] = c; -+ -+ if (temp_i == 2) { -+ /* parse value */ -+ if (sscanf(temp, "%hhx", &map[i]) != 1) { -+ RTW_ERR("%s sscanf fail for offset:0x%03x\n", __func__, i); -+ goto exit; -+ } -+ break; -+ } -+ } -+ -+ if (end == _TRUE) { -+ if (temp_i != 0) { -+ RTW_ERR("%s incomplete 8-bit hex format for offset:0x%03x\n", __func__, i); -+ goto exit; -+ } -+ break; -+ } -+ } -+ -+ RTW_PRINT("efuse file:%s, 0x%03x byte content read\n", path, i); -+ -+ _rtw_memcpy(buf, map, map_size); -+ -+ ret = _SUCCESS; -+ -+exit: -+ if (file_data) -+ rtw_vmfree(file_data, file_size); -+ if (map) -+ rtw_vmfree(map, map_size); -+ -+ return ret; -+} -+ -+u32 rtw_read_macaddr_from_file(const char *path, u8 *buf) -+{ -+ u32 i; -+ u8 temp[3]; -+ u32 ret = _FAIL; -+ -+ u8 file_data[17]; -+ u32 read_size, pos = 0; -+ u8 addr[ETH_ALEN]; -+ -+ if (rtw_is_file_readable(path) != _TRUE) { -+ RTW_PRINT("%s %s is not readable\n", __func__, path); -+ goto exit; -+ } -+ -+ read_size = rtw_retrieve_from_file(path, file_data, 17); -+ if (read_size != 17) { -+ RTW_ERR("%s read from %s fail\n", __func__, path); -+ goto exit; -+ } -+ -+ temp[2] = 0; /* end of string '\0' */ -+ -+ for (i = 0 ; i < ETH_ALEN ; i++) { -+ if (IsHexDigit(file_data[i * 3]) == _FALSE || IsHexDigit(file_data[i * 3 + 1]) == _FALSE) { -+ RTW_ERR("%s invalid 8-bit hex format for address offset:%u\n", __func__, i); -+ goto exit; -+ } -+ -+ if (i < ETH_ALEN - 1 && file_data[i * 3 + 2] != ':') { -+ RTW_ERR("%s invalid separator after address offset:%u\n", __func__, i); -+ goto exit; -+ } -+ -+ temp[0] = file_data[i * 3]; -+ temp[1] = file_data[i * 3 + 1]; -+ if (sscanf(temp, "%hhx", &addr[i]) != 1) { -+ RTW_ERR("%s sscanf fail for address offset:0x%03x\n", __func__, i); -+ goto exit; -+ } -+ } -+ -+ _rtw_memcpy(buf, addr, ETH_ALEN); -+ -+ RTW_PRINT("wifi_mac file: %s\n", path); -+#ifdef CONFIG_RTW_DEBUG -+ RTW_INFO(MAC_FMT"\n", MAC_ARG(buf)); -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_EFUSE_CONFIG_FILE */ -+ -+#endif /* PLATFORM_LINUX */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_ap.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ap.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_ap.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ap.c 2018-02-11 21:44:27.135145903 +0200 -@@ -0,0 +1,4119 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_AP_C_ -+ -+#include -+ -+ -+#ifdef CONFIG_AP_MODE -+ -+extern unsigned char RTW_WPA_OUI[]; -+extern unsigned char WMM_OUI[]; -+extern unsigned char WPS_OUI[]; -+extern unsigned char P2P_OUI[]; -+extern unsigned char WFD_OUI[]; -+ -+void init_mlme_ap_info(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ _rtw_spinlock_init(&pmlmepriv->bcn_update_lock); -+ -+ /* pmlmeext->bstart_bss = _FALSE; */ -+ -+} -+ -+void free_mlme_ap_info(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ stop_ap_mode(padapter); -+ _rtw_spinlock_free(&pmlmepriv->bcn_update_lock); -+ -+} -+ -+static void update_BCNTIM(_adapter *padapter) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network); -+ unsigned char *pie = pnetwork_mlmeext->IEs; -+ -+#if 0 -+ -+ -+ /* update TIM IE */ -+ /* if(pstapriv->tim_bitmap) */ -+#endif -+ if (_TRUE) { -+ u8 *p, *dst_ie, *premainder_ie = NULL, *pbackup_remainder_ie = NULL; -+ u16 tim_bitmap_le; -+ uint offset, tmp_len, tim_ielen, tim_ie_offset, remainder_ielen; -+ -+ tim_bitmap_le = cpu_to_le16(pstapriv->tim_bitmap); -+ -+ p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, _TIM_IE_, &tim_ielen, pnetwork_mlmeext->IELength - _FIXED_IE_LENGTH_); -+ if (p != NULL && tim_ielen > 0) { -+ tim_ielen += 2; -+ -+ premainder_ie = p + tim_ielen; -+ -+ tim_ie_offset = (sint)(p - pie); -+ -+ remainder_ielen = pnetwork_mlmeext->IELength - tim_ie_offset - tim_ielen; -+ -+ /*append TIM IE from dst_ie offset*/ -+ dst_ie = p; -+ } else { -+ tim_ielen = 0; -+ -+ /*calculate head_len*/ -+ offset = _FIXED_IE_LENGTH_; -+ -+ /* get ssid_ie len */ -+ p = rtw_get_ie(pie + _BEACON_IE_OFFSET_, _SSID_IE_, &tmp_len, (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_)); -+ if (p != NULL) -+ offset += tmp_len + 2; -+ -+ /*get supported rates len*/ -+ p = rtw_get_ie(pie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &tmp_len, (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_)); -+ if (p != NULL) -+ offset += tmp_len + 2; -+ -+ /*DS Parameter Set IE, len=3*/ -+ offset += 3; -+ -+ premainder_ie = pie + offset; -+ -+ remainder_ielen = pnetwork_mlmeext->IELength - offset - tim_ielen; -+ -+ /*append TIM IE from offset*/ -+ dst_ie = pie + offset; -+ -+ } -+ -+ if (remainder_ielen > 0) { -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if (pbackup_remainder_ie && premainder_ie) -+ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ *dst_ie++ = _TIM_IE_; -+ -+ if ((pstapriv->tim_bitmap & 0xff00) && (pstapriv->tim_bitmap & 0x00fe)) -+ tim_ielen = 5; -+ else -+ tim_ielen = 4; -+ -+ *dst_ie++ = tim_ielen; -+ -+ *dst_ie++ = 0;/*DTIM count*/ -+ *dst_ie++ = 1;/*DTIM period*/ -+ -+ if (pstapriv->tim_bitmap & BIT(0))/*for bc/mc frames*/ -+ *dst_ie++ = BIT(0);/*bitmap ctrl */ -+ else -+ *dst_ie++ = 0; -+ -+ if (tim_ielen == 4) { -+ u8 pvb = 0; -+ -+ if (pstapriv->tim_bitmap & 0x00fe) -+ pvb = (u8)tim_bitmap_le; -+ else if (pstapriv->tim_bitmap & 0xff00) -+ pvb = (u8)(tim_bitmap_le >> 8); -+ else -+ pvb = (u8)tim_bitmap_le; -+ -+ *dst_ie++ = pvb; -+ -+ } else if (tim_ielen == 5) { -+ _rtw_memcpy(dst_ie, &tim_bitmap_le, 2); -+ dst_ie += 2; -+ } -+ -+ /*copy remainder IE*/ -+ if (pbackup_remainder_ie) { -+ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ rtw_mfree(pbackup_remainder_ie, remainder_ielen); -+ } -+ -+ offset = (uint)(dst_ie - pie); -+ pnetwork_mlmeext->IELength = offset + remainder_ielen; -+ -+ } -+} -+ -+void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *data, u8 len) -+{ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 bmatch = _FALSE; -+ u8 *pie = pnetwork->IEs; -+ u8 *p = NULL, *dst_ie = NULL, *premainder_ie = NULL, *pbackup_remainder_ie = NULL; -+ u32 i, offset, ielen, ie_offset, remainder_ielen = 0; -+ -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pnetwork->IELength;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pnetwork->IEs + i); -+ -+ if (pIE->ElementID > index) -+ break; -+ else if (pIE->ElementID == index) { /* already exist the same IE */ -+ p = (u8 *)pIE; -+ ielen = pIE->Length; -+ bmatch = _TRUE; -+ break; -+ } -+ -+ p = (u8 *)pIE; -+ ielen = pIE->Length; -+ i += (pIE->Length + 2); -+ } -+ -+ if (p != NULL && ielen > 0) { -+ ielen += 2; -+ -+ premainder_ie = p + ielen; -+ -+ ie_offset = (sint)(p - pie); -+ -+ remainder_ielen = pnetwork->IELength - ie_offset - ielen; -+ -+ if (bmatch) -+ dst_ie = p; -+ else -+ dst_ie = (p + ielen); -+ } -+ -+ if (dst_ie == NULL) -+ return; -+ -+ if (remainder_ielen > 0) { -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if (pbackup_remainder_ie && premainder_ie) -+ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ *dst_ie++ = index; -+ *dst_ie++ = len; -+ -+ _rtw_memcpy(dst_ie, data, len); -+ dst_ie += len; -+ -+ /* copy remainder IE */ -+ if (pbackup_remainder_ie) { -+ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ rtw_mfree(pbackup_remainder_ie, remainder_ielen); -+ } -+ -+ offset = (uint)(dst_ie - pie); -+ pnetwork->IELength = offset + remainder_ielen; -+} -+ -+void rtw_remove_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index) -+{ -+ u8 *p, *dst_ie = NULL, *premainder_ie = NULL, *pbackup_remainder_ie = NULL; -+ uint offset, ielen, ie_offset, remainder_ielen = 0; -+ u8 *pie = pnetwork->IEs; -+ -+ p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, index, &ielen, pnetwork->IELength - _FIXED_IE_LENGTH_); -+ if (p != NULL && ielen > 0) { -+ ielen += 2; -+ -+ premainder_ie = p + ielen; -+ -+ ie_offset = (sint)(p - pie); -+ -+ remainder_ielen = pnetwork->IELength - ie_offset - ielen; -+ -+ dst_ie = p; -+ } else -+ return; -+ -+ if (remainder_ielen > 0) { -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if (pbackup_remainder_ie && premainder_ie) -+ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ /* copy remainder IE */ -+ if (pbackup_remainder_ie) { -+ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ rtw_mfree(pbackup_remainder_ie, remainder_ielen); -+ } -+ -+ offset = (uint)(dst_ie - pie); -+ pnetwork->IELength = offset + remainder_ielen; -+} -+ -+ -+u8 chk_sta_is_alive(struct sta_info *psta); -+u8 chk_sta_is_alive(struct sta_info *psta) -+{ -+ u8 ret = _FALSE; -+#ifdef DBG_EXPIRATION_CHK -+ RTW_INFO("sta:"MAC_FMT", rssi:%d, rx:"STA_PKTS_FMT", expire_to:%u, %s%ssq_len:%u\n" -+ , MAC_ARG(psta->hwaddr) -+ , psta->rssi_stat.UndecoratedSmoothedPWDB -+ /* , STA_RX_PKTS_ARG(psta) */ -+ , STA_RX_PKTS_DIFF_ARG(psta) -+ , psta->expire_to -+ , psta->state & WIFI_SLEEP_STATE ? "PS, " : "" -+ , psta->state & WIFI_STA_ALIVE_CHK_STATE ? "SAC, " : "" -+ , psta->sleepq_len -+ ); -+#endif -+ -+ /* if(sta_last_rx_pkts(psta) == sta_rx_pkts(psta)) */ -+ if ((psta->sta_stats.last_rx_data_pkts + psta->sta_stats.last_rx_ctrl_pkts) == (psta->sta_stats.rx_data_pkts + psta->sta_stats.rx_ctrl_pkts)) { -+#if 0 -+ if (psta->state & WIFI_SLEEP_STATE) -+ ret = _TRUE; -+#endif -+ } else -+ ret = _TRUE; -+ -+ sta_update_last_rx_pkts(psta); -+ -+ return ret; -+} -+ -+void expire_timeout_chk(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ u8 updated = _FALSE; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 chk_alive_num = 0; -+ char chk_alive_list[NUM_STA]; -+ int i; -+ -+ -+#ifdef CONFIG_MCC_MODE -+ /* then driver may check fail due to not recv client's frame under sitesurvey, -+ * don't expire timeout chk under MCC under sitesurvey */ -+ -+ if (rtw_hal_mcc_link_status_chk(padapter, __func__) == _FALSE) -+ return; -+#endif -+ -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ -+ phead = &pstapriv->auth_list; -+ plist = get_next(phead); -+ -+ /* check auth_queue */ -+#ifdef DBG_EXPIRATION_CHK -+ if (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ RTW_INFO(FUNC_NDEV_FMT" auth_list, cnt:%u\n" -+ , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->auth_list_cnt); -+ } -+#endif -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, auth_list); -+ -+ plist = get_next(plist); -+ -+ -+#ifdef CONFIG_ATMEL_RC_PATCH -+ if (_TRUE == _rtw_memcmp((void *)(pstapriv->atmel_rc_pattern), (void *)(psta->hwaddr), ETH_ALEN)) -+ continue; -+ if (psta->flag_atmel_rc) -+ continue; -+#endif -+ if (psta->expire_to > 0) { -+ psta->expire_to--; -+ if (psta->expire_to == 0) { -+ rtw_list_delete(&psta->auth_list); -+ pstapriv->auth_list_cnt--; -+ -+ RTW_INFO("auth expire %02X%02X%02X%02X%02X%02X\n", -+ psta->hwaddr[0], psta->hwaddr[1], psta->hwaddr[2], psta->hwaddr[3], psta->hwaddr[4], psta->hwaddr[5]); -+ -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ rtw_free_stainfo(padapter, psta); -+ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ } -+ } -+ -+ } -+ -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ psta = NULL; -+ -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* check asoc_queue */ -+#ifdef DBG_EXPIRATION_CHK -+ if (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ RTW_INFO(FUNC_NDEV_FMT" asoc_list, cnt:%u\n" -+ , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->asoc_list_cnt); -+ } -+#endif -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+#ifdef CONFIG_ATMEL_RC_PATCH -+ RTW_INFO("%s:%d psta=%p, %02x,%02x||%02x,%02x \n\n", __func__, __LINE__, -+ psta, pstapriv->atmel_rc_pattern[0], pstapriv->atmel_rc_pattern[5], psta->hwaddr[0], psta->hwaddr[5]); -+ if (_TRUE == _rtw_memcmp((void *)pstapriv->atmel_rc_pattern, (void *)(psta->hwaddr), ETH_ALEN)) -+ continue; -+ if (psta->flag_atmel_rc) -+ continue; -+ RTW_INFO("%s: debug line:%d\n", __func__, __LINE__); -+#endif -+#ifdef CONFIG_AUTO_AP_MODE -+ if (psta->isrc) -+ continue; -+#endif -+ if (chk_sta_is_alive(psta) || !psta->expire_to) { -+ psta->expire_to = pstapriv->expire_to; -+ psta->keep_alive_trycnt = 0; -+#ifdef CONFIG_TX_MCAST2UNI -+ psta->under_exist_checking = 0; -+#endif /* CONFIG_TX_MCAST2UNI */ -+ } else -+ psta->expire_to--; -+ -+#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+#ifdef CONFIG_80211N_HT -+#ifdef CONFIG_TX_MCAST2UNI -+ if ((psta->flags & WLAN_STA_HT) && (psta->htpriv.agg_enable_bitmap || psta->under_exist_checking)) { -+ /* check sta by delba(addba) for 11n STA */ -+ /* ToDo: use CCX report to check for all STAs */ -+ /* RTW_INFO("asoc check by DELBA/ADDBA! (pstapriv->expire_to=%d s)(psta->expire_to=%d s), [%02x, %d]\n", pstapriv->expire_to*2, psta->expire_to*2, psta->htpriv.agg_enable_bitmap, psta->under_exist_checking); */ -+ -+ if (psta->expire_to <= (pstapriv->expire_to - 50)) { -+ RTW_INFO("asoc expire by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to - psta->expire_to) * 2); -+ psta->under_exist_checking = 0; -+ psta->expire_to = 0; -+ } else if (psta->expire_to <= (pstapriv->expire_to - 3) && (psta->under_exist_checking == 0)) { -+ RTW_INFO("asoc check by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to - psta->expire_to) * 2); -+ psta->under_exist_checking = 1; -+ /* tear down TX AMPDU */ -+ send_delba(padapter, 1, psta->hwaddr);/* */ /* originator */ -+ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ -+ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ -+ } -+ } -+#endif /* CONFIG_TX_MCAST2UNI */ -+#endif /* CONFIG_80211N_HT */ -+#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ -+ if (psta->expire_to <= 0) { -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (padapter->registrypriv.wifi_spec == 1) { -+ psta->expire_to = pstapriv->expire_to; -+ continue; -+ } -+ -+#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+#ifdef CONFIG_80211N_HT -+ -+#define KEEP_ALIVE_TRYCNT (3) -+ -+ if (psta->keep_alive_trycnt > 0 && psta->keep_alive_trycnt <= KEEP_ALIVE_TRYCNT) { -+ if (psta->state & WIFI_STA_ALIVE_CHK_STATE) -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ else -+ psta->keep_alive_trycnt = 0; -+ -+ } else if ((psta->keep_alive_trycnt > KEEP_ALIVE_TRYCNT) && !(psta->state & WIFI_STA_ALIVE_CHK_STATE)) -+ psta->keep_alive_trycnt = 0; -+ if ((psta->htpriv.ht_option == _TRUE) && (psta->htpriv.ampdu_enable == _TRUE)) { -+ uint priority = 1; /* test using BK */ -+ u8 issued = 0; -+ -+ /* issued = (psta->htpriv.agg_enable_bitmap>>priority)&0x1; */ -+ issued |= (psta->htpriv.candidate_tid_bitmap >> priority) & 0x1; -+ -+ if (0 == issued) { -+ if (!(psta->state & WIFI_STA_ALIVE_CHK_STATE)) { -+ psta->htpriv.candidate_tid_bitmap |= BIT((u8)priority); -+ -+ if (psta->state & WIFI_SLEEP_STATE) -+ psta->expire_to = 2; /* 2x2=4 sec */ -+ else -+ psta->expire_to = 1; /* 2 sec */ -+ -+ psta->state |= WIFI_STA_ALIVE_CHK_STATE; -+ -+ /* add_ba_hdl(padapter, (u8*)paddbareq_parm); */ -+ -+ RTW_INFO("issue addba_req to check if sta alive, keep_alive_trycnt=%d\n", psta->keep_alive_trycnt); -+ -+ issue_addba_req(padapter, psta->hwaddr, (u8)priority); -+ -+ _set_timer(&psta->addba_retry_timer, ADDBA_TO); -+ -+ psta->keep_alive_trycnt++; -+ -+ continue; -+ } -+ } -+ } -+ if (psta->keep_alive_trycnt > 0 && psta->state & WIFI_STA_ALIVE_CHK_STATE) { -+ psta->keep_alive_trycnt = 0; -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ RTW_INFO("change to another methods to check alive if staion is at ps mode\n"); -+ } -+ -+#endif /* CONFIG_80211N_HT */ -+#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ if (psta->state & WIFI_SLEEP_STATE) { -+ if (!(psta->state & WIFI_STA_ALIVE_CHK_STATE)) { -+ /* to check if alive by another methods if staion is at ps mode. */ -+ psta->expire_to = pstapriv->expire_to; -+ psta->state |= WIFI_STA_ALIVE_CHK_STATE; -+ -+ /* RTW_INFO("alive chk, sta:" MAC_FMT " is at ps mode!\n", MAC_ARG(psta->hwaddr)); */ -+ -+ /* to update bcn with tim_bitmap for this station */ -+ pstapriv->tim_bitmap |= BIT(psta->aid); -+ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); -+ -+ if (!pmlmeext->active_keep_alive_check) -+ continue; -+ } -+ } -+#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ if (pmlmeext->active_keep_alive_check) { -+ int stainfo_offset; -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ chk_alive_list[chk_alive_num++] = stainfo_offset; -+ -+ continue; -+ } -+#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ RTW_INFO("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); -+ updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); -+ } else { -+ /* TODO: Aging mechanism to digest frames in sleep_q to avoid running out of xmitframe */ -+ if (psta->sleepq_len > (NR_XMITFRAME / pstapriv->asoc_list_cnt) -+ && padapter->xmitpriv.free_xmitframe_cnt < ((NR_XMITFRAME / pstapriv->asoc_list_cnt) / 2) -+ ) { -+ RTW_INFO("%s sta:"MAC_FMT", sleepq_len:%u, free_xmitframe_cnt:%u, asoc_list_cnt:%u, clear sleep_q\n", __func__ -+ , MAC_ARG(psta->hwaddr) -+ , psta->sleepq_len, padapter->xmitpriv.free_xmitframe_cnt, pstapriv->asoc_list_cnt); -+ wakeup_sta_to_xmit(padapter, psta); -+ } -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ if (chk_alive_num) { -+ -+ u8 backup_ch = 0, backup_bw, backup_offset; -+ u8 union_ch = 0, union_bw, union_offset; -+ u8 switch_channel = _TRUE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (!rtw_mi_get_ch_setting_union(padapter, &union_ch, &union_bw, &union_offset) -+ || pmlmeext->cur_channel != union_ch) -+ goto bypass_active_keep_alive; -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) { -+ /* driver doesn't switch channel under MCC */ -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) -+ switch_channel = _FALSE; -+ } -+#endif -+ /* switch to correct channel of current network before issue keep-alive frames */ -+ if (switch_channel == _TRUE && rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { -+ backup_ch = rtw_get_oper_ch(padapter); -+ backup_bw = rtw_get_oper_bw(padapter); -+ backup_offset = rtw_get_oper_choffset(padapter); -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ } -+ -+ /* issue null data to check sta alive*/ -+ for (i = 0; i < chk_alive_num; i++) { -+ int ret = _FAIL; -+ -+ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); -+#ifdef CONFIG_ATMEL_RC_PATCH -+ if (_TRUE == _rtw_memcmp(pstapriv->atmel_rc_pattern, psta->hwaddr, ETH_ALEN)) -+ continue; -+ if (psta->flag_atmel_rc) -+ continue; -+#endif -+ if (!(psta->state & _FW_LINKED)) -+ continue; -+ -+ if (psta->state & WIFI_SLEEP_STATE) -+ ret = issue_nulldata(padapter, psta->hwaddr, 0, 1, 50); -+ else -+ ret = issue_nulldata(padapter, psta->hwaddr, 0, 3, 50); -+ -+ psta->keep_alive_trycnt++; -+ if (ret == _SUCCESS) { -+ RTW_INFO("asoc check, sta(" MAC_FMT ") is alive\n", MAC_ARG(psta->hwaddr)); -+ psta->expire_to = pstapriv->expire_to; -+ psta->keep_alive_trycnt = 0; -+ continue; -+ } else if (psta->keep_alive_trycnt <= 3) { -+ RTW_INFO("ack check for asoc expire, keep_alive_trycnt=%d\n", psta->keep_alive_trycnt); -+ psta->expire_to = 1; -+ continue; -+ } -+ -+ psta->keep_alive_trycnt = 0; -+ RTW_INFO("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ } -+ -+ /* back to the original operation channel */ -+ if (switch_channel && backup_ch > 0) -+ set_channel_bwmode(padapter, backup_ch, backup_offset, backup_bw); -+ -+bypass_active_keep_alive: -+ ; -+ } -+#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); -+} -+ -+void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level) -+{ -+ int i; -+ u8 rf_type; -+ unsigned char sta_band = 0; -+ u64 tx_ra_bitmap = 0; -+ struct ht_priv *psta_ht = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ -+#ifdef CONFIG_80211N_HT -+ if (psta) -+ psta_ht = &psta->htpriv; -+ else -+ return; -+#endif /* CONFIG_80211N_HT */ -+ -+ if (!(psta->state & _FW_LINKED)) -+ return; -+ -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ tx_ra_bitmap = psta->ra_mask; -+ -+ if (pcur_network->Configuration.DSConfig > 14) { -+ -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_5N ; -+ -+ if (tx_ra_bitmap & 0xff0) -+ sta_band |= WIRELESS_11A; -+ -+ /* 5G band */ -+#ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) -+ sta_band = WIRELESS_11_5AC; -+#endif -+ -+ } else { -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_24N; -+ -+ if (tx_ra_bitmap & 0xff0) -+ sta_band |= WIRELESS_11G; -+ -+ if (tx_ra_bitmap & 0x0f) -+ sta_band |= WIRELESS_11B; -+ } -+ -+ psta->wireless_mode = sta_band; -+ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); -+ -+ if (psta->aid < NUM_STA) { -+ RTW_INFO("%s=> mac_id:%d , raid:%d, tx_ra_bitmap:0x%016llx, networkType:0x%02x\n", -+ __FUNCTION__, psta->mac_id, psta->raid, tx_ra_bitmap, psta->wireless_mode); -+ -+ rtw_update_ramask(padapter, psta, psta->mac_id, rssi_level); -+ } else -+ RTW_INFO("station aid %d exceed the max number\n", psta->aid); -+ -+} -+ -+void update_bmc_sta(_adapter *padapter) -+{ -+ _irqL irqL; -+ unsigned char network_type; -+ int supportRateNum = 0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ struct sta_info *psta = rtw_get_bcmc_stainfo(padapter); -+ -+ if (psta) { -+ psta->aid = 0;/* default set to 0 */ -+ psta->qos_option = 0; -+#ifdef CONFIG_80211N_HT -+ psta->htpriv.ht_option = _FALSE; -+#endif /* CONFIG_80211N_HT */ -+ -+ psta->ieee8021x_blocked = 0; -+ -+ _rtw_memset((void *)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); -+ -+ /* psta->dot118021XPrivacy = _NO_PRIVACY_; */ /* !!! remove it, because it has been set before this. */ -+ -+ /* prepare for add_RATid */ -+ supportRateNum = rtw_get_rateset_len((u8 *)&pcur_network->SupportedRates); -+ network_type = rtw_check_network_type((u8 *)&pcur_network->SupportedRates, supportRateNum, pcur_network->Configuration.DSConfig); -+ if (IsSupportedTxCCK(network_type)) -+ network_type = WIRELESS_11B; -+ else if (network_type == WIRELESS_INVALID) { /* error handling */ -+ if (pcur_network->Configuration.DSConfig > 14) -+ network_type = WIRELESS_11A; -+ else -+ network_type = WIRELESS_11B; -+ } -+ update_sta_basic_rate(psta, network_type); -+ psta->wireless_mode = network_type; -+ -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ -+ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state = _FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ rtw_sta_media_status_rpt(padapter, psta, 1); -+ rtw_hal_update_ra_mask(psta, 0); -+ } else -+ RTW_INFO("add_RATid_bmc_sta error!\n"); -+ -+} -+ -+/* notes: -+ * AID: 1~MAX for sta and 0 for bc/mc in ap/adhoc mode */ -+void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+#ifdef CONFIG_80211N_HT -+ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; -+ struct ht_priv *phtpriv_sta = &psta->htpriv; -+#endif /* CONFIG_80211N_HT */ -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0; -+ /* set intf_tag to if1 */ -+ /* psta->intf_tag = 0; */ -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ /*alloc macid when call rtw_alloc_stainfo(),release macid when call rtw_free_stainfo()*/ -+ -+ /* ap mode */ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); -+ -+ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) -+ psta->ieee8021x_blocked = _TRUE; -+ else -+ psta->ieee8021x_blocked = _FALSE; -+ -+ -+ /* update sta's cap */ -+ -+ /* ERP */ -+ VCS_update(padapter, psta); -+#ifdef CONFIG_80211N_HT -+ /* HT related cap */ -+ if (phtpriv_sta->ht_option) { -+ /* check if sta supports rx ampdu */ -+ phtpriv_sta->ampdu_enable = phtpriv_ap->ampdu_enable; -+ -+ phtpriv_sta->rx_ampdu_min_spacing = (phtpriv_sta->ht_cap.ampdu_params_info & IEEE80211_HT_CAP_AMPDU_DENSITY) >> 2; -+ -+ /* bwmode */ -+ if ((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) -+ psta->bw_mode = CHANNEL_WIDTH_40; -+ else -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ -+ if (psta->ht_40mhz_intolerant) -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ -+ if (pmlmeext->cur_bwmode < psta->bw_mode) -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ -+ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; -+ -+ -+ /* check if sta support s Short GI 20M */ -+ if ((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_20)) -+ phtpriv_sta->sgi_20m = _TRUE; -+ -+ /* check if sta support s Short GI 40M */ -+ if ((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) { -+ if (psta->bw_mode == CHANNEL_WIDTH_40) /* according to psta->bw_mode */ -+ phtpriv_sta->sgi_40m = _TRUE; -+ else -+ phtpriv_sta->sgi_40m = _FALSE; -+ } -+ -+ psta->qos_option = _TRUE; -+ -+ /* B0 Config LDPC Coding Capability */ -+ if (TEST_FLAG(phtpriv_ap->ldpc_cap, LDPC_HT_ENABLE_TX) && -+ GET_HT_CAP_ELE_LDPC_CAP((u8 *)(&phtpriv_sta->ht_cap))) { -+ SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX)); -+ RTW_INFO("Enable HT Tx LDPC for STA(%d)\n", psta->aid); -+ } -+ -+ /* B7 B8 B9 Config STBC setting */ -+ if (TEST_FLAG(phtpriv_ap->stbc_cap, STBC_HT_ENABLE_TX) && -+ GET_HT_CAP_ELE_RX_STBC((u8 *)(&phtpriv_sta->ht_cap))) { -+ SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX)); -+ RTW_INFO("Enable HT Tx STBC for STA(%d)\n", psta->aid); -+ } -+ -+#ifdef CONFIG_BEAMFORMING -+ /*Config Tx beamforming setting*/ -+ if (TEST_FLAG(phtpriv_ap->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP((u8 *)(&phtpriv_sta->ht_cap))) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); -+ /*Shift to BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS((u8 *)(&phtpriv_sta->ht_cap)) << 6); -+ } -+ -+ if (TEST_FLAG(phtpriv_ap->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP((u8 *)(&phtpriv_sta->ht_cap))) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); -+ /*Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS((u8 *)(&phtpriv_sta->ht_cap)) << 4); -+ } -+ if (cur_beamform_cap) -+ RTW_INFO("Client STA(%d) HT Beamforming Cap = 0x%02X\n", psta->aid, cur_beamform_cap); -+#endif /*CONFIG_BEAMFORMING*/ -+ } else { -+ phtpriv_sta->ampdu_enable = _FALSE; -+ -+ phtpriv_sta->sgi_20m = _FALSE; -+ phtpriv_sta->sgi_40m = _FALSE; -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ phtpriv_sta->ldpc_cap = cur_ldpc_cap; -+ phtpriv_sta->stbc_cap = cur_stbc_cap; -+ phtpriv_sta->beamform_cap = cur_beamform_cap; -+ -+ /* Rx AMPDU */ -+ send_delba(padapter, 0, psta->hwaddr);/* recipient */ -+ -+ /* TX AMPDU */ -+ send_delba(padapter, 1, psta->hwaddr);/* */ /* originator */ -+ phtpriv_sta->agg_enable_bitmap = 0x0;/* reset */ -+ phtpriv_sta->candidate_tid_bitmap = 0x0;/* reset */ -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_80211AC_VHT -+ update_sta_vht_info_apmode(padapter, psta); -+#endif -+ -+ update_ldpc_stbc_cap(psta); -+ -+ /* todo: init other variables */ -+ -+ _rtw_memset((void *)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); -+ -+ -+ /* add ratid */ -+ /* add_RATid(padapter, psta); */ /* move to ap_sta_info_defer_update() */ -+ -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state |= _FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ -+} -+ -+static void update_ap_info(_adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+#ifdef CONFIG_80211N_HT -+ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; -+#endif /* CONFIG_80211N_HT */ -+ -+ psta->wireless_mode = pmlmeext->cur_wireless_mode; -+ -+ psta->bssratelen = rtw_get_rateset_len(pnetwork->SupportedRates); -+ _rtw_memcpy(psta->bssrateset, pnetwork->SupportedRates, psta->bssratelen); -+ -+#ifdef CONFIG_80211N_HT -+ /* HT related cap */ -+ if (phtpriv_ap->ht_option) { -+ /* check if sta supports rx ampdu */ -+ /* phtpriv_ap->ampdu_enable = phtpriv_ap->ampdu_enable; */ -+ -+ /* check if sta support s Short GI 20M */ -+ if ((phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_20)) -+ phtpriv_ap->sgi_20m = _TRUE; -+ /* check if sta support s Short GI 40M */ -+ if ((phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) -+ phtpriv_ap->sgi_40m = _TRUE; -+ -+ psta->qos_option = _TRUE; -+ } else { -+ phtpriv_ap->ampdu_enable = _FALSE; -+ -+ phtpriv_ap->sgi_20m = _FALSE; -+ phtpriv_ap->sgi_40m = _FALSE; -+ } -+ -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ phtpriv_ap->ch_offset = pmlmeext->cur_ch_offset; -+ -+ phtpriv_ap->agg_enable_bitmap = 0x0;/* reset */ -+ phtpriv_ap->candidate_tid_bitmap = 0x0;/* reset */ -+ -+ _rtw_memcpy(&psta->htpriv, &pmlmepriv->htpriv, sizeof(struct ht_priv)); -+ -+#ifdef CONFIG_80211AC_VHT -+ _rtw_memcpy(&psta->vhtpriv, &pmlmepriv->vhtpriv, sizeof(struct vht_priv)); -+#endif /* CONFIG_80211AC_VHT */ -+ -+#endif /* CONFIG_80211N_HT */ -+ -+ psta->state |= WIFI_AP_STATE; /* Aries, add,fix bug of flush_cam_entry at STOP AP mode , 0724 */ -+} -+ -+static void rtw_set_hw_wmm_param(_adapter *padapter) -+{ -+ u8 ACI, ACM, AIFS, ECWMin, ECWMax, aSifsTime; -+ u8 acm_mask; -+ u16 TXOP; -+ u32 acParm, i; -+ u32 edca[4], inx[4]; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ acm_mask = 0; -+ -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || -+ (pmlmeext->cur_wireless_mode & WIRELESS_11_24N)) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ if (pmlmeinfo->WMM_enable == 0) { -+ padapter->mlmepriv.acm_mask = 0; -+ -+ AIFS = aSifsTime + (2 * pmlmeinfo->slotTime); -+ -+ if (pmlmeext->cur_wireless_mode & (WIRELESS_11G | WIRELESS_11A)) { -+ ECWMin = 4; -+ ECWMax = 10; -+ } else if (pmlmeext->cur_wireless_mode & WIRELESS_11B) { -+ ECWMin = 5; -+ ECWMax = 10; -+ } else { -+ ECWMin = 4; -+ ECWMax = 10; -+ } -+ -+ TXOP = 0; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); -+ -+ ECWMin = 2; -+ ECWMax = 3; -+ TXOP = 0x2f; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); -+ -+ } else { -+ edca[0] = edca[1] = edca[2] = edca[3] = 0; -+ -+ /*TODO:*/ -+ acm_mask = 0; -+ padapter->mlmepriv.acm_mask = acm_mask; -+ -+#if 0 -+ /* BK */ -+ /* AIFS = AIFSN * slot time + SIFS - r2t phy delay */ -+#endif -+ AIFS = (7 * pmlmeinfo->slotTime) + aSifsTime; -+ ECWMin = 4; -+ ECWMax = 10; -+ TXOP = 0; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); -+ edca[XMIT_BK_QUEUE] = acParm; -+ RTW_INFO("WMM(BK): %x\n", acParm); -+ -+ /* BE */ -+ AIFS = (3 * pmlmeinfo->slotTime) + aSifsTime; -+ ECWMin = 4; -+ ECWMax = 6; -+ TXOP = 0; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); -+ edca[XMIT_BE_QUEUE] = acParm; -+ RTW_INFO("WMM(BE): %x\n", acParm); -+ -+ /* VI */ -+ AIFS = (1 * pmlmeinfo->slotTime) + aSifsTime; -+ ECWMin = 3; -+ ECWMax = 4; -+ TXOP = 94; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); -+ edca[XMIT_VI_QUEUE] = acParm; -+ RTW_INFO("WMM(VI): %x\n", acParm); -+ -+ /* VO */ -+ AIFS = (1 * pmlmeinfo->slotTime) + aSifsTime; -+ ECWMin = 2; -+ ECWMax = 3; -+ TXOP = 47; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); -+ edca[XMIT_VO_QUEUE] = acParm; -+ RTW_INFO("WMM(VO): %x\n", acParm); -+ -+ -+ if (padapter->registrypriv.acm_method == 1) -+ rtw_hal_set_hwreg(padapter, HW_VAR_ACM_CTRL, (u8 *)(&acm_mask)); -+ else -+ padapter->mlmepriv.acm_mask = acm_mask; -+ -+ inx[0] = 0; -+ inx[1] = 1; -+ inx[2] = 2; -+ inx[3] = 3; -+ -+ if (pregpriv->wifi_spec == 1) { -+ u32 j, tmp, change_inx = _FALSE; -+ -+ /* entry indx: 0->vo, 1->vi, 2->be, 3->bk. */ -+ for (i = 0 ; i < 4 ; i++) { -+ for (j = i + 1 ; j < 4 ; j++) { -+ /* compare CW and AIFS */ -+ if ((edca[j] & 0xFFFF) < (edca[i] & 0xFFFF)) -+ change_inx = _TRUE; -+ else if ((edca[j] & 0xFFFF) == (edca[i] & 0xFFFF)) { -+ /* compare TXOP */ -+ if ((edca[j] >> 16) > (edca[i] >> 16)) -+ change_inx = _TRUE; -+ } -+ -+ if (change_inx) { -+ tmp = edca[i]; -+ edca[i] = edca[j]; -+ edca[j] = tmp; -+ -+ tmp = inx[i]; -+ inx[i] = inx[j]; -+ inx[j] = tmp; -+ -+ change_inx = _FALSE; -+ } -+ } -+ } -+ } -+ -+ for (i = 0 ; i < 4 ; i++) { -+ pxmitpriv->wmm_para_seq[i] = inx[i]; -+ RTW_INFO("wmm_para_seq(%d): %d\n", i, pxmitpriv->wmm_para_seq[i]); -+ } -+ -+ } -+ -+} -+ -+static void update_hw_ht_param(_adapter *padapter) -+{ -+ unsigned char max_AMPDU_len; -+ unsigned char min_MPDU_spacing; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ -+ /* handle A-MPDU parameter field */ -+ /* -+ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k -+ AMPDU_para [4:2]:Min MPDU Start Spacing -+ */ -+ max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; -+ -+ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len)); -+ -+ /* */ -+ /* Config SM Power Save setting */ -+ /* */ -+ pmlmeinfo->SM_PS = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & 0x0C) >> 2; -+ if (pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) { -+#if 0 -+ u8 i; -+ /* update the MCS rates */ -+ for (i = 0; i < 16; i++) -+ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; -+#endif -+ RTW_INFO("%s(): WLAN_HT_CAP_SM_PS_STATIC\n", __FUNCTION__); -+ } -+ -+ /* */ -+ /* Config current HT Protection mode. */ -+ /* */ -+ /* pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; */ -+ -+} -+ -+static void rtw_ap_check_scan(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ u32 delta_time, lifetime; -+ struct wlan_network *pnetwork = NULL; -+ WLAN_BSSID_EX *pbss = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ u8 do_scan = _FALSE; -+ u8 reason = RTW_AUTO_SCAN_REASON_UNSPECIFIED; -+ -+ lifetime = SCANQUEUE_LIFETIME; /* 20 sec */ -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ phead = get_list_head(queue); -+ if (rtw_end_of_queue_search(phead, get_next(phead)) == _TRUE) -+ if (padapter->registrypriv.wifi_spec) { -+ do_scan = _TRUE; -+ reason |= RTW_AUTO_SCAN_REASON_2040_BSS; -+ } -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ if (padapter->registrypriv.acs_auto_scan) { -+ do_scan = _TRUE; -+ reason |= RTW_AUTO_SCAN_REASON_ACS; -+ rtw_acs_start(padapter, _TRUE); -+ } -+#endif -+ -+ if (_TRUE == do_scan) { -+ RTW_INFO("%s : drv scans by itself and wait_completed\n", __func__); -+ rtw_drv_scan_by_self(padapter, reason); -+ rtw_scan_wait_completed(padapter); -+ } -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ if (padapter->registrypriv.acs_auto_scan) -+ rtw_acs_start(padapter, _FALSE); -+#endif -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 -+ && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE -+ && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid))) { -+ delta_time = (u32) rtw_get_passing_time_ms(pnetwork->last_scanned); -+ -+ if (delta_time < lifetime) { -+ -+ uint ie_len = 0; -+ u8 *pbuf = NULL; -+ u8 *ie = NULL; -+ -+ pbss = &pnetwork->network; -+ ie = pbss->IEs; -+ -+ /*check if HT CAP INFO IE exists or not*/ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pbss->IELength - _BEACON_IE_OFFSET_)); -+ if (pbuf == NULL) { -+ /* HT CAP INFO IE don't exist, it is b/g mode bss.*/ -+ -+ if (_FALSE == ATOMIC_READ(&pmlmepriv->olbc)) -+ ATOMIC_SET(&pmlmepriv->olbc, _TRUE); -+ -+ if (_FALSE == ATOMIC_READ(&pmlmepriv->olbc_ht)) -+ ATOMIC_SET(&pmlmepriv->olbc_ht, _TRUE); -+ -+ if (padapter->registrypriv.wifi_spec) -+ RTW_INFO("%s: %s is a/b/g ap\n", __func__, pnetwork->network.Ssid.Ssid); -+ } -+ } -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+#ifdef CONFIG_80211N_HT -+ pmlmepriv->num_sta_no_ht = 0; /* reset to 0 after ap do scanning*/ -+#endif -+ -+} -+ -+void rtw_start_bss_hdl_after_chbw_decided(_adapter *adapter) -+{ -+ WLAN_BSSID_EX *pnetwork = &(adapter->mlmepriv.cur_network.network); -+ struct sta_info *sta = NULL; -+ -+ /* update cur_wireless_mode */ -+ update_wireless_mode(adapter); -+ -+ /* update RRSR and RTS_INIT_RATE register after set channel and bandwidth */ -+ UpdateBrateTbl(adapter, pnetwork->SupportedRates); -+ rtw_hal_set_hwreg(adapter, HW_VAR_BASIC_RATE, pnetwork->SupportedRates); -+ -+ /* update capability after cur_wireless_mode updated */ -+ update_capinfo(adapter, rtw_get_capability(pnetwork)); -+ -+ /* update bc/mc sta_info */ -+ update_bmc_sta(adapter); -+ -+ /* update AP's sta info */ -+ sta = rtw_get_stainfo(&adapter->stapriv, pnetwork->MacAddress); -+ if (!sta) { -+ RTW_INFO(FUNC_ADPT_FMT" !sta for macaddr="MAC_FMT"\n", FUNC_ADPT_ARG(adapter), MAC_ARG(pnetwork->MacAddress)); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ update_ap_info(adapter, sta); -+} -+ -+void start_bss_network(_adapter *padapter, struct createbss_parm *parm) -+{ -+#define DUMP_ADAPTERS_STATUS 0 -+ -+ u8 val8; -+ u16 bcn_interval; -+ u32 acparm; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; /* used as input */ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network); -+ struct dvobj_priv *pdvobj = padapter->dvobj; -+ s16 req_ch = -1, req_bw = -1, req_offset = -1; -+ bool ch_setting_changed = _FALSE; -+ u8 ch_to_set = 0, bw_to_set, offset_to_set; -+ u8 doiqk = _FALSE; -+ /* use for check ch bw offset can be allowed or not */ -+ u8 chbw_allow = _TRUE; -+ -+ if (parm->req_ch != 0) { -+ /* bypass other setting, go checking ch, bw, offset */ -+ req_ch = parm->req_ch; -+ req_bw = parm->req_bw; -+ req_offset = parm->req_offset; -+ goto chbw_decision; -+ } -+ -+ bcn_interval = (u16)pnetwork->Configuration.BeaconPeriod; -+ -+ /* check if there is wps ie, */ -+ /* if there is wpsie in beacon, the hostapd will update beacon twice when stating hostapd, */ -+ /* and at first time the security ie ( RSN/WPA IE) will not include in beacon. */ -+ if (NULL == rtw_get_wps_ie(pnetwork->IEs + _FIXED_IE_LENGTH_, pnetwork->IELength - _FIXED_IE_LENGTH_, NULL, NULL)) -+ pmlmeext->bstart_bss = _TRUE; -+ -+ /* todo: update wmm, ht cap */ -+ /* pmlmeinfo->WMM_enable; */ -+ /* pmlmeinfo->HT_enable; */ -+ if (pmlmepriv->qospriv.qos_option) -+ pmlmeinfo->WMM_enable = _TRUE; -+#ifdef CONFIG_80211N_HT -+ if (pmlmepriv->htpriv.ht_option) { -+ pmlmeinfo->WMM_enable = _TRUE; -+ pmlmeinfo->HT_enable = _TRUE; -+ /* pmlmeinfo->HT_info_enable = _TRUE; */ -+ /* pmlmeinfo->HT_caps_enable = _TRUE; */ -+ -+ update_hw_ht_param(padapter); -+ } -+#endif /* #CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_80211AC_VHT -+ if (pmlmepriv->vhtpriv.vht_option) { -+ pmlmeinfo->VHT_enable = _TRUE; -+ update_hw_vht_param(padapter); -+ } -+#endif /* CONFIG_80211AC_VHT */ -+ -+ if (pmlmepriv->cur_network.join_res != _TRUE) { /* setting only at first time */ -+ /* WEP Key will be set before this function, do not clear CAM. */ -+ if ((psecuritypriv->dot11PrivacyAlgrthm != _WEP40_) && (psecuritypriv->dot11PrivacyAlgrthm != _WEP104_)) -+ flush_all_cam_entry(padapter); /* clear CAM */ -+ } -+ -+ /* set MSR to AP_Mode */ -+ Set_MSR(padapter, _HW_STATE_AP_); -+ -+ /* Set BSSID REG */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pnetwork->MacAddress); -+ -+ /* Set EDCA param reg */ -+#ifdef CONFIG_CONCURRENT_MODE -+ acparm = 0x005ea42b; -+#else -+ acparm = 0x002F3217; /* VO */ -+#endif -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); -+ acparm = 0x005E4317; /* VI */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); -+ /* acparm = 0x00105320; */ /* BE */ -+ acparm = 0x005ea42b; -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); -+ acparm = 0x0000A444; /* BK */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); -+ -+ /* Set Security */ -+ val8 = (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) ? 0xcc : 0xcf; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+ /* Beacon Control related register */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&bcn_interval)); -+ -+chbw_decision: -+ ch_setting_changed = rtw_ap_chbw_decision(padapter, req_ch, req_bw, req_offset -+ , &ch_to_set, &bw_to_set, &offset_to_set, &chbw_allow); -+ -+ /* let pnetwork_mlmeext == pnetwork_mlme. */ -+ _rtw_memcpy(pnetwork_mlmeext, pnetwork, pnetwork->Length); -+ -+ rtw_start_bss_hdl_after_chbw_decided(padapter); -+ -+#if defined(CONFIG_DFS_MASTER) -+ rtw_dfs_master_status_apply(padapter, MLME_AP_STARTED); -+#endif -+ -+#ifdef CONFIG_MCC_MODE -+ /* issue null data to AP for all interface connecting to AP before switch channel setting for softap */ -+ rtw_hal_mcc_issue_null_data(padapter, chbw_allow, 1); -+#endif /* CONFIG_MCC_MODE */ -+ -+ doiqk = _TRUE; -+ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); -+ -+ if (ch_to_set != 0) { -+ set_channel_bwmode(padapter, ch_to_set, offset_to_set, bw_to_set); -+ rtw_mi_update_union_chan_inf(padapter, ch_to_set, offset_to_set, bw_to_set); -+ } -+ -+ doiqk = _FALSE; -+ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); -+ -+#ifdef CONFIG_MCC_MODE -+ /* after set_channel_bwmode for backup IQK */ -+ rtw_hal_set_mcc_setting_start_bss_network(padapter, chbw_allow); -+#endif -+ -+ if (DUMP_ADAPTERS_STATUS) { -+ RTW_INFO(FUNC_ADPT_FMT" done\n", FUNC_ADPT_ARG(padapter)); -+ dump_adapters_status(RTW_DBGDUMP , adapter_to_dvobj(padapter)); -+ } -+ -+ /* update beacon content only if bstart_bss is _TRUE */ -+ if (_TRUE == pmlmeext->bstart_bss) { -+ -+ _irqL irqL; -+ -+#ifdef CONFIG_80211N_HT -+ if ((ATOMIC_READ(&pmlmepriv->olbc) == _TRUE) || -+ (ATOMIC_READ(&pmlmepriv->olbc_ht) == _TRUE)) { -+ /* AP is not starting a 40 MHz BSS in presence of an 802.11g BSS. */ -+ -+ pmlmepriv->ht_op_mode &= (~HT_INFO_OPERATION_MODE_OP_MODE_MASK); -+ pmlmepriv->ht_op_mode |= OP_MODE_MAY_BE_LEGACY_STAS; -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _FALSE); -+ } -+#endif /* CONFIG_80211N_HT */ -+ -+ update_beacon(padapter, _TIM_IE_, NULL, _FALSE); -+ -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+ _enter_critical_bh(&pdvobj->ap_if_q.lock, &irqL); -+ if (rtw_is_list_empty(&padapter->list)) { -+ rtw_list_insert_tail(&padapter->list, get_list_head(&pdvobj->ap_if_q)); -+ pdvobj->nr_ap_if++; -+ pdvobj->inter_bcn_space = DEFAULT_BCN_INTERVAL / pdvobj->nr_ap_if; -+ } -+ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&pdvobj->inter_bcn_space)); -+ -+#endif /*CONFIG_SWTIMER_BASED_TXBCN*/ -+ -+ } -+ -+ rtw_scan_wait_completed(padapter); -+ -+ /* send beacon */ -+ if ((0 == rtw_mi_check_fwstate(padapter, _FW_UNDER_SURVEY)) -+ && (0 == rtw_mi_check_fwstate(padapter, WIFI_OP_CH_SWITCHING)) -+ ) { -+ -+ /*update_beacon(padapter, _TIM_IE_, NULL, _TRUE);*/ -+ -+#if !defined(CONFIG_INTERRUPT_BASED_TXBCN) -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+ if (pdvobj->nr_ap_if == 1) { -+ RTW_INFO("start SW BCN TIMER!\n"); -+ _set_timer(&pdvobj->txbcn_timer, bcn_interval); -+ } -+#else -+ /* other case will tx beacon when bcn interrupt coming in. */ -+ if (send_beacon(padapter) == _FAIL) -+ RTW_INFO("issue_beacon, fail!\n"); -+#endif -+#endif -+#endif /* !defined(CONFIG_INTERRUPT_BASED_TXBCN) */ -+ } -+ -+ /*Set EDCA param reg after update cur_wireless_mode & update_capinfo*/ -+ if (pregpriv->wifi_spec == 1) -+ rtw_set_hw_wmm_param(padapter); -+ -+ /*pmlmeext->bstart_bss = _TRUE;*/ -+} -+ -+int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) -+{ -+ int ret = _SUCCESS; -+ u8 *p; -+ u8 *pHT_caps_ie = NULL; -+ u8 *pHT_info_ie = NULL; -+ u16 cap, ht_cap = _FALSE; -+ uint ie_len = 0; -+ int group_cipher, pairwise_cipher; -+ u8 channel, network_type, supportRate[NDIS_802_11_LENGTH_RATES_EX]; -+ int supportRateNum = 0; -+ u8 OUI1[] = {0x00, 0x50, 0xf2, 0x01}; -+ u8 wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; -+ u8 WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pbss_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ie = pbss_network->IEs; -+ u8 vht_cap = _FALSE; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 rf_num = 0; -+ -+ /* SSID */ -+ /* Supported rates */ -+ /* DS Params */ -+ /* WLAN_EID_COUNTRY */ -+ /* ERP Information element */ -+ /* Extended supported rates */ -+ /* WPA/WPA2 */ -+ /* Wi-Fi Wireless Multimedia Extensions */ -+ /* ht_capab, ht_oper */ -+ /* WPS IE */ -+ -+ RTW_INFO("%s, len=%d\n", __FUNCTION__, len); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return _FAIL; -+ -+ -+ if (len > MAX_IE_SZ) -+ return _FAIL; -+ -+ pbss_network->IELength = len; -+ -+ _rtw_memset(ie, 0, MAX_IE_SZ); -+ -+ _rtw_memcpy(ie, pbuf, pbss_network->IELength); -+ -+ -+ if (pbss_network->InfrastructureMode != Ndis802_11APMode) -+ return _FAIL; -+ -+ -+ rtw_ap_check_scan(padapter); -+ -+ -+ pbss_network->Rssi = 0; -+ -+ _rtw_memcpy(pbss_network->MacAddress, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ /* beacon interval */ -+ p = rtw_get_beacon_interval_from_ie(ie);/* ie + 8; */ /* 8: TimeStamp, 2: Beacon Interval 2:Capability */ -+ /* pbss_network->Configuration.BeaconPeriod = le16_to_cpu(*(unsigned short*)p); */ -+ pbss_network->Configuration.BeaconPeriod = RTW_GET_LE16(p); -+ -+ /* capability */ -+ /* cap = *(unsigned short *)rtw_get_capability_from_ie(ie); */ -+ /* cap = le16_to_cpu(cap); */ -+ cap = RTW_GET_LE16(ie); -+ -+ /* SSID */ -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SSID_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (p && ie_len > 0) { -+ _rtw_memset(&pbss_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(pbss_network->Ssid.Ssid, (p + 2), ie_len); -+ pbss_network->Ssid.SsidLength = ie_len; -+#ifdef CONFIG_P2P -+ _rtw_memcpy(padapter->wdinfo.p2p_group_ssid, pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength); -+ padapter->wdinfo.p2p_group_ssid_len = pbss_network->Ssid.SsidLength; -+#endif -+ } -+ -+ /* chnnel */ -+ channel = 0; -+ pbss_network->Configuration.Length = 0; -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _DSSET_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (p && ie_len > 0) -+ channel = *(p + 2); -+ -+ pbss_network->Configuration.DSConfig = channel; -+ -+ -+ _rtw_memset(supportRate, 0, NDIS_802_11_LENGTH_RATES_EX); -+ /* get supported rates */ -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (p != NULL) { -+ _rtw_memcpy(supportRate, p + 2, ie_len); -+ supportRateNum = ie_len; -+ } -+ -+ /* get ext_supported rates */ -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ie_len, pbss_network->IELength - _BEACON_IE_OFFSET_); -+ if (p != NULL) { -+ _rtw_memcpy(supportRate + supportRateNum, p + 2, ie_len); -+ supportRateNum += ie_len; -+ -+ } -+ -+ network_type = rtw_check_network_type(supportRate, supportRateNum, channel); -+ -+ rtw_set_supported_rate(pbss_network->SupportedRates, network_type); -+ -+ -+ /* parsing ERP_IE */ -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (p && ie_len > 0) -+ ERP_IE_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)p); -+ -+ /* update privacy/security */ -+ if (cap & BIT(4)) -+ pbss_network->Privacy = 1; -+ else -+ pbss_network->Privacy = 0; -+ -+ psecuritypriv->wpa_psk = 0; -+ -+ /* wpa2 */ -+ group_cipher = 0; -+ pairwise_cipher = 0; -+ psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; -+ psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (p && ie_len > 0) { -+ if (rtw_parse_wpa2_ie(p, ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ -+ psecuritypriv->dot8021xalg = 1;/* psk, todo:802.1x */ -+ psecuritypriv->wpa_psk |= BIT(1); -+ -+ psecuritypriv->wpa2_group_cipher = group_cipher; -+ psecuritypriv->wpa2_pairwise_cipher = pairwise_cipher; -+#if 0 -+ switch (group_cipher) { -+ case WPA_CIPHER_NONE: -+ psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; -+ break; -+ case WPA_CIPHER_WEP40: -+ psecuritypriv->wpa2_group_cipher = _WEP40_; -+ break; -+ case WPA_CIPHER_TKIP: -+ psecuritypriv->wpa2_group_cipher = _TKIP_; -+ break; -+ case WPA_CIPHER_CCMP: -+ psecuritypriv->wpa2_group_cipher = _AES_; -+ break; -+ case WPA_CIPHER_WEP104: -+ psecuritypriv->wpa2_group_cipher = _WEP104_; -+ break; -+ } -+ -+ switch (pairwise_cipher) { -+ case WPA_CIPHER_NONE: -+ psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; -+ break; -+ case WPA_CIPHER_WEP40: -+ psecuritypriv->wpa2_pairwise_cipher = _WEP40_; -+ break; -+ case WPA_CIPHER_TKIP: -+ psecuritypriv->wpa2_pairwise_cipher = _TKIP_; -+ break; -+ case WPA_CIPHER_CCMP: -+ psecuritypriv->wpa2_pairwise_cipher = _AES_; -+ break; -+ case WPA_CIPHER_WEP104: -+ psecuritypriv->wpa2_pairwise_cipher = _WEP104_; -+ break; -+ } -+#endif -+ } -+ -+ } -+ -+ /* wpa */ -+ ie_len = 0; -+ group_cipher = 0; -+ pairwise_cipher = 0; -+ psecuritypriv->wpa_group_cipher = _NO_PRIVACY_; -+ psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_; -+ for (p = ie + _BEACON_IE_OFFSET_; ; p += (ie_len + 2)) { -+ p = rtw_get_ie(p, _SSN_IE_1_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); -+ if ((p) && (_rtw_memcmp(p + 2, OUI1, 4))) { -+ if (rtw_parse_wpa_ie(p, ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ -+ psecuritypriv->dot8021xalg = 1;/* psk, todo:802.1x */ -+ -+ psecuritypriv->wpa_psk |= BIT(0); -+ -+ psecuritypriv->wpa_group_cipher = group_cipher; -+ psecuritypriv->wpa_pairwise_cipher = pairwise_cipher; -+ -+#if 0 -+ switch (group_cipher) { -+ case WPA_CIPHER_NONE: -+ psecuritypriv->wpa_group_cipher = _NO_PRIVACY_; -+ break; -+ case WPA_CIPHER_WEP40: -+ psecuritypriv->wpa_group_cipher = _WEP40_; -+ break; -+ case WPA_CIPHER_TKIP: -+ psecuritypriv->wpa_group_cipher = _TKIP_; -+ break; -+ case WPA_CIPHER_CCMP: -+ psecuritypriv->wpa_group_cipher = _AES_; -+ break; -+ case WPA_CIPHER_WEP104: -+ psecuritypriv->wpa_group_cipher = _WEP104_; -+ break; -+ } -+ -+ switch (pairwise_cipher) { -+ case WPA_CIPHER_NONE: -+ psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_; -+ break; -+ case WPA_CIPHER_WEP40: -+ psecuritypriv->wpa_pairwise_cipher = _WEP40_; -+ break; -+ case WPA_CIPHER_TKIP: -+ psecuritypriv->wpa_pairwise_cipher = _TKIP_; -+ break; -+ case WPA_CIPHER_CCMP: -+ psecuritypriv->wpa_pairwise_cipher = _AES_; -+ break; -+ case WPA_CIPHER_WEP104: -+ psecuritypriv->wpa_pairwise_cipher = _WEP104_; -+ break; -+ } -+#endif -+ } -+ -+ break; -+ -+ } -+ -+ if ((p == NULL) || (ie_len == 0)) -+ break; -+ -+ } -+ -+ /* wmm */ -+ ie_len = 0; -+ pmlmepriv->qospriv.qos_option = 0; -+ if (pregistrypriv->wmm_enable) { -+ for (p = ie + _BEACON_IE_OFFSET_; ; p += (ie_len + 2)) { -+ p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); -+ if ((p) && _rtw_memcmp(p + 2, WMM_PARA_IE, 6)) { -+ pmlmepriv->qospriv.qos_option = 1; -+ -+ *(p + 8) |= BIT(7); /* QoS Info, support U-APSD */ -+ -+ /* disable all ACM bits since the WMM admission control is not supported */ -+ *(p + 10) &= ~BIT(4); /* BE */ -+ *(p + 14) &= ~BIT(4); /* BK */ -+ *(p + 18) &= ~BIT(4); /* VI */ -+ *(p + 22) &= ~BIT(4); /* VO */ -+ -+ break; -+ } -+ -+ if ((p == NULL) || (ie_len == 0)) -+ break; -+ } -+ } -+#ifdef CONFIG_80211N_HT -+ /* parsing HT_CAP_IE */ -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (p && ie_len > 0) { -+ u8 rf_type = 0; -+ HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor = MAX_AMPDU_FACTOR_64K; -+ struct rtw_ieee80211_ht_cap *pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); -+ -+ if (0) { -+ RTW_INFO(FUNC_ADPT_FMT" HT_CAP_IE from upper layer:\n", FUNC_ADPT_ARG(padapter)); -+ dump_ht_cap_ie_content(RTW_DBGDUMP, p + 2, ie_len); -+ } -+ -+ pHT_caps_ie = p; -+ -+ ht_cap = _TRUE; -+ network_type |= WIRELESS_11_24N; -+ -+ rtw_ht_use_default_setting(padapter); -+ -+ /* Update HT Capabilities Info field */ -+ if (pmlmepriv->htpriv.sgi_20m == _FALSE) -+ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_SGI_20); -+ -+ if (pmlmepriv->htpriv.sgi_40m == _FALSE) -+ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_SGI_40); -+ -+ if (!TEST_FLAG(pmlmepriv->htpriv.ldpc_cap, LDPC_HT_ENABLE_RX)) -+ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_LDPC_CODING); -+ -+ if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_TX)) -+ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_TX_STBC); -+ -+ if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_RX)) -+ pht_cap->cap_info &= ~(IEEE80211_HT_CAP_RX_STBC_3R); -+ -+ /* Update A-MPDU Parameters field */ -+ pht_cap->ampdu_params_info &= ~(IEEE80211_HT_CAP_AMPDU_FACTOR | IEEE80211_HT_CAP_AMPDU_DENSITY); -+ -+ if ((psecuritypriv->wpa_pairwise_cipher & WPA_CIPHER_CCMP) || -+ (psecuritypriv->wpa2_pairwise_cipher & WPA_CIPHER_CCMP)) -+ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & (0x07 << 2)); -+ else -+ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & 0x00); -+ -+ rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); -+ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_FACTOR & max_rx_ampdu_factor); /* set Max Rx AMPDU size to 64K */ -+ -+ _rtw_memcpy(&(pmlmeinfo->HT_caps), pht_cap, sizeof(struct HT_caps_element)); -+ -+ /* Update Supported MCS Set field */ -+ { -+ int i; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ /* RX MCS Bitmask */ -+ switch (rf_type) { -+ case RF_1T1R: -+ case RF_1T2R: /* ? */ -+ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_1R); -+ break; -+ case RF_2T2R: -+ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_2R); -+ break; -+ case RF_3T3R: -+ set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_3R); -+ break; -+ default: -+ RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); -+ } -+ for (i = 0; i < 10; i++) -+ *(HT_CAP_ELE_RX_MCS_MAP(pht_cap) + i) &= padapter->mlmeextpriv.default_supported_mcs_set[i]; -+ } -+ -+#ifdef CONFIG_BEAMFORMING -+ /* Use registry value to enable HT Beamforming. */ -+ /* ToDo: use configure file to set these capability. */ -+ pht_cap->tx_BF_cap_info = 0; -+ -+ /* HT Beamformer */ -+ if (TEST_FLAG(pmlmepriv->htpriv.beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { -+ /* Transmit NDP Capable */ -+ SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(pht_cap, 1); -+ /* Explicit Compressed Steering Capable */ -+ SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pht_cap, 1); -+ /* Compressed Steering Number Antennas */ -+ SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pht_cap, 1); -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMER_CAP, (u8 *)&rf_num); -+ SET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(pht_cap, rf_num); -+ } -+ -+ /* HT Beamformee */ -+ if (TEST_FLAG(pmlmepriv->htpriv.beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) { -+ /* Receive NDP Capable */ -+ SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(pht_cap, 1); -+ /* Explicit Compressed Beamforming Feedback Capable */ -+ SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pht_cap, 2); -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); -+ SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pht_cap, rf_num); -+ } -+#endif /* CONFIG_BEAMFORMING */ -+ -+ _rtw_memcpy(&pmlmepriv->htpriv.ht_cap, p + 2, ie_len); -+ -+ if (0) { -+ RTW_INFO(FUNC_ADPT_FMT" HT_CAP_IE driver masked:\n", FUNC_ADPT_ARG(padapter)); -+ dump_ht_cap_ie_content(RTW_DBGDUMP, p + 2, ie_len); -+ } -+ } -+ -+ /* parsing HT_INFO_IE */ -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (p && ie_len > 0) -+ pHT_info_ie = p; -+#endif /* CONFIG_80211N_HT */ -+ switch (network_type) { -+ case WIRELESS_11B: -+ pbss_network->NetworkTypeInUse = Ndis802_11DS; -+ break; -+ case WIRELESS_11G: -+ case WIRELESS_11BG: -+ case WIRELESS_11G_24N: -+ case WIRELESS_11BG_24N: -+ pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; -+ break; -+ case WIRELESS_11A: -+ pbss_network->NetworkTypeInUse = Ndis802_11OFDM5; -+ break; -+ default: -+ pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; -+ break; -+ } -+ -+ pmlmepriv->cur_network.network_type = network_type; -+ -+#ifdef CONFIG_80211N_HT -+ pmlmepriv->htpriv.ht_option = _FALSE; -+ -+ if ((psecuritypriv->wpa2_pairwise_cipher & WPA_CIPHER_TKIP) || -+ (psecuritypriv->wpa_pairwise_cipher & WPA_CIPHER_TKIP)) { -+ /* todo: */ -+ /* ht_cap = _FALSE; */ -+ } -+ -+ /* ht_cap */ -+ if (pregistrypriv->ht_enable && ht_cap == _TRUE) { -+ pmlmepriv->htpriv.ht_option = _TRUE; -+ pmlmepriv->qospriv.qos_option = 1; -+ -+ pmlmepriv->htpriv.ampdu_enable = pregistrypriv->ampdu_enable ? _TRUE : _FALSE; -+ -+ HT_caps_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)pHT_caps_ie); -+ -+ HT_info_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)pHT_info_ie); -+ } -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ -+ /* Parsing VHT CAP IE */ -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, EID_VHTCapability, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (p && ie_len > 0) -+ vht_cap = _TRUE; -+ /* Parsing VHT OPERATION IE */ -+ -+ -+ pmlmepriv->vhtpriv.vht_option = _FALSE; -+ /* if channel in 5G band, then add vht ie . */ -+ if ((pbss_network->Configuration.DSConfig > 14) -+ && (pmlmepriv->htpriv.ht_option == _TRUE) -+ && REGSTY_IS_11AC_ENABLE(pregistrypriv) -+ && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) -+ && (!pmlmepriv->country_ent || COUNTRY_CHPLAN_EN_11AC(pmlmepriv->country_ent)) -+ ) { -+ if (vht_cap == _TRUE) -+ pmlmepriv->vhtpriv.vht_option = _TRUE; -+ else if (REGSTY_IS_11AC_AUTO(pregistrypriv)) { -+ u8 cap_len, operation_len; -+ -+ rtw_vht_use_default_setting(padapter); -+ -+ { -+ /* VHT Operation mode notifiy bit in Extended IE (127) */ -+ uint len = 0; -+ -+ SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(pmlmepriv->ext_capab_ie_data, 1); -+ pmlmepriv->ext_capab_ie_len = 10; -+ rtw_set_ie(pbss_network->IEs + pbss_network->IELength, EID_EXTCapability, 8, pmlmepriv->ext_capab_ie_data, &len); -+ pbss_network->IELength += pmlmepriv->ext_capab_ie_len; -+ } -+ -+ /* VHT Capabilities element */ -+ cap_len = rtw_build_vht_cap_ie(padapter, pbss_network->IEs + pbss_network->IELength); -+ pbss_network->IELength += cap_len; -+ -+ /* VHT Operation element */ -+ operation_len = rtw_build_vht_operation_ie(padapter, pbss_network->IEs + pbss_network->IELength, pbss_network->Configuration.DSConfig); -+ pbss_network->IELength += operation_len; -+ -+ pmlmepriv->vhtpriv.vht_option = _TRUE; -+ } -+ } -+#endif /* CONFIG_80211AC_VHT */ -+ -+ if(pbss_network->Configuration.DSConfig <= 14 && padapter->registrypriv.wifi_spec == 1) { -+ uint len = 0; -+#ifdef CONFIG_80211N_HT -+ SET_EXT_CAPABILITY_ELE_BSS_COEXIST(pmlmepriv->ext_capab_ie_data, 1); -+#endif /* CONFIG_80211N_HT */ -+ pmlmepriv->ext_capab_ie_len = 10; -+ rtw_set_ie(pbss_network->IEs + pbss_network->IELength, EID_EXTCapability, 8, pmlmepriv->ext_capab_ie_data, &len); -+ pbss_network->IELength += pmlmepriv->ext_capab_ie_len; -+ } -+ -+ pbss_network->Length = get_WLAN_BSSID_EX_sz((WLAN_BSSID_EX *)pbss_network); -+ -+ rtw_ies_get_chbw(pbss_network->IEs + _BEACON_IE_OFFSET_, pbss_network->IELength - _BEACON_IE_OFFSET_ -+ , &pmlmepriv->ori_ch, &pmlmepriv->ori_bw, &pmlmepriv->ori_offset); -+ rtw_warn_on(pmlmepriv->ori_ch == 0); -+ -+ { -+ /* alloc sta_info for ap itself */ -+ -+ struct sta_info *sta; -+ -+ sta = rtw_get_stainfo(&padapter->stapriv, pbss_network->MacAddress); -+ if (!sta) { -+ sta = rtw_alloc_stainfo(&padapter->stapriv, pbss_network->MacAddress); -+ if (sta == NULL) -+ return _FAIL; -+ } -+ } -+ -+ rtw_startbss_cmd(padapter, RTW_CMDF_WAIT_ACK); -+ { -+ int sk_band = RTW_GET_SCAN_BAND_SKIP(padapter); -+ -+ if (sk_band) -+ RTW_CLR_SCAN_BAND_SKIP(padapter, sk_band); -+ } -+ -+ rtw_indicate_connect(padapter); -+ -+ pmlmepriv->cur_network.join_res = _TRUE;/* for check if already set beacon */ -+ -+ /* update bc/mc sta_info */ -+ /* update_bmc_sta(padapter); */ -+ -+ return ret; -+ -+} -+ -+#if CONFIG_RTW_MACADDR_ACL -+void rtw_macaddr_acl_init(_adapter *adapter) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct wlan_acl_pool *acl = &stapriv->acl_list; -+ _queue *acl_node_q = &acl->acl_node_q; -+ int i; -+ _irqL irqL; -+ -+ _enter_critical_bh(&(acl_node_q->lock), &irqL); -+ _rtw_init_listhead(&(acl_node_q->queue)); -+ acl->num = 0; -+ acl->mode = RTW_ACL_MODE_DISABLED; -+ for (i = 0; i < NUM_ACL; i++) { -+ _rtw_init_listhead(&acl->aclnode[i].list); -+ acl->aclnode[i].valid = _FALSE; -+ } -+ _exit_critical_bh(&(acl_node_q->lock), &irqL); -+} -+ -+void rtw_macaddr_acl_deinit(_adapter *adapter) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct wlan_acl_pool *acl = &stapriv->acl_list; -+ _queue *acl_node_q = &acl->acl_node_q; -+ _irqL irqL; -+ _list *head, *list; -+ struct rtw_wlan_acl_node *acl_node; -+ -+ _enter_critical_bh(&(acl_node_q->lock), &irqL); -+ head = get_list_head(acl_node_q); -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ acl_node = LIST_CONTAINOR(list, struct rtw_wlan_acl_node, list); -+ list = get_next(list); -+ -+ if (acl_node->valid == _TRUE) { -+ acl_node->valid = _FALSE; -+ rtw_list_delete(&acl_node->list); -+ acl->num--; -+ } -+ } -+ _exit_critical_bh(&(acl_node_q->lock), &irqL); -+ -+ rtw_warn_on(acl->num); -+ acl->mode = RTW_ACL_MODE_DISABLED; -+} -+ -+void rtw_set_macaddr_acl(_adapter *adapter, int mode) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct wlan_acl_pool *acl = &stapriv->acl_list; -+ -+ RTW_INFO(FUNC_ADPT_FMT" mode=%d\n", FUNC_ADPT_ARG(adapter), mode); -+ -+ acl->mode = mode; -+ -+ if (mode == RTW_ACL_MODE_DISABLED) -+ rtw_macaddr_acl_deinit(adapter); -+} -+ -+int rtw_acl_add_sta(_adapter *adapter, const u8 *addr) -+{ -+ _irqL irqL; -+ _list *list, *head; -+ u8 existed = 0; -+ int i = -1, ret = 0; -+ struct rtw_wlan_acl_node *acl_node; -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct wlan_acl_pool *acl = &stapriv->acl_list; -+ _queue *acl_node_q = &acl->acl_node_q; -+ -+ _enter_critical_bh(&(acl_node_q->lock), &irqL); -+ -+ head = get_list_head(acl_node_q); -+ list = get_next(head); -+ -+ /* search for existed entry */ -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ acl_node = LIST_CONTAINOR(list, struct rtw_wlan_acl_node, list); -+ list = get_next(list); -+ -+ if (_rtw_memcmp(acl_node->addr, addr, ETH_ALEN)) { -+ if (acl_node->valid == _TRUE) { -+ existed = 1; -+ break; -+ } -+ } -+ } -+ if (existed) -+ goto release_lock; -+ -+ if (acl->num >= NUM_ACL) -+ goto release_lock; -+ -+ /* find empty one and use */ -+ for (i = 0; i < NUM_ACL; i++) { -+ -+ acl_node = &acl->aclnode[i]; -+ if (acl_node->valid == _FALSE) { -+ -+ _rtw_init_listhead(&acl_node->list); -+ _rtw_memcpy(acl_node->addr, addr, ETH_ALEN); -+ acl_node->valid = _TRUE; -+ -+ rtw_list_insert_tail(&acl_node->list, get_list_head(acl_node_q)); -+ acl->num++; -+ break; -+ } -+ } -+ -+release_lock: -+ _exit_critical_bh(&(acl_node_q->lock), &irqL); -+ -+ if (!existed && (i < 0 || i >= NUM_ACL)) -+ ret = -1; -+ -+ RTW_INFO(FUNC_ADPT_FMT" "MAC_FMT" %s (acl_num=%d)\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr) -+ , (existed ? "existed" : ((i < 0 || i >= NUM_ACL) ? "no room" : "added")) -+ , acl->num); -+ -+ return ret; -+} -+ -+int rtw_acl_remove_sta(_adapter *adapter, const u8 *addr) -+{ -+ _irqL irqL; -+ _list *list, *head; -+ int ret = 0; -+ struct rtw_wlan_acl_node *acl_node; -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct wlan_acl_pool *acl = &stapriv->acl_list; -+ _queue *acl_node_q = &acl->acl_node_q; -+ u8 is_baddr = is_broadcast_mac_addr(addr); -+ u8 match = 0; -+ -+ _enter_critical_bh(&(acl_node_q->lock), &irqL); -+ -+ head = get_list_head(acl_node_q); -+ list = get_next(head); -+ -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ acl_node = LIST_CONTAINOR(list, struct rtw_wlan_acl_node, list); -+ list = get_next(list); -+ -+ if (is_baddr || _rtw_memcmp(acl_node->addr, addr, ETH_ALEN)) { -+ if (acl_node->valid == _TRUE) { -+ acl_node->valid = _FALSE; -+ rtw_list_delete(&acl_node->list); -+ acl->num--; -+ match = 1; -+ } -+ } -+ } -+ -+ _exit_critical_bh(&(acl_node_q->lock), &irqL); -+ -+ RTW_INFO(FUNC_ADPT_FMT" "MAC_FMT" %s (acl_num=%d)\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr) -+ , is_baddr ? "clear all" : (match ? "match" : "no found") -+ , acl->num); -+ -+ return ret; -+} -+#endif /* CONFIG_RTW_MACADDR_ACL */ -+ -+u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta) -+{ -+ struct cmd_obj *ph2c; -+ struct set_stakey_parm *psetstakey_para; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ psetstakey_para = (struct set_stakey_parm *)rtw_zmalloc(sizeof(struct set_stakey_parm)); -+ if (psetstakey_para == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); -+ -+ -+ psetstakey_para->algorithm = (u8)psta->dot118021XPrivacy; -+ -+ _rtw_memcpy(psetstakey_para->addr, psta->hwaddr, ETH_ALEN); -+ -+ _rtw_memcpy(psetstakey_para->key, &psta->dot118021x_UncstKey, 16); -+ -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+static int rtw_ap_set_key(_adapter *padapter, u8 *key, u8 alg, int keyid, u8 set_tx) -+{ -+ u8 keylen; -+ struct cmd_obj *pcmd; -+ struct setkey_parm *psetkeyparm; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ int res = _SUCCESS; -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ psetkeyparm = (struct setkey_parm *)rtw_zmalloc(sizeof(struct setkey_parm)); -+ if (psetkeyparm == NULL) { -+ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memset(psetkeyparm, 0, sizeof(struct setkey_parm)); -+ -+ psetkeyparm->keyid = (u8)keyid; -+ if (is_wep_enc(alg)) -+ padapter->securitypriv.key_mask |= BIT(psetkeyparm->keyid); -+ -+ psetkeyparm->algorithm = alg; -+ -+ psetkeyparm->set_tx = set_tx; -+ -+ switch (alg) { -+ case _WEP40_: -+ keylen = 5; -+ break; -+ case _WEP104_: -+ keylen = 13; -+ break; -+ case _TKIP_: -+ case _TKIP_WTMIC_: -+ case _AES_: -+ default: -+ keylen = 16; -+ } -+ -+ _rtw_memcpy(&(psetkeyparm->key[0]), key, keylen); -+ -+ pcmd->cmdcode = _SetKey_CMD_; -+ pcmd->parmbuf = (u8 *)psetkeyparm; -+ pcmd->cmdsz = (sizeof(struct setkey_parm)); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ -+ _rtw_init_listhead(&pcmd->list); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ -+ return res; -+} -+ -+int rtw_ap_set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ return rtw_ap_set_key(padapter, key, alg, keyid, 1); -+} -+ -+int rtw_ap_set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx) -+{ -+ u8 alg; -+ -+ switch (keylen) { -+ case 5: -+ alg = _WEP40_; -+ break; -+ case 13: -+ alg = _WEP104_; -+ break; -+ default: -+ alg = _NO_PRIVACY_; -+ } -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ return rtw_ap_set_key(padapter, key, alg, keyid, set_tx); -+} -+ -+u8 rtw_ap_bmc_frames_hdl(_adapter *padapter) -+{ -+#define HIQ_XMIT_COUNTS (6) -+ _irqL irqL; -+ struct sta_info *psta_bmc; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ bool update_tim = _FALSE; -+ -+ -+ if (padapter->registrypriv.wifi_spec != 1) -+ return H2C_SUCCESS; -+ -+ -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ if (!psta_bmc) -+ return H2C_SUCCESS; -+ -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ if ((pstapriv->tim_bitmap & BIT(0)) && (psta_bmc->sleepq_len > 0)) { -+ int tx_counts = 0; -+ -+ _update_beacon(padapter, _TIM_IE_, NULL, _FALSE, "update TIM with TIB=1"); -+ -+ RTW_INFO("sleepq_len of bmc_sta = %d\n", psta_bmc->sleepq_len); -+ -+ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ psta_bmc->sleepq_len--; -+ tx_counts++; -+ -+ if (psta_bmc->sleepq_len > 0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ if (tx_counts == HIQ_XMIT_COUNTS) -+ pxmitframe->attrib.mdata = 0; -+ -+ pxmitframe->attrib.triggered = 1; -+ -+ if (xmitframe_hiq_filter(pxmitframe) == _TRUE) -+ pxmitframe->attrib.qsel = QSLT_HIGH;/*HIQ*/ -+ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ if (tx_counts == HIQ_XMIT_COUNTS) -+ break; -+ -+ } -+ -+ } else { -+ if (psta_bmc->sleepq_len == 0) { -+ -+ /*RTW_INFO("sleepq_len of bmc_sta = %d\n", psta_bmc->sleepq_len);*/ -+ -+ if (pstapriv->tim_bitmap & BIT(0)) -+ update_tim = _TRUE; -+ -+ pstapriv->tim_bitmap &= ~BIT(0); -+ pstapriv->sta_dz_bitmap &= ~BIT(0); -+ -+ if (update_tim == _TRUE) { -+ RTW_INFO("clear TIB\n"); -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "bmc sleepq and HIQ empty"); -+ } -+ } -+ } -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+#if 0 -+ /* HIQ Check */ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); -+ -+ while (_FALSE == empty && rtw_get_passing_time_ms(start) < 3000) { -+ rtw_msleep_os(100); -+ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); -+ } -+ -+ -+ printk("check if hiq empty=%d\n", empty); -+#endif -+ -+ return H2C_SUCCESS; -+} -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ -+static void associated_stainfo_update(_adapter *padapter, struct sta_info *psta, u32 sta_info_type) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ RTW_INFO("%s: "MAC_FMT", updated_type=0x%x\n", __func__, MAC_ARG(psta->hwaddr), sta_info_type); -+ -+ if (sta_info_type & STA_INFO_UPDATE_BW) { -+#ifdef CONFIG_80211N_HT -+ if ((psta->flags & WLAN_STA_HT) && !psta->ht_20mhz_set) { -+ if (pmlmepriv->sw_to_20mhz) { -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ /*psta->htpriv.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;*/ -+ psta->htpriv.sgi_40m = _FALSE; -+ } else { -+ /*TODO: Switch back to 40MHZ?80MHZ*/ -+ } -+ } -+#endif /* CONFIG_80211N_HT */ -+ } -+ -+ /* -+ if (sta_info_type & STA_INFO_UPDATE_RATE) { -+ -+ } -+ */ -+ -+ if (sta_info_type & STA_INFO_UPDATE_PROTECTION_MODE) -+ VCS_update(padapter, psta); -+ -+ /* -+ if (sta_info_type & STA_INFO_UPDATE_CAP) { -+ -+ } -+ -+ if (sta_info_type & STA_INFO_UPDATE_HT_CAP) { -+ -+ } -+ -+ if (sta_info_type & STA_INFO_UPDATE_VHT_CAP) { -+ -+ } -+ */ -+ -+} -+ -+static void update_bcn_ext_capab_ie(_adapter *padapter) -+{ -+ sint ie_len = 0; -+ unsigned char *pbuf; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ u8 *ie = pnetwork->IEs; -+ u8 null_extcap_data[8] = {0}; -+ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_CAP_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (pbuf && ie_len > 0) -+ rtw_remove_bcn_ie(padapter, pnetwork, _EXT_CAP_IE_); -+ -+ if ((pmlmepriv->ext_capab_ie_len > 0) && -+ (_rtw_memcmp(pmlmepriv->ext_capab_ie_data, null_extcap_data, sizeof(null_extcap_data)) == _FALSE)) -+ rtw_add_bcn_ie(padapter, pnetwork, _EXT_CAP_IE_, pmlmepriv->ext_capab_ie_data, pmlmepriv->ext_capab_ie_len); -+ -+} -+ -+static void update_bcn_fixed_ie(_adapter *padapter) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_erpinfo_ie(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ unsigned char *p, *ie = pnetwork->IEs; -+ u32 len = 0; -+ -+ RTW_INFO("%s, ERP_enable=%d\n", __FUNCTION__, pmlmeinfo->ERP_enable); -+ -+ if (!pmlmeinfo->ERP_enable) -+ return; -+ -+ /* parsing ERP_IE */ -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (p && len > 0) { -+ PNDIS_802_11_VARIABLE_IEs pIE = (PNDIS_802_11_VARIABLE_IEs)p; -+ -+ if (pmlmepriv->num_sta_non_erp == 1) -+ pIE->data[0] |= RTW_ERP_INFO_NON_ERP_PRESENT | RTW_ERP_INFO_USE_PROTECTION; -+ else -+ pIE->data[0] &= ~(RTW_ERP_INFO_NON_ERP_PRESENT | RTW_ERP_INFO_USE_PROTECTION); -+ -+ if (pmlmepriv->num_sta_no_short_preamble > 0) -+ pIE->data[0] |= RTW_ERP_INFO_BARKER_PREAMBLE_MODE; -+ else -+ pIE->data[0] &= ~(RTW_ERP_INFO_BARKER_PREAMBLE_MODE); -+ -+ ERP_IE_handler(padapter, pIE); -+ } -+ -+} -+ -+#ifdef CONFIG_80211N_HT -+static void update_bcn_htcap_ie(_adapter *padapter) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_htinfo_ie(_adapter *padapter) -+{ -+ /* -+ u8 beacon_updated = _FALSE; -+ u32 sta_info_update_type = STA_INFO_UPDATE_NONE; -+ */ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ unsigned char *p, *ie = pnetwork->IEs; -+ u32 len = 0; -+ -+ if (pmlmepriv->htpriv.ht_option == _FALSE) -+ return; -+ -+ if (pmlmeinfo->HT_info_enable != 1) -+ return; -+ -+ -+ RTW_INFO("%s current operation mode=0x%X\n", -+ __FUNCTION__, pmlmepriv->ht_op_mode); -+ -+ RTW_INFO("num_sta_40mhz_intolerant(%d), 20mhz_width_req(%d), intolerant_ch_rpt(%d), olbc(%d)\n", -+ pmlmepriv->num_sta_40mhz_intolerant, pmlmepriv->ht_20mhz_width_req, pmlmepriv->ht_intolerant_ch_reported, ATOMIC_READ(&pmlmepriv->olbc)); -+ -+ /*parsing HT_INFO_IE, currently only update ht_op_mode - pht_info->infos[1] & pht_info->infos[2] for wifi logo test*/ -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (p && len > 0) { -+ struct HT_info_element *pht_info = NULL; -+ -+ pht_info = (struct HT_info_element *)(p + 2); -+ -+ /* for STA Channel Width/Secondary Channel Offset*/ -+ if ((pmlmepriv->sw_to_20mhz == 0) && (pmlmeext->cur_channel <= 14)) { -+ if ((pmlmepriv->num_sta_40mhz_intolerant > 0) || (pmlmepriv->ht_20mhz_width_req == _TRUE) -+ || (pmlmepriv->ht_intolerant_ch_reported == _TRUE) || (ATOMIC_READ(&pmlmepriv->olbc) == _TRUE)) { -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(pht_info, 0); -+ SET_HT_OP_ELE_STA_CHL_WIDTH(pht_info, 0); -+ -+ pmlmepriv->sw_to_20mhz = 1; -+ /* -+ sta_info_update_type |= STA_INFO_UPDATE_BW; -+ beacon_updated = _TRUE; -+ */ -+ -+ RTW_INFO("%s:switching to 20Mhz\n", __FUNCTION__); -+ -+ /*TODO : cur_bwmode/cur_ch_offset switches to 20Mhz*/ -+ } -+ } else { -+ -+ if ((pmlmepriv->num_sta_40mhz_intolerant == 0) && (pmlmepriv->ht_20mhz_width_req == _FALSE) -+ && (pmlmepriv->ht_intolerant_ch_reported == _FALSE) && (ATOMIC_READ(&pmlmepriv->olbc) == _FALSE)) { -+ -+ if (pmlmeext->cur_bwmode >= CHANNEL_WIDTH_40) { -+ -+ SET_HT_OP_ELE_STA_CHL_WIDTH(pht_info, 1); -+ -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(pht_info, -+ (pmlmeext->cur_ch_offset == HAL_PRIME_CHNL_OFFSET_LOWER) ? -+ HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE : HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW); -+ -+ pmlmepriv->sw_to_20mhz = 0; -+ /* -+ sta_info_update_type |= STA_INFO_UPDATE_BW; -+ beacon_updated = _TRUE; -+ */ -+ -+ RTW_INFO("%s:switching back to 40Mhz\n", __FUNCTION__); -+ } -+ } -+ } -+ -+ /* to update ht_op_mode*/ -+ *(u16 *)(pht_info->infos + 1) = cpu_to_le16(pmlmepriv->ht_op_mode); -+ -+ } -+ -+ /*associated_clients_update(padapter, beacon_updated, sta_info_update_type);*/ -+ -+} -+#endif /* CONFIG_80211N_HT */ -+ -+static void update_bcn_rsn_ie(_adapter *padapter) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_wpa_ie(_adapter *padapter) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_wmm_ie(_adapter *padapter) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_wps_ie(_adapter *padapter) -+{ -+ u8 *pwps_ie = NULL, *pwps_ie_src, *premainder_ie, *pbackup_remainder_ie = NULL; -+ uint wps_ielen = 0, wps_offset, remainder_ielen; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ unsigned char *ie = pnetwork->IEs; -+ u32 ielen = pnetwork->IELength; -+ -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ pwps_ie = rtw_get_wps_ie(ie + _FIXED_IE_LENGTH_, ielen - _FIXED_IE_LENGTH_, NULL, &wps_ielen); -+ -+ if (pwps_ie == NULL || wps_ielen == 0) -+ return; -+ -+ pwps_ie_src = pmlmepriv->wps_beacon_ie; -+ if (pwps_ie_src == NULL) -+ return; -+ -+ wps_offset = (uint)(pwps_ie - ie); -+ -+ premainder_ie = pwps_ie + wps_ielen; -+ -+ remainder_ielen = ielen - wps_offset - wps_ielen; -+ -+ if (remainder_ielen > 0) { -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if (pbackup_remainder_ie) -+ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ wps_ielen = (uint)pwps_ie_src[1];/* to get ie data len */ -+ if ((wps_offset + wps_ielen + 2 + remainder_ielen) <= MAX_IE_SZ) { -+ _rtw_memcpy(pwps_ie, pwps_ie_src, wps_ielen + 2); -+ pwps_ie += (wps_ielen + 2); -+ -+ if (pbackup_remainder_ie) -+ _rtw_memcpy(pwps_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ /* update IELength */ -+ pnetwork->IELength = wps_offset + (wps_ielen + 2) + remainder_ielen; -+ } -+ -+ if (pbackup_remainder_ie) -+ rtw_mfree(pbackup_remainder_ie, remainder_ielen); -+ -+ /* deal with the case without set_tx_beacon_cmd() in update_beacon() */ -+#if defined(CONFIG_INTERRUPT_BASED_TXBCN) || defined(CONFIG_PCI_HCI) -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { -+ u8 sr = 0; -+ rtw_get_wps_attr_content(pwps_ie_src, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8 *)(&sr), NULL); -+ -+ if (sr) { -+ set_fwstate(pmlmepriv, WIFI_UNDER_WPS); -+ RTW_INFO("%s, set WIFI_UNDER_WPS\n", __func__); -+ } -+ } -+#endif -+} -+ -+static void update_bcn_p2p_ie(_adapter *padapter) -+{ -+ -+} -+ -+static void update_bcn_vendor_spec_ie(_adapter *padapter, u8 *oui) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ if (_rtw_memcmp(RTW_WPA_OUI, oui, 4)) -+ update_bcn_wpa_ie(padapter); -+ else if (_rtw_memcmp(WMM_OUI, oui, 4)) -+ update_bcn_wmm_ie(padapter); -+ else if (_rtw_memcmp(WPS_OUI, oui, 4)) -+ update_bcn_wps_ie(padapter); -+ else if (_rtw_memcmp(P2P_OUI, oui, 4)) -+ update_bcn_p2p_ie(padapter); -+ else -+ RTW_INFO("unknown OUI type!\n"); -+ -+ -+} -+ -+void _update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx, const char *tag) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv; -+ struct mlme_ext_priv *pmlmeext; -+ /* struct mlme_ext_info *pmlmeinfo; */ -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ if (!padapter) -+ return; -+ -+ pmlmepriv = &(padapter->mlmepriv); -+ pmlmeext = &(padapter->mlmeextpriv); -+ /* pmlmeinfo = &(pmlmeext->mlmext_info); */ -+ -+ if (_FALSE == pmlmeext->bstart_bss) -+ return; -+ -+ _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+ -+ switch (ie_id) { -+ case 0xFF: -+ -+ update_bcn_fixed_ie(padapter);/* 8: TimeStamp, 2: Beacon Interval 2:Capability */ -+ -+ break; -+ -+ case _TIM_IE_: -+ -+ update_BCNTIM(padapter); -+ -+ break; -+ -+ case _ERPINFO_IE_: -+ -+ update_bcn_erpinfo_ie(padapter); -+ -+ break; -+ -+ case _HT_CAPABILITY_IE_: -+#ifdef CONFIG_80211N_HT -+ update_bcn_htcap_ie(padapter); -+#endif /*CONFIG_80211N_HT */ -+ break; -+ case _RSN_IE_2_: -+ -+ update_bcn_rsn_ie(padapter); -+ -+ break; -+ -+ case _HT_ADD_INFO_IE_: -+#ifdef CONFIG_80211N_HT -+ update_bcn_htinfo_ie(padapter); -+#endif /*CONFIG_80211N_HT */ -+ break; -+ -+ case _EXT_CAP_IE_: -+ -+ update_bcn_ext_capab_ie(padapter); -+ -+ break; -+ -+ case _VENDOR_SPECIFIC_IE_: -+ -+ update_bcn_vendor_spec_ie(padapter, oui); -+ -+ break; -+ -+ default: -+ break; -+ } -+ -+ pmlmepriv->update_bcn = _TRUE; -+ -+ _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+ -+#ifndef CONFIG_INTERRUPT_BASED_TXBCN -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ if (tx) { -+ /* send_beacon(padapter); */ /* send_beacon must execute on TSR level */ -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" ie_id:%u - %s\n", FUNC_ADPT_ARG(padapter), ie_id, tag); -+ set_tx_beacon_cmd(padapter); -+ } -+#else -+ { -+ /* PCI will issue beacon when BCN interrupt occurs. */ -+ } -+#endif -+#endif /* !CONFIG_INTERRUPT_BASED_TXBCN */ -+ -+} -+ -+#ifdef CONFIG_80211N_HT -+ -+void rtw_process_public_act_bsscoex(_adapter *padapter, u8 *pframe, uint frame_len) -+{ -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 beacon_updated = _FALSE; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ uint frame_body_len = frame_len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 category, action; -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta == NULL) -+ return; -+ -+ -+ category = frame_body[0]; -+ action = frame_body[1]; -+ -+ if (frame_body_len > 0) { -+ if ((frame_body[2] == EID_BSSCoexistence) && (frame_body[3] > 0)) { -+ u8 ie_data = frame_body[4]; -+ -+ if (ie_data & RTW_WLAN_20_40_BSS_COEX_40MHZ_INTOL) { -+ if (psta->ht_40mhz_intolerant == 0) { -+ psta->ht_40mhz_intolerant = 1; -+ pmlmepriv->num_sta_40mhz_intolerant++; -+ beacon_updated = _TRUE; -+ } -+ } else if (ie_data & RTW_WLAN_20_40_BSS_COEX_20MHZ_WIDTH_REQ) { -+ if (pmlmepriv->ht_20mhz_width_req == _FALSE) { -+ pmlmepriv->ht_20mhz_width_req = _TRUE; -+ beacon_updated = _TRUE; -+ } -+ } else -+ beacon_updated = _FALSE; -+ } -+ } -+ -+ if (frame_body_len > 8) { -+ /* if EID_BSSIntolerantChlReport ie exists */ -+ if ((frame_body[5] == EID_BSSIntolerantChlReport) && (frame_body[6] > 0)) { -+ /*todo:*/ -+ if (pmlmepriv->ht_intolerant_ch_reported == _FALSE) { -+ pmlmepriv->ht_intolerant_ch_reported = _TRUE; -+ beacon_updated = _TRUE; -+ } -+ } -+ } -+ -+ if (beacon_updated) { -+ -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); -+ -+ associated_stainfo_update(padapter, psta, STA_INFO_UPDATE_BW); -+ } -+ -+ -+ -+} -+ -+void rtw_process_ht_action_smps(_adapter *padapter, u8 *ta, u8 ctrl_field) -+{ -+ u8 e_field, m_field; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ psta = rtw_get_stainfo(pstapriv, ta); -+ if (psta == NULL) -+ return; -+ -+ e_field = (ctrl_field & BIT(0)) ? 1 : 0; -+ m_field = (ctrl_field & BIT(1)) ? 1 : 0; -+ -+ if (e_field) { -+ -+ /* enable */ -+ /* 0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ -+ -+ if (m_field) /*mode*/ -+ psta->htpriv.smps_cap = 1; -+ else -+ psta->htpriv.smps_cap = 0; -+ } else { -+ /*disable*/ -+ psta->htpriv.smps_cap = 3; -+ } -+ -+ rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta); -+ -+} -+ -+/* -+op_mode -+Set to 0 (HT pure) under the followign conditions -+ - all STAs in the BSS are 20/40 MHz HT in 20/40 MHz BSS or -+ - all STAs in the BSS are 20 MHz HT in 20 MHz BSS -+Set to 1 (HT non-member protection) if there may be non-HT STAs -+ in both the primary and the secondary channel -+Set to 2 if only HT STAs are associated in BSS, -+ however and at least one 20 MHz HT STA is associated -+Set to 3 (HT mixed mode) when one or more non-HT STAs are associated -+ (currently non-GF HT station is considered as non-HT STA also) -+*/ -+int rtw_ht_operation_update(_adapter *padapter) -+{ -+ u16 cur_op_mode, new_op_mode; -+ int op_mode_changes = 0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; -+ -+ if (pmlmepriv->htpriv.ht_option == _FALSE) -+ return 0; -+ -+ /*if (!iface->conf->ieee80211n || iface->conf->ht_op_mode_fixed) -+ return 0;*/ -+ -+ RTW_INFO("%s current operation mode=0x%X\n", -+ __FUNCTION__, pmlmepriv->ht_op_mode); -+ -+ if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) -+ && pmlmepriv->num_sta_ht_no_gf) { -+ pmlmepriv->ht_op_mode |= -+ HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT; -+ op_mode_changes++; -+ } else if ((pmlmepriv->ht_op_mode & -+ HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) && -+ pmlmepriv->num_sta_ht_no_gf == 0) { -+ pmlmepriv->ht_op_mode &= -+ ~HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT; -+ op_mode_changes++; -+ } -+ -+ if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) && -+ (pmlmepriv->num_sta_no_ht || ATOMIC_READ(&pmlmepriv->olbc_ht))) { -+ pmlmepriv->ht_op_mode |= HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT; -+ op_mode_changes++; -+ } else if ((pmlmepriv->ht_op_mode & -+ HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) && -+ (pmlmepriv->num_sta_no_ht == 0 && !ATOMIC_READ(&pmlmepriv->olbc_ht))) { -+ pmlmepriv->ht_op_mode &= -+ ~HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT; -+ op_mode_changes++; -+ } -+ -+ /* Note: currently we switch to the MIXED op mode if HT non-greenfield -+ * station is associated. Probably it's a theoretical case, since -+ * it looks like all known HT STAs support greenfield. -+ */ -+ new_op_mode = 0; -+ if (pmlmepriv->num_sta_no_ht /*|| -+ (pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT)*/) -+ new_op_mode = OP_MODE_MIXED; -+ else if ((phtpriv_ap->ht_cap.cap_info & IEEE80211_HT_CAP_SUP_WIDTH) -+ && pmlmepriv->num_sta_ht_20mhz) -+ new_op_mode = OP_MODE_20MHZ_HT_STA_ASSOCED; -+ else if (ATOMIC_READ(&pmlmepriv->olbc_ht)) -+ new_op_mode = OP_MODE_MAY_BE_LEGACY_STAS; -+ else -+ new_op_mode = OP_MODE_PURE; -+ -+ cur_op_mode = pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_OP_MODE_MASK; -+ if (cur_op_mode != new_op_mode) { -+ pmlmepriv->ht_op_mode &= ~HT_INFO_OPERATION_MODE_OP_MODE_MASK; -+ pmlmepriv->ht_op_mode |= new_op_mode; -+ op_mode_changes++; -+ } -+ -+ RTW_INFO("%s new operation mode=0x%X changes=%d\n", -+ __FUNCTION__, pmlmepriv->ht_op_mode, op_mode_changes); -+ -+ return op_mode_changes; -+ -+} -+ -+#endif /* CONFIG_80211N_HT */ -+ -+void associated_clients_update(_adapter *padapter, u8 updated, u32 sta_info_type) -+{ -+ /* update associcated stations cap. */ -+ if (updated == _TRUE) { -+ _irqL irqL; -+ _list *phead, *plist; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* check asoc_queue */ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ associated_stainfo_update(padapter, psta, sta_info_type); -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ } -+ -+} -+ -+/* called > TSR LEVEL for USB or SDIO Interface*/ -+void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) -+{ -+ u8 beacon_updated = _FALSE; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ -+#if 0 -+ if (!(psta->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) && -+ !psta->no_short_preamble_set) { -+ psta->no_short_preamble_set = 1; -+ pmlmepriv->num_sta_no_short_preamble++; -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_preamble == 1)) -+ ieee802_11_set_beacons(hapd->iface); -+ } -+#endif -+ -+ -+ if (!(psta->flags & WLAN_STA_SHORT_PREAMBLE)) { -+ if (!psta->no_short_preamble_set) { -+ psta->no_short_preamble_set = 1; -+ -+ pmlmepriv->num_sta_no_short_preamble++; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_preamble == 1)) { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, 0xFF, NULL, _TRUE); -+ } -+ -+ } -+ } else { -+ if (psta->no_short_preamble_set) { -+ psta->no_short_preamble_set = 0; -+ -+ pmlmepriv->num_sta_no_short_preamble--; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_preamble == 0)) { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, 0xFF, NULL, _TRUE); -+ } -+ -+ } -+ } -+ -+#if 0 -+ if (psta->flags & WLAN_STA_NONERP && !psta->nonerp_set) { -+ psta->nonerp_set = 1; -+ pmlmepriv->num_sta_non_erp++; -+ if (pmlmepriv->num_sta_non_erp == 1) -+ ieee802_11_set_beacons(hapd->iface); -+ } -+#endif -+ -+ if (psta->flags & WLAN_STA_NONERP) { -+ if (!psta->nonerp_set) { -+ psta->nonerp_set = 1; -+ -+ pmlmepriv->num_sta_non_erp++; -+ -+ if (pmlmepriv->num_sta_non_erp == 1) { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE); -+ } -+ } -+ -+ } else { -+ if (psta->nonerp_set) { -+ psta->nonerp_set = 0; -+ -+ pmlmepriv->num_sta_non_erp--; -+ -+ if (pmlmepriv->num_sta_non_erp == 0) { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE); -+ } -+ } -+ -+ } -+ -+ -+#if 0 -+ if (!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT) && -+ !psta->no_short_slot_time_set) { -+ psta->no_short_slot_time_set = 1; -+ pmlmepriv->num_sta_no_short_slot_time++; -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_slot_time == 1)) -+ ieee802_11_set_beacons(hapd->iface); -+ } -+#endif -+ -+ if (!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT)) { -+ if (!psta->no_short_slot_time_set) { -+ psta->no_short_slot_time_set = 1; -+ -+ pmlmepriv->num_sta_no_short_slot_time++; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_slot_time == 1)) { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, 0xFF, NULL, _TRUE); -+ } -+ -+ } -+ } else { -+ if (psta->no_short_slot_time_set) { -+ psta->no_short_slot_time_set = 0; -+ -+ pmlmepriv->num_sta_no_short_slot_time--; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_slot_time == 0)) { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, 0xFF, NULL, _TRUE); -+ } -+ } -+ } -+ -+#ifdef CONFIG_80211N_HT -+ -+ if (psta->flags & WLAN_STA_HT) { -+ u16 ht_capab = le16_to_cpu(psta->htpriv.ht_cap.cap_info); -+ -+ RTW_INFO("HT: STA " MAC_FMT " HT Capabilities " -+ "Info: 0x%04x\n", MAC_ARG(psta->hwaddr), ht_capab); -+ -+ if (psta->no_ht_set) { -+ psta->no_ht_set = 0; -+ pmlmepriv->num_sta_no_ht--; -+ } -+ -+ if ((ht_capab & IEEE80211_HT_CAP_GRN_FLD) == 0) { -+ if (!psta->no_ht_gf_set) { -+ psta->no_ht_gf_set = 1; -+ pmlmepriv->num_sta_ht_no_gf++; -+ } -+ RTW_INFO("%s STA " MAC_FMT " - no " -+ "greenfield, num of non-gf stations %d\n", -+ __FUNCTION__, MAC_ARG(psta->hwaddr), -+ pmlmepriv->num_sta_ht_no_gf); -+ } -+ -+ if ((ht_capab & IEEE80211_HT_CAP_SUP_WIDTH) == 0) { -+ if (!psta->ht_20mhz_set) { -+ psta->ht_20mhz_set = 1; -+ pmlmepriv->num_sta_ht_20mhz++; -+ } -+ RTW_INFO("%s STA " MAC_FMT " - 20 MHz HT, " -+ "num of 20MHz HT STAs %d\n", -+ __FUNCTION__, MAC_ARG(psta->hwaddr), -+ pmlmepriv->num_sta_ht_20mhz); -+ } -+ -+ } else { -+ if (!psta->no_ht_set) { -+ psta->no_ht_set = 1; -+ pmlmepriv->num_sta_no_ht++; -+ } -+ if (pmlmepriv->htpriv.ht_option == _TRUE) { -+ RTW_INFO("%s STA " MAC_FMT -+ " - no HT, num of non-HT stations %d\n", -+ __FUNCTION__, MAC_ARG(psta->hwaddr), -+ pmlmepriv->num_sta_no_ht); -+ } -+ } -+ -+ if (rtw_ht_operation_update(padapter) > 0) { -+ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); -+ /*beacon_updated = _TRUE;*/ -+ } -+ -+#endif /* CONFIG_80211N_HT */ -+ -+ /* update associcated stations cap. */ -+ associated_clients_update(padapter, beacon_updated, STA_INFO_UPDATE_ALL); -+ -+ RTW_INFO("%s, updated=%d\n", __func__, beacon_updated); -+ -+} -+ -+u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta) -+{ -+ u8 beacon_updated = _FALSE; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ if (!psta) -+ return beacon_updated; -+ -+ if (psta->no_short_preamble_set) { -+ psta->no_short_preamble_set = 0; -+ pmlmepriv->num_sta_no_short_preamble--; -+ if (pmlmeext->cur_wireless_mode > WIRELESS_11B -+ && pmlmepriv->num_sta_no_short_preamble == 0) { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, 0xFF, NULL, _TRUE); -+ } -+ } -+ -+ if (psta->nonerp_set) { -+ psta->nonerp_set = 0; -+ pmlmepriv->num_sta_non_erp--; -+ if (pmlmepriv->num_sta_non_erp == 0) { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE); -+ } -+ } -+ -+ if (psta->no_short_slot_time_set) { -+ psta->no_short_slot_time_set = 0; -+ pmlmepriv->num_sta_no_short_slot_time--; -+ if (pmlmeext->cur_wireless_mode > WIRELESS_11B -+ && pmlmepriv->num_sta_no_short_slot_time == 0) { -+ beacon_updated = _TRUE; -+ update_beacon(padapter, 0xFF, NULL, _TRUE); -+ } -+ } -+ -+#ifdef CONFIG_80211N_HT -+ -+ if (psta->no_ht_gf_set) { -+ psta->no_ht_gf_set = 0; -+ pmlmepriv->num_sta_ht_no_gf--; -+ } -+ -+ if (psta->no_ht_set) { -+ psta->no_ht_set = 0; -+ pmlmepriv->num_sta_no_ht--; -+ } -+ -+ if (psta->ht_20mhz_set) { -+ psta->ht_20mhz_set = 0; -+ pmlmepriv->num_sta_ht_20mhz--; -+ } -+ -+ -+ -+ if (rtw_ht_operation_update(padapter) > 0) { -+ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); -+ } -+ -+#endif /* CONFIG_80211N_HT */ -+ -+#if 0 -+ /* update associated stations cap. */ -+ associated_clients_update(padapter, beacon_updated, STA_INFO_UPDATE_ALL); /* move it to avoid deadlock */ -+#endif -+ -+ RTW_INFO("%s, updated=%d\n", __func__, beacon_updated); -+ -+ return beacon_updated; -+ -+} -+ -+u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reason, bool enqueue) -+{ -+ _irqL irqL; -+ u8 beacon_updated = _FALSE; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ if (!psta) -+ return beacon_updated; -+ -+ if (active == _TRUE) { -+#ifdef CONFIG_80211N_HT -+ /* tear down Rx AMPDU */ -+ send_delba(padapter, 0, psta->hwaddr);/* recipient */ -+ -+ /* tear down TX AMPDU */ -+ send_delba(padapter, 1, psta->hwaddr);/* */ /* originator */ -+ -+#endif /* CONFIG_80211N_HT */ -+ -+ issue_deauth(padapter, psta->hwaddr, reason); -+ } -+ -+#ifdef CONFIG_BEAMFORMING -+ beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_LEAVE, psta->hwaddr, ETH_ALEN, 1); -+#endif -+ -+#ifdef CONFIG_80211N_HT -+ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ -+ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ -+#endif /* CONFIG_80211N_HT */ -+ -+ /* clear cam entry / key */ -+ rtw_clearstakey_cmd(padapter, psta, enqueue); -+ -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state &= ~_FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (1) { -+#ifdef COMPAT_KERNEL_RELEASE -+ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); -+#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) */ -+ /* will call rtw_cfg80211_indicate_sta_disassoc() in cmd_thread for old API context */ -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) */ -+ } else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ { -+ rtw_indicate_sta_disassoc_event(padapter, psta); -+ } -+ -+ report_del_sta_event(padapter, psta->hwaddr, reason, enqueue, _FALSE); -+ -+ beacon_updated = bss_cap_update_on_sta_leave(padapter, psta); -+ -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ rtw_free_stainfo(padapter, psta); -+ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ -+ -+ return beacon_updated; -+ -+} -+ -+int rtw_ap_inform_ch_switch(_adapter *padapter, u8 new_ch, u8 ch_offset) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ int ret = 0; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) -+ return ret; -+ -+ RTW_INFO(FUNC_NDEV_FMT" with ch:%u, offset:%u\n", -+ FUNC_NDEV_ARG(padapter->pnetdev), new_ch, ch_offset); -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* for each sta in asoc_queue */ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ issue_action_spct_ch_switch(padapter, psta->hwaddr, new_ch, ch_offset); -+ psta->expire_to = ((pstapriv->expire_to * 2) > 5) ? 5 : (pstapriv->expire_to * 2); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ issue_action_spct_ch_switch(padapter, bc_addr, new_ch, ch_offset); -+ -+ return ret; -+} -+ -+int rtw_sta_flush(_adapter *padapter, bool enqueue) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ int ret = 0; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 flush_num = 0; -+ char flush_list[NUM_STA]; -+ int i; -+ -+ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) -+ return ret; -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); -+ -+ /* pick sta from sta asoc_queue */ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ int stainfo_offset; -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ flush_list[flush_num++] = stainfo_offset; -+ else -+ rtw_warn_on(1); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ /* call ap_free_sta() for each sta picked */ -+ for (i = 0; i < flush_num; i++) { -+ psta = rtw_get_stainfo_by_offset(pstapriv, flush_list[i]); -+ ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, enqueue); -+ } -+ -+ issue_deauth(padapter, bc_addr, WLAN_REASON_DEAUTH_LEAVING); -+ -+ associated_clients_update(padapter, _TRUE, STA_INFO_UPDATE_ALL); -+ -+ return ret; -+} -+ -+/* called > TSR LEVEL for USB or SDIO Interface*/ -+void sta_info_update(_adapter *padapter, struct sta_info *psta) -+{ -+ int flags = psta->flags; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ -+ /* update wmm cap. */ -+ if (WLAN_STA_WME & flags) -+ psta->qos_option = 1; -+ else -+ psta->qos_option = 0; -+ -+ if (pmlmepriv->qospriv.qos_option == 0) -+ psta->qos_option = 0; -+ -+ -+#ifdef CONFIG_80211N_HT -+ /* update 802.11n ht cap. */ -+ if (WLAN_STA_HT & flags) { -+ psta->htpriv.ht_option = _TRUE; -+ psta->qos_option = 1; -+ -+ psta->htpriv.smps_cap = (psta->htpriv.ht_cap.cap_info & IEEE80211_HT_CAP_SM_PS) >> 2; -+ } else -+ psta->htpriv.ht_option = _FALSE; -+ -+ if (pmlmepriv->htpriv.ht_option == _FALSE) -+ psta->htpriv.ht_option = _FALSE; -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ /* update 802.11AC vht cap. */ -+ if (WLAN_STA_VHT & flags) -+ psta->vhtpriv.vht_option = _TRUE; -+ else -+ psta->vhtpriv.vht_option = _FALSE; -+ -+ if (pmlmepriv->vhtpriv.vht_option == _FALSE) -+ psta->vhtpriv.vht_option = _FALSE; -+#endif -+ -+ update_sta_info_apmode(padapter, psta); -+} -+ -+/* called >= TSR LEVEL for USB or SDIO Interface*/ -+void ap_sta_info_defer_update(_adapter *padapter, struct sta_info *psta) -+{ -+ if (psta->state & _FW_LINKED) -+ rtw_hal_update_ra_mask(psta, 0); /* DM_RATR_STA_INIT */ -+} -+/* restore hw setting from sw data structures */ -+void rtw_ap_restore_network(_adapter *padapter) -+{ -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ _irqL irqL; -+ _list *phead, *plist; -+ u8 chk_alive_num = 0; -+ char chk_alive_list[NUM_STA]; -+ int i; -+ -+ rtw_setopmode_cmd(padapter, Ndis802_11APMode, _FALSE); -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ rtw_startbss_cmd(padapter, RTW_CMDF_DIRECTLY); -+ -+ if ((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) { -+ /* restore group key, WEP keys is restored in ips_leave() */ -+ rtw_set_key(padapter, psecuritypriv, psecuritypriv->dot118021XGrpKeyid, 0, _FALSE); -+ } -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ int stainfo_offset; -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ chk_alive_list[chk_alive_num++] = stainfo_offset; -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ for (i = 0; i < chk_alive_num; i++) { -+ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); -+ -+ if (psta == NULL) -+ RTW_INFO(FUNC_ADPT_FMT" sta_info is null\n", FUNC_ADPT_ARG(padapter)); -+ else if (psta->state & _FW_LINKED) { -+ rtw_sta_media_status_rpt(padapter, psta, 1); -+ Update_RA_Entry(padapter, psta); -+ /* pairwise key */ -+ /* per sta pairwise key and settings */ -+ if ((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) -+ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _FALSE); -+ } -+ } -+ -+} -+ -+void start_ap_mode(_adapter *padapter) -+{ -+ int i; -+ struct sta_info *psta = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ pmlmepriv->update_bcn = _FALSE; -+ -+ /*init_mlme_ap_info(padapter);*/ -+ -+ pmlmeext->bstart_bss = _FALSE; -+ -+ pmlmepriv->num_sta_non_erp = 0; -+ -+ pmlmepriv->num_sta_no_short_slot_time = 0; -+ -+ pmlmepriv->num_sta_no_short_preamble = 0; -+ -+ pmlmepriv->num_sta_ht_no_gf = 0; -+#ifdef CONFIG_80211N_HT -+ pmlmepriv->num_sta_no_ht = 0; -+#endif /* CONFIG_80211N_HT */ -+ pmlmeinfo->HT_info_enable = 0; -+ pmlmeinfo->HT_caps_enable = 0; -+ pmlmeinfo->HT_enable = 0; -+ -+ pmlmepriv->num_sta_ht_20mhz = 0; -+ pmlmepriv->num_sta_40mhz_intolerant = 0; -+ ATOMIC_SET(&pmlmepriv->olbc, _FALSE); -+ ATOMIC_SET(&pmlmepriv->olbc_ht, _FALSE); -+ -+#ifdef CONFIG_80211N_HT -+ pmlmepriv->ht_20mhz_width_req = _FALSE; -+ pmlmepriv->ht_intolerant_ch_reported = _FALSE; -+ pmlmepriv->ht_op_mode = 0; -+ pmlmepriv->sw_to_20mhz = 0; -+#endif -+ -+ _rtw_memset(pmlmepriv->ext_capab_ie_data, 0, sizeof(pmlmepriv->ext_capab_ie_data)); -+ pmlmepriv->ext_capab_ie_len = 0; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ psecuritypriv->dot118021x_bmc_cam_id = INVALID_SEC_MAC_CAM_ID; -+#endif -+ -+ for (i = 0 ; i < NUM_STA ; i++) -+ pstapriv->sta_aid[i] = NULL; -+ -+#if CONFIG_RTW_MACADDR_ACL -+ rtw_macaddr_acl_init(padapter); -+#endif -+ -+ psta = rtw_get_bcmc_stainfo(padapter); -+ /*_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL);*/ -+ if (psta) -+ rtw_free_stainfo(padapter, psta); -+ /*_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);*/ -+ -+ rtw_init_bcmc_stainfo(padapter); -+ -+ if (rtw_mi_get_ap_num(padapter)) -+ RTW_SET_SCAN_BAND_SKIP(padapter, BAND_5G); -+ -+} -+ -+void stop_ap_mode(_adapter *padapter) -+{ -+ _irqL irqL; -+ struct sta_info *psta = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct dvobj_priv *pdvobj = padapter->dvobj; -+ -+ RTW_INFO("%s -"ADPT_FMT"\n", __func__, ADPT_ARG(padapter)); -+ -+ pmlmepriv->update_bcn = _FALSE; -+ /*pmlmeext->bstart_bss = _FALSE;*/ -+ padapter->netif_up = _FALSE; -+ /* _rtw_spinlock_free(&pmlmepriv->bcn_update_lock); */ -+ -+ /* reset and init security priv , this can refine with rtw_reset_securitypriv */ -+ _rtw_memset((unsigned char *)&padapter->securitypriv, 0, sizeof(struct security_priv)); -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; -+ -+#ifdef CONFIG_DFS_MASTER -+ rtw_dfs_master_status_apply(padapter, MLME_AP_STOPPED); -+#endif -+ -+ /* free scan queue */ -+ rtw_free_network_queue(padapter, _TRUE); -+ -+#if CONFIG_RTW_MACADDR_ACL -+ rtw_macaddr_acl_deinit(padapter); -+#endif -+ -+ rtw_sta_flush(padapter, _TRUE); -+ -+ /* free_assoc_sta_resources */ -+ rtw_free_all_stainfo(padapter); -+ -+ psta = rtw_get_bcmc_stainfo(padapter); -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ rtw_free_stainfo(padapter, psta); -+ /*_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);*/ -+ -+ rtw_free_mlme_priv_ie_data(pmlmepriv); -+ -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+ if (pmlmeext->bstart_bss == _TRUE) { -+ _enter_critical_bh(&pdvobj->ap_if_q.lock, &irqL); -+ pdvobj->nr_ap_if--; -+ if (pdvobj->nr_ap_if > 0) -+ pdvobj->inter_bcn_space = DEFAULT_BCN_INTERVAL / pdvobj->nr_ap_if; -+ else -+ pdvobj->inter_bcn_space = DEFAULT_BCN_INTERVAL; -+ -+ rtw_list_delete(&padapter->list); -+ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&pdvobj->inter_bcn_space)); -+ -+ if (pdvobj->nr_ap_if == 0) -+ _cancel_timer_ex(&pdvobj->txbcn_timer); -+ } -+#endif -+ -+ pmlmeext->bstart_bss = _FALSE; -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_MediaStatusNotify(padapter, 0); /* disconnect */ -+#endif -+ -+} -+ -+#endif /* CONFIG_NATIVEAP_MLME */ -+ -+void rtw_ap_update_bss_chbw(_adapter *adapter, WLAN_BSSID_EX *bss, u8 ch, u8 bw, u8 offset) -+{ -+#define UPDATE_VHT_CAP 1 -+#define UPDATE_HT_CAP 1 -+ -+#ifdef CONFIG_80211AC_VHT -+ { -+ struct vht_priv *vhtpriv = &adapter->mlmepriv.vhtpriv; -+ u8 *vht_cap_ie, *vht_op_ie; -+ int vht_cap_ielen, vht_op_ielen; -+ u8 center_freq; -+ -+ vht_cap_ie = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_VHTCapability, &vht_cap_ielen, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ vht_op_ie = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_VHTOperation, &vht_op_ielen, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ center_freq = rtw_get_center_ch(ch, bw, offset); -+ -+ /* update vht cap ie */ -+ if (vht_cap_ie && vht_cap_ielen) { -+ #if UPDATE_VHT_CAP -+ /* if ((bw == CHANNEL_WIDTH_160 || bw == CHANNEL_WIDTH_80_80) && pvhtpriv->sgi_160m) -+ SET_VHT_CAPABILITY_ELE_SHORT_GI160M(pvht_cap_ie + 2, 1); -+ else */ -+ SET_VHT_CAPABILITY_ELE_SHORT_GI160M(vht_cap_ie + 2, 0); -+ -+ if (bw >= CHANNEL_WIDTH_80 && vhtpriv->sgi_80m) -+ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(vht_cap_ie + 2, 1); -+ else -+ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(vht_cap_ie + 2, 0); -+ #endif -+ } -+ -+ /* update vht op ie */ -+ if (vht_op_ie && vht_op_ielen) { -+ if (bw < CHANNEL_WIDTH_80) { -+ SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2, 0); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op_ie + 2, 0); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op_ie + 2, 0); -+ } else if (bw == CHANNEL_WIDTH_80) { -+ SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2, 1); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op_ie + 2, center_freq); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op_ie + 2, 0); -+ } else { -+ RTW_ERR(FUNC_ADPT_FMT" unsupported BW:%u\n", FUNC_ADPT_ARG(adapter), bw); -+ rtw_warn_on(1); -+ } -+ } -+ } -+#endif /* CONFIG_80211AC_VHT */ -+#ifdef CONFIG_80211N_HT -+ { -+ struct ht_priv *htpriv = &adapter->mlmepriv.htpriv; -+ u8 *ht_cap_ie, *ht_op_ie; -+ int ht_cap_ielen, ht_op_ielen; -+ -+ ht_cap_ie = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_HTCapability, &ht_cap_ielen, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ ht_op_ie = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_HTInfo, &ht_op_ielen, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ -+ /* update ht cap ie */ -+ if (ht_cap_ie && ht_cap_ielen) { -+ #if UPDATE_HT_CAP -+ if (bw >= CHANNEL_WIDTH_40) -+ SET_HT_CAP_ELE_CHL_WIDTH(ht_cap_ie + 2, 1); -+ else -+ SET_HT_CAP_ELE_CHL_WIDTH(ht_cap_ie + 2, 0); -+ -+ if (bw >= CHANNEL_WIDTH_40 && htpriv->sgi_40m) -+ SET_HT_CAP_ELE_SHORT_GI40M(ht_cap_ie + 2, 1); -+ else -+ SET_HT_CAP_ELE_SHORT_GI40M(ht_cap_ie + 2, 0); -+ -+ if (htpriv->sgi_20m) -+ SET_HT_CAP_ELE_SHORT_GI20M(ht_cap_ie + 2, 1); -+ else -+ SET_HT_CAP_ELE_SHORT_GI20M(ht_cap_ie + 2, 0); -+ #endif -+ } -+ -+ /* update ht op ie */ -+ if (ht_op_ie && ht_op_ielen) { -+ SET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2, ch); -+ switch (offset) { -+ case HAL_PRIME_CHNL_OFFSET_LOWER: -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2, SCA); -+ break; -+ case HAL_PRIME_CHNL_OFFSET_UPPER: -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2, SCB); -+ break; -+ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: -+ default: -+ SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2, SCN); -+ break; -+ } -+ -+ if (bw >= CHANNEL_WIDTH_40) -+ SET_HT_OP_ELE_STA_CHL_WIDTH(ht_op_ie + 2, 1); -+ else -+ SET_HT_OP_ELE_STA_CHL_WIDTH(ht_op_ie + 2, 0); -+ } -+ } -+#endif /* CONFIG_80211N_HT */ -+ -+ { -+ u8 *p; -+ int ie_len; -+ u8 old_ch = bss->Configuration.DSConfig; -+ bool change_band = _FALSE; -+ -+ if ((ch <= 14 && old_ch >= 36) || (ch >= 36 && old_ch <= 14)) -+ change_band = _TRUE; -+ -+ /* update channel in IE */ -+ p = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if (p && ie_len > 0) -+ *(p + 2) = ch; -+ -+ bss->Configuration.DSConfig = ch; -+ -+ /* band is changed, update ERP, support rate, ext support rate IE */ -+ if (change_band == _TRUE) -+ change_band_update_ie(adapter, bss, ch); -+ } -+ -+} -+ -+bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offset -+ , u8 *ch, u8 *bw, u8 *offset, u8 *chbw_allow) -+{ -+ u8 cur_ie_ch, cur_ie_bw, cur_ie_offset; -+ u8 dec_ch, dec_bw, dec_offset; -+ u8 u_ch = 0, u_offset, u_bw; -+ bool changed = _FALSE; -+ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); -+ WLAN_BSSID_EX *network = &(adapter->mlmepriv.cur_network.network); -+ struct mi_state mstate; -+ bool set_u_ch = _FALSE, set_dec_ch = _FALSE; -+ -+ rtw_ies_get_chbw(network->IEs + sizeof(NDIS_802_11_FIXED_IEs) -+ , network->IELength - sizeof(NDIS_802_11_FIXED_IEs) -+ , &cur_ie_ch, &cur_ie_bw, &cur_ie_offset); -+ -+ /* use chbw of cur_ie updated with specifying req as temporary decision */ -+ dec_ch = (req_ch <= 0) ? cur_ie_ch : req_ch; -+ dec_bw = (req_bw < 0) ? cur_ie_bw : req_bw; -+ dec_offset = (req_offset < 0) ? cur_ie_offset : req_offset; -+ -+ rtw_mi_status_no_self(adapter, &mstate); -+ RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, lg_sta_num%u, ap_num:%u\n" -+ , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate), MSTATE_STA_LG_NUM(&mstate), MSTATE_AP_NUM(&mstate)); -+ -+ if (MSTATE_STA_LD_NUM(&mstate) || MSTATE_AP_NUM(&mstate)) { -+ /* has linked STA or AP mode, follow */ -+ -+ rtw_warn_on(!rtw_mi_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset)); -+ -+ RTW_INFO(FUNC_ADPT_FMT" union no self: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ RTW_INFO(FUNC_ADPT_FMT" req: %d,%d,%d\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); -+ -+#ifdef CONFIG_80211N_HT -+ rtw_adjust_chbw(adapter, u_ch, &dec_bw, &dec_offset); -+#endif /* CONFIG_80211N_HT */ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(adapter)) { -+ if (!rtw_is_chbw_grouped(u_ch, u_bw, u_offset, dec_ch, dec_bw, dec_offset)) { -+ mlmeext->cur_channel = *ch = dec_ch; -+ mlmeext->cur_bwmode = *bw = dec_bw; -+ mlmeext->cur_ch_offset = *offset = dec_offset; -+ /* channel bw offset can not be allowed, need MCC */ -+ *chbw_allow = _FALSE; -+ RTW_INFO(FUNC_ADPT_FMT" enable mcc: %u,%u,%u\n", FUNC_ADPT_ARG(adapter) -+ , *ch, *bw, *offset); -+ goto exit; -+ } else -+ /* channel bw offset can be allowed, not need MCC */ -+ *chbw_allow = _TRUE; -+ } -+#endif /* CONFIG_MCC_MODE */ -+ rtw_sync_chbw(&dec_ch, &dec_bw, &dec_offset -+ , &u_ch, &u_bw, &u_offset); -+ -+ rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) -+ , dec_ch, dec_bw, dec_offset); -+ -+ set_u_ch = _TRUE; -+ } else if (MSTATE_STA_LG_NUM(&mstate)) { -+ /* has linking STA */ -+ -+ rtw_warn_on(!rtw_mi_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset)); -+ -+ RTW_INFO(FUNC_ADPT_FMT" union no self: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ RTW_INFO(FUNC_ADPT_FMT" req: %d,%d,%d\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); -+ -+#ifdef CONFIG_80211N_HT -+ rtw_adjust_chbw(adapter, dec_ch, &dec_bw, &dec_offset); -+#endif -+ if (rtw_is_chbw_grouped(u_ch, u_bw, u_offset, dec_ch, dec_bw, dec_offset)) { -+ -+ rtw_sync_chbw(&dec_ch, &dec_bw, &dec_offset -+ , &u_ch, &u_bw, &u_offset); -+ -+ rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) -+ , dec_ch, dec_bw, dec_offset); -+ -+ set_u_ch = _TRUE; -+ -+ /* channel bw offset can be allowed, not need MCC */ -+ *chbw_allow = _TRUE; -+ } else { -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(adapter)) { -+ mlmeext->cur_channel = *ch = dec_ch; -+ mlmeext->cur_bwmode = *bw = dec_bw; -+ mlmeext->cur_ch_offset = *offset = dec_offset; -+ -+ /* channel bw offset can not be allowed, need MCC */ -+ *chbw_allow = _FALSE; -+ RTW_INFO(FUNC_ADPT_FMT" enable mcc: %u,%u,%u\n", FUNC_ADPT_ARG(adapter) -+ , *ch, *bw, *offset); -+ goto exit; -+ } -+#endif /* CONFIG_MCC_MODE */ -+ /* set this for possible ch change when join down*/ -+ set_fwstate(&adapter->mlmepriv, WIFI_OP_CH_SWITCHING); -+ } -+ } else { -+ /* single AP mode */ -+ -+ RTW_INFO(FUNC_ADPT_FMT" req: %d,%d,%d\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); -+ -+ /* check temporary decision first */ -+#ifdef CONFIG_80211N_HT -+ rtw_adjust_chbw(adapter, dec_ch, &dec_bw, &dec_offset); -+#endif -+ if (!rtw_get_offset_by_chbw(dec_ch, dec_bw, &dec_offset)) { -+#if defined(CONFIG_DFS_MASTER) -+ if (req_ch == -1 || req_bw == -1) -+ goto choose_chbw; -+#endif -+ RTW_WARN(FUNC_ADPT_FMT" req: %u,%u has no valid offset\n", FUNC_ADPT_ARG(adapter), dec_ch, dec_bw); -+ *chbw_allow = _FALSE; -+ goto exit; -+ } -+ -+ if (!rtw_chset_is_chbw_valid(mlmeext->channel_set, dec_ch, dec_bw, dec_offset)) { -+#if defined(CONFIG_DFS_MASTER) -+ if (req_ch == -1 || req_bw == -1) -+ goto choose_chbw; -+#endif -+ RTW_WARN(FUNC_ADPT_FMT" req: %u,%u,%u doesn't fit in chplan\n", FUNC_ADPT_ARG(adapter), dec_ch, dec_bw, dec_offset); -+ *chbw_allow = _FALSE; -+ goto exit; -+ } -+ -+ if (rtw_chset_is_ch_non_ocp(mlmeext->channel_set, dec_ch, dec_bw, dec_offset) == _FALSE) -+ goto update_bss_chbw; -+ -+choose_chbw: -+ if (req_bw < 0) -+ req_bw = cur_ie_bw; -+ -+#if defined(CONFIG_DFS_MASTER) -+ /* choose 5G DFS channel for debug */ -+ if (adapter_to_rfctl(adapter)->dbg_dfs_master_choose_dfs_ch_first -+ && rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, RTW_CHF_2G | RTW_CHF_NON_DFS) == _TRUE) -+ RTW_INFO(FUNC_ADPT_FMT" choose 5G DFS channel for debug\n", FUNC_ADPT_ARG(adapter)); -+ else if (adapter_to_rfctl(adapter)->dfs_ch_sel_d_flags -+ && rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, adapter_to_rfctl(adapter)->dfs_ch_sel_d_flags) == _TRUE) -+ RTW_INFO(FUNC_ADPT_FMT" choose with dfs_ch_sel_d_flags:0x%02x for debug\n", FUNC_ADPT_ARG(adapter), adapter_to_rfctl(adapter)->dfs_ch_sel_d_flags); -+ else if (rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, 0) == _FALSE) { -+ RTW_WARN(FUNC_ADPT_FMT" no available channel\n", FUNC_ADPT_ARG(adapter)); -+ *chbw_allow = _FALSE; -+ goto exit; -+ } -+#endif /* defined(CONFIG_DFS_MASTER) */ -+ -+update_bss_chbw: -+ rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) -+ , dec_ch, dec_bw, dec_offset); -+ -+ /* channel bw offset can be allowed for single AP, not need MCC */ -+ *chbw_allow = _TRUE; -+ set_dec_ch = _TRUE; -+ } -+ -+ if (rtw_mi_check_fwstate(adapter, _FW_UNDER_SURVEY)) { -+ /* scanning, leave ch setting to scan state machine */ -+ set_u_ch = set_dec_ch = _FALSE; -+ } -+ -+ if (mlmeext->cur_channel != dec_ch -+ || mlmeext->cur_bwmode != dec_bw -+ || mlmeext->cur_ch_offset != dec_offset) -+ changed = _TRUE; -+ -+ if (changed == _TRUE && rtw_linked_check(adapter) == _TRUE) { -+#ifdef CONFIG_SPCT_CH_SWITCH -+ if (1) -+ rtw_ap_inform_ch_switch(adapter, dec_ch, dec_offset); -+ else -+#endif -+ rtw_sta_flush(adapter, _FALSE); -+ } -+ -+ mlmeext->cur_channel = dec_ch; -+ mlmeext->cur_bwmode = dec_bw; -+ mlmeext->cur_ch_offset = dec_offset; -+ -+ if (u_ch != 0) -+ RTW_INFO(FUNC_ADPT_FMT" union: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ -+ RTW_INFO(FUNC_ADPT_FMT" dec: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), dec_ch, dec_bw, dec_offset); -+ -+ if (set_u_ch == _TRUE) { -+ *ch = u_ch; -+ *bw = u_bw; -+ *offset = u_offset; -+ } else if (set_dec_ch == _TRUE) { -+ *ch = dec_ch; -+ *bw = dec_bw; -+ *offset = dec_offset; -+ } -+exit: -+ return changed; -+} -+ -+/*#define DBG_SWTIMER_BASED_TXBCN*/ -+ -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+void tx_beacon_handlder(struct dvobj_priv *pdvobj) -+{ -+#define BEACON_EARLY_TIME 20 /* unit:TU*/ -+ _irqL irqL; -+ _list *plist, *phead; -+ u32 timestamp[2]; -+ u32 bcn_interval_us; /* unit : usec */ -+ u64 time; -+ u32 cur_tick, time_offset; /* unit : usec */ -+ u32 inter_bcn_space_us; /* unit : usec */ -+ int nr_vap, idx, bcn_idx; -+ int i; -+ u8 val8, late = 0; -+ _adapter *padapter = NULL; -+ -+ i = 0; -+ -+ /* get first ap mode interface */ -+ _enter_critical_bh(&pdvobj->ap_if_q.lock, &irqL); -+ if (rtw_is_list_empty(&pdvobj->ap_if_q.queue) || (pdvobj->nr_ap_if == 0)) { -+ RTW_INFO("[%s] ERROR: ap_if_q is empty!or nr_ap = %d\n", __func__, pdvobj->nr_ap_if); -+ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); -+ return; -+ } else -+ padapter = LIST_CONTAINOR(get_next(&(pdvobj->ap_if_q.queue)), struct _ADAPTER, list); -+ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); -+ -+ if (NULL == padapter) { -+ RTW_INFO("[%s] ERROR: no any ap interface!\n", __func__); -+ return; -+ } -+ -+ -+ bcn_interval_us = DEFAULT_BCN_INTERVAL * NET80211_TU_TO_US; -+ if (0 == bcn_interval_us) { -+ RTW_INFO("[%s] ERROR: beacon interval = 0\n", __func__); -+ return; -+ } -+ -+ /* read TSF */ -+ timestamp[1] = rtw_read32(padapter, 0x560 + 4); -+ timestamp[0] = rtw_read32(padapter, 0x560); -+ while (timestamp[1]) { -+ time = (0xFFFFFFFF % bcn_interval_us + 1) * timestamp[1] + timestamp[0]; -+ timestamp[0] = (u32)time; -+ timestamp[1] = (u32)(time >> 32); -+ } -+ cur_tick = timestamp[0] % bcn_interval_us; -+ -+ -+ _enter_critical_bh(&pdvobj->ap_if_q.lock, &irqL); -+ -+ nr_vap = (pdvobj->nr_ap_if - 1); -+ if (nr_vap > 0) { -+ inter_bcn_space_us = pdvobj->inter_bcn_space * NET80211_TU_TO_US; /* beacon_interval / (nr_vap+1); */ -+ idx = cur_tick / inter_bcn_space_us; -+ if (idx < nr_vap) /* if (idx < (nr_vap+1))*/ -+ bcn_idx = idx + 1; /* bcn_idx = (idx + 1) % (nr_vap+1);*/ -+ else -+ bcn_idx = 0; -+ -+ /* to get padapter based on bcn_idx */ -+ padapter = NULL; -+ phead = get_list_head(&pdvobj->ap_if_q); -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ padapter = LIST_CONTAINOR(plist, struct _ADAPTER, list); -+ -+ plist = get_next(plist); -+ -+ if (i == bcn_idx) -+ break; -+ -+ i++; -+ } -+ if ((NULL == padapter) || (i > pdvobj->nr_ap_if)) { -+ RTW_INFO("[%s] ERROR: nr_ap_if = %d, padapter=%p, bcn_idx=%d, index=%d\n", -+ __func__, pdvobj->nr_ap_if, padapter, bcn_idx, i); -+ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); -+ return; -+ } -+#ifdef DBG_SWTIMER_BASED_TXBCN -+ RTW_INFO("BCN_IDX=%d, cur_tick=%d, padapter=%p\n", bcn_idx, cur_tick, padapter); -+#endif -+ if (((idx + 2 == nr_vap + 1) && (idx < nr_vap + 1)) || (0 == bcn_idx)) { -+ time_offset = bcn_interval_us - cur_tick - BEACON_EARLY_TIME * NET80211_TU_TO_US; -+ if ((s32)time_offset < 0) -+ time_offset += inter_bcn_space_us; -+ -+ } else { -+ time_offset = (idx + 2) * inter_bcn_space_us - cur_tick - BEACON_EARLY_TIME * NET80211_TU_TO_US; -+ if (time_offset > (inter_bcn_space_us + (inter_bcn_space_us >> 1))) { -+ time_offset -= inter_bcn_space_us; -+ late = 1; -+ } -+ } -+ } else -+ /*#endif*/ { /* MBSSID */ -+ time_offset = 2 * bcn_interval_us - cur_tick - BEACON_EARLY_TIME * NET80211_TU_TO_US; -+ if (time_offset > (bcn_interval_us + (bcn_interval_us >> 1))) { -+ time_offset -= bcn_interval_us; -+ late = 1; -+ } -+ } -+ _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); -+ -+#ifdef DBG_SWTIMER_BASED_TXBCN -+ RTW_INFO("set sw bcn timer %d us\n", time_offset); -+#endif -+ _set_timer(&pdvobj->txbcn_timer, time_offset / NET80211_TU_TO_US); -+ -+ if (padapter) { -+#ifdef DBG_SWTIMER_BASED_TXBCN -+ RTW_INFO("padapter=%p, PORT=%d\n", padapter, padapter->hw_port); -+#endif -+ /*update_beacon(padapter, _TIM_IE_, NULL, _FALSE);*/ -+ issue_beacon(padapter, 0); -+ } -+ -+#if 0 -+ /* handle any buffered BC/MC frames*/ -+ /* Don't dynamically change DIS_ATIM due to HW will auto send ACQ after HIQ empty.*/ -+ val8 = *((unsigned char *)priv->beaconbuf + priv->timoffset + 4); -+ if (val8 & 0x01) { -+ process_mcast_dzqueue(priv); -+ priv->pkt_in_dtimQ = 0; -+ } -+#endif -+ -+} -+ -+void tx_beacon_timer_handlder(struct dvobj_priv *pdvobj) -+{ -+ _adapter *padapter = pdvobj->padapters[0]; -+ -+ if (padapter) -+ set_tx_beacon_cmd(padapter); -+} -+#endif -+ -+#endif /* CONFIG_AP_MODE */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_beamforming.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_beamforming.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_beamforming.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_beamforming.c 2018-02-11 21:44:27.135145903 +0200 -@@ -0,0 +1,1942 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_BEAMFORMING_C_ -+ -+#include -+#include -+ -+#ifdef CONFIG_BEAMFORMING -+ -+#if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ -+#ifdef RTW_BEAMFORMING_VERSION_2 -+/* -+ * For phydm -+ */ -+BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(void *mlme, u8 mac_id) -+{ -+ PADAPTER adapter; -+ struct beamforming_info *pBeamInfo; -+ struct beamformee_entry *bfee; -+ BEAMFORMING_CAP cap = BEAMFORMING_CAP_NONE; -+ u8 i = 0; -+ -+ -+ adapter = mlme_to_adapter((struct mlme_priv *)mlme); -+ pBeamInfo = GET_BEAMFORM_INFO(adapter); -+ -+ for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { -+ bfee = &pBeamInfo->bfee_entry[i]; -+ if ((bfee->used == _TRUE) -+ && (bfee->mac_id == mac_id)) { -+ cap = bfee->cap; -+ break; -+ } -+ } -+ -+ return cap; -+} -+ -+struct beamformer_entry *beamforming_get_bfer_entry_by_addr(PADAPTER adapter, u8 *ra) -+{ -+ u8 i = 0; -+ struct beamforming_info *bf_info; -+ struct beamformer_entry *entry; -+ -+ -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { -+ entry = &bf_info->bfer_entry[i]; -+ if (entry->used == _FALSE) -+ continue; -+ if (_rtw_memcmp(ra, entry->mac_addr, ETH_ALEN) == _TRUE) { -+ return entry; -+ } -+ } -+ -+ return NULL; -+} -+ -+struct beamformee_entry *beamforming_get_bfee_entry_by_addr(PADAPTER adapter, u8 *ra) -+{ -+ u8 i = 0; -+ struct beamforming_info *bf_info; -+ struct beamformee_entry *entry; -+ -+ -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { -+ entry = &bf_info->bfee_entry[i]; -+ if (entry->used == _FALSE) -+ continue; -+ if (_rtw_memcmp(ra, entry->mac_addr, ETH_ALEN) == _TRUE) -+ return entry; -+ } -+ -+ return NULL; -+} -+ -+static struct beamformer_entry *_get_bfer_free_entry(PADAPTER adapter) -+{ -+ u8 i = 0; -+ struct beamforming_info *bf_info; -+ struct beamformer_entry *entry; -+ -+ -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { -+ entry = &bf_info->bfer_entry[i]; -+ if (entry->used == _FALSE) -+ return entry; -+ } -+ -+ return NULL; -+} -+ -+static struct beamformee_entry *_get_bfee_free_entry(PADAPTER adapter) -+{ -+ u8 i = 0; -+ struct beamforming_info *bf_info; -+ struct beamformee_entry *entry; -+ -+ -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { -+ entry = &bf_info->bfee_entry[i]; -+ if (entry->used == _FALSE) -+ return entry; -+ } -+ -+ return NULL; -+} -+ -+/* -+ * Description: -+ * Get the first entry index of MU Beamformee. -+ * -+ * Return Value: -+ * Index of the first MU sta. -+ * -+ * 2015.05.25. Created by tynli. -+ * -+ */ -+static u8 _get_first_mu_bfee_entry_idx(PADAPTER adapter, struct beamformee_entry *ignore) -+{ -+ struct beamforming_info *bf_info; -+ struct beamformee_entry *entry; -+ u8 idx = 0xFF; -+ u8 bFound = _FALSE; -+ -+ -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ for (idx = 0; idx < MAX_BEAMFORMEE_ENTRY_NUM; idx++) { -+ entry = &bf_info->bfee_entry[idx]; -+ if (ignore && (entry == ignore)) -+ continue; -+ if ((entry->used == _TRUE) && -+ TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_MU)) { -+ bFound = _TRUE; -+ break; -+ } -+ } -+ -+ if (bFound == _FALSE) -+ idx = 0xFF; -+ -+ return idx; -+} -+ -+static void _update_min_sounding_period(PADAPTER adapter, u16 period, u8 leave) -+{ -+ struct beamforming_info *bf_info; -+ struct beamformee_entry *entry; -+ u8 i = 0; -+ u16 min_val = 0xFFFF; -+ -+ -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ if (_TRUE == leave) { -+ /* -+ * When a BFee left, -+ * we need to find the latest min sounding period -+ * from the remaining BFees -+ */ -+ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { -+ entry = &bf_info->bfee_entry[i]; -+ if ((entry->used == _TRUE) -+ && (entry->sound_period < min_val)) -+ min_val = entry->sound_period; -+ } -+ -+ if (min_val == 0xFFFF) -+ bf_info->sounding_info.min_sounding_period = 0; -+ else -+ bf_info->sounding_info.min_sounding_period = min_val; -+ } else { -+ if ((bf_info->sounding_info.min_sounding_period == 0) -+ || (period < bf_info->sounding_info.min_sounding_period)) -+ bf_info->sounding_info.min_sounding_period = period; -+ } -+} -+ -+static struct beamformer_entry *_add_bfer_entry(PADAPTER adapter, -+ struct sta_info *sta, u8 bf_cap, u8 sounding_dim, u8 comp_steering) -+{ -+ struct mlme_priv *mlme; -+ struct beamforming_info *bf_info; -+ struct beamformer_entry *entry; -+ u8 *bssid; -+ u16 val16; -+ u8 i; -+ -+ -+ mlme = &adapter->mlmepriv; -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ entry = beamforming_get_bfer_entry_by_addr(adapter, sta->hwaddr); -+ if (!entry) { -+ entry = _get_bfer_free_entry(adapter); -+ if (!entry) -+ return NULL; -+ } -+ -+ entry->used = _TRUE; -+ -+ if (check_fwstate(mlme, WIFI_AP_STATE)) { -+ bssid = adapter_mac_addr(adapter); -+ /* BSSID[44:47] xor BSSID[40:43] */ -+ val16 = ((bssid[5] & 0xF0) >> 4) ^ (bssid[5] & 0xF); -+ /* (dec(A) + dec(B)*32) mod 512 */ -+ entry->p_aid = (sta->aid + val16 * 32) & 0x1FF; -+ entry->g_id = 63; -+ } else if ((check_fwstate(mlme, WIFI_ADHOC_STATE) == _TRUE) -+ || (check_fwstate(mlme, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { -+ entry->p_aid = 0; -+ entry->g_id = 63; -+ } else { -+ bssid = sta->hwaddr; -+ /* BSSID[39:47] */ -+ entry->p_aid = (bssid[5] << 1) | (bssid[4] >> 7); -+ entry->g_id = 0; -+ } -+ RTW_INFO("%s: p_aid=0x%04x g_id=0x%04x aid=0x%x\n", -+ __FUNCTION__, entry->p_aid, entry->g_id, sta->aid); -+ -+ _rtw_memcpy(entry->mac_addr, sta->hwaddr, ETH_ALEN); -+ entry->cap = bf_cap; -+ entry->state = BEAMFORM_ENTRY_HW_STATE_ADD_INIT; -+ entry->NumofSoundingDim = sounding_dim; -+ -+ if (TEST_FLAG(bf_cap, BEAMFORMER_CAP_VHT_MU)) { -+ bf_info->beamformer_mu_cnt += 1; -+ entry->aid = sta->aid; -+ } else if (TEST_FLAG(bf_cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { -+ bf_info->beamformer_su_cnt += 1; -+ -+ /* Record HW idx info */ -+ for (i = 0; i < MAX_NUM_BEAMFORMER_SU; i++) { -+ if ((bf_info->beamformer_su_reg_maping & BIT(i)) == 0) { -+ bf_info->beamformer_su_reg_maping |= BIT(i); -+ entry->su_reg_index = i; -+ break; -+ } -+ } -+ RTW_INFO("%s: Add BFer entry beamformer_su_reg_maping=%#X, su_reg_index=%d\n", -+ __FUNCTION__, bf_info->beamformer_su_reg_maping, entry->su_reg_index); -+ } -+ -+ return entry; -+} -+ -+static struct beamformee_entry *_add_bfee_entry(PADAPTER adapter, -+ struct sta_info *sta, u8 bf_cap, u8 sounding_dim, u8 comp_steering) -+{ -+ struct mlme_priv *mlme; -+ struct beamforming_info *bf_info; -+ struct beamformee_entry *entry; -+ u8 *bssid; -+ u16 val16; -+ u8 i; -+ -+ -+ mlme = &adapter->mlmepriv; -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ entry = beamforming_get_bfee_entry_by_addr(adapter, sta->hwaddr); -+ if (!entry) { -+ entry = _get_bfee_free_entry(adapter); -+ if (!entry) -+ return NULL; -+ } -+ -+ entry->used = _TRUE; -+ entry->aid = sta->aid; -+ entry->mac_id = sta->mac_id; -+ entry->sound_bw = sta->bw_mode; -+ -+ if (check_fwstate(mlme, WIFI_AP_STATE)) { -+ bssid = adapter_mac_addr(adapter); -+ /* BSSID[44:47] xor BSSID[40:43] */ -+ val16 = ((bssid[5] & 0xF0) >> 4) ^ (bssid[5] & 0xF); -+ /* (dec(A) + dec(B)*32) mod 512 */ -+ entry->p_aid = (sta->aid + val16 * 32) & 0x1FF; -+ entry->g_id = 63; -+ } else if (check_fwstate(mlme, WIFI_ADHOC_STATE) || check_fwstate(mlme, WIFI_ADHOC_MASTER_STATE)) { -+ entry->p_aid = 0; -+ entry->g_id = 63; -+ } else { -+ bssid = sta->hwaddr; -+ /* BSSID[39:47] */ -+ entry->p_aid = (bssid[5] << 1) | (bssid[4] >> 7); -+ entry->g_id = 0; -+ } -+ -+ _rtw_memcpy(entry->mac_addr, sta->hwaddr, ETH_ALEN); -+ entry->txbf = _FALSE; -+ entry->sounding = _FALSE; -+ entry->sound_period = 40; -+ entry->cap = bf_cap; -+ -+ _update_min_sounding_period(adapter, entry->sound_period, _FALSE); -+ entry->SoundCnt = GetInitSoundCnt(entry->sound_period, bf_info->sounding_info.min_sounding_period); -+ -+ entry->LogStatusFailCnt = 0; -+ -+ entry->NumofSoundingDim = sounding_dim; -+ entry->CompSteeringNumofBFer = comp_steering; -+ entry->state = BEAMFORM_ENTRY_HW_STATE_ADD_INIT; -+ -+ if (TEST_FLAG(bf_cap, BEAMFORMEE_CAP_VHT_MU)) { -+ bf_info->beamformee_mu_cnt += 1; -+ bf_info->first_mu_bfee_index = _get_first_mu_bfee_entry_idx(adapter, NULL); -+ -+ /* Record HW idx info */ -+ for (i = 0; i < MAX_NUM_BEAMFORMEE_MU; i++) { -+ if ((bf_info->beamformee_mu_reg_maping & BIT(i)) == 0) { -+ bf_info->beamformee_mu_reg_maping |= BIT(i); -+ entry->mu_reg_index = i; -+ break; -+ } -+ } -+ RTW_INFO("%s: Add BFee entry beamformee_mu_reg_maping=%#X, mu_reg_index=%d\n", -+ __FUNCTION__, bf_info->beamformee_mu_reg_maping, entry->mu_reg_index); -+ -+ } else if (TEST_FLAG(bf_cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { -+ bf_info->beamformee_su_cnt += 1; -+ -+ /* Record HW idx info */ -+ for (i = 0; i < MAX_NUM_BEAMFORMEE_SU; i++) { -+ if ((bf_info->beamformee_su_reg_maping & BIT(i)) == 0) { -+ bf_info->beamformee_su_reg_maping |= BIT(i); -+ entry->su_reg_index = i; -+ break; -+ } -+ } -+ RTW_INFO("%s: Add BFee entry beamformee_su_reg_maping=%#X, su_reg_index=%d\n", -+ __FUNCTION__, bf_info->beamformee_su_reg_maping, entry->su_reg_index); -+ } -+ -+ return entry; -+} -+ -+static void _remove_bfer_entry(PADAPTER adapter, struct beamformer_entry *entry) -+{ -+ struct beamforming_info *bf_info; -+ -+ -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ entry->state = BEAMFORM_ENTRY_HW_STATE_DELETE_INIT; -+ -+ if (TEST_FLAG(entry->cap, BEAMFORMER_CAP_VHT_MU)) { -+ bf_info->beamformer_mu_cnt -= 1; -+ _rtw_memset(entry->gid_valid, 0, 8); -+ _rtw_memset(entry->user_position, 0, 16); -+ } else if (TEST_FLAG(entry->cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { -+ bf_info->beamformer_su_cnt -= 1; -+ } -+ -+ if (bf_info->beamformer_mu_cnt == 0) -+ bf_info->beamforming_cap &= ~BEAMFORMEE_CAP_VHT_MU; -+ if (bf_info->beamformer_su_cnt == 0) -+ bf_info->beamforming_cap &= ~(BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT); -+} -+ -+static void _remove_bfee_entry(PADAPTER adapter, struct beamformee_entry *entry) -+{ -+ struct beamforming_info *bf_info; -+ -+ -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ -+ entry->state = BEAMFORM_ENTRY_HW_STATE_DELETE_INIT; -+ -+ if (TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_MU)) { -+ bf_info->beamformee_mu_cnt -= 1; -+ bf_info->first_mu_bfee_index = _get_first_mu_bfee_entry_idx(adapter, entry); -+ } else if (TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { -+ bf_info->beamformee_su_cnt -= 1; -+ } -+ -+ if (bf_info->beamformee_mu_cnt == 0) -+ bf_info->beamforming_cap &= ~BEAMFORMER_CAP_VHT_MU; -+ if (bf_info->beamformee_su_cnt == 0) -+ bf_info->beamforming_cap &= ~(BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT); -+ -+ _update_min_sounding_period(adapter, 0, _TRUE); -+} -+ -+/* -+ * Parameters -+ * adapter struct _adapter* -+ * sta struct sta_info* -+ * sta_bf_cap beamforming capabe of sta -+ * sounding_dim Number of Sounding Dimensions -+ * comp_steering Compressed Steering Number of Beamformer Antennas Supported -+ */ -+static void _get_sta_beamform_cap(PADAPTER adapter, struct sta_info *sta, -+ u8 *sta_bf_cap, u8 *sounding_dim, u8 *comp_steering) -+{ -+ struct ht_priv *ht; -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv *vht; -+#endif /* CONFIG_80211AC_VHT */ -+ u16 bf_cap; -+ -+ -+ *sta_bf_cap = 0; -+ *sounding_dim = 0; -+ *comp_steering = 0; -+ -+ ht = &adapter->mlmepriv.htpriv; -+#ifdef CONFIG_80211AC_VHT -+ vht = &adapter->mlmepriv.vhtpriv; -+#endif /* CONFIG_80211AC_VHT */ -+ -+ if (IsSupportedHT(sta->wireless_mode) == _TRUE) { -+ /* HT */ -+ bf_cap = ht->beamform_cap; -+ -+ if (TEST_FLAG(bf_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) { -+ *sta_bf_cap |= BEAMFORMER_CAP_HT_EXPLICIT; -+ *sounding_dim = (bf_cap & BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP) >> 6; -+ } -+ if (TEST_FLAG(bf_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { -+ *sta_bf_cap |= BEAMFORMEE_CAP_HT_EXPLICIT; -+ *comp_steering = (bf_cap & BEAMFORMING_HT_BEAMFORMER_STEER_NUM) >> 4; -+ } -+ } -+ -+#ifdef CONFIG_80211AC_VHT -+ if (IsSupportedVHT(sta->wireless_mode) == _TRUE) { -+ /* VHT */ -+ bf_cap = vht->beamform_cap; -+ -+ /* We are SU Beamformee because the STA is SU Beamformer */ -+ if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) { -+ *sta_bf_cap |= BEAMFORMER_CAP_VHT_SU; -+ -+ /* We are MU Beamformee because the STA is MU Beamformer */ -+ if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) -+ *sta_bf_cap |= BEAMFORMER_CAP_VHT_MU; -+ -+ *sounding_dim = (bf_cap & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM) >> 12; -+ } -+ /* We are SU Beamformer because the STA is SU Beamformee */ -+ if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { -+ *sta_bf_cap |= BEAMFORMEE_CAP_VHT_SU; -+ -+ /* We are MU Beamformer because the STA is MU Beamformee */ -+ if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) -+ *sta_bf_cap |= BEAMFORMEE_CAP_VHT_MU; -+ -+ *comp_steering = (bf_cap & BEAMFORMING_VHT_BEAMFORMER_STS_CAP) >> 8; -+ } -+ } -+#endif /* CONFIG_80211AC_VHT */ -+} -+/* -+ * Return: -+ * _TRUE success -+ * _FALSE fail -+ */ -+static u8 _init_entry(PADAPTER adapter, struct sta_info *sta) -+{ -+ struct mlme_priv *mlme; -+ struct ht_priv *htpriv; -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv *vhtpriv; -+#endif -+ struct mlme_ext_priv *mlme_ext; -+ struct sta_info *sta_real; -+ struct beamformer_entry *bfer = NULL; -+ struct beamformee_entry *bfee = NULL; -+ u8 *ra; -+ u8 wireless_mode; -+ u8 sta_bf_cap; -+ u8 sounding_dim = 0; /* number of sounding dimensions */ -+ u8 comp_steering_num = 0; /* compressed steering number */ -+ -+ -+ mlme = &adapter->mlmepriv; -+ htpriv = &mlme->htpriv; -+#ifdef CONFIG_80211AC_VHT -+ vhtpriv = &mlme->vhtpriv; -+#endif -+ mlme_ext = &adapter->mlmeextpriv; -+ ra = sta->hwaddr; -+ wireless_mode = sta->wireless_mode; -+ sta_real = rtw_get_stainfo(&adapter->stapriv, ra); -+ -+ /* The current setting does not support Beaforming */ -+ if ((IsSupportedHT(wireless_mode) == _FALSE) -+ && (IsSupportedVHT(wireless_mode) == _FALSE)) -+ return _FALSE; -+ -+ if ((0 == htpriv->beamform_cap) -+#ifdef CONFIG_80211AC_VHT -+ && (0 == vhtpriv->beamform_cap) -+#endif -+ ) { -+ RTW_INFO("The configuration disabled Beamforming! Skip...\n"); -+ return _FALSE; -+ } -+ -+ _get_sta_beamform_cap(adapter, sta, -+ &sta_bf_cap, &sounding_dim, &comp_steering_num); -+ RTW_INFO("STA Beamforming Capability=0x%02X\n", sta_bf_cap); -+ -+ if (sta_bf_cap == BEAMFORMING_CAP_NONE) -+ return _FALSE; -+ -+ if ((sta_bf_cap & BEAMFORMEE_CAP_HT_EXPLICIT) -+ || (sta_bf_cap & BEAMFORMEE_CAP_VHT_SU) -+ || (sta_bf_cap & BEAMFORMEE_CAP_VHT_MU)) -+ sta_bf_cap |= BEAMFORMEE_CAP; -+ else -+ sta_bf_cap |= BEAMFORMER_CAP; -+ -+ if (sta_bf_cap & BEAMFORMER_CAP) { -+ /* The other side is beamformer */ -+ bfer = _add_bfer_entry(adapter, sta, sta_bf_cap, sounding_dim, comp_steering_num); -+ if (bfer == NULL) { -+ RTW_ERR("%s: Fail to allocate bfer entry!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ -+ sta_real->txbf_paid = bfer->p_aid; -+ sta_real->txbf_gid = bfer->g_id; -+ } else { -+ /* The other side is beamformee */ -+ bfee = _add_bfee_entry(adapter, sta, sta_bf_cap, sounding_dim, comp_steering_num); -+ if (bfee == NULL) { -+ RTW_ERR("%s: Fail to allocate bfee entry!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ -+ sta_real->txbf_paid = bfee->p_aid; -+ sta_real->txbf_gid = bfee->g_id; -+ } -+ -+ return _TRUE; -+} -+ -+static void _deinit_entry(PADAPTER adapter, u8 *ra) -+{ -+ struct beamforming_info *bf_info; -+ struct beamformer_entry *bfer = NULL; -+ struct beamformee_entry *bfee = NULL; -+ u8 bHwStateAddInit = _FALSE; -+ -+ -+ RTW_INFO("+%s\n", __FUNCTION__); -+ -+ bf_info = GET_BEAMFORM_INFO(adapter); -+ bfer = beamforming_get_bfer_entry_by_addr(adapter, ra); -+ bfee = beamforming_get_bfee_entry_by_addr(adapter, ra); -+ -+ if (!bfer && !bfee) { -+ RTW_WARN("%s: " MAC_FMT " is neither beamforming ee or er!!\n", -+ __FUNCTION__, MAC_ARG(ra)); -+ return; -+ } -+ -+ if (bfer && bfee) -+ RTW_ERR("%s: " MAC_FMT " is both beamforming ee & er!!\n", -+ __FUNCTION__, MAC_ARG(ra)); -+ -+ if (bfer) -+ _remove_bfer_entry(adapter, bfer); -+ -+ if (bfee) -+ _remove_bfee_entry(adapter, bfee); -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_LEAVE, ra); -+ -+ RTW_DBG("-%s\n", __FUNCTION__); -+} -+ -+void _beamforming_reset(PADAPTER adapter) -+{ -+ RTW_ERR("%s: Not ready!!\n", __FUNCTION__); -+} -+ -+void beamforming_enter(PADAPTER adapter, void *sta) -+{ -+ u8 ret; -+ -+ ret = _init_entry(adapter, (struct sta_info *)sta); -+ if (ret == _FALSE) -+ return; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_ENTER, sta); -+} -+ -+void beamforming_leave(PADAPTER adapter, u8 *ra) -+{ -+ if (ra == NULL) -+ _beamforming_reset(adapter); -+ else -+ _deinit_entry(adapter, ra); -+} -+ -+void beamforming_sounding_fail(PADAPTER adapter) -+{ -+ RTW_ERR("+%s: not implemented yet!\n", __FUNCTION__); -+} -+ -+u8 beamforming_send_vht_gid_mgnt_packet(PADAPTER adapter, struct beamformee_entry *entry) -+{ -+ struct xmit_priv *xmitpriv; -+ struct mlme_priv *mlmepriv; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *attrib; -+ struct rtw_ieee80211_hdr *wlanhdr; -+ u8 *pframe; -+ -+ -+ xmitpriv = &adapter->xmitpriv; -+ mlmepriv = &adapter->mlmepriv; -+ -+ pmgntframe = alloc_mgtxmitframe(xmitpriv); -+ if (!pmgntframe) -+ return _FALSE; -+ -+ /* update attribute */ -+ attrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(adapter, attrib); -+ attrib->rate = MGN_6M; -+ attrib->bwmode = CHANNEL_WIDTH_20; -+ attrib->subtype = WIFI_ACTION; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)pmgntframe->buf_addr + TXDESC_OFFSET; -+ wlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ wlanhdr->frame_ctl = 0; -+ SetFrameSubType(pframe, attrib->subtype); -+ SetDuration(pframe, 0); -+ SetFragNum(pframe, 0); -+ SetSeqNum(pframe, 0); -+ -+ _rtw_memcpy(wlanhdr->addr1, entry->mac_addr, ETH_ALEN); -+ _rtw_memcpy(wlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); -+ _rtw_memcpy(wlanhdr->addr3, get_bssid(mlmepriv), ETH_ALEN); -+ -+ pframe[24] = RTW_WLAN_CATEGORY_VHT; -+ pframe[25] = RTW_WLAN_ACTION_VHT_GROUPID_MANAGEMENT; -+ _rtw_memcpy(&pframe[26], entry->gid_valid, 8); -+ _rtw_memcpy(&pframe[34], entry->user_position, 16); -+ -+ attrib->pktlen = 54; -+ attrib->last_txcmdsz = attrib->pktlen; -+ -+ dump_mgntframe(adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+void beamforming_watchdog(PADAPTER adapter) -+{ -+} -+#else /* !RTW_BEAMFORMING_VERSION_2 */ -+ -+struct beamforming_entry *beamforming_get_entry_by_addr(struct mlme_priv *pmlmepriv, u8 *ra, u8 *idx) -+{ -+ u8 i = 0; -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ -+ for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { -+ if (pBeamInfo->beamforming_entry[i].bUsed && -+ (_rtw_memcmp(ra, pBeamInfo->beamforming_entry[i].mac_addr, ETH_ALEN))) { -+ *idx = i; -+ return &(pBeamInfo->beamforming_entry[i]); -+ } -+ } -+ -+ return NULL; -+} -+ -+BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(PVOID pmlmepriv , u8 mac_id) -+{ -+ u8 i = 0; -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO((struct mlme_priv *)pmlmepriv); -+ BEAMFORMING_CAP BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ -+ for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { -+ if (pBeamInfo->beamforming_entry[i].bUsed && -+ (mac_id == pBeamInfo->beamforming_entry[i].mac_id)) { -+ BeamformEntryCap = pBeamInfo->beamforming_entry[i].beamforming_entry_cap; -+ i = BEAMFORMING_ENTRY_NUM; -+ } -+ } -+ -+ return BeamformEntryCap; -+} -+ -+struct beamforming_entry *beamforming_get_free_entry(struct mlme_priv *pmlmepriv, u8 *idx) -+{ -+ u8 i = 0; -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ -+ for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { -+ if (pBeamInfo->beamforming_entry[i].bUsed == _FALSE) { -+ *idx = i; -+ return &(pBeamInfo->beamforming_entry[i]); -+ } -+ } -+ return NULL; -+} -+ -+ -+struct beamforming_entry *beamforming_add_entry(PADAPTER adapter, u8 *ra, u16 aid, -+ u16 mac_id, CHANNEL_WIDTH bw, BEAMFORMING_CAP beamfrom_cap, u8 *idx) -+{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct beamforming_entry *pEntry = beamforming_get_free_entry(pmlmepriv, idx); -+ -+ if (pEntry != NULL) { -+ pEntry->bUsed = _TRUE; -+ pEntry->aid = aid; -+ pEntry->mac_id = mac_id; -+ pEntry->sound_bw = bw; -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ u16 BSSID = ((*(adapter_mac_addr(adapter) + 5) & 0xf0) >> 4) ^ -+ (*(adapter_mac_addr(adapter) + 5) & 0xf); /* BSSID[44:47] xor BSSID[40:43] */ -+ pEntry->p_aid = (aid + BSSID * 32) & 0x1ff; /* (dec(A) + dec(B)*32) mod 512 */ -+ pEntry->g_id = 63; -+ } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) { -+ pEntry->p_aid = 0; -+ pEntry->g_id = 63; -+ } else { -+ pEntry->p_aid = ra[5]; /* BSSID[39:47] */ -+ pEntry->p_aid = (pEntry->p_aid << 1) | (ra[4] >> 7); -+ pEntry->g_id = 0; -+ } -+ _rtw_memcpy(pEntry->mac_addr, ra, ETH_ALEN); -+ pEntry->bSound = _FALSE; -+ -+ /* 3 TODO SW/FW sound period */ -+ pEntry->sound_period = 200; -+ pEntry->beamforming_entry_cap = beamfrom_cap; -+ pEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ -+ -+ pEntry->PreLogSeq = 0; /*Modified by Jeffery @2015-04-13*/ -+ pEntry->LogSeq = 0; /*Modified by Jeffery @2014-10-29*/ -+ pEntry->LogRetryCnt = 0; /*Modified by Jeffery @2014-10-29*/ -+ pEntry->LogSuccess = 0; /*LogSuccess is NOT needed to be accumulated, so LogSuccessCnt->LogSuccess, 2015-04-13, Jeffery*/ -+ pEntry->ClockResetTimes = 0; /*Modified by Jeffery @2015-04-13*/ -+ pEntry->LogStatusFailCnt = 0; -+ -+ return pEntry; -+ } else -+ return NULL; -+} -+ -+BOOLEAN beamforming_remove_entry(struct mlme_priv *pmlmepriv, u8 *ra, u8 *idx) -+{ -+ struct beamforming_entry *pEntry = beamforming_get_entry_by_addr(pmlmepriv, ra, idx); -+ -+ if (pEntry != NULL) { -+ pEntry->bUsed = _FALSE; -+ pEntry->beamforming_entry_cap = BEAMFORMING_CAP_NONE; -+ pEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ return _TRUE; -+ } else -+ return _FALSE; -+} -+ -+/* Used for BeamformingStart_V1 */ -+void beamforming_dym_ndpa_rate(PADAPTER adapter) -+{ -+ u16 NDPARate = MGN_6M; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ -+ if (pHalData->MinUndecoratedPWDBForDM > 30) /* link RSSI > 30% */ -+ NDPARate = MGN_24M; -+ else -+ NDPARate = MGN_6M; -+ -+ /* BW = CHANNEL_WIDTH_20; */ -+ NDPARate = NDPARate << 8; -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_RATE, (u8 *)&NDPARate); -+} -+ -+void beamforming_dym_period(PADAPTER Adapter) -+{ -+ u8 Idx; -+ BOOLEAN bChangePeriod = _FALSE; -+ u16 SoundPeriod_SW, SoundPeriod_FW; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ struct beamforming_entry *pBeamformEntry; -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO((&Adapter->mlmepriv)); -+ struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); -+ -+ /* 3 TODO per-client throughput caculation. */ -+ -+ if (pdvobjpriv->traffic_stat.cur_tx_tp + pdvobjpriv->traffic_stat.cur_rx_tp > 2) { -+ SoundPeriod_SW = 32 * 20; -+ SoundPeriod_FW = 2; -+ } else { -+ SoundPeriod_SW = 32 * 2000; -+ SoundPeriod_FW = 200; -+ } -+ -+ for (Idx = 0; Idx < BEAMFORMING_ENTRY_NUM; Idx++) { -+ pBeamformEntry = pBeamInfo->beamforming_entry + Idx; -+ if (pBeamformEntry->bDefaultCSI) { -+ SoundPeriod_SW = 32 * 2000; -+ SoundPeriod_FW = 200; -+ } -+ -+ if (pBeamformEntry->beamforming_entry_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { -+ if (pSoundInfo->sound_mode == SOUNDING_FW_VHT_TIMER || pSoundInfo->sound_mode == SOUNDING_FW_HT_TIMER) { -+ if (pBeamformEntry->sound_period != SoundPeriod_FW) { -+ pBeamformEntry->sound_period = SoundPeriod_FW; -+ bChangePeriod = _TRUE; /* Only FW sounding need to send H2C packet to change sound period. */ -+ } -+ } else if (pBeamformEntry->sound_period != SoundPeriod_SW) -+ pBeamformEntry->sound_period = SoundPeriod_SW; -+ } -+ } -+ -+ if (bChangePeriod) -+ rtw_hal_set_hwreg(Adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&Idx); -+} -+ -+BOOLEAN issue_ht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; -+ u8 *pframe; -+ u16 *fctrl; -+ u16 duration = 0; -+ u8 aSifsTime = 0; -+ u8 NDPTxRate = 0; -+ -+ RTW_INFO("%s: issue_ht_sw_ndpa_packet!\n", __func__); -+ -+ NDPTxRate = MGN_MCS8; -+ RTW_INFO("%s: NDPTxRate =%d\n", __func__, NDPTxRate); -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) -+ return _FALSE; -+ -+ /*update attribute*/ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ pattrib->qsel = QSLT_MGNT; -+ pattrib->rate = NDPTxRate; -+ pattrib->bwmode = bw; -+ pattrib->order = 1; -+ pattrib->subtype = WIFI_ACTION_NOACK; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetOrderBit(pframe); -+ SetFrameSubType(pframe, WIFI_ACTION_NOACK); -+ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ if (pmlmeext->cur_wireless_mode == WIRELESS_11B) -+ aSifsTime = 10; -+ else -+ aSifsTime = 16; -+ -+ duration = 2 * aSifsTime + 40; -+ -+ if (bw == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ SetDuration(pframe, duration); -+ -+ /*HT control field*/ -+ SET_HT_CTRL_CSI_STEERING(pframe + 24, 3); -+ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe + 24, 1); -+ -+ _rtw_memcpy(pframe + 28, ActionHdr, 4); -+ -+ pattrib->pktlen = 32; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ return _TRUE; -+ -+ -+} -+BOOLEAN issue_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; -+ u8 *pframe; -+ u16 *fctrl; -+ u16 duration = 0; -+ u8 aSifsTime = 0; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) -+ return _FALSE; -+ -+ /*update attribute*/ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ -+ if (qidx == BCN_QUEUE_INX) -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->rate = MGN_MCS8; -+ pattrib->bwmode = bw; -+ pattrib->order = 1; -+ pattrib->subtype = WIFI_ACTION_NOACK; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetOrderBit(pframe); -+ SetFrameSubType(pframe, WIFI_ACTION_NOACK); -+ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ if (pmlmeext->cur_wireless_mode == WIRELESS_11B) -+ aSifsTime = 10; -+ else -+ aSifsTime = 16; -+ -+ duration = 2 * aSifsTime + 40; -+ -+ if (bw == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ SetDuration(pframe, duration); -+ -+ /* HT control field */ -+ SET_HT_CTRL_CSI_STEERING(pframe + 24, 3); -+ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe + 24, 1); -+ -+ _rtw_memcpy(pframe + 28, ActionHdr, 4); -+ -+ pattrib->pktlen = 32; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+BOOLEAN beamforming_send_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) -+{ -+ return issue_ht_ndpa_packet(Adapter, ra, bw, qidx); -+} -+BOOLEAN issue_vht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct rtw_ndpa_sta_info sta_info; -+ u8 NDPTxRate = 0; -+ -+ u8 *pframe; -+ u16 *fctrl; -+ u16 duration = 0; -+ u8 sequence = 0, aSifsTime = 0; -+ -+ RTW_INFO("%s: issue_vht_sw_ndpa_packet!\n", __func__); -+ -+ -+ NDPTxRate = MGN_VHT2SS_MCS0; -+ RTW_INFO("%s: NDPTxRate =%d\n", __func__, NDPTxRate); -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ RTW_INFO("%s, alloc mgnt frame fail\n", __func__); -+ return _FALSE; -+ } -+ -+ /*update attribute*/ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ pattrib->qsel = QSLT_MGNT; -+ pattrib->rate = NDPTxRate; -+ pattrib->bwmode = bw; -+ pattrib->subtype = WIFI_NDPA; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetFrameSubType(pframe, WIFI_NDPA); -+ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); -+ -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ duration = 2 * aSifsTime + 44; -+ -+ if (bw == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if (bw == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ SetDuration(pframe, duration); -+ -+ sequence = pBeamInfo->sounding_sequence << 2; -+ if (pBeamInfo->sounding_sequence >= 0x3f) -+ pBeamInfo->sounding_sequence = 0; -+ else -+ pBeamInfo->sounding_sequence++; -+ -+ _rtw_memcpy(pframe + 16, &sequence, 1); -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) -+ aid = 0; -+ -+ sta_info.aid = aid; -+ sta_info.feedback_type = 0; -+ sta_info.nc_index = 0; -+ -+ _rtw_memcpy(pframe + 17, (u8 *)&sta_info, 2); -+ -+ pattrib->pktlen = 19; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ -+ return _TRUE; -+ -+} -+BOOLEAN issue_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct rtw_ndpa_sta_info sta_info; -+ u8 *pframe; -+ u16 *fctrl; -+ u16 duration = 0; -+ u8 sequence = 0, aSifsTime = 0; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return _FALSE; -+ -+ /*update attribute*/ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ -+ if (qidx == BCN_QUEUE_INX) -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->rate = MGN_VHT2SS_MCS0; -+ pattrib->bwmode = bw; -+ pattrib->subtype = WIFI_NDPA; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetFrameSubType(pframe, WIFI_NDPA); -+ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); -+ -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ duration = 2 * aSifsTime + 44; -+ -+ if (bw == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if (bw == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ SetDuration(pframe, duration); -+ -+ sequence = pBeamInfo->sounding_sequence << 2; -+ if (pBeamInfo->sounding_sequence >= 0x3f) -+ pBeamInfo->sounding_sequence = 0; -+ else -+ pBeamInfo->sounding_sequence++; -+ -+ _rtw_memcpy(pframe + 16, &sequence, 1); -+ -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) -+ aid = 0; -+ -+ sta_info.aid = aid; -+ sta_info.feedback_type = 0; -+ sta_info.nc_index = 0; -+ -+ _rtw_memcpy(pframe + 17, (u8 *)&sta_info, 2); -+ -+ pattrib->pktlen = 19; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+BOOLEAN beamforming_send_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) -+{ -+ return issue_vht_ndpa_packet(Adapter, ra, aid, bw, qidx); -+} -+ -+BOOLEAN beamfomring_bSounding(struct beamforming_info *pBeamInfo) -+{ -+ BOOLEAN bSounding = _FALSE; -+ -+ if ((beamforming_get_beamform_cap(pBeamInfo) & BEAMFORMER_CAP) == 0) -+ bSounding = _FALSE; -+ else -+ bSounding = _TRUE; -+ -+ return bSounding; -+} -+ -+u8 beamforming_sounding_idx(struct beamforming_info *pBeamInfo) -+{ -+ u8 idx = 0; -+ u8 i; -+ -+ for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { -+ if (pBeamInfo->beamforming_entry[i].bUsed && -+ (_FALSE == pBeamInfo->beamforming_entry[i].bSound)) { -+ idx = i; -+ break; -+ } -+ } -+ -+ return idx; -+} -+ -+SOUNDING_MODE beamforming_sounding_mode(struct beamforming_info *pBeamInfo, u8 idx) -+{ -+ struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; -+ SOUNDING_MODE mode; -+ -+ if (BeamEntry.beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) -+ mode = SOUNDING_FW_VHT_TIMER; -+ else if (BeamEntry.beamforming_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) -+ mode = SOUNDING_FW_HT_TIMER; -+ else -+ mode = SOUNDING_STOP_All_TIMER; -+ -+ return mode; -+} -+ -+u16 beamforming_sounding_time(struct beamforming_info *pBeamInfo, SOUNDING_MODE mode, u8 idx) -+{ -+ u16 sounding_time = 0xffff; -+ struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; -+ -+ sounding_time = BeamEntry.sound_period; -+ -+ return sounding_time; -+} -+ -+CHANNEL_WIDTH beamforming_sounding_bw(struct beamforming_info *pBeamInfo, SOUNDING_MODE mode, u8 idx) -+{ -+ CHANNEL_WIDTH sounding_bw = CHANNEL_WIDTH_20; -+ struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; -+ -+ sounding_bw = BeamEntry.sound_bw; -+ -+ return sounding_bw; -+} -+ -+BOOLEAN beamforming_select_beam_entry(struct beamforming_info *pBeamInfo) -+{ -+ struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); -+ -+ pSoundInfo->sound_idx = beamforming_sounding_idx(pBeamInfo); -+ -+ if (pSoundInfo->sound_idx < BEAMFORMING_ENTRY_NUM) -+ pSoundInfo->sound_mode = beamforming_sounding_mode(pBeamInfo, pSoundInfo->sound_idx); -+ else -+ pSoundInfo->sound_mode = SOUNDING_STOP_All_TIMER; -+ -+ if (SOUNDING_STOP_All_TIMER == pSoundInfo->sound_mode) -+ return _FALSE; -+ else { -+ pSoundInfo->sound_bw = beamforming_sounding_bw(pBeamInfo, pSoundInfo->sound_mode, pSoundInfo->sound_idx); -+ pSoundInfo->sound_period = beamforming_sounding_time(pBeamInfo, pSoundInfo->sound_mode, pSoundInfo->sound_idx); -+ return _TRUE; -+ } -+} -+ -+BOOLEAN beamforming_start_fw(PADAPTER adapter, u8 idx) -+{ -+ u8 *RA = NULL; -+ struct beamforming_entry *pEntry; -+ BOOLEAN ret = _TRUE; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ -+ pEntry = &(pBeamInfo->beamforming_entry[idx]); -+ if (pEntry->bUsed == _FALSE) { -+ RTW_INFO("Skip Beamforming, no entry for Idx =%d\n", idx); -+ return _FALSE; -+ } -+ -+ pEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; -+ pEntry->bSound = _TRUE; -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&idx); -+ -+ return _TRUE; -+} -+ -+void beamforming_end_fw(PADAPTER adapter) -+{ -+ u8 idx = 0; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&idx); -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+} -+ -+BOOLEAN beamforming_start_period(PADAPTER adapter) -+{ -+ BOOLEAN ret = _TRUE; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); -+ -+ beamforming_dym_ndpa_rate(adapter); -+ -+ beamforming_select_beam_entry(pBeamInfo); -+ -+ if (pSoundInfo->sound_mode == SOUNDING_FW_VHT_TIMER || pSoundInfo->sound_mode == SOUNDING_FW_HT_TIMER) -+ ret = beamforming_start_fw(adapter, pSoundInfo->sound_idx); -+ else -+ ret = _FALSE; -+ -+ RTW_INFO("%s Idx %d Mode %d BW %d Period %d\n", __FUNCTION__, -+ pSoundInfo->sound_idx, pSoundInfo->sound_mode, pSoundInfo->sound_bw, pSoundInfo->sound_period); -+ -+ return ret; -+} -+ -+void beamforming_end_period(PADAPTER adapter) -+{ -+ u8 idx = 0; -+ struct beamforming_entry *pBeamformEntry; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); -+ -+ -+ if (pSoundInfo->sound_mode == SOUNDING_FW_VHT_TIMER || pSoundInfo->sound_mode == SOUNDING_FW_HT_TIMER) -+ beamforming_end_fw(adapter); -+} -+ -+void beamforming_notify(PADAPTER adapter) -+{ -+ BOOLEAN bSounding = _FALSE; -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(&(adapter->mlmepriv)); -+ -+ bSounding = beamfomring_bSounding(pBeamInfo); -+ -+ if (pBeamInfo->beamforming_state == BEAMFORMING_STATE_IDLE) { -+ if (bSounding) { -+ if (beamforming_start_period(adapter) == _TRUE) -+ pBeamInfo->beamforming_state = BEAMFORMING_STATE_START; -+ } -+ } else if (pBeamInfo->beamforming_state == BEAMFORMING_STATE_START) { -+ if (bSounding) { -+ if (beamforming_start_period(adapter) == _FALSE) -+ pBeamInfo->beamforming_state = BEAMFORMING_STATE_END; -+ } else { -+ beamforming_end_period(adapter); -+ pBeamInfo->beamforming_state = BEAMFORMING_STATE_END; -+ } -+ } else if (pBeamInfo->beamforming_state == BEAMFORMING_STATE_END) { -+ if (bSounding) { -+ if (beamforming_start_period(adapter) == _TRUE) -+ pBeamInfo->beamforming_state = BEAMFORMING_STATE_START; -+ } -+ } else -+ RTW_INFO("%s BeamformState %d\n", __FUNCTION__, pBeamInfo->beamforming_state); -+ -+ RTW_INFO("%s BeamformState %d bSounding %d\n", __FUNCTION__, pBeamInfo->beamforming_state, bSounding); -+} -+ -+BOOLEAN beamforming_init_entry(PADAPTER adapter, struct sta_info *psta, u8 *idx) -+{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct ht_priv *phtpriv = &(pmlmepriv->htpriv); -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv *pvhtpriv = &(pmlmepriv->vhtpriv); -+#endif -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct beamforming_entry *pBeamformEntry = NULL; -+ u8 *ra; -+ u16 aid, mac_id; -+ u8 wireless_mode; -+ CHANNEL_WIDTH bw = CHANNEL_WIDTH_20; -+ BEAMFORMING_CAP beamform_cap = BEAMFORMING_CAP_NONE; -+ -+ /* The current setting does not support Beaforming */ -+ if (0 == phtpriv->beamform_cap -+#ifdef CONFIG_80211AC_VHT -+ && 0 == pvhtpriv->beamform_cap -+#endif -+ ) { -+ RTW_INFO("The configuration disabled Beamforming! Skip...\n"); -+ return _FALSE; -+ } -+ -+ aid = psta->aid; -+ ra = psta->hwaddr; -+ mac_id = psta->mac_id; -+ wireless_mode = psta->wireless_mode; -+ bw = psta->bw_mode; -+ -+ if (IsSupportedHT(wireless_mode) || IsSupportedVHT(wireless_mode)) { -+ /* 3 */ /* HT */ -+ u8 cur_beamform; -+ -+ cur_beamform = psta->htpriv.beamform_cap; -+ -+ /* We are Beamformee because the STA is Beamformer */ -+ if (TEST_FLAG(cur_beamform, BEAMFORMING_HT_BEAMFORMER_ENABLE)) -+ beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMEE_CAP_HT_EXPLICIT); -+ -+ /* We are Beamformer because the STA is Beamformee */ -+ if (TEST_FLAG(cur_beamform, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) -+ beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMER_CAP_HT_EXPLICIT); -+#ifdef CONFIG_80211AC_VHT -+ if (IsSupportedVHT(wireless_mode)) { -+ /* 3 */ /* VHT */ -+ cur_beamform = psta->vhtpriv.beamform_cap; -+ -+ /* We are Beamformee because the STA is Beamformer */ -+ if (TEST_FLAG(cur_beamform, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) -+ beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMEE_CAP_VHT_SU); -+ /* We are Beamformer because the STA is Beamformee */ -+ if (TEST_FLAG(cur_beamform, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) -+ beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMER_CAP_VHT_SU); -+ } -+#endif /* CONFIG_80211AC_VHT */ -+ -+ if (beamform_cap == BEAMFORMING_CAP_NONE) -+ return _FALSE; -+ -+ RTW_INFO("Beamforming Config Capability = 0x%02X\n", beamform_cap); -+ -+ pBeamformEntry = beamforming_get_entry_by_addr(pmlmepriv, ra, idx); -+ if (pBeamformEntry == NULL) { -+ pBeamformEntry = beamforming_add_entry(adapter, ra, aid, mac_id, bw, beamform_cap, idx); -+ if (pBeamformEntry == NULL) -+ return _FALSE; -+ else -+ pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; -+ } else { -+ /* Entry has been created. If entry is initialing or progressing then errors occur. */ -+ if (pBeamformEntry->beamforming_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && -+ pBeamformEntry->beamforming_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ RTW_INFO("Error State of Beamforming"); -+ return _FALSE; -+ } else -+ pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; -+ } -+ -+ pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ psta->txbf_paid = pBeamformEntry->p_aid; -+ psta->txbf_gid = pBeamformEntry->g_id; -+ -+ RTW_INFO("%s Idx %d\n", __FUNCTION__, *idx); -+ } else -+ return _FALSE; -+ -+ return _SUCCESS; -+} -+ -+void beamforming_deinit_entry(PADAPTER adapter, u8 *ra) -+{ -+ u8 idx = 0; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ if (beamforming_remove_entry(pmlmepriv, ra, &idx) == _TRUE) -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_LEAVE, (u8 *)&idx); -+ -+ RTW_INFO("%s Idx %d\n", __FUNCTION__, idx); -+} -+ -+void beamforming_reset(PADAPTER adapter) -+{ -+ u8 idx = 0; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ -+ for (idx = 0; idx < BEAMFORMING_ENTRY_NUM; idx++) { -+ if (pBeamInfo->beamforming_entry[idx].bUsed == _TRUE) { -+ pBeamInfo->beamforming_entry[idx].bUsed = _FALSE; -+ pBeamInfo->beamforming_entry[idx].beamforming_entry_cap = BEAMFORMING_CAP_NONE; -+ pBeamInfo->beamforming_entry[idx].beamforming_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_LEAVE, (u8 *)&idx); -+ } -+ } -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+} -+ -+void beamforming_sounding_fail(PADAPTER Adapter) -+{ -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct beamforming_entry *pEntry = &(pBeamInfo->beamforming_entry[pBeamInfo->beamforming_cur_idx]); -+ -+ pEntry->bSound = _FALSE; -+ rtw_hal_set_hwreg(Adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&pBeamInfo->beamforming_cur_idx); -+ beamforming_deinit_entry(Adapter, pEntry->mac_addr); -+} -+ -+void beamforming_check_sounding_success(PADAPTER Adapter, BOOLEAN status) -+{ -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); -+ struct beamforming_entry *pEntry = &(pBeamInfo->beamforming_entry[pBeamInfo->beamforming_cur_idx]); -+ -+ if (status == 1) -+ pEntry->LogStatusFailCnt = 0; -+ else { -+ pEntry->LogStatusFailCnt++; -+ RTW_INFO("%s LogStatusFailCnt %d\n", __FUNCTION__, pEntry->LogStatusFailCnt); -+ } -+ if (pEntry->LogStatusFailCnt > 20) { -+ RTW_INFO("%s LogStatusFailCnt > 20, Stop SOUNDING\n", __FUNCTION__); -+ /* pEntry->bSound = _FALSE; */ -+ /* rtw_hal_set_hwreg(Adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&pBeamInfo->beamforming_cur_idx); */ -+ /* beamforming_deinit_entry(Adapter, pEntry->mac_addr); */ -+ beamforming_wk_cmd(Adapter, BEAMFORMING_CTRL_SOUNDING_FAIL, NULL, 0, 1); -+ } -+} -+ -+void beamforming_enter(PADAPTER adapter, PVOID psta) -+{ -+ u8 idx = 0xff; -+ -+ if (beamforming_init_entry(adapter, (struct sta_info *)psta, &idx)) -+ rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_ENTER, (u8 *)&idx); -+ -+ /* RTW_INFO("%s Idx %d\n", __FUNCTION__, idx); */ -+} -+ -+void beamforming_leave(PADAPTER adapter, u8 *ra) -+{ -+ if (ra == NULL) -+ beamforming_reset(adapter); -+ else -+ beamforming_deinit_entry(adapter, ra); -+ -+ beamforming_notify(adapter); -+} -+ -+BEAMFORMING_CAP beamforming_get_beamform_cap(struct beamforming_info *pBeamInfo) -+{ -+ u8 i; -+ BOOLEAN bSelfBeamformer = _FALSE; -+ BOOLEAN bSelfBeamformee = _FALSE; -+ struct beamforming_entry beamforming_entry; -+ BEAMFORMING_CAP beamform_cap = BEAMFORMING_CAP_NONE; -+ -+ for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { -+ beamforming_entry = pBeamInfo->beamforming_entry[i]; -+ -+ if (beamforming_entry.bUsed) { -+ if ((beamforming_entry.beamforming_entry_cap & BEAMFORMEE_CAP_VHT_SU) || -+ (beamforming_entry.beamforming_entry_cap & BEAMFORMEE_CAP_HT_EXPLICIT)) -+ bSelfBeamformee = _TRUE; -+ if ((beamforming_entry.beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) || -+ (beamforming_entry.beamforming_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT)) -+ bSelfBeamformer = _TRUE; -+ } -+ -+ if (bSelfBeamformer && bSelfBeamformee) -+ i = BEAMFORMING_ENTRY_NUM; -+ } -+ -+ if (bSelfBeamformer) -+ beamform_cap |= BEAMFORMER_CAP; -+ if (bSelfBeamformee) -+ beamform_cap |= BEAMFORMEE_CAP; -+ -+ return beamform_cap; -+} -+ -+void beamforming_watchdog(PADAPTER Adapter) -+{ -+ struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO((&(Adapter->mlmepriv))); -+ -+ if (pBeamInfo->beamforming_state != BEAMFORMING_STATE_START) -+ return; -+ -+ beamforming_dym_period(Adapter); -+ beamforming_dym_ndpa_rate(Adapter); -+} -+#endif /* !RTW_BEAMFORMING_VERSION_2 */ -+#endif/* #if (BEAMFORMING_SUPPORT ==0) - for diver defined beamforming*/ -+ -+u32 beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_frame) -+{ -+ u32 ret = _SUCCESS; -+#if (BEAMFORMING_SUPPORT == 1) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ ret = Beamforming_GetReportFrame(pDM_Odm, precv_frame); -+ -+#else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ -+#ifdef RTW_BEAMFORMING_VERSION_2 -+ struct beamformee_entry *pBeamformEntry = NULL; -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u32 frame_len = precv_frame->u.hdr.len; -+ u8 *ta; -+ u8 *frame_body; -+ u8 category, action; -+ u8 *pMIMOCtrlField, *pCSIMatrix; -+ u8 Nc = 0, Nr = 0, CH_W = 0; -+ u16 CSIMatrixLen = 0; -+ -+ -+ RTW_DBG("+%s\n", __FUNCTION__); -+ -+ /* Memory comparison to see if CSI report is the same with previous one */ -+ ta = GetAddr2Ptr(pframe); -+ pBeamformEntry = beamforming_get_bfee_entry_by_addr(Adapter, ta); -+ if (!pBeamformEntry) -+ return _FAIL; -+ -+ frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ category = frame_body[0]; -+ action = frame_body[1]; -+ -+ if ((category == RTW_WLAN_CATEGORY_VHT) -+ && (action == RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING)) { -+ pMIMOCtrlField = pframe + 26; -+ Nc = ((*pMIMOCtrlField) & 0x7) + 1; -+ Nr = (((*pMIMOCtrlField) & 0x38) >> 3) + 1; -+ CH_W = (((*pMIMOCtrlField) & 0xC0) >> 6); -+ /* -+ * 24+(1+1+3)+2 -+ * ==> MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2) -+ */ -+ pCSIMatrix = pMIMOCtrlField + 3 + Nc; -+ CSIMatrixLen = frame_len - 26 - 3 - Nc; -+ } else if ((category == RTW_WLAN_CATEGORY_HT) -+ && (action == RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING)) { -+ pMIMOCtrlField = pframe + 26; -+ Nc = ((*pMIMOCtrlField) & 0x3) + 1; -+ Nr = (((*pMIMOCtrlField) & 0xC) >> 2) + 1; -+ CH_W = ((*pMIMOCtrlField) & 0x10) >> 4; -+ /* -+ * 24+(1+1+6)+2 -+ * ==> MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2) -+ */ -+ pCSIMatrix = pMIMOCtrlField + 6 + Nr; -+ CSIMatrixLen = frame_len - 26 - 6 - Nr; -+ } -+ -+ RTW_INFO("%s: pkt type=%d-%d, Nc=%d, Nr=%d, CH_W=%d\n", -+ __FUNCTION__, category, action, Nc, Nr, CH_W); -+#else /* !RTW_BEAMFORMING_VERSION_2 */ -+ struct beamforming_entry *pBeamformEntry = NULL; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u32 frame_len = precv_frame->u.hdr.len; -+ u8 *ta; -+ u8 idx, offset; -+ -+ /*RTW_INFO("beamforming_get_report_frame\n");*/ -+ -+ /*Memory comparison to see if CSI report is the same with previous one*/ -+ ta = GetAddr2Ptr(pframe); -+ pBeamformEntry = beamforming_get_entry_by_addr(pmlmepriv, ta, &idx); -+ if (pBeamformEntry->beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) -+ offset = 31; /*24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ -+ else if (pBeamformEntry->beamforming_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) -+ offset = 34; /*24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ -+ else -+ return ret; -+ -+ /*RTW_INFO("%s MacId %d offset=%d\n", __FUNCTION__, pBeamformEntry->mac_id, offset);*/ -+ -+ if (_rtw_memcmp(pBeamformEntry->PreCsiReport + offset, pframe + offset, frame_len - offset) == _FALSE) -+ pBeamformEntry->DefaultCsiCnt = 0; -+ else -+ pBeamformEntry->DefaultCsiCnt++; -+ -+ _rtw_memcpy(&pBeamformEntry->PreCsiReport, pframe, frame_len); -+ -+ pBeamformEntry->bDefaultCSI = _FALSE; -+ -+ if (pBeamformEntry->DefaultCsiCnt > 20) -+ pBeamformEntry->bDefaultCSI = _TRUE; -+ else -+ pBeamformEntry->bDefaultCSI = _FALSE; -+#endif /* !RTW_BEAMFORMING_VERSION_2 */ -+#endif -+ return ret; -+} -+ -+void beamforming_get_ndpa_frame(PADAPTER Adapter, union recv_frame *precv_frame) -+{ -+#if (BEAMFORMING_SUPPORT == 1) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ Beamforming_GetNDPAFrame(pDM_Odm, precv_frame); -+ -+#else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ -+#ifdef RTW_BEAMFORMING_VERSION_2 -+ RTW_DBG("+%s\n", __FUNCTION__); -+#else /* !RTW_BEAMFORMING_VERSION_2 */ -+ u8 *ta; -+ u8 idx, Sequence; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct beamforming_entry *pBeamformEntry = NULL; -+ -+ /*RTW_INFO("beamforming_get_ndpa_frame\n");*/ -+ -+ if (IS_HARDWARE_TYPE_8812(Adapter) == _FALSE) -+ return; -+ else if (GetFrameSubType(pframe) != WIFI_NDPA) -+ return; -+ -+ ta = GetAddr2Ptr(pframe); -+ /*Remove signaling TA. */ -+ ta[0] = ta[0] & 0xFE; -+ -+ pBeamformEntry = beamforming_get_entry_by_addr(pmlmepriv, ta, &idx); -+ -+ if (pBeamformEntry == NULL) -+ return; -+ else if (!(pBeamformEntry->beamforming_entry_cap & BEAMFORMEE_CAP_VHT_SU)) -+ return; -+ /*LogSuccess: As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is NO LONGER needed !2015-04-10, Jeffery*/ -+ /*ClockResetTimes: While BFer entry always doesn't receive our CSI, clock will reset again and again.So ClockResetTimes is limited to 5 times.2015-04-13, Jeffery*/ -+ else if ((pBeamformEntry->LogSuccess == 1) || (pBeamformEntry->ClockResetTimes == 5)) { -+ RTW_INFO("[%s] LogSeq=%d, PreLogSeq=%d\n", __func__, pBeamformEntry->LogSeq, pBeamformEntry->PreLogSeq); -+ return; -+ } -+ -+ Sequence = (pframe[16]) >> 2; -+ RTW_INFO("[%s] Start, Sequence=%d, LogSeq=%d, PreLogSeq=%d, LogRetryCnt=%d, ClockResetTimes=%d, LogSuccess=%d\n", -+ __func__, Sequence, pBeamformEntry->LogSeq, pBeamformEntry->PreLogSeq, pBeamformEntry->LogRetryCnt, pBeamformEntry->ClockResetTimes, pBeamformEntry->LogSuccess); -+ -+ if ((pBeamformEntry->LogSeq != 0) && (pBeamformEntry->PreLogSeq != 0)) { -+ /*Success condition*/ -+ if ((pBeamformEntry->LogSeq != Sequence) && (pBeamformEntry->PreLogSeq != pBeamformEntry->LogSeq)) { -+ /* break option for clcok reset, 2015-03-30, Jeffery */ -+ pBeamformEntry->LogRetryCnt = 0; -+ /*As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is no longer needed.*/ -+ /*That is, LogSuccess is NOT needed to be reset to zero, 2015-04-13, Jeffery*/ -+ pBeamformEntry->LogSuccess = 1; -+ -+ } else {/*Fail condition*/ -+ -+ if (pBeamformEntry->LogRetryCnt == 5) { -+ pBeamformEntry->ClockResetTimes++; -+ pBeamformEntry->LogRetryCnt = 0; -+ -+ RTW_INFO("[%s] Clock Reset!!! ClockResetTimes=%d\n", __func__, pBeamformEntry->ClockResetTimes); -+ beamforming_wk_cmd(Adapter, BEAMFORMING_CTRL_SOUNDING_CLK, NULL, 0, 1); -+ -+ } else -+ pBeamformEntry->LogRetryCnt++; -+ } -+ } -+ -+ /*Update LogSeq & PreLogSeq*/ -+ pBeamformEntry->PreLogSeq = pBeamformEntry->LogSeq; -+ pBeamformEntry->LogSeq = Sequence; -+#endif /* !RTW_BEAMFORMING_VERSION_2 */ -+#endif -+ -+} -+ -+/* octets in data header, no WEP */ -+#define sMacHdrLng 24 -+/* VHT Group ID (GID) Management Frame */ -+#define FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY (sMacHdrLng + 2) -+#define FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY (sMacHdrLng + 10) -+/* VHT GID Management Frame Info */ -+#define GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(_pStart) LE_BITS_TO_1BYTE((_pStart), 0, 8) -+#define GET_VHT_GID_MGNT_INFO_USER_POSITION(_pStart) LE_BITS_TO_1BYTE((_pStart), 0, 8) -+/* -+ * Description: -+ * On VHT GID management frame by an MU beamformee. -+ * -+ * 2015.05.20. Created by tynli. -+ */ -+u32 beamforming_get_vht_gid_mgnt_frame(PADAPTER adapter, union recv_frame *precv_frame) -+{ -+#ifdef RTW_BEAMFORMING_VERSION_2 -+ u8 *ta; -+ u8 idx; -+ u8 *pframe; -+ u8 *pBuffer = NULL; -+ struct beamformer_entry *bfer = NULL; -+ -+ -+ RTW_DBG("+%s\n", __FUNCTION__); -+ -+ pframe = precv_frame->u.hdr.rx_data; -+ /* Get BFer entry by Addr2 */ -+ ta = GetAddr2Ptr(pframe); -+ /* Remove signaling TA */ -+ ta[0] &= 0xFE; -+ -+ bfer = beamforming_get_bfer_entry_by_addr(adapter, ta); -+ if (!bfer) { -+ RTW_INFO("%s: Cannot find BFer entry!!\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+ /* Parsing Membership Status Array */ -+ pBuffer = pframe + FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY; -+ for (idx = 0; idx < 8; idx++) -+ bfer->gid_valid[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(pBuffer+idx); -+ -+ /* Parsing User Position Array */ -+ pBuffer = pframe + FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY; -+ for (idx = 0; idx < 16; idx++) -+ bfer->user_position[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(pBuffer+idx); -+ -+ /* Config HW GID table */ -+ beamforming_wk_cmd(adapter, BEAMFORMING_CTRL_SET_GID_TABLE, (u8*)&bfer, sizeof(struct beamformer_entry *), 1); -+ -+ return _SUCCESS; -+#else /* !RTW_BEAMFORMING_VERSION_2 */ -+ return _FAIL; -+#endif /* !RTW_BEAMFORMING_VERSION_2 */ -+} -+ -+void beamforming_wk_hdl(_adapter *padapter, u8 type, u8 *pbuf) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+#if (BEAMFORMING_SUPPORT == 1) /*(BEAMFORMING_SUPPORT == 1)- for PHYDM beamfoming*/ -+ switch (type) { -+ case BEAMFORMING_CTRL_ENTER: { -+ struct sta_info *psta = (PVOID)pbuf; -+ u16 staIdx = psta->mac_id; -+ -+ Beamforming_Enter(pDM_Odm, staIdx); -+ break; -+ } -+ case BEAMFORMING_CTRL_LEAVE: -+ Beamforming_Leave(pDM_Odm, pbuf); -+ break; -+ default: -+ break; -+ -+ } -+#else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ -+ switch (type) { -+ case BEAMFORMING_CTRL_ENTER: -+ beamforming_enter(padapter, (PVOID)pbuf); -+ break; -+ -+ case BEAMFORMING_CTRL_LEAVE: -+ beamforming_leave(padapter, pbuf); -+ break; -+ -+ case BEAMFORMING_CTRL_SOUNDING_FAIL: -+ beamforming_sounding_fail(padapter); -+ break; -+ -+ case BEAMFORMING_CTRL_SOUNDING_CLK: -+ rtw_hal_set_hwreg(padapter, HW_VAR_SOUNDING_CLK, NULL); -+ break; -+ -+ case BEAMFORMING_CTRL_SET_GID_TABLE: -+ rtw_hal_set_hwreg(padapter, HW_VAR_SOUNDING_SET_GID_TABLE, *(void**)pbuf); -+ break; -+ -+ default: -+ break; -+ } -+#endif -+} -+ -+u8 beamforming_wk_cmd(_adapter *padapter, s32 type, u8 *pbuf, s32 size, u8 enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ if (enqueue) { -+ u8 *wk_buf; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ if (pbuf != NULL) { -+ wk_buf = rtw_zmalloc(size); -+ if (wk_buf == NULL) { -+ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memcpy(wk_buf, pbuf, size); -+ } else { -+ wk_buf = NULL; -+ size = 0; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = BEAMFORMING_WK_CID; -+ pdrvextra_cmd_parm->type = type; -+ pdrvextra_cmd_parm->size = size; -+ pdrvextra_cmd_parm->pbuf = wk_buf; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } else -+ beamforming_wk_hdl(padapter, type, pbuf); -+ -+exit: -+ -+ -+ return res; -+} -+ -+void update_attrib_txbf_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) -+{ -+ if (psta) { -+ pattrib->txbf_g_id = psta->txbf_gid; -+ pattrib->txbf_p_aid = psta->txbf_paid; -+ } -+} -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_br_ext.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_br_ext.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_br_ext.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_br_ext.c 2018-02-11 21:44:27.135145903 +0200 -@@ -0,0 +1,1585 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_BR_EXT_C_ -+ -+#ifdef __KERNEL__ -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+#endif -+ -+#if 1 /* rtw_wifi_driver */ -+ #include -+#else /* rtw_wifi_driver */ -+ #include "./8192cd_cfg.h" -+ -+ #ifndef __KERNEL__ -+ #include "./sys-support.h" -+ #endif -+ -+ #include "./8192cd.h" -+ #include "./8192cd_headers.h" -+ #include "./8192cd_br_ext.h" -+ #include "./8192cd_debug.h" -+#endif /* rtw_wifi_driver */ -+ -+#ifdef CL_IPV6_PASS -+ #ifdef __KERNEL__ -+ #include -+ #include -+ #include -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+ #include -+ #else -+ #include -+ #endif -+ #endif -+#endif -+ -+#ifdef CONFIG_BR_EXT -+ -+/* #define BR_EXT_DEBUG */ -+ -+#define NAT25_IPV4 01 -+#define NAT25_IPV6 02 -+#define NAT25_IPX 03 -+#define NAT25_APPLE 04 -+#define NAT25_PPPOE 05 -+ -+#define RTL_RELAY_TAG_LEN (ETH_ALEN) -+#define TAG_HDR_LEN 4 -+ -+#define MAGIC_CODE 0x8186 -+#define MAGIC_CODE_LEN 2 -+#define WAIT_TIME_PPPOE 5 /* waiting time for pppoe server in sec */ -+ -+/*----------------------------------------------------------------- -+ How database records network address: -+ 0 1 2 3 4 5 6 7 8 9 10 -+ |----|----|----|----|----|----|----|----|----|----|----| -+ IPv4 |type| | IP addr | -+ IPX |type| Net addr | Node addr | -+ IPX |type| Net addr |Sckt addr| -+ Apple |type| Network |node| -+ PPPoE |type| SID | AC MAC | -+-----------------------------------------------------------------*/ -+ -+ -+/* Find a tag in pppoe frame and return the pointer */ -+static __inline__ unsigned char *__nat25_find_pppoe_tag(struct pppoe_hdr *ph, unsigned short type) -+{ -+ unsigned char *cur_ptr, *start_ptr; -+ unsigned short tagLen, tagType; -+ -+ start_ptr = cur_ptr = (unsigned char *)ph->tag; -+ while ((cur_ptr - start_ptr) < ntohs(ph->length)) { -+ /* prevent un-alignment access */ -+ tagType = (unsigned short)((cur_ptr[0] << 8) + cur_ptr[1]); -+ tagLen = (unsigned short)((cur_ptr[2] << 8) + cur_ptr[3]); -+ if (tagType == type) -+ return cur_ptr; -+ cur_ptr = cur_ptr + TAG_HDR_LEN + tagLen; -+ } -+ return 0; -+} -+ -+ -+static __inline__ int __nat25_add_pppoe_tag(struct sk_buff *skb, struct pppoe_tag *tag) -+{ -+ struct pppoe_hdr *ph = (struct pppoe_hdr *)(skb->data + ETH_HLEN); -+ int data_len; -+ -+ data_len = tag->tag_len + TAG_HDR_LEN; -+ if (skb_tailroom(skb) < data_len) { -+ _DEBUG_ERR("skb_tailroom() failed in add SID tag!\n"); -+ return -1; -+ } -+ -+ skb_put(skb, data_len); -+ /* have a room for new tag */ -+ memmove(((unsigned char *)ph->tag + data_len), (unsigned char *)ph->tag, ntohs(ph->length)); -+ ph->length = htons(ntohs(ph->length) + data_len); -+ memcpy((unsigned char *)ph->tag, tag, data_len); -+ return data_len; -+} -+ -+static int skb_pull_and_merge(struct sk_buff *skb, unsigned char *src, int len) -+{ -+ int tail_len; -+ unsigned long end, tail; -+ -+ if ((src + len) > skb_tail_pointer(skb) || skb->len < len) -+ return -1; -+ -+ tail = (unsigned long)skb_tail_pointer(skb); -+ end = (unsigned long)src + len; -+ if (tail < end) -+ return -1; -+ -+ tail_len = (int)(tail - end); -+ if (tail_len > 0) -+ memmove(src, src + len, tail_len); -+ -+ skb_trim(skb, skb->len - len); -+ return 0; -+} -+ -+static __inline__ unsigned long __nat25_timeout(_adapter *priv) -+{ -+ unsigned long timeout; -+ -+ timeout = jiffies - NAT25_AGEING_TIME * HZ; -+ -+ return timeout; -+} -+ -+ -+static __inline__ int __nat25_has_expired(_adapter *priv, -+ struct nat25_network_db_entry *fdb) -+{ -+ if (time_before_eq(fdb->ageing_timer, __nat25_timeout(priv))) -+ return 1; -+ -+ return 0; -+} -+ -+ -+static __inline__ void __nat25_generate_ipv4_network_addr(unsigned char *networkAddr, -+ unsigned int *ipAddr) -+{ -+ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); -+ -+ networkAddr[0] = NAT25_IPV4; -+ memcpy(networkAddr + 7, (unsigned char *)ipAddr, 4); -+} -+ -+ -+static __inline__ void __nat25_generate_ipx_network_addr_with_node(unsigned char *networkAddr, -+ unsigned int *ipxNetAddr, unsigned char *ipxNodeAddr) -+{ -+ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); -+ -+ networkAddr[0] = NAT25_IPX; -+ memcpy(networkAddr + 1, (unsigned char *)ipxNetAddr, 4); -+ memcpy(networkAddr + 5, ipxNodeAddr, 6); -+} -+ -+ -+static __inline__ void __nat25_generate_ipx_network_addr_with_socket(unsigned char *networkAddr, -+ unsigned int *ipxNetAddr, unsigned short *ipxSocketAddr) -+{ -+ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); -+ -+ networkAddr[0] = NAT25_IPX; -+ memcpy(networkAddr + 1, (unsigned char *)ipxNetAddr, 4); -+ memcpy(networkAddr + 5, (unsigned char *)ipxSocketAddr, 2); -+} -+ -+ -+static __inline__ void __nat25_generate_apple_network_addr(unsigned char *networkAddr, -+ unsigned short *network, unsigned char *node) -+{ -+ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); -+ -+ networkAddr[0] = NAT25_APPLE; -+ memcpy(networkAddr + 1, (unsigned char *)network, 2); -+ networkAddr[3] = *node; -+} -+ -+ -+static __inline__ void __nat25_generate_pppoe_network_addr(unsigned char *networkAddr, -+ unsigned char *ac_mac, unsigned short *sid) -+{ -+ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); -+ -+ networkAddr[0] = NAT25_PPPOE; -+ memcpy(networkAddr + 1, (unsigned char *)sid, 2); -+ memcpy(networkAddr + 3, (unsigned char *)ac_mac, 6); -+} -+ -+ -+#ifdef CL_IPV6_PASS -+static void __nat25_generate_ipv6_network_addr(unsigned char *networkAddr, -+ unsigned int *ipAddr) -+{ -+ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); -+ -+ networkAddr[0] = NAT25_IPV6; -+ memcpy(networkAddr + 1, (unsigned char *)ipAddr, 16); -+} -+ -+ -+static unsigned char *scan_tlv(unsigned char *data, int len, unsigned char tag, unsigned char len8b) -+{ -+ while (len > 0) { -+ if (*data == tag && *(data + 1) == len8b && len >= len8b * 8) -+ return data + 2; -+ -+ len -= (*(data + 1)) * 8; -+ data += (*(data + 1)) * 8; -+ } -+ return NULL; -+} -+ -+ -+static int update_nd_link_layer_addr(unsigned char *data, int len, unsigned char *replace_mac) -+{ -+ struct icmp6hdr *icmphdr = (struct icmp6hdr *)data; -+ unsigned char *mac; -+ -+ if (icmphdr->icmp6_type == NDISC_ROUTER_SOLICITATION) { -+ if (len >= 8) { -+ mac = scan_tlv(&data[8], len - 8, 1, 1); -+ if (mac) { -+ RTW_INFO("Router Solicitation, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0], mac[1], mac[2], mac[3], mac[4], mac[5], -+ replace_mac[0], replace_mac[1], replace_mac[2], replace_mac[3], replace_mac[4], replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; -+ } -+ } -+ } else if (icmphdr->icmp6_type == NDISC_ROUTER_ADVERTISEMENT) { -+ if (len >= 16) { -+ mac = scan_tlv(&data[16], len - 16, 1, 1); -+ if (mac) { -+ RTW_INFO("Router Advertisement, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0], mac[1], mac[2], mac[3], mac[4], mac[5], -+ replace_mac[0], replace_mac[1], replace_mac[2], replace_mac[3], replace_mac[4], replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; -+ } -+ } -+ } else if (icmphdr->icmp6_type == NDISC_NEIGHBOUR_SOLICITATION) { -+ if (len >= 24) { -+ mac = scan_tlv(&data[24], len - 24, 1, 1); -+ if (mac) { -+ RTW_INFO("Neighbor Solicitation, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0], mac[1], mac[2], mac[3], mac[4], mac[5], -+ replace_mac[0], replace_mac[1], replace_mac[2], replace_mac[3], replace_mac[4], replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; -+ } -+ } -+ } else if (icmphdr->icmp6_type == NDISC_NEIGHBOUR_ADVERTISEMENT) { -+ if (len >= 24) { -+ mac = scan_tlv(&data[24], len - 24, 2, 1); -+ if (mac) { -+ RTW_INFO("Neighbor Advertisement, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0], mac[1], mac[2], mac[3], mac[4], mac[5], -+ replace_mac[0], replace_mac[1], replace_mac[2], replace_mac[3], replace_mac[4], replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; -+ } -+ } -+ } else if (icmphdr->icmp6_type == NDISC_REDIRECT) { -+ if (len >= 40) { -+ mac = scan_tlv(&data[40], len - 40, 2, 1); -+ if (mac) { -+ RTW_INFO("Redirect, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0], mac[1], mac[2], mac[3], mac[4], mac[5], -+ replace_mac[0], replace_mac[1], replace_mac[2], replace_mac[3], replace_mac[4], replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; -+ } -+ } -+ } -+ return 0; -+} -+ -+ -+static void convert_ipv6_mac_to_mc(struct sk_buff *skb) -+{ -+ struct ipv6hdr *iph = (struct ipv6hdr *)(skb->data + ETH_HLEN); -+ unsigned char *dst_mac = skb->data; -+ -+ /* dst_mac[0] = 0xff; */ -+ /* dst_mac[1] = 0xff; */ -+ /*modified by qinjunjie,ipv6 multicast address ix 0x33-33-xx-xx-xx-xx*/ -+ dst_mac[0] = 0x33; -+ dst_mac[1] = 0x33; -+ memcpy(&dst_mac[2], &iph->daddr.s6_addr32[3], 4); -+#if defined(__LINUX_2_6__) -+ /*modified by qinjunjie,warning:should not remove next line*/ -+ skb->pkt_type = PACKET_MULTICAST; -+#endif -+} -+#endif /* CL_IPV6_PASS */ -+ -+ -+static __inline__ int __nat25_network_hash(unsigned char *networkAddr) -+{ -+ if (networkAddr[0] == NAT25_IPV4) { -+ unsigned long x; -+ -+ x = networkAddr[7] ^ networkAddr[8] ^ networkAddr[9] ^ networkAddr[10]; -+ -+ return x & (NAT25_HASH_SIZE - 1); -+ } else if (networkAddr[0] == NAT25_IPX) { -+ unsigned long x; -+ -+ x = networkAddr[1] ^ networkAddr[2] ^ networkAddr[3] ^ networkAddr[4] ^ networkAddr[5] ^ -+ networkAddr[6] ^ networkAddr[7] ^ networkAddr[8] ^ networkAddr[9] ^ networkAddr[10]; -+ -+ return x & (NAT25_HASH_SIZE - 1); -+ } else if (networkAddr[0] == NAT25_APPLE) { -+ unsigned long x; -+ -+ x = networkAddr[1] ^ networkAddr[2] ^ networkAddr[3]; -+ -+ return x & (NAT25_HASH_SIZE - 1); -+ } else if (networkAddr[0] == NAT25_PPPOE) { -+ unsigned long x; -+ -+ x = networkAddr[0] ^ networkAddr[1] ^ networkAddr[2] ^ networkAddr[3] ^ networkAddr[4] ^ networkAddr[5] ^ networkAddr[6] ^ networkAddr[7] ^ networkAddr[8]; -+ -+ return x & (NAT25_HASH_SIZE - 1); -+ } -+#ifdef CL_IPV6_PASS -+ else if (networkAddr[0] == NAT25_IPV6) { -+ unsigned long x; -+ -+ x = networkAddr[1] ^ networkAddr[2] ^ networkAddr[3] ^ networkAddr[4] ^ networkAddr[5] ^ -+ networkAddr[6] ^ networkAddr[7] ^ networkAddr[8] ^ networkAddr[9] ^ networkAddr[10] ^ -+ networkAddr[11] ^ networkAddr[12] ^ networkAddr[13] ^ networkAddr[14] ^ networkAddr[15] ^ -+ networkAddr[16]; -+ -+ return x & (NAT25_HASH_SIZE - 1); -+ } -+#endif -+ else { -+ unsigned long x = 0; -+ int i; -+ -+ for (i = 0; i < MAX_NETWORK_ADDR_LEN; i++) -+ x ^= networkAddr[i]; -+ -+ return x & (NAT25_HASH_SIZE - 1); -+ } -+} -+ -+ -+static __inline__ void __network_hash_link(_adapter *priv, -+ struct nat25_network_db_entry *ent, int hash) -+{ -+ /* Caller must _enter_critical_bh already! */ -+ /* _irqL irqL; */ -+ /* _enter_critical_bh(&priv->br_ext_lock, &irqL); */ -+ -+ ent->next_hash = priv->nethash[hash]; -+ if (ent->next_hash != NULL) -+ ent->next_hash->pprev_hash = &ent->next_hash; -+ priv->nethash[hash] = ent; -+ ent->pprev_hash = &priv->nethash[hash]; -+ -+ /* _exit_critical_bh(&priv->br_ext_lock, &irqL); */ -+} -+ -+ -+static __inline__ void __network_hash_unlink(struct nat25_network_db_entry *ent) -+{ -+ /* Caller must _enter_critical_bh already! */ -+ /* _irqL irqL; */ -+ /* _enter_critical_bh(&priv->br_ext_lock, &irqL); */ -+ -+ *(ent->pprev_hash) = ent->next_hash; -+ if (ent->next_hash != NULL) -+ ent->next_hash->pprev_hash = ent->pprev_hash; -+ ent->next_hash = NULL; -+ ent->pprev_hash = NULL; -+ -+ /* _exit_critical_bh(&priv->br_ext_lock, &irqL); */ -+} -+ -+ -+static int __nat25_db_network_lookup_and_replace(_adapter *priv, -+ struct sk_buff *skb, unsigned char *networkAddr) -+{ -+ struct nat25_network_db_entry *db; -+ _irqL irqL; -+ _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ -+ db = priv->nethash[__nat25_network_hash(networkAddr)]; -+ while (db != NULL) { -+ if (!memcmp(db->networkAddr, networkAddr, MAX_NETWORK_ADDR_LEN)) { -+ if (!__nat25_has_expired(priv, db)) { -+ /* replace the destination mac address */ -+ memcpy(skb->data, db->macAddr, ETH_ALEN); -+ atomic_inc(&db->use_count); -+ -+#ifdef CL_IPV6_PASS -+ RTW_INFO("NAT25: Lookup M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" -+ "%02x%02x%02x%02x%02x%02x\n", -+ db->macAddr[0], -+ db->macAddr[1], -+ db->macAddr[2], -+ db->macAddr[3], -+ db->macAddr[4], -+ db->macAddr[5], -+ db->networkAddr[0], -+ db->networkAddr[1], -+ db->networkAddr[2], -+ db->networkAddr[3], -+ db->networkAddr[4], -+ db->networkAddr[5], -+ db->networkAddr[6], -+ db->networkAddr[7], -+ db->networkAddr[8], -+ db->networkAddr[9], -+ db->networkAddr[10], -+ db->networkAddr[11], -+ db->networkAddr[12], -+ db->networkAddr[13], -+ db->networkAddr[14], -+ db->networkAddr[15], -+ db->networkAddr[16]); -+#else -+ RTW_INFO("NAT25: Lookup M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", -+ db->macAddr[0], -+ db->macAddr[1], -+ db->macAddr[2], -+ db->macAddr[3], -+ db->macAddr[4], -+ db->macAddr[5], -+ db->networkAddr[0], -+ db->networkAddr[1], -+ db->networkAddr[2], -+ db->networkAddr[3], -+ db->networkAddr[4], -+ db->networkAddr[5], -+ db->networkAddr[6], -+ db->networkAddr[7], -+ db->networkAddr[8], -+ db->networkAddr[9], -+ db->networkAddr[10]); -+#endif -+ } -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ return 1; -+ } -+ -+ db = db->next_hash; -+ } -+ -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ return 0; -+} -+ -+ -+static void __nat25_db_network_insert(_adapter *priv, -+ unsigned char *macAddr, unsigned char *networkAddr) -+{ -+ struct nat25_network_db_entry *db; -+ int hash; -+ _irqL irqL; -+ _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ -+ hash = __nat25_network_hash(networkAddr); -+ db = priv->nethash[hash]; -+ while (db != NULL) { -+ if (!memcmp(db->networkAddr, networkAddr, MAX_NETWORK_ADDR_LEN)) { -+ memcpy(db->macAddr, macAddr, ETH_ALEN); -+ db->ageing_timer = jiffies; -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ return; -+ } -+ -+ db = db->next_hash; -+ } -+ -+ db = (struct nat25_network_db_entry *) rtw_malloc(sizeof(*db)); -+ if (db == NULL) { -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ return; -+ } -+ -+ memcpy(db->networkAddr, networkAddr, MAX_NETWORK_ADDR_LEN); -+ memcpy(db->macAddr, macAddr, ETH_ALEN); -+ atomic_set(&db->use_count, 1); -+ db->ageing_timer = jiffies; -+ -+ __network_hash_link(priv, db, hash); -+ -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+} -+ -+ -+static void __nat25_db_print(_adapter *priv) -+{ -+ _irqL irqL; -+ _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ -+#ifdef BR_EXT_DEBUG -+ static int counter = 0; -+ int i, j; -+ struct nat25_network_db_entry *db; -+ -+ counter++; -+ if ((counter % 16) != 0) -+ return; -+ -+ for (i = 0, j = 0; i < NAT25_HASH_SIZE; i++) { -+ db = priv->nethash[i]; -+ -+ while (db != NULL) { -+#ifdef CL_IPV6_PASS -+ panic_printk("NAT25: DB(%d) H(%02d) C(%d) M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" -+ "%02x%02x%02x%02x%02x%02x\n", -+ j, -+ i, -+ atomic_read(&db->use_count), -+ db->macAddr[0], -+ db->macAddr[1], -+ db->macAddr[2], -+ db->macAddr[3], -+ db->macAddr[4], -+ db->macAddr[5], -+ db->networkAddr[0], -+ db->networkAddr[1], -+ db->networkAddr[2], -+ db->networkAddr[3], -+ db->networkAddr[4], -+ db->networkAddr[5], -+ db->networkAddr[6], -+ db->networkAddr[7], -+ db->networkAddr[8], -+ db->networkAddr[9], -+ db->networkAddr[10], -+ db->networkAddr[11], -+ db->networkAddr[12], -+ db->networkAddr[13], -+ db->networkAddr[14], -+ db->networkAddr[15], -+ db->networkAddr[16]); -+#else -+ panic_printk("NAT25: DB(%d) H(%02d) C(%d) M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", -+ j, -+ i, -+ atomic_read(&db->use_count), -+ db->macAddr[0], -+ db->macAddr[1], -+ db->macAddr[2], -+ db->macAddr[3], -+ db->macAddr[4], -+ db->macAddr[5], -+ db->networkAddr[0], -+ db->networkAddr[1], -+ db->networkAddr[2], -+ db->networkAddr[3], -+ db->networkAddr[4], -+ db->networkAddr[5], -+ db->networkAddr[6], -+ db->networkAddr[7], -+ db->networkAddr[8], -+ db->networkAddr[9], -+ db->networkAddr[10]); -+#endif -+ j++; -+ -+ db = db->next_hash; -+ } -+ } -+#endif -+ -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+} -+ -+ -+ -+ -+/* -+ * NAT2.5 interface -+ */ -+ -+void nat25_db_cleanup(_adapter *priv) -+{ -+ int i; -+ _irqL irqL; -+ _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ -+ for (i = 0; i < NAT25_HASH_SIZE; i++) { -+ struct nat25_network_db_entry *f; -+ f = priv->nethash[i]; -+ while (f != NULL) { -+ struct nat25_network_db_entry *g; -+ -+ g = f->next_hash; -+ if (priv->scdb_entry == f) { -+ memset(priv->scdb_mac, 0, ETH_ALEN); -+ memset(priv->scdb_ip, 0, 4); -+ priv->scdb_entry = NULL; -+ } -+ __network_hash_unlink(f); -+ rtw_mfree((u8 *) f, sizeof(struct nat25_network_db_entry)); -+ -+ f = g; -+ } -+ } -+ -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+} -+ -+ -+void nat25_db_expire(_adapter *priv) -+{ -+ int i; -+ _irqL irqL; -+ _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ -+ /* if(!priv->ethBrExtInfo.nat25_disable) */ -+ { -+ for (i = 0; i < NAT25_HASH_SIZE; i++) { -+ struct nat25_network_db_entry *f; -+ f = priv->nethash[i]; -+ -+ while (f != NULL) { -+ struct nat25_network_db_entry *g; -+ g = f->next_hash; -+ -+ if (__nat25_has_expired(priv, f)) { -+ if (atomic_dec_and_test(&f->use_count)) { -+#ifdef BR_EXT_DEBUG -+#ifdef CL_IPV6_PASS -+ panic_printk("NAT25 Expire H(%02d) M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" -+ "%02x%02x%02x%02x%02x%02x\n", -+ i, -+ f->macAddr[0], -+ f->macAddr[1], -+ f->macAddr[2], -+ f->macAddr[3], -+ f->macAddr[4], -+ f->macAddr[5], -+ f->networkAddr[0], -+ f->networkAddr[1], -+ f->networkAddr[2], -+ f->networkAddr[3], -+ f->networkAddr[4], -+ f->networkAddr[5], -+ f->networkAddr[6], -+ f->networkAddr[7], -+ f->networkAddr[8], -+ f->networkAddr[9], -+ f->networkAddr[10], -+ f->networkAddr[11], -+ f->networkAddr[12], -+ f->networkAddr[13], -+ f->networkAddr[14], -+ f->networkAddr[15], -+ f->networkAddr[16]); -+#else -+ -+ panic_printk("NAT25 Expire H(%02d) M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", -+ i, -+ f->macAddr[0], -+ f->macAddr[1], -+ f->macAddr[2], -+ f->macAddr[3], -+ f->macAddr[4], -+ f->macAddr[5], -+ f->networkAddr[0], -+ f->networkAddr[1], -+ f->networkAddr[2], -+ f->networkAddr[3], -+ f->networkAddr[4], -+ f->networkAddr[5], -+ f->networkAddr[6], -+ f->networkAddr[7], -+ f->networkAddr[8], -+ f->networkAddr[9], -+ f->networkAddr[10]); -+#endif -+#endif -+ if (priv->scdb_entry == f) { -+ memset(priv->scdb_mac, 0, ETH_ALEN); -+ memset(priv->scdb_ip, 0, 4); -+ priv->scdb_entry = NULL; -+ } -+ __network_hash_unlink(f); -+ rtw_mfree((u8 *) f, sizeof(struct nat25_network_db_entry)); -+ } -+ } -+ -+ f = g; -+ } -+ } -+ } -+ -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+} -+ -+ -+#ifdef SUPPORT_TX_MCAST2UNI -+static int checkIPMcAndReplace(_adapter *priv, struct sk_buff *skb, unsigned int *dst_ip) -+{ -+ struct stat_info *pstat; -+ struct list_head *phead, *plist; -+ int i; -+ -+ phead = &priv->asoc_list; -+ plist = phead->next; -+ -+ while (plist != phead) { -+ pstat = list_entry(plist, struct stat_info, asoc_list); -+ plist = plist->next; -+ -+ if (pstat->ipmc_num == 0) -+ continue; -+ -+ for (i = 0; i < MAX_IP_MC_ENTRY; i++) { -+ if (pstat->ipmc[i].used && !memcmp(&pstat->ipmc[i].mcmac[3], ((unsigned char *)dst_ip) + 1, 3)) { -+ memcpy(skb->data, pstat->ipmc[i].mcmac, ETH_ALEN); -+ return 1; -+ } -+ } -+ } -+ return 0; -+} -+#endif -+ -+int nat25_db_handle(_adapter *priv, struct sk_buff *skb, int method) -+{ -+ unsigned short protocol; -+ unsigned char networkAddr[MAX_NETWORK_ADDR_LEN]; -+ -+ if (skb == NULL) -+ return -1; -+ -+ if ((method <= NAT25_MIN) || (method >= NAT25_MAX)) -+ return -1; -+ -+ protocol = *((unsigned short *)(skb->data + 2 * ETH_ALEN)); -+ -+ /*---------------------------------------------------*/ -+ /* Handle IP frame */ -+ /*---------------------------------------------------*/ -+ if (protocol == __constant_htons(ETH_P_IP)) { -+ struct iphdr *iph = (struct iphdr *)(skb->data + ETH_HLEN); -+ -+ if (((unsigned char *)(iph) + (iph->ihl << 2)) >= (skb->data + ETH_HLEN + skb->len)) { -+ DEBUG_WARN("NAT25: malformed IP packet !\n"); -+ return -1; -+ } -+ -+ switch (method) { -+ case NAT25_CHECK: -+ return -1; -+ -+ case NAT25_INSERT: { -+ /* some muticast with source IP is all zero, maybe other case is illegal */ -+ /* in class A, B, C, host address is all zero or all one is illegal */ -+ if (iph->saddr == 0) -+ return 0; -+ RTW_INFO("NAT25: Insert IP, SA=%08x, DA=%08x\n", iph->saddr, iph->daddr); -+ __nat25_generate_ipv4_network_addr(networkAddr, &iph->saddr); -+ /* record source IP address and , source mac address into db */ -+ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); -+ -+ __nat25_db_print(priv); -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: { -+ RTW_INFO("NAT25: Lookup IP, SA=%08x, DA=%08x\n", iph->saddr, iph->daddr); -+#ifdef SUPPORT_TX_MCAST2UNI -+ if (priv->pshare->rf_ft_var.mc2u_disable || -+ ((((OPMODE & (WIFI_STATION_STATE | WIFI_ASOC_STATE)) -+ == (WIFI_STATION_STATE | WIFI_ASOC_STATE)) && -+ !checkIPMcAndReplace(priv, skb, &iph->daddr)) || -+ (OPMODE & WIFI_ADHOC_STATE))) -+#endif -+ { -+ __nat25_generate_ipv4_network_addr(networkAddr, &iph->daddr); -+ -+ if (!__nat25_db_network_lookup_and_replace(priv, skb, networkAddr)) { -+ if (*((unsigned char *)&iph->daddr + 3) == 0xff) { -+ /* L2 is unicast but L3 is broadcast, make L2 bacome broadcast */ -+ RTW_INFO("NAT25: Set DA as boardcast\n"); -+ memset(skb->data, 0xff, ETH_ALEN); -+ } else { -+ /* forward unknow IP packet to upper TCP/IP */ -+ RTW_INFO("NAT25: Replace DA with BR's MAC\n"); -+ if ((*(u32 *)priv->br_mac) == 0 && (*(u16 *)(priv->br_mac + 4)) == 0) { -+ void netdev_br_init(struct net_device *netdev); -+ printk("Re-init netdev_br_init() due to br_mac==0!\n"); -+ netdev_br_init(priv->pnetdev); -+ } -+ memcpy(skb->data, priv->br_mac, ETH_ALEN); -+ } -+ } -+ } -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /*---------------------------------------------------*/ -+ /* Handle ARP frame */ -+ /*---------------------------------------------------*/ -+ else if (protocol == __constant_htons(ETH_P_ARP)) { -+ struct arphdr *arp = (struct arphdr *)(skb->data + ETH_HLEN); -+ unsigned char *arp_ptr = (unsigned char *)(arp + 1); -+ unsigned int *sender, *target; -+ -+ if (arp->ar_pro != __constant_htons(ETH_P_IP)) { -+ DEBUG_WARN("NAT25: arp protocol unknown (%4x)!\n", htons(arp->ar_pro)); -+ return -1; -+ } -+ -+ switch (method) { -+ case NAT25_CHECK: -+ return 0; /* skb_copy for all ARP frame */ -+ -+ case NAT25_INSERT: { -+ RTW_INFO("NAT25: Insert ARP, MAC=%02x%02x%02x%02x%02x%02x\n", arp_ptr[0], -+ arp_ptr[1], arp_ptr[2], arp_ptr[3], arp_ptr[4], arp_ptr[5]); -+ -+ /* change to ARP sender mac address to wlan STA address */ -+ memcpy(arp_ptr, GET_MY_HWADDR(priv), ETH_ALEN); -+ -+ arp_ptr += arp->ar_hln; -+ sender = (unsigned int *)arp_ptr; -+ -+ __nat25_generate_ipv4_network_addr(networkAddr, sender); -+ -+ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); -+ -+ __nat25_db_print(priv); -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: { -+ RTW_INFO("NAT25: Lookup ARP\n"); -+ -+ arp_ptr += arp->ar_hln; -+ sender = (unsigned int *)arp_ptr; -+ arp_ptr += (arp->ar_hln + arp->ar_pln); -+ target = (unsigned int *)arp_ptr; -+ -+ __nat25_generate_ipv4_network_addr(networkAddr, target); -+ -+ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); -+ -+ /* change to ARP target mac address to Lookup result */ -+ arp_ptr = (unsigned char *)(arp + 1); -+ arp_ptr += (arp->ar_hln + arp->ar_pln); -+ memcpy(arp_ptr, skb->data, ETH_ALEN); -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /*---------------------------------------------------*/ -+ /* Handle IPX and Apple Talk frame */ -+ /*---------------------------------------------------*/ -+ else if ((protocol == __constant_htons(ETH_P_IPX)) || -+ (protocol == __constant_htons(ETH_P_ATALK)) || -+ (protocol == __constant_htons(ETH_P_AARP))) { -+ unsigned char ipx_header[2] = {0xFF, 0xFF}; -+ struct ipxhdr *ipx = NULL; -+ struct elapaarp *ea = NULL; -+ struct ddpehdr *ddp = NULL; -+ unsigned char *framePtr = skb->data + ETH_HLEN; -+ -+ if (protocol == __constant_htons(ETH_P_IPX)) { -+ RTW_INFO("NAT25: Protocol=IPX (Ethernet II)\n"); -+ ipx = (struct ipxhdr *)framePtr; -+ } else { /* if(protocol <= __constant_htons(ETH_FRAME_LEN)) */ -+ if (!memcmp(ipx_header, framePtr, 2)) { -+ RTW_INFO("NAT25: Protocol=IPX (Ethernet 802.3)\n"); -+ ipx = (struct ipxhdr *)framePtr; -+ } else { -+ unsigned char ipx_8022_type = 0xE0; -+ unsigned char snap_8022_type = 0xAA; -+ -+ if (*framePtr == snap_8022_type) { -+ unsigned char ipx_snap_id[5] = {0x0, 0x0, 0x0, 0x81, 0x37}; /* IPX SNAP ID */ -+ unsigned char aarp_snap_id[5] = {0x00, 0x00, 0x00, 0x80, 0xF3}; /* Apple Talk AARP SNAP ID */ -+ unsigned char ddp_snap_id[5] = {0x08, 0x00, 0x07, 0x80, 0x9B}; /* Apple Talk DDP SNAP ID */ -+ -+ framePtr += 3; /* eliminate the 802.2 header */ -+ -+ if (!memcmp(ipx_snap_id, framePtr, 5)) { -+ framePtr += 5; /* eliminate the SNAP header */ -+ -+ RTW_INFO("NAT25: Protocol=IPX (Ethernet SNAP)\n"); -+ ipx = (struct ipxhdr *)framePtr; -+ } else if (!memcmp(aarp_snap_id, framePtr, 5)) { -+ framePtr += 5; /* eliminate the SNAP header */ -+ -+ ea = (struct elapaarp *)framePtr; -+ } else if (!memcmp(ddp_snap_id, framePtr, 5)) { -+ framePtr += 5; /* eliminate the SNAP header */ -+ -+ ddp = (struct ddpehdr *)framePtr; -+ } else { -+ DEBUG_WARN("NAT25: Protocol=Ethernet SNAP %02x%02x%02x%02x%02x\n", framePtr[0], -+ framePtr[1], framePtr[2], framePtr[3], framePtr[4]); -+ return -1; -+ } -+ } else if (*framePtr == ipx_8022_type) { -+ framePtr += 3; /* eliminate the 802.2 header */ -+ -+ if (!memcmp(ipx_header, framePtr, 2)) { -+ RTW_INFO("NAT25: Protocol=IPX (Ethernet 802.2)\n"); -+ ipx = (struct ipxhdr *)framePtr; -+ } else -+ return -1; -+ } -+ } -+ } -+ -+ /* IPX */ -+ if (ipx != NULL) { -+ switch (method) { -+ case NAT25_CHECK: -+ if (!memcmp(skb->data + ETH_ALEN, ipx->ipx_source.node, ETH_ALEN)) { -+ RTW_INFO("NAT25: Check IPX skb_copy\n"); -+ return 0; -+ } -+ return -1; -+ -+ case NAT25_INSERT: { -+ RTW_INFO("NAT25: Insert IPX, Dest=%08x,%02x%02x%02x%02x%02x%02x,%04x Source=%08x,%02x%02x%02x%02x%02x%02x,%04x\n", -+ ipx->ipx_dest.net, -+ ipx->ipx_dest.node[0], -+ ipx->ipx_dest.node[1], -+ ipx->ipx_dest.node[2], -+ ipx->ipx_dest.node[3], -+ ipx->ipx_dest.node[4], -+ ipx->ipx_dest.node[5], -+ ipx->ipx_dest.sock, -+ ipx->ipx_source.net, -+ ipx->ipx_source.node[0], -+ ipx->ipx_source.node[1], -+ ipx->ipx_source.node[2], -+ ipx->ipx_source.node[3], -+ ipx->ipx_source.node[4], -+ ipx->ipx_source.node[5], -+ ipx->ipx_source.sock); -+ -+ if (!memcmp(skb->data + ETH_ALEN, ipx->ipx_source.node, ETH_ALEN)) { -+ RTW_INFO("NAT25: Use IPX Net, and Socket as network addr\n"); -+ -+ __nat25_generate_ipx_network_addr_with_socket(networkAddr, &ipx->ipx_source.net, &ipx->ipx_source.sock); -+ -+ /* change IPX source node addr to wlan STA address */ -+ memcpy(ipx->ipx_source.node, GET_MY_HWADDR(priv), ETH_ALEN); -+ } else -+ __nat25_generate_ipx_network_addr_with_node(networkAddr, &ipx->ipx_source.net, ipx->ipx_source.node); -+ -+ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); -+ -+ __nat25_db_print(priv); -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: { -+ if (!memcmp(GET_MY_HWADDR(priv), ipx->ipx_dest.node, ETH_ALEN)) { -+ RTW_INFO("NAT25: Lookup IPX, Modify Destination IPX Node addr\n"); -+ -+ __nat25_generate_ipx_network_addr_with_socket(networkAddr, &ipx->ipx_dest.net, &ipx->ipx_dest.sock); -+ -+ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); -+ -+ /* replace IPX destination node addr with Lookup destination MAC addr */ -+ memcpy(ipx->ipx_dest.node, skb->data, ETH_ALEN); -+ } else { -+ __nat25_generate_ipx_network_addr_with_node(networkAddr, &ipx->ipx_dest.net, ipx->ipx_dest.node); -+ -+ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); -+ } -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /* AARP */ -+ else if (ea != NULL) { -+ /* Sanity check fields. */ -+ if (ea->hw_len != ETH_ALEN || ea->pa_len != AARP_PA_ALEN) { -+ DEBUG_WARN("NAT25: Appletalk AARP Sanity check fail!\n"); -+ return -1; -+ } -+ -+ switch (method) { -+ case NAT25_CHECK: -+ return 0; -+ -+ case NAT25_INSERT: { -+ /* change to AARP source mac address to wlan STA address */ -+ memcpy(ea->hw_src, GET_MY_HWADDR(priv), ETH_ALEN); -+ -+ RTW_INFO("NAT25: Insert AARP, Source=%d,%d Destination=%d,%d\n", -+ ea->pa_src_net, -+ ea->pa_src_node, -+ ea->pa_dst_net, -+ ea->pa_dst_node); -+ -+ __nat25_generate_apple_network_addr(networkAddr, &ea->pa_src_net, &ea->pa_src_node); -+ -+ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); -+ -+ __nat25_db_print(priv); -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: { -+ RTW_INFO("NAT25: Lookup AARP, Source=%d,%d Destination=%d,%d\n", -+ ea->pa_src_net, -+ ea->pa_src_node, -+ ea->pa_dst_net, -+ ea->pa_dst_node); -+ -+ __nat25_generate_apple_network_addr(networkAddr, &ea->pa_dst_net, &ea->pa_dst_node); -+ -+ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); -+ -+ /* change to AARP destination mac address to Lookup result */ -+ memcpy(ea->hw_dst, skb->data, ETH_ALEN); -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /* DDP */ -+ else if (ddp != NULL) { -+ switch (method) { -+ case NAT25_CHECK: -+ return -1; -+ -+ case NAT25_INSERT: { -+ RTW_INFO("NAT25: Insert DDP, Source=%d,%d Destination=%d,%d\n", -+ ddp->deh_snet, -+ ddp->deh_snode, -+ ddp->deh_dnet, -+ ddp->deh_dnode); -+ -+ __nat25_generate_apple_network_addr(networkAddr, &ddp->deh_snet, &ddp->deh_snode); -+ -+ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); -+ -+ __nat25_db_print(priv); -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: { -+ RTW_INFO("NAT25: Lookup DDP, Source=%d,%d Destination=%d,%d\n", -+ ddp->deh_snet, -+ ddp->deh_snode, -+ ddp->deh_dnet, -+ ddp->deh_dnode); -+ -+ __nat25_generate_apple_network_addr(networkAddr, &ddp->deh_dnet, &ddp->deh_dnode); -+ -+ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ return -1; -+ } -+ -+ /*---------------------------------------------------*/ -+ /* Handle PPPoE frame */ -+ /*---------------------------------------------------*/ -+ else if ((protocol == __constant_htons(ETH_P_PPP_DISC)) || -+ (protocol == __constant_htons(ETH_P_PPP_SES))) { -+ struct pppoe_hdr *ph = (struct pppoe_hdr *)(skb->data + ETH_HLEN); -+ unsigned short *pMagic; -+ -+ switch (method) { -+ case NAT25_CHECK: -+ if (ph->sid == 0) -+ return 0; -+ return 1; -+ -+ case NAT25_INSERT: -+ if (ph->sid == 0) { /* Discovery phase according to tag */ -+ if (ph->code == PADI_CODE || ph->code == PADR_CODE) { -+ if (priv->ethBrExtInfo.addPPPoETag) { -+ struct pppoe_tag *tag, *pOldTag; -+ unsigned char tag_buf[40]; -+ int old_tag_len = 0; -+ -+ tag = (struct pppoe_tag *)tag_buf; -+ pOldTag = (struct pppoe_tag *)__nat25_find_pppoe_tag(ph, ntohs(PTT_RELAY_SID)); -+ if (pOldTag) { /* if SID existed, copy old value and delete it */ -+ old_tag_len = ntohs(pOldTag->tag_len); -+ if (old_tag_len + TAG_HDR_LEN + MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN > sizeof(tag_buf)) { -+ DEBUG_ERR("SID tag length too long!\n"); -+ return -1; -+ } -+ -+ memcpy(tag->tag_data + MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN, -+ pOldTag->tag_data, old_tag_len); -+ -+ if (skb_pull_and_merge(skb, (unsigned char *)pOldTag, TAG_HDR_LEN + old_tag_len) < 0) { -+ DEBUG_ERR("call skb_pull_and_merge() failed in PADI/R packet!\n"); -+ return -1; -+ } -+ ph->length = htons(ntohs(ph->length) - TAG_HDR_LEN - old_tag_len); -+ } -+ -+ tag->tag_type = PTT_RELAY_SID; -+ tag->tag_len = htons(MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN + old_tag_len); -+ -+ /* insert the magic_code+client mac in relay tag */ -+ pMagic = (unsigned short *)tag->tag_data; -+ *pMagic = htons(MAGIC_CODE); -+ memcpy(tag->tag_data + MAGIC_CODE_LEN, skb->data + ETH_ALEN, ETH_ALEN); -+ -+ /* Add relay tag */ -+ if (__nat25_add_pppoe_tag(skb, tag) < 0) -+ return -1; -+ -+ RTW_INFO("NAT25: Insert PPPoE, forward %s packet\n", -+ (ph->code == PADI_CODE ? "PADI" : "PADR")); -+ } else { /* not add relay tag */ -+ if (priv->pppoe_connection_in_progress && -+ memcmp(skb->data + ETH_ALEN, priv->pppoe_addr, ETH_ALEN)) { -+ DEBUG_ERR("Discard PPPoE packet due to another PPPoE connection is in progress!\n"); -+ return -2; -+ } -+ -+ if (priv->pppoe_connection_in_progress == 0) -+ memcpy(priv->pppoe_addr, skb->data + ETH_ALEN, ETH_ALEN); -+ -+ priv->pppoe_connection_in_progress = WAIT_TIME_PPPOE; -+ } -+ } else -+ return -1; -+ } else { /* session phase */ -+ RTW_INFO("NAT25: Insert PPPoE, insert session packet to %s\n", skb->dev->name); -+ -+ __nat25_generate_pppoe_network_addr(networkAddr, skb->data, &(ph->sid)); -+ -+ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); -+ -+ __nat25_db_print(priv); -+ -+ if (!priv->ethBrExtInfo.addPPPoETag && -+ priv->pppoe_connection_in_progress && -+ !memcmp(skb->data + ETH_ALEN, priv->pppoe_addr, ETH_ALEN)) -+ priv->pppoe_connection_in_progress = 0; -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: -+ if (ph->code == PADO_CODE || ph->code == PADS_CODE) { -+ if (priv->ethBrExtInfo.addPPPoETag) { -+ struct pppoe_tag *tag; -+ unsigned char *ptr; -+ unsigned short tagType, tagLen; -+ int offset = 0; -+ -+ ptr = __nat25_find_pppoe_tag(ph, ntohs(PTT_RELAY_SID)); -+ if (ptr == 0) { -+ DEBUG_ERR("Fail to find PTT_RELAY_SID in FADO!\n"); -+ return -1; -+ } -+ -+ tag = (struct pppoe_tag *)ptr; -+ tagType = (unsigned short)((ptr[0] << 8) + ptr[1]); -+ tagLen = (unsigned short)((ptr[2] << 8) + ptr[3]); -+ -+ if ((tagType != ntohs(PTT_RELAY_SID)) || (tagLen < (MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN))) { -+ DEBUG_ERR("Invalid PTT_RELAY_SID tag length [%d]!\n", tagLen); -+ return -1; -+ } -+ -+ pMagic = (unsigned short *)tag->tag_data; -+ if (ntohs(*pMagic) != MAGIC_CODE) { -+ DEBUG_ERR("Can't find MAGIC_CODE in %s packet!\n", -+ (ph->code == PADO_CODE ? "PADO" : "PADS")); -+ return -1; -+ } -+ -+ memcpy(skb->data, tag->tag_data + MAGIC_CODE_LEN, ETH_ALEN); -+ -+ if (tagLen > MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN) -+ offset = TAG_HDR_LEN; -+ -+ if (skb_pull_and_merge(skb, ptr + offset, TAG_HDR_LEN + MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN - offset) < 0) { -+ DEBUG_ERR("call skb_pull_and_merge() failed in PADO packet!\n"); -+ return -1; -+ } -+ ph->length = htons(ntohs(ph->length) - (TAG_HDR_LEN + MAGIC_CODE_LEN + RTL_RELAY_TAG_LEN - offset)); -+ if (offset > 0) -+ tag->tag_len = htons(tagLen - MAGIC_CODE_LEN - RTL_RELAY_TAG_LEN); -+ -+ RTW_INFO("NAT25: Lookup PPPoE, forward %s Packet from %s\n", -+ (ph->code == PADO_CODE ? "PADO" : "PADS"), skb->dev->name); -+ } else { /* not add relay tag */ -+ if (!priv->pppoe_connection_in_progress) { -+ DEBUG_ERR("Discard PPPoE packet due to no connection in progresss!\n"); -+ return -1; -+ } -+ memcpy(skb->data, priv->pppoe_addr, ETH_ALEN); -+ priv->pppoe_connection_in_progress = WAIT_TIME_PPPOE; -+ } -+ } else { -+ if (ph->sid != 0) { -+ RTW_INFO("NAT25: Lookup PPPoE, lookup session packet from %s\n", skb->dev->name); -+ __nat25_generate_pppoe_network_addr(networkAddr, skb->data + ETH_ALEN, &(ph->sid)); -+ -+ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); -+ -+ __nat25_db_print(priv); -+ } else -+ return -1; -+ -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /*---------------------------------------------------*/ -+ /* Handle EAP frame */ -+ /*---------------------------------------------------*/ -+ else if (protocol == __constant_htons(0x888e)) { -+ switch (method) { -+ case NAT25_CHECK: -+ return -1; -+ -+ case NAT25_INSERT: -+ return 0; -+ -+ case NAT25_LOOKUP: -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /*---------------------------------------------------*/ -+ /* Handle C-Media proprietary frame */ -+ /*---------------------------------------------------*/ -+ else if ((protocol == __constant_htons(0xe2ae)) || -+ (protocol == __constant_htons(0xe2af))) { -+ switch (method) { -+ case NAT25_CHECK: -+ return -1; -+ -+ case NAT25_INSERT: -+ return 0; -+ -+ case NAT25_LOOKUP: -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /*---------------------------------------------------*/ -+ /* Handle IPV6 frame */ -+ /*---------------------------------------------------*/ -+#ifdef CL_IPV6_PASS -+ else if (protocol == __constant_htons(ETH_P_IPV6)) { -+ struct ipv6hdr *iph = (struct ipv6hdr *)(skb->data + ETH_HLEN); -+ -+ if (sizeof(*iph) >= (skb->len - ETH_HLEN)) { -+ DEBUG_WARN("NAT25: malformed IPv6 packet !\n"); -+ return -1; -+ } -+ -+ switch (method) { -+ case NAT25_CHECK: -+ if (skb->data[0] & 1) -+ return 0; -+ return -1; -+ -+ case NAT25_INSERT: { -+ RTW_INFO("NAT25: Insert IP, SA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x," -+ " DA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x\n", -+ iph->saddr.s6_addr16[0], iph->saddr.s6_addr16[1], iph->saddr.s6_addr16[2], iph->saddr.s6_addr16[3], -+ iph->saddr.s6_addr16[4], iph->saddr.s6_addr16[5], iph->saddr.s6_addr16[6], iph->saddr.s6_addr16[7], -+ iph->daddr.s6_addr16[0], iph->daddr.s6_addr16[1], iph->daddr.s6_addr16[2], iph->daddr.s6_addr16[3], -+ iph->daddr.s6_addr16[4], iph->daddr.s6_addr16[5], iph->daddr.s6_addr16[6], iph->daddr.s6_addr16[7]); -+ -+ if (memcmp(&iph->saddr, "\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0", 16)) { -+ __nat25_generate_ipv6_network_addr(networkAddr, (unsigned int *)&iph->saddr); -+ __nat25_db_network_insert(priv, skb->data + ETH_ALEN, networkAddr); -+ __nat25_db_print(priv); -+ -+ if (iph->nexthdr == IPPROTO_ICMPV6 && -+ skb->len > (ETH_HLEN + sizeof(*iph) + 4)) { -+ if (update_nd_link_layer_addr(skb->data + ETH_HLEN + sizeof(*iph), -+ skb->len - ETH_HLEN - sizeof(*iph), GET_MY_HWADDR(priv))) { -+ struct icmp6hdr *hdr = (struct icmp6hdr *)(skb->data + ETH_HLEN + sizeof(*iph)); -+ hdr->icmp6_cksum = 0; -+ hdr->icmp6_cksum = csum_ipv6_magic(&iph->saddr, &iph->daddr, -+ iph->payload_len, -+ IPPROTO_ICMPV6, -+ csum_partial((__u8 *)hdr, iph->payload_len, 0)); -+ } -+ } -+ } -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: -+ RTW_INFO("NAT25: Lookup IP, SA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x," -+ " DA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x\n", -+ iph->saddr.s6_addr16[0], iph->saddr.s6_addr16[1], iph->saddr.s6_addr16[2], iph->saddr.s6_addr16[3], -+ iph->saddr.s6_addr16[4], iph->saddr.s6_addr16[5], iph->saddr.s6_addr16[6], iph->saddr.s6_addr16[7], -+ iph->daddr.s6_addr16[0], iph->daddr.s6_addr16[1], iph->daddr.s6_addr16[2], iph->daddr.s6_addr16[3], -+ iph->daddr.s6_addr16[4], iph->daddr.s6_addr16[5], iph->daddr.s6_addr16[6], iph->daddr.s6_addr16[7]); -+ -+ -+ __nat25_generate_ipv6_network_addr(networkAddr, (unsigned int *)&iph->daddr); -+ if (!__nat25_db_network_lookup_and_replace(priv, skb, networkAddr)) { -+#ifdef SUPPORT_RX_UNI2MCAST -+ if (iph->daddr.s6_addr[0] == 0xff) -+ convert_ipv6_mac_to_mc(skb); -+#endif -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+#endif /* CL_IPV6_PASS */ -+ -+ return -1; -+} -+ -+ -+int nat25_handle_frame(_adapter *priv, struct sk_buff *skb) -+{ -+#ifdef BR_EXT_DEBUG -+ if ((!priv->ethBrExtInfo.nat25_disable) && (!(skb->data[0] & 1))) { -+ panic_printk("NAT25: Input Frame: DA=%02x%02x%02x%02x%02x%02x SA=%02x%02x%02x%02x%02x%02x\n", -+ skb->data[0], -+ skb->data[1], -+ skb->data[2], -+ skb->data[3], -+ skb->data[4], -+ skb->data[5], -+ skb->data[6], -+ skb->data[7], -+ skb->data[8], -+ skb->data[9], -+ skb->data[10], -+ skb->data[11]); -+ } -+#endif -+ -+ if (!(skb->data[0] & 1)) { -+ int is_vlan_tag = 0, i, retval = 0; -+ unsigned short vlan_hdr = 0; -+ -+ if (*((unsigned short *)(skb->data + ETH_ALEN * 2)) == __constant_htons(ETH_P_8021Q)) { -+ is_vlan_tag = 1; -+ vlan_hdr = *((unsigned short *)(skb->data + ETH_ALEN * 2 + 2)); -+ for (i = 0; i < 6; i++) -+ *((unsigned short *)(skb->data + ETH_ALEN * 2 + 2 - i * 2)) = *((unsigned short *)(skb->data + ETH_ALEN * 2 - 2 - i * 2)); -+ skb_pull(skb, 4); -+ } -+ -+ if (!priv->ethBrExtInfo.nat25_disable) { -+ _irqL irqL; -+ _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ /* -+ * This function look up the destination network address from -+ * the NAT2.5 database. Return value = -1 means that the -+ * corresponding network protocol is NOT support. -+ */ -+ if (!priv->ethBrExtInfo.nat25sc_disable && -+ (*((unsigned short *)(skb->data + ETH_ALEN * 2)) == __constant_htons(ETH_P_IP)) && -+ !memcmp(priv->scdb_ip, skb->data + ETH_HLEN + 16, 4)) { -+ memcpy(skb->data, priv->scdb_mac, ETH_ALEN); -+ -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ } else { -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ -+ retval = nat25_db_handle(priv, skb, NAT25_LOOKUP); -+ } -+ } else { -+ if (((*((unsigned short *)(skb->data + ETH_ALEN * 2)) == __constant_htons(ETH_P_IP)) && -+ !memcmp(priv->br_ip, skb->data + ETH_HLEN + 16, 4)) || -+ ((*((unsigned short *)(skb->data + ETH_ALEN * 2)) == __constant_htons(ETH_P_ARP)) && -+ !memcmp(priv->br_ip, skb->data + ETH_HLEN + 24, 4))) { -+ /* for traffic to upper TCP/IP */ -+ retval = nat25_db_handle(priv, skb, NAT25_LOOKUP); -+ } -+ } -+ -+ if (is_vlan_tag) { -+ skb_push(skb, 4); -+ for (i = 0; i < 6; i++) -+ *((unsigned short *)(skb->data + i * 2)) = *((unsigned short *)(skb->data + 4 + i * 2)); -+ *((unsigned short *)(skb->data + ETH_ALEN * 2)) = __constant_htons(ETH_P_8021Q); -+ *((unsigned short *)(skb->data + ETH_ALEN * 2 + 2)) = vlan_hdr; -+ } -+ -+ if (retval == -1) { -+ /* DEBUG_ERR("NAT25: Lookup fail!\n"); */ -+ return -1; -+ } -+ } -+ -+ return 0; -+} -+ -+#if 0 -+void mac_clone(_adapter *priv, unsigned char *addr) -+{ -+ struct sockaddr sa; -+ -+ memcpy(sa.sa_data, addr, ETH_ALEN); -+ RTW_INFO("MAC Clone: Addr=%02x%02x%02x%02x%02x%02x\n", -+ addr[0], addr[1], addr[2], addr[3], addr[4], addr[5]); -+ rtl8192cd_set_hwaddr(priv->dev, &sa); -+} -+ -+ -+int mac_clone_handle_frame(_adapter *priv, struct sk_buff *skb) -+{ -+ if (priv->ethBrExtInfo.macclone_enable && !priv->macclone_completed) { -+ if (!(skb->data[ETH_ALEN] & 1)) { /* check any other particular MAC add */ -+ if (memcmp(skb->data + ETH_ALEN, GET_MY_HWADDR(priv), ETH_ALEN) && -+ ((priv->dev->br_port) && -+ memcmp(skb->data + ETH_ALEN, priv->br_mac, ETH_ALEN))) { -+ mac_clone(priv, skb->data + ETH_ALEN); -+ priv->macclone_completed = 1; -+ } -+ } -+ } -+ -+ return 0; -+} -+#endif /* 0 */ -+ -+#define SERVER_PORT 67 -+#define CLIENT_PORT 68 -+#define DHCP_MAGIC 0x63825363 -+#define BROADCAST_FLAG 0x8000 -+ -+struct dhcpMessage { -+ u_int8_t op; -+ u_int8_t htype; -+ u_int8_t hlen; -+ u_int8_t hops; -+ u_int32_t xid; -+ u_int16_t secs; -+ u_int16_t flags; -+ u_int32_t ciaddr; -+ u_int32_t yiaddr; -+ u_int32_t siaddr; -+ u_int32_t giaddr; -+ u_int8_t chaddr[16]; -+ u_int8_t sname[64]; -+ u_int8_t file[128]; -+ u_int32_t cookie; -+ u_int8_t options[308]; /* 312 - cookie */ -+}; -+ -+void dhcp_flag_bcast(_adapter *priv, struct sk_buff *skb) -+{ -+ if (skb == NULL) -+ return; -+ -+ if (!priv->ethBrExtInfo.dhcp_bcst_disable) { -+ unsigned short protocol = *((unsigned short *)(skb->data + 2 * ETH_ALEN)); -+ -+ if (protocol == __constant_htons(ETH_P_IP)) { /* IP */ -+ struct iphdr *iph = (struct iphdr *)(skb->data + ETH_HLEN); -+ -+ if (iph->protocol == IPPROTO_UDP) { /* UDP */ -+ struct udphdr *udph = (struct udphdr *)((SIZE_PTR)iph + (iph->ihl << 2)); -+ -+ if ((udph->source == __constant_htons(CLIENT_PORT)) -+ && (udph->dest == __constant_htons(SERVER_PORT))) { /* DHCP request */ -+ struct dhcpMessage *dhcph = -+ (struct dhcpMessage *)((SIZE_PTR)udph + sizeof(struct udphdr)); -+ -+ if (dhcph->cookie == __constant_htonl(DHCP_MAGIC)) { /* match magic word */ -+ if (!(dhcph->flags & htons(BROADCAST_FLAG))) { /* if not broadcast */ -+ register int sum = 0; -+ -+ RTW_INFO("DHCP: change flag of DHCP request to broadcast.\n"); -+ /* or BROADCAST flag */ -+ dhcph->flags |= htons(BROADCAST_FLAG); -+ /* recalculate checksum */ -+ sum = ~(udph->check) & 0xffff; -+ sum += dhcph->flags; -+ while (sum >> 16) -+ sum = (sum & 0xffff) + (sum >> 16); -+ udph->check = ~sum; -+ } -+ } -+ } -+ } -+ } -+ } -+} -+ -+ -+void *scdb_findEntry(_adapter *priv, unsigned char *macAddr, -+ unsigned char *ipAddr) -+{ -+ unsigned char networkAddr[MAX_NETWORK_ADDR_LEN]; -+ struct nat25_network_db_entry *db; -+ int hash; -+ /* _irqL irqL; */ -+ /* _enter_critical_bh(&priv->br_ext_lock, &irqL); */ -+ -+ __nat25_generate_ipv4_network_addr(networkAddr, (unsigned int *)ipAddr); -+ hash = __nat25_network_hash(networkAddr); -+ db = priv->nethash[hash]; -+ while (db != NULL) { -+ if (!memcmp(db->networkAddr, networkAddr, MAX_NETWORK_ADDR_LEN)) { -+ /* _exit_critical_bh(&priv->br_ext_lock, &irqL); */ -+ return (void *)db; -+ } -+ -+ db = db->next_hash; -+ } -+ -+ /* _exit_critical_bh(&priv->br_ext_lock, &irqL); */ -+ return NULL; -+} -+ -+#endif /* CONFIG_BR_EXT */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_btcoex.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_btcoex.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_btcoex.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_btcoex.c 2018-02-11 21:44:27.135145903 +0200 -@@ -0,0 +1,1722 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifdef CONFIG_BT_COEXIST -+ -+#include -+#include -+#include -+ -+ -+void rtw_btcoex_Initialize(PADAPTER padapter) -+{ -+ hal_btcoex_Initialize(padapter); -+} -+ -+void rtw_btcoex_PowerOnSetting(PADAPTER padapter) -+{ -+ hal_btcoex_PowerOnSetting(padapter); -+} -+ -+void rtw_btcoex_PowerOffSetting(PADAPTER padapter) -+{ -+ hal_btcoex_PowerOffSetting(padapter); -+} -+ -+void rtw_btcoex_PreLoadFirmware(PADAPTER padapter) -+{ -+ hal_btcoex_PreLoadFirmware(padapter); -+} -+ -+void rtw_btcoex_HAL_Initialize(PADAPTER padapter, u8 bWifiOnly) -+{ -+ hal_btcoex_InitHwConfig(padapter, bWifiOnly); -+} -+ -+void rtw_btcoex_IpsNotify(PADAPTER padapter, u8 type) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_IpsNotify(padapter, type); -+} -+ -+void rtw_btcoex_LpsNotify(PADAPTER padapter, u8 type) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_LpsNotify(padapter, type); -+} -+ -+void rtw_btcoex_ScanNotify(PADAPTER padapter, u8 type) -+{ -+ PHAL_DATA_TYPE pHalData; -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ if (_FALSE == type) { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, WIFI_SITE_MONITOR)) -+ return; -+ #endif -+ -+ if (DEV_MGMT_TX_NUM(adapter_to_dvobj(padapter)) -+ || DEV_ROCH_NUM(adapter_to_dvobj(padapter))) -+ return; -+ } -+ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ if (pBtMgnt->ExtConfig.bEnableWifiScanNotify) -+ rtw_btcoex_SendScanNotify(padapter, type); -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ -+ hal_btcoex_ScanNotify(padapter, type); -+} -+ -+void rtw_btcoex_ConnectNotify(PADAPTER padapter, u8 action) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+#ifdef DBG_CONFIG_ERROR_RESET -+ if (_TRUE == rtw_hal_sreset_inprogress(padapter)) { -+ RTW_INFO(FUNC_ADPT_FMT ": [BTCoex] under reset, skip notify!\n", -+ FUNC_ADPT_ARG(padapter)); -+ return; -+ } -+#endif /* DBG_CONFIG_ERROR_RESET */ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (_FALSE == action) { -+ if (rtw_mi_buddy_check_fwstate(padapter, WIFI_UNDER_LINKING)) -+ return; -+ } -+#endif -+ -+ hal_btcoex_ConnectNotify(padapter, action); -+} -+ -+void rtw_btcoex_MediaStatusNotify(PADAPTER padapter, u8 mediaStatus) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+#ifdef DBG_CONFIG_ERROR_RESET -+ if (_TRUE == rtw_hal_sreset_inprogress(padapter)) { -+ RTW_INFO(FUNC_ADPT_FMT ": [BTCoex] under reset, skip notify!\n", -+ FUNC_ADPT_ARG(padapter)); -+ return; -+ } -+#endif /* DBG_CONFIG_ERROR_RESET */ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (RT_MEDIA_DISCONNECT == mediaStatus) { -+ if (rtw_mi_buddy_check_fwstate(padapter, WIFI_ASOC_STATE)) -+ return; -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ if ((RT_MEDIA_CONNECT == mediaStatus) -+ && (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE)) -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_RSVD_PAGE, NULL); -+ -+ hal_btcoex_MediaStatusNotify(padapter, mediaStatus); -+} -+ -+void rtw_btcoex_SpecialPacketNotify(PADAPTER padapter, u8 pktType) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_SpecialPacketNotify(padapter, pktType); -+} -+ -+void rtw_btcoex_IQKNotify(PADAPTER padapter, u8 state) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_IQKNotify(padapter, state); -+} -+ -+void rtw_btcoex_BtInfoNotify(PADAPTER padapter, u8 length, u8 *tmpBuf) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_BtInfoNotify(padapter, length, tmpBuf); -+} -+ -+void rtw_btcoex_BtMpRptNotify(PADAPTER padapter, u8 length, u8 *tmpBuf) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ if (padapter->registrypriv.mp_mode == 1) -+ return; -+ -+ hal_btcoex_BtMpRptNotify(padapter, length, tmpBuf); -+} -+ -+void rtw_btcoex_SuspendNotify(PADAPTER padapter, u8 state) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_SuspendNotify(padapter, state); -+} -+ -+void rtw_btcoex_HaltNotify(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 do_halt = 1; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ do_halt = 0; -+ -+ if (_FALSE == padapter->bup) { -+ RTW_INFO(FUNC_ADPT_FMT ": bup=%d Skip!\n", -+ FUNC_ADPT_ARG(padapter), padapter->bup); -+ do_halt = 0; -+ } -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=%s Skip!\n", -+ FUNC_ADPT_ARG(padapter), rtw_is_surprise_removed(padapter) ? "True" : "False"); -+ do_halt = 0; -+ } -+ -+ hal_btcoex_HaltNotify(padapter, do_halt); -+} -+ -+void rtw_btcoex_switchband_notify(u8 under_scan, u8 band_type) -+{ -+ hal_btcoex_switchband_notify(under_scan, band_type); -+} -+ -+void rtw_btcoex_SwitchBtTRxMask(PADAPTER padapter) -+{ -+ hal_btcoex_SwitchBtTRxMask(padapter); -+} -+ -+void rtw_btcoex_Switch(PADAPTER padapter, u8 enable) -+{ -+ hal_btcoex_SetBTCoexist(padapter, enable); -+} -+ -+u8 rtw_btcoex_IsBtDisabled(PADAPTER padapter) -+{ -+ return hal_btcoex_IsBtDisabled(padapter); -+} -+ -+void rtw_btcoex_Handler(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ if (_FALSE == pHalData->EEPROMBluetoothCoexist) -+ return; -+ -+ hal_btcoex_Hanlder(padapter); -+} -+ -+s32 rtw_btcoex_IsBTCoexRejectAMPDU(PADAPTER padapter) -+{ -+ s32 coexctrl; -+ -+ coexctrl = hal_btcoex_IsBTCoexRejectAMPDU(padapter); -+ -+ return coexctrl; -+} -+ -+s32 rtw_btcoex_IsBTCoexCtrlAMPDUSize(PADAPTER padapter) -+{ -+ s32 coexctrl; -+ -+ coexctrl = hal_btcoex_IsBTCoexCtrlAMPDUSize(padapter); -+ -+ return coexctrl; -+} -+ -+u32 rtw_btcoex_GetAMPDUSize(PADAPTER padapter) -+{ -+ u32 size; -+ -+ size = hal_btcoex_GetAMPDUSize(padapter); -+ -+ return size; -+} -+ -+void rtw_btcoex_SetManualControl(PADAPTER padapter, u8 manual) -+{ -+ if (_TRUE == manual) -+ hal_btcoex_SetManualControl(padapter, _TRUE); -+ else -+ hal_btcoex_SetManualControl(padapter, _FALSE); -+} -+ -+u8 rtw_btcoex_1Ant(PADAPTER padapter) -+{ -+ return hal_btcoex_1Ant(padapter); -+} -+ -+u8 rtw_btcoex_IsBtControlLps(PADAPTER padapter) -+{ -+ return hal_btcoex_IsBtControlLps(padapter); -+} -+ -+u8 rtw_btcoex_IsLpsOn(PADAPTER padapter) -+{ -+ return hal_btcoex_IsLpsOn(padapter); -+} -+ -+u8 rtw_btcoex_RpwmVal(PADAPTER padapter) -+{ -+ return hal_btcoex_RpwmVal(padapter); -+} -+ -+u8 rtw_btcoex_LpsVal(PADAPTER padapter) -+{ -+ return hal_btcoex_LpsVal(padapter); -+} -+ -+u32 rtw_btcoex_GetRaMask(PADAPTER padapter) -+{ -+ return hal_btcoex_GetRaMask(padapter); -+} -+ -+void rtw_btcoex_RecordPwrMode(PADAPTER padapter, u8 *pCmdBuf, u8 cmdLen) -+{ -+ hal_btcoex_RecordPwrMode(padapter, pCmdBuf, cmdLen); -+} -+ -+void rtw_btcoex_DisplayBtCoexInfo(PADAPTER padapter, u8 *pbuf, u32 bufsize) -+{ -+ hal_btcoex_DisplayBtCoexInfo(padapter, pbuf, bufsize); -+} -+ -+void rtw_btcoex_SetDBG(PADAPTER padapter, u32 *pDbgModule) -+{ -+ hal_btcoex_SetDBG(padapter, pDbgModule); -+} -+ -+u32 rtw_btcoex_GetDBG(PADAPTER padapter, u8 *pStrBuf, u32 bufSize) -+{ -+ return hal_btcoex_GetDBG(padapter, pStrBuf, bufSize); -+} -+ -+u8 rtw_btcoex_IncreaseScanDeviceNum(PADAPTER padapter) -+{ -+ return hal_btcoex_IncreaseScanDeviceNum(padapter); -+} -+ -+u8 rtw_btcoex_IsBtLinkExist(PADAPTER padapter) -+{ -+ return hal_btcoex_IsBtLinkExist(padapter); -+} -+ -+void rtw_btcoex_SetBtPatchVersion(PADAPTER padapter, u16 btHciVer, u16 btPatchVer) -+{ -+ hal_btcoex_SetBtPatchVersion(padapter, btHciVer, btPatchVer); -+} -+ -+void rtw_btcoex_SetHciVersion(PADAPTER padapter, u16 hciVersion) -+{ -+ hal_btcoex_SetHciVersion(padapter, hciVersion); -+} -+ -+void rtw_btcoex_StackUpdateProfileInfo(void) -+{ -+ hal_btcoex_StackUpdateProfileInfo(); -+} -+ -+void rtw_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON) -+{ -+ hal_btcoex_BTOffOnNotify(padapter, bBTON); -+} -+ -+/* ================================================== -+ * Below Functions are called by BT-Coex -+ * ================================================== */ -+void rtw_btcoex_rx_ampdu_apply(PADAPTER padapter) -+{ -+ rtw_rx_ampdu_apply(padapter); -+} -+ -+void rtw_btcoex_LPS_Enter(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ u8 lpsVal; -+ -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ pwrpriv->bpower_saving = _TRUE; -+ lpsVal = rtw_btcoex_LpsVal(padapter); -+ rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, lpsVal, "BTCOEX"); -+} -+ -+void rtw_btcoex_LPS_Leave(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "BTCOEX"); -+ LPS_RF_ON_check(padapter, 100); -+ pwrpriv->bpower_saving = _FALSE; -+ } -+} -+ -+u16 rtw_btcoex_btreg_read(PADAPTER padapter, u8 type, u16 addr, u32 *data) -+{ -+ return hal_btcoex_btreg_read(padapter, type, addr, data); -+} -+ -+u16 rtw_btcoex_btreg_write(PADAPTER padapter, u8 type, u16 addr, u16 val) -+{ -+ return hal_btcoex_btreg_write(padapter, type, addr, val); -+} -+ -+u8 rtw_btcoex_get_bt_coexist(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ return pHalData->EEPROMBluetoothCoexist; -+} -+ -+u8 rtw_btcoex_get_chip_type(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ return pHalData->EEPROMBluetoothType; -+} -+ -+u8 rtw_btcoex_get_pg_ant_num(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ return pHalData->EEPROMBluetoothAntNum == Ant_x2 ? 2 : 1; -+} -+ -+u8 rtw_btcoex_get_pg_single_ant_path(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ return pHalData->ant_path; -+} -+ -+u8 rtw_btcoex_get_pg_rfe_type(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ return pHalData->RFEType; -+} -+ -+u8 rtw_btcoex_is_tfbga_package_type(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+#ifdef CONFIG_RTL8723B -+ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA80) -+ || (pHalData->PackageType == PACKAGE_TFBGA90)) -+ return _TRUE; -+#endif -+ -+ return _FALSE; -+} -+ -+u8 rtw_btcoex_get_ant_div_cfg(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ return (pHalData->AntDivCfg == 0) ? _FALSE : _TRUE; -+} -+ -+/* ================================================== -+ * Below Functions are BT-Coex socket related function -+ * ================================================== */ -+ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+_adapter *pbtcoexadapter; /* = NULL; */ /* do not initialise globals to 0 or NULL */ -+u8 rtw_btcoex_btinfo_cmd(_adapter *adapter, u8 *buf, u16 len) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ u8 *btinfo; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ btinfo = rtw_zmalloc(len); -+ if (btinfo == NULL) { -+ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = BTINFO_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = len; -+ pdrvextra_cmd_parm->pbuf = btinfo; -+ -+ _rtw_memcpy(btinfo, buf, len); -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+u8 rtw_btcoex_send_event_to_BT(_adapter *padapter, u8 status, u8 event_code, u8 opcode_low, u8 opcode_high, u8 *dbg_msg) -+{ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ rtw_HCI_event *pEvent; -+ -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ pEvent->EventCode = event_code; -+ pEvent->Data[0] = 0x1; /* packet # */ -+ pEvent->Data[1] = opcode_low; -+ pEvent->Data[2] = opcode_high; -+ len = len + 3; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; /* status */ -+ -+ len++; -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+#if 0 -+ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, dbg_msg); -+#endif -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ -+ return status; -+} -+ -+/* -+Ref: -+Realtek Wi-Fi Driver -+Host Controller Interface for -+Bluetooth 3.0 + HS V1.4 2013/02/07 -+ -+Window team code & BT team code -+ */ -+ -+ -+u8 rtw_btcoex_parse_BT_info_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+#define BT_INFO_LENGTH 8 -+ -+ u8 curPollEnable = pcmd[0]; -+ u8 curPollTime = pcmd[1]; -+ u8 btInfoReason = pcmd[2]; -+ u8 btInfoLen = pcmd[3]; -+ u8 btinfo[BT_INFO_LENGTH]; -+ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; -+ rtw_HCI_event *pEvent; -+ -+ /* RTW_INFO("%s\n",__func__); -+ RTW_INFO("current Poll Enable: %d, currrent Poll Time: %d\n",curPollEnable,curPollTime); -+ RTW_INFO("BT Info reason: %d, BT Info length: %d\n",btInfoReason,btInfoLen); -+ RTW_INFO("%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x\n" -+ ,pcmd[4],pcmd[5],pcmd[6],pcmd[7],pcmd[8],pcmd[9],pcmd[10],pcmd[11]);*/ -+ -+ _rtw_memset(btinfo, 0, BT_INFO_LENGTH); -+ -+#if 1 -+ if (BT_INFO_LENGTH != btInfoLen) { -+ status = HCI_STATUS_INVALID_HCI_CMD_PARA_VALUE; -+ RTW_INFO("Error BT Info Length: %d\n", btInfoLen); -+ /* return _FAIL; */ -+ } else -+#endif -+ { -+ if (0x1 == btInfoReason || 0x2 == btInfoReason) { -+ _rtw_memcpy(btinfo, &pcmd[4], btInfoLen); -+ btinfo[0] = btInfoReason; -+ rtw_btcoex_btinfo_cmd(padapter, btinfo, btInfoLen); -+ } else -+ RTW_INFO("Other BT info reason\n"); -+ } -+ -+ /* send complete event to BT */ -+ { -+ -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; /* packet # */ -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_INFO_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_INFO_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; /* status */ -+ -+ len++; -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+#if 0 -+ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "BT_info_event"); -+#endif -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ -+ return status; -+ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ -+ } -+} -+ -+u8 rtw_btcoex_parse_BT_patch_ver_info_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; -+ u16 btPatchVer = 0x0, btHciVer = 0x0; -+ /* u16 *pU2tmp; */ -+ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ rtw_HCI_event *pEvent; -+ -+ btHciVer = pcmd[0] | pcmd[1] << 8; -+ btPatchVer = pcmd[2] | pcmd[3] << 8; -+ -+ -+ RTW_INFO("%s, cmd:%02x %02x %02x %02x\n", __func__, pcmd[0] , pcmd[1] , pcmd[2] , pcmd[3]); -+ RTW_INFO("%s, HCI Ver:%d, Patch Ver:%d\n", __func__, btHciVer, btPatchVer); -+ -+ rtw_btcoex_SetBtPatchVersion(padapter, btHciVer, btPatchVer); -+ -+ -+ /* send complete event to BT */ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; /* packet # */ -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_PATCH_VERSION_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_PATCH_VERSION_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; /* status */ -+ -+ len++; -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+#if 0 -+ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "BT_patch_event"); -+#endif -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ -+ } -+} -+ -+u8 rtw_btcoex_parse_HCI_Ver_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; -+ u16 hciver = pcmd[0] | pcmd[1] << 8; -+ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ rtw_HCI_event *pEvent; -+ -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; -+ pBtMgnt->ExtConfig.HCIExtensionVer = hciver; -+ RTW_INFO("%s, HCI Version: %d\n", __func__, pBtMgnt->ExtConfig.HCIExtensionVer); -+ if (pBtMgnt->ExtConfig.HCIExtensionVer < 4) { -+ status = HCI_STATUS_INVALID_HCI_CMD_PARA_VALUE; -+ RTW_INFO("%s, Version = %d, HCI Version < 4\n", __func__, pBtMgnt->ExtConfig.HCIExtensionVer); -+ } else -+ rtw_btcoex_SetHciVersion(padapter, hciver); -+ /* send complete event to BT */ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; /* packet # */ -+ pEvent->Data[1] = HCIOPCODELOW(HCI_EXTENSION_VERSION_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_EXTENSION_VERSION_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; /* status */ -+ -+ len++; -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ -+ } -+ -+} -+ -+u8 rtw_btcoex_parse_WIFI_scan_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; -+ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ rtw_HCI_event *pEvent; -+ -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; -+ pBtMgnt->ExtConfig.bEnableWifiScanNotify = pcmd[0]; -+ RTW_INFO("%s, bEnableWifiScanNotify: %d\n", __func__, pBtMgnt->ExtConfig.bEnableWifiScanNotify); -+ -+ /* send complete event to BT */ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; /* packet # */ -+ pEvent->Data[1] = HCIOPCODELOW(HCI_ENABLE_WIFI_SCAN_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_ENABLE_WIFI_SCAN_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; /* status */ -+ -+ len++; -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ -+ } -+} -+ -+u8 rtw_btcoex_parse_HCI_link_status_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; -+ /* PBT_DBG pBtDbg=&padapter->MgntInfo.BtInfo.BtDbg; */ -+ u8 i, numOfHandle = 0, numOfAcl = 0; -+ u16 conHandle; -+ u8 btProfile, btCoreSpec, linkRole; -+ u8 *pTriple; -+ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ rtw_HCI_event *pEvent; -+ -+ /* pBtDbg->dbgHciInfo.hciCmdCntLinkStatusNotify++; */ -+ /* RT_DISP_DATA(FIOCTL, IOCTL_BT_HCICMD_EXT, "LinkStatusNotify, Hex Data :\n", */ -+ /* &pHciCmd->Data[0], pHciCmd->Length); */ -+ -+ RTW_INFO("BTLinkStatusNotify\n"); -+ -+ /* Current only RTL8723 support this command. */ -+ /* pBtMgnt->bSupportProfile = TRUE; */ -+ pBtMgnt->bSupportProfile = _FALSE; -+ -+ pBtMgnt->ExtConfig.NumberOfACL = 0; -+ pBtMgnt->ExtConfig.NumberOfSCO = 0; -+ -+ numOfHandle = pcmd[0]; -+ /* RT_DISP(FIOCTL, IOCTL_BT_HCICMD_EXT, ("numOfHandle = 0x%x\n", numOfHandle)); */ -+ /* RT_DISP(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCIExtensionVer = %d\n", pBtMgnt->ExtConfig.HCIExtensionVer)); */ -+ RTW_INFO("numOfHandle = 0x%x\n", numOfHandle); -+ RTW_INFO("HCIExtensionVer = %d\n", pBtMgnt->ExtConfig.HCIExtensionVer); -+ -+ pTriple = &pcmd[1]; -+ for (i = 0; i < numOfHandle; i++) { -+ if (pBtMgnt->ExtConfig.HCIExtensionVer < 1) { -+ conHandle = *((u8 *)&pTriple[0]); -+ btProfile = pTriple[2]; -+ btCoreSpec = pTriple[3]; -+ if (BT_PROFILE_SCO == btProfile) -+ pBtMgnt->ExtConfig.NumberOfSCO++; -+ else { -+ pBtMgnt->ExtConfig.NumberOfACL++; -+ pBtMgnt->ExtConfig.aclLink[i].ConnectHandle = conHandle; -+ pBtMgnt->ExtConfig.aclLink[i].BTProfile = btProfile; -+ pBtMgnt->ExtConfig.aclLink[i].BTCoreSpec = btCoreSpec; -+ } -+ /* RT_DISP(FIOCTL, IOCTL_BT_HCICMD_EXT, */ -+ /* ("Connection_Handle=0x%x, BTProfile=%d, BTSpec=%d\n", */ -+ /* conHandle, btProfile, btCoreSpec)); */ -+ RTW_INFO("Connection_Handle=0x%x, BTProfile=%d, BTSpec=%d\n", conHandle, btProfile, btCoreSpec); -+ pTriple += 4; -+ } else if (pBtMgnt->ExtConfig.HCIExtensionVer >= 1) { -+ conHandle = *((pu2Byte)&pTriple[0]); -+ btProfile = pTriple[2]; -+ btCoreSpec = pTriple[3]; -+ linkRole = pTriple[4]; -+ if (BT_PROFILE_SCO == btProfile) -+ pBtMgnt->ExtConfig.NumberOfSCO++; -+ else { -+ pBtMgnt->ExtConfig.NumberOfACL++; -+ pBtMgnt->ExtConfig.aclLink[i].ConnectHandle = conHandle; -+ pBtMgnt->ExtConfig.aclLink[i].BTProfile = btProfile; -+ pBtMgnt->ExtConfig.aclLink[i].BTCoreSpec = btCoreSpec; -+ pBtMgnt->ExtConfig.aclLink[i].linkRole = linkRole; -+ } -+ /* RT_DISP(FIOCTL, IOCTL_BT_HCICMD_EXT, */ -+ RTW_INFO("Connection_Handle=0x%x, BTProfile=%d, BTSpec=%d, LinkRole=%d\n", -+ conHandle, btProfile, btCoreSpec, linkRole); -+ pTriple += 5; -+ } -+ } -+ rtw_btcoex_StackUpdateProfileInfo(); -+ -+ /* send complete event to BT */ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; /* packet # */ -+ pEvent->Data[1] = HCIOPCODELOW(HCI_LINK_STATUS_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_LINK_STATUS_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; /* status */ -+ -+ len++; -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ -+ } -+ -+ -+} -+ -+u8 rtw_btcoex_parse_HCI_BT_coex_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ rtw_HCI_event *pEvent; -+ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; -+ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; /* packet # */ -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_COEX_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_COEX_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; /* status */ -+ -+ len++; -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ -+ } -+} -+ -+u8 rtw_btcoex_parse_HCI_BT_operation_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ rtw_HCI_event *pEvent; -+ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; -+ -+ RTW_INFO("%s, OP code: %d\n", __func__, pcmd[0]); -+ -+ switch (pcmd[0]) { -+ case HCI_BT_OP_NONE: -+ RTW_INFO("[bt operation] : Operation None!!\n"); -+ break; -+ case HCI_BT_OP_INQUIRY_START: -+ RTW_INFO("[bt operation] : Inquiry start!!\n"); -+ break; -+ case HCI_BT_OP_INQUIRY_FINISH: -+ RTW_INFO("[bt operation] : Inquiry finished!!\n"); -+ break; -+ case HCI_BT_OP_PAGING_START: -+ RTW_INFO("[bt operation] : Paging is started!!\n"); -+ break; -+ case HCI_BT_OP_PAGING_SUCCESS: -+ RTW_INFO("[bt operation] : Paging complete successfully!!\n"); -+ break; -+ case HCI_BT_OP_PAGING_UNSUCCESS: -+ RTW_INFO("[bt operation] : Paging complete unsuccessfully!!\n"); -+ break; -+ case HCI_BT_OP_PAIRING_START: -+ RTW_INFO("[bt operation] : Pairing start!!\n"); -+ break; -+ case HCI_BT_OP_PAIRING_FINISH: -+ RTW_INFO("[bt operation] : Pairing finished!!\n"); -+ break; -+ case HCI_BT_OP_BT_DEV_ENABLE: -+ RTW_INFO("[bt operation] : BT Device is enabled!!\n"); -+ break; -+ case HCI_BT_OP_BT_DEV_DISABLE: -+ RTW_INFO("[bt operation] : BT Device is disabled!!\n"); -+ break; -+ default: -+ RTW_INFO("[bt operation] : Unknown, error!!\n"); -+ break; -+ } -+ -+ /* send complete event to BT */ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; /* packet # */ -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_OPERATION_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_OPERATION_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; /* status */ -+ -+ len++; -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ -+ } -+} -+ -+u8 rtw_btcoex_parse_BT_AFH_MAP_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ rtw_HCI_event *pEvent; -+ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; -+ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; /* packet # */ -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_AFH_MAP_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_AFH_MAP_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; /* status */ -+ -+ len++; -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ -+ } -+} -+ -+u8 rtw_btcoex_parse_BT_register_val_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ rtw_HCI_event *pEvent; -+ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; -+ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; /* packet # */ -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_REGISTER_VALUE_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_REGISTER_VALUE_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; /* status */ -+ -+ len++; -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ -+ } -+} -+ -+u8 rtw_btcoex_parse_HCI_BT_abnormal_notify_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ rtw_HCI_event *pEvent; -+ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; -+ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; /* packet # */ -+ pEvent->Data[1] = HCIOPCODELOW(HCI_BT_ABNORMAL_NOTIFY, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_BT_ABNORMAL_NOTIFY, OGF_EXTENSION); -+ len = len + 3; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; /* status */ -+ -+ len++; -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ -+ } -+} -+ -+u8 rtw_btcoex_parse_HCI_query_RF_status_cmd(_adapter *padapter, u8 *pcmd, u16 cmdlen) -+{ -+ u8 localBuf[6] = ""; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ rtw_HCI_event *pEvent; -+ RTW_HCI_STATUS status = HCI_STATUS_SUCCESS; -+ -+ { -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ -+ pEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE; -+ pEvent->Data[0] = 0x1; /* packet # */ -+ pEvent->Data[1] = HCIOPCODELOW(HCI_QUERY_RF_STATUS, OGF_EXTENSION); -+ pEvent->Data[2] = HCIOPCODEHIGHT(HCI_QUERY_RF_STATUS, OGF_EXTENSION); -+ len = len + 3; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ pRetPar[0] = status; /* status */ -+ -+ len++; -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+ -+ status = rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ return status; -+ /* bthci_IndicateEvent(Adapter, PPacketIrpEvent, len+2); */ -+ } -+} -+ -+/***************************************** -+* HCI cmd format : -+*| 15 - 0 | -+*| OPcode (OCF|OGF<<10) | -+*| 15 - 8 |7 - 0 | -+*|Cmd para |Cmd para Length | -+*|Cmd para...... | -+******************************************/ -+ -+/* bit 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 -+ * | OCF | OGF | */ -+void rtw_btcoex_parse_hci_extend_cmd(_adapter *padapter, u8 *pcmd, u16 len, const u16 hci_OCF) -+{ -+ -+ RTW_INFO("%s: OCF: %x\n", __func__, hci_OCF); -+ switch (hci_OCF) { -+ case HCI_EXTENSION_VERSION_NOTIFY: -+ RTW_INFO("HCI_EXTENSION_VERSION_NOTIFY\n"); -+ rtw_btcoex_parse_HCI_Ver_notify_cmd(padapter, pcmd, len); -+ break; -+ case HCI_LINK_STATUS_NOTIFY: -+ RTW_INFO("HCI_LINK_STATUS_NOTIFY\n"); -+ rtw_btcoex_parse_HCI_link_status_notify_cmd(padapter, pcmd, len); -+ break; -+ case HCI_BT_OPERATION_NOTIFY: -+ /* only for 8723a 2ant */ -+ RTW_INFO("HCI_BT_OPERATION_NOTIFY\n"); -+ rtw_btcoex_parse_HCI_BT_operation_notify_cmd(padapter, pcmd, len); -+ /* */ -+ break; -+ case HCI_ENABLE_WIFI_SCAN_NOTIFY: -+ RTW_INFO("HCI_ENABLE_WIFI_SCAN_NOTIFY\n"); -+ rtw_btcoex_parse_WIFI_scan_notify_cmd(padapter, pcmd, len); -+ break; -+ case HCI_QUERY_RF_STATUS: -+ /* only for 8723b 2ant */ -+ RTW_INFO("HCI_QUERY_RF_STATUS\n"); -+ rtw_btcoex_parse_HCI_query_RF_status_cmd(padapter, pcmd, len); -+ break; -+ case HCI_BT_ABNORMAL_NOTIFY: -+ RTW_INFO("HCI_BT_ABNORMAL_NOTIFY\n"); -+ rtw_btcoex_parse_HCI_BT_abnormal_notify_cmd(padapter, pcmd, len); -+ break; -+ case HCI_BT_INFO_NOTIFY: -+ RTW_INFO("HCI_BT_INFO_NOTIFY\n"); -+ rtw_btcoex_parse_BT_info_notify_cmd(padapter, pcmd, len); -+ break; -+ case HCI_BT_COEX_NOTIFY: -+ RTW_INFO("HCI_BT_COEX_NOTIFY\n"); -+ rtw_btcoex_parse_HCI_BT_coex_notify_cmd(padapter, pcmd, len); -+ break; -+ case HCI_BT_PATCH_VERSION_NOTIFY: -+ RTW_INFO("HCI_BT_PATCH_VERSION_NOTIFY\n"); -+ rtw_btcoex_parse_BT_patch_ver_info_cmd(padapter, pcmd, len); -+ break; -+ case HCI_BT_AFH_MAP_NOTIFY: -+ RTW_INFO("HCI_BT_AFH_MAP_NOTIFY\n"); -+ rtw_btcoex_parse_BT_AFH_MAP_notify_cmd(padapter, pcmd, len); -+ break; -+ case HCI_BT_REGISTER_VALUE_NOTIFY: -+ RTW_INFO("HCI_BT_REGISTER_VALUE_NOTIFY\n"); -+ rtw_btcoex_parse_BT_register_val_notify_cmd(padapter, pcmd, len); -+ break; -+ default: -+ RTW_INFO("ERROR!!! Unknown OCF: %x\n", hci_OCF); -+ break; -+ -+ } -+} -+ -+void rtw_btcoex_parse_hci_cmd(_adapter *padapter, u8 *pcmd, u16 len) -+{ -+ u16 opcode = pcmd[0] | pcmd[1] << 8; -+ u16 hci_OGF = HCI_OGF(opcode); -+ u16 hci_OCF = HCI_OCF(opcode); -+ u8 cmdlen = len - 3; -+ u8 pare_len = pcmd[2]; -+ -+ RTW_INFO("%s OGF: %x,OCF: %x\n", __func__, hci_OGF, hci_OCF); -+ switch (hci_OGF) { -+ case OGF_EXTENSION: -+ RTW_INFO("HCI_EXTENSION_CMD_OGF\n"); -+ rtw_btcoex_parse_hci_extend_cmd(padapter, &pcmd[3], cmdlen, hci_OCF); -+ break; -+ default: -+ RTW_INFO("Other OGF: %x\n", hci_OGF); -+ break; -+ } -+} -+ -+u16 rtw_btcoex_parse_recv_data(u8 *msg, u8 msg_size) -+{ -+ u8 cmp_msg1[32] = attend_ack; -+ u8 cmp_msg2[32] = leave_ack; -+ u8 cmp_msg3[32] = bt_leave; -+ u8 cmp_msg4[32] = invite_req; -+ u8 cmp_msg5[32] = attend_req; -+ u8 cmp_msg6[32] = invite_rsp; -+ u8 res = OTHER; -+ -+ if (_rtw_memcmp(cmp_msg1, msg, msg_size) == _TRUE) { -+ /*RTW_INFO("%s, msg:%s\n",__func__,msg);*/ -+ res = RX_ATTEND_ACK; -+ } else if (_rtw_memcmp(cmp_msg2, msg, msg_size) == _TRUE) { -+ /*RTW_INFO("%s, msg:%s\n",__func__,msg);*/ -+ res = RX_LEAVE_ACK; -+ } else if (_rtw_memcmp(cmp_msg3, msg, msg_size) == _TRUE) { -+ /*RTW_INFO("%s, msg:%s\n",__func__,msg);*/ -+ res = RX_BT_LEAVE; -+ } else if (_rtw_memcmp(cmp_msg4, msg, msg_size) == _TRUE) { -+ /*RTW_INFO("%s, msg:%s\n",__func__,msg);*/ -+ res = RX_INVITE_REQ; -+ } else if (_rtw_memcmp(cmp_msg5, msg, msg_size) == _TRUE) -+ res = RX_ATTEND_REQ; -+ else if (_rtw_memcmp(cmp_msg6, msg, msg_size) == _TRUE) -+ res = RX_INVITE_RSP; -+ else { -+ /*RTW_INFO("%s, %s\n", __func__, msg);*/ -+ res = OTHER; -+ } -+ -+ /*RTW_INFO("%s, res:%d\n", __func__, res);*/ -+ -+ return res; -+} -+ -+void rtw_btcoex_recvmsgbysocket(void *data) -+{ -+ u8 recv_data[255]; -+ u8 tx_msg[255] = leave_ack; -+ u32 len = 0; -+ u16 recv_length = 0; -+ u16 parse_res = 0; -+#if 0 -+ u8 para_len = 0, polling_enable = 0, poling_interval = 0, reason = 0, btinfo_len = 0; -+ u8 btinfo[BT_INFO_LEN] = {0}; -+#endif -+ -+ struct bt_coex_info *pcoex_info = NULL; -+ struct sock *sk = NULL; -+ struct sk_buff *skb = NULL; -+ -+ /*RTW_INFO("%s\n",__func__);*/ -+ -+ if (pbtcoexadapter == NULL) { -+ RTW_INFO("%s: btcoexadapter NULL!\n", __func__); -+ return; -+ } -+ -+ pcoex_info = &pbtcoexadapter->coex_info; -+ sk = pcoex_info->sk_store; -+ -+ if (sk == NULL) { -+ RTW_INFO("%s: critical error when receive socket data!\n", __func__); -+ return; -+ } -+ -+ len = skb_queue_len(&sk->sk_receive_queue); -+ while (len > 0) { -+ skb = skb_dequeue(&sk->sk_receive_queue); -+ -+ /*important: cut the udp header from skb->data! header length is 8 byte*/ -+ recv_length = skb->len - 8; -+ _rtw_memset(recv_data, 0, sizeof(recv_data)); -+ _rtw_memcpy(recv_data, skb->data + 8, recv_length); -+ -+ parse_res = rtw_btcoex_parse_recv_data(recv_data, recv_length); -+#if 0 -+ if (RX_ATTEND_ACK == parse_res) { -+ /* attend ack */ -+ pcoex_info->BT_attend = _TRUE; -+ RTW_INFO("RX_ATTEND_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ } else if (RX_ATTEND_REQ == parse_res) { -+ /* attend req from BT */ -+ pcoex_info->BT_attend = _TRUE; -+ RTW_INFO("RX_BT_ATTEND_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, attend_ack, sizeof(attend_ack), _FALSE); -+ } else if (RX_INVITE_REQ == parse_res) { -+ /* invite req from BT */ -+ pcoex_info->BT_attend = _TRUE; -+ RTW_INFO("RX_INVITE_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, invite_rsp, sizeof(invite_rsp), _FALSE); -+ } else if (RX_INVITE_RSP == parse_res) { -+ /* invite rsp */ -+ pcoex_info->BT_attend = _TRUE; -+ RTW_INFO("RX_INVITE_RSP!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ } else if (RX_LEAVE_ACK == parse_res) { -+ /* mean BT know wifi will leave */ -+ pcoex_info->BT_attend = _FALSE; -+ RTW_INFO("RX_LEAVE_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ } else if (RX_BT_LEAVE == parse_res) { -+ /* BT leave */ -+ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, leave_ack, sizeof(leave_ack), _FALSE); /* no ack */ -+ pcoex_info->BT_attend = _FALSE; -+ RTW_INFO("RX_BT_LEAVE!sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ } else { -+ /* todo: check if recv data are really hci cmds */ -+ if (_TRUE == pcoex_info->BT_attend) -+ rtw_btcoex_parse_hci_cmd(pbtcoexadapter, recv_data, recv_length); -+ } -+#endif -+ switch (parse_res) { -+ case RX_ATTEND_ACK: -+ /* attend ack */ -+ pcoex_info->BT_attend = _TRUE; -+ RTW_INFO("RX_ATTEND_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); -+ break; -+ -+ case RX_ATTEND_REQ: -+ pcoex_info->BT_attend = _TRUE; -+ RTW_INFO("RX_BT_ATTEND_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, attend_ack, sizeof(attend_ack), _FALSE); -+ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); -+ break; -+ -+ case RX_INVITE_REQ: -+ /* invite req from BT */ -+ pcoex_info->BT_attend = _TRUE; -+ RTW_INFO("RX_INVITE_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, invite_rsp, sizeof(invite_rsp), _FALSE); -+ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); -+ break; -+ -+ case RX_INVITE_RSP: -+ /*invite rsp*/ -+ pcoex_info->BT_attend = _TRUE; -+ RTW_INFO("RX_INVITE_RSP!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); -+ break; -+ -+ case RX_LEAVE_ACK: -+ /* mean BT know wifi will leave */ -+ pcoex_info->BT_attend = _FALSE; -+ RTW_INFO("RX_LEAVE_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); -+ break; -+ -+ case RX_BT_LEAVE: -+ /* BT leave */ -+ rtw_btcoex_sendmsgbysocket(pbtcoexadapter, leave_ack, sizeof(leave_ack), _FALSE); /* no ack */ -+ pcoex_info->BT_attend = _FALSE; -+ RTW_INFO("RX_BT_LEAVE!sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); -+ break; -+ -+ default: -+ if (_TRUE == pcoex_info->BT_attend) -+ rtw_btcoex_parse_hci_cmd(pbtcoexadapter, recv_data, recv_length); -+ else -+ RTW_INFO("ERROR!! BT is UP\n"); -+ break; -+ -+ } -+ -+ len--; -+ kfree_skb(skb); -+ } -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0)) -+ void rtw_btcoex_recvmsg_init(struct sock *sk_in, s32 bytes) -+#else -+ void rtw_btcoex_recvmsg_init(struct sock *sk_in) -+#endif -+{ -+ struct bt_coex_info *pcoex_info = NULL; -+ -+ if (pbtcoexadapter == NULL) { -+ RTW_INFO("%s: btcoexadapter NULL\n", __func__); -+ return; -+ } -+ pcoex_info = &pbtcoexadapter->coex_info; -+ pcoex_info->sk_store = sk_in; -+ if (pcoex_info->btcoex_wq != NULL) -+ queue_delayed_work(pcoex_info->btcoex_wq, &pcoex_info->recvmsg_work, 0); -+ else -+ RTW_INFO("%s: BTCOEX workqueue NULL\n", __func__); -+} -+ -+u8 rtw_btcoex_sendmsgbysocket(_adapter *padapter, u8 *msg, u8 msg_size, bool force) -+{ -+ u8 error; -+ struct msghdr udpmsg; -+ mm_segment_t oldfs; -+ struct iovec iov; -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ -+ /* RTW_INFO("%s: msg:%s, force:%s\n", __func__, msg, force == _TRUE?"TRUE":"FALSE"); */ -+ if (_FALSE == force) { -+ if (_FALSE == pcoex_info->BT_attend) { -+ RTW_INFO("TX Blocked: WiFi-BT disconnected\n"); -+ return _FAIL; -+ } -+ } -+ -+ iov.iov_base = (void *)msg; -+ iov.iov_len = msg_size; -+ udpmsg.msg_name = &pcoex_info->bt_sockaddr; -+ udpmsg.msg_namelen = sizeof(struct sockaddr_in); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ /* referece:sock_xmit in kernel code -+ * WRITE for sock_sendmsg, READ for sock_recvmsg -+ * third parameter for msg_iovlen -+ * last parameter for iov_len -+ */ -+ iov_iter_init(&udpmsg.msg_iter, WRITE, &iov, 1, msg_size); -+#else -+ udpmsg.msg_iov = &iov; -+ udpmsg.msg_iovlen = 1; -+#endif -+ udpmsg.msg_control = NULL; -+ udpmsg.msg_controllen = 0; -+ udpmsg.msg_flags = MSG_DONTWAIT | MSG_NOSIGNAL; -+ oldfs = get_fs(); -+ set_fs(KERNEL_DS); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ error = sock_sendmsg(pcoex_info->udpsock, &udpmsg); -+#else -+ error = sock_sendmsg(pcoex_info->udpsock, &udpmsg, msg_size); -+#endif -+ set_fs(oldfs); -+ if (error < 0) { -+ RTW_INFO("Error when sendimg msg, error:%d\n", error); -+ return _FAIL; -+ } else -+ return _SUCCESS; -+} -+ -+u8 rtw_btcoex_create_kernel_socket(_adapter *padapter) -+{ -+ s8 kernel_socket_err; -+ u8 tx_msg[255] = attend_req; -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ s32 sock_reuse = 1; -+ u8 status = _FAIL; -+ -+ RTW_INFO("%s CONNECT_PORT %d\n", __func__, CONNECT_PORT); -+ -+ if (NULL == pcoex_info) { -+ RTW_INFO("coex_info: NULL\n"); -+ status = _FAIL; -+ } -+ -+ kernel_socket_err = sock_create(PF_INET, SOCK_DGRAM, 0, &pcoex_info->udpsock); -+ -+ if (kernel_socket_err < 0) { -+ RTW_INFO("Error during creation of socket error:%d\n", kernel_socket_err); -+ status = _FAIL; -+ } else { -+ _rtw_memset(&(pcoex_info->wifi_sockaddr), 0, sizeof(pcoex_info->wifi_sockaddr)); -+ pcoex_info->wifi_sockaddr.sin_family = AF_INET; -+ pcoex_info->wifi_sockaddr.sin_port = htons(CONNECT_PORT); -+ pcoex_info->wifi_sockaddr.sin_addr.s_addr = htonl(INADDR_LOOPBACK); -+ -+ _rtw_memset(&(pcoex_info->bt_sockaddr), 0, sizeof(pcoex_info->bt_sockaddr)); -+ pcoex_info->bt_sockaddr.sin_family = AF_INET; -+ pcoex_info->bt_sockaddr.sin_port = htons(CONNECT_PORT_BT); -+ pcoex_info->bt_sockaddr.sin_addr.s_addr = htonl(INADDR_LOOPBACK); -+ -+ pcoex_info->sk_store = NULL; -+ kernel_socket_err = pcoex_info->udpsock->ops->bind(pcoex_info->udpsock, (struct sockaddr *)&pcoex_info->wifi_sockaddr, -+ sizeof(pcoex_info->wifi_sockaddr)); -+ if (kernel_socket_err == 0) { -+ RTW_INFO("binding socket success\n"); -+ pcoex_info->udpsock->sk->sk_data_ready = rtw_btcoex_recvmsg_init; -+ pcoex_info->sock_open |= KERNEL_SOCKET_OK; -+ pcoex_info->BT_attend = _FALSE; -+ RTW_INFO("WIFI sending attend_req\n"); -+ rtw_btcoex_sendmsgbysocket(padapter, attend_req, sizeof(attend_req), _TRUE); -+ status = _SUCCESS; -+ } else { -+ pcoex_info->BT_attend = _FALSE; -+ sock_release(pcoex_info->udpsock); /* bind fail release socket */ -+ RTW_INFO("Error binding socket: %d\n", kernel_socket_err); -+ status = _FAIL; -+ } -+ -+ } -+ -+ return status; -+} -+ -+void rtw_btcoex_close_kernel_socket(_adapter *padapter) -+{ -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ if (pcoex_info->sock_open & KERNEL_SOCKET_OK) { -+ RTW_INFO("release kernel socket\n"); -+ sock_release(pcoex_info->udpsock); -+ pcoex_info->sock_open &= ~(KERNEL_SOCKET_OK); -+ if (_TRUE == pcoex_info->BT_attend) -+ pcoex_info->BT_attend = _FALSE; -+ -+ RTW_INFO("sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); -+ } -+} -+ -+void rtw_btcoex_init_socket(_adapter *padapter) -+{ -+ -+ u8 is_invite = _FALSE; -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ RTW_INFO("%s\n", __func__); -+ if (_FALSE == pcoex_info->is_exist) { -+ _rtw_memset(pcoex_info, 0, sizeof(struct bt_coex_info)); -+ pcoex_info->btcoex_wq = create_workqueue("BTCOEX"); -+ INIT_DELAYED_WORK(&pcoex_info->recvmsg_work, -+ (void *)rtw_btcoex_recvmsgbysocket); -+ pbtcoexadapter = padapter; -+ /* We expect BT is off if BT don't send ack to wifi */ -+ RTW_INFO("We expect BT is off if BT send ack to wifi\n"); -+ rtw_btcoex_BTOffOnNotify(pbtcoexadapter, _FALSE); -+ if (rtw_btcoex_create_kernel_socket(padapter) == _SUCCESS) -+ pcoex_info->is_exist = _TRUE; -+ else { -+ pcoex_info->is_exist = _FALSE; -+ pbtcoexadapter = NULL; -+ } -+ -+ RTW_INFO("%s: pbtcoexadapter:%p, coex_info->is_exist: %s\n" -+ , __func__, pbtcoexadapter, pcoex_info->is_exist == _TRUE ? "TRUE" : "FALSE"); -+ } -+} -+ -+void rtw_btcoex_close_socket(_adapter *padapter) -+{ -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ -+ RTW_INFO("%s--coex_info->is_exist: %s, pcoex_info->BT_attend:%s\n" -+ , __func__, pcoex_info->is_exist == _TRUE ? "TRUE" : "FALSE", pcoex_info->BT_attend == _TRUE ? "TRUE" : "FALSE"); -+ -+ if (_TRUE == pcoex_info->is_exist) { -+ if (_TRUE == pcoex_info->BT_attend) { -+ /*inform BT wifi leave*/ -+ rtw_btcoex_sendmsgbysocket(padapter, wifi_leave, sizeof(wifi_leave), _FALSE); -+ msleep(50); -+ } -+ -+ if (pcoex_info->btcoex_wq != NULL) { -+ flush_workqueue(pcoex_info->btcoex_wq); -+ destroy_workqueue(pcoex_info->btcoex_wq); -+ } -+ -+ rtw_btcoex_close_kernel_socket(padapter); -+ pbtcoexadapter = NULL; -+ pcoex_info->is_exist = _FALSE; -+ } -+} -+ -+void rtw_btcoex_dump_tx_msg(u8 *tx_msg, u8 len, u8 *msg_name) -+{ -+ u8 i = 0; -+ RTW_INFO("======> Msg name: %s\n", msg_name); -+ for (i = 0; i < len; i++) -+ printk("%02x ", tx_msg[i]); -+ printk("\n"); -+ RTW_INFO("Msg name: %s <======\n", msg_name); -+} -+ -+/* Porting from Windows team */ -+void rtw_btcoex_SendEventExtBtCoexControl(PADAPTER padapter, u8 bNeedDbgRsp, u8 dataLen, void *pData) -+{ -+ u8 len = 0, tx_event_length = 0; -+ u8 localBuf[32] = ""; -+ u8 *pRetPar; -+ u8 opCode = 0; -+ u8 *pInBuf = (pu1Byte)pData; -+ u8 *pOpCodeContent; -+ rtw_HCI_event *pEvent; -+ -+ opCode = pInBuf[0]; -+ -+ RTW_INFO("%s, OPCode:%02x\n", __func__, opCode); -+ -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ /* len += bthci_ExtensionEventHeaderRtk(&localBuf[0], */ -+ /* HCI_EVENT_EXT_BT_COEX_CONTROL); */ -+ pEvent->EventCode = HCI_EVENT_EXTENSION_RTK; -+ pEvent->Data[0] = HCI_EVENT_EXT_BT_COEX_CONTROL; /* extension event code */ -+ len++; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ _rtw_memcpy(&pRetPar[0], pData, dataLen); -+ -+ len += dataLen; -+ -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+#if 0 -+ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "BT COEX CONTROL", _FALSE); -+#endif -+ rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ -+} -+ -+/* Porting from Windows team */ -+void rtw_btcoex_SendEventExtBtInfoControl(PADAPTER padapter, u8 dataLen, void *pData) -+{ -+ rtw_HCI_event *pEvent; -+ u8 *pRetPar; -+ u8 len = 0, tx_event_length = 0; -+ u8 localBuf[32] = ""; -+ -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; -+ -+ /* RTW_INFO("%s\n",__func__);*/ -+ if (pBtMgnt->ExtConfig.HCIExtensionVer < 4) { /* not support */ -+ RTW_INFO("ERROR: HCIExtensionVer = %d, HCIExtensionVer<4 !!!!\n", pBtMgnt->ExtConfig.HCIExtensionVer); -+ return; -+ } -+ -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ /* len += bthci_ExtensionEventHeaderRtk(&localBuf[0], */ -+ /* HCI_EVENT_EXT_BT_INFO_CONTROL); */ -+ pEvent->EventCode = HCI_EVENT_EXTENSION_RTK; -+ pEvent->Data[0] = HCI_EVENT_EXT_BT_INFO_CONTROL; /* extension event code */ -+ len++; -+ -+ /* Return parameters starts from here */ -+ pRetPar = &pEvent->Data[len]; -+ _rtw_memcpy(&pRetPar[0], pData, dataLen); -+ -+ len += dataLen; -+ -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+#if 0 -+ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "BT INFO CONTROL"); -+#endif -+ rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+ -+} -+ -+void rtw_btcoex_SendScanNotify(PADAPTER padapter, u8 scanType) -+{ -+ u8 len = 0, tx_event_length = 0; -+ u8 localBuf[7] = ""; -+ u8 *pRetPar; -+ u8 *pu1Temp; -+ rtw_HCI_event *pEvent; -+ struct bt_coex_info *pcoex_info = &padapter->coex_info; -+ PBT_MGNT pBtMgnt = &pcoex_info->BtMgnt; -+ -+ /* if(!pBtMgnt->BtOperationOn) -+ * return; */ -+ -+ pEvent = (rtw_HCI_event *)(&localBuf[0]); -+ -+ /* len += bthci_ExtensionEventHeaderRtk(&localBuf[0], -+ * HCI_EVENT_EXT_WIFI_SCAN_NOTIFY); */ -+ -+ pEvent->EventCode = HCI_EVENT_EXTENSION_RTK; -+ pEvent->Data[0] = HCI_EVENT_EXT_WIFI_SCAN_NOTIFY; /* extension event code */ -+ len++; -+ -+ /* Return parameters starts from here */ -+ /* pRetPar = &PPacketIrpEvent->Data[len]; */ -+ /* pu1Temp = (u8 *)&pRetPar[0]; */ -+ /* *pu1Temp = scanType; */ -+ pEvent->Data[len] = scanType; -+ len += 1; -+ -+ pEvent->Length = len; -+ -+ /* total tx event length + EventCode length + sizeof(length) */ -+ tx_event_length = pEvent->Length + 2; -+#if 0 -+ rtw_btcoex_dump_tx_msg((u8 *)pEvent, tx_event_length, "WIFI SCAN OPERATION"); -+#endif -+ rtw_btcoex_sendmsgbysocket(padapter, (u8 *)pEvent, tx_event_length, _FALSE); -+} -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+#endif /* CONFIG_BT_COEXIST */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_bt_mp.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_bt_mp.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_bt_mp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_bt_mp.c 2018-02-11 21:44:27.135145903 +0200 -@@ -0,0 +1,1580 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#include -+#include -+ -+#if defined(CONFIG_RTL8723B) -+ #include -+#endif -+ -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8821A) -+void MPh2c_timeout_handle(void *FunctionContext) -+{ -+ PADAPTER pAdapter; -+ PMPT_CONTEXT pMptCtx; -+ -+ -+ RTW_INFO("[MPT], MPh2c_timeout_handle\n"); -+ -+ pAdapter = (PADAPTER)FunctionContext; -+ pMptCtx = &pAdapter->mppriv.MptCtx; -+ -+ pMptCtx->bMPh2c_timeout = _TRUE; -+ -+ if ((_FALSE == pMptCtx->MptH2cRspEvent) -+ || ((_TRUE == pMptCtx->MptH2cRspEvent) -+ && (_FALSE == pMptCtx->MptBtC2hEvent))) -+ _rtw_up_sema(&pMptCtx->MPh2c_Sema); -+} -+ -+u32 WaitC2Hevent(PADAPTER pAdapter, u8 *C2H_event, u32 delay_time) -+{ -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ pMptCtx->bMPh2c_timeout = _FALSE; -+ -+ if (pAdapter->registrypriv.mp_mode == 0) { -+ RTW_INFO("[MPT], Error!! WaitC2Hevent mp_mode == 0!!\n"); -+ return _FALSE; -+ } -+ -+ _set_timer(&pMptCtx->MPh2c_timeout_timer, delay_time); -+ -+ _rtw_down_sema(&pMptCtx->MPh2c_Sema); -+ -+ if (pMptCtx->bMPh2c_timeout == _TRUE) { -+ *C2H_event = _FALSE; -+ -+ return _FALSE; -+ } -+ -+ /* for safty, cancel timer here again */ -+ _cancel_timer_ex(&pMptCtx->MPh2c_timeout_timer); -+ -+ return _TRUE; -+} -+ -+BT_CTRL_STATUS -+mptbt_CheckC2hFrame( -+ PADAPTER Adapter, -+ PBT_H2C pH2c, -+ PBT_EXT_C2H pExtC2h -+) -+{ -+ BT_CTRL_STATUS c2hStatus = BT_STATUS_C2H_SUCCESS; -+ -+ /* RTW_INFO("[MPT], MPT rsp C2H hex: %x %x %x %x %x %x\n"), pExtC2h , pExtC2h+1 ,pExtC2h+2 ,pExtC2h+3 ,pExtC2h+4 ,pExtC2h+5); */ -+ -+ RTW_INFO("[MPT], statusCode = 0x%x\n", pExtC2h->statusCode); -+ RTW_INFO("[MPT], retLen = %d\n", pExtC2h->retLen); -+ RTW_INFO("[MPT], opCodeVer : req/rsp=%d/%d\n", pH2c->opCodeVer, pExtC2h->opCodeVer); -+ RTW_INFO("[MPT], reqNum : req/rsp=%d/%d\n", pH2c->reqNum, pExtC2h->reqNum); -+ if (pExtC2h->reqNum != pH2c->reqNum) { -+ c2hStatus = BT_STATUS_C2H_REQNUM_MISMATCH; -+ RTW_INFO("[MPT], Error!! C2H reqNum Mismatch!!\n"); -+ } else if (pExtC2h->opCodeVer != pH2c->opCodeVer) { -+ c2hStatus = BT_STATUS_OPCODE_L_VERSION_MISMATCH; -+ RTW_INFO("[MPT], Error!! OPCode version L mismatch!!\n"); -+ } -+ -+ return c2hStatus; -+} -+ -+BT_CTRL_STATUS -+mptbt_SendH2c( -+ PADAPTER Adapter, -+ PBT_H2C pH2c, -+ u2Byte h2cCmdLen -+) -+{ -+ /* KIRQL OldIrql = KeGetCurrentIrql(); */ -+ BT_CTRL_STATUS h2cStatus = BT_STATUS_H2C_SUCCESS; -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ u1Byte i; -+ -+ RTW_INFO("[MPT], mptbt_SendH2c()=========>\n"); -+ -+ /* PlatformResetEvent(&pMptCtx->MptH2cRspEvent); */ -+ /* PlatformResetEvent(&pMptCtx->MptBtC2hEvent); */ -+ -+ /* if(OldIrql == PASSIVE_LEVEL) -+ * { */ -+ /* RTPRINT_DATA(FMPBT, FMPBT_H2C_CONTENT, ("[MPT], MPT H2C hex:\n"), pH2c, h2cCmdLen); */ -+ -+ for (i = 0; i < BT_H2C_MAX_RETRY; i++) { -+ RTW_INFO("[MPT], Send H2C command to wifi!!!\n"); -+ -+ pMptCtx->MptH2cRspEvent = _FALSE; -+ pMptCtx->MptBtC2hEvent = _FALSE; -+ -+#if defined(CONFIG_RTL8723B) -+ rtl8723b_set_FwBtMpOper_cmd(Adapter, pH2c->opCode, pH2c->opCodeVer, pH2c->reqNum, pH2c->buf); -+#endif -+ pMptCtx->h2cReqNum++; -+ pMptCtx->h2cReqNum %= 16; -+ -+ if (WaitC2Hevent(Adapter, &pMptCtx->MptH2cRspEvent, 100)) { -+ RTW_INFO("[MPT], Received WiFi MptH2cRspEvent!!!\n"); -+ if (WaitC2Hevent(Adapter, &pMptCtx->MptBtC2hEvent, 400)) { -+ RTW_INFO("[MPT], Received MptBtC2hEvent!!!\n"); -+ break; -+ } else { -+ RTW_INFO("[MPT], Error!!BT MptBtC2hEvent timeout!!\n"); -+ h2cStatus = BT_STATUS_H2C_BT_NO_RSP; -+ } -+ } else { -+ RTW_INFO("[MPT], Error!!WiFi MptH2cRspEvent timeout!!\n"); -+ h2cStatus = BT_STATUS_H2C_TIMTOUT; -+ } -+ } -+ /* } -+ * else -+ * { -+ * RT_ASSERT(FALSE, ("[MPT], mptbt_SendH2c() can only run under PASSIVE_LEVEL!!\n")); -+ * h2cStatus = BT_STATUS_WRONG_LEVEL; -+ * } */ -+ -+ RTW_INFO("[MPT], mptbt_SendH2c()<=========\n"); -+ return h2cStatus; -+} -+ -+ -+ -+BT_CTRL_STATUS -+mptbt_CheckBtRspStatus( -+ PADAPTER Adapter, -+ PBT_EXT_C2H pExtC2h -+) -+{ -+ BT_CTRL_STATUS retStatus = BT_OP_STATUS_SUCCESS; -+ -+ switch (pExtC2h->statusCode) { -+ case BT_OP_STATUS_SUCCESS: -+ retStatus = BT_STATUS_BT_OP_SUCCESS; -+ RTW_INFO("[MPT], BT status : BT_STATUS_SUCCESS\n"); -+ break; -+ case BT_OP_STATUS_VERSION_MISMATCH: -+ retStatus = BT_STATUS_OPCODE_L_VERSION_MISMATCH; -+ RTW_INFO("[MPT], BT status : BT_STATUS_OPCODE_L_VERSION_MISMATCH\n"); -+ break; -+ case BT_OP_STATUS_UNKNOWN_OPCODE: -+ retStatus = BT_STATUS_UNKNOWN_OPCODE_L; -+ RTW_INFO("[MPT], BT status : BT_STATUS_UNKNOWN_OPCODE_L\n"); -+ break; -+ case BT_OP_STATUS_ERROR_PARAMETER: -+ retStatus = BT_STATUS_PARAMETER_FORMAT_ERROR_L; -+ RTW_INFO("[MPT], BT status : BT_STATUS_PARAMETER_FORMAT_ERROR_L\n"); -+ break; -+ default: -+ retStatus = BT_STATUS_UNKNOWN_STATUS_L; -+ RTW_INFO("[MPT], BT status : BT_STATUS_UNKNOWN_STATUS_L\n"); -+ break; -+ } -+ -+ return retStatus; -+} -+ -+ -+ -+BT_CTRL_STATUS -+mptbt_BtFwOpCodeProcess( -+ PADAPTER Adapter, -+ u1Byte btFwOpCode, -+ u1Byte opCodeVer, -+ pu1Byte pH2cPar, -+ u1Byte h2cParaLen -+) -+{ -+ u1Byte H2C_Parameter[6] = {0}; -+ PBT_H2C pH2c = (PBT_H2C)&H2C_Parameter[0]; -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; -+ u2Byte paraLen = 0, i; -+ BT_CTRL_STATUS h2cStatus = BT_STATUS_H2C_SUCCESS, c2hStatus = BT_STATUS_C2H_SUCCESS; -+ BT_CTRL_STATUS retStatus = BT_STATUS_H2C_BT_NO_RSP; -+ -+ if (Adapter->registrypriv.mp_mode == 0) { -+ RTW_INFO("[MPT], Error!! mptbt_BtFwOpCodeProces mp_mode == 0!!\n"); -+ return _FALSE; -+ } -+ -+ pH2c->opCode = btFwOpCode; -+ pH2c->opCodeVer = opCodeVer; -+ pH2c->reqNum = pMptCtx->h2cReqNum; -+ /* PlatformMoveMemory(&pH2c->buf[0], pH2cPar, h2cParaLen); */ -+ /* _rtw_memcpy(&pH2c->buf[0], pH2cPar, h2cParaLen); */ -+ _rtw_memcpy(pH2c->buf, pH2cPar, h2cParaLen); -+ -+ RTW_INFO("[MPT], pH2c->opCode=%d\n", pH2c->opCode); -+ RTW_INFO("[MPT], pH2c->opCodeVer=%d\n", pH2c->opCodeVer); -+ RTW_INFO("[MPT], pH2c->reqNum=%d\n", pH2c->reqNum); -+ RTW_INFO("[MPT], h2c parameter length=%d\n", h2cParaLen); -+ for (i = 0; i < h2cParaLen; i++) -+ RTW_INFO("[MPT], parameter[%d]=0x%02x\n", i, pH2c->buf[i]); -+ -+ h2cStatus = mptbt_SendH2c(Adapter, pH2c, h2cParaLen + 2); -+ if (BT_STATUS_H2C_SUCCESS == h2cStatus) { -+ /* if reach here, it means H2C get the correct c2h response, */ -+ c2hStatus = mptbt_CheckC2hFrame(Adapter, pH2c, pExtC2h); -+ if (BT_STATUS_C2H_SUCCESS == c2hStatus) -+ retStatus = mptbt_CheckBtRspStatus(Adapter, pExtC2h); -+ else { -+ RTW_INFO("[MPT], Error!! C2H failed for pH2c->opCode=%d\n", pH2c->opCode); -+ /* check c2h status error, return error status code to upper layer. */ -+ retStatus = c2hStatus; -+ } -+ } else { -+ RTW_INFO("[MPT], Error!! H2C failed for pH2c->opCode=%d\n", pH2c->opCode); -+ /* check h2c status error, return error status code to upper layer. */ -+ retStatus = h2cStatus; -+ } -+ -+ return retStatus; -+} -+ -+ -+ -+ -+u2Byte -+mptbt_BtReady( -+ PADAPTER Adapter, -+ PBT_REQ_CMD pBtReq, -+ PBT_RSP_CMD pBtRsp -+) -+{ -+ u1Byte h2cParaBuf[6] = {0}; -+ u1Byte h2cParaLen = 0; -+ u2Byte paraLen = 0; -+ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode; -+ u1Byte btOpcodeVer = 0; -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; -+ u1Byte i; -+ u1Byte btFwVer = 0, bdAddr[6] = {0}; -+ u2Byte btRealFwVer = 0; -+ pu2Byte pu2Tmp = NULL; -+ -+ /* */ -+ /* check upper layer parameters */ -+ /* */ -+ -+ /* 1. check upper layer opcode version */ -+ if (pBtReq->opCodeVer != 1) { -+ RTW_INFO("[MPT], Error!! Upper OP code version not match!!!\n"); -+ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; -+ return paraLen; -+ } -+ -+ pBtRsp->pParamStart[0] = MP_BT_NOT_READY; -+ paraLen = 10; -+ /* */ -+ /* execute lower layer opcodes */ -+ /* */ -+ -+ /* Get BT FW version */ -+ /* fill h2c parameters */ -+ btOpcode = BT_LO_OP_GET_BT_VERSION; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } else { -+ pu2Tmp = (pu2Byte)&pExtC2h->buf[0]; -+ btRealFwVer = *pu2Tmp; -+ btFwVer = pExtC2h->buf[1]; -+ RTW_INFO("[MPT], btRealFwVer=0x%x, btFwVer=0x%x\n", btRealFwVer, btFwVer); -+ } -+ -+ /* Get BD Address */ -+ /* fill h2c parameters */ -+ btOpcode = BT_LO_OP_GET_BD_ADDR_L; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } else { -+ bdAddr[5] = pExtC2h->buf[0]; -+ bdAddr[4] = pExtC2h->buf[1]; -+ bdAddr[3] = pExtC2h->buf[2]; -+ } -+ -+ /* fill h2c parameters */ -+ btOpcode = BT_LO_OP_GET_BD_ADDR_H; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } else { -+ bdAddr[2] = pExtC2h->buf[0]; -+ bdAddr[1] = pExtC2h->buf[1]; -+ bdAddr[0] = pExtC2h->buf[2]; -+ } -+ RTW_INFO("[MPT], Local BDAddr:"); -+ for (i = 0; i < 6; i++) -+ RTW_INFO(" 0x%x ", bdAddr[i]); -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ pBtRsp->pParamStart[0] = MP_BT_READY; -+ pu2Tmp = (pu2Byte)&pBtRsp->pParamStart[1]; -+ *pu2Tmp = btRealFwVer; -+ pBtRsp->pParamStart[3] = btFwVer; -+ for (i = 0; i < 6; i++) -+ pBtRsp->pParamStart[4 + i] = bdAddr[5 - i]; -+ -+ return paraLen; -+} -+ -+void mptbt_close_WiFiRF(PADAPTER Adapter) -+{ -+ PHY_SetBBReg(Adapter, 0x824, 0xF, 0x0); -+ PHY_SetBBReg(Adapter, 0x824, 0x700000, 0x0); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x0); -+} -+ -+void mptbt_open_WiFiRF(PADAPTER Adapter) -+{ -+ PHY_SetBBReg(Adapter, 0x824, 0x700000, 0x3); -+ PHY_SetBBReg(Adapter, 0x824, 0xF, 0x2); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x3); -+} -+ -+u4Byte mptbt_switch_RF(PADAPTER Adapter, u1Byte Enter) -+{ -+ u2Byte tmp_2byte = 0; -+ -+ /* Enter test mode */ -+ if (Enter) { -+ /* 1>. close WiFi RF */ -+ mptbt_close_WiFiRF(Adapter); -+ -+ /* 2>. change ant switch to BT */ -+ tmp_2byte = rtw_read16(Adapter, 0x860); -+ tmp_2byte = tmp_2byte | BIT(9); -+ tmp_2byte = tmp_2byte & (~BIT(8)); -+ rtw_write16(Adapter, 0x860, tmp_2byte); -+ rtw_write16(Adapter, 0x870, 0x300); -+ } else { -+ /* 1>. Open WiFi RF */ -+ mptbt_open_WiFiRF(Adapter); -+ -+ /* 2>. change ant switch back */ -+ tmp_2byte = rtw_read16(Adapter, 0x860); -+ tmp_2byte = tmp_2byte | BIT(8); -+ tmp_2byte = tmp_2byte & (~BIT(9)); -+ rtw_write16(Adapter, 0x860, tmp_2byte); -+ rtw_write16(Adapter, 0x870, 0x300); -+ } -+ -+ return 0; -+} -+ -+u2Byte -+mptbt_BtSetMode( -+ PADAPTER Adapter, -+ PBT_REQ_CMD pBtReq, -+ PBT_RSP_CMD pBtRsp -+) -+{ -+ u1Byte h2cParaBuf[6] = {0}; -+ u1Byte h2cParaLen = 0; -+ u2Byte paraLen = 0; -+ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode; -+ u1Byte btOpcodeVer = 0; -+ u1Byte btModeToSet = 0; -+ -+ /* */ -+ /* check upper layer parameters */ -+ /* */ -+ /* 1. check upper layer opcode version */ -+ if (pBtReq->opCodeVer != 1) { -+ RTW_INFO("[MPT], Error!! Upper OP code version not match!!!\n"); -+ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; -+ return paraLen; -+ } -+ /* 2. check upper layer parameter length */ -+ if (1 == pBtReq->paraLength) { -+ btModeToSet = pBtReq->pParamStart[0]; -+ RTW_INFO("[MPT], BtTestMode=%d\n", btModeToSet); -+ } else { -+ RTW_INFO("[MPT], Error!! wrong parameter length=%d (should be 1)\n", pBtReq->paraLength); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ -+ /* */ -+ /* execute lower layer opcodes */ -+ /* */ -+ -+ /* 1. fill h2c parameters */ -+ /* check bt mode */ -+ btOpcode = BT_LO_OP_SET_BT_MODE; -+ if (btModeToSet >= MP_BT_MODE_MAX) { -+ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } else { -+ mptbt_switch_RF(Adapter, 1); -+ -+ h2cParaBuf[0] = btModeToSet; -+ h2cParaLen = 1; -+ /* 2. execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ /* 3. construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS == retStatus) -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ else { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ } -+ -+ return paraLen; -+} -+ -+ -+VOID -+MPTBT_FwC2hBtMpCtrl( -+ PADAPTER Adapter, -+ pu1Byte tmpBuf, -+ u1Byte length -+) -+{ -+ u32 i; -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)tmpBuf; -+ -+ if (Adapter->bBTFWReady == _FALSE || Adapter->registrypriv.mp_mode == 0) { -+ /* RTW_INFO("Ignore C2H BT MP Info since not in MP mode\n"); */ -+ return; -+ } -+ if (length > 32 || length < 3) { -+ RTW_INFO("\n [MPT], pExtC2h->buf hex: length=%d > 32 || < 3\n", length); -+ return; -+ } -+ -+ /* cancel_timeout for h2c handle */ -+ _cancel_timer_ex(&pMptCtx->MPh2c_timeout_timer); -+ -+ for (i = 0; i < length; i++) -+ RTW_INFO("[MPT], %s, buf[%d]=0x%02x ", __FUNCTION__, i, tmpBuf[i]); -+ RTW_INFO("[MPT], pExtC2h->extendId=0x%x\n", pExtC2h->extendId); -+ -+ switch (pExtC2h->extendId) { -+ case EXT_C2H_WIFI_FW_ACTIVE_RSP: -+ RTW_INFO("[MPT], EXT_C2H_WIFI_FW_ACTIVE_RSP\n"); -+#if 0 -+ RTW_INFO("[MPT], pExtC2h->buf hex:\n"); -+ for (i = 0; i < (length - 3); i++) -+ RTW_INFO(" 0x%x ", pExtC2h->buf[i]); -+#endif -+ if ((_FALSE == pMptCtx->bMPh2c_timeout) -+ && (_FALSE == pMptCtx->MptH2cRspEvent)) { -+ pMptCtx->MptH2cRspEvent = _TRUE; -+ _rtw_up_sema(&pMptCtx->MPh2c_Sema); -+ } -+ break; -+ -+ case EXT_C2H_TRIG_BY_BT_FW: -+ RTW_INFO("[MPT], EXT_C2H_TRIG_BY_BT_FW\n"); -+ _rtw_memcpy(&pMptCtx->c2hBuf[0], tmpBuf, length); -+ RTW_INFO("[MPT], pExtC2h->statusCode=0x%x\n", pExtC2h->statusCode); -+ RTW_INFO("[MPT], pExtC2h->retLen=0x%x\n", pExtC2h->retLen); -+ RTW_INFO("[MPT], pExtC2h->opCodeVer=0x%x\n", pExtC2h->opCodeVer); -+ RTW_INFO("[MPT], pExtC2h->reqNum=0x%x\n", pExtC2h->reqNum); -+ for (i = 0; i < (length - 3); i++) -+ RTW_INFO("[MPT], pExtC2h->buf[%d]=0x%02x\n", i, pExtC2h->buf[i]); -+ -+ if ((_FALSE == pMptCtx->bMPh2c_timeout) -+ && (_TRUE == pMptCtx->MptH2cRspEvent) -+ && (_FALSE == pMptCtx->MptBtC2hEvent)) { -+ pMptCtx->MptBtC2hEvent = _TRUE; -+ _rtw_up_sema(&pMptCtx->MPh2c_Sema); -+ } -+ break; -+ -+ default: -+ RTW_INFO("[MPT], EXT_C2H Target not found,pExtC2h->extendId =%d ,pExtC2h->reqNum=%d\n", pExtC2h->extendId, pExtC2h->reqNum); -+ break; -+ } -+ -+ -+ -+} -+ -+ -+u2Byte -+mptbt_BtGetGeneral( -+ IN PADAPTER Adapter, -+ IN PBT_REQ_CMD pBtReq, -+ IN PBT_RSP_CMD pBtRsp -+) -+{ -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; -+ u1Byte h2cParaBuf[6] = {0}; -+ u1Byte h2cParaLen = 0; -+ u2Byte paraLen = 0; -+ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode, bdAddr[6] = {0}; -+ u1Byte btOpcodeVer = 0; -+ u1Byte getType = 0, i; -+ u2Byte getParaLen = 0, validParaLen = 0; -+ u1Byte regType = 0, reportType = 0; -+ u4Byte regAddr = 0, regValue = 0; -+ pu4Byte pu4Tmp; -+ pu2Byte pu2Tmp; -+ pu1Byte pu1Tmp; -+ -+ /* */ -+ /* check upper layer parameters */ -+ /* */ -+ -+ /* check upper layer opcode version */ -+ if (pBtReq->opCodeVer != 1) { -+ RTW_INFO("[MPT], Error!! Upper OP code version not match!!!\n"); -+ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; -+ return paraLen; -+ } -+ /* check upper layer parameter length */ -+ if (pBtReq->paraLength < 1) { -+ RTW_INFO("[MPT], Error!! wrong parameter length=%d (should larger than 1)\n", pBtReq->paraLength); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ getParaLen = pBtReq->paraLength - 1; -+ getType = pBtReq->pParamStart[0]; -+ -+ RTW_INFO("[MPT], getType=%d, getParaLen=%d\n", getType, getParaLen); -+ -+ /* check parameter first */ -+ switch (getType) { -+ case BT_GGET_REG: -+ RTW_INFO("[MPT], [BT_GGET_REG]\n"); -+ validParaLen = 5; -+ if (getParaLen == validParaLen) { -+ btOpcode = BT_LO_OP_READ_REG; -+ regType = pBtReq->pParamStart[1]; -+ pu4Tmp = (pu4Byte)&pBtReq->pParamStart[2]; -+ regAddr = *pu4Tmp; -+ RTW_INFO("[MPT], BT_GGET_REG regType=0x%02x, regAddr=0x%08x!!\n", -+ regType, regAddr); -+ if (regType >= BT_REG_MAX) { -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } else { -+ if (((BT_REG_RF == regType) && (regAddr > 0x7f)) || -+ ((BT_REG_MODEM == regType) && (regAddr > 0x1ff)) || -+ ((BT_REG_BLUEWIZE == regType) && (regAddr > 0xfff)) || -+ ((BT_REG_VENDOR == regType) && (regAddr > 0xfff)) || -+ ((BT_REG_LE == regType) && (regAddr > 0xfff))) { -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ } -+ } -+ break; -+ case BT_GGET_STATUS: -+ RTW_INFO("[MPT], [BT_GGET_STATUS]\n"); -+ validParaLen = 0; -+ break; -+ case BT_GGET_REPORT: -+ RTW_INFO("[MPT], [BT_GGET_REPORT]\n"); -+ validParaLen = 1; -+ if (getParaLen == validParaLen) { -+ reportType = pBtReq->pParamStart[1]; -+ RTW_INFO("[MPT], BT_GGET_REPORT reportType=0x%x!!\n", reportType); -+ if (reportType >= BT_REPORT_MAX) { -+ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ } -+ break; -+ default: { -+ RTW_INFO("[MPT], Error!! getType=%d, out of range\n", getType); -+ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ break; -+ } -+ if (getParaLen != validParaLen) { -+ RTW_INFO("[MPT], Error!! wrong parameter length=%d for BT_GET_GEN_CMD cmd id=0x%x, paraLen should=0x%x\n", -+ getParaLen, getType, validParaLen); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ -+ /* */ -+ /* execute lower layer opcodes */ -+ /* */ -+ if (BT_GGET_REG == getType) { -+ /* fill h2c parameters */ -+ /* here we should write reg value first then write the address, adviced by Austin */ -+ btOpcode = BT_LO_OP_READ_REG; -+ h2cParaBuf[0] = regType; -+ h2cParaBuf[1] = pBtReq->pParamStart[2]; -+ h2cParaBuf[2] = pBtReq->pParamStart[3]; -+ h2cParaLen = 3; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ pu2Tmp = (pu2Byte)&pExtC2h->buf[0]; -+ regValue = *pu2Tmp; -+ RTW_INFO("[MPT], read reg regType=0x%02x, regAddr=0x%08x, regValue=0x%04x\n", -+ regType, regAddr, regValue); -+ -+ pu4Tmp = (pu4Byte)&pBtRsp->pParamStart[0]; -+ *pu4Tmp = regValue; -+ paraLen = 4; -+ } else if (BT_GGET_STATUS == getType) { -+ btOpcode = BT_LO_OP_GET_BT_STATUS; -+ h2cParaLen = 0; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; -+ RTW_INFO("[MPT], read bt status, testMode=0x%x, testStatus=0x%x\n", -+ pBtRsp->pParamStart[0], pBtRsp->pParamStart[1]); -+ paraLen = 2; -+ } else if (BT_GGET_REPORT == getType) { -+ switch (reportType) { -+ case BT_REPORT_RX_PACKET_CNT: { -+ RTW_INFO("[MPT], [Rx Packet Counts]\n"); -+ btOpcode = BT_LO_OP_GET_RX_PKT_CNT_L; -+ h2cParaLen = 0; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; -+ -+ btOpcode = BT_LO_OP_GET_RX_PKT_CNT_H; -+ h2cParaLen = 0; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[2] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[3] = pExtC2h->buf[1]; -+ paraLen = 4; -+ } -+ break; -+ case BT_REPORT_RX_ERROR_BITS: { -+ RTW_INFO("[MPT], [Rx Error Bits]\n"); -+ btOpcode = BT_LO_OP_GET_RX_ERROR_BITS_L; -+ h2cParaLen = 0; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; -+ -+ btOpcode = BT_LO_OP_GET_RX_ERROR_BITS_H; -+ h2cParaLen = 0; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[2] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[3] = pExtC2h->buf[1]; -+ paraLen = 4; -+ } -+ break; -+ case BT_REPORT_RSSI: { -+ RTW_INFO("[MPT], [RSSI]\n"); -+ btOpcode = BT_LO_OP_GET_RSSI; -+ h2cParaLen = 0; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; -+ paraLen = 2; -+ } -+ break; -+ case BT_REPORT_CFO_HDR_QUALITY: { -+ RTW_INFO("[MPT], [CFO & Header Quality]\n"); -+ btOpcode = BT_LO_OP_GET_CFO_HDR_QUALITY_L; -+ h2cParaLen = 0; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[0] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[1] = pExtC2h->buf[1]; -+ -+ btOpcode = BT_LO_OP_GET_CFO_HDR_QUALITY_H; -+ h2cParaLen = 0; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ pBtRsp->pParamStart[2] = pExtC2h->buf[0]; -+ pBtRsp->pParamStart[3] = pExtC2h->buf[1]; -+ paraLen = 4; -+ } -+ break; -+ case BT_REPORT_CONNECT_TARGET_BD_ADDR: { -+ RTW_INFO("[MPT], [Connected Target BD ADDR]\n"); -+ btOpcode = BT_LO_OP_GET_TARGET_BD_ADDR_L; -+ h2cParaLen = 0; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ bdAddr[5] = pExtC2h->buf[0]; -+ bdAddr[4] = pExtC2h->buf[1]; -+ bdAddr[3] = pExtC2h->buf[2]; -+ -+ btOpcode = BT_LO_OP_GET_TARGET_BD_ADDR_H; -+ h2cParaLen = 0; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ bdAddr[2] = pExtC2h->buf[0]; -+ bdAddr[1] = pExtC2h->buf[1]; -+ bdAddr[0] = pExtC2h->buf[2]; -+ -+ RTW_INFO("[MPT], Connected Target BDAddr:%s", bdAddr); -+ for (i = 0; i < 6; i++) -+ pBtRsp->pParamStart[i] = bdAddr[5 - i]; -+ paraLen = 6; -+ } -+ break; -+ default: -+ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ break; -+ } -+ } -+ -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ return paraLen; -+} -+ -+ -+ -+u2Byte -+mptbt_BtSetGeneral( -+ IN PADAPTER Adapter, -+ IN PBT_REQ_CMD pBtReq, -+ IN PBT_RSP_CMD pBtRsp -+) -+{ -+ u1Byte h2cParaBuf[6] = {0}; -+ u1Byte h2cParaLen = 0; -+ u2Byte paraLen = 0; -+ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode; -+ u1Byte btOpcodeVer = 0; -+ u1Byte setType = 0; -+ u2Byte setParaLen = 0, validParaLen = 0; -+ u1Byte regType = 0, bdAddr[6] = {0}, calVal = 0; -+ u4Byte regAddr = 0, regValue = 0; -+ pu4Byte pu4Tmp; -+ pu2Byte pu2Tmp; -+ pu1Byte pu1Tmp; -+ -+ /* */ -+ /* check upper layer parameters */ -+ /* */ -+ -+ /* check upper layer opcode version */ -+ if (pBtReq->opCodeVer != 1) { -+ RTW_INFO("[MPT], Error!! Upper OP code version not match!!!\n"); -+ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; -+ return paraLen; -+ } -+ /* check upper layer parameter length */ -+ if (pBtReq->paraLength < 1) { -+ RTW_INFO("[MPT], Error!! wrong parameter length=%d (should larger than 1)\n", pBtReq->paraLength); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ setParaLen = pBtReq->paraLength - 1; -+ setType = pBtReq->pParamStart[0]; -+ -+ RTW_INFO("[MPT], setType=%d, setParaLen=%d\n", setType, setParaLen); -+ -+ /* check parameter first */ -+ switch (setType) { -+ case BT_GSET_REG: -+ RTW_INFO("[MPT], [BT_GSET_REG]\n"); -+ validParaLen = 9; -+ if (setParaLen == validParaLen) { -+ btOpcode = BT_LO_OP_WRITE_REG_VALUE; -+ regType = pBtReq->pParamStart[1]; -+ pu4Tmp = (pu4Byte)&pBtReq->pParamStart[2]; -+ regAddr = *pu4Tmp; -+ pu4Tmp = (pu4Byte)&pBtReq->pParamStart[6]; -+ regValue = *pu4Tmp; -+ RTW_INFO("[MPT], BT_GSET_REG regType=0x%x, regAddr=0x%x, regValue=0x%x!!\n", -+ regType, regAddr, regValue); -+ if (regType >= BT_REG_MAX) { -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } else { -+ if (((BT_REG_RF == regType) && (regAddr > 0x7f)) || -+ ((BT_REG_MODEM == regType) && (regAddr > 0x1ff)) || -+ ((BT_REG_BLUEWIZE == regType) && (regAddr > 0xfff)) || -+ ((BT_REG_VENDOR == regType) && (regAddr > 0xfff)) || -+ ((BT_REG_LE == regType) && (regAddr > 0xfff))) { -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ } -+ } -+ break; -+ case BT_GSET_RESET: -+ RTW_INFO("[MPT], [BT_GSET_RESET]\n"); -+ validParaLen = 0; -+ break; -+ case BT_GSET_TARGET_BD_ADDR: -+ RTW_INFO("[MPT], [BT_GSET_TARGET_BD_ADDR]\n"); -+ validParaLen = 6; -+ if (setParaLen == validParaLen) { -+ btOpcode = BT_LO_OP_SET_TARGET_BD_ADDR_H; -+ if ((pBtReq->pParamStart[1] == 0) && -+ (pBtReq->pParamStart[2] == 0) && -+ (pBtReq->pParamStart[3] == 0) && -+ (pBtReq->pParamStart[4] == 0) && -+ (pBtReq->pParamStart[5] == 0) && -+ (pBtReq->pParamStart[6] == 0)) { -+ RTW_INFO("[MPT], Error!! targetBDAddr=all zero\n"); -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ if ((pBtReq->pParamStart[1] == 0xff) && -+ (pBtReq->pParamStart[2] == 0xff) && -+ (pBtReq->pParamStart[3] == 0xff) && -+ (pBtReq->pParamStart[4] == 0xff) && -+ (pBtReq->pParamStart[5] == 0xff) && -+ (pBtReq->pParamStart[6] == 0xff)) { -+ RTW_INFO("[MPT], Error!! targetBDAddr=all 0xf\n"); -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ bdAddr[0] = pBtReq->pParamStart[6]; -+ bdAddr[1] = pBtReq->pParamStart[5]; -+ bdAddr[2] = pBtReq->pParamStart[4]; -+ bdAddr[3] = pBtReq->pParamStart[3]; -+ bdAddr[4] = pBtReq->pParamStart[2]; -+ bdAddr[5] = pBtReq->pParamStart[1]; -+ RTW_INFO("[MPT], target BDAddr:%x,%x,%x,%x,%x,%x\n", -+ bdAddr[0], bdAddr[1], bdAddr[2], bdAddr[3], bdAddr[4], bdAddr[5]); -+ } -+ break; -+ case BT_GSET_TX_PWR_FINETUNE: -+ RTW_INFO("[MPT], [BT_GSET_TX_PWR_FINETUNE]\n"); -+ validParaLen = 1; -+ if (setParaLen == validParaLen) { -+ btOpcode = BT_LO_OP_SET_TX_POWER_CALIBRATION; -+ calVal = pBtReq->pParamStart[1]; -+ if ((calVal < 1) || (calVal > 9)) { -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ RTW_INFO("[MPT], calVal=%d\n", calVal); -+ } -+ break; -+ case BT_SET_TRACKING_INTERVAL: -+ RTW_INFO("[MPT], [BT_SET_TRACKING_INTERVAL] setParaLen =%d\n", setParaLen); -+ -+ validParaLen = 1; -+ if (setParaLen == validParaLen) -+ calVal = pBtReq->pParamStart[1]; -+ break; -+ case BT_SET_THERMAL_METER: -+ RTW_INFO("[MPT], [BT_SET_THERMAL_METER] setParaLen =%d\n", setParaLen); -+ validParaLen = 1; -+ if (setParaLen == validParaLen) -+ calVal = pBtReq->pParamStart[1]; -+ break; -+ case BT_ENABLE_CFO_TRACKING: -+ RTW_INFO("[MPT], [BT_ENABLE_CFO_TRACKING] setParaLen =%d\n", setParaLen); -+ validParaLen = 1; -+ if (setParaLen == validParaLen) -+ calVal = pBtReq->pParamStart[1]; -+ break; -+ case BT_GSET_UPDATE_BT_PATCH: -+ -+ break; -+ default: { -+ RTW_INFO("[MPT], Error!! setType=%d, out of range\n", setType); -+ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ break; -+ } -+ if (setParaLen != validParaLen) { -+ RTW_INFO("[MPT], Error!! wrong parameter length=%d for BT_SET_GEN_CMD cmd id=0x%x, paraLen should=0x%x\n", -+ setParaLen, setType, validParaLen); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ -+ /* */ -+ /* execute lower layer opcodes */ -+ /* */ -+ if (BT_GSET_REG == setType) { -+ /* fill h2c parameters */ -+ /* here we should write reg value first then write the address, adviced by Austin */ -+ btOpcode = BT_LO_OP_WRITE_REG_VALUE; -+ h2cParaBuf[0] = pBtReq->pParamStart[6]; -+ h2cParaBuf[1] = pBtReq->pParamStart[7]; -+ h2cParaBuf[2] = pBtReq->pParamStart[8]; -+ h2cParaLen = 3; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ /* write reg address */ -+ btOpcode = BT_LO_OP_WRITE_REG_ADDR; -+ h2cParaBuf[0] = regType; -+ h2cParaBuf[1] = pBtReq->pParamStart[2]; -+ h2cParaBuf[2] = pBtReq->pParamStart[3]; -+ h2cParaLen = 3; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ } else if (BT_GSET_RESET == setType) { -+ btOpcode = BT_LO_OP_RESET; -+ h2cParaLen = 0; -+ /* execute h2c and check respond c2h from bt fw is correct or not */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ } else if (BT_GSET_TARGET_BD_ADDR == setType) { -+ /* fill h2c parameters */ -+ btOpcode = BT_LO_OP_SET_TARGET_BD_ADDR_L; -+ h2cParaBuf[0] = pBtReq->pParamStart[1]; -+ h2cParaBuf[1] = pBtReq->pParamStart[2]; -+ h2cParaBuf[2] = pBtReq->pParamStart[3]; -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ btOpcode = BT_LO_OP_SET_TARGET_BD_ADDR_H; -+ h2cParaBuf[0] = pBtReq->pParamStart[4]; -+ h2cParaBuf[1] = pBtReq->pParamStart[5]; -+ h2cParaBuf[2] = pBtReq->pParamStart[6]; -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ } else if (BT_GSET_TX_PWR_FINETUNE == setType) { -+ /* fill h2c parameters */ -+ btOpcode = BT_LO_OP_SET_TX_POWER_CALIBRATION; -+ h2cParaBuf[0] = calVal; -+ h2cParaLen = 1; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ } else if (BT_SET_TRACKING_INTERVAL == setType) { -+ /* BT_LO_OP_SET_TRACKING_INTERVAL = 0x22, */ -+ /* BT_LO_OP_SET_THERMAL_METER = 0x23, */ -+ /* BT_LO_OP_ENABLE_CFO_TRACKING = 0x24, */ -+ btOpcode = BT_LO_OP_SET_TRACKING_INTERVAL; -+ h2cParaBuf[0] = calVal; -+ h2cParaLen = 1; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ } else if (BT_SET_THERMAL_METER == setType) { -+ btOpcode = BT_LO_OP_SET_THERMAL_METER; -+ h2cParaBuf[0] = calVal; -+ h2cParaLen = 1; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ } else if (BT_ENABLE_CFO_TRACKING == setType) { -+ btOpcode = BT_LO_OP_ENABLE_CFO_TRACKING; -+ h2cParaBuf[0] = calVal; -+ h2cParaLen = 1; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ } -+ -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ return paraLen; -+} -+ -+ -+ -+u2Byte -+mptbt_BtSetTxRxPars( -+ IN PADAPTER Adapter, -+ IN PBT_REQ_CMD pBtReq, -+ IN PBT_RSP_CMD pBtRsp -+) -+{ -+ u1Byte h2cParaBuf[6] = {0}; -+ u1Byte h2cParaLen = 0; -+ u2Byte paraLen = 0; -+ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode; -+ u1Byte btOpcodeVer = 0; -+ PBT_TXRX_PARAMETERS pTxRxPars = (PBT_TXRX_PARAMETERS)&pBtReq->pParamStart[0]; -+ u2Byte lenTxRx = sizeof(BT_TXRX_PARAMETERS); -+ u1Byte i; -+ u1Byte bdAddr[6] = {0}; -+ -+ /* */ -+ /* check upper layer parameters */ -+ /* */ -+ -+ /* 1. check upper layer opcode version */ -+ if (pBtReq->opCodeVer != 1) { -+ RTW_INFO("[MPT], Error!! Upper OP code version not match!!!\n"); -+ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; -+ return paraLen; -+ } -+ /* 2. check upper layer parameter length */ -+ if (pBtReq->paraLength == sizeof(BT_TXRX_PARAMETERS)) { -+ RTW_INFO("[MPT], pTxRxPars->txrxChannel=0x%x\n", pTxRxPars->txrxChannel); -+ RTW_INFO("[MPT], pTxRxPars->txrxTxPktCnt=0x%8x\n", pTxRxPars->txrxTxPktCnt); -+ RTW_INFO("[MPT], pTxRxPars->txrxTxPktInterval=0x%x\n", pTxRxPars->txrxTxPktInterval); -+ RTW_INFO("[MPT], pTxRxPars->txrxPayloadType=0x%x\n", pTxRxPars->txrxPayloadType); -+ RTW_INFO("[MPT], pTxRxPars->txrxPktType=0x%x\n", pTxRxPars->txrxPktType); -+ RTW_INFO("[MPT], pTxRxPars->txrxPayloadLen=0x%x\n", pTxRxPars->txrxPayloadLen); -+ RTW_INFO("[MPT], pTxRxPars->txrxPktHeader=0x%x\n", pTxRxPars->txrxPktHeader); -+ RTW_INFO("[MPT], pTxRxPars->txrxWhitenCoeff=0x%x\n", pTxRxPars->txrxWhitenCoeff); -+ bdAddr[0] = pTxRxPars->txrxBdaddr[5]; -+ bdAddr[1] = pTxRxPars->txrxBdaddr[4]; -+ bdAddr[2] = pTxRxPars->txrxBdaddr[3]; -+ bdAddr[3] = pTxRxPars->txrxBdaddr[2]; -+ bdAddr[4] = pTxRxPars->txrxBdaddr[1]; -+ bdAddr[5] = pTxRxPars->txrxBdaddr[0]; -+ RTW_INFO("[MPT], pTxRxPars->txrxBdaddr: %s", &bdAddr[0]); -+ RTW_INFO("[MPT], pTxRxPars->txrxTxGainIndex=0x%x\n", pTxRxPars->txrxTxGainIndex); -+ } else { -+ RTW_INFO("[MPT], Error!! pBtReq->paraLength=%d, correct Len=%d\n", pBtReq->paraLength, lenTxRx); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ -+ /* */ -+ /* execute lower layer opcodes */ -+ /* */ -+ -+ /* fill h2c parameters */ -+ btOpcode = BT_LO_OP_SET_PKT_HEADER; -+ if (pTxRxPars->txrxPktHeader > 0x3ffff) { -+ RTW_INFO("[MPT], Error!! pTxRxPars->txrxPktHeader=0x%x is out of range, (should be between 0x0~0x3ffff)\n", pTxRxPars->txrxPktHeader); -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } else { -+ h2cParaBuf[0] = (u1Byte)(pTxRxPars->txrxPktHeader & 0xff); -+ h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxPktHeader & 0xff00) >> 8); -+ h2cParaBuf[2] = (u1Byte)((pTxRxPars->txrxPktHeader & 0xff0000) >> 16); -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ /* fill h2c parameters */ -+ btOpcode = BT_LO_OP_SET_PKT_TYPE_LEN; -+ { -+ u2Byte payloadLenLimit = 0; -+ switch (pTxRxPars->txrxPktType) { -+ case MP_BT_PKT_DH1: -+ payloadLenLimit = 27 * 8; -+ break; -+ case MP_BT_PKT_DH3: -+ payloadLenLimit = 183 * 8; -+ break; -+ case MP_BT_PKT_DH5: -+ payloadLenLimit = 339 * 8; -+ break; -+ case MP_BT_PKT_2DH1: -+ payloadLenLimit = 54 * 8; -+ break; -+ case MP_BT_PKT_2DH3: -+ payloadLenLimit = 367 * 8; -+ break; -+ case MP_BT_PKT_2DH5: -+ payloadLenLimit = 679 * 8; -+ break; -+ case MP_BT_PKT_3DH1: -+ payloadLenLimit = 83 * 8; -+ break; -+ case MP_BT_PKT_3DH3: -+ payloadLenLimit = 552 * 8; -+ break; -+ case MP_BT_PKT_3DH5: -+ payloadLenLimit = 1021 * 8; -+ break; -+ case MP_BT_PKT_LE: -+ payloadLenLimit = 39 * 8; -+ break; -+ default: { -+ RTW_INFO("[MPT], Error!! Unknown pTxRxPars->txrxPktType=0x%x\n", pTxRxPars->txrxPktType); -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ break; -+ } -+ -+ if (pTxRxPars->txrxPayloadLen > payloadLenLimit) { -+ RTW_INFO("[MPT], Error!! pTxRxPars->txrxPayloadLen=0x%x, (should smaller than %d)\n", -+ pTxRxPars->txrxPayloadLen, payloadLenLimit); -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ -+ h2cParaBuf[0] = pTxRxPars->txrxPktType; -+ h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxPayloadLen & 0xff)); -+ h2cParaBuf[2] = (u1Byte)((pTxRxPars->txrxPayloadLen & 0xff00) >> 8); -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ /* fill h2c parameters */ -+ btOpcode = BT_LO_OP_SET_PKT_CNT_L_PL_TYPE; -+ if (pTxRxPars->txrxPayloadType > MP_BT_PAYLOAD_MAX) { -+ RTW_INFO("[MPT], Error!! pTxRxPars->txrxPayloadType=0x%x, (should be between 0~4)\n", pTxRxPars->txrxPayloadType); -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } else { -+ h2cParaBuf[0] = (u1Byte)((pTxRxPars->txrxTxPktCnt & 0xff)); -+ h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxTxPktCnt & 0xff00) >> 8); -+ h2cParaBuf[2] = pTxRxPars->txrxPayloadType; -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ /* fill h2c parameters */ -+ btOpcode = BT_LO_OP_SET_PKT_CNT_H_PKT_INTV; -+ if (pTxRxPars->txrxTxPktInterval > 15) { -+ RTW_INFO("[MPT], Error!! pTxRxPars->txrxTxPktInterval=0x%x, (should be between 0~15)\n", pTxRxPars->txrxTxPktInterval); -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } else { -+ h2cParaBuf[0] = (u1Byte)((pTxRxPars->txrxTxPktCnt & 0xff0000) >> 16); -+ h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxTxPktCnt & 0xff000000) >> 24); -+ h2cParaBuf[2] = pTxRxPars->txrxTxPktInterval; -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ /* fill h2c parameters */ -+ btOpcode = BT_LO_OP_SET_WHITENCOEFF; -+ { -+ h2cParaBuf[0] = pTxRxPars->txrxWhitenCoeff; -+ h2cParaLen = 1; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ -+ /* fill h2c parameters */ -+ btOpcode = BT_LO_OP_SET_CHNL_TX_GAIN; -+ if ((pTxRxPars->txrxChannel > 78) || -+ (pTxRxPars->txrxTxGainIndex > 7)) { -+ RTW_INFO("[MPT], Error!! pTxRxPars->txrxChannel=0x%x, (should be between 0~78)\n", pTxRxPars->txrxChannel); -+ RTW_INFO("[MPT], Error!! pTxRxPars->txrxTxGainIndex=0x%x, (should be between 0~7)\n", pTxRxPars->txrxTxGainIndex); -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } else { -+ h2cParaBuf[0] = pTxRxPars->txrxChannel; -+ h2cParaBuf[1] = pTxRxPars->txrxTxGainIndex; -+ h2cParaLen = 2; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ /* fill h2c parameters */ -+ btOpcode = BT_LO_OP_SET_BD_ADDR_L; -+ if ((pTxRxPars->txrxBdaddr[0] == 0) && -+ (pTxRxPars->txrxBdaddr[1] == 0) && -+ (pTxRxPars->txrxBdaddr[2] == 0) && -+ (pTxRxPars->txrxBdaddr[3] == 0) && -+ (pTxRxPars->txrxBdaddr[4] == 0) && -+ (pTxRxPars->txrxBdaddr[5] == 0)) { -+ RTW_INFO("[MPT], Error!! pTxRxPars->txrxBdaddr=all zero\n"); -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ if ((pTxRxPars->txrxBdaddr[0] == 0xff) && -+ (pTxRxPars->txrxBdaddr[1] == 0xff) && -+ (pTxRxPars->txrxBdaddr[2] == 0xff) && -+ (pTxRxPars->txrxBdaddr[3] == 0xff) && -+ (pTxRxPars->txrxBdaddr[4] == 0xff) && -+ (pTxRxPars->txrxBdaddr[5] == 0xff)) { -+ RTW_INFO("[MPT], Error!! pTxRxPars->txrxBdaddr=all 0xf\n"); -+ pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } -+ -+ { -+ h2cParaBuf[0] = pTxRxPars->txrxBdaddr[0]; -+ h2cParaBuf[1] = pTxRxPars->txrxBdaddr[1]; -+ h2cParaBuf[2] = pTxRxPars->txrxBdaddr[2]; -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ btOpcode = BT_LO_OP_SET_BD_ADDR_H; -+ { -+ h2cParaBuf[0] = pTxRxPars->txrxBdaddr[3]; -+ h2cParaBuf[1] = pTxRxPars->txrxBdaddr[4]; -+ h2cParaBuf[2] = pTxRxPars->txrxBdaddr[5]; -+ h2cParaLen = 3; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ /* ckeck bt return status. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ return paraLen; -+} -+ -+ -+ -+u2Byte -+mptbt_BtTestCtrl( -+ IN PADAPTER Adapter, -+ IN PBT_REQ_CMD pBtReq, -+ IN PBT_RSP_CMD pBtRsp -+) -+{ -+ u1Byte h2cParaBuf[6] = {0}; -+ u1Byte h2cParaLen = 0; -+ u2Byte paraLen = 0; -+ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode; -+ u1Byte btOpcodeVer = 0; -+ u1Byte testCtrl = 0; -+ -+ /* */ -+ /* check upper layer parameters */ -+ /* */ -+ -+ /* 1. check upper layer opcode version */ -+ if (pBtReq->opCodeVer != 1) { -+ RTW_INFO("[MPT], Error!! Upper OP code version not match!!!\n"); -+ pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; -+ return paraLen; -+ } -+ /* 2. check upper layer parameter length */ -+ if (1 == pBtReq->paraLength) { -+ testCtrl = pBtReq->pParamStart[0]; -+ RTW_INFO("[MPT], testCtrl=%d\n", testCtrl); -+ } else { -+ RTW_INFO("[MPT], Error!! wrong parameter length=%d (should be 1)\n", pBtReq->paraLength); -+ pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; -+ return paraLen; -+ } -+ -+ /* */ -+ /* execute lower layer opcodes */ -+ /* */ -+ -+ /* 1. fill h2c parameters */ -+ /* check bt mode */ -+ btOpcode = BT_LO_OP_TEST_CTRL; -+ if (testCtrl >= MP_BT_TEST_MAX) { -+ RTW_INFO("[MPT], Error!! testCtrl=0x%x, (should be between smaller or equal to 0x%x)\n", -+ testCtrl, MP_BT_TEST_MAX - 1); -+ pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; -+ return paraLen; -+ } else { -+ h2cParaBuf[0] = testCtrl; -+ h2cParaLen = 1; -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); -+ } -+ -+ /* 3. construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ return paraLen; -+} -+ -+ -+u2Byte -+mptbt_TestBT( -+ IN PADAPTER Adapter, -+ IN PBT_REQ_CMD pBtReq, -+ IN PBT_RSP_CMD pBtRsp -+) -+{ -+ -+ u1Byte h2cParaBuf[6] = {0}; -+ u1Byte h2cParaLen = 0; -+ u2Byte paraLen = 0; -+ u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; -+ u1Byte btOpcode; -+ u1Byte btOpcodeVer = 0; -+ u1Byte testCtrl = 0; -+ -+ /* 1. fill h2c parameters */ -+ btOpcode = 0x11; -+ h2cParaBuf[0] = 0x11; -+ h2cParaBuf[1] = 0x0; -+ h2cParaBuf[2] = 0x0; -+ h2cParaBuf[3] = 0x0; -+ h2cParaBuf[4] = 0x0; -+ h2cParaLen = 1; -+ /* retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); */ -+ retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, h2cParaBuf, h2cParaLen); -+ -+ -+ /* 3. construct respond status code and data. */ -+ if (BT_STATUS_BT_OP_SUCCESS != retStatus) { -+ pBtRsp->status = ((btOpcode << 8) | retStatus); -+ RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); -+ return paraLen; -+ } -+ -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ return paraLen; -+} -+ -+VOID -+mptbt_BtControlProcess( -+ PADAPTER Adapter, -+ PVOID pInBuf -+) -+{ -+ u1Byte H2C_Parameter[6] = {0}; -+ PBT_H2C pH2c = (PBT_H2C)&H2C_Parameter[0]; -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ PBT_REQ_CMD pBtReq = (PBT_REQ_CMD)pInBuf; -+ PBT_RSP_CMD pBtRsp; -+ u1Byte i; -+ -+ -+ RTW_INFO("[MPT], mptbt_BtControlProcess()=========>\n"); -+ -+ RTW_INFO("[MPT], input opCodeVer=%d\n", pBtReq->opCodeVer); -+ RTW_INFO("[MPT], input OpCode=%d\n", pBtReq->OpCode); -+ RTW_INFO("[MPT], paraLength=%d\n", pBtReq->paraLength); -+ if (pBtReq->paraLength) { -+ /* RTW_INFO("[MPT], parameters(hex):0x%x %d\n",&pBtReq->pParamStart[0], pBtReq->paraLength); */ -+ } -+ -+ _rtw_memset((void *)pMptCtx->mptOutBuf, 0, 100); -+ pMptCtx->mptOutLen = 4; /* length of (BT_RSP_CMD.status+BT_RSP_CMD.paraLength) */ -+ -+ pBtRsp = (PBT_RSP_CMD)pMptCtx->mptOutBuf; -+ pBtRsp->status = BT_STATUS_SUCCESS; -+ pBtRsp->paraLength = 0x0; -+ -+ /* The following we should maintain the User OP codes sent by upper layer */ -+ switch (pBtReq->OpCode) { -+ case BT_UP_OP_BT_READY: -+ RTW_INFO("[MPT], OPcode : [BT_READY]\n"); -+ pBtRsp->paraLength = mptbt_BtReady(Adapter, pBtReq, pBtRsp); -+ break; -+ case BT_UP_OP_BT_SET_MODE: -+ RTW_INFO("[MPT], OPcode : [BT_SET_MODE]\n"); -+ pBtRsp->paraLength = mptbt_BtSetMode(Adapter, pBtReq, pBtRsp); -+ break; -+ case BT_UP_OP_BT_SET_TX_RX_PARAMETER: -+ RTW_INFO("[MPT], OPcode : [BT_SET_TXRX_PARAMETER]\n"); -+ pBtRsp->paraLength = mptbt_BtSetTxRxPars(Adapter, pBtReq, pBtRsp); -+ break; -+ case BT_UP_OP_BT_SET_GENERAL: -+ RTW_INFO("[MPT], OPcode : [BT_SET_GENERAL]\n"); -+ pBtRsp->paraLength = mptbt_BtSetGeneral(Adapter, pBtReq, pBtRsp); -+ break; -+ case BT_UP_OP_BT_GET_GENERAL: -+ RTW_INFO("[MPT], OPcode : [BT_GET_GENERAL]\n"); -+ pBtRsp->paraLength = mptbt_BtGetGeneral(Adapter, pBtReq, pBtRsp); -+ break; -+ case BT_UP_OP_BT_TEST_CTRL: -+ RTW_INFO("[MPT], OPcode : [BT_TEST_CTRL]\n"); -+ pBtRsp->paraLength = mptbt_BtTestCtrl(Adapter, pBtReq, pBtRsp); -+ break; -+ case BT_UP_OP_TEST_BT: -+ RTW_INFO("[MPT], OPcode : [TEST_BT]\n"); -+ pBtRsp->paraLength = mptbt_TestBT(Adapter, pBtReq, pBtRsp); -+ break; -+ default: -+ RTW_INFO("[MPT], Error!! OPcode : UNDEFINED!!!!\n"); -+ pBtRsp->status = BT_STATUS_UNKNOWN_OPCODE_U; -+ pBtRsp->paraLength = 0x0; -+ break; -+ } -+ -+ pMptCtx->mptOutLen += pBtRsp->paraLength; -+ -+ RTW_INFO("[MPT], pMptCtx->mptOutLen=%d, pBtRsp->paraLength=%d\n", pMptCtx->mptOutLen, pBtRsp->paraLength); -+ RTW_INFO("[MPT], mptbt_BtControlProcess()<=========\n"); -+} -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_cmd.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_cmd.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_cmd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_cmd.c 2018-02-11 21:44:27.136145918 +0200 -@@ -0,0 +1,4652 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_CMD_C_ -+ -+#include -+#include -+ -+#ifndef DBG_CMD_EXECUTE -+ #define DBG_CMD_EXECUTE 0 -+#endif -+ -+/* -+Caller and the rtw_cmd_thread can protect cmd_q by spin_lock. -+No irqsave is necessary. -+*/ -+ -+sint _rtw_init_cmd_priv(struct cmd_priv *pcmdpriv) -+{ -+ sint res = _SUCCESS; -+ -+ -+ _rtw_init_sema(&(pcmdpriv->cmd_queue_sema), 0); -+ /* _rtw_init_sema(&(pcmdpriv->cmd_done_sema), 0); */ -+ /*_rtw_init_sema(&(pcmdpriv->terminate_cmdthread_sema), 0);*/ -+ _rtw_init_sema(&(pcmdpriv->start_cmdthread_sema), 0); -+ _rtw_init_completion(&pcmdpriv->cmdthread_comp); -+ -+ _rtw_init_queue(&(pcmdpriv->cmd_queue)); -+ -+ /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */ -+ -+ pcmdpriv->cmd_seq = 1; -+ -+ pcmdpriv->cmd_allocated_buf = rtw_zmalloc(MAX_CMDSZ + CMDBUFF_ALIGN_SZ); -+ -+ if (pcmdpriv->cmd_allocated_buf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pcmdpriv->cmd_buf = pcmdpriv->cmd_allocated_buf + CMDBUFF_ALIGN_SZ - ((SIZE_PTR)(pcmdpriv->cmd_allocated_buf) & (CMDBUFF_ALIGN_SZ - 1)); -+ -+ pcmdpriv->rsp_allocated_buf = rtw_zmalloc(MAX_RSPSZ + 4); -+ -+ if (pcmdpriv->rsp_allocated_buf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pcmdpriv->rsp_buf = pcmdpriv->rsp_allocated_buf + 4 - ((SIZE_PTR)(pcmdpriv->rsp_allocated_buf) & 3); -+ -+ pcmdpriv->cmd_issued_cnt = pcmdpriv->cmd_done_cnt = pcmdpriv->rsp_cnt = 0; -+ -+ _rtw_mutex_init(&pcmdpriv->sctx_mutex); -+exit: -+ -+ -+ return res; -+ -+} -+ -+#ifdef CONFIG_C2H_WK -+static void c2h_wk_callback(_workitem *work) -+{ -+ struct evt_priv *evtpriv = container_of(work, struct evt_priv, c2h_wk); -+ _adapter *adapter = container_of(evtpriv, _adapter, evtpriv); -+ u8 *c2h_evt; -+ c2h_id_filter direct_hdl_filter = rtw_hal_c2h_id_handle_directly; -+ u8 id, seq, plen; -+ u8 *payload; -+ -+ evtpriv->c2h_wk_alive = _TRUE; -+ -+ while (!rtw_cbuf_empty(evtpriv->c2h_queue)) { -+ c2h_evt = (u8 *)rtw_cbuf_pop(evtpriv->c2h_queue); -+ if (c2h_evt != NULL) { -+ /* This C2H event is read, clear it */ -+ c2h_evt_clear(adapter); -+ } else { -+ c2h_evt = (u8 *)rtw_malloc(C2H_REG_LEN); -+ if (c2h_evt == NULL) { -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ /* This C2H event is not read, read & clear now */ -+ if (rtw_hal_c2h_evt_read(adapter, c2h_evt) != _SUCCESS) { -+ rtw_mfree(c2h_evt, C2H_REG_LEN); -+ continue; -+ } -+ } -+ -+ /* Special pointer to trigger c2h_evt_clear only */ -+ if ((void *)c2h_evt == (void *)evtpriv) -+ continue; -+ -+ if (!rtw_hal_c2h_valid(adapter, c2h_evt) -+ || rtw_hal_c2h_reg_hdr_parse(adapter, c2h_evt, &id, &seq, &plen, &payload) != _SUCCESS -+ ) { -+ rtw_mfree(c2h_evt, C2H_REG_LEN); -+ continue; -+ } -+ -+ if (direct_hdl_filter(adapter, id, seq, plen, payload) == _TRUE) { -+ /* Handle directly */ -+ rtw_hal_c2h_handler(adapter, id, seq, plen, payload); -+ rtw_mfree(c2h_evt, C2H_REG_LEN); -+ } else { -+ /* Enqueue into cmd_thread for others */ -+ rtw_c2h_reg_wk_cmd(adapter, c2h_evt); -+ rtw_mfree(c2h_evt, C2H_REG_LEN); -+ } -+ } -+ -+ evtpriv->c2h_wk_alive = _FALSE; -+} -+#endif /* CONFIG_C2H_WK */ -+ -+sint _rtw_init_evt_priv(struct evt_priv *pevtpriv) -+{ -+ sint res = _SUCCESS; -+ -+ -+#ifdef CONFIG_H2CLBK -+ _rtw_init_sema(&(pevtpriv->lbkevt_done), 0); -+ pevtpriv->lbkevt_limit = 0; -+ pevtpriv->lbkevt_num = 0; -+ pevtpriv->cmdevt_parm = NULL; -+#endif -+ -+ /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */ -+ ATOMIC_SET(&pevtpriv->event_seq, 0); -+ pevtpriv->evt_done_cnt = 0; -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+ -+ _rtw_init_sema(&(pevtpriv->evt_notify), 0); -+ _rtw_init_sema(&(pevtpriv->terminate_evtthread_sema), 0); -+ -+ pevtpriv->evt_allocated_buf = rtw_zmalloc(MAX_EVTSZ + 4); -+ if (pevtpriv->evt_allocated_buf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ pevtpriv->evt_buf = pevtpriv->evt_allocated_buf + 4 - ((unsigned int)(pevtpriv->evt_allocated_buf) & 3); -+ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pevtpriv->allocated_c2h_mem = rtw_zmalloc(C2H_MEM_SZ + 4); -+ -+ if (pevtpriv->allocated_c2h_mem == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pevtpriv->c2h_mem = pevtpriv->allocated_c2h_mem + 4\ -+ - ((u32)(pevtpriv->allocated_c2h_mem) & 3); -+#ifdef PLATFORM_OS_XP -+ pevtpriv->pc2h_mdl = IoAllocateMdl((u8 *)pevtpriv->c2h_mem, C2H_MEM_SZ , FALSE, FALSE, NULL); -+ -+ if (pevtpriv->pc2h_mdl == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ MmBuildMdlForNonPagedPool(pevtpriv->pc2h_mdl); -+#endif -+#endif /* end of CONFIG_SDIO_HCI */ -+ -+ _rtw_init_queue(&(pevtpriv->evt_queue)); -+ -+exit: -+ -+#endif /* end of CONFIG_EVENT_THREAD_MODE */ -+ -+#ifdef CONFIG_C2H_WK -+ _init_workitem(&pevtpriv->c2h_wk, c2h_wk_callback, NULL); -+ pevtpriv->c2h_wk_alive = _FALSE; -+ pevtpriv->c2h_queue = rtw_cbuf_alloc(C2H_QUEUE_MAX_LEN + 1); -+#endif -+ -+ -+ return res; -+} -+ -+void _rtw_free_evt_priv(struct evt_priv *pevtpriv) -+{ -+ -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+ _rtw_free_sema(&(pevtpriv->evt_notify)); -+ _rtw_free_sema(&(pevtpriv->terminate_evtthread_sema)); -+ -+ -+ if (pevtpriv->evt_allocated_buf) -+ rtw_mfree(pevtpriv->evt_allocated_buf, MAX_EVTSZ + 4); -+#endif -+ -+#ifdef CONFIG_C2H_WK -+ _cancel_workitem_sync(&pevtpriv->c2h_wk); -+ while (pevtpriv->c2h_wk_alive) -+ rtw_msleep_os(10); -+ -+ while (!rtw_cbuf_empty(pevtpriv->c2h_queue)) { -+ void *c2h; -+ c2h = rtw_cbuf_pop(pevtpriv->c2h_queue); -+ if (c2h != NULL && c2h != (void *)pevtpriv) -+ rtw_mfree(c2h, 16); -+ } -+ rtw_cbuf_free(pevtpriv->c2h_queue); -+#endif -+ -+ -+ -+} -+ -+void _rtw_free_cmd_priv(struct cmd_priv *pcmdpriv) -+{ -+ -+ if (pcmdpriv) { -+ _rtw_spinlock_free(&(pcmdpriv->cmd_queue.lock)); -+ _rtw_free_sema(&(pcmdpriv->cmd_queue_sema)); -+ /* _rtw_free_sema(&(pcmdpriv->cmd_done_sema)); */ -+ /*_rtw_free_sema(&(pcmdpriv->terminate_cmdthread_sema));*/ -+ _rtw_free_sema(&(pcmdpriv->start_cmdthread_sema)); -+ -+ if (pcmdpriv->cmd_allocated_buf) -+ rtw_mfree(pcmdpriv->cmd_allocated_buf, MAX_CMDSZ + CMDBUFF_ALIGN_SZ); -+ -+ if (pcmdpriv->rsp_allocated_buf) -+ rtw_mfree(pcmdpriv->rsp_allocated_buf, MAX_RSPSZ + 4); -+ -+ _rtw_mutex_free(&pcmdpriv->sctx_mutex); -+ } -+} -+ -+/* -+Calling Context: -+ -+rtw_enqueue_cmd can only be called between kernel thread, -+since only spin_lock is used. -+ -+ISR/Call-Back functions can't call this sub-function. -+ -+*/ -+#ifdef DBG_CMD_QUEUE -+extern u8 dump_cmd_id; -+#endif -+ -+sint _rtw_enqueue_cmd(_queue *queue, struct cmd_obj *obj, bool to_head) -+{ -+ _irqL irqL; -+ -+ -+ if (obj == NULL) -+ goto exit; -+ -+ /* _enter_critical_bh(&queue->lock, &irqL); */ -+ _enter_critical(&queue->lock, &irqL); -+ -+ if (to_head) -+ rtw_list_insert_head(&obj->list, &queue->queue); -+ else -+ rtw_list_insert_tail(&obj->list, &queue->queue); -+ -+#ifdef DBG_CMD_QUEUE -+ if (dump_cmd_id) { -+ printk("%s===> cmdcode:0x%02x\n", __FUNCTION__, obj->cmdcode); -+ if (obj->cmdcode == GEN_CMD_CODE(_Set_MLME_EVT)) { -+ if (obj->parmbuf) { -+ struct C2HEvent_Header *pc2h_evt_hdr = (struct C2HEvent_Header *)(obj->parmbuf); -+ printk("pc2h_evt_hdr->ID:0x%02x(%d)\n", pc2h_evt_hdr->ID, pc2h_evt_hdr->ID); -+ } -+ } -+ if (obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { -+ if (obj->parmbuf) { -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)(obj->parmbuf); -+ printk("pdrvextra_cmd_parm->ec_id:0x%02x\n", pdrvextra_cmd_parm->ec_id); -+ } -+ } -+ } -+ -+ if (queue->queue.prev->next != &queue->queue) { -+ RTW_INFO("[%d] head %p, tail %p, tail->prev->next %p[tail], tail->next %p[head]\n", __LINE__, -+ &queue->queue, queue->queue.prev, queue->queue.prev->prev->next, queue->queue.prev->next); -+ -+ RTW_INFO("==========%s============\n", __FUNCTION__); -+ RTW_INFO("head:%p,obj_addr:%p\n", &queue->queue, obj); -+ RTW_INFO("padapter: %p\n", obj->padapter); -+ RTW_INFO("cmdcode: 0x%02x\n", obj->cmdcode); -+ RTW_INFO("res: %d\n", obj->res); -+ RTW_INFO("parmbuf: %p\n", obj->parmbuf); -+ RTW_INFO("cmdsz: %d\n", obj->cmdsz); -+ RTW_INFO("rsp: %p\n", obj->rsp); -+ RTW_INFO("rspsz: %d\n", obj->rspsz); -+ RTW_INFO("sctx: %p\n", obj->sctx); -+ RTW_INFO("list->next: %p\n", obj->list.next); -+ RTW_INFO("list->prev: %p\n", obj->list.prev); -+ } -+#endif /* DBG_CMD_QUEUE */ -+ -+ /* _exit_critical_bh(&queue->lock, &irqL); */ -+ _exit_critical(&queue->lock, &irqL); -+ -+exit: -+ -+ -+ return _SUCCESS; -+} -+ -+struct cmd_obj *_rtw_dequeue_cmd(_queue *queue) -+{ -+ _irqL irqL; -+ struct cmd_obj *obj; -+ -+ -+ /* _enter_critical_bh(&(queue->lock), &irqL); */ -+ _enter_critical(&queue->lock, &irqL); -+ -+#ifdef DBG_CMD_QUEUE -+ if (queue->queue.prev->next != &queue->queue) { -+ RTW_INFO("[%d] head %p, tail %p, tail->prev->next %p[tail], tail->next %p[head]\n", __LINE__, -+ &queue->queue, queue->queue.prev, queue->queue.prev->prev->next, queue->queue.prev->next); -+ } -+#endif /* DBG_CMD_QUEUE */ -+ -+ -+ if (rtw_is_list_empty(&(queue->queue))) -+ obj = NULL; -+ else { -+ obj = LIST_CONTAINOR(get_next(&(queue->queue)), struct cmd_obj, list); -+ -+#ifdef DBG_CMD_QUEUE -+ if (queue->queue.prev->next != &queue->queue) { -+ RTW_INFO("==========%s============\n", __FUNCTION__); -+ RTW_INFO("head:%p,obj_addr:%p\n", &queue->queue, obj); -+ RTW_INFO("padapter: %p\n", obj->padapter); -+ RTW_INFO("cmdcode: 0x%02x\n", obj->cmdcode); -+ RTW_INFO("res: %d\n", obj->res); -+ RTW_INFO("parmbuf: %p\n", obj->parmbuf); -+ RTW_INFO("cmdsz: %d\n", obj->cmdsz); -+ RTW_INFO("rsp: %p\n", obj->rsp); -+ RTW_INFO("rspsz: %d\n", obj->rspsz); -+ RTW_INFO("sctx: %p\n", obj->sctx); -+ RTW_INFO("list->next: %p\n", obj->list.next); -+ RTW_INFO("list->prev: %p\n", obj->list.prev); -+ } -+ -+ if (dump_cmd_id) { -+ RTW_INFO("%s===> cmdcode:0x%02x\n", __FUNCTION__, obj->cmdcode); -+ if (obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { -+ if (obj->parmbuf) { -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)(obj->parmbuf); -+ printk("pdrvextra_cmd_parm->ec_id:0x%02x\n", pdrvextra_cmd_parm->ec_id); -+ } -+ } -+ -+ } -+#endif /* DBG_CMD_QUEUE */ -+ -+ rtw_list_delete(&obj->list); -+ } -+ -+ /* _exit_critical_bh(&(queue->lock), &irqL); */ -+ _exit_critical(&queue->lock, &irqL); -+ -+ -+ return obj; -+} -+ -+u32 rtw_init_cmd_priv(struct cmd_priv *pcmdpriv) -+{ -+ u32 res; -+ res = _rtw_init_cmd_priv(pcmdpriv); -+ return res; -+} -+ -+u32 rtw_init_evt_priv(struct evt_priv *pevtpriv) -+{ -+ int res; -+ res = _rtw_init_evt_priv(pevtpriv); -+ return res; -+} -+ -+void rtw_free_evt_priv(struct evt_priv *pevtpriv) -+{ -+ _rtw_free_evt_priv(pevtpriv); -+} -+ -+void rtw_free_cmd_priv(struct cmd_priv *pcmdpriv) -+{ -+ _rtw_free_cmd_priv(pcmdpriv); -+} -+ -+int rtw_cmd_filter(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj); -+int rtw_cmd_filter(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj) -+{ -+ u8 bAllow = _FALSE; /* set to _TRUE to allow enqueuing cmd when hw_init_completed is _FALSE */ -+ -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+ /* To decide allow or not */ -+ if ((adapter_to_pwrctl(pcmdpriv->padapter)->bHWPwrPindetect) -+ && (!pcmdpriv->padapter->registrypriv.usbss_enable) -+ ) { -+ if (cmd_obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)cmd_obj->parmbuf; -+ if (pdrvextra_cmd_parm->ec_id == POWER_SAVING_CTRL_WK_CID) { -+ /* RTW_INFO("==>enqueue POWER_SAVING_CTRL_WK_CID\n"); */ -+ bAllow = _TRUE; -+ } -+ } -+ } -+#endif -+ -+ if (cmd_obj->cmdcode == GEN_CMD_CODE(_SetChannelPlan)) -+ bAllow = _TRUE; -+ -+ if (cmd_obj->no_io) -+ bAllow = _TRUE; -+ -+ if ((!rtw_is_hw_init_completed(pcmdpriv->padapter) && (bAllow == _FALSE)) -+ || ATOMIC_READ(&(pcmdpriv->cmdthd_running)) == _FALSE /* com_thread not running */ -+ ) { -+ if (DBG_CMD_EXECUTE) -+ RTW_INFO(ADPT_FMT" drop "CMD_FMT" hw_init_completed:%u, cmdthd_running:%u\n", ADPT_ARG(cmd_obj->padapter) -+ , CMD_ARG(cmd_obj), rtw_get_hw_init_completed(cmd_obj->padapter), ATOMIC_READ(&pcmdpriv->cmdthd_running)); -+ if (0) -+ rtw_warn_on(1); -+ -+ return _FAIL; -+ } -+ return _SUCCESS; -+} -+ -+ -+ -+u32 rtw_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj) -+{ -+ int res = _FAIL; -+ PADAPTER padapter = pcmdpriv->padapter; -+ -+ -+ if (cmd_obj == NULL) -+ goto exit; -+ -+ cmd_obj->padapter = padapter; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ /* change pcmdpriv to primary's pcmdpriv */ -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ pcmdpriv = &(GET_PRIMARY_ADAPTER(padapter)->cmdpriv); -+#endif -+ -+ res = rtw_cmd_filter(pcmdpriv, cmd_obj); -+ if ((_FAIL == res) || (cmd_obj->cmdsz > MAX_CMDSZ)) { -+ if (cmd_obj->cmdsz > MAX_CMDSZ) { -+ RTW_INFO("%s failed due to obj->cmdsz(%d) > MAX_CMDSZ(%d)\n", __func__, cmd_obj->cmdsz, MAX_CMDSZ); -+ rtw_warn_on(1); -+ } -+ -+ if (cmd_obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { -+ struct drvextra_cmd_parm *extra_parm = (struct drvextra_cmd_parm *)cmd_obj->parmbuf; -+ -+ if (extra_parm->pbuf && extra_parm->size > 0) -+ rtw_mfree(extra_parm->pbuf, extra_parm->size); -+ } -+ rtw_free_cmd_obj(cmd_obj); -+ goto exit; -+ } -+ -+ res = _rtw_enqueue_cmd(&pcmdpriv->cmd_queue, cmd_obj, 0); -+ -+ if (res == _SUCCESS) -+ _rtw_up_sema(&pcmdpriv->cmd_queue_sema); -+ -+exit: -+ -+ -+ return res; -+} -+ -+struct cmd_obj *rtw_dequeue_cmd(struct cmd_priv *pcmdpriv) -+{ -+ struct cmd_obj *cmd_obj; -+ -+ -+ cmd_obj = _rtw_dequeue_cmd(&pcmdpriv->cmd_queue); -+ -+ return cmd_obj; -+} -+ -+void rtw_cmd_clr_isr(struct cmd_priv *pcmdpriv) -+{ -+ pcmdpriv->cmd_done_cnt++; -+ /* _rtw_up_sema(&(pcmdpriv->cmd_done_sema)); */ -+} -+ -+void rtw_free_cmd_obj(struct cmd_obj *pcmd) -+{ -+ struct drvextra_cmd_parm *extra_parm = NULL; -+ -+ if (pcmd->parmbuf != NULL) { -+ /* free parmbuf in cmd_obj */ -+ rtw_mfree((unsigned char *)pcmd->parmbuf, pcmd->cmdsz); -+ } -+ if (pcmd->rsp != NULL) { -+ if (pcmd->rspsz != 0) { -+ /* free rsp in cmd_obj */ -+ rtw_mfree((unsigned char *)pcmd->rsp, pcmd->rspsz); -+ } -+ } -+ -+ /* free cmd_obj */ -+ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); -+ -+} -+ -+ -+void rtw_stop_cmd_thread(_adapter *adapter) -+{ -+ if (adapter->cmdThread && -+ ATOMIC_READ(&(adapter->cmdpriv.cmdthd_running)) == _TRUE && -+ adapter->cmdpriv.stop_req == 0) { -+ adapter->cmdpriv.stop_req = 1; -+ _rtw_up_sema(&adapter->cmdpriv.cmd_queue_sema); -+ /*_rtw_down_sema(&adapter->cmdpriv.terminate_cmdthread_sema);*/ -+ rtw_wait_for_thread_stop(&adapter->cmdpriv.cmdthread_comp); -+ } -+} -+ -+thread_return rtw_cmd_thread(thread_context context) -+{ -+ u8 ret; -+ struct cmd_obj *pcmd; -+ u8 *pcmdbuf, *prspbuf; -+ u32 cmd_start_time; -+ u32 cmd_process_time; -+ u8(*cmd_hdl)(_adapter *padapter, u8 *pbuf); -+ void (*pcmd_callback)(_adapter *dev, struct cmd_obj *pcmd); -+ PADAPTER padapter = (PADAPTER)context; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ struct drvextra_cmd_parm *extra_parm = NULL; -+ _irqL irqL; -+ -+ thread_enter("RTW_CMD_THREAD"); -+ -+ pcmdbuf = pcmdpriv->cmd_buf; -+ prspbuf = pcmdpriv->rsp_buf; -+ -+ pcmdpriv->stop_req = 0; -+ ATOMIC_SET(&(pcmdpriv->cmdthd_running), _TRUE); -+ /*_rtw_up_sema(&pcmdpriv->terminate_cmdthread_sema);*/ -+ _rtw_up_sema(&pcmdpriv->start_cmdthread_sema); -+ -+ -+ while (1) { -+ if (_rtw_down_sema(&pcmdpriv->cmd_queue_sema) == _FAIL) { -+ RTW_PRINT(FUNC_ADPT_FMT" _rtw_down_sema(&pcmdpriv->cmd_queue_sema) return _FAIL, break\n", FUNC_ADPT_ARG(padapter)); -+ break; -+ } -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ RTW_PRINT("%s: DriverStopped(%s) SurpriseRemoved(%s) break at line %d\n", -+ __func__ -+ , rtw_is_drv_stopped(padapter) ? "True" : "False" -+ , rtw_is_surprise_removed(padapter) ? "True" : "False" -+ , __LINE__); -+ break; -+ } -+ -+ if (pcmdpriv->stop_req) { -+ RTW_PRINT(FUNC_ADPT_FMT" stop_req:%u, break\n", FUNC_ADPT_ARG(padapter), pcmdpriv->stop_req); -+ break; -+ } -+ -+ _enter_critical(&pcmdpriv->cmd_queue.lock, &irqL); -+ if (rtw_is_list_empty(&(pcmdpriv->cmd_queue.queue))) { -+ /* RTW_INFO("%s: cmd queue is empty!\n", __func__); */ -+ _exit_critical(&pcmdpriv->cmd_queue.lock, &irqL); -+ continue; -+ } -+ _exit_critical(&pcmdpriv->cmd_queue.lock, &irqL); -+ -+_next: -+ if (RTW_CANNOT_RUN(padapter)) { -+ RTW_PRINT("%s: DriverStopped(%s) SurpriseRemoved(%s) break at line %d\n", -+ __func__ -+ , rtw_is_drv_stopped(padapter) ? "True" : "False" -+ , rtw_is_surprise_removed(padapter) ? "True" : "False" -+ , __LINE__); -+ break; -+ } -+ -+ pcmd = rtw_dequeue_cmd(pcmdpriv); -+ if (!pcmd) { -+#ifdef CONFIG_LPS_LCLK -+ rtw_unregister_cmd_alive(padapter); -+#endif -+ continue; -+ } -+ -+ cmd_start_time = rtw_get_current_time(); -+ pcmdpriv->cmd_issued_cnt++; -+ -+ if (pcmd->cmdsz > MAX_CMDSZ) { -+ RTW_ERR("%s cmdsz:%d > MAX_CMDSZ:%d\n", __func__, pcmd->cmdsz, MAX_CMDSZ); -+ pcmd->res = H2C_PARAMETERS_ERROR; -+ goto post_process; -+ } -+ -+ if (pcmd->cmdcode >= (sizeof(wlancmds) / sizeof(struct cmd_hdl))) { -+ RTW_ERR("%s undefined cmdcode:%d\n", __func__, pcmd->cmdcode); -+ pcmd->res = H2C_PARAMETERS_ERROR; -+ goto post_process; -+ } -+ -+ cmd_hdl = wlancmds[pcmd->cmdcode].h2cfuns; -+ if (!cmd_hdl) { -+ RTW_ERR("%s no cmd_hdl for cmdcode:%d\n", __func__, pcmd->cmdcode); -+ pcmd->res = H2C_PARAMETERS_ERROR; -+ goto post_process; -+ } -+ -+ if (_FAIL == rtw_cmd_filter(pcmdpriv, pcmd)) { -+ pcmd->res = H2C_DROPPED; -+ if (pcmd->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { -+ extra_parm = (struct drvextra_cmd_parm *)pcmd->parmbuf; -+ if (extra_parm && extra_parm->pbuf && extra_parm->size > 0) -+ rtw_mfree(extra_parm->pbuf, extra_parm->size); -+ } -+ goto post_process; -+ } -+ -+#ifdef CONFIG_LPS_LCLK -+ if (pcmd->no_io) -+ rtw_unregister_cmd_alive(padapter); -+ else { -+ if (rtw_register_cmd_alive(padapter) != _SUCCESS) { -+ if (DBG_CMD_EXECUTE) -+ RTW_PRINT("%s: wait to leave LPS_LCLK\n", __func__); -+ -+ pcmd->res = H2C_ENQ_HEAD; -+ ret = _rtw_enqueue_cmd(&pcmdpriv->cmd_queue, pcmd, 1); -+ if (ret == _SUCCESS) { -+ if (DBG_CMD_EXECUTE) -+ RTW_INFO(ADPT_FMT" "CMD_FMT" ENQ_HEAD\n", ADPT_ARG(pcmd->padapter), CMD_ARG(pcmd)); -+ continue; -+ } -+ -+ RTW_INFO(ADPT_FMT" "CMD_FMT" ENQ_HEAD_FAIL\n", ADPT_ARG(pcmd->padapter), CMD_ARG(pcmd)); -+ pcmd->res = H2C_ENQ_HEAD_FAIL; -+ rtw_warn_on(1); -+ } -+ } -+#endif /* CONFIG_LPS_LCLK */ -+ -+ if (DBG_CMD_EXECUTE) -+ RTW_INFO(ADPT_FMT" "CMD_FMT" %sexecute\n", ADPT_ARG(pcmd->padapter), CMD_ARG(pcmd) -+ , pcmd->res == H2C_ENQ_HEAD ? "ENQ_HEAD " : (pcmd->res == H2C_ENQ_HEAD_FAIL ? "ENQ_HEAD_FAIL " : "")); -+ -+ _rtw_memcpy(pcmdbuf, pcmd->parmbuf, pcmd->cmdsz); -+ ret = cmd_hdl(pcmd->padapter, pcmdbuf); -+ pcmd->res = ret; -+ -+ pcmdpriv->cmd_seq++; -+ -+post_process: -+ -+ _enter_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); -+ if (pcmd->sctx) { -+ if (0) -+ RTW_PRINT(FUNC_ADPT_FMT" pcmd->sctx\n", FUNC_ADPT_ARG(pcmd->padapter)); -+ if (pcmd->res == H2C_SUCCESS) -+ rtw_sctx_done(&pcmd->sctx); -+ else -+ rtw_sctx_done_err(&pcmd->sctx, RTW_SCTX_DONE_CMD_ERROR); -+ } -+ _exit_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); -+ -+ cmd_process_time = rtw_get_passing_time_ms(cmd_start_time); -+ if (cmd_process_time > 1000) { -+ RTW_INFO(ADPT_FMT" "CMD_FMT" process_time=%d\n", ADPT_ARG(pcmd->padapter), CMD_ARG(pcmd), cmd_process_time); -+ if (0) -+ rtw_warn_on(1); -+ } -+ -+ /* call callback function for post-processed */ -+ if (pcmd->cmdcode < (sizeof(rtw_cmd_callback) / sizeof(struct _cmd_callback))) { -+ pcmd_callback = rtw_cmd_callback[pcmd->cmdcode].callback; -+ if (pcmd_callback == NULL) { -+ rtw_free_cmd_obj(pcmd); -+ } else { -+ /* todo: !!! fill rsp_buf to pcmd->rsp if (pcmd->rsp!=NULL) */ -+ pcmd_callback(pcmd->padapter, pcmd);/* need conider that free cmd_obj in rtw_cmd_callback */ -+ } -+ } else { -+ rtw_free_cmd_obj(pcmd); -+ } -+ -+ flush_signals_thread(); -+ -+ goto _next; -+ -+ } -+ -+#ifdef CONFIG_LPS_LCLK -+ rtw_unregister_cmd_alive(padapter); -+#endif -+ -+ /* to avoid enqueue cmd after free all cmd_obj */ -+ ATOMIC_SET(&(pcmdpriv->cmdthd_running), _FALSE); -+ -+ /* free all cmd_obj resources */ -+ do { -+ pcmd = rtw_dequeue_cmd(pcmdpriv); -+ if (pcmd == NULL) -+ break; -+ -+ if (0) -+ RTW_INFO("%s: leaving... drop "CMD_FMT"\n", __func__, CMD_ARG(pcmd)); -+ -+ if (pcmd->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) { -+ extra_parm = (struct drvextra_cmd_parm *)pcmd->parmbuf; -+ if (extra_parm->pbuf && extra_parm->size > 0) -+ rtw_mfree(extra_parm->pbuf, extra_parm->size); -+ } -+ -+ _enter_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); -+ if (pcmd->sctx) { -+ if (0) -+ RTW_PRINT(FUNC_ADPT_FMT" pcmd->sctx\n", FUNC_ADPT_ARG(pcmd->padapter)); -+ rtw_sctx_done_err(&pcmd->sctx, RTW_SCTX_DONE_CMD_DROP); -+ } -+ _exit_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); -+ -+ rtw_free_cmd_obj(pcmd); -+ } while (1); -+ -+ /*_rtw_up_sema(&pcmdpriv->terminate_cmdthread_sema);*/ -+ thread_exit(&pcmdpriv->cmdthread_comp); -+ return 0; -+} -+ -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+u32 rtw_enqueue_evt(struct evt_priv *pevtpriv, struct evt_obj *obj) -+{ -+ _irqL irqL; -+ int res; -+ _queue *queue = &pevtpriv->evt_queue; -+ -+ -+ res = _SUCCESS; -+ -+ if (obj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ rtw_list_insert_tail(&obj->list, &queue->queue); -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ /* rtw_evt_notify_isr(pevtpriv); */ -+ -+exit: -+ -+ -+ return res; -+} -+ -+struct evt_obj *rtw_dequeue_evt(_queue *queue) -+{ -+ _irqL irqL; -+ struct evt_obj *pevtobj; -+ -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ if (rtw_is_list_empty(&(queue->queue))) -+ pevtobj = NULL; -+ else { -+ pevtobj = LIST_CONTAINOR(get_next(&(queue->queue)), struct evt_obj, list); -+ rtw_list_delete(&pevtobj->list); -+ } -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ -+ return pevtobj; -+} -+ -+void rtw_free_evt_obj(struct evt_obj *pevtobj) -+{ -+ -+ if (pevtobj->parmbuf) -+ rtw_mfree((unsigned char *)pevtobj->parmbuf, pevtobj->evtsz); -+ -+ rtw_mfree((unsigned char *)pevtobj, sizeof(struct evt_obj)); -+ -+} -+ -+void rtw_evt_notify_isr(struct evt_priv *pevtpriv) -+{ -+ pevtpriv->evt_done_cnt++; -+ _rtw_up_sema(&(pevtpriv->evt_notify)); -+} -+#endif -+ -+ -+/* -+u8 rtw_setstandby_cmd(unsigned char *adapter) -+*/ -+u8 rtw_setstandby_cmd(_adapter *padapter, uint action) -+{ -+ struct cmd_obj *ph2c; -+ struct usb_suspend_parm *psetusbsuspend; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 ret = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ psetusbsuspend = (struct usb_suspend_parm *)rtw_zmalloc(sizeof(struct usb_suspend_parm)); -+ if (psetusbsuspend == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ psetusbsuspend->action = action; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetusbsuspend, GEN_CMD_CODE(_SetUsbSuspend)); -+ -+ ret = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return ret; -+} -+ -+/* -+rtw_sitesurvey_cmd(~) -+ ### NOTE:#### (!!!!) -+ MUST TAKE CARE THAT BEFORE CALLING THIS FUNC, YOU SHOULD HAVE LOCKED pmlmepriv->lock -+*/ -+u8 rtw_sitesurvey_cmd(_adapter *padapter, NDIS_802_11_SSID *ssid, int ssid_num, -+ struct rtw_ieee80211_channel *ch, int ch_num) -+{ -+ u8 res = _FAIL; -+ struct cmd_obj *ph2c; -+ struct sitesurvey_parm *psurveyPara; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P */ -+ -+ -+#ifdef CONFIG_LPS -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SCAN, 1); -+#endif -+ -+#ifdef CONFIG_P2P_PS -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ p2p_ps_wk_cmd(padapter, P2P_PS_SCAN, 1); -+#endif /* CONFIG_P2P_PS */ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) -+ return _FAIL; -+ -+ psurveyPara = (struct sitesurvey_parm *)rtw_zmalloc(sizeof(struct sitesurvey_parm)); -+ if (psurveyPara == NULL) { -+ rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); -+ return _FAIL; -+ } -+ -+ rtw_free_network_queue(padapter, _FALSE); -+ -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psurveyPara, GEN_CMD_CODE(_SiteSurvey)); -+ -+ /* psurveyPara->bsslimit = 48; */ -+ psurveyPara->scan_mode = pmlmepriv->scan_mode; -+ -+ /* prepare ssid list */ -+ if (ssid) { -+ int i; -+ for (i = 0; i < ssid_num && i < RTW_SSID_SCAN_AMOUNT; i++) { -+ if (ssid[i].SsidLength) { -+ _rtw_memcpy(&psurveyPara->ssid[i], &ssid[i], sizeof(NDIS_802_11_SSID)); -+ psurveyPara->ssid_num++; -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" ssid:(%s, %d)\n", FUNC_ADPT_ARG(padapter), -+ psurveyPara->ssid[i].Ssid, psurveyPara->ssid[i].SsidLength); -+ } -+ } -+ } -+ -+ /* prepare channel list */ -+ if (ch) { -+ int i; -+ for (i = 0; i < ch_num && i < RTW_CHANNEL_SCAN_AMOUNT; i++) { -+ if (ch[i].hw_value && !(ch[i].flags & RTW_IEEE80211_CHAN_DISABLED)) { -+ _rtw_memcpy(&psurveyPara->ch[i], &ch[i], sizeof(struct rtw_ieee80211_channel)); -+ psurveyPara->ch_num++; -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" ch:%u\n", FUNC_ADPT_ARG(padapter), -+ psurveyPara->ch[i].hw_value); -+ } -+ } -+ } -+ -+ set_fwstate(pmlmepriv, _FW_UNDER_SURVEY); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+ if (res == _SUCCESS) { -+ -+ pmlmepriv->scan_start_time = rtw_get_current_time(); -+ -+#ifdef CONFIG_SCAN_BACKOP -+ if (rtw_mi_buddy_check_mlmeinfo_state(padapter, WIFI_FW_AP_STATE)) { -+ if (IsSupported5G(padapter->registrypriv.wireless_mode) -+ && IsSupported24G(padapter->registrypriv.wireless_mode)) /* dual band */ -+ mlme_set_scan_to_timer(pmlmepriv, CONC_SCANNING_TIMEOUT_DUAL_BAND); -+ else /* single band */ -+ mlme_set_scan_to_timer(pmlmepriv, CONC_SCANNING_TIMEOUT_SINGLE_BAND); -+ } else -+#endif /* CONFIG_SCAN_BACKOP */ -+ mlme_set_scan_to_timer(pmlmepriv, SCANNING_TIMEOUT); -+ -+ rtw_led_control(padapter, LED_CTL_SITE_SURVEY); -+ } else -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ -+ -+ return res; -+} -+ -+u8 rtw_setdatarate_cmd(_adapter *padapter, u8 *rateset) -+{ -+ struct cmd_obj *ph2c; -+ struct setdatarate_parm *pbsetdataratepara; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pbsetdataratepara = (struct setdatarate_parm *)rtw_zmalloc(sizeof(struct setdatarate_parm)); -+ if (pbsetdataratepara == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pbsetdataratepara, GEN_CMD_CODE(_SetDataRate)); -+#ifdef MP_FIRMWARE_OFFLOAD -+ pbsetdataratepara->curr_rateidx = *(u32 *)rateset; -+ /* _rtw_memcpy(pbsetdataratepara, rateset, sizeof(u32)); */ -+#else -+ pbsetdataratepara->mac_id = 5; -+ _rtw_memcpy(pbsetdataratepara->datarates, rateset, NumRates); -+#endif -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ -+ return res; -+} -+ -+u8 rtw_setbasicrate_cmd(_adapter *padapter, u8 *rateset) -+{ -+ struct cmd_obj *ph2c; -+ struct setbasicrate_parm *pssetbasicratepara; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ pssetbasicratepara = (struct setbasicrate_parm *)rtw_zmalloc(sizeof(struct setbasicrate_parm)); -+ -+ if (pssetbasicratepara == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pssetbasicratepara, _SetBasicRate_CMD_); -+ -+ _rtw_memcpy(pssetbasicratepara->basicrates, rateset, NumRates); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ -+ return res; -+} -+ -+ -+/* -+unsigned char rtw_setphy_cmd(unsigned char *adapter) -+ -+1. be called only after rtw_update_registrypriv_dev_network( ~) or mp testing program -+2. for AdHoc/Ap mode or mp mode? -+ -+*/ -+u8 rtw_setphy_cmd(_adapter *padapter, u8 modem, u8 ch) -+{ -+ struct cmd_obj *ph2c; -+ struct setphy_parm *psetphypara; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ /* struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ * struct registry_priv* pregistry_priv = &padapter->registrypriv; */ -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ psetphypara = (struct setphy_parm *)rtw_zmalloc(sizeof(struct setphy_parm)); -+ -+ if (psetphypara == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetphypara, _SetPhy_CMD_); -+ -+ -+ psetphypara->modem = modem; -+ psetphypara->rfchannel = ch; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ return res; -+} -+ -+u8 rtw_getmacreg_cmd(_adapter *padapter, u8 len, u32 addr) -+{ -+ struct cmd_obj *ph2c; -+ struct readMAC_parm *preadmacparm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ preadmacparm = (struct readMAC_parm *)rtw_zmalloc(sizeof(struct readMAC_parm)); -+ -+ if (preadmacparm == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, preadmacparm, GEN_CMD_CODE(_GetMACReg)); -+ -+ preadmacparm->len = len; -+ preadmacparm->addr = addr; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+void rtw_usb_catc_trigger_cmd(_adapter *padapter, const char *caller) -+{ -+ RTW_INFO("%s caller:%s\n", __func__, caller); -+ rtw_getmacreg_cmd(padapter, 1, 0x1c4); -+} -+ -+u8 rtw_setbbreg_cmd(_adapter *padapter, u8 offset, u8 val) -+{ -+ struct cmd_obj *ph2c; -+ struct writeBB_parm *pwritebbparm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ pwritebbparm = (struct writeBB_parm *)rtw_zmalloc(sizeof(struct writeBB_parm)); -+ -+ if (pwritebbparm == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pwritebbparm, GEN_CMD_CODE(_SetBBReg)); -+ -+ pwritebbparm->offset = offset; -+ pwritebbparm->value = val; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ return res; -+} -+ -+u8 rtw_getbbreg_cmd(_adapter *padapter, u8 offset, u8 *pval) -+{ -+ struct cmd_obj *ph2c; -+ struct readBB_parm *prdbbparm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ prdbbparm = (struct readBB_parm *)rtw_zmalloc(sizeof(struct readBB_parm)); -+ -+ if (prdbbparm == NULL) { -+ rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); -+ return _FAIL; -+ } -+ -+ _rtw_init_listhead(&ph2c->list); -+ ph2c->cmdcode = GEN_CMD_CODE(_GetBBReg); -+ ph2c->parmbuf = (unsigned char *)prdbbparm; -+ ph2c->cmdsz = sizeof(struct readBB_parm); -+ ph2c->rsp = pval; -+ ph2c->rspsz = sizeof(struct readBB_rsp); -+ -+ prdbbparm->offset = offset; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ return res; -+} -+ -+u8 rtw_setrfreg_cmd(_adapter *padapter, u8 offset, u32 val) -+{ -+ struct cmd_obj *ph2c; -+ struct writeRF_parm *pwriterfparm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ pwriterfparm = (struct writeRF_parm *)rtw_zmalloc(sizeof(struct writeRF_parm)); -+ -+ if (pwriterfparm == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pwriterfparm, GEN_CMD_CODE(_SetRFReg)); -+ -+ pwriterfparm->offset = offset; -+ pwriterfparm->value = val; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ return res; -+} -+ -+u8 rtw_getrfreg_cmd(_adapter *padapter, u8 offset, u8 *pval) -+{ -+ struct cmd_obj *ph2c; -+ struct readRF_parm *prdrfparm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ prdrfparm = (struct readRF_parm *)rtw_zmalloc(sizeof(struct readRF_parm)); -+ if (prdrfparm == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_init_listhead(&ph2c->list); -+ ph2c->cmdcode = GEN_CMD_CODE(_GetRFReg); -+ ph2c->parmbuf = (unsigned char *)prdrfparm; -+ ph2c->cmdsz = sizeof(struct readRF_parm); -+ ph2c->rsp = pval; -+ ph2c->rspsz = sizeof(struct readRF_rsp); -+ -+ prdrfparm->offset = offset; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+} -+ -+void rtw_getbbrfreg_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) -+{ -+ -+ /* rtw_free_cmd_obj(pcmd); */ -+ rtw_mfree((unsigned char *) pcmd->parmbuf, pcmd->cmdsz); -+ rtw_mfree((unsigned char *) pcmd, sizeof(struct cmd_obj)); -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) -+ padapter->mppriv.workparam.bcompleted = _TRUE; -+#endif -+} -+ -+void rtw_readtssi_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) -+{ -+ -+ rtw_mfree((unsigned char *) pcmd->parmbuf, pcmd->cmdsz); -+ rtw_mfree((unsigned char *) pcmd, sizeof(struct cmd_obj)); -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) -+ padapter->mppriv.workparam.bcompleted = _TRUE; -+#endif -+ -+} -+ -+static u8 rtw_createbss_cmd(_adapter *adapter, int flags, bool adhoc -+ , s16 req_ch, s8 req_bw, s8 req_offset) -+{ -+ struct cmd_obj *cmdobj; -+ struct createbss_parm *parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; -+ -+ if (req_ch > 0 && req_bw >= 0 && req_offset >= 0) { -+ if (!rtw_chset_is_chbw_valid(adapter->mlmeextpriv.channel_set, req_ch, req_bw, req_offset)) { -+ res = _FAIL; -+ goto exit; -+ } -+ } -+ -+ /* prepare cmd parameter */ -+ parm = (struct createbss_parm *)rtw_zmalloc(sizeof(*parm)); -+ if (parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ if (adhoc) { -+ /* for now, adhoc doesn't support ch,bw,offset request */ -+ parm->adhoc = 1; -+ } else { -+ parm->adhoc = 0; -+ parm->req_ch = req_ch; -+ parm->req_bw = req_bw; -+ parm->req_offset = req_offset; -+ } -+ -+ if (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != createbss_hdl(adapter, (u8 *)parm)) -+ res = _FAIL; -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ } else { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_CreateBss)); -+ -+ if (flags & RTW_CMDF_WAIT_ACK) { -+ cmdobj->sctx = &sctx; -+ rtw_sctx_init(&sctx, 2000); -+ } -+ -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ -+ if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { -+ rtw_sctx_wait(&sctx, __func__); -+ _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ if (sctx.status == RTW_SCTX_SUBMITTED) -+ cmdobj->sctx = NULL; -+ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ } -+ } -+ -+exit: -+ return res; -+} -+ -+inline u8 rtw_create_ibss_cmd(_adapter *adapter, int flags) -+{ -+ return rtw_createbss_cmd(adapter, flags -+ , 1 -+ , 0, -1, -1 /* for now, adhoc doesn't support ch,bw,offset request */ -+ ); -+} -+ -+inline u8 rtw_startbss_cmd(_adapter *adapter, int flags) -+{ -+ return rtw_createbss_cmd(adapter, flags -+ , 0 -+ , 0, -1, -1 /* excute entire AP setup cmd */ -+ ); -+} -+ -+inline u8 rtw_change_bss_chbw_cmd(_adapter *adapter, int flags, s16 req_ch, s8 req_bw, s8 req_offset) -+{ -+ return rtw_createbss_cmd(adapter, flags -+ , 0 -+ , req_ch, req_bw, req_offset -+ ); -+} -+ -+u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) -+{ -+ u8 *auth, res = _SUCCESS; -+ uint t_len = 0; -+ WLAN_BSSID_EX *psecnetwork; -+ struct cmd_obj *pcmd; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+#ifdef CONFIG_80211N_HT -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+#endif /* CONFIG_80211N_HT */ -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+#endif /* CONFIG_80211AC_VHT */ -+ NDIS_802_11_NETWORK_INFRASTRUCTURE ndis_network_mode = pnetwork->network.InfrastructureMode; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u32 tmp_len; -+ u8 *ptmp = NULL; -+#ifdef CONFIG_RTW_80211R -+ struct _ft_priv *pftpriv = &pmlmepriv->ftpriv; -+#endif -+ -+ rtw_led_control(padapter, LED_CTL_START_TO_LINK); -+ -+ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+#if 0 -+ /* for IEs is pointer */ -+ t_len = sizeof(ULONG) + sizeof(NDIS_802_11_MAC_ADDRESS) + 2 + -+ sizeof(NDIS_802_11_SSID) + sizeof(ULONG) + -+ sizeof(NDIS_802_11_RSSI) + sizeof(NDIS_802_11_NETWORK_TYPE) + -+ sizeof(NDIS_802_11_CONFIGURATION) + -+ sizeof(NDIS_802_11_NETWORK_INFRASTRUCTURE) + -+ sizeof(NDIS_802_11_RATES_EX) + sizeof(WLAN_PHY_INFO) + sizeof(ULONG) + MAX_IE_SZ; -+#endif -+ /* for IEs is fix buf size */ -+ t_len = sizeof(WLAN_BSSID_EX); -+ -+ -+ /* for hidden ap to set fw_state here */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) != _TRUE) { -+ switch (ndis_network_mode) { -+ case Ndis802_11IBSS: -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ break; -+ -+ case Ndis802_11Infrastructure: -+ set_fwstate(pmlmepriv, WIFI_STATION_STATE); -+ break; -+ -+ case Ndis802_11APMode: -+ case Ndis802_11AutoUnknown: -+ case Ndis802_11InfrastructureMax: -+ case Ndis802_11Monitor: -+ break; -+ -+ } -+ } -+ -+ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->network.IEs, pnetwork->network.IELength); -+ -+ /* -+ Modified by Arvin 2015/05/13 -+ Solution for allocating a new WLAN_BSSID_EX to avoid race condition issue between disconnect and joinbss -+ */ -+ psecnetwork = (WLAN_BSSID_EX *)rtw_zmalloc(sizeof(WLAN_BSSID_EX)); -+ if (psecnetwork == NULL) { -+ if (pcmd != NULL) -+ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); -+ -+ res = _FAIL; -+ -+ -+ goto exit; -+ } -+ -+ _rtw_memset(psecnetwork, 0, t_len); -+ -+ _rtw_memcpy(psecnetwork, &pnetwork->network, get_WLAN_BSSID_EX_sz(&pnetwork->network)); -+ -+ auth = &psecuritypriv->authenticator_ie[0]; -+ psecuritypriv->authenticator_ie[0] = (unsigned char)psecnetwork->IELength; -+ -+ if ((psecnetwork->IELength - 12) < (256 - 1)) -+ _rtw_memcpy(&psecuritypriv->authenticator_ie[1], &psecnetwork->IEs[12], psecnetwork->IELength - 12); -+ else -+ _rtw_memcpy(&psecuritypriv->authenticator_ie[1], &psecnetwork->IEs[12], (256 - 1)); -+ -+ psecnetwork->IELength = 0; -+ /* Added by Albert 2009/02/18 */ -+ /* If the the driver wants to use the bssid to create the connection. */ -+ /* If not, we have to copy the connecting AP's MAC address to it so that */ -+ /* the driver just has the bssid information for PMKIDList searching. */ -+ -+ if (pmlmepriv->assoc_by_bssid == _FALSE) -+ _rtw_memcpy(&pmlmepriv->assoc_bssid[0], &pnetwork->network.MacAddress[0], ETH_ALEN); -+ -+ psecnetwork->IELength = rtw_restruct_sec_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength); -+ -+ -+ pqospriv->qos_option = 0; -+ -+ if (pregistrypriv->wmm_enable) { -+ tmp_len = rtw_restruct_wmm_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength, psecnetwork->IELength); -+ -+ if (psecnetwork->IELength != tmp_len) { -+ psecnetwork->IELength = tmp_len; -+ pqospriv->qos_option = 1; /* There is WMM IE in this corresp. beacon */ -+ } else { -+ pqospriv->qos_option = 0;/* There is no WMM IE in this corresp. beacon */ -+ } -+ } -+ -+#ifdef CONFIG_80211N_HT -+ phtpriv->ht_option = _FALSE; -+ ptmp = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &tmp_len, pnetwork->network.IELength - 12); -+ if (pregistrypriv->ht_enable && ptmp && tmp_len > 0) { -+ /* Added by Albert 2010/06/23 */ -+ /* For the WEP mode, we will use the bg mode to do the connection to avoid some IOT issue. */ -+ /* Especially for Realtek 8192u SoftAP. */ -+ if ((padapter->securitypriv.dot11PrivacyAlgrthm != _WEP40_) && -+ (padapter->securitypriv.dot11PrivacyAlgrthm != _WEP104_) && -+ (padapter->securitypriv.dot11PrivacyAlgrthm != _TKIP_)) { -+ rtw_ht_use_default_setting(padapter); -+ -+ rtw_build_wmm_ie_ht(padapter, &psecnetwork->IEs[0], &psecnetwork->IELength); -+ -+ /* rtw_restructure_ht_ie */ -+ rtw_restructure_ht_ie(padapter, &pnetwork->network.IEs[12], &psecnetwork->IEs[0], -+ pnetwork->network.IELength - 12, &psecnetwork->IELength, -+ pnetwork->network.Configuration.DSConfig); -+ } -+ } -+ -+#ifdef CONFIG_80211AC_VHT -+ pvhtpriv->vht_option = _FALSE; -+ if (phtpriv->ht_option -+ && REGSTY_IS_11AC_ENABLE(pregistrypriv) -+ && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) -+ && (!pmlmepriv->country_ent || COUNTRY_CHPLAN_EN_11AC(pmlmepriv->country_ent)) -+ ) { -+ rtw_restructure_vht_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], -+ pnetwork->network.IELength, &psecnetwork->IELength); -+ } -+#endif -+ -+ rtw_append_exented_cap(padapter, &psecnetwork->IEs[0], &psecnetwork->IELength); -+ -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_RTW_80211R -+ /*IEEE802.11-2012 Std. Table 8-101¡XAKM suite selectors*/ -+ if ((rtw_chk_ft_flags(padapter, RTW_FT_STA_SUPPORTED)) && -+ ((psecuritypriv->rsn_akm_suite_type == 3) || (psecuritypriv->rsn_akm_suite_type == 4)) -+ ) { -+ ptmp = rtw_get_ie(&pnetwork->network.IEs[12], _MDIE_, &tmp_len, pnetwork->network.IELength-12); -+ if (ptmp) { -+ _rtw_memcpy(&pftpriv->mdid, ptmp+2, 2); -+ pftpriv->ft_cap = *(ptmp+4); -+ -+ RTW_INFO("FT: Target AP "MAC_FMT" MDID=(0x%2x), capacity=(0x%2x)\n", MAC_ARG(pnetwork->network.MacAddress), pftpriv->mdid, pftpriv->ft_cap); -+ rtw_set_ft_flags(padapter, RTW_FT_SUPPORTED); -+ if ((rtw_chk_ft_flags(padapter, RTW_FT_STA_OVER_DS_SUPPORTED)) && (pftpriv->ft_roam_on_expired == _FALSE) && (pftpriv->ft_cap & 0x01)) -+ rtw_set_ft_flags(padapter, RTW_FT_OVER_DS_SUPPORTED); -+ } else { -+ /*Don't use FT roaming if Target AP cannot support FT*/ -+ RTW_INFO("FT: Target AP "MAC_FMT" could not support FT\n", MAC_ARG(pnetwork->network.MacAddress)); -+ rtw_clr_ft_flags(padapter, RTW_FT_SUPPORTED|RTW_FT_OVER_DS_SUPPORTED); -+ rtw_reset_ft_status(padapter); -+ } -+ } else { -+ /*It could be a non-FT connection*/ -+ RTW_INFO("FT: non-FT rtw_joinbss_cmd\n"); -+ rtw_clr_ft_flags(padapter, RTW_FT_SUPPORTED|RTW_FT_OVER_DS_SUPPORTED); -+ rtw_reset_ft_status(padapter); -+ } -+#endif -+ -+#if 0 -+ psecuritypriv->supplicant_ie[0] = (u8)psecnetwork->IELength; -+ -+ if (psecnetwork->IELength < (256 - 1)) -+ _rtw_memcpy(&psecuritypriv->supplicant_ie[1], &psecnetwork->IEs[0], psecnetwork->IELength); -+ else -+ _rtw_memcpy(&psecuritypriv->supplicant_ie[1], &psecnetwork->IEs[0], (256 - 1)); -+#endif -+ -+ pcmd->cmdsz = sizeof(WLAN_BSSID_EX); -+ -+#ifdef CONFIG_RTL8712 -+ /* wlan_network endian conversion */ -+ psecnetwork->Length = cpu_to_le32(psecnetwork->Length); -+ psecnetwork->Ssid.SsidLength = cpu_to_le32(psecnetwork->Ssid.SsidLength); -+ psecnetwork->Privacy = cpu_to_le32(psecnetwork->Privacy); -+ psecnetwork->Rssi = cpu_to_le32(psecnetwork->Rssi); -+ psecnetwork->NetworkTypeInUse = cpu_to_le32(psecnetwork->NetworkTypeInUse); -+ psecnetwork->Configuration.ATIMWindow = cpu_to_le32(psecnetwork->Configuration.ATIMWindow); -+ psecnetwork->Configuration.BeaconPeriod = cpu_to_le32(psecnetwork->Configuration.BeaconPeriod); -+ psecnetwork->Configuration.DSConfig = cpu_to_le32(psecnetwork->Configuration.DSConfig); -+ psecnetwork->Configuration.FHConfig.DwellTime = cpu_to_le32(psecnetwork->Configuration.FHConfig.DwellTime); -+ psecnetwork->Configuration.FHConfig.HopPattern = cpu_to_le32(psecnetwork->Configuration.FHConfig.HopPattern); -+ psecnetwork->Configuration.FHConfig.HopSet = cpu_to_le32(psecnetwork->Configuration.FHConfig.HopSet); -+ psecnetwork->Configuration.FHConfig.Length = cpu_to_le32(psecnetwork->Configuration.FHConfig.Length); -+ psecnetwork->Configuration.Length = cpu_to_le32(psecnetwork->Configuration.Length); -+ psecnetwork->InfrastructureMode = cpu_to_le32(psecnetwork->InfrastructureMode); -+ psecnetwork->IELength = cpu_to_le32(psecnetwork->IELength); -+#endif -+ -+ _rtw_init_listhead(&pcmd->list); -+ pcmd->cmdcode = _JoinBss_CMD_;/* GEN_CMD_CODE(_JoinBss) */ -+ pcmd->parmbuf = (unsigned char *)psecnetwork; -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ -+ -+ return res; -+} -+ -+u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, bool enqueue) /* for sta_mode */ -+{ -+ struct cmd_obj *cmdobj = NULL; -+ struct disconnect_parm *param = NULL; -+ struct cmd_priv *cmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ -+ /* prepare cmd parameter */ -+ param = (struct disconnect_parm *)rtw_zmalloc(sizeof(*param)); -+ if (param == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ param->deauth_timeout_ms = deauth_timeout_ms; -+ -+ if (enqueue) { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ rtw_mfree((u8 *)param, sizeof(*param)); -+ goto exit; -+ } -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, param, _DisConnect_CMD_); -+ res = rtw_enqueue_cmd(cmdpriv, cmdobj); -+ } else { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != disconnect_hdl(padapter, (u8 *)param)) -+ res = _FAIL; -+ rtw_mfree((u8 *)param, sizeof(*param)); -+ } -+ -+exit: -+ -+ -+ return res; -+} -+ -+u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, bool enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct setopmode_parm *psetop; -+ -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ psetop = (struct setopmode_parm *)rtw_zmalloc(sizeof(struct setopmode_parm)); -+ -+ if (psetop == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ psetop->mode = (u8)networktype; -+ -+ if (enqueue) { -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ rtw_mfree((u8 *)psetop, sizeof(*psetop)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetop, _SetOpMode_CMD_); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } else { -+ setopmode_hdl(padapter, (u8 *)psetop); -+ rtw_mfree((u8 *)psetop, sizeof(*psetop)); -+ } -+exit: -+ -+ -+ return res; -+} -+ -+u8 rtw_setstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 key_type, bool enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct set_stakey_parm *psetstakey_para; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct set_stakey_rsp *psetstakey_rsp = NULL; -+ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u8 res = _SUCCESS; -+ -+ -+ psetstakey_para = (struct set_stakey_parm *)rtw_zmalloc(sizeof(struct set_stakey_parm)); -+ if (psetstakey_para == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ psetstakey_para->algorithm = (unsigned char) psecuritypriv->dot11PrivacyAlgrthm; -+ else -+ GET_ENCRY_ALGO(psecuritypriv, sta, psetstakey_para->algorithm, _FALSE); -+ -+ if (key_type == GROUP_KEY) -+ _rtw_memcpy(&psetstakey_para->key, &psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey, 16); -+ else if (key_type == UNICAST_KEY) -+ _rtw_memcpy(&psetstakey_para->key, &sta->dot118021x_UncstKey, 16); -+#ifdef CONFIG_TDLS -+ else if (key_type == TDLS_KEY) { -+ _rtw_memcpy(&psetstakey_para->key, sta->tpk.tk, 16); -+ psetstakey_para->algorithm = (u8)sta->dot118021XPrivacy; -+ } -+#endif /* CONFIG_TDLS */ -+ -+ /* jeff: set this becasue at least sw key is ready */ -+ padapter->securitypriv.busetkipkey = _TRUE; -+ -+ if (enqueue) { -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ psetstakey_rsp = (struct set_stakey_rsp *)rtw_zmalloc(sizeof(struct set_stakey_rsp)); -+ if (psetstakey_rsp == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); -+ ph2c->rsp = (u8 *) psetstakey_rsp; -+ ph2c->rspsz = sizeof(struct set_stakey_rsp); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } else { -+ set_stakey_hdl(padapter, (u8 *)psetstakey_para); -+ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); -+ } -+exit: -+ -+ -+ return res; -+} -+ -+u8 rtw_clearstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct set_stakey_parm *psetstakey_para; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct set_stakey_rsp *psetstakey_rsp = NULL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ s16 cam_id = 0; -+ u8 res = _SUCCESS; -+ -+ -+ if (!enqueue) { -+ while ((cam_id = rtw_camid_search(padapter, sta->hwaddr, -1, -1)) >= 0) { -+ RTW_PRINT("clear key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(sta->hwaddr), cam_id); -+ clear_cam_entry(padapter, cam_id); -+ rtw_camid_free(padapter, cam_id); -+ } -+ } else { -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ psetstakey_para = (struct set_stakey_parm *)rtw_zmalloc(sizeof(struct set_stakey_parm)); -+ if (psetstakey_para == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ psetstakey_rsp = (struct set_stakey_rsp *)rtw_zmalloc(sizeof(struct set_stakey_rsp)); -+ if (psetstakey_rsp == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); -+ ph2c->rsp = (u8 *) psetstakey_rsp; -+ ph2c->rspsz = sizeof(struct set_stakey_rsp); -+ -+ _rtw_memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN); -+ -+ psetstakey_para->algorithm = _NO_PRIVACY_; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+ } -+ -+exit: -+ -+ -+ return res; -+} -+ -+u8 rtw_setrttbl_cmd(_adapter *padapter, struct setratable_parm *prate_table) -+{ -+ struct cmd_obj *ph2c; -+ struct setratable_parm *psetrttblparm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ psetrttblparm = (struct setratable_parm *)rtw_zmalloc(sizeof(struct setratable_parm)); -+ -+ if (psetrttblparm == NULL) { -+ rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetrttblparm, GEN_CMD_CODE(_SetRaTable)); -+ -+ _rtw_memcpy(psetrttblparm, prate_table, sizeof(struct setratable_parm)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ return res; -+ -+} -+ -+u8 rtw_getrttbl_cmd(_adapter *padapter, struct getratable_rsp *pval) -+{ -+ struct cmd_obj *ph2c; -+ struct getratable_parm *pgetrttblparm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ pgetrttblparm = (struct getratable_parm *)rtw_zmalloc(sizeof(struct getratable_parm)); -+ -+ if (pgetrttblparm == NULL) { -+ rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ /* init_h2fwcmd_w_parm_no_rsp(ph2c, psetrttblparm, GEN_CMD_CODE(_SetRaTable)); */ -+ -+ _rtw_init_listhead(&ph2c->list); -+ ph2c->cmdcode = GEN_CMD_CODE(_GetRaTable); -+ ph2c->parmbuf = (unsigned char *)pgetrttblparm; -+ ph2c->cmdsz = sizeof(struct getratable_parm); -+ ph2c->rsp = (u8 *)pval; -+ ph2c->rspsz = sizeof(struct getratable_rsp); -+ -+ pgetrttblparm->rsvd = 0x0; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ return res; -+ -+} -+ -+u8 rtw_setassocsta_cmd(_adapter *padapter, u8 *mac_addr) -+{ -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct cmd_obj *ph2c; -+ struct set_assocsta_parm *psetassocsta_para; -+ struct set_stakey_rsp *psetassocsta_rsp = NULL; -+ -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ psetassocsta_para = (struct set_assocsta_parm *)rtw_zmalloc(sizeof(struct set_assocsta_parm)); -+ if (psetassocsta_para == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ psetassocsta_rsp = (struct set_stakey_rsp *)rtw_zmalloc(sizeof(struct set_assocsta_rsp)); -+ if (psetassocsta_rsp == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *) psetassocsta_para, sizeof(struct set_assocsta_parm)); -+ return _FAIL; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetassocsta_para, _SetAssocSta_CMD_); -+ ph2c->rsp = (u8 *) psetassocsta_rsp; -+ ph2c->rspsz = sizeof(struct set_assocsta_rsp); -+ -+ _rtw_memcpy(psetassocsta_para->addr, mac_addr, ETH_ALEN); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+} -+ -+u8 rtw_addbareq_cmd(_adapter *padapter, u8 tid, u8 *addr) -+{ -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct cmd_obj *ph2c; -+ struct addBaReq_parm *paddbareq_parm; -+ -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ paddbareq_parm = (struct addBaReq_parm *)rtw_zmalloc(sizeof(struct addBaReq_parm)); -+ if (paddbareq_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ paddbareq_parm->tid = tid; -+ _rtw_memcpy(paddbareq_parm->addr, addr, ETH_ALEN); -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, paddbareq_parm, GEN_CMD_CODE(_AddBAReq)); -+ -+ /* RTW_INFO("rtw_addbareq_cmd, tid=%d\n", tid); */ -+ -+ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+} -+ -+u8 rtw_addbarsp_cmd(_adapter *padapter, u8 *addr, u16 tid, u8 status, u8 size, u16 start_seq) -+{ -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct cmd_obj *ph2c; -+ struct addBaRsp_parm *paddBaRsp_parm; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ paddBaRsp_parm = (struct addBaRsp_parm *)rtw_zmalloc(sizeof(struct addBaRsp_parm)); -+ -+ if (paddBaRsp_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memcpy(paddBaRsp_parm->addr, addr, ETH_ALEN); -+ paddBaRsp_parm->tid = tid; -+ paddBaRsp_parm->status = status; -+ paddBaRsp_parm->size = size; -+ paddBaRsp_parm->start_seq = start_seq; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, paddBaRsp_parm, GEN_CMD_CODE(_AddBARsp)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+} -+/* add for CONFIG_IEEE80211W, none 11w can use it */ -+u8 rtw_reset_securitypriv_cmd(_adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = RESET_SECURITYPRIV; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ -+ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+ -+} -+ -+u8 rtw_free_assoc_resources_cmd(_adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = FREE_ASSOC_RESOURCES; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ -+ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+ -+} -+ -+u8 rtw_dynamic_chk_wk_cmd(_adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ /* only primary padapter does this cmd */ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = DYNAMIC_CHK_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ -+ /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+ -+} -+ -+u8 rtw_set_ch_cmd(_adapter *padapter, u8 ch, u8 bw, u8 ch_offset, u8 enqueue) -+{ -+ struct cmd_obj *pcmdobj; -+ struct set_ch_parm *set_ch_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res = _SUCCESS; -+ -+ -+ RTW_INFO(FUNC_NDEV_FMT" ch:%u, bw:%u, ch_offset:%u\n", -+ FUNC_NDEV_ARG(padapter->pnetdev), ch, bw, ch_offset); -+ -+ /* check input parameter */ -+ -+ /* prepare cmd parameter */ -+ set_ch_parm = (struct set_ch_parm *)rtw_zmalloc(sizeof(*set_ch_parm)); -+ if (set_ch_parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ set_ch_parm->ch = ch; -+ set_ch_parm->bw = bw; -+ set_ch_parm->ch_offset = ch_offset; -+ -+ if (enqueue) { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmdobj == NULL) { -+ rtw_mfree((u8 *)set_ch_parm, sizeof(*set_ch_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(pcmdobj, set_ch_parm, GEN_CMD_CODE(_SetChannel)); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ } else { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != set_ch_hdl(padapter, (u8 *)set_ch_parm)) -+ res = _FAIL; -+ -+ rtw_mfree((u8 *)set_ch_parm, sizeof(*set_ch_parm)); -+ } -+ -+ /* do something based on res... */ -+ -+exit: -+ -+ RTW_INFO(FUNC_NDEV_FMT" res:%u\n", FUNC_NDEV_ARG(padapter->pnetdev), res); -+ -+ -+ return res; -+} -+ -+u8 _rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, const struct country_chplan *country_ent, u8 swconfig) -+{ -+ struct cmd_obj *cmdobj; -+ struct SetChannelPlan_param *parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; -+ -+ -+ /* check if allow software config */ -+ if (swconfig && rtw_hal_is_disable_sw_channel_plan(adapter) == _TRUE) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ /* if country_entry is provided, replace chplan */ -+ if (country_ent) -+ chplan = country_ent->chplan; -+ -+ /* check input parameter */ -+ if (!rtw_is_channel_plan_valid(chplan)) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ /* prepare cmd parameter */ -+ parm = (struct SetChannelPlan_param *)rtw_zmalloc(sizeof(*parm)); -+ if (parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ parm->country_ent = country_ent; -+ parm->channel_plan = chplan; -+ -+ if (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != set_chplan_hdl(adapter, (u8 *)parm)) -+ res = _FAIL; -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ } else { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_SetChannelPlan)); -+ -+ if (flags & RTW_CMDF_WAIT_ACK) { -+ cmdobj->sctx = &sctx; -+ rtw_sctx_init(&sctx, 2000); -+ } -+ -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ -+ if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { -+ rtw_sctx_wait(&sctx, __func__); -+ _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ if (sctx.status == RTW_SCTX_SUBMITTED) -+ cmdobj->sctx = NULL; -+ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ } -+ } -+ -+exit: -+ -+ -+ return res; -+} -+ -+inline u8 rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, u8 swconfig) -+{ -+ return _rtw_set_chplan_cmd(adapter, flags, chplan, NULL, swconfig); -+} -+ -+inline u8 rtw_set_country_cmd(_adapter *adapter, int flags, const char *country_code, u8 swconfig) -+{ -+ const struct country_chplan *ent; -+ -+ if (is_alpha(country_code[0]) == _FALSE -+ || is_alpha(country_code[1]) == _FALSE -+ ) { -+ RTW_PRINT("%s input country_code is not alpha2\n", __func__); -+ return _FAIL; -+ } -+ -+ ent = rtw_get_chplan_from_country(country_code); -+ -+ if (ent == NULL) { -+ RTW_PRINT("%s unsupported country_code:\"%c%c\"\n", __func__, country_code[0], country_code[1]); -+ return _FAIL; -+ } -+ -+ RTW_PRINT("%s country_code:\"%c%c\" mapping to chplan:0x%02x\n", __func__, country_code[0], country_code[1], ent->chplan); -+ -+ return _rtw_set_chplan_cmd(adapter, flags, RTW_CHPLAN_MAX, ent, swconfig); -+} -+ -+u8 rtw_led_blink_cmd(_adapter *padapter, PVOID pLed) -+{ -+ struct cmd_obj *pcmdobj; -+ struct LedBlink_param *ledBlink_param; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res = _SUCCESS; -+ -+ -+ -+ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmdobj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ ledBlink_param = (struct LedBlink_param *)rtw_zmalloc(sizeof(struct LedBlink_param)); -+ if (ledBlink_param == NULL) { -+ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ ledBlink_param->pLed = pLed; -+ -+ init_h2fwcmd_w_parm_no_rsp(pcmdobj, ledBlink_param, GEN_CMD_CODE(_LedBlink)); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+exit: -+ -+ -+ return res; -+} -+ -+u8 rtw_set_csa_cmd(_adapter *padapter, u8 new_ch_no) -+{ -+ struct cmd_obj *pcmdobj; -+ struct SetChannelSwitch_param *setChannelSwitch_param; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res = _SUCCESS; -+ -+ -+ -+ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmdobj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ setChannelSwitch_param = (struct SetChannelSwitch_param *)rtw_zmalloc(sizeof(struct SetChannelSwitch_param)); -+ if (setChannelSwitch_param == NULL) { -+ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ setChannelSwitch_param->new_ch_no = new_ch_no; -+ -+ init_h2fwcmd_w_parm_no_rsp(pcmdobj, setChannelSwitch_param, GEN_CMD_CODE(_SetChannelSwitch)); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+exit: -+ -+ -+ return res; -+} -+ -+u8 rtw_tdls_cmd(_adapter *padapter, u8 *addr, u8 option) -+{ -+ struct cmd_obj *pcmdobj; -+ struct TDLSoption_param *TDLSoption; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res = _SUCCESS; -+ -+ -+#ifdef CONFIG_TDLS -+ -+ -+ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmdobj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ TDLSoption = (struct TDLSoption_param *)rtw_zmalloc(sizeof(struct TDLSoption_param)); -+ if (TDLSoption == NULL) { -+ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_spinlock(&(padapter->tdlsinfo.cmd_lock)); -+ if (addr != NULL) -+ _rtw_memcpy(TDLSoption->addr, addr, 6); -+ TDLSoption->option = option; -+ _rtw_spinunlock(&(padapter->tdlsinfo.cmd_lock)); -+ init_h2fwcmd_w_parm_no_rsp(pcmdobj, TDLSoption, GEN_CMD_CODE(_TDLS)); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+#endif /* CONFIG_TDLS */ -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_enable_hw_update_tsf_cmd(_adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = EN_HW_UPDATE_TSF_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+/* from_timer == 1 means driver is in LPS */ -+u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer) -+{ -+ u8 bEnterPS = _FALSE; -+ u16 BusyThresholdHigh; -+ u16 BusyThresholdLow; -+ u16 BusyThreshold; -+ u8 bBusyTraffic = _FALSE, bTxBusyTraffic = _FALSE, bRxBusyTraffic = _FALSE; -+ u8 bHigherBusyTraffic = _FALSE, bHigherBusyRxTraffic = _FALSE, bHigherBusyTxTraffic = _FALSE; -+ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &(padapter->tdlsinfo); -+ struct tdls_txmgmt txmgmt; -+ u8 baddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; -+#endif /* CONFIG_TDLS */ -+ -+ RT_LINK_DETECT_T *link_detect = &pmlmepriv->LinkDetectInfo; -+ -+#ifdef CONFIG_BT_COEXIST -+ if (padapter->registrypriv.wifi_spec != 1) { -+ BusyThresholdHigh = 25; -+ BusyThresholdLow = 10; -+ } else -+#endif /* CONFIG_BT_COEXIST */ -+ { -+ BusyThresholdHigh = 100; -+ BusyThresholdLow = 75; -+ } -+ BusyThreshold = BusyThresholdHigh; -+ -+ -+ /* */ -+ /* Determine if our traffic is busy now */ -+ /* */ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ /*&& !MgntInitAdapterInProgress(pMgntInfo)*/) { -+ /* if we raise bBusyTraffic in last watchdog, using lower threshold. */ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ BusyThreshold = BusyThresholdLow; -+ -+ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > BusyThreshold || -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > BusyThreshold) { -+ bBusyTraffic = _TRUE; -+ -+ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) -+ bRxBusyTraffic = _TRUE; -+ else -+ bTxBusyTraffic = _TRUE; -+ } -+ -+ /* Higher Tx/Rx data. */ -+ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > 4000 || -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > 4000) { -+ bHigherBusyTraffic = _TRUE; -+ -+ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) -+ bHigherBusyRxTraffic = _TRUE; -+ else -+ bHigherBusyTxTraffic = _TRUE; -+ } -+ -+#ifdef CONFIG_TRAFFIC_PROTECT -+#define TX_ACTIVE_TH 10 -+#define RX_ACTIVE_TH 20 -+#define TRAFFIC_PROTECT_PERIOD_MS 4500 -+ -+ if (link_detect->NumTxOkInPeriod > TX_ACTIVE_TH -+ || link_detect->NumRxUnicastOkInPeriod > RX_ACTIVE_TH) { -+ -+ RTW_INFO(FUNC_ADPT_FMT" acqiure wake_lock for %u ms(tx:%d,rx_unicast:%d)\n", -+ FUNC_ADPT_ARG(padapter), -+ TRAFFIC_PROTECT_PERIOD_MS, -+ link_detect->NumTxOkInPeriod, -+ link_detect->NumRxUnicastOkInPeriod); -+ -+ rtw_lock_traffic_suspend_timeout(TRAFFIC_PROTECT_PERIOD_MS); -+ } -+#endif -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_AUTOSETUP -+ /* TDLS_WATCHDOG_PERIOD * 2sec, periodically send */ -+ if (hal_chk_wl_func(padapter, WL_FUNC_TDLS) == _TRUE) { -+ if ((ptdlsinfo->watchdog_count % TDLS_WATCHDOG_PERIOD) == 0) { -+ _rtw_memcpy(txmgmt.peer, baddr, ETH_ALEN); -+ issue_tdls_dis_req(padapter, &txmgmt); -+ } -+ ptdlsinfo->watchdog_count++; -+ } -+#endif /* CONFIG_TDLS_AUTOSETUP */ -+#endif /* CONFIG_TDLS */ -+ -+#ifdef CONFIG_LPS -+ /* check traffic for powersaving. */ -+ if (((pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) > 8) || -+#ifdef CONFIG_LPS_SLOW_TRANSITION -+ (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 2) -+#else /* CONFIG_LPS_SLOW_TRANSITION */ -+ (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 4) -+#endif /* CONFIG_LPS_SLOW_TRANSITION */ -+ ) { -+#ifdef DBG_RX_COUNTER_DUMP -+ if (padapter->dump_rx_cnt_mode & DUMP_DRV_TRX_COUNTER_DATA) -+ RTW_INFO("(-)Tx = %d, Rx = %d\n", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); -+#endif -+ bEnterPS = _FALSE; -+#ifdef CONFIG_LPS_SLOW_TRANSITION -+ if (bBusyTraffic == _TRUE) { -+ if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount <= 4) -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 4; -+ -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount++; -+ -+ /* RTW_INFO("Set TrafficTransitionCount to %d\n", pmlmepriv->LinkDetectInfo.TrafficTransitionCount); */ -+ -+ if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount > 30/*TrafficTransitionLevel*/) -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 30; -+ } -+#endif /* CONFIG_LPS_SLOW_TRANSITION */ -+ -+ } else { -+#ifdef DBG_RX_COUNTER_DUMP -+ if (padapter->dump_rx_cnt_mode & DUMP_DRV_TRX_COUNTER_DATA) -+ RTW_INFO("(+)Tx = %d, Rx = %d\n", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); -+#endif -+#ifdef CONFIG_LPS_SLOW_TRANSITION -+ if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount >= 2) -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount -= 2; -+ else -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; -+ -+ if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount == 0) -+ bEnterPS = _TRUE; -+#else /* CONFIG_LPS_SLOW_TRANSITION */ -+ bEnterPS = _TRUE; -+#endif /* CONFIG_LPS_SLOW_TRANSITION */ -+ } -+ -+#ifdef CONFIG_DYNAMIC_DTIM -+ if (pmlmepriv->LinkDetectInfo.LowPowerTransitionCount == 8) -+ bEnterPS = _FALSE; -+ -+ RTW_INFO("LowPowerTransitionCount=%d\n", pmlmepriv->LinkDetectInfo.LowPowerTransitionCount); -+#endif /* CONFIG_DYNAMIC_DTIM */ -+ -+ /* LeisurePS only work in infra mode. */ -+ if (bEnterPS) { -+ if (!from_timer) { -+#ifdef CONFIG_DYNAMIC_DTIM -+ if (pmlmepriv->LinkDetectInfo.LowPowerTransitionCount < 8) -+ adapter_to_pwrctl(padapter)->dtim = 1; -+ else -+ adapter_to_pwrctl(padapter)->dtim = 3; -+#endif /* CONFIG_DYNAMIC_DTIM */ -+ LPS_Enter(padapter, "TRAFFIC_IDLE"); -+ } else { -+ /* do this at caller */ -+ /* rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_ENTER, 1); */ -+ /* rtw_hal_dm_watchdog_in_lps(padapter); */ -+ } -+#ifdef CONFIG_DYNAMIC_DTIM -+ if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount++; -+#endif /* CONFIG_DYNAMIC_DTIM */ -+ } else { -+#ifdef CONFIG_DYNAMIC_DTIM -+ if (pmlmepriv->LinkDetectInfo.LowPowerTransitionCount != 8) -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; -+ else -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount++; -+#endif /* CONFIG_DYNAMIC_DTIM */ -+ if (!from_timer) -+ LPS_Leave(padapter, "TRAFFIC_BUSY"); -+ else { -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->hw_port == HW_PORT0) -+#endif -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_TRAFFIC_BUSY, 1); -+ } -+ } -+ -+#endif /* CONFIG_LPS */ -+ } else { -+#ifdef CONFIG_LPS -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ int n_assoc_iface = 0; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) -+ n_assoc_iface++; -+ } -+ -+ if (!from_timer && n_assoc_iface == 0) -+ LPS_Leave(padapter, "NON_LINKED"); -+#endif -+ } -+ -+ session_tracker_chk_cmd(padapter, NULL); -+ -+ pmlmepriv->LinkDetectInfo.NumRxOkInPeriod = 0; -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod = 0; -+ pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod = 0; -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = bBusyTraffic; -+ pmlmepriv->LinkDetectInfo.bTxBusyTraffic = bTxBusyTraffic; -+ pmlmepriv->LinkDetectInfo.bRxBusyTraffic = bRxBusyTraffic; -+ pmlmepriv->LinkDetectInfo.bHigherBusyTraffic = bHigherBusyTraffic; -+ pmlmepriv->LinkDetectInfo.bHigherBusyRxTraffic = bHigherBusyRxTraffic; -+ pmlmepriv->LinkDetectInfo.bHigherBusyTxTraffic = bHigherBusyTxTraffic; -+ -+ return bEnterPS; -+ -+} -+ -+ -+/* for 11n Logo 4.2.31/4.2.32 */ -+static void dynamic_update_bcn_check(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (!padapter->registrypriv.wifi_spec) -+ return; -+ -+ if (!MLME_IS_AP(padapter)) -+ return; -+ -+#if defined(CONFIG_80211N_HT) && defined(CONFIG_AP_MODE) -+ if (pmlmeext->bstart_bss) { -+ /* In 10 * 2 = 20s, there are no legacy AP, update HT info */ -+ static u8 count = 1; -+ if (count % 10 == 0) { -+ count = 1; -+ if (_FALSE == ATOMIC_READ(&pmlmepriv->olbc) -+ && _FALSE == ATOMIC_READ(&pmlmepriv->olbc_ht)) { -+ if (rtw_ht_operation_update(padapter) > 0) { -+ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); -+ } -+ } -+ } -+ /* In 2s, there are any legacy AP, update HT info, and then reset count */ -+ -+ if (_FALSE != ATOMIC_READ(&pmlmepriv->olbc) -+ && _FALSE != ATOMIC_READ(&pmlmepriv->olbc_ht)) { -+ -+ if (rtw_ht_operation_update(padapter) > 0) { -+ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); -+ -+ } -+ ATOMIC_SET(&pmlmepriv->olbc, _FALSE); -+ ATOMIC_SET(&pmlmepriv->olbc_ht, _FALSE); -+ count = 0; -+ } -+ count ++; -+ } -+#endif /* CONFIG_80211N_HT */ -+} -+void rtw_iface_dynamic_chk_wk_hdl(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ #ifdef CONFIG_AP_MODE -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ expire_timeout_chk(padapter); -+ #endif -+ #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ dynamic_update_bcn_check(padapter); -+ -+ linked_status_chk(padapter, 0); -+ traffic_status_watchdog(padapter, 0); -+ -+ /* for debug purpose */ -+ _linked_info_dump(padapter); -+ -+ #ifdef CONFIG_BEAMFORMING -+ #ifndef RTW_BEAMFORMING_VERSION_2 -+ #if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ -+ beamforming_watchdog(padapter); -+ #endif -+ #endif /* !RTW_BEAMFORMING_VERSION_2 */ -+ #endif -+ -+} -+void rtw_dynamic_chk_wk_hdl(_adapter *padapter) -+{ -+ rtw_mi_dynamic_chk_wk_hdl(padapter); -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ rtw_hal_sreset_xmit_status_check(padapter); -+ rtw_hal_sreset_linked_status_check(padapter); -+#endif -+ -+ /* if(check_fwstate(pmlmepriv, _FW_UNDER_LINKING|_FW_UNDER_SURVEY)==_FALSE) */ -+ { -+#ifdef DBG_RX_COUNTER_DUMP -+ rtw_dump_rx_counters(padapter); -+#endif -+ dm_DynamicUsbTxAgg(padapter, 0); -+ } -+ rtw_hal_dm_watchdog(padapter); -+ -+ /* check_hw_pbc(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->type); */ -+ -+#ifdef CONFIG_BT_COEXIST -+ /* BT-Coexist */ -+ rtw_btcoex_Handler(padapter); -+#endif -+ -+#ifdef CONFIG_IPS_CHECK_IN_WD -+ /* always call rtw_ps_processor() at last one. */ -+ rtw_ps_processor(padapter); -+#endif -+ -+#ifdef CONFIG_MCC_MODE -+ rtw_hal_mcc_sw_status_check(padapter); -+#endif /* CONFIG_MCC_MODE */ -+ -+} -+ -+#ifdef CONFIG_LPS -+ -+void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type); -+void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 mstatus; -+ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) -+ || (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) -+ return; -+ -+ switch (lps_ctrl_type) { -+ case LPS_CTRL_SCAN: -+ /* RTW_INFO("LPS_CTRL_SCAN\n"); */ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_ScanNotify(padapter, _TRUE); -+#endif /* CONFIG_BT_COEXIST */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ /* connect */ -+ LPS_Leave(padapter, "LPS_CTRL_SCAN"); -+ } -+ break; -+ case LPS_CTRL_JOINBSS: -+ /* RTW_INFO("LPS_CTRL_JOINBSS\n"); */ -+ LPS_Leave(padapter, "LPS_CTRL_JOINBSS"); -+ break; -+ case LPS_CTRL_CONNECT: -+ /* RTW_INFO("LPS_CTRL_CONNECT\n"); */ -+ mstatus = 1;/* connect */ -+ /* Reset LPS Setting */ -+ pwrpriv->LpsIdleCount = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_MediaStatusNotify(padapter, mstatus); -+#endif /* CONFIG_BT_COEXIST */ -+ break; -+ case LPS_CTRL_DISCONNECT: -+ /* RTW_INFO("LPS_CTRL_DISCONNECT\n"); */ -+ mstatus = 0;/* disconnect */ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_MediaStatusNotify(padapter, mstatus); -+#endif /* CONFIG_BT_COEXIST */ -+ LPS_Leave(padapter, "LPS_CTRL_DISCONNECT"); -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); -+ break; -+ case LPS_CTRL_SPECIAL_PACKET: -+ /* RTW_INFO("LPS_CTRL_SPECIAL_PACKET\n"); */ -+ pwrpriv->DelayLPSLastTimeStamp = rtw_get_current_time(); -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SpecialPacketNotify(padapter, PACKET_DHCP); -+#endif /* CONFIG_BT_COEXIST */ -+ LPS_Leave(padapter, "LPS_CTRL_SPECIAL_PACKET"); -+ break; -+ case LPS_CTRL_LEAVE: -+ LPS_Leave(padapter, "LPS_CTRL_LEAVE"); -+ break; -+ case LPS_CTRL_LEAVE_CFG80211_PWRMGMT: -+ LPS_Leave(padapter, "CFG80211_PWRMGMT"); -+ break; -+ case LPS_CTRL_TRAFFIC_BUSY: -+ LPS_Leave(padapter, "LPS_CTRL_TRAFFIC_BUSY"); -+ break; -+ case LPS_CTRL_TX_TRAFFIC_LEAVE: -+ LPS_Leave(padapter, "LPS_CTRL_TX_TRAFFIC_LEAVE"); -+ break; -+ case LPS_CTRL_RX_TRAFFIC_LEAVE: -+ LPS_Leave(padapter, "LPS_CTRL_RX_TRAFFIC_LEAVE"); -+ break; -+ case LPS_CTRL_ENTER: -+ LPS_Enter(padapter, "TRAFFIC_IDLE_1"); -+ break; -+ default: -+ break; -+ } -+ -+} -+ -+u8 rtw_lps_ctrl_wk_cmd(_adapter *padapter, u8 lps_ctrl_type, u8 enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ /* struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); */ -+ u8 res = _SUCCESS; -+ -+ -+ /* if(!pwrctrlpriv->bLeisurePs) */ -+ /* return res; */ -+ -+ if (enqueue) { -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = LPS_CTRL_WK_CID; -+ pdrvextra_cmd_parm->type = lps_ctrl_type; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } else -+ lps_ctrl_wk_hdl(padapter, lps_ctrl_type); -+ -+exit: -+ -+ -+ return res; -+ -+} -+ -+void rtw_dm_in_lps_hdl(_adapter *padapter) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_IN_LPS, NULL); -+} -+ -+u8 rtw_dm_in_lps_wk_cmd(_adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = DM_IN_LPS_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+void rtw_lps_change_dtim_hdl(_adapter *padapter, u8 dtim) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ if (dtim <= 0 || dtim > 16) -+ return; -+ -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBtControlLps(padapter) == _TRUE) -+ return; -+#endif -+ -+#ifdef CONFIG_LPS_LCLK -+ _enter_pwrlock(&pwrpriv->lock); -+#endif -+ -+ if (pwrpriv->dtim != dtim) { -+ RTW_INFO("change DTIM from %d to %d, bFwCurrentInPSMode=%d, ps_mode=%d\n", pwrpriv->dtim, dtim, -+ pwrpriv->bFwCurrentInPSMode, pwrpriv->pwr_mode); -+ -+ pwrpriv->dtim = dtim; -+ } -+ -+ if ((pwrpriv->bFwCurrentInPSMode == _TRUE) && (pwrpriv->pwr_mode > PS_MODE_ACTIVE)) { -+ u8 ps_mode = pwrpriv->pwr_mode; -+ -+ /* RTW_INFO("change DTIM from %d to %d, ps_mode=%d\n", pwrpriv->dtim, dtim, ps_mode); */ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); -+ } -+ -+#ifdef CONFIG_LPS_LCLK -+ _exit_pwrlock(&pwrpriv->lock); -+#endif -+ -+} -+ -+#endif -+ -+u8 rtw_lps_change_dtim_cmd(_adapter *padapter, u8 dtim) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ /* -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->hw_port != HW_PORT0) -+ return res; -+ #endif -+ */ -+ { -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = LPS_CHANGE_DTIM_CID; -+ pdrvextra_cmd_parm->type = dtim; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } -+ -+exit: -+ -+ return res; -+ -+} -+ -+#if (RATE_ADAPTIVE_SUPPORT == 1) -+void rpt_timer_setting_wk_hdl(_adapter *padapter, u16 minRptTime) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_RPT_TIMER_SETTING, (u8 *)(&minRptTime)); -+} -+ -+u8 rtw_rpt_timer_cfg_cmd(_adapter *padapter, u16 minRptTime) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = RTP_TIMER_CFG_WK_CID; -+ pdrvextra_cmd_parm->type = minRptTime; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ -+ return res; -+ -+} -+ -+#endif -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+void antenna_select_wk_hdl(_adapter *padapter, u8 antenna) -+{ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_ANTDIV_SELECT, &antenna, _TRUE); -+} -+ -+u8 rtw_antenna_select_cmd(_adapter *padapter, u8 antenna, u8 enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ u8 bSupportAntDiv = _FALSE; -+ u8 res = _SUCCESS; -+ int i; -+ -+ rtw_hal_get_def_var(padapter, HAL_DEF_IS_SUPPORT_ANT_DIV, &(bSupportAntDiv)); -+ if (_FALSE == bSupportAntDiv) -+ return _FAIL; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (rtw_linked_check(dvobj->padapters[i])) -+ return _FAIL; -+ } -+ -+ if (_TRUE == enqueue) { -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = ANT_SELECT_WK_CID; -+ pdrvextra_cmd_parm->type = antenna; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } else -+ antenna_select_wk_hdl(padapter, antenna); -+exit: -+ -+ -+ return res; -+ -+} -+#endif -+ -+void rtw_dm_ra_mask_hdl(_adapter *padapter, struct sta_info *psta) -+{ -+ if (psta) -+ set_sta_rate(padapter, psta); -+} -+ -+u8 rtw_dm_ra_mask_wk_cmd(_adapter *padapter, u8 *psta) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = DM_RA_MSK_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = psta; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+void power_saving_wk_hdl(_adapter *padapter) -+{ -+ rtw_ps_processor(padapter); -+} -+ -+/* add for CONFIG_IEEE80211W, none 11w can use it */ -+void reset_securitypriv_hdl(_adapter *padapter) -+{ -+ rtw_reset_securitypriv(padapter); -+} -+ -+void free_assoc_resources_hdl(_adapter *padapter) -+{ -+ rtw_free_assoc_resources(padapter, 1); -+} -+ -+#ifdef CONFIG_P2P -+u8 p2p_protocol_wk_cmd(_adapter *padapter, int intCmdType) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return res; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = P2P_PROTO_WK_CID; -+ pdrvextra_cmd_parm->type = intCmdType; /* As the command tppe. */ -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; /* Must be NULL here */ -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+ -+} -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+static u8 _p2p_roch_cmd(_adapter *adapter -+ , u64 cookie, struct wireless_dev *wdev -+ , struct ieee80211_channel *ch, enum nl80211_channel_type ch_type -+ , unsigned int duration -+ , u8 flags -+) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *parm; -+ struct p2p_roch_parm *roch_parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct submit_ctx sctx; -+ u8 cancel = duration ? 0 : 1; -+ u8 res = _SUCCESS; -+ -+ roch_parm = (struct p2p_roch_parm *)rtw_zmalloc(sizeof(struct p2p_roch_parm)); -+ if (roch_parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ roch_parm->cookie = cookie; -+ roch_parm->wdev = wdev; -+ if (!cancel) { -+ _rtw_memcpy(&roch_parm->ch, ch, sizeof(struct ieee80211_channel)); -+ roch_parm->ch_type = ch_type; -+ roch_parm->duration = duration; -+ } -+ -+ if (flags & RTW_CMDF_DIRECTLY) { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != p2p_protocol_wk_hdl(adapter, cancel ? P2P_CANCEL_RO_CH_WK : P2P_RO_CH_WK, (u8 *)roch_parm)) -+ res = _FAIL; -+ rtw_mfree((u8 *)roch_parm, sizeof(*roch_parm)); -+ } else { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (parm == NULL) { -+ rtw_mfree((u8 *)roch_parm, sizeof(*roch_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm->ec_id = P2P_PROTO_WK_CID; -+ parm->type = cancel ? P2P_CANCEL_RO_CH_WK : P2P_RO_CH_WK; -+ parm->size = sizeof(*roch_parm); -+ parm->pbuf = (u8 *)roch_parm; -+ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ rtw_mfree((u8 *)roch_parm, sizeof(*roch_parm)); -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ if (flags & RTW_CMDF_WAIT_ACK) { -+ cmdobj->sctx = &sctx; -+ rtw_sctx_init(&sctx, 10 * 1000); -+ } -+ -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ -+ if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { -+ rtw_sctx_wait(&sctx, __func__); -+ _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ if (sctx.status == RTW_SCTX_SUBMITTED) -+ cmdobj->sctx = NULL; -+ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ if (sctx.status != RTW_SCTX_DONE_SUCCESS) -+ res = _FAIL; -+ } -+ } -+ -+exit: -+ return res; -+} -+ -+inline u8 p2p_roch_cmd(_adapter *adapter -+ , u64 cookie, struct wireless_dev *wdev -+ , struct ieee80211_channel *ch, enum nl80211_channel_type ch_type -+ , unsigned int duration -+ , u8 flags -+) -+{ -+ return _p2p_roch_cmd(adapter, cookie, wdev, ch, ch_type, duration, flags); -+} -+ -+inline u8 p2p_cancel_roch_cmd(_adapter *adapter, u64 cookie, struct wireless_dev *wdev, u8 flags) -+{ -+ return _p2p_roch_cmd(adapter, cookie, wdev, NULL, 0, 0, flags); -+} -+#endif /* CONFIG_IOCTL_CFG80211 */ -+#endif /* CONFIG_P2P */ -+ -+u8 rtw_ps_cmd(_adapter *padapter) -+{ -+ struct cmd_obj *ppscmd; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res = _SUCCESS; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ goto exit; -+#endif -+ -+ ppscmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ppscmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ppscmd, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = POWER_SAVING_CTRL_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ init_h2fwcmd_w_parm_no_rsp(ppscmd, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ppscmd); -+ -+exit: -+ -+ -+ return res; -+ -+} -+ -+#ifdef CONFIG_AP_MODE -+ -+static void rtw_chk_hi_queue_hdl(_adapter *padapter) -+{ -+ struct sta_info *psta_bmc; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u32 start = rtw_get_current_time(); -+ u8 empty = _FALSE; -+ -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ if (!psta_bmc) -+ return; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); -+ -+ while (_FALSE == empty && rtw_get_passing_time_ms(start) < rtw_get_wait_hiq_empty_ms()) { -+ rtw_msleep_os(100); -+ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty); -+ } -+ -+ if (psta_bmc->sleepq_len == 0) { -+ if (empty == _SUCCESS) { -+ bool update_tim = _FALSE; -+ -+ if (pstapriv->tim_bitmap & BIT(0)) -+ update_tim = _TRUE; -+ -+ pstapriv->tim_bitmap &= ~BIT(0); -+ pstapriv->sta_dz_bitmap &= ~BIT(0); -+ -+ if (update_tim == _TRUE) -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "bmc sleepq and HIQ empty"); -+ } else /* re check again */ -+ rtw_chk_hi_queue_cmd(padapter); -+ -+ } -+ -+} -+ -+u8 rtw_chk_hi_queue_cmd(_adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = CHECK_HIQ_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+#ifdef CONFIG_DFS_MASTER -+u8 rtw_dfs_master_hdl(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ -+ if (!rfctl->dfs_master_enabled) -+ goto exit; -+ -+ if (rtw_get_on_cur_ch_time(adapter) == 0 -+ || rtw_get_passing_time_ms(rtw_get_on_cur_ch_time(adapter)) < 300 -+ ) { -+ /* offchannel , bypass radar detect */ -+ goto cac_status_chk; -+ } -+ -+ if (IS_CH_WAITING(rfctl) && !IS_UNDER_CAC(rfctl)) { -+ /* non_ocp, bypass radar detect */ -+ goto cac_status_chk; -+ } -+ -+ if (!rfctl->dbg_dfs_master_fake_radar_detect_cnt -+ && rtw_odm_radar_detect(adapter) != _TRUE) -+ goto cac_status_chk; -+ -+ if (rfctl->dbg_dfs_master_fake_radar_detect_cnt != 0) { -+ RTW_INFO(FUNC_ADPT_FMT" fake radar detect, cnt:%d\n", FUNC_ADPT_ARG(adapter) -+ , rfctl->dbg_dfs_master_fake_radar_detect_cnt); -+ rfctl->dbg_dfs_master_fake_radar_detect_cnt--; -+ } -+ -+ if (rfctl->dbg_dfs_master_radar_detect_trigger_non) { -+ /* radar detect debug mode, trigger no mlme flow */ -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" radar detected, trigger no mlme flow for debug\n", FUNC_ADPT_ARG(adapter)); -+ } else { -+ /* TODO: move timer to rfctl */ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!dvobj->padapters[i]) -+ continue; -+ if (check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_AP_STATE) -+ && check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_ASOC_STATE)) -+ break; -+ } -+ -+ if (i >= dvobj->iface_nums) { -+ /* what? */ -+ rtw_warn_on(1); -+ } else { -+ rtw_chset_update_non_ocp(dvobj->padapters[i]->mlmeextpriv.channel_set -+ , rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset); -+ rfctl->radar_detected = 1; -+ -+ /* trigger channel selection */ -+ rtw_change_bss_chbw_cmd(dvobj->padapters[i], RTW_CMDF_DIRECTLY, -1, dvobj->padapters[i]->mlmepriv.ori_bw, -1); -+ } -+ -+ if (rfctl->dfs_master_enabled) -+ goto set_timer; -+ goto exit; -+ } -+ -+cac_status_chk: -+ -+ if (!IS_CH_WAITING(rfctl) && !IS_CAC_STOPPED(rfctl)) { -+ u8 pause = 0x00; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_TXPAUSE, &pause); -+ rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; -+ } -+ -+set_timer: -+ _set_timer(&mlme->dfs_master_timer, DFS_MASTER_TIMER_MS); -+ -+exit: -+ return H2C_SUCCESS; -+} -+ -+u8 rtw_dfs_master_cmd(_adapter *adapter, bool enqueue) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 res = _FAIL; -+ -+ if (enqueue) { -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == NULL) -+ goto exit; -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = DFS_MASTER_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ } else { -+ rtw_dfs_master_hdl(adapter); -+ res = _SUCCESS; -+ } -+ -+exit: -+ return res; -+} -+ -+void rtw_dfs_master_timer_hdl(RTW_TIMER_HDL_ARGS) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ -+ rtw_dfs_master_cmd(adapter, _TRUE); -+} -+ -+void rtw_dfs_master_enable(_adapter *adapter, u8 ch, u8 bw, u8 offset) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ /* TODO: move timer to rfctl */ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ -+ RTW_INFO(FUNC_ADPT_FMT" on %u,%u,%u\n", FUNC_ADPT_ARG(adapter), ch, bw, offset); -+ -+ if (rtw_is_cac_reset_needed(adapter, ch, bw, offset) == _TRUE) -+ rtw_reset_cac(adapter, ch, bw, offset); -+ -+ rfctl->radar_detect_by_others = _FALSE; -+ rfctl->radar_detect_ch = ch; -+ rfctl->radar_detect_bw = bw; -+ rfctl->radar_detect_offset = offset; -+ -+ rfctl->radar_detected = 0; -+ -+ if (!rfctl->dfs_master_enabled) { -+ RTW_INFO(FUNC_ADPT_FMT" set dfs_master_enabled\n", FUNC_ADPT_ARG(adapter)); -+ rfctl->dfs_master_enabled = 1; -+ _set_timer(&adapter->mlmepriv.dfs_master_timer, DFS_MASTER_TIMER_MS); -+ -+ if (rtw_rfctl_overlap_radar_detect_ch(rfctl)) { -+ if (IS_CH_WAITING(rfctl)) { -+ u8 pause = 0xFF; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_TXPAUSE, &pause); -+ } -+ rtw_odm_radar_detect_enable(adapter); -+ } -+ } -+} -+ -+void rtw_dfs_master_disable(_adapter *adapter, u8 ch, u8 bw, u8 offset, bool by_others) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ /* TODO: move timer to rfctl */ -+ adapter = GET_PRIMARY_ADAPTER(adapter); -+ -+ rfctl->radar_detect_by_others = by_others; -+ -+ if (rfctl->dfs_master_enabled) { -+ bool overlap_radar_detect_ch = rtw_rfctl_overlap_radar_detect_ch(rfctl); -+ -+ RTW_INFO(FUNC_ADPT_FMT" clear dfs_master_enabled\n", FUNC_ADPT_ARG(adapter)); -+ -+ rfctl->dfs_master_enabled = 0; -+ rfctl->radar_detected = 0; -+ rfctl->radar_detect_ch = 0; -+ rfctl->radar_detect_bw = 0; -+ rfctl->radar_detect_offset = 0; -+ rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; -+ _cancel_timer_ex(&adapter->mlmepriv.dfs_master_timer); -+ -+ if (overlap_radar_detect_ch) { -+ u8 pause = 0x00; -+ -+ rtw_hal_set_hwreg(adapter, HW_VAR_TXPAUSE, &pause); -+ rtw_odm_radar_detect_disable(adapter); -+ } -+ } -+ -+ if (by_others) { -+ rfctl->radar_detect_ch = ch; -+ rfctl->radar_detect_bw = bw; -+ rfctl->radar_detect_offset = offset; -+ } -+} -+ -+void rtw_dfs_master_status_apply(_adapter *adapter, u8 self_action) -+{ -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct mi_state mstate; -+ u8 u_ch, u_bw, u_offset; -+ bool ld_sta_in_dfs = _FALSE; -+ bool sync_ch = _FALSE; /* _FALSE: asign channel directly */ -+ bool needed = _FALSE; -+ -+ rtw_mi_status_no_self(adapter, &mstate); -+ rtw_mi_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset); -+ if (u_ch != 0) -+ sync_ch = _TRUE; -+ -+ switch (self_action) { -+ case MLME_STA_CONNECTING: -+ MSTATE_STA_LG_NUM(&mstate)++; -+ break; -+ case MLME_STA_CONNECTED: -+ MSTATE_STA_LD_NUM(&mstate)++; -+ break; -+ case MLME_AP_STARTED: -+ MSTATE_AP_NUM(&mstate)++; -+ break; -+ case MLME_AP_STOPPED: -+ case MLME_STA_DISCONNECTED: -+ default: -+ break; -+ } -+ -+ if (sync_ch == _TRUE) { -+ if (!rtw_is_chbw_grouped(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset, u_ch, u_bw, u_offset)) { -+ RTW_INFO(FUNC_ADPT_FMT" can't sync %u,%u,%u with %u,%u,%u\n", FUNC_ADPT_ARG(adapter) -+ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset, u_ch, u_bw, u_offset); -+ goto apply; -+ } -+ -+ rtw_sync_chbw(&mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset -+ , &u_ch, &u_bw, &u_offset); -+ } else { -+ u_ch = mlmeext->cur_channel; -+ u_bw = mlmeext->cur_bwmode; -+ u_offset = mlmeext->cur_ch_offset; -+ } -+ -+ if (MSTATE_STA_LD_NUM(&mstate) > 0) { -+ /* rely on AP on which STA mode connects */ -+ if (rtw_is_dfs_ch(u_ch, u_bw, u_offset)) -+ ld_sta_in_dfs = _TRUE; -+ goto apply; -+ } -+ -+ if (MSTATE_STA_LG_NUM(&mstate) > 0) { -+ /* STA mode is linking */ -+ goto apply; -+ } -+ -+ if (MSTATE_AP_NUM(&mstate) == 0) { -+ /* No working AP mode */ -+ goto apply; -+ } -+ -+ if (rtw_is_dfs_ch(u_ch, u_bw, u_offset)) -+ needed = _TRUE; -+ -+apply: -+ -+ RTW_INFO(FUNC_ADPT_FMT" needed:%d, self_action:%u\n" -+ , FUNC_ADPT_ARG(adapter), needed, self_action); -+ RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, lg_sta_num:%u, ap_num:%u, %u,%u,%u\n" -+ , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate), MSTATE_STA_LG_NUM(&mstate), MSTATE_AP_NUM(&mstate) -+ , u_ch, u_bw, u_offset); -+ -+ if (needed == _TRUE) -+ rtw_dfs_master_enable(adapter, u_ch, u_bw, u_offset); -+ else -+ rtw_dfs_master_disable(adapter, u_ch, u_bw, u_offset, ld_sta_in_dfs); -+} -+#endif /* CONFIG_DFS_MASTER */ -+ -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_BT_COEXIST -+struct btinfo { -+ u8 cid; -+ u8 len; -+ -+ u8 bConnection:1; -+ u8 bSCOeSCO:1; -+ u8 bInQPage:1; -+ u8 bACLBusy:1; -+ u8 bSCOBusy:1; -+ u8 bHID:1; -+ u8 bA2DP:1; -+ u8 bFTP:1; -+ -+ u8 retry_cnt:4; -+ u8 rsvd_34:1; -+ u8 rsvd_35:1; -+ u8 rsvd_36:1; -+ u8 rsvd_37:1; -+ -+ u8 rssi; -+ -+ u8 rsvd_50:1; -+ u8 rsvd_51:1; -+ u8 rsvd_52:1; -+ u8 rsvd_53:1; -+ u8 rsvd_54:1; -+ u8 rsvd_55:1; -+ u8 eSCO_SCO:1; -+ u8 Master_Slave:1; -+ -+ u8 rsvd_6; -+ u8 rsvd_7; -+}; -+ -+void btinfo_evt_dump(void *sel, void *buf) -+{ -+ struct btinfo *info = (struct btinfo *)buf; -+ -+ RTW_PRINT_SEL(sel, "cid:0x%02x, len:%u\n", info->cid, info->len); -+ -+ if (info->len > 2) -+ RTW_PRINT_SEL(sel, "byte2:%s%s%s%s%s%s%s%s\n" -+ , info->bConnection ? "bConnection " : "" -+ , info->bSCOeSCO ? "bSCOeSCO " : "" -+ , info->bInQPage ? "bInQPage " : "" -+ , info->bACLBusy ? "bACLBusy " : "" -+ , info->bSCOBusy ? "bSCOBusy " : "" -+ , info->bHID ? "bHID " : "" -+ , info->bA2DP ? "bA2DP " : "" -+ , info->bFTP ? "bFTP" : "" -+ ); -+ -+ if (info->len > 3) -+ RTW_PRINT_SEL(sel, "retry_cnt:%u\n", info->retry_cnt); -+ -+ if (info->len > 4) -+ RTW_PRINT_SEL(sel, "rssi:%u\n", info->rssi); -+ -+ if (info->len > 5) -+ RTW_PRINT_SEL(sel, "byte5:%s%s\n" -+ , info->eSCO_SCO ? "eSCO_SCO " : "" -+ , info->Master_Slave ? "Master_Slave " : "" -+ ); -+} -+ -+static void rtw_btinfo_hdl(_adapter *adapter, u8 *buf, u16 buf_len) -+{ -+#define BTINFO_WIFI_FETCH 0x23 -+#define BTINFO_BT_AUTO_RPT 0x27 -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ struct btinfo_8761ATV *info = (struct btinfo_8761ATV *)buf; -+#else /* !CONFIG_BT_COEXIST_SOCKET_TRX */ -+ struct btinfo *info = (struct btinfo *)buf; -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ u8 cmd_idx; -+ u8 len; -+ -+ cmd_idx = info->cid; -+ -+ if (info->len > buf_len - 2) { -+ rtw_warn_on(1); -+ len = buf_len - 2; -+ } else -+ len = info->len; -+ -+ /* #define DBG_PROC_SET_BTINFO_EVT */ -+#ifdef DBG_PROC_SET_BTINFO_EVT -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ RTW_INFO("%s: btinfo[0]=%x,btinfo[1]=%x,btinfo[2]=%x,btinfo[3]=%x btinfo[4]=%x,btinfo[5]=%x,btinfo[6]=%x,btinfo[7]=%x\n" -+ , __func__, buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6], buf[7]); -+#else/* !CONFIG_BT_COEXIST_SOCKET_TRX */ -+ btinfo_evt_dump(RTW_DBGDUMP, info); -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+#endif /* DBG_PROC_SET_BTINFO_EVT */ -+ -+ /* transform BT-FW btinfo to WiFI-FW C2H format and notify */ -+ if (cmd_idx == BTINFO_WIFI_FETCH) -+ buf[1] = 0; -+ else if (cmd_idx == BTINFO_BT_AUTO_RPT) -+ buf[1] = 2; -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ else if (0x01 == cmd_idx || 0x02 == cmd_idx) -+ buf[1] = buf[0]; -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ rtw_btcoex_BtInfoNotify(adapter , len + 1, &buf[1]); -+} -+ -+u8 rtw_btinfo_cmd(_adapter *adapter, u8 *buf, u16 len) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ u8 *btinfo; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ btinfo = rtw_zmalloc(len); -+ if (btinfo == NULL) { -+ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = BTINFO_WK_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = len; -+ pdrvextra_cmd_parm->pbuf = btinfo; -+ -+ _rtw_memcpy(btinfo, buf, len); -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+#endif /* CONFIG_BT_COEXIST */ -+ -+u8 rtw_test_h2c_cmd(_adapter *adapter, u8 *buf, u8 len) -+{ -+ struct cmd_obj *pcmdobj; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ u8 *ph2c_content; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmdobj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ ph2c_content = rtw_zmalloc(len); -+ if (ph2c_content == NULL) { -+ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = TEST_H2C_CID; -+ pdrvextra_cmd_parm->type = 0; -+ pdrvextra_cmd_parm->size = len; -+ pdrvextra_cmd_parm->pbuf = ph2c_content; -+ -+ _rtw_memcpy(ph2c_content, buf, len); -+ -+ init_h2fwcmd_w_parm_no_rsp(pcmdobj, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+exit: -+ return res; -+} -+ -+#ifdef CONFIG_RTW_CUSTOMER_STR -+static s32 rtw_customer_str_cmd_hdl(_adapter *adapter, u8 write, const u8 *cstr) -+{ -+ int ret = H2C_SUCCESS; -+ -+ if (write) -+ ret = rtw_hal_h2c_customer_str_write(adapter, cstr); -+ else -+ ret = rtw_hal_h2c_customer_str_req(adapter); -+ -+ return ret == _SUCCESS ? H2C_SUCCESS : H2C_REJECTED; -+} -+ -+static u8 rtw_customer_str_cmd(_adapter *adapter, u8 write, const u8 *cstr) -+{ -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *parm; -+ u8 *str = NULL; -+ struct cmd_priv *pcmdpriv = &adapter->cmdpriv; -+ struct submit_ctx sctx; -+ u8 res = _SUCCESS; -+ -+ parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (parm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ if (write) { -+ str = rtw_zmalloc(RTW_CUSTOMER_STR_LEN); -+ if (str == NULL) { -+ rtw_mfree((u8 *)parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ } -+ -+ parm->ec_id = CUSTOMER_STR_WK_CID; -+ parm->type = write; -+ parm->size = write ? RTW_CUSTOMER_STR_LEN : 0; -+ parm->pbuf = write ? str : NULL; -+ -+ if (write) -+ _rtw_memcpy(str, cstr, RTW_CUSTOMER_STR_LEN); -+ -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ rtw_mfree((u8 *)parm, sizeof(*parm)); -+ if (write) -+ rtw_mfree(str, RTW_CUSTOMER_STR_LEN); -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ cmdobj->sctx = &sctx; -+ rtw_sctx_init(&sctx, 2 * 1000); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, cmdobj); -+ -+ if (res == _SUCCESS) { -+ rtw_sctx_wait(&sctx, __func__); -+ _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ if (sctx.status == RTW_SCTX_SUBMITTED) -+ cmdobj->sctx = NULL; -+ _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); -+ if (sctx.status != RTW_SCTX_DONE_SUCCESS) -+ res = _FAIL; -+ } -+ -+exit: -+ return res; -+} -+ -+inline u8 rtw_customer_str_req_cmd(_adapter *adapter) -+{ -+ return rtw_customer_str_cmd(adapter, 0, NULL); -+} -+ -+inline u8 rtw_customer_str_write_cmd(_adapter *adapter, const u8 *cstr) -+{ -+ return rtw_customer_str_cmd(adapter, 1, cstr); -+} -+#endif /* CONFIG_RTW_CUSTOMER_STR */ -+ -+u8 rtw_c2h_wk_cmd(PADAPTER padapter, u8 *pbuf, u16 length, u8 type) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 *extra_cmd_buf; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ extra_cmd_buf = rtw_zmalloc(length); -+ if (extra_cmd_buf == NULL) { -+ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memcpy(extra_cmd_buf, pbuf, length); -+ pdrvextra_cmd_parm->ec_id = C2H_WK_CID; -+ pdrvextra_cmd_parm->type = type; -+ pdrvextra_cmd_parm->size = length; -+ pdrvextra_cmd_parm->pbuf = extra_cmd_buf; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ return res; -+} -+ -+#ifdef CONFIG_FW_C2H_REG -+inline u8 rtw_c2h_reg_wk_cmd(_adapter *adapter, u8 *c2h_evt) -+{ -+ return rtw_c2h_wk_cmd(adapter, c2h_evt, c2h_evt ? C2H_REG_LEN : 0, C2H_TYPE_REG); -+} -+#endif -+ -+#ifdef CONFIG_FW_C2H_PKT -+inline u8 rtw_c2h_packet_wk_cmd(_adapter *adapter, u8 *c2h_evt, u16 length) -+{ -+ return rtw_c2h_wk_cmd(adapter, c2h_evt, length, C2H_TYPE_PKT); -+} -+#endif -+ -+u8 rtw_run_in_thread_cmd(PADAPTER padapter, void (*func)(void *), void *context) -+{ -+ struct cmd_priv *pcmdpriv; -+ struct cmd_obj *ph2c; -+ struct RunInThread_param *parm; -+ s32 res = _SUCCESS; -+ -+ -+ pcmdpriv = &padapter->cmdpriv; -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (NULL == ph2c) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm = (struct RunInThread_param *)rtw_zmalloc(sizeof(struct RunInThread_param)); -+ if (NULL == parm) { -+ rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ parm->func = func; -+ parm->context = context; -+ init_h2fwcmd_w_parm_no_rsp(ph2c, parm, GEN_CMD_CODE(_RunInThreadCMD)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ -+ return res; -+} -+ -+#ifdef CONFIG_FW_C2H_REG -+s32 c2h_evt_hdl(_adapter *adapter, u8 *c2h_evt, c2h_id_filter filter) -+{ -+ s32 ret = _FAIL; -+ u8 buf[C2H_REG_LEN] = {0}; -+ u8 id, seq, plen; -+ u8 *payload; -+ -+ if (!c2h_evt) { -+ /* No c2h event in cmd_obj, read c2h event before handling*/ -+ if (rtw_hal_c2h_evt_read(adapter, buf) != _SUCCESS) -+ goto exit; -+ c2h_evt = buf; -+ } -+ -+ rtw_hal_c2h_reg_hdr_parse(adapter, c2h_evt, &id, &seq, &plen, &payload); -+ -+ if (filter && filter(adapter, id, seq, plen, payload) == _FALSE) -+ goto exit; -+ -+ ret = rtw_hal_c2h_handler(adapter, id, seq, plen, payload); -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_FW_C2H_REG */ -+ -+u8 session_tracker_cmd(_adapter *adapter, u8 cmd, struct sta_info *sta, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) -+{ -+ struct cmd_priv *cmdpriv = &adapter->cmdpriv; -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *cmd_parm; -+ struct st_cmd_parm *st_parm; -+ u8 res = _SUCCESS; -+ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (cmd_parm == NULL) { -+ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ st_parm = (struct st_cmd_parm *)rtw_zmalloc(sizeof(struct st_cmd_parm)); -+ if (st_parm == NULL) { -+ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ st_parm->cmd = cmd; -+ st_parm->sta = sta; -+ if (cmd != ST_CMD_CHK) { -+ _rtw_memcpy(&st_parm->local_naddr, local_naddr, 4); -+ _rtw_memcpy(&st_parm->local_port, local_port, 2); -+ _rtw_memcpy(&st_parm->remote_naddr, remote_naddr, 4); -+ _rtw_memcpy(&st_parm->remote_port, remote_port, 2); -+ } -+ -+ cmd_parm->ec_id = SESSION_TRACKER_WK_CID; -+ cmd_parm->type = 0; -+ cmd_parm->size = sizeof(struct st_cmd_parm); -+ cmd_parm->pbuf = (u8 *)st_parm; -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ cmdobj->no_io = 1; -+ -+ res = rtw_enqueue_cmd(cmdpriv, cmdobj); -+ -+exit: -+ return res; -+} -+ -+inline u8 session_tracker_chk_cmd(_adapter *adapter, struct sta_info *sta) -+{ -+ return session_tracker_cmd(adapter, ST_CMD_CHK, sta, NULL, NULL, NULL, NULL); -+} -+ -+inline u8 session_tracker_add_cmd(_adapter *adapter, struct sta_info *sta, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) -+{ -+ return session_tracker_cmd(adapter, ST_CMD_ADD, sta, local_naddr, local_port, remote_naddr, remote_port); -+} -+ -+inline u8 session_tracker_del_cmd(_adapter *adapter, struct sta_info *sta, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) -+{ -+ return session_tracker_cmd(adapter, ST_CMD_DEL, sta, local_naddr, local_port, remote_naddr, remote_port); -+} -+ -+void session_tracker_chk_for_sta(_adapter *adapter, struct sta_info *sta) -+{ -+ struct st_ctl_t *st_ctl = &sta->st_ctl; -+ int i; -+ _irqL irqL; -+ _list *plist, *phead, *pnext; -+ _list dlist; -+ struct session_tracker *st = NULL; -+ u8 op_wfd_mode = MIRACAST_DISABLED; -+ -+ if (DBG_SESSION_TRACKER) -+ RTW_INFO(FUNC_ADPT_FMT" sta:%p\n", FUNC_ADPT_ARG(adapter), sta); -+ -+ if (!(sta->state & _FW_LINKED)) -+ goto exit; -+ -+ for (i = 0; i < SESSION_TRACKER_REG_ID_NUM; i++) { -+ if (st_ctl->reg[i].s_proto != 0) -+ break; -+ } -+ if (i >= SESSION_TRACKER_REG_ID_NUM) -+ goto chk_sta; -+ -+ _rtw_init_listhead(&dlist); -+ -+ _enter_critical_bh(&st_ctl->tracker_q.lock, &irqL); -+ -+ phead = &st_ctl->tracker_q.queue; -+ plist = get_next(phead); -+ pnext = get_next(plist); -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ st = LIST_CONTAINOR(plist, struct session_tracker, list); -+ plist = pnext; -+ pnext = get_next(pnext); -+ -+ if (st->status != ST_STATUS_ESTABLISH -+ && rtw_get_passing_time_ms(st->set_time) > ST_EXPIRE_MS -+ ) { -+ rtw_list_delete(&st->list); -+ rtw_list_insert_tail(&st->list, &dlist); -+ } -+ -+ /* TODO: check OS for status update */ -+ if (st->status == ST_STATUS_CHECK) -+ st->status = ST_STATUS_ESTABLISH; -+ -+ if (st->status != ST_STATUS_ESTABLISH) -+ continue; -+ -+ #ifdef CONFIG_WFD -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" local:%u, remote:%u, rtsp:%u, %u, %u\n", FUNC_ADPT_ARG(adapter) -+ , ntohs(st->local_port), ntohs(st->remote_port), adapter->wfd_info.rtsp_ctrlport, adapter->wfd_info.tdls_rtsp_ctrlport -+ , adapter->wfd_info.peer_rtsp_ctrlport); -+ if (ntohs(st->local_port) == adapter->wfd_info.rtsp_ctrlport) -+ op_wfd_mode |= MIRACAST_SINK; -+ if (ntohs(st->local_port) == adapter->wfd_info.tdls_rtsp_ctrlport) -+ op_wfd_mode |= MIRACAST_SINK; -+ if (ntohs(st->remote_port) == adapter->wfd_info.peer_rtsp_ctrlport) -+ op_wfd_mode |= MIRACAST_SOURCE; -+ #endif -+ } -+ -+ _exit_critical_bh(&st_ctl->tracker_q.lock, &irqL); -+ -+ plist = get_next(&dlist); -+ while (rtw_end_of_queue_search(&dlist, plist) == _FALSE) { -+ st = LIST_CONTAINOR(plist, struct session_tracker, list); -+ plist = get_next(plist); -+ rtw_mfree((u8 *)st, sizeof(struct session_tracker)); -+ } -+ -+chk_sta: -+ if (STA_OP_WFD_MODE(sta) != op_wfd_mode) { -+ STA_SET_OP_WFD_MODE(sta, op_wfd_mode); -+ rtw_sta_media_status_rpt_cmd(adapter, sta, 1); -+ } -+ -+exit: -+ return; -+} -+ -+void session_tracker_chk_for_adapter(_adapter *adapter) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct sta_info *sta; -+ int i; -+ _irqL irqL; -+ _list *plist, *phead; -+ u8 op_wfd_mode = MIRACAST_DISABLED; -+ -+ _enter_critical_bh(&stapriv->sta_hash_lock, &irqL); -+ -+ for (i = 0; i < NUM_STA; i++) { -+ phead = &(stapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ plist = get_next(plist); -+ -+ session_tracker_chk_for_sta(adapter, sta); -+ -+ op_wfd_mode |= STA_OP_WFD_MODE(sta); -+ } -+ } -+ -+ _exit_critical_bh(&stapriv->sta_hash_lock, &irqL); -+ -+#ifdef CONFIG_WFD -+ adapter->wfd_info.op_wfd_mode = MIRACAST_MODE_REVERSE(op_wfd_mode); -+#endif -+} -+ -+void session_tracker_cmd_hdl(_adapter *adapter, struct st_cmd_parm *parm) -+{ -+ u8 cmd = parm->cmd; -+ struct sta_info *sta = parm->sta; -+ -+ if (cmd == ST_CMD_CHK) { -+ if (sta) -+ session_tracker_chk_for_sta(adapter, sta); -+ else -+ session_tracker_chk_for_adapter(adapter); -+ -+ goto exit; -+ -+ } else if (cmd == ST_CMD_ADD || cmd == ST_CMD_DEL) { -+ struct st_ctl_t *st_ctl; -+ u32 local_naddr = parm->local_naddr; -+ u16 local_port = parm->local_port; -+ u32 remote_naddr = parm->remote_naddr; -+ u16 remote_port = parm->remote_port; -+ struct session_tracker *st = NULL; -+ _irqL irqL; -+ _list *plist, *phead; -+ u8 free_st = 0; -+ u8 alloc_st = 0; -+ -+ if (DBG_SESSION_TRACKER) -+ RTW_INFO(FUNC_ADPT_FMT" cmd:%u, sta:%p, local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), cmd, sta -+ , IP_ARG(&local_naddr), PORT_ARG(&local_port) -+ , IP_ARG(&remote_naddr), PORT_ARG(&remote_port) -+ ); -+ -+ if (!(sta->state & _FW_LINKED)) -+ goto exit; -+ -+ st_ctl = &sta->st_ctl; -+ -+ _enter_critical_bh(&st_ctl->tracker_q.lock, &irqL); -+ -+ phead = &st_ctl->tracker_q.queue; -+ plist = get_next(phead); -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ st = LIST_CONTAINOR(plist, struct session_tracker, list); -+ -+ if (st->local_naddr == local_naddr -+ && st->local_port == local_port -+ && st->remote_naddr == remote_naddr -+ && st->remote_port == remote_port) -+ break; -+ -+ plist = get_next(plist); -+ } -+ -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ st = NULL; -+ -+ switch (cmd) { -+ case ST_CMD_DEL: -+ if (st) { -+ rtw_list_delete(plist); -+ free_st = 1; -+ } -+ goto unlock; -+ case ST_CMD_ADD: -+ if (!st) -+ alloc_st = 1; -+ } -+ -+unlock: -+ _exit_critical_bh(&st_ctl->tracker_q.lock, &irqL); -+ -+ if (free_st) { -+ rtw_mfree((u8 *)st, sizeof(struct session_tracker)); -+ goto exit; -+ } -+ -+ if (alloc_st) { -+ st = (struct session_tracker *)rtw_zmalloc(sizeof(struct session_tracker)); -+ if (!st) -+ goto exit; -+ -+ st->local_naddr = local_naddr; -+ st->local_port = local_port; -+ st->remote_naddr = remote_naddr; -+ st->remote_port = remote_port; -+ st->set_time = rtw_get_current_time(); -+ st->status = ST_STATUS_CHECK; -+ -+ _enter_critical_bh(&st_ctl->tracker_q.lock, &irqL); -+ rtw_list_insert_tail(&st->list, phead); -+ _exit_critical_bh(&st_ctl->tracker_q.lock, &irqL); -+ } -+ } -+ -+exit: -+ return; -+} -+ -+u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ int ret = H2C_SUCCESS; -+ struct drvextra_cmd_parm *pdrvextra_cmd; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ pdrvextra_cmd = (struct drvextra_cmd_parm *)pbuf; -+ -+ switch (pdrvextra_cmd->ec_id) { -+ case STA_MSTATUS_RPT_WK_CID: -+ rtw_sta_media_status_rpt_cmd_hdl(padapter, (struct sta_media_status_rpt_cmd_parm *)pdrvextra_cmd->pbuf); -+ break; -+ -+ case DYNAMIC_CHK_WK_CID:/*only primary padapter go to this cmd, but execute dynamic_chk_wk_hdl() for two interfaces */ -+ rtw_dynamic_chk_wk_hdl(padapter); -+ break; -+ case POWER_SAVING_CTRL_WK_CID: -+ power_saving_wk_hdl(padapter); -+ break; -+#ifdef CONFIG_LPS -+ case LPS_CTRL_WK_CID: -+ lps_ctrl_wk_hdl(padapter, (u8)pdrvextra_cmd->type); -+ break; -+ case DM_IN_LPS_WK_CID: -+ rtw_dm_in_lps_hdl(padapter); -+ break; -+ case LPS_CHANGE_DTIM_CID: -+ rtw_lps_change_dtim_hdl(padapter, (u8)pdrvextra_cmd->type); -+ break; -+#endif -+#if (RATE_ADAPTIVE_SUPPORT == 1) -+ case RTP_TIMER_CFG_WK_CID: -+ rpt_timer_setting_wk_hdl(padapter, pdrvextra_cmd->type); -+ break; -+#endif -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ case ANT_SELECT_WK_CID: -+ antenna_select_wk_hdl(padapter, pdrvextra_cmd->type); -+ break; -+#endif -+#ifdef CONFIG_P2P_PS -+ case P2P_PS_WK_CID: -+ p2p_ps_wk_hdl(padapter, pdrvextra_cmd->type); -+ break; -+#endif -+#ifdef CONFIG_P2P -+ case P2P_PROTO_WK_CID: -+ /* -+ * Commented by Albert 2011/07/01 -+ * I used the type_size as the type command -+ */ -+ ret = p2p_protocol_wk_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); -+ break; -+#endif -+#ifdef CONFIG_AP_MODE -+ case CHECK_HIQ_WK_CID: -+ rtw_chk_hi_queue_hdl(padapter); -+ break; -+#endif -+#ifdef CONFIG_INTEL_WIDI -+ case INTEl_WIDI_WK_CID: -+ intel_widi_wk_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); -+ break; -+#endif -+ /* add for CONFIG_IEEE80211W, none 11w can use it */ -+ case RESET_SECURITYPRIV: -+ reset_securitypriv_hdl(padapter); -+ break; -+ case FREE_ASSOC_RESOURCES: -+ free_assoc_resources_hdl(padapter); -+ break; -+ case C2H_WK_CID: -+ switch (pdrvextra_cmd->type) { -+ #ifdef CONFIG_FW_C2H_REG -+ case C2H_TYPE_REG: -+ c2h_evt_hdl(padapter, pdrvextra_cmd->pbuf, NULL); -+ break; -+ #endif -+ #ifdef CONFIG_FW_C2H_PKT -+ case C2H_TYPE_PKT: -+ rtw_hal_c2h_pkt_hdl(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->size); -+ break; -+ #endif -+ default: -+ RTW_ERR("unknown C2H type:%d\n", pdrvextra_cmd->type); -+ rtw_warn_on(1); -+ break; -+ } -+ break; -+#ifdef CONFIG_BEAMFORMING -+ case BEAMFORMING_WK_CID: -+ beamforming_wk_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); -+ break; -+#endif -+ case DM_RA_MSK_WK_CID: -+ rtw_dm_ra_mask_hdl(padapter, (struct sta_info *)pdrvextra_cmd->pbuf); -+ break; -+#ifdef CONFIG_BT_COEXIST -+ case BTINFO_WK_CID: -+ rtw_btinfo_hdl(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->size); -+ break; -+#endif -+#ifdef CONFIG_DFS_MASTER -+ case DFS_MASTER_WK_CID: -+ rtw_dfs_master_hdl(padapter); -+ break; -+#endif -+ case SESSION_TRACKER_WK_CID: -+ session_tracker_cmd_hdl(padapter, (struct st_cmd_parm *)pdrvextra_cmd->pbuf); -+ break; -+ case EN_HW_UPDATE_TSF_WK_CID: -+ rtw_hal_set_hwreg(padapter, HW_VAR_EN_HW_UPDATE_TSF, NULL); -+ break; -+ case TEST_H2C_CID: -+ rtw_hal_fill_h2c_cmd(padapter, pdrvextra_cmd->pbuf[0], pdrvextra_cmd->size - 1, &pdrvextra_cmd->pbuf[1]); -+ break; -+#ifdef CONFIG_RTW_CUSTOMER_STR -+ case CUSTOMER_STR_WK_CID: -+ ret = rtw_customer_str_cmd_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); -+ break; -+#endif -+ default: -+ break; -+ } -+ -+ if (pdrvextra_cmd->pbuf && pdrvextra_cmd->size > 0) -+ rtw_mfree(pdrvextra_cmd->pbuf, pdrvextra_cmd->size); -+ -+ return ret; -+} -+ -+void rtw_survey_cmd_callback(_adapter *padapter , struct cmd_obj *pcmd) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ if (pcmd->res == H2C_DROPPED) { -+ /* TODO: cancel timer and do timeout handler directly... */ -+ /* need to make timeout handlerOS independent */ -+ mlme_set_scan_to_timer(pmlmepriv, 1); -+ } else if (pcmd->res != H2C_SUCCESS) { -+ mlme_set_scan_to_timer(pmlmepriv, 1); -+ } -+ -+ /* free cmd */ -+ rtw_free_cmd_obj(pcmd); -+ -+} -+void rtw_disassoc_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ if (pcmd->res != H2C_SUCCESS) { -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ set_fwstate(pmlmepriv, _FW_LINKED); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ goto exit; -+ } -+#ifdef CONFIG_BR_EXT -+ else /* clear bridge database */ -+ nat25_db_cleanup(padapter); -+#endif /* CONFIG_BR_EXT */ -+ -+ /* free cmd */ -+ rtw_free_cmd_obj(pcmd); -+ -+exit: -+ return; -+} -+ -+ -+void rtw_getmacreg_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) -+{ -+ -+ -+ rtw_free_cmd_obj(pcmd); -+ -+} -+ -+void rtw_joinbss_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ if (pcmd->res == H2C_DROPPED) { -+ /* TODO: cancel timer and do timeout handler directly... */ -+ /* need to make timeout handlerOS independent */ -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ } else if (pcmd->res != H2C_SUCCESS) -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ -+ rtw_free_cmd_obj(pcmd); -+ -+} -+ -+void rtw_create_ibss_post_hdl(_adapter *padapter, int status) -+{ -+ _irqL irqL; -+ u8 timer_cancelled; -+ struct sta_info *psta = NULL; -+ struct wlan_network *pwlan = NULL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ WLAN_BSSID_EX *pdev_network = &padapter->registrypriv.dev_network; -+ struct wlan_network *mlme_cur_network = &(pmlmepriv->cur_network); -+ -+ if (status != H2C_SUCCESS) -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ -+ _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ { -+ _irqL irqL; -+ -+ pwlan = _rtw_alloc_network(pmlmepriv); -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ if (pwlan == NULL) { -+ pwlan = rtw_get_oldest_wlan_network(&pmlmepriv->scanned_queue); -+ if (pwlan == NULL) { -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ goto createbss_cmd_fail; -+ } -+ pwlan->last_scanned = rtw_get_current_time(); -+ } else -+ rtw_list_insert_tail(&(pwlan->list), &pmlmepriv->scanned_queue.queue); -+ -+ pdev_network->Length = get_WLAN_BSSID_EX_sz(pdev_network); -+ _rtw_memcpy(&(pwlan->network), pdev_network, pdev_network->Length); -+ /* pwlan->fixed = _TRUE; */ -+ -+ /* copy pdev_network information to pmlmepriv->cur_network */ -+ _rtw_memcpy(&mlme_cur_network->network, pdev_network, (get_WLAN_BSSID_EX_sz(pdev_network))); -+ -+#if 0 -+ /* reset DSConfig */ -+ mlme_cur_network->network.Configuration.DSConfig = (u32)rtw_ch2freq(pdev_network->Configuration.DSConfig); -+#endif -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ /* we will set _FW_LINKED when there is one more sat to join us (rtw_stassoc_event_callback) */ -+ } -+ -+createbss_cmd_fail: -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+exit: -+ return; -+} -+ -+ -+ -+void rtw_setstaKey_cmdrsp_callback(_adapter *padapter , struct cmd_obj *pcmd) -+{ -+ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct set_stakey_rsp *psetstakey_rsp = (struct set_stakey_rsp *)(pcmd->rsp); -+ struct sta_info *psta = rtw_get_stainfo(pstapriv, psetstakey_rsp->addr); -+ -+ -+ if (psta == NULL) { -+ goto exit; -+ } -+ -+ /* psta->aid = psta->mac_id = psetstakey_rsp->keyid; */ /* CAM_ID(CAM_ENTRY) */ -+ -+exit: -+ -+ rtw_free_cmd_obj(pcmd); -+ -+ -+} -+void rtw_setassocsta_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) -+{ -+ _irqL irqL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct set_assocsta_parm *passocsta_parm = (struct set_assocsta_parm *)(pcmd->parmbuf); -+ struct set_assocsta_rsp *passocsta_rsp = (struct set_assocsta_rsp *)(pcmd->rsp); -+ struct sta_info *psta = rtw_get_stainfo(pstapriv, passocsta_parm->addr); -+ -+ -+ if (psta == NULL) { -+ goto exit; -+ } -+ -+ psta->aid = psta->mac_id = passocsta_rsp->cam_id; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) && (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE)) -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+ set_fwstate(pmlmepriv, _FW_LINKED); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+exit: -+ rtw_free_cmd_obj(pcmd); -+ -+} -+ -+void rtw_getrttbl_cmd_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+void rtw_getrttbl_cmd_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) -+{ -+ -+ rtw_free_cmd_obj(pcmd); -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) -+ padapter->mppriv.workparam.bcompleted = _TRUE; -+#endif -+ -+ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_debug.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_debug.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_debug.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_debug.c 2018-02-11 21:44:27.136145918 +0200 -@@ -0,0 +1,4583 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_DEBUG_C_ -+ -+#include -+#include -+ -+#ifdef CONFIG_RTW_DEBUG -+const char *rtw_log_level_str[] = { -+ "_DRV_NONE_ = 0", -+ "_DRV_ALWAYS_ = 1", -+ "_DRV_ERR_ = 2", -+ "_DRV_WARNING_ = 3", -+ "_DRV_INFO_ = 4", -+ "_DRV_DEBUG_ = 5", -+ "_DRV_MAX_ = 6", -+}; -+#endif -+ -+#ifdef CONFIG_DEBUG_RTL871X -+ u64 GlobalDebugComponents = 0; -+#endif /* CONFIG_DEBUG_RTL871X */ -+ -+#include -+ -+#ifdef CONFIG_TDLS -+ #define TDLS_DBG_INFO_SPACE_BTWN_ITEM_AND_VALUE 41 -+#endif -+ -+void dump_drv_version(void *sel) -+{ -+ RTW_PRINT_SEL(sel, "%s %s\n", DRV_NAME, DRIVERVERSION); -+ RTW_PRINT_SEL(sel, "build time: %s %s\n", __DATE__, __TIME__); -+} -+ -+void dump_drv_cfg(void *sel) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+ char *kernel_version = utsname()->release; -+ -+ RTW_PRINT_SEL(sel, "\nKernel Version: %s\n", kernel_version); -+#endif -+ -+ RTW_PRINT_SEL(sel, "Driver Version: %s\n", DRIVERVERSION); -+ RTW_PRINT_SEL(sel, "------------------------------------------------\n"); -+#ifdef CONFIG_IOCTL_CFG80211 -+ RTW_PRINT_SEL(sel, "CFG80211\n"); -+#ifdef RTW_USE_CFG80211_STA_EVENT -+ RTW_PRINT_SEL(sel, "RTW_USE_CFG80211_STA_EVENT\n"); -+#endif -+#else -+ RTW_PRINT_SEL(sel, "WEXT\n"); -+#endif -+ -+ RTW_PRINT_SEL(sel, "DBG:%d\n", DBG); -+#ifdef CONFIG_RTW_DEBUG -+ RTW_PRINT_SEL(sel, "CONFIG_RTW_DEBUG\n"); -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ RTW_PRINT_SEL(sel, "CONFIG_CONCURRENT_MODE\n"); -+#endif -+ -+#ifdef CONFIG_POWER_SAVING -+ RTW_PRINT_SEL(sel, "CONFIG_POWER_SAVING\n"); -+#endif -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ RTW_PRINT_SEL(sel, "LOAD_PHY_PARA_FROM_FILE - REALTEK_CONFIG_PATH=%s\n", REALTEK_CONFIG_PATH); -+ #if defined(CONFIG_MULTIDRV) || defined(REALTEK_CONFIG_PATH_WITH_IC_NAME_FOLDER) -+ RTW_PRINT_SEL(sel, "LOAD_PHY_PARA_FROM_FILE - REALTEK_CONFIG_PATH_WITH_IC_NAME_FOLDER\n"); -+ #endif -+ -+/* configurations about TX power */ -+#ifdef CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY -+ RTW_PRINT_SEL(sel, "CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY\n"); -+#endif -+#ifdef CONFIG_CALIBRATE_TX_POWER_TO_MAX -+ RTW_PRINT_SEL(sel, "CONFIG_CALIBRATE_TX_POWER_TO_MAX\n"); -+#endif -+#endif -+ RTW_PRINT_SEL(sel, "RTW_DEF_MODULE_REGULATORY_CERT=0x%02x\n", RTW_DEF_MODULE_REGULATORY_CERT); -+ -+ RTW_PRINT_SEL(sel, "CONFIG_TXPWR_BY_RATE_EN=%d\n", CONFIG_TXPWR_BY_RATE_EN); -+ RTW_PRINT_SEL(sel, "CONFIG_TXPWR_LIMIT_EN=%d\n", CONFIG_TXPWR_LIMIT_EN); -+ -+ -+#ifdef CONFIG_DISABLE_ODM -+ RTW_PRINT_SEL(sel, "CONFIG_DISABLE_ODM\n"); -+#endif -+ -+#ifdef CONFIG_MINIMAL_MEMORY_USAGE -+ RTW_PRINT_SEL(sel, "CONFIG_MINIMAL_MEMORY_USAGE\n"); -+#endif -+ -+ RTW_PRINT_SEL(sel, "CONFIG_RTW_ADAPTIVITY_EN = %d\n", CONFIG_RTW_ADAPTIVITY_EN); -+#if (CONFIG_RTW_ADAPTIVITY_EN) -+ RTW_PRINT_SEL(sel, "ADAPTIVITY_MODE = %s\n", (CONFIG_RTW_ADAPTIVITY_MODE) ? "carrier_sense" : "normal"); -+#endif -+ -+#ifdef CONFIG_WOWLAN -+ RTW_PRINT_SEL(sel, "CONFIG_WOWLAN - "); -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ RTW_PRINT_SEL(sel, "CONFIG_GPIO_WAKEUP - WAKEUP_GPIO_IDX:%d\n", WAKEUP_GPIO_IDX); -+#endif -+#endif -+ -+#ifdef CONFIG_TDLS -+ RTW_PRINT_SEL(sel, "CONFIG_TDLS\n"); -+#endif -+ -+#ifdef CONFIG_RTW_80211R -+ RTW_PRINT_SEL(sel, "CONFIG_RTW_80211R\n"); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+#ifdef CONFIG_SUPPORT_USB_INT -+ RTW_PRINT_SEL(sel, "CONFIG_SUPPORT_USB_INT\n"); -+#endif -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+ RTW_PRINT_SEL(sel, "CONFIG_USB_INTERRUPT_IN_PIPE\n"); -+#endif -+#ifdef CONFIG_USB_TX_AGGREGATION -+ RTW_PRINT_SEL(sel, "CONFIG_USB_TX_AGGREGATION\n"); -+#endif -+#ifdef CONFIG_USB_RX_AGGREGATION -+ RTW_PRINT_SEL(sel, "CONFIG_USB_RX_AGGREGATION\n"); -+#endif -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ RTW_PRINT_SEL(sel, "CONFIG_USE_USB_BUFFER_ALLOC_TX\n"); -+#endif -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ RTW_PRINT_SEL(sel, "CONFIG_USE_USB_BUFFER_ALLOC_RX\n"); -+#endif -+#ifdef CONFIG_PREALLOC_RECV_SKB -+ RTW_PRINT_SEL(sel, "CONFIG_PREALLOC_RECV_SKB\n"); -+#endif -+#ifdef CONFIG_FIX_NR_BULKIN_BUFFER -+ RTW_PRINT_SEL(sel, "CONFIG_FIX_NR_BULKIN_BUFFER\n"); -+#endif -+#endif /*CONFIG_USB_HCI*/ -+ -+#ifdef CONFIG_SDIO_HCI -+#ifdef CONFIG_TX_AGGREGATION -+ RTW_PRINT_SEL(sel, "CONFIG_TX_AGGREGATION\n"); -+#endif -+#ifdef CONFIG_RX_AGGREGATION -+ RTW_PRINT_SEL(sel, "CONFIG_RX_AGGREGATION\n"); -+#endif -+#endif /*CONFIG_SDIO_HCI*/ -+ -+#ifdef CONFIG_PCI_HCI -+#endif -+ -+ RTW_PRINT_SEL(sel, "MAX_XMITBUF_SZ = %d\n", MAX_XMITBUF_SZ); -+ RTW_PRINT_SEL(sel, "MAX_RECVBUF_SZ = %d\n", MAX_RECVBUF_SZ); -+ -+} -+ -+void dump_log_level(void *sel) -+{ -+#ifdef CONFIG_RTW_DEBUG -+ int i; -+ -+ RTW_PRINT_SEL(sel, "drv_log_level:%d\n", rtw_drv_log_level); -+ for (i = 0; i <= _DRV_MAX_; i++) { -+ if (rtw_log_level_str[i]) -+ RTW_PRINT_SEL(sel, "%c %s = %d\n", -+ (rtw_drv_log_level == i) ? '+' : ' ', rtw_log_level_str[i], i); -+ } -+#else -+ RTW_PRINT_SEL(sel, "CONFIG_RTW_DEBUG is disabled\n"); -+#endif -+} -+ -+#ifdef CONFIG_SDIO_HCI -+void sd_f0_reg_dump(void *sel, _adapter *adapter) -+{ -+ int i; -+ -+ for (i = 0x0; i <= 0xff; i++) { -+ if (i % 16 == 0) -+ RTW_PRINT_SEL(sel, "0x%02x ", i); -+ -+ _RTW_PRINT_SEL(sel, "%02x ", rtw_sd_f0_read8(adapter, i)); -+ -+ if (i % 16 == 15) -+ _RTW_PRINT_SEL(sel, "\n"); -+ else if (i % 8 == 7) -+ _RTW_PRINT_SEL(sel, "\t"); -+ } -+} -+ -+void sdio_local_reg_dump(void *sel, _adapter *adapter) -+{ -+ int i, j = 1; -+ -+ for (i = 0x0; i < 0x100; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%02x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, (0x1025 << 16) | i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+} -+#endif /* CONFIG_SDIO_HCI */ -+ -+void mac_reg_dump(void *sel, _adapter *adapter) -+{ -+ int i, j = 1; -+ -+ RTW_PRINT_SEL(sel, "======= MAC REG =======\n"); -+ -+ for (i = 0x0; i < 0x800; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%03x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+#ifdef CONFIG_RTL8814A -+ { -+ for (i = 0x1000; i < 0x1650; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%03x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ } -+#endif /* CONFIG_RTL8814A */ -+ -+#ifdef CONFIG_RTL8822B -+ for (i = 0x1000; i < 0x1800; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%03x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif /* CONFIG_RTL8822B */ -+} -+ -+void bb_reg_dump(void *sel, _adapter *adapter) -+{ -+ int i, j = 1; -+ -+ RTW_PRINT_SEL(sel, "======= BB REG =======\n"); -+ for (i = 0x800; i < 0x1000; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%03x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+#ifdef CONFIG_RTL8822B -+ for (i = 0x1800; i < 0x2000; i += 4) { -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%03x", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif /* CONFIG_RTL8822B */ -+} -+ -+void rf_reg_dump(void *sel, _adapter *adapter) -+{ -+ int i, j = 1, path; -+ u32 value; -+ u8 rf_type = 0; -+ u8 path_nums = 0; -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if ((RF_1T2R == rf_type) || (RF_1T1R == rf_type)) -+ path_nums = 1; -+ else -+ path_nums = 2; -+ -+ RTW_PRINT_SEL(sel, "======= RF REG =======\n"); -+ -+ for (path = 0; path < path_nums; path++) { -+ RTW_PRINT_SEL(sel, "RF_Path(%x)\n", path); -+ for (i = 0; i < 0x100; i++) { -+ value = rtw_hal_read_rfreg(adapter, path, i, 0xffffffff); -+ if (j % 4 == 1) -+ RTW_PRINT_SEL(sel, "0x%02x ", i); -+ _RTW_PRINT_SEL(sel, " 0x%08x ", value); -+ if ((j++) % 4 == 0) -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ } -+} -+ -+static u8 fwdl_test_chksum_fail = 0; -+static u8 fwdl_test_wintint_rdy_fail = 0; -+ -+bool rtw_fwdl_test_trigger_chksum_fail(void) -+{ -+ if (fwdl_test_chksum_fail) { -+ RTW_PRINT("fwdl test case: trigger chksum_fail\n"); -+ fwdl_test_chksum_fail--; -+ return _TRUE; -+ } -+ return _FALSE; -+} -+ -+bool rtw_fwdl_test_trigger_wintint_rdy_fail(void) -+{ -+ if (fwdl_test_wintint_rdy_fail) { -+ RTW_PRINT("fwdl test case: trigger wintint_rdy_fail\n"); -+ fwdl_test_wintint_rdy_fail--; -+ return _TRUE; -+ } -+ return _FALSE; -+} -+ -+static u32 g_wait_hiq_empty_ms = 0; -+ -+u32 rtw_get_wait_hiq_empty_ms(void) -+{ -+ return g_wait_hiq_empty_ms; -+} -+ -+static u8 del_rx_ampdu_test_no_tx_fail = 0; -+ -+bool rtw_del_rx_ampdu_test_trigger_no_tx_fail(void) -+{ -+ if (del_rx_ampdu_test_no_tx_fail) { -+ RTW_PRINT("del_rx_ampdu test case: trigger no_tx_fail\n"); -+ del_rx_ampdu_test_no_tx_fail--; -+ return _TRUE; -+ } -+ return _FALSE; -+} -+ -+void rtw_sink_rtp_seq_dbg(_adapter *adapter, _pkt *pkt) -+{ -+ struct recv_priv *precvpriv = &(adapter->recvpriv); -+ if (precvpriv->sink_udpport > 0) { -+ if (*((u16 *)((pkt->data) + 0x24)) == cpu_to_be16(precvpriv->sink_udpport)) { -+ precvpriv->pre_rtp_rxseq = precvpriv->cur_rtp_rxseq; -+ precvpriv->cur_rtp_rxseq = be16_to_cpu(*((u16 *)((pkt->data) + 0x2C))); -+ if (precvpriv->pre_rtp_rxseq + 1 != precvpriv->cur_rtp_rxseq) -+ RTW_INFO("%s : RTP Seq num from %d to %d\n", __FUNCTION__, precvpriv->pre_rtp_rxseq, precvpriv->cur_rtp_rxseq); -+ } -+ } -+} -+ -+void sta_rx_reorder_ctl_dump(void *sel, struct sta_info *sta) -+{ -+ struct recv_reorder_ctrl *reorder_ctl; -+ int i; -+ -+ for (i = 0; i < 16; i++) { -+ reorder_ctl = &sta->recvreorder_ctrl[i]; -+ if (reorder_ctl->ampdu_size != RX_AMPDU_SIZE_INVALID || reorder_ctl->indicate_seq != 0xFFFF) { -+ RTW_PRINT_SEL(sel, "tid=%d, enable=%d, ampdu_size=%u, indicate_seq=%u\n" -+ , i, reorder_ctl->enable, reorder_ctl->ampdu_size, reorder_ctl->indicate_seq -+ ); -+ } -+ } -+} -+ -+void dump_tx_rate_bmp(void *sel, struct dvobj_priv *dvobj) -+{ -+ _adapter *adapter = dvobj_get_primary_adapter(dvobj); -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ u8 bw; -+ -+ RTW_PRINT_SEL(sel, "%-6s", "bw"); -+ if (hal_chk_proto_cap(adapter, PROTO_CAP_11AC)) -+ _RTW_PRINT_SEL(sel, " %-11s", "vht"); -+ -+ _RTW_PRINT_SEL(sel, " %-11s %-4s %-3s\n", "ht", "ofdm", "cck"); -+ -+ for (bw = CHANNEL_WIDTH_20; bw <= CHANNEL_WIDTH_160; bw++) { -+ if (!hal_is_bw_support(adapter, bw)) -+ continue; -+ -+ RTW_PRINT_SEL(sel, "%6s", ch_width_str(bw)); -+ if (hal_chk_proto_cap(adapter, PROTO_CAP_11AC)) { -+ _RTW_PRINT_SEL(sel, " %03x %03x %03x" -+ , RATE_BMP_GET_VHT_3SS(rfctl->rate_bmp_vht_by_bw[bw]) -+ , RATE_BMP_GET_VHT_2SS(rfctl->rate_bmp_vht_by_bw[bw]) -+ , RATE_BMP_GET_VHT_1SS(rfctl->rate_bmp_vht_by_bw[bw]) -+ ); -+ } -+ -+ _RTW_PRINT_SEL(sel, " %02x %02x %02x %02x" -+ , bw <= CHANNEL_WIDTH_40 ? RATE_BMP_GET_HT_4SS(rfctl->rate_bmp_ht_by_bw[bw]) : 0 -+ , bw <= CHANNEL_WIDTH_40 ? RATE_BMP_GET_HT_3SS(rfctl->rate_bmp_ht_by_bw[bw]) : 0 -+ , bw <= CHANNEL_WIDTH_40 ? RATE_BMP_GET_HT_2SS(rfctl->rate_bmp_ht_by_bw[bw]) : 0 -+ , bw <= CHANNEL_WIDTH_40 ? RATE_BMP_GET_HT_1SS(rfctl->rate_bmp_ht_by_bw[bw]) : 0 -+ ); -+ -+ _RTW_PRINT_SEL(sel, " %03x %01x\n" -+ , bw <= CHANNEL_WIDTH_20 ? RATE_BMP_GET_OFDM(rfctl->rate_bmp_cck_ofdm) : 0 -+ , bw <= CHANNEL_WIDTH_20 ? RATE_BMP_GET_CCK(rfctl->rate_bmp_cck_ofdm) : 0 -+ ); -+ } -+} -+ -+void dump_adapters_status(void *sel, struct dvobj_priv *dvobj) -+{ -+ struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); -+ int i; -+ _adapter *iface; -+ u8 u_ch, u_bw, u_offset; -+ -+ dump_mi_status(sel, dvobj); -+ -+ RTW_PRINT_SEL(sel, "dev status:%s%s\n\n" -+ , dev_is_surprise_removed(dvobj) ? " SR" : "" -+ , dev_is_drv_stopped(dvobj) ? " DS" : "" -+ ); -+ -+#ifdef CONFIG_P2P -+#define P2P_INFO_TITLE_FMT " %-3s %-4s" -+#define P2P_INFO_TITLE_ARG , "lch", "p2ps" -+#ifdef CONFIG_IOCTL_CFG80211 -+#define P2P_INFO_VALUE_FMT " %3u %c%3u" -+#define P2P_INFO_VALUE_ARG , iface->wdinfo.listen_channel, iface->wdev_data.p2p_enabled ? 'e' : ' ', rtw_p2p_state(&iface->wdinfo) -+#else -+#define P2P_INFO_VALUE_FMT " %3u %4u" -+#define P2P_INFO_VALUE_ARG , iface->wdinfo.listen_channel, rtw_p2p_state(&iface->wdinfo) -+#endif -+#define P2P_INFO_DASH "---------" -+#else -+#define P2P_INFO_TITLE_FMT "" -+#define P2P_INFO_TITLE_ARG -+#define P2P_INFO_VALUE_FMT "" -+#define P2P_INFO_VALUE_ARG -+#define P2P_INFO_DASH -+#endif -+ -+ RTW_PRINT_SEL(sel, "%-2s %-15s %c %-3s %-3s %-3s %-17s %-4s %-7s" -+ P2P_INFO_TITLE_FMT -+ " %s\n" -+ , "id", "ifname", ' ', "bup", "nup", "ncd", "macaddr", "port", "ch" -+ P2P_INFO_TITLE_ARG -+ , "status"); -+ -+ RTW_PRINT_SEL(sel, "---------------------------------------------------------------" -+ P2P_INFO_DASH -+ "-------\n"); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface) { -+ RTW_PRINT_SEL(sel, "%2d %-15s %c %3u %3u %3u "MAC_FMT" %4hhu %3u,%u,%u" -+ P2P_INFO_VALUE_FMT -+ " "MLME_STATE_FMT"\n" -+ , i, iface->registered ? ADPT_ARG(iface) : NULL -+ , iface->registered ? 'R' : ' ' -+ , iface->bup -+ , iface->netif_up -+ , iface->net_closed -+ , MAC_ARG(adapter_mac_addr(iface)) -+ , get_hw_port(iface) -+ , iface->mlmeextpriv.cur_channel -+ , iface->mlmeextpriv.cur_bwmode -+ , iface->mlmeextpriv.cur_ch_offset -+ P2P_INFO_VALUE_ARG -+ , MLME_STATE_ARG(iface) -+ ); -+ } -+ } -+ -+ RTW_PRINT_SEL(sel, "---------------------------------------------------------------" -+ P2P_INFO_DASH -+ "-------\n"); -+ -+ rtw_mi_get_ch_setting_union(dvobj->padapters[IFACE_ID0], &u_ch, &u_bw, &u_offset); -+ RTW_PRINT_SEL(sel, "%55s %3u,%u,%u\n" -+ , "union:" -+ , u_ch, u_bw, u_offset -+ ); -+ -+ RTW_PRINT_SEL(sel, "%55s %3u,%u,%u\n" -+ , "oper:" -+ , dvobj->oper_channel -+ , dvobj->oper_bwmode -+ , dvobj->oper_ch_offset -+ ); -+ -+#ifdef CONFIG_DFS_MASTER -+ if (rfctl->radar_detect_ch != 0) { -+ u32 non_ocp_ms; -+ u32 cac_ms; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!dvobj->padapters[i]) -+ continue; -+ if (check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_AP_STATE) -+ && check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_ASOC_STATE)) -+ break; -+ } -+ -+ if (i >= dvobj->iface_nums) { -+ RTW_PRINT_SEL(sel, "DFS master enable without AP mode???"); -+ goto end_dfs_master; -+ } -+ -+ RTW_PRINT_SEL(sel, "%55s %3u,%u,%u" -+ , "radar_detect:" -+ , rfctl->radar_detect_ch -+ , rfctl->radar_detect_bw -+ , rfctl->radar_detect_offset -+ ); -+ -+ _RTW_PRINT_SEL(sel, ", domain:%u", rtw_odm_get_dfs_domain(dvobj->padapters[IFACE_ID0])); -+ -+ rtw_get_ch_waiting_ms(dvobj->padapters[i] -+ , rfctl->radar_detect_ch -+ , rfctl->radar_detect_bw -+ , rfctl->radar_detect_offset -+ , &non_ocp_ms -+ , &cac_ms -+ ); -+ -+ if (non_ocp_ms) -+ _RTW_PRINT_SEL(sel, ", non_ocp:%d", non_ocp_ms); -+ if (cac_ms) -+ _RTW_PRINT_SEL(sel, ", cac:%d", cac_ms); -+end_dfs_master: -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+#endif /* CONFIG_DFS_MASTER */ -+} -+ -+#define SEC_CAM_ENT_ID_TITLE_FMT "%-2s" -+#define SEC_CAM_ENT_ID_TITLE_ARG "id" -+#define SEC_CAM_ENT_ID_VALUE_FMT "%2u" -+#define SEC_CAM_ENT_ID_VALUE_ARG(id) (id) -+ -+#define SEC_CAM_ENT_TITLE_FMT "%-6s %-17s %-32s %-3s %-7s %-2s %-2s %-5s" -+#define SEC_CAM_ENT_TITLE_ARG "ctrl", "addr", "key", "kid", "type", "MK", "GK", "valid" -+#define SEC_CAM_ENT_VALUE_FMT "0x%04x "MAC_FMT" "KEY_FMT" %3u %-7s %2u %2u %5u" -+#define SEC_CAM_ENT_VALUE_ARG(ent) \ -+ (ent)->ctrl \ -+ , MAC_ARG((ent)->mac) \ -+ , KEY_ARG((ent)->key) \ -+ , ((ent)->ctrl) & 0x03 \ -+ , security_type_str((((ent)->ctrl) >> 2) & 0x07) \ -+ , (((ent)->ctrl) >> 5) & 0x01 \ -+ , (((ent)->ctrl) >> 6) & 0x01 \ -+ , (((ent)->ctrl) >> 15) & 0x01 -+ -+void dump_sec_cam_ent(void *sel, struct sec_cam_ent *ent, int id) -+{ -+ if (id >= 0) { -+ RTW_PRINT_SEL(sel, SEC_CAM_ENT_ID_VALUE_FMT " " SEC_CAM_ENT_VALUE_FMT"\n" -+ , SEC_CAM_ENT_ID_VALUE_ARG(id), SEC_CAM_ENT_VALUE_ARG(ent)); -+ } else -+ RTW_PRINT_SEL(sel, SEC_CAM_ENT_VALUE_FMT"\n", SEC_CAM_ENT_VALUE_ARG(ent)); -+} -+ -+void dump_sec_cam_ent_title(void *sel, u8 has_id) -+{ -+ if (has_id) { -+ RTW_PRINT_SEL(sel, SEC_CAM_ENT_ID_TITLE_FMT " " SEC_CAM_ENT_TITLE_FMT"\n" -+ , SEC_CAM_ENT_ID_TITLE_ARG, SEC_CAM_ENT_TITLE_ARG); -+ } else -+ RTW_PRINT_SEL(sel, SEC_CAM_ENT_TITLE_FMT"\n", SEC_CAM_ENT_TITLE_ARG); -+} -+ -+void dump_sec_cam(void *sel, _adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ struct sec_cam_ent ent; -+ int i; -+ -+ RTW_PRINT_SEL(sel, "HW sec cam:\n"); -+ dump_sec_cam_ent_title(sel, 1); -+ for (i = 0; i < cam_ctl->num; i++) { -+ rtw_sec_read_cam_ent(adapter, i, (u8 *)(&ent.ctrl), ent.mac, ent.key); -+ dump_sec_cam_ent(sel , &ent, i); -+ } -+} -+ -+void dump_sec_cam_cache(void *sel, _adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ int i; -+ -+ RTW_PRINT_SEL(sel, "SW sec cam cache:\n"); -+ dump_sec_cam_ent_title(sel, 1); -+ for (i = 0; i < cam_ctl->num; i++) { -+ if (dvobj->cam_cache[i].ctrl != 0) -+ dump_sec_cam_ent(sel, &dvobj->cam_cache[i], i); -+ } -+ -+} -+ -+#ifdef CONFIG_PROC_DEBUG -+ssize_t proc_set_write_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 addr, val, len; -+ -+ if (count < 3) { -+ RTW_INFO("argument size is less than 3\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%x %x %x", &addr, &val, &len); -+ -+ if (num != 3) { -+ RTW_INFO("invalid write_reg parameter!\n"); -+ return count; -+ } -+ -+ switch (len) { -+ case 1: -+ rtw_write8(padapter, addr, (u8)val); -+ break; -+ case 2: -+ rtw_write16(padapter, addr, (u16)val); -+ break; -+ case 4: -+ rtw_write32(padapter, addr, val); -+ break; -+ default: -+ RTW_INFO("error write length=%d", len); -+ break; -+ } -+ -+ } -+ -+ return count; -+ -+} -+ -+static u32 proc_get_read_addr = 0xeeeeeeee; -+static u32 proc_get_read_len = 0x4; -+ -+int proc_get_read_reg(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (proc_get_read_addr == 0xeeeeeeee) { -+ RTW_PRINT_SEL(m, "address not initialized\n"); -+ return 0; -+ } -+ -+ switch (proc_get_read_len) { -+ case 1: -+ RTW_PRINT_SEL(m, "rtw_read8(0x%x)=0x%x\n", proc_get_read_addr, rtw_read8(padapter, proc_get_read_addr)); -+ break; -+ case 2: -+ RTW_PRINT_SEL(m, "rtw_read16(0x%x)=0x%x\n", proc_get_read_addr, rtw_read16(padapter, proc_get_read_addr)); -+ break; -+ case 4: -+ RTW_PRINT_SEL(m, "rtw_read32(0x%x)=0x%x\n", proc_get_read_addr, rtw_read32(padapter, proc_get_read_addr)); -+ break; -+ default: -+ RTW_PRINT_SEL(m, "error read length=%d\n", proc_get_read_len); -+ break; -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_read_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ char tmp[16]; -+ u32 addr, len; -+ -+ if (count < 2) { -+ RTW_INFO("argument size is less than 2\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%x %x", &addr, &len); -+ -+ if (num != 2) { -+ RTW_INFO("invalid read_reg parameter!\n"); -+ return count; -+ } -+ -+ proc_get_read_addr = addr; -+ -+ proc_get_read_len = len; -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_fwstate(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ RTW_PRINT_SEL(m, "fwstate=0x%x\n", get_fwstate(pmlmepriv)); -+ -+ return 0; -+} -+ -+int proc_get_sec_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct security_priv *sec = &padapter->securitypriv; -+ -+ RTW_PRINT_SEL(m, "auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", -+ sec->dot11AuthAlgrthm, sec->dot11PrivacyAlgrthm, -+ sec->ndisauthtype, sec->ndisencryptstatus); -+ -+ RTW_PRINT_SEL(m, "hw_decrypted=%d\n", sec->hw_decrypted); -+ -+#ifdef DBG_SW_SEC_CNT -+ RTW_PRINT_SEL(m, "wep_sw_enc_cnt=%llu, %llu, %llu\n" -+ , sec->wep_sw_enc_cnt_bc , sec->wep_sw_enc_cnt_mc, sec->wep_sw_enc_cnt_uc); -+ RTW_PRINT_SEL(m, "wep_sw_dec_cnt=%llu, %llu, %llu\n" -+ , sec->wep_sw_dec_cnt_bc , sec->wep_sw_dec_cnt_mc, sec->wep_sw_dec_cnt_uc); -+ -+ RTW_PRINT_SEL(m, "tkip_sw_enc_cnt=%llu, %llu, %llu\n" -+ , sec->tkip_sw_enc_cnt_bc , sec->tkip_sw_enc_cnt_mc, sec->tkip_sw_enc_cnt_uc); -+ RTW_PRINT_SEL(m, "tkip_sw_dec_cnt=%llu, %llu, %llu\n" -+ , sec->tkip_sw_dec_cnt_bc , sec->tkip_sw_dec_cnt_mc, sec->tkip_sw_dec_cnt_uc); -+ -+ RTW_PRINT_SEL(m, "aes_sw_enc_cnt=%llu, %llu, %llu\n" -+ , sec->aes_sw_enc_cnt_bc , sec->aes_sw_enc_cnt_mc, sec->aes_sw_enc_cnt_uc); -+ RTW_PRINT_SEL(m, "aes_sw_dec_cnt=%llu, %llu, %llu\n" -+ , sec->aes_sw_dec_cnt_bc , sec->aes_sw_dec_cnt_mc, sec->aes_sw_dec_cnt_uc); -+#endif /* DBG_SW_SEC_CNT */ -+ -+ return 0; -+} -+ -+int proc_get_mlmext_state(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ RTW_PRINT_SEL(m, "pmlmeinfo->state=0x%x\n", pmlmeinfo->state); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_LAYER2_ROAMING -+int proc_get_roam_flags(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "0x%02x\n", rtw_roam_flags(adapter)); -+ -+ return 0; -+} -+ -+ssize_t proc_set_roam_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ char tmp[32]; -+ u8 flags; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &flags); -+ -+ if (num == 1) -+ rtw_assign_roam_flags(adapter, flags); -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_roam_param(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ -+ RTW_PRINT_SEL(m, "%12s %12s %11s %14s\n", "rssi_diff_th", "scanr_exp_ms", "scan_int_ms", "rssi_threshold"); -+ RTW_PRINT_SEL(m, "%-12u %-12u %-11u %-14u\n" -+ , mlme->roam_rssi_diff_th -+ , mlme->roam_scanr_exp_ms -+ , mlme->roam_scan_int_ms -+ , mlme->roam_rssi_threshold -+ ); -+ -+ return 0; -+} -+ -+ssize_t proc_set_roam_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ -+ char tmp[32]; -+ u8 rssi_diff_th; -+ u32 scanr_exp_ms; -+ u32 scan_int_ms; -+ u8 rssi_threshold; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu %u %u %hhu", &rssi_diff_th, &scanr_exp_ms, &scan_int_ms, &rssi_threshold); -+ -+ if (num >= 1) -+ mlme->roam_rssi_diff_th = rssi_diff_th; -+ if (num >= 2) -+ mlme->roam_scanr_exp_ms = scanr_exp_ms; -+ if (num >= 3) -+ mlme->roam_scan_int_ms = scan_int_ms; -+ if (num >= 4) -+ mlme->roam_rssi_threshold = rssi_threshold; -+ } -+ -+ return count; -+ -+} -+ -+ssize_t proc_set_roam_tgt_addr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ char tmp[32]; -+ u8 addr[ETH_ALEN]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx", addr, addr + 1, addr + 2, addr + 3, addr + 4, addr + 5); -+ if (num == 6) -+ _rtw_memcpy(adapter->mlmepriv.roam_tgt_addr, addr, ETH_ALEN); -+ -+ RTW_INFO("set roam_tgt_addr to "MAC_FMT"\n", MAC_ARG(adapter->mlmepriv.roam_tgt_addr)); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_LAYER2_ROAMING */ -+ -+#ifdef CONFIG_RTW_80211R -+ssize_t proc_set_ft_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ char tmp[32]; -+ u8 flags; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%hhx", &flags); -+ -+ if (num == 1) -+ adapter->mlmepriv.ftpriv.ft_flags = flags; -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_ft_flags(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "0x%02x\n", adapter->mlmepriv.ftpriv.ft_flags); -+ -+ return 0; -+} -+#endif -+ -+int proc_get_qos_option(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ RTW_PRINT_SEL(m, "qos_option=%d\n", pmlmepriv->qospriv.qos_option); -+ -+ return 0; -+} -+ -+int proc_get_ht_option(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+#ifdef CONFIG_80211N_HT -+ RTW_PRINT_SEL(m, "ht_option=%d\n", pmlmepriv->htpriv.ht_option); -+#endif /* CONFIG_80211N_HT */ -+ -+ return 0; -+} -+ -+int proc_get_rf_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ RTW_PRINT_SEL(m, "cur_ch=%d, cur_bw=%d, cur_ch_offet=%d\n", -+ pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ -+ RTW_PRINT_SEL(m, "oper_ch=%d, oper_bw=%d, oper_ch_offet=%d\n", -+ rtw_get_oper_ch(padapter), rtw_get_oper_bw(padapter), rtw_get_oper_choffset(padapter)); -+ -+ return 0; -+} -+ -+int proc_get_scan_param(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct ss_res *ss = &mlmeext->sitesurvey_res; -+ -+#define SCAN_PARAM_TITLE_FMT "%10s" -+#define SCAN_PARAM_VALUE_FMT "%-10u" -+#define SCAN_PARAM_TITLE_ARG , "scan_ch_ms" -+#define SCAN_PARAM_VALUE_ARG , ss->scan_ch_ms -+#ifdef CONFIG_80211N_HT -+#define SCAN_PARAM_TITLE_FMT_HT " %15s %13s" -+#define SCAN_PARAM_VALUE_FMT_HT " %-15u %-13u" -+#define SCAN_PARAM_TITLE_ARG_HT , "rx_ampdu_accept", "rx_ampdu_size" -+#define SCAN_PARAM_VALUE_ARG_HT , ss->rx_ampdu_accept, ss->rx_ampdu_size -+#else -+#define SCAN_PARAM_TITLE_FMT_HT "" -+#define SCAN_PARAM_VALUE_FMT_HT "" -+#define SCAN_PARAM_TITLE_ARG_HT -+#define SCAN_PARAM_VALUE_ARG_HT -+#endif -+#ifdef CONFIG_SCAN_BACKOP -+#define SCAN_PARAM_TITLE_FMT_BACKOP " %9s %12s" -+#define SCAN_PARAM_VALUE_FMT_BACKOP " %-9u %-12u" -+#define SCAN_PARAM_TITLE_ARG_BACKOP , "backop_ms", "scan_cnt_max" -+#define SCAN_PARAM_VALUE_ARG_BACKOP , ss->backop_ms, ss->scan_cnt_max -+#else -+#define SCAN_PARAM_TITLE_FMT_BACKOP "" -+#define SCAN_PARAM_VALUE_FMT_BACKOP "" -+#define SCAN_PARAM_TITLE_ARG_BACKOP -+#define SCAN_PARAM_VALUE_ARG_BACKOP -+#endif -+ -+ RTW_PRINT_SEL(m, -+ SCAN_PARAM_TITLE_FMT -+ SCAN_PARAM_TITLE_FMT_HT -+ SCAN_PARAM_TITLE_FMT_BACKOP -+ "\n" -+ SCAN_PARAM_TITLE_ARG -+ SCAN_PARAM_TITLE_ARG_HT -+ SCAN_PARAM_TITLE_ARG_BACKOP -+ ); -+ -+ RTW_PRINT_SEL(m, -+ SCAN_PARAM_VALUE_FMT -+ SCAN_PARAM_VALUE_FMT_HT -+ SCAN_PARAM_VALUE_FMT_BACKOP -+ "\n" -+ SCAN_PARAM_VALUE_ARG -+ SCAN_PARAM_VALUE_ARG_HT -+ SCAN_PARAM_VALUE_ARG_BACKOP -+ ); -+ -+ return 0; -+} -+ -+ssize_t proc_set_scan_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct ss_res *ss = &mlmeext->sitesurvey_res; -+ -+ char tmp[32] = {0}; -+ -+ u16 scan_ch_ms; -+#define SCAN_PARAM_INPUT_FMT "%hu" -+#define SCAN_PARAM_INPUT_ARG , &scan_ch_ms -+#ifdef CONFIG_80211N_HT -+ u8 rx_ampdu_accept; -+ u8 rx_ampdu_size; -+#define SCAN_PARAM_INPUT_FMT_HT " %hhu %hhu" -+#define SCAN_PARAM_INPUT_ARG_HT , &rx_ampdu_accept, &rx_ampdu_size -+#else -+#define SCAN_PARAM_INPUT_FMT_HT "" -+#define SCAN_PARAM_INPUT_ARG_HT -+#endif -+#ifdef CONFIG_SCAN_BACKOP -+ u16 backop_ms; -+ u8 scan_cnt_max; -+#define SCAN_PARAM_INPUT_FMT_BACKOP " %hu %hhu" -+#define SCAN_PARAM_INPUT_ARG_BACKOP , &backop_ms, &scan_cnt_max -+#else -+#define SCAN_PARAM_INPUT_FMT_BACKOP "" -+#define SCAN_PARAM_INPUT_ARG_BACKOP -+#endif -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, -+ SCAN_PARAM_INPUT_FMT -+ SCAN_PARAM_INPUT_FMT_HT -+ SCAN_PARAM_INPUT_FMT_BACKOP -+ SCAN_PARAM_INPUT_ARG -+ SCAN_PARAM_INPUT_ARG_HT -+ SCAN_PARAM_INPUT_ARG_BACKOP -+ ); -+ -+ if (num-- > 0) -+ ss->scan_ch_ms = scan_ch_ms; -+#ifdef CONFIG_80211N_HT -+ if (num-- > 0) -+ ss->rx_ampdu_accept = rx_ampdu_accept; -+ if (num-- > 0) -+ ss->rx_ampdu_size = rx_ampdu_size; -+#endif -+#ifdef CONFIG_SCAN_BACKOP -+ if (num-- > 0) -+ ss->backop_ms = backop_ms; -+ if (num-- > 0) -+ ss->scan_cnt_max = scan_cnt_max; -+#endif -+ } -+ -+ return count; -+} -+ -+int proc_get_scan_abort(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u32 pass_ms; -+ -+ pass_ms = rtw_scan_abort_timeout(adapter, 10000); -+ -+ RTW_PRINT_SEL(m, "%u\n", pass_ms); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_SCAN_BACKOP -+int proc_get_backop_flags_sta(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ RTW_PRINT_SEL(m, "0x%02x\n", mlmeext_scan_backop_flags_sta(mlmeext)); -+ -+ return 0; -+} -+ -+ssize_t proc_set_backop_flags_sta(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ char tmp[32]; -+ u8 flags; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &flags); -+ -+ if (num == 1) -+ mlmeext_assign_scan_backop_flags_sta(mlmeext, flags); -+ } -+ -+ return count; -+} -+ -+int proc_get_backop_flags_ap(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ RTW_PRINT_SEL(m, "0x%02x\n", mlmeext_scan_backop_flags_ap(mlmeext)); -+ -+ return 0; -+} -+ -+ssize_t proc_set_backop_flags_ap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ char tmp[32]; -+ u8 flags; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &flags); -+ -+ if (num == 1) -+ mlmeext_assign_scan_backop_flags_ap(mlmeext, flags); -+ } -+ -+ return count; -+} -+ -+#endif /* CONFIG_SCAN_BACKOP */ -+ -+int proc_get_survey_info(struct seq_file *m, void *v) -+{ -+ _irqL irqL; -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ _list *plist, *phead; -+ s32 notify_signal; -+ s16 notify_noise = 0; -+ u16 index = 0, ie_cap = 0; -+ unsigned char *ie_wpa = NULL, *ie_wpa2 = NULL, *ie_wps = NULL; -+ unsigned char *ie_p2p = NULL, *ssid = NULL; -+ char flag_str[64]; -+ int ielen = 0; -+ u32 wpsielen = 0; -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ phead = get_list_head(queue); -+ if (!phead) -+ return 0; -+ plist = get_next(phead); -+ if (!plist) -+ return 0; -+ -+ RTW_PRINT_SEL(m, "%5s %-17s %3s %-3s %-4s %-4s %5s %32s %32s\n", "index", "bssid", "ch", "RSSI", "SdBm", "Noise", "age", "flag", "ssid"); -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (!pnetwork) -+ break; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { -+ notify_signal = translate_percentage_to_dbm(padapter->recvpriv.signal_strength);/* dbm */ -+ } else { -+ notify_signal = translate_percentage_to_dbm(pnetwork->network.PhyInfo.SignalStrength);/* dbm */ -+ } -+ -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(pnetwork->network.Configuration.DSConfig), &(notify_noise)); -+#endif -+ -+ ie_wpa = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &ielen, pnetwork->network.IELength - 12); -+ ie_wpa2 = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &ielen, pnetwork->network.IELength - 12); -+ ie_cap = rtw_get_capability(&pnetwork->network); -+ ie_wps = rtw_get_wps_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &wpsielen); -+ ie_p2p = rtw_get_p2p_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &ielen); -+ ssid = pnetwork->network.Ssid.Ssid; -+ sprintf(flag_str, "%s%s%s%s%s%s%s", -+ (ie_wpa) ? "[WPA]" : "", -+ (ie_wpa2) ? "[WPA2]" : "", -+ (!ie_wpa && !ie_wpa && ie_cap & BIT(4)) ? "[WEP]" : "", -+ (ie_wps) ? "[WPS]" : "", -+ (pnetwork->network.InfrastructureMode == Ndis802_11IBSS) ? "[IBSS]" : "", -+ (ie_cap & BIT(0)) ? "[ESS]" : "", -+ (ie_p2p) ? "[P2P]" : ""); -+ RTW_PRINT_SEL(m, "%5d "MAC_FMT" %3d %3d %4d %4d %5d %32s %32s\n", -+ ++index, -+ MAC_ARG(pnetwork->network.MacAddress), -+ pnetwork->network.Configuration.DSConfig, -+ (int)pnetwork->network.Rssi, -+ notify_signal, -+ notify_noise, -+ rtw_get_passing_time_ms((u32)pnetwork->last_scanned), -+ flag_str, -+ pnetwork->network.Ssid.Ssid); -+ plist = get_next(plist); -+ } -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ return 0; -+} -+ -+ssize_t proc_set_survey_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ _irqL irqL; -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ bool need_indicate_scan_done = _FALSE; -+ u8 _status = _FALSE; -+ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_mi_mp_mode_check(padapter)) { -+ RTW_INFO("MP mode block Scan request\n"); -+ goto exit; -+ } -+#endif -+ if (rtw_is_scan_deny(padapter)) { -+ RTW_INFO(FUNC_ADPT_FMT ": scan deny\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ -+ rtw_ps_deny(padapter, PS_DENY_SCAN); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) -+ goto cancel_ps_deny; -+ -+ if (!rtw_is_adapter_up(padapter)) { -+ RTW_INFO("scan abort!! adapter cannot use\n"); -+ goto cancel_ps_deny; -+ } -+ -+ if (rtw_mi_busy_traffic_check(padapter, _FALSE)) { -+ RTW_INFO("scan abort!! BusyTraffic == _TRUE\n"); -+ goto cancel_ps_deny; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) && check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { -+ RTW_INFO("scan abort!! AP mode process WPS\n"); -+ goto cancel_ps_deny; -+ } -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) == _TRUE) { -+ RTW_INFO("scan abort!! fwstate=0x%x\n", pmlmepriv->fw_state); -+ goto cancel_ps_deny; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, -+ _FW_UNDER_SURVEY | _FW_UNDER_LINKING | WIFI_UNDER_WPS)) { -+ RTW_INFO("scan abort!! buddy_fwstate check failed\n"); -+ goto cancel_ps_deny; -+ } -+#endif -+ _status = rtw_set_802_11_bssid_list_scan(padapter, NULL, 0, NULL, 0); -+ -+cancel_ps_deny: -+ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); -+exit: -+ return count; -+} -+ -+int proc_get_ap_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ struct sta_info *psta; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); -+ if (psta) { -+ int i; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ -+ RTW_PRINT_SEL(m, "SSID=%s\n", cur_network->network.Ssid.Ssid); -+ RTW_PRINT_SEL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ RTW_PRINT_SEL(m, "cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ RTW_PRINT_SEL(m, "wireless_mode=0x%x, rtsen=%d, cts2slef=%d\n", psta->wireless_mode, psta->rtsen, psta->cts2self); -+ RTW_PRINT_SEL(m, "state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); -+#ifdef CONFIG_80211N_HT -+ RTW_PRINT_SEL(m, "qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ RTW_PRINT_SEL(m, "bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); -+ RTW_PRINT_SEL(m, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ RTW_PRINT_SEL(m, "agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); -+ RTW_PRINT_SEL(m, "ldpc_cap=0x%x, stbc_cap=0x%x, beamform_cap=0x%x\n", psta->htpriv.ldpc_cap, psta->htpriv.stbc_cap, psta->htpriv.beamform_cap); -+#endif /* CONFIG_80211N_HT */ -+#ifdef CONFIG_80211AC_VHT -+ RTW_PRINT_SEL(m, "vht_en=%d, vht_sgi_80m=%d\n", psta->vhtpriv.vht_option, psta->vhtpriv.sgi_80m); -+ RTW_PRINT_SEL(m, "vht_ldpc_cap=0x%x, vht_stbc_cap=0x%x, vht_beamform_cap=0x%x\n", psta->vhtpriv.ldpc_cap, psta->vhtpriv.stbc_cap, psta->vhtpriv.beamform_cap); -+ RTW_PRINT_SEL(m, "vht_mcs_map=0x%x, vht_highest_rate=0x%x, vht_ampdu_len=%d\n", *(u16 *)psta->vhtpriv.vht_mcs_map, psta->vhtpriv.vht_highest_rate, psta->vhtpriv.ampdu_len); -+#endif -+ -+ sta_rx_reorder_ctl_dump(m, psta); -+ } else -+ RTW_PRINT_SEL(m, "can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); -+ -+ return 0; -+} -+ -+ssize_t proc_reset_trx_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ char cmd[32] = {0}; -+ u8 cnt = 0; -+ -+ if (count > sizeof(cmd)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(cmd, buffer, count)) { -+ int num = sscanf(cmd, "%hhx", &cnt); -+ -+ if (0 == cnt) { -+ pdbgpriv->dbg_rx_ampdu_drop_count = 0; -+ pdbgpriv->dbg_rx_ampdu_forced_indicate_count = 0; -+ pdbgpriv->dbg_rx_ampdu_loss_count = 0; -+ pdbgpriv->dbg_rx_dup_mgt_frame_drop_count = 0; -+ pdbgpriv->dbg_rx_ampdu_window_shift_cnt = 0; -+ pdbgpriv->dbg_rx_conflic_mac_addr_cnt = 0; -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_trx_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ int i; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct hw_xmit *phwxmit; -+ -+ dump_os_queue(m, padapter); -+ -+ RTW_PRINT_SEL(m, "free_xmitbuf_cnt=%d, free_xmitframe_cnt=%d\n" -+ , pxmitpriv->free_xmitbuf_cnt, pxmitpriv->free_xmitframe_cnt); -+ RTW_PRINT_SEL(m, "free_ext_xmitbuf_cnt=%d, free_xframe_ext_cnt=%d\n" -+ , pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xframe_ext_cnt); -+ RTW_PRINT_SEL(m, "free_recvframe_cnt=%d\n" -+ , precvpriv->free_recvframe_cnt); -+ -+ for (i = 0; i < 4; i++) { -+ phwxmit = pxmitpriv->hwxmits + i; -+ RTW_PRINT_SEL(m, "%d, hwq.accnt=%d\n", i, phwxmit->accnt); -+ } -+ -+#ifdef CONFIG_USB_HCI -+ RTW_PRINT_SEL(m, "rx_urb_pending_cn=%d\n", ATOMIC_READ(&(precvpriv->rx_pending_cnt))); -+#endif -+ -+ /* Folowing are RX info */ -+ /* Counts of packets whose seq_num is less than preorder_ctrl->indicate_seq, Ex delay, retransmission, redundant packets and so on */ -+ RTW_PRINT_SEL(m, "Rx: Counts of Packets Whose Seq_Num Less Than Reorder Control Seq_Num: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_drop_count); -+ /* How many times the Rx Reorder Timer is triggered. */ -+ RTW_PRINT_SEL(m, "Rx: Reorder Time-out Trigger Counts: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_forced_indicate_count); -+ /* Total counts of packets loss */ -+ RTW_PRINT_SEL(m, "Rx: Packet Loss Counts: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_loss_count); -+ RTW_PRINT_SEL(m, "Rx: Duplicate Management Frame Drop Count: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_dup_mgt_frame_drop_count); -+ RTW_PRINT_SEL(m, "Rx: AMPDU BA window shift Count: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_window_shift_cnt); -+ /*The same mac addr counts*/ -+ RTW_PRINT_SEL(m, "Rx: Conflict MAC Address Frames Count: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_conflic_mac_addr_cnt); -+ return 0; -+} -+ -+int proc_get_dis_pwt(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 dis_pwt = 0; -+ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DIS_PWT, &(dis_pwt)); -+ RTW_PRINT_SEL(m, " Tx Power training mode:%s\n", (dis_pwt == _TRUE) ? "Disable" : "Enable"); -+ return 0; -+} -+ssize_t proc_set_dis_pwt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[4] = {0}; -+ u8 dis_pwt = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &dis_pwt); -+ RTW_INFO("Set Tx Power training mode:%s\n", (dis_pwt == _TRUE) ? "Disable" : "Enable"); -+ -+ if (num >= 1) -+ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DIS_PWT, &(dis_pwt)); -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_rate_ctl(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ int i; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 data_rate = 0, sgi = 0, data_fb = 0; -+ -+ if (adapter->fix_rate != 0xff) { -+ data_rate = adapter->fix_rate & 0x7F; -+ sgi = adapter->fix_rate >> 7; -+ data_fb = adapter->data_fb ? 1 : 0; -+ RTW_PRINT_SEL(m, "FIXED %s%s%s\n" -+ , HDATA_RATE(data_rate) -+ , data_rate > DESC_RATE54M ? (sgi ? " SGI" : " LGI") : "" -+ , data_fb ? " FB" : "" -+ ); -+ RTW_PRINT_SEL(m, "0x%02x %u\n", adapter->fix_rate, adapter->data_fb); -+ } else -+ RTW_PRINT_SEL(m, "RA\n"); -+ -+ return 0; -+} -+ -+ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 fix_rate; -+ u8 data_fb; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx %hhu", &fix_rate, &data_fb); -+ -+ if (num >= 1) { -+ u8 fix_rate_ori = adapter->fix_rate; -+ -+ adapter->fix_rate = fix_rate; -+ if (adapter->fix_bw != 0xFF && fix_rate_ori != fix_rate) -+ rtw_update_tx_rate_bmp(adapter_to_dvobj(adapter)); -+ } -+ if (num >= 2) -+ adapter->data_fb = data_fb ? 1 : 0; -+ } -+ -+ return count; -+} -+int proc_get_bw_ctl(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 data_bw = 0; -+ -+ if (adapter->fix_bw != 0xff) { -+ data_bw = adapter->fix_bw; -+ RTW_PRINT_SEL(m, "FIXED %s\n", ch_width_str(data_bw)); -+ } else -+ RTW_PRINT_SEL(m, "Auto\n"); -+ -+ return 0; -+} -+ -+ssize_t proc_set_bw_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 fix_bw; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%hhu", &fix_bw); -+ -+ if (num >= 1) { -+ u8 fix_bw_ori = adapter->fix_bw; -+ -+ adapter->fix_bw = fix_bw; -+ -+ if (adapter->fix_rate != 0xFF && fix_bw_ori != fix_bw) -+ rtw_update_tx_rate_bmp(adapter_to_dvobj(adapter)); -+ } -+ } -+ -+ return count; -+} -+ -+#ifdef DBG_RX_COUNTER_DUMP -+int proc_get_rx_cnt_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ int i; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "BIT0- Dump RX counters of DRV\n"); -+ RTW_PRINT_SEL(m, "BIT1- Dump RX counters of MAC\n"); -+ RTW_PRINT_SEL(m, "BIT2- Dump RX counters of PHY\n"); -+ RTW_PRINT_SEL(m, "BIT3- Dump TRX data frame of DRV\n"); -+ RTW_PRINT_SEL(m, "dump_rx_cnt_mode = 0x%02x\n", adapter->dump_rx_cnt_mode); -+ -+ return 0; -+} -+ssize_t proc_set_rx_cnt_dump(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 dump_rx_cnt_mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &dump_rx_cnt_mode); -+ -+ rtw_dump_phy_rxcnts_preprocess(adapter, dump_rx_cnt_mode); -+ adapter->dump_rx_cnt_mode = dump_rx_cnt_mode; -+ -+ } -+ -+ return count; -+} -+#endif -+ssize_t proc_set_fwdl_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ int num; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) -+ num = sscanf(tmp, "%hhu %hhu", &fwdl_test_chksum_fail, &fwdl_test_wintint_rdy_fail); -+ -+ return count; -+} -+ -+ssize_t proc_set_del_rx_ampdu_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ int num; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) -+ num = sscanf(tmp, "%hhu", &del_rx_ampdu_test_no_tx_fail); -+ -+ return count; -+} -+ -+#ifdef CONFIG_DFS_MASTER -+int proc_get_dfs_master_test_case(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ RTW_PRINT_SEL(m, "%-24s %-19s\n", "radar_detect_trigger_non", "choose_dfs_ch_first"); -+ RTW_PRINT_SEL(m, "%24hhu %19hhu\n" -+ , rfctl->dbg_dfs_master_radar_detect_trigger_non -+ , rfctl->dbg_dfs_master_choose_dfs_ch_first -+ ); -+ -+ return 0; -+} -+ -+ssize_t proc_set_dfs_master_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ char tmp[32]; -+ u8 radar_detect_trigger_non; -+ u8 choose_dfs_ch_first; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%hhu %hhu", &radar_detect_trigger_non, &choose_dfs_ch_first); -+ -+ if (num >= 1) -+ rfctl->dbg_dfs_master_radar_detect_trigger_non = radar_detect_trigger_non; -+ if (num >= 2) -+ rfctl->dbg_dfs_master_choose_dfs_ch_first = choose_dfs_ch_first; -+ } -+ -+ return count; -+} -+#endif /* CONFIG_DFS_MASTER */ -+ -+ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ int num; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) -+ num = sscanf(tmp, "%u", &g_wait_hiq_empty_ms); -+ -+ return count; -+} -+ -+int proc_get_suspend_resume_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+ -+ RTW_PRINT_SEL(m, "dbg_sdio_alloc_irq_cnt=%d\n", pdbgpriv->dbg_sdio_alloc_irq_cnt); -+ RTW_PRINT_SEL(m, "dbg_sdio_free_irq_cnt=%d\n", pdbgpriv->dbg_sdio_free_irq_cnt); -+ RTW_PRINT_SEL(m, "dbg_sdio_alloc_irq_error_cnt=%d\n", pdbgpriv->dbg_sdio_alloc_irq_error_cnt); -+ RTW_PRINT_SEL(m, "dbg_sdio_free_irq_error_cnt=%d\n", pdbgpriv->dbg_sdio_free_irq_error_cnt); -+ RTW_PRINT_SEL(m, "dbg_sdio_init_error_cnt=%d\n", pdbgpriv->dbg_sdio_init_error_cnt); -+ RTW_PRINT_SEL(m, "dbg_sdio_deinit_error_cnt=%d\n", pdbgpriv->dbg_sdio_deinit_error_cnt); -+ RTW_PRINT_SEL(m, "dbg_suspend_error_cnt=%d\n", pdbgpriv->dbg_suspend_error_cnt); -+ RTW_PRINT_SEL(m, "dbg_suspend_cnt=%d\n", pdbgpriv->dbg_suspend_cnt); -+ RTW_PRINT_SEL(m, "dbg_resume_cnt=%d\n", pdbgpriv->dbg_resume_cnt); -+ RTW_PRINT_SEL(m, "dbg_resume_error_cnt=%d\n", pdbgpriv->dbg_resume_error_cnt); -+ RTW_PRINT_SEL(m, "dbg_deinit_fail_cnt=%d\n", pdbgpriv->dbg_deinit_fail_cnt); -+ RTW_PRINT_SEL(m, "dbg_carddisable_cnt=%d\n", pdbgpriv->dbg_carddisable_cnt); -+ RTW_PRINT_SEL(m, "dbg_ps_insuspend_cnt=%d\n", pdbgpriv->dbg_ps_insuspend_cnt); -+ RTW_PRINT_SEL(m, "dbg_dev_unload_inIPS_cnt=%d\n", pdbgpriv->dbg_dev_unload_inIPS_cnt); -+ RTW_PRINT_SEL(m, "dbg_scan_pwr_state_cnt=%d\n", pdbgpriv->dbg_scan_pwr_state_cnt); -+ RTW_PRINT_SEL(m, "dbg_downloadfw_pwr_state_cnt=%d\n", pdbgpriv->dbg_downloadfw_pwr_state_cnt); -+ RTW_PRINT_SEL(m, "dbg_carddisable_error_cnt=%d\n", pdbgpriv->dbg_carddisable_error_cnt); -+ RTW_PRINT_SEL(m, "dbg_fw_read_ps_state_fail_cnt=%d\n", pdbgpriv->dbg_fw_read_ps_state_fail_cnt); -+ RTW_PRINT_SEL(m, "dbg_leave_ips_fail_cnt=%d\n", pdbgpriv->dbg_leave_ips_fail_cnt); -+ RTW_PRINT_SEL(m, "dbg_leave_lps_fail_cnt=%d\n", pdbgpriv->dbg_leave_lps_fail_cnt); -+ RTW_PRINT_SEL(m, "dbg_h2c_leave32k_fail_cnt=%d\n", pdbgpriv->dbg_h2c_leave32k_fail_cnt); -+ RTW_PRINT_SEL(m, "dbg_diswow_dload_fw_fail_cnt=%d\n", pdbgpriv->dbg_diswow_dload_fw_fail_cnt); -+ RTW_PRINT_SEL(m, "dbg_enwow_dload_fw_fail_cnt=%d\n", pdbgpriv->dbg_enwow_dload_fw_fail_cnt); -+ RTW_PRINT_SEL(m, "dbg_ips_drvopen_fail_cnt=%d\n", pdbgpriv->dbg_ips_drvopen_fail_cnt); -+ RTW_PRINT_SEL(m, "dbg_poll_fail_cnt=%d\n", pdbgpriv->dbg_poll_fail_cnt); -+ RTW_PRINT_SEL(m, "dbg_rpwm_toogle_cnt=%d\n", pdbgpriv->dbg_rpwm_toogle_cnt); -+ RTW_PRINT_SEL(m, "dbg_rpwm_timeout_fail_cnt=%d\n", pdbgpriv->dbg_rpwm_timeout_fail_cnt); -+ RTW_PRINT_SEL(m, "dbg_sreset_cnt=%d\n", pdbgpriv->dbg_sreset_cnt); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_DBG_COUNTER -+ -+int proc_get_rx_logs(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rx_logs *rx_logs = &padapter->rx_logs; -+ -+ RTW_PRINT_SEL(m, -+ "intf_rx=%d\n" -+ "intf_rx_err_recvframe=%d\n" -+ "intf_rx_err_skb=%d\n" -+ "intf_rx_report=%d\n" -+ "core_rx=%d\n" -+ "core_rx_pre=%d\n" -+ "core_rx_pre_ver_err=%d\n" -+ "core_rx_pre_mgmt=%d\n" -+ "core_rx_pre_mgmt_err_80211w=%d\n" -+ "core_rx_pre_mgmt_err=%d\n" -+ "core_rx_pre_ctrl=%d\n" -+ "core_rx_pre_ctrl_err=%d\n" -+ "core_rx_pre_data=%d\n" -+ "core_rx_pre_data_wapi_seq_err=%d\n" -+ "core_rx_pre_data_wapi_key_err=%d\n" -+ "core_rx_pre_data_handled=%d\n" -+ "core_rx_pre_data_err=%d\n" -+ "core_rx_pre_data_unknown=%d\n" -+ "core_rx_pre_unknown=%d\n" -+ "core_rx_enqueue=%d\n" -+ "core_rx_dequeue=%d\n" -+ "core_rx_post=%d\n" -+ "core_rx_post_decrypt=%d\n" -+ "core_rx_post_decrypt_wep=%d\n" -+ "core_rx_post_decrypt_tkip=%d\n" -+ "core_rx_post_decrypt_aes=%d\n" -+ "core_rx_post_decrypt_wapi=%d\n" -+ "core_rx_post_decrypt_hw=%d\n" -+ "core_rx_post_decrypt_unknown=%d\n" -+ "core_rx_post_decrypt_err=%d\n" -+ "core_rx_post_defrag_err=%d\n" -+ "core_rx_post_portctrl_err=%d\n" -+ "core_rx_post_indicate=%d\n" -+ "core_rx_post_indicate_in_oder=%d\n" -+ "core_rx_post_indicate_reoder=%d\n" -+ "core_rx_post_indicate_err=%d\n" -+ "os_indicate=%d\n" -+ "os_indicate_ap_mcast=%d\n" -+ "os_indicate_ap_forward=%d\n" -+ "os_indicate_ap_self=%d\n" -+ "os_indicate_err=%d\n" -+ "os_netif_ok=%d\n" -+ "os_netif_err=%d\n", -+ rx_logs->intf_rx, -+ rx_logs->intf_rx_err_recvframe, -+ rx_logs->intf_rx_err_skb, -+ rx_logs->intf_rx_report, -+ rx_logs->core_rx, -+ rx_logs->core_rx_pre, -+ rx_logs->core_rx_pre_ver_err, -+ rx_logs->core_rx_pre_mgmt, -+ rx_logs->core_rx_pre_mgmt_err_80211w, -+ rx_logs->core_rx_pre_mgmt_err, -+ rx_logs->core_rx_pre_ctrl, -+ rx_logs->core_rx_pre_ctrl_err, -+ rx_logs->core_rx_pre_data, -+ rx_logs->core_rx_pre_data_wapi_seq_err, -+ rx_logs->core_rx_pre_data_wapi_key_err, -+ rx_logs->core_rx_pre_data_handled, -+ rx_logs->core_rx_pre_data_err, -+ rx_logs->core_rx_pre_data_unknown, -+ rx_logs->core_rx_pre_unknown, -+ rx_logs->core_rx_enqueue, -+ rx_logs->core_rx_dequeue, -+ rx_logs->core_rx_post, -+ rx_logs->core_rx_post_decrypt, -+ rx_logs->core_rx_post_decrypt_wep, -+ rx_logs->core_rx_post_decrypt_tkip, -+ rx_logs->core_rx_post_decrypt_aes, -+ rx_logs->core_rx_post_decrypt_wapi, -+ rx_logs->core_rx_post_decrypt_hw, -+ rx_logs->core_rx_post_decrypt_unknown, -+ rx_logs->core_rx_post_decrypt_err, -+ rx_logs->core_rx_post_defrag_err, -+ rx_logs->core_rx_post_portctrl_err, -+ rx_logs->core_rx_post_indicate, -+ rx_logs->core_rx_post_indicate_in_oder, -+ rx_logs->core_rx_post_indicate_reoder, -+ rx_logs->core_rx_post_indicate_err, -+ rx_logs->os_indicate, -+ rx_logs->os_indicate_ap_mcast, -+ rx_logs->os_indicate_ap_forward, -+ rx_logs->os_indicate_ap_self, -+ rx_logs->os_indicate_err, -+ rx_logs->os_netif_ok, -+ rx_logs->os_netif_err -+ ); -+ -+ return 0; -+} -+ -+int proc_get_tx_logs(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tx_logs *tx_logs = &padapter->tx_logs; -+ -+ RTW_PRINT_SEL(m, -+ "os_tx=%d\n" -+ "os_tx_err_up=%d\n" -+ "os_tx_err_xmit=%d\n" -+ "os_tx_m2u=%d\n" -+ "os_tx_m2u_ignore_fw_linked=%d\n" -+ "os_tx_m2u_ignore_self=%d\n" -+ "os_tx_m2u_entry=%d\n" -+ "os_tx_m2u_entry_err_xmit=%d\n" -+ "os_tx_m2u_entry_err_skb=%d\n" -+ "os_tx_m2u_stop=%d\n" -+ "core_tx=%d\n" -+ "core_tx_err_pxmitframe=%d\n" -+ "core_tx_err_brtx=%d\n" -+ "core_tx_upd_attrib=%d\n" -+ "core_tx_upd_attrib_adhoc=%d\n" -+ "core_tx_upd_attrib_sta=%d\n" -+ "core_tx_upd_attrib_ap=%d\n" -+ "core_tx_upd_attrib_unknown=%d\n" -+ "core_tx_upd_attrib_dhcp=%d\n" -+ "core_tx_upd_attrib_icmp=%d\n" -+ "core_tx_upd_attrib_active=%d\n" -+ "core_tx_upd_attrib_err_ucast_sta=%d\n" -+ "core_tx_upd_attrib_err_ucast_ap_link=%d\n" -+ "core_tx_upd_attrib_err_sta=%d\n" -+ "core_tx_upd_attrib_err_link=%d\n" -+ "core_tx_upd_attrib_err_sec=%d\n" -+ "core_tx_ap_enqueue_warn_fwstate=%d\n" -+ "core_tx_ap_enqueue_warn_sta=%d\n" -+ "core_tx_ap_enqueue_warn_nosta=%d\n" -+ "core_tx_ap_enqueue_warn_link=%d\n" -+ "core_tx_ap_enqueue_warn_trigger=%d\n" -+ "core_tx_ap_enqueue_mcast=%d\n" -+ "core_tx_ap_enqueue_ucast=%d\n" -+ "core_tx_ap_enqueue=%d\n" -+ "intf_tx=%d\n" -+ "intf_tx_pending_ac=%d\n" -+ "intf_tx_pending_fw_under_survey=%d\n" -+ "intf_tx_pending_fw_under_linking=%d\n" -+ "intf_tx_pending_xmitbuf=%d\n" -+ "intf_tx_enqueue=%d\n" -+ "core_tx_enqueue=%d\n" -+ "core_tx_enqueue_class=%d\n" -+ "core_tx_enqueue_class_err_sta=%d\n" -+ "core_tx_enqueue_class_err_nosta=%d\n" -+ "core_tx_enqueue_class_err_fwlink=%d\n" -+ "intf_tx_direct=%d\n" -+ "intf_tx_direct_err_coalesce=%d\n" -+ "intf_tx_dequeue=%d\n" -+ "intf_tx_dequeue_err_coalesce=%d\n" -+ "intf_tx_dump_xframe=%d\n" -+ "intf_tx_dump_xframe_err_txdesc=%d\n" -+ "intf_tx_dump_xframe_err_port=%d\n", -+ tx_logs->os_tx, -+ tx_logs->os_tx_err_up, -+ tx_logs->os_tx_err_xmit, -+ tx_logs->os_tx_m2u, -+ tx_logs->os_tx_m2u_ignore_fw_linked, -+ tx_logs->os_tx_m2u_ignore_self, -+ tx_logs->os_tx_m2u_entry, -+ tx_logs->os_tx_m2u_entry_err_xmit, -+ tx_logs->os_tx_m2u_entry_err_skb, -+ tx_logs->os_tx_m2u_stop, -+ tx_logs->core_tx, -+ tx_logs->core_tx_err_pxmitframe, -+ tx_logs->core_tx_err_brtx, -+ tx_logs->core_tx_upd_attrib, -+ tx_logs->core_tx_upd_attrib_adhoc, -+ tx_logs->core_tx_upd_attrib_sta, -+ tx_logs->core_tx_upd_attrib_ap, -+ tx_logs->core_tx_upd_attrib_unknown, -+ tx_logs->core_tx_upd_attrib_dhcp, -+ tx_logs->core_tx_upd_attrib_icmp, -+ tx_logs->core_tx_upd_attrib_active, -+ tx_logs->core_tx_upd_attrib_err_ucast_sta, -+ tx_logs->core_tx_upd_attrib_err_ucast_ap_link, -+ tx_logs->core_tx_upd_attrib_err_sta, -+ tx_logs->core_tx_upd_attrib_err_link, -+ tx_logs->core_tx_upd_attrib_err_sec, -+ tx_logs->core_tx_ap_enqueue_warn_fwstate, -+ tx_logs->core_tx_ap_enqueue_warn_sta, -+ tx_logs->core_tx_ap_enqueue_warn_nosta, -+ tx_logs->core_tx_ap_enqueue_warn_link, -+ tx_logs->core_tx_ap_enqueue_warn_trigger, -+ tx_logs->core_tx_ap_enqueue_mcast, -+ tx_logs->core_tx_ap_enqueue_ucast, -+ tx_logs->core_tx_ap_enqueue, -+ tx_logs->intf_tx, -+ tx_logs->intf_tx_pending_ac, -+ tx_logs->intf_tx_pending_fw_under_survey, -+ tx_logs->intf_tx_pending_fw_under_linking, -+ tx_logs->intf_tx_pending_xmitbuf, -+ tx_logs->intf_tx_enqueue, -+ tx_logs->core_tx_enqueue, -+ tx_logs->core_tx_enqueue_class, -+ tx_logs->core_tx_enqueue_class_err_sta, -+ tx_logs->core_tx_enqueue_class_err_nosta, -+ tx_logs->core_tx_enqueue_class_err_fwlink, -+ tx_logs->intf_tx_direct, -+ tx_logs->intf_tx_direct_err_coalesce, -+ tx_logs->intf_tx_dequeue, -+ tx_logs->intf_tx_dequeue_err_coalesce, -+ tx_logs->intf_tx_dump_xframe, -+ tx_logs->intf_tx_dump_xframe_err_txdesc, -+ tx_logs->intf_tx_dump_xframe_err_port -+ ); -+ -+ return 0; -+} -+ -+int proc_get_int_logs(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, -+ "all=%d\n" -+ "err=%d\n" -+ "tbdok=%d\n" -+ "tbder=%d\n" -+ "bcnderr=%d\n" -+ "bcndma=%d\n" -+ "bcndma_e=%d\n" -+ "rx=%d\n" -+ "rx_rdu=%d\n" -+ "rx_fovw=%d\n" -+ "txfovw=%d\n" -+ "mgntok=%d\n" -+ "highdok=%d\n" -+ "bkdok=%d\n" -+ "bedok=%d\n" -+ "vidok=%d\n" -+ "vodok=%d\n", -+ padapter->int_logs.all, -+ padapter->int_logs.err, -+ padapter->int_logs.tbdok, -+ padapter->int_logs.tbder, -+ padapter->int_logs.bcnderr, -+ padapter->int_logs.bcndma, -+ padapter->int_logs.bcndma_e, -+ padapter->int_logs.rx, -+ padapter->int_logs.rx_rdu, -+ padapter->int_logs.rx_fovw, -+ padapter->int_logs.txfovw, -+ padapter->int_logs.mgntok, -+ padapter->int_logs.highdok, -+ padapter->int_logs.bkdok, -+ padapter->int_logs.bedok, -+ padapter->int_logs.vidok, -+ padapter->int_logs.vodok -+ ); -+ -+ return 0; -+} -+ -+#endif /* CONFIG_DBG_COUNTER */ -+ -+int proc_get_hw_status(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+ struct registry_priv *regsty = dvobj_to_regsty(dvobj); -+ -+ if (regsty->check_hw_status == 0) -+ RTW_PRINT_SEL(m, "RX FIFO full count: not check in watch dog\n"); -+ else if (pdbgpriv->dbg_rx_fifo_last_overflow == 1 -+ && pdbgpriv->dbg_rx_fifo_curr_overflow == 1 -+ && pdbgpriv->dbg_rx_fifo_diff_overflow == 1 -+ ) -+ RTW_PRINT_SEL(m, "RX FIFO full count: no implementation\n"); -+ else { -+ RTW_PRINT_SEL(m, "RX FIFO full count: last_time=%llu, current_time=%llu, differential=%llu\n" -+ , pdbgpriv->dbg_rx_fifo_last_overflow, pdbgpriv->dbg_rx_fifo_curr_overflow, pdbgpriv->dbg_rx_fifo_diff_overflow); -+ } -+ -+ return 0; -+} -+ -+ssize_t proc_set_hw_status(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = padapter->dvobj; -+ struct registry_priv *regsty = dvobj_to_regsty(dvobj); -+ char tmp[32]; -+ u32 enable; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &enable); -+ -+ if (regsty && enable <= 1) { -+ regsty->check_hw_status = enable; -+ RTW_INFO("check_hw_status=%d\n", regsty->check_hw_status); -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_trx_info_debug(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ int i; -+ -+ -+ /*============ tx info ============ */ -+ rtw_hal_get_def_var(padapter, HW_DEF_RA_INFO_DUMP, m); -+ -+ /*============ rx info ============ */ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_RX_INFO_DUMP, m, _FALSE); -+ -+ -+ return 0; -+} -+ -+int proc_get_rx_signal(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ RTW_PRINT_SEL(m, "rssi:%d\n", padapter->recvpriv.rssi); -+ /* RTW_PRINT_SEL(m, "rxpwdb:%d\n", padapter->recvpriv.rxpwdb); */ -+ RTW_PRINT_SEL(m, "signal_strength:%u\n", padapter->recvpriv.signal_strength); -+ RTW_PRINT_SEL(m, "signal_qual:%u\n", padapter->recvpriv.signal_qual); -+ if (padapter->registrypriv.mp_mode == 1) { -+ if (padapter->mppriv.antenna_rx == ANTENNA_A) -+ RTW_PRINT_SEL(m, "Antenna: A\n"); -+ else if (padapter->mppriv.antenna_rx == ANTENNA_B) -+ RTW_PRINT_SEL(m, "Antenna: B\n"); -+ else if (padapter->mppriv.antenna_rx == ANTENNA_C) -+ RTW_PRINT_SEL(m, "Antenna: C\n"); -+ else if (padapter->mppriv.antenna_rx == ANTENNA_D) -+ RTW_PRINT_SEL(m, "Antenna: D\n"); -+ else if (padapter->mppriv.antenna_rx == ANTENNA_AB) -+ RTW_PRINT_SEL(m, "Antenna: AB\n"); -+ else if (padapter->mppriv.antenna_rx == ANTENNA_BC) -+ RTW_PRINT_SEL(m, "Antenna: BC\n"); -+ else if (padapter->mppriv.antenna_rx == ANTENNA_CD) -+ RTW_PRINT_SEL(m, "Antenna: CD\n"); -+ else -+ RTW_PRINT_SEL(m, "Antenna: __\n"); -+ return 0; -+ } -+ -+ rtw_get_noise(padapter); -+ RTW_PRINT_SEL(m, "noise:%d\n", padapter->recvpriv.noise); -+#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ rtw_odm_get_perpkt_rssi(m, padapter); -+ rtw_get_raw_rssi_info(m, padapter); -+#endif -+ return 0; -+} -+ -+ssize_t proc_set_rx_signal(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 is_signal_dbg, signal_strength; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%u %u", &is_signal_dbg, &signal_strength); -+ -+ is_signal_dbg = is_signal_dbg == 0 ? 0 : 1; -+ -+ if (is_signal_dbg && num != 2) -+ return count; -+ -+ signal_strength = signal_strength > 100 ? 100 : signal_strength; -+ -+ padapter->recvpriv.is_signal_dbg = is_signal_dbg; -+ padapter->recvpriv.signal_strength_dbg = signal_strength; -+ -+ if (is_signal_dbg) -+ RTW_INFO("set %s %u\n", "DBG_SIGNAL_STRENGTH", signal_strength); -+ else -+ RTW_INFO("set %s\n", "HW_SIGNAL_STRENGTH"); -+ -+ } -+ -+ return count; -+ -+} -+#ifdef CONFIG_80211N_HT -+int proc_get_ht_enable(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ if (pregpriv) -+ RTW_PRINT_SEL(m, "%d\n", pregpriv->ht_enable); -+ -+ return 0; -+} -+ -+ssize_t proc_set_ht_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &mode); -+ -+ if (pregpriv && mode < 2) { -+ pregpriv->ht_enable = mode; -+ RTW_INFO("ht_enable=%d\n", pregpriv->ht_enable); -+ } -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_bw_mode(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ if (pregpriv) -+ RTW_PRINT_SEL(m, "0x%02x\n", pregpriv->bw_mode); -+ -+ return 0; -+} -+ -+ssize_t proc_set_bw_mode(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ u8 bw_2g; -+ u8 bw_5g; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%x ", &mode); -+ bw_5g = mode >> 4; -+ bw_2g = mode & 0x0f; -+ -+ if (pregpriv && bw_2g <= 4 && bw_5g <= 4) { -+ -+ pregpriv->bw_mode = mode; -+ printk("bw_mode=0x%x\n", mode); -+ -+ } -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_ampdu_enable(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ if (pregpriv) -+ RTW_PRINT_SEL(m, "%d\n", pregpriv->ampdu_enable); -+ -+ return 0; -+} -+ -+ssize_t proc_set_ampdu_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &mode); -+ -+ if (pregpriv && mode < 2) { -+ pregpriv->ampdu_enable = mode; -+ printk("ampdu_enable=%d\n", mode); -+ } -+ -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_rx_ampdu(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ _RTW_PRINT_SEL(m, "accept: "); -+ if (padapter->fix_rx_ampdu_accept == RX_AMPDU_ACCEPT_INVALID) -+ RTW_PRINT_SEL(m, "%u%s\n", rtw_rx_ampdu_is_accept(padapter), "(auto)"); -+ else -+ RTW_PRINT_SEL(m, "%u%s\n", padapter->fix_rx_ampdu_accept, "(fixed)"); -+ -+ _RTW_PRINT_SEL(m, "size: "); -+ if (padapter->fix_rx_ampdu_size == RX_AMPDU_SIZE_INVALID) -+ RTW_PRINT_SEL(m, "%u%s\n", rtw_rx_ampdu_size(padapter), "(auto)"); -+ else -+ RTW_PRINT_SEL(m, "%u%s\n", padapter->fix_rx_ampdu_size, "(fixed)"); -+ -+ RTW_PRINT_SEL(m, "%19s %17s\n", "fix_rx_ampdu_accept", "fix_rx_ampdu_size"); -+ -+ _RTW_PRINT_SEL(m, "%-19d %-17u\n" -+ , padapter->fix_rx_ampdu_accept -+ , padapter->fix_rx_ampdu_size); -+ -+ return 0; -+} -+ -+ssize_t proc_set_rx_ampdu(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ char tmp[32]; -+ u8 accept; -+ u8 size; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu %hhu", &accept, &size); -+ -+ if (num >= 1) -+ rtw_rx_ampdu_set_accept(padapter, accept, RX_AMPDU_DRV_FIXED); -+ if (num >= 2) -+ rtw_rx_ampdu_set_size(padapter, size, RX_AMPDU_DRV_FIXED); -+ -+ rtw_rx_ampdu_apply(padapter); -+ } -+ -+exit: -+ return count; -+} -+int proc_get_rx_ampdu_factor(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ if (padapter) -+ RTW_PRINT_SEL(m, "rx ampdu factor = %x\n", padapter->driver_rx_ampdu_factor); -+ -+ return 0; -+} -+ -+ssize_t proc_set_rx_ampdu_factor(struct file *file, const char __user *buffer -+ , size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 factor; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &factor); -+ -+ if (padapter && (num == 1)) { -+ RTW_INFO("padapter->driver_rx_ampdu_factor = %x\n", factor); -+ -+ if (factor > 0x03) -+ padapter->driver_rx_ampdu_factor = 0xFF; -+ else -+ padapter->driver_rx_ampdu_factor = factor; -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_rx_ampdu_density(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ if (padapter) -+ RTW_PRINT_SEL(m, "rx ampdu densityg = %x\n", padapter->driver_rx_ampdu_spacing); -+ -+ return 0; -+} -+ -+ssize_t proc_set_rx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 density; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &density); -+ -+ if (padapter && (num == 1)) { -+ RTW_INFO("padapter->driver_rx_ampdu_spacing = %x\n", density); -+ -+ if (density > 0x07) -+ padapter->driver_rx_ampdu_spacing = 0xFF; -+ else -+ padapter->driver_rx_ampdu_spacing = density; -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_tx_ampdu_density(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ if (padapter) -+ RTW_PRINT_SEL(m, "tx ampdu density = %x\n", padapter->driver_ampdu_spacing); -+ -+ return 0; -+} -+ -+ssize_t proc_set_tx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 density; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &density); -+ -+ if (padapter && (num == 1)) { -+ RTW_INFO("padapter->driver_ampdu_spacing = %x\n", density); -+ -+ if (density > 0x07) -+ padapter->driver_ampdu_spacing = 0xFF; -+ else -+ padapter->driver_ampdu_spacing = density; -+ } -+ } -+ -+ return count; -+} -+#endif /* CONFIG_80211N_HT */ -+ -+int proc_get_mac_rptbuf(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u16 i; -+ u16 mac_id; -+ u32 shcut_addr = 0; -+ u32 read_addr = 0; -+#ifdef CONFIG_RTL8814A -+ RTW_PRINT_SEL(m, "TX ShortCut:\n"); -+ for (mac_id = 0; mac_id < 64; mac_id++) { -+ rtw_write16(padapter, 0x140, 0x662 | ((mac_id & BIT5) >> 5)); -+ shcut_addr = 0x8000; -+ shcut_addr = shcut_addr | ((mac_id & 0x1f) << 7); -+ RTW_PRINT_SEL(m, "mac_id=%d, 0x140=%x =>\n", mac_id, 0x662 | ((mac_id & BIT5) >> 5)); -+ for (i = 0; i < 30; i++) { -+ read_addr = 0; -+ read_addr = shcut_addr | (i << 2); -+ RTW_PRINT_SEL(m, "i=%02d: MAC_%04x= %08x ", i, read_addr, rtw_read32(padapter, read_addr)); -+ if (!((i + 1) % 4)) -+ RTW_PRINT_SEL(m, "\n"); -+ if (i == 29) -+ RTW_PRINT_SEL(m, "\n"); -+ } -+ } -+#endif /* CONFIG_RTL8814A */ -+ return 0; -+} -+ -+int proc_get_en_fwps(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pregpriv) -+ RTW_PRINT_SEL(m, "check_fw_ps = %d , 1:enable get FW PS state , 0: disable get FW PS state\n" -+ , pregpriv->check_fw_ps); -+ -+ return 0; -+} -+ -+ssize_t proc_set_en_fwps(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &mode); -+ -+ if (pregpriv && mode < 2) { -+ pregpriv->check_fw_ps = mode; -+ RTW_INFO("pregpriv->check_fw_ps=%d\n", pregpriv->check_fw_ps); -+ } -+ -+ } -+ -+ return count; -+} -+ -+/* -+int proc_get_two_path_rssi(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if(padapter) -+ RTW_PRINT_SEL(m, "%d %d\n", -+ padapter->recvpriv.RxRssi[0], padapter->recvpriv.RxRssi[1]); -+ -+ return 0; -+} -+*/ -+#ifdef CONFIG_80211N_HT -+int proc_get_rx_stbc(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ if (pregpriv) -+ RTW_PRINT_SEL(m, "%d\n", pregpriv->rx_stbc); -+ -+ return 0; -+} -+ -+ssize_t proc_set_rx_stbc(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &mode); -+ -+ if (pregpriv && (mode == 0 || mode == 1 || mode == 2 || mode == 3)) { -+ pregpriv->rx_stbc = mode; -+ printk("rx_stbc=%d\n", mode); -+ } -+ } -+ -+ return count; -+ -+} -+#endif /* CONFIG_80211N_HT */ -+ -+/*int proc_get_rssi_disp(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ return 0; -+} -+*/ -+ -+/*ssize_t proc_set_rssi_disp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 enable=0; -+ -+ if (count < 1) -+ { -+ RTW_INFO("argument size is less than 1\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%x", &enable); -+ -+ if (num != 1) { -+ RTW_INFO("invalid set_rssi_disp parameter!\n"); -+ return count; -+ } -+ -+ if(enable) -+ { -+ RTW_INFO("Linked info Function Enable\n"); -+ padapter->bLinkInfoDump = enable ; -+ } -+ else -+ { -+ RTW_INFO("Linked info Function Disable\n"); -+ padapter->bLinkInfoDump = 0 ; -+ } -+ -+ } -+ -+ return count; -+ -+} -+ -+*/ -+#ifdef CONFIG_AP_MODE -+ -+int proc_get_all_sta_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _irqL irqL; -+ struct sta_info *psta; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ int i; -+ _list *plist, *phead; -+ -+ RTW_PRINT_SEL(m, "sta_dz_bitmap=0x%x, tim_bitmap=0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for (i = 0; i < NUM_STA; i++) { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ plist = get_next(plist); -+ -+ /* if(extra_arg == psta->aid) */ -+ { -+ RTW_PRINT_SEL(m, "==============================\n"); -+ RTW_PRINT_SEL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ RTW_PRINT_SEL(m, "rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); -+ RTW_PRINT_SEL(m, "state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); -+#ifdef CONFIG_80211N_HT -+ RTW_PRINT_SEL(m, "qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ RTW_PRINT_SEL(m, "bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); -+ RTW_PRINT_SEL(m, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ RTW_PRINT_SEL(m, "agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); -+#endif /* CONFIG_80211N_HT */ -+ RTW_PRINT_SEL(m, "sleepq_len=%d\n", psta->sleepq_len); -+ RTW_PRINT_SEL(m, "sta_xmitpriv.vo_q_qcnt=%d\n", psta->sta_xmitpriv.vo_q.qcnt); -+ RTW_PRINT_SEL(m, "sta_xmitpriv.vi_q_qcnt=%d\n", psta->sta_xmitpriv.vi_q.qcnt); -+ RTW_PRINT_SEL(m, "sta_xmitpriv.be_q_qcnt=%d\n", psta->sta_xmitpriv.be_q.qcnt); -+ RTW_PRINT_SEL(m, "sta_xmitpriv.bk_q_qcnt=%d\n", psta->sta_xmitpriv.bk_q.qcnt); -+ -+ RTW_PRINT_SEL(m, "capability=0x%x\n", psta->capability); -+ RTW_PRINT_SEL(m, "flags=0x%x\n", psta->flags); -+ RTW_PRINT_SEL(m, "wpa_psk=0x%x\n", psta->wpa_psk); -+ RTW_PRINT_SEL(m, "wpa2_group_cipher=0x%x\n", psta->wpa2_group_cipher); -+ RTW_PRINT_SEL(m, "wpa2_pairwise_cipher=0x%x\n", psta->wpa2_pairwise_cipher); -+ RTW_PRINT_SEL(m, "qos_info=0x%x\n", psta->qos_info); -+ RTW_PRINT_SEL(m, "dot118021XPrivacy=0x%x\n", psta->dot118021XPrivacy); -+ -+ sta_rx_reorder_ctl_dump(m, psta); -+ -+#ifdef CONFIG_TDLS -+ RTW_PRINT_SEL(m, "tdls_sta_state=0x%08x\n", psta->tdls_sta_state); -+ RTW_PRINT_SEL(m, "PeerKey_Lifetime=%d\n", psta->TDLS_PeerKey_Lifetime); -+ RTW_PRINT_SEL(m, "rx_data_pkts=%llu\n", psta->sta_stats.rx_data_pkts); -+ RTW_PRINT_SEL(m, "rx_bytes=%llu\n", psta->sta_stats.rx_bytes); -+ RTW_PRINT_SEL(m, "tx_data_pkts=%llu\n", psta->sta_stats.tx_pkts); -+ RTW_PRINT_SEL(m, "tx_bytes=%llu\n", psta->sta_stats.tx_bytes); -+#endif /* CONFIG_TDLS */ -+ -+ dump_st_ctl(m, &psta->st_ctl); -+ -+ if (STA_OP_WFD_MODE(psta)) -+ RTW_PRINT_SEL(m, "op_wfd_mode:0x%02x\n", STA_OP_WFD_MODE(psta)); -+ -+ RTW_PRINT_SEL(m, "==============================\n"); -+ } -+ -+ } -+ -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ return 0; -+} -+ -+#endif -+ -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+int proc_get_rtkm_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct recv_buf *precvbuf; -+ -+ precvbuf = (struct recv_buf *)precvpriv->precv_buf; -+ -+ RTW_PRINT_SEL(m, "============[RTKM Info]============\n"); -+ RTW_PRINT_SEL(m, "MAX_RTKM_NR_PREALLOC_RECV_SKB: %d\n", rtw_rtkm_get_nr_recv_skb()); -+ RTW_PRINT_SEL(m, "MAX_RTKM_RECVBUF_SZ: %d\n", rtw_rtkm_get_buff_size()); -+ -+ RTW_PRINT_SEL(m, "============[Driver Info]============\n"); -+ RTW_PRINT_SEL(m, "NR_PREALLOC_RECV_SKB: %d\n", NR_PREALLOC_RECV_SKB); -+ RTW_PRINT_SEL(m, "MAX_RECVBUF_SZ: %d\n", precvbuf->alloc_sz); -+ -+ return 0; -+} -+#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ -+#ifdef DBG_MEMORY_LEAK -+#include -+extern atomic_t _malloc_cnt;; -+extern atomic_t _malloc_size;; -+ -+int proc_get_malloc_cnt(struct seq_file *m, void *v) -+{ -+ RTW_PRINT_SEL(m, "_malloc_cnt=%d\n", atomic_read(&_malloc_cnt)); -+ RTW_PRINT_SEL(m, "_malloc_size=%d\n", atomic_read(&_malloc_size)); -+ -+ return 0; -+} -+#endif /* DBG_MEMORY_LEAK */ -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+int proc_get_best_channel(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u32 i, best_channel_24G = 1, best_channel_5G = 36, index_24G = 0, index_5G = 0; -+ -+ for (i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) { -+ if (pmlmeext->channel_set[i].ChannelNum == 1) -+ index_24G = i; -+ if (pmlmeext->channel_set[i].ChannelNum == 36) -+ index_5G = i; -+ } -+ -+ for (i = 0; (i < MAX_CHANNEL_NUM) && (pmlmeext->channel_set[i].ChannelNum != 0) ; i++) { -+ /* 2.4G */ -+ if (pmlmeext->channel_set[i].ChannelNum == 6) { -+ if (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_24G].rx_count) { -+ index_24G = i; -+ best_channel_24G = pmlmeext->channel_set[i].ChannelNum; -+ } -+ } -+ -+ /* 5G */ -+ if (pmlmeext->channel_set[i].ChannelNum >= 36 -+ && pmlmeext->channel_set[i].ChannelNum < 140) { -+ /* Find primary channel */ -+ if (((pmlmeext->channel_set[i].ChannelNum - 36) % 8 == 0) -+ && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { -+ index_5G = i; -+ best_channel_5G = pmlmeext->channel_set[i].ChannelNum; -+ } -+ } -+ -+ if (pmlmeext->channel_set[i].ChannelNum >= 149 -+ && pmlmeext->channel_set[i].ChannelNum < 165) { -+ /* find primary channel */ -+ if (((pmlmeext->channel_set[i].ChannelNum - 149) % 8 == 0) -+ && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { -+ index_5G = i; -+ best_channel_5G = pmlmeext->channel_set[i].ChannelNum; -+ } -+ } -+#if 1 /* debug */ -+ RTW_PRINT_SEL(m, "The rx cnt of channel %3d = %d\n", -+ pmlmeext->channel_set[i].ChannelNum, pmlmeext->channel_set[i].rx_count); -+#endif -+ } -+ -+ RTW_PRINT_SEL(m, "best_channel_5G = %d\n", best_channel_5G); -+ RTW_PRINT_SEL(m, "best_channel_24G = %d\n", best_channel_24G); -+ -+ return 0; -+} -+ -+ssize_t proc_set_best_channel(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ char tmp[32]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int i; -+ for (i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) -+ pmlmeext->channel_set[i].rx_count = 0; -+ -+ RTW_INFO("set %s\n", "Clean Best Channel Count"); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_FIND_BEST_CHANNEL */ -+ -+#ifdef CONFIG_BT_COEXIST -+int proc_get_btcoex_dbg(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ PADAPTER padapter; -+ char buf[512] = {0}; -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+ rtw_btcoex_GetDBG(padapter, buf, 512); -+ -+ _RTW_PRINT_SEL(m, "%s", buf); -+ -+ return 0; -+} -+ -+ssize_t proc_set_btcoex_dbg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ PADAPTER padapter; -+ u8 tmp[80] = {0}; -+ u32 module[2] = {0}; -+ u32 num; -+ -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+ /* RTW_INFO("+" FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(padapter)); */ -+ -+ if (NULL == buffer) { -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", -+ FUNC_ADPT_ARG(padapter)); -+ -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", -+ FUNC_ADPT_ARG(padapter)); -+ -+ return -EFAULT; -+ } -+ -+ num = count; -+ if (num > (sizeof(tmp) - 1)) -+ num = (sizeof(tmp) - 1); -+ -+ if (copy_from_user(tmp, buffer, num)) { -+ RTW_INFO(FUNC_ADPT_FMT ": copy buffer from user space FAIL!\n", -+ FUNC_ADPT_ARG(padapter)); -+ -+ return -EFAULT; -+ } -+ -+ num = sscanf(tmp, "%x %x", module, module + 1); -+ if (1 == num) { -+ if (0 == module[0]) -+ _rtw_memset(module, 0, sizeof(module)); -+ else -+ _rtw_memset(module, 0xFF, sizeof(module)); -+ } else if (2 != num) { -+ RTW_INFO(FUNC_ADPT_FMT ": input(\"%s\") format incorrect!\n", -+ FUNC_ADPT_ARG(padapter), tmp); -+ -+ if (0 == num) -+ return -EFAULT; -+ } -+ -+ RTW_INFO(FUNC_ADPT_FMT ": input 0x%08X 0x%08X\n", -+ FUNC_ADPT_ARG(padapter), module[0], module[1]); -+ rtw_btcoex_SetDBG(padapter, module); -+ -+ return count; -+} -+ -+int proc_get_btcoex_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ PADAPTER padapter; -+ const u32 bufsize = 30 * 100; -+ u8 *pbuf = NULL; -+ -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+ pbuf = rtw_zmalloc(bufsize); -+ if (NULL == pbuf) -+ return -ENOMEM; -+ -+ rtw_btcoex_DisplayBtCoexInfo(padapter, pbuf, bufsize); -+ -+ _RTW_PRINT_SEL(m, "%s\n", pbuf); -+ -+ rtw_mfree(pbuf, bufsize); -+ -+ return 0; -+} -+#endif /* CONFIG_BT_COEXIST */ -+ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+int proc_get_sreset(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ return 0; -+} -+ -+ssize_t proc_set_sreset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ s32 trigger_point; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d", &trigger_point); -+ -+ if (trigger_point == SRESET_TGP_NULL) -+ rtw_hal_sreset_reset(padapter); -+ else -+ sreset_set_trigger_point(padapter, trigger_point); -+ } -+ -+ return count; -+ -+} -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ -+#ifdef CONFIG_PCI_HCI -+ -+int proc_get_rx_ring(struct seq_file *m, void *v) -+{ -+ _irqL irqL; -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct rtw_rx_ring *rx_ring = &precvpriv->rx_ring[RX_MPDU_QUEUE]; -+ int i, j; -+ -+ RTW_PRINT_SEL(m, "rx ring (%p)\n", rx_ring); -+ RTW_PRINT_SEL(m, " dma: 0x%08x\n", (int) rx_ring->dma); -+ RTW_PRINT_SEL(m, " idx: %d\n", rx_ring->idx); -+ -+ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ for (i = 0; i < precvpriv->rxringcount; i++) { -+#ifdef CONFIG_TRX_BD_ARCH -+ struct rx_buf_desc *entry = &rx_ring->buf_desc[i]; -+#else -+ struct recv_stat *entry = &rx_ring->desc[i]; -+#endif -+ struct sk_buff *skb = rx_ring->rx_buf[i]; -+ -+ RTW_PRINT_SEL(m, " desc[%03d]: %p, rx_buf[%03d]: 0x%08x\n", -+ i, entry, i, cpu_to_le32(*((dma_addr_t *)skb->cb))); -+ -+ for (j = 0; j < sizeof(*entry) / 4; j++) { -+ if ((j % 4) == 0) -+ RTW_PRINT_SEL(m, " 0x%03x", j); -+ -+ RTW_PRINT_SEL(m, " 0x%08x ", ((int *) entry)[j]); -+ -+ if ((j % 4) == 3) -+ RTW_PRINT_SEL(m, "\n"); -+ } -+ } -+ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ -+ return 0; -+} -+ -+int proc_get_tx_ring(struct seq_file *m, void *v) -+{ -+ _irqL irqL; -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ int i, j, k; -+ -+ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ for (i = 0; i < PCI_MAX_TX_QUEUE_COUNT; i++) { -+ struct rtw_tx_ring *tx_ring = &pxmitpriv->tx_ring[i]; -+ -+ RTW_PRINT_SEL(m, "tx ring[%d] (%p)\n", i, tx_ring); -+ RTW_PRINT_SEL(m, " dma: 0x%08x\n", (int) tx_ring->dma); -+ RTW_PRINT_SEL(m, " idx: %d\n", tx_ring->idx); -+ RTW_PRINT_SEL(m, " entries: %d\n", tx_ring->entries); -+ /* RTW_PRINT_SEL(m, " queue: %d\n", tx_ring->queue); */ -+ RTW_PRINT_SEL(m, " qlen: %d\n", tx_ring->qlen); -+ -+ for (j = 0; j < pxmitpriv->txringcount[i]; j++) { -+#ifdef CONFIG_TRX_BD_ARCH -+ struct tx_buf_desc *entry = &tx_ring->buf_desc[j]; -+#else -+ struct tx_desc *entry = &tx_ring->desc[j]; -+#endif -+ -+ RTW_PRINT_SEL(m, " desc[%03d]: %p\n", j, entry); -+ for (k = 0; k < sizeof(*entry) / 4; k++) { -+ if ((k % 4) == 0) -+ RTW_PRINT_SEL(m, " 0x%03x", k); -+ -+ RTW_PRINT_SEL(m, " 0x%08x ", ((int *) entry)[k]); -+ -+ if ((k % 4) == 3) -+ RTW_PRINT_SEL(m, "\n"); -+ } -+ } -+ } -+ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ -+ return 0; -+} -+#endif -+ -+#ifdef CONFIG_WOWLAN -+int proc_get_pattern_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ u8 pattern_num = 0, val8; -+ char str_1[128]; -+ char *p_str; -+ int i = 0 , j = 0, k = 0; -+ int len = 0, max_len = 0, total = 0; -+ -+ p_str = str_1; -+ max_len = sizeof(str_1); -+ -+ total = pwrpriv->wowlan_pattern_idx; -+ -+ rtw_set_default_pattern(padapter); -+ -+ /*show pattern*/ -+ RTW_PRINT_SEL(m, "\n======[Pattern Info.]======\n"); -+ RTW_PRINT_SEL(m, "pattern number: %d\n", total); -+ RTW_PRINT_SEL(m, "support default patterns: %c\n", -+ (pregistrypriv->default_patterns_en) ? 'Y' : 'N'); -+ -+ for (k = 0; k < total ; k++) { -+ RTW_PRINT_SEL(m, "\npattern idx: %d\n", k); -+ RTW_PRINT_SEL(m, "pattern content:\n"); -+ -+ p_str = str_1; -+ max_len = sizeof(str_1); -+ for (i = 0 ; i < MAX_WKFM_PATTERN_SIZE / 8 ; i++) { -+ _rtw_memset(p_str, 0, max_len); -+ len = 0; -+ for (j = 0 ; j < 8 ; j++) { -+ val8 = pwrpriv->patterns[k].content[i * 8 + j]; -+ len += snprintf(p_str + len, max_len - len, -+ "%02x ", val8); -+ } -+ RTW_PRINT_SEL(m, "%s\n", p_str); -+ } -+ RTW_PRINT_SEL(m, "\npattern mask:\n"); -+ for (i = 0 ; i < MAX_WKFM_SIZE / 8 ; i++) { -+ _rtw_memset(p_str, 0, max_len); -+ len = 0; -+ for (j = 0 ; j < 8 ; j++) { -+ val8 = pwrpriv->patterns[k].mask[i * 8 + j]; -+ len += snprintf(p_str + len, max_len - len, -+ "%02x ", val8); -+ } -+ RTW_PRINT_SEL(m, "%s\n", p_str); -+ } -+ -+ RTW_PRINT_SEL(m, "\npriv_pattern_len:\n"); -+ RTW_PRINT_SEL(m, "pattern_len: %d\n", pwrpriv->patterns[k].len); -+ RTW_PRINT_SEL(m, "*****************\n"); -+ } -+ -+ return 0; -+} -+ssize_t proc_set_pattern_info(struct file *file, const char __user *buffer, -+ size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct wowlan_ioctl_param poidparam; -+ u8 tmp[MAX_WKFM_PATTERN_SIZE] = {0}; -+ int ret = 0, num = 0; -+ u8 index = 0; -+ -+ poidparam.subcode = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (pwrpriv->wowlan_pattern_idx >= MAX_WKFM_NUM) { -+ RTW_INFO("WARNING: priv-pattern is full(idx: %d)\n", -+ pwrpriv->wowlan_pattern_idx); -+ RTW_INFO("WARNING: please clean priv-pattern first\n"); -+ return -ENOMEM; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ if (strncmp(tmp, "clean", 5) == 0) { -+ poidparam.subcode = WOWLAN_PATTERN_CLEAN; -+ rtw_hal_set_hwreg(padapter, -+ HW_VAR_WOWLAN, (u8 *)&poidparam); -+ } else { -+ index = pwrpriv->wowlan_pattern_idx; -+ ret = rtw_wowlan_parser_pattern_cmd(tmp, -+ pwrpriv->patterns[index].content, -+ &pwrpriv->patterns[index].len, -+ pwrpriv->patterns[index].mask); -+ if (ret == _TRUE) -+ pwrpriv->wowlan_pattern_idx++; -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_wakeup_reason(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 val = pwrpriv->wowlan_last_wake_reason; -+ -+ RTW_PRINT_SEL(m, "last wake reason: %#02x\n", val); -+ return 0; -+} -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+int proc_get_wowlan_gpio_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 val = pwrpriv->is_high_active; -+ -+ RTW_PRINT_SEL(m, "wakeup_gpio_idx: %d\n", WAKEUP_GPIO_IDX); -+ RTW_PRINT_SEL(m, "high_active: %d\n", val); -+ -+ return 0; -+} -+ -+ssize_t proc_set_wowlan_gpio_info(struct file *file, const char __user *buffer, -+ size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ char tmp[32] = {0}; -+ int num = 0; -+ u32 is_high_active = 0; -+ u8 val8 = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ num = sscanf(tmp, "%u", &is_high_active); -+ -+ is_high_active = is_high_active == 0 ? 0 : 1; -+ -+ pwrpriv->is_high_active = is_high_active; -+ -+ rtw_ps_deny(padapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(padapter); -+ val8 = (pwrpriv->is_high_active == 0) ? 1 : 0; -+ rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, val8); -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ -+ RTW_INFO("set %s %d\n", "gpio_high_active", -+ pwrpriv->is_high_active); -+ RTW_INFO("%s: set GPIO_%d %d as default.\n", -+ __func__, WAKEUP_GPIO_IDX, val8); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_GPIO_WAKEUP */ -+ -+#ifdef CONFIG_P2P_WOWLAN -+int proc_get_p2p_wowlan_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct p2p_wowlan_info peerinfo = pwdinfo->p2p_wow_info; -+ if (_TRUE == peerinfo.is_trigger) { -+ RTW_PRINT_SEL(m, "is_trigger: TRUE\n"); -+ switch (peerinfo.wowlan_recv_frame_type) { -+ case P2P_WOWLAN_RECV_NEGO_REQ: -+ RTW_PRINT_SEL(m, "Frame Type: Nego Request\n"); -+ break; -+ case P2P_WOWLAN_RECV_INVITE_REQ: -+ RTW_PRINT_SEL(m, "Frame Type: Invitation Request\n"); -+ break; -+ case P2P_WOWLAN_RECV_PROVISION_REQ: -+ RTW_PRINT_SEL(m, "Frame Type: Provision Request\n"); -+ break; -+ default: -+ break; -+ } -+ RTW_PRINT_SEL(m, "Peer Addr: "MAC_FMT"\n", MAC_ARG(peerinfo.wowlan_peer_addr)); -+ RTW_PRINT_SEL(m, "Peer WPS Config: %x\n", peerinfo.wowlan_peer_wpsconfig); -+ RTW_PRINT_SEL(m, "Persistent Group: %d\n", peerinfo.wowlan_peer_is_persistent); -+ RTW_PRINT_SEL(m, "Intivation Type: %d\n", peerinfo.wowlan_peer_invitation_type); -+ } else -+ RTW_PRINT_SEL(m, "is_trigger: False\n"); -+ return 0; -+} -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+int proc_get_new_bcn_max(struct seq_file *m, void *v) -+{ -+ extern int new_bcn_max; -+ -+ RTW_PRINT_SEL(m, "%d", new_bcn_max); -+ return 0; -+} -+ -+ssize_t proc_set_new_bcn_max(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ char tmp[32]; -+ extern int new_bcn_max; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) -+ sscanf(tmp, "%d ", &new_bcn_max); -+ -+ return count; -+} -+ -+#ifdef CONFIG_POWER_SAVING -+int proc_get_ps_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 ips_mode = pwrpriv->ips_mode; -+ u8 lps_mode = pwrpriv->power_mgnt; -+ char *str = ""; -+ -+ RTW_PRINT_SEL(m, "======Power Saving Info:======\n"); -+ RTW_PRINT_SEL(m, "*IPS:\n"); -+ -+ if (ips_mode == IPS_NORMAL) { -+#ifdef CONFIG_FWLPS_IN_IPS -+ str = "FW_LPS_IN_IPS"; -+#else -+ str = "Card Disable"; -+#endif -+ } else if (ips_mode == IPS_NONE) -+ str = "NO IPS"; -+ else if (ips_mode == IPS_LEVEL_2) -+ str = "IPS_LEVEL_2"; -+ else -+ str = "invalid ips_mode"; -+ -+ RTW_PRINT_SEL(m, " IPS mode: %s\n", str); -+ RTW_PRINT_SEL(m, " IPS enter count:%d, IPS leave count:%d\n", -+ pwrpriv->ips_enter_cnts, pwrpriv->ips_leave_cnts); -+ RTW_PRINT_SEL(m, "------------------------------\n"); -+ RTW_PRINT_SEL(m, "*LPS:\n"); -+ -+ if (lps_mode == PS_MODE_ACTIVE) -+ str = "NO LPS"; -+ else if (lps_mode == PS_MODE_MIN) -+ str = "MIN"; -+ else if (lps_mode == PS_MODE_MAX) -+ str = "MAX"; -+ else if (lps_mode == PS_MODE_DTIM) -+ str = "DTIM"; -+ else -+ sprintf(str, "%d", lps_mode); -+ -+ RTW_PRINT_SEL(m, " LPS mode: %s\n", str); -+ -+ if (pwrpriv->dtim != 0) -+ RTW_PRINT_SEL(m, " DTIM: %d\n", pwrpriv->dtim); -+ RTW_PRINT_SEL(m, " LPS enter count:%d, LPS leave count:%d\n", -+ pwrpriv->lps_enter_cnts, pwrpriv->lps_leave_cnts); -+ RTW_PRINT_SEL(m, "=============================\n"); -+ return 0; -+} -+#endif /* CONFIG_POWER_SAVING */ -+ -+#ifdef CONFIG_TDLS -+static int proc_tdls_display_tdls_function_info(struct seq_file *m) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ u8 SpaceBtwnItemAndValue = TDLS_DBG_INFO_SPACE_BTWN_ITEM_AND_VALUE; -+ u8 SpaceBtwnItemAndValueTmp = 0; -+ BOOLEAN FirstMatchFound = _FALSE; -+ int j = 0; -+ -+ RTW_PRINT_SEL(m, "============[TDLS Function Info]============\n"); -+ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Prohibited", (ptdlsinfo->ap_prohibited == _TRUE) ? "_TRUE" : "_FALSE"); -+ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Channel Switch Prohibited", (ptdlsinfo->ch_switch_prohibited == _TRUE) ? "_TRUE" : "_FALSE"); -+ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Link Established", (ptdlsinfo->link_established == _TRUE) ? "_TRUE" : "_FALSE"); -+ RTW_PRINT_SEL(m, "%-*s = %d/%d\n", SpaceBtwnItemAndValue, "TDLS STA Num (Linked/Allowed)", ptdlsinfo->sta_cnt, MAX_ALLOWED_TDLS_STA_NUM); -+ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Allowed STA Num Reached", (ptdlsinfo->sta_maximum == _TRUE) ? "_TRUE" : "_FALSE"); -+ -+#ifdef CONFIG_TDLS_CH_SW -+ RTW_PRINT_SEL(m, "%-*s =", SpaceBtwnItemAndValue, "TDLS CH SW State"); -+ if (ptdlsinfo->chsw_info.ch_sw_state == TDLS_STATE_NONE) -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_STATE_NONE"); -+ else { -+ for (j = 0; j < 32; j++) { -+ if (ptdlsinfo->chsw_info.ch_sw_state & BIT(j)) { -+ if (FirstMatchFound == _FALSE) { -+ SpaceBtwnItemAndValueTmp = 1; -+ FirstMatchFound = _TRUE; -+ } else -+ SpaceBtwnItemAndValueTmp = SpaceBtwnItemAndValue + 3; -+ switch (BIT(j)) { -+ case TDLS_INITIATOR_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_INITIATOR_STATE"); -+ break; -+ case TDLS_RESPONDER_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_RESPONDER_STATE"); -+ break; -+ case TDLS_LINKED_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_LINKED_STATE"); -+ break; -+ case TDLS_WAIT_PTR_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_WAIT_PTR_STATE"); -+ break; -+ case TDLS_ALIVE_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_ALIVE_STATE"); -+ break; -+ case TDLS_CH_SWITCH_ON_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_CH_SWITCH_ON_STATE"); -+ break; -+ case TDLS_PEER_AT_OFF_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_PEER_AT_OFF_STATE"); -+ break; -+ case TDLS_CH_SW_INITIATOR_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_CH_SW_INITIATOR_STATE"); -+ break; -+ case TDLS_WAIT_CH_RSP_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValue, " ", "TDLS_WAIT_CH_RSP_STATE"); -+ break; -+ default: -+ RTW_PRINT_SEL(m, "%-*sBIT(%d)\n", SpaceBtwnItemAndValueTmp, " ", j); -+ break; -+ } -+ } -+ } -+ } -+ -+ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS CH SW On", (ATOMIC_READ(&ptdlsinfo->chsw_info.chsw_on) == _TRUE) ? "_TRUE" : "_FALSE"); -+ RTW_PRINT_SEL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "TDLS CH SW Off-Channel Num", ptdlsinfo->chsw_info.off_ch_num); -+ RTW_PRINT_SEL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "TDLS CH SW Channel Offset", ptdlsinfo->chsw_info.ch_offset); -+ RTW_PRINT_SEL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "TDLS CH SW Current Time", ptdlsinfo->chsw_info.cur_time); -+ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS CH SW Delay Switch Back", (ptdlsinfo->chsw_info.delay_switch_back == _TRUE) ? "_TRUE" : "_FALSE"); -+ RTW_PRINT_SEL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "TDLS CH SW Dump Back", ptdlsinfo->chsw_info.dump_stack); -+#endif -+ -+ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Device Discovered", (ptdlsinfo->dev_discovered == _TRUE) ? "_TRUE" : "_FALSE"); -+ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Enable", (ptdlsinfo->tdls_enable == _TRUE) ? "_TRUE" : "_FALSE"); -+ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Driver Setup", (ptdlsinfo->driver_setup == _TRUE) ? "_TRUE" : "_FALSE"); -+ -+ return 0; -+} -+ -+static int proc_tdls_display_network_info(struct seq_file *m) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ int i = 0; -+ u8 SpaceBtwnItemAndValue = TDLS_DBG_INFO_SPACE_BTWN_ITEM_AND_VALUE; -+ -+ /* Display the linked AP/GO info */ -+ RTW_PRINT_SEL(m, "============[Associated AP/GO Info]============\n"); -+ -+ if ((pmlmepriv->fw_state & WIFI_STATION_STATE) && (pmlmepriv->fw_state & _FW_LINKED)) { -+ RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "BSSID", cur_network->network.Ssid.Ssid); -+ RTW_PRINT_SEL(m, "%-*s = "MAC_FMT"\n", SpaceBtwnItemAndValue, "Mac Address", MAC_ARG(cur_network->network.MacAddress)); -+ -+ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Wireless Mode"); -+ for (i = 0; i < 8; i++) { -+ if (pmlmeext->cur_wireless_mode & BIT(i)) { -+ switch (BIT(i)) { -+ case WIRELESS_11B: -+ RTW_PRINT_SEL(m, "%4s", "11B "); -+ break; -+ case WIRELESS_11G: -+ RTW_PRINT_SEL(m, "%4s", "11G "); -+ break; -+ case WIRELESS_11A: -+ RTW_PRINT_SEL(m, "%4s", "11A "); -+ break; -+ case WIRELESS_11_24N: -+ RTW_PRINT_SEL(m, "%7s", "11_24N "); -+ break; -+ case WIRELESS_11_5N: -+ RTW_PRINT_SEL(m, "%6s", "11_5N "); -+ break; -+ case WIRELESS_AUTO: -+ RTW_PRINT_SEL(m, "%5s", "AUTO "); -+ break; -+ case WIRELESS_11AC: -+ RTW_PRINT_SEL(m, "%5s", "11AC "); -+ break; -+ } -+ } -+ } -+ RTW_PRINT_SEL(m, "\n"); -+ -+ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Privacy"); -+ switch (padapter->securitypriv.dot11PrivacyAlgrthm) { -+ case _NO_PRIVACY_: -+ RTW_PRINT_SEL(m, "%s\n", "NO PRIVACY"); -+ break; -+ case _WEP40_: -+ RTW_PRINT_SEL(m, "%s\n", "WEP 40"); -+ break; -+ case _TKIP_: -+ RTW_PRINT_SEL(m, "%s\n", "TKIP"); -+ break; -+ case _TKIP_WTMIC_: -+ RTW_PRINT_SEL(m, "%s\n", "TKIP WTMIC"); -+ break; -+ case _AES_: -+ RTW_PRINT_SEL(m, "%s\n", "AES"); -+ break; -+ case _WEP104_: -+ RTW_PRINT_SEL(m, "%s\n", "WEP 104"); -+ break; -+ case _WEP_WPA_MIXED_: -+ RTW_PRINT_SEL(m, "%s\n", "WEP/WPA Mixed"); -+ break; -+ case _SMS4_: -+ RTW_PRINT_SEL(m, "%s\n", "SMS4"); -+ break; -+#ifdef CONFIG_IEEE80211W -+ case _BIP_: -+ RTW_PRINT_SEL(m, "%s\n", "BIP"); -+ break; -+#endif /* CONFIG_IEEE80211W */ -+ } -+ -+ RTW_PRINT_SEL(m, "%-*s = %d\n", SpaceBtwnItemAndValue, "Channel", pmlmeext->cur_channel); -+ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Channel Offset"); -+ switch (pmlmeext->cur_ch_offset) { -+ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: -+ RTW_PRINT_SEL(m, "%s\n", "N/A"); -+ break; -+ case HAL_PRIME_CHNL_OFFSET_LOWER: -+ RTW_PRINT_SEL(m, "%s\n", "Lower"); -+ break; -+ case HAL_PRIME_CHNL_OFFSET_UPPER: -+ RTW_PRINT_SEL(m, "%s\n", "Upper"); -+ break; -+ } -+ -+ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Bandwidth Mode"); -+ switch (pmlmeext->cur_bwmode) { -+ case CHANNEL_WIDTH_20: -+ RTW_PRINT_SEL(m, "%s\n", "20MHz"); -+ break; -+ case CHANNEL_WIDTH_40: -+ RTW_PRINT_SEL(m, "%s\n", "40MHz"); -+ break; -+ case CHANNEL_WIDTH_80: -+ RTW_PRINT_SEL(m, "%s\n", "80MHz"); -+ break; -+ case CHANNEL_WIDTH_160: -+ RTW_PRINT_SEL(m, "%s\n", "160MHz"); -+ break; -+ case CHANNEL_WIDTH_80_80: -+ RTW_PRINT_SEL(m, "%s\n", "80MHz + 80MHz"); -+ break; -+ } -+ } else -+ RTW_PRINT_SEL(m, "No association with AP/GO exists!\n"); -+ -+ return 0; -+} -+ -+static int proc_tdls_display_tdls_sta_info(struct seq_file *m) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_info *psta; -+ int i = 0, j = 0; -+ _irqL irqL; -+ _list *plist, *phead; -+ u8 SpaceBtwnItemAndValue = TDLS_DBG_INFO_SPACE_BTWN_ITEM_AND_VALUE; -+ u8 SpaceBtwnItemAndValueTmp = 0; -+ u8 NumOfTdlsStaToShow = 0; -+ BOOLEAN FirstMatchFound = _FALSE; -+ -+ /* Search for TDLS sta info to display */ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for (i = 0; i < NUM_STA; i++) { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ plist = get_next(plist); -+ if (psta->tdls_sta_state != TDLS_STATE_NONE) { -+ /* We got one TDLS sta info to show */ -+ RTW_PRINT_SEL(m, "============[TDLS Peer STA Info: STA %d]============\n", ++NumOfTdlsStaToShow); -+ RTW_PRINT_SEL(m, "%-*s = "MAC_FMT"\n", SpaceBtwnItemAndValue, "Mac Address", MAC_ARG(psta->hwaddr)); -+ RTW_PRINT_SEL(m, "%-*s =", SpaceBtwnItemAndValue, "TDLS STA State"); -+ SpaceBtwnItemAndValueTmp = 0; -+ FirstMatchFound = _FALSE; -+ for (j = 0; j < 32; j++) { -+ if (psta->tdls_sta_state & BIT(j)) { -+ if (FirstMatchFound == _FALSE) { -+ SpaceBtwnItemAndValueTmp = 1; -+ FirstMatchFound = _TRUE; -+ } else -+ SpaceBtwnItemAndValueTmp = SpaceBtwnItemAndValue + 3; -+ switch (BIT(j)) { -+ case TDLS_INITIATOR_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_INITIATOR_STATE"); -+ break; -+ case TDLS_RESPONDER_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_RESPONDER_STATE"); -+ break; -+ case TDLS_LINKED_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_LINKED_STATE"); -+ break; -+ case TDLS_WAIT_PTR_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_WAIT_PTR_STATE"); -+ break; -+ case TDLS_ALIVE_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_ALIVE_STATE"); -+ break; -+ case TDLS_CH_SWITCH_ON_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_CH_SWITCH_ON_STATE"); -+ break; -+ case TDLS_PEER_AT_OFF_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_PEER_AT_OFF_STATE"); -+ break; -+ case TDLS_CH_SW_INITIATOR_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValueTmp, " ", "TDLS_CH_SW_INITIATOR_STATE"); -+ break; -+ case TDLS_WAIT_CH_RSP_STATE: -+ RTW_PRINT_SEL(m, "%-*s%s\n", SpaceBtwnItemAndValue, " ", "TDLS_WAIT_CH_RSP_STATE"); -+ break; -+ default: -+ RTW_PRINT_SEL(m, "%-*sBIT(%d)\n", SpaceBtwnItemAndValueTmp, " ", j); -+ break; -+ } -+ } -+ } -+ -+ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Wireless Mode"); -+ for (j = 0; j < 8; j++) { -+ if (psta->wireless_mode & BIT(j)) { -+ switch (BIT(j)) { -+ case WIRELESS_11B: -+ RTW_PRINT_SEL(m, "%4s", "11B "); -+ break; -+ case WIRELESS_11G: -+ RTW_PRINT_SEL(m, "%4s", "11G "); -+ break; -+ case WIRELESS_11A: -+ RTW_PRINT_SEL(m, "%4s", "11A "); -+ break; -+ case WIRELESS_11_24N: -+ RTW_PRINT_SEL(m, "%7s", "11_24N "); -+ break; -+ case WIRELESS_11_5N: -+ RTW_PRINT_SEL(m, "%6s", "11_5N "); -+ break; -+ case WIRELESS_AUTO: -+ RTW_PRINT_SEL(m, "%5s", "AUTO "); -+ break; -+ case WIRELESS_11AC: -+ RTW_PRINT_SEL(m, "%5s", "11AC "); -+ break; -+ } -+ } -+ } -+ RTW_PRINT_SEL(m, "\n"); -+ -+ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Bandwidth Mode"); -+ switch (psta->bw_mode) { -+ case CHANNEL_WIDTH_20: -+ RTW_PRINT_SEL(m, "%s\n", "20MHz"); -+ break; -+ case CHANNEL_WIDTH_40: -+ RTW_PRINT_SEL(m, "%s\n", "40MHz"); -+ break; -+ case CHANNEL_WIDTH_80: -+ RTW_PRINT_SEL(m, "%s\n", "80MHz"); -+ break; -+ case CHANNEL_WIDTH_160: -+ RTW_PRINT_SEL(m, "%s\n", "160MHz"); -+ break; -+ case CHANNEL_WIDTH_80_80: -+ RTW_PRINT_SEL(m, "%s\n", "80MHz + 80MHz"); -+ break; -+ } -+ -+ RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Privacy"); -+ switch (psta->dot118021XPrivacy) { -+ case _NO_PRIVACY_: -+ RTW_PRINT_SEL(m, "%s\n", "NO PRIVACY"); -+ break; -+ case _WEP40_: -+ RTW_PRINT_SEL(m, "%s\n", "WEP 40"); -+ break; -+ case _TKIP_: -+ RTW_PRINT_SEL(m, "%s\n", "TKIP"); -+ break; -+ case _TKIP_WTMIC_: -+ RTW_PRINT_SEL(m, "%s\n", "TKIP WTMIC"); -+ break; -+ case _AES_: -+ RTW_PRINT_SEL(m, "%s\n", "AES"); -+ break; -+ case _WEP104_: -+ RTW_PRINT_SEL(m, "%s\n", "WEP 104"); -+ break; -+ case _WEP_WPA_MIXED_: -+ RTW_PRINT_SEL(m, "%s\n", "WEP/WPA Mixed"); -+ break; -+ case _SMS4_: -+ RTW_PRINT_SEL(m, "%s\n", "SMS4"); -+ break; -+#ifdef CONFIG_IEEE80211W -+ case _BIP_: -+ RTW_PRINT_SEL(m, "%s\n", "BIP"); -+ break; -+#endif /* CONFIG_IEEE80211W */ -+ } -+ -+ RTW_PRINT_SEL(m, "%-*s = %d sec/%d sec\n", SpaceBtwnItemAndValue, "TPK Lifetime (Current/Expire)", psta->TPK_count, psta->TDLS_PeerKey_Lifetime); -+ RTW_PRINT_SEL(m, "%-*s = %llu\n", SpaceBtwnItemAndValue, "Tx Packets Over Direct Link", psta->sta_stats.tx_pkts); -+ RTW_PRINT_SEL(m, "%-*s = %llu\n", SpaceBtwnItemAndValue, "Rx Packets Over Direct Link", psta->sta_stats.rx_data_pkts); -+ } -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ if (NumOfTdlsStaToShow == 0) { -+ RTW_PRINT_SEL(m, "============[TDLS Peer STA Info]============\n"); -+ RTW_PRINT_SEL(m, "No TDLS direct link exists!\n"); -+ } -+ -+ return 0; -+} -+ -+int proc_get_tdls_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_info *psta; -+ int i = 0, j = 0; -+ _irqL irqL; -+ _list *plist, *phead; -+ u8 SpaceBtwnItemAndValue = 41; -+ u8 SpaceBtwnItemAndValueTmp = 0; -+ u8 NumOfTdlsStaToShow = 0; -+ BOOLEAN FirstMatchFound = _FALSE; -+ -+ if (hal_chk_wl_func(padapter, WL_FUNC_TDLS) == _FALSE) { -+ RTW_PRINT_SEL(m, "No tdls info can be shown since hal doesn't support tdls\n"); -+ return 0; -+ } -+ -+ proc_tdls_display_tdls_function_info(m); -+ proc_tdls_display_network_info(m); -+ proc_tdls_display_tdls_sta_info(m); -+ -+ return 0; -+} -+#endif -+ -+int proc_get_monitor(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (WIFI_MONITOR_STATE == get_fwstate(pmlmepriv)) { -+ RTW_PRINT_SEL(m, "Monitor mode : Enable\n"); -+ -+ RTW_PRINT_SEL(m, "ch=%d, ch_offset=%d, bw=%d\n", -+ rtw_get_oper_ch(padapter), rtw_get_oper_choffset(padapter), rtw_get_oper_bw(padapter)); -+ } else -+ RTW_PRINT_SEL(m, "Monitor mode : Disable\n"); -+ -+ return 0; -+} -+ -+ssize_t proc_set_monitor(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ char tmp[32]; -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 target_chan, target_offset, target_bw; -+ -+ if (count < 3) { -+ RTW_INFO("argument size is less than 3\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%hhu %hhu %hhu", &target_chan, &target_offset, &target_bw); -+ -+ if (num != 3) { -+ RTW_INFO("invalid write_reg parameter!\n"); -+ return count; -+ } -+ -+ padapter->mlmeextpriv.cur_channel = target_chan; -+ set_channel_bwmode(padapter, target_chan, target_offset, target_bw); -+ } -+ -+ return count; -+} -+ -+#include -+int proc_get_efuse_map(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+ int i, j; -+ u8 ips_mode = IPS_NUM; -+ u16 mapLen; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, _FALSE); -+ if (mapLen > EFUSE_MAX_MAP_LEN) -+ mapLen = EFUSE_MAX_MAP_LEN; -+ -+ ips_mode = pwrctrlpriv->ips_mode; -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ -+ if (pHalData->efuse_file_status == EFUSE_FILE_LOADED) { -+ RTW_PRINT_SEL(m, "File eFuse Map loaded! file path:%s\nDriver eFuse Map From File\n", EFUSE_MAP_PATH); -+ if (pHalData->bautoload_fail_flag) -+ RTW_PRINT_SEL(m, "File Autoload fail!!!\n"); -+ } else if (pHalData->efuse_file_status == EFUSE_FILE_FAILED) { -+ RTW_PRINT_SEL(m, "Open File eFuse Map Fail ! file path:%s\nDriver eFuse Map From Default\n", EFUSE_MAP_PATH); -+ if (pHalData->bautoload_fail_flag) -+ RTW_PRINT_SEL(m, "HW Autoload fail!!!\n"); -+ } else { -+ RTW_PRINT_SEL(m, "Driver eFuse Map From HW\n"); -+ if (pHalData->bautoload_fail_flag) -+ RTW_PRINT_SEL(m, "HW Autoload fail!!!\n"); -+ } -+ for (i = 0; i < mapLen; i += 16) { -+ RTW_PRINT_SEL(m, "0x%02x\t", i); -+ for (j = 0; j < 8; j++) -+ RTW_PRINT_SEL(m, "%02X ", pHalData->efuse_eeprom_data[i + j]); -+ RTW_PRINT_SEL(m, "\t"); -+ for (; j < 16; j++) -+ RTW_PRINT_SEL(m, "%02X ", pHalData->efuse_eeprom_data[i + j]); -+ RTW_PRINT_SEL(m, "\n"); -+ } -+ -+ if (rtw_efuse_map_read(padapter, 0, mapLen, pEfuseHal->fakeEfuseInitMap) == _FAIL) { -+ RTW_PRINT_SEL(m, "WARN - Read Realmap Failed\n"); -+ return 0; -+ } -+ -+ RTW_PRINT_SEL(m, "\n"); -+ RTW_PRINT_SEL(m, "HW eFuse Map\n"); -+ for (i = 0; i < mapLen; i += 16) { -+ RTW_PRINT_SEL(m, "0x%02x\t", i); -+ for (j = 0; j < 8; j++) -+ RTW_PRINT_SEL(m, "%02X ", pEfuseHal->fakeEfuseInitMap[i + j]); -+ RTW_PRINT_SEL(m, "\t"); -+ for (; j < 16; j++) -+ RTW_PRINT_SEL(m, "%02X ", pEfuseHal->fakeEfuseInitMap[i + j]); -+ RTW_PRINT_SEL(m, "\n"); -+ } -+ -+ rtw_pm_set_ips(padapter, ips_mode); -+ -+ return 0; -+} -+ -+ssize_t proc_set_efuse_map(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+#if 0 -+ char tmp[256] = {0}; -+ u32 addr, cnts; -+ u8 efuse_data; -+ -+ int jj, kk; -+ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ u8 ips_mode = IPS_NUM; -+ -+ if (count < 3) { -+ RTW_INFO("argument size is less than 3\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%x %d %x", &addr, &cnts, &efuse_data); -+ -+ if (num != 3) { -+ RTW_INFO("invalid write_reg parameter!\n"); -+ return count; -+ } -+ } -+ ips_mode = pwrctrlpriv->ips_mode; -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ if (rtw_efuse_map_write(padapter, addr, cnts, &efuse_data) == _FAIL) -+ RTW_INFO("WARN - rtw_efuse_map_write error!!\n"); -+ rtw_pm_set_ips(padapter, ips_mode); -+#endif -+ return count; -+} -+ -+#ifdef CONFIG_IEEE80211W -+ssize_t proc_set_tx_sa_query(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct sta_info *psta; -+ _list *plist, *phead; -+ _irqL irqL; -+ char tmp[16]; -+ u8 mac_addr[NUM_STA][ETH_ALEN]; -+ u32 key_type; -+ u8 index; -+ -+ if (count > 2) { -+ RTW_INFO("argument size is more than 2\n"); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x", &key_type); -+ -+ if (num != 1) { -+ RTW_INFO("invalid read_reg parameter!\n"); -+ return count; -+ } -+ RTW_INFO("0: set sa query request , key_type=%d\n", key_type); -+ } -+ -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && padapter->securitypriv.binstallBIPkey == _TRUE) { -+ RTW_INFO("STA:"MAC_FMT"\n", MAC_ARG(get_my_bssid(&(pmlmeinfo->network)))); -+ /* TX unicast sa_query to AP */ -+ issue_action_SA_Query(padapter, get_my_bssid(&(pmlmeinfo->network)), 0, 0, (u8)key_type); -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE && padapter->securitypriv.binstallBIPkey == _TRUE) { -+ /* TX unicast sa_query to every client STA */ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for (index = 0; index < NUM_STA; index++) { -+ psta = NULL; -+ -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ plist = get_next(plist); -+ _rtw_memcpy(&mac_addr[psta->mac_id][0], psta->hwaddr, ETH_ALEN); -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for (index = 0; index < macid_ctl->num && index < NUM_STA; index++) { -+ if (rtw_macid_is_used(macid_ctl, index) && !rtw_macid_is_bmc(macid_ctl, index)) { -+ if (!_rtw_memcmp(get_my_bssid(&(pmlmeinfo->network)), &mac_addr[index][0], ETH_ALEN) -+ && !IS_MCAST(&mac_addr[index][0])) { -+ issue_action_SA_Query(padapter, &mac_addr[index][0], 0, 0, (u8)key_type); -+ RTW_INFO("STA[%u]:"MAC_FMT"\n", index , MAC_ARG(&mac_addr[index][0])); -+ } -+ } -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_tx_sa_query(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "%s\n", __func__); -+ return 0; -+} -+ -+ssize_t proc_set_tx_deauth(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct sta_info *psta; -+ _list *plist, *phead; -+ _irqL irqL; -+ char tmp[16]; -+ u8 mac_addr[NUM_STA][ETH_ALEN]; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u32 key_type; -+ u8 index; -+ -+ -+ if (count > 2) { -+ RTW_INFO("argument size is more than 2\n"); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x", &key_type); -+ -+ if (num != 1) { -+ RTW_INFO("invalid read_reg parameter!\n"); -+ return count; -+ } -+ RTW_INFO("key_type=%d\n", key_type); -+ } -+ if (key_type < 0 || key_type > 4) -+ return count; -+ -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { -+ if (key_type == 3) /* key_type 3 only for AP mode */ -+ return count; -+ /* TX unicast deauth to AP */ -+ issue_deauth_11w(padapter, get_my_bssid(&(pmlmeinfo->network)), 0, (u8)key_type); -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ -+ if (key_type == 3) -+ issue_deauth_11w(padapter, bc_addr, 0, IEEE80211W_RIGHT_KEY); -+ -+ /* TX unicast deauth to every client STA */ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for (index = 0; index < NUM_STA; index++) { -+ psta = NULL; -+ -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ plist = get_next(plist); -+ _rtw_memcpy(&mac_addr[psta->mac_id][0], psta->hwaddr, ETH_ALEN); -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for (index = 0; index < macid_ctl->num && index < NUM_STA; index++) { -+ if (rtw_macid_is_used(macid_ctl, index) && !rtw_macid_is_bmc(macid_ctl, index)) { -+ if (!_rtw_memcmp(get_my_bssid(&(pmlmeinfo->network)), &mac_addr[index][0], ETH_ALEN)) { -+ if (key_type != 3) -+ issue_deauth_11w(padapter, &mac_addr[index][0], 0, (u8)key_type); -+ -+ psta = rtw_get_stainfo(pstapriv, &mac_addr[index][0]); -+ if (psta && key_type != IEEE80211W_WRONG_KEY && key_type != IEEE80211W_NO_KEY) { -+ u8 updated = _FALSE; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); -+ } -+ -+ RTW_INFO("STA[%u]:"MAC_FMT"\n", index , MAC_ARG(&mac_addr[index][0])); -+ } -+ } -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_tx_deauth(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "%s\n", __func__); -+ return 0; -+} -+ -+ssize_t proc_set_tx_auth(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct sta_info *psta; -+ _list *plist, *phead; -+ _irqL irqL; -+ char tmp[16]; -+ u8 mac_addr[NUM_STA][ETH_ALEN]; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u32 tx_auth; -+ u8 index; -+ -+ -+ if (count > 2) { -+ RTW_INFO("argument size is more than 2\n"); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x", &tx_auth); -+ -+ if (num != 1) { -+ RTW_INFO("invalid read_reg parameter!\n"); -+ return count; -+ } -+ RTW_INFO("1: setnd auth, 2: send assoc request. tx_auth=%d\n", tx_auth); -+ } -+ -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { -+ if (tx_auth == 1) { -+ /* TX unicast auth to AP */ -+ issue_auth(padapter, NULL, 0); -+ } else if (tx_auth == 2) { -+ /* TX unicast auth to AP */ -+ issue_assocreq(padapter); -+ } -+ } -+ -+ return count; -+} -+ -+int proc_get_tx_auth(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "%s\n", __func__); -+ return 0; -+} -+#endif /* CONFIG_IEEE80211W */ -+ -+#ifdef CONFIG_MCC_MODE -+int proc_get_mcc_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_adapters_status(m, adapter_to_dvobj(adapter)); -+ rtw_hal_dump_mcc_info(m, adapter_to_dvobj(adapter)); -+ return 0; -+} -+ -+ssize_t proc_set_mcc_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[255]; -+ u32 en_mcc = 0; -+ -+ if (NULL == buffer) { -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface = NULL; -+ u8 i = 0; -+ int num = sscanf(tmp, "%u", &en_mcc); -+ -+ if (num < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+ -+ RTW_INFO("%s: en_mcc = %d\n", __func__, en_mcc); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ iface->registrypriv.en_mcc = en_mcc; -+ } -+ } -+ -+ return count; -+} -+ -+ssize_t proc_set_mcc_single_tx_criteria(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[255]; -+ u32 mcc_single_tx_criteria = 0; -+ -+ if (NULL == buffer) { -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface = NULL; -+ u8 i = 0; -+ int num = sscanf(tmp, "%u", &mcc_single_tx_criteria); -+ -+ if (num < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+ -+ RTW_INFO("%s: mcc_single_tx_criteria = %d\n", __func__, mcc_single_tx_criteria); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ iface->registrypriv.rtw_mcc_single_tx_cri = mcc_single_tx_criteria; -+ } -+ -+ -+ } -+ -+ return count; -+} -+ -+ -+ssize_t proc_set_mcc_ap_bw20_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[255]; -+ u32 mcc_ap_bw20_target_tp = 0; -+ -+ if (NULL == buffer) { -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%u", &mcc_ap_bw20_target_tp); -+ -+ if (num < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+ -+ RTW_INFO("%s: mcc_ap_bw20_target_tp = %d\n", __func__, mcc_ap_bw20_target_tp); -+ -+ padapter->registrypriv.rtw_mcc_ap_bw20_target_tx_tp = mcc_ap_bw20_target_tp; -+ -+ -+ } -+ -+ return count; -+} -+ -+ssize_t proc_set_mcc_ap_bw40_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[255]; -+ u32 mcc_ap_bw40_target_tp = 0; -+ -+ if (NULL == buffer) { -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%u", &mcc_ap_bw40_target_tp); -+ -+ if (num < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+ -+ RTW_INFO("%s: mcc_ap_bw40_target_tp = %d\n", __func__, mcc_ap_bw40_target_tp); -+ -+ padapter->registrypriv.rtw_mcc_ap_bw40_target_tx_tp = mcc_ap_bw40_target_tp; -+ -+ -+ } -+ -+ return count; -+} -+ -+ssize_t proc_set_mcc_ap_bw80_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[255]; -+ u32 mcc_ap_bw80_target_tp = 0; -+ -+ if (NULL == buffer) { -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%u", &mcc_ap_bw80_target_tp); -+ -+ if (num < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+ -+ RTW_INFO("%s: mcc_ap_bw80_target_tp = %d\n", __func__, mcc_ap_bw80_target_tp); -+ -+ padapter->registrypriv.rtw_mcc_ap_bw80_target_tx_tp = mcc_ap_bw80_target_tp; -+ -+ -+ } -+ -+ return count; -+} -+ -+ssize_t proc_set_mcc_sta_bw20_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[255]; -+ u32 mcc_sta_bw20_target_tp = 0; -+ -+ if (NULL == buffer) { -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%u", &mcc_sta_bw20_target_tp); -+ -+ if (num < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+ -+ RTW_INFO("%s: mcc_sta_bw20_target_tp = %d\n", __func__, mcc_sta_bw20_target_tp); -+ -+ padapter->registrypriv.rtw_mcc_sta_bw20_target_tx_tp = mcc_sta_bw20_target_tp; -+ -+ -+ } -+ -+ return count; -+} -+ -+ssize_t proc_set_mcc_sta_bw40_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[255]; -+ u32 mcc_sta_bw40_target_tp = 0; -+ -+ if (NULL == buffer) { -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%u", &mcc_sta_bw40_target_tp); -+ -+ if (num < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+ -+ RTW_INFO("%s: mcc_sta_bw40_target_tp = %d\n", __func__, mcc_sta_bw40_target_tp); -+ -+ padapter->registrypriv.rtw_mcc_sta_bw40_target_tx_tp = mcc_sta_bw40_target_tp; -+ -+ -+ } -+ -+ return count; -+} -+ -+ssize_t proc_set_mcc_sta_bw80_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[255]; -+ u32 mcc_sta_bw80_target_tp = 0; -+ -+ if (NULL == buffer) { -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%u", &mcc_sta_bw80_target_tp); -+ -+ if (num < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); -+ return -EINVAL; -+ } -+ -+ RTW_INFO("%s: mcc_sta_bw80_target_tp = %d\n", __func__, mcc_sta_bw80_target_tp); -+ -+ padapter->registrypriv.rtw_mcc_sta_bw80_target_tx_tp = mcc_sta_bw80_target_tp; -+ -+ -+ } -+ -+ return count; -+} -+#endif /* CONFIG_MCC_MODE */ -+ -+#endif /* CONFIG_PROC_DEBUG */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_eeprom.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_eeprom.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_eeprom.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_eeprom.c 2018-02-11 21:44:27.136145918 +0200 -@@ -0,0 +1,374 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_EEPROM_C_ -+ -+#include -+#include -+#include -+ -+void up_clk(_adapter *padapter, u16 *x) -+{ -+ *x = *x | _EESK; -+ rtw_write8(padapter, EE_9346CR, (u8)*x); -+ rtw_udelay_os(CLOCK_RATE); -+ -+ -+} -+ -+void down_clk(_adapter *padapter, u16 *x) -+{ -+ *x = *x & ~_EESK; -+ rtw_write8(padapter, EE_9346CR, (u8)*x); -+ rtw_udelay_os(CLOCK_RATE); -+} -+ -+void shift_out_bits(_adapter *padapter, u16 data, u16 count) -+{ -+ u16 x, mask; -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ mask = 0x01 << (count - 1); -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EEDO | _EEDI); -+ -+ do { -+ x &= ~_EEDI; -+ if (data & mask) -+ x |= _EEDI; -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ rtw_write8(padapter, EE_9346CR, (u8)x); -+ rtw_udelay_os(CLOCK_RATE); -+ up_clk(padapter, &x); -+ down_clk(padapter, &x); -+ mask = mask >> 1; -+ } while (mask); -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ x &= ~_EEDI; -+ rtw_write8(padapter, EE_9346CR, (u8)x); -+out: -+ return; -+} -+ -+u16 shift_in_bits(_adapter *padapter) -+{ -+ u16 x, d = 0, i; -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EEDO | _EEDI); -+ d = 0; -+ -+ for (i = 0; i < 16; i++) { -+ d = d << 1; -+ up_clk(padapter, &x); -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EEDI); -+ if (x & _EEDO) -+ d |= 1; -+ -+ down_clk(padapter, &x); -+ } -+out: -+ -+ return d; -+} -+ -+void standby(_adapter *padapter) -+{ -+ u8 x; -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EECS | _EESK); -+ rtw_write8(padapter, EE_9346CR, x); -+ -+ rtw_udelay_os(CLOCK_RATE); -+ x |= _EECS; -+ rtw_write8(padapter, EE_9346CR, x); -+ rtw_udelay_os(CLOCK_RATE); -+} -+ -+u16 wait_eeprom_cmd_done(_adapter *padapter) -+{ -+ u8 x; -+ u16 i, res = _FALSE; -+ standby(padapter); -+ for (i = 0; i < 200; i++) { -+ x = rtw_read8(padapter, EE_9346CR); -+ if (x & _EEDO) { -+ res = _TRUE; -+ goto exit; -+ } -+ rtw_udelay_os(CLOCK_RATE); -+ } -+exit: -+ return res; -+} -+ -+void eeprom_clean(_adapter *padapter) -+{ -+ u16 x; -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ x = rtw_read8(padapter, EE_9346CR); -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ x &= ~(_EECS | _EEDI); -+ rtw_write8(padapter, EE_9346CR, (u8)x); -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ up_clk(padapter, &x); -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ down_clk(padapter, &x); -+out: -+ return; -+} -+ -+void eeprom_write16(_adapter *padapter, u16 reg, u16 data) -+{ -+ u8 x; -+#ifdef CONFIG_RTL8712 -+ u8 tmp8_ori, tmp8_new, tmp8_clk_ori, tmp8_clk_new; -+ tmp8_ori = rtw_read8(padapter, 0x102502f1); -+ tmp8_new = tmp8_ori & 0xf7; -+ if (tmp8_ori != tmp8_new) { -+ rtw_write8(padapter, 0x102502f1, tmp8_new); -+ } -+ tmp8_clk_ori = rtw_read8(padapter, 0x10250003); -+ tmp8_clk_new = tmp8_clk_ori | 0x20; -+ if (tmp8_clk_new != tmp8_clk_ori) { -+ rtw_write8(padapter, 0x10250003, tmp8_clk_new); -+ } -+#endif -+ -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ x &= ~(_EEDI | _EEDO | _EESK | _EEM0); -+ x |= _EEM1 | _EECS; -+ rtw_write8(padapter, EE_9346CR, x); -+ -+ shift_out_bits(padapter, EEPROM_EWEN_OPCODE, 5); -+ -+ if (padapter->EepromAddressSize == 8) /* CF+ and SDIO */ -+ shift_out_bits(padapter, 0, 6); -+ else /* USB */ -+ shift_out_bits(padapter, 0, 4); -+ -+ standby(padapter); -+ -+ /* Commented out by rcnjko, 2004.0 -+ * Erase this particular word. Write the erase opcode and register -+ * number in that order. The opcode is 3bits in length; reg is 6 bits long. */ -+/* shift_out_bits(Adapter, EEPROM_ERASE_OPCODE, 3); -+ * shift_out_bits(Adapter, reg, Adapter->EepromAddressSize); -+ * -+ * if (wait_eeprom_cmd_done(Adapter ) == FALSE) -+ * { -+ * return; -+ * } */ -+ -+ -+ standby(padapter); -+ -+ /* write the new word to the EEPROM */ -+ -+ /* send the write opcode the EEPORM */ -+ shift_out_bits(padapter, EEPROM_WRITE_OPCODE, 3); -+ -+ /* select which word in the EEPROM that we are writing to. */ -+ shift_out_bits(padapter, reg, padapter->EepromAddressSize); -+ -+ /* write the data to the selected EEPROM word. */ -+ shift_out_bits(padapter, data, 16); -+ -+ if (wait_eeprom_cmd_done(padapter) == _FALSE) -+ -+ goto exit; -+ -+ standby(padapter); -+ -+ shift_out_bits(padapter, EEPROM_EWDS_OPCODE, 5); -+ shift_out_bits(padapter, reg, 4); -+ -+ eeprom_clean(padapter); -+exit: -+#ifdef CONFIG_RTL8712 -+ if (tmp8_clk_new != tmp8_clk_ori) -+ rtw_write8(padapter, 0x10250003, tmp8_clk_ori); -+ if (tmp8_new != tmp8_ori) -+ rtw_write8(padapter, 0x102502f1, tmp8_ori); -+ -+#endif -+ return; -+} -+ -+u16 eeprom_read16(_adapter *padapter, u16 reg) /* ReadEEprom */ -+{ -+ -+ u16 x; -+ u16 data = 0; -+#ifdef CONFIG_RTL8712 -+ u8 tmp8_ori, tmp8_new, tmp8_clk_ori, tmp8_clk_new; -+ tmp8_ori = rtw_read8(padapter, 0x102502f1); -+ tmp8_new = tmp8_ori & 0xf7; -+ if (tmp8_ori != tmp8_new) { -+ rtw_write8(padapter, 0x102502f1, tmp8_new); -+ } -+ tmp8_clk_ori = rtw_read8(padapter, 0x10250003); -+ tmp8_clk_new = tmp8_clk_ori | 0x20; -+ if (tmp8_clk_new != tmp8_clk_ori) { -+ rtw_write8(padapter, 0x10250003, tmp8_clk_new); -+ } -+#endif -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ /* select EEPROM, reset bits, set _EECS */ -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ -+ x &= ~(_EEDI | _EEDO | _EESK | _EEM0); -+ x |= _EEM1 | _EECS; -+ rtw_write8(padapter, EE_9346CR, (unsigned char)x); -+ -+ /* write the read opcode and register number in that order */ -+ /* The opcode is 3bits in length, reg is 6 bits long */ -+ shift_out_bits(padapter, EEPROM_READ_OPCODE, 3); -+ shift_out_bits(padapter, reg, padapter->EepromAddressSize); -+ -+ /* Now read the data (16 bits) in from the selected EEPROM word */ -+ data = shift_in_bits(padapter); -+ -+ eeprom_clean(padapter); -+out: -+#ifdef CONFIG_RTL8712 -+ if (tmp8_clk_new != tmp8_clk_ori) -+ rtw_write8(padapter, 0x10250003, tmp8_clk_ori); -+ if (tmp8_new != tmp8_ori) -+ rtw_write8(padapter, 0x102502f1, tmp8_ori); -+ -+#endif -+ return data; -+ -+ -+} -+ -+ -+ -+ -+/* From even offset */ -+void eeprom_read_sz(_adapter *padapter, u16 reg, u8 *data, u32 sz) -+{ -+ -+ u16 x, data16; -+ u32 i; -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ /* select EEPROM, reset bits, set _EECS */ -+ x = rtw_read8(padapter, EE_9346CR); -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ goto out; -+ } -+ -+ x &= ~(_EEDI | _EEDO | _EESK | _EEM0); -+ x |= _EEM1 | _EECS; -+ rtw_write8(padapter, EE_9346CR, (unsigned char)x); -+ -+ /* write the read opcode and register number in that order */ -+ /* The opcode is 3bits in length, reg is 6 bits long */ -+ shift_out_bits(padapter, EEPROM_READ_OPCODE, 3); -+ shift_out_bits(padapter, reg, padapter->EepromAddressSize); -+ -+ -+ for (i = 0; i < sz; i += 2) { -+ data16 = shift_in_bits(padapter); -+ data[i] = data16 & 0xff; -+ data[i + 1] = data16 >> 8; -+ } -+ -+ eeprom_clean(padapter); -+out: -+ return; -+} -+ -+ -+/* addr_off : address offset of the entry in eeprom (not the tuple number of eeprom (reg); that is addr_off !=reg) */ -+u8 eeprom_read(_adapter *padapter, u32 addr_off, u8 sz, u8 *rbuf) -+{ -+ u8 quotient, remainder, addr_2align_odd; -+ u16 reg, stmp , i = 0, idx = 0; -+ reg = (u16)(addr_off >> 1); -+ addr_2align_odd = (u8)(addr_off & 0x1); -+ -+ if (addr_2align_odd) { /* read that start at high part: e.g 1,3,5,7,9,... */ -+ stmp = eeprom_read16(padapter, reg); -+ rbuf[idx++] = (u8)((stmp >> 8) & 0xff); /* return hogh-part of the short */ -+ reg++; -+ sz--; -+ } -+ -+ quotient = sz >> 1; -+ remainder = sz & 0x1; -+ -+ for (i = 0 ; i < quotient; i++) { -+ stmp = eeprom_read16(padapter, reg + i); -+ rbuf[idx++] = (u8)(stmp & 0xff); -+ rbuf[idx++] = (u8)((stmp >> 8) & 0xff); -+ } -+ -+ reg = reg + i; -+ if (remainder) { /* end of read at lower part of short : 0,2,4,6,... */ -+ stmp = eeprom_read16(padapter, reg); -+ rbuf[idx] = (u8)(stmp & 0xff); -+ } -+ return _TRUE; -+} -+ -+ -+ -+VOID read_eeprom_content(_adapter *padapter) -+{ -+ -+ -+ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_ieee80211.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ieee80211.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_ieee80211.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ieee80211.c 2018-02-11 21:44:27.136145918 +0200 -@@ -0,0 +1,2706 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _IEEE80211_C -+ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ #include -+#endif -+#include -+ -+ -+u8 RTW_WPA_OUI_TYPE[] = { 0x00, 0x50, 0xf2, 1 }; -+u16 RTW_WPA_VERSION = 1; -+u8 WPA_AUTH_KEY_MGMT_NONE[] = { 0x00, 0x50, 0xf2, 0 }; -+u8 WPA_AUTH_KEY_MGMT_UNSPEC_802_1X[] = { 0x00, 0x50, 0xf2, 1 }; -+u8 WPA_AUTH_KEY_MGMT_PSK_OVER_802_1X[] = { 0x00, 0x50, 0xf2, 2 }; -+u8 WPA_CIPHER_SUITE_NONE[] = { 0x00, 0x50, 0xf2, 0 }; -+u8 WPA_CIPHER_SUITE_WEP40[] = { 0x00, 0x50, 0xf2, 1 }; -+u8 WPA_CIPHER_SUITE_TKIP[] = { 0x00, 0x50, 0xf2, 2 }; -+u8 WPA_CIPHER_SUITE_WRAP[] = { 0x00, 0x50, 0xf2, 3 }; -+u8 WPA_CIPHER_SUITE_CCMP[] = { 0x00, 0x50, 0xf2, 4 }; -+u8 WPA_CIPHER_SUITE_WEP104[] = { 0x00, 0x50, 0xf2, 5 }; -+ -+u16 RSN_VERSION_BSD = 1; -+u8 RSN_AUTH_KEY_MGMT_UNSPEC_802_1X[] = { 0x00, 0x0f, 0xac, 1 }; -+u8 RSN_AUTH_KEY_MGMT_PSK_OVER_802_1X[] = { 0x00, 0x0f, 0xac, 2 }; -+u8 RSN_CIPHER_SUITE_NONE[] = { 0x00, 0x0f, 0xac, 0 }; -+u8 RSN_CIPHER_SUITE_WEP40[] = { 0x00, 0x0f, 0xac, 1 }; -+u8 RSN_CIPHER_SUITE_TKIP[] = { 0x00, 0x0f, 0xac, 2 }; -+u8 RSN_CIPHER_SUITE_WRAP[] = { 0x00, 0x0f, 0xac, 3 }; -+u8 RSN_CIPHER_SUITE_CCMP[] = { 0x00, 0x0f, 0xac, 4 }; -+u8 RSN_CIPHER_SUITE_WEP104[] = { 0x00, 0x0f, 0xac, 5 }; -+/* ----------------------------------------------------------- -+ * for adhoc-master to generate ie and provide supported-rate to fw -+ * ----------------------------------------------------------- */ -+ -+static u8 WIFI_CCKRATES[] = { -+ (IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK), -+ (IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK), -+ (IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK), -+ (IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK) -+}; -+ -+static u8 WIFI_OFDMRATES[] = { -+ (IEEE80211_OFDM_RATE_6MB), -+ (IEEE80211_OFDM_RATE_9MB), -+ (IEEE80211_OFDM_RATE_12MB), -+ (IEEE80211_OFDM_RATE_18MB), -+ (IEEE80211_OFDM_RATE_24MB), -+ IEEE80211_OFDM_RATE_36MB, -+ IEEE80211_OFDM_RATE_48MB, -+ IEEE80211_OFDM_RATE_54MB -+}; -+ -+u8 mgn_rates_cck[4] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}; -+u8 mgn_rates_ofdm[8] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M}; -+u8 mgn_rates_mcs0_7[8] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}; -+u8 mgn_rates_mcs8_15[8] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}; -+u8 mgn_rates_mcs16_23[8] = {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23}; -+u8 mgn_rates_mcs24_31[8] = {MGN_MCS24, MGN_MCS25, MGN_MCS26, MGN_MCS27, MGN_MCS28, MGN_MCS29, MGN_MCS30, MGN_MCS31}; -+u8 mgn_rates_vht1ss[10] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4 -+ , MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9 -+ }; -+u8 mgn_rates_vht2ss[10] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4 -+ , MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9 -+ }; -+u8 mgn_rates_vht3ss[10] = {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4 -+ , MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9 -+ }; -+u8 mgn_rates_vht4ss[10] = {MGN_VHT4SS_MCS0, MGN_VHT4SS_MCS1, MGN_VHT4SS_MCS2, MGN_VHT4SS_MCS3, MGN_VHT4SS_MCS4 -+ , MGN_VHT4SS_MCS5, MGN_VHT4SS_MCS6, MGN_VHT4SS_MCS7, MGN_VHT4SS_MCS8, MGN_VHT4SS_MCS9 -+ }; -+ -+static const char *const _rate_section_str[] = { -+ "CCK", -+ "OFDM", -+ "HT_1SS", -+ "HT_2SS", -+ "HT_3SS", -+ "HT_4SS", -+ "VHT_1SS", -+ "VHT_2SS", -+ "VHT_3SS", -+ "VHT_4SS", -+ "RATE_SECTION_UNKNOWN", -+}; -+ -+const char *rate_section_str(u8 section) -+{ -+ section = (section >= RATE_SECTION_NUM) ? RATE_SECTION_NUM : section; -+ return _rate_section_str[section]; -+} -+ -+struct rate_section_ent rates_by_sections[RATE_SECTION_NUM] = { -+ {RF_1TX, 4, mgn_rates_cck}, -+ {RF_1TX, 8, mgn_rates_ofdm}, -+ {RF_1TX, 8, mgn_rates_mcs0_7}, -+ {RF_2TX, 8, mgn_rates_mcs8_15}, -+ {RF_3TX, 8, mgn_rates_mcs16_23}, -+ {RF_4TX, 8, mgn_rates_mcs24_31}, -+ {RF_1TX, 10, mgn_rates_vht1ss}, -+ {RF_2TX, 10, mgn_rates_vht2ss}, -+ {RF_3TX, 10, mgn_rates_vht3ss}, -+ {RF_4TX, 10, mgn_rates_vht4ss}, -+}; -+ -+int rtw_get_bit_value_from_ieee_value(u8 val) -+{ -+ unsigned char dot11_rate_table[] = {2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108, 0}; /* last element must be zero!! */ -+ -+ int i = 0; -+ while (dot11_rate_table[i] != 0) { -+ if (dot11_rate_table[i] == val) -+ return BIT(i); -+ i++; -+ } -+ return 0; -+} -+ -+uint rtw_is_cckrates_included(u8 *rate) -+{ -+ u32 i = 0; -+ -+ while (rate[i] != 0) { -+ if ((((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || -+ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22)) -+ return _TRUE; -+ i++; -+ } -+ -+ return _FALSE; -+} -+ -+uint rtw_is_cckratesonly_included(u8 *rate) -+{ -+ u32 i = 0; -+ -+ -+ while (rate[i] != 0) { -+ if ((((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && -+ (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22)) -+ return _FALSE; -+ -+ i++; -+ } -+ -+ return _TRUE; -+ -+} -+ -+int rtw_check_network_type(unsigned char *rate, int ratelen, int channel) -+{ -+ if (channel > 14) { -+ if ((rtw_is_cckrates_included(rate)) == _TRUE) -+ return WIRELESS_INVALID; -+ else -+ return WIRELESS_11A; -+ } else { /* could be pure B, pure G, or B/G */ -+ if ((rtw_is_cckratesonly_included(rate)) == _TRUE) -+ return WIRELESS_11B; -+ else if ((rtw_is_cckrates_included(rate)) == _TRUE) -+ return WIRELESS_11BG; -+ else -+ return WIRELESS_11G; -+ } -+ -+} -+ -+u8 *rtw_set_fixed_ie(unsigned char *pbuf, unsigned int len, unsigned char *source, -+ unsigned int *frlen) -+{ -+ _rtw_memcpy((void *)pbuf, (void *)source, len); -+ *frlen = *frlen + len; -+ return pbuf + len; -+} -+ -+/* rtw_set_ie will update frame length */ -+u8 *rtw_set_ie -+( -+ u8 *pbuf, -+ sint index, -+ uint len, -+ u8 *source, -+ uint *frlen /* frame length */ -+) -+{ -+ *pbuf = (u8)index; -+ -+ *(pbuf + 1) = (u8)len; -+ -+ if (len > 0) -+ _rtw_memcpy((void *)(pbuf + 2), (void *)source, len); -+ -+ *frlen = *frlen + (len + 2); -+ -+ return pbuf + len + 2; -+} -+ -+inline u8 *rtw_set_ie_ch_switch(u8 *buf, u32 *buf_len, u8 ch_switch_mode, -+ u8 new_ch, u8 ch_switch_cnt) -+{ -+ u8 ie_data[3]; -+ -+ ie_data[0] = ch_switch_mode; -+ ie_data[1] = new_ch; -+ ie_data[2] = ch_switch_cnt; -+ return rtw_set_ie(buf, WLAN_EID_CHANNEL_SWITCH, 3, ie_data, buf_len); -+} -+ -+inline u8 secondary_ch_offset_to_hal_ch_offset(u8 ch_offset) -+{ -+ if (ch_offset == SCN) -+ return HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ else if (ch_offset == SCA) -+ return HAL_PRIME_CHNL_OFFSET_UPPER; -+ else if (ch_offset == SCB) -+ return HAL_PRIME_CHNL_OFFSET_LOWER; -+ -+ return HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+} -+ -+inline u8 hal_ch_offset_to_secondary_ch_offset(u8 ch_offset) -+{ -+ if (ch_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) -+ return SCN; -+ else if (ch_offset == HAL_PRIME_CHNL_OFFSET_LOWER) -+ return SCB; -+ else if (ch_offset == HAL_PRIME_CHNL_OFFSET_UPPER) -+ return SCA; -+ -+ return SCN; -+} -+ -+inline u8 *rtw_set_ie_secondary_ch_offset(u8 *buf, u32 *buf_len, u8 secondary_ch_offset) -+{ -+ return rtw_set_ie(buf, WLAN_EID_SECONDARY_CHANNEL_OFFSET, 1, &secondary_ch_offset, buf_len); -+} -+ -+inline u8 *rtw_set_ie_mesh_ch_switch_parm(u8 *buf, u32 *buf_len, u8 ttl, -+ u8 flags, u16 reason, u16 precedence) -+{ -+ u8 ie_data[6]; -+ -+ ie_data[0] = ttl; -+ ie_data[1] = flags; -+ RTW_PUT_LE16((u8 *)&ie_data[2], reason); -+ RTW_PUT_LE16((u8 *)&ie_data[4], precedence); -+ -+ return rtw_set_ie(buf, 0x118, 6, ie_data, buf_len); -+} -+ -+/*---------------------------------------------------------------------------- -+index: the information element id index, limit is the limit for search -+-----------------------------------------------------------------------------*/ -+u8 *rtw_get_ie(u8 *pbuf, sint index, sint *len, sint limit) -+{ -+ sint tmp, i; -+ u8 *p; -+ if (limit < 1) { -+ return NULL; -+ } -+ -+ p = pbuf; -+ i = 0; -+ *len = 0; -+ while (1) { -+ if (*p == index) { -+ *len = *(p + 1); -+ return p; -+ } else { -+ tmp = *(p + 1); -+ p += (tmp + 2); -+ i += (tmp + 2); -+ } -+ if (i >= limit) -+ break; -+ } -+ return NULL; -+} -+ -+/** -+ * rtw_get_ie_ex - Search specific IE from a series of IEs -+ * @in_ie: Address of IEs to search -+ * @in_len: Length limit from in_ie -+ * @eid: Element ID to match -+ * @oui: OUI to match -+ * @oui_len: OUI length -+ * @ie: If not NULL and the specific IE is found, the IE will be copied to the buf starting from the specific IE -+ * @ielen: If not NULL and the specific IE is found, will set to the length of the entire IE -+ * -+ * Returns: The address of the specific IE found, or NULL -+ */ -+u8 *rtw_get_ie_ex(u8 *in_ie, uint in_len, u8 eid, u8 *oui, u8 oui_len, u8 *ie, uint *ielen) -+{ -+ uint cnt; -+ u8 *target_ie = NULL; -+ -+ -+ if (ielen) -+ *ielen = 0; -+ -+ if (!in_ie || in_len <= 0) -+ return target_ie; -+ -+ cnt = 0; -+ -+ while (cnt < in_len) { -+ if (eid == in_ie[cnt] -+ && (!oui || _rtw_memcmp(&in_ie[cnt + 2], oui, oui_len) == _TRUE)) { -+ target_ie = &in_ie[cnt]; -+ -+ if (ie) -+ _rtw_memcpy(ie, &in_ie[cnt], in_ie[cnt + 1] + 2); -+ -+ if (ielen) -+ *ielen = in_ie[cnt + 1] + 2; -+ -+ break; -+ } else { -+ cnt += in_ie[cnt + 1] + 2; /* goto next */ -+ } -+ -+ } -+ -+ return target_ie; -+} -+ -+/** -+ * rtw_ies_remove_ie - Find matching IEs and remove -+ * @ies: Address of IEs to search -+ * @ies_len: Pointer of length of ies, will update to new length -+ * @offset: The offset to start scarch -+ * @eid: Element ID to match -+ * @oui: OUI to match -+ * @oui_len: OUI length -+ * -+ * Returns: _SUCCESS: ies is updated, _FAIL: not updated -+ */ -+int rtw_ies_remove_ie(u8 *ies, uint *ies_len, uint offset, u8 eid, u8 *oui, u8 oui_len) -+{ -+ int ret = _FAIL; -+ u8 *target_ie; -+ u32 target_ielen; -+ u8 *start; -+ uint search_len; -+ -+ if (!ies || !ies_len || *ies_len <= offset) -+ goto exit; -+ -+ start = ies + offset; -+ search_len = *ies_len - offset; -+ -+ while (1) { -+ target_ie = rtw_get_ie_ex(start, search_len, eid, oui, oui_len, NULL, &target_ielen); -+ if (target_ie && target_ielen) { -+ u8 *remain_ies = target_ie + target_ielen; -+ uint remain_len = search_len - (remain_ies - start); -+ -+ _rtw_memmove(target_ie, remain_ies, remain_len); -+ *ies_len = *ies_len - target_ielen; -+ ret = _SUCCESS; -+ -+ start = target_ie; -+ search_len = remain_len; -+ } else -+ break; -+ } -+exit: -+ return ret; -+} -+ -+void rtw_set_supported_rate(u8 *SupportedRates, uint mode) -+{ -+ -+ _rtw_memset(SupportedRates, 0, NDIS_802_11_LENGTH_RATES_EX); -+ -+ switch (mode) { -+ case WIRELESS_11B: -+ _rtw_memcpy(SupportedRates, WIFI_CCKRATES, IEEE80211_CCK_RATE_LEN); -+ break; -+ -+ case WIRELESS_11G: -+ case WIRELESS_11A: -+ case WIRELESS_11_5N: -+ case WIRELESS_11A_5N: /* Todo: no basic rate for ofdm ? */ -+ case WIRELESS_11_5AC: -+ _rtw_memcpy(SupportedRates, WIFI_OFDMRATES, IEEE80211_NUM_OFDM_RATESLEN); -+ break; -+ -+ case WIRELESS_11BG: -+ case WIRELESS_11G_24N: -+ case WIRELESS_11_24N: -+ case WIRELESS_11BG_24N: -+ _rtw_memcpy(SupportedRates, WIFI_CCKRATES, IEEE80211_CCK_RATE_LEN); -+ _rtw_memcpy(SupportedRates + IEEE80211_CCK_RATE_LEN, WIFI_OFDMRATES, IEEE80211_NUM_OFDM_RATESLEN); -+ break; -+ -+ } -+} -+ -+uint rtw_get_rateset_len(u8 *rateset) -+{ -+ uint i = 0; -+ while (1) { -+ if ((rateset[i]) == 0) -+ break; -+ -+ if (i > 12) -+ break; -+ -+ i++; -+ } -+ return i; -+} -+ -+int rtw_generate_ie(struct registry_priv *pregistrypriv) -+{ -+ u8 wireless_mode; -+ int sz = 0, rateLen; -+ WLAN_BSSID_EX *pdev_network = &pregistrypriv->dev_network; -+ u8 *ie = pdev_network->IEs; -+ -+ -+ /* timestamp will be inserted by hardware */ -+ sz += 8; -+ ie += sz; -+ -+ /* beacon interval : 2bytes */ -+ *(u16 *)ie = cpu_to_le16((u16)pdev_network->Configuration.BeaconPeriod); /* BCN_INTERVAL; */ -+ sz += 2; -+ ie += 2; -+ -+ /* capability info */ -+ *(u16 *)ie = 0; -+ -+ *(u16 *)ie |= cpu_to_le16(cap_IBSS); -+ -+ if (pregistrypriv->preamble == PREAMBLE_SHORT) -+ *(u16 *)ie |= cpu_to_le16(cap_ShortPremble); -+ -+ if (pdev_network->Privacy) -+ *(u16 *)ie |= cpu_to_le16(cap_Privacy); -+ -+ sz += 2; -+ ie += 2; -+ -+ /* SSID */ -+ ie = rtw_set_ie(ie, _SSID_IE_, pdev_network->Ssid.SsidLength, pdev_network->Ssid.Ssid, &sz); -+ -+ /* supported rates */ -+ if (pregistrypriv->wireless_mode == WIRELESS_11ABGN) { -+ if (pdev_network->Configuration.DSConfig > 14) -+ wireless_mode = WIRELESS_11A_5N; -+ else -+ wireless_mode = WIRELESS_11BG_24N; -+ } else if (pregistrypriv->wireless_mode == WIRELESS_MODE_MAX) { /* WIRELESS_11ABGN | WIRELESS_11AC */ -+ if (pdev_network->Configuration.DSConfig > 14) -+ wireless_mode = WIRELESS_11_5AC; -+ else -+ wireless_mode = WIRELESS_11BG_24N; -+ } else -+ wireless_mode = pregistrypriv->wireless_mode; -+ -+ rtw_set_supported_rate(pdev_network->SupportedRates, wireless_mode) ; -+ -+ rateLen = rtw_get_rateset_len(pdev_network->SupportedRates); -+ -+ if (rateLen > 8) { -+ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, 8, pdev_network->SupportedRates, &sz); -+ /* ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (pdev_network->SupportedRates + 8), &sz); */ -+ } else -+ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, rateLen, pdev_network->SupportedRates, &sz); -+ -+ /* DS parameter set */ -+ ie = rtw_set_ie(ie, _DSSET_IE_, 1, (u8 *)&(pdev_network->Configuration.DSConfig), &sz); -+ -+ -+ /* IBSS Parameter Set */ -+ -+ ie = rtw_set_ie(ie, _IBSS_PARA_IE_, 2, (u8 *)&(pdev_network->Configuration.ATIMWindow), &sz); -+ -+ if (rateLen > 8) -+ ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (pdev_network->SupportedRates + 8), &sz); -+ -+#ifdef CONFIG_80211N_HT -+ /* HT Cap. */ -+ if (((pregistrypriv->wireless_mode & WIRELESS_11_5N) || (pregistrypriv->wireless_mode & WIRELESS_11_24N)) -+ && (pregistrypriv->ht_enable == _TRUE)) { -+ /* todo: */ -+ } -+#endif /* CONFIG_80211N_HT */ -+ -+ /* pdev_network->IELength = sz; */ /* update IELength */ -+ -+ -+ /* return _SUCCESS; */ -+ -+ return sz; -+ -+} -+ -+unsigned char *rtw_get_wpa_ie(unsigned char *pie, int *wpa_ie_len, int limit) -+{ -+ int len; -+ u16 val16; -+ unsigned char wpa_oui_type[] = {0x00, 0x50, 0xf2, 0x01}; -+ u8 *pbuf = pie; -+ int limit_new = limit; -+ -+ while (1) { -+ pbuf = rtw_get_ie(pbuf, _WPA_IE_ID_, &len, limit_new); -+ -+ if (pbuf) { -+ -+ /* check if oui matches... */ -+ if (_rtw_memcmp((pbuf + 2), wpa_oui_type, sizeof(wpa_oui_type)) == _FALSE) -+ -+ goto check_next_ie; -+ -+ /* check version... */ -+ _rtw_memcpy((u8 *)&val16, (pbuf + 6), sizeof(val16)); -+ -+ val16 = le16_to_cpu(val16); -+ if (val16 != 0x0001) -+ goto check_next_ie; -+ -+ *wpa_ie_len = *(pbuf + 1); -+ -+ return pbuf; -+ -+ } else { -+ -+ *wpa_ie_len = 0; -+ return NULL; -+ } -+ -+check_next_ie: -+ -+ limit_new = limit - (pbuf - pie) - 2 - len; -+ -+ if (limit_new <= 0) -+ break; -+ -+ pbuf += (2 + len); -+ -+ } -+ -+ *wpa_ie_len = 0; -+ -+ return NULL; -+ -+} -+ -+unsigned char *rtw_get_wpa2_ie(unsigned char *pie, int *rsn_ie_len, int limit) -+{ -+ -+ return rtw_get_ie(pie, _WPA2_IE_ID_, rsn_ie_len, limit); -+ -+} -+ -+int rtw_get_wpa_cipher_suite(u8 *s) -+{ -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_NONE, WPA_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_NONE; -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_WEP40, WPA_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_WEP40; -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_TKIP, WPA_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_TKIP; -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_CCMP, WPA_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_CCMP; -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_WEP104, WPA_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_WEP104; -+ -+ return 0; -+} -+ -+int rtw_get_wpa2_cipher_suite(u8 *s) -+{ -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_NONE, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_NONE; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_WEP40, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_WEP40; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_TKIP, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_TKIP; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_CCMP, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_CCMP; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_WEP104, RSN_SELECTOR_LEN) == _TRUE) -+ return WPA_CIPHER_WEP104; -+ -+ return 0; -+} -+ -+ -+int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x) -+{ -+ int i, ret = _SUCCESS; -+ int left, count; -+ u8 *pos; -+ u8 SUITE_1X[4] = {0x00, 0x50, 0xf2, 1}; -+ -+ if (wpa_ie_len <= 0) { -+ /* No WPA IE - fail silently */ -+ return _FAIL; -+ } -+ -+ -+ if ((*wpa_ie != _WPA_IE_ID_) || (*(wpa_ie + 1) != (u8)(wpa_ie_len - 2)) || -+ (_rtw_memcmp(wpa_ie + 2, RTW_WPA_OUI_TYPE, WPA_SELECTOR_LEN) != _TRUE)) -+ return _FAIL; -+ -+ pos = wpa_ie; -+ -+ pos += 8; -+ left = wpa_ie_len - 8; -+ -+ -+ /* group_cipher */ -+ if (left >= WPA_SELECTOR_LEN) { -+ -+ *group_cipher = rtw_get_wpa_cipher_suite(pos); -+ -+ pos += WPA_SELECTOR_LEN; -+ left -= WPA_SELECTOR_LEN; -+ -+ } else if (left > 0) { -+ -+ return _FAIL; -+ } -+ -+ -+ /* pairwise_cipher */ -+ if (left >= 2) { -+ /* count = le16_to_cpu(*(u16*)pos); */ -+ count = RTW_GET_LE16(pos); -+ pos += 2; -+ left -= 2; -+ -+ if (count == 0 || left < count * WPA_SELECTOR_LEN) { -+ return _FAIL; -+ } -+ -+ for (i = 0; i < count; i++) { -+ *pairwise_cipher |= rtw_get_wpa_cipher_suite(pos); -+ -+ pos += WPA_SELECTOR_LEN; -+ left -= WPA_SELECTOR_LEN; -+ } -+ -+ } else if (left == 1) { -+ return _FAIL; -+ } -+ -+ if (is_8021x) { -+ if (left >= 6) { -+ pos += 2; -+ if (_rtw_memcmp(pos, SUITE_1X, 4) == 1) { -+ *is_8021x = 1; -+ } -+ } -+ } -+ -+ return ret; -+ -+} -+ -+int rtw_parse_wpa2_ie(u8 *rsn_ie, int rsn_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x) -+{ -+ int i, ret = _SUCCESS; -+ int left, count; -+ u8 *pos; -+ u8 SUITE_1X[4] = {0x00, 0x0f, 0xac, 0x01}; -+ -+ if (rsn_ie_len <= 0) { -+ /* No RSN IE - fail silently */ -+ return _FAIL; -+ } -+ -+ -+ if ((*rsn_ie != _WPA2_IE_ID_) || (*(rsn_ie + 1) != (u8)(rsn_ie_len - 2))) -+ return _FAIL; -+ -+ pos = rsn_ie; -+ pos += 4; -+ left = rsn_ie_len - 4; -+ -+ /* group_cipher */ -+ if (left >= RSN_SELECTOR_LEN) { -+ -+ *group_cipher = rtw_get_wpa2_cipher_suite(pos); -+ -+ pos += RSN_SELECTOR_LEN; -+ left -= RSN_SELECTOR_LEN; -+ -+ } else if (left > 0) { -+ return _FAIL; -+ } -+ -+ /* pairwise_cipher */ -+ if (left >= 2) { -+ /* count = le16_to_cpu(*(u16*)pos); */ -+ count = RTW_GET_LE16(pos); -+ pos += 2; -+ left -= 2; -+ -+ if (count == 0 || left < count * RSN_SELECTOR_LEN) { -+ return _FAIL; -+ } -+ -+ for (i = 0; i < count; i++) { -+ *pairwise_cipher |= rtw_get_wpa2_cipher_suite(pos); -+ -+ pos += RSN_SELECTOR_LEN; -+ left -= RSN_SELECTOR_LEN; -+ } -+ -+ } else if (left == 1) { -+ -+ return _FAIL; -+ } -+ -+ if (is_8021x) { -+ if (left >= 6) { -+ pos += 2; -+ if (_rtw_memcmp(pos, SUITE_1X, 4) == 1) { -+ *is_8021x = 1; -+ } -+ } -+ } -+ -+ return ret; -+ -+} -+ -+/* #ifdef CONFIG_WAPI_SUPPORT */ -+int rtw_get_wapi_ie(u8 *in_ie, uint in_len, u8 *wapi_ie, u16 *wapi_len) -+{ -+ int len = 0; -+ u8 authmode, i; -+ uint cnt; -+ u8 wapi_oui1[4] = {0x0, 0x14, 0x72, 0x01}; -+ u8 wapi_oui2[4] = {0x0, 0x14, 0x72, 0x02}; -+ -+ -+ if (wapi_len) -+ *wapi_len = 0; -+ -+ if (!in_ie || in_len <= 0) -+ return len; -+ -+ cnt = (_TIMESTAMP_ + _BEACON_ITERVAL_ + _CAPABILITY_); -+ -+ while (cnt < in_len) { -+ authmode = in_ie[cnt]; -+ -+ /* if(authmode==_WAPI_IE_) */ -+ if (authmode == _WAPI_IE_ && (_rtw_memcmp(&in_ie[cnt + 6], wapi_oui1, 4) == _TRUE || -+ _rtw_memcmp(&in_ie[cnt + 6], wapi_oui2, 4) == _TRUE)) { -+ if (wapi_ie) -+ _rtw_memcpy(wapi_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); -+ -+ if (wapi_len) -+ *wapi_len = in_ie[cnt + 1] + 2; -+ -+ cnt += in_ie[cnt + 1] + 2; /* get next */ -+ } else { -+ cnt += in_ie[cnt + 1] + 2; /* get next */ -+ } -+ } -+ -+ if (wapi_len) -+ len = *wapi_len; -+ -+ -+ return len; -+ -+} -+/* #endif */ -+ -+int rtw_get_sec_ie(u8 *in_ie, uint in_len, u8 *rsn_ie, u16 *rsn_len, u8 *wpa_ie, u16 *wpa_len) -+{ -+ u8 authmode, sec_idx, i; -+ u8 wpa_oui[4] = {0x0, 0x50, 0xf2, 0x01}; -+ uint cnt; -+ -+ -+ /* Search required WPA or WPA2 IE and copy to sec_ie[ ] */ -+ -+ cnt = (_TIMESTAMP_ + _BEACON_ITERVAL_ + _CAPABILITY_); -+ -+ sec_idx = 0; -+ -+ while (cnt < in_len) { -+ authmode = in_ie[cnt]; -+ -+ if ((authmode == _WPA_IE_ID_) && (_rtw_memcmp(&in_ie[cnt + 2], &wpa_oui[0], 4) == _TRUE)) { -+ -+ if (wpa_ie) -+ _rtw_memcpy(wpa_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); -+ -+ *wpa_len = in_ie[cnt + 1] + 2; -+ cnt += in_ie[cnt + 1] + 2; /* get next */ -+ } else { -+ if (authmode == _WPA2_IE_ID_) { -+ -+ if (rsn_ie) -+ _rtw_memcpy(rsn_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); -+ -+ *rsn_len = in_ie[cnt + 1] + 2; -+ cnt += in_ie[cnt + 1] + 2; /* get next */ -+ } else { -+ cnt += in_ie[cnt + 1] + 2; /* get next */ -+ } -+ } -+ -+ } -+ -+ -+ return *rsn_len + *wpa_len; -+ -+} -+ -+u8 rtw_is_wps_ie(u8 *ie_ptr, uint *wps_ielen) -+{ -+ u8 match = _FALSE; -+ u8 eid, wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; -+ -+ if (ie_ptr == NULL) -+ return match; -+ -+ eid = ie_ptr[0]; -+ -+ if ((eid == _WPA_IE_ID_) && (_rtw_memcmp(&ie_ptr[2], wps_oui, 4) == _TRUE)) { -+ /* RTW_INFO("==> found WPS_IE.....\n"); */ -+ *wps_ielen = ie_ptr[1] + 2; -+ match = _TRUE; -+ } -+ return match; -+} -+ -+u8 *rtw_get_wps_ie_from_scan_queue(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen, u8 frame_type) -+{ -+ u8 *wps = NULL; -+ -+ RTW_INFO("[%s] frame_type = %d\n", __FUNCTION__, frame_type); -+ switch (frame_type) { -+ case 1: -+ case 3: { -+ /* Beacon or Probe Response */ -+ wps = rtw_get_wps_ie(in_ie + _PROBERSP_IE_OFFSET_, in_len - _PROBERSP_IE_OFFSET_, wps_ie, wps_ielen); -+ break; -+ } -+ case 2: { -+ /* Probe Request */ -+ wps = rtw_get_wps_ie(in_ie + _PROBEREQ_IE_OFFSET_ , in_len - _PROBEREQ_IE_OFFSET_ , wps_ie, wps_ielen); -+ break; -+ } -+ } -+ return wps; -+} -+ -+/** -+ * rtw_get_wps_ie - Search WPS IE from a series of IEs -+ * @in_ie: Address of IEs to search -+ * @in_len: Length limit from in_ie -+ * @wps_ie: If not NULL and WPS IE is found, WPS IE will be copied to the buf starting from wps_ie -+ * @wps_ielen: If not NULL and WPS IE is found, will set to the length of the entire WPS IE -+ * -+ * Returns: The address of the WPS IE found, or NULL -+ */ -+u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen) -+{ -+ uint cnt; -+ u8 *wpsie_ptr = NULL; -+ u8 eid, wps_oui[4] = {0x00, 0x50, 0xf2, 0x04}; -+ -+ if (wps_ielen) -+ *wps_ielen = 0; -+ -+ if (!in_ie) { -+ rtw_warn_on(1); -+ return wpsie_ptr; -+ } -+ -+ if (in_len <= 0) -+ return wpsie_ptr; -+ -+ cnt = 0; -+ -+ while (cnt + 1 + 4 < in_len) { -+ eid = in_ie[cnt]; -+ -+ if (cnt + 1 + 4 >= MAX_IE_SZ) { -+ rtw_warn_on(1); -+ return NULL; -+ } -+ -+ if (eid == WLAN_EID_VENDOR_SPECIFIC && _rtw_memcmp(&in_ie[cnt + 2], wps_oui, 4) == _TRUE) { -+ wpsie_ptr = in_ie + cnt; -+ -+ if (wps_ie) -+ _rtw_memcpy(wps_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); -+ -+ if (wps_ielen) -+ *wps_ielen = in_ie[cnt + 1] + 2; -+ -+ break; -+ } else -+ cnt += in_ie[cnt + 1] + 2; -+ -+ } -+ -+ return wpsie_ptr; -+} -+ -+/** -+ * rtw_get_wps_attr - Search a specific WPS attribute from a given WPS IE -+ * @wps_ie: Address of WPS IE to search -+ * @wps_ielen: Length limit from wps_ie -+ * @target_attr_id: The attribute ID of WPS attribute to search -+ * @buf_attr: If not NULL and the WPS attribute is found, WPS attribute will be copied to the buf starting from buf_attr -+ * @len_attr: If not NULL and the WPS attribute is found, will set to the length of the entire WPS attribute -+ * -+ * Returns: the address of the specific WPS attribute found, or NULL -+ */ -+u8 *rtw_get_wps_attr(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 *buf_attr, u32 *len_attr) -+{ -+ u8 *attr_ptr = NULL; -+ u8 *target_attr_ptr = NULL; -+ u8 wps_oui[4] = {0x00, 0x50, 0xF2, 0x04}; -+ -+ if (len_attr) -+ *len_attr = 0; -+ -+ if ((wps_ie[0] != _VENDOR_SPECIFIC_IE_) || -+ (_rtw_memcmp(wps_ie + 2, wps_oui , 4) != _TRUE)) -+ return attr_ptr; -+ -+ /* 6 = 1(Element ID) + 1(Length) + 4(WPS OUI) */ -+ attr_ptr = wps_ie + 6; /* goto first attr */ -+ -+ while (attr_ptr - wps_ie < wps_ielen) { -+ /* 4 = 2(Attribute ID) + 2(Length) */ -+ u16 attr_id = RTW_GET_BE16(attr_ptr); -+ u16 attr_data_len = RTW_GET_BE16(attr_ptr + 2); -+ u16 attr_len = attr_data_len + 4; -+ -+ /* RTW_INFO("%s attr_ptr:%p, id:%u, length:%u\n", __FUNCTION__, attr_ptr, attr_id, attr_data_len); */ -+ if (attr_id == target_attr_id) { -+ target_attr_ptr = attr_ptr; -+ -+ if (buf_attr) -+ _rtw_memcpy(buf_attr, attr_ptr, attr_len); -+ -+ if (len_attr) -+ *len_attr = attr_len; -+ -+ break; -+ } else { -+ attr_ptr += attr_len; /* goto next */ -+ } -+ -+ } -+ -+ return target_attr_ptr; -+} -+ -+/** -+ * rtw_get_wps_attr_content - Search a specific WPS attribute content from a given WPS IE -+ * @wps_ie: Address of WPS IE to search -+ * @wps_ielen: Length limit from wps_ie -+ * @target_attr_id: The attribute ID of WPS attribute to search -+ * @buf_content: If not NULL and the WPS attribute is found, WPS attribute content will be copied to the buf starting from buf_content -+ * @len_content: If not NULL and the WPS attribute is found, will set to the length of the WPS attribute content -+ * -+ * Returns: the address of the specific WPS attribute content found, or NULL -+ */ -+u8 *rtw_get_wps_attr_content(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 *buf_content, uint *len_content) -+{ -+ u8 *attr_ptr; -+ u32 attr_len; -+ -+ if (len_content) -+ *len_content = 0; -+ -+ attr_ptr = rtw_get_wps_attr(wps_ie, wps_ielen, target_attr_id, NULL, &attr_len); -+ -+ if (attr_ptr && attr_len) { -+ if (buf_content) -+ _rtw_memcpy(buf_content, attr_ptr + 4, attr_len - 4); -+ -+ if (len_content) -+ *len_content = attr_len - 4; -+ -+ return attr_ptr + 4; -+ } -+ -+ return NULL; -+} -+ -+static int rtw_ieee802_11_parse_vendor_specific(u8 *pos, uint elen, -+ struct rtw_ieee802_11_elems *elems, -+ int show_errors) -+{ -+ unsigned int oui; -+ -+ /* first 3 bytes in vendor specific information element are the IEEE -+ * OUI of the vendor. The following byte is used a vendor specific -+ * sub-type. */ -+ if (elen < 4) { -+ if (show_errors) { -+ RTW_INFO("short vendor specific " -+ "information element ignored (len=%lu)\n", -+ (unsigned long) elen); -+ } -+ return -1; -+ } -+ -+ oui = RTW_GET_BE24(pos); -+ switch (oui) { -+ case OUI_MICROSOFT: -+ /* Microsoft/Wi-Fi information elements are further typed and -+ * subtyped */ -+ switch (pos[3]) { -+ case 1: -+ /* Microsoft OUI (00:50:F2) with OUI Type 1: -+ * real WPA information element */ -+ elems->wpa_ie = pos; -+ elems->wpa_ie_len = elen; -+ break; -+ case WME_OUI_TYPE: /* this is a Wi-Fi WME info. element */ -+ if (elen < 5) { -+ RTW_DBG("short WME " -+ "information element ignored " -+ "(len=%lu)\n", -+ (unsigned long) elen); -+ return -1; -+ } -+ switch (pos[4]) { -+ case WME_OUI_SUBTYPE_INFORMATION_ELEMENT: -+ case WME_OUI_SUBTYPE_PARAMETER_ELEMENT: -+ elems->wme = pos; -+ elems->wme_len = elen; -+ break; -+ case WME_OUI_SUBTYPE_TSPEC_ELEMENT: -+ elems->wme_tspec = pos; -+ elems->wme_tspec_len = elen; -+ break; -+ default: -+ RTW_DBG("unknown WME " -+ "information element ignored " -+ "(subtype=%d len=%lu)\n", -+ pos[4], (unsigned long) elen); -+ return -1; -+ } -+ break; -+ case 4: -+ /* Wi-Fi Protected Setup (WPS) IE */ -+ elems->wps_ie = pos; -+ elems->wps_ie_len = elen; -+ break; -+ default: -+ RTW_DBG("Unknown Microsoft " -+ "information element ignored " -+ "(type=%d len=%lu)\n", -+ pos[3], (unsigned long) elen); -+ return -1; -+ } -+ break; -+ -+ case OUI_BROADCOM: -+ switch (pos[3]) { -+ case VENDOR_HT_CAPAB_OUI_TYPE: -+ elems->vendor_ht_cap = pos; -+ elems->vendor_ht_cap_len = elen; -+ break; -+ default: -+ RTW_DBG("Unknown Broadcom " -+ "information element ignored " -+ "(type=%d len=%lu)\n", -+ pos[3], (unsigned long) elen); -+ return -1; -+ } -+ break; -+ -+ default: -+ RTW_DBG("unknown vendor specific information " -+ "element ignored (vendor OUI %02x:%02x:%02x " -+ "len=%lu)\n", -+ pos[0], pos[1], pos[2], (unsigned long) elen); -+ return -1; -+ } -+ -+ return 0; -+ -+} -+ -+/** -+ * ieee802_11_parse_elems - Parse information elements in management frames -+ * @start: Pointer to the start of IEs -+ * @len: Length of IE buffer in octets -+ * @elems: Data structure for parsed elements -+ * @show_errors: Whether to show parsing errors in debug log -+ * Returns: Parsing result -+ */ -+ParseRes rtw_ieee802_11_parse_elems(u8 *start, uint len, -+ struct rtw_ieee802_11_elems *elems, -+ int show_errors) -+{ -+ uint left = len; -+ u8 *pos = start; -+ int unknown = 0; -+ -+ _rtw_memset(elems, 0, sizeof(*elems)); -+ -+ while (left >= 2) { -+ u8 id, elen; -+ -+ id = *pos++; -+ elen = *pos++; -+ left -= 2; -+ -+ if (elen > left) { -+ if (show_errors) { -+ RTW_INFO("IEEE 802.11 element " -+ "parse failed (id=%d elen=%d " -+ "left=%lu)\n", -+ id, elen, (unsigned long) left); -+ } -+ return ParseFailed; -+ } -+ -+ switch (id) { -+ case WLAN_EID_SSID: -+ elems->ssid = pos; -+ elems->ssid_len = elen; -+ break; -+ case WLAN_EID_SUPP_RATES: -+ elems->supp_rates = pos; -+ elems->supp_rates_len = elen; -+ break; -+ case WLAN_EID_FH_PARAMS: -+ elems->fh_params = pos; -+ elems->fh_params_len = elen; -+ break; -+ case WLAN_EID_DS_PARAMS: -+ elems->ds_params = pos; -+ elems->ds_params_len = elen; -+ break; -+ case WLAN_EID_CF_PARAMS: -+ elems->cf_params = pos; -+ elems->cf_params_len = elen; -+ break; -+ case WLAN_EID_TIM: -+ elems->tim = pos; -+ elems->tim_len = elen; -+ break; -+ case WLAN_EID_IBSS_PARAMS: -+ elems->ibss_params = pos; -+ elems->ibss_params_len = elen; -+ break; -+ case WLAN_EID_CHALLENGE: -+ elems->challenge = pos; -+ elems->challenge_len = elen; -+ break; -+ case WLAN_EID_ERP_INFO: -+ elems->erp_info = pos; -+ elems->erp_info_len = elen; -+ break; -+ case WLAN_EID_EXT_SUPP_RATES: -+ elems->ext_supp_rates = pos; -+ elems->ext_supp_rates_len = elen; -+ break; -+ case WLAN_EID_VENDOR_SPECIFIC: -+ if (rtw_ieee802_11_parse_vendor_specific(pos, elen, -+ elems, -+ show_errors)) -+ unknown++; -+ break; -+ case WLAN_EID_RSN: -+ elems->rsn_ie = pos; -+ elems->rsn_ie_len = elen; -+ break; -+ case WLAN_EID_PWR_CAPABILITY: -+ elems->power_cap = pos; -+ elems->power_cap_len = elen; -+ break; -+ case WLAN_EID_SUPPORTED_CHANNELS: -+ elems->supp_channels = pos; -+ elems->supp_channels_len = elen; -+ break; -+ case WLAN_EID_MOBILITY_DOMAIN: -+ elems->mdie = pos; -+ elems->mdie_len = elen; -+ break; -+ case WLAN_EID_FAST_BSS_TRANSITION: -+ elems->ftie = pos; -+ elems->ftie_len = elen; -+ break; -+ case WLAN_EID_TIMEOUT_INTERVAL: -+ elems->timeout_int = pos; -+ elems->timeout_int_len = elen; -+ break; -+ case WLAN_EID_HT_CAP: -+ elems->ht_capabilities = pos; -+ elems->ht_capabilities_len = elen; -+ break; -+ case WLAN_EID_HT_OPERATION: -+ elems->ht_operation = pos; -+ elems->ht_operation_len = elen; -+ break; -+ case WLAN_EID_VHT_CAPABILITY: -+ elems->vht_capabilities = pos; -+ elems->vht_capabilities_len = elen; -+ break; -+ case WLAN_EID_VHT_OPERATION: -+ elems->vht_operation = pos; -+ elems->vht_operation_len = elen; -+ break; -+ case WLAN_EID_VHT_OP_MODE_NOTIFY: -+ elems->vht_op_mode_notify = pos; -+ elems->vht_op_mode_notify_len = elen; -+ break; -+ default: -+ unknown++; -+ if (!show_errors) -+ break; -+ RTW_DBG("IEEE 802.11 element parse " -+ "ignored unknown element (id=%d elen=%d)\n", -+ id, elen); -+ break; -+ } -+ -+ left -= elen; -+ pos += elen; -+ } -+ -+ if (left) -+ return ParseFailed; -+ -+ return unknown ? ParseUnknown : ParseOK; -+ -+} -+ -+static u8 key_char2num(u8 ch); -+static u8 key_char2num(u8 ch) -+{ -+ if ((ch >= '0') && (ch <= '9')) -+ return ch - '0'; -+ else if ((ch >= 'a') && (ch <= 'f')) -+ return ch - 'a' + 10; -+ else if ((ch >= 'A') && (ch <= 'F')) -+ return ch - 'A' + 10; -+ else -+ return 0xff; -+} -+ -+u8 str_2char2num(u8 hch, u8 lch); -+u8 str_2char2num(u8 hch, u8 lch) -+{ -+ return (key_char2num(hch) * 10) + key_char2num(lch); -+} -+ -+u8 key_2char2num(u8 hch, u8 lch); -+u8 key_2char2num(u8 hch, u8 lch) -+{ -+ return (key_char2num(hch) << 4) | key_char2num(lch); -+} -+ -+void macstr2num(u8 *dst, u8 *src); -+void macstr2num(u8 *dst, u8 *src) -+{ -+ int jj, kk; -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) -+ dst[jj] = key_2char2num(src[kk], src[kk + 1]); -+} -+ -+u8 convert_ip_addr(u8 hch, u8 mch, u8 lch) -+{ -+ return (key_char2num(hch) * 100) + (key_char2num(mch) * 10) + key_char2num(lch); -+} -+ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+#define MAC_ADDRESS_LEN 12 -+ -+int rtw_get_mac_addr_intel(unsigned char *buf) -+{ -+ int ret = 0; -+ int i; -+ struct file *fp = NULL; -+ mm_segment_t oldfs; -+ unsigned char c_mac[MAC_ADDRESS_LEN]; -+ char fname[] = "/config/wifi/mac.txt"; -+ int jj, kk; -+ -+ RTW_INFO("%s Enter\n", __FUNCTION__); -+ -+ ret = rtw_retrieve_from_file(fname, c_mac, MAC_ADDRESS_LEN); -+ if (ret < MAC_ADDRESS_LEN) -+ return -1; -+ -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 2) -+ buf[jj] = key_2char2num(c_mac[kk], c_mac[kk + 1]); -+ -+ RTW_INFO("%s: read from file mac address: "MAC_FMT"\n", -+ __FUNCTION__, MAC_ARG(buf)); -+ -+ return 0; -+} -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+ -+/* -+ * Description: -+ * rtw_check_invalid_mac_address: -+ * This is only used for checking mac address valid or not. -+ * -+ * Input: -+ * adapter: mac_address pointer. -+ * check_local_bit: check locally bit or not. -+ * -+ * Output: -+ * _TRUE: The mac address is invalid. -+ * _FALSE: The mac address is valid. -+ * -+ * Auther: Isaac.Li -+ */ -+u8 rtw_check_invalid_mac_address(u8 *mac_addr, u8 check_local_bit) -+{ -+ u8 null_mac_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; -+ u8 multi_mac_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 res = _FALSE; -+ -+ if (_rtw_memcmp(mac_addr, null_mac_addr, ETH_ALEN)) { -+ res = _TRUE; -+ goto func_exit; -+ } -+ -+ if (_rtw_memcmp(mac_addr, multi_mac_addr, ETH_ALEN)) { -+ res = _TRUE; -+ goto func_exit; -+ } -+ -+ if (mac_addr[0] & BIT0) { -+ res = _TRUE; -+ goto func_exit; -+ } -+ -+ if (check_local_bit == _TRUE) { -+ if (mac_addr[0] & BIT1) { -+ res = _TRUE; -+ goto func_exit; -+ } -+ } -+ -+func_exit: -+ return res; -+} -+ -+extern char *rtw_initmac; -+/** -+ * rtw_macaddr_cfg - Decide the mac address used -+ * @out: buf to store mac address decided -+ * @hw_mac_addr: mac address from efuse/epprom -+ */ -+void rtw_macaddr_cfg(u8 *out, const u8 *hw_mac_addr) -+{ -+#define DEFAULT_RANDOM_MACADDR 1 -+ u8 mac[ETH_ALEN]; -+ -+ if (out == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ /* Users specify the mac address */ -+ if (rtw_initmac) { -+ int jj, kk; -+ -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) -+ mac[jj] = key_2char2num(rtw_initmac[kk], rtw_initmac[kk + 1]); -+ -+ goto err_chk; -+ } -+ -+ /* platform specified */ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ if (rtw_get_mac_addr_intel(mac) == 0) -+ goto err_chk; -+#endif -+ -+ /* Use the mac address stored in the Efuse */ -+ if (hw_mac_addr) { -+ _rtw_memcpy(mac, hw_mac_addr, ETH_ALEN); -+ goto err_chk; -+ } -+ -+err_chk: -+ if (rtw_check_invalid_mac_address(mac, _TRUE) == _TRUE) { -+#if DEFAULT_RANDOM_MACADDR -+ RTW_ERR("invalid mac addr:"MAC_FMT", assign random MAC\n", MAC_ARG(mac)); -+ *((u32 *)(&mac[2])) = rtw_random32(); -+ mac[0] = 0x00; -+ mac[1] = 0xe0; -+ mac[2] = 0x4c; -+#else -+ RTW_ERR("invalid mac addr:"MAC_FMT", assign default one\n", MAC_ARG(mac)); -+ mac[0] = 0x00; -+ mac[1] = 0xe0; -+ mac[2] = 0x4c; -+ mac[3] = 0x87; -+ mac[4] = 0x00; -+ mac[5] = 0x00; -+#endif -+ } -+ -+ _rtw_memcpy(out, mac, ETH_ALEN); -+ RTW_INFO("%s mac addr:"MAC_FMT"\n", __func__, MAC_ARG(out)); -+} -+ -+#ifdef CONFIG_80211N_HT -+void dump_ht_cap_ie_content(void *sel, u8 *buf, u32 buf_len) -+{ -+ if (buf_len != 26) { -+ RTW_PRINT_SEL(sel, "Invalid HT capability IE len:%d != %d\n", buf_len, 26); -+ return; -+ } -+ -+ RTW_PRINT_SEL(sel, "HT Capabilities Info:%02x%02x\n", *(buf), *(buf + 1)); -+ RTW_PRINT_SEL(sel, "A-MPDU Parameters:"HT_AMPDU_PARA_FMT"\n" -+ , HT_AMPDU_PARA_ARG(HT_CAP_ELE_AMPDU_PARA(buf))); -+ RTW_PRINT_SEL(sel, "Supported MCS Set:"HT_SUP_MCS_SET_FMT"\n" -+ , HT_SUP_MCS_SET_ARG(HT_CAP_ELE_SUP_MCS_SET(buf))); -+} -+ -+void dump_ht_cap_ie(void *sel, u8 *ie, u32 ie_len) -+{ -+ u8 *pos = (u8 *)ie; -+ u16 id; -+ u16 len; -+ -+ u8 *ht_cap_ie; -+ sint ht_cap_ielen; -+ -+ ht_cap_ie = rtw_get_ie(ie, _HT_CAPABILITY_IE_, &ht_cap_ielen, ie_len); -+ if (!ie || ht_cap_ie != ie) -+ return; -+ -+ dump_ht_cap_ie_content(sel, ht_cap_ie + 2, ht_cap_ielen); -+} -+#endif /* CONFIG_80211N_HT */ -+ -+void dump_ies(void *sel, u8 *buf, u32 buf_len) -+{ -+ u8 *pos = (u8 *)buf; -+ u8 id, len; -+ -+ while (pos - buf + 1 < buf_len) { -+ id = *pos; -+ len = *(pos + 1); -+ -+ RTW_PRINT_SEL(sel, "%s ID:%u, LEN:%u\n", __FUNCTION__, id, len); -+#ifdef CONFIG_80211N_HT -+ dump_ht_cap_ie(sel, pos, len + 2); -+#endif -+ dump_wps_ie(sel, pos, len + 2); -+#ifdef CONFIG_P2P -+ dump_p2p_ie(sel, pos, len + 2); -+#ifdef CONFIG_WFD -+ dump_wfd_ie(sel, pos, len + 2); -+#endif -+#endif -+ -+ pos += (2 + len); -+ } -+} -+ -+void dump_wps_ie(void *sel, u8 *ie, u32 ie_len) -+{ -+ u8 *pos = (u8 *)ie; -+ u16 id; -+ u16 len; -+ -+ u8 *wps_ie; -+ uint wps_ielen; -+ -+ wps_ie = rtw_get_wps_ie(ie, ie_len, NULL, &wps_ielen); -+ if (wps_ie != ie || wps_ielen == 0) -+ return; -+ -+ pos += 6; -+ while (pos - ie + 4 <= ie_len) { -+ id = RTW_GET_BE16(pos); -+ len = RTW_GET_BE16(pos + 2); -+ -+ RTW_PRINT_SEL(sel, "%s ID:0x%04x, LEN:%u%s\n", __func__, id, len -+ , ((pos - ie + 4 + len) <= ie_len) ? "" : "(exceed ie_len)"); -+ -+ pos += (4 + len); -+ } -+} -+ -+/** -+ * rtw_ies_get_chbw - get operation ch, bw, offset from IEs of BSS. -+ * @ies: pointer of the first tlv IE -+ * @ies_len: length of @ies -+ * @ch: pointer of ch, used as output -+ * @bw: pointer of bw, used as output -+ * @offset: pointer of offset, used as output -+ */ -+void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset) -+{ -+ u8 *p; -+ int ie_len; -+ -+ *ch = 0; -+ *bw = CHANNEL_WIDTH_20; -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ p = rtw_get_ie(ies, _DSSET_IE_, &ie_len, ies_len); -+ if (p && ie_len > 0) -+ *ch = *(p + 2); -+ -+#ifdef CONFIG_80211N_HT -+ { -+ u8 *ht_cap_ie, *ht_op_ie; -+ int ht_cap_ielen, ht_op_ielen; -+ -+ ht_cap_ie = rtw_get_ie(ies, EID_HTCapability, &ht_cap_ielen, ies_len); -+ if (ht_cap_ie && ht_cap_ielen) { -+ if (GET_HT_CAP_ELE_CHL_WIDTH(ht_cap_ie + 2)) -+ *bw = CHANNEL_WIDTH_40; -+ } -+ -+ ht_op_ie = rtw_get_ie(ies, EID_HTInfo, &ht_op_ielen, ies_len); -+ if (ht_op_ie && ht_op_ielen) { -+ if (*ch == 0) -+ *ch = GET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2); -+ else if (*ch != 0 && *ch != GET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2)) { -+ RTW_INFO("%s ch inconsistent, DSSS:%u, HT primary:%u\n" -+ , __func__, *ch, GET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2)); -+ } -+ -+ if (!GET_HT_OP_ELE_STA_CHL_WIDTH(ht_op_ie + 2)) -+ *bw = CHANNEL_WIDTH_20; -+ -+ if (*bw == CHANNEL_WIDTH_40) { -+ switch (GET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2)) { -+ case SCA: -+ *offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ case SCB: -+ *offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ } -+ } -+ } -+ } -+#endif /* CONFIG_80211N_HT */ -+#ifdef CONFIG_80211AC_VHT -+ { -+ u8 *vht_op_ie; -+ int vht_op_ielen; -+ -+ vht_op_ie = rtw_get_ie(ies, EID_VHTOperation, &vht_op_ielen, ies_len); -+ if (vht_op_ie && vht_op_ielen) { -+ /* enable VHT 80 before check enable HT40 or not */ -+ if (GET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2) >= 1) { -+ /* for HT40, enable VHT80 */ -+ if (*bw == CHANNEL_WIDTH_40) -+ *bw = CHANNEL_WIDTH_80; -+ /* for HT20, enable VHT20 */ -+ else if (*bw == CHANNEL_WIDTH_20) { -+ /* modify VHT OP IE */ -+ SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2, 0); -+ /* reset to 0 for VHT20 */ -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op_ie + 2, 0); -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op_ie + 2, 0); -+ } -+ } else { -+ /* -+ VHT OP WIDTH = 0 under HT20/HT40 -+ if REGSTY_BW_5G(pregistrypriv) < CHANNEL_WIDTH_80 in rtw_build_vht_operation_ie -+ */ -+ } -+ } -+ } -+#endif -+} -+ -+void rtw_bss_get_chbw(WLAN_BSSID_EX *bss, u8 *ch, u8 *bw, u8 *offset) -+{ -+ rtw_ies_get_chbw(bss->IEs + sizeof(NDIS_802_11_FIXED_IEs) -+ , bss->IELength - sizeof(NDIS_802_11_FIXED_IEs) -+ , ch, bw, offset); -+ -+ if (*ch == 0) -+ *ch = bss->Configuration.DSConfig; -+ else if (*ch != bss->Configuration.DSConfig) { -+ RTW_INFO("inconsistent ch - ies:%u bss->Configuration.DSConfig:%u\n" -+ , *ch, bss->Configuration.DSConfig); -+ *ch = bss->Configuration.DSConfig; -+ rtw_warn_on(1); -+ } -+} -+ -+/** -+ * rtw_is_chbw_grouped - test if the two ch settings can be grouped together -+ * @ch_a: ch of set a -+ * @bw_a: bw of set a -+ * @offset_a: offset of set a -+ * @ch_b: ch of set b -+ * @bw_b: bw of set b -+ * @offset_b: offset of set b -+ */ -+bool rtw_is_chbw_grouped(u8 ch_a, u8 bw_a, u8 offset_a -+ , u8 ch_b, u8 bw_b, u8 offset_b) -+{ -+ bool is_grouped = _FALSE; -+ -+ if (ch_a != ch_b) { -+ /* ch is different */ -+ goto exit; -+ } else if ((bw_a == CHANNEL_WIDTH_40 || bw_a == CHANNEL_WIDTH_80) -+ && (bw_b == CHANNEL_WIDTH_40 || bw_b == CHANNEL_WIDTH_80) -+ ) { -+ if (offset_a != offset_b) -+ goto exit; -+ } -+ -+ is_grouped = _TRUE; -+ -+exit: -+ return is_grouped; -+} -+ -+/** -+ * rtw_sync_chbw - obey g_ch, adjust g_bw, g_offset, bw, offset -+ * @req_ch: pointer of the request ch, may be modified further -+ * @req_bw: pointer of the request bw, may be modified further -+ * @req_offset: pointer of the request offset, may be modified further -+ * @g_ch: pointer of the ongoing group ch -+ * @g_bw: pointer of the ongoing group bw, may be modified further -+ * @g_offset: pointer of the ongoing group offset, may be modified further -+ */ -+void rtw_sync_chbw(u8 *req_ch, u8 *req_bw, u8 *req_offset -+ , u8 *g_ch, u8 *g_bw, u8 *g_offset) -+{ -+ -+ *req_ch = *g_ch; -+ -+ if (*req_bw == CHANNEL_WIDTH_80 && *g_ch <= 14) { -+ /*2.4G ch, downgrade to 40Mhz */ -+ *req_bw = CHANNEL_WIDTH_40; -+ } -+ -+ switch (*req_bw) { -+ case CHANNEL_WIDTH_80: -+ if (*g_bw == CHANNEL_WIDTH_40 || *g_bw == CHANNEL_WIDTH_80) -+ *req_offset = *g_offset; -+ else if (*g_bw == CHANNEL_WIDTH_20) -+ *req_offset = rtw_get_offset_by_ch(*req_ch); -+ -+ if (*req_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) { -+ RTW_ERR("%s req 80MHz BW without offset, down to 20MHz\n", __func__); -+ rtw_warn_on(1); -+ *req_bw = CHANNEL_WIDTH_20; -+ } -+ break; -+ case CHANNEL_WIDTH_40: -+ if (*g_bw == CHANNEL_WIDTH_40 || *g_bw == CHANNEL_WIDTH_80) -+ *req_offset = *g_offset; -+ else if (*g_bw == CHANNEL_WIDTH_20) -+ *req_offset = rtw_get_offset_by_ch(*req_ch); -+ -+ if (*req_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) { -+ RTW_ERR("%s req 40MHz BW without offset, down to 20MHz\n", __func__); -+ rtw_warn_on(1); -+ *req_bw = CHANNEL_WIDTH_20; -+ } -+ break; -+ case CHANNEL_WIDTH_20: -+ *req_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ default: -+ RTW_ERR("%s req unsupported BW:%u\n", __func__, *req_bw); -+ rtw_warn_on(1); -+ } -+ -+ if (*req_bw > *g_bw) { -+ *g_bw = *req_bw; -+ *g_offset = *req_offset; -+ } -+} -+ -+/** -+ * rtw_get_p2p_merged_len - Get merged ie length from muitiple p2p ies. -+ * @in_ie: Pointer of the first p2p ie -+ * @in_len: Total len of muiltiple p2p ies -+ * Returns: Length of merged p2p ie length -+ */ -+u32 rtw_get_p2p_merged_ies_len(u8 *in_ie, u32 in_len) -+{ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 OUI[4] = { 0x50, 0x6f, 0x9a, 0x09 }; -+ int i = 0; -+ int j = 0, len = 0; -+ -+ while (i < in_len) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(in_ie + i); -+ -+ if (pIE->ElementID == _VENDOR_SPECIFIC_IE_ && _rtw_memcmp(pIE->data, OUI, 4)) { -+ len += pIE->Length - 4; /* 4 is P2P OUI length, don't count it in this loop */ -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ return len + 4; /* Append P2P OUI length at last. */ -+} -+ -+/** -+ * rtw_p2p_merge_ies - Merge muitiple p2p ies into one -+ * @in_ie: Pointer of the first p2p ie -+ * @in_len: Total len of muiltiple p2p ies -+ * @merge_ie: Pointer of merged ie -+ * Returns: Length of merged p2p ie -+ */ -+int rtw_p2p_merge_ies(u8 *in_ie, u32 in_len, u8 *merge_ie) -+{ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 len = 0; -+ u8 OUI[4] = { 0x50, 0x6f, 0x9a, 0x09 }; -+ u8 ELOUI[6] = { 0xDD, 0x00, 0x50, 0x6f, 0x9a, 0x09 }; /* EID;Len;OUI, Len would copy at the end of function */ -+ int i = 0; -+ -+ if (merge_ie != NULL) { -+ /* Set first P2P OUI */ -+ _rtw_memcpy(merge_ie, ELOUI, 6); -+ merge_ie += 6; -+ -+ while (i < in_len) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(in_ie + i); -+ -+ /* Take out the rest of P2P OUIs */ -+ if (pIE->ElementID == _VENDOR_SPECIFIC_IE_ && _rtw_memcmp(pIE->data, OUI, 4)) { -+ _rtw_memcpy(merge_ie, pIE->data + 4, pIE->Length - 4); -+ len += pIE->Length - 4; -+ merge_ie += pIE->Length - 4; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ return len + 4; /* 4 is for P2P OUI */ -+ -+ } -+ -+ return 0; -+} -+ -+void dump_p2p_ie(void *sel, u8 *ie, u32 ie_len) -+{ -+ u8 *pos = (u8 *)ie; -+ u8 id; -+ u16 len; -+ -+ u8 *p2p_ie; -+ uint p2p_ielen; -+ -+ p2p_ie = rtw_get_p2p_ie(ie, ie_len, NULL, &p2p_ielen); -+ if (p2p_ie != ie || p2p_ielen == 0) -+ return; -+ -+ pos += 6; -+ while (pos - ie + 3 <= ie_len) { -+ id = *pos; -+ len = RTW_GET_LE16(pos + 1); -+ -+ RTW_PRINT_SEL(sel, "%s ID:%u, LEN:%u%s\n", __func__, id, len -+ , ((pos - ie + 3 + len) <= ie_len) ? "" : "(exceed ie_len)"); -+ -+ pos += (3 + len); -+ } -+} -+ -+/** -+ * rtw_get_p2p_ie - Search P2P IE from a series of IEs -+ * @in_ie: Address of IEs to search -+ * @in_len: Length limit from in_ie -+ * @p2p_ie: If not NULL and P2P IE is found, P2P IE will be copied to the buf starting from p2p_ie -+ * @p2p_ielen: If not NULL and P2P IE is found, will set to the length of the entire P2P IE -+ * -+ * Returns: The address of the P2P IE found, or NULL -+ */ -+u8 *rtw_get_p2p_ie(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen) -+{ -+ uint cnt; -+ u8 *p2p_ie_ptr = NULL; -+ u8 eid, p2p_oui[4] = {0x50, 0x6F, 0x9A, 0x09}; -+ -+ if (p2p_ielen) -+ *p2p_ielen = 0; -+ -+ if (!in_ie || in_len < 0) { -+ rtw_warn_on(1); -+ return p2p_ie_ptr; -+ } -+ -+ if (in_len <= 0) -+ return p2p_ie_ptr; -+ -+ cnt = 0; -+ -+ while (cnt + 1 + 4 < in_len) { -+ eid = in_ie[cnt]; -+ -+ if (cnt + 1 + 4 >= MAX_IE_SZ) { -+ rtw_warn_on(1); -+ return NULL; -+ } -+ -+ if (eid == WLAN_EID_VENDOR_SPECIFIC && _rtw_memcmp(&in_ie[cnt + 2], p2p_oui, 4) == _TRUE) { -+ p2p_ie_ptr = in_ie + cnt; -+ -+ if (p2p_ie) -+ _rtw_memcpy(p2p_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); -+ -+ if (p2p_ielen) -+ *p2p_ielen = in_ie[cnt + 1] + 2; -+ -+ break; -+ } else -+ cnt += in_ie[cnt + 1] + 2; -+ -+ } -+ -+ return p2p_ie_ptr; -+} -+ -+/** -+ * rtw_get_p2p_attr - Search a specific P2P attribute from a given P2P IE -+ * @p2p_ie: Address of P2P IE to search -+ * @p2p_ielen: Length limit from p2p_ie -+ * @target_attr_id: The attribute ID of P2P attribute to search -+ * @buf_attr: If not NULL and the P2P attribute is found, P2P attribute will be copied to the buf starting from buf_attr -+ * @len_attr: If not NULL and the P2P attribute is found, will set to the length of the entire P2P attribute -+ * -+ * Returns: the address of the specific WPS attribute found, or NULL -+ */ -+u8 *rtw_get_p2p_attr(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id , u8 *buf_attr, u32 *len_attr) -+{ -+ u8 *attr_ptr = NULL; -+ u8 *target_attr_ptr = NULL; -+ u8 p2p_oui[4] = {0x50, 0x6F, 0x9A, 0x09}; -+ -+ if (len_attr) -+ *len_attr = 0; -+ -+ if (!p2p_ie -+ || p2p_ielen <= 6 -+ || (p2p_ie[0] != WLAN_EID_VENDOR_SPECIFIC) -+ || (_rtw_memcmp(p2p_ie + 2, p2p_oui, 4) != _TRUE)) -+ return attr_ptr; -+ -+ /* 6 = 1(Element ID) + 1(Length) + 3 (OUI) + 1(OUI Type) */ -+ attr_ptr = p2p_ie + 6; /* goto first attr */ -+ -+ while ((attr_ptr - p2p_ie + 3) <= p2p_ielen) { -+ /* 3 = 1(Attribute ID) + 2(Length) */ -+ u8 attr_id = *attr_ptr; -+ u16 attr_data_len = RTW_GET_LE16(attr_ptr + 1); -+ u16 attr_len = attr_data_len + 3; -+ -+ if (0) -+ RTW_INFO("%s attr_ptr:%p, id:%u, length:%u\n", __func__, attr_ptr, attr_id, attr_data_len); -+ -+ if ((attr_ptr - p2p_ie + attr_len) > p2p_ielen) -+ break; -+ -+ if (attr_id == target_attr_id) { -+ target_attr_ptr = attr_ptr; -+ -+ if (buf_attr) -+ _rtw_memcpy(buf_attr, attr_ptr, attr_len); -+ -+ if (len_attr) -+ *len_attr = attr_len; -+ -+ break; -+ } else -+ attr_ptr += attr_len; -+ } -+ -+ return target_attr_ptr; -+} -+ -+/** -+ * rtw_get_p2p_attr_content - Search a specific P2P attribute content from a given P2P IE -+ * @p2p_ie: Address of P2P IE to search -+ * @p2p_ielen: Length limit from p2p_ie -+ * @target_attr_id: The attribute ID of P2P attribute to search -+ * @buf_content: If not NULL and the P2P attribute is found, P2P attribute content will be copied to the buf starting from buf_content -+ * @len_content: If not NULL and the P2P attribute is found, will set to the length of the P2P attribute content -+ * -+ * Returns: the address of the specific P2P attribute content found, or NULL -+ */ -+u8 *rtw_get_p2p_attr_content(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id , u8 *buf_content, uint *len_content) -+{ -+ u8 *attr_ptr; -+ u32 attr_len; -+ -+ if (len_content) -+ *len_content = 0; -+ -+ attr_ptr = rtw_get_p2p_attr(p2p_ie, p2p_ielen, target_attr_id, NULL, &attr_len); -+ -+ if (attr_ptr && attr_len) { -+ if (buf_content) -+ _rtw_memcpy(buf_content, attr_ptr + 3, attr_len - 3); -+ -+ if (len_content) -+ *len_content = attr_len - 3; -+ -+ return attr_ptr + 3; -+ } -+ -+ return NULL; -+} -+ -+u32 rtw_set_p2p_attr_content(u8 *pbuf, u8 attr_id, u16 attr_len, u8 *pdata_attr) -+{ -+ u32 a_len; -+ -+ *pbuf = attr_id; -+ -+ /* *(u16*)(pbuf + 1) = cpu_to_le16(attr_len); */ -+ RTW_PUT_LE16(pbuf + 1, attr_len); -+ -+ if (pdata_attr) -+ _rtw_memcpy(pbuf + 3, pdata_attr, attr_len); -+ -+ a_len = attr_len + 3; -+ -+ return a_len; -+} -+ -+uint rtw_del_p2p_ie(u8 *ies, uint ies_len_ori, const char *msg) -+{ -+#define DBG_DEL_P2P_IE 0 -+ -+ u8 *target_ie; -+ u32 target_ie_len; -+ uint ies_len = ies_len_ori; -+ int index = 0; -+ -+ while (1) { -+ target_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &target_ie_len); -+ if (target_ie && target_ie_len) { -+ u8 *next_ie = target_ie + target_ie_len; -+ uint remain_len = ies_len - (next_ie - ies); -+ -+ if (DBG_DEL_P2P_IE && msg) { -+ RTW_INFO("%s %d before\n", __func__, index); -+ dump_ies(RTW_DBGDUMP, ies, ies_len); -+ -+ RTW_INFO("ies:%p, ies_len:%u\n", ies, ies_len); -+ RTW_INFO("target_ie:%p, target_ie_len:%u\n", target_ie, target_ie_len); -+ RTW_INFO("next_ie:%p, remain_len:%u\n", next_ie, remain_len); -+ } -+ -+ _rtw_memmove(target_ie, next_ie, remain_len); -+ _rtw_memset(target_ie + remain_len, 0, target_ie_len); -+ ies_len -= target_ie_len; -+ -+ if (DBG_DEL_P2P_IE && msg) { -+ RTW_INFO("%s %d after\n", __func__, index); -+ dump_ies(RTW_DBGDUMP, ies, ies_len); -+ } -+ -+ index++; -+ } else -+ break; -+ } -+ -+ return ies_len; -+} -+ -+uint rtw_del_p2p_attr(u8 *ie, uint ielen_ori, u8 attr_id) -+{ -+#define DBG_DEL_P2P_ATTR 0 -+ -+ u8 *target_attr; -+ u32 target_attr_len; -+ uint ielen = ielen_ori; -+ int index = 0; -+ -+ while (1) { -+ target_attr = rtw_get_p2p_attr(ie, ielen, attr_id, NULL, &target_attr_len); -+ if (target_attr && target_attr_len) { -+ u8 *next_attr = target_attr + target_attr_len; -+ uint remain_len = ielen - (next_attr - ie); -+ -+ if (DBG_DEL_P2P_ATTR) { -+ RTW_INFO("%s %d before\n", __func__, index); -+ dump_ies(RTW_DBGDUMP, ie, ielen); -+ -+ RTW_INFO("ie:%p, ielen:%u\n", ie, ielen); -+ RTW_INFO("target_attr:%p, target_attr_len:%u\n", target_attr, target_attr_len); -+ RTW_INFO("next_attr:%p, remain_len:%u\n", next_attr, remain_len); -+ } -+ -+ _rtw_memmove(target_attr, next_attr, remain_len); -+ _rtw_memset(target_attr + remain_len, 0, target_attr_len); -+ *(ie + 1) -= target_attr_len; -+ ielen -= target_attr_len; -+ -+ if (DBG_DEL_P2P_ATTR) { -+ RTW_INFO("%s %d after\n", __func__, index); -+ dump_ies(RTW_DBGDUMP, ie, ielen); -+ } -+ -+ index++; -+ } else -+ break; -+ } -+ -+ return ielen; -+} -+ -+inline u8 *rtw_bss_ex_get_p2p_ie(WLAN_BSSID_EX *bss_ex, u8 *p2p_ie, uint *p2p_ielen) -+{ -+ return rtw_get_p2p_ie(BSS_EX_TLV_IES(bss_ex), BSS_EX_TLV_IES_LEN(bss_ex), p2p_ie, p2p_ielen); -+} -+ -+void rtw_bss_ex_del_p2p_ie(WLAN_BSSID_EX *bss_ex) -+{ -+#define DBG_BSS_EX_DEL_P2P_IE 0 -+ -+ u8 *ies = BSS_EX_TLV_IES(bss_ex); -+ uint ies_len_ori = BSS_EX_TLV_IES_LEN(bss_ex); -+ uint ies_len; -+ -+ ies_len = rtw_del_p2p_ie(ies, ies_len_ori, DBG_BSS_EX_DEL_P2P_IE ? __func__ : NULL); -+ bss_ex->IELength -= ies_len_ori - ies_len; -+} -+ -+void rtw_bss_ex_del_p2p_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id) -+{ -+#define DBG_BSS_EX_DEL_P2P_ATTR 0 -+ -+ u8 *ies = BSS_EX_TLV_IES(bss_ex); -+ uint ies_len = BSS_EX_TLV_IES_LEN(bss_ex); -+ -+ u8 *ie; -+ uint ie_len, ie_len_ori; -+ -+ int index = 0; -+ -+ while (1) { -+ ie = rtw_get_p2p_ie(ies, ies_len, NULL, &ie_len_ori); -+ if (ie) { -+ u8 *next_ie_ori = ie + ie_len_ori; -+ uint remain_len = bss_ex->IELength - (next_ie_ori - bss_ex->IEs); -+ u8 has_target_attr = 0; -+ -+ if (DBG_BSS_EX_DEL_P2P_ATTR) { -+ if (rtw_get_p2p_attr(ie, ie_len_ori, attr_id, NULL, NULL)) { -+ RTW_INFO("%s %d before\n", __func__, index); -+ dump_ies(RTW_DBGDUMP, BSS_EX_TLV_IES(bss_ex), BSS_EX_TLV_IES_LEN(bss_ex)); -+ -+ RTW_INFO("ies:%p, ies_len:%u\n", ies, ies_len); -+ RTW_INFO("ie:%p, ie_len_ori:%u\n", ie, ie_len_ori); -+ RTW_INFO("next_ie_ori:%p, remain_len:%u\n", next_ie_ori, remain_len); -+ has_target_attr = 1; -+ } -+ } -+ -+ ie_len = rtw_del_p2p_attr(ie, ie_len_ori, attr_id); -+ if (ie_len != ie_len_ori) { -+ u8 *next_ie = ie + ie_len; -+ -+ _rtw_memmove(next_ie, next_ie_ori, remain_len); -+ _rtw_memset(next_ie + remain_len, 0, ie_len_ori - ie_len); -+ bss_ex->IELength -= ie_len_ori - ie_len; -+ -+ ies = next_ie; -+ } else -+ ies = next_ie_ori; -+ -+ if (DBG_BSS_EX_DEL_P2P_ATTR) { -+ if (has_target_attr) { -+ RTW_INFO("%s %d after\n", __func__, index); -+ dump_ies(RTW_DBGDUMP, BSS_EX_TLV_IES(bss_ex), BSS_EX_TLV_IES_LEN(bss_ex)); -+ } -+ } -+ -+ ies_len = remain_len; -+ -+ index++; -+ } else -+ break; -+ } -+} -+ -+void dump_wfd_ie(void *sel, u8 *ie, u32 ie_len) -+{ -+ u8 *pos = (u8 *)ie; -+ u8 id; -+ u16 len; -+ -+ u8 *wfd_ie; -+ uint wfd_ielen; -+ -+ wfd_ie = rtw_get_wfd_ie(ie, ie_len, NULL, &wfd_ielen); -+ if (wfd_ie != ie || wfd_ielen == 0) -+ return; -+ -+ pos += 6; -+ while (pos - ie + 3 <= ie_len) { -+ id = *pos; -+ len = RTW_GET_BE16(pos + 1); -+ -+ RTW_PRINT_SEL(sel, "%s ID:%u, LEN:%u%s\n", __func__, id, len -+ , ((pos - ie + 3 + len) <= ie_len) ? "" : "(exceed ie_len)"); -+ -+ pos += (3 + len); -+ } -+} -+ -+/** -+ * rtw_get_wfd_ie - Search WFD IE from a series of IEs -+ * @in_ie: Address of IEs to search -+ * @in_len: Length limit from in_ie -+ * @wfd_ie: If not NULL and WFD IE is found, WFD IE will be copied to the buf starting from wfd_ie -+ * @wfd_ielen: If not NULL and WFD IE is found, will set to the length of the entire WFD IE -+ * -+ * Returns: The address of the P2P IE found, or NULL -+ */ -+u8 *rtw_get_wfd_ie(u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen) -+{ -+ uint cnt; -+ u8 *wfd_ie_ptr = NULL; -+ u8 eid, wfd_oui[4] = {0x50, 0x6F, 0x9A, 0x0A}; -+ -+ if (wfd_ielen) -+ *wfd_ielen = 0; -+ -+ if (!in_ie || in_len < 0) { -+ rtw_warn_on(1); -+ return wfd_ie_ptr; -+ } -+ -+ if (in_len <= 0) -+ return wfd_ie_ptr; -+ -+ cnt = 0; -+ -+ while (cnt + 1 + 4 < in_len) { -+ eid = in_ie[cnt]; -+ -+ if (cnt + 1 + 4 >= MAX_IE_SZ) { -+ rtw_warn_on(1); -+ return NULL; -+ } -+ -+ if (eid == WLAN_EID_VENDOR_SPECIFIC && _rtw_memcmp(&in_ie[cnt + 2], wfd_oui, 4) == _TRUE) { -+ wfd_ie_ptr = in_ie + cnt; -+ -+ if (wfd_ie) -+ _rtw_memcpy(wfd_ie, &in_ie[cnt], in_ie[cnt + 1] + 2); -+ -+ if (wfd_ielen) -+ *wfd_ielen = in_ie[cnt + 1] + 2; -+ -+ break; -+ } else -+ cnt += in_ie[cnt + 1] + 2; -+ -+ } -+ -+ return wfd_ie_ptr; -+} -+ -+/** -+ * rtw_get_wfd_attr - Search a specific WFD attribute from a given WFD IE -+ * @wfd_ie: Address of WFD IE to search -+ * @wfd_ielen: Length limit from wfd_ie -+ * @target_attr_id: The attribute ID of WFD attribute to search -+ * @buf_attr: If not NULL and the WFD attribute is found, WFD attribute will be copied to the buf starting from buf_attr -+ * @len_attr: If not NULL and the WFD attribute is found, will set to the length of the entire WFD attribute -+ * -+ * Returns: the address of the specific WPS attribute found, or NULL -+ */ -+u8 *rtw_get_wfd_attr(u8 *wfd_ie, uint wfd_ielen, u8 target_attr_id, u8 *buf_attr, u32 *len_attr) -+{ -+ u8 *attr_ptr = NULL; -+ u8 *target_attr_ptr = NULL; -+ u8 wfd_oui[4] = {0x50, 0x6F, 0x9A, 0x0A}; -+ -+ if (len_attr) -+ *len_attr = 0; -+ -+ if (!wfd_ie -+ || wfd_ielen <= 6 -+ || (wfd_ie[0] != WLAN_EID_VENDOR_SPECIFIC) -+ || (_rtw_memcmp(wfd_ie + 2, wfd_oui, 4) != _TRUE)) -+ return attr_ptr; -+ -+ /* 6 = 1(Element ID) + 1(Length) + 3 (OUI) + 1(OUI Type) */ -+ attr_ptr = wfd_ie + 6; /* goto first attr */ -+ -+ while ((attr_ptr - wfd_ie + 3) <= wfd_ielen) { -+ /* 3 = 1(Attribute ID) + 2(Length) */ -+ u8 attr_id = *attr_ptr; -+ u16 attr_data_len = RTW_GET_BE16(attr_ptr + 1); -+ u16 attr_len = attr_data_len + 3; -+ -+ if (0) -+ RTW_INFO("%s attr_ptr:%p, id:%u, length:%u\n", __func__, attr_ptr, attr_id, attr_data_len); -+ -+ if ((attr_ptr - wfd_ie + attr_len) > wfd_ielen) -+ break; -+ -+ if (attr_id == target_attr_id) { -+ target_attr_ptr = attr_ptr; -+ -+ if (buf_attr) -+ _rtw_memcpy(buf_attr, attr_ptr, attr_len); -+ -+ if (len_attr) -+ *len_attr = attr_len; -+ -+ break; -+ } else -+ attr_ptr += attr_len; -+ } -+ -+ return target_attr_ptr; -+} -+ -+/** -+ * rtw_get_wfd_attr_content - Search a specific WFD attribute content from a given WFD IE -+ * @wfd_ie: Address of WFD IE to search -+ * @wfd_ielen: Length limit from wfd_ie -+ * @target_attr_id: The attribute ID of WFD attribute to search -+ * @buf_content: If not NULL and the WFD attribute is found, WFD attribute content will be copied to the buf starting from buf_content -+ * @len_content: If not NULL and the WFD attribute is found, will set to the length of the WFD attribute content -+ * -+ * Returns: the address of the specific WFD attribute content found, or NULL -+ */ -+u8 *rtw_get_wfd_attr_content(u8 *wfd_ie, uint wfd_ielen, u8 target_attr_id, u8 *buf_content, uint *len_content) -+{ -+ u8 *attr_ptr; -+ u32 attr_len; -+ -+ if (len_content) -+ *len_content = 0; -+ -+ attr_ptr = rtw_get_wfd_attr(wfd_ie, wfd_ielen, target_attr_id, NULL, &attr_len); -+ -+ if (attr_ptr && attr_len) { -+ if (buf_content) -+ _rtw_memcpy(buf_content, attr_ptr + 3, attr_len - 3); -+ -+ if (len_content) -+ *len_content = attr_len - 3; -+ -+ return attr_ptr + 3; -+ } -+ -+ return NULL; -+} -+ -+uint rtw_del_wfd_ie(u8 *ies, uint ies_len_ori, const char *msg) -+{ -+#define DBG_DEL_WFD_IE 0 -+ -+ u8 *target_ie; -+ u32 target_ie_len; -+ uint ies_len = ies_len_ori; -+ int index = 0; -+ -+ while (1) { -+ target_ie = rtw_get_wfd_ie(ies, ies_len, NULL, &target_ie_len); -+ if (target_ie && target_ie_len) { -+ u8 *next_ie = target_ie + target_ie_len; -+ uint remain_len = ies_len - (next_ie - ies); -+ -+ if (DBG_DEL_WFD_IE && msg) { -+ RTW_INFO("%s %d before\n", __func__, index); -+ dump_ies(RTW_DBGDUMP, ies, ies_len); -+ -+ RTW_INFO("ies:%p, ies_len:%u\n", ies, ies_len); -+ RTW_INFO("target_ie:%p, target_ie_len:%u\n", target_ie, target_ie_len); -+ RTW_INFO("next_ie:%p, remain_len:%u\n", next_ie, remain_len); -+ } -+ -+ _rtw_memmove(target_ie, next_ie, remain_len); -+ _rtw_memset(target_ie + remain_len, 0, target_ie_len); -+ ies_len -= target_ie_len; -+ -+ if (DBG_DEL_WFD_IE && msg) { -+ RTW_INFO("%s %d after\n", __func__, index); -+ dump_ies(RTW_DBGDUMP, ies, ies_len); -+ } -+ -+ index++; -+ } else -+ break; -+ } -+ -+ return ies_len; -+} -+ -+uint rtw_del_wfd_attr(u8 *ie, uint ielen_ori, u8 attr_id) -+{ -+#define DBG_DEL_WFD_ATTR 0 -+ -+ u8 *target_attr; -+ u32 target_attr_len; -+ uint ielen = ielen_ori; -+ int index = 0; -+ -+ while (1) { -+ target_attr = rtw_get_wfd_attr(ie, ielen, attr_id, NULL, &target_attr_len); -+ if (target_attr && target_attr_len) { -+ u8 *next_attr = target_attr + target_attr_len; -+ uint remain_len = ielen - (next_attr - ie); -+ -+ if (DBG_DEL_WFD_ATTR) { -+ RTW_INFO("%s %d before\n", __func__, index); -+ dump_ies(RTW_DBGDUMP, ie, ielen); -+ -+ RTW_INFO("ie:%p, ielen:%u\n", ie, ielen); -+ RTW_INFO("target_attr:%p, target_attr_len:%u\n", target_attr, target_attr_len); -+ RTW_INFO("next_attr:%p, remain_len:%u\n", next_attr, remain_len); -+ } -+ -+ _rtw_memmove(target_attr, next_attr, remain_len); -+ _rtw_memset(target_attr + remain_len, 0, target_attr_len); -+ *(ie + 1) -= target_attr_len; -+ ielen -= target_attr_len; -+ -+ if (DBG_DEL_WFD_ATTR) { -+ RTW_INFO("%s %d after\n", __func__, index); -+ dump_ies(RTW_DBGDUMP, ie, ielen); -+ } -+ -+ index++; -+ } else -+ break; -+ } -+ -+ return ielen; -+} -+ -+inline u8 *rtw_bss_ex_get_wfd_ie(WLAN_BSSID_EX *bss_ex, u8 *wfd_ie, uint *wfd_ielen) -+{ -+ return rtw_get_wfd_ie(BSS_EX_TLV_IES(bss_ex), BSS_EX_TLV_IES_LEN(bss_ex), wfd_ie, wfd_ielen); -+} -+ -+void rtw_bss_ex_del_wfd_ie(WLAN_BSSID_EX *bss_ex) -+{ -+#define DBG_BSS_EX_DEL_WFD_IE 0 -+ u8 *ies = BSS_EX_TLV_IES(bss_ex); -+ uint ies_len_ori = BSS_EX_TLV_IES_LEN(bss_ex); -+ uint ies_len; -+ -+ ies_len = rtw_del_wfd_ie(ies, ies_len_ori, DBG_BSS_EX_DEL_WFD_IE ? __func__ : NULL); -+ bss_ex->IELength -= ies_len_ori - ies_len; -+} -+ -+void rtw_bss_ex_del_wfd_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id) -+{ -+#define DBG_BSS_EX_DEL_WFD_ATTR 0 -+ -+ u8 *ies = BSS_EX_TLV_IES(bss_ex); -+ uint ies_len = BSS_EX_TLV_IES_LEN(bss_ex); -+ -+ u8 *ie; -+ uint ie_len, ie_len_ori; -+ -+ int index = 0; -+ -+ while (1) { -+ ie = rtw_get_wfd_ie(ies, ies_len, NULL, &ie_len_ori); -+ if (ie) { -+ u8 *next_ie_ori = ie + ie_len_ori; -+ uint remain_len = bss_ex->IELength - (next_ie_ori - bss_ex->IEs); -+ u8 has_target_attr = 0; -+ -+ if (DBG_BSS_EX_DEL_WFD_ATTR) { -+ if (rtw_get_wfd_attr(ie, ie_len_ori, attr_id, NULL, NULL)) { -+ RTW_INFO("%s %d before\n", __func__, index); -+ dump_ies(RTW_DBGDUMP, BSS_EX_TLV_IES(bss_ex), BSS_EX_TLV_IES_LEN(bss_ex)); -+ -+ RTW_INFO("ies:%p, ies_len:%u\n", ies, ies_len); -+ RTW_INFO("ie:%p, ie_len_ori:%u\n", ie, ie_len_ori); -+ RTW_INFO("next_ie_ori:%p, remain_len:%u\n", next_ie_ori, remain_len); -+ has_target_attr = 1; -+ } -+ } -+ -+ ie_len = rtw_del_wfd_attr(ie, ie_len_ori, attr_id); -+ if (ie_len != ie_len_ori) { -+ u8 *next_ie = ie + ie_len; -+ -+ _rtw_memmove(next_ie, next_ie_ori, remain_len); -+ _rtw_memset(next_ie + remain_len, 0, ie_len_ori - ie_len); -+ bss_ex->IELength -= ie_len_ori - ie_len; -+ -+ ies = next_ie; -+ } else -+ ies = next_ie_ori; -+ -+ if (DBG_BSS_EX_DEL_WFD_ATTR) { -+ if (has_target_attr) { -+ RTW_INFO("%s %d after\n", __func__, index); -+ dump_ies(RTW_DBGDUMP, BSS_EX_TLV_IES(bss_ex), BSS_EX_TLV_IES_LEN(bss_ex)); -+ } -+ } -+ -+ ies_len = remain_len; -+ -+ index++; -+ } else -+ break; -+ } -+} -+ -+/* Baron adds to avoid FreeBSD warning */ -+int ieee80211_is_empty_essid(const char *essid, int essid_len) -+{ -+ /* Single white space is for Linksys APs */ -+ if (essid_len == 1 && essid[0] == ' ') -+ return 1; -+ -+ /* Otherwise, if the entire essid is 0, we assume it is hidden */ -+ while (essid_len) { -+ essid_len--; -+ if (essid[essid_len] != '\0') -+ return 0; -+ } -+ -+ return 1; -+} -+ -+int ieee80211_get_hdrlen(u16 fc) -+{ -+ int hdrlen = 24; -+ -+ switch (WLAN_FC_GET_TYPE(fc)) { -+ case RTW_IEEE80211_FTYPE_DATA: -+ if (fc & RTW_IEEE80211_STYPE_QOS_DATA) -+ hdrlen += 2; -+ if ((fc & RTW_IEEE80211_FCTL_FROMDS) && (fc & RTW_IEEE80211_FCTL_TODS)) -+ hdrlen += 6; /* Addr4 */ -+ break; -+ case RTW_IEEE80211_FTYPE_CTL: -+ switch (WLAN_FC_GET_STYPE(fc)) { -+ case RTW_IEEE80211_STYPE_CTS: -+ case RTW_IEEE80211_STYPE_ACK: -+ hdrlen = 10; -+ break; -+ default: -+ hdrlen = 16; -+ break; -+ } -+ break; -+ } -+ -+ return hdrlen; -+} -+ -+int rtw_get_cipher_info(struct wlan_network *pnetwork) -+{ -+ u32 wpa_ielen; -+ unsigned char *pbuf; -+ int group_cipher = 0, pairwise_cipher = 0, is8021x = 0; -+ int ret = _FAIL; -+ pbuf = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength - 12); -+ -+ if (pbuf && (wpa_ielen > 0)) { -+ if (_SUCCESS == rtw_parse_wpa_ie(pbuf, wpa_ielen + 2, &group_cipher, &pairwise_cipher, &is8021x)) { -+ -+ pnetwork->BcnInfo.pairwise_cipher = pairwise_cipher; -+ pnetwork->BcnInfo.group_cipher = group_cipher; -+ pnetwork->BcnInfo.is_8021x = is8021x; -+ ret = _SUCCESS; -+ } -+ } else { -+ -+ pbuf = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength - 12); -+ -+ if (pbuf && (wpa_ielen > 0)) { -+ if (_SUCCESS == rtw_parse_wpa2_ie(pbuf, wpa_ielen + 2, &group_cipher, &pairwise_cipher, &is8021x)) { -+ pnetwork->BcnInfo.pairwise_cipher = pairwise_cipher; -+ pnetwork->BcnInfo.group_cipher = group_cipher; -+ pnetwork->BcnInfo.is_8021x = is8021x; -+ ret = _SUCCESS; -+ } -+ } -+ } -+ -+ return ret; -+} -+ -+void rtw_get_bcn_info(struct wlan_network *pnetwork) -+{ -+ unsigned short cap = 0; -+ u8 bencrypt = 0; -+ /* u8 wpa_ie[255],rsn_ie[255]; */ -+ u16 wpa_len = 0, rsn_len = 0; -+ struct HT_info_element *pht_info = NULL; -+ struct rtw_ieee80211_ht_cap *pht_cap = NULL; -+ unsigned int len; -+ unsigned char *p; -+ -+ _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); -+ cap = le16_to_cpu(cap); -+ if (cap & WLAN_CAPABILITY_PRIVACY) { -+ bencrypt = 1; -+ pnetwork->network.Privacy = 1; -+ } else -+ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_OPENSYS; -+ rtw_get_sec_ie(pnetwork->network.IEs , pnetwork->network.IELength, NULL, &rsn_len, NULL, &wpa_len); -+ -+ if (rsn_len > 0) -+ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_WPA2; -+ else if (wpa_len > 0) -+ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_WPA; -+ else { -+ if (bencrypt) -+ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_WEP; -+ } -+ rtw_get_cipher_info(pnetwork); -+ -+ /* get bwmode and ch_offset */ -+ /* parsing HT_CAP_IE */ -+ p = rtw_get_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, pnetwork->network.IELength - _FIXED_IE_LENGTH_); -+ if (p && len > 0) { -+ pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); -+ pnetwork->BcnInfo.ht_cap_info = pht_cap->cap_info; -+ } else -+ pnetwork->BcnInfo.ht_cap_info = 0; -+ /* parsing HT_INFO_IE */ -+ p = rtw_get_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, pnetwork->network.IELength - _FIXED_IE_LENGTH_); -+ if (p && len > 0) { -+ pht_info = (struct HT_info_element *)(p + 2); -+ pnetwork->BcnInfo.ht_info_infos_0 = pht_info->infos[0]; -+ } else -+ pnetwork->BcnInfo.ht_info_infos_0 = 0; -+} -+ -+u8 rtw_ht_mcsset_to_nss(u8 *supp_mcs_set) -+{ -+ u8 nss = 1; -+ -+ if (supp_mcs_set[3]) -+ nss = 4; -+ else if (supp_mcs_set[2]) -+ nss = 3; -+ else if (supp_mcs_set[1]) -+ nss = 2; -+ else if (supp_mcs_set[0]) -+ nss = 1; -+ else -+ RTW_INFO("%s,%d, warning! supp_mcs_set is zero\n", __func__, __LINE__); -+ /* RTW_INFO("%s HT: %dSS\n", __FUNCTION__, nss); */ -+ return nss; -+} -+ -+/* show MCS rate, unit: 100Kbps */ -+u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI, unsigned char *MCS_rate) -+{ -+ u16 max_rate = 0; -+ -+ /*MCS_rate[2] = 3T3R , MCS_rate[1] = 2T2R , MCS_rate[0] = 1T1R*/ -+ if (MCS_rate[2]) { -+ if (MCS_rate[2] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 4500 : 4050) : ((short_GI) ? 2167 : 1950); -+ else if (MCS_rate[2] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 4050 : 3645) : ((short_GI) ? 1950 : 1750); -+ else if (MCS_rate[2] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 3600 : 3240) : ((short_GI) ? 1733 : 1560); -+ else if (MCS_rate[2] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 2700 : 2430) : ((short_GI) ? 1300 : 1170); -+ else if (MCS_rate[2] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 1800 : 1620) : ((short_GI) ? 867 : 780); -+ else if (MCS_rate[2] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 1350 : 1215) : ((short_GI) ? 650 : 585); -+ else if (MCS_rate[2] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 900 : 810) : ((short_GI) ? 433 : 390); -+ else if (MCS_rate[2] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 450 : 405) : ((short_GI) ? 217 : 195); -+ } else if (MCS_rate[1]) { -+ if (MCS_rate[1] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 3000 : 2700) : ((short_GI) ? 1444 : 1300); -+ else if (MCS_rate[1] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 2700 : 2430) : ((short_GI) ? 1300 : 1170); -+ else if (MCS_rate[1] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 2400 : 2160) : ((short_GI) ? 1156 : 1040); -+ else if (MCS_rate[1] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 1800 : 1620) : ((short_GI) ? 867 : 780); -+ else if (MCS_rate[1] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 1200 : 1080) : ((short_GI) ? 578 : 520); -+ else if (MCS_rate[1] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 900 : 810) : ((short_GI) ? 433 : 390); -+ else if (MCS_rate[1] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 600 : 540) : ((short_GI) ? 289 : 260); -+ else if (MCS_rate[1] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 300 : 270) : ((short_GI) ? 144 : 130); -+ } else { -+ if (MCS_rate[0] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 1500 : 1350) : ((short_GI) ? 722 : 650); -+ else if (MCS_rate[0] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 1350 : 1215) : ((short_GI) ? 650 : 585); -+ else if (MCS_rate[0] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 1200 : 1080) : ((short_GI) ? 578 : 520); -+ else if (MCS_rate[0] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 900 : 810) : ((short_GI) ? 433 : 390); -+ else if (MCS_rate[0] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 600 : 540) : ((short_GI) ? 289 : 260); -+ else if (MCS_rate[0] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 450 : 405) : ((short_GI) ? 217 : 195); -+ else if (MCS_rate[0] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 300 : 270) : ((short_GI) ? 144 : 130); -+ else if (MCS_rate[0] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65); -+ } -+ -+ return max_rate; -+} -+ -+int rtw_action_frame_parse(const u8 *frame, u32 frame_len, u8 *category, u8 *action) -+{ -+ const u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u16 fc; -+ u8 c; -+ u8 a = ACT_PUBLIC_MAX; -+ -+ fc = le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)frame)->frame_ctl); -+ -+ if ((fc & (RTW_IEEE80211_FCTL_FTYPE | RTW_IEEE80211_FCTL_STYPE)) -+ != (RTW_IEEE80211_FTYPE_MGMT | RTW_IEEE80211_STYPE_ACTION) -+ ) -+ return _FALSE; -+ -+ c = frame_body[0]; -+ -+ switch (c) { -+ case RTW_WLAN_CATEGORY_P2P: /* vendor-specific */ -+ break; -+ default: -+ a = frame_body[1]; -+ } -+ -+ if (category) -+ *category = c; -+ if (action) -+ *action = a; -+ -+ return _TRUE; -+} -+ -+static const char *_action_public_str[] = { -+ "ACT_PUB_BSSCOEXIST", -+ "ACT_PUB_DSE_ENABLE", -+ "ACT_PUB_DSE_DEENABLE", -+ "ACT_PUB_DSE_REG_LOCATION", -+ "ACT_PUB_EXT_CHL_SWITCH", -+ "ACT_PUB_DSE_MSR_REQ", -+ "ACT_PUB_DSE_MSR_RPRT", -+ "ACT_PUB_MP", -+ "ACT_PUB_DSE_PWR_CONSTRAINT", -+ "ACT_PUB_VENDOR", -+ "ACT_PUB_GAS_INITIAL_REQ", -+ "ACT_PUB_GAS_INITIAL_RSP", -+ "ACT_PUB_GAS_COMEBACK_REQ", -+ "ACT_PUB_GAS_COMEBACK_RSP", -+ "ACT_PUB_TDLS_DISCOVERY_RSP", -+ "ACT_PUB_LOCATION_TRACK", -+ "ACT_PUB_RSVD", -+}; -+ -+const char *action_public_str(u8 action) -+{ -+ action = (action >= ACT_PUBLIC_MAX) ? ACT_PUBLIC_MAX : action; -+ return _action_public_str[action]; -+} -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_io.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_io.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_io.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_io.c 2018-02-11 21:44:27.136145918 +0200 -@@ -0,0 +1,701 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/* -+ -+The purpose of rtw_io.c -+ -+a. provides the API -+ -+b. provides the protocol engine -+ -+c. provides the software interface between caller and the hardware interface -+ -+ -+Compiler Flag Option: -+ -+1. CONFIG_SDIO_HCI: -+ a. USE_SYNC_IRP: Only sync operations are provided. -+ b. USE_ASYNC_IRP:Both sync/async operations are provided. -+ -+2. CONFIG_USB_HCI: -+ a. USE_ASYNC_IRP: Both sync/async operations are provided. -+ -+3. CONFIG_CFIO_HCI: -+ b. USE_SYNC_IRP: Only sync operations are provided. -+ -+ -+Only sync read/rtw_write_mem operations are provided. -+ -+jackson@realtek.com.tw -+ -+*/ -+ -+#define _RTW_IO_C_ -+ -+#include -+#include -+ -+#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+ #error "Shall be Linux or Windows, but not both!\n" -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+ #define rtw_le16_to_cpu(val) val -+ #define rtw_le32_to_cpu(val) val -+ #define rtw_cpu_to_le16(val) val -+ #define rtw_cpu_to_le32(val) val -+#else -+ #define rtw_le16_to_cpu(val) le16_to_cpu(val) -+ #define rtw_le32_to_cpu(val) le32_to_cpu(val) -+ #define rtw_cpu_to_le16(val) cpu_to_le16(val) -+ #define rtw_cpu_to_le32(val) cpu_to_le32(val) -+#endif -+ -+ -+u8 _rtw_read8(_adapter *adapter, u32 addr) -+{ -+ u8 r_val; -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u8(*_read8)(struct intf_hdl *pintfhdl, u32 addr); -+ _read8 = pintfhdl->io_ops._read8; -+ -+ r_val = _read8(pintfhdl, addr); -+ return r_val; -+} -+ -+u16 _rtw_read16(_adapter *adapter, u32 addr) -+{ -+ u16 r_val; -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u16(*_read16)(struct intf_hdl *pintfhdl, u32 addr); -+ _read16 = pintfhdl->io_ops._read16; -+ -+ r_val = _read16(pintfhdl, addr); -+ return rtw_le16_to_cpu(r_val); -+} -+ -+u32 _rtw_read32(_adapter *adapter, u32 addr) -+{ -+ u32 r_val; -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u32(*_read32)(struct intf_hdl *pintfhdl, u32 addr); -+ _read32 = pintfhdl->io_ops._read32; -+ -+ r_val = _read32(pintfhdl, addr); -+ return rtw_le32_to_cpu(r_val); -+ -+} -+ -+int _rtw_write8(_adapter *adapter, u32 addr, u8 val) -+{ -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int ret; -+ _write8 = pintfhdl->io_ops._write8; -+ -+ ret = _write8(pintfhdl, addr, val); -+ -+ return RTW_STATUS_CODE(ret); -+} -+int _rtw_write16(_adapter *adapter, u32 addr, u16 val) -+{ -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int ret; -+ _write16 = pintfhdl->io_ops._write16; -+ -+ val = rtw_cpu_to_le16(val); -+ ret = _write16(pintfhdl, addr, val); -+ -+ return RTW_STATUS_CODE(ret); -+} -+int _rtw_write32(_adapter *adapter, u32 addr, u32 val) -+{ -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ int ret; -+ _write32 = pintfhdl->io_ops._write32; -+ -+ val = rtw_cpu_to_le32(val); -+ ret = _write32(pintfhdl, addr, val); -+ -+ return RTW_STATUS_CODE(ret); -+} -+ -+int _rtw_writeN(_adapter *adapter, u32 addr , u32 length , u8 *pdata) -+{ -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = (struct intf_hdl *)(&(pio_priv->intf)); -+ int (*_writeN)(struct intf_hdl *pintfhdl, u32 addr, u32 length, u8 *pdata); -+ int ret; -+ _writeN = pintfhdl->io_ops._writeN; -+ -+ ret = _writeN(pintfhdl, addr, length, pdata); -+ -+ return RTW_STATUS_CODE(ret); -+} -+ -+#ifdef CONFIG_SDIO_HCI -+u8 _rtw_sd_f0_read8(_adapter *adapter, u32 addr) -+{ -+ u8 r_val = 0x00; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u8(*_sd_f0_read8)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _sd_f0_read8 = pintfhdl->io_ops._sd_f0_read8; -+ -+ if (_sd_f0_read8) -+ r_val = _sd_f0_read8(pintfhdl, addr); -+ else -+ RTW_WARN(FUNC_ADPT_FMT" _sd_f0_read8 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return r_val; -+} -+ -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+u8 _rtw_sd_iread8(_adapter *adapter, u32 addr) -+{ -+ u8 r_val = 0x00; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u8(*_sd_iread8)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _sd_iread8 = pintfhdl->io_ops._sd_iread8; -+ -+ if (_sd_iread8) -+ r_val = _sd_iread8(pintfhdl, addr); -+ else -+ RTW_ERR(FUNC_ADPT_FMT" _sd_iread8 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return r_val; -+} -+ -+u16 _rtw_sd_iread16(_adapter *adapter, u32 addr) -+{ -+ u16 r_val = 0x00; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u16(*_sd_iread16)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _sd_iread16 = pintfhdl->io_ops._sd_iread16; -+ -+ if (_sd_iread16) -+ r_val = _sd_iread16(pintfhdl, addr); -+ else -+ RTW_ERR(FUNC_ADPT_FMT" _sd_iread16 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return r_val; -+} -+ -+u32 _rtw_sd_iread32(_adapter *adapter, u32 addr) -+{ -+ u32 r_val = 0x00; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u32(*_sd_iread32)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _sd_iread32 = pintfhdl->io_ops._sd_iread32; -+ -+ if (_sd_iread32) -+ r_val = _sd_iread32(pintfhdl, addr); -+ else -+ RTW_ERR(FUNC_ADPT_FMT" _sd_iread32 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return r_val; -+} -+ -+int _rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val) -+{ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_sd_iwrite8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int ret = -1; -+ -+ _sd_iwrite8 = pintfhdl->io_ops._sd_iwrite8; -+ -+ if (_sd_iwrite8) -+ ret = _sd_iwrite8(pintfhdl, addr, val); -+ else -+ RTW_ERR(FUNC_ADPT_FMT" _sd_iwrite8 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return RTW_STATUS_CODE(ret); -+} -+ -+int _rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val) -+{ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_sd_iwrite16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int ret = -1; -+ -+ _sd_iwrite16 = pintfhdl->io_ops._sd_iwrite16; -+ -+ if (_sd_iwrite16) -+ ret = _sd_iwrite16(pintfhdl, addr, val); -+ else -+ RTW_ERR(FUNC_ADPT_FMT" _sd_iwrite16 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return RTW_STATUS_CODE(ret); -+} -+int _rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val) -+{ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_sd_iwrite32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ int ret = -1; -+ -+ _sd_iwrite32 = pintfhdl->io_ops._sd_iwrite32; -+ -+ if (_sd_iwrite32) -+ ret = _sd_iwrite32(pintfhdl, addr, val); -+ else -+ RTW_ERR(FUNC_ADPT_FMT" _sd_iwrite32 callback is NULL\n", FUNC_ADPT_ARG(adapter)); -+ -+ return RTW_STATUS_CODE(ret); -+} -+ -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+ -+#endif /* CONFIG_SDIO_HCI */ -+ -+int _rtw_write8_async(_adapter *adapter, u32 addr, u8 val) -+{ -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write8_async)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int ret; -+ _write8_async = pintfhdl->io_ops._write8_async; -+ -+ ret = _write8_async(pintfhdl, addr, val); -+ -+ return RTW_STATUS_CODE(ret); -+} -+int _rtw_write16_async(_adapter *adapter, u32 addr, u16 val) -+{ -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write16_async)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int ret; -+ _write16_async = pintfhdl->io_ops._write16_async; -+ val = rtw_cpu_to_le16(val); -+ ret = _write16_async(pintfhdl, addr, val); -+ -+ return RTW_STATUS_CODE(ret); -+} -+int _rtw_write32_async(_adapter *adapter, u32 addr, u32 val) -+{ -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write32_async)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ int ret; -+ _write32_async = pintfhdl->io_ops._write32_async; -+ val = rtw_cpu_to_le32(val); -+ ret = _write32_async(pintfhdl, addr, val); -+ -+ return RTW_STATUS_CODE(ret); -+} -+ -+void _rtw_read_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) -+{ -+ void (*_read_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ -+ -+ if (RTW_CANNOT_RUN(adapter)) { -+ return; -+ } -+ -+ _read_mem = pintfhdl->io_ops._read_mem; -+ -+ _read_mem(pintfhdl, addr, cnt, pmem); -+ -+ -+} -+ -+void _rtw_write_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) -+{ -+ void (*_write_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ -+ -+ _write_mem = pintfhdl->io_ops._write_mem; -+ -+ _write_mem(pintfhdl, addr, cnt, pmem); -+ -+ -+} -+ -+void _rtw_read_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) -+{ -+ u32(*_read_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ -+ -+ if (RTW_CANNOT_RUN(adapter)) { -+ return; -+ } -+ -+ _read_port = pintfhdl->io_ops._read_port; -+ -+ _read_port(pintfhdl, addr, cnt, pmem); -+ -+ -+} -+ -+void _rtw_read_port_cancel(_adapter *adapter) -+{ -+ void (*_read_port_cancel)(struct intf_hdl *pintfhdl); -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ -+ _read_port_cancel = pintfhdl->io_ops._read_port_cancel; -+ -+ RTW_DISABLE_FUNC(adapter, DF_RX_BIT); -+ -+ if (_read_port_cancel) -+ _read_port_cancel(pintfhdl); -+} -+ -+u32 _rtw_write_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) -+{ -+ u32(*_write_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ /* struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; */ -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u32 ret = _SUCCESS; -+ -+ -+ _write_port = pintfhdl->io_ops._write_port; -+ -+ ret = _write_port(pintfhdl, addr, cnt, pmem); -+ -+ -+ return ret; -+} -+ -+u32 _rtw_write_port_and_wait(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem, int timeout_ms) -+{ -+ int ret = _SUCCESS; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)pmem; -+ struct submit_ctx sctx; -+ -+ rtw_sctx_init(&sctx, timeout_ms); -+ pxmitbuf->sctx = &sctx; -+ -+ ret = _rtw_write_port(adapter, addr, cnt, pmem); -+ -+ if (ret == _SUCCESS) -+ ret = rtw_sctx_wait(&sctx, __func__); -+ -+ return ret; -+} -+ -+void _rtw_write_port_cancel(_adapter *adapter) -+{ -+ void (*_write_port_cancel)(struct intf_hdl *pintfhdl); -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ -+ _write_port_cancel = pintfhdl->io_ops._write_port_cancel; -+ -+ RTW_DISABLE_FUNC(adapter, DF_TX_BIT); -+ -+ if (_write_port_cancel) -+ _write_port_cancel(pintfhdl); -+} -+int rtw_init_io_priv(_adapter *padapter, void (*set_intf_ops)(_adapter *padapter, struct _io_ops *pops)) -+{ -+ struct io_priv *piopriv = &padapter->iopriv; -+ struct intf_hdl *pintf = &piopriv->intf; -+ -+ if (set_intf_ops == NULL) -+ return _FAIL; -+ -+ piopriv->padapter = padapter; -+ pintf->padapter = padapter; -+ pintf->pintf_dev = adapter_to_dvobj(padapter); -+ -+ set_intf_ops(padapter, &pintf->io_ops); -+ -+ return _SUCCESS; -+} -+ -+/* -+* Increase and check if the continual_io_error of this @param dvobjprive is larger than MAX_CONTINUAL_IO_ERR -+* @return _TRUE: -+* @return _FALSE: -+*/ -+int rtw_inc_and_chk_continual_io_error(struct dvobj_priv *dvobj) -+{ -+ int ret = _FALSE; -+ int value; -+ -+ value = ATOMIC_INC_RETURN(&dvobj->continual_io_error); -+ if (value > MAX_CONTINUAL_IO_ERR) { -+ RTW_INFO("[dvobj:%p][ERROR] continual_io_error:%d > %d\n", dvobj, value, MAX_CONTINUAL_IO_ERR); -+ ret = _TRUE; -+ } else { -+ /* RTW_INFO("[dvobj:%p] continual_io_error:%d\n", dvobj, value); */ -+ } -+ return ret; -+} -+ -+/* -+* Set the continual_io_error of this @param dvobjprive to 0 -+*/ -+void rtw_reset_continual_io_error(struct dvobj_priv *dvobj) -+{ -+ ATOMIC_SET(&dvobj->continual_io_error, 0); -+} -+ -+#ifdef DBG_IO -+ -+u32 read_sniff_ranges[][2] = { -+ /* {0x520, 0x523}, */ -+}; -+ -+u32 write_sniff_ranges[][2] = { -+ /* {0x520, 0x523}, */ -+ /* {0x4c, 0x4c}, */ -+}; -+ -+int read_sniff_num = sizeof(read_sniff_ranges) / sizeof(u32) / 2; -+int write_sniff_num = sizeof(write_sniff_ranges) / sizeof(u32) / 2; -+ -+bool match_read_sniff_ranges(u32 addr, u16 len) -+{ -+ int i; -+ for (i = 0; i < read_sniff_num; i++) { -+ if (addr + len > read_sniff_ranges[i][0] && addr <= read_sniff_ranges[i][1]) -+ return _TRUE; -+ } -+ -+ return _FALSE; -+} -+ -+bool match_write_sniff_ranges(u32 addr, u16 len) -+{ -+ int i; -+ for (i = 0; i < write_sniff_num; i++) { -+ if (addr + len > write_sniff_ranges[i][0] && addr <= write_sniff_ranges[i][1]) -+ return _TRUE; -+ } -+ -+ return _FALSE; -+} -+ -+struct rf_sniff_ent { -+ u8 path; -+ u16 reg; -+ u32 mask; -+}; -+ -+struct rf_sniff_ent rf_read_sniff_ranges[] = { -+ /* example for all path addr 0x55 with all RF Reg mask */ -+ /* {MAX_RF_PATH, 0x55, bRFRegOffsetMask}, */ -+}; -+ -+struct rf_sniff_ent rf_write_sniff_ranges[] = { -+ /* example for all path addr 0x55 with all RF Reg mask */ -+ /* {MAX_RF_PATH, 0x55, bRFRegOffsetMask}, */ -+}; -+ -+int rf_read_sniff_num = sizeof(rf_read_sniff_ranges) / sizeof(struct rf_sniff_ent); -+int rf_write_sniff_num = sizeof(rf_write_sniff_ranges) / sizeof(struct rf_sniff_ent); -+ -+bool match_rf_read_sniff_ranges(u8 path, u32 addr, u32 mask) -+{ -+ int i; -+ -+ for (i = 0; i < rf_read_sniff_num; i++) { -+ if (rf_read_sniff_ranges[i].path == MAX_RF_PATH || rf_read_sniff_ranges[i].path == path) -+ if (addr == rf_read_sniff_ranges[i].reg && (mask & rf_read_sniff_ranges[i].mask)) -+ return _TRUE; -+ } -+ -+ return _FALSE; -+} -+ -+bool match_rf_write_sniff_ranges(u8 path, u32 addr, u32 mask) -+{ -+ int i; -+ -+ for (i = 0; i < rf_write_sniff_num; i++) { -+ if (rf_write_sniff_ranges[i].path == MAX_RF_PATH || rf_write_sniff_ranges[i].path == path) -+ if (addr == rf_write_sniff_ranges[i].reg && (mask & rf_write_sniff_ranges[i].mask)) -+ return _TRUE; -+ } -+ -+ return _FALSE; -+} -+ -+u8 dbg_rtw_read8(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u8 val = _rtw_read8(adapter, addr); -+ -+ if (match_read_sniff_ranges(addr, 1)) -+ RTW_INFO("DBG_IO %s:%d rtw_read8(0x%04x) return 0x%02x\n", caller, line, addr, val); -+ -+ return val; -+} -+ -+u16 dbg_rtw_read16(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u16 val = _rtw_read16(adapter, addr); -+ -+ if (match_read_sniff_ranges(addr, 2)) -+ RTW_INFO("DBG_IO %s:%d rtw_read16(0x%04x) return 0x%04x\n", caller, line, addr, val); -+ -+ return val; -+} -+ -+u32 dbg_rtw_read32(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u32 val = _rtw_read32(adapter, addr); -+ -+ if (match_read_sniff_ranges(addr, 4)) -+ RTW_INFO("DBG_IO %s:%d rtw_read32(0x%04x) return 0x%08x\n", caller, line, addr, val); -+ -+ return val; -+} -+ -+int dbg_rtw_write8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 1)) -+ RTW_INFO("DBG_IO %s:%d rtw_write8(0x%04x, 0x%02x)\n", caller, line, addr, val); -+ -+ return _rtw_write8(adapter, addr, val); -+} -+int dbg_rtw_write16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 2)) -+ RTW_INFO("DBG_IO %s:%d rtw_write16(0x%04x, 0x%04x)\n", caller, line, addr, val); -+ -+ return _rtw_write16(adapter, addr, val); -+} -+int dbg_rtw_write32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 4)) -+ RTW_INFO("DBG_IO %s:%d rtw_write32(0x%04x, 0x%08x)\n", caller, line, addr, val); -+ -+ return _rtw_write32(adapter, addr, val); -+} -+int dbg_rtw_writeN(_adapter *adapter, u32 addr , u32 length , u8 *data, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, length)) -+ RTW_INFO("DBG_IO %s:%d rtw_writeN(0x%04x, %u)\n", caller, line, addr, length); -+ -+ return _rtw_writeN(adapter, addr, length, data); -+} -+ -+#ifdef CONFIG_SDIO_HCI -+u8 dbg_rtw_sd_f0_read8(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u8 val = _rtw_sd_f0_read8(adapter, addr); -+ -+#if 0 -+ if (match_read_sniff_ranges(addr, 1)) -+ RTW_INFO("DBG_IO %s:%d rtw_sd_f0_read8(0x%04x) return 0x%02x\n", caller, line, addr, val); -+#endif -+ -+ return val; -+} -+ -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+u8 dbg_rtw_sd_iread8(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u8 val = rtw_sd_iread8(adapter, addr); -+ -+ if (match_read_sniff_ranges(addr, 1)) -+ RTW_INFO("DBG_IO %s:%d rtw_sd_iread8(0x%04x) return 0x%02x\n", caller, line, addr, val); -+ -+ return val; -+} -+ -+u16 dbg_rtw_sd_iread16(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u16 val = _rtw_sd_iread16(adapter, addr); -+ -+ if (match_read_sniff_ranges(addr, 2)) -+ RTW_INFO("DBG_IO %s:%d rtw_sd_iread16(0x%04x) return 0x%04x\n", caller, line, addr, val); -+ -+ return val; -+} -+ -+u32 dbg_rtw_sd_iread32(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u32 val = _rtw_sd_iread32(adapter, addr); -+ -+ if (match_read_sniff_ranges(addr, 4)) -+ RTW_INFO("DBG_IO %s:%d rtw_sd_iread32(0x%04x) return 0x%08x\n", caller, line, addr, val); -+ -+ return val; -+} -+ -+int dbg_rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 1)) -+ RTW_INFO("DBG_IO %s:%d rtw_sd_iwrite8(0x%04x, 0x%02x)\n", caller, line, addr, val); -+ -+ return _rtw_sd_iwrite8(adapter, addr, val); -+} -+int dbg_rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 2)) -+ RTW_INFO("DBG_IO %s:%d rtw_sd_iwrite16(0x%04x, 0x%04x)\n", caller, line, addr, val); -+ -+ return _rtw_sd_iwrite16(adapter, addr, val); -+} -+int dbg_rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 4)) -+ RTW_INFO("DBG_IO %s:%d rtw_sd_iwrite32(0x%04x, 0x%08x)\n", caller, line, addr, val); -+ -+ return _rtw_sd_iwrite32(adapter, addr, val); -+} -+ -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+ -+#endif /* CONFIG_SDIO_HCI */ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_ioctl_query.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ioctl_query.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_ioctl_query.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ioctl_query.c 2018-02-11 21:44:27.136145918 +0200 -@@ -0,0 +1,171 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_IOCTL_QUERY_C_ -+ -+#include -+ -+ -+#ifdef PLATFORM_WINDOWS -+/* -+ * Added for WPA2-PSK, by Annie, 2005-09-20. -+ * */ -+u8 -+query_802_11_capability( -+ _adapter *Adapter, -+ u8 *pucBuf, -+ u32 *pulOutLen -+) -+{ -+ static NDIS_802_11_AUTHENTICATION_ENCRYPTION szAuthEnc[] = { -+ {Ndis802_11AuthModeOpen, Ndis802_11EncryptionDisabled}, -+ {Ndis802_11AuthModeOpen, Ndis802_11Encryption1Enabled}, -+ {Ndis802_11AuthModeShared, Ndis802_11EncryptionDisabled}, -+ {Ndis802_11AuthModeShared, Ndis802_11Encryption1Enabled}, -+ {Ndis802_11AuthModeWPA, Ndis802_11Encryption2Enabled}, -+ {Ndis802_11AuthModeWPA, Ndis802_11Encryption3Enabled}, -+ {Ndis802_11AuthModeWPAPSK, Ndis802_11Encryption2Enabled}, -+ {Ndis802_11AuthModeWPAPSK, Ndis802_11Encryption3Enabled}, -+ {Ndis802_11AuthModeWPANone, Ndis802_11Encryption2Enabled}, -+ {Ndis802_11AuthModeWPANone, Ndis802_11Encryption3Enabled}, -+ {Ndis802_11AuthModeWPA2, Ndis802_11Encryption2Enabled}, -+ {Ndis802_11AuthModeWPA2, Ndis802_11Encryption3Enabled}, -+ {Ndis802_11AuthModeWPA2PSK, Ndis802_11Encryption2Enabled}, -+ {Ndis802_11AuthModeWPA2PSK, Ndis802_11Encryption3Enabled} -+ }; -+ static ULONG ulNumOfPairSupported = sizeof(szAuthEnc) / sizeof(NDIS_802_11_AUTHENTICATION_ENCRYPTION); -+ NDIS_802_11_CAPABILITY *pCap = (NDIS_802_11_CAPABILITY *)pucBuf; -+ u8 *pucAuthEncryptionSupported = (u8 *) pCap->AuthenticationEncryptionSupported; -+ -+ -+ pCap->Length = sizeof(NDIS_802_11_CAPABILITY); -+ if (ulNumOfPairSupported > 1) -+ pCap->Length += (ulNumOfPairSupported - 1) * sizeof(NDIS_802_11_AUTHENTICATION_ENCRYPTION); -+ -+ pCap->Version = 2; -+ pCap->NoOfPMKIDs = NUM_PMKID_CACHE; -+ pCap->NoOfAuthEncryptPairsSupported = ulNumOfPairSupported; -+ -+ if (sizeof(szAuthEnc) <= 240) /* 240 = 256 - 4*4 */ { /* SecurityInfo.szCapability: only 256 bytes in size. */ -+ _rtw_memcpy(pucAuthEncryptionSupported, (u8 *)szAuthEnc, sizeof(szAuthEnc)); -+ *pulOutLen = pCap->Length; -+ return _TRUE; -+ } else { -+ *pulOutLen = 0; -+ return _FALSE; -+ } -+} -+ -+u8 query_802_11_association_information(_adapter *padapter, PNDIS_802_11_ASSOCIATION_INFORMATION pAssocInfo) -+{ -+ struct wlan_network *tgt_network; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ WLAN_BSSID_EX *psecnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ u8 *pDest = (u8 *)pAssocInfo + sizeof(NDIS_802_11_ASSOCIATION_INFORMATION); -+ unsigned char i, *auth_ie, *supp_ie; -+ -+ /* NdisZeroMemory(pAssocInfo, sizeof(NDIS_802_11_ASSOCIATION_INFORMATION)); */ -+ _rtw_memset(pAssocInfo, 0, sizeof(NDIS_802_11_ASSOCIATION_INFORMATION)); -+ /* pAssocInfo->Length = sizeof(NDIS_802_11_ASSOCIATION_INFORMATION); */ -+ -+ /* ------------------------------------------------------ */ -+ /* Association Request related information */ -+ /* ------------------------------------------------------ */ -+ /* Req_1. AvailableRequestFixedIEs */ -+ if (psecnetwork != NULL) { -+ -+ pAssocInfo->AvailableRequestFixedIEs |= NDIS_802_11_AI_REQFI_CAPABILITIES | NDIS_802_11_AI_REQFI_CURRENTAPADDRESS; -+ pAssocInfo->RequestFixedIEs.Capabilities = (unsigned short) *&psecnetwork->IEs[10]; -+ _rtw_memcpy(pAssocInfo->RequestFixedIEs.CurrentAPAddress, -+ &psecnetwork->MacAddress, 6); -+ -+ pAssocInfo->OffsetRequestIEs = sizeof(NDIS_802_11_ASSOCIATION_INFORMATION); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING | _FW_LINKED) == _TRUE) { -+ -+ if (psecuritypriv->ndisauthtype >= Ndis802_11AuthModeWPA2) -+ pDest[0] = 48; /* RSN Information Element */ -+ else -+ pDest[0] = 221; /* WPA(SSN) Information Element */ -+ -+ supp_ie = &psecuritypriv->supplicant_ie[0]; -+ -+ i = 13; /* 0~11 is fixed information element */ -+ while ((i < supp_ie[0]) && (i < 256)) { -+ if ((unsigned char)supp_ie[i] == pDest[0]) { -+ _rtw_memcpy((u8 *)(pDest), -+ &supp_ie[i], -+ supp_ie[1 + i] + 2); -+ -+ break; -+ } -+ -+ i = i + supp_ie[i + 1] + 2; -+ if (supp_ie[1 + i] == 0) -+ i = i + 1; -+ -+ } -+ -+ -+ pAssocInfo->RequestIELength += (2 + supp_ie[1 + i]); /* (2 + psecnetwork->IEs[1+i]+4); */ -+ -+ } -+ -+ -+ -+ } -+ -+ -+ /* ------------------------------------------------------ */ -+ /* Association Response related information */ -+ /* ------------------------------------------------------ */ -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ tgt_network = &(pmlmepriv->cur_network); -+ if (tgt_network != NULL) { -+ pAssocInfo->AvailableResponseFixedIEs = -+ NDIS_802_11_AI_RESFI_CAPABILITIES -+ | NDIS_802_11_AI_RESFI_ASSOCIATIONID -+ ; -+ -+ pAssocInfo->ResponseFixedIEs.Capabilities = (unsigned short) *&tgt_network->network.IEs[10]; -+ pAssocInfo->ResponseFixedIEs.StatusCode = 0; -+ pAssocInfo->ResponseFixedIEs.AssociationId = (unsigned short) tgt_network->aid; -+ -+ pDest = (u8 *)pAssocInfo + sizeof(NDIS_802_11_ASSOCIATION_INFORMATION) + pAssocInfo->RequestIELength; -+ auth_ie = &psecuritypriv->authenticator_ie[0]; -+ -+ -+ i = auth_ie[0] - 12; -+ if (i > 0) { -+ _rtw_memcpy((u8 *)&pDest[0], &auth_ie[1], i); -+ pAssocInfo->ResponseIELength = i; -+ } -+ -+ -+ pAssocInfo->OffsetResponseIEs = sizeof(NDIS_802_11_ASSOCIATION_INFORMATION) + pAssocInfo->RequestIELength; -+ -+ -+ } -+ } -+ -+ return _TRUE; -+} -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_ioctl_rtl.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ioctl_rtl.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_ioctl_rtl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ioctl_rtl.c 2018-02-11 21:44:27.137145933 +0200 -@@ -0,0 +1,904 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_IOCTL_RTL_C_ -+ -+#include -+ -+#ifdef CONFIG_MP_INCLUDED -+ #include -+#endif -+ -+struct oid_obj_priv oid_rtl_seg_01_01[] = { -+ {1, &oid_null_function}, /* 0x80 */ -+ {1, &oid_null_function}, /* 0x81 */ -+ {1, &oid_null_function}, /* 0x82 */ -+ {1, &oid_null_function}, /* 0x83 */ /* OID_RT_SET_SNIFFER_MODE */ -+ {1, &oid_rt_get_signal_quality_hdl}, /* 0x84 */ -+ {1, &oid_rt_get_small_packet_crc_hdl}, /* 0x85 */ -+ {1, &oid_rt_get_middle_packet_crc_hdl}, /* 0x86 */ -+ {1, &oid_rt_get_large_packet_crc_hdl}, /* 0x87 */ -+ {1, &oid_rt_get_tx_retry_hdl}, /* 0x88 */ -+ {1, &oid_rt_get_rx_retry_hdl}, /* 0x89 */ -+ {1, &oid_rt_pro_set_fw_dig_state_hdl}, /* 0x8A */ -+ {1, &oid_rt_pro_set_fw_ra_state_hdl} , /* 0x8B */ -+ {1, &oid_null_function}, /* 0x8C */ -+ {1, &oid_null_function}, /* 0x8D */ -+ {1, &oid_null_function}, /* 0x8E */ -+ {1, &oid_null_function}, /* 0x8F */ -+ {1, &oid_rt_get_rx_total_packet_hdl}, /* 0x90 */ -+ {1, &oid_rt_get_tx_beacon_ok_hdl}, /* 0x91 */ -+ {1, &oid_rt_get_tx_beacon_err_hdl}, /* 0x92 */ -+ {1, &oid_rt_get_rx_icv_err_hdl}, /* 0x93 */ -+ {1, &oid_rt_set_encryption_algorithm_hdl}, /* 0x94 */ -+ {1, &oid_null_function}, /* 0x95 */ -+ {1, &oid_rt_get_preamble_mode_hdl}, /* 0x96 */ -+ {1, &oid_null_function}, /* 0x97 */ -+ {1, &oid_rt_get_ap_ip_hdl}, /* 0x98 */ -+ {1, &oid_rt_get_channelplan_hdl}, /* 0x99 */ -+ {1, &oid_rt_set_preamble_mode_hdl}, /* 0x9A */ -+ {1, &oid_rt_set_bcn_intvl_hdl}, /* 0x9B */ -+ {1, &oid_null_function}, /* 0x9C */ -+ {1, &oid_rt_dedicate_probe_hdl}, /* 0x9D */ -+ {1, &oid_null_function}, /* 0x9E */ -+ {1, &oid_null_function}, /* 0x9F */ -+ {1, &oid_null_function}, /* 0xA0 */ -+ {1, &oid_null_function}, /* 0xA1 */ -+ {1, &oid_null_function}, /* 0xA2 */ -+ {1, &oid_null_function}, /* 0xA3 */ -+ {1, &oid_null_function}, /* 0xA4 */ -+ {1, &oid_null_function}, /* 0xA5 */ -+ {1, &oid_null_function}, /* 0xA6 */ -+ {1, &oid_rt_get_total_tx_bytes_hdl}, /* 0xA7 */ -+ {1, &oid_rt_get_total_rx_bytes_hdl}, /* 0xA8 */ -+ {1, &oid_rt_current_tx_power_level_hdl}, /* 0xA9 */ -+ {1, &oid_rt_get_enc_key_mismatch_count_hdl}, /* 0xAA */ -+ {1, &oid_rt_get_enc_key_match_count_hdl}, /* 0xAB */ -+ {1, &oid_rt_get_channel_hdl}, /* 0xAC */ -+ {1, &oid_rt_set_channelplan_hdl}, /* 0xAD */ -+ {1, &oid_rt_get_hardware_radio_off_hdl}, /* 0xAE */ -+ {1, &oid_null_function}, /* 0xAF */ -+ {1, &oid_null_function}, /* 0xB0 */ -+ {1, &oid_null_function}, /* 0xB1 */ -+ {1, &oid_null_function}, /* 0xB2 */ -+ {1, &oid_null_function}, /* 0xB3 */ -+ {1, &oid_rt_get_key_mismatch_hdl}, /* 0xB4 */ -+ {1, &oid_null_function}, /* 0xB5 */ -+ {1, &oid_null_function}, /* 0xB6 */ -+ {1, &oid_null_function}, /* 0xB7 */ -+ {1, &oid_null_function}, /* 0xB8 */ -+ {1, &oid_null_function}, /* 0xB9 */ -+ {1, &oid_null_function}, /* 0xBA */ -+ {1, &oid_rt_supported_wireless_mode_hdl}, /* 0xBB */ -+ {1, &oid_rt_get_channel_list_hdl}, /* 0xBC */ -+ {1, &oid_rt_get_scan_in_progress_hdl}, /* 0xBD */ -+ {1, &oid_null_function}, /* 0xBE */ -+ {1, &oid_null_function}, /* 0xBF */ -+ {1, &oid_null_function}, /* 0xC0 */ -+ {1, &oid_rt_forced_data_rate_hdl}, /* 0xC1 */ -+ {1, &oid_rt_wireless_mode_for_scan_list_hdl}, /* 0xC2 */ -+ {1, &oid_rt_get_bss_wireless_mode_hdl}, /* 0xC3 */ -+ {1, &oid_rt_scan_with_magic_packet_hdl}, /* 0xC4 */ -+ {1, &oid_null_function}, /* 0xC5 */ -+ {1, &oid_null_function}, /* 0xC6 */ -+ {1, &oid_null_function}, /* 0xC7 */ -+ {1, &oid_null_function}, /* 0xC8 */ -+ {1, &oid_null_function}, /* 0xC9 */ -+ {1, &oid_null_function}, /* 0xCA */ -+ {1, &oid_null_function}, /* 0xCB */ -+ {1, &oid_null_function}, /* 0xCC */ -+ {1, &oid_null_function}, /* 0xCD */ -+ {1, &oid_null_function}, /* 0xCE */ -+ {1, &oid_null_function}, /* 0xCF */ -+ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_01_03[] = { -+ {1, &oid_rt_ap_get_associated_station_list_hdl}, /* 0x00 */ -+ {1, &oid_null_function}, /* 0x01 */ -+ {1, &oid_rt_ap_switch_into_ap_mode_hdl}, /* 0x02 */ -+ {1, &oid_null_function}, /* 0x03 */ -+ {1, &oid_rt_ap_supported_hdl}, /* 0x04 */ -+ {1, &oid_rt_ap_set_passphrase_hdl}, /* 0x05 */ -+ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_01_11[] = { -+ {1, &oid_null_function}, /* 0xC0 OID_RT_PRO_RX_FILTER */ -+ {1, &oid_null_function}, /* 0xC1 OID_CE_USB_WRITE_REGISTRY */ -+ {1, &oid_null_function}, /* 0xC2 OID_CE_USB_READ_REGISTRY */ -+ {1, &oid_null_function}, /* 0xC3 OID_RT_PRO_SET_INITIAL_GAIN */ -+ {1, &oid_null_function}, /* 0xC4 OID_RT_PRO_SET_BB_RF_STANDBY_MODE */ -+ {1, &oid_null_function}, /* 0xC5 OID_RT_PRO_SET_BB_RF_SHUTDOWN_MODE */ -+ {1, &oid_null_function}, /* 0xC6 OID_RT_PRO_SET_TX_CHARGE_PUMP */ -+ {1, &oid_null_function}, /* 0xC7 OID_RT_PRO_SET_RX_CHARGE_PUMP */ -+ {1, &oid_rt_pro_rf_write_registry_hdl}, /* 0xC8 */ -+ {1, &oid_rt_pro_rf_read_registry_hdl}, /* 0xC9 */ -+ {1, &oid_null_function} /* 0xCA OID_RT_PRO_QUERY_RF_TYPE */ -+ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_03_00[] = { -+ {1, &oid_null_function}, /* 0x00 */ -+ {1, &oid_rt_get_connect_state_hdl}, /* 0x01 */ -+ {1, &oid_null_function}, /* 0x02 */ -+ {1, &oid_null_function}, /* 0x03 */ -+ {1, &oid_rt_set_default_key_id_hdl}, /* 0x04 */ -+ -+ -+}; -+ -+ -+/* ************** oid_rtl_seg_01_01 section start ************** */ -+ -+NDIS_STATUS oid_rt_pro_set_fw_dig_state_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ _irqL oldirql; -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ if (poid_par_priv->information_buf_len >= sizeof(struct setdig_parm)) { -+ /* DEBUG_ERR(("===> oid_rt_pro_set_fw_dig_state_hdl. type:0x%02x.\n",*((unsigned char*)poid_par_priv->information_buf ))); */ -+ if (!rtw_setfwdig_cmd(Adapter, *((unsigned char *)poid_par_priv->information_buf))) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ } else -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ _irqlevel_changed_(&oldirql, RAISE); -+#endif -+ return status; -+} -+/* ----------------------------------------------------------------------------- */ -+NDIS_STATUS oid_rt_pro_set_fw_ra_state_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ _irqL oldirql; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (poid_par_priv->information_buf_len >= sizeof(struct setra_parm)) { -+ /* DEBUG_ERR(("===> oid_rt_pro_set_fw_ra_state_hdl. type:0x%02x.\n",*((unsigned char*)poid_par_priv->information_buf ))); */ -+ if (!rtw_setfwra_cmd(Adapter, *((unsigned char *)poid_par_priv->information_buf))) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ } else -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ _irqlevel_changed_(&oldirql, RAISE); -+#endif -+ return status; -+} -+/* ----------------------------------------------------------------------------- */ -+NDIS_STATUS oid_rt_get_signal_quality_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ /* DEBUG_ERR(("<**********************oid_rt_get_signal_quality_hdl\n")); */ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+#if 0 -+ if (pMgntInfo->mAssoc || pMgntInfo->mIbss) { -+ ulInfo = pAdapter->RxStats.SignalQuality; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else { -+ ulInfo = 0xffffffff; /* It stands for -1 in 4-byte integer. */ -+ } -+ break; -+#endif -+ -+ return status; -+} -+ -+/* ------------------------------------------------------------------------------ */ -+ -+NDIS_STATUS oid_rt_get_small_packet_crc_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { -+ *(ULONG *)poid_par_priv->information_buf = padapter->recvpriv.rx_smallpacket_crcerr; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH; -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_middle_packet_crc_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { -+ *(ULONG *)poid_par_priv->information_buf = padapter->recvpriv.rx_middlepacket_crcerr; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH; -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_large_packet_crc_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { -+ *(ULONG *)poid_par_priv->information_buf = padapter->recvpriv.rx_largepacket_crcerr; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH; -+ -+ -+ return status; -+} -+ -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_tx_retry_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+NDIS_STATUS oid_rt_get_rx_retry_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_rx_total_packet_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { -+ *(u64 *)poid_par_priv->information_buf = padapter->recvpriv.rx_pkts + padapter->recvpriv.rx_drop; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH; -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_tx_beacon_ok_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+NDIS_STATUS oid_rt_get_tx_beacon_err_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_rx_icv_err_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ if (poid_par_priv->information_buf_len >= sizeof(u32)) { -+ /* _rtw_memcpy(*(uint *)poid_par_priv->information_buf,padapter->recvpriv.rx_icv_err,sizeof(u32)); */ -+ *(uint *)poid_par_priv->information_buf = padapter->recvpriv.rx_icv_err; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH ; -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_set_encryption_algorithm_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_preamble_mode_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ ULONG preamblemode = 0 ; -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { -+ if (padapter->registrypriv.preamble == PREAMBLE_LONG) -+ preamblemode = 0; -+ else if (padapter->registrypriv.preamble == PREAMBLE_AUTO) -+ preamblemode = 1; -+ else if (padapter->registrypriv.preamble == PREAMBLE_SHORT) -+ preamblemode = 2; -+ -+ -+ *(ULONG *)poid_par_priv->information_buf = preamblemode ; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH ; -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_ap_ip_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+ -+NDIS_STATUS oid_rt_get_channelplan_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ *(u16 *)poid_par_priv->information_buf = padapter->mlmepriv.ChannelPlan ; -+ -+ return status; -+} -+NDIS_STATUS oid_rt_set_channelplan_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ padapter->mlmepriv.ChannelPlan = *(u16 *)poid_par_priv->information_buf ; -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_set_preamble_mode_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ ULONG preamblemode = 0; -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { -+ preamblemode = *(ULONG *)poid_par_priv->information_buf ; -+ if (preamblemode == 0) -+ padapter->registrypriv.preamble = PREAMBLE_LONG; -+ else if (preamblemode == 1) -+ padapter->registrypriv.preamble = PREAMBLE_AUTO; -+ else if (preamblemode == 2) -+ padapter->registrypriv.preamble = PREAMBLE_SHORT; -+ -+ *(ULONG *)poid_par_priv->information_buf = preamblemode ; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH ; -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_set_bcn_intvl_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+NDIS_STATUS oid_rt_dedicate_probe_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_total_tx_bytes_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { -+ *(u64 *)poid_par_priv->information_buf = padapter->xmitpriv.tx_bytes; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH ; -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_total_rx_bytes_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { -+ /* _rtw_memcpy(*(uint *)poid_par_priv->information_buf,padapter->recvpriv.rx_icv_err,sizeof(u32)); */ -+ *(u64 *)poid_par_priv->information_buf = padapter->recvpriv.rx_bytes; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH ; -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_current_tx_power_level_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+NDIS_STATUS oid_rt_get_enc_key_mismatch_count_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+NDIS_STATUS oid_rt_get_enc_key_match_count_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+NDIS_STATUS oid_rt_get_channel_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ NDIS_802_11_CONFIGURATION *pnic_Config; -+ -+ ULONG channelnum; -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) -+ pnic_Config = &pmlmepriv->cur_network.network.Configuration; -+ else -+ pnic_Config = &padapter->registrypriv.dev_network.Configuration; -+ -+ channelnum = pnic_Config->DSConfig; -+ *(ULONG *)poid_par_priv->information_buf = channelnum; -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ -+ -+ return status; -+} -+NDIS_STATUS oid_rt_get_hardware_radio_off_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+NDIS_STATUS oid_rt_get_key_mismatch_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+NDIS_STATUS oid_rt_supported_wireless_mode_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ ULONG ulInfo = 0 ; -+ /* DEBUG_ERR(("<**********************oid_rt_supported_wireless_mode_hdl\n")); */ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { -+ ulInfo |= 0x0100; /* WIRELESS_MODE_B */ -+ ulInfo |= 0x0200; /* WIRELESS_MODE_G */ -+ ulInfo |= 0x0400; /* WIRELESS_MODE_A */ -+ -+ *(ULONG *) poid_par_priv->information_buf = ulInfo; -+ /* DEBUG_ERR(("<===oid_rt_supported_wireless_mode %x\n",ulInfo)); */ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH; -+ -+ return status; -+} -+NDIS_STATUS oid_rt_get_channel_list_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+NDIS_STATUS oid_rt_get_scan_in_progress_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+ -+ -+NDIS_STATUS oid_rt_forced_data_rate_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+NDIS_STATUS oid_rt_wireless_mode_for_scan_list_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+NDIS_STATUS oid_rt_get_bss_wireless_mode_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+ -+NDIS_STATUS oid_rt_scan_with_magic_packet_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+/* ************** oid_rtl_seg_01_01 section end ************** */ -+ -+/* ************** oid_rtl_seg_01_03 section start ************** */ -+NDIS_STATUS oid_rt_ap_get_associated_station_list_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+NDIS_STATUS oid_rt_ap_switch_into_ap_mode_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+NDIS_STATUS oid_rt_ap_supported_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+NDIS_STATUS oid_rt_ap_set_passphrase_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+ -+/* ************** oid_rtl_seg_01_03 section end ************** */ -+ -+/* **************** oid_rtl_seg_01_11 section start **************** */ -+NDIS_STATUS oid_rt_pro_rf_write_registry_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ _irqL oldirql; -+ /* DEBUG_ERR(("<**********************oid_rt_pro_rf_write_registry_hdl\n")); */ -+ if (poid_par_priv->type_of_oid != SET_OID) { /* QUERY_OID */ -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ if (poid_par_priv->information_buf_len == (sizeof(unsigned long) * 3)) { -+ /* RegOffsetValue - The offset of RF register to write. */ -+ /* RegDataWidth - The data width of RF register to write. */ -+ /* RegDataValue - The value to write. */ -+ /* RegOffsetValue = *((unsigned long*)InformationBuffer); */ -+ /* RegDataWidth = *((unsigned long*)InformationBuffer+1); */ -+ /* RegDataValue = *((unsigned long*)InformationBuffer+2); */ -+ if (!rtw_setrfreg_cmd(Adapter, -+ *(unsigned char *)poid_par_priv->information_buf, -+ (unsigned long)(*((unsigned long *)poid_par_priv->information_buf + 2)))) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH; -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ return status; -+} -+ -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_rf_read_registry_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ _irqL oldirql; -+ -+ /* DEBUG_ERR(("<**********************oid_rt_pro_rf_read_registry_hdl\n")); */ -+ if (poid_par_priv->type_of_oid != SET_OID) { /* QUERY_OID */ -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ if (poid_par_priv->information_buf_len == (sizeof(unsigned long) * 3)) { -+ if (Adapter->mppriv.act_in_progress == _TRUE) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ else { -+ /* init workparam */ -+ Adapter->mppriv.act_in_progress = _TRUE; -+ Adapter->mppriv.workparam.bcompleted = _FALSE; -+ Adapter->mppriv.workparam.act_type = MPT_READ_RF; -+ Adapter->mppriv.workparam.io_offset = *(unsigned long *)poid_par_priv->information_buf; -+ Adapter->mppriv.workparam.io_value = 0xcccccccc; -+ -+ /* RegOffsetValue - The offset of RF register to read. */ -+ /* RegDataWidth - The data width of RF register to read. */ -+ /* RegDataValue - The value to read. */ -+ /* RegOffsetValue = *((unsigned long*)InformationBuffer); */ -+ /* RegDataWidth = *((unsigned long*)InformationBuffer+1); */ -+ /* RegDataValue = *((unsigned long*)InformationBuffer+2); */ -+ if (!rtw_getrfreg_cmd(Adapter, -+ *(unsigned char *)poid_par_priv->information_buf, -+ (unsigned char *)&Adapter->mppriv.workparam.io_value)) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ } -+ -+ -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH; -+ _irqlevel_changed_(&oldirql, RAISE); -+#endif -+ return status; -+} -+ -+/* **************** oid_rtl_seg_01_11 section end**************** */ -+ -+ -+/* ************** oid_rtl_seg_03_00 section start ************** */ -+enum _CONNECT_STATE_ { -+ CHECKINGSTATUS, -+ ASSOCIATED, -+ ADHOCMODE, -+ NOTASSOCIATED -+}; -+ -+NDIS_STATUS oid_rt_get_connect_state_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ ULONG ulInfo; -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ /* nStatus==0 CheckingStatus */ -+ /* nStatus==1 Associated */ -+ /* nStatus==2 AdHocMode */ -+ /* nStatus==3 NotAssociated */ -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) -+ ulInfo = CHECKINGSTATUS; -+ else if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ ulInfo = ASSOCIATED; -+ else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) -+ ulInfo = ADHOCMODE; -+ else -+ ulInfo = NOTASSOCIATED ; -+ -+ *(ULONG *)poid_par_priv->information_buf = ulInfo; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+#if 0 -+ /* Rearrange the order to let the UI still shows connection when scan is in progress */ -+ if (pMgntInfo->mAssoc) -+ ulInfo = 1; -+ else if (pMgntInfo->mIbss) -+ ulInfo = 2; -+ else if (pMgntInfo->bScanInProgress) -+ ulInfo = 0; -+ else -+ ulInfo = 3; -+ ulInfoLen = sizeof(ULONG); -+#endif -+ -+ return status; -+} -+ -+NDIS_STATUS oid_rt_set_default_key_id_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+/* ************** oid_rtl_seg_03_00 section end ************** */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_ioctl_set.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ioctl_set.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_ioctl_set.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_ioctl_set.c 2018-02-11 21:44:27.137145933 +0200 -@@ -0,0 +1,1252 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_IOCTL_SET_C_ -+ -+#include -+#include -+ -+ -+extern void indicate_wx_scan_complete_event(_adapter *padapter); -+ -+#define IS_MAC_ADDRESS_BROADCAST(addr) \ -+ (\ -+ ((addr[0] == 0xff) && (addr[1] == 0xff) && \ -+ (addr[2] == 0xff) && (addr[3] == 0xff) && \ -+ (addr[4] == 0xff) && (addr[5] == 0xff)) ? _TRUE : _FALSE \ -+ ) -+ -+u8 rtw_validate_bssid(u8 *bssid) -+{ -+ u8 ret = _TRUE; -+ -+ if (is_zero_mac_addr(bssid) -+ || is_broadcast_mac_addr(bssid) -+ || is_multicast_mac_addr(bssid) -+ ) -+ ret = _FALSE; -+ -+ return ret; -+} -+ -+u8 rtw_validate_ssid(NDIS_802_11_SSID *ssid) -+{ -+ u8 i; -+ u8 ret = _TRUE; -+ -+ -+ if (ssid->SsidLength > 32) { -+ ret = _FALSE; -+ goto exit; -+ } -+ -+#ifdef CONFIG_VALIDATE_SSID -+ for (i = 0; i < ssid->SsidLength; i++) { -+ /* wifi, printable ascii code must be supported */ -+ if (!((ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e))) { -+ ret = _FALSE; -+ break; -+ } -+ } -+#endif /* CONFIG_VALIDATE_SSID */ -+ -+exit: -+ -+ -+ return ret; -+} -+ -+u8 rtw_do_join(_adapter *padapter); -+u8 rtw_do_join(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ u8 *pibss = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ u8 ret = _SUCCESS; -+ -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ -+ pmlmepriv->cur_network.join_res = -2; -+ -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ -+ pmlmepriv->pscanned = plist; -+ -+ pmlmepriv->to_join = _TRUE; -+ -+ if (_rtw_queue_empty(queue) == _TRUE) { -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+ /* when set_ssid/set_bssid for rtw_do_join(), but scanning queue is empty */ -+ /* we try to issue sitesurvey firstly */ -+ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _FALSE -+ || rtw_to_roam(padapter) > 0 -+ ) { -+ /* submit site_survey_cmd */ -+ ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); -+ if (_SUCCESS != ret) { -+ pmlmepriv->to_join = _FALSE; -+ } -+ } else { -+ pmlmepriv->to_join = _FALSE; -+ ret = _FAIL; -+ } -+ -+ goto exit; -+ } else { -+ int select_ret; -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ select_ret = rtw_select_and_join_from_scanned_queue(pmlmepriv); -+ if (select_ret == _SUCCESS) { -+ pmlmepriv->to_join = _FALSE; -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ } else { -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) { -+ /* submit createbss_cmd to change to a ADHOC_MASTER */ -+ -+ /* pmlmepriv->lock has been acquired by caller... */ -+ WLAN_BSSID_EX *pdev_network = &(padapter->registrypriv.dev_network); -+ -+ /*pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;*/ -+ init_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ -+ pibss = padapter->registrypriv.dev_network.MacAddress; -+ -+ _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); -+ -+ rtw_update_registrypriv_dev_network(padapter); -+ -+ rtw_generate_random_ibss(pibss); -+ -+ if (rtw_create_ibss_cmd(padapter, 0) != _SUCCESS) { -+ ret = _FALSE; -+ goto exit; -+ } -+ -+ pmlmepriv->to_join = _FALSE; -+ -+ -+ } else { -+ /* can't associate ; reset under-linking */ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+#if 0 -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)) { -+ if (_rtw_memcmp(pmlmepriv->cur_network.network.Ssid.Ssid, pmlmepriv->assoc_ssid.Ssid, pmlmepriv->assoc_ssid.SsidLength)) { -+ /* for funk to do roaming */ -+ /* funk will reconnect, but funk will not sitesurvey before reconnect */ -+ if (pmlmepriv->sitesurveyctrl.traffic_busy == _FALSE) -+ rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); -+ } -+ -+ } -+#endif -+ -+ /* when set_ssid/set_bssid for rtw_do_join(), but there are no desired bss in scanning queue */ -+ /* we try to issue sitesurvey firstly */ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _FALSE -+ || rtw_to_roam(padapter) > 0 -+ ) { -+ /* RTW_INFO("rtw_do_join() when no desired bss in scanning queue\n"); */ -+ ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); -+ if (_SUCCESS != ret) { -+ pmlmepriv->to_join = _FALSE; -+ } -+ } else { -+ ret = _FAIL; -+ pmlmepriv->to_join = _FALSE; -+ } -+ } -+ -+ } -+ -+ } -+ -+exit: -+ -+ return ret; -+} -+ -+#ifdef PLATFORM_WINDOWS -+u8 rtw_pnp_set_power_wakeup(_adapter *padapter) -+{ -+ u8 res = _SUCCESS; -+ -+ -+ -+ res = rtw_setstandby_cmd(padapter, 0); -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_pnp_set_power_sleep(_adapter *padapter) -+{ -+ u8 res = _SUCCESS; -+ -+ -+ /* DbgPrint("+rtw_pnp_set_power_sleep\n"); */ -+ -+ res = rtw_setstandby_cmd(padapter, 1); -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_set_802_11_reload_defaults(_adapter *padapter, NDIS_802_11_RELOAD_DEFAULTS reloadDefaults) -+{ -+ -+ -+ -+ /* SecClearAllKeys(Adapter); */ -+ /* 8711 CAM was not for En/Decrypt only */ -+ /* so, we can't clear all keys. */ -+ /* should we disable WPAcfg (ox0088) bit 1-2, instead of clear all CAM */ -+ -+ /* TO DO... */ -+ -+ -+ return _TRUE; -+} -+ -+u8 set_802_11_test(_adapter *padapter, NDIS_802_11_TEST *test) -+{ -+ u8 ret = _TRUE; -+ -+ -+ switch (test->Type) { -+ case 1: -+ NdisMIndicateStatus(padapter->hndis_adapter, NDIS_STATUS_MEDIA_SPECIFIC_INDICATION, (PVOID)&test->AuthenticationEvent, test->Length - 8); -+ NdisMIndicateStatusComplete(padapter->hndis_adapter); -+ break; -+ -+ case 2: -+ NdisMIndicateStatus(padapter->hndis_adapter, NDIS_STATUS_MEDIA_SPECIFIC_INDICATION, (PVOID)&test->RssiTrigger, sizeof(NDIS_802_11_RSSI)); -+ NdisMIndicateStatusComplete(padapter->hndis_adapter); -+ break; -+ -+ default: -+ ret = _FALSE; -+ break; -+ } -+ -+ -+ return ret; -+} -+ -+u8 rtw_set_802_11_pmkid(_adapter *padapter, NDIS_802_11_PMKID *pmkid) -+{ -+ u8 ret = _SUCCESS; -+ -+ return ret; -+} -+ -+#endif -+ -+u8 rtw_set_802_11_bssid(_adapter *padapter, u8 *bssid) -+{ -+ _irqL irqL; -+ u8 status = _SUCCESS; -+ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ RTW_PRINT("set bssid:%pM\n", bssid); -+ -+ if ((bssid[0] == 0x00 && bssid[1] == 0x00 && bssid[2] == 0x00 && bssid[3] == 0x00 && bssid[4] == 0x00 && bssid[5] == 0x00) || -+ (bssid[0] == 0xFF && bssid[1] == 0xFF && bssid[2] == 0xFF && bssid[3] == 0xFF && bssid[4] == 0xFF && bssid[5] == 0xFF)) { -+ status = _FAIL; -+ goto exit; -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+ RTW_INFO("Set BSSID under fw_state=0x%08x\n", get_fwstate(pmlmepriv)); -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) -+ goto handle_tkip_countermeasure; -+ else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) -+ goto release_mlme_lock; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED | WIFI_ADHOC_MASTER_STATE) == _TRUE) { -+ -+ if (_rtw_memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid, ETH_ALEN) == _TRUE) { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _FALSE) -+ goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */ -+ } else { -+ -+ rtw_disassoc_cmd(padapter, 0, _TRUE); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { -+ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ } -+ } -+ } -+ -+handle_tkip_countermeasure: -+ if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { -+ status = _FAIL; -+ goto release_mlme_lock; -+ } -+ -+ _rtw_memset(&pmlmepriv->assoc_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN); -+ pmlmepriv->assoc_by_bssid = _TRUE; -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) -+ pmlmepriv->to_join = _TRUE; -+ else -+ status = rtw_do_join(padapter); -+ -+release_mlme_lock: -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+exit: -+ -+ -+ return status; -+} -+ -+u8 rtw_set_802_11_ssid(_adapter *padapter, NDIS_802_11_SSID *ssid) -+{ -+ _irqL irqL; -+ u8 status = _SUCCESS; -+ u32 cur_time = 0; -+ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *pnetwork = &pmlmepriv->cur_network; -+ -+ -+ RTW_PRINT("set ssid [%s] fw_state=0x%08x\n", -+ ssid->Ssid, get_fwstate(pmlmepriv)); -+ -+ if (!rtw_is_hw_init_completed(padapter)) { -+ status = _FAIL; -+ goto exit; -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ RTW_INFO("Set SSID under fw_state=0x%08x\n", get_fwstate(pmlmepriv)); -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) -+ goto handle_tkip_countermeasure; -+ else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) -+ goto release_mlme_lock; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED | WIFI_ADHOC_MASTER_STATE) == _TRUE) { -+ -+ if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) && -+ (_rtw_memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid, ssid->SsidLength) == _TRUE)) { -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _FALSE)) { -+ -+ if (rtw_is_same_ibss(padapter, pnetwork) == _FALSE) { -+ /* if in WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE, create bss or rejoin again */ -+ rtw_disassoc_cmd(padapter, 0, _TRUE); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) { -+ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ } -+ } else { -+ goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */ -+ } -+ } -+#ifdef CONFIG_LPS -+ else -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_JOINBSS, 1); -+#endif -+ } else { -+ -+ rtw_disassoc_cmd(padapter, 0, _TRUE); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) { -+ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ } -+ } -+ } -+ -+handle_tkip_countermeasure: -+ if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { -+ status = _FAIL; -+ goto release_mlme_lock; -+ } -+ -+ if (rtw_validate_ssid(ssid) == _FALSE) { -+ status = _FAIL; -+ goto release_mlme_lock; -+ } -+ -+ _rtw_memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(NDIS_802_11_SSID)); -+ pmlmepriv->assoc_by_bssid = _FALSE; -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) -+ pmlmepriv->to_join = _TRUE; -+ else -+ status = rtw_do_join(padapter); -+ -+release_mlme_lock: -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+exit: -+ -+ -+ return status; -+ -+} -+ -+u8 rtw_set_802_11_connect(_adapter *padapter, u8 *bssid, NDIS_802_11_SSID *ssid) -+{ -+ _irqL irqL; -+ u8 status = _SUCCESS; -+ u32 cur_time = 0; -+ bool bssid_valid = _TRUE; -+ bool ssid_valid = _TRUE; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ if (!ssid || rtw_validate_ssid(ssid) == _FALSE) -+ ssid_valid = _FALSE; -+ -+ if (!bssid || rtw_validate_bssid(bssid) == _FALSE) -+ bssid_valid = _FALSE; -+ -+ if (ssid_valid == _FALSE && bssid_valid == _FALSE) { -+ RTW_INFO(FUNC_ADPT_FMT" ssid:%p, ssid_valid:%d, bssid:%p, bssid_valid:%d\n", -+ FUNC_ADPT_ARG(padapter), ssid, ssid_valid, bssid, bssid_valid); -+ status = _FAIL; -+ goto exit; -+ } -+ -+ if (!rtw_is_hw_init_completed(padapter)) { -+ status = _FAIL; -+ goto exit; -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ RTW_PRINT(FUNC_ADPT_FMT" fw_state=0x%08x\n", -+ FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) -+ goto handle_tkip_countermeasure; -+ else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) -+ goto release_mlme_lock; -+ -+handle_tkip_countermeasure: -+ if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { -+ status = _FAIL; -+ goto release_mlme_lock; -+ } -+ -+ if (ssid && ssid_valid) -+ _rtw_memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(NDIS_802_11_SSID)); -+ else -+ _rtw_memset(&pmlmepriv->assoc_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ -+ if (bssid && bssid_valid) { -+ _rtw_memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN); -+ pmlmepriv->assoc_by_bssid = _TRUE; -+ } else -+ pmlmepriv->assoc_by_bssid = _FALSE; -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) -+ pmlmepriv->to_join = _TRUE; -+ else -+ status = rtw_do_join(padapter); -+ -+release_mlme_lock: -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+exit: -+ -+ -+ return status; -+} -+ -+u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networktype) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE *pold_state = &(cur_network->network.InfrastructureMode); -+ -+ -+ -+ if (*pold_state != networktype) { -+ /* RTW_INFO("change mode, old_mode=%d, new_mode=%d, fw_state=0x%x\n", *pold_state, networktype, get_fwstate(pmlmepriv)); */ -+ -+ if (*pold_state == Ndis802_11APMode) { -+ /* change to other mode from Ndis802_11APMode */ -+ cur_network->join_res = -1; -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ stop_ap_mode(padapter); -+#endif -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || (*pold_state == Ndis802_11IBSS)) -+ rtw_disassoc_cmd(padapter, 0, _TRUE); -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) -+ rtw_free_assoc_resources(padapter, 1); -+ -+ if ((*pold_state == Ndis802_11Infrastructure) || (*pold_state == Ndis802_11IBSS)) { -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ rtw_indicate_disconnect(padapter, 0, _FALSE); /*will clr Linked_state; before this function, we must have checked whether issue dis-assoc_cmd or not*/ -+ } -+ } -+ -+ *pold_state = networktype; -+ -+ _clr_fwstate_(pmlmepriv, ~WIFI_NULL_STATE); -+ -+ switch (networktype) { -+ case Ndis802_11IBSS: -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ break; -+ -+ case Ndis802_11Infrastructure: -+ set_fwstate(pmlmepriv, WIFI_STATION_STATE); -+ break; -+ -+ case Ndis802_11APMode: -+ set_fwstate(pmlmepriv, WIFI_AP_STATE); -+#ifdef CONFIG_NATIVEAP_MLME -+ start_ap_mode(padapter); -+ /* rtw_indicate_connect(padapter); */ -+#endif -+ -+ break; -+ -+ case Ndis802_11AutoUnknown: -+ case Ndis802_11InfrastructureMax: -+ break; -+ case Ndis802_11Monitor: -+ set_fwstate(pmlmepriv, WIFI_MONITOR_STATE); -+ break; -+ } -+ -+ /* SecClearAllKeys(adapter); */ -+ -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ } -+ -+ -+ return _TRUE; -+} -+ -+ -+u8 rtw_set_802_11_disassociate(_adapter *padapter) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ -+ rtw_disassoc_cmd(padapter, 0, _TRUE); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ /* modify for CONFIG_IEEE80211W, none 11w can use it */ -+ rtw_free_assoc_resources_cmd(padapter); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) -+ RTW_INFO("%s(): rtw_pwr_wakeup fail !!!\n", __FUNCTION__); -+ } -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+ return _TRUE; -+} -+ -+#if 1 -+u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, NDIS_802_11_SSID *pssid, int ssid_max_num, struct rtw_ieee80211_channel *ch, int ch_num) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 res = _TRUE; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, ch, ch_num); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ return res; -+} -+ -+#else -+u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, NDIS_802_11_SSID *pssid, int ssid_max_num, struct rtw_ieee80211_channel *ch, int ch_num) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 res = _TRUE; -+ -+ -+ -+ if (padapter == NULL) { -+ res = _FALSE; -+ goto exit; -+ } -+ if (!rtw_is_hw_init_completed(padapter)) { -+ res = _FALSE; -+ goto exit; -+ } -+ -+ if ((check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) == _TRUE) || -+ (pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE)) { -+ /* Scan or linking is in progress, do nothing. */ -+ res = _TRUE; -+ -+ -+ } else { -+ if (rtw_is_scan_deny(padapter)) { -+ RTW_INFO(FUNC_ADPT_FMT": scan deny\n", FUNC_ADPT_ARG(padapter)); -+ indicate_wx_scan_complete_event(padapter); -+ return _SUCCESS; -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, NULL, 0, ch, ch_num); -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ } -+exit: -+ -+ -+ return res; -+} -+#endif -+u8 rtw_set_802_11_authentication_mode(_adapter *padapter, NDIS_802_11_AUTHENTICATION_MODE authmode) -+{ -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ int res; -+ u8 ret; -+ -+ -+ -+ psecuritypriv->ndisauthtype = authmode; -+ -+ -+ if (psecuritypriv->ndisauthtype > 3) -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (psecuritypriv->ndisauthtype == 6) -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; -+#endif -+ -+ res = rtw_set_auth(padapter, psecuritypriv); -+ -+ if (res == _SUCCESS) -+ ret = _TRUE; -+ else -+ ret = _FALSE; -+ -+ -+ return ret; -+} -+ -+u8 rtw_set_802_11_add_wep(_adapter *padapter, NDIS_802_11_WEP *wep) -+{ -+ -+ u8 bdefaultkey; -+ u8 btransmitkey; -+ sint keyid, res; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ u8 ret = _SUCCESS; -+ -+ -+ bdefaultkey = (wep->KeyIndex & 0x40000000) > 0 ? _FALSE : _TRUE; /* for ??? */ -+ btransmitkey = (wep->KeyIndex & 0x80000000) > 0 ? _TRUE : _FALSE; /* for ??? */ -+ keyid = wep->KeyIndex & 0x3fffffff; -+ -+ if (keyid >= 4) { -+ ret = _FALSE; -+ goto exit; -+ } -+ -+ switch (wep->KeyLength) { -+ case 5: -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ break; -+ case 13: -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ break; -+ default: -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ break; -+ } -+ -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[keyid].skey[0]), &(wep->KeyMaterial), wep->KeyLength); -+ -+ psecuritypriv->dot11DefKeylen[keyid] = wep->KeyLength; -+ -+ psecuritypriv->dot11PrivacyKeyIndex = keyid; -+ -+ -+ res = rtw_set_key(padapter, psecuritypriv, keyid, 1, _TRUE); -+ -+ if (res == _FAIL) -+ ret = _FALSE; -+exit: -+ -+ -+ return ret; -+ -+} -+ -+u8 rtw_set_802_11_remove_wep(_adapter *padapter, u32 keyindex) -+{ -+ -+ u8 ret = _SUCCESS; -+ -+ -+ if (keyindex >= 0x80000000 || padapter == NULL) { -+ -+ ret = _FALSE; -+ goto exit; -+ -+ } else { -+ int res; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ if (keyindex < 4) { -+ -+ _rtw_memset(&psecuritypriv->dot11DefKey[keyindex], 0, 16); -+ -+ res = rtw_set_key(padapter, psecuritypriv, keyindex, 0, _TRUE); -+ -+ psecuritypriv->dot11DefKeylen[keyindex] = 0; -+ -+ if (res == _FAIL) -+ ret = _FAIL; -+ -+ } else -+ ret = _FAIL; -+ -+ } -+ -+exit: -+ -+ -+ return ret; -+ -+} -+ -+u8 rtw_set_802_11_add_key(_adapter *padapter, NDIS_802_11_KEY *key) -+{ -+ -+ uint encryptionalgo; -+ u8 *pbssid; -+ struct sta_info *stainfo; -+ u8 bgroup = _FALSE; -+ u8 bgrouptkey = _FALSE;/* can be remove later */ -+ u8 ret = _SUCCESS; -+ -+ -+ if (((key->KeyIndex & 0x80000000) == 0) && ((key->KeyIndex & 0x40000000) > 0)) { -+ -+ /* It is invalid to clear bit 31 and set bit 30. If the miniport driver encounters this combination, */ -+ /* it must fail the request and return NDIS_STATUS_INVALID_DATA. */ -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if (key->KeyIndex & 0x40000000) { -+ /* Pairwise key */ -+ -+ -+ pbssid = get_bssid(&padapter->mlmepriv); -+ stainfo = rtw_get_stainfo(&padapter->stapriv, pbssid); -+ -+ if ((stainfo != NULL) && (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X)) { -+ encryptionalgo = stainfo->dot118021XPrivacy; -+ } else { -+ encryptionalgo = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ -+ -+ -+ -+ if (key->KeyIndex & 0x000000FF) { -+ /* The key index is specified in the lower 8 bits by values of zero to 255. */ -+ /* The key index should be set to zero for a Pairwise key, and the driver should fail with */ -+ /* NDIS_STATUS_INVALID_DATA if the lower 8 bits is not zero */ -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* check BSSID */ -+ if (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == _TRUE) { -+ -+ ret = _FALSE; -+ goto exit; -+ } -+ -+ /* Check key length for TKIP. */ -+ /* if(encryptionAlgorithm == RT_ENC_TKIP_ENCRYPTION && key->KeyLength != 32) */ -+ if ((encryptionalgo == _TKIP_) && (key->KeyLength != 32)) { -+ ret = _FAIL; -+ goto exit; -+ -+ } -+ -+ /* Check key length for AES. */ -+ if ((encryptionalgo == _AES_) && (key->KeyLength != 16)) { -+ /* For our supplicant, EAPPkt9x.vxd, cannot differentiate TKIP and AES case. */ -+ if (key->KeyLength == 32) -+ key->KeyLength = 16; -+ else { -+ ret = _FAIL; -+ goto exit; -+ } -+ } -+ -+ /* Check key length for WEP. For NDTEST, 2005.01.27, by rcnjko. -> modify checking condition*/ -+ if (((encryptionalgo == _WEP40_) && (key->KeyLength != 5)) || ((encryptionalgo == _WEP104_) && (key->KeyLength != 13))) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ bgroup = _FALSE; -+ -+ /* Check the pairwise key. Added by Annie, 2005-07-06. */ -+ -+ } else { -+ /* Group key - KeyIndex(BIT30==0) */ -+ -+ -+ /* when add wep key through add key and didn't assigned encryption type before */ -+ if ((padapter->securitypriv.ndisauthtype <= 3) && (padapter->securitypriv.dot118021XGrpPrivacy == 0)) { -+ -+ switch (key->KeyLength) { -+ case 5: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; -+ break; -+ case 13: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; -+ break; -+ default: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ break; -+ } -+ -+ encryptionalgo = padapter->securitypriv.dot11PrivacyAlgrthm; -+ -+ -+ } else { -+ encryptionalgo = padapter->securitypriv.dot118021XGrpPrivacy; -+ -+ } -+ -+ if ((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE) == _TRUE) && (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == _FALSE)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* Check key length for TKIP */ -+ if ((encryptionalgo == _TKIP_) && (key->KeyLength != 32)) { -+ -+ ret = _FAIL; -+ goto exit; -+ -+ } else if (encryptionalgo == _AES_ && (key->KeyLength != 16 && key->KeyLength != 32)) { -+ -+ /* Check key length for AES */ -+ /* For NDTEST, we allow keylen=32 in this case. 2005.01.27, by rcnjko. */ -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* Change the key length for EAPPkt9x.vxd. Added by Annie, 2005-11-03. */ -+ if ((encryptionalgo == _AES_) && (key->KeyLength == 32)) { -+ key->KeyLength = 16; -+ } -+ -+ if (key->KeyIndex & 0x8000000) /* error ??? 0x8000_0000 */ -+ bgrouptkey = _TRUE; -+ -+ if ((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE) == _TRUE) && (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _TRUE)) -+ bgrouptkey = _TRUE; -+ -+ bgroup = _TRUE; -+ -+ -+ } -+ -+ /* If WEP encryption algorithm, just call rtw_set_802_11_add_wep(). */ -+ if ((padapter->securitypriv.dot11AuthAlgrthm != dot11AuthAlgrthm_8021X) && (encryptionalgo == _WEP40_ || encryptionalgo == _WEP104_)) { -+ u8 ret; -+ u32 keyindex; -+ u32 len = FIELD_OFFSET(NDIS_802_11_KEY, KeyMaterial) + key->KeyLength; -+ NDIS_802_11_WEP *wep = &padapter->securitypriv.ndiswep; -+ -+ -+ wep->Length = len; -+ keyindex = key->KeyIndex & 0x7fffffff; -+ wep->KeyIndex = keyindex ; -+ wep->KeyLength = key->KeyLength; -+ -+ -+ _rtw_memcpy(wep->KeyMaterial, key->KeyMaterial, key->KeyLength); -+ _rtw_memcpy(&(padapter->securitypriv.dot11DefKey[keyindex].skey[0]), key->KeyMaterial, key->KeyLength); -+ -+ padapter->securitypriv.dot11DefKeylen[keyindex] = key->KeyLength; -+ padapter->securitypriv.dot11PrivacyKeyIndex = keyindex; -+ -+ ret = rtw_set_802_11_add_wep(padapter, wep); -+ -+ goto exit; -+ -+ } -+ -+ if (key->KeyIndex & 0x20000000) { -+ /* SetRSC */ -+ if (bgroup == _TRUE) { -+ NDIS_802_11_KEY_RSC keysrc = key->KeyRSC & 0x00FFFFFFFFFFFFULL; -+ _rtw_memcpy(&padapter->securitypriv.dot11Grprxpn, &keysrc, 8); -+ } else { -+ NDIS_802_11_KEY_RSC keysrc = key->KeyRSC & 0x00FFFFFFFFFFFFULL; -+ _rtw_memcpy(&padapter->securitypriv.dot11Grptxpn, &keysrc, 8); -+ } -+ -+ } -+ -+ /* Indicate this key idx is used for TX */ -+ /* Save the key in KeyMaterial */ -+ if (bgroup == _TRUE) { /* Group transmit key */ -+ int res; -+ -+ if (bgrouptkey == _TRUE) -+ padapter->securitypriv.dot118021XGrpKeyid = (u8)key->KeyIndex; -+ -+ if ((key->KeyIndex & 0x3) == 0) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memset(&padapter->securitypriv.dot118021XGrpKey[(u8)((key->KeyIndex) & 0x03)], 0, 16); -+ _rtw_memset(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], 0, 16); -+ _rtw_memset(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], 0, 16); -+ -+ if ((key->KeyIndex & 0x10000000)) { -+ _rtw_memcpy(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 16, 8); -+ _rtw_memcpy(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 24, 8); -+ -+ -+ } else { -+ _rtw_memcpy(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 24, 8); -+ _rtw_memcpy(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 16, 8); -+ -+ -+ } -+ -+ /* set group key by index */ -+ _rtw_memcpy(&padapter->securitypriv.dot118021XGrpKey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial, key->KeyLength); -+ -+ key->KeyIndex = key->KeyIndex & 0x03; -+ -+ padapter->securitypriv.binstallGrpkey = _TRUE; -+ -+ padapter->securitypriv.bcheck_grpkey = _FALSE; -+ -+ -+ res = rtw_set_key(padapter, &padapter->securitypriv, key->KeyIndex, 1, _TRUE); -+ -+ if (res == _FAIL) -+ ret = _FAIL; -+ -+ goto exit; -+ -+ } else { /* Pairwise Key */ -+ u8 res; -+ -+ pbssid = get_bssid(&padapter->mlmepriv); -+ stainfo = rtw_get_stainfo(&padapter->stapriv , pbssid); -+ -+ if (stainfo != NULL) { -+ _rtw_memset(&stainfo->dot118021x_UncstKey, 0, 16); /* clear keybuffer */ -+ -+ _rtw_memcpy(&stainfo->dot118021x_UncstKey, key->KeyMaterial, 16); -+ -+ if (encryptionalgo == _TKIP_) { -+ padapter->securitypriv.busetkipkey = _FALSE; -+ -+ /* _set_timer(&padapter->securitypriv.tkip_timer, 50); */ -+ -+ -+ /* if TKIP, save the Receive/Transmit MIC key in KeyMaterial[128-255] */ -+ if ((key->KeyIndex & 0x10000000)) { -+ _rtw_memcpy(&stainfo->dot11tkiptxmickey, key->KeyMaterial + 16, 8); -+ _rtw_memcpy(&stainfo->dot11tkiprxmickey, key->KeyMaterial + 24, 8); -+ -+ } else { -+ _rtw_memcpy(&stainfo->dot11tkiptxmickey, key->KeyMaterial + 24, 8); -+ _rtw_memcpy(&stainfo->dot11tkiprxmickey, key->KeyMaterial + 16, 8); -+ -+ } -+ -+ } else if (encryptionalgo == _AES_) { -+ -+ } -+ -+ -+ /* Set key to CAM through H2C command */ -+#if 0 -+ if (bgrouptkey) { /* never go to here */ -+ res = rtw_setstakey_cmd(padapter, stainfo, GROUP_KEY, _TRUE); -+ } else { -+ res = rtw_setstakey_cmd(padapter, stainfo, UNICAST_KEY, _TRUE); -+ } -+#else -+ -+ res = rtw_setstakey_cmd(padapter, stainfo, UNICAST_KEY, _TRUE); -+#endif -+ -+ if (res == _FALSE) -+ ret = _FAIL; -+ -+ } -+ -+ } -+ -+exit: -+ -+ -+ return ret; -+} -+ -+u8 rtw_set_802_11_remove_key(_adapter *padapter, NDIS_802_11_REMOVE_KEY *key) -+{ -+ -+ uint encryptionalgo; -+ u8 *pbssid; -+ struct sta_info *stainfo; -+ u8 bgroup = (key->KeyIndex & 0x4000000) > 0 ? _FALSE : _TRUE; -+ u8 keyIndex = (u8)key->KeyIndex & 0x03; -+ u8 ret = _SUCCESS; -+ -+ -+ if ((key->KeyIndex & 0xbffffffc) > 0) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if (bgroup == _TRUE) { -+ encryptionalgo = padapter->securitypriv.dot118021XGrpPrivacy; -+ /* clear group key by index */ -+ /* NdisZeroMemory(Adapter->MgntInfo.SecurityInfo.KeyBuf[keyIndex], MAX_WEP_KEY_LEN); */ -+ /* Adapter->MgntInfo.SecurityInfo.KeyLen[keyIndex] = 0; */ -+ -+ _rtw_memset(&padapter->securitypriv.dot118021XGrpKey[keyIndex], 0, 16); -+ -+ /* ! \todo Send a H2C Command to Firmware for removing this Key in CAM Entry. */ -+ -+ } else { -+ -+ pbssid = get_bssid(&padapter->mlmepriv); -+ stainfo = rtw_get_stainfo(&padapter->stapriv , pbssid); -+ if (stainfo != NULL) { -+ encryptionalgo = stainfo->dot118021XPrivacy; -+ -+ /* clear key by BSSID */ -+ _rtw_memset(&stainfo->dot118021x_UncstKey, 0, 16); -+ -+ /* ! \todo Send a H2C Command to Firmware for disable this Key in CAM Entry. */ -+ -+ } else { -+ ret = _FAIL; -+ goto exit; -+ } -+ } -+ -+exit: -+ -+ -+ return _TRUE; -+ -+} -+ -+/* -+* rtw_get_cur_max_rate - -+* @adapter: pointer to _adapter structure -+* -+* Return 0 or 100Kbps -+*/ -+u16 rtw_get_cur_max_rate(_adapter *adapter) -+{ -+ int i = 0; -+ u16 rate = 0, max_rate = 0; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ struct sta_info *psta = NULL; -+ u8 short_GI = 0; -+#ifdef CONFIG_80211N_HT -+ u8 rf_type = 0; -+#endif -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (adapter->registrypriv.mp_mode == 1) { -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) -+ return 0; -+ } -+#endif -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) != _TRUE) -+ && (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != _TRUE)) -+ return 0; -+ -+ psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) -+ return 0; -+ -+ short_GI = query_ra_short_GI(psta, psta->bw_mode); -+ -+#ifdef CONFIG_80211N_HT -+ if (IsSupportedHT(psta->wireless_mode)) { -+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ max_rate = rtw_mcs_rate( -+ rf_type, -+ ((psta->bw_mode == CHANNEL_WIDTH_40) ? 1 : 0), -+ short_GI, -+ psta->htpriv.ht_cap.supp_mcs_set -+ ); -+ } -+#ifdef CONFIG_80211AC_VHT -+ else if (IsSupportedVHT(psta->wireless_mode)) -+ max_rate = ((rtw_vht_mcs_to_data_rate(psta->bw_mode, short_GI, pmlmepriv->vhtpriv.vht_highest_rate) + 1) >> 1) * 10; -+#endif /* CONFIG_80211AC_VHT */ -+ else -+#endif /* CONFIG_80211N_HT */ -+ { -+ while ((pcur_bss->SupportedRates[i] != 0) && (pcur_bss->SupportedRates[i] != 0xFF)) { -+ rate = pcur_bss->SupportedRates[i] & 0x7F; -+ if (rate > max_rate) -+ max_rate = rate; -+ i++; -+ } -+ -+ max_rate = max_rate * 10 / 2; -+ } -+ -+ return max_rate; -+} -+ -+/* -+* rtw_set_scan_mode - -+* @adapter: pointer to _adapter structure -+* @scan_mode: -+* -+* Return _SUCCESS or _FAIL -+*/ -+int rtw_set_scan_mode(_adapter *adapter, RT_SCAN_TYPE scan_mode) -+{ -+ if (scan_mode != SCAN_ACTIVE && scan_mode != SCAN_PASSIVE) -+ return _FAIL; -+ -+ adapter->mlmepriv.scan_mode = scan_mode; -+ -+ return _SUCCESS; -+} -+ -+/* -+* rtw_set_channel_plan - -+* @adapter: pointer to _adapter structure -+* @channel_plan: -+* -+* Return _SUCCESS or _FAIL -+*/ -+int rtw_set_channel_plan(_adapter *adapter, u8 channel_plan) -+{ -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ /* handle by cmd_thread to sync with scan operation */ -+ return rtw_set_chplan_cmd(adapter, RTW_CMDF_WAIT_ACK, channel_plan, 1); -+} -+ -+/* -+* rtw_set_country - -+* @adapter: pointer to _adapter structure -+* @country_code: string of country code -+* -+* Return _SUCCESS or _FAIL -+*/ -+int rtw_set_country(_adapter *adapter, const char *country_code) -+{ -+#ifdef CONFIG_RTW_IOCTL_SET_COUNTRY -+ return rtw_set_country_cmd(adapter, RTW_CMDF_WAIT_ACK, country_code, 1); -+#else -+ return _FAIL; -+#endif -+} -+ -+/* -+* rtw_set_band - -+* @adapter: pointer to _adapter structure -+* @band: band to set -+* -+* Return _SUCCESS or _FAIL -+*/ -+int rtw_set_band(_adapter *adapter, u8 band) -+{ -+ if (rtw_band_valid(band)) { -+ RTW_INFO(FUNC_ADPT_FMT" band:%d\n", FUNC_ADPT_ARG(adapter), band); -+ adapter->setband = band; -+ return _SUCCESS; -+ } -+ -+ RTW_PRINT(FUNC_ADPT_FMT" band:%d fail\n", FUNC_ADPT_ARG(adapter), band); -+ return _FAIL; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_iol.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_iol.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_iol.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_iol.c 2018-02-11 21:44:27.137145933 +0200 -@@ -0,0 +1,387 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include -+ -+#ifdef CONFIG_IOL -+struct xmit_frame *rtw_IOL_accquire_xmit_frame(ADAPTER *adapter) -+{ -+ struct xmit_frame *xmit_frame; -+ struct xmit_buf *xmitbuf; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv = &(adapter->xmitpriv); -+ -+#if 1 -+ xmit_frame = rtw_alloc_xmitframe(pxmitpriv); -+ if (xmit_frame == NULL) { -+ RTW_INFO("%s rtw_alloc_xmitframe return null\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ xmitbuf = rtw_alloc_xmitbuf(pxmitpriv); -+ if (xmitbuf == NULL) { -+ RTW_INFO("%s rtw_alloc_xmitbuf return null\n", __FUNCTION__); -+ rtw_free_xmitframe(pxmitpriv, xmit_frame); -+ xmit_frame = NULL; -+ goto exit; -+ } -+ -+ xmit_frame->frame_tag = MGNT_FRAMETAG; -+ xmit_frame->pxmitbuf = xmitbuf; -+ xmit_frame->buf_addr = xmitbuf->pbuf; -+ xmitbuf->priv_data = xmit_frame; -+ -+ pattrib = &xmit_frame->attrib; -+ update_mgntframe_attrib(adapter, pattrib); -+ pattrib->qsel = QSLT_BEACON;/* Beacon */ -+ pattrib->subtype = WIFI_BEACON; -+ pattrib->pktlen = pattrib->last_txcmdsz = 0; -+ -+#else -+ xmit_frame = alloc_mgtxmitframe(pxmitpriv); -+ if (xmit_frame == NULL) -+ RTW_INFO("%s alloc_mgtxmitframe return null\n", __FUNCTION__); -+ else { -+ pattrib = &xmit_frame->attrib; -+ update_mgntframe_attrib(adapter, pattrib); -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->pktlen = pattrib->last_txcmdsz = 0; -+ } -+#endif -+ -+exit: -+ return xmit_frame; -+} -+ -+ -+int rtw_IOL_append_cmds(struct xmit_frame *xmit_frame, u8 *IOL_cmds, u32 cmd_len) -+{ -+ struct pkt_attrib *pattrib = &xmit_frame->attrib; -+ u16 buf_offset; -+ u32 ori_len; -+ -+ buf_offset = TXDESC_OFFSET; -+ ori_len = buf_offset + pattrib->pktlen; -+ -+ /* check if the io_buf can accommodate new cmds */ -+ if (ori_len + cmd_len + 8 > MAX_XMITBUF_SZ) { -+ RTW_INFO("%s %u is large than MAX_XMITBUF_SZ:%u, can't accommodate new cmds\n", __FUNCTION__ -+ , ori_len + cmd_len + 8, MAX_XMITBUF_SZ); -+ return _FAIL; -+ } -+ -+ _rtw_memcpy(xmit_frame->buf_addr + buf_offset + pattrib->pktlen, IOL_cmds, cmd_len); -+ pattrib->pktlen += cmd_len; -+ pattrib->last_txcmdsz += cmd_len; -+ -+ /* RTW_INFO("%s ori:%u + cmd_len:%u = %u\n", __FUNCTION__, ori_len, cmd_len, buf_offset+pattrib->pktlen); */ -+ -+ return _SUCCESS; -+} -+ -+bool rtw_IOL_applied(ADAPTER *adapter) -+{ -+ if (1 == adapter->registrypriv.fw_iol) -+ return _TRUE; -+ -+#ifdef CONFIG_USB_HCI -+ if ((2 == adapter->registrypriv.fw_iol) && (IS_FULL_SPEED_USB(adapter))) -+ return _TRUE; -+#endif -+ -+ return _FALSE; -+} -+ -+int rtw_IOL_exec_cmds_sync(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt) -+{ -+ return rtw_hal_iol_cmd(adapter, xmit_frame, max_wating_ms, bndy_cnt); -+} -+ -+#ifdef CONFIG_IOL_NEW_GENERATION -+int rtw_IOL_append_LLT_cmd(struct xmit_frame *xmit_frame, u8 page_boundary) -+{ -+ return _SUCCESS; -+} -+int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, u8 mask) -+{ -+ struct ioreg_cfg cmd = {8, IOREG_CMD_WB_REG, 0x0, 0x0, 0x0}; -+ -+ /* RTW_PUT_LE16((u8*)&cmd.address, addr); */ -+ /* RTW_PUT_LE32((u8*)&cmd.value, (u32)value); */ -+ cmd.address = cpu_to_le16(addr); -+ cmd.data = cpu_to_le32(value); -+ -+ if (mask != 0xFF) { -+ cmd.length = 12; -+ /* RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); */ -+ cmd.mask = cpu_to_le32(mask); -+ } -+ -+ /* RTW_INFO("%s addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FUNCTION__, addr,value,mask); */ -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, cmd.length); -+ -+} -+int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, u16 mask) -+{ -+ struct ioreg_cfg cmd = {8, IOREG_CMD_WW_REG, 0x0, 0x0, 0x0}; -+ -+ /* RTW_PUT_LE16((u8*)&cmd.address, addr); */ -+ /* RTW_PUT_LE32((u8*)&cmd.value, (u32)value); */ -+ cmd.address = cpu_to_le16(addr); -+ cmd.data = cpu_to_le32(value); -+ -+ if (mask != 0xFFFF) { -+ cmd.length = 12; -+ /* RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); */ -+ cmd.mask = cpu_to_le32(mask); -+ } -+ -+ /* RTW_INFO("%s addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FUNCTION__, addr,value,mask); */ -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, cmd.length); -+ -+} -+int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, u32 mask) -+{ -+ struct ioreg_cfg cmd = {8, IOREG_CMD_WD_REG, 0x0, 0x0, 0x0}; -+ -+ /* RTW_PUT_LE16((u8*)&cmd.address, addr); */ -+ /* RTW_PUT_LE32((u8*)&cmd.value, (u32)value); */ -+ cmd.address = cpu_to_le16(addr); -+ cmd.data = cpu_to_le32(value); -+ -+ if (mask != 0xFFFFFFFF) { -+ cmd.length = 12; -+ /* RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); */ -+ cmd.mask = cpu_to_le32(mask); -+ } -+ -+ /* RTW_INFO("%s addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FU2NCTION__, addr,value,mask); */ -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, cmd.length); -+ -+} -+ -+int _rtw_IOL_append_WRF_cmd(struct xmit_frame *xmit_frame, u8 rf_path, u16 addr, u32 value, u32 mask) -+{ -+ struct ioreg_cfg cmd = {8, IOREG_CMD_W_RF, 0x0, 0x0, 0x0}; -+ -+ /* RTW_PUT_LE16((u8*)&cmd.address, addr); */ -+ /* RTW_PUT_LE32((u8*)&cmd.value, (u32)value); */ -+ cmd.address = (rf_path << 8) | ((addr) & 0xFF); -+ cmd.data = cpu_to_le32(value); -+ -+ if (mask != 0x000FFFFF) { -+ cmd.length = 12; -+ /* RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); */ -+ cmd.mask = cpu_to_le32(mask); -+ } -+ -+ /* RTW_INFO("%s rf_path:0x%02x addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FU2NCTION__,rf_path, addr,value,mask); */ -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, cmd.length); -+ -+} -+ -+ -+ -+int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us) -+{ -+ struct ioreg_cfg cmd = {4, IOREG_CMD_DELAY_US, 0x0, 0x0, 0x0}; -+ /* RTW_PUT_LE16((u8*)&cmd.address, us); */ -+ cmd.address = cpu_to_le16(us); -+ -+ /* RTW_INFO("%s %u\n", __FUNCTION__, us); */ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 4); -+} -+ -+int rtw_IOL_append_DELAY_MS_cmd(struct xmit_frame *xmit_frame, u16 ms) -+{ -+ struct ioreg_cfg cmd = {4, IOREG_CMD_DELAY_US, 0x0, 0x0, 0x0}; -+ -+ /* RTW_PUT_LE16((u8*)&cmd.address, ms); */ -+ cmd.address = cpu_to_le16(ms); -+ -+ /* RTW_INFO("%s %u\n", __FUNCTION__, ms); */ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 4); -+} -+int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame) -+{ -+ struct ioreg_cfg cmd = {4, IOREG_CMD_END, 0xFFFF, 0xFF, 0x0}; -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 4); -+ -+} -+ -+u8 rtw_IOL_cmd_boundary_handle(struct xmit_frame *pxmit_frame) -+{ -+ u8 is_cmd_bndy = _FALSE; -+ if (((pxmit_frame->attrib.pktlen + 32) % 256) + 8 >= 256) { -+ rtw_IOL_append_END_cmd(pxmit_frame); -+ pxmit_frame->attrib.pktlen = ((((pxmit_frame->attrib.pktlen + 32) / 256) + 1) * 256); -+ -+ /* printk("==> %s, pktlen(%d)\n",__FUNCTION__,pxmit_frame->attrib.pktlen); */ -+ pxmit_frame->attrib.last_txcmdsz = pxmit_frame->attrib.pktlen; -+ is_cmd_bndy = _TRUE; -+ } -+ return is_cmd_bndy; -+} -+ -+void rtw_IOL_cmd_buf_dump(ADAPTER *Adapter, int buf_len, u8 *pbuf) -+{ -+ int i; -+ int j = 1; -+ -+ printk("###### %s ######\n", __FUNCTION__); -+ for (i = 0; i < buf_len; i++) { -+ printk("%02x-", *(pbuf + i)); -+ -+ if (j % 32 == 0) -+ printk("\n"); -+ j++; -+ } -+ printk("\n"); -+ printk("============= ioreg_cmd len = %d ===============\n", buf_len); -+} -+ -+ -+#else /* CONFIG_IOL_NEW_GENERATION */ -+int rtw_IOL_append_LLT_cmd(struct xmit_frame *xmit_frame, u8 page_boundary) -+{ -+ IOL_CMD cmd = {0x0, IOL_CMD_LLT, 0x0, 0x0}; -+ -+ RTW_PUT_BE32((u8 *)&cmd.value, (u32)page_boundary); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 8); -+} -+ -+int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value) -+{ -+ IOL_CMD cmd = {0x0, IOL_CMD_WB_REG, 0x0, 0x0}; -+ -+ RTW_PUT_BE16((u8 *)&cmd.address, (u16)addr); -+ RTW_PUT_BE32((u8 *)&cmd.value, (u32)value); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 8); -+} -+ -+int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value) -+{ -+ IOL_CMD cmd = {0x0, IOL_CMD_WW_REG, 0x0, 0x0}; -+ -+ RTW_PUT_BE16((u8 *)&cmd.address, (u16)addr); -+ RTW_PUT_BE32((u8 *)&cmd.value, (u32)value); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 8); -+} -+ -+int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value) -+{ -+ IOL_CMD cmd = {0x0, IOL_CMD_WD_REG, 0x0, 0x0}; -+ u8 *pos = (u8 *)&cmd; -+ -+ RTW_PUT_BE16((u8 *)&cmd.address, (u16)addr); -+ RTW_PUT_BE32((u8 *)&cmd.value, (u32)value); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 8); -+} -+ -+#ifdef DBG_IO -+int dbg_rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 1)) -+ RTW_INFO("DBG_IO %s:%d IOL_WB(0x%04x, 0x%02x)\n", caller, line, addr, value); -+ -+ return _rtw_IOL_append_WB_cmd(xmit_frame, addr, value); -+} -+ -+int dbg_rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 2)) -+ RTW_INFO("DBG_IO %s:%d IOL_WW(0x%04x, 0x%04x)\n", caller, line, addr, value); -+ -+ return _rtw_IOL_append_WW_cmd(xmit_frame, addr, value); -+} -+ -+int dbg_rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 4)) -+ RTW_INFO("DBG_IO %s:%d IOL_WD(0x%04x, 0x%08x)\n", caller, line, addr, value); -+ -+ return _rtw_IOL_append_WD_cmd(xmit_frame, addr, value); -+} -+#endif -+ -+int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us) -+{ -+ IOL_CMD cmd = {0x0, IOL_CMD_DELAY_US, 0x0, 0x0}; -+ -+ RTW_PUT_BE32((u8 *)&cmd.value, (u32)us); -+ -+ /* RTW_INFO("%s %u\n", __FUNCTION__, us); */ -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 8); -+} -+ -+int rtw_IOL_append_DELAY_MS_cmd(struct xmit_frame *xmit_frame, u16 ms) -+{ -+ IOL_CMD cmd = {0x0, IOL_CMD_DELAY_MS, 0x0, 0x0}; -+ -+ RTW_PUT_BE32((u8 *)&cmd.value, (u32)ms); -+ -+ /* RTW_INFO("%s %u\n", __FUNCTION__, ms); */ -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&cmd, 8); -+} -+ -+int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame) -+{ -+ IOL_CMD end_cmd = {0x0, IOL_CMD_END, 0x0, 0x0}; -+ -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8 *)&end_cmd, 8); -+ -+} -+ -+int rtw_IOL_exec_cmd_array_sync(PADAPTER adapter, u8 *IOL_cmds, u32 cmd_num, u32 max_wating_ms) -+{ -+ struct xmit_frame *xmit_frame; -+ -+ xmit_frame = rtw_IOL_accquire_xmit_frame(adapter); -+ if (xmit_frame == NULL) -+ return _FAIL; -+ -+ if (rtw_IOL_append_cmds(xmit_frame, IOL_cmds, cmd_num << 3) == _FAIL) -+ return _FAIL; -+ -+ return rtw_IOL_exec_cmds_sync(adapter, xmit_frame, max_wating_ms, 0); -+} -+ -+int rtw_IOL_exec_empty_cmds_sync(ADAPTER *adapter, u32 max_wating_ms) -+{ -+ IOL_CMD end_cmd = {0x0, IOL_CMD_END, 0x0, 0x0}; -+ return rtw_IOL_exec_cmd_array_sync(adapter, (u8 *)&end_cmd, 1, max_wating_ms); -+} -+#endif /* CONFIG_IOL_NEW_GENERATION */ -+ -+ -+ -+ -+#endif /* CONFIG_IOL */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_mem.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mem.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_mem.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mem.c 2018-02-11 21:44:27.137145933 +0200 -@@ -0,0 +1,114 @@ -+ -+#include -+#include -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Realtek Wireless Lan Driver"); -+MODULE_AUTHOR("Realtek Semiconductor Corp."); -+MODULE_VERSION("DRIVERVERSION"); -+ -+struct sk_buff_head rtk_skb_mem_q; -+struct u8 *rtk_buf_mem[NR_RECVBUFF]; -+ -+struct u8 *rtw_get_buf_premem(int index) -+{ -+ printk("%s, rtk_buf_mem index : %d\n", __func__, index); -+ return rtk_buf_mem[index]; -+} -+ -+u16 rtw_rtkm_get_buff_size(void) -+{ -+ return MAX_RTKM_RECVBUF_SZ; -+} -+EXPORT_SYMBOL(rtw_rtkm_get_buff_size); -+ -+u8 rtw_rtkm_get_nr_recv_skb(void) -+{ -+ return MAX_RTKM_NR_PREALLOC_RECV_SKB; -+} -+EXPORT_SYMBOL(rtw_rtkm_get_nr_recv_skb); -+ -+struct sk_buff *rtw_alloc_skb_premem(u16 in_size) -+{ -+ struct sk_buff *skb = NULL; -+ -+ if (in_size > MAX_RTKM_RECVBUF_SZ) { -+ pr_info("warning %s: driver buffer size(%d) > rtkm buffer size(%d)\n", __func__, in_size, MAX_RTKM_RECVBUF_SZ); -+ WARN_ON(1); -+ return skb; -+ } -+ -+ skb = skb_dequeue(&rtk_skb_mem_q); -+ -+ printk("%s, rtk_skb_mem_q len : %d\n", __func__, skb_queue_len(&rtk_skb_mem_q)); -+ -+ return skb; -+} -+EXPORT_SYMBOL(rtw_alloc_skb_premem); -+ -+int rtw_free_skb_premem(struct sk_buff *pskb) -+{ -+ if (!pskb) -+ return -1; -+ -+ if (skb_queue_len(&rtk_skb_mem_q) >= MAX_RTKM_NR_PREALLOC_RECV_SKB) -+ return -1; -+ -+ skb_queue_tail(&rtk_skb_mem_q, pskb); -+ -+ printk("%s, rtk_skb_mem_q len : %d\n", __func__, skb_queue_len(&rtk_skb_mem_q)); -+ -+ return 0; -+} -+EXPORT_SYMBOL(rtw_free_skb_premem); -+ -+static int __init rtw_mem_init(void) -+{ -+ int i; -+ SIZE_PTR tmpaddr = 0; -+ SIZE_PTR alignment = 0; -+ struct sk_buff *pskb = NULL; -+ -+ printk("%s\n", __func__); -+ pr_info("MAX_RTKM_NR_PREALLOC_RECV_SKB: %d\n", MAX_RTKM_NR_PREALLOC_RECV_SKB); -+ pr_info("MAX_RTKM_RECVBUF_SZ: %d\n", MAX_RTKM_RECVBUF_SZ); -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ for (i = 0; i < NR_RECVBUFF; i++) -+ rtk_buf_mem[i] = usb_buffer_alloc(dev, size, (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL), dma); -+#endif /* CONFIG_USE_USB_BUFFER_ALLOC_RX */ -+ -+ skb_queue_head_init(&rtk_skb_mem_q); -+ -+ for (i = 0; i < MAX_RTKM_NR_PREALLOC_RECV_SKB; i++) { -+ pskb = __dev_alloc_skb(MAX_RTKM_RECVBUF_SZ + RECVBUFF_ALIGN_SZ, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+ if (pskb) { -+ tmpaddr = (SIZE_PTR)pskb->data; -+ alignment = tmpaddr & (RECVBUFF_ALIGN_SZ - 1); -+ skb_reserve(pskb, (RECVBUFF_ALIGN_SZ - alignment)); -+ -+ skb_queue_tail(&rtk_skb_mem_q, pskb); -+ } else -+ printk("%s, alloc skb memory fail!\n", __func__); -+ -+ pskb = NULL; -+ } -+ -+ printk("%s, rtk_skb_mem_q len : %d\n", __func__, skb_queue_len(&rtk_skb_mem_q)); -+ -+ return 0; -+ -+} -+ -+static void __exit rtw_mem_exit(void) -+{ -+ if (skb_queue_len(&rtk_skb_mem_q)) -+ printk("%s, rtk_skb_mem_q len : %d\n", __func__, skb_queue_len(&rtk_skb_mem_q)); -+ -+ skb_queue_purge(&rtk_skb_mem_q); -+ -+ printk("%s\n", __func__); -+} -+ -+module_init(rtw_mem_init); -+module_exit(rtw_mem_exit); -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_mi.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mi.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_mi.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mi.c 2018-02-11 21:44:27.137145933 +0200 -@@ -0,0 +1,1289 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2015 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_MI_C_ -+ -+#include -+#include -+ -+void rtw_mi_update_union_chan_inf(_adapter *adapter, u8 ch, u8 offset , u8 bw) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mi_state *iface_state = &dvobj->iface_state; -+ -+ iface_state->union_ch = ch; -+ iface_state->union_bw = bw; -+ iface_state->union_offset = offset; -+} -+ -+/* Find union about ch, bw, ch_offset of all linked/linking interfaces */ -+int _rtw_mi_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset, bool include_self) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ struct mlme_ext_priv *mlmeext; -+ int i; -+ u8 ch_ret = 0; -+ u8 bw_ret = CHANNEL_WIDTH_20; -+ u8 offset_ret = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ int num = 0; -+ -+ if (ch) -+ *ch = 0; -+ if (bw) -+ *bw = CHANNEL_WIDTH_20; -+ if (offset) -+ *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (!check_fwstate(&iface->mlmepriv, _FW_LINKED | _FW_UNDER_LINKING)) -+ continue; -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_OP_CH_SWITCHING)) -+ continue; -+ -+ if (include_self == _FALSE && adapter == iface) -+ continue; -+ -+ if (num == 0) { -+ ch_ret = mlmeext->cur_channel; -+ bw_ret = mlmeext->cur_bwmode; -+ offset_ret = mlmeext->cur_ch_offset; -+ num++; -+ continue; -+ } -+ -+ if (ch_ret != mlmeext->cur_channel) { -+ num = 0; -+ break; -+ } -+ -+ if (bw_ret < mlmeext->cur_bwmode) { -+ bw_ret = mlmeext->cur_bwmode; -+ offset_ret = mlmeext->cur_ch_offset; -+ } else if (bw_ret == mlmeext->cur_bwmode && offset_ret != mlmeext->cur_ch_offset) { -+ num = 0; -+ break; -+ } -+ -+ num++; -+ } -+ -+ if (num) { -+ if (ch) -+ *ch = ch_ret; -+ if (bw) -+ *bw = bw_ret; -+ if (offset) -+ *offset = offset_ret; -+ } -+ -+ return num; -+} -+ -+inline int rtw_mi_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) -+{ -+ return _rtw_mi_get_ch_setting_union(adapter, ch, bw, offset, 1); -+} -+ -+inline int rtw_mi_get_ch_setting_union_no_self(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) -+{ -+ return _rtw_mi_get_ch_setting_union(adapter, ch, bw, offset, 0); -+} -+ -+/* For now, not return union_ch/bw/offset */ -+void _rtw_mi_status(_adapter *adapter, struct mi_state *mstate, bool include_self) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ int i; -+ -+ _rtw_memset(mstate, 0, sizeof(struct mi_state)); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ -+ if (include_self == _FALSE && iface == adapter) -+ continue; -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_STATION_STATE) == _TRUE) { -+ MSTATE_STA_NUM(mstate)++; -+ if (check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE) -+ MSTATE_STA_LD_NUM(mstate)++; -+ -+ if (check_fwstate(&iface->mlmepriv, _FW_UNDER_LINKING) == _TRUE) -+ MSTATE_STA_LG_NUM(mstate)++; -+ -+ } else if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE -+ && check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE -+ ) { -+ MSTATE_AP_NUM(mstate)++; -+ if (iface->stapriv.asoc_sta_count > 2) -+ MSTATE_AP_LD_NUM(mstate)++; -+ -+ } else if (check_fwstate(&iface->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) == _TRUE -+ && check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE -+ ) { -+ MSTATE_ADHOC_NUM(mstate)++; -+ if (iface->stapriv.asoc_sta_count > 2) -+ MSTATE_ADHOC_LD_NUM(mstate)++; -+ } -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_UNDER_WPS) == _TRUE) -+ MSTATE_WPS_NUM(mstate)++; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (rtw_cfg80211_get_is_mgmt_tx(iface)) -+ MSTATE_MGMT_TX_NUM(mstate)++; -+ #ifdef CONFIG_P2P -+ if (rtw_cfg80211_get_is_roch(iface) == _TRUE) -+ MSTATE_ROCH_NUM(mstate)++; -+ #endif -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ } -+} -+ -+inline void rtw_mi_status(_adapter *adapter, struct mi_state *mstate) -+{ -+ return _rtw_mi_status(adapter, mstate, 1); -+} -+inline void rtw_mi_status_no_self(_adapter *adapter, struct mi_state *mstate) -+{ -+ return _rtw_mi_status(adapter, mstate, 0); -+} -+void dump_mi_status(void *sel, struct dvobj_priv *dvobj) -+{ -+ RTW_PRINT_SEL(sel, "== dvobj-iface_state ==\n"); -+ RTW_PRINT_SEL(sel, "sta_num:%d\n", DEV_STA_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "linking_sta_num:%d\n", DEV_STA_LG_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "linked_sta_num:%d\n", DEV_STA_LD_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "ap_num:%d\n", DEV_AP_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "linked_ap_num:%d\n", DEV_AP_LD_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "adhoc_num:%d\n", DEV_ADHOC_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "linked_adhoc_num:%d\n", DEV_ADHOC_LD_NUM(dvobj)); -+#ifdef CONFIG_P2P -+ RTW_PRINT_SEL(sel, "p2p_device_num:%d\n", rtw_mi_stay_in_p2p_mode(dvobj->padapters[IFACE_ID0])); -+#endif -+#if defined(CONFIG_IOCTL_CFG80211) -+ #if defined(CONFIG_P2P) -+ RTW_PRINT_SEL(sel, "roch_num:%d\n", DEV_ROCH_NUM(dvobj)); -+ #endif -+ RTW_PRINT_SEL(sel, "mgmt_tx_num:%d\n", DEV_MGMT_TX_NUM(dvobj)); -+#endif -+ RTW_PRINT_SEL(sel, "under_wps_num:%d\n", DEV_WPS_NUM(dvobj)); -+ RTW_PRINT_SEL(sel, "union_ch:%d\n", DEV_U_CH(dvobj)); -+ RTW_PRINT_SEL(sel, "union_bw:%d\n", DEV_U_BW(dvobj)); -+ RTW_PRINT_SEL(sel, "union_offset:%d\n", DEV_U_OFFSET(dvobj)); -+ RTW_PRINT_SEL(sel, "================\n\n"); -+} -+ -+void dump_dvobj_mi_status(void *sel, const char *fun_name, _adapter *adapter) -+{ -+ RTW_INFO("\n[ %s ] call %s\n", fun_name, __func__); -+ dump_mi_status(sel, adapter_to_dvobj(adapter)); -+} -+ -+inline void rtw_mi_update_iface_status(struct mlme_priv *pmlmepriv, sint state) -+{ -+ _adapter *adapter = container_of(pmlmepriv, _adapter, mlmepriv); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mi_state *iface_state = &dvobj->iface_state; -+ struct mi_state tmp_mstate; -+ u8 i; -+ u8 u_ch, u_offset, u_bw; -+ _adapter *iface; -+ -+ if (state == WIFI_MONITOR_STATE -+ || state == WIFI_SITE_MONITOR -+ || state == 0xFFFFFFFF -+ ) -+ return; -+ -+ if (0) -+ RTW_INFO("%s => will change or clean state to 0x%08x\n", __func__, state); -+ -+ rtw_mi_status(adapter, &tmp_mstate); -+ _rtw_memcpy(iface_state, &tmp_mstate, sizeof(struct mi_state)); -+ -+ if (rtw_mi_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset)) -+ rtw_mi_update_union_chan_inf(adapter , u_ch, u_offset , u_bw); -+ else { -+ if (0) { -+ dump_adapters_status(RTW_DBGDUMP , dvobj); -+ RTW_INFO("%s-[ERROR] cannot get union channel\n", __func__); -+ rtw_warn_on(1); -+ } -+ } -+ -+#ifdef DBG_IFACE_STATUS -+ DBG_IFACE_STATUS_DUMP(adapter); -+#endif -+} -+u8 rtw_mi_check_status(_adapter *adapter, u8 type) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mi_state *iface_state = &dvobj->iface_state; -+ u8 ret = _FALSE; -+ -+#ifdef DBG_IFACE_STATUS -+ DBG_IFACE_STATUS_DUMP(adapter); -+ RTW_INFO("%s-"ADPT_FMT" check type:%d\n", __func__, ADPT_ARG(adapter), type); -+#endif -+ -+ switch (type) { -+ case MI_LINKED: -+ if (MSTATE_STA_LD_NUM(iface_state) || MSTATE_AP_NUM(iface_state) || MSTATE_ADHOC_NUM(iface_state)) /*check_fwstate(&iface->mlmepriv, _FW_LINKED)*/ -+ ret = _TRUE; -+ break; -+ case MI_ASSOC: -+ if (MSTATE_STA_LD_NUM(iface_state) || MSTATE_AP_LD_NUM(iface_state) || MSTATE_ADHOC_LD_NUM(iface_state)) -+ ret = _TRUE; -+ break; -+ case MI_UNDER_WPS: -+ if (MSTATE_WPS_NUM(iface_state)) -+ ret = _TRUE; -+ break; -+ -+ case MI_AP_MODE: -+ if (MSTATE_AP_NUM(iface_state)) -+ ret = _TRUE; -+ break; -+ case MI_AP_ASSOC: -+ if (MSTATE_AP_LD_NUM(iface_state)) -+ ret = _TRUE; -+ break; -+ -+ case MI_ADHOC: -+ if (MSTATE_ADHOC_NUM(iface_state)) -+ ret = _TRUE; -+ break; -+ case MI_ADHOC_ASSOC: -+ if (MSTATE_ADHOC_LD_NUM(iface_state)) -+ ret = _TRUE; -+ break; -+ -+ case MI_STA_NOLINK: /* this is misleading, but not used now */ -+ if (MSTATE_STA_NUM(iface_state) && (!(MSTATE_STA_LD_NUM(iface_state) || MSTATE_STA_LG_NUM(iface_state)))) -+ ret = _TRUE; -+ break; -+ case MI_STA_LINKED: -+ if (MSTATE_STA_LD_NUM(iface_state)) -+ ret = _TRUE; -+ break; -+ case MI_STA_LINKING: -+ if (MSTATE_STA_LG_NUM(iface_state)) -+ ret = _TRUE; -+ break; -+ -+ default: -+ break; -+ } -+ return ret; -+} -+ -+u8 rtw_mi_mp_mode_check(_adapter *padapter) -+{ -+#ifdef CONFIG_MP_INCLUDED -+#ifdef CONFIG_CONCURRENT_MODE -+ int i; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface = NULL; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ -+ if ((iface) && (iface->registrypriv.mp_mode == 1)) -+ return _TRUE; -+ } -+#else -+ if (padapter->registrypriv.mp_mode == 1) -+ return _TRUE; -+#endif -+#endif /* CONFIG_MP_INCLUDED */ -+ return _FALSE; -+} -+ -+/* -+* return value : 0 is failed or have not interface meet condition -+* return value : !0 is success or interface numbers which meet condition -+* return value of ops_func must be _TRUE or _FALSE -+*/ -+static u8 _rtw_mi_process(_adapter *padapter, bool exclude_self, -+ void *data, u8(*ops_func)(_adapter *padapter, void *data)) -+{ -+ int i; -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ u8 ret = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ -+ if ((exclude_self) && (iface == padapter)) -+ continue; -+ -+ if (ops_func) -+ if (_TRUE == ops_func(iface, data)) -+ ret++; -+ } -+ } -+ return ret; -+} -+static u8 _rtw_mi_netif_stop_queue(_adapter *padapter, void *data) -+{ -+ bool carrier_off = *(bool *)data; -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ if (carrier_off) -+ netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ return _TRUE; -+} -+u8 rtw_mi_netif_stop_queue(_adapter *padapter, bool carrier_off) -+{ -+ bool in_data = carrier_off; -+ -+ return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_netif_stop_queue); -+} -+u8 rtw_mi_buddy_netif_stop_queue(_adapter *padapter, bool carrier_off) -+{ -+ bool in_data = carrier_off; -+ -+ return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_netif_stop_queue); -+} -+ -+static u8 _rtw_mi_netif_wake_queue(_adapter *padapter, void *data) -+{ -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ if (pnetdev) -+ rtw_netif_wake_queue(pnetdev); -+ return _TRUE; -+} -+u8 rtw_mi_netif_wake_queue(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_netif_wake_queue); -+} -+u8 rtw_mi_buddy_netif_wake_queue(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_netif_wake_queue); -+} -+ -+static u8 _rtw_mi_netif_carrier_on(_adapter *padapter, void *data) -+{ -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ if (pnetdev) -+ rtw_netif_carrier_on(pnetdev); -+ return _TRUE; -+} -+u8 rtw_mi_netif_carrier_on(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_netif_carrier_on); -+} -+u8 rtw_mi_buddy_netif_carrier_on(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_netif_carrier_on); -+} -+ -+static u8 _rtw_mi_scan_abort(_adapter *adapter, void *data) -+{ -+ bool bwait = *(bool *)data; -+ -+ if (bwait) -+ rtw_scan_abort(adapter); -+ else -+ rtw_scan_abort_no_wait(adapter); -+ -+ return _TRUE; -+} -+void rtw_mi_scan_abort(_adapter *adapter, bool bwait) -+{ -+ bool in_data = bwait; -+ -+ _rtw_mi_process(adapter, _FALSE, &in_data, _rtw_mi_scan_abort); -+ -+} -+void rtw_mi_buddy_scan_abort(_adapter *adapter, bool bwait) -+{ -+ bool in_data = bwait; -+ -+ _rtw_mi_process(adapter, _TRUE, &in_data, _rtw_mi_scan_abort); -+} -+ -+static u8 _rtw_mi_start_drv_threads(_adapter *adapter, void *data) -+{ -+ rtw_start_drv_threads(adapter); -+ return _TRUE; -+} -+void rtw_mi_start_drv_threads(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_start_drv_threads); -+} -+void rtw_mi_buddy_start_drv_threads(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_start_drv_threads); -+} -+ -+static u8 _rtw_mi_stop_drv_threads(_adapter *adapter, void *data) -+{ -+ rtw_stop_drv_threads(adapter); -+ return _TRUE; -+} -+void rtw_mi_stop_drv_threads(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_stop_drv_threads); -+} -+void rtw_mi_buddy_stop_drv_threads(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_stop_drv_threads); -+} -+ -+static u8 _rtw_mi_cancel_all_timer(_adapter *adapter, void *data) -+{ -+ rtw_cancel_all_timer(adapter); -+ return _TRUE; -+} -+void rtw_mi_cancel_all_timer(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_cancel_all_timer); -+} -+void rtw_mi_buddy_cancel_all_timer(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_cancel_all_timer); -+} -+ -+static u8 _rtw_mi_reset_drv_sw(_adapter *adapter, void *data) -+{ -+ rtw_reset_drv_sw(adapter); -+ return _TRUE; -+} -+void rtw_mi_reset_drv_sw(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_reset_drv_sw); -+} -+void rtw_mi_buddy_reset_drv_sw(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_reset_drv_sw); -+} -+ -+static u8 _rtw_mi_intf_start(_adapter *adapter, void *data) -+{ -+ rtw_intf_start(adapter); -+ return _TRUE; -+} -+void rtw_mi_intf_start(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_intf_start); -+} -+void rtw_mi_buddy_intf_start(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_intf_start); -+} -+ -+static u8 _rtw_mi_intf_stop(_adapter *adapter, void *data) -+{ -+ rtw_intf_stop(adapter); -+ return _TRUE; -+} -+void rtw_mi_intf_stop(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_intf_stop); -+} -+void rtw_mi_buddy_intf_stop(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_intf_stop); -+} -+ -+static u8 _rtw_mi_suspend_free_assoc_resource(_adapter *padapter, void *data) -+{ -+ return rtw_suspend_free_assoc_resource(padapter); -+} -+void rtw_mi_suspend_free_assoc_resource(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_suspend_free_assoc_resource); -+} -+void rtw_mi_buddy_suspend_free_assoc_resource(_adapter *adapter) -+{ -+ _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_suspend_free_assoc_resource); -+} -+ -+static u8 _rtw_mi_is_scan_deny(_adapter *adapter, void *data) -+{ -+ return rtw_is_scan_deny(adapter); -+} -+ -+u8 rtw_mi_is_scan_deny(_adapter *adapter) -+{ -+ return _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_is_scan_deny); -+ -+} -+u8 rtw_mi_buddy_is_scan_deny(_adapter *adapter) -+{ -+ return _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_is_scan_deny); -+} -+ -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+static u8 _rtw_mi_set_scan_deny(_adapter *adapter, void *data) -+{ -+ u32 ms = *(u32 *)data; -+ -+ rtw_set_scan_deny(adapter, ms); -+ return _TRUE; -+} -+void rtw_mi_set_scan_deny(_adapter *adapter, u32 ms) -+{ -+ u32 in_data = ms; -+ -+ _rtw_mi_process(adapter, _FALSE, &in_data, _rtw_mi_set_scan_deny); -+} -+void rtw_mi_buddy_set_scan_deny(_adapter *adapter, u32 ms) -+{ -+ u32 in_data = ms; -+ -+ _rtw_mi_process(adapter, _TRUE, &in_data, _rtw_mi_set_scan_deny); -+} -+#endif -+ -+struct nulldata_param { -+ unsigned char *da; -+ unsigned int power_mode; -+ int try_cnt; -+ int wait_ms; -+}; -+ -+static u8 _rtw_mi_issue_nulldata(_adapter *padapter, void *data) -+{ -+ struct nulldata_param *pnulldata_param = (struct nulldata_param *)data; -+ -+ if (is_client_associated_to_ap(padapter) == _TRUE) { -+ /* TODO: TDLS peers */ -+ issue_nulldata(padapter, pnulldata_param->da, pnulldata_param->power_mode, pnulldata_param->try_cnt, pnulldata_param->wait_ms); -+ return _TRUE; -+ } -+ return _FALSE; -+} -+ -+u8 rtw_mi_issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) -+{ -+ struct nulldata_param nparam; -+ -+ nparam.da = da; -+ nparam.power_mode = power_mode;/*0 or 1*/ -+ nparam.try_cnt = try_cnt; -+ nparam.wait_ms = wait_ms; -+ -+ return _rtw_mi_process(padapter, _FALSE, &nparam, _rtw_mi_issue_nulldata); -+} -+u8 rtw_mi_buddy_issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) -+{ -+ struct nulldata_param nparam; -+ -+ nparam.da = da; -+ nparam.power_mode = power_mode; -+ nparam.try_cnt = try_cnt; -+ nparam.wait_ms = wait_ms; -+ -+ return _rtw_mi_process(padapter, _TRUE, &nparam, _rtw_mi_issue_nulldata); -+} -+ -+static u8 _rtw_mi_beacon_update(_adapter *padapter, void *data) -+{ -+ struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; -+ #ifdef CONFIG_AP_MODE -+ if (mlmeext_msr(mlmeext) == WIFI_FW_AP_STATE -+ && check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _TRUE) { -+ RTW_INFO(ADPT_FMT"-WIFI_FW_AP_STATE - update_beacon\n", ADPT_ARG(padapter)); -+ update_beacon(padapter, 0, NULL, _TRUE); -+ } -+#endif -+ return _TRUE; -+} -+ -+void rtw_mi_beacon_update(_adapter *padapter) -+{ -+ _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_beacon_update); -+} -+ -+void rtw_mi_buddy_beacon_update(_adapter *padapter) -+{ -+ _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_beacon_update); -+} -+ -+static u8 _rtw_mi_hal_dump_macaddr(_adapter *padapter, void *data) -+{ -+ u8 mac_addr[ETH_ALEN] = {0}; -+ -+ rtw_hal_get_macaddr_port(padapter, mac_addr); -+ RTW_INFO(ADPT_FMT"MAC Address ="MAC_FMT"\n", ADPT_ARG(padapter), MAC_ARG(mac_addr)); -+ return _TRUE; -+} -+void rtw_mi_hal_dump_macaddr(_adapter *padapter) -+{ -+ _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_hal_dump_macaddr); -+} -+void rtw_mi_buddy_hal_dump_macaddr(_adapter *padapter) -+{ -+ _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_hal_dump_macaddr); -+} -+ -+#ifdef CONFIG_PCI_HCI -+static u8 _rtw_mi_xmit_tasklet_schedule(_adapter *padapter, void *data) -+{ -+ if (rtw_txframes_pending(padapter)) { -+ /* try to deal with the pending packets */ -+ tasklet_hi_schedule(&(padapter->xmitpriv.xmit_tasklet)); -+ } -+ return _TRUE; -+} -+void rtw_mi_xmit_tasklet_schedule(_adapter *padapter) -+{ -+ _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_xmit_tasklet_schedule); -+} -+void rtw_mi_buddy_xmit_tasklet_schedule(_adapter *padapter) -+{ -+ _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_xmit_tasklet_schedule); -+} -+#endif -+ -+u8 _rtw_mi_busy_traffic_check(_adapter *padapter, void *data) -+{ -+ u32 passtime; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ bool check_sc_interval = *(bool *)data; -+ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE) { -+ if (check_sc_interval) { -+ /* Miracast can't do AP scan*/ -+ passtime = rtw_get_passing_time_ms(pmlmepriv->lastscantime); -+ pmlmepriv->lastscantime = rtw_get_current_time(); -+ if (passtime > BUSY_TRAFFIC_SCAN_DENY_PERIOD) { -+ RTW_INFO(ADPT_FMT" bBusyTraffic == _TRUE\n", ADPT_ARG(padapter)); -+ return _TRUE; -+ } -+ } else -+ return _TRUE; -+ } -+ -+ return _FALSE; -+} -+ -+u8 rtw_mi_busy_traffic_check(_adapter *padapter, bool check_sc_interval) -+{ -+ bool in_data = check_sc_interval; -+ -+ return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_busy_traffic_check); -+} -+u8 rtw_mi_buddy_busy_traffic_check(_adapter *padapter, bool check_sc_interval) -+{ -+ bool in_data = check_sc_interval; -+ -+ return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_busy_traffic_check); -+} -+static u8 _rtw_mi_check_mlmeinfo_state(_adapter *padapter, void *data) -+{ -+ u32 state = *(u32 *)data; -+ struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; -+ -+ /*if (mlmeext_msr(mlmeext) == state)*/ -+ if (check_mlmeinfo_state(mlmeext, state)) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+u8 rtw_mi_check_mlmeinfo_state(_adapter *padapter, u32 state) -+{ -+ u32 in_data = state; -+ -+ return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_check_mlmeinfo_state); -+} -+ -+u8 rtw_mi_buddy_check_mlmeinfo_state(_adapter *padapter, u32 state) -+{ -+ u32 in_data = state; -+ -+ return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_check_mlmeinfo_state); -+} -+ -+/*#define DBG_DUMP_FW_STATE*/ -+#ifdef DBG_DUMP_FW_STATE -+static void rtw_dbg_dump_fwstate(_adapter *padapter, sint state) -+{ -+ u8 buf[32] = {0}; -+ -+ if (state & WIFI_FW_NULL_STATE) { -+ _rtw_memset(buf, 0, 32); -+ sprintf(buf, "WIFI_FW_NULL_STATE"); -+ RTW_INFO(FUNC_ADPT_FMT"fwstate-%s\n", FUNC_ADPT_ARG(padapter), buf); -+ } -+ -+ if (state & _FW_LINKED) { -+ _rtw_memset(buf, 0, 32); -+ sprintf(buf, "_FW_LINKED"); -+ RTW_INFO(FUNC_ADPT_FMT"fwstate-%s\n", FUNC_ADPT_ARG(padapter), buf); -+ } -+ -+ if (state & _FW_UNDER_LINKING) { -+ _rtw_memset(buf, 0, 32); -+ sprintf(buf, "_FW_UNDER_LINKING"); -+ RTW_INFO(FUNC_ADPT_FMT"fwstate-%s\n", FUNC_ADPT_ARG(padapter), buf); -+ } -+ -+ if (state & _FW_UNDER_SURVEY) { -+ _rtw_memset(buf, 0, 32); -+ sprintf(buf, "_FW_UNDER_SURVEY"); -+ RTW_INFO(FUNC_ADPT_FMT"fwstate-%s\n", FUNC_ADPT_ARG(padapter), buf); -+ } -+} -+#endif -+ -+static u8 _rtw_mi_check_fwstate(_adapter *padapter, void *data) -+{ -+ u8 ret = _FALSE; -+ -+ sint state = *(sint *)data; -+ -+ if ((state == WIFI_FW_NULL_STATE) && -+ (padapter->mlmepriv.fw_state == WIFI_FW_NULL_STATE)) -+ ret = _TRUE; -+ else if (_TRUE == check_fwstate(&padapter->mlmepriv, state)) -+ ret = _TRUE; -+#ifdef DBG_DUMP_FW_STATE -+ if (ret) -+ rtw_dbg_dump_fwstate(padapter, state); -+#endif -+ return ret; -+} -+u8 rtw_mi_check_fwstate(_adapter *padapter, sint state) -+{ -+ sint in_data = state; -+ -+ return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_check_fwstate); -+} -+u8 rtw_mi_buddy_check_fwstate(_adapter *padapter, sint state) -+{ -+ sint in_data = state; -+ -+ return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_check_fwstate); -+} -+ -+static u8 _rtw_mi_traffic_statistics(_adapter *padapter , void *data) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ -+ /* Tx */ -+ pdvobjpriv->traffic_stat.tx_bytes += padapter->xmitpriv.tx_bytes; -+ pdvobjpriv->traffic_stat.tx_pkts += padapter->xmitpriv.tx_pkts; -+ pdvobjpriv->traffic_stat.tx_drop += padapter->xmitpriv.tx_drop; -+ -+ /* Rx */ -+ pdvobjpriv->traffic_stat.rx_bytes += padapter->recvpriv.rx_bytes; -+ pdvobjpriv->traffic_stat.rx_pkts += padapter->recvpriv.rx_pkts; -+ pdvobjpriv->traffic_stat.rx_drop += padapter->recvpriv.rx_drop; -+ return _TRUE; -+} -+u8 rtw_mi_traffic_statistics(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_traffic_statistics); -+} -+ -+static u8 _rtw_mi_check_miracast_enabled(_adapter *padapter , void *data) -+{ -+ return is_miracast_enabled(padapter); -+} -+u8 rtw_mi_check_miracast_enabled(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_check_miracast_enabled); -+} -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+static u8 _rtw_mi_check_pending_xmitbuf(_adapter *padapter , void *data) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ return check_pending_xmitbuf(pxmitpriv); -+} -+u8 rtw_mi_check_pending_xmitbuf(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_check_pending_xmitbuf); -+} -+u8 rtw_mi_buddy_check_pending_xmitbuf(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_check_pending_xmitbuf); -+} -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+static u8 _rtw_mi_dequeue_writeport(_adapter *padapter , bool exclude_self) -+{ -+ int i; -+ u8 queue_empty = _TRUE; -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ -+ if ((exclude_self) && (iface == padapter)) -+ continue; -+ -+ queue_empty &= _dequeue_writeport(iface); -+ } -+ } -+ return queue_empty; -+} -+u8 rtw_mi_dequeue_writeport(_adapter *padapter) -+{ -+ return _rtw_mi_dequeue_writeport(padapter, _FALSE); -+} -+u8 rtw_mi_buddy_dequeue_writeport(_adapter *padapter) -+{ -+ return _rtw_mi_dequeue_writeport(padapter, _TRUE); -+} -+#endif -+static void _rtw_mi_adapter_reset(_adapter *padapter , u8 exclude_self) -+{ -+ int i; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (dvobj->padapters[i]) { -+ if ((exclude_self) && (dvobj->padapters[i] == padapter)) -+ continue; -+ dvobj->padapters[i] = NULL; -+ } -+ } -+} -+ -+void rtw_mi_adapter_reset(_adapter *padapter) -+{ -+ _rtw_mi_adapter_reset(padapter, _FALSE); -+} -+ -+void rtw_mi_buddy_adapter_reset(_adapter *padapter) -+{ -+ _rtw_mi_adapter_reset(padapter, _TRUE); -+} -+ -+static u8 _rtw_mi_dynamic_check_timer_handlder(_adapter *adapter, void *data) -+{ -+ rtw_iface_dynamic_check_timer_handlder(adapter); -+ return _TRUE; -+} -+u8 rtw_mi_dynamic_check_timer_handlder(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_dynamic_check_timer_handlder); -+} -+u8 rtw_mi_buddy_dynamic_check_timer_handlder(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_dynamic_check_timer_handlder); -+} -+ -+static u8 _rtw_mi_dev_unload(_adapter *adapter, void *data) -+{ -+ rtw_dev_unload(adapter); -+ return _TRUE; -+} -+u8 rtw_mi_dev_unload(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_dev_unload); -+} -+u8 rtw_mi_buddy_dev_unload(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_dev_unload); -+} -+ -+static u8 _rtw_mi_dynamic_chk_wk_hdl(_adapter *adapter, void *data) -+{ -+ rtw_iface_dynamic_chk_wk_hdl(adapter); -+ return _TRUE; -+} -+u8 rtw_mi_dynamic_chk_wk_hdl(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_dynamic_chk_wk_hdl); -+} -+u8 rtw_mi_buddy_dynamic_chk_wk_hdl(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_dynamic_chk_wk_hdl); -+} -+ -+static u8 _rtw_mi_os_xmit_schedule(_adapter *adapter, void *data) -+{ -+ rtw_os_xmit_schedule(adapter); -+ return _TRUE; -+} -+u8 rtw_mi_os_xmit_schedule(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_os_xmit_schedule); -+} -+u8 rtw_mi_buddy_os_xmit_schedule(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_os_xmit_schedule); -+} -+ -+static u8 _rtw_mi_report_survey_event(_adapter *adapter, void *data) -+{ -+ union recv_frame *precv_frame = (union recv_frame *)data; -+ -+ report_survey_event(adapter, precv_frame); -+ return _TRUE; -+} -+u8 rtw_mi_report_survey_event(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ return _rtw_mi_process(padapter, _FALSE, precv_frame, _rtw_mi_report_survey_event); -+} -+u8 rtw_mi_buddy_report_survey_event(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ return _rtw_mi_process(padapter, _TRUE, precv_frame, _rtw_mi_report_survey_event); -+} -+ -+static u8 _rtw_mi_sreset_adapter_hdl(_adapter *adapter, void *data) -+{ -+ u8 bstart = *(u8 *)data; -+ -+ if (bstart) -+ sreset_start_adapter(adapter); -+ else -+ sreset_stop_adapter(adapter); -+ return _TRUE; -+} -+u8 rtw_mi_sreset_adapter_hdl(_adapter *padapter, u8 bstart) -+{ -+ u8 in_data = bstart; -+ -+ return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_sreset_adapter_hdl); -+} -+u8 rtw_mi_buddy_sreset_adapter_hdl(_adapter *padapter, u8 bstart) -+{ -+ u8 in_data = bstart; -+ -+ return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_sreset_adapter_hdl); -+} -+#ifdef CONFIG_AP_MODE -+static u8 _rtw_mi_tx_beacon_hdl(_adapter *adapter, void *data) -+{ -+ if (check_fwstate(&adapter->mlmepriv, WIFI_AP_STATE) == _TRUE -+ && check_fwstate(&adapter->mlmepriv, WIFI_ASOC_STATE) == _TRUE -+ ) { -+ adapter->mlmepriv.update_bcn = _TRUE; -+#ifndef CONFIG_INTERRUPT_BASED_TXBCN -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ tx_beacon_hdl(adapter, NULL); -+#endif -+#endif -+ } -+ return _TRUE; -+} -+u8 rtw_mi_tx_beacon_hdl(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_tx_beacon_hdl); -+} -+u8 rtw_mi_buddy_tx_beacon_hdl(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_sreset_adapter_hdl); -+} -+ -+static u8 _rtw_mi_set_tx_beacon_cmd(_adapter *adapter, void *data) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ if (pmlmepriv->update_bcn == _TRUE) -+ set_tx_beacon_cmd(adapter); -+ } -+ return _TRUE; -+} -+u8 rtw_mi_set_tx_beacon_cmd(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_set_tx_beacon_cmd); -+} -+u8 rtw_mi_buddy_set_tx_beacon_cmd(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_set_tx_beacon_cmd); -+} -+#endif /* CONFIG_AP MODE */ -+ -+#ifdef CONFIG_P2P -+static u8 _rtw_mi_p2p_chk_state(_adapter *adapter, void *data) -+{ -+ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); -+ enum P2P_STATE state = *(enum P2P_STATE *)data; -+ -+ return rtw_p2p_chk_state(pwdinfo, state); -+} -+u8 rtw_mi_p2p_chk_state(_adapter *padapter, enum P2P_STATE p2p_state) -+{ -+ u8 in_data = p2p_state; -+ -+ return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_p2p_chk_state); -+} -+u8 rtw_mi_buddy_p2p_chk_state(_adapter *padapter, enum P2P_STATE p2p_state) -+{ -+ u8 in_data = p2p_state; -+ -+ return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_p2p_chk_state); -+} -+static u8 _rtw_mi_stay_in_p2p_mode(_adapter *adapter, void *data) -+{ -+ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); -+ -+ if (rtw_p2p_role(pwdinfo) != P2P_ROLE_DISABLE) -+ return _TRUE; -+ return _FALSE; -+} -+u8 rtw_mi_stay_in_p2p_mode(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_stay_in_p2p_mode); -+} -+u8 rtw_mi_buddy_stay_in_p2p_mode(_adapter *padapter) -+{ -+ return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_stay_in_p2p_mode); -+} -+#endif /*CONFIG_P2P*/ -+ -+_adapter *rtw_get_iface_by_id(_adapter *padapter, u8 iface_id) -+{ -+ _adapter *iface = NULL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ if ((padapter == NULL) || (iface_id >= CONFIG_IFACE_NUMBER)) { -+ rtw_warn_on(1); -+ return iface; -+ } -+ -+ return dvobj->padapters[iface_id]; -+} -+ -+_adapter *rtw_get_iface_by_macddr(_adapter *padapter, u8 *mac_addr) -+{ -+ int i; -+ _adapter *iface = NULL; -+ u8 bmatch = _FALSE; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && (_rtw_memcmp(mac_addr, adapter_mac_addr(iface), ETH_ALEN))) { -+ bmatch = _TRUE; -+ break; -+ } -+ } -+ if (bmatch) -+ return iface; -+ else -+ return NULL; -+} -+ -+_adapter *rtw_get_iface_by_hwport(_adapter *padapter, u8 hw_port) -+{ -+ int i; -+ _adapter *iface = NULL; -+ u8 bmatch = _FALSE; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && (hw_port == iface->hw_port)) { -+ bmatch = _TRUE; -+ break; -+ } -+ } -+ if (bmatch) -+ return iface; -+ else -+ return NULL; -+} -+ -+/*#define CONFIG_SKB_ALLOCATED*/ -+#define DBG_SKB_PROCESS -+#ifdef DBG_SKB_PROCESS -+void rtw_dbg_skb_process(_adapter *padapter, union recv_frame *precvframe, union recv_frame *pcloneframe) -+{ -+ _pkt *pkt_copy, *pkt_org; -+ -+ pkt_org = precvframe->u.hdr.pkt; -+ pkt_copy = pcloneframe->u.hdr.pkt; -+ /* -+ RTW_INFO("%s ===== ORG SKB =====\n", __func__); -+ RTW_INFO(" SKB head(%p)\n", pkt_org->head); -+ RTW_INFO(" SKB data(%p)\n", pkt_org->data); -+ RTW_INFO(" SKB tail(%p)\n", pkt_org->tail); -+ RTW_INFO(" SKB end(%p)\n", pkt_org->end); -+ -+ RTW_INFO(" recv frame head(%p)\n", precvframe->u.hdr.rx_head); -+ RTW_INFO(" recv frame data(%p)\n", precvframe->u.hdr.rx_data); -+ RTW_INFO(" recv frame tail(%p)\n", precvframe->u.hdr.rx_tail); -+ RTW_INFO(" recv frame end(%p)\n", precvframe->u.hdr.rx_end); -+ -+ RTW_INFO("%s ===== COPY SKB =====\n", __func__); -+ RTW_INFO(" SKB head(%p)\n", pkt_copy->head); -+ RTW_INFO(" SKB data(%p)\n", pkt_copy->data); -+ RTW_INFO(" SKB tail(%p)\n", pkt_copy->tail); -+ RTW_INFO(" SKB end(%p)\n", pkt_copy->end); -+ -+ RTW_INFO(" recv frame head(%p)\n", pcloneframe->u.hdr.rx_head); -+ RTW_INFO(" recv frame data(%p)\n", pcloneframe->u.hdr.rx_data); -+ RTW_INFO(" recv frame tail(%p)\n", pcloneframe->u.hdr.rx_tail); -+ RTW_INFO(" recv frame end(%p)\n", pcloneframe->u.hdr.rx_end); -+ */ -+ /* -+ RTW_INFO("%s => recv_frame adapter(%p,%p)\n", __func__, precvframe->u.hdr.adapter, pcloneframe->u.hdr.adapter); -+ RTW_INFO("%s => recv_frame dev(%p,%p)\n", __func__, pkt_org->dev , pkt_copy->dev); -+ RTW_INFO("%s => recv_frame len(%d,%d)\n", __func__, precvframe->u.hdr.len, pcloneframe->u.hdr.len); -+ */ -+ if (precvframe->u.hdr.len != pcloneframe->u.hdr.len) -+ RTW_INFO("%s [WARN] recv_frame length(%d:%d) compare failed\n", __func__, precvframe->u.hdr.len, pcloneframe->u.hdr.len); -+ -+ if (_rtw_memcmp(&precvframe->u.hdr.attrib, &pcloneframe->u.hdr.attrib, sizeof(struct rx_pkt_attrib)) == _FALSE) -+ RTW_INFO("%s [WARN] recv_frame attrib compare failed\n", __func__); -+ -+ if (_rtw_memcmp(precvframe->u.hdr.rx_data, pcloneframe->u.hdr.rx_data, precvframe->u.hdr.len) == _FALSE) -+ RTW_INFO("%s [WARN] recv_frame rx_data compare failed\n", __func__); -+ -+} -+#endif -+ -+static s32 _rtw_mi_buddy_clone_bcmc_packet(_adapter *adapter, union recv_frame *precvframe, u8 *pphy_status, union recv_frame *pcloneframe) -+{ -+ s32 ret = _SUCCESS; -+ u8 *pbuf = precvframe->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = NULL; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ -+ if (pcloneframe) { -+ pcloneframe->u.hdr.adapter = adapter; -+ -+ _rtw_init_listhead(&pcloneframe->u.hdr.list); -+ pcloneframe->u.hdr.precvbuf = NULL; /*can't access the precvbuf for new arch.*/ -+ pcloneframe->u.hdr.len = 0; -+ -+ _rtw_memcpy(&pcloneframe->u.hdr.attrib, &precvframe->u.hdr.attrib, sizeof(struct rx_pkt_attrib)); -+ -+ pattrib = &pcloneframe->u.hdr.attrib; -+#ifdef CONFIG_SKB_ALLOCATED -+ if (rtw_os_alloc_recvframe(adapter, pcloneframe, pbuf, NULL) == _SUCCESS) -+#else -+ if (rtw_os_recvframe_duplicate_skb(adapter, pcloneframe, precvframe->u.hdr.pkt) == _SUCCESS) -+#endif -+ { -+#ifdef CONFIG_SKB_ALLOCATED -+ recvframe_put(pcloneframe, pattrib->pkt_len); -+#endif -+ -+#ifdef DBG_SKB_PROCESS -+ rtw_dbg_skb_process(adapter, precvframe, pcloneframe); -+#endif -+ -+ if (pattrib->physt && pphy_status) -+ rx_query_phy_status(pcloneframe, pphy_status); -+ -+ ret = rtw_recv_entry(pcloneframe); -+ } else { -+ ret = -1; -+ RTW_INFO("%s()-%d: rtw_os_alloc_recvframe() failed!\n", __func__, __LINE__); -+ } -+ -+ } -+ return ret; -+} -+ -+void rtw_mi_buddy_clone_bcmc_packet(_adapter *padapter, union recv_frame *precvframe, u8 *pphy_status) -+{ -+ int i; -+ s32 ret = _SUCCESS; -+ _adapter *iface = NULL; -+ union recv_frame *pcloneframe = NULL; -+ struct recv_priv *precvpriv = &padapter->recvpriv;/*primary_padapter*/ -+ _queue *pfree_recv_queue = &precvpriv->free_recv_queue; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface || iface == padapter) -+ continue; -+ if (rtw_is_adapter_up(iface) == _FALSE || iface->registered == 0) -+ continue; -+ -+ pcloneframe = rtw_alloc_recvframe(pfree_recv_queue); -+ if (pcloneframe) { -+ ret = _rtw_mi_buddy_clone_bcmc_packet(iface, precvframe, pphy_status, pcloneframe); -+ if (_SUCCESS != ret) { -+ if (ret == -1) -+ rtw_free_recvframe(pcloneframe, pfree_recv_queue); -+ /*RTW_INFO(ADPT_FMT"-clone BC/MC frame failed\n", ADPT_ARG(iface));*/ -+ } -+ } -+ } -+ -+} -+ -+#ifdef CONFIG_PCI_HCI -+/*API be created temporary for MI, caller is interrupt-handler, PCIE's interrupt handler cannot apply to multi-AP*/ -+_adapter *rtw_mi_get_ap_adapter(_adapter *padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ int i; -+ _adapter *iface = NULL; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE -+ && check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE) -+ break; -+ -+ } -+ return iface; -+} -+#endif -+ -+void rtw_mi_update_ap_bmc_camid(_adapter *padapter, u8 camid_a, u8 camid_b) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ -+ int i; -+ _adapter *iface = NULL; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ if (macid_ctl->iface_bmc[iface->iface_id] != INVALID_SEC_MAC_CAM_ID) { -+ if (macid_ctl->iface_bmc[iface->iface_id] == camid_a) -+ macid_ctl->iface_bmc[iface->iface_id] = camid_b; -+ else if (macid_ctl->iface_bmc[iface->iface_id] == camid_b) -+ macid_ctl->iface_bmc[iface->iface_id] = camid_a; -+ iface->securitypriv.dot118021x_bmc_cam_id = macid_ctl->iface_bmc[iface->iface_id]; -+ } -+ } -+#endif -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_mlme.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mlme.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_mlme.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mlme.c 2018-02-11 21:44:27.137145933 +0200 -@@ -0,0 +1,4668 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_MLME_C_ -+ -+#include -+ -+extern void indicate_wx_scan_complete_event(_adapter *padapter); -+extern u8 rtw_do_join(_adapter *padapter); -+ -+ -+sint _rtw_init_mlme_priv(_adapter *padapter) -+{ -+ sint i; -+ u8 *pbuf; -+ struct wlan_network *pnetwork; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ sint res = _SUCCESS; -+ -+ -+ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). */ -+ /* _rtw_memset((u8 *)pmlmepriv, 0, sizeof(struct mlme_priv)); */ -+ -+ -+ /*qos_priv*/ -+ /*pmlmepriv->qospriv.qos_option = pregistrypriv->wmm_enable;*/ -+ -+ /*ht_priv*/ -+#ifdef CONFIG_80211N_HT -+ pmlmepriv->htpriv.ampdu_enable = _FALSE;/*set to disabled*/ -+#endif -+ -+ pmlmepriv->nic_hdl = (u8 *)padapter; -+ -+ pmlmepriv->pscanned = NULL; -+ /*pmlmepriv->fw_state = WIFI_STATION_STATE; */ /*Must sync with rtw_wdev_alloc()*/ -+ /*init_fwstate(pmlmepriv, WIFI_STATION_STATE);*/ -+ init_fwstate(pmlmepriv, WIFI_NULL_STATE);/*assigned interface role(STA/AP) must after execute set_opmode*/ -+ -+ /* wdev->iftype = NL80211_IFTYPE_STATION*/ -+ pmlmepriv->cur_network.network.InfrastructureMode = Ndis802_11AutoUnknown; -+ pmlmepriv->scan_mode = SCAN_ACTIVE; /* 1: active, 0: pasive. Maybe someday we should rename this varable to "active_mode" (Jeff) */ -+ -+ _rtw_spinlock_init(&(pmlmepriv->lock)); -+ _rtw_init_queue(&(pmlmepriv->free_bss_pool)); -+ _rtw_init_queue(&(pmlmepriv->scanned_queue)); -+ -+ set_scanned_network_val(pmlmepriv, 0); -+ -+ _rtw_memset(&pmlmepriv->assoc_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ -+ pbuf = rtw_zvmalloc(MAX_BSS_CNT * (sizeof(struct wlan_network))); -+ -+ if (pbuf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ pmlmepriv->free_bss_buf = pbuf; -+ -+ pnetwork = (struct wlan_network *)pbuf; -+ -+ for (i = 0; i < MAX_BSS_CNT; i++) { -+ _rtw_init_listhead(&(pnetwork->list)); -+ -+ rtw_list_insert_tail(&(pnetwork->list), &(pmlmepriv->free_bss_pool.queue)); -+ -+ pnetwork++; -+ } -+ -+ /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */ -+ -+ rtw_clear_scan_deny(padapter); -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ pmlmepriv->bGetGateway = 0; -+ pmlmepriv->GetGatewayTryCnt = 0; -+#endif -+ -+#ifdef CONFIG_LAYER2_ROAMING -+#define RTW_ROAM_SCAN_RESULT_EXP_MS (5*1000) -+#define RTW_ROAM_RSSI_DIFF_TH 10 -+#define RTW_ROAM_SCAN_INTERVAL_MS (10*1000) -+#define RTW_ROAM_RSSI_THRESHOLD 70 -+ -+ pmlmepriv->roam_flags = 0 -+ | RTW_ROAM_ON_EXPIRED -+#ifdef CONFIG_LAYER2_ROAMING_RESUME -+ | RTW_ROAM_ON_RESUME -+#endif -+#ifdef CONFIG_LAYER2_ROAMING_ACTIVE -+ | RTW_ROAM_ACTIVE -+#endif -+ ; -+ -+ pmlmepriv->roam_scanr_exp_ms = RTW_ROAM_SCAN_RESULT_EXP_MS; -+ pmlmepriv->roam_rssi_diff_th = RTW_ROAM_RSSI_DIFF_TH; -+ pmlmepriv->roam_scan_int_ms = RTW_ROAM_SCAN_INTERVAL_MS; -+ pmlmepriv->roam_rssi_threshold = RTW_ROAM_RSSI_THRESHOLD; -+#endif /* CONFIG_LAYER2_ROAMING */ -+ -+#ifdef CONFIG_RTW_80211R -+ memset(&pmlmepriv->ftpriv, 0, sizeof(ft_priv)); -+ pmlmepriv->ftpriv.ft_flags = 0 -+ | RTW_FT_STA_SUPPORTED -+ | RTW_FT_STA_OVER_DS_SUPPORTED -+ ; -+#endif -+ rtw_init_mlme_timer(padapter); -+ -+exit: -+ -+ -+ return res; -+} -+ -+void rtw_mfree_mlme_priv_lock(struct mlme_priv *pmlmepriv); -+void rtw_mfree_mlme_priv_lock(struct mlme_priv *pmlmepriv) -+{ -+ _rtw_spinlock_free(&pmlmepriv->lock); -+ _rtw_spinlock_free(&(pmlmepriv->free_bss_pool.lock)); -+ _rtw_spinlock_free(&(pmlmepriv->scanned_queue.lock)); -+} -+ -+static void rtw_free_mlme_ie_data(u8 **ppie, u32 *plen) -+{ -+ if (*ppie) { -+ rtw_mfree(*ppie, *plen); -+ *plen = 0; -+ *ppie = NULL; -+ } -+} -+ -+void rtw_free_mlme_priv_ie_data(struct mlme_priv *pmlmepriv) -+{ -+#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ rtw_buf_free(&pmlmepriv->assoc_req, &pmlmepriv->assoc_req_len); -+ rtw_buf_free(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wps_beacon_ie, &pmlmepriv->wps_beacon_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wps_probe_req_ie, &pmlmepriv->wps_probe_req_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wps_probe_resp_ie, &pmlmepriv->wps_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wps_assoc_resp_ie, &pmlmepriv->wps_assoc_resp_ie_len); -+ -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_beacon_ie, &pmlmepriv->p2p_beacon_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_probe_req_ie, &pmlmepriv->p2p_probe_req_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_probe_resp_ie, &pmlmepriv->p2p_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_go_probe_resp_ie, &pmlmepriv->p2p_go_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_assoc_req_ie, &pmlmepriv->p2p_assoc_req_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_assoc_resp_ie, &pmlmepriv->p2p_assoc_resp_ie_len); -+#endif -+ -+#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) -+ rtw_free_mlme_ie_data(&pmlmepriv->wfd_beacon_ie, &pmlmepriv->wfd_beacon_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wfd_probe_req_ie, &pmlmepriv->wfd_probe_req_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wfd_probe_resp_ie, &pmlmepriv->wfd_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wfd_go_probe_resp_ie, &pmlmepriv->wfd_go_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wfd_assoc_req_ie, &pmlmepriv->wfd_assoc_req_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wfd_assoc_resp_ie, &pmlmepriv->wfd_assoc_resp_ie_len); -+#endif -+ -+#ifdef CONFIG_RTW_80211R -+ rtw_free_mlme_ie_data(&pmlmepriv->auth_rsp, &pmlmepriv->auth_rsp_len); -+#endif -+} -+ -+#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) -+int rtw_mlme_update_wfd_ie_data(struct mlme_priv *mlme, u8 type, u8 *ie, u32 ie_len) -+{ -+ _adapter *adapter = mlme_to_adapter(mlme); -+ struct wifi_display_info *wfd_info = &adapter->wfd_info; -+ u8 clear = 0; -+ u8 **t_ie = NULL; -+ u32 *t_ie_len = NULL; -+ int ret = _FAIL; -+ -+ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) -+ goto success; -+ -+ if (wfd_info->wfd_enable == _TRUE) -+ goto success; /* WFD IE is build by self */ -+ -+ if (!ie && !ie_len) -+ clear = 1; -+ else if (!ie || !ie_len) { -+ RTW_PRINT(FUNC_ADPT_FMT" type:%u, ie:%p, ie_len:%u" -+ , FUNC_ADPT_ARG(adapter), type, ie, ie_len); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ switch (type) { -+ case MLME_BEACON_IE: -+ t_ie = &mlme->wfd_beacon_ie; -+ t_ie_len = &mlme->wfd_beacon_ie_len; -+ break; -+ case MLME_PROBE_REQ_IE: -+ t_ie = &mlme->wfd_probe_req_ie; -+ t_ie_len = &mlme->wfd_probe_req_ie_len; -+ break; -+ case MLME_PROBE_RESP_IE: -+ t_ie = &mlme->wfd_probe_resp_ie; -+ t_ie_len = &mlme->wfd_probe_resp_ie_len; -+ break; -+ case MLME_GO_PROBE_RESP_IE: -+ t_ie = &mlme->wfd_go_probe_resp_ie; -+ t_ie_len = &mlme->wfd_go_probe_resp_ie_len; -+ break; -+ case MLME_ASSOC_REQ_IE: -+ t_ie = &mlme->wfd_assoc_req_ie; -+ t_ie_len = &mlme->wfd_assoc_req_ie_len; -+ break; -+ case MLME_ASSOC_RESP_IE: -+ t_ie = &mlme->wfd_assoc_resp_ie; -+ t_ie_len = &mlme->wfd_assoc_resp_ie_len; -+ break; -+ default: -+ RTW_PRINT(FUNC_ADPT_FMT" unsupported type:%u" -+ , FUNC_ADPT_ARG(adapter), type); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (*t_ie) { -+ u32 free_len = *t_ie_len; -+ *t_ie_len = 0; -+ rtw_mfree(*t_ie, free_len); -+ *t_ie = NULL; -+ } -+ -+ if (!clear) { -+ *t_ie = rtw_malloc(ie_len); -+ if (*t_ie == NULL) { -+ RTW_ERR(FUNC_ADPT_FMT" type:%u, rtw_malloc() fail\n" -+ , FUNC_ADPT_ARG(adapter), type); -+ goto exit; -+ } -+ _rtw_memcpy(*t_ie, ie, ie_len); -+ *t_ie_len = ie_len; -+ } -+ -+ if (*t_ie && *t_ie_len) { -+ u8 *attr_content; -+ u32 attr_contentlen = 0; -+ -+ attr_content = rtw_get_wfd_attr_content(*t_ie, *t_ie_len, WFD_ATTR_DEVICE_INFO, NULL, &attr_contentlen); -+ if (attr_content && attr_contentlen) { -+ if (RTW_GET_BE16(attr_content + 2) != wfd_info->rtsp_ctrlport) { -+ wfd_info->rtsp_ctrlport = RTW_GET_BE16(attr_content + 2); -+ RTW_INFO(FUNC_ADPT_FMT" type:%u, RTSP CTRL port = %u\n" -+ , FUNC_ADPT_ARG(adapter), type, wfd_info->rtsp_ctrlport); -+ } -+ } -+ } -+ -+success: -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+#endif /* defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) */ -+ -+void _rtw_free_mlme_priv(struct mlme_priv *pmlmepriv) -+{ -+ if (NULL == pmlmepriv) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ rtw_free_mlme_priv_ie_data(pmlmepriv); -+ -+ if (pmlmepriv) { -+ rtw_mfree_mlme_priv_lock(pmlmepriv); -+ -+ if (pmlmepriv->free_bss_buf) -+ rtw_vmfree(pmlmepriv->free_bss_buf, MAX_BSS_CNT * sizeof(struct wlan_network)); -+ } -+exit: -+ return; -+} -+ -+sint _rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork) -+{ -+ _irqL irqL; -+ -+ -+ if (pnetwork == NULL) -+ goto exit; -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ rtw_list_insert_tail(&pnetwork->list, &queue->queue); -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+exit: -+ -+ -+ return _SUCCESS; -+} -+ -+/* -+struct wlan_network *_rtw_dequeue_network(_queue *queue) -+{ -+ _irqL irqL; -+ -+ struct wlan_network *pnetwork; -+ -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ if (_rtw_queue_empty(queue) == _TRUE) -+ -+ pnetwork = NULL; -+ -+ else -+ { -+ pnetwork = LIST_CONTAINOR(get_next(&queue->queue), struct wlan_network, list); -+ -+ rtw_list_delete(&(pnetwork->list)); -+ } -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ -+ return pnetwork; -+} -+*/ -+ -+struct wlan_network *_rtw_alloc_network(struct mlme_priv *pmlmepriv) /* (_queue *free_queue) */ -+{ -+ _irqL irqL; -+ struct wlan_network *pnetwork; -+ _queue *free_queue = &pmlmepriv->free_bss_pool; -+ _list *plist = NULL; -+ -+ -+ _enter_critical_bh(&free_queue->lock, &irqL); -+ -+ if (_rtw_queue_empty(free_queue) == _TRUE) { -+ pnetwork = NULL; -+ goto exit; -+ } -+ plist = get_next(&(free_queue->queue)); -+ -+ pnetwork = LIST_CONTAINOR(plist , struct wlan_network, list); -+ -+ rtw_list_delete(&pnetwork->list); -+ -+ pnetwork->network_type = 0; -+ pnetwork->fixed = _FALSE; -+ pnetwork->last_scanned = rtw_get_current_time(); -+ pnetwork->aid = 0; -+ pnetwork->join_res = 0; -+ -+ pmlmepriv->num_of_scanned++; -+ -+exit: -+ _exit_critical_bh(&free_queue->lock, &irqL); -+ -+ -+ return pnetwork; -+} -+ -+void _rtw_free_network(struct mlme_priv *pmlmepriv , struct wlan_network *pnetwork, u8 isfreeall) -+{ -+ u32 delta_time; -+ u32 lifetime = SCANQUEUE_LIFETIME; -+ _irqL irqL; -+ _queue *free_queue = &(pmlmepriv->free_bss_pool); -+ -+ -+ if (pnetwork == NULL) -+ goto exit; -+ -+ if (pnetwork->fixed == _TRUE) -+ goto exit; -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) -+ lifetime = 1; -+ -+ if (!isfreeall) { -+ delta_time = (u32) rtw_get_passing_time_ms(pnetwork->last_scanned); -+ if (delta_time < lifetime) /* unit:msec */ -+ goto exit; -+ } -+ -+ _enter_critical_bh(&free_queue->lock, &irqL); -+ -+ rtw_list_delete(&(pnetwork->list)); -+ -+ rtw_list_insert_tail(&(pnetwork->list), &(free_queue->queue)); -+ -+ pmlmepriv->num_of_scanned--; -+ -+ -+ /* RTW_INFO("_rtw_free_network:SSID=%s\n", pnetwork->network.Ssid.Ssid); */ -+ -+ _exit_critical_bh(&free_queue->lock, &irqL); -+ -+exit: -+ return; -+} -+ -+void _rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork) -+{ -+ -+ _queue *free_queue = &(pmlmepriv->free_bss_pool); -+ -+ -+ if (pnetwork == NULL) -+ goto exit; -+ -+ if (pnetwork->fixed == _TRUE) -+ goto exit; -+ -+ /* _enter_critical(&free_queue->lock, &irqL); */ -+ -+ rtw_list_delete(&(pnetwork->list)); -+ -+ rtw_list_insert_tail(&(pnetwork->list), get_list_head(free_queue)); -+ -+ pmlmepriv->num_of_scanned--; -+ -+ /* _exit_critical(&free_queue->lock, &irqL); */ -+ -+exit: -+ return; -+} -+ -+ -+/* -+ return the wlan_network with the matching addr -+ -+ Shall be calle under atomic context... to avoid possible racing condition... -+*/ -+struct wlan_network *_rtw_find_network(_queue *scanned_queue, u8 *addr) -+{ -+ -+ /* _irqL irqL; */ -+ _list *phead, *plist; -+ struct wlan_network *pnetwork = NULL; -+ u8 zero_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; -+ -+ -+ if (_rtw_memcmp(zero_addr, addr, ETH_ALEN)) { -+ pnetwork = NULL; -+ goto exit; -+ } -+ -+ /* _enter_critical_bh(&scanned_queue->lock, &irqL); */ -+ -+ phead = get_list_head(scanned_queue); -+ plist = get_next(phead); -+ -+ while (plist != phead) { -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network , list); -+ -+ if (_rtw_memcmp(addr, pnetwork->network.MacAddress, ETH_ALEN) == _TRUE) -+ break; -+ -+ plist = get_next(plist); -+ } -+ -+ if (plist == phead) -+ pnetwork = NULL; -+ -+ /* _exit_critical_bh(&scanned_queue->lock, &irqL); */ -+ -+exit: -+ -+ -+ return pnetwork; -+ -+} -+ -+ -+void _rtw_free_network_queue(_adapter *padapter, u8 isfreeall) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ struct wlan_network *pnetwork; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _queue *scanned_queue = &pmlmepriv->scanned_queue; -+ -+ -+ -+ _enter_critical_bh(&scanned_queue->lock, &irqL); -+ -+ phead = get_list_head(scanned_queue); -+ plist = get_next(phead); -+ -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ plist = get_next(plist); -+ -+ _rtw_free_network(pmlmepriv, pnetwork, isfreeall); -+ -+ } -+ -+ _exit_critical_bh(&scanned_queue->lock, &irqL); -+ -+ -+} -+ -+ -+ -+ -+sint rtw_if_up(_adapter *padapter) -+{ -+ -+ sint res; -+ -+ if (RTW_CANNOT_RUN(padapter) || -+ (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _FALSE)) { -+ res = _FALSE; -+ } else -+ res = _TRUE; -+ -+ return res; -+} -+ -+ -+void rtw_generate_random_ibss(u8 *pibss) -+{ -+ *((u32 *)(&pibss[2])) = rtw_random32(); -+ pibss[0] = 0x02; /* in ad-hoc mode local bit must set to 1 */ -+ pibss[1] = 0x11; -+ pibss[2] = 0x87; -+} -+ -+u8 *rtw_get_capability_from_ie(u8 *ie) -+{ -+ return ie + 8 + 2; -+} -+ -+ -+u16 rtw_get_capability(WLAN_BSSID_EX *bss) -+{ -+ u16 val; -+ -+ _rtw_memcpy((u8 *)&val, rtw_get_capability_from_ie(bss->IEs), 2); -+ -+ return le16_to_cpu(val); -+} -+ -+u8 *rtw_get_timestampe_from_ie(u8 *ie) -+{ -+ return ie + 0; -+} -+ -+u8 *rtw_get_beacon_interval_from_ie(u8 *ie) -+{ -+ return ie + 8; -+} -+ -+ -+int rtw_init_mlme_priv(_adapter *padapter) /* (struct mlme_priv *pmlmepriv) */ -+{ -+ int res; -+ res = _rtw_init_mlme_priv(padapter);/* (pmlmepriv); */ -+ return res; -+} -+ -+void rtw_free_mlme_priv(struct mlme_priv *pmlmepriv) -+{ -+ _rtw_free_mlme_priv(pmlmepriv); -+} -+ -+int rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork); -+int rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork) -+{ -+ int res; -+ res = _rtw_enqueue_network(queue, pnetwork); -+ return res; -+} -+ -+/* -+static struct wlan_network *rtw_dequeue_network(_queue *queue) -+{ -+ struct wlan_network *pnetwork; -+ pnetwork = _rtw_dequeue_network(queue); -+ return pnetwork; -+} -+*/ -+ -+struct wlan_network *rtw_alloc_network(struct mlme_priv *pmlmepriv); -+struct wlan_network *rtw_alloc_network(struct mlme_priv *pmlmepriv) /* (_queue *free_queue) */ -+{ -+ struct wlan_network *pnetwork; -+ pnetwork = _rtw_alloc_network(pmlmepriv); -+ return pnetwork; -+} -+ -+void rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 is_freeall); -+void rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 is_freeall)/* (struct wlan_network *pnetwork, _queue *free_queue) */ -+{ -+ _rtw_free_network(pmlmepriv, pnetwork, is_freeall); -+} -+ -+void rtw_free_network_nolock(_adapter *padapter, struct wlan_network *pnetwork); -+void rtw_free_network_nolock(_adapter *padapter, struct wlan_network *pnetwork) -+{ -+ _rtw_free_network_nolock(&(padapter->mlmepriv), pnetwork); -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_unlink_bss(padapter, pnetwork); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+} -+ -+ -+void rtw_free_network_queue(_adapter *dev, u8 isfreeall) -+{ -+ _rtw_free_network_queue(dev, isfreeall); -+} -+ -+/* -+ return the wlan_network with the matching addr -+ -+ Shall be calle under atomic context... to avoid possible racing condition... -+*/ -+struct wlan_network *rtw_find_network(_queue *scanned_queue, u8 *addr) -+{ -+ struct wlan_network *pnetwork = _rtw_find_network(scanned_queue, addr); -+ -+ return pnetwork; -+} -+ -+int rtw_is_same_ibss(_adapter *adapter, struct wlan_network *pnetwork) -+{ -+ int ret = _TRUE; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ -+ if ((psecuritypriv->dot11PrivacyAlgrthm != _NO_PRIVACY_) && -+ (pnetwork->network.Privacy == 0)) -+ ret = _FALSE; -+ else if ((psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_) && -+ (pnetwork->network.Privacy == 1)) -+ ret = _FALSE; -+ else -+ ret = _TRUE; -+ -+ return ret; -+ -+} -+ -+inline int is_same_ess(WLAN_BSSID_EX *a, WLAN_BSSID_EX *b) -+{ -+ return (a->Ssid.SsidLength == b->Ssid.SsidLength) -+ && _rtw_memcmp(a->Ssid.Ssid, b->Ssid.Ssid, a->Ssid.SsidLength) == _TRUE; -+} -+ -+int is_same_network(WLAN_BSSID_EX *src, WLAN_BSSID_EX *dst, u8 feature) -+{ -+ u16 s_cap, d_cap; -+ -+ -+ if (rtw_bug_check(dst, src, &s_cap, &d_cap) == _FALSE) -+ return _FALSE; -+ -+ _rtw_memcpy((u8 *)&s_cap, rtw_get_capability_from_ie(src->IEs), 2); -+ _rtw_memcpy((u8 *)&d_cap, rtw_get_capability_from_ie(dst->IEs), 2); -+ -+ -+ s_cap = le16_to_cpu(s_cap); -+ d_cap = le16_to_cpu(d_cap); -+ -+ -+#ifdef CONFIG_P2P -+ if ((feature == 1) && /* 1: P2P supported */ -+ (_rtw_memcmp(src->MacAddress, dst->MacAddress, ETH_ALEN) == _TRUE) -+ ) -+ return _TRUE; -+#endif -+ -+ return ((src->Ssid.SsidLength == dst->Ssid.SsidLength) && -+ /* (src->Configuration.DSConfig == dst->Configuration.DSConfig) && */ -+ ((_rtw_memcmp(src->MacAddress, dst->MacAddress, ETH_ALEN)) == _TRUE) && -+ ((_rtw_memcmp(src->Ssid.Ssid, dst->Ssid.Ssid, src->Ssid.SsidLength)) == _TRUE) && -+ ((s_cap & WLAN_CAPABILITY_IBSS) == -+ (d_cap & WLAN_CAPABILITY_IBSS)) && -+ ((s_cap & WLAN_CAPABILITY_BSS) == -+ (d_cap & WLAN_CAPABILITY_BSS))); -+ -+} -+ -+struct wlan_network *_rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network) -+{ -+ _list *phead, *plist; -+ struct wlan_network *found = NULL; -+ -+ phead = get_list_head(scanned_queue); -+ plist = get_next(phead); -+ -+ while (plist != phead) { -+ found = LIST_CONTAINOR(plist, struct wlan_network , list); -+ -+ if (is_same_network(&network->network, &found->network, 0)) -+ break; -+ -+ plist = get_next(plist); -+ } -+ -+ if (plist == phead) -+ found = NULL; -+exit: -+ return found; -+} -+ -+struct wlan_network *rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network) -+{ -+ _irqL irqL; -+ struct wlan_network *found = NULL; -+ -+ if (scanned_queue == NULL || network == NULL) -+ goto exit; -+ -+ _enter_critical_bh(&scanned_queue->lock, &irqL); -+ found = _rtw_find_same_network(scanned_queue, network); -+ _exit_critical_bh(&scanned_queue->lock, &irqL); -+ -+exit: -+ return found; -+} -+ -+struct wlan_network *rtw_get_oldest_wlan_network(_queue *scanned_queue) -+{ -+ _list *plist, *phead; -+ -+ -+ struct wlan_network *pwlan = NULL; -+ struct wlan_network *oldest = NULL; -+ phead = get_list_head(scanned_queue); -+ -+ plist = get_next(phead); -+ -+ while (1) { -+ -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pwlan = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ if (pwlan->fixed != _TRUE) { -+ if (oldest == NULL || time_after(oldest->last_scanned, pwlan->last_scanned)) -+ oldest = pwlan; -+ } -+ -+ plist = get_next(plist); -+ } -+ return oldest; -+ -+} -+ -+void update_network(WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src, -+ _adapter *padapter, bool update_ie) -+{ -+ u8 ss_ori = dst->PhyInfo.SignalStrength; -+ u8 sq_ori = dst->PhyInfo.SignalQuality; -+ long rssi_ori = dst->Rssi; -+ -+ u8 ss_smp = src->PhyInfo.SignalStrength; -+ u8 sq_smp = src->PhyInfo.SignalQuality; -+ long rssi_smp = src->Rssi; -+ -+ u8 ss_final; -+ u8 sq_final; -+ long rssi_final; -+ -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ rtw_hal_antdiv_rssi_compared(padapter, dst, src); /* this will update src.Rssi, need consider again */ -+#endif -+ -+#if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) && 1 -+ if (strcmp(dst->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" %s("MAC_FMT", ch%u) ss_ori:%3u, sq_ori:%3u, rssi_ori:%3ld, ss_smp:%3u, sq_smp:%3u, rssi_smp:%3ld\n" -+ , FUNC_ADPT_ARG(padapter) -+ , src->Ssid.Ssid, MAC_ARG(src->MacAddress), src->Configuration.DSConfig -+ , ss_ori, sq_ori, rssi_ori -+ , ss_smp, sq_smp, rssi_smp -+ ); -+ } -+#endif -+ -+ /* The rule below is 1/5 for sample value, 4/5 for history value */ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) && is_same_network(&(padapter->mlmepriv.cur_network.network), src, 0)) { -+ /* Take the recvpriv's value for the connected AP*/ -+ ss_final = padapter->recvpriv.signal_strength; -+ sq_final = padapter->recvpriv.signal_qual; -+ /* the rssi value here is undecorated, and will be used for antenna diversity */ -+ if (sq_smp != 101) /* from the right channel */ -+ rssi_final = (src->Rssi + dst->Rssi * 4) / 5; -+ else -+ rssi_final = rssi_ori; -+ } else { -+ if (sq_smp != 101) { /* from the right channel */ -+ ss_final = ((u32)(src->PhyInfo.SignalStrength) + (u32)(dst->PhyInfo.SignalStrength) * 4) / 5; -+ sq_final = ((u32)(src->PhyInfo.SignalQuality) + (u32)(dst->PhyInfo.SignalQuality) * 4) / 5; -+ rssi_final = (src->Rssi + dst->Rssi * 4) / 5; -+ } else { -+ /* bss info not receving from the right channel, use the original RX signal infos */ -+ ss_final = dst->PhyInfo.SignalStrength; -+ sq_final = dst->PhyInfo.SignalQuality; -+ rssi_final = dst->Rssi; -+ } -+ -+ } -+ -+ if (update_ie) { -+ dst->Reserved[0] = src->Reserved[0]; -+ dst->Reserved[1] = src->Reserved[1]; -+ _rtw_memcpy((u8 *)dst, (u8 *)src, get_WLAN_BSSID_EX_sz(src)); -+ } -+ -+ dst->PhyInfo.SignalStrength = ss_final; -+ dst->PhyInfo.SignalQuality = sq_final; -+ dst->Rssi = rssi_final; -+ -+#if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) && 1 -+ if (strcmp(dst->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" %s("MAC_FMT"), SignalStrength:%u, SignalQuality:%u, RawRSSI:%ld\n" -+ , FUNC_ADPT_ARG(padapter) -+ , dst->Ssid.Ssid, MAC_ARG(dst->MacAddress), dst->PhyInfo.SignalStrength, dst->PhyInfo.SignalQuality, dst->Rssi); -+ } -+#endif -+ -+#if 0 /* old codes, may be useful one day... -+ * RTW_INFO("update_network: rssi=0x%lx dst->Rssi=%d ,dst->Rssi=0x%lx , src->Rssi=0x%lx",(dst->Rssi+src->Rssi)/2,dst->Rssi,dst->Rssi,src->Rssi); */ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) && is_same_network(&(padapter->mlmepriv.cur_network.network), src)) { -+ -+ /* RTW_INFO("b:ssid=%s update_network: src->rssi=0x%d padapter->recvpriv.ui_rssi=%d\n",src->Ssid.Ssid,src->Rssi,padapter->recvpriv.signal); */ -+ if (padapter->recvpriv.signal_qual_data.total_num++ >= PHY_LINKQUALITY_SLID_WIN_MAX) { -+ padapter->recvpriv.signal_qual_data.total_num = PHY_LINKQUALITY_SLID_WIN_MAX; -+ last_evm = padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index]; -+ padapter->recvpriv.signal_qual_data.total_val -= last_evm; -+ } -+ padapter->recvpriv.signal_qual_data.total_val += query_rx_pwr_percentage(src->Rssi); -+ -+ padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = query_rx_pwr_percentage(src->Rssi); -+ if (padapter->recvpriv.signal_qual_data.index >= PHY_LINKQUALITY_SLID_WIN_MAX) -+ padapter->recvpriv.signal_qual_data.index = 0; -+ -+ /* RTW_INFO("Total SQ=%d pattrib->signal_qual= %d\n", padapter->recvpriv.signal_qual_data.total_val, src->Rssi); */ -+ -+ /* <1> Showed on UI for user,in percentage. */ -+ tmpVal = padapter->recvpriv.signal_qual_data.total_val / padapter->recvpriv.signal_qual_data.total_num; -+ padapter->recvpriv.signal = (u8)tmpVal; /* Link quality */ -+ -+ src->Rssi = translate_percentage_to_dbm(padapter->recvpriv.signal) ; -+ } else { -+ /* RTW_INFO("ELSE:ssid=%s update_network: src->rssi=0x%d dst->rssi=%d\n",src->Ssid.Ssid,src->Rssi,dst->Rssi); */ -+ src->Rssi = (src->Rssi + dst->Rssi) / 2; /* dBM */ -+ } -+ -+ /* RTW_INFO("a:update_network: src->rssi=0x%d padapter->recvpriv.ui_rssi=%d\n",src->Rssi,padapter->recvpriv.signal); */ -+ -+#endif -+ -+} -+ -+static void update_current_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork) -+{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ -+ rtw_bug_check(&(pmlmepriv->cur_network.network), -+ &(pmlmepriv->cur_network.network), -+ &(pmlmepriv->cur_network.network), -+ &(pmlmepriv->cur_network.network)); -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && (is_same_network(&(pmlmepriv->cur_network.network), pnetwork, 0))) { -+ -+ /* if(pmlmepriv->cur_network.network.IELength<= pnetwork->IELength) */ -+ { -+ update_network(&(pmlmepriv->cur_network.network), pnetwork, adapter, _TRUE); -+ rtw_update_protection(adapter, (pmlmepriv->cur_network.network.IEs) + sizeof(NDIS_802_11_FIXED_IEs), -+ pmlmepriv->cur_network.network.IELength); -+ } -+ } -+ -+ -+} -+ -+ -+/* -+ -+Caller must hold pmlmepriv->lock first. -+ -+ -+*/ -+void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ ULONG bssid_ex_sz; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); -+#endif /* CONFIG_P2P */ -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ struct wlan_network *oldest = NULL; -+ int target_find = 0; -+ u8 feature = 0; -+ -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ feature = 1; /* p2p enable */ -+#endif -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ rtw_bug_check(pnetwork, pnetwork, pnetwork, pnetwork); -+ -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && -+ (_rtw_memcmp(pnetwork->network.MacAddress, target->MacAddress, ETH_ALEN) == _TRUE)) { -+ target_find = 1; -+ break; -+ } -+#endif -+ -+ if (is_same_network(&(pnetwork->network), target, feature)) { -+ target_find = 1; -+ break; -+ } -+ -+ if (rtw_roam_flags(adapter)) { -+ /* TODO: don't select netowrk in the same ess as oldest if it's new enough*/ -+ } -+ -+ if (oldest == NULL || time_after(oldest->last_scanned, pnetwork->last_scanned)) -+ oldest = pnetwork; -+ -+ plist = get_next(plist); -+ -+ } -+ -+ -+ /* If we didn't find a match, then get a new network slot to initialize -+ * with this beacon's information */ -+ /* if (rtw_end_of_queue_search(phead,plist)== _TRUE) { */ -+ if (!target_find) { -+ if (_rtw_queue_empty(&(pmlmepriv->free_bss_pool)) == _TRUE) { -+ /* If there are no more slots, expire the oldest */ -+ /* list_del_init(&oldest->list); */ -+ pnetwork = oldest; -+ if (pnetwork == NULL) { -+ goto exit; -+ } -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ rtw_hal_get_odm_var(adapter, HAL_ODM_ANTDIV_SELECT, &(target->PhyInfo.Optimum_antenna), NULL); -+#endif -+ _rtw_memcpy(&(pnetwork->network), target, get_WLAN_BSSID_EX_sz(target)); -+ /* pnetwork->last_scanned = rtw_get_current_time(); */ -+ /* variable initialize */ -+ pnetwork->fixed = _FALSE; -+ pnetwork->last_scanned = rtw_get_current_time(); -+ -+ pnetwork->network_type = 0; -+ pnetwork->aid = 0; -+ pnetwork->join_res = 0; -+ -+ /* bss info not receving from the right channel */ -+ if (pnetwork->network.PhyInfo.SignalQuality == 101) -+ pnetwork->network.PhyInfo.SignalQuality = 0; -+ } else { -+ /* Otherwise just pull from the free list */ -+ -+ pnetwork = rtw_alloc_network(pmlmepriv); /* will update scan_time */ -+ -+ if (pnetwork == NULL) { -+ goto exit; -+ } -+ -+ bssid_ex_sz = get_WLAN_BSSID_EX_sz(target); -+ target->Length = bssid_ex_sz; -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ rtw_hal_get_odm_var(adapter, HAL_ODM_ANTDIV_SELECT, &(target->PhyInfo.Optimum_antenna), NULL); -+#endif -+ _rtw_memcpy(&(pnetwork->network), target, bssid_ex_sz); -+ -+ pnetwork->last_scanned = rtw_get_current_time(); -+ -+ /* bss info not receving from the right channel */ -+ if (pnetwork->network.PhyInfo.SignalQuality == 101) -+ pnetwork->network.PhyInfo.SignalQuality = 0; -+ -+ rtw_list_insert_tail(&(pnetwork->list), &(queue->queue)); -+ -+ } -+ } else { -+ /* we have an entry and we are going to update it. But this entry may -+ * be already expired. In this case we do the same as we found a new -+ * net and call the new_net handler -+ */ -+ bool update_ie = _TRUE; -+ -+ pnetwork->last_scanned = rtw_get_current_time(); -+ -+ /* target.Reserved[0]==1, means that scaned network is a bcn frame. */ -+ if ((pnetwork->network.IELength > target->IELength) && (target->Reserved[0] == 1)) -+ update_ie = _FALSE; -+ -+ /* probe resp(3) > beacon(1) > probe req(2) */ -+ if ((target->Reserved[0] != 2) && -+ (target->Reserved[0] >= pnetwork->network.Reserved[0]) -+ ) -+ update_ie = _TRUE; -+ else -+ update_ie = _FALSE; -+ -+ update_network(&(pnetwork->network), target, adapter, update_ie); -+ } -+ -+exit: -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+} -+ -+void rtw_add_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork); -+void rtw_add_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &(((_adapter *)adapter)->mlmepriv); -+ /* _queue *queue = &(pmlmepriv->scanned_queue); */ -+ -+ -+ /* _enter_critical_bh(&queue->lock, &irqL); */ -+ -+#if defined(CONFIG_P2P) && defined(CONFIG_P2P_REMOVE_GROUP_INFO) -+ if (adapter->registrypriv.wifi_spec == 0) -+ rtw_bss_ex_del_p2p_attr(pnetwork, P2P_ATTR_GROUP_INFO); -+#endif -+ -+ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) -+ rtw_bss_ex_del_wfd_ie(pnetwork); -+ -+ update_current_network(adapter, pnetwork); -+ -+ rtw_update_scanned_network(adapter, pnetwork); -+ -+ /* _exit_critical_bh(&queue->lock, &irqL); */ -+ -+} -+ -+/* select the desired network based on the capability of the (i)bss. -+ * check items: (1) security -+ * (2) network_type -+ * (3) WMM -+ * (4) HT -+ * (5) others */ -+int rtw_is_desired_network(_adapter *adapter, struct wlan_network *pnetwork); -+int rtw_is_desired_network(_adapter *adapter, struct wlan_network *pnetwork) -+{ -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u32 desired_encmode; -+ u32 privacy; -+ -+ /* u8 wps_ie[512]; */ -+ uint wps_ielen; -+ -+ int bselected = _TRUE; -+ -+ desired_encmode = psecuritypriv->ndisencryptstatus; -+ privacy = pnetwork->network.Privacy; -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { -+ if (rtw_get_wps_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_, pnetwork->network.IELength - _FIXED_IE_LENGTH_, NULL, &wps_ielen) != NULL) -+ return _TRUE; -+ else -+ return _FALSE; -+ } -+ if (adapter->registrypriv.wifi_spec == 1) { /* for correct flow of 8021X to do.... */ -+ u8 *p = NULL; -+ uint ie_len = 0; -+ -+ if ((desired_encmode == Ndis802_11EncryptionDisabled) && (privacy != 0)) -+ bselected = _FALSE; -+ -+ if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) { -+ p = rtw_get_ie(pnetwork->network.IEs + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pnetwork->network.IELength - _BEACON_IE_OFFSET_)); -+ if (p && ie_len > 0) -+ bselected = _TRUE; -+ else -+ bselected = _FALSE; -+ } -+ } -+ -+ -+ if ((desired_encmode != Ndis802_11EncryptionDisabled) && (privacy == 0)) { -+ RTW_INFO("desired_encmode: %d, privacy: %d\n", desired_encmode, privacy); -+ bselected = _FALSE; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) { -+ if (pnetwork->network.InfrastructureMode != pmlmepriv->cur_network.network.InfrastructureMode) -+ bselected = _FALSE; -+ } -+ -+ -+ return bselected; -+} -+ -+/* TODO: Perry : For Power Management */ -+void rtw_atimdone_event_callback(_adapter *adapter , u8 *pbuf) -+{ -+ -+ return; -+} -+ -+ -+void rtw_survey_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL; -+ u32 len; -+ WLAN_BSSID_EX *pnetwork; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ -+ pnetwork = (WLAN_BSSID_EX *)pbuf; -+ -+ -+#ifdef CONFIG_RTL8712 -+ /* endian_convert */ -+ pnetwork->Length = le32_to_cpu(pnetwork->Length); -+ pnetwork->Ssid.SsidLength = le32_to_cpu(pnetwork->Ssid.SsidLength); -+ pnetwork->Privacy = le32_to_cpu(pnetwork->Privacy); -+ pnetwork->Rssi = le32_to_cpu(pnetwork->Rssi); -+ pnetwork->NetworkTypeInUse = le32_to_cpu(pnetwork->NetworkTypeInUse); -+ pnetwork->Configuration.ATIMWindow = le32_to_cpu(pnetwork->Configuration.ATIMWindow); -+ pnetwork->Configuration.BeaconPeriod = le32_to_cpu(pnetwork->Configuration.BeaconPeriod); -+ pnetwork->Configuration.DSConfig = le32_to_cpu(pnetwork->Configuration.DSConfig); -+ pnetwork->Configuration.FHConfig.DwellTime = le32_to_cpu(pnetwork->Configuration.FHConfig.DwellTime); -+ pnetwork->Configuration.FHConfig.HopPattern = le32_to_cpu(pnetwork->Configuration.FHConfig.HopPattern); -+ pnetwork->Configuration.FHConfig.HopSet = le32_to_cpu(pnetwork->Configuration.FHConfig.HopSet); -+ pnetwork->Configuration.FHConfig.Length = le32_to_cpu(pnetwork->Configuration.FHConfig.Length); -+ pnetwork->Configuration.Length = le32_to_cpu(pnetwork->Configuration.Length); -+ pnetwork->InfrastructureMode = le32_to_cpu(pnetwork->InfrastructureMode); -+ pnetwork->IELength = le32_to_cpu(pnetwork->IELength); -+#endif -+ -+ len = get_WLAN_BSSID_EX_sz(pnetwork); -+ if (len > (sizeof(WLAN_BSSID_EX))) { -+ return; -+ } -+ -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ /* update IBSS_network 's timestamp */ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == _TRUE) { -+ if (_rtw_memcmp(&(pmlmepriv->cur_network.network.MacAddress), pnetwork->MacAddress, ETH_ALEN)) { -+ struct wlan_network *ibss_wlan = NULL; -+ _irqL irqL; -+ -+ _rtw_memcpy(pmlmepriv->cur_network.network.IEs, pnetwork->IEs, 8); -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ ibss_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->MacAddress); -+ if (ibss_wlan) { -+ _rtw_memcpy(ibss_wlan->network.IEs , pnetwork->IEs, 8); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ goto exit; -+ } -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ } -+ } -+ -+ /* lock pmlmepriv->lock when you accessing network_q */ -+ if ((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == _FALSE) { -+ if (pnetwork->Ssid.Ssid[0] == 0) -+ pnetwork->Ssid.SsidLength = 0; -+ rtw_add_network(adapter, pnetwork); -+ } -+ -+exit: -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+ return; -+} -+ -+void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL; -+ u8 timer_cancelled; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+#ifdef CONFIG_RTW_80211R -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+#endif -+ -+#ifdef CONFIG_MLME_EXT -+ mlmeext_surveydone_event_callback(adapter); -+#endif -+ -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ if (pmlmepriv->wps_probe_req_ie) { -+ u32 free_len = pmlmepriv->wps_probe_req_ie_len; -+ pmlmepriv->wps_probe_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); -+ pmlmepriv->wps_probe_req_ie = NULL; -+ } -+ -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _FALSE) { -+ RTW_INFO(FUNC_ADPT_FMT" fw_state:0x%x\n", FUNC_ADPT_ARG(adapter), get_fwstate(pmlmepriv)); -+ /* rtw_warn_on(1); */ -+ } -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ _cancel_timer(&pmlmepriv->scan_to_timer, &timer_cancelled); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ rtw_set_signal_stat_timer(&adapter->recvpriv); -+#endif -+ -+ if (pmlmepriv->to_join == _TRUE) { -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) { -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE) { -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ -+ if (rtw_select_and_join_from_scanned_queue(pmlmepriv) == _SUCCESS) -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ else { -+ WLAN_BSSID_EX *pdev_network = &(adapter->registrypriv.dev_network); -+ u8 *pibss = adapter->registrypriv.dev_network.MacAddress; -+ -+ /* pmlmepriv->fw_state ^= _FW_UNDER_SURVEY; */ /* because don't set assoc_timer */ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ -+ -+ _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); -+ -+ rtw_update_registrypriv_dev_network(adapter); -+ rtw_generate_random_ibss(pibss); -+ -+ /*pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;*/ -+ init_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ -+ if (rtw_create_ibss_cmd(adapter, 0) != _SUCCESS) -+ RTW_ERR("rtw_create_ibss_cmd FAIL\n"); -+ -+ pmlmepriv->to_join = _FALSE; -+ } -+ } -+ } else { -+ int s_ret; -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ pmlmepriv->to_join = _FALSE; -+ s_ret = rtw_select_and_join_from_scanned_queue(pmlmepriv); -+ if (_SUCCESS == s_ret) -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ else if (s_ret == 2) { /* there is no need to wait for join */ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ rtw_indicate_connect(adapter); -+ } else { -+ RTW_INFO("try_to_join, but select scanning queue fail, to_roam:%d\n", rtw_to_roam(adapter)); -+ -+ if (rtw_to_roam(adapter) != 0) { -+ if (rtw_dec_to_roam(adapter) == 0 -+ || _SUCCESS != rtw_sitesurvey_cmd(adapter, &pmlmepriv->assoc_ssid, 1, NULL, 0) -+ ) { -+ rtw_set_to_roam(adapter, 0); -+#ifdef CONFIG_INTEL_WIDI -+ if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) { -+ _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); -+ intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL, 0); -+ RTW_INFO("change to widi listen\n"); -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ rtw_free_assoc_resources(adapter, 1); -+ rtw_indicate_disconnect(adapter, 0, _FALSE); -+ } else -+ pmlmepriv->to_join = _TRUE; -+ } else -+ rtw_indicate_disconnect(adapter, 0, _FALSE); -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ } -+ } -+ } else { -+ if (rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE)) { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED)) { -+ if (rtw_select_roaming_candidate(pmlmepriv) == _SUCCESS) { -+#ifdef CONFIG_RTW_80211R -+ if (rtw_chk_ft_flags(adapter, RTW_FT_OVER_DS_SUPPORTED)) { -+ start_clnt_ft_action(adapter, (u8 *)pmlmepriv->roam_network->network.MacAddress); -+ } else { -+ /*wait a little time to retrieve packets buffered in the current ap while scan*/ -+ _set_timer(&pmlmeext->ft_roam_timer, 30); -+ } -+#else -+ receive_disconnect(adapter, pmlmepriv->cur_network.network.MacAddress -+ , WLAN_REASON_ACTIVE_ROAM, _FALSE); -+#endif -+ } -+ } -+ } -+ } -+ -+ /* RTW_INFO("scan complete in %dms\n",rtw_get_passing_time_ms(pmlmepriv->scan_start_time)); */ -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+#ifdef CONFIG_P2P_PS -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ p2p_ps_wk_cmd(adapter, P2P_PS_SCAN_DONE, 0); -+#endif /* CONFIG_P2P_PS */ -+ -+ rtw_mi_os_xmit_schedule(adapter); -+ -+#ifdef CONFIG_DRVEXT_MODULE_WSC -+ drvext_surveydone_callback(&adapter->drvextpriv); -+#endif -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ { -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ if (pmlmeext->sitesurvey_res.bss_cnt == 0) { -+ /* rtw_hal_sreset_reset(adapter); */ -+ } -+ } -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_surveydone_event_callback(adapter); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ rtw_indicate_scan_done(adapter, _FALSE); -+ -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_IOCTL_CFG80211) -+ rtw_cfg80211_indicate_scan_done_for_buddy(adapter, _FALSE); -+#endif -+ -+} -+ -+void rtw_dummy_event_callback(_adapter *adapter , u8 *pbuf) -+{ -+ -+} -+ -+void rtw_fwdbg_event_callback(_adapter *adapter , u8 *pbuf) -+{ -+ -+} -+ -+static void free_scanqueue(struct mlme_priv *pmlmepriv) -+{ -+ _irqL irqL, irqL0; -+ _queue *free_queue = &pmlmepriv->free_bss_pool; -+ _queue *scan_queue = &pmlmepriv->scanned_queue; -+ _list *plist, *phead, *ptemp; -+ -+ -+ _enter_critical_bh(&scan_queue->lock, &irqL0); -+ _enter_critical_bh(&free_queue->lock, &irqL); -+ -+ phead = get_list_head(scan_queue); -+ plist = get_next(phead); -+ -+ while (plist != phead) { -+ ptemp = get_next(plist); -+ rtw_list_delete(plist); -+ rtw_list_insert_tail(plist, &free_queue->queue); -+ plist = ptemp; -+ pmlmepriv->num_of_scanned--; -+ } -+ -+ _exit_critical_bh(&free_queue->lock, &irqL); -+ _exit_critical_bh(&scan_queue->lock, &irqL0); -+ -+} -+ -+void rtw_reset_rx_info(struct debug_priv *pdbgpriv) -+{ -+ pdbgpriv->dbg_rx_ampdu_drop_count = 0; -+ pdbgpriv->dbg_rx_ampdu_forced_indicate_count = 0; -+ pdbgpriv->dbg_rx_ampdu_loss_count = 0; -+ pdbgpriv->dbg_rx_dup_mgt_frame_drop_count = 0; -+ pdbgpriv->dbg_rx_ampdu_window_shift_cnt = 0; -+} -+ -+/* -+*rtw_free_assoc_resources: the caller has to lock pmlmepriv->lock -+*/ -+void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue) -+{ -+ _irqL irqL; -+ struct wlan_network *pwlan = NULL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct wlan_network *tgt_network = &pmlmepriv->cur_network; -+ struct dvobj_priv *psdpriv = adapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; -+#endif /* CONFIG_TDLS */ -+ -+ -+ RTW_INFO("%s-"ADPT_FMT" tgt_network MacAddress=" MAC_FMT"ssid=%s\n", -+ __func__, ADPT_ARG(adapter), MAC_ARG(tgt_network->network.MacAddress), tgt_network->network.Ssid.Ssid); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ struct sta_info *psta; -+ -+ psta = rtw_get_stainfo(&adapter->stapriv, tgt_network->network.MacAddress); -+ -+#ifdef CONFIG_TDLS -+ if (ptdlsinfo->link_established == _TRUE) { -+ rtw_tdls_cmd(adapter, NULL, TDLS_RS_RCR); -+ rtw_reset_tdls_info(adapter); -+ rtw_free_all_stainfo(adapter); -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ } else -+#endif /* CONFIG_TDLS */ -+ { -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ rtw_free_stainfo(adapter, psta); -+ } -+ -+ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { -+ struct sta_info *psta; -+ -+ rtw_free_all_stainfo(adapter); -+ -+ psta = rtw_get_bcmc_stainfo(adapter); -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ rtw_free_stainfo(adapter, psta); -+ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ -+ rtw_init_bcmc_stainfo(adapter); -+ } -+ -+ if (lock_scanned_queue) -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ pwlan = _rtw_find_same_network(&pmlmepriv->scanned_queue, tgt_network); -+ if ((pwlan) && (!check_fwstate(pmlmepriv, WIFI_UNDER_WPS))) { -+ pwlan->fixed = _FALSE; -+ -+ RTW_INFO("free disconnecting network of scanned_queue\n"); -+ rtw_free_network_nolock(adapter, pwlan); -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(&adapter->wdinfo, P2P_STATE_NONE)) { -+ rtw_mi_set_scan_deny(adapter, 2000); -+ /* rtw_clear_scan_deny(adapter); */ -+ } -+#endif /* CONFIG_P2P */ -+ } else { -+ if (pwlan == NULL) -+ RTW_INFO("free disconnecting network of scanned_queue failed due to pwlan== NULL\n\n"); -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) -+ RTW_INFO("donot free disconnecting network of scanned_queue when WIFI_UNDER_WPS\n\n"); -+ } -+ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) && (adapter->stapriv.asoc_sta_count == 1)) -+ /*||check_fwstate(pmlmepriv, WIFI_STATION_STATE)*/) { -+ if (pwlan) -+ rtw_free_network_nolock(adapter, pwlan); -+ } -+ -+ if (lock_scanned_queue) -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ adapter->securitypriv.key_mask = 0; -+ -+ rtw_reset_rx_info(pdbgpriv); -+ -+ -+} -+ -+/* -+*rtw_indicate_connect: the caller has to lock pmlmepriv->lock -+*/ -+void rtw_indicate_connect(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ -+ -+ pmlmepriv->to_join = _FALSE; -+ -+ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { -+ -+ set_fwstate(pmlmepriv, _FW_LINKED); -+ -+ rtw_led_control(padapter, LED_CTL_LINK); -+ -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ if (padapter->drvextpriv.enable_wpa) -+ indicate_l2_connect(padapter); -+ else -+#endif -+ { -+ rtw_os_indicate_connect(padapter); -+ } -+ -+ } -+ -+ rtw_set_to_roam(padapter, 0); -+#ifdef CONFIG_INTEL_WIDI -+ if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) { -+ _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_WK, NULL, 0); -+ RTW_INFO("change to widi listen\n"); -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ if (!check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE)) -+ rtw_mi_set_scan_deny(padapter, 3000); -+ -+ -+} -+ -+ -+/* -+*rtw_indicate_disconnect: the caller has to lock pmlmepriv->lock -+*/ -+void rtw_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally_generated) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *wps_ie = NULL; -+ uint wpsie_len = 0; -+ -+ -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING | WIFI_UNDER_WPS); -+ -+ /* force to clear cur_network_scanned's SELECTED REGISTRAR */ -+ if (pmlmepriv->cur_network_scanned) { -+ WLAN_BSSID_EX *current_joined_bss = &(pmlmepriv->cur_network_scanned->network); -+ if (current_joined_bss) { -+ wps_ie = rtw_get_wps_ie(current_joined_bss->IEs + _FIXED_IE_LENGTH_, -+ current_joined_bss->IELength - _FIXED_IE_LENGTH_, NULL, &wpsie_len); -+ if (wps_ie && wpsie_len > 0) { -+ u8 *attr = NULL; -+ u32 attr_len; -+ attr = rtw_get_wps_attr(wps_ie, wpsie_len, WPS_ATTR_SELECTED_REGISTRAR, -+ NULL, &attr_len); -+ if (attr) -+ *(attr + 4) = 0; -+ } -+ } -+ } -+ /* RTW_INFO("clear wps when %s\n", __func__); */ -+ -+ if (rtw_to_roam(padapter) > 0) -+ _clr_fwstate_(pmlmepriv, _FW_LINKED); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ rtw_wapi_return_one_sta_info(padapter, psta->hwaddr); -+ else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || -+ check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) -+ rtw_wapi_return_all_sta_info(padapter); -+#endif -+ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) -+ || (rtw_to_roam(padapter) <= 0) -+ ) { -+ -+ rtw_os_indicate_disconnect(padapter, reason, locally_generated); -+ -+ /* set ips_deny_time to avoid enter IPS before LPS leave */ -+ rtw_set_ips_deny(padapter, 3000); -+ -+ _clr_fwstate_(pmlmepriv, _FW_LINKED); -+ -+ rtw_led_control(padapter, LED_CTL_NO_LINK); -+ -+ rtw_clear_scan_deny(padapter); -+ } -+ -+#ifdef CONFIG_P2P_PS -+ p2p_ps_wk_cmd(padapter, P2P_PS_DISABLE, 1); -+#endif /* CONFIG_P2P_PS */ -+ -+#ifdef CONFIG_LPS -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, 1); -+#endif -+ -+#ifdef CONFIG_BEAMFORMING -+ beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_LEAVE, cur_network->MacAddress, ETH_ALEN, 1); -+#endif /*CONFIG_BEAMFORMING*/ -+ -+} -+ -+inline void rtw_indicate_scan_done(_adapter *padapter, bool aborted) -+{ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ rtw_os_indicate_scan_done(padapter, aborted); -+ -+#ifdef CONFIG_IPS -+ if (is_primary_adapter(padapter) -+ && (_FALSE == adapter_to_pwrctl(padapter)->bInSuspend) -+ && (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE | WIFI_UNDER_LINKING) == _FALSE)) { -+ struct pwrctrl_priv *pwrpriv; -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ rtw_set_ips_deny(padapter, 0); -+#ifdef CONFIG_IPS_CHECK_IN_WD -+ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 1); -+#else /* !CONFIG_IPS_CHECK_IN_WD */ -+ _rtw_set_pwr_state_check_timer(pwrpriv, 1); -+#endif /* !CONFIG_IPS_CHECK_IN_WD */ -+ } -+#endif /* CONFIG_IPS */ -+} -+ -+static u32 _rtw_wait_scan_done(_adapter *adapter, u8 abort, u32 timeout_ms) -+{ -+ u32 start; -+ u32 pass_ms; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ start = rtw_get_current_time(); -+ -+ pmlmeext->scan_abort = abort; -+ -+ while (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) -+ && rtw_get_passing_time_ms(start) <= timeout_ms) { -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ break; -+ -+ RTW_INFO(FUNC_NDEV_FMT"fw_state=_FW_UNDER_SURVEY!\n", FUNC_NDEV_ARG(adapter->pnetdev)); -+ rtw_msleep_os(20); -+ } -+ -+ if (_TRUE == abort) { -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { -+ if (!RTW_CANNOT_RUN(adapter)) -+ RTW_INFO(FUNC_NDEV_FMT"waiting for scan_abort time out!\n", FUNC_NDEV_ARG(adapter->pnetdev)); -+#ifdef CONFIG_PLATFORM_MSTAR -+ /*_clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY);*/ -+ set_survey_timer(pmlmeext, 0); -+ mlme_set_scan_to_timer(pmlmepriv, 50); -+#endif -+ rtw_indicate_scan_done(adapter, _TRUE); -+ } -+ } -+ -+ pmlmeext->scan_abort = _FALSE; -+ pass_ms = rtw_get_passing_time_ms(start); -+ -+ return pass_ms; -+ -+} -+ -+void rtw_scan_wait_completed(_adapter *adapter) -+{ -+ u32 scan_to = SCANNING_TIMEOUT; -+ -+#ifdef CONFIG_SCAN_BACKOP -+ if (IsSupported5G(adapter->registrypriv.wireless_mode) -+ && IsSupported24G(adapter->registrypriv.wireless_mode)) /*dual band*/ -+ scan_to = CONC_SCANNING_TIMEOUT_DUAL_BAND; -+ else /*single band*/ -+ scan_to = CONC_SCANNING_TIMEOUT_SINGLE_BAND; -+#endif /* CONFIG_SCAN_BACKOP */ -+ -+ _rtw_wait_scan_done(adapter, _FALSE, scan_to); -+} -+ -+u32 rtw_scan_abort_timeout(_adapter *adapter, u32 timeout_ms) -+{ -+ return _rtw_wait_scan_done(adapter, _TRUE, timeout_ms); -+} -+ -+void rtw_scan_abort_no_wait(_adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) -+ pmlmeext->scan_abort = _TRUE; -+} -+ -+void rtw_scan_abort(_adapter *adapter) -+{ -+ rtw_scan_abort_timeout(adapter, 200); -+} -+ -+static struct sta_info *rtw_joinbss_update_stainfo(_adapter *padapter, struct wlan_network *pnetwork) -+{ -+ int i; -+ struct sta_info *bmc_sta, *psta = NULL; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ psta = rtw_get_stainfo(pstapriv, pnetwork->network.MacAddress); -+ if (psta == NULL) -+ psta = rtw_alloc_stainfo(pstapriv, pnetwork->network.MacAddress); -+ -+ if (psta) { /* update ptarget_sta */ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ psta->aid = pnetwork->join_res; -+ -+#if 0 /* alloc macid when call rtw_alloc_stainfo(), and release macid when call rtw_free_stainfo() */ -+#ifdef CONFIG_CONCURRENT_MODE -+ -+ if (PRIMARY_ADAPTER == padapter->adapter_type) -+ psta->mac_id = 0; -+ else -+ psta->mac_id = 2; -+#else -+ psta->mac_id = 0; -+#endif -+#endif /* removed */ -+ -+ update_sta_info(padapter, psta); -+ -+ /* update station supportRate */ -+ psta->bssratelen = rtw_get_rateset_len(pnetwork->network.SupportedRates); -+ _rtw_memcpy(psta->bssrateset, pnetwork->network.SupportedRates, psta->bssratelen); -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ -+ psta->wireless_mode = pmlmeext->cur_wireless_mode; -+ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); -+ -+ -+ /* sta mode */ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); -+ -+ /* security related */ -+#ifdef CONFIG_RTW_80211R -+ if ((padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) && (psta->ft_pairwise_key_installed == _FALSE)) { -+#else -+ if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { -+#endif -+ padapter->securitypriv.binstallGrpkey = _FALSE; -+ padapter->securitypriv.busetkipkey = _FALSE; -+ padapter->securitypriv.bgrpkey_handshake = _FALSE; -+ -+ psta->ieee8021x_blocked = _TRUE; -+ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ -+ _rtw_memset((u8 *)&psta->dot118021x_UncstKey, 0, sizeof(union Keytype)); -+ -+ _rtw_memset((u8 *)&psta->dot11tkiprxmickey, 0, sizeof(union Keytype)); -+ _rtw_memset((u8 *)&psta->dot11tkiptxmickey, 0, sizeof(union Keytype)); -+ -+ _rtw_memset((u8 *)&psta->dot11txpn, 0, sizeof(union pn48)); -+ psta->dot11txpn.val = psta->dot11txpn.val + 1; -+#ifdef CONFIG_IEEE80211W -+ _rtw_memset((u8 *)&psta->dot11wtxpn, 0, sizeof(union pn48)); -+#endif /* CONFIG_IEEE80211W */ -+ _rtw_memset((u8 *)&psta->dot11rxpn, 0, sizeof(union pn48)); -+ } -+ -+ /* Commented by Albert 2012/07/21 */ -+ /* When doing the WPS, the wps_ie_len won't equal to 0 */ -+ /* And the Wi-Fi driver shouldn't allow the data packet to be tramsmitted. */ -+ if (padapter->securitypriv.wps_ie_len != 0) { -+ psta->ieee8021x_blocked = _TRUE; -+ padapter->securitypriv.wps_ie_len = 0; -+ } -+ -+ -+ /* for A-MPDU Rx reordering buffer control for bmc_sta & sta_info */ -+ /* if A-MPDU Rx is enabled, reseting rx_ordering_ctrl wstart_b(indicate_seq) to default value=0xffff */ -+ /* todo: check if AP can send A-MPDU packets */ -+ for (i = 0; i < 16 ; i++) { -+ /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = _FALSE; -+ preorder_ctrl->indicate_seq = 0xffff; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq); -+#endif -+ preorder_ctrl->wend_b = 0xffff; -+ preorder_ctrl->wsize_b = 64;/* max_ampdu_sz; */ /* ex. 32(kbytes) -> wsize_b=32 */ -+ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; -+ } -+ -+ -+ bmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if (bmc_sta) { -+ for (i = 0; i < 16 ; i++) { -+ /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ -+ preorder_ctrl = &bmc_sta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = _FALSE; -+ preorder_ctrl->indicate_seq = 0xffff; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq); -+#endif -+ preorder_ctrl->wend_b = 0xffff; -+ preorder_ctrl->wsize_b = 64;/* max_ampdu_sz; */ /* ex. 32(kbytes) -> wsize_b=32 */ -+ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; -+ } -+ } -+ } -+ -+ return psta; -+ -+} -+ -+/* pnetwork : returns from rtw_joinbss_event_callback -+ * ptarget_wlan: found from scanned_queue */ -+static void rtw_joinbss_update_network(_adapter *padapter, struct wlan_network *ptarget_wlan, struct wlan_network *pnetwork) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ -+ -+ /* why not use ptarget_wlan?? */ -+ _rtw_memcpy(&cur_network->network, &pnetwork->network, pnetwork->network.Length); -+ /* some IEs in pnetwork is wrong, so we should use ptarget_wlan IEs */ -+ cur_network->network.IELength = ptarget_wlan->network.IELength; -+ _rtw_memcpy(&cur_network->network.IEs[0], &ptarget_wlan->network.IEs[0], MAX_IE_SZ); -+ -+ cur_network->aid = pnetwork->join_res; -+ -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ rtw_set_signal_stat_timer(&padapter->recvpriv); -+#endif -+ padapter->recvpriv.signal_strength = ptarget_wlan->network.PhyInfo.SignalStrength; -+ padapter->recvpriv.signal_qual = ptarget_wlan->network.PhyInfo.SignalQuality; -+ /* the ptarget_wlan->network.Rssi is raw data, we use ptarget_wlan->network.PhyInfo.SignalStrength instead (has scaled) */ -+ padapter->recvpriv.rssi = translate_percentage_to_dbm(ptarget_wlan->network.PhyInfo.SignalStrength); -+#if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 -+ RTW_INFO(FUNC_ADPT_FMT" signal_strength:%3u, rssi:%3d, signal_qual:%3u" -+ "\n" -+ , FUNC_ADPT_ARG(padapter) -+ , padapter->recvpriv.signal_strength -+ , padapter->recvpriv.rssi -+ , padapter->recvpriv.signal_qual -+ ); -+#endif -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ rtw_set_signal_stat_timer(&padapter->recvpriv); -+#endif -+ -+ /* update fw_state */ /* will clr _FW_UNDER_LINKING here indirectly */ -+ -+ switch (pnetwork->network.InfrastructureMode) { -+ case Ndis802_11Infrastructure: -+ -+ if (pmlmepriv->fw_state & WIFI_UNDER_WPS) -+ /*pmlmepriv->fw_state = WIFI_STATION_STATE|WIFI_UNDER_WPS;*/ -+ init_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_UNDER_WPS); -+ else -+ /*pmlmepriv->fw_state = WIFI_STATION_STATE;*/ -+ init_fwstate(pmlmepriv, WIFI_STATION_STATE); -+ break; -+ case Ndis802_11IBSS: -+ /*pmlmepriv->fw_state = WIFI_ADHOC_STATE;*/ -+ init_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ break; -+ default: -+ /*pmlmepriv->fw_state = WIFI_NULL_STATE;*/ -+ init_fwstate(pmlmepriv, WIFI_NULL_STATE); -+ break; -+ } -+ -+ rtw_update_protection(padapter, (cur_network->network.IEs) + sizeof(NDIS_802_11_FIXED_IEs), -+ (cur_network->network.IELength)); -+ -+#ifdef CONFIG_80211N_HT -+ rtw_update_ht_cap(padapter, cur_network->network.IEs, cur_network->network.IELength, (u8) cur_network->network.Configuration.DSConfig); -+#endif -+} -+ -+/* Notes: the fucntion could be > passive_level (the same context as Rx tasklet) -+ * pnetwork : returns from rtw_joinbss_event_callback -+ * ptarget_wlan: found from scanned_queue -+ * if join_res > 0, for (fw_state==WIFI_STATION_STATE), we check if "ptarget_sta" & "ptarget_wlan" exist. -+ * if join_res > 0, for (fw_state==WIFI_ADHOC_STATE), we only check if "ptarget_wlan" exist. -+ * if join_res > 0, update "cur_network->network" from "pnetwork->network" if (ptarget_wlan !=NULL). -+ */ -+/* #define REJOIN */ -+void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL, irqL2; -+ static u8 retry = 0; -+ u8 timer_cancelled; -+ struct sta_info *ptarget_sta = NULL, *pcur_sta = NULL; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct wlan_network *pnetwork = (struct wlan_network *)pbuf; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wlan_network *pcur_wlan = NULL, *ptarget_wlan = NULL; -+ unsigned int the_same_macaddr = _FALSE; -+ -+ -+#ifdef CONFIG_RTL8712 -+ /* endian_convert */ -+ pnetwork->join_res = le32_to_cpu(pnetwork->join_res); -+ pnetwork->network_type = le32_to_cpu(pnetwork->network_type); -+ pnetwork->network.Length = le32_to_cpu(pnetwork->network.Length); -+ pnetwork->network.Ssid.SsidLength = le32_to_cpu(pnetwork->network.Ssid.SsidLength); -+ pnetwork->network.Privacy = le32_to_cpu(pnetwork->network.Privacy); -+ pnetwork->network.Rssi = le32_to_cpu(pnetwork->network.Rssi); -+ pnetwork->network.NetworkTypeInUse = le32_to_cpu(pnetwork->network.NetworkTypeInUse) ; -+ pnetwork->network.Configuration.ATIMWindow = le32_to_cpu(pnetwork->network.Configuration.ATIMWindow); -+ pnetwork->network.Configuration.BeaconPeriod = le32_to_cpu(pnetwork->network.Configuration.BeaconPeriod); -+ pnetwork->network.Configuration.DSConfig = le32_to_cpu(pnetwork->network.Configuration.DSConfig); -+ pnetwork->network.Configuration.FHConfig.DwellTime = le32_to_cpu(pnetwork->network.Configuration.FHConfig.DwellTime); -+ pnetwork->network.Configuration.FHConfig.HopPattern = le32_to_cpu(pnetwork->network.Configuration.FHConfig.HopPattern); -+ pnetwork->network.Configuration.FHConfig.HopSet = le32_to_cpu(pnetwork->network.Configuration.FHConfig.HopSet); -+ pnetwork->network.Configuration.FHConfig.Length = le32_to_cpu(pnetwork->network.Configuration.FHConfig.Length); -+ pnetwork->network.Configuration.Length = le32_to_cpu(pnetwork->network.Configuration.Length); -+ pnetwork->network.InfrastructureMode = le32_to_cpu(pnetwork->network.InfrastructureMode); -+ pnetwork->network.IELength = le32_to_cpu(pnetwork->network.IELength); -+#endif -+ -+ -+ rtw_get_encrypt_decrypt_from_registrypriv(adapter); -+ -+ -+ -+ the_same_macaddr = _rtw_memcmp(pnetwork->network.MacAddress, cur_network->network.MacAddress, ETH_ALEN); -+ -+ pnetwork->network.Length = get_WLAN_BSSID_EX_sz(&pnetwork->network); -+ if (pnetwork->network.Length > sizeof(WLAN_BSSID_EX)) { -+ goto ignore_joinbss_callback; -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; -+ -+ -+ if (pnetwork->join_res > 0) { -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ retry = 0; -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) { -+ /* s1. find ptarget_wlan */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ if (the_same_macaddr == _TRUE) -+ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); -+ else { -+ pcur_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); -+ if (pcur_wlan) -+ pcur_wlan->fixed = _FALSE; -+ -+ pcur_sta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); -+ if (pcur_sta) { -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); */ -+ rtw_free_stainfo(adapter, pcur_sta); -+ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); */ -+ } -+ -+ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->network.MacAddress); -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { -+ if (ptarget_wlan) -+ ptarget_wlan->fixed = _TRUE; -+ } -+ } -+ -+ } else { -+ ptarget_wlan = _rtw_find_same_network(&pmlmepriv->scanned_queue, pnetwork); -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { -+ if (ptarget_wlan) -+ ptarget_wlan->fixed = _TRUE; -+ } -+ } -+ -+ /* s2. update cur_network */ -+ if (ptarget_wlan) -+ rtw_joinbss_update_network(adapter, ptarget_wlan, pnetwork); -+ else { -+ RTW_PRINT("Can't find ptarget_wlan when joinbss_event callback\n"); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ goto ignore_joinbss_callback; -+ } -+ -+ -+ /* s3. find ptarget_sta & update ptarget_sta after update cur_network only for station mode */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { -+ ptarget_sta = rtw_joinbss_update_stainfo(adapter, pnetwork); -+ if (ptarget_sta == NULL) { -+ RTW_ERR("Can't update stainfo when joinbss_event callback\n"); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ goto ignore_joinbss_callback; -+ } -+ } -+ -+ /* s4. indicate connect */ -+ if (MLME_IS_STA(adapter) || MLME_IS_ADHOC(adapter)) { -+ pmlmepriv->cur_network_scanned = ptarget_wlan; -+ rtw_indicate_connect(adapter); -+ } -+ -+ /* s5. Cancle assoc_timer */ -+ _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled); -+ -+ -+ } else { -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ goto ignore_joinbss_callback; -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ } else if (pnetwork->join_res == -4) { -+ rtw_reset_securitypriv(adapter); -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ -+ /* rtw_free_assoc_resources(adapter, 1); */ -+ -+ if ((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == _TRUE) { -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ } -+ -+ } else { /* if join_res < 0 (join fails), then try again */ -+ -+#ifdef REJOIN -+ res = _FAIL; -+ if (retry < 2) { -+ res = rtw_select_and_join_from_scanned_queue(pmlmepriv); -+ } -+ -+ if (res == _SUCCESS) { -+ /* extend time of assoc_timer */ -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ retry++; -+ } else if (res == 2) { /* there is no need to wait for join */ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ rtw_indicate_connect(adapter); -+ } else { -+#endif -+ -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ /* rtw_free_assoc_resources(adapter, 1); */ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+#ifdef REJOIN -+ retry = 0; -+ } -+#endif -+ } -+ -+ignore_joinbss_callback: -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+ -+void rtw_joinbss_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ struct wlan_network *pnetwork = (struct wlan_network *)pbuf; -+ -+ -+ mlmeext_joinbss_event_callback(adapter, pnetwork->join_res); -+ -+ rtw_mi_os_xmit_schedule(adapter); -+ -+} -+ -+void rtw_sta_media_status_rpt(_adapter *adapter, struct sta_info *sta, bool connected) -+{ -+ struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; -+ bool miracast_enabled = 0; -+ bool miracast_sink = 0; -+ u8 role = H2C_MSR_ROLE_RSVD; -+ -+ if (sta == NULL) { -+ RTW_PRINT(FUNC_ADPT_FMT" sta is NULL\n" -+ , FUNC_ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ if (sta->mac_id >= macid_ctl->num) { -+ RTW_PRINT(FUNC_ADPT_FMT" invalid macid:%u\n" -+ , FUNC_ADPT_ARG(adapter), sta->mac_id); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ if (!rtw_macid_is_used(macid_ctl, sta->mac_id)) { -+ RTW_PRINT(FUNC_ADPT_FMT" macid:%u not is used, set connected to 0\n" -+ , FUNC_ADPT_ARG(adapter), sta->mac_id); -+ connected = 0; -+ rtw_warn_on(1); -+ } -+ -+ if (connected && !rtw_macid_is_bmc(macid_ctl, sta->mac_id)) { -+ miracast_enabled = STA_OP_WFD_MODE(sta) != 0 && is_miracast_enabled(adapter); -+ miracast_sink = miracast_enabled && (STA_OP_WFD_MODE(sta) & MIRACAST_SINK); -+ -+#ifdef CONFIG_TDLS -+ if (sta->tdls_sta_state & TDLS_LINKED_STATE) -+ role = H2C_MSR_ROLE_TDLS; -+ else -+#endif -+ if (MLME_IS_STA(adapter)) { -+ if (MLME_IS_GC(adapter)) -+ role = H2C_MSR_ROLE_GO; -+ else -+ role = H2C_MSR_ROLE_AP; -+ } else if (MLME_IS_AP(adapter)) { -+ if (MLME_IS_GO(adapter)) -+ role = H2C_MSR_ROLE_GC; -+ else -+ role = H2C_MSR_ROLE_STA; -+ } else if (MLME_IS_ADHOC(adapter) || MLME_IS_ADHOC_MASTER(adapter)) -+ role = H2C_MSR_ROLE_ADHOC; -+ -+#ifdef CONFIG_WFD -+ if (role == H2C_MSR_ROLE_GC -+ || role == H2C_MSR_ROLE_GO -+ || role == H2C_MSR_ROLE_TDLS -+ ) { -+ if (adapter->wfd_info.rtsp_ctrlport -+ || adapter->wfd_info.tdls_rtsp_ctrlport -+ || adapter->wfd_info.peer_rtsp_ctrlport) -+ rtw_wfd_st_switch(sta, 1); -+ } -+#endif -+ } -+ -+ rtw_hal_set_FwMediaStatusRpt_single_cmd(adapter -+ , connected -+ , miracast_enabled -+ , miracast_sink -+ , role -+ , sta->mac_id -+ ); -+} -+ -+u8 rtw_sta_media_status_rpt_cmd(_adapter *adapter, struct sta_info *sta, bool connected) -+{ -+ struct cmd_priv *cmdpriv = &adapter->cmdpriv; -+ struct cmd_obj *cmdobj; -+ struct drvextra_cmd_parm *cmd_parm; -+ struct sta_media_status_rpt_cmd_parm *rpt_parm; -+ u8 res = _SUCCESS; -+ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (cmd_parm == NULL) { -+ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ rpt_parm = (struct sta_media_status_rpt_cmd_parm *)rtw_zmalloc(sizeof(struct sta_media_status_rpt_cmd_parm)); -+ if (rpt_parm == NULL) { -+ rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)cmd_parm, sizeof(struct drvextra_cmd_parm)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ rpt_parm->sta = sta; -+ rpt_parm->connected = connected; -+ -+ cmd_parm->ec_id = STA_MSTATUS_RPT_WK_CID; -+ cmd_parm->type = 0; -+ cmd_parm->size = sizeof(struct sta_media_status_rpt_cmd_parm); -+ cmd_parm->pbuf = (u8 *)rpt_parm; -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(cmdpriv, cmdobj); -+ -+exit: -+ return res; -+} -+ -+inline void rtw_sta_media_status_rpt_cmd_hdl(_adapter *adapter, struct sta_media_status_rpt_cmd_parm *parm) -+{ -+ rtw_sta_media_status_rpt(adapter, parm->sta, parm->connected); -+} -+ -+void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL; -+ struct sta_info *psta; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct stassoc_event *pstassoc = (struct stassoc_event *)pbuf; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wlan_network *ptarget_wlan = NULL; -+ -+ -+#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) -+ if (rtw_access_ctrl(adapter, pstassoc->macaddr) == _FALSE) -+ return; -+#endif -+ -+#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); -+ if (psta) { -+ u8 *passoc_req = NULL; -+ u32 assoc_req_len = 0; -+ -+ rtw_sta_media_status_rpt(adapter, psta, 1); -+ -+#ifndef CONFIG_AUTO_AP_MODE -+ -+ ap_sta_info_defer_update(adapter, psta); -+ -+ /* report to upper layer */ -+ RTW_INFO("indicate_sta_assoc_event to upper layer - hostapd\n"); -+#ifdef CONFIG_IOCTL_CFG80211 -+ _enter_critical_bh(&psta->lock, &irqL); -+ if (psta->passoc_req && psta->assoc_req_len > 0) { -+ passoc_req = rtw_zmalloc(psta->assoc_req_len); -+ if (passoc_req) { -+ assoc_req_len = psta->assoc_req_len; -+ _rtw_memcpy(passoc_req, psta->passoc_req, assoc_req_len); -+ -+ rtw_mfree(psta->passoc_req , psta->assoc_req_len); -+ psta->passoc_req = NULL; -+ psta->assoc_req_len = 0; -+ } -+ } -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ if (passoc_req && assoc_req_len > 0) { -+ rtw_cfg80211_indicate_sta_assoc(adapter, passoc_req, assoc_req_len); -+ -+ rtw_mfree(passoc_req, assoc_req_len); -+ } -+#else /* !CONFIG_IOCTL_CFG80211 */ -+ rtw_indicate_sta_assoc_event(adapter, psta); -+#endif /* !CONFIG_IOCTL_CFG80211 */ -+#endif /* !CONFIG_AUTO_AP_MODE */ -+ -+#ifdef CONFIG_BEAMFORMING -+ beamforming_wk_cmd(adapter, BEAMFORMING_CTRL_ENTER, (u8 *)psta, sizeof(struct sta_info), 0); -+#endif/*CONFIG_BEAMFORMING*/ -+ if (is_wep_enc(adapter->securitypriv.dot11PrivacyAlgrthm)) -+ rtw_ap_wep_pk_setting(adapter, psta); -+ } -+ goto exit; -+ } -+#endif /* defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ -+ -+ /* for AD-HOC mode */ -+ psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); -+ if (psta == NULL) { -+ RTW_ERR(FUNC_ADPT_FMT" get no sta_info with "MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(pstassoc->macaddr)); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ rtw_hal_set_odm_var(adapter, HAL_ODM_STA_INFO, psta, _TRUE); -+ -+ rtw_sta_media_status_rpt(adapter, psta, 1); -+ -+ if (adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) -+ psta->dot118021XPrivacy = adapter->securitypriv.dot11PrivacyAlgrthm; -+ -+ -+ psta->ieee8021x_blocked = _FALSE; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) { -+ if (adapter->stapriv.asoc_sta_count == 2) { -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); -+ pmlmepriv->cur_network_scanned = ptarget_wlan; -+ if (ptarget_wlan) -+ ptarget_wlan->fixed = _TRUE; -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ /* a sta + bc/mc_stainfo (not Ibss_stainfo) */ -+ rtw_indicate_connect(adapter); -+ } -+ } -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+ mlmeext_sta_add_event_callback(adapter, psta); -+ -+#ifdef CONFIG_RTL8711 -+ /* submit SetStaKey_cmd to tell fw, fw will allocate an CAM entry for this sta */ -+ rtw_setstakey_cmd(adapter, psta, GROUP_KEY, _TRUE); -+#endif -+ -+exit: -+ return; -+} -+ -+#ifdef CONFIG_IEEE80211W -+void rtw_sta_timeout_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL; -+ struct sta_info *psta; -+ struct stadel_event *pstadel = (struct stadel_event *)pbuf; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ -+ -+ psta = rtw_get_stainfo(&adapter->stapriv, pstadel->macaddr); -+ -+ if (psta) { -+ u8 updated = _FALSE; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(adapter, psta, _TRUE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(adapter, updated, STA_INFO_UPDATE_ALL); -+ } -+ -+ -+ -+} -+#endif /* CONFIG_IEEE80211W */ -+ -+#ifdef CONFIG_RTW_80211R -+void rtw_update_ft_stainfo(_adapter *padapter, WLAN_BSSID_EX *pnetwork) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ -+ psta = rtw_get_stainfo(pstapriv, pnetwork->MacAddress); -+ if (psta == NULL) -+ psta = rtw_alloc_stainfo(pstapriv, pnetwork->MacAddress); -+ -+ if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { -+ -+ padapter->securitypriv.binstallGrpkey = _FALSE; -+ padapter->securitypriv.busetkipkey = _FALSE; -+ padapter->securitypriv.bgrpkey_handshake = _FALSE; -+ -+ psta->ieee8021x_blocked = _TRUE; -+ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ psta->dot11txpn.val = psta->dot11txpn.val + 1; -+ -+ _rtw_memset((u8 *)&psta->dot118021x_UncstKey, 0, sizeof(union Keytype)); -+ _rtw_memset((u8 *)&psta->dot11tkiprxmickey, 0, sizeof(union Keytype)); -+ _rtw_memset((u8 *)&psta->dot11tkiptxmickey, 0, sizeof(union Keytype)); -+ _rtw_memset((u8 *)&psta->dot11txpn, 0, sizeof(union pn48)); -+#ifdef CONFIG_IEEE80211W -+ _rtw_memset((u8 *)&psta->dot11wtxpn, 0, sizeof(union pn48)); -+#endif -+ _rtw_memset((u8 *)&psta->dot11rxpn, 0, sizeof(union pn48)); -+ } -+ -+} -+ -+void rtw_ft_reassoc_event_callback(_adapter *padapter, u8 *pbuf) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct stassoc_event *pstassoc = (struct stassoc_event *)pbuf; -+ ft_priv *pftpriv = &pmlmepriv->ftpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+ struct cfg80211_ft_event_params ft_evt_parms; -+ _irqL irqL; -+ -+ _rtw_memset(&ft_evt_parms, 0, sizeof(ft_evt_parms)); -+ rtw_update_ft_stainfo(padapter, pnetwork); -+ ft_evt_parms.ies_len = pftpriv->ft_event.ies_len; -+ ft_evt_parms.ies = rtw_zmalloc(ft_evt_parms.ies_len); -+ if (ft_evt_parms.ies) -+ _rtw_memcpy((void *)ft_evt_parms.ies, pftpriv->ft_event.ies, ft_evt_parms.ies_len); -+ else -+ goto err_2; -+ -+ ft_evt_parms.target_ap = rtw_zmalloc(ETH_ALEN); -+ if (ft_evt_parms.target_ap) -+ _rtw_memcpy((void *)ft_evt_parms.target_ap, pstassoc->macaddr, ETH_ALEN); -+ else -+ goto err_1; -+ -+ ft_evt_parms.ric_ies = pftpriv->ft_event.ric_ies; -+ ft_evt_parms.ric_ies_len = pftpriv->ft_event.ric_ies_len; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ rtw_set_ft_status(padapter, RTW_FT_AUTHENTICATED_STA); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ rtw_cfg80211_ft_event(padapter, &ft_evt_parms); -+ RTW_INFO("%s: to "MAC_FMT"\n", __func__, MAC_ARG(ft_evt_parms.target_ap)); -+ -+ rtw_mfree((u8 *)pftpriv->ft_event.target_ap, ETH_ALEN); -+err_1: -+ rtw_mfree((u8 *)ft_evt_parms.ies, ft_evt_parms.ies_len); -+err_2: -+ return; -+} -+#endif -+ -+void rtw_sta_mstatus_disc_rpt(_adapter *adapter, u8 mac_id) -+{ -+ struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; -+ -+ RTW_INFO("%s "ADPT_FMT" - mac_id=%d\n", __func__, ADPT_ARG(adapter), mac_id); -+ -+ if (mac_id >= 0 && mac_id < macid_ctl->num) { -+ rtw_hal_set_FwMediaStatusRpt_single_cmd(adapter, 0, 0, 0, 0, mac_id); -+ /* -+ * For safety, prevent from keeping macid sleep. -+ * If we can sure all power mode enter/leave are paired, -+ * this check can be removed. -+ * Lucas@20131113 -+ */ -+ /* wakeup macid after disconnect. */ -+ /*if (MLME_IS_STA(adapter))*/ -+ rtw_hal_macid_wakeup(adapter, mac_id); -+ } else { -+ RTW_PRINT(FUNC_ADPT_FMT" invalid macid:%u\n" -+ , FUNC_ADPT_ARG(adapter), mac_id); -+ rtw_warn_on(1); -+ } -+} -+void rtw_sta_mstatus_report(_adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct wlan_network *tgt_network = &pmlmepriv->cur_network; -+ struct sta_info *psta = NULL; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && -+ check_fwstate(pmlmepriv, _FW_LINKED)) { -+ psta = rtw_get_stainfo(&adapter->stapriv, tgt_network->network.MacAddress); -+ if (psta) -+ rtw_sta_mstatus_disc_rpt(adapter, psta->mac_id); -+ else { -+ RTW_INFO("%s "ADPT_FMT" - mac_addr: "MAC_FMT" psta == NULL\n", __func__, ADPT_ARG(adapter), MAC_ARG(tgt_network->network.MacAddress)); -+ rtw_warn_on(1); -+ } -+ } else { -+ RTW_DBG("%s: fwstate: %08x\n", __func__, pmlmepriv->fw_state); -+ } -+} -+ -+void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL, irqL2; -+ -+ struct sta_info *psta; -+ struct wlan_network *pwlan = NULL; -+ WLAN_BSSID_EX *pdev_network = NULL; -+ u8 *pibss = NULL; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct stadel_event *pstadel = (struct stadel_event *)pbuf; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct wlan_network *tgt_network = &(pmlmepriv->cur_network); -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ RTW_INFO("%s(mac_id=%d)=" MAC_FMT "\n", __func__, pstadel->mac_id, MAC_ARG(pstadel->macaddr)); -+ rtw_sta_mstatus_disc_rpt(adapter, pstadel->mac_id); -+ -+ psta = rtw_get_stainfo(&adapter->stapriv, pstadel->macaddr); -+ -+ if (psta == NULL) { -+ RTW_INFO("%s(mac_id=%d)=" MAC_FMT " psta == NULL\n", __func__, pstadel->mac_id, MAC_ARG(pstadel->macaddr)); -+ /*rtw_warn_on(1);*/ -+ } -+ -+ if (psta) -+ rtw_wfd_st_switch(psta, 0); -+ -+ /* if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) */ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { -+#ifdef CONFIG_IOCTL_CFG80211 -+#ifdef COMPAT_KERNEL_RELEASE -+ -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 37)) || defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ rtw_cfg80211_indicate_sta_disassoc(adapter, pstadel->macaddr, *(u16 *)pstadel->rsvd); -+#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 37)) || defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) */ -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ return; -+ } -+ -+ mlmeext_sta_del_event_callback(adapter); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL2); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ u16 reason = *((unsigned short *)(pstadel->rsvd)); -+ bool roam = _FALSE; -+ struct wlan_network *roam_target = NULL; -+ -+#ifdef CONFIG_LAYER2_ROAMING -+#ifdef CONFIG_RTW_80211R -+ if (reason == WLAN_REASON_EXPIRATION_CHK && rtw_chk_roam_flags(adapter, RTW_ROAM_ON_EXPIRED)) -+ pmlmepriv->ftpriv.ft_roam_on_expired = _TRUE; -+ else -+ pmlmepriv->ftpriv.ft_roam_on_expired = _FALSE; -+#endif -+ if (adapter->registrypriv.wifi_spec == 1) -+ roam = _FALSE; -+ else if (reason == WLAN_REASON_EXPIRATION_CHK && rtw_chk_roam_flags(adapter, RTW_ROAM_ON_EXPIRED)) -+ roam = _TRUE; -+ else if (reason == WLAN_REASON_ACTIVE_ROAM && rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE)) { -+ roam = _TRUE; -+ roam_target = pmlmepriv->roam_network; -+ } -+#ifdef CONFIG_INTEL_WIDI -+ else if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_CONNECTED) -+ roam = _TRUE; -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ if (roam == _TRUE) { -+ if (rtw_to_roam(adapter) > 0) -+ rtw_dec_to_roam(adapter); /* this stadel_event is caused by roaming, decrease to_roam */ -+ else if (rtw_to_roam(adapter) == 0) -+ rtw_set_to_roam(adapter, adapter->registrypriv.max_roaming_times); -+ } else -+ rtw_set_to_roam(adapter, 0); -+#endif /* CONFIG_LAYER2_ROAMING */ -+ -+ rtw_free_uc_swdec_pending_queue(adapter); -+ -+ rtw_free_assoc_resources(adapter, 1); -+ rtw_free_mlme_priv_ie_data(pmlmepriv); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ /* remove the network entry in scanned_queue */ -+ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); -+ if ((pwlan) && (!check_fwstate(pmlmepriv, WIFI_UNDER_WPS))) { -+ pwlan->fixed = _FALSE; -+ rtw_free_network_nolock(adapter, pwlan); -+ } -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ rtw_indicate_disconnect(adapter, *(u16 *)pstadel->rsvd, pstadel->locally_generated); -+#ifdef CONFIG_INTEL_WIDI -+ if (!rtw_to_roam(adapter)) -+ process_intel_widi_disconnect(adapter, 1); -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ _rtw_roaming(adapter, roam_target); -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) || -+ check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { -+ -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ rtw_free_stainfo(adapter, psta); -+ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ -+ if (adapter->stapriv.asoc_sta_count == 1) { /* a sta + bc/mc_stainfo (not Ibss_stainfo) */ -+ /* rtw_indicate_disconnect(adapter); */ /* removed@20091105 */ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ /* free old ibss network */ -+ /* pwlan = rtw_find_network(&pmlmepriv->scanned_queue, pstadel->macaddr); */ -+ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); -+ if (pwlan) { -+ pwlan->fixed = _FALSE; -+ rtw_free_network_nolock(adapter, pwlan); -+ } -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ /* re-create ibss */ -+ pdev_network = &(adapter->registrypriv.dev_network); -+ pibss = adapter->registrypriv.dev_network.MacAddress; -+ -+ _rtw_memcpy(pdev_network, &tgt_network->network, get_WLAN_BSSID_EX_sz(&tgt_network->network)); -+ -+ _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); -+ -+ rtw_update_registrypriv_dev_network(adapter); -+ -+ rtw_generate_random_ibss(pibss); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { -+ set_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_STATE); -+ } -+ -+ if (rtw_create_ibss_cmd(adapter, 0) != _SUCCESS) -+ RTW_ERR("rtw_create_ibss_cmd FAIL\n"); -+ -+ } -+ -+ } -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL2); -+ -+ -+} -+ -+ -+void rtw_cpwm_event_callback(PADAPTER padapter, u8 *pbuf) -+{ -+#ifdef CONFIG_LPS_LCLK -+ struct reportpwrstate_parm *preportpwrstate; -+#endif -+ -+ -+#ifdef CONFIG_LPS_LCLK -+ preportpwrstate = (struct reportpwrstate_parm *)pbuf; -+ preportpwrstate->state |= (u8)(adapter_to_pwrctl(padapter)->cpwm_tog + 0x80); -+ cpwm_int_hdl(padapter, preportpwrstate); -+#endif -+ -+ -+} -+ -+ -+void rtw_wmm_event_callback(PADAPTER padapter, u8 *pbuf) -+{ -+ -+ WMMOnAssocRsp(padapter); -+ -+ -+} -+ -+/* -+* _rtw_join_timeout_handler - Timeout/faliure handler for CMD JoinBss -+* @adapter: pointer to _adapter structure -+*/ -+void _rtw_join_timeout_handler(_adapter *adapter) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+#if 0 -+ if (rtw_is_drv_stopped(adapter)) { -+ _rtw_up_sema(&pmlmepriv->assoc_terminate); -+ return; -+ } -+#endif -+ -+ -+ -+ RTW_INFO("%s, fw_state=%x\n", __FUNCTION__, get_fwstate(pmlmepriv)); -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ return; -+ -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ if (rtw_to_roam(adapter) > 0) { /* join timeout caused by roaming */ -+ while (1) { -+ rtw_dec_to_roam(adapter); -+ if (rtw_to_roam(adapter) != 0) { /* try another */ -+ int do_join_r; -+ RTW_INFO("%s try another roaming\n", __FUNCTION__); -+ do_join_r = rtw_do_join(adapter); -+ if (_SUCCESS != do_join_r) { -+ RTW_INFO("%s roaming do_join return %d\n", __FUNCTION__ , do_join_r); -+ continue; -+ } -+ break; -+ } else { -+#ifdef CONFIG_INTEL_WIDI -+ if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) { -+ _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); -+ intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL, 0); -+ RTW_INFO("change to widi listen\n"); -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ RTW_INFO("%s We've try roaming but fail\n", __FUNCTION__); -+#ifdef CONFIG_RTW_80211R -+ rtw_clr_ft_flags(adapter, RTW_FT_SUPPORTED|RTW_FT_OVER_DS_SUPPORTED); -+ rtw_reset_ft_status(adapter); -+#endif -+ rtw_indicate_disconnect(adapter, 0, _FALSE); -+ break; -+ } -+ } -+ -+ } else -+#endif -+ { -+ rtw_indicate_disconnect(adapter, 0, _FALSE); -+ free_scanqueue(pmlmepriv);/* ??? */ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ /* indicate disconnect for the case that join_timeout and check_fwstate != FW_LINKED */ -+ rtw_cfg80211_indicate_disconnect(adapter, 0, _FALSE); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ } -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+#ifdef CONFIG_DRVEXT_MODULE_WSC -+ drvext_assoc_fail_indicate(&adapter->drvextpriv); -+#endif -+ -+ -+ -+} -+ -+/* -+* rtw_scan_timeout_handler - Timeout/Faliure handler for CMD SiteSurvey -+* @adapter: pointer to _adapter structure -+*/ -+void rtw_scan_timeout_handler(_adapter *adapter) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ RTW_INFO(FUNC_ADPT_FMT" fw_state=%x\n", FUNC_ADPT_ARG(adapter), get_fwstate(pmlmepriv)); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_surveydone_event_callback(adapter); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ rtw_indicate_scan_done(adapter, _TRUE); -+ -+#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_IOCTL_CFG80211) -+ rtw_cfg80211_indicate_scan_done_for_buddy(adapter, _TRUE); -+#endif -+} -+ -+void rtw_mlme_reset_auto_scan_int(_adapter *adapter, u8 *reason) -+{ -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 u_ch; -+ u32 interval_ms = 0xffffffff; /* 0xffffffff: special value to make min() works well, also means no auto scan */ -+ -+ *reason = RTW_AUTO_SCAN_REASON_UNSPECIFIED; -+ rtw_mi_get_ch_setting_union(adapter, &u_ch, NULL, NULL); -+ -+ if (hal_chk_bw_cap(adapter, BW_CAP_40M) -+ && is_client_associated_to_ap(adapter) == _TRUE -+ && u_ch >= 1 && u_ch <= 14 -+ && adapter->registrypriv.wifi_spec -+ /* TODO: AP Connected is 40MHz capability? */ -+ ) { -+ interval_ms = rtw_min(interval_ms, 60 * 1000); -+ *reason |= RTW_AUTO_SCAN_REASON_2040_BSS; -+ } -+ -+exit: -+ if (interval_ms == 0xffffffff) -+ interval_ms = 0; -+ -+ rtw_mlme_set_auto_scan_int(adapter, interval_ms); -+ return; -+} -+ -+void rtw_drv_scan_by_self(_adapter *padapter, u8 reason) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct rtw_ieee80211_channel ch_for_2040_bss[14] = { -+ {1, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {2, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {3, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {4, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {5, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {6, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {7, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {8, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {9, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {10, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {11, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {12, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {13, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ {14, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, -+ }; -+ struct rtw_ieee80211_channel *ch_sel = NULL; -+ int ch_num = 0; -+ -+ if (rtw_is_scan_deny(padapter)) -+ goto exit; -+ -+ if (!rtw_is_adapter_up(padapter)) -+ goto exit; -+ -+ if (rtw_mi_busy_traffic_check(padapter, _FALSE)) { -+#ifdef CONFIG_LAYER2_ROAMING -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE) && pmlmepriv->need_to_roam == _TRUE) { -+ RTW_INFO("need to roam, don't care BusyTraffic\n"); -+ } else -+#endif -+ { -+ RTW_INFO(FUNC_ADPT_FMT" exit BusyTraffic\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ } -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) && check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { -+ RTW_INFO(FUNC_ADPT_FMT" WIFI_AP_STATE && WIFI_UNDER_WPS\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ if (check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY | _FW_UNDER_LINKING)) == _TRUE) { -+ RTW_INFO(FUNC_ADPT_FMT" _FW_UNDER_SURVEY|_FW_UNDER_LINKING\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, (_FW_UNDER_SURVEY | _FW_UNDER_LINKING | WIFI_UNDER_WPS))) { -+ RTW_INFO(FUNC_ADPT_FMT", but buddy_intf is under scanning or linking or wps_phase\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+#endif -+ -+ RTW_INFO(FUNC_ADPT_FMT" reason:0x%02x\n", FUNC_ADPT_ARG(padapter), reason); -+ -+ /* only for 20/40 BSS */ -+ if (reason == RTW_AUTO_SCAN_REASON_2040_BSS) { -+ ch_sel = ch_for_2040_bss; -+ ch_num = 14; -+ } -+ -+ rtw_set_802_11_bssid_list_scan(padapter, NULL, 0, ch_sel, ch_num); -+exit: -+ return; -+} -+ -+static void rtw_auto_scan_handler(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 reason = RTW_AUTO_SCAN_REASON_UNSPECIFIED; -+ -+ rtw_mlme_reset_auto_scan_int(padapter, &reason); -+ -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE)) -+ goto exit; -+#endif -+ -+#ifdef CONFIG_TDLS -+ if (padapter->tdlsinfo.link_established == _TRUE) -+ goto exit; -+#endif -+ -+ if (pmlmepriv->auto_scan_int_ms == 0 -+ || rtw_get_passing_time_ms(pmlmepriv->scan_start_time) < pmlmepriv->auto_scan_int_ms) -+ goto exit; -+ -+ rtw_drv_scan_by_self(padapter, reason); -+ -+exit: -+ return; -+} -+static u8 is_drv_in_lps(_adapter *adapter) -+{ -+ u8 is_in_lps = _FALSE; -+ -+ #ifdef CONFIG_LPS_LCLK_WD_TIMER /* to avoid leaving lps 32k frequently*/ -+ if ((adapter_to_pwrctl(adapter)->bFwCurrentInPSMode == _TRUE) -+ #ifdef CONFIG_BT_COEXIST -+ && (rtw_btcoex_IsBtControlLps(adapter) == _FALSE) -+ #endif -+ ) -+ is_in_lps = _TRUE; -+ #endif /* CONFIG_LPS_LCLK_WD_TIMER*/ -+ return is_in_lps; -+} -+void rtw_iface_dynamic_check_timer_handlder(_adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ if (adapter->net_closed == _TRUE) -+ return; -+ #ifdef CONFIG_LPS_LCLK_WD_TIMER /* to avoid leaving lps 32k frequently*/ -+ if (is_drv_in_lps(adapter)) { -+ u8 bEnterPS; -+ -+ linked_status_chk(adapter, 1); -+ -+ bEnterPS = traffic_status_watchdog(adapter, 1); -+ if (bEnterPS) { -+ /* rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_ENTER, 1); */ -+ rtw_hal_dm_watchdog_in_lps(adapter); -+ } else { -+ /* call rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1) in traffic_status_watchdog() */ -+ } -+ } -+ #endif /* CONFIG_LPS_LCLK_WD_TIMER */ -+ -+ /* auto site survey */ -+ rtw_auto_scan_handler(adapter); -+ -+#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+#ifdef CONFIG_AP_MODE -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ expire_timeout_chk(adapter); -+#endif -+#endif /* !CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ -+#ifdef CONFIG_BR_EXT -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+ rcu_read_lock(); -+#endif /* (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) */ -+ -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ if (adapter->pnetdev->br_port -+#else /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ -+ if (rcu_dereference(adapter->pnetdev->rx_handler_data) -+#endif /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ -+ && (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) == _TRUE)) { -+ /* expire NAT2.5 entry */ -+ void nat25_db_expire(_adapter *priv); -+ nat25_db_expire(adapter); -+ -+ if (adapter->pppoe_connection_in_progress > 0) -+ adapter->pppoe_connection_in_progress--; -+ /* due to rtw_dynamic_check_timer_handlder() is called every 2 seconds */ -+ if (adapter->pppoe_connection_in_progress > 0) -+ adapter->pppoe_connection_in_progress--; -+ } -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+ rcu_read_unlock(); -+#endif /* (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) */ -+ -+#endif /* CONFIG_BR_EXT */ -+ -+} -+ -+/*#define DBG_TRAFFIC_STATISTIC*/ -+static void collect_traffic_statistics(_adapter *padapter) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ -+ /*_rtw_memset(&pdvobjpriv->traffic_stat, 0, sizeof(struct rtw_traffic_statistics));*/ -+ -+ /* Tx bytes reset*/ -+ pdvobjpriv->traffic_stat.tx_bytes = 0; -+ pdvobjpriv->traffic_stat.tx_pkts = 0; -+ pdvobjpriv->traffic_stat.tx_drop = 0; -+ -+ /* Rx bytes reset*/ -+ pdvobjpriv->traffic_stat.rx_bytes = 0; -+ pdvobjpriv->traffic_stat.rx_pkts = 0; -+ pdvobjpriv->traffic_stat.rx_drop = 0; -+ -+ rtw_mi_traffic_statistics(padapter); -+ -+ /* Calculate throughput in last interval */ -+ pdvobjpriv->traffic_stat.cur_tx_bytes = pdvobjpriv->traffic_stat.tx_bytes - pdvobjpriv->traffic_stat.last_tx_bytes; -+ pdvobjpriv->traffic_stat.cur_rx_bytes = pdvobjpriv->traffic_stat.rx_bytes - pdvobjpriv->traffic_stat.last_rx_bytes; -+ pdvobjpriv->traffic_stat.last_tx_bytes = pdvobjpriv->traffic_stat.tx_bytes; -+ pdvobjpriv->traffic_stat.last_rx_bytes = pdvobjpriv->traffic_stat.rx_bytes; -+ -+ pdvobjpriv->traffic_stat.cur_tx_tp = (u32)(pdvobjpriv->traffic_stat.cur_tx_bytes * 8 / 2 / 1024 / 1024); -+ pdvobjpriv->traffic_stat.cur_rx_tp = (u32)(pdvobjpriv->traffic_stat.cur_rx_bytes * 8 / 2 / 1024 / 1024); -+ -+ #ifdef DBG_TRAFFIC_STATISTIC -+ RTW_INFO("\n========================\n"); -+ RTW_INFO("cur_tx_bytes:%lld\n", pdvobjpriv->traffic_stat.cur_tx_bytes); -+ RTW_INFO("cur_rx_bytes:%lld\n", pdvobjpriv->traffic_stat.cur_rx_bytes); -+ -+ RTW_INFO("last_tx_bytes:%lld\n", pdvobjpriv->traffic_stat.last_tx_bytes); -+ RTW_INFO("last_rx_bytes:%lld\n", pdvobjpriv->traffic_stat.last_rx_bytes); -+ -+ RTW_INFO("cur_tx_tp:%d\n", pdvobjpriv->traffic_stat.cur_tx_tp); -+ RTW_INFO("cur_rx_tp:%d\n", pdvobjpriv->traffic_stat.cur_rx_tp); -+ #endif -+} -+ -+void rtw_dynamic_check_timer_handlder(_adapter *adapter) -+{ -+ if (!adapter) -+ return; -+ -+ if (!rtw_is_hw_init_completed(adapter)) -+ return; -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ return; -+ -+ collect_traffic_statistics(adapter); -+ -+ rtw_mi_dynamic_check_timer_handlder(adapter); -+ -+ if (!is_drv_in_lps(adapter)) -+ rtw_dynamic_chk_wk_cmd(adapter); -+} -+ -+ -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+inline bool rtw_is_scan_deny(_adapter *adapter) -+{ -+ struct mlme_priv *mlmepriv = &adapter->mlmepriv; -+ return (ATOMIC_READ(&mlmepriv->set_scan_deny) != 0) ? _TRUE : _FALSE; -+} -+ -+inline void rtw_clear_scan_deny(_adapter *adapter) -+{ -+ struct mlme_priv *mlmepriv = &adapter->mlmepriv; -+ ATOMIC_SET(&mlmepriv->set_scan_deny, 0); -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+} -+ -+void rtw_set_scan_deny_timer_hdl(_adapter *adapter) -+{ -+ rtw_clear_scan_deny(adapter); -+} -+void rtw_set_scan_deny(_adapter *adapter, u32 ms) -+{ -+ struct mlme_priv *mlmepriv = &adapter->mlmepriv; -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+ ATOMIC_SET(&mlmepriv->set_scan_deny, 1); -+ _set_timer(&mlmepriv->set_scan_deny_timer, ms); -+} -+#endif -+ -+#ifdef CONFIG_LAYER2_ROAMING -+/* -+* Select a new roaming candidate from the original @param candidate and @param competitor -+* @return _TRUE: candidate is updated -+* @return _FALSE: candidate is not updated -+*/ -+static int rtw_check_roaming_candidate(struct mlme_priv *mlme -+ , struct wlan_network **candidate, struct wlan_network *competitor) -+{ -+ int updated = _FALSE; -+ _adapter *adapter = container_of(mlme, _adapter, mlmepriv); -+#ifdef CONFIG_RTW_80211R -+ ft_priv *pftpriv = &mlme->ftpriv; -+ u32 mdie_len = 0; -+ u8 *ptmp = NULL; -+#endif -+ -+ -+ if (is_same_ess(&competitor->network, &mlme->cur_network.network) == _FALSE) -+ goto exit; -+ -+ if (rtw_is_desired_network(adapter, competitor) == _FALSE) -+ goto exit; -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ if (mlme->need_to_roam == _FALSE) -+ goto exit; -+#endif -+ -+#ifdef CONFIG_RTW_80211R -+ if (rtw_chk_ft_flags(adapter, RTW_FT_SUPPORTED)) { -+ ptmp = rtw_get_ie(&competitor->network.IEs[12], _MDIE_, &mdie_len, competitor->network.IELength-12); -+ if (ptmp) { -+ if (!_rtw_memcmp(&pftpriv->mdid, ptmp+2, 2)) -+ goto exit; -+ -+ /*The candidate don't support over-the-DS*/ -+ if (rtw_chk_ft_flags(adapter, RTW_FT_STA_OVER_DS_SUPPORTED)) { -+ if ((rtw_chk_ft_flags(adapter, RTW_FT_OVER_DS_SUPPORTED) && !(*(ptmp+4) & 0x01)) || -+ (!rtw_chk_ft_flags(adapter, RTW_FT_OVER_DS_SUPPORTED) && (*(ptmp+4) & 0x01))) { -+ RTW_INFO("FT: ignore the candidate(" MAC_FMT ") for over-the-DS\n", MAC_ARG(competitor->network.MacAddress)); -+ rtw_clr_ft_flags(adapter, RTW_FT_OVER_DS_SUPPORTED); -+ goto exit; -+ } -+ } -+ } else -+ goto exit; -+ } -+#endif -+ -+ RTW_INFO("roam candidate:%s %s("MAC_FMT", ch%3u) rssi:%d, age:%5d\n", -+ (competitor == mlme->cur_network_scanned) ? "*" : " " , -+ competitor->network.Ssid.Ssid, -+ MAC_ARG(competitor->network.MacAddress), -+ competitor->network.Configuration.DSConfig, -+ (int)competitor->network.Rssi, -+ rtw_get_passing_time_ms(competitor->last_scanned) -+ ); -+ -+ /* got specific addr to roam */ -+ if (!is_zero_mac_addr(mlme->roam_tgt_addr)) { -+ if (_rtw_memcmp(mlme->roam_tgt_addr, competitor->network.MacAddress, ETH_ALEN) == _TRUE) -+ goto update; -+ else -+ goto exit; -+ } -+#if 1 -+ if (rtw_get_passing_time_ms((u32)competitor->last_scanned) >= mlme->roam_scanr_exp_ms) -+ goto exit; -+ -+ if (competitor->network.Rssi - mlme->cur_network_scanned->network.Rssi < mlme->roam_rssi_diff_th) -+ goto exit; -+ -+ if (*candidate != NULL && (*candidate)->network.Rssi >= competitor->network.Rssi) -+ goto exit; -+#else -+ goto exit; -+#endif -+ -+update: -+ *candidate = competitor; -+ updated = _TRUE; -+ -+exit: -+ return updated; -+} -+ -+int rtw_select_roaming_candidate(struct mlme_priv *mlme) -+{ -+ _irqL irqL; -+ int ret = _FAIL; -+ _list *phead; -+ _adapter *adapter; -+ _queue *queue = &(mlme->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ struct wlan_network *candidate = NULL; -+ u8 bSupportAntDiv = _FALSE; -+ -+ -+ if (mlme->cur_network_scanned == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ _enter_critical_bh(&(mlme->scanned_queue.lock), &irqL); -+ phead = get_list_head(queue); -+ adapter = (_adapter *)mlme->nic_hdl; -+ -+ mlme->pscanned = get_next(phead); -+ -+ while (!rtw_end_of_queue_search(phead, mlme->pscanned)) { -+ -+ pnetwork = LIST_CONTAINOR(mlme->pscanned, struct wlan_network, list); -+ if (pnetwork == NULL) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ mlme->pscanned = get_next(mlme->pscanned); -+ -+ if (0) -+ RTW_INFO("%s("MAC_FMT", ch%u) rssi:%d\n" -+ , pnetwork->network.Ssid.Ssid -+ , MAC_ARG(pnetwork->network.MacAddress) -+ , pnetwork->network.Configuration.DSConfig -+ , (int)pnetwork->network.Rssi); -+ -+ rtw_check_roaming_candidate(mlme, &candidate, pnetwork); -+ -+ } -+ -+ if (candidate == NULL) { -+ RTW_INFO("%s: return _FAIL(candidate == NULL)\n", __FUNCTION__); -+ ret = _FAIL; -+ goto exit; -+ } else { -+ RTW_INFO("%s: candidate: %s("MAC_FMT", ch:%u)\n", __FUNCTION__, -+ candidate->network.Ssid.Ssid, MAC_ARG(candidate->network.MacAddress), -+ candidate->network.Configuration.DSConfig); -+ -+ mlme->roam_network = candidate; -+ -+ if (_rtw_memcmp(candidate->network.MacAddress, mlme->roam_tgt_addr, ETH_ALEN) == _TRUE) -+ _rtw_memset(mlme->roam_tgt_addr, 0, ETH_ALEN); -+ } -+ -+ ret = _SUCCESS; -+exit: -+ _exit_critical_bh(&(mlme->scanned_queue.lock), &irqL); -+ -+ return ret; -+} -+#endif /* CONFIG_LAYER2_ROAMING */ -+ -+/* -+* Select a new join candidate from the original @param candidate and @param competitor -+* @return _TRUE: candidate is updated -+* @return _FALSE: candidate is not updated -+*/ -+static int rtw_check_join_candidate(struct mlme_priv *mlme -+ , struct wlan_network **candidate, struct wlan_network *competitor) -+{ -+ int updated = _FALSE; -+ _adapter *adapter = container_of(mlme, _adapter, mlmepriv); -+ -+ -+ /* check bssid, if needed */ -+ if (mlme->assoc_by_bssid == _TRUE) { -+ if (_rtw_memcmp(competitor->network.MacAddress, mlme->assoc_bssid, ETH_ALEN) == _FALSE) -+ goto exit; -+ } -+ -+ /* check ssid, if needed */ -+ if (mlme->assoc_ssid.Ssid[0] && mlme->assoc_ssid.SsidLength) { -+ if (competitor->network.Ssid.SsidLength != mlme->assoc_ssid.SsidLength -+ || _rtw_memcmp(competitor->network.Ssid.Ssid, mlme->assoc_ssid.Ssid, mlme->assoc_ssid.SsidLength) == _FALSE -+ ) -+ goto exit; -+ } -+ -+ if (rtw_is_desired_network(adapter, competitor) == _FALSE) -+ goto exit; -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ if (rtw_to_roam(adapter) > 0) { -+ if (rtw_get_passing_time_ms((u32)competitor->last_scanned) >= mlme->roam_scanr_exp_ms -+ || is_same_ess(&competitor->network, &mlme->cur_network.network) == _FALSE -+ ) -+ goto exit; -+ } -+#endif -+ -+ if (*candidate == NULL || (*candidate)->network.Rssi < competitor->network.Rssi) { -+ *candidate = competitor; -+ updated = _TRUE; -+ } -+ -+ if (updated) { -+ RTW_INFO("[by_bssid:%u][assoc_ssid:%s][to_roam:%u] " -+ "new candidate: %s("MAC_FMT", ch%u) rssi:%d\n", -+ mlme->assoc_by_bssid, -+ mlme->assoc_ssid.Ssid, -+ rtw_to_roam(adapter), -+ (*candidate)->network.Ssid.Ssid, -+ MAC_ARG((*candidate)->network.MacAddress), -+ (*candidate)->network.Configuration.DSConfig, -+ (int)(*candidate)->network.Rssi -+ ); -+ } -+ -+exit: -+ return updated; -+} -+ -+/* -+Calling context: -+The caller of the sub-routine will be in critical section... -+ -+The caller must hold the following spinlock -+ -+pmlmepriv->lock -+ -+ -+*/ -+ -+int rtw_select_and_join_from_scanned_queue(struct mlme_priv *pmlmepriv) -+{ -+ _irqL irqL; -+ int ret; -+ _list *phead; -+ _adapter *adapter; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ struct wlan_network *candidate = NULL; -+ u8 bSupportAntDiv = _FALSE; -+ -+ -+ adapter = (_adapter *)pmlmepriv->nic_hdl; -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ if (pmlmepriv->roam_network) { -+ candidate = pmlmepriv->roam_network; -+ pmlmepriv->roam_network = NULL; -+ goto candidate_exist; -+ } -+#endif -+ -+ phead = get_list_head(queue); -+ pmlmepriv->pscanned = get_next(phead); -+ -+ while (!rtw_end_of_queue_search(phead, pmlmepriv->pscanned)) { -+ -+ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); -+ if (pnetwork == NULL) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); -+ -+ if (0) -+ RTW_INFO("%s("MAC_FMT", ch%u) rssi:%d\n" -+ , pnetwork->network.Ssid.Ssid -+ , MAC_ARG(pnetwork->network.MacAddress) -+ , pnetwork->network.Configuration.DSConfig -+ , (int)pnetwork->network.Rssi); -+ -+ rtw_check_join_candidate(pmlmepriv, &candidate, pnetwork); -+ -+ } -+ -+ if (candidate == NULL) { -+ RTW_INFO("%s: return _FAIL(candidate == NULL)\n", __FUNCTION__); -+#ifdef CONFIG_WOWLAN -+ _clr_fwstate_(pmlmepriv, _FW_LINKED | _FW_UNDER_LINKING); -+#endif -+ ret = _FAIL; -+ goto exit; -+ } else { -+ RTW_INFO("%s: candidate: %s("MAC_FMT", ch:%u)\n", __FUNCTION__, -+ candidate->network.Ssid.Ssid, MAC_ARG(candidate->network.MacAddress), -+ candidate->network.Configuration.DSConfig); -+ goto candidate_exist; -+ } -+ -+candidate_exist: -+ -+ /* check for situation of _FW_LINKED */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ RTW_INFO("%s: _FW_LINKED while ask_for_joinbss!!!\n", __FUNCTION__); -+ -+#if 0 /* for WPA/WPA2 authentication, wpa_supplicant will expect authentication from AP, it is needed to reconnect AP... */ -+ if (is_same_network(&pmlmepriv->cur_network.network, &candidate->network)) { -+ RTW_INFO("%s: _FW_LINKED and is same network, it needn't join again\n", __FUNCTION__); -+ -+ rtw_indicate_connect(adapter);/* rtw_indicate_connect again */ -+ -+ ret = 2; -+ goto exit; -+ } else -+#endif -+ { -+ rtw_disassoc_cmd(adapter, 0, _TRUE); -+ rtw_indicate_disconnect(adapter, 0, _FALSE); -+ rtw_free_assoc_resources(adapter, 0); -+ } -+ } -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ rtw_hal_get_def_var(adapter, HAL_DEF_IS_SUPPORT_ANT_DIV, &(bSupportAntDiv)); -+ if (_TRUE == bSupportAntDiv) { -+ u8 CurrentAntenna; -+ rtw_hal_get_odm_var(adapter, HAL_ODM_ANTDIV_SELECT, &(CurrentAntenna), NULL); -+ RTW_INFO("#### Opt_Ant_(%s) , cur_Ant(%s)\n", -+ (MAIN_ANT == candidate->network.PhyInfo.Optimum_antenna) ? "MAIN_ANT" : "AUX_ANT", -+ (MAIN_ANT == CurrentAntenna) ? "MAIN_ANT" : "AUX_ANT" -+ ); -+ } -+#endif -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ ret = rtw_joinbss_cmd(adapter, candidate); -+ -+exit: -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ -+ return ret; -+} -+ -+sint rtw_set_auth(_adapter *adapter, struct security_priv *psecuritypriv) -+{ -+ struct cmd_obj *pcmd; -+ struct setauth_parm *psetauthparm; -+ struct cmd_priv *pcmdpriv = &(adapter->cmdpriv); -+ sint res = _SUCCESS; -+ -+ -+ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd == NULL) { -+ res = _FAIL; /* try again */ -+ goto exit; -+ } -+ -+ psetauthparm = (struct setauth_parm *)rtw_zmalloc(sizeof(struct setauth_parm)); -+ if (psetauthparm == NULL) { -+ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memset(psetauthparm, 0, sizeof(struct setauth_parm)); -+ psetauthparm->mode = (unsigned char)psecuritypriv->dot11AuthAlgrthm; -+ -+ pcmd->cmdcode = _SetAuth_CMD_; -+ pcmd->parmbuf = (unsigned char *)psetauthparm; -+ pcmd->cmdsz = (sizeof(struct setauth_parm)); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ -+ _rtw_init_listhead(&pcmd->list); -+ -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ -+ -+ return res; -+ -+} -+ -+ -+sint rtw_set_key(_adapter *adapter, struct security_priv *psecuritypriv, sint keyid, u8 set_tx, bool enqueue) -+{ -+ u8 keylen; -+ struct cmd_obj *pcmd; -+ struct setkey_parm *psetkeyparm; -+ struct cmd_priv *pcmdpriv = &(adapter->cmdpriv); -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ sint res = _SUCCESS; -+ -+ -+ psetkeyparm = (struct setkey_parm *)rtw_zmalloc(sizeof(struct setkey_parm)); -+ if (psetkeyparm == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ _rtw_memset(psetkeyparm, 0, sizeof(struct setkey_parm)); -+ -+ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { -+ psetkeyparm->algorithm = (unsigned char)psecuritypriv->dot118021XGrpPrivacy; -+ } else { -+ psetkeyparm->algorithm = (u8)psecuritypriv->dot11PrivacyAlgrthm; -+ -+ } -+ psetkeyparm->keyid = (u8)keyid;/* 0~3 */ -+ psetkeyparm->set_tx = set_tx; -+ if (is_wep_enc(psetkeyparm->algorithm)) -+ adapter->securitypriv.key_mask |= BIT(psetkeyparm->keyid); -+ -+ RTW_INFO("==> rtw_set_key algorithm(%x),keyid(%x),key_mask(%x)\n", psetkeyparm->algorithm, psetkeyparm->keyid, adapter->securitypriv.key_mask); -+ -+ switch (psetkeyparm->algorithm) { -+ -+ case _WEP40_: -+ keylen = 5; -+ _rtw_memcpy(&(psetkeyparm->key[0]), &(psecuritypriv->dot11DefKey[keyid].skey[0]), keylen); -+ break; -+ case _WEP104_: -+ keylen = 13; -+ _rtw_memcpy(&(psetkeyparm->key[0]), &(psecuritypriv->dot11DefKey[keyid].skey[0]), keylen); -+ break; -+ case _TKIP_: -+ keylen = 16; -+ _rtw_memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); -+ psetkeyparm->grpkey = 1; -+ break; -+ case _AES_: -+ keylen = 16; -+ _rtw_memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); -+ psetkeyparm->grpkey = 1; -+ break; -+ default: -+ res = _FAIL; -+ rtw_mfree((unsigned char *)psetkeyparm, sizeof(struct setkey_parm)); -+ goto exit; -+ } -+ -+ -+ if (enqueue) { -+ pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd == NULL) { -+ rtw_mfree((unsigned char *)psetkeyparm, sizeof(struct setkey_parm)); -+ res = _FAIL; /* try again */ -+ goto exit; -+ } -+ -+ pcmd->cmdcode = _SetKey_CMD_; -+ pcmd->parmbuf = (u8 *)psetkeyparm; -+ pcmd->cmdsz = (sizeof(struct setkey_parm)); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ _rtw_init_listhead(&pcmd->list); -+ -+ /* _rtw_init_sema(&(pcmd->cmd_sem), 0); */ -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ } else { -+ setkey_hdl(adapter, (u8 *)psetkeyparm); -+ rtw_mfree((u8 *) psetkeyparm, sizeof(struct setkey_parm)); -+ } -+exit: -+ return res; -+ -+} -+ -+ -+/* adjust IEs for rtw_joinbss_cmd in WMM */ -+int rtw_restruct_wmm_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len, uint initial_out_len) -+{ -+ unsigned int ielength = 0; -+ unsigned int i, j; -+ -+ i = 12; /* after the fixed IE */ -+ while (i < in_len) { -+ ielength = initial_out_len; -+ -+ if (in_ie[i] == 0xDD && in_ie[i + 2] == 0x00 && in_ie[i + 3] == 0x50 && in_ie[i + 4] == 0xF2 && in_ie[i + 5] == 0x02 && i + 5 < in_len) { /* WMM element ID and OUI */ -+ -+ /* Append WMM IE to the last index of out_ie */ -+#if 0 -+ for (j = i; j < i + (in_ie[i + 1] + 2); j++) { -+ out_ie[ielength] = in_ie[j]; -+ ielength++; -+ } -+ out_ie[initial_out_len + 8] = 0x00; /* force the QoS Info Field to be zero */ -+#endif -+ -+ for (j = i; j < i + 9; j++) { -+ out_ie[ielength] = in_ie[j]; -+ ielength++; -+ } -+ out_ie[initial_out_len + 1] = 0x07; -+ out_ie[initial_out_len + 6] = 0x00; -+ out_ie[initial_out_len + 8] = 0x00; -+ -+ break; -+ } -+ -+ i += (in_ie[i + 1] + 2); /* to the next IE element */ -+ } -+ -+ return ielength; -+ -+} -+ -+ -+/* -+ * Ported from 8185: IsInPreAuthKeyList(). (Renamed from SecIsInPreAuthKeyList(), 2006-10-13.) -+ * Added by Annie, 2006-05-07. -+ * -+ * Search by BSSID, -+ * Return Value: -+ * -1 :if there is no pre-auth key in the table -+ * >=0 :if there is pre-auth key, and return the entry id -+ * -+ * */ -+ -+static int SecIsInPMKIDList(_adapter *Adapter, u8 *bssid) -+{ -+ struct security_priv *psecuritypriv = &Adapter->securitypriv; -+ int i = 0; -+ -+ do { -+ if ((psecuritypriv->PMKIDList[i].bUsed) && -+ (_rtw_memcmp(psecuritypriv->PMKIDList[i].Bssid, bssid, ETH_ALEN) == _TRUE)) -+ break; -+ else { -+ i++; -+ /* continue; */ -+ } -+ -+ } while (i < NUM_PMKID_CACHE); -+ -+ if (i == NUM_PMKID_CACHE) { -+ i = -1;/* Could not find. */ -+ } else { -+ /* There is one Pre-Authentication Key for the specific BSSID. */ -+ } -+ -+ return i; -+ -+} -+ -+/* -+ * Check the RSN IE length -+ * If the RSN IE length <= 20, the RSN IE didn't include the PMKID information -+ * 0-11th element in the array are the fixed IE -+ * 12th element in the array is the IE -+ * 13th element in the array is the IE length -+ * */ -+ -+static int rtw_append_pmkid(_adapter *adapter, int iEntry, u8 *ie, uint ie_len) -+{ -+ struct security_priv *sec = &adapter->securitypriv; -+ -+ if (ie[13] > 20) { -+ int i; -+ u16 pmkid_cnt = RTW_GET_LE16(ie + 14 + 20); -+ if (pmkid_cnt == 1 && _rtw_memcmp(ie + 14 + 20 + 2, &sec->PMKIDList[iEntry].PMKID, 16)) { -+ RTW_INFO(FUNC_ADPT_FMT" has carried the same PMKID:"KEY_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), KEY_ARG(&sec->PMKIDList[iEntry].PMKID)); -+ goto exit; -+ } -+ -+ RTW_INFO(FUNC_ADPT_FMT" remove original PMKID, count:%u\n" -+ , FUNC_ADPT_ARG(adapter), pmkid_cnt); -+ -+ for (i = 0; i < pmkid_cnt; i++) -+ RTW_INFO(" "KEY_FMT"\n", KEY_ARG(ie + 14 + 20 + 2 + i * 16)); -+ -+ ie_len -= 2 + pmkid_cnt * 16; -+ ie[13] = 20; -+ } -+ -+ if (ie[13] <= 20) { -+ /* The RSN IE didn't include the PMK ID, append the PMK information */ -+ -+ RTW_INFO(FUNC_ADPT_FMT" append PMKID:"KEY_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), KEY_ARG(&sec->PMKIDList[iEntry].PMKID)); -+ -+ RTW_PUT_LE16(&ie[ie_len], 1); -+ ie_len += 2; -+ -+ _rtw_memcpy(&ie[ie_len], &sec->PMKIDList[iEntry].PMKID, 16); -+ ie_len += 16; -+ -+ ie[13] += 18;/* PMKID length = 2+16 */ -+ } -+ -+exit: -+ return ie_len; -+} -+ -+static int rtw_remove_pmkid(_adapter *adapter, u8 *ie, uint ie_len) -+{ -+ struct security_priv *sec = &adapter->securitypriv; -+ int i; -+ u16 pmkid_cnt = RTW_GET_LE16(ie + 14 + 20); -+ -+ if (ie[13] <= 20) -+ goto exit; -+ -+ RTW_INFO(FUNC_ADPT_FMT" remove original PMKID, count:%u\n" -+ , FUNC_ADPT_ARG(adapter), pmkid_cnt); -+ -+ for (i = 0; i < pmkid_cnt; i++) -+ RTW_INFO(" "KEY_FMT"\n", KEY_ARG(ie + 14 + 20 + 2 + i * 16)); -+ -+ ie_len -= 2 + pmkid_cnt * 16; -+ ie[13] = 20; -+ -+exit: -+ return ie_len; -+} -+ -+sint rtw_restruct_sec_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len) -+{ -+ u8 authmode = 0x0, securitytype, match; -+ u8 sec_ie[255], uncst_oui[4], bkup_ie[255]; -+ u8 wpa_oui[4] = {0x0, 0x50, 0xf2, 0x01}; -+ uint ielength, cnt, remove_cnt; -+ int iEntry; -+ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ uint ndisauthmode = psecuritypriv->ndisauthtype; -+ uint ndissecuritytype = psecuritypriv->ndisencryptstatus; -+ -+ -+ -+ /* copy fixed ie only */ -+ _rtw_memcpy(out_ie, in_ie, 12); -+ ielength = 12; -+ if ((ndisauthmode == Ndis802_11AuthModeWPA) || (ndisauthmode == Ndis802_11AuthModeWPAPSK)) -+ authmode = _WPA_IE_ID_; -+ if ((ndisauthmode == Ndis802_11AuthModeWPA2) || (ndisauthmode == Ndis802_11AuthModeWPA2PSK)) -+ authmode = _WPA2_IE_ID_; -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { -+ _rtw_memcpy(out_ie + ielength, psecuritypriv->wps_ie, psecuritypriv->wps_ie_len); -+ -+ ielength += psecuritypriv->wps_ie_len; -+ } else if ((authmode == _WPA_IE_ID_) || (authmode == _WPA2_IE_ID_)) { -+ /* copy RSN or SSN */ -+ _rtw_memcpy(&out_ie[ielength], &psecuritypriv->supplicant_ie[0], psecuritypriv->supplicant_ie[1] + 2); -+ /* debug for CONFIG_IEEE80211W -+ { -+ int jj; -+ printk("supplicant_ie_length=%d &&&&&&&&&&&&&&&&&&&\n", psecuritypriv->supplicant_ie[1]+2); -+ for(jj=0; jj < psecuritypriv->supplicant_ie[1]+2; jj++) -+ printk(" %02x ", psecuritypriv->supplicant_ie[jj]); -+ printk("\n"); -+ }*/ -+ ielength += psecuritypriv->supplicant_ie[1] + 2; -+ rtw_report_sec_ie(adapter, authmode, psecuritypriv->supplicant_ie); -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ drvext_report_sec_ie(&adapter->drvextpriv, authmode, sec_ie); -+#endif -+ } -+ -+ iEntry = SecIsInPMKIDList(adapter, pmlmepriv->assoc_bssid); -+ if (iEntry < 0) { -+ if (authmode == _WPA2_IE_ID_) -+ ielength = rtw_remove_pmkid(adapter, out_ie, ielength); -+ } else { -+ if (authmode == _WPA2_IE_ID_) -+ ielength = rtw_append_pmkid(adapter, iEntry, out_ie, ielength); -+ } -+ -+ -+ return ielength; -+} -+ -+void rtw_init_registrypriv_dev_network(_adapter *adapter) -+{ -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ WLAN_BSSID_EX *pdev_network = &pregistrypriv->dev_network; -+ u8 *myhwaddr = adapter_mac_addr(adapter); -+ -+ -+ _rtw_memcpy(pdev_network->MacAddress, myhwaddr, ETH_ALEN); -+ -+ _rtw_memcpy(&pdev_network->Ssid, &pregistrypriv->ssid, sizeof(NDIS_802_11_SSID)); -+ -+ pdev_network->Configuration.Length = sizeof(NDIS_802_11_CONFIGURATION); -+ pdev_network->Configuration.BeaconPeriod = 100; -+ pdev_network->Configuration.FHConfig.Length = 0; -+ pdev_network->Configuration.FHConfig.HopPattern = 0; -+ pdev_network->Configuration.FHConfig.HopSet = 0; -+ pdev_network->Configuration.FHConfig.DwellTime = 0; -+ -+ -+ -+} -+ -+void rtw_update_registrypriv_dev_network(_adapter *adapter) -+{ -+ int sz = 0; -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ WLAN_BSSID_EX *pdev_network = &pregistrypriv->dev_network; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct wlan_network *cur_network = &adapter->mlmepriv.cur_network; -+ /* struct xmit_priv *pxmitpriv = &adapter->xmitpriv; */ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ -+ -+#if 0 -+ pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense; -+ pxmitpriv->vcs = pregistrypriv->vcs_type; -+ pxmitpriv->vcs_type = pregistrypriv->vcs_type; -+ /* pxmitpriv->rts_thresh = pregistrypriv->rts_thresh; */ -+ pxmitpriv->frag_len = pregistrypriv->frag_thresh; -+ -+ adapter->qospriv.qos_option = pregistrypriv->wmm_enable; -+#endif -+ -+ pdev_network->Privacy = (psecuritypriv->dot11PrivacyAlgrthm > 0 ? 1 : 0) ; /* adhoc no 802.1x */ -+ -+ pdev_network->Rssi = 0; -+ -+ switch (pregistrypriv->wireless_mode) { -+ case WIRELESS_11B: -+ pdev_network->NetworkTypeInUse = (Ndis802_11DS); -+ break; -+ case WIRELESS_11G: -+ case WIRELESS_11BG: -+ case WIRELESS_11_24N: -+ case WIRELESS_11G_24N: -+ case WIRELESS_11BG_24N: -+ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM24); -+ break; -+ case WIRELESS_11A: -+ case WIRELESS_11A_5N: -+ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM5); -+ break; -+ case WIRELESS_11ABGN: -+ if (pregistrypriv->channel > 14) -+ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM5); -+ else -+ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM24); -+ break; -+ default: -+ /* TODO */ -+ break; -+ } -+ -+ pdev_network->Configuration.DSConfig = (pregistrypriv->channel); -+ -+ if (cur_network->network.InfrastructureMode == Ndis802_11IBSS) { -+ pdev_network->Configuration.ATIMWindow = (0); -+ -+ if (pmlmeext->cur_channel != 0) -+ pdev_network->Configuration.DSConfig = pmlmeext->cur_channel; -+ else -+ pdev_network->Configuration.DSConfig = 1; -+ } -+ -+ pdev_network->InfrastructureMode = (cur_network->network.InfrastructureMode); -+ -+ /* 1. Supported rates */ -+ /* 2. IE */ -+ -+ /* rtw_set_supported_rate(pdev_network->SupportedRates, pregistrypriv->wireless_mode) ; */ /* will be called in rtw_generate_ie */ -+ sz = rtw_generate_ie(pregistrypriv); -+ -+ pdev_network->IELength = sz; -+ -+ pdev_network->Length = get_WLAN_BSSID_EX_sz((WLAN_BSSID_EX *)pdev_network); -+ -+ /* notes: translate IELength & Length after assign the Length to cmdsz in createbss_cmd(); */ -+ /* pdev_network->IELength = cpu_to_le32(sz); */ -+ -+ -+} -+ -+void rtw_get_encrypt_decrypt_from_registrypriv(_adapter *adapter) -+{ -+ -+ -+ -+} -+ -+/* the fucntion is at passive_level */ -+void rtw_joinbss_reset(_adapter *padapter) -+{ -+ u8 threshold; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ /* todo: if you want to do something io/reg/hw setting before join_bss, please add code here */ -+ -+#ifdef CONFIG_80211N_HT -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ -+ pmlmepriv->num_FortyMHzIntolerant = 0; -+ -+ pmlmepriv->num_sta_no_ht = 0; -+ -+ phtpriv->ampdu_enable = _FALSE;/* reset to disabled */ -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) -+ /* TH=1 => means that invalidate usb rx aggregation */ -+ /* TH=0 => means that validate usb rx aggregation, use init value. */ -+ if (phtpriv->ht_option) { -+ if (padapter->registrypriv.wifi_spec == 1) -+ threshold = 1; -+ else -+ threshold = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); -+ } else { -+ threshold = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); -+ } -+#endif/* #if defined( CONFIG_USB_HCI) || defined (CONFIG_SDIO_HCI) */ -+ -+#endif/* #ifdef CONFIG_80211N_HT */ -+ -+} -+ -+ -+#ifdef CONFIG_80211N_HT -+void rtw_ht_use_default_setting(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ BOOLEAN bHwLDPCSupport = _FALSE, bHwSTBCSupport = _FALSE; -+#ifdef CONFIG_BEAMFORMING -+ BOOLEAN bHwSupportBeamformer = _FALSE, bHwSupportBeamformee = _FALSE; -+#endif /* CONFIG_BEAMFORMING */ -+ -+ if (pregistrypriv->wifi_spec) -+ phtpriv->bss_coexist = 1; -+ else -+ phtpriv->bss_coexist = 0; -+ -+ phtpriv->sgi_40m = TEST_FLAG(pregistrypriv->short_gi, BIT1) ? _TRUE : _FALSE; -+ phtpriv->sgi_20m = TEST_FLAG(pregistrypriv->short_gi, BIT0) ? _TRUE : _FALSE; -+ -+ /* LDPC support */ -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_LDPC, (u8 *)&bHwLDPCSupport); -+ CLEAR_FLAGS(phtpriv->ldpc_cap); -+ if (bHwLDPCSupport) { -+ if (TEST_FLAG(pregistrypriv->ldpc_cap, BIT4)) -+ SET_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_RX); -+ } -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_LDPC, (u8 *)&bHwLDPCSupport); -+ if (bHwLDPCSupport) { -+ if (TEST_FLAG(pregistrypriv->ldpc_cap, BIT5)) -+ SET_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX); -+ } -+ if (phtpriv->ldpc_cap) -+ RTW_INFO("[HT] HAL Support LDPC = 0x%02X\n", phtpriv->ldpc_cap); -+ -+ /* STBC */ -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_STBC, (u8 *)&bHwSTBCSupport); -+ CLEAR_FLAGS(phtpriv->stbc_cap); -+ if (bHwSTBCSupport) { -+ if (TEST_FLAG(pregistrypriv->stbc_cap, BIT5)) -+ SET_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX); -+ } -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_STBC, (u8 *)&bHwSTBCSupport); -+ if (bHwSTBCSupport) { -+ if (TEST_FLAG(pregistrypriv->stbc_cap, BIT4)) -+ SET_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX); -+ } -+ if (phtpriv->stbc_cap) -+ RTW_INFO("[HT] HAL Support STBC = 0x%02X\n", phtpriv->stbc_cap); -+ -+ /* Beamforming setting */ -+ CLEAR_FLAGS(phtpriv->beamform_cap); -+#ifdef CONFIG_BEAMFORMING -+ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMER, (u8 *)&bHwSupportBeamformer); -+ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMEE, (u8 *)&bHwSupportBeamformee); -+ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT4) && bHwSupportBeamformer) { -+ SET_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); -+ RTW_INFO("[HT] HAL Support Beamformer\n"); -+ } -+ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT5) && bHwSupportBeamformee) { -+ SET_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); -+ RTW_INFO("[HT] HAL Support Beamformee\n"); -+ } -+#endif /* CONFIG_BEAMFORMING */ -+} -+void rtw_build_wmm_ie_ht(_adapter *padapter, u8 *out_ie, uint *pout_len) -+{ -+ unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01, 0x00}; -+ int out_len; -+ u8 *pframe; -+ -+ if (padapter->mlmepriv.qospriv.qos_option == 0) { -+ out_len = *pout_len; -+ pframe = rtw_set_ie(out_ie + out_len, _VENDOR_SPECIFIC_IE_, -+ _WMM_IE_Length_, WMM_IE, pout_len); -+ -+ padapter->mlmepriv.qospriv.qos_option = 1; -+ } -+} -+ -+/* the fucntion is >= passive_level */ -+unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len, u8 channel) -+{ -+ u32 ielen, out_len; -+ u32 rx_packet_offset, max_recvbuf_sz; -+ HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor; -+ HT_CAP_AMPDU_DENSITY best_ampdu_density; -+ unsigned char *p, *pframe; -+ struct rtw_ieee80211_ht_cap ht_capie; -+ u8 cbw40_enable = 0, rf_type = 0, operation_bw = 0, rf_num = 0, rx_stbc_nss = 0; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ phtpriv->ht_option = _FALSE; -+ -+ out_len = *pout_len; -+ -+ _rtw_memset(&ht_capie, 0, sizeof(struct rtw_ieee80211_ht_cap)); -+ -+ ht_capie.cap_info = IEEE80211_HT_CAP_DSSSCCK40; -+ -+ if (phtpriv->sgi_20m) -+ ht_capie.cap_info |= IEEE80211_HT_CAP_SGI_20; -+ -+ /* Get HT BW */ -+ if (in_ie == NULL) { -+ /* TDLS: TODO 20/40 issue */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ operation_bw = padapter->mlmeextpriv.cur_bwmode; -+ if (operation_bw > CHANNEL_WIDTH_40) -+ operation_bw = CHANNEL_WIDTH_40; -+ } else -+ /* TDLS: TODO 40? */ -+ operation_bw = CHANNEL_WIDTH_40; -+ } else { -+ p = rtw_get_ie(in_ie, _HT_ADD_INFO_IE_, &ielen, in_len); -+ if (p && (ielen == sizeof(struct ieee80211_ht_addt_info))) { -+ struct HT_info_element *pht_info = (struct HT_info_element *)(p + 2); -+ if (pht_info->infos[0] & BIT(2)) { -+ switch (pht_info->infos[0] & 0x3) { -+ case 1: -+ case 3: -+ operation_bw = CHANNEL_WIDTH_40; -+ break; -+ default: -+ operation_bw = CHANNEL_WIDTH_20; -+ break; -+ } -+ } else -+ operation_bw = CHANNEL_WIDTH_20; -+ } -+ } -+ -+ /* to disable 40M Hz support while gd_bw_40MHz_en = 0 */ -+ if (hal_chk_bw_cap(padapter, BW_CAP_40M)) { -+ if (channel > 14) { -+ if (REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) -+ cbw40_enable = 1; -+ } else { -+ if (REGSTY_IS_BW_2G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) -+ cbw40_enable = 1; -+ } -+ } -+ -+ if ((cbw40_enable == 1) && (operation_bw == CHANNEL_WIDTH_40)) { -+ ht_capie.cap_info |= IEEE80211_HT_CAP_SUP_WIDTH; -+ if (phtpriv->sgi_40m) -+ ht_capie.cap_info |= IEEE80211_HT_CAP_SGI_40; -+ } -+ -+ /* todo: disable SM power save mode */ -+ ht_capie.cap_info |= IEEE80211_HT_CAP_SM_PS; -+ -+ /* RX LDPC */ -+ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_RX)) { -+ ht_capie.cap_info |= IEEE80211_HT_CAP_LDPC_CODING; -+ RTW_INFO("[HT] Declare supporting RX LDPC\n"); -+ } -+ -+ /* TX STBC */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX)) { -+ ht_capie.cap_info |= IEEE80211_HT_CAP_TX_STBC; -+ RTW_INFO("[HT] Declare supporting TX STBC\n"); -+ } -+ -+ /* RX STBC */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX)) { -+ if ((pregistrypriv->rx_stbc == 0x3) || /* enable for 2.4/5 GHz */ -+ ((channel <= 14) && (pregistrypriv->rx_stbc == 0x1)) || /* enable for 2.4GHz */ -+ ((channel > 14) && (pregistrypriv->rx_stbc == 0x2)) || /* enable for 5GHz */ -+ (pregistrypriv->wifi_spec == 1)) { -+ /* HAL_DEF_RX_STBC means STBC RX spatial stream, todo: VHT 4 streams */ -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_STBC, (u8 *)(&rx_stbc_nss)); -+ SET_HT_CAP_ELE_RX_STBC(&ht_capie, rx_stbc_nss); -+ RTW_INFO("[HT] Declare supporting RX STBC = %d\n", rx_stbc_nss); -+ } -+ } -+ -+ /* fill default supported_mcs_set */ -+ _rtw_memcpy(ht_capie.supp_mcs_set, pmlmeext->default_supported_mcs_set, 16); -+ -+ /* update default supported_mcs_set */ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ switch (rf_type) { -+ case RF_1T1R: -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_1R); -+ break; -+ -+ case RF_2T2R: -+ case RF_1T2R: -+#ifdef CONFIG_DISABLE_MCS13TO15 -+ if (((cbw40_enable == 1) && (operation_bw == CHANNEL_WIDTH_40)) && (pregistrypriv->wifi_spec != 1)) -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R_13TO15_OFF); -+ else -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R); -+#else /* CONFIG_DISABLE_MCS13TO15 */ -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R); -+#endif /* CONFIG_DISABLE_MCS13TO15 */ -+ break; -+ case RF_3T3R: -+ set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_3R); -+ break; -+ default: -+ RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); -+ } -+ -+ { -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_PACKET_OFFSET, &rx_packet_offset); -+ rtw_hal_get_def_var(padapter, HAL_DEF_MAX_RECVBUF_SZ, &max_recvbuf_sz); -+ if (max_recvbuf_sz - rx_packet_offset >= (8191 - 256)) { -+ RTW_INFO("%s IEEE80211_HT_CAP_MAX_AMSDU is set\n", __FUNCTION__); -+ ht_capie.cap_info = ht_capie.cap_info | IEEE80211_HT_CAP_MAX_AMSDU; -+ } -+ } -+ /* -+ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k -+ AMPDU_para [4:2]:Min MPDU Start Spacing -+ */ -+ -+ /* -+ #if defined(CONFIG_RTL8188E) && defined(CONFIG_SDIO_HCI) -+ ht_capie.ampdu_params_info = 2; -+ #else -+ ht_capie.ampdu_params_info = (IEEE80211_HT_CAP_AMPDU_FACTOR&0x03); -+ #endif -+ */ -+ -+ if (padapter->driver_rx_ampdu_factor != 0xFF) -+ max_rx_ampdu_factor = (HT_CAP_AMPDU_FACTOR)padapter->driver_rx_ampdu_factor; -+ else -+ rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); -+ -+ /* rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); */ -+ ht_capie.ampdu_params_info = (max_rx_ampdu_factor & 0x03); -+ -+ if (padapter->driver_rx_ampdu_spacing != 0xFF) -+ ht_capie.ampdu_params_info |= ((padapter->driver_rx_ampdu_spacing & 0x07) << 2); -+ else { -+ if (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) { -+ /* -+ * Todo : Each chip must to ask DD , this chip best ampdu_density setting -+ * By yiwei.sun -+ */ -+ rtw_hal_get_def_var(padapter, HW_VAR_BEST_AMPDU_DENSITY, &best_ampdu_density); -+ -+ ht_capie.ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & (best_ampdu_density << 2)); -+ -+ } else -+ ht_capie.ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & 0x00); -+ } -+#ifdef CONFIG_BEAMFORMING -+ ht_capie.tx_BF_cap_info = 0; -+ -+ /* HT Beamformer*/ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { -+ /* Transmit NDP Capable */ -+ SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(&ht_capie, 1); -+ /* Explicit Compressed Steering Capable */ -+ SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(&ht_capie, 1); -+ /* Compressed Steering Number Antennas */ -+ SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(&ht_capie, 1); -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMER_CAP, (u8 *)&rf_num); -+ SET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(&ht_capie, rf_num); -+ } -+ -+ /* HT Beamformee */ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) { -+ /* Receive NDP Capable */ -+ SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(&ht_capie, 1); -+ /* Explicit Compressed Beamforming Feedback Capable */ -+ SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(&ht_capie, 2); -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); -+ SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(&ht_capie, rf_num); -+ } -+#endif/*CONFIG_BEAMFORMING*/ -+ -+ pframe = rtw_set_ie(out_ie + out_len, _HT_CAPABILITY_IE_, -+ sizeof(struct rtw_ieee80211_ht_cap), (unsigned char *)&ht_capie, pout_len); -+ -+ phtpriv->ht_option = _TRUE; -+ -+ if (in_ie != NULL) { -+ p = rtw_get_ie(in_ie, _HT_ADD_INFO_IE_, &ielen, in_len); -+ if (p && (ielen == sizeof(struct ieee80211_ht_addt_info))) { -+ out_len = *pout_len; -+ pframe = rtw_set_ie(out_ie + out_len, _HT_ADD_INFO_IE_, ielen, p + 2 , pout_len); -+ } -+ } -+ -+ return phtpriv->ht_option; -+ -+} -+ -+/* the fucntion is > passive_level (in critical_section) */ -+void rtw_update_ht_cap(_adapter *padapter, u8 *pie, uint ie_len, u8 channel) -+{ -+ u8 *p, max_ampdu_sz; -+ int len; -+ /* struct sta_info *bmc_sta, *psta; */ -+ struct rtw_ieee80211_ht_cap *pht_capie; -+ struct ieee80211_ht_addt_info *pht_addtinfo; -+ /* struct recv_reorder_ctrl *preorder_ctrl; */ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ /* struct recv_priv *precvpriv = &padapter->recvpriv; */ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ /* struct wlan_network *pcur_network = &(pmlmepriv->cur_network);; */ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 cbw40_enable = 0; -+ -+ -+ if (!phtpriv->ht_option) -+ return; -+ -+ if ((!pmlmeinfo->HT_info_enable) || (!pmlmeinfo->HT_caps_enable)) -+ return; -+ -+ RTW_INFO("+rtw_update_ht_cap()\n"); -+ -+ /* maybe needs check if ap supports rx ampdu. */ -+ if ((phtpriv->ampdu_enable == _FALSE) && (pregistrypriv->ampdu_enable == 1)) { -+ if (pregistrypriv->wifi_spec == 1) { -+ /* remove this part because testbed AP should disable RX AMPDU */ -+ /* phtpriv->ampdu_enable = _FALSE; */ -+ phtpriv->ampdu_enable = _TRUE; -+ } else -+ phtpriv->ampdu_enable = _TRUE; -+ } -+ -+ -+ /* check Max Rx A-MPDU Size */ -+ len = 0; -+ p = rtw_get_ie(pie + sizeof(NDIS_802_11_FIXED_IEs), _HT_CAPABILITY_IE_, &len, ie_len - sizeof(NDIS_802_11_FIXED_IEs)); -+ if (p && len > 0) { -+ pht_capie = (struct rtw_ieee80211_ht_cap *)(p + 2); -+ max_ampdu_sz = (pht_capie->ampdu_params_info & IEEE80211_HT_CAP_AMPDU_FACTOR); -+ max_ampdu_sz = 1 << (max_ampdu_sz + 3); /* max_ampdu_sz (kbytes); */ -+ -+ /* RTW_INFO("rtw_update_ht_cap(): max_ampdu_sz=%d\n", max_ampdu_sz); */ -+ phtpriv->rx_ampdu_maxlen = max_ampdu_sz; -+ -+ } -+ -+ -+ len = 0; -+ p = rtw_get_ie(pie + sizeof(NDIS_802_11_FIXED_IEs), _HT_ADD_INFO_IE_, &len, ie_len - sizeof(NDIS_802_11_FIXED_IEs)); -+ if (p && len > 0) { -+ pht_addtinfo = (struct ieee80211_ht_addt_info *)(p + 2); -+ /* todo: */ -+ } -+ -+ if (hal_chk_bw_cap(padapter, BW_CAP_40M)) { -+ if (channel > 14) { -+ if (REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) -+ cbw40_enable = 1; -+ } else { -+ if (REGSTY_IS_BW_2G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) -+ cbw40_enable = 1; -+ } -+ } -+ -+ /* update cur_bwmode & cur_ch_offset */ -+ if ((cbw40_enable) && -+ (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & BIT(1)) && -+ (pmlmeinfo->HT_info.infos[0] & BIT(2))) { -+ int i; -+ u8 rf_type = RF_1T1R; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ /* update the MCS set */ -+ for (i = 0; i < 16; i++) -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= pmlmeext->default_supported_mcs_set[i]; -+ -+ /* update the MCS rates */ -+ switch (rf_type) { -+ case RF_1T1R: -+ case RF_1T2R: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R); -+ break; -+ case RF_2T2R: -+#ifdef CONFIG_DISABLE_MCS13TO15 -+ if (pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && pregistrypriv->wifi_spec != 1) -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R_13TO15_OFF); -+ else -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+#else /* CONFIG_DISABLE_MCS13TO15 */ -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+#endif /* CONFIG_DISABLE_MCS13TO15 */ -+ break; -+ case RF_3T3R: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_3R); -+ break; -+ default: -+ RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); -+ } -+ -+ /* switch to the 40M Hz mode accoring to the AP */ -+ /* pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; */ -+ switch ((pmlmeinfo->HT_info.infos[0] & 0x3)) { -+ case EXTCHNL_OFFSET_UPPER: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case EXTCHNL_OFFSET_LOWER: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ } -+ -+ /* */ -+ /* Config SM Power Save setting */ -+ /* */ -+ pmlmeinfo->SM_PS = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & 0x0C) >> 2; -+ if (pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) { -+#if 0 -+ u8 i; -+ /* update the MCS rates */ -+ for (i = 0; i < 16; i++) -+ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; -+#endif -+ RTW_INFO("%s(): WLAN_HT_CAP_SM_PS_STATIC\n", __FUNCTION__); -+ } -+ -+ /* */ -+ /* Config current HT Protection mode. */ -+ /* */ -+ pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; -+ -+ -+ -+#if 0 /* move to rtw_update_sta_info_client() */ -+ /* for A-MPDU Rx reordering buffer control for bmc_sta & sta_info */ -+ /* if A-MPDU Rx is enabled, reseting rx_ordering_ctrl wstart_b(indicate_seq) to default value=0xffff */ -+ /* todo: check if AP can send A-MPDU packets */ -+ bmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if (bmc_sta) { -+ for (i = 0; i < 16 ; i++) { -+ /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ -+ preorder_ctrl = &bmc_sta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = _FALSE; -+ preorder_ctrl->indicate_seq = 0xffff; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq); -+#endif -+ preorder_ctrl->wend_b = 0xffff; -+ preorder_ctrl->wsize_b = 64;/* max_ampdu_sz; */ /* ex. 32(kbytes) -> wsize_b=32 */ -+ } -+ } -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, pcur_network->network.MacAddress); -+ if (psta) { -+ for (i = 0; i < 16 ; i++) { -+ /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = _FALSE; -+ preorder_ctrl->indicate_seq = 0xffff; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq); -+#endif -+ preorder_ctrl->wend_b = 0xffff; -+ preorder_ctrl->wsize_b = 64;/* max_ampdu_sz; */ /* ex. 32(kbytes) -> wsize_b=32 */ -+ } -+ } -+#endif -+ -+} -+ -+#ifdef CONFIG_TDLS -+void rtw_issue_addbareq_cmd_tdls(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta = NULL; -+ u8 issued; -+ int priority; -+ struct ht_priv *phtpriv; -+ -+ priority = pattrib->priority; -+ -+ if (pattrib->direct_link == _TRUE) { -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); -+ if ((ptdls_sta != NULL) && (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) { -+ phtpriv = &ptdls_sta->htpriv; -+ -+ if ((phtpriv->ht_option == _TRUE) && (phtpriv->ampdu_enable == _TRUE)) { -+ issued = (phtpriv->agg_enable_bitmap >> priority) & 0x1; -+ issued |= (phtpriv->candidate_tid_bitmap >> priority) & 0x1; -+ -+ if (0 == issued) { -+ RTW_INFO("[%s], p=%d\n", __FUNCTION__, priority); -+ ptdls_sta->htpriv.candidate_tid_bitmap |= BIT((u8)priority); -+ rtw_addbareq_cmd(padapter, (u8)priority, pattrib->dst); -+ } -+ } -+ } -+ } -+} -+#endif /* CONFIG_TDLS */ -+ -+void rtw_issue_addbareq_cmd(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ u8 issued; -+ int priority; -+ struct sta_info *psta = NULL; -+ struct ht_priv *phtpriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ -+ /* if(bmcst || (padapter->mlmepriv.LinkDetectInfo.bTxBusyTraffic == _FALSE)) */ -+ if (bmcst || (padapter->mlmepriv.LinkDetectInfo.NumTxOkInPeriod < 100)) -+ return; -+ -+ priority = pattrib->priority; -+ -+#ifdef CONFIG_TDLS -+ rtw_issue_addbareq_cmd_tdls(padapter, pxmitframe); -+#endif /* CONFIG_TDLS */ -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if (pattrib->psta != psta) { -+ RTW_INFO("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return; -+ } -+ -+ if (psta == NULL) { -+ RTW_INFO("%s, psta==NUL\n", __func__); -+ return; -+ } -+ -+ if (!(psta->state & _FW_LINKED)) { -+ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return; -+ } -+ -+ -+ phtpriv = &psta->htpriv; -+ -+ if ((phtpriv->ht_option == _TRUE) && (phtpriv->ampdu_enable == _TRUE)) { -+ issued = (phtpriv->agg_enable_bitmap >> priority) & 0x1; -+ issued |= (phtpriv->candidate_tid_bitmap >> priority) & 0x1; -+ -+ if (0 == issued) { -+ RTW_INFO("rtw_issue_addbareq_cmd, p=%d\n", priority); -+ psta->htpriv.candidate_tid_bitmap |= BIT((u8)priority); -+ rtw_addbareq_cmd(padapter, (u8) priority, pattrib->ra); -+ } -+ } -+ -+} -+ -+void rtw_append_exented_cap(_adapter *padapter, u8 *out_ie, uint *pout_len) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+#endif /* CONFIG_80211AC_VHT */ -+ u8 cap_content[8] = { 0 }; -+ u8 *pframe; -+ u8 null_content[8] = {0}; -+ -+ if (phtpriv->bss_coexist) -+ SET_EXT_CAPABILITY_ELE_BSS_COEXIST(cap_content, 1); -+ -+#ifdef CONFIG_80211AC_VHT -+ if (pvhtpriv->vht_option) -+ SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(cap_content, 1); -+#endif /* CONFIG_80211AC_VHT */ -+ /* -+ From 802.11 specification,if a STA does not support any of capabilities defined -+ in the Extended Capabilities element, then the STA is not required to -+ transmit the Extended Capabilities element. -+ */ -+ if (_FALSE == _rtw_memcmp(cap_content, null_content, 8)) -+ pframe = rtw_set_ie(out_ie + *pout_len, EID_EXTCapability, 8, cap_content , pout_len); -+} -+#endif -+ -+#ifdef CONFIG_LAYER2_ROAMING -+inline void rtw_set_to_roam(_adapter *adapter, u8 to_roam) -+{ -+ if (to_roam == 0) -+ adapter->mlmepriv.to_join = _FALSE; -+ adapter->mlmepriv.to_roam = to_roam; -+} -+ -+inline u8 rtw_dec_to_roam(_adapter *adapter) -+{ -+ adapter->mlmepriv.to_roam--; -+ return adapter->mlmepriv.to_roam; -+} -+ -+inline u8 rtw_to_roam(_adapter *adapter) -+{ -+ return adapter->mlmepriv.to_roam; -+} -+ -+void rtw_roaming(_adapter *padapter, struct wlan_network *tgt_network) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ _rtw_roaming(padapter, tgt_network); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+void _rtw_roaming(_adapter *padapter, struct wlan_network *tgt_network) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ int do_join_r; -+ -+ if (0 < rtw_to_roam(padapter)) { -+ RTW_INFO("roaming from %s("MAC_FMT"), length:%d\n", -+ cur_network->network.Ssid.Ssid, MAC_ARG(cur_network->network.MacAddress), -+ cur_network->network.Ssid.SsidLength); -+ _rtw_memcpy(&pmlmepriv->assoc_ssid, &cur_network->network.Ssid, sizeof(NDIS_802_11_SSID)); -+ -+ pmlmepriv->assoc_by_bssid = _FALSE; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_return_all_sta_info(padapter); -+#endif -+ -+ while (1) { -+ do_join_r = rtw_do_join(padapter); -+ if (_SUCCESS == do_join_r) -+ break; -+ else { -+ RTW_INFO("roaming do_join return %d\n", do_join_r); -+ rtw_dec_to_roam(padapter); -+ -+ if (rtw_to_roam(padapter) > 0) -+ continue; -+ else { -+ RTW_INFO("%s(%d) -to roaming fail, indicate_disconnect\n", __FUNCTION__, __LINE__); -+#ifdef CONFIG_RTW_80211R -+ rtw_clr_ft_flags(padapter, RTW_FT_SUPPORTED|RTW_FT_OVER_DS_SUPPORTED); -+ rtw_reset_ft_status(padapter); -+#endif -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ break; -+ } -+ } -+ } -+ } -+ -+} -+#endif /* CONFIG_LAYER2_ROAMING */ -+ -+#ifdef CONFIG_80211N_HT -+bool rtw_adjust_chbw(_adapter *adapter, u8 req_ch, u8 *req_bw, u8 *req_offset) -+{ -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ u8 allowed_bw; -+ -+ if (req_ch <= 14) -+ allowed_bw = REGSTY_BW_2G(regsty); -+ else -+ allowed_bw = REGSTY_BW_5G(regsty); -+ -+ allowed_bw = hal_largest_bw(adapter, allowed_bw); -+ -+ if (allowed_bw == CHANNEL_WIDTH_80 && *req_bw > CHANNEL_WIDTH_80) -+ *req_bw = CHANNEL_WIDTH_80; -+ else if (allowed_bw == CHANNEL_WIDTH_40 && *req_bw > CHANNEL_WIDTH_40) -+ *req_bw = CHANNEL_WIDTH_40; -+ else if (allowed_bw == CHANNEL_WIDTH_20 && *req_bw > CHANNEL_WIDTH_20) { -+ *req_bw = CHANNEL_WIDTH_20; -+ *req_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } else -+ return _FALSE; -+ -+ return _TRUE; -+} -+#endif -+ -+sint rtw_linked_check(_adapter *padapter) -+{ -+ if ((check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) || -+ (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) == _TRUE)) { -+ if (padapter->stapriv.asoc_sta_count > 2) -+ return _TRUE; -+ } else { -+ /* Station mode */ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _TRUE) -+ return _TRUE; -+ } -+ return _FALSE; -+} -+u8 rtw_is_adapter_up(_adapter *padapter) -+{ -+ if (padapter == NULL) -+ return _FALSE; -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ RTW_INFO(FUNC_ADPT_FMT "-(bSurpriseRemoved == _TRUE) || ( bDriverStopped == _TRUE)\n", FUNC_ADPT_ARG(padapter)); -+ return _FALSE; -+ } -+ -+ if (!rtw_is_hw_init_completed(padapter)) { -+ /*RTW_INFO(FUNC_ADPT_FMT "-(hw_init_completed == _FALSE)\n", FUNC_ADPT_ARG(padapter));*/ -+ return _FALSE; -+ } -+ -+ if (padapter->bup == _FALSE) { -+ /*RTW_INFO(FUNC_ADPT_FMT "-(bup == _FALSE)\n", FUNC_ADPT_ARG(padapter));*/ -+ return _FALSE; -+ } -+ -+ return _TRUE; -+} -+ -+bool is_miracast_enabled(_adapter *adapter) -+{ -+ bool enabled = 0; -+#ifdef CONFIG_WFD -+ struct wifi_display_info *wfdinfo = &adapter->wfd_info; -+ -+ enabled = (wfdinfo->stack_wfd_mode & (MIRACAST_SOURCE | MIRACAST_SINK)) -+ || (wfdinfo->op_wfd_mode & (MIRACAST_SOURCE | MIRACAST_SINK)); -+#endif -+ -+ return enabled; -+} -+ -+bool rtw_chk_miracast_mode(_adapter *adapter, u8 mode) -+{ -+ bool ret = 0; -+#ifdef CONFIG_WFD -+ struct wifi_display_info *wfdinfo = &adapter->wfd_info; -+ -+ ret = (wfdinfo->stack_wfd_mode & mode) || (wfdinfo->op_wfd_mode & mode); -+#endif -+ -+ return ret; -+} -+ -+const char *get_miracast_mode_str(int mode) -+{ -+ if (mode == MIRACAST_SOURCE) -+ return "SOURCE"; -+ else if (mode == MIRACAST_SINK) -+ return "SINK"; -+ else if (mode == (MIRACAST_SOURCE | MIRACAST_SINK)) -+ return "SOURCE&SINK"; -+ else if (mode == MIRACAST_DISABLED) -+ return "DISABLED"; -+ else -+ return "INVALID"; -+} -+ -+#ifdef CONFIG_WFD -+static bool wfd_st_match_rule(_adapter *adapter, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) -+{ -+ struct wifi_display_info *wfdinfo = &adapter->wfd_info; -+ -+ if (ntohs(*((u16 *)local_port)) == wfdinfo->rtsp_ctrlport -+ || ntohs(*((u16 *)local_port)) == wfdinfo->tdls_rtsp_ctrlport -+ || ntohs(*((u16 *)remote_port)) == wfdinfo->peer_rtsp_ctrlport) -+ return _TRUE; -+ return _FALSE; -+} -+ -+static struct st_register wfd_st_reg = { -+ .s_proto = 0x06, -+ .rule = wfd_st_match_rule, -+}; -+#endif /* CONFIG_WFD */ -+ -+inline void rtw_wfd_st_switch(struct sta_info *sta, bool on) -+{ -+#ifdef CONFIG_WFD -+ if (on) -+ rtw_st_ctl_register(&sta->st_ctl, SESSION_TRACKER_REG_ID_WFD, &wfd_st_reg); -+ else -+ rtw_st_ctl_unregister(&sta->st_ctl, SESSION_TRACKER_REG_ID_WFD); -+#endif -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_mlme_ext.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mlme_ext.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_mlme_ext.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mlme_ext.c 2018-02-11 21:44:27.139145964 +0200 -@@ -0,0 +1,15722 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_MLME_EXT_C_ -+ -+#include -+#ifdef CONFIG_IOCTL_CFG80211 -+ #include -+#endif /* CONFIG_IOCTL_CFG80211 */ -+#include -+ -+ -+struct mlme_handler mlme_sta_tbl[] = { -+ {WIFI_ASSOCREQ, "OnAssocReq", &OnAssocReq}, -+ {WIFI_ASSOCRSP, "OnAssocRsp", &OnAssocRsp}, -+ {WIFI_REASSOCREQ, "OnReAssocReq", &OnAssocReq}, -+ {WIFI_REASSOCRSP, "OnReAssocRsp", &OnAssocRsp}, -+ {WIFI_PROBEREQ, "OnProbeReq", &OnProbeReq}, -+ {WIFI_PROBERSP, "OnProbeRsp", &OnProbeRsp}, -+ -+ /*---------------------------------------------------------- -+ below 2 are reserved -+ -----------------------------------------------------------*/ -+ {0, "DoReserved", &DoReserved}, -+ {0, "DoReserved", &DoReserved}, -+ {WIFI_BEACON, "OnBeacon", &OnBeacon}, -+ {WIFI_ATIM, "OnATIM", &OnAtim}, -+ {WIFI_DISASSOC, "OnDisassoc", &OnDisassoc}, -+ {WIFI_AUTH, "OnAuth", &OnAuthClient}, -+ {WIFI_DEAUTH, "OnDeAuth", &OnDeAuth}, -+ {WIFI_ACTION, "OnAction", &OnAction}, -+ {WIFI_ACTION_NOACK, "OnActionNoAck", &OnAction}, -+}; -+ -+#ifdef _CONFIG_NATIVEAP_MLME_ -+struct mlme_handler mlme_ap_tbl[] = { -+ {WIFI_ASSOCREQ, "OnAssocReq", &OnAssocReq}, -+ {WIFI_ASSOCRSP, "OnAssocRsp", &OnAssocRsp}, -+ {WIFI_REASSOCREQ, "OnReAssocReq", &OnAssocReq}, -+ {WIFI_REASSOCRSP, "OnReAssocRsp", &OnAssocRsp}, -+ {WIFI_PROBEREQ, "OnProbeReq", &OnProbeReq}, -+ {WIFI_PROBERSP, "OnProbeRsp", &OnProbeRsp}, -+ -+ /*---------------------------------------------------------- -+ below 2 are reserved -+ -----------------------------------------------------------*/ -+ {0, "DoReserved", &DoReserved}, -+ {0, "DoReserved", &DoReserved}, -+ {WIFI_BEACON, "OnBeacon", &OnBeacon}, -+ {WIFI_ATIM, "OnATIM", &OnAtim}, -+ {WIFI_DISASSOC, "OnDisassoc", &OnDisassoc}, -+ {WIFI_AUTH, "OnAuth", &OnAuth}, -+ {WIFI_DEAUTH, "OnDeAuth", &OnDeAuth}, -+ {WIFI_ACTION, "OnAction", &OnAction}, -+ {WIFI_ACTION_NOACK, "OnActionNoAck", &OnAction}, -+}; -+#endif -+ -+struct action_handler OnAction_tbl[] = { -+ {RTW_WLAN_CATEGORY_SPECTRUM_MGMT, "ACTION_SPECTRUM_MGMT", on_action_spct}, -+ {RTW_WLAN_CATEGORY_QOS, "ACTION_QOS", &OnAction_qos}, -+ {RTW_WLAN_CATEGORY_DLS, "ACTION_DLS", &OnAction_dls}, -+ {RTW_WLAN_CATEGORY_BACK, "ACTION_BACK", &OnAction_back}, -+ {RTW_WLAN_CATEGORY_PUBLIC, "ACTION_PUBLIC", on_action_public}, -+ {RTW_WLAN_CATEGORY_RADIO_MEASUREMENT, "ACTION_RADIO_MEASUREMENT", &DoReserved}, -+ {RTW_WLAN_CATEGORY_FT, "ACTION_FT", &OnAction_ft}, -+ {RTW_WLAN_CATEGORY_HT, "ACTION_HT", &OnAction_ht}, -+#ifdef CONFIG_IEEE80211W -+ {RTW_WLAN_CATEGORY_SA_QUERY, "ACTION_SA_QUERY", &OnAction_sa_query}, -+#else -+ {RTW_WLAN_CATEGORY_SA_QUERY, "ACTION_SA_QUERY", &DoReserved}, -+#endif /* CONFIG_IEEE80211W */ -+#ifdef CONFIG_RTW_WNM -+ {RTW_WLAN_CATEGORY_WNM, "ACTION_WNM", &on_action_wnm}, -+#endif -+ {RTW_WLAN_CATEGORY_UNPROTECTED_WNM, "ACTION_UNPROTECTED_WNM", &DoReserved}, -+ {RTW_WLAN_CATEGORY_SELF_PROTECTED, "ACTION_SELF_PROTECTED", &DoReserved}, -+ {RTW_WLAN_CATEGORY_WMM, "ACTION_WMM", &OnAction_wmm}, -+ {RTW_WLAN_CATEGORY_VHT, "ACTION_VHT", &OnAction_vht}, -+ {RTW_WLAN_CATEGORY_P2P, "ACTION_P2P", &OnAction_p2p}, -+}; -+ -+ -+u8 null_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; -+ -+/************************************************** -+OUI definitions for the vendor specific IE -+***************************************************/ -+unsigned char RTW_WPA_OUI[] = {0x00, 0x50, 0xf2, 0x01}; -+unsigned char WMM_OUI[] = {0x00, 0x50, 0xf2, 0x02}; -+unsigned char WPS_OUI[] = {0x00, 0x50, 0xf2, 0x04}; -+unsigned char P2P_OUI[] = {0x50, 0x6F, 0x9A, 0x09}; -+unsigned char WFD_OUI[] = {0x50, 0x6F, 0x9A, 0x0A}; -+ -+unsigned char WMM_INFO_OUI[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01}; -+unsigned char WMM_PARA_OUI[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; -+ -+unsigned char WPA_TKIP_CIPHER[4] = {0x00, 0x50, 0xf2, 0x02}; -+unsigned char RSN_TKIP_CIPHER[4] = {0x00, 0x0f, 0xac, 0x02}; -+ -+extern unsigned char REALTEK_96B_IE[]; -+ -+#ifdef LEGACY_CHANNEL_PLAN_REF -+/******************************************************** -+ChannelPlan definitions -+*********************************************************/ -+static RT_CHANNEL_PLAN legacy_channel_plan[] = { -+ /* 0x00, RTW_CHPLAN_FCC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 32}, -+ /* 0x01, RTW_CHPLAN_IC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 31}, -+ /* 0x02, RTW_CHPLAN_ETSI */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 32}, -+ /* 0x03, RTW_CHPLAN_SPAIN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, -+ /* 0x04, RTW_CHPLAN_FRANCE */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, -+ /* 0x05, RTW_CHPLAN_MKK */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, -+ /* 0x06, RTW_CHPLAN_MKK1 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, -+ /* 0x07, RTW_CHPLAN_ISRAEL */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64}, 21}, -+ /* 0x08, RTW_CHPLAN_TELEC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52, 56, 60, 64}, 22}, -+ /* 0x09, RTW_CHPLAN_GLOBAL_DOAMIN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14}, -+ /* 0x0A, RTW_CHPLAN_WORLD_WIDE_13 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, -+ /* 0x0B, RTW_CHPLAN_TAIWAN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 26}, -+ /* 0x0C, RTW_CHPLAN_CHINA */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 149, 153, 157, 161, 165}, 18}, -+ /* 0x0D, RTW_CHPLAN_SINGAPORE_INDIA_MEXICO */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165}, 24}, -+ /* 0x0E, RTW_CHPLAN_KOREA */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161, 165}, 31}, -+ /* 0x0F, RTW_CHPLAN_TURKEY */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64}, 19}, -+ /* 0x10, RTW_CHPLAN_JAPAN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 32}, -+ /* 0x11, RTW_CHPLAN_FCC_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 149, 153, 157, 161, 165}, 20}, -+ /* 0x12, RTW_CHPLAN_JAPAN_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48}, 17}, -+ /* 0x13, RTW_CHPLAN_WORLD_WIDE_5G */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165}, 37}, -+ /* 0x14, RTW_CHPLAN_TAIWAN_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 56, 60, 64, 149, 153, 157, 161, 165}, 19}, -+}; -+#endif -+ -+static struct ch_list_t RTW_ChannelPlan2G[] = { -+ /* 0, RTW_RD_2G_NULL */ CH_LIST_ENT(0), -+ /* 1, RTW_RD_2G_WORLD */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), -+ /* 2, RTW_RD_2G_ETSI1 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), -+ /* 3, RTW_RD_2G_FCC1 */ CH_LIST_ENT(11, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11), -+ /* 4, RTW_RD_2G_MKK1 */ CH_LIST_ENT(14, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14), -+ /* 5, RTW_RD_2G_ETSI2 */ CH_LIST_ENT(4, 10, 11, 12, 13), -+ /* 6, RTW_RD_2G_GLOBAL */ CH_LIST_ENT(14, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14), -+ /* 7, RTW_RD_2G_MKK2 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), -+ /* 8, RTW_RD_2G_FCC2 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), -+}; -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+static struct ch_list_t RTW_ChannelPlan5G[] = { -+ /* 0, RTW_RD_5G_NULL */ CH_LIST_ENT(0), -+ /* 1, RTW_RD_5G_ETSI1 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), -+ /* 2, RTW_RD_5G_ETSI2 */ CH_LIST_ENT(24, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165), -+ /* 3, RTW_RD_5G_ETSI3 */ CH_LIST_ENT(22, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 149, 153, 157, 161, 165), -+ /* 4, RTW_RD_5G_FCC1 */ CH_LIST_ENT(24, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165), -+ /* 5, RTW_RD_5G_FCC2 */ CH_LIST_ENT(9, 36, 40, 44, 48, 149, 153, 157, 161, 165), -+ /* 6, RTW_RD_5G_FCC3 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165), -+ /* 7, RTW_RD_5G_FCC4 */ CH_LIST_ENT(12, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161), -+ /* 8, RTW_RD_5G_FCC5 */ CH_LIST_ENT(5, 149, 153, 157, 161, 165), -+ /* 9, RTW_RD_5G_FCC6 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64), -+ /* 10, RTW_RD_5G_FCC7 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), -+ /* 11, RTW_RD_5G_KCC1 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161), -+ /* 12, RTW_RD_5G_MKK1 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), -+ /* 13, RTW_RD_5G_MKK2 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64), -+ /* 14, RTW_RD_5G_MKK3 */ CH_LIST_ENT(11, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), -+ /* 15, RTW_RD_5G_NCC1 */ CH_LIST_ENT(16, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), -+ /* 16, RTW_RD_5G_NCC2 */ CH_LIST_ENT(8, 56, 60, 64, 149, 153, 157, 161, 165), -+ /* 17, RTW_RD_5G_NCC3 */ CH_LIST_ENT(5, 149, 153, 157, 161, 165), -+ /* 18, RTW_RD_5G_ETSI4 */ CH_LIST_ENT(4, 36, 40, 44, 48), -+ /* 19, RTW_RD_5G_ETSI5 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), -+ /* 20, RTW_RD_5G_FCC8 */ CH_LIST_ENT(4, 149, 153, 157, 161), -+ /* 21, RTW_RD_5G_ETSI6 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64), -+ /* 22, RTW_RD_5G_ETSI7 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165), -+ /* 23, RTW_RD_5G_ETSI8 */ CH_LIST_ENT(9, 36, 40, 44, 48, 149, 153, 157, 161, 165), -+ /* 24, RTW_RD_5G_ETSI9 */ CH_LIST_ENT(11, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), -+ /* 25, RTW_RD_5G_ETSI10 */ CH_LIST_ENT(5, 149, 153, 157, 161, 165), -+ /* 26, RTW_RD_5G_ETSI11 */ CH_LIST_ENT(16, 36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140, 149, 153, 157, 161, 165), -+ /* 27, RTW_RD_5G_NCC4 */ CH_LIST_ENT(17, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), -+ /* 28, RTW_RD_5G_ETSI12 */ CH_LIST_ENT(4, 149, 153, 157, 161), -+ /* 29, RTW_RD_5G_FCC9 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), -+ /* 30, RTW_RD_5G_ETSI13 */ CH_LIST_ENT(16, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140), -+ /* 31, RTW_RD_5G_FCC10 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161), -+ /* 32, RTW_RD_5G_MKK4 */ CH_LIST_ENT(4, 36, 40, 44, 48), -+ /* 33, RTW_RD_5G_ETSI14 */ CH_LIST_ENT(11, 36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140), -+ /* 34, RTW_RD_5G_FCC11 */ CH_LIST_ENT(25, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144, 149, 153, 157, 161, 165), -+ -+ /* === Below are driver defined for legacy channel plan compatible, NO static index assigned ==== */ -+ /* RTW_RD_5G_OLD_FCC1 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165), -+ /* RTW_RD_5G_OLD_NCC1 */ CH_LIST_ENT(15, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165), -+ /* RTW_RD_5G_OLD_KCC1 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161, 165), -+}; -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ -+static RT_CHANNEL_PLAN_MAP RTW_ChannelPlanMap[] = { -+ /* ===== 0x00 ~ 0x1F, legacy channel plan ===== */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_KCC1, TXPWR_LMT_FCC), /* 0x00, RTW_CHPLAN_FCC */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_OLD_FCC1, TXPWR_LMT_FCC), /* 0x01, RTW_CHPLAN_IC */ -+ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI1, TXPWR_LMT_ETSI), /* 0x02, RTW_CHPLAN_ETSI */ -+ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x03, RTW_CHPLAN_SPAIN */ -+ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x04, RTW_CHPLAN_FRANCE */ -+ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x05, RTW_CHPLAN_MKK */ -+ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x06, RTW_CHPLAN_MKK1 */ -+ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_FCC6, TXPWR_LMT_ETSI), /* 0x07, RTW_CHPLAN_ISRAEL */ -+ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_FCC6, TXPWR_LMT_MKK), /* 0x08, RTW_CHPLAN_TELEC */ -+ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x09, RTW_CHPLAN_GLOBAL_DOAMIN */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x0A, RTW_CHPLAN_WORLD_WIDE_13 */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_OLD_NCC1, TXPWR_LMT_FCC), /* 0x0B, RTW_CHPLAN_TAIWAN */ -+ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_FCC5, TXPWR_LMT_ETSI), /* 0x0C, RTW_CHPLAN_CHINA */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC3, TXPWR_LMT_WW), /* 0x0D, RTW_CHPLAN_SINGAPORE_INDIA_MEXICO */ /* ETSI:Singapore, India. FCC:Mexico => WW */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_OLD_KCC1, TXPWR_LMT_ETSI), /* 0x0E, RTW_CHPLAN_KOREA */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC6, TXPWR_LMT_ETSI), /* 0x0F, RTW_CHPLAN_TURKEY */ -+ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI1, TXPWR_LMT_MKK), /* 0x10, RTW_CHPLAN_JAPAN */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC2, TXPWR_LMT_FCC), /* 0x11, RTW_CHPLAN_FCC_NO_DFS */ -+ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_FCC7, TXPWR_LMT_MKK), /* 0x12, RTW_CHPLAN_JAPAN_NO_DFS */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC1, TXPWR_LMT_WW), /* 0x13, RTW_CHPLAN_WORLD_WIDE_5G */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC2, TXPWR_LMT_FCC), /* 0x14, RTW_CHPLAN_TAIWAN_NO_DFS */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC7, TXPWR_LMT_ETSI), /* 0x15, RTW_CHPLAN_ETSI_NO_DFS */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_NCC1, TXPWR_LMT_ETSI), /* 0x16, RTW_CHPLAN_KOREA_NO_DFS */ -+ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_FCC7, TXPWR_LMT_MKK), /* 0x17, RTW_CHPLAN_JAPAN_NO_DFS */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_FCC5, TXPWR_LMT_ETSI), /* 0x18, RTW_CHPLAN_PAKISTAN_NO_DFS */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC5, TXPWR_LMT_FCC), /* 0x19, RTW_CHPLAN_TAIWAN2_NO_DFS */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1A, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1B, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1C, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1D, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1E, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_FCC1, TXPWR_LMT_WW), /* 0x1F, RTW_CHPLAN_WORLD_WIDE_ONLY_5G */ -+ -+ /* ===== 0x20 ~ 0x7F, new channel plan ===== */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x20, RTW_CHPLAN_WORLD_NULL */ -+ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x21, RTW_CHPLAN_ETSI1_NULL */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NULL, TXPWR_LMT_FCC), /* 0x22, RTW_CHPLAN_FCC1_NULL */ -+ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x23, RTW_CHPLAN_MKK1_NULL */ -+ CHPLAN_ENT(RTW_RD_2G_ETSI2, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x24, RTW_CHPLAN_ETSI2_NULL */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC1, TXPWR_LMT_FCC), /* 0x25, RTW_CHPLAN_FCC1_FCC1 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI1, TXPWR_LMT_ETSI), /* 0x26, RTW_CHPLAN_WORLD_ETSI1 */ -+ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_MKK1, TXPWR_LMT_MKK), /* 0x27, RTW_CHPLAN_MKK1_MKK1 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_KCC1, TXPWR_LMT_ETSI), /* 0x28, RTW_CHPLAN_WORLD_KCC1 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC2, TXPWR_LMT_FCC), /* 0x29, RTW_CHPLAN_WORLD_FCC2 */ -+ CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_NULL, TXPWR_LMT_FCC), /* 0x2A, RTW_CHPLAN_FCC2_NULL */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2B, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2C, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2D, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2E, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2F, */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC3, TXPWR_LMT_FCC), /* 0x30, RTW_CHPLAN_WORLD_FCC3 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC4, TXPWR_LMT_FCC), /* 0x31, RTW_CHPLAN_WORLD_FCC4 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC5, TXPWR_LMT_FCC), /* 0x32, RTW_CHPLAN_WORLD_FCC5 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC6, TXPWR_LMT_FCC), /* 0x33, RTW_CHPLAN_WORLD_FCC6 */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC7, TXPWR_LMT_FCC), /* 0x34, RTW_CHPLAN_FCC1_FCC7 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI2, TXPWR_LMT_ETSI), /* 0x35, RTW_CHPLAN_WORLD_ETSI2 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI3, TXPWR_LMT_ETSI), /* 0x36, RTW_CHPLAN_WORLD_ETSI3 */ -+ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_MKK2, TXPWR_LMT_MKK), /* 0x37, RTW_CHPLAN_MKK1_MKK2 */ -+ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_MKK3, TXPWR_LMT_MKK), /* 0x38, RTW_CHPLAN_MKK1_MKK3 */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC1, TXPWR_LMT_FCC), /* 0x39, RTW_CHPLAN_FCC1_NCC1 */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3A, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3B, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3C, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3D, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3E, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3F, */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC2, TXPWR_LMT_FCC), /* 0x40, RTW_CHPLAN_FCC1_NCC2 */ -+ CHPLAN_ENT(RTW_RD_2G_GLOBAL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x41, RTW_CHPLAN_GLOBAL_NULL */ -+ CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI4, TXPWR_LMT_ETSI), /* 0x42, RTW_CHPLAN_ETSI1_ETSI4 */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC2, TXPWR_LMT_FCC), /* 0x43, RTW_CHPLAN_FCC1_FCC2 */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC3, TXPWR_LMT_FCC), /* 0x44, RTW_CHPLAN_FCC1_NCC3 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI5, TXPWR_LMT_ETSI), /* 0x45, RTW_CHPLAN_WORLD_ETSI5 */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC8, TXPWR_LMT_FCC), /* 0x46, RTW_CHPLAN_FCC1_FCC8 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI6, TXPWR_LMT_ETSI), /* 0x47, RTW_CHPLAN_WORLD_ETSI6 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI7, TXPWR_LMT_ETSI), /* 0x48, RTW_CHPLAN_WORLD_ETSI7 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI8, TXPWR_LMT_ETSI), /* 0x49, RTW_CHPLAN_WORLD_ETSI8 */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4A, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4B, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4C, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4D, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4E, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4F, */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI9, TXPWR_LMT_ETSI), /* 0x50, RTW_CHPLAN_WORLD_ETSI9 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI10, TXPWR_LMT_ETSI), /* 0x51, RTW_CHPLAN_WORLD_ETSI10 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI11, TXPWR_LMT_ETSI), /* 0x52, RTW_CHPLAN_WORLD_ETSI11 */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC4, TXPWR_LMT_FCC), /* 0x53, RTW_CHPLAN_FCC1_NCC4 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI12, TXPWR_LMT_ETSI), /* 0x54, RTW_CHPLAN_WORLD_ETSI12 */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC9, TXPWR_LMT_FCC), /* 0x55, RTW_CHPLAN_FCC1_FCC9 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI13, TXPWR_LMT_ETSI), /* 0x56, RTW_CHPLAN_WORLD_ETSI13 */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC10, TXPWR_LMT_FCC), /* 0x57, RTW_CHPLAN_FCC1_FCC10 */ -+ CHPLAN_ENT(RTW_RD_2G_MKK2, RTW_RD_5G_MKK4, TXPWR_LMT_MKK), /* 0x58, RTW_CHPLAN_MKK2_MKK4 */ -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI14, TXPWR_LMT_ETSI), /* 0x59, RTW_CHPLAN_WORLD_ETSI14 */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5A, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5B, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5C, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5D, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5E, */ -+ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5F, */ -+ CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC5, TXPWR_LMT_FCC), /* 0x60, RTW_CHPLAN_FCC1_FCC5 */ -+ CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_FCC7, TXPWR_LMT_FCC), /* 0x61, RTW_CHPLAN_FCC2_FCC7 */ -+ CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_FCC1, TXPWR_LMT_FCC), /* 0x62, RTW_CHPLAN_FCC2_FCC1 */ -+}; -+ -+static RT_CHANNEL_PLAN_MAP RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE = -+ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC1, TXPWR_LMT_FCC); /* 0x7F, Realtek Define */ -+ -+bool rtw_chplan_is_empty(u8 id) -+{ -+ RT_CHANNEL_PLAN_MAP *chplan_map; -+ -+ if (id == RTW_CHPLAN_REALTEK_DEFINE) -+ chplan_map = &RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE; -+ else -+ chplan_map = &RTW_ChannelPlanMap[id]; -+ -+ if (chplan_map->Index2G == RTW_RD_2G_NULL -+ #ifdef CONFIG_IEEE80211_BAND_5GHZ -+ && chplan_map->Index5G == RTW_RD_5G_NULL -+ #endif -+ ) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+void rtw_rfctl_init(_adapter *adapter) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ _rtw_memset(rfctl, 0, sizeof(*rfctl)); -+ -+#ifdef CONFIG_DFS_MASTER -+ rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; -+ -+ /* TODO: dfs_master_timer */ -+#endif -+} -+ -+#ifdef CONFIG_DFS_MASTER -+/* -+* called in rtw_dfs_master_enable() -+* assume the request channel coverage is DFS range -+* base on the current status and the request channel coverage to check if need to reset complete CAC time -+*/ -+bool rtw_is_cac_reset_needed(_adapter *adapter, u8 ch, u8 bw, u8 offset) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ bool needed = _FALSE; -+ u32 cur_hi, cur_lo, hi, lo; -+ -+ if (rfctl->radar_detected == 1) { -+ needed = _TRUE; -+ goto exit; -+ } -+ -+ if (rfctl->radar_detect_ch == 0) { -+ needed = _TRUE; -+ goto exit; -+ } -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) { -+ RTW_ERR("request detection range ch:%u, bw:%u, offset:%u\n", ch, bw, offset); -+ rtw_warn_on(1); -+ } -+ -+ if (rtw_chbw_to_freq_range(rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset, &cur_hi, &cur_lo) == _FALSE) { -+ RTW_ERR("cur detection range ch:%u, bw:%u, offset:%u\n", rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset); -+ rtw_warn_on(1); -+ } -+ -+ if (hi <= lo || cur_hi <= cur_lo) { -+ RTW_ERR("hi:%u, lo:%u, cur_hi:%u, cur_lo:%u\n", hi, lo, cur_hi, cur_lo); -+ rtw_warn_on(1); -+ } -+ -+ if (rtw_is_range_a_in_b(hi, lo, cur_hi, cur_lo)) { -+ /* request is in current detect range */ -+ goto exit; -+ } -+ -+ /* check if request channel coverage has new range and the new range is in DFS range */ -+ if (!rtw_is_range_overlap(hi, lo, cur_hi, cur_lo)) { -+ /* request has no overlap with current */ -+ needed = _TRUE; -+ } else if (rtw_is_range_a_in_b(cur_hi, cur_lo, hi, lo)) { -+ /* request is supper set of current */ -+ if ((hi != cur_hi && rtw_is_dfs_range(hi, cur_hi)) || (lo != cur_lo && rtw_is_dfs_range(cur_lo, lo))) -+ needed = _TRUE; -+ } else { -+ /* request is not supper set of current, but has overlap */ -+ if ((lo < cur_lo && rtw_is_dfs_range(cur_lo, lo)) || (hi > cur_hi && rtw_is_dfs_range(hi, cur_hi))) -+ needed = _TRUE; -+ } -+ -+exit: -+ return needed; -+} -+ -+bool _rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset) -+{ -+ bool ret = _FALSE; -+ u32 hi = 0, lo = 0; -+ u32 r_hi = 0, r_lo = 0; -+ int i; -+ -+ if (rfctl->radar_detect_by_others) -+ goto exit; -+ -+ if (rfctl->radar_detect_ch == 0) -+ goto exit; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (rtw_chbw_to_freq_range(rfctl->radar_detect_ch -+ , rfctl->radar_detect_bw, rfctl->radar_detect_offset -+ , &r_hi, &r_lo) == _FALSE) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (rtw_is_range_overlap(hi, lo, r_hi, r_lo)) -+ ret = _TRUE; -+ -+exit: -+ return ret; -+} -+ -+bool rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl) -+{ -+ return _rtw_rfctl_overlap_radar_detect_ch(rfctl -+ , rfctl_to_dvobj(rfctl)->oper_channel -+ , rfctl_to_dvobj(rfctl)->oper_bwmode -+ , rfctl_to_dvobj(rfctl)->oper_ch_offset); -+} -+ -+bool rtw_rfctl_is_tx_blocked_by_ch_waiting(struct rf_ctl_t *rfctl) -+{ -+ return rtw_rfctl_overlap_radar_detect_ch(rfctl) && IS_CH_WAITING(rfctl); -+} -+ -+bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) -+{ -+ bool ret = _FALSE; -+ u32 hi = 0, lo = 0; -+ int i; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) -+ goto exit; -+ -+ for (i = 0; ch_set[i].ChannelNum != 0; i++) { -+ if (!rtw_ch2freq(ch_set[i].ChannelNum)) { -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ if (!CH_IS_NON_OCP(&ch_set[i])) -+ continue; -+ -+ if (lo <= rtw_ch2freq(ch_set[i].ChannelNum) -+ && rtw_ch2freq(ch_set[i].ChannelNum) <= hi -+ ) { -+ ret = _TRUE; -+ break; -+ } -+ } -+ -+exit: -+ return ret; -+} -+ -+u32 rtw_chset_get_ch_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) -+{ -+ int ms = 0; -+ u32 current_time; -+ u32 hi = 0, lo = 0; -+ int i; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) -+ goto exit; -+ -+ current_time = rtw_get_current_time(); -+ -+ for (i = 0; ch_set[i].ChannelNum != 0; i++) { -+ if (!rtw_ch2freq(ch_set[i].ChannelNum)) { -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ if (!CH_IS_NON_OCP(&ch_set[i])) -+ continue; -+ -+ if (lo <= rtw_ch2freq(ch_set[i].ChannelNum) -+ && rtw_ch2freq(ch_set[i].ChannelNum) <= hi -+ ) { -+ if (rtw_systime_to_ms(ch_set[i].non_ocp_end_time - current_time) > ms) -+ ms = rtw_systime_to_ms(ch_set[i].non_ocp_end_time - current_time); -+ } -+ } -+ -+exit: -+ return ms; -+} -+ -+/** -+ * rtw_chset_update_non_ocp - update non_ocp_end_time according to the given @ch, @bw, @offset into @ch_set -+ * @ch_set: the given channel set -+ * @ch: channel number on which radar is detected -+ * @bw: bandwidth on which radar is detected -+ * @offset: bandwidth offset on which radar is detected -+ * @ms: ms to add from now to update non_ocp_end_time, ms < 0 means use NON_OCP_TIME_MS -+ */ -+static void _rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset, int ms) -+{ -+ u32 hi = 0, lo = 0; -+ int i; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) -+ goto exit; -+ -+ for (i = 0; ch_set[i].ChannelNum != 0; i++) { -+ if (!rtw_ch2freq(ch_set[i].ChannelNum)) { -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ if (lo <= rtw_ch2freq(ch_set[i].ChannelNum) -+ && rtw_ch2freq(ch_set[i].ChannelNum) <= hi -+ ) { -+ if (ms >= 0) -+ ch_set[i].non_ocp_end_time = rtw_get_current_time() + rtw_ms_to_systime(ms); -+ else -+ ch_set[i].non_ocp_end_time = rtw_get_current_time() + rtw_ms_to_systime(NON_OCP_TIME_MS); -+ } -+ } -+ -+exit: -+ return; -+} -+ -+inline void rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) -+{ -+ _rtw_chset_update_non_ocp(ch_set, ch, bw, offset, -1); -+} -+ -+inline void rtw_chset_update_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset, int ms) -+{ -+ _rtw_chset_update_non_ocp(ch_set, ch, bw, offset, ms); -+} -+ -+u32 rtw_get_ch_waiting_ms(_adapter *adapter, u8 ch, u8 bw, u8 offset, u32 *r_non_ocp_ms, u32 *r_cac_ms) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ u32 non_ocp_ms; -+ u32 cac_ms; -+ u8 in_rd_range = 0; /* if in current radar detection range*/ -+ -+ if (rtw_chset_is_ch_non_ocp(mlmeext->channel_set, ch, bw, offset)) -+ non_ocp_ms = rtw_chset_get_ch_non_ocp_ms(mlmeext->channel_set, ch, bw, offset); -+ else -+ non_ocp_ms = 0; -+ -+ if (rfctl->dfs_master_enabled) { -+ u32 cur_hi, cur_lo, hi, lo; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) { -+ RTW_ERR("input range ch:%u, bw:%u, offset:%u\n", ch, bw, offset); -+ rtw_warn_on(1); -+ } -+ -+ if (rtw_chbw_to_freq_range(rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset, &cur_hi, &cur_lo) == _FALSE) { -+ RTW_ERR("cur detection range ch:%u, bw:%u, offset:%u\n", rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset); -+ rtw_warn_on(1); -+ } -+ -+ if (rtw_is_range_a_in_b(hi, lo, cur_hi, cur_lo)) -+ in_rd_range = 1; -+ } -+ -+ if (!rtw_is_dfs_ch(ch, bw, offset)) -+ cac_ms = 0; -+ else if (in_rd_range && !non_ocp_ms) { -+ if (IS_CH_WAITING(rfctl)) -+ cac_ms = rtw_systime_to_ms(rfctl->cac_end_time - rtw_get_current_time()); -+ else -+ cac_ms = 0; -+ } else if (rtw_is_long_cac_ch(ch, bw, offset, rtw_odm_get_dfs_domain(adapter))) -+ cac_ms = CAC_TIME_CE_MS; -+ else -+ cac_ms = CAC_TIME_MS; -+ -+ if (r_non_ocp_ms) -+ *r_non_ocp_ms = non_ocp_ms; -+ if (r_cac_ms) -+ *r_cac_ms = cac_ms; -+ -+ return non_ocp_ms + cac_ms; -+} -+ -+void rtw_reset_cac(_adapter *adapter, u8 ch, u8 bw, u8 offset) -+{ -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ u32 non_ocp_ms; -+ u32 cac_ms; -+ -+ rtw_get_ch_waiting_ms(adapter -+ , ch -+ , bw -+ , offset -+ , &non_ocp_ms -+ , &cac_ms -+ ); -+ -+ rfctl->cac_start_time = rtw_get_current_time() + rtw_ms_to_systime(non_ocp_ms); -+ rfctl->cac_end_time = rfctl->cac_start_time + rtw_ms_to_systime(cac_ms); -+ -+ /* skip special value */ -+ if (rfctl->cac_start_time == RTW_CAC_STOPPED) { -+ rfctl->cac_start_time++; -+ rfctl->cac_end_time++; -+ } -+ if (rfctl->cac_end_time == RTW_CAC_STOPPED) -+ rfctl->cac_end_time++; -+} -+ -+/* choose channel with shortest waiting (non ocp + cac) time */ -+bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 *dec_bw, u8 *dec_offset, u8 d_flags) -+{ -+#ifndef DBG_CHOOSE_SHORTEST_WAITING_CH -+#define DBG_CHOOSE_SHORTEST_WAITING_CH 0 -+#endif -+ -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ u8 ch, bw, offset; -+ u8 ch_c = 0, bw_c = 0, offset_c = 0; -+ int i; -+ u32 min_waiting_ms = 0; -+ -+ if (!dec_ch || !dec_bw || !dec_offset) { -+ rtw_warn_on(1); -+ return _FALSE; -+ } -+ -+ /* full search and narrow bw judegement first to avoid potetial judegement timing issue */ -+ for (bw = CHANNEL_WIDTH_20; bw <= req_bw; bw++) { -+ if (!hal_is_bw_support(adapter, bw)) -+ continue; -+ -+ for (i = 0; i < mlmeext->max_chan_nums; i++) { -+ u32 non_ocp_ms; -+ u32 cac_ms; -+ u32 waiting_ms; -+ -+ ch = mlmeext->channel_set[i].ChannelNum; -+ -+ if ((d_flags & RTW_CHF_2G) && ch <= 14) -+ continue; -+ -+ if ((d_flags & RTW_CHF_5G) && ch > 14) -+ continue; -+ -+ if (ch > 14) { -+ if (bw > REGSTY_BW_5G(regsty)) -+ continue; -+ } else { -+ if (bw > REGSTY_BW_2G(regsty)) -+ continue; -+ } -+ -+ if (!rtw_get_offset_by_chbw(ch, bw, &offset)) -+ continue; -+ -+ if (!rtw_chset_is_chbw_valid(mlmeext->channel_set, ch, bw, offset)) -+ continue; -+ -+ if ((d_flags & RTW_CHF_NON_OCP) && rtw_chset_is_ch_non_ocp(mlmeext->channel_set, ch, bw, offset)) -+ continue; -+ -+ if ((d_flags & RTW_CHF_DFS) && rtw_is_dfs_ch(ch, bw, offset)) -+ continue; -+ -+ if ((d_flags & RTW_CHF_LONG_CAC) && rtw_is_long_cac_ch(ch, bw, offset, rtw_odm_get_dfs_domain(adapter))) -+ continue; -+ -+ if ((d_flags & RTW_CHF_NON_DFS) && !rtw_is_dfs_ch(ch, bw, offset)) -+ continue; -+ -+ if ((d_flags & RTW_CHF_NON_LONG_CAC) && !rtw_is_long_cac_ch(ch, bw, offset, rtw_odm_get_dfs_domain(adapter))) -+ continue; -+ -+ waiting_ms = rtw_get_ch_waiting_ms(adapter, ch, bw, offset, &non_ocp_ms, &cac_ms); -+ -+ if (DBG_CHOOSE_SHORTEST_WAITING_CH) -+ RTW_INFO(FUNC_ADPT_FMT":%u,%u,%u %u(non_ocp:%u, cac:%u)\n" -+ , FUNC_ADPT_ARG(adapter), ch, bw, offset, waiting_ms, non_ocp_ms, cac_ms); -+ -+ if (ch_c == 0 -+ || min_waiting_ms > waiting_ms -+ || (min_waiting_ms == waiting_ms && bw > bw_c) /* wider bw first */ -+ ) { -+ ch_c = ch; -+ bw_c = bw; -+ offset_c = offset; -+ min_waiting_ms = waiting_ms; -+ } -+ } -+ } -+ -+ if (ch_c != 0) { -+ RTW_INFO(FUNC_ADPT_FMT": d_flags:0x%02x %u,%u,%u waiting_ms:%u\n" -+ , FUNC_ADPT_ARG(adapter), d_flags, ch_c, bw_c, offset_c, min_waiting_ms); -+ -+ *dec_ch = ch_c; -+ *dec_bw = bw_c; -+ *dec_offset = offset_c; -+ return _TRUE; -+ } -+ -+ if (d_flags == 0) -+ rtw_warn_on(1); -+ -+ return _FALSE; -+} -+#endif /* CONFIG_DFS_MASTER */ -+ -+void dump_country_chplan(void *sel, const struct country_chplan *ent) -+{ -+ _RTW_PRINT_SEL(sel, "\"%c%c\", 0x%02X%s\n" -+ , ent->alpha2[0], ent->alpha2[1], ent->chplan -+ , COUNTRY_CHPLAN_EN_11AC(ent) ? " ac" : "" -+ ); -+} -+ -+void dump_country_chplan_map(void *sel) -+{ -+ const struct country_chplan *ent; -+ u8 code[2]; -+ -+#if RTW_DEF_MODULE_REGULATORY_CERT -+ _RTW_PRINT_SEL(sel, "RTW_DEF_MODULE_REGULATORY_CERT:0x%x\n", RTW_DEF_MODULE_REGULATORY_CERT); -+#endif -+#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP -+ _RTW_PRINT_SEL(sel, "CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP\n"); -+#endif -+ -+ for (code[0] = 'A'; code[0] <= 'Z'; code[0]++) { -+ for (code[1] = 'A'; code[1] <= 'Z'; code[1]++) { -+ ent = rtw_get_chplan_from_country(code); -+ if (!ent) -+ continue; -+ -+ dump_country_chplan(sel, ent); -+ } -+ } -+} -+ -+void dump_chplan_id_list(void *sel) -+{ -+ int i; -+ -+ for (i = 0; i < RTW_CHPLAN_MAX; i++) { -+ if (!rtw_is_channel_plan_valid(i)) -+ continue; -+ -+ _RTW_PRINT_SEL(sel, "0x%02X ", i); -+ } -+ -+ RTW_PRINT_SEL(sel, "0x7F\n"); -+} -+ -+void dump_chplan_test(void *sel) -+{ -+ int i, j; -+ -+ /* check invalid channel */ -+ for (i = 0; i < RTW_RD_2G_MAX; i++) { -+ for (j = 0; j < CH_LIST_LEN(RTW_ChannelPlan2G[i]); j++) { -+ if (rtw_ch2freq(CH_LIST_CH(RTW_ChannelPlan2G[i], j)) == 0) -+ RTW_PRINT_SEL(sel, "invalid ch:%u at (%d,%d)\n", CH_LIST_CH(RTW_ChannelPlan2G[i], j), i, j); -+ } -+ } -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ for (i = 0; i < RTW_RD_5G_MAX; i++) { -+ for (j = 0; j < CH_LIST_LEN(RTW_ChannelPlan5G[i]); j++) { -+ if (rtw_ch2freq(CH_LIST_CH(RTW_ChannelPlan5G[i], j)) == 0) -+ RTW_PRINT_SEL(sel, "invalid ch:%u at (%d,%d)\n", CH_LIST_CH(RTW_ChannelPlan5G[i], j), i, j); -+ } -+ } -+#endif -+} -+ -+void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set) -+{ -+ u8 i; -+ -+ for (i = 0; ch_set[i].ChannelNum != 0; i++) { -+ RTW_PRINT_SEL(sel, "ch:%3u, freq:%u, scan_type:%d" -+ , ch_set[i].ChannelNum, rtw_ch2freq(ch_set[i].ChannelNum), ch_set[i].ScanType); -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ _RTW_PRINT_SEL(sel, ", rx_count:%u", ch_set[i].rx_count); -+#endif -+ -+#ifdef CONFIG_DFS_MASTER -+ if (rtw_is_dfs_ch(ch_set[i].ChannelNum, CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE)) { -+ if (CH_IS_NON_OCP(&ch_set[i])) -+ _RTW_PRINT_SEL(sel, ", non_ocp:%d" -+ , rtw_systime_to_ms(ch_set[i].non_ocp_end_time - rtw_get_current_time())); -+ else -+ _RTW_PRINT_SEL(sel, ", non_ocp:N/A"); -+ } -+#endif -+ -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+ RTW_PRINT_SEL(sel, "total ch number:%d\n", i); -+} -+ -+void dump_cur_chset(void *sel, _adapter *adapter) -+{ -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int i; -+ -+ if (mlme->country_ent) -+ dump_country_chplan(sel, mlme->country_ent); -+ else -+ RTW_PRINT_SEL(sel, "chplan:0x%02X\n", mlme->ChannelPlan); -+ -+ RTW_PRINT_SEL(sel, "2G_PLS:%u, 5G_PLS:%u\n" -+ , hal_data->Regulation2_4G, hal_data->Regulation5G); -+ -+ for (i = 0; i < MAX_CHANNEL_NUM; i++) -+ if (regsty->excl_chs[i] != 0) -+ break; -+ -+ if (i < MAX_CHANNEL_NUM) { -+ _RTW_PRINT_SEL(sel, "excl_chs:"); -+ for (i = 0; i < MAX_CHANNEL_NUM; i++) { -+ if (regsty->excl_chs[i] == 0) -+ break; -+ _RTW_PRINT_SEL(sel, "%u ", regsty->excl_chs[i]); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ } -+ -+ dump_chset(sel, mlmeext->channel_set); -+} -+ -+/* -+ * Search the @param ch in given @param ch_set -+ * @ch_set: the given channel set -+ * @ch: the given channel number -+ * -+ * return the index of channel_num in channel_set, -1 if not found -+ */ -+int rtw_ch_set_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch) -+{ -+ int i; -+ for (i = 0; ch_set[i].ChannelNum != 0; i++) { -+ if (ch == ch_set[i].ChannelNum) -+ break; -+ } -+ -+ if (i >= ch_set[i].ChannelNum) -+ return -1; -+ return i; -+} -+ -+/* -+ * Check if the @param ch, bw, offset is valid for the given @param ch_set -+ * @ch_set: the given channel set -+ * @ch: the given channel number -+ * @bw: the given bandwidth -+ * @offset: the given channel offset -+ * -+ * return valid (1) or not (0) -+ */ -+u8 rtw_chset_is_chbw_valid(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) -+{ -+ u8 cch; -+ u8 *op_chs; -+ u8 op_ch_num; -+ u8 valid = 0; -+ int i; -+ -+ cch = rtw_get_center_ch(ch, bw, offset); -+ -+ if (!rtw_get_op_chs_by_cch_bw(cch, bw, &op_chs, &op_ch_num)) -+ goto exit; -+ -+ for (i = 0; i < op_ch_num; i++) { -+ if (0) -+ RTW_INFO("%u,%u,%u - cch:%u, bw:%u, op_ch:%u\n", ch, bw, offset, cch, bw, *(op_chs + i)); -+ if (rtw_ch_set_search_ch(ch_set, *(op_chs + i)) == -1) -+ break; -+ } -+ -+ if (op_ch_num != 0 && i == op_ch_num) -+ valid = 1; -+ -+exit: -+ return valid; -+} -+ -+/* -+ * Check the @param ch is fit with setband setting of @param adapter -+ * @adapter: the given adapter -+ * @ch: the given channel number -+ * -+ * return _TRUE when check valid, _FALSE not valid -+ */ -+bool rtw_mlme_band_check(_adapter *adapter, const u32 ch) -+{ -+ if (adapter->setband == WIFI_FREQUENCY_BAND_AUTO /* 2.4G and 5G */ -+ || (adapter->setband == WIFI_FREQUENCY_BAND_2GHZ && ch < 35) /* 2.4G only */ -+ || (adapter->setband == WIFI_FREQUENCY_BAND_5GHZ && ch > 35) /* 5G only */ -+ ) -+ return _TRUE; -+ return _FALSE; -+} -+inline void RTW_SET_SCAN_BAND_SKIP(_adapter *padapter, int skip_band) -+{ -+ int bs = ATOMIC_READ(&padapter->bandskip); -+ -+ bs |= skip_band; -+ ATOMIC_SET(&padapter->bandskip, bs); -+} -+ -+inline void RTW_CLR_SCAN_BAND_SKIP(_adapter *padapter, int skip_band) -+{ -+ int bs = ATOMIC_READ(&padapter->bandskip); -+ -+ bs &= ~(skip_band); -+ ATOMIC_SET(&padapter->bandskip, bs); -+} -+inline int RTW_GET_SCAN_BAND_SKIP(_adapter *padapter) -+{ -+ return ATOMIC_READ(&padapter->bandskip); -+} -+ -+#define RTW_IS_SCAN_BAND_SKIP(padapter, skip_band) (ATOMIC_READ(&padapter->bandskip) & (skip_band)) -+ -+bool rtw_mlme_ignore_chan(_adapter *adapter, const u32 ch) -+{ -+ if (RTW_IS_SCAN_BAND_SKIP(adapter, BAND_24G) && ch < 35) /* SKIP 2.4G Band channel */ -+ return _TRUE; -+ if (RTW_IS_SCAN_BAND_SKIP(adapter, BAND_5G) && ch > 35) /* SKIP 5G Band channel */ -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+ -+/**************************************************************************** -+ -+Following are the initialization functions for WiFi MLME -+ -+*****************************************************************************/ -+ -+int init_hw_mlme_ext(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ /* set_opmode_cmd(padapter, infra_client_with_mlme); */ /* removed */ -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ return _SUCCESS; -+} -+ -+void init_mlme_default_rate_set(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ unsigned char supported_b_mode[b_mode_rate_num] = -+ {_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_}; -+ unsigned char supported_g_mode[g_mode_rate_num] = -+ {_6M_RATE_, _9M_RATE_, _12M_RATE_, _18M_RATE_,\ -+ _24M_RATE_, _36M_RATE_, _48M_RATE_, _54M_RATE_}; -+ unsigned char supported_mcs_set[16] = {0xff, 0xff, 0xff, 0x00, 0x00, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; -+ unsigned char end_set[1] = {0xff}; -+ u8 offset = 0; -+#if 1 -+ if (IsSupportedTxCCK(padapter->registrypriv.wireless_mode)) { -+ _rtw_memcpy(pmlmeext->datarate, -+ supported_b_mode, b_mode_rate_num); -+ _rtw_memcpy(pmlmeext->basicrate, -+ supported_b_mode, b_mode_rate_num); -+ offset += b_mode_rate_num; -+ RTW_INFO("%s: support CCK\n", __func__); -+ } -+ -+ if (IsSupportedTxOFDM(padapter->registrypriv.wireless_mode)) { -+ _rtw_memcpy(pmlmeext->datarate + offset, -+ supported_g_mode, g_mode_rate_num); -+ _rtw_memcpy(pmlmeext->basicrate + offset, -+ supported_g_mode, g_mode_rate_num); -+ offset += g_mode_rate_num; -+ RTW_INFO("%s: support OFDM\n", __func__); -+ } -+ -+ _rtw_memcpy(pmlmeext->datarate + offset, end_set, 1); -+ _rtw_memcpy(pmlmeext->basicrate + offset, end_set, 1); -+#else -+ _rtw_memcpy(pmlmeext->datarate, mixed_datarate, NumRates); -+ _rtw_memcpy(pmlmeext->basicrate, mixed_basicrate, NumRates); -+#endif -+#ifdef CONFIG_80211N_HT -+ _rtw_memcpy(pmlmeext->default_supported_mcs_set, supported_mcs_set, -+ sizeof(pmlmeext->default_supported_mcs_set)); -+#endif -+} -+ -+static void init_mlme_ext_priv_value(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ ATOMIC_SET(&pmlmeext->event_seq, 0); -+ pmlmeext->mgnt_seq = 0;/* reset to zero when disconnect at client mode */ -+#ifdef CONFIG_IEEE80211W -+ pmlmeext->sa_query_seq = 0; -+ pmlmeext->mgnt_80211w_IPN = 0; -+ pmlmeext->mgnt_80211w_IPN_rx = 0; -+#endif /* CONFIG_IEEE80211W */ -+ pmlmeext->cur_channel = padapter->registrypriv.channel; -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ pmlmeext->retry = 0; -+ -+ pmlmeext->cur_wireless_mode = padapter->registrypriv.wireless_mode; -+ -+ init_mlme_default_rate_set(padapter); -+ -+ if (pmlmeext->cur_channel > 14) -+ pmlmeext->tx_rate = IEEE80211_OFDM_RATE_6MB; -+ else -+ pmlmeext->tx_rate = IEEE80211_CCK_RATE_1MB; -+ -+ mlmeext_set_scan_state(pmlmeext, SCAN_DISABLE); -+ pmlmeext->sitesurvey_res.channel_idx = 0; -+ pmlmeext->sitesurvey_res.bss_cnt = 0; -+ pmlmeext->sitesurvey_res.scan_ch_ms = SURVEY_TO; -+ pmlmeext->sitesurvey_res.rx_ampdu_accept = RX_AMPDU_ACCEPT_INVALID; -+ pmlmeext->sitesurvey_res.rx_ampdu_size = RX_AMPDU_SIZE_INVALID; -+#ifdef CONFIG_SCAN_BACKOP -+ mlmeext_assign_scan_backop_flags_sta(pmlmeext, /*SS_BACKOP_EN|*/SS_BACKOP_PS_ANNC | SS_BACKOP_TX_RESUME); -+ mlmeext_assign_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN | SS_BACKOP_PS_ANNC | SS_BACKOP_TX_RESUME); -+ pmlmeext->sitesurvey_res.scan_cnt = 0; -+ pmlmeext->sitesurvey_res.scan_cnt_max = RTW_SCAN_NUM_OF_CH; -+ pmlmeext->sitesurvey_res.backop_ms = RTW_BACK_OP_CH_MS; -+#endif -+#if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) -+ pmlmeext->sitesurvey_res.is_sw_antdiv_bl_scan = 0; -+#endif -+ pmlmeext->scan_abort = _FALSE; -+ -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ pmlmeinfo->reauth_count = 0; -+ pmlmeinfo->reassoc_count = 0; -+ pmlmeinfo->link_count = 0; -+ pmlmeinfo->auth_seq = 0; -+ pmlmeinfo->auth_algo = dot11AuthAlgrthm_Open; -+ pmlmeinfo->key_index = 0; -+ pmlmeinfo->iv = 0; -+ -+ pmlmeinfo->enc_algo = _NO_PRIVACY_; -+ pmlmeinfo->authModeToggle = 0; -+ -+ _rtw_memset(pmlmeinfo->chg_txt, 0, 128); -+ -+ pmlmeinfo->slotTime = SHORT_SLOT_TIME; -+ pmlmeinfo->preamble_mode = PREAMBLE_AUTO; -+ -+ pmlmeinfo->dialogToken = 0; -+ -+ pmlmeext->action_public_rxseq = 0xffff; -+ pmlmeext->action_public_dialog_token = 0xff; -+} -+ -+static int has_channel(RT_CHANNEL_INFO *channel_set, -+ u8 chanset_size, -+ u8 chan) -+{ -+ int i; -+ -+ for (i = 0; i < chanset_size; i++) { -+ if (channel_set[i].ChannelNum == chan) -+ return 1; -+ } -+ -+ return 0; -+} -+ -+static void init_channel_list(_adapter *padapter, RT_CHANNEL_INFO *channel_set, -+ u8 chanset_size, -+ struct p2p_channels *channel_list) -+{ -+ struct registry_priv *regsty = adapter_to_regsty(padapter); -+ -+ struct p2p_oper_class_map op_class[] = { -+ { IEEE80211G, 81, 1, 13, 1, BW20 }, -+ { IEEE80211G, 82, 14, 14, 1, BW20 }, -+#if 0 /* Do not enable HT40 on 2 GHz */ -+ { IEEE80211G, 83, 1, 9, 1, BW40PLUS }, -+ { IEEE80211G, 84, 5, 13, 1, BW40MINUS }, -+#endif -+ { IEEE80211A, 115, 36, 48, 4, BW20 }, -+ { IEEE80211A, 116, 36, 44, 8, BW40PLUS }, -+ { IEEE80211A, 117, 40, 48, 8, BW40MINUS }, -+ { IEEE80211A, 124, 149, 161, 4, BW20 }, -+ { IEEE80211A, 125, 149, 169, 4, BW20 }, -+ { IEEE80211A, 126, 149, 157, 8, BW40PLUS }, -+ { IEEE80211A, 127, 153, 161, 8, BW40MINUS }, -+ { -1, 0, 0, 0, 0, BW20 } -+ }; -+ -+ int cla, op; -+ -+ cla = 0; -+ -+ for (op = 0; op_class[op].op_class; op++) { -+ u8 ch; -+ struct p2p_oper_class_map *o = &op_class[op]; -+ struct p2p_reg_class *reg = NULL; -+ -+ for (ch = o->min_chan; ch <= o->max_chan; ch += o->inc) { -+ if (!has_channel(channel_set, chanset_size, ch)) -+ continue; -+#ifdef CONFIG_80211N_HT -+ if ((0 == padapter->registrypriv.ht_enable) && (8 == o->inc)) -+ continue; -+ -+ if ((REGSTY_IS_BW_5G_SUPPORT(regsty, CHANNEL_WIDTH_40)) && -+ ((BW40MINUS == o->bw) || (BW40PLUS == o->bw))) -+ continue; -+#endif -+ if (reg == NULL) { -+ reg = &channel_list->reg_class[cla]; -+ cla++; -+ reg->reg_class = o->op_class; -+ reg->channels = 0; -+ } -+ reg->channel[reg->channels] = ch; -+ reg->channels++; -+ } -+ } -+ channel_list->reg_classes = cla; -+ -+} -+ -+bool rtw_regsty_is_excl_chs(struct registry_priv *regsty, u8 ch) -+{ -+ int i; -+ -+ for (i = 0; i < MAX_CHANNEL_NUM; i++) { -+ if (regsty->excl_chs[i] == 0) -+ break; -+ if (regsty->excl_chs[i] == ch) -+ return _TRUE; -+ } -+ return _FALSE; -+} -+ -+static u8 init_channel_set(_adapter *padapter, u8 ChannelPlan, RT_CHANNEL_INFO *channel_set) -+{ -+ struct registry_priv *regsty = adapter_to_regsty(padapter); -+ u8 index, chanset_size = 0; -+ u8 b5GBand = _FALSE, b2_4GBand = _FALSE; -+ u8 Index2G = 0, Index5G = 0; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ int i; -+ -+ if (!rtw_is_channel_plan_valid(ChannelPlan)) { -+ RTW_ERR("ChannelPlan ID 0x%02X error !!!!!\n", ChannelPlan); -+ return chanset_size; -+ } -+ -+ _rtw_memset(channel_set, 0, sizeof(RT_CHANNEL_INFO) * MAX_CHANNEL_NUM); -+ -+ if (IsSupported24G(padapter->registrypriv.wireless_mode)) -+ b2_4GBand = _TRUE; -+ -+ if (IsSupported5G(padapter->registrypriv.wireless_mode)) -+ b5GBand = _TRUE; -+ -+ if (b2_4GBand) { -+ if (RTW_CHPLAN_REALTEK_DEFINE == ChannelPlan) -+ Index2G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index2G; -+ else -+ Index2G = RTW_ChannelPlanMap[ChannelPlan].Index2G; -+ -+ for (index = 0; index < CH_LIST_LEN(RTW_ChannelPlan2G[Index2G]); index++) { -+ if (rtw_regsty_is_excl_chs(regsty, CH_LIST_CH(RTW_ChannelPlan2G[Index2G], index)) == _TRUE) -+ continue; -+ -+ channel_set[chanset_size].ChannelNum = CH_LIST_CH(RTW_ChannelPlan2G[Index2G], index); -+ -+ if (RTW_CHPLAN_GLOBAL_DOAMIN == ChannelPlan -+ || RTW_CHPLAN_GLOBAL_NULL == ChannelPlan -+ ) { -+ /* Channel 1~11 is active, and 12~14 is passive */ -+ if (channel_set[chanset_size].ChannelNum >= 1 && channel_set[chanset_size].ChannelNum <= 11) -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ else if ((channel_set[chanset_size].ChannelNum >= 12 && channel_set[chanset_size].ChannelNum <= 14)) -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ } else if (RTW_CHPLAN_WORLD_WIDE_13 == ChannelPlan -+ || RTW_CHPLAN_WORLD_WIDE_5G == ChannelPlan -+ || RTW_RD_2G_WORLD == Index2G -+ ) { -+ /* channel 12~13, passive scan */ -+ if (channel_set[chanset_size].ChannelNum <= 11) -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ else -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ } else -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ -+ chanset_size++; -+ } -+ } -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ if (b5GBand) { -+ if (RTW_CHPLAN_REALTEK_DEFINE == ChannelPlan) -+ Index5G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index5G; -+ else -+ Index5G = RTW_ChannelPlanMap[ChannelPlan].Index5G; -+ -+ for (index = 0; index < CH_LIST_LEN(RTW_ChannelPlan5G[Index5G]); index++) { -+ if (rtw_regsty_is_excl_chs(regsty, CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index)) == _TRUE) -+ continue; -+#ifdef CONFIG_DFS -+ channel_set[chanset_size].ChannelNum = CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index); -+ if (channel_set[chanset_size].ChannelNum <= 48 -+ || channel_set[chanset_size].ChannelNum >= 149 -+ ) { -+ if (RTW_CHPLAN_WORLD_WIDE_5G == ChannelPlan) /* passive scan for all 5G channels */ -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ else -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ } else -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ chanset_size++; -+#else /* CONFIG_DFS */ -+ if (CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index) <= 48 -+ || CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index) >= 149 -+ ) { -+ channel_set[chanset_size].ChannelNum = CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index); -+ if (RTW_CHPLAN_WORLD_WIDE_5G == ChannelPlan) /* passive scan for all 5G channels */ -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ else -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ chanset_size++; -+ } -+#endif /* CONFIG_DFS */ -+ } -+ } -+ -+ #ifdef CONFIG_DFS_MASTER -+ for (i = 0; i < chanset_size; i++) -+ channel_set[i].non_ocp_end_time = rtw_get_current_time(); -+ #endif -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ -+ if (RTW_CHPLAN_REALTEK_DEFINE == ChannelPlan) { -+ hal_data->Regulation2_4G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.regd; -+ hal_data->Regulation5G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.regd; -+ } else { -+ hal_data->Regulation2_4G = RTW_ChannelPlanMap[ChannelPlan].regd; -+ hal_data->Regulation5G = RTW_ChannelPlanMap[ChannelPlan].regd; -+ } -+ -+ RTW_INFO(FUNC_ADPT_FMT" ChannelPlan ID:0x%02x, ch num:%d\n" -+ , FUNC_ADPT_ARG(padapter), ChannelPlan, chanset_size); -+ -+ return chanset_size; -+} -+ -+int init_mlme_ext_priv(_adapter *padapter) -+{ -+ int res = _SUCCESS; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). */ -+ /* _rtw_memset((u8 *)pmlmeext, 0, sizeof(struct mlme_ext_priv)); */ -+ -+ pmlmeext->padapter = padapter; -+ -+ /* fill_fwpriv(padapter, &(pmlmeext->fwpriv)); */ -+ -+ init_mlme_ext_priv_value(padapter); -+ pmlmeinfo->bAcceptAddbaReq = pregistrypriv->bAcceptAddbaReq; -+ -+ init_mlme_ext_timer(padapter); -+ -+#ifdef CONFIG_AP_MODE -+ init_mlme_ap_info(padapter); -+#endif -+ -+ pmlmeext->max_chan_nums = init_channel_set(padapter, pmlmepriv->ChannelPlan, pmlmeext->channel_set); -+ init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); -+ pmlmeext->last_scan_time = 0; -+ pmlmeext->mlmeext_init = _TRUE; -+ -+ -+#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ pmlmeext->active_keep_alive_check = _TRUE; -+#else -+ pmlmeext->active_keep_alive_check = _FALSE; -+#endif -+ -+#ifdef DBG_FIXED_CHAN -+ pmlmeext->fixed_chan = 0xFF; -+#endif -+ -+ return res; -+ -+} -+ -+void free_mlme_ext_priv(struct mlme_ext_priv *pmlmeext) -+{ -+ _adapter *padapter = pmlmeext->padapter; -+ -+ if (!padapter) -+ return; -+ -+ if (rtw_is_drv_stopped(padapter)) { -+ _cancel_timer_ex(&pmlmeext->survey_timer); -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ /* _cancel_timer_ex(&pmlmeext->ADDBA_timer); */ -+ } -+} -+ -+static u8 cmp_pkt_chnl_diff(_adapter *padapter, u8 *pframe, uint packet_len) -+{ -+ /* if the channel is same, return 0. else return channel differential */ -+ uint len; -+ u8 channel; -+ u8 *p; -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_, _DSSET_IE_, &len, packet_len - _BEACON_IE_OFFSET_); -+ if (p) { -+ channel = *(p + 2); -+ if (padapter->mlmeextpriv.cur_channel >= channel) -+ return padapter->mlmeextpriv.cur_channel - channel; -+ else -+ return channel - padapter->mlmeextpriv.cur_channel; -+ } else -+ return 0; -+} -+ -+static void _mgt_dispatcher(_adapter *padapter, struct mlme_handler *ptable, union recv_frame *precv_frame) -+{ -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ -+ if (ptable->func) { -+ /* receive the frames that ra(a1) is my address or ra(a1) is bc address. */ -+ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_mac_addr(padapter), ETH_ALEN) && -+ !_rtw_memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) -+ return; -+ -+ ptable->func(padapter, precv_frame); -+ } -+ -+} -+ -+void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ int index; -+ struct mlme_handler *ptable; -+#ifdef CONFIG_AP_MODE -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#endif /* CONFIG_AP_MODE */ -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, GetAddr2Ptr(pframe)); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ -+#if 0 -+ { -+ u8 *pbuf; -+ pbuf = GetAddr1Ptr(pframe); -+ RTW_INFO("A1-%x:%x:%x:%x:%x:%x\n", *pbuf, *(pbuf + 1), *(pbuf + 2), *(pbuf + 3), *(pbuf + 4), *(pbuf + 5)); -+ pbuf = GetAddr2Ptr(pframe); -+ RTW_INFO("A2-%x:%x:%x:%x:%x:%x\n", *pbuf, *(pbuf + 1), *(pbuf + 2), *(pbuf + 3), *(pbuf + 4), *(pbuf + 5)); -+ pbuf = GetAddr3Ptr(pframe); -+ RTW_INFO("A3-%x:%x:%x:%x:%x:%x\n", *pbuf, *(pbuf + 1), *(pbuf + 2), *(pbuf + 3), *(pbuf + 4), *(pbuf + 5)); -+ } -+#endif -+ -+ if (GetFrameType(pframe) != WIFI_MGT_TYPE) { -+ return; -+ } -+ -+ /* receive the frames that ra(a1) is my address or ra(a1) is bc address. */ -+ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_mac_addr(padapter), ETH_ALEN) && -+ !_rtw_memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) -+ return; -+ -+ ptable = mlme_sta_tbl; -+ -+ index = GetFrameSubType(pframe) >> 4; -+ -+#ifdef CONFIG_TDLS -+ if ((index << 4) == WIFI_ACTION) { -+ /* category==public (4), action==TDLS_DISCOVERY_RESPONSE */ -+ if (*(pframe + 24) == RTW_WLAN_CATEGORY_PUBLIC && *(pframe + 25) == TDLS_DISCOVERY_RESPONSE) { -+ RTW_INFO("[TDLS] Recv %s from "MAC_FMT"\n", rtw_tdls_action_txt(TDLS_DISCOVERY_RESPONSE), MAC_ARG(GetAddr2Ptr(pframe))); -+ On_TDLS_Dis_Rsp(padapter, precv_frame); -+ } -+ } -+#endif /* CONFIG_TDLS */ -+ -+ if (index >= (sizeof(mlme_sta_tbl) / sizeof(struct mlme_handler))) { -+ return; -+ } -+ ptable += index; -+ -+#if 1 -+ if (psta != NULL) { -+ if (GetRetry(pframe)) { -+ if (precv_frame->u.hdr.attrib.seq_num == psta->RxMgmtFrameSeqNum) { -+ /* drop the duplicate management frame */ -+ pdbgpriv->dbg_rx_dup_mgt_frame_drop_count++; -+ RTW_INFO("Drop duplicate management frame with seq_num = %d.\n", precv_frame->u.hdr.attrib.seq_num); -+ return; -+ } -+ } -+ psta->RxMgmtFrameSeqNum = precv_frame->u.hdr.attrib.seq_num; -+ } -+#else -+ -+ if (GetRetry(pframe)) { -+ /* return; */ -+ } -+#endif -+ -+#ifdef CONFIG_AP_MODE -+ switch (GetFrameSubType(pframe)) { -+ case WIFI_AUTH: -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ ptable->func = &OnAuth; -+ else -+ ptable->func = &OnAuthClient; -+ /* pass through */ -+ case WIFI_ASSOCREQ: -+ case WIFI_REASSOCREQ: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+#ifdef CONFIG_HOSTAPD_MLME -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ rtw_hostapd_mlme_rx(padapter, precv_frame); -+#endif -+ break; -+ case WIFI_PROBEREQ: -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+#ifdef CONFIG_HOSTAPD_MLME -+ rtw_hostapd_mlme_rx(padapter, precv_frame); -+#else -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+#endif -+ } else -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ case WIFI_BEACON: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ case WIFI_ACTION: -+ /* if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) */ -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ default: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ rtw_hostapd_mlme_rx(padapter, precv_frame); -+ break; -+ } -+#else -+ -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ -+#endif -+ -+} -+ -+#ifdef CONFIG_P2P -+u32 p2p_listen_state_process(_adapter *padapter, unsigned char *da) -+{ -+ bool response = _TRUE; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) { -+ if (rtw_cfg80211_get_is_roch(padapter) == _FALSE -+ || rtw_get_oper_ch(padapter) != padapter->wdinfo.listen_channel -+ || adapter_wdev_data(padapter)->p2p_enabled == _FALSE -+ || padapter->mlmepriv.wps_probe_resp_ie == NULL -+ || padapter->mlmepriv.p2p_probe_resp_ie == NULL -+ ) { -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO(ADPT_FMT" DON'T issue_probersp_p2p: p2p_enabled:%d, wps_probe_resp_ie:%p, p2p_probe_resp_ie:%p\n" -+ , ADPT_ARG(padapter) -+ , adapter_wdev_data(padapter)->p2p_enabled -+ , padapter->mlmepriv.wps_probe_resp_ie -+ , padapter->mlmepriv.p2p_probe_resp_ie); -+ RTW_INFO(ADPT_FMT" DON'T issue_probersp_p2p: is_ro_ch:%d, op_ch:%d, p2p_listen_channel:%d\n" -+ , ADPT_ARG(padapter) -+ , rtw_cfg80211_get_is_roch(padapter) -+ , rtw_get_oper_ch(padapter) -+ , padapter->wdinfo.listen_channel); -+#endif -+ response = _FALSE; -+ } -+ } else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ if (padapter->wdinfo.driver_interface == DRIVER_WEXT) { -+ /* do nothing if the device name is empty */ -+ if (!padapter->wdinfo.device_name_len) -+ response = _FALSE; -+ } -+ -+ if (response == _TRUE) -+ issue_probersp_p2p(padapter, da); -+ -+ return _SUCCESS; -+} -+#endif /* CONFIG_P2P */ -+ -+ -+/**************************************************************************** -+ -+Following are the callback functions for each subtype of the management frames -+ -+*****************************************************************************/ -+ -+unsigned int OnProbeReq(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int ielen; -+ unsigned char *p; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur = &(pmlmeinfo->network); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ u8 is_valid_p2p_probereq = _FALSE; -+ -+#ifdef CONFIG_ATMEL_RC_PATCH -+ u8 *target_ie = NULL, *wps_ie = NULL; -+ u8 *start; -+ uint search_len = 0, wps_ielen = 0, target_ielen = 0; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+#endif -+ -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ u8 wifi_test_chk_rate = 1; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if ((pwdinfo->driver_interface == DRIVER_CFG80211) -+ && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) -+ && (GET_CFG80211_REPORT_MGMT(adapter_wdev_data(padapter), IEEE80211_STYPE_PROBE_REQ) == _TRUE) -+ ) { -+ rtw_cfg80211_rx_probe_request(padapter, precv_frame); -+ return _SUCCESS; -+ } -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && -+ !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE) && -+ !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && -+ !rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH) && -+ !rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) -+ ) { -+ /* Commented by Albert 2011/03/17 */ -+ /* mcs_rate = 0->CCK 1M rate */ -+ /* mcs_rate = 1->CCK 2M rate */ -+ /* mcs_rate = 2->CCK 5.5M rate */ -+ /* mcs_rate = 3->CCK 11M rate */ -+ /* In the P2P mode, the driver should not support the CCK rate */ -+ -+ /* Commented by Kurt 2012/10/16 */ -+ /* IOT issue: Google Nexus7 use 1M rate to send p2p_probe_req after GO nego completed and Nexus7 is client */ -+ if (padapter->registrypriv.wifi_spec == 1) { -+ if (pattrib->data_rate <= 3) -+ wifi_test_chk_rate = 0; -+ } -+ -+ if (wifi_test_chk_rate == 1) { -+ is_valid_p2p_probereq = process_probe_req_p2p_ie(pwdinfo, pframe, len); -+ if (is_valid_p2p_probereq == _TRUE) { -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE)) { -+ /* FIXME */ -+ if (padapter->wdinfo.driver_interface == DRIVER_WEXT) -+ report_survey_event(padapter, precv_frame); -+ -+ p2p_listen_state_process(padapter, get_sa(pframe)); -+ -+ return _SUCCESS; -+ } -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ goto _continue; -+ } -+ } -+ } -+ -+_continue: -+#endif /* CONFIG_P2P */ -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ return _SUCCESS; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE && -+ check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_AP_STATE) == _FALSE) -+ return _SUCCESS; -+ -+ -+ /* RTW_INFO("+OnProbeReq\n"); */ -+ -+ -+#ifdef CONFIG_ATMEL_RC_PATCH -+ wps_ie = rtw_get_wps_ie( -+ pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_, -+ NULL, &wps_ielen); -+ if (wps_ie) -+ target_ie = rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_MANUFACTURER, NULL, &target_ielen); -+ if ((target_ie && (target_ielen == 4)) && (_TRUE == _rtw_memcmp((void *)target_ie, "Ozmo", 4))) { -+ /* psta->flag_atmel_rc = 1; */ -+ unsigned char *sa_addr = get_sa(pframe); -+ printk("%s: Find Ozmo RC -- %02x:%02x:%02x:%02x:%02x:%02x \n\n", -+ __func__, *sa_addr, *(sa_addr + 1), *(sa_addr + 2), *(sa_addr + 3), *(sa_addr + 4), *(sa_addr + 5)); -+ _rtw_memcpy(pstapriv->atmel_rc_pattern, get_sa(pframe), ETH_ALEN); -+ } -+#endif -+ -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && -+ pmlmepriv->cur_network.join_res == _TRUE) { -+ _irqL irqL; -+ struct sta_info *psta; -+ u8 *mac_addr, *peer_addr; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 RC_OUI[4] = {0x00, 0xE0, 0x4C, 0x0A}; -+ /* EID[1] + EID_LEN[1] + RC_OUI[4] + MAC[6] + PairingID[2] + ChannelNum[2] */ -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, (int *)&ielen, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); -+ -+ if (!p || ielen != 14) -+ goto _non_rc_device; -+ -+ if (!_rtw_memcmp(p + 2, RC_OUI, sizeof(RC_OUI))) -+ goto _non_rc_device; -+ -+ if (!_rtw_memcmp(p + 6, get_sa(pframe), ETH_ALEN)) { -+ RTW_INFO("%s, do rc pairing ("MAC_FMT"), but mac addr mismatch!("MAC_FMT")\n", __FUNCTION__, -+ MAC_ARG(get_sa(pframe)), MAC_ARG(p + 6)); -+ -+ goto _non_rc_device; -+ } -+ -+ RTW_INFO("%s, got the pairing device("MAC_FMT")\n", __FUNCTION__, MAC_ARG(get_sa(pframe))); -+ -+ /* new a station */ -+ psta = rtw_get_stainfo(pstapriv, get_sa(pframe)); -+ if (psta == NULL) { -+ /* allocate a new one */ -+ RTW_INFO("going to alloc stainfo for rc="MAC_FMT"\n", MAC_ARG(get_sa(pframe))); -+ psta = rtw_alloc_stainfo(pstapriv, get_sa(pframe)); -+ if (psta == NULL) { -+ /* TODO: */ -+ RTW_INFO(" Exceed the upper limit of supported clients...\n"); -+ return _SUCCESS; -+ } -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&psta->asoc_list)) { -+ psta->expire_to = pstapriv->expire_to; -+ rtw_list_insert_tail(&psta->asoc_list, &pstapriv->asoc_list); -+ pstapriv->asoc_list_cnt++; -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ /* generate pairing ID */ -+ mac_addr = adapter_mac_addr(padapter); -+ peer_addr = psta->hwaddr; -+ psta->pid = (u16)(((mac_addr[4] << 8) + mac_addr[5]) + ((peer_addr[4] << 8) + peer_addr[5])); -+ -+ /* update peer stainfo */ -+ psta->isrc = _TRUE; -+ -+ /* get a unique AID */ -+ if (psta->aid > 0) -+ RTW_INFO("old AID %d\n", psta->aid); -+ else { -+ for (psta->aid = 1; psta->aid <= NUM_STA; psta->aid++) -+ if (pstapriv->sta_aid[psta->aid - 1] == NULL) -+ break; -+ -+ if (psta->aid > pstapriv->max_num_sta) { -+ psta->aid = 0; -+ RTW_INFO("no room for more AIDs\n"); -+ return _SUCCESS; -+ } else { -+ pstapriv->sta_aid[psta->aid - 1] = psta; -+ RTW_INFO("allocate new AID = (%d)\n", psta->aid); -+ } -+ } -+ -+ psta->qos_option = 1; -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ psta->ieee8021x_blocked = _FALSE; -+#ifdef CONFIG_80211N_HT -+ psta->htpriv.ht_option = _TRUE; -+ psta->htpriv.ampdu_enable = _FALSE; -+ psta->htpriv.sgi_20m = _FALSE; -+ psta->htpriv.sgi_40m = _FALSE; -+ psta->htpriv.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ -+ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ -+#endif -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); -+ -+ _rtw_memset((void *)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state |= _FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ report_add_sta_event(padapter, psta->hwaddr); -+ -+ } -+ -+ issue_probersp(padapter, get_sa(pframe), _FALSE); -+ -+ return _SUCCESS; -+ -+ } -+ -+_non_rc_device: -+ -+ return _SUCCESS; -+ -+#endif /* CONFIG_AUTO_AP_MODE */ -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) && -+ rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING | _FW_UNDER_SURVEY)) { -+ /* don't process probe req */ -+ return _SUCCESS; -+ } -+#endif -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _SSID_IE_, (int *)&ielen, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); -+ -+ -+ /* check (wildcard) SSID */ -+ if (p != NULL) { -+ if (is_valid_p2p_probereq == _TRUE) -+ goto _issue_probersp; -+ -+ if ((ielen != 0 && _FALSE == _rtw_memcmp((void *)(p + 2), (void *)cur->Ssid.Ssid, cur->Ssid.SsidLength)) -+ || (ielen == 0 && pmlmeinfo->hidden_ssid_mode) -+ ) -+ return _SUCCESS; -+ -+_issue_probersp: -+ if (((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && -+ pmlmepriv->cur_network.join_res == _TRUE)) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) { -+ /* RTW_INFO("+issue_probersp during ap mode\n"); */ -+ issue_probersp(padapter, get_sa(pframe), is_valid_p2p_probereq); -+ } -+ -+ } -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnProbeRsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct sta_info *psta; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif -+ -+ -+#ifdef CONFIG_P2P -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) { -+ if (_TRUE == pwdinfo->tx_prov_disc_info.benable) { -+ if (_rtw_memcmp(pwdinfo->tx_prov_disc_info.peerIFAddr, GetAddr2Ptr(pframe), ETH_ALEN)) { -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { -+ pwdinfo->tx_prov_disc_info.benable = _FALSE; -+ issue_p2p_provision_request(padapter, -+ pwdinfo->tx_prov_disc_info.ssid.Ssid, -+ pwdinfo->tx_prov_disc_info.ssid.SsidLength, -+ pwdinfo->tx_prov_disc_info.peerDevAddr); -+ } else if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ pwdinfo->tx_prov_disc_info.benable = _FALSE; -+ issue_p2p_provision_request(padapter, -+ NULL, -+ 0, -+ pwdinfo->tx_prov_disc_info.peerDevAddr); -+ } -+ } -+ } -+ return _SUCCESS; -+ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) { -+ if (_TRUE == pwdinfo->nego_req_info.benable) { -+ RTW_INFO("[%s] P2P State is GONEGO ING!\n", __FUNCTION__); -+ if (_rtw_memcmp(pwdinfo->nego_req_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN)) { -+ pwdinfo->nego_req_info.benable = _FALSE; -+ issue_p2p_GO_request(padapter, pwdinfo->nego_req_info.peerDevAddr); -+ } -+ } -+ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ)) { -+ if (_TRUE == pwdinfo->invitereq_info.benable) { -+ RTW_INFO("[%s] P2P_STATE_TX_INVITE_REQ!\n", __FUNCTION__); -+ if (_rtw_memcmp(pwdinfo->invitereq_info.peer_macaddr, GetAddr2Ptr(pframe), ETH_ALEN)) { -+ pwdinfo->invitereq_info.benable = _FALSE; -+ issue_p2p_invitation_request(padapter, pwdinfo->invitereq_info.peer_macaddr); -+ } -+ } -+ } -+#endif -+ -+ -+ if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS)) { -+ rtw_mi_report_survey_event(padapter, precv_frame); -+ return _SUCCESS; -+ } -+ -+#if 0 /* move to validate_recv_mgnt_frame */ -+ if (_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN)) { -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta != NULL) -+ psta->sta_stats.rx_mgnt_pkts++; -+ } -+ } -+#endif -+ -+ return _SUCCESS; -+ -+} -+ -+/* for 11n Logo 4.2.31/4.2.32 */ -+static void rtw_check_legacy_ap(_adapter *padapter, u8 *pframe, u32 len) -+{ -+ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (!padapter->registrypriv.wifi_spec) -+ return; -+ -+ if(!MLME_IS_AP(padapter)) -+ return; -+ -+#ifdef CONFIG_AP_MODE -+ if (pmlmeext->bstart_bss == _TRUE) { -+ int left; -+ u16 capability; -+ unsigned char *pos; -+ struct rtw_ieee802_11_elems elems; -+ struct HT_info_element *pht_info = NULL; -+ u16 cur_op_mode; -+ -+ /* checking IEs */ -+ left = len - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_; -+ pos = pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_; -+ if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed) { -+ RTW_INFO("%s: parse fail for "MAC_FMT"\n", __func__, MAC_ARG(GetAddr3Ptr(pframe))); -+ return; -+ } -+ -+#ifdef CONFIG_80211N_HT -+ cur_op_mode = pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_OP_MODE_MASK; -+#endif -+ -+ /* for legacy ap */ -+ if (elems.ht_capabilities == NULL && elems.ht_capabilities_len == 0) { -+ -+ if (0) -+ RTW_INFO("%s: "MAC_FMT" is legacy ap\n", __func__, MAC_ARG(GetAddr3Ptr(pframe))); -+ -+ ATOMIC_SET(&pmlmepriv->olbc, _TRUE); -+ ATOMIC_SET(&pmlmepriv->olbc_ht, _TRUE); -+ } -+ -+ } -+#endif -+} -+ -+unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct sta_info *psta; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ WLAN_BSSID_EX *pbss; -+ int ret = _SUCCESS; -+ u8 *p = NULL; -+ u32 ielen = 0; -+#ifdef CONFIG_TDLS -+ struct sta_info *ptdls_sta; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+#ifdef CONFIG_TDLS_CH_SW -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+#endif -+#endif /* CONFIG_TDLS */ -+ -+#ifdef CONFIG_ATTEMPT_TO_FIX_AP_BEACON_ERROR -+ p = rtw_get_ie(pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ielen, -+ precv_frame->u.hdr.len - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_); -+ if ((p != NULL) && (ielen > 0)) { -+ if ((*(p + 1 + ielen) == 0x2D) && (*(p + 2 + ielen) != 0x2D)) { -+ /* Invalid value 0x2D is detected in Extended Supported Rates (ESR) IE. Try to fix the IE length to avoid failed Beacon parsing. */ -+ RTW_INFO("[WIFIDBG] Error in ESR IE is detected in Beacon of BSSID:"MAC_FMT". Fix the length of ESR IE to avoid failed Beacon parsing.\n", MAC_ARG(GetAddr3Ptr(pframe))); -+ *(p + 1) = ielen - 1; -+ } -+ } -+#endif -+ -+ if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS)) { -+ rtw_mi_report_survey_event(padapter, precv_frame); -+ return _SUCCESS; -+ } -+ -+ -+ rtw_check_legacy_ap(padapter, pframe, len); -+ -+ if (_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN)) { -+ if (pmlmeinfo->state & WIFI_FW_AUTH_NULL) { -+ /* we should update current network before auth, or some IE is wrong */ -+ pbss = (WLAN_BSSID_EX *)rtw_malloc(sizeof(WLAN_BSSID_EX)); -+ if (pbss) { -+ if (collect_bss_info(padapter, precv_frame, pbss) == _SUCCESS) { -+ struct beacon_keys recv_beacon; -+ -+ update_network(&(pmlmepriv->cur_network.network), pbss, padapter, _TRUE); -+ rtw_get_bcn_info(&(pmlmepriv->cur_network)); -+ -+ /* update bcn keys */ -+ if (rtw_get_bcn_keys(padapter, pframe, len, &recv_beacon) == _TRUE) { -+ RTW_INFO("%s: beacon keys ready\n", __func__); -+ _rtw_memcpy(&pmlmepriv->cur_beacon_keys, -+ &recv_beacon, sizeof(recv_beacon)); -+ pmlmepriv->new_beacon_cnts = 0; -+ } else { -+ RTW_ERR("%s: get beacon keys failed\n", __func__); -+ _rtw_memset(&pmlmepriv->cur_beacon_keys, 0, sizeof(recv_beacon)); -+ pmlmepriv->new_beacon_cnts = 0; -+ } -+ } -+ rtw_mfree((u8 *)pbss, sizeof(WLAN_BSSID_EX)); -+ } -+ -+ /* check the vendor of the assoc AP */ -+ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pframe + sizeof(struct rtw_ieee80211_hdr_3addr), len - sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ /* update TSF Value */ -+ update_TSF(pmlmeext, pframe, len); -+ -+ /* reset for adaptive_early_32k */ -+ pmlmeext->adaptive_tsf_done = _FALSE; -+ pmlmeext->DrvBcnEarly = 0xff; -+ pmlmeext->DrvBcnTimeOut = 0xff; -+ pmlmeext->bcn_cnt = 0; -+ _rtw_memset(pmlmeext->bcn_delay_cnt, 0, sizeof(pmlmeext->bcn_delay_cnt)); -+ _rtw_memset(pmlmeext->bcn_delay_ratio, 0, sizeof(pmlmeext->bcn_delay_ratio)); -+ -+#ifdef CONFIG_P2P_PS -+ process_p2p_ps_ie(padapter, (pframe + WLAN_HDR_A3_LEN), (len - WLAN_HDR_A3_LEN)); -+#endif /* CONFIG_P2P_PS */ -+ -+#if defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE) -+ if (padapter->registrypriv.wifi_spec) { -+ if (process_p2p_cross_connect_ie(padapter, (pframe + WLAN_HDR_A3_LEN), (len - WLAN_HDR_A3_LEN)) == _FALSE) { -+ if (rtw_mi_buddy_check_mlmeinfo_state(padapter, WIFI_FW_AP_STATE)) { -+ RTW_PRINT("no issue auth, P2P cross-connect does not permit\n "); -+ return _SUCCESS; -+ } -+ } -+ } -+#endif /* CONFIG_P2P CONFIG_P2P and CONFIG_CONCURRENT_MODE */ -+ -+ /* start auth */ -+ start_clnt_auth(padapter); -+ -+ return _SUCCESS; -+ } -+ -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) && (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta != NULL) { -+#ifdef CONFIG_PATCH_JOIN_WRONG_CHANNEL -+ /* Merge from 8712 FW code */ -+ if (cmp_pkt_chnl_diff(padapter, pframe, len) != 0) { -+ /* join wrong channel, deauth and reconnect */ -+ issue_deauth(padapter, (&(pmlmeinfo->network))->MacAddress, WLAN_REASON_DEAUTH_LEAVING); -+ -+ report_del_sta_event(padapter, (&(pmlmeinfo->network))->MacAddress, WLAN_REASON_JOIN_WRONG_CHANNEL, _TRUE, _FALSE); -+ pmlmeinfo->state &= (~WIFI_FW_ASSOC_SUCCESS); -+ return _SUCCESS; -+ } -+#endif /* CONFIG_PATCH_JOIN_WRONG_CHANNEL */ -+ -+ ret = rtw_check_bcn_info(padapter, pframe, len); -+ if (!ret) { -+ RTW_PRINT("ap has changed, disconnect now\n "); -+ receive_disconnect(padapter, pmlmeinfo->network.MacAddress , 0, _FALSE); -+ return _SUCCESS; -+ } -+ /* update WMM, ERP in the beacon */ -+ /* todo: the timer is used instead of the number of the beacon received */ -+ if ((sta_rx_pkts(psta) & 0xf) == 0) { -+ /* RTW_INFO("update_bcn_info\n"); */ -+ update_beacon_info(padapter, pframe, len, psta); -+ } -+ -+ pmlmepriv->cur_network_scanned->network.Rssi = precv_frame->u.hdr.attrib.phy_info.RecvSignalPower; -+ -+ adaptive_early_32k(pmlmeext, pframe, len); -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ if (rtw_tdls_is_chsw_allowed(padapter) == _TRUE) { -+ /* Send TDLS Channel Switch Request when receiving Beacon */ -+ if ((padapter->tdlsinfo.chsw_info.ch_sw_state & TDLS_CH_SW_INITIATOR_STATE) && (ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) -+ && (pmlmeext->cur_channel == rtw_get_oper_ch(padapter))) { -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, padapter->tdlsinfo.chsw_info.addr); -+ if (ptdls_sta != NULL) { -+ if (ptdls_sta->tdls_sta_state | TDLS_LINKED_STATE) -+ _set_timer(&ptdls_sta->stay_on_base_chnl_timer, TDLS_CH_SW_STAY_ON_BASE_CHNL_TIMEOUT); -+ } -+ } -+ } -+#endif -+#endif /* CONFIG_TDLS */ -+ -+#ifdef CONFIG_DFS -+ process_csa_ie(padapter, pframe, len); /* channel switch announcement */ -+#endif /* CONFIG_DFS */ -+ -+#ifdef CONFIG_P2P_PS -+ process_p2p_ps_ie(padapter, (pframe + WLAN_HDR_A3_LEN), (len - WLAN_HDR_A3_LEN)); -+#endif /* CONFIG_P2P_PS */ -+ -+ if (pmlmeext->en_hw_update_tsf) -+ rtw_enable_hw_update_tsf_cmd(padapter); -+ -+#if 0 /* move to validate_recv_mgnt_frame */ -+ psta->sta_stats.rx_mgnt_pkts++; -+#endif -+ } -+ -+ } else if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { -+ _irqL irqL; -+ u8 rate_set[16]; -+ u8 rate_num = 0; -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta != NULL) { -+ /* -+ * update WMM, ERP in the beacon -+ * todo: the timer is used instead of the number of the beacon received -+ */ -+ if ((sta_rx_pkts(psta) & 0xf) == 0) -+ update_beacon_info(padapter, pframe, len, psta); -+ -+ if (pmlmeext->en_hw_update_tsf) -+ rtw_enable_hw_update_tsf_cmd(padapter); -+ } else { -+ rtw_ies_get_supported_rate(pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_, len - WLAN_HDR_A3_LEN - _BEACON_IE_OFFSET_, rate_set, &rate_num); -+ if (rate_num == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" RX beacon with no supported rate\n", FUNC_ADPT_ARG(padapter)); -+ goto _END_ONBEACON_; -+ } -+ -+ psta = rtw_alloc_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta == NULL) { -+ RTW_INFO(FUNC_ADPT_FMT" Exceed the upper limit of supported clients\n", FUNC_ADPT_ARG(padapter)); -+ goto _END_ONBEACON_; -+ } -+ -+ psta->expire_to = pstapriv->adhoc_expire_to; -+ -+ _rtw_memcpy(psta->bssrateset, rate_set, rate_num); -+ psta->bssratelen = rate_num; -+ -+ /* update TSF Value */ -+ update_TSF(pmlmeext, pframe, len); -+ -+ /* report sta add event */ -+ report_add_sta_event(padapter, GetAddr2Ptr(pframe)); -+ } -+ } -+ } -+ -+_END_ONBEACON_: -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnAuth(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_AP_MODE -+ _irqL irqL; -+ unsigned int auth_mode, seq, ie_len; -+ unsigned char *sa, *p; -+ u16 algorithm; -+ int status; -+ static struct sta_info stat; -+ struct sta_info *pstat = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ u8 offset = 0; -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) && -+ rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING | _FW_UNDER_SURVEY)) { -+ /* don't process auth request; */ -+ return _SUCCESS; -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) -+ return _FAIL; -+ -+ RTW_INFO("+OnAuth\n"); -+ -+ sa = GetAddr2Ptr(pframe); -+ -+ auth_mode = psecuritypriv->dot11AuthAlgrthm; -+ -+ if (GetPrivacy(pframe)) { -+ u8 *iv; -+ struct rx_pkt_attrib *prxattrib = &(precv_frame->u.hdr.attrib); -+ -+ prxattrib->hdrlen = WLAN_HDR_A3_LEN; -+ prxattrib->encrypt = _WEP40_; -+ -+ iv = pframe + prxattrib->hdrlen; -+ prxattrib->key_index = ((iv[3] >> 6) & 0x3); -+ -+ prxattrib->iv_len = 4; -+ prxattrib->icv_len = 4; -+ -+ rtw_wep_decrypt(padapter, (u8 *)precv_frame); -+ -+ offset = 4; -+ } -+ -+ algorithm = le16_to_cpu(*(u16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset)); -+ seq = le16_to_cpu(*(u16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 2)); -+ -+ RTW_INFO("auth alg=%x, seq=%X\n", algorithm, seq); -+ -+ if (auth_mode == 2 && -+ psecuritypriv->dot11PrivacyAlgrthm != _WEP40_ && -+ psecuritypriv->dot11PrivacyAlgrthm != _WEP104_) -+ auth_mode = 0; -+ -+ if ((algorithm > 0 && auth_mode == 0) || /* rx a shared-key auth but shared not enabled */ -+ (algorithm == 0 && auth_mode == 1)) { /* rx a open-system auth but shared-key is enabled */ -+ RTW_INFO("auth rejected due to bad alg [alg=%d, auth_mib=%d] %02X%02X%02X%02X%02X%02X\n", -+ algorithm, auth_mode, sa[0], sa[1], sa[2], sa[3], sa[4], sa[5]); -+ -+ status = _STATS_NO_SUPP_ALG_; -+ -+ goto auth_fail; -+ } -+ -+#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) -+ if (rtw_access_ctrl(padapter, sa) == _FALSE) { -+ status = _STATS_UNABLE_HANDLE_STA_; -+ goto auth_fail; -+ } -+#endif -+ -+ pstat = rtw_get_stainfo(pstapriv, sa); -+ if (pstat == NULL) { -+ -+ /* allocate a new one */ -+ RTW_INFO("going to alloc stainfo for sa="MAC_FMT"\n", MAC_ARG(sa)); -+ pstat = rtw_alloc_stainfo(pstapriv, sa); -+ if (pstat == NULL) { -+ RTW_INFO(" Exceed the upper limit of supported clients...\n"); -+ status = _STATS_UNABLE_HANDLE_STA_; -+ goto auth_fail; -+ } -+ -+ pstat->state = WIFI_FW_AUTH_NULL; -+ pstat->auth_seq = 0; -+ -+ /* pstat->flags = 0; */ -+ /* pstat->capability = 0; */ -+ } else { -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&pstat->asoc_list) == _FALSE) { -+ rtw_list_delete(&pstat->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ if (pstat->expire_to > 0) -+ ;/* TODO: STA re_auth within expire_to */ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ if (seq == 1) -+ ; /* TODO: STA re_auth and auth timeout */ -+ -+ } -+ } -+ -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ if (rtw_is_list_empty(&pstat->auth_list)) { -+ -+ rtw_list_insert_tail(&pstat->auth_list, &pstapriv->auth_list); -+ pstapriv->auth_list_cnt++; -+ } -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ } -+ -+ if (pstat->auth_seq == 0) -+ pstat->expire_to = pstapriv->auth_to; -+ -+ -+ if ((pstat->auth_seq + 1) != seq) { -+ RTW_INFO("(1)auth rejected because out of seq [rx_seq=%d, exp_seq=%d]!\n", -+ seq, pstat->auth_seq + 1); -+ status = _STATS_OUT_OF_AUTH_SEQ_; -+ goto auth_fail; -+ } -+ -+ if (algorithm == 0 && (auth_mode == 0 || auth_mode == 2 || auth_mode == 3)) { -+ if (seq == 1) { -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ pstat->state &= ~WIFI_FW_AUTH_NULL; -+ pstat->state |= WIFI_FW_AUTH_SUCCESS; -+ pstat->expire_to = pstapriv->assoc_to; -+ } -+ pstat->authalg = algorithm; -+ } else { -+ RTW_INFO("(2)auth rejected because out of seq [rx_seq=%d, exp_seq=%d]!\n", -+ seq, pstat->auth_seq + 1); -+ status = _STATS_OUT_OF_AUTH_SEQ_; -+ goto auth_fail; -+ } -+ } else { /* shared system or auto authentication */ -+ if (seq == 1) { -+ /* prepare for the challenging txt... */ -+ -+ /* get_random_bytes((void *)pstat->chg_txt, 128); */ /* TODO: */ -+ _rtw_memset((void *)pstat->chg_txt, 78, 128); -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ pstat->state &= ~WIFI_FW_AUTH_NULL; -+ pstat->state |= WIFI_FW_AUTH_STATE; -+ } -+ pstat->authalg = algorithm; -+ pstat->auth_seq = 2; -+ } else if (seq == 3) { -+ /* checking for challenging txt... */ -+ RTW_INFO("checking for challenging txt...\n"); -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + 4 + _AUTH_IE_OFFSET_ , _CHLGETXT_IE_, (int *)&ie_len, -+ len - WLAN_HDR_A3_LEN - _AUTH_IE_OFFSET_ - 4); -+ -+ if ((p == NULL) || (ie_len <= 0)) { -+ RTW_INFO("auth rejected because challenge failure!(1)\n"); -+ status = _STATS_CHALLENGE_FAIL_; -+ goto auth_fail; -+ } -+ -+ if (_rtw_memcmp((void *)(p + 2), pstat->chg_txt, 128)) { -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE && !(pstat->state & WIFI_FW_ASSOC_SUCCESS)) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ pstat->state &= (~WIFI_FW_AUTH_STATE); -+ pstat->state |= WIFI_FW_AUTH_SUCCESS; -+ /* challenging txt is correct... */ -+ pstat->expire_to = pstapriv->assoc_to; -+ } -+ } else { -+ RTW_INFO("auth rejected because challenge failure!\n"); -+ status = _STATS_CHALLENGE_FAIL_; -+ goto auth_fail; -+ } -+ } else { -+ RTW_INFO("(3)auth rejected because out of seq [rx_seq=%d, exp_seq=%d]!\n", -+ seq, pstat->auth_seq + 1); -+ status = _STATS_OUT_OF_AUTH_SEQ_; -+ goto auth_fail; -+ } -+ } -+ -+ -+ /* Now, we are going to issue_auth... */ -+ pstat->auth_seq = seq + 1; -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ issue_auth(padapter, pstat, (unsigned short)(_STATS_SUCCESSFUL_)); -+#endif -+ -+ if ((pstat->state & WIFI_FW_AUTH_SUCCESS) || (pstat->state & WIFI_FW_ASSOC_SUCCESS)) -+ pstat->auth_seq = 0; -+ -+ -+ return _SUCCESS; -+ -+auth_fail: -+ -+ if (pstat) -+ rtw_free_stainfo(padapter , pstat); -+ -+ pstat = &stat; -+ _rtw_memset((char *)pstat, '\0', sizeof(stat)); -+ pstat->auth_seq = 2; -+ _rtw_memcpy(pstat->hwaddr, sa, 6); -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ issue_auth(padapter, pstat, (unsigned short)status); -+#endif -+ -+#endif -+ return _FAIL; -+ -+} -+ -+unsigned int OnAuthClient(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int seq, len, status, algthm, offset; -+ unsigned char *p; -+ unsigned int go2asoc = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+#ifdef CONFIG_RTW_80211R -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ ft_priv *pftpriv = &pmlmepriv->ftpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+#endif -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint pkt_len = precv_frame->u.hdr.len; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ /* check A1 matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), get_da(pframe), ETH_ALEN)) -+ return _SUCCESS; -+ -+ if (!(pmlmeinfo->state & WIFI_FW_AUTH_STATE)) -+ return _SUCCESS; -+ -+ offset = (GetPrivacy(pframe)) ? 4 : 0; -+ -+ algthm = le16_to_cpu(*(unsigned short *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset)); -+ seq = le16_to_cpu(*(unsigned short *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 2)); -+ status = le16_to_cpu(*(unsigned short *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 4)); -+ -+ if (status != 0) { -+ RTW_INFO("clnt auth fail, status: %d\n", status); -+ if (status == 13) { /* && pmlmeinfo->auth_algo == dot11AuthAlgrthm_Auto) */ -+ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) -+ pmlmeinfo->auth_algo = dot11AuthAlgrthm_Open; -+ else -+ pmlmeinfo->auth_algo = dot11AuthAlgrthm_Shared; -+ /* pmlmeinfo->reauth_count = 0; */ -+ } -+ -+ set_link_timer(pmlmeext, 1); -+ goto authclnt_fail; -+ } -+ -+ if (seq == 2) { -+ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) { -+ /* legendary shared system */ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _AUTH_IE_OFFSET_, _CHLGETXT_IE_, (int *)&len, -+ pkt_len - WLAN_HDR_A3_LEN - _AUTH_IE_OFFSET_); -+ -+ if (p == NULL) { -+ /* RTW_INFO("marc: no challenge text?\n"); */ -+ goto authclnt_fail; -+ } -+ -+ _rtw_memcpy((void *)(pmlmeinfo->chg_txt), (void *)(p + 2), len); -+ pmlmeinfo->auth_seq = 3; -+ issue_auth(padapter, NULL, 0); -+ set_link_timer(pmlmeext, REAUTH_TO); -+ -+ return _SUCCESS; -+ } else { -+ /* open, or 802.11r FTAA system */ -+ go2asoc = 1; -+ } -+ } else if (seq == 4) { -+ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) -+ go2asoc = 1; -+ else -+ goto authclnt_fail; -+ } else { -+ /* this is also illegal */ -+ /* RTW_INFO("marc: clnt auth failed due to illegal seq=%x\n", seq); */ -+ goto authclnt_fail; -+ } -+ -+ if (go2asoc) { -+#ifdef CONFIG_RTW_80211R -+ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { -+ u8 target_ap_addr[ETH_ALEN] = {0}; -+ -+ if ((rtw_chk_ft_status(padapter, RTW_FT_AUTHENTICATED_STA)) || -+ (rtw_chk_ft_status(padapter, RTW_FT_ASSOCIATING_STA)) || -+ (rtw_chk_ft_status(padapter, RTW_FT_ASSOCIATED_STA))) { -+ /*report_ft_reassoc_event already, and waiting for cfg80211_rtw_update_ft_ies*/ -+ return _SUCCESS; -+ } -+ -+ rtw_buf_update(&pmlmepriv->auth_rsp, &pmlmepriv->auth_rsp_len, pframe, pkt_len); -+ pftpriv->ft_event.ies = pmlmepriv->auth_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6; -+ pftpriv->ft_event.ies_len = pmlmepriv->auth_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6; -+ -+ /*Not support RIC*/ -+ pftpriv->ft_event.ric_ies = NULL; -+ pftpriv->ft_event.ric_ies_len = 0; -+ _rtw_memcpy(target_ap_addr, pmlmepriv->assoc_bssid, ETH_ALEN); -+ report_ft_reassoc_event(padapter, target_ap_addr); -+ return _SUCCESS; -+ } -+#endif -+ -+ RTW_PRINT("auth success, start assoc\n"); -+ start_clnt_assoc(padapter); -+ return _SUCCESS; -+ } -+ -+authclnt_fail: -+ -+ /* pmlmeinfo->state &= ~(WIFI_FW_AUTH_STATE); */ -+ -+ return _FAIL; -+ -+} -+ -+unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_AP_MODE -+ _irqL irqL; -+ u16 capab_info, listen_interval; -+ struct rtw_ieee802_11_elems elems; -+ struct sta_info *pstat; -+ unsigned char reassoc, *p, *pos, *wpa_ie; -+ unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01}; -+ int i, ie_len, wpa_ie_len, left; -+ u8 rate_set[16]; -+ u8 rate_num; -+ unsigned short status = _STATS_SUCCESSFUL_; -+ unsigned short frame_type, ie_offset = 0; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur = &(pmlmeinfo->network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint pkt_len = precv_frame->u.hdr.len; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 p2p_status_code = P2P_STATUS_SUCCESS; -+ u8 *p2pie; -+ u32 p2pielen = 0; -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) && -+ rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING | _FW_UNDER_SURVEY)) { -+ /* don't process assoc request; */ -+ return _SUCCESS; -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) -+ return _FAIL; -+ -+ frame_type = GetFrameSubType(pframe); -+ if (frame_type == WIFI_ASSOCREQ) { -+ reassoc = 0; -+ ie_offset = _ASOCREQ_IE_OFFSET_; -+ } else { /* WIFI_REASSOCREQ */ -+ reassoc = 1; -+ ie_offset = _REASOCREQ_IE_OFFSET_; -+ } -+ -+ -+ if (pkt_len < IEEE80211_3ADDR_LEN + ie_offset) { -+ RTW_INFO("handle_assoc(reassoc=%d) - too short payload (len=%lu)" -+ "\n", reassoc, (unsigned long)pkt_len); -+ return _FAIL; -+ } -+ -+ pstat = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (pstat == (struct sta_info *)NULL) { -+ status = _RSON_CLS2_; -+ goto asoc_class2_error; -+ } -+ -+ capab_info = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN); -+ /* capab_info = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); */ -+ /* listen_interval = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN+2)); */ -+ listen_interval = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN + 2); -+ -+ left = pkt_len - (IEEE80211_3ADDR_LEN + ie_offset); -+ pos = pframe + (IEEE80211_3ADDR_LEN + ie_offset); -+ -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ /* check if this stat has been successfully authenticated/assocated */ -+ if (!((pstat->state) & WIFI_FW_AUTH_SUCCESS)) { -+ if (!((pstat->state) & WIFI_FW_ASSOC_SUCCESS)) { -+ status = _RSON_CLS2_; -+ goto asoc_class2_error; -+ } else { -+ pstat->state &= (~WIFI_FW_ASSOC_SUCCESS); -+ pstat->state |= WIFI_FW_ASSOC_STATE; -+ } -+ } else { -+ pstat->state &= (~WIFI_FW_AUTH_SUCCESS); -+ pstat->state |= WIFI_FW_ASSOC_STATE; -+ } -+ -+ -+#if 0/* todo:tkip_countermeasures */ -+ if (hapd->tkip_countermeasures) { -+ resp = WLAN_REASON_MICHAEL_MIC_FAILURE; -+ goto fail; -+ } -+#endif -+ -+ pstat->capability = capab_info; -+ -+#if 0/* todo: */ -+ /* check listen_interval */ -+ if (listen_interval > hapd->conf->max_listen_interval) { -+ hostapd_logger(hapd, mgmt->sa, HOSTAPD_MODULE_IEEE80211, -+ HOSTAPD_LEVEL_DEBUG, -+ "Too large Listen Interval (%d)", -+ listen_interval); -+ resp = WLAN_STATUS_ASSOC_DENIED_LISTEN_INT_TOO_LARGE; -+ goto fail; -+ } -+ -+ pstat->listen_interval = listen_interval; -+#endif -+ -+ /* now parse all ieee802_11 ie to point to elems */ -+ if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed || -+ !elems.ssid) { -+ RTW_INFO("STA " MAC_FMT " sent invalid association request\n", -+ MAC_ARG(pstat->hwaddr)); -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } -+ -+ -+ /* now we should check all the fields... */ -+ /* checking SSID */ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + ie_offset, _SSID_IE_, &ie_len, -+ pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ if (p == NULL) -+ status = _STATS_FAILURE_; -+ -+ if (ie_len == 0) /* broadcast ssid, however it is not allowed in assocreq */ -+ status = _STATS_FAILURE_; -+ else { -+ /* check if ssid match */ -+ if (!_rtw_memcmp((void *)(p + 2), cur->Ssid.Ssid, cur->Ssid.SsidLength)) -+ status = _STATS_FAILURE_; -+ -+ if (ie_len != cur->Ssid.SsidLength) -+ status = _STATS_FAILURE_; -+ } -+ -+ if (_STATS_SUCCESSFUL_ != status) -+ goto OnAssocReqFail; -+ -+ rtw_ies_get_supported_rate(pframe + WLAN_HDR_A3_LEN + ie_offset, pkt_len - WLAN_HDR_A3_LEN - ie_offset, rate_set, &rate_num); -+ if (rate_num == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" RX assoc-req with no supported rate\n", FUNC_ADPT_ARG(padapter)); -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } -+ _rtw_memcpy(pstat->bssrateset, rate_set, rate_num); -+ pstat->bssratelen = rate_num; -+ UpdateBrateTblForSoftAP(pstat->bssrateset, pstat->bssratelen); -+ -+ /* check RSN/WPA/WPS */ -+ pstat->dot8021xalg = 0; -+ pstat->wpa_psk = 0; -+ pstat->wpa_group_cipher = 0; -+ pstat->wpa2_group_cipher = 0; -+ pstat->wpa_pairwise_cipher = 0; -+ pstat->wpa2_pairwise_cipher = 0; -+ _rtw_memset(pstat->wpa_ie, 0, sizeof(pstat->wpa_ie)); -+ if ((psecuritypriv->wpa_psk & BIT(1)) && elems.rsn_ie) { -+ -+ int group_cipher = 0, pairwise_cipher = 0; -+ -+ wpa_ie = elems.rsn_ie; -+ wpa_ie_len = elems.rsn_ie_len; -+ -+ if (rtw_parse_wpa2_ie(wpa_ie - 2, wpa_ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { -+ pstat->dot8021xalg = 1;/* psk, todo:802.1x */ -+ pstat->wpa_psk |= BIT(1); -+ -+ pstat->wpa2_group_cipher = group_cipher & psecuritypriv->wpa2_group_cipher; -+ pstat->wpa2_pairwise_cipher = pairwise_cipher & psecuritypriv->wpa2_pairwise_cipher; -+ -+ if (!pstat->wpa2_group_cipher) -+ status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; -+ -+ if (!pstat->wpa2_pairwise_cipher) -+ status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; -+ } else -+ status = WLAN_STATUS_INVALID_IE; -+ -+ } else if ((psecuritypriv->wpa_psk & BIT(0)) && elems.wpa_ie) { -+ -+ int group_cipher = 0, pairwise_cipher = 0; -+ -+ wpa_ie = elems.wpa_ie; -+ wpa_ie_len = elems.wpa_ie_len; -+ -+ if (rtw_parse_wpa_ie(wpa_ie - 2, wpa_ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { -+ pstat->dot8021xalg = 1;/* psk, todo:802.1x */ -+ pstat->wpa_psk |= BIT(0); -+ -+ pstat->wpa_group_cipher = group_cipher & psecuritypriv->wpa_group_cipher; -+ pstat->wpa_pairwise_cipher = pairwise_cipher & psecuritypriv->wpa_pairwise_cipher; -+ -+ if (!pstat->wpa_group_cipher) -+ status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; -+ -+ if (!pstat->wpa_pairwise_cipher) -+ status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; -+ -+ } else -+ status = WLAN_STATUS_INVALID_IE; -+ -+ } else { -+ wpa_ie = NULL; -+ wpa_ie_len = 0; -+ } -+ -+ if (_STATS_SUCCESSFUL_ != status) -+ goto OnAssocReqFail; -+ -+ pstat->flags &= ~(WLAN_STA_WPS | WLAN_STA_MAYBE_WPS); -+ /* if (hapd->conf->wps_state && wpa_ie == NULL) { */ /* todo: to check ap if supporting WPS */ -+ if (wpa_ie == NULL) { -+ if (elems.wps_ie) { -+ RTW_INFO("STA included WPS IE in " -+ "(Re)Association Request - assume WPS is " -+ "used\n"); -+ pstat->flags |= WLAN_STA_WPS; -+ /* wpabuf_free(sta->wps_ie); */ -+ /* sta->wps_ie = wpabuf_alloc_copy(elems.wps_ie + 4, */ -+ /* elems.wps_ie_len - 4); */ -+ } else { -+ RTW_INFO("STA did not include WPA/RSN IE " -+ "in (Re)Association Request - possible WPS " -+ "use\n"); -+ pstat->flags |= WLAN_STA_MAYBE_WPS; -+ } -+ -+ -+ /* AP support WPA/RSN, and sta is going to do WPS, but AP is not ready */ -+ /* that the selected registrar of AP is _FLASE */ -+ if ((psecuritypriv->wpa_psk > 0) -+ && (pstat->flags & (WLAN_STA_WPS | WLAN_STA_MAYBE_WPS))) { -+ if (pmlmepriv->wps_beacon_ie) { -+ u8 selected_registrar = 0; -+ -+ rtw_get_wps_attr_content(pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len, WPS_ATTR_SELECTED_REGISTRAR , &selected_registrar, NULL); -+ -+ if (!selected_registrar) { -+ RTW_INFO("selected_registrar is _FALSE , or AP is not ready to do WPS\n"); -+ -+ status = _STATS_UNABLE_HANDLE_STA_; -+ -+ goto OnAssocReqFail; -+ } -+ } -+ } -+ -+ } else { -+ int copy_len; -+ -+ if (psecuritypriv->wpa_psk == 0) { -+ RTW_INFO("STA " MAC_FMT ": WPA/RSN IE in association " -+ "request, but AP don't support WPA/RSN\n", MAC_ARG(pstat->hwaddr)); -+ -+ status = WLAN_STATUS_INVALID_IE; -+ -+ goto OnAssocReqFail; -+ -+ } -+ -+ if (elems.wps_ie) { -+ RTW_INFO("STA included WPS IE in " -+ "(Re)Association Request - WPS is " -+ "used\n"); -+ pstat->flags |= WLAN_STA_WPS; -+ copy_len = 0; -+ } else -+ copy_len = ((wpa_ie_len + 2) > sizeof(pstat->wpa_ie)) ? (sizeof(pstat->wpa_ie)) : (wpa_ie_len + 2); -+ -+ -+ if (copy_len > 0) -+ _rtw_memcpy(pstat->wpa_ie, wpa_ie - 2, copy_len); -+ -+ } -+ -+ -+ /* check if there is WMM IE & support WWM-PS */ -+ pstat->flags &= ~WLAN_STA_WME; -+ pstat->qos_option = 0; -+ pstat->qos_info = 0; -+ pstat->has_legacy_ac = _TRUE; -+ pstat->uapsd_vo = 0; -+ pstat->uapsd_vi = 0; -+ pstat->uapsd_be = 0; -+ pstat->uapsd_bk = 0; -+ if (pmlmepriv->qospriv.qos_option) { -+ p = pframe + WLAN_HDR_A3_LEN + ie_offset; -+ ie_len = 0; -+ for (;;) { -+ p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ if (p != NULL) { -+ if (_rtw_memcmp(p + 2, WMM_IE, 6)) { -+ -+ pstat->flags |= WLAN_STA_WME; -+ -+ pstat->qos_option = 1; -+ pstat->qos_info = *(p + 8); -+ -+ pstat->max_sp_len = (pstat->qos_info >> 5) & 0x3; -+ -+ if ((pstat->qos_info & 0xf) != 0xf) -+ pstat->has_legacy_ac = _TRUE; -+ else -+ pstat->has_legacy_ac = _FALSE; -+ -+ if (pstat->qos_info & 0xf) { -+ if (pstat->qos_info & BIT(0)) -+ pstat->uapsd_vo = BIT(0) | BIT(1); -+ else -+ pstat->uapsd_vo = 0; -+ -+ if (pstat->qos_info & BIT(1)) -+ pstat->uapsd_vi = BIT(0) | BIT(1); -+ else -+ pstat->uapsd_vi = 0; -+ -+ if (pstat->qos_info & BIT(2)) -+ pstat->uapsd_bk = BIT(0) | BIT(1); -+ else -+ pstat->uapsd_bk = 0; -+ -+ if (pstat->qos_info & BIT(3)) -+ pstat->uapsd_be = BIT(0) | BIT(1); -+ else -+ pstat->uapsd_be = 0; -+ -+ } -+ -+ break; -+ } -+ } else -+ break; -+ p = p + ie_len + 2; -+ } -+ } -+ -+ -+#ifdef CONFIG_80211N_HT -+ if (pmlmepriv->htpriv.ht_option == _FALSE) -+ goto bypass_ht_chk; -+ -+ /* save HT capabilities in the sta object */ -+ _rtw_memset(&pstat->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); -+ if (elems.ht_capabilities && elems.ht_capabilities_len >= sizeof(struct rtw_ieee80211_ht_cap)) { -+ pstat->flags |= WLAN_STA_HT; -+ -+ pstat->flags |= WLAN_STA_WME; -+ -+ _rtw_memcpy(&pstat->htpriv.ht_cap, elems.ht_capabilities, sizeof(struct rtw_ieee80211_ht_cap)); -+ -+ } else -+ pstat->flags &= ~WLAN_STA_HT; -+bypass_ht_chk: -+ -+ if ((pmlmepriv->htpriv.ht_option == _FALSE) && (pstat->flags & WLAN_STA_HT)) { -+ rtw_warn_on(1); -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_80211AC_VHT -+ if (pmlmepriv->vhtpriv.vht_option == _FALSE) -+ goto bypass_vht_chk; -+ -+ _rtw_memset(&pstat->vhtpriv, 0, sizeof(struct vht_priv)); -+ if (elems.vht_capabilities && elems.vht_capabilities_len == 12) { -+ pstat->flags |= WLAN_STA_VHT; -+ -+ _rtw_memcpy(pstat->vhtpriv.vht_cap, elems.vht_capabilities, 12); -+ -+ if (elems.vht_op_mode_notify && elems.vht_op_mode_notify_len == 1) -+ _rtw_memcpy(&pstat->vhtpriv.vht_op_mode_notify, elems.vht_op_mode_notify, 1); -+ else /* for Frame without Operating Mode notify ie; default: 80M */ -+ pstat->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80; -+ } else -+ pstat->flags &= ~WLAN_STA_VHT; -+bypass_vht_chk: -+ -+ if ((pmlmepriv->vhtpriv.vht_option == _FALSE) && (pstat->flags & WLAN_STA_VHT)) { -+ rtw_warn_on(1); -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } -+#endif /* CONFIG_80211AC_VHT */ -+ -+ if (((pstat->flags & WLAN_STA_HT) || (pstat->flags & WLAN_STA_VHT)) && -+ ((pstat->wpa2_pairwise_cipher & WPA_CIPHER_TKIP) || -+ (pstat->wpa_pairwise_cipher & WPA_CIPHER_TKIP))) { -+ -+ RTW_INFO("(V)HT: " MAC_FMT " tried to use TKIP with (V)HT association\n", MAC_ARG(pstat->hwaddr)); -+ -+ pstat->flags &= ~WLAN_STA_HT; -+ pstat->flags &= ~WLAN_STA_VHT; -+ /*status = WLAN_STATUS_CIPHER_REJECTED_PER_POLICY; -+ * goto OnAssocReqFail; -+ */ -+ } -+ -+ -+ /* -+ * if (hapd->iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G) */ /* ? */ -+ pstat->flags |= WLAN_STA_NONERP; -+ for (i = 0; i < pstat->bssratelen; i++) { -+ if ((pstat->bssrateset[i] & 0x7f) > 22) { -+ pstat->flags &= ~WLAN_STA_NONERP; -+ break; -+ } -+ } -+ -+ if (pstat->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) -+ pstat->flags |= WLAN_STA_SHORT_PREAMBLE; -+ else -+ pstat->flags &= ~WLAN_STA_SHORT_PREAMBLE; -+ -+ -+ -+ if (status != _STATS_SUCCESSFUL_) -+ goto OnAssocReqFail; -+ -+#ifdef CONFIG_P2P -+ pstat->is_p2p_device = _FALSE; -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ p2pie = rtw_get_p2p_ie(pframe + WLAN_HDR_A3_LEN + ie_offset , pkt_len - WLAN_HDR_A3_LEN - ie_offset , NULL, &p2pielen); -+ if (p2pie) { -+ pstat->is_p2p_device = _TRUE; -+ p2p_status_code = (u8)process_assoc_req_p2p_ie(pwdinfo, pframe, pkt_len, pstat); -+ if (p2p_status_code > 0) { -+ pstat->p2p_status_code = p2p_status_code; -+ status = _STATS_CAP_FAIL_; -+ goto OnAssocReqFail; -+ } -+ } -+#ifdef CONFIG_WFD -+ rtw_process_wfd_ies(padapter, pframe + WLAN_HDR_A3_LEN + ie_offset, pkt_len - WLAN_HDR_A3_LEN - ie_offset, __func__); -+#endif -+ } -+ pstat->p2p_status_code = p2p_status_code; -+#endif /* CONFIG_P2P */ -+ -+ /* TODO: identify_proprietary_vendor_ie(); */ -+ /* Realtek proprietary IE */ -+ /* identify if this is Broadcom sta */ -+ /* identify if this is ralink sta */ -+ /* Customer proprietary IE */ -+ -+ -+ -+ /* get a unique AID */ -+ if (pstat->aid > 0) -+ RTW_INFO(" old AID %d\n", pstat->aid); -+ else { -+ for (pstat->aid = 1; pstat->aid <= NUM_STA; pstat->aid++) { -+ if (pstapriv->sta_aid[pstat->aid - 1] == NULL) { -+ if (pstat->aid > pstapriv->max_num_sta) { -+ pstat->aid = 0; -+ -+ RTW_INFO(" no room for more AIDs\n"); -+ -+ status = WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA; -+ -+ goto OnAssocReqFail; -+ -+ -+ } else { -+ pstapriv->sta_aid[pstat->aid - 1] = pstat; -+ RTW_INFO("allocate new AID = (%d)\n", pstat->aid); -+ break; -+ } -+ } -+ } -+ } -+ -+ -+ pstat->state &= (~WIFI_FW_ASSOC_STATE); -+ pstat->state |= WIFI_FW_ASSOC_SUCCESS; -+ /* RTW_INFO("==================%s, %d, (%x), bpairwise_key_installed=%d, MAC:"MAC_FMT"\n" -+ , __func__, __LINE__, pstat->state, pstat->bpairwise_key_installed, MAC_ARG(pstat->hwaddr)); */ -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ if (!rtw_is_list_empty(&pstat->auth_list)) { -+ rtw_list_delete(&pstat->auth_list); -+ pstapriv->auth_list_cnt--; -+ } -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&pstat->asoc_list)) { -+ pstat->expire_to = pstapriv->expire_to; -+ rtw_list_insert_tail(&pstat->asoc_list, &pstapriv->asoc_list); -+ pstapriv->asoc_list_cnt++; -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ } -+ -+ /* now the station is qualified to join our BSS... */ -+ if (pstat && (pstat->state & WIFI_FW_ASSOC_SUCCESS) && (_STATS_SUCCESSFUL_ == status)) { -+#ifdef CONFIG_NATIVEAP_MLME -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ /* .1 bss_cap_update & sta_info_update */ -+ bss_cap_update_on_sta_join(padapter, pstat); -+ sta_info_update(padapter, pstat); -+ } -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed == _TRUE) -+ status = _STATS_REFUSED_TEMPORARILY_; -+#endif /* CONFIG_IEEE80211W */ -+ /* .2 issue assoc rsp before notify station join event. */ -+ if (frame_type == WIFI_ASSOCREQ) -+ issue_asocrsp(padapter, status, pstat, WIFI_ASSOCRSP); -+ else -+ issue_asocrsp(padapter, status, pstat, WIFI_REASSOCRSP); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ _enter_critical_bh(&pstat->lock, &irqL); -+ if (pstat->passoc_req) { -+ rtw_mfree(pstat->passoc_req, pstat->assoc_req_len); -+ pstat->passoc_req = NULL; -+ pstat->assoc_req_len = 0; -+ } -+ -+ pstat->passoc_req = rtw_zmalloc(pkt_len); -+ if (pstat->passoc_req) { -+ _rtw_memcpy(pstat->passoc_req, pframe, pkt_len); -+ pstat->assoc_req_len = pkt_len; -+ } -+ _exit_critical_bh(&pstat->lock, &irqL); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed != _TRUE) -+#endif /* CONFIG_IEEE80211W */ -+ { -+ /* .3-(1) report sta add event */ -+ report_add_sta_event(padapter, pstat->hwaddr); -+ } -+#ifdef CONFIG_IEEE80211W -+ if (pstat->bpairwise_key_installed == _TRUE && padapter->securitypriv.binstallBIPkey == _TRUE) { -+ RTW_INFO(MAC_FMT"\n", MAC_ARG(pstat->hwaddr)); -+ issue_action_SA_Query(padapter, pstat->hwaddr, 0, 0, IEEE80211W_RIGHT_KEY); -+ } -+#endif /* CONFIG_IEEE80211W */ -+#endif /* CONFIG_NATIVEAP_MLME */ -+ } -+ -+ return _SUCCESS; -+ -+asoc_class2_error: -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ issue_deauth(padapter, (void *)GetAddr2Ptr(pframe), status); -+#endif -+ -+ return _FAIL; -+ -+OnAssocReqFail: -+ -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ pstat->aid = 0; -+ if (frame_type == WIFI_ASSOCREQ) -+ issue_asocrsp(padapter, status, pstat, WIFI_ASSOCRSP); -+ else -+ issue_asocrsp(padapter, status, pstat, WIFI_REASSOCRSP); -+#endif -+ -+ -+#endif /* CONFIG_AP_MODE */ -+ -+ return _FAIL; -+ -+} -+ -+unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ uint i; -+ int res; -+ unsigned short status; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ /* WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); */ -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint pkt_len = precv_frame->u.hdr.len; -+ PNDIS_802_11_VARIABLE_IEs pWapiIE = NULL; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ /* check A1 matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), get_da(pframe), ETH_ALEN)) -+ return _SUCCESS; -+ -+ if (!(pmlmeinfo->state & (WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE))) -+ return _SUCCESS; -+ -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ return _SUCCESS; -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ /* status */ -+ status = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN + 2)); -+ if (status > 0) { -+ RTW_INFO("assoc reject, status code: %d\n", status); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ res = -4; -+ goto report_assoc_result; -+ } -+ -+ /* get capabilities */ -+ pmlmeinfo->capability = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); -+ -+ /* set slot time */ -+ pmlmeinfo->slotTime = (pmlmeinfo->capability & BIT(10)) ? 9 : 20; -+ -+ /* AID */ -+ res = pmlmeinfo->aid = (int)(le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN + 4)) & 0x3fff); -+ -+ /* following are moved to join event callback function */ -+ /* to handle HT, WMM, rate adaptive, update MAC reg */ -+ /* for not to handle the synchronous IO in the tasklet */ -+ for (i = (6 + WLAN_HDR_A3_LEN); i < pkt_len;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: -+ if (_rtw_memcmp(pIE->data, WMM_PARA_OUI, 6)) /* WMM */ -+ WMM_param_handler(padapter, pIE); -+#if defined(CONFIG_P2P) && defined(CONFIG_WFD) -+ else if (_rtw_memcmp(pIE->data, WFD_OUI, 4)) /* WFD */ -+ rtw_process_wfd_ie(padapter, (u8 *)pIE, pIE->Length, __func__); -+#endif -+ break; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ case _WAPI_IE_: -+ pWapiIE = pIE; -+ break; -+#endif -+ -+ case _HT_CAPABILITY_IE_: /* HT caps */ -+ HT_caps_handler(padapter, pIE); -+ break; -+ -+ case _HT_EXTRA_INFO_IE_: /* HT info */ -+ HT_info_handler(padapter, pIE); -+ break; -+ -+#ifdef CONFIG_80211AC_VHT -+ case EID_VHTCapability: -+ VHT_caps_handler(padapter, pIE); -+ break; -+ -+ case EID_VHTOperation: -+ VHT_operation_handler(padapter, pIE); -+ break; -+#endif -+ -+ case _ERPINFO_IE_: -+ ERP_IE_handler(padapter, pIE); -+ break; -+#ifdef CONFIG_TDLS -+ case _EXT_CAP_IE_: -+ if (check_ap_tdls_prohibited(pIE->data, pIE->Length) == _TRUE) -+ padapter->tdlsinfo.ap_prohibited = _TRUE; -+ if (check_ap_tdls_ch_switching_prohibited(pIE->data, pIE->Length) == _TRUE) -+ padapter->tdlsinfo.ch_switch_prohibited = _TRUE; -+ break; -+#endif /* CONFIG_TDLS */ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_on_assoc_ok(padapter, pIE); -+#endif -+ -+ pmlmeinfo->state &= (~WIFI_FW_ASSOC_STATE); -+ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ -+ /* Update Basic Rate Table for spec, 2010-12-28 , by thomas */ -+ UpdateBrateTbl(padapter, pmlmeinfo->network.SupportedRates); -+ -+report_assoc_result: -+ if (res > 0) -+ rtw_buf_update(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len, pframe, pkt_len); -+ else -+ rtw_buf_free(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len); -+ -+ report_join_res(padapter, res); -+ -+ return _SUCCESS; -+} -+ -+unsigned int OnDeAuth(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned short reason; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P */ -+ -+ /* check A3 */ -+ if (!(_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) -+ return _SUCCESS; -+ -+ RTW_INFO(FUNC_ADPT_FMT" - Start to Disconnect\n", FUNC_ADPT_ARG(padapter)); -+ -+#ifdef CONFIG_P2P -+ if (pwdinfo->rx_invitereq_info.scan_op_ch_only) { -+ _cancel_timer_ex(&pwdinfo->reset_ch_sitesurvey); -+ _set_timer(&pwdinfo->reset_ch_sitesurvey, 10); -+ } -+#endif /* CONFIG_P2P */ -+ -+ reason = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); -+ -+ rtw_lock_rx_suspend_timeout(8000); -+ -+#ifdef CONFIG_AP_MODE -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ _irqL irqL; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ /* rtw_free_stainfo(padapter, psta); */ -+ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ -+ RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM\n" -+ , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe)); -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta) { -+ u8 updated = _FALSE; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, _FALSE, reason, _TRUE); -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); -+ } -+ -+ -+ return _SUCCESS; -+ } else -+#endif -+ { -+ int ignore_received_deauth = 0; -+ -+ /* Commented by Albert 20130604 */ -+ /* Before sending the auth frame to start the STA/GC mode connection with AP/GO, */ -+ /* we will send the deauth first. */ -+ /* However, the Win8.1 with BRCM Wi-Fi will send the deauth with reason code 6 to us after receieving our deauth. */ -+ /* Added the following code to avoid this case. */ -+ if ((pmlmeinfo->state & WIFI_FW_AUTH_STATE) || -+ (pmlmeinfo->state & WIFI_FW_ASSOC_STATE)) { -+ if (reason == WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA) -+ ignore_received_deauth = 1; -+ else if (WLAN_REASON_PREV_AUTH_NOT_VALID == reason) { -+ /* TODO: 802.11r */ -+ ignore_received_deauth = 1; -+ } -+ } -+ -+ RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM, ignore=%d\n" -+ , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe), ignore_received_deauth); -+ -+ if (0 == ignore_received_deauth) -+ receive_disconnect(padapter, GetAddr2Ptr(pframe), reason, _FALSE); -+ } -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnDisassoc(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned short reason; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P */ -+ -+ /* check A3 */ -+ if (!(_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) -+ return _SUCCESS; -+ -+ RTW_INFO(FUNC_ADPT_FMT" - Start to Disconnect\n", FUNC_ADPT_ARG(padapter)); -+ -+#ifdef CONFIG_P2P -+ if (pwdinfo->rx_invitereq_info.scan_op_ch_only) { -+ _cancel_timer_ex(&pwdinfo->reset_ch_sitesurvey); -+ _set_timer(&pwdinfo->reset_ch_sitesurvey, 10); -+ } -+#endif /* CONFIG_P2P */ -+ -+ reason = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); -+ -+ rtw_lock_rx_suspend_timeout(8000); -+ -+#ifdef CONFIG_AP_MODE -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ _irqL irqL; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ /* rtw_free_stainfo(padapter, psta); */ -+ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ -+ RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM\n" -+ , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe)); -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta) { -+ u8 updated = _FALSE; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, _FALSE, reason, _TRUE); -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); -+ } -+ -+ return _SUCCESS; -+ } else -+#endif -+ { -+ RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM\n" -+ , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe)); -+ -+ receive_disconnect(padapter, GetAddr2Ptr(pframe), reason, _FALSE); -+ } -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnAtim(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ return _SUCCESS; -+} -+ -+unsigned int on_action_spct_ch_switch(_adapter *padapter, struct sta_info *psta, u8 *ies, uint ies_len) -+{ -+ unsigned int ret = _FAIL; -+ struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(mlmeext->mlmext_info); -+ -+ if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { -+ ret = _SUCCESS; -+ goto exit; -+ } -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { -+ -+ int ch_switch_mode = -1, ch = -1, ch_switch_cnt = -1; -+ int ch_offset = -1; -+ u8 bwmode; -+ struct ieee80211_info_element *ie; -+ -+ RTW_INFO(FUNC_NDEV_FMT" from "MAC_FMT"\n", -+ FUNC_NDEV_ARG(padapter->pnetdev), MAC_ARG(psta->hwaddr)); -+ -+ for_each_ie(ie, ies, ies_len) { -+ if (ie->id == WLAN_EID_CHANNEL_SWITCH) { -+ ch_switch_mode = ie->data[0]; -+ ch = ie->data[1]; -+ ch_switch_cnt = ie->data[2]; -+ RTW_INFO("ch_switch_mode:%d, ch:%d, ch_switch_cnt:%d\n", -+ ch_switch_mode, ch, ch_switch_cnt); -+ } else if (ie->id == WLAN_EID_SECONDARY_CHANNEL_OFFSET) { -+ ch_offset = secondary_ch_offset_to_hal_ch_offset(ie->data[0]); -+ RTW_INFO("ch_offset:%d\n", ch_offset); -+ } -+ } -+ -+ if (ch == -1) -+ return _SUCCESS; -+ -+ if (ch_offset == -1) -+ bwmode = mlmeext->cur_bwmode; -+ else -+ bwmode = (ch_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) ? -+ CHANNEL_WIDTH_20 : CHANNEL_WIDTH_40; -+ -+ ch_offset = (ch_offset == -1) ? mlmeext->cur_ch_offset : ch_offset; -+ -+ /* todo: -+ * 1. the decision of channel switching -+ * 2. things after channel switching -+ */ -+ -+ ret = rtw_set_ch_cmd(padapter, ch, bwmode, ch_offset, _TRUE); -+ } -+ -+exit: -+ return ret; -+} -+ -+unsigned int on_action_spct(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int ret = _FAIL; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ u8 *frame_body = (u8 *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ u8 category; -+ u8 action; -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ -+ if (!psta) -+ goto exit; -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_SPECTRUM_MGMT) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case RTW_WLAN_ACTION_SPCT_MSR_REQ: -+ case RTW_WLAN_ACTION_SPCT_MSR_RPRT: -+ case RTW_WLAN_ACTION_SPCT_TPC_REQ: -+ case RTW_WLAN_ACTION_SPCT_TPC_RPRT: -+ break; -+ case RTW_WLAN_ACTION_SPCT_CHL_SWITCH: -+#ifdef CONFIG_SPCT_CH_SWITCH -+ ret = on_action_spct_ch_switch(padapter, psta, &frame_body[2], -+ frame_len - (frame_body - pframe) - 2); -+#endif -+ break; -+ default: -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+unsigned int OnAction_qos(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ return _SUCCESS; -+} -+ -+unsigned int OnAction_dls(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_RTW_WNM -+unsigned int on_action_wnm(_adapter *adapter, union recv_frame *rframe) -+{ -+ unsigned int ret = _FAIL; -+ struct sta_info *sta = NULL; -+ struct sta_priv *stapriv = &adapter->stapriv; -+ u8 *frame = rframe->u.hdr.rx_data; -+ uint frame_len = rframe->u.hdr.len; -+ u8 *frame_body = (u8 *)(frame + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ u8 category; -+ u8 action; -+ int cnt = 0; -+ char msg[16]; -+ -+ sta = rtw_get_stainfo(stapriv, GetAddr2Ptr(frame)); -+ if (!sta) -+ goto exit; -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_WNM) -+ goto exit; -+ -+ action = frame_body[1]; -+ -+ switch (action) { -+ default: -+ #ifdef CONFIG_IOCTL_CFG80211 -+ cnt += sprintf((msg + cnt), "ACT_WNM %u", action); -+ rtw_cfg80211_rx_action(adapter, rframe, msg); -+ #endif -+ ret = _SUCCESS; -+ break; -+ } -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_RTW_WNM */ -+ -+/** -+ * rtw_rx_ampdu_size - Get the target RX AMPDU buffer size for the specific @adapter -+ * @adapter: the adapter to get target RX AMPDU buffer size -+ * -+ * Returns: the target RX AMPDU buffer size -+ */ -+u8 rtw_rx_ampdu_size(_adapter *adapter) -+{ -+ u8 size; -+ HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor; -+ -+ if (adapter->fix_rx_ampdu_size != RX_AMPDU_SIZE_INVALID) { -+ size = adapter->fix_rx_ampdu_size; -+ goto exit; -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBTCoexCtrlAMPDUSize(adapter) == _TRUE) { -+ size = rtw_btcoex_GetAMPDUSize(adapter); -+ goto exit; -+ } -+#endif -+ -+ /* for scan */ -+ if (!mlmeext_chk_scan_state(&adapter->mlmeextpriv, SCAN_DISABLE) -+ && !mlmeext_chk_scan_state(&adapter->mlmeextpriv, SCAN_COMPLETE) -+ && adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_size != RX_AMPDU_SIZE_INVALID -+ ) { -+ size = adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_size; -+ goto exit; -+ } -+ -+ /* default value based on max_rx_ampdu_factor */ -+ if (adapter->driver_rx_ampdu_factor != 0xFF) -+ max_rx_ampdu_factor = (HT_CAP_AMPDU_FACTOR)adapter->driver_rx_ampdu_factor; -+ else -+ rtw_hal_get_def_var(adapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); -+ -+ if (MAX_AMPDU_FACTOR_64K == max_rx_ampdu_factor) -+ size = 64; -+ else if (MAX_AMPDU_FACTOR_32K == max_rx_ampdu_factor) -+ size = 32; -+ else if (MAX_AMPDU_FACTOR_16K == max_rx_ampdu_factor) -+ size = 16; -+ else if (MAX_AMPDU_FACTOR_8K == max_rx_ampdu_factor) -+ size = 8; -+ else -+ size = 64; -+ -+exit: -+ -+ if (size > 127) -+ size = 127; -+ -+ return size; -+} -+ -+/** -+ * rtw_rx_ampdu_is_accept - Get the permission if RX AMPDU should be set up for the specific @adapter -+ * @adapter: the adapter to get the permission if RX AMPDU should be set up -+ * -+ * Returns: accept or not -+ */ -+bool rtw_rx_ampdu_is_accept(_adapter *adapter) -+{ -+ bool accept; -+ -+ if (adapter->fix_rx_ampdu_accept != RX_AMPDU_ACCEPT_INVALID) { -+ accept = adapter->fix_rx_ampdu_accept; -+ goto exit; -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBTCoexRejectAMPDU(adapter) == _TRUE) { -+ accept = _FALSE; -+ goto exit; -+ } -+#endif -+ -+ /* for scan */ -+ if (!mlmeext_chk_scan_state(&adapter->mlmeextpriv, SCAN_DISABLE) -+ && !mlmeext_chk_scan_state(&adapter->mlmeextpriv, SCAN_COMPLETE) -+ && adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_accept != RX_AMPDU_ACCEPT_INVALID -+ ) { -+ accept = adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_accept; -+ goto exit; -+ } -+ -+ /* default value for other cases */ -+ accept = adapter->mlmeextpriv.mlmext_info.bAcceptAddbaReq; -+ -+exit: -+ return accept; -+} -+ -+/** -+ * rtw_rx_ampdu_set_size - Set the target RX AMPDU buffer size for the specific @adapter and specific @reason -+ * @adapter: the adapter to set target RX AMPDU buffer size -+ * @size: the target RX AMPDU buffer size to set -+ * @reason: reason for the target RX AMPDU buffer size setting -+ * -+ * Returns: whether the target RX AMPDU buffer size is changed -+ */ -+bool rtw_rx_ampdu_set_size(_adapter *adapter, u8 size, u8 reason) -+{ -+ bool is_adj = _FALSE; -+ struct mlme_ext_priv *mlmeext; -+ struct mlme_ext_info *mlmeinfo; -+ -+ mlmeext = &adapter->mlmeextpriv; -+ mlmeinfo = &mlmeext->mlmext_info; -+ -+ if (reason == RX_AMPDU_DRV_FIXED) { -+ if (adapter->fix_rx_ampdu_size != size) { -+ adapter->fix_rx_ampdu_size = size; -+ is_adj = _TRUE; -+ RTW_INFO(FUNC_ADPT_FMT" fix_rx_ampdu_size:%u\n", FUNC_ADPT_ARG(adapter), size); -+ } -+ } else if (reason == RX_AMPDU_DRV_SCAN) { -+ struct ss_res *ss = &adapter->mlmeextpriv.sitesurvey_res; -+ -+ if (ss->rx_ampdu_size != size) { -+ ss->rx_ampdu_size = size; -+ is_adj = _TRUE; -+ RTW_INFO(FUNC_ADPT_FMT" ss.rx_ampdu_size:%u\n", FUNC_ADPT_ARG(adapter), size); -+ } -+ } -+ -+ return is_adj; -+} -+ -+/** -+ * rtw_rx_ampdu_set_accept - Set the permission if RX AMPDU should be set up for the specific @adapter and specific @reason -+ * @adapter: the adapter to set if RX AMPDU should be set up -+ * @accept: if RX AMPDU should be set up -+ * @reason: reason for the permission if RX AMPDU should be set up -+ * -+ * Returns: whether the permission if RX AMPDU should be set up is changed -+ */ -+bool rtw_rx_ampdu_set_accept(_adapter *adapter, u8 accept, u8 reason) -+{ -+ bool is_adj = _FALSE; -+ struct mlme_ext_priv *mlmeext; -+ struct mlme_ext_info *mlmeinfo; -+ -+ mlmeext = &adapter->mlmeextpriv; -+ mlmeinfo = &mlmeext->mlmext_info; -+ -+ if (reason == RX_AMPDU_DRV_FIXED) { -+ if (adapter->fix_rx_ampdu_accept != accept) { -+ adapter->fix_rx_ampdu_accept = accept; -+ is_adj = _TRUE; -+ RTW_INFO(FUNC_ADPT_FMT" fix_rx_ampdu_accept:%u\n", FUNC_ADPT_ARG(adapter), accept); -+ } -+ } else if (reason == RX_AMPDU_DRV_SCAN) { -+ if (adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_accept != accept) { -+ adapter->mlmeextpriv.sitesurvey_res.rx_ampdu_accept = accept; -+ is_adj = _TRUE; -+ RTW_INFO(FUNC_ADPT_FMT" ss.rx_ampdu_accept:%u\n", FUNC_ADPT_ARG(adapter), accept); -+ } -+ } -+ -+ return is_adj; -+} -+ -+/** -+ * rx_ampdu_apply_sta_tid - Apply RX AMPDU setting to the specific @sta and @tid -+ * @adapter: the adapter to which @sta belongs -+ * @sta: the sta to be checked -+ * @tid: the tid to be checked -+ * @accept: the target permission if RX AMPDU should be set up -+ * @size: the target RX AMPDU buffer size -+ * -+ * Returns: -+ * 0: no canceled -+ * 1: canceled by no permission -+ * 2: canceled by different buffer size -+ * 3: canceled by potential mismatched status -+ * -+ * Blocking function, may sleep -+ */ -+u8 rx_ampdu_apply_sta_tid(_adapter *adapter, struct sta_info *sta, u8 tid, u8 accept, u8 size) -+{ -+ u8 ret = 0; -+ struct recv_reorder_ctrl *reorder_ctl = &sta->recvreorder_ctrl[tid]; -+ -+ if (reorder_ctl->enable == _FALSE) { -+ if (reorder_ctl->ampdu_size != RX_AMPDU_SIZE_INVALID) { -+ send_delba_sta_tid_wait_ack(adapter, 0, sta, tid, 1); -+ ret = 3; -+ } -+ goto exit; -+ } -+ -+ if (accept == _FALSE) { -+ send_delba_sta_tid_wait_ack(adapter, 0, sta, tid, 0); -+ ret = 1; -+ } else if (reorder_ctl->ampdu_size != size) { -+ send_delba_sta_tid_wait_ack(adapter, 0, sta, tid, 0); -+ ret = 2; -+ } -+ -+exit: -+ return ret; -+} -+ -+/** -+ * rx_ampdu_apply_sta - Apply RX AMPDU setting to the specific @sta -+ * @adapter: the adapter to which @sta belongs -+ * @sta: the sta to be checked -+ * @accept: the target permission if RX AMPDU should be set up -+ * @size: the target RX AMPDU buffer size -+ * -+ * Returns: number of the RX AMPDU assciation canceled for applying current target setting -+ * -+ * Blocking function, may sleep -+ */ -+u8 rx_ampdu_apply_sta(_adapter *adapter, struct sta_info *sta, u8 accept, u8 size) -+{ -+ u8 change_cnt = 0; -+ int i; -+ -+ for (i = 0; i < TID_NUM; i++) { -+ if (rx_ampdu_apply_sta_tid(adapter, sta, i, accept, size) != 0) -+ change_cnt++; -+ } -+ -+ return change_cnt; -+} -+ -+/** -+ * rtw_rx_ampdu_apply - Apply the current target RX AMPDU setting for the specific @adapter -+ * @adapter: the adapter to be applied -+ * -+ * Returns: number of the RX AMPDU assciation canceled for applying current target setting -+ */ -+u16 rtw_rx_ampdu_apply(_adapter *adapter) -+{ -+ u16 adj_cnt = 0; -+ struct mlme_ext_priv *mlmeext; -+ struct sta_info *sta; -+ u8 accept = rtw_rx_ampdu_is_accept(adapter); -+ u8 size = rtw_rx_ampdu_size(adapter); -+ -+ mlmeext = &adapter->mlmeextpriv; -+ -+ if (mlmeext_msr(mlmeext) == WIFI_FW_STATION_STATE) { -+ sta = rtw_get_stainfo(&adapter->stapriv, get_bssid(&adapter->mlmepriv)); -+ if (sta) -+ adj_cnt += rx_ampdu_apply_sta(adapter, sta, accept, size); -+#ifdef CONFIG_AP_MODE -+ } else if (mlmeext_msr(mlmeext) == WIFI_FW_AP_STATE) { -+ _irqL irqL; -+ _list *phead, *plist; -+ u8 peer_num = 0; -+ char peers[NUM_STA]; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ int i; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ int stainfo_offset; -+ -+ sta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, sta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ peers[peer_num++] = stainfo_offset; -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ for (i = 0; i < peer_num; i++) { -+ sta = rtw_get_stainfo_by_offset(pstapriv, peers[i]); -+ if (sta) -+ adj_cnt += rx_ampdu_apply_sta(adapter, sta, accept, size); -+ } -+#endif -+ } -+ -+ return adj_cnt; -+} -+ -+unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ u8 *addr; -+ struct sta_info *psta = NULL; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ unsigned char *frame_body; -+ unsigned char category, action; -+ unsigned short tid, status, reason_code = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+#ifdef CONFIG_80211N_HT -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ /* check RA matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) -+ return _SUCCESS; -+ -+#if 0 -+ /* check A1 matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), get_da(pframe), ETH_ALEN)) -+ return _SUCCESS; -+#endif -+ -+ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) -+ if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) -+ return _SUCCESS; -+ -+ addr = GetAddr2Ptr(pframe); -+ psta = rtw_get_stainfo(pstapriv, addr); -+ -+ if (psta == NULL) -+ return _SUCCESS; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ category = frame_body[0]; -+ if (category == RTW_WLAN_CATEGORY_BACK) { /* representing Block Ack */ -+#ifdef CONFIG_TDLS -+ if ((psta->tdls_sta_state & TDLS_LINKED_STATE) && -+ (psta->htpriv.ht_option == _TRUE) && -+ (psta->htpriv.ampdu_enable == _TRUE)) -+ RTW_INFO("Recv [%s] from direc link\n", __FUNCTION__); -+ else -+#endif /* CONFIG_TDLS */ -+ if (!pmlmeinfo->HT_enable) -+ return _SUCCESS; -+ -+ action = frame_body[1]; -+ RTW_INFO("%s, action=%d\n", __FUNCTION__, action); -+ switch (action) { -+ case RTW_WLAN_ACTION_ADDBA_REQ: /* ADDBA request */ -+ -+ _rtw_memcpy(&(pmlmeinfo->ADDBA_req), &(frame_body[2]), sizeof(struct ADDBA_request)); -+ /* process_addba_req(padapter, (u8*)&(pmlmeinfo->ADDBA_req), GetAddr3Ptr(pframe)); */ -+ process_addba_req(padapter, (u8 *)&(pmlmeinfo->ADDBA_req), addr); -+ -+ break; -+#ifdef CONFIG_AP_MODE -+ case RTW_WLAN_ACTION_ADDBA_RESP: /* ADDBA response */ -+ -+ /* status = frame_body[3] | (frame_body[4] << 8); */ /* endian issue */ -+ status = RTW_GET_LE16(&frame_body[3]); -+ tid = ((frame_body[5] >> 2) & 0x7); -+ -+ if (status == 0) { -+ /* successful */ -+ RTW_INFO("agg_enable for TID=%d\n", tid); -+ psta->htpriv.agg_enable_bitmap |= 1 << tid; -+ psta->htpriv.candidate_tid_bitmap &= ~BIT(tid); -+ } else -+ psta->htpriv.agg_enable_bitmap &= ~BIT(tid); -+ -+ if (psta->state & WIFI_STA_ALIVE_CHK_STATE) { -+ RTW_INFO("%s alive check - rx ADDBA response\n", __func__); -+ psta->htpriv.agg_enable_bitmap &= ~BIT(tid); -+ psta->expire_to = pstapriv->expire_to; -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ } -+ -+ /* RTW_INFO("marc: ADDBA RSP: %x\n", pmlmeinfo->agg_enable_bitmap); */ -+ break; -+#endif -+ case RTW_WLAN_ACTION_DELBA: /* DELBA */ -+ if ((frame_body[3] & BIT(3)) == 0) { -+ psta->htpriv.agg_enable_bitmap &= ~(1 << ((frame_body[3] >> 4) & 0xf)); -+ psta->htpriv.candidate_tid_bitmap &= ~(1 << ((frame_body[3] >> 4) & 0xf)); -+ -+ /* reason_code = frame_body[4] | (frame_body[5] << 8); */ -+ reason_code = RTW_GET_LE16(&frame_body[4]); -+ } else if ((frame_body[3] & BIT(3)) == BIT(3)) { -+ tid = (frame_body[3] >> 4) & 0x0F; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[tid]; -+ preorder_ctrl->enable = _FALSE; -+ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; -+ } -+ -+ RTW_INFO("%s(): DELBA: %x(%x)\n", __FUNCTION__, pmlmeinfo->agg_enable_bitmap, reason_code); -+ /* todo: how to notify the host while receiving DELETE BA */ -+ break; -+ -+ default: -+ break; -+ } -+ } -+#endif /* CONFIG_80211N_HT */ -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_P2P -+ -+static int get_reg_classes_full_count(struct p2p_channels channel_list) -+{ -+ int cnt = 0; -+ int i; -+ -+ for (i = 0; i < channel_list.reg_classes; i++) -+ cnt += channel_list.reg_class[i].channels; -+ -+ return cnt; -+} -+ -+static void get_channel_cnt_24g_5gl_5gh(struct mlme_ext_priv *pmlmeext, u8 *p24g_cnt, u8 *p5gl_cnt, u8 *p5gh_cnt) -+{ -+ int i = 0; -+ -+ *p24g_cnt = 0; -+ *p5gl_cnt = 0; -+ *p5gh_cnt = 0; -+ -+ for (i = 0; i < pmlmeext->max_chan_nums; i++) { -+ if (pmlmeext->channel_set[i].ChannelNum <= 14) -+ (*p24g_cnt)++; -+ else if ((pmlmeext->channel_set[i].ChannelNum > 14) && (pmlmeext->channel_set[i].ChannelNum <= 48)) { -+ /* Just include the channel 36, 40, 44, 48 channels for 5G low */ -+ (*p5gl_cnt)++; -+ } else if ((pmlmeext->channel_set[i].ChannelNum >= 149) && (pmlmeext->channel_set[i].ChannelNum <= 161)) { -+ /* Just include the channel 149, 153, 157, 161 channels for 5G high */ -+ (*p5gh_cnt)++; -+ } -+ } -+} -+ -+void issue_p2p_GO_request(_adapter *padapter, u8 *raddr) -+{ -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_GO_NEGO_REQ; -+ u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; -+ u8 wpsielen = 0, p2pielen = 0, i; -+ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; -+ u16 len_channellist_attr = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ RTW_INFO("[%s] In\n", __FUNCTION__); -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pwdinfo->negotiation_dialog_token = 1; /* Initialize the dialog value */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &pwdinfo->negotiation_dialog_token, &(pattrib->pktlen)); -+ -+ -+ -+ /* WPS Section */ -+ wpsielen = 0; -+ /* WPS OUI */ -+ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); -+ wpsielen += 4; -+ -+ /* WPS version */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ -+ -+ /* Device Password ID */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_PWID); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); -+ wpsielen += 2; -+ -+ /* Value: */ -+ -+ if (pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PEER_DISPLAY_PIN) -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_USER_SPEC); -+ else if (pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_SELF_DISPLAY_PIN) -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_REGISTRAR_SPEC); -+ else if (pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PBC) -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_PBC); -+ -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); -+ -+ -+ /* P2P IE Section. */ -+ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Commented by Albert 20110306 */ -+ /* According to the P2P Specification, the group negoitation request frame should contain 9 P2P attributes */ -+ /* 1. P2P Capability */ -+ /* 2. Group Owner Intent */ -+ /* 3. Configuration Timeout */ -+ /* 4. Listen Channel */ -+ /* 5. Extended Listen Timing */ -+ /* 6. Intended P2P Interface Address */ -+ /* 7. Channel List */ -+ /* 8. P2P Device Info */ -+ /* 9. Operating Channel */ -+ -+ -+ /* P2P Capability */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Device Capability Bitmap, 1 byte */ -+ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; -+ -+ /* Group Capability Bitmap, 1 byte */ -+ if (pwdinfo->persistent_supported) -+ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN | P2P_GRPCAP_PERSISTENT_GROUP; -+ else -+ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN; -+ -+ -+ /* Group Owner Intent */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_GO_INTENT; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Todo the tie breaker bit. */ -+ p2pie[p2pielen++] = ((pwdinfo->intent << 1) & 0xFE); -+ -+ /* Configuration Timeout */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CONF_TIMEOUT; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P GO */ -+ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P Client */ -+ -+ -+ /* Listen Channel */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_LISTEN_CH; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x51; /* Copy from SD7 */ -+ -+ /* Channel Number */ -+ p2pie[p2pielen++] = pwdinfo->listen_channel; /* listening channel number */ -+ -+ -+ /* Extended Listen Timing ATTR */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_EX_LISTEN_TIMING; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0004); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Availability Period */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0xFFFF); -+ p2pielen += 2; -+ -+ /* Availability Interval */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0xFFFF); -+ p2pielen += 2; -+ -+ -+ /* Intended P2P Interface Address */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_INTENDED_IF_ADDR; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ -+ /* Channel List */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; -+ -+ /* Length: */ -+ /* Country String(3) */ -+ /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ -+ /* + number of channels in all classes */ -+ len_channellist_attr = 3 -+ + (1 + 1) * (u16)(pmlmeext->channel_list.reg_classes) -+ + get_reg_classes_full_count(pmlmeext->channel_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(5 + 1); -+ else -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); -+#else -+ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); -+ -+#endif -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Channel Entry List */ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ -+ /* Operating Class */ -+ if (union_ch > 14) { -+ if (union_ch >= 149) -+ p2pie[p2pielen++] = 0x7c; -+ else -+ p2pie[p2pielen++] = 0x73; -+ } else -+ p2pie[p2pielen++] = 0x51; -+ -+ -+ /* Number of Channels */ -+ /* Just support 1 channel and this channel is AP's channel */ -+ p2pie[p2pielen++] = 1; -+ -+ /* Channel List */ -+ p2pie[p2pielen++] = union_ch; -+ } else { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+#else /* CONFIG_CONCURRENT_MODE */ -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ /* Device Info */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ -+ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(21 + pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* P2P Device Address */ -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* Config Method */ -+ /* This field should be big endian. Noted by P2P specification. */ -+ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->supported_wps_cm); -+ -+ p2pielen += 2; -+ -+ /* Primary Device Type */ -+ /* Category ID */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); -+ p2pielen += 2; -+ -+ /* OUI */ -+ *(u32 *)(p2pie + p2pielen) = cpu_to_be32(WPSOUI); -+ p2pielen += 4; -+ -+ /* Sub Category ID */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); -+ p2pielen += 2; -+ -+ /* Number of Secondary Device Types */ -+ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ -+ -+ /* Device Name */ -+ /* Type: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); -+ p2pielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name , pwdinfo->device_name_len); -+ p2pielen += pwdinfo->device_name_len; -+ -+ -+ /* Operating Channel */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Operating Class */ -+ if (pwdinfo->operating_channel <= 14) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x51; -+ } else if ((pwdinfo->operating_channel >= 36) && (pwdinfo->operating_channel <= 48)) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x73; -+ } else { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x7c; -+ } -+ -+ /* Channel Number */ -+ p2pie[p2pielen++] = pwdinfo->operating_channel; /* operating channel number */ -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_nego_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+ -+void issue_p2p_GO_response(_adapter *padapter, u8 *raddr, u8 *frame_body, uint len, u8 result) -+{ -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_GO_NEGO_RESP; -+ u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; -+ u8 p2pielen = 0, i; -+ uint wpsielen = 0; -+ u16 wps_devicepassword_id = 0x0000; -+ uint wps_devicepassword_id_len = 0; -+ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh; -+ u16 len_channellist_attr = 0; -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ RTW_INFO("[%s] In, result = %d\n", __FUNCTION__, result); -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pwdinfo->negotiation_dialog_token = frame_body[7]; /* The Dialog Token of provisioning discovery request frame. */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(pwdinfo->negotiation_dialog_token), &(pattrib->pktlen)); -+ -+ /* Commented by Albert 20110328 */ -+ /* Try to get the device password ID from the WPS IE of group negotiation request frame */ -+ /* WiFi Direct test plan 5.1.15 */ -+ rtw_get_wps_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, wpsie, &wpsielen); -+ rtw_get_wps_attr_content(wpsie, wpsielen, WPS_ATTR_DEVICE_PWID, (u8 *) &wps_devicepassword_id, &wps_devicepassword_id_len); -+ wps_devicepassword_id = be16_to_cpu(wps_devicepassword_id); -+ -+ _rtw_memset(wpsie, 0x00, 255); -+ wpsielen = 0; -+ -+ /* WPS Section */ -+ wpsielen = 0; -+ /* WPS OUI */ -+ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); -+ wpsielen += 4; -+ -+ /* WPS version */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ -+ -+ /* Device Password ID */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_PWID); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); -+ wpsielen += 2; -+ -+ /* Value: */ -+ if (wps_devicepassword_id == WPS_DPID_USER_SPEC) -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_REGISTRAR_SPEC); -+ else if (wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_USER_SPEC); -+ else -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_PBC); -+ wpsielen += 2; -+ -+ /* Commented by Kurt 20120113 */ -+ /* If some device wants to do p2p handshake without sending prov_disc_req */ -+ /* We have to get peer_req_cm from here. */ -+ if (_rtw_memcmp(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "000", 3)) { -+ if (wps_devicepassword_id == WPS_DPID_USER_SPEC) -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "dis", 3); -+ else if (wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3); -+ else -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3); -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); -+ -+ -+ /* P2P IE Section. */ -+ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Commented by Albert 20100908 */ -+ /* According to the P2P Specification, the group negoitation response frame should contain 9 P2P attributes */ -+ /* 1. Status */ -+ /* 2. P2P Capability */ -+ /* 3. Group Owner Intent */ -+ /* 4. Configuration Timeout */ -+ /* 5. Operating Channel */ -+ /* 6. Intended P2P Interface Address */ -+ /* 7. Channel List */ -+ /* 8. Device Info */ -+ /* 9. Group ID ( Only GO ) */ -+ -+ -+ /* ToDo: */ -+ -+ /* P2P Status */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_STATUS; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); -+ p2pielen += 2; -+ -+ /* Value: */ -+ p2pie[p2pielen++] = result; -+ -+ /* P2P Capability */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Device Capability Bitmap, 1 byte */ -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { -+ /* Commented by Albert 2011/03/08 */ -+ /* According to the P2P specification */ -+ /* if the sending device will be client, the P2P Capability should be reserved of group negotation response frame */ -+ p2pie[p2pielen++] = 0; -+ } else { -+ /* Be group owner or meet the error case */ -+ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; -+ } -+ -+ /* Group Capability Bitmap, 1 byte */ -+ if (pwdinfo->persistent_supported) -+ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN | P2P_GRPCAP_PERSISTENT_GROUP; -+ else -+ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN; -+ -+ /* Group Owner Intent */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_GO_INTENT; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); -+ p2pielen += 2; -+ -+ /* Value: */ -+ if (pwdinfo->peer_intent & 0x01) { -+ /* Peer's tie breaker bit is 1, our tie breaker bit should be 0 */ -+ p2pie[p2pielen++] = (pwdinfo->intent << 1); -+ } else { -+ /* Peer's tie breaker bit is 0, our tie breaker bit should be 1 */ -+ p2pie[p2pielen++] = ((pwdinfo->intent << 1) | BIT(0)); -+ } -+ -+ -+ /* Configuration Timeout */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CONF_TIMEOUT; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P GO */ -+ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P Client */ -+ -+ /* Operating Channel */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Operating Class */ -+ if (pwdinfo->operating_channel <= 14) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x51; -+ } else if ((pwdinfo->operating_channel >= 36) && (pwdinfo->operating_channel <= 48)) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x73; -+ } else { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x7c; -+ } -+ -+ /* Channel Number */ -+ p2pie[p2pielen++] = pwdinfo->operating_channel; /* operating channel number */ -+ -+ /* Intended P2P Interface Address */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_INTENDED_IF_ADDR; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* Channel List */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; -+ -+ /* Country String(3) */ -+ /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ -+ /* + number of channels in all classes */ -+ len_channellist_attr = 3 -+ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes -+ + get_reg_classes_full_count(pmlmeext->channel_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(5 + 1); -+ else -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); -+#else -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); -+ -+#endif -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Channel Entry List */ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { -+ -+ u8 union_chan = rtw_mi_get_union_chan(padapter); -+ -+ /*Operating Class*/ -+ if (union_chan > 14) { -+ if (union_chan >= 149) -+ p2pie[p2pielen++] = 0x7c; -+ else -+ p2pie[p2pielen++] = 0x73; -+ -+ } else -+ p2pie[p2pielen++] = 0x51; -+ -+ /* Number of Channels -+ Just support 1 channel and this channel is AP's channel*/ -+ p2pie[p2pielen++] = 1; -+ -+ /*Channel List*/ -+ p2pie[p2pielen++] = union_chan; -+ } else { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+#else /* CONFIG_CONCURRENT_MODE */ -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ -+ /* Device Info */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ -+ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(21 + pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* P2P Device Address */ -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* Config Method */ -+ /* This field should be big endian. Noted by P2P specification. */ -+ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->supported_wps_cm); -+ -+ p2pielen += 2; -+ -+ /* Primary Device Type */ -+ /* Category ID */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); -+ p2pielen += 2; -+ -+ /* OUI */ -+ *(u32 *)(p2pie + p2pielen) = cpu_to_be32(WPSOUI); -+ p2pielen += 4; -+ -+ /* Sub Category ID */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); -+ p2pielen += 2; -+ -+ /* Number of Secondary Device Types */ -+ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ -+ -+ /* Device Name */ -+ /* Type: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); -+ p2pielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name , pwdinfo->device_name_len); -+ p2pielen += pwdinfo->device_name_len; -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ /* Group ID Attribute */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_GROUP_ID; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN + pwdinfo->nego_ssidlen); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* p2P Device Address */ -+ _rtw_memcpy(p2pie + p2pielen , pwdinfo->device_addr, ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* SSID */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen); -+ p2pielen += pwdinfo->nego_ssidlen; -+ -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_nego_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+void issue_p2p_GO_confirm(_adapter *padapter, u8 *raddr, u8 result) -+{ -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_GO_NEGO_CONF; -+ u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; -+ u8 wpsielen = 0, p2pielen = 0; -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ RTW_INFO("[%s] In\n", __FUNCTION__); -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(pwdinfo->negotiation_dialog_token), &(pattrib->pktlen)); -+ -+ -+ -+ /* P2P IE Section. */ -+ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Commented by Albert 20110306 */ -+ /* According to the P2P Specification, the group negoitation request frame should contain 5 P2P attributes */ -+ /* 1. Status */ -+ /* 2. P2P Capability */ -+ /* 3. Operating Channel */ -+ /* 4. Channel List */ -+ /* 5. Group ID ( if this WiFi is GO ) */ -+ -+ /* P2P Status */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_STATUS; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); -+ p2pielen += 2; -+ -+ /* Value: */ -+ p2pie[p2pielen++] = result; -+ -+ /* P2P Capability */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Device Capability Bitmap, 1 byte */ -+ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; -+ -+ /* Group Capability Bitmap, 1 byte */ -+ if (pwdinfo->persistent_supported) -+ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN | P2P_GRPCAP_PERSISTENT_GROUP; -+ else -+ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN; -+ -+ -+ /* Operating Channel */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { -+ if (pwdinfo->peer_operating_ch <= 14) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x51; -+ } else if ((pwdinfo->peer_operating_ch >= 36) && (pwdinfo->peer_operating_ch <= 48)) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x73; -+ } else { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x7c; -+ } -+ -+ p2pie[p2pielen++] = pwdinfo->peer_operating_ch; -+ } else { -+ if (pwdinfo->operating_channel <= 14) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x51; -+ } else if ((pwdinfo->operating_channel >= 36) && (pwdinfo->operating_channel <= 48)) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x73; -+ } else { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x7c; -+ } -+ -+ /* Channel Number */ -+ p2pie[p2pielen++] = pwdinfo->operating_channel; /* Use the listen channel as the operating channel */ -+ } -+ -+ -+ /* Channel List */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; -+ -+ *(u16 *)(p2pie + p2pielen) = 6; -+ p2pielen += 2; -+ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Value: */ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { -+ if (pwdinfo->peer_operating_ch <= 14) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x51; -+ } else if ((pwdinfo->peer_operating_ch >= 36) && (pwdinfo->peer_operating_ch <= 48)) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x73; -+ } else { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x7c; -+ } -+ p2pie[p2pielen++] = 1; -+ p2pie[p2pielen++] = pwdinfo->peer_operating_ch; -+ } else { -+ if (pwdinfo->operating_channel <= 14) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x51; -+ } else if ((pwdinfo->operating_channel >= 36) && (pwdinfo->operating_channel <= 48)) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x73; -+ } else { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x7c; -+ } -+ -+ /* Channel Number */ -+ p2pie[p2pielen++] = 1; -+ p2pie[p2pielen++] = pwdinfo->operating_channel; /* Use the listen channel as the operating channel */ -+ } -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ /* Group ID Attribute */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_GROUP_ID; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN + pwdinfo->nego_ssidlen); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* p2P Device Address */ -+ _rtw_memcpy(p2pie + p2pielen , pwdinfo->device_addr, ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* SSID */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen); -+ p2pielen += pwdinfo->nego_ssidlen; -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_nego_confirm_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+void issue_p2p_invitation_request(_adapter *padapter, u8 *raddr) -+{ -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_INVIT_REQ; -+ u8 p2pie[255] = { 0x00 }; -+ u8 p2pielen = 0, i; -+ u8 dialogToken = 3; -+ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; -+ u16 len_channellist_attr = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, raddr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ /* P2P IE Section. */ -+ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Commented by Albert 20101011 */ -+ /* According to the P2P Specification, the P2P Invitation request frame should contain 7 P2P attributes */ -+ /* 1. Configuration Timeout */ -+ /* 2. Invitation Flags */ -+ /* 3. Operating Channel ( Only GO ) */ -+ /* 4. P2P Group BSSID ( Should be included if I am the GO ) */ -+ /* 5. Channel List */ -+ /* 6. P2P Group ID */ -+ /* 7. P2P Device Info */ -+ -+ /* Configuration Timeout */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CONF_TIMEOUT; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P GO */ -+ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P Client */ -+ -+ /* Invitation Flags */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_INVITATION_FLAGS; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); -+ p2pielen += 2; -+ -+ /* Value: */ -+ p2pie[p2pielen++] = P2P_INVITATION_FLAGS_PERSISTENT; -+ -+ -+ /* Operating Channel */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Operating Class */ -+ if (pwdinfo->invitereq_info.operating_ch <= 14) -+ p2pie[p2pielen++] = 0x51; -+ else if ((pwdinfo->invitereq_info.operating_ch >= 36) && (pwdinfo->invitereq_info.operating_ch <= 48)) -+ p2pie[p2pielen++] = 0x73; -+ else -+ p2pie[p2pielen++] = 0x7c; -+ -+ /* Channel Number */ -+ p2pie[p2pielen++] = pwdinfo->invitereq_info.operating_ch; /* operating channel number */ -+ -+ if (_rtw_memcmp(adapter_mac_addr(padapter), pwdinfo->invitereq_info.go_bssid, ETH_ALEN)) { -+ /* P2P Group BSSID */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_GROUP_BSSID; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* P2P Device Address for GO */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->invitereq_info.go_bssid, ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ } -+ -+ /* Channel List */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; -+ -+ -+ /* Length: */ -+ /* Country String(3) */ -+ /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ -+ /* + number of channels in all classes */ -+ len_channellist_attr = 3 -+ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes -+ + get_reg_classes_full_count(pmlmeext->channel_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(5 + 1); -+ else -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); -+#else -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); -+#endif -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Channel Entry List */ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ -+ /* Operating Class */ -+ if (union_ch > 14) { -+ if (union_ch >= 149) -+ p2pie[p2pielen++] = 0x7c; -+ else -+ p2pie[p2pielen++] = 0x73; -+ } else -+ p2pie[p2pielen++] = 0x51; -+ -+ -+ /* Number of Channels */ -+ /* Just support 1 channel and this channel is AP's channel */ -+ p2pie[p2pielen++] = 1; -+ -+ /* Channel List */ -+ p2pie[p2pielen++] = union_ch; -+ } else { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+#else /* CONFIG_CONCURRENT_MODE */ -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ -+ /* P2P Group ID */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_GROUP_ID; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(6 + pwdinfo->invitereq_info.ssidlen); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* P2P Device Address for GO */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->invitereq_info.go_bssid, ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* SSID */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->invitereq_info.go_ssid, pwdinfo->invitereq_info.ssidlen); -+ p2pielen += pwdinfo->invitereq_info.ssidlen; -+ -+ -+ /* Device Info */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ -+ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(21 + pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* P2P Device Address */ -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* Config Method */ -+ /* This field should be big endian. Noted by P2P specification. */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_CONFIG_METHOD_DISPLAY); -+ p2pielen += 2; -+ -+ /* Primary Device Type */ -+ /* Category ID */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); -+ p2pielen += 2; -+ -+ /* OUI */ -+ *(u32 *)(p2pie + p2pielen) = cpu_to_be32(WPSOUI); -+ p2pielen += 4; -+ -+ /* Sub Category ID */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); -+ p2pielen += 2; -+ -+ /* Number of Secondary Device Types */ -+ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ -+ -+ /* Device Name */ -+ /* Type: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); -+ p2pielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len); -+ p2pielen += pwdinfo->device_name_len; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_invitation_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+void issue_p2p_invitation_response(_adapter *padapter, u8 *raddr, u8 dialogToken, u8 status_code) -+{ -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_INVIT_RESP; -+ u8 p2pie[255] = { 0x00 }; -+ u8 p2pielen = 0, i; -+ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; -+ u16 len_channellist_attr = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, raddr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ /* P2P IE Section. */ -+ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Commented by Albert 20101005 */ -+ /* According to the P2P Specification, the P2P Invitation response frame should contain 5 P2P attributes */ -+ /* 1. Status */ -+ /* 2. Configuration Timeout */ -+ /* 3. Operating Channel ( Only GO ) */ -+ /* 4. P2P Group BSSID ( Only GO ) */ -+ /* 5. Channel List */ -+ -+ /* P2P Status */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_STATUS; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* When status code is P2P_STATUS_FAIL_INFO_UNAVAILABLE. */ -+ /* Sent the event receiving the P2P Invitation Req frame to DMP UI. */ -+ /* DMP had to compare the MAC address to find out the profile. */ -+ /* So, the WiFi driver will send the P2P_STATUS_FAIL_INFO_UNAVAILABLE to NB. */ -+ /* If the UI found the corresponding profile, the WiFi driver sends the P2P Invitation Req */ -+ /* to NB to rebuild the persistent group. */ -+ p2pie[p2pielen++] = status_code; -+ -+ /* Configuration Timeout */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CONF_TIMEOUT; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P GO */ -+ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P Client */ -+ -+ if (status_code == P2P_STATUS_SUCCESS) { -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ /* The P2P Invitation request frame asks this Wi-Fi device to be the P2P GO */ -+ /* In this case, the P2P Invitation response frame should carry the two more P2P attributes. */ -+ /* First one is operating channel attribute. */ -+ /* Second one is P2P Group BSSID attribute. */ -+ -+ /* Operating Channel */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x51; /* Copy from SD7 */ -+ -+ /* Channel Number */ -+ p2pie[p2pielen++] = pwdinfo->operating_channel; /* operating channel number */ -+ -+ -+ /* P2P Group BSSID */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_GROUP_BSSID; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* P2P Device Address for GO */ -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ } -+ -+ /* Channel List */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; -+ -+ /* Length: */ -+ /* Country String(3) */ -+ /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ -+ /* + number of channels in all classes */ -+ len_channellist_attr = 3 -+ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes -+ + get_reg_classes_full_count(pmlmeext->channel_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(5 + 1); -+ else -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); -+#else -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); -+#endif -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Channel Entry List */ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ -+ /* Operating Class */ -+ if (union_ch > 14) { -+ if (union_ch >= 149) -+ p2pie[p2pielen++] = 0x7c; -+ else -+ p2pie[p2pielen++] = 0x73; -+ } else -+ p2pie[p2pielen++] = 0x51; -+ -+ -+ /* Number of Channels */ -+ /* Just support 1 channel and this channel is AP's channel */ -+ p2pie[p2pielen++] = 1; -+ -+ /* Channel List */ -+ p2pie[p2pielen++] = union_ch; -+ } else { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+#else /* CONFIG_CONCURRENT_MODE */ -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_invitation_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+void issue_p2p_provision_request(_adapter *padapter, u8 *pssid, u8 ussidlen, u8 *pdev_raddr) -+{ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u8 dialogToken = 1; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_PROVISION_DISC_REQ; -+ u8 wpsie[100] = { 0x00 }; -+ u8 wpsielen = 0; -+ u32 p2pielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ RTW_INFO("[%s] In\n", __FUNCTION__); -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, pdev_raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pdev_raddr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ p2pielen = build_prov_disc_request_p2p_ie(pwdinfo, pframe, pssid, ussidlen, pdev_raddr); -+ -+ pframe += p2pielen; -+ pattrib->pktlen += p2pielen; -+ -+ wpsielen = 0; -+ /* WPS OUI */ -+ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); -+ wpsielen += 4; -+ -+ /* WPS version */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ -+ -+ /* Config Method */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_CONF_METHOD); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); -+ wpsielen += 2; -+ -+ /* Value: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->tx_prov_disc_info.wps_config_method_request); -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); -+ -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_provdisc_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+ -+u8 is_matched_in_profilelist(u8 *peermacaddr, struct profile_info *profileinfo) -+{ -+ u8 i, match_result = 0; -+ -+ RTW_INFO("[%s] peermac = %.2X %.2X %.2X %.2X %.2X %.2X\n", __FUNCTION__, -+ peermacaddr[0], peermacaddr[1], peermacaddr[2], peermacaddr[3], peermacaddr[4], peermacaddr[5]); -+ -+ for (i = 0; i < P2P_MAX_PERSISTENT_GROUP_NUM; i++, profileinfo++) { -+ RTW_INFO("[%s] profileinfo_mac = %.2X %.2X %.2X %.2X %.2X %.2X\n", __FUNCTION__, -+ profileinfo->peermac[0], profileinfo->peermac[1], profileinfo->peermac[2], profileinfo->peermac[3], profileinfo->peermac[4], profileinfo->peermac[5]); -+ if (_rtw_memcmp(peermacaddr, profileinfo->peermac, ETH_ALEN)) { -+ match_result = 1; -+ RTW_INFO("[%s] Match!\n", __FUNCTION__); -+ break; -+ } -+ } -+ -+ return match_result ; -+} -+ -+void issue_probersp_p2p(_adapter *padapter, unsigned char *da) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned char *mac; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ /* WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); */ -+ u16 beacon_interval = 100; -+ u16 capInfo = 0; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 wpsie[255] = { 0x00 }; -+ u32 wpsielen = 0, p2pielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+#ifdef CONFIG_INTEL_WIDI -+ u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ if (IS_CCK_RATE(pattrib->rate)) { -+ /* force OFDM 6M rate */ -+ pattrib->rate = MGN_6M; -+ pattrib->raid = rtw_get_mgntframe_raid(padapter, WIRELESS_11G); -+ } -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = adapter_mac_addr(padapter); -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ /* Use the device address for BSSID field. */ -+ _rtw_memcpy(pwlanhdr->addr3, mac, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(fctrl, WIFI_PROBERSP); -+ -+ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = pattrib->hdrlen; -+ pframe += pattrib->hdrlen; -+ -+ /* timestamp will be inserted by hardware */ -+ pframe += 8; -+ pattrib->pktlen += 8; -+ -+ /* beacon interval: 2 bytes */ -+ _rtw_memcpy(pframe, (unsigned char *) &beacon_interval, 2); -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /* capability info: 2 bytes */ -+ /* ESS and IBSS bits must be 0 (defined in the 3.1.2.1.1 of WiFi Direct Spec) */ -+ capInfo |= cap_ShortPremble; -+ capInfo |= cap_ShortSlot; -+ -+ _rtw_memcpy(pframe, (unsigned char *) &capInfo, 2); -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, 7, pwdinfo->p2p_wildcard_ssid, &pattrib->pktlen); -+ -+ /* supported rates... */ -+ /* Use the OFDM rate in the P2P probe response frame. ( 6(B), 9(B), 12, 18, 24, 36, 48, 54 ) */ -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pwdinfo->support_rate, &pattrib->pktlen); -+ -+ /* DS parameter set */ -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&pwdinfo->listen_channel, &pattrib->pktlen); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (pmlmepriv->wps_probe_resp_ie != NULL && pmlmepriv->p2p_probe_resp_ie != NULL) { -+ /* WPS IE */ -+ _rtw_memcpy(pframe, pmlmepriv->wps_probe_resp_ie, pmlmepriv->wps_probe_resp_ie_len); -+ pattrib->pktlen += pmlmepriv->wps_probe_resp_ie_len; -+ pframe += pmlmepriv->wps_probe_resp_ie_len; -+ -+ /* P2P IE */ -+ _rtw_memcpy(pframe, pmlmepriv->p2p_probe_resp_ie, pmlmepriv->p2p_probe_resp_ie_len); -+ pattrib->pktlen += pmlmepriv->p2p_probe_resp_ie_len; -+ pframe += pmlmepriv->p2p_probe_resp_ie_len; -+ } -+ } else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ { -+ -+ /* Todo: WPS IE */ -+ /* Noted by Albert 20100907 */ -+ /* According to the WPS specification, all the WPS attribute is presented by Big Endian. */ -+ -+ wpsielen = 0; -+ /* WPS OUI */ -+ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); -+ wpsielen += 4; -+ -+ /* WPS version */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ -+ -+#ifdef CONFIG_INTEL_WIDI -+ /* Commented by Kurt */ -+ /* Appended WiDi info. only if we did issued_probereq_widi(), and then we saved ven. ext. in pmlmepriv->sa_ext. */ -+ if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE -+ || pmlmepriv->num_p2p_sdt != 0) { -+ /* Sec dev type */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SEC_DEV_TYPE_LIST); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0008); -+ wpsielen += 2; -+ -+ /* Value: */ -+ /* Category ID */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_CID_DISPLAYS); -+ wpsielen += 2; -+ -+ /* OUI */ -+ *(u32 *)(wpsie + wpsielen) = cpu_to_be32(INTEL_DEV_TYPE_OUI); -+ wpsielen += 4; -+ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_SCID_WIDI_CONSUMER_SINK); -+ wpsielen += 2; -+ -+ if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE) { -+ /* Vendor Extension */ -+ _rtw_memcpy(wpsie + wpsielen, pmlmepriv->sa_ext, L2SDTA_SERVICE_VE_LEN); -+ wpsielen += L2SDTA_SERVICE_VE_LEN; -+ } -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ /* WiFi Simple Config State */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SIMPLE_CONF_STATE); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_WSC_STATE_NOT_CONFIG; /* Not Configured. */ -+ -+ /* Response Type */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_RESP_TYPE); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_RESPONSE_TYPE_8021X; -+ -+ /* UUID-E */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_UUID_E); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0010); -+ wpsielen += 2; -+ -+ /* Value: */ -+ if (pwdinfo->external_uuid == 0) { -+ _rtw_memset(wpsie + wpsielen, 0x0, 16); -+ _rtw_memcpy(wpsie + wpsielen, mac, ETH_ALEN); -+ } else -+ _rtw_memcpy(wpsie + wpsielen, pwdinfo->uuid, 0x10); -+ wpsielen += 0x10; -+ -+ /* Manufacturer */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_MANUFACTURER); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0007); -+ wpsielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(wpsie + wpsielen, "Realtek", 7); -+ wpsielen += 7; -+ -+ /* Model Name */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_MODEL_NAME); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0006); -+ wpsielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(wpsie + wpsielen, "8192CU", 6); -+ wpsielen += 6; -+ -+ /* Model Number */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_MODEL_NUMBER); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = 0x31; /* character 1 */ -+ -+ /* Serial Number */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SERIAL_NUMBER); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(ETH_ALEN); -+ wpsielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(wpsie + wpsielen, "123456" , ETH_ALEN); -+ wpsielen += ETH_ALEN; -+ -+ /* Primary Device Type */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_PRIMARY_DEV_TYPE); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0008); -+ wpsielen += 2; -+ -+ /* Value: */ -+ /* Category ID */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); -+ wpsielen += 2; -+ -+ /* OUI */ -+ *(u32 *)(wpsie + wpsielen) = cpu_to_be32(WPSOUI); -+ wpsielen += 4; -+ -+ /* Sub Category ID */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); -+ wpsielen += 2; -+ -+ /* Device Name */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->device_name_len); -+ wpsielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(wpsie + wpsielen, pwdinfo->device_name, pwdinfo->device_name_len); -+ wpsielen += pwdinfo->device_name_len; -+ -+ /* Config Method */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_CONF_METHOD); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); -+ wpsielen += 2; -+ -+ /* Value: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->supported_wps_cm); -+ wpsielen += 2; -+ -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); -+ -+ -+ p2pielen = build_probe_resp_p2p_ie(pwdinfo, pframe); -+ pframe += p2pielen; -+ pattrib->pktlen += p2pielen; -+ } -+ -+#ifdef CONFIG_WFD -+ wfdielen = rtw_append_probe_resp_wfd_ie(padapter, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+int _issue_probereq_p2p(_adapter *padapter, u8 *da, int wait_ack) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned char *mac; -+ unsigned char bssrate[NumRates]; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int bssrate_len = 0; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; -+ u16 wpsielen = 0, p2pielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ if (IS_CCK_RATE(pattrib->rate)) { -+ /* force OFDM 6M rate */ -+ pattrib->rate = MGN_6M; -+ pattrib->raid = rtw_get_mgntframe_raid(padapter, WIRELESS_11G); -+ } -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = adapter_mac_addr(padapter); -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ if (da) { -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, da, ETH_ALEN); -+ } else { -+ if ((pwdinfo->p2p_info.scan_op_ch_only) || (pwdinfo->rx_invitereq_info.scan_op_ch_only)) { -+ /* This two flags will be set when this is only the P2P client mode. */ -+ _rtw_memcpy(pwlanhdr->addr1, pwdinfo->p2p_peer_interface_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->p2p_peer_interface_addr, ETH_ALEN); -+ } else { -+ /* broadcast probe request frame */ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, bc_addr, ETH_ALEN); -+ } -+ } -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_PROBEREQ); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) -+ pframe = rtw_set_ie(pframe, _SSID_IE_, pwdinfo->tx_prov_disc_info.ssid.SsidLength, pwdinfo->tx_prov_disc_info.ssid.Ssid, &(pattrib->pktlen)); -+ else -+ pframe = rtw_set_ie(pframe, _SSID_IE_, P2P_WILDCARD_SSID_LEN, pwdinfo->p2p_wildcard_ssid, &(pattrib->pktlen)); -+ /* Use the OFDM rate in the P2P probe request frame. ( 6(B), 9(B), 12(B), 24(B), 36, 48, 54 ) */ -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pwdinfo->support_rate, &pattrib->pktlen); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (pmlmepriv->wps_probe_req_ie != NULL && pmlmepriv->p2p_probe_req_ie != NULL) { -+ /* WPS IE */ -+ _rtw_memcpy(pframe, pmlmepriv->wps_probe_req_ie, pmlmepriv->wps_probe_req_ie_len); -+ pattrib->pktlen += pmlmepriv->wps_probe_req_ie_len; -+ pframe += pmlmepriv->wps_probe_req_ie_len; -+ -+ /* P2P IE */ -+ _rtw_memcpy(pframe, pmlmepriv->p2p_probe_req_ie, pmlmepriv->p2p_probe_req_ie_len); -+ pattrib->pktlen += pmlmepriv->p2p_probe_req_ie_len; -+ pframe += pmlmepriv->p2p_probe_req_ie_len; -+ } -+ } else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ { -+ -+ /* WPS IE */ -+ /* Noted by Albert 20110221 */ -+ /* According to the WPS specification, all the WPS attribute is presented by Big Endian. */ -+ -+ wpsielen = 0; -+ /* WPS OUI */ -+ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); -+ wpsielen += 4; -+ -+ /* WPS version */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ -+ -+ if (pmlmepriv->wps_probe_req_ie == NULL) { -+ /* UUID-E */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_UUID_E); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0010); -+ wpsielen += 2; -+ -+ /* Value: */ -+ if (pwdinfo->external_uuid == 0) { -+ _rtw_memset(wpsie + wpsielen, 0x0, 16); -+ _rtw_memcpy(wpsie + wpsielen, mac, ETH_ALEN); -+ } else -+ _rtw_memcpy(wpsie + wpsielen, pwdinfo->uuid, 0x10); -+ wpsielen += 0x10; -+ -+ /* Config Method */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_CONF_METHOD); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); -+ wpsielen += 2; -+ -+ /* Value: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->supported_wps_cm); -+ wpsielen += 2; -+ } -+ -+ /* Device Name */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->device_name_len); -+ wpsielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(wpsie + wpsielen, pwdinfo->device_name, pwdinfo->device_name_len); -+ wpsielen += pwdinfo->device_name_len; -+ -+ /* Primary Device Type */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_PRIMARY_DEV_TYPE); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0008); -+ wpsielen += 2; -+ -+ /* Value: */ -+ /* Category ID */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_CID_RTK_WIDI); -+ wpsielen += 2; -+ -+ /* OUI */ -+ *(u32 *)(wpsie + wpsielen) = cpu_to_be32(WPSOUI); -+ wpsielen += 4; -+ -+ /* Sub Category ID */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_SCID_RTK_DMP); -+ wpsielen += 2; -+ -+ /* Device Password ID */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_PWID); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); -+ wpsielen += 2; -+ -+ /* Value: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_REGISTRAR_SPEC); /* Registrar-specified */ -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); -+ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Commented by Albert 20110221 */ -+ /* According to the P2P Specification, the probe request frame should contain 5 P2P attributes */ -+ /* 1. P2P Capability */ -+ /* 2. P2P Device ID if this probe request wants to find the specific P2P device */ -+ /* 3. Listen Channel */ -+ /* 4. Extended Listen Timing */ -+ /* 5. Operating Channel if this WiFi is working as the group owner now */ -+ -+ /* P2P Capability */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Device Capability Bitmap, 1 byte */ -+ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; -+ -+ /* Group Capability Bitmap, 1 byte */ -+ if (pwdinfo->persistent_supported) -+ p2pie[p2pielen++] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; -+ else -+ p2pie[p2pielen++] = DMP_P2P_GRPCAP_SUPPORT; -+ -+ /* Listen Channel */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_LISTEN_CH; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x51; /* Copy from SD7 */ -+ -+ /* Channel Number */ -+ p2pie[p2pielen++] = pwdinfo->listen_channel; /* listen channel */ -+ -+ -+ /* Extended Listen Timing */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_EX_LISTEN_TIMING; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0004); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Availability Period */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0xFFFF); -+ p2pielen += 2; -+ -+ /* Availability Interval */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0xFFFF); -+ p2pielen += 2; -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ /* Operating Channel (if this WiFi is working as the group owner now) */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x51; /* Copy from SD7 */ -+ -+ /* Channel Number */ -+ p2pie[p2pielen++] = pwdinfo->operating_channel; /* operating channel number */ -+ -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); -+ -+ } -+ -+#ifdef CONFIG_WFD -+ wfdielen = rtw_append_probe_req_wfd_ie(padapter, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ -+ if (wait_ack) -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+inline void issue_probereq_p2p(_adapter *adapter, u8 *da) -+{ -+ _issue_probereq_p2p(adapter, da, _FALSE); -+} -+ -+/* -+ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ * try_cnt means the maximal TX count to try -+ */ -+int issue_probereq_p2p_ex(_adapter *adapter, u8 *da, int try_cnt, int wait_ms) -+{ -+ int ret; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ -+ do { -+ ret = _issue_probereq_p2p(adapter, da, wait_ms > 0 ? _TRUE : _FALSE); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+#ifndef DBG_XMIT_ACK -+ goto exit; -+#endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ if (da) -+ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(adapter), MAC_ARG(da), rtw_get_oper_ch(adapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ else -+ RTW_INFO(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(adapter), rtw_get_oper_ch(adapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ } -+exit: -+ return ret; -+} -+ -+#endif /* CONFIG_P2P */ -+ -+s32 rtw_action_public_decache(union recv_frame *rframe, u8 token_offset) -+{ -+ _adapter *adapter = rframe->u.hdr.adapter; -+ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); -+ u8 *frame = rframe->u.hdr.rx_data; -+ u16 seq_ctrl = ((rframe->u.hdr.attrib.seq_num & 0xffff) << 4) | (rframe->u.hdr.attrib.frag_num & 0xf); -+ u8 token = *(rframe->u.hdr.rx_data + sizeof(struct rtw_ieee80211_hdr_3addr) + token_offset); -+ -+ if (GetRetry(frame)) { -+ if ((seq_ctrl == mlmeext->action_public_rxseq) -+ && (token == mlmeext->action_public_dialog_token) -+ ) { -+ RTW_INFO(FUNC_ADPT_FMT" seq_ctrl=0x%x, rxseq=0x%x, token:%d\n", -+ FUNC_ADPT_ARG(adapter), seq_ctrl, mlmeext->action_public_rxseq, token); -+ return _FAIL; -+ } -+ } -+ -+ /* TODO: per sta seq & token */ -+ mlmeext->action_public_rxseq = seq_ctrl; -+ mlmeext->action_public_dialog_token = token; -+ -+ return _SUCCESS; -+} -+ -+unsigned int on_action_public_p2p(union recv_frame *precv_frame) -+{ -+ _adapter *padapter = precv_frame->u.hdr.adapter; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ u8 *frame_body; -+#ifdef CONFIG_P2P -+ u8 *p2p_ie; -+ u32 p2p_ielen, wps_ielen; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 result = P2P_STATUS_SUCCESS; -+ u8 empty_addr[ETH_ALEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; -+ u8 *merged_p2pie = NULL; -+ u32 merged_p2p_ielen = 0; -+#endif /* CONFIG_P2P */ -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+#ifdef CONFIG_P2P -+ _cancel_timer_ex(&pwdinfo->reset_ch_sitesurvey); -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) -+ rtw_cfg80211_rx_p2p_action_public(padapter, precv_frame); -+ else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ { -+ /* Do nothing if the driver doesn't enable the P2P function. */ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) -+ return _SUCCESS; -+ -+ len -= sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ switch (frame_body[6]) { /* OUI Subtype */ -+ case P2P_GO_NEGO_REQ: { -+ RTW_INFO("[%s] Got GO Nego Req Frame\n", __FUNCTION__); -+ _rtw_memset(&pwdinfo->groupid_info, 0x00, sizeof(struct group_id_info)); -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ)) -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL)) { -+ /* Commented by Albert 20110526 */ -+ /* In this case, this means the previous nego fail doesn't be reset yet. */ -+ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); -+ /* Restore the previous p2p state */ -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ RTW_INFO("[%s] Restore the previous p2p state to %d\n", __FUNCTION__, rtw_p2p_state(pwdinfo)); -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, _FW_LINKED)) -+ _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ /* Commented by Kurt 20110902 */ -+ /* Add if statement to avoid receiving duplicate prov disc req. such that pre_p2p_state would be covered. */ -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ -+ /* Commented by Kurt 20120113 */ -+ /* Get peer_dev_addr here if peer doesn't issue prov_disc frame. */ -+ if (_rtw_memcmp(pwdinfo->rx_prov_disc_info.peerDevAddr, empty_addr, ETH_ALEN)) -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN); -+ -+ result = process_p2p_group_negotation_req(pwdinfo, frame_body, len); -+ issue_p2p_GO_response(padapter, GetAddr2Ptr(pframe), frame_body, len, result); -+#ifdef CONFIG_INTEL_WIDI -+ if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) { -+ padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; -+ _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL, 0); -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ /* Commented by Albert 20110718 */ -+ /* No matter negotiating or negotiation failure, the driver should set up the restore P2P state timer. */ -+#ifdef CONFIG_CONCURRENT_MODE -+ /* Commented by Albert 20120107 */ -+ _set_timer(&pwdinfo->restore_p2p_state_timer, 3000); -+#else /* CONFIG_CONCURRENT_MODE */ -+ _set_timer(&pwdinfo->restore_p2p_state_timer, 5000); -+#endif /* CONFIG_CONCURRENT_MODE */ -+ break; -+ } -+ case P2P_GO_NEGO_RESP: { -+ RTW_INFO("[%s] Got GO Nego Resp Frame\n", __FUNCTION__); -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) { -+ /* Commented by Albert 20110425 */ -+ /* The restore timer is enabled when issuing the nego request frame of rtw_p2p_connect function. */ -+ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); -+ pwdinfo->nego_req_info.benable = _FALSE; -+ result = process_p2p_group_negotation_resp(pwdinfo, frame_body, len); -+ issue_p2p_GO_confirm(pwdinfo->padapter, GetAddr2Ptr(pframe), result); -+ if (P2P_STATUS_SUCCESS == result) { -+ if (rtw_p2p_role(pwdinfo) == P2P_ROLE_CLIENT) { -+ pwdinfo->p2p_info.operation_ch[0] = pwdinfo->peer_operating_ch; -+#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->p2p_info.operation_ch[1] = 1; /* Check whether GO is operating in channel 1; */ -+ pwdinfo->p2p_info.operation_ch[2] = 6; /* Check whether GO is operating in channel 6; */ -+ pwdinfo->p2p_info.operation_ch[3] = 11; /* Check whether GO is operating in channel 11; */ -+#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ -+ pwdinfo->p2p_info.scan_op_ch_only = 1; -+ _set_timer(&pwdinfo->reset_ch_sitesurvey2, P2P_RESET_SCAN_CH); -+ } -+ } -+ -+ /* Reset the dialog token for group negotiation frames. */ -+ pwdinfo->negotiation_dialog_token = 1; -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL)) -+ _set_timer(&pwdinfo->restore_p2p_state_timer, 5000); -+ } else -+ RTW_INFO("[%s] Skipped GO Nego Resp Frame (p2p_state != P2P_STATE_GONEGO_ING)\n", __FUNCTION__); -+ -+ break; -+ } -+ case P2P_GO_NEGO_CONF: { -+ RTW_INFO("[%s] Got GO Nego Confirm Frame\n", __FUNCTION__); -+ result = process_p2p_group_negotation_confirm(pwdinfo, frame_body, len); -+ if (P2P_STATUS_SUCCESS == result) { -+ if (rtw_p2p_role(pwdinfo) == P2P_ROLE_CLIENT) { -+ pwdinfo->p2p_info.operation_ch[0] = pwdinfo->peer_operating_ch; -+#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->p2p_info.operation_ch[1] = 1; /* Check whether GO is operating in channel 1; */ -+ pwdinfo->p2p_info.operation_ch[2] = 6; /* Check whether GO is operating in channel 6; */ -+ pwdinfo->p2p_info.operation_ch[3] = 11; /* Check whether GO is operating in channel 11; */ -+#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ -+ pwdinfo->p2p_info.scan_op_ch_only = 1; -+ _set_timer(&pwdinfo->reset_ch_sitesurvey2, P2P_RESET_SCAN_CH); -+ } -+ } -+ break; -+ } -+ case P2P_INVIT_REQ: { -+ /* Added by Albert 2010/10/05 */ -+ /* Received the P2P Invite Request frame. */ -+ -+ RTW_INFO("[%s] Got invite request frame!\n", __FUNCTION__); -+ p2p_ie = rtw_get_p2p_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen); -+ if (p2p_ie) { -+ /* Parse the necessary information from the P2P Invitation Request frame. */ -+ /* For example: The MAC address of sending this P2P Invitation Request frame. */ -+ u32 attr_contentlen = 0; -+ u8 status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ struct group_id_info group_id; -+ u8 invitation_flag = 0; -+ int j = 0; -+ -+ merged_p2p_ielen = rtw_get_p2p_merged_ies_len(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_); -+ -+ merged_p2pie = rtw_zmalloc(merged_p2p_ielen + 2); /* 2 is for EID and Length */ -+ if (merged_p2pie == NULL) { -+ RTW_INFO("[%s] Malloc p2p ie fail\n", __FUNCTION__); -+ goto exit; -+ } -+ _rtw_memset(merged_p2pie, 0x00, merged_p2p_ielen); -+ -+ merged_p2p_ielen = rtw_p2p_merge_ies(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, merged_p2pie); -+ -+ rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_INVITATION_FLAGS, &invitation_flag, &attr_contentlen); -+ if (attr_contentlen) { -+ -+ rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_GROUP_BSSID, pwdinfo->p2p_peer_interface_addr, &attr_contentlen); -+ /* Commented by Albert 20120510 */ -+ /* Copy to the pwdinfo->p2p_peer_interface_addr. */ -+ /* So that the WFD UI ( or Sigma ) can get the peer interface address by using the following command. */ -+ /* #> iwpriv wlan0 p2p_get peer_ifa */ -+ /* After having the peer interface address, the sigma can find the correct conf file for wpa_supplicant. */ -+ -+ if (attr_contentlen) { -+ RTW_INFO("[%s] GO's BSSID = %.2X %.2X %.2X %.2X %.2X %.2X\n", __FUNCTION__, -+ pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], -+ pwdinfo->p2p_peer_interface_addr[2], pwdinfo->p2p_peer_interface_addr[3], -+ pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]); -+ } -+ -+ if (invitation_flag & P2P_INVITATION_FLAGS_PERSISTENT) { -+ /* Re-invoke the persistent group. */ -+ -+ _rtw_memset(&group_id, 0x00, sizeof(struct group_id_info)); -+ rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_GROUP_ID, (u8 *) &group_id, &attr_contentlen); -+ if (attr_contentlen) { -+ if (_rtw_memcmp(group_id.go_device_addr, adapter_mac_addr(padapter), ETH_ALEN)) { -+ /* The p2p device sending this p2p invitation request wants this Wi-Fi device to be the persistent GO. */ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_GO); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ status_code = P2P_STATUS_SUCCESS; -+ } else { -+ /* The p2p device sending this p2p invitation request wants to be the persistent GO. */ -+ if (is_matched_in_profilelist(pwdinfo->p2p_peer_interface_addr, &pwdinfo->profileinfo[0])) { -+ u8 operatingch_info[5] = { 0x00 }; -+ if (rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, -+ &attr_contentlen)) { -+ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, (u32)operatingch_info[4]) >= 0) { -+ /* The operating channel is acceptable for this device. */ -+ pwdinfo->rx_invitereq_info.operation_ch[0] = operatingch_info[4]; -+#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->rx_invitereq_info.operation_ch[1] = 1; /* Check whether GO is operating in channel 1; */ -+ pwdinfo->rx_invitereq_info.operation_ch[2] = 6; /* Check whether GO is operating in channel 6; */ -+ pwdinfo->rx_invitereq_info.operation_ch[3] = 11; /* Check whether GO is operating in channel 11; */ -+#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ -+ pwdinfo->rx_invitereq_info.scan_op_ch_only = 1; -+ _set_timer(&pwdinfo->reset_ch_sitesurvey, P2P_RESET_SCAN_CH); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_MATCH); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ status_code = P2P_STATUS_SUCCESS; -+ } else { -+ /* The operating channel isn't supported by this device. */ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_DISMATCH); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ status_code = P2P_STATUS_FAIL_NO_COMMON_CH; -+ _set_timer(&pwdinfo->restore_p2p_state_timer, 3000); -+ } -+ } else { -+ /* Commented by Albert 20121130 */ -+ /* Intel will use the different P2P IE to store the operating channel information */ -+ /* Workaround for Intel WiDi 3.5 */ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_MATCH); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ status_code = P2P_STATUS_SUCCESS; -+ } -+ } else { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_DISMATCH); -+#ifdef CONFIG_INTEL_WIDI -+ _rtw_memcpy(pwdinfo->p2p_peer_device_addr, group_id.go_device_addr , ETH_ALEN); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ status_code = P2P_STATUS_FAIL_UNKNOWN_P2PGROUP; -+ } -+ } -+ } else { -+ RTW_INFO("[%s] P2P Group ID Attribute NOT FOUND!\n", __FUNCTION__); -+ status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ } -+ } else { -+ /* Received the invitation to join a P2P group. */ -+ -+ _rtw_memset(&group_id, 0x00, sizeof(struct group_id_info)); -+ rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_GROUP_ID, (u8 *) &group_id, &attr_contentlen); -+ if (attr_contentlen) { -+ if (_rtw_memcmp(group_id.go_device_addr, adapter_mac_addr(padapter), ETH_ALEN)) { -+ /* In this case, the GO can't be myself. */ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_DISMATCH); -+ status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ } else { -+ /* The p2p device sending this p2p invitation request wants to join an existing P2P group */ -+ /* Commented by Albert 2012/06/28 */ -+ /* In this case, this Wi-Fi device should use the iwpriv command to get the peer device address. */ -+ /* The peer device address should be the destination address for the provisioning discovery request. */ -+ /* Then, this Wi-Fi device should use the iwpriv command to get the peer interface address. */ -+ /* The peer interface address should be the address for WPS mac address */ -+ _rtw_memcpy(pwdinfo->p2p_peer_device_addr, group_id.go_device_addr , ETH_ALEN); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_JOIN); -+ status_code = P2P_STATUS_SUCCESS; -+ } -+ } else { -+ RTW_INFO("[%s] P2P Group ID Attribute NOT FOUND!\n", __FUNCTION__); -+ status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ } -+ } -+ } else { -+ RTW_INFO("[%s] P2P Invitation Flags Attribute NOT FOUND!\n", __FUNCTION__); -+ status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ } -+ -+ RTW_INFO("[%s] status_code = %d\n", __FUNCTION__, status_code); -+ -+ pwdinfo->inviteresp_info.token = frame_body[7]; -+ issue_p2p_invitation_response(padapter, GetAddr2Ptr(pframe), pwdinfo->inviteresp_info.token, status_code); -+ _set_timer(&pwdinfo->restore_p2p_state_timer, 3000); -+ } -+#ifdef CONFIG_INTEL_WIDI -+ if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) { -+ padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; -+ _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL, 0); -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ break; -+ } -+ case P2P_INVIT_RESP: { -+ u8 attr_content = 0x00; -+ u32 attr_contentlen = 0; -+ -+ RTW_INFO("[%s] Got invite response frame!\n", __FUNCTION__); -+ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); -+ p2p_ie = rtw_get_p2p_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen); -+ if (p2p_ie) { -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, &attr_content, &attr_contentlen); -+ -+ if (attr_contentlen == 1) { -+ RTW_INFO("[%s] Status = %d\n", __FUNCTION__, attr_content); -+ pwdinfo->invitereq_info.benable = _FALSE; -+ -+ if (attr_content == P2P_STATUS_SUCCESS) { -+ if (_rtw_memcmp(pwdinfo->invitereq_info.go_bssid, adapter_mac_addr(padapter), ETH_ALEN)) -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ else -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_INVITE_RESP_OK); -+ } else { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_INVITE_RESP_FAIL); -+ } -+ } else { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_INVITE_RESP_FAIL); -+ } -+ } else { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_INVITE_RESP_FAIL); -+ } -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_INVITE_RESP_FAIL)) -+ _set_timer(&pwdinfo->restore_p2p_state_timer, 5000); -+ break; -+ } -+ case P2P_DEVDISC_REQ: -+ -+ process_p2p_devdisc_req(pwdinfo, pframe, len); -+ -+ break; -+ -+ case P2P_DEVDISC_RESP: -+ -+ process_p2p_devdisc_resp(pwdinfo, pframe, len); -+ -+ break; -+ -+ case P2P_PROVISION_DISC_REQ: -+ RTW_INFO("[%s] Got Provisioning Discovery Request Frame\n", __FUNCTION__); -+ process_p2p_provdisc_req(pwdinfo, pframe, len); -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN); -+ -+ /* 20110902 Kurt */ -+ /* Add the following statement to avoid receiving duplicate prov disc req. such that pre_p2p_state would be covered. */ -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ)) -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ); -+ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT); -+#ifdef CONFIG_INTEL_WIDI -+ if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) { -+ padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; -+ _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL, 0); -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ break; -+ -+ case P2P_PROVISION_DISC_RESP: -+ /* Commented by Albert 20110707 */ -+ /* Should we check the pwdinfo->tx_prov_disc_info.bsent flag here?? */ -+ RTW_INFO("[%s] Got Provisioning Discovery Response Frame\n", __FUNCTION__); -+ /* Commented by Albert 20110426 */ -+ /* The restore timer is enabled when issuing the provisioing request frame in rtw_p2p_prov_disc function. */ -+ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_RSP); -+ process_p2p_provdisc_resp(pwdinfo, pframe); -+ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT); -+ break; -+ -+ } -+ } -+ -+ -+exit: -+ -+ if (merged_p2pie) -+ rtw_mfree(merged_p2pie, merged_p2p_ielen + 2); -+#endif /* CONFIG_P2P */ -+ return _SUCCESS; -+} -+ -+unsigned int on_action_public_vendor(union recv_frame *precv_frame) -+{ -+ unsigned int ret = _FAIL; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if (_rtw_memcmp(frame_body + 2, P2P_OUI, 4) == _TRUE) { -+ if (rtw_action_public_decache(precv_frame, 7) == _FAIL) -+ goto exit; -+ -+ if (!hal_chk_wl_func(precv_frame->u.hdr.adapter, WL_FUNC_MIRACAST)) -+ rtw_rframe_del_wfd_ie(precv_frame, 8); -+ -+ ret = on_action_public_p2p(precv_frame); -+ } -+ -+exit: -+ return ret; -+} -+ -+unsigned int on_action_public_default(union recv_frame *precv_frame, u8 action) -+{ -+ unsigned int ret = _FAIL; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 token; -+ _adapter *adapter = precv_frame->u.hdr.adapter; -+ int cnt = 0; -+ char msg[64]; -+ -+ token = frame_body[2]; -+ -+ if (rtw_action_public_decache(precv_frame, 2) == _FAIL) -+ goto exit; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ cnt += sprintf((msg + cnt), "%s(token:%u)", action_public_str(action), token); -+ rtw_cfg80211_rx_action(adapter, precv_frame, msg); -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+unsigned int on_action_public(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int ret = _FAIL; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 category, action; -+ -+ /* check RA matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) -+ goto exit; -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_PUBLIC) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case ACT_PUBLIC_BSSCOEXIST: -+#ifdef CONFIG_80211N_HT -+#ifdef CONFIG_AP_MODE -+ /*20/40 BSS Coexistence Management frame is a Public Action frame*/ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) -+ rtw_process_public_act_bsscoex(padapter, pframe, frame_len); -+#endif /*CONFIG_AP_MODE*/ -+#endif /*CONFIG_80211N_HT*/ -+ break; -+ case ACT_PUBLIC_VENDOR: -+ ret = on_action_public_vendor(precv_frame); -+ break; -+ default: -+ ret = on_action_public_default(precv_frame, action); -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+unsigned int OnAction_ft(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_RTW_80211R -+ u32 ret = _FAIL; -+ u32 frame_len = 0; -+ u8 action_code = 0; -+ u8 category = 0; -+ u8 *pframe = NULL; -+ u8 *pframe_body = NULL; -+ u8 sta_addr[ETH_ALEN] = {0}; -+ u8 *pie = NULL; -+ u32 ft_ie_len = 0; -+ u32 status_code = 0; -+ struct mlme_ext_priv *pmlmeext = NULL; -+ struct mlme_ext_info *pmlmeinfo = NULL; -+ struct mlme_priv *pmlmepriv = NULL; -+ struct wlan_network *proam_target = NULL; -+ ft_priv *pftpriv = NULL; -+ _irqL irqL; -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &(pmlmeext->mlmext_info); -+ pmlmepriv = &padapter->mlmepriv; -+ pftpriv = &pmlmepriv->ftpriv; -+ pframe = precv_frame->u.hdr.rx_data; -+ frame_len = precv_frame->u.hdr.len; -+ pframe_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ category = pframe_body[0]; -+ -+ if (category != RTW_WLAN_CATEGORY_FT) -+ goto exit; -+ -+ action_code = pframe_body[1]; -+ switch (action_code) { -+ case RTW_WLAN_ACTION_FT_RESPONSE: -+ RTW_INFO("FT: %s RTW_WLAN_ACTION_FT_RESPONSE\n", __func__); -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), &pframe_body[2], ETH_ALEN)) { -+ RTW_ERR("FT: Unmatched STA MAC Address "MAC_FMT"\n", MAC_ARG(&pframe_body[2])); -+ goto exit; -+ } -+ -+ status_code = le16_to_cpu(*(u16 *)((SIZE_PTR)pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + 14)); -+ if (status_code != 0) { -+ RTW_ERR("FT: WLAN ACTION FT RESPONSE fail, status: %d\n", status_code); -+ goto exit; -+ } -+ -+ if (is_zero_mac_addr(&pframe_body[8]) || is_broadcast_mac_addr(&pframe_body[8])) { -+ RTW_ERR("FT: Invalid Target MAC Address "MAC_FMT"\n", MAC_ARG(padapter->mlmepriv.roam_tgt_addr)); -+ goto exit; -+ } -+ -+ pie = rtw_get_ie(pframe_body, _MDIE_, &ft_ie_len, frame_len); -+ if (pie) { -+ if (!_rtw_memcmp(&pftpriv->mdid, pie+2, 2)) { -+ RTW_ERR("FT: Invalid MDID\n"); -+ goto exit; -+ } -+ } -+ -+ rtw_set_ft_status(padapter, RTW_FT_REQUESTED_STA); -+ _cancel_timer_ex(&pmlmeext->ft_link_timer); -+ -+ /*Disconnect current AP*/ -+ receive_disconnect(padapter, pmlmepriv->cur_network.network.MacAddress, WLAN_REASON_ACTIVE_ROAM, _FALSE); -+ -+ pftpriv->ft_action_len = frame_len; -+ _rtw_memcpy(pftpriv->ft_action, pframe, rtw_min(frame_len, RTW_MAX_FTIE_SZ)); -+ ret = _SUCCESS; -+ break; -+ case RTW_WLAN_ACTION_FT_REQUEST: -+ case RTW_WLAN_ACTION_FT_CONFIRM: -+ case RTW_WLAN_ACTION_FT_ACK: -+ default: -+ RTW_ERR("FT: Unsupported FT Action!\n"); -+ break; -+ } -+ -+exit: -+ return ret; -+#else -+ return _SUCCESS; -+#endif -+} -+ -+unsigned int OnAction_ht(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 category, action; -+ -+ /* check RA matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) -+ goto exit; -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_HT) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case RTW_WLAN_ACTION_HT_SM_PS: -+#ifdef CONFIG_80211N_HT -+#ifdef CONFIG_AP_MODE -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) -+ rtw_process_ht_action_smps(padapter, GetAddr2Ptr(pframe), frame_body[2]); -+#endif /*CONFIG_AP_MODE*/ -+#endif /*CONFIG_80211N_HT*/ -+ break; -+ case RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING: -+#ifdef CONFIG_BEAMFORMING -+ /*RTW_INFO("RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING\n");*/ -+ beamforming_get_report_frame(padapter, precv_frame); -+#endif /*CONFIG_BEAMFORMING*/ -+ break; -+ default: -+ break; -+ } -+ -+exit: -+ -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_IEEE80211W -+unsigned int OnAction_sa_query(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u16 tid; -+ /* Baron */ -+ -+ RTW_INFO("OnAction_sa_query\n"); -+ -+ switch (pframe[WLAN_HDR_A3_LEN + 1]) { -+ case 0: /* SA Query req */ -+ _rtw_memcpy(&tid, &pframe[WLAN_HDR_A3_LEN + 2], sizeof(u16)); -+ RTW_INFO("OnAction_sa_query request,action=%d, tid=%04x, pframe=%02x-%02x\n" -+ , pframe[WLAN_HDR_A3_LEN + 1], tid, pframe[WLAN_HDR_A3_LEN + 2], pframe[WLAN_HDR_A3_LEN + 3]); -+ issue_action_SA_Query(padapter, GetAddr2Ptr(pframe), 1, tid, IEEE80211W_RIGHT_KEY); -+ break; -+ -+ case 1: /* SA Query rsp */ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta != NULL) -+ _cancel_timer_ex(&psta->dot11w_expire_timer); -+ -+ _rtw_memcpy(&tid, &pframe[WLAN_HDR_A3_LEN + 2], sizeof(u16)); -+ RTW_INFO("OnAction_sa_query response,action=%d, tid=%04x, cancel timer\n", pframe[WLAN_HDR_A3_LEN + 1], tid); -+ break; -+ default: -+ break; -+ } -+ if (0) { -+ int pp; -+ printk("pattrib->pktlen = %d =>", pattrib->pkt_len); -+ for (pp = 0; pp < pattrib->pkt_len; pp++) -+ printk(" %02x ", pframe[pp]); -+ printk("\n"); -+ } -+ -+ return _SUCCESS; -+} -+#endif /* CONFIG_IEEE80211W */ -+ -+unsigned int OnAction_wmm(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ return _SUCCESS; -+} -+ -+unsigned int OnAction_vht(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_80211AC_VHT -+ struct rx_pkt_attrib *prxattrib = &precv_frame->u.hdr.attrib; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ struct rtw_ieee80211_hdr_3addr *whdr = (struct rtw_ieee80211_hdr_3addr *)pframe; -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 category, action; -+ struct sta_info *psta = NULL; -+ -+ /* check RA matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) -+ goto exit; -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_VHT) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING: -+#ifdef CONFIG_BEAMFORMING -+ /*RTW_INFO("RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING\n");*/ -+ beamforming_get_report_frame(padapter, precv_frame); -+#endif /*CONFIG_BEAMFORMING*/ -+ break; -+ case RTW_WLAN_ACTION_VHT_OPMODE_NOTIFICATION: -+ /* CategoryCode(1) + ActionCode(1) + OpModeNotification(1) */ -+ /* RTW_INFO("RTW_WLAN_ACTION_VHT_OPMODE_NOTIFICATION\n"); */ -+ psta = rtw_get_stainfo(&padapter->stapriv, whdr->addr2); -+ if (psta) -+ rtw_process_vht_op_mode_notify(padapter, &frame_body[2], psta); -+ break; -+ case RTW_WLAN_ACTION_VHT_GROUPID_MANAGEMENT: -+#ifdef CONFIG_BEAMFORMING -+ beamforming_get_vht_gid_mgnt_frame(padapter, precv_frame); -+#endif /* CONFIG_BEAMFORMING */ -+ break; -+ default: -+ break; -+ } -+ -+exit: -+#endif /* CONFIG_80211AC_VHT */ -+ -+ return _SUCCESS; -+} -+ -+unsigned int OnAction_p2p(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_P2P -+ u8 *frame_body; -+ u8 category, OUI_Subtype, dialogToken = 0; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ /* check RA matches or not */ -+ if (!_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(pframe), ETH_ALEN)) -+ return _SUCCESS; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ category = frame_body[0]; -+ if (category != RTW_WLAN_CATEGORY_P2P) -+ return _SUCCESS; -+ -+ if (cpu_to_be32(*((u32 *)(frame_body + 1))) != P2POUI) -+ return _SUCCESS; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (adapter_wdev_data(padapter)->p2p_enabled -+ && pwdinfo->driver_interface == DRIVER_CFG80211 -+ ) { -+ rtw_cfg80211_rx_action_p2p(padapter, precv_frame); -+ return _SUCCESS; -+ } else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ { -+ len -= sizeof(struct rtw_ieee80211_hdr_3addr); -+ OUI_Subtype = frame_body[5]; -+ dialogToken = frame_body[6]; -+ -+ switch (OUI_Subtype) { -+ case P2P_NOTICE_OF_ABSENCE: -+ -+ break; -+ -+ case P2P_PRESENCE_REQUEST: -+ -+ process_p2p_presence_req(pwdinfo, pframe, len); -+ -+ break; -+ -+ case P2P_PRESENCE_RESPONSE: -+ -+ break; -+ -+ case P2P_GO_DISC_REQUEST: -+ -+ break; -+ -+ default: -+ break; -+ -+ } -+ } -+#endif /* CONFIG_P2P */ -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnAction(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ int i; -+ unsigned char category; -+ struct action_handler *ptable; -+ unsigned char *frame_body; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ category = frame_body[0]; -+ -+ for (i = 0; i < sizeof(OnAction_tbl) / sizeof(struct action_handler); i++) { -+ ptable = &OnAction_tbl[i]; -+ -+ if (category == ptable->num) -+ ptable->func(padapter, precv_frame); -+ -+ } -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int DoReserved(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ -+ /* RTW_INFO("rcvd mgt frame(%x, %x)\n", (GetFrameSubType(pframe) >> 4), *(unsigned int *)GetAddr1Ptr(pframe)); */ -+ return _SUCCESS; -+} -+ -+struct xmit_frame *_alloc_mgtxmitframe(struct xmit_priv *pxmitpriv, bool once) -+{ -+ struct xmit_frame *pmgntframe; -+ struct xmit_buf *pxmitbuf; -+ -+ if (once) -+ pmgntframe = rtw_alloc_xmitframe_once(pxmitpriv); -+ else -+ pmgntframe = rtw_alloc_xmitframe_ext(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ RTW_INFO(FUNC_ADPT_FMT" alloc xmitframe fail, once:%d\n", FUNC_ADPT_ARG(pxmitpriv->adapter), once); -+ goto exit; -+ } -+ -+ pxmitbuf = rtw_alloc_xmitbuf_ext(pxmitpriv); -+ if (pxmitbuf == NULL) { -+ RTW_INFO(FUNC_ADPT_FMT" alloc xmitbuf fail\n", FUNC_ADPT_ARG(pxmitpriv->adapter)); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ pmgntframe = NULL; -+ goto exit; -+ } -+ -+ pmgntframe->frame_tag = MGNT_FRAMETAG; -+ pmgntframe->pxmitbuf = pxmitbuf; -+ pmgntframe->buf_addr = pxmitbuf->pbuf; -+ pxmitbuf->priv_data = pmgntframe; -+ -+exit: -+ return pmgntframe; -+ -+} -+ -+inline struct xmit_frame *alloc_mgtxmitframe(struct xmit_priv *pxmitpriv) -+{ -+ return _alloc_mgtxmitframe(pxmitpriv, _FALSE); -+} -+ -+inline struct xmit_frame *alloc_mgtxmitframe_once(struct xmit_priv *pxmitpriv) -+{ -+ return _alloc_mgtxmitframe(pxmitpriv, _TRUE); -+} -+ -+ -+/**************************************************************************** -+ -+Following are some TX fuctions for WiFi MLME -+ -+*****************************************************************************/ -+ -+void update_mgnt_tx_rate(_adapter *padapter, u8 rate) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ pmlmeext->tx_rate = rate; -+ /* RTW_INFO("%s(): rate = %x\n",__FUNCTION__, rate); */ -+} -+ -+ -+void update_monitor_frame_attrib(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 wireless_mode; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *pbcmc_sta = NULL; -+ -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); -+ -+ pattrib->hdrlen = 24; -+ pattrib->nr_frags = 1; -+ pattrib->priority = 7; -+ -+ if (pbcmc_sta) -+ pattrib->mac_id = pbcmc_sta->mac_id; -+ else { -+ pattrib->mac_id = 0; -+ RTW_INFO("mgmt use mac_id 0 will affect RA\n"); -+ } -+ pattrib->qsel = QSLT_MGNT; -+ -+ pattrib->pktlen = 0; -+ -+ if (pmlmeext->tx_rate == IEEE80211_CCK_RATE_1MB) -+ wireless_mode = WIRELESS_11B; -+ else -+ wireless_mode = WIRELESS_11G; -+ -+ pattrib->raid = rtw_get_mgntframe_raid(padapter, wireless_mode); -+#ifdef CONFIG_80211AC_VHT -+ if (pHalData->rf_type == RF_1T1R) -+ pattrib->raid = RATEID_IDX_VHT_1SS; -+ else if (pHalData->rf_type == RF_2T2R || pHalData->rf_type == RF_2T4R) -+ pattrib->raid = RATEID_IDX_VHT_2SS; -+ else if (pHalData->rf_type == RF_3T3R) -+ pattrib->raid = RATEID_IDX_VHT_3SS; -+ else -+ pattrib->raid = RATEID_IDX_BGN_40M_1SS; -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ pattrib->rate = MGN_VHT1SS_MCS9; -+#else -+ pattrib->rate = MGN_MCS7; -+#endif -+ -+ pattrib->encrypt = _NO_PRIVACY_; -+ pattrib->bswenc = _FALSE; -+ -+ pattrib->qos_en = _FALSE; -+ pattrib->ht_en = 1; -+ pattrib->bwmode = CHANNEL_WIDTH_20; -+ pattrib->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pattrib->sgi = _FALSE; -+ -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ -+ pattrib->retry_ctrl = _TRUE; -+ -+ pattrib->mbssid = 0; -+ pattrib->hw_ssn_sel = pxmitpriv->hw_ssn_seq_no; -+ -+} -+ -+ -+void update_mgntframe_attrib(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ u8 wireless_mode; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *pbcmc_sta = NULL; -+ /* _rtw_memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); */ -+ -+ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); -+ -+ pattrib->hdrlen = 24; -+ pattrib->nr_frags = 1; -+ pattrib->priority = 7; -+ -+ if (pbcmc_sta) -+ pattrib->mac_id = pbcmc_sta->mac_id; -+ else { -+ pattrib->mac_id = 1; /* use STA's BCMC sta-info macid */ -+ -+ if (MLME_IS_AP(padapter) || MLME_IS_GO(padapter)) -+ RTW_INFO("%s-"ADPT_FMT" get bcmc sta_info fail,use MACID=1\n", __func__, ADPT_ARG(padapter)); -+ } -+ pattrib->qsel = QSLT_MGNT; -+ -+#ifdef CONFIG_MCC_MODE -+ update_mcc_mgntframe_attrib(padapter, pattrib); -+#endif -+ -+ pattrib->pktlen = 0; -+ -+ if (IS_CCK_RATE(pmlmeext->tx_rate)) -+ wireless_mode = WIRELESS_11B; -+ else -+ wireless_mode = WIRELESS_11G; -+ pattrib->raid = rtw_get_mgntframe_raid(padapter, wireless_mode); -+ pattrib->rate = pmlmeext->tx_rate; -+ -+ pattrib->encrypt = _NO_PRIVACY_; -+ pattrib->bswenc = _FALSE; -+ -+ pattrib->qos_en = _FALSE; -+ pattrib->ht_en = _FALSE; -+ pattrib->bwmode = CHANNEL_WIDTH_20; -+ pattrib->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pattrib->sgi = _FALSE; -+ -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ -+ pattrib->retry_ctrl = _TRUE; -+ -+ pattrib->mbssid = 0; -+ pattrib->hw_ssn_sel = pxmitpriv->hw_ssn_seq_no; -+ -+#ifdef CONFIG_BEAMFORMING -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ if (psta) -+ update_attrib_txbf_info(padapter, pattrib, psta); -+#endif -+ -+} -+ -+void update_mgntframe_attrib_addr(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ u8 *pframe; -+ struct pkt_attrib *pattrib = &pmgntframe->attrib; -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(pframe), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(pframe), ETH_ALEN); -+} -+ -+void dump_mgntframe(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ if (RTW_CANNOT_RUN(padapter)) { -+ rtw_free_xmitbuf(&padapter->xmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(&padapter->xmitpriv, pmgntframe); -+ return; -+ } -+ -+ rtw_hal_mgnt_xmit(padapter, pmgntframe); -+} -+ -+s32 dump_mgntframe_and_wait(_adapter *padapter, struct xmit_frame *pmgntframe, int timeout_ms) -+{ -+ s32 ret = _FAIL; -+ _irqL irqL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_buf *pxmitbuf = pmgntframe->pxmitbuf; -+ struct submit_ctx sctx; -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ rtw_free_xmitbuf(&padapter->xmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(&padapter->xmitpriv, pmgntframe); -+ return ret; -+ } -+ -+ rtw_sctx_init(&sctx, timeout_ms); -+ pxmitbuf->sctx = &sctx; -+ -+ ret = rtw_hal_mgnt_xmit(padapter, pmgntframe); -+ -+ if (ret == _SUCCESS) -+ ret = rtw_sctx_wait(&sctx, __func__); -+ -+ _enter_critical(&pxmitpriv->lock_sctx, &irqL); -+ pxmitbuf->sctx = NULL; -+ _exit_critical(&pxmitpriv->lock_sctx, &irqL); -+ -+ return ret; -+} -+ -+s32 dump_mgntframe_and_wait_ack_timeout(_adapter *padapter, struct xmit_frame *pmgntframe, int timeout_ms) -+{ -+#ifdef CONFIG_XMIT_ACK -+ static u8 seq_no = 0; -+ s32 ret = _FAIL; -+ struct xmit_priv *pxmitpriv = &(GET_PRIMARY_ADAPTER(padapter))->xmitpriv; -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ rtw_free_xmitbuf(&padapter->xmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(&padapter->xmitpriv, pmgntframe); -+ return -1; -+ } -+ -+ _enter_critical_mutex(&pxmitpriv->ack_tx_mutex, NULL); -+ pxmitpriv->ack_tx = _TRUE; -+ pxmitpriv->seq_no = seq_no++; -+ pmgntframe->ack_report = 1; -+ rtw_sctx_init(&(pxmitpriv->ack_tx_ops), timeout_ms); -+ if (rtw_hal_mgnt_xmit(padapter, pmgntframe) == _SUCCESS) -+ ret = rtw_sctx_wait(&(pxmitpriv->ack_tx_ops), __func__); -+ -+ pxmitpriv->ack_tx = _FALSE; -+ _exit_critical_mutex(&pxmitpriv->ack_tx_mutex, NULL); -+ -+ return ret; -+#else /* !CONFIG_XMIT_ACK */ -+ dump_mgntframe(padapter, pmgntframe); -+ rtw_msleep_os(50); -+ return _SUCCESS; -+#endif /* !CONFIG_XMIT_ACK */ -+} -+ -+s32 dump_mgntframe_and_wait_ack(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ /* In this case, use 500 ms as the default wait_ack timeout */ -+ return dump_mgntframe_and_wait_ack_timeout(padapter, pmgntframe, 500); -+} -+ -+ -+int update_hidden_ssid(u8 *ies, u32 ies_len, u8 hidden_ssid_mode) -+{ -+ u8 *ssid_ie; -+ sint ssid_len_ori; -+ int len_diff = 0; -+ -+ ssid_ie = rtw_get_ie(ies, WLAN_EID_SSID, &ssid_len_ori, ies_len); -+ -+ /* RTW_INFO("%s hidden_ssid_mode:%u, ssid_ie:%p, ssid_len_ori:%d\n", __FUNCTION__, hidden_ssid_mode, ssid_ie, ssid_len_ori); */ -+ -+ if (ssid_ie && ssid_len_ori > 0) { -+ switch (hidden_ssid_mode) { -+ case 1: { -+ u8 *next_ie = ssid_ie + 2 + ssid_len_ori; -+ u32 remain_len = 0; -+ -+ remain_len = ies_len - (next_ie - ies); -+ -+ ssid_ie[1] = 0; -+ _rtw_memcpy(ssid_ie + 2, next_ie, remain_len); -+ len_diff -= ssid_len_ori; -+ -+ break; -+ } -+ case 2: -+ _rtw_memset(&ssid_ie[2], 0, ssid_len_ori); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ return len_diff; -+} -+ -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+u32 rtw_build_vendor_ie(_adapter *padapter , unsigned char *pframe , u8 mgmt_frame_tyte) -+{ -+ int vendor_ie_num = 0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u32 len = 0; -+ -+ for (vendor_ie_num = 0 ; vendor_ie_num < WLAN_MAX_VENDOR_IE_NUM ; vendor_ie_num++) { -+ if (pmlmepriv->vendor_ielen[vendor_ie_num] > 0 && pmlmepriv->vendor_ie_mask[vendor_ie_num] & mgmt_frame_tyte) { -+ _rtw_memcpy(pframe , pmlmepriv->vendor_ie[vendor_ie_num] , pmlmepriv->vendor_ielen[vendor_ie_num]); -+ pframe += pmlmepriv->vendor_ielen[vendor_ie_num]; -+ len += pmlmepriv->vendor_ielen[vendor_ie_num]; -+ } -+ } -+ -+ return len; -+} -+#endif -+ -+#ifdef CONFIG_AP_MODE -+void issue_beacon(_adapter *padapter, int timeout_ms) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned int rate_len; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+#endif /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P */ -+ -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+#ifdef CONFIG_BCN_ICF -+ pmgntframe = rtw_alloc_bcnxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+#else -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+#endif -+ { -+ RTW_INFO("%s, alloc mgnt frame fail\n", __FUNCTION__); -+ return; -+ } -+#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+#endif /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->qsel = QSLT_BEACON; -+ -+#if defined(CONFIG_CONCURRENT_MODE) && (!defined(CONFIG_SWTIMER_BASED_TXBCN)) -+ if (padapter->hw_port == HW_PORT1) -+ pattrib->mbssid = 1; -+#endif -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ /* pmlmeext->mgnt_seq++; */ -+ SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { -+ /* RTW_INFO("ie len=%d\n", cur_network->IELength); */ -+#ifdef CONFIG_P2P -+ /* for P2P : Primary Device Type & Device Name */ -+ u32 wpsielen = 0, insert_len = 0; -+ u8 *wpsie = NULL; -+ wpsie = rtw_get_wps_ie(cur_network->IEs + _FIXED_IE_LENGTH_, cur_network->IELength - _FIXED_IE_LENGTH_, NULL, &wpsielen); -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && wpsie && wpsielen > 0) { -+ uint wps_offset, remainder_ielen; -+ u8 *premainder_ie, *pframe_wscie; -+ -+ wps_offset = (uint)(wpsie - cur_network->IEs); -+ -+ premainder_ie = wpsie + wpsielen; -+ -+ remainder_ielen = cur_network->IELength - wps_offset - wpsielen; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (pmlmepriv->wps_beacon_ie && pmlmepriv->wps_beacon_ie_len > 0) { -+ _rtw_memcpy(pframe, cur_network->IEs, wps_offset); -+ pframe += wps_offset; -+ pattrib->pktlen += wps_offset; -+ -+ _rtw_memcpy(pframe, pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len); -+ pframe += pmlmepriv->wps_beacon_ie_len; -+ pattrib->pktlen += pmlmepriv->wps_beacon_ie_len; -+ -+ /* copy remainder_ie to pframe */ -+ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pattrib->pktlen += remainder_ielen; -+ } else { -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ pframe += cur_network->IELength; -+ pattrib->pktlen += cur_network->IELength; -+ } -+ } else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ { -+ pframe_wscie = pframe + wps_offset; -+ _rtw_memcpy(pframe, cur_network->IEs, wps_offset + wpsielen); -+ pframe += (wps_offset + wpsielen); -+ pattrib->pktlen += (wps_offset + wpsielen); -+ -+ /* now pframe is end of wsc ie, insert Primary Device Type & Device Name */ -+ /* Primary Device Type */ -+ /* Type: */ -+ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_ATTR_PRIMARY_DEV_TYPE); -+ insert_len += 2; -+ -+ /* Length: */ -+ *(u16 *)(pframe + insert_len) = cpu_to_be16(0x0008); -+ insert_len += 2; -+ -+ /* Value: */ -+ /* Category ID */ -+ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); -+ insert_len += 2; -+ -+ /* OUI */ -+ *(u32 *)(pframe + insert_len) = cpu_to_be32(WPSOUI); -+ insert_len += 4; -+ -+ /* Sub Category ID */ -+ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); -+ insert_len += 2; -+ -+ -+ /* Device Name */ -+ /* Type: */ -+ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); -+ insert_len += 2; -+ -+ /* Length: */ -+ *(u16 *)(pframe + insert_len) = cpu_to_be16(pwdinfo->device_name_len); -+ insert_len += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(pframe + insert_len, pwdinfo->device_name, pwdinfo->device_name_len); -+ insert_len += pwdinfo->device_name_len; -+ -+ -+ /* update wsc ie length */ -+ *(pframe_wscie + 1) = (wpsielen - 2) + insert_len; -+ -+ /* pframe move to end */ -+ pframe += insert_len; -+ pattrib->pktlen += insert_len; -+ -+ /* copy remainder_ie to pframe */ -+ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pattrib->pktlen += remainder_ielen; -+ } -+ } else -+#endif /* CONFIG_P2P */ -+ { -+ int len_diff; -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ len_diff = update_hidden_ssid( -+ pframe + _BEACON_IE_OFFSET_ -+ , cur_network->IELength - _BEACON_IE_OFFSET_ -+ , pmlmeinfo->hidden_ssid_mode -+ ); -+ pframe += (cur_network->IELength + len_diff); -+ pattrib->pktlen += (cur_network->IELength + len_diff); -+ } -+ -+ { -+ u8 *wps_ie; -+ uint wps_ielen; -+ u8 sr = 0; -+ wps_ie = rtw_get_wps_ie(pmgntframe->buf_addr + TXDESC_OFFSET + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_, -+ pattrib->pktlen - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_, NULL, &wps_ielen); -+ if (wps_ie && wps_ielen > 0) -+ rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8 *)(&sr), NULL); -+ if (sr != 0) -+ set_fwstate(pmlmepriv, WIFI_UNDER_WPS); -+ else -+ _clr_fwstate_(pmlmepriv, WIFI_UNDER_WPS); -+ } -+ -+#ifdef CONFIG_P2P -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ u32 len; -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) { -+ len = pmlmepriv->p2p_beacon_ie_len; -+ if (pmlmepriv->p2p_beacon_ie && len > 0) -+ _rtw_memcpy(pframe, pmlmepriv->p2p_beacon_ie, len); -+ } else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ { -+ len = build_beacon_p2p_ie(pwdinfo, pframe); -+ } -+ -+ pframe += len; -+ pattrib->pktlen += len; -+ -+#ifdef CONFIG_WFD -+ len = rtw_append_beacon_wfd_ie(padapter, pframe); -+ pframe += len; -+ pattrib->pktlen += len; -+#endif -+ } -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_BEACON_VENDOR_IE_BIT); -+#endif -+ goto _issue_bcn; -+ -+ } -+ -+ /* below for ad-hoc mode */ -+ -+ /* timestamp will be inserted by hardware */ -+ pframe += 8; -+ pattrib->pktlen += 8; -+ -+ /* beacon interval: 2 bytes */ -+ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /* capability info: 2 bytes */ -+ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pattrib->pktlen); -+ -+ /* supported rates... */ -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pattrib->pktlen); -+ -+ /* DS parameter set */ -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pattrib->pktlen); -+ -+ /* if( (pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) */ -+ { -+ u8 erpinfo = 0; -+ u32 ATIMWindow; -+ /* IBSS Parameter Set... */ -+ /* ATIMWindow = cur->Configuration.ATIMWindow; */ -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pattrib->pktlen); -+ -+ /* ERP IE */ -+ pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pattrib->pktlen); -+ } -+ -+ -+ /* EXTERNDED SUPPORTED RATE */ -+ if (rate_len > 8) -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pattrib->pktlen); -+ -+ -+ /* todo:HT for adhoc */ -+ -+_issue_bcn: -+ -+#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ pmlmepriv->update_bcn = _FALSE; -+ -+ _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+#endif /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ -+ -+ if ((pattrib->pktlen + TXDESC_SIZE) > 512) { -+ RTW_INFO("beacon frame too large\n"); -+ return; -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ /* RTW_INFO("issue bcn_sz=%d\n", pattrib->last_txcmdsz); */ -+ if (timeout_ms > 0) -+ dump_mgntframe_and_wait(padapter, pmgntframe, timeout_ms); -+ else -+ dump_mgntframe(padapter, pmgntframe); -+ -+} -+#endif -+ -+void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probereq) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned char *mac, *bssid; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ u8 *pwps_ie; -+ uint wps_ielen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#endif /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ unsigned int rate_len; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+#endif /* CONFIG_P2P */ -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ if (da == NULL) -+ return; -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ return; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ RTW_INFO("%s, alloc mgnt frame fail\n", __FUNCTION__); -+ return; -+ } -+ -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = adapter_mac_addr(padapter); -+ bssid = cur_network->MacAddress; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(fctrl, WIFI_PROBERSP); -+ -+ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = pattrib->hdrlen; -+ pframe += pattrib->hdrlen; -+ -+ -+ if (cur_network->IELength > MAX_IE_SZ) -+ return; -+ -+#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { -+ pwps_ie = rtw_get_wps_ie(cur_network->IEs + _FIXED_IE_LENGTH_, cur_network->IELength - _FIXED_IE_LENGTH_, NULL, &wps_ielen); -+ -+ /* inerset & update wps_probe_resp_ie */ -+ if ((pmlmepriv->wps_probe_resp_ie != NULL) && pwps_ie && (wps_ielen > 0)) { -+ uint wps_offset, remainder_ielen; -+ u8 *premainder_ie; -+ -+ wps_offset = (uint)(pwps_ie - cur_network->IEs); -+ -+ premainder_ie = pwps_ie + wps_ielen; -+ -+ remainder_ielen = cur_network->IELength - wps_offset - wps_ielen; -+ -+ _rtw_memcpy(pframe, cur_network->IEs, wps_offset); -+ pframe += wps_offset; -+ pattrib->pktlen += wps_offset; -+ -+ wps_ielen = (uint)pmlmepriv->wps_probe_resp_ie[1];/* to get ie data len */ -+ if ((wps_offset + wps_ielen + 2) <= MAX_IE_SZ) { -+ _rtw_memcpy(pframe, pmlmepriv->wps_probe_resp_ie, wps_ielen + 2); -+ pframe += wps_ielen + 2; -+ pattrib->pktlen += wps_ielen + 2; -+ } -+ -+ if ((wps_offset + wps_ielen + 2 + remainder_ielen) <= MAX_IE_SZ) { -+ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pattrib->pktlen += remainder_ielen; -+ } -+ } else { -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ pframe += cur_network->IELength; -+ pattrib->pktlen += cur_network->IELength; -+ } -+ -+ /* retrieve SSID IE from cur_network->Ssid */ -+ { -+ u8 *ssid_ie; -+ sint ssid_ielen; -+ sint ssid_ielen_diff; -+ u8 buf[MAX_IE_SZ]; -+ u8 *ies = pmgntframe->buf_addr + TXDESC_OFFSET + sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ ssid_ie = rtw_get_ie(ies + _FIXED_IE_LENGTH_, _SSID_IE_, &ssid_ielen, -+ (pframe - ies) - _FIXED_IE_LENGTH_); -+ -+ ssid_ielen_diff = cur_network->Ssid.SsidLength - ssid_ielen; -+ -+ if (ssid_ie && cur_network->Ssid.SsidLength) { -+ uint remainder_ielen; -+ u8 *remainder_ie; -+ remainder_ie = ssid_ie + 2; -+ remainder_ielen = (pframe - remainder_ie); -+ -+ if (remainder_ielen > MAX_IE_SZ) { -+ RTW_WARN(FUNC_ADPT_FMT" remainder_ielen > MAX_IE_SZ\n", FUNC_ADPT_ARG(padapter)); -+ remainder_ielen = MAX_IE_SZ; -+ } -+ -+ _rtw_memcpy(buf, remainder_ie, remainder_ielen); -+ _rtw_memcpy(remainder_ie + ssid_ielen_diff, buf, remainder_ielen); -+ *(ssid_ie + 1) = cur_network->Ssid.SsidLength; -+ _rtw_memcpy(ssid_ie + 2, cur_network->Ssid.Ssid, cur_network->Ssid.SsidLength); -+ -+ pframe += ssid_ielen_diff; -+ pattrib->pktlen += ssid_ielen_diff; -+ } -+ } -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_PROBERESP_VENDOR_IE_BIT); -+#endif -+ } else -+#endif -+ { -+ -+ /* timestamp will be inserted by hardware */ -+ pframe += 8; -+ pattrib->pktlen += 8; -+ -+ /* beacon interval: 2 bytes */ -+ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /* capability info: 2 bytes */ -+ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /* below for ad-hoc mode */ -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pattrib->pktlen); -+ -+ /* supported rates... */ -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pattrib->pktlen); -+ -+ /* DS parameter set */ -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pattrib->pktlen); -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { -+ u8 erpinfo = 0; -+ u32 ATIMWindow; -+ /* IBSS Parameter Set... */ -+ /* ATIMWindow = cur->Configuration.ATIMWindow; */ -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pattrib->pktlen); -+ -+ /* ERP IE */ -+ pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pattrib->pktlen); -+ } -+ -+ -+ /* EXTERNDED SUPPORTED RATE */ -+ if (rate_len > 8) -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pattrib->pktlen); -+ -+ -+ /* todo:HT for adhoc */ -+ -+ } -+ -+#ifdef CONFIG_P2P -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) -+ /* IOT issue, When wifi_spec is not set, send probe_resp with P2P IE even if probe_req has no P2P IE */ -+ && (is_valid_p2p_probereq || !padapter->registrypriv.wifi_spec)) { -+ u32 len; -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) { -+ /* if pwdinfo->role == P2P_ROLE_DEVICE will call issue_probersp_p2p() */ -+ len = pmlmepriv->p2p_go_probe_resp_ie_len; -+ if (pmlmepriv->p2p_go_probe_resp_ie && len > 0) -+ _rtw_memcpy(pframe, pmlmepriv->p2p_go_probe_resp_ie, len); -+ } else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ { -+ len = build_probe_resp_p2p_ie(pwdinfo, pframe); -+ } -+ -+ pframe += len; -+ pattrib->pktlen += len; -+ -+#ifdef CONFIG_WFD -+ len = rtw_append_probe_resp_wfd_ie(padapter, pframe); -+ pframe += len; -+ pattrib->pktlen += len; -+#endif -+ } -+#endif /* CONFIG_P2P */ -+ -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ { -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ RTW_INFO("(%s)\n", __FUNCTION__); -+ -+ /* check rc station */ -+ psta = rtw_get_stainfo(pstapriv, da); -+ if (psta && psta->isrc && psta->pid > 0) { -+ u8 RC_OUI[4] = {0x00, 0xE0, 0x4C, 0x0A}; -+ u8 RC_INFO[14] = {0}; -+ /* EID[1] + EID_LEN[1] + RC_OUI[4] + MAC[6] + PairingID[2] + ChannelNum[2] */ -+ u16 cu_ch = (u16)cur_network->Configuration.DSConfig; -+ -+ RTW_INFO("%s, reply rc(pid=0x%x) device "MAC_FMT" in ch=%d\n", __FUNCTION__, -+ psta->pid, MAC_ARG(psta->hwaddr), cu_ch); -+ -+ /* append vendor specific ie */ -+ _rtw_memcpy(RC_INFO, RC_OUI, sizeof(RC_OUI)); -+ _rtw_memcpy(&RC_INFO[4], mac, ETH_ALEN); -+ _rtw_memcpy(&RC_INFO[10], (u8 *)&psta->pid, 2); -+ _rtw_memcpy(&RC_INFO[12], (u8 *)&cu_ch, 2); -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, sizeof(RC_INFO), RC_INFO, &pattrib->pktlen); -+ } -+ } -+#endif /* CONFIG_AUTO_AP_MODE */ -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, bool append_wps, int wait_ack) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned char *mac; -+ unsigned char bssrate[NumRates]; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int bssrate_len = 0; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ goto exit; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = adapter_mac_addr(padapter); -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ if (da) { -+ /* unicast probe request frame */ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, da, ETH_ALEN); -+ } else { -+ /* broadcast probe request frame */ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, bc_addr, ETH_ALEN); -+ } -+ -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_PROBEREQ); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if (pssid) -+ pframe = rtw_set_ie(pframe, _SSID_IE_, pssid->SsidLength, pssid->Ssid, &(pattrib->pktlen)); -+ else -+ pframe = rtw_set_ie(pframe, _SSID_IE_, 0, NULL, &(pattrib->pktlen)); -+ -+ get_rate_set(padapter, bssrate, &bssrate_len); -+ -+ if (bssrate_len > 8) { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); -+ } else -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); -+ -+ if (ch) -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, &ch, &pattrib->pktlen); -+ -+ if (append_wps) { -+ /* add wps_ie for wps2.0 */ -+ if (pmlmepriv->wps_probe_req_ie_len > 0 && pmlmepriv->wps_probe_req_ie) { -+ _rtw_memcpy(pframe, pmlmepriv->wps_probe_req_ie, pmlmepriv->wps_probe_req_ie_len); -+ pframe += pmlmepriv->wps_probe_req_ie_len; -+ pattrib->pktlen += pmlmepriv->wps_probe_req_ie_len; -+ /* pmlmepriv->wps_probe_req_ie_len = 0 ; */ /* reset to zero */ -+ } -+ } -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_PROBEREQ_VENDOR_IE_BIT); -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ -+ if (wait_ack) -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+inline void issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da) -+{ -+ _issue_probereq(padapter, pssid, da, 0, 1, _FALSE); -+} -+ -+/* -+ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ * try_cnt means the maximal TX count to try -+ */ -+int issue_probereq_ex(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, bool append_wps, -+ int try_cnt, int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ goto exit; -+ -+ do { -+ ret = _issue_probereq(padapter, pssid, da, ch, append_wps, wait_ms > 0 ? _TRUE : _FALSE); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+#ifndef DBG_XMIT_ACK -+ goto exit; -+#endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ if (da) -+ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ else -+ RTW_INFO(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ } -+exit: -+ return ret; -+} -+ -+/* if psta == NULL, indiate we are station(client) now... */ -+void issue_auth(_adapter *padapter, struct sta_info *psta, unsigned short status) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned int val32; -+ unsigned short val16; -+ int use_shared_key = 0; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+#ifdef CONFIG_RTW_80211R -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ ft_priv *pftpriv = &pmlmepriv->ftpriv; -+ u8 is_ft_roaming = _FALSE; -+ u8 is_ft_roaming_with_rsn_ie = _TRUE; -+ u8 *pie = NULL; -+ u32 ft_ie_len = 0; -+#endif -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ return; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_AUTH); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ -+ if (psta) { /* for AP mode */ -+#ifdef CONFIG_NATIVEAP_MLME -+ -+ _rtw_memcpy(pwlanhdr->addr1, psta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ -+ /* setting auth algo number */ -+ val16 = (u16)psta->authalg; -+ -+ if (status != _STATS_SUCCESSFUL_) -+ val16 = 0; -+ -+ if (val16) { -+ val16 = cpu_to_le16(val16); -+ use_shared_key = 1; -+ } -+ -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_ALGM_NUM_, (unsigned char *)&val16, &(pattrib->pktlen)); -+ -+ /* setting auth seq number */ -+ val16 = (u16)psta->auth_seq; -+ val16 = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_SEQ_NUM_, (unsigned char *)&val16, &(pattrib->pktlen)); -+ -+ /* setting status code... */ -+ val16 = status; -+ val16 = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&val16, &(pattrib->pktlen)); -+ -+ /* added challenging text... */ -+ if ((psta->auth_seq == 2) && (psta->state & WIFI_FW_AUTH_STATE) && (use_shared_key == 1)) -+ pframe = rtw_set_ie(pframe, _CHLGETXT_IE_, 128, psta->chg_txt, &(pattrib->pktlen)); -+#endif -+ } else { -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ -+#ifdef CONFIG_RTW_80211R -+ /*For Fast BSS Transition */ -+ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { -+ is_ft_roaming = _TRUE; -+ val16 = 2; /* 2: 802.11R FTAA */ -+ val16 = cpu_to_le16(val16); -+ } else -+#endif -+ { -+ /* setting auth algo number */ -+ val16 = (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) ? 1 : 0; /* 0:OPEN System, 1:Shared key */ -+ if (val16) { -+ val16 = cpu_to_le16(val16); -+ use_shared_key = 1; -+ } -+ } -+ -+ /* RTW_INFO("%s auth_algo= %s auth_seq=%d\n",__FUNCTION__,(pmlmeinfo->auth_algo==0)?"OPEN":"SHARED",pmlmeinfo->auth_seq); */ -+ -+ /* setting IV for auth seq #3 */ -+ if ((pmlmeinfo->auth_seq == 3) && (pmlmeinfo->state & WIFI_FW_AUTH_STATE) && (use_shared_key == 1)) { -+ /* RTW_INFO("==> iv(%d),key_index(%d)\n",pmlmeinfo->iv,pmlmeinfo->key_index); */ -+ val32 = ((pmlmeinfo->iv++) | (pmlmeinfo->key_index << 30)); -+ val32 = cpu_to_le32(val32); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *)&val32, &(pattrib->pktlen)); -+ -+ pattrib->iv_len = 4; -+ } -+ -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_ALGM_NUM_, (unsigned char *)&val16, &(pattrib->pktlen)); -+ -+ /* setting auth seq number */ -+ val16 = pmlmeinfo->auth_seq; -+ val16 = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_SEQ_NUM_, (unsigned char *)&val16, &(pattrib->pktlen)); -+ -+ -+ /* setting status code... */ -+ val16 = status; -+ val16 = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&val16, &(pattrib->pktlen)); -+ -+#ifdef CONFIG_RTW_80211R -+ if (is_ft_roaming == _TRUE) { -+ pie = rtw_get_ie(pftpriv->updated_ft_ies, EID_WPA2, &ft_ie_len, pftpriv->updated_ft_ies_len); -+ if (pie) -+ pframe = rtw_set_ie(pframe, EID_WPA2, ft_ie_len, pie+2, &(pattrib->pktlen)); -+ else -+ is_ft_roaming_with_rsn_ie = _FALSE; -+ -+ pie = rtw_get_ie(pftpriv->updated_ft_ies, _MDIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); -+ if (pie) -+ pframe = rtw_set_ie(pframe, _MDIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); -+ -+ pie = rtw_get_ie(pftpriv->updated_ft_ies, _FTIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); -+ if (pie && is_ft_roaming_with_rsn_ie) -+ pframe = rtw_set_ie(pframe, _FTIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); -+ } -+#endif -+ -+ /* then checking to see if sending challenging text... */ -+ if ((pmlmeinfo->auth_seq == 3) && (pmlmeinfo->state & WIFI_FW_AUTH_STATE) && (use_shared_key == 1)) { -+ pframe = rtw_set_ie(pframe, _CHLGETXT_IE_, 128, pmlmeinfo->chg_txt, &(pattrib->pktlen)); -+ -+ SetPrivacy(fctrl); -+ -+ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pattrib->encrypt = _WEP40_; -+ -+ pattrib->icv_len = 4; -+ -+ pattrib->pktlen += pattrib->icv_len; -+ -+ } -+ -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ rtw_wep_encrypt(padapter, (u8 *)pmgntframe); -+ RTW_INFO("%s\n", __FUNCTION__); -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+} -+ -+ -+void issue_asocrsp(_adapter *padapter, unsigned short status, struct sta_info *pstat, int pkt_type) -+{ -+#ifdef CONFIG_AP_MODE -+ struct xmit_frame *pmgntframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct pkt_attrib *pattrib; -+ unsigned char *pbuf, *pframe; -+ unsigned short val, ie_status; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ u8 *ie = pnetwork->IEs; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+#endif /* CONFIG_P2P */ -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ return; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy((void *)GetAddr1Ptr(pwlanhdr), pstat->hwaddr, ETH_ALEN); -+ _rtw_memcpy((void *)GetAddr2Ptr(pwlanhdr), adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy((void *)GetAddr3Ptr(pwlanhdr), get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ if ((pkt_type == WIFI_ASSOCRSP) || (pkt_type == WIFI_REASSOCRSP)) -+ SetFrameSubType(pwlanhdr, pkt_type); -+ else -+ return; -+ -+ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen += pattrib->hdrlen; -+ pframe += pattrib->hdrlen; -+ -+ /* capability */ -+ val = *(unsigned short *)rtw_get_capability_from_ie(ie); -+ -+ pframe = rtw_set_fixed_ie(pframe, _CAPABILITY_ , (unsigned char *)&val, &(pattrib->pktlen)); -+ -+ ie_status = cpu_to_le16(status); -+ pframe = rtw_set_fixed_ie(pframe , _STATUS_CODE_ , (unsigned char *)&ie_status, &(pattrib->pktlen)); -+ -+ val = cpu_to_le16(pstat->aid | BIT(14) | BIT(15)); -+ pframe = rtw_set_fixed_ie(pframe, _ASOC_ID_ , (unsigned char *)&val, &(pattrib->pktlen)); -+ -+ if (pstat->bssratelen <= 8) -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, pstat->bssratelen, pstat->bssrateset, &(pattrib->pktlen)); -+ else { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pstat->bssrateset, &(pattrib->pktlen)); -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (pstat->bssratelen - 8), pstat->bssrateset + 8, &(pattrib->pktlen)); -+ } -+ -+#ifdef CONFIG_IEEE80211W -+ if (status == _STATS_REFUSED_TEMPORARILY_) { -+ u8 timeout_itvl[5]; -+ u32 timeout_interval = 3000; -+ /* Association Comeback time */ -+ timeout_itvl[0] = 0x03; -+ timeout_interval = cpu_to_le32(timeout_interval); -+ _rtw_memcpy(timeout_itvl + 1, &timeout_interval, 4); -+ pframe = rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); -+ } -+#endif /* CONFIG_IEEE80211W */ -+ -+#ifdef CONFIG_80211N_HT -+ if ((pstat->flags & WLAN_STA_HT) && (pmlmepriv->htpriv.ht_option)) { -+ uint ie_len = 0; -+ -+ /* FILL HT CAP INFO IE */ -+ /* p = hostapd_eid_ht_capabilities_info(hapd, p); */ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (pbuf && ie_len > 0) { -+ _rtw_memcpy(pframe, pbuf, ie_len + 2); -+ pframe += (ie_len + 2); -+ pattrib->pktlen += (ie_len + 2); -+ } -+ -+ /* FILL HT ADD INFO IE */ -+ /* p = hostapd_eid_ht_operation(hapd, p); */ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (pbuf && ie_len > 0) { -+ _rtw_memcpy(pframe, pbuf, ie_len + 2); -+ pframe += (ie_len + 2); -+ pattrib->pktlen += (ie_len + 2); -+ } -+ -+ } -+#endif -+ -+ /*adding EXT_CAPAB_IE */ -+ if (pmlmepriv->ext_capab_ie_len > 0) { -+ uint ie_len = 0; -+ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_CAP_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (pbuf && ie_len > 0) { -+ _rtw_memcpy(pframe, pbuf, ie_len + 2); -+ pframe += (ie_len + 2); -+ pattrib->pktlen += (ie_len + 2); -+ } -+ } -+ -+#ifdef CONFIG_80211AC_VHT -+ if ((pstat->flags & WLAN_STA_VHT) && (pmlmepriv->vhtpriv.vht_option) -+ && (pstat->wpa_pairwise_cipher != WPA_CIPHER_TKIP) -+ && (pstat->wpa2_pairwise_cipher != WPA_CIPHER_TKIP)) { -+ u32 ie_len = 0; -+ -+ /* FILL VHT CAP IE */ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, EID_VHTCapability, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (pbuf && ie_len > 0) { -+ _rtw_memcpy(pframe, pbuf, ie_len + 2); -+ pframe += (ie_len + 2); -+ pattrib->pktlen += (ie_len + 2); -+ } -+ -+ /* FILL VHT OPERATION IE */ -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, EID_VHTOperation, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if (pbuf && ie_len > 0) { -+ _rtw_memcpy(pframe, pbuf, ie_len + 2); -+ pframe += (ie_len + 2); -+ pattrib->pktlen += (ie_len + 2); -+ } -+ } -+#endif /* CONFIG_80211AC_VHT */ -+ -+ /* FILL WMM IE */ -+ if ((pstat->flags & WLAN_STA_WME) && (pmlmepriv->qospriv.qos_option)) { -+ uint ie_len = 0; -+ unsigned char WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; -+ -+ for (pbuf = ie + _BEACON_IE_OFFSET_; ; pbuf += (ie_len + 2)) { -+ pbuf = rtw_get_ie(pbuf, _VENDOR_SPECIFIC_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); -+ if (pbuf && _rtw_memcmp(pbuf + 2, WMM_PARA_IE, 6)) { -+ _rtw_memcpy(pframe, pbuf, ie_len + 2); -+ pframe += (ie_len + 2); -+ pattrib->pktlen += (ie_len + 2); -+ -+ break; -+ } -+ -+ if ((pbuf == NULL) || (ie_len == 0)) -+ break; -+ } -+ -+ } -+ -+ -+ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK) -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 6 , REALTEK_96B_IE, &(pattrib->pktlen)); -+ -+ /* add WPS IE ie for wps 2.0 */ -+ if (pmlmepriv->wps_assoc_resp_ie && pmlmepriv->wps_assoc_resp_ie_len > 0) { -+ _rtw_memcpy(pframe, pmlmepriv->wps_assoc_resp_ie, pmlmepriv->wps_assoc_resp_ie_len); -+ -+ pframe += pmlmepriv->wps_assoc_resp_ie_len; -+ pattrib->pktlen += pmlmepriv->wps_assoc_resp_ie_len; -+ } -+ -+#ifdef CONFIG_P2P -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && (pstat->is_p2p_device == _TRUE)) { -+ u32 len; -+ -+ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) { -+ len = 0; -+ if (pmlmepriv->p2p_assoc_resp_ie && pmlmepriv->p2p_assoc_resp_ie_len > 0) { -+ len = pmlmepriv->p2p_assoc_resp_ie_len; -+ _rtw_memcpy(pframe, pmlmepriv->p2p_assoc_resp_ie, len); -+ } -+ } else -+ len = build_assoc_resp_p2p_ie(pwdinfo, pframe, pstat->p2p_status_code); -+ pframe += len; -+ pattrib->pktlen += len; -+ } -+ -+#ifdef CONFIG_WFD -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ wfdielen = rtw_append_assoc_resp_wfd_ie(padapter, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+#endif -+ -+#endif /* CONFIG_P2P */ -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_ASSOCRESP_VENDOR_IE_BIT); -+#endif -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+#endif -+} -+ -+void _issue_assocreq(_adapter *padapter, u8 is_reassoc) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe, *p; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned short val16; -+ unsigned int i, j, ie_len, index = 0; -+ unsigned char rf_type, bssrate[NumRates], sta_bssrate[NumRates]; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int bssrate_len = 0, sta_bssrate_len = 0; -+ u8 vs_ie_length = 0; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 p2pie[255] = { 0x00 }; -+ u16 p2pielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_DFS -+ u16 cap; -+ -+ /* Dot H */ -+ u8 pow_cap_ele[2] = { 0x00 }; -+ u8 sup_ch[30 * 2] = {0x00 }, sup_ch_idx = 0, idx_5g = 2; /* For supported channel */ -+#endif /* CONFIG_DFS */ -+#ifdef CONFIG_RTW_80211R -+ u8 *pie = NULL; -+ u32 ft_ie_len = 0; -+ ft_priv *pftpriv = &pmlmepriv->ftpriv; -+#endif -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ goto exit; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ if (is_reassoc == _TRUE) -+ SetFrameSubType(pframe, WIFI_REASSOCREQ); -+ else -+ SetFrameSubType(pframe, WIFI_ASSOCREQ); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* caps */ -+ -+#ifdef CONFIG_DFS -+ _rtw_memcpy(&cap, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+ cap |= cap_SpecMgmt; -+ _rtw_memcpy(pframe, &cap, 2); -+#else -+ _rtw_memcpy(pframe, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+#endif /* CONFIG_DFS */ -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /* listen interval */ -+ /* todo: listen interval for power saving */ -+ val16 = cpu_to_le16(3); -+ _rtw_memcpy(pframe , (unsigned char *)&val16, 2); -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ /*Construct Current AP Field for Reassoc-Req only*/ -+ if (is_reassoc == _TRUE) { -+ _rtw_memcpy(pframe, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ pframe += ETH_ALEN; -+ pattrib->pktlen += ETH_ALEN; -+ } -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, pmlmeinfo->network.Ssid.SsidLength, pmlmeinfo->network.Ssid.Ssid, &(pattrib->pktlen)); -+ -+#ifdef CONFIG_DFS -+ /* Dot H */ -+ if (pmlmeext->cur_channel > 14) { -+ pow_cap_ele[0] = 13; /* Minimum transmit power capability */ -+ pow_cap_ele[1] = 21; /* Maximum transmit power capability */ -+ pframe = rtw_set_ie(pframe, EID_PowerCap, 2, pow_cap_ele, &(pattrib->pktlen)); -+ -+ /* supported channels */ -+ do { -+ if (pmlmeext->channel_set[sup_ch_idx].ChannelNum <= 14) { -+ sup_ch[0] = 1; /* First channel number */ -+ sup_ch[1] = pmlmeext->channel_set[sup_ch_idx].ChannelNum; /* Number of channel */ -+ } else { -+ sup_ch[idx_5g++] = pmlmeext->channel_set[sup_ch_idx].ChannelNum; -+ sup_ch[idx_5g++] = 1; -+ } -+ sup_ch_idx++; -+ } while (pmlmeext->channel_set[sup_ch_idx].ChannelNum != 0); -+ pframe = rtw_set_ie(pframe, EID_SupportedChannels, idx_5g, sup_ch, &(pattrib->pktlen)); -+ } -+#endif /* CONFIG_DFS */ -+ -+ /* supported rate & extended supported rate */ -+ -+#if 1 /* Check if the AP's supported rates are also supported by STA. */ -+ get_rate_set(padapter, sta_bssrate, &sta_bssrate_len); -+ /* RTW_INFO("sta_bssrate_len=%d\n", sta_bssrate_len); */ -+ -+ if (pmlmeext->cur_channel == 14) /* for JAPAN, channel 14 can only uses B Mode(CCK) */ -+ sta_bssrate_len = 4; -+ -+ -+ /* for (i = 0; i < sta_bssrate_len; i++) { */ -+ /* RTW_INFO("sta_bssrate[%d]=%02X\n", i, sta_bssrate[i]); */ -+ /* } */ -+ -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ if (pmlmeinfo->network.SupportedRates[i] == 0) -+ break; -+ RTW_INFO("network.SupportedRates[%d]=%02X\n", i, pmlmeinfo->network.SupportedRates[i]); -+ } -+ -+ -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ if (pmlmeinfo->network.SupportedRates[i] == 0) -+ break; -+ -+ -+ /* Check if the AP's supported rates are also supported by STA. */ -+ for (j = 0; j < sta_bssrate_len; j++) { -+ /* Avoid the proprietary data rate (22Mbps) of Handlink WSG-4000 AP */ -+ if ((pmlmeinfo->network.SupportedRates[i] | IEEE80211_BASIC_RATE_MASK) -+ == (sta_bssrate[j] | IEEE80211_BASIC_RATE_MASK)) { -+ /* RTW_INFO("match i = %d, j=%d\n", i, j); */ -+ break; -+ } else { -+ /* RTW_INFO("not match: %02X != %02X\n", (pmlmeinfo->network.SupportedRates[i]|IEEE80211_BASIC_RATE_MASK), (sta_bssrate[j]|IEEE80211_BASIC_RATE_MASK)); */ -+ } -+ } -+ -+ if (j == sta_bssrate_len) { -+ /* the rate is not supported by STA */ -+ RTW_INFO("%s(): the rate[%d]=%02X is not supported by STA!\n", __FUNCTION__, i, pmlmeinfo->network.SupportedRates[i]); -+ } else { -+ /* the rate is supported by STA */ -+ bssrate[index++] = pmlmeinfo->network.SupportedRates[i]; -+ } -+ } -+ -+ bssrate_len = index; -+ RTW_INFO("bssrate_len = %d\n", bssrate_len); -+ -+#else /* Check if the AP's supported rates are also supported by STA. */ -+#if 0 -+ get_rate_set(padapter, bssrate, &bssrate_len); -+#else -+ for (bssrate_len = 0; bssrate_len < NumRates; bssrate_len++) { -+ if (pmlmeinfo->network.SupportedRates[bssrate_len] == 0) -+ break; -+ -+ if (pmlmeinfo->network.SupportedRates[bssrate_len] == 0x2C) /* Avoid the proprietary data rate (22Mbps) of Handlink WSG-4000 AP */ -+ break; -+ -+ bssrate[bssrate_len] = pmlmeinfo->network.SupportedRates[bssrate_len]; -+ } -+#endif -+#endif /* Check if the AP's supported rates are also supported by STA. */ -+ -+ if ((bssrate_len == 0) && (pmlmeinfo->network.SupportedRates[0] != 0)) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; /* don't connect to AP if no joint supported rate */ -+ } -+ -+ -+ if (bssrate_len > 8) { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); -+ } else if (bssrate_len > 0) -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); -+ else -+ RTW_INFO("%s: Connect to AP without 11b and 11g data rate!\n", __FUNCTION__); -+ -+ /* vendor specific IE, such as WPA, WMM, WPS */ -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pmlmeinfo->network.IELength;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pmlmeinfo->network.IEs + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: -+ if ((_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) || -+ (_rtw_memcmp(pIE->data, WMM_OUI, 4)) || -+ (_rtw_memcmp(pIE->data, WPS_OUI, 4))) { -+ vs_ie_length = pIE->Length; -+ if ((!padapter->registrypriv.wifi_spec) && (_rtw_memcmp(pIE->data, WPS_OUI, 4))) { -+ /* Commented by Kurt 20110629 */ -+ /* In some older APs, WPS handshake */ -+ /* would be fail if we append vender extensions informations to AP */ -+ -+ vs_ie_length = 14; -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, vs_ie_length, pIE->data, &(pattrib->pktlen)); -+ } -+ break; -+ -+ case EID_WPA2: -+#ifdef CONFIG_RTW_80211R -+ if ((is_reassoc == _TRUE) && (rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { -+ pie = rtw_get_ie(pftpriv->updated_ft_ies, EID_WPA2, &ft_ie_len, pftpriv->updated_ft_ies_len); -+ if (pie) -+ pframe = rtw_set_ie(pframe, EID_WPA2, ft_ie_len, pie+2, &(pattrib->pktlen)); -+ } else -+#endif -+ pframe = rtw_set_ie(pframe, EID_WPA2, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ break; -+#ifdef CONFIG_80211N_HT -+ case EID_HTCapability: -+ if (padapter->mlmepriv.htpriv.ht_option == _TRUE) { -+ if (!(is_ap_in_tkip(padapter))) { -+ _rtw_memcpy(&(pmlmeinfo->HT_caps), pIE->data, sizeof(struct HT_caps_element)); -+ -+ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info = cpu_to_le16(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info); -+ -+ pframe = rtw_set_ie(pframe, EID_HTCapability, pIE->Length , (u8 *)(&(pmlmeinfo->HT_caps)), &(pattrib->pktlen)); -+ } -+ } -+ break; -+ -+ case EID_EXTCapability: -+ if (padapter->mlmepriv.htpriv.ht_option == _TRUE) -+ pframe = rtw_set_ie(pframe, EID_EXTCapability, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ break; -+#endif /* CONFIG_80211N_HT */ -+#ifdef CONFIG_80211AC_VHT -+ case EID_VHTCapability: -+ if (padapter->mlmepriv.vhtpriv.vht_option == _TRUE) -+ pframe = rtw_set_ie(pframe, EID_VHTCapability, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ break; -+ -+ case EID_OpModeNotification: -+ if (padapter->mlmepriv.vhtpriv.vht_option == _TRUE) -+ pframe = rtw_set_ie(pframe, EID_OpModeNotification, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ break; -+#endif /* CONFIG_80211AC_VHT */ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK) -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 6 , REALTEK_96B_IE, &(pattrib->pktlen)); -+ -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_build_assoc_req_wapi_ie(padapter, pframe, pattrib); -+#endif -+ -+ -+#ifdef CONFIG_P2P -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (pmlmepriv->p2p_assoc_req_ie && pmlmepriv->p2p_assoc_req_ie_len > 0) { -+ _rtw_memcpy(pframe, pmlmepriv->p2p_assoc_req_ie, pmlmepriv->p2p_assoc_req_ie_len); -+ pframe += pmlmepriv->p2p_assoc_req_ie_len; -+ pattrib->pktlen += pmlmepriv->p2p_assoc_req_ie_len; -+ } -+ } else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ { -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) { -+ /* Should add the P2P IE in the association request frame. */ -+ /* P2P OUI */ -+ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Commented by Albert 20101109 */ -+ /* According to the P2P Specification, the association request frame should contain 3 P2P attributes */ -+ /* 1. P2P Capability */ -+ /* 2. Extended Listen Timing */ -+ /* 3. Device Info */ -+ /* Commented by Albert 20110516 */ -+ /* 4. P2P Interface */ -+ -+ /* P2P Capability */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Device Capability Bitmap, 1 byte */ -+ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; -+ -+ /* Group Capability Bitmap, 1 byte */ -+ if (pwdinfo->persistent_supported) -+ p2pie[p2pielen++] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; -+ else -+ p2pie[p2pielen++] = DMP_P2P_GRPCAP_SUPPORT; -+ -+ /* Extended Listen Timing */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_EX_LISTEN_TIMING; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0004); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Availability Period */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0xFFFF); -+ p2pielen += 2; -+ -+ /* Availability Interval */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0xFFFF); -+ p2pielen += 2; -+ -+ /* Device Info */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ -+ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(21 + pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* P2P Device Address */ -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* Config Method */ -+ /* This field should be big endian. Noted by P2P specification. */ -+ if ((pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PEER_DISPLAY_PIN) || -+ (pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_SELF_DISPLAY_PIN)) -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_CONFIG_METHOD_DISPLAY); -+ else -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_CONFIG_METHOD_PBC); -+ -+ p2pielen += 2; -+ -+ /* Primary Device Type */ -+ /* Category ID */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); -+ p2pielen += 2; -+ -+ /* OUI */ -+ *(u32 *)(p2pie + p2pielen) = cpu_to_be32(WPSOUI); -+ p2pielen += 4; -+ -+ /* Sub Category ID */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); -+ p2pielen += 2; -+ -+ /* Number of Secondary Device Types */ -+ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ -+ -+ /* Device Name */ -+ /* Type: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); -+ p2pielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len); -+ p2pielen += pwdinfo->device_name_len; -+ -+ /* P2P Interface */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_INTERFACE; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x000D); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN); /* P2P Device Address */ -+ p2pielen += ETH_ALEN; -+ -+ p2pie[p2pielen++] = 1; /* P2P Interface Address Count */ -+ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN); /* P2P Interface Address List */ -+ p2pielen += ETH_ALEN; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); -+ } -+ } -+ -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_WFD -+ wfdielen = rtw_append_assoc_req_wfd_ie(padapter, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_ASSOCREQ_VENDOR_IE_BIT); -+#endif -+#ifdef CONFIG_RTW_80211R -+ if (rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { -+ u8 mdieval[3] = {0}; -+ -+ _rtw_memcpy(mdieval, &(pftpriv->mdid), 2); -+ mdieval[2] = pftpriv->ft_cap; -+ pframe = rtw_set_ie(pframe, _MDIE_, 3, mdieval, &(pattrib->pktlen)); -+ } -+ -+ if (is_reassoc == _TRUE) { -+ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { -+ u8 is_ft_roaming_with_rsn_ie = _TRUE; -+ -+ pie = rtw_get_ie(pftpriv->updated_ft_ies, EID_WPA2, &ft_ie_len, pftpriv->updated_ft_ies_len); -+ if (!pie) -+ is_ft_roaming_with_rsn_ie = _FALSE; -+ -+ pie = rtw_get_ie(pftpriv->updated_ft_ies, _FTIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); -+ if (pie && is_ft_roaming_with_rsn_ie) -+ pframe = rtw_set_ie(pframe, _FTIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); -+ } -+ } -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ -+ ret = _SUCCESS; -+ -+exit: -+ if (ret == _SUCCESS) -+ rtw_buf_update(&pmlmepriv->assoc_req, &pmlmepriv->assoc_req_len, (u8 *)pwlanhdr, pattrib->pktlen); -+ else -+ rtw_buf_free(&pmlmepriv->assoc_req, &pmlmepriv->assoc_req_len); -+ -+ return; -+} -+ -+void issue_assocreq(_adapter *padapter) -+{ -+ _issue_assocreq(padapter, _FALSE); -+} -+ -+void issue_reassocreq(_adapter *padapter) -+{ -+ _issue_assocreq(padapter, _TRUE); -+} -+ -+/* when wait_ack is ture, this function shoule be called at process context */ -+static int _issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int wait_ack) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ -+ /* RTW_INFO("%s:%d\n", __FUNCTION__, power_mode); */ -+ -+ if (!padapter) -+ goto exit; -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ goto exit; -+ -+ pxmitpriv = &(padapter->xmitpriv); -+ pmlmeext = &(padapter->mlmeextpriv); -+ pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = _FALSE; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) -+ SetFrDs(fctrl); -+ else if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) -+ SetToDs(fctrl); -+ -+ if (power_mode) -+ SetPwrMgt(fctrl); -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_DATA_NULL); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if (wait_ack) -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+/* -+ * [IMPORTANT] Don't call this function in interrupt context -+ * -+ * When wait_ms > 0, this function should be called at process context -+ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ * try_cnt means the maximal TX count to try -+ * da == NULL for station mode -+ */ -+int issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_info *psta; -+ u8 macid_sleep_reg_access = _TRUE; -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) { -+ /* driver doesn't access macid sleep reg under MCC */ -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { -+ macid_sleep_reg_access = _FALSE; -+ -+ if (da == NULL) { -+ RTW_INFO("Warning: Do not tx null data to AP under MCC mode\n"); -+ rtw_warn_on(1); -+ } -+ -+ } -+ } -+#endif -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ goto exit; -+ -+ /* da == NULL, assum it's null data for sta to ap*/ -+ if (da == NULL) -+ da = get_my_bssid(&(pmlmeinfo->network)); -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, da); -+ if (psta) { -+ if (macid_sleep_reg_access) { -+ if (power_mode) -+ rtw_hal_macid_sleep(padapter, psta->mac_id); -+ else -+ rtw_hal_macid_wakeup(padapter, psta->mac_id); -+ } -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT ": Can't find sta info for " MAC_FMT ", skip macid %s!!\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), power_mode ? "sleep" : "wakeup"); -+ rtw_warn_on(1); -+ } -+ -+ do { -+ ret = _issue_nulldata(padapter, da, power_mode, wait_ms > 0 ? _TRUE : _FALSE); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+#ifndef DBG_XMIT_ACK -+ goto exit; -+#endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ if (da) -+ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ else -+ RTW_INFO(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ } -+exit: -+ return ret; -+} -+ -+/* -+ * [IMPORTANT] This function run in interrupt context -+ * -+ * The null data packet would be sent without power bit, -+ * and not guarantee success. -+ */ -+s32 issue_nulldata_in_interrupt(PADAPTER padapter, u8 *da, unsigned int power_mode) -+{ -+ int ret; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ /* da == NULL, assum it's null data for sta to ap*/ -+ if (da == NULL) -+ da = get_my_bssid(&(pmlmeinfo->network)); -+ -+ ret = _issue_nulldata(padapter, da, power_mode, _FALSE); -+ -+ return ret; -+} -+ -+/* when wait_ack is ture, this function shoule be called at process context */ -+static int _issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int wait_ack) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl, *qc; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ goto exit; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ pattrib->hdrlen += 2; -+ pattrib->qos_en = _TRUE; -+ pattrib->eosp = 1; -+ pattrib->ack_policy = 0; -+ pattrib->mdata = 0; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) -+ SetFrDs(fctrl); -+ else if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) -+ SetToDs(fctrl); -+ -+ if (pattrib->mdata) -+ SetMData(fctrl); -+ -+ qc = (unsigned short *)(pframe + pattrib->hdrlen - 2); -+ -+ SetPriority(qc, tid); -+ -+ SetEOSP(qc, pattrib->eosp); -+ -+ SetAckpolicy(qc, pattrib->ack_policy); -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if (wait_ack) -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+/* -+ * when wait_ms >0 , this function should be called at process context -+ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ * try_cnt means the maximal TX count to try -+ * da == NULL for station mode -+ */ -+int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int try_cnt, int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ goto exit; -+ -+ /* da == NULL, assum it's null data for sta to ap*/ -+ if (da == NULL) -+ da = get_my_bssid(&(pmlmeinfo->network)); -+ -+ do { -+ ret = _issue_qos_nulldata(padapter, da, tid, wait_ms > 0 ? _TRUE : _FALSE); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+#ifndef DBG_XMIT_ACK -+ goto exit; -+#endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ if (da) -+ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ else -+ RTW_INFO(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ } -+exit: -+ return ret; -+} -+ -+static int _issue_deauth(_adapter *padapter, unsigned char *da, unsigned short reason, u8 wait_ack, u8 key_type) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int ret = _FAIL; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P */ -+ -+ /* RTW_INFO("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); */ -+ -+#ifdef CONFIG_P2P -+ if (!(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) && (pwdinfo->rx_invitereq_info.scan_op_ch_only)) { -+ _cancel_timer_ex(&pwdinfo->reset_ch_sitesurvey); -+ _set_timer(&pwdinfo->reset_ch_sitesurvey, 10); -+ } -+#endif /* CONFIG_P2P */ -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ goto exit; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = _FALSE; -+ pattrib->key_type = key_type; -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_DEAUTH); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ reason = cpu_to_le16(reason); -+ pframe = rtw_set_fixed_ie(pframe, _RSON_CODE_ , (unsigned char *)&reason, &(pattrib->pktlen)); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ -+ if (wait_ack) -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+int issue_deauth(_adapter *padapter, unsigned char *da, unsigned short reason) -+{ -+ RTW_INFO("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); -+ return _issue_deauth(padapter, da, reason, _FALSE, IEEE80211W_RIGHT_KEY); -+} -+ -+#ifdef CONFIG_IEEE80211W -+int issue_deauth_11w(_adapter *padapter, unsigned char *da, unsigned short reason, u8 key_type) -+{ -+ RTW_INFO("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); -+ return _issue_deauth(padapter, da, reason, _FALSE, key_type); -+} -+#endif /* CONFIG_IEEE80211W */ -+ -+/* -+ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ * try_cnt means the maximal TX count to try -+ */ -+int issue_deauth_ex(_adapter *padapter, u8 *da, unsigned short reason, int try_cnt, -+ int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ goto exit; -+ -+ do { -+ ret = _issue_deauth(padapter, da, reason, wait_ms > 0 ? _TRUE : _FALSE, IEEE80211W_RIGHT_KEY); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+#ifndef DBG_XMIT_ACK -+ goto exit; -+#endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ if (da) -+ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ else -+ RTW_INFO(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ } -+exit: -+ return ret; -+} -+ -+void issue_action_spct_ch_switch(_adapter *padapter, u8 *ra, u8 new_ch, u8 ch_offset) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ return; -+ -+ RTW_INFO(FUNC_NDEV_FMT" ra="MAC_FMT", ch:%u, offset:%u\n", -+ FUNC_NDEV_ARG(padapter->pnetdev), MAC_ARG(ra), new_ch, ch_offset); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); /* RA */ -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); /* TA */ -+ _rtw_memcpy(pwlanhdr->addr3, ra, ETH_ALEN); /* DA = RA */ -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* category, action */ -+ { -+ u8 category, action; -+ category = RTW_WLAN_CATEGORY_SPECTRUM_MGMT; -+ action = RTW_WLAN_ACTION_SPCT_CHL_SWITCH; -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ } -+ -+ pframe = rtw_set_ie_ch_switch(pframe, &(pattrib->pktlen), 0, new_ch, 0); -+ pframe = rtw_set_ie_secondary_ch_offset(pframe, &(pattrib->pktlen), -+ hal_ch_offset_to_secondary_ch_offset(ch_offset)); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+} -+ -+#ifdef CONFIG_IEEE80211W -+void issue_action_SA_Query(_adapter *padapter, unsigned char *raddr, unsigned char action, unsigned short tid, u8 key_type) -+{ -+ u8 category = RTW_WLAN_CATEGORY_SA_QUERY; -+ u16 reason_code; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ u8 *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ return; -+ -+ RTW_INFO("%s, %04x\n", __FUNCTION__, tid); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ RTW_INFO("%s: alloc_mgtxmitframe fail\n", __FUNCTION__); -+ return; -+ } -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->key_type = key_type; -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ if (raddr) -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ else -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &category, &pattrib->pktlen); -+ pframe = rtw_set_fixed_ie(pframe, 1, &action, &pattrib->pktlen); -+ -+ switch (action) { -+ case 0: /* SA Query req */ -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)&pmlmeext->sa_query_seq, &pattrib->pktlen); -+ pmlmeext->sa_query_seq++; -+ /* send sa query request to AP, AP should reply sa query response in 1 second */ -+ if (pattrib->key_type == IEEE80211W_RIGHT_KEY) { -+ psta = rtw_get_stainfo(pstapriv, raddr); -+ if (psta != NULL) { -+ /* RTW_INFO("%s, %d, set dot11w_expire_timer\n", __func__, __LINE__); */ -+ _set_timer(&psta->dot11w_expire_timer, 1000); -+ } -+ } -+ break; -+ -+ case 1: /* SA Query rsp */ -+ tid = cpu_to_le16(tid); -+ /* RTW_INFO("rtw_set_fixed_ie, %04x\n", tid); */ -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)&tid, &pattrib->pktlen); -+ break; -+ default: -+ break; -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+} -+#endif /* CONFIG_IEEE80211W */ -+ -+/** -+ * issue_action_ba - internal function to TX Block Ack action frame -+ * @padapter: the adapter to TX -+ * @raddr: receiver address -+ * @action: Block Ack Action -+ * @tid: tid -+ * @size: the announced AMPDU buffer size. used by ADDBA_RESP -+ * @status: status/reason code. used by ADDBA_RESP, DELBA -+ * @initiator: if we are the initiator of AMPDU association. used by DELBA -+ * @wait_ack: used xmit ack -+ * -+ * Returns: -+ * _SUCCESS: No xmit ack is used or acked -+ * _FAIL: not acked when using xmit ack -+ */ -+static int issue_action_ba(_adapter *padapter, unsigned char *raddr, unsigned char action -+ , u8 tid, u8 size, u16 status, u8 initiator, int wait_ack) -+{ -+ int ret = _FAIL; -+ u8 category = RTW_WLAN_CATEGORY_BACK; -+ u16 start_seq; -+ u16 BA_para_set; -+ u16 BA_timeout_value; -+ u16 BA_starting_seqctrl; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ u8 *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+#ifdef CONFIG_80211N_HT -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ goto exit; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ /* _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); */ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ -+ if (category == 3) { -+ switch (action) { -+ case RTW_WLAN_ACTION_ADDBA_REQ: -+ do { -+ pmlmeinfo->dialogToken++; -+ } while (pmlmeinfo->dialogToken == 0); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(pmlmeinfo->dialogToken), &(pattrib->pktlen)); -+ -+#if defined(CONFIG_RTL8188E) && defined(CONFIG_SDIO_HCI) -+ BA_para_set = (0x0802 | ((tid & 0xf) << 2)); /* immediate ack & 16 buffer size */ -+#else -+ BA_para_set = (0x1002 | ((tid & 0xf) << 2)); /* immediate ack & 64 buffer size */ -+#endif -+ -+ BA_para_set = cpu_to_le16(BA_para_set); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_para_set)), &(pattrib->pktlen)); -+ -+ /* BA_timeout_value = 0xffff; */ /* max: 65535 TUs(~ 65 ms) */ -+ BA_timeout_value = 5000;/* ~ 5ms */ -+ BA_timeout_value = cpu_to_le16(BA_timeout_value); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_timeout_value)), &(pattrib->pktlen)); -+ -+ /* if ((psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress)) != NULL) */ -+ psta = rtw_get_stainfo(pstapriv, raddr); -+ if (psta != NULL) { -+ start_seq = (psta->sta_xmitpriv.txseq_tid[tid & 0x07] & 0xfff) + 1; -+ -+ RTW_INFO("BA_starting_seqctrl = %d for TID=%d\n", start_seq, tid & 0x07); -+ -+ psta->BA_starting_seqctrl[tid & 0x07] = start_seq; -+ -+ BA_starting_seqctrl = start_seq << 4; -+ } -+ -+ BA_starting_seqctrl = cpu_to_le16(BA_starting_seqctrl); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_starting_seqctrl)), &(pattrib->pktlen)); -+ break; -+ -+ case RTW_WLAN_ACTION_ADDBA_RESP: -+ pframe = rtw_set_fixed_ie(pframe, 1, &(pmlmeinfo->ADDBA_req.dialog_token), &(pattrib->pktlen)); -+ status = cpu_to_le16(status); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&status), &(pattrib->pktlen)); -+ -+ BA_para_set = le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set); -+ -+ BA_para_set &= ~IEEE80211_ADDBA_PARAM_TID_MASK; -+ BA_para_set |= (tid << 2) & IEEE80211_ADDBA_PARAM_TID_MASK; -+ -+ BA_para_set &= ~RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; -+ BA_para_set |= (size << 6) & RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; -+ -+ if (!padapter->registrypriv.wifi_spec) { -+ if (pregpriv->ampdu_amsdu == 0) /* disabled */ -+ BA_para_set &= ~BIT(0); -+ else if (pregpriv->ampdu_amsdu == 1) /* enabled */ -+ BA_para_set |= BIT(0); -+ } -+ -+ BA_para_set = cpu_to_le16(BA_para_set); -+ -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_para_set)), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(pmlmeinfo->ADDBA_req.BA_timeout_value)), &(pattrib->pktlen)); -+ break; -+ -+ case RTW_WLAN_ACTION_DELBA: -+ BA_para_set = 0; -+ BA_para_set |= (tid << 12) & IEEE80211_DELBA_PARAM_TID_MASK; -+ BA_para_set |= (initiator << 11) & IEEE80211_DELBA_PARAM_INITIATOR_MASK; -+ -+ BA_para_set = cpu_to_le16(BA_para_set); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_para_set)), &(pattrib->pktlen)); -+ status = cpu_to_le16(status); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(status)), &(pattrib->pktlen)); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if (wait_ack) -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+#endif /* CONFIG_80211N_HT */ -+ return ret; -+} -+ -+/** -+ * issue_addba_req - TX ADDBA_REQ -+ * @adapter: the adapter to TX -+ * @ra: receiver address -+ * @tid: tid -+ */ -+inline void issue_addba_req(_adapter *adapter, unsigned char *ra, u8 tid) -+{ -+ issue_action_ba(adapter, ra, RTW_WLAN_ACTION_ADDBA_REQ -+ , tid -+ , 0 /* unused */ -+ , 0 /* unused */ -+ , 0 /* unused */ -+ , _FALSE -+ ); -+ RTW_INFO(FUNC_ADPT_FMT" ra="MAC_FMT" tid=%u\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), tid); -+ -+} -+ -+/** -+ * issue_addba_rsp - TX ADDBA_RESP -+ * @adapter: the adapter to TX -+ * @ra: receiver address -+ * @tid: tid -+ * @status: status code -+ * @size: the announced AMPDU buffer size -+ */ -+inline void issue_addba_rsp(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size) -+{ -+ issue_action_ba(adapter, ra, RTW_WLAN_ACTION_ADDBA_RESP -+ , tid -+ , size -+ , status -+ , 0 /* unused */ -+ , _FALSE -+ ); -+ RTW_INFO(FUNC_ADPT_FMT" ra="MAC_FMT" status=%u, tid=%u, size=%u\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), status, tid, size); -+} -+ -+/** -+ * issue_addba_rsp_wait_ack - TX ADDBA_RESP and wait ack -+ * @adapter: the adapter to TX -+ * @ra: receiver address -+ * @tid: tid -+ * @status: status code -+ * @size: the announced AMPDU buffer size -+ * @try_cnt: the maximal TX count to try -+ * @wait_ms: == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ */ -+inline u8 issue_addba_rsp_wait_ack(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size, int try_cnt, int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(adapter))) -+ goto exit; -+ -+ do { -+ ret = issue_action_ba(adapter, ra, RTW_WLAN_ACTION_ADDBA_RESP -+ , tid -+ , size -+ , status -+ , 0 /* unused */ -+ , _TRUE -+ ); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+#ifndef DBG_XMIT_ACK -+ /* goto exit; */ -+#endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ RTW_INFO(FUNC_ADPT_FMT" ra="MAC_FMT" tid=%u%s, %d/%d in %u ms\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), tid -+ , ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ } -+ -+exit: -+ return ret; -+} -+ -+/** -+ * issue_del_ba - TX DELBA -+ * @adapter: the adapter to TX -+ * @ra: receiver address -+ * @tid: tid -+ * @reason: reason code -+ * @initiator: if we are the initiator of AMPDU association. used by DELBA -+ */ -+inline void issue_del_ba(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator) -+{ -+ issue_action_ba(adapter, ra, RTW_WLAN_ACTION_DELBA -+ , tid -+ , 0 /* unused */ -+ , reason -+ , initiator -+ , _FALSE -+ ); -+ RTW_INFO(FUNC_ADPT_FMT" ra="MAC_FMT" reason=%u, tid=%u, initiator=%u\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), reason, tid, initiator); -+} -+ -+/** -+ * issue_del_ba_ex - TX DELBA with xmit ack options -+ * @adapter: the adapter to TX -+ * @ra: receiver address -+ * @tid: tid -+ * @reason: reason code -+ * @initiator: if we are the initiator of AMPDU association. used by DELBA -+ * @try_cnt: the maximal TX count to try -+ * @wait_ms: == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ */ -+int issue_del_ba_ex(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator -+ , int try_cnt, int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(adapter))) -+ goto exit; -+ -+ do { -+ ret = issue_action_ba(adapter, ra, RTW_WLAN_ACTION_DELBA -+ , tid -+ , 0 /* unused */ -+ , reason -+ , initiator -+ , wait_ms > 0 ? _TRUE : _FALSE -+ ); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+#ifndef DBG_XMIT_ACK -+ /* goto exit; */ -+#endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ RTW_INFO(FUNC_ADPT_FMT" ra="MAC_FMT" reason=%u, tid=%u, initiator=%u%s, %d/%d in %u ms\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), reason, tid, initiator -+ , ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ } -+exit: -+ return ret; -+} -+ -+static void issue_action_BSSCoexistPacket(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ unsigned char category, action; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct wlan_network *pnetwork = NULL; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ u8 InfoContent[16] = {0}; -+ u8 ICS[8][15]; -+#ifdef CONFIG_80211N_HT -+ if ((pmlmepriv->num_FortyMHzIntolerant == 0) || (pmlmepriv->num_sta_no_ht == 0)) -+ return; -+ -+ if (_TRUE == pmlmeinfo->bwmode_updated) -+ return; -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ return; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ -+ category = RTW_WLAN_CATEGORY_PUBLIC; -+ action = ACT_PUBLIC_BSSCOEXIST; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ -+ -+ /* */ -+ if (pmlmepriv->num_FortyMHzIntolerant > 0) { -+ u8 iedata = 0; -+ -+ iedata |= BIT(2);/* 20 MHz BSS Width Request */ -+ -+ pframe = rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); -+ -+ } -+ -+ -+ /* */ -+ _rtw_memset(ICS, 0, sizeof(ICS)); -+ if (pmlmepriv->num_sta_no_ht > 0) { -+ int i; -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ int len; -+ u8 *p; -+ WLAN_BSSID_EX *pbss_network; -+ -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ plist = get_next(plist); -+ -+ pbss_network = (WLAN_BSSID_EX *)&pnetwork->network; -+ -+ p = rtw_get_ie(pbss_network->IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, pbss_network->IELength - _FIXED_IE_LENGTH_); -+ if ((p == NULL) || (len == 0)) { /* non-HT */ -+ if ((pbss_network->Configuration.DSConfig <= 0) || (pbss_network->Configuration.DSConfig > 14)) -+ continue; -+ -+ ICS[0][pbss_network->Configuration.DSConfig] = 1; -+ -+ if (ICS[0][0] == 0) -+ ICS[0][0] = 1; -+ } -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ -+ for (i = 0; i < 8; i++) { -+ if (ICS[i][0] == 1) { -+ int j, k = 0; -+ -+ InfoContent[k] = i; -+ /* SET_BSS_INTOLERANT_ELE_REG_CLASS(InfoContent,i); */ -+ k++; -+ -+ for (j = 1; j <= 14; j++) { -+ if (ICS[i][j] == 1) { -+ if (k < 16) { -+ InfoContent[k] = j; /* channel number */ -+ /* SET_BSS_INTOLERANT_ELE_CHANNEL(InfoContent+k, j); */ -+ k++; -+ } -+ } -+ } -+ -+ pframe = rtw_set_ie(pframe, EID_BSSIntolerantChlReport, k, InfoContent, &(pattrib->pktlen)); -+ -+ } -+ -+ } -+ -+ -+ } -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+#endif /* CONFIG_80211N_HT */ -+} -+ -+/* Spatial Multiplexing Powersave (SMPS) action frame */ -+int _issue_action_SM_PS(_adapter *padapter , unsigned char *raddr , u8 NewMimoPsMode , u8 wait_ack) -+{ -+ -+ int ret = _FAIL; -+ unsigned char category = RTW_WLAN_CATEGORY_HT; -+ u8 action = RTW_WLAN_ACTION_HT_SM_PS; -+ u8 sm_power_control = 0; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ if (NewMimoPsMode == WLAN_HT_CAP_SM_PS_DISABLED) { -+ sm_power_control = sm_power_control & ~(BIT(0)); /* SM Power Save Enable = 0 SM Power Save Disable */ -+ } else if (NewMimoPsMode == WLAN_HT_CAP_SM_PS_STATIC) { -+ sm_power_control = sm_power_control | BIT(0); /* SM Power Save Enable = 1 SM Power Save Enable */ -+ sm_power_control = sm_power_control & ~(BIT(1)); /* SM Mode = 0 Static Mode */ -+ } else if (NewMimoPsMode == WLAN_HT_CAP_SM_PS_DYNAMIC) { -+ sm_power_control = sm_power_control | BIT(0); /* SM Power Save Enable = 1 SM Power Save Enable */ -+ sm_power_control = sm_power_control | BIT(1); /* SM Mode = 1 Dynamic Mode */ -+ } else -+ return ret; -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ return ret; -+ -+ RTW_INFO("%s, sm_power_control=%u, NewMimoPsMode=%u\n", __FUNCTION__ , sm_power_control , NewMimoPsMode); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return ret; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); /* RA */ -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); /* TA */ -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); /* DA = RA */ -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* category, action */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(sm_power_control), &(pattrib->pktlen)); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if (wait_ack) -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+ if (ret != _SUCCESS) -+ RTW_INFO("%s, ack to\n", __func__); -+ -+ return ret; -+} -+ -+/* -+ * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ * try_cnt means the maximal TX count to try -+ */ -+int issue_action_SM_PS_wait_ack(_adapter *padapter, unsigned char *raddr, u8 NewMimoPsMode, int try_cnt, int wait_ms) -+{ -+ int ret = _FAIL; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ -+ if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) -+ goto exit; -+ -+ do { -+ ret = _issue_action_SM_PS(padapter, raddr, NewMimoPsMode , wait_ms > 0 ? _TRUE : _FALSE); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ } while ((i < try_cnt) && ((ret == _FAIL) || (wait_ms == 0))); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+#ifndef DBG_XMIT_ACK -+ goto exit; -+#endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ if (raddr) -+ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", %s , %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(raddr), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ else -+ RTW_INFO(FUNC_ADPT_FMT", %s , %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ } -+exit: -+ -+ return ret; -+} -+ -+int issue_action_SM_PS(_adapter *padapter , unsigned char *raddr , u8 NewMimoPsMode) -+{ -+ RTW_INFO("%s to "MAC_FMT"\n", __func__, MAC_ARG(raddr)); -+ return _issue_action_SM_PS(padapter, raddr, NewMimoPsMode , _FALSE); -+} -+ -+/** -+ * _send_delba_sta_tid - Cancel the AMPDU association for the specific @sta, @tid -+ * @adapter: the adapter to which @sta belongs -+ * @initiator: if we are the initiator of AMPDU association -+ * @sta: the sta to be checked -+ * @tid: the tid to be checked -+ * @force: cancel and send DELBA even when no AMPDU association is setup -+ * @wait_ack: send delba with xmit ack (valid when initiator == 0) -+ * -+ * Returns: -+ * _FAIL if sta is NULL -+ * when initiator is 1, always _SUCCESS -+ * when initiator is 0, _SUCCESS if DELBA is acked -+ */ -+static unsigned int _send_delba_sta_tid(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid -+ , u8 force, int wait_ack) -+{ -+ int ret = _SUCCESS; -+ -+ if (sta == NULL) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if (initiator == 0) { -+ /* recipient */ -+ if (force || sta->recvreorder_ctrl[tid].enable == _TRUE) { -+ u8 ampdu_size_bak = sta->recvreorder_ctrl[tid].ampdu_size; -+ -+ sta->recvreorder_ctrl[tid].enable = _FALSE; -+ sta->recvreorder_ctrl[tid].ampdu_size = RX_AMPDU_SIZE_INVALID; -+ -+ if (rtw_del_rx_ampdu_test_trigger_no_tx_fail()) -+ ret = _FAIL; -+ else if (wait_ack) -+ ret = issue_del_ba_ex(adapter, sta->hwaddr, tid, 37, initiator, 3, 1); -+ else -+ issue_del_ba(adapter, sta->hwaddr, tid, 37, initiator); -+ -+ if (ret == _FAIL && sta->recvreorder_ctrl[tid].enable == _FALSE) -+ sta->recvreorder_ctrl[tid].ampdu_size = ampdu_size_bak; -+ } -+ } else if (initiator == 1) { -+ /* originator */ -+#ifdef CONFIG_80211N_HT -+ if (force || sta->htpriv.agg_enable_bitmap & BIT(tid)) { -+ sta->htpriv.agg_enable_bitmap &= ~BIT(tid); -+ sta->htpriv.candidate_tid_bitmap &= ~BIT(tid); -+ issue_del_ba(adapter, sta->hwaddr, tid, 37, initiator); -+ } -+#endif -+ } -+ -+exit: -+ return ret; -+} -+ -+inline unsigned int send_delba_sta_tid(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid -+ , u8 force) -+{ -+ return _send_delba_sta_tid(adapter, initiator, sta, tid, force, 0); -+} -+ -+inline unsigned int send_delba_sta_tid_wait_ack(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid -+ , u8 force) -+{ -+ return _send_delba_sta_tid(adapter, initiator, sta, tid, force, 1); -+} -+ -+unsigned int send_delba(_adapter *padapter, u8 initiator, u8 *addr) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u16 tid; -+ -+ if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) -+ if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) -+ return _SUCCESS; -+ -+ psta = rtw_get_stainfo(pstapriv, addr); -+ if (psta == NULL) -+ return _SUCCESS; -+ -+#if 0 -+ RTW_INFO("%s:%s\n", __func__, (initiator == 0) ? "RX_DIR" : "TX_DIR"); -+ if (initiator == 1) /* originator */ -+ RTW_INFO("tx agg_enable_bitmap(0x%08x)\n", psta->htpriv.agg_enable_bitmap); -+#endif -+ -+ for (tid = 0; tid < TID_NUM; tid++) -+ send_delba_sta_tid(padapter, initiator, psta, tid, 0); -+ -+ return _SUCCESS; -+} -+ -+unsigned int send_beacon(_adapter *padapter) -+{ -+ u8 bxmitok = _FALSE; -+ int issue = 0; -+ int poll = 0; -+#ifdef CONFIG_AP_MODE -+#if defined(CONFIG_PCI_HCI) && defined(RTL8814AE_SW_BCN) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ -+ /* 8192EE Port select for Beacon DL */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ -+ issue_beacon(padapter, 0); -+ -+#ifdef RTL8814AE_SW_BCN -+ if (pHalData->bCorrectBCN != 0) -+ RTW_INFO("%s, line%d, Warnning, pHalData->bCorrectBCN != 0\n", __func__, __LINE__); -+ pHalData->bCorrectBCN = 1; -+#endif -+ -+ return _SUCCESS; -+#endif -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ u32 start = rtw_get_current_time(); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ do { -+ issue_beacon(padapter, 100); -+ issue++; -+ do { -+ rtw_yield_os(); -+ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8 *)(&bxmitok)); -+ poll++; -+ } while ((poll % 10) != 0 && _FALSE == bxmitok && !RTW_CANNOT_RUN(padapter)); -+ -+ } while (_FALSE == bxmitok && issue < 100 && !RTW_CANNOT_RUN(padapter)); -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ return _FAIL; -+ -+ -+ if (_FALSE == bxmitok) { -+ RTW_INFO("%s fail! %u ms\n", __FUNCTION__, rtw_get_passing_time_ms(start)); -+ return _FAIL; -+ } else { -+ u32 passing_time = rtw_get_passing_time_ms(start); -+ -+ if (passing_time > 100 || issue > 3) -+ RTW_INFO("%s success, issue:%d, poll:%d, %u ms\n", __FUNCTION__, issue, poll, rtw_get_passing_time_ms(start)); -+ else if (0) -+ RTW_INFO("%s success, issue:%d, poll:%d, %u ms\n", __FUNCTION__, issue, poll, rtw_get_passing_time_ms(start)); -+ -+ rtw_hal_fw_correct_bcn(padapter); -+ -+ return _SUCCESS; -+ } -+ -+#endif -+#else /* CONFIG_AP_MODE */ -+ return _FAIL; -+#endif /* !CONFIG_AP_MODE */ -+} -+ -+/**************************************************************************** -+ -+Following are some utitity fuctions for WiFi MLME -+ -+*****************************************************************************/ -+ -+BOOLEAN IsLegal5GChannel( -+ IN PADAPTER Adapter, -+ IN u8 channel) -+{ -+ -+ int i = 0; -+ u8 Channel_5G[45] = {36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, -+ 60, 62, 64, 100, 102, 104, 106, 108, 110, 112, 114, 116, 118, 120, 122, -+ 124, 126, 128, 130, 132, 134, 136, 138, 140, 149, 151, 153, 155, 157, 159, -+ 161, 163, 165 -+ }; -+ for (i = 0; i < sizeof(Channel_5G); i++) -+ if (channel == Channel_5G[i]) -+ return _TRUE; -+ return _FALSE; -+} -+ -+/* collect bss info from Beacon and Probe request/response frames. */ -+u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSID_EX *bssid) -+{ -+ int i; -+ u32 len; -+ u8 *p; -+ u16 val16, subtype; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u32 packet_len = precv_frame->u.hdr.len; -+ u8 ie_offset; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ len = packet_len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if (len > MAX_IE_SZ) { -+ /* RTW_INFO("IE too long for survey event\n"); */ -+ return _FAIL; -+ } -+ -+ _rtw_memset(bssid, 0, sizeof(WLAN_BSSID_EX)); -+ -+ subtype = GetFrameSubType(pframe); -+ -+ if (subtype == WIFI_BEACON) { -+ bssid->Reserved[0] = 1; -+ ie_offset = _BEACON_IE_OFFSET_; -+ } else { -+ /* FIXME : more type */ -+ if (subtype == WIFI_PROBERSP) { -+ ie_offset = _PROBERSP_IE_OFFSET_; -+ bssid->Reserved[0] = 3; -+ } else if (subtype == WIFI_PROBEREQ) { -+ ie_offset = _PROBEREQ_IE_OFFSET_; -+ bssid->Reserved[0] = 2; -+ } else { -+ bssid->Reserved[0] = 0; -+ ie_offset = _FIXED_IE_LENGTH_; -+ } -+ } -+ -+ bssid->Length = sizeof(WLAN_BSSID_EX) - MAX_IE_SZ + len; -+ -+ /* below is to copy the information element */ -+ bssid->IELength = len; -+ _rtw_memcpy(bssid->IEs, (pframe + sizeof(struct rtw_ieee80211_hdr_3addr)), bssid->IELength); -+ -+ /* get the signal strength */ -+ /* bssid->Rssi = precv_frame->u.hdr.attrib.SignalStrength; */ /* 0-100 index. */ -+ bssid->Rssi = precv_frame->u.hdr.attrib.phy_info.RecvSignalPower; /* in dBM.raw data */ -+ bssid->PhyInfo.SignalQuality = precv_frame->u.hdr.attrib.phy_info.SignalQuality;/* in percentage */ -+ bssid->PhyInfo.SignalStrength = precv_frame->u.hdr.attrib.phy_info.SignalStrength;/* in percentage */ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ rtw_hal_get_odm_var(padapter, HAL_ODM_ANTDIV_SELECT, &(bssid->PhyInfo.Optimum_antenna), NULL); -+#endif -+ -+ /* checking SSID */ -+ p = rtw_get_ie(bssid->IEs + ie_offset, _SSID_IE_, &len, bssid->IELength - ie_offset); -+ if (p == NULL) { -+ RTW_INFO("marc: cannot find SSID for survey event\n"); -+ return _FAIL; -+ } -+ -+ if (*(p + 1)) { -+ if (len > NDIS_802_11_LENGTH_SSID) { -+ RTW_INFO("%s()-%d: IE too long (%d) for survey event\n", __FUNCTION__, __LINE__, len); -+ return _FAIL; -+ } -+ _rtw_memcpy(bssid->Ssid.Ssid, (p + 2), *(p + 1)); -+ bssid->Ssid.SsidLength = *(p + 1); -+ } else -+ bssid->Ssid.SsidLength = 0; -+ -+ _rtw_memset(bssid->SupportedRates, 0, NDIS_802_11_LENGTH_RATES_EX); -+ -+ /* checking rate info... */ -+ i = 0; -+ p = rtw_get_ie(bssid->IEs + ie_offset, _SUPPORTEDRATES_IE_, &len, bssid->IELength - ie_offset); -+ if (p != NULL) { -+ if (len > NDIS_802_11_LENGTH_RATES_EX) { -+ RTW_INFO("%s()-%d: IE too long (%d) for survey event\n", __FUNCTION__, __LINE__, len); -+ return _FAIL; -+ } -+ _rtw_memcpy(bssid->SupportedRates, (p + 2), len); -+ i = len; -+ } -+ -+ p = rtw_get_ie(bssid->IEs + ie_offset, _EXT_SUPPORTEDRATES_IE_, &len, bssid->IELength - ie_offset); -+ if (p != NULL) { -+ if (len > (NDIS_802_11_LENGTH_RATES_EX - i)) { -+ RTW_INFO("%s()-%d: IE too long (%d) for survey event\n", __FUNCTION__, __LINE__, len); -+ return _FAIL; -+ } -+ _rtw_memcpy(bssid->SupportedRates + i, (p + 2), len); -+ } -+ -+ /* todo: */ -+#if 0 -+ if (judge_network_type(bssid->SupportedRates, (len + i)) == WIRELESS_11B) -+ bssid->NetworkTypeInUse = Ndis802_11DS; -+ else -+#endif -+ { -+ bssid->NetworkTypeInUse = Ndis802_11OFDM24; -+ } -+ -+#ifdef CONFIG_P2P -+ if (subtype == WIFI_PROBEREQ) { -+ u8 *p2p_ie; -+ u32 p2p_ielen; -+ /* Set Listion Channel */ -+ p2p_ie = rtw_get_p2p_ie(bssid->IEs, bssid->IELength, NULL, &p2p_ielen); -+ if (p2p_ie) { -+ u32 attr_contentlen = 0; -+ u8 listen_ch[5] = { 0x00 }; -+ -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, listen_ch, &attr_contentlen); -+ bssid->Configuration.DSConfig = listen_ch[4]; -+ } else { -+ /* use current channel */ -+ bssid->Configuration.DSConfig = padapter->mlmeextpriv.cur_channel; -+ RTW_INFO("%s()-%d: Cannot get p2p_ie. set DSconfig to op_ch(%d)\n", __FUNCTION__, __LINE__, bssid->Configuration.DSConfig); -+ } -+ -+ /* FIXME */ -+ bssid->InfrastructureMode = Ndis802_11Infrastructure; -+ _rtw_memcpy(bssid->MacAddress, GetAddr2Ptr(pframe), ETH_ALEN); -+ bssid->Privacy = 1; -+ return _SUCCESS; -+ } -+#endif /* CONFIG_P2P */ -+ -+ if (bssid->IELength < 12) -+ return _FAIL; -+ -+ /* Checking for DSConfig */ -+ p = rtw_get_ie(bssid->IEs + ie_offset, _DSSET_IE_, &len, bssid->IELength - ie_offset); -+ -+ bssid->Configuration.DSConfig = 0; -+ bssid->Configuration.Length = 0; -+ -+ if (p) -+ bssid->Configuration.DSConfig = *(p + 2); -+ else { -+ /* In 5G, some ap do not have DSSET IE */ -+ /* checking HT info for channel */ -+ p = rtw_get_ie(bssid->IEs + ie_offset, _HT_ADD_INFO_IE_, &len, bssid->IELength - ie_offset); -+ if (p) { -+ struct HT_info_element *HT_info = (struct HT_info_element *)(p + 2); -+ bssid->Configuration.DSConfig = HT_info->primary_channel; -+ } else { -+ /* use current channel */ -+ bssid->Configuration.DSConfig = rtw_get_oper_ch(padapter); -+ } -+ } -+ -+ _rtw_memcpy(&bssid->Configuration.BeaconPeriod, rtw_get_beacon_interval_from_ie(bssid->IEs), 2); -+ bssid->Configuration.BeaconPeriod = le32_to_cpu(bssid->Configuration.BeaconPeriod); -+ -+ val16 = rtw_get_capability((WLAN_BSSID_EX *)bssid); -+ -+ if (val16 & BIT(0)) { -+ bssid->InfrastructureMode = Ndis802_11Infrastructure; -+ _rtw_memcpy(bssid->MacAddress, GetAddr2Ptr(pframe), ETH_ALEN); -+ } else { -+ bssid->InfrastructureMode = Ndis802_11IBSS; -+ _rtw_memcpy(bssid->MacAddress, GetAddr3Ptr(pframe), ETH_ALEN); -+ } -+ -+ if (val16 & BIT(4)) -+ bssid->Privacy = 1; -+ else -+ bssid->Privacy = 0; -+ -+ bssid->Configuration.ATIMWindow = 0; -+ -+ /* 20/40 BSS Coexistence check */ -+ if ((pregistrypriv->wifi_spec == 1) && (_FALSE == pmlmeinfo->bwmode_updated)) { -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_80211N_HT -+ p = rtw_get_ie(bssid->IEs + ie_offset, _HT_CAPABILITY_IE_, &len, bssid->IELength - ie_offset); -+ if (p && len > 0) { -+ struct HT_caps_element *pHT_caps; -+ pHT_caps = (struct HT_caps_element *)(p + 2); -+ -+ if (pHT_caps->u.HT_cap_element.HT_caps_info & BIT(14)) -+ pmlmepriv->num_FortyMHzIntolerant++; -+ } else -+ pmlmepriv->num_sta_no_ht++; -+#endif /* CONFIG_80211N_HT */ -+ -+ } -+ -+#ifdef CONFIG_INTEL_WIDI -+ /* process_intel_widi_query_or_tigger(padapter, bssid); */ -+ if (process_intel_widi_query_or_tigger(padapter, bssid)) -+ return _FAIL; -+#endif /* CONFIG_INTEL_WIDI */ -+ -+#if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) & 1 -+ if (strcmp(bssid->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { -+ RTW_INFO("Receiving %s("MAC_FMT", DSConfig:%u) from ch%u with ss:%3u, sq:%3u, RawRSSI:%3ld\n" -+ , bssid->Ssid.Ssid, MAC_ARG(bssid->MacAddress), bssid->Configuration.DSConfig -+ , rtw_get_oper_ch(padapter) -+ , bssid->PhyInfo.SignalStrength, bssid->PhyInfo.SignalQuality, bssid->Rssi -+ ); -+ } -+#endif -+ -+ /* mark bss info receving from nearby channel as SignalQuality 101 */ -+ if (bssid->Configuration.DSConfig != rtw_get_oper_ch(padapter)) -+ bssid->PhyInfo.SignalQuality = 101; -+ -+ return _SUCCESS; -+} -+ -+void start_create_ibss(_adapter *padapter) -+{ -+ unsigned short caps; -+ u8 val8; -+ u8 join_type; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+ u8 doiqk = _FALSE; -+ pmlmeext->cur_channel = (u8)pnetwork->Configuration.DSConfig; -+ pmlmeinfo->bcn_interval = get_beacon_interval(pnetwork); -+ -+ /* update wireless mode */ -+ update_wireless_mode(padapter); -+ -+ /* udpate capability */ -+ caps = rtw_get_capability((WLAN_BSSID_EX *)pnetwork); -+ update_capinfo(padapter, caps); -+ if (caps & cap_IBSS) { /* adhoc master */ -+ /* set_opmode_cmd(padapter, adhoc); */ /* removed */ -+ -+ val8 = 0xcf; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+ doiqk = _TRUE; -+ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); -+ -+ /* switch channel */ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ -+ doiqk = _FALSE; -+ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); -+ -+ beacon_timing_control(padapter); -+ -+ /* set msr to WIFI_FW_ADHOC_STATE */ -+ pmlmeinfo->state = WIFI_FW_ADHOC_STATE; -+ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); -+ -+ /* issue beacon */ -+ if (send_beacon(padapter) == _FAIL) { -+ -+ report_join_res(padapter, -1); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ } else { -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, padapter->registrypriv.dev_network.MacAddress); -+ join_type = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ -+ report_join_res(padapter, 1); -+ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ rtw_indicate_connect(padapter); -+ } -+ } else { -+ RTW_INFO("start_create_ibss, invalid cap:%x\n", caps); -+ return; -+ } -+ /* update bc/mc sta_info */ -+#ifdef CONFIG_AP_MODE -+ update_bmc_sta(padapter); -+#endif /* CONFIG_AP_MODE */ -+ -+} -+ -+void start_clnt_join(_adapter *padapter) -+{ -+ unsigned short caps; -+ u8 val8; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+ int beacon_timeout; -+ u8 ASIX_ID[] = {0x00, 0x0E, 0xC6}; -+ -+ /* update wireless mode */ -+ update_wireless_mode(padapter); -+ -+ /* udpate capability */ -+ caps = rtw_get_capability((WLAN_BSSID_EX *)pnetwork); -+ update_capinfo(padapter, caps); -+ -+ /* check if sta is ASIX peer and fix IOT issue if it is. */ -+ if (_rtw_memcmp(get_my_bssid(&pmlmeinfo->network) , ASIX_ID , 3)) { -+ u8 iot_flag = _TRUE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_ASIX_IOT, (u8 *)(&iot_flag)); -+ } -+ -+ if (caps & cap_ESS) { -+ Set_MSR(padapter, WIFI_FW_STATION_STATE); -+ -+ val8 = (pmlmeinfo->auth_algo == dot11AuthAlgrthm_8021X) ? 0xcc : 0xcf; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (padapter->wapiInfo.bWapiEnable && pmlmeinfo->auth_algo == dot11AuthAlgrthm_WAPI) { -+ /* Disable TxUseDefaultKey, RxUseDefaultKey, RxBroadcastUseDefaultKey. */ -+ val8 = 0x4c; -+ } -+#endif -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+#ifdef CONFIG_DEAUTH_BEFORE_CONNECT -+ /* Because of AP's not receiving deauth before */ -+ /* AP may: 1)not response auth or 2)deauth us after link is complete */ -+ /* issue deauth before issuing auth to deal with the situation */ -+ -+ /* Commented by Albert 2012/07/21 */ -+ /* For the Win8 P2P connection, it will be hard to have a successful connection if this Wi-Fi doesn't connect to it. */ -+ { -+#ifdef CONFIG_P2P -+ _queue *queue = &(padapter->mlmepriv.scanned_queue); -+ _list *head = get_list_head(queue); -+ _list *pos = get_next(head); -+ struct wlan_network *scanned = NULL; -+ u8 ie_offset = 0; -+ _irqL irqL; -+ bool has_p2p_ie = _FALSE; -+ -+ _enter_critical_bh(&(padapter->mlmepriv.scanned_queue.lock), &irqL); -+ -+ for (pos = get_next(head); !rtw_end_of_queue_search(head, pos); pos = get_next(pos)) { -+ -+ scanned = LIST_CONTAINOR(pos, struct wlan_network, list); -+ -+ if (_rtw_memcmp(&(scanned->network.Ssid), &(pnetwork->Ssid), sizeof(NDIS_802_11_SSID)) == _TRUE -+ && _rtw_memcmp(scanned->network.MacAddress, pnetwork->MacAddress, sizeof(NDIS_802_11_MAC_ADDRESS)) == _TRUE -+ ) { -+ ie_offset = (scanned->network.Reserved[0] == 2 ? 0 : 12); -+ if (rtw_get_p2p_ie(scanned->network.IEs + ie_offset, scanned->network.IELength - ie_offset, NULL, NULL)) -+ has_p2p_ie = _TRUE; -+ break; -+ } -+ } -+ -+ _exit_critical_bh(&(padapter->mlmepriv.scanned_queue.lock), &irqL); -+ -+ if (scanned == NULL || rtw_end_of_queue_search(head, pos) || has_p2p_ie == _FALSE) -+#endif /* CONFIG_P2P */ -+ /* To avoid connecting to AP fail during resume process, change retry count from 5 to 1 */ -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); -+ } -+#endif /* CONFIG_DEAUTH_BEFORE_CONNECT */ -+ -+ /* here wait for receiving the beacon to start auth */ -+ /* and enable a timer */ -+ beacon_timeout = decide_wait_for_beacon_timeout(pmlmeinfo->bcn_interval); -+ set_link_timer(pmlmeext, beacon_timeout); -+ _set_timer(&padapter->mlmepriv.assoc_timer, -+ (REAUTH_TO * REAUTH_LIMIT) + (REASSOC_TO * REASSOC_LIMIT) + beacon_timeout); -+ -+#ifdef CONFIG_RTW_80211R -+ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { -+ if (rtw_chk_ft_flags(padapter, RTW_FT_OVER_DS_SUPPORTED)) { -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ ft_priv *pftpriv = &pmlmepriv->ftpriv; -+ -+ pmlmeinfo->state = WIFI_FW_AUTH_SUCCESS | WIFI_FW_STATION_STATE; -+ pftpriv->ft_event.ies = pftpriv->ft_action + sizeof(struct rtw_ieee80211_hdr_3addr) + 16; -+ pftpriv->ft_event.ies_len = pftpriv->ft_action_len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /*Not support RIC*/ -+ pftpriv->ft_event.ric_ies = NULL; -+ pftpriv->ft_event.ric_ies_len = 0; -+ report_ft_event(padapter); -+ } else { -+ pmlmeinfo->state = WIFI_FW_AUTH_NULL | WIFI_FW_STATION_STATE; -+ start_clnt_auth(padapter); -+ } -+ } else -+#endif -+ pmlmeinfo->state = WIFI_FW_AUTH_NULL | WIFI_FW_STATION_STATE; -+ } else if (caps & cap_IBSS) { /* adhoc client */ -+ Set_MSR(padapter, WIFI_FW_ADHOC_STATE); -+ -+ val8 = 0xcf; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+ beacon_timing_control(padapter); -+ -+ pmlmeinfo->state = WIFI_FW_ADHOC_STATE; -+ -+ report_join_res(padapter, 1); -+ } else { -+ /* RTW_INFO("marc: invalid cap:%x\n", caps); */ -+ return; -+ } -+ -+} -+ -+void start_clnt_auth(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ pmlmeinfo->state &= (~WIFI_FW_AUTH_NULL); -+ pmlmeinfo->state |= WIFI_FW_AUTH_STATE; -+ -+ pmlmeinfo->auth_seq = 1; -+ pmlmeinfo->reauth_count = 0; -+ pmlmeinfo->reassoc_count = 0; -+ pmlmeinfo->link_count = 0; -+ pmlmeext->retry = 0; -+ -+#ifdef CONFIG_RTW_80211R -+ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { -+ rtw_set_ft_status(padapter, RTW_FT_AUTHENTICATING_STA); -+ RTW_PRINT("start ft auth\n"); -+ } else -+#endif -+ RTW_PRINT("start auth\n"); -+ issue_auth(padapter, NULL, 0); -+ -+ set_link_timer(pmlmeext, REAUTH_TO); -+ -+} -+ -+ -+void start_clnt_assoc(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ pmlmeinfo->state &= (~(WIFI_FW_AUTH_NULL | WIFI_FW_AUTH_STATE)); -+ pmlmeinfo->state |= (WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE); -+ -+#ifdef CONFIG_RTW_80211R -+ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) -+ issue_reassocreq(padapter); -+ else -+#endif -+ issue_assocreq(padapter); -+ -+ set_link_timer(pmlmeext, REASSOC_TO); -+} -+ -+unsigned int receive_disconnect(_adapter *padapter, unsigned char *MacAddr, unsigned short reason, u8 locally_generated) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (!(_rtw_memcmp(MacAddr, get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) -+ return _SUCCESS; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { -+ if (report_del_sta_event(padapter, MacAddr, reason, _TRUE, locally_generated) != _FAIL) -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ } else if (pmlmeinfo->state & WIFI_FW_LINKING_STATE) { -+ if (report_join_res(padapter, -2) != _FAIL) -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ } else -+ RTW_INFO(FUNC_ADPT_FMT" - End to Disconnect\n", FUNC_ADPT_ARG(padapter)); -+#ifdef CONFIG_RTW_80211R -+ if ((rtw_to_roam(padapter) > 0) && !rtw_chk_ft_status(padapter, RTW_FT_REQUESTED_STA)) -+ rtw_reset_ft_status(padapter); -+#endif -+ } -+ -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_80211D -+static void process_80211d(PADAPTER padapter, WLAN_BSSID_EX *bssid) -+{ -+ struct registry_priv *pregistrypriv; -+ struct mlme_ext_priv *pmlmeext; -+ RT_CHANNEL_INFO *chplan_new; -+ u8 channel; -+ u8 i; -+ -+ -+ pregistrypriv = &padapter->registrypriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ -+ /* Adjust channel plan by AP Country IE */ -+ if (pregistrypriv->enable80211d -+ && (!pmlmeext->update_channel_plan_by_ap_done)) { -+ u8 *ie, *p; -+ u32 len; -+ RT_CHANNEL_PLAN chplan_ap; -+ RT_CHANNEL_INFO chplan_sta[MAX_CHANNEL_NUM]; -+ u8 country[4]; -+ u8 fcn; /* first channel number */ -+ u8 noc; /* number of channel */ -+ u8 j, k; -+ -+ ie = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _COUNTRY_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (!ie) -+ return; -+ if (len < 6) -+ return; -+ -+ ie += 2; -+ p = ie; -+ ie += len; -+ -+ _rtw_memset(country, 0, 4); -+ _rtw_memcpy(country, p, 3); -+ p += 3; -+ RTW_INFO("%s: 802.11d country=%s\n", __FUNCTION__, country); -+ -+ i = 0; -+ while ((ie - p) >= 3) { -+ fcn = *(p++); -+ noc = *(p++); -+ p++; -+ -+ for (j = 0; j < noc; j++) { -+ if (fcn <= 14) -+ channel = fcn + j; /* 2.4 GHz */ -+ else -+ channel = fcn + j * 4; /* 5 GHz */ -+ -+ chplan_ap.Channel[i++] = channel; -+ } -+ } -+ chplan_ap.Len = i; -+ -+#ifdef CONFIG_RTW_DEBUG -+ i = 0; -+ RTW_INFO("%s: AP[%s] channel plan {", __FUNCTION__, bssid->Ssid.Ssid); -+ while ((i < chplan_ap.Len) && (chplan_ap.Channel[i] != 0)) { -+ _RTW_INFO("%02d,", chplan_ap.Channel[i]); -+ i++; -+ } -+ _RTW_INFO("}\n"); -+#endif -+ -+ _rtw_memcpy(chplan_sta, pmlmeext->channel_set, sizeof(chplan_sta)); -+#ifdef CONFIG_RTW_DEBUG -+ i = 0; -+ RTW_INFO("%s: STA channel plan {", __FUNCTION__); -+ while ((i < MAX_CHANNEL_NUM) && (chplan_sta[i].ChannelNum != 0)) { -+ _RTW_INFO("%02d(%c),", chplan_sta[i].ChannelNum, chplan_sta[i].ScanType == SCAN_PASSIVE ? 'p' : 'a'); -+ i++; -+ } -+ _RTW_INFO("}\n"); -+#endif -+ -+ _rtw_memset(pmlmeext->channel_set, 0, sizeof(pmlmeext->channel_set)); -+ chplan_new = pmlmeext->channel_set; -+ -+ i = j = k = 0; -+ if (pregistrypriv->wireless_mode & WIRELESS_11G) { -+ do { -+ if ((i == MAX_CHANNEL_NUM) -+ || (chplan_sta[i].ChannelNum == 0) -+ || (chplan_sta[i].ChannelNum > 14)) -+ break; -+ -+ if ((j == chplan_ap.Len) || (chplan_ap.Channel[j] > 14)) -+ break; -+ -+ if (chplan_sta[i].ChannelNum == chplan_ap.Channel[j]) { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ i++; -+ j++; -+ k++; -+ } else if (chplan_sta[i].ChannelNum < chplan_ap.Channel[j]) { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+#if 0 -+ chplan_new[k].ScanType = chplan_sta[i].ScanType; -+#else -+ chplan_new[k].ScanType = SCAN_PASSIVE; -+#endif -+ i++; -+ k++; -+ } else if (chplan_sta[i].ChannelNum > chplan_ap.Channel[j]) { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ j++; -+ k++; -+ } -+ } while (1); -+ -+ /* change AP not support channel to Passive scan */ -+ while ((i < MAX_CHANNEL_NUM) -+ && (chplan_sta[i].ChannelNum != 0) -+ && (chplan_sta[i].ChannelNum <= 14)) { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+#if 0 -+ chplan_new[k].ScanType = chplan_sta[i].ScanType; -+#else -+ chplan_new[k].ScanType = SCAN_PASSIVE; -+#endif -+ i++; -+ k++; -+ } -+ -+ /* add channel AP supported */ -+ while ((j < chplan_ap.Len) && (chplan_ap.Channel[j] <= 14)) { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ j++; -+ k++; -+ } -+ } else { -+ /* keep original STA 2.4G channel plan */ -+ while ((i < MAX_CHANNEL_NUM) -+ && (chplan_sta[i].ChannelNum != 0) -+ && (chplan_sta[i].ChannelNum <= 14)) { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+ chplan_new[k].ScanType = chplan_sta[i].ScanType; -+ i++; -+ k++; -+ } -+ -+ /* skip AP 2.4G channel plan */ -+ while ((j < chplan_ap.Len) && (chplan_ap.Channel[j] <= 14)) -+ j++; -+ } -+ -+ if (pregistrypriv->wireless_mode & WIRELESS_11A) { -+ do { -+ if ((i >= MAX_CHANNEL_NUM) -+ || (chplan_sta[i].ChannelNum == 0)) -+ break; -+ -+ if ((j == chplan_ap.Len) || (chplan_ap.Channel[j] == 0)) -+ break; -+ -+ if (chplan_sta[i].ChannelNum == chplan_ap.Channel[j]) { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ i++; -+ j++; -+ k++; -+ } else if (chplan_sta[i].ChannelNum < chplan_ap.Channel[j]) { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+#if 0 -+ chplan_new[k].ScanType = chplan_sta[i].ScanType; -+#else -+ chplan_new[k].ScanType = SCAN_PASSIVE; -+#endif -+ i++; -+ k++; -+ } else if (chplan_sta[i].ChannelNum > chplan_ap.Channel[j]) { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ j++; -+ k++; -+ } -+ } while (1); -+ -+ /* change AP not support channel to Passive scan */ -+ while ((i < MAX_CHANNEL_NUM) && (chplan_sta[i].ChannelNum != 0)) { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+#if 0 -+ chplan_new[k].ScanType = chplan_sta[i].ScanType; -+#else -+ chplan_new[k].ScanType = SCAN_PASSIVE; -+#endif -+ i++; -+ k++; -+ } -+ -+ /* add channel AP supported */ -+ while ((j < chplan_ap.Len) && (chplan_ap.Channel[j] != 0)) { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ j++; -+ k++; -+ } -+ } else { -+ /* keep original STA 5G channel plan */ -+ while ((i < MAX_CHANNEL_NUM) && (chplan_sta[i].ChannelNum != 0)) { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+ chplan_new[k].ScanType = chplan_sta[i].ScanType; -+ i++; -+ k++; -+ } -+ } -+ -+ pmlmeext->update_channel_plan_by_ap_done = 1; -+ -+#ifdef CONFIG_RTW_DEBUG -+ k = 0; -+ RTW_INFO("%s: new STA channel plan {", __FUNCTION__); -+ while ((k < MAX_CHANNEL_NUM) && (chplan_new[k].ChannelNum != 0)) { -+ _RTW_INFO("%02d(%c),", chplan_new[k].ChannelNum, chplan_new[k].ScanType == SCAN_PASSIVE ? 'p' : 'c'); -+ k++; -+ } -+ _RTW_INFO("}\n"); -+#endif -+ -+#if 0 -+ /* recover the right channel index */ -+ channel = chplan_sta[pmlmeext->sitesurvey_res.channel_idx].ChannelNum; -+ k = 0; -+ while ((k < MAX_CHANNEL_NUM) && (chplan_new[k].ChannelNum != 0)) { -+ if (chplan_new[k].ChannelNum == channel) { -+ RTW_INFO("%s: change mlme_ext sitesurvey channel index from %d to %d\n", -+ __FUNCTION__, pmlmeext->sitesurvey_res.channel_idx, k); -+ pmlmeext->sitesurvey_res.channel_idx = k; -+ break; -+ } -+ k++; -+ } -+#endif -+ } -+ -+ /* If channel is used by AP, set channel scan type to active */ -+ channel = bssid->Configuration.DSConfig; -+ chplan_new = pmlmeext->channel_set; -+ i = 0; -+ while ((i < MAX_CHANNEL_NUM) && (chplan_new[i].ChannelNum != 0)) { -+ if (chplan_new[i].ChannelNum == channel) { -+ if (chplan_new[i].ScanType == SCAN_PASSIVE) { -+ /* 5G Bnad 2, 3 (DFS) doesn't change to active scan */ -+ if (channel >= 52 && channel <= 144) -+ break; -+ -+ chplan_new[i].ScanType = SCAN_ACTIVE; -+ RTW_INFO("%s: change channel %d scan type from passive to active\n", -+ __FUNCTION__, channel); -+ } -+ break; -+ } -+ i++; -+ } -+} -+#endif -+ -+/**************************************************************************** -+ -+Following are the functions to report events -+ -+*****************************************************************************/ -+ -+void report_survey_event(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct survey_event *psurvey_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext; -+ struct cmd_priv *pcmdpriv; -+ /* u8 *pframe = precv_frame->u.hdr.rx_data; */ -+ /* uint len = precv_frame->u.hdr.len; */ -+ -+ if (!padapter) -+ return; -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pcmdpriv = &padapter->cmdpriv; -+ -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ return; -+ -+ cmdsz = (sizeof(struct survey_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct survey_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_Survey); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ psurvey_evt = (struct survey_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ -+ if (collect_bss_info(padapter, precv_frame, (WLAN_BSSID_EX *)&psurvey_evt->bss) == _FAIL) { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)pevtcmd, cmdsz); -+ return; -+ } -+ -+#ifdef CONFIG_80211D -+ process_80211d(padapter, &psurvey_evt->bss); -+#endif -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ pmlmeext->sitesurvey_res.bss_cnt++; -+ -+ return; -+ -+} -+ -+void report_surveydone_event(_adapter *padapter) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct surveydone_event *psurveydone_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ return; -+ -+ cmdsz = (sizeof(struct surveydone_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct surveydone_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_SurveyDone); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ psurveydone_evt = (struct surveydone_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ psurveydone_evt->bss_cnt = pmlmeext->sitesurvey_res.bss_cnt; -+ -+ RTW_INFO("survey done event(%x) band:%d for "ADPT_FMT"\n", psurveydone_evt->bss_cnt, padapter->setband, ADPT_ARG(padapter)); -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+ -+} -+ -+u32 report_join_res(_adapter *padapter, int res) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct joinbss_event *pjoinbss_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u32 ret = _FAIL; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ goto exit; -+ -+ cmdsz = (sizeof(struct joinbss_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ goto exit; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct joinbss_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_JoinBss); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ pjoinbss_evt = (struct joinbss_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ _rtw_memcpy((unsigned char *)(&(pjoinbss_evt->network.network)), &(pmlmeinfo->network), sizeof(WLAN_BSSID_EX)); -+ pjoinbss_evt->network.join_res = pjoinbss_evt->network.aid = res; -+ -+ RTW_INFO("report_join_res(%d)\n", res); -+ -+ -+ rtw_joinbss_event_prehandle(padapter, (u8 *)&pjoinbss_evt->network); -+ -+ -+ ret = rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+exit: -+ return ret; -+} -+ -+void report_wmm_edca_update(_adapter *padapter) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct wmm_event *pwmm_event; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ return; -+ -+ cmdsz = (sizeof(struct wmm_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct wmm_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_WMM); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ pwmm_event = (struct wmm_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ pwmm_event->wmm = 0; -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+ -+} -+ -+u32 report_del_sta_event(_adapter *padapter, unsigned char *MacAddr, unsigned short reason, bool enqueue, u8 locally_generated) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct sta_info *psta; -+ int mac_id = -1; -+ struct stadel_event *pdel_sta_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ /* prepare cmd parameter */ -+ cmdsz = (sizeof(struct stadel_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct stadel_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_DelSTA); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ pdel_sta_evt = (struct stadel_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ _rtw_memcpy((unsigned char *)(&(pdel_sta_evt->macaddr)), MacAddr, ETH_ALEN); -+ _rtw_memcpy((unsigned char *)(pdel_sta_evt->rsvd), (unsigned char *)(&reason), 2); -+ psta = rtw_get_stainfo(&padapter->stapriv, MacAddr); -+ if (psta) -+ mac_id = (int)psta->mac_id; -+ else -+ mac_id = (-1); -+ pdel_sta_evt->mac_id = mac_id; -+ pdel_sta_evt->locally_generated = locally_generated; -+ -+ if (!enqueue) { -+ /* do directly */ -+ rtw_stadel_event_callback(padapter, (u8 *)pdel_sta_evt); -+ rtw_mfree(pevtcmd, cmdsz); -+ } else { -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) { -+ rtw_mfree(pevtcmd, cmdsz); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ } -+ -+exit: -+ -+ RTW_INFO(FUNC_ADPT_FMT" "MAC_FMT" mac_id=%d, enqueue:%d, res:%u\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(MacAddr), mac_id, enqueue, res); -+ -+ return res; -+} -+ -+void report_add_sta_event(_adapter *padapter, unsigned char *MacAddr) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct stassoc_event *padd_sta_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ return; -+ -+ cmdsz = (sizeof(struct stassoc_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct stassoc_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_AddSTA); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ padd_sta_evt = (struct stassoc_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ _rtw_memcpy((unsigned char *)(&(padd_sta_evt->macaddr)), MacAddr, ETH_ALEN); -+ -+ RTW_INFO("report_add_sta_event: add STA\n"); -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+} -+ -+ -+bool rtw_port_switch_chk(_adapter *adapter) -+{ -+ bool switch_needed = _FALSE; -+#ifdef CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_RUNTIME_PORT_SWITCH -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(dvobj); -+ _adapter *if_port0 = NULL; -+ _adapter *if_port1 = NULL; -+ struct mlme_ext_info *if_port0_mlmeinfo = NULL; -+ struct mlme_ext_info *if_port1_mlmeinfo = NULL; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (get_hw_port(dvobj->padapters[i]) == HW_PORT0) { -+ if_port0 = dvobj->padapters[i]; -+ if_port0_mlmeinfo = &(if_port0->mlmeextpriv.mlmext_info); -+ } else if (get_hw_port(dvobj->padapters[i]) == HW_PORT1) { -+ if_port1 = dvobj->padapters[i]; -+ if_port1_mlmeinfo = &(if_port1->mlmeextpriv.mlmext_info); -+ } -+ } -+ -+ if (if_port0 == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (if_port1 == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+#ifdef DBG_RUNTIME_PORT_SWITCH -+ RTW_INFO(FUNC_ADPT_FMT" wowlan_mode:%u\n" -+ ADPT_FMT", port0, mlmeinfo->state:0x%08x, p2p_state:%d, %d\n" -+ ADPT_FMT", port1, mlmeinfo->state:0x%08x, p2p_state:%d, %d\n", -+ FUNC_ADPT_ARG(adapter), pwrctl->wowlan_mode, -+ ADPT_ARG(if_port0), if_port0_mlmeinfo->state, rtw_p2p_state(&if_port0->wdinfo), rtw_p2p_chk_state(&if_port0->wdinfo, P2P_STATE_NONE), -+ ADPT_ARG(if_port1), if_port1_mlmeinfo->state, rtw_p2p_state(&if_port1->wdinfo), rtw_p2p_chk_state(&if_port1->wdinfo, P2P_STATE_NONE)); -+#endif /* DBG_RUNTIME_PORT_SWITCH */ -+ -+#ifdef CONFIG_WOWLAN -+ /* WOWLAN interface(primary, for now) should be port0 */ -+ if (pwrctl->wowlan_mode == _TRUE) { -+ if (!is_primary_adapter(if_port0)) { -+ RTW_INFO("%s "ADPT_FMT" enable WOWLAN\n", __func__, ADPT_ARG(if_port1)); -+ switch_needed = _TRUE; -+ } -+ goto exit; -+ } -+#endif /* CONFIG_WOWLAN */ -+ -+ /* AP should use port0 for ctl frame's ack */ -+ if ((if_port1_mlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { -+ RTW_INFO("%s "ADPT_FMT" is AP/GO\n", __func__, ADPT_ARG(if_port1)); -+ switch_needed = _TRUE; -+ goto exit; -+ } -+ -+ /* GC should use port0 for p2p ps */ -+ if (((if_port1_mlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) -+ && (if_port1_mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+#ifdef CONFIG_P2P -+ && !rtw_p2p_chk_state(&if_port1->wdinfo, P2P_STATE_NONE) -+#endif -+ && !check_fwstate(&if_port1->mlmepriv, WIFI_UNDER_WPS) -+ ) { -+ RTW_INFO("%s "ADPT_FMT" is GC\n", __func__, ADPT_ARG(if_port1)); -+ switch_needed = _TRUE; -+ goto exit; -+ } -+ -+ /* port1 linked, but port0 not linked */ -+ if ((if_port1_mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ && !(if_port0_mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ && ((if_port0_mlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) -+ ) { -+ RTW_INFO("%s "ADPT_FMT" is SINGLE_LINK\n", __func__, ADPT_ARG(if_port1)); -+ switch_needed = _TRUE; -+ goto exit; -+ } -+ -+exit: -+#ifdef DBG_RUNTIME_PORT_SWITCH -+ RTW_INFO(FUNC_ADPT_FMT" ret:%d\n", FUNC_ADPT_ARG(adapter), switch_needed); -+#endif /* DBG_RUNTIME_PORT_SWITCH */ -+#endif /* CONFIG_RUNTIME_PORT_SWITCH */ -+#endif /* CONFIG_CONCURRENT_MODE */ -+ return switch_needed; -+} -+ -+/**************************************************************************** -+ -+Following are the event callback functions -+ -+*****************************************************************************/ -+ -+/* for sta/adhoc mode */ -+void update_sta_info(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* ERP */ -+ VCS_update(padapter, psta); -+ -+#ifdef CONFIG_80211N_HT -+ /* HT */ -+ if (pmlmepriv->htpriv.ht_option) { -+ psta->htpriv.ht_option = _TRUE; -+ -+ psta->htpriv.ampdu_enable = pmlmepriv->htpriv.ampdu_enable; -+ -+ psta->htpriv.rx_ampdu_min_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & IEEE80211_HT_CAP_AMPDU_DENSITY) >> 2; -+ -+ if (support_short_GI(padapter, &(pmlmeinfo->HT_caps), CHANNEL_WIDTH_20)) -+ psta->htpriv.sgi_20m = _TRUE; -+ -+ if (support_short_GI(padapter, &(pmlmeinfo->HT_caps), CHANNEL_WIDTH_40)) -+ psta->htpriv.sgi_40m = _TRUE; -+ -+ psta->qos_option = _TRUE; -+ -+ psta->htpriv.ldpc_cap = pmlmepriv->htpriv.ldpc_cap; -+ psta->htpriv.stbc_cap = pmlmepriv->htpriv.stbc_cap; -+ psta->htpriv.beamform_cap = pmlmepriv->htpriv.beamform_cap; -+ -+ _rtw_memcpy(&psta->htpriv.ht_cap, &pmlmeinfo->HT_caps, sizeof(struct rtw_ieee80211_ht_cap)); -+ } else -+#endif /* CONFIG_80211N_HT */ -+ { -+#ifdef CONFIG_80211N_HT -+ psta->htpriv.ht_option = _FALSE; -+ -+ psta->htpriv.ampdu_enable = _FALSE; -+ -+ psta->htpriv.sgi_20m = _FALSE; -+ psta->htpriv.sgi_40m = _FALSE; -+#endif /* CONFIG_80211N_HT */ -+ psta->qos_option = _FALSE; -+ -+ } -+ -+#ifdef CONFIG_80211N_HT -+ psta->htpriv.ch_offset = pmlmeext->cur_ch_offset; -+ -+ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ -+ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ -+#endif /* CONFIG_80211N_HT */ -+ -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ -+ /* QoS */ -+ if (pmlmepriv->qospriv.qos_option) -+ psta->qos_option = _TRUE; -+ -+#ifdef CONFIG_80211AC_VHT -+ _rtw_memcpy(&psta->vhtpriv, &pmlmepriv->vhtpriv, sizeof(struct vht_priv)); -+#endif /* CONFIG_80211AC_VHT */ -+ -+ update_ldpc_stbc_cap(psta); -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state = _FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+} -+ -+static void rtw_mlmeext_disconnect(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+ u8 state_backup = (pmlmeinfo->state & 0x03); -+ u8 ASIX_ID[] = {0x00, 0x0E, 0xC6}; -+ -+ /* set_opmode_cmd(padapter, infra_client_with_mlme); */ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, 0); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); -+ -+ /* set MSR to no link state->infra. mode */ -+ Set_MSR(padapter, _HW_STATE_STATION_); -+ -+ /* check if sta is ASIX peer and fix IOT issue if it is. */ -+ if (_rtw_memcmp(get_my_bssid(&pmlmeinfo->network) , ASIX_ID , 3)) { -+ u8 iot_flag = _FALSE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_ASIX_IOT, (u8 *)(&iot_flag)); -+ } -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+#ifdef CONFIG_MCC_MODE -+ /* mcc disconnect setting before download LPS rsvd page */ -+ rtw_hal_set_mcc_setting_disconnect(padapter); -+#endif /* CONFIG_MCC_MODE */ -+ -+ if (state_backup == WIFI_FW_STATION_STATE) { -+ if (rtw_port_switch_chk(padapter) == _TRUE) { -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+#ifdef CONFIG_LPS -+ { -+ _adapter *port0_iface = dvobj_get_port0_adapter(adapter_to_dvobj(padapter)); -+ if (port0_iface) -+ rtw_lps_ctrl_wk_cmd(port0_iface, LPS_CTRL_CONNECT, 0); -+ } -+#endif -+ } -+ } -+ -+ /* switch to the 20M Hz mode after disconnect */ -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+#ifdef CONFIG_FCS_MODE -+ if (EN_FCS(padapter)) -+ rtw_hal_set_hwreg(padapter, HW_VAR_STOP_FCS_MODE, NULL); -+#endif -+ -+#ifdef CONFIG_DFS_MASTER -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ rtw_dfs_master_status_apply(padapter, MLME_AP_STOPPED); -+ else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ rtw_dfs_master_status_apply(padapter, MLME_STA_DISCONNECTED); -+#endif -+ -+ { -+ u8 ch, bw, offset; -+ -+ if (rtw_mi_get_ch_setting_union_no_self(padapter, &ch, &bw, &offset) != 0) { -+ set_channel_bwmode(padapter, ch, offset, bw); -+ rtw_mi_update_union_chan_inf(padapter, ch, offset, bw); -+ } -+ } -+ -+ flush_all_cam_entry(padapter); -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ /* pmlmepriv->LinkDetectInfo.TrafficBusyState = _FALSE; */ -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; -+ -+#ifdef CONFIG_TDLS -+ padapter->tdlsinfo.ap_prohibited = _FALSE; -+ -+ /* For TDLS channel switch, currently we only allow it to work in wifi logo test mode */ -+ if (padapter->registrypriv.wifi_spec == 1) -+ padapter->tdlsinfo.ch_switch_prohibited = _FALSE; -+#endif /* CONFIG_TDLS */ -+ -+} -+ -+void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) -+{ -+ struct sta_info *psta, *psta_bmc; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 join_type; -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#endif -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ if (join_res < 0) { -+ join_type = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); -+ -+ goto exit_mlmeext_joinbss_event_callback; -+ } -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ pmlmepriv->bGetGateway = 1; -+ pmlmepriv->GetGatewayTryCnt = 0; -+#endif -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { -+ /* update bc/mc sta_info */ -+#ifdef CONFIG_AP_MODE -+ update_bmc_sta(padapter); -+#endif -+ } -+ -+ -+ /* turn on dynamic functions */ -+ /* Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, _TRUE); */ -+ -+ /* update IOT-releated issue */ -+ update_IOT_info(padapter); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, cur_network->SupportedRates); -+ -+ /* BCN interval */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&pmlmeinfo->bcn_interval)); -+ -+ /* udpate capability */ -+ update_capinfo(padapter, pmlmeinfo->capability); -+ -+ /* WMM, Update EDCA param */ -+ WMMOnAssocRsp(padapter); -+ -+ /* HT */ -+ HTOnAssocRsp(padapter); -+ -+#ifdef CONFIG_80211AC_VHT -+ /* VHT */ -+ VHTOnAssocRsp(padapter); -+#endif -+ -+ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); -+ if (psta) { /* only for infra. mode */ -+ /* RTW_INFO("set_sta_rate\n"); */ -+ -+ psta->wireless_mode = pmlmeext->cur_wireless_mode; -+ -+ /* set per sta rate after updating HT cap. */ -+ set_sta_rate(padapter, psta); -+ -+ rtw_sta_media_status_rpt(padapter, psta, 1); -+ -+ /* wakeup macid after join bss successfully to ensure -+ the subsequent data frames can be sent out normally */ -+ rtw_hal_macid_wakeup(padapter, psta->mac_id); -+ } -+ -+#ifndef CONFIG_IOCTL_CFG80211 -+ if (is_wep_enc(psecuritypriv->dot11PrivacyAlgrthm)) -+ rtw_sec_restore_wep_key(padapter); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ if (rtw_port_switch_chk(padapter) == _TRUE) -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+ -+ join_type = 2; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { -+ /* correcting TSF */ -+ correct_TSF(padapter, pmlmeext); -+ -+ /* set_link_timer(pmlmeext, DISCONNECT_TO); */ -+ } -+ -+#ifdef CONFIG_LPS -+ if (get_hw_port(padapter) == HW_PORT0) -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_CONNECT, 0); -+#endif -+ -+#ifdef CONFIG_BEAMFORMING -+ if (psta) -+ beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_ENTER, (u8 *)psta, sizeof(struct sta_info), 0); -+#endif/*CONFIG_BEAMFORMING*/ -+ -+exit_mlmeext_joinbss_event_callback: -+ -+ rtw_join_done_chk_ch(padapter, join_res); -+ -+ RTW_INFO("=>%s - End to Connection without 4-way\n", __FUNCTION__); -+} -+ -+/* currently only adhoc mode will go here */ -+void mlmeext_sta_add_event_callback(_adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 join_type; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { /* adhoc master or sta_count>1 */ -+ /* nothing to do */ -+ } else { /* adhoc client */ -+ /* update TSF Value */ -+ /* update_TSF(pmlmeext, pframe, len); */ -+ -+ /* correcting TSF */ -+ correct_TSF(padapter, pmlmeext); -+ -+ /* start beacon */ -+ if (send_beacon(padapter) == _FAIL) -+ rtw_warn_on(1); -+ -+ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ } -+ -+ join_type = 2; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ } -+ -+ /* update adhoc sta_info */ -+ update_sta_info(padapter, psta); -+ -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ -+ /* ToDo: HT for Ad-hoc */ -+ psta->wireless_mode = rtw_check_network_type(psta->bssrateset, psta->bssratelen, pmlmeext->cur_channel); -+ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); -+ -+ /* rate radaptive */ -+ Update_RA_Entry(padapter, psta); -+} -+ -+void mlmeext_sta_del_event_callback(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (is_client_associated_to_ap(padapter) || is_IBSS_empty(padapter)) -+ rtw_mlmeext_disconnect(padapter); -+ -+} -+ -+/**************************************************************************** -+ -+Following are the functions for the timer handlers -+ -+*****************************************************************************/ -+void _linked_info_dump(_adapter *padapter) -+{ -+ int i; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ HAL_DATA_TYPE *HalData = GET_HAL_DATA(padapter); -+ int UndecoratedSmoothedPWDB = 0; -+ -+ if (padapter->bLinkInfoDump) { -+ -+ RTW_INFO("\n============["ADPT_FMT"] linked status check ===================\n", ADPT_ARG(padapter)); -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { -+ rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); -+ -+ RTW_INFO("AP[" MAC_FMT "] - UndecoratedSmoothedPWDB:%d\n", -+ MAC_ARG(padapter->mlmepriv.cur_network.network.MacAddress), UndecoratedSmoothedPWDB); -+#ifdef CONFIG_AP_MODE -+ } else if ((pmlmeinfo->state & 0x03) == _HW_STATE_AP_) { -+ _irqL irqL; -+ _list *phead, *plist; -+ -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ RTW_INFO("STA[" MAC_FMT "]:UndecoratedSmoothedPWDB:%d\n", -+ MAC_ARG(psta->hwaddr), psta->rssi_stat.UndecoratedSmoothedPWDB); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+#endif -+ } -+ -+ /*============ tx info ============ */ -+ rtw_hal_get_def_var(padapter, HW_DEF_RA_INFO_DUMP, RTW_DBGDUMP); -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_RX_INFO_DUMP, RTW_DBGDUMP, _FALSE); -+ -+ } -+ -+ -+} -+void rtw_delba_check(_adapter *padapter, struct sta_info *psta, u8 from_timer) -+{ -+ int i = 0; -+ int ret = _SUCCESS; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* -+ IOT issue,occur Broadcom ap(Buffalo WZR-D1800H,Netgear R6300). -+ AP is originator.AP does not transmit unicast packets when STA response its BAR. -+ This case probably occur ap issue BAR after AP builds BA. -+ -+ Follow 802.11 spec, STA shall maintain an inactivity timer for every negotiated Block Ack setup. -+ The inactivity timer is not reset when MPDUs corresponding to other TIDs are received. -+ */ -+ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) { -+ for (i = 0; i < TID_NUM ; i++) { -+ if ((psta->recvreorder_ctrl[i].enable) && -+ (sta_rx_data_qos_pkts(psta, i) == sta_last_rx_data_qos_pkts(psta, i)) ) { -+ if (_TRUE == rtw_inc_and_chk_continual_no_rx_packet(psta, i)) { -+ /* send a DELBA frame to the peer STA with the Reason Code field set to TIMEOUT */ -+ if (!from_timer) -+ ret = issue_del_ba_ex(padapter, psta->hwaddr, i, 39, 0, 3, 1); -+ else -+ issue_del_ba(padapter, psta->hwaddr, i, 39, 0); -+ psta->recvreorder_ctrl[i].enable = _FALSE; -+ if (ret != _FAIL) -+ psta->recvreorder_ctrl[i].ampdu_size = RX_AMPDU_SIZE_INVALID; -+ rtw_reset_continual_no_rx_packet(psta, i); -+ } -+ } else { -+ /* The inactivity timer is reset when MPDUs to the TID is received. */ -+ rtw_reset_continual_no_rx_packet(psta, i); -+ } -+ } -+ } -+} -+ -+u8 chk_ap_is_alive(_adapter *padapter, struct sta_info *psta) -+{ -+ u8 ret = _FALSE; -+ int i = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+#ifdef DBG_EXPIRATION_CHK -+ RTW_INFO(FUNC_ADPT_FMT" rx:"STA_PKTS_FMT", beacon:%llu, probersp_to_self:%llu" -+ /*", probersp_bm:%llu, probersp_uo:%llu, probereq:%llu, BI:%u"*/ -+ ", retry:%u\n" -+ , FUNC_ADPT_ARG(padapter) -+ , STA_RX_PKTS_DIFF_ARG(psta) -+ , psta->sta_stats.rx_beacon_pkts - psta->sta_stats.last_rx_beacon_pkts -+ , psta->sta_stats.rx_probersp_pkts - psta->sta_stats.last_rx_probersp_pkts -+ /*, psta->sta_stats.rx_probersp_bm_pkts - psta->sta_stats.last_rx_probersp_bm_pkts -+ , psta->sta_stats.rx_probersp_uo_pkts - psta->sta_stats.last_rx_probersp_uo_pkts -+ , psta->sta_stats.rx_probereq_pkts - psta->sta_stats.last_rx_probereq_pkts -+ , pmlmeinfo->bcn_interval*/ -+ , pmlmeext->retry -+ ); -+ -+ RTW_INFO(FUNC_ADPT_FMT" tx_pkts:%llu, link_count:%u\n", FUNC_ADPT_ARG(padapter) -+ , padapter->xmitpriv.tx_pkts -+ , pmlmeinfo->link_count -+ ); -+#endif -+ -+ if ((sta_rx_data_pkts(psta) == sta_last_rx_data_pkts(psta)) -+ && sta_rx_beacon_pkts(psta) == sta_last_rx_beacon_pkts(psta) -+ && sta_rx_probersp_pkts(psta) == sta_last_rx_probersp_pkts(psta) -+ ) -+ ret = _FALSE; -+ else -+ ret = _TRUE; -+ -+ sta_update_last_rx_pkts(psta); -+ -+ /* -+ record last rx data packets for every tid. -+ */ -+ for (i = 0; i < TID_NUM; i++) -+ psta->sta_stats.last_rx_data_qos_pkts[i] = psta->sta_stats.rx_data_qos_pkts[i]; -+ -+ return ret; -+} -+ -+u8 chk_adhoc_peer_is_alive(struct sta_info *psta) -+{ -+ u8 ret = _TRUE; -+ -+#ifdef DBG_EXPIRATION_CHK -+ RTW_INFO("sta:"MAC_FMT", rssi:%d, rx:"STA_PKTS_FMT", beacon:%llu, probersp_to_self:%llu" -+ /*", probersp_bm:%llu, probersp_uo:%llu, probereq:%llu, BI:%u"*/ -+ ", expire_to:%u\n" -+ , MAC_ARG(psta->hwaddr) -+ , psta->rssi_stat.UndecoratedSmoothedPWDB -+ , STA_RX_PKTS_DIFF_ARG(psta) -+ , psta->sta_stats.rx_beacon_pkts - psta->sta_stats.last_rx_beacon_pkts -+ , psta->sta_stats.rx_probersp_pkts - psta->sta_stats.last_rx_probersp_pkts -+ /*, psta->sta_stats.rx_probersp_bm_pkts - psta->sta_stats.last_rx_probersp_bm_pkts -+ , psta->sta_stats.rx_probersp_uo_pkts - psta->sta_stats.last_rx_probersp_uo_pkts -+ , psta->sta_stats.rx_probereq_pkts - psta->sta_stats.last_rx_probereq_pkts -+ , pmlmeinfo->bcn_interval*/ -+ , psta->expire_to -+ ); -+#endif -+ -+ if (sta_rx_data_pkts(psta) == sta_last_rx_data_pkts(psta) -+ && sta_rx_beacon_pkts(psta) == sta_last_rx_beacon_pkts(psta) -+ && sta_rx_probersp_pkts(psta) == sta_last_rx_probersp_pkts(psta)) -+ ret = _FALSE; -+ -+ sta_update_last_rx_pkts(psta); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_TDLS -+u8 chk_tdls_peer_sta_is_alive(_adapter *padapter, struct sta_info *psta) -+{ -+ if ((psta->sta_stats.rx_data_pkts == psta->sta_stats.last_rx_data_pkts) -+ && (psta->sta_stats.rx_tdls_disc_rsp_pkts == psta->sta_stats.last_rx_tdls_disc_rsp_pkts)) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+void linked_status_chk_tdls(_adapter *padapter) -+{ -+ struct candidate_pool { -+ struct sta_info *psta; -+ u8 addr[ETH_ALEN]; -+ }; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ _irqL irqL; -+ u8 ack_chk; -+ struct sta_info *psta; -+ int i, num_teardown = 0, num_checkalive = 0; -+ _list *plist, *phead; -+ struct tdls_txmgmt txmgmt; -+ struct candidate_pool checkalive[MAX_ALLOWED_TDLS_STA_NUM]; -+ struct candidate_pool teardown[MAX_ALLOWED_TDLS_STA_NUM]; -+ u8 tdls_sta_max = _FALSE; -+ -+#define ALIVE_MIN 2 -+#define ALIVE_MAX 5 -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ _rtw_memset(checkalive, 0x00, sizeof(checkalive)); -+ _rtw_memset(teardown, 0x00, sizeof(teardown)); -+ -+ if ((padapter->tdlsinfo.link_established == _TRUE)) { -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for (i = 0; i < NUM_STA; i++) { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ plist = get_next(plist); -+ -+ if (psta->tdls_sta_state & TDLS_LINKED_STATE) { -+ psta->alive_count++; -+ if (psta->alive_count >= ALIVE_MIN) { -+ if (chk_tdls_peer_sta_is_alive(padapter, psta) == _FALSE) { -+ if (psta->alive_count < ALIVE_MAX) { -+ _rtw_memcpy(checkalive[num_checkalive].addr, psta->hwaddr, ETH_ALEN); -+ checkalive[num_checkalive].psta = psta; -+ num_checkalive++; -+ } else { -+ _rtw_memcpy(teardown[num_teardown].addr, psta->hwaddr, ETH_ALEN); -+ teardown[num_teardown].psta = psta; -+ num_teardown++; -+ } -+ } else -+ psta->alive_count = 0; -+ } -+ psta->sta_stats.last_rx_data_pkts = psta->sta_stats.rx_data_pkts; -+ psta->sta_stats.last_rx_tdls_disc_rsp_pkts = psta->sta_stats.rx_tdls_disc_rsp_pkts; -+ -+ if ((num_checkalive >= MAX_ALLOWED_TDLS_STA_NUM) || (num_teardown >= MAX_ALLOWED_TDLS_STA_NUM)) { -+ tdls_sta_max = _TRUE; -+ break; -+ } -+ } -+ } -+ -+ if (tdls_sta_max == _TRUE) -+ break; -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ if (num_checkalive > 0) { -+ for (i = 0; i < num_checkalive; i++) { -+ _rtw_memcpy(txmgmt.peer, checkalive[i].addr, ETH_ALEN); -+ issue_tdls_dis_req(padapter, &txmgmt); -+ issue_tdls_dis_req(padapter, &txmgmt); -+ issue_tdls_dis_req(padapter, &txmgmt); -+ } -+ } -+ -+ if (num_teardown > 0) { -+ for (i = 0; i < num_teardown; i++) { -+ RTW_INFO("[%s %d] Send teardown to "MAC_FMT"\n", __FUNCTION__, __LINE__, MAC_ARG(teardown[i].addr)); -+ txmgmt.status_code = _RSON_TDLS_TEAR_TOOFAR_; -+ _rtw_memcpy(txmgmt.peer, teardown[i].addr, ETH_ALEN); -+ issue_tdls_teardown(padapter, &txmgmt, _FALSE); -+ } -+ } -+ } -+ -+} -+#endif /* CONFIG_TDLS */ -+ -+/* from_timer == 1 means driver is in LPS */ -+void linked_status_chk(_adapter *padapter, u8 from_timer) -+{ -+ u32 i; -+ struct sta_info *psta; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+#if defined(CONFIG_ARP_KEEP_ALIVE) || defined(CONFIG_LAYER2_ROAMING) -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#endif -+#ifdef CONFIG_LAYER2_ROAMING -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+#endif -+ -+ if (padapter->registrypriv.mp_mode == _TRUE) -+ return; -+ -+ if (is_client_associated_to_ap(padapter)) { -+ /* linked infrastructure client mode */ -+ -+ int tx_chk = _SUCCESS, rx_chk = _SUCCESS; -+ int rx_chk_limit; -+ int link_count_limit; -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE)) { -+ RTW_INFO("signal_strength_data.avg_val = %d\n", precvpriv->signal_strength_data.avg_val); -+ if (precvpriv->signal_strength_data.avg_val < pmlmepriv->roam_rssi_threshold) { -+ pmlmepriv->need_to_roam = _TRUE; -+ rtw_drv_scan_by_self(padapter, RTW_AUTO_SCAN_REASON_ROAM); -+ } else { -+ pmlmepriv->need_to_roam = _FALSE; -+ } -+ } -+#endif -+#ifdef CONFIG_MCC_MODE -+ /* -+ * due to tx ps null date to ao, so ap doest not tx pkt to driver -+ * we may check chk_ap_is_alive fail, and may issue_probereq to wrong channel under sitesurvey -+ * don't keep alive check under MCC -+ */ -+ if (rtw_hal_mcc_link_status_chk(padapter, __func__) == _FALSE) -+ return; -+#endif -+ -+#if defined(DBG_ROAMING_TEST) -+ rx_chk_limit = 1; -+#elif defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && !defined(CONFIG_LPS_LCLK_WD_TIMER) -+ rx_chk_limit = 4; -+#else -+ rx_chk_limit = 8; -+#endif -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ if (!from_timer && pmlmepriv->bGetGateway == 1 && pmlmepriv->GetGatewayTryCnt < 3) { -+ RTW_INFO("do rtw_gw_addr_query() : %d\n", pmlmepriv->GetGatewayTryCnt); -+ pmlmepriv->GetGatewayTryCnt++; -+ if (rtw_gw_addr_query(padapter) == 0) -+ pmlmepriv->bGetGateway = 0; -+ else { -+ _rtw_memset(pmlmepriv->gw_ip, 0, 4); -+ _rtw_memset(pmlmepriv->gw_mac_addr, 0, 6); -+ } -+ } -+#endif -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE)) { -+ if (!from_timer) -+ link_count_limit = 3; /* 8 sec */ -+ else -+ link_count_limit = 15; /* 32 sec */ -+ } else -+#endif /* CONFIG_P2P */ -+ { -+ if (!from_timer) -+ link_count_limit = 7; /* 16 sec */ -+ else -+ link_count_limit = 29; /* 60 sec */ -+ } -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ if (ATOMIC_READ(&padapter->tdlsinfo.chsw_info.chsw_on) == _TRUE) -+ return; -+#endif /* CONFIG_TDLS_CH_SW */ -+ -+#ifdef CONFIG_TDLS_AUTOCHECKALIVE -+ linked_status_chk_tdls(padapter); -+#endif /* CONFIG_TDLS_AUTOCHECKALIVE */ -+#endif /* CONFIG_TDLS */ -+ -+ psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); -+ if (psta != NULL) { -+ bool is_p2p_enable = _FALSE; -+#ifdef CONFIG_P2P -+ is_p2p_enable = !rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE); -+#endif -+ -+#ifdef CONFIG_DELBA_CHECK -+ /*issue delba when ap does not tx data packet that is Broadcom ap */ -+ rtw_delba_check(padapter, psta, from_timer); -+#endif -+ if (chk_ap_is_alive(padapter, psta) == _FALSE) -+ rx_chk = _FAIL; -+ -+ if (pxmitpriv->last_tx_pkts == pxmitpriv->tx_pkts) -+ tx_chk = _FAIL; -+ -+#if defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && !defined(CONFIG_LPS_LCLK_WD_TIMER) -+ if (pmlmeext->active_keep_alive_check && (rx_chk == _FAIL || tx_chk == _FAIL) -+ #ifdef CONFIG_MCC_MODE -+ /* Driver don't know operation channel under MCC*/ -+ /* So driver don't do KEEP_ALIVE_CHECK */ -+ && (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) -+ #endif -+ ) { -+ u8 backup_ch = 0, backup_bw, backup_offset; -+ u8 union_ch = 0, union_bw, union_offset; -+ -+ if (!rtw_mi_get_ch_setting_union(padapter, &union_ch, &union_bw, &union_offset) -+ || pmlmeext->cur_channel != union_ch) -+ goto bypass_active_keep_alive; -+ -+ /* switch to correct channel of current network before issue keep-alive frames */ -+ if (rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { -+ backup_ch = rtw_get_oper_ch(padapter); -+ backup_bw = rtw_get_oper_bw(padapter); -+ backup_offset = rtw_get_oper_choffset(padapter); -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ } -+ -+ if (rx_chk != _SUCCESS) -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, psta->hwaddr, 0, 0, 3, 1); -+ -+ if ((tx_chk != _SUCCESS && pmlmeinfo->link_count++ == link_count_limit) || rx_chk != _SUCCESS) { -+ tx_chk = issue_nulldata(padapter, psta->hwaddr, 0, 3, 1); -+ /* if tx acked and p2p disabled, set rx_chk _SUCCESS to reset retry count */ -+ if (tx_chk == _SUCCESS && !is_p2p_enable) -+ rx_chk = _SUCCESS; -+ } -+ -+ /* back to the original operation channel */ -+ if (backup_ch > 0) -+ set_channel_bwmode(padapter, backup_ch, backup_offset, backup_bw); -+ -+bypass_active_keep_alive: -+ ; -+ } else -+#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ { -+ if (rx_chk != _SUCCESS) { -+ if (pmlmeext->retry == 0) { -+#ifdef DBG_EXPIRATION_CHK -+ RTW_INFO("issue_probereq to trigger probersp, retry=%d\n", pmlmeext->retry); -+#endif -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); -+ } -+ } -+ -+ if (tx_chk != _SUCCESS && pmlmeinfo->link_count++ == link_count_limit -+#ifdef CONFIG_MCC_MODE -+ /* FW tx nulldata under MCC mode, we just check ap is alive */ -+ && (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) -+#endif /* CONFIG_MCC_MODE */ -+ ) { -+#ifdef DBG_EXPIRATION_CHK -+ RTW_INFO("%s issue_nulldata(%d)\n", __FUNCTION__, from_timer ? 1 : 0); -+#endif -+ tx_chk = issue_nulldata_in_interrupt(padapter, NULL, from_timer ? 1 : 0); -+ } -+ } -+ -+ if (rx_chk == _FAIL) { -+ pmlmeext->retry++; -+ if (pmlmeext->retry > rx_chk_limit) { -+ RTW_PRINT(FUNC_ADPT_FMT" disconnect or roaming\n", -+ FUNC_ADPT_ARG(padapter)); -+ receive_disconnect(padapter, pmlmeinfo->network.MacAddress -+ , WLAN_REASON_EXPIRATION_CHK, _FALSE); -+ return; -+ } -+ } else -+ pmlmeext->retry = 0; -+ -+ if (tx_chk == _FAIL) -+ pmlmeinfo->link_count %= (link_count_limit + 1); -+ else { -+ pxmitpriv->last_tx_pkts = pxmitpriv->tx_pkts; -+ pmlmeinfo->link_count = 0; -+ } -+ -+ } /* end of if ((psta = rtw_get_stainfo(pstapriv, passoc_res->network.MacAddress)) != NULL) */ -+ -+ } else if (is_client_associated_to_ibss(padapter)) { -+ _irqL irqL; -+ _list *phead, *plist, dlist; -+ -+ _rtw_init_listhead(&dlist); -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for (i = 0; i < NUM_STA; i++) { -+ -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ plist = get_next(plist); -+ -+ if (is_broadcast_mac_addr(psta->hwaddr)) -+ continue; -+ -+ if (chk_adhoc_peer_is_alive(psta) || !psta->expire_to) -+ psta->expire_to = pstapriv->adhoc_expire_to; -+ else -+ psta->expire_to--; -+ -+ if (psta->expire_to <= 0) { -+ rtw_list_delete(&psta->list); -+ rtw_list_insert_tail(&psta->list, &dlist); -+ } -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ plist = get_next(&dlist); -+ while (rtw_end_of_queue_search(&dlist, plist) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, list); -+ plist = get_next(plist); -+ rtw_list_delete(&psta->list); -+ RTW_INFO(FUNC_ADPT_FMT" ibss expire "MAC_FMT"\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->hwaddr)); -+ report_del_sta_event(padapter, psta->hwaddr, WLAN_REASON_EXPIRATION_CHK, from_timer ? _TRUE : _FALSE, _FALSE); -+ } -+ } -+ -+} -+ -+void survey_timer_hdl(_adapter *padapter) -+{ -+ struct cmd_obj *cmd; -+ struct sitesurvey_parm *psurveyPara; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif -+ -+ if (mlmeext_scan_state(pmlmeext) > SCAN_DISABLE) { -+ cmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (cmd == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ psurveyPara = (struct sitesurvey_parm *)rtw_zmalloc(sizeof(struct sitesurvey_parm)); -+ if (psurveyPara == NULL) { -+ rtw_warn_on(1); -+ rtw_mfree((unsigned char *)cmd, sizeof(struct cmd_obj)); -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(cmd, psurveyPara, GEN_CMD_CODE(_SiteSurvey)); -+ rtw_enqueue_cmd(pcmdpriv, cmd); -+ } -+ -+exit: -+ return; -+} -+ -+void link_timer_hdl(_adapter *padapter) -+{ -+ /* static unsigned int rx_pkt = 0; */ -+ /* static u64 tx_cnt = 0; */ -+ /* struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); */ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ /* struct sta_priv *pstapriv = &padapter->stapriv; */ -+#ifdef CONFIG_RTW_80211R -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+#endif -+ -+ if (pmlmeinfo->state & WIFI_FW_AUTH_NULL) { -+ RTW_INFO("link_timer_hdl:no beacon while connecting\n"); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ report_join_res(padapter, -3); -+ } else if (pmlmeinfo->state & WIFI_FW_AUTH_STATE) { -+ /* re-auth timer */ -+ if (++pmlmeinfo->reauth_count > REAUTH_LIMIT) { -+ /* if (pmlmeinfo->auth_algo != dot11AuthAlgrthm_Auto) */ -+ /* { */ -+ pmlmeinfo->state = 0; -+ report_join_res(padapter, -1); -+ return; -+ /* } */ -+ /* else */ -+ /* { */ -+ /* pmlmeinfo->auth_algo = dot11AuthAlgrthm_Shared; */ -+ /* pmlmeinfo->reauth_count = 0; */ -+ /* } */ -+ } -+ -+ RTW_INFO("link_timer_hdl: auth timeout and try again\n"); -+ pmlmeinfo->auth_seq = 1; -+ issue_auth(padapter, NULL, 0); -+ set_link_timer(pmlmeext, REAUTH_TO); -+ } else if (pmlmeinfo->state & WIFI_FW_ASSOC_STATE) { -+ /* re-assoc timer */ -+ if (++pmlmeinfo->reassoc_count > REASSOC_LIMIT) { -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+#ifdef CONFIG_RTW_80211R -+ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { -+ psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); -+ if (psta) -+ rtw_free_stainfo(padapter, psta); -+ } -+#endif -+ report_join_res(padapter, -2); -+ return; -+ } -+ -+#ifdef CONFIG_RTW_80211R -+ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { -+ RTW_INFO("link_timer_hdl: reassoc timeout and try again\n"); -+ issue_reassocreq(padapter); -+ } else -+#endif -+ { -+ RTW_INFO("link_timer_hdl: assoc timeout and try again\n"); -+ issue_assocreq(padapter); -+ } -+ -+ set_link_timer(pmlmeext, REASSOC_TO); -+ } -+ -+ return; -+} -+ -+void addba_timer_hdl(struct sta_info *psta) -+{ -+#ifdef CONFIG_80211N_HT -+ struct ht_priv *phtpriv; -+ -+ if (!psta) -+ return; -+ -+ phtpriv = &psta->htpriv; -+ -+ if ((phtpriv->ht_option == _TRUE) && (phtpriv->ampdu_enable == _TRUE)) { -+ if (phtpriv->candidate_tid_bitmap) -+ phtpriv->candidate_tid_bitmap = 0x0; -+ -+ } -+#endif /* CONFIG_80211N_HT */ -+} -+ -+#ifdef CONFIG_IEEE80211W -+void report_sta_timeout_event(_adapter *padapter, u8 *MacAddr, unsigned short reason) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct sta_info *psta; -+ int mac_id; -+ struct stadel_event *pdel_sta_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ return; -+ -+ cmdsz = (sizeof(struct stadel_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct stadel_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_TimeoutSTA); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ pdel_sta_evt = (struct stadel_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ _rtw_memcpy((unsigned char *)(&(pdel_sta_evt->macaddr)), MacAddr, ETH_ALEN); -+ _rtw_memcpy((unsigned char *)(pdel_sta_evt->rsvd), (unsigned char *)(&reason), 2); -+ -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, MacAddr); -+ if (psta) -+ mac_id = (int)psta->mac_id; -+ else -+ mac_id = (-1); -+ -+ pdel_sta_evt->mac_id = mac_id; -+ -+ RTW_INFO("report_del_sta_event: delete STA, mac_id=%d\n", mac_id); -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+} -+ -+void clnt_sa_query_timeout(_adapter *padapter) -+{ -+ -+ rtw_disassoc_cmd(padapter, 0, _TRUE); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ rtw_free_assoc_resources(padapter, 1); -+ -+ RTW_INFO("SA query timeout client disconnect\n"); -+} -+ -+void sa_query_timer_hdl(struct sta_info *psta) -+{ -+ _adapter *padapter = psta->padapter; -+ _irqL irqL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE && -+ check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ clnt_sa_query_timeout(padapter); -+ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ report_sta_timeout_event(padapter, psta->hwaddr, WLAN_REASON_PREV_AUTH_NOT_VALID); -+} -+ -+#endif /* CONFIG_IEEE80211W */ -+ -+#ifdef CONFIG_RTW_80211R -+void start_clnt_ft_action(_adapter *padapter, u8 *pTargetAddr) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ rtw_set_ft_status(padapter, RTW_FT_REQUESTING_STA); -+ issue_action_ft_request(padapter, pTargetAddr); -+ _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); -+} -+ -+void ft_link_timer_hdl(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ ft_priv *pftpriv = &pmlmepriv->ftpriv; -+ -+ if (rtw_chk_ft_status(padapter, RTW_FT_REQUESTING_STA)) { -+ if (pftpriv->ft_req_retry_cnt < FT_ACTION_REQ_LIMIT) { -+ pftpriv->ft_req_retry_cnt++; -+ issue_action_ft_request(padapter, (u8 *)pmlmepriv->roam_network->network.MacAddress); -+ _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); -+ } else { -+ pftpriv->ft_req_retry_cnt = 0; -+ -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ rtw_set_ft_status(padapter, RTW_FT_ASSOCIATED_STA); -+ else -+ rtw_reset_ft_status(padapter); -+ } -+ } -+} -+ -+void ft_roam_timer_hdl(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ receive_disconnect(padapter, pmlmepriv->cur_network.network.MacAddress -+ , WLAN_REASON_ACTIVE_ROAM, _FALSE); -+} -+ -+void issue_action_ft_request(_adapter *padapter, u8 *pTargetAddr) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct xmit_frame *pmgntframe = NULL; -+ struct rtw_ieee80211_hdr *pwlanhdr = NULL; -+ struct pkt_attrib *pattrib = NULL; -+ ft_priv *pftpriv = NULL; -+ u8 *pframe = NULL; -+ u8 category = RTW_WLAN_CATEGORY_FT; -+ u8 action = RTW_WLAN_ACTION_FT_REQUEST; -+ u8 is_ft_roaming_with_rsn_ie = _TRUE; -+ u8 *pie = NULL; -+ u16 *fctrl = NULL; -+ u32 ft_ie_len = 0; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ -+ _rtw_memcpy(pframe, adapter_mac_addr(padapter), ETH_ALEN); -+ pframe += ETH_ALEN; -+ pattrib->pktlen += ETH_ALEN; -+ -+ _rtw_memcpy(pframe, pTargetAddr, ETH_ALEN); -+ pframe += ETH_ALEN; -+ pattrib->pktlen += ETH_ALEN; -+ -+ pftpriv = &pmlmepriv->ftpriv; -+ pie = rtw_get_ie(pftpriv->updated_ft_ies, EID_WPA2, &ft_ie_len, pftpriv->updated_ft_ies_len); -+ if (pie) -+ pframe = rtw_set_ie(pframe, EID_WPA2, ft_ie_len, pie+2, &(pattrib->pktlen)); -+ else -+ is_ft_roaming_with_rsn_ie = _FALSE; -+ -+ pie = rtw_get_ie(pftpriv->updated_ft_ies, _MDIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); -+ if (pie) -+ pframe = rtw_set_ie(pframe, _MDIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); -+ -+ pie = rtw_get_ie(pftpriv->updated_ft_ies, _FTIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); -+ if (pie && is_ft_roaming_with_rsn_ie) -+ pframe = rtw_set_ie(pframe, _FTIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+} -+ -+void report_ft_event(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ ft_priv *pftpriv = &pmlmepriv->ftpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+ struct cfg80211_ft_event_params ft_evt_parms; -+ _irqL irqL; -+ -+ _rtw_memset(&ft_evt_parms, 0, sizeof(ft_evt_parms)); -+ rtw_update_ft_stainfo(padapter, pnetwork); -+ -+ if (!pnetwork) -+ goto err_2; -+ -+ ft_evt_parms.ies_len = pftpriv->ft_event.ies_len; -+ ft_evt_parms.ies = rtw_zmalloc(ft_evt_parms.ies_len); -+ if (ft_evt_parms.ies) -+ _rtw_memcpy((void *)ft_evt_parms.ies, pftpriv->ft_event.ies, ft_evt_parms.ies_len); -+ else -+ goto err_2; -+ -+ ft_evt_parms.target_ap = rtw_zmalloc(ETH_ALEN); -+ if (ft_evt_parms.target_ap) -+ _rtw_memcpy((void *)ft_evt_parms.target_ap, pnetwork->MacAddress, ETH_ALEN); -+ else -+ goto err_1; -+ -+ ft_evt_parms.ric_ies = pftpriv->ft_event.ric_ies; -+ ft_evt_parms.ric_ies_len = pftpriv->ft_event.ric_ies_len; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ rtw_set_ft_status(padapter, RTW_FT_AUTHENTICATED_STA); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ rtw_cfg80211_ft_event(padapter, &ft_evt_parms); -+ RTW_INFO("FT: report_ft_event\n"); -+ rtw_mfree((u8 *)pftpriv->ft_event.target_ap, ETH_ALEN); -+err_1: -+ rtw_mfree((u8 *)ft_evt_parms.ies, ft_evt_parms.ies_len); -+err_2: -+ return; -+} -+ -+void report_ft_reassoc_event(_adapter *padapter, u8 *pMacAddr) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct cmd_obj *pcmd_obj = NULL; -+ struct stassoc_event *passoc_sta_evt = NULL; -+ struct C2HEvent_Header *pc2h_evt_hdr = NULL; -+ u8 *pevtcmd = NULL; -+ u32 cmdsz = 0; -+ -+ pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (pcmd_obj == NULL) -+ return; -+ -+ cmdsz = (sizeof(struct stassoc_event) + sizeof(struct C2HEvent_Header)); -+ pevtcmd = (u8 *)rtw_zmalloc(cmdsz); -+ if (pevtcmd == NULL) { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header *)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct stassoc_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_FT_REASSOC); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ passoc_sta_evt = (struct stassoc_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ _rtw_memcpy((unsigned char *)(&(passoc_sta_evt->macaddr)), pMacAddr, ETH_ALEN); -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+} -+#endif -+ -+u8 NULL_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ return H2C_SUCCESS; -+} -+ -+#ifdef CONFIG_AUTO_AP_MODE -+void rtw_start_auto_ap(_adapter *adapter) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ rtw_set_802_11_infrastructure_mode(adapter, Ndis802_11APMode); -+ -+ rtw_setopmode_cmd(adapter, Ndis802_11APMode, _TRUE); -+} -+ -+static int rtw_auto_ap_start_beacon(_adapter *adapter) -+{ -+ int ret = 0; -+ u8 *pbuf = NULL; -+ uint len; -+ u8 supportRate[16]; -+ int sz = 0, rateLen; -+ u8 *ie; -+ u8 wireless_mode, oper_channel; -+ u8 ssid[3] = {0}; /* hidden ssid */ -+ u32 ssid_len = sizeof(ssid); -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return -EINVAL; -+ -+ -+ len = 128; -+ pbuf = rtw_zmalloc(len); -+ if (!pbuf) -+ return -ENOMEM; -+ -+ -+ /* generate beacon */ -+ ie = pbuf; -+ -+ /* timestamp will be inserted by hardware */ -+ sz += 8; -+ ie += sz; -+ -+ /* beacon interval : 2bytes */ -+ *(u16 *)ie = cpu_to_le16((u16)100); /* BCN_INTERVAL=100; */ -+ sz += 2; -+ ie += 2; -+ -+ /* capability info */ -+ *(u16 *)ie = 0; -+ *(u16 *)ie |= cpu_to_le16(cap_ESS); -+ *(u16 *)ie |= cpu_to_le16(cap_ShortPremble); -+ /* *(u16*)ie |= cpu_to_le16(cap_Privacy); */ -+ sz += 2; -+ ie += 2; -+ -+ /* SSID */ -+ ie = rtw_set_ie(ie, _SSID_IE_, ssid_len, ssid, &sz); -+ -+ /* supported rates */ -+ wireless_mode = WIRELESS_11BG_24N; -+ rtw_set_supported_rate(supportRate, wireless_mode) ; -+ rateLen = rtw_get_rateset_len(supportRate); -+ if (rateLen > 8) -+ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, 8, supportRate, &sz); -+ else -+ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, rateLen, supportRate, &sz); -+ -+ -+ /* DS parameter set */ -+ if (rtw_mi_check_status(adapter, MI_LINKED)) -+ oper_channel = rtw_mi_get_union_chan(adapter); -+ else -+ oper_channel = adapter_to_dvobj(adapter)->oper_channel; -+ -+ ie = rtw_set_ie(ie, _DSSET_IE_, 1, &oper_channel, &sz); -+ -+ /* ext supported rates */ -+ if (rateLen > 8) -+ ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (supportRate + 8), &sz); -+ -+ RTW_INFO("%s, start auto ap beacon sz=%d\n", __FUNCTION__, sz); -+ -+ /* lunch ap mode & start to issue beacon */ -+ if (rtw_check_beacon_data(adapter, pbuf, sz) == _SUCCESS) { -+ -+ } else -+ ret = -EINVAL; -+ -+ -+ rtw_mfree(pbuf, len); -+ -+ return ret; -+ -+} -+#endif/* CONFIG_AUTO_AP_MODE */ -+ -+u8 setopmode_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ u8 type; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct setopmode_parm *psetop = (struct setopmode_parm *)pbuf; -+ -+ if (psetop->mode == Ndis802_11APMode) { -+ pmlmeinfo->state = WIFI_FW_AP_STATE; -+ type = _HW_STATE_AP_; -+#ifdef CONFIG_NATIVEAP_MLME -+ /* start_ap_mode(padapter); */ -+#endif -+ } else if (psetop->mode == Ndis802_11Infrastructure) { -+ pmlmeinfo->state &= ~(BIT(0) | BIT(1)); /* clear state */ -+ pmlmeinfo->state |= WIFI_FW_STATION_STATE;/* set to STATION_STATE */ -+ type = _HW_STATE_STATION_; -+ } else if (psetop->mode == Ndis802_11IBSS) -+ type = _HW_STATE_ADHOC_; -+ else if (psetop->mode == Ndis802_11Monitor) -+ type = _HW_STATE_MONITOR_; -+ else -+ type = _HW_STATE_NOLINK_; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_OPMODE, (u8 *)(&type)); -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (psetop->mode == Ndis802_11APMode) -+ rtw_auto_ap_start_beacon(padapter); -+#endif -+ -+ if (rtw_port_switch_chk(padapter) == _TRUE) { -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+ -+ if (psetop->mode == Ndis802_11APMode) -+ adapter_to_pwrctl(padapter)->fw_psmode_iface_id = 0xff; /* ap mode won't dowload rsvd pages */ -+ else if (psetop->mode == Ndis802_11Infrastructure) { -+#ifdef CONFIG_LPS -+ _adapter *port0_iface = dvobj_get_port0_adapter(adapter_to_dvobj(padapter)); -+ if (port0_iface) -+ rtw_lps_ctrl_wk_cmd(port0_iface, LPS_CTRL_CONNECT, 0); -+#endif -+ } -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ if (psetop->mode == Ndis802_11APMode || -+ psetop->mode == Ndis802_11Monitor) { -+ /* Do this after port switch to */ -+ /* prevent from downloading rsvd page to wrong port */ -+ rtw_btcoex_MediaStatusNotify(padapter, 1); /* connect */ -+ } -+#endif /* CONFIG_BT_COEXIST */ -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 createbss_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+ WLAN_BSSID_EX *pdev_network = &padapter->registrypriv.dev_network; -+ struct createbss_parm *parm = (struct createbss_parm *)pbuf; -+ u8 ret = H2C_SUCCESS; -+ /* u8 initialgain; */ -+ -+#ifdef CONFIG_AP_MODE -+ if (pmlmeinfo->state == WIFI_FW_AP_STATE) { -+ start_bss_network(padapter, parm); -+ goto exit; -+ } -+#endif -+ -+ /* below is for ad-hoc master */ -+ if (parm->adhoc) { -+ rtw_warn_on(pdev_network->InfrastructureMode != Ndis802_11IBSS); -+ rtw_joinbss_reset(padapter); -+ -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pmlmeinfo->ERP_enable = 0; -+ pmlmeinfo->WMM_enable = 0; -+ pmlmeinfo->HT_enable = 0; -+ pmlmeinfo->HT_caps_enable = 0; -+ pmlmeinfo->HT_info_enable = 0; -+ pmlmeinfo->agg_enable_bitmap = 0; -+ pmlmeinfo->candidate_tid_bitmap = 0; -+ -+ /* config the initial gain under linking, need to write the BB registers */ -+ /* initialgain = 0x1E; */ -+ /*rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE);*/ -+ -+ /* disable dynamic functions, such as high power, DIG */ -+ rtw_phydm_ability_backup(padapter); -+ rtw_phydm_func_disable_all(padapter); -+ -+ /* cancel link timer */ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ /* clear CAM */ -+ flush_all_cam_entry(padapter); -+ -+ pdev_network->Length = get_WLAN_BSSID_EX_sz(pdev_network); -+ _rtw_memcpy(pnetwork, pdev_network, FIELD_OFFSET(WLAN_BSSID_EX, IELength)); -+ pnetwork->IELength = pdev_network->IELength; -+ -+ if (pnetwork->IELength > MAX_IE_SZ) { -+ ret = H2C_PARAMETERS_ERROR; -+ goto ibss_post_hdl; -+ } -+ -+ _rtw_memcpy(pnetwork->IEs, pdev_network->IEs, pnetwork->IELength); -+ start_create_ibss(padapter); -+ } else { -+ rtw_warn_on(1); -+ ret = H2C_PARAMETERS_ERROR; -+ } -+ -+ibss_post_hdl: -+ rtw_create_ibss_post_hdl(padapter, ret); -+ -+exit: -+ return ret; -+} -+ -+u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ u8 join_type; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ struct joinbss_parm *pparm = (struct joinbss_parm *)pbuf; -+#endif /* CONFIG_ANTENNA_DIVERSITY */ -+ u32 i; -+ /* u8 initialgain; */ -+ /* u32 acparm; */ -+ u8 u_ch, u_bw, u_offset; -+ u8 doiqk = _FALSE; -+ -+ /* check already connecting to AP or not */ -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { -+ if (pmlmeinfo->state & WIFI_FW_STATION_STATE) -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+ /* clear CAM */ -+ flush_all_cam_entry(padapter); -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ /* set MSR to nolink->infra. mode */ -+ /* Set_MSR(padapter, _HW_STATE_NOLINK_); */ -+ Set_MSR(padapter, _HW_STATE_STATION_); -+ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, 0); -+ } -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ rtw_antenna_select_cmd(padapter, pparm->network.PhyInfo.Optimum_antenna, _FALSE); -+#endif -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_clear_all_cam_entry(padapter); -+#endif -+ -+ rtw_joinbss_reset(padapter); -+ -+ pmlmeinfo->ERP_enable = 0; -+ pmlmeinfo->WMM_enable = 0; -+ pmlmeinfo->HT_enable = 0; -+ pmlmeinfo->HT_caps_enable = 0; -+ pmlmeinfo->HT_info_enable = 0; -+ pmlmeinfo->agg_enable_bitmap = 0; -+ pmlmeinfo->candidate_tid_bitmap = 0; -+ pmlmeinfo->bwmode_updated = _FALSE; -+ /* pmlmeinfo->assoc_AP_vendor = HT_IOT_PEER_MAX; */ -+ pmlmeinfo->VHT_enable = 0; -+ -+ _rtw_memcpy(pnetwork, pbuf, FIELD_OFFSET(WLAN_BSSID_EX, IELength)); -+ pnetwork->IELength = ((WLAN_BSSID_EX *)pbuf)->IELength; -+ -+ if (pnetwork->IELength > MAX_IE_SZ) /* Check pbuf->IELength */ -+ return H2C_PARAMETERS_ERROR; -+ -+ if (pnetwork->IELength < 2) { -+ report_join_res(padapter, (-4)); -+ return H2C_SUCCESS; -+ } -+ _rtw_memcpy(pnetwork->IEs, ((WLAN_BSSID_EX *)pbuf)->IEs, pnetwork->IELength); -+ -+ pmlmeinfo->bcn_interval = get_beacon_interval(pnetwork); -+ -+ /* Check AP vendor to move rtw_joinbss_cmd() */ -+ /* pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->IEs, pnetwork->IELength); */ -+ -+ /* sizeof(NDIS_802_11_FIXED_IEs) */ -+ for (i = _FIXED_IE_LENGTH_ ; i < pnetwork->IELength - 2 ;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pnetwork->IEs + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: /* Get WMM IE. */ -+ if (_rtw_memcmp(pIE->data, WMM_OUI, 4)) -+ WMM_param_handler(padapter, pIE); -+ break; -+ -+#ifdef CONFIG_80211N_HT -+ case _HT_CAPABILITY_IE_: /* Get HT Cap IE. */ -+ pmlmeinfo->HT_caps_enable = 1; -+ break; -+ -+ case _HT_EXTRA_INFO_IE_: /* Get HT Info IE. */ -+ pmlmeinfo->HT_info_enable = 1; -+ break; -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_80211AC_VHT -+ case EID_VHTCapability: /* Get VHT Cap IE. */ -+ pmlmeinfo->VHT_enable = 1; -+ break; -+ -+ case EID_VHTOperation: /* Get VHT Operation IE. */ -+ break; -+#endif /* CONFIG_80211AC_VHT */ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ rtw_bss_get_chbw(pnetwork -+ , &pmlmeext->cur_channel, &pmlmeext->cur_bwmode, &pmlmeext->cur_ch_offset); -+ -+#ifdef CONFIG_80211N_HT -+ rtw_adjust_chbw(padapter, pmlmeext->cur_channel, &pmlmeext->cur_bwmode, -+ &pmlmeext->cur_ch_offset); -+#endif -+ -+#if 0 -+ if (padapter->registrypriv.wifi_spec) { -+ /* for WiFi test, follow WMM test plan spec */ -+ acparm = 0x002F431C; /* VO */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); -+ acparm = 0x005E541C; /* VI */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); -+ acparm = 0x0000A525; /* BE */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); -+ acparm = 0x0000A549; /* BK */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); -+ -+ /* for WiFi test, mixed mode with intel STA under bg mode throughput issue */ -+ if (padapter->mlmepriv.htpriv.ht_option == _FALSE) { -+ acparm = 0x00004320; -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); -+ } -+ } else { -+ acparm = 0x002F3217; /* VO */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); -+ acparm = 0x005E4317; /* VI */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); -+ acparm = 0x00105320; /* BE */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); -+ acparm = 0x0000A444; /* BK */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); -+ } -+#endif -+ -+ /* check channel, bandwidth, offset and switch */ -+ if (rtw_chk_start_clnt_join(padapter, &u_ch, &u_bw, &u_offset) == _FAIL) { -+ report_join_res(padapter, (-4)); -+ return H2C_SUCCESS; -+ } -+ -+ /* disable dynamic functions, such as high power, DIG */ -+ /*rtw_phydm_func_disable_all(padapter);*/ -+ -+ /* config the initial gain under linking, need to write the BB registers */ -+ /* initialgain = 0x1E; */ -+ /*rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE);*/ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress); -+ join_type = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ doiqk = _TRUE; -+ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); -+ -+ set_channel_bwmode(padapter, u_ch, u_offset, u_bw); -+ rtw_mi_update_union_chan_inf(padapter, u_ch, u_offset, u_bw); -+ -+ doiqk = _FALSE; -+ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); -+ -+ /* cancel link timer */ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ start_clnt_join(padapter); -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 disconnect_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct disconnect_parm *param = (struct disconnect_parm *)pbuf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+ u8 val8; -+ -+ if (is_client_associated_to_ap(padapter)) { -+#ifdef CONFIG_DFS -+ if (padapter->mlmepriv.handle_dfs == _FALSE) -+#endif /* CONFIG_DFS */ -+#ifdef CONFIG_PLATFORM_ROCKCHIPS -+ /* To avoid connecting to AP fail during resume process, change retry count from 5 to 1 */ -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); -+#else -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, param->deauth_timeout_ms / 100, 100); -+#endif /* CONFIG_PLATFORM_ROCKCHIPS */ -+ } -+ -+#ifdef CONFIG_DFS -+ if (padapter->mlmepriv.handle_dfs == _TRUE) -+ padapter->mlmepriv.handle_dfs = _FALSE; -+#endif /* CONFIG_DFS */ -+ -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) { -+ /* Stop BCN */ -+ val8 = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_FUNC, (u8 *)(&val8)); -+ } -+ -+ rtw_mlmeext_disconnect(padapter); -+ -+ rtw_free_uc_swdec_pending_queue(padapter); -+ -+ return H2C_SUCCESS; -+} -+ -+static const char *const _scan_state_str[] = { -+ "SCAN_DISABLE", -+ "SCAN_START", -+ "SCAN_PS_ANNC_WAIT", -+ "SCAN_ENTER", -+ "SCAN_PROCESS", -+ "SCAN_BACKING_OP", -+ "SCAN_BACK_OP", -+ "SCAN_LEAVING_OP", -+ "SCAN_LEAVE_OP", -+ "SCAN_SW_ANTDIV_BL", -+ "SCAN_TO_P2P_LISTEN", -+ "SCAN_P2P_LISTEN", -+ "SCAN_COMPLETE", -+ "SCAN_STATE_MAX", -+}; -+ -+const char *scan_state_str(u8 state) -+{ -+ state = (state >= SCAN_STATE_MAX) ? SCAN_STATE_MAX : state; -+ return _scan_state_str[state]; -+} -+ -+static bool scan_abort_hdl(_adapter *adapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct ss_res *ss = &pmlmeext->sitesurvey_res; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+#endif -+ bool ret = _FALSE; -+ -+ if (pmlmeext->scan_abort == _TRUE) { -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(&adapter->wdinfo, P2P_STATE_NONE)) { -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_MAX); -+ ss->channel_idx = 3; -+ RTW_INFO("%s idx:%d, cnt:%u\n", __FUNCTION__ -+ , ss->channel_idx -+ , pwdinfo->find_phase_state_exchange_cnt -+ ); -+ } else -+#endif -+ { -+ ss->channel_idx = ss->ch_num; -+ RTW_INFO("%s idx:%d\n", __FUNCTION__ -+ , ss->channel_idx -+ ); -+ } -+ pmlmeext->scan_abort = _FALSE; -+ ret = _TRUE; -+ } -+ -+ return ret; -+} -+ -+u8 rtw_scan_sparse(_adapter *adapter, struct rtw_ieee80211_channel *ch, u8 ch_num) -+{ -+ /* interval larger than this is treated as backgroud scan */ -+#ifndef RTW_SCAN_SPARSE_BG_INTERVAL_MS -+#define RTW_SCAN_SPARSE_BG_INTERVAL_MS 12000 -+#endif -+ -+#ifndef RTW_SCAN_SPARSE_CH_NUM_MIRACAST -+#define RTW_SCAN_SPARSE_CH_NUM_MIRACAST 1 -+#endif -+#ifndef RTW_SCAN_SPARSE_CH_NUM_BG -+#define RTW_SCAN_SPARSE_CH_NUM_BG 4 -+#endif -+#ifdef CONFIG_LAYER2_ROAMING -+#ifndef RTW_SCAN_SPARSE_CH_NUM_ROAMING_ACTIVE -+#define RTW_SCAN_SPARSE_CH_NUM_ROAMING_ACTIVE 1 -+#endif -+#endif -+ -+#define SCAN_SPARSE_CH_NUM_INVALID 255 -+ -+ static u8 token = 255; -+ u32 interval; -+ bool busy_traffic = _FALSE; -+ bool miracast_enabled = _FALSE; -+ bool bg_scan = _FALSE; -+ u8 max_allow_ch = SCAN_SPARSE_CH_NUM_INVALID; -+ u8 scan_division_num; -+ u8 ret_num = ch_num; -+ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ -+ if (regsty->wifi_spec) -+ goto exit; -+ -+ /* assume ch_num > 6 is normal scan */ -+ if (ch_num <= 6) -+ goto exit; -+ -+ if (mlmeext->last_scan_time == 0) -+ mlmeext->last_scan_time = rtw_get_current_time(); -+ -+ interval = rtw_get_passing_time_ms(mlmeext->last_scan_time); -+ -+ -+ if (rtw_mi_busy_traffic_check(adapter, _FALSE)) -+ busy_traffic = _TRUE; -+ -+ if (rtw_mi_check_miracast_enabled(adapter)) -+ miracast_enabled = _TRUE; -+ -+ if (interval > RTW_SCAN_SPARSE_BG_INTERVAL_MS) -+ bg_scan = _TRUE; -+ -+ /* max_allow_ch by conditions*/ -+ -+#if RTW_SCAN_SPARSE_MIRACAST -+ if (miracast_enabled == _TRUE && busy_traffic == _TRUE) -+ max_allow_ch = rtw_min(max_allow_ch, RTW_SCAN_SPARSE_CH_NUM_MIRACAST); -+#endif -+ -+#if RTW_SCAN_SPARSE_BG -+ if (bg_scan == _TRUE) -+ max_allow_ch = rtw_min(max_allow_ch, RTW_SCAN_SPARSE_CH_NUM_BG); -+#endif -+ -+#if defined(CONFIG_LAYER2_ROAMING) && defined(RTW_SCAN_SPARSE_ROAMING_ACTIVE) -+ if (rtw_chk_roam_flags(adapter, RTW_ROAM_ACTIVE)) { -+ if (busy_traffic == _TRUE && adapter->mlmepriv.need_to_roam == _TRUE) -+ max_allow_ch = rtw_min(max_allow_ch, RTW_SCAN_SPARSE_CH_NUM_ROAMING_ACTIVE); -+ } -+#endif -+ -+ -+ if (max_allow_ch != SCAN_SPARSE_CH_NUM_INVALID) { -+ int i; -+ int k = 0; -+ -+ scan_division_num = (ch_num / max_allow_ch) + ((ch_num % max_allow_ch) ? 1 : 0); -+ token = (token + 1) % scan_division_num; -+ -+ if (0) -+ RTW_INFO("scan_division_num:%u, token:%u\n", scan_division_num, token); -+ -+ for (i = 0; i < ch_num; i++) { -+ if (ch[i].hw_value && (i % scan_division_num) == token -+ ) { -+ if (i != k) -+ _rtw_memcpy(&ch[k], &ch[i], sizeof(struct rtw_ieee80211_channel)); -+ k++; -+ } -+ } -+ -+ _rtw_memset(&ch[k], 0, sizeof(struct rtw_ieee80211_channel)); -+ -+ ret_num = k; -+ mlmeext->last_scan_time = rtw_get_current_time(); -+ } -+ -+exit: -+ return ret_num; -+} -+ -+static int rtw_scan_ch_decision(_adapter *padapter, struct rtw_ieee80211_channel *out, -+ u32 out_num, struct rtw_ieee80211_channel *in, u32 in_num) -+{ -+ int i, j; -+ int scan_ch_num = 0; -+ int set_idx; -+ u8 chan; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ /* clear first */ -+ _rtw_memset(out, 0, sizeof(struct rtw_ieee80211_channel) * out_num); -+ -+ /* acquire channels from in */ -+ j = 0; -+ for (i = 0; i < in_num; i++) { -+ -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" "CHAN_FMT"\n", FUNC_ADPT_ARG(padapter), CHAN_ARG(&in[i])); -+ -+ if (!in[i].hw_value || (in[i].flags & RTW_IEEE80211_CHAN_DISABLED)) -+ continue; -+ if (rtw_mlme_band_check(padapter, in[i].hw_value) == _FALSE) -+ continue; -+ -+ set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, in[i].hw_value); -+ if (set_idx >= 0) { -+ if (j >= out_num) { -+ RTW_PRINT(FUNC_ADPT_FMT" out_num:%u not enough\n", -+ FUNC_ADPT_ARG(padapter), out_num); -+ break; -+ } -+ -+ _rtw_memcpy(&out[j], &in[i], sizeof(struct rtw_ieee80211_channel)); -+ -+ if (pmlmeext->channel_set[set_idx].ScanType == SCAN_PASSIVE) -+ out[j].flags |= RTW_IEEE80211_CHAN_PASSIVE_SCAN; -+ -+ j++; -+ } -+ if (j >= out_num) -+ break; -+ } -+ -+ /* if out is empty, use channel_set as default */ -+ if (j == 0) { -+ for (i = 0; i < pmlmeext->max_chan_nums; i++) { -+ chan = pmlmeext->channel_set[i].ChannelNum; -+ if (rtw_mlme_band_check(padapter, chan) == _TRUE) { -+ if (rtw_mlme_ignore_chan(padapter, chan) == _TRUE) -+ continue; -+ -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" ch:%u\n", FUNC_ADPT_ARG(padapter), chan); -+ -+ if (j >= out_num) { -+ RTW_PRINT(FUNC_ADPT_FMT" out_num:%u not enough\n", -+ FUNC_ADPT_ARG(padapter), out_num); -+ break; -+ } -+ -+ out[j].hw_value = chan; -+ -+ if (pmlmeext->channel_set[i].ScanType == SCAN_PASSIVE) -+ out[j].flags |= RTW_IEEE80211_CHAN_PASSIVE_SCAN; -+ -+ j++; -+ } -+ } -+ } -+ -+ /* scan_sparse */ -+ j = rtw_scan_sparse(padapter, out, j); -+ -+ return j; -+} -+ -+static void sitesurvey_res_reset(_adapter *adapter, struct sitesurvey_parm *parm) -+{ -+ struct ss_res *ss = &adapter->mlmeextpriv.sitesurvey_res; -+ int i; -+ -+ ss->bss_cnt = 0; -+ ss->channel_idx = 0; -+ ss->igi_scan = 0; -+ ss->igi_before_scan = 0; -+#ifdef CONFIG_SCAN_BACKOP -+ ss->scan_cnt = 0; -+#endif -+#if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) -+ ss->is_sw_antdiv_bl_scan = 0; -+#endif -+ -+ for (i = 0; i < RTW_SSID_SCAN_AMOUNT; i++) { -+ if (parm->ssid[i].SsidLength) { -+ _rtw_memcpy(ss->ssid[i].Ssid, parm->ssid[i].Ssid, IW_ESSID_MAX_SIZE); -+ ss->ssid[i].SsidLength = parm->ssid[i].SsidLength; -+ } else -+ ss->ssid[i].SsidLength = 0; -+ } -+ -+ ss->ch_num = rtw_scan_ch_decision(adapter -+ , ss->ch, RTW_CHANNEL_SCAN_AMOUNT -+ , parm->ch, parm->ch_num -+ ); -+ -+ ss->scan_mode = parm->scan_mode; -+} -+ -+static u8 sitesurvey_pick_ch_behavior(_adapter *padapter, u8 *ch, RT_SCAN_TYPE *type) -+{ -+ u8 next_state; -+ u8 scan_ch = 0; -+ RT_SCAN_TYPE scan_type = SCAN_PASSIVE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ struct ss_res *ss = &pmlmeext->sitesurvey_res; -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif -+ -+ /* handle scan abort request */ -+ scan_abort_hdl(padapter); -+ -+#ifdef CONFIG_P2P -+ if (pwdinfo->rx_invitereq_info.scan_op_ch_only || pwdinfo->p2p_info.scan_op_ch_only) { -+ if (pwdinfo->rx_invitereq_info.scan_op_ch_only) -+ scan_ch = pwdinfo->rx_invitereq_info.operation_ch[ss->channel_idx]; -+ else -+ scan_ch = pwdinfo->p2p_info.operation_ch[ss->channel_idx]; -+ scan_type = SCAN_ACTIVE; -+ } else if (rtw_p2p_findphase_ex_is_social(pwdinfo)) { -+ /* -+ * Commented by Albert 2011/06/03 -+ * The driver is in the find phase, it should go through the social channel. -+ */ -+ int ch_set_idx; -+ -+ scan_ch = pwdinfo->social_chan[ss->channel_idx]; -+ ch_set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, scan_ch); -+ if (ch_set_idx >= 0) -+ scan_type = pmlmeext->channel_set[ch_set_idx].ScanType; -+ else -+ scan_type = SCAN_ACTIVE; -+ } else -+#endif /* CONFIG_P2P */ -+ { -+ struct rtw_ieee80211_channel *ch; -+ -+ if (ss->channel_idx < ss->ch_num) { -+ ch = &ss->ch[ss->channel_idx]; -+ scan_ch = ch->hw_value; -+ scan_type = (ch->flags & RTW_IEEE80211_CHAN_PASSIVE_SCAN) ? SCAN_PASSIVE : SCAN_ACTIVE; -+ } -+ } -+ -+ if (scan_ch != 0) { -+ next_state = SCAN_PROCESS; -+#ifdef CONFIG_SCAN_BACKOP -+ { -+ struct mi_state mstate; -+ u8 backop_flags = 0; -+ -+ rtw_mi_status(padapter, &mstate); -+ -+ if ((MSTATE_STA_LD_NUM(&mstate) && mlmeext_chk_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN)) -+ || (MSTATE_STA_NUM(&mstate) && mlmeext_chk_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN_NL))) -+ backop_flags |= mlmeext_scan_backop_flags_sta(pmlmeext); -+ -+ if ((MSTATE_AP_LD_NUM(&mstate) && mlmeext_chk_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN)) -+ || (MSTATE_AP_NUM(&mstate) && mlmeext_chk_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN_NL))) -+ backop_flags |= mlmeext_scan_backop_flags_ap(pmlmeext); -+ -+ if (backop_flags) { -+ if (ss->scan_cnt < ss->scan_cnt_max) -+ ss->scan_cnt++; -+ else { -+ mlmeext_assign_scan_backop_flags(pmlmeext, backop_flags); -+ next_state = SCAN_BACKING_OP; -+ } -+ } -+ } -+#endif /* CONFIG_SCAN_BACKOP */ -+ } else if (rtw_p2p_findphase_ex_is_needed(pwdinfo)) { -+ /* go p2p listen */ -+ next_state = SCAN_TO_P2P_LISTEN; -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ } else if (rtw_hal_antdiv_before_linked(padapter)) { -+ /* go sw antdiv before link */ -+ next_state = SCAN_SW_ANTDIV_BL; -+#endif -+ } else { -+ next_state = SCAN_COMPLETE; -+ -+#if defined(DBG_SCAN_SW_ANTDIV_BL) -+ { -+ /* for SCAN_SW_ANTDIV_BL state testing */ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ int i; -+ bool is_linked = _FALSE; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (rtw_linked_check(dvobj->padapters[i])) -+ is_linked = _TRUE; -+ } -+ -+ if (!is_linked) { -+ static bool fake_sw_antdiv_bl_state = 0; -+ -+ if (fake_sw_antdiv_bl_state == 0) { -+ next_state = SCAN_SW_ANTDIV_BL; -+ fake_sw_antdiv_bl_state = 1; -+ } else -+ fake_sw_antdiv_bl_state = 0; -+ } -+ } -+#endif /* defined(DBG_SCAN_SW_ANTDIV_BL) */ -+ } -+ -+#ifdef CONFIG_SCAN_BACKOP -+ if (next_state != SCAN_PROCESS) -+ ss->scan_cnt = 0; -+#endif -+ -+ -+#ifdef DBG_FIXED_CHAN -+ if (pmlmeext->fixed_chan != 0xff && next_state == SCAN_PROCESS) -+ scan_ch = pmlmeext->fixed_chan; -+#endif -+ -+ if (ch) -+ *ch = scan_ch; -+ if (type) -+ *type = scan_type; -+ -+ return next_state; -+} -+ -+void site_survey(_adapter *padapter, u8 survey_channel, RT_SCAN_TYPE ScanType) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif -+ -+ if (survey_channel != 0) { -+ set_channel_bwmode(padapter, survey_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ if (ACS_ENABLE == GET_ACS_STATE(padapter)) { -+ ACS_OP acs_op = ACS_RESET; -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &acs_op, _TRUE); -+ rtw_set_acs_channel(padapter, survey_channel); -+#ifdef DBG_AUTO_CHNL_SEL_NHM -+ RTW_INFO("[ACS-"ADPT_FMT"]-set ch:%u\n", -+ ADPT_ARG(padapter), rtw_get_acs_channel(padapter)); -+#endif -+ } -+#endif -+ -+ if (ScanType == SCAN_ACTIVE) { -+#ifdef CONFIG_P2P -+ #ifdef CONFIG_IOCTL_CFG80211 -+ if (rtw_cfg80211_is_p2p_scan(padapter)) -+ #else -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) -+ || rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH)) -+ #endif -+ { -+ issue_probereq_p2p(padapter, NULL); -+ issue_probereq_p2p(padapter, NULL); -+ issue_probereq_p2p(padapter, NULL); -+ } else -+#endif /* CONFIG_P2P */ -+ { -+ int i; -+ -+ for (i = 0; i < RTW_SSID_SCAN_AMOUNT; i++) { -+ if (pmlmeext->sitesurvey_res.ssid[i].SsidLength) { -+ /* IOT issue, When wifi_spec is not set, send one probe req without WPS IE. */ -+ if (padapter->registrypriv.wifi_spec) -+ issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); -+ else -+ issue_probereq_ex(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL, 0, 0, 0, 0); -+ issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); -+ } -+ } -+ -+ if (pmlmeext->sitesurvey_res.scan_mode == SCAN_ACTIVE) { -+ /* IOT issue, When wifi_spec is not set, send one probe req without WPS IE. */ -+ if (padapter->registrypriv.wifi_spec) -+ issue_probereq(padapter, NULL, NULL); -+ else -+ issue_probereq_ex(padapter, NULL, NULL, 0, 0, 0, 0); -+ issue_probereq(padapter, NULL, NULL); -+ } -+ } -+ } -+ } else { -+ /* channel number is 0 or this channel is not valid. */ -+ rtw_warn_on(1); -+ } -+ -+ return; -+} -+ -+void survey_done_set_ch_bw(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u8 cur_channel = 0; -+ u8 cur_bwmode; -+ u8 cur_ch_offset; -+ -+#ifdef CONFIG_MCC_MODE -+ if (!rtw_hal_mcc_change_scan_flag(padapter, &cur_channel, &cur_bwmode, &cur_ch_offset)) { -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" back to AP channel - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), cur_channel, cur_bwmode, cur_ch_offset); -+ goto exit; -+ } -+#endif -+ -+ if (rtw_mi_get_ch_setting_union(padapter, &cur_channel, &cur_bwmode, &cur_ch_offset) != 0) { -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), cur_channel, cur_bwmode, cur_ch_offset); -+ } else { -+#ifdef CONFIG_P2P -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (iface->wdinfo.driver_interface == DRIVER_CFG80211 && !adapter_wdev_data(iface)->p2p_enabled) -+ continue; -+#endif -+ -+ if (rtw_p2p_chk_state(&iface->wdinfo, P2P_STATE_LISTEN)) { -+ cur_channel = iface->wdinfo.listen_channel; -+ cur_bwmode = CHANNEL_WIDTH_20; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" back to "ADPT_FMT"'s listen ch - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ADPT_ARG(iface), cur_channel, cur_bwmode, cur_ch_offset); -+ break; -+ } -+ } -+#endif /* CONFIG_P2P */ -+ -+ if (cur_channel == 0) { -+ cur_channel = pmlmeext->cur_channel; -+ cur_bwmode = pmlmeext->cur_bwmode; -+ cur_ch_offset = pmlmeext->cur_ch_offset; -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" back to ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), cur_channel, cur_bwmode, cur_ch_offset); -+ } -+ } -+exit: -+ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+} -+ -+#if 1 -+/** -+ * sitesurvey_ps_annc - check and doing ps announcement for all the adapters of given @dvobj -+ * @padapter -+ * @ps: power saving or not -+ * -+ * Returns: 0: no ps announcement is doing. 1: ps announcement is doing -+ */ -+ -+u8 sitesurvey_ps_annc(_adapter *padapter, bool ps) -+{ -+ u8 ps_anc = 0; -+ -+ if (rtw_mi_issue_nulldata(padapter, NULL, ps, 3, 500)) -+ ps_anc = 1; -+ return ps_anc; -+} -+#else -+/** -+ * sitesurvey_ps_annc - check and doing ps announcement for all the adapters of given @dvobj -+ * @dvobj: the dvobj to check -+ * @ps: power saving or not -+ * -+ * Returns: 0: no ps announcement is doing. 1: ps announcement is doing -+ */ -+ -+u8 sitesurvey_ps_annc(struct dvobj_priv *dvobj, bool ps) -+{ -+ _adapter *adapter; -+ int i; -+ u8 ps_anc = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ adapter = dvobj->padapters[i]; -+ if (!adapter) -+ continue; -+ -+ if (ps) { -+ if (is_client_associated_to_ap(adapter) == _TRUE) { -+ /* TODO: TDLS peers */ -+ issue_nulldata(adapter, NULL, 1, 3, 500); -+ ps_anc = 1; -+ } -+ } else { -+ if (is_client_associated_to_ap(adapter) == _TRUE) { -+ /* TODO: TDLS peers */ -+ issue_nulldata(adapter, NULL, 0, 3, 500); -+ ps_anc = 1; -+ } -+ } -+ } -+ return ps_anc; -+} -+#endif -+ -+void sitesurvey_set_igi(_adapter *adapter) -+{ -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ struct ss_res *ss = &mlmeext->sitesurvey_res; -+ u8 igi; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+#endif -+ -+ switch (mlmeext_scan_state(mlmeext)) { -+ case SCAN_ENTER: -+ #ifdef CONFIG_P2P -+ #ifdef CONFIG_IOCTL_CFG80211 -+ if (adapter_wdev_data(adapter)->p2p_enabled == _TRUE && pwdinfo->driver_interface == DRIVER_CFG80211) -+ igi = 0x30; -+ else -+ #endif /* CONFIG_IOCTL_CFG80211 */ -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ igi = 0x28; -+ else -+ #endif /* CONFIG_P2P */ -+ igi = 0x1e; -+ -+ /* record IGI status */ -+ ss->igi_scan = igi; -+ rtw_hal_get_odm_var(adapter, HAL_ODM_INITIAL_GAIN, &ss->igi_before_scan, NULL); -+ -+ /* disable DIG and set IGI for scan */ -+ rtw_hal_set_odm_var(adapter, HAL_ODM_INITIAL_GAIN, &igi, _FALSE); -+ break; -+ case SCAN_COMPLETE: -+ case SCAN_TO_P2P_LISTEN: -+ /* enable DIG and restore IGI */ -+ igi = 0xff; -+ rtw_hal_set_odm_var(adapter, HAL_ODM_INITIAL_GAIN, &igi, _FALSE); -+ break; -+#ifdef CONFIG_SCAN_BACKOP -+ case SCAN_BACKING_OP: -+ /* write IGI for op channel when DIG is not enabled */ -+ ODM_Write_DIG(GET_ODM(adapter), ss->igi_before_scan); -+ break; -+ case SCAN_LEAVE_OP: -+ /* write IGI for scan when DIG is not enabled */ -+ ODM_Write_DIG(GET_ODM(adapter), ss->igi_scan); -+ break; -+#endif /* CONFIG_SCAN_BACKOP */ -+ default: -+ rtw_warn_on(1); -+ break; -+ } -+} -+void sitesurvey_set_msr(_adapter *adapter, bool enter) -+{ -+ u8 network_type; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (enter) { -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_hal_get_hwreg(adapter, HW_VAR_MEDIA_STATUS, (u8 *)(&pmlmeinfo->hw_media_state)); -+#endif -+ /* set MSR to no link state */ -+ network_type = _HW_STATE_NOLINK_; -+ } else { -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ network_type = pmlmeinfo->hw_media_state; -+#else -+ network_type = pmlmeinfo->state & 0x3; -+#endif -+ } -+ Set_MSR(adapter, network_type); -+} -+u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ struct sitesurvey_parm *pparm = (struct sitesurvey_parm *)pbuf; -+ struct dvobj_priv *dvobj = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct ss_res *ss = &pmlmeext->sitesurvey_res; -+ u8 val8; -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif -+ -+#ifdef DBG_CHECK_FW_PS_STATE -+ if (rtw_fw_ps_state(padapter) == _FAIL) { -+ RTW_INFO("scan without leave 32k\n"); -+ pdbgpriv->dbg_scan_pwr_state_cnt++; -+ } -+#endif /* DBG_CHECK_FW_PS_STATE */ -+ -+ /* increase channel idx */ -+ if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS)) -+ ss->channel_idx++; -+ -+ /* update scan state to next state (assigned by previous cmd hdl) */ -+ if (mlmeext_scan_state(pmlmeext) != mlmeext_scan_next_state(pmlmeext)) -+ mlmeext_set_scan_state(pmlmeext, mlmeext_scan_next_state(pmlmeext)); -+ -+operation_by_state: -+ switch (mlmeext_scan_state(pmlmeext)) { -+ -+ case SCAN_DISABLE: -+ /* -+ * SW parameter initialization -+ */ -+ -+ sitesurvey_res_reset(padapter, pparm); -+ mlmeext_set_scan_state(pmlmeext, SCAN_START); -+ goto operation_by_state; -+ -+ case SCAN_START: -+ /* -+ * prepare to leave operating channel -+ */ -+ -+#ifdef CONFIG_MCC_MODE -+ rtw_hal_set_mcc_setting_scan_start(padapter); -+#endif /* CONFIG_MCC_MODE */ -+ -+ /* apply rx ampdu setting */ -+ if (ss->rx_ampdu_accept != RX_AMPDU_ACCEPT_INVALID -+ || ss->rx_ampdu_size != RX_AMPDU_SIZE_INVALID) -+ rtw_rx_ampdu_apply(padapter); -+ -+ /* clear HW TX queue before scan */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); -+ -+ /* power save state announcement */ -+ if (sitesurvey_ps_annc(padapter, 1)) { -+ mlmeext_set_scan_state(pmlmeext, SCAN_PS_ANNC_WAIT); -+ mlmeext_set_scan_next_state(pmlmeext, SCAN_ENTER); -+ set_survey_timer(pmlmeext, 50); /* delay 50ms to protect nulldata(1) */ -+ } else { -+ mlmeext_set_scan_state(pmlmeext, SCAN_ENTER); -+ goto operation_by_state; -+ } -+ -+ break; -+ -+ case SCAN_ENTER: -+ /* -+ * HW register and DM setting for enter scan -+ */ -+ -+ rtw_phydm_ability_backup(padapter); -+ -+ sitesurvey_set_igi(padapter); -+ -+ /* config dynamic functions for off channel */ -+ rtw_phydm_func_for_offchannel(padapter); -+ /* set MSR to no link state */ -+ sitesurvey_set_msr(padapter, _TRUE); -+ -+ val8 = 1; /* under site survey */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ mlmeext_set_scan_state(pmlmeext, SCAN_PROCESS); -+ goto operation_by_state; -+ -+ case SCAN_PROCESS: { -+ u8 scan_ch; -+ RT_SCAN_TYPE scan_type; -+ u8 next_state; -+ u32 scan_ms; -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ if ((ACS_ENABLE == GET_ACS_STATE(padapter)) && (0 != rtw_get_acs_channel(padapter))) { -+ ACS_OP acs_op = ACS_SELECT; -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &acs_op, _TRUE); -+ } -+#endif -+ -+ next_state = sitesurvey_pick_ch_behavior(padapter, &scan_ch, &scan_type); -+ if (next_state != SCAN_PROCESS) { -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ if (ACS_ENABLE == GET_ACS_STATE(padapter)) { -+ rtw_set_acs_channel(padapter, 0); -+#ifdef DBG_AUTO_CHNL_SEL_NHM -+ RTW_INFO("[ACS-"ADPT_FMT"]-set ch:%u\n", ADPT_ARG(padapter), rtw_get_acs_channel(padapter)); -+#endif -+ } -+#endif -+ -+ mlmeext_set_scan_state(pmlmeext, next_state); -+ goto operation_by_state; -+ } -+ -+ /* still SCAN_PROCESS state */ -+ if (0) -+#ifdef CONFIG_P2P -+ RTW_INFO(FUNC_ADPT_FMT" %s ch:%u (cnt:%u,idx:%d) at %dms, %c%c%c\n" -+ , FUNC_ADPT_ARG(padapter) -+ , mlmeext_scan_state_str(pmlmeext) -+ , scan_ch -+ , pwdinfo->find_phase_state_exchange_cnt, ss->channel_idx -+ , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) -+ , scan_type ? 'A' : 'P', ss->scan_mode ? 'A' : 'P' -+ , ss->ssid[0].SsidLength ? 'S' : ' ' -+ ); -+#else -+ RTW_INFO(FUNC_ADPT_FMT" %s ch:%u (idx:%d) at %dms, %c%c%c\n" -+ , FUNC_ADPT_ARG(padapter) -+ , mlmeext_scan_state_str(pmlmeext) -+ , scan_ch -+ , ss->channel_idx -+ , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) -+ , scan_type ? 'A' : 'P', ss->scan_mode ? 'A' : 'P' -+ , ss->ssid[0].SsidLength ? 'S' : ' ' -+ ); -+#endif /* CONFIG_P2P */ -+ -+#ifdef DBG_FIXED_CHAN -+ if (pmlmeext->fixed_chan != 0xff) -+ RTW_INFO(FUNC_ADPT_FMT" fixed_chan:%u\n", pmlmeext->fixed_chan); -+#endif -+ -+ site_survey(padapter, scan_ch, scan_type); -+ -+#if defined(CONFIG_ATMEL_RC_PATCH) -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ scan_ms = 20; -+ else -+ scan_ms = 40; -+#else -+ scan_ms = ss->scan_ch_ms; -+#endif -+ -+#if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) -+ if (ss->is_sw_antdiv_bl_scan) -+ scan_ms = scan_ms / 2; -+#endif -+ -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ { -+ struct noise_info info; -+ -+ info.bPauseDIG = _FALSE; -+ info.IGIValue = 0; -+ info.max_time = scan_ms / 2; -+ info.chan = scan_ch; -+ rtw_hal_set_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &info, _FALSE); -+ } -+#endif -+ -+ set_survey_timer(pmlmeext, scan_ms); -+ break; -+ } -+ -+#ifdef CONFIG_SCAN_BACKOP -+ case SCAN_BACKING_OP: { -+ u8 back_ch, back_bw, back_ch_offset; -+ u8 need_ch_setting_union = _TRUE; -+ -+#ifdef CONFIG_MCC_MODE -+ need_ch_setting_union = rtw_hal_mcc_change_scan_flag(padapter, -+ &back_ch, &back_bw, &back_ch_offset); -+#endif /* CONFIG_MCC_MODE */ -+ -+ if (need_ch_setting_union) { -+ if (rtw_mi_get_ch_setting_union(padapter, &back_ch, &back_bw, &back_ch_offset) == 0) -+ rtw_warn_on(1); -+ } -+ -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" %s ch:%u, bw:%u, offset:%u at %dms\n" -+ , FUNC_ADPT_ARG(padapter) -+ , mlmeext_scan_state_str(pmlmeext) -+ , back_ch, back_bw, back_ch_offset -+ , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) -+ ); -+ -+ set_channel_bwmode(padapter, back_ch, back_ch_offset, back_bw); -+ -+ sitesurvey_set_msr(padapter, _FALSE); -+ -+ val8 = 0; /* survey done */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC)) { -+ sitesurvey_set_igi(padapter); -+ sitesurvey_ps_annc(padapter, 0); -+ } -+ -+ mlmeext_set_scan_state(pmlmeext, SCAN_BACK_OP); -+ ss->backop_time = rtw_get_current_time(); -+ -+ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_TX_RESUME)) -+ rtw_mi_os_xmit_schedule(padapter); -+ -+ -+ goto operation_by_state; -+ } -+ -+ case SCAN_BACK_OP: -+ if (rtw_get_passing_time_ms(ss->backop_time) >= ss->backop_ms -+ || pmlmeext->scan_abort -+ ) { -+ mlmeext_set_scan_state(pmlmeext, SCAN_LEAVING_OP); -+ goto operation_by_state; -+ } -+ set_survey_timer(pmlmeext, 50); -+ break; -+ -+ case SCAN_LEAVING_OP: -+ /* -+ * prepare to leave operating channel -+ */ -+ -+ /* clear HW TX queue before scan */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); -+ -+ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC) -+ && sitesurvey_ps_annc(padapter, 1) -+ ) { -+ mlmeext_set_scan_state(pmlmeext, SCAN_PS_ANNC_WAIT); -+ mlmeext_set_scan_next_state(pmlmeext, SCAN_LEAVE_OP); -+ set_survey_timer(pmlmeext, 50); /* delay 50ms to protect nulldata(1) */ -+ } else { -+ mlmeext_set_scan_state(pmlmeext, SCAN_LEAVE_OP); -+ goto operation_by_state; -+ } -+ -+ break; -+ -+ case SCAN_LEAVE_OP: -+ /* -+ * HW register and DM setting for enter scan -+ */ -+ -+ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC)) -+ sitesurvey_set_igi(padapter); -+ -+ sitesurvey_set_msr(padapter, _TRUE); -+ -+ val8 = 1; /* under site survey */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ mlmeext_set_scan_state(pmlmeext, SCAN_PROCESS); -+ goto operation_by_state; -+ -+#endif /* CONFIG_SCAN_BACKOP */ -+ -+#if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) -+ case SCAN_SW_ANTDIV_BL: -+ /* -+ * 20100721 -+ * For SW antenna diversity before link, it needs to switch to another antenna and scan again. -+ * It compares the scan result and select better one to do connection. -+ */ -+ ss->bss_cnt = 0; -+ ss->channel_idx = 0; -+ ss->is_sw_antdiv_bl_scan = 1; -+ -+ mlmeext_set_scan_next_state(pmlmeext, SCAN_PROCESS); -+ set_survey_timer(pmlmeext, ss->scan_ch_ms); -+ break; -+#endif -+ -+#ifdef CONFIG_P2P -+ case SCAN_TO_P2P_LISTEN: -+ /* -+ * Set the P2P State to the listen state of find phase -+ * and set the current channel to the listen channel -+ */ -+ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_LISTEN); -+ -+ /* turn on phy-dynamic functions */ -+ rtw_phydm_ability_restore(padapter); -+ -+ sitesurvey_set_igi(padapter); -+ -+ mlmeext_set_scan_state(pmlmeext, SCAN_P2P_LISTEN); -+ _set_timer(&pwdinfo->find_phase_timer, (u32)((u32)pwdinfo->listen_dwell * 100)); -+ break; -+ -+ case SCAN_P2P_LISTEN: -+ mlmeext_set_scan_state(pmlmeext, SCAN_PROCESS); -+ ss->channel_idx = 0; -+ goto operation_by_state; -+#endif /* CONFIG_P2P */ -+ -+ case SCAN_COMPLETE: -+#ifdef CONFIG_P2P -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) -+ || rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH) -+ ) { -+#ifdef CONFIG_CONCURRENT_MODE -+ if (pwdinfo->driver_interface == DRIVER_WEXT) { -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ _set_timer(&pwdinfo->ap_p2p_switch_timer, 500); -+ } -+#endif -+ -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ } -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+#endif /* CONFIG_P2P */ -+ -+ /* switch channel */ -+ survey_done_set_ch_bw(padapter); -+ -+ sitesurvey_set_msr(padapter, _FALSE); -+ -+ val8 = 0; /* survey done */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ /* turn on phy-dynamic functions */ -+ rtw_phydm_ability_restore(padapter); -+ -+ sitesurvey_set_igi(padapter); -+ -+#ifdef CONFIG_MCC_MODE -+ /* start MCC fail, then tx null data */ -+ if (!rtw_hal_set_mcc_setting_scan_complete(padapter)) -+#endif /* CONFIG_MCC_MODE */ -+ sitesurvey_ps_annc(padapter, 0); -+ -+ /* apply rx ampdu setting */ -+ rtw_rx_ampdu_apply(padapter); -+ -+ mlmeext_set_scan_state(pmlmeext, SCAN_DISABLE); -+ -+ report_surveydone_event(padapter); -+ -+ issue_action_BSSCoexistPacket(padapter); -+ issue_action_BSSCoexistPacket(padapter); -+ issue_action_BSSCoexistPacket(padapter); -+ } -+ -+ return H2C_SUCCESS; -+} -+ -+u8 setauth_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct setauth_parm *pparm = (struct setauth_parm *)pbuf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pparm->mode < 4) -+ pmlmeinfo->auth_algo = pparm->mode; -+ -+ return H2C_SUCCESS; -+} -+ -+/* -+SEC CAM Entry format (32 bytes) -+DW0 - MAC_ADDR[15:0] | Valid[15] | MFB[14:8] | RSVD[7] | GK[6] | MIC_KEY[5] | SEC_TYPE[4:2] | KID[1:0] -+DW0 - MAC_ADDR[15:0] | Valid[15] |RSVD[14:9] | RPT_MODE[8] | SPP_MODE[7] | GK[6] | MIC_KEY[5] | SEC_TYPE[4:2] | KID[1:0] (92E/8812A/8814A) -+DW1 - MAC_ADDR[47:16] -+DW2 - KEY[31:0] -+DW3 - KEY[63:32] -+DW4 - KEY[95:64] -+DW5 - KEY[127:96] -+DW6 - RSVD -+DW7 - RSVD -+*/ -+ -+/*Set WEP key or Group Key*/ -+u8 setkey_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ u16 ctrl = 0; -+ s16 cam_id = 0; -+ struct setkey_parm *pparm = (struct setkey_parm *)pbuf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ unsigned char null_addr[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ u8 *addr; -+ bool used = _FALSE; -+ -+ /* main tx key for wep. */ -+ if (pparm->set_tx) -+ pmlmeinfo->key_index = pparm->keyid; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) -+ cam_id = rtw_iface_bcmc_id_get(padapter); -+ else -+#endif -+ cam_id = rtw_camid_alloc(padapter, NULL, pparm->keyid, &used); -+ -+ if (cam_id < 0) -+ goto enable_mc; -+ -+#ifndef CONFIG_CONCURRENT_MODE -+ if (cam_id >= 0 && cam_id <= 3) -+ addr = null_addr; -+ else -+#endif -+ { -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) -+ /* for AP mode ,we will force sec cam entry_id so hw dont search cam when tx*/ -+ addr = adapter_mac_addr(padapter); -+ else -+ /* not default key, searched by A2 */ -+ addr = get_bssid(&padapter->mlmepriv); -+ } -+ -+ /* cam entry searched is pairwise key */ -+ if (used == _TRUE && rtw_camid_is_gk(padapter, cam_id) == _FALSE) { -+ s16 camid_clr; -+ -+ RTW_PRINT(FUNC_ADPT_FMT" group key with "MAC_FMT" id:%u the same key id as pairwise key\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(addr), pparm->keyid); -+ -+ /* HW has problem to distinguish this group key with existing pairwise key, stop HW enc and dec for BMC */ -+ rtw_camctl_set_flags(padapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH); -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, NULL); -+ -+ /* clear group key */ -+ while ((camid_clr = rtw_camid_search(padapter, addr, -1, 1)) >= 0) { -+ RTW_PRINT("clear group key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(addr), camid_clr); -+ clear_cam_entry(padapter, camid_clr); -+ rtw_camid_free(padapter, camid_clr); -+ } -+ -+ goto enable_mc; -+ } -+ -+ ctrl = BIT(15) | BIT(6) | ((pparm->algorithm) << 2) | pparm->keyid; -+ -+ RTW_PRINT("set group key camid:%d, addr:"MAC_FMT", kid:%d, type:%s\n" -+ , cam_id, MAC_ARG(addr), pparm->keyid, security_type_str(pparm->algorithm)); -+ -+ write_cam(padapter, cam_id, ctrl, addr, pparm->key); -+ -+ /* if ((cam_id > 3) && (((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE)))*/ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) { -+ if (is_wep_enc(pparm->algorithm)) { -+ padapter->securitypriv.dot11Def_camid[pparm->keyid] = cam_id; -+ padapter->securitypriv.dot118021x_bmc_cam_id = -+ padapter->securitypriv.dot11Def_camid[padapter->securitypriv.dot11PrivacyKeyIndex]; -+ RTW_PRINT("wep group key - force camid:%d\n", padapter->securitypriv.dot118021x_bmc_cam_id); -+ } else { -+ /*u8 org_cam_id = padapter->securitypriv.dot118021x_bmc_cam_id;*/ -+ -+ /*force GK's cam id*/ -+ padapter->securitypriv.dot118021x_bmc_cam_id = cam_id; -+ -+ /* for GTK rekey -+ if ((org_cam_id != INVALID_SEC_MAC_CAM_ID) && -+ (org_cam_id != cam_id)) { -+ RTW_PRINT("clear group key for addr:"MAC_FMT", org_camid:%d new_camid:%d\n", MAC_ARG(addr), org_cam_id, cam_id); -+ clear_cam_entry(padapter, org_cam_id); -+ rtw_camid_free(padapter, org_cam_id); -+ }*/ -+ } -+ } -+#endif -+ -+ -+#ifndef CONFIG_CONCURRENT_MODE -+ if (cam_id >= 0 && cam_id <= 3) -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8 *)_TRUE); -+#endif -+ -+ /* 8814au should set both broadcast and unicast CAM entry for WEP key in STA mode */ -+ if (is_wep_enc(pparm->algorithm) && check_mlmeinfo_state(pmlmeext, WIFI_FW_STATION_STATE) && -+ _rtw_camctl_chk_cap(padapter, SEC_CAP_CHK_BMC)) { -+ struct set_stakey_parm sta_pparm; -+ -+ sta_pparm.algorithm = pparm->algorithm; -+ sta_pparm.keyid = pparm->keyid; -+ _rtw_memcpy(sta_pparm.key, pparm->key, 16); -+ _rtw_memcpy(sta_pparm.addr, get_bssid(&padapter->mlmepriv), ETH_ALEN); -+ set_stakey_hdl(padapter, (u8 *)&sta_pparm); -+ } -+ -+enable_mc: -+ /* allow multicast packets to driver */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_ON_RCR_AM, null_addr); -+ -+ return H2C_SUCCESS; -+} -+ -+void rtw_ap_wep_pk_setting(_adapter *adapter, struct sta_info *psta) -+{ -+ struct security_priv *psecuritypriv = &(adapter->securitypriv); -+ struct set_stakey_parm sta_pparm; -+ sint keyid; -+ -+ if (!is_wep_enc(psecuritypriv->dot11PrivacyAlgrthm)) -+ return; -+ -+ for (keyid = 0; keyid < 4; keyid++) { -+ if ((psecuritypriv->key_mask & BIT(keyid)) && (keyid == psecuritypriv->dot11PrivacyKeyIndex)) { -+ sta_pparm.algorithm = psecuritypriv->dot11PrivacyAlgrthm; -+ sta_pparm.keyid = keyid; -+ _rtw_memcpy(sta_pparm.key, &(psecuritypriv->dot11DefKey[keyid].skey[0]), 16); -+ _rtw_memcpy(sta_pparm.addr, psta->hwaddr, ETH_ALEN); -+ -+ RTW_PRINT(FUNC_ADPT_FMT"set WEP - PK with "MAC_FMT" keyid:%u\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->hwaddr), keyid); -+ -+ set_stakey_hdl(adapter, (u8 *)&sta_pparm); -+ } -+ } -+} -+ -+u8 set_stakey_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ u16 ctrl = 0; -+ s16 cam_id = 0; -+ bool used; -+ u8 kid = 0; -+ u8 ret = H2C_SUCCESS; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct set_stakey_parm *pparm = (struct set_stakey_parm *)pbuf; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ -+ if (pparm->algorithm == _NO_PRIVACY_) -+ goto write_to_cam; -+ -+ psta = rtw_get_stainfo(pstapriv, pparm->addr); -+ if (!psta) { -+ RTW_PRINT("%s sta:"MAC_FMT" not found\n", __func__, MAC_ARG(pparm->addr)); -+ ret = H2C_REJECTED; -+ goto exit; -+ } -+ -+ pmlmeinfo->enc_algo = pparm->algorithm; -+ if (is_wep_enc(pparm->algorithm)) -+ kid = pparm->keyid; -+ cam_id = rtw_camid_alloc(padapter, psta, kid, &used); -+ if (cam_id < 0) -+ goto exit; -+ -+ /* cam entry searched is group key */ -+ if (used == _TRUE && rtw_camid_is_gk(padapter, cam_id) == _TRUE) { -+ s16 camid_clr; -+ -+ RTW_PRINT(FUNC_ADPT_FMT" pairwise key with "MAC_FMT" id:%u the same key id as group key\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(pparm->addr), pparm->keyid); -+ -+ /* HW has problem to distinguish this pairwise key with existing group key, stop HW enc and dec for BMC */ -+ rtw_camctl_set_flags(padapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH); -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, NULL); -+ -+ /* clear group key */ -+ while ((camid_clr = rtw_camid_search(padapter, pparm->addr, -1, 1)) >= 0) { -+ RTW_PRINT("clear group key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(pparm->addr), camid_clr); -+ clear_cam_entry(padapter, camid_clr); -+ rtw_camid_free(padapter, camid_clr); -+ } -+ } -+ -+write_to_cam: -+ if (pparm->algorithm == _NO_PRIVACY_) { -+ while ((cam_id = rtw_camid_search(padapter, pparm->addr, -1, -1)) >= 0) { -+ RTW_PRINT("clear key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(pparm->addr), cam_id); -+ clear_cam_entry(padapter, cam_id); -+ rtw_camid_free(padapter, cam_id); -+ } -+ } else { -+ RTW_PRINT("set pairwise key camid:%d, addr:"MAC_FMT", kid:%d, type:%s\n", -+ cam_id, MAC_ARG(pparm->addr), pparm->keyid, security_type_str(pparm->algorithm)); -+ ctrl = BIT(15) | ((pparm->algorithm) << 2) | pparm->keyid; -+ write_cam(padapter, cam_id, ctrl, pparm->addr, pparm->key); -+ } -+ ret = H2C_SUCCESS_RSP; -+ -+exit: -+ return ret; -+} -+ -+u8 add_ba_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct addBaReq_parm *pparm = (struct addBaReq_parm *)pbuf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, pparm->addr); -+ -+ if (!psta) -+ return H2C_SUCCESS; -+ -+#ifdef CONFIG_80211N_HT -+ if (((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && (pmlmeinfo->HT_enable)) || -+ ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) { -+ /* pmlmeinfo->ADDBA_retry_count = 0; */ -+ /* pmlmeinfo->candidate_tid_bitmap |= (0x1 << pparm->tid); */ -+ /* psta->htpriv.candidate_tid_bitmap |= BIT(pparm->tid); */ -+ issue_addba_req(padapter, pparm->addr, (u8)pparm->tid); -+ /* _set_timer(&pmlmeext->ADDBA_timer, ADDBA_TO); */ -+ _set_timer(&psta->addba_retry_timer, ADDBA_TO); -+ } -+#ifdef CONFIG_TDLS -+ else if ((psta->tdls_sta_state & TDLS_LINKED_STATE) && -+ (psta->htpriv.ht_option == _TRUE) && -+ (psta->htpriv.ampdu_enable == _TRUE)) { -+ issue_addba_req(padapter, pparm->addr, (u8)pparm->tid); -+ _set_timer(&psta->addba_retry_timer, ADDBA_TO); -+ } -+#endif /* CONFIG */ -+ else -+ psta->htpriv.candidate_tid_bitmap &= ~BIT(pparm->tid); -+#endif /* CONFIG_80211N_HT */ -+ return H2C_SUCCESS; -+} -+ -+ -+u8 add_ba_rsp_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct addBaRsp_parm *pparm = (struct addBaRsp_parm *)pbuf; -+ u8 ret = _TRUE, i = 0, try_cnt = 3, wait_ms = 50; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ -+ psta = rtw_get_stainfo(pstapriv, pparm->addr); -+ if (!psta) -+ goto exit; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[pparm->tid]; -+ ret = issue_addba_rsp_wait_ack(padapter, pparm->addr, pparm->tid, pparm->status, pparm->size, 3, 50); -+ -+#ifdef CONFIG_UPDATE_INDICATE_SEQ_WHILE_PROCESS_ADDBA_REQ -+ /* status = 0 means accept this addba req, so update indicate seq = start_seq under this compile flag */ -+ if (pparm->status == 0) { -+ preorder_ctrl->indicate_seq = pparm->start_seq; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, start_seq: %d\n", __func__, __LINE__, -+ preorder_ctrl->indicate_seq, pparm->start_seq); -+#endif -+ } -+#else -+ preorder_ctrl->indicate_seq = 0xffff; -+#endif -+ -+ /* -+ * status = 0 means accept this addba req -+ * status = 37 means reject this addba req -+ */ -+ if (pparm->status == 0) { -+ preorder_ctrl->enable = _TRUE; -+ preorder_ctrl->ampdu_size = pparm->size; -+ } else if (pparm->status == 37) -+ preorder_ctrl->enable = _FALSE; -+ -+exit: -+ return H2C_SUCCESS; -+} -+ -+u8 chk_bmc_sleepq_cmd(_adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_parm_rsp(ph2c, GEN_CMD_CODE(_ChkBMCSleepq)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ return res; -+} -+ -+u8 set_tx_beacon_cmd(_adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct Tx_Beacon_param *ptxBeacon_parm; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 res = _SUCCESS; -+ int len_diff = 0; -+ -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ ptxBeacon_parm = (struct Tx_Beacon_param *)rtw_zmalloc(sizeof(struct Tx_Beacon_param)); -+ if (ptxBeacon_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memcpy(&(ptxBeacon_parm->network), &(pmlmeinfo->network), sizeof(WLAN_BSSID_EX)); -+ -+ len_diff = update_hidden_ssid( -+ ptxBeacon_parm->network.IEs + _BEACON_IE_OFFSET_ -+ , ptxBeacon_parm->network.IELength - _BEACON_IE_OFFSET_ -+ , pmlmeinfo->hidden_ssid_mode -+ ); -+ ptxBeacon_parm->network.IELength += len_diff; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, ptxBeacon_parm, GEN_CMD_CODE(_TX_Beacon)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+ -+exit: -+ -+ -+ return res; -+} -+ -+ -+u8 mlme_evt_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ u8 evt_code, evt_seq; -+ u16 evt_sz; -+ uint *peventbuf; -+ void (*event_callback)(_adapter *dev, u8 *pbuf); -+ struct evt_priv *pevt_priv = &(padapter->evtpriv); -+ -+ if (pbuf == NULL) -+ goto _abort_event_; -+ -+ peventbuf = (uint *)pbuf; -+ evt_sz = (u16)(*peventbuf & 0xffff); -+ evt_seq = (u8)((*peventbuf >> 24) & 0x7f); -+ evt_code = (u8)((*peventbuf >> 16) & 0xff); -+ -+ -+#ifdef CHECK_EVENT_SEQ -+ /* checking event sequence... */ -+ if (evt_seq != (ATOMIC_READ(&pevt_priv->event_seq) & 0x7f)) { -+ -+ pevt_priv->event_seq = (evt_seq + 1) & 0x7f; -+ -+ goto _abort_event_; -+ } -+#endif -+ -+ /* checking if event code is valid */ -+ if (evt_code >= MAX_C2HEVT) { -+ goto _abort_event_; -+ } -+ -+ /* checking if event size match the event parm size */ -+ if ((wlanevents[evt_code].parmsize != 0) && -+ (wlanevents[evt_code].parmsize != evt_sz)) { -+ -+ goto _abort_event_; -+ -+ } -+ -+ ATOMIC_INC(&pevt_priv->event_seq); -+ -+ peventbuf += 2; -+ -+ if (peventbuf) { -+ event_callback = wlanevents[evt_code].event_callback; -+ event_callback(padapter, (u8 *)peventbuf); -+ -+ pevt_priv->evt_done_cnt++; -+ } -+ -+ -+_abort_event_: -+ -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 h2c_msg_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ return H2C_SUCCESS; -+} -+ -+u8 chk_bmc_sleepq_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+#ifdef CONFIG_AP_MODE -+ _irqL irqL; -+ struct sta_info *psta_bmc; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ /* for BC/MC Frames */ -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ if (!psta_bmc) -+ return H2C_SUCCESS; -+ -+ if ((pstapriv->tim_bitmap & BIT(0)) && (psta_bmc->sleepq_len > 0)) { -+#ifndef CONFIG_PCI_HCI -+ rtw_msleep_os(10);/* 10ms, ATIM(HIQ) Windows */ -+#endif -+ /* _enter_critical_bh(&psta_bmc->sleep_q.lock, &irqL); */ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ psta_bmc->sleepq_len--; -+ if (psta_bmc->sleepq_len > 0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ pxmitframe->attrib.triggered = 1; -+ -+ if (xmitframe_hiq_filter(pxmitframe) == _TRUE) -+ pxmitframe->attrib.qsel = QSLT_HIGH;/* HIQ */ -+ -+#if 0 -+ _exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); -+ if (rtw_hal_xmit(padapter, pxmitframe) == _TRUE) -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ _enter_critical_bh(&psta_bmc->sleep_q.lock, &irqL); -+#endif -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ } -+ -+ /* _exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); */ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ if (rtw_get_intf_type(padapter) != RTW_PCIE) { -+ /* check hi queue and bmc_sleepq */ -+ rtw_chk_hi_queue_cmd(padapter); -+ } -+ } -+#endif -+ -+ return H2C_SUCCESS; -+} -+ -+u8 tx_beacon_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+ -+ tx_beacon_handlder(padapter->dvobj); -+ -+#else -+ -+ if (send_beacon(padapter) == _FAIL) { -+ RTW_INFO("issue_beacon, fail!\n"); -+ return H2C_PARAMETERS_ERROR; -+ } -+ -+ /* tx bc/mc frames after update TIM */ -+ chk_bmc_sleepq_hdl(padapter, NULL); -+#endif -+ -+ return H2C_SUCCESS; -+} -+ -+#ifdef CONFIG_AP_MODE -+/* -+* according to channel -+* add/remove WLAN_BSSID_EX.IEs's ERP ie -+* set WLAN_BSSID_EX.SupportedRates -+* update WLAN_BSSID_EX.IEs's Supported Rate and Extended Supported Rate ie -+*/ -+void change_band_update_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 ch) -+{ -+ u8 network_type, rate_len, total_rate_len, remainder_rate_len; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 erpinfo = 0x4; -+ -+ if (ch >= 36) { -+ network_type = WIRELESS_11A; -+ total_rate_len = IEEE80211_NUM_OFDM_RATESLEN; -+ rtw_remove_bcn_ie(padapter, pnetwork, _ERPINFO_IE_); -+ } else { -+ network_type = WIRELESS_11BG; -+ total_rate_len = IEEE80211_CCK_RATE_LEN + IEEE80211_NUM_OFDM_RATESLEN; -+ rtw_add_bcn_ie(padapter, pnetwork, _ERPINFO_IE_, &erpinfo, 1); -+ } -+ -+ rtw_set_supported_rate(pnetwork->SupportedRates, network_type); -+ -+ UpdateBrateTbl(padapter, pnetwork->SupportedRates); -+ -+ if (total_rate_len > 8) { -+ rate_len = 8; -+ remainder_rate_len = total_rate_len - 8; -+ } else { -+ rate_len = total_rate_len; -+ remainder_rate_len = 0; -+ } -+ -+ rtw_add_bcn_ie(padapter, pnetwork, _SUPPORTEDRATES_IE_, pnetwork->SupportedRates, rate_len); -+ -+ if (remainder_rate_len) -+ rtw_add_bcn_ie(padapter, pnetwork, _EXT_SUPPORTEDRATES_IE_, (pnetwork->SupportedRates + 8), remainder_rate_len); -+ else -+ rtw_remove_bcn_ie(padapter, pnetwork, _EXT_SUPPORTEDRATES_IE_); -+ -+ pnetwork->Length = get_WLAN_BSSID_EX_sz(pnetwork); -+} -+#endif -+ -+void rtw_join_done_chk_ch(_adapter *adapter, int join_res) -+{ -+#define DUMP_ADAPTERS_STATUS 0 -+ -+ struct dvobj_priv *dvobj; -+ _adapter *iface; -+ struct mlme_priv *mlme; -+ struct mlme_ext_priv *mlmeext; -+ u8 u_ch, u_offset, u_bw; -+ int i; -+ -+ dvobj = adapter_to_dvobj(adapter); -+ -+ if (DUMP_ADAPTERS_STATUS) { -+ RTW_INFO(FUNC_ADPT_FMT" enter\n", FUNC_ADPT_ARG(adapter)); -+ dump_adapters_status(RTW_DBGDUMP , dvobj); -+ } -+ -+ if (join_res >= 0) { -+ -+#ifdef CONFIG_MCC_MODE -+ /* MCC setting success, don't go to ch union process */ -+ if (rtw_hal_set_mcc_setting_join_done_chk_ch(adapter)) -+ return; -+#endif /* CONFIG_MCC_MODE */ -+ -+ if (rtw_mi_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset) <= 0) { -+ dump_adapters_status(RTW_DBGDUMP , dvobj); -+ rtw_warn_on(1); -+ } -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlme = &iface->mlmepriv; -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (!iface || iface == adapter) -+ continue; -+#ifdef CONFIG_AP_MODE -+ if (check_fwstate(mlme, WIFI_AP_STATE) -+ && check_fwstate(mlme, WIFI_ASOC_STATE) -+ ) { -+ bool is_grouped = rtw_is_chbw_grouped(u_ch, u_bw, u_offset -+ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); -+ -+ if (is_grouped == _FALSE) { -+ /* handle AP which need to switch ch setting */ -+ -+ /* restore original bw, adjust bw by registry setting on target ch */ -+ mlmeext->cur_bwmode = mlme->ori_bw; -+ mlmeext->cur_channel = u_ch; -+#ifdef CONFIG_80211N_HT -+ rtw_adjust_chbw(iface -+ , mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset); -+#endif /* CONFIG_80211N_HT */ -+ -+ rtw_sync_chbw(&mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset -+ , &u_ch, &u_bw, &u_offset); -+ -+ rtw_ap_update_bss_chbw(iface, &(mlmeext->mlmext_info.network) -+ , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); -+ -+ _rtw_memcpy(&(mlme->cur_network.network), &(mlmeext->mlmext_info.network), sizeof(WLAN_BSSID_EX)); -+ -+ rtw_start_bss_hdl_after_chbw_decided(iface); -+ } -+ -+ update_beacon(iface, 0, NULL, _TRUE); -+ } -+#endif -+ clr_fwstate(mlme, WIFI_OP_CH_SWITCHING); -+ } -+ -+#ifdef CONFIG_DFS_MASTER -+ rtw_dfs_master_status_apply(adapter, MLME_STA_CONNECTED); -+#endif -+ } else { -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlme = &iface->mlmepriv; -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (!iface || iface == adapter) -+ continue; -+#ifdef CONFIG_AP_MODE -+ if (check_fwstate(mlme, WIFI_AP_STATE) -+ && check_fwstate(mlme, WIFI_ASOC_STATE)) -+ update_beacon(iface, 0, NULL, _TRUE); -+#endif /* CONFIG_AP_MODE */ -+ -+ clr_fwstate(mlme, WIFI_OP_CH_SWITCHING); -+ } -+#ifdef CONFIG_DFS_MASTER -+ rtw_dfs_master_status_apply(adapter, MLME_STA_DISCONNECTED); -+#endif -+ } -+ -+ if (rtw_mi_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset)) { -+ set_channel_bwmode(adapter, u_ch, u_offset, u_bw); -+ rtw_mi_update_union_chan_inf(adapter, u_ch, u_offset, u_bw); -+ } -+ -+ if (DUMP_ADAPTERS_STATUS) { -+ RTW_INFO(FUNC_ADPT_FMT" exit\n", FUNC_ADPT_ARG(adapter)); -+ dump_adapters_status(RTW_DBGDUMP , dvobj); -+ } -+} -+ -+int rtw_chk_start_clnt_join(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) -+{ -+ bool chbw_allow = _TRUE; -+ bool connect_allow = _TRUE; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ u8 cur_ch, cur_bw, cur_ch_offset; -+ u8 u_ch, u_offset, u_bw; -+ -+ u_ch = cur_ch = pmlmeext->cur_channel; -+ u_bw = cur_bw = pmlmeext->cur_bwmode; -+ u_offset = cur_ch_offset = pmlmeext->cur_ch_offset; -+ -+ if (!ch || !bw || !offset) { -+ connect_allow = _FALSE; -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (cur_ch == 0) { -+ connect_allow = _FALSE; -+ RTW_ERR(FUNC_ADPT_FMT" cur_ch:%u\n" -+ , FUNC_ADPT_ARG(adapter), cur_ch); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ RTW_INFO(FUNC_ADPT_FMT" req: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ { -+ struct dvobj_priv *dvobj; -+ _adapter *iface; -+ struct mlme_priv *mlme; -+ struct mlme_ext_priv *mlmeext; -+ struct mi_state mstate; -+ int i; -+ -+ dvobj = adapter_to_dvobj(adapter); -+ -+ rtw_mi_status_no_self(adapter, &mstate); -+ RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, ap_num:%u\n" -+ , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate), MSTATE_AP_NUM(&mstate)); -+ -+ if (!MSTATE_STA_LD_NUM(&mstate) && !MSTATE_AP_NUM(&mstate)) { -+ /* consider linking STA? */ -+ goto connect_allow_hdl; -+ } -+ -+ if (rtw_mi_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset) <= 0) { -+ dump_adapters_status(RTW_DBGDUMP , dvobj); -+ rtw_warn_on(1); -+ } -+ RTW_INFO(FUNC_ADPT_FMT" union no self: %u,%u,%u\n" -+ , FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ -+ /* chbw_allow? */ -+ chbw_allow = rtw_is_chbw_grouped(pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset -+ , u_ch, u_bw, u_offset); -+ -+ RTW_INFO(FUNC_ADPT_FMT" chbw_allow:%d\n" -+ , FUNC_ADPT_ARG(adapter), chbw_allow); -+ -+#ifdef CONFIG_MCC_MODE -+ /* check setting success, don't go to ch union process */ -+ if (rtw_hal_set_mcc_setting_chk_start_clnt_join(adapter, &u_ch, &u_bw, &u_offset, chbw_allow)) -+ goto exit; -+#endif -+ -+ if (chbw_allow == _TRUE) { -+ rtw_sync_chbw(&cur_ch, &cur_bw, &cur_ch_offset, &u_ch, &u_bw, &u_offset); -+ rtw_warn_on(cur_ch != pmlmeext->cur_channel); -+ rtw_warn_on(cur_bw != pmlmeext->cur_bwmode); -+ rtw_warn_on(cur_ch_offset != pmlmeext->cur_ch_offset); -+ goto connect_allow_hdl; -+ } -+ -+#ifdef CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT -+ /* chbw_allow is _FALSE, connect allow? */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlme = &iface->mlmepriv; -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (check_fwstate(mlme, WIFI_STATION_STATE) -+ && check_fwstate(mlme, WIFI_ASOC_STATE) -+#if defined(CONFIG_P2P) -+ && rtw_p2p_chk_state(&(iface->wdinfo), P2P_STATE_NONE) -+#endif -+ ) { -+ connect_allow = _FALSE; -+ break; -+ } -+ } -+#endif /* CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT */ -+ -+ if (MSTATE_STA_LD_NUM(&mstate) + MSTATE_AP_LD_NUM(&mstate) >= 2) -+ connect_allow = _FALSE; -+ -+ RTW_INFO(FUNC_ADPT_FMT" connect_allow:%d\n" -+ , FUNC_ADPT_ARG(adapter), connect_allow); -+ -+ if (connect_allow == _FALSE) -+ goto exit; -+ -+connect_allow_hdl: -+ /* connect_allow == _TRUE */ -+ -+#ifdef CONFIG_DFS_MASTER -+ rtw_dfs_master_status_apply(adapter, MLME_STA_CONNECTING); -+#endif -+ -+ if (chbw_allow == _FALSE) { -+ u_ch = cur_ch; -+ u_bw = cur_bw; -+ u_offset = cur_ch_offset; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlme = &iface->mlmepriv; -+ mlmeext = &iface->mlmeextpriv; -+ -+ if (!iface || iface == adapter) -+ continue; -+ -+ if (check_fwstate(mlme, WIFI_AP_STATE) -+ && check_fwstate(mlme, WIFI_ASOC_STATE) -+ ) { -+#ifdef CONFIG_SPCT_CH_SWITCH -+ if (1) -+ rtw_ap_inform_ch_switch(iface, pmlmeext->cur_channel , pmlmeext->cur_ch_offset); -+ else -+#endif -+ rtw_sta_flush(iface, _FALSE); -+ -+ rtw_hal_set_hwreg(iface, HW_VAR_CHECK_TXBUF, 0); -+ set_fwstate(mlme, WIFI_OP_CH_SWITCHING); -+ } else if (check_fwstate(mlme, WIFI_STATION_STATE) -+ && check_fwstate(mlme, WIFI_ASOC_STATE) -+ ) { -+ rtw_disassoc_cmd(iface, 500, _FALSE); -+ rtw_indicate_disconnect(iface, 0, _FALSE); -+ rtw_free_assoc_resources(iface, 1); -+ } -+ } -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+exit: -+ -+ if (connect_allow == _TRUE) { -+ RTW_INFO(FUNC_ADPT_FMT" union: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); -+ *ch = u_ch; -+ *bw = u_bw; -+ *offset = u_offset; -+ } -+ -+ return connect_allow == _TRUE ? _SUCCESS : _FAIL; -+} -+ -+ -+u8 set_ch_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ struct set_ch_parm *set_ch_parm; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ set_ch_parm = (struct set_ch_parm *)pbuf; -+ -+ RTW_INFO(FUNC_NDEV_FMT" ch:%u, bw:%u, ch_offset:%u\n", -+ FUNC_NDEV_ARG(padapter->pnetdev), -+ set_ch_parm->ch, set_ch_parm->bw, set_ch_parm->ch_offset); -+ -+ pmlmeext->cur_channel = set_ch_parm->ch; -+ pmlmeext->cur_ch_offset = set_ch_parm->ch_offset; -+ pmlmeext->cur_bwmode = set_ch_parm->bw; -+ -+ set_channel_bwmode(padapter, set_ch_parm->ch, set_ch_parm->ch_offset, set_ch_parm->bw); -+ -+ return H2C_SUCCESS; -+} -+ -+u8 set_chplan_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct SetChannelPlan_param *setChannelPlan_param; -+ struct mlme_priv *mlme = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ setChannelPlan_param = (struct SetChannelPlan_param *)pbuf; -+ -+ if (!rtw_is_channel_plan_valid(setChannelPlan_param->channel_plan)) -+ return H2C_PARAMETERS_ERROR; -+ -+ mlme->country_ent = setChannelPlan_param->country_ent; -+ mlme->ChannelPlan = setChannelPlan_param->channel_plan; -+ -+ pmlmeext->max_chan_nums = init_channel_set(padapter, setChannelPlan_param->channel_plan, pmlmeext->channel_set); -+ init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_REGULATION, NULL, _TRUE); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_reg_notify_by_driver(padapter); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ return H2C_SUCCESS; -+} -+ -+u8 led_blink_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct LedBlink_param *ledBlink_param; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ ledBlink_param = (struct LedBlink_param *)pbuf; -+ -+#ifdef CONFIG_LED_HANDLED_BY_CMD_THREAD -+ BlinkHandler((PLED_DATA)ledBlink_param->pLed); -+#endif -+ -+ return H2C_SUCCESS; -+} -+ -+u8 set_csa_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+#ifdef CONFIG_DFS -+ struct SetChannelSwitch_param *setChannelSwitch_param; -+ u8 new_ch_no; -+ u8 gval8 = 0x00, sval8 = 0xff; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ setChannelSwitch_param = (struct SetChannelSwitch_param *)pbuf; -+ new_ch_no = setChannelSwitch_param->new_ch_no; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_TXPAUSE, &gval8); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &sval8); -+ -+ RTW_INFO("DFS detected! Swiching channel to %d!\n", new_ch_no); -+ set_channel_bwmode(padapter, new_ch_no, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &gval8); -+ -+ rtw_disassoc_cmd(padapter, 0, _FALSE); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ rtw_free_assoc_resources(padapter, 1); -+ rtw_free_network_queue(padapter, _TRUE); -+ -+ if (((new_ch_no >= 52) && (new_ch_no <= 64)) || ((new_ch_no >= 100) && (new_ch_no <= 140))) -+ RTW_INFO("Switched to DFS band (ch %02x) again!!\n", new_ch_no); -+ -+ return H2C_SUCCESS; -+#else -+ return H2C_REJECTED; -+#endif /* CONFIG_DFS */ -+ -+} -+ -+u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+#ifdef CONFIG_TDLS -+ _irqL irqL; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+#ifdef CONFIG_TDLS_CH_SW -+ struct tdls_ch_switch *pchsw_info = &ptdlsinfo->chsw_info; -+#endif -+ struct TDLSoption_param *TDLSoption; -+ struct sta_info *ptdls_sta = NULL; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ u8 survey_channel, i, min, option; -+ struct tdls_txmgmt txmgmt; -+ u32 setchtime, resp_sleep = 0, wait_time; -+ u8 zaddr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ u8 ret; -+ u8 doiqk; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ TDLSoption = (struct TDLSoption_param *)pbuf; -+ option = TDLSoption->option; -+ -+ if (!_rtw_memcmp(TDLSoption->addr, zaddr, ETH_ALEN)) { -+ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), TDLSoption->addr); -+ if (ptdls_sta == NULL) -+ return H2C_REJECTED; -+ } else { -+ if (!(option == TDLS_RS_RCR)) -+ return H2C_REJECTED; -+ } -+ -+ /* _enter_critical_bh(&(ptdlsinfo->hdl_lock), &irqL); */ -+ /* RTW_INFO("[%s] option:%d\n", __FUNCTION__, option); */ -+ -+ switch (option) { -+ case TDLS_ESTABLISHED: { -+ /* As long as TDLS handshake success, we should set RCR_CBSSID_DATA bit to 0 */ -+ /* So we can receive all kinds of data frames. */ -+ u8 sta_band = 0; -+ -+ /* leave ALL PS when TDLS is established */ -+ rtw_pwr_wakeup(padapter); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_WRCR, 0); -+ RTW_INFO("Created Direct Link with "MAC_FMT"\n", MAC_ARG(ptdls_sta->hwaddr)); -+ -+ /* Set TDLS sta rate. */ -+ /* Update station supportRate */ -+ rtw_hal_update_sta_rate_mask(padapter, ptdls_sta); -+ if (pmlmeext->cur_channel > 14) { -+ if (ptdls_sta->ra_mask & 0xffff000) -+ sta_band |= WIRELESS_11_5N ; -+ -+ if (ptdls_sta->ra_mask & 0xff0) -+ sta_band |= WIRELESS_11A; -+ -+ /* 5G band */ -+#ifdef CONFIG_80211AC_VHT -+ if (ptdls_sta->vhtpriv.vht_option) -+ sta_band = WIRELESS_11_5AC; -+#endif -+ -+ } else { -+ if (ptdls_sta->ra_mask & 0xffff000) -+ sta_band |= WIRELESS_11_24N; -+ -+ if (ptdls_sta->ra_mask & 0xff0) -+ sta_band |= WIRELESS_11G; -+ -+ if (ptdls_sta->ra_mask & 0x0f) -+ sta_band |= WIRELESS_11B; -+ } -+ ptdls_sta->wireless_mode = sta_band; -+ ptdls_sta->raid = rtw_hal_networktype_to_raid(padapter, ptdls_sta); -+ set_sta_rate(padapter, ptdls_sta); -+ rtw_sta_media_status_rpt(padapter, ptdls_sta, 1); -+ /* Sta mode */ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, ptdls_sta, _TRUE); -+ break; -+ } -+ case TDLS_ISSUE_PTI: -+ ptdls_sta->tdls_sta_state |= TDLS_WAIT_PTR_STATE; -+ issue_tdls_peer_traffic_indication(padapter, ptdls_sta); -+ _set_timer(&ptdls_sta->pti_timer, TDLS_PTI_TIME); -+ break; -+#ifdef CONFIG_TDLS_CH_SW -+ case TDLS_CH_SW_RESP: -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.status_code = 0; -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); -+ -+ issue_nulldata(padapter, NULL, 1, 3, 3); -+ -+ RTW_INFO("[TDLS ] issue tdls channel switch response\n"); -+ ret = issue_tdls_ch_switch_rsp(padapter, &txmgmt, _TRUE); -+ -+ /* If we receive TDLS_CH_SW_REQ at off channel which it's target is AP's channel */ -+ /* then we just switch to AP's channel*/ -+ if (padapter->mlmeextpriv.cur_channel == pchsw_info->off_ch_num) { -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END_TO_BASE_CHNL); -+ break; -+ } -+ -+ if (ret == _SUCCESS) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_OFF_CHNL); -+ else -+ RTW_INFO("[TDLS] issue_tdls_ch_switch_rsp wait ack fail !!!!!!!!!!\n"); -+ -+ break; -+ case TDLS_CH_SW_PREPARE: -+ pchsw_info->ch_sw_state |= TDLS_CH_SWITCH_PREPARE_STATE; -+ -+ /* to collect IQK info of off-chnl */ -+ doiqk = _TRUE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, &doiqk); -+ set_channel_bwmode(padapter, pchsw_info->off_ch_num, pchsw_info->ch_offset, (pchsw_info->ch_offset) ? CHANNEL_WIDTH_40 : CHANNEL_WIDTH_20); -+ doiqk = _FALSE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, &doiqk); -+ -+ /* switch back to base-chnl */ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_START); -+ -+ pchsw_info->ch_sw_state &= ~(TDLS_CH_SWITCH_PREPARE_STATE); -+ -+ break; -+ case TDLS_CH_SW_START: -+ rtw_tdls_set_ch_sw_oper_control(padapter, _TRUE); -+ break; -+ case TDLS_CH_SW_TO_OFF_CHNL: -+ issue_nulldata(padapter, NULL, 1, 3, 3); -+ -+ if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) -+ _set_timer(&ptdls_sta->ch_sw_timer, (u32)(ptdls_sta->ch_switch_timeout) / 1000); -+ -+ if (rtw_tdls_do_ch_sw(padapter, ptdls_sta, TDLS_CH_SW_OFF_CHNL, pchsw_info->off_ch_num, -+ pchsw_info->ch_offset, (pchsw_info->ch_offset) ? CHANNEL_WIDTH_40 : CHANNEL_WIDTH_20, ptdls_sta->ch_switch_time) == _SUCCESS) { -+ pchsw_info->ch_sw_state &= ~(TDLS_PEER_AT_OFF_STATE); -+ if (pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE) { -+ if (issue_nulldata_to_TDLS_peer_STA(ptdls_sta->padapter, ptdls_sta->hwaddr, 0, 1, 3) == _FAIL) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_BASE_CHNL); -+ } -+ } else { -+ u8 bcancelled; -+ -+ if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) -+ _cancel_timer(&ptdls_sta->ch_sw_timer, &bcancelled); -+ } -+ -+ -+ break; -+ case TDLS_CH_SW_END: -+ case TDLS_CH_SW_END_TO_BASE_CHNL: -+ rtw_tdls_set_ch_sw_oper_control(padapter, _FALSE); -+ _cancel_timer_ex(&ptdls_sta->ch_sw_timer); -+ _cancel_timer_ex(&ptdls_sta->stay_on_base_chnl_timer); -+ _cancel_timer_ex(&ptdls_sta->ch_sw_monitor_timer); -+#if 0 -+ _rtw_memset(pHalData->tdls_ch_sw_iqk_info_base_chnl, 0x00, sizeof(pHalData->tdls_ch_sw_iqk_info_base_chnl)); -+ _rtw_memset(pHalData->tdls_ch_sw_iqk_info_off_chnl, 0x00, sizeof(pHalData->tdls_ch_sw_iqk_info_off_chnl)); -+#endif -+ -+ if (option == TDLS_CH_SW_END_TO_BASE_CHNL) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_BASE_CHNL); -+ -+ break; -+ case TDLS_CH_SW_TO_BASE_CHNL_UNSOLICITED: -+ case TDLS_CH_SW_TO_BASE_CHNL: -+ pchsw_info->ch_sw_state &= ~(TDLS_PEER_AT_OFF_STATE | TDLS_WAIT_CH_RSP_STATE); -+ -+ if (option == TDLS_CH_SW_TO_BASE_CHNL_UNSOLICITED) { -+ if (ptdls_sta != NULL) { -+ /* Send unsolicited channel switch rsp. to peer */ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.status_code = 0; -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); -+ issue_tdls_ch_switch_rsp(padapter, &txmgmt, _FALSE); -+ } -+ } -+ -+ if (rtw_tdls_do_ch_sw(padapter, ptdls_sta, TDLS_CH_SW_BASE_CHNL, pmlmeext->cur_channel, -+ pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode, ptdls_sta->ch_switch_time) == _SUCCESS) { -+ issue_nulldata(padapter, NULL, 0, 3, 3); -+ /* set ch sw monitor timer for responder */ -+ if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) -+ _set_timer(&ptdls_sta->ch_sw_monitor_timer, TDLS_CH_SW_MONITOR_TIMEOUT); -+ } -+ -+ break; -+#endif -+ case TDLS_RS_RCR: -+ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_RS_RCR, 0); -+ RTW_INFO("[TDLS] write REG_RCR, set bit6 on\n"); -+ break; -+ case TDLS_TEARDOWN_STA: -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.status_code = 0; -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); -+ -+ issue_tdls_teardown(padapter, &txmgmt, _TRUE); -+ break; -+ case TDLS_TEARDOWN_STA_LOCALLY: -+#ifdef CONFIG_TDLS_CH_SW -+ if (_rtw_memcmp(TDLSoption->addr, pchsw_info->addr, ETH_ALEN) == _TRUE) { -+ pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE | -+ TDLS_CH_SWITCH_ON_STATE | -+ TDLS_PEER_AT_OFF_STATE); -+ rtw_tdls_set_ch_sw_oper_control(padapter, _FALSE); -+ _rtw_memset(pchsw_info->addr, 0x00, ETH_ALEN); -+ } -+#endif -+ rtw_sta_media_status_rpt(padapter, ptdls_sta, 0); -+ free_tdls_sta(padapter, ptdls_sta); -+ break; -+ } -+ -+ /* _exit_critical_bh(&(ptdlsinfo->hdl_lock), &irqL); */ -+ -+ return H2C_SUCCESS; -+#else -+ return H2C_REJECTED; -+#endif /* CONFIG_TDLS */ -+ -+} -+ -+u8 run_in_thread_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ struct RunInThread_param *p; -+ -+ -+ if (NULL == pbuf) -+ return H2C_PARAMETERS_ERROR; -+ p = (struct RunInThread_param *)pbuf; -+ -+ if (p->func) -+ p->func(p->context); -+ -+ return H2C_SUCCESS; -+} -+ -+u8 rtw_getmacreg_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ -+ struct readMAC_parm *preadmacparm = NULL; -+ u8 sz = 0; -+ u32 addr = 0; -+ u32 value = 0; -+ -+ if (!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ preadmacparm = (struct readMAC_parm *) pbuf; -+ sz = preadmacparm->len; -+ addr = preadmacparm->addr; -+ value = 0; -+ -+ switch (sz) { -+ case 1: -+ value = rtw_read8(padapter, addr); -+ break; -+ case 2: -+ value = rtw_read16(padapter, addr); -+ break; -+ case 4: -+ value = rtw_read32(padapter, addr); -+ break; -+ default: -+ RTW_INFO("%s: Unknown size\n", __func__); -+ break; -+ } -+ RTW_INFO("%s: addr:0x%02x valeu:0x%02x\n", __func__, addr, value); -+ -+ return H2C_SUCCESS; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_mp.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mp.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_mp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mp.c 2018-02-11 21:44:27.139145964 +0200 -@@ -0,0 +1,3452 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_MP_C_ -+#include -+#ifdef PLATFORM_FREEBSD -+ #include /* for RFHIGHPID */ -+#endif -+ -+#include "../hal/phydm/phydm_precomp.h" -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8821A) -+ #include -+#endif -+ -+#ifdef CONFIG_MP_VHT_HW_TX_MODE -+#define CEILING_POS(X) ((X - (int)(X)) > 0 ? (int)(X + 1) : (int)(X)) -+#define CEILING_NEG(X) ((X - (int)(X)) < 0 ? (int)(X - 1) : (int)(X)) -+#define ceil(X) (((X) > 0) ? CEILING_POS(X) : CEILING_NEG(X)) -+ -+int rtfloor(float x) -+{ -+ int i = x - 2; -+ while -+ (++i <= x - 1) -+ ; -+ return i; -+} -+#endif -+ -+#ifdef CONFIG_MP_INCLUDED -+u32 read_macreg(_adapter *padapter, u32 addr, u32 sz) -+{ -+ u32 val = 0; -+ -+ switch (sz) { -+ case 1: -+ val = rtw_read8(padapter, addr); -+ break; -+ case 2: -+ val = rtw_read16(padapter, addr); -+ break; -+ case 4: -+ val = rtw_read32(padapter, addr); -+ break; -+ default: -+ val = 0xffffffff; -+ break; -+ } -+ -+ return val; -+ -+} -+ -+void write_macreg(_adapter *padapter, u32 addr, u32 val, u32 sz) -+{ -+ switch (sz) { -+ case 1: -+ rtw_write8(padapter, addr, (u8)val); -+ break; -+ case 2: -+ rtw_write16(padapter, addr, (u16)val); -+ break; -+ case 4: -+ rtw_write32(padapter, addr, val); -+ break; -+ default: -+ break; -+ } -+ -+} -+ -+u32 read_bbreg(_adapter *padapter, u32 addr, u32 bitmask) -+{ -+ return rtw_hal_read_bbreg(padapter, addr, bitmask); -+} -+ -+void write_bbreg(_adapter *padapter, u32 addr, u32 bitmask, u32 val) -+{ -+ rtw_hal_write_bbreg(padapter, addr, bitmask, val); -+} -+ -+u32 _read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask) -+{ -+ return rtw_hal_read_rfreg(padapter, rfpath, addr, bitmask); -+} -+ -+void _write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask, u32 val) -+{ -+ rtw_hal_write_rfreg(padapter, rfpath, addr, bitmask, val); -+} -+ -+u32 read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr) -+{ -+ return _read_rfreg(padapter, rfpath, addr, bRFRegOffsetMask); -+} -+ -+void write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 val) -+{ -+ _write_rfreg(padapter, rfpath, addr, bRFRegOffsetMask, val); -+} -+ -+static void _init_mp_priv_(struct mp_priv *pmp_priv) -+{ -+ WLAN_BSSID_EX *pnetwork; -+ -+ _rtw_memset(pmp_priv, 0, sizeof(struct mp_priv)); -+ -+ pmp_priv->mode = MP_OFF; -+ -+ pmp_priv->channel = 1; -+ pmp_priv->bandwidth = CHANNEL_WIDTH_20; -+ pmp_priv->prime_channel_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pmp_priv->rateidx = RATE_1M; -+ pmp_priv->txpoweridx = 0x2A; -+ -+ pmp_priv->antenna_tx = ANTENNA_A; -+ pmp_priv->antenna_rx = ANTENNA_AB; -+ -+ pmp_priv->check_mp_pkt = 0; -+ -+ pmp_priv->tx_pktcount = 0; -+ -+ pmp_priv->rx_bssidpktcount = 0; -+ pmp_priv->rx_pktcount = 0; -+ pmp_priv->rx_crcerrpktcount = 0; -+ -+ pmp_priv->network_macaddr[0] = 0x00; -+ pmp_priv->network_macaddr[1] = 0xE0; -+ pmp_priv->network_macaddr[2] = 0x4C; -+ pmp_priv->network_macaddr[3] = 0x87; -+ pmp_priv->network_macaddr[4] = 0x66; -+ pmp_priv->network_macaddr[5] = 0x55; -+ -+ pmp_priv->bSetRxBssid = _FALSE; -+ pmp_priv->bRTWSmbCfg = _FALSE; -+ pmp_priv->bloopback = _FALSE; -+ -+ pmp_priv->bloadefusemap = _FALSE; -+ -+ pnetwork = &pmp_priv->mp_network.network; -+ _rtw_memcpy(pnetwork->MacAddress, pmp_priv->network_macaddr, ETH_ALEN); -+ -+ pnetwork->Ssid.SsidLength = 8; -+ _rtw_memcpy(pnetwork->Ssid.Ssid, "mp_871x", pnetwork->Ssid.SsidLength); -+ -+ pmp_priv->tx.payload = 2; -+#ifdef CONFIG_80211N_HT -+ pmp_priv->tx.attrib.ht_en = 1; -+#endif -+ -+} -+ -+#ifdef PLATFORM_WINDOWS -+#if 0 -+void mp_wi_callback( -+ IN NDIS_WORK_ITEM *pwk_item, -+ IN PVOID cntx -+) -+{ -+ _adapter *padapter = (_adapter *)cntx; -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ struct mp_wi_cntx *pmp_wi_cntx = &pmppriv->wi_cntx; -+ -+ /* Execute specified action. */ -+ if (pmp_wi_cntx->curractfunc != NULL) { -+ LARGE_INTEGER cur_time; -+ ULONGLONG start_time, end_time; -+ NdisGetCurrentSystemTime(&cur_time); /* driver version */ -+ start_time = cur_time.QuadPart / 10; /* The return value is in microsecond */ -+ -+ pmp_wi_cntx->curractfunc(padapter); -+ -+ NdisGetCurrentSystemTime(&cur_time); /* driver version */ -+ end_time = cur_time.QuadPart / 10; /* The return value is in microsecond */ -+ -+ } -+ -+ NdisAcquireSpinLock(&(pmp_wi_cntx->mp_wi_lock)); -+ pmp_wi_cntx->bmp_wi_progress = _FALSE; -+ NdisReleaseSpinLock(&(pmp_wi_cntx->mp_wi_lock)); -+ -+ if (pmp_wi_cntx->bmpdrv_unload) -+ NdisSetEvent(&(pmp_wi_cntx->mp_wi_evt)); -+ -+} -+#endif -+ -+static int init_mp_priv_by_os(struct mp_priv *pmp_priv) -+{ -+ struct mp_wi_cntx *pmp_wi_cntx; -+ -+ if (pmp_priv == NULL) -+ return _FAIL; -+ -+ pmp_priv->rx_testcnt = 0; -+ pmp_priv->rx_testcnt1 = 0; -+ pmp_priv->rx_testcnt2 = 0; -+ -+ pmp_priv->tx_testcnt = 0; -+ pmp_priv->tx_testcnt1 = 0; -+ -+ pmp_wi_cntx = &pmp_priv->wi_cntx -+ pmp_wi_cntx->bmpdrv_unload = _FALSE; -+ pmp_wi_cntx->bmp_wi_progress = _FALSE; -+ pmp_wi_cntx->curractfunc = NULL; -+ -+ return _SUCCESS; -+} -+#endif -+ -+#ifdef PLATFORM_LINUX -+static int init_mp_priv_by_os(struct mp_priv *pmp_priv) -+{ -+ int i, res; -+ struct mp_xmit_frame *pmp_xmitframe; -+ -+ if (pmp_priv == NULL) -+ return _FAIL; -+ -+ _rtw_init_queue(&pmp_priv->free_mp_xmitqueue); -+ -+ pmp_priv->pallocated_mp_xmitframe_buf = NULL; -+ pmp_priv->pallocated_mp_xmitframe_buf = rtw_zmalloc(NR_MP_XMITFRAME * sizeof(struct mp_xmit_frame) + 4); -+ if (pmp_priv->pallocated_mp_xmitframe_buf == NULL) { -+ res = _FAIL; -+ goto _exit_init_mp_priv; -+ } -+ -+ pmp_priv->pmp_xmtframe_buf = pmp_priv->pallocated_mp_xmitframe_buf + 4 - ((SIZE_PTR)(pmp_priv->pallocated_mp_xmitframe_buf) & 3); -+ -+ pmp_xmitframe = (struct mp_xmit_frame *)pmp_priv->pmp_xmtframe_buf; -+ -+ for (i = 0; i < NR_MP_XMITFRAME; i++) { -+ _rtw_init_listhead(&pmp_xmitframe->list); -+ rtw_list_insert_tail(&pmp_xmitframe->list, &pmp_priv->free_mp_xmitqueue.queue); -+ -+ pmp_xmitframe->pkt = NULL; -+ pmp_xmitframe->frame_tag = MP_FRAMETAG; -+ pmp_xmitframe->padapter = pmp_priv->papdater; -+ -+ pmp_xmitframe++; -+ } -+ -+ pmp_priv->free_mp_xmitframe_cnt = NR_MP_XMITFRAME; -+ -+ res = _SUCCESS; -+ -+_exit_init_mp_priv: -+ -+ return res; -+} -+#endif -+ -+static void mp_init_xmit_attrib(struct mp_tx *pmptx, PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ struct pkt_attrib *pattrib; -+ -+ /* init xmitframe attribute */ -+ pattrib = &pmptx->attrib; -+ _rtw_memset(pattrib, 0, sizeof(struct pkt_attrib)); -+ _rtw_memset(pmptx->desc, 0, TXDESC_SIZE); -+ -+ pattrib->ether_type = 0x8712; -+#if 0 -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+#endif -+ _rtw_memset(pattrib->dst, 0xFF, ETH_ALEN); -+ -+ /* pattrib->dhcp_pkt = 0; -+ * pattrib->pktlen = 0; */ -+ pattrib->ack_policy = 0; -+ /* pattrib->pkt_hdrlen = ETH_HLEN; */ -+ pattrib->hdrlen = WLAN_HDR_A3_LEN; -+ pattrib->subtype = WIFI_DATA; -+ pattrib->priority = 0; -+ pattrib->qsel = pattrib->priority; -+ /* do_queue_select(padapter, pattrib); */ -+ pattrib->nr_frags = 1; -+ pattrib->encrypt = 0; -+ pattrib->bswenc = _FALSE; -+ pattrib->qos_en = _FALSE; -+ -+ pattrib->pktlen = 1500; -+ -+#ifdef CONFIG_80211AC_VHT -+ if (pHalData->rf_type == RF_1T1R) -+ pattrib->raid = RATEID_IDX_VHT_1SS; -+ else if (pHalData->rf_type == RF_2T2R || pHalData->rf_type == RF_2T4R) -+ pattrib->raid = RATEID_IDX_VHT_2SS; -+ else if (pHalData->rf_type == RF_3T3R) -+ pattrib->raid = RATEID_IDX_VHT_3SS; -+ else -+ pattrib->raid = RATEID_IDX_BGN_40M_1SS; -+#endif -+} -+ -+s32 init_mp_priv(PADAPTER padapter) -+{ -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ _init_mp_priv_(pmppriv); -+ pmppriv->papdater = padapter; -+ pmppriv->mp_dm = 0; -+ pmppriv->tx.stop = 1; -+ pmppriv->bSetTxPower = 0; /*for manually set tx power*/ -+ pmppriv->bTxBufCkFail = _FALSE; -+ pmppriv->pktInterval = 0; -+ pmppriv->pktLength = 1000; -+ -+ mp_init_xmit_attrib(&pmppriv->tx, padapter); -+ -+ switch (padapter->registrypriv.rf_config) { -+ case RF_1T1R: -+ pmppriv->antenna_tx = ANTENNA_A; -+ pmppriv->antenna_rx = ANTENNA_A; -+ break; -+ case RF_1T2R: -+ default: -+ pmppriv->antenna_tx = ANTENNA_A; -+ pmppriv->antenna_rx = ANTENNA_AB; -+ break; -+ case RF_2T2R: -+ case RF_2T2R_GREEN: -+ pmppriv->antenna_tx = ANTENNA_AB; -+ pmppriv->antenna_rx = ANTENNA_AB; -+ break; -+ case RF_2T4R: -+ pmppriv->antenna_tx = ANTENNA_BC; -+ pmppriv->antenna_rx = ANTENNA_ABCD; -+ break; -+ } -+ -+ pHalData->AntennaRxPath = pmppriv->antenna_rx; -+ pHalData->AntennaTxPath = pmppriv->antenna_tx; -+ -+ return _SUCCESS; -+} -+ -+void free_mp_priv(struct mp_priv *pmp_priv) -+{ -+ if (pmp_priv->pallocated_mp_xmitframe_buf) { -+ rtw_mfree(pmp_priv->pallocated_mp_xmitframe_buf, 0); -+ pmp_priv->pallocated_mp_xmitframe_buf = NULL; -+ } -+ pmp_priv->pmp_xmtframe_buf = NULL; -+} -+ -+ -+static VOID PHY_IQCalibrate_default( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery -+) -+{ -+ RTW_INFO("%s\n", __func__); -+} -+ -+static VOID PHY_LCCalibrate_default( -+ IN PADAPTER pAdapter -+) -+{ -+ RTW_INFO("%s\n", __func__); -+} -+ -+static VOID PHY_SetRFPathSwitch_default( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bMain -+) -+{ -+ RTW_INFO("%s\n", __func__); -+} -+ -+ -+void mpt_InitHWConfig(PADAPTER Adapter) -+{ -+ if (IS_HARDWARE_TYPE_8723B(Adapter)) { -+ /* TODO: <20130114, Kordan> The following setting is only for DPDT and Fixed board type. */ -+ /* TODO: A better solution is configure it according EFUSE during the run-time. */ -+ -+ PHY_SetMacReg(Adapter, 0x64, BIT20, 0x0); /* 0x66[4]=0 */ -+ PHY_SetMacReg(Adapter, 0x64, BIT24, 0x0); /* 0x66[8]=0 */ -+ PHY_SetMacReg(Adapter, 0x40, BIT4, 0x0); /* 0x40[4]=0 */ -+ PHY_SetMacReg(Adapter, 0x40, BIT3, 0x1); /* 0x40[3]=1 */ -+ PHY_SetMacReg(Adapter, 0x4C, BIT24, 0x1); /* 0x4C[24:23]=10 */ -+ PHY_SetMacReg(Adapter, 0x4C, BIT23, 0x0); /* 0x4C[24:23]=10 */ -+ PHY_SetBBReg(Adapter, 0x944, BIT1 | BIT0, 0x3); /* 0x944[1:0]=11 */ -+ PHY_SetBBReg(Adapter, 0x930, bMaskByte0, 0x77); /* 0x930[7:0]=77 */ -+ PHY_SetMacReg(Adapter, 0x38, BIT11, 0x1); /* 0x38[11]=1 */ -+ -+ /* TODO: <20130206, Kordan> The default setting is wrong, hard-coded here. */ -+ PHY_SetMacReg(Adapter, 0x778, 0x3, 0x3); /* Turn off hardware PTA control (Asked by Scott) */ -+ PHY_SetMacReg(Adapter, 0x64, bMaskDWord, 0x36000000); /* Fix BT S0/S1 */ -+ PHY_SetMacReg(Adapter, 0x948, bMaskDWord, 0x0); /* Fix BT can't Tx */ -+ -+ /* <20130522, Kordan> Turn off equalizer to improve Rx sensitivity. (Asked by EEChou) */ -+ PHY_SetBBReg(Adapter, 0xA00, BIT8, 0x0); /*0xA01[0] = 0*/ -+ } else if (IS_HARDWARE_TYPE_8821(Adapter)) { -+ /* <20131121, VincentL> Add for 8821AU DPDT setting and fix switching antenna issue (Asked by Rock) -+ <20131122, VincentL> Enable for all 8821A/8811AU (Asked by Alex)*/ -+ PHY_SetMacReg(Adapter, 0x4C, BIT23, 0x0); /*0x4C[23:22]=01*/ -+ PHY_SetMacReg(Adapter, 0x4C, BIT22, 0x1); /*0x4C[23:22]=01*/ -+ } else if (IS_HARDWARE_TYPE_8188ES(Adapter)) -+ PHY_SetMacReg(Adapter, 0x4C , BIT23, 0); /*select DPDT_P and DPDT_N as output pin*/ -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(Adapter)) -+ PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8814A, 0x2000); -+#endif -+#ifdef CONFIG_RTL8822B -+ else if (IS_HARDWARE_TYPE_8822B(Adapter)) -+ PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8822B, 0x2000); -+#endif /* CONFIG_RTL8822B */ -+#ifdef CONFIG_RTL8821C -+ else if (IS_HARDWARE_TYPE_8821C(Adapter)) -+ PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8821C, 0x2000); -+#endif /* CONFIG_RTL8821C */ -+} -+ -+#ifdef CONFIG_RTL8188E -+ #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8188E(a, b) -+ #define PHY_LCCalibrate(a) PHY_LCCalibrate_8188E(&(GET_HAL_DATA(a)->odmpriv)) -+ #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8188E(a, b) -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8814A(&(GET_HAL_DATA(a)->odmpriv), b) -+ #define PHY_LCCalibrate(a) PHY_LCCalibrate_8814A(&(GET_HAL_DATA(a)->odmpriv)) -+ #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8814A(a, b) -+#endif /* CONFIG_RTL8814A */ -+ -+#ifdef CONFIG_RTL8812A -+ #define PHY_IQCalibrate(_Adapter, b) PHY_IQCalibrate_8812A(_Adapter, b) -+ #define PHY_LCCalibrate(_Adapter) PHY_LCCalibrate_8812A(&(GET_HAL_DATA(_Adapter)->odmpriv)) -+ #define PHY_SetRFPathSwitch(_Adapter, b) PHY_SetRFPathSwitch_8812A(_Adapter, b) -+#endif -+ -+#ifdef CONFIG_RTL8821A -+ #define PHY_IQCalibrate(_Adapter, b) PHY_IQCalibrate_8821A(&(GET_HAL_DATA(_Adapter)->odmpriv), b) -+ #define PHY_LCCalibrate(_Adapter) PHY_LCCalibrate_8821A(&(GET_HAL_DATA(_Adapter)->odmpriv)) -+ #define PHY_SetRFPathSwitch(_Adapter, b) PHY_SetRFPathSwitch_8812A(_Adapter, b) -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8192E(a, b) -+ #define PHY_LCCalibrate(a) PHY_LCCalibrate_8192E(&(GET_HAL_DATA(a)->odmpriv)) -+ #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8192E(a, b) -+#endif /* CONFIG_RTL8812A_8821A */ -+ -+#ifdef CONFIG_RTL8723B -+static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 b2ant; /* false:1ant, true:2-ant */ -+ u8 RF_Path; /* 0:S1, 1:S0 */ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ b2ant = pHalData->EEPROMBluetoothAntNum == Ant_x2 ? _TRUE : _FALSE; -+ -+ PHY_IQCalibrate_8723B(padapter, bReCovery, _FALSE, b2ant, pHalData->ant_path); -+} -+ -+ -+#define PHY_LCCalibrate(a) PHY_LCCalibrate_8723B(&(GET_HAL_DATA(a)->odmpriv)) -+#define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8723B(a, b) -+#endif -+ -+#ifdef CONFIG_RTL8703B -+static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) -+{ -+ PHY_IQCalibrate_8703B(padapter, bReCovery); -+} -+ -+ -+#define PHY_LCCalibrate(a) PHY_LCCalibrate_8703B(&(GET_HAL_DATA(a)->odmpriv)) -+#define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8703B(a, b) -+#endif -+ -+#ifdef CONFIG_RTL8188F -+static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) -+{ -+ PHY_IQCalibrate_8188F(padapter, bReCovery, _FALSE); -+} -+ -+ -+#define PHY_LCCalibrate(a) PHY_LCCalibrate_8188F(&(GET_HAL_DATA(a)->odmpriv)) -+#define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8188F(a, b) -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8822B(a, b) -+ #define PHY_LCCalibrate(a) -+ #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8822B(a, b) -+#endif /* CONFIG_RTL8822B */ -+ -+#ifdef CONFIG_RTL8723D -+ #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8723D(a, b) -+ #define PHY_LCCalibrate(a) PHY_LCCalibrate_8723D(&(GET_HAL_DATA(a)->odmpriv)) -+ #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8723D(a, b) -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ #define PHY_IQCalibrate(a, b) -+ #define PHY_LCCalibrate(a) -+ #define PHY_SetRFPathSwitch(a, b) -+#endif /* CONFIG_RTL8821C */ -+s32 -+MPT_InitializeAdapter( -+ IN PADAPTER pAdapter, -+ IN u8 Channel -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ s32 rtStatus = _SUCCESS; -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; -+ u32 ledsetting; -+ struct mlme_priv *pmlmepriv = &pAdapter->mlmepriv; -+ -+ pMptCtx->bMptDrvUnload = _FALSE; -+ pMptCtx->bMassProdTest = _FALSE; -+ pMptCtx->bMptIndexEven = _TRUE; /* default gain index is -6.0db */ -+ pMptCtx->h2cReqNum = 0x0; -+ /* init for BT MP */ -+#if defined(CONFIG_RTL8723B) -+ pMptCtx->bMPh2c_timeout = _FALSE; -+ pMptCtx->MptH2cRspEvent = _FALSE; -+ pMptCtx->MptBtC2hEvent = _FALSE; -+ _rtw_init_sema(&pMptCtx->MPh2c_Sema, 0); -+ _init_timer(&pMptCtx->MPh2c_timeout_timer, pAdapter->pnetdev, MPh2c_timeout_handle, pAdapter); -+#endif -+ -+ mpt_InitHWConfig(pAdapter); -+ -+#ifdef CONFIG_RTL8723B -+ rtl8723b_InitAntenna_Selection(pAdapter); -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+ -+ /* <20130522, Kordan> Turn off equalizer to improve Rx sensitivity. (Asked by EEChou)*/ -+ PHY_SetBBReg(pAdapter, 0xA00, BIT8, 0x0); -+ PHY_SetRFPathSwitch(pAdapter, 1/*pHalData->bDefaultAntenna*/); /*default use Main*/ -+ /*<20130522, Kordan> 0x51 and 0x71 should be set immediately after path switched, or they might be overwritten. */ -+ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)) -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); -+ else -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); -+ } -+ /*set ant to wifi side in mp mode*/ -+ rtw_write16(pAdapter, 0x870, 0x300); -+ rtw_write16(pAdapter, 0x860, 0x110); -+#endif -+ -+ pMptCtx->bMptWorkItemInProgress = _FALSE; -+ pMptCtx->CurrMptAct = NULL; -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ /* ------------------------------------------------------------------------- */ -+ /* Don't accept any packets */ -+ rtw_write32(pAdapter, REG_RCR, 0); -+ -+ /* ledsetting = rtw_read32(pAdapter, REG_LEDCFG0); */ -+ /* rtw_write32(pAdapter, REG_LEDCFG0, ledsetting & ~LED0DIS); */ -+ -+ /* rtw_write32(pAdapter, REG_LEDCFG0, 0x08080); */ -+ ledsetting = rtw_read32(pAdapter, REG_LEDCFG0); -+ -+ -+ PHY_LCCalibrate(pAdapter); -+ PHY_IQCalibrate(pAdapter, _FALSE); -+ /* dm_CheckTXPowerTracking(&pHalData->odmpriv); */ /* trigger thermal meter */ -+ -+ PHY_SetRFPathSwitch(pAdapter, 1/*pHalData->bDefaultAntenna*/); /* default use Main */ -+ -+ pMptCtx->backup0xc50 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_XAAGCCore1, bMaskByte0); -+ pMptCtx->backup0xc58 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_XBAGCCore1, bMaskByte0); -+ pMptCtx->backup0xc30 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_RxDetector1, bMaskByte0); -+ pMptCtx->backup0x52_RF_A = (u1Byte)PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0); -+ pMptCtx->backup0x52_RF_B = (u1Byte)PHY_QueryRFReg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0); -+#ifdef CONFIG_RTL8188E -+ rtw_write32(pAdapter, REG_MACID_NO_LINK_0, 0x0); -+ rtw_write32(pAdapter, REG_MACID_NO_LINK_1, 0x0); -+#endif -+#ifdef CONFIG_RTL8814A -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) { -+ pHalData->BackUp_IG_REG_4_Chnl_Section[0] = (u1Byte)PHY_QueryBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0); -+ pHalData->BackUp_IG_REG_4_Chnl_Section[1] = (u1Byte)PHY_QueryBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0); -+ pHalData->BackUp_IG_REG_4_Chnl_Section[2] = (u1Byte)PHY_QueryBBReg(pAdapter, rC_IGI_Jaguar2, bMaskByte0); -+ pHalData->BackUp_IG_REG_4_Chnl_Section[3] = (u1Byte)PHY_QueryBBReg(pAdapter, rD_IGI_Jaguar2, bMaskByte0); -+ } -+#endif -+ return rtStatus; -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: MPT_DeInitAdapter() -+ * -+ * Overview: Extra DeInitialization for Mass Production Test. -+ * -+ * Input: PADAPTER pAdapter -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 05/08/2007 MHC Create Version 0. -+ * 05/18/2007 MHC Add normal driver MPHalt code. -+ * -+ *---------------------------------------------------------------------------*/ -+VOID -+MPT_DeInitAdapter( -+ IN PADAPTER pAdapter -+) -+{ -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; -+ -+ pMptCtx->bMptDrvUnload = _TRUE; -+#if defined(CONFIG_RTL8723B) -+ _rtw_free_sema(&(pMptCtx->MPh2c_Sema)); -+ _cancel_timer_ex(&pMptCtx->MPh2c_timeout_timer); -+#endif -+#if defined(CONFIG_RTL8723B) -+ PHY_SetBBReg(pAdapter, 0xA01, BIT0, 1); /* /suggestion by jerry for MP Rx. */ -+#endif -+#if 0 /* for Windows */ -+ PlatformFreeWorkItem(&(pMptCtx->MptWorkItem)); -+ -+ while (pMptCtx->bMptWorkItemInProgress) { -+ if (NdisWaitEvent(&(pMptCtx->MptWorkItemEvent), 50)) -+ break; -+ } -+ NdisFreeSpinLock(&(pMptCtx->MptWorkItemSpinLock)); -+#endif -+} -+ -+static u8 mpt_ProStartTest(PADAPTER padapter) -+{ -+ PMPT_CONTEXT pMptCtx = &padapter->mppriv.MptCtx; -+ -+ pMptCtx->bMassProdTest = _TRUE; -+ pMptCtx->bStartContTx = _FALSE; -+ pMptCtx->bCckContTx = _FALSE; -+ pMptCtx->bOfdmContTx = _FALSE; -+ pMptCtx->bSingleCarrier = _FALSE; -+ pMptCtx->bCarrierSuppression = _FALSE; -+ pMptCtx->bSingleTone = _FALSE; -+ pMptCtx->HWTxmode = PACKETS_TX; -+ -+ return _SUCCESS; -+} -+ -+/* -+ * General use -+ */ -+s32 SetPowerTracking(PADAPTER padapter, u8 enable) -+{ -+ -+ hal_mpt_SetPowerTracking(padapter, enable); -+ return 0; -+} -+ -+void GetPowerTracking(PADAPTER padapter, u8 *enable) -+{ -+ hal_mpt_GetPowerTracking(padapter, enable); -+} -+ -+void rtw_mp_trigger_iqk(PADAPTER padapter) -+{ -+ PHY_IQCalibrate(padapter, _FALSE); -+} -+ -+void rtw_mp_trigger_lck(PADAPTER padapter) -+{ -+ PHY_LCCalibrate(padapter); -+} -+ -+static void disable_dm(PADAPTER padapter) -+{ -+ u8 v8; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ /* 3 1. disable firmware dynamic mechanism */ -+ /* disable Power Training, Rate Adaptive */ -+ v8 = rtw_read8(padapter, REG_BCN_CTRL); -+ v8 &= ~EN_BCN_FUNCTION; -+ rtw_write8(padapter, REG_BCN_CTRL, v8); -+ -+ /* 3 2. disable driver dynamic mechanism */ -+ rtw_phydm_func_disable_all(padapter); -+ -+ /* enable APK, LCK and IQK but disable power tracking */ -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _FALSE; -+ rtw_phydm_func_set(padapter, ODM_RF_CALIBRATION); -+ -+ /* #ifdef CONFIG_BT_COEXIST */ -+ /* rtw_btcoex_Switch(padapter, 0); */ /* remove for BT MP Down. */ -+ /* #endif */ -+} -+ -+ -+void MPT_PwrCtlDM(PADAPTER padapter, u32 bstart) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ if (bstart == 1) { -+ RTW_INFO("in MPT_PwrCtlDM start\n"); -+ rtw_phydm_func_set(padapter, ODM_RF_TX_PWR_TRACK | ODM_RF_CALIBRATION); -+ -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; -+ padapter->mppriv.mp_dm = 1; -+ -+ } else { -+ RTW_INFO("in MPT_PwrCtlDM stop\n"); -+ disable_dm(padapter); -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _FALSE; -+ padapter->mppriv.mp_dm = 0; -+ { -+ TXPWRTRACK_CFG c; -+ u1Byte chnl = 0 ; -+ _rtw_memset(&c, 0, sizeof(TXPWRTRACK_CFG)); -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+ if (*c.ODM_TxPwrTrackSetPwr) { -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, chnl); -+ else if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, ODM_RF_PATH_A, chnl); -+ SetTxPower(padapter); -+ } else { -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, ODM_RF_PATH_A, chnl); -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, ODM_RF_PATH_B, chnl); -+ } -+ } -+ } -+ } -+ -+} -+ -+ -+u32 mp_join(PADAPTER padapter, u8 mode) -+{ -+ WLAN_BSSID_EX bssid; -+ struct sta_info *psta; -+ u32 length; -+ u8 val8, join_type; -+ _irqL irqL; -+ s32 res = _SUCCESS; -+ -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *tgt_network = &pmlmepriv->cur_network; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+#endif /* #ifdef CONFIG_IOCTL_CFG80211 */ -+ /* 1. initialize a new WLAN_BSSID_EX */ -+ _rtw_memset(&bssid, 0, sizeof(WLAN_BSSID_EX)); -+ RTW_INFO("%s ,pmppriv->network_macaddr=%x %x %x %x %x %x\n", __func__, -+ pmppriv->network_macaddr[0], pmppriv->network_macaddr[1], pmppriv->network_macaddr[2], pmppriv->network_macaddr[3], pmppriv->network_macaddr[4], -+ pmppriv->network_macaddr[5]); -+ _rtw_memcpy(bssid.MacAddress, pmppriv->network_macaddr, ETH_ALEN); -+ -+ if (mode == WIFI_FW_ADHOC_STATE) { -+ bssid.Ssid.SsidLength = strlen("mp_pseudo_adhoc"); -+ _rtw_memcpy(bssid.Ssid.Ssid, (u8 *)"mp_pseudo_adhoc", bssid.Ssid.SsidLength); -+ bssid.InfrastructureMode = Ndis802_11IBSS; -+ bssid.NetworkTypeInUse = Ndis802_11DS; -+ bssid.IELength = 0; -+ bssid.Configuration.DSConfig = pmppriv->channel; -+ -+ } else if (mode == WIFI_FW_STATION_STATE) { -+ bssid.Ssid.SsidLength = strlen("mp_pseudo_STATION"); -+ _rtw_memcpy(bssid.Ssid.Ssid, (u8 *)"mp_pseudo_STATION", bssid.Ssid.SsidLength); -+ bssid.InfrastructureMode = Ndis802_11Infrastructure; -+ bssid.NetworkTypeInUse = Ndis802_11DS; -+ bssid.IELength = 0; -+ } -+ -+ length = get_WLAN_BSSID_EX_sz(&bssid); -+ if (length % 4) -+ bssid.Length = ((length >> 2) + 1) << 2; /* round up to multiple of 4 bytes. */ -+ else -+ bssid.Length = length; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) -+ goto end_of_mp_start_test; -+ -+ /* init mp_start_test status */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ rtw_disassoc_cmd(padapter, 500, _TRUE); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ rtw_free_assoc_resources(padapter, 1); -+ } -+ pmppriv->prev_fw_state = get_fwstate(pmlmepriv); -+ /*pmlmepriv->fw_state = WIFI_MP_STATE;*/ -+ init_fwstate(pmlmepriv, WIFI_MP_STATE); -+ -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ -+ /* 3 2. create a new psta for mp driver */ -+ /* clear psta in the cur_network, if any */ -+ psta = rtw_get_stainfo(&padapter->stapriv, tgt_network->network.MacAddress); -+ if (psta) -+ rtw_free_stainfo(padapter, psta); -+ -+ psta = rtw_alloc_stainfo(&padapter->stapriv, bssid.MacAddress); -+ if (psta == NULL) { -+ /*pmlmepriv->fw_state = pmppriv->prev_fw_state;*/ -+ init_fwstate(pmlmepriv, pmppriv->prev_fw_state); -+ res = _FAIL; -+ goto end_of_mp_start_test; -+ } -+ if (mode == WIFI_FW_ADHOC_STATE) -+ set_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ else -+ set_fwstate(pmlmepriv, WIFI_STATION_STATE); -+ /* 3 3. join psudo AdHoc */ -+ tgt_network->join_res = 1; -+ tgt_network->aid = psta->aid = 1; -+ -+ _rtw_memcpy(&padapter->registrypriv.dev_network, &bssid, length); -+ rtw_update_registrypriv_dev_network(padapter); -+ _rtw_memcpy(&tgt_network->network, &padapter->registrypriv.dev_network, padapter->registrypriv.dev_network.Length); -+ _rtw_memcpy(pnetwork, &padapter->registrypriv.dev_network, padapter->registrypriv.dev_network.Length); -+ -+ rtw_indicate_connect(padapter); -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ set_fwstate(pmlmepriv, _FW_LINKED); -+ -+end_of_mp_start_test: -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if (1) { /* (res == _SUCCESS) */ -+ /* set MSR to WIFI_FW_ADHOC_STATE */ -+ if (mode == WIFI_FW_ADHOC_STATE) { -+ /* set msr to WIFI_FW_ADHOC_STATE */ -+ pmlmeinfo->state = WIFI_FW_ADHOC_STATE; -+ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, padapter->registrypriv.dev_network.MacAddress); -+ join_type = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ -+ report_join_res(padapter, 1); -+ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ } else { -+ Set_MSR(padapter, WIFI_FW_STATION_STATE); -+ -+ RTW_INFO("%s , pmppriv->network_macaddr =%x %x %x %x %x %x\n", __func__, -+ pmppriv->network_macaddr[0], pmppriv->network_macaddr[1], pmppriv->network_macaddr[2], pmppriv->network_macaddr[3], pmppriv->network_macaddr[4], -+ pmppriv->network_macaddr[5]); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmppriv->network_macaddr); -+ } -+ } -+ -+ return res; -+} -+/* This function initializes the DUT to the MP test mode */ -+s32 mp_start_test(PADAPTER padapter) -+{ -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ s32 res = _SUCCESS; -+ -+ padapter->registrypriv.mp_mode = 1; -+ -+ /* 3 disable dynamic mechanism */ -+ disable_dm(padapter); -+#ifdef CONFIG_RTL8814A -+ rtl8814_InitHalDm(padapter); -+#endif /* CONFIG_RTL8814A */ -+#ifdef CONFIG_RTL8822B -+ rtl8822b_phy_init_haldm(padapter); -+#endif /* CONFIG_RTL8822B */ -+#ifdef CONFIG_RTL8821C -+ rtl8821c_phy_init_haldm(padapter); -+#endif /* CONFIG_RTL8821C */ -+#ifdef CONFIG_RTL8812A -+ rtl8812_InitHalDm(padapter); -+#endif /* CONFIG_RTL8812A */ -+#ifdef CONFIG_RTL8723B -+ rtl8723b_InitHalDm(padapter); -+#endif /* CONFIG_RTL8723B */ -+#ifdef CONFIG_RTL8703B -+ rtl8703b_InitHalDm(padapter); -+#endif /* CONFIG_RTL8703B */ -+#ifdef CONFIG_RTL8192E -+ rtl8192e_InitHalDm(padapter); -+#endif -+#ifdef CONFIG_RTL8188F -+ rtl8188f_InitHalDm(padapter); -+#endif -+#ifdef CONFIG_RTL8188E -+ rtl8188e_InitHalDm(padapter); -+#endif -+#ifdef CONFIG_RTL8723D -+ rtl8723d_InitHalDm(padapter); -+#endif /* CONFIG_RTL8723D */ -+ -+ /* 3 0. update mp_priv */ -+ -+ if (padapter->registrypriv.rf_config == RF_MAX_TYPE) { -+ /* switch (phal->rf_type) { */ -+ switch (GET_RF_TYPE(padapter)) { -+ case RF_1T1R: -+ pmppriv->antenna_tx = ANTENNA_A; -+ pmppriv->antenna_rx = ANTENNA_A; -+ break; -+ case RF_1T2R: -+ default: -+ pmppriv->antenna_tx = ANTENNA_A; -+ pmppriv->antenna_rx = ANTENNA_AB; -+ break; -+ case RF_2T2R: -+ case RF_2T2R_GREEN: -+ pmppriv->antenna_tx = ANTENNA_AB; -+ pmppriv->antenna_rx = ANTENNA_AB; -+ break; -+ case RF_2T4R: -+ pmppriv->antenna_tx = ANTENNA_AB; -+ pmppriv->antenna_rx = ANTENNA_ABCD; -+ break; -+ } -+ } -+ -+ mpt_ProStartTest(padapter); -+ -+ mp_join(padapter, WIFI_FW_ADHOC_STATE); -+ -+ return res; -+} -+/* ------------------------------------------------------------------------------ -+ * This function change the DUT from the MP test mode into normal mode */ -+void mp_stop_test(PADAPTER padapter) -+{ -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *tgt_network = &pmlmepriv->cur_network; -+ struct sta_info *psta; -+ -+ _irqL irqL; -+ -+ if (pmppriv->mode == MP_ON) { -+ pmppriv->bSetTxPower = 0; -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _FALSE) -+ goto end_of_mp_stop_test; -+ -+ /* 3 1. disconnect psudo AdHoc */ -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ -+ /* 3 2. clear psta used in mp test mode. -+ * rtw_free_assoc_resources(padapter, 1); */ -+ psta = rtw_get_stainfo(&padapter->stapriv, tgt_network->network.MacAddress); -+ if (psta) -+ rtw_free_stainfo(padapter, psta); -+ -+ /* 3 3. return to normal state (default:station mode) */ -+ /*pmlmepriv->fw_state = pmppriv->prev_fw_state; */ /* WIFI_STATION_STATE;*/ -+ init_fwstate(pmlmepriv, pmppriv->prev_fw_state); -+ -+ /* flush the cur_network */ -+ _rtw_memset(tgt_network, 0, sizeof(struct wlan_network)); -+ -+ _clr_fwstate_(pmlmepriv, WIFI_MP_STATE); -+ -+end_of_mp_stop_test: -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+#ifdef CONFIG_RTL8812A -+ rtl8812_InitHalDm(padapter); -+#endif -+#ifdef CONFIG_RTL8723B -+ rtl8723b_InitHalDm(padapter); -+#endif -+#ifdef CONFIG_RTL8703B -+ rtl8703b_InitHalDm(padapter); -+#endif -+#ifdef CONFIG_RTL8192E -+ rtl8192e_InitHalDm(padapter); -+#endif -+#ifdef CONFIG_RTL8188F -+ rtl8188f_InitHalDm(padapter); -+#endif -+#ifdef CONFIG_RTL8723D -+ rtl8723d_InitHalDm(padapter); -+#endif -+ } -+} -+/*---------------------------hal\rtl8192c\MPT_Phy.c---------------------------*/ -+#if 0 -+/* #ifdef CONFIG_USB_HCI */ -+static VOID mpt_AdjustRFRegByRateByChan92CU(PADAPTER pAdapter, u8 RateIdx, u8 Channel, u8 BandWidthID) -+{ -+ u8 eRFPath; -+ u32 rfReg0x26; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ -+ if (RateIdx < MPT_RATE_6M) /* CCK rate,for 88cu */ -+ rfReg0x26 = 0xf400; -+ else if ((RateIdx >= MPT_RATE_6M) && (RateIdx <= MPT_RATE_54M)) {/* OFDM rate,for 88cu */ -+ if ((4 == Channel) || (8 == Channel) || (12 == Channel)) -+ rfReg0x26 = 0xf000; -+ else if ((5 == Channel) || (7 == Channel) || (13 == Channel) || (14 == Channel)) -+ rfReg0x26 = 0xf400; -+ else -+ rfReg0x26 = 0x4f200; -+ } else if ((RateIdx >= MPT_RATE_MCS0) && (RateIdx <= MPT_RATE_MCS15)) { -+ /* MCS 20M ,for 88cu */ /* MCS40M rate,for 88cu */ -+ -+ if (CHANNEL_WIDTH_20 == BandWidthID) { -+ if ((4 == Channel) || (8 == Channel)) -+ rfReg0x26 = 0xf000; -+ else if ((5 == Channel) || (7 == Channel) || (13 == Channel) || (14 == Channel)) -+ rfReg0x26 = 0xf400; -+ else -+ rfReg0x26 = 0x4f200; -+ } else { -+ if ((4 == Channel) || (8 == Channel)) -+ rfReg0x26 = 0xf000; -+ else if ((5 == Channel) || (7 == Channel)) -+ rfReg0x26 = 0xf400; -+ else -+ rfReg0x26 = 0x4f200; -+ } -+ } -+ -+ for (eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) -+ write_rfreg(pAdapter, eRFPath, RF_SYN_G2, rfReg0x26); -+} -+#endif -+/*----------------------------------------------------------------------------- -+ * Function: mpt_SwitchRfSetting -+ * -+ * Overview: Change RF Setting when we siwthc channel/rate/BW for MP. -+ * -+ * Input: IN PADAPTER pAdapter -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 01/08/2009 MHC Suggestion from SD3 Willis for 92S series. -+ * 01/09/2009 MHC Add CCK modification for 40MHZ. Suggestion from SD3. -+ * -+ *---------------------------------------------------------------------------*/ -+static void mpt_SwitchRfSetting(PADAPTER pAdapter) -+{ -+ hal_mpt_SwitchRfSetting(pAdapter); -+} -+ -+/*---------------------------hal\rtl8192c\MPT_Phy.c---------------------------*/ -+/*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ -+static void MPT_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) -+{ -+ hal_mpt_CCKTxPowerAdjust(Adapter, bInCH14); -+} -+ -+/*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ -+ -+/* -+ * SetChannel -+ * Description -+ * Use H2C command to change channel, -+ * not only modify rf register, but also other setting need to be done. -+ */ -+void SetChannel(PADAPTER pAdapter) -+{ -+ hal_mpt_SetChannel(pAdapter); -+} -+ -+/* -+ * Notice -+ * Switch bandwitdth may change center frequency(channel) -+ */ -+void SetBandwidth(PADAPTER pAdapter) -+{ -+ hal_mpt_SetBandwidth(pAdapter); -+ -+} -+ -+void SetAntenna(PADAPTER pAdapter) -+{ -+ hal_mpt_SetAntenna(pAdapter); -+} -+ -+int SetTxPower(PADAPTER pAdapter) -+{ -+ -+ hal_mpt_SetTxPower(pAdapter); -+ return _TRUE; -+} -+ -+void SetTxAGCOffset(PADAPTER pAdapter, u32 ulTxAGCOffset) -+{ -+ u32 TxAGCOffset_B, TxAGCOffset_C, TxAGCOffset_D, tmpAGC; -+ -+ TxAGCOffset_B = (ulTxAGCOffset & 0x000000ff); -+ TxAGCOffset_C = ((ulTxAGCOffset & 0x0000ff00) >> 8); -+ TxAGCOffset_D = ((ulTxAGCOffset & 0x00ff0000) >> 16); -+ -+ tmpAGC = (TxAGCOffset_D << 8 | TxAGCOffset_C << 4 | TxAGCOffset_B); -+ write_bbreg(pAdapter, rFPGA0_TxGainStage, -+ (bXBTxAGC | bXCTxAGC | bXDTxAGC), tmpAGC); -+} -+ -+void SetDataRate(PADAPTER pAdapter) -+{ -+ hal_mpt_SetDataRate(pAdapter); -+} -+ -+void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter , BOOLEAN bMain) -+{ -+ -+ PHY_SetRFPathSwitch(pAdapter, bMain); -+ -+} -+ -+ -+s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther) -+{ -+ return hal_mpt_SetThermalMeter(pAdapter, target_ther); -+} -+ -+static void TriggerRFThermalMeter(PADAPTER pAdapter) -+{ -+ hal_mpt_TriggerRFThermalMeter(pAdapter); -+} -+ -+static u8 ReadRFThermalMeter(PADAPTER pAdapter) -+{ -+ return hal_mpt_ReadRFThermalMeter(pAdapter); -+} -+ -+void GetThermalMeter(PADAPTER pAdapter, u8 *value) -+{ -+ hal_mpt_GetThermalMeter(pAdapter, value); -+} -+ -+void SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) -+{ -+ PhySetTxPowerLevel(pAdapter); -+ hal_mpt_SetSingleCarrierTx(pAdapter, bStart); -+} -+ -+void SetSingleToneTx(PADAPTER pAdapter, u8 bStart) -+{ -+ PhySetTxPowerLevel(pAdapter); -+ hal_mpt_SetSingleToneTx(pAdapter, bStart); -+} -+ -+void SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) -+{ -+ PhySetTxPowerLevel(pAdapter); -+ hal_mpt_SetCarrierSuppressionTx(pAdapter, bStart); -+} -+ -+void SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ PhySetTxPowerLevel(pAdapter); -+ hal_mpt_SetCCKContinuousTx(pAdapter, bStart); -+} -+ -+void SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ PhySetTxPowerLevel(pAdapter); -+ hal_mpt_SetOFDMContinuousTx(pAdapter, bStart); -+} /* mpt_StartOfdmContTx */ -+ -+void SetContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ PhySetTxPowerLevel(pAdapter); -+ hal_mpt_SetContinuousTx(pAdapter, bStart); -+} -+ -+ -+void PhySetTxPowerLevel(PADAPTER pAdapter) -+{ -+ struct mp_priv *pmp_priv = &pAdapter->mppriv; -+ -+ -+ if (pmp_priv->bSetTxPower == 0) /* for NO manually set power index */ -+ rtw_hal_set_tx_power_level(pAdapter, pmp_priv->channel); -+} -+ -+/* ------------------------------------------------------------------------------ */ -+static void dump_mpframe(PADAPTER padapter, struct xmit_frame *pmpframe) -+{ -+ rtw_hal_mgnt_xmit(padapter, pmpframe); -+} -+ -+static struct xmit_frame *alloc_mp_xmitframe(struct xmit_priv *pxmitpriv) -+{ -+ struct xmit_frame *pmpframe; -+ struct xmit_buf *pxmitbuf; -+ -+ pmpframe = rtw_alloc_xmitframe(pxmitpriv); -+ if (pmpframe == NULL) -+ return NULL; -+ -+ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); -+ if (pxmitbuf == NULL) { -+ rtw_free_xmitframe(pxmitpriv, pmpframe); -+ return NULL; -+ } -+ -+ pmpframe->frame_tag = MP_FRAMETAG; -+ -+ pmpframe->pxmitbuf = pxmitbuf; -+ -+ pmpframe->buf_addr = pxmitbuf->pbuf; -+ -+ pxmitbuf->priv_data = pmpframe; -+ -+ return pmpframe; -+ -+} -+ -+static thread_return mp_xmit_packet_thread(thread_context context) -+{ -+ struct xmit_frame *pxmitframe; -+ struct mp_tx *pmptx; -+ struct mp_priv *pmp_priv; -+ struct xmit_priv *pxmitpriv; -+ PADAPTER padapter; -+ -+ pmp_priv = (struct mp_priv *)context; -+ pmptx = &pmp_priv->tx; -+ padapter = pmp_priv->papdater; -+ pxmitpriv = &(padapter->xmitpriv); -+ -+ thread_enter("RTW_MP_THREAD"); -+ -+ RTW_INFO("%s:pkTx Start\n", __func__); -+ while (1) { -+ pxmitframe = alloc_mp_xmitframe(pxmitpriv); -+ if (pxmitframe == NULL) { -+ if (pmptx->stop || -+ RTW_CANNOT_RUN(padapter)) -+ goto exit; -+ else { -+ rtw_usleep_os(10); -+ continue; -+ } -+ } -+ _rtw_memcpy((u8 *)(pxmitframe->buf_addr + TXDESC_OFFSET), pmptx->buf, pmptx->write_size); -+ _rtw_memcpy(&(pxmitframe->attrib), &(pmptx->attrib), sizeof(struct pkt_attrib)); -+ -+ -+ rtw_usleep_os(padapter->mppriv.pktInterval); -+ dump_mpframe(padapter, pxmitframe); -+ -+ pmptx->sended++; -+ pmp_priv->tx_pktcount++; -+ -+ if (pmptx->stop || -+ RTW_CANNOT_RUN(padapter)) -+ goto exit; -+ if ((pmptx->count != 0) && -+ (pmptx->count == pmptx->sended)) -+ goto exit; -+ -+ flush_signals_thread(); -+ } -+ -+exit: -+ /* RTW_INFO("%s:pkTx Exit\n", __func__); */ -+ rtw_mfree(pmptx->pallocated_buf, pmptx->buf_size); -+ pmptx->pallocated_buf = NULL; -+ pmptx->stop = 1; -+ -+ thread_exit(NULL); -+ return 0; -+} -+ -+void fill_txdesc_for_mp(PADAPTER padapter, u8 *ptxdesc) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ _rtw_memcpy(ptxdesc, pmp_priv->tx.desc, TXDESC_SIZE); -+} -+ -+#if defined(CONFIG_RTL8188E) -+void fill_tx_desc_8188e(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ struct tx_desc *desc = (struct tx_desc *)&(pmp_priv->tx.desc); -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ u32 pkt_size = pattrib->last_txcmdsz; -+ s32 bmcast = IS_MCAST(pattrib->ra); -+ /* offset 0 */ -+#if !defined(CONFIG_RTL8188E_SDIO) && !defined(CONFIG_PCI_HCI) -+ desc->txdw0 |= cpu_to_le32(OWN | FSG | LSG); -+ desc->txdw0 |= cpu_to_le32(pkt_size & 0x0000FFFF); /* packet size */ -+ desc->txdw0 |= cpu_to_le32(((TXDESC_SIZE + OFFSET_SZ) << OFFSET_SHT) & 0x00FF0000); /* 32 bytes for TX Desc */ -+ if (bmcast) -+ desc->txdw0 |= cpu_to_le32(BMC); /* broadcast packet */ -+ -+ desc->txdw1 |= cpu_to_le32((0x01 << 26) & 0xff000000); -+#endif -+ -+ desc->txdw1 |= cpu_to_le32((pattrib->mac_id) & 0x3F); /* CAM_ID(MAC_ID) */ -+ desc->txdw1 |= cpu_to_le32((pattrib->qsel << QSEL_SHT) & 0x00001F00); /* Queue Select, TID */ -+ desc->txdw1 |= cpu_to_le32((pattrib->raid << RATE_ID_SHT) & 0x000F0000); /* Rate Adaptive ID */ -+ /* offset 8 */ -+ /* desc->txdw2 |= cpu_to_le32(AGG_BK); */ /* AGG BK */ -+ -+ desc->txdw3 |= cpu_to_le32((pattrib->seqnum << 16) & 0x0fff0000); -+ desc->txdw4 |= cpu_to_le32(HW_SSN); -+ -+ desc->txdw4 |= cpu_to_le32(USERATE); -+ desc->txdw4 |= cpu_to_le32(DISDATAFB); -+ -+ if (pmp_priv->preamble) { -+ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) -+ desc->txdw4 |= cpu_to_le32(DATA_SHORT); /* CCK Short Preamble */ -+ } -+ -+ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) -+ desc->txdw4 |= cpu_to_le32(DATA_BW); -+ -+ /* offset 20 */ -+ desc->txdw5 |= cpu_to_le32(pmp_priv->rateidx & 0x0000001F); -+ -+ if (pmp_priv->preamble) { -+ if (HwRateToMPTRate(pmp_priv->rateidx) > MPT_RATE_54M) -+ desc->txdw5 |= cpu_to_le32(SGI); /* MCS Short Guard Interval */ -+ } -+ -+ desc->txdw5 |= cpu_to_le32(RTY_LMT_EN); /* retry limit enable */ -+ desc->txdw5 |= cpu_to_le32(0x00180000); /* DATA/RTS Rate Fallback Limit */ -+ -+ -+} -+#endif -+ -+#if defined(CONFIG_RTL8814A) -+void fill_tx_desc_8814a(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ u8 *pDesc = (u8 *)&(pmp_priv->tx.desc); -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ -+ u32 pkt_size = pattrib->last_txcmdsz; -+ s32 bmcast = IS_MCAST(pattrib->ra); -+ u8 data_rate, pwr_status, offset; -+ -+ /* SET_TX_DESC_FIRST_SEG_8814A(pDesc, 1); */ -+ SET_TX_DESC_LAST_SEG_8814A(pDesc, 1); -+ /* SET_TX_DESC_OWN_(pDesc, 1); */ -+ -+ SET_TX_DESC_PKT_SIZE_8814A(pDesc, pkt_size); -+ -+ offset = TXDESC_SIZE + OFFSET_SZ; -+ -+ SET_TX_DESC_OFFSET_8814A(pDesc, offset); -+#if defined(CONFIG_PCI_HCI) -+ SET_TX_DESC_PKT_OFFSET_8814A(pDesc, 0); /* 8814AE pkt_offset is 0 */ -+#else -+ SET_TX_DESC_PKT_OFFSET_8814A(pDesc, 1); -+#endif -+ -+ if (bmcast) -+ SET_TX_DESC_BMC_8814A(pDesc, 1); -+ -+ SET_TX_DESC_MACID_8814A(pDesc, pattrib->mac_id); -+ SET_TX_DESC_RATE_ID_8814A(pDesc, pattrib->raid); -+ -+ /* SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_G); */ -+ SET_TX_DESC_QUEUE_SEL_8814A(pDesc, pattrib->qsel); -+ /* SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); */ -+ -+ if (pmp_priv->preamble) -+ SET_TX_DESC_DATA_SHORT_8814A(pDesc, 1); -+ -+ if (!pattrib->qos_en) { -+ SET_TX_DESC_HWSEQ_EN_8814A(pDesc, 1); /* Hw set sequence number */ -+ } else -+ SET_TX_DESC_SEQ_8814A(pDesc, pattrib->seqnum); -+ -+ if (pmp_priv->bandwidth <= CHANNEL_WIDTH_160) -+ SET_TX_DESC_DATA_BW_8814A(pDesc, pmp_priv->bandwidth); -+ else { -+ RTW_INFO("%s:Err: unknown bandwidth %d, use 20M\n", __func__, pmp_priv->bandwidth); -+ SET_TX_DESC_DATA_BW_8814A(pDesc, CHANNEL_WIDTH_20); -+ } -+ -+ SET_TX_DESC_DISABLE_FB_8814A(pDesc, 1); -+ SET_TX_DESC_USE_RATE_8814A(pDesc, 1); -+ SET_TX_DESC_TX_RATE_8814A(pDesc, pmp_priv->rateidx); -+ -+} -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+void fill_tx_desc_8812a(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ u8 *pDesc = (u8 *)&(pmp_priv->tx.desc); -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ -+ u32 pkt_size = pattrib->last_txcmdsz; -+ s32 bmcast = IS_MCAST(pattrib->ra); -+ u8 data_rate, pwr_status, offset; -+ -+ SET_TX_DESC_FIRST_SEG_8812(pDesc, 1); -+ SET_TX_DESC_LAST_SEG_8812(pDesc, 1); -+ SET_TX_DESC_OWN_8812(pDesc, 1); -+ -+ SET_TX_DESC_PKT_SIZE_8812(pDesc, pkt_size); -+ -+ offset = TXDESC_SIZE + OFFSET_SZ; -+ -+ SET_TX_DESC_OFFSET_8812(pDesc, offset); -+ -+#if defined(CONFIG_PCI_HCI) -+ SET_TX_DESC_PKT_OFFSET_8812(pDesc, 0); -+#else -+ SET_TX_DESC_PKT_OFFSET_8812(pDesc, 1); -+#endif -+ if (bmcast) -+ SET_TX_DESC_BMC_8812(pDesc, 1); -+ -+ SET_TX_DESC_MACID_8812(pDesc, pattrib->mac_id); -+ SET_TX_DESC_RATE_ID_8812(pDesc, pattrib->raid); -+ -+ /* SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_G); */ -+ SET_TX_DESC_QUEUE_SEL_8812(pDesc, pattrib->qsel); -+ /* SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); */ -+ -+ if (!pattrib->qos_en) { -+ SET_TX_DESC_HWSEQ_EN_8812(pDesc, 1); /* Hw set sequence number */ -+ } else -+ SET_TX_DESC_SEQ_8812(pDesc, pattrib->seqnum); -+ -+ if (pmp_priv->bandwidth <= CHANNEL_WIDTH_160) -+ SET_TX_DESC_DATA_BW_8812(pDesc, pmp_priv->bandwidth); -+ else { -+ RTW_INFO("%s:Err: unknown bandwidth %d, use 20M\n", __func__, pmp_priv->bandwidth); -+ SET_TX_DESC_DATA_BW_8812(pDesc, CHANNEL_WIDTH_20); -+ } -+ -+ SET_TX_DESC_DISABLE_FB_8812(pDesc, 1); -+ SET_TX_DESC_USE_RATE_8812(pDesc, 1); -+ SET_TX_DESC_TX_RATE_8812(pDesc, pmp_priv->rateidx); -+ -+} -+#endif -+#if defined(CONFIG_RTL8192E) -+void fill_tx_desc_8192e(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ u8 *pDesc = (u8 *)&(pmp_priv->tx.desc); -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ -+ u32 pkt_size = pattrib->last_txcmdsz; -+ s32 bmcast = IS_MCAST(pattrib->ra); -+ u8 data_rate, pwr_status, offset; -+ -+ -+ SET_TX_DESC_PKT_SIZE_92E(pDesc, pkt_size); -+ -+ offset = TXDESC_SIZE + OFFSET_SZ; -+ -+ SET_TX_DESC_OFFSET_92E(pDesc, offset); -+#if defined(CONFIG_PCI_HCI) /* 8192EE */ -+ -+ SET_TX_DESC_PKT_OFFSET_92E(pDesc, 0); /* 8192EE pkt_offset is 0 */ -+#else /* 8192EU 8192ES */ -+ SET_TX_DESC_PKT_OFFSET_92E(pDesc, 1); -+#endif -+ -+ if (bmcast) -+ SET_TX_DESC_BMC_92E(pDesc, 1); -+ -+ SET_TX_DESC_MACID_92E(pDesc, pattrib->mac_id); -+ SET_TX_DESC_RATE_ID_92E(pDesc, pattrib->raid); -+ -+ -+ SET_TX_DESC_QUEUE_SEL_92E(pDesc, pattrib->qsel); -+ /* SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); */ -+ -+ if (!pattrib->qos_en) { -+ SET_TX_DESC_EN_HWSEQ_92E(pDesc, 1);/* Hw set sequence number */ -+ SET_TX_DESC_HWSEQ_SEL_92E(pDesc, pattrib->hw_ssn_sel); -+ } else -+ SET_TX_DESC_SEQ_92E(pDesc, pattrib->seqnum); -+ -+ if ((pmp_priv->bandwidth == CHANNEL_WIDTH_20) || (pmp_priv->bandwidth == CHANNEL_WIDTH_40)) -+ SET_TX_DESC_DATA_BW_92E(pDesc, pmp_priv->bandwidth); -+ else { -+ RTW_INFO("%s:Err: unknown bandwidth %d, use 20M\n", __func__, pmp_priv->bandwidth); -+ SET_TX_DESC_DATA_BW_92E(pDesc, CHANNEL_WIDTH_20); -+ } -+ -+ /* SET_TX_DESC_DATA_SC_92E(pDesc, SCMapping_92E(padapter,pattrib)); */ -+ -+ SET_TX_DESC_DISABLE_FB_92E(pDesc, 1); -+ SET_TX_DESC_USE_RATE_92E(pDesc, 1); -+ SET_TX_DESC_TX_RATE_92E(pDesc, pmp_priv->rateidx); -+ -+} -+#endif -+ -+#if defined(CONFIG_RTL8723B) -+void fill_tx_desc_8723b(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ u8 *ptxdesc = pmp_priv->tx.desc; -+ -+ SET_TX_DESC_AGG_BREAK_8723B(ptxdesc, 1); -+ SET_TX_DESC_MACID_8723B(ptxdesc, pattrib->mac_id); -+ SET_TX_DESC_QUEUE_SEL_8723B(ptxdesc, pattrib->qsel); -+ -+ SET_TX_DESC_RATE_ID_8723B(ptxdesc, pattrib->raid); -+ SET_TX_DESC_SEQ_8723B(ptxdesc, pattrib->seqnum); -+ SET_TX_DESC_HWSEQ_EN_8723B(ptxdesc, 1); -+ SET_TX_DESC_USE_RATE_8723B(ptxdesc, 1); -+ SET_TX_DESC_DISABLE_FB_8723B(ptxdesc, 1); -+ -+ if (pmp_priv->preamble) { -+ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) -+ SET_TX_DESC_DATA_SHORT_8723B(ptxdesc, 1); -+ } -+ -+ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) -+ SET_TX_DESC_DATA_BW_8723B(ptxdesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8723B(ptxdesc, pmp_priv->rateidx); -+ -+ SET_TX_DESC_DATA_RATE_FB_LIMIT_8723B(ptxdesc, 0x1F); -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8723B(ptxdesc, 0xF); -+} -+#endif -+ -+#if defined(CONFIG_RTL8703B) -+void fill_tx_desc_8703b(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ u8 *ptxdesc = pmp_priv->tx.desc; -+ -+ SET_TX_DESC_AGG_BREAK_8703B(ptxdesc, 1); -+ SET_TX_DESC_MACID_8703B(ptxdesc, pattrib->mac_id); -+ SET_TX_DESC_QUEUE_SEL_8703B(ptxdesc, pattrib->qsel); -+ -+ SET_TX_DESC_RATE_ID_8703B(ptxdesc, pattrib->raid); -+ SET_TX_DESC_SEQ_8703B(ptxdesc, pattrib->seqnum); -+ SET_TX_DESC_HWSEQ_EN_8703B(ptxdesc, 1); -+ SET_TX_DESC_USE_RATE_8703B(ptxdesc, 1); -+ SET_TX_DESC_DISABLE_FB_8703B(ptxdesc, 1); -+ -+ if (pmp_priv->preamble) { -+ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) -+ SET_TX_DESC_DATA_SHORT_8703B(ptxdesc, 1); -+ } -+ -+ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) -+ SET_TX_DESC_DATA_BW_8703B(ptxdesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8703B(ptxdesc, pmp_priv->rateidx); -+ -+ SET_TX_DESC_DATA_RATE_FB_LIMIT_8703B(ptxdesc, 0x1F); -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8703B(ptxdesc, 0xF); -+} -+#endif -+ -+#if defined(CONFIG_RTL8188F) -+void fill_tx_desc_8188f(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ u8 *ptxdesc = pmp_priv->tx.desc; -+ -+ SET_TX_DESC_AGG_BREAK_8188F(ptxdesc, 1); -+ SET_TX_DESC_MACID_8188F(ptxdesc, pattrib->mac_id); -+ SET_TX_DESC_QUEUE_SEL_8188F(ptxdesc, pattrib->qsel); -+ -+ SET_TX_DESC_RATE_ID_8188F(ptxdesc, pattrib->raid); -+ SET_TX_DESC_SEQ_8188F(ptxdesc, pattrib->seqnum); -+ SET_TX_DESC_HWSEQ_EN_8188F(ptxdesc, 1); -+ SET_TX_DESC_USE_RATE_8188F(ptxdesc, 1); -+ SET_TX_DESC_DISABLE_FB_8188F(ptxdesc, 1); -+ -+ if (pmp_priv->preamble) -+ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) -+ SET_TX_DESC_DATA_SHORT_8188F(ptxdesc, 1); -+ -+ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) -+ SET_TX_DESC_DATA_BW_8188F(ptxdesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8188F(ptxdesc, pmp_priv->rateidx); -+ -+ SET_TX_DESC_DATA_RATE_FB_LIMIT_8188F(ptxdesc, 0x1F); -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8188F(ptxdesc, 0xF); -+} -+#endif -+ -+#if defined(CONFIG_RTL8723D) -+void fill_tx_desc_8723d(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ u8 *ptxdesc = pmp_priv->tx.desc; -+ -+ SET_TX_DESC_BK_8723D(ptxdesc, 1); -+ SET_TX_DESC_MACID_8723D(ptxdesc, pattrib->mac_id); -+ SET_TX_DESC_QUEUE_SEL_8723D(ptxdesc, pattrib->qsel); -+ -+ SET_TX_DESC_RATE_ID_8723D(ptxdesc, pattrib->raid); -+ SET_TX_DESC_SEQ_8723D(ptxdesc, pattrib->seqnum); -+ SET_TX_DESC_HWSEQ_EN_8723D(ptxdesc, 1); -+ SET_TX_DESC_USE_RATE_8723D(ptxdesc, 1); -+ SET_TX_DESC_DISABLE_FB_8723D(ptxdesc, 1); -+ -+ if (pmp_priv->preamble) { -+ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) -+ SET_TX_DESC_DATA_SHORT_8723D(ptxdesc, 1); -+ } -+ -+ if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) -+ SET_TX_DESC_DATA_BW_8723D(ptxdesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8723D(ptxdesc, pmp_priv->rateidx); -+ -+ SET_TX_DESC_DATA_RATE_FB_LIMIT_8723D(ptxdesc, 0x1F); -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8723D(ptxdesc, 0xF); -+} -+#endif -+ -+static void Rtw_MPSetMacTxEDCA(PADAPTER padapter) -+{ -+ -+ rtw_write32(padapter, 0x508 , 0x00a422); /* Disable EDCA BE Txop for MP pkt tx adjust Packet interval */ -+ /* RTW_INFO("%s:write 0x508~~~~~~ 0x%x\n", __func__,rtw_read32(padapter, 0x508)); */ -+ PHY_SetMacReg(padapter, 0x458 , bMaskDWord , 0x0); -+ /* RTW_INFO("%s()!!!!! 0x460 = 0x%x\n" ,__func__,PHY_QueryBBReg(padapter, 0x460, bMaskDWord)); */ -+ PHY_SetMacReg(padapter, 0x460 , bMaskLWord , 0x0); /* fast EDCA queue packet interval & time out vaule */ -+ /* PHY_SetMacReg(padapter, ODM_EDCA_VO_PARAM ,bMaskLWord , 0x431C); */ -+ /* PHY_SetMacReg(padapter, ODM_EDCA_BE_PARAM ,bMaskLWord , 0x431C); */ -+ /* PHY_SetMacReg(padapter, ODM_EDCA_BK_PARAM ,bMaskLWord , 0x431C); */ -+ RTW_INFO("%s()!!!!! 0x460 = 0x%x\n" , __func__, PHY_QueryBBReg(padapter, 0x460, bMaskDWord)); -+ -+} -+ -+void SetPacketTx(PADAPTER padapter) -+{ -+ u8 *ptr, *pkt_start, *pkt_end, *fctrl; -+ u32 pkt_size, offset, startPlace, i; -+ struct rtw_ieee80211_hdr *hdr; -+ u8 payload; -+ s32 bmcast; -+ struct pkt_attrib *pattrib; -+ struct mp_priv *pmp_priv; -+ -+ pmp_priv = &padapter->mppriv; -+ -+ if (pmp_priv->tx.stop) -+ return; -+ pmp_priv->tx.sended = 0; -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx_pktcount = 0; -+ -+ /* 3 1. update_attrib() */ -+ pattrib = &pmp_priv->tx.attrib; -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ bmcast = IS_MCAST(pattrib->ra); -+ if (bmcast) { -+ pattrib->mac_id = 1; -+ pattrib->psta = rtw_get_bcmc_stainfo(padapter); -+ } else { -+ pattrib->mac_id = 0; -+ pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); -+ } -+ pattrib->mbssid = 0; -+ -+ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->pktlen; -+ -+ /* 3 2. allocate xmit buffer */ -+ pkt_size = pattrib->last_txcmdsz; -+ -+ if (pmp_priv->tx.pallocated_buf) -+ rtw_mfree(pmp_priv->tx.pallocated_buf, pmp_priv->tx.buf_size); -+ pmp_priv->tx.write_size = pkt_size; -+ pmp_priv->tx.buf_size = pkt_size + XMITBUF_ALIGN_SZ; -+ pmp_priv->tx.pallocated_buf = rtw_zmalloc(pmp_priv->tx.buf_size); -+ if (pmp_priv->tx.pallocated_buf == NULL) { -+ RTW_INFO("%s: malloc(%d) fail!!\n", __func__, pmp_priv->tx.buf_size); -+ return; -+ } -+ pmp_priv->tx.buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pmp_priv->tx.pallocated_buf), XMITBUF_ALIGN_SZ); -+ ptr = pmp_priv->tx.buf; -+ -+ _rtw_memset(pmp_priv->tx.desc, 0, TXDESC_SIZE); -+ pkt_start = ptr; -+ pkt_end = pkt_start + pkt_size; -+ -+ /* 3 3. init TX descriptor */ -+#if defined(CONFIG_RTL8188E) -+ if (IS_HARDWARE_TYPE_8188E(padapter)) -+ fill_tx_desc_8188e(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8814A) -+ if (IS_HARDWARE_TYPE_8814A(padapter)) -+ fill_tx_desc_8814a(padapter); -+#endif /* defined(CONFIG_RTL8814A) */ -+ -+#if defined(CONFIG_RTL8822B) -+ if (IS_HARDWARE_TYPE_8822B(padapter)) -+ rtl8822b_prepare_mp_txdesc(padapter, pmp_priv); -+#endif /* CONFIG_RTL8822B */ -+ -+#if defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_8821C(padapter)) -+ rtl8821c_prepare_mp_txdesc(padapter, pmp_priv); -+#endif /* CONFIG_RTL8821C */ -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ if (IS_HARDWARE_TYPE_8812(padapter) || IS_HARDWARE_TYPE_8821(padapter)) -+ fill_tx_desc_8812a(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8192E) -+ if (IS_HARDWARE_TYPE_8192E(padapter)) -+ fill_tx_desc_8192e(padapter); -+#endif -+#if defined(CONFIG_RTL8723B) -+ if (IS_HARDWARE_TYPE_8723B(padapter)) -+ fill_tx_desc_8723b(padapter); -+#endif -+#if defined(CONFIG_RTL8703B) -+ if (IS_HARDWARE_TYPE_8703B(padapter)) -+ fill_tx_desc_8703b(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8188F) -+ if (IS_HARDWARE_TYPE_8188F(padapter)) -+ fill_tx_desc_8188f(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8723D) -+ if (IS_HARDWARE_TYPE_8723D(padapter)) -+ fill_tx_desc_8723d(padapter); -+#endif -+ -+ /* 3 4. make wlan header, make_wlanhdr() */ -+ hdr = (struct rtw_ieee80211_hdr *)pkt_start; -+ SetFrameSubType(&hdr->frame_ctl, pattrib->subtype); -+ -+ _rtw_memcpy(hdr->addr1, pattrib->dst, ETH_ALEN); /* DA */ -+ _rtw_memcpy(hdr->addr2, pattrib->src, ETH_ALEN); /* SA */ -+ _rtw_memcpy(hdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); /* RA, BSSID */ -+ -+ /* 3 5. make payload */ -+ ptr = pkt_start + pattrib->hdrlen; -+ -+ switch (pmp_priv->tx.payload) { -+ case 0: -+ payload = 0x00; -+ break; -+ case 1: -+ payload = 0x5a; -+ break; -+ case 2: -+ payload = 0xa5; -+ break; -+ case 3: -+ payload = 0xff; -+ break; -+ default: -+ payload = 0x00; -+ break; -+ } -+ pmp_priv->TXradomBuffer = rtw_zmalloc(4096); -+ if (pmp_priv->TXradomBuffer == NULL) { -+ RTW_INFO("mp create random buffer fail!\n"); -+ goto exit; -+ } -+ -+ -+ for (i = 0; i < 4096; i++) -+ pmp_priv->TXradomBuffer[i] = rtw_random32() % 0xFF; -+ -+ /* startPlace = (u32)(rtw_random32() % 3450); */ -+ _rtw_memcpy(ptr, pmp_priv->TXradomBuffer, pkt_end - ptr); -+ /* _rtw_memset(ptr, payload, pkt_end - ptr); */ -+ rtw_mfree(pmp_priv->TXradomBuffer, 4096); -+ -+ /* 3 6. start thread */ -+#ifdef PLATFORM_LINUX -+ pmp_priv->tx.PktTxThread = kthread_run(mp_xmit_packet_thread, pmp_priv, "RTW_MP_THREAD"); -+ if (IS_ERR(pmp_priv->tx.PktTxThread)) -+ RTW_INFO("Create PktTx Thread Fail !!!!!\n"); -+#endif -+#ifdef PLATFORM_FREEBSD -+ { -+ struct proc *p; -+ struct thread *td; -+ pmp_priv->tx.PktTxThread = kproc_kthread_add(mp_xmit_packet_thread, pmp_priv, -+ &p, &td, RFHIGHPID, 0, "MPXmitThread", "MPXmitThread"); -+ -+ if (pmp_priv->tx.PktTxThread < 0) -+ RTW_INFO("Create PktTx Thread Fail !!!!!\n"); -+ } -+#endif -+ -+ Rtw_MPSetMacTxEDCA(padapter); -+exit: -+ return; -+} -+ -+void SetPacketRx(PADAPTER pAdapter, u8 bStartRx, u8 bAB) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ struct mp_priv *pmppriv = &pAdapter->mppriv; -+ -+ -+ if (bStartRx) { -+#ifdef CONFIG_RTL8723B -+ PHY_SetMacReg(pAdapter, 0xe70, BIT23 | BIT22, 0x3); /* Power on adc (in RX_WAIT_CCA state) */ -+ write_bbreg(pAdapter, 0xa01, BIT0, bDisable);/* improve Rx performance by jerry */ -+#endif -+ pHalData->ReceiveConfig = RCR_AAP | RCR_APM | RCR_AM | RCR_AMF | RCR_HTC_LOC_CTRL; -+ pHalData->ReceiveConfig |= RCR_ACRC32; -+ pHalData->ReceiveConfig |= RCR_APP_PHYST_RXFF | RCR_APP_ICV | RCR_APP_MIC; -+ -+ if (pmppriv->bSetRxBssid == _TRUE) { -+ RTW_INFO("%s: pmppriv->network_macaddr=" MAC_FMT "\n", __func__, -+ MAC_ARG(pmppriv->network_macaddr)); -+ pHalData->ReceiveConfig = 0; -+ pHalData->ReceiveConfig |= RCR_CBSSID_DATA | RCR_CBSSID_BCN |RCR_APM | RCR_AM | RCR_AB |RCR_AMF; -+ -+#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ write_bbreg(pAdapter, 0x550, BIT3, bEnable); -+#endif -+ rtw_write16(pAdapter, REG_RXFLTMAP0, 0xFFEF); /* REG_RXFLTMAP0 (RX Filter Map Group 0) */ -+ -+ } else { -+ pHalData->ReceiveConfig |= RCR_ADF; -+ /* Accept all data frames */ -+ rtw_write16(pAdapter, REG_RXFLTMAP2, 0xFFFF); -+ } -+ -+ if (bAB) -+ pHalData->ReceiveConfig |= RCR_AB; -+ } else { -+#ifdef CONFIG_RTL8723B -+ PHY_SetMacReg(pAdapter, 0xe70, BIT23 | BIT22, 0x00); /* Power off adc (in RX_WAIT_CCA state) */ -+ write_bbreg(pAdapter, 0xa01, BIT0, bEnable);/* improve Rx performance by jerry */ -+#endif -+ pHalData->ReceiveConfig = 0; -+ rtw_write16(pAdapter, REG_RXFLTMAP0, 0xFFFF); /* REG_RXFLTMAP0 (RX Filter Map Group 0) */ -+ } -+ -+ rtw_write32(pAdapter, REG_RCR, pHalData->ReceiveConfig); -+} -+ -+void ResetPhyRxPktCount(PADAPTER pAdapter) -+{ -+ u32 i, phyrx_set = 0; -+ -+ for (i = 0; i <= 0xF; i++) { -+ phyrx_set = 0; -+ phyrx_set |= _RXERR_RPT_SEL(i); /* select */ -+ phyrx_set |= RXERR_RPT_RST; /* set counter to zero */ -+ rtw_write32(pAdapter, REG_RXERR_RPT, phyrx_set); -+ } -+} -+ -+static u32 GetPhyRxPktCounts(PADAPTER pAdapter, u32 selbit) -+{ -+ /* selection */ -+ u32 phyrx_set = 0, count = 0; -+ -+ phyrx_set = _RXERR_RPT_SEL(selbit & 0xF); -+ rtw_write32(pAdapter, REG_RXERR_RPT, phyrx_set); -+ -+ /* Read packet count */ -+ count = rtw_read32(pAdapter, REG_RXERR_RPT) & RXERR_COUNTER_MASK; -+ -+ return count; -+} -+ -+u32 GetPhyRxPktReceived(PADAPTER pAdapter) -+{ -+ u32 OFDM_cnt = 0, CCK_cnt = 0, HT_cnt = 0; -+ -+ OFDM_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_OFDM_MPDU_OK); -+ CCK_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_CCK_MPDU_OK); -+ HT_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_HT_MPDU_OK); -+ -+ return OFDM_cnt + CCK_cnt + HT_cnt; -+} -+ -+u32 GetPhyRxPktCRC32Error(PADAPTER pAdapter) -+{ -+ u32 OFDM_cnt = 0, CCK_cnt = 0, HT_cnt = 0; -+ -+ OFDM_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_OFDM_MPDU_FAIL); -+ CCK_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_CCK_MPDU_FAIL); -+ HT_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_HT_MPDU_FAIL); -+ -+ return OFDM_cnt + CCK_cnt + HT_cnt; -+} -+ -+/* reg 0x808[9:0]: FFT data x -+ * reg 0x808[22]: 0 --> 1 to get 1 FFT data y -+ * reg 0x8B4[15:0]: FFT data y report */ -+static u32 rtw_GetPSDData(PADAPTER pAdapter, u32 point) -+{ -+ u32 psd_val = 0; -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ u16 psd_reg = 0x910; -+ u16 psd_regL = 0xF44; -+#else -+ u16 psd_reg = 0x808; -+ u16 psd_regL = 0x8B4; -+#endif -+ -+ psd_val = rtw_read32(pAdapter, psd_reg); -+ -+ psd_val &= 0xFFBFFC00; -+ psd_val |= point; -+ -+ rtw_write32(pAdapter, psd_reg, psd_val); -+ rtw_mdelay_os(1); -+ psd_val |= 0x00400000; -+ -+ rtw_write32(pAdapter, psd_reg, psd_val); -+ rtw_mdelay_os(1); -+ -+ psd_val = rtw_read32(pAdapter, psd_regL); -+ psd_val &= 0x0000FFFF; -+ -+ return psd_val; -+} -+ -+/* -+ * pts start_point_min stop_point_max -+ * 128 64 64 + 128 = 192 -+ * 256 128 128 + 256 = 384 -+ * 512 256 256 + 512 = 768 -+ * 1024 512 512 + 1024 = 1536 -+ * -+ */ -+u32 mp_query_psd(PADAPTER pAdapter, u8 *data) -+{ -+ u32 i, psd_pts = 0, psd_start = 0, psd_stop = 0; -+ u32 psd_data = 0; -+ -+ -+#ifdef PLATFORM_LINUX -+ if (!netif_running(pAdapter->pnetdev)) { -+ return 0; -+ } -+#endif -+ -+ if (check_fwstate(&pAdapter->mlmepriv, WIFI_MP_STATE) == _FALSE) { -+ return 0; -+ } -+ -+ if (strlen(data) == 0) { /* default value */ -+ psd_pts = 128; -+ psd_start = 64; -+ psd_stop = 128; -+ } else -+ sscanf(data, "pts=%d,start=%d,stop=%d", &psd_pts, &psd_start, &psd_stop); -+ -+ data[0] = '\0'; -+ -+ i = psd_start; -+ while (i < psd_stop) { -+ if (i >= psd_pts) -+ psd_data = rtw_GetPSDData(pAdapter, i - psd_pts); -+ else -+ psd_data = rtw_GetPSDData(pAdapter, i); -+ sprintf(data, "%s%x ", data, psd_data); -+ i++; -+ } -+ -+#ifdef CONFIG_LONG_DELAY_ISSUE -+ rtw_msleep_os(100); -+#else -+ rtw_mdelay_os(100); -+#endif -+ -+ return strlen(data) + 1; -+} -+ -+ -+#if 0 -+void _rtw_mp_xmit_priv(struct xmit_priv *pxmitpriv) -+{ -+ int i, res; -+ _adapter *padapter = pxmitpriv->adapter; -+ struct xmit_frame *pxmitframe = (struct xmit_frame *) pxmitpriv->pxmit_frame_buf; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf; -+ -+ u32 max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; -+ u32 num_xmit_extbuf = NR_XMIT_EXTBUFF; -+ if (padapter->registrypriv.mp_mode == 0) { -+ max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; -+ num_xmit_extbuf = NR_XMIT_EXTBUFF; -+ } else { -+ max_xmit_extbuf_size = 6000; -+ num_xmit_extbuf = 8; -+ } -+ -+ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; -+ for (i = 0; i < num_xmit_extbuf; i++) { -+ rtw_os_xmit_resource_free(padapter, pxmitbuf, (max_xmit_extbuf_size + XMITBUF_ALIGN_SZ), _FALSE); -+ -+ pxmitbuf++; -+ } -+ -+ if (pxmitpriv->pallocated_xmit_extbuf) -+ rtw_vmfree(pxmitpriv->pallocated_xmit_extbuf, num_xmit_extbuf * sizeof(struct xmit_buf) + 4); -+ -+ if (padapter->registrypriv.mp_mode == 0) { -+ max_xmit_extbuf_size = 6000; -+ num_xmit_extbuf = 8; -+ } else { -+ max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; -+ num_xmit_extbuf = NR_XMIT_EXTBUFF; -+ } -+ -+ /* Init xmit extension buff */ -+ _rtw_init_queue(&pxmitpriv->free_xmit_extbuf_queue); -+ -+ pxmitpriv->pallocated_xmit_extbuf = rtw_zvmalloc(num_xmit_extbuf * sizeof(struct xmit_buf) + 4); -+ -+ if (pxmitpriv->pallocated_xmit_extbuf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pxmitpriv->pxmit_extbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_xmit_extbuf), 4); -+ -+ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; -+ -+ for (i = 0; i < num_xmit_extbuf; i++) { -+ _rtw_init_listhead(&pxmitbuf->list); -+ -+ pxmitbuf->priv_data = NULL; -+ pxmitbuf->padapter = padapter; -+ pxmitbuf->buf_tag = XMITBUF_MGNT; -+ -+ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, max_xmit_extbuf_size + XMITBUF_ALIGN_SZ, _TRUE); -+ if (res == _FAIL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->phead = pxmitbuf->pbuf; -+ pxmitbuf->pend = pxmitbuf->pbuf + max_xmit_extbuf_size; -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+#endif -+ -+ rtw_list_insert_tail(&pxmitbuf->list, &(pxmitpriv->free_xmit_extbuf_queue.queue)); -+#ifdef DBG_XMIT_BUF_EXT -+ pxmitbuf->no = i; -+#endif -+ pxmitbuf++; -+ -+ } -+ -+ pxmitpriv->free_xmit_extbuf_cnt = num_xmit_extbuf; -+ -+exit: -+ ; -+} -+#endif -+ -+u8 -+MptToMgntRate( -+ IN ULONG MptRateIdx -+) -+{ -+ /* Mapped to MGN_XXX defined in MgntGen.h */ -+ switch (MptRateIdx) { -+ /* CCK rate. */ -+ case MPT_RATE_1M: -+ return MGN_1M; -+ case MPT_RATE_2M: -+ return MGN_2M; -+ case MPT_RATE_55M: -+ return MGN_5_5M; -+ case MPT_RATE_11M: -+ return MGN_11M; -+ -+ /* OFDM rate. */ -+ case MPT_RATE_6M: -+ return MGN_6M; -+ case MPT_RATE_9M: -+ return MGN_9M; -+ case MPT_RATE_12M: -+ return MGN_12M; -+ case MPT_RATE_18M: -+ return MGN_18M; -+ case MPT_RATE_24M: -+ return MGN_24M; -+ case MPT_RATE_36M: -+ return MGN_36M; -+ case MPT_RATE_48M: -+ return MGN_48M; -+ case MPT_RATE_54M: -+ return MGN_54M; -+ -+ /* HT rate. */ -+ case MPT_RATE_MCS0: -+ return MGN_MCS0; -+ case MPT_RATE_MCS1: -+ return MGN_MCS1; -+ case MPT_RATE_MCS2: -+ return MGN_MCS2; -+ case MPT_RATE_MCS3: -+ return MGN_MCS3; -+ case MPT_RATE_MCS4: -+ return MGN_MCS4; -+ case MPT_RATE_MCS5: -+ return MGN_MCS5; -+ case MPT_RATE_MCS6: -+ return MGN_MCS6; -+ case MPT_RATE_MCS7: -+ return MGN_MCS7; -+ case MPT_RATE_MCS8: -+ return MGN_MCS8; -+ case MPT_RATE_MCS9: -+ return MGN_MCS9; -+ case MPT_RATE_MCS10: -+ return MGN_MCS10; -+ case MPT_RATE_MCS11: -+ return MGN_MCS11; -+ case MPT_RATE_MCS12: -+ return MGN_MCS12; -+ case MPT_RATE_MCS13: -+ return MGN_MCS13; -+ case MPT_RATE_MCS14: -+ return MGN_MCS14; -+ case MPT_RATE_MCS15: -+ return MGN_MCS15; -+ case MPT_RATE_MCS16: -+ return MGN_MCS16; -+ case MPT_RATE_MCS17: -+ return MGN_MCS17; -+ case MPT_RATE_MCS18: -+ return MGN_MCS18; -+ case MPT_RATE_MCS19: -+ return MGN_MCS19; -+ case MPT_RATE_MCS20: -+ return MGN_MCS20; -+ case MPT_RATE_MCS21: -+ return MGN_MCS21; -+ case MPT_RATE_MCS22: -+ return MGN_MCS22; -+ case MPT_RATE_MCS23: -+ return MGN_MCS23; -+ case MPT_RATE_MCS24: -+ return MGN_MCS24; -+ case MPT_RATE_MCS25: -+ return MGN_MCS25; -+ case MPT_RATE_MCS26: -+ return MGN_MCS26; -+ case MPT_RATE_MCS27: -+ return MGN_MCS27; -+ case MPT_RATE_MCS28: -+ return MGN_MCS28; -+ case MPT_RATE_MCS29: -+ return MGN_MCS29; -+ case MPT_RATE_MCS30: -+ return MGN_MCS30; -+ case MPT_RATE_MCS31: -+ return MGN_MCS31; -+ -+ /* VHT rate. */ -+ case MPT_RATE_VHT1SS_MCS0: -+ return MGN_VHT1SS_MCS0; -+ case MPT_RATE_VHT1SS_MCS1: -+ return MGN_VHT1SS_MCS1; -+ case MPT_RATE_VHT1SS_MCS2: -+ return MGN_VHT1SS_MCS2; -+ case MPT_RATE_VHT1SS_MCS3: -+ return MGN_VHT1SS_MCS3; -+ case MPT_RATE_VHT1SS_MCS4: -+ return MGN_VHT1SS_MCS4; -+ case MPT_RATE_VHT1SS_MCS5: -+ return MGN_VHT1SS_MCS5; -+ case MPT_RATE_VHT1SS_MCS6: -+ return MGN_VHT1SS_MCS6; -+ case MPT_RATE_VHT1SS_MCS7: -+ return MGN_VHT1SS_MCS7; -+ case MPT_RATE_VHT1SS_MCS8: -+ return MGN_VHT1SS_MCS8; -+ case MPT_RATE_VHT1SS_MCS9: -+ return MGN_VHT1SS_MCS9; -+ case MPT_RATE_VHT2SS_MCS0: -+ return MGN_VHT2SS_MCS0; -+ case MPT_RATE_VHT2SS_MCS1: -+ return MGN_VHT2SS_MCS1; -+ case MPT_RATE_VHT2SS_MCS2: -+ return MGN_VHT2SS_MCS2; -+ case MPT_RATE_VHT2SS_MCS3: -+ return MGN_VHT2SS_MCS3; -+ case MPT_RATE_VHT2SS_MCS4: -+ return MGN_VHT2SS_MCS4; -+ case MPT_RATE_VHT2SS_MCS5: -+ return MGN_VHT2SS_MCS5; -+ case MPT_RATE_VHT2SS_MCS6: -+ return MGN_VHT2SS_MCS6; -+ case MPT_RATE_VHT2SS_MCS7: -+ return MGN_VHT2SS_MCS7; -+ case MPT_RATE_VHT2SS_MCS8: -+ return MGN_VHT2SS_MCS8; -+ case MPT_RATE_VHT2SS_MCS9: -+ return MGN_VHT2SS_MCS9; -+ case MPT_RATE_VHT3SS_MCS0: -+ return MGN_VHT3SS_MCS0; -+ case MPT_RATE_VHT3SS_MCS1: -+ return MGN_VHT3SS_MCS1; -+ case MPT_RATE_VHT3SS_MCS2: -+ return MGN_VHT3SS_MCS2; -+ case MPT_RATE_VHT3SS_MCS3: -+ return MGN_VHT3SS_MCS3; -+ case MPT_RATE_VHT3SS_MCS4: -+ return MGN_VHT3SS_MCS4; -+ case MPT_RATE_VHT3SS_MCS5: -+ return MGN_VHT3SS_MCS5; -+ case MPT_RATE_VHT3SS_MCS6: -+ return MGN_VHT3SS_MCS6; -+ case MPT_RATE_VHT3SS_MCS7: -+ return MGN_VHT3SS_MCS7; -+ case MPT_RATE_VHT3SS_MCS8: -+ return MGN_VHT3SS_MCS8; -+ case MPT_RATE_VHT3SS_MCS9: -+ return MGN_VHT3SS_MCS9; -+ case MPT_RATE_VHT4SS_MCS0: -+ return MGN_VHT4SS_MCS0; -+ case MPT_RATE_VHT4SS_MCS1: -+ return MGN_VHT4SS_MCS1; -+ case MPT_RATE_VHT4SS_MCS2: -+ return MGN_VHT4SS_MCS2; -+ case MPT_RATE_VHT4SS_MCS3: -+ return MGN_VHT4SS_MCS3; -+ case MPT_RATE_VHT4SS_MCS4: -+ return MGN_VHT4SS_MCS4; -+ case MPT_RATE_VHT4SS_MCS5: -+ return MGN_VHT4SS_MCS5; -+ case MPT_RATE_VHT4SS_MCS6: -+ return MGN_VHT4SS_MCS6; -+ case MPT_RATE_VHT4SS_MCS7: -+ return MGN_VHT4SS_MCS7; -+ case MPT_RATE_VHT4SS_MCS8: -+ return MGN_VHT4SS_MCS8; -+ case MPT_RATE_VHT4SS_MCS9: -+ return MGN_VHT4SS_MCS9; -+ -+ case MPT_RATE_LAST: /* fully automatiMGN_VHT2SS_MCS1; */ -+ default: -+ RTW_INFO("<===MptToMgntRate(), Invalid Rate: %d!!\n", MptRateIdx); -+ return 0x0; -+ } -+} -+ -+ -+u8 HwRateToMPTRate(u8 rate) -+{ -+ u8 ret_rate = MGN_1M; -+ -+ switch (rate) { -+ case DESC_RATE1M: -+ ret_rate = MPT_RATE_1M; -+ break; -+ case DESC_RATE2M: -+ ret_rate = MPT_RATE_2M; -+ break; -+ case DESC_RATE5_5M: -+ ret_rate = MPT_RATE_55M; -+ break; -+ case DESC_RATE11M: -+ ret_rate = MPT_RATE_11M; -+ break; -+ case DESC_RATE6M: -+ ret_rate = MPT_RATE_6M; -+ break; -+ case DESC_RATE9M: -+ ret_rate = MPT_RATE_9M; -+ break; -+ case DESC_RATE12M: -+ ret_rate = MPT_RATE_12M; -+ break; -+ case DESC_RATE18M: -+ ret_rate = MPT_RATE_18M; -+ break; -+ case DESC_RATE24M: -+ ret_rate = MPT_RATE_24M; -+ break; -+ case DESC_RATE36M: -+ ret_rate = MPT_RATE_36M; -+ break; -+ case DESC_RATE48M: -+ ret_rate = MPT_RATE_48M; -+ break; -+ case DESC_RATE54M: -+ ret_rate = MPT_RATE_54M; -+ break; -+ case DESC_RATEMCS0: -+ ret_rate = MPT_RATE_MCS0; -+ break; -+ case DESC_RATEMCS1: -+ ret_rate = MPT_RATE_MCS1; -+ break; -+ case DESC_RATEMCS2: -+ ret_rate = MPT_RATE_MCS2; -+ break; -+ case DESC_RATEMCS3: -+ ret_rate = MPT_RATE_MCS3; -+ break; -+ case DESC_RATEMCS4: -+ ret_rate = MPT_RATE_MCS4; -+ break; -+ case DESC_RATEMCS5: -+ ret_rate = MPT_RATE_MCS5; -+ break; -+ case DESC_RATEMCS6: -+ ret_rate = MPT_RATE_MCS6; -+ break; -+ case DESC_RATEMCS7: -+ ret_rate = MPT_RATE_MCS7; -+ break; -+ case DESC_RATEMCS8: -+ ret_rate = MPT_RATE_MCS8; -+ break; -+ case DESC_RATEMCS9: -+ ret_rate = MPT_RATE_MCS9; -+ break; -+ case DESC_RATEMCS10: -+ ret_rate = MPT_RATE_MCS10; -+ break; -+ case DESC_RATEMCS11: -+ ret_rate = MPT_RATE_MCS11; -+ break; -+ case DESC_RATEMCS12: -+ ret_rate = MPT_RATE_MCS12; -+ break; -+ case DESC_RATEMCS13: -+ ret_rate = MPT_RATE_MCS13; -+ break; -+ case DESC_RATEMCS14: -+ ret_rate = MPT_RATE_MCS14; -+ break; -+ case DESC_RATEMCS15: -+ ret_rate = MPT_RATE_MCS15; -+ break; -+ case DESC_RATEMCS16: -+ ret_rate = MPT_RATE_MCS16; -+ break; -+ case DESC_RATEMCS17: -+ ret_rate = MPT_RATE_MCS17; -+ break; -+ case DESC_RATEMCS18: -+ ret_rate = MPT_RATE_MCS18; -+ break; -+ case DESC_RATEMCS19: -+ ret_rate = MPT_RATE_MCS19; -+ break; -+ case DESC_RATEMCS20: -+ ret_rate = MPT_RATE_MCS20; -+ break; -+ case DESC_RATEMCS21: -+ ret_rate = MPT_RATE_MCS21; -+ break; -+ case DESC_RATEMCS22: -+ ret_rate = MPT_RATE_MCS22; -+ break; -+ case DESC_RATEMCS23: -+ ret_rate = MPT_RATE_MCS23; -+ break; -+ case DESC_RATEMCS24: -+ ret_rate = MPT_RATE_MCS24; -+ break; -+ case DESC_RATEMCS25: -+ ret_rate = MPT_RATE_MCS25; -+ break; -+ case DESC_RATEMCS26: -+ ret_rate = MPT_RATE_MCS26; -+ break; -+ case DESC_RATEMCS27: -+ ret_rate = MPT_RATE_MCS27; -+ break; -+ case DESC_RATEMCS28: -+ ret_rate = MPT_RATE_MCS28; -+ break; -+ case DESC_RATEMCS29: -+ ret_rate = MPT_RATE_MCS29; -+ break; -+ case DESC_RATEMCS30: -+ ret_rate = MPT_RATE_MCS30; -+ break; -+ case DESC_RATEMCS31: -+ ret_rate = MPT_RATE_MCS31; -+ break; -+ case DESC_RATEVHTSS1MCS0: -+ ret_rate = MPT_RATE_VHT1SS_MCS0; -+ break; -+ case DESC_RATEVHTSS1MCS1: -+ ret_rate = MPT_RATE_VHT1SS_MCS1; -+ break; -+ case DESC_RATEVHTSS1MCS2: -+ ret_rate = MPT_RATE_VHT1SS_MCS2; -+ break; -+ case DESC_RATEVHTSS1MCS3: -+ ret_rate = MPT_RATE_VHT1SS_MCS3; -+ break; -+ case DESC_RATEVHTSS1MCS4: -+ ret_rate = MPT_RATE_VHT1SS_MCS4; -+ break; -+ case DESC_RATEVHTSS1MCS5: -+ ret_rate = MPT_RATE_VHT1SS_MCS5; -+ break; -+ case DESC_RATEVHTSS1MCS6: -+ ret_rate = MPT_RATE_VHT1SS_MCS6; -+ break; -+ case DESC_RATEVHTSS1MCS7: -+ ret_rate = MPT_RATE_VHT1SS_MCS7; -+ break; -+ case DESC_RATEVHTSS1MCS8: -+ ret_rate = MPT_RATE_VHT1SS_MCS8; -+ break; -+ case DESC_RATEVHTSS1MCS9: -+ ret_rate = MPT_RATE_VHT1SS_MCS9; -+ break; -+ case DESC_RATEVHTSS2MCS0: -+ ret_rate = MPT_RATE_VHT2SS_MCS0; -+ break; -+ case DESC_RATEVHTSS2MCS1: -+ ret_rate = MPT_RATE_VHT2SS_MCS1; -+ break; -+ case DESC_RATEVHTSS2MCS2: -+ ret_rate = MPT_RATE_VHT2SS_MCS2; -+ break; -+ case DESC_RATEVHTSS2MCS3: -+ ret_rate = MPT_RATE_VHT2SS_MCS3; -+ break; -+ case DESC_RATEVHTSS2MCS4: -+ ret_rate = MPT_RATE_VHT2SS_MCS4; -+ break; -+ case DESC_RATEVHTSS2MCS5: -+ ret_rate = MPT_RATE_VHT2SS_MCS5; -+ break; -+ case DESC_RATEVHTSS2MCS6: -+ ret_rate = MPT_RATE_VHT2SS_MCS6; -+ break; -+ case DESC_RATEVHTSS2MCS7: -+ ret_rate = MPT_RATE_VHT2SS_MCS7; -+ break; -+ case DESC_RATEVHTSS2MCS8: -+ ret_rate = MPT_RATE_VHT2SS_MCS8; -+ break; -+ case DESC_RATEVHTSS2MCS9: -+ ret_rate = MPT_RATE_VHT2SS_MCS9; -+ break; -+ case DESC_RATEVHTSS3MCS0: -+ ret_rate = MPT_RATE_VHT3SS_MCS0; -+ break; -+ case DESC_RATEVHTSS3MCS1: -+ ret_rate = MPT_RATE_VHT3SS_MCS1; -+ break; -+ case DESC_RATEVHTSS3MCS2: -+ ret_rate = MPT_RATE_VHT3SS_MCS2; -+ break; -+ case DESC_RATEVHTSS3MCS3: -+ ret_rate = MPT_RATE_VHT3SS_MCS3; -+ break; -+ case DESC_RATEVHTSS3MCS4: -+ ret_rate = MPT_RATE_VHT3SS_MCS4; -+ break; -+ case DESC_RATEVHTSS3MCS5: -+ ret_rate = MPT_RATE_VHT3SS_MCS5; -+ break; -+ case DESC_RATEVHTSS3MCS6: -+ ret_rate = MPT_RATE_VHT3SS_MCS6; -+ break; -+ case DESC_RATEVHTSS3MCS7: -+ ret_rate = MPT_RATE_VHT3SS_MCS7; -+ break; -+ case DESC_RATEVHTSS3MCS8: -+ ret_rate = MPT_RATE_VHT3SS_MCS8; -+ break; -+ case DESC_RATEVHTSS3MCS9: -+ ret_rate = MPT_RATE_VHT3SS_MCS9; -+ break; -+ case DESC_RATEVHTSS4MCS0: -+ ret_rate = MPT_RATE_VHT4SS_MCS0; -+ break; -+ case DESC_RATEVHTSS4MCS1: -+ ret_rate = MPT_RATE_VHT4SS_MCS1; -+ break; -+ case DESC_RATEVHTSS4MCS2: -+ ret_rate = MPT_RATE_VHT4SS_MCS2; -+ break; -+ case DESC_RATEVHTSS4MCS3: -+ ret_rate = MPT_RATE_VHT4SS_MCS3; -+ break; -+ case DESC_RATEVHTSS4MCS4: -+ ret_rate = MPT_RATE_VHT4SS_MCS4; -+ break; -+ case DESC_RATEVHTSS4MCS5: -+ ret_rate = MPT_RATE_VHT4SS_MCS5; -+ break; -+ case DESC_RATEVHTSS4MCS6: -+ ret_rate = MPT_RATE_VHT4SS_MCS6; -+ break; -+ case DESC_RATEVHTSS4MCS7: -+ ret_rate = MPT_RATE_VHT4SS_MCS7; -+ break; -+ case DESC_RATEVHTSS4MCS8: -+ ret_rate = MPT_RATE_VHT4SS_MCS8; -+ break; -+ case DESC_RATEVHTSS4MCS9: -+ ret_rate = MPT_RATE_VHT4SS_MCS9; -+ break; -+ -+ default: -+ RTW_INFO("HwRateToMRate(): Non supported Rate [%x]!!!\n", rate); -+ break; -+ } -+ return ret_rate; -+} -+ -+u8 rtw_mpRateParseFunc(PADAPTER pAdapter, u8 *targetStr) -+{ -+ u16 i = 0; -+ u8 *rateindex_Array[] = { "1M", "2M", "5.5M", "11M", "6M", "9M", "12M", "18M", "24M", "36M", "48M", "54M", -+ "HTMCS0", "HTMCS1", "HTMCS2", "HTMCS3", "HTMCS4", "HTMCS5", "HTMCS6", "HTMCS7", -+ "HTMCS8", "HTMCS9", "HTMCS10", "HTMCS11", "HTMCS12", "HTMCS13", "HTMCS14", "HTMCS15", -+ "HTMCS16", "HTMCS17", "HTMCS18", "HTMCS19", "HTMCS20", "HTMCS21", "HTMCS22", "HTMCS23", -+ "HTMCS24", "HTMCS25", "HTMCS26", "HTMCS27", "HTMCS28", "HTMCS29", "HTMCS30", "HTMCS31", -+ "VHT1MCS0", "VHT1MCS1", "VHT1MCS2", "VHT1MCS3", "VHT1MCS4", "VHT1MCS5", "VHT1MCS6", "VHT1MCS7", "VHT1MCS8", "VHT1MCS9", -+ "VHT2MCS0", "VHT2MCS1", "VHT2MCS2", "VHT2MCS3", "VHT2MCS4", "VHT2MCS5", "VHT2MCS6", "VHT2MCS7", "VHT2MCS8", "VHT2MCS9", -+ "VHT3MCS0", "VHT3MCS1", "VHT3MCS2", "VHT3MCS3", "VHT3MCS4", "VHT3MCS5", "VHT3MCS6", "VHT3MCS7", "VHT3MCS8", "VHT3MCS9", -+ "VHT4MCS0", "VHT4MCS1", "VHT4MCS2", "VHT4MCS3", "VHT4MCS4", "VHT4MCS5", "VHT4MCS6", "VHT4MCS7", "VHT4MCS8", "VHT4MCS9" -+ }; -+ -+ for (i = 0; i <= 83; i++) { -+ if (strcmp(targetStr, rateindex_Array[i]) == 0) { -+ RTW_INFO("%s , index = %d\n", __func__ , i); -+ return i; -+ } -+ } -+ -+ printk("%s ,please input a Data RATE String as:", __func__); -+ for (i = 0; i <= 83; i++) { -+ printk("%s ", rateindex_Array[i]); -+ if (i % 10 == 0) -+ printk("\n"); -+ } -+ return _FAIL; -+} -+ -+ULONG mpt_ProQueryCalTxPower( -+ PADAPTER pAdapter, -+ u8 RfPath -+) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ -+ ULONG TxPower = 1; -+ u1Byte rate = 0; -+ struct txpwr_idx_comp tic; -+ u8 mgn_rate = MptToMgntRate(pMptCtx->MptRateIndex); -+ -+ TxPower = rtw_hal_get_tx_power_index(pAdapter, RfPath, mgn_rate, pHalData->CurrentChannelBW, pHalData->CurrentChannel, &tic); -+ -+ RTW_INFO("bw=%d, ch=%d, rate=%d, txPower:%u = %u + (%d=%d:%d) + (%d) + (%d)\n", -+ pHalData->CurrentChannelBW, pHalData->CurrentChannel, mgn_rate -+ , TxPower, tic.base, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt, tic.ebias); -+ -+ pAdapter->mppriv.txpoweridx = (u8)TxPower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_A] = (u8)TxPower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_B] = (u8)TxPower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_C] = (u8)TxPower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_D] = (u8)TxPower; -+ hal_mpt_SetTxPower(pAdapter); -+ -+ return TxPower; -+} -+ -+#ifdef CONFIG_MP_VHT_HW_TX_MODE -+static inline void dump_buf(u8 *buf, u32 len) -+{ -+ u32 i; -+ -+ RTW_INFO("-----------------Len %d----------------\n", len); -+ for (i = 0; i < len; i++) -+ RTW_INFO("%2.2x-", *(buf + i)); -+ RTW_INFO("\n"); -+} -+ -+void ByteToBit( -+ UCHAR *out, -+ bool *in, -+ UCHAR in_size) -+{ -+ UCHAR i = 0, j = 0; -+ -+ for (i = 0; i < in_size; i++) { -+ for (j = 0; j < 8; j++) { -+ if (in[8 * i + j]) -+ out[i] |= (1 << j); -+ } -+ } -+} -+ -+ -+void CRC16_generator( -+ bool *out, -+ bool *in, -+ UCHAR in_size -+) -+{ -+ UCHAR i = 0; -+ bool temp = 0, reg[] = {1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1}; -+ -+ for (i = 0; i < in_size; i++) {/* take one's complement and bit reverse*/ -+ temp = in[i] ^ reg[15]; -+ reg[15] = reg[14]; -+ reg[14] = reg[13]; -+ reg[13] = reg[12]; -+ reg[12] = reg[11]; -+ reg[11] = reg[10]; -+ reg[10] = reg[9]; -+ reg[9] = reg[8]; -+ reg[8] = reg[7]; -+ -+ reg[7] = reg[6]; -+ reg[6] = reg[5]; -+ reg[5] = reg[4]; -+ reg[4] = reg[3]; -+ reg[3] = reg[2]; -+ reg[2] = reg[1]; -+ reg[1] = reg[0]; -+ reg[12] = reg[12] ^ temp; -+ reg[5] = reg[5] ^ temp; -+ reg[0] = temp; -+ } -+ for (i = 0; i < 16; i++) /* take one's complement and bit reverse*/ -+ out[i] = 1 - reg[15 - i]; -+} -+ -+ -+ -+/*======================================== -+ SFD SIGNAL SERVICE LENGTH CRC -+ 16 bit 8 bit 8 bit 16 bit 16 bit -+========================================*/ -+void CCK_generator( -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo -+) -+{ -+ double ratio = 0; -+ bool crc16_in[32] = {0}, crc16_out[16] = {0}; -+ bool LengthExtBit; -+ double LengthExact; -+ double LengthPSDU; -+ UCHAR i; -+ UINT PacketLength = pPMacTxInfo->PacketLength; -+ -+ if (pPMacTxInfo->bSPreamble) -+ pPMacTxInfo->SFD = 0x05CF; -+ else -+ pPMacTxInfo->SFD = 0xF3A0; -+ -+ switch (pPMacPktInfo->MCS) { -+ case 0: -+ pPMacTxInfo->SignalField = 0xA; -+ ratio = 8; -+ /*CRC16_in(1,0:7)=[0 1 0 1 0 0 0 0]*/ -+ crc16_in[1] = crc16_in[3] = 1; -+ break; -+ case 1: -+ pPMacTxInfo->SignalField = 0x14; -+ ratio = 4; -+ /*CRC16_in(1,0:7)=[0 0 1 0 1 0 0 0];*/ -+ crc16_in[2] = crc16_in[4] = 1; -+ break; -+ case 2: -+ pPMacTxInfo->SignalField = 0x37; -+ ratio = 8.0 / 5.5; -+ /*CRC16_in(1,0:7)=[1 1 1 0 1 1 0 0];*/ -+ crc16_in[0] = crc16_in[1] = crc16_in[2] = crc16_in[4] = crc16_in[5] = 1; -+ break; -+ case 3: -+ pPMacTxInfo->SignalField = 0x6E; -+ ratio = 8.0 / 11.0; -+ /*CRC16_in(1,0:7)=[0 1 1 1 0 1 1 0];*/ -+ crc16_in[1] = crc16_in[2] = crc16_in[3] = crc16_in[5] = crc16_in[6] = 1; -+ break; -+ } -+ -+ LengthExact = PacketLength * ratio; -+ LengthPSDU = ceil(LengthExact); -+ -+ if ((pPMacPktInfo->MCS == 3) && -+ ((LengthPSDU - LengthExact) >= 0.727 || (LengthPSDU - LengthExact) <= -0.727)) -+ LengthExtBit = 1; -+ else -+ LengthExtBit = 0; -+ -+ -+ pPMacTxInfo->LENGTH = (UINT)LengthPSDU; -+ /* CRC16_in(1,16:31) = LengthPSDU[0:15]*/ -+ for (i = 0; i < 16; i++) -+ crc16_in[i + 16] = (pPMacTxInfo->LENGTH >> i) & 0x1; -+ -+ if (LengthExtBit == 0) { -+ pPMacTxInfo->ServiceField = 0x0; -+ /* CRC16_in(1,8:15) = [0 0 0 0 0 0 0 0];*/ -+ } else { -+ pPMacTxInfo->ServiceField = 0x80; -+ /*CRC16_in(1,8:15)=[0 0 0 0 0 0 0 1];*/ -+ crc16_in[15] = 1; -+ } -+ -+ CRC16_generator(crc16_out, crc16_in, 32); -+ -+ _rtw_memset(pPMacTxInfo->CRC16, 0, 2); -+ ByteToBit(pPMacTxInfo->CRC16, crc16_out, 2); -+ -+} -+ -+ -+void PMAC_Get_Pkt_Param( -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo) -+{ -+ -+ UCHAR TX_RATE_HEX = 0, MCS = 0; -+ UCHAR TX_RATE = pPMacTxInfo->TX_RATE; -+ -+ /* TX_RATE & Nss */ -+ if (MPT_IS_2SS_RATE(TX_RATE)) -+ pPMacPktInfo->Nss = 2; -+ else if (MPT_IS_3SS_RATE(TX_RATE)) -+ pPMacPktInfo->Nss = 3; -+ else if (MPT_IS_4SS_RATE(TX_RATE)) -+ pPMacPktInfo->Nss = 4; -+ else -+ pPMacPktInfo->Nss = 1; -+ -+ RTW_INFO("PMacTxInfo.Nss =%d\n", pPMacPktInfo->Nss); -+ -+ /* MCS & TX_RATE_HEX*/ -+ if (MPT_IS_CCK_RATE(TX_RATE)) { -+ switch (TX_RATE) { -+ case MPT_RATE_1M: -+ TX_RATE_HEX = MCS = 0; -+ break; -+ case MPT_RATE_2M: -+ TX_RATE_HEX = MCS = 1; -+ break; -+ case MPT_RATE_55M: -+ TX_RATE_HEX = MCS = 2; -+ break; -+ case MPT_RATE_11M: -+ TX_RATE_HEX = MCS = 3; -+ break; -+ } -+ } else if (MPT_IS_OFDM_RATE(TX_RATE)) { -+ MCS = TX_RATE - MPT_RATE_6M; -+ TX_RATE_HEX = MCS + 4; -+ } else if (MPT_IS_HT_RATE(TX_RATE)) { -+ MCS = TX_RATE - MPT_RATE_MCS0; -+ TX_RATE_HEX = MCS + 12; -+ } else if (MPT_IS_VHT_RATE(TX_RATE)) { -+ TX_RATE_HEX = TX_RATE - MPT_RATE_VHT1SS_MCS0 + 44; -+ -+ if (MPT_IS_VHT_2S_RATE(TX_RATE)) -+ MCS = TX_RATE - MPT_RATE_VHT2SS_MCS0; -+ else if (MPT_IS_VHT_3S_RATE(TX_RATE)) -+ MCS = TX_RATE - MPT_RATE_VHT3SS_MCS0; -+ else if (MPT_IS_VHT_4S_RATE(TX_RATE)) -+ MCS = TX_RATE - MPT_RATE_VHT4SS_MCS0; -+ else -+ MCS = TX_RATE - MPT_RATE_VHT1SS_MCS0; -+ } -+ -+ pPMacPktInfo->MCS = MCS; -+ pPMacTxInfo->TX_RATE_HEX = TX_RATE_HEX; -+ -+ RTW_INFO(" MCS=%d, TX_RATE_HEX =0x%x\n", MCS, pPMacTxInfo->TX_RATE_HEX); -+ /* mSTBC & Nsts*/ -+ pPMacPktInfo->Nsts = pPMacPktInfo->Nss; -+ if (pPMacTxInfo->bSTBC) { -+ if (pPMacPktInfo->Nss == 1) { -+ pPMacTxInfo->m_STBC = 2; -+ pPMacPktInfo->Nsts = pPMacPktInfo->Nss * 2; -+ } else -+ pPMacTxInfo->m_STBC = 1; -+ } else -+ pPMacTxInfo->m_STBC = 1; -+} -+ -+ -+UINT LDPC_parameter_generator( -+ UINT N_pld_int, -+ UINT N_CBPSS, -+ UINT N_SS, -+ UINT R, -+ UINT m_STBC, -+ UINT N_TCB_int -+) -+{ -+ double CR = 0.; -+ double N_pld = (double)N_pld_int; -+ double N_TCB = (double)N_TCB_int; -+ double N_CW = 0., N_shrt = 0., N_spcw = 0., N_fshrt = 0.; -+ double L_LDPC = 0., K_LDPC = 0., L_LDPC_info = 0.; -+ double N_punc = 0., N_ppcw = 0., N_fpunc = 0., N_rep = 0., N_rpcw = 0., N_frep = 0.; -+ double R_eff = 0.; -+ UINT VHTSIGA2B3 = 0;/* extra symbol from VHT-SIG-A2 Bit 3*/ -+ -+ if (R == 0) -+ CR = 0.5; -+ else if (R == 1) -+ CR = 2. / 3.; -+ else if (R == 2) -+ CR = 3. / 4.; -+ else if (R == 3) -+ CR = 5. / 6.; -+ -+ if (N_TCB <= 648.) { -+ N_CW = 1.; -+ if (N_TCB >= N_pld + 912.*(1. - CR)) -+ L_LDPC = 1296.; -+ else -+ L_LDPC = 648.; -+ } else if (N_TCB <= 1296.) { -+ N_CW = 1.; -+ if (N_TCB >= (double)N_pld + 1464.*(1. - CR)) -+ L_LDPC = 1944.; -+ else -+ L_LDPC = 1296.; -+ } else if (N_TCB <= 1944.) { -+ N_CW = 1.; -+ L_LDPC = 1944.; -+ } else if (N_TCB <= 2592.) { -+ N_CW = 2.; -+ if (N_TCB >= N_pld + 2916.*(1. - CR)) -+ L_LDPC = 1944.; -+ else -+ L_LDPC = 1296.; -+ } else { -+ N_CW = ceil(N_pld / 1944. / CR); -+ L_LDPC = 1944.; -+ } -+ /* Number of information bits per CW*/ -+ K_LDPC = L_LDPC * CR; -+ /* Number of shortening bits max(0, (N_CW * L_LDPC * R) - N_pld)*/ -+ N_shrt = (N_CW * K_LDPC - N_pld) > 0. ? (N_CW * K_LDPC - N_pld) : 0.; -+ /* Number of shortening bits per CW N_spcw = rtfloor(N_shrt/N_CW)*/ -+ N_spcw = rtfloor(N_shrt / N_CW); -+ /* The first N_fshrt CWs shorten 1 bit more*/ -+ N_fshrt = (double)((int)N_shrt % (int)N_CW); -+ /* Number of data bits for the last N_CW-N_fshrt CWs*/ -+ L_LDPC_info = K_LDPC - N_spcw; -+ /* Number of puncturing bits*/ -+ N_punc = (N_CW * L_LDPC - N_TCB - N_shrt) > 0. ? (N_CW * L_LDPC - N_TCB - N_shrt) : 0.; -+ if (((N_punc > .1 * N_CW * L_LDPC * (1. - CR)) && (N_shrt < 1.2 * N_punc * CR / (1. - CR))) || -+ (N_punc > 0.3 * N_CW * L_LDPC * (1. - CR))) { -+ /*cout << "*** N_TCB and N_punc are Recomputed ***" << endl;*/ -+ VHTSIGA2B3 = 1; -+ N_TCB += (double)N_CBPSS * N_SS * m_STBC; -+ N_punc = (N_CW * L_LDPC - N_TCB - N_shrt) > 0. ? (N_CW * L_LDPC - N_TCB - N_shrt) : 0.; -+ } else -+ VHTSIGA2B3 = 0; -+ -+ return VHTSIGA2B3; -+} /* function end of LDPC_parameter_generator */ -+ -+/*======================================== -+ Data field of PPDU -+ Get N_sym and SIGA2BB3 -+========================================*/ -+void PMAC_Nsym_generator( -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo) -+{ -+ UINT SIGA2B3 = 0; -+ UCHAR TX_RATE = pPMacTxInfo->TX_RATE; -+ -+ UINT R, R_list[10] = {0, 0, 2, 0, 2, 1, 2, 3, 2, 3}; -+ double CR = 0; -+ UINT N_SD, N_BPSC_list[10] = {1, 2, 2, 4, 4, 6, 6, 6, 8, 8}; -+ UINT N_BPSC = 0, N_CBPS = 0, N_DBPS = 0, N_ES = 0, N_SYM = 0, N_pld = 0, N_TCB = 0; -+ int D_R = 0; -+ -+ RTW_INFO("TX_RATE = %d\n", TX_RATE); -+ /* N_SD*/ -+ if (pPMacTxInfo->BandWidth == 0) -+ N_SD = 52; -+ else if (pPMacTxInfo->BandWidth == 1) -+ N_SD = 108; -+ else -+ N_SD = 234; -+ -+ if (MPT_IS_HT_RATE(TX_RATE)) { -+ UCHAR MCS_temp; -+ -+ if (pPMacPktInfo->MCS > 23) -+ MCS_temp = pPMacPktInfo->MCS - 24; -+ else if (pPMacPktInfo->MCS > 15) -+ MCS_temp = pPMacPktInfo->MCS - 16; -+ else if (pPMacPktInfo->MCS > 7) -+ MCS_temp = pPMacPktInfo->MCS - 8; -+ else -+ MCS_temp = pPMacPktInfo->MCS; -+ -+ R = R_list[MCS_temp]; -+ -+ switch (R) { -+ case 0: -+ CR = .5; -+ break; -+ case 1: -+ CR = 2. / 3.; -+ break; -+ case 2: -+ CR = 3. / 4.; -+ break; -+ case 3: -+ CR = 5. / 6.; -+ break; -+ } -+ -+ N_BPSC = N_BPSC_list[MCS_temp]; -+ N_CBPS = N_BPSC * N_SD * pPMacPktInfo->Nss; -+ N_DBPS = (UINT)((double)N_CBPS * CR); -+ -+ if (pPMacTxInfo->bLDPC == FALSE) { -+ N_ES = (UINT)ceil((double)(N_DBPS * pPMacPktInfo->Nss) / 4. / 300.); -+ RTW_INFO("N_ES = %d\n", N_ES); -+ -+ /* N_SYM = m_STBC* (8*length+16+6*N_ES) / (m_STBC*N_DBPS)*/ -+ N_SYM = pPMacTxInfo->m_STBC * (UINT)ceil((double)(pPMacTxInfo->PacketLength * 8 + 16 + N_ES * 6) / -+ (double)(N_DBPS * pPMacTxInfo->m_STBC)); -+ -+ } else { -+ N_ES = 1; -+ /* N_pld = length * 8 + 16*/ -+ N_pld = pPMacTxInfo->PacketLength * 8 + 16; -+ RTW_INFO("N_pld = %d\n", N_pld); -+ N_SYM = pPMacTxInfo->m_STBC * (UINT)ceil((double)(N_pld) / -+ (double)(N_DBPS * pPMacTxInfo->m_STBC)); -+ RTW_INFO("N_SYM = %d\n", N_SYM); -+ /* N_avbits = N_CBPS *m_STBC *(N_pld/N_CBPS*R*m_STBC)*/ -+ N_TCB = N_CBPS * N_SYM; -+ RTW_INFO("N_TCB = %d\n", N_TCB); -+ SIGA2B3 = LDPC_parameter_generator(N_pld, N_CBPS, pPMacPktInfo->Nss, R, pPMacTxInfo->m_STBC, N_TCB); -+ RTW_INFO("SIGA2B3 = %d\n", SIGA2B3); -+ N_SYM = N_SYM + SIGA2B3 * pPMacTxInfo->m_STBC; -+ RTW_INFO("N_SYM = %d\n", N_SYM); -+ } -+ } else if (MPT_IS_VHT_RATE(TX_RATE)) { -+ R = R_list[pPMacPktInfo->MCS]; -+ -+ switch (R) { -+ case 0: -+ CR = .5; -+ break; -+ case 1: -+ CR = 2. / 3.; -+ break; -+ case 2: -+ CR = 3. / 4.; -+ break; -+ case 3: -+ CR = 5. / 6.; -+ break; -+ } -+ N_BPSC = N_BPSC_list[pPMacPktInfo->MCS]; -+ N_CBPS = N_BPSC * N_SD * pPMacPktInfo->Nss; -+ N_DBPS = (UINT)((double)N_CBPS * CR); -+ if (pPMacTxInfo->bLDPC == FALSE) { -+ if (pPMacTxInfo->bSGI) -+ N_ES = (UINT)ceil((double)(N_DBPS) / 3.6 / 600.); -+ else -+ N_ES = (UINT)ceil((double)(N_DBPS) / 4. / 600.); -+ /* N_SYM = m_STBC* (8*length+16+6*N_ES) / (m_STBC*N_DBPS)*/ -+ N_SYM = pPMacTxInfo->m_STBC * (UINT)ceil((double)(pPMacTxInfo->PacketLength * 8 + 16 + N_ES * 6) / (double)(N_DBPS * pPMacTxInfo->m_STBC)); -+ SIGA2B3 = 0; -+ } else { -+ N_ES = 1; -+ /* N_SYM = m_STBC* (8*length+N_service) / (m_STBC*N_DBPS)*/ -+ N_SYM = pPMacTxInfo->m_STBC * (UINT)ceil((double)(pPMacTxInfo->PacketLength * 8 + 16) / (double)(N_DBPS * pPMacTxInfo->m_STBC)); -+ /* N_avbits = N_sys_init * N_CBPS*/ -+ N_TCB = N_CBPS * N_SYM; -+ /* N_pld = N_sys_init * N_DBPS*/ -+ N_pld = N_SYM * N_DBPS; -+ SIGA2B3 = LDPC_parameter_generator(N_pld, N_CBPS, pPMacPktInfo->Nss, R, pPMacTxInfo->m_STBC, N_TCB); -+ N_SYM = N_SYM + SIGA2B3 * pPMacTxInfo->m_STBC; -+ } -+ -+ switch (R) { -+ case 0: -+ D_R = 2; -+ break; -+ case 1: -+ D_R = 3; -+ break; -+ case 2: -+ D_R = 4; -+ break; -+ case 3: -+ D_R = 6; -+ break; -+ } -+ -+ if (((N_CBPS / N_ES) % D_R) != 0) { -+ RTW_INFO("MCS= %d is not supported when Nss=%d and BW= %d !!\n", pPMacPktInfo->MCS, pPMacPktInfo->Nss, pPMacTxInfo->BandWidth); -+ return; -+ } -+ -+ RTW_INFO("MCS= %d Nss=%d and BW= %d !!\n", pPMacPktInfo->MCS, pPMacPktInfo->Nss, pPMacTxInfo->BandWidth); -+ } -+ -+ pPMacPktInfo->N_sym = N_SYM; -+ pPMacPktInfo->SIGA2B3 = SIGA2B3; -+} -+ -+/*======================================== -+ L-SIG Rate R Length P Tail -+ 4b 1b 12b 1b 6b -+========================================*/ -+ -+void L_SIG_generator( -+ UINT N_SYM, /* Max: 750*/ -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo) -+{ -+ u8 sig_bi[24] = {0}; /* 24 BIT*/ -+ UINT mode, LENGTH; -+ int i; -+ -+ if (MPT_IS_OFDM_RATE(pPMacTxInfo->TX_RATE)) { -+ mode = pPMacPktInfo->MCS; -+ LENGTH = pPMacTxInfo->PacketLength; -+ } else { -+ UCHAR N_LTF; -+ double T_data; -+ UINT OFDM_symbol; -+ -+ mode = 0; -+ -+ /* Table 20-13 Num of HT-DLTFs request*/ -+ if (pPMacPktInfo->Nsts <= 2) -+ N_LTF = pPMacPktInfo->Nsts; -+ else -+ N_LTF = 4; -+ -+ if (pPMacTxInfo->bSGI) -+ T_data = 3.6; -+ else -+ T_data = 4.0; -+ -+ /*(L-SIG, HT-SIG, HT-STF, HT-LTF....HT-LTF, Data)*/ -+ if (MPT_IS_VHT_RATE(pPMacTxInfo->TX_RATE)) -+ OFDM_symbol = (UINT)ceil((double)(8 + 4 + N_LTF * 4 + N_SYM * T_data + 4) / 4.); -+ else -+ OFDM_symbol = (UINT)ceil((double)(8 + 4 + N_LTF * 4 + N_SYM * T_data) / 4.); -+ -+ RTW_INFO("%s , OFDM_symbol =%d\n", __func__, OFDM_symbol); -+ LENGTH = OFDM_symbol * 3 - 3; -+ RTW_INFO("%s , LENGTH =%d\n", __func__, LENGTH); -+ -+ } -+ /* Rate Field*/ -+ switch (mode) { -+ case 0: -+ sig_bi[0] = 1; -+ sig_bi[1] = 1; -+ sig_bi[2] = 0; -+ sig_bi[3] = 1; -+ break; -+ case 1: -+ sig_bi[0] = 1; -+ sig_bi[1] = 1; -+ sig_bi[2] = 1; -+ sig_bi[3] = 1; -+ break; -+ case 2: -+ sig_bi[0] = 0; -+ sig_bi[1] = 1; -+ sig_bi[2] = 0; -+ sig_bi[3] = 1; -+ break; -+ case 3: -+ sig_bi[0] = 0; -+ sig_bi[1] = 1; -+ sig_bi[2] = 1; -+ sig_bi[3] = 1; -+ break; -+ case 4: -+ sig_bi[0] = 1; -+ sig_bi[1] = 0; -+ sig_bi[2] = 0; -+ sig_bi[3] = 1; -+ break; -+ case 5: -+ sig_bi[0] = 1; -+ sig_bi[1] = 0; -+ sig_bi[2] = 1; -+ sig_bi[3] = 1; -+ break; -+ case 6: -+ sig_bi[0] = 0; -+ sig_bi[1] = 0; -+ sig_bi[2] = 0; -+ sig_bi[3] = 1; -+ break; -+ case 7: -+ sig_bi[0] = 0; -+ sig_bi[1] = 0; -+ sig_bi[2] = 1; -+ sig_bi[3] = 1; -+ break; -+ } -+ /*Reserved bit*/ -+ sig_bi[4] = 0; -+ -+ /* Length Field*/ -+ for (i = 0; i < 12; i++) -+ sig_bi[i + 5] = (LENGTH >> i) & 1; -+ -+ /* Parity Bit*/ -+ sig_bi[17] = 0; -+ for (i = 0; i < 17; i++) -+ sig_bi[17] = sig_bi[17] + sig_bi[i]; -+ -+ sig_bi[17] %= 2; -+ -+ /* Tail Field*/ -+ for (i = 18; i < 24; i++) -+ sig_bi[i] = 0; -+ -+ /* dump_buf(sig_bi,24);*/ -+ _rtw_memset(pPMacTxInfo->LSIG, 0, 3); -+ ByteToBit(pPMacTxInfo->LSIG, (bool *)sig_bi, 3); -+} -+ -+ -+void CRC8_generator( -+ bool *out, -+ bool *in, -+ UCHAR in_size -+) -+{ -+ UCHAR i = 0; -+ bool temp = 0, reg[] = {1, 1, 1, 1, 1, 1, 1, 1}; -+ -+ for (i = 0; i < in_size; i++) { /* take one's complement and bit reverse*/ -+ temp = in[i] ^ reg[7]; -+ reg[7] = reg[6]; -+ reg[6] = reg[5]; -+ reg[5] = reg[4]; -+ reg[4] = reg[3]; -+ reg[3] = reg[2]; -+ reg[2] = reg[1] ^ temp; -+ reg[1] = reg[0] ^ temp; -+ reg[0] = temp; -+ } -+ for (i = 0; i < 8; i++)/* take one's complement and bit reverse*/ -+ out[i] = reg[7 - i] ^ 1; -+} -+ -+/*/================================================================================ -+ HT-SIG1 MCS CW Length 24BIT + 24BIT -+ 7b 1b 16b -+ HT-SIG2 Smoothing Not sounding Rsvd AGG STBC FEC SGI N_ELTF CRC Tail -+ 1b 1b 1b 1b 2b 1b 1b 2b 8b 6b -+================================================================================*/ -+void HT_SIG_generator( -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo -+) -+{ -+ UINT i; -+ bool sig_bi[48] = {0}, crc8[8] = {0}; -+ /* MCS Field*/ -+ for (i = 0; i < 7; i++) -+ sig_bi[i] = (pPMacPktInfo->MCS >> i) & 0x1; -+ /* Packet BW Setting*/ -+ sig_bi[7] = pPMacTxInfo->BandWidth; -+ /* HT-Length Field*/ -+ for (i = 0; i < 16; i++) -+ sig_bi[i + 8] = (pPMacTxInfo->PacketLength >> i) & 0x1; -+ /* Smoothing; 1->allow smoothing*/ -+ sig_bi[24] = 1; -+ /*Not Sounding*/ -+ sig_bi[25] = 1 - pPMacTxInfo->NDP_sound; -+ /*Reserved bit*/ -+ sig_bi[26] = 1; -+ /*/Aggregate*/ -+ sig_bi[27] = 0; -+ /*STBC Field*/ -+ if (pPMacTxInfo->bSTBC) { -+ sig_bi[28] = 1; -+ sig_bi[29] = 0; -+ } else { -+ sig_bi[28] = 0; -+ sig_bi[29] = 0; -+ } -+ /*Advance Coding, 0: BCC, 1: LDPC*/ -+ sig_bi[30] = pPMacTxInfo->bLDPC; -+ /* Short GI*/ -+ sig_bi[31] = pPMacTxInfo->bSGI; -+ /* N_ELTFs*/ -+ if (pPMacTxInfo->NDP_sound == FALSE) { -+ sig_bi[32] = 0; -+ sig_bi[33] = 0; -+ } else { -+ int N_ELTF = pPMacTxInfo->Ntx - pPMacPktInfo->Nss; -+ -+ for (i = 0; i < 2; i++) -+ sig_bi[32 + i] = (N_ELTF >> i) % 2; -+ } -+ /* CRC-8*/ -+ CRC8_generator(crc8, sig_bi, 34); -+ -+ for (i = 0; i < 8; i++) -+ sig_bi[34 + i] = crc8[i]; -+ -+ /*Tail*/ -+ for (i = 42; i < 48; i++) -+ sig_bi[i] = 0; -+ -+ _rtw_memset(pPMacTxInfo->HT_SIG, 0, 6); -+ ByteToBit(pPMacTxInfo->HT_SIG, sig_bi, 6); -+} -+ -+ -+/*====================================================================================== -+ VHT-SIG-A1 -+ BW Reserved STBC G_ID SU_Nsts P_AID TXOP_PS_NOT_ALLOW Reserved -+ 2b 1b 1b 6b 3b 9b 1b 2b 1b -+ VHT-SIG-A2 -+ SGI SGI_Nsym SU/MU coding LDPC_Extra SU_NCS Beamformed Reserved CRC Tail -+ 1b 1b 1b 1b 4b 1b 1b 8b 6b -+======================================================================================*/ -+void VHT_SIG_A_generator( -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo) -+{ -+ UINT i; -+ bool sig_bi[48], crc8[8]; -+ -+ _rtw_memset(sig_bi, 0, 48); -+ _rtw_memset(crc8, 0, 8); -+ -+ /* BW Setting*/ -+ for (i = 0; i < 2; i++) -+ sig_bi[i] = (pPMacTxInfo->BandWidth >> i) & 0x1; -+ /* Reserved Bit*/ -+ sig_bi[2] = 1; -+ /*STBC Field*/ -+ sig_bi[3] = pPMacTxInfo->bSTBC; -+ /*Group ID: Single User->A value of 0 or 63 indicates an SU PPDU. */ -+ for (i = 0; i < 6; i++) -+ sig_bi[4 + i] = 0; -+ /* N_STS/Partial AID*/ -+ for (i = 0; i < 12; i++) { -+ if (i < 3) -+ sig_bi[10 + i] = ((pPMacPktInfo->Nsts - 1) >> i) & 0x1; -+ else -+ sig_bi[10 + i] = 0; -+ } -+ /*TXOP_PS_NOT_ALLPWED*/ -+ sig_bi[22] = 0; -+ /*Reserved Bits*/ -+ sig_bi[23] = 1; -+ /*Short GI*/ -+ sig_bi[24] = pPMacTxInfo->bSGI; -+ if (pPMacTxInfo->bSGI > 0 && (pPMacPktInfo->N_sym % 10) == 9) -+ sig_bi[25] = 1; -+ else -+ sig_bi[25] = 0; -+ /* SU/MU[0] Coding*/ -+ sig_bi[26] = pPMacTxInfo->bLDPC; /* 0:BCC, 1:LDPC */ -+ sig_bi[27] = pPMacPktInfo->SIGA2B3; /*/ Record Extra OFDM Symols is added or not when LDPC is used*/ -+ /*SU MCS/MU[1-3] Coding*/ -+ for (i = 0; i < 4; i++) -+ sig_bi[28 + i] = (pPMacPktInfo->MCS >> i) & 0x1; -+ /*SU Beamform */ -+ sig_bi[32] = 0; /*packet.TXBF_en;*/ -+ /*Reserved Bit*/ -+ sig_bi[33] = 1; -+ /*CRC-8*/ -+ CRC8_generator(crc8, sig_bi, 34); -+ for (i = 0; i < 8; i++) -+ sig_bi[34 + i] = crc8[i]; -+ /*Tail*/ -+ for (i = 42; i < 48; i++) -+ sig_bi[i] = 0; -+ -+ _rtw_memset(pPMacTxInfo->VHT_SIG_A, 0, 6); -+ ByteToBit(pPMacTxInfo->VHT_SIG_A, sig_bi, 6); -+} -+ -+/*====================================================================================== -+ VHT-SIG-B -+ Length Resesrved Trail -+ 17/19/21 BIT 3/2/2 BIT 6b -+======================================================================================*/ -+void VHT_SIG_B_generator( -+ PRT_PMAC_TX_INFO pPMacTxInfo) -+{ -+ bool sig_bi[32], crc8_bi[8]; -+ UINT i, len, res, tail = 6, total_len, crc8_in_len; -+ UINT sigb_len; -+ -+ _rtw_memset(sig_bi, 0, 32); -+ _rtw_memset(crc8_bi, 0, 8); -+ -+ /*Sounding Packet*/ -+ if (pPMacTxInfo->NDP_sound == 1) { -+ if (pPMacTxInfo->BandWidth == 0) { -+ bool sigb_temp[26] = {0, 0, 0, 0, 0, 1, 1, 1, 0, 1, 0, 0, 0, 1, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0}; -+ -+ _rtw_memcpy(sig_bi, sigb_temp, 26); -+ } else if (pPMacTxInfo->BandWidth == 1) { -+ bool sigb_temp[27] = {1, 0, 1, 0, 0, 1, 0, 1, 1, 0, 1, 0, 0, 0, 1, 0, 0, 0, 0, 1, 1, 0, 0, 0, 0, 0, 0}; -+ -+ _rtw_memcpy(sig_bi, sigb_temp, 27); -+ } else if (pPMacTxInfo->BandWidth == 2) { -+ bool sigb_temp[29] = {0, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 1, 1, 1, 1, 1, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0}; -+ -+ _rtw_memcpy(sig_bi, sigb_temp, 29); -+ } -+ } else { /* Not NDP Sounding*/ -+ bool *sigb_temp[29] = {0}; -+ -+ if (pPMacTxInfo->BandWidth == 0) { -+ len = 17; -+ res = 3; -+ } else if (pPMacTxInfo->BandWidth == 1) { -+ len = 19; -+ res = 2; -+ } else if (pPMacTxInfo->BandWidth == 2) { -+ len = 21; -+ res = 2; -+ } else { -+ len = 21; -+ res = 2; -+ } -+ total_len = len + res + tail; -+ crc8_in_len = len + res; -+ -+ /*Length Field*/ -+ sigb_len = (pPMacTxInfo->PacketLength + 3) >> 2; -+ -+ for (i = 0; i < len; i++) -+ sig_bi[i] = (sigb_len >> i) & 0x1; -+ /*Reserved Field*/ -+ for (i = 0; i < res; i++) -+ sig_bi[len + i] = 1; -+ /* CRC-8*/ -+ CRC8_generator(crc8_bi, sig_bi, crc8_in_len); -+ -+ /* Tail */ -+ for (i = 0; i < tail; i++) -+ sig_bi[len + res + i] = 0; -+ } -+ -+ _rtw_memset(pPMacTxInfo->VHT_SIG_B, 0, 4); -+ ByteToBit(pPMacTxInfo->VHT_SIG_B, sig_bi, 4); -+ -+ pPMacTxInfo->VHT_SIG_B_CRC = 0; -+ ByteToBit(&(pPMacTxInfo->VHT_SIG_B_CRC), crc8_bi, 1); -+} -+ -+/*======================= -+ VHT Delimiter -+=======================*/ -+void VHT_Delimiter_generator( -+ PRT_PMAC_TX_INFO pPMacTxInfo -+) -+{ -+ bool sig_bi[32] = {0}, crc8[8] = {0}; -+ UINT crc8_in_len = 16; -+ UINT PacketLength = pPMacTxInfo->PacketLength; -+ int j; -+ -+ /* Delimiter[0]: EOF*/ -+ sig_bi[0] = 1; -+ /* Delimiter[1]: Reserved*/ -+ sig_bi[1] = 0; -+ /* Delimiter[3:2]: MPDU Length High*/ -+ sig_bi[2] = ((PacketLength - 4) >> 12) % 2; -+ sig_bi[3] = ((PacketLength - 4) >> 13) % 2; -+ /* Delimiter[15:4]: MPDU Length Low*/ -+ for (j = 4; j < 16; j++) -+ sig_bi[j] = ((PacketLength - 4) >> (j - 4)) % 2; -+ CRC8_generator(crc8, sig_bi, crc8_in_len); -+ for (j = 16; j < 24; j++) /* Delimiter[23:16]: CRC 8*/ -+ sig_bi[j] = crc8[j - 16]; -+ for (j = 24; j < 32; j++) /* Delimiter[31:24]: Signature ('4E' in Hex, 78 in Dec)*/ -+ sig_bi[j] = (78 >> (j - 24)) % 2; -+ -+ _rtw_memset(pPMacTxInfo->VHT_Delimiter, 0, 4); -+ ByteToBit(pPMacTxInfo->VHT_Delimiter, sig_bi, 4); -+} -+ -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_mp_ioctl.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mp_ioctl.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_mp_ioctl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_mp_ioctl.c 2018-02-11 21:44:27.139145964 +0200 -@@ -0,0 +1,2534 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_MP_IOCTL_C_ -+ -+#include -+#include -+#include "../hal/phydm/phydm_precomp.h" -+ -+/* **************** oid_rtl_seg_81_85 section start **************** */ -+NDIS_STATUS oid_rt_wireless_mode_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ if (poid_par_priv->information_buf_len < sizeof(u8)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ if (poid_par_priv->type_of_oid == SET_OID) -+ Adapter->registrypriv.wireless_mode = *(u8 *)poid_par_priv->information_buf; -+ else if (poid_par_priv->type_of_oid == QUERY_OID) { -+ *(u8 *)poid_par_priv->information_buf = Adapter->registrypriv.wireless_mode; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ -+ return status; -+} -+/* **************** oid_rtl_seg_81_87_80 section start **************** */ -+NDIS_STATUS oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ struct bb_reg_param *pbbreg; -+ u16 offset; -+ u32 value; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf); -+ -+ offset = (u16)(pbbreg->offset) & 0xFFF; /* 0ffset :0x800~0xfff */ -+ if (offset < BB_REG_BASE_ADDR) -+ offset |= BB_REG_BASE_ADDR; -+ -+ value = pbbreg->value; -+ -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ write_bbreg(Adapter, offset, 0xFFFFFFFF, value); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ struct bb_reg_param *pbbreg; -+ u16 offset; -+ u32 value; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf); -+ -+ offset = (u16)(pbbreg->offset) & 0xFFF; /* 0ffset :0x800~0xfff */ -+ if (offset < BB_REG_BASE_ADDR) -+ offset |= BB_REG_BASE_ADDR; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ value = read_bbreg(Adapter, offset, 0xFFFFFFFF); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ pbbreg->value = value; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ struct rf_reg_param *pbbreg; -+ u8 path; -+ u8 offset; -+ u32 value; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf); -+ -+ if (pbbreg->path >= MAX_RF_PATH_NUMS) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ if (pbbreg->offset > 0xFF) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ if (pbbreg->value > 0xFFFFF) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ path = (u8)pbbreg->path; -+ offset = (u8)pbbreg->offset; -+ value = pbbreg->value; -+ -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ write_rfreg(Adapter, path, offset, value); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ struct rf_reg_param *pbbreg; -+ u8 path; -+ u8 offset; -+ u32 value; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf); -+ -+ if (pbbreg->path >= MAX_RF_PATH_NUMS) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ if (pbbreg->offset > 0xFF) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ path = (u8)pbbreg->path; -+ offset = (u8)pbbreg->offset; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ value = read_rfreg(Adapter, path, offset); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ pbbreg->value = value; -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ -+ return status; -+} -+/* **************** oid_rtl_seg_81_87_00 section end**************** -+ * ------------------------------------------------------------------------------ */ -+ -+/* **************** oid_rtl_seg_81_80_00 section start **************** -+ * ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_set_data_rate_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u32 ratevalue;/* 4 */ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ ratevalue = *((u32 *)poid_par_priv->information_buf); /* 4 */ -+ if (ratevalue >= MPT_RATE_LAST) -+ return NDIS_STATUS_INVALID_DATA; -+ -+ Adapter->mppriv.rateidx = ratevalue; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetDataRate(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_start_test_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u32 mode; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (Adapter->registrypriv.mp_mode == 0) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ /* IQCalibrateBcut(Adapter); */ -+ -+ mode = *((u32 *)poid_par_priv->information_buf); -+ Adapter->mppriv.mode = mode;/* 1 for loopback */ -+ -+ if (mp_start_test(Adapter) == _FAIL) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ goto exit; -+ } -+ -+exit: -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_stop_test_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ mp_stop_test(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u32 Channel; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ if (poid_par_priv->type_of_oid == QUERY_OID) { -+ *((u32 *)poid_par_priv->information_buf) = Adapter->mppriv.channel; -+ return NDIS_STATUS_SUCCESS; -+ } -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ Channel = *((u32 *)poid_par_priv->information_buf); -+ if (Channel > 14) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ Adapter->mppriv.channel = Channel; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetChannel(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_set_bandwidth_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u16 bandwidth; -+ u16 channel_offset; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ bandwidth = *((u32 *)poid_par_priv->information_buf); /* 4 */ -+ channel_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if (bandwidth != CHANNEL_WIDTH_40) -+ bandwidth = CHANNEL_WIDTH_20; -+ padapter->mppriv.bandwidth = (u8)bandwidth; -+ padapter->mppriv.prime_channel_offset = (u8)channel_offset; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetBandwidth(padapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u32 antenna; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ if (poid_par_priv->type_of_oid == SET_OID) { -+ antenna = *(u32 *)poid_par_priv->information_buf; -+ -+ Adapter->mppriv.antenna_tx = (u16)((antenna & 0xFFFF0000) >> 16); -+ Adapter->mppriv.antenna_rx = (u16)(antenna & 0x0000FFFF); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetAntenna(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ } else { -+ antenna = (Adapter->mppriv.antenna_tx << 16) | Adapter->mppriv.antenna_rx; -+ *(u32 *)poid_par_priv->information_buf = antenna; -+ } -+ -+ -+ return status; -+} -+ -+NDIS_STATUS oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u32 tx_pwr_idx; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ tx_pwr_idx = *((u32 *)poid_par_priv->information_buf); -+ if (tx_pwr_idx > MAX_TX_PWR_INDEX_N_MODE) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ Adapter->mppriv.txpoweridx = (u8)tx_pwr_idx; -+ -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetTxPower(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+ -+/* ------------------------------------------------------------------------------ -+ * **************** oid_rtl_seg_81_80_20 section start **************** -+ * ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if (poid_par_priv->information_buf_len == sizeof(ULONG)) { -+ *(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.tx_pktcount; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH; -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ if (poid_par_priv->information_buf_len == sizeof(ULONG)) { -+ *(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.rx_pktcount; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH; -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ if (poid_par_priv->information_buf_len == sizeof(ULONG)) { -+ *(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.rx_crcerrpktcount; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH; -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+ -+NDIS_STATUS oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ Adapter->mppriv.tx_pktcount = 0; -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if (poid_par_priv->information_buf_len == sizeof(ULONG)) { -+ Adapter->mppriv.rx_pktcount = 0; -+ Adapter->mppriv.rx_crcerrpktcount = 0; -+ } else -+ status = NDIS_STATUS_INVALID_LENGTH; -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ ResetPhyRxPktCount(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len != sizeof(ULONG)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ *(ULONG *)poid_par_priv->information_buf = GetPhyRxPktReceived(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ -+ if (poid_par_priv->information_buf_len != sizeof(ULONG)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ *(ULONG *)poid_par_priv->information_buf = GetPhyRxPktCRC32Error(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ -+ return status; -+} -+/* **************** oid_rtl_seg_81_80_20 section end **************** */ -+NDIS_STATUS oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u32 bStartTest; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ bStartTest = *((u32 *)poid_par_priv->information_buf); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetContinuousTx(Adapter, (u8)bStartTest); -+ if (bStartTest) { -+ struct mp_priv *pmp_priv = &Adapter->mppriv; -+ if (pmp_priv->tx.stop == 0) { -+ pmp_priv->tx.stop = 1; -+ RTW_INFO("%s: pkt tx is running...\n", __func__); -+ rtw_msleep_os(5); -+ } -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx.count = 1; -+ SetPacketTx(Adapter); -+ } -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+ -+NDIS_STATUS oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u32 bStartTest; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ bStartTest = *((u32 *)poid_par_priv->information_buf); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetSingleCarrierTx(Adapter, (u8)bStartTest); -+ if (bStartTest) { -+ struct mp_priv *pmp_priv = &Adapter->mppriv; -+ if (pmp_priv->tx.stop == 0) { -+ pmp_priv->tx.stop = 1; -+ RTW_INFO("%s: pkt tx is running...\n", __func__); -+ rtw_msleep_os(5); -+ } -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx.count = 1; -+ SetPacketTx(Adapter); -+ } -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+ -+NDIS_STATUS oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u32 bStartTest; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ bStartTest = *((u32 *)poid_par_priv->information_buf); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetCarrierSuppressionTx(Adapter, (u8)bStartTest); -+ if (bStartTest) { -+ struct mp_priv *pmp_priv = &Adapter->mppriv; -+ if (pmp_priv->tx.stop == 0) { -+ pmp_priv->tx.stop = 1; -+ RTW_INFO("%s: pkt tx is running...\n", __func__); -+ rtw_msleep_os(5); -+ } -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx.count = 1; -+ SetPacketTx(Adapter); -+ } -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+ -+NDIS_STATUS oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u32 bStartTest; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ bStartTest = *((u32 *)poid_par_priv->information_buf); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetSingleToneTx(Adapter, (u8)bStartTest); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+ -+NDIS_STATUS oid_rt_pro_set_modulation_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+ -+NDIS_STATUS oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ rtw_hal_set_hwreg(Adapter, HW_VAR_TRIGGER_GPIO_0, 0); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+/* **************** oid_rtl_seg_81_80_00 section end **************** -+ * ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro8711_join_bss_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ PNDIS_802_11_SSID pssid; -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ *poid_par_priv->bytes_needed = (u32)sizeof(NDIS_802_11_SSID); -+ *poid_par_priv->bytes_rw = 0; -+ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ pssid = (PNDIS_802_11_SSID)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (mp_start_joinbss(Adapter, pssid) == _FAIL) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = sizeof(NDIS_802_11_SSID); -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_read_register_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ pRW_Reg RegRWStruct; -+ u32 offset, width; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ RegRWStruct = (pRW_Reg)poid_par_priv->information_buf; -+ offset = RegRWStruct->offset; -+ width = RegRWStruct->width; -+ -+ if (offset > 0xFFF) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ switch (width) { -+ case 1: -+ RegRWStruct->value = rtw_read8(Adapter, offset); -+ break; -+ case 2: -+ RegRWStruct->value = rtw_read16(Adapter, offset); -+ break; -+ default: -+ width = 4; -+ RegRWStruct->value = rtw_read32(Adapter, offset); -+ break; -+ } -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = width; -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_write_register_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ pRW_Reg RegRWStruct; -+ u32 offset, width, value; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ RegRWStruct = (pRW_Reg)poid_par_priv->information_buf; -+ offset = RegRWStruct->offset; -+ width = RegRWStruct->width; -+ value = RegRWStruct->value; -+ -+ if (offset > 0xFFF) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ switch (RegRWStruct->width) { -+ case 1: -+ if (value > 0xFF) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ break; -+ } -+ rtw_write8(padapter, offset, (u8)value); -+ break; -+ case 2: -+ if (value > 0xFFFF) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ break; -+ } -+ rtw_write16(padapter, offset, (u16)value); -+ break; -+ case 4: -+ rtw_write32(padapter, offset, value); -+ break; -+ default: -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ break; -+ } -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_burst_read_register_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ pBurst_RW_Reg pBstRwReg; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ pBstRwReg = (pBurst_RW_Reg)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ rtw_read_mem(padapter, pBstRwReg->offset, (u32)pBstRwReg->len, pBstRwReg->Data); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_burst_write_register_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ pBurst_RW_Reg pBstRwReg; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ pBstRwReg = (pBurst_RW_Reg)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ rtw_write_mem(padapter, pBstRwReg->offset, (u32)pBstRwReg->len, pBstRwReg->Data); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_write_txcmd_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ -+ TX_CMD_Desc *TxCmd_Info; -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ -+ TxCmd_Info = (TX_CMD_Desc *)poid_par_priv->information_buf; -+ -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ rtw_write32(Adapter, TxCmd_Info->offset + 0, (unsigned int)TxCmd_Info->TxCMD.value[0]); -+ rtw_write32(Adapter, TxCmd_Info->offset + 4, (unsigned int)TxCmd_Info->TxCMD.value[1]); -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+ -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ pEEPROM_RWParam pEEPROM; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ pEEPROM = (pEEPROM_RWParam)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ pEEPROM->value = eeprom_read16(padapter, (u16)(pEEPROM->offset >> 1)); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+ -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_write16_eeprom_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ pEEPROM_RWParam pEEPROM; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ pEEPROM = (pEEPROM_RWParam)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ eeprom_write16(padapter, (u16)(pEEPROM->offset >> 1), pEEPROM->value); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ struct mp_wiparam *pwi_param; -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(struct mp_wiparam)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ if (Adapter->mppriv.workparam.bcompleted == _FALSE) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ pwi_param = (struct mp_wiparam *)poid_par_priv->information_buf; -+ -+ _rtw_memcpy(pwi_param, &Adapter->mppriv.workparam, sizeof(struct mp_wiparam)); -+ Adapter->mppriv.act_in_progress = _FALSE; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(uint) * 2) { -+ return NDIS_STATUS_INVALID_LENGTH; -+ } -+ -+ if (*(uint *)poid_par_priv->information_buf == 1) /* init==1 */ -+ Adapter->mppriv.rx_pktloss = 0; -+ -+ *((uint *)poid_par_priv->information_buf + 1) = Adapter->mppriv.rx_pktloss; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_rd_attrib_mem_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ struct io_queue *pio_queue = (struct io_queue *)Adapter->pio_queue; -+ struct intf_hdl *pintfhdl = &pio_queue->intf; -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+#ifdef CONFIG_SDIO_HCI -+ void (*_attrib_read)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+#endif -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+#ifdef CONFIG_SDIO_HCI -+ _irqlevel_changed_(&oldirql, LOWER); -+ { -+ u32 *plmem = (u32 *)poid_par_priv->information_buf + 2; -+ _attrib_read = pintfhdl->io_ops._attrib_read; -+ _attrib_read(pintfhdl, *((u32 *)poid_par_priv->information_buf), -+ *((u32 *)poid_par_priv->information_buf + 1), (u8 *)plmem); -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } -+ _irqlevel_changed_(&oldirql, RAISE); -+#endif -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_wr_attrib_mem_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ struct io_queue *pio_queue = (struct io_queue *)Adapter->pio_queue; -+ struct intf_hdl *pintfhdl = &pio_queue->intf; -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+#ifdef CONFIG_SDIO_HCI -+ void (*_attrib_write)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+#endif -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+#ifdef CONFIG_SDIO_HCI -+ _irqlevel_changed_(&oldirql, LOWER); -+ { -+ u32 *plmem = (u32 *)poid_par_priv->information_buf + 2; -+ _attrib_write = pintfhdl->io_ops._attrib_write; -+ _attrib_write(pintfhdl, *(u32 *)poid_par_priv->information_buf, -+ *((u32 *)poid_par_priv->information_buf + 1), (u8 *)plmem); -+ } -+ _irqlevel_changed_(&oldirql, RAISE); -+#endif -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (rtw_setrfintfs_cmd(Adapter, *(unsigned char *)poid_par_priv->information_buf) == _FAIL) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_poll_rx_status_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ _rtw_memcpy(poid_par_priv->information_buf, (unsigned char *)&Adapter->mppriv.rxstat, sizeof(struct recv_stat)); -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ PCFG_DBG_MSG_STRUCT pdbg_msg; -+ -+ -+ -+#if 0/*#ifdef CONFIG_DEBUG_RTL871X*/ -+ -+ pdbg_msg = (PCFG_DBG_MSG_STRUCT)(poid_par_priv->information_buf); -+ -+ if (poid_par_priv->type_of_oid == SET_OID) { -+ -+ GlobalDebugLevel = pdbg_msg->DebugLevel; -+ GlobalDebugComponents = (pdbg_msg->DebugComponent_H32 << 32) | pdbg_msg->DebugComponent_L32; -+ } else { -+ pdbg_msg->DebugLevel = GlobalDebugLevel; -+ pdbg_msg->DebugComponent_H32 = (u32)(GlobalDebugComponents >> 32); -+ pdbg_msg->DebugComponent_L32 = (u32)GlobalDebugComponents; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ } -+ -+#endif -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (rtw_setdatarate_cmd(Adapter, poid_par_priv->information_buf) != _SUCCESS) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+/* ----------------------------------------------------------------------------- */ -+NDIS_STATUS oid_rt_get_thermal_meter_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ u8 thermal = 0; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ GetThermalMeter(Adapter, &thermal); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *(u32 *)poid_par_priv->information_buf = (u32)thermal; -+ *poid_par_priv->bytes_rw = sizeof(u32); -+ -+ -+ return status; -+} -+/* ----------------------------------------------------------------------------- */ -+NDIS_STATUS oid_rt_pro_read_tssi_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (Adapter->mppriv.act_in_progress == _TRUE) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u8)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ /* init workparam */ -+ Adapter->mppriv.act_in_progress = _TRUE; -+ Adapter->mppriv.workparam.bcompleted = _FALSE; -+ Adapter->mppriv.workparam.act_type = MPT_READ_TSSI; -+ Adapter->mppriv.workparam.io_offset = 0; -+ Adapter->mppriv.workparam.io_value = 0xFFFFFFFF; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (!rtw_gettssi_cmd(Adapter, 0, (u8 *)&Adapter->mppriv.workparam.io_value)) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ /* if (poid_par_priv->type_of_oid != SET_OID) -+ * return NDIS_STATUS_NOT_ACCEPTED; */ -+ -+ if (poid_par_priv->information_buf_len < sizeof(u8)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ if (poid_par_priv->type_of_oid == SET_OID) { -+ u8 enable; -+ -+ enable = *(u8 *)poid_par_priv->information_buf; -+ -+ SetPowerTracking(Adapter, enable); -+ } else -+ GetPowerTracking(Adapter, (u8 *)poid_par_priv->information_buf); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+/* ----------------------------------------------------------------------------- */ -+NDIS_STATUS oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u32 ratevalue; -+ u8 datarates[NumRates]; -+ int i; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+#if 0 -+ ratevalue = *((u32 *)poid_par_priv->information_buf); -+ -+ for (i = 0; i < NumRates; i++) { -+ if (ratevalue == mpdatarate[i]) -+ datarates[i] = mpdatarate[i]; -+ else -+ datarates[i] = 0xff; -+ } -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (rtw_setbasicrate_cmd(padapter, datarates) != _SUCCESS) -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+#endif -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < 8) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ *poid_par_priv->bytes_rw = 8; -+ _rtw_memcpy(poid_par_priv->information_buf, &(adapter_to_pwrctl(Adapter)->pwr_mode), 8); -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ uint pwr_mode, smart_ps; -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ *poid_par_priv->bytes_rw = 0; -+ *poid_par_priv->bytes_needed = 8; -+ -+ if (poid_par_priv->information_buf_len < 8) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ pwr_mode = *(uint *)(poid_par_priv->information_buf); -+ smart_ps = *(uint *)((int)poid_par_priv->information_buf + 4); -+ -+ *poid_par_priv->bytes_rw = 8; -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ struct setratable_parm *prate_table; -+ u8 res; -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ *poid_par_priv->bytes_needed = sizeof(struct setratable_parm); -+ if (poid_par_priv->information_buf_len < sizeof(struct setratable_parm)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ prate_table = (struct setratable_parm *)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ res = rtw_setrttbl_cmd(Adapter, prate_table); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ if (res == _FAIL) -+ status = NDIS_STATUS_FAILURE; -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+#if 0 -+ struct mp_wi_cntx *pmp_wi_cntx = &(Adapter->mppriv.wi_cntx); -+ u8 res = _SUCCESS; -+ DEBUG_INFO(("===> Set OID_RT_PRO_H2C_GET_RATE_TABLE.\n")); -+ -+ if (pmp_wi_cntx->bmp_wi_progress == _TRUE) { -+ DEBUG_ERR(("\n mp workitem is progressing, not allow to set another workitem right now!!!\n")); -+ Status = NDIS_STATUS_NOT_ACCEPTED; -+ break; -+ } else { -+ pmp_wi_cntx->bmp_wi_progress = _TRUE; -+ pmp_wi_cntx->param.bcompleted = _FALSE; -+ pmp_wi_cntx->param.act_type = MPT_GET_RATE_TABLE; -+ pmp_wi_cntx->param.io_offset = 0x0; -+ pmp_wi_cntx->param.bytes_cnt = sizeof(struct getratable_rsp); -+ pmp_wi_cntx->param.io_value = 0xffffffff; -+ -+ res = rtw_getrttbl_cmd(Adapter, (struct getratable_rsp *)pmp_wi_cntx->param.data); -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ if (res != _SUCCESS) -+ Status = NDIS_STATUS_NOT_ACCEPTED; -+ } -+ DEBUG_INFO(("\n <=== Set OID_RT_PRO_H2C_GET_RATE_TABLE.\n")); -+#endif -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+ -+/* **************** oid_rtl_seg_87_12_00 section start **************** */ -+NDIS_STATUS oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ struct security_priv *psecuritypriv = &Adapter->securitypriv; -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ ENCRY_CTRL_STATE encry_mode; -+ -+ -+ *poid_par_priv->bytes_needed = sizeof(u8); -+ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ if (poid_par_priv->type_of_oid == SET_OID) { -+ encry_mode = *((u8 *)poid_par_priv->information_buf); -+ switch (encry_mode) { -+ case HW_CONTROL: -+#if 0 -+ Adapter->registrypriv.software_decrypt = _FALSE; -+ Adapter->registrypriv.software_encrypt = _FALSE; -+#else -+ psecuritypriv->sw_decrypt = _FALSE; -+ psecuritypriv->sw_encrypt = _FALSE; -+#endif -+ break; -+ case SW_CONTROL: -+#if 0 -+ Adapter->registrypriv.software_decrypt = _TRUE; -+ Adapter->registrypriv.software_encrypt = _TRUE; -+#else -+ psecuritypriv->sw_decrypt = _TRUE; -+ psecuritypriv->sw_encrypt = _TRUE; -+#endif -+ break; -+ case HW_ENCRY_SW_DECRY: -+#if 0 -+ Adapter->registrypriv.software_decrypt = _TRUE; -+ Adapter->registrypriv.software_encrypt = _FALSE; -+#else -+ psecuritypriv->sw_decrypt = _TRUE; -+ psecuritypriv->sw_encrypt = _FALSE; -+#endif -+ break; -+ case SW_ENCRY_HW_DECRY: -+#if 0 -+ Adapter->registrypriv.software_decrypt = _FALSE; -+ Adapter->registrypriv.software_encrypt = _TRUE; -+#else -+ psecuritypriv->sw_decrypt = _FALSE; -+ psecuritypriv->sw_encrypt = _TRUE; -+#endif -+ break; -+ } -+ -+ } else { -+#if 0 -+ if (Adapter->registrypriv.software_encrypt == _FALSE) { -+ if (Adapter->registrypriv.software_decrypt == _FALSE) -+ encry_mode = HW_CONTROL; -+ else -+ encry_mode = HW_ENCRY_SW_DECRY; -+ } else { -+ if (Adapter->registrypriv.software_decrypt == _FALSE) -+ encry_mode = SW_ENCRY_HW_DECRY; -+ else -+ encry_mode = SW_CONTROL; -+ } -+#else -+ -+ if ((psecuritypriv->sw_encrypt == _FALSE) && (psecuritypriv->sw_decrypt == _FALSE)) -+ encry_mode = HW_CONTROL; -+ else if ((psecuritypriv->sw_encrypt == _FALSE) && (psecuritypriv->sw_decrypt == _TRUE)) -+ encry_mode = HW_ENCRY_SW_DECRY; -+ else if ((psecuritypriv->sw_encrypt == _TRUE) && (psecuritypriv->sw_decrypt == _FALSE)) -+ encry_mode = SW_ENCRY_HW_DECRY; -+ else if ((psecuritypriv->sw_encrypt == _TRUE) && (psecuritypriv->sw_decrypt == _TRUE)) -+ encry_mode = SW_CONTROL; -+ -+#endif -+ -+ *(u8 *)poid_par_priv->information_buf = encry_mode; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ } -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_add_sta_info_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ struct sta_info *psta = NULL; -+ UCHAR *macaddr; -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ *poid_par_priv->bytes_needed = ETH_ALEN; -+ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ macaddr = (UCHAR *) poid_par_priv->information_buf ; -+ -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ psta = rtw_get_stainfo(&Adapter->stapriv, macaddr); -+ -+ if (psta == NULL) { /* the sta have been in sta_info_queue => do nothing */ -+ psta = rtw_alloc_stainfo(&Adapter->stapriv, macaddr); -+ -+ if (psta == NULL) { -+ status = NDIS_STATUS_FAILURE; -+ } -+ } -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ struct sta_info *psta = NULL; -+ UCHAR *macaddr; -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ *poid_par_priv->bytes_needed = ETH_ALEN; -+ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ macaddr = (UCHAR *) poid_par_priv->information_buf ; -+ -+ psta = rtw_get_stainfo(&Adapter->stapriv, macaddr); -+ if (psta != NULL) { -+ /* _enter_critical(&(Adapter->stapriv.sta_hash_lock), &irqL); */ -+ rtw_free_stainfo(Adapter, psta); -+ /* _exit_critical(&(Adapter->stapriv.sta_hash_lock), &irqL); */ -+ } -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+#if 0 -+static u32 mp_query_drv_var(_adapter *padapter, u8 offset, u32 var) -+{ -+#ifdef CONFIG_SDIO_HCI -+ -+ if (offset == 1) { -+ u16 tmp_blk_num; -+ tmp_blk_num = rtw_read16(padapter, SDIO_RX0_RDYBLK_NUM); -+ if (adapter_to_dvobj(padapter)->rxblknum != tmp_blk_num) { -+ /* sd_recv_rxfifo(padapter); */ -+ } -+ } -+ -+#if 0 -+ if (offset <= 100) { /* For setting data rate and query data rate */ -+ if (offset == 100) { /* For query data rate */ -+ var = padapter->registrypriv.tx_rate; -+ -+ } else if (offset < 0x1d) { /* For setting data rate */ -+ padapter->registrypriv.tx_rate = offset; -+ var = padapter->registrypriv.tx_rate; -+ padapter->registrypriv.use_rate = _TRUE; -+ } else { /* not use the data rate */ -+ padapter->registrypriv.use_rate = _FALSE; -+ } -+ } else if (offset <= 110) { /* for setting debug level */ -+ if (offset == 110) { /* For query data rate */ -+ padapter->registrypriv.dbg_level = GlobalDebugLevel; -+ var = padapter->registrypriv.dbg_level; -+ } else if (offset < 110 && offset > 100) { -+ padapter->registrypriv.dbg_level = GlobalDebugLevel = offset - 100; -+ var = padapter->registrypriv.dbg_level; -+ -+ } -+ } else if (offset > 110 && offset < 116) { -+ if (115 == offset) { -+ } else { -+ switch (offset) { -+ case 111: -+ adapter_to_dvobj(padapter)->tx_block_mode = 1; -+ adapter_to_dvobj(padapter)->rx_block_mode = 1; -+ break; -+ case 112: -+ adapter_to_dvobj(padapter)->tx_block_mode = 1; -+ adapter_to_dvobj(padapter)->rx_block_mode = 0; -+ break; -+ case 113: -+ adapter_to_dvobj(padapter)->tx_block_mode = 0; -+ adapter_to_dvobj(padapter)->rx_block_mode = 1; -+ break; -+ case 114: -+ adapter_to_dvobj(padapter)->tx_block_mode = 0; -+ adapter_to_dvobj(padapter)->rx_block_mode = 0; -+ break; -+ default: -+ break; -+ -+ } -+ -+ } -+ -+ } else if (offset >= 127) { -+ u64 prnt_dbg_comp; -+ u8 chg_idx; -+ u64 tmp_dbg_comp; -+ chg_idx = offset - 0x80; -+ tmp_dbg_comp = BIT(chg_idx); -+ prnt_dbg_comp = padapter->registrypriv.dbg_component = GlobalDebugComponents; -+ if (offset == 127) { -+ /* prnt_dbg_comp=padapter->registrypriv.dbg_component= GlobalDebugComponents; */ -+ var = (u32)(padapter->registrypriv.dbg_component); -+ prnt_dbg_comp = GlobalDebugComponents; -+ prnt_dbg_comp = GlobalDebugComponents = padapter->registrypriv.dbg_component; -+ -+ } else { -+ prnt_dbg_comp = GlobalDebugComponents; -+ prnt_dbg_comp = GlobalDebugComponents = padapter->registrypriv.dbg_component; -+ -+ if (GlobalDebugComponents & tmp_dbg_comp) { -+ /* this bit is already set, now clear it */ -+ GlobalDebugComponents = GlobalDebugComponents & (~tmp_dbg_comp); -+ } else { -+ /* this bit is not set, now set it. */ -+ GlobalDebugComponents = GlobalDebugComponents | tmp_dbg_comp; -+ } -+ prnt_dbg_comp = GlobalDebugComponents; -+ -+ var = (u32)(GlobalDebugComponents); -+ /* GlobalDebugComponents=padapter->registrypriv.dbg_component; */ -+ -+ } -+ } -+#endif -+#endif -+ -+ return var; -+} -+#endif -+ -+NDIS_STATUS oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ DR_VARIABLE_STRUCT *pdrv_var; -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ *poid_par_priv->bytes_needed = sizeof(DR_VARIABLE_STRUCT); -+ if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ -+ pdrv_var = (struct _DR_VARIABLE_STRUCT_ *)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ pdrv_var->variable = mp_query_drv_var(Adapter, pdrv_var->offset, pdrv_var->variable); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ -+ if (poid_par_priv->information_buf_len < sizeof(UCHAR)) { -+ status = NDIS_STATUS_INVALID_LENGTH; -+ *poid_par_priv->bytes_needed = sizeof(UCHAR); -+ return status; -+ } -+ -+ if (poid_par_priv->type_of_oid == SET_OID) { -+ Adapter->mppriv.rx_with_status = *(UCHAR *) poid_par_priv->information_buf; -+ -+ -+ } else { -+ *(UCHAR *) poid_par_priv->information_buf = Adapter->mppriv.rx_with_status; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ /* *(u32 *)&Adapter->eeprompriv.mac_addr[0]=rtw_read32(Adapter, 0x10250050); */ -+ /* *(u16 *)&Adapter->eeprompriv.mac_addr[4]=rtw_read16(Adapter, 0x10250054); */ -+ } -+#endif -+ -+ return NDIS_STATUS_SUCCESS; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ PEFUSE_ACCESS_STRUCT pefuse; -+ u8 *data; -+ u16 addr = 0, cnts = 0, max_available_size = 0; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(EFUSE_ACCESS_STRUCT)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf; -+ addr = pefuse->start_addr; -+ cnts = pefuse->cnts; -+ data = pefuse->data; -+ -+ -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); -+ -+ if ((addr + cnts) > max_available_size) { -+ return NDIS_STATUS_NOT_ACCEPTED; -+ } -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ if (rtw_efuse_access(Adapter, _FALSE, addr, cnts, data) == _FAIL) { -+ status = NDIS_STATUS_FAILURE; -+ } else -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ PEFUSE_ACCESS_STRUCT pefuse; -+ u8 *data; -+ u16 addr = 0, cnts = 0, max_available_size = 0; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf; -+ addr = pefuse->start_addr; -+ cnts = pefuse->cnts; -+ data = pefuse->data; -+ -+ -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); -+ -+ if ((addr + cnts) > max_available_size) { -+ return NDIS_STATUS_NOT_ACCEPTED; -+ } -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ if (rtw_efuse_access(Adapter, _TRUE, addr, cnts, data) == _FAIL) -+ status = NDIS_STATUS_FAILURE; -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ PPGPKT_STRUCT ppgpkt; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ *poid_par_priv->bytes_rw = 0; -+ -+ if (poid_par_priv->information_buf_len < sizeof(PGPKT_STRUCT)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ ppgpkt = (PPGPKT_STRUCT)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (poid_par_priv->type_of_oid == QUERY_OID) { -+ -+ Efuse_PowerSwitch(Adapter, _FALSE, _TRUE); -+ if (Efuse_PgPacketRead(Adapter, ppgpkt->offset, ppgpkt->data, _FALSE) == _TRUE) -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ else -+ status = NDIS_STATUS_FAILURE; -+ Efuse_PowerSwitch(Adapter, _FALSE, _FALSE); -+ } else { -+ -+ Efuse_PowerSwitch(Adapter, _TRUE, _TRUE); -+ if (Efuse_PgPacketWrite(Adapter, ppgpkt->offset, ppgpkt->word_en, ppgpkt->data, _FALSE) == _TRUE) -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ else -+ status = NDIS_STATUS_FAILURE; -+ Efuse_PowerSwitch(Adapter, _TRUE, _FALSE); -+ } -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u16 size; -+ u8 ret; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ ret = efuse_GetCurrentSize(Adapter, &size); -+ _irqlevel_changed_(&oldirql, RAISE); -+ if (ret == _SUCCESS) { -+ *(u32 *)poid_par_priv->information_buf = size; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = NDIS_STATUS_FAILURE; -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_efuse_max_size_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ *(u32 *)poid_par_priv->information_buf = efuse_GetMaxSize(Adapter); -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status; -+ -+ -+ -+ if (poid_par_priv->type_of_oid == QUERY_OID) -+ status = oid_rt_pro_read_efuse_hdl(poid_par_priv); -+ else -+ status = oid_rt_pro_write_efuse_hdl(poid_par_priv); -+ -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u8 *data; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ u16 mapLen = 0; -+ -+ -+ -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); -+ -+ *poid_par_priv->bytes_rw = 0; -+ -+ if (poid_par_priv->information_buf_len < mapLen) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ data = (u8 *)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (poid_par_priv->type_of_oid == QUERY_OID) { -+ -+ if (rtw_efuse_map_read(Adapter, 0, mapLen, data) == _SUCCESS) -+ *poid_par_priv->bytes_rw = mapLen; -+ else { -+ status = NDIS_STATUS_FAILURE; -+ } -+ } else { -+ /* SET_OID */ -+ -+ if (rtw_efuse_map_write(Adapter, 0, mapLen, data) == _SUCCESS) -+ *poid_par_priv->bytes_rw = mapLen; -+ else { -+ status = NDIS_STATUS_FAILURE; -+ } -+ } -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+ -+NDIS_STATUS oid_rt_set_crystal_cap_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ -+ u32 crystal_cap = 0; -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ crystal_cap = *((u32 *)poid_par_priv->information_buf); /* 4 */ -+ if (crystal_cap > 0xf) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ Adapter->mppriv.curr_crystalcap = crystal_cap; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetCrystalCap(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+#endif -+ return status; -+} -+ -+NDIS_STATUS oid_rt_set_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u8 rx_pkt_type; -+ /* u32 rcr_val32; */ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ /* PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); */ -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u8)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ rx_pkt_type = *((u8 *)poid_par_priv->information_buf); /* 4 */ -+ -+#if 0 -+ _irqlevel_changed_(&oldirql, LOWER); -+#if 0 -+ rcr_val8 = rtw_read8(Adapter, 0x10250048);/* RCR */ -+ rcr_val8 &= ~(RCR_AB | RCR_AM | RCR_APM | RCR_AAP); -+ -+ if (rx_pkt_type == RX_PKT_BROADCAST) -+ rcr_val8 |= (RCR_AB | RCR_ACRC32); -+ else if (rx_pkt_type == RX_PKT_DEST_ADDR) -+ rcr_val8 |= (RCR_AAP | RCR_AM | RCR_ACRC32); -+ else if (rx_pkt_type == RX_PKT_PHY_MATCH) -+ rcr_val8 |= (RCR_APM | RCR_ACRC32); -+ else -+ rcr_val8 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32); -+ rtw_write8(padapter, 0x10250048, rcr_val8); -+#else -+ rcr_val32 = rtw_read32(padapter, RCR);/* RCR = 0x10250048 */ -+ rcr_val32 &= ~(RCR_CBSSID | RCR_AB | RCR_AM | RCR_APM | RCR_AAP); -+#if 0 -+ if (rx_pkt_type == RX_PKT_BROADCAST) -+ rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32); -+ else if (rx_pkt_type == RX_PKT_DEST_ADDR) { -+ /* rcr_val32 |= (RCR_CBSSID|RCR_AAP|RCR_AM|RCR_ACRC32); */ -+ rcr_val32 |= (RCR_CBSSID | RCR_APM | RCR_ACRC32); -+ } else if (rx_pkt_type == RX_PKT_PHY_MATCH) { -+ rcr_val32 |= (RCR_APM | RCR_ACRC32); -+ /* rcr_val32 |= (RCR_AAP|RCR_ACRC32); */ -+ } else -+ rcr_val32 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32); -+#else -+ switch (rx_pkt_type) { -+ case RX_PKT_BROADCAST: -+ rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32); -+ break; -+ case RX_PKT_DEST_ADDR: -+ rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32); -+ break; -+ case RX_PKT_PHY_MATCH: -+ rcr_val32 |= (RCR_APM | RCR_ACRC32); -+ break; -+ default: -+ rcr_val32 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32); -+ break; -+ } -+ -+ if (rx_pkt_type == RX_PKT_DEST_ADDR) -+ padapter->mppriv.check_mp_pkt = 1; -+ else -+ padapter->mppriv.check_mp_pkt = 0; -+#endif -+ rtw_write32(padapter, RCR, rcr_val32); -+ -+#endif -+ _irqlevel_changed_(&oldirql, RAISE); -+#endif -+ -+ return status; -+} -+ -+NDIS_STATUS oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ u32 txagc; -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ txagc = *(u32 *)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetTxAGCOffset(Adapter, txagc); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+ -+NDIS_STATUS oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ struct mp_priv *pmppriv = &Adapter->mppriv; -+ u32 type; -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return NDIS_STATUS_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return NDIS_STATUS_INVALID_LENGTH; -+ -+ type = *(u32 *)poid_par_priv->information_buf; -+ -+ if (_LOOPBOOK_MODE_ == type) { -+ pmppriv->mode = type; -+ set_fwstate(pmlmepriv, WIFI_MP_LPBK_STATE); /* append txdesc */ -+ } else if (_2MAC_MODE_ == type) { -+ pmppriv->mode = type; -+ _clr_fwstate_(pmlmepriv, WIFI_MP_LPBK_STATE); -+ } else -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -+ -+unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ PMP_XMIT_PARM pparm; -+ PADAPTER padapter; -+ struct mp_priv *pmp_priv; -+ struct pkt_attrib *pattrib; -+ -+ -+ pparm = (PMP_XMIT_PARM)poid_par_priv->information_buf; -+ padapter = (PADAPTER)poid_par_priv->adapter_context; -+ pmp_priv = &padapter->mppriv; -+ -+ if (poid_par_priv->type_of_oid == QUERY_OID) { -+ pparm->enable = !pmp_priv->tx.stop; -+ pparm->count = pmp_priv->tx.sended; -+ } else { -+ if (pparm->enable == 0) -+ pmp_priv->tx.stop = 1; -+ else if (pmp_priv->tx.stop == 1) { -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx.count = pparm->count; -+ pmp_priv->tx.payload = pparm->payload_type; -+ pattrib = &pmp_priv->tx.attrib; -+ pattrib->pktlen = pparm->length; -+ _rtw_memcpy(pattrib->dst, pparm->da, ETH_ALEN); -+ SetPacketTx(padapter); -+ } else -+ return NDIS_STATUS_FAILURE; -+ } -+ -+ return NDIS_STATUS_SUCCESS; -+} -+ -+#if 0 -+unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ unsigned char *pframe, *pmp_pkt; -+ struct ethhdr *pethhdr; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ int llc_sz, payload_len; -+ struct mp_xmit_frame *pxframe = NULL; -+ struct mp_xmit_packet *pmp_xmitpkt = (struct mp_xmit_packet *)param; -+ u8 addr3[] = {0x02, 0xE0, 0x4C, 0x87, 0x66, 0x55}; -+ -+ /* RTW_INFO("+mp_ioctl_xmit_packet_hdl\n"); */ -+ -+ pxframe = alloc_mp_xmitframe(&padapter->mppriv); -+ if (pxframe == NULL) { -+ DEBUG_ERR(("Can't alloc pmpframe %d:%s\n", __LINE__, __FILE__)); -+ return -1; -+ } -+ -+ /* mp_xmit_pkt */ -+ payload_len = pmp_xmitpkt->len - 14; -+ pmp_pkt = (unsigned char *)pmp_xmitpkt->mem; -+ pethhdr = (struct ethhdr *)pmp_pkt; -+ -+ /* RTW_INFO("payload_len=%d, pkt_mem=0x%x\n", pmp_xmitpkt->len, (void*)pmp_xmitpkt->mem); */ -+ -+ /* RTW_INFO("pxframe=0x%x\n", (void*)pxframe); */ -+ /* RTW_INFO("pxframe->mem=0x%x\n", (void*)pxframe->mem); */ -+ -+ /* update attribute */ -+ pattrib = &pxframe->attrib; -+ memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); -+ pattrib->pktlen = pmp_xmitpkt->len; -+ pattrib->ether_type = ntohs(pethhdr->h_proto); -+ pattrib->hdrlen = 24; -+ pattrib->nr_frags = 1; -+ pattrib->priority = 0; -+#ifndef CONFIG_MP_LINUX -+ if (IS_MCAST(pethhdr->h_dest)) -+ pattrib->mac_id = 4; -+ else -+ pattrib->mac_id = 5; -+#else -+ pattrib->mac_id = 5; -+#endif -+ -+ /* */ -+ memset(pxframe->mem, 0 , WLANHDR_OFFSET); -+ pframe = (u8 *)(pxframe->mem) + WLANHDR_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ SetFrameSubType(pframe, WIFI_DATA); -+ -+ _rtw_memcpy(pwlanhdr->addr1, pethhdr->h_dest, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pethhdr->h_source, ETH_ALEN); -+ -+ _rtw_memcpy(pwlanhdr->addr3, addr3, ETH_ALEN); -+ -+ pwlanhdr->seq_ctl = 0; -+ pframe += pattrib->hdrlen; -+ -+ llc_sz = rtw_put_snap(pframe, pattrib->ether_type); -+ pframe += llc_sz; -+ -+ _rtw_memcpy(pframe, (void *)(pmp_pkt + 14), payload_len); -+ -+ pattrib->last_txcmdsz = pattrib->hdrlen + llc_sz + payload_len; -+ -+ DEBUG_INFO(("issuing mp_xmit_frame, tx_len=%d, ether_type=0x%x\n", pattrib->last_txcmdsz, pattrib->ether_type)); -+ xmit_mp_frame(padapter, pxframe); -+ -+ return _SUCCESS; -+} -+#endif -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_set_power_down_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#ifdef PLATFORM_OS_XP -+ _irqL oldirql; -+#endif -+ u8 bpwrup; -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+#ifdef PLATFORM_LINUX -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+#endif -+#endif -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ bpwrup = *(u8 *)poid_par_priv->information_buf; -+ /* CALL the power_down function */ -+#ifdef PLATFORM_LINUX -+#if defined(CONFIG_RTL8712) /* Linux MP insmod unknown symbol */ -+ dev_power_down(padapter, bpwrup); -+#endif -+#endif -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ /* DEBUG_ERR(("\n <=== Query OID_RT_PRO_READ_REGISTER. */ -+ /* Add:0x%08x Width:%d Value:0x%08x\n",RegRWStruct->offset,RegRWStruct->width,RegRWStruct->value)); */ -+ -+ -+ return status; -+} -+/* ------------------------------------------------------------------------------ */ -+NDIS_STATUS oid_rt_get_power_mode_hdl(struct oid_par_priv *poid_par_priv) -+{ -+#if 0 -+ NDIS_STATUS status = NDIS_STATUS_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ /* #ifdef PLATFORM_OS_XP */ -+ /* _irqL oldirql; -+ * #endif */ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = NDIS_STATUS_NOT_ACCEPTED; -+ return status; -+ } -+ if (poid_par_priv->information_buf_len < sizeof(u32)) { -+ status = NDIS_STATUS_INVALID_LENGTH; -+ return status; -+ } -+ -+ -+ /* _irqlevel_changed_(&oldirql, LOWER); */ -+ *(int *)poid_par_priv->information_buf = Adapter->registrypriv.low_power ? POWER_LOW : POWER_NORMAL; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ /* _irqlevel_changed_(&oldirql, RAISE); */ -+ -+ -+ return status; -+#else -+ return 0; -+#endif -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_odm.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_odm.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_odm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_odm.c 2018-02-11 21:44:27.140145979 +0200 -@@ -0,0 +1,577 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+ -+const char *odm_comp_str[] = { -+ /* BIT0 */"ODM_COMP_DIG", -+ /* BIT1 */"ODM_COMP_RA_MASK", -+ /* BIT2 */"ODM_COMP_DYNAMIC_TXPWR", -+ /* BIT3 */"ODM_COMP_FA_CNT", -+ /* BIT4 */"ODM_COMP_RSSI_MONITOR", -+ /* BIT5 */"ODM_COMP_SNIFFER", -+ /* BIT6 */"ODM_COMP_ANT_DIV", -+ /* BIT7 */"ODM_COMP_DFS", -+ /* BIT8 */"ODM_COMP_NOISY_DETECT", -+ /* BIT9 */"ODM_COMP_RATE_ADAPTIVE", -+ /* BIT10 */"ODM_COMP_PATH_DIV", -+ /* BIT11 */"ODM_COMP_CCX", -+ /* BIT12 */"ODM_COMP_DYNAMIC_PRICCA", -+ /* BIT13 */NULL, -+ /* BIT14 */"ODM_COMP_MP", -+ /* BIT15 */"ODM_COMP_CFO_TRACKING", -+ /* BIT16 */"ODM_COMP_ACS", -+ /* BIT17 */"PHYDM_COMP_ADAPTIVITY", -+ /* BIT18 */"PHYDM_COMP_RA_DBG", -+ /* BIT19 */"PHYDM_COMP_TXBF", -+ /* BIT20 */"ODM_COMP_EDCA_TURBO", -+ /* BIT21 */"ODM_COMP_EARLY_MODE", -+ /* BIT22 */"ODM_FW_DEBUG_TRACE", -+ /* BIT23 */NULL, -+ /* BIT24 */"ODM_COMP_TX_PWR_TRACK", -+ /* BIT25 */"ODM_COMP_RX_GAIN_TRACK", -+ /* BIT26 */"ODM_COMP_CALIBRATION", -+ /* BIT27 */NULL, -+ /* BIT28 */"ODM_PHY_CONFIG", -+ /* BIT29 */"ODM_COMP_INIT", -+ /* BIT30 */"ODM_COMP_COMMON", -+}; -+ -+#define RTW_ODM_COMP_MAX 31 -+ -+const char *odm_ability_str[] = { -+ /* BIT0 */"ODM_BB_DIG", -+ /* BIT1 */"ODM_BB_RA_MASK", -+ /* BIT2 */"ODM_BB_DYNAMIC_TXPWR", -+ /* BIT3 */"ODM_BB_FA_CNT", -+ /* BIT4 */"ODM_BB_RSSI_MONITOR", -+ /* BIT5 */"ODM_BB_CCK_PD", -+ /* BIT6 */"ODM_BB_ANT_DIV", -+ /* BIT7 */NULL, -+ /* BIT8 */"ODM_BB_PWR_TRAIN", -+ /* BIT9 */"ODM_BB_RATE_ADAPTIVE", -+ /* BIT10 */"ODM_BB_PATH_DIV", -+ /* BIT11 */NULL, -+ /* BIT12 */NULL, -+ /* BIT13 */"ODM_BB_ADAPTIVITY", -+ /* BIT14 */"ODM_BB_CFO_TRACKING", -+ /* BIT15 */"ODM_BB_NHM_CNT", -+ /* BIT16 */"ODM_BB_PRIMARY_CCA", -+ /* BIT17 */"ODM_BB_TXBF", -+ /* BIT18 */"ODM_BB_DYNAMIC_ARFR", -+ /* BIT19 */NULL, -+ /* BIT20 */"ODM_MAC_EDCA_TURBO", -+ /* BIT21 */"ODM_MAC_EARLY_MODE", -+ /* BIT22 */NULL, -+ /* BIT23 */NULL, -+ /* BIT24 */"ODM_RF_TX_PWR_TRACK", -+ /* BIT25 */"ODM_RF_RX_GAIN_TRACK", -+ /* BIT26 */"ODM_RF_CALIBRATION", -+}; -+ -+#define RTW_ODM_ABILITY_MAX 27 -+ -+const char *odm_dbg_level_str[] = { -+ NULL, -+ "ODM_DBG_OFF", -+ "ODM_DBG_SERIOUS", -+ "ODM_DBG_WARNING", -+ "ODM_DBG_LOUD", -+ "ODM_DBG_TRACE", -+}; -+ -+#define RTW_ODM_DBG_LEVEL_NUM 6 -+ -+void rtw_odm_dbg_comp_msg(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &pHalData->odmpriv; -+ int cnt = 0; -+ u64 dbg_comp = 0; -+ int i; -+ -+ rtw_hal_get_odm_var(adapter, HAL_ODM_DBG_FLAG, &dbg_comp, NULL); -+ -+ RTW_PRINT_SEL(sel, "odm.DebugComponents = 0x%016llx\n", dbg_comp); -+ for (i = 0; i < RTW_ODM_COMP_MAX; i++) { -+ if (odm_comp_str[i]) -+ RTW_PRINT_SEL(sel, "%cBIT%-2d %s\n", -+ (BIT0 & (dbg_comp >> i)) ? '+' : ' ', i, odm_comp_str[i]); -+ } -+} -+ -+inline void rtw_odm_dbg_comp_set(_adapter *adapter, u64 comps) -+{ -+ rtw_hal_set_odm_var(adapter, HAL_ODM_DBG_FLAG, &comps, _FALSE); -+} -+ -+void rtw_odm_dbg_level_msg(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &pHalData->odmpriv; -+ int cnt = 0; -+ u32 dbg_level = 0; -+ int i; -+ -+ rtw_hal_get_odm_var(adapter, HAL_ODM_DBG_LEVEL, &dbg_level, NULL); -+ RTW_PRINT_SEL(sel, "odm.DebugLevel = %u\n", dbg_level); -+ for (i = 0; i < RTW_ODM_DBG_LEVEL_NUM; i++) { -+ if (odm_dbg_level_str[i]) -+ RTW_PRINT_SEL(sel, "%u %s\n", i, odm_dbg_level_str[i]); -+ } -+} -+ -+inline void rtw_odm_dbg_level_set(_adapter *adapter, u32 level) -+{ -+ rtw_hal_set_odm_var(adapter, HAL_ODM_DBG_LEVEL, &level, _FALSE); -+} -+ -+void rtw_odm_ability_msg(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &pHalData->odmpriv; -+ int cnt = 0; -+ u32 ability = 0; -+ int i; -+ -+ ability = rtw_phydm_ability_get(adapter); -+ RTW_PRINT_SEL(sel, "odm.SupportAbility = 0x%08x\n", ability); -+ for (i = 0; i < RTW_ODM_ABILITY_MAX; i++) { -+ if (odm_ability_str[i]) -+ RTW_PRINT_SEL(sel, "%cBIT%-2d %s\n", -+ (BIT0 << i) & ability ? '+' : ' ', i, odm_ability_str[i]); -+ } -+} -+ -+inline void rtw_odm_ability_set(_adapter *adapter, u32 ability) -+{ -+ rtw_phydm_ability_set(adapter, ability); -+} -+ -+/* set ODM_CMNINFO_IC_TYPE based on chip_type */ -+void rtw_odm_init_ic_type(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &hal_data->odmpriv; -+ u4Byte ic_type = chip_type_to_odm_ic_type(rtw_get_chip_type(adapter)); -+ -+ rtw_warn_on(!ic_type); -+ -+ ODM_CmnInfoInit(odm, ODM_CMNINFO_IC_TYPE, ic_type); -+} -+ -+inline void rtw_odm_set_force_igi_lb(_adapter *adapter, u8 lb) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ hal_data->u1ForcedIgiLb = lb; -+} -+ -+inline u8 rtw_odm_get_force_igi_lb(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ return hal_data->u1ForcedIgiLb; -+} -+ -+void rtw_odm_adaptivity_ver_msg(void *sel, _adapter *adapter) -+{ -+ RTW_PRINT_SEL(sel, "ADAPTIVITY_VERSION "ADAPTIVITY_VERSION"\n"); -+} -+ -+#define RTW_ADAPTIVITY_EN_DISABLE 0 -+#define RTW_ADAPTIVITY_EN_ENABLE 1 -+ -+void rtw_odm_adaptivity_en_msg(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regsty = &adapter->registrypriv; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &hal_data->odmpriv; -+ -+ RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_EN_"); -+ -+ if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_DISABLE) -+ _RTW_PRINT_SEL(sel, "DISABLE\n"); -+ else if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_ENABLE) -+ _RTW_PRINT_SEL(sel, "ENABLE\n"); -+ else -+ _RTW_PRINT_SEL(sel, "INVALID\n"); -+} -+ -+#define RTW_ADAPTIVITY_MODE_NORMAL 0 -+#define RTW_ADAPTIVITY_MODE_CARRIER_SENSE 1 -+ -+void rtw_odm_adaptivity_mode_msg(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regsty = &adapter->registrypriv; -+ -+ RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_MODE_"); -+ -+ if (regsty->adaptivity_mode == RTW_ADAPTIVITY_MODE_NORMAL) -+ _RTW_PRINT_SEL(sel, "NORMAL\n"); -+ else if (regsty->adaptivity_mode == RTW_ADAPTIVITY_MODE_CARRIER_SENSE) -+ _RTW_PRINT_SEL(sel, "CARRIER_SENSE\n"); -+ else -+ _RTW_PRINT_SEL(sel, "INVALID\n"); -+} -+ -+#define RTW_ADAPTIVITY_DML_DISABLE 0 -+#define RTW_ADAPTIVITY_DML_ENABLE 1 -+ -+void rtw_odm_adaptivity_dml_msg(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regsty = &adapter->registrypriv; -+ -+ RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_DML_"); -+ -+ if (regsty->adaptivity_dml == RTW_ADAPTIVITY_DML_DISABLE) -+ _RTW_PRINT_SEL(sel, "DISABLE\n"); -+ else if (regsty->adaptivity_dml == RTW_ADAPTIVITY_DML_ENABLE) -+ _RTW_PRINT_SEL(sel, "ENABLE\n"); -+ else -+ _RTW_PRINT_SEL(sel, "INVALID\n"); -+} -+ -+void rtw_odm_adaptivity_dc_backoff_msg(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regsty = &adapter->registrypriv; -+ -+ RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_DC_BACKOFF:%u\n", regsty->adaptivity_dc_backoff); -+} -+ -+void rtw_odm_adaptivity_config_msg(void *sel, _adapter *adapter) -+{ -+ rtw_odm_adaptivity_ver_msg(sel, adapter); -+ rtw_odm_adaptivity_en_msg(sel, adapter); -+ rtw_odm_adaptivity_mode_msg(sel, adapter); -+ rtw_odm_adaptivity_dml_msg(sel, adapter); -+ rtw_odm_adaptivity_dc_backoff_msg(sel, adapter); -+} -+ -+bool rtw_odm_adaptivity_needed(_adapter *adapter) -+{ -+ struct registry_priv *regsty = &adapter->registrypriv; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ bool ret = _FALSE; -+ -+ if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_ENABLE) -+ ret = _TRUE; -+ -+ return ret; -+} -+ -+void rtw_odm_adaptivity_parm_msg(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &pHalData->odmpriv; -+ -+ rtw_odm_adaptivity_config_msg(sel, adapter); -+ -+ RTW_PRINT_SEL(sel, "%10s %16s %16s %22s %12s\n" -+ , "TH_L2H_ini", "TH_EDCCA_HL_diff", "TH_L2H_ini_mode2", "TH_EDCCA_HL_diff_mode2", "EDCCA_enable"); -+ RTW_PRINT_SEL(sel, "0x%-8x %-16d 0x%-14x %-22d %-12d\n" -+ , (u8)odm->TH_L2H_ini -+ , odm->TH_EDCCA_HL_diff -+ , (u8)odm->TH_L2H_ini_mode2 -+ , odm->TH_EDCCA_HL_diff_mode2 -+ , odm->EDCCA_enable -+ ); -+ -+ RTW_PRINT_SEL(sel, "%15s %9s\n", "AdapEnableState", "Adap_Flag"); -+ RTW_PRINT_SEL(sel, "%-15x %-9x\n" -+ , odm->Adaptivity_enable -+ , odm->adaptivity_flag -+ ); -+} -+ -+void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff, s8 TH_L2H_ini_mode2, s8 TH_EDCCA_HL_diff_mode2, u8 EDCCA_enable) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &pHalData->odmpriv; -+ -+ odm->TH_L2H_ini = TH_L2H_ini; -+ odm->TH_EDCCA_HL_diff = TH_EDCCA_HL_diff; -+ odm->TH_L2H_ini_mode2 = TH_L2H_ini_mode2; -+ odm->TH_EDCCA_HL_diff_mode2 = TH_EDCCA_HL_diff_mode2; -+ odm->EDCCA_enable = EDCCA_enable; -+} -+ -+void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &(hal_data->odmpriv); -+ -+ RTW_PRINT_SEL(sel, "RxRate = %s, RSSI_A = %d(%%), RSSI_B = %d(%%)\n", -+ HDATA_RATE(odm->RxRate), odm->RSSI_A, odm->RSSI_B); -+} -+ -+ -+void rtw_odm_acquirespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ _irqL irqL; -+ -+ switch (type) { -+ case RT_IQK_SPINLOCK: -+ _enter_critical_bh(&pHalData->IQKSpinLock, &irqL); -+ default: -+ break; -+ } -+} -+ -+void rtw_odm_releasespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ _irqL irqL; -+ -+ switch (type) { -+ case RT_IQK_SPINLOCK: -+ _exit_critical_bh(&pHalData->IQKSpinLock, &irqL); -+ default: -+ break; -+ } -+} -+ -+#ifdef CONFIG_DFS_MASTER -+inline u8 rtw_odm_get_dfs_domain(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ PDM_ODM_T pDM_Odm = &(hal_data->odmpriv); -+ -+ return pDM_Odm->DFS_RegionDomain; -+} -+ -+inline VOID rtw_odm_radar_detect_reset(_adapter *adapter) -+{ -+ phydm_radar_detect_reset(GET_ODM(adapter)); -+} -+ -+inline VOID rtw_odm_radar_detect_disable(_adapter *adapter) -+{ -+ phydm_radar_detect_disable(GET_ODM(adapter)); -+} -+ -+/* called after ch, bw is set */ -+inline VOID rtw_odm_radar_detect_enable(_adapter *adapter) -+{ -+ phydm_radar_detect_enable(GET_ODM(adapter)); -+} -+ -+inline BOOLEAN rtw_odm_radar_detect(_adapter *adapter) -+{ -+ return phydm_radar_detect(GET_ODM(adapter)); -+} -+#endif /* CONFIG_DFS_MASTER */ -+ -+void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys) -+{ -+#ifndef DBG_RX_PHYSTATUS_CHINFO -+#define DBG_RX_PHYSTATUS_CHINFO 0 -+#endif -+ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+ _adapter *adapter = rframe->u.hdr.adapter; -+ struct rx_pkt_attrib *attrib = &rframe->u.hdr.attrib; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 *wlanhdr = get_recvframe_data(rframe); -+ -+ if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) { -+ /* -+ * 8723D: -+ * type_0(CCK) -+ * l_rxsc -+ * is filled with primary channel SC, not real rxsc. -+ * 0:LSC, 1:USC -+ * type_1(OFDM) -+ * rf_mode -+ * RF bandwidth when RX -+ * l_rxsc(legacy), ht_rxsc -+ * see below RXSC N-series -+ * type_2(Not used) -+ */ -+ /* -+ * 8821C, 8822B: -+ * type_0(CCK) -+ * l_rxsc -+ * is filled with primary channel SC, not real rxsc. -+ * 0:LSC, 1:USC -+ * type_1(OFDM) -+ * rf_mode -+ * RF bandwidth when RX -+ * l_rxsc(legacy), ht_rxsc -+ * see below RXSC AC-series -+ * type_2(Not used) -+ */ -+ -+ if ((*phys & 0xf) == 0) { -+ struct _Phy_Status_Rpt_Jaguar2_Type0 *phys_t0 = (struct _Phy_Status_Rpt_Jaguar2_Type0 *)phys; -+ -+ if (DBG_RX_PHYSTATUS_CHINFO) { -+ RTW_PRINT("phys_t%u ta="MAC_FMT" %s, %s(band:%u, ch:%u, l_rxsc:%u)\n" -+ , *phys & 0xf -+ , MAC_ARG(get_ta(wlanhdr)) -+ , is_broadcast_mac_addr(get_ra(wlanhdr)) ? "BC" : is_multicast_mac_addr(get_ra(wlanhdr)) ? "MC" : "UC" -+ , HDATA_RATE(attrib->data_rate) -+ , phys_t0->band, phys_t0->channel, phys_t0->rxsc -+ ); -+ } -+ -+ } else if ((*phys & 0xf) == 1) { -+ struct _Phy_Status_Rpt_Jaguar2_Type1 *phys_t1 = (struct _Phy_Status_Rpt_Jaguar2_Type1 *)phys; -+ u8 rxsc = (attrib->data_rate > DESC_RATE11M && attrib->data_rate < DESC_RATEMCS0) ? phys_t1->l_rxsc : phys_t1->ht_rxsc; -+ u8 pkt_cch = 0; -+ u8 pkt_bw = CHANNEL_WIDTH_20; -+ -+ #if ODM_IC_11N_SERIES_SUPPORT -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ /* RXSC N-series */ -+ #define RXSC_DUP 0 -+ #define RXSC_LSC 1 -+ #define RXSC_USC 2 -+ #define RXSC_40M 3 -+ -+ static const s8 cch_offset_by_rxsc[4] = {0, -2, 2, 0}; -+ -+ if (phys_t1->rf_mode == 0) { -+ pkt_cch = phys_t1->channel; -+ pkt_bw = CHANNEL_WIDTH_20; -+ } else if (phys_t1->rf_mode == 1) { -+ if (rxsc == RXSC_LSC || rxsc == RXSC_USC) { -+ pkt_cch = phys_t1->channel + cch_offset_by_rxsc[rxsc]; -+ pkt_bw = CHANNEL_WIDTH_20; -+ } else if (rxsc == RXSC_40M) { -+ pkt_cch = phys_t1->channel; -+ pkt_bw = CHANNEL_WIDTH_40; -+ } -+ } else -+ rtw_warn_on(1); -+ -+ goto type1_end; -+ } -+ #endif /* ODM_IC_11N_SERIES_SUPPORT */ -+ -+ #if ODM_IC_11AC_SERIES_SUPPORT -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ /* RXSC AC-series */ -+ #define RXSC_DUP 0 /* 0: RX from all SC of current rf_mode */ -+ -+ #define RXSC_LL20M_OF_160M 8 /* 1~8: RX from 20MHz SC */ -+ #define RXSC_L20M_OF_160M 6 -+ #define RXSC_L20M_OF_80M 4 -+ #define RXSC_L20M_OF_40M 2 -+ #define RXSC_U20M_OF_40M 1 -+ #define RXSC_U20M_OF_80M 3 -+ #define RXSC_U20M_OF_160M 5 -+ #define RXSC_UU20M_OF_160M 7 -+ -+ #define RXSC_L40M_OF_160M 12 /* 9~12: RX from 40MHz SC */ -+ #define RXSC_L40M_OF_80M 10 -+ #define RXSC_U40M_OF_80M 9 -+ #define RXSC_U40M_OF_160M 11 -+ -+ #define RXSC_L80M_OF_160M 14 /* 13~14: RX from 80MHz SC */ -+ #define RXSC_U80M_OF_160M 13 -+ -+ static const s8 cch_offset_by_rxsc[15] = {0, 2, -2, 6, -6, 10, -10, 14, -14, 4, -4, 12, -12, 8, -8}; -+ -+ if (phys_t1->rf_mode > 3) { -+ /* invalid rf_mode */ -+ rtw_warn_on(1); -+ goto type1_end; -+ } -+ -+ if (phys_t1->rf_mode == 0) { -+ /* RF 20MHz */ -+ pkt_cch = phys_t1->channel; -+ pkt_bw = CHANNEL_WIDTH_20; -+ goto type1_end; -+ } -+ -+ if (rxsc == 0) { -+ /* RF and RX with same BW */ -+ if (attrib->data_rate >= DESC_RATEMCS0) { -+ pkt_cch = phys_t1->channel; -+ pkt_bw = phys_t1->rf_mode; -+ } -+ goto type1_end; -+ } -+ -+ if ((phys_t1->rf_mode == 1 && rxsc >= 1 && rxsc <= 2) /* RF 40MHz, RX 20MHz */ -+ || (phys_t1->rf_mode == 2 && rxsc >= 1 && rxsc <= 4) /* RF 80MHz, RX 20MHz */ -+ || (phys_t1->rf_mode == 3 && rxsc >= 1 && rxsc <= 8) /* RF 160MHz, RX 20MHz */ -+ ) { -+ pkt_cch = phys_t1->channel + cch_offset_by_rxsc[rxsc]; -+ pkt_bw = CHANNEL_WIDTH_20; -+ } else if ((phys_t1->rf_mode == 2 && rxsc >= 9 && rxsc <= 10) /* RF 80MHz, RX 40MHz */ -+ || (phys_t1->rf_mode == 3 && rxsc >= 9 && rxsc <= 12) /* RF 160MHz, RX 40MHz */ -+ ) { -+ if (attrib->data_rate >= DESC_RATEMCS0) { -+ pkt_cch = phys_t1->channel + cch_offset_by_rxsc[rxsc]; -+ pkt_bw = CHANNEL_WIDTH_40; -+ } -+ } else if ((phys_t1->rf_mode == 3 && rxsc >= 13 && rxsc <= 14) /* RF 160MHz, RX 80MHz */ -+ ) { -+ if (attrib->data_rate >= DESC_RATEMCS0) { -+ pkt_cch = phys_t1->channel + cch_offset_by_rxsc[rxsc]; -+ pkt_bw = CHANNEL_WIDTH_80; -+ } -+ } else -+ rtw_warn_on(1); -+ -+ } -+ #endif /* ODM_IC_11AC_SERIES_SUPPORT */ -+ -+type1_end: -+ if (DBG_RX_PHYSTATUS_CHINFO) { -+ RTW_PRINT("phys_t%u ta="MAC_FMT" %s, %s(band:%u, ch:%u, rf_mode:%u, l_rxsc:%u, ht_rxsc:%u) => %u,%u\n" -+ , *phys & 0xf -+ , MAC_ARG(get_ta(wlanhdr)) -+ , is_broadcast_mac_addr(get_ra(wlanhdr)) ? "BC" : is_multicast_mac_addr(get_ra(wlanhdr)) ? "MC" : "UC" -+ , HDATA_RATE(attrib->data_rate) -+ , phys_t1->band, phys_t1->channel, phys_t1->rf_mode, phys_t1->l_rxsc, phys_t1->ht_rxsc -+ , pkt_cch, pkt_bw -+ ); -+ } -+ -+ /* for now, only return cneter channel of 20MHz packet */ -+ if (pkt_cch && pkt_bw == CHANNEL_WIDTH_20) -+ attrib->ch = pkt_cch; -+ -+ } else { -+ struct _Phy_Status_Rpt_Jaguar2_Type2 *phys_t2 = (struct _Phy_Status_Rpt_Jaguar2_Type2 *)phys; -+ -+ if (DBG_RX_PHYSTATUS_CHINFO) { -+ RTW_PRINT("phys_t%u ta="MAC_FMT" %s, %s(band:%u, ch:%u, l_rxsc:%u, ht_rxsc:%u)\n" -+ , *phys & 0xf -+ , MAC_ARG(get_ta(wlanhdr)) -+ , is_broadcast_mac_addr(get_ra(wlanhdr)) ? "BC" : is_multicast_mac_addr(get_ra(wlanhdr)) ? "MC" : "UC" -+ , HDATA_RATE(attrib->data_rate) -+ , phys_t2->band, phys_t2->channel, phys_t2->l_rxsc, phys_t2->ht_rxsc -+ ); -+ } -+ } -+ } -+#endif /* (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) */ -+ -+} -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_p2p.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_p2p.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_p2p.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_p2p.c 2018-02-11 21:44:27.140145979 +0200 -@@ -0,0 +1,5291 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_P2P_C_ -+ -+#include -+ -+#ifdef CONFIG_P2P -+ -+int rtw_p2p_is_channel_list_ok(u8 desired_ch, u8 *ch_list, u8 ch_cnt) -+{ -+ int found = 0, i = 0; -+ -+ for (i = 0; i < ch_cnt; i++) { -+ if (ch_list[i] == desired_ch) { -+ found = 1; -+ break; -+ } -+ } -+ return found ; -+} -+ -+int is_any_client_associated(_adapter *padapter) -+{ -+ return padapter->stapriv.asoc_list_cnt ? _TRUE : _FALSE; -+} -+ -+static u32 go_add_group_info_attr(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ u32 len = 0; -+ u16 attr_len = 0; -+ u8 tmplen, *pdata_attr, *pstart, *pcur; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = pwdinfo->padapter; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ pdata_attr = rtw_zmalloc(MAX_P2P_IE_LEN); -+ -+ if (NULL == pdata_attr) { -+ RTW_INFO("%s pdata_attr malloc failed\n", __FUNCTION__); -+ goto _exit; -+ } -+ -+ pstart = pdata_attr; -+ pcur = pdata_attr; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* look up sta asoc_queue */ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ -+ if (psta->is_p2p_device) { -+ tmplen = 0; -+ -+ pcur++; -+ -+ /* P2P device address */ -+ _rtw_memcpy(pcur, psta->dev_addr, ETH_ALEN); -+ pcur += ETH_ALEN; -+ -+ /* P2P interface address */ -+ _rtw_memcpy(pcur, psta->hwaddr, ETH_ALEN); -+ pcur += ETH_ALEN; -+ -+ *pcur = psta->dev_cap; -+ pcur++; -+ -+ /* *(u16*)(pcur) = cpu_to_be16(psta->config_methods); */ -+ RTW_PUT_BE16(pcur, psta->config_methods); -+ pcur += 2; -+ -+ _rtw_memcpy(pcur, psta->primary_dev_type, 8); -+ pcur += 8; -+ -+ *pcur = psta->num_of_secdev_type; -+ pcur++; -+ -+ _rtw_memcpy(pcur, psta->secdev_types_list, psta->num_of_secdev_type * 8); -+ pcur += psta->num_of_secdev_type * 8; -+ -+ if (psta->dev_name_len > 0) { -+ /* *(u16*)(pcur) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); */ -+ RTW_PUT_BE16(pcur, WPS_ATTR_DEVICE_NAME); -+ pcur += 2; -+ -+ /* *(u16*)(pcur) = cpu_to_be16( psta->dev_name_len ); */ -+ RTW_PUT_BE16(pcur, psta->dev_name_len); -+ pcur += 2; -+ -+ _rtw_memcpy(pcur, psta->dev_name, psta->dev_name_len); -+ pcur += psta->dev_name_len; -+ } -+ -+ -+ tmplen = (u8)(pcur - pstart); -+ -+ *pstart = (tmplen - 1); -+ -+ attr_len += tmplen; -+ -+ /* pstart += tmplen; */ -+ pstart = pcur; -+ -+ } -+ -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ if (attr_len > 0) -+ len = rtw_set_p2p_attr_content(pbuf, P2P_ATTR_GROUP_INFO, attr_len, pdata_attr); -+ -+ rtw_mfree(pdata_attr, MAX_P2P_IE_LEN); -+ -+_exit: -+ return len; -+ -+} -+ -+static void issue_group_disc_req(struct wifidirect_info *pwdinfo, u8 *da) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ _adapter *padapter = pwdinfo->padapter; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ unsigned char category = RTW_WLAN_CATEGORY_P2P;/* P2P action frame */ -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_GO_DISC_REQUEST; -+ u8 dialogToken = 0; -+ -+ RTW_INFO("[%s]\n", __FUNCTION__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pwdinfo->interface_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->interface_addr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* Build P2P action frame header */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ /* there is no IE in this P2P action frame */ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+} -+ -+static void issue_p2p_devdisc_resp(struct wifidirect_info *pwdinfo, u8 *da, u8 status, u8 dialogToken) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ _adapter *padapter = pwdinfo->padapter; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_DEVDISC_RESP; -+ u8 p2pie[8] = { 0x00 }; -+ u32 p2pielen = 0; -+ -+ RTW_INFO("[%s]\n", __FUNCTION__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pwdinfo->device_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->device_addr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* Build P2P public action frame header */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ -+ /* Build P2P IE */ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* P2P_ATTR_STATUS */ -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_STATUS, 1, &status); -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, p2pie, &pattrib->pktlen); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+} -+ -+static void issue_p2p_provision_resp(struct wifidirect_info *pwdinfo, u8 *raddr, u8 *frame_body, u16 config_method) -+{ -+ _adapter *padapter = pwdinfo->padapter; -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u8 dialogToken = frame_body[7]; /* The Dialog Token of provisioning discovery request frame. */ -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_PROVISION_DISC_RESP; -+ u8 wpsie[100] = { 0x00 }; -+ u8 wpsielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ wpsielen = 0; -+ /* WPS OUI */ -+ /* *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); */ -+ RTW_PUT_BE32(wpsie, WPSOUI); -+ wpsielen += 4; -+ -+#if 0 -+ /* WPS version */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ -+#endif -+ -+ /* Config Method */ -+ /* Type: */ -+ /* *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); */ -+ RTW_PUT_BE16(wpsie + wpsielen, WPS_ATTR_CONF_METHOD); -+ wpsielen += 2; -+ -+ /* Length: */ -+ /* *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); */ -+ RTW_PUT_BE16(wpsie + wpsielen, 0x0002); -+ wpsielen += 2; -+ -+ /* Value: */ -+ /* *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( config_method ); */ -+ RTW_PUT_BE16(wpsie + wpsielen, config_method); -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_provdisc_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+static void issue_p2p_presence_resp(struct wifidirect_info *pwdinfo, u8 *da, u8 status, u8 dialogToken) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ _adapter *padapter = pwdinfo->padapter; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ unsigned char category = RTW_WLAN_CATEGORY_P2P;/* P2P action frame */ -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_PRESENCE_RESPONSE; -+ u8 p2pie[MAX_P2P_IE_LEN] = { 0x00 }; -+ u8 noa_attr_content[32] = { 0x00 }; -+ u32 p2pielen = 0; -+ -+ RTW_INFO("[%s]\n", __FUNCTION__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pwdinfo->interface_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->interface_addr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* Build P2P action frame header */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ -+ /* Add P2P IE header */ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Add Status attribute in P2P IE */ -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_STATUS, 1, &status); -+ -+ /* Add NoA attribute in P2P IE */ -+ noa_attr_content[0] = 0x1;/* index */ -+ noa_attr_content[1] = 0x0;/* CTWindow and OppPS Parameters */ -+ -+ /* todo: Notice of Absence Descriptor(s) */ -+ -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_NOA, 2, noa_attr_content); -+ -+ -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, p2pie, &(pattrib->pktlen)); -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+} -+ -+u32 build_beacon_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 p2pie[MAX_P2P_IE_LEN] = { 0x00 }; -+ u16 capability = 0; -+ u32 len = 0, p2pielen = 0; -+ -+ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ -+ /* According to the P2P Specification, the beacon frame should contain 3 P2P attributes */ -+ /* 1. P2P Capability */ -+ /* 2. P2P Device ID */ -+ /* 3. Notice of Absence ( NOA ) */ -+ -+ /* P2P Capability ATTR */ -+ /* Type: */ -+ /* Length: */ -+ /* Value: */ -+ /* Device Capability Bitmap, 1 byte */ -+ /* Be able to participate in additional P2P Groups and */ -+ /* support the P2P Invitation Procedure */ -+ /* Group Capability Bitmap, 1 byte */ -+ capability = P2P_DEVCAP_INVITATION_PROC | P2P_DEVCAP_CLIENT_DISCOVERABILITY; -+ capability |= ((P2P_GRPCAP_GO | P2P_GRPCAP_INTRABSS) << 8); -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) -+ capability |= (P2P_GRPCAP_GROUP_FORMATION << 8); -+ -+ capability = cpu_to_le16(capability); -+ -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_CAPABILITY, 2, (u8 *)&capability); -+ -+ -+ /* P2P Device ID ATTR */ -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_DEVICE_ID, ETH_ALEN, pwdinfo->device_addr); -+ -+ -+ /* Notice of Absence ATTR */ -+ /* Type: */ -+ /* Length: */ -+ /* Value: */ -+ -+ /* go_add_noa_attr(pwdinfo); */ -+ -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); -+ -+ -+ return len; -+ -+} -+ -+#ifdef CONFIG_WFD -+u32 build_beacon_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u16 val16 = 0; -+ u32 len = 0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* Commented by Albert 20110812 */ -+ /* According to the WFD Specification, the beacon frame should contain 4 WFD attributes */ -+ /* 1. WFD Device Information */ -+ /* 2. Associated BSSID */ -+ /* 3. Coupled Sink Information */ -+ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ -+ if (P2P_ROLE_GO == pwdinfo->role) { -+ if (is_any_client_associated(pwdinfo->padapter)) { -+ /* WFD primary sink + WiFi Direct mode + WSD (WFD Service Discovery) */ -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ } else { -+ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD (WFD Service Discovery) */ -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ } -+ -+ } else { -+ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ } -+ -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ wfdielen += ETH_ALEN; -+ -+ /* Coupled Sink Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Coupled Sink Status bitmap */ -+ /* Not coupled/available for Coupling */ -+ wfdie[wfdielen++] = 0; -+ /* MAC Addr. */ -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+exit: -+ return len; -+} -+ -+u32 build_probe_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u16 val16 = 0; -+ u32 len = 0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* Commented by Albert 20110812 */ -+ /* According to the WFD Specification, the probe request frame should contain 4 WFD attributes */ -+ /* 1. WFD Device Information */ -+ /* 2. Associated BSSID */ -+ /* 3. Coupled Sink Information */ -+ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ -+ if (1 == pwdinfo->wfd_tdls_enable) { -+ /* WFD primary sink + available for WFD session + WiFi TDLS mode + WSC ( WFD Service Discovery ) */ -+ val16 = pwfd_info->wfd_device_type | -+ WFD_DEVINFO_SESSION_AVAIL | -+ WFD_DEVINFO_WSD | -+ WFD_DEVINFO_PC_TDLS; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ } else { -+ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSC ( WFD Service Discovery ) */ -+ val16 = pwfd_info->wfd_device_type | -+ WFD_DEVINFO_SESSION_AVAIL | -+ WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ } -+ -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ wfdielen += ETH_ALEN; -+ -+ /* Coupled Sink Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Coupled Sink Status bitmap */ -+ /* Not coupled/available for Coupling */ -+ wfdie[wfdielen++] = 0; -+ /* MAC Addr. */ -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+exit: -+ return len; -+} -+ -+u32 build_probe_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 tunneled) -+{ -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len = 0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* Commented by Albert 20110812 */ -+ /* According to the WFD Specification, the probe response frame should contain 4 WFD attributes */ -+ /* 1. WFD Device Information */ -+ /* 2. Associated BSSID */ -+ /* 3. Coupled Sink Information */ -+ /* 4. WFD Session Information */ -+ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ /* WFD primary sink + available for WFD session + WiFi Direct mode */ -+ -+ if (_TRUE == pwdinfo->session_available) { -+ if (P2P_ROLE_GO == pwdinfo->role) { -+ if (is_any_client_associated(pwdinfo->padapter)) { -+ if (pwdinfo->wfd_tdls_enable) { -+ /* TDLS mode + WSD ( WFD Service Discovery ) */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); -+ } else { -+ /* WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); -+ } -+ } else { -+ if (pwdinfo->wfd_tdls_enable) { -+ /* available for WFD session + TDLS mode + WSD ( WFD Service Discovery ) */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); -+ } else { -+ /* available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); -+ } -+ } -+ } else { -+ if (pwdinfo->wfd_tdls_enable) { -+ /* available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); -+ } else { -+ -+ /* available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); -+ } -+ } -+ } else { -+ if (pwdinfo->wfd_tdls_enable) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); -+ else -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); -+ -+ } -+ -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ wfdielen += ETH_ALEN; -+ -+ /* Coupled Sink Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Coupled Sink Status bitmap */ -+ /* Not coupled/available for Coupling */ -+ wfdie[wfdielen++] = 0; -+ /* MAC Addr. */ -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ /* WFD Session Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_SESSION_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0000); -+ wfdielen += 2; -+ -+ /* Todo: to add the list of WFD device info descriptor in WFD group. */ -+ -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_TDLS -+ { -+ int i; -+ _adapter *iface = NULL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ if (iface == padapter) -+ continue; -+ -+ if ((tunneled == 0) && (iface->wdinfo.wfd_tdls_enable == 1)) { -+ /* Alternative MAC Address ATTR -+ Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ALTER_MAC; -+ -+ /* Length: -+ Note: In the WFD specification, the size of length field is 2.*/ -+ RTW_PUT_BE16(wfdie + wfdielen, ETH_ALEN); -+ wfdielen += 2; -+ -+ /* Value: -+ Alternative MAC Address*/ -+ _rtw_memcpy(wfdie + wfdielen, adapter_mac_addr(iface), ETH_ALEN); -+ wfdielen += ETH_ALEN; -+ } -+ } -+ } -+ } -+ -+#endif /* CONFIG_TDLS*/ -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+exit: -+ return len; -+} -+ -+u32 build_assoc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u16 val16 = 0; -+ u32 len = 0, wfdielen = 0; -+ _adapter *padapter = NULL; -+ struct mlme_priv *pmlmepriv = NULL; -+ struct wifi_display_info *pwfd_info = NULL; -+ -+ padapter = pwdinfo->padapter; -+ pmlmepriv = &padapter->mlmepriv; -+ pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) -+ goto exit; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* Commented by Albert 20110812 */ -+ /* According to the WFD Specification, the probe request frame should contain 4 WFD attributes */ -+ /* 1. WFD Device Information */ -+ /* 2. Associated BSSID */ -+ /* 3. Coupled Sink Information */ -+ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ wfdielen += ETH_ALEN; -+ -+ /* Coupled Sink Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Coupled Sink Status bitmap */ -+ /* Not coupled/available for Coupling */ -+ wfdie[wfdielen++] = 0; -+ /* MAC Addr. */ -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+exit: -+ return len; -+} -+ -+u32 build_assoc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len = 0, wfdielen = 0; -+ u16 val16 = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* Commented by Albert 20110812 */ -+ /* According to the WFD Specification, the probe request frame should contain 4 WFD attributes */ -+ /* 1. WFD Device Information */ -+ /* 2. Associated BSSID */ -+ /* 3. Coupled Sink Information */ -+ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ wfdielen += ETH_ALEN; -+ -+ /* Coupled Sink Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Coupled Sink Status bitmap */ -+ /* Not coupled/available for Coupling */ -+ wfdie[wfdielen++] = 0; -+ /* MAC Addr. */ -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+exit: -+ return len; -+} -+ -+u32 build_nego_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len = 0, wfdielen = 0; -+ u16 val16 = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* Commented by Albert 20110825 */ -+ /* According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes */ -+ /* 1. WFD Device Information */ -+ /* 2. Associated BSSID ( Optional ) */ -+ /* 3. Local IP Adress ( Optional ) */ -+ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ /* WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available */ -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ wfdielen += ETH_ALEN; -+ -+ /* Coupled Sink Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Coupled Sink Status bitmap */ -+ /* Not coupled/available for Coupling */ -+ wfdie[wfdielen++] = 0; -+ /* MAC Addr. */ -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+exit: -+ return len; -+} -+ -+u32 build_nego_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len = 0, wfdielen = 0; -+ u16 val16 = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* Commented by Albert 20110825 */ -+ /* According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes */ -+ /* 1. WFD Device Information */ -+ /* 2. Associated BSSID ( Optional ) */ -+ /* 3. Local IP Adress ( Optional ) */ -+ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ /* WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available */ -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ wfdielen += ETH_ALEN; -+ -+ /* Coupled Sink Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Coupled Sink Status bitmap */ -+ /* Not coupled/available for Coupling */ -+ wfdie[wfdielen++] = 0; -+ /* MAC Addr. */ -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ -+ -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+exit: -+ return len; -+} -+ -+u32 build_nego_confirm_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len = 0, wfdielen = 0; -+ u16 val16 = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* Commented by Albert 20110825 */ -+ /* According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes */ -+ /* 1. WFD Device Information */ -+ /* 2. Associated BSSID ( Optional ) */ -+ /* 3. Local IP Adress ( Optional ) */ -+ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ /* WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available */ -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ wfdielen += ETH_ALEN; -+ -+ /* Coupled Sink Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Coupled Sink Status bitmap */ -+ /* Not coupled/available for Coupling */ -+ wfdie[wfdielen++] = 0; -+ /* MAC Addr. */ -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+exit: -+ return len; -+} -+ -+u32 build_invitation_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len = 0, wfdielen = 0; -+ u16 val16 = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* Commented by Albert 20110825 */ -+ /* According to the WFD Specification, the provision discovery request frame should contain 3 WFD attributes */ -+ /* 1. WFD Device Information */ -+ /* 2. Associated BSSID ( Optional ) */ -+ /* 3. Local IP Adress ( Optional ) */ -+ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ wfdielen += ETH_ALEN; -+ -+ /* Coupled Sink Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Coupled Sink Status bitmap */ -+ /* Not coupled/available for Coupling */ -+ wfdie[wfdielen++] = 0; -+ /* MAC Addr. */ -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ -+ if (P2P_ROLE_GO == pwdinfo->role) { -+ /* WFD Session Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_SESSION_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0000); -+ wfdielen += 2; -+ -+ /* Todo: to add the list of WFD device info descriptor in WFD group. */ -+ -+ } -+ -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+exit: -+ return len; -+} -+ -+u32 build_invitation_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u16 val16 = 0; -+ u32 len = 0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* Commented by Albert 20110825 */ -+ /* According to the WFD Specification, the provision discovery request frame should contain 3 WFD attributes */ -+ /* 1. WFD Device Information */ -+ /* 2. Associated BSSID ( Optional ) */ -+ /* 3. Local IP Adress ( Optional ) */ -+ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ wfdielen += ETH_ALEN; -+ -+ /* Coupled Sink Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Coupled Sink Status bitmap */ -+ /* Not coupled/available for Coupling */ -+ wfdie[wfdielen++] = 0; -+ /* MAC Addr. */ -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ -+ if (P2P_ROLE_GO == pwdinfo->role) { -+ /* WFD Session Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_SESSION_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0000); -+ wfdielen += 2; -+ -+ /* Todo: to add the list of WFD device info descriptor in WFD group. */ -+ -+ } -+ -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+exit: -+ return len; -+} -+ -+u32 build_provdisc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len = 0, wfdielen = 0; -+ u16 val16 = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* Commented by Albert 20110825 */ -+ /* According to the WFD Specification, the provision discovery request frame should contain 3 WFD attributes */ -+ /* 1. WFD Device Information */ -+ /* 2. Associated BSSID ( Optional ) */ -+ /* 3. Local IP Adress ( Optional ) */ -+ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ wfdielen += ETH_ALEN; -+ -+ /* Coupled Sink Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Coupled Sink Status bitmap */ -+ /* Not coupled/available for Coupling */ -+ wfdie[wfdielen++] = 0; -+ /* MAC Addr. */ -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ -+ -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+exit: -+ return len; -+} -+ -+u32 build_provdisc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len = 0, wfdielen = 0; -+ u16 val16 = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* Commented by Albert 20110825 */ -+ /* According to the WFD Specification, the provision discovery response frame should contain 3 WFD attributes */ -+ /* 1. WFD Device Information */ -+ /* 2. Associated BSSID ( Optional ) */ -+ /* 3. Local IP Adress ( Optional ) */ -+ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ /* WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ -+ val16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD; -+ RTW_PUT_BE16(wfdie + wfdielen, val16); -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ wfdielen += ETH_ALEN; -+ -+ /* Coupled Sink Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Coupled Sink Status bitmap */ -+ /* Not coupled/available for Coupling */ -+ wfdie[wfdielen++] = 0; -+ /* MAC Addr. */ -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ wfdie[wfdielen++] = 0; -+ -+ rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+exit: -+ return len; -+} -+#endif /* CONFIG_WFD */ -+ -+u32 build_probe_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 p2pie[MAX_P2P_IE_LEN] = { 0x00 }; -+ u32 len = 0, p2pielen = 0; -+#ifdef CONFIG_INTEL_WIDI -+ struct mlme_priv *pmlmepriv = &(pwdinfo->padapter->mlmepriv); -+ u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; -+ u8 widi_version = 0, i = 0; -+ -+ if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE) -+ widi_version = 35; -+ else if (pmlmepriv->num_p2p_sdt != 0) -+ widi_version = 40; -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Commented by Albert 20100907 */ -+ /* According to the P2P Specification, the probe response frame should contain 5 P2P attributes */ -+ /* 1. P2P Capability */ -+ /* 2. Extended Listen Timing */ -+ /* 3. Notice of Absence ( NOA ) ( Only GO needs this ) */ -+ /* 4. Device Info */ -+ /* 5. Group Info ( Only GO need this ) */ -+ -+ /* P2P Capability ATTR */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; -+ -+ /* Length: */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); */ -+ RTW_PUT_LE16(p2pie + p2pielen, 0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Device Capability Bitmap, 1 byte */ -+ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; -+ -+ /* Group Capability Bitmap, 1 byte */ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ p2pie[p2pielen] = (P2P_GRPCAP_GO | P2P_GRPCAP_INTRABSS); -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) -+ p2pie[p2pielen] |= P2P_GRPCAP_GROUP_FORMATION; -+ -+ p2pielen++; -+ } else if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE)) { -+ /* Group Capability Bitmap, 1 byte */ -+ if (pwdinfo->persistent_supported) -+ p2pie[p2pielen++] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; -+ else -+ p2pie[p2pielen++] = DMP_P2P_GRPCAP_SUPPORT; -+ } -+ -+ /* Extended Listen Timing ATTR */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_EX_LISTEN_TIMING; -+ -+ /* Length: */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0004 ); */ -+ RTW_PUT_LE16(p2pie + p2pielen, 0x0004); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Availability Period */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); */ -+ RTW_PUT_LE16(p2pie + p2pielen, 0xFFFF); -+ p2pielen += 2; -+ -+ /* Availability Interval */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); */ -+ RTW_PUT_LE16(p2pie + p2pielen, 0xFFFF); -+ p2pielen += 2; -+ -+ -+ /* Notice of Absence ATTR */ -+ /* Type: */ -+ /* Length: */ -+ /* Value: */ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ /* go_add_noa_attr(pwdinfo); */ -+ } -+ -+ /* Device Info ATTR */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ -+ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); */ -+#ifdef CONFIG_INTEL_WIDI -+ if (widi_version == 35) -+ RTW_PUT_LE16(p2pie + p2pielen, 21 + 8 + pwdinfo->device_name_len); -+ else if (widi_version == 40) -+ RTW_PUT_LE16(p2pie + p2pielen, 21 + 8 * pmlmepriv->num_p2p_sdt + pwdinfo->device_name_len); -+ else -+#endif /* CONFIG_INTEL_WIDI */ -+ RTW_PUT_LE16(p2pie + p2pielen, 21 + pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* P2P Device Address */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* Config Method */ -+ /* This field should be big endian. Noted by P2P specification. */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, pwdinfo->supported_wps_cm); -+ p2pielen += 2; -+ -+#ifdef CONFIG_INTEL_WIDI -+ if (widi_version == 40) { -+ /* Primary Device Type */ -+ /* Category ID */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_pdt_cid); -+ p2pielen += 2; -+ -+ /* OUI */ -+ /* *(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); */ -+ RTW_PUT_BE32(p2pie + p2pielen, WPSOUI); -+ p2pielen += 4; -+ -+ /* Sub Category ID */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_pdt_scid); -+ p2pielen += 2; -+ } else -+#endif /* CONFIG_INTEL_WIDI */ -+ { -+ /* Primary Device Type */ -+ /* Category ID */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_MULIT_MEDIA); -+ p2pielen += 2; -+ -+ /* OUI */ -+ /* *(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); */ -+ RTW_PUT_BE32(p2pie + p2pielen, WPSOUI); -+ p2pielen += 4; -+ -+ /* Sub Category ID */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_SCID_MEDIA_SERVER); -+ p2pielen += 2; -+ } -+ -+ /* Number of Secondary Device Types */ -+#ifdef CONFIG_INTEL_WIDI -+ if (widi_version == 35) { -+ p2pie[p2pielen++] = 0x01; -+ -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_DISPLAYS); -+ p2pielen += 2; -+ -+ RTW_PUT_BE32(p2pie + p2pielen, INTEL_DEV_TYPE_OUI); -+ p2pielen += 4; -+ -+ RTW_PUT_BE16(p2pie + p2pielen, P2P_SCID_WIDI_CONSUMER_SINK); -+ p2pielen += 2; -+ } else if (widi_version == 40) { -+ p2pie[p2pielen++] = pmlmepriv->num_p2p_sdt; -+ for (; i < pmlmepriv->num_p2p_sdt; i++) { -+ RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_sdt_cid[i]); -+ p2pielen += 2; -+ -+ RTW_PUT_BE32(p2pie + p2pielen, INTEL_DEV_TYPE_OUI); -+ p2pielen += 4; -+ -+ RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_sdt_scid[i]); -+ p2pielen += 2; -+ } -+ } else -+#endif /* CONFIG_INTEL_WIDI */ -+ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ -+ -+ /* Device Name */ -+ /* Type: */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_ATTR_DEVICE_NAME); -+ p2pielen += 2; -+ -+ /* Length: */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len); -+ p2pielen += pwdinfo->device_name_len; -+ -+ /* Group Info ATTR */ -+ /* Type: */ -+ /* Length: */ -+ /* Value: */ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ p2pielen += go_add_group_info_attr(pwdinfo, p2pie + p2pielen); -+ -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); -+ -+ -+ return len; -+ -+} -+ -+u32 build_prov_disc_request_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 *pssid, u8 ussidlen, u8 *pdev_raddr) -+{ -+ u8 p2pie[MAX_P2P_IE_LEN] = { 0x00 }; -+ u32 len = 0, p2pielen = 0; -+ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Commented by Albert 20110301 */ -+ /* According to the P2P Specification, the provision discovery request frame should contain 3 P2P attributes */ -+ /* 1. P2P Capability */ -+ /* 2. Device Info */ -+ /* 3. Group ID ( When joining an operating P2P Group ) */ -+ -+ /* P2P Capability ATTR */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; -+ -+ /* Length: */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); */ -+ RTW_PUT_LE16(p2pie + p2pielen, 0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Device Capability Bitmap, 1 byte */ -+ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; -+ -+ /* Group Capability Bitmap, 1 byte */ -+ if (pwdinfo->persistent_supported) -+ p2pie[p2pielen++] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; -+ else -+ p2pie[p2pielen++] = DMP_P2P_GRPCAP_SUPPORT; -+ -+ -+ /* Device Info ATTR */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ -+ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); */ -+ RTW_PUT_LE16(p2pie + p2pielen, 21 + pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* P2P Device Address */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* Config Method */ -+ /* This field should be big endian. Noted by P2P specification. */ -+ if (pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PBC) { -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_PBC ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_CONFIG_METHOD_PBC); -+ } else { -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_DISPLAY ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_CONFIG_METHOD_DISPLAY); -+ } -+ -+ p2pielen += 2; -+ -+ /* Primary Device Type */ -+ /* Category ID */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_MULIT_MEDIA); -+ p2pielen += 2; -+ -+ /* OUI */ -+ /* *(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); */ -+ RTW_PUT_BE32(p2pie + p2pielen, WPSOUI); -+ p2pielen += 4; -+ -+ /* Sub Category ID */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_SCID_MEDIA_SERVER); -+ p2pielen += 2; -+ -+ /* Number of Secondary Device Types */ -+ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ -+ -+ /* Device Name */ -+ /* Type: */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_ATTR_DEVICE_NAME); -+ p2pielen += 2; -+ -+ /* Length: */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); */ -+ RTW_PUT_BE16(p2pie + p2pielen, pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len); -+ p2pielen += pwdinfo->device_name_len; -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { -+ /* Added by Albert 2011/05/19 */ -+ /* In this case, the pdev_raddr is the device address of the group owner. */ -+ -+ /* P2P Group ID ATTR */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_GROUP_ID; -+ -+ /* Length: */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN + ussidlen ); */ -+ RTW_PUT_LE16(p2pie + p2pielen, ETH_ALEN + ussidlen); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2pie + p2pielen, pdev_raddr, ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ _rtw_memcpy(p2pie + p2pielen, pssid, ussidlen); -+ p2pielen += ussidlen; -+ -+ } -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); -+ -+ -+ return len; -+ -+} -+ -+ -+u32 build_assoc_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 status_code) -+{ -+ u8 p2pie[MAX_P2P_IE_LEN] = { 0x00 }; -+ u32 len = 0, p2pielen = 0; -+ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* According to the P2P Specification, the Association response frame should contain 2 P2P attributes */ -+ /* 1. Status */ -+ /* 2. Extended Listen Timing (optional) */ -+ -+ -+ /* Status ATTR */ -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_STATUS, 1, &status_code); -+ -+ -+ /* Extended Listen Timing ATTR */ -+ /* Type: */ -+ /* Length: */ -+ /* Value: */ -+ -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_deauth_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u32 len = 0; -+ -+ return len; -+} -+ -+u32 process_probe_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ -+ u8 *p; -+ u32 ret = _FALSE; -+ u8 *p2pie; -+ u32 p2pielen = 0; -+ int ssid_len = 0, rate_cnt = 0; -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _SUPPORTEDRATES_IE_, (int *)&rate_cnt, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); -+ -+ if (rate_cnt <= 4) { -+ int i, g_rate = 0; -+ -+ for (i = 0; i < rate_cnt; i++) { -+ if (((*(p + 2 + i) & 0xff) != 0x02) && -+ ((*(p + 2 + i) & 0xff) != 0x04) && -+ ((*(p + 2 + i) & 0xff) != 0x0B) && -+ ((*(p + 2 + i) & 0xff) != 0x16)) -+ g_rate = 1; -+ } -+ -+ if (g_rate == 0) { -+ /* There is no OFDM rate included in SupportedRates IE of this probe request frame */ -+ /* The driver should response this probe request. */ -+ return ret; -+ } -+ } else { -+ /* rate_cnt > 4 means the SupportRates IE contains the OFDM rate because the count of CCK rates are 4. */ -+ /* We should proceed the following check for this probe request. */ -+ } -+ -+ /* Added comments by Albert 20100906 */ -+ /* There are several items we should check here. */ -+ /* 1. This probe request frame must contain the P2P IE. (Done) */ -+ /* 2. This probe request frame must contain the wildcard SSID. (Done) */ -+ /* 3. Wildcard BSSID. (Todo) */ -+ /* 4. Destination Address. ( Done in mgt_dispatcher function ) */ -+ /* 5. Requested Device Type in WSC IE. (Todo) */ -+ /* 6. Device ID attribute in P2P IE. (Todo) */ -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _SSID_IE_, (int *)&ssid_len, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); -+ -+ ssid_len &= 0xff; /* Just last 1 byte is valid for ssid len of the probe request */ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ p2pie = rtw_get_p2p_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_ , len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_ , NULL, &p2pielen); -+ if (p2pie) { -+ if ((p != NULL) && _rtw_memcmp((void *)(p + 2), (void *) pwdinfo->p2p_wildcard_ssid , 7)) { -+ /* todo: */ -+ /* Check Requested Device Type attributes in WSC IE. */ -+ /* Check Device ID attribute in P2P IE */ -+ -+ ret = _TRUE; -+ } else if ((p != NULL) && (ssid_len == 0)) -+ ret = _TRUE; -+ } else { -+ /* non -p2p device */ -+ } -+ -+ } -+ -+ -+ return ret; -+ -+} -+ -+u32 process_assoc_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len, struct sta_info *psta) -+{ -+ u8 status_code = P2P_STATUS_SUCCESS; -+ u8 *pbuf, *pattr_content = NULL; -+ u32 attr_contentlen = 0; -+ u16 cap_attr = 0; -+ unsigned short frame_type, ie_offset = 0; -+ u8 *ies; -+ u32 ies_len; -+ u8 *p2p_ie; -+ u32 p2p_ielen = 0; -+ -+ if (!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ return P2P_STATUS_FAIL_REQUEST_UNABLE; -+ -+ frame_type = GetFrameSubType(pframe); -+ if (frame_type == WIFI_ASSOCREQ) -+ ie_offset = _ASOCREQ_IE_OFFSET_; -+ else /* WIFI_REASSOCREQ */ -+ ie_offset = _REASOCREQ_IE_OFFSET_; -+ -+ ies = pframe + WLAN_HDR_A3_LEN + ie_offset; -+ ies_len = len - WLAN_HDR_A3_LEN - ie_offset; -+ -+ p2p_ie = rtw_get_p2p_ie(ies , ies_len , NULL, &p2p_ielen); -+ -+ if (!p2p_ie) { -+ RTW_INFO("[%s] P2P IE not Found!!\n", __FUNCTION__); -+ status_code = P2P_STATUS_FAIL_INVALID_PARAM; -+ } else -+ RTW_INFO("[%s] P2P IE Found!!\n", __FUNCTION__); -+ -+ while (p2p_ie) { -+ /* Check P2P Capability ATTR */ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8 *)&cap_attr, (uint *) &attr_contentlen)) { -+ RTW_INFO("[%s] Got P2P Capability Attr!!\n", __FUNCTION__); -+ cap_attr = le16_to_cpu(cap_attr); -+ psta->dev_cap = cap_attr & 0xff; -+ } -+ -+ /* Check Extended Listen Timing ATTR */ -+ -+ -+ /* Check P2P Device Info ATTR */ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO, NULL, (uint *)&attr_contentlen)) { -+ RTW_INFO("[%s] Got P2P DEVICE INFO Attr!!\n", __FUNCTION__); -+ pattr_content = pbuf = rtw_zmalloc(attr_contentlen); -+ if (pattr_content) { -+ u8 num_of_secdev_type; -+ u16 dev_name_len; -+ -+ -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO , pattr_content, (uint *)&attr_contentlen); -+ -+ _rtw_memcpy(psta->dev_addr, pattr_content, ETH_ALEN);/* P2P Device Address */ -+ -+ pattr_content += ETH_ALEN; -+ -+ _rtw_memcpy(&psta->config_methods, pattr_content, 2);/* Config Methods */ -+ psta->config_methods = be16_to_cpu(psta->config_methods); -+ -+ pattr_content += 2; -+ -+ _rtw_memcpy(psta->primary_dev_type, pattr_content, 8); -+ -+ pattr_content += 8; -+ -+ num_of_secdev_type = *pattr_content; -+ pattr_content += 1; -+ -+ if (num_of_secdev_type == 0) -+ psta->num_of_secdev_type = 0; -+ else { -+ u32 len; -+ -+ psta->num_of_secdev_type = num_of_secdev_type; -+ -+ len = (sizeof(psta->secdev_types_list) < (num_of_secdev_type * 8)) ? (sizeof(psta->secdev_types_list)) : (num_of_secdev_type * 8); -+ -+ _rtw_memcpy(psta->secdev_types_list, pattr_content, len); -+ -+ pattr_content += (num_of_secdev_type * 8); -+ } -+ -+ -+ /* dev_name_len = attr_contentlen - ETH_ALEN - 2 - 8 - 1 - (num_of_secdev_type*8); */ -+ psta->dev_name_len = 0; -+ if (WPS_ATTR_DEVICE_NAME == be16_to_cpu(*(u16 *)pattr_content)) { -+ dev_name_len = be16_to_cpu(*(u16 *)(pattr_content + 2)); -+ -+ psta->dev_name_len = (sizeof(psta->dev_name) < dev_name_len) ? sizeof(psta->dev_name) : dev_name_len; -+ -+ _rtw_memcpy(psta->dev_name, pattr_content + 4, psta->dev_name_len); -+ } -+ -+ rtw_mfree(pbuf, attr_contentlen); -+ -+ } -+ -+ } -+ -+ /* Get the next P2P IE */ -+ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); -+ -+ } -+ -+ return status_code; -+ -+} -+ -+u32 process_p2p_devdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ -+ u8 *frame_body; -+ u8 status, dialogToken; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = pwdinfo->padapter; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *p2p_ie; -+ u32 p2p_ielen = 0; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ dialogToken = frame_body[7]; -+ status = P2P_STATUS_FAIL_UNKNOWN_P2PGROUP; -+ -+ p2p_ie = rtw_get_p2p_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen); -+ if (p2p_ie) { -+ u8 groupid[38] = { 0x00 }; -+ u8 dev_addr[ETH_ALEN] = { 0x00 }; -+ u32 attr_contentlen = 0; -+ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, groupid, &attr_contentlen)) { -+ if (_rtw_memcmp(pwdinfo->device_addr, groupid, ETH_ALEN) && -+ _rtw_memcmp(pwdinfo->p2p_group_ssid, groupid + ETH_ALEN, pwdinfo->p2p_group_ssid_len)) { -+ attr_contentlen = 0; -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_ID, dev_addr, &attr_contentlen)) { -+ _irqL irqL; -+ _list *phead, *plist; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* look up sta asoc_queue */ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ if (psta->is_p2p_device && (psta->dev_cap & P2P_DEVCAP_CLIENT_DISCOVERABILITY) && -+ _rtw_memcmp(psta->dev_addr, dev_addr, ETH_ALEN)) { -+ -+ /* _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); */ -+ /* issue GO Discoverability Request */ -+ issue_group_disc_req(pwdinfo, psta->hwaddr); -+ /* _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); */ -+ -+ status = P2P_STATUS_SUCCESS; -+ -+ break; -+ } else -+ status = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ } else -+ status = P2P_STATUS_FAIL_INVALID_PARAM; -+ -+ } else -+ status = P2P_STATUS_FAIL_INVALID_PARAM; -+ -+ } -+ -+ } -+ -+ -+ /* issue Device Discoverability Response */ -+ issue_p2p_devdisc_resp(pwdinfo, GetAddr2Ptr(pframe), status, dialogToken); -+ -+ -+ return (status == P2P_STATUS_SUCCESS) ? _TRUE : _FALSE; -+ -+} -+ -+u32 process_p2p_devdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ -+ return _TRUE; -+} -+ -+u8 process_p2p_provdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ -+ u8 *frame_body; -+ u8 *wpsie; -+ uint wps_ielen = 0, attr_contentlen = 0; -+ u16 uconfig_method = 0; -+ -+ -+ frame_body = (pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ wpsie = rtw_get_wps_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &wps_ielen); -+ if (wpsie) { -+ if (rtw_get_wps_attr_content(wpsie, wps_ielen, WPS_ATTR_CONF_METHOD , (u8 *) &uconfig_method, &attr_contentlen)) { -+ uconfig_method = be16_to_cpu(uconfig_method); -+ switch (uconfig_method) { -+ case WPS_CM_DISPLYA: { -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "dis", 3); -+ break; -+ } -+ case WPS_CM_LABEL: { -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "lab", 3); -+ break; -+ } -+ case WPS_CM_PUSH_BUTTON: { -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3); -+ break; -+ } -+ case WPS_CM_KEYPAD: { -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3); -+ break; -+ } -+ } -+ issue_p2p_provision_resp(pwdinfo, GetAddr2Ptr(pframe), frame_body, uconfig_method); -+ } -+ } -+ RTW_INFO("[%s] config method = %s\n", __FUNCTION__, pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req); -+ return _TRUE; -+ -+} -+ -+u8 process_p2p_provdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe) -+{ -+ -+ return _TRUE; -+} -+ -+u8 rtw_p2p_get_peer_ch_list(struct wifidirect_info *pwdinfo, u8 *ch_content, u8 ch_cnt, u8 *peer_ch_list) -+{ -+ u8 i = 0, j = 0; -+ u8 temp = 0; -+ u8 ch_no = 0; -+ ch_content += 3; -+ ch_cnt -= 3; -+ -+ while (ch_cnt > 0) { -+ ch_content += 1; -+ ch_cnt -= 1; -+ temp = *ch_content; -+ for (i = 0 ; i < temp ; i++, j++) -+ peer_ch_list[j] = *(ch_content + 1 + i); -+ ch_content += (temp + 1); -+ ch_cnt -= (temp + 1); -+ ch_no += temp ; -+ } -+ -+ return ch_no; -+} -+ -+u8 rtw_p2p_check_peer_oper_ch(struct mlme_ext_priv *pmlmeext, u8 ch) -+{ -+ u8 i = 0; -+ -+ for (i = 0; i < pmlmeext->max_chan_nums; i++) { -+ if (pmlmeext->channel_set[i].ChannelNum == ch) -+ return _SUCCESS; -+ } -+ -+ return _FAIL; -+} -+ -+u8 rtw_p2p_ch_inclusion(struct mlme_ext_priv *pmlmeext, u8 *peer_ch_list, u8 peer_ch_num, u8 *ch_list_inclusioned) -+{ -+ int i = 0, j = 0, temp = 0; -+ u8 ch_no = 0; -+ -+ for (i = 0; i < peer_ch_num; i++) { -+ for (j = temp; j < pmlmeext->max_chan_nums; j++) { -+ if (*(peer_ch_list + i) == pmlmeext->channel_set[j].ChannelNum) { -+ ch_list_inclusioned[ch_no++] = *(peer_ch_list + i); -+ temp = j; -+ break; -+ } -+ } -+ } -+ -+ return ch_no; -+} -+ -+u8 process_p2p_group_negotation_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ -+ _adapter *padapter = pwdinfo->padapter; -+ u8 result = P2P_STATUS_SUCCESS; -+ u32 p2p_ielen = 0, wps_ielen = 0; -+ u8 *ies; -+ u32 ies_len; -+ u8 *p2p_ie; -+ u8 *wpsie; -+ u16 wps_devicepassword_id = 0x0000; -+ uint wps_devicepassword_id_len = 0; -+#ifdef CONFIG_WFD -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+#endif /* CONFIG_TDLS */ -+#endif /* CONFIG_WFD */ -+ wpsie = rtw_get_wps_ie(pframe + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &wps_ielen); -+ if (wpsie) { -+ /* Commented by Kurt 20120113 */ -+ /* If some device wants to do p2p handshake without sending prov_disc_req */ -+ /* We have to get peer_req_cm from here. */ -+ if (_rtw_memcmp(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "000", 3)) { -+ rtw_get_wps_attr_content(wpsie, wps_ielen, WPS_ATTR_DEVICE_PWID, (u8 *) &wps_devicepassword_id, &wps_devicepassword_id_len); -+ wps_devicepassword_id = be16_to_cpu(wps_devicepassword_id); -+ -+ if (wps_devicepassword_id == WPS_DPID_USER_SPEC) -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "dis", 3); -+ else if (wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3); -+ else -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3); -+ } -+ } else { -+ RTW_INFO("[%s] WPS IE not Found!!\n", __FUNCTION__); -+ result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ return result ; -+ } -+ -+ ies = pframe + _PUBLIC_ACTION_IE_OFFSET_; -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); -+ -+ if (!p2p_ie) { -+ RTW_INFO("[%s] P2P IE not Found!!\n", __FUNCTION__); -+ result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ } -+ -+ while (p2p_ie) { -+ u8 attr_content = 0x00; -+ u32 attr_contentlen = 0; -+ u8 ch_content[100] = { 0x00 }; -+ uint ch_cnt = 0; -+ u8 peer_ch_list[100] = { 0x00 }; -+ u8 peer_ch_num = 0; -+ u8 ch_list_inclusioned[100] = { 0x00 }; -+ u8 ch_num_inclusioned = 0; -+ u16 cap_attr; -+ u8 listen_ch_attr[5] = { 0x00 }; -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_ING); -+ -+ /* Check P2P Capability ATTR */ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8 *)&cap_attr, (uint *)&attr_contentlen)) { -+ cap_attr = le16_to_cpu(cap_attr); -+ -+#if defined(CONFIG_WFD) && defined(CONFIG_TDLS) -+ if (!(cap_attr & P2P_GRPCAP_INTRABSS)) -+ ptdlsinfo->ap_prohibited = _TRUE; -+#endif /* defined(CONFIG_WFD) && defined(CONFIG_TDLS) */ -+ } -+ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT , &attr_content, &attr_contentlen)) { -+ RTW_INFO("[%s] GO Intent = %d, tie = %d\n", __FUNCTION__, attr_content >> 1, attr_content & 0x01); -+ pwdinfo->peer_intent = attr_content; /* include both intent and tie breaker values. */ -+ -+ if (pwdinfo->intent == (pwdinfo->peer_intent >> 1)) { -+ /* Try to match the tie breaker value */ -+ if (pwdinfo->intent == P2P_MAX_INTENT) { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ result = P2P_STATUS_FAIL_BOTH_GOINTENT_15; -+ } else { -+ if (attr_content & 0x01) -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ else -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } -+ } else if (pwdinfo->intent > (pwdinfo->peer_intent >> 1)) -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ else -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ /* Store the group id information. */ -+ _rtw_memcpy(pwdinfo->groupid_info.go_device_addr, pwdinfo->device_addr, ETH_ALEN); -+ _rtw_memcpy(pwdinfo->groupid_info.ssid, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen); -+ } -+ } -+ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, (u8 *)listen_ch_attr, (uint *) &attr_contentlen) && attr_contentlen == 5) -+ pwdinfo->nego_req_info.peer_ch = listen_ch_attr[4]; -+ -+ RTW_INFO(FUNC_ADPT_FMT" listen channel :%u\n", FUNC_ADPT_ARG(padapter), pwdinfo->nego_req_info.peer_ch); -+ -+ attr_contentlen = 0; -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_INTENDED_IF_ADDR, pwdinfo->p2p_peer_interface_addr, &attr_contentlen)) { -+ if (attr_contentlen != ETH_ALEN) -+ _rtw_memset(pwdinfo->p2p_peer_interface_addr, 0x00, ETH_ALEN); -+ } -+ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, ch_content, &ch_cnt)) { -+ peer_ch_num = rtw_p2p_get_peer_ch_list(pwdinfo, ch_content, ch_cnt, peer_ch_list); -+ ch_num_inclusioned = rtw_p2p_ch_inclusion(&padapter->mlmeextpriv, peer_ch_list, peer_ch_num, ch_list_inclusioned); -+ -+ if (ch_num_inclusioned == 0) { -+ RTW_INFO("[%s] No common channel in channel list!\n", __FUNCTION__); -+ result = P2P_STATUS_FAIL_NO_COMMON_CH; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ break; -+ } -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ if (!rtw_p2p_is_channel_list_ok(pwdinfo->operating_channel, -+ ch_list_inclusioned, ch_num_inclusioned)) { -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) -+ && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { -+ RTW_INFO("[%s] desired channel NOT Found!\n", __FUNCTION__); -+ result = P2P_STATUS_FAIL_NO_COMMON_CH; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ break; -+ } else -+#endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ u8 operatingch_info[5] = { 0x00 }, peer_operating_ch = 0; -+ attr_contentlen = 0; -+ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen)) -+ peer_operating_ch = operatingch_info[4]; -+ -+ if (rtw_p2p_is_channel_list_ok(peer_operating_ch, -+ ch_list_inclusioned, ch_num_inclusioned)) { -+ /** -+ * Change our operating channel as peer's for compatibility. -+ */ -+ pwdinfo->operating_channel = peer_operating_ch; -+ RTW_INFO("[%s] Change op ch to %02x as peer's\n", __FUNCTION__, pwdinfo->operating_channel); -+ } else { -+ /* Take first channel of ch_list_inclusioned as operating channel */ -+ pwdinfo->operating_channel = ch_list_inclusioned[0]; -+ RTW_INFO("[%s] Change op ch to %02x\n", __FUNCTION__, pwdinfo->operating_channel); -+ } -+ } -+ -+ } -+ } -+ } -+ -+ /* Get the next P2P IE */ -+ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); -+ } -+ -+ if (pwdinfo->ui_got_wps_info == P2P_NO_WPSINFO) { -+ result = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_INFOR_NOREADY); -+ return result; -+ } -+ -+#ifdef CONFIG_WFD -+ rtw_process_wfd_ies(padapter, pframe + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, __func__); -+#endif -+ -+ return result ; -+} -+ -+u8 process_p2p_group_negotation_resp(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ -+ _adapter *padapter = pwdinfo->padapter; -+ u8 result = P2P_STATUS_SUCCESS; -+ u32 p2p_ielen, wps_ielen; -+ u8 *ies; -+ u32 ies_len; -+ u8 *p2p_ie; -+#ifdef CONFIG_WFD -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+#endif /* CONFIG_TDLS */ -+#endif /* CONFIG_WFD */ -+ -+ ies = pframe + _PUBLIC_ACTION_IE_OFFSET_; -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ /* Be able to know which one is the P2P GO and which one is P2P client. */ -+ -+ if (rtw_get_wps_ie(ies, ies_len, NULL, &wps_ielen)) { -+ -+ } else { -+ RTW_INFO("[%s] WPS IE not Found!!\n", __FUNCTION__); -+ result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ } -+ -+ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); -+ if (!p2p_ie) { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; -+ } else { -+ -+ u8 attr_content = 0x00; -+ u32 attr_contentlen = 0; -+ u8 operatingch_info[5] = { 0x00 }; -+ uint ch_cnt = 0; -+ u8 ch_content[100] = { 0x00 }; -+ u8 groupid[38]; -+ u16 cap_attr; -+ u8 peer_ch_list[100] = { 0x00 }; -+ u8 peer_ch_num = 0; -+ u8 ch_list_inclusioned[100] = { 0x00 }; -+ u8 ch_num_inclusioned = 0; -+ -+ while (p2p_ie) { /* Found the P2P IE. */ -+ -+ /* Check P2P Capability ATTR */ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8 *)&cap_attr, (uint *)&attr_contentlen)) { -+ cap_attr = le16_to_cpu(cap_attr); -+#ifdef CONFIG_TDLS -+ if (!(cap_attr & P2P_GRPCAP_INTRABSS)) -+ ptdlsinfo->ap_prohibited = _TRUE; -+#endif /* CONFIG_TDLS */ -+ } -+ -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, &attr_content, &attr_contentlen); -+ if (attr_contentlen == 1) { -+ RTW_INFO("[%s] Status = %d\n", __FUNCTION__, attr_content); -+ if (attr_content == P2P_STATUS_SUCCESS) { -+ /* Do nothing. */ -+ } else { -+ if (P2P_STATUS_FAIL_INFO_UNAVAILABLE == attr_content) -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_INFOR_NOREADY); -+ else -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ result = attr_content; -+ break; -+ } -+ } -+ -+ /* Try to get the peer's interface address */ -+ attr_contentlen = 0; -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_INTENDED_IF_ADDR, pwdinfo->p2p_peer_interface_addr, &attr_contentlen)) { -+ if (attr_contentlen != ETH_ALEN) -+ _rtw_memset(pwdinfo->p2p_peer_interface_addr, 0x00, ETH_ALEN); -+ } -+ -+ /* Try to get the peer's intent and tie breaker value. */ -+ attr_content = 0x00; -+ attr_contentlen = 0; -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT , &attr_content, &attr_contentlen)) { -+ RTW_INFO("[%s] GO Intent = %d, tie = %d\n", __FUNCTION__, attr_content >> 1, attr_content & 0x01); -+ pwdinfo->peer_intent = attr_content; /* include both intent and tie breaker values. */ -+ -+ if (pwdinfo->intent == (pwdinfo->peer_intent >> 1)) { -+ /* Try to match the tie breaker value */ -+ if (pwdinfo->intent == P2P_MAX_INTENT) { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ result = P2P_STATUS_FAIL_BOTH_GOINTENT_15; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ } else { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ if (attr_content & 0x01) -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ else -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } -+ } else if (pwdinfo->intent > (pwdinfo->peer_intent >> 1)) { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } else { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ } -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ /* Store the group id information. */ -+ _rtw_memcpy(pwdinfo->groupid_info.go_device_addr, pwdinfo->device_addr, ETH_ALEN); -+ _rtw_memcpy(pwdinfo->groupid_info.ssid, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen); -+ -+ } -+ } -+ -+ /* Try to get the operation channel information */ -+ -+ attr_contentlen = 0; -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen)) { -+ RTW_INFO("[%s] Peer's operating channel = %d\n", __FUNCTION__, operatingch_info[4]); -+ pwdinfo->peer_operating_ch = operatingch_info[4]; -+ } -+ -+ /* Try to get the channel list information */ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, pwdinfo->channel_list_attr, &pwdinfo->channel_list_attr_len)) { -+ RTW_INFO("[%s] channel list attribute found, len = %d\n", __FUNCTION__, pwdinfo->channel_list_attr_len); -+ -+ peer_ch_num = rtw_p2p_get_peer_ch_list(pwdinfo, pwdinfo->channel_list_attr, pwdinfo->channel_list_attr_len, peer_ch_list); -+ ch_num_inclusioned = rtw_p2p_ch_inclusion(&padapter->mlmeextpriv, peer_ch_list, peer_ch_num, ch_list_inclusioned); -+ -+ if (ch_num_inclusioned == 0) { -+ RTW_INFO("[%s] No common channel in channel list!\n", __FUNCTION__); -+ result = P2P_STATUS_FAIL_NO_COMMON_CH; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ break; -+ } -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ if (!rtw_p2p_is_channel_list_ok(pwdinfo->operating_channel, -+ ch_list_inclusioned, ch_num_inclusioned)) { -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) -+ && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { -+ RTW_INFO("[%s] desired channel NOT Found!\n", __FUNCTION__); -+ result = P2P_STATUS_FAIL_NO_COMMON_CH; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ break; -+ } else -+#endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ u8 operatingch_info[5] = { 0x00 }, peer_operating_ch = 0; -+ attr_contentlen = 0; -+ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen)) -+ peer_operating_ch = operatingch_info[4]; -+ -+ if (rtw_p2p_is_channel_list_ok(peer_operating_ch, -+ ch_list_inclusioned, ch_num_inclusioned)) { -+ /** -+ * Change our operating channel as peer's for compatibility. -+ */ -+ pwdinfo->operating_channel = peer_operating_ch; -+ RTW_INFO("[%s] Change op ch to %02x as peer's\n", __FUNCTION__, pwdinfo->operating_channel); -+ } else { -+ /* Take first channel of ch_list_inclusioned as operating channel */ -+ pwdinfo->operating_channel = ch_list_inclusioned[0]; -+ RTW_INFO("[%s] Change op ch to %02x\n", __FUNCTION__, pwdinfo->operating_channel); -+ } -+ } -+ -+ } -+ } -+ -+ } else -+ RTW_INFO("[%s] channel list attribute not found!\n", __FUNCTION__); -+ -+ /* Try to get the group id information if peer is GO */ -+ attr_contentlen = 0; -+ _rtw_memset(groupid, 0x00, 38); -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, groupid, &attr_contentlen)) { -+ _rtw_memcpy(pwdinfo->groupid_info.go_device_addr, &groupid[0], ETH_ALEN); -+ _rtw_memcpy(pwdinfo->groupid_info.ssid, &groupid[6], attr_contentlen - ETH_ALEN); -+ } -+ -+ /* Get the next P2P IE */ -+ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); -+ } -+ -+ } -+ -+#ifdef CONFIG_WFD -+ rtw_process_wfd_ies(padapter, pframe + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, __func__); -+#endif -+ -+ return result ; -+ -+} -+ -+u8 process_p2p_group_negotation_confirm(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ -+ _adapter *padapter = pwdinfo->padapter; -+ u8 *ies; -+ u32 ies_len; -+ u8 *p2p_ie; -+ u32 p2p_ielen = 0; -+ u8 result = P2P_STATUS_SUCCESS; -+ ies = pframe + _PUBLIC_ACTION_IE_OFFSET_; -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); -+ while (p2p_ie) { /* Found the P2P IE. */ -+ u8 attr_content = 0x00, operatingch_info[5] = { 0x00 }; -+ u8 groupid[38] = { 0x00 }; -+ u32 attr_contentlen = 0; -+ -+ pwdinfo->negotiation_dialog_token = 1; -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, &attr_content, &attr_contentlen); -+ if (attr_contentlen == 1) { -+ RTW_INFO("[%s] Status = %d\n", __FUNCTION__, attr_content); -+ result = attr_content; -+ -+ if (attr_content == P2P_STATUS_SUCCESS) { -+ u8 bcancelled = 0; -+ -+ _cancel_timer(&pwdinfo->restore_p2p_state_timer, &bcancelled); -+ -+ /* Commented by Albert 20100911 */ -+ /* Todo: Need to handle the case which both Intents are the same. */ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ if ((pwdinfo->intent) > (pwdinfo->peer_intent >> 1)) -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ else if ((pwdinfo->intent) < (pwdinfo->peer_intent >> 1)) -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ else { -+ /* Have to compare the Tie Breaker */ -+ if (pwdinfo->peer_intent & 0x01) -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ else -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) -+ && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { -+ /* Switch back to the AP channel soon. */ -+ _set_timer(&pwdinfo->ap_p2p_switch_timer, 100); -+ } -+#endif -+ } else { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ break; -+ } -+ } -+ -+ /* Try to get the group id information */ -+ attr_contentlen = 0; -+ _rtw_memset(groupid, 0x00, 38); -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, groupid, &attr_contentlen)) { -+ RTW_INFO("[%s] Ssid = %s, ssidlen = %zu\n", __FUNCTION__, &groupid[ETH_ALEN], strlen(&groupid[ETH_ALEN])); -+ _rtw_memcpy(pwdinfo->groupid_info.go_device_addr, &groupid[0], ETH_ALEN); -+ _rtw_memcpy(pwdinfo->groupid_info.ssid, &groupid[6], attr_contentlen - ETH_ALEN); -+ } -+ -+ attr_contentlen = 0; -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen)) { -+ RTW_INFO("[%s] Peer's operating channel = %d\n", __FUNCTION__, operatingch_info[4]); -+ pwdinfo->peer_operating_ch = operatingch_info[4]; -+ } -+ -+ /* Get the next P2P IE */ -+ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); -+ -+ } -+ -+ return result ; -+} -+ -+u8 process_p2p_presence_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ -+ u8 *frame_body; -+ u8 dialogToken = 0; -+ u8 status = P2P_STATUS_SUCCESS; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ dialogToken = frame_body[6]; -+ -+ /* todo: check NoA attribute */ -+ -+ issue_p2p_presence_resp(pwdinfo, GetAddr2Ptr(pframe), status, dialogToken); -+ -+ return _TRUE; -+} -+ -+void find_phase_handler(_adapter *padapter) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ NDIS_802_11_SSID ssid; -+ _irqL irqL; -+ u8 _status = 0; -+ -+ -+ _rtw_memset((unsigned char *)&ssid, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN); -+ ssid.SsidLength = P2P_WILDCARD_SSID_LEN; -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ _status = rtw_sitesurvey_cmd(padapter, &ssid, 1, NULL, 0); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+} -+ -+void p2p_concurrent_handler(_adapter *padapter); -+ -+void restore_p2p_state_handler(_adapter *padapter) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL)) -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ u8 union_bw = rtw_mi_get_union_bw(padapter); -+ u8 union_offset = rtw_mi_get_union_offset(padapter); -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_RSP)) { -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ rtw_mi_buddy_issue_nulldata(padapter, NULL, 0, 3, 500); -+ } -+ } -+#endif -+ -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE)) { -+#ifdef CONFIG_CONCURRENT_MODE -+ p2p_concurrent_handler(padapter); -+#else -+ /* In the P2P client mode, the driver should not switch back to its listen channel */ -+ /* because this P2P client should stay at the operating channel of P2P GO. */ -+ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+#endif -+ } -+} -+ -+void pre_tx_invitereq_handler(_adapter *padapter) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ u8 val8 = 1; -+ -+ set_channel_bwmode(padapter, pwdinfo->invitereq_info.peer_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq_p2p(padapter, NULL); -+ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); -+ -+} -+ -+void pre_tx_provdisc_handler(_adapter *padapter) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ u8 val8 = 1; -+ -+ set_channel_bwmode(padapter, pwdinfo->tx_prov_disc_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq_p2p(padapter, NULL); -+ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); -+ -+} -+ -+void pre_tx_negoreq_handler(_adapter *padapter) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ u8 val8 = 1; -+ -+ set_channel_bwmode(padapter, pwdinfo->nego_req_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq_p2p(padapter , NULL); -+ /* WIN Phone only accept unicast probe request when nego back */ -+ issue_probereq_p2p(padapter , pwdinfo->nego_req_info.peerDevAddr); -+ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); -+ -+} -+ -+#ifdef CONFIG_CONCURRENT_MODE -+void p2p_concurrent_handler(_adapter *padapter) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 val8; -+ -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ u8 union_bw = rtw_mi_get_union_bw(padapter); -+ u8 union_offset = rtw_mi_get_union_offset(padapter); -+ -+ pwdinfo->operating_channel = union_ch; -+ -+ if (pwdinfo->driver_interface == DRIVER_CFG80211) { -+ RTW_INFO("%s, switch ch back to union_ch=%d\n", __func__, union_ch); -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ -+ rtw_mi_buddy_issue_nulldata(padapter, NULL, 0, 3, 500); -+ -+ } else if (pwdinfo->driver_interface == DRIVER_WEXT) { -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) { -+ /* Now, the driver stays on the AP's channel. */ -+ /* If the pwdinfo->ext_listen_period = 0, that means the P2P listen state is not available on listen channel. */ -+ if (pwdinfo->ext_listen_period > 0) { -+ RTW_INFO("[%s] P2P_STATE_IDLE, ext_listen_period = %d\n", __FUNCTION__, pwdinfo->ext_listen_period); -+ -+ if (union_ch != pwdinfo->listen_channel) { -+ /* Will switch to listen channel so that need to send the NULL data with PW bit to AP. */ -+ rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); -+ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+ -+ if (!rtw_mi_check_mlmeinfo_state(padapter, WIFI_FW_AP_STATE)) { -+ val8 = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ } -+ /* Todo: To check the value of pwdinfo->ext_listen_period is equal to 0 or not. */ -+ _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period); -+ } -+ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) || -+ rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL) || -+ (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) && pwdinfo->nego_req_info.benable == _FALSE) || -+ rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ)) { -+ /* Now, the driver is in the listen state of P2P mode. */ -+ RTW_INFO("[%s] P2P_STATE_IDLE, ext_listen_interval = %d\n", __FUNCTION__, pwdinfo->ext_listen_interval); -+ -+ /* Commented by Albert 2012/11/01 */ -+ /* If the AP's channel is the same as the listen channel, we should still be in the listen state */ -+ /* Other P2P device is still able to find this device out even this device is in the AP's channel. */ -+ /* So, configure this device to be able to receive the probe request frame and set it to listen state. */ -+ if (union_ch != pwdinfo->listen_channel) { -+ -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ if (!rtw_mi_check_status(padapter, MI_AP_MODE)) { -+ val8 = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ } -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_IDLE); -+ rtw_mi_buddy_issue_nulldata(padapter, NULL, 0, 3, 500); -+ } -+ -+ /* Todo: To check the value of pwdinfo->ext_listen_interval is equal to 0 or not. */ -+ _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_interval); -+ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_OK)) { -+ /* The driver had finished the P2P handshake successfully. */ -+ val8 = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ rtw_mi_buddy_issue_nulldata(padapter, NULL, 0, 3, 500); -+ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) { -+ val8 = 1; -+ set_channel_bwmode(padapter, pwdinfo->tx_prov_disc_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq_p2p(padapter, NULL); -+ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); -+ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) && pwdinfo->nego_req_info.benable == _TRUE) { -+ val8 = 1; -+ set_channel_bwmode(padapter, pwdinfo->nego_req_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq_p2p(padapter, NULL); -+ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); -+ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ) && pwdinfo->invitereq_info.benable == _TRUE) { -+ /* -+ val8 = 1; -+ set_channel_bwmode(padapter, , HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq_p2p(padapter, NULL); -+ _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ */ -+ } -+ } -+ } else { -+ /* In p2p+softap. When in P2P_STATE_GONEGO_OK, not back to listen channel.*/ -+ if (!rtw_p2p_chk_state(pwdinfo , P2P_STATE_GONEGO_OK) || padapter->registrypriv.full_ch_in_p2p_handshake == 0) -+ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ else -+ RTW_INFO("%s, buddy not linked, go nego ok, not back to listen channel\n", __func__); -+ } -+ -+} -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+static int ro_ch_handler(_adapter *adapter, u8 *buf) -+{ -+ /* TODO: move remain on channel logical here */ -+ return H2C_SUCCESS; -+} -+ -+static int cancel_ro_ch_handler(_adapter *padapter, u8 *buf) -+{ -+ int ret = H2C_SUCCESS; -+ struct p2p_roch_parm *roch_parm = (struct p2p_roch_parm *)buf; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+ struct wireless_dev *wdev; -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ u8 ch, bw, offset; -+ -+ _enter_critical_mutex(&pwdev_priv->roch_mutex, NULL); -+ -+ if (rtw_cfg80211_get_is_roch(padapter) != _TRUE) -+ goto exit; -+ -+ if (roch_parm->wdev && roch_parm->cookie) { -+ if (pcfg80211_wdinfo->ro_ch_wdev != roch_parm->wdev) { -+ RTW_WARN(FUNC_ADPT_FMT" ongoing wdev:%p, wdev:%p\n" -+ , FUNC_ADPT_ARG(padapter), pcfg80211_wdinfo->ro_ch_wdev, roch_parm->wdev); -+ rtw_warn_on(1); -+ } -+ -+ if (pcfg80211_wdinfo->remain_on_ch_cookie != roch_parm->cookie) { -+ RTW_WARN(FUNC_ADPT_FMT" ongoing cookie:0x%llx, cookie:0x%llx\n" -+ , FUNC_ADPT_ARG(padapter), pcfg80211_wdinfo->remain_on_ch_cookie, roch_parm->cookie); -+ rtw_warn_on(1); -+ } -+ } -+ -+ if (rtw_mi_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ } else if (adapter_wdev_data(padapter)->p2p_enabled && pwdinfo->listen_channel) { -+ ch = pwdinfo->listen_channel; -+ bw = CHANNEL_WIDTH_20; -+ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" back to listen ch - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ } else { -+ ch = pcfg80211_wdinfo->restore_channel; -+ bw = CHANNEL_WIDTH_20; -+ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" back to restore ch - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ } -+ -+ set_channel_bwmode(padapter, ch, offset, bw); -+ -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); -+#endif -+ -+ wdev = pcfg80211_wdinfo->ro_ch_wdev; -+ -+ rtw_cfg80211_set_is_roch(padapter, _FALSE); -+ pcfg80211_wdinfo->ro_ch_wdev = NULL; -+ pcfg80211_wdinfo->last_ro_ch_time = rtw_get_current_time(); -+ -+ rtw_cfg80211_remain_on_channel_expired(wdev -+ , pcfg80211_wdinfo->remain_on_ch_cookie -+ , &pcfg80211_wdinfo->remain_on_ch_channel -+ , pcfg80211_wdinfo->remain_on_ch_type, GFP_KERNEL); -+ -+ RTW_INFO("cfg80211_remain_on_channel_expired cookie:0x%llx\n" -+ , pcfg80211_wdinfo->remain_on_ch_cookie); -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_ScanNotify(padapter, _FALSE); -+#endif -+ -+exit: -+ _exit_critical_mutex(&pwdev_priv->roch_mutex, NULL); -+ -+ return ret; -+} -+ -+static void ro_ch_timer_process(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ -+ p2p_cancel_roch_cmd(adapter, 0, NULL, 0); -+} -+ -+static void rtw_change_p2pie_op_ch(_adapter *padapter, const u8 *frame_body, u32 len, u8 ch) -+{ -+ u8 *ies, *p2p_ie; -+ u32 ies_len, p2p_ielen; -+ -+ ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); -+ -+ while (p2p_ie) { -+ u32 attr_contentlen = 0; -+ u8 *pattr = NULL; -+ -+ /* Check P2P_ATTR_OPERATING_CH */ -+ attr_contentlen = 0; -+ pattr = NULL; -+ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, (uint *)&attr_contentlen); -+ if (pattr != NULL) -+ *(pattr + 4) = ch; -+ -+ /* Get the next P2P IE */ -+ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); -+ } -+} -+ -+static void rtw_change_p2pie_ch_list(_adapter *padapter, const u8 *frame_body, u32 len, u8 ch) -+{ -+ u8 *ies, *p2p_ie; -+ u32 ies_len, p2p_ielen; -+ -+ ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); -+ -+ while (p2p_ie) { -+ u32 attr_contentlen = 0; -+ u8 *pattr = NULL; -+ -+ /* Check P2P_ATTR_CH_LIST */ -+ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, (uint *)&attr_contentlen); -+ if (pattr != NULL) { -+ int i; -+ u32 num_of_ch; -+ u8 *pattr_temp = pattr + 3 ; -+ -+ attr_contentlen -= 3; -+ -+ while (attr_contentlen > 0) { -+ num_of_ch = *(pattr_temp + 1); -+ -+ for (i = 0; i < num_of_ch; i++) -+ *(pattr_temp + 2 + i) = ch; -+ -+ pattr_temp += (2 + num_of_ch); -+ attr_contentlen -= (2 + num_of_ch); -+ } -+ } -+ -+ /* Get the next P2P IE */ -+ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); -+ } -+} -+ -+static bool rtw_chk_p2pie_ch_list_with_buddy(_adapter *padapter, const u8 *frame_body, u32 len) -+{ -+ bool fit = _FALSE; -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 *ies, *p2p_ie; -+ u32 ies_len, p2p_ielen; -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ -+ ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); -+ -+ while (p2p_ie) { -+ u32 attr_contentlen = 0; -+ u8 *pattr = NULL; -+ -+ /* Check P2P_ATTR_CH_LIST */ -+ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, (uint *)&attr_contentlen); -+ if (pattr != NULL) { -+ int i; -+ u32 num_of_ch; -+ u8 *pattr_temp = pattr + 3 ; -+ -+ attr_contentlen -= 3; -+ -+ while (attr_contentlen > 0) { -+ num_of_ch = *(pattr_temp + 1); -+ -+ for (i = 0; i < num_of_ch; i++) { -+ if (*(pattr_temp + 2 + i) == union_ch) { -+ RTW_INFO(FUNC_ADPT_FMT" ch_list fit buddy_ch:%u\n", FUNC_ADPT_ARG(padapter), union_ch); -+ fit = _TRUE; -+ break; -+ } -+ } -+ -+ pattr_temp += (2 + num_of_ch); -+ attr_contentlen -= (2 + num_of_ch); -+ } -+ } -+ -+ /* Get the next P2P IE */ -+ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); -+ } -+#endif -+ return fit; -+} -+ -+static bool rtw_chk_p2pie_op_ch_with_buddy(_adapter *padapter, const u8 *frame_body, u32 len) -+{ -+ bool fit = _FALSE; -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 *ies, *p2p_ie; -+ u32 ies_len, p2p_ielen; -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ -+ ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); -+ -+ while (p2p_ie) { -+ u32 attr_contentlen = 0; -+ u8 *pattr = NULL; -+ -+ /* Check P2P_ATTR_OPERATING_CH */ -+ attr_contentlen = 0; -+ pattr = NULL; -+ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, (uint *)&attr_contentlen); -+ if (pattr != NULL) { -+ if (*(pattr + 4) == union_ch) { -+ RTW_INFO(FUNC_ADPT_FMT" op_ch fit buddy_ch:%u\n", FUNC_ADPT_ARG(padapter), union_ch); -+ fit = _TRUE; -+ break; -+ } -+ } -+ -+ /* Get the next P2P IE */ -+ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); -+ } -+#endif -+ return fit; -+} -+ -+static void rtw_cfg80211_adjust_p2pie_channel(_adapter *padapter, const u8 *frame_body, u32 len) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 *ies, *p2p_ie; -+ u32 ies_len, p2p_ielen; -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ -+ ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); -+ -+ while (p2p_ie) { -+ u32 attr_contentlen = 0; -+ u8 *pattr = NULL; -+ -+ /* Check P2P_ATTR_CH_LIST */ -+ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, (uint *)&attr_contentlen); -+ if (pattr != NULL) { -+ int i; -+ u32 num_of_ch; -+ u8 *pattr_temp = pattr + 3 ; -+ -+ attr_contentlen -= 3; -+ -+ while (attr_contentlen > 0) { -+ num_of_ch = *(pattr_temp + 1); -+ -+ for (i = 0; i < num_of_ch; i++) { -+ if (*(pattr_temp + 2 + i) && *(pattr_temp + 2 + i) != union_ch) { -+ #ifdef RTW_SINGLE_WIPHY -+ RTW_ERR("replace ch_list:%u with:%u\n", *(pattr_temp + 2 + i), union_ch); -+ #endif -+ *(pattr_temp + 2 + i) = union_ch; /*forcing to the same channel*/ -+ } -+ } -+ -+ pattr_temp += (2 + num_of_ch); -+ attr_contentlen -= (2 + num_of_ch); -+ } -+ } -+ -+ /* Check P2P_ATTR_OPERATING_CH */ -+ attr_contentlen = 0; -+ pattr = NULL; -+ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, (uint *)&attr_contentlen); -+ if (pattr != NULL) { -+ if (*(pattr + 4) && *(pattr + 4) != union_ch) { -+ #ifdef RTW_SINGLE_WIPHY -+ RTW_ERR("replace op_ch:%u with:%u\n", *(pattr + 4), union_ch); -+ #endif -+ *(pattr + 4) = union_ch; /*forcing to the same channel */ -+ } -+ } -+ -+ /* Get the next P2P IE */ -+ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); -+ -+ } -+ -+#endif -+} -+ -+#ifdef CONFIG_WFD -+u32 rtw_xframe_build_wfd_ie(struct xmit_frame *xframe) -+{ -+ _adapter *adapter = xframe->padapter; -+ struct wifidirect_info *wdinfo = &adapter->wdinfo; -+ u8 *frame = xframe->buf_addr + TXDESC_OFFSET; -+ u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 *frame_tail = frame + xframe->attrib.pktlen; -+ u8 category, action, OUI_Subtype, dialogToken = 0; -+ u32 wfdielen = 0; -+ -+ category = frame_body[0]; -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) { -+ action = frame_body[1]; -+ if (action == ACT_PUBLIC_VENDOR -+ && _rtw_memcmp(frame_body + 2, P2P_OUI, 4) == _TRUE -+ ) { -+ OUI_Subtype = frame_body[6]; -+ dialogToken = frame_body[7]; -+ -+ switch (OUI_Subtype) { -+ case P2P_GO_NEGO_REQ: -+ wfdielen = build_nego_req_wfd_ie(wdinfo, frame_tail); -+ break; -+ case P2P_GO_NEGO_RESP: -+ wfdielen = build_nego_resp_wfd_ie(wdinfo, frame_tail); -+ break; -+ case P2P_GO_NEGO_CONF: -+ wfdielen = build_nego_confirm_wfd_ie(wdinfo, frame_tail); -+ break; -+ case P2P_INVIT_REQ: -+ wfdielen = build_invitation_req_wfd_ie(wdinfo, frame_tail); -+ break; -+ case P2P_INVIT_RESP: -+ wfdielen = build_invitation_resp_wfd_ie(wdinfo, frame_tail); -+ break; -+ case P2P_PROVISION_DISC_REQ: -+ wfdielen = build_provdisc_req_wfd_ie(wdinfo, frame_tail); -+ break; -+ case P2P_PROVISION_DISC_RESP: -+ wfdielen = build_provdisc_resp_wfd_ie(wdinfo, frame_tail); -+ break; -+ case P2P_DEVDISC_REQ: -+ case P2P_DEVDISC_RESP: -+ default: -+ break; -+ } -+ -+ } -+ } else if (category == RTW_WLAN_CATEGORY_P2P) { -+ OUI_Subtype = frame_body[5]; -+ dialogToken = frame_body[6]; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("ACTION_CATEGORY_P2P: OUI=0x%x, OUI_Subtype=%d, dialogToken=%d\n" -+ , cpu_to_be32(*((u32 *)(frame_body + 1))), OUI_Subtype, dialogToken); -+#endif -+ -+ switch (OUI_Subtype) { -+ case P2P_NOTICE_OF_ABSENCE: -+ break; -+ case P2P_PRESENCE_REQUEST: -+ break; -+ case P2P_PRESENCE_RESPONSE: -+ break; -+ case P2P_GO_DISC_REQUEST: -+ break; -+ default: -+ break; -+ } -+ } else -+ RTW_INFO("%s, action frame category=%d\n", __func__, category); -+ -+ xframe->attrib.pktlen += wfdielen; -+ -+ return wfdielen; -+} -+#endif /* CONFIG_WFD */ -+ -+bool rtw_xframe_del_wfd_ie(struct xmit_frame *xframe) -+{ -+#define DBG_XFRAME_DEL_WFD_IE 0 -+ -+ _adapter *adapter = xframe->padapter; -+ u8 *frame = xframe->buf_addr + TXDESC_OFFSET; -+ u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 *frame_tail = frame + xframe->attrib.pktlen; -+ u8 category, action, OUI_Subtype; -+ u8 *ies = NULL; -+ uint ies_len_ori = 0; -+ uint ies_len = 0; -+ -+ category = frame_body[0]; -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) { -+ action = frame_body[1]; -+ if (action == ACT_PUBLIC_VENDOR -+ && _rtw_memcmp(frame_body + 2, P2P_OUI, 4) == _TRUE -+ ) { -+ OUI_Subtype = frame_body[6]; -+ -+ switch (OUI_Subtype) { -+ case P2P_GO_NEGO_REQ: -+ case P2P_GO_NEGO_RESP: -+ case P2P_GO_NEGO_CONF: -+ case P2P_INVIT_REQ: -+ case P2P_INVIT_RESP: -+ case P2P_PROVISION_DISC_REQ: -+ case P2P_PROVISION_DISC_RESP: -+ ies = frame_body + 8; -+ ies_len_ori = frame_tail - (frame_body + 8); -+ break; -+ } -+ } -+ } -+ -+ if (ies && ies_len_ori) { -+ ies_len = rtw_del_wfd_ie(ies, ies_len_ori, DBG_XFRAME_DEL_WFD_IE ? __func__ : NULL); -+ xframe->attrib.pktlen -= (ies_len_ori - ies_len); -+ } -+ -+ return ies_len_ori != ies_len; -+} -+ -+/* -+* rtw_xframe_chk_wfd_ie - -+* -+*/ -+void rtw_xframe_chk_wfd_ie(struct xmit_frame *xframe) -+{ -+ _adapter *adapter = xframe->padapter; -+ u8 *frame = xframe->buf_addr + TXDESC_OFFSET; -+ u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 *frame_tail = frame + xframe->attrib.pktlen; -+ -+ struct wifidirect_info *wdinfo = &adapter->wdinfo; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ u8 build = 0; -+ u8 del = 0; -+ -+ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) -+ del = 1; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (_TRUE == wdinfo->wfd_info->wfd_enable) -+#endif -+ del = build = 1; -+ -+ if (del) -+ rtw_xframe_del_wfd_ie(xframe); -+ -+#ifdef CONFIG_WFD -+ if (build) -+ rtw_xframe_build_wfd_ie(xframe); -+#endif -+} -+ -+u8 *dump_p2p_attr_ch_list(u8 *p2p_ie, uint p2p_ielen, u8 *buf, u32 buf_len) -+{ -+ uint attr_contentlen = 0; -+ u8 *pattr = NULL; -+ int w_sz = 0; -+ u8 ch_cnt = 0; -+ u8 ch_list[40]; -+ bool continuous = _FALSE; -+ -+ pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, &attr_contentlen); -+ if (pattr != NULL) { -+ int i, j; -+ u32 num_of_ch; -+ u8 *pattr_temp = pattr + 3 ; -+ -+ attr_contentlen -= 3; -+ -+ _rtw_memset(ch_list, 0, 40); -+ -+ while (attr_contentlen > 0) { -+ num_of_ch = *(pattr_temp + 1); -+ -+ for (i = 0; i < num_of_ch; i++) { -+ for (j = 0; j < ch_cnt; j++) { -+ if (ch_list[j] == *(pattr_temp + 2 + i)) -+ break; -+ } -+ if (j >= ch_cnt) -+ ch_list[ch_cnt++] = *(pattr_temp + 2 + i); -+ -+ } -+ -+ pattr_temp += (2 + num_of_ch); -+ attr_contentlen -= (2 + num_of_ch); -+ } -+ -+ for (j = 0; j < ch_cnt; j++) { -+ if (j == 0) -+ w_sz += snprintf(buf + w_sz, buf_len - w_sz, "%u", ch_list[j]); -+ else if (ch_list[j] - ch_list[j - 1] != 1) -+ w_sz += snprintf(buf + w_sz, buf_len - w_sz, ", %u", ch_list[j]); -+ else if (j != ch_cnt - 1 && ch_list[j + 1] - ch_list[j] == 1) { -+ /* empty */ -+ } else -+ w_sz += snprintf(buf + w_sz, buf_len - w_sz, "-%u", ch_list[j]); -+ } -+ } -+ return buf; -+} -+ -+/* -+ * return _TRUE if requester is GO, _FALSE if responder is GO -+ */ -+bool rtw_p2p_nego_intent_compare(u8 req, u8 resp) -+{ -+ if (req >> 1 == resp >> 1) -+ return req & 0x01 ? _TRUE : _FALSE; -+ else if (req >> 1 > resp >> 1) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx) -+{ -+ int is_p2p_frame = (-1); -+ unsigned char *frame_body; -+ u8 category, action, OUI_Subtype, dialogToken = 0; -+ u8 *p2p_ie = NULL; -+ uint p2p_ielen = 0; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ int status = -1; -+ u8 ch_list_buf[128] = {'\0'}; -+ int op_ch = -1; -+ int listen_ch = -1; -+ u8 intent = 0; -+ u8 *iaddr = NULL; -+ u8 *gbssid = NULL; -+ -+ frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ category = frame_body[0]; -+ /* just for check */ -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) { -+ action = frame_body[1]; -+ if (action == ACT_PUBLIC_VENDOR -+ && _rtw_memcmp(frame_body + 2, P2P_OUI, 4) == _TRUE -+ ) { -+ OUI_Subtype = frame_body[6]; -+ dialogToken = frame_body[7]; -+ is_p2p_frame = OUI_Subtype; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("ACTION_CATEGORY_PUBLIC: ACT_PUBLIC_VENDOR, OUI=0x%x, OUI_Subtype=%d, dialogToken=%d\n", -+ cpu_to_be32(*((u32 *)(frame_body + 2))), OUI_Subtype, dialogToken); -+ #endif -+ -+ p2p_ie = rtw_get_p2p_ie( -+ (u8 *)buf + sizeof(struct rtw_ieee80211_hdr_3addr) + _PUBLIC_ACTION_IE_OFFSET_ -+ , len - sizeof(struct rtw_ieee80211_hdr_3addr) - _PUBLIC_ACTION_IE_OFFSET_ -+ , NULL, &p2p_ielen); -+ -+ switch (OUI_Subtype) { /* OUI Subtype */ -+ u8 *cont; -+ uint cont_len; -+ case P2P_GO_NEGO_REQ: { -+ struct rtw_wdev_nego_info *nego_info = &pwdev_priv->nego_info; -+ -+ if (tx) { -+ #ifdef CONFIG_DRV_ISSUE_PROV_REQ /* IOT FOR S2 */ -+ if (pwdev_priv->provdisc_req_issued == _FALSE) -+ rtw_cfg80211_issue_p2p_provision_request(padapter, buf, len); -+ #endif /* CONFIG_DRV_ISSUE_PROV_REQ */ -+ -+ /* pwdev_priv->provdisc_req_issued = _FALSE; */ -+ -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) -+ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)); -+ #endif -+ } -+ -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len); -+ if (cont) -+ op_ch = *(cont + 4); -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, NULL, &cont_len); -+ if (cont) -+ listen_ch = *(cont + 4); -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT, NULL, &cont_len); -+ if (cont) -+ intent = *cont; -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_INTENDED_IF_ADDR, NULL, &cont_len); -+ if (cont && cont_len == 6) -+ iaddr = cont; -+ -+ if (nego_info->token != dialogToken) -+ rtw_wdev_nego_info_init(nego_info); -+ -+ _rtw_memcpy(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN); -+ if (iaddr) -+ _rtw_memcpy(tx ? nego_info->iface_addr : nego_info->peer_iface_addr, iaddr, ETH_ALEN); -+ nego_info->active = tx ? 1 : 0; -+ nego_info->token = dialogToken; -+ nego_info->req_op_ch = op_ch; -+ nego_info->req_listen_ch = listen_ch; -+ nego_info->req_intent = intent; -+ nego_info->state = 0; -+ -+ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); -+ RTW_INFO("RTW_%s:P2P_GO_NEGO_REQ, dialogToken=%d, intent:%u%s, listen_ch:%d, op_ch:%d, ch_list:%s" -+ , (tx == _TRUE) ? "Tx" : "Rx" , dialogToken , (intent >> 1) , intent & 0x1 ? "+" : "-" , listen_ch , op_ch , ch_list_buf); -+ if (iaddr) -+ _RTW_INFO(", iaddr:"MAC_FMT, MAC_ARG(iaddr)); -+ _RTW_INFO("\n"); -+ -+ if (!tx) { -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) -+ if (rtw_mi_check_status(padapter, MI_LINKED) -+ && rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE -+ && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); -+ rtw_change_p2pie_ch_list(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr), 0); -+ } -+ #endif -+ } -+ -+ break; -+ } -+ case P2P_GO_NEGO_RESP: { -+ struct rtw_wdev_nego_info *nego_info = &pwdev_priv->nego_info; -+ -+ if (tx) { -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) -+ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)); -+ #endif -+ } -+ -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len); -+ if (cont) -+ op_ch = *(cont + 4); -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT, NULL, &cont_len); -+ if (cont) -+ intent = *cont; -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len); -+ if (cont) -+ status = *cont; -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_INTENDED_IF_ADDR, NULL, &cont_len); -+ if (cont && cont_len == 6) -+ iaddr = cont; -+ -+ if (nego_info->token == dialogToken && nego_info->state == 0 -+ && _rtw_memcmp(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN) == _TRUE -+ ) { -+ if (iaddr) -+ _rtw_memcpy(tx ? nego_info->iface_addr : nego_info->peer_iface_addr, iaddr, ETH_ALEN); -+ nego_info->status = (status == -1) ? 0xff : status; -+ nego_info->rsp_op_ch = op_ch; -+ nego_info->rsp_intent = intent; -+ nego_info->state = 1; -+ if (status != 0) -+ nego_info->token = 0; /* init */ -+ } -+ -+ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); -+ RTW_INFO("RTW_%s:P2P_GO_NEGO_RESP, dialogToken=%d, intent:%u%s, status:%d, op_ch:%d, ch_list:%s" -+ , (tx == _TRUE) ? "Tx" : "Rx", dialogToken, (intent >> 1), intent & 0x1 ? "+" : "-", status, op_ch, ch_list_buf); -+ if (iaddr) -+ _RTW_INFO(", iaddr:"MAC_FMT, MAC_ARG(iaddr)); -+ _RTW_INFO("\n"); -+ -+ if (!tx) { -+ pwdev_priv->provdisc_req_issued = _FALSE; -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) -+ if (rtw_mi_check_status(padapter, MI_LINKED) -+ && rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE -+ && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { -+ RTW_INFO(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); -+ rtw_change_p2pie_ch_list(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr), 0); -+ } -+ #endif -+ } -+ -+ break; -+ } -+ case P2P_GO_NEGO_CONF: { -+ struct rtw_wdev_nego_info *nego_info = &pwdev_priv->nego_info; -+ bool is_go = _FALSE; -+ -+ if (tx) { -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) -+ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)); -+ #endif -+ } -+ -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len); -+ if (cont) -+ op_ch = *(cont + 4); -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len); -+ if (cont) -+ status = *cont; -+ -+ if (nego_info->token == dialogToken && nego_info->state == 1 -+ && _rtw_memcmp(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN) == _TRUE -+ ) { -+ nego_info->status = (status == -1) ? 0xff : status; -+ nego_info->conf_op_ch = (op_ch == -1) ? 0 : op_ch; -+ nego_info->state = 2; -+ -+ if (status == 0) { -+ if (rtw_p2p_nego_intent_compare(nego_info->req_intent, nego_info->rsp_intent) ^ !tx) -+ is_go = _TRUE; -+ } -+ -+ nego_info->token = 0; /* init */ -+ } -+ -+ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); -+ RTW_INFO("RTW_%s:P2P_GO_NEGO_CONF, dialogToken=%d, status:%d, op_ch:%d, ch_list:%s\n" -+ , (tx == _TRUE) ? "Tx" : "Rx", dialogToken, status, op_ch, ch_list_buf); -+ -+ if (!tx) { -+ } -+ -+ break; -+ } -+ case P2P_INVIT_REQ: { -+ struct rtw_wdev_invit_info *invit_info = &pwdev_priv->invit_info; -+ int flags = -1; -+ -+ if (tx) { -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) -+ if (rtw_mi_check_status(padapter, MI_LINKED) -+ && padapter->registrypriv.full_ch_in_p2p_handshake == 0) -+ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)); -+ #endif -+ } -+ -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_INVITATION_FLAGS, NULL, &cont_len); -+ if (cont) -+ flags = *cont; -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len); -+ if (cont) -+ op_ch = *(cont + 4); -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_BSSID, NULL, &cont_len); -+ if (cont && cont_len == 6) -+ gbssid = cont; -+ -+ if (invit_info->token != dialogToken) -+ rtw_wdev_invit_info_init(invit_info); -+ -+ _rtw_memcpy(invit_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN); -+ if (gbssid) -+ _rtw_memcpy(invit_info->group_bssid, gbssid, ETH_ALEN); -+ invit_info->active = tx ? 1 : 0; -+ invit_info->token = dialogToken; -+ invit_info->flags = (flags == -1) ? 0x0 : flags; -+ invit_info->req_op_ch = op_ch; -+ invit_info->state = 0; -+ -+ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); -+ RTW_INFO("RTW_%s:P2P_INVIT_REQ, dialogToken=%d, flags:0x%02x, op_ch:%d, ch_list:%s" -+ , (tx == _TRUE) ? "Tx" : "Rx", dialogToken, flags, op_ch, ch_list_buf); -+ if (gbssid) -+ _RTW_INFO(", gbssid:"MAC_FMT, MAC_ARG(gbssid)); -+ _RTW_INFO("\n"); -+ -+ if (!tx) { -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { -+ if (op_ch != -1 && rtw_chk_p2pie_op_ch_with_buddy(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE) { -+ RTW_INFO(FUNC_ADPT_FMT" op_ch:%u has no intersect with buddy\n", FUNC_ADPT_ARG(padapter), op_ch); -+ rtw_change_p2pie_ch_list(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr), 0); -+ } else if (rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE) { -+ RTW_INFO(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); -+ rtw_change_p2pie_ch_list(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr), 0); -+ } -+ } -+ #endif -+ } -+ -+ break; -+ } -+ case P2P_INVIT_RESP: { -+ struct rtw_wdev_invit_info *invit_info = &pwdev_priv->invit_info; -+ -+ if (tx) { -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) -+ if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) -+ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)); -+ #endif -+ } -+ -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len); -+ if (cont) { -+ #ifdef CONFIG_P2P_INVITE_IOT -+ if (tx && *cont == 7) { -+ RTW_INFO("TX_P2P_INVITE_RESP, status is no common channel, change to unknown group\n"); -+ *cont = 8; /* unknow group status */ -+ } -+ #endif /* CONFIG_P2P_INVITE_IOT */ -+ status = *cont; -+ } -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len); -+ if (cont) -+ op_ch = *(cont + 4); -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_BSSID, NULL, &cont_len); -+ if (cont && cont_len == 6) -+ gbssid = cont; -+ -+ if (invit_info->token == dialogToken && invit_info->state == 0 -+ && _rtw_memcmp(invit_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN) == _TRUE -+ ) { -+ invit_info->status = (status == -1) ? 0xff : status; -+ invit_info->rsp_op_ch = op_ch; -+ invit_info->state = 1; -+ invit_info->token = 0; /* init */ -+ } -+ -+ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); -+ RTW_INFO("RTW_%s:P2P_INVIT_RESP, dialogToken=%d, status:%d, op_ch:%d, ch_list:%s" -+ , (tx == _TRUE) ? "Tx" : "Rx", dialogToken, status, op_ch, ch_list_buf); -+ if (gbssid) -+ _RTW_INFO(", gbssid:"MAC_FMT, MAC_ARG(gbssid)); -+ _RTW_INFO("\n"); -+ -+ if (!tx) { -+ } -+ -+ break; -+ } -+ case P2P_DEVDISC_REQ: -+ RTW_INFO("RTW_%s:P2P_DEVDISC_REQ, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", dialogToken); -+ break; -+ case P2P_DEVDISC_RESP: -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len); -+ RTW_INFO("RTW_%s:P2P_DEVDISC_RESP, dialogToken=%d, status:%d\n", (tx == _TRUE) ? "Tx" : "Rx", dialogToken, cont ? *cont : -1); -+ break; -+ case P2P_PROVISION_DISC_REQ: { -+ size_t frame_body_len = len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 *p2p_ie; -+ uint p2p_ielen = 0; -+ uint contentlen = 0; -+ -+ RTW_INFO("RTW_%s:P2P_PROVISION_DISC_REQ, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", dialogToken); -+ -+ /* if(tx) */ -+ { -+ pwdev_priv->provdisc_req_issued = _FALSE; -+ -+ p2p_ie = rtw_get_p2p_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen); -+ if (p2p_ie) { -+ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, NULL, &contentlen)) { -+ pwdev_priv->provdisc_req_issued = _FALSE;/* case: p2p_client join p2p GO */ -+ } else { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("provdisc_req_issued is _TRUE\n"); -+ #endif /*CONFIG_DEBUG_CFG80211*/ -+ pwdev_priv->provdisc_req_issued = _TRUE;/* case: p2p_devices connection before Nego req. */ -+ } -+ -+ } -+ } -+ } -+ break; -+ case P2P_PROVISION_DISC_RESP: -+ RTW_INFO("RTW_%s:P2P_PROVISION_DISC_RESP, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", dialogToken); -+ break; -+ default: -+ RTW_INFO("RTW_%s:OUI_Subtype=%d, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", OUI_Subtype, dialogToken); -+ break; -+ } -+ -+ } -+ -+ } else if (category == RTW_WLAN_CATEGORY_P2P) { -+ OUI_Subtype = frame_body[5]; -+ dialogToken = frame_body[6]; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("ACTION_CATEGORY_P2P: OUI=0x%x, OUI_Subtype=%d, dialogToken=%d\n", -+ cpu_to_be32(*((u32 *)(frame_body + 1))), OUI_Subtype, dialogToken); -+ #endif -+ -+ is_p2p_frame = OUI_Subtype; -+ -+ switch (OUI_Subtype) { -+ case P2P_NOTICE_OF_ABSENCE: -+ RTW_INFO("RTW_%s:P2P_NOTICE_OF_ABSENCE, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", dialogToken); -+ break; -+ case P2P_PRESENCE_REQUEST: -+ RTW_INFO("RTW_%s:P2P_PRESENCE_REQUEST, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", dialogToken); -+ break; -+ case P2P_PRESENCE_RESPONSE: -+ RTW_INFO("RTW_%s:P2P_PRESENCE_RESPONSE, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", dialogToken); -+ break; -+ case P2P_GO_DISC_REQUEST: -+ RTW_INFO("RTW_%s:P2P_GO_DISC_REQUEST, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", dialogToken); -+ break; -+ default: -+ RTW_INFO("RTW_%s:OUI_Subtype=%d, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", OUI_Subtype, dialogToken); -+ break; -+ } -+ -+ } else -+ RTW_INFO("RTW_%s:action frame category=%d\n", (tx == _TRUE) ? "TX" : "RX", category); -+ -+ return is_p2p_frame; -+} -+ -+void rtw_init_cfg80211_wifidirect_info(_adapter *padapter) -+{ -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+ -+ _rtw_memset(pcfg80211_wdinfo, 0x00, sizeof(struct cfg80211_wifidirect_info)); -+ -+ _init_timer(&pcfg80211_wdinfo->remain_on_ch_timer, padapter->pnetdev, ro_ch_timer_process, padapter); -+} -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+s32 p2p_protocol_wk_hdl(_adapter *padapter, int intCmdType, u8 *buf) -+{ -+ int ret = H2C_SUCCESS; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ switch (intCmdType) { -+ case P2P_FIND_PHASE_WK: -+ find_phase_handler(padapter); -+ break; -+ -+ case P2P_RESTORE_STATE_WK: -+ restore_p2p_state_handler(padapter); -+ break; -+ -+ case P2P_PRE_TX_PROVDISC_PROCESS_WK: -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ p2p_concurrent_handler(padapter); -+ else -+ pre_tx_provdisc_handler(padapter); -+#else -+ pre_tx_provdisc_handler(padapter); -+#endif -+ break; -+ -+ case P2P_PRE_TX_INVITEREQ_PROCESS_WK: -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ p2p_concurrent_handler(padapter); -+ else -+ pre_tx_invitereq_handler(padapter); -+#else -+ pre_tx_invitereq_handler(padapter); -+#endif -+ break; -+ -+ case P2P_PRE_TX_NEGOREQ_PROCESS_WK: -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ p2p_concurrent_handler(padapter); -+ else -+ pre_tx_negoreq_handler(padapter); -+#else -+ pre_tx_negoreq_handler(padapter); -+#endif -+ break; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ case P2P_AP_P2P_CH_SWITCH_PROCESS_WK: -+ p2p_concurrent_handler(padapter); -+ break; -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ case P2P_RO_CH_WK: -+ ret = ro_ch_handler(padapter, buf); -+ break; -+ case P2P_CANCEL_RO_CH_WK: -+ ret = cancel_ro_ch_handler(padapter, buf); -+ break; -+#endif -+ -+ default: -+ rtw_warn_on(1); -+ break; -+ } -+ -+ return ret; -+} -+ -+int process_p2p_cross_connect_ie(PADAPTER padapter, u8 *IEs, u32 IELength) -+{ -+ int ret = _TRUE; -+ u8 *ies; -+ u32 ies_len; -+ u8 *p2p_ie; -+ u32 p2p_ielen = 0; -+ u8 p2p_attr[MAX_P2P_IE_LEN] = { 0x00 };/* NoA length should be n*(13) + 2 */ -+ u32 attr_contentlen = 0; -+ -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ -+ if (IELength <= _BEACON_IE_OFFSET_) -+ return ret; -+ -+ ies = IEs + _BEACON_IE_OFFSET_; -+ ies_len = IELength - _BEACON_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); -+ -+ while (p2p_ie) { -+ /* Get P2P Manageability IE. */ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_MANAGEABILITY, p2p_attr, &attr_contentlen)) { -+ if ((p2p_attr[0] & (BIT(0) | BIT(1))) == 0x01) -+ ret = _FALSE; -+ break; -+ } -+ /* Get the next P2P IE */ -+ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); -+ } -+ -+ return ret; -+} -+ -+#ifdef CONFIG_P2P_PS -+void process_p2p_ps_ie(PADAPTER padapter, u8 *IEs, u32 IELength) -+{ -+ u8 *ies; -+ u32 ies_len; -+ u8 *p2p_ie; -+ u32 p2p_ielen = 0; -+ u8 noa_attr[MAX_P2P_IE_LEN] = { 0x00 };/* NoA length should be n*(13) + 2 */ -+ u32 attr_contentlen = 0; -+ -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 find_p2p = _FALSE, find_p2p_ps = _FALSE; -+ u8 noa_offset, noa_num, noa_index; -+ -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->hw_port != HW_PORT0) -+ return; -+#endif -+ if (IELength <= _BEACON_IE_OFFSET_) -+ return; -+ -+ ies = IEs + _BEACON_IE_OFFSET_; -+ ies_len = IELength - _BEACON_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie(ies, ies_len, NULL, &p2p_ielen); -+ -+ while (p2p_ie) { -+ find_p2p = _TRUE; -+ /* Get Notice of Absence IE. */ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_NOA, noa_attr, &attr_contentlen)) { -+ find_p2p_ps = _TRUE; -+ noa_index = noa_attr[0]; -+ -+ if ((pwdinfo->p2p_ps_mode == P2P_PS_NONE) || -+ (noa_index != pwdinfo->noa_index)) { /* if index change, driver should reconfigure related setting. */ -+ pwdinfo->noa_index = noa_index; -+ pwdinfo->opp_ps = noa_attr[1] >> 7; -+ pwdinfo->ctwindow = noa_attr[1] & 0x7F; -+ -+ noa_offset = 2; -+ noa_num = 0; -+ /* NoA length should be n*(13) + 2 */ -+ if (attr_contentlen > 2) { -+ while (noa_offset < attr_contentlen) { -+ /* _rtw_memcpy(&wifidirect_info->noa_count[noa_num], &noa_attr[noa_offset], 1); */ -+ pwdinfo->noa_count[noa_num] = noa_attr[noa_offset]; -+ noa_offset += 1; -+ -+ _rtw_memcpy(&pwdinfo->noa_duration[noa_num], &noa_attr[noa_offset], 4); -+ noa_offset += 4; -+ -+ _rtw_memcpy(&pwdinfo->noa_interval[noa_num], &noa_attr[noa_offset], 4); -+ noa_offset += 4; -+ -+ _rtw_memcpy(&pwdinfo->noa_start_time[noa_num], &noa_attr[noa_offset], 4); -+ noa_offset += 4; -+ -+ noa_num++; -+ } -+ } -+ pwdinfo->noa_num = noa_num; -+ -+ if (pwdinfo->opp_ps == 1) { -+ pwdinfo->p2p_ps_mode = P2P_PS_CTWINDOW; -+ /* driver should wait LPS for entering CTWindow */ -+ if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) -+ p2p_ps_wk_cmd(padapter, P2P_PS_ENABLE, 1); -+ } else if (pwdinfo->noa_num > 0) { -+ pwdinfo->p2p_ps_mode = P2P_PS_NOA; -+ p2p_ps_wk_cmd(padapter, P2P_PS_ENABLE, 1); -+ } else if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) -+ p2p_ps_wk_cmd(padapter, P2P_PS_DISABLE, 1); -+ } -+ -+ break; /* find target, just break. */ -+ } -+ -+ /* Get the next P2P IE */ -+ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); -+ -+ } -+ -+ if (find_p2p == _TRUE) { -+ if ((pwdinfo->p2p_ps_mode > P2P_PS_NONE) && (find_p2p_ps == _FALSE)) -+ p2p_ps_wk_cmd(padapter, P2P_PS_DISABLE, 1); -+ } -+ -+} -+ -+void p2p_ps_wk_hdl(_adapter *padapter, u8 p2p_ps_state) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ -+ /* Pre action for p2p state */ -+ switch (p2p_ps_state) { -+ case P2P_PS_DISABLE: -+ pwdinfo->p2p_ps_state = p2p_ps_state; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_P2P_PS_OFFLOAD, (u8 *)(&p2p_ps_state)); -+ -+ pwdinfo->noa_index = 0; -+ pwdinfo->ctwindow = 0; -+ pwdinfo->opp_ps = 0; -+ pwdinfo->noa_num = 0; -+ pwdinfo->p2p_ps_mode = P2P_PS_NONE; -+ if (pwrpriv->bFwCurrentInPSMode == _TRUE) { -+ if (pwrpriv->smart_ps == 0) { -+ pwrpriv->smart_ps = 2; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&(pwrpriv->pwr_mode))); -+ } -+ } -+ break; -+ case P2P_PS_ENABLE: -+ if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) { -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) { -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { -+ RTW_INFO("P2P PS enble under MCC\n"); -+ rtw_warn_on(1); -+ } -+ -+ } -+#endif /* CONFIG_MCC_MODE */ -+ pwdinfo->p2p_ps_state = p2p_ps_state; -+ -+ if (pwdinfo->ctwindow > 0) { -+ if (pwrpriv->smart_ps != 0) { -+ pwrpriv->smart_ps = 0; -+ RTW_INFO("%s(): Enter CTW, change SmartPS\n", __FUNCTION__); -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&(pwrpriv->pwr_mode))); -+ } -+ } -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_P2P_PS_OFFLOAD, (u8 *)(&p2p_ps_state)); -+ } -+ break; -+ case P2P_PS_SCAN: -+ case P2P_PS_SCAN_DONE: -+ case P2P_PS_ALLSTASLEEP: -+ if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) { -+ pwdinfo->p2p_ps_state = p2p_ps_state; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_P2P_PS_OFFLOAD, (u8 *)(&p2p_ps_state)); -+ } -+ break; -+ default: -+ break; -+ } -+ -+} -+ -+u8 p2p_ps_wk_cmd(_adapter *padapter, u8 p2p_ps_state, u8 enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) -+#ifdef CONFIG_CONCURRENT_MODE -+ || (padapter->hw_port != HW_PORT0) -+#endif -+ ) -+ return res; -+ -+ if (enqueue) { -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = P2P_PS_WK_CID; -+ pdrvextra_cmd_parm->type = p2p_ps_state; -+ pdrvextra_cmd_parm->size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } else -+ p2p_ps_wk_hdl(padapter, p2p_ps_state); -+ -+exit: -+ -+ -+ return res; -+ -+} -+#endif /* CONFIG_P2P_PS */ -+ -+static void reset_ch_sitesurvey_timer_process(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ -+ RTW_INFO("[%s] In\n", __FUNCTION__); -+ /* Reset the operation channel information */ -+ pwdinfo->rx_invitereq_info.operation_ch[0] = 0; -+#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->rx_invitereq_info.operation_ch[1] = 0; -+ pwdinfo->rx_invitereq_info.operation_ch[2] = 0; -+ pwdinfo->rx_invitereq_info.operation_ch[3] = 0; -+#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ -+ pwdinfo->rx_invitereq_info.scan_op_ch_only = 0; -+} -+ -+static void reset_ch_sitesurvey_timer_process2(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ -+ RTW_INFO("[%s] In\n", __FUNCTION__); -+ /* Reset the operation channel information */ -+ pwdinfo->p2p_info.operation_ch[0] = 0; -+#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->p2p_info.operation_ch[1] = 0; -+ pwdinfo->p2p_info.operation_ch[2] = 0; -+ pwdinfo->p2p_info.operation_ch[3] = 0; -+#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ -+ pwdinfo->p2p_info.scan_op_ch_only = 0; -+} -+ -+static void restore_p2p_state_timer_process(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ -+ p2p_protocol_wk_cmd(adapter, P2P_RESTORE_STATE_WK); -+} -+ -+static void pre_tx_scan_timer_process(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *) FunctionContext; -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u8 _status = 0; -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) { -+ if (_TRUE == pwdinfo->tx_prov_disc_info.benable) { /* the provision discovery request frame is trigger to send or not */ -+ p2p_protocol_wk_cmd(adapter, P2P_PRE_TX_PROVDISC_PROCESS_WK); -+ /* issue_probereq_p2p(adapter, NULL); */ -+ /* _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); */ -+ } -+ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) { -+ if (_TRUE == pwdinfo->nego_req_info.benable) -+ p2p_protocol_wk_cmd(adapter, P2P_PRE_TX_NEGOREQ_PROCESS_WK); -+ } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ)) { -+ if (_TRUE == pwdinfo->invitereq_info.benable) -+ p2p_protocol_wk_cmd(adapter, P2P_PRE_TX_INVITEREQ_PROCESS_WK); -+ } else -+ RTW_INFO("[%s] p2p_state is %d, ignore!!\n", __FUNCTION__, rtw_p2p_state(pwdinfo)); -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+ -+static void find_phase_timer_process(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ -+ adapter->wdinfo.find_phase_state_exchange_cnt++; -+ -+ p2p_protocol_wk_cmd(adapter, P2P_FIND_PHASE_WK); -+} -+ -+#ifdef CONFIG_CONCURRENT_MODE -+void ap_p2p_switch_timer_process(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+#endif -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); -+#endif -+ -+ p2p_protocol_wk_cmd(adapter, P2P_AP_P2P_CH_SWITCH_PROCESS_WK); -+} -+#endif -+ -+void reset_global_wifidirect_info(_adapter *padapter) -+{ -+ struct wifidirect_info *pwdinfo; -+ -+ pwdinfo = &padapter->wdinfo; -+ pwdinfo->persistent_supported = 0; -+ pwdinfo->session_available = _TRUE; -+ rtw_tdls_wfd_enable(padapter, 0); -+ pwdinfo->wfd_tdls_weaksec = _TRUE; -+} -+ -+#ifdef CONFIG_WFD -+int rtw_init_wifi_display_info(_adapter *padapter) -+{ -+ int res = _SUCCESS; -+ struct wifi_display_info *pwfd_info = &padapter->wfd_info; -+ -+ /* Used in P2P and TDLS */ -+ pwfd_info->init_rtsp_ctrlport = 554; -+#ifdef CONFIG_IOCTL_CFG80211 -+ pwfd_info->rtsp_ctrlport = 0; -+#else -+ pwfd_info->rtsp_ctrlport = pwfd_info->init_rtsp_ctrlport; /* set non-zero value for legacy wfd */ -+#endif -+ pwfd_info->tdls_rtsp_ctrlport = 0; -+ pwfd_info->peer_rtsp_ctrlport = 0; /* Reset to 0 */ -+ pwfd_info->wfd_enable = _FALSE; -+ pwfd_info->wfd_device_type = WFD_DEVINFO_PSINK; -+ pwfd_info->scan_result_type = SCAN_RESULT_P2P_ONLY; -+ -+ /* Used in P2P */ -+ pwfd_info->peer_session_avail = _TRUE; -+ pwfd_info->wfd_pc = _FALSE; -+ -+ /* Used in TDLS */ -+ _rtw_memset(pwfd_info->ip_address, 0x00, 4); -+ _rtw_memset(pwfd_info->peer_ip_address, 0x00, 4); -+ return res; -+ -+} -+ -+inline void rtw_wfd_enable(_adapter *adapter, bool on) -+{ -+ struct wifi_display_info *wfdinfo = &adapter->wfd_info; -+ -+ if (on) { -+ wfdinfo->rtsp_ctrlport = wfdinfo->init_rtsp_ctrlport; -+ wfdinfo->wfd_enable = _TRUE; -+ -+ } else { -+ wfdinfo->wfd_enable = _FALSE; -+ wfdinfo->rtsp_ctrlport = 0; -+ } -+} -+ -+inline void rtw_wfd_set_ctrl_port(_adapter *adapter, u16 port) -+{ -+ struct wifi_display_info *wfdinfo = &adapter->wfd_info; -+ -+ wfdinfo->init_rtsp_ctrlport = port; -+ if (wfdinfo->wfd_enable == _TRUE) -+ wfdinfo->rtsp_ctrlport = port; -+ if (adapter->wdinfo.wfd_tdls_enable == 1) -+ wfdinfo->tdls_rtsp_ctrlport = port; -+} -+ -+inline void rtw_tdls_wfd_enable(_adapter *adapter, bool on) -+{ -+ struct wifi_display_info *wfdinfo = &adapter->wfd_info; -+ -+ if (on) { -+ wfdinfo->tdls_rtsp_ctrlport = wfdinfo->init_rtsp_ctrlport; -+ adapter->wdinfo.wfd_tdls_enable = 1; -+ -+ } else { -+ adapter->wdinfo.wfd_tdls_enable = 0; -+ wfdinfo->tdls_rtsp_ctrlport = 0; -+ } -+} -+ -+u32 rtw_append_beacon_wfd_ie(_adapter *adapter, u8 *pbuf) -+{ -+ struct wifidirect_info *wdinfo = &adapter->wdinfo; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ u8 build_ie_by_self = 0; -+ u32 len = 0; -+ -+ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (_TRUE == wdinfo->wfd_info->wfd_enable) -+#endif -+ build_ie_by_self = 1; -+ -+ if (build_ie_by_self) -+ len = build_beacon_wfd_ie(wdinfo, pbuf); -+#ifdef CONFIG_IOCTL_CFG80211 -+ else if (mlme->wfd_beacon_ie && mlme->wfd_beacon_ie_len > 0) { -+ len = mlme->wfd_beacon_ie_len; -+ _rtw_memcpy(pbuf, mlme->wfd_beacon_ie, len); -+ } -+#endif -+ -+exit: -+ return len; -+} -+ -+u32 rtw_append_probe_req_wfd_ie(_adapter *adapter, u8 *pbuf) -+{ -+ struct wifidirect_info *wdinfo = &adapter->wdinfo; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ u8 build_ie_by_self = 0; -+ u32 len = 0; -+ -+ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (_TRUE == wdinfo->wfd_info->wfd_enable) -+#endif -+ build_ie_by_self = 1; -+ -+ if (build_ie_by_self) -+ len = build_probe_req_wfd_ie(wdinfo, pbuf); -+#ifdef CONFIG_IOCTL_CFG80211 -+ else if (mlme->wfd_probe_req_ie && mlme->wfd_probe_req_ie_len > 0) { -+ len = mlme->wfd_probe_req_ie_len; -+ _rtw_memcpy(pbuf, mlme->wfd_probe_req_ie, len); -+ } -+#endif -+ -+exit: -+ return len; -+} -+ -+u32 rtw_append_probe_resp_wfd_ie(_adapter *adapter, u8 *pbuf) -+{ -+ struct wifidirect_info *wdinfo = &adapter->wdinfo; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ u8 build_ie_by_self = 0; -+ u32 len = 0; -+ -+ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (_TRUE == wdinfo->wfd_info->wfd_enable) -+#endif -+ build_ie_by_self = 1; -+ -+ if (build_ie_by_self) -+ len = build_probe_resp_wfd_ie(wdinfo, pbuf, 0); -+#ifdef CONFIG_IOCTL_CFG80211 -+ else if (mlme->wfd_probe_resp_ie && mlme->wfd_probe_resp_ie_len > 0) { -+ len = mlme->wfd_probe_resp_ie_len; -+ _rtw_memcpy(pbuf, mlme->wfd_probe_resp_ie, len); -+ } -+#endif -+ -+exit: -+ return len; -+} -+ -+u32 rtw_append_assoc_req_wfd_ie(_adapter *adapter, u8 *pbuf) -+{ -+ struct wifidirect_info *wdinfo = &adapter->wdinfo; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ u8 build_ie_by_self = 0; -+ u32 len = 0; -+ -+ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (_TRUE == wdinfo->wfd_info->wfd_enable) -+#endif -+ build_ie_by_self = 1; -+ -+ if (build_ie_by_self) -+ len = build_assoc_req_wfd_ie(wdinfo, pbuf); -+#ifdef CONFIG_IOCTL_CFG80211 -+ else if (mlme->wfd_assoc_req_ie && mlme->wfd_assoc_req_ie_len > 0) { -+ len = mlme->wfd_assoc_req_ie_len; -+ _rtw_memcpy(pbuf, mlme->wfd_assoc_req_ie, len); -+ } -+#endif -+ -+exit: -+ return len; -+} -+ -+u32 rtw_append_assoc_resp_wfd_ie(_adapter *adapter, u8 *pbuf) -+{ -+ struct wifidirect_info *wdinfo = &adapter->wdinfo; -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ u8 build_ie_by_self = 0; -+ u32 len = 0; -+ -+ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) -+ goto exit; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (_TRUE == wdinfo->wfd_info->wfd_enable) -+#endif -+ build_ie_by_self = 1; -+ -+ if (build_ie_by_self) -+ len = build_assoc_resp_wfd_ie(wdinfo, pbuf); -+#ifdef CONFIG_IOCTL_CFG80211 -+ else if (mlme->wfd_assoc_resp_ie && mlme->wfd_assoc_resp_ie_len > 0) { -+ len = mlme->wfd_assoc_resp_ie_len; -+ _rtw_memcpy(pbuf, mlme->wfd_assoc_resp_ie, len); -+ } -+#endif -+ -+exit: -+ return len; -+} -+ -+#endif /* CONFIG_WFD */ -+ -+void rtw_init_wifidirect_timers(_adapter *padapter) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ -+ _init_timer(&pwdinfo->find_phase_timer, padapter->pnetdev, find_phase_timer_process, padapter); -+ _init_timer(&pwdinfo->restore_p2p_state_timer, padapter->pnetdev, restore_p2p_state_timer_process, padapter); -+ _init_timer(&pwdinfo->pre_tx_scan_timer, padapter->pnetdev, pre_tx_scan_timer_process, padapter); -+ _init_timer(&pwdinfo->reset_ch_sitesurvey, padapter->pnetdev, reset_ch_sitesurvey_timer_process, padapter); -+ _init_timer(&pwdinfo->reset_ch_sitesurvey2, padapter->pnetdev, reset_ch_sitesurvey_timer_process2, padapter); -+#ifdef CONFIG_CONCURRENT_MODE -+ _init_timer(&pwdinfo->ap_p2p_switch_timer, padapter->pnetdev, ap_p2p_switch_timer_process, padapter); -+#endif -+} -+ -+void rtw_init_wifidirect_addrs(_adapter *padapter, u8 *dev_addr, u8 *iface_addr) -+{ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ -+ /*init device&interface address */ -+ if (dev_addr) -+ _rtw_memcpy(pwdinfo->device_addr, dev_addr, ETH_ALEN); -+ if (iface_addr) -+ _rtw_memcpy(pwdinfo->interface_addr, iface_addr, ETH_ALEN); -+#endif -+} -+ -+void init_wifidirect_info(_adapter *padapter, enum P2P_ROLE role) -+{ -+ struct wifidirect_info *pwdinfo; -+#ifdef CONFIG_WFD -+ struct wifi_display_info *pwfd_info = &padapter->wfd_info; -+#endif -+ u8 union_ch = 0; -+ pwdinfo = &padapter->wdinfo; -+ -+ pwdinfo->padapter = padapter; -+ -+ /* 1, 6, 11 are the social channel defined in the WiFi Direct specification. */ -+ pwdinfo->social_chan[0] = 1; -+ pwdinfo->social_chan[1] = 6; -+ pwdinfo->social_chan[2] = 11; -+ pwdinfo->social_chan[3] = 0; /* channel 0 for scanning ending in site survey function. */ -+ -+ if (role != P2P_ROLE_DISABLE -+ && pwdinfo->driver_interface != DRIVER_CFG80211 -+ ) { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ union_ch = rtw_mi_get_union_chan(padapter); -+ -+ if (union_ch != 0 && -+ (union_ch == 1 || union_ch == 6 || union_ch == 11) -+ ) { -+ /* Use the AP's channel as the listen channel */ -+ /* This will avoid the channel switch between AP's channel and listen channel */ -+ pwdinfo->listen_channel = union_ch; -+ } else -+ #endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ /* Use the channel 11 as the listen channel */ -+ pwdinfo->listen_channel = 11; -+ } -+ } -+ -+ if (role == P2P_ROLE_DEVICE) { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_IDLE); -+ else -+#endif -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+ -+ pwdinfo->intent = 1; -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_LISTEN); -+ } else if (role == P2P_ROLE_CLIENT) { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ pwdinfo->intent = 1; -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ } else if (role == P2P_ROLE_GO) { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ pwdinfo->intent = 15; -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ } -+ -+ /* Use the OFDM rate in the P2P probe response frame. ( 6(B), 9(B), 12, 18, 24, 36, 48, 54 ) */ -+ pwdinfo->support_rate[0] = 0x8c; /* 6(B) */ -+ pwdinfo->support_rate[1] = 0x92; /* 9(B) */ -+ pwdinfo->support_rate[2] = 0x18; /* 12 */ -+ pwdinfo->support_rate[3] = 0x24; /* 18 */ -+ pwdinfo->support_rate[4] = 0x30; /* 24 */ -+ pwdinfo->support_rate[5] = 0x48; /* 36 */ -+ pwdinfo->support_rate[6] = 0x60; /* 48 */ -+ pwdinfo->support_rate[7] = 0x6c; /* 54 */ -+ -+ _rtw_memcpy((void *) pwdinfo->p2p_wildcard_ssid, "DIRECT-", 7); -+ -+ _rtw_memset(pwdinfo->device_name, 0x00, WPS_MAX_DEVICE_NAME_LEN); -+ pwdinfo->device_name_len = 0; -+ -+ _rtw_memset(&pwdinfo->invitereq_info, 0x00, sizeof(struct tx_invite_req_info)); -+ pwdinfo->invitereq_info.token = 3; /* Token used for P2P invitation request frame. */ -+ -+ _rtw_memset(&pwdinfo->inviteresp_info, 0x00, sizeof(struct tx_invite_resp_info)); -+ pwdinfo->inviteresp_info.token = 0; -+ -+ pwdinfo->profileindex = 0; -+ _rtw_memset(&pwdinfo->profileinfo[0], 0x00, sizeof(struct profile_info) * P2P_MAX_PERSISTENT_GROUP_NUM); -+ -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+ -+ pwdinfo->listen_dwell = (u8)((rtw_get_current_time() % 3) + 1); -+ /* RTW_INFO( "[%s] listen_dwell time is %d00ms\n", __FUNCTION__, pwdinfo->listen_dwell ); */ -+ -+ _rtw_memset(&pwdinfo->tx_prov_disc_info, 0x00, sizeof(struct tx_provdisc_req_info)); -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_NONE; -+ -+ _rtw_memset(&pwdinfo->nego_req_info, 0x00, sizeof(struct tx_nego_req_info)); -+ -+ pwdinfo->device_password_id_for_nego = WPS_DPID_PBC; -+ pwdinfo->negotiation_dialog_token = 1; -+ -+ _rtw_memset(pwdinfo->nego_ssid, 0x00, WLAN_SSID_MAXLEN); -+ pwdinfo->nego_ssidlen = 0; -+ -+ pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO; -+#ifdef CONFIG_WFD -+ pwdinfo->supported_wps_cm = WPS_CONFIG_METHOD_DISPLAY | WPS_CONFIG_METHOD_PBC; -+ pwdinfo->wfd_info = pwfd_info; -+#else -+ pwdinfo->supported_wps_cm = WPS_CONFIG_METHOD_DISPLAY | WPS_CONFIG_METHOD_PBC | WPS_CONFIG_METHOD_KEYPAD; -+#endif /* CONFIG_WFD */ -+ pwdinfo->channel_list_attr_len = 0; -+ _rtw_memset(pwdinfo->channel_list_attr, 0x00, 100); -+ -+ _rtw_memset(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, 0x00, 4); -+ _rtw_memset(pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, '0', 3); -+ _rtw_memset(&pwdinfo->groupid_info, 0x00, sizeof(struct group_id_info)); -+#ifdef CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_IOCTL_CFG80211 -+ pwdinfo->ext_listen_interval = 1000; /* The interval to be available with legacy AP during p2p0-find/scan */ -+ pwdinfo->ext_listen_period = 3000; /* The time period to be available for P2P during nego */ -+#else /* !CONFIG_IOCTL_CFG80211 */ -+ /* pwdinfo->ext_listen_interval = 3000; */ -+ /* pwdinfo->ext_listen_period = 400; */ -+ pwdinfo->ext_listen_interval = 1000; -+ pwdinfo->ext_listen_period = 1000; -+#endif /* !CONFIG_IOCTL_CFG80211 */ -+#endif -+ -+ /* Commented by Kurt 20130319 -+ * For WiDi purpose: Use CFG80211 interface but controled WFD/RDS frame by driver itself. */ -+#ifdef CONFIG_IOCTL_CFG80211 -+ pwdinfo->driver_interface = DRIVER_CFG80211; -+#else -+ pwdinfo->driver_interface = DRIVER_WEXT; -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ pwdinfo->wfd_tdls_enable = 0; -+ _rtw_memset(pwdinfo->p2p_peer_interface_addr, 0x00, ETH_ALEN); -+ _rtw_memset(pwdinfo->p2p_peer_device_addr, 0x00, ETH_ALEN); -+ -+ pwdinfo->rx_invitereq_info.operation_ch[0] = 0; -+ pwdinfo->rx_invitereq_info.operation_ch[1] = 0; /* Used to indicate the scan end in site survey function */ -+#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->rx_invitereq_info.operation_ch[2] = 0; -+ pwdinfo->rx_invitereq_info.operation_ch[3] = 0; -+ pwdinfo->rx_invitereq_info.operation_ch[4] = 0; -+#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ -+ pwdinfo->rx_invitereq_info.scan_op_ch_only = 0; -+ pwdinfo->p2p_info.operation_ch[0] = 0; -+ pwdinfo->p2p_info.operation_ch[1] = 0; /* Used to indicate the scan end in site survey function */ -+#ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ pwdinfo->p2p_info.operation_ch[2] = 0; -+ pwdinfo->p2p_info.operation_ch[3] = 0; -+ pwdinfo->p2p_info.operation_ch[4] = 0; -+#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ -+ pwdinfo->p2p_info.scan_op_ch_only = 0; -+} -+ -+#ifdef CONFIG_DBG_P2P -+ -+/** -+ * rtw_p2p_role_txt - Get the p2p role name as a text string -+ * @role: P2P role -+ * Returns: The state name as a printable text string -+ */ -+const char *rtw_p2p_role_txt(enum P2P_ROLE role) -+{ -+ switch (role) { -+ case P2P_ROLE_DISABLE: -+ return "P2P_ROLE_DISABLE"; -+ case P2P_ROLE_DEVICE: -+ return "P2P_ROLE_DEVICE"; -+ case P2P_ROLE_CLIENT: -+ return "P2P_ROLE_CLIENT"; -+ case P2P_ROLE_GO: -+ return "P2P_ROLE_GO"; -+ default: -+ return "UNKNOWN"; -+ } -+} -+ -+/** -+ * rtw_p2p_state_txt - Get the p2p state name as a text string -+ * @state: P2P state -+ * Returns: The state name as a printable text string -+ */ -+const char *rtw_p2p_state_txt(enum P2P_STATE state) -+{ -+ switch (state) { -+ case P2P_STATE_NONE: -+ return "P2P_STATE_NONE"; -+ case P2P_STATE_IDLE: -+ return "P2P_STATE_IDLE"; -+ case P2P_STATE_LISTEN: -+ return "P2P_STATE_LISTEN"; -+ case P2P_STATE_SCAN: -+ return "P2P_STATE_SCAN"; -+ case P2P_STATE_FIND_PHASE_LISTEN: -+ return "P2P_STATE_FIND_PHASE_LISTEN"; -+ case P2P_STATE_FIND_PHASE_SEARCH: -+ return "P2P_STATE_FIND_PHASE_SEARCH"; -+ case P2P_STATE_TX_PROVISION_DIS_REQ: -+ return "P2P_STATE_TX_PROVISION_DIS_REQ"; -+ case P2P_STATE_RX_PROVISION_DIS_RSP: -+ return "P2P_STATE_RX_PROVISION_DIS_RSP"; -+ case P2P_STATE_RX_PROVISION_DIS_REQ: -+ return "P2P_STATE_RX_PROVISION_DIS_REQ"; -+ case P2P_STATE_GONEGO_ING: -+ return "P2P_STATE_GONEGO_ING"; -+ case P2P_STATE_GONEGO_OK: -+ return "P2P_STATE_GONEGO_OK"; -+ case P2P_STATE_GONEGO_FAIL: -+ return "P2P_STATE_GONEGO_FAIL"; -+ case P2P_STATE_RECV_INVITE_REQ_MATCH: -+ return "P2P_STATE_RECV_INVITE_REQ_MATCH"; -+ case P2P_STATE_PROVISIONING_ING: -+ return "P2P_STATE_PROVISIONING_ING"; -+ case P2P_STATE_PROVISIONING_DONE: -+ return "P2P_STATE_PROVISIONING_DONE"; -+ case P2P_STATE_TX_INVITE_REQ: -+ return "P2P_STATE_TX_INVITE_REQ"; -+ case P2P_STATE_RX_INVITE_RESP_OK: -+ return "P2P_STATE_RX_INVITE_RESP_OK"; -+ case P2P_STATE_RECV_INVITE_REQ_DISMATCH: -+ return "P2P_STATE_RECV_INVITE_REQ_DISMATCH"; -+ case P2P_STATE_RECV_INVITE_REQ_GO: -+ return "P2P_STATE_RECV_INVITE_REQ_GO"; -+ case P2P_STATE_RECV_INVITE_REQ_JOIN: -+ return "P2P_STATE_RECV_INVITE_REQ_JOIN"; -+ case P2P_STATE_RX_INVITE_RESP_FAIL: -+ return "P2P_STATE_RX_INVITE_RESP_FAIL"; -+ case P2P_STATE_RX_INFOR_NOREADY: -+ return "P2P_STATE_RX_INFOR_NOREADY"; -+ case P2P_STATE_TX_INFOR_NOREADY: -+ return "P2P_STATE_TX_INFOR_NOREADY"; -+ default: -+ return "UNKNOWN"; -+ } -+} -+ -+void dbg_rtw_p2p_set_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line) -+{ -+ if (!_rtw_p2p_chk_state(wdinfo, state)) { -+ enum P2P_STATE old_state = _rtw_p2p_state(wdinfo); -+ _rtw_p2p_set_state(wdinfo, state); -+ RTW_INFO("[CONFIG_DBG_P2P]%s:%d set_state from %s to %s\n", caller, line -+ , rtw_p2p_state_txt(old_state), rtw_p2p_state_txt(_rtw_p2p_state(wdinfo)) -+ ); -+ } else { -+ RTW_INFO("[CONFIG_DBG_P2P]%s:%d set_state to same state %s\n", caller, line -+ , rtw_p2p_state_txt(_rtw_p2p_state(wdinfo)) -+ ); -+ } -+} -+void dbg_rtw_p2p_set_pre_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line) -+{ -+ if (_rtw_p2p_pre_state(wdinfo) != state) { -+ enum P2P_STATE old_state = _rtw_p2p_pre_state(wdinfo); -+ _rtw_p2p_set_pre_state(wdinfo, state); -+ RTW_INFO("[CONFIG_DBG_P2P]%s:%d set_pre_state from %s to %s\n", caller, line -+ , rtw_p2p_state_txt(old_state), rtw_p2p_state_txt(_rtw_p2p_pre_state(wdinfo)) -+ ); -+ } else { -+ RTW_INFO("[CONFIG_DBG_P2P]%s:%d set_pre_state to same state %s\n", caller, line -+ , rtw_p2p_state_txt(_rtw_p2p_pre_state(wdinfo)) -+ ); -+ } -+} -+#if 0 -+void dbg_rtw_p2p_restore_state(struct wifidirect_info *wdinfo, const char *caller, int line) -+{ -+ if (wdinfo->pre_p2p_state != -1) { -+ RTW_INFO("[CONFIG_DBG_P2P]%s:%d restore from %s to %s\n", caller, line -+ , p2p_state_str[wdinfo->p2p_state], p2p_state_str[wdinfo->pre_p2p_state] -+ ); -+ _rtw_p2p_restore_state(wdinfo); -+ } else { -+ RTW_INFO("[CONFIG_DBG_P2P]%s:%d restore no pre state, cur state %s\n", caller, line -+ , p2p_state_str[wdinfo->p2p_state] -+ ); -+ } -+} -+#endif -+void dbg_rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role, const char *caller, int line) -+{ -+ if (wdinfo->role != role) { -+ enum P2P_ROLE old_role = wdinfo->role; -+ _rtw_p2p_set_role(wdinfo, role); -+ RTW_INFO("[CONFIG_DBG_P2P]%s:%d set_role from %s to %s\n", caller, line -+ , rtw_p2p_role_txt(old_role), rtw_p2p_role_txt(wdinfo->role) -+ ); -+ } else { -+ RTW_INFO("[CONFIG_DBG_P2P]%s:%d set_role to same role %s\n", caller, line -+ , rtw_p2p_role_txt(wdinfo->role) -+ ); -+ } -+} -+#endif /* CONFIG_DBG_P2P */ -+ -+ -+int rtw_p2p_enable(_adapter *padapter, enum P2P_ROLE role) -+{ -+ int ret = _SUCCESS; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ if (role == P2P_ROLE_DEVICE || role == P2P_ROLE_CLIENT || role == P2P_ROLE_GO) { -+ u8 channel, ch_offset; -+ u16 bwmode; -+ -+#if defined(CONFIG_CONCURRENT_MODE) && (!defined(RTW_P2P_GROUP_INTERFACE) || !RTW_P2P_GROUP_INTERFACE) -+ /* Commented by Albert 2011/12/30 */ -+ /* The driver just supports 1 P2P group operation. */ -+ /* So, this function will do nothing if the buddy adapter had enabled the P2P function. */ -+ /*if(!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE)) -+ return ret;*/ -+ /*The buddy adapter had enabled the P2P function.*/ -+ if (rtw_mi_buddy_stay_in_p2p_mode(padapter)) -+ return ret; -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ /* leave IPS/Autosuspend */ -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* Added by Albert 2011/03/22 */ -+ /* In the P2P mode, the driver should not support the b mode. */ -+ /* So, the Tx packet shouldn't use the CCK rate */ -+ #ifdef CONFIG_IOCTL_CFG80211 -+ if (rtw_cfg80211_iface_has_p2p_group_cap(padapter)) -+ #endif -+ update_tx_basic_rate(padapter, WIRELESS_11AGN); -+ -+ /* Enable P2P function */ -+ init_wifidirect_info(padapter, role); -+ -+ #ifdef CONFIG_IOCTL_CFG80211 -+ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) -+ adapter_wdev_data(padapter)->p2p_enabled = _TRUE; -+ #endif -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_P2P_STATE, NULL, _TRUE); -+#ifdef CONFIG_WFD -+ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ rtw_hal_set_odm_var(padapter, HAL_ODM_WIFI_DISPLAY_STATE, NULL, _TRUE); -+#endif -+ -+ } else if (role == P2P_ROLE_DISABLE) { -+#ifdef CONFIG_INTEL_WIDI -+ if (padapter->mlmepriv.p2p_reject_disable == _TRUE) -+ return ret; -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ #ifdef CONFIG_IOCTL_CFG80211 -+ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) -+ adapter_wdev_data(padapter)->p2p_enabled = _FALSE; -+ #endif -+ -+ pwdinfo->listen_channel = 0; -+ -+ /* Disable P2P function */ -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ _cancel_timer_ex(&pwdinfo->find_phase_timer); -+ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); -+ _cancel_timer_ex(&pwdinfo->pre_tx_scan_timer); -+ _cancel_timer_ex(&pwdinfo->reset_ch_sitesurvey); -+ _cancel_timer_ex(&pwdinfo->reset_ch_sitesurvey2); -+ reset_ch_sitesurvey_timer_process(padapter); -+ reset_ch_sitesurvey_timer_process2(padapter); -+#ifdef CONFIG_CONCURRENT_MODE -+ _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); -+#endif -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE); -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_NONE); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DISABLE); -+ _rtw_memset(&pwdinfo->rx_prov_disc_info, 0x00, sizeof(struct rx_provdisc_req_info)); -+ -+ /* Remove profiles in wifidirect_info structure. */ -+ _rtw_memset(&pwdinfo->profileinfo[0], 0x00, sizeof(struct profile_info) * P2P_MAX_PERSISTENT_GROUP_NUM); -+ pwdinfo->profileindex = 0; -+ } -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_P2P_STATE, NULL, _FALSE); -+#ifdef CONFIG_WFD -+ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ rtw_hal_set_odm_var(padapter, HAL_ODM_WIFI_DISPLAY_STATE, NULL, _FALSE); -+#endif -+ -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* Restore to initial setting. */ -+ update_tx_basic_rate(padapter, padapter->registrypriv.wireless_mode); -+ -+#ifdef CONFIG_INTEL_WIDI -+ rtw_reset_widi_info(padapter); -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ /* For WiDi purpose. */ -+#ifdef CONFIG_IOCTL_CFG80211 -+ pwdinfo->driver_interface = DRIVER_CFG80211; -+#else -+ pwdinfo->driver_interface = DRIVER_WEXT; -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ } -+ -+exit: -+ return ret; -+} -+ -+#endif /* CONFIG_P2P */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_pwrctrl.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_pwrctrl.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_pwrctrl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_pwrctrl.c 2018-02-11 21:44:27.140145979 +0200 -@@ -0,0 +1,2480 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_PWRCTRL_C_ -+ -+#include -+#include -+#include -+ -+int rtw_fw_ps_state(PADAPTER padapter) -+{ -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ int ret = _FAIL, dont_care = 0; -+ u16 fw_ps_state = 0; -+ u32 start_time; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ -+ if (registry_par->check_fw_ps != 1) -+ return _SUCCESS; -+ -+ _enter_pwrlock(&pwrpriv->check_32k_lock); -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ RTW_INFO("%s: bSurpriseRemoved=%s , hw_init_completed=%d, bDriverStopped=%s\n", __func__ -+ , rtw_is_surprise_removed(padapter) ? "True" : "False" -+ , rtw_get_hw_init_completed(padapter) -+ , rtw_is_drv_stopped(padapter) ? "True" : "False"); -+ goto exit_fw_ps_state; -+ } -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_REQ_FW_PS, (u8 *)&dont_care); -+ { -+ /* 4. if 0x88[7]=1, driver set cmd to leave LPS/IPS. */ -+ /* Else, hw will keep in active mode. */ -+ /* debug info: */ -+ /* 0x88[7] = 32kpermission, */ -+ /* 0x88[6:0] = current_ps_state */ -+ /* 0x89[7:0] = last_rpwm */ -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_FW_PS_STATE, (u8 *)&fw_ps_state); -+ -+ if ((fw_ps_state & 0x80) == 0) -+ ret = _SUCCESS; -+ else { -+ pdbgpriv->dbg_poll_fail_cnt++; -+ RTW_INFO("%s: fw_ps_state=%04x\n", __FUNCTION__, fw_ps_state); -+ } -+ } -+ -+ -+exit_fw_ps_state: -+ _exit_pwrlock(&pwrpriv->check_32k_lock); -+ return ret; -+} -+ -+#ifdef CONFIG_IPS -+void _ips_enter(_adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ pwrpriv->bips_processing = _TRUE; -+ -+ /* syn ips_mode with request */ -+ pwrpriv->ips_mode = pwrpriv->ips_mode_req; -+ -+ pwrpriv->ips_enter_cnts++; -+ RTW_INFO("==>ips_enter cnts:%d\n", pwrpriv->ips_enter_cnts); -+ -+ if (rf_off == pwrpriv->change_rfpwrstate) { -+ pwrpriv->bpower_saving = _TRUE; -+ RTW_PRINT("nolinked power save enter\n"); -+ -+ if (pwrpriv->ips_mode == IPS_LEVEL_2) -+ pwrpriv->bkeepfwalive = _TRUE; -+ -+ rtw_ips_pwr_down(padapter); -+ pwrpriv->rf_pwrstate = rf_off; -+ } -+ pwrpriv->bips_processing = _FALSE; -+ -+} -+ -+void ips_enter(_adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_IpsNotify(padapter, pwrpriv->ips_mode_req); -+#endif /* CONFIG_BT_COEXIST */ -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ _ips_enter(padapter); -+ _exit_pwrlock(&pwrpriv->lock); -+} -+ -+int _ips_leave(_adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ int result = _SUCCESS; -+ -+ if ((pwrpriv->rf_pwrstate == rf_off) && (!pwrpriv->bips_processing)) { -+ pwrpriv->bips_processing = _TRUE; -+ pwrpriv->change_rfpwrstate = rf_on; -+ pwrpriv->ips_leave_cnts++; -+ RTW_INFO("==>ips_leave cnts:%d\n", pwrpriv->ips_leave_cnts); -+ -+ result = rtw_ips_pwr_up(padapter); -+ if (result == _SUCCESS) -+ pwrpriv->rf_pwrstate = rf_on; -+ RTW_PRINT("nolinked power save leave\n"); -+ -+ RTW_INFO("==> ips_leave.....LED(0x%08x)...\n", rtw_read32(padapter, 0x4c)); -+ pwrpriv->bips_processing = _FALSE; -+ -+ pwrpriv->bkeepfwalive = _FALSE; -+ pwrpriv->bpower_saving = _FALSE; -+ } -+ -+ return result; -+} -+ -+int ips_leave(_adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ int ret; -+ -+ if (!is_primary_adapter(padapter)) -+ return _SUCCESS; -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ ret = _ips_leave(padapter); -+#ifdef DBG_CHECK_FW_PS_STATE -+ if (rtw_fw_ps_state(padapter) == _FAIL) { -+ RTW_INFO("ips leave doesn't leave 32k\n"); -+ pdbgpriv->dbg_leave_ips_fail_cnt++; -+ } -+#endif /* DBG_CHECK_FW_PS_STATE */ -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ if (_SUCCESS == ret) -+ ODM_DMReset(&GET_HAL_DATA(padapter)->odmpriv); -+ -+#ifdef CONFIG_BT_COEXIST -+ if (_SUCCESS == ret) -+ rtw_btcoex_IpsNotify(padapter, IPS_NONE); -+#endif /* CONFIG_BT_COEXIST */ -+ -+ return ret; -+} -+#endif /* CONFIG_IPS */ -+ -+#ifdef CONFIG_AUTOSUSPEND -+ extern void autosuspend_enter(_adapter *padapter); -+ extern int autoresume_enter(_adapter *padapter); -+#endif -+ -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+ int rtw_hw_suspend(_adapter *padapter); -+ int rtw_hw_resume(_adapter *padapter); -+#endif -+ -+bool rtw_pwr_unassociated_idle(_adapter *adapter) -+{ -+ u8 i; -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct xmit_priv *pxmit_priv = &adapter->xmitpriv; -+ struct mlme_priv *pmlmepriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo; -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo; -+#endif -+#endif -+ -+ bool ret = _FALSE; -+ -+ if (adapter_to_pwrctl(adapter)->bpower_saving == _TRUE) { -+ /* RTW_INFO("%s: already in LPS or IPS mode\n", __func__); */ -+ goto exit; -+ } -+ -+ if (adapter_to_pwrctl(adapter)->ips_deny_time >= rtw_get_current_time()) { -+ /* RTW_INFO("%s ips_deny_time\n", __func__); */ -+ goto exit; -+ } -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ pmlmepriv = &(iface->mlmepriv); -+#ifdef CONFIG_P2P -+ pwdinfo = &(iface->wdinfo); -+#ifdef CONFIG_IOCTL_CFG80211 -+ pcfg80211_wdinfo = &iface->cfg80211_wdinfo; -+#endif -+#endif -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE | WIFI_SITE_MONITOR) -+ || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS) -+ || check_fwstate(pmlmepriv, WIFI_AP_STATE) -+ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE) -+#if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) -+ || rtw_cfg80211_get_is_roch(iface) == _TRUE -+#elif defined(CONFIG_P2P) -+ || rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE) -+ || rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) -+#endif -+#if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) -+ || rtw_get_passing_time_ms(pcfg80211_wdinfo->last_ro_ch_time) < 3000 -+#endif -+ ) -+ goto exit; -+ -+ } -+ } -+ -+#if (MP_DRIVER == 1) -+ if (adapter->registrypriv.mp_mode == 1) -+ goto exit; -+#endif -+ -+#ifdef CONFIG_INTEL_PROXIM -+ if (adapter->proximity.proxim_on == _TRUE) -+ return; -+#endif -+ -+ if (pxmit_priv->free_xmitbuf_cnt != NR_XMITBUFF || -+ pxmit_priv->free_xmit_extbuf_cnt != NR_XMIT_EXTBUFF) { -+ RTW_PRINT("There are some pkts to transmit\n"); -+ RTW_PRINT("free_xmitbuf_cnt: %d, free_xmit_extbuf_cnt: %d\n", -+ pxmit_priv->free_xmitbuf_cnt, pxmit_priv->free_xmit_extbuf_cnt); -+ goto exit; -+ } -+ -+ ret = _TRUE; -+ -+exit: -+ return ret; -+} -+ -+ -+/* -+ * ATTENTION: -+ * rtw_ps_processor() doesn't handle LPS. -+ */ -+void rtw_ps_processor(_adapter *padapter) -+{ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P */ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+ rt_rf_power_state rfpwrstate; -+#endif /* SUPPORT_HW_RFOFF_DETECTED */ -+ u32 ps_deny = 0; -+ -+ _enter_pwrlock(&adapter_to_pwrctl(padapter)->lock); -+ ps_deny = rtw_ps_deny_get(padapter); -+ _exit_pwrlock(&adapter_to_pwrctl(padapter)->lock); -+ if (ps_deny != 0) { -+ RTW_INFO(FUNC_ADPT_FMT ": ps_deny=0x%08X, skip power save!\n", -+ FUNC_ADPT_ARG(padapter), ps_deny); -+ goto exit; -+ } -+ -+ if (pwrpriv->bInSuspend == _TRUE) { /* system suspend or autosuspend */ -+ pdbgpriv->dbg_ps_insuspend_cnt++; -+ RTW_INFO("%s, pwrpriv->bInSuspend == _TRUE ignore this process\n", __FUNCTION__); -+ return; -+ } -+ -+ pwrpriv->ps_processing = _TRUE; -+ -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+ if (pwrpriv->bips_processing == _TRUE) -+ goto exit; -+ -+ /* RTW_INFO("==> fw report state(0x%x)\n",rtw_read8(padapter,0x1ca)); */ -+ if (pwrpriv->bHWPwrPindetect) { -+#ifdef CONFIG_AUTOSUSPEND -+ if (padapter->registrypriv.usbss_enable) { -+ if (pwrpriv->rf_pwrstate == rf_on) { -+ if (padapter->net_closed == _TRUE) -+ pwrpriv->ps_flag = _TRUE; -+ -+ rfpwrstate = RfOnOffDetect(padapter); -+ RTW_INFO("@@@@- #1 %s==> rfstate:%s\n", __FUNCTION__, (rfpwrstate == rf_on) ? "rf_on" : "rf_off"); -+ if (rfpwrstate != pwrpriv->rf_pwrstate) { -+ if (rfpwrstate == rf_off) { -+ pwrpriv->change_rfpwrstate = rf_off; -+ -+ pwrpriv->bkeepfwalive = _TRUE; -+ pwrpriv->brfoffbyhw = _TRUE; -+ -+ autosuspend_enter(padapter); -+ } -+ } -+ } -+ } else -+#endif /* CONFIG_AUTOSUSPEND */ -+ { -+ rfpwrstate = RfOnOffDetect(padapter); -+ RTW_INFO("@@@@- #2 %s==> rfstate:%s\n", __FUNCTION__, (rfpwrstate == rf_on) ? "rf_on" : "rf_off"); -+ -+ if (rfpwrstate != pwrpriv->rf_pwrstate) { -+ if (rfpwrstate == rf_off) { -+ pwrpriv->change_rfpwrstate = rf_off; -+ pwrpriv->brfoffbyhw = _TRUE; -+ rtw_hw_suspend(padapter); -+ } else { -+ pwrpriv->change_rfpwrstate = rf_on; -+ rtw_hw_resume(padapter); -+ } -+ RTW_INFO("current rf_pwrstate(%s)\n", (pwrpriv->rf_pwrstate == rf_off) ? "rf_off" : "rf_on"); -+ } -+ } -+ pwrpriv->pwr_state_check_cnts++; -+ } -+#endif /* SUPPORT_HW_RFOFF_DETECTED */ -+ -+ if (pwrpriv->ips_mode_req == IPS_NONE) -+ goto exit; -+ -+ if (rtw_pwr_unassociated_idle(padapter) == _FALSE) -+ goto exit; -+ -+ if ((pwrpriv->rf_pwrstate == rf_on) && ((pwrpriv->pwr_state_check_cnts % 4) == 0)) { -+ RTW_INFO("==>%s .fw_state(%x)\n", __FUNCTION__, get_fwstate(pmlmepriv)); -+#if defined(CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) -+#else -+ pwrpriv->change_rfpwrstate = rf_off; -+#endif -+#ifdef CONFIG_AUTOSUSPEND -+ if (padapter->registrypriv.usbss_enable) { -+ if (pwrpriv->bHWPwrPindetect) -+ pwrpriv->bkeepfwalive = _TRUE; -+ -+ if (padapter->net_closed == _TRUE) -+ pwrpriv->ps_flag = _TRUE; -+ -+#if defined(CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) -+ if (_TRUE == pwrpriv->bInternalAutoSuspend) -+ RTW_INFO("<==%s .pwrpriv->bInternalAutoSuspend)(%x)\n", __FUNCTION__, pwrpriv->bInternalAutoSuspend); -+ else { -+ pwrpriv->change_rfpwrstate = rf_off; -+ RTW_INFO("<==%s .pwrpriv->bInternalAutoSuspend)(%x) call autosuspend_enter\n", __FUNCTION__, pwrpriv->bInternalAutoSuspend); -+ autosuspend_enter(padapter); -+ } -+#else -+ autosuspend_enter(padapter); -+#endif /* if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) */ -+ } else if (pwrpriv->bHWPwrPindetect) { -+ } else -+#endif /* CONFIG_AUTOSUSPEND */ -+ { -+#if defined(CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) -+ pwrpriv->change_rfpwrstate = rf_off; -+#endif /* defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) */ -+ -+#ifdef CONFIG_IPS -+ ips_enter(padapter); -+#endif -+ } -+ } -+exit: -+#ifndef CONFIG_IPS_CHECK_IN_WD -+ rtw_set_pwr_state_check_timer(pwrpriv); -+#endif -+ pwrpriv->ps_processing = _FALSE; -+ return; -+} -+ -+void pwr_state_check_handler(RTW_TIMER_HDL_ARGS); -+void pwr_state_check_handler(RTW_TIMER_HDL_ARGS) -+{ -+ _adapter *padapter = (_adapter *)FunctionContext; -+ rtw_ps_cmd(padapter); -+} -+ -+#ifdef CONFIG_LPS -+void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets) -+{ -+#ifdef CONFIG_CHECK_LEAVE_LPS -+ static u32 start_time = 0; -+ static u32 xmit_cnt = 0; -+ u8 bLeaveLPS = _FALSE; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ -+ if (tx) { /* from tx */ -+ xmit_cnt += tx_packets; -+ -+ if (start_time == 0) -+ start_time = rtw_get_current_time(); -+ -+ if (rtw_get_passing_time_ms(start_time) > 2000) { /* 2 sec == watch dog timer */ -+ if (xmit_cnt > 8) { -+ if ((adapter_to_pwrctl(padapter)->bLeisurePs) -+ && (adapter_to_pwrctl(padapter)->pwr_mode != PS_MODE_ACTIVE) -+#ifdef CONFIG_BT_COEXIST -+ && (rtw_btcoex_IsBtControlLps(padapter) == _FALSE) -+#endif -+ ) { -+ /* RTW_INFO("leave lps via Tx = %d\n", xmit_cnt); */ -+ bLeaveLPS = _TRUE; -+ } -+ } -+ -+ start_time = rtw_get_current_time(); -+ xmit_cnt = 0; -+ } -+ -+ } else { /* from rx path */ -+ if (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 4/*2*/) { -+ if ((adapter_to_pwrctl(padapter)->bLeisurePs) -+ && (adapter_to_pwrctl(padapter)->pwr_mode != PS_MODE_ACTIVE) -+#ifdef CONFIG_BT_COEXIST -+ && (rtw_btcoex_IsBtControlLps(padapter) == _FALSE) -+#endif -+ ) { -+ /* RTW_INFO("leave lps via Rx = %d\n", pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); */ -+ bLeaveLPS = _TRUE; -+ } -+ } -+ } -+ -+ if (bLeaveLPS) { -+ /* RTW_INFO("leave lps via %s, Tx = %d, Rx = %d\n", tx?"Tx":"Rx", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod,pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); */ -+ /* rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); */ -+ rtw_lps_ctrl_wk_cmd(padapter, tx ? LPS_CTRL_TX_TRAFFIC_LEAVE : LPS_CTRL_RX_TRAFFIC_LEAVE, tx ? 0 : 1); -+ } -+#endif /* CONFIG_CHECK_LEAVE_LPS */ -+} -+ -+/* -+ * Description: -+ * This function MUST be called under power lock protect -+ * -+ * Parameters -+ * padapter -+ * pslv power state level, only could be PS_STATE_S0 ~ PS_STATE_S4 -+ * -+ */ -+void rtw_set_rpwm(PADAPTER padapter, u8 pslv) -+{ -+ u8 rpwm; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+#ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ u8 cpwm_orig; -+#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ pslv = PS_STATE(pslv); -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+ if (pwrpriv->brpwmtimeout == _TRUE) -+ RTW_INFO("%s: RPWM timeout, force to set RPWM(0x%02X) again!\n", __FUNCTION__, pslv); -+ else -+#endif /* CONFIG_LPS_RPWM_TIMER */ -+ { -+ if ((pwrpriv->rpwm == pslv) -+#ifdef CONFIG_LPS_LCLK -+ || ((pwrpriv->rpwm >= PS_STATE_S2) && (pslv >= PS_STATE_S2)) -+#endif -+ ) { -+ return; -+ } -+ } -+ -+ if (rtw_is_surprise_removed(padapter) || -+ (!rtw_is_hw_init_completed(padapter))) { -+ -+ pwrpriv->cpwm = PS_STATE_S4; -+ -+ return; -+ } -+ -+ if (rtw_is_drv_stopped(padapter)) { -+ -+ if (pslv < PS_STATE_S2) { -+ return; -+ } -+ } -+ -+ rpwm = pslv | pwrpriv->tog; -+#ifdef CONFIG_LPS_LCLK -+ /* only when from PS_STATE S0/S1 to S2 and higher needs ACK */ -+ if ((pwrpriv->cpwm < PS_STATE_S2) && (pslv >= PS_STATE_S2)) -+ rpwm |= PS_ACK; -+#endif -+ -+ pwrpriv->rpwm = pslv; -+ -+#ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ cpwm_orig = 0; -+ if (rpwm & PS_ACK) -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); -+#endif -+ -+#if defined(CONFIG_LPS_RPWM_TIMER) && !defined(CONFIG_DETECT_CPWM_BY_POLLING) -+ if (rpwm & PS_ACK) -+ _set_timer(&pwrpriv->pwr_rpwm_timer, LPS_RPWM_WAIT_MS); -+#endif /* CONFIG_LPS_RPWM_TIMER & !CONFIG_DETECT_CPWM_BY_POLLING */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); -+ -+ pwrpriv->tog += 0x80; -+ -+#ifdef CONFIG_LPS_LCLK -+ /* No LPS 32K, No Ack */ -+ if (rpwm & PS_ACK) { -+#ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ u32 start_time; -+ u8 cpwm_now; -+ u8 poll_cnt = 0; -+ -+ start_time = rtw_get_current_time(); -+ -+ /* polling cpwm */ -+ do { -+ rtw_msleep_os(1); -+ poll_cnt++; -+ cpwm_now = 0; -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_now); -+ if ((cpwm_orig ^ cpwm_now) & 0x80) { -+ pwrpriv->cpwm = PS_STATE_S4; -+ pwrpriv->cpwm_tog = cpwm_now & PS_TOGGLE; -+#ifdef DBG_CHECK_FW_PS_STATE -+ RTW_INFO("%s: polling cpwm OK! poll_cnt=%d, cpwm_orig=%02x, cpwm_now=%02x , 0x100=0x%x\n" -+ , __FUNCTION__, poll_cnt, cpwm_orig, cpwm_now, rtw_read8(padapter, REG_CR)); -+ if (rtw_fw_ps_state(padapter) == _FAIL) { -+ RTW_INFO("leave 32k but fw state in 32k\n"); -+ pdbgpriv->dbg_rpwm_toogle_cnt++; -+ } -+#endif /* DBG_CHECK_FW_PS_STATE */ -+ break; -+ } -+ -+ if (rtw_get_passing_time_ms(start_time) > LPS_RPWM_WAIT_MS) { -+ RTW_INFO("%s: polling cpwm timeout! poll_cnt=%d, cpwm_orig=%02x, cpwm_now=%02x\n", __FUNCTION__, poll_cnt, cpwm_orig, cpwm_now); -+#ifdef DBG_CHECK_FW_PS_STATE -+ if (rtw_fw_ps_state(padapter) == _FAIL) { -+ RTW_INFO("rpwm timeout and fw ps state in 32k\n"); -+ pdbgpriv->dbg_rpwm_timeout_fail_cnt++; -+ } -+#endif /* DBG_CHECK_FW_PS_STATE */ -+#ifdef CONFIG_LPS_RPWM_TIMER -+ _set_timer(&pwrpriv->pwr_rpwm_timer, 1); -+#endif /* CONFIG_LPS_RPWM_TIMER */ -+ break; -+ } -+ } while (1); -+#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ -+ } else -+#endif /* CONFIG_LPS_LCLK */ -+ { -+ pwrpriv->cpwm = pslv; -+ } -+ -+} -+ -+u8 PS_RDY_CHECK(_adapter *padapter) -+{ -+ u32 curr_time, delta_time; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+#endif /* CONFIG_IOCTL_CFG80211 */ -+#endif /* CONFIG_P2P */ -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ if (_TRUE == pwrpriv->bInSuspend && pwrpriv->wowlan_mode) -+ return _TRUE; -+ else if (_TRUE == pwrpriv->bInSuspend && pwrpriv->wowlan_ap_mode) -+ return _TRUE; -+ else if (_TRUE == pwrpriv->bInSuspend) -+ return _FALSE; -+#else -+ if (_TRUE == pwrpriv->bInSuspend) -+ return _FALSE; -+#endif -+ -+ curr_time = rtw_get_current_time(); -+ -+ delta_time = curr_time - pwrpriv->DelayLPSLastTimeStamp; -+ -+ if (delta_time < LPS_DELAY_TIME) -+ return _FALSE; -+ -+ if (check_fwstate(pmlmepriv, WIFI_SITE_MONITOR) -+ || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS) -+ || check_fwstate(pmlmepriv, WIFI_AP_STATE) -+ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE) -+#if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) -+ || rtw_cfg80211_get_is_roch(padapter) == _TRUE -+#endif -+ || rtw_is_scan_deny(padapter) -+#ifdef CONFIG_TDLS -+ /* TDLS link is established. */ -+ || (padapter->tdlsinfo.link_established == _TRUE) -+#endif /* CONFIG_TDLS */ -+ ) -+ return _FALSE; -+ -+ if ((padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) && (padapter->securitypriv.binstallGrpkey == _FALSE)) { -+ RTW_INFO("Group handshake still in progress !!!\n"); -+ return _FALSE; -+ } -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (!rtw_cfg80211_pwr_mgmt(padapter)) -+ return _FALSE; -+#endif -+ -+ return _TRUE; -+} -+ -+#if defined(CONFIG_FWLPS_IN_IPS) -+void rtw_set_fw_in_ips_mode(PADAPTER padapter, u8 enable) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ int cnt = 0; -+ u32 start_time; -+ u8 val8 = 0; -+ u8 cpwm_orig = 0, cpwm_now = 0; -+ u8 parm[H2C_INACTIVE_PS_LEN] = {0}; -+ -+ if (padapter->netif_up == _FALSE) { -+ RTW_INFO("%s: ERROR, netif is down\n", __func__); -+ return; -+ } -+ -+ /* u8 cmd_param; */ /* BIT0:enable, BIT1:NoConnect32k */ -+ if (enable) { -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_IpsNotify(padapter, pwrpriv->ips_mode_req); -+#endif -+ /* Enter IPS */ -+ RTW_INFO("%s: issue H2C to FW when entering IPS\n", __func__); -+ -+ parm[0] = 0x1;/* suggest by Isaac.Hsu*/ -+#ifdef CONFIG_PNO_SUPPORT -+ if (pwrpriv->pno_inited) { -+ parm[1] = pwrpriv->pnlo_info->fast_scan_iterations; -+ parm[2] = pwrpriv->pnlo_info->slow_scan_period; -+ } -+#endif -+ -+ rtw_hal_fill_h2c_cmd(padapter, /* H2C_FWLPS_IN_IPS_, */ -+ H2C_INACTIVE_PS_, -+ H2C_INACTIVE_PS_LEN, parm); -+ /* poll 0x1cc to make sure H2C command already finished by FW; MAC_0x1cc=0 means H2C done by FW. */ -+ do { -+ val8 = rtw_read8(padapter, REG_HMETFR); -+ cnt++; -+ RTW_INFO("%s polling REG_HMETFR=0x%x, cnt=%d\n", -+ __func__, val8, cnt); -+ rtw_mdelay_os(10); -+ } while (cnt < 100 && (val8 != 0)); -+ -+#ifdef CONFIG_LPS_LCLK -+ /* H2C done, enter 32k */ -+ if (val8 == 0) { -+ /* ser rpwm to enter 32k */ -+ val8 = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1); -+ RTW_INFO("%s: read rpwm=%02x\n", __FUNCTION__, val8); -+ val8 += 0x80; -+ val8 |= BIT(0); -+ rtw_write8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1, val8); -+ RTW_INFO("%s: write rpwm=%02x\n", __FUNCTION__, val8); -+ adapter_to_pwrctl(padapter)->tog = (val8 + 0x80) & 0x80; -+ cnt = val8 = 0; -+ if (parm[1] == 0 || parm[2] == 0) { -+ do { -+ val8 = rtw_read8(padapter, REG_CR); -+ cnt++; -+ RTW_INFO("%s polling 0x100=0x%x, cnt=%d\n", -+ __func__, val8, cnt); -+ RTW_INFO("%s 0x08:%02x, 0x03:%02x\n", -+ __func__, -+ rtw_read8(padapter, 0x08), -+ rtw_read8(padapter, 0x03)); -+ rtw_mdelay_os(10); -+ } while (cnt < 20 && (val8 != 0xEA)); -+ } -+ } -+#endif -+ } else { -+ /* Leave IPS */ -+ RTW_INFO("%s: Leaving IPS in FWLPS state\n", __func__); -+ -+#ifdef CONFIG_LPS_LCLK -+ /* for polling cpwm */ -+ cpwm_orig = 0; -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); -+ -+ /* ser rpwm */ -+ val8 = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1); -+ val8 &= 0x80; -+ val8 += 0x80; -+ val8 |= BIT(6); -+ rtw_write8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1, val8); -+ RTW_INFO("%s: write rpwm=%02x\n", __FUNCTION__, val8); -+ adapter_to_pwrctl(padapter)->tog = (val8 + 0x80) & 0x80; -+ -+ /* do polling cpwm */ -+ start_time = rtw_get_current_time(); -+ do { -+ -+ rtw_mdelay_os(1); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_now); -+ if ((cpwm_orig ^ cpwm_now) & 0x80) -+ break; -+ -+ if (rtw_get_passing_time_ms(start_time) > 100) { -+ RTW_INFO("%s: polling cpwm timeout when leaving IPS in FWLPS state\n", __FUNCTION__); -+ break; -+ } -+ } while (1); -+ -+#endif -+ parm[0] = 0x0; -+ parm[1] = 0x0; -+ parm[2] = 0x0; -+ rtw_hal_fill_h2c_cmd(padapter, H2C_INACTIVE_PS_, -+ H2C_INACTIVE_PS_LEN, parm); -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_IpsNotify(padapter, IPS_NONE); -+#endif -+ } -+} -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode, const char *msg) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P */ -+#ifdef CONFIG_TDLS -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ _irqL irqL; -+ int i, j; -+ _list *plist, *phead; -+ struct sta_info *ptdls_sta; -+#endif /* CONFIG_TDLS */ -+ -+ -+ -+ if (ps_mode > PM_Card_Disable) { -+ return; -+ } -+ -+ if (pwrpriv->pwr_mode == ps_mode) { -+ if (PS_MODE_ACTIVE == ps_mode) -+ return; -+ -+#ifndef CONFIG_BT_COEXIST -+ if ((pwrpriv->smart_ps == smart_ps) && -+ (pwrpriv->bcn_ant_mode == bcn_ant_mode)) -+ return; -+#endif /* !CONFIG_BT_COEXIST */ -+ } -+ -+#ifdef CONFIG_LPS_PG -+ if ((PS_MODE_ACTIVE != ps_mode) && (pwrpriv->blpspg_info_up)) -+ rtw_hal_set_lps_pg_info(padapter); -+#endif -+ -+#ifdef CONFIG_LPS_LCLK -+ _enter_pwrlock(&pwrpriv->lock); -+#endif -+ -+ /* if(pwrpriv->pwr_mode == PS_MODE_ACTIVE) */ -+ if (ps_mode == PS_MODE_ACTIVE) { -+ if (1 -+#ifdef CONFIG_BT_COEXIST -+ && (((rtw_btcoex_IsBtControlLps(padapter) == _FALSE) -+#ifdef CONFIG_P2P_PS -+ && (pwdinfo->opp_ps == 0) -+#endif /* CONFIG_P2P_PS */ -+ ) -+ || ((rtw_btcoex_IsBtControlLps(padapter) == _TRUE) -+ && (rtw_btcoex_IsLpsOn(padapter) == _FALSE)) -+ ) -+#else /* !CONFIG_BT_COEXIST */ -+#ifdef CONFIG_P2P_PS -+ && (pwdinfo->opp_ps == 0) -+#endif /* CONFIG_P2P_PS */ -+#endif /* !CONFIG_BT_COEXIST */ -+ ) { -+ RTW_INFO(FUNC_ADPT_FMT" Leave 802.11 power save - %s\n", -+ FUNC_ADPT_ARG(padapter), msg); -+ -+ if (pwrpriv->lps_leave_cnts < UINT_MAX) -+ pwrpriv->lps_leave_cnts++; -+ else -+ pwrpriv->lps_leave_cnts = 0; -+#ifdef CONFIG_TDLS -+ for (i = 0; i < NUM_STA; i++) { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ ptdls_sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 0, 0); -+ plist = get_next(plist); -+ } -+ } -+#endif /* CONFIG_TDLS */ -+ -+ pwrpriv->pwr_mode = ps_mode; -+ rtw_set_rpwm(padapter, PS_STATE_S4); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN) -+ if (pwrpriv->wowlan_mode == _TRUE || -+ pwrpriv->wowlan_ap_mode == _TRUE || -+ pwrpriv->wowlan_p2p_mode == _TRUE) { -+ u32 start_time, delay_ms; -+ u8 val8; -+ delay_ms = 20; -+ start_time = rtw_get_current_time(); -+ do { -+ rtw_hal_get_hwreg(padapter, HW_VAR_SYS_CLKR, &val8); -+ if (!(val8 & BIT(4))) { /* 0x08 bit4 =1 --> in 32k, bit4 = 0 --> leave 32k */ -+ pwrpriv->cpwm = PS_STATE_S4; -+ break; -+ } -+ if (rtw_get_passing_time_ms(start_time) > delay_ms) { -+ RTW_INFO("%s: Wait for FW 32K leave more than %u ms!!!\n", -+ __FUNCTION__, delay_ms); -+ pdbgpriv->dbg_wow_leave_ps_fail_cnt++; -+ break; -+ } -+ rtw_usleep_os(100); -+ } while (1); -+ } -+#endif -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); -+#ifdef CONFIG_LPS_POFF -+ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_POFF_SET_MODE, -+ (u8 *)(&ps_mode)); -+#endif /*CONFIG_LPS_POFF*/ -+ -+ pwrpriv->bFwCurrentInPSMode = _FALSE; -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_LpsNotify(padapter, ps_mode); -+#endif /* CONFIG_BT_COEXIST */ -+ } -+ } else { -+ if ((PS_RDY_CHECK(padapter) && check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE)) -+#ifdef CONFIG_BT_COEXIST -+ || ((rtw_btcoex_IsBtControlLps(padapter) == _TRUE) -+ && (rtw_btcoex_IsLpsOn(padapter) == _TRUE)) -+#endif -+#ifdef CONFIG_P2P_WOWLAN -+ || (_TRUE == pwrpriv->wowlan_p2p_mode) -+#endif /* CONFIG_P2P_WOWLAN */ -+ ) { -+ u8 pslv; -+ -+ RTW_INFO(FUNC_ADPT_FMT" Enter 802.11 power save - %s\n", -+ FUNC_ADPT_ARG(padapter), msg); -+ -+ if (pwrpriv->lps_enter_cnts < UINT_MAX) -+ pwrpriv->lps_enter_cnts++; -+ else -+ pwrpriv->lps_enter_cnts = 0; -+#ifdef CONFIG_TDLS -+ for (i = 0; i < NUM_STA; i++) { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ ptdls_sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 1, 0, 0); -+ plist = get_next(plist); -+ } -+ } -+#endif /* CONFIG_TDLS */ -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_LpsNotify(padapter, ps_mode); -+#endif /* CONFIG_BT_COEXIST */ -+ -+#ifdef CONFIG_LPS_POFF -+ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_POFF_SET_MODE, -+ (u8 *)(&ps_mode)); -+#endif /*CONFIG_LPS_POFF*/ -+ -+ pwrpriv->bFwCurrentInPSMode = _TRUE; -+ pwrpriv->pwr_mode = ps_mode; -+ pwrpriv->smart_ps = smart_ps; -+ pwrpriv->bcn_ant_mode = bcn_ant_mode; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); -+ -+#ifdef CONFIG_P2P_PS -+ /* Set CTWindow after LPS */ -+ if (pwdinfo->opp_ps == 1) -+ p2p_ps_wk_cmd(padapter, P2P_PS_ENABLE, 0); -+#endif /* CONFIG_P2P_PS */ -+ -+ pslv = PS_STATE_S2; -+#ifdef CONFIG_LPS_LCLK -+ if (pwrpriv->alives == 0) -+ pslv = PS_STATE_S0; -+#endif /* CONFIG_LPS_LCLK */ -+ -+#ifdef CONFIG_BT_COEXIST -+ if ((rtw_btcoex_IsBtDisabled(padapter) == _FALSE) -+ && (rtw_btcoex_IsBtControlLps(padapter) == _TRUE)) { -+ u8 val8; -+ -+ val8 = rtw_btcoex_LpsVal(padapter); -+ if (val8 & BIT(4)) -+ pslv = PS_STATE_S2; -+ -+ } -+#endif /* CONFIG_BT_COEXIST */ -+ -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+#ifdef CONFIG_LPS_LCLK -+ _exit_pwrlock(&pwrpriv->lock); -+#endif -+ -+} -+ -+/* -+ * Return: -+ * 0: Leave OK -+ * -1: Timeout -+ * -2: Other error -+ */ -+s32 LPS_RF_ON_check(PADAPTER padapter, u32 delay_ms) -+{ -+ u32 start_time; -+ u8 bAwake = _FALSE; -+ s32 err = 0; -+ -+ -+ start_time = rtw_get_current_time(); -+ while (1) { -+ rtw_hal_get_hwreg(padapter, HW_VAR_FWLPS_RF_ON, &bAwake); -+ if (_TRUE == bAwake) -+ break; -+ -+ if (rtw_is_surprise_removed(padapter)) { -+ err = -2; -+ RTW_INFO("%s: device surprise removed!!\n", __FUNCTION__); -+ break; -+ } -+ -+ if (rtw_get_passing_time_ms(start_time) > delay_ms) { -+ err = -1; -+ RTW_INFO("%s: Wait for FW LPS leave more than %u ms!!!\n", __FUNCTION__, delay_ms); -+ break; -+ } -+ rtw_usleep_os(100); -+ } -+ -+ return err; -+} -+ -+/* -+ * Description: -+ * Enter the leisure power save mode. -+ * */ -+void LPS_Enter(PADAPTER padapter, const char *msg) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ int n_assoc_iface = 0; -+ int i; -+ char buf[32] = {0}; -+ -+ -+ /* RTW_INFO("+LeisurePSEnter\n"); */ -+ if (_FALSE == padapter->bFWReady) -+ return; -+ -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBtControlLps(padapter) == _TRUE) -+ return; -+#endif -+ -+ /* Skip lps enter request if number of assocated adapters is not 1 */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) -+ n_assoc_iface++; -+ } -+ if (n_assoc_iface != 1) -+ return; -+ -+ /* Skip lps enter request for adapter not port0 */ -+ if (get_hw_port(padapter) != HW_PORT0) -+ return; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (PS_RDY_CHECK(dvobj->padapters[i]) == _FALSE) -+ return; -+ } -+ -+#ifdef CONFIG_P2P_PS -+ if (padapter->wdinfo.p2p_ps_mode == P2P_PS_NOA) { -+ return;/* supporting p2p client ps NOA via H2C_8723B_P2P_PS_OFFLOAD */ -+ } -+#endif /* CONFIG_P2P_PS */ -+ -+ if (pwrpriv->bLeisurePs) { -+ /* Idle for a while if we connect to AP a while ago. */ -+ if (pwrpriv->LpsIdleCount >= 2) { /* 4 Sec */ -+ if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) { -+ sprintf(buf, "WIFI-%s", msg); -+ pwrpriv->bpower_saving = _TRUE; -+ rtw_set_ps_mode(padapter, pwrpriv->power_mgnt, padapter->registrypriv.smart_ps, 0, buf); -+ } -+ } else -+ pwrpriv->LpsIdleCount++; -+ } -+ -+ /* RTW_INFO("-LeisurePSEnter\n"); */ -+ -+} -+ -+/* -+ * Description: -+ * Leave the leisure power save mode. -+ * */ -+void LPS_Leave(PADAPTER padapter, const char *msg) -+{ -+#define LPS_LEAVE_TIMEOUT_MS 100 -+ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ u32 start_time; -+ u8 bAwake = _FALSE; -+ char buf[32] = {0}; -+ struct debug_priv *pdbgpriv = &dvobj->drv_dbg; -+ -+ -+ /* RTW_INFO("+LeisurePSLeave\n"); */ -+ -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBtControlLps(padapter) == _TRUE) -+ return; -+#endif -+ -+ if (pwrpriv->bLeisurePs) { -+ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { -+ sprintf(buf, "WIFI-%s", msg); -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, buf); -+ -+ if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) -+ LPS_RF_ON_check(padapter, LPS_LEAVE_TIMEOUT_MS); -+ } -+ } -+ -+ pwrpriv->bpower_saving = _FALSE; -+#ifdef DBG_CHECK_FW_PS_STATE -+ if (rtw_fw_ps_state(padapter) == _FAIL) { -+ RTW_INFO("leave lps, fw in 32k\n"); -+ pdbgpriv->dbg_leave_lps_fail_cnt++; -+ } -+#endif /* DBG_CHECK_FW_PS_STATE -+ * RTW_INFO("-LeisurePSLeave\n"); */ -+ -+} -+#endif -+ -+void LeaveAllPowerSaveModeDirect(PADAPTER Adapter) -+{ -+ PADAPTER pri_padapter = GET_PRIMARY_ADAPTER(Adapter); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); -+ struct dvobj_priv *psdpriv = Adapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+#ifndef CONFIG_DETECT_CPWM_BY_POLLING -+ u8 cpwm_orig, cpwm_now; -+ u32 start_time; -+#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ -+ -+ -+ RTW_INFO("%s.....\n", __FUNCTION__); -+ -+ if (rtw_is_surprise_removed(Adapter)) { -+ RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=_TRUE Skip!\n", FUNC_ADPT_ARG(Adapter)); -+ return; -+ } -+ -+ if (rtw_mi_check_status(Adapter, MI_LINKED)) { /*connect*/ -+ -+ if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) { -+ RTW_INFO("%s: Driver Already Leave LPS\n", __FUNCTION__); -+ return; -+ } -+ -+#ifdef CONFIG_LPS_LCLK -+ _enter_pwrlock(&pwrpriv->lock); -+ -+#ifndef CONFIG_DETECT_CPWM_BY_POLLING -+ cpwm_orig = 0; -+ rtw_hal_get_hwreg(Adapter, HW_VAR_CPWM, &cpwm_orig); -+#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ -+ rtw_set_rpwm(Adapter, PS_STATE_S4); -+ -+#ifndef CONFIG_DETECT_CPWM_BY_POLLING -+ -+ start_time = rtw_get_current_time(); -+ -+ /* polling cpwm */ -+ do { -+ rtw_mdelay_os(1); -+ -+ rtw_hal_get_hwreg(Adapter, HW_VAR_CPWM, &cpwm_now); -+ if ((cpwm_orig ^ cpwm_now) & 0x80) { -+ pwrpriv->cpwm = PS_STATE_S4; -+ pwrpriv->cpwm_tog = cpwm_now & PS_TOGGLE; -+#ifdef DBG_CHECK_FW_PS_STATE -+ RTW_INFO("%s: polling cpwm OK! cpwm_orig=%02x, cpwm_now=%02x, 0x100=0x%x\n" -+ , __FUNCTION__, cpwm_orig, cpwm_now, rtw_read8(Adapter, REG_CR)); -+ if (rtw_fw_ps_state(Adapter) == _FAIL) { -+ RTW_INFO("%s: leave 32k but fw state in 32k\n", __FUNCTION__); -+ pdbgpriv->dbg_rpwm_toogle_cnt++; -+ } -+#endif /* DBG_CHECK_FW_PS_STATE */ -+ break; -+ } -+ -+ if (rtw_get_passing_time_ms(start_time) > LPS_RPWM_WAIT_MS) { -+ RTW_INFO("%s: polling cpwm timeout! cpwm_orig=%02x, cpwm_now=%02x\n", __FUNCTION__, cpwm_orig, cpwm_now); -+#ifdef DBG_CHECK_FW_PS_STATE -+ if (rtw_fw_ps_state(Adapter) == _FAIL) { -+ RTW_INFO("rpwm timeout and fw ps state in 32k\n"); -+ pdbgpriv->dbg_rpwm_timeout_fail_cnt++; -+ } -+#endif /* DBG_CHECK_FW_PS_STATE */ -+ break; -+ } -+ } while (1); -+#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ -+ -+ _exit_pwrlock(&pwrpriv->lock); -+#endif -+ -+#ifdef CONFIG_P2P_PS -+ p2p_ps_wk_cmd(pri_padapter, P2P_PS_DISABLE, 0); -+#endif /* CONFIG_P2P_PS */ -+ -+#ifdef CONFIG_LPS -+ rtw_lps_ctrl_wk_cmd(pri_padapter, LPS_CTRL_LEAVE, 0); -+#endif -+ } else { -+ if (pwrpriv->rf_pwrstate == rf_off) { -+#ifdef CONFIG_AUTOSUSPEND -+ if (Adapter->registrypriv.usbss_enable) { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ usb_disable_autosuspend(adapter_to_dvobj(Adapter)->pusbdev); -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 22) && LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 34)) -+ adapter_to_dvobj(Adapter)->pusbdev->autosuspend_disabled = Adapter->bDisableAutosuspend;/* autosuspend disabled by the user */ -+#endif -+ } else -+#endif -+ { -+#if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) -+#ifdef CONFIG_IPS -+ if (_FALSE == ips_leave(pri_padapter)) -+ RTW_INFO("======> ips_leave fail.............\n"); -+#endif -+#endif /* CONFIG_SWLPS_IN_IPS || (CONFIG_PLATFORM_SPRD && CONFIG_RTL8188E) */ -+ } -+ } -+ } -+ -+} -+ -+/* -+ * Description: Leave all power save mode: LPS, FwLPS, IPS if needed. -+ * Move code to function by tynli. 2010.03.26. -+ * */ -+void LeaveAllPowerSaveMode(IN PADAPTER Adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ u8 enqueue = 0; -+ int n_assoc_iface = 0; -+ int i; -+ -+ -+ /* RTW_INFO("%s.....\n",__FUNCTION__); */ -+ -+ if (_FALSE == Adapter->bup) { -+ RTW_INFO(FUNC_ADPT_FMT ": bup=%d Skip!\n", -+ FUNC_ADPT_ARG(Adapter), Adapter->bup); -+ return; -+ } -+ -+ if (rtw_is_surprise_removed(Adapter)) { -+ RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=_TRUE Skip!\n", FUNC_ADPT_ARG(Adapter)); -+ return; -+ } -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) -+ n_assoc_iface++; -+ } -+ -+ if (n_assoc_iface) { -+ /* connect */ -+#ifdef CONFIG_LPS_LCLK -+ enqueue = 1; -+#endif -+ -+#ifdef CONFIG_P2P_PS -+ p2p_ps_wk_cmd(Adapter, P2P_PS_DISABLE, enqueue); -+#endif /* CONFIG_P2P_PS */ -+ -+#ifdef CONFIG_LPS -+ rtw_lps_ctrl_wk_cmd(Adapter, LPS_CTRL_LEAVE, enqueue); -+#endif -+ -+#ifdef CONFIG_LPS_LCLK -+ LPS_Leave_check(Adapter); -+#endif -+ } else { -+ if (adapter_to_pwrctl(Adapter)->rf_pwrstate == rf_off) { -+#ifdef CONFIG_AUTOSUSPEND -+ if (Adapter->registrypriv.usbss_enable) { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ usb_disable_autosuspend(adapter_to_dvobj(Adapter)->pusbdev); -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 22) && LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 34)) -+ adapter_to_dvobj(Adapter)->pusbdev->autosuspend_disabled = Adapter->bDisableAutosuspend;/* autosuspend disabled by the user */ -+#endif -+ } else -+#endif -+ { -+#if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) || (defined(CONFIG_PLATFORM_SPRD) && defined(CONFIG_RTL8188E)) -+#ifdef CONFIG_IPS -+ if (_FALSE == ips_leave(Adapter)) -+ RTW_INFO("======> ips_leave fail.............\n"); -+#endif -+#endif /* CONFIG_SWLPS_IN_IPS || (CONFIG_PLATFORM_SPRD && CONFIG_RTL8188E) */ -+ } -+ } -+ } -+ -+} -+ -+#ifdef CONFIG_LPS_LCLK -+void LPS_Leave_check( -+ PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ u32 start_time; -+ u8 bReady; -+ -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ bReady = _FALSE; -+ start_time = rtw_get_current_time(); -+ -+ rtw_yield_os(); -+ -+ while (1) { -+ _enter_pwrlock(&pwrpriv->lock); -+ -+ if (rtw_is_surprise_removed(padapter) -+ || (!rtw_is_hw_init_completed(padapter)) -+#ifdef CONFIG_USB_HCI -+ || rtw_is_drv_stopped(padapter) -+#endif -+ || (pwrpriv->pwr_mode == PS_MODE_ACTIVE) -+ ) -+ bReady = _TRUE; -+ -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ if (_TRUE == bReady) -+ break; -+ -+ if (rtw_get_passing_time_ms(start_time) > 100) { -+ RTW_INFO("Wait for cpwm event than 100 ms!!!\n"); -+ break; -+ } -+ rtw_msleep_os(1); -+ } -+ -+} -+ -+/* -+ * Caller:ISR handler... -+ * -+ * This will be called when CPWM interrupt is up. -+ * -+ * using to update cpwn of drv; and drv willl make a decision to up or down pwr level -+ */ -+void cpwm_int_hdl( -+ PADAPTER padapter, -+ struct reportpwrstate_parm *preportpwrstate) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+#if 0 -+ if (pwrpriv->cpwm_tog == (preportpwrstate->state & PS_TOGGLE)) { -+ goto exit; -+ } -+#endif -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+ if (pwrpriv->rpwm < PS_STATE_S2) { -+ RTW_INFO("%s: Redundant CPWM Int. RPWM=0x%02X CPWM=0x%02x\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); -+ _exit_pwrlock(&pwrpriv->lock); -+ goto exit; -+ } -+#endif /* CONFIG_LPS_RPWM_TIMER */ -+ -+ pwrpriv->cpwm = PS_STATE(preportpwrstate->state); -+ pwrpriv->cpwm_tog = preportpwrstate->state & PS_TOGGLE; -+ -+ if (pwrpriv->cpwm >= PS_STATE_S2) { -+ if (pwrpriv->alives & CMD_ALIVE) -+ _rtw_up_sema(&padapter->cmdpriv.cmd_queue_sema); -+ -+ if (pwrpriv->alives & XMIT_ALIVE) -+ _rtw_up_sema(&padapter->xmitpriv.xmit_sema); -+ } -+ -+ _exit_pwrlock(&pwrpriv->lock); -+ -+exit: -+ return; -+} -+ -+static void cpwm_event_callback(struct work_struct *work) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, cpwm_event); -+ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); -+ _adapter *adapter = dvobj->padapters[IFACE_ID0]; -+ struct reportpwrstate_parm report; -+ -+ /* RTW_INFO("%s\n",__FUNCTION__); */ -+ -+ report.state = PS_STATE_S2; -+ cpwm_int_hdl(adapter, &report); -+} -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+static void rpwmtimeout_workitem_callback(struct work_struct *work) -+{ -+ PADAPTER padapter; -+ struct dvobj_priv *dvobj; -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+ pwrpriv = container_of(work, struct pwrctrl_priv, rpwmtimeoutwi); -+ dvobj = pwrctl_to_dvobj(pwrpriv); -+ padapter = dvobj->padapters[IFACE_ID0]; -+ /* RTW_INFO("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); */ -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { -+ RTW_INFO("%s: rpwm=0x%02X cpwm=0x%02X CPWM done!\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); -+ goto exit; -+ } -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ if (rtw_read8(padapter, 0x100) != 0xEA) { -+#if 1 -+ struct reportpwrstate_parm report; -+ -+ report.state = PS_STATE_S2; -+ RTW_INFO("\n%s: FW already leave 32K!\n\n", __func__); -+ cpwm_int_hdl(padapter, &report); -+#else -+ RTW_INFO("\n%s: FW already leave 32K!\n\n", __func__); -+ cpwm_event_callback(&pwrpriv->cpwm_event); -+#endif -+ return; -+ } -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ -+ if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { -+ RTW_INFO("%s: cpwm=%d, nothing to do!\n", __func__, pwrpriv->cpwm); -+ goto exit; -+ } -+ pwrpriv->brpwmtimeout = _TRUE; -+ rtw_set_rpwm(padapter, pwrpriv->rpwm); -+ pwrpriv->brpwmtimeout = _FALSE; -+ -+exit: -+ _exit_pwrlock(&pwrpriv->lock); -+} -+ -+/* -+ * This function is a timer handler, can't do any IO in it. -+ */ -+static void pwr_rpwm_timeout_handler(void *FunctionContext) -+{ -+ PADAPTER padapter; -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+ padapter = (PADAPTER)FunctionContext; -+ pwrpriv = adapter_to_pwrctl(padapter); -+ RTW_INFO("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); -+ -+ if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { -+ RTW_INFO("+%s: cpwm=%d, nothing to do!\n", __func__, pwrpriv->cpwm); -+ return; -+ } -+ -+ _set_workitem(&pwrpriv->rpwmtimeoutwi); -+} -+#endif /* CONFIG_LPS_RPWM_TIMER */ -+ -+__inline static void register_task_alive(struct pwrctrl_priv *pwrctrl, u32 tag) -+{ -+ pwrctrl->alives |= tag; -+} -+ -+__inline static void unregister_task_alive(struct pwrctrl_priv *pwrctrl, u32 tag) -+{ -+ pwrctrl->alives &= ~tag; -+} -+ -+ -+/* -+ * Description: -+ * Check if the fw_pwrstate is okay for I/O. -+ * If not (cpwm is less than S2), then the sub-routine -+ * will raise the cpwm to be greater than or equal to S2. -+ * -+ * Calling Context: Passive -+ * -+ * Constraint: -+ * 1. this function will request pwrctrl->lock -+ * -+ * Return Value: -+ * _SUCCESS hardware is ready for I/O -+ * _FAIL can't I/O right now -+ */ -+s32 rtw_register_task_alive(PADAPTER padapter, u32 task) -+{ -+ s32 res; -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+ -+ res = _SUCCESS; -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S2; -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, task); -+ -+ if (pwrctrl->bFwCurrentInPSMode == _TRUE) { -+ -+ if (pwrctrl->cpwm < pslv) { -+ if (pwrctrl->cpwm < PS_STATE_S2) -+ res = _FAIL; -+ if (pwrctrl->rpwm < pslv) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+#ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ if (_FAIL == res) { -+ if (pwrctrl->cpwm >= PS_STATE_S2) -+ res = _SUCCESS; -+ } -+#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ -+ -+ -+ return res; -+} -+ -+/* -+ * Description: -+ * If task is done, call this func. to power down firmware again. -+ * -+ * Constraint: -+ * 1. this function will request pwrctrl->lock -+ * -+ * Return Value: -+ * none -+ */ -+void rtw_unregister_task_alive(PADAPTER padapter, u32 task) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+ -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S0; -+ -+#ifdef CONFIG_BT_COEXIST -+ if ((rtw_btcoex_IsBtDisabled(padapter) == _FALSE) -+ && (rtw_btcoex_IsBtControlLps(padapter) == _TRUE)) { -+ u8 val8; -+ -+ val8 = rtw_btcoex_LpsVal(padapter); -+ if (val8 & BIT(4)) -+ pslv = PS_STATE_S2; -+ -+ } -+#endif /* CONFIG_BT_COEXIST */ -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ unregister_task_alive(pwrctrl, task); -+ -+ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) -+ && (pwrctrl->bFwCurrentInPSMode == _TRUE)) { -+ -+ if (pwrctrl->cpwm > pslv) { -+ if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+} -+ -+/* -+ * Caller: rtw_xmit_thread -+ * -+ * Check if the fw_pwrstate is okay for xmit. -+ * If not (cpwm is less than S3), then the sub-routine -+ * will raise the cpwm to be greater than or equal to S3. -+ * -+ * Calling Context: Passive -+ * -+ * Return Value: -+ * _SUCCESS rtw_xmit_thread can write fifo/txcmd afterwards. -+ * _FAIL rtw_xmit_thread can not do anything. -+ */ -+s32 rtw_register_tx_alive(PADAPTER padapter) -+{ -+ s32 res; -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+ -+ res = _SUCCESS; -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S2; -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, XMIT_ALIVE); -+ -+ if (pwrctrl->bFwCurrentInPSMode == _TRUE) { -+ -+ if (pwrctrl->cpwm < pslv) { -+ if (pwrctrl->cpwm < PS_STATE_S2) -+ res = _FAIL; -+ if (pwrctrl->rpwm < pslv) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+#ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ if (_FAIL == res) { -+ if (pwrctrl->cpwm >= PS_STATE_S2) -+ res = _SUCCESS; -+ } -+#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ -+ -+ -+ return res; -+} -+ -+/* -+ * Caller: rtw_cmd_thread -+ * -+ * Check if the fw_pwrstate is okay for issuing cmd. -+ * If not (cpwm should be is less than S2), then the sub-routine -+ * will raise the cpwm to be greater than or equal to S2. -+ * -+ * Calling Context: Passive -+ * -+ * Return Value: -+ * _SUCCESS rtw_cmd_thread can issue cmds to firmware afterwards. -+ * _FAIL rtw_cmd_thread can not do anything. -+ */ -+s32 rtw_register_cmd_alive(PADAPTER padapter) -+{ -+ s32 res; -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+ -+ res = _SUCCESS; -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S2; -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, CMD_ALIVE); -+ -+ if (pwrctrl->bFwCurrentInPSMode == _TRUE) { -+ -+ if (pwrctrl->cpwm < pslv) { -+ if (pwrctrl->cpwm < PS_STATE_S2) -+ res = _FAIL; -+ if (pwrctrl->rpwm < pslv) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+#ifdef CONFIG_DETECT_CPWM_BY_POLLING -+ if (_FAIL == res) { -+ if (pwrctrl->cpwm >= PS_STATE_S2) -+ res = _SUCCESS; -+ } -+#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ -+ -+ -+ return res; -+} -+ -+/* -+ * Caller: rx_isr -+ * -+ * Calling Context: Dispatch/ISR -+ * -+ * Return Value: -+ * _SUCCESS -+ * _FAIL -+ */ -+s32 rtw_register_rx_alive(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ -+ -+ pwrctrl = adapter_to_pwrctl(padapter); -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, RECV_ALIVE); -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+ -+ return _SUCCESS; -+} -+ -+/* -+ * Caller: evt_isr or evt_thread -+ * -+ * Calling Context: Dispatch/ISR or Passive -+ * -+ * Return Value: -+ * _SUCCESS -+ * _FAIL -+ */ -+s32 rtw_register_evt_alive(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ -+ -+ pwrctrl = adapter_to_pwrctl(padapter); -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, EVT_ALIVE); -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+ -+ return _SUCCESS; -+} -+ -+/* -+ * Caller: ISR -+ * -+ * If ISR's txdone, -+ * No more pkts for TX, -+ * Then driver shall call this fun. to power down firmware again. -+ */ -+void rtw_unregister_tx_alive(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ u8 pslv, i; -+ -+ -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S0; -+ -+#ifdef CONFIG_BT_COEXIST -+ if ((rtw_btcoex_IsBtDisabled(padapter) == _FALSE) -+ && (rtw_btcoex_IsBtControlLps(padapter) == _TRUE)) { -+ u8 val8; -+ -+ val8 = rtw_btcoex_LpsVal(padapter); -+ if (val8 & BIT(4)) -+ pslv = PS_STATE_S2; -+ -+ } -+#endif /* CONFIG_BT_COEXIST */ -+ -+#ifdef CONFIG_P2P_PS -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ if (iface->wdinfo.p2p_ps_mode > P2P_PS_NONE) { -+ pslv = PS_STATE_S2; -+ break; -+ } -+ } -+ } -+#endif -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ unregister_task_alive(pwrctrl, XMIT_ALIVE); -+ -+ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) -+ && (pwrctrl->bFwCurrentInPSMode == _TRUE)) { -+ -+ if (pwrctrl->cpwm > pslv) { -+ if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+} -+ -+/* -+ * Caller: ISR -+ * -+ * If all commands have been done, -+ * and no more command to do, -+ * then driver shall call this fun. to power down firmware again. -+ */ -+void rtw_unregister_cmd_alive(PADAPTER padapter) -+{ -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv, i; -+ -+ -+ pwrctrl = adapter_to_pwrctl(padapter); -+ pslv = PS_STATE_S0; -+ -+#ifdef CONFIG_BT_COEXIST -+ if ((rtw_btcoex_IsBtDisabled(padapter) == _FALSE) -+ && (rtw_btcoex_IsBtControlLps(padapter) == _TRUE)) { -+ u8 val8; -+ -+ val8 = rtw_btcoex_LpsVal(padapter); -+ if (val8 & BIT(4)) -+ pslv = PS_STATE_S2; -+ -+ } -+#endif /* CONFIG_BT_COEXIST */ -+ -+#ifdef CONFIG_P2P_PS -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ if (iface->wdinfo.p2p_ps_mode > P2P_PS_NONE) { -+ pslv = PS_STATE_S2; -+ break; -+ } -+ } -+ } -+#endif -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ unregister_task_alive(pwrctrl, CMD_ALIVE); -+ -+ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) -+ && (pwrctrl->bFwCurrentInPSMode == _TRUE)) { -+ -+ if (pwrctrl->cpwm > pslv) { -+ if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+} -+ -+/* -+ * Caller: ISR -+ */ -+void rtw_unregister_rx_alive(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ -+ -+ pwrctrl = adapter_to_pwrctl(padapter); -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ unregister_task_alive(pwrctrl, RECV_ALIVE); -+ -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+} -+ -+void rtw_unregister_evt_alive(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ -+ -+ pwrctrl = adapter_to_pwrctl(padapter); -+ -+ unregister_task_alive(pwrctrl, EVT_ALIVE); -+ -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+} -+#endif /* CONFIG_LPS_LCLK */ -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+ static void resume_workitem_callback(struct work_struct *work); -+#endif /* CONFIG_RESUME_IN_WORKQUEUE */ -+ -+void rtw_init_pwrctrl_priv(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ int i = 0; -+ u8 val8 = 0; -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ -+ -+#ifdef PLATFORM_WINDOWS -+ pwrctrlpriv->pnp_current_pwr_state = NdisDeviceStateD0; -+#endif -+ -+ _init_pwrlock(&pwrctrlpriv->lock); -+ _init_pwrlock(&pwrctrlpriv->check_32k_lock); -+ pwrctrlpriv->rf_pwrstate = rf_on; -+ pwrctrlpriv->ips_enter_cnts = 0; -+ pwrctrlpriv->ips_leave_cnts = 0; -+ pwrctrlpriv->lps_enter_cnts = 0; -+ pwrctrlpriv->lps_leave_cnts = 0; -+ pwrctrlpriv->bips_processing = _FALSE; -+ -+ pwrctrlpriv->ips_mode = padapter->registrypriv.ips_mode; -+ pwrctrlpriv->ips_mode_req = padapter->registrypriv.ips_mode; -+ -+ pwrctrlpriv->pwr_state_check_interval = RTW_PWR_STATE_CHK_INTERVAL; -+ pwrctrlpriv->pwr_state_check_cnts = 0; -+ pwrctrlpriv->bInternalAutoSuspend = _FALSE; -+ pwrctrlpriv->bInSuspend = _FALSE; -+ pwrctrlpriv->bkeepfwalive = _FALSE; -+ -+#ifdef CONFIG_AUTOSUSPEND -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+ pwrctrlpriv->pwr_state_check_interval = (pwrctrlpriv->bHWPwrPindetect) ? 1000 : 2000; -+#endif -+#endif -+ -+ pwrctrlpriv->LpsIdleCount = 0; -+ -+#ifdef CONFIG_LPS_PG -+ pwrctrlpriv->lpspg_rsvd_page_locate = 0; -+#endif -+ -+ /* pwrctrlpriv->FWCtrlPSMode =padapter->registrypriv.power_mgnt; */ /* PS_MODE_MIN; */ -+ if (padapter->registrypriv.mp_mode == 1) -+ pwrctrlpriv->power_mgnt = PS_MODE_ACTIVE ; -+ else -+ pwrctrlpriv->power_mgnt = padapter->registrypriv.power_mgnt; /* PS_MODE_MIN; */ -+ pwrctrlpriv->bLeisurePs = (PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt) ? _TRUE : _FALSE; -+ -+ pwrctrlpriv->bFwCurrentInPSMode = _FALSE; -+ -+ pwrctrlpriv->rpwm = 0; -+ pwrctrlpriv->cpwm = PS_STATE_S4; -+ -+ pwrctrlpriv->pwr_mode = PS_MODE_ACTIVE; -+ pwrctrlpriv->smart_ps = padapter->registrypriv.smart_ps; -+ pwrctrlpriv->bcn_ant_mode = 0; -+ pwrctrlpriv->dtim = 0; -+ -+ pwrctrlpriv->tog = 0x80; -+ -+#ifdef CONFIG_LPS_LCLK -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&pwrctrlpriv->rpwm)); -+ -+ _init_workitem(&pwrctrlpriv->cpwm_event, cpwm_event_callback, NULL); -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+ pwrctrlpriv->brpwmtimeout = _FALSE; -+ _init_workitem(&pwrctrlpriv->rpwmtimeoutwi, rpwmtimeout_workitem_callback, NULL); -+ _init_timer(&pwrctrlpriv->pwr_rpwm_timer, padapter->pnetdev, pwr_rpwm_timeout_handler, padapter); -+#endif /* CONFIG_LPS_RPWM_TIMER */ -+#endif /* CONFIG_LPS_LCLK */ -+ -+ rtw_init_timer(&pwrctrlpriv->pwr_state_check_timer, padapter, pwr_state_check_handler); -+ -+ pwrctrlpriv->wowlan_mode = _FALSE; -+ pwrctrlpriv->wowlan_ap_mode = _FALSE; -+ pwrctrlpriv->wowlan_p2p_mode = _FALSE; -+ pwrctrlpriv->wowlan_last_wake_reason = 0; -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+ _init_workitem(&pwrctrlpriv->resume_work, resume_workitem_callback, NULL); -+ pwrctrlpriv->rtw_workqueue = create_singlethread_workqueue("rtw_workqueue"); -+#endif /* CONFIG_RESUME_IN_WORKQUEUE */ -+ -+#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) -+ pwrctrlpriv->early_suspend.suspend = NULL; -+ rtw_register_early_suspend(pwrctrlpriv); -+#endif /* CONFIG_HAS_EARLYSUSPEND || CONFIG_ANDROID_POWER */ -+ -+#ifdef CONFIG_RTW_SDIO_OOB_INT -+ rtw_hal_switch_ood_int_ctrl(padapter, _TRUE); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ /*default low active*/ -+ pwrctrlpriv->is_high_active = HIGH_ACTIVE; -+ val8 = (pwrctrlpriv->is_high_active == 0) ? 1 : 0; -+ rtw_hal_switch_gpio_wl_ctrl(padapter, WAKEUP_GPIO_IDX, _TRUE); -+ rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, val8); -+ RTW_INFO("%s: set GPIO_%d %d as default.\n", -+ __func__, WAKEUP_GPIO_IDX, val8); -+#endif /* CONFIG_GPIO_WAKEUP */ -+ -+#ifdef CONFIG_WOWLAN -+ pwrctrlpriv->wowlan_pattern_idx = DEFAULT_PATTERN_NUM; -+ pwrctrlpriv->wowlan_in_resume = _FALSE; -+ for (i = 0 ; i < MAX_WKFM_NUM; i++) { -+ _rtw_memset(pwrctrlpriv->patterns[i].content, '\0', -+ sizeof(pwrctrlpriv->patterns[i].content)); -+ _rtw_memset(pwrctrlpriv->patterns[i].mask, '\0', -+ sizeof(pwrctrlpriv->patterns[i].mask)); -+ pwrctrlpriv->patterns[i].len = 0; -+ } -+ -+#ifdef CONFIG_PNO_SUPPORT -+ pwrctrlpriv->pno_inited = _FALSE; -+ pwrctrlpriv->pnlo_info = NULL; -+ pwrctrlpriv->pscan_info = NULL; -+ pwrctrlpriv->pno_ssid_list = NULL; -+#endif /* CONFIG_PNO_SUPPORT */ -+ pwrctrlpriv->wowlan_aoac_rpt_loc = 0; -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_LPS_POFF -+ rtw_hal_set_hwreg(padapter, HW_VAR_LPS_POFF_INIT, 0); -+#endif -+ -+ -+} -+ -+ -+void rtw_free_pwrctrl_priv(PADAPTER adapter) -+{ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(adapter); -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (adapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ -+ -+ /* _rtw_memset((unsigned char *)pwrctrlpriv, 0, sizeof(struct pwrctrl_priv)); */ -+ -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+ if (pwrctrlpriv->rtw_workqueue) { -+ flush_workqueue(pwrctrlpriv->rtw_workqueue); -+ destroy_workqueue(pwrctrlpriv->rtw_workqueue); -+ } -+#endif -+ -+#ifdef CONFIG_LPS_POFF -+ rtw_hal_set_hwreg(adapter, HW_VAR_LPS_POFF_DEINIT, 0); -+#endif -+ -+#ifdef CONFIG_WOWLAN -+#ifdef CONFIG_PNO_SUPPORT -+ if (pwrctrlpriv->pnlo_info != NULL) -+ printk("****** pnlo_info memory leak********\n"); -+ -+ if (pwrctrlpriv->pscan_info != NULL) -+ printk("****** pscan_info memory leak********\n"); -+ -+ if (pwrctrlpriv->pno_ssid_list != NULL) -+ printk("****** pno_ssid_list memory leak********\n"); -+#endif -+#endif /* CONFIG_WOWLAN */ -+ -+#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) -+ rtw_unregister_early_suspend(pwrctrlpriv); -+#endif /* CONFIG_HAS_EARLYSUSPEND || CONFIG_ANDROID_POWER */ -+ -+ _free_pwrlock(&pwrctrlpriv->lock); -+ _free_pwrlock(&pwrctrlpriv->check_32k_lock); -+ -+} -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+extern int rtw_resume_process(_adapter *padapter); -+ -+static void resume_workitem_callback(struct work_struct *work) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, resume_work); -+ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); -+ _adapter *adapter = dvobj->padapters[IFACE_ID0]; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ rtw_resume_process(adapter); -+ -+ rtw_resume_unlock_suspend(); -+} -+ -+void rtw_resume_in_workqueue(struct pwrctrl_priv *pwrpriv) -+{ -+ /* accquire system's suspend lock preventing from falliing asleep while resume in workqueue */ -+ /* rtw_lock_suspend(); */ -+ -+ rtw_resume_lock_suspend(); -+ -+#if 1 -+ queue_work(pwrpriv->rtw_workqueue, &pwrpriv->resume_work); -+#else -+ _set_workitem(&pwrpriv->resume_work); -+#endif -+} -+#endif /* CONFIG_RESUME_IN_WORKQUEUE */ -+ -+#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) -+inline bool rtw_is_earlysuspend_registered(struct pwrctrl_priv *pwrpriv) -+{ -+ return (pwrpriv->early_suspend.suspend) ? _TRUE : _FALSE; -+} -+ -+inline bool rtw_is_do_late_resume(struct pwrctrl_priv *pwrpriv) -+{ -+ return (pwrpriv->do_late_resume) ? _TRUE : _FALSE; -+} -+ -+inline void rtw_set_do_late_resume(struct pwrctrl_priv *pwrpriv, bool enable) -+{ -+ pwrpriv->do_late_resume = enable; -+} -+#endif -+ -+#ifdef CONFIG_HAS_EARLYSUSPEND -+extern int rtw_resume_process(_adapter *padapter); -+static void rtw_early_suspend(struct early_suspend *h) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ rtw_set_do_late_resume(pwrpriv, _FALSE); -+} -+ -+static void rtw_late_resume(struct early_suspend *h) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); -+ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); -+ _adapter *adapter = dvobj->padapters[IFACE_ID0]; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ if (pwrpriv->do_late_resume) { -+ rtw_set_do_late_resume(pwrpriv, _FALSE); -+ rtw_resume_process(adapter); -+ } -+} -+ -+void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ /* jeff: set the early suspend level before blank screen, so we wll do late resume after scree is lit */ -+ pwrpriv->early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20; -+ pwrpriv->early_suspend.suspend = rtw_early_suspend; -+ pwrpriv->early_suspend.resume = rtw_late_resume; -+ register_early_suspend(&pwrpriv->early_suspend); -+ -+ -+} -+ -+void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ rtw_set_do_late_resume(pwrpriv, _FALSE); -+ -+ if (pwrpriv->early_suspend.suspend) -+ unregister_early_suspend(&pwrpriv->early_suspend); -+ -+ pwrpriv->early_suspend.suspend = NULL; -+ pwrpriv->early_suspend.resume = NULL; -+} -+#endif /* CONFIG_HAS_EARLYSUSPEND */ -+ -+#ifdef CONFIG_ANDROID_POWER -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ extern int rtw_resume_process(PADAPTER padapter); -+#endif -+static void rtw_early_suspend(android_early_suspend_t *h) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ rtw_set_do_late_resume(pwrpriv, _FALSE); -+} -+ -+static void rtw_late_resume(android_early_suspend_t *h) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); -+ struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); -+ _adapter *adapter = dvobj->padapters[IFACE_ID0]; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ if (pwrpriv->do_late_resume) { -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ rtw_set_do_late_resume(pwrpriv, _FALSE); -+ rtw_resume_process(adapter); -+#endif -+ } -+} -+ -+void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ /* jeff: set the early suspend level before blank screen, so we wll do late resume after scree is lit */ -+ pwrpriv->early_suspend.level = ANDROID_EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20; -+ pwrpriv->early_suspend.suspend = rtw_early_suspend; -+ pwrpriv->early_suspend.resume = rtw_late_resume; -+ android_register_early_suspend(&pwrpriv->early_suspend); -+} -+ -+void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ rtw_set_do_late_resume(pwrpriv, _FALSE); -+ -+ if (pwrpriv->early_suspend.suspend) -+ android_unregister_early_suspend(&pwrpriv->early_suspend); -+ -+ pwrpriv->early_suspend.suspend = NULL; -+ pwrpriv->early_suspend.resume = NULL; -+} -+#endif /* CONFIG_ANDROID_POWER */ -+ -+u8 rtw_interface_ps_func(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val) -+{ -+ u8 bResult = _TRUE; -+ rtw_hal_intf_ps_func(padapter, efunc_id, val); -+ -+ return bResult; -+} -+ -+ -+inline void rtw_set_ips_deny(_adapter *padapter, u32 ms) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ms); -+} -+ -+/* -+* rtw_pwr_wakeup - Wake the NIC up from: 1)IPS. 2)USB autosuspend -+* @adapter: pointer to _adapter structure -+* @ips_deffer_ms: the ms wiil prevent from falling into IPS after wakeup -+* Return _SUCCESS or _FAIL -+*/ -+ -+int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ struct mlme_priv *pmlmepriv; -+ int ret = _SUCCESS; -+ int i; -+ u32 start = rtw_get_current_time(); -+ -+ /* for LPS */ -+ LeaveAllPowerSaveMode(padapter); -+ -+ /* IPS still bound with primary adapter */ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ pmlmepriv = &padapter->mlmepriv; -+ -+ if (pwrpriv->ips_deny_time < rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms)) -+ pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms); -+ -+ -+ if (pwrpriv->ps_processing) { -+ RTW_INFO("%s wait ps_processing...\n", __func__); -+ while (pwrpriv->ps_processing && rtw_get_passing_time_ms(start) <= 3000) -+ rtw_msleep_os(10); -+ if (pwrpriv->ps_processing) -+ RTW_INFO("%s wait ps_processing timeout\n", __func__); -+ else -+ RTW_INFO("%s wait ps_processing done\n", __func__); -+ } -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ if (rtw_hal_sreset_inprogress(padapter)) { -+ RTW_INFO("%s wait sreset_inprogress...\n", __func__); -+ while (rtw_hal_sreset_inprogress(padapter) && rtw_get_passing_time_ms(start) <= 4000) -+ rtw_msleep_os(10); -+ if (rtw_hal_sreset_inprogress(padapter)) -+ RTW_INFO("%s wait sreset_inprogress timeout\n", __func__); -+ else -+ RTW_INFO("%s wait sreset_inprogress done\n", __func__); -+ } -+#endif -+ -+ if (pwrpriv->bInternalAutoSuspend == _FALSE && pwrpriv->bInSuspend) { -+ RTW_INFO("%s wait bInSuspend...\n", __func__); -+ while (pwrpriv->bInSuspend -+ && ((rtw_get_passing_time_ms(start) <= 3000 && !rtw_is_do_late_resume(pwrpriv)) -+ || (rtw_get_passing_time_ms(start) <= 500 && rtw_is_do_late_resume(pwrpriv))) -+ ) -+ rtw_msleep_os(10); -+ if (pwrpriv->bInSuspend) -+ RTW_INFO("%s wait bInSuspend timeout\n", __func__); -+ else -+ RTW_INFO("%s wait bInSuspend done\n", __func__); -+ } -+ -+ /* System suspend is not allowed to wakeup */ -+ if ((pwrpriv->bInternalAutoSuspend == _FALSE) && (_TRUE == pwrpriv->bInSuspend)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* block??? */ -+ if ((pwrpriv->bInternalAutoSuspend == _TRUE) && (padapter->net_closed == _TRUE)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* I think this should be check in IPS, LPS, autosuspend functions... */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+#if defined(CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) -+ if (_TRUE == pwrpriv->bInternalAutoSuspend) { -+ if (0 == pwrpriv->autopm_cnt) { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 33)) -+ if (usb_autopm_get_interface(adapter_to_dvobj(padapter)->pusbintf) < 0) -+ RTW_INFO("can't get autopm:\n"); -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 20)) -+ usb_autopm_disable(adapter_to_dvobj(padapter)->pusbintf); -+#else -+ usb_autoresume_device(adapter_to_dvobj(padapter)->pusbdev, 1); -+#endif -+ pwrpriv->autopm_cnt++; -+ } -+#endif /* #if defined (CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) */ -+ ret = _SUCCESS; -+ goto exit; -+#if defined(CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) -+ } -+#endif /* #if defined (CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) */ -+ } -+ -+ if (rf_off == pwrpriv->rf_pwrstate) { -+#ifdef CONFIG_USB_HCI -+#ifdef CONFIG_AUTOSUSPEND -+ if (pwrpriv->brfoffbyhw == _TRUE) { -+ RTW_INFO("hw still in rf_off state ...........\n"); -+ ret = _FAIL; -+ goto exit; -+ } else if (padapter->registrypriv.usbss_enable) { -+ RTW_INFO("%s call autoresume_enter....\n", __FUNCTION__); -+ if (_FAIL == autoresume_enter(padapter)) { -+ RTW_INFO("======> autoresume fail.............\n"); -+ ret = _FAIL; -+ goto exit; -+ } -+ } else -+#endif -+#endif -+ { -+#ifdef CONFIG_IPS -+ RTW_INFO("%s call ips_leave....\n", __FUNCTION__); -+ if (_FAIL == ips_leave(padapter)) { -+ RTW_INFO("======> ips_leave fail.............\n"); -+ ret = _FAIL; -+ goto exit; -+ } -+#endif -+ } -+ } -+ -+ /* TODO: the following checking need to be merged... */ -+ if (rtw_is_drv_stopped(padapter) -+ || !padapter->bup -+ || !rtw_is_hw_init_completed(padapter) -+ ) { -+ RTW_INFO("%s: bDriverStopped=%s, bup=%d, hw_init_completed=%u\n" -+ , caller -+ , rtw_is_drv_stopped(padapter) ? "True" : "False" -+ , padapter->bup -+ , rtw_get_hw_init_completed(padapter)); -+ ret = _FALSE; -+ goto exit; -+ } -+ -+exit: -+ if (pwrpriv->ips_deny_time < rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms)) -+ pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms); -+ return ret; -+ -+} -+ -+int rtw_pm_set_lps(_adapter *padapter, u8 mode) -+{ -+ int ret = 0; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (mode < PS_MODE_NUM) { -+ if (pwrctrlpriv->power_mgnt != mode) { -+ if (PS_MODE_ACTIVE == mode) -+ LeaveAllPowerSaveMode(padapter); -+ else -+ pwrctrlpriv->LpsIdleCount = 2; -+ pwrctrlpriv->power_mgnt = mode; -+ pwrctrlpriv->bLeisurePs = (PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt) ? _TRUE : _FALSE; -+ } -+ } else -+ ret = -EINVAL; -+ -+ return ret; -+} -+ -+int rtw_pm_set_ips(_adapter *padapter, u8 mode) -+{ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (mode == IPS_NORMAL || mode == IPS_LEVEL_2) { -+ rtw_ips_mode_req(pwrctrlpriv, mode); -+ RTW_INFO("%s %s\n", __FUNCTION__, mode == IPS_NORMAL ? "IPS_NORMAL" : "IPS_LEVEL_2"); -+ return 0; -+ } else if (mode == IPS_NONE) { -+ rtw_ips_mode_req(pwrctrlpriv, mode); -+ RTW_INFO("%s %s\n", __FUNCTION__, "IPS_NONE"); -+ if (!rtw_is_surprise_removed(padapter) && (_FAIL == rtw_pwr_wakeup(padapter))) -+ return -EFAULT; -+ } else -+ return -EINVAL; -+ return 0; -+} -+ -+/* -+ * ATTENTION: -+ * This function will request pwrctrl LOCK! -+ */ -+void rtw_ps_deny(PADAPTER padapter, PS_DENY_REASON reason) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ s32 ret; -+ -+ -+ /* RTW_INFO("+" FUNC_ADPT_FMT ": Request PS deny for %d (0x%08X)\n", -+ * FUNC_ADPT_ARG(padapter), reason, BIT(reason)); */ -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ if (pwrpriv->ps_deny & BIT(reason)) { -+ RTW_INFO(FUNC_ADPT_FMT ": [WARNING] Reason %d had been set before!!\n", -+ FUNC_ADPT_ARG(padapter), reason); -+ } -+ pwrpriv->ps_deny |= BIT(reason); -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ /* RTW_INFO("-" FUNC_ADPT_FMT ": Now PS deny for 0x%08X\n", -+ * FUNC_ADPT_ARG(padapter), pwrpriv->ps_deny); */ -+} -+ -+/* -+ * ATTENTION: -+ * This function will request pwrctrl LOCK! -+ */ -+void rtw_ps_deny_cancel(PADAPTER padapter, PS_DENY_REASON reason) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+ /* RTW_INFO("+" FUNC_ADPT_FMT ": Cancel PS deny for %d(0x%08X)\n", -+ * FUNC_ADPT_ARG(padapter), reason, BIT(reason)); */ -+ -+ pwrpriv = adapter_to_pwrctl(padapter); -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ if ((pwrpriv->ps_deny & BIT(reason)) == 0) { -+ RTW_INFO(FUNC_ADPT_FMT ": [ERROR] Reason %d had been canceled before!!\n", -+ FUNC_ADPT_ARG(padapter), reason); -+ } -+ pwrpriv->ps_deny &= ~BIT(reason); -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ /* RTW_INFO("-" FUNC_ADPT_FMT ": Now PS deny for 0x%08X\n", -+ * FUNC_ADPT_ARG(padapter), pwrpriv->ps_deny); */ -+} -+ -+/* -+ * ATTENTION: -+ * Before calling this function pwrctrl lock should be occupied already, -+ * otherwise it may return incorrect value. -+ */ -+u32 rtw_ps_deny_get(PADAPTER padapter) -+{ -+ u32 deny; -+ -+ -+ deny = adapter_to_pwrctl(padapter)->ps_deny; -+ -+ return deny; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_recv.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_recv.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_recv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_recv.c 2018-02-11 21:44:27.140145979 +0200 -@@ -0,0 +1,4674 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_RECV_C_ -+ -+#include -+#include -+ -+#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+ -+ #error "Shall be Linux or Windows, but not both!\n" -+ -+#endif -+ -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS); -+ -+enum { -+ SIGNAL_STAT_CALC_PROFILE_0 = 0, -+ SIGNAL_STAT_CALC_PROFILE_1, -+ SIGNAL_STAT_CALC_PROFILE_MAX -+}; -+ -+u8 signal_stat_calc_profile[SIGNAL_STAT_CALC_PROFILE_MAX][2] = { -+ {4, 1}, /* Profile 0 => pre_stat : curr_stat = 4 : 1 */ -+ {3, 7} /* Profile 1 => pre_stat : curr_stat = 3 : 7 */ -+}; -+ -+#ifndef RTW_SIGNAL_STATE_CALC_PROFILE -+ #define RTW_SIGNAL_STATE_CALC_PROFILE SIGNAL_STAT_CALC_PROFILE_1 -+#endif -+ -+#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ -+void _rtw_init_sta_recv_priv(struct sta_recv_priv *psta_recvpriv) -+{ -+ -+ -+ -+ _rtw_memset((u8 *)psta_recvpriv, 0, sizeof(struct sta_recv_priv)); -+ -+ _rtw_spinlock_init(&psta_recvpriv->lock); -+ -+ /* for(i=0; iblk_strms[i]); */ -+ -+ _rtw_init_queue(&psta_recvpriv->defrag_q); -+ -+ -+} -+ -+sint _rtw_init_recv_priv(struct recv_priv *precvpriv, _adapter *padapter) -+{ -+ sint i; -+ -+ union recv_frame *precvframe; -+ sint res = _SUCCESS; -+ -+ -+ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). */ -+ /* _rtw_memset((unsigned char *)precvpriv, 0, sizeof (struct recv_priv)); */ -+ -+ _rtw_spinlock_init(&precvpriv->lock); -+ -+ _rtw_init_queue(&precvpriv->free_recv_queue); -+ _rtw_init_queue(&precvpriv->recv_pending_queue); -+ _rtw_init_queue(&precvpriv->uc_swdec_pending_queue); -+ -+ precvpriv->adapter = padapter; -+ -+ precvpriv->free_recvframe_cnt = NR_RECVFRAME; -+ -+ precvpriv->sink_udpport = 0; -+ precvpriv->pre_rtp_rxseq = 0; -+ precvpriv->cur_rtp_rxseq = 0; -+ -+#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ precvpriv->store_law_data_flag = 1; -+#else -+ precvpriv->store_law_data_flag = 0; -+#endif -+ -+ rtw_os_recv_resource_init(precvpriv, padapter); -+ -+ precvpriv->pallocated_frame_buf = rtw_zvmalloc(NR_RECVFRAME * sizeof(union recv_frame) + RXFRAME_ALIGN_SZ); -+ -+ if (precvpriv->pallocated_frame_buf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ /* _rtw_memset(precvpriv->pallocated_frame_buf, 0, NR_RECVFRAME * sizeof(union recv_frame) + RXFRAME_ALIGN_SZ); */ -+ -+ precvpriv->precv_frame_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(precvpriv->pallocated_frame_buf), RXFRAME_ALIGN_SZ); -+ /* precvpriv->precv_frame_buf = precvpriv->pallocated_frame_buf + RXFRAME_ALIGN_SZ - */ -+ /* ((SIZE_PTR) (precvpriv->pallocated_frame_buf) &(RXFRAME_ALIGN_SZ-1)); */ -+ -+ precvframe = (union recv_frame *) precvpriv->precv_frame_buf; -+ -+ -+ for (i = 0; i < NR_RECVFRAME ; i++) { -+ _rtw_init_listhead(&(precvframe->u.list)); -+ -+ rtw_list_insert_tail(&(precvframe->u.list), &(precvpriv->free_recv_queue.queue)); -+ -+ res = rtw_os_recv_resource_alloc(padapter, precvframe); -+ -+ precvframe->u.hdr.len = 0; -+ -+ precvframe->u.hdr.adapter = padapter; -+ precvframe++; -+ -+ } -+ -+#ifdef CONFIG_USB_HCI -+ -+ ATOMIC_SET(&(precvpriv->rx_pending_cnt), 1); -+ -+ _rtw_init_sema(&precvpriv->allrxreturnevt, 0); -+ -+#endif -+ -+ res = rtw_hal_init_recv_priv(padapter); -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ rtw_init_timer(&precvpriv->signal_stat_timer, padapter, RTW_TIMER_HDL_NAME(signal_stat)); -+ -+ precvpriv->signal_stat_sampling_interval = 2000; /* ms */ -+ /* precvpriv->signal_stat_converging_constant = 5000; */ /* ms */ -+ -+ rtw_set_signal_stat_timer(precvpriv); -+#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ -+exit: -+ -+ -+ return res; -+ -+} -+ -+void rtw_mfree_recv_priv_lock(struct recv_priv *precvpriv); -+void rtw_mfree_recv_priv_lock(struct recv_priv *precvpriv) -+{ -+ _rtw_spinlock_free(&precvpriv->lock); -+#ifdef CONFIG_RECV_THREAD_MODE -+ _rtw_free_sema(&precvpriv->recv_sema); -+ /*_rtw_free_sema(&precvpriv->terminate_recvthread_sema);*/ -+#endif -+ -+ _rtw_spinlock_free(&precvpriv->free_recv_queue.lock); -+ _rtw_spinlock_free(&precvpriv->recv_pending_queue.lock); -+ -+ _rtw_spinlock_free(&precvpriv->free_recv_buf_queue.lock); -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ _rtw_spinlock_free(&precvpriv->recv_buf_pending_queue.lock); -+#endif /* CONFIG_USE_USB_BUFFER_ALLOC_RX */ -+} -+ -+void _rtw_free_recv_priv(struct recv_priv *precvpriv) -+{ -+ _adapter *padapter = precvpriv->adapter; -+ -+ -+ rtw_free_uc_swdec_pending_queue(padapter); -+ -+ rtw_mfree_recv_priv_lock(precvpriv); -+ -+ rtw_os_recv_resource_free(precvpriv); -+ -+ if (precvpriv->pallocated_frame_buf) -+ rtw_vmfree(precvpriv->pallocated_frame_buf, NR_RECVFRAME * sizeof(union recv_frame) + RXFRAME_ALIGN_SZ); -+ -+ rtw_hal_free_recv_priv(padapter); -+ -+ -+} -+ -+bool rtw_rframe_del_wfd_ie(union recv_frame *rframe, u8 ies_offset) -+{ -+#define DBG_RFRAME_DEL_WFD_IE 0 -+ u8 *ies = rframe->u.hdr.rx_data + sizeof(struct rtw_ieee80211_hdr_3addr) + ies_offset; -+ uint ies_len_ori = rframe->u.hdr.len - (ies - rframe->u.hdr.rx_data); -+ uint ies_len; -+ -+ ies_len = rtw_del_wfd_ie(ies, ies_len_ori, DBG_RFRAME_DEL_WFD_IE ? __func__ : NULL); -+ rframe->u.hdr.len -= ies_len_ori - ies_len; -+ -+ return ies_len_ori != ies_len; -+} -+ -+union recv_frame *_rtw_alloc_recvframe(_queue *pfree_recv_queue) -+{ -+ -+ union recv_frame *precvframe; -+ _list *plist, *phead; -+ _adapter *padapter; -+ struct recv_priv *precvpriv; -+ -+ if (_rtw_queue_empty(pfree_recv_queue) == _TRUE) -+ precvframe = NULL; -+ else { -+ phead = get_list_head(pfree_recv_queue); -+ -+ plist = get_next(phead); -+ -+ precvframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ -+ rtw_list_delete(&precvframe->u.hdr.list); -+ padapter = precvframe->u.hdr.adapter; -+ if (padapter != NULL) { -+ precvpriv = &padapter->recvpriv; -+ if (pfree_recv_queue == &precvpriv->free_recv_queue) -+ precvpriv->free_recvframe_cnt--; -+ } -+ } -+ -+ -+ return precvframe; -+ -+} -+ -+union recv_frame *rtw_alloc_recvframe(_queue *pfree_recv_queue) -+{ -+ _irqL irqL; -+ union recv_frame *precvframe; -+ -+ _enter_critical_bh(&pfree_recv_queue->lock, &irqL); -+ -+ precvframe = _rtw_alloc_recvframe(pfree_recv_queue); -+ -+ _exit_critical_bh(&pfree_recv_queue->lock, &irqL); -+ -+ return precvframe; -+} -+ -+void rtw_init_recvframe(union recv_frame *precvframe, struct recv_priv *precvpriv) -+{ -+ /* Perry: This can be removed */ -+ _rtw_init_listhead(&precvframe->u.hdr.list); -+ -+ precvframe->u.hdr.len = 0; -+} -+ -+int rtw_free_recvframe(union recv_frame *precvframe, _queue *pfree_recv_queue) -+{ -+ _irqL irqL; -+ _adapter *padapter = precvframe->u.hdr.adapter; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ precvpriv = &padapter->recvpriv; -+ pfree_recv_queue = &precvpriv->free_recv_queue; -+ precvframe->u.hdr.adapter = padapter; -+#endif -+ -+ -+ rtw_os_free_recvframe(precvframe); -+ -+ -+ _enter_critical_bh(&pfree_recv_queue->lock, &irqL); -+ -+ rtw_list_delete(&(precvframe->u.hdr.list)); -+ -+ precvframe->u.hdr.len = 0; -+ -+ rtw_list_insert_tail(&(precvframe->u.hdr.list), get_list_head(pfree_recv_queue)); -+ -+ if (padapter != NULL) { -+ if (pfree_recv_queue == &precvpriv->free_recv_queue) -+ precvpriv->free_recvframe_cnt++; -+ } -+ -+ _exit_critical_bh(&pfree_recv_queue->lock, &irqL); -+ -+ -+ return _SUCCESS; -+ -+} -+ -+ -+ -+ -+sint _rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue) -+{ -+ -+ _adapter *padapter = precvframe->u.hdr.adapter; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ -+ /* _rtw_init_listhead(&(precvframe->u.hdr.list)); */ -+ rtw_list_delete(&(precvframe->u.hdr.list)); -+ -+ -+ rtw_list_insert_tail(&(precvframe->u.hdr.list), get_list_head(queue)); -+ -+ if (padapter != NULL) { -+ if (queue == &precvpriv->free_recv_queue) -+ precvpriv->free_recvframe_cnt++; -+ } -+ -+ -+ return _SUCCESS; -+} -+ -+sint rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue) -+{ -+ sint ret; -+ _irqL irqL; -+ -+ /* _spinlock(&pfree_recv_queue->lock); */ -+ _enter_critical_bh(&queue->lock, &irqL); -+ ret = _rtw_enqueue_recvframe(precvframe, queue); -+ /* _rtw_spinunlock(&pfree_recv_queue->lock); */ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ return ret; -+} -+ -+/* -+sint rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue) -+{ -+ return rtw_free_recvframe(precvframe, queue); -+} -+*/ -+ -+ -+ -+ -+/* -+caller : defrag ; recvframe_chk_defrag in recv_thread (passive) -+pframequeue: defrag_queue : will be accessed in recv_thread (passive) -+ -+using spinlock to protect -+ -+*/ -+ -+void rtw_free_recvframe_queue(_queue *pframequeue, _queue *pfree_recv_queue) -+{ -+ union recv_frame *precvframe; -+ _list *plist, *phead; -+ -+ _rtw_spinlock(&pframequeue->lock); -+ -+ phead = get_list_head(pframequeue); -+ plist = get_next(phead); -+ -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ precvframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ -+ plist = get_next(plist); -+ -+ /* rtw_list_delete(&precvframe->u.hdr.list); */ /* will do this in rtw_free_recvframe() */ -+ -+ rtw_free_recvframe(precvframe, pfree_recv_queue); -+ } -+ -+ _rtw_spinunlock(&pframequeue->lock); -+ -+ -+} -+ -+u32 rtw_free_uc_swdec_pending_queue(_adapter *adapter) -+{ -+ u32 cnt = 0; -+ union recv_frame *pending_frame; -+ while ((pending_frame = rtw_alloc_recvframe(&adapter->recvpriv.uc_swdec_pending_queue))) { -+ rtw_free_recvframe(pending_frame, &adapter->recvpriv.free_recv_queue); -+ cnt++; -+ } -+ -+ if (cnt) -+ RTW_INFO(FUNC_ADPT_FMT" dequeue %d\n", FUNC_ADPT_ARG(adapter), cnt); -+ -+ return cnt; -+} -+ -+ -+sint rtw_enqueue_recvbuf_to_head(struct recv_buf *precvbuf, _queue *queue) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ rtw_list_delete(&precvbuf->list); -+ rtw_list_insert_head(&precvbuf->list, get_list_head(queue)); -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ return _SUCCESS; -+} -+ -+sint rtw_enqueue_recvbuf(struct recv_buf *precvbuf, _queue *queue) -+{ -+ _irqL irqL; -+#ifdef CONFIG_SDIO_HCI -+ _enter_critical_bh(&queue->lock, &irqL); -+#else -+ _enter_critical_ex(&queue->lock, &irqL); -+#endif/*#ifdef CONFIG_SDIO_HCI*/ -+ -+ rtw_list_delete(&precvbuf->list); -+ -+ rtw_list_insert_tail(&precvbuf->list, get_list_head(queue)); -+#ifdef CONFIG_SDIO_HCI -+ _exit_critical_bh(&queue->lock, &irqL); -+#else -+ _exit_critical_ex(&queue->lock, &irqL); -+#endif/*#ifdef CONFIG_SDIO_HCI*/ -+ return _SUCCESS; -+ -+} -+ -+struct recv_buf *rtw_dequeue_recvbuf(_queue *queue) -+{ -+ _irqL irqL; -+ struct recv_buf *precvbuf; -+ _list *plist, *phead; -+ -+#ifdef CONFIG_SDIO_HCI -+ _enter_critical_bh(&queue->lock, &irqL); -+#else -+ _enter_critical_ex(&queue->lock, &irqL); -+#endif/*#ifdef CONFIG_SDIO_HCI*/ -+ -+ if (_rtw_queue_empty(queue) == _TRUE) -+ precvbuf = NULL; -+ else { -+ phead = get_list_head(queue); -+ -+ plist = get_next(phead); -+ -+ precvbuf = LIST_CONTAINOR(plist, struct recv_buf, list); -+ -+ rtw_list_delete(&precvbuf->list); -+ -+ } -+ -+#ifdef CONFIG_SDIO_HCI -+ _exit_critical_bh(&queue->lock, &irqL); -+#else -+ _exit_critical_ex(&queue->lock, &irqL); -+#endif/*#ifdef CONFIG_SDIO_HCI*/ -+ -+ return precvbuf; -+ -+} -+ -+sint recvframe_chkmic(_adapter *adapter, union recv_frame *precvframe); -+sint recvframe_chkmic(_adapter *adapter, union recv_frame *precvframe) -+{ -+ -+ sint i, res = _SUCCESS; -+ u32 datalen; -+ u8 miccode[8]; -+ u8 bmic_err = _FALSE, brpt_micerror = _TRUE; -+ u8 *pframe, *payload, *pframemic; -+ u8 *mickey; -+ /* u8 *iv,rxdata_key_idx=0; */ -+ struct sta_info *stainfo; -+ struct rx_pkt_attrib *prxattrib = &precvframe->u.hdr.attrib; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ stainfo = rtw_get_stainfo(&adapter->stapriv , &prxattrib->ta[0]); -+ -+ if (prxattrib->encrypt == _TKIP_) { -+ -+ /* calculate mic code */ -+ if (stainfo != NULL) { -+ if (IS_MCAST(prxattrib->ra)) { -+ /* mickey=&psecuritypriv->dot118021XGrprxmickey.skey[0]; */ -+ /* iv = precvframe->u.hdr.rx_data+prxattrib->hdrlen; */ -+ /* rxdata_key_idx =( ((iv[3])>>6)&0x3) ; */ -+ mickey = &psecuritypriv->dot118021XGrprxmickey[prxattrib->key_index].skey[0]; -+ -+ /* RTW_INFO("\n recvframe_chkmic: bcmc key psecuritypriv->dot118021XGrpKeyid(%d),pmlmeinfo->key_index(%d) ,recv key_id(%d)\n", */ -+ /* psecuritypriv->dot118021XGrpKeyid,pmlmeinfo->key_index,rxdata_key_idx); */ -+ -+ if (psecuritypriv->binstallGrpkey == _FALSE) { -+ res = _FAIL; -+ RTW_INFO("\n recvframe_chkmic:didn't install group key!!!!!!!!!!\n"); -+ goto exit; -+ } -+ } else { -+ mickey = &stainfo->dot11tkiprxmickey.skey[0]; -+ } -+ -+ datalen = precvframe->u.hdr.len - prxattrib->hdrlen - prxattrib->iv_len - prxattrib->icv_len - 8; /* icv_len included the mic code */ -+ pframe = precvframe->u.hdr.rx_data; -+ payload = pframe + prxattrib->hdrlen + prxattrib->iv_len; -+ -+ -+ /* rtw_seccalctkipmic(&stainfo->dot11tkiprxmickey.skey[0],pframe,payload, datalen ,&miccode[0],(unsigned char)prxattrib->priority); */ /* care the length of the data */ -+ -+ rtw_seccalctkipmic(mickey, pframe, payload, datalen , &miccode[0], (unsigned char)prxattrib->priority); /* care the length of the data */ -+ -+ pframemic = payload + datalen; -+ -+ bmic_err = _FALSE; -+ -+ for (i = 0; i < 8; i++) { -+ if (miccode[i] != *(pframemic + i)) { -+ bmic_err = _TRUE; -+ } -+ } -+ -+ -+ if (bmic_err == _TRUE) { -+ -+ -+ -+ /* double check key_index for some timing issue , */ -+ /* cannot compare with psecuritypriv->dot118021XGrpKeyid also cause timing issue */ -+ if ((IS_MCAST(prxattrib->ra) == _TRUE) && (prxattrib->key_index != pmlmeinfo->key_index)) -+ brpt_micerror = _FALSE; -+ -+ if ((prxattrib->bdecrypted == _TRUE) && (brpt_micerror == _TRUE)) { -+ rtw_handle_tkip_mic_err(adapter, stainfo, (u8)IS_MCAST(prxattrib->ra)); -+ RTW_INFO(" mic error :prxattrib->bdecrypted=%d\n", prxattrib->bdecrypted); -+ } else { -+ RTW_INFO(" mic error :prxattrib->bdecrypted=%d\n", prxattrib->bdecrypted); -+ } -+ -+ res = _FAIL; -+ -+ } else { -+ /* mic checked ok */ -+ if ((psecuritypriv->bcheck_grpkey == _FALSE) && (IS_MCAST(prxattrib->ra) == _TRUE)) { -+ psecuritypriv->bcheck_grpkey = _TRUE; -+ } -+ } -+ -+ } -+ -+ recvframe_pull_tail(precvframe, 8); -+ -+ } -+ -+exit: -+ -+ -+ return res; -+ -+} -+ -+/*#define DBG_RX_SW_DECRYPTOR*/ -+ -+/* decrypt and set the ivlen,icvlen of the recv_frame */ -+union recv_frame *decryptor(_adapter *padapter, union recv_frame *precv_frame); -+union recv_frame *decryptor(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ -+ struct rx_pkt_attrib *prxattrib = &precv_frame->u.hdr.attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ union recv_frame *return_packet = precv_frame; -+ u32 res = _SUCCESS; -+ -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt); -+ -+ -+ if (prxattrib->encrypt > 0) { -+ u8 *iv = precv_frame->u.hdr.rx_data + prxattrib->hdrlen; -+ prxattrib->key_index = (((iv[3]) >> 6) & 0x3) ; -+ -+ if (prxattrib->key_index > WEP_KEYS) { -+ RTW_INFO("prxattrib->key_index(%d) > WEP_KEYS\n", prxattrib->key_index); -+ -+ switch (prxattrib->encrypt) { -+ case _WEP40_: -+ case _WEP104_: -+ prxattrib->key_index = psecuritypriv->dot11PrivacyKeyIndex; -+ break; -+ case _TKIP_: -+ case _AES_: -+ default: -+ prxattrib->key_index = psecuritypriv->dot118021XGrpKeyid; -+ break; -+ } -+ } -+ } -+ -+ if ((prxattrib->encrypt > 0) && ((prxattrib->bdecrypted == 0) || (psecuritypriv->sw_decrypt == _TRUE))) { -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (!IS_MCAST(prxattrib->ra)) /* bc/mc packets use sw decryption for concurrent mode */ -+#endif -+ psecuritypriv->hw_decrypted = _FALSE; -+ -+#ifdef DBG_RX_SW_DECRYPTOR -+ RTW_INFO(ADPT_FMT" - sec_type:%s DO SW decryption\n", -+ ADPT_ARG(padapter), security_type_str(prxattrib->encrypt)); -+#endif -+ -+#ifdef DBG_RX_DECRYPTOR -+ RTW_INFO("[%s] %d:prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n", -+ __FUNCTION__, -+ __LINE__, -+ prxattrib->bdecrypted, -+ prxattrib->encrypt, -+ psecuritypriv->hw_decrypted); -+#endif -+ -+ switch (prxattrib->encrypt) { -+ case _WEP40_: -+ case _WEP104_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_wep); -+ rtw_wep_decrypt(padapter, (u8 *)precv_frame); -+ break; -+ case _TKIP_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_tkip); -+ res = rtw_tkip_decrypt(padapter, (u8 *)precv_frame); -+ break; -+ case _AES_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_aes); -+ res = rtw_aes_decrypt(padapter, (u8 *)precv_frame); -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_wapi); -+ rtw_sms4_decrypt(padapter, (u8 *)precv_frame); -+ break; -+#endif -+ default: -+ break; -+ } -+ } else if (prxattrib->bdecrypted == 1 -+ && prxattrib->encrypt > 0 -+ && (psecuritypriv->busetkipkey == 1 || prxattrib->encrypt != _TKIP_) -+ ) { -+#if 0 -+ if ((prxstat->icv == 1) && (prxattrib->encrypt != _AES_)) { -+ psecuritypriv->hw_decrypted = _FALSE; -+ -+ -+ rtw_free_recvframe(precv_frame, &padapter->recvpriv.free_recv_queue); -+ -+ return_packet = NULL; -+ -+ } else -+#endif -+ { -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_hw); -+ -+ psecuritypriv->hw_decrypted = _TRUE; -+#ifdef DBG_RX_DECRYPTOR -+ RTW_INFO("[%s] %d:prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n", -+ __FUNCTION__, -+ __LINE__, -+ prxattrib->bdecrypted, -+ prxattrib->encrypt, -+ psecuritypriv->hw_decrypted); -+ -+#endif -+ } -+ } else { -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_unknown); -+#ifdef DBG_RX_DECRYPTOR -+ RTW_INFO("[%s] %d:prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n", -+ __FUNCTION__, -+ __LINE__, -+ prxattrib->bdecrypted, -+ prxattrib->encrypt, -+ psecuritypriv->hw_decrypted); -+#endif -+ } -+ -+ if (res == _FAIL) { -+ rtw_free_recvframe(return_packet, &padapter->recvpriv.free_recv_queue); -+ return_packet = NULL; -+ } else -+ prxattrib->bdecrypted = _TRUE; -+ /* recvframe_chkmic(adapter, precv_frame); */ /* move to recvframme_defrag function */ -+ -+ -+ return return_packet; -+ -+} -+/* ###set the security information in the recv_frame */ -+union recv_frame *portctrl(_adapter *adapter, union recv_frame *precv_frame); -+union recv_frame *portctrl(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ u8 *psta_addr = NULL; -+ u8 *ptr; -+ uint auth_alg; -+ struct recv_frame_hdr *pfhdr; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv ; -+ union recv_frame *prtnframe; -+ u16 ether_type = 0; -+ u16 eapol_type = 0x888e;/* for Funia BD's WPA issue */ -+ struct rx_pkt_attrib *pattrib; -+ -+ -+ pstapriv = &adapter->stapriv; -+ -+ auth_alg = adapter->securitypriv.dot11AuthAlgrthm; -+ -+ ptr = get_recvframe_data(precv_frame); -+ pfhdr = &precv_frame->u.hdr; -+ pattrib = &pfhdr->attrib; -+ psta_addr = pattrib->ta; -+ -+ prtnframe = NULL; -+ -+ psta = rtw_get_stainfo(pstapriv, psta_addr); -+ -+ -+ if (auth_alg == dot11AuthAlgrthm_8021X) { -+ if ((psta != NULL) && (psta->ieee8021x_blocked)) { -+ /* blocked */ -+ /* only accept EAPOL frame */ -+ -+ prtnframe = precv_frame; -+ -+ /* get ether_type */ -+ ptr = ptr + pfhdr->attrib.hdrlen + pfhdr->attrib.iv_len + LLC_HEADER_SIZE; -+ _rtw_memcpy(ðer_type, ptr, 2); -+ ether_type = ntohs((unsigned short)ether_type); -+ -+ if (ether_type == eapol_type) -+ prtnframe = precv_frame; -+ else { -+ /* free this frame */ -+ rtw_free_recvframe(precv_frame, &adapter->recvpriv.free_recv_queue); -+ prtnframe = NULL; -+ } -+ } else { -+ /* allowed */ -+ /* check decryption status, and decrypt the frame if needed */ -+ -+ -+ prtnframe = precv_frame; -+ /* check is the EAPOL frame or not (Rekey) */ -+ /* if(ether_type == eapol_type){ */ -+ /* check Rekey */ -+ -+ /* prtnframe=precv_frame; */ -+ /* } */ -+ } -+ } else -+ prtnframe = precv_frame; -+ -+ -+ return prtnframe; -+ -+} -+ -+sint recv_decache(union recv_frame *precv_frame, u8 bretry, struct stainfo_rxcache *prxcache); -+sint recv_decache(union recv_frame *precv_frame, u8 bretry, struct stainfo_rxcache *prxcache) -+{ -+ sint tid = precv_frame->u.hdr.attrib.priority; -+ -+ u16 seq_ctrl = ((precv_frame->u.hdr.attrib.seq_num & 0xffff) << 4) | -+ (precv_frame->u.hdr.attrib.frag_num & 0xf); -+ -+ -+ if (tid > 15) { -+ -+ return _FAIL; -+ } -+ -+ if (1) { /* if(bretry) */ -+ if (seq_ctrl == prxcache->tid_rxseq[tid]) { -+ -+ return _FAIL; -+ } -+ } -+ -+ prxcache->tid_rxseq[tid] = seq_ctrl; -+ -+ -+ return _SUCCESS; -+ -+} -+ -+#define PN_LESS_CHK(a, b) (((a-b) & 0x800000000000) != 0) -+#define PN_EQUAL_CHK(a, b) (a == b) -+sint recv_ucast_pn_decache(union recv_frame *precv_frame, struct stainfo_rxcache *prxcache); -+sint recv_ucast_pn_decache(union recv_frame *precv_frame, struct stainfo_rxcache *prxcache) -+{ -+ _adapter *padapter = precv_frame->u.hdr.adapter; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ u8 *pdata = precv_frame->u.hdr.rx_data; -+ u32 data_len = precv_frame->u.hdr.len; -+ sint tid = precv_frame->u.hdr.attrib.priority; -+ u64 tmp_iv_hdr = 0; -+ u64 curr_pn = 0, pkt_pn = 0; -+ -+ if (tid > 15) -+ return _FAIL; -+ -+ if (pattrib->encrypt == _AES_) { -+ _rtw_memcpy(&tmp_iv_hdr, (pdata + pattrib->hdrlen), 8); -+ tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); -+ pkt_pn = (tmp_iv_hdr & 0x000000000000ffff) | -+ ((tmp_iv_hdr & 0xffffffff00000000) >> 16); -+ -+ _rtw_memcpy(&tmp_iv_hdr, prxcache->iv[tid], 8); -+ tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); -+ curr_pn = (tmp_iv_hdr & 0x000000000000ffff) | -+ ((tmp_iv_hdr & 0xffffffff00000000) >> 16); -+ -+ if (curr_pn == 0) { -+ _rtw_memcpy(prxcache->iv[tid], (pdata + pattrib->hdrlen), sizeof(prxcache->iv[tid])); -+ goto exit; -+ } -+ -+ if (PN_LESS_CHK(pkt_pn, curr_pn) || PN_EQUAL_CHK(pkt_pn, curr_pn)) { -+ /* return _FAIL; */ -+ } else -+ _rtw_memcpy(prxcache->iv[tid], (pdata + pattrib->hdrlen), sizeof(prxcache->iv[tid])); -+ } -+ -+exit: -+ return _SUCCESS; -+} -+ -+sint recv_bcast_pn_decache(union recv_frame *precv_frame); -+sint recv_bcast_pn_decache(union recv_frame *precv_frame) -+{ -+ _adapter *padapter = precv_frame->u.hdr.adapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ u8 *pdata = precv_frame->u.hdr.rx_data; -+ u32 data_len = precv_frame->u.hdr.len; -+ u64 tmp_iv_hdr = 0; -+ u64 curr_pn = 0, pkt_pn = 0; -+ u8 key_id; -+ -+ if ((pattrib->encrypt == _AES_) && -+ (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)) { -+ _rtw_memcpy(&tmp_iv_hdr, (pdata + pattrib->hdrlen), 8); -+ tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); -+ key_id = ((tmp_iv_hdr & 0x00000000c0000000) >> 30); -+ pkt_pn = (tmp_iv_hdr & 0x000000000000ffff) | -+ ((tmp_iv_hdr & 0xffffffff00000000) >> 16); -+ -+ if (key_id >= 4 ) -+ return _FAIL; -+ -+ _rtw_memcpy(&tmp_iv_hdr, psecuritypriv->iv_seq[key_id], 8); -+ tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); -+ curr_pn = (tmp_iv_hdr & 0x000000000000ffff) | -+ ((tmp_iv_hdr & 0xffffffff00000000) >> 16); -+ -+ if (PN_LESS_CHK(pkt_pn, curr_pn) || PN_EQUAL_CHK(pkt_pn, curr_pn)) { -+ return _FAIL; -+ } else -+ _rtw_memcpy(psecuritypriv->iv_seq[key_id], (pdata + pattrib->hdrlen), sizeof(psecuritypriv->iv_seq[key_id])); -+ } -+ -+ return _SUCCESS; -+} -+ -+void process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame); -+void process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_AP_MODE -+ unsigned char pwrbit; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ -+ psta = rtw_get_stainfo(pstapriv, pattrib->src); -+ -+ pwrbit = GetPwrMgt(ptr); -+ -+ if (psta) { -+ if (pwrbit) { -+ if (!(psta->state & WIFI_SLEEP_STATE)) { -+ /* psta->state |= WIFI_SLEEP_STATE; */ -+ /* pstapriv->sta_dz_bitmap |= BIT(psta->aid); */ -+ -+ stop_sta_xmit(padapter, psta); -+ -+ /* RTW_INFO("to sleep, sta_dz_bitmap=%x\n", pstapriv->sta_dz_bitmap); */ -+ } -+ } else { -+ if (psta->state & WIFI_SLEEP_STATE) { -+ /* psta->state ^= WIFI_SLEEP_STATE; */ -+ /* pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); */ -+ -+ wakeup_sta_to_xmit(padapter, psta); -+ -+ /* RTW_INFO("to wakeup, sta_dz_bitmap=%x\n", pstapriv->sta_dz_bitmap); */ -+ } -+ } -+ -+ } -+ -+#endif -+} -+ -+void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame); -+void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_AP_MODE -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ -+ psta = rtw_get_stainfo(pstapriv, pattrib->src); -+ -+ if (!psta) -+ return; -+ -+#ifdef CONFIG_TDLS -+ if (!(psta->tdls_sta_state & TDLS_LINKED_STATE)) { -+#endif /* CONFIG_TDLS */ -+ -+ if (!psta->qos_option) -+ return; -+ -+ if (!(psta->qos_info & 0xf)) -+ return; -+ -+#ifdef CONFIG_TDLS -+ } -+#endif /* CONFIG_TDLS */ -+ -+ if (psta->state & WIFI_SLEEP_STATE) { -+ u8 wmmps_ac = 0; -+ -+ switch (pattrib->priority) { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk & BIT(1); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi & BIT(1); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo & BIT(1); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be & BIT(1); -+ break; -+ } -+ -+ if (wmmps_ac) { -+ if (psta->sleepq_ac_len > 0) { -+ /* process received triggered frame */ -+ xmit_delivery_enabled_frames(padapter, psta); -+ } else { -+ /* issue one qos null frame with More data bit = 0 and the EOSP bit set (=1) */ -+ issue_qos_nulldata(padapter, psta->hwaddr, (u16)pattrib->priority, 0, 0); -+ } -+ } -+ -+ } -+ -+ -+#endif -+ -+} -+ -+#ifdef CONFIG_TDLS -+sint OnTDLS(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ sint ret = _SUCCESS; -+ u8 *paction = get_recvframe_data(precv_frame); -+ u8 category_field = 1; -+#ifdef CONFIG_WFD -+ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a }; -+#endif /* CONFIG_WFD */ -+ struct tdls_info *ptdlsinfo = &(adapter->tdlsinfo); -+ -+ /* point to action field */ -+ paction += pattrib->hdrlen -+ + pattrib->iv_len -+ + SNAP_SIZE -+ + ETH_TYPE_LEN -+ + PAYLOAD_TYPE_LEN -+ + category_field; -+ -+ RTW_INFO("[TDLS] Recv %s from "MAC_FMT" with SeqNum = %d\n", rtw_tdls_action_txt(*paction), MAC_ARG(pattrib->src), GetSequence(get_recvframe_data(precv_frame))); -+ -+ if (hal_chk_wl_func(adapter, WL_FUNC_TDLS) == _FALSE) { -+ RTW_INFO("Ignore tdls frame since hal doesn't support tdls\n"); -+ ret = _FAIL; -+ return ret; -+ } -+ -+ if (ptdlsinfo->tdls_enable == _FALSE) { -+ RTW_INFO("recv tdls frame, " -+ "but tdls haven't enabled\n"); -+ ret = _FAIL; -+ return ret; -+ } -+ -+ switch (*paction) { -+ case TDLS_SETUP_REQUEST: -+ ret = On_TDLS_Setup_Req(adapter, precv_frame); -+ break; -+ case TDLS_SETUP_RESPONSE: -+ ret = On_TDLS_Setup_Rsp(adapter, precv_frame); -+ break; -+ case TDLS_SETUP_CONFIRM: -+ ret = On_TDLS_Setup_Cfm(adapter, precv_frame); -+ break; -+ case TDLS_TEARDOWN: -+ ret = On_TDLS_Teardown(adapter, precv_frame); -+ break; -+ case TDLS_DISCOVERY_REQUEST: -+ ret = On_TDLS_Dis_Req(adapter, precv_frame); -+ break; -+ case TDLS_PEER_TRAFFIC_INDICATION: -+ ret = On_TDLS_Peer_Traffic_Indication(adapter, precv_frame); -+ break; -+ case TDLS_PEER_TRAFFIC_RESPONSE: -+ ret = On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame); -+ break; -+#ifdef CONFIG_TDLS_CH_SW -+ case TDLS_CHANNEL_SWITCH_REQUEST: -+ ret = On_TDLS_Ch_Switch_Req(adapter, precv_frame); -+ break; -+ case TDLS_CHANNEL_SWITCH_RESPONSE: -+ ret = On_TDLS_Ch_Switch_Rsp(adapter, precv_frame); -+ break; -+#endif -+#ifdef CONFIG_WFD -+ /* First byte of WFA OUI */ -+ case 0x50: -+ if (_rtw_memcmp(WFA_OUI, paction, 3)) { -+ /* Probe request frame */ -+ if (*(paction + 3) == 0x04) { -+ /* WFDTDLS: for sigma test, do not setup direct link automatically */ -+ ptdlsinfo->dev_discovered = _TRUE; -+ RTW_INFO("recv tunneled probe request frame\n"); -+ issue_tunneled_probe_rsp(adapter, precv_frame); -+ } -+ /* Probe response frame */ -+ if (*(paction + 3) == 0x05) { -+ /* WFDTDLS: for sigma test, do not setup direct link automatically */ -+ ptdlsinfo->dev_discovered = _TRUE; -+ RTW_INFO("recv tunneled probe response frame\n"); -+ } -+ } -+ break; -+#endif /* CONFIG_WFD */ -+ default: -+ RTW_INFO("receive TDLS frame %d but not support\n", *paction); -+ ret = _FAIL; -+ break; -+ } -+ -+exit: -+ return ret; -+ -+} -+#endif /* CONFIG_TDLS */ -+ -+void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_info *sta); -+void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_info *sta) -+{ -+ int sz; -+ struct sta_info *psta = NULL; -+ struct stainfo_stats *pstats = NULL; -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ sz = get_recvframe_len(prframe); -+ precvpriv->rx_bytes += sz; -+ -+ padapter->mlmepriv.LinkDetectInfo.NumRxOkInPeriod++; -+ -+ if ((!MacAddr_isBcst(pattrib->dst)) && (!IS_MCAST(pattrib->dst))) -+ padapter->mlmepriv.LinkDetectInfo.NumRxUnicastOkInPeriod++; -+ -+ if (sta) -+ psta = sta; -+ else -+ psta = prframe->u.hdr.psta; -+ -+ if (psta) { -+ pstats = &psta->sta_stats; -+ -+ pstats->rx_data_pkts++; -+ pstats->rx_bytes += sz; -+ -+ /*record rx packets for every tid*/ -+ pstats->rx_data_qos_pkts[pattrib->priority]++; -+ -+#ifdef CONFIG_TDLS -+ if (psta->tdls_sta_state & TDLS_LINKED_STATE) { -+ struct sta_info *pap_sta = NULL; -+ pap_sta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); -+ if (pap_sta) { -+ pstats = &pap_sta->sta_stats; -+ pstats->rx_data_pkts++; -+ pstats->rx_bytes += sz; -+ } -+ } -+#endif /* CONFIG_TDLS */ -+ } -+ -+#ifdef CONFIG_CHECK_LEAVE_LPS -+ traffic_check_for_leave_lps(padapter, _FALSE, 0); -+#endif /* CONFIG_LPS */ -+ -+} -+ -+sint sta2sta_data_frame( -+ _adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info **psta -+); -+sint sta2sta_data_frame( -+ _adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info **psta -+) -+{ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ sint ret = _SUCCESS; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u8 *mybssid = get_bssid(pmlmepriv); -+ u8 *myhwaddr = adapter_mac_addr(adapter); -+ u8 *sta_addr = NULL; -+ sint bmcast = IS_MCAST(pattrib->dst); -+ -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; -+#ifdef CONFIG_TDLS_CH_SW -+ struct tdls_ch_switch *pchsw_info = &ptdlsinfo->chsw_info; -+#endif -+ struct sta_info *ptdls_sta = NULL; -+ u8 *psnap_type = ptr + pattrib->hdrlen + pattrib->iv_len + SNAP_SIZE; -+ /* frame body located after [+2]: ether-type, [+1]: payload type */ -+ u8 *pframe_body = psnap_type + 2 + 1; -+#endif -+ -+ -+ /* RTW_INFO("[%s] %d, seqnum:%d\n", __FUNCTION__, __LINE__, pattrib->seq_num); */ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { -+ -+ /* filter packets that SA is myself or multicast or broadcast */ -+ if (_rtw_memcmp(myhwaddr, pattrib->src, ETH_ALEN)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if ((!_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN)) && (!bmcast)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if (_rtw_memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ _rtw_memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN))) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ sta_addr = pattrib->src; -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { -+#ifdef CONFIG_TDLS -+ -+ /* direct link data transfer */ -+ if (ptdlsinfo->link_established == _TRUE) { -+ ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->src); -+ if (ptdls_sta == NULL) { -+ ret = _FAIL; -+ goto exit; -+ } else if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { -+ /* filter packets that SA is myself or multicast or broadcast */ -+ if (_rtw_memcmp(myhwaddr, pattrib->src, ETH_ALEN)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ /* da should be for me */ -+ if ((!_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN)) && (!bmcast)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ /* check BSSID */ -+ if (_rtw_memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ _rtw_memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN))) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+#ifdef CONFIG_TDLS_CH_SW -+ if (ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) { -+ if (adapter->mlmeextpriv.cur_channel != rtw_get_oper_ch(adapter)) { -+ pchsw_info->ch_sw_state |= TDLS_PEER_AT_OFF_STATE; -+ if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) -+ _cancel_timer_ex(&ptdls_sta->ch_sw_timer); -+ /* On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame); */ -+ } -+ } -+#endif -+ -+ /* process UAPSD tdls sta */ -+ process_pwrbit_data(adapter, precv_frame); -+ -+ /* if NULL-frame, check pwrbit */ -+ if ((GetFrameSubType(ptr) & WIFI_DATA_NULL) == WIFI_DATA_NULL) { -+ /* NULL-frame with pwrbit=1, buffer_STA should buffer frames for sleep_STA */ -+ if (GetPwrMgt(ptr)) { -+ /* it would be triggered when we are off channel and receiving NULL DATA */ -+ /* we can confirm that peer STA is at off channel */ -+ RTW_INFO("TDLS: recv peer null frame with pwr bit 1\n"); -+ /* ptdls_sta->tdls_sta_state|=TDLS_PEER_SLEEP_STATE; */ -+ } -+ -+ /* TODO: Updated BSSID's seq. */ -+ /* RTW_INFO("drop Null Data\n"); */ -+ ptdls_sta->tdls_sta_state &= ~(TDLS_WAIT_PTR_STATE); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* receive some of all TDLS management frames, process it at ON_TDLS */ -+ if (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_TDLS, 2)) { -+ ret = OnTDLS(adapter, precv_frame); -+ goto exit; -+ } -+ -+ if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) -+ process_wmmps_data(adapter, precv_frame); -+ -+ ptdls_sta->tdls_sta_state &= ~(TDLS_WAIT_PTR_STATE); -+ -+ } -+ -+ sta_addr = pattrib->src; -+ -+ } else -+#endif /* CONFIG_TDLS */ -+ { -+ /* For Station mode, sa and bssid should always be BSSID, and DA is my mac-address */ -+ if (!_rtw_memcmp(pattrib->bssid, pattrib->src, ETH_ALEN)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ sta_addr = pattrib->bssid; -+ } -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ if (bmcast) { -+ /* For AP mode, if DA == MCAST, then BSSID should be also MCAST */ -+ if (!IS_MCAST(pattrib->bssid)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ } else { /* not mc-frame */ -+ /* For AP mode, if DA is non-MCAST, then it must be BSSID, and bssid == BSSID */ -+ if (!_rtw_memcmp(pattrib->bssid, pattrib->dst, ETH_ALEN)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ sta_addr = pattrib->src; -+ } -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) { -+ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ sta_addr = mybssid; -+ } else -+ ret = _FAIL; -+ -+ -+ -+ if (bmcast) -+ *psta = rtw_get_bcmc_stainfo(adapter); -+ else -+ *psta = rtw_get_stainfo(pstapriv, sta_addr); /* get ap_info */ -+ -+#ifdef CONFIG_TDLS -+ if (ptdls_sta != NULL) -+ *psta = ptdls_sta; -+#endif /* CONFIG_TDLS */ -+ -+ if (*psta == NULL) { -+#ifdef CONFIG_MP_INCLUDED -+ if (adapter->registrypriv.mp_mode == 1) { -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) -+ adapter->mppriv.rx_pktloss++; -+ } -+#endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+exit: -+ return ret; -+ -+} -+ -+sint ap2sta_data_frame( -+ _adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info **psta); -+sint ap2sta_data_frame( -+ _adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info **psta) -+{ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ sint ret = _SUCCESS; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u8 *mybssid = get_bssid(pmlmepriv); -+ u8 *myhwaddr = adapter_mac_addr(adapter); -+ sint bmcast = IS_MCAST(pattrib->dst); -+ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE -+ || check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) -+ ) { -+ -+ /* filter packets that SA is myself or multicast or broadcast */ -+ if (_rtw_memcmp(myhwaddr, pattrib->src, ETH_ALEN)) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s SA="MAC_FMT", myhwaddr="MAC_FMT"\n", -+ __FUNCTION__, MAC_ARG(pattrib->src), MAC_ARG(myhwaddr)); -+#endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* da should be for me */ -+ if ((!_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN)) && (!bmcast)) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s DA="MAC_FMT"\n", __func__, MAC_ARG(pattrib->dst)); -+#endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ -+ /* check BSSID */ -+ if (_rtw_memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ _rtw_memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN))) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s BSSID="MAC_FMT", mybssid="MAC_FMT"\n", -+ __func__, MAC_ARG(pattrib->bssid), MAC_ARG(mybssid)); -+#endif -+ -+ if (!bmcast) { -+ RTW_INFO(ADPT_FMT" -issue_deauth to the nonassociated ap=" MAC_FMT " for the reason(7)\n", ADPT_ARG(adapter), MAC_ARG(pattrib->bssid)); -+ issue_deauth(adapter, pattrib->bssid, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ } -+ -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if (bmcast) -+ *psta = rtw_get_bcmc_stainfo(adapter); -+ else -+ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get ap_info */ -+ -+ if (*psta == NULL) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s can't get psta under STATION_MODE ; drop pkt\n", __FUNCTION__); -+#endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) { -+ } -+ -+ if (GetFrameSubType(ptr) & BIT(6)) { -+ /* No data, will not indicate to upper layer, temporily count it here */ -+ count_rx_stats(adapter, precv_frame, *psta); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+ } else if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) && -+ (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { -+ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ -+ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get sta_info */ -+ if (*psta == NULL) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s can't get psta under WIFI_MP_STATE ; drop pkt\n", __FUNCTION__); -+#endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ /* Special case */ -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } else { -+ if (_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN) && (!bmcast)) { -+ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get sta_info */ -+ if (*psta == NULL) { -+ -+ /* for AP multicast issue , modify by yiwei */ -+ static u32 send_issue_deauth_time = 0; -+ -+ /* RTW_INFO("After send deauth , %u ms has elapsed.\n", rtw_get_passing_time_ms(send_issue_deauth_time)); */ -+ -+ if (rtw_get_passing_time_ms(send_issue_deauth_time) > 10000 || send_issue_deauth_time == 0) { -+ send_issue_deauth_time = rtw_get_current_time(); -+ -+ RTW_INFO("issue_deauth to the ap=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->bssid)); -+ -+ issue_deauth(adapter, pattrib->bssid, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ } -+ } -+ } -+ -+ ret = _FAIL; -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s fw_state:0x%x\n", __FUNCTION__, get_fwstate(pmlmepriv)); -+#endif -+ } -+ -+exit: -+ -+ -+ return ret; -+ -+} -+ -+sint sta2ap_data_frame( -+ _adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info **psta); -+sint sta2ap_data_frame( -+ _adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info **psta) -+{ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ unsigned char *mybssid = get_bssid(pmlmepriv); -+ sint ret = _SUCCESS; -+ -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ /* For AP mode, RA=BSSID, TX=STA(SRC_ADDR), A3=DST_ADDR */ -+ if (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ *psta = rtw_get_stainfo(pstapriv, pattrib->src); -+ if (*psta == NULL) { -+ #ifdef CONFIG_DFS_MASTER -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ /* prevent RX tasklet blocks cmd_thread */ -+ if (rfctl->radar_detected == 1) -+ goto bypass_deauth7; -+ #endif -+ -+ RTW_INFO("issue_deauth to sta=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->src)); -+ -+ issue_deauth(adapter, pattrib->src, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ -+#ifdef CONFIG_DFS_MASTER -+bypass_deauth7: -+#endif -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+ process_pwrbit_data(adapter, precv_frame); -+ -+ if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) -+ process_wmmps_data(adapter, precv_frame); -+ -+ if (GetFrameSubType(ptr) & BIT(6)) { -+ /* No data, will not indicate to upper layer, temporily count it here */ -+ count_rx_stats(adapter, precv_frame, *psta); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ } else if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) && -+ (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { -+ /* RTW_INFO("%s ,in WIFI_MP_STATE\n",__func__); */ -+ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ -+ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get sta_info */ -+ if (*psta == NULL) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s can't get psta under WIFI_MP_STATE ; drop pkt\n", __FUNCTION__); -+#endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ } else { -+ u8 *myhwaddr = adapter_mac_addr(adapter); -+ if (!_rtw_memcmp(pattrib->ra, myhwaddr, ETH_ALEN)) { -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ RTW_INFO("issue_deauth to sta=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->src)); -+ issue_deauth(adapter, pattrib->src, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+exit: -+ -+ -+ return ret; -+ -+} -+ -+sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame); -+sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct sta_info *psta = NULL; -+ /* uint len = precv_frame->u.hdr.len; */ -+ -+ /* RTW_INFO("+validate_recv_ctrl_frame\n"); */ -+ -+ if (GetFrameType(pframe) != WIFI_CTRL_TYPE) -+ return _FAIL; -+ -+ /* receive the frames that ra(a1) is my address */ -+ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_mac_addr(padapter), ETH_ALEN)) -+ return _FAIL; -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (psta == NULL) -+ return _FAIL; -+ -+ /* for rx pkt statistics */ -+ psta->sta_stats.rx_ctrl_pkts++; -+ -+ /* only handle ps-poll */ -+ if (GetFrameSubType(pframe) == WIFI_PSPOLL) { -+#ifdef CONFIG_AP_MODE -+ u16 aid; -+ u8 wmmps_ac = 0; -+ -+ aid = GetAid(pframe); -+ if (psta->aid != aid) -+ return _FAIL; -+ -+ switch (pattrib->priority) { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk & BIT(0); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi & BIT(0); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo & BIT(0); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be & BIT(0); -+ break; -+ } -+ -+ if (wmmps_ac) -+ return _FAIL; -+ -+ if (psta->state & WIFI_STA_ALIVE_CHK_STATE) { -+ RTW_INFO("%s alive check-rx ps-poll\n", __func__); -+ psta->expire_to = pstapriv->expire_to; -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ } -+ -+ if ((psta->state & WIFI_SLEEP_STATE) && (pstapriv->sta_dz_bitmap & BIT(psta->aid))) { -+ _irqL irqL; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&psta->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ if ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ psta->sleepq_len--; -+ -+ if (psta->sleepq_len > 0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ pxmitframe->attrib.triggered = 1; -+ -+ /* RTW_INFO("handling ps-poll, q_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ -+ -+#if 0 -+ _exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ if (rtw_hal_xmit(padapter, pxmitframe) == _TRUE) -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ _enter_critical_bh(&psta->sleep_q.lock, &irqL); -+#endif -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ if (psta->sleepq_len == 0) { -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ /* RTW_INFO("after handling ps-poll, tim=%x\n", pstapriv->tim_bitmap); */ -+ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); -+ } -+ -+ /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ } else { -+ /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ /* RTW_INFO("no buffered packets to xmit\n"); */ -+ if (pstapriv->tim_bitmap & BIT(psta->aid)) { -+ if (psta->sleepq_len == 0) { -+ RTW_INFO("no buffered packets to xmit\n"); -+ -+ /* issue nulldata with More data bit = 0 to indicate we have no buffered packets */ -+ issue_nulldata_in_interrupt(padapter, psta->hwaddr, 0); -+ } else { -+ RTW_INFO("error!psta->sleepq_len=%d\n", psta->sleepq_len); -+ psta->sleepq_len = 0; -+ } -+ -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); -+ } -+ } -+ } -+#endif /* CONFIG_AP_MODE */ -+ } else if (GetFrameSubType(pframe) == WIFI_NDPA) { -+#ifdef CONFIG_BEAMFORMING -+ beamforming_get_ndpa_frame(padapter, precv_frame); -+#endif/*CONFIG_BEAMFORMING*/ -+ } -+ -+ return _FAIL; -+ -+} -+ -+union recv_frame *recvframe_chk_defrag(PADAPTER padapter, union recv_frame *precv_frame); -+sint validate_recv_mgnt_frame(PADAPTER padapter, union recv_frame *precv_frame); -+sint validate_recv_mgnt_frame(PADAPTER padapter, union recv_frame *precv_frame) -+{ -+ /* struct mlme_priv *pmlmepriv = &adapter->mlmepriv; */ -+ -+ -+#if 0 -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+#ifdef CONFIG_NATIVEAP_MLME -+ mgt_dispatcher(padapter, precv_frame); -+#else -+ rtw_hostapd_mlme_rx(padapter, precv_frame); -+#endif -+ } else -+ mgt_dispatcher(padapter, precv_frame); -+#endif -+ -+ precv_frame = recvframe_chk_defrag(padapter, precv_frame); -+ if (precv_frame == NULL) { -+ return _SUCCESS; -+ } -+ -+ { -+ /* for rx pkt statistics */ -+ struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, GetAddr2Ptr(precv_frame->u.hdr.rx_data)); -+ if (psta) { -+ psta->sta_stats.rx_mgnt_pkts++; -+ if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_BEACON) -+ psta->sta_stats.rx_beacon_pkts++; -+ else if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_PROBEREQ) -+ psta->sta_stats.rx_probereq_pkts++; -+ else if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_PROBERSP) { -+ if (_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(precv_frame->u.hdr.rx_data), ETH_ALEN) == _TRUE) -+ psta->sta_stats.rx_probersp_pkts++; -+ else if (is_broadcast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data)) -+ || is_multicast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data))) -+ psta->sta_stats.rx_probersp_bm_pkts++; -+ else -+ psta->sta_stats.rx_probersp_uo_pkts++; -+ } -+ } -+ } -+ -+#ifdef CONFIG_INTEL_PROXIM -+ if (padapter->proximity.proxim_on == _TRUE) { -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct recv_stat *prxstat = (struct recv_stat *) precv_frame->u.hdr.rx_head ; -+ u8 *pda, *psa, *pbssid, *ptr; -+ ptr = precv_frame->u.hdr.rx_data; -+ pda = get_da(ptr); -+ psa = get_sa(ptr); -+ pbssid = get_hdr_bssid(ptr); -+ -+ -+ _rtw_memcpy(pattrib->dst, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, psa, ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->bssid, pbssid, ETH_ALEN); -+ -+ switch (pattrib->to_fr_ds) { -+ case 0: -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ break; -+ -+ case 1: -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pbssid, ETH_ALEN); -+ break; -+ -+ case 2: -+ _rtw_memcpy(pattrib->ra, pbssid, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ break; -+ -+ case 3: -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); -+ break; -+ -+ default: -+ break; -+ -+ } -+ pattrib->priority = 0; -+ pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 30 : 24; -+ -+ padapter->proximity.proxim_rx(padapter, precv_frame); -+ } -+#endif -+ mgt_dispatcher(padapter, precv_frame); -+ -+ return _SUCCESS; -+ -+} -+ -+sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame); -+sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ u8 bretry; -+ u8 *psa, *pda, *pbssid; -+ struct sta_info *psta = NULL; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ sint ret = _SUCCESS; -+ -+ -+ bretry = GetRetry(ptr); -+ pda = get_da(ptr); -+ psa = get_sa(ptr); -+ pbssid = get_hdr_bssid(ptr); -+ -+ if (pbssid == NULL) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s pbssid == NULL\n", __func__); -+#endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memcpy(pattrib->dst, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, psa, ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->bssid, pbssid, ETH_ALEN); -+ -+ switch (pattrib->to_fr_ds) { -+ case 0: -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ ret = sta2sta_data_frame(adapter, precv_frame, &psta); -+ break; -+ -+ case 1: -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pbssid, ETH_ALEN); -+ ret = ap2sta_data_frame(adapter, precv_frame, &psta); -+ break; -+ -+ case 2: -+ _rtw_memcpy(pattrib->ra, pbssid, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ ret = sta2ap_data_frame(adapter, precv_frame, &psta); -+ break; -+ -+ case 3: -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); -+ ret = _FAIL; -+ break; -+ -+ default: -+ ret = _FAIL; -+ break; -+ -+ } -+ -+ if (ret == _FAIL) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s case:%d, res:%d\n", __FUNCTION__, pattrib->to_fr_ds, ret); -+#endif -+ goto exit; -+ } else if (ret == RTW_RX_HANDLED) -+ goto exit; -+ -+ -+ if (psta == NULL) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s psta == NULL\n", __func__); -+#endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* psta->rssi = prxcmd->rssi; */ -+ /* psta->signal_quality= prxcmd->sq; */ -+ precv_frame->u.hdr.psta = psta; -+ -+ -+ pattrib->amsdu = 0; -+ pattrib->ack_policy = 0; -+ /* parsing QC field */ -+ if (pattrib->qos == 1) { -+ pattrib->priority = GetPriority((ptr + 24)); -+ pattrib->ack_policy = GetAckpolicy((ptr + 24)); -+ pattrib->amsdu = GetAMsdu((ptr + 24)); -+ pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 32 : 26; -+ -+ if (pattrib->priority != 0 && pattrib->priority != 3) -+ adapter->recvpriv.bIsAnyNonBEPkts = _TRUE; -+ else -+ adapter->recvpriv.bIsAnyNonBEPkts = _FALSE; -+ } else { -+ pattrib->priority = 0; -+ pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 30 : 24; -+ } -+ -+ -+ if (pattrib->order) /* HT-CTRL 11n */ -+ pattrib->hdrlen += 4; -+ -+ precv_frame->u.hdr.preorder_ctrl = &psta->recvreorder_ctrl[pattrib->priority]; -+ -+ /* decache, drop duplicate recv packets */ -+ if (recv_decache(precv_frame, bretry, &psta->sta_recvpriv.rxcache) == _FAIL) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s recv_decache return _FAIL\n", __func__); -+#endif -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if (!IS_MCAST(pattrib->ra)) { -+ if (recv_ucast_pn_decache(precv_frame, &psta->sta_recvpriv.rxcache) == _FAIL) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s recv_decache return _FAIL\n", __func__); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ } else { -+ if (recv_bcast_pn_decache(precv_frame) == _FAIL) { -+ #ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" recv_bcast_pn_decache _FAIL for invalid PN!\n" -+ , FUNC_ADPT_ARG(adapter)); -+ #endif -+ ret = _FAIL; -+ goto exit; -+ } -+ } -+ -+ if (pattrib->privacy) { -+ -+ -+#ifdef CONFIG_TDLS -+ if ((psta->tdls_sta_state & TDLS_LINKED_STATE) && (psta->dot118021XPrivacy == _AES_)) -+ pattrib->encrypt = psta->dot118021XPrivacy; -+ else -+#endif /* CONFIG_TDLS */ -+ GET_ENCRY_ALGO(psecuritypriv, psta, pattrib->encrypt, IS_MCAST(pattrib->ra)); -+ -+ -+ SET_ICE_IV_LEN(pattrib->iv_len, pattrib->icv_len, pattrib->encrypt); -+ } else { -+ pattrib->encrypt = 0; -+ pattrib->iv_len = pattrib->icv_len = 0; -+ } -+ -+exit: -+ -+ -+ return ret; -+} -+ -+#ifdef CONFIG_IEEE80211W -+static sint validate_80211w_mgmt(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ u8 type; -+ u8 subtype; -+ -+ type = GetFrameType(ptr); -+ subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ -+ -+ if (adapter->securitypriv.binstallBIPkey == _TRUE) { -+ /* unicast management frame decrypt */ -+ if (pattrib->privacy && !(IS_MCAST(GetAddr1Ptr(ptr))) && -+ (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || subtype == WIFI_ACTION)) { -+ u8 *ppp, *mgmt_DATA; -+ u32 data_len = 0; -+ ppp = GetAddr2Ptr(ptr); -+ -+ pattrib->bdecrypted = 0; -+ pattrib->encrypt = _AES_; -+ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ /* set iv and icv length */ -+ SET_ICE_IV_LEN(pattrib->iv_len, pattrib->icv_len, pattrib->encrypt); -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); -+ /* actual management data frame body */ -+ data_len = pattrib->pkt_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; -+ mgmt_DATA = rtw_zmalloc(data_len); -+ if (mgmt_DATA == NULL) { -+ RTW_INFO("%s mgmt allocate fail !!!!!!!!!\n", __FUNCTION__); -+ goto validate_80211w_fail; -+ } -+#if 0 -+ /* dump the packet content before decrypt */ -+ { -+ int pp; -+ printk("pattrib->pktlen = %d =>", pattrib->pkt_len); -+ for (pp = 0; pp < pattrib->pkt_len; pp++) -+ printk(" %02x ", ptr[pp]); -+ printk("\n"); -+ } -+#endif -+ -+ precv_frame = decryptor(adapter, precv_frame); -+ /* save actual management data frame body */ -+ _rtw_memcpy(mgmt_DATA, ptr + pattrib->hdrlen + pattrib->iv_len, data_len); -+ /* overwrite the iv field */ -+ _rtw_memcpy(ptr + pattrib->hdrlen, mgmt_DATA, data_len); -+ /* remove the iv and icv length */ -+ pattrib->pkt_len = pattrib->pkt_len - pattrib->iv_len - pattrib->icv_len; -+ rtw_mfree(mgmt_DATA, data_len); -+#if 0 -+ /* print packet content after decryption */ -+ { -+ int pp; -+ printk("after decryption pattrib->pktlen = %d @@=>", pattrib->pkt_len); -+ for (pp = 0; pp < pattrib->pkt_len; pp++) -+ printk(" %02x ", ptr[pp]); -+ printk("\n"); -+ } -+#endif -+ if (!precv_frame) { -+ RTW_INFO("%s mgmt descrypt fail !!!!!!!!!\n", __FUNCTION__); -+ goto validate_80211w_fail; -+ } -+ } else if (IS_MCAST(GetAddr1Ptr(ptr)) && -+ (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC)) { -+ sint BIP_ret = _SUCCESS; -+ /* verify BIP MME IE of broadcast/multicast de-auth/disassoc packet */ -+ BIP_ret = rtw_BIP_verify(adapter, (u8 *)precv_frame); -+ if (BIP_ret == _FAIL) { -+ /* RTW_INFO("802.11w BIP verify fail\n"); */ -+ goto validate_80211w_fail; -+ } else if (BIP_ret == RTW_RX_HANDLED) { -+ RTW_INFO("802.11w recv none protected packet\n"); -+ /* drop pkt, don't issue sa query request */ -+ /* issue_action_SA_Query(adapter, NULL, 0, 0, 0); */ -+ goto validate_80211w_fail; -+ } -+ } /* 802.11w protect */ -+ else { -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(ptr)); -+ -+ if (subtype == WIFI_ACTION && psta && psta->bpairwise_key_installed == _TRUE) { -+ /* according 802.11-2012 standard, these five types are not robust types */ -+ if (ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_PUBLIC && -+ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_HT && -+ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_UNPROTECTED_WNM && -+ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_SELF_PROTECTED && -+ ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_P2P) { -+ RTW_INFO("action frame category=%d should robust\n", ptr[WLAN_HDR_A3_LEN]); -+ goto validate_80211w_fail; -+ } -+ } else if (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC) { -+ unsigned short reason; -+ reason = le16_to_cpu(*(unsigned short *)(ptr + WLAN_HDR_A3_LEN)); -+ RTW_INFO("802.11w recv none protected packet, reason=%d\n", reason); -+ if (reason == 6 || reason == 7) { -+ /* issue sa query request */ -+ issue_action_SA_Query(adapter, NULL, 0, 0, IEEE80211W_RIGHT_KEY); -+ } -+ goto validate_80211w_fail; -+ } -+ } -+ } -+ return _SUCCESS; -+ -+validate_80211w_fail: -+ return _FAIL; -+ -+} -+#endif /* CONFIG_IEEE80211W */ -+ -+static inline void dump_rx_packet(u8 *ptr) -+{ -+ int i; -+ -+ RTW_INFO("#############################\n"); -+ for (i = 0; i < 64; i = i + 8) -+ RTW_INFO("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr + i), -+ *(ptr + i + 1), *(ptr + i + 2) , *(ptr + i + 3) , *(ptr + i + 4), *(ptr + i + 5), *(ptr + i + 6), *(ptr + i + 7)); -+ RTW_INFO("#############################\n"); -+} -+ -+sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame); -+sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ /* shall check frame subtype, to / from ds, da, bssid */ -+ -+ /* then call check if rx seq/frag. duplicated. */ -+ -+ u8 type; -+ u8 subtype; -+ sint retval = _SUCCESS; -+ -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ u8 ver = (unsigned char)(*ptr) & 0x3 ; -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+#endif -+ -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; -+#endif /* CONFIG_TDLS */ -+#ifdef CONFIG_WAPI_SUPPORT -+ PRT_WAPI_T pWapiInfo = &adapter->wapiInfo; -+ struct recv_frame_hdr *phdr = &precv_frame->u.hdr; -+ u8 wai_pkt = 0; -+ u16 sc; -+ u8 external_len = 0; -+#endif -+ -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ if (pmlmeext->sitesurvey_res.state == SCAN_PROCESS) { -+ int ch_set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, rtw_get_oper_ch(adapter)); -+ if (ch_set_idx >= 0) -+ pmlmeext->channel_set[ch_set_idx].rx_count++; -+ } -+#endif -+ -+#ifdef CONFIG_TDLS -+ if (ptdlsinfo->ch_sensing == 1 && ptdlsinfo->cur_channel != 0) -+ ptdlsinfo->collect_pkt_num[ptdlsinfo->cur_channel - 1]++; -+#endif /* CONFIG_TDLS */ -+ -+#ifdef RTK_DMP_PLATFORM -+ if (0) { -+ RTW_INFO("++\n"); -+ { -+ int i; -+ for (i = 0; i < 64; i = i + 8) -+ RTW_INFO("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:", *(ptr + i), -+ *(ptr + i + 1), *(ptr + i + 2) , *(ptr + i + 3) , *(ptr + i + 4), *(ptr + i + 5), *(ptr + i + 6), *(ptr + i + 7)); -+ -+ } -+ RTW_INFO("--\n"); -+ } -+#endif /* RTK_DMP_PLATFORM */ -+ -+ /* add version chk */ -+ if (ver != 0) { -+ retval = _FAIL; -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_ver_err); -+ goto exit; -+ } -+ -+ type = GetFrameType(ptr); -+ subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ -+ -+ pattrib->to_fr_ds = get_tofr_ds(ptr); -+ -+ pattrib->frag_num = GetFragNum(ptr); -+ pattrib->seq_num = GetSequence(ptr); -+ -+ pattrib->pw_save = GetPwrMgt(ptr); -+ pattrib->mfrag = GetMFrag(ptr); -+ pattrib->mdata = GetMData(ptr); -+ pattrib->privacy = GetPrivacy(ptr); -+ pattrib->order = GetOrder(ptr); -+#ifdef CONFIG_WAPI_SUPPORT -+ sc = (pattrib->seq_num << 4) | pattrib->frag_num; -+#endif -+ -+#if 1 /* Dump rx packets */ -+ { -+ u8 bDumpRxPkt = 0; -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); -+ if (bDumpRxPkt == 1) /* dump all rx packets */ -+ dump_rx_packet(ptr); -+ else if ((bDumpRxPkt == 2) && (type == WIFI_MGT_TYPE)) -+ dump_rx_packet(ptr); -+ else if ((bDumpRxPkt == 3) && (type == WIFI_DATA_TYPE)) -+ dump_rx_packet(ptr); -+ } -+#endif -+ switch (type) { -+ case WIFI_MGT_TYPE: /* mgnt */ -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt); -+#ifdef CONFIG_IEEE80211W -+ if (validate_80211w_mgmt(adapter, precv_frame) == _FAIL) { -+ retval = _FAIL; -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt_err_80211w); -+ break; -+ } -+#endif /* CONFIG_IEEE80211W */ -+ -+ retval = validate_recv_mgnt_frame(adapter, precv_frame); -+ if (retval == _FAIL) { -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt_err); -+ } -+ retval = _FAIL; /* only data frame return _SUCCESS */ -+ break; -+ case WIFI_CTRL_TYPE: /* ctrl */ -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_ctrl); -+ retval = validate_recv_ctrl_frame(adapter, precv_frame); -+ if (retval == _FAIL) { -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_ctrl_err); -+ } -+ retval = _FAIL; /* only data frame return _SUCCESS */ -+ break; -+ case WIFI_DATA_TYPE: /* data */ -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data); -+#ifdef CONFIG_WAPI_SUPPORT -+ if (pattrib->qos) -+ external_len = 2; -+ else -+ external_len = 0; -+ -+ wai_pkt = rtw_wapi_is_wai_packet(adapter, ptr); -+ -+ phdr->bIsWaiPacket = wai_pkt; -+ -+ if (wai_pkt != 0) { -+ if (sc != adapter->wapiInfo.wapiSeqnumAndFragNum) -+ adapter->wapiInfo.wapiSeqnumAndFragNum = sc; -+ else { -+ retval = _FAIL; -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_wapi_seq_err); -+ break; -+ } -+ } else { -+ -+ if (rtw_wapi_drop_for_key_absent(adapter, GetAddr2Ptr(ptr))) { -+ retval = _FAIL; -+ WAPI_TRACE(WAPI_RX, "drop for key absent for rx\n"); -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_wapi_key_err); -+ break; -+ } -+ } -+ -+#endif -+ -+ pattrib->qos = (subtype & BIT(7)) ? 1 : 0; -+ retval = validate_recv_data_frame(adapter, precv_frame); -+ if (retval == _FAIL) { -+ struct recv_priv *precvpriv = &adapter->recvpriv; -+ precvpriv->rx_drop++; -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_err); -+ } else if (retval == _SUCCESS) { -+#ifdef DBG_RX_DUMP_EAP -+ u8 bDumpRxPkt; -+ u16 eth_type; -+ -+ /* dump eapol */ -+ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); -+ /* get ether_type */ -+ _rtw_memcpy(ð_type, ptr + pattrib->hdrlen + pattrib->iv_len + LLC_HEADER_SIZE, 2); -+ eth_type = ntohs((unsigned short) eth_type); -+ if ((bDumpRxPkt == 4) && (eth_type == 0x888e)) -+ dump_rx_packet(ptr); -+#endif -+ } else -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_handled); -+ break; -+ default: -+ DBG_COUNTER(adapter->rx_logs.core_rx_pre_unknown); -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME validate_recv_data_frame fail! type=0x%x\n", type); -+#endif -+ retval = _FAIL; -+ break; -+ } -+ -+exit: -+ -+ -+ return retval; -+} -+ -+ -+/* remove the wlanhdr and add the eth_hdr */ -+#if 1 -+ -+sint wlanhdr_to_ethhdr(union recv_frame *precvframe); -+sint wlanhdr_to_ethhdr(union recv_frame *precvframe) -+{ -+ sint rmv_len; -+ u16 eth_type, len; -+ u8 bsnaphdr; -+ u8 *psnap_type; -+ struct ieee80211_snap_hdr *psnap; -+ -+ sint ret = _SUCCESS; -+ _adapter *adapter = precvframe->u.hdr.adapter; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ u8 *ptr = get_recvframe_data(precvframe) ; /* point to frame_ctrl field */ -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ -+ -+ if (pattrib->encrypt) -+ recvframe_pull_tail(precvframe, pattrib->icv_len); -+ -+ psnap = (struct ieee80211_snap_hdr *)(ptr + pattrib->hdrlen + pattrib->iv_len); -+ psnap_type = ptr + pattrib->hdrlen + pattrib->iv_len + SNAP_SIZE; -+ /* convert hdr + possible LLC headers into Ethernet header */ -+ /* eth_type = (psnap_type[0] << 8) | psnap_type[1]; */ -+ if ((_rtw_memcmp(psnap, rtw_rfc1042_header, SNAP_SIZE) && -+ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_IPX, 2) == _FALSE) && -+ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_AARP, 2) == _FALSE)) || -+ /* eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || */ -+ _rtw_memcmp(psnap, rtw_bridge_tunnel_header, SNAP_SIZE)) { -+ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ -+ bsnaphdr = _TRUE; -+ } else { -+ /* Leave Ethernet header part of hdr and full payload */ -+ bsnaphdr = _FALSE; -+ } -+ -+ rmv_len = pattrib->hdrlen + pattrib->iv_len + (bsnaphdr ? SNAP_SIZE : 0); -+ len = precvframe->u.hdr.len - rmv_len; -+ -+ -+ _rtw_memcpy(ð_type, ptr + rmv_len, 2); -+ eth_type = ntohs((unsigned short)eth_type); /* pattrib->ether_type */ -+ pattrib->eth_type = eth_type; -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (0x8899 == pattrib->eth_type) { -+ struct sta_info *psta = precvframe->u.hdr.psta; -+ -+ RTW_INFO("wlan rx: got eth_type=0x%x\n", pattrib->eth_type); -+ -+ if (psta && psta->isrc && psta->pid > 0) { -+ u16 rx_pid; -+ -+ rx_pid = *(u16 *)(ptr + rmv_len + 2); -+ -+ RTW_INFO("wlan rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", -+ rx_pid, MAC_ARG(psta->hwaddr), psta->pid); -+ -+ if (rx_pid == psta->pid) { -+ int i; -+ u16 len = *(u16 *)(ptr + rmv_len + 4); -+ /* u16 ctrl_type = *(u16*)(ptr+rmv_len+6); */ -+ -+ /* RTW_INFO("RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); */ -+ RTW_INFO("RC: len=0x%x\n", len); -+ -+ for (i = 0; i < len; i++) -+ RTW_INFO("0x%x\n", *(ptr + rmv_len + 6 + i)); -+ /* RTW_INFO("0x%x\n", *(ptr+rmv_len+8+i)); */ -+ -+ RTW_INFO("RC-end\n"); -+ } -+ } -+ } -+#endif /* CONFIG_AUTO_AP_MODE */ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE)) { -+ ptr += rmv_len ; -+ *ptr = 0x87; -+ *(ptr + 1) = 0x12; -+ -+ eth_type = 0x8712; -+ /* append rx status for mp test packets */ -+ ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + 2) - 24); -+ if (!ptr) { -+ ret = _FAIL; -+ goto exiting; -+ } -+ _rtw_memcpy(ptr, get_rxmem(precvframe), 24); -+ ptr += 24; -+ } else { -+ ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + (bsnaphdr ? 2 : 0))); -+ if (!ptr) { -+ ret = _FAIL; -+ goto exiting; -+ } -+ } -+ -+ if (ptr) { -+ _rtw_memcpy(ptr, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(ptr + ETH_ALEN, pattrib->src, ETH_ALEN); -+ -+ if (!bsnaphdr) { -+ len = htons(len); -+ _rtw_memcpy(ptr + 12, &len, 2); -+ } -+ } -+ -+exiting: -+ return ret; -+ -+} -+ -+#else -+ -+sint wlanhdr_to_ethhdr(union recv_frame *precvframe) -+{ -+ sint rmv_len; -+ u16 eth_type; -+ u8 bsnaphdr; -+ u8 *psnap_type; -+ struct ieee80211_snap_hdr *psnap; -+ -+ sint ret = _SUCCESS; -+ _adapter *adapter = precvframe->u.hdr.adapter; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ u8 *ptr = get_recvframe_data(precvframe) ; /* point to frame_ctrl field */ -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ struct _vlan *pvlan = NULL; -+ -+ -+ psnap = (struct ieee80211_snap_hdr *)(ptr + pattrib->hdrlen + pattrib->iv_len); -+ psnap_type = ptr + pattrib->hdrlen + pattrib->iv_len + SNAP_SIZE; -+ if (psnap->dsap == 0xaa && psnap->ssap == 0xaa && psnap->ctrl == 0x03) { -+ if (_rtw_memcmp(psnap->oui, oui_rfc1042, WLAN_IEEE_OUI_LEN)) -+ bsnaphdr = _TRUE; /* wlan_pkt_format = WLAN_PKT_FORMAT_SNAP_RFC1042; */ -+ else if (_rtw_memcmp(psnap->oui, SNAP_HDR_APPLETALK_DDP, WLAN_IEEE_OUI_LEN) && -+ _rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_DDP, 2)) -+ bsnaphdr = _TRUE; /* wlan_pkt_format = WLAN_PKT_FORMAT_APPLETALK; */ -+ else if (_rtw_memcmp(psnap->oui, oui_8021h, WLAN_IEEE_OUI_LEN)) -+ bsnaphdr = _TRUE; /* wlan_pkt_format = WLAN_PKT_FORMAT_SNAP_TUNNEL; */ -+ else { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ } else -+ bsnaphdr = _FALSE; /* wlan_pkt_format = WLAN_PKT_FORMAT_OTHERS; */ -+ -+ rmv_len = pattrib->hdrlen + pattrib->iv_len + (bsnaphdr ? SNAP_SIZE : 0); -+ -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) { -+ ptr += rmv_len ; -+ *ptr = 0x87; -+ *(ptr + 1) = 0x12; -+ -+ /* back to original pointer */ -+ ptr -= rmv_len; -+ } -+ -+ ptr += rmv_len ; -+ -+ _rtw_memcpy(ð_type, ptr, 2); -+ eth_type = ntohs((unsigned short)eth_type); /* pattrib->ether_type */ -+ ptr += 2; -+ -+ if (pattrib->encrypt) -+ recvframe_pull_tail(precvframe, pattrib->icv_len); -+ -+ if (eth_type == 0x8100) { /* vlan */ -+ pvlan = (struct _vlan *) ptr; -+ -+ /* eth_type = get_vlan_encap_proto(pvlan); */ -+ /* eth_type = pvlan->h_vlan_encapsulated_proto; */ /* ? */ -+ rmv_len += 4; -+ ptr += 4; -+ } -+ -+ if (eth_type == 0x0800) { /* ip */ -+ /* struct iphdr* piphdr = (struct iphdr*) ptr; */ -+ /* __u8 tos = (unsigned char)(pattrib->priority & 0xff); */ -+ -+ /* piphdr->tos = tos; */ -+ -+ } else if (eth_type == 0x8712) { /* append rx status for mp test packets */ -+ /* ptr -= 16; */ -+ /* _rtw_memcpy(ptr, get_rxmem(precvframe), 16); */ -+ } else { -+#ifdef PLATFORM_OS_XP -+ NDIS_PACKET_8021Q_INFO VlanPriInfo; -+ UINT32 UserPriority = precvframe->u.hdr.attrib.priority; -+ UINT32 VlanID = (pvlan != NULL ? get_vlan_id(pvlan) : 0); -+ -+ VlanPriInfo.Value = /* Get current value. */ -+ NDIS_PER_PACKET_INFO_FROM_PACKET(precvframe->u.hdr.pkt, Ieee8021QInfo); -+ -+ VlanPriInfo.TagHeader.UserPriority = UserPriority; -+ VlanPriInfo.TagHeader.VlanId = VlanID ; -+ -+ VlanPriInfo.TagHeader.CanonicalFormatId = 0; /* Should be zero. */ -+ VlanPriInfo.TagHeader.Reserved = 0; /* Should be zero. */ -+ NDIS_PER_PACKET_INFO_FROM_PACKET(precvframe->u.hdr.pkt, Ieee8021QInfo) = VlanPriInfo.Value; -+#endif -+ } -+ -+ if (eth_type == 0x8712) { /* append rx status for mp test packets */ -+ ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + 2) - 24); -+ _rtw_memcpy(ptr, get_rxmem(precvframe), 24); -+ ptr += 24; -+ } else -+ ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + 2)); -+ -+ _rtw_memcpy(ptr, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(ptr + ETH_ALEN, pattrib->src, ETH_ALEN); -+ -+ eth_type = htons((unsigned short)eth_type) ; -+ _rtw_memcpy(ptr + 12, ð_type, 2); -+ -+exit: -+ -+ -+ return ret; -+} -+#endif -+ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifdef PLATFORM_LINUX -+static void recvframe_expand_pkt( -+ PADAPTER padapter, -+ union recv_frame *prframe) -+{ -+ struct recv_frame_hdr *pfhdr; -+ _pkt *ppkt; -+ u8 shift_sz; -+ u32 alloc_sz; -+ u8 *ptr; -+ -+ -+ pfhdr = &prframe->u.hdr; -+ -+ /* 6 is for IP header 8 bytes alignment in QoS packet case. */ -+ if (pfhdr->attrib.qos) -+ shift_sz = 6; -+ else -+ shift_sz = 0; -+ -+ /* for first fragment packet, need to allocate */ -+ /* (1536 + RXDESC_SIZE + drvinfo_sz) to reassemble packet */ -+ /* 8 is for skb->data 8 bytes alignment. -+ * alloc_sz = _RND(1536 + RXDESC_SIZE + pfhdr->attrib.drvinfosize + shift_sz + 8, 128); */ -+ alloc_sz = 1664; /* round (1536 + 24 + 32 + shift_sz + 8) to 128 bytes alignment */ -+ -+ /* 3 1. alloc new skb */ -+ /* prepare extra space for 4 bytes alignment */ -+ ppkt = rtw_skb_alloc(alloc_sz); -+ -+ if (!ppkt) -+ return; /* no way to expand */ -+ -+ /* 3 2. Prepare new skb to replace & release old skb */ -+ /* force ppkt->data at 8-byte alignment address */ -+ skb_reserve(ppkt, 8 - ((SIZE_PTR)ppkt->data & 7)); -+ /* force ip_hdr at 8-byte alignment address according to shift_sz */ -+ skb_reserve(ppkt, shift_sz); -+ -+ /* copy data to new pkt */ -+ ptr = skb_put(ppkt, pfhdr->len); -+ if (ptr) -+ _rtw_memcpy(ptr, pfhdr->rx_data, pfhdr->len); -+ -+ rtw_skb_free(pfhdr->pkt); -+ -+ /* attach new pkt to recvframe */ -+ pfhdr->pkt = ppkt; -+ pfhdr->rx_head = ppkt->head; -+ pfhdr->rx_data = ppkt->data; -+ pfhdr->rx_tail = skb_tail_pointer(ppkt); -+ pfhdr->rx_end = skb_end_pointer(ppkt); -+} -+#else -+#warning "recvframe_expand_pkt not implement, defrag may crash system" -+#endif -+#endif -+ -+/* perform defrag */ -+union recv_frame *recvframe_defrag(_adapter *adapter, _queue *defrag_q); -+union recv_frame *recvframe_defrag(_adapter *adapter, _queue *defrag_q) -+{ -+ _list *plist, *phead; -+ u8 *data, wlanhdr_offset; -+ u8 curfragnum; -+ struct recv_frame_hdr *pfhdr, *pnfhdr; -+ union recv_frame *prframe, *pnextrframe; -+ _queue *pfree_recv_queue; -+ -+ -+ curfragnum = 0; -+ pfree_recv_queue = &adapter->recvpriv.free_recv_queue; -+ -+ phead = get_list_head(defrag_q); -+ plist = get_next(phead); -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pfhdr = &prframe->u.hdr; -+ rtw_list_delete(&(prframe->u.list)); -+ -+ if (curfragnum != pfhdr->attrib.frag_num) { -+ /* the first fragment number must be 0 */ -+ /* free the whole queue */ -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); -+ -+ return NULL; -+ } -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifndef CONFIG_SDIO_RX_COPY -+ recvframe_expand_pkt(adapter, prframe); -+#endif -+#endif -+ -+ curfragnum++; -+ -+ plist = get_list_head(defrag_q); -+ -+ plist = get_next(plist); -+ -+ data = get_recvframe_data(prframe); -+ -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ pnextrframe = LIST_CONTAINOR(plist, union recv_frame , u); -+ pnfhdr = &pnextrframe->u.hdr; -+ -+ -+ /* check the fragment sequence (2nd ~n fragment frame) */ -+ -+ if (curfragnum != pnfhdr->attrib.frag_num) { -+ /* the fragment number must be increasing (after decache) */ -+ /* release the defrag_q & prframe */ -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); -+ return NULL; -+ } -+ -+ curfragnum++; -+ -+ /* copy the 2nd~n fragment frame's payload to the first fragment */ -+ /* get the 2nd~last fragment frame's payload */ -+ -+ wlanhdr_offset = pnfhdr->attrib.hdrlen + pnfhdr->attrib.iv_len; -+ -+ recvframe_pull(pnextrframe, wlanhdr_offset); -+ -+ /* append to first fragment frame's tail (if privacy frame, pull the ICV) */ -+ recvframe_pull_tail(prframe, pfhdr->attrib.icv_len); -+ -+ /* memcpy */ -+ _rtw_memcpy(pfhdr->rx_tail, pnfhdr->rx_data, pnfhdr->len); -+ -+ recvframe_put(prframe, pnfhdr->len); -+ -+ pfhdr->attrib.icv_len = pnfhdr->attrib.icv_len; -+ plist = get_next(plist); -+ -+ }; -+ -+ /* free the defrag_q queue and return the prframe */ -+ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); -+ -+ -+ -+ return prframe; -+} -+ -+/* check if need to defrag, if needed queue the frame to defrag_q */ -+union recv_frame *recvframe_chk_defrag(PADAPTER padapter, union recv_frame *precv_frame) -+{ -+ u8 ismfrag; -+ u8 fragnum; -+ u8 *psta_addr; -+ struct recv_frame_hdr *pfhdr; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv; -+ _list *phead; -+ union recv_frame *prtnframe = NULL; -+ _queue *pfree_recv_queue, *pdefrag_q; -+ -+ -+ pstapriv = &padapter->stapriv; -+ -+ pfhdr = &precv_frame->u.hdr; -+ -+ pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+ /* need to define struct of wlan header frame ctrl */ -+ ismfrag = pfhdr->attrib.mfrag; -+ fragnum = pfhdr->attrib.frag_num; -+ -+ psta_addr = pfhdr->attrib.ta; -+ psta = rtw_get_stainfo(pstapriv, psta_addr); -+ if (psta == NULL) { -+ u8 type = GetFrameType(pfhdr->rx_data); -+ if (type != WIFI_DATA_TYPE) { -+ psta = rtw_get_bcmc_stainfo(padapter); -+ pdefrag_q = &psta->sta_recvpriv.defrag_q; -+ } else -+ pdefrag_q = NULL; -+ } else -+ pdefrag_q = &psta->sta_recvpriv.defrag_q; -+ -+ if ((ismfrag == 0) && (fragnum == 0)) { -+ prtnframe = precv_frame;/* isn't a fragment frame */ -+ } -+ -+ if (ismfrag == 1) { -+ /* 0~(n-1) fragment frame */ -+ /* enqueue to defraf_g */ -+ if (pdefrag_q != NULL) { -+ if (fragnum == 0) { -+ /* the first fragment */ -+ if (_rtw_queue_empty(pdefrag_q) == _FALSE) { -+ /* free current defrag_q */ -+ rtw_free_recvframe_queue(pdefrag_q, pfree_recv_queue); -+ } -+ } -+ -+ -+ /* Then enqueue the 0~(n-1) fragment into the defrag_q */ -+ -+ /* _rtw_spinlock(&pdefrag_q->lock); */ -+ phead = get_list_head(pdefrag_q); -+ rtw_list_insert_tail(&pfhdr->list, phead); -+ /* _rtw_spinunlock(&pdefrag_q->lock); */ -+ -+ -+ prtnframe = NULL; -+ -+ } else { -+ /* can't find this ta's defrag_queue, so free this recv_frame */ -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ prtnframe = NULL; -+ } -+ -+ } -+ -+ if ((ismfrag == 0) && (fragnum != 0)) { -+ /* the last fragment frame */ -+ /* enqueue the last fragment */ -+ if (pdefrag_q != NULL) { -+ /* _rtw_spinlock(&pdefrag_q->lock); */ -+ phead = get_list_head(pdefrag_q); -+ rtw_list_insert_tail(&pfhdr->list, phead); -+ /* _rtw_spinunlock(&pdefrag_q->lock); */ -+ -+ /* call recvframe_defrag to defrag */ -+ precv_frame = recvframe_defrag(padapter, pdefrag_q); -+ prtnframe = precv_frame; -+ -+ } else { -+ /* can't find this ta's defrag_queue, so free this recv_frame */ -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ prtnframe = NULL; -+ } -+ -+ } -+ -+ -+ if ((prtnframe != NULL) && (prtnframe->u.hdr.attrib.privacy)) { -+ /* after defrag we must check tkip mic code */ -+ if (recvframe_chkmic(padapter, prtnframe) == _FAIL) { -+ rtw_free_recvframe(prtnframe, pfree_recv_queue); -+ prtnframe = NULL; -+ } -+ } -+ -+ -+ return prtnframe; -+ -+} -+ -+int amsdu_to_msdu(_adapter *padapter, union recv_frame *prframe) -+{ -+ int a_len, padding_len; -+ u16 nSubframe_Length; -+ u8 nr_subframes, i; -+ u8 *pdata; -+ _pkt *sub_pkt, *subframes[MAX_SUBFRAME_COUNT]; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *pfree_recv_queue = &(precvpriv->free_recv_queue); -+ int ret = _SUCCESS; -+ -+ nr_subframes = 0; -+ -+ recvframe_pull(prframe, prframe->u.hdr.attrib.hdrlen); -+ -+ if (prframe->u.hdr.attrib.iv_len > 0) -+ recvframe_pull(prframe, prframe->u.hdr.attrib.iv_len); -+ -+ a_len = prframe->u.hdr.len; -+ -+ pdata = prframe->u.hdr.rx_data; -+ -+ while (a_len > ETH_HLEN) { -+ -+ /* Offset 12 denote 2 mac address */ -+ nSubframe_Length = RTW_GET_BE16(pdata + 12); -+ -+ if (a_len < (ETHERNET_HEADER_SIZE + nSubframe_Length)) { -+ RTW_INFO("nRemain_Length is %d and nSubframe_Length is : %d\n", a_len, nSubframe_Length); -+ break; -+ } -+ -+ sub_pkt = rtw_os_alloc_msdu_pkt(prframe, nSubframe_Length, pdata); -+ if (sub_pkt == NULL) { -+ RTW_INFO("%s(): allocate sub packet fail !!!\n", __FUNCTION__); -+ break; -+ } -+ -+ /* move the data point to data content */ -+ pdata += ETH_HLEN; -+ a_len -= ETH_HLEN; -+ -+ subframes[nr_subframes++] = sub_pkt; -+ -+ if (nr_subframes >= MAX_SUBFRAME_COUNT) { -+ RTW_INFO("ParseSubframe(): Too many Subframes! Packets dropped!\n"); -+ break; -+ } -+ -+ pdata += nSubframe_Length; -+ a_len -= nSubframe_Length; -+ if (a_len != 0) { -+ padding_len = 4 - ((nSubframe_Length + ETH_HLEN) & (4 - 1)); -+ if (padding_len == 4) -+ padding_len = 0; -+ -+ if (a_len < padding_len) { -+ RTW_INFO("ParseSubframe(): a_len < padding_len !\n"); -+ break; -+ } -+ pdata += padding_len; -+ a_len -= padding_len; -+ } -+ } -+ -+ for (i = 0; i < nr_subframes; i++) { -+ sub_pkt = subframes[i]; -+ -+ /* Indicat the packets to upper layer */ -+ if (sub_pkt) -+ rtw_os_recv_indicate_pkt(padapter, sub_pkt, &prframe->u.hdr.attrib); -+ } -+ -+ prframe->u.hdr.len = 0; -+ rtw_free_recvframe(prframe, pfree_recv_queue);/* free this recv_frame */ -+ -+ return ret; -+} -+ -+int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num); -+int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num) -+{ -+ PADAPTER padapter = preorder_ctrl->padapter; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ u8 wsize = preorder_ctrl->wsize_b; -+ u16 wend = (preorder_ctrl->indicate_seq + wsize - 1) & 0xFFF; /* % 4096; */ -+ -+ /* Rx Reorder initialize condition. */ -+ if (preorder_ctrl->indicate_seq == 0xFFFF) { -+ preorder_ctrl->indicate_seq = seq_num; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d init IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, seq_num); -+#endif -+ -+ /* DbgPrint("check_indicate_seq, 1st->indicate_seq=%d\n", precvpriv->indicate_seq); */ -+ } -+ -+ /* DbgPrint("enter->check_indicate_seq(): IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ -+ -+ /* Drop out the packet which SeqNum is smaller than WinStart */ -+ if (SN_LESS(seq_num, preorder_ctrl->indicate_seq)) { -+ /* DbgPrint("CheckRxTsIndicateSeq(): Packet Drop! IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ -+ -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("%s IndicateSeq: %d > NewSeq: %d\n", __FUNCTION__, -+ preorder_ctrl->indicate_seq, seq_num); -+#endif -+ -+ -+ return _FALSE; -+ } -+ -+ /* */ -+ /* Sliding window manipulation. Conditions includes: */ -+ /* 1. Incoming SeqNum is equal to WinStart =>Window shift 1 */ -+ /* 2. Incoming SeqNum is larger than the WinEnd => Window shift N */ -+ /* */ -+ if (SN_EQUAL(seq_num, preorder_ctrl->indicate_seq)) { -+ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) & 0xFFF; -+ -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d SN_EQUAL IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, seq_num); -+#endif -+ } else if (SN_LESS(wend, seq_num)) { -+ /* DbgPrint("CheckRxTsIndicateSeq(): Window Shift! IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ -+ -+ /* boundary situation, when seq_num cross 0xFFF */ -+ if (seq_num >= (wsize - 1)) -+ preorder_ctrl->indicate_seq = seq_num + 1 - wsize; -+ else -+ preorder_ctrl->indicate_seq = 0xFFF - (wsize - (seq_num + 1)) + 1; -+ pdbgpriv->dbg_rx_ampdu_window_shift_cnt++; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d SN_LESS(wend, seq_num) IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, seq_num); -+#endif -+ } -+ -+ /* DbgPrint("exit->check_indicate_seq(): IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ -+ -+ return _TRUE; -+} -+ -+int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union recv_frame *prframe); -+int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union recv_frame *prframe) -+{ -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ _list *phead, *plist; -+ union recv_frame *pnextrframe; -+ struct rx_pkt_attrib *pnextattrib; -+ -+ /* DbgPrint("+enqueue_reorder_recvframe()\n"); */ -+ -+ /* _enter_critical_ex(&ppending_recvframe_queue->lock, &irql); */ -+ /* _rtw_spinlock_ex(&ppending_recvframe_queue->lock); */ -+ -+ -+ phead = get_list_head(ppending_recvframe_queue); -+ plist = get_next(phead); -+ -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ pnextrframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pnextattrib = &pnextrframe->u.hdr.attrib; -+ -+ if (SN_LESS(pnextattrib->seq_num, pattrib->seq_num)) -+ plist = get_next(plist); -+ else if (SN_EQUAL(pnextattrib->seq_num, pattrib->seq_num)) { -+ /* Duplicate entry is found!! Do not insert current entry. */ -+ -+ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ -+ -+ return _FALSE; -+ } else -+ break; -+ -+ /* DbgPrint("enqueue_reorder_recvframe():while\n"); */ -+ -+ } -+ -+ -+ /* _enter_critical_ex(&ppending_recvframe_queue->lock, &irql); */ -+ /* _rtw_spinlock_ex(&ppending_recvframe_queue->lock); */ -+ -+ rtw_list_delete(&(prframe->u.hdr.list)); -+ -+ rtw_list_insert_tail(&(prframe->u.hdr.list), plist); -+ -+ /* _rtw_spinunlock_ex(&ppending_recvframe_queue->lock); */ -+ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ -+ -+ -+ return _TRUE; -+ -+} -+ -+void recv_indicatepkts_pkt_loss_cnt(struct debug_priv *pdbgpriv, u64 prev_seq, u64 current_seq); -+void recv_indicatepkts_pkt_loss_cnt(struct debug_priv *pdbgpriv, u64 prev_seq, u64 current_seq) -+{ -+ if (current_seq < prev_seq) -+ pdbgpriv->dbg_rx_ampdu_loss_count += (4096 + current_seq - prev_seq); -+ -+ else -+ pdbgpriv->dbg_rx_ampdu_loss_count += (current_seq - prev_seq); -+} -+int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced); -+int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced) -+{ -+ /* _irqL irql; */ -+ /* u8 bcancelled; */ -+ _list *phead, *plist; -+ union recv_frame *prframe; -+ struct rx_pkt_attrib *pattrib; -+ /* u8 index = 0; */ -+ int bPktInBuf = _FALSE; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_in_oder); -+ -+ /* DbgPrint("+recv_indicatepkts_in_order\n"); */ -+ -+ /* _enter_critical_ex(&ppending_recvframe_queue->lock, &irql); */ -+ /* _rtw_spinlock_ex(&ppending_recvframe_queue->lock); */ -+ -+ phead = get_list_head(ppending_recvframe_queue); -+ plist = get_next(phead); -+ -+#if 0 -+ /* Check if there is any other indication thread running. */ -+ if (pTS->RxIndicateState == RXTS_INDICATE_PROCESSING) -+ return; -+#endif -+ -+ /* Handling some condition for forced indicate case. */ -+ if (bforced == _TRUE) { -+ pdbgpriv->dbg_rx_ampdu_forced_indicate_count++; -+ if (rtw_is_list_empty(phead)) { -+ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ -+ /* _rtw_spinunlock_ex(&ppending_recvframe_queue->lock); */ -+ return _TRUE; -+ } -+ -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pattrib = &prframe->u.hdr.attrib; -+ -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+#endif -+ recv_indicatepkts_pkt_loss_cnt(pdbgpriv, preorder_ctrl->indicate_seq, pattrib->seq_num); -+ preorder_ctrl->indicate_seq = pattrib->seq_num; -+ -+ } -+ -+ /* Prepare indication list and indication. */ -+ /* Check if there is any packet need indicate. */ -+ while (!rtw_is_list_empty(phead)) { -+ -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pattrib = &prframe->u.hdr.attrib; -+ -+ if (!SN_LESS(preorder_ctrl->indicate_seq, pattrib->seq_num)) { -+ -+#if 0 -+ /* This protect buffer from overflow. */ -+ if (index >= REORDER_WIN_SIZE) { -+ RT_ASSERT(FALSE, ("IndicateRxReorderList(): Buffer overflow!!\n")); -+ bPktInBuf = TRUE; -+ break; -+ } -+#endif -+ -+ plist = get_next(plist); -+ rtw_list_delete(&(prframe->u.hdr.list)); -+ -+ if (SN_EQUAL(preorder_ctrl->indicate_seq, pattrib->seq_num)) { -+ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) & 0xFFF; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+#endif -+ } -+ -+#if 0 -+ index++; -+ if (index == 1) { -+ /* Cancel previous pending timer. */ -+ /* PlatformCancelTimer(Adapter, &pTS->RxPktPendingTimer); */ -+ if (bforced != _TRUE) { -+ /* RTW_INFO("_cancel_timer(&preorder_ctrl->reordering_ctrl_timer, &bcancelled);\n"); */ -+ _cancel_timer(&preorder_ctrl->reordering_ctrl_timer, &bcancelled); -+ } -+ } -+#endif -+ -+ /* Set this as a lock to make sure that only one thread is indicating packet. */ -+ /* pTS->RxIndicateState = RXTS_INDICATE_PROCESSING; */ -+ -+ /* Indicate packets */ -+ /* RT_ASSERT((index<=REORDER_WIN_SIZE), ("RxReorderIndicatePacket(): Rx Reorder buffer full!!\n")); */ -+ -+ -+ /* indicate this recv_frame */ -+ /* DbgPrint("recv_indicatepkts_in_order, indicate_seq=%d, seq_num=%d\n", precvpriv->indicate_seq, pattrib->seq_num); */ -+ if (!pattrib->amsdu) { -+ /* RTW_INFO("recv_indicatepkts_in_order, amsdu!=1, indicate_seq=%d, seq_num=%d\n", preorder_ctrl->indicate_seq, pattrib->seq_num); */ -+ -+ if (!RTW_CANNOT_RUN(padapter)) -+ rtw_recv_indicatepkt(padapter, prframe);/*indicate this recv_frame*/ -+ -+ } else if (pattrib->amsdu == 1) { -+ if (amsdu_to_msdu(padapter, prframe) != _SUCCESS) -+ rtw_free_recvframe(prframe, &precvpriv->free_recv_queue); -+ } else { -+ /* error condition; */ -+ } -+ -+ -+ /* Update local variables. */ -+ bPktInBuf = _FALSE; -+ -+ } else { -+ bPktInBuf = _TRUE; -+ break; -+ } -+ -+ /* DbgPrint("recv_indicatepkts_in_order():while\n"); */ -+ -+ } -+ -+ /* _rtw_spinunlock_ex(&ppending_recvframe_queue->lock); */ -+ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ -+ -+#if 0 -+ /* Release the indication lock and set to new indication step. */ -+ if (bPktInBuf) { -+ /* Set new pending timer. */ -+ /* pTS->RxIndicateState = RXTS_INDICATE_REORDER; */ -+ /* PlatformSetTimer(Adapter, &pTS->RxPktPendingTimer, pHTInfo->RxReorderPendingTime); */ -+ -+ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); -+ } else { -+ /* pTS->RxIndicateState = RXTS_INDICATE_IDLE; */ -+ } -+#endif -+ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ -+ -+ /* return _TRUE; */ -+ return bPktInBuf; -+ -+} -+ -+int recv_indicatepkt_reorder(_adapter *padapter, union recv_frame *prframe); -+int recv_indicatepkt_reorder(_adapter *padapter, union recv_frame *prframe) -+{ -+ _irqL irql; -+ int retval = _SUCCESS; -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ struct recv_reorder_ctrl *preorder_ctrl = prframe->u.hdr.preorder_ctrl; -+ _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_reoder); -+ -+ if (!pattrib->amsdu) { -+ /* s1. */ -+ retval = wlanhdr_to_ethhdr(prframe); -+ if (retval != _SUCCESS) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr error!\n", __FUNCTION__); -+#endif -+ return retval; -+ } -+ -+ /* if ((pattrib->qos!=1) || pattrib->priority!=0 || IS_MCAST(pattrib->ra) */ -+ /* || (pattrib->eth_type==0x0806) || (pattrib->ack_policy!=0)) */ -+ if (pattrib->qos != 1) { -+ if (!RTW_CANNOT_RUN(padapter)) { -+ -+ rtw_recv_indicatepkt(padapter, prframe); -+ return _SUCCESS; -+ -+ } -+ -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s pattrib->qos !=1\n", __FUNCTION__); -+#endif -+ -+ return _FAIL; -+ -+ } -+ -+ if (preorder_ctrl->enable == _FALSE) { -+ /* indicate this recv_frame */ -+ preorder_ctrl->indicate_seq = pattrib->seq_num; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+#endif -+ -+ rtw_recv_indicatepkt(padapter, prframe); -+ -+ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) % 4096; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+#endif -+ -+ return _SUCCESS; -+ } -+ -+#ifndef CONFIG_RECV_REORDERING_CTRL -+ /* indicate this recv_frame */ -+ rtw_recv_indicatepkt(padapter, prframe); -+ return _SUCCESS; -+#endif -+ -+ } else if (pattrib->amsdu == 1) { /* temp filter->means didn't support A-MSDUs in a A-MPDU */ -+ if (preorder_ctrl->enable == _FALSE) { -+ preorder_ctrl->indicate_seq = pattrib->seq_num; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+#endif -+ -+ retval = amsdu_to_msdu(padapter, prframe); -+ -+ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) % 4096; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+#endif -+ -+ if (retval != _SUCCESS) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s amsdu_to_msdu fail\n", __FUNCTION__); -+#endif -+ } -+ -+ return retval; -+ } -+ } else { -+ -+ } -+ -+ _enter_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ -+ -+ /* s2. check if winstart_b(indicate_seq) needs to been updated */ -+ if (!check_indicate_seq(preorder_ctrl, pattrib->seq_num)) { -+ pdbgpriv->dbg_rx_ampdu_drop_count++; -+ /* pHTInfo->RxReorderDropCounter++; */ -+ /* ReturnRFDList(Adapter, pRfd); */ -+ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ -+ /* return _FAIL; */ -+ -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s check_indicate_seq fail\n", __FUNCTION__); -+#endif -+#if 0 -+ rtw_recv_indicatepkt(padapter, prframe); -+ -+ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ -+ goto _success_exit; -+#else -+ goto _err_exit; -+#endif -+ } -+ -+ -+ /* s3. Insert all packet into Reorder Queue to maintain its ordering. */ -+ if (!enqueue_reorder_recvframe(preorder_ctrl, prframe)) { -+ /* DbgPrint("recv_indicatepkt_reorder, enqueue_reorder_recvframe fail!\n"); */ -+ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ -+ /* return _FAIL; */ -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s enqueue_reorder_recvframe fail\n", __FUNCTION__); -+#endif -+ goto _err_exit; -+ } -+ -+ -+ /* s4. */ -+ /* Indication process. */ -+ /* After Packet dropping and Sliding Window shifting as above, we can now just indicate the packets */ -+ /* with the SeqNum smaller than latest WinStart and buffer other packets. */ -+ /* */ -+ /* For Rx Reorder condition: */ -+ /* 1. All packets with SeqNum smaller than WinStart => Indicate */ -+ /* 2. All packets with SeqNum larger than or equal to WinStart => Buffer it. */ -+ /* */ -+ -+ /* recv_indicatepkts_in_order(padapter, preorder_ctrl, _TRUE); */ -+ if (recv_indicatepkts_in_order(padapter, preorder_ctrl, _FALSE) == _TRUE) { -+ if (!preorder_ctrl->bReorderWaiting) { -+ preorder_ctrl->bReorderWaiting = _TRUE; -+ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); -+ } -+ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ } else { -+ preorder_ctrl->bReorderWaiting = _FALSE; -+ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); -+ } -+ -+ -+_success_exit: -+ -+ return _SUCCESS; -+ -+_err_exit: -+ -+ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ -+ return _FAIL; -+} -+ -+ -+void rtw_reordering_ctrl_timeout_handler(void *pcontext) -+{ -+ _irqL irql; -+ struct recv_reorder_ctrl *preorder_ctrl = (struct recv_reorder_ctrl *)pcontext; -+ _adapter *padapter = preorder_ctrl->padapter; -+ _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ return; -+ -+ /* RTW_INFO("+rtw_reordering_ctrl_timeout_handler()=>\n"); */ -+ -+ _enter_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ -+ if (preorder_ctrl) -+ preorder_ctrl->bReorderWaiting = _FALSE; -+ -+ if (recv_indicatepkts_in_order(padapter, preorder_ctrl, _TRUE) == _TRUE) -+ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); -+ -+ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ -+} -+ -+int process_recv_indicatepkts(_adapter *padapter, union recv_frame *prframe); -+int process_recv_indicatepkts(_adapter *padapter, union recv_frame *prframe) -+{ -+ int retval = _SUCCESS; -+ /* struct recv_priv *precvpriv = &padapter->recvpriv; */ -+ /* struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; */ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_TDLS -+ struct sta_info *psta = prframe->u.hdr.psta; -+#endif /* CONFIG_TDLS */ -+ -+#ifdef CONFIG_80211N_HT -+ -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate); -+ -+#ifdef CONFIG_TDLS -+ if ((phtpriv->ht_option == _TRUE) || -+ ((psta->tdls_sta_state & TDLS_LINKED_STATE) && -+ (psta->htpriv.ht_option == _TRUE) && -+ (psta->htpriv.ampdu_enable == _TRUE))) /* B/G/N Mode */ -+#else -+ if (phtpriv->ht_option == _TRUE) /* B/G/N Mode */ -+#endif /* CONFIG_TDLS */ -+ { -+ /* prframe->u.hdr.preorder_ctrl = &precvpriv->recvreorder_ctrl[pattrib->priority]; */ -+ -+ if (recv_indicatepkt_reorder(padapter, prframe) != _SUCCESS) { /* including perform A-MPDU Rx Ordering Buffer Control */ -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s recv_indicatepkt_reorder error!\n", __FUNCTION__); -+#endif -+ -+ if (!RTW_CANNOT_RUN(padapter)) { -+ retval = _FAIL; -+ return retval; -+ } -+ } -+ } else /* B/G mode */ -+#endif -+ { -+ retval = wlanhdr_to_ethhdr(prframe); -+ if (retval != _SUCCESS) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr error!\n", __FUNCTION__); -+#endif -+ return retval; -+ } -+ -+ if (!RTW_CANNOT_RUN(padapter)) { -+ /* indicate this recv_frame */ -+ rtw_recv_indicatepkt(padapter, prframe); -+ } else { -+ -+ retval = _FAIL; -+ return retval; -+ } -+ -+ } -+ -+ return retval; -+ -+} -+ -+#ifdef CONFIG_MP_INCLUDED -+int validate_mp_recv_frame(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ int ret = _SUCCESS; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ u8 type, subtype; -+ struct mp_priv *pmppriv = &adapter->mppriv; -+ struct mp_tx *pmptx; -+ unsigned char *sa , *da, *bs; -+ -+ pmptx = &pmppriv->tx; -+ -+#if 0 -+ if (1) { -+ u8 bDumpRxPkt; -+ type = GetFrameType(ptr); -+ subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); -+ if (bDumpRxPkt == 1) { /* dump all rx packets */ -+ int i; -+ RTW_INFO("############ type:0x%02x subtype:0x%02x #################\n", type, subtype); -+ -+ for (i = 0; i < 64; i = i + 8) -+ RTW_INFO("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr + i), -+ *(ptr + i + 1), *(ptr + i + 2) , *(ptr + i + 3) , *(ptr + i + 4), *(ptr + i + 5), *(ptr + i + 6), *(ptr + i + 7)); -+ RTW_INFO("#############################\n"); -+ } -+ } -+#endif -+ if (pmppriv->bloopback) { -+ if (_rtw_memcmp(ptr + 24, pmptx->buf + 24, precv_frame->u.hdr.len - 24) == _FALSE) { -+ RTW_INFO("Compare payload content Fail !!!\n"); -+ ret = _FAIL; -+ } -+ } -+ if (pmppriv->bSetRxBssid == _TRUE) { -+ -+ sa = GetAddr2Ptr(ptr); -+ da = GetAddr1Ptr(ptr); -+ bs = GetAddr3Ptr(ptr); -+ type = GetFrameType(ptr); -+ subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ -+ -+ if (_rtw_memcmp(bs, adapter->mppriv.network_macaddr, ETH_ALEN) == _FALSE) -+ ret = _FAIL; -+ -+ RTW_DBG("############ type:0x%02x subtype:0x%02x #################\n", type, subtype); -+ RTW_DBG("A2 sa %02X:%02X:%02X:%02X:%02X:%02X \n", *(sa) , *(sa + 1), *(sa+ 2), *(sa + 3), *(sa + 4), *(sa + 5)); -+ RTW_DBG("A1 da %02X:%02X:%02X:%02X:%02X:%02X \n", *(da) , *(da + 1), *(da+ 2), *(da + 3), *(da + 4), *(da + 5)); -+ RTW_DBG("A3 bs %02X:%02X:%02X:%02X:%02X:%02X \n --------------------------\n", *(bs) , *(bs + 1), *(bs+ 2), *(bs + 3), *(bs + 4), *(bs + 5)); -+ } -+ -+ if (!adapter->mppriv.bmac_filter) -+ return ret; -+ -+ if (_rtw_memcmp(GetAddr2Ptr(ptr), adapter->mppriv.mac_filter, ETH_ALEN) == _FALSE) -+ ret = _FAIL; -+ -+ return ret; -+} -+ -+static sint MPwlanhdr_to_ethhdr(union recv_frame *precvframe) -+{ -+ sint rmv_len; -+ u16 eth_type, len; -+ u8 bsnaphdr; -+ u8 *psnap_type; -+ u8 mcastheadermac[] = {0x01, 0x00, 0x5e}; -+ -+ struct ieee80211_snap_hdr *psnap; -+ -+ sint ret = _SUCCESS; -+ _adapter *adapter = precvframe->u.hdr.adapter; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ u8 *ptr = get_recvframe_data(precvframe) ; /* point to frame_ctrl field */ -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ -+ -+ if (pattrib->encrypt) -+ recvframe_pull_tail(precvframe, pattrib->icv_len); -+ -+ psnap = (struct ieee80211_snap_hdr *)(ptr + pattrib->hdrlen + pattrib->iv_len); -+ psnap_type = ptr + pattrib->hdrlen + pattrib->iv_len + SNAP_SIZE; -+ /* convert hdr + possible LLC headers into Ethernet header */ -+ /* eth_type = (psnap_type[0] << 8) | psnap_type[1]; */ -+ if ((_rtw_memcmp(psnap, rtw_rfc1042_header, SNAP_SIZE) && -+ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_IPX, 2) == _FALSE) && -+ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_AARP, 2) == _FALSE)) || -+ /* eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || */ -+ _rtw_memcmp(psnap, rtw_bridge_tunnel_header, SNAP_SIZE)) { -+ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ -+ bsnaphdr = _TRUE; -+ } else { -+ /* Leave Ethernet header part of hdr and full payload */ -+ bsnaphdr = _FALSE; -+ } -+ -+ rmv_len = pattrib->hdrlen + pattrib->iv_len + (bsnaphdr ? SNAP_SIZE : 0); -+ len = precvframe->u.hdr.len - rmv_len; -+ -+ -+ _rtw_memcpy(ð_type, ptr + rmv_len, 2); -+ eth_type = ntohs((unsigned short)eth_type); /* pattrib->ether_type */ -+ pattrib->eth_type = eth_type; -+ -+ { -+ ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + (bsnaphdr ? 2 : 0))); -+ } -+ -+ _rtw_memcpy(ptr, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(ptr + ETH_ALEN, pattrib->src, ETH_ALEN); -+ -+ if (!bsnaphdr) { -+ len = htons(len); -+ _rtw_memcpy(ptr + 12, &len, 2); -+ } -+ -+ -+ len = htons(pattrib->seq_num); -+ /* RTW_INFO("wlan seq = %d ,seq_num =%x\n",len,pattrib->seq_num); */ -+ _rtw_memcpy(ptr + 12, &len, 2); -+ if (adapter->mppriv.bRTWSmbCfg == _TRUE) { -+ /* if(_rtw_memcmp(mcastheadermac, pattrib->dst, 3) == _TRUE) */ /* SimpleConfig Dest. */ -+ /* _rtw_memcpy(ptr+ETH_ALEN, pattrib->bssid, ETH_ALEN); */ -+ -+ if (_rtw_memcmp(mcastheadermac, pattrib->bssid, 3) == _TRUE) /* SimpleConfig Dest. */ -+ _rtw_memcpy(ptr, pattrib->bssid, ETH_ALEN); -+ -+ } -+ -+ -+ return ret; -+ -+} -+ -+ -+int mp_recv_frame(_adapter *padapter, union recv_frame *rframe) -+{ -+ int ret = _SUCCESS; -+ struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+#ifdef CONFIG_MP_INCLUDED -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mp_priv *pmppriv = &padapter->mppriv; -+#endif /* CONFIG_MP_INCLUDED */ -+ u8 type; -+ u8 *ptr = rframe->u.hdr.rx_data; -+ u8 *psa, *pda, *pbssid; -+ struct sta_info *psta = NULL; -+ DBG_COUNTER(padapter->rx_logs.core_rx_pre); -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { /* &&(padapter->mppriv.check_mp_pkt == 0)) */ -+ if (pattrib->crc_err == 1) -+ padapter->mppriv.rx_crcerrpktcount++; -+ else { -+ if (_SUCCESS == validate_mp_recv_frame(padapter, rframe)) -+ padapter->mppriv.rx_pktcount++; -+ else -+ padapter->mppriv.rx_pktcount_filter_out++; -+ } -+ -+ if (pmppriv->rx_bindicatePkt == _FALSE) { -+ ret = _FAIL; -+ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ -+ goto exit; -+ } else { -+ type = GetFrameType(ptr); -+ pattrib->to_fr_ds = get_tofr_ds(ptr); -+ pattrib->frag_num = GetFragNum(ptr); -+ pattrib->seq_num = GetSequence(ptr); -+ pattrib->pw_save = GetPwrMgt(ptr); -+ pattrib->mfrag = GetMFrag(ptr); -+ pattrib->mdata = GetMData(ptr); -+ pattrib->privacy = GetPrivacy(ptr); -+ pattrib->order = GetOrder(ptr); -+ -+ if (type == WIFI_DATA_TYPE) { -+ pda = get_da(ptr); -+ psa = get_sa(ptr); -+ pbssid = get_hdr_bssid(ptr); -+ -+ _rtw_memcpy(pattrib->dst, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, psa, ETH_ALEN); -+ _rtw_memcpy(pattrib->bssid, pbssid, ETH_ALEN); -+ -+ switch (pattrib->to_fr_ds) { -+ case 0: -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ ret = sta2sta_data_frame(padapter, rframe, &psta); -+ break; -+ -+ case 1: -+ -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pbssid, ETH_ALEN); -+ ret = ap2sta_data_frame(padapter, rframe, &psta); -+ -+ break; -+ -+ case 2: -+ _rtw_memcpy(pattrib->ra, pbssid, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ ret = sta2ap_data_frame(padapter, rframe, &psta); -+ break; -+ -+ case 3: -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); -+ ret = _FAIL; -+ break; -+ -+ default: -+ ret = _FAIL; -+ break; -+ } -+ -+ ret = MPwlanhdr_to_ethhdr(rframe); -+ -+ if (ret != _SUCCESS) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr: drop pkt\n", __FUNCTION__); -+#endif -+ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ -+ ret = _FAIL; -+ goto exit; -+ } -+ if (!RTW_CANNOT_RUN(padapter)) { -+ /* indicate this recv_frame */ -+ ret = rtw_recv_indicatepkt(padapter, rframe); -+ if (ret != _SUCCESS) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s rtw_recv_indicatepkt fail!\n", __FUNCTION__); -+#endif -+ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ -+ ret = _FAIL; -+ -+ goto exit; -+ } -+ } else { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s ecv_func:bDriverStopped(%s) OR bSurpriseRemoved(%s)\n", __func__, -+ rtw_is_drv_stopped(padapter) ? "True" : "False", -+ rtw_is_surprise_removed(padapter) ? "True" : "False"); -+#endif -+ ret = _FAIL; -+ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ -+ goto exit; -+ } -+ -+ } -+ } -+ -+ } -+ -+ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ -+ ret = _FAIL; -+ -+exit: -+ return ret; -+ -+} -+#endif -+ -+static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, u8 *buf) -+{ -+#define CHAN2FREQ(a) ((a < 14) ? (2407+5*a) : (5000+5*a)) -+ -+#if 0 -+#define RTW_RX_RADIOTAP_PRESENT (\ -+ (1 << IEEE80211_RADIOTAP_TSFT) | \ -+ (1 << IEEE80211_RADIOTAP_FLAGS) | \ -+ (1 << IEEE80211_RADIOTAP_RATE) | \ -+ (1 << IEEE80211_RADIOTAP_CHANNEL) | \ -+ (0 << IEEE80211_RADIOTAP_FHSS) | \ -+ (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) | \ -+ (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) | \ -+ (0 << IEEE80211_RADIOTAP_LOCK_QUALITY) | \ -+ (0 << IEEE80211_RADIOTAP_TX_ATTENUATION) | \ -+ (0 << IEEE80211_RADIOTAP_DB_TX_ATTENUATION) | \ -+ (0 << IEEE80211_RADIOTAP_DBM_TX_POWER) | \ -+ (1 << IEEE80211_RADIOTAP_ANTENNA) | \ -+ (1 << IEEE80211_RADIOTAP_DB_ANTSIGNAL) | \ -+ (0 << IEEE80211_RADIOTAP_DB_ANTNOISE) | \ -+ (0 << IEEE80211_RADIOTAP_RX_FLAGS) | \ -+ (0 << IEEE80211_RADIOTAP_TX_FLAGS) | \ -+ (0 << IEEE80211_RADIOTAP_RTS_RETRIES) | \ -+ (0 << IEEE80211_RADIOTAP_DATA_RETRIES) | \ -+ (0 << IEEE80211_RADIOTAP_MCS) | \ -+ (0 << IEEE80211_RADIOTAP_RADIOTAP_NAMESPACE)| \ -+ (0 << IEEE80211_RADIOTAP_VENDOR_NAMESPACE) | \ -+ (0 << IEEE80211_RADIOTAP_EXT) | \ -+ 0) -+ -+ /* (0 << IEEE80211_RADIOTAP_AMPDU_STATUS) | \ */ -+ /* (0 << IEEE80211_RADIOTAP_VHT) | \ */ -+#endif -+ -+#ifndef IEEE80211_RADIOTAP_RX_FLAGS -+#define IEEE80211_RADIOTAP_RX_FLAGS 14 -+#endif -+ -+#ifndef IEEE80211_RADIOTAP_MCS -+#define IEEE80211_RADIOTAP_MCS 19 -+#endif -+#ifndef IEEE80211_RADIOTAP_VHT -+#define IEEE80211_RADIOTAP_VHT 21 -+#endif -+ -+#ifndef IEEE80211_RADIOTAP_F_BADFCS -+#define IEEE80211_RADIOTAP_F_BADFCS 0x40 /* bad FCS */ -+#endif -+ -+ sint ret = _SUCCESS; -+ _adapter *adapter = precvframe->u.hdr.adapter; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ u16 tmp_16bit = 0; -+ -+ u8 data_rate[] = { -+ 2, 4, 11, 22, /* CCK */ -+ 12, 18, 24, 36, 48, 72, 93, 108, /* OFDM */ -+ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, /* HT MCS index */ -+ 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, -+ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, /* VHT Nss 1 */ -+ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, /* VHT Nss 2 */ -+ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, /* VHT Nss 3 */ -+ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, /* VHT Nss 4 */ -+ }; -+ -+ _pkt *pskb = NULL; -+ -+ struct ieee80211_radiotap_header *rtap_hdr = NULL; -+ u8 *ptr = NULL; -+ -+ u8 hdr_buf[64] = {0}; -+ u16 rt_len = 8; -+ -+ /* create header */ -+ rtap_hdr = (struct ieee80211_radiotap_header *)&hdr_buf[0]; -+ rtap_hdr->it_version = PKTHDR_RADIOTAP_VERSION; -+ -+ /* tsft */ -+ if (pattrib->tsfl) { -+ u64 tmp_64bit; -+ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_TSFT); -+ tmp_64bit = cpu_to_le64(pattrib->tsfl); -+ memcpy(&hdr_buf[rt_len], &tmp_64bit, 8); -+ rt_len += 8; -+ } -+ -+ /* flags */ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_FLAGS); -+ if (0) -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_CFP; -+ -+ if (0) -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_SHORTPRE; -+ -+ if ((pattrib->encrypt == 1) || (pattrib->encrypt == 5)) -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_WEP; -+ -+ if (pattrib->mfrag) -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_FRAG; -+ -+ /* always append FCS */ -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_FCS; -+ -+ -+ if (0) -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_DATAPAD; -+ -+ if (pattrib->crc_err) -+ hdr_buf[rt_len] |= IEEE80211_RADIOTAP_F_BADFCS; -+ -+ if (pattrib->sgi) { -+ /* Currently unspecified but used */ -+ hdr_buf[rt_len] |= 0x80; -+ } -+ rt_len += 1; -+ -+ /* rate */ -+ if (pattrib->data_rate < 12) { -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_RATE); -+ if (pattrib->data_rate < 4) { -+ /* CCK */ -+ hdr_buf[rt_len] = data_rate[pattrib->data_rate]; -+ } else { -+ /* OFDM */ -+ hdr_buf[rt_len] = data_rate[pattrib->data_rate]; -+ } -+ } -+ rt_len += 1; /* force padding 1 byte for aligned */ -+ -+ /* channel */ -+ tmp_16bit = 0; -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_CHANNEL); -+ tmp_16bit = CHAN2FREQ(rtw_get_oper_ch(padapter)); -+ /*tmp_16bit = CHAN2FREQ(pHalData->CurrentChannel);*/ -+ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 2; -+ -+ /* channel flags */ -+ tmp_16bit = 0; -+ if (pHalData->CurrentBandType == 0) -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_2GHZ); -+ else -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_5GHZ); -+ -+ if (pattrib->data_rate < 12) { -+ if (pattrib->data_rate < 4) { -+ /* CCK */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_CCK); -+ } else { -+ /* OFDM */ -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_OFDM); -+ } -+ } else -+ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_DYN); -+ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 2; -+ -+ /* dBm Antenna Signal */ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL); -+ hdr_buf[rt_len] = pattrib->phy_info.RecvSignalPower; -+ rt_len += 1; -+ -+#if 0 -+ /* dBm Antenna Noise */ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE); -+ hdr_buf[rt_len] = 0; -+ rt_len += 1; -+ -+ /* Signal Quality */ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_LOCK_QUALITY); -+ hdr_buf[rt_len] = pattrib->phy_info.SignalQuality; -+ rt_len += 1; -+#endif -+ -+ /* Antenna */ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_ANTENNA); -+ hdr_buf[rt_len] = 0; /* pHalData->rf_type; */ -+ rt_len += 1; -+ -+ /* RX flags */ -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_RX_FLAGS); -+#if 0 -+ tmp_16bit = cpu_to_le16(0); -+ memcpy(ptr, &tmp_16bit, 1); -+#endif -+ rt_len += 2; -+ -+ /* MCS information */ -+ if (pattrib->data_rate >= 12 && pattrib->data_rate < 44) { -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_MCS); -+ /* known, flag */ -+ hdr_buf[rt_len] |= BIT1; /* MCS index known */ -+ -+ /* bandwidth */ -+ hdr_buf[rt_len] |= BIT0; -+ hdr_buf[rt_len + 1] |= (pattrib->bw & 0x03); -+ -+ /* guard interval */ -+ hdr_buf[rt_len] |= BIT2; -+ hdr_buf[rt_len + 1] |= (pattrib->sgi & 0x01) << 2; -+ -+ /* STBC */ -+ hdr_buf[rt_len] |= BIT5; -+ hdr_buf[rt_len + 1] |= (pattrib->stbc & 0x03) << 5; -+ -+ rt_len += 2; -+ -+ /* MCS rate index */ -+ hdr_buf[rt_len] = data_rate[pattrib->data_rate]; -+ rt_len += 1; -+ } -+ -+ /* VHT */ -+ if (pattrib->data_rate >= 44 && pattrib->data_rate < 84) { -+ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_VHT); -+ -+ /* known 16 bit, flag 8 bit */ -+ tmp_16bit = 0; -+ -+ /* Bandwidth */ -+ tmp_16bit |= BIT6; -+ -+ /* Group ID */ -+ tmp_16bit |= BIT7; -+ -+ /* Partial AID */ -+ tmp_16bit |= BIT8; -+ -+ /* STBC */ -+ tmp_16bit |= BIT0; -+ hdr_buf[rt_len + 2] |= (pattrib->stbc & 0x01); -+ -+ /* Guard interval */ -+ tmp_16bit |= BIT2; -+ hdr_buf[rt_len + 2] |= (pattrib->sgi & 0x01) << 2; -+ -+ /* LDPC extra OFDM symbol */ -+ tmp_16bit |= BIT4; -+ hdr_buf[rt_len + 2] |= (pattrib->ldpc & 0x01) << 4; -+ -+ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 3; -+ -+ /* bandwidth */ -+ if (pattrib->bw == 0) -+ hdr_buf[rt_len] |= 0; -+ else if (pattrib->bw == 1) -+ hdr_buf[rt_len] |= 1; -+ else if (pattrib->bw == 2) -+ hdr_buf[rt_len] |= 4; -+ else if (pattrib->bw == 3) -+ hdr_buf[rt_len] |= 11; -+ rt_len += 1; -+ -+ /* mcs_nss */ -+ if (pattrib->data_rate >= 44 && pattrib->data_rate < 54) { -+ hdr_buf[rt_len] |= 1; -+ hdr_buf[rt_len] |= data_rate[pattrib->data_rate] << 4; -+ } else if (pattrib->data_rate >= 54 && pattrib->data_rate < 64) { -+ hdr_buf[rt_len + 1] |= 2; -+ hdr_buf[rt_len + 1] |= data_rate[pattrib->data_rate] << 4; -+ } else if (pattrib->data_rate >= 64 && pattrib->data_rate < 74) { -+ hdr_buf[rt_len + 2] |= 3; -+ hdr_buf[rt_len + 2] |= data_rate[pattrib->data_rate] << 4; -+ } else if (pattrib->data_rate >= 74 && pattrib->data_rate < 84) { -+ hdr_buf[rt_len + 3] |= 4; -+ hdr_buf[rt_len + 3] |= data_rate[pattrib->data_rate] << 4; -+ } -+ rt_len += 4; -+ -+ /* coding */ -+ hdr_buf[rt_len] = 0; -+ rt_len += 1; -+ -+ /* group_id */ -+ hdr_buf[rt_len] = 0; -+ rt_len += 1; -+ -+ /* partial_aid */ -+ tmp_16bit = 0; -+ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); -+ rt_len += 2; -+ } -+ -+ /* push to skb */ -+ pskb = (_pkt *)buf; -+ if (skb_headroom(pskb) < rt_len) { -+ RTW_INFO("%s:%d %s headroom is too small.\n", __FILE__, __LINE__, __func__); -+ ret = _FAIL; -+ return ret; -+ } -+ -+ ptr = skb_push(pskb, rt_len); -+ if (ptr) { -+ rtap_hdr->it_len = cpu_to_le16(rt_len); -+ memcpy(ptr, rtap_hdr, rt_len); -+ } else -+ ret = _FAIL; -+ -+ return ret; -+ -+} -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+int recv_frame_monitor(_adapter *padapter, union recv_frame *rframe) -+{ -+ int ret = _SUCCESS; -+ struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ _pkt *pskb = NULL; -+ -+ /* read skb information from recv frame */ -+ pskb = rframe->u.hdr.pkt; -+ pskb->len = rframe->u.hdr.len; -+ pskb->data = rframe->u.hdr.rx_data; -+ skb_set_tail_pointer(pskb, rframe->u.hdr.len); -+ -+ /* fill radiotap header */ -+ if (fill_radiotap_hdr(padapter, rframe, (u8 *)pskb) == _FAIL) { -+ ret = _FAIL; -+ rtw_free_recvframe(rframe, pfree_recv_queue); /* free this recv_frame */ -+ goto exit; -+ } -+ -+ /* write skb information to recv frame */ -+ skb_reset_mac_header(pskb); -+ rframe->u.hdr.len = pskb->len; -+ rframe->u.hdr.rx_data = pskb->data; -+ rframe->u.hdr.rx_head = pskb->head; -+ rframe->u.hdr.rx_tail = skb_tail_pointer(pskb); -+ rframe->u.hdr.rx_end = skb_end_pointer(pskb); -+ -+ if (!RTW_CANNOT_RUN(padapter)) { -+ /* indicate this recv_frame */ -+ ret = rtw_recv_monitor(padapter, rframe); -+ if (ret != _SUCCESS) { -+ ret = _FAIL; -+ rtw_free_recvframe(rframe, pfree_recv_queue); /* free this recv_frame */ -+ goto exit; -+ } -+ } else { -+ ret = _FAIL; -+ rtw_free_recvframe(rframe, pfree_recv_queue); /* free this recv_frame */ -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+#endif -+int recv_func_prehandle(_adapter *padapter, union recv_frame *rframe) -+{ -+ int ret = _SUCCESS; -+ struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+#ifdef DBG_RX_COUNTER_DUMP -+ if (padapter->dump_rx_cnt_mode & DUMP_DRV_RX_COUNTER) { -+ if (pattrib->crc_err == 1) -+ padapter->drv_rx_cnt_crcerror++; -+ else -+ padapter->drv_rx_cnt_ok++; -+ } -+#endif -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1 || padapter->mppriv.bRTWSmbCfg == _TRUE) { -+ mp_recv_frame(padapter, rframe); -+ ret = _FAIL; -+ goto exit; -+ } else -+#endif -+ { -+ /* check the frame crtl field and decache */ -+ ret = validate_recv_frame(padapter, rframe); -+ if (ret != _SUCCESS) { -+ rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ -+ goto exit; -+ } -+ } -+exit: -+ return ret; -+} -+ -+/*#define DBG_RX_BMC_FRAME*/ -+int recv_func_posthandle(_adapter *padapter, union recv_frame *prframe) -+{ -+ int ret = _SUCCESS; -+ union recv_frame *orig_prframe = prframe; -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+#ifdef CONFIG_TDLS -+ u8 *psnap_type, *pcategory; -+#endif /* CONFIG_TDLS */ -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post); -+ -+ /* DATA FRAME */ -+ rtw_led_control(padapter, LED_CTL_RX); -+ -+ prframe = decryptor(padapter, prframe); -+ if (prframe == NULL) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s decryptor: drop pkt\n", __FUNCTION__); -+#endif -+ ret = _FAIL; -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_err); -+ goto _recv_data_drop; -+ } -+ -+#ifdef DBG_RX_BMC_FRAME -+ if (IS_MCAST(pattrib->ra)) { -+ u8 *pbuf = prframe->u.hdr.rx_data; -+ u8 *sa_addr = get_sa(pbuf); -+ -+ RTW_INFO("%s =>"ADPT_FMT" Rx BC/MC from MAC: "MAC_FMT"\n", __func__, ADPT_ARG(padapter), MAC_ARG(sa_addr)); -+ } -+#endif -+ -+#if 0 -+ if (padapter->adapter_type == PRIMARY_ADAPTER) { -+ RTW_INFO("+++\n"); -+ { -+ int i; -+ u8 *ptr = get_recvframe_data(prframe); -+ for (i = 0; i < 140; i = i + 8) -+ RTW_INFO("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:", *(ptr + i), -+ *(ptr + i + 1), *(ptr + i + 2) , *(ptr + i + 3) , *(ptr + i + 4), *(ptr + i + 5), *(ptr + i + 6), *(ptr + i + 7)); -+ -+ } -+ RTW_INFO("---\n"); -+ } -+#endif -+ -+#ifdef CONFIG_TDLS -+ /* check TDLS frame */ -+ psnap_type = get_recvframe_data(orig_prframe) + pattrib->hdrlen + pattrib->iv_len + SNAP_SIZE; -+ pcategory = psnap_type + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; -+ -+ if ((_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_TDLS, ETH_TYPE_LEN)) && -+ ((*pcategory == RTW_WLAN_CATEGORY_TDLS) || (*pcategory == RTW_WLAN_CATEGORY_P2P))) { -+ ret = OnTDLS(padapter, prframe); -+ if (ret == _FAIL) -+ goto _exit_recv_func; -+ } -+#endif /* CONFIG_TDLS */ -+ -+ prframe = recvframe_chk_defrag(padapter, prframe); -+ if (prframe == NULL) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s recvframe_chk_defrag: drop pkt\n", __FUNCTION__); -+#endif -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_defrag_err); -+ goto _recv_data_drop; -+ } -+ -+ prframe = portctrl(padapter, prframe); -+ if (prframe == NULL) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s portctrl: drop pkt\n", __FUNCTION__); -+#endif -+ ret = _FAIL; -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_portctrl_err); -+ goto _recv_data_drop; -+ } -+ -+ count_rx_stats(padapter, prframe, NULL); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_update_info(padapter, prframe); -+#endif -+ -+#ifdef CONFIG_80211N_HT -+ ret = process_recv_indicatepkts(padapter, prframe); -+ if (ret != _SUCCESS) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s process_recv_indicatepkts fail!\n", __FUNCTION__); -+#endif -+ rtw_free_recvframe(orig_prframe, pfree_recv_queue);/* free this recv_frame */ -+ DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_err); -+ goto _recv_data_drop; -+ } -+#else /* CONFIG_80211N_HT */ -+ if (!pattrib->amsdu) { -+ ret = wlanhdr_to_ethhdr(prframe); -+ if (ret != _SUCCESS) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr: drop pkt\n", __FUNCTION__); -+#endif -+ rtw_free_recvframe(orig_prframe, pfree_recv_queue);/* free this recv_frame */ -+ goto _recv_data_drop; -+ } -+ -+ if (!RTW_CANNOT_RUN(padapter)) { -+ /* indicate this recv_frame */ -+ ret = rtw_recv_indicatepkt(padapter, prframe); -+ if (ret != _SUCCESS) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s rtw_recv_indicatepkt fail!\n", __FUNCTION__); -+#endif -+ goto _recv_data_drop; -+ } -+ } else { -+ -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s recv_func:bDriverStopped(%s) OR bSurpriseRemoved(%s)\n", __func__ -+ , rtw_is_drv_stopped(padapter) ? "True" : "False" -+ , rtw_is_surprise_removed(padapter) ? "True" : "False"); -+#endif -+ ret = _FAIL; -+ rtw_free_recvframe(orig_prframe, pfree_recv_queue); /* free this recv_frame */ -+ } -+ -+ } else if (pattrib->amsdu == 1) { -+ -+ ret = amsdu_to_msdu(padapter, prframe); -+ if (ret != _SUCCESS) { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s amsdu_to_msdu fail\n", __FUNCTION__); -+#endif -+ rtw_free_recvframe(orig_prframe, pfree_recv_queue); -+ goto _recv_data_drop; -+ } -+ } else { -+#ifdef DBG_RX_DROP_FRAME -+ RTW_INFO("DBG_RX_DROP_FRAME %s what is this condition??\n", __FUNCTION__); -+#endif -+ goto _recv_data_drop; -+ } -+#endif /* CONFIG_80211N_HT */ -+ -+_exit_recv_func: -+ return ret; -+ -+_recv_data_drop: -+ precvpriv->rx_drop++; -+ return ret; -+} -+ -+ -+int recv_func(_adapter *padapter, union recv_frame *rframe); -+int recv_func(_adapter *padapter, union recv_frame *rframe) -+{ -+ int ret; -+ struct rx_pkt_attrib *prxattrib = &rframe->u.hdr.attrib; -+ struct recv_priv *recvpriv = &padapter->recvpriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ -+ if (check_fwstate(mlmepriv, WIFI_MONITOR_STATE)) { -+ /* monitor mode */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+ recv_frame_monitor(padapter, rframe); -+#endif -+ ret = _SUCCESS; -+ goto exit; -+ } else -+ -+ /* check if need to handle uc_swdec_pending_queue*/ -+ if (check_fwstate(mlmepriv, WIFI_STATION_STATE) && psecuritypriv->busetkipkey) { -+ union recv_frame *pending_frame; -+ int cnt = 0; -+ -+ while ((pending_frame = rtw_alloc_recvframe(&padapter->recvpriv.uc_swdec_pending_queue))) { -+ cnt++; -+ DBG_COUNTER(padapter->rx_logs.core_rx_dequeue); -+ recv_func_posthandle(padapter, pending_frame); -+ } -+ -+ if (cnt) -+ RTW_INFO(FUNC_ADPT_FMT" dequeue %d from uc_swdec_pending_queue\n", -+ FUNC_ADPT_ARG(padapter), cnt); -+ } -+ -+ DBG_COUNTER(padapter->rx_logs.core_rx); -+ ret = recv_func_prehandle(padapter, rframe); -+ -+ if (ret == _SUCCESS) { -+ -+ /* check if need to enqueue into uc_swdec_pending_queue*/ -+ if (check_fwstate(mlmepriv, WIFI_STATION_STATE) && -+ !IS_MCAST(prxattrib->ra) && prxattrib->encrypt > 0 && -+ (prxattrib->bdecrypted == 0 || psecuritypriv->sw_decrypt == _TRUE) && -+ psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPAPSK && -+ !psecuritypriv->busetkipkey) { -+ DBG_COUNTER(padapter->rx_logs.core_rx_enqueue); -+ rtw_enqueue_recvframe(rframe, &padapter->recvpriv.uc_swdec_pending_queue); -+ /* RTW_INFO("%s: no key, enqueue uc_swdec_pending_queue\n", __func__); */ -+ -+ if (recvpriv->free_recvframe_cnt < NR_RECVFRAME / 4) { -+ /* to prevent from recvframe starvation, get recvframe from uc_swdec_pending_queue to free_recvframe_cnt */ -+ rframe = rtw_alloc_recvframe(&padapter->recvpriv.uc_swdec_pending_queue); -+ if (rframe) -+ goto do_posthandle; -+ } -+ goto exit; -+ } -+ -+do_posthandle: -+ ret = recv_func_posthandle(padapter, rframe); -+ } -+ -+exit: -+ return ret; -+} -+ -+ -+s32 rtw_recv_entry(union recv_frame *precvframe) -+{ -+ _adapter *padapter; -+ struct recv_priv *precvpriv; -+ s32 ret = _SUCCESS; -+ -+ -+ -+ padapter = precvframe->u.hdr.adapter; -+ -+ precvpriv = &padapter->recvpriv; -+ -+ -+ ret = recv_func(padapter, precvframe); -+ if (ret == _FAIL) { -+ goto _recv_entry_drop; -+ } -+ -+ -+ precvpriv->rx_pkts++; -+ -+ -+ return ret; -+ -+_recv_entry_drop: -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) -+ padapter->mppriv.rx_pktloss = precvpriv->rx_drop; -+#endif -+ -+ -+ -+ return ret; -+} -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ struct recv_priv *recvpriv = &adapter->recvpriv; -+ -+ u32 tmp_s, tmp_q; -+ u8 avg_signal_strength = 0; -+ u8 avg_signal_qual = 0; -+ u32 num_signal_strength = 0; -+ u32 num_signal_qual = 0; -+ u8 ratio_pre_stat = 0, ratio_curr_stat = 0, ratio_total = 0, ratio_profile = SIGNAL_STAT_CALC_PROFILE_0; -+ -+ if (adapter->recvpriv.is_signal_dbg) { -+ /* update the user specific value, signal_strength_dbg, to signal_strength, rssi */ -+ adapter->recvpriv.signal_strength = adapter->recvpriv.signal_strength_dbg; -+ adapter->recvpriv.rssi = (s8)translate_percentage_to_dbm((u8)adapter->recvpriv.signal_strength_dbg); -+ } else { -+ -+ if (recvpriv->signal_strength_data.update_req == 0) { /* update_req is clear, means we got rx */ -+ avg_signal_strength = recvpriv->signal_strength_data.avg_val; -+ num_signal_strength = recvpriv->signal_strength_data.total_num; -+ /* after avg_vals are accquired, we can re-stat the signal values */ -+ recvpriv->signal_strength_data.update_req = 1; -+ } -+ -+ if (recvpriv->signal_qual_data.update_req == 0) { /* update_req is clear, means we got rx */ -+ avg_signal_qual = recvpriv->signal_qual_data.avg_val; -+ num_signal_qual = recvpriv->signal_qual_data.total_num; -+ /* after avg_vals are accquired, we can re-stat the signal values */ -+ recvpriv->signal_qual_data.update_req = 1; -+ } -+ -+ if (num_signal_strength == 0) { -+ if (rtw_get_on_cur_ch_time(adapter) == 0 -+ || rtw_get_passing_time_ms(rtw_get_on_cur_ch_time(adapter)) < 2 * adapter->mlmeextpriv.mlmext_info.bcn_interval -+ ) -+ goto set_timer; -+ } -+ -+ if (check_fwstate(&adapter->mlmepriv, _FW_UNDER_SURVEY) == _TRUE -+ || check_fwstate(&adapter->mlmepriv, _FW_LINKED) == _FALSE -+ ) -+ goto set_timer; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(adapter, _FW_UNDER_SURVEY) == _TRUE) -+ goto set_timer; -+#endif -+ -+ if (RTW_SIGNAL_STATE_CALC_PROFILE < SIGNAL_STAT_CALC_PROFILE_MAX) -+ ratio_profile = RTW_SIGNAL_STATE_CALC_PROFILE; -+ -+ ratio_pre_stat = signal_stat_calc_profile[ratio_profile][0]; -+ ratio_curr_stat = signal_stat_calc_profile[ratio_profile][1]; -+ ratio_total = ratio_pre_stat + ratio_curr_stat; -+ -+ /* update value of signal_strength, rssi, signal_qual */ -+ tmp_s = (ratio_curr_stat * avg_signal_strength + ratio_pre_stat * recvpriv->signal_strength); -+ if (tmp_s % ratio_total) -+ tmp_s = tmp_s / ratio_total + 1; -+ else -+ tmp_s = tmp_s / ratio_total; -+ if (tmp_s > 100) -+ tmp_s = 100; -+ -+ tmp_q = (ratio_curr_stat * avg_signal_qual + ratio_pre_stat * recvpriv->signal_qual); -+ if (tmp_q % ratio_total) -+ tmp_q = tmp_q / ratio_total + 1; -+ else -+ tmp_q = tmp_q / ratio_total; -+ if (tmp_q > 100) -+ tmp_q = 100; -+ -+ recvpriv->signal_strength = tmp_s; -+ recvpriv->rssi = (s8)translate_percentage_to_dbm(tmp_s); -+ recvpriv->signal_qual = tmp_q; -+ -+#if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 -+ RTW_INFO(FUNC_ADPT_FMT" signal_strength:%3u, rssi:%3d, signal_qual:%3u" -+ ", num_signal_strength:%u, num_signal_qual:%u" -+ ", on_cur_ch_ms:%d" -+ "\n" -+ , FUNC_ADPT_ARG(adapter) -+ , recvpriv->signal_strength -+ , recvpriv->rssi -+ , recvpriv->signal_qual -+ , num_signal_strength, num_signal_qual -+ , rtw_get_on_cur_ch_time(adapter) ? rtw_get_passing_time_ms(rtw_get_on_cur_ch_time(adapter)) : 0 -+ ); -+#endif -+ } -+ -+set_timer: -+ rtw_set_signal_stat_timer(recvpriv); -+ -+} -+#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ -+static void rx_process_rssi(_adapter *padapter, union recv_frame *prframe) -+{ -+ u32 last_rssi, tmp_val; -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ struct signal_stat *signal_stat = &padapter->recvpriv.signal_strength_data; -+#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ -+ /* RTW_INFO("process_rssi=> pattrib->rssil(%d) signal_strength(%d)\n ",pattrib->RecvSignalPower,pattrib->signal_strength); */ -+ /* if(pRfd->Status.bPacketToSelf || pRfd->Status.bPacketBeacon) */ -+ { -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ if (signal_stat->update_req) { -+ signal_stat->total_num = 0; -+ signal_stat->total_val = 0; -+ signal_stat->update_req = 0; -+ } -+ -+ signal_stat->total_num++; -+ signal_stat->total_val += pattrib->phy_info.SignalStrength; -+ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; -+#else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ -+ /* Adapter->RxStats.RssiCalculateCnt++; */ /* For antenna Test */ -+ if (padapter->recvpriv.signal_strength_data.total_num++ >= PHY_RSSI_SLID_WIN_MAX) { -+ padapter->recvpriv.signal_strength_data.total_num = PHY_RSSI_SLID_WIN_MAX; -+ last_rssi = padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index]; -+ padapter->recvpriv.signal_strength_data.total_val -= last_rssi; -+ } -+ padapter->recvpriv.signal_strength_data.total_val += pattrib->phy_info.SignalStrength; -+ -+ padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index++] = pattrib->phy_info.SignalStrength; -+ if (padapter->recvpriv.signal_strength_data.index >= PHY_RSSI_SLID_WIN_MAX) -+ padapter->recvpriv.signal_strength_data.index = 0; -+ -+ -+ tmp_val = padapter->recvpriv.signal_strength_data.total_val / padapter->recvpriv.signal_strength_data.total_num; -+ -+ if (padapter->recvpriv.is_signal_dbg) { -+ padapter->recvpriv.signal_strength = padapter->recvpriv.signal_strength_dbg; -+ padapter->recvpriv.rssi = (s8)translate_percentage_to_dbm(padapter->recvpriv.signal_strength_dbg); -+ } else { -+ padapter->recvpriv.signal_strength = tmp_val; -+ padapter->recvpriv.rssi = (s8)translate_percentage_to_dbm(tmp_val); -+ } -+ -+#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ } -+} -+ -+static void rx_process_link_qual(_adapter *padapter, union recv_frame *prframe) -+{ -+ u32 last_evm = 0, tmpVal; -+ struct rx_pkt_attrib *pattrib; -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ struct signal_stat *signal_stat; -+#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ -+ if (prframe == NULL || padapter == NULL) -+ return; -+ -+ pattrib = &prframe->u.hdr.attrib; -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ signal_stat = &padapter->recvpriv.signal_qual_data; -+#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ -+ /* RTW_INFO("process_link_qual=> pattrib->signal_qual(%d)\n ",pattrib->signal_qual); */ -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ if (signal_stat->update_req) { -+ signal_stat->total_num = 0; -+ signal_stat->total_val = 0; -+ signal_stat->update_req = 0; -+ } -+ -+ signal_stat->total_num++; -+ signal_stat->total_val += pattrib->phy_info.SignalQuality; -+ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; -+ -+#else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ if (pattrib->phy_info.SignalQuality != 0) { -+ /* */ -+ /* 1. Record the general EVM to the sliding window. */ -+ /* */ -+ if (padapter->recvpriv.signal_qual_data.total_num++ >= PHY_LINKQUALITY_SLID_WIN_MAX) { -+ padapter->recvpriv.signal_qual_data.total_num = PHY_LINKQUALITY_SLID_WIN_MAX; -+ last_evm = padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index]; -+ padapter->recvpriv.signal_qual_data.total_val -= last_evm; -+ } -+ padapter->recvpriv.signal_qual_data.total_val += pattrib->phy_info.SignalQuality; -+ -+ padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = pattrib->phy_info.SignalQuality; -+ if (padapter->recvpriv.signal_qual_data.index >= PHY_LINKQUALITY_SLID_WIN_MAX) -+ padapter->recvpriv.signal_qual_data.index = 0; -+ -+ -+ /* <1> Showed on UI for user, in percentage. */ -+ tmpVal = padapter->recvpriv.signal_qual_data.total_val / padapter->recvpriv.signal_qual_data.total_num; -+ padapter->recvpriv.signal_qual = (u8)tmpVal; -+ -+ } -+#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+} -+ -+void rx_process_phy_info(_adapter *padapter, union recv_frame *rframe) -+{ -+ /* Check RSSI */ -+ rx_process_rssi(padapter, rframe); -+ -+ /* Check PWDB */ -+ /* process_PWDB(padapter, rframe); */ -+ -+ /* UpdateRxSignalStatistics8192C(Adapter, pRfd); */ -+ -+ /* Check EVM */ -+ rx_process_link_qual(padapter, rframe); -+ rtw_store_phy_info(padapter, rframe); -+} -+ -+void rx_query_phy_status( -+ union recv_frame *precvframe, -+ u8 *pphy_status) -+{ -+ PADAPTER padapter = precvframe->u.hdr.adapter; -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PODM_PHY_INFO_T pPHYInfo = (PODM_PHY_INFO_T)(&pattrib->phy_info); -+ u8 *wlanhdr; -+ ODM_PACKET_INFO_T pkt_info; -+ u8 *sa; -+ struct sta_priv *pstapriv; -+ struct sta_info *psta = NULL; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ /* _irqL irqL; */ -+ -+ pkt_info.bPacketMatchBSSID = _FALSE; -+ pkt_info.bPacketToSelf = _FALSE; -+ pkt_info.bPacketBeacon = _FALSE; -+ -+ wlanhdr = get_recvframe_data(precvframe); -+ -+ pkt_info.bPacketMatchBSSID = (!IsFrameTypeCtrl(wlanhdr)) -+ && (!pattrib->icv_err) && (!pattrib->crc_err) -+ && _rtw_memcmp(get_hdr_bssid(wlanhdr), get_bssid(&padapter->mlmepriv), ETH_ALEN); -+ -+ pkt_info.bToSelf = (!pattrib->icv_err) && (!pattrib->crc_err) -+ && _rtw_memcmp(get_ra(wlanhdr), adapter_mac_addr(padapter), ETH_ALEN); -+ -+ pkt_info.bPacketToSelf = pkt_info.bPacketMatchBSSID -+ && _rtw_memcmp(get_ra(wlanhdr), adapter_mac_addr(padapter), ETH_ALEN); -+ -+ pkt_info.bPacketBeacon = pkt_info.bPacketMatchBSSID -+ && (GetFrameSubType(wlanhdr) == WIFI_BEACON); -+ -+ sa = get_ta(wlanhdr); -+ -+ pkt_info.StationID = 0xFF; -+ -+ if (_rtw_memcmp(adapter_mac_addr(padapter), sa, ETH_ALEN) == _TRUE) { -+ static u32 start_time = 0; -+ -+#if 0 /*For debug */ -+ if (IsFrameTypeCtrl(wlanhdr)) { -+ RTW_INFO("-->Control frame: Y\n"); -+ RTW_INFO("-->pkt_len: %d\n", pattrib->pkt_len); -+ RTW_INFO("-->Sub Type = 0x%X\n", GetFrameSubType(wlanhdr)); -+ } -+ -+ /* Dump first 40 bytes of header */ -+ int i = 0; -+ -+ for (i = 0; i < 40; i++) -+ RTW_INFO("%d: %X\n", i, *((u8 *)wlanhdr + i)); -+ -+ RTW_INFO("\n"); -+#endif -+ -+ if ((start_time == 0) || (rtw_get_passing_time_ms(start_time) > 5000)) { -+ RTW_PRINT("Warning!!! %s: Confilc mac addr!!\n", __func__); -+ start_time = rtw_get_current_time(); -+ } -+ pdbgpriv->dbg_rx_conflic_mac_addr_cnt++; -+ } else { -+ pstapriv = &padapter->stapriv; -+ psta = rtw_get_stainfo(pstapriv, sa); -+ if (psta) -+ pkt_info.StationID = psta->mac_id; -+ } -+ -+ pkt_info.DataRate = pattrib->data_rate; -+ -+ /* _enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ -+ ODM_PhyStatusQuery(&pHalData->odmpriv, pPHYInfo, pphy_status, &pkt_info); -+ if (psta) -+ psta->rssi = pattrib->phy_info.RecvSignalPower; -+ /* _exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ -+ -+ { -+ precvframe->u.hdr.psta = NULL; -+ if (pkt_info.bPacketMatchBSSID -+ && (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) -+ ) { -+ if (psta) { -+ precvframe->u.hdr.psta = psta; -+ rx_process_phy_info(padapter, precvframe); -+ } -+ } else if (pkt_info.bPacketToSelf || pkt_info.bPacketBeacon) { -+ -+ if (psta) -+ precvframe->u.hdr.psta = psta; -+ rx_process_phy_info(padapter, precvframe); -+ } -+ } -+ -+ rtw_odm_parse_rx_phy_status_chinfo(precvframe, pphy_status); -+} -+/* -+* Increase and check if the continual_no_rx_packet of this @param pmlmepriv is larger than MAX_CONTINUAL_NORXPACKET_COUNT -+* @return _TRUE: -+* @return _FALSE: -+*/ -+int rtw_inc_and_chk_continual_no_rx_packet(struct sta_info *sta, int tid_index) -+{ -+ -+ int ret = _FALSE; -+ int value = ATOMIC_INC_RETURN(&sta->continual_no_rx_packet[tid_index]); -+ -+ if (value >= MAX_CONTINUAL_NORXPACKET_COUNT) -+ ret = _TRUE; -+ -+ return ret; -+} -+ -+/* -+* Set the continual_no_rx_packet of this @param pmlmepriv to 0 -+*/ -+void rtw_reset_continual_no_rx_packet(struct sta_info *sta, int tid_index) -+{ -+ ATOMIC_SET(&sta->continual_no_rx_packet[tid_index], 0); -+} -+ -+ -+s32 pre_recv_entry(union recv_frame *precvframe, u8 *pphy_status) -+{ -+ s32 ret = _SUCCESS; -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 *pda; -+ u8 *pbuf = precvframe->u.hdr.rx_data; -+ _adapter *iface = NULL; -+ _adapter *primary_padapter = precvframe->u.hdr.adapter; -+ -+ pda = get_ra(pbuf); -+ -+ if (IS_MCAST(pda) == _FALSE) { /*unicast packets*/ -+ iface = rtw_get_iface_by_macddr(primary_padapter , pda); -+ if (NULL == iface) { -+ RTW_INFO("%s [WARN] Cannot find appropriate adapter - mac_addr : "MAC_FMT"\n", __func__, MAC_ARG(pda)); -+ /*rtw_warn_on(1);*/ -+ } else -+ precvframe->u.hdr.adapter = iface; -+ } else /* Handle BC/MC Packets */ -+ rtw_mi_buddy_clone_bcmc_packet(primary_padapter, precvframe, pphy_status); -+#endif -+ -+ return ret; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_rf.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_rf.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_rf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_rf.c 2018-02-11 21:44:27.141145994 +0200 -@@ -0,0 +1,1140 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_RF_C_ -+ -+#include -+#include -+ -+u8 center_ch_2g[CENTER_CH_2G_NUM] = { -+/* G00 */1, 2, -+/* G01 */3, 4, 5, -+/* G02 */6, 7, 8, -+/* G03 */9, 10, 11, -+/* G04 */12, 13, -+/* G05 */14 -+}; -+ -+u8 center_ch_2g_40m[CENTER_CH_2G_40M_NUM] = { -+ 3, -+ 4, -+ 5, -+ 6, -+ 7, -+ 8, -+ 9, -+ 10, -+ 11, -+}; -+ -+u8 op_chs_of_cch_2g_40m[CENTER_CH_2G_40M_NUM][2] = { -+ {1, 5}, /* 3 */ -+ {2, 6}, /* 4 */ -+ {3, 7}, /* 5 */ -+ {4, 8}, /* 6 */ -+ {5, 9}, /* 7 */ -+ {6, 10}, /* 8 */ -+ {7, 11}, /* 9 */ -+ {8, 12}, /* 10 */ -+ {9, 13}, /* 11 */ -+}; -+ -+u8 center_ch_5g_all[CENTER_CH_5G_ALL_NUM] = { -+/* G00 */36, 38, 40, -+ 42, -+/* G01 */44, 46, 48, -+ /* 50, */ -+/* G02 */52, 54, 56, -+ 58, -+/* G03 */60, 62, 64, -+/* G04 */100, 102, 104, -+ 106, -+/* G05 */108, 110, 112, -+ /* 114, */ -+/* G06 */116, 118, 120, -+ 122, -+/* G07 */124, 126, 128, -+/* G08 */132, 134, 136, -+ 138, -+/* G09 */140, 142, 144, -+/* G10 */149, 151, 153, -+ 155, -+/* G11 */157, 159, 161, -+ /* 163, */ -+/* G12 */165, 167, 169, -+ 171, -+/* G13 */173, 175, 177 -+}; -+ -+u8 center_ch_5g_20m[CENTER_CH_5G_20M_NUM] = { -+/* G00 */36, 40, -+/* G01 */44, 48, -+/* G02 */52, 56, -+/* G03 */60, 64, -+/* G04 */100, 104, -+/* G05 */108, 112, -+/* G06 */116, 120, -+/* G07 */124, 128, -+/* G08 */132, 136, -+/* G09 */140, 144, -+/* G10 */149, 153, -+/* G11 */157, 161, -+/* G12 */165, 169, -+/* G13 */173, 177 -+}; -+ -+u8 center_ch_5g_40m[CENTER_CH_5G_40M_NUM] = { -+/* G00 */38, -+/* G01 */46, -+/* G02 */54, -+/* G03 */62, -+/* G04 */102, -+/* G05 */110, -+/* G06 */118, -+/* G07 */126, -+/* G08 */134, -+/* G09 */142, -+/* G10 */151, -+/* G11 */159, -+/* G12 */167, -+/* G13 */175 -+}; -+ -+u8 center_ch_5g_20m_40m[CENTER_CH_5G_20M_NUM + CENTER_CH_5G_40M_NUM] = { -+/* G00 */36, 38, 40, -+/* G01 */44, 46, 48, -+/* G02 */52, 54, 56, -+/* G03 */60, 62, 64, -+/* G04 */100, 102, 104, -+/* G05 */108, 110, 112, -+/* G06 */116, 118, 120, -+/* G07 */124, 126, 128, -+/* G08 */132, 134, 136, -+/* G09 */140, 142, 144, -+/* G10 */149, 151, 153, -+/* G11 */157, 159, 161, -+/* G12 */165, 167, 169, -+/* G13 */173, 175, 177 -+}; -+ -+u8 op_chs_of_cch_5g_40m[CENTER_CH_5G_40M_NUM][2] = { -+ {36, 40}, /* 38 */ -+ {44, 48}, /* 46 */ -+ {52, 56}, /* 54 */ -+ {60, 64}, /* 62 */ -+ {100, 104}, /* 102 */ -+ {108, 112}, /* 110 */ -+ {116, 120}, /* 118 */ -+ {124, 128}, /* 126 */ -+ {132, 136}, /* 134 */ -+ {140, 144}, /* 142 */ -+ {149, 153}, /* 151 */ -+ {157, 161}, /* 159 */ -+ {165, 169}, /* 167 */ -+ {173, 177}, /* 175 */ -+}; -+ -+u8 center_ch_5g_80m[CENTER_CH_5G_80M_NUM] = { -+/* G00 ~ G01*/42, -+/* G02 ~ G03*/58, -+/* G04 ~ G05*/106, -+/* G06 ~ G07*/122, -+/* G08 ~ G09*/138, -+/* G10 ~ G11*/155, -+/* G12 ~ G13*/171 -+}; -+ -+u8 op_chs_of_cch_5g_80m[CENTER_CH_5G_80M_NUM][4] = { -+ {36, 40, 44, 48}, /* 42 */ -+ {52, 56, 60, 64}, /* 58 */ -+ {100, 104, 108, 112}, /* 106 */ -+ {116, 120, 124, 128}, /* 122 */ -+ {132, 136, 140, 144}, /* 138 */ -+ {149, 153, 157, 161}, /* 155 */ -+ {165, 169, 173, 177}, /* 171 */ -+}; -+ -+u8 center_ch_5g_160m[CENTER_CH_5G_160M_NUM] = { -+/* G00 ~ G03*/50, -+/* G04 ~ G07*/114, -+/* G10 ~ G13*/163 -+}; -+ -+u8 op_chs_of_cch_5g_160m[CENTER_CH_5G_160M_NUM][8] = { -+ {36, 40, 44, 48, 52, 56, 60, 64}, /* 50 */ -+ {100, 104, 108, 112, 116, 120, 124, 128}, /* 114 */ -+ {149, 153, 157, 161, 165, 169, 173, 177}, /* 163 */ -+}; -+ -+struct center_chs_ent_t { -+ u8 ch_num; -+ u8 *chs; -+}; -+ -+struct center_chs_ent_t center_chs_2g_by_bw[] = { -+ {CENTER_CH_2G_NUM, center_ch_2g}, -+ {CENTER_CH_2G_40M_NUM, center_ch_2g_40m}, -+}; -+ -+struct center_chs_ent_t center_chs_5g_by_bw[] = { -+ {CENTER_CH_5G_20M_NUM, center_ch_5g_20m}, -+ {CENTER_CH_5G_40M_NUM, center_ch_5g_40m}, -+ {CENTER_CH_5G_80M_NUM, center_ch_5g_80m}, -+ {CENTER_CH_5G_160M_NUM, center_ch_5g_160m}, -+}; -+ -+/* -+ * Get center channel of smaller bandwidth by @param cch, @param bw, @param offset -+ * @cch: the given center channel -+ * @bw: the given bandwidth -+ * @offset: the given primary SC offset of the given bandwidth -+ * -+ * return center channel of smaller bandiwdth if valid, or 0 -+ */ -+u8 rtw_get_scch_by_cch_offset(u8 cch, u8 bw, u8 offset) -+{ -+ int i; -+ u8 t_cch = 0; -+ -+ if (bw == CHANNEL_WIDTH_20) { -+ t_cch = cch; -+ goto exit; -+ } -+ -+ if (offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ /* 2.4G, 40MHz */ -+ if (cch >= 3 && cch <= 11 && bw == CHANNEL_WIDTH_40) { -+ t_cch = (offset == HAL_PRIME_CHNL_OFFSET_UPPER) ? cch + 2 : cch - 2; -+ goto exit; -+ } -+ -+ /* 5G, 160MHz */ -+ if (cch >= 50 && cch <= 163 && bw == CHANNEL_WIDTH_160) { -+ t_cch = (offset == HAL_PRIME_CHNL_OFFSET_UPPER) ? cch + 8 : cch - 8; -+ goto exit; -+ -+ /* 5G, 80MHz */ -+ } else if (cch >= 42 && cch <= 171 && bw == CHANNEL_WIDTH_80) { -+ t_cch = (offset == HAL_PRIME_CHNL_OFFSET_UPPER) ? cch + 4 : cch - 4; -+ goto exit; -+ -+ /* 5G, 40MHz */ -+ } else if (cch >= 38 && cch <= 175 && bw == CHANNEL_WIDTH_40) { -+ t_cch = (offset == HAL_PRIME_CHNL_OFFSET_UPPER) ? cch + 2 : cch - 2; -+ goto exit; -+ -+ } else { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+exit: -+ return t_cch; -+} -+ -+struct op_chs_ent_t { -+ u8 ch_num; -+ u8 *chs; -+}; -+ -+struct op_chs_ent_t op_chs_of_cch_2g_by_bw[] = { -+ {1, center_ch_2g}, -+ {2, (u8 *)op_chs_of_cch_2g_40m}, -+}; -+ -+struct op_chs_ent_t op_chs_of_cch_5g_by_bw[] = { -+ {1, center_ch_5g_20m}, -+ {2, (u8 *)op_chs_of_cch_5g_40m}, -+ {4, (u8 *)op_chs_of_cch_5g_80m}, -+ {8, (u8 *)op_chs_of_cch_5g_160m}, -+}; -+ -+inline u8 center_chs_2g_num(u8 bw) -+{ -+ if (bw > CHANNEL_WIDTH_40) -+ return 0; -+ -+ return center_chs_2g_by_bw[bw].ch_num; -+} -+ -+inline u8 center_chs_2g(u8 bw, u8 id) -+{ -+ if (bw > CHANNEL_WIDTH_40) -+ return 0; -+ -+ if (id >= center_chs_2g_num(bw)) -+ return 0; -+ -+ return center_chs_2g_by_bw[bw].chs[id]; -+} -+ -+inline u8 center_chs_5g_num(u8 bw) -+{ -+ if (bw > CHANNEL_WIDTH_80) -+ return 0; -+ -+ return center_chs_5g_by_bw[bw].ch_num; -+} -+ -+inline u8 center_chs_5g(u8 bw, u8 id) -+{ -+ if (bw > CHANNEL_WIDTH_80) -+ return 0; -+ -+ if (id >= center_chs_5g_num(bw)) -+ return 0; -+ -+ return center_chs_5g_by_bw[bw].chs[id]; -+} -+ -+/* -+ * Get available op channels by @param cch, @param bw -+ * @cch: the given center channel -+ * @bw: the given bandwidth -+ * @op_chs: the pointer to return pointer of op channel array -+ * @op_ch_num: the pointer to return pointer of op channel number -+ * -+ * return valid (1) or not (0) -+ */ -+u8 rtw_get_op_chs_by_cch_bw(u8 cch, u8 bw, u8 **op_chs, u8 *op_ch_num) -+{ -+ int i; -+ struct center_chs_ent_t *c_chs_ent = NULL; -+ struct op_chs_ent_t *op_chs_ent = NULL; -+ u8 valid = 1; -+ -+ if (cch <= 14 -+ && bw >= CHANNEL_WIDTH_20 && bw <= CHANNEL_WIDTH_40 -+ ) { -+ c_chs_ent = ¢er_chs_2g_by_bw[bw]; -+ op_chs_ent = &op_chs_of_cch_2g_by_bw[bw]; -+ } else if (cch >= 36 && cch <= 177 -+ && bw >= CHANNEL_WIDTH_20 && bw <= CHANNEL_WIDTH_160 -+ ) { -+ c_chs_ent = ¢er_chs_5g_by_bw[bw]; -+ op_chs_ent = &op_chs_of_cch_5g_by_bw[bw]; -+ } else { -+ valid = 0; -+ goto exit; -+ } -+ -+ for (i = 0; i < c_chs_ent->ch_num; i++) -+ if (cch == *(c_chs_ent->chs + i)) -+ break; -+ -+ if (i == c_chs_ent->ch_num) { -+ valid = 0; -+ goto exit; -+ } -+ -+ *op_chs = op_chs_ent->chs + op_chs_ent->ch_num * i; -+ *op_ch_num = op_chs_ent->ch_num; -+ -+exit: -+ return valid; -+} -+ -+u8 rtw_get_ch_group(u8 ch, u8 *group, u8 *cck_group) -+{ -+ BAND_TYPE band = BAND_MAX; -+ s8 gp = -1, cck_gp = -1; -+ -+ if (ch <= 14) { -+ band = BAND_ON_2_4G; -+ -+ if (1 <= ch && ch <= 2) -+ gp = 0; -+ else if (3 <= ch && ch <= 5) -+ gp = 1; -+ else if (6 <= ch && ch <= 8) -+ gp = 2; -+ else if (9 <= ch && ch <= 11) -+ gp = 3; -+ else if (12 <= ch && ch <= 14) -+ gp = 4; -+ else -+ band = BAND_MAX; -+ -+ if (ch == 14) -+ cck_gp = 5; -+ else -+ cck_gp = gp; -+ } else { -+ band = BAND_ON_5G; -+ -+ if (36 <= ch && ch <= 42) -+ gp = 0; -+ else if (44 <= ch && ch <= 48) -+ gp = 1; -+ else if (50 <= ch && ch <= 58) -+ gp = 2; -+ else if (60 <= ch && ch <= 64) -+ gp = 3; -+ else if (100 <= ch && ch <= 106) -+ gp = 4; -+ else if (108 <= ch && ch <= 114) -+ gp = 5; -+ else if (116 <= ch && ch <= 122) -+ gp = 6; -+ else if (124 <= ch && ch <= 130) -+ gp = 7; -+ else if (132 <= ch && ch <= 138) -+ gp = 8; -+ else if (140 <= ch && ch <= 144) -+ gp = 9; -+ else if (149 <= ch && ch <= 155) -+ gp = 10; -+ else if (157 <= ch && ch <= 161) -+ gp = 11; -+ else if (165 <= ch && ch <= 171) -+ gp = 12; -+ else if (173 <= ch && ch <= 177) -+ gp = 13; -+ else -+ band = BAND_MAX; -+ } -+ -+ if (band == BAND_MAX -+ || (band == BAND_ON_2_4G && cck_gp == -1) -+ || gp == -1 -+ ) { -+ RTW_WARN("%s invalid channel:%u", __func__, ch); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (group) -+ *group = gp; -+ if (cck_group && band == BAND_ON_2_4G) -+ *cck_group = cck_gp; -+ -+exit: -+ return band; -+} -+ -+int rtw_ch2freq(int chan) -+{ -+ /* see 802.11 17.3.8.3.2 and Annex J -+ * there are overlapping channel numbers in 5GHz and 2GHz bands */ -+ -+ /* -+ * RTK: don't consider the overlapping channel numbers: 5G channel <= 14, -+ * because we don't support it. simply judge from channel number -+ */ -+ -+ if (chan >= 1 && chan <= 14) { -+ if (chan == 14) -+ return 2484; -+ else if (chan < 14) -+ return 2407 + chan * 5; -+ } else if (chan >= 36 && chan <= 177) -+ return 5000 + chan * 5; -+ -+ return 0; /* not supported */ -+} -+ -+int rtw_freq2ch(int freq) -+{ -+ /* see 802.11 17.3.8.3.2 and Annex J */ -+ if (freq == 2484) -+ return 14; -+ else if (freq < 2484) -+ return (freq - 2407) / 5; -+ else if (freq >= 4910 && freq <= 4980) -+ return (freq - 4000) / 5; -+ else if (freq <= 45000) /* DMG band lower limit */ -+ return (freq - 5000) / 5; -+ else if (freq >= 58320 && freq <= 64800) -+ return (freq - 56160) / 2160; -+ else -+ return 0; -+} -+ -+bool rtw_chbw_to_freq_range(u8 ch, u8 bw, u8 offset, u32 *hi, u32 *lo) -+{ -+ u8 c_ch; -+ u32 freq; -+ u32 hi_ret = 0, lo_ret = 0; -+ int i; -+ bool valid = _FALSE; -+ -+ if (hi) -+ *hi = 0; -+ if (lo) -+ *lo = 0; -+ -+ c_ch = rtw_get_center_ch(ch, bw, offset); -+ freq = rtw_ch2freq(c_ch); -+ -+ if (!freq) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (bw == CHANNEL_WIDTH_80) { -+ hi_ret = freq + 40; -+ lo_ret = freq - 40; -+ } else if (bw == CHANNEL_WIDTH_40) { -+ hi_ret = freq + 20; -+ lo_ret = freq - 20; -+ } else if (bw == CHANNEL_WIDTH_20) { -+ hi_ret = freq + 10; -+ lo_ret = freq - 10; -+ } else -+ rtw_warn_on(1); -+ -+ if (hi) -+ *hi = hi_ret; -+ if (lo) -+ *lo = lo_ret; -+ -+ valid = _TRUE; -+ -+exit: -+ return valid; -+} -+ -+const char *const _ch_width_str[] = { -+ "20MHz", -+ "40MHz", -+ "80MHz", -+ "160MHz", -+ "80_80MHz", -+ "CHANNEL_WIDTH_MAX", -+}; -+ -+const u8 _ch_width_to_bw_cap[] = { -+ BW_CAP_20M, -+ BW_CAP_40M, -+ BW_CAP_80M, -+ BW_CAP_160M, -+ BW_CAP_80_80M, -+ 0, -+}; -+ -+const char *const _band_str[] = { -+ "2.4G", -+ "5G", -+ "BOTH", -+ "BAND_MAX", -+}; -+ -+const u8 _band_to_band_cap[] = { -+ BAND_CAP_2G, -+ BAND_CAP_5G, -+ 0, -+ 0, -+}; -+ -+#ifdef CONFIG_80211AC_VHT -+#define COUNTRY_CHPLAN_ASSIGN_EN_11AC(_val) , .en_11ac = (_val) -+#else -+#define COUNTRY_CHPLAN_ASSIGN_EN_11AC(_val) -+#endif -+ -+#if RTW_DEF_MODULE_REGULATORY_CERT -+#define COUNTRY_CHPLAN_ASSIGN_DEF_MODULE_FLAGS(_val) , .def_module_flags = (_val) -+#else -+#define COUNTRY_CHPLAN_ASSIGN_DEF_MODULE_FLAGS(_val) -+#endif -+ -+/* has def_module_flags specified, used by common map and HAL dfference map */ -+#define COUNTRY_CHPLAN_ENT(_alpha2, _chplan, _en_11ac, _def_module_flags) \ -+ {.alpha2 = (_alpha2), .chplan = (_chplan) \ -+ COUNTRY_CHPLAN_ASSIGN_EN_11AC(_en_11ac) \ -+ COUNTRY_CHPLAN_ASSIGN_DEF_MODULE_FLAGS(_def_module_flags) \ -+ } -+ -+#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP -+ -+#include "../platform/custom_country_chplan.h" -+ -+#elif RTW_DEF_MODULE_REGULATORY_CERT -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8821AE_HMC_M2) -+static const struct country_chplan RTL8821AE_HMC_M2_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("CN", 0x51, 1, 0xFB), /* China */ -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0, 0xFB), /* Russia(fac/gost), Kaliningrad */ -+ COUNTRY_CHPLAN_ENT("UA", 0x26, 0, 0xFB), /* Ukraine */ -+}; -+static const u16 RTL8821AE_HMC_M2_country_chplan_map_sz = sizeof(RTL8821AE_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8821AU) -+static const struct country_chplan RTL8821AU_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 0, 0xFB), /* Russia(fac/gost), Kaliningrad */ -+ COUNTRY_CHPLAN_ENT("UA", 0x26, 0, 0xFB), /* Ukraine */ -+}; -+static const u16 RTL8821AU_country_chplan_map_sz = sizeof(RTL8821AU_country_chplan_map) / sizeof(struct country_chplan); -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8812AENF_NGFF) -+static const struct country_chplan RTL8812AENF_NGFF_country_chplan_map[] = { -+}; -+static const u16 RTL8812AENF_NGFF_country_chplan_map_sz = sizeof(RTL8812AENF_NGFF_country_chplan_map) / sizeof(struct country_chplan); -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8812AEBT_HMC) -+static const struct country_chplan RTL8812AEBT_HMC_country_chplan_map[] = { -+}; -+static const u16 RTL8812AEBT_HMC_country_chplan_map_sz = sizeof(RTL8812AEBT_HMC_country_chplan_map) / sizeof(struct country_chplan); -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8188EE_HMC_M2) -+static const struct country_chplan RTL8188EE_HMC_M2_country_chplan_map[] = { -+}; -+static const u16 RTL8188EE_HMC_M2_country_chplan_map_sz = sizeof(RTL8188EE_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8723BE_HMC_M2) -+static const struct country_chplan RTL8723BE_HMC_M2_country_chplan_map[] = { -+}; -+static const u16 RTL8723BE_HMC_M2_country_chplan_map_sz = sizeof(RTL8723BE_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8723BS_NGFF1216) -+static const struct country_chplan RTL8723BS_NGFF1216_country_chplan_map[] = { -+}; -+static const u16 RTL8723BS_NGFF1216_country_chplan_map_sz = sizeof(RTL8723BS_NGFF1216_country_chplan_map) / sizeof(struct country_chplan); -+#endif -+ -+#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8192EEBT_HMC_M2) -+static const struct country_chplan RTL8192EEBT_HMC_M2_country_chplan_map[] = { -+}; -+static const u16 RTL8192EEBT_HMC_M2_country_chplan_map_sz = sizeof(RTL8192EEBT_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); -+#endif -+ -+/** -+ * rtw_def_module_get_chplan_from_country - -+ * @country_code: string of country code -+ * @return: -+ * Return NULL for case referring to common map -+ */ -+static const struct country_chplan *rtw_def_module_get_chplan_from_country(const char *country_code) -+{ -+ const struct country_chplan *ent = NULL; -+ const struct country_chplan *hal_map = NULL; -+ u16 hal_map_sz = 0; -+ int i; -+ -+ /* TODO: runtime selection for multi driver */ -+#if (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8821AE_HMC_M2) -+ hal_map = RTL8821AE_HMC_M2_country_chplan_map; -+ hal_map_sz = RTL8821AE_HMC_M2_country_chplan_map_sz; -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8821AU) -+ hal_map = RTL8821AU_country_chplan_map; -+ hal_map_sz = RTL8821AU_country_chplan_map_sz; -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8812AENF_NGFF) -+ hal_map = RTL8812AENF_NGFF_country_chplan_map; -+ hal_map_sz = RTL8812AENF_NGFF_country_chplan_map_sz; -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8812AEBT_HMC) -+ hal_map = RTL8812AEBT_HMC_country_chplan_map; -+ hal_map_sz = RTL8812AEBT_HMC_country_chplan_map_sz; -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8188EE_HMC_M2) -+ hal_map = RTL8188EE_HMC_M2_country_chplan_map; -+ hal_map_sz = RTL8188EE_HMC_M2_country_chplan_map_sz; -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8723BE_HMC_M2) -+ hal_map = RTL8723BE_HMC_M2_country_chplan_map; -+ hal_map_sz = RTL8723BE_HMC_M2_country_chplan_map_sz; -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8723BS_NGFF1216) -+ hal_map = RTL8723BS_NGFF1216_country_chplan_map; -+ hal_map_sz = RTL8723BS_NGFF1216_country_chplan_map_sz; -+#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8192EEBT_HMC_M2) -+ hal_map = RTL8192EEBT_HMC_M2_country_chplan_map; -+ hal_map_sz = RTL8192EEBT_HMC_M2_country_chplan_map_sz; -+#endif -+ -+ if (hal_map == NULL || hal_map_sz == 0) -+ goto exit; -+ -+ for (i = 0; i < hal_map_sz; i++) { -+ if (strncmp(country_code, hal_map[i].alpha2, 2) == 0) { -+ ent = &hal_map[i]; -+ break; -+ } -+ } -+ -+exit: -+ return ent; -+} -+#endif /* CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP or RTW_DEF_MODULE_REGULATORY_CERT */ -+ -+static const struct country_chplan country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("AD", 0x26, 1, 0x00), /* Andorra */ -+ COUNTRY_CHPLAN_ENT("AE", 0x26, 1, 0xFB), /* United Arab Emirates */ -+ COUNTRY_CHPLAN_ENT("AF", 0x42, 1, 0x00), /* Afghanistan */ -+ COUNTRY_CHPLAN_ENT("AG", 0x30, 1, 0x00), /* Antigua & Barbuda */ -+ COUNTRY_CHPLAN_ENT("AI", 0x26, 1, 0x00), /* Anguilla(UK) */ -+ COUNTRY_CHPLAN_ENT("AL", 0x26, 1, 0xF1), /* Albania */ -+ COUNTRY_CHPLAN_ENT("AM", 0x26, 1, 0xB0), /* Armenia */ -+ COUNTRY_CHPLAN_ENT("AO", 0x26, 1, 0xE0), /* Angola */ -+ COUNTRY_CHPLAN_ENT("AQ", 0x26, 1, 0x00), /* Antarctica */ -+ COUNTRY_CHPLAN_ENT("AR", 0x57, 1, 0xF3), /* Argentina */ -+ COUNTRY_CHPLAN_ENT("AS", 0x34, 1, 0x00), /* American Samoa */ -+ COUNTRY_CHPLAN_ENT("AT", 0x26, 1, 0xFB), /* Austria */ -+ COUNTRY_CHPLAN_ENT("AU", 0x45, 1, 0xFB), /* Australia */ -+ COUNTRY_CHPLAN_ENT("AW", 0x34, 1, 0xB0), /* Aruba */ -+ COUNTRY_CHPLAN_ENT("AZ", 0x26, 1, 0xF1), /* Azerbaijan */ -+ COUNTRY_CHPLAN_ENT("BA", 0x26, 1, 0xF1), /* Bosnia & Herzegovina */ -+ COUNTRY_CHPLAN_ENT("BB", 0x34, 1, 0x50), /* Barbados */ -+ COUNTRY_CHPLAN_ENT("BD", 0x26, 1, 0xF1), /* Bangladesh */ -+ COUNTRY_CHPLAN_ENT("BE", 0x26, 1, 0xFB), /* Belgium */ -+ COUNTRY_CHPLAN_ENT("BF", 0x26, 1, 0xB0), /* Burkina Faso */ -+ COUNTRY_CHPLAN_ENT("BG", 0x26, 1, 0xF1), /* Bulgaria */ -+ COUNTRY_CHPLAN_ENT("BH", 0x47, 1, 0xF1), /* Bahrain */ -+ COUNTRY_CHPLAN_ENT("BI", 0x26, 1, 0xB0), /* Burundi */ -+ COUNTRY_CHPLAN_ENT("BJ", 0x26, 1, 0xB0), /* Benin */ -+ COUNTRY_CHPLAN_ENT("BN", 0x47, 1, 0x10), /* Brunei */ -+ COUNTRY_CHPLAN_ENT("BO", 0x30, 1, 0xF1), /* Bolivia */ -+ COUNTRY_CHPLAN_ENT("BR", 0x34, 1, 0xF1), /* Brazil */ -+ COUNTRY_CHPLAN_ENT("BS", 0x34, 1, 0x20), /* Bahamas */ -+ COUNTRY_CHPLAN_ENT("BW", 0x26, 1, 0xF1), /* Botswana */ -+ COUNTRY_CHPLAN_ENT("BY", 0x26, 1, 0xF1), /* Belarus */ -+ COUNTRY_CHPLAN_ENT("BZ", 0x34, 1, 0x00), /* Belize */ -+ COUNTRY_CHPLAN_ENT("CA", 0x34, 1, 0xFB), /* Canada */ -+ COUNTRY_CHPLAN_ENT("CC", 0x26, 1, 0x00), /* Cocos (Keeling) Islands (Australia) */ -+ COUNTRY_CHPLAN_ENT("CD", 0x26, 1, 0xB0), /* Congo, Republic of the */ -+ COUNTRY_CHPLAN_ENT("CF", 0x26, 1, 0xB0), /* Central African Republic */ -+ COUNTRY_CHPLAN_ENT("CG", 0x26, 1, 0xB0), /* Congo, Democratic Republic of the. Zaire */ -+ COUNTRY_CHPLAN_ENT("CH", 0x26, 1, 0xFB), /* Switzerland */ -+ COUNTRY_CHPLAN_ENT("CI", 0x26, 1, 0xF1), /* Cote d'Ivoire */ -+ COUNTRY_CHPLAN_ENT("CK", 0x26, 1, 0x00), /* Cook Islands */ -+ COUNTRY_CHPLAN_ENT("CL", 0x30, 1, 0xF1), /* Chile */ -+ COUNTRY_CHPLAN_ENT("CM", 0x26, 1, 0xB0), /* Cameroon */ -+ COUNTRY_CHPLAN_ENT("CN", 0x48, 1, 0xFB), /* China */ -+ COUNTRY_CHPLAN_ENT("CO", 0x34, 1, 0xF1), /* Colombia */ -+ COUNTRY_CHPLAN_ENT("CR", 0x34, 1, 0xF1), /* Costa Rica */ -+ COUNTRY_CHPLAN_ENT("CV", 0x26, 1, 0xB0), /* Cape Verde */ -+ COUNTRY_CHPLAN_ENT("CX", 0x45, 1, 0x00), /* Christmas Island (Australia) */ -+ COUNTRY_CHPLAN_ENT("CY", 0x26, 1, 0xFB), /* Cyprus */ -+ COUNTRY_CHPLAN_ENT("CZ", 0x26, 1, 0xFB), /* Czech Republic */ -+ COUNTRY_CHPLAN_ENT("DE", 0x26, 1, 0xFB), /* Germany */ -+ COUNTRY_CHPLAN_ENT("DJ", 0x26, 1, 0x80), /* Djibouti */ -+ COUNTRY_CHPLAN_ENT("DK", 0x26, 1, 0xFB), /* Denmark */ -+ COUNTRY_CHPLAN_ENT("DM", 0x34, 1, 0x00), /* Dominica */ -+ COUNTRY_CHPLAN_ENT("DO", 0x34, 1, 0xF1), /* Dominican Republic */ -+ COUNTRY_CHPLAN_ENT("DZ", 0x26, 1, 0xF1), /* Algeria */ -+ COUNTRY_CHPLAN_ENT("EC", 0x34, 1, 0xF1), /* Ecuador */ -+ COUNTRY_CHPLAN_ENT("EE", 0x26, 1, 0xFB), /* Estonia */ -+ COUNTRY_CHPLAN_ENT("EG", 0x47, 0, 0xF1), /* Egypt */ -+ COUNTRY_CHPLAN_ENT("EH", 0x47, 1, 0x80), /* Western Sahara */ -+ COUNTRY_CHPLAN_ENT("ER", 0x26, 1, 0x00), /* Eritrea */ -+ COUNTRY_CHPLAN_ENT("ES", 0x26, 1, 0xFB), /* Spain, Canary Islands, Ceuta, Melilla */ -+ COUNTRY_CHPLAN_ENT("ET", 0x26, 1, 0xB0), /* Ethiopia */ -+ COUNTRY_CHPLAN_ENT("FI", 0x26, 1, 0xFB), /* Finland */ -+ COUNTRY_CHPLAN_ENT("FJ", 0x34, 1, 0x00), /* Fiji */ -+ COUNTRY_CHPLAN_ENT("FK", 0x26, 1, 0x00), /* Falkland Islands (Islas Malvinas) (UK) */ -+ COUNTRY_CHPLAN_ENT("FM", 0x34, 1, 0x00), /* Micronesia, Federated States of (USA) */ -+ COUNTRY_CHPLAN_ENT("FO", 0x26, 1, 0x00), /* Faroe Islands (Denmark) */ -+ COUNTRY_CHPLAN_ENT("FR", 0x26, 1, 0xFB), /* France */ -+ COUNTRY_CHPLAN_ENT("GA", 0x26, 1, 0xB0), /* Gabon */ -+ COUNTRY_CHPLAN_ENT("GB", 0x26, 1, 0xFB), /* Great Britain (United Kingdom; England) */ -+ COUNTRY_CHPLAN_ENT("GD", 0x34, 1, 0xB0), /* Grenada */ -+ COUNTRY_CHPLAN_ENT("GE", 0x26, 1, 0x00), /* Georgia */ -+ COUNTRY_CHPLAN_ENT("GF", 0x26, 1, 0x80), /* French Guiana */ -+ COUNTRY_CHPLAN_ENT("GG", 0x26, 1, 0x00), /* Guernsey (UK) */ -+ COUNTRY_CHPLAN_ENT("GH", 0x26, 1, 0xF1), /* Ghana */ -+ COUNTRY_CHPLAN_ENT("GI", 0x26, 1, 0x00), /* Gibraltar (UK) */ -+ COUNTRY_CHPLAN_ENT("GL", 0x26, 1, 0x00), /* Greenland (Denmark) */ -+ COUNTRY_CHPLAN_ENT("GM", 0x26, 1, 0xB0), /* Gambia */ -+ COUNTRY_CHPLAN_ENT("GN", 0x26, 1, 0x10), /* Guinea */ -+ COUNTRY_CHPLAN_ENT("GP", 0x26, 1, 0x00), /* Guadeloupe (France) */ -+ COUNTRY_CHPLAN_ENT("GQ", 0x26, 1, 0xB0), /* Equatorial Guinea */ -+ COUNTRY_CHPLAN_ENT("GR", 0x26, 1, 0xFB), /* Greece */ -+ COUNTRY_CHPLAN_ENT("GS", 0x26, 1, 0x00), /* South Georgia and the Sandwich Islands (UK) */ -+ COUNTRY_CHPLAN_ENT("GT", 0x34, 1, 0xF1), /* Guatemala */ -+ COUNTRY_CHPLAN_ENT("GU", 0x34, 1, 0x00), /* Guam (USA) */ -+ COUNTRY_CHPLAN_ENT("GW", 0x26, 1, 0xB0), /* Guinea-Bissau */ -+ COUNTRY_CHPLAN_ENT("GY", 0x44, 1, 0x00), /* Guyana */ -+ COUNTRY_CHPLAN_ENT("HK", 0x26, 1, 0xFB), /* Hong Kong */ -+ COUNTRY_CHPLAN_ENT("HM", 0x45, 1, 0x00), /* Heard and McDonald Islands (Australia) */ -+ COUNTRY_CHPLAN_ENT("HN", 0x32, 1, 0xF1), /* Honduras */ -+ COUNTRY_CHPLAN_ENT("HR", 0x26, 1, 0xF9), /* Croatia */ -+ COUNTRY_CHPLAN_ENT("HT", 0x34, 1, 0x50), /* Haiti */ -+ COUNTRY_CHPLAN_ENT("HU", 0x26, 1, 0xFB), /* Hungary */ -+ COUNTRY_CHPLAN_ENT("ID", 0x54, 0, 0xF3), /* Indonesia */ -+ COUNTRY_CHPLAN_ENT("IE", 0x26, 1, 0xFB), /* Ireland */ -+ COUNTRY_CHPLAN_ENT("IL", 0x47, 1, 0xF1), /* Israel */ -+ COUNTRY_CHPLAN_ENT("IM", 0x26, 1, 0x00), /* Isle of Man (UK) */ -+ COUNTRY_CHPLAN_ENT("IN", 0x47, 1, 0xF1), /* India */ -+ COUNTRY_CHPLAN_ENT("IQ", 0x26, 1, 0x00), /* Iraq */ -+ COUNTRY_CHPLAN_ENT("IR", 0x26, 0, 0x00), /* Iran */ -+ COUNTRY_CHPLAN_ENT("IS", 0x26, 1, 0xFB), /* Iceland */ -+ COUNTRY_CHPLAN_ENT("IT", 0x26, 1, 0xFB), /* Italy */ -+ COUNTRY_CHPLAN_ENT("JE", 0x26, 1, 0x00), /* Jersey (UK) */ -+ COUNTRY_CHPLAN_ENT("JM", 0x51, 1, 0xF1), /* Jamaica */ -+ COUNTRY_CHPLAN_ENT("JO", 0x49, 1, 0xFB), /* Jordan */ -+ COUNTRY_CHPLAN_ENT("JP", 0x27, 1, 0xFF), /* Japan- Telec */ -+ COUNTRY_CHPLAN_ENT("KE", 0x47, 1, 0xF9), /* Kenya */ -+ COUNTRY_CHPLAN_ENT("KG", 0x26, 1, 0xF1), /* Kyrgyzstan */ -+ COUNTRY_CHPLAN_ENT("KH", 0x26, 1, 0xF1), /* Cambodia */ -+ COUNTRY_CHPLAN_ENT("KI", 0x26, 1, 0x00), /* Kiribati */ -+ COUNTRY_CHPLAN_ENT("KN", 0x34, 1, 0x00), /* Saint Kitts and Nevis */ -+ COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0xFB), /* South Korea */ -+ COUNTRY_CHPLAN_ENT("KW", 0x47, 1, 0xFB), /* Kuwait */ -+ COUNTRY_CHPLAN_ENT("KY", 0x34, 1, 0x00), /* Cayman Islands (UK) */ -+ COUNTRY_CHPLAN_ENT("KZ", 0x26, 1, 0x00), /* Kazakhstan */ -+ COUNTRY_CHPLAN_ENT("LA", 0x26, 1, 0x00), /* Laos */ -+ COUNTRY_CHPLAN_ENT("LB", 0x26, 1, 0xF1), /* Lebanon */ -+ COUNTRY_CHPLAN_ENT("LC", 0x34, 1, 0x00), /* Saint Lucia */ -+ COUNTRY_CHPLAN_ENT("LI", 0x26, 1, 0xFB), /* Liechtenstein */ -+ COUNTRY_CHPLAN_ENT("LK", 0x26, 1, 0xF1), /* Sri Lanka */ -+ COUNTRY_CHPLAN_ENT("LR", 0x26, 1, 0xB0), /* Liberia */ -+ COUNTRY_CHPLAN_ENT("LS", 0x26, 1, 0xF1), /* Lesotho */ -+ COUNTRY_CHPLAN_ENT("LT", 0x26, 1, 0xFB), /* Lithuania */ -+ COUNTRY_CHPLAN_ENT("LU", 0x26, 1, 0xFB), /* Luxembourg */ -+ COUNTRY_CHPLAN_ENT("LV", 0x26, 1, 0xFB), /* Latvia */ -+ COUNTRY_CHPLAN_ENT("LY", 0x26, 1, 0x00), /* Libya */ -+ COUNTRY_CHPLAN_ENT("MA", 0x47, 1, 0xF1), /* Morocco */ -+ COUNTRY_CHPLAN_ENT("MC", 0x26, 1, 0xFB), /* Monaco */ -+ COUNTRY_CHPLAN_ENT("MD", 0x26, 1, 0xF1), /* Moldova */ -+ COUNTRY_CHPLAN_ENT("ME", 0x26, 1, 0xF1), /* Montenegro */ -+ COUNTRY_CHPLAN_ENT("MF", 0x34, 1, 0x00), /* Saint Martin */ -+ COUNTRY_CHPLAN_ENT("MG", 0x26, 1, 0x20), /* Madagascar */ -+ COUNTRY_CHPLAN_ENT("MH", 0x34, 1, 0x00), /* Marshall Islands (USA) */ -+ COUNTRY_CHPLAN_ENT("MK", 0x26, 1, 0xF1), /* Republic of Macedonia (FYROM) */ -+ COUNTRY_CHPLAN_ENT("ML", 0x26, 1, 0xB0), /* Mali */ -+ COUNTRY_CHPLAN_ENT("MM", 0x26, 1, 0x00), /* Burma (Myanmar) */ -+ COUNTRY_CHPLAN_ENT("MN", 0x26, 1, 0x00), /* Mongolia */ -+ COUNTRY_CHPLAN_ENT("MO", 0x26, 1, 0x00), /* Macau */ -+ COUNTRY_CHPLAN_ENT("MP", 0x34, 1, 0x00), /* Northern Mariana Islands (USA) */ -+ COUNTRY_CHPLAN_ENT("MQ", 0x26, 1, 0x40), /* Martinique (France) */ -+ COUNTRY_CHPLAN_ENT("MR", 0x26, 1, 0xA0), /* Mauritania */ -+ COUNTRY_CHPLAN_ENT("MS", 0x26, 1, 0x00), /* Montserrat (UK) */ -+ COUNTRY_CHPLAN_ENT("MT", 0x26, 1, 0xFB), /* Malta */ -+ COUNTRY_CHPLAN_ENT("MU", 0x26, 1, 0xB0), /* Mauritius */ -+ COUNTRY_CHPLAN_ENT("MV", 0x26, 1, 0x00), /* Maldives */ -+ COUNTRY_CHPLAN_ENT("MW", 0x26, 1, 0xB0), /* Malawi */ -+ COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0xF1), /* Mexico */ -+ COUNTRY_CHPLAN_ENT("MY", 0x47, 1, 0xF1), /* Malaysia */ -+ COUNTRY_CHPLAN_ENT("MZ", 0x26, 1, 0xF1), /* Mozambique */ -+ COUNTRY_CHPLAN_ENT("NA", 0x26, 0, 0x00), /* Namibia */ -+ COUNTRY_CHPLAN_ENT("NC", 0x26, 1, 0x00), /* New Caledonia */ -+ COUNTRY_CHPLAN_ENT("NE", 0x26, 1, 0xB0), /* Niger */ -+ COUNTRY_CHPLAN_ENT("NF", 0x45, 1, 0x00), /* Norfolk Island (Australia) */ -+ COUNTRY_CHPLAN_ENT("NG", 0x50, 1, 0xF9), /* Nigeria */ -+ COUNTRY_CHPLAN_ENT("NI", 0x34, 1, 0xF1), /* Nicaragua */ -+ COUNTRY_CHPLAN_ENT("NL", 0x26, 1, 0xFB), /* Netherlands */ -+ COUNTRY_CHPLAN_ENT("NO", 0x26, 1, 0xFB), /* Norway */ -+ COUNTRY_CHPLAN_ENT("NP", 0x47, 1, 0xF0), /* Nepal */ -+ COUNTRY_CHPLAN_ENT("NR", 0x26, 1, 0x00), /* Nauru */ -+ COUNTRY_CHPLAN_ENT("NU", 0x45, 1, 0x00), /* Niue */ -+ COUNTRY_CHPLAN_ENT("NZ", 0x45, 1, 0xFB), /* New Zealand */ -+ COUNTRY_CHPLAN_ENT("OM", 0x26, 1, 0xF9), /* Oman */ -+ COUNTRY_CHPLAN_ENT("PA", 0x34, 1, 0xF1), /* Panama */ -+ COUNTRY_CHPLAN_ENT("PE", 0x34, 1, 0xF1), /* Peru */ -+ COUNTRY_CHPLAN_ENT("PF", 0x26, 1, 0x00), /* French Polynesia (France) */ -+ COUNTRY_CHPLAN_ENT("PG", 0x26, 1, 0xF1), /* Papua New Guinea */ -+ COUNTRY_CHPLAN_ENT("PH", 0x26, 1, 0xF1), /* Philippines */ -+ COUNTRY_CHPLAN_ENT("PK", 0x51, 1, 0xF1), /* Pakistan */ -+ COUNTRY_CHPLAN_ENT("PL", 0x26, 1, 0xFB), /* Poland */ -+ COUNTRY_CHPLAN_ENT("PM", 0x26, 1, 0x00), /* Saint Pierre and Miquelon (France) */ -+ COUNTRY_CHPLAN_ENT("PR", 0x34, 1, 0xF1), /* Puerto Rico */ -+ COUNTRY_CHPLAN_ENT("PT", 0x26, 1, 0xFB), /* Portugal */ -+ COUNTRY_CHPLAN_ENT("PW", 0x34, 1, 0x00), /* Palau */ -+ COUNTRY_CHPLAN_ENT("PY", 0x34, 1, 0xF1), /* Paraguay */ -+ COUNTRY_CHPLAN_ENT("QA", 0x51, 1, 0xF9), /* Qatar */ -+ COUNTRY_CHPLAN_ENT("RE", 0x26, 1, 0x00), /* Reunion (France) */ -+ COUNTRY_CHPLAN_ENT("RO", 0x26, 1, 0xF1), /* Romania */ -+ COUNTRY_CHPLAN_ENT("RS", 0x26, 1, 0xF1), /* Serbia, Kosovo */ -+ COUNTRY_CHPLAN_ENT("RU", 0x59, 1, 0xFB), /* Russia(fac/gost), Kaliningrad */ -+ COUNTRY_CHPLAN_ENT("RW", 0x26, 1, 0xB0), /* Rwanda */ -+ COUNTRY_CHPLAN_ENT("SA", 0x26, 1, 0xFB), /* Saudi Arabia */ -+ COUNTRY_CHPLAN_ENT("SB", 0x26, 1, 0x00), /* Solomon Islands */ -+ COUNTRY_CHPLAN_ENT("SC", 0x34, 1, 0x90), /* Seychelles */ -+ COUNTRY_CHPLAN_ENT("SE", 0x26, 1, 0xFB), /* Sweden */ -+ COUNTRY_CHPLAN_ENT("SG", 0x47, 1, 0xFB), /* Singapore */ -+ COUNTRY_CHPLAN_ENT("SH", 0x26, 1, 0x00), /* Saint Helena (UK) */ -+ COUNTRY_CHPLAN_ENT("SI", 0x26, 1, 0xFB), /* Slovenia */ -+ COUNTRY_CHPLAN_ENT("SJ", 0x26, 1, 0x00), /* Svalbard (Norway) */ -+ COUNTRY_CHPLAN_ENT("SK", 0x26, 1, 0xFB), /* Slovakia */ -+ COUNTRY_CHPLAN_ENT("SL", 0x26, 1, 0xB0), /* Sierra Leone */ -+ COUNTRY_CHPLAN_ENT("SM", 0x26, 1, 0x00), /* San Marino */ -+ COUNTRY_CHPLAN_ENT("SN", 0x26, 1, 0xF1), /* Senegal */ -+ COUNTRY_CHPLAN_ENT("SO", 0x26, 1, 0x00), /* Somalia */ -+ COUNTRY_CHPLAN_ENT("SR", 0x34, 1, 0x00), /* Suriname */ -+ COUNTRY_CHPLAN_ENT("ST", 0x34, 1, 0x80), /* Sao Tome and Principe */ -+ COUNTRY_CHPLAN_ENT("SV", 0x30, 1, 0xF1), /* El Salvador */ -+ COUNTRY_CHPLAN_ENT("SX", 0x34, 1, 0x00), /* Sint Marteen */ -+ COUNTRY_CHPLAN_ENT("SZ", 0x26, 1, 0x20), /* Swaziland */ -+ COUNTRY_CHPLAN_ENT("TC", 0x26, 1, 0x00), /* Turks and Caicos Islands (UK) */ -+ COUNTRY_CHPLAN_ENT("TD", 0x26, 1, 0xB0), /* Chad */ -+ COUNTRY_CHPLAN_ENT("TF", 0x26, 1, 0x80), /* French Southern and Antarctic Lands (FR Southern Territories) */ -+ COUNTRY_CHPLAN_ENT("TG", 0x26, 1, 0xB0), /* Togo */ -+ COUNTRY_CHPLAN_ENT("TH", 0x26, 1, 0xF1), /* Thailand */ -+ COUNTRY_CHPLAN_ENT("TJ", 0x26, 1, 0x40), /* Tajikistan */ -+ COUNTRY_CHPLAN_ENT("TK", 0x45, 1, 0x00), /* Tokelau */ -+ COUNTRY_CHPLAN_ENT("TM", 0x26, 1, 0x00), /* Turkmenistan */ -+ COUNTRY_CHPLAN_ENT("TN", 0x47, 1, 0xF1), /* Tunisia */ -+ COUNTRY_CHPLAN_ENT("TO", 0x26, 1, 0x00), /* Tonga */ -+ COUNTRY_CHPLAN_ENT("TR", 0x26, 1, 0xF1), /* Turkey, Northern Cyprus */ -+ COUNTRY_CHPLAN_ENT("TT", 0x42, 1, 0xF1), /* Trinidad & Tobago */ -+ COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0xFF), /* Taiwan */ -+ COUNTRY_CHPLAN_ENT("TZ", 0x26, 1, 0xF0), /* Tanzania */ -+ COUNTRY_CHPLAN_ENT("UA", 0x26, 1, 0xFB), /* Ukraine */ -+ COUNTRY_CHPLAN_ENT("UG", 0x26, 1, 0xF1), /* Uganda */ -+ COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0xFF), /* United States of America (USA) */ -+ COUNTRY_CHPLAN_ENT("UY", 0x34, 1, 0xF1), /* Uruguay */ -+ COUNTRY_CHPLAN_ENT("UZ", 0x47, 1, 0xF0), /* Uzbekistan */ -+ COUNTRY_CHPLAN_ENT("VA", 0x26, 1, 0x00), /* Holy See (Vatican City) */ -+ COUNTRY_CHPLAN_ENT("VC", 0x34, 1, 0x10), /* Saint Vincent and the Grenadines */ -+ COUNTRY_CHPLAN_ENT("VE", 0x30, 1, 0xF1), /* Venezuela */ -+ COUNTRY_CHPLAN_ENT("VI", 0x34, 1, 0x00), /* United States Virgin Islands (USA) */ -+ COUNTRY_CHPLAN_ENT("VN", 0x26, 1, 0xF1), /* Vietnam */ -+ COUNTRY_CHPLAN_ENT("VU", 0x26, 1, 0x00), /* Vanuatu */ -+ COUNTRY_CHPLAN_ENT("WF", 0x26, 1, 0x00), /* Wallis and Futuna (France) */ -+ COUNTRY_CHPLAN_ENT("WS", 0x34, 1, 0x00), /* Samoa */ -+ COUNTRY_CHPLAN_ENT("YE", 0x26, 1, 0x40), /* Yemen */ -+ COUNTRY_CHPLAN_ENT("YT", 0x26, 1, 0x80), /* Mayotte (France) */ -+ COUNTRY_CHPLAN_ENT("ZA", 0x26, 1, 0xF1), /* South Africa */ -+ COUNTRY_CHPLAN_ENT("ZM", 0x26, 1, 0xB0), /* Zambia */ -+ COUNTRY_CHPLAN_ENT("ZW", 0x26, 1, 0xF1), /* Zimbabwe */ -+}; -+ -+u16 const country_chplan_map_sz = sizeof(country_chplan_map) / sizeof(struct country_chplan); -+ -+/* -+* rtw_get_chplan_from_country - -+* @country_code: string of country code -+* -+* Return pointer of struct country_chplan entry or NULL when unsupported country_code is given -+*/ -+const struct country_chplan *rtw_get_chplan_from_country(const char *country_code) -+{ -+ const struct country_chplan *ent = NULL; -+ const struct country_chplan *map = NULL; -+ u16 map_sz = 0; -+ char code[2]; -+ int i; -+ -+ code[0] = alpha_to_upper(country_code[0]); -+ code[1] = alpha_to_upper(country_code[1]); -+ -+#if !defined(CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP) && RTW_DEF_MODULE_REGULATORY_CERT -+ ent = rtw_def_module_get_chplan_from_country(code); -+ if (ent != NULL) -+ goto exit; -+#endif -+ -+#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP -+ map = CUSTOMIZED_country_chplan_map; -+ map_sz = CUSTOMIZED_country_chplan_map_sz; -+#else -+ map = country_chplan_map; -+ map_sz = country_chplan_map_sz; -+#endif -+ -+ for (i = 0; i < map_sz; i++) { -+ if (strncmp(code, map[i].alpha2, 2) == 0) { -+ ent = &map[i]; -+ break; -+ } -+ } -+ -+exit: -+ #if RTW_DEF_MODULE_REGULATORY_CERT -+ if (ent && !(COUNTRY_CHPLAN_DEF_MODULE_FALGS(ent) & RTW_DEF_MODULE_REGULATORY_CERT)) -+ ent = NULL; -+ #endif -+ -+ return ent; -+} -+ -+int rtw_ch_to_bb_gain_sel(int ch) -+{ -+ int sel = -1; -+ -+ if (ch >= 1 && ch <= 14) -+ sel = BB_GAIN_2G; -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ else if (ch >= 36 && ch < 48) -+ sel = BB_GAIN_5GLB1; -+ else if (ch >= 52 && ch <= 64) -+ sel = BB_GAIN_5GLB2; -+ else if (ch >= 100 && ch <= 120) -+ sel = BB_GAIN_5GMB1; -+ else if (ch >= 124 && ch <= 144) -+ sel = BB_GAIN_5GMB2; -+ else if (ch >= 149 && ch <= 177) -+ sel = BB_GAIN_5GHB; -+#endif -+ -+ return sel; -+} -+ -+s8 rtw_rf_get_kfree_tx_gain_offset(_adapter *padapter, u8 path, u8 ch) -+{ -+ s8 kfree_offset = 0; -+ -+#ifdef CONFIG_RF_POWER_TRIM -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(padapter); -+ s8 bb_gain_sel = rtw_ch_to_bb_gain_sel(ch); -+ -+ if (bb_gain_sel < BB_GAIN_2G || bb_gain_sel >= BB_GAIN_NUM) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (kfree_data->flag & KFREE_FLAG_ON) { -+ kfree_offset = kfree_data->bb_gain[bb_gain_sel][path]; -+ if (IS_HARDWARE_TYPE_8723D(padapter)) -+ RTW_INFO("%s path:%s, ch:%u, bb_gain_sel:%d, kfree_offset:%d\n" -+ , __func__, (path == 0)?"S1":"S0", -+ ch, bb_gain_sel, kfree_offset); -+ else -+ RTW_INFO("%s path:%u, ch:%u, bb_gain_sel:%d, kfree_offset:%d\n" -+ , __func__, path, ch, bb_gain_sel, kfree_offset); -+ } -+exit: -+#endif /* CONFIG_RF_POWER_TRIM */ -+ return kfree_offset; -+} -+ -+void rtw_rf_set_tx_gain_offset(_adapter *adapter, u8 path, s8 offset) -+{ -+ u8 write_value; -+ u8 target_path = 0; -+ u32 val32 = 0; -+ -+ if (IS_HARDWARE_TYPE_8723D(adapter)) { -+ target_path = RF_PATH_A; /*in 8723D case path means S0/S1*/ -+ if (path == PPG_8723D_S1) -+ RTW_INFO("kfree gain_offset 0x55:0x%x ", -+ rtw_hal_read_rfreg(adapter, target_path, 0x55, 0xffffffff)); -+ else if (path == PPG_8723D_S0) -+ RTW_INFO("kfree gain_offset 0x65:0x%x ", -+ rtw_hal_read_rfreg(adapter, target_path, 0x65, 0xffffffff)); -+ } else { -+ target_path = path; -+ RTW_INFO("kfree gain_offset 0x55:0x%x ", rtw_hal_read_rfreg(adapter, target_path, 0x55, 0xffffffff)); -+ } -+ -+ switch (rtw_get_chip_type(adapter)) { -+#ifdef CONFIG_RTL8723D -+ case RTL8723D: -+ write_value = RF_TX_GAIN_OFFSET_8723D(offset); -+ if (path == PPG_8723D_S1) -+ rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0f8000, write_value); -+ else if (path == PPG_8723D_S0) -+ rtw_hal_write_rfreg(adapter, target_path, 0x65, 0x0f8000, write_value); -+ break; -+#endif /* CONFIG_RTL8723D */ -+#ifdef CONFIG_RTL8703B -+ case RTL8703B: -+ write_value = RF_TX_GAIN_OFFSET_8703B(offset); -+ rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0fc000, write_value); -+ break; -+#endif /* CONFIG_RTL8703B */ -+#ifdef CONFIG_RTL8188F -+ case RTL8188F: -+ write_value = RF_TX_GAIN_OFFSET_8188F(offset); -+ rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0fc000, write_value); -+ break; -+#endif /* CONFIG_RTL8188F */ -+#ifdef CONFIG_RTL8192E -+ case RTL8192E: -+ write_value = RF_TX_GAIN_OFFSET_8192E(offset); -+ rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0f8000, write_value); -+ break; -+#endif /* CONFIG_RTL8188F */ -+ -+#ifdef CONFIG_RTL8821A -+ case RTL8821: -+ write_value = RF_TX_GAIN_OFFSET_8821A(offset); -+ rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0f8000, write_value); -+ break; -+#endif /* CONFIG_RTL8821A */ -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ case RTL8814A: -+ case RTL8822B: -+ case RTL8821C: -+ RTW_INFO("\nkfree by PhyDM on the sw CH. path %d\n", path); -+ break; -+#endif /* CONFIG_RTL8814A || CONFIG_RTL8822B || CONFIG_RTL8821C */ -+ -+ default: -+ rtw_warn_on(1); -+ break; -+ } -+ -+ if (IS_HARDWARE_TYPE_8723D(adapter)) { -+ if (path == PPG_8723D_S1) -+ val32 = rtw_hal_read_rfreg(adapter, target_path, 0x55, 0xffffffff); -+ else if (path == PPG_8723D_S0) -+ val32 = rtw_hal_read_rfreg(adapter, target_path, 0x65, 0xffffffff); -+ } else { -+ val32 = rtw_hal_read_rfreg(adapter, target_path, 0x55, 0xffffffff); -+ } -+ RTW_INFO(" after :0x%x\n", val32); -+} -+ -+void rtw_rf_apply_tx_gain_offset(_adapter *adapter, u8 ch) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ s8 kfree_offset = 0; -+ s8 tx_pwr_track_offset = 0; /* TODO: 8814A should consider tx pwr track when setting tx gain offset */ -+ s8 total_offset; -+ int i, total = 0; -+ -+ if (IS_HARDWARE_TYPE_8723D(adapter)) -+ total = 2; /* S1 and S0 */ -+ else -+ total = hal_data->NumTotalRFPath; -+ -+ for (i = 0; i < total; i++) { -+ kfree_offset = rtw_rf_get_kfree_tx_gain_offset(adapter, i, ch); -+ total_offset = kfree_offset + tx_pwr_track_offset; -+ rtw_rf_set_tx_gain_offset(adapter, i, total_offset); -+ } -+} -+ -+bool rtw_is_dfs_range(u32 hi, u32 lo) -+{ -+ return rtw_is_range_overlap(hi, lo, 5720 + 10, 5260 - 10) ? _TRUE : _FALSE; -+} -+ -+bool rtw_is_dfs_ch(u8 ch, u8 bw, u8 offset) -+{ -+ u32 hi, lo; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) -+ return _FALSE; -+ -+ return rtw_is_dfs_range(hi, lo) ? _TRUE : _FALSE; -+} -+ -+bool rtw_is_long_cac_range(u32 hi, u32 lo, u8 dfs_region) -+{ -+ return (dfs_region == PHYDM_DFS_DOMAIN_ETSI && rtw_is_range_overlap(hi, lo, 5660 + 10, 5600 - 10)) ? _TRUE : _FALSE; -+} -+ -+bool rtw_is_long_cac_ch(u8 ch, u8 bw, u8 offset, u8 dfs_region) -+{ -+ u32 hi, lo; -+ -+ if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) -+ return _FALSE; -+ -+ return rtw_is_long_cac_range(hi, lo, dfs_region) ? _TRUE : _FALSE; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_sdio.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_sdio.c 2018-02-11 21:44:27.141145994 +0200 -@@ -0,0 +1,98 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ ******************************************************************************/ -+#define _RTW_SDIO_C_ -+ -+#include /* struct dvobj_priv and etc. */ -+#include /* RTW_SDIO_ADDR_CMD52_GEN */ -+ -+/* -+ * Description: -+ * Use SDIO cmd52 or cmd53 to read/write data -+ * -+ * Parameters: -+ * d pointer of device object(struct dvobj_priv) -+ * addr SDIO address, 17 bits -+ * buf buffer for I/O -+ * len length -+ * write 0:read, 1:write -+ * cmd52 0:cmd52, 1:cmd53 -+ * -+ * Return: -+ * _SUCCESS I/O ok. -+ * _FAIL I/O fail. -+ */ -+static u8 sdio_io(struct dvobj_priv *d, u32 addr, void *buf, size_t len, u8 write, u8 cmd52) -+{ -+ int err; -+ -+ -+ if (cmd52) -+ addr = RTW_SDIO_ADDR_CMD52_GEN(addr); -+ -+ if (write) -+ err = d->intf_ops->write(d, addr, buf, len, 0); -+ else -+ err = d->intf_ops->read(d, addr, buf, len, 0); -+ if (err) { -+ RTW_INFO("%s: [ERROR] %s FAIL! error(%d)\n", -+ __FUNCTION__, write ? "write" : "read", err); -+ return _FAIL; -+ } -+ -+ return _SUCCESS; -+} -+ -+u8 rtw_sdio_read_cmd52(struct dvobj_priv *d, u32 addr, void *buf, size_t len) -+{ -+ return sdio_io(d, addr, buf, len, 0, 1); -+} -+ -+u8 rtw_sdio_read_cmd53(struct dvobj_priv *d, u32 addr, void *buf, size_t len) -+{ -+ return sdio_io(d, addr, buf, len, 0, 0); -+} -+ -+u8 rtw_sdio_write_cmd52(struct dvobj_priv *d, u32 addr, void *buf, size_t len) -+{ -+ return sdio_io(d, addr, buf, len, 1, 1); -+} -+ -+u8 rtw_sdio_write_cmd53(struct dvobj_priv *d, u32 addr, void *buf, size_t len) -+{ -+ return sdio_io(d, addr, buf, len, 1, 0); -+} -+ -+u8 rtw_sdio_f0_read(struct dvobj_priv *d, u32 addr, void *buf, size_t len) -+{ -+ int err; -+ u8 ret; -+ -+ -+ ret = _SUCCESS; -+ addr = RTW_SDIO_ADDR_F0_GEN(addr); -+ -+ err = d->intf_ops->read(d, addr, buf, len, 0); -+ if (err) { -+ RTW_INFO("%s: [ERROR] Read f0 register FAIL!\n", __FUNCTION__); -+ ret = _FAIL; -+ } -+ -+ -+ return ret; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_security.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_security.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_security.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_security.c 2018-02-11 21:44:27.141145994 +0200 -@@ -0,0 +1,3197 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_SECURITY_C_ -+ -+#include -+ -+static const char *_security_type_str[] = { -+ "N/A", -+ "WEP40", -+ "TKIP", -+ "TKIP_WM", -+ "AES", -+ "WEP104", -+ "SMS4", -+ "WEP_WPA", -+ "BIP", -+}; -+ -+const char *security_type_str(u8 value) -+{ -+#ifdef CONFIG_IEEE80211W -+ if (value <= _BIP_) -+#else -+ if (value <= _WEP_WPA_MIXED_) -+#endif -+ return _security_type_str[value]; -+ return NULL; -+} -+ -+#ifdef DBG_SW_SEC_CNT -+#define WEP_SW_ENC_CNT_INC(sec, ra) do {\ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->wep_sw_enc_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->wep_sw_enc_cnt_mc++; \ -+ else \ -+ sec->wep_sw_enc_cnt_uc++; \ -+ } while (0) -+ -+#define WEP_SW_DEC_CNT_INC(sec, ra) do {\ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->wep_sw_dec_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->wep_sw_dec_cnt_mc++; \ -+ else \ -+ sec->wep_sw_dec_cnt_uc++; \ -+ } while (0) -+ -+#define TKIP_SW_ENC_CNT_INC(sec, ra) do {\ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->tkip_sw_enc_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->tkip_sw_enc_cnt_mc++; \ -+ else \ -+ sec->tkip_sw_enc_cnt_uc++; \ -+ } while (0) -+ -+#define TKIP_SW_DEC_CNT_INC(sec, ra) do {\ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->tkip_sw_dec_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->tkip_sw_dec_cnt_mc++; \ -+ else \ -+ sec->tkip_sw_dec_cnt_uc++; \ -+ } while (0) -+ -+#define AES_SW_ENC_CNT_INC(sec, ra) do {\ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->aes_sw_enc_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->aes_sw_enc_cnt_mc++; \ -+ else \ -+ sec->aes_sw_enc_cnt_uc++; \ -+ } while (0) -+ -+#define AES_SW_DEC_CNT_INC(sec, ra) do {\ -+ if (is_broadcast_mac_addr(ra)) \ -+ sec->aes_sw_dec_cnt_bc++; \ -+ else if (is_multicast_mac_addr(ra)) \ -+ sec->aes_sw_dec_cnt_mc++; \ -+ else \ -+ sec->aes_sw_dec_cnt_uc++; \ -+ } while (0) -+#else -+#define WEP_SW_ENC_CNT_INC(sec, ra) -+#define WEP_SW_DEC_CNT_INC(sec, ra) -+#define TKIP_SW_ENC_CNT_INC(sec, ra) -+#define TKIP_SW_DEC_CNT_INC(sec, ra) -+#define AES_SW_ENC_CNT_INC(sec, ra) -+#define AES_SW_DEC_CNT_INC(sec, ra) -+#endif /* DBG_SW_SEC_CNT */ -+ -+/* *****WEP related***** */ -+ -+#define CRC32_POLY 0x04c11db7 -+ -+struct arc4context { -+ u32 x; -+ u32 y; -+ u8 state[256]; -+}; -+ -+ -+static void arcfour_init(struct arc4context *parc4ctx, u8 *key, u32 key_len) -+{ -+ u32 t, u; -+ u32 keyindex; -+ u32 stateindex; -+ u8 *state; -+ u32 counter; -+ state = parc4ctx->state; -+ parc4ctx->x = 0; -+ parc4ctx->y = 0; -+ for (counter = 0; counter < 256; counter++) -+ state[counter] = (u8)counter; -+ keyindex = 0; -+ stateindex = 0; -+ for (counter = 0; counter < 256; counter++) { -+ t = state[counter]; -+ stateindex = (stateindex + key[keyindex] + t) & 0xff; -+ u = state[stateindex]; -+ state[stateindex] = (u8)t; -+ state[counter] = (u8)u; -+ if (++keyindex >= key_len) -+ keyindex = 0; -+ } -+} -+static u32 arcfour_byte(struct arc4context *parc4ctx) -+{ -+ u32 x; -+ u32 y; -+ u32 sx, sy; -+ u8 *state; -+ state = parc4ctx->state; -+ x = (parc4ctx->x + 1) & 0xff; -+ sx = state[x]; -+ y = (sx + parc4ctx->y) & 0xff; -+ sy = state[y]; -+ parc4ctx->x = x; -+ parc4ctx->y = y; -+ state[y] = (u8)sx; -+ state[x] = (u8)sy; -+ return state[(sx + sy) & 0xff]; -+} -+ -+ -+static void arcfour_encrypt(struct arc4context *parc4ctx, -+ u8 *dest, -+ u8 *src, -+ u32 len) -+{ -+ u32 i; -+ for (i = 0; i < len; i++) -+ dest[i] = src[i] ^ (unsigned char)arcfour_byte(parc4ctx); -+} -+ -+static sint bcrc32initialized = 0; -+static u32 crc32_table[256]; -+ -+ -+static u8 crc32_reverseBit(u8 data) -+{ -+ return (u8)((data << 7) & 0x80) | ((data << 5) & 0x40) | ((data << 3) & 0x20) | ((data << 1) & 0x10) | ((data >> 1) & 0x08) | ((data >> 3) & 0x04) | ((data >> 5) & 0x02) | (( -+ data >> 7) & 0x01) ; -+} -+ -+static void crc32_init(void) -+{ -+ if (bcrc32initialized == 1) -+ goto exit; -+ else { -+ sint i, j; -+ u32 c; -+ u8 *p = (u8 *)&c, *p1; -+ u8 k; -+ -+ c = 0x12340000; -+ -+ for (i = 0; i < 256; ++i) { -+ k = crc32_reverseBit((u8)i); -+ for (c = ((u32)k) << 24, j = 8; j > 0; --j) -+ c = c & 0x80000000 ? (c << 1) ^ CRC32_POLY : (c << 1); -+ p1 = (u8 *)&crc32_table[i]; -+ -+ p1[0] = crc32_reverseBit(p[3]); -+ p1[1] = crc32_reverseBit(p[2]); -+ p1[2] = crc32_reverseBit(p[1]); -+ p1[3] = crc32_reverseBit(p[0]); -+ } -+ bcrc32initialized = 1; -+ } -+exit: -+ return; -+} -+ -+static u32 getcrc32(u8 *buf, sint len) -+{ -+ u8 *p; -+ u32 crc; -+ if (bcrc32initialized == 0) -+ crc32_init(); -+ -+ crc = 0xffffffff; /* preload shift register, per CRC-32 spec */ -+ -+ for (p = buf; len > 0; ++p, --len) -+ crc = crc32_table[(crc ^ *p) & 0xff] ^ (crc >> 8); -+ return ~crc; /* transmit complement, per CRC-32 spec */ -+} -+ -+ -+/* -+ Need to consider the fragment situation -+*/ -+void rtw_wep_encrypt(_adapter *padapter, u8 *pxmitframe) -+{ -+ /* exclude ICV */ -+ -+ unsigned char crc[4]; -+ struct arc4context mycontext; -+ -+ sint curfragnum, length; -+ u32 keylength; -+ -+ u8 *pframe, *payload, *iv; /* ,*wepkey */ -+ u8 wepkey[16]; -+ u8 hw_hdr_offset = 0; -+ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ -+ -+ if (((struct xmit_frame *)pxmitframe)->buf_addr == NULL) -+ return; -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ hw_hdr_offset = TXDESC_SIZE + -+ (((struct xmit_frame *)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); -+#else -+#ifdef CONFIG_TX_EARLY_MODE -+ hw_hdr_offset = TXDESC_OFFSET + EARLY_MODE_INFO_SIZE; -+#else -+ hw_hdr_offset = TXDESC_OFFSET; -+#endif -+#endif -+ -+ pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + hw_hdr_offset; -+ -+ /* start to encrypt each fragment */ -+ if ((pattrib->encrypt == _WEP40_) || (pattrib->encrypt == _WEP104_)) { -+ keylength = psecuritypriv->dot11DefKeylen[psecuritypriv->dot11PrivacyKeyIndex]; -+ -+ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { -+ iv = pframe + pattrib->hdrlen; -+ _rtw_memcpy(&wepkey[0], iv, 3); -+ _rtw_memcpy(&wepkey[3], &psecuritypriv->dot11DefKey[psecuritypriv->dot11PrivacyKeyIndex].skey[0], keylength); -+ payload = pframe + pattrib->iv_len + pattrib->hdrlen; -+ -+ if ((curfragnum + 1) == pattrib->nr_frags) { -+ /* the last fragment */ -+ -+ length = pattrib->last_txcmdsz - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; -+ -+ *((u32 *)crc) = cpu_to_le32(getcrc32(payload, length)); -+ -+ arcfour_init(&mycontext, wepkey, 3 + keylength); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ arcfour_encrypt(&mycontext, payload + length, crc, 4); -+ -+ } else { -+ length = pxmitpriv->frag_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len ; -+ *((u32 *)crc) = cpu_to_le32(getcrc32(payload, length)); -+ arcfour_init(&mycontext, wepkey, 3 + keylength); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ arcfour_encrypt(&mycontext, payload + length, crc, 4); -+ -+ pframe += pxmitpriv->frag_len; -+ pframe = (u8 *)RND4((SIZE_PTR)(pframe)); -+ -+ } -+ -+ } -+ -+ WEP_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); -+ } -+ -+ -+} -+ -+void rtw_wep_decrypt(_adapter *padapter, u8 *precvframe) -+{ -+ /* exclude ICV */ -+ u8 crc[4]; -+ struct arc4context mycontext; -+ sint length; -+ u32 keylength; -+ u8 *pframe, *payload, *iv, wepkey[16]; -+ u8 keyindex; -+ struct rx_pkt_attrib *prxattrib = &(((union recv_frame *)precvframe)->u.hdr.attrib); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ -+ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; -+ -+ /* start to decrypt recvframe */ -+ if ((prxattrib->encrypt == _WEP40_) || (prxattrib->encrypt == _WEP104_)) { -+ iv = pframe + prxattrib->hdrlen; -+ /* keyindex=(iv[3]&0x3); */ -+ keyindex = prxattrib->key_index; -+ keylength = psecuritypriv->dot11DefKeylen[keyindex]; -+ _rtw_memcpy(&wepkey[0], iv, 3); -+ /* _rtw_memcpy(&wepkey[3], &psecuritypriv->dot11DefKey[psecuritypriv->dot11PrivacyKeyIndex].skey[0],keylength); */ -+ _rtw_memcpy(&wepkey[3], &psecuritypriv->dot11DefKey[keyindex].skey[0], keylength); -+ length = ((union recv_frame *)precvframe)->u.hdr.len - prxattrib->hdrlen - prxattrib->iv_len; -+ -+ payload = pframe + prxattrib->iv_len + prxattrib->hdrlen; -+ -+ /* decrypt payload include icv */ -+ arcfour_init(&mycontext, wepkey, 3 + keylength); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ -+ /* calculate icv and compare the icv */ -+ *((u32 *)crc) = le32_to_cpu(getcrc32(payload, length - 4)); -+ -+ -+ WEP_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); -+ } -+ -+ -+ return; -+ -+} -+ -+/* 3 =====TKIP related===== */ -+ -+static u32 secmicgetuint32(u8 *p) -+/* Convert from Byte[] to Us4Byte32 in a portable way */ -+{ -+ s32 i; -+ u32 res = 0; -+ for (i = 0; i < 4; i++) -+ res |= ((u32)(*p++)) << (8 * i); -+ return res; -+} -+ -+static void secmicputuint32(u8 *p, u32 val) -+/* Convert from Us4Byte32 to Byte[] in a portable way */ -+{ -+ long i; -+ for (i = 0; i < 4; i++) { -+ *p++ = (u8)(val & 0xff); -+ val >>= 8; -+ } -+} -+ -+static void secmicclear(struct mic_data *pmicdata) -+{ -+ /* Reset the state to the empty message. */ -+ pmicdata->L = pmicdata->K0; -+ pmicdata->R = pmicdata->K1; -+ pmicdata->nBytesInM = 0; -+ pmicdata->M = 0; -+} -+ -+void rtw_secmicsetkey(struct mic_data *pmicdata, u8 *key) -+{ -+ /* Set the key */ -+ pmicdata->K0 = secmicgetuint32(key); -+ pmicdata->K1 = secmicgetuint32(key + 4); -+ /* and reset the message */ -+ secmicclear(pmicdata); -+} -+ -+void rtw_secmicappendbyte(struct mic_data *pmicdata, u8 b) -+{ -+ /* Append the byte to our word-sized buffer */ -+ pmicdata->M |= ((unsigned long)b) << (8 * pmicdata->nBytesInM); -+ pmicdata->nBytesInM++; -+ /* Process the word if it is full. */ -+ if (pmicdata->nBytesInM >= 4) { -+ pmicdata->L ^= pmicdata->M; -+ pmicdata->R ^= ROL32(pmicdata->L, 17); -+ pmicdata->L += pmicdata->R; -+ pmicdata->R ^= ((pmicdata->L & 0xff00ff00) >> 8) | ((pmicdata->L & 0x00ff00ff) << 8); -+ pmicdata->L += pmicdata->R; -+ pmicdata->R ^= ROL32(pmicdata->L, 3); -+ pmicdata->L += pmicdata->R; -+ pmicdata->R ^= ROR32(pmicdata->L, 2); -+ pmicdata->L += pmicdata->R; -+ /* Clear the buffer */ -+ pmicdata->M = 0; -+ pmicdata->nBytesInM = 0; -+ } -+} -+ -+void rtw_secmicappend(struct mic_data *pmicdata, u8 *src, u32 nbytes) -+{ -+ /* This is simple */ -+ while (nbytes > 0) { -+ rtw_secmicappendbyte(pmicdata, *src++); -+ nbytes--; -+ } -+} -+ -+void rtw_secgetmic(struct mic_data *pmicdata, u8 *dst) -+{ -+ /* Append the minimum padding */ -+ rtw_secmicappendbyte(pmicdata, 0x5a); -+ rtw_secmicappendbyte(pmicdata, 0); -+ rtw_secmicappendbyte(pmicdata, 0); -+ rtw_secmicappendbyte(pmicdata, 0); -+ rtw_secmicappendbyte(pmicdata, 0); -+ /* and then zeroes until the length is a multiple of 4 */ -+ while (pmicdata->nBytesInM != 0) -+ rtw_secmicappendbyte(pmicdata, 0); -+ /* The appendByte function has already computed the result. */ -+ secmicputuint32(dst, pmicdata->L); -+ secmicputuint32(dst + 4, pmicdata->R); -+ /* Reset to the empty message. */ -+ secmicclear(pmicdata); -+} -+ -+ -+void rtw_seccalctkipmic(u8 *key, u8 *header, u8 *data, u32 data_len, u8 *mic_code, u8 pri) -+{ -+ -+ struct mic_data micdata; -+ u8 priority[4] = {0x0, 0x0, 0x0, 0x0}; -+ rtw_secmicsetkey(&micdata, key); -+ priority[0] = pri; -+ -+ /* Michael MIC pseudo header: DA, SA, 3 x 0, Priority */ -+ if (header[1] & 1) { /* ToDS==1 */ -+ rtw_secmicappend(&micdata, &header[16], 6); /* DA */ -+ if (header[1] & 2) /* From Ds==1 */ -+ rtw_secmicappend(&micdata, &header[24], 6); -+ else -+ rtw_secmicappend(&micdata, &header[10], 6); -+ } else { /* ToDS==0 */ -+ rtw_secmicappend(&micdata, &header[4], 6); /* DA */ -+ if (header[1] & 2) /* From Ds==1 */ -+ rtw_secmicappend(&micdata, &header[16], 6); -+ else -+ rtw_secmicappend(&micdata, &header[10], 6); -+ -+ } -+ rtw_secmicappend(&micdata, &priority[0], 4); -+ -+ -+ rtw_secmicappend(&micdata, data, data_len); -+ -+ rtw_secgetmic(&micdata, mic_code); -+} -+ -+ -+ -+ -+/* macros for extraction/creation of unsigned char/unsigned short values */ -+#define RotR1(v16) ((((v16) >> 1) & 0x7FFF) ^ (((v16) & 1) << 15)) -+#define Lo8(v16) ((u8)((v16) & 0x00FF)) -+#define Hi8(v16) ((u8)(((v16) >> 8) & 0x00FF)) -+#define Lo16(v32) ((u16)((v32) & 0xFFFF)) -+#define Hi16(v32) ((u16)(((v32) >> 16) & 0xFFFF)) -+#define Mk16(hi, lo) ((lo) ^ (((u16)(hi)) << 8)) -+ -+/* select the Nth 16-bit word of the temporal key unsigned char array TK[] */ -+#define TK16(N) Mk16(tk[2*(N)+1], tk[2*(N)]) -+ -+/* S-box lookup: 16 bits --> 16 bits */ -+#define _S_(v16) (Sbox1[0][Lo8(v16)] ^ Sbox1[1][Hi8(v16)]) -+ -+/* fixed algorithm "parameters" */ -+#define PHASE1_LOOP_CNT 8 /* this needs to be "big enough" */ -+#define TA_SIZE 6 /* 48-bit transmitter address */ -+#define TK_SIZE 16 /* 128-bit temporal key */ -+#define P1K_SIZE 10 /* 80-bit Phase1 key */ -+#define RC4_KEY_SIZE 16 /* 128-bit RC4KEY (104 bits unknown) */ -+ -+ -+/* 2-unsigned char by 2-unsigned char subset of the full AES S-box table */ -+static const unsigned short Sbox1[2][256] = /* Sbox for hash (can be in ROM) */ -+{ { -+ 0xC6A5, 0xF884, 0xEE99, 0xF68D, 0xFF0D, 0xD6BD, 0xDEB1, 0x9154, -+ 0x6050, 0x0203, 0xCEA9, 0x567D, 0xE719, 0xB562, 0x4DE6, 0xEC9A, -+ 0x8F45, 0x1F9D, 0x8940, 0xFA87, 0xEF15, 0xB2EB, 0x8EC9, 0xFB0B, -+ 0x41EC, 0xB367, 0x5FFD, 0x45EA, 0x23BF, 0x53F7, 0xE496, 0x9B5B, -+ 0x75C2, 0xE11C, 0x3DAE, 0x4C6A, 0x6C5A, 0x7E41, 0xF502, 0x834F, -+ 0x685C, 0x51F4, 0xD134, 0xF908, 0xE293, 0xAB73, 0x6253, 0x2A3F, -+ 0x080C, 0x9552, 0x4665, 0x9D5E, 0x3028, 0x37A1, 0x0A0F, 0x2FB5, -+ 0x0E09, 0x2436, 0x1B9B, 0xDF3D, 0xCD26, 0x4E69, 0x7FCD, 0xEA9F, -+ 0x121B, 0x1D9E, 0x5874, 0x342E, 0x362D, 0xDCB2, 0xB4EE, 0x5BFB, -+ 0xA4F6, 0x764D, 0xB761, 0x7DCE, 0x527B, 0xDD3E, 0x5E71, 0x1397, -+ 0xA6F5, 0xB968, 0x0000, 0xC12C, 0x4060, 0xE31F, 0x79C8, 0xB6ED, -+ 0xD4BE, 0x8D46, 0x67D9, 0x724B, 0x94DE, 0x98D4, 0xB0E8, 0x854A, -+ 0xBB6B, 0xC52A, 0x4FE5, 0xED16, 0x86C5, 0x9AD7, 0x6655, 0x1194, -+ 0x8ACF, 0xE910, 0x0406, 0xFE81, 0xA0F0, 0x7844, 0x25BA, 0x4BE3, -+ 0xA2F3, 0x5DFE, 0x80C0, 0x058A, 0x3FAD, 0x21BC, 0x7048, 0xF104, -+ 0x63DF, 0x77C1, 0xAF75, 0x4263, 0x2030, 0xE51A, 0xFD0E, 0xBF6D, -+ 0x814C, 0x1814, 0x2635, 0xC32F, 0xBEE1, 0x35A2, 0x88CC, 0x2E39, -+ 0x9357, 0x55F2, 0xFC82, 0x7A47, 0xC8AC, 0xBAE7, 0x322B, 0xE695, -+ 0xC0A0, 0x1998, 0x9ED1, 0xA37F, 0x4466, 0x547E, 0x3BAB, 0x0B83, -+ 0x8CCA, 0xC729, 0x6BD3, 0x283C, 0xA779, 0xBCE2, 0x161D, 0xAD76, -+ 0xDB3B, 0x6456, 0x744E, 0x141E, 0x92DB, 0x0C0A, 0x486C, 0xB8E4, -+ 0x9F5D, 0xBD6E, 0x43EF, 0xC4A6, 0x39A8, 0x31A4, 0xD337, 0xF28B, -+ 0xD532, 0x8B43, 0x6E59, 0xDAB7, 0x018C, 0xB164, 0x9CD2, 0x49E0, -+ 0xD8B4, 0xACFA, 0xF307, 0xCF25, 0xCAAF, 0xF48E, 0x47E9, 0x1018, -+ 0x6FD5, 0xF088, 0x4A6F, 0x5C72, 0x3824, 0x57F1, 0x73C7, 0x9751, -+ 0xCB23, 0xA17C, 0xE89C, 0x3E21, 0x96DD, 0x61DC, 0x0D86, 0x0F85, -+ 0xE090, 0x7C42, 0x71C4, 0xCCAA, 0x90D8, 0x0605, 0xF701, 0x1C12, -+ 0xC2A3, 0x6A5F, 0xAEF9, 0x69D0, 0x1791, 0x9958, 0x3A27, 0x27B9, -+ 0xD938, 0xEB13, 0x2BB3, 0x2233, 0xD2BB, 0xA970, 0x0789, 0x33A7, -+ 0x2DB6, 0x3C22, 0x1592, 0xC920, 0x8749, 0xAAFF, 0x5078, 0xA57A, -+ 0x038F, 0x59F8, 0x0980, 0x1A17, 0x65DA, 0xD731, 0x84C6, 0xD0B8, -+ 0x82C3, 0x29B0, 0x5A77, 0x1E11, 0x7BCB, 0xA8FC, 0x6DD6, 0x2C3A, -+ }, -+ -+ -+ { /* second half of table is unsigned char-reversed version of first! */ -+ 0xA5C6, 0x84F8, 0x99EE, 0x8DF6, 0x0DFF, 0xBDD6, 0xB1DE, 0x5491, -+ 0x5060, 0x0302, 0xA9CE, 0x7D56, 0x19E7, 0x62B5, 0xE64D, 0x9AEC, -+ 0x458F, 0x9D1F, 0x4089, 0x87FA, 0x15EF, 0xEBB2, 0xC98E, 0x0BFB, -+ 0xEC41, 0x67B3, 0xFD5F, 0xEA45, 0xBF23, 0xF753, 0x96E4, 0x5B9B, -+ 0xC275, 0x1CE1, 0xAE3D, 0x6A4C, 0x5A6C, 0x417E, 0x02F5, 0x4F83, -+ 0x5C68, 0xF451, 0x34D1, 0x08F9, 0x93E2, 0x73AB, 0x5362, 0x3F2A, -+ 0x0C08, 0x5295, 0x6546, 0x5E9D, 0x2830, 0xA137, 0x0F0A, 0xB52F, -+ 0x090E, 0x3624, 0x9B1B, 0x3DDF, 0x26CD, 0x694E, 0xCD7F, 0x9FEA, -+ 0x1B12, 0x9E1D, 0x7458, 0x2E34, 0x2D36, 0xB2DC, 0xEEB4, 0xFB5B, -+ 0xF6A4, 0x4D76, 0x61B7, 0xCE7D, 0x7B52, 0x3EDD, 0x715E, 0x9713, -+ 0xF5A6, 0x68B9, 0x0000, 0x2CC1, 0x6040, 0x1FE3, 0xC879, 0xEDB6, -+ 0xBED4, 0x468D, 0xD967, 0x4B72, 0xDE94, 0xD498, 0xE8B0, 0x4A85, -+ 0x6BBB, 0x2AC5, 0xE54F, 0x16ED, 0xC586, 0xD79A, 0x5566, 0x9411, -+ 0xCF8A, 0x10E9, 0x0604, 0x81FE, 0xF0A0, 0x4478, 0xBA25, 0xE34B, -+ 0xF3A2, 0xFE5D, 0xC080, 0x8A05, 0xAD3F, 0xBC21, 0x4870, 0x04F1, -+ 0xDF63, 0xC177, 0x75AF, 0x6342, 0x3020, 0x1AE5, 0x0EFD, 0x6DBF, -+ 0x4C81, 0x1418, 0x3526, 0x2FC3, 0xE1BE, 0xA235, 0xCC88, 0x392E, -+ 0x5793, 0xF255, 0x82FC, 0x477A, 0xACC8, 0xE7BA, 0x2B32, 0x95E6, -+ 0xA0C0, 0x9819, 0xD19E, 0x7FA3, 0x6644, 0x7E54, 0xAB3B, 0x830B, -+ 0xCA8C, 0x29C7, 0xD36B, 0x3C28, 0x79A7, 0xE2BC, 0x1D16, 0x76AD, -+ 0x3BDB, 0x5664, 0x4E74, 0x1E14, 0xDB92, 0x0A0C, 0x6C48, 0xE4B8, -+ 0x5D9F, 0x6EBD, 0xEF43, 0xA6C4, 0xA839, 0xA431, 0x37D3, 0x8BF2, -+ 0x32D5, 0x438B, 0x596E, 0xB7DA, 0x8C01, 0x64B1, 0xD29C, 0xE049, -+ 0xB4D8, 0xFAAC, 0x07F3, 0x25CF, 0xAFCA, 0x8EF4, 0xE947, 0x1810, -+ 0xD56F, 0x88F0, 0x6F4A, 0x725C, 0x2438, 0xF157, 0xC773, 0x5197, -+ 0x23CB, 0x7CA1, 0x9CE8, 0x213E, 0xDD96, 0xDC61, 0x860D, 0x850F, -+ 0x90E0, 0x427C, 0xC471, 0xAACC, 0xD890, 0x0506, 0x01F7, 0x121C, -+ 0xA3C2, 0x5F6A, 0xF9AE, 0xD069, 0x9117, 0x5899, 0x273A, 0xB927, -+ 0x38D9, 0x13EB, 0xB32B, 0x3322, 0xBBD2, 0x70A9, 0x8907, 0xA733, -+ 0xB62D, 0x223C, 0x9215, 0x20C9, 0x4987, 0xFFAA, 0x7850, 0x7AA5, -+ 0x8F03, 0xF859, 0x8009, 0x171A, 0xDA65, 0x31D7, 0xC684, 0xB8D0, -+ 0xC382, 0xB029, 0x775A, 0x111E, 0xCB7B, 0xFCA8, 0xD66D, 0x3A2C, -+ } -+}; -+ -+/* -+********************************************************************** -+* Routine: Phase 1 -- generate P1K, given TA, TK, IV32 -+* -+* Inputs: -+* tk[] = temporal key [128 bits] -+* ta[] = transmitter's MAC address [ 48 bits] -+* iv32 = upper 32 bits of IV [ 32 bits] -+* Output: -+* p1k[] = Phase 1 key [ 80 bits] -+* -+* Note: -+* This function only needs to be called every 2**16 packets, -+* although in theory it could be called every packet. -+* -+********************************************************************** -+*/ -+static void phase1(u16 *p1k, const u8 *tk, const u8 *ta, u32 iv32) -+{ -+ sint i; -+ /* Initialize the 80 bits of P1K[] from IV32 and TA[0..5] */ -+ p1k[0] = Lo16(iv32); -+ p1k[1] = Hi16(iv32); -+ p1k[2] = Mk16(ta[1], ta[0]); /* use TA[] as little-endian */ -+ p1k[3] = Mk16(ta[3], ta[2]); -+ p1k[4] = Mk16(ta[5], ta[4]); -+ -+ /* Now compute an unbalanced Feistel cipher with 80-bit block */ -+ /* size on the 80-bit block P1K[], using the 128-bit key TK[] */ -+ for (i = 0; i < PHASE1_LOOP_CNT ; i++) { -+ /* Each add operation here is mod 2**16 */ -+ p1k[0] += _S_(p1k[4] ^ TK16((i & 1) + 0)); -+ p1k[1] += _S_(p1k[0] ^ TK16((i & 1) + 2)); -+ p1k[2] += _S_(p1k[1] ^ TK16((i & 1) + 4)); -+ p1k[3] += _S_(p1k[2] ^ TK16((i & 1) + 6)); -+ p1k[4] += _S_(p1k[3] ^ TK16((i & 1) + 0)); -+ p1k[4] += (unsigned short)i; /* avoid "slide attacks" */ -+ } -+} -+ -+ -+/* -+********************************************************************** -+* Routine: Phase 2 -- generate RC4KEY, given TK, P1K, IV16 -+* -+* Inputs: -+* tk[] = Temporal key [128 bits] -+* p1k[] = Phase 1 output key [ 80 bits] -+* iv16 = low 16 bits of IV counter [ 16 bits] -+* Output: -+* rc4key[] = the key used to encrypt the packet [128 bits] -+* -+* Note: -+* The value {TA,IV32,IV16} for Phase1/Phase2 must be unique -+* across all packets using the same key TK value. Then, for a -+* given value of TK[], this TKIP48 construction guarantees that -+* the final RC4KEY value is unique across all packets. -+* -+* Suggested implementation optimization: if PPK[] is "overlaid" -+* appropriately on RC4KEY[], there is no need for the final -+* for loop below that copies the PPK[] result into RC4KEY[]. -+* -+********************************************************************** -+*/ -+static void phase2(u8 *rc4key, const u8 *tk, const u16 *p1k, u16 iv16) -+{ -+ sint i; -+ u16 PPK[6]; /* temporary key for mixing */ -+ /* Note: all adds in the PPK[] equations below are mod 2**16 */ -+ for (i = 0; i < 5; i++) -+ PPK[i] = p1k[i]; /* first, copy P1K to PPK */ -+ PPK[5] = p1k[4] + iv16; /* next, add in IV16 */ -+ -+ /* Bijective non-linear mixing of the 96 bits of PPK[0..5] */ -+ PPK[0] += _S_(PPK[5] ^ TK16(0)); /* Mix key in each "round" */ -+ PPK[1] += _S_(PPK[0] ^ TK16(1)); -+ PPK[2] += _S_(PPK[1] ^ TK16(2)); -+ PPK[3] += _S_(PPK[2] ^ TK16(3)); -+ PPK[4] += _S_(PPK[3] ^ TK16(4)); -+ PPK[5] += _S_(PPK[4] ^ TK16(5)); /* Total # S-box lookups == 6 */ -+ -+ /* Final sweep: bijective, "linear". Rotates kill LSB correlations */ -+ PPK[0] += RotR1(PPK[5] ^ TK16(6)); -+ PPK[1] += RotR1(PPK[0] ^ TK16(7)); /* Use all of TK[] in Phase2 */ -+ PPK[2] += RotR1(PPK[1]); -+ PPK[3] += RotR1(PPK[2]); -+ PPK[4] += RotR1(PPK[3]); -+ PPK[5] += RotR1(PPK[4]); -+ /* Note: At this point, for a given key TK[0..15], the 96-bit output */ -+ /* value PPK[0..5] is guaranteed to be unique, as a function */ -+ /* of the 96-bit "input" value {TA,IV32,IV16}. That is, P1K */ -+ /* is now a keyed permutation of {TA,IV32,IV16}. */ -+ -+ /* Set RC4KEY[0..3], which includes "cleartext" portion of RC4 key */ -+ rc4key[0] = Hi8(iv16); /* RC4KEY[0..2] is the WEP IV */ -+ rc4key[1] = (Hi8(iv16) | 0x20) & 0x7F; /* Help avoid weak (FMS) keys */ -+ rc4key[2] = Lo8(iv16); -+ rc4key[3] = Lo8((PPK[5] ^ TK16(0)) >> 1); -+ -+ -+ /* Copy 96 bits of PPK[0..5] to RC4KEY[4..15] (little-endian) */ -+ for (i = 0; i < 6; i++) { -+ rc4key[4 + 2 * i] = Lo8(PPK[i]); -+ rc4key[5 + 2 * i] = Hi8(PPK[i]); -+ } -+} -+ -+ -+/* The hlen isn't include the IV */ -+u32 rtw_tkip_encrypt(_adapter *padapter, u8 *pxmitframe) -+{ -+ /* exclude ICV */ -+ u16 pnl; -+ u32 pnh; -+ u8 rc4key[16]; -+ u8 ttkey[16]; -+ u8 crc[4]; -+ u8 hw_hdr_offset = 0; -+ struct arc4context mycontext; -+ sint curfragnum, length; -+ u32 prwskeylen; -+ -+ u8 *pframe, *payload, *iv, *prwskey; -+ union pn48 dot11txpn; -+ /* struct sta_info *stainfo; */ -+ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ u32 res = _SUCCESS; -+ -+ if (((struct xmit_frame *)pxmitframe)->buf_addr == NULL) -+ return _FAIL; -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ hw_hdr_offset = TXDESC_SIZE + -+ (((struct xmit_frame *)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); -+#else -+#ifdef CONFIG_TX_EARLY_MODE -+ hw_hdr_offset = TXDESC_OFFSET + EARLY_MODE_INFO_SIZE; -+#else -+ hw_hdr_offset = TXDESC_OFFSET; -+#endif -+#endif -+ -+ pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + hw_hdr_offset; -+ /* 4 start to encrypt each fragment */ -+ if (pattrib->encrypt == _TKIP_) { -+ -+ /* -+ if(pattrib->psta) -+ { -+ stainfo = pattrib->psta; -+ } -+ else -+ { -+ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); -+ stainfo=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0] ); -+ } -+ */ -+ /* if (stainfo!=NULL) */ -+ { -+ /* -+ if(!(stainfo->state &_FW_LINKED)) -+ { -+ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, stainfo->state); -+ return _FAIL; -+ } -+ */ -+ -+ if (IS_MCAST(pattrib->ra)) -+ prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; -+ else { -+ /* prwskey=&stainfo->dot118021x_UncstKey.skey[0]; */ -+ prwskey = pattrib->dot118021x_UncstKey.skey; -+ } -+ -+ prwskeylen = 16; -+ -+ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { -+ iv = pframe + pattrib->hdrlen; -+ payload = pframe + pattrib->iv_len + pattrib->hdrlen; -+ -+ GET_TKIP_PN(iv, dot11txpn); -+ -+ pnl = (u16)(dot11txpn.val); -+ pnh = (u32)(dot11txpn.val >> 16); -+ -+ phase1((u16 *)&ttkey[0], prwskey, &pattrib->ta[0], pnh); -+ -+ phase2(&rc4key[0], prwskey, (u16 *)&ttkey[0], pnl); -+ -+ if ((curfragnum + 1) == pattrib->nr_frags) { /* 4 the last fragment */ -+ length = pattrib->last_txcmdsz - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; -+ *((u32 *)crc) = cpu_to_le32(getcrc32(payload, length)); /* modified by Amy*/ -+ -+ arcfour_init(&mycontext, rc4key, 16); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ arcfour_encrypt(&mycontext, payload + length, crc, 4); -+ -+ } else { -+ length = pxmitpriv->frag_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len ; -+ *((u32 *)crc) = cpu_to_le32(getcrc32(payload, length)); /* modified by Amy*/ -+ arcfour_init(&mycontext, rc4key, 16); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ arcfour_encrypt(&mycontext, payload + length, crc, 4); -+ -+ pframe += pxmitpriv->frag_len; -+ pframe = (u8 *)RND4((SIZE_PTR)(pframe)); -+ -+ } -+ } -+ -+ TKIP_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); -+ } -+ /* -+ else{ -+ RTW_INFO("%s, psta==NUL\n", __func__); -+ res=_FAIL; -+ } -+ */ -+ -+ } -+ return res; -+ -+} -+ -+ -+/* The hlen isn't include the IV */ -+u32 rtw_tkip_decrypt(_adapter *padapter, u8 *precvframe) -+{ -+ /* exclude ICV */ -+ u16 pnl; -+ u32 pnh; -+ u8 rc4key[16]; -+ u8 ttkey[16]; -+ u8 crc[4]; -+ struct arc4context mycontext; -+ sint length; -+ u32 prwskeylen; -+ -+ u8 *pframe, *payload, *iv, *prwskey; -+ union pn48 dot11txpn; -+ struct sta_info *stainfo; -+ struct rx_pkt_attrib *prxattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ /* struct recv_priv *precvpriv=&padapter->recvpriv; */ -+ u32 res = _SUCCESS; -+ -+ -+ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; -+ -+ /* 4 start to decrypt recvframe */ -+ if (prxattrib->encrypt == _TKIP_) { -+ -+ stainfo = rtw_get_stainfo(&padapter->stapriv , &prxattrib->ta[0]); -+ if (stainfo != NULL) { -+ -+ if (IS_MCAST(prxattrib->ra)) { -+ static u32 start = 0; -+ static u32 no_gkey_bc_cnt = 0; -+ static u32 no_gkey_mc_cnt = 0; -+ -+ if (psecuritypriv->binstallGrpkey == _FALSE) { -+ res = _FAIL; -+ -+ if (start == 0) -+ start = rtw_get_current_time(); -+ -+ if (is_broadcast_mac_addr(prxattrib->ra)) -+ no_gkey_bc_cnt++; -+ else -+ no_gkey_mc_cnt++; -+ -+ if (rtw_get_passing_time_ms(start) > 1000) { -+ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { -+ RTW_PRINT(FUNC_ADPT_FMT" no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", -+ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); -+ } -+ start = rtw_get_current_time(); -+ no_gkey_bc_cnt = 0; -+ no_gkey_mc_cnt = 0; -+ } -+ goto exit; -+ } -+ -+ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { -+ RTW_PRINT(FUNC_ADPT_FMT" gkey installed. no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", -+ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); -+ } -+ start = 0; -+ no_gkey_bc_cnt = 0; -+ no_gkey_mc_cnt = 0; -+ -+ /* RTW_INFO("rx bc/mc packets, to perform sw rtw_tkip_decrypt\n"); */ -+ /* prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; */ -+ prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; -+ prwskeylen = 16; -+ } else { -+ prwskey = &stainfo->dot118021x_UncstKey.skey[0]; -+ prwskeylen = 16; -+ } -+ -+ iv = pframe + prxattrib->hdrlen; -+ payload = pframe + prxattrib->iv_len + prxattrib->hdrlen; -+ length = ((union recv_frame *)precvframe)->u.hdr.len - prxattrib->hdrlen - prxattrib->iv_len; -+ -+ GET_TKIP_PN(iv, dot11txpn); -+ -+ pnl = (u16)(dot11txpn.val); -+ pnh = (u32)(dot11txpn.val >> 16); -+ -+ phase1((u16 *)&ttkey[0], prwskey, &prxattrib->ta[0], pnh); -+ phase2(&rc4key[0], prwskey, (unsigned short *)&ttkey[0], pnl); -+ -+ /* 4 decrypt payload include icv */ -+ -+ arcfour_init(&mycontext, rc4key, 16); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ -+ *((u32 *)crc) = le32_to_cpu(getcrc32(payload, length - 4)); -+ -+ if (crc[3] != payload[length - 1] || crc[2] != payload[length - 2] || crc[1] != payload[length - 3] || crc[0] != payload[length - 4]) { -+ res = _FAIL; -+ } -+ -+ TKIP_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); -+ } else { -+ res = _FAIL; -+ } -+ -+ } -+exit: -+ return res; -+ -+} -+ -+ -+/* 3 =====AES related===== */ -+ -+ -+ -+#define MAX_MSG_SIZE 2048 -+/*****************************/ -+/******** SBOX Table *********/ -+/*****************************/ -+ -+static u8 sbox_table[256] = { -+ 0x63, 0x7c, 0x77, 0x7b, 0xf2, 0x6b, 0x6f, 0xc5, -+ 0x30, 0x01, 0x67, 0x2b, 0xfe, 0xd7, 0xab, 0x76, -+ 0xca, 0x82, 0xc9, 0x7d, 0xfa, 0x59, 0x47, 0xf0, -+ 0xad, 0xd4, 0xa2, 0xaf, 0x9c, 0xa4, 0x72, 0xc0, -+ 0xb7, 0xfd, 0x93, 0x26, 0x36, 0x3f, 0xf7, 0xcc, -+ 0x34, 0xa5, 0xe5, 0xf1, 0x71, 0xd8, 0x31, 0x15, -+ 0x04, 0xc7, 0x23, 0xc3, 0x18, 0x96, 0x05, 0x9a, -+ 0x07, 0x12, 0x80, 0xe2, 0xeb, 0x27, 0xb2, 0x75, -+ 0x09, 0x83, 0x2c, 0x1a, 0x1b, 0x6e, 0x5a, 0xa0, -+ 0x52, 0x3b, 0xd6, 0xb3, 0x29, 0xe3, 0x2f, 0x84, -+ 0x53, 0xd1, 0x00, 0xed, 0x20, 0xfc, 0xb1, 0x5b, -+ 0x6a, 0xcb, 0xbe, 0x39, 0x4a, 0x4c, 0x58, 0xcf, -+ 0xd0, 0xef, 0xaa, 0xfb, 0x43, 0x4d, 0x33, 0x85, -+ 0x45, 0xf9, 0x02, 0x7f, 0x50, 0x3c, 0x9f, 0xa8, -+ 0x51, 0xa3, 0x40, 0x8f, 0x92, 0x9d, 0x38, 0xf5, -+ 0xbc, 0xb6, 0xda, 0x21, 0x10, 0xff, 0xf3, 0xd2, -+ 0xcd, 0x0c, 0x13, 0xec, 0x5f, 0x97, 0x44, 0x17, -+ 0xc4, 0xa7, 0x7e, 0x3d, 0x64, 0x5d, 0x19, 0x73, -+ 0x60, 0x81, 0x4f, 0xdc, 0x22, 0x2a, 0x90, 0x88, -+ 0x46, 0xee, 0xb8, 0x14, 0xde, 0x5e, 0x0b, 0xdb, -+ 0xe0, 0x32, 0x3a, 0x0a, 0x49, 0x06, 0x24, 0x5c, -+ 0xc2, 0xd3, 0xac, 0x62, 0x91, 0x95, 0xe4, 0x79, -+ 0xe7, 0xc8, 0x37, 0x6d, 0x8d, 0xd5, 0x4e, 0xa9, -+ 0x6c, 0x56, 0xf4, 0xea, 0x65, 0x7a, 0xae, 0x08, -+ 0xba, 0x78, 0x25, 0x2e, 0x1c, 0xa6, 0xb4, 0xc6, -+ 0xe8, 0xdd, 0x74, 0x1f, 0x4b, 0xbd, 0x8b, 0x8a, -+ 0x70, 0x3e, 0xb5, 0x66, 0x48, 0x03, 0xf6, 0x0e, -+ 0x61, 0x35, 0x57, 0xb9, 0x86, 0xc1, 0x1d, 0x9e, -+ 0xe1, 0xf8, 0x98, 0x11, 0x69, 0xd9, 0x8e, 0x94, -+ 0x9b, 0x1e, 0x87, 0xe9, 0xce, 0x55, 0x28, 0xdf, -+ 0x8c, 0xa1, 0x89, 0x0d, 0xbf, 0xe6, 0x42, 0x68, -+ 0x41, 0x99, 0x2d, 0x0f, 0xb0, 0x54, 0xbb, 0x16 -+}; -+ -+/*****************************/ -+/**** Function Prototypes ****/ -+/*****************************/ -+ -+static void bitwise_xor(u8 *ina, u8 *inb, u8 *out); -+static void construct_mic_iv( -+ u8 *mic_header1, -+ sint qc_exists, -+ sint a4_exists, -+ u8 *mpdu, -+ uint payload_length, -+ u8 *pn_vector, -+ uint frtype);/* add for CONFIG_IEEE80211W, none 11w also can use */ -+static void construct_mic_header1( -+ u8 *mic_header1, -+ sint header_length, -+ u8 *mpdu, -+ uint frtype);/* add for CONFIG_IEEE80211W, none 11w also can use */ -+static void construct_mic_header2( -+ u8 *mic_header2, -+ u8 *mpdu, -+ sint a4_exists, -+ sint qc_exists); -+static void construct_ctr_preload( -+ u8 *ctr_preload, -+ sint a4_exists, -+ sint qc_exists, -+ u8 *mpdu, -+ u8 *pn_vector, -+ sint c, -+ uint frtype);/* add for CONFIG_IEEE80211W, none 11w also can use */ -+static void xor_128(u8 *a, u8 *b, u8 *out); -+static void xor_32(u8 *a, u8 *b, u8 *out); -+static u8 sbox(u8 a); -+static void next_key(u8 *key, sint round); -+static void byte_sub(u8 *in, u8 *out); -+static void shift_row(u8 *in, u8 *out); -+static void mix_column(u8 *in, u8 *out); -+#ifndef PLATFORM_FREEBSD -+static void add_round_key(u8 *shiftrow_in, -+ u8 *mcol_in, -+ u8 *block_in, -+ sint round, -+ u8 *out); -+#endif /* PLATFORM_FREEBSD */ -+static void aes128k128d(u8 *key, u8 *data, u8 *ciphertext); -+ -+ -+/****************************************/ -+/* aes128k128d() */ -+/* Performs a 128 bit AES encrypt with */ -+/* 128 bit data. */ -+/****************************************/ -+static void xor_128(u8 *a, u8 *b, u8 *out) -+{ -+ sint i; -+ for (i = 0; i < 16; i++) -+ out[i] = a[i] ^ b[i]; -+} -+ -+ -+static void xor_32(u8 *a, u8 *b, u8 *out) -+{ -+ sint i; -+ for (i = 0; i < 4; i++) -+ out[i] = a[i] ^ b[i]; -+} -+ -+ -+static u8 sbox(u8 a) -+{ -+ return sbox_table[(sint)a]; -+} -+ -+ -+static void next_key(u8 *key, sint round) -+{ -+ u8 rcon; -+ u8 sbox_key[4]; -+ u8 rcon_table[12] = { -+ 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, -+ 0x1b, 0x36, 0x36, 0x36 -+ }; -+ sbox_key[0] = sbox(key[13]); -+ sbox_key[1] = sbox(key[14]); -+ sbox_key[2] = sbox(key[15]); -+ sbox_key[3] = sbox(key[12]); -+ -+ rcon = rcon_table[round]; -+ -+ xor_32(&key[0], sbox_key, &key[0]); -+ key[0] = key[0] ^ rcon; -+ -+ xor_32(&key[4], &key[0], &key[4]); -+ xor_32(&key[8], &key[4], &key[8]); -+ xor_32(&key[12], &key[8], &key[12]); -+} -+ -+ -+static void byte_sub(u8 *in, u8 *out) -+{ -+ sint i; -+ for (i = 0; i < 16; i++) -+ out[i] = sbox(in[i]); -+} -+ -+ -+static void shift_row(u8 *in, u8 *out) -+{ -+ out[0] = in[0]; -+ out[1] = in[5]; -+ out[2] = in[10]; -+ out[3] = in[15]; -+ out[4] = in[4]; -+ out[5] = in[9]; -+ out[6] = in[14]; -+ out[7] = in[3]; -+ out[8] = in[8]; -+ out[9] = in[13]; -+ out[10] = in[2]; -+ out[11] = in[7]; -+ out[12] = in[12]; -+ out[13] = in[1]; -+ out[14] = in[6]; -+ out[15] = in[11]; -+} -+ -+ -+static void mix_column(u8 *in, u8 *out) -+{ -+ sint i; -+ u8 add1b[4]; -+ u8 add1bf7[4]; -+ u8 rotl[4]; -+ u8 swap_halfs[4]; -+ u8 andf7[4]; -+ u8 rotr[4]; -+ u8 temp[4]; -+ u8 tempb[4]; -+ for (i = 0 ; i < 4; i++) { -+ if ((in[i] & 0x80) == 0x80) -+ add1b[i] = 0x1b; -+ else -+ add1b[i] = 0x00; -+ } -+ -+ swap_halfs[0] = in[2]; /* Swap halfs */ -+ swap_halfs[1] = in[3]; -+ swap_halfs[2] = in[0]; -+ swap_halfs[3] = in[1]; -+ -+ rotl[0] = in[3]; /* Rotate left 8 bits */ -+ rotl[1] = in[0]; -+ rotl[2] = in[1]; -+ rotl[3] = in[2]; -+ -+ andf7[0] = in[0] & 0x7f; -+ andf7[1] = in[1] & 0x7f; -+ andf7[2] = in[2] & 0x7f; -+ andf7[3] = in[3] & 0x7f; -+ -+ for (i = 3; i > 0; i--) { /* logical shift left 1 bit */ -+ andf7[i] = andf7[i] << 1; -+ if ((andf7[i - 1] & 0x80) == 0x80) -+ andf7[i] = (andf7[i] | 0x01); -+ } -+ andf7[0] = andf7[0] << 1; -+ andf7[0] = andf7[0] & 0xfe; -+ -+ xor_32(add1b, andf7, add1bf7); -+ -+ xor_32(in, add1bf7, rotr); -+ -+ temp[0] = rotr[0]; /* Rotate right 8 bits */ -+ rotr[0] = rotr[1]; -+ rotr[1] = rotr[2]; -+ rotr[2] = rotr[3]; -+ rotr[3] = temp[0]; -+ -+ xor_32(add1bf7, rotr, temp); -+ xor_32(swap_halfs, rotl, tempb); -+ xor_32(temp, tempb, out); -+} -+ -+ -+static void aes128k128d(u8 *key, u8 *data, u8 *ciphertext) -+{ -+ sint round; -+ sint i; -+ u8 intermediatea[16]; -+ u8 intermediateb[16]; -+ u8 round_key[16]; -+ for (i = 0; i < 16; i++) -+ round_key[i] = key[i]; -+ -+ for (round = 0; round < 11; round++) { -+ if (round == 0) { -+ xor_128(round_key, data, ciphertext); -+ next_key(round_key, round); -+ } else if (round == 10) { -+ byte_sub(ciphertext, intermediatea); -+ shift_row(intermediatea, intermediateb); -+ xor_128(intermediateb, round_key, ciphertext); -+ } else { /* 1 - 9 */ -+ byte_sub(ciphertext, intermediatea); -+ shift_row(intermediatea, intermediateb); -+ mix_column(&intermediateb[0], &intermediatea[0]); -+ mix_column(&intermediateb[4], &intermediatea[4]); -+ mix_column(&intermediateb[8], &intermediatea[8]); -+ mix_column(&intermediateb[12], &intermediatea[12]); -+ xor_128(intermediatea, round_key, ciphertext); -+ next_key(round_key, round); -+ } -+ } -+} -+ -+ -+/************************************************/ -+/* construct_mic_iv() */ -+/* Builds the MIC IV from header fields and PN */ -+/* Baron think the function is construct CCM */ -+/* nonce */ -+/************************************************/ -+static void construct_mic_iv( -+ u8 *mic_iv, -+ sint qc_exists, -+ sint a4_exists, -+ u8 *mpdu, -+ uint payload_length, -+ u8 *pn_vector, -+ uint frtype/* add for CONFIG_IEEE80211W, none 11w also can use */ -+) -+{ -+ sint i; -+ mic_iv[0] = 0x59; -+ if (qc_exists && a4_exists) -+ mic_iv[1] = mpdu[30] & 0x0f; /* QoS_TC */ -+ if (qc_exists && !a4_exists) -+ mic_iv[1] = mpdu[24] & 0x0f; /* mute bits 7-4 */ -+ if (!qc_exists) -+ mic_iv[1] = 0x00; -+#ifdef CONFIG_IEEE80211W -+ /* 802.11w management frame should set management bit(4) */ -+ if (frtype == WIFI_MGT_TYPE) -+ mic_iv[1] |= BIT(4); -+#endif /* CONFIG_IEEE80211W */ -+ for (i = 2; i < 8; i++) -+ mic_iv[i] = mpdu[i + 8]; /* mic_iv[2:7] = A2[0:5] = mpdu[10:15] */ -+#ifdef CONSISTENT_PN_ORDER -+ for (i = 8; i < 14; i++) -+ mic_iv[i] = pn_vector[i - 8]; /* mic_iv[8:13] = PN[0:5] */ -+#else -+ for (i = 8; i < 14; i++) -+ mic_iv[i] = pn_vector[13 - i]; /* mic_iv[8:13] = PN[5:0] */ -+#endif -+ mic_iv[14] = (unsigned char)(payload_length / 256); -+ mic_iv[15] = (unsigned char)(payload_length % 256); -+} -+ -+ -+/************************************************/ -+/* construct_mic_header1() */ -+/* Builds the first MIC header block from */ -+/* header fields. */ -+/* Build AAD SC,A1,A2 */ -+/************************************************/ -+static void construct_mic_header1( -+ u8 *mic_header1, -+ sint header_length, -+ u8 *mpdu, -+ uint frtype/* add for CONFIG_IEEE80211W, none 11w also can use */ -+) -+{ -+ mic_header1[0] = (u8)((header_length - 2) / 256); -+ mic_header1[1] = (u8)((header_length - 2) % 256); -+#ifdef CONFIG_IEEE80211W -+ /* 802.11w management frame don't AND subtype bits 4,5,6 of frame control field */ -+ if (frtype == WIFI_MGT_TYPE) -+ mic_header1[2] = mpdu[0]; -+ else -+#endif /* CONFIG_IEEE80211W */ -+ mic_header1[2] = mpdu[0] & 0xcf; /* Mute CF poll & CF ack bits */ -+ -+ mic_header1[3] = mpdu[1] & 0xc7; /* Mute retry, more data and pwr mgt bits */ -+ mic_header1[4] = mpdu[4]; /* A1 */ -+ mic_header1[5] = mpdu[5]; -+ mic_header1[6] = mpdu[6]; -+ mic_header1[7] = mpdu[7]; -+ mic_header1[8] = mpdu[8]; -+ mic_header1[9] = mpdu[9]; -+ mic_header1[10] = mpdu[10]; /* A2 */ -+ mic_header1[11] = mpdu[11]; -+ mic_header1[12] = mpdu[12]; -+ mic_header1[13] = mpdu[13]; -+ mic_header1[14] = mpdu[14]; -+ mic_header1[15] = mpdu[15]; -+} -+ -+ -+/************************************************/ -+/* construct_mic_header2() */ -+/* Builds the last MIC header block from */ -+/* header fields. */ -+/************************************************/ -+static void construct_mic_header2( -+ u8 *mic_header2, -+ u8 *mpdu, -+ sint a4_exists, -+ sint qc_exists -+) -+{ -+ sint i; -+ for (i = 0; i < 16; i++) -+ mic_header2[i] = 0x00; -+ -+ mic_header2[0] = mpdu[16]; /* A3 */ -+ mic_header2[1] = mpdu[17]; -+ mic_header2[2] = mpdu[18]; -+ mic_header2[3] = mpdu[19]; -+ mic_header2[4] = mpdu[20]; -+ mic_header2[5] = mpdu[21]; -+ -+ /* mic_header2[6] = mpdu[22] & 0xf0; SC */ -+ mic_header2[6] = 0x00; -+ mic_header2[7] = 0x00; /* mpdu[23]; */ -+ -+ -+ if (!qc_exists && a4_exists) { -+ for (i = 0; i < 6; i++) -+ mic_header2[8 + i] = mpdu[24 + i]; /* A4 */ -+ -+ } -+ -+ if (qc_exists && !a4_exists) { -+ mic_header2[8] = mpdu[24] & 0x0f; /* mute bits 15 - 4 */ -+ mic_header2[9] = mpdu[25] & 0x00; -+ } -+ -+ if (qc_exists && a4_exists) { -+ for (i = 0; i < 6; i++) -+ mic_header2[8 + i] = mpdu[24 + i]; /* A4 */ -+ -+ mic_header2[14] = mpdu[30] & 0x0f; -+ mic_header2[15] = mpdu[31] & 0x00; -+ } -+ -+} -+ -+ -+/************************************************/ -+/* construct_mic_header2() */ -+/* Builds the last MIC header block from */ -+/* header fields. */ -+/* Baron think the function is construct CCM */ -+/* nonce */ -+/************************************************/ -+static void construct_ctr_preload( -+ u8 *ctr_preload, -+ sint a4_exists, -+ sint qc_exists, -+ u8 *mpdu, -+ u8 *pn_vector, -+ sint c, -+ uint frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+) -+{ -+ sint i = 0; -+ for (i = 0; i < 16; i++) -+ ctr_preload[i] = 0x00; -+ i = 0; -+ -+ ctr_preload[0] = 0x01; /* flag */ -+ if (qc_exists && a4_exists) -+ ctr_preload[1] = mpdu[30] & 0x0f; /* QoC_Control */ -+ if (qc_exists && !a4_exists) -+ ctr_preload[1] = mpdu[24] & 0x0f; -+#ifdef CONFIG_IEEE80211W -+ /* 802.11w management frame should set management bit(4) */ -+ if (frtype == WIFI_MGT_TYPE) -+ ctr_preload[1] |= BIT(4); -+#endif /* CONFIG_IEEE80211W */ -+ for (i = 2; i < 8; i++) -+ ctr_preload[i] = mpdu[i + 8]; /* ctr_preload[2:7] = A2[0:5] = mpdu[10:15] */ -+#ifdef CONSISTENT_PN_ORDER -+ for (i = 8; i < 14; i++) -+ ctr_preload[i] = pn_vector[i - 8]; /* ctr_preload[8:13] = PN[0:5] */ -+#else -+ for (i = 8; i < 14; i++) -+ ctr_preload[i] = pn_vector[13 - i]; /* ctr_preload[8:13] = PN[5:0] */ -+#endif -+ ctr_preload[14] = (unsigned char)(c / 256); /* Ctr */ -+ ctr_preload[15] = (unsigned char)(c % 256); -+} -+ -+ -+/************************************/ -+/* bitwise_xor() */ -+/* A 128 bit, bitwise exclusive or */ -+/************************************/ -+static void bitwise_xor(u8 *ina, u8 *inb, u8 *out) -+{ -+ sint i; -+ for (i = 0; i < 16; i++) -+ out[i] = ina[i] ^ inb[i]; -+} -+ -+ -+static sint aes_cipher(u8 *key, uint hdrlen, -+ u8 *pframe, uint plen) -+{ -+ /* static unsigned char message[MAX_MSG_SIZE]; */ -+ uint qc_exists, a4_exists, i, j, payload_remainder, -+ num_blocks, payload_index; -+ -+ u8 pn_vector[6]; -+ u8 mic_iv[16]; -+ u8 mic_header1[16]; -+ u8 mic_header2[16]; -+ u8 ctr_preload[16]; -+ -+ /* Intermediate Buffers */ -+ u8 chain_buffer[16]; -+ u8 aes_out[16]; -+ u8 padded_buffer[16]; -+ u8 mic[8]; -+ /* uint offset = 0; */ -+ uint frtype = GetFrameType(pframe); -+ uint frsubtype = GetFrameSubType(pframe); -+ -+ frsubtype = frsubtype >> 4; -+ -+ -+ _rtw_memset((void *)mic_iv, 0, 16); -+ _rtw_memset((void *)mic_header1, 0, 16); -+ _rtw_memset((void *)mic_header2, 0, 16); -+ _rtw_memset((void *)ctr_preload, 0, 16); -+ _rtw_memset((void *)chain_buffer, 0, 16); -+ _rtw_memset((void *)aes_out, 0, 16); -+ _rtw_memset((void *)padded_buffer, 0, 16); -+ -+ if ((hdrlen == WLAN_HDR_A3_LEN) || (hdrlen == WLAN_HDR_A3_QOS_LEN)) -+ a4_exists = 0; -+ else -+ a4_exists = 1; -+ -+ if ( -+ ((frtype | frsubtype) == WIFI_DATA_CFACK) || -+ ((frtype | frsubtype) == WIFI_DATA_CFPOLL) || -+ ((frtype | frsubtype) == WIFI_DATA_CFACKPOLL)) { -+ qc_exists = 1; -+ if (hdrlen != WLAN_HDR_A3_QOS_LEN) -+ -+ hdrlen += 2; -+ } -+ /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ else if ((frtype == WIFI_DATA) && -+ ((frsubtype == 0x08) || -+ (frsubtype == 0x09) || -+ (frsubtype == 0x0a) || -+ (frsubtype == 0x0b))) { -+ if (hdrlen != WLAN_HDR_A3_QOS_LEN) -+ -+ hdrlen += 2; -+ qc_exists = 1; -+ } else -+ qc_exists = 0; -+ -+ pn_vector[0] = pframe[hdrlen]; -+ pn_vector[1] = pframe[hdrlen + 1]; -+ pn_vector[2] = pframe[hdrlen + 4]; -+ pn_vector[3] = pframe[hdrlen + 5]; -+ pn_vector[4] = pframe[hdrlen + 6]; -+ pn_vector[5] = pframe[hdrlen + 7]; -+ -+ construct_mic_iv( -+ mic_iv, -+ qc_exists, -+ a4_exists, -+ pframe, /* message, */ -+ plen, -+ pn_vector, -+ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ); -+ -+ construct_mic_header1( -+ mic_header1, -+ hdrlen, -+ pframe, /* message */ -+ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ); -+ construct_mic_header2( -+ mic_header2, -+ pframe, /* message, */ -+ a4_exists, -+ qc_exists -+ ); -+ -+ -+ payload_remainder = plen % 16; -+ num_blocks = plen / 16; -+ -+ /* Find start of payload */ -+ payload_index = (hdrlen + 8); -+ -+ /* Calculate MIC */ -+ aes128k128d(key, mic_iv, aes_out); -+ bitwise_xor(aes_out, mic_header1, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ bitwise_xor(aes_out, mic_header2, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ -+ for (i = 0; i < num_blocks; i++) { -+ bitwise_xor(aes_out, &pframe[payload_index], chain_buffer);/* bitwise_xor(aes_out, &message[payload_index], chain_buffer); */ -+ -+ payload_index += 16; -+ aes128k128d(key, chain_buffer, aes_out); -+ } -+ -+ /* Add on the final payload block if it needs padding */ -+ if (payload_remainder > 0) { -+ for (j = 0; j < 16; j++) -+ padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) { -+ padded_buffer[j] = pframe[payload_index++];/* padded_buffer[j] = message[payload_index++]; */ -+ } -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ -+ } -+ -+ for (j = 0 ; j < 8; j++) -+ mic[j] = aes_out[j]; -+ -+ /* Insert MIC into payload */ -+ for (j = 0; j < 8; j++) -+ pframe[payload_index + j] = mic[j]; /* message[payload_index+j] = mic[j]; */ -+ -+ payload_index = hdrlen + 8; -+ for (i = 0; i < num_blocks; i++) { -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ pframe, /* message, */ -+ pn_vector, -+ i + 1, -+ frtype); /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, &pframe[payload_index], chain_buffer);/* bitwise_xor(aes_out, &message[payload_index], chain_buffer); */ -+ for (j = 0; j < 16; j++) -+ pframe[payload_index++] = chain_buffer[j];/* for (j=0; j<16;j++) message[payload_index++] = chain_buffer[j]; */ -+ } -+ -+ if (payload_remainder > 0) { /* If there is a short final block, then pad it,*/ -+ /* encrypt it and copy the unpadded part back */ -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ pframe, /* message, */ -+ pn_vector, -+ num_blocks + 1, -+ frtype); /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ -+ for (j = 0; j < 16; j++) -+ padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) { -+ padded_buffer[j] = pframe[payload_index + j]; /* padded_buffer[j] = message[payload_index+j]; */ -+ } -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ for (j = 0; j < payload_remainder; j++) -+ pframe[payload_index++] = chain_buffer[j];/* for (j=0; jattrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ /* uint offset = 0; */ -+ u32 res = _SUCCESS; -+ -+ if (((struct xmit_frame *)pxmitframe)->buf_addr == NULL) -+ return _FAIL; -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ hw_hdr_offset = TXDESC_SIZE + -+ (((struct xmit_frame *)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); -+#else -+#ifdef CONFIG_TX_EARLY_MODE -+ hw_hdr_offset = TXDESC_OFFSET + EARLY_MODE_INFO_SIZE; -+#else -+ hw_hdr_offset = TXDESC_OFFSET; -+#endif -+#endif -+ -+ pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + hw_hdr_offset; -+ -+ /* 4 start to encrypt each fragment */ -+ if ((pattrib->encrypt == _AES_)) { -+ /* -+ if(pattrib->psta) -+ { -+ stainfo = pattrib->psta; -+ } -+ else -+ { -+ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); -+ stainfo=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0] ); -+ } -+ */ -+ /* if (stainfo!=NULL) */ -+ { -+ /* -+ if(!(stainfo->state &_FW_LINKED)) -+ { -+ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, stainfo->state); -+ return _FAIL; -+ } -+ */ -+ -+ if (IS_MCAST(pattrib->ra)) -+ prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; -+ else { -+ /* prwskey=&stainfo->dot118021x_UncstKey.skey[0]; */ -+ prwskey = pattrib->dot118021x_UncstKey.skey; -+ } -+ -+#ifdef CONFIG_TDLS -+ { -+ /* Swencryption */ -+ struct sta_info *ptdls_sta; -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv , &pattrib->dst[0]); -+ if ((ptdls_sta != NULL) && (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) { -+ RTW_INFO("[%s] for tdls link\n", __FUNCTION__); -+ prwskey = &ptdls_sta->tpk.tk[0]; -+ } -+ } -+#endif /* CONFIG_TDLS */ -+ -+ prwskeylen = 16; -+ -+ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { -+ -+ if ((curfragnum + 1) == pattrib->nr_frags) { /* 4 the last fragment */ -+ length = pattrib->last_txcmdsz - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; -+ -+ aes_cipher(prwskey, pattrib->hdrlen, pframe, length); -+ } else { -+ length = pxmitpriv->frag_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len ; -+ -+ aes_cipher(prwskey, pattrib->hdrlen, pframe, length); -+ pframe += pxmitpriv->frag_len; -+ pframe = (u8 *)RND4((SIZE_PTR)(pframe)); -+ -+ } -+ } -+ -+ AES_SW_ENC_CNT_INC(psecuritypriv, pattrib->ra); -+ } -+ /* -+ else{ -+ RTW_INFO("%s, psta==NUL\n", __func__); -+ res=_FAIL; -+ } -+ */ -+ } -+ -+ -+ -+ return res; -+} -+ -+static sint aes_decipher(u8 *key, uint hdrlen, -+ u8 *pframe, uint plen) -+{ -+ static u8 message[MAX_MSG_SIZE]; -+ uint qc_exists, a4_exists, i, j, payload_remainder, -+ num_blocks, payload_index; -+ sint res = _SUCCESS; -+ u8 pn_vector[6]; -+ u8 mic_iv[16]; -+ u8 mic_header1[16]; -+ u8 mic_header2[16]; -+ u8 ctr_preload[16]; -+ -+ /* Intermediate Buffers */ -+ u8 chain_buffer[16]; -+ u8 aes_out[16]; -+ u8 padded_buffer[16]; -+ u8 mic[8]; -+ -+ -+ /* uint offset = 0; */ -+ uint frtype = GetFrameType(pframe); -+ uint frsubtype = GetFrameSubType(pframe); -+ frsubtype = frsubtype >> 4; -+ -+ -+ _rtw_memset((void *)mic_iv, 0, 16); -+ _rtw_memset((void *)mic_header1, 0, 16); -+ _rtw_memset((void *)mic_header2, 0, 16); -+ _rtw_memset((void *)ctr_preload, 0, 16); -+ _rtw_memset((void *)chain_buffer, 0, 16); -+ _rtw_memset((void *)aes_out, 0, 16); -+ _rtw_memset((void *)padded_buffer, 0, 16); -+ -+ /* start to decrypt the payload */ -+ -+ num_blocks = (plen - 8) / 16; /* (plen including LLC, payload_length and mic ) */ -+ -+ payload_remainder = (plen - 8) % 16; -+ -+ pn_vector[0] = pframe[hdrlen]; -+ pn_vector[1] = pframe[hdrlen + 1]; -+ pn_vector[2] = pframe[hdrlen + 4]; -+ pn_vector[3] = pframe[hdrlen + 5]; -+ pn_vector[4] = pframe[hdrlen + 6]; -+ pn_vector[5] = pframe[hdrlen + 7]; -+ -+ if ((hdrlen == WLAN_HDR_A3_LEN) || (hdrlen == WLAN_HDR_A3_QOS_LEN)) -+ a4_exists = 0; -+ else -+ a4_exists = 1; -+ -+ if ( -+ ((frtype | frsubtype) == WIFI_DATA_CFACK) || -+ ((frtype | frsubtype) == WIFI_DATA_CFPOLL) || -+ ((frtype | frsubtype) == WIFI_DATA_CFACKPOLL)) { -+ qc_exists = 1; -+ if (hdrlen != WLAN_HDR_A3_QOS_LEN) -+ -+ hdrlen += 2; -+ } /* only for data packet . add for CONFIG_IEEE80211W, none 11w also can use */ -+ else if ((frtype == WIFI_DATA) && -+ ((frsubtype == 0x08) || -+ (frsubtype == 0x09) || -+ (frsubtype == 0x0a) || -+ (frsubtype == 0x0b))) { -+ if (hdrlen != WLAN_HDR_A3_QOS_LEN) -+ -+ hdrlen += 2; -+ qc_exists = 1; -+ } else -+ qc_exists = 0; -+ -+ -+ /* now, decrypt pframe with hdrlen offset and plen long */ -+ -+ payload_index = hdrlen + 8; /* 8 is for extiv */ -+ -+ for (i = 0; i < num_blocks; i++) { -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ pframe, -+ pn_vector, -+ i + 1, -+ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ); -+ -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, &pframe[payload_index], chain_buffer); -+ -+ for (j = 0; j < 16; j++) -+ pframe[payload_index++] = chain_buffer[j]; -+ } -+ -+ if (payload_remainder > 0) { /* If there is a short final block, then pad it,*/ -+ /* encrypt it and copy the unpadded part back */ -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ pframe, -+ pn_vector, -+ num_blocks + 1, -+ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ); -+ -+ for (j = 0; j < 16; j++) -+ padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) -+ padded_buffer[j] = pframe[payload_index + j]; -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ for (j = 0; j < payload_remainder; j++) -+ pframe[payload_index++] = chain_buffer[j]; -+ } -+ -+ /* start to calculate the mic */ -+ if ((hdrlen + plen + 8) <= MAX_MSG_SIZE) -+ _rtw_memcpy((void *)message, pframe, (hdrlen + plen + 8)); /* 8 is for ext iv len */ -+ -+ -+ pn_vector[0] = pframe[hdrlen]; -+ pn_vector[1] = pframe[hdrlen + 1]; -+ pn_vector[2] = pframe[hdrlen + 4]; -+ pn_vector[3] = pframe[hdrlen + 5]; -+ pn_vector[4] = pframe[hdrlen + 6]; -+ pn_vector[5] = pframe[hdrlen + 7]; -+ -+ -+ -+ construct_mic_iv( -+ mic_iv, -+ qc_exists, -+ a4_exists, -+ message, -+ plen - 8, -+ pn_vector, -+ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ); -+ -+ construct_mic_header1( -+ mic_header1, -+ hdrlen, -+ message, -+ frtype /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ ); -+ construct_mic_header2( -+ mic_header2, -+ message, -+ a4_exists, -+ qc_exists -+ ); -+ -+ -+ payload_remainder = (plen - 8) % 16; -+ num_blocks = (plen - 8) / 16; -+ -+ /* Find start of payload */ -+ payload_index = (hdrlen + 8); -+ -+ /* Calculate MIC */ -+ aes128k128d(key, mic_iv, aes_out); -+ bitwise_xor(aes_out, mic_header1, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ bitwise_xor(aes_out, mic_header2, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ -+ for (i = 0; i < num_blocks; i++) { -+ bitwise_xor(aes_out, &message[payload_index], chain_buffer); -+ -+ payload_index += 16; -+ aes128k128d(key, chain_buffer, aes_out); -+ } -+ -+ /* Add on the final payload block if it needs padding */ -+ if (payload_remainder > 0) { -+ for (j = 0; j < 16; j++) -+ padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) -+ padded_buffer[j] = message[payload_index++]; -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ -+ } -+ -+ for (j = 0 ; j < 8; j++) -+ mic[j] = aes_out[j]; -+ -+ /* Insert MIC into payload */ -+ for (j = 0; j < 8; j++) -+ message[payload_index + j] = mic[j]; -+ -+ payload_index = hdrlen + 8; -+ for (i = 0; i < num_blocks; i++) { -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ message, -+ pn_vector, -+ i + 1, -+ frtype); /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, &message[payload_index], chain_buffer); -+ for (j = 0; j < 16; j++) -+ message[payload_index++] = chain_buffer[j]; -+ } -+ -+ if (payload_remainder > 0) { /* If there is a short final block, then pad it,*/ -+ /* encrypt it and copy the unpadded part back */ -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ message, -+ pn_vector, -+ num_blocks + 1, -+ frtype); /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ -+ for (j = 0; j < 16; j++) -+ padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) -+ padded_buffer[j] = message[payload_index + j]; -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ for (j = 0; j < payload_remainder; j++) -+ message[payload_index++] = chain_buffer[j]; -+ } -+ -+ /* Encrypt the MIC */ -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ message, -+ pn_vector, -+ 0, -+ frtype); /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ -+ for (j = 0; j < 16; j++) -+ padded_buffer[j] = 0x00; -+ for (j = 0; j < 8; j++) -+ padded_buffer[j] = message[j + hdrlen + 8 + plen - 8]; -+ -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ for (j = 0; j < 8; j++) -+ message[payload_index++] = chain_buffer[j]; -+ -+ /* compare the mic */ -+ for (i = 0; i < 8; i++) { -+ if (pframe[hdrlen + 8 + plen - 8 + i] != message[hdrlen + 8 + plen - 8 + i]) { -+ RTW_INFO("aes_decipher:mic check error mic[%d]: pframe(%x) != message(%x)\n", -+ i, pframe[hdrlen + 8 + plen - 8 + i], message[hdrlen + 8 + plen - 8 + i]); -+ res = _FAIL; -+ } -+ } -+ return res; -+} -+ -+u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe) -+{ -+ /* exclude ICV */ -+ -+ -+ /*static*/ -+ /* unsigned char message[MAX_MSG_SIZE]; */ -+ -+ -+ /* Intermediate Buffers */ -+ -+ -+ sint length; -+ u32 prwskeylen; -+ u8 *pframe, *prwskey; /* , *payload,*iv */ -+ struct sta_info *stainfo; -+ struct rx_pkt_attrib *prxattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ /* struct recv_priv *precvpriv=&padapter->recvpriv; */ -+ u32 res = _SUCCESS; -+ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; -+ /* 4 start to encrypt each fragment */ -+ if ((prxattrib->encrypt == _AES_)) { -+ -+ stainfo = rtw_get_stainfo(&padapter->stapriv , &prxattrib->ta[0]); -+ if (stainfo != NULL) { -+ -+ if (IS_MCAST(prxattrib->ra)) { -+ static u32 start = 0; -+ static u32 no_gkey_bc_cnt = 0; -+ static u32 no_gkey_mc_cnt = 0; -+ -+ /* RTW_INFO("rx bc/mc packets, to perform sw rtw_aes_decrypt\n"); */ -+ /* prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; */ -+ if (psecuritypriv->binstallGrpkey == _FALSE) { -+ res = _FAIL; -+ -+ if (start == 0) -+ start = rtw_get_current_time(); -+ -+ if (is_broadcast_mac_addr(prxattrib->ra)) -+ no_gkey_bc_cnt++; -+ else -+ no_gkey_mc_cnt++; -+ -+ if (rtw_get_passing_time_ms(start) > 1000) { -+ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { -+ RTW_PRINT(FUNC_ADPT_FMT" no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", -+ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); -+ } -+ start = rtw_get_current_time(); -+ no_gkey_bc_cnt = 0; -+ no_gkey_mc_cnt = 0; -+ } -+ -+ goto exit; -+ } -+ -+ if (no_gkey_bc_cnt || no_gkey_mc_cnt) { -+ RTW_PRINT(FUNC_ADPT_FMT" gkey installed. no_gkey_bc_cnt:%u, no_gkey_mc_cnt:%u\n", -+ FUNC_ADPT_ARG(padapter), no_gkey_bc_cnt, no_gkey_mc_cnt); -+ } -+ start = 0; -+ no_gkey_bc_cnt = 0; -+ no_gkey_mc_cnt = 0; -+ -+ prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; -+ if (psecuritypriv->dot118021XGrpKeyid != prxattrib->key_index) { -+ RTW_INFO("not match packet_index=%d, install_index=%d\n" -+ , prxattrib->key_index, psecuritypriv->dot118021XGrpKeyid); -+ res = _FAIL; -+ goto exit; -+ } -+ } else -+ prwskey = &stainfo->dot118021x_UncstKey.skey[0]; -+ -+ length = ((union recv_frame *)precvframe)->u.hdr.len - prxattrib->hdrlen - prxattrib->iv_len; -+#if 0 -+ /* add for CONFIG_IEEE80211W, debug */ -+ if (0) -+ printk("@@@@@@@@@@@@@@@@@@ length=%d, prxattrib->hdrlen=%d, prxattrib->pkt_len=%d\n" -+ , length, prxattrib->hdrlen, prxattrib->pkt_len); -+ if (0) { -+ int no; -+ /* test print PSK */ -+ printk("PSK key below:\n"); -+ for (no = 0; no < 16; no++) -+ printk(" %02x ", prwskey[no]); -+ printk("\n"); -+ } -+ if (0) { -+ int no; -+ /* test print PSK */ -+ printk("frame:\n"); -+ for (no = 0; no < prxattrib->pkt_len; no++) -+ printk(" %02x ", pframe[no]); -+ printk("\n"); -+ } -+#endif -+ -+ res = aes_decipher(prwskey, prxattrib->hdrlen, pframe, length); -+ -+ AES_SW_DEC_CNT_INC(psecuritypriv, prxattrib->ra); -+ } else { -+ res = _FAIL; -+ } -+ -+ } -+exit: -+ return res; -+} -+ -+#ifdef CONFIG_IEEE80211W -+u32 rtw_BIP_verify(_adapter *padapter, u8 *precvframe) -+{ -+ struct rx_pkt_attrib *pattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; -+ u8 *pframe; -+ u8 *BIP_AAD, *p; -+ u32 res = _FAIL; -+ uint len, ori_len; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u8 mic[16]; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ ori_len = pattrib->pkt_len - WLAN_HDR_A3_LEN + BIP_AAD_SIZE; -+ BIP_AAD = rtw_zmalloc(ori_len); -+ -+ if (BIP_AAD == NULL) { -+ RTW_INFO("BIP AAD allocate fail\n"); -+ return _FAIL; -+ } -+ /* PKT start */ -+ pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; -+ /* mapping to wlan header */ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ /* save the frame body + MME */ -+ _rtw_memcpy(BIP_AAD + BIP_AAD_SIZE, pframe + WLAN_HDR_A3_LEN, pattrib->pkt_len - WLAN_HDR_A3_LEN); -+ /* find MME IE pointer */ -+ p = rtw_get_ie(BIP_AAD + BIP_AAD_SIZE, _MME_IE_, &len, pattrib->pkt_len - WLAN_HDR_A3_LEN); -+ /* Baron */ -+ if (p) { -+ u16 keyid = 0; -+ u64 temp_ipn = 0; -+ /* save packet number */ -+ _rtw_memcpy(&temp_ipn, p + 4, 6); -+ temp_ipn = le64_to_cpu(temp_ipn); -+ /* BIP packet number should bigger than previous BIP packet */ -+ if (temp_ipn < pmlmeext->mgnt_80211w_IPN_rx) { -+ RTW_INFO("replay BIP packet\n"); -+ goto BIP_exit; -+ } -+ /* copy key index */ -+ _rtw_memcpy(&keyid, p + 2, 2); -+ keyid = le16_to_cpu(keyid); -+ if (keyid != padapter->securitypriv.dot11wBIPKeyid) { -+ RTW_INFO("BIP key index error!\n"); -+ goto BIP_exit; -+ } -+ /* clear the MIC field of MME to zero */ -+ _rtw_memset(p + 2 + len - 8, 0, 8); -+ -+ /* conscruct AAD, copy frame control field */ -+ _rtw_memcpy(BIP_AAD, &pwlanhdr->frame_ctl, 2); -+ ClearRetry(BIP_AAD); -+ ClearPwrMgt(BIP_AAD); -+ ClearMData(BIP_AAD); -+ /* conscruct AAD, copy address 1 to address 3 */ -+ _rtw_memcpy(BIP_AAD + 2, pwlanhdr->addr1, 18); -+ -+ if (omac1_aes_128(padapter->securitypriv.dot11wBIPKey[padapter->securitypriv.dot11wBIPKeyid].skey -+ , BIP_AAD, ori_len, mic)) -+ goto BIP_exit; -+ -+#if 0 -+ /* management packet content */ -+ { -+ int pp; -+ RTW_INFO("pkt: "); -+ for (pp = 0; pp < pattrib->pkt_len; pp++) -+ printk(" %02x ", pframe[pp]); -+ RTW_INFO("\n"); -+ /* BIP AAD + management frame body + MME(MIC is zero) */ -+ RTW_INFO("AAD+PKT: "); -+ for (pp = 0; pp < ori_len; pp++) -+ RTW_INFO(" %02x ", BIP_AAD[pp]); -+ RTW_INFO("\n"); -+ /* show the MIC result */ -+ RTW_INFO("mic: "); -+ for (pp = 0; pp < 16; pp++) -+ RTW_INFO(" %02x ", mic[pp]); -+ RTW_INFO("\n"); -+ } -+#endif -+ /* MIC field should be last 8 bytes of packet (packet without FCS) */ -+ if (_rtw_memcmp(mic, pframe + pattrib->pkt_len - 8, 8)) { -+ pmlmeext->mgnt_80211w_IPN_rx = temp_ipn; -+ res = _SUCCESS; -+ } else -+ RTW_INFO("BIP MIC error!\n"); -+ -+ } else -+ res = RTW_RX_HANDLED; -+BIP_exit: -+ -+ rtw_mfree(BIP_AAD, ori_len); -+ return res; -+} -+#endif /* CONFIG_IEEE80211W */ -+ -+#ifndef PLATFORM_FREEBSD -+/* compress 512-bits */ -+static int sha256_compress(struct sha256_state *md, unsigned char *buf) -+{ -+ u32 S[8], W[64], t0, t1; -+ u32 t; -+ int i; -+ -+ /* copy state into S */ -+ for (i = 0; i < 8; i++) -+ S[i] = md->state[i]; -+ -+ /* copy the state into 512-bits into W[0..15] */ -+ for (i = 0; i < 16; i++) -+ W[i] = WPA_GET_BE32(buf + (4 * i)); -+ -+ /* fill W[16..63] */ -+ for (i = 16; i < 64; i++) { -+ W[i] = Gamma1(W[i - 2]) + W[i - 7] + Gamma0(W[i - 15]) + -+ W[i - 16]; -+ } -+ -+ /* Compress */ -+#define RND(a, b, c, d, e, f, g, h, i) do {\ -+ t0 = h + Sigma1(e) + Ch(e, f, g) + K[i] + W[i]; \ -+ t1 = Sigma0(a) + Maj(a, b, c); \ -+ d += t0; \ -+ h = t0 + t1; \ -+ } while (0) -+ -+ for (i = 0; i < 64; ++i) { -+ RND(S[0], S[1], S[2], S[3], S[4], S[5], S[6], S[7], i); -+ t = S[7]; -+ S[7] = S[6]; -+ S[6] = S[5]; -+ S[5] = S[4]; -+ S[4] = S[3]; -+ S[3] = S[2]; -+ S[2] = S[1]; -+ S[1] = S[0]; -+ S[0] = t; -+ } -+ -+ /* feedback */ -+ for (i = 0; i < 8; i++) -+ md->state[i] = md->state[i] + S[i]; -+ return 0; -+} -+ -+/* Initialize the hash state */ -+static void sha256_init(struct sha256_state *md) -+{ -+ md->curlen = 0; -+ md->length = 0; -+ md->state[0] = 0x6A09E667UL; -+ md->state[1] = 0xBB67AE85UL; -+ md->state[2] = 0x3C6EF372UL; -+ md->state[3] = 0xA54FF53AUL; -+ md->state[4] = 0x510E527FUL; -+ md->state[5] = 0x9B05688CUL; -+ md->state[6] = 0x1F83D9ABUL; -+ md->state[7] = 0x5BE0CD19UL; -+} -+ -+/** -+ Process a block of memory though the hash -+ @param md The hash state -+ @param in The data to hash -+ @param inlen The length of the data (octets) -+ @return CRYPT_OK if successful -+*/ -+static int sha256_process(struct sha256_state *md, unsigned char *in, -+ unsigned long inlen) -+{ -+ unsigned long n; -+#define block_size 64 -+ -+ if (md->curlen > sizeof(md->buf)) -+ return -1; -+ -+ while (inlen > 0) { -+ if (md->curlen == 0 && inlen >= block_size) { -+ if (sha256_compress(md, (unsigned char *) in) < 0) -+ return -1; -+ md->length += block_size * 8; -+ in += block_size; -+ inlen -= block_size; -+ } else { -+ n = MIN(inlen, (block_size - md->curlen)); -+ _rtw_memcpy(md->buf + md->curlen, in, n); -+ md->curlen += n; -+ in += n; -+ inlen -= n; -+ if (md->curlen == block_size) { -+ if (sha256_compress(md, md->buf) < 0) -+ return -1; -+ md->length += 8 * block_size; -+ md->curlen = 0; -+ } -+ } -+ } -+ -+ return 0; -+} -+ -+ -+/** -+ Terminate the hash to get the digest -+ @param md The hash state -+ @param out [out] The destination of the hash (32 bytes) -+ @return CRYPT_OK if successful -+*/ -+static int sha256_done(struct sha256_state *md, unsigned char *out) -+{ -+ int i; -+ -+ if (md->curlen >= sizeof(md->buf)) -+ return -1; -+ -+ /* increase the length of the message */ -+ md->length += md->curlen * 8; -+ -+ /* append the '1' bit */ -+ md->buf[md->curlen++] = (unsigned char) 0x80; -+ -+ /* if the length is currently above 56 bytes we append zeros -+ * then compress. Then we can fall back to padding zeros and length -+ * encoding like normal. -+ */ -+ if (md->curlen > 56) { -+ while (md->curlen < 64) -+ md->buf[md->curlen++] = (unsigned char) 0; -+ sha256_compress(md, md->buf); -+ md->curlen = 0; -+ } -+ -+ /* pad upto 56 bytes of zeroes */ -+ while (md->curlen < 56) -+ md->buf[md->curlen++] = (unsigned char) 0; -+ -+ /* store length */ -+ WPA_PUT_BE64(md->buf + 56, md->length); -+ sha256_compress(md, md->buf); -+ -+ /* copy output */ -+ for (i = 0; i < 8; i++) -+ WPA_PUT_BE32(out + (4 * i), md->state[i]); -+ -+ return 0; -+} -+ -+/** -+ * sha256_vector - SHA256 hash for data vector -+ * @num_elem: Number of elements in the data vector -+ * @addr: Pointers to the data areas -+ * @len: Lengths of the data blocks -+ * @mac: Buffer for the hash -+ * Returns: 0 on success, -1 of failure -+ */ -+static int sha256_vector(size_t num_elem, u8 *addr[], size_t *len, -+ u8 *mac) -+{ -+ struct sha256_state ctx; -+ size_t i; -+ -+ sha256_init(&ctx); -+ for (i = 0; i < num_elem; i++) -+ if (sha256_process(&ctx, addr[i], len[i])) -+ return -1; -+ if (sha256_done(&ctx, mac)) -+ return -1; -+ return 0; -+} -+ -+static u8 os_strlen(const char *s) -+{ -+ const char *p = s; -+ while (*p) -+ p++; -+ return p - s; -+} -+ -+static int os_memcmp(void *s1, void *s2, u8 n) -+{ -+ unsigned char *p1 = s1, *p2 = s2; -+ -+ if (n == 0) -+ return 0; -+ -+ while (*p1 == *p2) { -+ p1++; -+ p2++; -+ n--; -+ if (n == 0) -+ return 0; -+ } -+ -+ return *p1 - *p2; -+} -+ -+/** -+ * hmac_sha256_vector - HMAC-SHA256 over data vector (RFC 2104) -+ * @key: Key for HMAC operations -+ * @key_len: Length of the key in bytes -+ * @num_elem: Number of elements in the data vector -+ * @addr: Pointers to the data areas -+ * @len: Lengths of the data blocks -+ * @mac: Buffer for the hash (32 bytes) -+ */ -+static void hmac_sha256_vector(u8 *key, size_t key_len, size_t num_elem, -+ u8 *addr[], size_t *len, u8 *mac) -+{ -+ unsigned char k_pad[64]; /* padding - key XORd with ipad/opad */ -+ unsigned char tk[32]; -+ u8 *_addr[6]; -+ size_t _len[6], i; -+ -+ if (num_elem > 5) { -+ /* -+ * Fixed limit on the number of fragments to avoid having to -+ * allocate memory (which could fail). -+ */ -+ return; -+ } -+ -+ /* if key is longer than 64 bytes reset it to key = SHA256(key) */ -+ if (key_len > 64) { -+ sha256_vector(1, &key, &key_len, tk); -+ key = tk; -+ key_len = 32; -+ } -+ -+ /* the HMAC_SHA256 transform looks like: -+ * -+ * SHA256(K XOR opad, SHA256(K XOR ipad, text)) -+ * -+ * where K is an n byte key -+ * ipad is the byte 0x36 repeated 64 times -+ * opad is the byte 0x5c repeated 64 times -+ * and text is the data being protected */ -+ -+ /* start out by storing key in ipad */ -+ _rtw_memset(k_pad, 0, sizeof(k_pad)); -+ _rtw_memcpy(k_pad, key, key_len); -+ /* XOR key with ipad values */ -+ for (i = 0; i < 64; i++) -+ k_pad[i] ^= 0x36; -+ -+ /* perform inner SHA256 */ -+ _addr[0] = k_pad; -+ _len[0] = 64; -+ for (i = 0; i < num_elem; i++) { -+ _addr[i + 1] = addr[i]; -+ _len[i + 1] = len[i]; -+ } -+ sha256_vector(1 + num_elem, _addr, _len, mac); -+ -+ _rtw_memset(k_pad, 0, sizeof(k_pad)); -+ _rtw_memcpy(k_pad, key, key_len); -+ /* XOR key with opad values */ -+ for (i = 0; i < 64; i++) -+ k_pad[i] ^= 0x5c; -+ -+ /* perform outer SHA256 */ -+ _addr[0] = k_pad; -+ _len[0] = 64; -+ _addr[1] = mac; -+ _len[1] = 32; -+ sha256_vector(2, _addr, _len, mac); -+} -+#endif /* PLATFORM_FREEBSD */ -+/** -+ * sha256_prf - SHA256-based Pseudo-Random Function (IEEE 802.11r, 8.5.1.5.2) -+ * @key: Key for PRF -+ * @key_len: Length of the key in bytes -+ * @label: A unique label for each purpose of the PRF -+ * @data: Extra data to bind into the key -+ * @data_len: Length of the data -+ * @buf: Buffer for the generated pseudo-random key -+ * @buf_len: Number of bytes of key to generate -+ * -+ * This function is used to derive new, cryptographically separate keys from a -+ * given key. -+ */ -+#ifndef PLATFORM_FREEBSD /* Baron */ -+static void sha256_prf(u8 *key, size_t key_len, char *label, -+ u8 *data, size_t data_len, u8 *buf, size_t buf_len) -+{ -+ u16 counter = 1; -+ size_t pos, plen; -+ u8 hash[SHA256_MAC_LEN]; -+ u8 *addr[4]; -+ size_t len[4]; -+ u8 counter_le[2], length_le[2]; -+ -+ addr[0] = counter_le; -+ len[0] = 2; -+ addr[1] = (u8 *) label; -+ len[1] = os_strlen(label); -+ addr[2] = data; -+ len[2] = data_len; -+ addr[3] = length_le; -+ len[3] = sizeof(length_le); -+ -+ WPA_PUT_LE16(length_le, buf_len * 8); -+ pos = 0; -+ while (pos < buf_len) { -+ plen = buf_len - pos; -+ WPA_PUT_LE16(counter_le, counter); -+ if (plen >= SHA256_MAC_LEN) { -+ hmac_sha256_vector(key, key_len, 4, addr, len, -+ &buf[pos]); -+ pos += SHA256_MAC_LEN; -+ } else { -+ hmac_sha256_vector(key, key_len, 4, addr, len, hash); -+ _rtw_memcpy(&buf[pos], hash, plen); -+ break; -+ } -+ counter++; -+ } -+} -+#endif /* PLATFORM_FREEBSD Baron */ -+ -+/* AES tables*/ -+const u32 Te0[256] = { -+ 0xc66363a5U, 0xf87c7c84U, 0xee777799U, 0xf67b7b8dU, -+ 0xfff2f20dU, 0xd66b6bbdU, 0xde6f6fb1U, 0x91c5c554U, -+ 0x60303050U, 0x02010103U, 0xce6767a9U, 0x562b2b7dU, -+ 0xe7fefe19U, 0xb5d7d762U, 0x4dababe6U, 0xec76769aU, -+ 0x8fcaca45U, 0x1f82829dU, 0x89c9c940U, 0xfa7d7d87U, -+ 0xeffafa15U, 0xb25959ebU, 0x8e4747c9U, 0xfbf0f00bU, -+ 0x41adadecU, 0xb3d4d467U, 0x5fa2a2fdU, 0x45afafeaU, -+ 0x239c9cbfU, 0x53a4a4f7U, 0xe4727296U, 0x9bc0c05bU, -+ 0x75b7b7c2U, 0xe1fdfd1cU, 0x3d9393aeU, 0x4c26266aU, -+ 0x6c36365aU, 0x7e3f3f41U, 0xf5f7f702U, 0x83cccc4fU, -+ 0x6834345cU, 0x51a5a5f4U, 0xd1e5e534U, 0xf9f1f108U, -+ 0xe2717193U, 0xabd8d873U, 0x62313153U, 0x2a15153fU, -+ 0x0804040cU, 0x95c7c752U, 0x46232365U, 0x9dc3c35eU, -+ 0x30181828U, 0x379696a1U, 0x0a05050fU, 0x2f9a9ab5U, -+ 0x0e070709U, 0x24121236U, 0x1b80809bU, 0xdfe2e23dU, -+ 0xcdebeb26U, 0x4e272769U, 0x7fb2b2cdU, 0xea75759fU, -+ 0x1209091bU, 0x1d83839eU, 0x582c2c74U, 0x341a1a2eU, -+ 0x361b1b2dU, 0xdc6e6eb2U, 0xb45a5aeeU, 0x5ba0a0fbU, -+ 0xa45252f6U, 0x763b3b4dU, 0xb7d6d661U, 0x7db3b3ceU, -+ 0x5229297bU, 0xdde3e33eU, 0x5e2f2f71U, 0x13848497U, -+ 0xa65353f5U, 0xb9d1d168U, 0x00000000U, 0xc1eded2cU, -+ 0x40202060U, 0xe3fcfc1fU, 0x79b1b1c8U, 0xb65b5bedU, -+ 0xd46a6abeU, 0x8dcbcb46U, 0x67bebed9U, 0x7239394bU, -+ 0x944a4adeU, 0x984c4cd4U, 0xb05858e8U, 0x85cfcf4aU, -+ 0xbbd0d06bU, 0xc5efef2aU, 0x4faaaae5U, 0xedfbfb16U, -+ 0x864343c5U, 0x9a4d4dd7U, 0x66333355U, 0x11858594U, -+ 0x8a4545cfU, 0xe9f9f910U, 0x04020206U, 0xfe7f7f81U, -+ 0xa05050f0U, 0x783c3c44U, 0x259f9fbaU, 0x4ba8a8e3U, -+ 0xa25151f3U, 0x5da3a3feU, 0x804040c0U, 0x058f8f8aU, -+ 0x3f9292adU, 0x219d9dbcU, 0x70383848U, 0xf1f5f504U, -+ 0x63bcbcdfU, 0x77b6b6c1U, 0xafdada75U, 0x42212163U, -+ 0x20101030U, 0xe5ffff1aU, 0xfdf3f30eU, 0xbfd2d26dU, -+ 0x81cdcd4cU, 0x180c0c14U, 0x26131335U, 0xc3ecec2fU, -+ 0xbe5f5fe1U, 0x359797a2U, 0x884444ccU, 0x2e171739U, -+ 0x93c4c457U, 0x55a7a7f2U, 0xfc7e7e82U, 0x7a3d3d47U, -+ 0xc86464acU, 0xba5d5de7U, 0x3219192bU, 0xe6737395U, -+ 0xc06060a0U, 0x19818198U, 0x9e4f4fd1U, 0xa3dcdc7fU, -+ 0x44222266U, 0x542a2a7eU, 0x3b9090abU, 0x0b888883U, -+ 0x8c4646caU, 0xc7eeee29U, 0x6bb8b8d3U, 0x2814143cU, -+ 0xa7dede79U, 0xbc5e5ee2U, 0x160b0b1dU, 0xaddbdb76U, -+ 0xdbe0e03bU, 0x64323256U, 0x743a3a4eU, 0x140a0a1eU, -+ 0x924949dbU, 0x0c06060aU, 0x4824246cU, 0xb85c5ce4U, -+ 0x9fc2c25dU, 0xbdd3d36eU, 0x43acacefU, 0xc46262a6U, -+ 0x399191a8U, 0x319595a4U, 0xd3e4e437U, 0xf279798bU, -+ 0xd5e7e732U, 0x8bc8c843U, 0x6e373759U, 0xda6d6db7U, -+ 0x018d8d8cU, 0xb1d5d564U, 0x9c4e4ed2U, 0x49a9a9e0U, -+ 0xd86c6cb4U, 0xac5656faU, 0xf3f4f407U, 0xcfeaea25U, -+ 0xca6565afU, 0xf47a7a8eU, 0x47aeaee9U, 0x10080818U, -+ 0x6fbabad5U, 0xf0787888U, 0x4a25256fU, 0x5c2e2e72U, -+ 0x381c1c24U, 0x57a6a6f1U, 0x73b4b4c7U, 0x97c6c651U, -+ 0xcbe8e823U, 0xa1dddd7cU, 0xe874749cU, 0x3e1f1f21U, -+ 0x964b4bddU, 0x61bdbddcU, 0x0d8b8b86U, 0x0f8a8a85U, -+ 0xe0707090U, 0x7c3e3e42U, 0x71b5b5c4U, 0xcc6666aaU, -+ 0x904848d8U, 0x06030305U, 0xf7f6f601U, 0x1c0e0e12U, -+ 0xc26161a3U, 0x6a35355fU, 0xae5757f9U, 0x69b9b9d0U, -+ 0x17868691U, 0x99c1c158U, 0x3a1d1d27U, 0x279e9eb9U, -+ 0xd9e1e138U, 0xebf8f813U, 0x2b9898b3U, 0x22111133U, -+ 0xd26969bbU, 0xa9d9d970U, 0x078e8e89U, 0x339494a7U, -+ 0x2d9b9bb6U, 0x3c1e1e22U, 0x15878792U, 0xc9e9e920U, -+ 0x87cece49U, 0xaa5555ffU, 0x50282878U, 0xa5dfdf7aU, -+ 0x038c8c8fU, 0x59a1a1f8U, 0x09898980U, 0x1a0d0d17U, -+ 0x65bfbfdaU, 0xd7e6e631U, 0x844242c6U, 0xd06868b8U, -+ 0x824141c3U, 0x299999b0U, 0x5a2d2d77U, 0x1e0f0f11U, -+ 0x7bb0b0cbU, 0xa85454fcU, 0x6dbbbbd6U, 0x2c16163aU, -+}; -+const u32 Td0[256] = { -+ 0x51f4a750U, 0x7e416553U, 0x1a17a4c3U, 0x3a275e96U, -+ 0x3bab6bcbU, 0x1f9d45f1U, 0xacfa58abU, 0x4be30393U, -+ 0x2030fa55U, 0xad766df6U, 0x88cc7691U, 0xf5024c25U, -+ 0x4fe5d7fcU, 0xc52acbd7U, 0x26354480U, 0xb562a38fU, -+ 0xdeb15a49U, 0x25ba1b67U, 0x45ea0e98U, 0x5dfec0e1U, -+ 0xc32f7502U, 0x814cf012U, 0x8d4697a3U, 0x6bd3f9c6U, -+ 0x038f5fe7U, 0x15929c95U, 0xbf6d7aebU, 0x955259daU, -+ 0xd4be832dU, 0x587421d3U, 0x49e06929U, 0x8ec9c844U, -+ 0x75c2896aU, 0xf48e7978U, 0x99583e6bU, 0x27b971ddU, -+ 0xbee14fb6U, 0xf088ad17U, 0xc920ac66U, 0x7dce3ab4U, -+ 0x63df4a18U, 0xe51a3182U, 0x97513360U, 0x62537f45U, -+ 0xb16477e0U, 0xbb6bae84U, 0xfe81a01cU, 0xf9082b94U, -+ 0x70486858U, 0x8f45fd19U, 0x94de6c87U, 0x527bf8b7U, -+ 0xab73d323U, 0x724b02e2U, 0xe31f8f57U, 0x6655ab2aU, -+ 0xb2eb2807U, 0x2fb5c203U, 0x86c57b9aU, 0xd33708a5U, -+ 0x302887f2U, 0x23bfa5b2U, 0x02036abaU, 0xed16825cU, -+ 0x8acf1c2bU, 0xa779b492U, 0xf307f2f0U, 0x4e69e2a1U, -+ 0x65daf4cdU, 0x0605bed5U, 0xd134621fU, 0xc4a6fe8aU, -+ 0x342e539dU, 0xa2f355a0U, 0x058ae132U, 0xa4f6eb75U, -+ 0x0b83ec39U, 0x4060efaaU, 0x5e719f06U, 0xbd6e1051U, -+ 0x3e218af9U, 0x96dd063dU, 0xdd3e05aeU, 0x4de6bd46U, -+ 0x91548db5U, 0x71c45d05U, 0x0406d46fU, 0x605015ffU, -+ 0x1998fb24U, 0xd6bde997U, 0x894043ccU, 0x67d99e77U, -+ 0xb0e842bdU, 0x07898b88U, 0xe7195b38U, 0x79c8eedbU, -+ 0xa17c0a47U, 0x7c420fe9U, 0xf8841ec9U, 0x00000000U, -+ 0x09808683U, 0x322bed48U, 0x1e1170acU, 0x6c5a724eU, -+ 0xfd0efffbU, 0x0f853856U, 0x3daed51eU, 0x362d3927U, -+ 0x0a0fd964U, 0x685ca621U, 0x9b5b54d1U, 0x24362e3aU, -+ 0x0c0a67b1U, 0x9357e70fU, 0xb4ee96d2U, 0x1b9b919eU, -+ 0x80c0c54fU, 0x61dc20a2U, 0x5a774b69U, 0x1c121a16U, -+ 0xe293ba0aU, 0xc0a02ae5U, 0x3c22e043U, 0x121b171dU, -+ 0x0e090d0bU, 0xf28bc7adU, 0x2db6a8b9U, 0x141ea9c8U, -+ 0x57f11985U, 0xaf75074cU, 0xee99ddbbU, 0xa37f60fdU, -+ 0xf701269fU, 0x5c72f5bcU, 0x44663bc5U, 0x5bfb7e34U, -+ 0x8b432976U, 0xcb23c6dcU, 0xb6edfc68U, 0xb8e4f163U, -+ 0xd731dccaU, 0x42638510U, 0x13972240U, 0x84c61120U, -+ 0x854a247dU, 0xd2bb3df8U, 0xaef93211U, 0xc729a16dU, -+ 0x1d9e2f4bU, 0xdcb230f3U, 0x0d8652ecU, 0x77c1e3d0U, -+ 0x2bb3166cU, 0xa970b999U, 0x119448faU, 0x47e96422U, -+ 0xa8fc8cc4U, 0xa0f03f1aU, 0x567d2cd8U, 0x223390efU, -+ 0x87494ec7U, 0xd938d1c1U, 0x8ccaa2feU, 0x98d40b36U, -+ 0xa6f581cfU, 0xa57ade28U, 0xdab78e26U, 0x3fadbfa4U, -+ 0x2c3a9de4U, 0x5078920dU, 0x6a5fcc9bU, 0x547e4662U, -+ 0xf68d13c2U, 0x90d8b8e8U, 0x2e39f75eU, 0x82c3aff5U, -+ 0x9f5d80beU, 0x69d0937cU, 0x6fd52da9U, 0xcf2512b3U, -+ 0xc8ac993bU, 0x10187da7U, 0xe89c636eU, 0xdb3bbb7bU, -+ 0xcd267809U, 0x6e5918f4U, 0xec9ab701U, 0x834f9aa8U, -+ 0xe6956e65U, 0xaaffe67eU, 0x21bccf08U, 0xef15e8e6U, -+ 0xbae79bd9U, 0x4a6f36ceU, 0xea9f09d4U, 0x29b07cd6U, -+ 0x31a4b2afU, 0x2a3f2331U, 0xc6a59430U, 0x35a266c0U, -+ 0x744ebc37U, 0xfc82caa6U, 0xe090d0b0U, 0x33a7d815U, -+ 0xf104984aU, 0x41ecdaf7U, 0x7fcd500eU, 0x1791f62fU, -+ 0x764dd68dU, 0x43efb04dU, 0xccaa4d54U, 0xe49604dfU, -+ 0x9ed1b5e3U, 0x4c6a881bU, 0xc12c1fb8U, 0x4665517fU, -+ 0x9d5eea04U, 0x018c355dU, 0xfa877473U, 0xfb0b412eU, -+ 0xb3671d5aU, 0x92dbd252U, 0xe9105633U, 0x6dd64713U, -+ 0x9ad7618cU, 0x37a10c7aU, 0x59f8148eU, 0xeb133c89U, -+ 0xcea927eeU, 0xb761c935U, 0xe11ce5edU, 0x7a47b13cU, -+ 0x9cd2df59U, 0x55f2733fU, 0x1814ce79U, 0x73c737bfU, -+ 0x53f7cdeaU, 0x5ffdaa5bU, 0xdf3d6f14U, 0x7844db86U, -+ 0xcaaff381U, 0xb968c43eU, 0x3824342cU, 0xc2a3405fU, -+ 0x161dc372U, 0xbce2250cU, 0x283c498bU, 0xff0d9541U, -+ 0x39a80171U, 0x080cb3deU, 0xd8b4e49cU, 0x6456c190U, -+ 0x7bcb8461U, 0xd532b670U, 0x486c5c74U, 0xd0b85742U, -+}; -+const u8 Td4s[256] = { -+ 0x52U, 0x09U, 0x6aU, 0xd5U, 0x30U, 0x36U, 0xa5U, 0x38U, -+ 0xbfU, 0x40U, 0xa3U, 0x9eU, 0x81U, 0xf3U, 0xd7U, 0xfbU, -+ 0x7cU, 0xe3U, 0x39U, 0x82U, 0x9bU, 0x2fU, 0xffU, 0x87U, -+ 0x34U, 0x8eU, 0x43U, 0x44U, 0xc4U, 0xdeU, 0xe9U, 0xcbU, -+ 0x54U, 0x7bU, 0x94U, 0x32U, 0xa6U, 0xc2U, 0x23U, 0x3dU, -+ 0xeeU, 0x4cU, 0x95U, 0x0bU, 0x42U, 0xfaU, 0xc3U, 0x4eU, -+ 0x08U, 0x2eU, 0xa1U, 0x66U, 0x28U, 0xd9U, 0x24U, 0xb2U, -+ 0x76U, 0x5bU, 0xa2U, 0x49U, 0x6dU, 0x8bU, 0xd1U, 0x25U, -+ 0x72U, 0xf8U, 0xf6U, 0x64U, 0x86U, 0x68U, 0x98U, 0x16U, -+ 0xd4U, 0xa4U, 0x5cU, 0xccU, 0x5dU, 0x65U, 0xb6U, 0x92U, -+ 0x6cU, 0x70U, 0x48U, 0x50U, 0xfdU, 0xedU, 0xb9U, 0xdaU, -+ 0x5eU, 0x15U, 0x46U, 0x57U, 0xa7U, 0x8dU, 0x9dU, 0x84U, -+ 0x90U, 0xd8U, 0xabU, 0x00U, 0x8cU, 0xbcU, 0xd3U, 0x0aU, -+ 0xf7U, 0xe4U, 0x58U, 0x05U, 0xb8U, 0xb3U, 0x45U, 0x06U, -+ 0xd0U, 0x2cU, 0x1eU, 0x8fU, 0xcaU, 0x3fU, 0x0fU, 0x02U, -+ 0xc1U, 0xafU, 0xbdU, 0x03U, 0x01U, 0x13U, 0x8aU, 0x6bU, -+ 0x3aU, 0x91U, 0x11U, 0x41U, 0x4fU, 0x67U, 0xdcU, 0xeaU, -+ 0x97U, 0xf2U, 0xcfU, 0xceU, 0xf0U, 0xb4U, 0xe6U, 0x73U, -+ 0x96U, 0xacU, 0x74U, 0x22U, 0xe7U, 0xadU, 0x35U, 0x85U, -+ 0xe2U, 0xf9U, 0x37U, 0xe8U, 0x1cU, 0x75U, 0xdfU, 0x6eU, -+ 0x47U, 0xf1U, 0x1aU, 0x71U, 0x1dU, 0x29U, 0xc5U, 0x89U, -+ 0x6fU, 0xb7U, 0x62U, 0x0eU, 0xaaU, 0x18U, 0xbeU, 0x1bU, -+ 0xfcU, 0x56U, 0x3eU, 0x4bU, 0xc6U, 0xd2U, 0x79U, 0x20U, -+ 0x9aU, 0xdbU, 0xc0U, 0xfeU, 0x78U, 0xcdU, 0x5aU, 0xf4U, -+ 0x1fU, 0xddU, 0xa8U, 0x33U, 0x88U, 0x07U, 0xc7U, 0x31U, -+ 0xb1U, 0x12U, 0x10U, 0x59U, 0x27U, 0x80U, 0xecU, 0x5fU, -+ 0x60U, 0x51U, 0x7fU, 0xa9U, 0x19U, 0xb5U, 0x4aU, 0x0dU, -+ 0x2dU, 0xe5U, 0x7aU, 0x9fU, 0x93U, 0xc9U, 0x9cU, 0xefU, -+ 0xa0U, 0xe0U, 0x3bU, 0x4dU, 0xaeU, 0x2aU, 0xf5U, 0xb0U, -+ 0xc8U, 0xebU, 0xbbU, 0x3cU, 0x83U, 0x53U, 0x99U, 0x61U, -+ 0x17U, 0x2bU, 0x04U, 0x7eU, 0xbaU, 0x77U, 0xd6U, 0x26U, -+ 0xe1U, 0x69U, 0x14U, 0x63U, 0x55U, 0x21U, 0x0cU, 0x7dU, -+}; -+const u8 rcons[] = { -+ 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x1B, 0x36 -+ /* for 128-bit blocks, Rijndael never uses more than 10 rcon values */ -+}; -+ -+/** -+ * Expand the cipher key into the encryption key schedule. -+ * -+ * @return the number of rounds for the given cipher key size. -+ */ -+#ifndef PLATFORM_FREEBSD /* Baron */ -+static void rijndaelKeySetupEnc(u32 rk[/*44*/], const u8 cipherKey[]) -+{ -+ int i; -+ u32 temp; -+ -+ rk[0] = GETU32(cipherKey); -+ rk[1] = GETU32(cipherKey + 4); -+ rk[2] = GETU32(cipherKey + 8); -+ rk[3] = GETU32(cipherKey + 12); -+ for (i = 0; i < 10; i++) { -+ temp = rk[3]; -+ rk[4] = rk[0] ^ -+ TE421(temp) ^ TE432(temp) ^ TE443(temp) ^ TE414(temp) ^ -+ RCON(i); -+ rk[5] = rk[1] ^ rk[4]; -+ rk[6] = rk[2] ^ rk[5]; -+ rk[7] = rk[3] ^ rk[6]; -+ rk += 4; -+ } -+} -+ -+static void rijndaelEncrypt(u32 rk[/*44*/], u8 pt[16], u8 ct[16]) -+{ -+ u32 s0, s1, s2, s3, t0, t1, t2, t3; -+ int Nr = 10; -+#ifndef FULL_UNROLL -+ int r; -+#endif /* ?FULL_UNROLL */ -+ -+ /* -+ * map byte array block to cipher state -+ * and add initial round key: -+ */ -+ s0 = GETU32(pt) ^ rk[0]; -+ s1 = GETU32(pt + 4) ^ rk[1]; -+ s2 = GETU32(pt + 8) ^ rk[2]; -+ s3 = GETU32(pt + 12) ^ rk[3]; -+ -+#define ROUND(i, d, s) do {\ -+ d##0 = TE0(s##0) ^ TE1(s##1) ^ TE2(s##2) ^ TE3(s##3) ^ rk[4 * i]; \ -+ d##1 = TE0(s##1) ^ TE1(s##2) ^ TE2(s##3) ^ TE3(s##0) ^ rk[4 * i + 1]; \ -+ d##2 = TE0(s##2) ^ TE1(s##3) ^ TE2(s##0) ^ TE3(s##1) ^ rk[4 * i + 2]; \ -+ d##3 = TE0(s##3) ^ TE1(s##0) ^ TE2(s##1) ^ TE3(s##2) ^ rk[4 * i + 3]; \ -+ } while (0) -+ -+#ifdef FULL_UNROLL -+ -+ ROUND(1, t, s); -+ ROUND(2, s, t); -+ ROUND(3, t, s); -+ ROUND(4, s, t); -+ ROUND(5, t, s); -+ ROUND(6, s, t); -+ ROUND(7, t, s); -+ ROUND(8, s, t); -+ ROUND(9, t, s); -+ -+ rk += Nr << 2; -+ -+#else /* !FULL_UNROLL */ -+ -+ /* Nr - 1 full rounds: */ -+ r = Nr >> 1; -+ for (;;) { -+ ROUND(1, t, s); -+ rk += 8; -+ if (--r == 0) -+ break; -+ ROUND(0, s, t); -+ } -+ -+#endif /* ?FULL_UNROLL */ -+ -+#undef ROUND -+ -+ /* -+ * apply last round and -+ * map cipher state to byte array block: -+ */ -+ s0 = TE41(t0) ^ TE42(t1) ^ TE43(t2) ^ TE44(t3) ^ rk[0]; -+ PUTU32(ct , s0); -+ s1 = TE41(t1) ^ TE42(t2) ^ TE43(t3) ^ TE44(t0) ^ rk[1]; -+ PUTU32(ct + 4, s1); -+ s2 = TE41(t2) ^ TE42(t3) ^ TE43(t0) ^ TE44(t1) ^ rk[2]; -+ PUTU32(ct + 8, s2); -+ s3 = TE41(t3) ^ TE42(t0) ^ TE43(t1) ^ TE44(t2) ^ rk[3]; -+ PUTU32(ct + 12, s3); -+} -+ -+static void *aes_encrypt_init(u8 *key, size_t len) -+{ -+ u32 *rk; -+ if (len != 16) -+ return NULL; -+ rk = (u32 *)rtw_malloc(AES_PRIV_SIZE); -+ if (rk == NULL) -+ return NULL; -+ rijndaelKeySetupEnc(rk, key); -+ return rk; -+} -+ -+static void aes_128_encrypt(void *ctx, u8 *plain, u8 *crypt) -+{ -+ rijndaelEncrypt(ctx, plain, crypt); -+} -+ -+ -+static void gf_mulx(u8 *pad) -+{ -+ int i, carry; -+ -+ carry = pad[0] & 0x80; -+ for (i = 0; i < AES_BLOCK_SIZE - 1; i++) -+ pad[i] = (pad[i] << 1) | (pad[i + 1] >> 7); -+ pad[AES_BLOCK_SIZE - 1] <<= 1; -+ if (carry) -+ pad[AES_BLOCK_SIZE - 1] ^= 0x87; -+} -+ -+static void aes_encrypt_deinit(void *ctx) -+{ -+ _rtw_memset(ctx, 0, AES_PRIV_SIZE); -+ rtw_mfree(ctx, AES_PRIV_SIZE); -+} -+ -+ -+/** -+ * omac1_aes_128_vector - One-Key CBC MAC (OMAC1) hash with AES-128 -+ * @key: 128-bit key for the hash operation -+ * @num_elem: Number of elements in the data vector -+ * @addr: Pointers to the data areas -+ * @len: Lengths of the data blocks -+ * @mac: Buffer for MAC (128 bits, i.e., 16 bytes) -+ * Returns: 0 on success, -1 on failure -+ * -+ * This is a mode for using block cipher (AES in this case) for authentication. -+ * OMAC1 was standardized with the name CMAC by NIST in a Special Publication -+ * (SP) 800-38B. -+ */ -+static int omac1_aes_128_vector(u8 *key, size_t num_elem, -+ u8 *addr[], size_t *len, u8 *mac) -+{ -+ void *ctx; -+ u8 cbc[AES_BLOCK_SIZE], pad[AES_BLOCK_SIZE]; -+ u8 *pos, *end; -+ size_t i, e, left, total_len; -+ -+ ctx = aes_encrypt_init(key, 16); -+ if (ctx == NULL) -+ return -1; -+ _rtw_memset(cbc, 0, AES_BLOCK_SIZE); -+ -+ total_len = 0; -+ for (e = 0; e < num_elem; e++) -+ total_len += len[e]; -+ left = total_len; -+ -+ e = 0; -+ pos = addr[0]; -+ end = pos + len[0]; -+ -+ while (left >= AES_BLOCK_SIZE) { -+ for (i = 0; i < AES_BLOCK_SIZE; i++) { -+ cbc[i] ^= *pos++; -+ if (pos >= end) { -+ e++; -+ pos = addr[e]; -+ end = pos + len[e]; -+ } -+ } -+ if (left > AES_BLOCK_SIZE) -+ aes_128_encrypt(ctx, cbc, cbc); -+ left -= AES_BLOCK_SIZE; -+ } -+ -+ _rtw_memset(pad, 0, AES_BLOCK_SIZE); -+ aes_128_encrypt(ctx, pad, pad); -+ gf_mulx(pad); -+ -+ if (left || total_len == 0) { -+ for (i = 0; i < left; i++) { -+ cbc[i] ^= *pos++; -+ if (pos >= end) { -+ e++; -+ pos = addr[e]; -+ end = pos + len[e]; -+ } -+ } -+ cbc[left] ^= 0x80; -+ gf_mulx(pad); -+ } -+ -+ for (i = 0; i < AES_BLOCK_SIZE; i++) -+ pad[i] ^= cbc[i]; -+ aes_128_encrypt(ctx, pad, mac); -+ aes_encrypt_deinit(ctx); -+ return 0; -+} -+ -+ -+/** -+ * omac1_aes_128 - One-Key CBC MAC (OMAC1) hash with AES-128 (aka AES-CMAC) -+ * @key: 128-bit key for the hash operation -+ * @data: Data buffer for which a MAC is determined -+ * @data_len: Length of data buffer in bytes -+ * @mac: Buffer for MAC (128 bits, i.e., 16 bytes) -+ * Returns: 0 on success, -1 on failure -+ * -+ * This is a mode for using block cipher (AES in this case) for authentication. -+ * OMAC1 was standardized with the name CMAC by NIST in a Special Publication -+ * (SP) 800-38B. -+ */ /* modify for CONFIG_IEEE80211W */ -+int omac1_aes_128(u8 *key, u8 *data, size_t data_len, u8 *mac) -+{ -+ return omac1_aes_128_vector(key, 1, &data, &data_len, mac); -+} -+#endif /* PLATFORM_FREEBSD Baron */ -+ -+#ifdef CONFIG_TDLS -+void wpa_tdls_generate_tpk(_adapter *padapter, PVOID sta) -+{ -+ struct sta_info *psta = (struct sta_info *)sta; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 *SNonce = psta->SNonce; -+ u8 *ANonce = psta->ANonce; -+ -+ u8 key_input[SHA256_MAC_LEN]; -+ u8 *nonce[2]; -+ size_t len[2]; -+ u8 data[3 * ETH_ALEN]; -+ -+ /* IEEE Std 802.11z-2010 8.5.9.1: -+ * TPK-Key-Input = SHA-256(min(SNonce, ANonce) || max(SNonce, ANonce)) -+ */ -+ len[0] = 32; -+ len[1] = 32; -+ if (os_memcmp(SNonce, ANonce, 32) < 0) { -+ nonce[0] = SNonce; -+ nonce[1] = ANonce; -+ } else { -+ nonce[0] = ANonce; -+ nonce[1] = SNonce; -+ } -+ -+ sha256_vector(2, nonce, len, key_input); -+ -+ /* -+ * TPK-Key-Data = KDF-N_KEY(TPK-Key-Input, "TDLS PMK", -+ * min(MAC_I, MAC_R) || max(MAC_I, MAC_R) || BSSID || N_KEY) -+ * TODO: is N_KEY really included in KDF Context and if so, in which -+ * presentation format (little endian 16-bit?) is it used? It gets -+ * added by the KDF anyway.. -+ */ -+ -+ if (os_memcmp(adapter_mac_addr(padapter), psta->hwaddr, ETH_ALEN) < 0) { -+ _rtw_memcpy(data, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(data + ETH_ALEN, psta->hwaddr, ETH_ALEN); -+ } else { -+ _rtw_memcpy(data, psta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(data + ETH_ALEN, adapter_mac_addr(padapter), ETH_ALEN); -+ } -+ _rtw_memcpy(data + 2 * ETH_ALEN, get_bssid(pmlmepriv), ETH_ALEN); -+ -+ sha256_prf(key_input, SHA256_MAC_LEN, "TDLS PMK", data, sizeof(data), (u8 *) &psta->tpk, sizeof(psta->tpk)); -+ -+ -+} -+ -+/** -+ * wpa_tdls_ftie_mic - Calculate TDLS FTIE MIC -+ * @kck: TPK-KCK -+ * @lnkid: Pointer to the beginning of Link Identifier IE -+ * @rsnie: Pointer to the beginning of RSN IE used for handshake -+ * @timeoutie: Pointer to the beginning of Timeout IE used for handshake -+ * @ftie: Pointer to the beginning of FT IE -+ * @mic: Pointer for writing MIC -+ * -+ * Calculate MIC for TDLS frame. -+ */ -+int wpa_tdls_ftie_mic(u8 *kck, u8 trans_seq, -+ u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie, -+ u8 *mic) -+{ -+ u8 *buf, *pos; -+ struct wpa_tdls_ftie *_ftie; -+ struct wpa_tdls_lnkid *_lnkid; -+ int ret; -+ int len = 2 * ETH_ALEN + 1 + 2 + lnkid[1] + 2 + rsnie[1] + -+ 2 + timeoutie[1] + 2 + ftie[1]; -+ buf = rtw_zmalloc(len); -+ if (!buf) { -+ RTW_INFO("TDLS: No memory for MIC calculation\n"); -+ return -1; -+ } -+ -+ pos = buf; -+ _lnkid = (struct wpa_tdls_lnkid *) lnkid; -+ /* 1) TDLS initiator STA MAC address */ -+ _rtw_memcpy(pos, _lnkid->init_sta, ETH_ALEN); -+ pos += ETH_ALEN; -+ /* 2) TDLS responder STA MAC address */ -+ _rtw_memcpy(pos, _lnkid->resp_sta, ETH_ALEN); -+ pos += ETH_ALEN; -+ /* 3) Transaction Sequence number */ -+ *pos++ = trans_seq; -+ /* 4) Link Identifier IE */ -+ _rtw_memcpy(pos, lnkid, 2 + lnkid[1]); -+ pos += 2 + lnkid[1]; -+ /* 5) RSN IE */ -+ _rtw_memcpy(pos, rsnie, 2 + rsnie[1]); -+ pos += 2 + rsnie[1]; -+ /* 6) Timeout Interval IE */ -+ _rtw_memcpy(pos, timeoutie, 2 + timeoutie[1]); -+ pos += 2 + timeoutie[1]; -+ /* 7) FTIE, with the MIC field of the FTIE set to 0 */ -+ _rtw_memcpy(pos, ftie, 2 + ftie[1]); -+ _ftie = (struct wpa_tdls_ftie *) pos; -+ _rtw_memset(_ftie->mic, 0, TDLS_MIC_LEN); -+ pos += 2 + ftie[1]; -+ -+ ret = omac1_aes_128(kck, buf, pos - buf, mic); -+ rtw_mfree(buf, len); -+ return ret; -+ -+} -+ -+/** -+ * wpa_tdls_teardown_ftie_mic - Calculate TDLS TEARDOWN FTIE MIC -+ * @kck: TPK-KCK -+ * @lnkid: Pointer to the beginning of Link Identifier IE -+ * @reason: Reason code of TDLS Teardown -+ * @dialog_token: Dialog token that was used in the MIC calculation for TPK Handshake Message 3 -+ * @trans_seq: Transaction Sequence number (1 octet) which shall be set to the value 4 -+ * @ftie: Pointer to the beginning of FT IE -+ * @mic: Pointer for writing MIC -+ * -+ * Calculate MIC for TDLS TEARDOWN frame according to Section 10.22.5 in IEEE 802.11 - 2012. -+ */ -+int wpa_tdls_teardown_ftie_mic(u8 *kck, u8 *lnkid, u16 reason, -+ u8 dialog_token, u8 trans_seq, u8 *ftie, u8 *mic) -+{ -+ u8 *buf, *pos; -+ struct wpa_tdls_ftie *_ftie; -+ int ret; -+ int len = 2 + lnkid[1] + 2 + 1 + 1 + 2 + ftie[1]; -+ -+ buf = rtw_zmalloc(len); -+ if (!buf) { -+ RTW_INFO("TDLS: No memory for MIC calculation\n"); -+ return -1; -+ } -+ -+ pos = buf; -+ /* 1) Link Identifier IE */ -+ _rtw_memcpy(pos, lnkid, 2 + lnkid[1]); -+ pos += 2 + lnkid[1]; -+ /* 2) Reason Code */ -+ _rtw_memcpy(pos, (u8 *)&reason, 2); -+ pos += 2; -+ /* 3) Dialog Token */ -+ *pos++ = dialog_token; -+ /* 4) Transaction Sequence number */ -+ *pos++ = trans_seq; -+ /* 5) FTIE, with the MIC field of the FTIE set to 0 */ -+ _rtw_memcpy(pos, ftie, 2 + ftie[1]); -+ _ftie = (struct wpa_tdls_ftie *) pos; -+ _rtw_memset(_ftie->mic, 0, TDLS_MIC_LEN); -+ pos += 2 + ftie[1]; -+ -+ ret = omac1_aes_128(kck, buf, pos - buf, mic); -+ rtw_mfree(buf, len); -+ return ret; -+ -+} -+ -+int tdls_verify_mic(u8 *kck, u8 trans_seq, -+ u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie) -+{ -+ u8 *buf, *pos; -+ int len; -+ u8 mic[16]; -+ int ret; -+ u8 *rx_ftie, *tmp_ftie; -+ -+ if (lnkid == NULL || rsnie == NULL || -+ timeoutie == NULL || ftie == NULL) -+ return _FAIL; -+ -+ len = 2 * ETH_ALEN + 1 + 2 + 18 + 2 + *(rsnie + 1) + 2 + *(timeoutie + 1) + 2 + *(ftie + 1); -+ -+ buf = rtw_zmalloc(len); -+ if (buf == NULL) -+ return _FAIL; -+ -+ pos = buf; -+ /* 1) TDLS initiator STA MAC address */ -+ _rtw_memcpy(pos, lnkid + ETH_ALEN + 2, ETH_ALEN); -+ pos += ETH_ALEN; -+ /* 2) TDLS responder STA MAC address */ -+ _rtw_memcpy(pos, lnkid + 2 * ETH_ALEN + 2, ETH_ALEN); -+ pos += ETH_ALEN; -+ /* 3) Transaction Sequence number */ -+ *pos++ = trans_seq; -+ /* 4) Link Identifier IE */ -+ _rtw_memcpy(pos, lnkid, 2 + 18); -+ pos += 2 + 18; -+ /* 5) RSN IE */ -+ _rtw_memcpy(pos, rsnie, 2 + *(rsnie + 1)); -+ pos += 2 + *(rsnie + 1); -+ /* 6) Timeout Interval IE */ -+ _rtw_memcpy(pos, timeoutie, 2 + *(timeoutie + 1)); -+ pos += 2 + *(timeoutie + 1); -+ /* 7) FTIE, with the MIC field of the FTIE set to 0 */ -+ _rtw_memcpy(pos, ftie, 2 + *(ftie + 1)); -+ pos += 2; -+ tmp_ftie = (u8 *)(pos + 2); -+ _rtw_memset(tmp_ftie, 0, 16); -+ pos += *(ftie + 1); -+ -+ ret = omac1_aes_128(kck, buf, pos - buf, mic); -+ rtw_mfree(buf, len); -+ if (ret) -+ return _FAIL; -+ rx_ftie = ftie + 4; -+ -+ if (os_memcmp(mic, rx_ftie, 16) == 0) { -+ /* Valid MIC */ -+ return _SUCCESS; -+ } -+ -+ /* Invalid MIC */ -+ RTW_INFO("[%s] Invalid MIC\n", __FUNCTION__); -+ return _FAIL; -+ -+} -+#endif /* CONFIG_TDLS */ -+ -+void rtw_use_tkipkey_handler(RTW_TIMER_HDL_ARGS) -+{ -+ _adapter *padapter = (_adapter *)FunctionContext; -+ -+ -+ -+ /* -+ if (RTW_CANNOT_RUN(padapter)) { -+ -+ return; -+ } -+ */ -+ -+ padapter->securitypriv.busetkipkey = _TRUE; -+ -+ -+ -+} -+ -+/* Restore HW wep key setting according to key_mask */ -+void rtw_sec_restore_wep_key(_adapter *adapter) -+{ -+ struct security_priv *securitypriv = &(adapter->securitypriv); -+ sint keyid; -+ -+ if ((_WEP40_ == securitypriv->dot11PrivacyAlgrthm) || (_WEP104_ == securitypriv->dot11PrivacyAlgrthm)) { -+ for (keyid = 0; keyid < 4; keyid++) { -+ if (securitypriv->key_mask & BIT(keyid)) { -+ if (keyid == securitypriv->dot11PrivacyKeyIndex) -+ rtw_set_key(adapter, securitypriv, keyid, 1, _FALSE); -+ else -+ rtw_set_key(adapter, securitypriv, keyid, 0, _FALSE); -+ } -+ } -+ } -+} -+ -+u8 rtw_handle_tkip_countermeasure(_adapter *adapter, const char *caller) -+{ -+ struct security_priv *securitypriv = &(adapter->securitypriv); -+ u8 status = _SUCCESS; -+ -+ if (securitypriv->btkip_countermeasure == _TRUE) { -+ u32 passing_ms = rtw_get_passing_time_ms(securitypriv->btkip_countermeasure_time); -+ if (passing_ms > 60 * 1000) { -+ RTW_PRINT("%s("ADPT_FMT") countermeasure time:%ds > 60s\n", -+ caller, ADPT_ARG(adapter), passing_ms / 1000); -+ securitypriv->btkip_countermeasure = _FALSE; -+ securitypriv->btkip_countermeasure_time = 0; -+ } else { -+ RTW_PRINT("%s("ADPT_FMT") countermeasure time:%ds < 60s\n", -+ caller, ADPT_ARG(adapter), passing_ms / 1000); -+ status = _FAIL; -+ } -+ } -+ -+ return status; -+} -+ -+#ifdef CONFIG_WOWLAN -+u16 rtw_cal_crc16(u8 data, u16 crc) -+{ -+ u8 shift_in, data_bit; -+ u8 crc_bit4, crc_bit11, crc_bit15; -+ u16 crc_result; -+ int index; -+ -+ for (index = 0; index < 8; index++) { -+ crc_bit15 = ((crc & BIT15) ? 1 : 0); -+ data_bit = (data & (BIT0 << index) ? 1 : 0); -+ shift_in = crc_bit15 ^ data_bit; -+ /*printf("crc_bit15=%d, DataBit=%d, shift_in=%d\n", -+ * crc_bit15, data_bit, shift_in);*/ -+ -+ crc_result = crc << 1; -+ -+ if (shift_in == 0) -+ crc_result &= (~BIT0); -+ else -+ crc_result |= BIT0; -+ /*printf("CRC =%x\n",CRC_Result);*/ -+ -+ crc_bit11 = ((crc & BIT11) ? 1 : 0) ^ shift_in; -+ -+ if (crc_bit11 == 0) -+ crc_result &= (~BIT12); -+ else -+ crc_result |= BIT12; -+ -+ /*printf("bit12 CRC =%x\n",CRC_Result);*/ -+ -+ crc_bit4 = ((crc & BIT4) ? 1 : 0) ^ shift_in; -+ -+ if (crc_bit4 == 0) -+ crc_result &= (~BIT5); -+ else -+ crc_result |= BIT5; -+ -+ /* printf("bit5 CRC =%x\n",CRC_Result); */ -+ /* repeat using the last result*/ -+ crc = crc_result; -+ } -+ return crc; -+} -+ -+/* -+ * function name :rtw_calc_crc -+ * -+ * input: char* pattern , pattern size -+ * -+ */ -+u16 rtw_calc_crc(u8 *pdata, int length) -+{ -+ u16 crc = 0xffff; -+ int i; -+ -+ for (i = 0; i < length; i++) -+ crc = rtw_cal_crc16(pdata[i], crc); -+ /* get 1' complement */ -+ crc = ~crc; -+ -+ return crc; -+} -+#endif /*CONFIG_WOWLAN*/ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_sreset.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_sreset.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_sreset.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_sreset.c 2018-02-11 21:44:27.141145994 +0200 -@@ -0,0 +1,348 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+#include -+ -+void sreset_init_value(_adapter *padapter) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ _rtw_mutex_init(&psrtpriv->silentreset_mutex); -+ psrtpriv->silent_reset_inprogress = _FALSE; -+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; -+ psrtpriv->last_tx_time = 0; -+ psrtpriv->last_tx_complete_time = 0; -+#endif -+} -+void sreset_reset_value(_adapter *padapter) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; -+ psrtpriv->last_tx_time = 0; -+ psrtpriv->last_tx_complete_time = 0; -+#endif -+} -+ -+u8 sreset_get_wifi_status(_adapter *padapter) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ u8 status = WIFI_STATUS_SUCCESS; -+ u32 val32 = 0; -+ _irqL irqL; -+ if (psrtpriv->silent_reset_inprogress == _TRUE) -+ return status; -+ val32 = rtw_read32(padapter, REG_TXDMA_STATUS); -+ if (val32 == 0xeaeaeaea) -+ psrtpriv->Wifi_Error_Status = WIFI_IF_NOT_EXIST; -+ else if (val32 != 0) { -+ RTW_INFO("txdmastatu(%x)\n", val32); -+ psrtpriv->Wifi_Error_Status = WIFI_MAC_TXDMA_ERROR; -+ } -+ -+ if (WIFI_STATUS_SUCCESS != psrtpriv->Wifi_Error_Status) { -+ RTW_INFO("==>%s error_status(0x%x)\n", __FUNCTION__, psrtpriv->Wifi_Error_Status); -+ status = (psrtpriv->Wifi_Error_Status & (~(USB_READ_PORT_FAIL | USB_WRITE_PORT_FAIL))); -+ } -+ RTW_INFO("==> %s wifi_status(0x%x)\n", __FUNCTION__, status); -+ -+ /* status restore */ -+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; -+ -+ return status; -+#else -+ return WIFI_STATUS_SUCCESS; -+#endif -+} -+ -+void sreset_set_wifi_error_status(_adapter *padapter, u32 status) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.Wifi_Error_Status = status; -+#endif -+} -+ -+void sreset_set_trigger_point(_adapter *padapter, s32 tgp) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.dbg_trigger_point = tgp; -+#endif -+} -+ -+bool sreset_inprogress(_adapter *padapter) -+{ -+#if defined(DBG_CONFIG_ERROR_RESET) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ return pHalData->srestpriv.silent_reset_inprogress; -+#else -+ return _FALSE; -+#endif -+} -+ -+void sreset_restore_security_station(_adapter *padapter) -+{ -+ u8 EntryId = 0; -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ struct mlme_ext_info *pmlmeinfo = &padapter->mlmeextpriv.mlmext_info; -+ -+ { -+ u8 val8; -+ -+ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_8021X) { -+ val8 = 0xcc; -+#ifdef CONFIG_WAPI_SUPPORT -+ } else if (padapter->wapiInfo.bWapiEnable && pmlmeinfo->auth_algo == dot11AuthAlgrthm_WAPI) { -+ /* Disable TxUseDefaultKey, RxUseDefaultKey, RxBroadcastUseDefaultKey. */ -+ val8 = 0x4c; -+#endif -+ } else -+ val8 = 0xcf; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ } -+ -+#if 0 -+ if ((padapter->securitypriv.dot11PrivacyAlgrthm == _WEP40_) || -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _WEP104_)) { -+ -+ for (EntryId = 0; EntryId < 4; EntryId++) { -+ if (EntryId == psecuritypriv->dot11PrivacyKeyIndex) -+ rtw_set_key(padapter, &padapter->securitypriv, EntryId, 1, _FALSE); -+ else -+ rtw_set_key(padapter, &padapter->securitypriv, EntryId, 0, _FALSE); -+ } -+ -+ } else -+#endif -+ if ((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) { -+ psta = rtw_get_stainfo(pstapriv, get_bssid(mlmepriv)); -+ if (psta == NULL) { -+ /* DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail\n")); */ -+ } else { -+ /* pairwise key */ -+ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _FALSE); -+ /* group key */ -+ rtw_set_key(padapter, &padapter->securitypriv, padapter->securitypriv.dot118021XGrpKeyid, 0, _FALSE); -+ } -+ } -+} -+ -+void sreset_restore_network_station(_adapter *padapter) -+{ -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 doiqk = _FALSE; -+ -+#if 0 -+ { -+ /* ======================================================= */ -+ /* reset related register of Beacon control */ -+ -+ /* set MSR to nolink */ -+ Set_MSR(padapter, _HW_STATE_NOLINK_); -+ /* reject all data frame */ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0x00); -+ /* reset TSF */ -+ rtw_write8(padapter, REG_DUAL_TSF_RST, (BIT(0) | BIT(1))); -+ -+ /* disable update TSF */ -+ SetBcnCtrlReg(padapter, BIT(4), 0); -+ -+ /* ======================================================= */ -+ } -+#endif -+ -+ rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure, _FALSE); -+ -+ { -+ u8 threshold; -+#ifdef CONFIG_USB_HCI -+ /* TH=1 => means that invalidate usb rx aggregation */ -+ /* TH=0 => means that validate usb rx aggregation, use init value. */ -+ if (mlmepriv->htpriv.ht_option) { -+ if (padapter->registrypriv.wifi_spec == 1) -+ threshold = 1; -+ else -+ threshold = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); -+ } else { -+ threshold = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); -+ } -+#endif -+ } -+ -+ doiqk = _TRUE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK , &doiqk); -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ doiqk = _FALSE; -+ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); -+ /* disable dynamic functions, such as high power, DIG */ -+ /*rtw_phydm_func_disable_all(padapter);*/ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress); -+ -+ { -+ u8 join_type = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ } -+ -+ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); -+ -+ mlmeext_joinbss_event_callback(padapter, 1); -+ /* restore Sequence No. */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_RESTORE_HW_SEQ, 0); -+ -+ sreset_restore_security_station(padapter); -+} -+ -+ -+void sreset_restore_network_status(_adapter *padapter) -+{ -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (check_fwstate(mlmepriv, WIFI_STATION_STATE)) { -+ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); -+ sreset_restore_network_station(padapter); -+#ifdef CONFIG_AP_MODE -+ } else if (check_fwstate(mlmepriv, WIFI_AP_STATE)) { -+ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); -+ rtw_ap_restore_network(padapter); -+#endif/* CONFIG_AP_MODE */ -+ } else if (check_fwstate(mlmepriv, WIFI_ADHOC_STATE)) -+ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); -+ else -+ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); -+} -+ -+void sreset_stop_adapter(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if (padapter == NULL) -+ return; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ rtw_netif_stop_queue(padapter->pnetdev); -+ -+ rtw_cancel_all_timer(padapter); -+ -+ /* TODO: OS and HCI independent */ -+#if defined(PLATFORM_LINUX) && defined(CONFIG_USB_HCI) -+ tasklet_kill(&pxmitpriv->xmit_tasklet); -+#endif -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) -+ rtw_scan_abort(padapter); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) { -+ rtw_set_to_roam(padapter, 0); -+ _rtw_join_timeout_handler(padapter); -+ } -+ -+} -+ -+void sreset_start_adapter(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if (padapter == NULL) -+ return; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) -+ sreset_restore_network_status(padapter); -+ -+ /* TODO: OS and HCI independent */ -+#if defined(PLATFORM_LINUX) && defined(CONFIG_USB_HCI) -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+#endif -+ -+ if (is_primary_adapter(padapter)) -+ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); -+ -+ rtw_netif_wake_queue(padapter->pnetdev); -+} -+ -+void sreset_reset(_adapter *padapter) -+{ -+#ifdef DBG_CONFIG_ERROR_RESET -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _irqL irqL; -+ u32 start = rtw_get_current_time(); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; -+ -+ -+#ifdef CONFIG_LPS -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "SRESET"); -+#endif/* #ifdef CONFIG_LPS */ -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ -+ psrtpriv->silent_reset_inprogress = _TRUE; -+ pwrpriv->change_rfpwrstate = rf_off; -+ -+ rtw_mi_sreset_adapter_hdl(padapter, _FALSE);/*sreset_stop_adapter*/ -+#ifdef CONFIG_IPS -+ _ips_enter(padapter); -+ _ips_leave(padapter); -+#endif -+ rtw_mi_sreset_adapter_hdl(padapter, _TRUE);/*sreset_start_adapter*/ -+ -+ psrtpriv->silent_reset_inprogress = _FALSE; -+ -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ RTW_INFO("%s done in %d ms\n", __FUNCTION__, rtw_get_passing_time_ms(start)); -+ pdbgpriv->dbg_sreset_cnt++; -+#endif -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_sta_mgt.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_sta_mgt.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_sta_mgt.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_sta_mgt.c 2018-02-11 21:44:27.141145994 +0200 -@@ -0,0 +1,978 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_STA_MGT_C_ -+ -+#include -+ -+#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+ -+ #error "Shall be Linux or Windows, but not both!\n" -+ -+#endif -+ -+ -+bool test_st_match_rule(_adapter *adapter, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) -+{ -+ if (ntohs(*((u16 *)local_port)) == 5001 || ntohs(*((u16 *)remote_port)) == 5001) -+ return _TRUE; -+ return _FALSE; -+} -+ -+struct st_register test_st_reg = { -+ .s_proto = 0x06, -+ .rule = test_st_match_rule, -+}; -+ -+inline void rtw_st_ctl_init(struct st_ctl_t *st_ctl) -+{ -+ _rtw_memset(st_ctl->reg, 0 , sizeof(struct st_register) * SESSION_TRACKER_REG_ID_NUM); -+ _rtw_init_queue(&st_ctl->tracker_q); -+} -+ -+inline void rtw_st_ctl_clear_tracker_q(struct st_ctl_t *st_ctl) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct session_tracker *st; -+ -+ _enter_critical_bh(&st_ctl->tracker_q.lock, &irqL); -+ phead = &st_ctl->tracker_q.queue; -+ plist = get_next(phead); -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ st = LIST_CONTAINOR(plist, struct session_tracker, list); -+ plist = get_next(plist); -+ rtw_list_delete(&st->list); -+ rtw_mfree((u8 *)st, sizeof(struct session_tracker)); -+ } -+ _exit_critical_bh(&st_ctl->tracker_q.lock, &irqL); -+} -+ -+inline void rtw_st_ctl_deinit(struct st_ctl_t *st_ctl) -+{ -+ rtw_st_ctl_clear_tracker_q(st_ctl); -+ _rtw_deinit_queue(&st_ctl->tracker_q); -+} -+ -+inline void rtw_st_ctl_register(struct st_ctl_t *st_ctl, u8 st_reg_id, struct st_register *reg) -+{ -+ if (st_reg_id >= SESSION_TRACKER_REG_ID_NUM) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ st_ctl->reg[st_reg_id].s_proto = reg->s_proto; -+ st_ctl->reg[st_reg_id].rule = reg->rule; -+} -+ -+inline void rtw_st_ctl_unregister(struct st_ctl_t *st_ctl, u8 st_reg_id) -+{ -+ int i; -+ -+ if (st_reg_id >= SESSION_TRACKER_REG_ID_NUM) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ st_ctl->reg[st_reg_id].s_proto = 0; -+ st_ctl->reg[st_reg_id].rule = NULL; -+ -+ /* clear tracker queue if no session trecker registered */ -+ for (i = 0; i < SESSION_TRACKER_REG_ID_NUM; i++) -+ if (st_ctl->reg[i].s_proto != 0) -+ break; -+ if (i >= SESSION_TRACKER_REG_ID_NUM) -+ rtw_st_ctl_clear_tracker_q(st_ctl); -+} -+ -+inline bool rtw_st_ctl_chk_reg_s_proto(struct st_ctl_t *st_ctl, u8 s_proto) -+{ -+ bool ret = _FALSE; -+ int i; -+ -+ for (i = 0; i < SESSION_TRACKER_REG_ID_NUM; i++) { -+ if (st_ctl->reg[i].s_proto == s_proto) { -+ ret = _TRUE; -+ break; -+ } -+ } -+ -+ return ret; -+} -+ -+inline bool rtw_st_ctl_chk_reg_rule(struct st_ctl_t *st_ctl, _adapter *adapter, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) -+{ -+ bool ret = _FALSE; -+ int i; -+ st_match_rule rule; -+ -+ for (i = 0; i < SESSION_TRACKER_REG_ID_NUM; i++) { -+ rule = st_ctl->reg[i].rule; -+ if (rule && rule(adapter, local_naddr, local_port, remote_naddr, remote_port) == _TRUE) { -+ ret = _TRUE; -+ break; -+ } -+ } -+ -+ return ret; -+} -+ -+#define SESSION_TRACKER_FMT IP_FMT":"PORT_FMT" "IP_FMT":"PORT_FMT" %u %d" -+#define SESSION_TRACKER_ARG(st) IP_ARG(&(st)->local_naddr), PORT_ARG(&(st)->local_port), IP_ARG(&(st)->remote_naddr), PORT_ARG(&(st)->remote_port), (st)->status, rtw_get_passing_time_ms((st)->set_time) -+ -+void dump_st_ctl(void *sel, struct st_ctl_t *st_ctl) -+{ -+ int i; -+ _irqL irqL; -+ _list *plist, *phead; -+ struct session_tracker *st; -+ -+ if (!DBG_SESSION_TRACKER) -+ return; -+ -+ for (i = 0; i < SESSION_TRACKER_REG_ID_NUM; i++) -+ RTW_PRINT_SEL(sel, "reg%d: %u %p\n", i, st_ctl->reg[i].s_proto, st_ctl->reg[i].rule); -+ -+ _enter_critical_bh(&st_ctl->tracker_q.lock, &irqL); -+ phead = &st_ctl->tracker_q.queue; -+ plist = get_next(phead); -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ st = LIST_CONTAINOR(plist, struct session_tracker, list); -+ plist = get_next(plist); -+ -+ RTW_PRINT_SEL(sel, SESSION_TRACKER_FMT"\n", SESSION_TRACKER_ARG(st)); -+ } -+ _exit_critical_bh(&st_ctl->tracker_q.lock, &irqL); -+ -+} -+ -+void _rtw_init_stainfo(struct sta_info *psta); -+void _rtw_init_stainfo(struct sta_info *psta) -+{ -+ -+ -+ _rtw_memset((u8 *)psta, 0, sizeof(struct sta_info)); -+ -+ _rtw_spinlock_init(&psta->lock); -+ _rtw_init_listhead(&psta->list); -+ _rtw_init_listhead(&psta->hash_list); -+ /* _rtw_init_listhead(&psta->asoc_list); */ -+ /* _rtw_init_listhead(&psta->sleep_list); */ -+ /* _rtw_init_listhead(&psta->wakeup_list); */ -+ -+ _rtw_init_queue(&psta->sleep_q); -+ psta->sleepq_len = 0; -+ -+ _rtw_init_sta_xmit_priv(&psta->sta_xmitpriv); -+ _rtw_init_sta_recv_priv(&psta->sta_recvpriv); -+ -+#ifdef CONFIG_AP_MODE -+ -+ _rtw_init_listhead(&psta->asoc_list); -+ -+ _rtw_init_listhead(&psta->auth_list); -+ -+ psta->expire_to = 0; -+ -+ psta->flags = 0; -+ -+ psta->capability = 0; -+ -+ psta->bpairwise_key_installed = _FALSE; -+ -+#ifdef CONFIG_RTW_80211R -+ psta->ft_pairwise_key_installed = _FALSE; -+#endif -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ psta->nonerp_set = 0; -+ psta->no_short_slot_time_set = 0; -+ psta->no_short_preamble_set = 0; -+ psta->no_ht_gf_set = 0; -+ psta->no_ht_set = 0; -+ psta->ht_20mhz_set = 0; -+ psta->ht_40mhz_intolerant = 0; -+#endif -+ -+#ifdef CONFIG_TX_MCAST2UNI -+ psta->under_exist_checking = 0; -+#endif /* CONFIG_TX_MCAST2UNI */ -+ -+ psta->keep_alive_trycnt = 0; -+ -+#endif /* CONFIG_AP_MODE */ -+ -+ rtw_st_ctl_init(&psta->st_ctl); -+ -+ -+} -+ -+u32 _rtw_init_sta_priv(struct sta_priv *pstapriv) -+{ -+ struct sta_info *psta; -+ s32 i; -+ -+ -+ pstapriv->pallocated_stainfo_buf = rtw_zvmalloc(sizeof(struct sta_info) * NUM_STA + 4); -+ -+ if (!pstapriv->pallocated_stainfo_buf) -+ return _FAIL; -+ -+ pstapriv->pstainfo_buf = pstapriv->pallocated_stainfo_buf + 4 - -+ ((SIZE_PTR)(pstapriv->pallocated_stainfo_buf) & 3); -+ -+ _rtw_init_queue(&pstapriv->free_sta_queue); -+ -+ _rtw_spinlock_init(&pstapriv->sta_hash_lock); -+ -+ /* _rtw_init_queue(&pstapriv->asoc_q); */ -+ pstapriv->asoc_sta_count = 0; -+ _rtw_init_queue(&pstapriv->sleep_q); -+ _rtw_init_queue(&pstapriv->wakeup_q); -+ -+ psta = (struct sta_info *)(pstapriv->pstainfo_buf); -+ -+ -+ for (i = 0; i < NUM_STA; i++) { -+ _rtw_init_stainfo(psta); -+ -+ _rtw_init_listhead(&(pstapriv->sta_hash[i])); -+ -+ rtw_list_insert_tail(&psta->list, get_list_head(&pstapriv->free_sta_queue)); -+ -+ psta++; -+ } -+ -+ pstapriv->adhoc_expire_to = 4; /* 4 * 2 = 8 sec */ -+ -+#ifdef CONFIG_AP_MODE -+ -+ pstapriv->sta_dz_bitmap = 0; -+ pstapriv->tim_bitmap = 0; -+ -+ _rtw_init_listhead(&pstapriv->asoc_list); -+ _rtw_init_listhead(&pstapriv->auth_list); -+ _rtw_spinlock_init(&pstapriv->asoc_list_lock); -+ _rtw_spinlock_init(&pstapriv->auth_list_lock); -+ pstapriv->asoc_list_cnt = 0; -+ pstapriv->auth_list_cnt = 0; -+ -+ pstapriv->auth_to = 3; /* 3*2 = 6 sec */ -+ pstapriv->assoc_to = 3; -+ /* pstapriv->expire_to = 900; */ /* 900*2 = 1800 sec = 30 min, expire after no any traffic. */ -+ /* pstapriv->expire_to = 30; */ /* 30*2 = 60 sec = 1 min, expire after no any traffic. */ -+#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ pstapriv->expire_to = 3; /* 3*2 = 6 sec */ -+#else -+ pstapriv->expire_to = 60;/* 60*2 = 120 sec = 2 min, expire after no any traffic. */ -+#endif -+#ifdef CONFIG_ATMEL_RC_PATCH -+ _rtw_memset(pstapriv->atmel_rc_pattern, 0, ETH_ALEN); -+#endif -+ pstapriv->max_num_sta = NUM_STA; -+ -+#ifdef CONFIG_RTW_MACADDR_ACL -+ _rtw_init_queue(&(pstapriv->acl_list.acl_node_q)); -+#endif -+#endif /* CONFIG_AP_MODE */ -+ -+ -+ return _SUCCESS; -+ -+} -+ -+inline int rtw_stainfo_offset(struct sta_priv *stapriv, struct sta_info *sta) -+{ -+ int offset = (((u8 *)sta) - stapriv->pstainfo_buf) / sizeof(struct sta_info); -+ -+ if (!stainfo_offset_valid(offset)) -+ RTW_INFO("%s invalid offset(%d), out of range!!!", __func__, offset); -+ -+ return offset; -+} -+ -+inline struct sta_info *rtw_get_stainfo_by_offset(struct sta_priv *stapriv, int offset) -+{ -+ if (!stainfo_offset_valid(offset)) -+ RTW_INFO("%s invalid offset(%d), out of range!!!", __func__, offset); -+ -+ return (struct sta_info *)(stapriv->pstainfo_buf + offset * sizeof(struct sta_info)); -+} -+ -+void _rtw_free_sta_xmit_priv_lock(struct sta_xmit_priv *psta_xmitpriv); -+void _rtw_free_sta_xmit_priv_lock(struct sta_xmit_priv *psta_xmitpriv) -+{ -+ -+ _rtw_spinlock_free(&psta_xmitpriv->lock); -+ -+ _rtw_spinlock_free(&(psta_xmitpriv->be_q.sta_pending.lock)); -+ _rtw_spinlock_free(&(psta_xmitpriv->bk_q.sta_pending.lock)); -+ _rtw_spinlock_free(&(psta_xmitpriv->vi_q.sta_pending.lock)); -+ _rtw_spinlock_free(&(psta_xmitpriv->vo_q.sta_pending.lock)); -+} -+ -+static void _rtw_free_sta_recv_priv_lock(struct sta_recv_priv *psta_recvpriv) -+{ -+ -+ _rtw_spinlock_free(&psta_recvpriv->lock); -+ -+ _rtw_spinlock_free(&(psta_recvpriv->defrag_q.lock)); -+ -+ -+} -+ -+void rtw_mfree_stainfo(struct sta_info *psta); -+void rtw_mfree_stainfo(struct sta_info *psta) -+{ -+ -+ if (&psta->lock != NULL) -+ _rtw_spinlock_free(&psta->lock); -+ -+ _rtw_free_sta_xmit_priv_lock(&psta->sta_xmitpriv); -+ _rtw_free_sta_recv_priv_lock(&psta->sta_recvpriv); -+ -+} -+ -+ -+/* this function is used to free the memory of lock || sema for all stainfos */ -+void rtw_mfree_all_stainfo(struct sta_priv *pstapriv); -+void rtw_mfree_all_stainfo(struct sta_priv *pstapriv) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct sta_info *psta = NULL; -+ -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ phead = get_list_head(&pstapriv->free_sta_queue); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info , list); -+ plist = get_next(plist); -+ -+ rtw_mfree_stainfo(psta); -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ -+} -+ -+void rtw_mfree_sta_priv_lock(struct sta_priv *pstapriv); -+void rtw_mfree_sta_priv_lock(struct sta_priv *pstapriv) -+{ -+ rtw_mfree_all_stainfo(pstapriv); /* be done before free sta_hash_lock */ -+ -+ _rtw_spinlock_free(&pstapriv->free_sta_queue.lock); -+ -+ _rtw_spinlock_free(&pstapriv->sta_hash_lock); -+ _rtw_spinlock_free(&pstapriv->wakeup_q.lock); -+ _rtw_spinlock_free(&pstapriv->sleep_q.lock); -+ -+#ifdef CONFIG_AP_MODE -+ _rtw_spinlock_free(&pstapriv->asoc_list_lock); -+ _rtw_spinlock_free(&pstapriv->auth_list_lock); -+#endif -+ -+} -+ -+u32 _rtw_free_sta_priv(struct sta_priv *pstapriv) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ struct sta_info *psta = NULL; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ int index; -+ -+ if (pstapriv) { -+ -+ /* delete all reordering_ctrl_timer */ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for (index = 0; index < NUM_STA; index++) { -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ int i; -+ psta = LIST_CONTAINOR(plist, struct sta_info , hash_list); -+ plist = get_next(plist); -+ -+ for (i = 0; i < 16 ; i++) { -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); -+ } -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ /*===============================*/ -+ -+ rtw_mfree_sta_priv_lock(pstapriv); -+ -+#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) -+ _rtw_deinit_queue(&(pstapriv->acl_list.acl_node_q)); -+#endif -+ -+ if (pstapriv->pallocated_stainfo_buf) -+ rtw_vmfree(pstapriv->pallocated_stainfo_buf, sizeof(struct sta_info) * NUM_STA + 4); -+ } -+ -+ return _SUCCESS; -+} -+ -+ -+/* struct sta_info *rtw_alloc_stainfo(_queue *pfree_sta_queue, unsigned char *hwaddr) */ -+struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) -+{ -+ _irqL irqL, irqL2; -+ uint tmp_aid; -+ s32 index; -+ _list *phash_list; -+ struct sta_info *psta; -+ _queue *pfree_sta_queue; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ int i = 0; -+ u16 wRxSeqInitialValue = 0xffff; -+ -+ -+ pfree_sta_queue = &pstapriv->free_sta_queue; -+ -+ /* _enter_critical_bh(&(pfree_sta_queue->lock), &irqL); */ -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); -+ if (_rtw_queue_empty(pfree_sta_queue) == _TRUE) { -+ /* _exit_critical_bh(&(pfree_sta_queue->lock), &irqL); */ -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); -+ psta = NULL; -+ } else { -+ psta = LIST_CONTAINOR(get_next(&pfree_sta_queue->queue), struct sta_info, list); -+ -+ rtw_list_delete(&(psta->list)); -+ -+ /* _exit_critical_bh(&(pfree_sta_queue->lock), &irqL); */ -+ -+ tmp_aid = psta->aid; -+ -+ _rtw_init_stainfo(psta); -+ -+ psta->padapter = pstapriv->padapter; -+ -+ _rtw_memcpy(psta->hwaddr, hwaddr, ETH_ALEN); -+ -+ index = wifi_mac_hash(hwaddr); -+ -+ -+ if (index >= NUM_STA) { -+ psta = NULL; -+ goto exit; -+ } -+ phash_list = &(pstapriv->sta_hash[index]); -+ -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); */ -+ -+ rtw_list_insert_tail(&psta->hash_list, phash_list); -+ -+ pstapriv->asoc_sta_count++; -+ -+ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); */ -+ -+ /* Commented by Albert 2009/08/13 -+ * For the SMC router, the sequence number of first packet of WPS handshake will be 0. -+ * In this case, this packet will be dropped by recv_decache function if we use the 0x00 as the default value for tid_rxseq variable. -+ * So, we initialize the tid_rxseq variable as the 0xffff. */ -+ -+ for (i = 0; i < 16; i++) { -+ _rtw_memcpy(&psta->sta_recvpriv.rxcache.tid_rxseq[i], &wRxSeqInitialValue, 2); -+ _rtw_memset(&psta->sta_recvpriv.rxcache.iv[i], 0, sizeof(psta->sta_recvpriv.rxcache.iv[i])); -+ } -+ -+ init_addba_retry_timer(pstapriv->padapter, psta); -+#ifdef CONFIG_IEEE80211W -+ init_dot11w_expire_timer(pstapriv->padapter, psta); -+#endif /* CONFIG_IEEE80211W */ -+#ifdef CONFIG_TDLS -+ rtw_init_tdls_timer(pstapriv->padapter, psta); -+#endif /* CONFIG_TDLS */ -+ -+ /* for A-MPDU Rx reordering buffer control */ -+ for (i = 0; i < 16 ; i++) { -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ -+ preorder_ctrl->padapter = pstapriv->padapter; -+ -+ preorder_ctrl->enable = _FALSE; -+ -+ preorder_ctrl->indicate_seq = 0xffff; -+#ifdef DBG_RX_SEQ -+ RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq); -+#endif -+ preorder_ctrl->wend_b = 0xffff; -+ /* preorder_ctrl->wsize_b = (NR_RECVBUFF-2); */ -+ preorder_ctrl->wsize_b = 64;/* 64; */ -+ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; -+ -+ _rtw_init_queue(&preorder_ctrl->pending_recvframe_queue); -+ -+ rtw_init_recv_timer(preorder_ctrl); -+ } -+ -+ -+ /* init for DM */ -+ psta->rssi_stat.UndecoratedSmoothedPWDB = (-1); -+ psta->rssi_stat.UndecoratedSmoothedCCK = (-1); -+#ifdef CONFIG_ATMEL_RC_PATCH -+ psta->flag_atmel_rc = 0; -+#endif -+ /* init for the sequence number of received management frame */ -+ psta->RxMgmtFrameSeqNum = 0xffff; -+ psta->ra_rpt_linked = _FALSE; -+ -+ rtw_alloc_macid(pstapriv->padapter, psta); -+ -+ } -+ -+exit: -+ -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); -+ -+ -+ if (psta) -+ rtw_mi_update_iface_status(&(pstapriv->padapter->mlmepriv), 0); -+ -+ return psta; -+} -+ -+ -+/* using pstapriv->sta_hash_lock to protect */ -+u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta) -+{ -+ int i; -+ _irqL irqL0; -+ _queue *pfree_sta_queue; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct sta_xmit_priv *pstaxmitpriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct hw_xmit *phwxmit; -+ int pending_qcnt[4]; -+ -+ -+ if (psta == NULL) -+ goto exit; -+ -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); -+ rtw_list_delete(&psta->hash_list); -+ pstapriv->asoc_sta_count--; -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); -+ rtw_mi_update_iface_status(&(padapter->mlmepriv), 0); -+ -+ -+ _enter_critical_bh(&psta->lock, &irqL0); -+ psta->state &= ~_FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL0); -+ -+ pfree_sta_queue = &pstapriv->free_sta_queue; -+ -+ -+ pstaxmitpriv = &psta->sta_xmitpriv; -+ -+ /* rtw_list_delete(&psta->sleep_list); */ -+ -+ /* rtw_list_delete(&psta->wakeup_list); */ -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ rtw_free_xmitframe_queue(pxmitpriv, &psta->sleep_q); -+ psta->sleepq_len = 0; -+ -+ /* vo */ -+ /* _enter_critical_bh(&(pxmitpriv->vo_pending.lock), &irqL0); */ -+ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->vo_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits; -+ phwxmit->accnt -= pstaxmitpriv->vo_q.qcnt; -+ pending_qcnt[0] = pstaxmitpriv->vo_q.qcnt; -+ pstaxmitpriv->vo_q.qcnt = 0; -+ /* _exit_critical_bh(&(pxmitpriv->vo_pending.lock), &irqL0); */ -+ -+ /* vi */ -+ /* _enter_critical_bh(&(pxmitpriv->vi_pending.lock), &irqL0); */ -+ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->vi_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->vi_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits + 1; -+ phwxmit->accnt -= pstaxmitpriv->vi_q.qcnt; -+ pending_qcnt[1] = pstaxmitpriv->vi_q.qcnt; -+ pstaxmitpriv->vi_q.qcnt = 0; -+ /* _exit_critical_bh(&(pxmitpriv->vi_pending.lock), &irqL0); */ -+ -+ /* be */ -+ /* _enter_critical_bh(&(pxmitpriv->be_pending.lock), &irqL0); */ -+ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->be_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits + 2; -+ phwxmit->accnt -= pstaxmitpriv->be_q.qcnt; -+ pending_qcnt[2] = pstaxmitpriv->be_q.qcnt; -+ pstaxmitpriv->be_q.qcnt = 0; -+ /* _exit_critical_bh(&(pxmitpriv->be_pending.lock), &irqL0); */ -+ -+ /* bk */ -+ /* _enter_critical_bh(&(pxmitpriv->bk_pending.lock), &irqL0); */ -+ rtw_free_xmitframe_queue(pxmitpriv, &pstaxmitpriv->bk_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits + 3; -+ phwxmit->accnt -= pstaxmitpriv->bk_q.qcnt; -+ pending_qcnt[3] = pstaxmitpriv->bk_q.qcnt; -+ pstaxmitpriv->bk_q.qcnt = 0; -+ /* _exit_critical_bh(&(pxmitpriv->bk_pending.lock), &irqL0); */ -+ -+ rtw_os_wake_queue_at_free_stainfo(padapter, pending_qcnt); -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ -+ /* re-init sta_info; 20061114 */ /* will be init in alloc_stainfo */ -+ /* _rtw_init_sta_xmit_priv(&psta->sta_xmitpriv); */ -+ /* _rtw_init_sta_recv_priv(&psta->sta_recvpriv); */ -+#ifdef CONFIG_IEEE80211W -+ _cancel_timer_ex(&psta->dot11w_expire_timer); -+#endif /* CONFIG_IEEE80211W */ -+ _cancel_timer_ex(&psta->addba_retry_timer); -+ -+#ifdef CONFIG_TDLS -+ psta->tdls_sta_state = TDLS_STATE_NONE; -+ rtw_free_tdls_timer(psta); -+#endif /* CONFIG_TDLS */ -+ -+ /* for A-MPDU Rx reordering buffer control, cancel reordering_ctrl_timer */ -+ for (i = 0; i < 16 ; i++) { -+ _irqL irqL; -+ _list *phead, *plist; -+ union recv_frame *prframe; -+ _queue *ppending_recvframe_queue; -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ -+ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); -+ -+ -+ ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ -+ _enter_critical_bh(&ppending_recvframe_queue->lock, &irqL); -+ -+ phead = get_list_head(ppending_recvframe_queue); -+ plist = get_next(phead); -+ -+ while (!rtw_is_list_empty(phead)) { -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ -+ plist = get_next(plist); -+ -+ rtw_list_delete(&(prframe->u.hdr.list)); -+ -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ } -+ -+ _exit_critical_bh(&ppending_recvframe_queue->lock, &irqL); -+ -+ } -+ -+ if (!((psta->state & WIFI_AP_STATE) || MacAddr_isBcst(psta->hwaddr))) -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _FALSE); -+ -+ -+ /* release mac id for non-bc/mc station, */ -+ rtw_release_macid(pstapriv->padapter, psta); -+ -+#ifdef CONFIG_AP_MODE -+ -+ /* -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL0); -+ rtw_list_delete(&psta->asoc_list); -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL0); -+ */ -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL0); -+ if (!rtw_is_list_empty(&psta->auth_list)) { -+ rtw_list_delete(&psta->auth_list); -+ pstapriv->auth_list_cnt--; -+ } -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL0); -+ -+ psta->expire_to = 0; -+#ifdef CONFIG_ATMEL_RC_PATCH -+ psta->flag_atmel_rc = 0; -+#endif -+ psta->sleepq_ac_len = 0; -+ psta->qos_info = 0; -+ -+ psta->max_sp_len = 0; -+ psta->uapsd_bk = 0; -+ psta->uapsd_be = 0; -+ psta->uapsd_vi = 0; -+ psta->uapsd_vo = 0; -+ -+ psta->has_legacy_ac = 0; -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ -+ pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ /* rtw_indicate_sta_disassoc_event(padapter, psta); */ -+ -+ if ((psta->aid > 0) && (pstapriv->sta_aid[psta->aid - 1] == psta)) { -+ pstapriv->sta_aid[psta->aid - 1] = NULL; -+ psta->aid = 0; -+ } -+ -+#endif /* CONFIG_NATIVEAP_MLME */ -+ -+#ifdef CONFIG_TX_MCAST2UNI -+ psta->under_exist_checking = 0; -+#endif /* CONFIG_TX_MCAST2UNI */ -+ -+#endif /* CONFIG_AP_MODE */ -+ -+ rtw_st_ctl_deinit(&psta->st_ctl); -+ -+ _rtw_spinlock_free(&psta->lock); -+ -+ /* _enter_critical_bh(&(pfree_sta_queue->lock), &irqL0); */ -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); -+ rtw_list_insert_tail(&psta->list, get_list_head(pfree_sta_queue)); -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); -+ /* _exit_critical_bh(&(pfree_sta_queue->lock), &irqL0); */ -+ -+exit: -+ -+ -+ return _SUCCESS; -+ -+} -+ -+/* free all stainfo which in sta_hash[all] */ -+void rtw_free_all_stainfo(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ s32 index; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *pbcmc_stainfo = rtw_get_bcmc_stainfo(padapter); -+ u8 free_sta_num = 0; -+ char free_sta_list[NUM_STA]; -+ int stainfo_offset; -+ -+ -+ if (pstapriv->asoc_sta_count == 1) -+ goto exit; -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for (index = 0; index < NUM_STA; index++) { -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info , hash_list); -+ -+ plist = get_next(plist); -+ -+ if (pbcmc_stainfo != psta) { -+ rtw_list_delete(&psta->hash_list); -+ /* rtw_free_stainfo(padapter , psta); */ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ free_sta_list[free_sta_num++] = stainfo_offset; -+ } -+ -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ -+ for (index = 0; index < free_sta_num; index++) { -+ psta = rtw_get_stainfo_by_offset(pstapriv, free_sta_list[index]); -+ rtw_free_stainfo(padapter , psta); -+ } -+ -+exit: -+ return; -+} -+ -+/* any station allocated can be searched by hash list */ -+struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) -+{ -+ -+ _irqL irqL; -+ -+ _list *plist, *phead; -+ -+ struct sta_info *psta = NULL; -+ -+ u32 index; -+ -+ u8 *addr; -+ -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ -+ if (hwaddr == NULL) -+ return NULL; -+ -+ if (IS_MCAST(hwaddr)) -+ addr = bc_addr; -+ else -+ addr = hwaddr; -+ -+ index = wifi_mac_hash(addr); -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ if ((_rtw_memcmp(psta->hwaddr, addr, ETH_ALEN)) == _TRUE) { -+ /* if found the matched address */ -+ break; -+ } -+ psta = NULL; -+ plist = get_next(plist); -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ return psta; -+ -+} -+ -+u32 rtw_init_bcmc_stainfo(_adapter *padapter) -+{ -+ -+ struct sta_info *psta; -+ struct tx_servq *ptxservq; -+ u32 res = _SUCCESS; -+ NDIS_802_11_MAC_ADDRESS bcast_addr = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ /* _queue *pstapending = &padapter->xmitpriv.bm_pending; */ -+ -+ -+ psta = rtw_alloc_stainfo(pstapriv, bcast_addr); -+ -+ if (psta == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+#ifdef CONFIG_BEAMFORMING -+ psta->txbf_gid = 63; -+ psta->txbf_paid = 0; -+#endif -+ ptxservq = &(psta->sta_xmitpriv.be_q); -+ -+ /* -+ _enter_critical(&pstapending->lock, &irqL0); -+ -+ if (rtw_is_list_empty(&ptxservq->tx_pending)) -+ rtw_list_insert_tail(&ptxservq->tx_pending, get_list_head(pstapending)); -+ -+ _exit_critical(&pstapending->lock, &irqL0); -+ */ -+ -+exit: -+ return _SUCCESS; -+ -+} -+ -+ -+struct sta_info *rtw_get_bcmc_stainfo(_adapter *padapter) -+{ -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ psta = rtw_get_stainfo(pstapriv, bc_addr); -+ return psta; -+ -+} -+ -+#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) -+const char *const _acl_mode_str[] = { -+ "DISABLED", -+ "ACCEPT_UNLESS_LISTED", -+ "DENY_UNLESS_LISTED", -+}; -+ -+u8 rtw_access_ctrl(_adapter *adapter, u8 *mac_addr) -+{ -+ u8 res = _TRUE; -+ _irqL irqL; -+ _list *list, *head; -+ struct rtw_wlan_acl_node *acl_node; -+ u8 match = _FALSE; -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct wlan_acl_pool *acl = &stapriv->acl_list; -+ _queue *acl_node_q = &acl->acl_node_q; -+ -+ _enter_critical_bh(&(acl_node_q->lock), &irqL); -+ head = get_list_head(acl_node_q); -+ list = get_next(head); -+ while (rtw_end_of_queue_search(head, list) == _FALSE) { -+ acl_node = LIST_CONTAINOR(list, struct rtw_wlan_acl_node, list); -+ list = get_next(list); -+ -+ if (_rtw_memcmp(acl_node->addr, mac_addr, ETH_ALEN)) { -+ if (acl_node->valid == _TRUE) { -+ match = _TRUE; -+ break; -+ } -+ } -+ } -+ _exit_critical_bh(&(acl_node_q->lock), &irqL); -+ -+ if (acl->mode == RTW_ACL_MODE_ACCEPT_UNLESS_LISTED) -+ res = (match == _TRUE) ? _FALSE : _TRUE; -+ else if (acl->mode == RTW_ACL_MODE_DENY_UNLESS_LISTED) -+ res = (match == _TRUE) ? _TRUE : _FALSE; -+ else -+ res = _TRUE; -+ -+ return res; -+} -+ -+void dump_macaddr_acl(void *sel, _adapter *adapter) -+{ -+ struct sta_priv *stapriv = &adapter->stapriv; -+ struct wlan_acl_pool *acl = &stapriv->acl_list; -+ int i; -+ -+ RTW_PRINT_SEL(sel, "mode:%s(%d)\n", acl_mode_str(acl->mode), acl->mode); -+ RTW_PRINT_SEL(sel, "num:%d/%d\n", acl->num, NUM_ACL); -+ for (i = 0; i < NUM_ACL; i++) { -+ if (acl->aclnode[i].valid == _FALSE) -+ continue; -+ RTW_PRINT_SEL(sel, MAC_FMT"\n", MAC_ARG(acl->aclnode[i].addr)); -+ } -+} -+#endif /* CONFIG_RTW_MACADDR_ACL && CONFIG_AP_MODE */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_tdls.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_tdls.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_tdls.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_tdls.c 2018-02-11 21:44:27.142146010 +0200 -@@ -0,0 +1,3341 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_TDLS_C_ -+ -+#include -+#include -+ -+#ifdef CONFIG_TDLS -+#define ONE_SEC 1000 /* 1000 ms */ -+ -+extern unsigned char MCS_rate_2R[16]; -+extern unsigned char MCS_rate_1R[16]; -+extern void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame); -+ -+void rtw_reset_tdls_info(_adapter *padapter) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ ptdlsinfo->ap_prohibited = _FALSE; -+ -+ /* For TDLS channel switch, currently we only allow it to work in wifi logo test mode */ -+ if (padapter->registrypriv.wifi_spec == 1) -+ ptdlsinfo->ch_switch_prohibited = _FALSE; -+ else -+ ptdlsinfo->ch_switch_prohibited = _TRUE; -+ -+ ptdlsinfo->link_established = _FALSE; -+ ptdlsinfo->sta_cnt = 0; -+ ptdlsinfo->sta_maximum = _FALSE; -+ -+#ifdef CONFIG_TDLS_CH_SW -+ ptdlsinfo->chsw_info.ch_sw_state = TDLS_STATE_NONE; -+ ATOMIC_SET(&ptdlsinfo->chsw_info.chsw_on, _FALSE); -+ ptdlsinfo->chsw_info.off_ch_num = 0; -+ ptdlsinfo->chsw_info.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ ptdlsinfo->chsw_info.cur_time = 0; -+ ptdlsinfo->chsw_info.delay_switch_back = _FALSE; -+ ptdlsinfo->chsw_info.dump_stack = _FALSE; -+#endif -+ -+ ptdlsinfo->ch_sensing = 0; -+ ptdlsinfo->watchdog_count = 0; -+ ptdlsinfo->dev_discovered = _FALSE; -+ -+#ifdef CONFIG_WFD -+ ptdlsinfo->wfd_info = &padapter->wfd_info; -+#endif -+} -+ -+int rtw_init_tdls_info(_adapter *padapter) -+{ -+ int res = _SUCCESS; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ rtw_reset_tdls_info(padapter); -+ -+ ptdlsinfo->tdls_enable = _TRUE; -+#ifdef CONFIG_TDLS_DRIVER_SETUP -+ ptdlsinfo->driver_setup = _TRUE; -+#else -+ ptdlsinfo->driver_setup = _FALSE; -+#endif /* CONFIG_TDLS_DRIVER_SETUP */ -+ -+ _rtw_spinlock_init(&ptdlsinfo->cmd_lock); -+ _rtw_spinlock_init(&ptdlsinfo->hdl_lock); -+ -+ return res; -+ -+} -+ -+void rtw_free_tdls_info(struct tdls_info *ptdlsinfo) -+{ -+ _rtw_spinlock_free(&ptdlsinfo->cmd_lock); -+ _rtw_spinlock_free(&ptdlsinfo->hdl_lock); -+ -+ _rtw_memset(ptdlsinfo, 0, sizeof(struct tdls_info)); -+ -+} -+ -+int check_ap_tdls_prohibited(u8 *pframe, u8 pkt_len) -+{ -+ u8 tdls_prohibited_bit = 0x40; /* bit(38); TDLS_prohibited */ -+ -+ if (pkt_len < 5) -+ return _FALSE; -+ -+ pframe += 4; -+ if ((*pframe) & tdls_prohibited_bit) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+int check_ap_tdls_ch_switching_prohibited(u8 *pframe, u8 pkt_len) -+{ -+ u8 tdls_ch_swithcing_prohibited_bit = 0x80; /* bit(39); TDLS_channel_switching prohibited */ -+ -+ if (pkt_len < 5) -+ return _FALSE; -+ -+ pframe += 4; -+ if ((*pframe) & tdls_ch_swithcing_prohibited_bit) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+u8 rtw_tdls_is_setup_allowed(_adapter *padapter) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ if (ptdlsinfo->ap_prohibited == _TRUE) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+#ifdef CONFIG_TDLS_CH_SW -+u8 rtw_tdls_is_chsw_allowed(_adapter *padapter) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ if (ptdlsinfo->ch_switch_prohibited == _TRUE) -+ return _FALSE; -+ -+ if (padapter->registrypriv.wifi_spec == 0) -+ return _FALSE; -+ -+ return _TRUE; -+} -+#endif -+ -+int _issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int wait_ack) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl, *qc; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ pattrib->hdrlen += 2; -+ pattrib->qos_en = _TRUE; -+ pattrib->eosp = 1; -+ pattrib->ack_policy = 0; -+ pattrib->mdata = 0; -+ pattrib->retry_ctrl = _FALSE; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ if (power_mode) -+ SetPwrMgt(fctrl); -+ -+ qc = (unsigned short *)(pframe + pattrib->hdrlen - 2); -+ -+ SetPriority(qc, 7); /* Set priority to VO */ -+ -+ SetEOSP(qc, pattrib->eosp); -+ -+ SetAckpolicy(qc, pattrib->ack_policy); -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if (wait_ack) -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+ -+} -+ -+/* -+ *wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT -+ *wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX -+ *try_cnt means the maximal TX count to try -+ */ -+int issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) -+{ -+ int ret; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+#if 0 -+ psta = rtw_get_stainfo(&padapter->stapriv, da); -+ if (psta) { -+ if (power_mode) -+ rtw_hal_macid_sleep(padapter, psta->mac_id); -+ else -+ rtw_hal_macid_wakeup(padapter, psta->mac_id); -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT ": Can't find sta info for " MAC_FMT ", skip macid %s!!\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), power_mode ? "sleep" : "wakeup"); -+ rtw_warn_on(1); -+ } -+#endif -+ -+ do { -+ ret = _issue_nulldata_to_TDLS_peer_STA(padapter, da, power_mode, wait_ms > 0 ? _TRUE : _FALSE); -+ -+ i++; -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ break; -+ -+ if (i < try_cnt && wait_ms > 0 && ret == _FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ } while ((i < try_cnt) && (ret == _FAIL || wait_ms == 0)); -+ -+ if (ret != _FAIL) { -+ ret = _SUCCESS; -+#ifndef DBG_XMIT_ACK -+ goto exit; -+#endif -+ } -+ -+ if (try_cnt && wait_ms) { -+ if (da) -+ RTW_INFO(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ else -+ RTW_INFO(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n", -+ FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter), -+ ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); -+ } -+exit: -+ return ret; -+} -+ -+void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ _irqL irqL; -+ -+ /* free peer sta_info */ -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ if (ptdlsinfo->sta_cnt != 0) -+ ptdlsinfo->sta_cnt--; -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ /* -2: AP + BC/MC sta, -4: default key */ -+ if (ptdlsinfo->sta_cnt < MAX_ALLOWED_TDLS_STA_NUM) { -+ ptdlsinfo->sta_maximum = _FALSE; -+ _rtw_memset(&ptdlsinfo->ss_record, 0x00, sizeof(struct tdls_ss_record)); -+ } -+ -+ /* clear cam */ -+ rtw_clearstakey_cmd(padapter, ptdls_sta, _TRUE); -+ -+ if (ptdlsinfo->sta_cnt == 0) { -+ rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); -+ ptdlsinfo->link_established = _FALSE; -+ } else -+ RTW_INFO("Remain tdls sta:%02x\n", ptdlsinfo->sta_cnt); -+ -+ rtw_free_stainfo(padapter, ptdls_sta); -+ -+} -+ -+ -+/* TDLS encryption(if needed) will always be CCMP */ -+void rtw_tdls_set_key(_adapter *padapter, struct sta_info *ptdls_sta) -+{ -+ ptdls_sta->dot118021XPrivacy = _AES_; -+ rtw_setstakey_cmd(padapter, ptdls_sta, TDLS_KEY, _TRUE); -+} -+ -+#ifdef CONFIG_80211N_HT -+void rtw_tdls_process_ht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ u8 max_AMPDU_len, min_MPDU_spacing; -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0; -+ -+ /* Save HT capabilities in the sta object */ -+ _rtw_memset(&ptdls_sta->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); -+ if (data && Length >= sizeof(struct rtw_ieee80211_ht_cap)) { -+ ptdls_sta->flags |= WLAN_STA_HT; -+ ptdls_sta->flags |= WLAN_STA_WME; -+ -+ _rtw_memcpy(&ptdls_sta->htpriv.ht_cap, data, sizeof(struct rtw_ieee80211_ht_cap)); -+ } else -+ ptdls_sta->flags &= ~WLAN_STA_HT; -+ -+ if (ptdls_sta->flags & WLAN_STA_HT) { -+ if (padapter->registrypriv.ht_enable == _TRUE) { -+ ptdls_sta->htpriv.ht_option = _TRUE; -+ ptdls_sta->qos_option = _TRUE; -+ } else { -+ ptdls_sta->htpriv.ht_option = _FALSE; -+ ptdls_sta->qos_option = _FALSE; -+ } -+ } -+ -+ /* HT related cap */ -+ if (ptdls_sta->htpriv.ht_option) { -+ /* Check if sta supports rx ampdu */ -+ if (padapter->registrypriv.ampdu_enable == 1) -+ ptdls_sta->htpriv.ampdu_enable = _TRUE; -+ -+ /* AMPDU Parameters field */ -+ /* Get MIN of MAX AMPDU Length Exp */ -+ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3) > (data[2] & 0x3)) -+ max_AMPDU_len = (data[2] & 0x3); -+ else -+ max_AMPDU_len = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3); -+ /* Get MAX of MIN MPDU Start Spacing */ -+ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) > (data[2] & 0x1c)) -+ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c); -+ else -+ min_MPDU_spacing = (data[2] & 0x1c); -+ ptdls_sta->htpriv.rx_ampdu_min_spacing = max_AMPDU_len | min_MPDU_spacing; -+ -+ /* Check if sta support s Short GI 20M */ -+ if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_20)) -+ ptdls_sta->htpriv.sgi_20m = _TRUE; -+ -+ /* Check if sta support s Short GI 40M */ -+ if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) -+ ptdls_sta->htpriv.sgi_40m = _TRUE; -+ -+ /* Bwmode would still followed AP's setting */ -+ if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) { -+ if (padapter->mlmeextpriv.cur_bwmode >= CHANNEL_WIDTH_40) -+ ptdls_sta->bw_mode = CHANNEL_WIDTH_40; -+ ptdls_sta->htpriv.ch_offset = padapter->mlmeextpriv.cur_ch_offset; -+ } -+ -+ /* Config LDPC Coding Capability */ -+ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX) && GET_HT_CAP_ELE_LDPC_CAP(data)) { -+ SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX)); -+ RTW_INFO("Enable HT Tx LDPC!\n"); -+ } -+ ptdls_sta->htpriv.ldpc_cap = cur_ldpc_cap; -+ -+ /* Config STBC setting */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_RX_STBC(data)) { -+ SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX)); -+ RTW_INFO("Enable HT Tx STBC!\n"); -+ } -+ ptdls_sta->htpriv.stbc_cap = cur_stbc_cap; -+ -+#ifdef CONFIG_BEAMFORMING -+ /* Config Tx beamforming setting */ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(data)) -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); -+ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(data)) -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); -+ ptdls_sta->htpriv.beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) -+ RTW_INFO("Client HT Beamforming Cap = 0x%02X\n", cur_beamform_cap); -+#endif /* CONFIG_BEAMFORMING */ -+ } -+ -+} -+ -+u8 *rtw_tdls_set_ht_cap(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ rtw_ht_use_default_setting(padapter); -+ -+ rtw_restructure_ht_ie(padapter, NULL, pframe, 0, &(pattrib->pktlen), padapter->mlmeextpriv.cur_channel); -+ -+ return pframe + pattrib->pktlen; -+} -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+void rtw_tdls_process_vht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0, rf_type = RF_1T1R; -+ u8 *pcap_mcs; -+ u8 vht_mcs[2]; -+ -+ _rtw_memset(&ptdls_sta->vhtpriv, 0, sizeof(struct vht_priv)); -+ if (data && Length == 12) { -+ ptdls_sta->flags |= WLAN_STA_VHT; -+ -+ _rtw_memcpy(ptdls_sta->vhtpriv.vht_cap, data, 12); -+ -+#if 0 -+ if (elems.vht_op_mode_notify && elems.vht_op_mode_notify_len == 1) -+ _rtw_memcpy(&pstat->vhtpriv.vht_op_mode_notify, elems.vht_op_mode_notify, 1); -+ else /* for Frame without Operating Mode notify ie; default: 80M */ -+ pstat->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80; -+#else -+ ptdls_sta->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80; -+#endif -+ } else -+ ptdls_sta->flags &= ~WLAN_STA_VHT; -+ -+ if (ptdls_sta->flags & WLAN_STA_VHT) { -+ if (REGSTY_IS_11AC_ENABLE(&padapter->registrypriv) -+ && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) -+ && (!pmlmepriv->country_ent || COUNTRY_CHPLAN_EN_11AC(pmlmepriv->country_ent))) -+ ptdls_sta->vhtpriv.vht_option = _TRUE; -+ else -+ ptdls_sta->vhtpriv.vht_option = _FALSE; -+ } -+ -+ /* B4 Rx LDPC */ -+ if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX) && -+ GET_VHT_CAPABILITY_ELE_RX_LDPC(data)) { -+ SET_FLAG(cur_ldpc_cap, (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX)); -+ RTW_INFO("Current VHT LDPC Setting = %02X\n", cur_ldpc_cap); -+ } -+ ptdls_sta->vhtpriv.ldpc_cap = cur_ldpc_cap; -+ -+ /* B5 Short GI for 80 MHz */ -+ ptdls_sta->vhtpriv.sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(data) & pvhtpriv->sgi_80m) ? _TRUE : _FALSE; -+ -+ /* B8 B9 B10 Rx STBC */ -+ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX) && -+ GET_VHT_CAPABILITY_ELE_RX_STBC(data)) { -+ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); -+ RTW_INFO("Current VHT STBC Setting = %02X\n", cur_stbc_cap); -+ } -+ ptdls_sta->vhtpriv.stbc_cap = cur_stbc_cap; -+ -+ /* B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && -+ GET_VHT_CAPABILITY_ELE_SU_BFEE(data)) -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); -+ -+ /* B12 SU Beamformee Capable, the target supports Beamformee and we are Beamformer */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) && -+ GET_VHT_CAPABILITY_ELE_SU_BFER(data)) -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ ptdls_sta->vhtpriv.beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) -+ RTW_INFO("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap); -+ -+ /* B23 B24 B25 Maximum A-MPDU Length Exponent */ -+ ptdls_sta->vhtpriv.ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(data); -+ -+ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(data); -+ _rtw_memcpy(vht_mcs, pcap_mcs, 2); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if ((rf_type == RF_1T1R) || (rf_type == RF_1T2R)) -+ vht_mcs[0] |= 0xfc; -+ else if (rf_type == RF_2T2R) -+ vht_mcs[0] |= 0xf0; -+ else if (rf_type == RF_3T3R) -+ vht_mcs[0] |= 0xc0; -+ -+ _rtw_memcpy(ptdls_sta->vhtpriv.vht_mcs_map, vht_mcs, 2); -+ -+ ptdls_sta->vhtpriv.vht_highest_rate = rtw_get_vht_highest_rate(ptdls_sta->vhtpriv.vht_mcs_map); -+} -+ -+u8 *rtw_tdls_set_aid(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ return rtw_set_ie(pframe, EID_AID, 2, (u8 *)&(padapter->mlmepriv.cur_network.aid), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_vht_cap(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u32 ie_len = 0; -+ -+ rtw_vht_use_default_setting(padapter); -+ -+ ie_len = rtw_build_vht_cap_ie(padapter, pframe); -+ pattrib->pktlen += ie_len; -+ -+ return pframe + ie_len; -+} -+ -+u8 *rtw_tdls_set_vht_operation(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib, u8 channel) -+{ -+ u32 ie_len = 0; -+ -+ ie_len = rtw_build_vht_operation_ie(padapter, pframe, channel); -+ pattrib->pktlen += ie_len; -+ -+ return pframe + ie_len; -+} -+ -+u8 *rtw_tdls_set_vht_op_mode_notify(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib, u8 bw) -+{ -+ u32 ie_len = 0; -+ -+ ie_len = rtw_build_vht_op_mode_notify_ie(padapter, pframe, bw); -+ pattrib->pktlen += ie_len; -+ -+ return pframe + ie_len; -+} -+#endif -+ -+ -+u8 *rtw_tdls_set_sup_ch(struct mlme_ext_priv *pmlmeext, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u8 sup_ch[30 * 2] = {0x00}, ch_set_idx = 0, sup_ch_idx = 2; -+ -+ do { -+ if (pmlmeext->channel_set[ch_set_idx].ChannelNum <= 14) { -+ sup_ch[0] = 1; /* First channel number */ -+ sup_ch[1] = pmlmeext->channel_set[ch_set_idx].ChannelNum; /* Number of channel */ -+ } else { -+ sup_ch[sup_ch_idx++] = pmlmeext->channel_set[ch_set_idx].ChannelNum; -+ sup_ch[sup_ch_idx++] = 1; -+ } -+ ch_set_idx++; -+ } while (pmlmeext->channel_set[ch_set_idx].ChannelNum != 0 && ch_set_idx < MAX_CHANNEL_NUM); -+ -+ return rtw_set_ie(pframe, _SUPPORTED_CH_IE_, sup_ch_idx, sup_ch, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_rsnie(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib *pattrib, int init, struct sta_info *ptdls_sta) -+{ -+ u8 *p = NULL; -+ int len = 0; -+ -+ if (ptxmgmt->len > 0) -+ p = rtw_get_ie(ptxmgmt->buf, _RSN_IE_2_, &len, ptxmgmt->len); -+ -+ if (p != NULL) -+ return rtw_set_ie(pframe, _RSN_IE_2_, len, p + 2, &(pattrib->pktlen)); -+ else if (init == _TRUE) -+ return rtw_set_ie(pframe, _RSN_IE_2_, sizeof(TDLS_RSNIE), TDLS_RSNIE, &(pattrib->pktlen)); -+ else -+ return rtw_set_ie(pframe, _RSN_IE_2_, sizeof(ptdls_sta->TDLS_RSNIE), ptdls_sta->TDLS_RSNIE, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_ext_cap(u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ return rtw_set_ie(pframe, _EXT_CAP_IE_ , sizeof(TDLS_EXT_CAPIE), TDLS_EXT_CAPIE, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_qos_cap(u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ return rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, sizeof(TDLS_WMMIE), TDLS_WMMIE, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_ftie(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib *pattrib, u8 *ANonce, u8 *SNonce) -+{ -+ struct wpa_tdls_ftie FTIE = {0}; -+ u8 *p = NULL; -+ int len = 0; -+ -+ if (ptxmgmt->len > 0) -+ p = rtw_get_ie(ptxmgmt->buf, _FTIE_, &len, ptxmgmt->len); -+ -+ if (p != NULL) -+ return rtw_set_ie(pframe, _FTIE_, len, p + 2, &(pattrib->pktlen)); -+ else { -+ if (ANonce != NULL) -+ _rtw_memcpy(FTIE.Anonce, ANonce, WPA_NONCE_LEN); -+ if (SNonce != NULL) -+ _rtw_memcpy(FTIE.Snonce, SNonce, WPA_NONCE_LEN); -+ return rtw_set_ie(pframe, _FTIE_ , 82, (u8 *)FTIE.mic_ctrl, &(pattrib->pktlen)); -+ } -+} -+ -+u8 *rtw_tdls_set_timeout_interval(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib *pattrib, int init, struct sta_info *ptdls_sta) -+{ -+ u8 timeout_itvl[5]; /* set timeout interval to maximum value */ -+ u32 timeout_interval = TDLS_TPK_RESEND_COUNT; -+ u8 *p = NULL; -+ int len = 0; -+ -+ if (ptxmgmt->len > 0) -+ p = rtw_get_ie(ptxmgmt->buf, _TIMEOUT_ITVL_IE_, &len, ptxmgmt->len); -+ -+ if (p != NULL) -+ return rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, len, p + 2, &(pattrib->pktlen)); -+ else { -+ /* Timeout interval */ -+ timeout_itvl[0] = 0x02; -+ if (init == _TRUE) -+ _rtw_memcpy(timeout_itvl + 1, &timeout_interval, 4); -+ else -+ _rtw_memcpy(timeout_itvl + 1, (u8 *)(&ptdls_sta->TDLS_PeerKey_Lifetime), 4); -+ -+ return rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); -+ } -+} -+ -+u8 *rtw_tdls_set_bss_coexist(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u8 iedata = 0; -+ -+ if (padapter->mlmepriv.num_FortyMHzIntolerant > 0) -+ iedata |= BIT(2); /* 20 MHz BSS Width Request */ -+ -+ /* Information Bit should be set by TDLS test plan 5.9 */ -+ iedata |= BIT(0); -+ return rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_payload_type(u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u8 payload_type = 0x02; -+ return rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_category(u8 *pframe, struct pkt_attrib *pattrib, u8 category) -+{ -+ return rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_action(u8 *pframe, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt) -+{ -+ return rtw_set_fixed_ie(pframe, 1, &(ptxmgmt->action_code), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_status_code(u8 *pframe, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt) -+{ -+ return rtw_set_fixed_ie(pframe, 2, (u8 *)&(ptxmgmt->status_code), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_dialog(u8 *pframe, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt) -+{ -+ u8 dialogtoken = 1; -+ if (ptxmgmt->dialog_token) -+ return rtw_set_fixed_ie(pframe, 1, &(ptxmgmt->dialog_token), &(pattrib->pktlen)); -+ else -+ return rtw_set_fixed_ie(pframe, 1, &(dialogtoken), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_reg_class(u8 *pframe, struct pkt_attrib *pattrib, struct sta_info *ptdls_sta) -+{ -+ u8 reg_class = 22; -+ return rtw_set_fixed_ie(pframe, 1, &(reg_class), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_second_channel_offset(u8 *pframe, struct pkt_attrib *pattrib, u8 ch_offset) -+{ -+ return rtw_set_ie(pframe, EID_SecondaryChnlOffset , 1, &ch_offset, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_capability(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ u8 cap_from_ie[2] = {0}; -+ -+ _rtw_memcpy(cap_from_ie, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+ -+ return rtw_set_fixed_ie(pframe, 2, cap_from_ie, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_supported_rate(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u8 bssrate[NDIS_802_11_LENGTH_RATES_EX]; -+ int bssrate_len = 0; -+ u8 more_supportedrates = 0; -+ -+ rtw_set_supported_rate(bssrate, (padapter->registrypriv.wireless_mode == WIRELESS_MODE_MAX) ? padapter->mlmeextpriv.cur_wireless_mode : padapter->registrypriv.wireless_mode); -+ bssrate_len = rtw_get_rateset_len(bssrate); -+ -+ if (bssrate_len > 8) { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); -+ more_supportedrates = 1; -+ } else -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); -+ -+ /* extended supported rates */ -+ if (more_supportedrates == 1) -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); -+ -+ return pframe; -+} -+ -+u8 *rtw_tdls_set_sup_reg_class(u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ return rtw_set_ie(pframe, _SRC_IE_ , sizeof(TDLS_SRC), TDLS_SRC, &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_linkid(u8 *pframe, struct pkt_attrib *pattrib, u8 init) -+{ -+ u8 link_id_addr[18] = {0}; -+ if (init == _TRUE) { -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr + 6), pattrib->src, 6); -+ _rtw_memcpy((link_id_addr + 12), pattrib->dst, 6); -+ } else { -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr + 6), pattrib->dst, 6); -+ _rtw_memcpy((link_id_addr + 12), pattrib->src, 6); -+ } -+ return rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); -+} -+ -+#ifdef CONFIG_TDLS_CH_SW -+u8 *rtw_tdls_set_target_ch(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u8 target_ch = 1; -+ if (padapter->tdlsinfo.chsw_info.off_ch_num) -+ return rtw_set_fixed_ie(pframe, 1, &(padapter->tdlsinfo.chsw_info.off_ch_num), &(pattrib->pktlen)); -+ else -+ return rtw_set_fixed_ie(pframe, 1, &(target_ch), &(pattrib->pktlen)); -+} -+ -+u8 *rtw_tdls_set_ch_sw(u8 *pframe, struct pkt_attrib *pattrib, struct sta_info *ptdls_sta) -+{ -+ u8 ch_switch_timing[4] = {0}; -+ u16 switch_time = (ptdls_sta->ch_switch_time >= TDLS_CH_SWITCH_TIME * 1000) ? -+ ptdls_sta->ch_switch_time : TDLS_CH_SWITCH_TIME; -+ u16 switch_timeout = (ptdls_sta->ch_switch_timeout >= TDLS_CH_SWITCH_TIMEOUT * 1000) ? -+ ptdls_sta->ch_switch_timeout : TDLS_CH_SWITCH_TIMEOUT; -+ -+ _rtw_memcpy(ch_switch_timing, &switch_time, 2); -+ _rtw_memcpy(ch_switch_timing + 2, &switch_timeout, 2); -+ -+ return rtw_set_ie(pframe, _CH_SWITCH_TIMING_, 4, ch_switch_timing, &(pattrib->pktlen)); -+} -+ -+void rtw_tdls_set_ch_sw_oper_control(_adapter *padapter, u8 enable) -+{ -+ if (ATOMIC_READ(&padapter->tdlsinfo.chsw_info.chsw_on) != enable) -+ ATOMIC_SET(&padapter->tdlsinfo.chsw_info.chsw_on, enable); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_BCN_EARLY_C2H_RPT, &enable); -+ RTW_INFO("[TDLS] %s Bcn Early C2H Report\n", (enable == _TRUE) ? "Start" : "Stop"); -+} -+ -+void rtw_tdls_ch_sw_back_to_base_chnl(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv; -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ -+ pmlmepriv = &padapter->mlmepriv; -+ -+ if ((ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) && -+ (padapter->mlmeextpriv.cur_channel != rtw_get_oper_ch(padapter))) -+ rtw_tdls_cmd(padapter, pchsw_info->addr, TDLS_CH_SW_TO_BASE_CHNL_UNSOLICITED); -+} -+ -+static void rtw_tdls_chsw_oper_init(_adapter *padapter, u32 timeout_ms) -+{ -+ struct submit_ctx *chsw_sctx = &padapter->tdlsinfo.chsw_info.chsw_sctx; -+ -+ rtw_sctx_init(chsw_sctx, timeout_ms); -+} -+ -+static int rtw_tdls_chsw_oper_wait(_adapter *padapter) -+{ -+ struct submit_ctx *chsw_sctx = &padapter->tdlsinfo.chsw_info.chsw_sctx; -+ -+ return rtw_sctx_wait(chsw_sctx, __func__); -+} -+ -+void rtw_tdls_chsw_oper_done(_adapter *padapter) -+{ -+ struct submit_ctx *chsw_sctx = &padapter->tdlsinfo.chsw_info.chsw_sctx; -+ -+ rtw_sctx_done(&chsw_sctx); -+} -+ -+s32 rtw_tdls_do_ch_sw(_adapter *padapter, struct sta_info *ptdls_sta, u8 chnl_type, u8 channel, u8 channel_offset, u16 bwmode, u16 ch_switch_time) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 center_ch, chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ u32 ch_sw_time_start, ch_sw_time_spent, wait_time; -+ u8 take_care_iqk; -+ s32 ret = _FAIL; -+ -+ ch_sw_time_start = rtw_systime_to_ms(rtw_get_current_time()); -+ -+ rtw_tdls_chsw_oper_init(padapter, TDLS_CH_SWITCH_OPER_OFFLOAD_TIMEOUT); -+ -+ /* set mac_id sleep before channel switch */ -+ rtw_hal_macid_sleep(padapter, ptdls_sta->mac_id); -+ -+ /* channel switch IOs offload to FW */ -+ if (rtw_hal_ch_sw_oper_offload(padapter, channel, channel_offset, bwmode) == _SUCCESS) { -+ if (rtw_tdls_chsw_oper_wait(padapter) == _SUCCESS) { -+ /* set channel and bw related variables in driver */ -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); -+ -+ rtw_set_oper_ch(padapter, channel); -+ rtw_set_oper_choffset(padapter, channel_offset); -+ rtw_set_oper_bw(padapter, bwmode); -+ -+ center_ch = rtw_get_center_ch(channel, bwmode, channel_offset); -+ pHalData->CurrentChannel = center_ch; -+ pHalData->CurrentCenterFrequencyIndex1 = center_ch; -+ pHalData->CurrentChannelBW = bwmode; -+ pHalData->nCur40MhzPrimeSC = channel_offset; -+ -+ if (bwmode == CHANNEL_WIDTH_80) { -+ if (center_ch > channel) -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else if (center_ch < channel) -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ pHalData->nCur80MhzPrimeSC = chnl_offset80; -+ -+ pHalData->CurrentCenterFrequencyIndex1 = center_ch; -+ -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk); -+ if (take_care_iqk == _TRUE) -+ rtw_hal_ch_sw_iqk_info_restore(padapter, CH_SW_USE_CASE_TDLS); -+ -+ ch_sw_time_spent = rtw_systime_to_ms(rtw_get_current_time()) - ch_sw_time_start; -+ -+ if (chnl_type == TDLS_CH_SW_OFF_CHNL) { -+ if ((u32)ch_switch_time / 1000 > ch_sw_time_spent) -+ wait_time = (u32)ch_switch_time / 1000 - ch_sw_time_spent; -+ else -+ wait_time = 0; -+ -+ if (wait_time > 0) -+ rtw_msleep_os(wait_time); -+ } -+ -+ ret = _SUCCESS; -+ } else -+ RTW_INFO("[TDLS] chsw oper wait fail !!\n"); -+ } -+ -+ /* set mac_id wakeup after channel switch */ -+ rtw_hal_macid_wakeup(padapter, ptdls_sta->mac_id); -+ -+ return ret; -+} -+#endif -+ -+u8 *rtw_tdls_set_wmm_params(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 wmm_param_ele[24] = {0}; -+ -+ if (&pmlmeinfo->WMM_param) { -+ _rtw_memcpy(wmm_param_ele, WMM_PARA_OUI, 6); -+ if (_rtw_memcmp(&pmlmeinfo->WMM_param, &wmm_param_ele[6], 18) == _TRUE) -+ /* Use default WMM Param */ -+ _rtw_memcpy(wmm_param_ele + 6, (u8 *)&TDLS_WMM_PARAM_IE, sizeof(TDLS_WMM_PARAM_IE)); -+ else -+ _rtw_memcpy(wmm_param_ele + 6, (u8 *)&pmlmeinfo->WMM_param, sizeof(pmlmeinfo->WMM_param)); -+ return rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 24, wmm_param_ele, &(pattrib->pktlen)); -+ } else -+ return pframe; -+} -+ -+#ifdef CONFIG_WFD -+void rtw_tdls_process_wfd_ie(struct tdls_info *ptdlsinfo, u8 *ptr, u8 length) -+{ -+ u8 *wfd_ie; -+ u32 wfd_ielen = 0; -+ -+ if (!hal_chk_wl_func(tdls_info_to_adapter(ptdlsinfo), WL_FUNC_MIRACAST)) -+ return; -+ -+ /* Try to get the TCP port information when receiving the negotiation response. */ -+ -+ wfd_ie = rtw_get_wfd_ie(ptr, length, NULL, &wfd_ielen); -+ while (wfd_ie) { -+ u8 *attr_content; -+ u32 attr_contentlen = 0; -+ int i; -+ -+ RTW_INFO("[%s] WFD IE Found!!\n", __FUNCTION__); -+ attr_content = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &attr_contentlen); -+ if (attr_content && attr_contentlen) { -+ ptdlsinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16(attr_content + 2); -+ RTW_INFO("[%s] Peer PORT NUM = %d\n", __FUNCTION__, ptdlsinfo->wfd_info->peer_rtsp_ctrlport); -+ } -+ -+ attr_content = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_LOCAL_IP_ADDR, NULL, &attr_contentlen); -+ if (attr_content && attr_contentlen) { -+ _rtw_memcpy(ptdlsinfo->wfd_info->peer_ip_address, (attr_content + 1), 4); -+ RTW_INFO("[%s] Peer IP = %02u.%02u.%02u.%02u\n", __FUNCTION__, -+ ptdlsinfo->wfd_info->peer_ip_address[0], ptdlsinfo->wfd_info->peer_ip_address[1], -+ ptdlsinfo->wfd_info->peer_ip_address[2], ptdlsinfo->wfd_info->peer_ip_address[3]); -+ } -+ -+ wfd_ie = rtw_get_wfd_ie(wfd_ie + wfd_ielen, (ptr + length) - (wfd_ie + wfd_ielen), NULL, &wfd_ielen); -+ } -+} -+ -+int issue_tunneled_probe_req(_adapter *padapter) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ u8 baddr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ struct tdls_txmgmt txmgmt; -+ int ret = _FAIL; -+ -+ RTW_INFO("[%s]\n", __FUNCTION__); -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.action_code = TUNNELED_PROBE_REQ; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, baddr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+} -+ -+int issue_tunneled_probe_rsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct tdls_txmgmt txmgmt; -+ int ret = _FAIL; -+ -+ RTW_INFO("[%s]\n", __FUNCTION__); -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.action_code = TUNNELED_PROBE_RSP; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, precv_frame->u.hdr.attrib.src, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+} -+#endif /* CONFIG_WFD */ -+ -+int issue_tdls_setup_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta = NULL; -+ _irqL irqL; -+ int ret = _FAIL; -+ /* Retry timer should be set at least 301 sec, using TPK_count counting 301 times. */ -+ u32 timeout_interval = TDLS_TPK_RESEND_COUNT; -+ -+ RTW_INFO("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_SETUP_REQUEST; -+ if (rtw_tdls_is_setup_allowed(padapter) == _FALSE) -+ goto exit; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ -+ /* init peer sta_info */ -+ ptdls_sta = rtw_get_stainfo(pstapriv, ptxmgmt->peer); -+ if (ptdls_sta == NULL) { -+ ptdls_sta = rtw_alloc_stainfo(pstapriv, ptxmgmt->peer); -+ if (ptdls_sta == NULL) { -+ RTW_INFO("[%s] rtw_alloc_stainfo fail\n", __FUNCTION__); -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ } -+ -+ if (!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) -+ ptdlsinfo->sta_cnt++; -+ -+ if (ptdlsinfo->sta_cnt == MAX_ALLOWED_TDLS_STA_NUM) -+ ptdlsinfo->sta_maximum = _TRUE; -+ -+ ptdls_sta->tdls_sta_state |= TDLS_RESPONDER_STATE; -+ -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { -+ ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; -+ _set_timer(&ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME); -+ } -+ -+ pattrib->qsel = pattrib->priority; -+ -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ if (wait_ack) -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ -+ return ret; -+} -+ -+int _issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta = NULL; -+ _irqL irqL; -+ int ret = _FAIL; -+ -+ RTW_INFO("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_TEARDOWN; -+ ptdls_sta = rtw_get_stainfo(pstapriv, ptxmgmt->peer); -+ if (ptdls_sta == NULL) { -+ RTW_INFO("Np tdls_sta for tearing down\n"); -+ goto exit; -+ } -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ rtw_mi_set_scan_deny(padapter, 550); -+ rtw_mi_scan_abort(padapter, _TRUE); -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) -+ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) -+ if (pattrib->encrypt) -+ _cancel_timer_ex(&ptdls_sta->TPK_timer); -+ -+ if (wait_ack) -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+ if (rtw_tdls_is_driver_setup(padapter)) -+ rtw_tdls_cmd(padapter, ptxmgmt->peer, TDLS_TEARDOWN_STA_LOCALLY); -+ -+exit: -+ -+ return ret; -+} -+ -+int issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack) -+{ -+ int ret = _FAIL; -+ -+ ret = _issue_tdls_teardown(padapter, ptxmgmt, wait_ack); -+ if ((ptxmgmt->status_code == _RSON_TDLS_TEAR_UN_RSN_) && (ret == _FAIL)) { -+ /* Change status code and send teardown again via AP */ -+ ptxmgmt->status_code = _RSON_TDLS_TEAR_TOOFAR_; -+ ret = _issue_tdls_teardown(padapter, ptxmgmt, wait_ack); -+ } -+ -+ return ret; -+} -+ -+int issue_tdls_dis_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ int ret = _FAIL; -+ -+ RTW_INFO("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_DISCOVERY_REQUEST; -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ dump_mgntframe(padapter, pmgntframe); -+ RTW_INFO("issue tdls dis req\n"); -+ -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+} -+ -+int issue_tdls_setup_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ int ret = _FAIL; -+ -+ RTW_INFO("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_SETUP_RESPONSE; -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(&(padapter->mlmepriv)), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+ -+} -+ -+int issue_tdls_setup_cfm(_adapter *padapter, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ int ret = _FAIL; -+ -+ RTW_INFO("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_SETUP_CONFIRM; -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(&padapter->mlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+ -+} -+ -+/* TDLS Discovery Response frame is a management action frame */ -+int issue_tdls_dis_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 privacy) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ int ret = _FAIL; -+ -+ RTW_INFO("[TDLS] %s\n", __FUNCTION__); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ /* unicast probe request frame */ -+ _rtw_memcpy(pwlanhdr->addr1, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->dst, pwlanhdr->addr1, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, pwlanhdr->addr2, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pwlanhdr->addr3, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ rtw_build_tdls_dis_rsp_ies(padapter, pmgntframe, pframe, ptxmgmt, privacy); -+ -+ pattrib->nr_frags = 1; -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+int issue_tdls_peer_traffic_rsp(_adapter *padapter, struct sta_info *ptdls_sta, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ int ret = _FAIL; -+ -+ RTW_INFO("[TDLS] %s\n", __FUNCTION__); -+ -+ ptxmgmt->action_code = TDLS_PEER_TRAFFIC_RESPONSE; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ -+exit: -+ -+ return ret; -+} -+ -+int issue_tdls_peer_traffic_indication(_adapter *padapter, struct sta_info *ptdls_sta) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct tdls_txmgmt txmgmt; -+ int ret = _FAIL; -+ -+ RTW_INFO("[TDLS] %s\n", __FUNCTION__); -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.action_code = TDLS_PEER_TRAFFIC_INDICATION; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ /* PTI frame's priority should be AC_VO */ -+ pattrib->priority = 7; -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ -+exit: -+ -+ return ret; -+} -+ -+#ifdef CONFIG_TDLS_CH_SW -+int issue_tdls_ch_switch_req(_adapter *padapter, struct sta_info *ptdls_sta) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct tdls_txmgmt txmgmt; -+ int ret = _FAIL; -+ -+ RTW_INFO("[TDLS] %s\n", __FUNCTION__); -+ -+ if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) { -+ RTW_INFO("[TDLS] Ignore %s since channel switch is not allowed\n", __func__); -+ goto exit; -+ } -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ txmgmt.action_code = TDLS_CHANNEL_SWITCH_REQUEST; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+exit: -+ -+ return ret; -+} -+ -+int issue_tdls_ch_switch_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ int ret = _FAIL; -+ -+ RTW_INFO("[TDLS] %s\n", __FUNCTION__); -+ -+ if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) { -+ RTW_INFO("[TDLS] Ignore %s since channel switch is not allowed\n", __func__); -+ goto exit; -+ } -+ -+ ptxmgmt->action_code = TDLS_CHANNEL_SWITCH_RESPONSE; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto exit; -+ -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, ptxmgmt->peer, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel = pattrib->priority; -+ /* -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ if(xmitframe_enqueue_for_tdls_sleeping_sta(padapter, pmgntframe)==_TRUE){ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ return _FALSE; -+ } -+ */ -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ if (wait_ack) -+ ret = dump_mgntframe_and_wait_ack_timeout(padapter, pmgntframe, 10); -+ else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+exit: -+ -+ return ret; -+} -+#endif -+ -+int On_TDLS_Dis_Rsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct sta_info *ptdls_sta = NULL, *psta = rtw_get_stainfo(&(padapter->stapriv), get_bssid(&(padapter->mlmepriv))); -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ u8 *ptr = precv_frame->u.hdr.rx_data, *psa; -+ struct rx_pkt_attrib *pattrib = &(precv_frame->u.hdr.attrib); -+ struct tdls_info *ptdlsinfo = &(padapter->tdlsinfo); -+ u8 empty_addr[ETH_ALEN] = { 0x00 }; -+ int UndecoratedSmoothedPWDB; -+ struct tdls_txmgmt txmgmt; -+ int ret = _SUCCESS; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ /* WFDTDLS: for sigma test, not to setup direct link automatically */ -+ ptdlsinfo->dev_discovered = _TRUE; -+ -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), psa); -+ if (ptdls_sta != NULL) -+ ptdls_sta->sta_stats.rx_tdls_disc_rsp_pkts++; -+ -+#ifdef CONFIG_TDLS_AUTOSETUP -+ if (ptdls_sta != NULL) { -+ /* Record the tdls sta with lowest signal strength */ -+ if (ptdlsinfo->sta_maximum == _TRUE && ptdls_sta->alive_count >= 1) { -+ if (_rtw_memcmp(ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN)) { -+ _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); -+ ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.RxPWDBAll; -+ } else { -+ if (ptdlsinfo->ss_record.RxPWDBAll < pattrib->phy_info.RxPWDBAll) { -+ _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); -+ ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.RxPWDBAll; -+ } -+ } -+ } -+ } else { -+ if (ptdlsinfo->sta_maximum == _TRUE) { -+ if (_rtw_memcmp(ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN)) { -+ /* All traffics are busy, do not set up another direct link. */ -+ ret = _FAIL; -+ goto exit; -+ } else { -+ if (pattrib->phy_info.RxPWDBAll > ptdlsinfo->ss_record.RxPWDBAll) { -+ _rtw_memcpy(txmgmt.peer, ptdlsinfo->ss_record.macaddr, ETH_ALEN); -+ /* issue_tdls_teardown(padapter, ptdlsinfo->ss_record.macaddr, _FALSE); */ -+ } else { -+ ret = _FAIL; -+ goto exit; -+ } -+ } -+ } -+ -+ rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); -+ -+ if (pattrib->phy_info.RxPWDBAll + TDLS_SIGNAL_THRESH >= UndecoratedSmoothedPWDB) { -+ RTW_INFO("pattrib->RxPWDBAll=%d, pdmpriv->UndecoratedSmoothedPWDB=%d\n", pattrib->phy_info.RxPWDBAll, UndecoratedSmoothedPWDB); -+ _rtw_memcpy(txmgmt.peer, psa, ETH_ALEN); -+ issue_tdls_setup_req(padapter, &txmgmt, _FALSE); -+ } -+ } -+#endif /* CONFIG_TDLS_AUTOSETUP */ -+ -+exit: -+ return ret; -+ -+} -+ -+sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ u8 *psa, *pmyid; -+ struct sta_info *ptdls_sta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ _irqL irqL; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *prsnie, *ppairwise_cipher; -+ u8 i, k; -+ u8 ccmp_included = 0, rsnie_included = 0; -+ u16 j, pairwise_count; -+ u8 SNonce[32]; -+ u32 timeout_interval = TDLS_TPK_RESEND_COUNT; -+ sint parsing_length; /* Frame body length, without icv_len */ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 5; -+ unsigned char supportRate[16]; -+ int supportRateNum = 0; -+ struct tdls_txmgmt txmgmt; -+ -+ if (rtw_tdls_is_setup_allowed(padapter) == _FALSE) -+ goto exit; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ pmyid = adapter_mac_addr(padapter); -+ ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; -+ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len -+ - prx_pkt_attrib->hdrlen -+ - prx_pkt_attrib->iv_len -+ - prx_pkt_attrib->icv_len -+ - LLC_HEADER_SIZE -+ - ETH_TYPE_LEN -+ - PAYLOAD_TYPE_LEN -+ - FIXED_IE; -+ -+ if (ptdls_sta == NULL) -+ ptdls_sta = rtw_alloc_stainfo(pstapriv, psa); -+ else { -+ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { -+ /* If the direct link is already set up */ -+ /* Process as re-setup after tear down */ -+ RTW_INFO("re-setup a direct link\n"); -+ } -+ /* Already receiving TDLS setup request */ -+ else if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) { -+ RTW_INFO("receive duplicated TDLS setup request frame in handshaking\n"); -+ goto exit; -+ } -+ /* When receiving and sending setup_req to the same link at the same time */ -+ /* STA with higher MAC_addr would be initiator */ -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) { -+ RTW_INFO("receive setup_req after sending setup_req\n"); -+ for (i = 0; i < 6; i++) { -+ if (*(pmyid + i) == *(psa + i)) { -+ } else if (*(pmyid + i) > *(psa + i)) { -+ ptdls_sta->tdls_sta_state = TDLS_INITIATOR_STATE; -+ break; -+ } else if (*(pmyid + i) < *(psa + i)) -+ goto exit; -+ } -+ } -+ } -+ -+ if (ptdls_sta) { -+ txmgmt.dialog_token = *(ptr + 2); /* Copy dialog token */ -+ txmgmt.status_code = _STATS_SUCCESSFUL_; -+ -+ /* Parsing information element */ -+ for (j = FIXED_IE; j < parsing_length;) { -+ -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); -+ -+ switch (pIE->ElementID) { -+ case _SUPPORTEDRATES_IE_: -+ _rtw_memcpy(supportRate, pIE->data, pIE->Length); -+ supportRateNum = pIE->Length; -+ break; -+ case _COUNTRY_IE_: -+ break; -+ case _EXT_SUPPORTEDRATES_IE_: -+ if (supportRateNum <= sizeof(supportRate)) { -+ _rtw_memcpy(supportRate + supportRateNum, pIE->data, pIE->Length); -+ supportRateNum += pIE->Length; -+ } -+ break; -+ case _SUPPORTED_CH_IE_: -+ break; -+ case _RSN_IE_2_: -+ rsnie_included = 1; -+ if (prx_pkt_attrib->encrypt) { -+ prsnie = (u8 *)pIE; -+ /* Check CCMP pairwise_cipher presence. */ -+ ppairwise_cipher = prsnie + 10; -+ _rtw_memcpy(ptdls_sta->TDLS_RSNIE, pIE->data, pIE->Length); -+ pairwise_count = *(u16 *)(ppairwise_cipher - 2); -+ for (k = 0; k < pairwise_count; k++) { -+ if (_rtw_memcmp(ppairwise_cipher + 4 * k, RSN_CIPHER_SUITE_CCMP, 4) == _TRUE) -+ ccmp_included = 1; -+ } -+ -+ if (ccmp_included == 0) -+ txmgmt.status_code = _STATS_INVALID_RSNIE_; -+ } -+ break; -+ case _EXT_CAP_IE_: -+ break; -+ case _VENDOR_SPECIFIC_IE_: -+ break; -+ case _FTIE_: -+ if (prx_pkt_attrib->encrypt) -+ _rtw_memcpy(SNonce, (ptr + j + 52), 32); -+ break; -+ case _TIMEOUT_ITVL_IE_: -+ if (prx_pkt_attrib->encrypt) -+ timeout_interval = cpu_to_le32(*(u32 *)(ptr + j + 3)); -+ break; -+ case _RIC_Descriptor_IE_: -+ break; -+#ifdef CONFIG_80211N_HT -+ case _HT_CAPABILITY_IE_: -+ rtw_tdls_process_ht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); -+ break; -+#endif -+#ifdef CONFIG_80211AC_VHT -+ case EID_AID: -+ break; -+ case EID_VHTCapability: -+ rtw_tdls_process_vht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); -+ break; -+#endif -+ case EID_BSSCoexistence: -+ break; -+ case _LINK_ID_IE_: -+ if (_rtw_memcmp(get_bssid(pmlmepriv), pIE->data, 6) == _FALSE) -+ txmgmt.status_code = _STATS_NOT_IN_SAME_BSS_; -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ /* Check status code */ -+ /* If responder STA has/hasn't security on AP, but request hasn't/has RSNIE, it should reject */ -+ if (txmgmt.status_code == _STATS_SUCCESSFUL_) { -+ if (rsnie_included && prx_pkt_attrib->encrypt == 0) -+ txmgmt.status_code = _STATS_SEC_DISABLED_; -+ else if (rsnie_included == 0 && prx_pkt_attrib->encrypt) -+ txmgmt.status_code = _STATS_INVALID_PARAMETERS_; -+ -+#ifdef CONFIG_WFD -+ /* WFD test plan version 0.18.2 test item 5.1.5 */ -+ /* SoUT does not use TDLS if AP uses weak security */ -+ if (padapter->wdinfo.wfd_tdls_enable && (rsnie_included && prx_pkt_attrib->encrypt != _AES_)) -+ txmgmt.status_code = _STATS_SEC_DISABLED_; -+#endif /* CONFIG_WFD */ -+ } -+ -+ ptdls_sta->tdls_sta_state |= TDLS_INITIATOR_STATE; -+ if (prx_pkt_attrib->encrypt) { -+ _rtw_memcpy(ptdls_sta->SNonce, SNonce, 32); -+ -+ if (timeout_interval <= 300) -+ ptdls_sta->TDLS_PeerKey_Lifetime = TDLS_TPK_RESEND_COUNT; -+ else -+ ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; -+ } -+ -+ /* Update station supportRate */ -+ ptdls_sta->bssratelen = supportRateNum; -+ _rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum); -+ -+ if (!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) -+ ptdlsinfo->sta_cnt++; -+ /* -2: AP + BC/MC sta, -4: default key */ -+ if (ptdlsinfo->sta_cnt == MAX_ALLOWED_TDLS_STA_NUM) -+ ptdlsinfo->sta_maximum = _TRUE; -+ -+#ifdef CONFIG_WFD -+ rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length); -+#endif -+ -+ } else -+ goto exit; -+ -+ _rtw_memcpy(txmgmt.peer, prx_pkt_attrib->src, ETH_ALEN); -+ -+ if (rtw_tdls_is_driver_setup(padapter)) { -+ issue_tdls_setup_rsp(padapter, &txmgmt); -+ -+ if (txmgmt.status_code == _STATS_SUCCESSFUL_) -+ _set_timer(&ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME); -+ else -+ free_tdls_sta(padapter, ptdls_sta); -+ } -+ -+exit: -+ -+ return _SUCCESS; -+} -+ -+int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_info *ptdls_sta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ _irqL irqL; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *psa; -+ u16 status_code = 0; -+ sint parsing_length; /* Frame body length, without icv_len */ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 7; -+ u8 ANonce[32]; -+ u8 *pftie = NULL, *ptimeout_ie = NULL, *plinkid_ie = NULL, *prsnie = NULL, *pftie_mic = NULL, *ppairwise_cipher = NULL; -+ u16 pairwise_count, j, k; -+ u8 verify_ccmp = 0; -+ unsigned char supportRate[16]; -+ int supportRateNum = 0; -+ struct tdls_txmgmt txmgmt; -+ int ret = _SUCCESS; -+ u32 timeout_interval = TDLS_TPK_RESEND_COUNT; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ if (ptdls_sta == NULL) { -+ RTW_INFO("[%s] Direct Link Peer = "MAC_FMT" not found\n", __func__, MAC_ARG(psa)); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; -+ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len -+ - prx_pkt_attrib->hdrlen -+ - prx_pkt_attrib->iv_len -+ - prx_pkt_attrib->icv_len -+ - LLC_HEADER_SIZE -+ - ETH_TYPE_LEN -+ - PAYLOAD_TYPE_LEN -+ - FIXED_IE; -+ -+ _rtw_memcpy(&status_code, ptr + 2, 2); -+ -+ if (status_code != 0) { -+ RTW_INFO("[TDLS] %s status_code = %d, free_tdls_sta\n", __FUNCTION__, status_code); -+ free_tdls_sta(padapter, ptdls_sta); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ status_code = 0; -+ -+ /* parsing information element */ -+ for (j = FIXED_IE; j < parsing_length;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); -+ -+ switch (pIE->ElementID) { -+ case _SUPPORTEDRATES_IE_: -+ _rtw_memcpy(supportRate, pIE->data, pIE->Length); -+ supportRateNum = pIE->Length; -+ break; -+ case _COUNTRY_IE_: -+ break; -+ case _EXT_SUPPORTEDRATES_IE_: -+ if (supportRateNum <= sizeof(supportRate)) { -+ _rtw_memcpy(supportRate + supportRateNum, pIE->data, pIE->Length); -+ supportRateNum += pIE->Length; -+ } -+ break; -+ case _SUPPORTED_CH_IE_: -+ break; -+ case _RSN_IE_2_: -+ prsnie = (u8 *)pIE; -+ /* Check CCMP pairwise_cipher presence. */ -+ ppairwise_cipher = prsnie + 10; -+ _rtw_memcpy(&pairwise_count, (u16 *)(ppairwise_cipher - 2), 2); -+ for (k = 0; k < pairwise_count; k++) { -+ if (_rtw_memcmp(ppairwise_cipher + 4 * k, RSN_CIPHER_SUITE_CCMP, 4) == _TRUE) -+ verify_ccmp = 1; -+ } -+ case _EXT_CAP_IE_: -+ break; -+ case _VENDOR_SPECIFIC_IE_: -+ if (_rtw_memcmp((u8 *)pIE + 2, WMM_INFO_OUI, 6) == _TRUE) { -+ /* WMM Info ID and OUI */ -+ if ((pregistrypriv->wmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE)) -+ ptdls_sta->qos_option = _TRUE; -+ } -+ break; -+ case _FTIE_: -+ pftie = (u8 *)pIE; -+ _rtw_memcpy(ANonce, (ptr + j + 20), 32); -+ break; -+ case _TIMEOUT_ITVL_IE_: -+ ptimeout_ie = (u8 *)pIE; -+ timeout_interval = cpu_to_le32(*(u32 *)(ptimeout_ie + 3)); -+ break; -+ case _RIC_Descriptor_IE_: -+ break; -+#ifdef CONFIG_80211N_HT -+ case _HT_CAPABILITY_IE_: -+ rtw_tdls_process_ht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); -+ break; -+#endif -+#ifdef CONFIG_80211AC_VHT -+ case EID_AID: -+ /* todo in the future if necessary */ -+ break; -+ case EID_VHTCapability: -+ rtw_tdls_process_vht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); -+ break; -+ case EID_OpModeNotification: -+ rtw_process_vht_op_mode_notify(padapter, pIE->data, ptdls_sta); -+ break; -+#endif -+ case EID_BSSCoexistence: -+ break; -+ case _LINK_ID_IE_: -+ plinkid_ie = (u8 *)pIE; -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ ptdls_sta->bssratelen = supportRateNum; -+ _rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum); -+ _rtw_memcpy(ptdls_sta->ANonce, ANonce, 32); -+ -+#ifdef CONFIG_WFD -+ rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length); -+#endif -+ -+ if (status_code != _STATS_SUCCESSFUL_) -+ txmgmt.status_code = status_code; -+ else { -+ if (prx_pkt_attrib->encrypt) { -+ if (verify_ccmp == 1) { -+ txmgmt.status_code = _STATS_SUCCESSFUL_; -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { -+ wpa_tdls_generate_tpk(padapter, ptdls_sta); -+ if (tdls_verify_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie) == _FAIL) { -+ RTW_INFO("[TDLS] %s tdls_verify_mic fail, free_tdls_sta\n", __FUNCTION__); -+ free_tdls_sta(padapter, ptdls_sta); -+ ret = _FAIL; -+ goto exit; -+ } -+ ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; -+ } -+ } else -+ txmgmt.status_code = _STATS_INVALID_RSNIE_; -+ -+ } else -+ txmgmt.status_code = _STATS_SUCCESSFUL_; -+ } -+ -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { -+ _rtw_memcpy(txmgmt.peer, prx_pkt_attrib->src, ETH_ALEN); -+ issue_tdls_setup_cfm(padapter, &txmgmt); -+ -+ if (txmgmt.status_code == _STATS_SUCCESSFUL_) { -+ ptdlsinfo->link_established = _TRUE; -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) { -+ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; -+ ptdls_sta->state |= _FW_LINKED; -+ _cancel_timer_ex(&ptdls_sta->handshake_timer); -+ } -+ -+ if (prx_pkt_attrib->encrypt) -+ rtw_tdls_set_key(padapter, ptdls_sta); -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ESTABLISHED); -+ -+ } -+ } -+ -+exit: -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) -+ return ret; -+ else -+ return _SUCCESS; -+ -+} -+ -+int On_TDLS_Setup_Cfm(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_info *ptdls_sta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ _irqL irqL; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *psa; -+ u16 status_code = 0; -+ sint parsing_length; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 5; -+ u8 *pftie = NULL, *ptimeout_ie = NULL, *plinkid_ie = NULL, *prsnie = NULL, *pftie_mic = NULL, *ppairwise_cipher = NULL; -+ u16 j, pairwise_count; -+ int ret = _SUCCESS; -+ -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ if (ptdls_sta == NULL) { -+ RTW_INFO("[%s] Direct Link Peer = "MAC_FMT" not found\n", __FUNCTION__, MAC_ARG(psa)); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; -+ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len -+ - prx_pkt_attrib->hdrlen -+ - prx_pkt_attrib->iv_len -+ - prx_pkt_attrib->icv_len -+ - LLC_HEADER_SIZE -+ - ETH_TYPE_LEN -+ - PAYLOAD_TYPE_LEN -+ - FIXED_IE; -+ -+ _rtw_memcpy(&status_code, ptr + 2, 2); -+ -+ if (status_code != 0) { -+ RTW_INFO("[%s] status_code = %d\n, free_tdls_sta", __FUNCTION__, status_code); -+ free_tdls_sta(padapter, ptdls_sta); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* Parsing information element */ -+ for (j = FIXED_IE; j < parsing_length;) { -+ -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); -+ -+ switch (pIE->ElementID) { -+ case _RSN_IE_2_: -+ prsnie = (u8 *)pIE; -+ break; -+ case _VENDOR_SPECIFIC_IE_: -+ if (_rtw_memcmp((u8 *)pIE + 2, WMM_PARA_OUI, 6) == _TRUE) { -+ /* WMM Parameter ID and OUI */ -+ ptdls_sta->qos_option = _TRUE; -+ } -+ break; -+ case _FTIE_: -+ pftie = (u8 *)pIE; -+ break; -+ case _TIMEOUT_ITVL_IE_: -+ ptimeout_ie = (u8 *)pIE; -+ break; -+#ifdef CONFIG_80211N_HT -+ case _HT_EXTRA_INFO_IE_: -+ break; -+#endif -+#ifdef CONFIG_80211AC_VHT -+ case EID_VHTOperation: -+ break; -+ case EID_OpModeNotification: -+ rtw_process_vht_op_mode_notify(padapter, pIE->data, ptdls_sta); -+ break; -+#endif -+ case _LINK_ID_IE_: -+ plinkid_ie = (u8 *)pIE; -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ if (prx_pkt_attrib->encrypt) { -+ /* Verify mic in FTIE MIC field */ -+ if (rtw_tdls_is_driver_setup(padapter) && -+ (tdls_verify_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie) == _FAIL)) { -+ free_tdls_sta(padapter, ptdls_sta); -+ ret = _FAIL; -+ goto exit; -+ } -+ } -+ -+ if (rtw_tdls_is_driver_setup(padapter)) { -+ ptdlsinfo->link_established = _TRUE; -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) { -+ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; -+ ptdls_sta->state |= _FW_LINKED; -+ _cancel_timer_ex(&ptdls_sta->handshake_timer); -+ } -+ -+ if (prx_pkt_attrib->encrypt) { -+ rtw_tdls_set_key(padapter, ptdls_sta); -+ -+ /* Start TPK timer */ -+ ptdls_sta->TPK_count = 0; -+ _set_timer(&ptdls_sta->TPK_timer, ONE_SEC); -+ } -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ESTABLISHED); -+ } -+ -+exit: -+ return ret; -+ -+} -+ -+int On_TDLS_Dis_Req(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta_ap; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ sint parsing_length; /* Frame body length, without icv_len */ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 3, *dst; -+ u16 j; -+ struct tdls_txmgmt txmgmt; -+ int ret = _SUCCESS; -+ -+ if (rtw_tdls_is_driver_setup(padapter) == _FALSE) -+ goto exit; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; -+ txmgmt.dialog_token = *(ptr + 2); -+ _rtw_memcpy(&txmgmt.peer, precv_frame->u.hdr.attrib.src, ETH_ALEN); -+ txmgmt.action_code = TDLS_DISCOVERY_RESPONSE; -+ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len -+ - prx_pkt_attrib->hdrlen -+ - prx_pkt_attrib->iv_len -+ - prx_pkt_attrib->icv_len -+ - LLC_HEADER_SIZE -+ - ETH_TYPE_LEN -+ - PAYLOAD_TYPE_LEN -+ - FIXED_IE; -+ -+ /* Parsing information element */ -+ for (j = FIXED_IE; j < parsing_length;) { -+ -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); -+ -+ switch (pIE->ElementID) { -+ case _LINK_ID_IE_: -+ psta_ap = rtw_get_stainfo(pstapriv, pIE->data); -+ if (psta_ap == NULL) -+ goto exit; -+ dst = pIE->data + 12; -+ if (MacAddr_isBcst(dst) == _FALSE && (_rtw_memcmp(adapter_mac_addr(padapter), dst, 6) == _FALSE)) -+ goto exit; -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ issue_tdls_dis_rsp(padapter, &txmgmt, prx_pkt_attrib->privacy); -+ -+exit: -+ return ret; -+ -+} -+ -+int On_TDLS_Teardown(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ u8 *psa; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta = NULL; -+ _irqL irqL; -+ u8 reason; -+ -+ reason = *(ptr + prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN + 2); -+ RTW_INFO("[TDLS] %s Reason code(%d)\n", __FUNCTION__, reason); -+ -+ psa = get_sa(ptr); -+ -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ if (ptdls_sta != NULL) { -+ if (rtw_tdls_is_driver_setup(padapter)) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEARDOWN_STA_LOCALLY); -+ } -+ -+ return _SUCCESS; -+ -+} -+ -+#if 0 -+u8 TDLS_check_ch_state(uint state) -+{ -+ if (state & TDLS_CH_SWITCH_ON_STATE && -+ state & TDLS_PEER_AT_OFF_STATE) { -+ if (state & TDLS_PEER_SLEEP_STATE) -+ return 2; /* U-APSD + ch. switch */ -+ else -+ return 1; /* ch. switch */ -+ } else -+ return 0; -+} -+#endif -+ -+int On_TDLS_Peer_Traffic_Indication(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->src); -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct tdls_txmgmt txmgmt; -+ -+ ptr += pattrib->hdrlen + pattrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ -+ if (ptdls_sta != NULL) { -+ txmgmt.dialog_token = *(ptr + 2); -+ issue_tdls_peer_traffic_rsp(padapter, ptdls_sta, &txmgmt); -+ /* issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 0, 0); */ -+ } else { -+ RTW_INFO("from unknown sta:"MAC_FMT"\n", MAC_ARG(pattrib->src)); -+ return _FAIL; -+ } -+ -+ return _SUCCESS; -+} -+ -+/* We process buffered data for 1. U-APSD, 2. ch. switch, 3. U-APSD + ch. switch here */ -+int On_TDLS_Peer_Traffic_Rsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->src); -+ u8 wmmps_ac = 0; -+ /* u8 state=TDLS_check_ch_state(ptdls_sta->tdls_sta_state); */ -+ int i; -+ -+ ptdls_sta->sta_stats.rx_data_pkts++; -+ -+ ptdls_sta->tdls_sta_state &= ~(TDLS_WAIT_PTR_STATE); -+ -+ /* Check 4-AC queue bit */ -+ if (ptdls_sta->uapsd_vo || ptdls_sta->uapsd_vi || ptdls_sta->uapsd_be || ptdls_sta->uapsd_bk) -+ wmmps_ac = 1; -+ -+ /* If it's a direct link and have buffered frame */ -+ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { -+ if (wmmps_ac) { -+ _irqL irqL; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe = NULL; -+ -+ _enter_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&ptdls_sta->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ /* transmit buffered frames */ -+ while (rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist) == _FALSE) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ xmitframe_plist = get_next(xmitframe_plist); -+ rtw_list_delete(&pxmitframe->list); -+ -+ ptdls_sta->sleepq_len--; -+ ptdls_sta->sleepq_ac_len--; -+ if (ptdls_sta->sleepq_len > 0) { -+ pxmitframe->attrib.mdata = 1; -+ pxmitframe->attrib.eosp = 0; -+ } else { -+ pxmitframe->attrib.mdata = 0; -+ pxmitframe->attrib.eosp = 1; -+ } -+ pxmitframe->attrib.triggered = 1; -+ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ } -+ -+ if (ptdls_sta->sleepq_len == 0) -+ RTW_INFO("no buffered packets for tdls to xmit\n"); -+ else { -+ RTW_INFO("error!psta->sleepq_len=%d\n", ptdls_sta->sleepq_len); -+ ptdls_sta->sleepq_len = 0; -+ } -+ -+ _exit_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); -+ -+ } -+ -+ } -+ -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_TDLS_CH_SW -+sint On_TDLS_Ch_Switch_Req(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ struct sta_info *ptdls_sta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *psa; -+ sint parsing_length; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 4; -+ u16 j; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct tdls_txmgmt txmgmt; -+ u8 zaddr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ u16 switch_time = TDLS_CH_SWITCH_TIME * 1000, switch_timeout = TDLS_CH_SWITCH_TIMEOUT * 1000; -+ u8 take_care_iqk; -+ -+ if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) { -+ RTW_INFO("[TDLS] Ignore %s since channel switch is not allowed\n", __func__); -+ return _FAIL; -+ } -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ if (ptdls_sta == NULL) { -+ RTW_INFO("[%s] Direct Link Peer = "MAC_FMT" not found\n", __func__, MAC_ARG(psa)); -+ return _FAIL; -+ } -+ -+ ptdls_sta->ch_switch_time = switch_time; -+ ptdls_sta->ch_switch_timeout = switch_timeout; -+ -+ ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; -+ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len -+ - prx_pkt_attrib->hdrlen -+ - prx_pkt_attrib->iv_len -+ - prx_pkt_attrib->icv_len -+ - LLC_HEADER_SIZE -+ - ETH_TYPE_LEN -+ - PAYLOAD_TYPE_LEN -+ - FIXED_IE; -+ -+ pchsw_info->off_ch_num = *(ptr + 2); -+ -+ if ((*(ptr + 2) == 2) && (hal_is_band_support(padapter, BAND_ON_5G))) -+ pchsw_info->off_ch_num = 44; -+ -+ if (pchsw_info->off_ch_num != pmlmeext->cur_channel) -+ pchsw_info->delay_switch_back = _FALSE; -+ -+ /* Parsing information element */ -+ for (j = FIXED_IE; j < parsing_length;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); -+ -+ switch (pIE->ElementID) { -+ case EID_SecondaryChnlOffset: -+ switch (*(pIE->data)) { -+ case EXTCHNL_OFFSET_UPPER: -+ pchsw_info->ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case EXTCHNL_OFFSET_LOWER: -+ pchsw_info->ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ pchsw_info->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ break; -+ case _LINK_ID_IE_: -+ break; -+ case _CH_SWITCH_TIMING_: -+ ptdls_sta->ch_switch_time = (RTW_GET_LE16(pIE->data) >= TDLS_CH_SWITCH_TIME * 1000) ? -+ RTW_GET_LE16(pIE->data) : TDLS_CH_SWITCH_TIME * 1000; -+ ptdls_sta->ch_switch_timeout = (RTW_GET_LE16(pIE->data + 2) >= TDLS_CH_SWITCH_TIMEOUT * 1000) ? -+ RTW_GET_LE16(pIE->data + 2) : TDLS_CH_SWITCH_TIMEOUT * 1000; -+ RTW_INFO("[TDLS] %s ch_switch_time:%d, ch_switch_timeout:%d\n" -+ , __FUNCTION__, RTW_GET_LE16(pIE->data), RTW_GET_LE16(pIE->data + 2)); -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ } -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk); -+ if (take_care_iqk == _TRUE) { -+ u8 central_chnl; -+ u8 bw_mode; -+ -+ bw_mode = (pchsw_info->ch_offset) ? CHANNEL_WIDTH_40 : CHANNEL_WIDTH_20; -+ central_chnl = rtw_get_center_ch(pchsw_info->off_ch_num, bw_mode, pchsw_info->ch_offset); -+ if (rtw_hal_ch_sw_iqk_info_search(padapter, central_chnl, bw_mode) < 0) { -+ if (!(pchsw_info->ch_sw_state & TDLS_CH_SWITCH_PREPARE_STATE)) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_PREPARE); -+ -+ return _FAIL; -+ } -+ } -+ -+ /* cancel ch sw monitor timer for responder */ -+ if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) -+ _cancel_timer_ex(&ptdls_sta->ch_sw_monitor_timer); -+ -+ /* Todo: check status */ -+ txmgmt.status_code = 0; -+ _rtw_memcpy(txmgmt.peer, psa, ETH_ALEN); -+ -+ if (_rtw_memcmp(pchsw_info->addr, zaddr, ETH_ALEN) == _TRUE) -+ _rtw_memcpy(pchsw_info->addr, ptdls_sta->hwaddr, ETH_ALEN); -+ -+ if (ATOMIC_READ(&pchsw_info->chsw_on) == _FALSE) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_START); -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_RESP); -+ -+ return _SUCCESS; -+} -+ -+sint On_TDLS_Ch_Switch_Rsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ struct sta_info *ptdls_sta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *psa; -+ sint parsing_length; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 4; -+ u16 status_code, j, switch_time, switch_timeout; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ int ret = _SUCCESS; -+ -+ if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) { -+ RTW_INFO("[TDLS] Ignore %s since channel switch is not allowed\n", __func__); -+ return _SUCCESS; -+ } -+ -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ if (ptdls_sta == NULL) { -+ RTW_INFO("[%s] Direct Link Peer = "MAC_FMT" not found\n", __func__, MAC_ARG(psa)); -+ return _FAIL; -+ } -+ -+ /* If we receive Unsolicited TDLS Channel Switch Response when channel switch is running, */ -+ /* we will go back to base channel and terminate this channel switch procedure */ -+ if (ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) { -+ if (pmlmeext->cur_channel != rtw_get_oper_ch(padapter)) { -+ RTW_INFO("[TDLS] Rx unsolicited channel switch response\n"); -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_BASE_CHNL); -+ goto exit; -+ } -+ } -+ -+ ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; -+ parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len -+ - prx_pkt_attrib->hdrlen -+ - prx_pkt_attrib->iv_len -+ - prx_pkt_attrib->icv_len -+ - LLC_HEADER_SIZE -+ - ETH_TYPE_LEN -+ - PAYLOAD_TYPE_LEN -+ - FIXED_IE; -+ -+ _rtw_memcpy(&status_code, ptr + 2, 2); -+ -+ if (status_code != 0) { -+ RTW_INFO("[TDLS] %s status_code:%d\n", __func__, status_code); -+ pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE); -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* Parsing information element */ -+ for (j = FIXED_IE; j < parsing_length;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j); -+ -+ switch (pIE->ElementID) { -+ case _LINK_ID_IE_: -+ break; -+ case _CH_SWITCH_TIMING_: -+ _rtw_memcpy(&switch_time, pIE->data, 2); -+ if (switch_time > ptdls_sta->ch_switch_time) -+ _rtw_memcpy(&ptdls_sta->ch_switch_time, &switch_time, 2); -+ -+ _rtw_memcpy(&switch_timeout, pIE->data + 2, 2); -+ if (switch_timeout > ptdls_sta->ch_switch_timeout) -+ _rtw_memcpy(&ptdls_sta->ch_switch_timeout, &switch_timeout, 2); -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ } -+ -+ if ((pmlmeext->cur_channel == rtw_get_oper_ch(padapter)) && -+ (pchsw_info->ch_sw_state & TDLS_WAIT_CH_RSP_STATE)) { -+ if (ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_OFF_CHNL); -+ } -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_TDLS_CH_SW */ -+ -+#ifdef CONFIG_WFD -+void wfd_ie_tdls(_adapter *padapter, u8 *pframe, u32 *pktlen) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->tdlsinfo.wfd_info; -+ u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 wfdielen = 0; -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) -+ return; -+ -+ /* WFD OUI */ -+ wfdielen = 0; -+ wfdie[wfdielen++] = 0x50; -+ wfdie[wfdielen++] = 0x6F; -+ wfdie[wfdielen++] = 0x9A; -+ wfdie[wfdielen++] = 0x0A; /* WFA WFD v1.0 */ -+ -+ /* -+ * Commented by Albert 20110825 -+ * According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes -+ * 1. WFD Device Information -+ * 2. Associated BSSID ( Optional ) -+ * 3. Local IP Adress ( Optional ) -+ */ -+ -+ /* WFD Device Information ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value1: */ -+ /* WFD device information */ -+ /* available for WFD session + Preferred TDLS + WSD ( WFD Service Discovery ) */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL -+ | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_WSD); -+ wfdielen += 2; -+ -+ /* Value2: */ -+ /* Session Management Control Port */ -+ /* Default TCP port for RTSP messages is 554 */ -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->tdls_rtsp_ctrlport); -+ wfdielen += 2; -+ -+ /* Value3: */ -+ /* WFD Device Maximum Throughput */ -+ /* 300Mbps is the maximum throughput */ -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ /* Associated BSSID ATTR */ -+ /* Type: */ -+ wfdie[wfdielen++] = WFD_ATTR_ASSOC_BSSID; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ /* Value: */ -+ /* Associated BSSID */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ _rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[0], ETH_ALEN); -+ else -+ _rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN); -+ -+ /* Local IP Address ATTR */ -+ wfdie[wfdielen++] = WFD_ATTR_LOCAL_IP_ADDR; -+ -+ /* Length: */ -+ /* Note: In the WFD specification, the size of length field is 2. */ -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0005); -+ wfdielen += 2; -+ -+ /* Version: */ -+ /* 0x01: Version1;IPv4 */ -+ wfdie[wfdielen++] = 0x01; -+ -+ /* IPv4 Address */ -+ _rtw_memcpy(wfdie + wfdielen, pwfd_info->ip_address, 4); -+ wfdielen += 4; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, pktlen); -+ -+} -+#endif /* CONFIG_WFD */ -+ -+void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta = rtw_get_stainfo((&padapter->stapriv) , pattrib->dst); -+ -+ int i = 0 ; -+ u32 time; -+ u8 *pframe_head; -+ -+ /* SNonce */ -+ if (pattrib->encrypt) { -+ for (i = 0; i < 8; i++) { -+ time = rtw_get_current_time(); -+ _rtw_memcpy(&ptdls_sta->SNonce[4 * i], (u8 *)&time, 4); -+ } -+ } -+ -+ pframe_head = pframe; /* For rtw_tdls_set_ht_cap() */ -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ -+ pframe = rtw_tdls_set_capability(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_sup_ch(&(padapter->mlmeextpriv), pframe, pattrib); -+ pframe = rtw_tdls_set_sup_reg_class(pframe, pattrib); -+ -+ if (pattrib->encrypt) -+ pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta); -+ -+ pframe = rtw_tdls_set_ext_cap(pframe, pattrib); -+ -+ if (pattrib->encrypt) { -+ pframe = rtw_tdls_set_ftie(ptxmgmt -+ , pframe -+ , pattrib -+ , NULL -+ , ptdls_sta->SNonce); -+ -+ pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta); -+ } -+ -+#ifdef CONFIG_80211N_HT -+ /* Sup_reg_classes(optional) */ -+ if (pregistrypriv->ht_enable == _TRUE) -+ pframe = rtw_tdls_set_ht_cap(padapter, pframe_head, pattrib); -+#endif -+ -+ pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib); -+ -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+ if ((pregistrypriv->wmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE)) -+ pframe = rtw_tdls_set_qos_cap(pframe, pattrib); -+ -+#ifdef CONFIG_80211AC_VHT -+ if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) && (pmlmeext->cur_channel > 14) -+ && REGSTY_IS_11AC_ENABLE(pregistrypriv) -+ && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) -+ && (!padapter->mlmepriv.country_ent || COUNTRY_CHPLAN_EN_11AC(padapter->mlmepriv.country_ent)) -+ ) { -+ pframe = rtw_tdls_set_aid(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_vht_cap(padapter, pframe, pattrib); -+ } -+#endif -+ -+#ifdef CONFIG_WFD -+ if (padapter->wdinfo.wfd_tdls_enable == 1) -+ wfd_ie_tdls(padapter, pframe, &(pattrib->pktlen)); -+#endif -+ -+} -+ -+void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta; -+ u8 k; /* for random ANonce */ -+ u8 *pftie = NULL, *ptimeout_ie = NULL, *plinkid_ie = NULL, *prsnie = NULL, *pftie_mic = NULL; -+ u32 time; -+ u8 *pframe_head; -+ -+ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv) , pattrib->dst); -+ -+ if (ptdls_sta == NULL) -+ RTW_INFO("[%s] %d ptdls_sta is NULL\n", __FUNCTION__, __LINE__); -+ -+ if (pattrib->encrypt && ptdls_sta != NULL) { -+ for (k = 0; k < 8; k++) { -+ time = rtw_get_current_time(); -+ _rtw_memcpy(&ptdls_sta->ANonce[4 * k], (u8 *)&time, 4); -+ } -+ } -+ -+ pframe_head = pframe; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); -+ -+ if (ptxmgmt->status_code != 0) { -+ RTW_INFO("[%s] status_code:%04x\n", __FUNCTION__, ptxmgmt->status_code); -+ return; -+ } -+ -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_capability(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_sup_ch(&(padapter->mlmeextpriv), pframe, pattrib); -+ pframe = rtw_tdls_set_sup_reg_class(pframe, pattrib); -+ -+ if (pattrib->encrypt) { -+ prsnie = pframe; -+ pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _FALSE, ptdls_sta); -+ } -+ -+ pframe = rtw_tdls_set_ext_cap(pframe, pattrib); -+ -+ if (pattrib->encrypt) { -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) -+ wpa_tdls_generate_tpk(padapter, ptdls_sta); -+ -+ pftie = pframe; -+ pftie_mic = pframe + 4; -+ pframe = rtw_tdls_set_ftie(ptxmgmt -+ , pframe -+ , pattrib -+ , ptdls_sta->ANonce -+ , ptdls_sta->SNonce); -+ -+ ptimeout_ie = pframe; -+ pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _FALSE, ptdls_sta); -+ } -+ -+#ifdef CONFIG_80211N_HT -+ /* Sup_reg_classes(optional) */ -+ if (pregistrypriv->ht_enable == _TRUE) -+ pframe = rtw_tdls_set_ht_cap(padapter, pframe_head, pattrib); -+#endif -+ -+ pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib); -+ -+ plinkid_ie = pframe; -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ -+ /* Fill FTIE mic */ -+ if (pattrib->encrypt && rtw_tdls_is_driver_setup(padapter) == _TRUE) -+ wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic); -+ -+ if ((pregistrypriv->wmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE)) -+ pframe = rtw_tdls_set_qos_cap(pframe, pattrib); -+ -+#ifdef CONFIG_80211AC_VHT -+ if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) && (pmlmeext->cur_channel > 14) -+ && REGSTY_IS_11AC_ENABLE(pregistrypriv) -+ && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) -+ && (!padapter->mlmepriv.country_ent || COUNTRY_CHPLAN_EN_11AC(padapter->mlmepriv.country_ent)) -+ ) { -+ pframe = rtw_tdls_set_aid(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_vht_cap(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_vht_op_mode_notify(padapter, pframe, pattrib, pmlmeext->cur_bwmode); -+ } -+#endif -+ -+#ifdef CONFIG_WFD -+ if (padapter->wdinfo.wfd_tdls_enable) -+ wfd_ie_tdls(padapter, pframe, &(pattrib->pktlen)); -+#endif -+ -+} -+ -+void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta = rtw_get_stainfo((&padapter->stapriv) , pattrib->dst); -+ -+ unsigned int ie_len; -+ unsigned char *p; -+ u8 wmm_param_ele[24] = {0}; -+ u8 *pftie = NULL, *ptimeout_ie = NULL, *plinkid_ie = NULL, *prsnie = NULL, *pftie_mic = NULL; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ -+ if (ptxmgmt->status_code != 0) -+ return; -+ -+ if (pattrib->encrypt) { -+ prsnie = pframe; -+ pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta); -+ } -+ -+ if (pattrib->encrypt) { -+ pftie = pframe; -+ pftie_mic = pframe + 4; -+ pframe = rtw_tdls_set_ftie(ptxmgmt -+ , pframe -+ , pattrib -+ , ptdls_sta->ANonce -+ , ptdls_sta->SNonce); -+ -+ ptimeout_ie = pframe; -+ pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta); -+ -+ if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { -+ /* Start TPK timer */ -+ ptdls_sta->TPK_count = 0; -+ _set_timer(&ptdls_sta->TPK_timer, ONE_SEC); -+ } -+ } -+ -+ /* HT operation; todo */ -+ -+ plinkid_ie = pframe; -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+ if (pattrib->encrypt && (rtw_tdls_is_driver_setup(padapter) == _TRUE)) -+ wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic); -+ -+ if (ptdls_sta->qos_option == _TRUE) -+ pframe = rtw_tdls_set_wmm_params(padapter, pframe, pattrib); -+ -+#ifdef CONFIG_80211AC_VHT -+ if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) -+ && (ptdls_sta->vhtpriv.vht_option == _TRUE) && (pmlmeext->cur_channel > 14) -+ && REGSTY_IS_11AC_ENABLE(pregistrypriv) -+ && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) -+ && (!padapter->mlmepriv.country_ent || COUNTRY_CHPLAN_EN_11AC(padapter->mlmepriv.country_ent)) -+ ) { -+ pframe = rtw_tdls_set_vht_operation(padapter, pframe, pattrib, pmlmeext->cur_channel); -+ pframe = rtw_tdls_set_vht_op_mode_notify(padapter, pframe, pattrib, pmlmeext->cur_bwmode); -+ } -+#endif -+} -+ -+void rtw_build_tdls_teardown_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(&(padapter->stapriv) , pattrib->dst); -+ u8 *pftie = NULL, *pftie_mic = NULL, *plinkid_ie = NULL; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); -+ -+ if (pattrib->encrypt) { -+ pftie = pframe; -+ pftie_mic = pframe + 4; -+ pframe = rtw_tdls_set_ftie(ptxmgmt -+ , pframe -+ , pattrib -+ , ptdls_sta->ANonce -+ , ptdls_sta->SNonce); -+ } -+ -+ plinkid_ie = pframe; -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+ if (pattrib->encrypt && (rtw_tdls_is_driver_setup(padapter) == _TRUE)) -+ wpa_tdls_teardown_ftie_mic(ptdls_sta->tpk.kck, plinkid_ie, ptxmgmt->status_code, 1, 4, pftie, pftie_mic); -+} -+ -+void rtw_build_tdls_dis_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+} -+ -+void rtw_build_tdls_dis_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, u8 privacy) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 *pframe_head, pktlen_index; -+ -+ pktlen_index = pattrib->pktlen; -+ pframe_head = pframe; -+ -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_PUBLIC); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_capability(padapter, pframe, pattrib); -+ -+ pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib); -+ -+ pframe = rtw_tdls_set_sup_ch(pmlmeext, pframe, pattrib); -+ -+ if (privacy) -+ pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, NULL); -+ -+ pframe = rtw_tdls_set_ext_cap(pframe, pattrib); -+ -+ if (privacy) { -+ pframe = rtw_tdls_set_ftie(ptxmgmt, pframe, pattrib, NULL, NULL); -+ pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _TRUE, NULL); -+ } -+ -+#ifdef CONFIG_80211N_HT -+ if (pregistrypriv->ht_enable == _TRUE) -+ pframe = rtw_tdls_set_ht_cap(padapter, pframe_head - pktlen_index, pattrib); -+#endif -+ -+ pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ -+} -+ -+ -+void rtw_build_tdls_peer_traffic_indication_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 AC_queue = 0; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+ /* PTI control */ -+ /* PU buffer status */ -+ if (ptdls_sta->uapsd_bk & BIT(1)) -+ AC_queue = BIT(0); -+ if (ptdls_sta->uapsd_be & BIT(1)) -+ AC_queue = BIT(1); -+ if (ptdls_sta->uapsd_vi & BIT(1)) -+ AC_queue = BIT(2); -+ if (ptdls_sta->uapsd_vo & BIT(1)) -+ AC_queue = BIT(3); -+ pframe = rtw_set_ie(pframe, _PTI_BUFFER_STATUS_, 1, &AC_queue, &(pattrib->pktlen)); -+ -+} -+ -+void rtw_build_tdls_peer_traffic_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+} -+ -+#ifdef CONFIG_TDLS_CH_SW -+void rtw_build_tdls_ch_switch_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ u16 switch_time = TDLS_CH_SWITCH_TIME * 1000, switch_timeout = TDLS_CH_SWITCH_TIMEOUT * 1000; -+ -+ ptdls_sta->ch_switch_time = switch_time; -+ ptdls_sta->ch_switch_timeout = switch_timeout; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_target_ch(padapter, pframe, pattrib); -+ pframe = rtw_tdls_set_reg_class(pframe, pattrib, ptdls_sta); -+ -+ if (ptdlsinfo->chsw_info.ch_offset != HAL_PRIME_CHNL_OFFSET_DONT_CARE) { -+ switch (ptdlsinfo->chsw_info.ch_offset) { -+ case HAL_PRIME_CHNL_OFFSET_LOWER: -+ pframe = rtw_tdls_set_second_channel_offset(pframe, pattrib, SCA); -+ break; -+ case HAL_PRIME_CHNL_OFFSET_UPPER: -+ pframe = rtw_tdls_set_second_channel_offset(pframe, pattrib, SCB); -+ break; -+ } -+ } -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+ pframe = rtw_tdls_set_ch_sw(pframe, pattrib, ptdls_sta); -+ -+} -+ -+void rtw_build_tdls_ch_switch_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); -+ pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); -+ pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); -+ -+ if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); -+ else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) -+ pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); -+ -+ pframe = rtw_tdls_set_ch_sw(pframe, pattrib, ptdls_sta); -+} -+#endif -+ -+#ifdef CONFIG_WFD -+void rtw_build_tunneled_probe_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe) -+{ -+ u8 i; -+ _adapter *iface = NULL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct wifidirect_info *pwdinfo; -+ -+ u8 category = RTW_WLAN_CATEGORY_P2P; -+ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a}; -+ u8 probe_req = 4; -+ u8 wfdielen = 0; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 3, WFA_OUI, &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(probe_req), &(pattrib->pktlen)); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ pwdinfo = &iface->wdinfo; -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ wfdielen = build_probe_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+ } -+ } -+} -+ -+void rtw_build_tunneled_probe_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe) -+{ -+ u8 i; -+ _adapter *iface = NULL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct wifidirect_info *pwdinfo; -+ u8 category = RTW_WLAN_CATEGORY_P2P; -+ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a}; -+ u8 probe_rsp = 5; -+ u8 wfdielen = 0; -+ -+ pframe = rtw_tdls_set_payload_type(pframe, pattrib); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 3, WFA_OUI, &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(probe_rsp), &(pattrib->pktlen)); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ pwdinfo = &iface->wdinfo; -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ wfdielen = build_probe_resp_wfd_ie(pwdinfo, pframe, 1); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+ } -+ } -+} -+#endif /* CONFIG_WFD */ -+ -+void _tdls_tpk_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ struct tdls_txmgmt txmgmt; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ ptdls_sta->TPK_count++; -+ /* TPK_timer expired in a second */ -+ /* Retry timer should set at least 301 sec. */ -+ if (ptdls_sta->TPK_count >= (ptdls_sta->TDLS_PeerKey_Lifetime - 3)) { -+ RTW_INFO("[TDLS] %s, Re-Setup TDLS link with "MAC_FMT" since TPK lifetime expires!\n", __FUNCTION__, MAC_ARG(ptdls_sta->hwaddr)); -+ ptdls_sta->TPK_count = 0; -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); -+ issue_tdls_setup_req(ptdls_sta->padapter, &txmgmt, _FALSE); -+ } -+ -+ _set_timer(&ptdls_sta->TPK_timer, ONE_SEC); -+} -+ -+#ifdef CONFIG_TDLS_CH_SW -+void _tdls_ch_switch_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END_TO_BASE_CHNL); -+ RTW_INFO("[TDLS] %s, can't get traffic from op_ch:%d\n", __func__, rtw_get_oper_ch(padapter)); -+} -+ -+void _tdls_delay_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ -+ RTW_INFO("[TDLS] %s, op_ch:%d, tdls_state:0x%08x\n", __func__, rtw_get_oper_ch(padapter), ptdls_sta->tdls_sta_state); -+ pchsw_info->delay_switch_back = _TRUE; -+} -+ -+void _tdls_stay_on_base_chnl_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ -+ if (ptdls_sta != NULL) { -+ issue_tdls_ch_switch_req(padapter, ptdls_sta); -+ pchsw_info->ch_sw_state |= TDLS_WAIT_CH_RSP_STATE; -+ } -+} -+ -+void _tdls_ch_switch_monitor_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END); -+ RTW_INFO("[TDLS] %s, does not receive ch sw req\n", __func__); -+} -+ -+#endif -+ -+void _tdls_handshake_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ struct tdls_txmgmt txmgmt; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); -+ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; -+ -+ if (ptdls_sta != NULL) { -+ RTW_INFO("[TDLS] Handshake time out\n"); -+ if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEARDOWN_STA); -+ else -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEARDOWN_STA_LOCALLY); -+ } -+} -+ -+void _tdls_pti_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ struct tdls_txmgmt txmgmt; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); -+ txmgmt.status_code = _RSON_TDLS_TEAR_TOOFAR_; -+ -+ if (ptdls_sta != NULL) { -+ if (ptdls_sta->tdls_sta_state & TDLS_WAIT_PTR_STATE) { -+ RTW_INFO("[TDLS] Doesn't receive PTR from peer dev:"MAC_FMT"; " -+ "Send TDLS Tear Down\n", MAC_ARG(ptdls_sta->hwaddr)); -+ issue_tdls_teardown(padapter, &txmgmt, _FALSE); -+ } -+ } -+} -+ -+void rtw_init_tdls_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ psta->padapter = padapter; -+ _init_timer(&psta->TPK_timer, padapter->pnetdev, _tdls_tpk_timer_hdl, psta); -+#ifdef CONFIG_TDLS_CH_SW -+ _init_timer(&psta->ch_sw_timer, padapter->pnetdev, _tdls_ch_switch_timer_hdl, psta); -+ _init_timer(&psta->delay_timer, padapter->pnetdev, _tdls_delay_timer_hdl, psta); -+ _init_timer(&psta->stay_on_base_chnl_timer, padapter->pnetdev, _tdls_stay_on_base_chnl_timer_hdl, psta); -+ _init_timer(&psta->ch_sw_monitor_timer, padapter->pnetdev, _tdls_ch_switch_monitor_timer_hdl, psta); -+#endif -+ _init_timer(&psta->handshake_timer, padapter->pnetdev, _tdls_handshake_timer_hdl, psta); -+ _init_timer(&psta->pti_timer, padapter->pnetdev, _tdls_pti_timer_hdl, psta); -+} -+ -+void rtw_free_tdls_timer(struct sta_info *psta) -+{ -+ _cancel_timer_ex(&psta->TPK_timer); -+#ifdef CONFIG_TDLS_CH_SW -+ _cancel_timer_ex(&psta->ch_sw_timer); -+ _cancel_timer_ex(&psta->delay_timer); -+ _cancel_timer_ex(&psta->stay_on_base_chnl_timer); -+ _cancel_timer_ex(&psta->ch_sw_monitor_timer); -+#endif -+ _cancel_timer_ex(&psta->handshake_timer); -+ _cancel_timer_ex(&psta->pti_timer); -+} -+ -+u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta) -+{ -+ unsigned char sta_band = 0; -+ unsigned int tx_ra_bitmap = 0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ tx_ra_bitmap = psta->ra_mask; -+ -+ if (pcur_network->Configuration.DSConfig > 14) { -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_5N | WIRELESS_11A; -+ else -+ sta_band |= WIRELESS_11A; -+ } else { -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_24N | WIRELESS_11G | WIRELESS_11B; -+ else if (tx_ra_bitmap & 0xff0) -+ sta_band |= WIRELESS_11G | WIRELESS_11B; -+ else -+ sta_band |= WIRELESS_11B; -+ } -+ -+ psta->wireless_mode = sta_band; -+ -+ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); -+ tx_ra_bitmap |= ((psta->raid << 28) & 0xf0000000); -+ return tx_ra_bitmap; -+} -+ -+int rtw_tdls_is_driver_setup(_adapter *padapter) -+{ -+ return padapter->tdlsinfo.driver_setup; -+} -+ -+const char *rtw_tdls_action_txt(enum TDLS_ACTION_FIELD action) -+{ -+ switch (action) { -+ case TDLS_SETUP_REQUEST: -+ return "TDLS_SETUP_REQUEST"; -+ case TDLS_SETUP_RESPONSE: -+ return "TDLS_SETUP_RESPONSE"; -+ case TDLS_SETUP_CONFIRM: -+ return "TDLS_SETUP_CONFIRM"; -+ case TDLS_TEARDOWN: -+ return "TDLS_TEARDOWN"; -+ case TDLS_PEER_TRAFFIC_INDICATION: -+ return "TDLS_PEER_TRAFFIC_INDICATION"; -+ case TDLS_CHANNEL_SWITCH_REQUEST: -+ return "TDLS_CHANNEL_SWITCH_REQUEST"; -+ case TDLS_CHANNEL_SWITCH_RESPONSE: -+ return "TDLS_CHANNEL_SWITCH_RESPONSE"; -+ case TDLS_PEER_PSM_REQUEST: -+ return "TDLS_PEER_PSM_REQUEST"; -+ case TDLS_PEER_PSM_RESPONSE: -+ return "TDLS_PEER_PSM_RESPONSE"; -+ case TDLS_PEER_TRAFFIC_RESPONSE: -+ return "TDLS_PEER_TRAFFIC_RESPONSE"; -+ case TDLS_DISCOVERY_REQUEST: -+ return "TDLS_DISCOVERY_REQUEST"; -+ case TDLS_DISCOVERY_RESPONSE: -+ return "TDLS_DISCOVERY_RESPONSE"; -+ default: -+ return "UNKNOWN"; -+ } -+} -+ -+#endif /* CONFIG_TDLS */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_vht.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_vht.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_vht.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_vht.c 2018-02-11 21:44:27.142146010 +0200 -@@ -0,0 +1,857 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_VHT_C -+ -+#include -+ -+#ifdef CONFIG_80211AC_VHT -+/* 20/40/80, ShortGI, MCS Rate */ -+const u16 VHT_MCS_DATA_RATE[3][2][30] = { -+ { { -+ 13, 26, 39, 52, 78, 104, 117, 130, 156, 156, -+ 26, 52, 78, 104, 156, 208, 234, 260, 312, 312, -+ 39, 78, 117, 156, 234, 312, 351, 390, 468, 520 -+ }, /* Long GI, 20MHz */ -+ { -+ 14, 29, 43, 58, 87, 116, 130, 144, 173, 173, -+ 29, 58, 87, 116, 173, 231, 260, 289, 347, 347, -+ 43, 87, 130, 173, 260, 347, 390, 433, 520, 578 -+ } -+ }, /* Short GI, 20MHz */ -+ { { -+ 27, 54, 81, 108, 162, 216, 243, 270, 324, 360, -+ 54, 108, 162, 216, 324, 432, 486, 540, 648, 720, -+ 81, 162, 243, 324, 486, 648, 729, 810, 972, 1080 -+ }, /* Long GI, 40MHz */ -+ { -+ 30, 60, 90, 120, 180, 240, 270, 300, 360, 400, -+ 60, 120, 180, 240, 360, 480, 540, 600, 720, 800, -+ 90, 180, 270, 360, 540, 720, 810, 900, 1080, 1200 -+ } -+ }, /* Short GI, 40MHz */ -+ { { -+ 59, 117, 176, 234, 351, 468, 527, 585, 702, 780, -+ 117, 234, 351, 468, 702, 936, 1053, 1170, 1404, 1560, -+ 176, 351, 527, 702, 1053, 1404, 1580, 1755, 2106, 2340 -+ }, /* Long GI, 80MHz */ -+ { -+ 65, 130, 195, 260, 390, 520, 585, 650, 780, 867, -+ 130, 260, 390, 520, 780, 1040, 1170, 1300, 1560, 1734, -+ 195, 390, 585, 780, 1170, 1560, 1755, 1950, 2340, 2600 -+ } -+ } /* Short GI, 80MHz */ -+}; -+ -+u8 rtw_get_vht_highest_rate(u8 *pvht_mcs_map) -+{ -+ u8 i, j; -+ u8 bit_map; -+ u8 vht_mcs_rate = 0; -+ -+ for (i = 0; i < 2; i++) { -+ if (pvht_mcs_map[i] != 0xff) { -+ for (j = 0; j < 8; j += 2) { -+ bit_map = (pvht_mcs_map[i] >> j) & 3; -+ -+ if (bit_map != 3) -+ vht_mcs_rate = MGN_VHT1SS_MCS7 + 10 * j / 2 + i * 40 + bit_map; /* VHT rate indications begin from 0x90 */ -+ } -+ } -+ } -+ -+ /* RTW_INFO("HighestVHTMCSRate is %x\n", vht_mcs_rate); */ -+ return vht_mcs_rate; -+} -+ -+u8 rtw_vht_mcsmap_to_nss(u8 *pvht_mcs_map) -+{ -+ u8 i, j; -+ u8 bit_map; -+ u8 nss = 0; -+ -+ for (i = 0; i < 2; i++) { -+ if (pvht_mcs_map[i] != 0xff) { -+ for (j = 0; j < 8; j += 2) { -+ bit_map = (pvht_mcs_map[i] >> j) & 3; -+ -+ if (bit_map != 3) -+ nss++; -+ } -+ } -+ } -+ -+ /* RTW_INFO("%s : %dSS\n", __FUNCTION__, nss); */ -+ return nss; -+} -+ -+void rtw_vht_nss_to_mcsmap(u8 nss, u8 *target_mcs_map, u8 *cur_mcs_map) -+{ -+ u8 i, j; -+ u8 cur_rate, target_rate; -+ -+ for (i = 0; i < 2; i++) { -+ target_mcs_map[i] = 0; -+ for (j = 0; j < 8; j += 2) { -+ cur_rate = (cur_mcs_map[i] >> j) & 3; -+ if (cur_rate == 3) /* 0x3 indicates not supported that num of SS */ -+ target_rate = 3; -+ else if (nss <= ((j / 2) + i * 4)) -+ target_rate = 3; -+ else -+ target_rate = cur_rate; -+ -+ target_mcs_map[i] |= (target_rate << j); -+ } -+ } -+ -+ /* RTW_INFO("%s : %dSS\n", __FUNCTION__, nss); */ -+} -+ -+u16 rtw_vht_mcs_to_data_rate(u8 bw, u8 short_GI, u8 vht_mcs_rate) -+{ -+ if (vht_mcs_rate > MGN_VHT3SS_MCS9) -+ vht_mcs_rate = MGN_VHT3SS_MCS9; -+ /* RTW_INFO("bw=%d, short_GI=%d, ((vht_mcs_rate - MGN_VHT1SS_MCS0)&0x3f)=%d\n", bw, short_GI, ((vht_mcs_rate - MGN_VHT1SS_MCS0)&0x3f)); */ -+ return VHT_MCS_DATA_RATE[bw][short_GI][((vht_mcs_rate - MGN_VHT1SS_MCS0) & 0x3f)]; -+} -+ -+void rtw_vht_use_default_setting(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ BOOLEAN bHwLDPCSupport = _FALSE, bHwSTBCSupport = _FALSE; -+#ifdef CONFIG_BEAMFORMING -+ BOOLEAN bHwSupportBeamformer = _FALSE, bHwSupportBeamformee = _FALSE; -+ u8 mu_bfer, mu_bfee; -+#endif /* CONFIG_BEAMFORMING */ -+ u8 rf_type = 0; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ pvhtpriv->sgi_80m = TEST_FLAG(pregistrypriv->short_gi, BIT2) ? _TRUE : _FALSE; -+ -+ /* LDPC support */ -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_LDPC, (u8 *)&bHwLDPCSupport); -+ CLEAR_FLAGS(pvhtpriv->ldpc_cap); -+ if (bHwLDPCSupport) { -+ if (TEST_FLAG(pregistrypriv->ldpc_cap, BIT0)) -+ SET_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_RX); -+ } -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_LDPC, (u8 *)&bHwLDPCSupport); -+ if (bHwLDPCSupport) { -+ if (TEST_FLAG(pregistrypriv->ldpc_cap, BIT1)) -+ SET_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX); -+ } -+ if (pvhtpriv->ldpc_cap) -+ RTW_INFO("[VHT] Support LDPC = 0x%02X\n", pvhtpriv->ldpc_cap); -+ -+ /* STBC */ -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_STBC, (u8 *)&bHwSTBCSupport); -+ CLEAR_FLAGS(pvhtpriv->stbc_cap); -+ if (bHwSTBCSupport) { -+ if (TEST_FLAG(pregistrypriv->stbc_cap, BIT1)) -+ SET_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX); -+ } -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_STBC, (u8 *)&bHwSTBCSupport); -+ if (bHwSTBCSupport) { -+ if (TEST_FLAG(pregistrypriv->stbc_cap, BIT0)) -+ SET_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_RX); -+ } -+ if (pvhtpriv->stbc_cap) -+ RTW_INFO("[VHT] Support STBC = 0x%02X\n", pvhtpriv->stbc_cap); -+ -+ /* Beamforming setting */ -+ CLEAR_FLAGS(pvhtpriv->beamform_cap); -+#ifdef CONFIG_BEAMFORMING -+ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMER, (u8 *)&bHwSupportBeamformer); -+ rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMEE, (u8 *)&bHwSupportBeamformee); -+ mu_bfer = _FALSE; -+ mu_bfee = _FALSE; -+ rtw_hal_get_def_var(padapter, HAL_DEF_VHT_MU_BEAMFORMER, &mu_bfer); -+ rtw_hal_get_def_var(padapter, HAL_DEF_VHT_MU_BEAMFORMEE, &mu_bfee); -+ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT0) && bHwSupportBeamformer) { -+#ifdef CONFIG_CONCURRENT_MODE -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { -+ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ RTW_INFO("[VHT] CONCURRENT AP Support Beamformer\n"); -+ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT(2)) -+ && (_TRUE == mu_bfer)) { -+ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE); -+ RTW_INFO("[VHT] Support MU-MIMO AP\n"); -+ } -+ } else -+ RTW_INFO("[VHT] CONCURRENT not AP ;not allow Support Beamformer\n"); -+#else -+ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ RTW_INFO("[VHT] Support Beamformer\n"); -+ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT(2)) -+ && (_TRUE == mu_bfer) -+ && ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) { -+ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE); -+ RTW_INFO("[VHT] Support MU-MIMO AP\n"); -+ } -+#endif -+ } -+ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT1) && bHwSupportBeamformee) { -+ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); -+ RTW_INFO("[VHT] Support Beamformee\n"); -+ if (TEST_FLAG(pregistrypriv->beamform_cap, BIT(3)) -+ && (_TRUE == mu_bfee) -+ && ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE)) { -+ SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE); -+ RTW_INFO("[VHT] Support MU-MIMO STA\n"); -+ } -+ } -+#endif /* CONFIG_BEAMFORMING */ -+ -+ pvhtpriv->ampdu_len = pregistrypriv->ampdu_factor; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ if (rf_type == RF_3T3R) -+ pvhtpriv->vht_mcs_map[0] = 0xea; /* support 1SS MCS 0~9 2SS MCS 0~9 3SS MCS 0~9 */ -+ else if (rf_type == RF_2T2R) -+ pvhtpriv->vht_mcs_map[0] = 0xfa; /* support 1SS MCS 0~9 2SS MCS 0~9 */ -+ else -+ pvhtpriv->vht_mcs_map[0] = 0xfe; /* Only support 1SS MCS 0~9; */ -+ pvhtpriv->vht_mcs_map[1] = 0xff; -+ -+ if (pregistrypriv->vht_rate_sel == 1) { -+ pvhtpriv->vht_mcs_map[0] = 0xfc; /* support 1SS MCS 0~7 */ -+ } else if (pregistrypriv->vht_rate_sel == 2) { -+ pvhtpriv->vht_mcs_map[0] = 0xfd; /* Support 1SS MCS 0~8 */ -+ } else if (pregistrypriv->vht_rate_sel == 3) { -+ pvhtpriv->vht_mcs_map[0] = 0xfe; /* Support 1SS MCS 0~9 */ -+ } else if (pregistrypriv->vht_rate_sel == 4) { -+ pvhtpriv->vht_mcs_map[0] = 0xf0; /* support 1SS MCS 0~7 2SS MCS 0~7 */ -+ } else if (pregistrypriv->vht_rate_sel == 5) { -+ pvhtpriv->vht_mcs_map[0] = 0xf5; /* support 1SS MCS 0~8 2SS MCS 0~8 */ -+ } else if (pregistrypriv->vht_rate_sel == 6) { -+ pvhtpriv->vht_mcs_map[0] = 0xfa; /* support 1SS MCS 0~9 2SS MCS 0~9 */ -+ } else if (pregistrypriv->vht_rate_sel == 7) { -+ pvhtpriv->vht_mcs_map[0] = 0xf8; /* support 1SS MCS 0-7 2SS MCS 0~9 */ -+ } else if (pregistrypriv->vht_rate_sel == 8) { -+ pvhtpriv->vht_mcs_map[0] = 0xf9; /* support 1SS MCS 0-8 2SS MCS 0~9 */ -+ } else if (pregistrypriv->vht_rate_sel == 9) { -+ pvhtpriv->vht_mcs_map[0] = 0xf4; /* support 1SS MCS 0-7 2SS MCS 0~8 */ -+ } -+ -+ pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv->vht_mcs_map); -+} -+ -+u64 rtw_vht_rate_to_bitmap(u8 *pVHTRate) -+{ -+ -+ u8 i, j , tmpRate; -+ u64 RateBitmap = 0; -+ u8 Bits_3ss = 6; -+ -+ for (i = j = 0; i < Bits_3ss; i += 2, j += 10) { -+ /* every two bits means single sptial stream */ -+ tmpRate = (pVHTRate[0] >> i) & 3; -+ -+ switch (tmpRate) { -+ case 2: -+ RateBitmap = RateBitmap | (0x03ff << j); -+ break; -+ case 1: -+ RateBitmap = RateBitmap | (0x01ff << j); -+ break; -+ -+ case 0: -+ RateBitmap = RateBitmap | (0x00ff << j); -+ break; -+ -+ default: -+ break; -+ } -+ } -+ RTW_INFO("RateBitmap=%016llx , pVHTRate[0]=%02x, pVHTRate[1]=%02x\n", RateBitmap, pVHTRate[0], pVHTRate[1]); -+ return RateBitmap; -+} -+ -+void update_sta_vht_info_apmode(_adapter *padapter, PVOID sta) -+{ -+ struct sta_info *psta = (struct sta_info *)sta; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct vht_priv *pvhtpriv_ap = &pmlmepriv->vhtpriv; -+ struct vht_priv *pvhtpriv_sta = &psta->vhtpriv; -+ struct ht_priv *phtpriv_sta = &psta->htpriv; -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, bw_mode = 0; -+ u16 cur_beamform_cap = 0; -+ u8 *pcap_mcs; -+ -+ if (pvhtpriv_sta->vht_option == _FALSE) -+ return; -+ -+ bw_mode = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(&pvhtpriv_sta->vht_op_mode_notify); -+ -+ /* if (bw_mode > psta->bw_mode) */ -+ psta->bw_mode = bw_mode; -+ -+ /* B4 Rx LDPC */ -+ if (TEST_FLAG(pvhtpriv_ap->ldpc_cap, LDPC_VHT_ENABLE_TX) && -+ GET_VHT_CAPABILITY_ELE_RX_LDPC(pvhtpriv_sta->vht_cap)) { -+ SET_FLAG(cur_ldpc_cap, (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX)); -+ RTW_INFO("Current STA(%d) VHT LDPC = %02X\n", psta->aid, cur_ldpc_cap); -+ } -+ pvhtpriv_sta->ldpc_cap = cur_ldpc_cap; -+ -+ if (psta->bw_mode > pmlmeext->cur_bwmode) -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ -+ if (psta->bw_mode == CHANNEL_WIDTH_80) { -+ /* B5 Short GI for 80 MHz */ -+ pvhtpriv_sta->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi_80m) ? _TRUE : _FALSE; -+ /* RTW_INFO("Current STA ShortGI80MHz = %d\n", pvhtpriv_sta->sgi_80m); */ -+ } else if (psta->bw_mode >= CHANNEL_WIDTH_160) { -+ /* B5 Short GI for 80 MHz */ -+ pvhtpriv_sta->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI160M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi_80m) ? _TRUE : _FALSE; -+ /* RTW_INFO("Current STA ShortGI160MHz = %d\n", pvhtpriv_sta->sgi_80m); */ -+ } -+ -+ /* B8 B9 B10 Rx STBC */ -+ if (TEST_FLAG(pvhtpriv_ap->stbc_cap, STBC_VHT_ENABLE_TX) && -+ GET_VHT_CAPABILITY_ELE_RX_STBC(pvhtpriv_sta->vht_cap)) { -+ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); -+ RTW_INFO("Current STA(%d) VHT STBC = %02X\n", psta->aid, cur_stbc_cap); -+ } -+ pvhtpriv_sta->stbc_cap = cur_stbc_cap; -+ -+#ifdef CONFIG_BEAMFORMING -+ /* B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee */ -+ if (TEST_FLAG(pvhtpriv_ap->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && -+ GET_VHT_CAPABILITY_ELE_SU_BFEE(pvhtpriv_sta->vht_cap)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); -+ /*Shift to BEAMFORMING_VHT_BEAMFORMER_STS_CAP*/ -+ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFEE_STS_CAP(pvhtpriv_sta->vht_cap) << 8); -+ } -+ -+ /* B12 SU Beamformee Capable, the target supports Beamformee and we are Beamformer */ -+ if (TEST_FLAG(pvhtpriv_ap->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) && -+ GET_VHT_CAPABILITY_ELE_SU_BFER(pvhtpriv_sta->vht_cap)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ /*Shit to BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM*/ -+ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(pvhtpriv_sta->vht_cap) << 12); -+ } -+ pvhtpriv_sta->beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) -+ RTW_INFO("Current STA(%d) VHT Beamforming Setting = %02X\n", psta->aid, cur_beamform_cap); -+#endif -+ -+ /* B23 B24 B25 Maximum A-MPDU Length Exponent */ -+ pvhtpriv_sta->ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pvhtpriv_sta->vht_cap); -+ -+ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pvhtpriv_sta->vht_cap); -+ _rtw_memcpy(pvhtpriv_sta->vht_mcs_map, pcap_mcs, 2); -+ -+ pvhtpriv_sta->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv_sta->vht_mcs_map); -+ -+} -+ -+void update_hw_vht_param(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 ht_AMPDU_len; -+ -+ ht_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; -+ -+ if (pvhtpriv->ampdu_len > ht_AMPDU_len) -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&pvhtpriv->ampdu_len)); -+} -+ -+void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, rf_type = RF_1T1R; -+ u16 cur_beamform_cap = 0; -+ u8 *pcap_mcs; -+ u8 vht_mcs[2]; -+ -+ if (pIE == NULL) -+ return; -+ -+ if (pvhtpriv->vht_option == _FALSE) -+ return; -+ -+ pmlmeinfo->VHT_enable = 1; -+ -+ /* B4 Rx LDPC */ -+ if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX) && -+ GET_VHT_CAPABILITY_ELE_RX_LDPC(pIE->data)) { -+ SET_FLAG(cur_ldpc_cap, (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX)); -+ RTW_INFO("Current VHT LDPC Setting = %02X\n", cur_ldpc_cap); -+ } -+ pvhtpriv->ldpc_cap = cur_ldpc_cap; -+ -+ /* B5 Short GI for 80 MHz */ -+ pvhtpriv->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(pIE->data) & pvhtpriv->sgi_80m) ? _TRUE : _FALSE; -+ /* RTW_INFO("Current ShortGI80MHz = %d\n", pvhtpriv->sgi_80m); */ -+ -+ /* B8 B9 B10 Rx STBC */ -+ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX) && -+ GET_VHT_CAPABILITY_ELE_RX_STBC(pIE->data)) { -+ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); -+ RTW_INFO("Current VHT STBC Setting = %02X\n", cur_stbc_cap); -+ } -+ pvhtpriv->stbc_cap = cur_stbc_cap; -+#ifdef CONFIG_BEAMFORMING -+#ifdef RTW_BEAMFORMING_VERSION_2 -+ /* -+ * B11 SU Beamformer Capable, -+ * the target supports Beamformer and we are Beamformee -+ */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) -+ && GET_VHT_CAPABILITY_ELE_SU_BFER(pIE->data)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); -+ -+ /* Shift to BEAMFORMING_VHT_BEAMFORMEE_STS_CAP */ -+ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFEE_STS_CAP(pIE->data) << 8); -+ -+ /* -+ * B19 MU Beamformer Capable, -+ * the target supports Beamformer and we are Beamformee -+ */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE) -+ && GET_VHT_CAPABILITY_ELE_MU_BFER(pIE->data)) -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE); -+ } -+ -+ /* -+ * B12 SU Beamformee Capable, -+ * the target supports Beamformee and we are Beamformer -+ */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) -+ && GET_VHT_CAPABILITY_ELE_SU_BFEE(pIE->data)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ -+ /* Shit to BEAMFORMING_VHT_BEAMFORMER_SOUND_DIM */ -+ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(pIE->data) << 12); -+ -+ /* -+ * B20 MU Beamformee Capable, -+ * the target supports Beamformee and we are Beamformer -+ */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE) -+ && GET_VHT_CAPABILITY_ELE_MU_BFEE(pIE->data)) -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE); -+ } -+ -+ pvhtpriv->beamform_cap = cur_beamform_cap; -+ RTW_INFO("Current VHT Beamforming Setting=0x%04X\n", cur_beamform_cap); -+#else /* !RTW_BEAMFORMING_VERSION_2 */ -+ /* B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && -+ GET_VHT_CAPABILITY_ELE_SU_BFEE(pIE->data)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); -+ /*Shift to BEAMFORMING_VHT_BEAMFORMER_STS_CAP*/ -+ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFEE_STS_CAP(pIE->data) << 8); -+ } -+ -+ /* B12 SU Beamformee Capable, the target supports Beamformee and we are Beamformer */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) && -+ GET_VHT_CAPABILITY_ELE_SU_BFER(pIE->data)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ /*Shit to BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM*/ -+ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(pIE->data) << 12); -+ -+ } -+ pvhtpriv->beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) -+ RTW_INFO("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap); -+#endif /* !RTW_BEAMFORMING_VERSION_2 */ -+#endif /* CONFIG_BEAMFORMING */ -+ /* B23 B24 B25 Maximum A-MPDU Length Exponent */ -+ pvhtpriv->ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pIE->data); -+ -+ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pIE->data); -+ _rtw_memcpy(vht_mcs, pcap_mcs, 2); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if ((rf_type == RF_1T1R) || (rf_type == RF_1T2R)) -+ vht_mcs[0] |= 0xfc; -+ else if (rf_type == RF_2T2R) -+ vht_mcs[0] |= 0xf0; -+ else if (rf_type == RF_3T3R) -+ vht_mcs[0] |= 0xc0; -+ -+ _rtw_memcpy(pvhtpriv->vht_mcs_map, vht_mcs, 2); -+ -+ pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv->vht_mcs_map); -+} -+ -+void VHT_operation_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ -+ if (pIE == NULL) -+ return; -+ -+ if (pvhtpriv->vht_option == _FALSE) -+ return; -+} -+ -+void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, PVOID sta) -+{ -+ struct sta_info *psta = (struct sta_info *)sta; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct registry_priv *regsty = adapter_to_regsty(padapter); -+ u8 target_bw; -+ u8 target_rxss, current_rxss; -+ u8 update_ra = _FALSE; -+ u8 vht_mcs_map[2] = {}; -+ -+ if (pvhtpriv->vht_option == _FALSE) -+ return; -+ -+ target_bw = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(pframe); -+ target_rxss = (GET_VHT_OPERATING_MODE_FIELD_RX_NSS(pframe) + 1); -+ -+ if (target_bw != psta->bw_mode) { -+ if (hal_is_bw_support(padapter, target_bw) -+ && REGSTY_IS_BW_5G_SUPPORT(regsty, target_bw) -+ ) { -+ update_ra = _TRUE; -+ psta->bw_mode = target_bw; -+ } -+ } -+ -+ current_rxss = rtw_vht_mcsmap_to_nss(psta->vhtpriv.vht_mcs_map); -+ if (target_rxss != current_rxss) { -+ update_ra = _TRUE; -+ -+ rtw_vht_nss_to_mcsmap(target_rxss, vht_mcs_map, psta->vhtpriv.vht_mcs_map); -+ _rtw_memcpy(psta->vhtpriv.vht_mcs_map, vht_mcs_map, 2); -+ -+ rtw_hal_update_sta_rate_mask(padapter, psta); -+ } -+ -+ if (update_ra) -+ rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta); -+} -+ -+u32 rtw_build_vht_operation_ie(_adapter *padapter, u8 *pbuf, u8 channel) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ /* struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; */ -+ u8 ChnlWidth, center_freq, bw_mode, rf_type = 0; -+ u32 len = 0; -+ u8 operation[5]; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ _rtw_memset(operation, 0, 5); -+ -+ bw_mode = REGSTY_BW_5G(pregistrypriv); /* TODO: control op bw with other info */ -+ -+ if (hal_chk_bw_cap(padapter, BW_CAP_80M | BW_CAP_160M) -+ && REGSTY_BW_5G(pregistrypriv) >= CHANNEL_WIDTH_80 -+ ) { -+ center_freq = rtw_get_center_ch(channel, bw_mode, HAL_PRIME_CHNL_OFFSET_LOWER); -+ ChnlWidth = 1; -+ } else { -+ center_freq = 0; -+ ChnlWidth = 0; -+ } -+ -+ -+ SET_VHT_OPERATION_ELE_CHL_WIDTH(operation, ChnlWidth); -+ /* center frequency */ -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(operation, center_freq);/* Todo: need to set correct center channel */ -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(operation, 0); -+ -+ if (padapter->registrypriv.rf_config != RF_MAX_TYPE) -+ rf_type = padapter->registrypriv.rf_config; -+ -+ switch (rf_type) { -+ case RF_1T1R: -+ operation[3] = 0xfe; -+ operation[4] = 0xff; -+ break; -+ case RF_1T2R: -+ case RF_2T2R: -+ case RF_2T2R_GREEN: -+ operation[3] = 0xfa; -+ operation[4] = 0xff; -+ break; -+ case RF_2T3R: -+ case RF_2T4R: -+ case RF_3T3R: -+ case RF_3T4R: -+ operation[3] = 0xea; -+ operation[4] = 0xff; -+ break; -+ case RF_4T4R: -+ operation[3] = 0xaa; -+ operation[4] = 0xff; -+ break; -+ default: -+ RTW_INFO("%s, %d, unknown rf type\n", __func__, __LINE__); -+ } -+ -+ rtw_set_ie(pbuf, EID_VHTOperation, 5, operation, &len); -+ -+ return len; -+} -+ -+u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf, u8 bw) -+{ -+ /* struct registry_priv *pregistrypriv = &padapter->registrypriv; */ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ u32 len = 0; -+ u8 opmode = 0, rf_type = 0; -+ u8 chnl_width, rx_nss; -+ -+ chnl_width = bw; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if (rf_type == RF_3T3R) -+ rx_nss = 3; -+ else if (rf_type == RF_2T2R) -+ rx_nss = 2; -+ else -+ rx_nss = 1; -+ -+ SET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(&opmode, chnl_width); -+ SET_VHT_OPERATING_MODE_FIELD_RX_NSS(&opmode, (rx_nss - 1)); -+ SET_VHT_OPERATING_MODE_FIELD_RX_NSS_TYPE(&opmode, 0); /* Todo */ -+ -+ pvhtpriv->vht_op_mode_notify = opmode; -+ -+ pbuf = rtw_set_ie(pbuf, EID_OpModeNotification, 1, &opmode, &len); -+ -+ return len; -+} -+ -+u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf) -+{ -+ u8 bw, rf_type, rf_num, rx_stbc_nss = 0; -+ u16 HighestRate; -+ u8 *pcap, *pcap_mcs; -+ u32 len = 0; -+ u32 rx_packet_offset, max_recvbuf_sz; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ -+ pcap = pvhtpriv->vht_cap; -+ _rtw_memset(pcap, 0, 32); -+ -+ /* B0 B1 Maximum MPDU Length */ -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_PACKET_OFFSET, &rx_packet_offset); -+ rtw_hal_get_def_var(padapter, HAL_DEF_MAX_RECVBUF_SZ, &max_recvbuf_sz); -+ -+ RTW_DBG("%s, line%d, Available RX buf size = %d bytes\n.", __FUNCTION__, __LINE__, max_recvbuf_sz - rx_packet_offset); -+ -+ if ((max_recvbuf_sz - rx_packet_offset) >= 11454) { -+ SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(pcap, 2); -+ RTW_INFO("%s, line%d, Set MAX MPDU len = 11454 bytes\n.", __FUNCTION__, __LINE__); -+ } else if ((max_recvbuf_sz - rx_packet_offset) >= 7991) { -+ SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(pcap, 1); -+ RTW_INFO("%s, line%d, Set MAX MPDU len = 7991 bytes\n.", __FUNCTION__, __LINE__); -+ } else if ((max_recvbuf_sz - rx_packet_offset) >= 3895) { -+ SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(pcap, 0); -+ RTW_INFO("%s, line%d, Set MAX MPDU len = 3895 bytes\n.", __FUNCTION__, __LINE__); -+ } else -+ RTW_ERR("%s, line%d, Error!! Available RX buf size < 3895 bytes\n.", __FUNCTION__, __LINE__); -+ -+ /* B2 B3 Supported Channel Width Set */ -+ if (hal_chk_bw_cap(padapter, BW_CAP_160M) && REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_160)) { -+ if (hal_chk_bw_cap(padapter, BW_CAP_80_80M) && REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_80_80)) -+ SET_VHT_CAPABILITY_ELE_CHL_WIDTH(pcap, 2); -+ else -+ SET_VHT_CAPABILITY_ELE_CHL_WIDTH(pcap, 1); -+ } else -+ SET_VHT_CAPABILITY_ELE_CHL_WIDTH(pcap, 0); -+ -+ /* B4 Rx LDPC */ -+ if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_RX)) -+ SET_VHT_CAPABILITY_ELE_RX_LDPC(pcap, 1); -+ -+ /* B5 ShortGI for 80MHz */ -+ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(pcap, pvhtpriv->sgi_80m ? 1 : 0); /* We can receive Short GI of 80M */ -+ -+ /* B6 ShortGI for 160MHz */ -+ /* SET_VHT_CAPABILITY_ELE_SHORT_GI160M(pcap, pvhtpriv->sgi_80m? 1 : 0); */ -+ -+ /* B7 Tx STBC */ -+ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX)) -+ SET_VHT_CAPABILITY_ELE_TX_STBC(pcap, 1); -+ -+ /* B8 B9 B10 Rx STBC */ -+ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_RX)) { -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_STBC, (u8 *)(&rx_stbc_nss)); -+ -+ SET_VHT_CAPABILITY_ELE_RX_STBC(pcap, rx_stbc_nss); -+ } -+ -+ /* B11 SU Beamformer Capable */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { -+ SET_VHT_CAPABILITY_ELE_SU_BFER(pcap, 1); -+ /* B16 17 18 Number of Sounding Dimensions */ -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMER_CAP, (u8 *)&rf_num); -+ SET_VHT_CAPABILITY_ELE_SOUNDING_DIMENSIONS(pcap, rf_num); -+ /* B19 MU Beamformer Capable */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) -+ SET_VHT_CAPABILITY_ELE_MU_BFER(pcap, 1); -+ } -+ -+ /* B12 SU Beamformee Capable */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) { -+ SET_VHT_CAPABILITY_ELE_SU_BFEE(pcap, 1); -+ /* B13 14 15 Compressed Steering Number of Beamformer Antennas Supported */ -+ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); -+ SET_VHT_CAPABILITY_ELE_BFER_ANT_SUPP(pcap, rf_num); -+ /* B20 SU Beamformee Capable */ -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) -+ SET_VHT_CAPABILITY_ELE_MU_BFEE(pcap, 1); -+ } -+ -+ /* B21 VHT TXOP PS */ -+ SET_VHT_CAPABILITY_ELE_TXOP_PS(pcap, 0); -+ /* B22 +HTC-VHT Capable */ -+ SET_VHT_CAPABILITY_ELE_HTC_VHT(pcap, 1); -+ /* B23 24 25 Maximum A-MPDU Length Exponent */ -+ if (pregistrypriv->ampdu_factor != 0xFE) -+ SET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pcap, pregistrypriv->ampdu_factor); -+ else -+ SET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pcap, 7); -+ /* B26 27 VHT Link Adaptation Capable */ -+ SET_VHT_CAPABILITY_ELE_LINK_ADAPTION(pcap, 0); -+ -+ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pcap); -+ _rtw_memcpy(pcap_mcs, pvhtpriv->vht_mcs_map, 2); -+ -+ pcap_mcs = GET_VHT_CAPABILITY_ELE_TX_MCS(pcap); -+ _rtw_memcpy(pcap_mcs, pvhtpriv->vht_mcs_map, 2); -+ -+ /* find the largest bw supported by both registry and hal */ -+ bw = hal_largest_bw(padapter, REGSTY_BW_5G(pregistrypriv)); -+ -+ HighestRate = VHT_MCS_DATA_RATE[bw][pvhtpriv->sgi_80m][((pvhtpriv->vht_highest_rate - MGN_VHT1SS_MCS0) & 0x3f)]; -+ HighestRate = (HighestRate + 1) >> 1; -+ -+ SET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(pcap, HighestRate); /* indicate we support highest rx rate is 600Mbps. */ -+ SET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(pcap, HighestRate); /* indicate we support highest tx rate is 600Mbps. */ -+ -+ pbuf = rtw_set_ie(pbuf, EID_VHTCapability, 12, pcap, &len); -+ -+ return len; -+} -+ -+u32 rtw_restructure_vht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len) -+{ -+ u32 ielen = 0, out_len = 0; -+ u8 cap_len = 0, notify_len = 0, notify_bw = 0, operation_bw = 0, supported_chnl_width = 0; -+ u8 *p, *pframe; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ -+ rtw_vht_use_default_setting(padapter); -+ -+ p = rtw_get_ie(in_ie + 12, EID_VHTCapability, &ielen, in_len - 12); -+ if (p && ielen > 0) { -+ supported_chnl_width = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p + 2); -+ -+ /* VHT Capabilities element */ -+ cap_len = rtw_build_vht_cap_ie(padapter, out_ie + *pout_len); -+ *pout_len += cap_len; -+ -+ /* Get HT BW */ -+ p = rtw_get_ie(in_ie + 12, _HT_EXTRA_INFO_IE_, &ielen, in_len - 12); -+ if (p && ielen > 0) { -+ struct HT_info_element *pht_info = (struct HT_info_element *)(p + 2); -+ if (pht_info->infos[0] & BIT(2)) -+ operation_bw = CHANNEL_WIDTH_40; -+ else -+ operation_bw = CHANNEL_WIDTH_20; -+ } -+ -+ /* VHT Operation element */ -+ p = rtw_get_ie(in_ie + 12, EID_VHTOperation, &ielen, in_len - 12); -+ if (p && ielen > 0) { -+ out_len = *pout_len; -+ if (GET_VHT_OPERATION_ELE_CHL_WIDTH(p + 2) >= 1) { -+ if (supported_chnl_width == 2) -+ operation_bw = CHANNEL_WIDTH_80_80; -+ else if (supported_chnl_width == 1) -+ operation_bw = CHANNEL_WIDTH_160; -+ else -+ operation_bw = CHANNEL_WIDTH_80; -+ } -+ pframe = rtw_set_ie(out_ie + out_len, EID_VHTOperation, ielen, p + 2 , pout_len); -+ } -+ -+ /* find the largest bw supported by both registry and hal */ -+ notify_bw = hal_largest_bw(padapter, REGSTY_BW_5G(pregistrypriv)); -+ -+ if (notify_bw > operation_bw) -+ notify_bw = operation_bw; -+ -+ /* Operating Mode Notification element */ -+ notify_len = rtw_build_vht_op_mode_notify_ie(padapter, out_ie + *pout_len, notify_bw); -+ *pout_len += notify_len; -+ -+ pvhtpriv->vht_option = _TRUE; -+ } -+ -+ return pvhtpriv->vht_option; -+ -+} -+ -+void VHTOnAssocRsp(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 ht_AMPDU_len; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ if (!pmlmeinfo->HT_enable) -+ return; -+ -+ if (!pmlmeinfo->VHT_enable) -+ return; -+ -+ ht_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; -+ -+ if (pvhtpriv->ampdu_len > ht_AMPDU_len) -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&pvhtpriv->ampdu_len)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MAX_TIME, (u8 *)(&pvhtpriv->vht_highest_rate)); -+} -+ -+#endif /* CONFIG_80211AC_VHT */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_wapi.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_wapi.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_wapi.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_wapi.c 2018-02-11 21:44:27.142146010 +0200 -@@ -0,0 +1,1240 @@ -+#ifdef CONFIG_WAPI_SUPPORT -+ -+#include -+#include -+#include -+#include -+ -+ -+u32 wapi_debug_component = -+ /* WAPI_INIT | -+ * WAPI_API | -+ * WAPI_TX | -+ * WAPI_RX | */ -+ WAPI_ERR ; /* always open err flags on */ -+ -+void WapiFreeAllStaInfo(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo; -+ PRT_WAPI_STA_INFO pWapiStaInfo; -+ PRT_WAPI_BKID pWapiBkid; -+ -+ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); -+ pWapiInfo = &padapter->wapiInfo; -+ -+ /* Pust to Idle List */ -+ rtw_wapi_return_all_sta_info(padapter); -+ -+ /* Sta Info List */ -+ while (!list_empty(&(pWapiInfo->wapiSTAIdleList))) { -+ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAIdleList.next, RT_WAPI_STA_INFO, list); -+ list_del_init(&pWapiStaInfo->list); -+ } -+ -+ /* BKID List */ -+ while (!list_empty(&(pWapiInfo->wapiBKIDIdleList))) { -+ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDIdleList.next, RT_WAPI_BKID, list); -+ list_del_init(&pWapiBkid->list); -+ } -+ WAPI_TRACE(WAPI_INIT, "<=========== %s\n", __FUNCTION__); -+ return; -+} -+ -+void WapiSetIE(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ /* PRT_WAPI_BKID pWapiBkid; */ -+ u16 protocolVer = 1; -+ u16 akmCnt = 1; -+ u16 suiteCnt = 1; -+ u16 capability = 0; -+ u8 OUI[3]; -+ -+ OUI[0] = 0x00; -+ OUI[1] = 0x14; -+ OUI[2] = 0x72; -+ -+ pWapiInfo->wapiIELength = 0; -+ /* protocol version */ -+ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, &protocolVer, 2); -+ pWapiInfo->wapiIELength += 2; -+ /* akm */ -+ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, &akmCnt, 2); -+ pWapiInfo->wapiIELength += 2; -+ -+ if (pWapiInfo->bWapiPSK) { -+ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, OUI, 3); -+ pWapiInfo->wapiIELength += 3; -+ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x2; -+ pWapiInfo->wapiIELength += 1; -+ } else { -+ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, OUI, 3); -+ pWapiInfo->wapiIELength += 3; -+ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; -+ pWapiInfo->wapiIELength += 1; -+ } -+ -+ /* usk */ -+ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, &suiteCnt, 2); -+ pWapiInfo->wapiIELength += 2; -+ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, OUI, 3); -+ pWapiInfo->wapiIELength += 3; -+ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; -+ pWapiInfo->wapiIELength += 1; -+ -+ /* msk */ -+ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, OUI, 3); -+ pWapiInfo->wapiIELength += 3; -+ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; -+ pWapiInfo->wapiIELength += 1; -+ -+ /* Capbility */ -+ memcpy(pWapiInfo->wapiIE + pWapiInfo->wapiIELength, &capability, 2); -+ pWapiInfo->wapiIELength += 2; -+} -+ -+ -+/* PN1 > PN2, return 1, -+ * else return 0. -+ */ -+u32 WapiComparePN(u8 *PN1, u8 *PN2) -+{ -+ char i; -+ -+ if ((NULL == PN1) || (NULL == PN2)) -+ return 1; -+ -+ /* overflow case */ -+ if ((PN2[15] - PN1[15]) & 0x80) -+ return 1; -+ -+ for (i = 16; i > 0; i--) { -+ if (PN1[i - 1] == PN2[i - 1]) -+ continue; -+ else if (PN1[i - 1] > PN2[i - 1]) -+ return 1; -+ else -+ return 0; -+ } -+ -+ return 0; -+} -+ -+u8 -+WapiGetEntryForCamWrite(_adapter *padapter, u8 *pMacAddr, u8 KID, BOOLEAN IsMsk) -+{ -+ PRT_WAPI_T pWapiInfo = NULL; -+ /* PRT_WAPI_CAM_ENTRY pEntry=NULL; */ -+ u8 i = 0; -+ u8 ret = 0xff; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ /* exist? */ -+ for (i = 0; i < WAPI_CAM_ENTRY_NUM; i++) { -+ if (pWapiInfo->wapiCamEntry[i].IsUsed -+ && (_rtw_memcmp(pMacAddr, pWapiInfo->wapiCamEntry[i].PeerMacAddr, ETH_ALEN) == _TRUE) -+ && pWapiInfo->wapiCamEntry[i].keyidx == KID -+ && pWapiInfo->wapiCamEntry[i].type == IsMsk) { -+ ret = pWapiInfo->wapiCamEntry[i].entry_idx; /* cover it */ -+ break; -+ } -+ } -+ -+ if (i == WAPI_CAM_ENTRY_NUM) { /* not found */ -+ for (i = 0; i < WAPI_CAM_ENTRY_NUM; i++) { -+ if (pWapiInfo->wapiCamEntry[i].IsUsed == 0) { -+ pWapiInfo->wapiCamEntry[i].IsUsed = 1; -+ pWapiInfo->wapiCamEntry[i].type = IsMsk; -+ pWapiInfo->wapiCamEntry[i].keyidx = KID; -+ _rtw_memcpy(pWapiInfo->wapiCamEntry[i].PeerMacAddr, pMacAddr, ETH_ALEN); -+ ret = pWapiInfo->wapiCamEntry[i].entry_idx; -+ break; -+ } -+ } -+ } -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+ return ret; -+ -+ /* -+ if(RTIsListEmpty(&pWapiInfo->wapiCamIdleList)) { -+ return 0; -+ } -+ -+ pEntry = (PRT_WAPI_CAM_ENTRY)RTRemoveHeadList(&pWapiInfo->wapiCamIdleList); -+ RTInsertTailList(&pWapiInfo->wapiCamUsedList, &pEntry->list); -+ -+ -+ return pEntry->entry_idx;*/ -+} -+ -+u8 WapiGetEntryForCamClear(_adapter *padapter, u8 *pPeerMac, u8 keyid, u8 IsMsk) -+{ -+ PRT_WAPI_T pWapiInfo = NULL; -+ u8 i = 0; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ for (i = 0; i < WAPI_CAM_ENTRY_NUM; i++) { -+ if (pWapiInfo->wapiCamEntry[i].IsUsed -+ && (_rtw_memcmp(pPeerMac, pWapiInfo->wapiCamEntry[i].PeerMacAddr, ETH_ALEN) == _TRUE) -+ && pWapiInfo->wapiCamEntry[i].keyidx == keyid -+ && pWapiInfo->wapiCamEntry[i].type == IsMsk) { -+ pWapiInfo->wapiCamEntry[i].IsUsed = 0; -+ pWapiInfo->wapiCamEntry[i].keyidx = 2; -+ _rtw_memset(pWapiInfo->wapiCamEntry[i].PeerMacAddr, 0, ETH_ALEN); -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+ return pWapiInfo->wapiCamEntry[i].entry_idx; -+ } -+ } -+ -+ WAPI_TRACE(WAPI_API, "<====WapiGetReturnCamEntry(), No this cam entry.\n"); -+ return 0xff; -+ /* -+ if(RTIsListEmpty(&pWapiInfo->wapiCamUsedList)) { -+ return FALSE; -+ } -+ -+ pList = &pWapiInfo->wapiCamUsedList; -+ while(pList->Flink != &pWapiInfo->wapiCamUsedList) -+ { -+ pEntry = (PRT_WAPI_CAM_ENTRY)pList->Flink; -+ if(PlatformCompareMemory(pPeerMac,pEntry->PeerMacAddr, ETHER_ADDRLEN)== 0 -+ && keyid == pEntry->keyidx) -+ { -+ RTRemoveEntryList(pList); -+ RTInsertHeadList(&pWapiInfo->wapiCamIdleList, pList); -+ return pEntry->entry_idx; -+ } -+ pList = pList->Flink; -+ } -+ -+ return 0; -+ */ -+} -+ -+void -+WapiResetAllCamEntry(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo; -+ int i; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ for (i = 0; i < WAPI_CAM_ENTRY_NUM; i++) { -+ _rtw_memset(pWapiInfo->wapiCamEntry[i].PeerMacAddr, 0, ETH_ALEN); -+ pWapiInfo->wapiCamEntry[i].IsUsed = 0; -+ pWapiInfo->wapiCamEntry[i].keyidx = 2; /* invalid */ -+ pWapiInfo->wapiCamEntry[i].entry_idx = 4 + i * 2; -+ } -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+ -+ return; -+} -+ -+u8 WapiWriteOneCamEntry( -+ _adapter *padapter, -+ u8 *pMacAddr, -+ u8 KeyId, -+ u8 EntryId, -+ u8 EncAlg, -+ u8 bGroupKey, -+ u8 *pKey -+) -+{ -+ u8 retVal = 0; -+ u16 usConfig = 0; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ if (EntryId >= 32) { -+ WAPI_TRACE(WAPI_ERR, "<=== CamAddOneEntry(): ulKeyId exceed!\n"); -+ return retVal; -+ } -+ -+ usConfig = usConfig | (0x01 << 15) | ((u16)(EncAlg) << 2) | (KeyId); -+ -+ if (EncAlg == _SMS4_) { -+ if (bGroupKey == 1) -+ usConfig |= (0x01 << 6); -+ if ((EntryId % 2) == 1) /* ==0 sec key; == 1mic key */ -+ usConfig |= (0x01 << 5); -+ } -+ -+ write_cam(padapter, EntryId, usConfig, pMacAddr, pKey); -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ return 1; -+} -+ -+void rtw_wapi_init(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo; -+ int i; -+ -+ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); -+ RT_ASSERT_RET(padapter); -+ -+ if (!padapter->WapiSupport) { -+ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ pWapiInfo = &padapter->wapiInfo; -+ pWapiInfo->bWapiEnable = false; -+ -+ /* Init BKID List */ -+ INIT_LIST_HEAD(&pWapiInfo->wapiBKIDIdleList); -+ INIT_LIST_HEAD(&pWapiInfo->wapiBKIDStoreList); -+ for (i = 0; i < WAPI_MAX_BKID_NUM; i++) -+ list_add_tail(&pWapiInfo->wapiBKID[i].list, &pWapiInfo->wapiBKIDIdleList); -+ -+ /* Init STA List */ -+ INIT_LIST_HEAD(&pWapiInfo->wapiSTAIdleList); -+ INIT_LIST_HEAD(&pWapiInfo->wapiSTAUsedList); -+ for (i = 0; i < WAPI_MAX_STAINFO_NUM; i++) -+ list_add_tail(&pWapiInfo->wapiSta[i].list, &pWapiInfo->wapiSTAIdleList); -+ -+ for (i = 0; i < WAPI_CAM_ENTRY_NUM; i++) { -+ pWapiInfo->wapiCamEntry[i].IsUsed = 0; -+ pWapiInfo->wapiCamEntry[i].keyidx = 2; /* invalid */ -+ pWapiInfo->wapiCamEntry[i].entry_idx = 4 + i * 2; -+ } -+ -+ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_free(_adapter *padapter) -+{ -+ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); -+ RT_ASSERT_RET(padapter); -+ -+ if (!padapter->WapiSupport) { -+ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ WapiFreeAllStaInfo(padapter); -+ -+ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_disable_tx(_adapter *padapter) -+{ -+ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); -+ RT_ASSERT_RET(padapter); -+ -+ if (!padapter->WapiSupport) { -+ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ padapter->wapiInfo.wapiTxMsk.bTxEnable = false; -+ padapter->wapiInfo.wapiTxMsk.bSet = false; -+ -+ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); -+} -+ -+u8 rtw_wapi_is_wai_packet(_adapter *padapter, u8 *pkt_data) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ u8 WaiPkt = 0, *pTaddr, bFind = false; -+ u8 Offset_TypeWAI = 0 ; /* (mac header len + llc length) */ -+ -+ WAPI_TRACE(WAPI_TX | WAPI_RX, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return 0; -+ } -+ -+ Offset_TypeWAI = 24 + 6 ; -+ -+ /* YJ,add,091103. Data frame may also have skb->data[30]=0x88 and skb->data[31]=0xb4. */ -+ if ((pkt_data[1] & 0x40) != 0) { -+ /* RTW_INFO("data is privacy\n"); */ -+ return 0; -+ } -+ -+ pTaddr = GetAddr2Ptr(pkt_data); -+ if (list_empty(&pWapiInfo->wapiSTAUsedList)) -+ bFind = false; -+ else { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (_rtw_memcmp(pTaddr, pWapiSta->PeerMacAddr, 6) == _TRUE) { -+ bFind = true; -+ break; -+ } -+ } -+ } -+ -+ WAPI_TRACE(WAPI_TX | WAPI_RX, "%s: bFind=%d pTaddr="MAC_FMT"\n", __FUNCTION__, bFind, MAC_ARG(pTaddr)); -+ -+ if (pkt_data[0] == WIFI_QOS_DATA_TYPE) -+ Offset_TypeWAI += 2; -+ -+ /* 88b4? */ -+ if ((pkt_data[Offset_TypeWAI] == 0x88) && (pkt_data[Offset_TypeWAI + 1] == 0xb4)) { -+ WaiPkt = pkt_data[Offset_TypeWAI + 5]; -+ -+ psecuritypriv->hw_decrypted = _TRUE; -+ } else -+ WAPI_TRACE(WAPI_TX | WAPI_RX, "%s(): non wai packet\n", __FUNCTION__); -+ -+ WAPI_TRACE(WAPI_TX | WAPI_RX, "%s(): Recvd WAI frame. IsWAIPkt(%d)\n", __FUNCTION__, WaiPkt); -+ -+ return WaiPkt; -+} -+ -+ -+void rtw_wapi_update_info(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ struct recv_frame_hdr *precv_hdr; -+ u8 *ptr; -+ u8 *pTA; -+ u8 *pRecvPN; -+ -+ -+ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { -+ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ precv_hdr = &precv_frame->u.hdr; -+ ptr = precv_hdr->rx_data; -+ -+ if (precv_hdr->attrib.qos == 1) -+ precv_hdr->UserPriority = GetTid(ptr); -+ else -+ precv_hdr->UserPriority = 0; -+ -+ pTA = GetAddr2Ptr(ptr); -+ _rtw_memcpy((u8 *)precv_hdr->WapiSrcAddr, pTA, 6); -+ pRecvPN = ptr + precv_hdr->attrib.hdrlen + 2; -+ _rtw_memcpy((u8 *)precv_hdr->WapiTempPN, pRecvPN, 16); -+ -+ WAPI_TRACE(WAPI_RX, "<========== %s\n", __FUNCTION__); -+} -+ -+/**************************************************************************** -+TRUE-----------------Drop -+FALSE---------------- handle -+add to support WAPI to N-mode -+*****************************************************************************/ -+u8 rtw_wapi_check_for_drop( -+ _adapter *padapter, -+ union recv_frame *precv_frame -+) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ u8 *pLastRecvPN = NULL; -+ u8 bFind = false; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ u8 bDrop = false; -+ struct recv_frame_hdr *precv_hdr = &precv_frame->u.hdr; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ int i; -+ -+ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { -+ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return false; -+ } -+ -+ if (precv_hdr->bIsWaiPacket != 0) { -+ if (precv_hdr->bIsWaiPacket == 0x8) { -+ -+ RTW_INFO("rtw_wapi_check_for_drop: dump packet\n"); -+ for (i = 0; i < 50; i++) { -+ RTW_INFO("%02X ", ptr[i]); -+ if ((i + 1) % 8 == 0) -+ RTW_INFO("\n"); -+ } -+ RTW_INFO("\n rtw_wapi_check_for_drop: dump packet\n"); -+ -+ for (i = 0; i < 16; i++) { -+ if (ptr[i + 27] != 0) -+ break; -+ } -+ -+ if (i == 16) { -+ WAPI_TRACE(WAPI_RX, "rtw_wapi_check_for_drop: drop with zero BKID\n"); -+ return true; -+ } else -+ return false; -+ } else -+ return false; -+ } -+ -+ if (list_empty(&pWapiInfo->wapiSTAUsedList)) -+ bFind = false; -+ else { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (_rtw_memcmp(precv_hdr->WapiSrcAddr, pWapiSta->PeerMacAddr, ETH_ALEN) == _TRUE) { -+ bFind = true; -+ break; -+ } -+ } -+ } -+ WAPI_TRACE(WAPI_RX, "%s: bFind=%d prxb->WapiSrcAddr="MAC_FMT"\n", __FUNCTION__, bFind, MAC_ARG(precv_hdr->WapiSrcAddr)); -+ -+ if (bFind) { -+ if (IS_MCAST(precv_hdr->attrib.ra)) { -+ WAPI_TRACE(WAPI_RX, "rtw_wapi_check_for_drop: multicast case\n"); -+ pLastRecvPN = pWapiSta->lastRxMulticastPN; -+ } else { -+ WAPI_TRACE(WAPI_RX, "rtw_wapi_check_for_drop: unicast case\n"); -+ switch (precv_hdr->UserPriority) { -+ case 0: -+ case 3: -+ pLastRecvPN = pWapiSta->lastRxUnicastPNBEQueue; -+ break; -+ case 1: -+ case 2: -+ pLastRecvPN = pWapiSta->lastRxUnicastPNBKQueue; -+ break; -+ case 4: -+ case 5: -+ pLastRecvPN = pWapiSta->lastRxUnicastPNVIQueue; -+ break; -+ case 6: -+ case 7: -+ pLastRecvPN = pWapiSta->lastRxUnicastPNVOQueue; -+ break; -+ default: -+ WAPI_TRACE(WAPI_ERR, "%s: Unknown TID\n", __FUNCTION__); -+ break; -+ } -+ } -+ -+ if (!WapiComparePN(precv_hdr->WapiTempPN, pLastRecvPN)) { -+ WAPI_TRACE(WAPI_RX, "%s: Equal PN!!\n", __FUNCTION__); -+ if (IS_MCAST(precv_hdr->attrib.ra)) -+ _rtw_memcpy(pLastRecvPN, WapiAEMultiCastPNInitialValueSrc, 16); -+ else -+ _rtw_memcpy(pLastRecvPN, WapiAEPNInitialValueSrc, 16); -+ bDrop = true; -+ } else -+ _rtw_memcpy(pLastRecvPN, precv_hdr->WapiTempPN, 16); -+ } -+ -+ WAPI_TRACE(WAPI_RX, "<========== %s\n", __FUNCTION__); -+ return bDrop; -+} -+ -+void rtw_build_probe_resp_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ u8 WapiIELength = 0; -+ -+ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ WapiSetIE(padapter); -+ WapiIELength = pWapiInfo->wapiIELength; -+ pframe[0] = _WAPI_IE_; -+ pframe[1] = WapiIELength; -+ _rtw_memcpy(pframe + 2, pWapiInfo->wapiIE, WapiIELength); -+ pframe += WapiIELength + 2; -+ pattrib->pktlen += WapiIELength + 2; -+ -+ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_build_beacon_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ u8 WapiIELength = 0; -+ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ WapiSetIE(padapter); -+ WapiIELength = pWapiInfo->wapiIELength; -+ pframe[0] = _WAPI_IE_; -+ pframe[1] = WapiIELength; -+ _rtw_memcpy(pframe + 2, pWapiInfo->wapiIE, WapiIELength); -+ pframe += WapiIELength + 2; -+ pattrib->pktlen += WapiIELength + 2; -+ -+ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_build_assoc_req_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) -+{ -+ PRT_WAPI_BKID pWapiBKID; -+ u16 bkidNum; -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ u8 WapiIELength = 0; -+ -+ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ WapiSetIE(padapter); -+ WapiIELength = pWapiInfo->wapiIELength; -+ bkidNum = 0; -+ if (!list_empty(&(pWapiInfo->wapiBKIDStoreList))) { -+ list_for_each_entry(pWapiBKID, &pWapiInfo->wapiBKIDStoreList, list) { -+ bkidNum++; -+ _rtw_memcpy(pWapiInfo->wapiIE + WapiIELength + 2, pWapiBKID->bkid, 16); -+ WapiIELength += 16; -+ } -+ } -+ _rtw_memcpy(pWapiInfo->wapiIE + WapiIELength, &bkidNum, 2); -+ WapiIELength += 2; -+ -+ pframe[0] = _WAPI_IE_; -+ pframe[1] = WapiIELength; -+ _rtw_memcpy(pframe + 2, pWapiInfo->wapiIE, WapiIELength); -+ pframe += WapiIELength + 2; -+ pattrib->pktlen += WapiIELength + 2; -+ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_on_assoc_ok(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ PRT_WAPI_STA_INFO pWapiSta; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ /* u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; */ -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ -+ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ pWapiSta = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAIdleList.next, RT_WAPI_STA_INFO, list); -+ list_del_init(&pWapiSta->list); -+ list_add_tail(&pWapiSta->list, &pWapiInfo->wapiSTAUsedList); -+ _rtw_memcpy(pWapiSta->PeerMacAddr, padapter->mlmeextpriv.mlmext_info.network.MacAddress, 6); -+ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPN, WapiAEPNInitialValueSrc, 16); -+ -+ /* For chenk PN error with Qos Data after s3: add by ylb 20111114 */ -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiAEPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiAEPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiAEPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiAEPNInitialValueSrc, 16); -+ -+ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); -+} -+ -+ -+void rtw_wapi_return_one_sta_info(_adapter *padapter, u8 *MacAddr) -+{ -+ PRT_WAPI_T pWapiInfo; -+ PRT_WAPI_STA_INFO pWapiStaInfo = NULL; -+ PRT_WAPI_BKID pWapiBkid = NULL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ WAPI_TRACE(WAPI_API, "==========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ while (!list_empty(&(pWapiInfo->wapiBKIDStoreList))) { -+ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDStoreList.next, RT_WAPI_BKID, list); -+ list_del_init(&pWapiBkid->list); -+ _rtw_memset(pWapiBkid->bkid, 0, 16); -+ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDIdleList); -+ } -+ } -+ -+ -+ WAPI_TRACE(WAPI_API, " %s: after clear bkid\n", __FUNCTION__); -+ -+ -+ /* Remove STA info */ -+ if (list_empty(&(pWapiInfo->wapiSTAUsedList))) { -+ WAPI_TRACE(WAPI_API, " %s: wapiSTAUsedList is null\n", __FUNCTION__); -+ return; -+ } else { -+ -+ WAPI_TRACE(WAPI_API, " %s: wapiSTAUsedList is not null\n", __FUNCTION__); -+#if 0 -+ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry((pWapiInfo->wapiSTAUsedList.next), RT_WAPI_STA_INFO, list); -+ -+ list_for_each_entry(pWapiStaInfo, &(pWapiInfo->wapiSTAUsedList), list) { -+ -+ RTW_INFO("MAC Addr %02x-%02x-%02x-%02x-%02x-%02x\n", MacAddr[0], MacAddr[1], MacAddr[2], MacAddr[3], MacAddr[4], MacAddr[5]); -+ -+ -+ RTW_INFO("peer Addr %02x-%02x-%02x-%02x-%02x-%02x\n", pWapiStaInfo->PeerMacAddr[0], pWapiStaInfo->PeerMacAddr[1], pWapiStaInfo->PeerMacAddr[2], pWapiStaInfo->PeerMacAddr[3], -+ pWapiStaInfo->PeerMacAddr[4], pWapiStaInfo->PeerMacAddr[5]); -+ -+ if (pWapiStaInfo == NULL) { -+ WAPI_TRACE(WAPI_API, " %s: pWapiStaInfo == NULL Case\n", __FUNCTION__); -+ return; -+ } -+ -+ if (pWapiStaInfo->PeerMacAddr == NULL) { -+ WAPI_TRACE(WAPI_API, " %s: pWapiStaInfo->PeerMacAddr == NULL Case\n", __FUNCTION__); -+ return; -+ } -+ -+ if (MacAddr == NULL) { -+ WAPI_TRACE(WAPI_API, " %s: MacAddr == NULL Case\n", __FUNCTION__); -+ return; -+ } -+ -+ if (_rtw_memcmp(pWapiStaInfo->PeerMacAddr, MacAddr, ETH_ALEN) == _TRUE) { -+ pWapiStaInfo->bAuthenticateInProgress = false; -+ pWapiStaInfo->bSetkeyOk = false; -+ _rtw_memset(pWapiStaInfo->PeerMacAddr, 0, ETH_ALEN); -+ list_del_init(&pWapiStaInfo->list); -+ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); -+ break; -+ } -+ -+ } -+#endif -+ -+ while (!list_empty(&(pWapiInfo->wapiSTAUsedList))) { -+ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAUsedList.next, RT_WAPI_STA_INFO, list); -+ -+ RTW_INFO("peer Addr %02x-%02x-%02x-%02x-%02x-%02x\n", pWapiStaInfo->PeerMacAddr[0], pWapiStaInfo->PeerMacAddr[1], pWapiStaInfo->PeerMacAddr[2], pWapiStaInfo->PeerMacAddr[3], -+ pWapiStaInfo->PeerMacAddr[4], pWapiStaInfo->PeerMacAddr[5]); -+ -+ list_del_init(&pWapiStaInfo->list); -+ memset(pWapiStaInfo->PeerMacAddr, 0, ETH_ALEN); -+ pWapiStaInfo->bSetkeyOk = 0; -+ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); -+ } -+ -+ } -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+ return; -+} -+ -+void rtw_wapi_return_all_sta_info(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo; -+ PRT_WAPI_STA_INFO pWapiStaInfo; -+ PRT_WAPI_BKID pWapiBkid; -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ /* Sta Info List */ -+ while (!list_empty(&(pWapiInfo->wapiSTAUsedList))) { -+ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAUsedList.next, RT_WAPI_STA_INFO, list); -+ list_del_init(&pWapiStaInfo->list); -+ memset(pWapiStaInfo->PeerMacAddr, 0, ETH_ALEN); -+ pWapiStaInfo->bSetkeyOk = 0; -+ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); -+ } -+ -+ /* BKID List */ -+ while (!list_empty(&(pWapiInfo->wapiBKIDStoreList))) { -+ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDStoreList.next, RT_WAPI_BKID, list); -+ list_del_init(&pWapiBkid->list); -+ memset(pWapiBkid->bkid, 0, 16); -+ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDIdleList); -+ } -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_clear_cam_entry(_adapter *padapter, u8 *pMacAddr) -+{ -+ u8 UcIndex = 0; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 0, 0); -+ if (UcIndex != 0xff) { -+ /* CAM_mark_invalid(Adapter, UcIndex); */ -+ CAM_empty_entry(padapter, UcIndex); -+ } -+ -+ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 1, 0); -+ if (UcIndex != 0xff) { -+ /* CAM_mark_invalid(Adapter, UcIndex); */ -+ CAM_empty_entry(padapter, UcIndex); -+ } -+ -+ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 0, 1); -+ if (UcIndex != 0xff) { -+ /* CAM_mark_invalid(Adapter, UcIndex); */ -+ CAM_empty_entry(padapter, UcIndex); -+ } -+ -+ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 1, 1); -+ if (UcIndex != 0xff) { -+ /* CAM_mark_invalid(padapter, UcIndex); */ -+ CAM_empty_entry(padapter, UcIndex); -+ } -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_clear_all_cam_entry(_adapter *padapter) -+{ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ invalidate_cam_all(padapter); /* is this ok? */ -+ WapiResetAllCamEntry(padapter); -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_set_key(_adapter *padapter, RT_WAPI_KEY *pWapiKey, RT_WAPI_STA_INFO *pWapiSta, u8 bGroupKey, u8 bUseDefaultKey) -+{ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ u8 *pMacAddr = pWapiSta->PeerMacAddr; -+ u32 EntryId = 0; -+ BOOLEAN IsPairWise = false ; -+ u8 EncAlgo; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) { -+ WAPI_TRACE(WAPI_API, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ EncAlgo = _SMS4_; -+ -+ /* For Tx bc/mc pkt,use defualt key entry */ -+ if (bUseDefaultKey) { -+ /* when WAPI update key, keyid will be 0 or 1 by turns. */ -+ if (pWapiKey->keyId == 0) -+ EntryId = 0; -+ else -+ EntryId = 2; -+ } else { -+ /* tx/rx unicast pkt, or rx broadcast, find the key entry by peer's MacAddr */ -+ EntryId = WapiGetEntryForCamWrite(padapter, pMacAddr, pWapiKey->keyId, bGroupKey); -+ } -+ -+ if (EntryId == 0xff) { -+ WAPI_TRACE(WAPI_API, "===>No entry for WAPI setkey! !!\n"); -+ return; -+ } -+ -+ /* EntryId is also used to diff Sec key and Mic key */ -+ /* Sec Key */ -+ WapiWriteOneCamEntry(padapter, -+ pMacAddr, -+ pWapiKey->keyId, /* keyid */ -+ EntryId, /* entry */ -+ EncAlgo, /* type */ -+ bGroupKey, /* pairwise or group key */ -+ pWapiKey->dataKey); -+ /* MIC key */ -+ WapiWriteOneCamEntry(padapter, -+ pMacAddr, -+ pWapiKey->keyId, /* keyid */ -+ EntryId + 1, /* entry */ -+ EncAlgo, /* type */ -+ bGroupKey, /* pairwise or group key */ -+ pWapiKey->micKey); -+ -+ WAPI_TRACE(WAPI_API, "Set Wapi Key :KeyId:%d,EntryId:%d,PairwiseKey:%d.\n", pWapiKey->keyId, EntryId, !bGroupKey); -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+} -+ -+#if 0 -+/* YJ,test,091013 */ -+void wapi_test_set_key(struct _adapter *padapter, u8 *buf) -+{ -+ /*Data: keyType(1) + bTxEnable(1) + bAuthenticator(1) + bUpdate(1) + PeerAddr(6) + DataKey(16) + MicKey(16) + KeyId(1)*/ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_BKID pWapiBkid; -+ PRT_WAPI_STA_INFO pWapiSta; -+ u8 data[43]; -+ bool bTxEnable; -+ bool bUpdate; -+ bool bAuthenticator; -+ u8 PeerAddr[6]; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ u8 WapiASUEPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ -+ WAPI_TRACE(WAPI_INIT, "===========>%s\n", __FUNCTION__); -+ -+ if (!padapter->WapiSupport) -+ return; -+ -+ copy_from_user(data, buf, 43); -+ bTxEnable = data[1]; -+ bAuthenticator = data[2]; -+ bUpdate = data[3]; -+ memcpy(PeerAddr, data + 4, 6); -+ -+ if (data[0] == 0x3) { -+ if (!list_empty(&(pWapiInfo->wapiBKIDIdleList))) { -+ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDIdleList.next, RT_WAPI_BKID, list); -+ list_del_init(&pWapiBkid->list); -+ memcpy(pWapiBkid->bkid, data + 10, 16); -+ WAPI_DATA(WAPI_INIT, "SetKey - BKID", pWapiBkid->bkid, 16); -+ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDStoreList); -+ } -+ } else { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (!memcmp(pWapiSta->PeerMacAddr, PeerAddr, 6)) { -+ pWapiSta->bAuthenticatorInUpdata = false; -+ switch (data[0]) { -+ case 1: /* usk */ -+ if (bAuthenticator) { /* authenticator */ -+ memcpy(pWapiSta->lastTxUnicastPN, WapiAEPNInitialValueSrc, 16); -+ if (!bUpdate) { /* first */ -+ WAPI_TRACE(WAPI_INIT, "AE fisrt set usk\n"); -+ pWapiSta->wapiUsk.bSet = true; -+ memcpy(pWapiSta->wapiUsk.dataKey, data + 10, 16); -+ memcpy(pWapiSta->wapiUsk.micKey, data + 26, 16); -+ pWapiSta->wapiUsk.keyId = *(data + 42); -+ pWapiSta->wapiUsk.bTxEnable = true; -+ WAPI_DATA(WAPI_INIT, "SetKey - AE USK Data Key", pWapiSta->wapiUsk.dataKey, 16); -+ WAPI_DATA(WAPI_INIT, "SetKey - AE USK Mic Key", pWapiSta->wapiUsk.micKey, 16); -+ } else { /* update */ -+ WAPI_TRACE(WAPI_INIT, "AE update usk\n"); -+ pWapiSta->wapiUskUpdate.bSet = true; -+ pWapiSta->bAuthenticatorInUpdata = true; -+ memcpy(pWapiSta->wapiUskUpdate.dataKey, data + 10, 16); -+ memcpy(pWapiSta->wapiUskUpdate.micKey, data + 26, 16); -+ memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiASUEPNInitialValueSrc, 16); -+ memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiASUEPNInitialValueSrc, 16); -+ memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiASUEPNInitialValueSrc, 16); -+ memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiASUEPNInitialValueSrc, 16); -+ memcpy(pWapiSta->lastRxUnicastPN, WapiASUEPNInitialValueSrc, 16); -+ pWapiSta->wapiUskUpdate.keyId = *(data + 42); -+ pWapiSta->wapiUskUpdate.bTxEnable = true; -+ } -+ } else { -+ if (!bUpdate) { -+ WAPI_TRACE(WAPI_INIT, "ASUE fisrt set usk\n"); -+ if (bTxEnable) { -+ pWapiSta->wapiUsk.bTxEnable = true; -+ memcpy(pWapiSta->lastTxUnicastPN, WapiASUEPNInitialValueSrc, 16); -+ } else { -+ pWapiSta->wapiUsk.bSet = true; -+ memcpy(pWapiSta->wapiUsk.dataKey, data + 10, 16); -+ memcpy(pWapiSta->wapiUsk.micKey, data + 26, 16); -+ pWapiSta->wapiUsk.keyId = *(data + 42); -+ pWapiSta->wapiUsk.bTxEnable = false; -+ } -+ } else { -+ WAPI_TRACE(WAPI_INIT, "ASUE update usk\n"); -+ if (bTxEnable) { -+ pWapiSta->wapiUskUpdate.bTxEnable = true; -+ if (pWapiSta->wapiUskUpdate.bSet) { -+ memcpy(pWapiSta->wapiUsk.dataKey, pWapiSta->wapiUskUpdate.dataKey, 16); -+ memcpy(pWapiSta->wapiUsk.micKey, pWapiSta->wapiUskUpdate.micKey, 16); -+ pWapiSta->wapiUsk.keyId = pWapiSta->wapiUskUpdate.keyId; -+ memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiASUEPNInitialValueSrc, 16); -+ memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiASUEPNInitialValueSrc, 16); -+ memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiASUEPNInitialValueSrc, 16); -+ memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiASUEPNInitialValueSrc, 16); -+ memcpy(pWapiSta->lastRxUnicastPN, WapiASUEPNInitialValueSrc, 16); -+ pWapiSta->wapiUskUpdate.bTxEnable = false; -+ pWapiSta->wapiUskUpdate.bSet = false; -+ } -+ memcpy(pWapiSta->lastTxUnicastPN, WapiASUEPNInitialValueSrc, 16); -+ } else { -+ pWapiSta->wapiUskUpdate.bSet = true; -+ memcpy(pWapiSta->wapiUskUpdate.dataKey, data + 10, 16); -+ memcpy(pWapiSta->wapiUskUpdate.micKey, data + 26, 16); -+ pWapiSta->wapiUskUpdate.keyId = *(data + 42); -+ pWapiSta->wapiUskUpdate.bTxEnable = false; -+ } -+ } -+ } -+ break; -+ case 2: /* msk */ -+ if (bAuthenticator) { /* authenticator */ -+ pWapiInfo->wapiTxMsk.bSet = true; -+ memcpy(pWapiInfo->wapiTxMsk.dataKey, data + 10, 16); -+ memcpy(pWapiInfo->wapiTxMsk.micKey, data + 26, 16); -+ pWapiInfo->wapiTxMsk.keyId = *(data + 42); -+ pWapiInfo->wapiTxMsk.bTxEnable = true; -+ memcpy(pWapiInfo->lastTxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); -+ -+ if (!bUpdate) { /* first */ -+ WAPI_TRACE(WAPI_INIT, "AE fisrt set msk\n"); -+ if (!pWapiSta->bSetkeyOk) -+ pWapiSta->bSetkeyOk = true; -+ pWapiInfo->bFirstAuthentiateInProgress = false; -+ } else /* update */ -+ WAPI_TRACE(WAPI_INIT, "AE update msk\n"); -+ -+ WAPI_DATA(WAPI_INIT, "SetKey - AE MSK Data Key", pWapiInfo->wapiTxMsk.dataKey, 16); -+ WAPI_DATA(WAPI_INIT, "SetKey - AE MSK Mic Key", pWapiInfo->wapiTxMsk.micKey, 16); -+ } else { -+ if (!bUpdate) { -+ WAPI_TRACE(WAPI_INIT, "ASUE fisrt set msk\n"); -+ pWapiSta->wapiMsk.bSet = true; -+ memcpy(pWapiSta->wapiMsk.dataKey, data + 10, 16); -+ memcpy(pWapiSta->wapiMsk.micKey, data + 26, 16); -+ pWapiSta->wapiMsk.keyId = *(data + 42); -+ pWapiSta->wapiMsk.bTxEnable = false; -+ if (!pWapiSta->bSetkeyOk) -+ pWapiSta->bSetkeyOk = true; -+ pWapiInfo->bFirstAuthentiateInProgress = false; -+ WAPI_DATA(WAPI_INIT, "SetKey - ASUE MSK Data Key", pWapiSta->wapiMsk.dataKey, 16); -+ WAPI_DATA(WAPI_INIT, "SetKey - ASUE MSK Mic Key", pWapiSta->wapiMsk.micKey, 16); -+ } else { -+ WAPI_TRACE(WAPI_INIT, "ASUE update msk\n"); -+ pWapiSta->wapiMskUpdate.bSet = true; -+ memcpy(pWapiSta->wapiMskUpdate.dataKey, data + 10, 16); -+ memcpy(pWapiSta->wapiMskUpdate.micKey, data + 26, 16); -+ pWapiSta->wapiMskUpdate.keyId = *(data + 42); -+ pWapiSta->wapiMskUpdate.bTxEnable = false; -+ } -+ } -+ break; -+ default: -+ WAPI_TRACE(WAPI_ERR, "Unknown Flag\n"); -+ break; -+ } -+ } -+ } -+ } -+ WAPI_TRACE(WAPI_INIT, "<===========%s\n", __FUNCTION__); -+} -+ -+ -+void wapi_test_init(struct _adapter *padapter) -+{ -+ u8 keybuf[100]; -+ u8 mac_addr[6] = {0x00, 0xe0, 0x4c, 0x72, 0x04, 0x70}; -+ u8 UskDataKey[16] = {0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f}; -+ u8 UskMicKey[16] = {0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19, 0x1a, 0x1b, 0x1c, 0x1d, 0x1e, 0x1f}; -+ u8 UskId = 0; -+ u8 MskDataKey[16] = {0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x27, 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, 0x2e, 0x2f}; -+ u8 MskMicKey[16] = {0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x3a, 0x3b, 0x3c, 0x3d, 0x3e, 0x3f}; -+ u8 MskId = 0; -+ -+ WAPI_TRACE(WAPI_INIT, "===========>%s\n", __FUNCTION__); -+ -+ /* Enable Wapi */ -+ WAPI_TRACE(WAPI_INIT, "%s: Enable wapi!!!!\n", __FUNCTION__); -+ padapter->wapiInfo.bWapiEnable = true; -+ padapter->pairwise_key_type = KEY_TYPE_SMS4; -+ ieee->group_key_type = KEY_TYPE_SMS4; -+ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; -+ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; -+ -+ /* set usk */ -+ WAPI_TRACE(WAPI_INIT, "%s: Set USK!!!!\n", __FUNCTION__); -+ memset(keybuf, 0, 100); -+ keybuf[0] = 1; /* set usk */ -+ keybuf[1] = 1; /* enable tx */ -+ keybuf[2] = 1; /* AE */ -+ keybuf[3] = 0; /* not update */ -+ -+ memcpy(keybuf + 4, mac_addr, 6); -+ memcpy(keybuf + 10, UskDataKey, 16); -+ memcpy(keybuf + 26, UskMicKey, 16); -+ keybuf[42] = UskId; -+ wapi_test_set_key(padapter, keybuf); -+ -+ memset(keybuf, 0, 100); -+ keybuf[0] = 1; /* set usk */ -+ keybuf[1] = 1; /* enable tx */ -+ keybuf[2] = 0; /* AE */ -+ keybuf[3] = 0; /* not update */ -+ -+ memcpy(keybuf + 4, mac_addr, 6); -+ memcpy(keybuf + 10, UskDataKey, 16); -+ memcpy(keybuf + 26, UskMicKey, 16); -+ keybuf[42] = UskId; -+ wapi_test_set_key(padapter, keybuf); -+ -+ /* set msk */ -+ WAPI_TRACE(WAPI_INIT, "%s: Set MSK!!!!\n", __FUNCTION__); -+ memset(keybuf, 0, 100); -+ keybuf[0] = 2; /* set msk */ -+ keybuf[1] = 1; /* Enable TX */ -+ keybuf[2] = 1; /* AE */ -+ keybuf[3] = 0; /* not update */ -+ memcpy(keybuf + 4, mac_addr, 6); -+ memcpy(keybuf + 10, MskDataKey, 16); -+ memcpy(keybuf + 26, MskMicKey, 16); -+ keybuf[42] = MskId; -+ wapi_test_set_key(padapter, keybuf); -+ -+ memset(keybuf, 0, 100); -+ keybuf[0] = 2; /* set msk */ -+ keybuf[1] = 1; /* Enable TX */ -+ keybuf[2] = 0; /* AE */ -+ keybuf[3] = 0; /* not update */ -+ memcpy(keybuf + 4, mac_addr, 6); -+ memcpy(keybuf + 10, MskDataKey, 16); -+ memcpy(keybuf + 26, MskMicKey, 16); -+ keybuf[42] = MskId; -+ wapi_test_set_key(padapter, keybuf); -+ WAPI_TRACE(WAPI_INIT, "<===========%s\n", __FUNCTION__); -+} -+#endif -+ -+void rtw_wapi_get_iv(_adapter *padapter, u8 *pRA, u8 *IV) -+{ -+ PWLAN_HEADER_WAPI_EXTENSION pWapiExt = NULL; -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ bool bPNOverflow = false; -+ bool bFindMatchPeer = false; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ -+ pWapiExt = (PWLAN_HEADER_WAPI_EXTENSION)IV; -+ -+ WAPI_DATA(WAPI_RX, "wapi_get_iv: pra", pRA, 6); -+ -+ if (IS_MCAST(pRA)) { -+ if (!pWapiInfo->wapiTxMsk.bTxEnable) { -+ WAPI_TRACE(WAPI_ERR, "%s: bTxEnable = 0!!\n", __FUNCTION__); -+ return; -+ } -+ -+ if (pWapiInfo->wapiTxMsk.keyId <= 1) { -+ pWapiExt->KeyIdx = pWapiInfo->wapiTxMsk.keyId; -+ pWapiExt->Reserved = 0; -+ bPNOverflow = WapiIncreasePN(pWapiInfo->lastTxMulticastPN, 1); -+ memcpy(pWapiExt->PN, pWapiInfo->lastTxMulticastPN, 16); -+ } -+ } else { -+ if (list_empty(&pWapiInfo->wapiSTAUsedList)) { -+ WAPI_TRACE(WAPI_RX, "rtw_wapi_get_iv: list is empty\n"); -+ _rtw_memset(IV, 10, 18); -+ return; -+ } else { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ WAPI_DATA(WAPI_RX, "rtw_wapi_get_iv: peermacaddr ", pWapiSta->PeerMacAddr, 6); -+ if (_rtw_memcmp((u8 *)pWapiSta->PeerMacAddr, pRA, 6) == _TRUE) { -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ -+ WAPI_TRACE(WAPI_RX, "bFindMatchPeer: %d\n", bFindMatchPeer); -+ WAPI_DATA(WAPI_RX, "Addr", pRA, 6); -+ -+ if (bFindMatchPeer) { -+ if ((!pWapiSta->wapiUskUpdate.bTxEnable) && (!pWapiSta->wapiUsk.bTxEnable)) -+ return; -+ -+ if (pWapiSta->wapiUsk.keyId <= 1) { -+ if (pWapiSta->wapiUskUpdate.bTxEnable) -+ pWapiExt->KeyIdx = pWapiSta->wapiUskUpdate.keyId; -+ else -+ pWapiExt->KeyIdx = pWapiSta->wapiUsk.keyId; -+ -+ pWapiExt->Reserved = 0; -+ bPNOverflow = WapiIncreasePN(pWapiSta->lastTxUnicastPN, 2); -+ _rtw_memcpy(pWapiExt->PN, pWapiSta->lastTxUnicastPN, 16); -+ -+ } -+ } -+ } -+ -+ } -+ -+} -+ -+bool rtw_wapi_drop_for_key_absent(_adapter *padapter, u8 *pRA) -+{ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ bool bFindMatchPeer = false; -+ bool bDrop = false; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ WAPI_DATA(WAPI_RX, "rtw_wapi_drop_for_key_absent: ra ", pRA, 6); -+ -+ if (psecuritypriv->dot11PrivacyAlgrthm == _SMS4_) { -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ return true; -+ -+ if (IS_MCAST(pRA)) { -+ if (!pWapiInfo->wapiTxMsk.bTxEnable) { -+ bDrop = true; -+ WAPI_TRACE(WAPI_RX, "rtw_wapi_drop_for_key_absent: multicast key is absent\n"); -+ return bDrop; -+ } -+ } else { -+ if (!list_empty(&pWapiInfo->wapiSTAUsedList)) { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ WAPI_DATA(WAPI_RX, "rtw_wapi_drop_for_key_absent: pWapiSta->PeerMacAddr ", pWapiSta->PeerMacAddr, 6); -+ if (_rtw_memcmp(pRA, pWapiSta->PeerMacAddr, 6) == _TRUE) { -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ if (bFindMatchPeer) { -+ if (!pWapiSta->wapiUsk.bTxEnable) { -+ bDrop = true; -+ WAPI_TRACE(WAPI_RX, "rtw_wapi_drop_for_key_absent: unicast key is absent\n"); -+ return bDrop; -+ } -+ } else { -+ bDrop = true; -+ WAPI_TRACE(WAPI_RX, "rtw_wapi_drop_for_key_absent: no peer find\n"); -+ return bDrop; -+ } -+ -+ } else { -+ bDrop = true; -+ WAPI_TRACE(WAPI_RX, "rtw_wapi_drop_for_key_absent: no sta exist\n"); -+ return bDrop; -+ } -+ } -+ } else -+ return bDrop; -+ -+ return bDrop; -+} -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_wapi_sms4.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_wapi_sms4.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_wapi_sms4.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_wapi_sms4.c 2018-02-11 21:44:27.142146010 +0200 -@@ -0,0 +1,908 @@ -+#ifdef CONFIG_WAPI_SUPPORT -+ -+#include -+#include -+#include -+#include -+ -+ -+#ifdef CONFIG_WAPI_SW_SMS4 -+ -+#define WAPI_LITTLE_ENDIAN -+/* #define BIG_ENDIAN */ -+#define ENCRYPT 0 -+#define DECRYPT 1 -+ -+ -+/********************************************************** -+ **********************************************************/ -+const u8 Sbox[256] = { -+ 0xd6, 0x90, 0xe9, 0xfe, 0xcc, 0xe1, 0x3d, 0xb7, 0x16, 0xb6, 0x14, 0xc2, 0x28, 0xfb, 0x2c, 0x05, -+ 0x2b, 0x67, 0x9a, 0x76, 0x2a, 0xbe, 0x04, 0xc3, 0xaa, 0x44, 0x13, 0x26, 0x49, 0x86, 0x06, 0x99, -+ 0x9c, 0x42, 0x50, 0xf4, 0x91, 0xef, 0x98, 0x7a, 0x33, 0x54, 0x0b, 0x43, 0xed, 0xcf, 0xac, 0x62, -+ 0xe4, 0xb3, 0x1c, 0xa9, 0xc9, 0x08, 0xe8, 0x95, 0x80, 0xdf, 0x94, 0xfa, 0x75, 0x8f, 0x3f, 0xa6, -+ 0x47, 0x07, 0xa7, 0xfc, 0xf3, 0x73, 0x17, 0xba, 0x83, 0x59, 0x3c, 0x19, 0xe6, 0x85, 0x4f, 0xa8, -+ 0x68, 0x6b, 0x81, 0xb2, 0x71, 0x64, 0xda, 0x8b, 0xf8, 0xeb, 0x0f, 0x4b, 0x70, 0x56, 0x9d, 0x35, -+ 0x1e, 0x24, 0x0e, 0x5e, 0x63, 0x58, 0xd1, 0xa2, 0x25, 0x22, 0x7c, 0x3b, 0x01, 0x21, 0x78, 0x87, -+ 0xd4, 0x00, 0x46, 0x57, 0x9f, 0xd3, 0x27, 0x52, 0x4c, 0x36, 0x02, 0xe7, 0xa0, 0xc4, 0xc8, 0x9e, -+ 0xea, 0xbf, 0x8a, 0xd2, 0x40, 0xc7, 0x38, 0xb5, 0xa3, 0xf7, 0xf2, 0xce, 0xf9, 0x61, 0x15, 0xa1, -+ 0xe0, 0xae, 0x5d, 0xa4, 0x9b, 0x34, 0x1a, 0x55, 0xad, 0x93, 0x32, 0x30, 0xf5, 0x8c, 0xb1, 0xe3, -+ 0x1d, 0xf6, 0xe2, 0x2e, 0x82, 0x66, 0xca, 0x60, 0xc0, 0x29, 0x23, 0xab, 0x0d, 0x53, 0x4e, 0x6f, -+ 0xd5, 0xdb, 0x37, 0x45, 0xde, 0xfd, 0x8e, 0x2f, 0x03, 0xff, 0x6a, 0x72, 0x6d, 0x6c, 0x5b, 0x51, -+ 0x8d, 0x1b, 0xaf, 0x92, 0xbb, 0xdd, 0xbc, 0x7f, 0x11, 0xd9, 0x5c, 0x41, 0x1f, 0x10, 0x5a, 0xd8, -+ 0x0a, 0xc1, 0x31, 0x88, 0xa5, 0xcd, 0x7b, 0xbd, 0x2d, 0x74, 0xd0, 0x12, 0xb8, 0xe5, 0xb4, 0xb0, -+ 0x89, 0x69, 0x97, 0x4a, 0x0c, 0x96, 0x77, 0x7e, 0x65, 0xb9, 0xf1, 0x09, 0xc5, 0x6e, 0xc6, 0x84, -+ 0x18, 0xf0, 0x7d, 0xec, 0x3a, 0xdc, 0x4d, 0x20, 0x79, 0xee, 0x5f, 0x3e, 0xd7, 0xcb, 0x39, 0x48 -+}; -+ -+const u32 CK[32] = { -+ 0x00070e15, 0x1c232a31, 0x383f464d, 0x545b6269, -+ 0x70777e85, 0x8c939aa1, 0xa8afb6bd, 0xc4cbd2d9, -+ 0xe0e7eef5, 0xfc030a11, 0x181f262d, 0x343b4249, -+ 0x50575e65, 0x6c737a81, 0x888f969d, 0xa4abb2b9, -+ 0xc0c7ced5, 0xdce3eaf1, 0xf8ff060d, 0x141b2229, -+ 0x30373e45, 0x4c535a61, 0x686f767d, 0x848b9299, -+ 0xa0a7aeb5, 0xbcc3cad1, 0xd8dfe6ed, 0xf4fb0209, -+ 0x10171e25, 0x2c333a41, 0x484f565d, 0x646b7279 -+}; -+ -+#define Rotl(_x, _y) (((_x) << (_y)) | ((_x) >> (32 - (_y)))) -+ -+#define ByteSub(_A) (Sbox[(_A) >> 24 & 0xFF] << 24 | \ -+ Sbox[(_A) >> 16 & 0xFF] << 16 | \ -+ Sbox[(_A) >> 8 & 0xFF] << 8 | \ -+ Sbox[(_A) & 0xFF]) -+ -+#define L1(_B) ((_B) ^ Rotl(_B, 2) ^ Rotl(_B, 10) ^ Rotl(_B, 18) ^ Rotl(_B, 24)) -+#define L2(_B) ((_B) ^ Rotl(_B, 13) ^ Rotl(_B, 23)) -+ -+static void -+xor_block(void *dst, void *src1, void *src2) -+/* 128-bit xor: *dst = *src1 xor *src2. Pointers must be 32-bit aligned */ -+{ -+ ((u32 *)dst)[0] = ((u32 *)src1)[0] ^ ((u32 *)src2)[0]; -+ ((u32 *)dst)[1] = ((u32 *)src1)[1] ^ ((u32 *)src2)[1]; -+ ((u32 *)dst)[2] = ((u32 *)src1)[2] ^ ((u32 *)src2)[2]; -+ ((u32 *)dst)[3] = ((u32 *)src1)[3] ^ ((u32 *)src2)[3]; -+} -+ -+ -+void SMS4Crypt(u8 *Input, u8 *Output, u32 *rk) -+{ -+ u32 r, mid, x0, x1, x2, x3, *p; -+ p = (u32 *)Input; -+ x0 = p[0]; -+ x1 = p[1]; -+ x2 = p[2]; -+ x3 = p[3]; -+#ifdef WAPI_LITTLE_ENDIAN -+ x0 = Rotl(x0, 16); -+ x0 = ((x0 & 0x00FF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); -+ x1 = Rotl(x1, 16); -+ x1 = ((x1 & 0x00FF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); -+ x2 = Rotl(x2, 16); -+ x2 = ((x2 & 0x00FF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); -+ x3 = Rotl(x3, 16); -+ x3 = ((x3 & 0x00FF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); -+#endif -+ for (r = 0; r < 32; r += 4) { -+ mid = x1 ^ x2 ^ x3 ^ rk[r + 0]; -+ mid = ByteSub(mid); -+ x0 ^= L1(mid); -+ mid = x2 ^ x3 ^ x0 ^ rk[r + 1]; -+ mid = ByteSub(mid); -+ x1 ^= L1(mid); -+ mid = x3 ^ x0 ^ x1 ^ rk[r + 2]; -+ mid = ByteSub(mid); -+ x2 ^= L1(mid); -+ mid = x0 ^ x1 ^ x2 ^ rk[r + 3]; -+ mid = ByteSub(mid); -+ x3 ^= L1(mid); -+ } -+#ifdef WAPI_LITTLE_ENDIAN -+ x0 = Rotl(x0, 16); -+ x0 = ((x0 & 0x00FF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); -+ x1 = Rotl(x1, 16); -+ x1 = ((x1 & 0x00FF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); -+ x2 = Rotl(x2, 16); -+ x2 = ((x2 & 0x00FF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); -+ x3 = Rotl(x3, 16); -+ x3 = ((x3 & 0x00FF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); -+#endif -+ p = (u32 *)Output; -+ p[0] = x3; -+ p[1] = x2; -+ p[2] = x1; -+ p[3] = x0; -+} -+ -+ -+ -+void SMS4KeyExt(u8 *Key, u32 *rk, u32 CryptFlag) -+{ -+ u32 r, mid, x0, x1, x2, x3, *p; -+ -+ p = (u32 *)Key; -+ x0 = p[0]; -+ x1 = p[1]; -+ x2 = p[2]; -+ x3 = p[3]; -+#ifdef WAPI_LITTLE_ENDIAN -+ x0 = Rotl(x0, 16); -+ x0 = ((x0 & 0xFF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); -+ x1 = Rotl(x1, 16); -+ x1 = ((x1 & 0xFF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); -+ x2 = Rotl(x2, 16); -+ x2 = ((x2 & 0xFF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); -+ x3 = Rotl(x3, 16); -+ x3 = ((x3 & 0xFF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); -+#endif -+ -+ x0 ^= 0xa3b1bac6; -+ x1 ^= 0x56aa3350; -+ x2 ^= 0x677d9197; -+ x3 ^= 0xb27022dc; -+ for (r = 0; r < 32; r += 4) { -+ mid = x1 ^ x2 ^ x3 ^ CK[r + 0]; -+ mid = ByteSub(mid); -+ rk[r + 0] = x0 ^= L2(mid); -+ mid = x2 ^ x3 ^ x0 ^ CK[r + 1]; -+ mid = ByteSub(mid); -+ rk[r + 1] = x1 ^= L2(mid); -+ mid = x3 ^ x0 ^ x1 ^ CK[r + 2]; -+ mid = ByteSub(mid); -+ rk[r + 2] = x2 ^= L2(mid); -+ mid = x0 ^ x1 ^ x2 ^ CK[r + 3]; -+ mid = ByteSub(mid); -+ rk[r + 3] = x3 ^= L2(mid); -+ } -+ if (CryptFlag == DECRYPT) { -+ for (r = 0; r < 16; r++) -+ mid = rk[r], rk[r] = rk[31 - r], rk[31 - r] = mid; -+ } -+} -+ -+ -+void WapiSMS4Cryption(u8 *Key, u8 *IV, u8 *Input, u16 InputLength, -+ u8 *Output, u16 *OutputLength, u32 CryptFlag) -+{ -+ u32 blockNum, i, j, rk[32]; -+ u16 remainder; -+ u8 blockIn[16], blockOut[16], tempIV[16], k; -+ -+ *OutputLength = 0; -+ remainder = InputLength & 0x0F; -+ blockNum = InputLength >> 4; -+ if (remainder != 0) -+ blockNum++; -+ else -+ remainder = 16; -+ -+ for (k = 0; k < 16; k++) -+ tempIV[k] = IV[15 - k]; -+ -+ memcpy(blockIn, tempIV, 16); -+ -+ SMS4KeyExt((u8 *)Key, rk, CryptFlag); -+ -+ for (i = 0; i < blockNum - 1; i++) { -+ SMS4Crypt((u8 *)blockIn, blockOut, rk); -+ xor_block(&Output[i * 16], &Input[i * 16], blockOut); -+ memcpy(blockIn, blockOut, 16); -+ } -+ -+ *OutputLength = i * 16; -+ -+ SMS4Crypt((u8 *)blockIn, blockOut, rk); -+ -+ for (j = 0; j < remainder; j++) -+ Output[i * 16 + j] = Input[i * 16 + j] ^ blockOut[j]; -+ *OutputLength += remainder; -+ -+} -+ -+void WapiSMS4Encryption(u8 *Key, u8 *IV, u8 *Input, u16 InputLength, -+ u8 *Output, u16 *OutputLength) -+{ -+ -+ WapiSMS4Cryption(Key, IV, Input, InputLength, Output, OutputLength, ENCRYPT); -+} -+ -+void WapiSMS4Decryption(u8 *Key, u8 *IV, u8 *Input, u16 InputLength, -+ u8 *Output, u16 *OutputLength) -+{ -+ /* OFB mode: is also ENCRYPT flag */ -+ WapiSMS4Cryption(Key, IV, Input, InputLength, Output, OutputLength, ENCRYPT); -+} -+ -+void WapiSMS4CalculateMic(u8 *Key, u8 *IV, u8 *Input1, u8 Input1Length, -+ u8 *Input2, u16 Input2Length, u8 *Output, u8 *OutputLength) -+{ -+ u32 blockNum, i, remainder, rk[32]; -+ u8 BlockIn[16], BlockOut[16], TempBlock[16], tempIV[16], k; -+ -+ *OutputLength = 0; -+ remainder = Input1Length & 0x0F; -+ blockNum = Input1Length >> 4; -+ -+ for (k = 0; k < 16; k++) -+ tempIV[k] = IV[15 - k]; -+ -+ memcpy(BlockIn, tempIV, 16); -+ -+ SMS4KeyExt((u8 *)Key, rk, ENCRYPT); -+ -+ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); -+ -+ for (i = 0; i < blockNum; i++) { -+ xor_block(BlockIn, (Input1 + i * 16), BlockOut); -+ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); -+ } -+ -+ if (remainder != 0) { -+ memset(TempBlock, 0, 16); -+ memcpy(TempBlock, (Input1 + blockNum * 16), remainder); -+ -+ xor_block(BlockIn, TempBlock, BlockOut); -+ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); -+ } -+ -+ remainder = Input2Length & 0x0F; -+ blockNum = Input2Length >> 4; -+ -+ for (i = 0; i < blockNum; i++) { -+ xor_block(BlockIn, (Input2 + i * 16), BlockOut); -+ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); -+ } -+ -+ if (remainder != 0) { -+ memset(TempBlock, 0, 16); -+ memcpy(TempBlock, (Input2 + blockNum * 16), remainder); -+ -+ xor_block(BlockIn, TempBlock, BlockOut); -+ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); -+ } -+ -+ memcpy(Output, BlockOut, 16); -+ *OutputLength = 16; -+} -+ -+void SecCalculateMicSMS4( -+ u8 KeyIdx, -+ u8 *MicKey, -+ u8 *pHeader, -+ u8 *pData, -+ u16 DataLen, -+ u8 *MicBuffer -+) -+{ -+#if 0 -+ struct ieee80211_hdr_3addr_qos *header; -+ u8 TempBuf[34], TempLen = 32, MicLen, QosOffset, *IV; -+ u16 *pTemp, fc; -+ -+ WAPI_TRACE(WAPI_TX | WAPI_RX, "=========>%s\n", __FUNCTION__); -+ -+ header = (struct ieee80211_hdr_3addr_qos *)pHeader; -+ memset(TempBuf, 0, 34); -+ memcpy(TempBuf, pHeader, 2); /* FrameCtrl */ -+ pTemp = (u16 *)TempBuf; -+ *pTemp &= 0xc78f; /* bit4,5,6,11,12,13 */ -+ -+ memcpy((TempBuf + 2), (pHeader + 4), 12); /* Addr1, Addr2 */ -+ memcpy((TempBuf + 14), (pHeader + 22), 2); /* SeqCtrl */ -+ pTemp = (u16 *)(TempBuf + 14); -+ *pTemp &= 0x000f; -+ -+ memcpy((TempBuf + 16), (pHeader + 16), 6); /* Addr3 */ -+ -+ fc = le16_to_cpu(header->frame_ctl); -+ -+ -+ -+ if (GetFrDs((u16 *)&fc) && GetToDs((u16 *)&fc)) { -+ memcpy((TempBuf + 22), (pHeader + 24), 6); -+ QosOffset = 30; -+ } else { -+ memset((TempBuf + 22), 0, 6); -+ QosOffset = 24; -+ } -+ -+ if ((fc & 0x0088) == 0x0088) { -+ memcpy((TempBuf + 28), (pHeader + QosOffset), 2); -+ TempLen += 2; -+ /* IV = pHeader + QosOffset + 2 + SNAP_SIZE + sizeof(u16) + 2; */ -+ IV = pHeader + QosOffset + 2 + 2; -+ } else { -+ IV = pHeader + QosOffset + 2; -+ /* IV = pHeader + QosOffset + SNAP_SIZE + sizeof(u16) + 2; */ -+ } -+ -+ TempBuf[TempLen - 1] = (u8)(DataLen & 0xff); -+ TempBuf[TempLen - 2] = (u8)((DataLen & 0xff00) >> 8); -+ TempBuf[TempLen - 4] = KeyIdx; -+ -+ WAPI_DATA(WAPI_TX, "CalculateMic - KEY", MicKey, 16); -+ WAPI_DATA(WAPI_TX, "CalculateMic - IV", IV, 16); -+ WAPI_DATA(WAPI_TX, "CalculateMic - TempBuf", TempBuf, TempLen); -+ WAPI_DATA(WAPI_TX, "CalculateMic - pData", pData, DataLen); -+ -+ WapiSMS4CalculateMic(MicKey, IV, TempBuf, TempLen, -+ pData, DataLen, MicBuffer, &MicLen); -+ -+ if (MicLen != 16) -+ WAPI_TRACE(WAPI_ERR, "%s: MIC Length Error!!\n", __FUNCTION__); -+ -+ WAPI_TRACE(WAPI_TX | WAPI_RX, "<=========%s\n", __FUNCTION__); -+#endif -+} -+ -+/* AddCount: 1 or 2. -+ * If overflow, return 1, -+ * else return 0. -+ */ -+u8 WapiIncreasePN(u8 *PN, u8 AddCount) -+{ -+ u8 i; -+ -+ if (NULL == PN) -+ return 1; -+ /* YJ,test,091102 */ -+ /* -+ if(AddCount == 2){ -+ RTW_INFO("############################%s(): PN[0]=0x%x\n", __FUNCTION__, PN[0]); -+ if(PN[0] == 0x48){ -+ PN[0] += AddCount; -+ return 1; -+ }else{ -+ PN[0] += AddCount; -+ return 0; -+ } -+ } -+ */ -+ /* YJ,test,091102,end */ -+ -+ for (i = 0; i < 16; i++) { -+ if (PN[i] + AddCount <= 0xff) { -+ PN[i] += AddCount; -+ return 0; -+ } else { -+ PN[i] += AddCount; -+ AddCount = 1; -+ } -+ } -+ return 1; -+} -+ -+ -+void WapiGetLastRxUnicastPNForQoSData( -+ u8 UserPriority, -+ PRT_WAPI_STA_INFO pWapiStaInfo, -+ u8 *PNOut -+) -+{ -+ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); -+ switch (UserPriority) { -+ case 0: -+ case 3: -+ memcpy(PNOut, pWapiStaInfo->lastRxUnicastPNBEQueue, 16); -+ break; -+ case 1: -+ case 2: -+ memcpy(PNOut, pWapiStaInfo->lastRxUnicastPNBKQueue, 16); -+ break; -+ case 4: -+ case 5: -+ memcpy(PNOut, pWapiStaInfo->lastRxUnicastPNVIQueue, 16); -+ break; -+ case 6: -+ case 7: -+ memcpy(PNOut, pWapiStaInfo->lastRxUnicastPNVOQueue, 16); -+ break; -+ default: -+ WAPI_TRACE(WAPI_ERR, "%s: Unknown TID\n", __FUNCTION__); -+ break; -+ } -+ WAPI_TRACE(WAPI_RX, "<=========== %s\n", __FUNCTION__); -+} -+ -+ -+void WapiSetLastRxUnicastPNForQoSData( -+ u8 UserPriority, -+ u8 *PNIn, -+ PRT_WAPI_STA_INFO pWapiStaInfo -+) -+{ -+ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); -+ switch (UserPriority) { -+ case 0: -+ case 3: -+ memcpy(pWapiStaInfo->lastRxUnicastPNBEQueue, PNIn, 16); -+ break; -+ case 1: -+ case 2: -+ memcpy(pWapiStaInfo->lastRxUnicastPNBKQueue, PNIn, 16); -+ break; -+ case 4: -+ case 5: -+ memcpy(pWapiStaInfo->lastRxUnicastPNVIQueue, PNIn, 16); -+ break; -+ case 6: -+ case 7: -+ memcpy(pWapiStaInfo->lastRxUnicastPNVOQueue, PNIn, 16); -+ break; -+ default: -+ WAPI_TRACE(WAPI_ERR, "%s: Unknown TID\n", __FUNCTION__); -+ break; -+ } -+ WAPI_TRACE(WAPI_RX, "<=========== %s\n", __FUNCTION__); -+} -+ -+ -+/**************************************************************************** -+ FALSE not RX-Reorder -+ TRUE do RX Reorder -+add to support WAPI to N-mode -+*****************************************************************************/ -+u8 WapiCheckPnInSwDecrypt( -+ _adapter *padapter, -+ struct sk_buff *pskb -+) -+{ -+ u8 ret = false; -+ -+#if 0 -+ struct ieee80211_hdr_3addr_qos *header; -+ u16 fc; -+ u8 *pDaddr, *pTaddr, *pRaddr; -+ -+ header = (struct ieee80211_hdr_3addr_qos *)pskb->data; -+ pTaddr = header->addr2; -+ pRaddr = header->addr1; -+ fc = le16_to_cpu(header->frame_ctl); -+ -+ if (GetToDs(&fc)) -+ pDaddr = header->addr3; -+ else -+ pDaddr = header->addr1; -+ -+ if ((_rtw_memcmp(pRaddr, padapter->pnetdev->dev_addr, ETH_ALEN) == 0) -+ && !(pDaddr) -+ && (GetFrameType(&fc) == WIFI_QOS_DATA_TYPE)) -+ /* && ieee->pHTInfo->bCurrentHTSupport && */ -+ /* ieee->pHTInfo->bCurRxReorderEnable) */ -+ ret = false; -+ else -+ ret = true; -+#endif -+ WAPI_TRACE(WAPI_RX, "%s: return %d\n", __FUNCTION__, ret); -+ return ret; -+} -+ -+int SecSMS4HeaderFillIV(_adapter *padapter, u8 *pxmitframe) -+{ -+ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; -+ u8 *frame = ((struct xmit_frame *)pxmitframe)->buf_addr + TXDESC_OFFSET; -+ u8 *pSecHeader = NULL, *pos = NULL, *pRA = NULL; -+ u8 bPNOverflow = false, bFindMatchPeer = false, hdr_len = 0; -+ PWLAN_HEADER_WAPI_EXTENSION pWapiExt = NULL; -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ int ret = 0; -+ -+ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); -+ -+ return ret; -+#if 0 -+ hdr_len = sMacHdrLng; -+ if (GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE) -+ hdr_len += 2; -+ /* hdr_len += SNAP_SIZE + sizeof(u16); */ -+ -+ pos = skb_push(pskb, padapter->wapiInfo.extra_prefix_len); -+ memmove(pos, pos + padapter->wapiInfo.extra_prefix_len, hdr_len); -+ -+ pSecHeader = pskb->data + hdr_len; -+ pWapiExt = (PWLAN_HEADER_WAPI_EXTENSION)pSecHeader; -+ pRA = pskb->data + 4; -+ -+ WAPI_DATA(WAPI_TX, "FillIV - Before Fill IV", pskb->data, pskb->len); -+ -+ /* Address 1 is always receiver's address */ -+ if (IS_MCAST(pRA)) { -+ if (!pWapiInfo->wapiTxMsk.bTxEnable) { -+ WAPI_TRACE(WAPI_ERR, "%s: bTxEnable = 0!!\n", __FUNCTION__); -+ return -2; -+ } -+ if (pWapiInfo->wapiTxMsk.keyId <= 1) { -+ pWapiExt->KeyIdx = pWapiInfo->wapiTxMsk.keyId; -+ pWapiExt->Reserved = 0; -+ bPNOverflow = WapiIncreasePN(pWapiInfo->lastTxMulticastPN, 1); -+ memcpy(pWapiExt->PN, pWapiInfo->lastTxMulticastPN, 16); -+ if (bPNOverflow) { -+ /* Update MSK Notification. */ -+ WAPI_TRACE(WAPI_ERR, "===============>%s():multicast PN overflow\n", __FUNCTION__); -+ rtw_wapi_app_event_handler(padapter, NULL, 0, pRA, false, false, true, 0, false); -+ } -+ } else { -+ WAPI_TRACE(WAPI_ERR, "%s: Invalid Wapi Multicast KeyIdx!!\n", __FUNCTION__); -+ ret = -3; -+ } -+ } else { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (!memcmp(pWapiSta->PeerMacAddr, pRA, 6)) { -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ if (bFindMatchPeer) { -+ if ((!pWapiSta->wapiUskUpdate.bTxEnable) && (!pWapiSta->wapiUsk.bTxEnable)) { -+ WAPI_TRACE(WAPI_ERR, "%s: bTxEnable = 0!!\n", __FUNCTION__); -+ return -4; -+ } -+ if (pWapiSta->wapiUsk.keyId <= 1) { -+ if (pWapiSta->wapiUskUpdate.bTxEnable) -+ pWapiExt->KeyIdx = pWapiSta->wapiUskUpdate.keyId; -+ else -+ pWapiExt->KeyIdx = pWapiSta->wapiUsk.keyId; -+ -+ pWapiExt->Reserved = 0; -+ bPNOverflow = WapiIncreasePN(pWapiSta->lastTxUnicastPN, 2); -+ memcpy(pWapiExt->PN, pWapiSta->lastTxUnicastPN, 16); -+ if (bPNOverflow) { -+ /* Update USK Notification. */ -+ WAPI_TRACE(WAPI_ERR, "===============>%s():unicast PN overflow\n", __FUNCTION__); -+ rtw_wapi_app_event_handler(padapter, NULL, 0, pWapiSta->PeerMacAddr, false, true, false, 0, false); -+ } -+ } else { -+ WAPI_TRACE(WAPI_ERR, "%s: Invalid Wapi Unicast KeyIdx!!\n", __FUNCTION__); -+ ret = -5; -+ } -+ } else { -+ WAPI_TRACE(WAPI_ERR, "%s: Can not find Peer Sta "MAC_FMT"!!\n", __FUNCTION__, MAC_ARG(pRA)); -+ ret = -6; -+ } -+ } -+ -+ WAPI_DATA(WAPI_TX, "FillIV - After Fill IV", pskb->data, pskb->len); -+ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); -+ return ret; -+#endif -+} -+ -+/* WAPI SW Enc: must have done Coalesce! */ -+void SecSWSMS4Encryption( -+ _adapter *padapter, -+ u8 *pxmitframe -+) -+{ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ u8 *pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + TXDESC_SIZE; -+ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; -+ -+ u8 *SecPtr = NULL, *pRA, *pMicKey = NULL, *pDataKey = NULL, *pIV = NULL; -+ u8 IVOffset, DataOffset, bFindMatchPeer = false, KeyIdx = 0, MicBuffer[16]; -+ u16 OutputLength; -+ -+ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); -+ -+ WAPI_TRACE(WAPI_TX, "hdrlen: %d\n", pattrib->hdrlen); -+ -+ return; -+ -+ DataOffset = pattrib->hdrlen + pattrib->iv_len; -+ -+ pRA = pframe + 4; -+ -+ -+ if (IS_MCAST(pRA)) { -+ KeyIdx = pWapiInfo->wapiTxMsk.keyId; -+ pIV = pWapiInfo->lastTxMulticastPN; -+ pMicKey = pWapiInfo->wapiTxMsk.micKey; -+ pDataKey = pWapiInfo->wapiTxMsk.dataKey; -+ } else { -+ if (!list_empty(&(pWapiInfo->wapiSTAUsedList))) { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (0 == memcmp(pWapiSta->PeerMacAddr, pRA, 6)) { -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ -+ if (bFindMatchPeer) { -+ if (pWapiSta->wapiUskUpdate.bTxEnable) { -+ KeyIdx = pWapiSta->wapiUskUpdate.keyId; -+ WAPI_TRACE(WAPI_TX, "%s(): Use update USK!! KeyIdx=%d\n", __FUNCTION__, KeyIdx); -+ pIV = pWapiSta->lastTxUnicastPN; -+ pMicKey = pWapiSta->wapiUskUpdate.micKey; -+ pDataKey = pWapiSta->wapiUskUpdate.dataKey; -+ } else { -+ KeyIdx = pWapiSta->wapiUsk.keyId; -+ WAPI_TRACE(WAPI_TX, "%s(): Use USK!! KeyIdx=%d\n", __FUNCTION__, KeyIdx); -+ pIV = pWapiSta->lastTxUnicastPN; -+ pMicKey = pWapiSta->wapiUsk.micKey; -+ pDataKey = pWapiSta->wapiUsk.dataKey; -+ } -+ } else { -+ WAPI_TRACE(WAPI_ERR, "%s: Can not find Peer Sta!!\n", __FUNCTION__); -+ return; -+ } -+ } else { -+ WAPI_TRACE(WAPI_ERR, "%s: wapiSTAUsedList is empty!!\n", __FUNCTION__); -+ return; -+ } -+ } -+ -+ SecPtr = pframe; -+ SecCalculateMicSMS4(KeyIdx, pMicKey, SecPtr, (SecPtr + DataOffset), pattrib->pktlen, MicBuffer); -+ -+ WAPI_DATA(WAPI_TX, "Encryption - MIC", MicBuffer, padapter->wapiInfo.extra_postfix_len); -+ -+ memcpy(pframe + pattrib->hdrlen + pattrib->iv_len + pattrib->pktlen - pattrib->icv_len, -+ (u8 *)MicBuffer, -+ padapter->wapiInfo.extra_postfix_len -+ ); -+ -+ -+ WapiSMS4Encryption(pDataKey, pIV, (SecPtr + DataOffset), pattrib->pktlen + pattrib->icv_len, (SecPtr + DataOffset), &OutputLength); -+ -+ WAPI_DATA(WAPI_TX, "Encryption - After SMS4 encryption", pframe, pattrib->hdrlen + pattrib->iv_len + pattrib->pktlen); -+ -+ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); -+} -+ -+u8 SecSWSMS4Decryption( -+ _adapter *padapter, -+ u8 *precv_frame, -+ struct recv_priv *precv_priv -+) -+{ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ struct recv_frame_hdr *precv_hdr; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ u8 IVOffset, DataOffset, bFindMatchPeer = false, bUseUpdatedKey = false; -+ u8 KeyIdx, MicBuffer[16], lastRxPNforQoS[16]; -+ u8 *pRA, *pTA, *pMicKey, *pDataKey, *pLastRxPN, *pRecvPN, *pSecData, *pRecvMic, *pos; -+ u8 TID = 0; -+ u16 OutputLength, DataLen; -+ u8 bQosData; -+ struct sk_buff *pskb; -+ -+ WAPI_TRACE(WAPI_RX, "=========>%s\n", __FUNCTION__); -+ -+ return 0; -+ -+ precv_hdr = &((union recv_frame *)precv_frame)->u.hdr; -+ pskb = (struct sk_buff *)(precv_hdr->rx_data); -+ precv_hdr->bWapiCheckPNInDecrypt = WapiCheckPnInSwDecrypt(padapter, pskb); -+ WAPI_TRACE(WAPI_RX, "=========>%s: check PN %d\n", __FUNCTION__, precv_hdr->bWapiCheckPNInDecrypt); -+ WAPI_DATA(WAPI_RX, "Decryption - Before decryption", pskb->data, pskb->len); -+ -+ IVOffset = sMacHdrLng; -+ bQosData = GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE; -+ if (bQosData) -+ IVOffset += 2; -+ -+ /* if(GetHTC()) */ -+ /* IVOffset += 4; */ -+ -+ /* IVOffset += SNAP_SIZE + sizeof(u16); */ -+ -+ DataOffset = IVOffset + padapter->wapiInfo.extra_prefix_len; -+ -+ pRA = pskb->data + 4; -+ pTA = pskb->data + 10; -+ KeyIdx = *(pskb->data + IVOffset); -+ pRecvPN = pskb->data + IVOffset + 2; -+ pSecData = pskb->data + DataOffset; -+ DataLen = pskb->len - DataOffset; -+ pRecvMic = pskb->data + pskb->len - padapter->wapiInfo.extra_postfix_len; -+ TID = GetTid(pskb->data); -+ -+ if (!list_empty(&(pWapiInfo->wapiSTAUsedList))) { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (0 == memcmp(pWapiSta->PeerMacAddr, pTA, 6)) { -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ } -+ -+ if (!bFindMatchPeer) { -+ WAPI_TRACE(WAPI_ERR, "%s: Can not find Peer Sta "MAC_FMT" for Key Info!!!\n", __FUNCTION__, MAC_ARG(pTA)); -+ return false; -+ } -+ -+ if (IS_MCAST(pRA)) { -+ WAPI_TRACE(WAPI_RX, "%s: Multicast decryption !!!\n", __FUNCTION__); -+ if (pWapiSta->wapiMsk.keyId == KeyIdx && pWapiSta->wapiMsk.bSet) { -+ pLastRxPN = pWapiSta->lastRxMulticastPN; -+ if (!WapiComparePN(pRecvPN, pLastRxPN)) { -+ WAPI_TRACE(WAPI_ERR, "%s: MSK PN is not larger than last, Dropped!!!\n", __FUNCTION__); -+ WAPI_DATA(WAPI_ERR, "pRecvPN:", pRecvPN, 16); -+ WAPI_DATA(WAPI_ERR, "pLastRxPN:", pLastRxPN, 16); -+ return false; -+ } -+ -+ memcpy(pLastRxPN, pRecvPN, 16); -+ pMicKey = pWapiSta->wapiMsk.micKey; -+ pDataKey = pWapiSta->wapiMsk.dataKey; -+ } else if (pWapiSta->wapiMskUpdate.keyId == KeyIdx && pWapiSta->wapiMskUpdate.bSet) { -+ WAPI_TRACE(WAPI_RX, "%s: Use Updated MSK for Decryption !!!\n", __FUNCTION__); -+ bUseUpdatedKey = true; -+ memcpy(pWapiSta->lastRxMulticastPN, pRecvPN, 16); -+ pMicKey = pWapiSta->wapiMskUpdate.micKey; -+ pDataKey = pWapiSta->wapiMskUpdate.dataKey; -+ } else { -+ WAPI_TRACE(WAPI_ERR, "%s: Can not find MSK with matched KeyIdx(%d), Dropped !!!\n", __FUNCTION__, KeyIdx); -+ return false; -+ } -+ } else { -+ WAPI_TRACE(WAPI_RX, "%s: Unicast decryption !!!\n", __FUNCTION__); -+ if (pWapiSta->wapiUsk.keyId == KeyIdx && pWapiSta->wapiUsk.bSet) { -+ WAPI_TRACE(WAPI_RX, "%s: Use USK for Decryption!!!\n", __FUNCTION__); -+ if (precv_hdr->bWapiCheckPNInDecrypt) { -+ if (GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE) { -+ WapiGetLastRxUnicastPNForQoSData(TID, pWapiSta, lastRxPNforQoS); -+ pLastRxPN = lastRxPNforQoS; -+ } else -+ pLastRxPN = pWapiSta->lastRxUnicastPN; -+ if (!WapiComparePN(pRecvPN, pLastRxPN)) -+ return false; -+ if (bQosData) -+ WapiSetLastRxUnicastPNForQoSData(TID, pRecvPN, pWapiSta); -+ else -+ memcpy(pWapiSta->lastRxUnicastPN, pRecvPN, 16); -+ } else -+ memcpy(precv_hdr->WapiTempPN, pRecvPN, 16); -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE)) { -+ if ((pRecvPN[0] & 0x1) == 0) { -+ WAPI_TRACE(WAPI_ERR, "%s: Rx USK PN is not odd when Infra STA mode, Dropped !!!\n", __FUNCTION__); -+ return false; -+ } -+ } -+ -+ pMicKey = pWapiSta->wapiUsk.micKey; -+ pDataKey = pWapiSta->wapiUsk.dataKey; -+ } else if (pWapiSta->wapiUskUpdate.keyId == KeyIdx && pWapiSta->wapiUskUpdate.bSet) { -+ WAPI_TRACE(WAPI_RX, "%s: Use Updated USK for Decryption!!!\n", __FUNCTION__); -+ if (pWapiSta->bAuthenticatorInUpdata) -+ bUseUpdatedKey = true; -+ else -+ bUseUpdatedKey = false; -+ -+ if (bQosData) -+ WapiSetLastRxUnicastPNForQoSData(TID, pRecvPN, pWapiSta); -+ else -+ memcpy(pWapiSta->lastRxUnicastPN, pRecvPN, 16); -+ pMicKey = pWapiSta->wapiUskUpdate.micKey; -+ pDataKey = pWapiSta->wapiUskUpdate.dataKey; -+ } else { -+ WAPI_TRACE(WAPI_ERR, "%s: No valid USK!!!KeyIdx=%d pWapiSta->wapiUsk.keyId=%d pWapiSta->wapiUskUpdate.keyId=%d\n", __FUNCTION__, KeyIdx, pWapiSta->wapiUsk.keyId, -+ pWapiSta->wapiUskUpdate.keyId); -+ /* dump_buf(pskb->data,pskb->len); */ -+ return false; -+ } -+ } -+ -+ WAPI_DATA(WAPI_RX, "Decryption - DataKey", pDataKey, 16); -+ WAPI_DATA(WAPI_RX, "Decryption - IV", pRecvPN, 16); -+ WapiSMS4Decryption(pDataKey, pRecvPN, pSecData, DataLen, pSecData, &OutputLength); -+ -+ if (OutputLength != DataLen) -+ WAPI_TRACE(WAPI_ERR, "%s: Output Length Error!!!!\n", __FUNCTION__); -+ -+ WAPI_DATA(WAPI_RX, "Decryption - After decryption", pskb->data, pskb->len); -+ -+ DataLen -= padapter->wapiInfo.extra_postfix_len; -+ -+ SecCalculateMicSMS4(KeyIdx, pMicKey, pskb->data, pSecData, DataLen, MicBuffer); -+ -+ WAPI_DATA(WAPI_RX, "Decryption - MIC received", pRecvMic, SMS4_MIC_LEN); -+ WAPI_DATA(WAPI_RX, "Decryption - MIC calculated", MicBuffer, SMS4_MIC_LEN); -+ -+ if (0 == memcmp(MicBuffer, pRecvMic, padapter->wapiInfo.extra_postfix_len)) { -+ WAPI_TRACE(WAPI_RX, "%s: Check MIC OK!!\n", __FUNCTION__); -+ if (bUseUpdatedKey) { -+ /* delete the old key */ -+ if (IS_MCAST(pRA)) { -+ WAPI_TRACE(WAPI_API, "%s(): AE use new update MSK!!\n", __FUNCTION__); -+ pWapiSta->wapiMsk.keyId = pWapiSta->wapiMskUpdate.keyId; -+ memcpy(pWapiSta->wapiMsk.dataKey, pWapiSta->wapiMskUpdate.dataKey, 16); -+ memcpy(pWapiSta->wapiMsk.micKey, pWapiSta->wapiMskUpdate.micKey, 16); -+ pWapiSta->wapiMskUpdate.bTxEnable = pWapiSta->wapiMskUpdate.bSet = false; -+ } else { -+ WAPI_TRACE(WAPI_API, "%s(): AE use new update USK!!\n", __FUNCTION__); -+ pWapiSta->wapiUsk.keyId = pWapiSta->wapiUskUpdate.keyId; -+ memcpy(pWapiSta->wapiUsk.dataKey, pWapiSta->wapiUskUpdate.dataKey, 16); -+ memcpy(pWapiSta->wapiUsk.micKey, pWapiSta->wapiUskUpdate.micKey, 16); -+ pWapiSta->wapiUskUpdate.bTxEnable = pWapiSta->wapiUskUpdate.bSet = false; -+ } -+ } -+ } else { -+ WAPI_TRACE(WAPI_ERR, "%s: Check MIC Error, Dropped !!!!\n", __FUNCTION__); -+ return false; -+ } -+ -+ pos = pskb->data; -+ memmove(pos + padapter->wapiInfo.extra_prefix_len, pos, IVOffset); -+ skb_pull(pskb, padapter->wapiInfo.extra_prefix_len); -+ -+ WAPI_TRACE(WAPI_RX, "<=========%s\n", __FUNCTION__); -+ -+ return true; -+} -+ -+u32 rtw_sms4_encrypt(_adapter *padapter, u8 *pxmitframe) -+{ -+ -+ u8 *pframe; -+ u32 res = _SUCCESS; -+ -+ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) { -+ WAPI_TRACE(WAPI_TX, "<========== %s, WAPI not supported or enabled!\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+ if (((struct xmit_frame *)pxmitframe)->buf_addr == NULL) -+ return _FAIL; -+ -+ pframe = ((struct xmit_frame *)pxmitframe)->buf_addr + TXDESC_OFFSET; -+ -+ SecSWSMS4Encryption(padapter, pxmitframe); -+ -+ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); -+ return res; -+} -+ -+u32 rtw_sms4_decrypt(_adapter *padapter, u8 *precvframe) -+{ -+ u8 *pframe; -+ u32 res = _SUCCESS; -+ -+ WAPI_TRACE(WAPI_RX, "=========>%s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) { -+ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or enabled!\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+ -+ /* drop packet when hw decrypt fail -+ * return tempraily */ -+ return _FAIL; -+ -+ /* pframe=(unsigned char *)((union recv_frame*)precvframe)->u.hdr.rx_data; */ -+ -+ if (false == SecSWSMS4Decryption(padapter, precvframe, &padapter->recvpriv)) { -+ WAPI_TRACE(WAPI_ERR, "%s():SMS4 decrypt frame error\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+ WAPI_TRACE(WAPI_RX, "<=========%s\n", __FUNCTION__); -+ return res; -+} -+ -+#else -+ -+u32 rtw_sms4_encrypt(_adapter *padapter, u8 *pxmitframe) -+{ -+ WAPI_TRACE(WAPI_TX, "=========>Dummy %s\n", __FUNCTION__); -+ WAPI_TRACE(WAPI_TX, "<=========Dummy %s\n", __FUNCTION__); -+ return _SUCCESS; -+} -+ -+u32 rtw_sms4_decrypt(_adapter *padapter, u8 *precvframe) -+{ -+ WAPI_TRACE(WAPI_RX, "=========>Dummy %s\n", __FUNCTION__); -+ WAPI_TRACE(WAPI_RX, "<=========Dummy %s\n", __FUNCTION__); -+ return _SUCCESS; -+} -+ -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_wlan_util.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_wlan_util.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_wlan_util.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_wlan_util.c 2018-02-11 21:44:27.142146010 +0200 -@@ -0,0 +1,4844 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_WLAN_UTIL_C_ -+ -+#include -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ #include -+ #define ETH_TYPE_OFFSET 12 -+ #define PROTOCOL_OFFSET 23 -+ #define IP_OFFSET 30 -+#endif -+ -+unsigned char ARTHEROS_OUI1[] = {0x00, 0x03, 0x7f}; -+unsigned char ARTHEROS_OUI2[] = {0x00, 0x13, 0x74}; -+ -+unsigned char BROADCOM_OUI1[] = {0x00, 0x10, 0x18}; -+unsigned char BROADCOM_OUI2[] = {0x00, 0x0a, 0xf7}; -+unsigned char BROADCOM_OUI3[] = {0x00, 0x05, 0xb5}; -+ -+ -+unsigned char CISCO_OUI[] = {0x00, 0x40, 0x96}; -+unsigned char MARVELL_OUI[] = {0x00, 0x50, 0x43}; -+unsigned char RALINK_OUI[] = {0x00, 0x0c, 0x43}; -+unsigned char REALTEK_OUI[] = {0x00, 0xe0, 0x4c}; -+unsigned char AIRGOCAP_OUI[] = {0x00, 0x0a, 0xf5}; -+ -+unsigned char REALTEK_96B_IE[] = {0x00, 0xe0, 0x4c, 0x02, 0x01, 0x20}; -+ -+extern unsigned char RTW_WPA_OUI[]; -+extern unsigned char WPA_TKIP_CIPHER[4]; -+extern unsigned char RSN_TKIP_CIPHER[4]; -+ -+#define R2T_PHY_DELAY (0) -+ -+/* #define WAIT_FOR_BCN_TO_MIN (3000) */ -+#define WAIT_FOR_BCN_TO_MIN (6000) -+#define WAIT_FOR_BCN_TO_MAX (20000) -+ -+#define DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS 1000 -+#define DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD 3 -+ -+static u8 rtw_basic_rate_cck[4] = { -+ IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK, -+ IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK -+}; -+ -+static u8 rtw_basic_rate_ofdm[3] = { -+ IEEE80211_OFDM_RATE_6MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_OFDM_RATE_12MB | IEEE80211_BASIC_RATE_MASK, -+ IEEE80211_OFDM_RATE_24MB | IEEE80211_BASIC_RATE_MASK -+}; -+ -+static u8 rtw_basic_rate_mix[7] = { -+ IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK, -+ IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK, -+ IEEE80211_OFDM_RATE_6MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_OFDM_RATE_12MB | IEEE80211_BASIC_RATE_MASK, -+ IEEE80211_OFDM_RATE_24MB | IEEE80211_BASIC_RATE_MASK -+}; -+ -+int new_bcn_max = 3; -+ -+int cckrates_included(unsigned char *rate, int ratelen) -+{ -+ int i; -+ -+ for (i = 0; i < ratelen; i++) { -+ if ((((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || -+ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22)) -+ return _TRUE; -+ } -+ -+ return _FALSE; -+ -+} -+ -+int cckratesonly_included(unsigned char *rate, int ratelen) -+{ -+ int i; -+ -+ for (i = 0; i < ratelen; i++) { -+ if ((((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && -+ (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22)) -+ return _FALSE; -+ } -+ -+ return _TRUE; -+} -+ -+#ifdef CONFIG_GET_RAID_BY_DRV -+s8 rtw_get_tx_nss(_adapter *adapter, struct sta_info *psta) -+{ -+ u8 rf_type = RF_1T1R, custom_rf_type, vht_mcs[2]; -+ s8 nss = 1; -+ -+ custom_rf_type = adapter->registrypriv.rf_config; -+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ if (!psta) -+ return nss; -+ -+ /* rf_config is dependent on efuse or sw config */ -+ if (custom_rf_type != RF_MAX_TYPE) -+ rf_type = custom_rf_type; -+ -+#ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) { -+ u8 vht_mcs[2]; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct vht_priv *pvhtpriv_ap = &pmlmepriv->vhtpriv; -+ -+ _rtw_memcpy(vht_mcs, psta->vhtpriv.vht_mcs_map, 2); -+ /* doesn't support 5~8 SS so far */ -+ vht_mcs[1] = 0xff; -+ switch (rf_type) { -+ case RF_1T1R: -+ case RF_1T2R: -+ vht_mcs[0] |= 0xfc; -+ break; -+ case RF_2T2R: -+ case RF_2T4R: -+ case RF_2T2R_GREEN: -+ case RF_2T3R: -+ vht_mcs[0] |= 0xf0; -+ break; -+ case RF_3T3R: -+ case RF_3T4R: -+ vht_mcs[0] |= 0xc0; -+ break; -+ default: -+ RTW_INFO("%s,%d, unknown rf type\n", __func__, __LINE__); -+ break; -+ } -+ nss = rtw_vht_mcsmap_to_nss(vht_mcs); -+ } else -+#endif /* CONFIG_80211AC_VHT */ -+ if (psta->htpriv.ht_option) { -+ u8 supp_mcs_set[4]; -+ -+ _rtw_memcpy(supp_mcs_set, psta->htpriv.ht_cap.supp_mcs_set, 4); -+ -+ switch (rf_type) { -+ case RF_1T1R: -+ case RF_1T2R: -+ supp_mcs_set[1] = supp_mcs_set[2] = supp_mcs_set[3] = 0; -+ break; -+ case RF_2T2R: -+ case RF_2T4R: -+ case RF_2T2R_GREEN: -+ case RF_2T3R: -+ supp_mcs_set[2] = supp_mcs_set[3] = 0; -+ break; -+ case RF_3T3R: -+ case RF_3T4R: -+ supp_mcs_set[3] = 0; -+ break; -+ default: -+ RTW_INFO("%s,%d, unknown rf type\n", __func__, __LINE__); -+ break; -+ } -+ nss = rtw_ht_mcsset_to_nss(supp_mcs_set); -+ } -+ -+ RTW_INFO("%s: %d SS, rf_type=%d\n", __func__, nss, rf_type); -+ return nss; -+} -+ -+u8 networktype_to_raid(_adapter *adapter, struct sta_info *psta) -+{ -+ unsigned char raid; -+ switch (psta->wireless_mode) { -+ case WIRELESS_11B: -+ raid = RATR_INX_WIRELESS_B; -+ break; -+ case WIRELESS_11A: -+ case WIRELESS_11G: -+ raid = RATR_INX_WIRELESS_G; -+ break; -+ case WIRELESS_11BG: -+ raid = RATR_INX_WIRELESS_GB; -+ break; -+ case WIRELESS_11_24N: -+ case WIRELESS_11_5N: -+ raid = RATR_INX_WIRELESS_N; -+ break; -+ case WIRELESS_11A_5N: -+ case WIRELESS_11G_24N: -+ raid = RATR_INX_WIRELESS_NG; -+ break; -+ case WIRELESS_11BG_24N: -+ raid = RATR_INX_WIRELESS_NGB; -+ break; -+ default: -+ raid = RATR_INX_WIRELESS_GB; -+ break; -+ -+ } -+ return raid; -+ -+} -+ -+u8 networktype_to_raid_ex(_adapter *adapter, struct sta_info *psta) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ u8 raid = RATEID_IDX_BGN_40M_1SS, cur_rf_type, rf_type, custom_rf_type; -+ s8 tx_nss; -+ -+ tx_nss = rtw_get_tx_nss(adapter, psta); -+ -+ switch (psta->wireless_mode) { -+ case WIRELESS_11B: -+ raid = RATEID_IDX_B; -+ break; -+ case WIRELESS_11A: -+ case WIRELESS_11G: -+ raid = RATEID_IDX_G; -+ break; -+ case WIRELESS_11BG: -+ raid = RATEID_IDX_BG; -+ break; -+ case WIRELESS_11_24N: -+ case WIRELESS_11_5N: -+ case WIRELESS_11A_5N: -+ case WIRELESS_11G_24N: -+ if (tx_nss == 1) -+ raid = RATEID_IDX_GN_N1SS; -+ else if (tx_nss == 2) -+ raid = RATEID_IDX_GN_N2SS; -+ else if (tx_nss == 3) -+ raid = RATEID_IDX_BGN_3SS; -+ else -+ RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); -+ break; -+ case WIRELESS_11B_24N: -+ case WIRELESS_11BG_24N: -+ if (psta->bw_mode == CHANNEL_WIDTH_20) { -+ if (tx_nss == 1) -+ raid = RATEID_IDX_BGN_20M_1SS_BN; -+ else if (tx_nss == 2) -+ raid = RATEID_IDX_BGN_20M_2SS_BN; -+ else if (tx_nss == 3) -+ raid = RATEID_IDX_BGN_3SS; -+ else -+ RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); -+ } else { -+ if (tx_nss == 1) -+ raid = RATEID_IDX_BGN_40M_1SS; -+ else if (tx_nss == 2) -+ raid = RATEID_IDX_BGN_40M_2SS; -+ else if (tx_nss == 3) -+ raid = RATEID_IDX_BGN_3SS; -+ else -+ RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); -+ } -+ break; -+#ifdef CONFIG_80211AC_VHT -+ case WIRELESS_11_5AC: -+ if (tx_nss == 1) -+ raid = RATEID_IDX_VHT_1SS; -+ else if (tx_nss == 2) -+ raid = RATEID_IDX_VHT_2SS; -+ else if (tx_nss == 3) -+ raid = RATEID_IDX_VHT_3SS; -+ else -+ RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); -+ break; -+ case WIRELESS_11_24AC: -+ if (psta->bw_mode >= CHANNEL_WIDTH_80) { -+ if (tx_nss == 1) -+ raid = RATEID_IDX_VHT_1SS; -+ else if (tx_nss == 2) -+ raid = RATEID_IDX_VHT_2SS; -+ else if (tx_nss == 3) -+ raid = RATEID_IDX_VHT_3SS; -+ else -+ RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); -+ } else { -+ if (tx_nss == 1) -+ raid = RATEID_IDX_MIX1; -+ else if (tx_nss == 2) -+ raid = RATEID_IDX_MIX2; -+ else if (tx_nss == 3) -+ raid = RATEID_IDX_VHT_3SS; -+ else -+ RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); -+ } -+ break; -+#endif -+ default: -+ RTW_INFO("unexpected wireless mode!(psta->wireless_mode=%x)\n", psta->wireless_mode); -+ break; -+ -+ } -+ -+ /* RTW_INFO("psta->wireless_mode=%x, tx_nss=%d\n", psta->wireless_mode, tx_nss); */ -+ -+ return raid; -+ -+} -+#endif -+u8 judge_network_type(_adapter *padapter, unsigned char *rate, int ratelen) -+{ -+ u8 network_type = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ if (pmlmeext->cur_channel > 14) { -+ if (pmlmeinfo->VHT_enable) -+ network_type = WIRELESS_11AC; -+ else if (pmlmeinfo->HT_enable) -+ network_type = WIRELESS_11_5N; -+ -+ network_type |= WIRELESS_11A; -+ } else { -+ if (pmlmeinfo->HT_enable) -+ network_type = WIRELESS_11_24N; -+ -+ if ((cckratesonly_included(rate, ratelen)) == _TRUE) -+ network_type |= WIRELESS_11B; -+ else if ((cckrates_included(rate, ratelen)) == _TRUE) -+ network_type |= WIRELESS_11BG; -+ else -+ network_type |= WIRELESS_11G; -+ } -+ -+ return network_type; -+} -+ -+unsigned char ratetbl_val_2wifirate(unsigned char rate); -+unsigned char ratetbl_val_2wifirate(unsigned char rate) -+{ -+ unsigned char val = 0; -+ -+ switch (rate & 0x7f) { -+ case 0: -+ val = IEEE80211_CCK_RATE_1MB; -+ break; -+ -+ case 1: -+ val = IEEE80211_CCK_RATE_2MB; -+ break; -+ -+ case 2: -+ val = IEEE80211_CCK_RATE_5MB; -+ break; -+ -+ case 3: -+ val = IEEE80211_CCK_RATE_11MB; -+ break; -+ -+ case 4: -+ val = IEEE80211_OFDM_RATE_6MB; -+ break; -+ -+ case 5: -+ val = IEEE80211_OFDM_RATE_9MB; -+ break; -+ -+ case 6: -+ val = IEEE80211_OFDM_RATE_12MB; -+ break; -+ -+ case 7: -+ val = IEEE80211_OFDM_RATE_18MB; -+ break; -+ -+ case 8: -+ val = IEEE80211_OFDM_RATE_24MB; -+ break; -+ -+ case 9: -+ val = IEEE80211_OFDM_RATE_36MB; -+ break; -+ -+ case 10: -+ val = IEEE80211_OFDM_RATE_48MB; -+ break; -+ -+ case 11: -+ val = IEEE80211_OFDM_RATE_54MB; -+ break; -+ -+ } -+ -+ return val; -+ -+} -+ -+int is_basicrate(_adapter *padapter, unsigned char rate); -+int is_basicrate(_adapter *padapter, unsigned char rate) -+{ -+ int i; -+ unsigned char val; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ for (i = 0; i < NumRates; i++) { -+ val = pmlmeext->basicrate[i]; -+ -+ if ((val != 0xff) && (val != 0xfe)) { -+ if (rate == ratetbl_val_2wifirate(val)) -+ return _TRUE; -+ } -+ } -+ -+ return _FALSE; -+} -+ -+unsigned int ratetbl2rateset(_adapter *padapter, unsigned char *rateset); -+unsigned int ratetbl2rateset(_adapter *padapter, unsigned char *rateset) -+{ -+ int i; -+ unsigned char rate; -+ unsigned int len = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ for (i = 0; i < NumRates; i++) { -+ rate = pmlmeext->datarate[i]; -+ -+ switch (rate) { -+ case 0xff: -+ return len; -+ -+ case 0xfe: -+ continue; -+ -+ default: -+ rate = ratetbl_val_2wifirate(rate); -+ -+ if (is_basicrate(padapter, rate) == _TRUE) -+ rate |= IEEE80211_BASIC_RATE_MASK; -+ -+ rateset[len] = rate; -+ len++; -+ break; -+ } -+ } -+ return len; -+} -+ -+void get_rate_set(_adapter *padapter, unsigned char *pbssrate, int *bssrate_len) -+{ -+ unsigned char supportedrates[NumRates]; -+ -+ _rtw_memset(supportedrates, 0, NumRates); -+ *bssrate_len = ratetbl2rateset(padapter, supportedrates); -+ _rtw_memcpy(pbssrate, supportedrates, *bssrate_len); -+} -+ -+void set_mcs_rate_by_mask(u8 *mcs_set, u32 mask) -+{ -+ u8 mcs_rate_1r = (u8)(mask & 0xff); -+ u8 mcs_rate_2r = (u8)((mask >> 8) & 0xff); -+ u8 mcs_rate_3r = (u8)((mask >> 16) & 0xff); -+ u8 mcs_rate_4r = (u8)((mask >> 24) & 0xff); -+ -+ mcs_set[0] &= mcs_rate_1r; -+ mcs_set[1] &= mcs_rate_2r; -+ mcs_set[2] &= mcs_rate_3r; -+ mcs_set[3] &= mcs_rate_4r; -+} -+ -+void UpdateBrateTbl( -+ IN PADAPTER Adapter, -+ IN u8 *mBratesOS -+) -+{ -+ u8 i; -+ u8 rate; -+ -+ /* 1M, 2M, 5.5M, 11M, 6M, 12M, 24M are mandatory. */ -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ rate = mBratesOS[i] & 0x7f; -+ switch (rate) { -+ case IEEE80211_CCK_RATE_1MB: -+ case IEEE80211_CCK_RATE_2MB: -+ case IEEE80211_CCK_RATE_5MB: -+ case IEEE80211_CCK_RATE_11MB: -+ case IEEE80211_OFDM_RATE_6MB: -+ case IEEE80211_OFDM_RATE_12MB: -+ case IEEE80211_OFDM_RATE_24MB: -+ mBratesOS[i] |= IEEE80211_BASIC_RATE_MASK; -+ break; -+ } -+ } -+ -+} -+ -+void UpdateBrateTblForSoftAP(u8 *bssrateset, u32 bssratelen) -+{ -+ u8 i; -+ u8 rate; -+ -+ for (i = 0; i < bssratelen; i++) { -+ rate = bssrateset[i] & 0x7f; -+ switch (rate) { -+ case IEEE80211_CCK_RATE_1MB: -+ case IEEE80211_CCK_RATE_2MB: -+ case IEEE80211_CCK_RATE_5MB: -+ case IEEE80211_CCK_RATE_11MB: -+ bssrateset[i] |= IEEE80211_BASIC_RATE_MASK; -+ break; -+ } -+ } -+ -+} -+void Set_MSR(_adapter *padapter, u8 type) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MEDIA_STATUS, (u8 *)(&type)); -+} -+ -+inline u8 rtw_get_oper_ch(_adapter *adapter) -+{ -+ return adapter_to_dvobj(adapter)->oper_channel; -+} -+ -+inline void rtw_set_oper_ch(_adapter *adapter, u8 ch) -+{ -+#ifdef DBG_CH_SWITCH -+ const int len = 128; -+ char msg[128] = {0}; -+ int cnt = 0; -+ int i = 0; -+#endif /* DBG_CH_SWITCH */ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ if (dvobj->oper_channel != ch) { -+ dvobj->on_oper_ch_time = rtw_get_current_time(); -+ -+#ifdef DBG_CH_SWITCH -+ cnt += snprintf(msg + cnt, len - cnt, "switch to ch %3u", ch); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ _adapter *iface = dvobj->padapters[i]; -+ cnt += snprintf(msg + cnt, len - cnt, " ["ADPT_FMT":", ADPT_ARG(iface)); -+ if (iface->mlmeextpriv.cur_channel == ch) -+ cnt += snprintf(msg + cnt, len - cnt, "C"); -+ else -+ cnt += snprintf(msg + cnt, len - cnt, "_"); -+ if (iface->wdinfo.listen_channel == ch && !rtw_p2p_chk_state(&iface->wdinfo, P2P_STATE_NONE)) -+ cnt += snprintf(msg + cnt, len - cnt, "L"); -+ else -+ cnt += snprintf(msg + cnt, len - cnt, "_"); -+ cnt += snprintf(msg + cnt, len - cnt, "]"); -+ } -+ -+ RTW_INFO(FUNC_ADPT_FMT" %s\n", FUNC_ADPT_ARG(adapter), msg); -+#endif /* DBG_CH_SWITCH */ -+ } -+ -+ dvobj->oper_channel = ch; -+} -+ -+inline u8 rtw_get_oper_bw(_adapter *adapter) -+{ -+ return adapter_to_dvobj(adapter)->oper_bwmode; -+} -+ -+inline void rtw_set_oper_bw(_adapter *adapter, u8 bw) -+{ -+ adapter_to_dvobj(adapter)->oper_bwmode = bw; -+} -+ -+inline u8 rtw_get_oper_choffset(_adapter *adapter) -+{ -+ return adapter_to_dvobj(adapter)->oper_ch_offset; -+} -+ -+inline void rtw_set_oper_choffset(_adapter *adapter, u8 offset) -+{ -+ adapter_to_dvobj(adapter)->oper_ch_offset = offset; -+} -+ -+u8 rtw_get_offset_by_chbw(u8 ch, u8 bw, u8 *r_offset) -+{ -+ u8 valid = 1; -+ u8 offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if (bw == CHANNEL_WIDTH_20) -+ goto exit; -+ -+ if (bw >= CHANNEL_WIDTH_80 && ch <= 14) { -+ valid = 0; -+ goto exit; -+ } -+ -+ if (ch >= 1 && ch <= 4) -+ offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else if (ch >= 5 && ch <= 9) { -+ if (*r_offset == HAL_PRIME_CHNL_OFFSET_LOWER || *r_offset == HAL_PRIME_CHNL_OFFSET_UPPER) -+ offset = *r_offset; /* both lower and upper is valid, obey input value */ -+ else -+ offset = HAL_PRIME_CHNL_OFFSET_UPPER; /* default use upper */ -+ } else if (ch >= 10 && ch <= 13) -+ offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else if (ch == 14) { -+ valid = 0; /* ch14 doesn't support 40MHz bandwidth */ -+ goto exit; -+ } else if (ch >= 36 && ch <= 177) { -+ switch (ch) { -+ case 36: -+ case 44: -+ case 52: -+ case 60: -+ case 100: -+ case 108: -+ case 116: -+ case 124: -+ case 132: -+ case 140: -+ case 149: -+ case 157: -+ case 165: -+ case 173: -+ offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ case 40: -+ case 48: -+ case 56: -+ case 64: -+ case 104: -+ case 112: -+ case 120: -+ case 128: -+ case 136: -+ case 144: -+ case 153: -+ case 161: -+ case 169: -+ case 177: -+ offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ default: -+ valid = 0; -+ break; -+ } -+ } else -+ valid = 0; -+ -+exit: -+ if (valid && r_offset) -+ *r_offset = offset; -+ return valid; -+} -+ -+u8 rtw_get_offset_by_ch(u8 channel) -+{ -+ u8 offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if (channel >= 1 && channel <= 4) -+ offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else if (channel >= 5 && channel <= 14) -+ offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else { -+ switch (channel) { -+ case 36: -+ case 44: -+ case 52: -+ case 60: -+ case 100: -+ case 108: -+ case 116: -+ case 124: -+ case 132: -+ case 149: -+ case 157: -+ offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ case 40: -+ case 48: -+ case 56: -+ case 64: -+ case 104: -+ case 112: -+ case 120: -+ case 128: -+ case 136: -+ case 153: -+ case 161: -+ offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ default: -+ offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ -+ } -+ -+ return offset; -+ -+} -+ -+u8 rtw_get_center_ch(u8 channel, u8 chnl_bw, u8 chnl_offset) -+{ -+ u8 center_ch = channel; -+ -+ if (chnl_bw == CHANNEL_WIDTH_80) { -+ if (channel == 36 || channel == 40 || channel == 44 || channel == 48) -+ center_ch = 42; -+ else if (channel == 52 || channel == 56 || channel == 60 || channel == 64) -+ center_ch = 58; -+ else if (channel == 100 || channel == 104 || channel == 108 || channel == 112) -+ center_ch = 106; -+ else if (channel == 116 || channel == 120 || channel == 124 || channel == 128) -+ center_ch = 122; -+ else if (channel == 132 || channel == 136 || channel == 140 || channel == 144) -+ center_ch = 138; -+ else if (channel == 149 || channel == 153 || channel == 157 || channel == 161) -+ center_ch = 155; -+ else if (channel == 165 || channel == 169 || channel == 173 || channel == 177) -+ center_ch = 171; -+ else if (channel <= 14) -+ center_ch = 7; -+ } else if (chnl_bw == CHANNEL_WIDTH_40) { -+ if (chnl_offset == HAL_PRIME_CHNL_OFFSET_LOWER) -+ center_ch = channel + 2; -+ else -+ center_ch = channel - 2; -+ } else if (chnl_bw == CHANNEL_WIDTH_20) -+ center_ch = channel; -+ else -+ rtw_warn_on(1); -+ -+ return center_ch; -+} -+ -+inline u32 rtw_get_on_oper_ch_time(_adapter *adapter) -+{ -+ return adapter_to_dvobj(adapter)->on_oper_ch_time; -+} -+ -+inline u32 rtw_get_on_cur_ch_time(_adapter *adapter) -+{ -+ if (adapter->mlmeextpriv.cur_channel == adapter_to_dvobj(adapter)->oper_channel) -+ return adapter_to_dvobj(adapter)->on_oper_ch_time; -+ else -+ return 0; -+} -+ -+void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char channel_offset, unsigned short bwmode) -+{ -+ u8 center_ch, chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+#if (defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW)) || defined(CONFIG_MCC_MODE) -+ u8 iqk_info_backup = _FALSE; -+#endif -+ -+ if (padapter->bNotifyChannelChange) -+ RTW_INFO("[%s] ch = %d, offset = %d, bwmode = %d\n", __FUNCTION__, channel, channel_offset, bwmode); -+ -+ center_ch = rtw_get_center_ch(channel, bwmode, channel_offset); -+ -+ if (bwmode == CHANNEL_WIDTH_80) { -+ if (center_ch > channel) -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else if (center_ch < channel) -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) { -+ /* driver doesn't set channel setting reg under MCC */ -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { -+ RTW_INFO("Warning: Do not set channel setting reg MCC mode\n"); -+ rtw_warn_on(1); -+ } -+ } -+#endif -+ -+#ifdef CONFIG_DFS_MASTER -+ { -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); -+ bool ori_overlap_radar_detect_ch = rtw_rfctl_overlap_radar_detect_ch(rfctl); -+ bool new_overlap_radar_detect_ch = _rtw_rfctl_overlap_radar_detect_ch(rfctl, channel, bwmode, channel_offset); -+ -+ if (new_overlap_radar_detect_ch) -+ rtw_odm_radar_detect_enable(padapter); -+ -+ if (new_overlap_radar_detect_ch && IS_CH_WAITING(rfctl)) { -+ u8 pause = 0xFF; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &pause); -+ } -+#endif /* CONFIG_DFS_MASTER */ -+ -+ /* set Channel */ -+ /* saved channel/bw info */ -+ rtw_set_oper_ch(padapter, channel); -+ rtw_set_oper_bw(padapter, bwmode); -+ rtw_set_oper_choffset(padapter, channel_offset); -+ -+#if (defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW)) || defined(CONFIG_MCC_MODE) -+ /* To check if we need to backup iqk info after switch chnl & bw */ -+ { -+ u8 take_care_iqk, do_iqk; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk); -+ rtw_hal_get_hwreg(padapter, HW_VAR_DO_IQK, &do_iqk); -+ if ((take_care_iqk == _TRUE) && (do_iqk == _TRUE)) -+ iqk_info_backup = _TRUE; -+ } -+#endif -+ -+ rtw_hal_set_chnl_bw(padapter, center_ch, bwmode, channel_offset, chnl_offset80); /* set center channel */ -+ -+#if (defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW)) || defined(CONFIG_MCC_MODE) -+ if (iqk_info_backup == _TRUE) -+ rtw_hal_ch_sw_iqk_info_backup(padapter); -+#endif -+ -+#ifdef CONFIG_DFS_MASTER -+ if (ori_overlap_radar_detect_ch && !new_overlap_radar_detect_ch) { -+ u8 pause = 0x00; -+ -+ rtw_odm_radar_detect_disable(padapter); -+ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &pause); -+ } -+ } -+#endif /* CONFIG_DFS_MASTER */ -+ -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); -+} -+ -+int get_bsstype(unsigned short capability) -+{ -+ if (capability & BIT(0)) -+ return WIFI_FW_AP_STATE; -+ else if (capability & BIT(1)) -+ return WIFI_FW_ADHOC_STATE; -+ else -+ return 0; -+} -+ -+__inline u8 *get_my_bssid(WLAN_BSSID_EX *pnetwork) -+{ -+ return pnetwork->MacAddress; -+} -+ -+u16 get_beacon_interval(WLAN_BSSID_EX *bss) -+{ -+ unsigned short val; -+ _rtw_memcpy((unsigned char *)&val, rtw_get_beacon_interval_from_ie(bss->IEs), 2); -+ -+ return le16_to_cpu(val); -+ -+} -+ -+int is_client_associated_to_ap(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ -+ if (!padapter) -+ return _FAIL; -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE)) -+ return _TRUE; -+ else -+ return _FAIL; -+} -+ -+int is_client_associated_to_ibss(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) -+ return _TRUE; -+ else -+ return _FAIL; -+} -+ -+int is_IBSS_empty(_adapter *padapter) -+{ -+ int i; -+ struct macid_ctl_t *macid_ctl = &padapter->dvobj->macid_ctl; -+ -+ for (i = 0; i < macid_ctl->num; i++) { -+ if (!rtw_macid_is_used(macid_ctl, i)) -+ continue; -+ if (rtw_macid_get_if_g(macid_ctl, i) != padapter->iface_id) -+ continue; -+ if (!GET_H2CCMD_MSRRPT_PARM_OPMODE(&macid_ctl->h2c_msr[i])) -+ continue; -+ if (GET_H2CCMD_MSRRPT_PARM_ROLE(&macid_ctl->h2c_msr[i]) == H2C_MSR_ROLE_ADHOC) -+ return _FAIL; -+ } -+ -+ return _TRUE; -+} -+ -+unsigned int decide_wait_for_beacon_timeout(unsigned int bcn_interval) -+{ -+ if ((bcn_interval << 2) < WAIT_FOR_BCN_TO_MIN) -+ return WAIT_FOR_BCN_TO_MIN; -+ else if ((bcn_interval << 2) > WAIT_FOR_BCN_TO_MAX) -+ return WAIT_FOR_BCN_TO_MAX; -+ else -+ return bcn_interval << 2; -+} -+ -+void CAM_empty_entry( -+ PADAPTER Adapter, -+ u8 ucIndex -+) -+{ -+ rtw_hal_set_hwreg(Adapter, HW_VAR_CAM_EMPTY_ENTRY, (u8 *)(&ucIndex)); -+} -+ -+void invalidate_cam_all(_adapter *padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ u8 val8 = 0; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_INVALID_ALL, &val8); -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ rtw_sec_cam_map_clr_all(&cam_ctl->used); -+ _rtw_memset(dvobj->cam_cache, 0, sizeof(struct sec_cam_ent) * SEC_CAM_ENT_NUM_SW_LIMIT); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+} -+ -+void _clear_cam_entry(_adapter *padapter, u8 entry) -+{ -+ unsigned char null_sta[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ unsigned char null_key[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ -+ rtw_sec_write_cam_ent(padapter, entry, 0, null_sta, null_key); -+} -+ -+inline void write_cam(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) -+{ -+#ifdef CONFIG_WRITE_CACHE_ONLY -+ write_cam_cache(adapter, id , ctrl, mac, key); -+#else -+ rtw_sec_write_cam_ent(adapter, id, ctrl, mac, key); -+ write_cam_cache(adapter, id , ctrl, mac, key); -+#endif -+} -+ -+inline void clear_cam_entry(_adapter *adapter, u8 id) -+{ -+ _clear_cam_entry(adapter, id); -+ clear_cam_cache(adapter, id); -+} -+ -+inline void write_cam_from_cache(_adapter *adapter, u8 id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ struct sec_cam_ent cache; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ _rtw_memcpy(&cache, &dvobj->cam_cache[id], sizeof(struct sec_cam_ent)); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ rtw_sec_write_cam_ent(adapter, id, cache.ctrl, cache.mac, cache.key); -+} -+void write_cam_cache(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ -+ dvobj->cam_cache[id].ctrl = ctrl; -+ _rtw_memcpy(dvobj->cam_cache[id].mac, mac, ETH_ALEN); -+ _rtw_memcpy(dvobj->cam_cache[id].key, key, 16); -+ -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+} -+ -+void clear_cam_cache(_adapter *adapter, u8 id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ -+ _rtw_memset(&(dvobj->cam_cache[id]), 0, sizeof(struct sec_cam_ent)); -+ -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+} -+ -+inline bool _rtw_camctl_chk_cap(_adapter *adapter, u8 cap) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ if (cam_ctl->sec_cap & cap) -+ return _TRUE; -+ return _FALSE; -+} -+ -+inline void _rtw_camctl_set_flags(_adapter *adapter, u32 flags) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ cam_ctl->flags |= flags; -+} -+ -+inline void rtw_camctl_set_flags(_adapter *adapter, u32 flags) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ _rtw_camctl_set_flags(adapter, flags); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+} -+ -+inline void _rtw_camctl_clr_flags(_adapter *adapter, u32 flags) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ cam_ctl->flags &= ~flags; -+} -+ -+inline void rtw_camctl_clr_flags(_adapter *adapter, u32 flags) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ _rtw_camctl_clr_flags(adapter, flags); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+} -+ -+inline bool _rtw_camctl_chk_flags(_adapter *adapter, u32 flags) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ if (cam_ctl->flags & flags) -+ return _TRUE; -+ return _FALSE; -+} -+ -+void dump_sec_cam_map(void *sel, struct sec_cam_bmp *map, u8 max_num) -+{ -+ RTW_PRINT_SEL(sel, "0x%08x\n", map->m0); -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ if (max_num && max_num > 32) -+ RTW_PRINT_SEL(sel, "0x%08x\n", map->m1); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ if (max_num && max_num > 64) -+ RTW_PRINT_SEL(sel, "0x%08x\n", map->m2); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ if (max_num && max_num > 96) -+ RTW_PRINT_SEL(sel, "0x%08x\n", map->m3); -+#endif -+} -+ -+inline bool rtw_sec_camid_is_set(struct sec_cam_bmp *map, u8 id) -+{ -+ if (id < 32) -+ return map->m0 & BIT(id); -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ return map->m1 & BIT(id - 32); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ return map->m2 & BIT(id - 64); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ return map->m3 & BIT(id - 96); -+#endif -+ else -+ rtw_warn_on(1); -+ -+ return 0; -+} -+ -+inline void rtw_sec_cam_map_set(struct sec_cam_bmp *map, u8 id) -+{ -+ if (id < 32) -+ map->m0 |= BIT(id); -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ map->m1 |= BIT(id - 32); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ map->m2 |= BIT(id - 64); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ map->m3 |= BIT(id - 96); -+#endif -+ else -+ rtw_warn_on(1); -+} -+ -+inline void rtw_sec_cam_map_clr(struct sec_cam_bmp *map, u8 id) -+{ -+ if (id < 32) -+ map->m0 &= ~BIT(id); -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ map->m1 &= ~BIT(id - 32); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ map->m2 &= ~BIT(id - 64); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ map->m3 &= ~BIT(id - 96); -+#endif -+ else -+ rtw_warn_on(1); -+} -+ -+inline void rtw_sec_cam_map_clr_all(struct sec_cam_bmp *map) -+{ -+ map->m0 = 0; -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ map->m1 = 0; -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ map->m2 = 0; -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ map->m3 = 0; -+#endif -+} -+ -+inline bool rtw_sec_camid_is_drv_forbid(struct cam_ctl_t *cam_ctl, u8 id) -+{ -+ struct sec_cam_bmp forbid_map; -+ -+ forbid_map.m0 = 0x00000ff0; -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ forbid_map.m1 = 0x00000000; -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ forbid_map.m2 = 0x00000000; -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ forbid_map.m3 = 0x00000000; -+#endif -+ -+ if (id < 32) -+ return forbid_map.m0 & BIT(id); -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ return forbid_map.m1 & BIT(id - 32); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ return forbid_map.m2 & BIT(id - 64); -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ return forbid_map.m3 & BIT(id - 96); -+#endif -+ else -+ rtw_warn_on(1); -+ -+ return 1; -+} -+ -+bool _rtw_sec_camid_is_used(struct cam_ctl_t *cam_ctl, u8 id) -+{ -+ bool ret = _FALSE; -+ -+ if (id >= cam_ctl->num) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+#if 0 /* for testing */ -+ if (rtw_sec_camid_is_drv_forbid(cam_ctl, id)) { -+ ret = _TRUE; -+ goto exit; -+ } -+#endif -+ -+ ret = rtw_sec_camid_is_set(&cam_ctl->used, id); -+ -+exit: -+ return ret; -+} -+ -+inline bool rtw_sec_camid_is_used(struct cam_ctl_t *cam_ctl, u8 id) -+{ -+ _irqL irqL; -+ bool ret; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ ret = _rtw_sec_camid_is_used(cam_ctl, id); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ return ret; -+} -+u8 rtw_get_sec_camid(_adapter *adapter, u8 max_bk_key_num, u8 *sec_key_id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ int i; -+ _irqL irqL; -+ u8 sec_cam_num = 0; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ for (i = 0; i < cam_ctl->num; i++) { -+ if (_rtw_sec_camid_is_used(cam_ctl, i)) { -+ sec_key_id[sec_cam_num++] = i; -+ if (sec_cam_num == max_bk_key_num) -+ break; -+ } -+ } -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ return sec_cam_num; -+} -+ -+inline bool _rtw_camid_is_gk(_adapter *adapter, u8 cam_id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ bool ret = _FALSE; -+ -+ if (cam_id >= cam_ctl->num) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (_rtw_sec_camid_is_used(cam_ctl, cam_id) == _FALSE) -+ goto exit; -+ -+ ret = (dvobj->cam_cache[cam_id].ctrl & BIT6) ? _TRUE : _FALSE; -+ -+exit: -+ return ret; -+} -+ -+inline bool rtw_camid_is_gk(_adapter *adapter, u8 cam_id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ bool ret; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ ret = _rtw_camid_is_gk(adapter, cam_id); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ return ret; -+} -+ -+bool cam_cache_chk(_adapter *adapter, u8 id, u8 *addr, s16 kid, s8 gk) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ bool ret = _FALSE; -+ -+ if (addr && _rtw_memcmp(dvobj->cam_cache[id].mac, addr, ETH_ALEN) == _FALSE) -+ goto exit; -+ if (kid >= 0 && kid != (dvobj->cam_cache[id].ctrl & 0x03)) -+ goto exit; -+ if (gk != -1 && (gk ? _TRUE : _FALSE) != _rtw_camid_is_gk(adapter, id)) -+ goto exit; -+ -+ ret = _TRUE; -+ -+exit: -+ return ret; -+} -+ -+s16 _rtw_camid_search(_adapter *adapter, u8 *addr, s16 kid, s8 gk) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ int i; -+ s16 cam_id = -1; -+ -+ for (i = 0; i < cam_ctl->num; i++) { -+ if (cam_cache_chk(adapter, i, addr, kid, gk)) { -+ cam_id = i; -+ break; -+ } -+ } -+ -+ if (0) { -+ if (addr) -+ RTW_INFO(FUNC_ADPT_FMT" addr:"MAC_FMT" kid:%d, gk:%d, return cam_id:%d\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), kid, gk, cam_id); -+ else -+ RTW_INFO(FUNC_ADPT_FMT" addr:%p kid:%d, gk:%d, return cam_id:%d\n" -+ , FUNC_ADPT_ARG(adapter), addr, kid, gk, cam_id); -+ } -+ -+ return cam_id; -+} -+ -+s16 rtw_camid_search(_adapter *adapter, u8 *addr, s16 kid, s8 gk) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ s16 cam_id = -1; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ cam_id = _rtw_camid_search(adapter, addr, kid, gk); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ return cam_id; -+} -+ -+s16 rtw_get_camid(_adapter *adapter, struct sta_info *sta, u8 *addr, s16 kid) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ int i; -+#if 0 /* for testing */ -+ static u8 start_id = 0; -+#else -+ u8 start_id = 0; -+#endif -+ s16 cam_id = -1; -+ -+ if (addr == NULL) { -+ RTW_PRINT(FUNC_ADPT_FMT" mac_address is NULL\n" -+ , FUNC_ADPT_ARG(adapter)); -+ rtw_warn_on(1); -+ goto _exit; -+ } -+ -+ /* find cam entry which has the same addr, kid (, gk bit) */ -+ if (_rtw_camctl_chk_cap(adapter, SEC_CAP_CHK_BMC) == _TRUE) -+ i = _rtw_camid_search(adapter, addr, kid, sta ? _FALSE : _TRUE); -+ else -+ i = _rtw_camid_search(adapter, addr, kid, -1); -+ -+ if (i >= 0) { -+ cam_id = i; -+ goto _exit; -+ } -+ -+ for (i = 0; i < cam_ctl->num; i++) { -+ /* bypass default key which is allocated statically */ -+#ifndef CONFIG_CONCURRENT_MODE -+ if (((i + start_id) % cam_ctl->num) < 4) -+ continue; -+#endif -+ if (_rtw_sec_camid_is_used(cam_ctl, ((i + start_id) % cam_ctl->num)) == _FALSE) -+ break; -+ } -+ -+ if (i == cam_ctl->num) { -+ if (sta) -+ RTW_PRINT(FUNC_ADPT_FMT" pairwise key with "MAC_FMT" id:%u no room\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), kid); -+ else -+ RTW_PRINT(FUNC_ADPT_FMT" group key with "MAC_FMT" id:%u no room\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), kid); -+ rtw_warn_on(1); -+ goto _exit; -+ } -+ -+ cam_id = ((i + start_id) % cam_ctl->num); -+ start_id = ((i + start_id + 1) % cam_ctl->num); -+ -+_exit: -+ return cam_id; -+} -+ -+s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, bool *used) -+{ -+ struct mlme_ext_info *mlmeinfo = &adapter->mlmeextpriv.mlmext_info; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ s16 cam_id = -1; -+ -+ *used = _FALSE; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ -+ if ((((mlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) || ((mlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) -+ && !sta) { -+#ifndef CONFIG_CONCURRENT_MODE -+ /* AP/Ad-hoc mode group key static alloction to default key by key ID on Non-concurrent*/ -+ if (kid > 3) { -+ RTW_PRINT(FUNC_ADPT_FMT" group key with invalid key id:%u\n" -+ , FUNC_ADPT_ARG(adapter), kid); -+ rtw_warn_on(1); -+ goto bitmap_handle; -+ } -+ cam_id = kid; -+#else -+ u8 *addr = adapter_mac_addr(adapter); -+ -+ cam_id = rtw_get_camid(adapter, sta, addr, kid); -+ if (1) -+ RTW_PRINT(FUNC_ADPT_FMT" group key with "MAC_FMT" assigned cam_id:%u\n" -+ , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), cam_id); -+#endif -+ } else { -+ u8 *addr = sta ? sta->hwaddr : NULL; -+ -+ if (!sta) { -+ if (!(mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { -+ /* bypass STA mode group key setting before connected(ex:WEP) because bssid is not ready */ -+ goto bitmap_handle; -+ } -+ addr = get_bssid(&adapter->mlmepriv);/*A2*/ -+ } -+ cam_id = rtw_get_camid(adapter, sta, addr, kid); -+ } -+ -+ -+bitmap_handle: -+ if (cam_id >= 0) { -+ *used = _rtw_sec_camid_is_used(cam_ctl, cam_id); -+ rtw_sec_cam_map_set(&cam_ctl->used, cam_id); -+ } -+ -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ return cam_id; -+} -+ -+void rtw_camid_set(_adapter *adapter, u8 cam_id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ -+ if (cam_id < cam_ctl->num) -+ rtw_sec_cam_map_set(&cam_ctl->used, cam_id); -+ -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+} -+ -+void rtw_camid_free(_adapter *adapter, u8 cam_id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ -+ if (cam_id < cam_ctl->num) -+ rtw_sec_cam_map_clr(&cam_ctl->used, cam_id); -+ -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+} -+ -+/*Must pause TX/RX before use this API*/ -+inline void rtw_sec_cam_swap(_adapter *adapter, u8 cam_id_a, u8 cam_id_b) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ struct sec_cam_ent cache_a, cache_b; -+ _irqL irqL; -+ bool cam_a_used, cam_b_used; -+ -+ if (1) -+ RTW_INFO(ADPT_FMT" - sec_cam %d,%d swap\n", ADPT_ARG(adapter), cam_id_a, cam_id_b); -+ -+ if (cam_id_a == cam_id_b) -+ return; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_mi_update_ap_bmc_camid(adapter, cam_id_a, cam_id_b); -+#endif -+ -+ /*setp-1. backup org cam_info*/ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ -+ cam_a_used = _rtw_sec_camid_is_used(cam_ctl, cam_id_a); -+ cam_b_used = _rtw_sec_camid_is_used(cam_ctl, cam_id_b); -+ -+ if (cam_a_used) -+ _rtw_memcpy(&cache_a, &dvobj->cam_cache[cam_id_a], sizeof(struct sec_cam_ent)); -+ -+ if (cam_b_used) -+ _rtw_memcpy(&cache_b, &dvobj->cam_cache[cam_id_b], sizeof(struct sec_cam_ent)); -+ -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ /*setp-2. clean cam_info*/ -+ if (cam_a_used) { -+ rtw_camid_free(adapter, cam_id_a); -+ clear_cam_entry(adapter, cam_id_a); -+ } -+ if (cam_b_used) { -+ rtw_camid_free(adapter, cam_id_b); -+ clear_cam_entry(adapter, cam_id_b); -+ } -+ -+ /*setp-3. set cam_info*/ -+ if (cam_a_used) { -+ write_cam(adapter, cam_id_b, cache_a.ctrl, cache_a.mac, cache_a.key); -+ rtw_camid_set(adapter, cam_id_b); -+ } -+ -+ if (cam_b_used) { -+ write_cam(adapter, cam_id_a, cache_b.ctrl, cache_b.mac, cache_b.key); -+ rtw_camid_set(adapter, cam_id_a); -+ } -+} -+ -+s16 rtw_get_empty_cam_entry(_adapter *adapter, u8 start_camid) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ int i; -+ s16 cam_id = -1; -+ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ for (i = start_camid; i < cam_ctl->num; i++) { -+ if (_FALSE == _rtw_sec_camid_is_used(cam_ctl, i)) { -+ cam_id = i; -+ break; -+ } -+ } -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+ return cam_id; -+} -+void rtw_clean_dk_section(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = dvobj_to_sec_camctl(dvobj); -+ s16 ept_cam_id; -+ int i; -+ -+ for (i = 0; i < 4; i++) { -+ if (rtw_sec_camid_is_used(cam_ctl, i)) { -+ ept_cam_id = rtw_get_empty_cam_entry(adapter, 4); -+ if (ept_cam_id > 0) -+ rtw_sec_cam_swap(adapter, i, ept_cam_id); -+ } -+ } -+} -+void rtw_clean_hw_dk_cam(_adapter *adapter) -+{ -+ int i; -+ -+ for (i = 0; i < 4; i++) -+ rtw_sec_clr_cam_ent(adapter, i); -+ /*_clear_cam_entry(adapter, i);*/ -+} -+ -+void flush_all_cam_entry(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv *psecpriv = &padapter->securitypriv; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ -+ psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); -+ if (psta) { -+ if (psta->state & WIFI_AP_STATE) { -+ /*clear cam when ap free per sta_info*/ -+ } else -+ rtw_clearstakey_cmd(padapter, psta, _FALSE); -+ } -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+#if 1 -+ int cam_id = -1; -+ u8 *addr = adapter_mac_addr(padapter); -+ -+ while ((cam_id = rtw_camid_search(padapter, addr, -1, -1)) >= 0) { -+ RTW_PRINT("clear wep or group key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(addr), cam_id); -+ clear_cam_entry(padapter, cam_id); -+ rtw_camid_free(padapter, cam_id); -+ } -+#else -+ /* clear default key */ -+ int i, cam_id; -+ u8 null_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; -+ -+ for (i = 0; i < 4; i++) { -+ cam_id = rtw_camid_search(padapter, null_addr, i, -1); -+ if (cam_id >= 0) { -+ clear_cam_entry(padapter, cam_id); -+ rtw_camid_free(padapter, cam_id); -+ } -+ } -+ /* clear default key related key search setting */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8 *)_FALSE); -+#endif -+ } -+ -+#else /*NON CONFIG_CONCURRENT_MODE*/ -+ -+ invalidate_cam_all(padapter); -+ /* clear default key related key search setting */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8 *)_FALSE); -+#endif -+} -+ -+#if defined(CONFIG_P2P) && defined(CONFIG_WFD) -+void rtw_process_wfd_ie(_adapter *adapter, u8 *wfd_ie, u8 wfd_ielen, const char *tag) -+{ -+ struct wifidirect_info *wdinfo = &adapter->wdinfo; -+ -+ u8 *attr_content; -+ u32 attr_contentlen = 0; -+ -+ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) -+ return; -+ -+ RTW_INFO("[%s] Found WFD IE\n", tag); -+ attr_content = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &attr_contentlen); -+ if (attr_content && attr_contentlen) { -+ wdinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16(attr_content + 2); -+ RTW_INFO("[%s] Peer PORT NUM = %d\n", tag, wdinfo->wfd_info->peer_rtsp_ctrlport); -+ } -+} -+ -+void rtw_process_wfd_ies(_adapter *adapter, u8 *ies, u8 ies_len, const char *tag) -+{ -+ u8 *wfd_ie; -+ u32 wfd_ielen; -+ -+ if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) -+ return; -+ -+ wfd_ie = rtw_get_wfd_ie(ies, ies_len, NULL, &wfd_ielen); -+ while (wfd_ie) { -+ rtw_process_wfd_ie(adapter, wfd_ie, wfd_ielen, tag); -+ wfd_ie = rtw_get_wfd_ie(wfd_ie + wfd_ielen, (ies + ies_len) - (wfd_ie + wfd_ielen), NULL, &wfd_ielen); -+ } -+} -+#endif /* defined(CONFIG_P2P) && defined(CONFIG_WFD) */ -+ -+int WMM_param_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ /* struct registry_priv *pregpriv = &padapter->registrypriv; */ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pmlmepriv->qospriv.qos_option == 0) { -+ pmlmeinfo->WMM_enable = 0; -+ return _FALSE; -+ } -+ -+ if (_rtw_memcmp(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element))) -+ return _FALSE; -+ else -+ _rtw_memcpy(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element)); -+ pmlmeinfo->WMM_enable = 1; -+ return _TRUE; -+ -+#if 0 -+ if (pregpriv->wifi_spec == 1) { -+ if (pmlmeinfo->WMM_enable == 1) { -+ /* todo: compare the parameter set count & decide wheher to update or not */ -+ return _FAIL; -+ } else { -+ pmlmeinfo->WMM_enable = 1; -+ _rtw_rtw_memcpy(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element)); -+ return _TRUE; -+ } -+ } else { -+ pmlmeinfo->WMM_enable = 0; -+ return _FAIL; -+ } -+#endif -+ -+} -+ -+void WMMOnAssocRsp(_adapter *padapter) -+{ -+ u8 ACI, ACM, AIFS, ECWMin, ECWMax, aSifsTime; -+ u8 acm_mask; -+ u16 TXOP; -+ u32 acParm, i; -+ u32 edca[4], inx[4]; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ acm_mask = 0; -+ -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || -+ (pmlmeext->cur_wireless_mode & WIRELESS_11_24N)) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ if (pmlmeinfo->WMM_enable == 0) { -+ padapter->mlmepriv.acm_mask = 0; -+ -+ AIFS = aSifsTime + (2 * pmlmeinfo->slotTime); -+ -+ if (pmlmeext->cur_wireless_mode & (WIRELESS_11G | WIRELESS_11A)) { -+ ECWMin = 4; -+ ECWMax = 10; -+ } else if (pmlmeext->cur_wireless_mode & WIRELESS_11B) { -+ ECWMin = 5; -+ ECWMax = 10; -+ } else { -+ ECWMin = 4; -+ ECWMax = 10; -+ } -+ -+ TXOP = 0; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); -+ -+ ECWMin = 2; -+ ECWMax = 3; -+ TXOP = 0x2f; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); -+ } else { -+ edca[0] = edca[1] = edca[2] = edca[3] = 0; -+ -+ for (i = 0; i < 4; i++) { -+ ACI = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 5) & 0x03; -+ ACM = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 4) & 0x01; -+ -+ /* AIFS = AIFSN * slot time + SIFS - r2t phy delay */ -+ AIFS = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN & 0x0f) * pmlmeinfo->slotTime + aSifsTime; -+ -+ ECWMin = (pmlmeinfo->WMM_param.ac_param[i].CW & 0x0f); -+ ECWMax = (pmlmeinfo->WMM_param.ac_param[i].CW & 0xf0) >> 4; -+ TXOP = le16_to_cpu(pmlmeinfo->WMM_param.ac_param[i].TXOP_limit); -+ -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ -+ switch (ACI) { -+ case 0x0: -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); -+ acm_mask |= (ACM ? BIT(1) : 0); -+ edca[XMIT_BE_QUEUE] = acParm; -+ break; -+ -+ case 0x1: -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); -+ /* acm_mask |= (ACM? BIT(0):0); */ -+ edca[XMIT_BK_QUEUE] = acParm; -+ break; -+ -+ case 0x2: -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); -+ acm_mask |= (ACM ? BIT(2) : 0); -+ edca[XMIT_VI_QUEUE] = acParm; -+ break; -+ -+ case 0x3: -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); -+ acm_mask |= (ACM ? BIT(3) : 0); -+ edca[XMIT_VO_QUEUE] = acParm; -+ break; -+ } -+ -+ RTW_INFO("WMM(%x): %x, %x\n", ACI, ACM, acParm); -+ } -+ -+ if (padapter->registrypriv.acm_method == 1) -+ rtw_hal_set_hwreg(padapter, HW_VAR_ACM_CTRL, (u8 *)(&acm_mask)); -+ else -+ padapter->mlmepriv.acm_mask = acm_mask; -+ -+ inx[0] = 0; -+ inx[1] = 1; -+ inx[2] = 2; -+ inx[3] = 3; -+ -+ if (pregpriv->wifi_spec == 1) { -+ u32 j, tmp, change_inx = _FALSE; -+ -+ /* entry indx: 0->vo, 1->vi, 2->be, 3->bk. */ -+ for (i = 0; i < 4; i++) { -+ for (j = i + 1; j < 4; j++) { -+ /* compare CW and AIFS */ -+ if ((edca[j] & 0xFFFF) < (edca[i] & 0xFFFF)) -+ change_inx = _TRUE; -+ else if ((edca[j] & 0xFFFF) == (edca[i] & 0xFFFF)) { -+ /* compare TXOP */ -+ if ((edca[j] >> 16) > (edca[i] >> 16)) -+ change_inx = _TRUE; -+ } -+ -+ if (change_inx) { -+ tmp = edca[i]; -+ edca[i] = edca[j]; -+ edca[j] = tmp; -+ -+ tmp = inx[i]; -+ inx[i] = inx[j]; -+ inx[j] = tmp; -+ -+ change_inx = _FALSE; -+ } -+ } -+ } -+ } -+ -+ for (i = 0; i < 4; i++) { -+ pxmitpriv->wmm_para_seq[i] = inx[i]; -+ RTW_INFO("wmm_para_seq(%d): %d\n", i, pxmitpriv->wmm_para_seq[i]); -+ } -+ } -+} -+ -+static void bwmode_update_check(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+#ifdef CONFIG_80211N_HT -+ unsigned char new_bwmode; -+ unsigned char new_ch_offset; -+ struct HT_info_element *pHT_info; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ u8 cbw40_enable = 0; -+ -+ if (!pIE) -+ return; -+ -+ if (phtpriv->ht_option == _FALSE) -+ return; -+ -+ if (pmlmeext->cur_bwmode >= CHANNEL_WIDTH_80) -+ return; -+ -+ if (pIE->Length > sizeof(struct HT_info_element)) -+ return; -+ -+ pHT_info = (struct HT_info_element *)pIE->data; -+ -+ if (hal_chk_bw_cap(padapter, BW_CAP_40M)) { -+ if (pmlmeext->cur_channel > 14) { -+ if (REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) -+ cbw40_enable = 1; -+ } else { -+ if (REGSTY_IS_BW_2G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) -+ cbw40_enable = 1; -+ } -+ } -+ -+ if ((pHT_info->infos[0] & BIT(2)) && cbw40_enable) { -+ new_bwmode = CHANNEL_WIDTH_40; -+ -+ switch (pHT_info->infos[0] & 0x3) { -+ case 1: -+ new_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case 3: -+ new_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ new_bwmode = CHANNEL_WIDTH_20; -+ new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ } else { -+ new_bwmode = CHANNEL_WIDTH_20; -+ new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ -+ if ((new_bwmode != pmlmeext->cur_bwmode || new_ch_offset != pmlmeext->cur_ch_offset) -+ && new_bwmode < pmlmeext->cur_bwmode -+ ) { -+ pmlmeinfo->bwmode_updated = _TRUE; -+ -+ pmlmeext->cur_bwmode = new_bwmode; -+ pmlmeext->cur_ch_offset = new_ch_offset; -+ -+ /* update HT info also */ -+ HT_info_handler(padapter, pIE); -+ } else -+ pmlmeinfo->bwmode_updated = _FALSE; -+ -+ -+ if (_TRUE == pmlmeinfo->bwmode_updated) { -+ struct sta_info *psta; -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ /* set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */ -+ -+ -+ /* update ap's stainfo */ -+ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); -+ if (psta) { -+ struct ht_priv *phtpriv_sta = &psta->htpriv; -+ -+ if (phtpriv_sta->ht_option) { -+ /* bwmode */ -+ psta->bw_mode = pmlmeext->cur_bwmode; -+ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; -+ } else { -+ psta->bw_mode = CHANNEL_WIDTH_20; -+ phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta); -+ } -+ -+ /* pmlmeinfo->bwmode_updated = _FALSE; */ /* bwmode_updated done, reset it! */ -+ } -+#endif /* CONFIG_80211N_HT */ -+} -+ -+void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+#ifdef CONFIG_80211N_HT -+ unsigned int i; -+ u8 rf_type = RF_1T1R; -+ u8 max_AMPDU_len, min_MPDU_spacing; -+ u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ if (pIE == NULL) -+ return; -+ -+ if (phtpriv->ht_option == _FALSE) -+ return; -+ -+ pmlmeinfo->HT_caps_enable = 1; -+ -+ for (i = 0; i < (pIE->Length); i++) { -+ if (i != 2) { -+ /* Commented by Albert 2010/07/12 */ -+ /* Got the endian issue here. */ -+ pmlmeinfo->HT_caps.u.HT_cap[i] &= (pIE->data[i]); -+ } else { -+ /* AMPDU Parameters field */ -+ -+ /* Get MIN of MAX AMPDU Length Exp */ -+ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3) > (pIE->data[i] & 0x3)) -+ max_AMPDU_len = (pIE->data[i] & 0x3); -+ else -+ max_AMPDU_len = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3); -+ -+ /* Get MAX of MIN MPDU Start Spacing */ -+ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) > (pIE->data[i] & 0x1c)) -+ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c); -+ else -+ min_MPDU_spacing = (pIE->data[i] & 0x1c); -+ -+ pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para = max_AMPDU_len | min_MPDU_spacing; -+ } -+ } -+ -+ /* Commented by Albert 2010/07/12 */ -+ /* Have to handle the endian issue after copying. */ -+ /* HT_ext_caps didn't be used yet. */ -+ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info = le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info); -+ pmlmeinfo->HT_caps.u.HT_cap_element.HT_ext_caps = le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_ext_caps); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ -+ /* update the MCS set */ -+ for (i = 0; i < 16; i++) -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= pmlmeext->default_supported_mcs_set[i]; -+ -+ /* update the MCS rates */ -+ switch (rf_type) { -+ case RF_1T1R: -+ case RF_1T2R: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R); -+ break; -+ case RF_2T2R: -+#ifdef CONFIG_DISABLE_MCS13TO15 -+ if (pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && pregistrypriv->wifi_spec != 1) -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R_13TO15_OFF); -+ else -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+#else /* CONFIG_DISABLE_MCS13TO15 */ -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -+#endif /* CONFIG_DISABLE_MCS13TO15 */ -+ break; -+ case RF_3T3R: -+ set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_3R); -+ break; -+ default: -+ RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ /* Config STBC setting */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_TX_STBC(pIE->data)) { -+ SET_FLAG(cur_stbc_cap, STBC_HT_ENABLE_TX); -+ RTW_INFO("Enable HT Tx STBC !\n"); -+ } -+ phtpriv->stbc_cap = cur_stbc_cap; -+ -+#ifdef CONFIG_BEAMFORMING -+ /* Config Tx beamforming setting */ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pIE->data)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); -+ /* Shift to BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(pIE->data) << 6); -+ } -+ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pIE->data)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); -+ /* Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pIE->data) << 4); -+ } -+ phtpriv->beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) -+ RTW_INFO("AP HT Beamforming Cap = 0x%02X\n", cur_beamform_cap); -+#endif /*CONFIG_BEAMFORMING*/ -+ } else { -+ /*WIFI_STATION_STATEorI_ADHOC_STATE or WIFI_ADHOC_MASTER_STATE*/ -+ /* Config LDPC Coding Capability */ -+ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX) && GET_HT_CAP_ELE_LDPC_CAP(pIE->data)) { -+ SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX)); -+ RTW_INFO("Enable HT Tx LDPC!\n"); -+ } -+ phtpriv->ldpc_cap = cur_ldpc_cap; -+ -+ /* Config STBC setting */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_RX_STBC(pIE->data)) { -+ SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX)); -+ RTW_INFO("Enable HT Tx STBC!\n"); -+ } -+ phtpriv->stbc_cap = cur_stbc_cap; -+ -+#ifdef CONFIG_BEAMFORMING -+ /* Config Tx beamforming setting */ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pIE->data)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); -+ /* Shift to BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(pIE->data) << 6); -+ } -+ -+ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && -+ GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pIE->data)) { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); -+ /* Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ -+ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pIE->data) << 4); -+ } -+ phtpriv->beamform_cap = cur_beamform_cap; -+ if (cur_beamform_cap) -+ RTW_INFO("Client HT Beamforming Cap = 0x%02X\n", cur_beamform_cap); -+#endif /*CONFIG_BEAMFORMING*/ -+ } -+ -+#endif /* CONFIG_80211N_HT */ -+} -+ -+void HT_info_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+#ifdef CONFIG_80211N_HT -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ -+ if (pIE == NULL) -+ return; -+ -+ if (phtpriv->ht_option == _FALSE) -+ return; -+ -+ -+ if (pIE->Length > sizeof(struct HT_info_element)) -+ return; -+ -+ pmlmeinfo->HT_info_enable = 1; -+ _rtw_memcpy(&(pmlmeinfo->HT_info), pIE->data, pIE->Length); -+#endif /* CONFIG_80211N_HT */ -+ return; -+} -+ -+void HTOnAssocRsp(_adapter *padapter) -+{ -+ unsigned char max_AMPDU_len; -+ unsigned char min_MPDU_spacing; -+ /* struct registry_priv *pregpriv = &padapter->registrypriv; */ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable)) -+ pmlmeinfo->HT_enable = 1; -+ else { -+ pmlmeinfo->HT_enable = 0; -+ /* set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */ -+ return; -+ } -+ -+ /* handle A-MPDU parameter field */ -+ /* -+ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k -+ AMPDU_para [4:2]:Min MPDU Start Spacing -+ */ -+ max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; -+ -+ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len)); -+ -+#if 0 /* move to rtw_update_ht_cap() */ -+ if ((pregpriv->bw_mode > 0) && -+ (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & BIT(1)) && -+ (pmlmeinfo->HT_info.infos[0] & BIT(2))) { -+ /* switch to the 40M Hz mode accoring to the AP */ -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; -+ switch ((pmlmeinfo->HT_info.infos[0] & 0x3)) { -+ case EXTCHNL_OFFSET_UPPER: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case EXTCHNL_OFFSET_LOWER: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ } -+#endif -+ -+ /* set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */ -+ -+#if 0 /* move to rtw_update_ht_cap() */ -+ /* */ -+ /* Config SM Power Save setting */ -+ /* */ -+ pmlmeinfo->SM_PS = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & 0x0C) >> 2; -+ if (pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) { -+#if 0 -+ u8 i; -+ /* update the MCS rates */ -+ for (i = 0; i < 16; i++) -+ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; -+#endif -+ RTW_INFO("%s(): WLAN_HT_CAP_SM_PS_STATIC\n", __FUNCTION__); -+ } -+ -+ /* */ -+ /* Config current HT Protection mode. */ -+ /* */ -+ pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; -+#endif -+ -+} -+ -+void ERP_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pIE->Length > 1) -+ return; -+ -+ pmlmeinfo->ERP_enable = 1; -+ _rtw_memcpy(&(pmlmeinfo->ERP_IE), pIE->data, pIE->Length); -+} -+ -+void VCS_update(_adapter *padapter, struct sta_info *psta) -+{ -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ switch (pregpriv->vrtl_carrier_sense) { /* 0:off 1:on 2:auto */ -+ case 0: /* off */ -+ psta->rtsen = 0; -+ psta->cts2self = 0; -+ break; -+ -+ case 1: /* on */ -+ if (pregpriv->vcs_type == 1) { /* 1:RTS/CTS 2:CTS to self */ -+ psta->rtsen = 1; -+ psta->cts2self = 0; -+ } else { -+ psta->rtsen = 0; -+ psta->cts2self = 1; -+ } -+ break; -+ -+ case 2: /* auto */ -+ default: -+ if (((pmlmeinfo->ERP_enable) && (pmlmeinfo->ERP_IE & BIT(1))) -+ /*||(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT)*/ -+ ) { -+ if (pregpriv->vcs_type == 1) { -+ psta->rtsen = 1; -+ psta->cts2self = 0; -+ } else { -+ psta->rtsen = 0; -+ psta->cts2self = 1; -+ } -+ } else { -+ psta->rtsen = 0; -+ psta->cts2self = 0; -+ } -+ break; -+ } -+} -+ -+void update_ldpc_stbc_cap(struct sta_info *psta) -+{ -+#ifdef CONFIG_80211N_HT -+ -+#ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) { -+ if (TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX)) -+ psta->ldpc = 1; -+ -+ if (TEST_FLAG(psta->vhtpriv.stbc_cap, STBC_VHT_ENABLE_TX)) -+ psta->stbc = 1; -+ } else -+#endif /* CONFIG_80211AC_VHT */ -+ if (psta->htpriv.ht_option) { -+ if (TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX)) -+ psta->ldpc = 1; -+ -+ if (TEST_FLAG(psta->htpriv.stbc_cap, STBC_HT_ENABLE_TX)) -+ psta->stbc = 1; -+ } else { -+ psta->ldpc = 0; -+ psta->stbc = 0; -+ } -+ -+#endif /* CONFIG_80211N_HT */ -+} -+ -+ -+/* -+ * rtw_get_bcn_keys: get beacon keys from recv frame -+ * -+ * TODO: -+ * WLAN_EID_COUNTRY -+ * WLAN_EID_ERP_INFO -+ * WLAN_EID_CHANNEL_SWITCH -+ * WLAN_EID_PWR_CONSTRAINT -+ */ -+int rtw_get_bcn_keys(ADAPTER *Adapter, u8 *pframe, u32 packet_len, -+ struct beacon_keys *recv_beacon) -+{ -+ int left; -+ u16 capability; -+ unsigned char *pos; -+ struct rtw_ieee802_11_elems elems; -+ struct rtw_ieee80211_ht_cap *pht_cap = NULL; -+ struct HT_info_element *pht_info = NULL; -+ -+ _rtw_memset(recv_beacon, 0, sizeof(*recv_beacon)); -+ -+ /* checking capabilities */ -+ capability = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN + 10)); -+ -+ /* checking IEs */ -+ left = packet_len - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_; -+ pos = pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_; -+ if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed) -+ return _FALSE; -+ -+ /* check bw and channel offset */ -+ if (elems.ht_capabilities) { -+ if (elems.ht_capabilities_len != sizeof(*pht_cap)) -+ return _FALSE; -+ -+ pht_cap = (struct rtw_ieee80211_ht_cap *) elems.ht_capabilities; -+ recv_beacon->ht_cap_info = pht_cap->cap_info; -+ } -+ -+ if (elems.ht_operation) { -+ if (elems.ht_operation_len != sizeof(*pht_info)) -+ return _FALSE; -+ -+ pht_info = (struct HT_info_element *) elems.ht_operation; -+ recv_beacon->ht_info_infos_0_sco = pht_info->infos[0] & 0x03; -+ } -+ -+ /* Checking for channel */ -+ if (elems.ds_params && elems.ds_params_len == sizeof(recv_beacon->bcn_channel)) -+ _rtw_memcpy(&recv_beacon->bcn_channel, elems.ds_params, -+ sizeof(recv_beacon->bcn_channel)); -+ else if (pht_info) -+ /* In 5G, some ap do not have DSSET IE checking HT info for channel */ -+ recv_beacon->bcn_channel = pht_info->primary_channel; -+ else { -+ /* we don't find channel IE, so don't check it */ -+ /* RTW_INFO("Oops: %s we don't find channel IE, so don't check it\n", __func__); */ -+ recv_beacon->bcn_channel = Adapter->mlmeextpriv.cur_channel; -+ } -+ -+ /* checking SSID */ -+ if (elems.ssid) { -+ if (elems.ssid_len > sizeof(recv_beacon->ssid)) -+ return _FALSE; -+ -+ _rtw_memcpy(recv_beacon->ssid, elems.ssid, elems.ssid_len); -+ recv_beacon->ssid_len = elems.ssid_len; -+ } else -+ ; /* means hidden ssid */ -+ -+ /* checking RSN first */ -+ if (elems.rsn_ie && elems.rsn_ie_len) { -+ recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WPA2; -+ rtw_parse_wpa2_ie(elems.rsn_ie - 2, elems.rsn_ie_len + 2, -+ &recv_beacon->group_cipher, &recv_beacon->pairwise_cipher, -+ &recv_beacon->is_8021x); -+ } -+ /* checking WPA secon */ -+ else if (elems.wpa_ie && elems.wpa_ie_len) { -+ recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WPA; -+ rtw_parse_wpa_ie(elems.wpa_ie - 2, elems.wpa_ie_len + 2, -+ &recv_beacon->group_cipher, &recv_beacon->pairwise_cipher, -+ &recv_beacon->is_8021x); -+ } else if (capability & BIT(4)) -+ recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WEP; -+ -+ return _TRUE; -+} -+ -+void rtw_dump_bcn_keys(struct beacon_keys *recv_beacon) -+{ -+ int i; -+ char *p; -+ u8 ssid[IW_ESSID_MAX_SIZE + 1]; -+ -+ _rtw_memcpy(ssid, recv_beacon->ssid, recv_beacon->ssid_len); -+ ssid[recv_beacon->ssid_len] = '\0'; -+ -+ RTW_INFO("%s: ssid = %s\n", __func__, ssid); -+ RTW_INFO("%s: channel = %x\n", __func__, recv_beacon->bcn_channel); -+ RTW_INFO("%s: ht_cap = %x\n", __func__, recv_beacon->ht_cap_info); -+ RTW_INFO("%s: ht_info_infos_0_sco = %x\n", __func__, recv_beacon->ht_info_infos_0_sco); -+ RTW_INFO("%s: sec=%d, group = %x, pair = %x, 8021X = %x\n", __func__, -+ recv_beacon->encryp_protocol, recv_beacon->group_cipher, -+ recv_beacon->pairwise_cipher, recv_beacon->is_8021x); -+} -+ -+int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) -+{ -+#if 0 -+ unsigned int len; -+ unsigned char *p; -+ unsigned short val16, subtype; -+ struct wlan_network *cur_network = &(Adapter->mlmepriv.cur_network); -+ /* u8 wpa_ie[255],rsn_ie[255]; */ -+ u16 wpa_len = 0, rsn_len = 0; -+ u8 encryp_protocol = 0; -+ WLAN_BSSID_EX *bssid; -+ int group_cipher = 0, pairwise_cipher = 0, is_8021x = 0; -+ unsigned char *pbuf; -+ u32 wpa_ielen = 0; -+ u8 *pbssid = GetAddr3Ptr(pframe); -+ u32 hidden_ssid = 0; -+ u8 cur_network_type, network_type = 0; -+ struct HT_info_element *pht_info = NULL; -+ struct rtw_ieee80211_ht_cap *pht_cap = NULL; -+ u32 bcn_channel; -+ unsigned short ht_cap_info; -+ unsigned char ht_info_infos_0; -+#endif -+ unsigned int len; -+ u8 *pbssid = GetAddr3Ptr(pframe); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ struct wlan_network *cur_network = &(Adapter->mlmepriv.cur_network); -+ struct beacon_keys recv_beacon; -+ -+ if (is_client_associated_to_ap(Adapter) == _FALSE) -+ return _TRUE; -+ -+ len = packet_len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if (len > MAX_IE_SZ) { -+ RTW_INFO("%s IE too long for survey event\n", __func__); -+ return _FAIL; -+ } -+ -+ if (_rtw_memcmp(cur_network->network.MacAddress, pbssid, 6) == _FALSE) { -+ RTW_INFO("Oops: rtw_check_network_encrypt linked but recv other bssid bcn\n" MAC_FMT MAC_FMT, -+ MAC_ARG(pbssid), MAC_ARG(cur_network->network.MacAddress)); -+ return _TRUE; -+ } -+ -+ if (rtw_get_bcn_keys(Adapter, pframe, packet_len, &recv_beacon) == _FALSE) -+ return _TRUE; /* parsing failed => broken IE */ -+ -+ /* don't care hidden ssid, use current beacon ssid directly */ -+ if (recv_beacon.ssid_len == 0) { -+ _rtw_memcpy(recv_beacon.ssid, pmlmepriv->cur_beacon_keys.ssid, -+ pmlmepriv->cur_beacon_keys.ssid_len); -+ recv_beacon.ssid_len = pmlmepriv->cur_beacon_keys.ssid_len; -+ } -+ -+ if (_rtw_memcmp(&recv_beacon, &pmlmepriv->cur_beacon_keys, sizeof(recv_beacon)) == _TRUE) -+ pmlmepriv->new_beacon_cnts = 0; -+ else if ((pmlmepriv->new_beacon_cnts == 0) || -+ _rtw_memcmp(&recv_beacon, &pmlmepriv->new_beacon_keys, sizeof(recv_beacon)) == _FALSE) { -+ RTW_ERR("%s: start new beacon (seq=%d)\n", __func__, GetSequence(pframe)); -+ -+ if (pmlmepriv->new_beacon_cnts == 0) { -+ RTW_ERR("%s: cur beacon key\n", __func__); -+ RTW_DBG_EXPR(rtw_dump_bcn_keys(&pmlmepriv->cur_beacon_keys)); -+ } -+ -+ RTW_ERR("%s: new beacon key\n", __func__); -+ RTW_DBG_EXPR(rtw_dump_bcn_keys(&recv_beacon)); -+ -+ memcpy(&pmlmepriv->new_beacon_keys, &recv_beacon, sizeof(recv_beacon)); -+ pmlmepriv->new_beacon_cnts = 1; -+ } else { -+ RTW_ERR("%s: new beacon again (seq=%d)\n", __func__, GetSequence(pframe)); -+ pmlmepriv->new_beacon_cnts++; -+ } -+ -+ /* if counter >= max, it means beacon is changed really */ -+ if (pmlmepriv->new_beacon_cnts >= new_bcn_max) { -+ RTW_ERR("%s: new beacon occur!!\n", __func__); -+ -+ /* check bw mode change only? */ -+ pmlmepriv->cur_beacon_keys.ht_cap_info = recv_beacon.ht_cap_info; -+ pmlmepriv->cur_beacon_keys.ht_info_infos_0_sco = recv_beacon.ht_info_infos_0_sco; -+ -+ if (_rtw_memcmp(&recv_beacon, &pmlmepriv->cur_beacon_keys, -+ sizeof(recv_beacon)) == _FALSE) { -+ /* beacon is changed, have to do disconnect/connect */ -+ return _FAIL; -+ } -+ -+ RTW_INFO("%s bw mode change\n", __func__); -+ RTW_INFO("%s bcn now: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, -+ cur_network->BcnInfo.ht_cap_info, -+ cur_network->BcnInfo.ht_info_infos_0); -+ -+ cur_network->BcnInfo.ht_cap_info = recv_beacon.ht_cap_info; -+ cur_network->BcnInfo.ht_info_infos_0 = -+ (cur_network->BcnInfo.ht_info_infos_0 & (~0x03)) | -+ recv_beacon.ht_info_infos_0_sco; -+ -+ RTW_INFO("%s bcn link: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, -+ cur_network->BcnInfo.ht_cap_info, -+ cur_network->BcnInfo.ht_info_infos_0); -+ -+ memcpy(&pmlmepriv->cur_beacon_keys, &recv_beacon, sizeof(recv_beacon)); -+ pmlmepriv->new_beacon_cnts = 0; -+ } -+ -+ return _SUCCESS; -+ -+#if 0 -+ bssid = (WLAN_BSSID_EX *)rtw_zmalloc(sizeof(WLAN_BSSID_EX)); -+ if (bssid == NULL) { -+ RTW_INFO("%s rtw_zmalloc fail !!!\n", __func__); -+ return _TRUE; -+ } -+ -+ if ((pmlmepriv->timeBcnInfoChkStart != 0) && (rtw_get_passing_time_ms(pmlmepriv->timeBcnInfoChkStart) > DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS)) { -+ pmlmepriv->timeBcnInfoChkStart = 0; -+ pmlmepriv->NumOfBcnInfoChkFail = 0; -+ } -+ -+ subtype = GetFrameSubType(pframe) >> 4; -+ -+ if (subtype == WIFI_BEACON) -+ bssid->Reserved[0] = 1; -+ -+ bssid->Length = sizeof(WLAN_BSSID_EX) - MAX_IE_SZ + len; -+ -+ /* below is to copy the information element */ -+ bssid->IELength = len; -+ _rtw_memcpy(bssid->IEs, (pframe + sizeof(struct rtw_ieee80211_hdr_3addr)), bssid->IELength); -+ -+ /* check bw and channel offset */ -+ /* parsing HT_CAP_IE */ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (p && len > 0) { -+ pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); -+ ht_cap_info = pht_cap->cap_info; -+ } else -+ ht_cap_info = 0; -+ /* parsing HT_INFO_IE */ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (p && len > 0) { -+ pht_info = (struct HT_info_element *)(p + 2); -+ ht_info_infos_0 = pht_info->infos[0]; -+ } else -+ ht_info_infos_0 = 0; -+ if (ht_cap_info != cur_network->BcnInfo.ht_cap_info || -+ ((ht_info_infos_0 & 0x03) != (cur_network->BcnInfo.ht_info_infos_0 & 0x03))) { -+ RTW_INFO("%s bcn now: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, -+ ht_cap_info, ht_info_infos_0); -+ RTW_INFO("%s bcn link: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, -+ cur_network->BcnInfo.ht_cap_info, cur_network->BcnInfo.ht_info_infos_0); -+ RTW_INFO("%s bw mode change\n", __func__); -+ { -+ /* bcn_info_update */ -+ cur_network->BcnInfo.ht_cap_info = ht_cap_info; -+ cur_network->BcnInfo.ht_info_infos_0 = ht_info_infos_0; -+ /* to do : need to check that whether modify related register of BB or not */ -+ } -+ /* goto _mismatch; */ -+ } -+ -+ /* Checking for channel */ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _DSSET_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (p) -+ bcn_channel = *(p + 2); -+ else {/* In 5G, some ap do not have DSSET IE checking HT info for channel */ -+ rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (pht_info) -+ bcn_channel = pht_info->primary_channel; -+ else { /* we don't find channel IE, so don't check it */ -+ /* RTW_INFO("Oops: %s we don't find channel IE, so don't check it\n", __func__); */ -+ bcn_channel = Adapter->mlmeextpriv.cur_channel; -+ } -+ } -+ if (bcn_channel != Adapter->mlmeextpriv.cur_channel) { -+ RTW_INFO("%s beacon channel:%d cur channel:%d disconnect\n", __func__, -+ bcn_channel, Adapter->mlmeextpriv.cur_channel); -+ goto _mismatch; -+ } -+ -+ /* checking SSID */ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _SSID_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (p == NULL) { -+ RTW_INFO("%s marc: cannot find SSID for survey event\n", __func__); -+ hidden_ssid = _TRUE; -+ } else -+ hidden_ssid = _FALSE; -+ -+ if ((NULL != p) && (_FALSE == hidden_ssid && (*(p + 1)))) { -+ _rtw_memcpy(bssid->Ssid.Ssid, (p + 2), *(p + 1)); -+ bssid->Ssid.SsidLength = *(p + 1); -+ } else { -+ bssid->Ssid.SsidLength = 0; -+ bssid->Ssid.Ssid[0] = '\0'; -+ } -+ -+ -+ if (_rtw_memcmp(bssid->Ssid.Ssid, cur_network->network.Ssid.Ssid, 32) == _FALSE || -+ bssid->Ssid.SsidLength != cur_network->network.Ssid.SsidLength) { -+ if (bssid->Ssid.Ssid[0] != '\0' && bssid->Ssid.SsidLength != 0) { /* not hidden ssid */ -+ RTW_INFO("%s(), SSID is not match\n", __func__); -+ goto _mismatch; -+ } -+ } -+ -+ /* check encryption info */ -+ val16 = rtw_get_capability((WLAN_BSSID_EX *)bssid); -+ -+ if (val16 & BIT(4)) -+ bssid->Privacy = 1; -+ else -+ bssid->Privacy = 0; -+ -+ if (cur_network->network.Privacy != bssid->Privacy) { -+ RTW_INFO("%s(), privacy is not match\n", __func__); -+ goto _mismatch; -+ } -+ -+ rtw_get_sec_ie(bssid->IEs, bssid->IELength, NULL, &rsn_len, NULL, &wpa_len); -+ -+ if (rsn_len > 0) -+ encryp_protocol = ENCRYP_PROTOCOL_WPA2; -+ else if (wpa_len > 0) -+ encryp_protocol = ENCRYP_PROTOCOL_WPA; -+ else { -+ if (bssid->Privacy) -+ encryp_protocol = ENCRYP_PROTOCOL_WEP; -+ } -+ -+ if (cur_network->BcnInfo.encryp_protocol != encryp_protocol) { -+ RTW_INFO("%s(): enctyp is not match\n", __func__); -+ goto _mismatch; -+ } -+ -+ if (encryp_protocol == ENCRYP_PROTOCOL_WPA || encryp_protocol == ENCRYP_PROTOCOL_WPA2) { -+ pbuf = rtw_get_wpa_ie(&bssid->IEs[12], &wpa_ielen, bssid->IELength - 12); -+ if (pbuf && (wpa_ielen > 0)) { -+ rtw_parse_wpa_ie(pbuf, wpa_ielen + 2, &group_cipher, &pairwise_cipher, &is_8021x); -+ } else { -+ pbuf = rtw_get_wpa2_ie(&bssid->IEs[12], &wpa_ielen, bssid->IELength - 12); -+ -+ if (pbuf && (wpa_ielen > 0)) { -+ rtw_parse_wpa2_ie(pbuf, wpa_ielen + 2, &group_cipher, &pairwise_cipher, &is_8021x); -+ } -+ } -+ -+ if (pairwise_cipher != cur_network->BcnInfo.pairwise_cipher || group_cipher != cur_network->BcnInfo.group_cipher) { -+ RTW_INFO("%s pairwise_cipher(%x:%x) or group_cipher(%x:%x) is not match\n", __func__, -+ pairwise_cipher, cur_network->BcnInfo.pairwise_cipher, -+ group_cipher, cur_network->BcnInfo.group_cipher); -+ goto _mismatch; -+ } -+ -+ if (is_8021x != cur_network->BcnInfo.is_8021x) { -+ RTW_INFO("%s authentication is not match\n", __func__); -+ goto _mismatch; -+ } -+ } -+ -+ rtw_mfree((u8 *)bssid, sizeof(WLAN_BSSID_EX)); -+ return _SUCCESS; -+ -+_mismatch: -+ rtw_mfree((u8 *)bssid, sizeof(WLAN_BSSID_EX)); -+ -+ if (pmlmepriv->NumOfBcnInfoChkFail == 0) -+ pmlmepriv->timeBcnInfoChkStart = rtw_get_current_time(); -+ -+ pmlmepriv->NumOfBcnInfoChkFail++; -+ RTW_INFO("%s by "ADPT_FMT" - NumOfChkFail = %d (SeqNum of this Beacon frame = %d).\n", __func__, ADPT_ARG(Adapter), pmlmepriv->NumOfBcnInfoChkFail, GetSequence(pframe)); -+ -+ if ((pmlmepriv->timeBcnInfoChkStart != 0) && (rtw_get_passing_time_ms(pmlmepriv->timeBcnInfoChkStart) <= DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS) -+ && (pmlmepriv->NumOfBcnInfoChkFail >= DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD)) { -+ RTW_INFO("%s by "ADPT_FMT" - NumOfChkFail = %d >= threshold : %d (in %d ms), return FAIL.\n", __func__, ADPT_ARG(Adapter), pmlmepriv->NumOfBcnInfoChkFail, -+ DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD, rtw_get_passing_time_ms(pmlmepriv->timeBcnInfoChkStart)); -+ pmlmepriv->timeBcnInfoChkStart = 0; -+ pmlmepriv->NumOfBcnInfoChkFail = 0; -+ return _FAIL; -+ } -+ -+ return _SUCCESS; -+#endif -+} -+ -+void update_beacon_info(_adapter *padapter, u8 *pframe, uint pkt_len, struct sta_info *psta) -+{ -+ unsigned int i; -+ unsigned int len; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ u8 tdls_prohibited[] = { 0x00, 0x00, 0x00, 0x00, 0x10 }; /* bit(38): TDLS_prohibited */ -+#endif /* CONFIG_TDLS */ -+ -+ len = pkt_len - (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN); -+ -+ for (i = 0; i < len;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN) + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: -+ /* to update WMM paramter set while receiving beacon */ -+ if (_rtw_memcmp(pIE->data, WMM_PARA_OUI, 6) && pIE->Length == WLAN_WMM_LEN) /* WMM */ -+ (WMM_param_handler(padapter, pIE)) ? report_wmm_edca_update(padapter) : 0; -+ -+ break; -+ -+ case _HT_EXTRA_INFO_IE_: /* HT info */ -+ /* HT_info_handler(padapter, pIE); */ -+ bwmode_update_check(padapter, pIE); -+ break; -+#ifdef CONFIG_80211AC_VHT -+ case EID_OpModeNotification: -+ rtw_process_vht_op_mode_notify(padapter, pIE->data, psta); -+ break; -+#endif /* CONFIG_80211AC_VHT */ -+ case _ERPINFO_IE_: -+ ERP_IE_handler(padapter, pIE); -+ VCS_update(padapter, psta); -+ break; -+ -+#ifdef CONFIG_TDLS -+ case _EXT_CAP_IE_: -+ if (check_ap_tdls_prohibited(pIE->data, pIE->Length) == _TRUE) -+ ptdlsinfo->ap_prohibited = _TRUE; -+ if (check_ap_tdls_ch_switching_prohibited(pIE->data, pIE->Length) == _TRUE) -+ ptdlsinfo->ch_switch_prohibited = _TRUE; -+ break; -+#endif /* CONFIG_TDLS */ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+} -+ -+#ifdef CONFIG_DFS -+void process_csa_ie(_adapter *padapter, u8 *pframe, uint pkt_len) -+{ -+ unsigned int i; -+ unsigned int len; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 new_ch_no = 0; -+ -+ if (padapter->mlmepriv.handle_dfs == _TRUE) -+ return; -+ -+ len = pkt_len - (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN); -+ -+ for (i = 0; i < len;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN) + i); -+ -+ switch (pIE->ElementID) { -+ case _CH_SWTICH_ANNOUNCE_: -+ padapter->mlmepriv.handle_dfs = _TRUE; -+ _rtw_memcpy(&new_ch_no, pIE->data + 1, 1); -+ rtw_set_csa_cmd(padapter, new_ch_no); -+ break; -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+} -+#endif /* CONFIG_DFS */ -+ -+unsigned int is_ap_in_tkip(_adapter *padapter) -+{ -+ u32 i; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ -+ if (rtw_get_capability((WLAN_BSSID_EX *)cur_network) & WLAN_CAPABILITY_PRIVACY) { -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pmlmeinfo->network.IELength;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pmlmeinfo->network.IEs + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: -+ if ((_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) && (_rtw_memcmp((pIE->data + 12), WPA_TKIP_CIPHER, 4))) -+ return _TRUE; -+ break; -+ -+ case _RSN_IE_2_: -+ if (_rtw_memcmp((pIE->data + 8), RSN_TKIP_CIPHER, 4)) -+ return _TRUE; -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ return _FALSE; -+ } else -+ return _FALSE; -+ -+} -+ -+unsigned int should_forbid_n_rate(_adapter *padapter) -+{ -+ u32 i; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ WLAN_BSSID_EX *cur_network = &pmlmepriv->cur_network.network; -+ -+ if (rtw_get_capability((WLAN_BSSID_EX *)cur_network) & WLAN_CAPABILITY_PRIVACY) { -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < cur_network->IELength;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(cur_network->IEs + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: -+ if (_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4) && -+ ((_rtw_memcmp((pIE->data + 12), WPA_CIPHER_SUITE_CCMP, 4)) || -+ (_rtw_memcmp((pIE->data + 16), WPA_CIPHER_SUITE_CCMP, 4)))) -+ return _FALSE; -+ break; -+ -+ case _RSN_IE_2_: -+ if ((_rtw_memcmp((pIE->data + 8), RSN_CIPHER_SUITE_CCMP, 4)) || -+ (_rtw_memcmp((pIE->data + 12), RSN_CIPHER_SUITE_CCMP, 4))) -+ return _FALSE; -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ return _TRUE; -+ } else -+ return _FALSE; -+ -+} -+ -+ -+unsigned int is_ap_in_wep(_adapter *padapter) -+{ -+ u32 i; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ -+ if (rtw_get_capability((WLAN_BSSID_EX *)cur_network) & WLAN_CAPABILITY_PRIVACY) { -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pmlmeinfo->network.IELength;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pmlmeinfo->network.IEs + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: -+ if (_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) -+ return _FALSE; -+ break; -+ -+ case _RSN_IE_2_: -+ return _FALSE; -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ return _TRUE; -+ } else -+ return _FALSE; -+ -+} -+ -+int wifirate2_ratetbl_inx(unsigned char rate); -+int wifirate2_ratetbl_inx(unsigned char rate) -+{ -+ int inx = 0; -+ rate = rate & 0x7f; -+ -+ switch (rate) { -+ case 54*2: -+ inx = 11; -+ break; -+ -+ case 48*2: -+ inx = 10; -+ break; -+ -+ case 36*2: -+ inx = 9; -+ break; -+ -+ case 24*2: -+ inx = 8; -+ break; -+ -+ case 18*2: -+ inx = 7; -+ break; -+ -+ case 12*2: -+ inx = 6; -+ break; -+ -+ case 9*2: -+ inx = 5; -+ break; -+ -+ case 6*2: -+ inx = 4; -+ break; -+ -+ case 11*2: -+ inx = 3; -+ break; -+ case 11: -+ inx = 2; -+ break; -+ -+ case 2*2: -+ inx = 1; -+ break; -+ -+ case 1*2: -+ inx = 0; -+ break; -+ -+ } -+ return inx; -+} -+ -+unsigned int update_basic_rate(unsigned char *ptn, unsigned int ptn_sz) -+{ -+ unsigned int i, num_of_rate; -+ unsigned int mask = 0; -+ -+ num_of_rate = (ptn_sz > NumRates) ? NumRates : ptn_sz; -+ -+ for (i = 0; i < num_of_rate; i++) { -+ if ((*(ptn + i)) & 0x80) -+ mask |= 0x1 << wifirate2_ratetbl_inx(*(ptn + i)); -+ } -+ return mask; -+} -+ -+unsigned int update_supported_rate(unsigned char *ptn, unsigned int ptn_sz) -+{ -+ unsigned int i, num_of_rate; -+ unsigned int mask = 0; -+ -+ num_of_rate = (ptn_sz > NumRates) ? NumRates : ptn_sz; -+ -+ for (i = 0; i < num_of_rate; i++) -+ mask |= 0x1 << wifirate2_ratetbl_inx(*(ptn + i)); -+ -+ return mask; -+} -+ -+unsigned int update_MCS_rate(struct HT_caps_element *pHT_caps) -+{ -+ unsigned int mask = 0; -+ -+ mask = ((pHT_caps->u.HT_cap_element.MCS_rate[0] << 12) | (pHT_caps->u.HT_cap_element.MCS_rate[1] << 20)); -+ -+ return mask; -+} -+ -+int support_short_GI(_adapter *padapter, struct HT_caps_element *pHT_caps, u8 bwmode) -+{ -+ unsigned char bit_offset; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (!(pmlmeinfo->HT_enable)) -+ return _FAIL; -+ -+ bit_offset = (bwmode & CHANNEL_WIDTH_40) ? 6 : 5; -+ -+ if (pHT_caps->u.HT_cap_element.HT_caps_info & (0x1 << bit_offset)) -+ return _SUCCESS; -+ else -+ return _FAIL; -+} -+ -+unsigned char get_highest_rate_idx(u32 mask) -+{ -+ int i; -+ unsigned char rate_idx = 0; -+ -+ for (i = 31; i >= 0; i--) { -+ if (mask & BIT(i)) { -+ rate_idx = i; -+ break; -+ } -+ } -+ -+ return rate_idx; -+} -+ -+unsigned char get_highest_mcs_rate(struct HT_caps_element *pHT_caps); -+unsigned char get_highest_mcs_rate(struct HT_caps_element *pHT_caps) -+{ -+ int i, mcs_rate; -+ -+ mcs_rate = (pHT_caps->u.HT_cap_element.MCS_rate[0] | (pHT_caps->u.HT_cap_element.MCS_rate[1] << 8)); -+ -+ for (i = 15; i >= 0; i--) { -+ if (mcs_rate & (0x1 << i)) -+ break; -+ } -+ -+ return i; -+} -+ -+void Update_RA_Entry(_adapter *padapter, struct sta_info *psta) -+{ -+ rtw_hal_update_ra_mask(psta, psta->rssi_level); -+} -+ -+void set_sta_rate(_adapter *padapter, struct sta_info *psta) -+{ -+ /* rate adaptive */ -+ rtw_hal_update_ra_mask(psta, psta->rssi_level); -+} -+ -+/* Update RRSR and Rate for USERATE */ -+void update_tx_basic_rate(_adapter *padapter, u8 wirelessmode) -+{ -+ NDIS_802_11_RATES_EX supported_rates; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ -+ /* Added by Albert 2011/03/22 */ -+ /* In the P2P mode, the driver should not support the b mode. */ -+ /* So, the Tx packet shouldn't use the CCK rate */ -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+#endif /* CONFIG_P2P */ -+#ifdef CONFIG_INTEL_WIDI -+ if (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_NONE) -+ return; -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ _rtw_memset(supported_rates, 0, NDIS_802_11_LENGTH_RATES_EX); -+ -+ /* clear B mod if current channel is in 5G band, avoid tx cck rate in 5G band. */ -+ if (pmlmeext->cur_channel > 14) -+ wirelessmode &= ~(WIRELESS_11B); -+ -+ if ((wirelessmode & WIRELESS_11B) && (wirelessmode == WIRELESS_11B)) -+ _rtw_memcpy(supported_rates, rtw_basic_rate_cck, 4); -+ else if (wirelessmode & WIRELESS_11B) -+ _rtw_memcpy(supported_rates, rtw_basic_rate_mix, 7); -+ else -+ _rtw_memcpy(supported_rates, rtw_basic_rate_ofdm, 3); -+ -+ if (wirelessmode & WIRELESS_11B) -+ update_mgnt_tx_rate(padapter, IEEE80211_CCK_RATE_1MB); -+ else -+ update_mgnt_tx_rate(padapter, IEEE80211_OFDM_RATE_6MB); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, supported_rates); -+} -+ -+unsigned char check_assoc_AP(u8 *pframe, uint len) -+{ -+ unsigned int i; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < len;) { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + i); -+ -+ switch (pIE->ElementID) { -+ case _VENDOR_SPECIFIC_IE_: -+ if ((_rtw_memcmp(pIE->data, ARTHEROS_OUI1, 3)) || (_rtw_memcmp(pIE->data, ARTHEROS_OUI2, 3))) { -+ RTW_INFO("link to Artheros AP\n"); -+ return HT_IOT_PEER_ATHEROS; -+ } else if ((_rtw_memcmp(pIE->data, BROADCOM_OUI1, 3)) -+ || (_rtw_memcmp(pIE->data, BROADCOM_OUI2, 3)) -+ || (_rtw_memcmp(pIE->data, BROADCOM_OUI3, 3))) { -+ RTW_INFO("link to Broadcom AP\n"); -+ return HT_IOT_PEER_BROADCOM; -+ } else if (_rtw_memcmp(pIE->data, MARVELL_OUI, 3)) { -+ RTW_INFO("link to Marvell AP\n"); -+ return HT_IOT_PEER_MARVELL; -+ } else if (_rtw_memcmp(pIE->data, RALINK_OUI, 3)) { -+ RTW_INFO("link to Ralink AP\n"); -+ return HT_IOT_PEER_RALINK; -+ } else if (_rtw_memcmp(pIE->data, CISCO_OUI, 3)) { -+ RTW_INFO("link to Cisco AP\n"); -+ return HT_IOT_PEER_CISCO; -+ } else if (_rtw_memcmp(pIE->data, REALTEK_OUI, 3)) { -+ u32 Vender = HT_IOT_PEER_REALTEK; -+#ifdef CONFIG_80211N_HT -+ if (pIE->Length >= 5) { -+ if (pIE->data[4] == 1) { -+ /* if(pIE->data[5] & RT_HT_CAP_USE_LONG_PREAMBLE) */ -+ /* bssDesc->BssHT.RT2RT_HT_Mode |= RT_HT_CAP_USE_LONG_PREAMBLE; */ -+ -+ if (pIE->data[5] & RT_HT_CAP_USE_92SE) { -+ /* bssDesc->BssHT.RT2RT_HT_Mode |= RT_HT_CAP_USE_92SE; */ -+ Vender = HT_IOT_PEER_REALTEK_92SE; -+ } -+ } -+ -+ if (pIE->data[5] & RT_HT_CAP_USE_SOFTAP) -+ Vender = HT_IOT_PEER_REALTEK_SOFTAP; -+ -+ if (pIE->data[4] == 2) { -+ if (pIE->data[6] & RT_HT_CAP_USE_JAGUAR_BCUT) { -+ Vender = HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP; -+ RTW_INFO("link to Realtek JAGUAR_BCUTAP\n"); -+ } -+ if (pIE->data[6] & RT_HT_CAP_USE_JAGUAR_CCUT) { -+ Vender = HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP; -+ RTW_INFO("link to Realtek JAGUAR_CCUTAP\n"); -+ } -+ } -+ } -+#endif -+ RTW_INFO("link to Realtek AP\n"); -+ return Vender; -+ } else if (_rtw_memcmp(pIE->data, AIRGOCAP_OUI, 3)) { -+ RTW_INFO("link to Airgo Cap\n"); -+ return HT_IOT_PEER_AIRGO; -+ } else -+ break; -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ RTW_INFO("link to new AP\n"); -+ return HT_IOT_PEER_UNKNOWN; -+} -+ -+void update_capinfo(PADAPTER Adapter, u16 updateCap) -+{ -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ BOOLEAN ShortPreamble; -+ -+ /* Check preamble mode, 2005.01.06, by rcnjko. */ -+ /* Mark to update preamble value forever, 2008.03.18 by lanhsin */ -+ /* if( pMgntInfo->RegPreambleMode == PREAMBLE_AUTO ) */ -+ { -+ -+ if (updateCap & cShortPreamble) { -+ /* Short Preamble */ -+ if (pmlmeinfo->preamble_mode != PREAMBLE_SHORT) { /* PREAMBLE_LONG or PREAMBLE_AUTO */ -+ ShortPreamble = _TRUE; -+ pmlmeinfo->preamble_mode = PREAMBLE_SHORT; -+ rtw_hal_set_hwreg(Adapter, HW_VAR_ACK_PREAMBLE, (u8 *)&ShortPreamble); -+ } -+ } else { -+ /* Long Preamble */ -+ if (pmlmeinfo->preamble_mode != PREAMBLE_LONG) { /* PREAMBLE_SHORT or PREAMBLE_AUTO */ -+ ShortPreamble = _FALSE; -+ pmlmeinfo->preamble_mode = PREAMBLE_LONG; -+ rtw_hal_set_hwreg(Adapter, HW_VAR_ACK_PREAMBLE, (u8 *)&ShortPreamble); -+ } -+ } -+ } -+ -+ if (updateCap & cIBSS) { -+ /* Filen: See 802.11-2007 p.91 */ -+ pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; -+ } else { -+ /* Filen: See 802.11-2007 p.90 */ -+ if (pmlmeext->cur_wireless_mode & (WIRELESS_11_24N | WIRELESS_11A | WIRELESS_11_5N | WIRELESS_11AC)) -+ pmlmeinfo->slotTime = SHORT_SLOT_TIME; -+ else if (pmlmeext->cur_wireless_mode & (WIRELESS_11G)) { -+ if ((updateCap & cShortSlotTime) /* && (!(pMgntInfo->pHTInfo->RT2RT_HT_Mode & RT_HT_CAP_USE_LONG_PREAMBLE)) */) { -+ /* Short Slot Time */ -+ pmlmeinfo->slotTime = SHORT_SLOT_TIME; -+ } else { -+ /* Long Slot Time */ -+ pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; -+ } -+ } else { -+ /* B Mode */ -+ pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; -+ } -+ } -+ -+ rtw_hal_set_hwreg(Adapter, HW_VAR_SLOT_TIME, &pmlmeinfo->slotTime); -+ -+} -+ -+/* -+* set adapter.mlmeextpriv.mlmext_info.HT_enable -+* set adapter.mlmeextpriv.cur_wireless_mode -+* set SIFS register -+* set mgmt tx rate -+*/ -+void update_wireless_mode(_adapter *padapter) -+{ -+ int ratelen, network_type = 0; -+ u32 SIFS_Timer; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ unsigned char *rate = cur_network->SupportedRates; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P */ -+ -+ ratelen = rtw_get_rateset_len(cur_network->SupportedRates); -+ -+ if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable)) -+ pmlmeinfo->HT_enable = 1; -+ -+ if (pmlmeext->cur_channel > 14) { -+ if (pmlmeinfo->VHT_enable) -+ network_type = WIRELESS_11AC; -+ else if (pmlmeinfo->HT_enable) -+ network_type = WIRELESS_11_5N; -+ -+ network_type |= WIRELESS_11A; -+ } else { -+ if (pmlmeinfo->VHT_enable) -+ network_type = WIRELESS_11AC; -+ else if (pmlmeinfo->HT_enable) -+ network_type = WIRELESS_11_24N; -+ -+ if ((cckratesonly_included(rate, ratelen)) == _TRUE) -+ network_type |= WIRELESS_11B; -+ else if ((cckrates_included(rate, ratelen)) == _TRUE) -+ network_type |= WIRELESS_11BG; -+ else -+ network_type |= WIRELESS_11G; -+ } -+ -+ pmlmeext->cur_wireless_mode = network_type & padapter->registrypriv.wireless_mode; -+ /* RTW_INFO("network_type=%02x, padapter->registrypriv.wireless_mode=%02x\n", network_type, padapter->registrypriv.wireless_mode); */ -+#if 0 -+ if ((pmlmeext->cur_wireless_mode == WIRELESS_11G) || -+ (pmlmeext->cur_wireless_mode == WIRELESS_11BG)) /* WIRELESS_MODE_G) */ -+ SIFS_Timer = 0x0a0a;/* CCK */ -+ else -+ SIFS_Timer = 0x0e0e;/* pHalData->SifsTime; //OFDM */ -+#endif -+ -+ SIFS_Timer = 0x0a0a0808; /* 0x0808->for CCK, 0x0a0a->for OFDM -+ * change this value if having IOT issues. */ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_RESP_SIFS, (u8 *)&SIFS_Timer); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_WIRELESS_MODE, (u8 *)&(pmlmeext->cur_wireless_mode)); -+ -+ if ((pmlmeext->cur_wireless_mode & WIRELESS_11B) -+ #ifdef CONFIG_P2P -+ && (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) -+ #ifdef CONFIG_IOCTL_CFG80211 -+ || !rtw_cfg80211_iface_has_p2p_group_cap(padapter) -+ #endif -+ ) -+ #endif -+ ) -+ update_mgnt_tx_rate(padapter, IEEE80211_CCK_RATE_1MB); -+ else -+ update_mgnt_tx_rate(padapter, IEEE80211_OFDM_RATE_6MB); -+} -+ -+void fire_write_MAC_cmd(_adapter *padapter, unsigned int addr, unsigned int value); -+void fire_write_MAC_cmd(_adapter *padapter, unsigned int addr, unsigned int value) -+{ -+#if 0 -+ struct cmd_obj *ph2c; -+ struct reg_rw_parm *pwriteMacPara; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ -+ ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) -+ return; -+ -+ pwriteMacPara = (struct reg_rw_parm *)rtw_malloc(sizeof(struct reg_rw_parm)); -+ if (pwriteMacPara == NULL) { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ pwriteMacPara->rw = 1; -+ pwriteMacPara->addr = addr; -+ pwriteMacPara->value = value; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pwriteMacPara, GEN_CMD_CODE(_Write_MACREG)); -+ rtw_enqueue_cmd(pcmdpriv, ph2c); -+#endif -+} -+ -+void update_sta_basic_rate(struct sta_info *psta, u8 wireless_mode) -+{ -+ if (IsSupportedTxCCK(wireless_mode)) { -+ /* Only B, B/G, and B/G/N AP could use CCK rate */ -+ _rtw_memcpy(psta->bssrateset, rtw_basic_rate_cck, 4); -+ psta->bssratelen = 4; -+ } else { -+ _rtw_memcpy(psta->bssrateset, rtw_basic_rate_ofdm, 3); -+ psta->bssratelen = 3; -+ } -+} -+ -+int rtw_ies_get_supported_rate(u8 *ies, uint ies_len, u8 *rate_set, u8 *rate_num) -+{ -+ u8 *ie; -+ unsigned int ie_len; -+ -+ if (!rate_set || !rate_num) -+ return _FALSE; -+ -+ *rate_num = 0; -+ -+ ie = rtw_get_ie(ies, _SUPPORTEDRATES_IE_, &ie_len, ies_len); -+ if (ie == NULL) -+ goto ext_rate; -+ -+ _rtw_memcpy(rate_set, ie + 2, ie_len); -+ *rate_num = ie_len; -+ -+ext_rate: -+ ie = rtw_get_ie(ies, _EXT_SUPPORTEDRATES_IE_, &ie_len, ies_len); -+ if (ie) { -+ _rtw_memcpy(rate_set + *rate_num, ie + 2, ie_len); -+ *rate_num += ie_len; -+ } -+ -+ if (*rate_num == 0) -+ return _FAIL; -+ -+ if (0) { -+ int i; -+ -+ for (i = 0; i < *rate_num; i++) -+ RTW_INFO("rate:0x%02x\n", *(rate_set + i)); -+ } -+ -+ return _SUCCESS; -+} -+ -+void process_addba_req(_adapter *padapter, u8 *paddba_req, u8 *addr) -+{ -+ struct sta_info *psta; -+ u16 tid, start_seq, param; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct ADDBA_request *preq = (struct ADDBA_request *)paddba_req; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 size, accept = _FALSE; -+ -+ psta = rtw_get_stainfo(pstapriv, addr); -+ if (!psta) -+ goto exit; -+ -+ start_seq = le16_to_cpu(preq->BA_starting_seqctrl) >> 4; -+ -+ param = le16_to_cpu(preq->BA_para_set); -+ tid = (param >> 2) & 0x0f; -+ -+ -+ accept = rtw_rx_ampdu_is_accept(padapter); -+ size = rtw_rx_ampdu_size(padapter); -+ -+ if (accept == _TRUE) -+ rtw_addbarsp_cmd(padapter, addr, tid, 0, size, start_seq); -+ else -+ rtw_addbarsp_cmd(padapter, addr, tid, 37, size, start_seq); /* reject ADDBA Req */ -+ -+exit: -+ return; -+} -+ -+void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len) -+{ -+ u8 *pIE; -+ u32 *pbuf; -+ -+ pIE = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ pbuf = (u32 *)pIE; -+ -+ pmlmeext->TSFValue = le32_to_cpu(*(pbuf + 1)); -+ -+ pmlmeext->TSFValue = pmlmeext->TSFValue << 32; -+ -+ pmlmeext->TSFValue |= le32_to_cpu(*pbuf); -+} -+ -+void correct_TSF(_adapter *padapter, struct mlme_ext_priv *pmlmeext) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CORRECT_TSF, 0); -+} -+ -+void adaptive_early_32k(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len) -+{ -+ int i; -+ u8 *pIE; -+ u32 *pbuf; -+ u64 tsf = 0; -+ u32 delay_ms; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ pmlmeext->bcn_cnt++; -+ -+ pIE = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ pbuf = (u32 *)pIE; -+ -+ tsf = le32_to_cpu(*(pbuf + 1)); -+ tsf = tsf << 32; -+ tsf |= le32_to_cpu(*pbuf); -+ -+ /* RTW_INFO("%s(): tsf_upper= 0x%08x, tsf_lower=0x%08x\n", __func__, (u32)(tsf>>32), (u32)tsf); */ -+ -+ /* delay = (timestamp mod 1024*100)/1000 (unit: ms) */ -+ /* delay_ms = do_div(tsf, (pmlmeinfo->bcn_interval*1024))/1000; */ -+ delay_ms = rtw_modular64(tsf, (pmlmeinfo->bcn_interval * 1024)); -+ delay_ms = delay_ms / 1000; -+ -+ if (delay_ms >= 8) { -+ pmlmeext->bcn_delay_cnt[8]++; -+ /* pmlmeext->bcn_delay_ratio[8] = (pmlmeext->bcn_delay_cnt[8] * 100) /pmlmeext->bcn_cnt; */ -+ } else { -+ pmlmeext->bcn_delay_cnt[delay_ms]++; -+ /* pmlmeext->bcn_delay_ratio[delay_ms] = (pmlmeext->bcn_delay_cnt[delay_ms] * 100) /pmlmeext->bcn_cnt; */ -+ } -+ -+ /* -+ RTW_INFO("%s(): (a)bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); -+ -+ -+ for(i=0; i<9; i++) -+ { -+ RTW_INFO("%s():bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d]=%d\n", __func__, i, -+ pmlmeext->bcn_delay_cnt[i] , i, pmlmeext->bcn_delay_ratio[i]); -+ } -+ */ -+ -+ /* dump for adaptive_early_32k */ -+ if (pmlmeext->bcn_cnt > 100 && (pmlmeext->adaptive_tsf_done == _TRUE)) { -+ u8 ratio_20_delay, ratio_80_delay; -+ u8 DrvBcnEarly, DrvBcnTimeOut; -+ -+ ratio_20_delay = 0; -+ ratio_80_delay = 0; -+ DrvBcnEarly = 0xff; -+ DrvBcnTimeOut = 0xff; -+ -+ RTW_INFO("%s(): bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); -+ -+ for (i = 0; i < 9; i++) { -+ pmlmeext->bcn_delay_ratio[i] = (pmlmeext->bcn_delay_cnt[i] * 100) / pmlmeext->bcn_cnt; -+ -+ -+ /* RTW_INFO("%s():bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d]=%d\n", __func__, i, */ -+ /* pmlmeext->bcn_delay_cnt[i] , i, pmlmeext->bcn_delay_ratio[i]); */ -+ -+ ratio_20_delay += pmlmeext->bcn_delay_ratio[i]; -+ ratio_80_delay += pmlmeext->bcn_delay_ratio[i]; -+ -+ if (ratio_20_delay > 20 && DrvBcnEarly == 0xff) { -+ DrvBcnEarly = i; -+ /* RTW_INFO("%s(): DrvBcnEarly = %d\n", __func__, DrvBcnEarly); */ -+ } -+ -+ if (ratio_80_delay > 80 && DrvBcnTimeOut == 0xff) { -+ DrvBcnTimeOut = i; -+ /* RTW_INFO("%s(): DrvBcnTimeOut = %d\n", __func__, DrvBcnTimeOut); */ -+ } -+ -+ /* reset adaptive_early_32k cnt */ -+ pmlmeext->bcn_delay_cnt[i] = 0; -+ pmlmeext->bcn_delay_ratio[i] = 0; -+ } -+ -+ pmlmeext->DrvBcnEarly = DrvBcnEarly; -+ pmlmeext->DrvBcnTimeOut = DrvBcnTimeOut; -+ -+ pmlmeext->bcn_cnt = 0; -+ } -+ -+} -+ -+ -+void beacon_timing_control(_adapter *padapter) -+{ -+ rtw_hal_bcn_related_reg_setting(padapter); -+} -+ -+#define CONFIG_SHARED_BMC_MACID -+ -+void dump_macid_map(void *sel, struct macid_bmp *map, u8 max_num) -+{ -+ RTW_PRINT_SEL(sel, "0x%08x\n", map->m0); -+#if (MACID_NUM_SW_LIMIT > 32) -+ if (max_num && max_num > 32) -+ RTW_PRINT_SEL(sel, "0x%08x\n", map->m1); -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ if (max_num && max_num > 64) -+ RTW_PRINT_SEL(sel, "0x%08x\n", map->m2); -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ if (max_num && max_num > 96) -+ RTW_PRINT_SEL(sel, "0x%08x\n", map->m3); -+#endif -+} -+ -+inline bool rtw_macid_is_set(struct macid_bmp *map, u8 id) -+{ -+ if (id < 32) -+ return map->m0 & BIT(id); -+#if (MACID_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ return map->m1 & BIT(id - 32); -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ return map->m2 & BIT(id - 64); -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ return map->m3 & BIT(id - 96); -+#endif -+ else -+ rtw_warn_on(1); -+ -+ return 0; -+} -+ -+inline void rtw_macid_map_set(struct macid_bmp *map, u8 id) -+{ -+ if (id < 32) -+ map->m0 |= BIT(id); -+#if (MACID_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ map->m1 |= BIT(id - 32); -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ map->m2 |= BIT(id - 64); -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ map->m3 |= BIT(id - 96); -+#endif -+ else -+ rtw_warn_on(1); -+} -+ -+/*Record bc's mac-id and sec-cam-id*/ -+inline void rtw_iface_bcmc_id_set(_adapter *padapter, u8 mac_id) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ -+ macid_ctl->iface_bmc[padapter->iface_id] = mac_id; -+} -+inline u8 rtw_iface_bcmc_id_get(_adapter *padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ -+ return macid_ctl->iface_bmc[padapter->iface_id]; -+} -+ -+inline void rtw_macid_map_clr(struct macid_bmp *map, u8 id) -+{ -+ if (id < 32) -+ map->m0 &= ~BIT(id); -+#if (MACID_NUM_SW_LIMIT > 32) -+ else if (id < 64) -+ map->m1 &= ~BIT(id - 32); -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ else if (id < 96) -+ map->m2 &= ~BIT(id - 64); -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ else if (id < 128) -+ map->m3 &= ~BIT(id - 96); -+#endif -+ else -+ rtw_warn_on(1); -+} -+ -+inline bool rtw_macid_is_used(struct macid_ctl_t *macid_ctl, u8 id) -+{ -+ return rtw_macid_is_set(&macid_ctl->used, id); -+} -+ -+inline bool rtw_macid_is_bmc(struct macid_ctl_t *macid_ctl, u8 id) -+{ -+ return rtw_macid_is_set(&macid_ctl->bmc, id); -+} -+ -+inline s8 rtw_macid_get_if_g(struct macid_ctl_t *macid_ctl, u8 id) -+{ -+ int i; -+ -+#ifdef CONFIG_SHARED_BMC_MACID -+ if (rtw_macid_is_bmc(macid_ctl, id)) { -+ for (i = 0; i < CONFIG_IFACE_NUMBER; i++) -+ if (macid_ctl->iface_bmc[i] == id) -+ return i; -+ return -1; -+ } -+#endif -+ -+ for (i = 0; i < CONFIG_IFACE_NUMBER; i++) { -+ if (rtw_macid_is_set(&macid_ctl->if_g[i], id)) -+ return i; -+ } -+ return -1; -+} -+ -+inline s8 rtw_macid_get_ch_g(struct macid_ctl_t *macid_ctl, u8 id) -+{ -+ int i; -+ -+ for (i = 0; i < 2; i++) { -+ if (rtw_macid_is_set(&macid_ctl->ch_g[i], id)) -+ return i; -+ } -+ return -1; -+} -+ -+void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta) -+{ -+ int i; -+ _irqL irqL; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct macid_bmp *used_map = &macid_ctl->used; -+ /* static u8 last_id = 0; for testing */ -+ u8 last_id = 0; -+ u8 is_bc_sta = _FALSE; -+ -+ if (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), ETH_ALEN)) { -+ psta->mac_id = macid_ctl->num; -+ return; -+ } -+ -+ if (_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) { -+ is_bc_sta = _TRUE; -+ rtw_iface_bcmc_id_set(padapter, INVALID_SEC_MAC_CAM_ID); /*init default value*/ -+ } -+ -+#ifdef CONFIG_SHARED_BMC_MACID -+ if (is_bc_sta -+#ifdef CONFIG_CONCURRENT_MODE -+ && (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) || check_fwstate(&padapter->mlmepriv, WIFI_NULL_STATE)) -+#endif -+ ) { -+ /* use shared broadcast & multicast macid 1 for all ifaces which configure to station mode*/ -+ _enter_critical_bh(&macid_ctl->lock, &irqL); -+ rtw_macid_map_set(used_map, 1); -+ rtw_macid_map_set(&macid_ctl->bmc, 1); -+ rtw_macid_map_set(&macid_ctl->if_g[padapter->iface_id], 1); -+ macid_ctl->sta[1] = psta; -+ /* TODO ch_g? */ -+ _exit_critical_bh(&macid_ctl->lock, &irqL); -+ i = 1; -+ goto assigned; -+ } -+#endif -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) { -+ if (MLME_IS_AP(padapter) || MLME_IS_GO(padapter)) -+ /* GO/AP assign client macid from 8 */ -+ last_id = 8; -+ } -+#endif /* CONFIG_MCC_MODE */ -+ -+ _enter_critical_bh(&macid_ctl->lock, &irqL); -+ -+ for (i = last_id; i < macid_ctl->num; i++) { -+#ifdef CONFIG_SHARED_BMC_MACID -+ if (i == 1) -+ continue; -+#endif -+ -+#ifdef CONFIG_MCC_MODE -+ /* macid 0/1 reserve for mcc for mgnt queue macid */ -+ if (MCC_EN(padapter)) { -+ if (i == MCC_ROLE_STA_GC_MGMT_QUEUE_MACID) -+ continue; -+ if (i == MCC_ROLE_SOFTAP_GO_MGMT_QUEUE_MACID) -+ continue; -+ } -+#endif /* CONFIG_MCC_MODE */ -+ -+ if (is_bc_sta) {/*for SoftAP's Broadcast sta-info*/ -+ /*TODO:non-security AP may allociated macid = 1*/ -+ struct cam_ctl_t *cam_ctl = dvobj_to_sec_camctl(dvobj); -+ -+ if ((!rtw_macid_is_used(macid_ctl, i)) && (!rtw_sec_camid_is_used(cam_ctl, i))) -+ break; -+ } else { -+ if (!rtw_macid_is_used(macid_ctl, i)) -+ break; -+ } -+ } -+ -+ if (i < macid_ctl->num) { -+ -+ rtw_macid_map_set(used_map, i); -+ -+ if (is_bc_sta) { -+ struct cam_ctl_t *cam_ctl = dvobj_to_sec_camctl(dvobj); -+ -+ rtw_macid_map_set(&macid_ctl->bmc, i); -+ rtw_iface_bcmc_id_set(padapter, i); -+ rtw_sec_cam_map_set(&cam_ctl->used, i); -+ } -+ -+ rtw_macid_map_set(&macid_ctl->if_g[padapter->iface_id], i); -+ macid_ctl->sta[i] = psta; -+ -+ /* TODO ch_g? */ -+ -+ last_id++; -+ last_id %= macid_ctl->num; -+ } -+ -+ _exit_critical_bh(&macid_ctl->lock, &irqL); -+ -+ if (i >= macid_ctl->num) { -+ psta->mac_id = macid_ctl->num; -+ RTW_ERR(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" no available macid\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->hwaddr)); -+ rtw_warn_on(1); -+ goto exit; -+ } else -+ goto assigned; -+ -+assigned: -+ psta->mac_id = i; -+ RTW_INFO(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" macid:%u\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->hwaddr), psta->mac_id); -+ -+exit: -+ return; -+} -+ -+void rtw_release_macid(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL; -+ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u8 is_bc_sta = _FALSE; -+ -+ if (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), ETH_ALEN)) -+ return; -+ -+ if (_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) -+ is_bc_sta = _TRUE; -+ -+#ifdef CONFIG_SHARED_BMC_MACID -+ if (is_bc_sta -+#ifdef CONFIG_CONCURRENT_MODE -+ && (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) || check_fwstate(&padapter->mlmepriv, WIFI_NULL_STATE)) -+#endif -+ ) -+ return; -+ -+ if (psta->mac_id == 1) { -+ RTW_ERR(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" with macid:%u\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->hwaddr), psta->mac_id); -+ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) || check_fwstate(&padapter->mlmepriv, WIFI_NULL_STATE)) -+ rtw_warn_on(1); -+ return; -+ } -+#endif -+ -+ _enter_critical_bh(&macid_ctl->lock, &irqL); -+ -+ if (psta->mac_id < macid_ctl->num) { -+ int i; -+ -+ if (!rtw_macid_is_used(macid_ctl, psta->mac_id)) { -+ RTW_ERR(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" macid:%u not used\n" -+ , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->hwaddr), psta->mac_id); -+ rtw_warn_on(1); -+ } -+ -+ rtw_macid_map_clr(&macid_ctl->used, psta->mac_id); -+ rtw_macid_map_clr(&macid_ctl->bmc, psta->mac_id); -+ -+ if (is_bc_sta) { -+ struct cam_ctl_t *cam_ctl = dvobj_to_sec_camctl(dvobj); -+ u8 id = rtw_iface_bcmc_id_get(padapter); -+ -+ if ((id != INVALID_SEC_MAC_CAM_ID) && (id < cam_ctl->num)) -+ rtw_sec_cam_map_clr(&cam_ctl->used, id); -+ -+ rtw_iface_bcmc_id_set(padapter, INVALID_SEC_MAC_CAM_ID); -+ } -+ -+ for (i = 0; i < CONFIG_IFACE_NUMBER; i++) -+ rtw_macid_map_clr(&macid_ctl->if_g[i], psta->mac_id); -+ for (i = 0; i < 2; i++) -+ rtw_macid_map_clr(&macid_ctl->ch_g[i], psta->mac_id); -+ macid_ctl->sta[psta->mac_id] = NULL; -+ } -+ -+ _exit_critical_bh(&macid_ctl->lock, &irqL); -+ -+ psta->mac_id = macid_ctl->num; -+} -+ -+/* For 8188E RA */ -+u8 rtw_search_max_mac_id(_adapter *padapter) -+{ -+ u8 max_mac_id = 0; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ int i; -+ _irqL irqL; -+ -+ /* TODO: Only search for connected macid? */ -+ -+ _enter_critical_bh(&macid_ctl->lock, &irqL); -+ for (i = (macid_ctl->num - 1); i > 0 ; i--) { -+ if (rtw_macid_is_used(macid_ctl, i)) -+ break; -+ } -+ _exit_critical_bh(&macid_ctl->lock, &irqL); -+ max_mac_id = i; -+ -+ return max_mac_id; -+} -+ -+inline void rtw_macid_ctl_set_h2c_msr(struct macid_ctl_t *macid_ctl, u8 id, u8 h2c_msr) -+{ -+ if (id >= macid_ctl->num) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ macid_ctl->h2c_msr[id] = h2c_msr; -+ if (0) -+ RTW_INFO("macid:%u, h2c_msr:"H2C_MSR_FMT"\n", id, H2C_MSR_ARG(&macid_ctl->h2c_msr[id])); -+} -+ -+inline void rtw_macid_ctl_set_bw(struct macid_ctl_t *macid_ctl, u8 id, u8 bw) -+{ -+ if (id >= macid_ctl->num) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ macid_ctl->bw[id] = bw; -+ if (0) -+ RTW_INFO("macid:%u, bw:%s\n", id, ch_width_str(macid_ctl->bw[id])); -+} -+ -+inline void rtw_macid_ctl_set_vht_en(struct macid_ctl_t *macid_ctl, u8 id, u8 en) -+{ -+ if (id >= macid_ctl->num) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ macid_ctl->vht_en[id] = en; -+ if (0) -+ RTW_INFO("macid:%u, vht_en:%u\n", id, macid_ctl->vht_en[id]); -+} -+ -+inline void rtw_macid_ctl_set_rate_bmp0(struct macid_ctl_t *macid_ctl, u8 id, u32 bmp) -+{ -+ if (id >= macid_ctl->num) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ macid_ctl->rate_bmp0[id] = bmp; -+ if (0) -+ RTW_INFO("macid:%u, rate_bmp0:0x%08X\n", id, macid_ctl->rate_bmp0[id]); -+} -+ -+inline void rtw_macid_ctl_set_rate_bmp1(struct macid_ctl_t *macid_ctl, u8 id, u32 bmp) -+{ -+ if (id >= macid_ctl->num) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ macid_ctl->rate_bmp1[id] = bmp; -+ if (0) -+ RTW_INFO("macid:%u, rate_bmp1:0x%08X\n", id, macid_ctl->rate_bmp1[id]); -+} -+ -+inline void rtw_macid_ctl_init(struct macid_ctl_t *macid_ctl) -+{ -+ _rtw_spinlock_init(&macid_ctl->lock); -+} -+ -+inline void rtw_macid_ctl_deinit(struct macid_ctl_t *macid_ctl) -+{ -+ _rtw_spinlock_free(&macid_ctl->lock); -+} -+ -+#if 0 -+unsigned int setup_beacon_frame(_adapter *padapter, unsigned char *beacon_frame) -+{ -+ unsigned short ATIMWindow; -+ unsigned char *pframe; -+ struct tx_desc *ptxdesc; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned int rate_len, len = 0; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ _rtw_memset(beacon_frame, 0, 256); -+ -+ pframe = beacon_frame + TXDESC_SIZE; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ -+ SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ len = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* timestamp will be inserted by hardware */ -+ pframe += 8; -+ len += 8; -+ -+ /* beacon interval: 2 bytes */ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ len += 2; -+ -+ /* capability info: 2 bytes */ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ len += 2; -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &len); -+ -+ /* supported rates... */ -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &len); -+ -+ /* DS parameter set */ -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &len); -+ -+ /* IBSS Parameter Set... */ -+ /* ATIMWindow = cur->Configuration.ATIMWindow; */ -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &len); -+ -+ /* todo: ERP IE */ -+ -+ /* EXTERNDED SUPPORTED RATE */ -+ if (rate_len > 8) -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &len); -+ -+ if ((len + TXDESC_SIZE) > 256) { -+ /* RTW_INFO("marc: beacon frame too large\n"); */ -+ return 0; -+ } -+ -+ /* fill the tx descriptor */ -+ ptxdesc = (struct tx_desc *)beacon_frame; -+ -+ /* offset 0 */ -+ ptxdesc->txdw0 |= cpu_to_le32(len & 0x0000ffff); -+ ptxdesc->txdw0 |= cpu_to_le32(((TXDESC_SIZE + OFFSET_SZ) << OFFSET_SHT) & 0x00ff0000); /* default = 32 bytes for TX Desc */ -+ -+ /* offset 4 */ -+ ptxdesc->txdw1 |= cpu_to_le32((0x10 << QSEL_SHT) & 0x00001f00); -+ -+ /* offset 8 */ -+ ptxdesc->txdw2 |= cpu_to_le32(BMC); -+ ptxdesc->txdw2 |= cpu_to_le32(BK); -+ -+ /* offset 16 */ -+ ptxdesc->txdw4 = 0x80000000; -+ -+ /* offset 20 */ -+ ptxdesc->txdw5 = 0x00000000; /* 1M */ -+ -+ return len + TXDESC_SIZE; -+} -+#endif -+ -+_adapter *dvobj_get_port0_adapter(struct dvobj_priv *dvobj) -+{ -+ _adapter *port0_iface = NULL; -+ int i; -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (get_hw_port(dvobj->padapters[i]) == HW_PORT0) -+ break; -+ } -+ -+ if (i < 0 || i >= dvobj->iface_nums) -+ rtw_warn_on(1); -+ else -+ port0_iface = dvobj->padapters[i]; -+ -+ return port0_iface; -+} -+ -+_adapter *dvobj_get_unregisterd_adapter(struct dvobj_priv *dvobj) -+{ -+ _adapter *adapter = NULL; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (dvobj->padapters[i]->registered == 0) -+ break; -+ } -+ -+ if (i < dvobj->iface_nums) -+ adapter = dvobj->padapters[i]; -+ -+ return adapter; -+} -+ -+_adapter *dvobj_get_adapter_by_addr(struct dvobj_priv *dvobj, u8 *addr) -+{ -+ _adapter *adapter = NULL; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (_rtw_memcmp(dvobj->padapters[i]->mac_addr, addr, ETH_ALEN) == _TRUE) -+ break; -+ } -+ -+ if (i < dvobj->iface_nums) -+ adapter = dvobj->padapters[i]; -+ -+ return adapter; -+} -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void rtw_get_current_ip_address(PADAPTER padapter, u8 *pcurrentip) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct in_device *my_ip_ptr = padapter->pnetdev->ip_ptr; -+ u8 ipaddress[4]; -+ -+ if ((pmlmeinfo->state & WIFI_FW_LINKING_STATE) || -+ pmlmeinfo->state & WIFI_FW_AP_STATE) { -+ if (my_ip_ptr != NULL) { -+ struct in_ifaddr *my_ifa_list = my_ip_ptr->ifa_list ; -+ if (my_ifa_list != NULL) { -+ ipaddress[0] = my_ifa_list->ifa_address & 0xFF; -+ ipaddress[1] = (my_ifa_list->ifa_address >> 8) & 0xFF; -+ ipaddress[2] = (my_ifa_list->ifa_address >> 16) & 0xFF; -+ ipaddress[3] = my_ifa_list->ifa_address >> 24; -+ RTW_INFO("%s: %d.%d.%d.%d ==========\n", __func__, -+ ipaddress[0], ipaddress[1], ipaddress[2], ipaddress[3]); -+ _rtw_memcpy(pcurrentip, ipaddress, 4); -+ } -+ } -+ } -+} -+#endif -+#ifdef CONFIG_WOWLAN -+bool rtw_wowlan_parser_pattern_cmd(u8 *input, char *pattern, -+ int *pattern_len, char *bit_mask) -+{ -+ char *cp = NULL, *end = NULL; -+ size_t len = 0; -+ int pos = 0, mask_pos = 0, res = 0; -+ u8 member[2] = {0}; -+ -+ cp = strchr(input, '='); -+ if (cp) { -+ *cp = 0; -+ cp++; -+ input = cp; -+ } -+ -+ while (1) { -+ cp = strchr(input, ':'); -+ -+ if (cp) { -+ len = strlen(input) - strlen(cp); -+ *cp = 0; -+ cp++; -+ } else -+ len = 2; -+ -+ if (bit_mask && (strcmp(input, "-") == 0 || -+ strcmp(input, "xx") == 0 || -+ strcmp(input, "--") == 0)) { -+ /* skip this byte and leave mask bit unset */ -+ } else { -+ u8 hex; -+ -+ strncpy(member, input, len); -+ if (!rtw_check_pattern_valid(member, sizeof(member))) { -+ RTW_INFO("%s:[ERROR] pattern is invalid!!\n", -+ __func__); -+ goto error; -+ } -+ -+ res = sscanf(member, "%02hhx", &hex); -+ pattern[pos] = hex; -+ mask_pos = pos / 8; -+ if (bit_mask) -+ bit_mask[mask_pos] |= 1 << (pos % 8); -+ } -+ -+ pos++; -+ if (!cp) -+ break; -+ input = cp; -+ } -+ -+ (*pattern_len) = pos; -+ -+ return _TRUE; -+error: -+ return _FALSE; -+} -+ -+bool rtw_check_pattern_valid(u8 *input, u8 len) -+{ -+ int i = 0; -+ bool res = _FALSE; -+ -+ if (len != 2) -+ goto exit; -+ -+ for (i = 0 ; i < len ; i++) -+ if (IsHexDigit(input[i]) == _FALSE) -+ goto exit; -+ -+ res = _SUCCESS; -+ -+exit: -+ return res; -+} -+ -+u8 rtw_set_default_pattern(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ u8 index = 0; -+ u8 currentip[4]; -+ u8 multicast_addr[3] = {0x01, 0x00, 0x5e}; -+ u8 multicast_ip[4] = {0xe0, 0x28, 0x28, 0x2a}; -+ u8 unicast_mask[5] = {0x3f, 0x70, 0x80, 0xc0, 0x03}; -+ u8 multicast_mask[5] = {0x07, 0x70, 0x80, 0xc0, 0x03}; -+ u8 ip_protocol[3] = {0x08, 0x00, 0x45}; -+ u8 icmp_protocol[1] = {0x01}; -+ u8 tcp_protocol[1] = {0x06}; -+ u8 udp_protocol[1] = {0x11}; -+ -+ if (pregistrypriv->default_patterns_en == _FALSE) -+ return 0; -+ -+ for (index = 0 ; index < DEFAULT_PATTERN_NUM ; index++) { -+ _rtw_memset(pwrpriv->patterns[index].content, 0, -+ sizeof(pwrpriv->patterns[index].content)); -+ _rtw_memset(pwrpriv->patterns[index].mask, 0, -+ sizeof(pwrpriv->patterns[index].mask)); -+ pwrpriv->patterns[index].len = 0; -+ } -+ -+ rtw_get_current_ip_address(adapter, currentip); -+ -+ /*TCP/ICMP unicast*/ -+ for (index = 0 ; index < DEFAULT_PATTERN_NUM ; index++) { -+ switch (index) { -+ case 0: -+ _rtw_memcpy(pwrpriv->patterns[index].content, -+ adapter_mac_addr(adapter), -+ ETH_ALEN); -+ _rtw_memcpy(pwrpriv->patterns[index].content + ETH_TYPE_OFFSET, -+ &ip_protocol, sizeof(ip_protocol)); -+ _rtw_memcpy(pwrpriv->patterns[index].content + PROTOCOL_OFFSET, -+ &tcp_protocol, sizeof(tcp_protocol)); -+ _rtw_memcpy(pwrpriv->patterns[index].content + IP_OFFSET, -+ ¤tip, sizeof(currentip)); -+ _rtw_memcpy(pwrpriv->patterns[index].mask, -+ &unicast_mask, sizeof(unicast_mask)); -+ pwrpriv->patterns[index].len = IP_OFFSET + sizeof(currentip); -+ break; -+ case 1: -+ _rtw_memcpy(pwrpriv->patterns[index].content, -+ adapter_mac_addr(adapter), -+ ETH_ALEN); -+ _rtw_memcpy(pwrpriv->patterns[index].content + ETH_TYPE_OFFSET, -+ &ip_protocol, sizeof(ip_protocol)); -+ _rtw_memcpy(pwrpriv->patterns[index].content + PROTOCOL_OFFSET, -+ &icmp_protocol, sizeof(icmp_protocol)); -+ _rtw_memcpy(pwrpriv->patterns[index].content + IP_OFFSET, -+ ¤tip, sizeof(currentip)); -+ _rtw_memcpy(pwrpriv->patterns[index].mask, -+ &unicast_mask, sizeof(unicast_mask)); -+ pwrpriv->patterns[index].len = IP_OFFSET + sizeof(currentip); -+ break; -+ case 2: -+ _rtw_memcpy(pwrpriv->patterns[index].content, &multicast_addr, -+ sizeof(multicast_addr)); -+ _rtw_memcpy(pwrpriv->patterns[index].content + ETH_TYPE_OFFSET, -+ &ip_protocol, sizeof(ip_protocol)); -+ _rtw_memcpy(pwrpriv->patterns[index].content + PROTOCOL_OFFSET, -+ &udp_protocol, sizeof(udp_protocol)); -+ _rtw_memcpy(pwrpriv->patterns[index].content + IP_OFFSET, -+ &multicast_ip, sizeof(multicast_ip)); -+ _rtw_memcpy(pwrpriv->patterns[index].mask, -+ &multicast_mask, sizeof(multicast_mask)); -+ pwrpriv->patterns[index].len = -+ IP_OFFSET + sizeof(multicast_ip); -+ break; -+ } -+ } -+ -+ return index; -+} -+ -+bool rtw_read_from_frame_mask(_adapter *adapter, u8 idx) -+{ -+ u32 data_l = 0, data_h = 0, rx_dma_buff_sz = 0, page_sz = 0; -+ u16 offset, rx_buf_ptr = 0; -+ u16 cam_start_offset = 0; -+ u16 ctrl_l = 0, ctrl_h = 0; -+ u8 count = 0, tmp = 0; -+ int i = 0; -+ bool res = _TRUE; -+ -+ if (idx > MAX_WKFM_NUM) { -+ RTW_INFO("[Error]: %s, pattern index is out of range\n", -+ __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, -+ (u8 *)&rx_dma_buff_sz); -+ -+ if (rx_dma_buff_sz == 0) { -+ RTW_INFO("[Error]: %s, rx_dma_buff_sz is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_PAGE_SIZE, (u8 *)&page_sz); -+ -+ if (page_sz == 0) { -+ RTW_INFO("[Error]: %s, page_sz is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ offset = (u16)PageNum(rx_dma_buff_sz, page_sz); -+ cam_start_offset = offset * page_sz; -+ -+ ctrl_l = 0x0; -+ ctrl_h = 0x0; -+ -+ /* Enable RX packet buffer access */ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, RXPKT_BUF_SELECT); -+ -+ /* Read the WKFM CAM */ -+ for (i = 0; i < (WKFMCAM_ADDR_NUM / 2); i++) { -+ /* -+ * Set Rx packet buffer offset. -+ * RxBufer pointer increases 1, we can access 8 bytes in Rx packet buffer. -+ * CAM start offset (unit: 1 byte) = Index*WKFMCAM_SIZE -+ * RxBufer pointer addr = (CAM start offset + per entry offset of a WKFMCAM)/8 -+ * * Index: The index of the wake up frame mask -+ * * WKFMCAM_SIZE: the total size of one WKFM CAM -+ * * per entry offset of a WKFM CAM: Addr i * 4 bytes -+ */ -+ rx_buf_ptr = -+ (cam_start_offset + idx * WKFMCAM_SIZE + i * 8) >> 3; -+ rtw_write16(adapter, REG_PKTBUF_DBG_CTRL, rx_buf_ptr); -+ -+ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); -+ data_l = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L); -+ data_h = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); -+ -+ RTW_INFO("[%d]: %08x %08x\n", i, data_h, data_l); -+ -+ count = 0; -+ -+ do { -+ tmp = rtw_read8(adapter, REG_RXPKTBUF_CTRL); -+ rtw_udelay_os(2); -+ count++; -+ } while (!tmp && count < 100); -+ -+ if (count >= 100) { -+ RTW_INFO("%s count:%d\n", __func__, count); -+ res = _FALSE; -+ } -+ } -+ -+ /* Disable RX packet buffer access */ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, -+ DISABLE_TRXPKT_BUF_ACCESS); -+ return res; -+} -+ -+bool rtw_write_to_frame_mask(_adapter *adapter, u8 idx, -+ struct rtl_wow_pattern *context) -+{ -+ u32 data = 0, rx_dma_buff_sz = 0, page_sz = 0; -+ u16 offset, rx_buf_ptr = 0; -+ u16 cam_start_offset = 0; -+ u16 ctrl_l = 0, ctrl_h = 0; -+ u8 count = 0, tmp = 0; -+ int res = 0, i = 0; -+ -+ if (idx > MAX_WKFM_NUM) { -+ RTW_INFO("[Error]: %s, pattern index is out of range\n", -+ __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, -+ (u8 *)&rx_dma_buff_sz); -+ -+ if (rx_dma_buff_sz == 0) { -+ RTW_INFO("[Error]: %s, rx_dma_buff_sz is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_PAGE_SIZE, (u8 *)&page_sz); -+ -+ if (page_sz == 0) { -+ RTW_INFO("[Error]: %s, page_sz is 0!!\n", __func__); -+ return _FALSE; -+ } -+ -+ offset = (u16)PageNum(rx_dma_buff_sz, page_sz); -+ -+ cam_start_offset = offset * page_sz; -+ -+ if (IS_HARDWARE_TYPE_8188E(adapter)) { -+ ctrl_l = 0x0001; -+ ctrl_h = 0x0001; -+ } else { -+ ctrl_l = 0x0f01; -+ ctrl_h = 0xf001; -+ } -+ -+ /* Enable RX packet buffer access */ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, RXPKT_BUF_SELECT); -+ -+ /* Write the WKFM CAM */ -+ for (i = 0; i < WKFMCAM_ADDR_NUM; i++) { -+ /* -+ * Set Rx packet buffer offset. -+ * RxBufer pointer increases 1, we can access 8 bytes in Rx packet buffer. -+ * CAM start offset (unit: 1 byte) = Index*WKFMCAM_SIZE -+ * RxBufer pointer addr = (CAM start offset + per entry offset of a WKFMCAM)/8 -+ * * Index: The index of the wake up frame mask -+ * * WKFMCAM_SIZE: the total size of one WKFM CAM -+ * * per entry offset of a WKFM CAM: Addr i * 4 bytes -+ */ -+ rx_buf_ptr = -+ (cam_start_offset + idx * WKFMCAM_SIZE + i * 4) >> 3; -+ rtw_write16(adapter, REG_PKTBUF_DBG_CTRL, rx_buf_ptr); -+ -+ if (i == 0) { -+ if (context->type == PATTERN_VALID) -+ data = BIT(31); -+ else if (context->type == PATTERN_BROADCAST) -+ data = BIT(31) | BIT(26); -+ else if (context->type == PATTERN_MULTICAST) -+ data = BIT(31) | BIT(25); -+ else if (context->type == PATTERN_UNICAST) -+ data = BIT(31) | BIT(24); -+ -+ if (context->crc != 0) -+ data |= context->crc; -+ -+ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_L, data); -+ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); -+ } else if (i == 1) { -+ data = 0; -+ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, data); -+ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_h); -+ } else if (i == 2 || i == 4) { -+ data = context->mask[i - 2]; -+ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_L, data); -+ /* write to RX packet buffer*/ -+ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); -+ } else if (i == 3 || i == 5) { -+ data = context->mask[i - 2]; -+ rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, data); -+ /* write to RX packet buffer*/ -+ rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_h); -+ } -+ -+ count = 0; -+ do { -+ tmp = rtw_read8(adapter, REG_RXPKTBUF_CTRL); -+ rtw_udelay_os(2); -+ count++; -+ } while (tmp && count < 100); -+ -+ if (count >= 100) -+ res = _FALSE; -+ else -+ res = _TRUE; -+ } -+ -+ /* Disable RX packet buffer access */ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, -+ DISABLE_TRXPKT_BUF_ACCESS); -+ -+ return res; -+} -+ -+ -+void rtw_dump_priv_pattern(_adapter *adapter, u8 idx) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ char str_1[128]; -+ char *p_str; -+ u8 val8 = 0; -+ int i = 0, j = 0, len = 0, max_len = 0; -+ -+ RTW_INFO("=========[%d]========\n", idx); -+ -+ RTW_INFO(">>>priv_pattern_content:\n"); -+ p_str = str_1; -+ max_len = sizeof(str_1); -+ for (i = 0 ; i < MAX_WKFM_PATTERN_SIZE / 8 ; i++) { -+ _rtw_memset(p_str, 0, max_len); -+ len = 0; -+ for (j = 0 ; j < 8 ; j++) { -+ val8 = pwrctl->patterns[idx].content[i * 8 + j]; -+ len += snprintf(p_str + len, max_len - len, -+ "%02x ", val8); -+ } -+ RTW_INFO("%s\n", p_str); -+ } -+ -+ RTW_INFO(">>>priv_pattern_mask:\n"); -+ for (i = 0 ; i < MAX_WKFM_SIZE / 8 ; i++) { -+ _rtw_memset(p_str, 0, max_len); -+ len = 0; -+ for (j = 0 ; j < 8 ; j++) { -+ val8 = pwrctl->patterns[idx].mask[i * 8 + j]; -+ len += snprintf(p_str + len, max_len - len, -+ "%02x ", val8); -+ } -+ RTW_INFO("%s\n", p_str); -+ } -+ -+ RTW_INFO(">>>priv_pattern_len:\n"); -+ RTW_INFO("%s: len: %d\n", __func__, pwrctl->patterns[idx].len); -+} -+ -+void rtw_clean_pattern(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct rtl_wow_pattern zero_pattern; -+ int i = 0; -+ -+ _rtw_memset(&zero_pattern, 0, sizeof(struct rtl_wow_pattern)); -+ -+ zero_pattern.type = PATTERN_INVALID; -+ -+ for (i = 0; i < MAX_WKFM_NUM; i++) -+ rtw_write_to_frame_mask(adapter, i, &zero_pattern); -+ -+ rtw_write8(adapter, REG_WKFMCAM_NUM, 0); -+} -+ -+void rtw_get_sec_iv(PADAPTER padapter, u8 *pcur_dot11txpn, u8 *StaAddr) -+{ -+ struct sta_info *psta; -+ struct security_priv *psecpriv = &padapter->securitypriv; -+ -+ _rtw_memset(pcur_dot11txpn, 0, 8); -+ if (NULL == StaAddr) -+ return; -+ psta = rtw_get_stainfo(&padapter->stapriv, StaAddr); -+ RTW_INFO("%s(): StaAddr: %02x %02x %02x %02x %02x %02x\n", -+ __func__, StaAddr[0], StaAddr[1], StaAddr[2], -+ StaAddr[3], StaAddr[4], StaAddr[5]); -+ -+ if (psta) { -+ if (psecpriv->dot11PrivacyAlgrthm == _AES_) -+ AES_IV(pcur_dot11txpn, psta->dot11txpn, 0); -+ else if (psecpriv->dot11PrivacyAlgrthm == _TKIP_) -+ TKIP_IV(pcur_dot11txpn, psta->dot11txpn, 0); -+ -+ RTW_INFO("%s(): CurrentIV: %02x %02x %02x %02x %02x %02x %02x %02x\n" -+ , __func__, pcur_dot11txpn[0], pcur_dot11txpn[1], -+ pcur_dot11txpn[2], pcur_dot11txpn[3], pcur_dot11txpn[4], -+ pcur_dot11txpn[5], pcur_dot11txpn[6], pcur_dot11txpn[7]); -+ } -+} -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_PNO_SUPPORT -+#define CSCAN_TLV_TYPE_SSID_IE 'S' -+#define CIPHER_IE "key_mgmt=" -+#define CIPHER_NONE "NONE" -+#define CIPHER_WPA_PSK "WPA-PSK" -+#define CIPHER_WPA_EAP "WPA-EAP IEEE8021X" -+/* -+ * SSIDs list parsing from cscan tlv list -+ */ -+int rtw_parse_ssid_list_tlv(char **list_str, pno_ssid_t *ssid, -+ int max, int *bytes_left) -+{ -+ char *str; -+ -+ int idx = 0; -+ -+ if ((list_str == NULL) || (*list_str == NULL) || (*bytes_left < 0)) { -+ RTW_INFO("%s error paramters\n", __func__); -+ return -1; -+ } -+ -+ str = *list_str; -+ while (*bytes_left > 0) { -+ -+ if (str[0] != CSCAN_TLV_TYPE_SSID_IE) { -+ *list_str = str; -+ RTW_INFO("nssid=%d left_parse=%d %d\n", idx, *bytes_left, str[0]); -+ return idx; -+ } -+ -+ /* Get proper CSCAN_TLV_TYPE_SSID_IE */ -+ *bytes_left -= 1; -+ str += 1; -+ -+ if (str[0] == 0) { -+ /* Broadcast SSID */ -+ ssid[idx].SSID_len = 0; -+ memset((char *)ssid[idx].SSID, 0x0, WLAN_SSID_MAXLEN); -+ *bytes_left -= 1; -+ str += 1; -+ -+ RTW_INFO("BROADCAST SCAN left=%d\n", *bytes_left); -+ } else if (str[0] <= WLAN_SSID_MAXLEN) { -+ /* Get proper SSID size */ -+ ssid[idx].SSID_len = str[0]; -+ *bytes_left -= 1; -+ str += 1; -+ -+ /* Get SSID */ -+ if (ssid[idx].SSID_len > *bytes_left) { -+ RTW_INFO("%s out of memory range len=%d but left=%d\n", -+ __func__, ssid[idx].SSID_len, *bytes_left); -+ return -1; -+ } -+ -+ memcpy((char *)ssid[idx].SSID, str, ssid[idx].SSID_len); -+ -+ *bytes_left -= ssid[idx].SSID_len; -+ str += ssid[idx].SSID_len; -+ -+ RTW_INFO("%s :size=%d left=%d\n", -+ (char *)ssid[idx].SSID, ssid[idx].SSID_len, *bytes_left); -+ } else { -+ RTW_INFO("### SSID size more that %d\n", str[0]); -+ return -1; -+ } -+ -+ if (idx++ > max) { -+ RTW_INFO("%s number of SSIDs more that %d\n", __func__, idx); -+ return -1; -+ } -+ } -+ -+ *list_str = str; -+ return idx; -+} -+ -+int rtw_parse_cipher_list(struct pno_nlo_info *nlo_info, char *list_str) -+{ -+ -+ char *pch, *pnext, *pend; -+ u8 key_len = 0, index = 0; -+ -+ pch = list_str; -+ -+ if (nlo_info == NULL || list_str == NULL) { -+ RTW_INFO("%s error paramters\n", __func__); -+ return -1; -+ } -+ -+ while (strlen(pch) != 0) { -+ pnext = strstr(pch, "key_mgmt="); -+ if (pnext != NULL) { -+ pch = pnext + strlen(CIPHER_IE); -+ pend = strstr(pch, "}"); -+ if (strncmp(pch, CIPHER_NONE, -+ strlen(CIPHER_NONE)) == 0) -+ nlo_info->ssid_cipher_info[index] = 0x00; -+ else if (strncmp(pch, CIPHER_WPA_PSK, -+ strlen(CIPHER_WPA_PSK)) == 0) -+ nlo_info->ssid_cipher_info[index] = 0x66; -+ else if (strncmp(pch, CIPHER_WPA_EAP, -+ strlen(CIPHER_WPA_EAP)) == 0) -+ nlo_info->ssid_cipher_info[index] = 0x01; -+ index++; -+ pch = pend + 1; -+ } else -+ break; -+ } -+ return 0; -+} -+ -+int rtw_dev_nlo_info_set(struct pno_nlo_info *nlo_info, pno_ssid_t *ssid, -+ int num, int pno_time, int pno_repeat, int pno_freq_expo_max) -+{ -+ -+ int i = 0; -+ struct file *fp; -+ mm_segment_t fs; -+ loff_t pos = 0; -+ u8 *source = NULL; -+ long len = 0; -+ -+ RTW_INFO("+%s+\n", __func__); -+ -+ nlo_info->fast_scan_period = pno_time; -+ nlo_info->ssid_num = num & BIT_LEN_MASK_32(8); -+ nlo_info->hidden_ssid_num = num & BIT_LEN_MASK_32(8); -+ nlo_info->slow_scan_period = (pno_time * 2); -+ nlo_info->fast_scan_iterations = 5; -+ -+ if (nlo_info->hidden_ssid_num > 8) -+ nlo_info->hidden_ssid_num = 8; -+ -+ /* TODO: channel list and probe index is all empty. */ -+ for (i = 0 ; i < num ; i++) { -+ nlo_info->ssid_length[i] -+ = ssid[i].SSID_len; -+ } -+ -+ /* cipher array */ -+ fp = filp_open("/home/timlee/wpa_kk/wpa.conf", O_RDONLY, 0644); -+ if (IS_ERR(fp)) { -+ RTW_INFO("Error, wpa_supplicant.conf doesn't exist.\n"); -+ RTW_INFO("Error, cipher array using default value.\n"); -+ return 0; -+ } -+ -+ len = i_size_read(fp->f_path.dentry->d_inode); -+ if (len < 0 || len > 2048) { -+ RTW_INFO("Error, file size is bigger than 2048.\n"); -+ RTW_INFO("Error, cipher array using default value.\n"); -+ return 0; -+ } -+ -+ fs = get_fs(); -+ set_fs(KERNEL_DS); -+ -+ source = rtw_zmalloc(2048); -+ -+ if (source != NULL) { -+ len = vfs_read(fp, source, len, &pos); -+ rtw_parse_cipher_list(nlo_info, source); -+ rtw_mfree(source, 2048); -+ } -+ -+ set_fs(fs); -+ filp_close(fp, NULL); -+ -+ RTW_INFO("-%s-\n", __func__); -+ return 0; -+} -+ -+int rtw_dev_ssid_list_set(struct pno_ssid_list *pno_ssid_list, -+ pno_ssid_t *ssid, u8 num) -+{ -+ -+ int i = 0; -+ if (num > MAX_PNO_LIST_COUNT) -+ num = MAX_PNO_LIST_COUNT; -+ -+ for (i = 0 ; i < num ; i++) { -+ _rtw_memcpy(&pno_ssid_list->node[i].SSID, -+ ssid[i].SSID, ssid[i].SSID_len); -+ pno_ssid_list->node[i].SSID_len = ssid[i].SSID_len; -+ } -+ return 0; -+} -+ -+int rtw_dev_scan_info_set(_adapter *padapter, pno_ssid_t *ssid, -+ unsigned char ch, unsigned char ch_offset, unsigned short bw_mode) -+{ -+ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct pno_scan_info *scan_info = pwrctl->pscan_info; -+ int i; -+ -+ scan_info->channel_num = MAX_SCAN_LIST_COUNT; -+ scan_info->orig_ch = ch; -+ scan_info->orig_bw = bw_mode; -+ scan_info->orig_40_offset = ch_offset; -+ -+ for (i = 0 ; i < scan_info->channel_num ; i++) { -+ if (i < 11) -+ scan_info->ssid_channel_info[i].active = 1; -+ else -+ scan_info->ssid_channel_info[i].active = 0; -+ -+ scan_info->ssid_channel_info[i].timeout = 100; -+ -+ scan_info->ssid_channel_info[i].tx_power = -+ PHY_GetTxPowerIndex(padapter, 0, 0x02, bw_mode, i + 1); -+ -+ scan_info->ssid_channel_info[i].channel = i + 1; -+ } -+ -+ RTW_INFO("%s, channel_num: %d, orig_ch: %d, orig_bw: %d orig_40_offset: %d\n", -+ __func__, scan_info->channel_num, scan_info->orig_ch, -+ scan_info->orig_bw, scan_info->orig_40_offset); -+ return 0; -+} -+ -+int rtw_dev_pno_set(struct net_device *net, pno_ssid_t *ssid, int num, -+ int pno_time, int pno_repeat, int pno_freq_expo_max) -+{ -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ int ret = -1; -+ -+ if (num == 0) { -+ RTW_INFO("%s, nssid is zero, no need to setup pno ssid list\n", __func__); -+ return 0; -+ } -+ -+ if (pwrctl == NULL) { -+ RTW_INFO("%s, ERROR: pwrctl is NULL\n", __func__); -+ return -1; -+ } else { -+ pwrctl->pnlo_info = -+ (pno_nlo_info_t *)rtw_zmalloc(sizeof(pno_nlo_info_t)); -+ pwrctl->pno_ssid_list = -+ (pno_ssid_list_t *)rtw_zmalloc(sizeof(pno_ssid_list_t)); -+ pwrctl->pscan_info = -+ (pno_scan_info_t *)rtw_zmalloc(sizeof(pno_scan_info_t)); -+ } -+ -+ if (pwrctl->pnlo_info == NULL || -+ pwrctl->pscan_info == NULL || -+ pwrctl->pno_ssid_list == NULL) { -+ RTW_INFO("%s, ERROR: alloc nlo_info, ssid_list, scan_info fail\n", __func__); -+ goto failing; -+ } -+ -+ pwrctl->wowlan_in_resume = _FALSE; -+ -+ pwrctl->pno_inited = _TRUE; -+ /* NLO Info */ -+ ret = rtw_dev_nlo_info_set(pwrctl->pnlo_info, ssid, num, -+ pno_time, pno_repeat, pno_freq_expo_max); -+ -+ /* SSID Info */ -+ ret = rtw_dev_ssid_list_set(pwrctl->pno_ssid_list, ssid, num); -+ -+ /* SCAN Info */ -+ ret = rtw_dev_scan_info_set(padapter, ssid, pmlmeext->cur_channel, -+ pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ RTW_INFO("+%s num: %d, pno_time: %d, pno_repeat:%d, pno_freq_expo_max:%d+\n", -+ __func__, num, pno_time, pno_repeat, pno_freq_expo_max); -+ -+ return 0; -+ -+failing: -+ if (pwrctl->pnlo_info) { -+ rtw_mfree((u8 *)pwrctl->pnlo_info, sizeof(pno_nlo_info_t)); -+ pwrctl->pnlo_info = NULL; -+ } -+ if (pwrctl->pno_ssid_list) { -+ rtw_mfree((u8 *)pwrctl->pno_ssid_list, sizeof(pno_ssid_list_t)); -+ pwrctl->pno_ssid_list = NULL; -+ } -+ if (pwrctl->pscan_info) { -+ rtw_mfree((u8 *)pwrctl->pscan_info, sizeof(pno_scan_info_t)); -+ pwrctl->pscan_info = NULL; -+ } -+ -+ return -1; -+} -+ -+#ifdef CONFIG_PNO_SET_DEBUG -+void rtw_dev_pno_debug(struct net_device *net) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ int i = 0, j = 0; -+ -+ RTW_INFO("*******NLO_INFO********\n"); -+ RTW_INFO("ssid_num: %d\n", pwrctl->pnlo_info->ssid_num); -+ RTW_INFO("fast_scan_iterations: %d\n", -+ pwrctl->pnlo_info->fast_scan_iterations); -+ RTW_INFO("fast_scan_period: %d\n", pwrctl->pnlo_info->fast_scan_period); -+ RTW_INFO("slow_scan_period: %d\n", pwrctl->pnlo_info->slow_scan_period); -+ -+ -+ -+ for (i = 0 ; i < MAX_PNO_LIST_COUNT ; i++) { -+ RTW_INFO("%d SSID (%s) length (%d) cipher(%x) channel(%d)\n", -+ i, pwrctl->pno_ssid_list->node[i].SSID, pwrctl->pnlo_info->ssid_length[i], -+ pwrctl->pnlo_info->ssid_cipher_info[i], pwrctl->pnlo_info->ssid_channel_info[i]); -+ } -+ -+ RTW_INFO("******SCAN_INFO******\n"); -+ RTW_INFO("ch_num: %d\n", pwrctl->pscan_info->channel_num); -+ RTW_INFO("orig_ch: %d\n", pwrctl->pscan_info->orig_ch); -+ RTW_INFO("orig bw: %d\n", pwrctl->pscan_info->orig_bw); -+ RTW_INFO("orig 40 offset: %d\n", pwrctl->pscan_info->orig_40_offset); -+ for (i = 0 ; i < MAX_SCAN_LIST_COUNT ; i++) { -+ RTW_INFO("[%02d] avtive:%d, timeout:%d, tx_power:%d, ch:%02d\n", -+ i, pwrctl->pscan_info->ssid_channel_info[i].active, -+ pwrctl->pscan_info->ssid_channel_info[i].timeout, -+ pwrctl->pscan_info->ssid_channel_info[i].tx_power, -+ pwrctl->pscan_info->ssid_channel_info[i].channel); -+ } -+ RTW_INFO("*****************\n"); -+} -+#endif /* CONFIG_PNO_SET_DEBUG */ -+#endif /* CONFIG_PNO_SUPPORT */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/core/rtw_xmit.c linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_xmit.c ---- linux-4.14.18/3rdparty/rtl8723de/core/rtw_xmit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/core/rtw_xmit.c 2018-02-11 21:44:27.143146025 +0200 -@@ -0,0 +1,5057 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTW_XMIT_C_ -+ -+#include -+#include -+ -+#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+ #error "Shall be Linux or Windows, but not both!\n" -+#endif -+ -+ -+static u8 P802_1H_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0xf8 }; -+static u8 RFC1042_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0x00 }; -+ -+static void _init_txservq(struct tx_servq *ptxservq) -+{ -+ _rtw_init_listhead(&ptxservq->tx_pending); -+ _rtw_init_queue(&ptxservq->sta_pending); -+ ptxservq->qcnt = 0; -+} -+ -+ -+void _rtw_init_sta_xmit_priv(struct sta_xmit_priv *psta_xmitpriv) -+{ -+ -+ -+ _rtw_memset((unsigned char *)psta_xmitpriv, 0, sizeof(struct sta_xmit_priv)); -+ -+ _rtw_spinlock_init(&psta_xmitpriv->lock); -+ -+ /* for(i = 0 ; i < MAX_NUMBLKS; i++) */ -+ /* _init_txservq(&(psta_xmitpriv->blk_q[i])); */ -+ -+ _init_txservq(&psta_xmitpriv->be_q); -+ _init_txservq(&psta_xmitpriv->bk_q); -+ _init_txservq(&psta_xmitpriv->vi_q); -+ _init_txservq(&psta_xmitpriv->vo_q); -+ _rtw_init_listhead(&psta_xmitpriv->legacy_dz); -+ _rtw_init_listhead(&psta_xmitpriv->apsd); -+ -+ -+} -+ -+s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, _adapter *padapter) -+{ -+ int i; -+ struct xmit_buf *pxmitbuf; -+ struct xmit_frame *pxframe; -+ sint res = _SUCCESS; -+ -+ -+ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). */ -+ /* _rtw_memset((unsigned char *)pxmitpriv, 0, sizeof(struct xmit_priv)); */ -+ -+ _rtw_spinlock_init(&pxmitpriv->lock); -+ _rtw_spinlock_init(&pxmitpriv->lock_sctx); -+ _rtw_init_sema(&pxmitpriv->xmit_sema, 0); -+ /*_rtw_init_sema(&pxmitpriv->terminate_xmitthread_sema, 0);*/ -+ _rtw_init_completion(&pxmitpriv->xmitthread_comp); -+ -+ /* -+ Please insert all the queue initializaiton using _rtw_init_queue below -+ */ -+ -+ pxmitpriv->adapter = padapter; -+ -+ /* for(i = 0 ; i < MAX_NUMBLKS; i++) */ -+ /* _rtw_init_queue(&pxmitpriv->blk_strms[i]); */ -+ -+ _rtw_init_queue(&pxmitpriv->be_pending); -+ _rtw_init_queue(&pxmitpriv->bk_pending); -+ _rtw_init_queue(&pxmitpriv->vi_pending); -+ _rtw_init_queue(&pxmitpriv->vo_pending); -+ _rtw_init_queue(&pxmitpriv->bm_pending); -+ -+ /* _rtw_init_queue(&pxmitpriv->legacy_dz_queue); */ -+ /* _rtw_init_queue(&pxmitpriv->apsd_queue); */ -+ -+ _rtw_init_queue(&pxmitpriv->free_xmit_queue); -+ -+ /* -+ Please allocate memory with the sz = (struct xmit_frame) * NR_XMITFRAME, -+ and initialize free_xmit_frame below. -+ Please also apply free_txobj to link_up all the xmit_frames... -+ */ -+ -+ pxmitpriv->pallocated_frame_buf = rtw_zvmalloc(NR_XMITFRAME * sizeof(struct xmit_frame) + 4); -+ -+ if (pxmitpriv->pallocated_frame_buf == NULL) { -+ pxmitpriv->pxmit_frame_buf = NULL; -+ res = _FAIL; -+ goto exit; -+ } -+ pxmitpriv->pxmit_frame_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_frame_buf), 4); -+ /* pxmitpriv->pxmit_frame_buf = pxmitpriv->pallocated_frame_buf + 4 - */ -+ /* ((SIZE_PTR) (pxmitpriv->pallocated_frame_buf) &3); */ -+ -+ pxframe = (struct xmit_frame *) pxmitpriv->pxmit_frame_buf; -+ -+ for (i = 0; i < NR_XMITFRAME; i++) { -+ _rtw_init_listhead(&(pxframe->list)); -+ -+ pxframe->padapter = padapter; -+ pxframe->frame_tag = NULL_FRAMETAG; -+ -+ pxframe->pkt = NULL; -+ -+ pxframe->buf_addr = NULL; -+ pxframe->pxmitbuf = NULL; -+ -+ rtw_list_insert_tail(&(pxframe->list), &(pxmitpriv->free_xmit_queue.queue)); -+ -+ pxframe++; -+ } -+ -+ pxmitpriv->free_xmitframe_cnt = NR_XMITFRAME; -+ -+ pxmitpriv->frag_len = MAX_FRAG_THRESHOLD; -+ -+ -+ /* init xmit_buf */ -+ _rtw_init_queue(&pxmitpriv->free_xmitbuf_queue); -+ _rtw_init_queue(&pxmitpriv->pending_xmitbuf_queue); -+ -+ pxmitpriv->pallocated_xmitbuf = rtw_zvmalloc(NR_XMITBUFF * sizeof(struct xmit_buf) + 4); -+ -+ if (pxmitpriv->pallocated_xmitbuf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pxmitpriv->pxmitbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_xmitbuf), 4); -+ /* pxmitpriv->pxmitbuf = pxmitpriv->pallocated_xmitbuf + 4 - */ -+ /* ((SIZE_PTR) (pxmitpriv->pallocated_xmitbuf) &3); */ -+ -+ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf; -+ -+ for (i = 0; i < NR_XMITBUFF; i++) { -+ _rtw_init_listhead(&pxmitbuf->list); -+ -+ pxmitbuf->priv_data = NULL; -+ pxmitbuf->padapter = padapter; -+ pxmitbuf->buf_tag = XMITBUF_DATA; -+ -+ /* Tx buf allocation may fail sometimes, so sleep and retry. */ -+ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, (MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), _TRUE); -+ if (res == _FAIL) { -+ rtw_msleep_os(10); -+ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, (MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), _TRUE); -+ if (res == _FAIL) -+ goto exit; -+ } -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->phead = pxmitbuf->pbuf; -+ pxmitbuf->pend = pxmitbuf->pbuf + MAX_XMITBUF_SZ; -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+#endif -+ -+ pxmitbuf->flags = XMIT_VO_QUEUE; -+ -+ rtw_list_insert_tail(&pxmitbuf->list, &(pxmitpriv->free_xmitbuf_queue.queue)); -+#ifdef DBG_XMIT_BUF -+ pxmitbuf->no = i; -+#endif -+ -+ pxmitbuf++; -+ -+ } -+ -+ pxmitpriv->free_xmitbuf_cnt = NR_XMITBUFF; -+ -+ /* init xframe_ext queue, the same count as extbuf */ -+ _rtw_init_queue(&pxmitpriv->free_xframe_ext_queue); -+ -+ pxmitpriv->xframe_ext_alloc_addr = rtw_zvmalloc(NR_XMIT_EXTBUFF * sizeof(struct xmit_frame) + 4); -+ -+ if (pxmitpriv->xframe_ext_alloc_addr == NULL) { -+ pxmitpriv->xframe_ext = NULL; -+ res = _FAIL; -+ goto exit; -+ } -+ pxmitpriv->xframe_ext = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->xframe_ext_alloc_addr), 4); -+ pxframe = (struct xmit_frame *)pxmitpriv->xframe_ext; -+ -+ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { -+ _rtw_init_listhead(&(pxframe->list)); -+ -+ pxframe->padapter = padapter; -+ pxframe->frame_tag = NULL_FRAMETAG; -+ -+ pxframe->pkt = NULL; -+ -+ pxframe->buf_addr = NULL; -+ pxframe->pxmitbuf = NULL; -+ -+ pxframe->ext_tag = 1; -+ -+ rtw_list_insert_tail(&(pxframe->list), &(pxmitpriv->free_xframe_ext_queue.queue)); -+ -+ pxframe++; -+ } -+ pxmitpriv->free_xframe_ext_cnt = NR_XMIT_EXTBUFF; -+ -+ /* Init xmit extension buff */ -+ _rtw_init_queue(&pxmitpriv->free_xmit_extbuf_queue); -+ -+ pxmitpriv->pallocated_xmit_extbuf = rtw_zvmalloc(NR_XMIT_EXTBUFF * sizeof(struct xmit_buf) + 4); -+ -+ if (pxmitpriv->pallocated_xmit_extbuf == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pxmitpriv->pxmit_extbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_xmit_extbuf), 4); -+ -+ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; -+ -+ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { -+ _rtw_init_listhead(&pxmitbuf->list); -+ -+ pxmitbuf->priv_data = NULL; -+ pxmitbuf->padapter = padapter; -+ pxmitbuf->buf_tag = XMITBUF_MGNT; -+ -+ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, MAX_XMIT_EXTBUF_SZ + XMITBUF_ALIGN_SZ, _TRUE); -+ if (res == _FAIL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->phead = pxmitbuf->pbuf; -+ pxmitbuf->pend = pxmitbuf->pbuf + MAX_XMIT_EXTBUF_SZ; -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+#endif -+ -+ rtw_list_insert_tail(&pxmitbuf->list, &(pxmitpriv->free_xmit_extbuf_queue.queue)); -+#ifdef DBG_XMIT_BUF_EXT -+ pxmitbuf->no = i; -+#endif -+ pxmitbuf++; -+ -+ } -+ -+ pxmitpriv->free_xmit_extbuf_cnt = NR_XMIT_EXTBUFF; -+ -+ for (i = 0; i < CMDBUF_MAX; i++) { -+ pxmitbuf = &pxmitpriv->pcmd_xmitbuf[i]; -+ if (pxmitbuf) { -+ _rtw_init_listhead(&pxmitbuf->list); -+ -+ pxmitbuf->priv_data = NULL; -+ pxmitbuf->padapter = padapter; -+ pxmitbuf->buf_tag = XMITBUF_CMD; -+ -+ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf, MAX_CMDBUF_SZ + XMITBUF_ALIGN_SZ, _TRUE); -+ if (res == _FAIL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->phead = pxmitbuf->pbuf; -+ pxmitbuf->pend = pxmitbuf->pbuf + MAX_CMDBUF_SZ; -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+#endif -+ pxmitbuf->alloc_sz = MAX_CMDBUF_SZ + XMITBUF_ALIGN_SZ; -+ } -+ } -+ -+ rtw_alloc_hwxmits(padapter); -+ rtw_init_hwxmits(pxmitpriv->hwxmits, pxmitpriv->hwxmit_entry); -+ -+ for (i = 0; i < 4; i++) -+ pxmitpriv->wmm_para_seq[i] = i; -+ -+#ifdef CONFIG_USB_HCI -+ pxmitpriv->txirp_cnt = 1; -+ -+ _rtw_init_sema(&(pxmitpriv->tx_retevt), 0); -+ -+ /* per AC pending irp */ -+ pxmitpriv->beq_cnt = 0; -+ pxmitpriv->bkq_cnt = 0; -+ pxmitpriv->viq_cnt = 0; -+ pxmitpriv->voq_cnt = 0; -+#endif -+ -+ -+#ifdef CONFIG_XMIT_ACK -+ pxmitpriv->ack_tx = _FALSE; -+ _rtw_mutex_init(&pxmitpriv->ack_tx_mutex); -+ rtw_sctx_init(&pxmitpriv->ack_tx_ops, 0); -+#endif -+ -+ rtw_hal_init_xmit_priv(padapter); -+ -+exit: -+ -+ -+ return res; -+} -+ -+void rtw_mfree_xmit_priv_lock(struct xmit_priv *pxmitpriv); -+void rtw_mfree_xmit_priv_lock(struct xmit_priv *pxmitpriv) -+{ -+ _rtw_spinlock_free(&pxmitpriv->lock); -+ _rtw_free_sema(&pxmitpriv->xmit_sema); -+ /*_rtw_free_sema(&pxmitpriv->terminate_xmitthread_sema);*/ -+ -+ _rtw_spinlock_free(&pxmitpriv->be_pending.lock); -+ _rtw_spinlock_free(&pxmitpriv->bk_pending.lock); -+ _rtw_spinlock_free(&pxmitpriv->vi_pending.lock); -+ _rtw_spinlock_free(&pxmitpriv->vo_pending.lock); -+ _rtw_spinlock_free(&pxmitpriv->bm_pending.lock); -+ -+ /* _rtw_spinlock_free(&pxmitpriv->legacy_dz_queue.lock); */ -+ /* _rtw_spinlock_free(&pxmitpriv->apsd_queue.lock); */ -+ -+ _rtw_spinlock_free(&pxmitpriv->free_xmit_queue.lock); -+ _rtw_spinlock_free(&pxmitpriv->free_xmitbuf_queue.lock); -+ _rtw_spinlock_free(&pxmitpriv->pending_xmitbuf_queue.lock); -+} -+ -+ -+void _rtw_free_xmit_priv(struct xmit_priv *pxmitpriv) -+{ -+ int i; -+ _adapter *padapter = pxmitpriv->adapter; -+ struct xmit_frame *pxmitframe = (struct xmit_frame *) pxmitpriv->pxmit_frame_buf; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf; -+ -+ -+ rtw_hal_free_xmit_priv(padapter); -+ -+ rtw_mfree_xmit_priv_lock(pxmitpriv); -+ -+ if (pxmitpriv->pxmit_frame_buf == NULL) -+ goto out; -+ -+ for (i = 0; i < NR_XMITFRAME; i++) { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ -+ pxmitframe++; -+ } -+ -+ for (i = 0; i < NR_XMITBUFF; i++) { -+ rtw_os_xmit_resource_free(padapter, pxmitbuf, (MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), _TRUE); -+ -+ pxmitbuf++; -+ } -+ -+ if (pxmitpriv->pallocated_frame_buf) -+ rtw_vmfree(pxmitpriv->pallocated_frame_buf, NR_XMITFRAME * sizeof(struct xmit_frame) + 4); -+ -+ -+ if (pxmitpriv->pallocated_xmitbuf) -+ rtw_vmfree(pxmitpriv->pallocated_xmitbuf, NR_XMITBUFF * sizeof(struct xmit_buf) + 4); -+ -+ /* free xframe_ext queue, the same count as extbuf */ -+ if ((pxmitframe = (struct xmit_frame *)pxmitpriv->xframe_ext)) { -+ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ pxmitframe++; -+ } -+ } -+ if (pxmitpriv->xframe_ext_alloc_addr) -+ rtw_vmfree(pxmitpriv->xframe_ext_alloc_addr, NR_XMIT_EXTBUFF * sizeof(struct xmit_frame) + 4); -+ _rtw_spinlock_free(&pxmitpriv->free_xframe_ext_queue.lock); -+ -+ /* free xmit extension buff */ -+ _rtw_spinlock_free(&pxmitpriv->free_xmit_extbuf_queue.lock); -+ -+ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; -+ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { -+ rtw_os_xmit_resource_free(padapter, pxmitbuf, (MAX_XMIT_EXTBUF_SZ + XMITBUF_ALIGN_SZ), _TRUE); -+ -+ pxmitbuf++; -+ } -+ -+ if (pxmitpriv->pallocated_xmit_extbuf) -+ rtw_vmfree(pxmitpriv->pallocated_xmit_extbuf, NR_XMIT_EXTBUFF * sizeof(struct xmit_buf) + 4); -+ -+ for (i = 0; i < CMDBUF_MAX; i++) { -+ pxmitbuf = &pxmitpriv->pcmd_xmitbuf[i]; -+ if (pxmitbuf != NULL) -+ rtw_os_xmit_resource_free(padapter, pxmitbuf, MAX_CMDBUF_SZ + XMITBUF_ALIGN_SZ , _TRUE); -+ } -+ -+ rtw_free_hwxmits(padapter); -+ -+#ifdef CONFIG_XMIT_ACK -+ _rtw_mutex_free(&pxmitpriv->ack_tx_mutex); -+#endif -+ -+out: -+ return; -+} -+ -+u8 rtw_get_tx_bw_mode(_adapter *adapter, struct sta_info *sta) -+{ -+ u8 bw; -+ -+ bw = sta->bw_mode; -+ if (MLME_STATE(adapter) & WIFI_ASOC_STATE) { -+ if (adapter->mlmeextpriv.cur_channel <= 14) -+ bw = rtw_min(bw, ADAPTER_TX_BW_2G(adapter)); -+ else -+ bw = rtw_min(bw, ADAPTER_TX_BW_5G(adapter)); -+ } -+ -+ return bw; -+} -+ -+void rtw_get_adapter_tx_rate_bmp_by_bw(_adapter *adapter, u8 bw, u16 *r_bmp_cck_ofdm, u32 *r_bmp_ht, u32 *r_bmp_vht) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ u8 fix_bw = 0xFF; -+ u16 bmp_cck_ofdm = 0; -+ u32 bmp_ht = 0; -+ u32 bmp_vht = 0; -+ int i; -+ -+ if (adapter->fix_rate != 0xFF && adapter->fix_bw != 0xFF) -+ fix_bw = adapter->fix_bw; -+ -+ /* TODO: adapter->fix_rate */ -+ -+ for (i = 0; i < macid_ctl->num; i++) { -+ if (!rtw_macid_is_used(macid_ctl, i)) -+ continue; -+ if (rtw_macid_get_if_g(macid_ctl, i) != adapter->iface_id) -+ continue; -+ -+ if (bw == CHANNEL_WIDTH_20) /* CCK, OFDM always 20MHz */ -+ bmp_cck_ofdm |= macid_ctl->rate_bmp0[i] & 0x00000FFF; -+ -+ /* bypass mismatch bandwidth for HT, VHT */ -+ if ((fix_bw != 0xFF && fix_bw != bw) || (fix_bw == 0xFF && macid_ctl->bw[i] != bw)) -+ continue; -+ -+ if (macid_ctl->vht_en[i]) -+ bmp_vht |= (macid_ctl->rate_bmp0[i] >> 12) | (macid_ctl->rate_bmp1[i] << 20); -+ else -+ bmp_ht |= (macid_ctl->rate_bmp0[i] >> 12) | (macid_ctl->rate_bmp1[i] << 20); -+ } -+ -+ /* TODO: mlmeext->tx_rate*/ -+ -+exit: -+ if (r_bmp_cck_ofdm) -+ *r_bmp_cck_ofdm = bmp_cck_ofdm; -+ if (r_bmp_ht) -+ *r_bmp_ht = bmp_ht; -+ if (r_bmp_vht) -+ *r_bmp_vht = bmp_vht; -+} -+ -+void rtw_get_shared_macid_tx_rate_bmp_by_bw(struct dvobj_priv *dvobj, u8 bw, u16 *r_bmp_cck_ofdm, u32 *r_bmp_ht, u32 *r_bmp_vht) -+{ -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u16 bmp_cck_ofdm = 0; -+ u32 bmp_ht = 0; -+ u32 bmp_vht = 0; -+ int i; -+ -+ for (i = 0; i < macid_ctl->num; i++) { -+ if (!rtw_macid_is_used(macid_ctl, i)) -+ continue; -+ if (rtw_macid_get_if_g(macid_ctl, i) != -1) -+ continue; -+ -+ if (bw == CHANNEL_WIDTH_20) /* CCK, OFDM always 20MHz */ -+ bmp_cck_ofdm |= macid_ctl->rate_bmp0[i] & 0x00000FFF; -+ -+ /* bypass mismatch bandwidth for HT, VHT */ -+ if (macid_ctl->bw[i] != bw) -+ continue; -+ -+ if (macid_ctl->vht_en[i]) -+ bmp_vht |= (macid_ctl->rate_bmp0[i] >> 12) | (macid_ctl->rate_bmp1[i] << 20); -+ else -+ bmp_ht |= (macid_ctl->rate_bmp0[i] >> 12) | (macid_ctl->rate_bmp1[i] << 20); -+ } -+ -+ if (r_bmp_cck_ofdm) -+ *r_bmp_cck_ofdm = bmp_cck_ofdm; -+ if (r_bmp_ht) -+ *r_bmp_ht = bmp_ht; -+ if (r_bmp_vht) -+ *r_bmp_vht = bmp_vht; -+} -+ -+void rtw_update_tx_rate_bmp(struct dvobj_priv *dvobj) -+{ -+ struct rf_ctl_t *rf_ctl = dvobj_to_rfctl(dvobj); -+ _adapter *adapter = dvobj_get_primary_adapter(dvobj); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 bw; -+ u16 bmp_cck_ofdm, tmp_cck_ofdm; -+ u32 bmp_ht, tmp_ht, ori_bmp_ht[2]; -+ u8 ori_highest_ht_rate_bw_bmp; -+ u32 bmp_vht, tmp_vht, ori_bmp_vht[4]; -+ u8 ori_highest_vht_rate_bw_bmp; -+ int i; -+ -+ /* backup the original ht & vht highest bw bmp */ -+ ori_highest_ht_rate_bw_bmp = rf_ctl->highest_ht_rate_bw_bmp; -+ ori_highest_vht_rate_bw_bmp = rf_ctl->highest_vht_rate_bw_bmp; -+ -+ for (bw = CHANNEL_WIDTH_20; bw <= CHANNEL_WIDTH_160; bw++) { -+ /* backup the original ht & vht bmp */ -+ if (bw <= CHANNEL_WIDTH_40) -+ ori_bmp_ht[bw] = rf_ctl->rate_bmp_ht_by_bw[bw]; -+ if (bw <= CHANNEL_WIDTH_160) -+ ori_bmp_vht[bw] = rf_ctl->rate_bmp_vht_by_bw[bw]; -+ -+ bmp_cck_ofdm = bmp_ht = bmp_vht = 0; -+ if (hal_is_bw_support(dvobj_get_primary_adapter(dvobj), bw)) { -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!dvobj->padapters[i]) -+ continue; -+ rtw_get_adapter_tx_rate_bmp_by_bw(dvobj->padapters[i], bw, &tmp_cck_ofdm, &tmp_ht, &tmp_vht); -+ bmp_cck_ofdm |= tmp_cck_ofdm; -+ bmp_ht |= tmp_ht; -+ bmp_vht |= tmp_vht; -+ } -+ rtw_get_shared_macid_tx_rate_bmp_by_bw(dvobj, bw, &tmp_cck_ofdm, &tmp_ht, &tmp_vht); -+ bmp_cck_ofdm |= tmp_cck_ofdm; -+ bmp_ht |= tmp_ht; -+ bmp_vht |= tmp_vht; -+ } -+ if (bw == CHANNEL_WIDTH_20) -+ rf_ctl->rate_bmp_cck_ofdm = bmp_cck_ofdm; -+ if (bw <= CHANNEL_WIDTH_40) -+ rf_ctl->rate_bmp_ht_by_bw[bw] = bmp_ht; -+ if (bw <= CHANNEL_WIDTH_160) -+ rf_ctl->rate_bmp_vht_by_bw[bw] = bmp_vht; -+ } -+ -+#ifndef DBG_HIGHEST_RATE_BMP_BW_CHANGE -+#define DBG_HIGHEST_RATE_BMP_BW_CHANGE 0 -+#endif -+ -+ { -+ u8 highest_rate_bw; -+ u8 highest_rate_bw_bmp; -+ u8 update_ht_rs = _FALSE; -+ u8 update_vht_rs = _FALSE; -+ -+ highest_rate_bw_bmp = BW_CAP_20M; -+ highest_rate_bw = CHANNEL_WIDTH_20; -+ for (bw = CHANNEL_WIDTH_20; bw <= CHANNEL_WIDTH_40; bw++) { -+ if (rf_ctl->rate_bmp_ht_by_bw[highest_rate_bw] < rf_ctl->rate_bmp_ht_by_bw[bw]) { -+ highest_rate_bw_bmp = ch_width_to_bw_cap(bw); -+ highest_rate_bw = bw; -+ } else if (rf_ctl->rate_bmp_ht_by_bw[highest_rate_bw] == rf_ctl->rate_bmp_ht_by_bw[bw]) -+ highest_rate_bw_bmp |= ch_width_to_bw_cap(bw); -+ } -+ rf_ctl->highest_ht_rate_bw_bmp = highest_rate_bw_bmp; -+ -+ if (ori_highest_ht_rate_bw_bmp != rf_ctl->highest_ht_rate_bw_bmp -+ || largest_bit(ori_bmp_ht[highest_rate_bw]) != largest_bit(rf_ctl->rate_bmp_ht_by_bw[highest_rate_bw]) -+ ) { -+ if (DBG_HIGHEST_RATE_BMP_BW_CHANGE) { -+ RTW_INFO("highest_ht_rate_bw_bmp:0x%02x=>0x%02x\n", ori_highest_ht_rate_bw_bmp, rf_ctl->highest_ht_rate_bw_bmp); -+ RTW_INFO("rate_bmp_ht_by_bw[%u]:0x%08x=>0x%08x\n", highest_rate_bw, ori_bmp_ht[highest_rate_bw], rf_ctl->rate_bmp_ht_by_bw[highest_rate_bw]); -+ } -+ update_ht_rs = _TRUE; -+ } -+ -+ highest_rate_bw_bmp = BW_CAP_20M; -+ highest_rate_bw = CHANNEL_WIDTH_20; -+ for (bw = CHANNEL_WIDTH_20; bw <= CHANNEL_WIDTH_160; bw++) { -+ if (rf_ctl->rate_bmp_vht_by_bw[highest_rate_bw] < rf_ctl->rate_bmp_vht_by_bw[bw]) { -+ highest_rate_bw_bmp = ch_width_to_bw_cap(bw); -+ highest_rate_bw = bw; -+ } else if (rf_ctl->rate_bmp_vht_by_bw[highest_rate_bw] == rf_ctl->rate_bmp_vht_by_bw[bw]) -+ highest_rate_bw_bmp |= ch_width_to_bw_cap(bw); -+ } -+ rf_ctl->highest_vht_rate_bw_bmp = highest_rate_bw_bmp; -+ -+ if (ori_highest_vht_rate_bw_bmp != rf_ctl->highest_vht_rate_bw_bmp -+ || largest_bit(ori_bmp_vht[highest_rate_bw]) != largest_bit(rf_ctl->rate_bmp_vht_by_bw[highest_rate_bw]) -+ ) { -+ if (DBG_HIGHEST_RATE_BMP_BW_CHANGE) { -+ RTW_INFO("highest_vht_rate_bw_bmp:0x%02x=>0x%02x\n", ori_highest_vht_rate_bw_bmp, rf_ctl->highest_vht_rate_bw_bmp); -+ RTW_INFO("rate_bmp_vht_by_bw[%u]:0x%08x=>0x%08x\n", highest_rate_bw, ori_bmp_vht[highest_rate_bw], rf_ctl->rate_bmp_vht_by_bw[highest_rate_bw]); -+ } -+ update_vht_rs = _TRUE; -+ } -+ -+ /* TODO: per rfpath and rate section handling? */ -+ if (update_ht_rs == _TRUE || update_vht_rs == _TRUE) -+ rtw_hal_set_tx_power_level(dvobj_get_primary_adapter(dvobj), hal_data->CurrentChannel); -+ } -+} -+ -+inline u16 rtw_get_tx_rate_bmp_cck_ofdm(struct dvobj_priv *dvobj) -+{ -+ struct rf_ctl_t *rf_ctl = dvobj_to_rfctl(dvobj); -+ -+ return rf_ctl->rate_bmp_cck_ofdm; -+} -+ -+inline u32 rtw_get_tx_rate_bmp_ht_by_bw(struct dvobj_priv *dvobj, u8 bw) -+{ -+ struct rf_ctl_t *rf_ctl = dvobj_to_rfctl(dvobj); -+ -+ return rf_ctl->rate_bmp_ht_by_bw[bw]; -+} -+ -+inline u32 rtw_get_tx_rate_bmp_vht_by_bw(struct dvobj_priv *dvobj, u8 bw) -+{ -+ struct rf_ctl_t *rf_ctl = dvobj_to_rfctl(dvobj); -+ -+ return rf_ctl->rate_bmp_vht_by_bw[bw]; -+} -+ -+u8 rtw_get_tx_bw_bmp_of_ht_rate(struct dvobj_priv *dvobj, u8 rate, u8 max_bw) -+{ -+ struct rf_ctl_t *rf_ctl = dvobj_to_rfctl(dvobj); -+ u8 bw; -+ u8 bw_bmp = 0; -+ u32 rate_bmp; -+ -+ if (!IS_HT_RATE(rate)) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ rate_bmp = 1 << (rate - MGN_MCS0); -+ -+ if (max_bw > CHANNEL_WIDTH_40) -+ max_bw = CHANNEL_WIDTH_40; -+ -+ for (bw = CHANNEL_WIDTH_20; bw <= max_bw; bw++) { -+ /* RA may use lower rate for retry */ -+ if (rf_ctl->rate_bmp_ht_by_bw[bw] >= rate_bmp) -+ bw_bmp |= ch_width_to_bw_cap(bw); -+ } -+ -+exit: -+ return bw_bmp; -+} -+ -+u8 rtw_get_tx_bw_bmp_of_vht_rate(struct dvobj_priv *dvobj, u8 rate, u8 max_bw) -+{ -+ struct rf_ctl_t *rf_ctl = dvobj_to_rfctl(dvobj); -+ u8 bw; -+ u8 bw_bmp = 0; -+ u32 rate_bmp; -+ -+ if (!IS_VHT_RATE(rate)) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ rate_bmp = 1 << (rate - MGN_VHT1SS_MCS0); -+ -+ if (max_bw > CHANNEL_WIDTH_160) -+ max_bw = CHANNEL_WIDTH_160; -+ -+ for (bw = CHANNEL_WIDTH_20; bw <= max_bw; bw++) { -+ /* RA may use lower rate for retry */ -+ if (rf_ctl->rate_bmp_vht_by_bw[bw] >= rate_bmp) -+ bw_bmp |= ch_width_to_bw_cap(bw); -+ } -+ -+exit: -+ return bw_bmp; -+} -+ -+u8 query_ra_short_GI(struct sta_info *psta, u8 bw) -+{ -+ u8 sgi = _FALSE, sgi_20m = _FALSE, sgi_40m = _FALSE, sgi_80m = _FALSE; -+ -+#ifdef CONFIG_80211N_HT -+#ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) -+ sgi_80m = psta->vhtpriv.sgi_80m; -+#endif -+ sgi_20m = psta->htpriv.sgi_20m; -+ sgi_40m = psta->htpriv.sgi_40m; -+#endif -+ -+ switch (bw) { -+ case CHANNEL_WIDTH_80: -+ sgi = sgi_80m; -+ break; -+ case CHANNEL_WIDTH_40: -+ sgi = sgi_40m; -+ break; -+ case CHANNEL_WIDTH_20: -+ default: -+ sgi = sgi_20m; -+ break; -+ } -+ -+ return sgi; -+} -+ -+static void update_attrib_vcs_info(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ u32 sz; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ /* struct sta_info *psta = pattrib->psta; */ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* -+ if(pattrib->psta) -+ { -+ psta = pattrib->psta; -+ } -+ else -+ { -+ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); -+ psta=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0] ); -+ } -+ -+ if(psta==NULL) -+ { -+ RTW_INFO("%s, psta==NUL\n", __func__); -+ return; -+ } -+ -+ if(!(psta->state &_FW_LINKED)) -+ { -+ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return; -+ } -+ */ -+ -+ if (pattrib->nr_frags != 1) -+ sz = padapter->xmitpriv.frag_len; -+ else /* no frag */ -+ sz = pattrib->last_txcmdsz; -+ -+ /* (1) RTS_Threshold is compared to the MPDU, not MSDU. */ -+ /* (2) If there are more than one frag in this MSDU, only the first frag uses protection frame. */ -+ /* Other fragments are protected by previous fragment. */ -+ /* So we only need to check the length of first fragment. */ -+ if (pmlmeext->cur_wireless_mode < WIRELESS_11_24N || padapter->registrypriv.wifi_spec) { -+ if (sz > padapter->registrypriv.rts_thresh) -+ pattrib->vcs_mode = RTS_CTS; -+ else { -+ if (pattrib->rtsen) -+ pattrib->vcs_mode = RTS_CTS; -+ else if (pattrib->cts2self) -+ pattrib->vcs_mode = CTS_TO_SELF; -+ else -+ pattrib->vcs_mode = NONE_VCS; -+ } -+ } else { -+ while (_TRUE) { -+#if 0 /* Todo */ -+ /* check IOT action */ -+ if (pHTInfo->IOTAction & HT_IOT_ACT_FORCED_CTS2SELF) { -+ pattrib->vcs_mode = CTS_TO_SELF; -+ pattrib->rts_rate = MGN_24M; -+ break; -+ } else if (pHTInfo->IOTAction & (HT_IOT_ACT_FORCED_RTS | HT_IOT_ACT_PURE_N_MODE)) { -+ pattrib->vcs_mode = RTS_CTS; -+ pattrib->rts_rate = MGN_24M; -+ break; -+ } -+#endif -+ -+ /* IOT action */ -+ if ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_ATHEROS) && (pattrib->ampdu_en == _TRUE) && -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) { -+ pattrib->vcs_mode = CTS_TO_SELF; -+ break; -+ } -+ -+ -+ /* check ERP protection */ -+ if (pattrib->rtsen || pattrib->cts2self) { -+ if (pattrib->rtsen) -+ pattrib->vcs_mode = RTS_CTS; -+ else if (pattrib->cts2self) -+ pattrib->vcs_mode = CTS_TO_SELF; -+ -+ break; -+ } -+ -+ /* check HT op mode */ -+ if (pattrib->ht_en) { -+ u8 HTOpMode = pmlmeinfo->HT_protection; -+ if ((pmlmeext->cur_bwmode && (HTOpMode == 2 || HTOpMode == 3)) || -+ (!pmlmeext->cur_bwmode && HTOpMode == 3)) { -+ pattrib->vcs_mode = RTS_CTS; -+ break; -+ } -+ } -+ -+ /* check rts */ -+ if (sz > padapter->registrypriv.rts_thresh) { -+ pattrib->vcs_mode = RTS_CTS; -+ break; -+ } -+ -+ /* to do list: check MIMO power save condition. */ -+ -+ /* check AMPDU aggregation for TXOP */ -+ if ((pattrib->ampdu_en == _TRUE) && (!IS_HARDWARE_TYPE_8812(padapter))) { -+ pattrib->vcs_mode = RTS_CTS; -+ break; -+ } -+ -+ pattrib->vcs_mode = NONE_VCS; -+ break; -+ } -+ } -+ -+ /* for debug : force driver control vrtl_carrier_sense. */ -+ if (padapter->driver_vcs_en == 1) { -+ /* u8 driver_vcs_en; */ /* Enable=1, Disable=0 driver control vrtl_carrier_sense. */ -+ /* u8 driver_vcs_type; */ /* force 0:disable VCS, 1:RTS-CTS, 2:CTS-to-self when vcs_en=1. */ -+ pattrib->vcs_mode = padapter->driver_vcs_type; -+ } -+ -+} -+ -+static void update_attrib_phy_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) -+{ -+ struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; -+ u8 bw; -+ -+ pattrib->rtsen = psta->rtsen; -+ pattrib->cts2self = psta->cts2self; -+ -+ pattrib->mdata = 0; -+ pattrib->eosp = 0; -+ pattrib->triggered = 0; -+ pattrib->ampdu_spacing = 0; -+ -+ /* qos_en, ht_en, init rate, ,bw, ch_offset, sgi */ -+ pattrib->qos_en = psta->qos_option; -+ -+ pattrib->raid = psta->raid; -+ -+ bw = rtw_get_tx_bw_mode(padapter, psta); -+ pattrib->bwmode = rtw_min(bw, mlmeext->cur_bwmode); -+ pattrib->sgi = query_ra_short_GI(psta, pattrib->bwmode); -+ -+ pattrib->ldpc = psta->ldpc; -+ pattrib->stbc = psta->stbc; -+ -+#ifdef CONFIG_80211N_HT -+ pattrib->ht_en = psta->htpriv.ht_option; -+ pattrib->ch_offset = psta->htpriv.ch_offset; -+ pattrib->ampdu_en = _FALSE; -+ -+ if (padapter->driver_ampdu_spacing != 0xFF) /* driver control AMPDU Density for peer sta's rx */ -+ pattrib->ampdu_spacing = padapter->driver_ampdu_spacing; -+ else -+ pattrib->ampdu_spacing = psta->htpriv.rx_ampdu_min_spacing; -+#endif /* CONFIG_80211N_HT */ -+ /* if(pattrib->ht_en && psta->htpriv.ampdu_enable) */ -+ /* { */ -+ /* if(psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) */ -+ /* pattrib->ampdu_en = _TRUE; */ -+ /* } */ -+ -+#ifdef CONFIG_TDLS -+ if (pattrib->direct_link == _TRUE) { -+ psta = pattrib->ptdls_sta; -+ -+ pattrib->raid = psta->raid; -+#ifdef CONFIG_80211N_HT -+ pattrib->bwmode = rtw_get_tx_bw_mode(padapter, psta); -+ pattrib->ht_en = psta->htpriv.ht_option; -+ pattrib->ch_offset = psta->htpriv.ch_offset; -+ pattrib->sgi = query_ra_short_GI(psta, pattrib->bwmode); -+#endif /* CONFIG_80211N_HT */ -+ } -+#endif /* CONFIG_TDLS */ -+ -+ pattrib->retry_ctrl = _FALSE; -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (psta->isrc && psta->pid > 0) -+ pattrib->pctrl = _TRUE; -+#endif -+ -+} -+ -+static s32 update_attrib_sec_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) -+{ -+ sint res = _SUCCESS; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ sint bmcast = IS_MCAST(pattrib->ra); -+ -+ _rtw_memset(pattrib->dot118021x_UncstKey.skey, 0, 16); -+ _rtw_memset(pattrib->dot11tkiptxmickey.skey, 0, 16); -+ pattrib->mac_id = psta->mac_id; -+ -+ if (psta->ieee8021x_blocked == _TRUE) { -+ -+ pattrib->encrypt = 0; -+ -+ if ((pattrib->ether_type != 0x888e) && (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _FALSE)) { -+#ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s psta->ieee8021x_blocked == _TRUE, pattrib->ether_type(%04x) != 0x888e\n", __FUNCTION__, pattrib->ether_type); -+#endif -+ res = _FAIL; -+ goto exit; -+ } -+ } else { -+ GET_ENCRY_ALGO(psecuritypriv, psta, pattrib->encrypt, bmcast); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (pattrib->ether_type == 0x88B4) -+ pattrib->encrypt = _NO_PRIVACY_; -+#endif -+ -+ switch (psecuritypriv->dot11AuthAlgrthm) { -+ case dot11AuthAlgrthm_Open: -+ case dot11AuthAlgrthm_Shared: -+ case dot11AuthAlgrthm_Auto: -+ pattrib->key_idx = (u8)psecuritypriv->dot11PrivacyKeyIndex; -+ break; -+ case dot11AuthAlgrthm_8021X: -+ if (bmcast) -+ pattrib->key_idx = (u8)psecuritypriv->dot118021XGrpKeyid; -+ else -+ pattrib->key_idx = 0; -+ break; -+ default: -+ pattrib->key_idx = 0; -+ break; -+ } -+ -+ /* For WPS 1.0 WEP, driver should not encrypt EAPOL Packet for WPS handshake. */ -+ if (((pattrib->encrypt == _WEP40_) || (pattrib->encrypt == _WEP104_)) && (pattrib->ether_type == 0x888e)) -+ pattrib->encrypt = _NO_PRIVACY_; -+ -+ } -+ -+#ifdef CONFIG_TDLS -+ if (pattrib->direct_link == _TRUE) { -+ if (pattrib->encrypt > 0) -+ pattrib->encrypt = _AES_; -+ } -+#endif -+ -+ switch (pattrib->encrypt) { -+ case _WEP40_: -+ case _WEP104_: -+ pattrib->iv_len = 4; -+ pattrib->icv_len = 4; -+ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ break; -+ -+ case _TKIP_: -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 4; -+ -+ if (psecuritypriv->busetkipkey == _FAIL) { -+#ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s psecuritypriv->busetkipkey(%d)==_FAIL drop packet\n", __FUNCTION__, psecuritypriv->busetkipkey); -+#endif -+ res = _FAIL; -+ goto exit; -+ } -+ -+ if (bmcast) -+ TKIP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ TKIP_IV(pattrib->iv, psta->dot11txpn, 0); -+ -+ -+ _rtw_memcpy(pattrib->dot11tkiptxmickey.skey, psta->dot11tkiptxmickey.skey, 16); -+ -+ break; -+ -+ case _AES_: -+ -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 8; -+ -+ if (bmcast) -+ AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ AES_IV(pattrib->iv, psta->dot11txpn, 0); -+ -+ break; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ pattrib->iv_len = 18; -+ pattrib->icv_len = 16; -+ rtw_wapi_get_iv(padapter, pattrib->ra, pattrib->iv); -+ break; -+#endif -+ default: -+ pattrib->iv_len = 0; -+ pattrib->icv_len = 0; -+ break; -+ } -+ -+ if (pattrib->encrypt > 0) -+ _rtw_memcpy(pattrib->dot118021x_UncstKey.skey, psta->dot118021x_UncstKey.skey, 16); -+ -+ -+ if (pattrib->encrypt && -+ ((padapter->securitypriv.sw_encrypt == _TRUE) || (psecuritypriv->hw_decrypted == _FALSE))) { -+ pattrib->bswenc = _TRUE; -+ } else { -+ pattrib->bswenc = _FALSE; -+ } -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ pattrib->bmc_camid = padapter->securitypriv.dot118021x_bmc_cam_id; -+#endif -+ -+ if (pattrib->encrypt && bmcast && _rtw_camctl_chk_flags(padapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH)) -+ pattrib->bswenc = _TRUE; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (pattrib->encrypt == _SMS4_) -+ pattrib->bswenc = _FALSE; -+#endif -+ -+exit: -+ -+ return res; -+ -+} -+ -+u8 qos_acm(u8 acm_mask, u8 priority) -+{ -+ u8 change_priority = priority; -+ -+ switch (priority) { -+ case 0: -+ case 3: -+ if (acm_mask & BIT(1)) -+ change_priority = 1; -+ break; -+ case 1: -+ case 2: -+ break; -+ case 4: -+ case 5: -+ if (acm_mask & BIT(2)) -+ change_priority = 0; -+ break; -+ case 6: -+ case 7: -+ if (acm_mask & BIT(3)) -+ change_priority = 5; -+ break; -+ default: -+ RTW_INFO("qos_acm(): invalid pattrib->priority: %d!!!\n", priority); -+ break; -+ } -+ -+ return change_priority; -+} -+ -+static void set_qos(struct pkt_file *ppktfile, struct pkt_attrib *pattrib) -+{ -+ struct ethhdr etherhdr; -+ struct iphdr ip_hdr; -+ s32 UserPriority = 0; -+ -+ -+ _rtw_open_pktfile(ppktfile->pkt, ppktfile); -+ _rtw_pktfile_read(ppktfile, (unsigned char *)ðerhdr, ETH_HLEN); -+ -+ /* get UserPriority from IP hdr */ -+ if (pattrib->ether_type == 0x0800) { -+ _rtw_pktfile_read(ppktfile, (u8 *)&ip_hdr, sizeof(ip_hdr)); -+ /* UserPriority = (ntohs(ip_hdr.tos) >> 5) & 0x3; */ -+ UserPriority = ip_hdr.tos >> 5; -+ } -+ /* -+ else if (pattrib->ether_type == 0x888e) { -+ -+ -+ UserPriority = 7; -+ } -+ */ -+ pattrib->priority = UserPriority; -+ pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN; -+ pattrib->subtype = WIFI_QOS_DATA_TYPE; -+} -+ -+#ifdef CONFIG_TDLS -+u8 rtw_check_tdls_established(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ pattrib->ptdls_sta = NULL; -+ -+ pattrib->direct_link = _FALSE; -+ if (padapter->tdlsinfo.link_established == _TRUE) { -+ pattrib->ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); -+#if 1 -+ if ((pattrib->ptdls_sta != NULL) && -+ (pattrib->ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) && -+ (pattrib->ether_type != 0x0806)) { -+ pattrib->direct_link = _TRUE; -+ /* RTW_INFO("send ptk to "MAC_FMT" using direct link\n", MAC_ARG(pattrib->dst)); */ -+ } -+#else -+ if (pattrib->ptdls_sta != NULL && -+ pattrib->ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { -+ pattrib->direct_link = _TRUE; -+#if 0 -+ RTW_INFO("send ptk to "MAC_FMT" using direct link\n", MAC_ARG(pattrib->dst)); -+#endif -+ } -+ -+ /* ARP frame may be helped by AP*/ -+ if (pattrib->ether_type != 0x0806) -+ pattrib->direct_link = _FALSE; -+#endif -+ } -+ -+ return pattrib->direct_link; -+} -+ -+s32 update_tdls_attrib(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ -+ s32 res = _SUCCESS; -+ -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ if (psta == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pattrib->mac_id = psta->mac_id; -+ pattrib->psta = psta; -+ pattrib->ack_policy = 0; -+ /* get ether_hdr_len */ -+ pattrib->pkt_hdrlen = ETH_HLEN; -+ -+ /* [TDLS] TODO: setup req/rsp should be AC_BK */ -+ if (pqospriv->qos_option && psta->qos_option) { -+ pattrib->priority = 4; /* tdls management frame should be AC_VI */ -+ pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN; -+ pattrib->subtype = WIFI_QOS_DATA_TYPE; -+ } else { -+ pattrib->priority = 0; -+ pattrib->hdrlen = WLAN_HDR_A3_LEN; -+ pattrib->subtype = WIFI_DATA_TYPE; -+ } -+ -+ /* TODO:_lock */ -+ if (update_attrib_sec_info(padapter, pattrib, psta) == _FAIL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ update_attrib_phy_info(padapter, pattrib, psta); -+ -+ -+exit: -+ -+ return res; -+} -+ -+#endif /* CONFIG_TDLS */ -+ -+/*get non-qos hw_ssn control register,mapping to REG_HW_SEQ0,1,2,3*/ -+inline u8 rtw_get_hwseq_no(_adapter *padapter) -+{ -+ u8 hwseq_num = 0; -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ hwseq_num = 1; -+ /* else */ -+ /* hwseq_num = 2; */ -+#endif /* CONFIG_CONCURRENT_MODE */ -+ return hwseq_num; -+} -+static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattrib) -+{ -+ uint i; -+ struct pkt_file pktfile; -+ struct sta_info *psta = NULL; -+ struct ethhdr etherhdr; -+ -+ sint bmcast; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ sint res = _SUCCESS; -+ -+ -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib); -+ -+ _rtw_open_pktfile(pkt, &pktfile); -+ i = _rtw_pktfile_read(&pktfile, (u8 *)ðerhdr, ETH_HLEN); -+ -+ pattrib->ether_type = ntohs(etherhdr.h_proto); -+ -+ -+ _rtw_memcpy(pattrib->dst, ðerhdr.h_dest, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, ðerhdr.h_source, ETH_ALEN); -+ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, adapter_mac_addr(padapter), ETH_ALEN); -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_adhoc); -+ } else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+#ifdef CONFIG_TDLS -+ if (rtw_check_tdls_established(padapter, pattrib) == _TRUE) -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); /* For TDLS direct link Tx, set ra to be same to dst */ -+ else -+#endif -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, adapter_mac_addr(padapter), ETH_ALEN); -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_sta); -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, get_bssid(pmlmepriv), ETH_ALEN); -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_ap); -+ } else -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_unknown); -+ -+ bmcast = IS_MCAST(pattrib->ra); -+ if (bmcast) { -+ psta = rtw_get_bcmc_stainfo(padapter); -+ if (psta == NULL) { /* if we cannot get psta => drop the pkt */ -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_sta); -+#ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s get sta_info fail, ra:" MAC_FMT"\n", __func__, MAC_ARG(pattrib->ra)); -+#endif -+ res = _FAIL; -+ goto exit; -+ } -+ } else { -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ if (psta == NULL) { /* if we cannot get psta => drop the pkt */ -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_ucast_sta); -+#ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s get sta_info fail, ra:" MAC_FMT"\n", __func__, MAC_ARG(pattrib->ra)); -+#endif -+ res = _FAIL; -+ goto exit; -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE && !(psta->state & _FW_LINKED)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_ucast_ap_link); -+ res = _FAIL; -+ goto exit; -+ } -+ } -+ -+ if (!(psta->state & _FW_LINKED)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_link); -+ RTW_INFO("%s-"ADPT_FMT" psta("MAC_FMT")->state(0x%x) != _FW_LINKED\n", __func__, ADPT_ARG(padapter), MAC_ARG(psta->hwaddr), psta->state); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pattrib->pktlen = pktfile.pkt_len; -+ -+ /* TODO: 802.1Q VLAN header */ -+ /* TODO: IPV6 */ -+ -+ if (ETH_P_IP == pattrib->ether_type) { -+ u8 ip[20]; -+ -+ _rtw_pktfile_read(&pktfile, ip, 20); -+ -+ if (GET_IPV4_IHL(ip) * 4 > 20) -+ _rtw_pktfile_read(&pktfile, NULL, GET_IPV4_IHL(ip) - 20); -+ -+ pattrib->icmp_pkt = 0; -+ pattrib->dhcp_pkt = 0; -+ -+ if (GET_IPV4_PROTOCOL(ip) == 0x01) { /* ICMP */ -+ pattrib->icmp_pkt = 1; -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_icmp); -+ -+ } else if (GET_IPV4_PROTOCOL(ip) == 0x11) { /* UDP */ -+ u8 udp[8]; -+ -+ _rtw_pktfile_read(&pktfile, udp, 8); -+ -+ if ((GET_UDP_SRC(udp) == 68 && GET_UDP_DST(udp) == 67) -+ || (GET_UDP_SRC(udp) == 67 && GET_UDP_DST(udp) == 68) -+ ) { -+ /* 67 : UDP BOOTP server, 68 : UDP BOOTP client */ -+ if (pattrib->pktlen > 282) { /* MINIMUM_DHCP_PACKET_SIZE */ -+ pattrib->dhcp_pkt = 1; -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_dhcp); -+ if (0) -+ RTW_INFO("send DHCP packet\n"); -+ } -+ } -+ -+ } else if (GET_IPV4_PROTOCOL(ip) == 0x06 /* TCP */ -+ && rtw_st_ctl_chk_reg_s_proto(&psta->st_ctl, 0x06) == _TRUE -+ ) { -+ u8 tcp[20]; -+ -+ _rtw_pktfile_read(&pktfile, tcp, 20); -+ -+ if (rtw_st_ctl_chk_reg_rule(&psta->st_ctl, padapter, IPV4_SRC(ip), TCP_SRC(tcp), IPV4_DST(ip), TCP_DST(tcp)) == _TRUE) { -+ if (GET_TCP_SYN(tcp) && GET_TCP_ACK(tcp)) { -+ session_tracker_add_cmd(padapter, psta -+ , IPV4_SRC(ip), TCP_SRC(tcp) -+ , IPV4_SRC(ip), TCP_DST(tcp)); -+ if (DBG_SESSION_TRACKER) -+ RTW_INFO(FUNC_ADPT_FMT" local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT" SYN-ACK\n" -+ , FUNC_ADPT_ARG(padapter) -+ , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp)) -+ , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp))); -+ } -+ if (GET_TCP_FIN(tcp)) { -+ session_tracker_del_cmd(padapter, psta -+ , IPV4_SRC(ip), TCP_SRC(tcp) -+ , IPV4_SRC(ip), TCP_DST(tcp)); -+ if (DBG_SESSION_TRACKER) -+ RTW_INFO(FUNC_ADPT_FMT" local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT" FIN\n" -+ , FUNC_ADPT_ARG(padapter) -+ , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp)) -+ , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp))); -+ } -+ } -+ } -+ -+ } else if (0x888e == pattrib->ether_type) -+ RTW_PRINT("send eapol packet\n"); -+ -+ if ((pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) -+ rtw_mi_set_scan_deny(padapter, 3000); -+ -+#ifdef CONFIG_LPS -+ /* If EAPOL , ARP , OR DHCP packet, driver must be in active mode. */ -+#ifdef CONFIG_WAPI_SUPPORT -+ if ((pattrib->ether_type == 0x88B4) || (pattrib->ether_type == 0x0806) || (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) -+#else /* !CONFIG_WAPI_SUPPORT */ -+#if 0 -+ if ((pattrib->ether_type == 0x0806) || (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) -+#else /* only ICMP/DHCP packets is as SPECIAL_PACKET, and leave LPS when tx IMCP/DHCP packets. */ -+ /* if ((pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1) ) */ -+ if (pattrib->icmp_pkt == 1) -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); -+ else if (pattrib->dhcp_pkt == 1) -+#endif -+#endif -+ { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_active); -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SPECIAL_PACKET, 1); -+ } -+#endif /* CONFIG_LPS */ -+ -+#ifdef CONFIG_BEAMFORMING -+ update_attrib_txbf_info(padapter, pattrib, psta); -+#endif -+ -+ /* TODO:_lock */ -+ if (update_attrib_sec_info(padapter, pattrib, psta) == _FAIL) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_sec); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ update_attrib_phy_info(padapter, pattrib, psta); -+ -+ /* RTW_INFO("%s ==> mac_id(%d)\n",__FUNCTION__,pattrib->mac_id ); */ -+ -+ pattrib->psta = psta; -+ /* TODO:_unlock */ -+ -+ pattrib->pctrl = 0; -+ -+ pattrib->ack_policy = 0; -+ /* get ether_hdr_len */ -+ pattrib->pkt_hdrlen = ETH_HLEN;/* (pattrib->ether_type == 0x8100) ? (14 + 4 ): 14; */ /* vlan tag */ -+ -+ pattrib->hdrlen = WLAN_HDR_A3_LEN; -+ pattrib->subtype = WIFI_DATA_TYPE; -+ pattrib->priority = 0; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE | WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { -+ if (pattrib->qos_en) -+ set_qos(&pktfile, pattrib); -+ } else { -+#ifdef CONFIG_TDLS -+ if (pattrib->direct_link == _TRUE) { -+ if (pattrib->qos_en) -+ set_qos(&pktfile, pattrib); -+ } else -+#endif -+ { -+ if (pqospriv->qos_option) { -+ set_qos(&pktfile, pattrib); -+ -+ if (pmlmepriv->acm_mask != 0) -+ pattrib->priority = qos_acm(pmlmepriv->acm_mask, pattrib->priority); -+ } -+ } -+ } -+ -+ /* pattrib->priority = 5; */ /* force to used VI queue, for testing */ -+ pattrib->hw_ssn_sel = pxmitpriv->hw_ssn_seq_no; -+ rtw_set_tx_chksum_offload(pkt, pattrib); -+ -+exit: -+ -+ -+ return res; -+} -+ -+static s32 xmitframe_addmic(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ sint curfragnum, length; -+ u8 *pframe, *payload, mic[8]; -+ struct mic_data micdata; -+ /* struct sta_info *stainfo; */ -+ struct qos_priv *pqospriv = &(padapter->mlmepriv.qospriv); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ u8 priority[4] = {0x0, 0x0, 0x0, 0x0}; -+ u8 hw_hdr_offset = 0; -+ sint bmcst = IS_MCAST(pattrib->ra); -+ -+ /* -+ if(pattrib->psta) -+ { -+ stainfo = pattrib->psta; -+ } -+ else -+ { -+ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); -+ stainfo=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0]); -+ } -+ -+ if(stainfo==NULL) -+ { -+ RTW_INFO("%s, psta==NUL\n", __func__); -+ return _FAIL; -+ } -+ -+ if(!(stainfo->state &_FW_LINKED)) -+ { -+ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, stainfo->state); -+ return _FAIL; -+ } -+ */ -+ -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ hw_hdr_offset = TXDESC_SIZE + (pxmitframe->pkt_offset * PACKET_OFFSET_SZ);; -+#else -+#ifdef CONFIG_TX_EARLY_MODE -+ hw_hdr_offset = TXDESC_OFFSET + EARLY_MODE_INFO_SIZE; -+#else -+ hw_hdr_offset = TXDESC_OFFSET; -+#endif -+#endif -+ -+ if (pattrib->encrypt == _TKIP_) { /* if(psecuritypriv->dot11PrivacyAlgrthm==_TKIP_PRIVACY_) */ -+ /* encode mic code */ -+ /* if(stainfo!= NULL) */ -+ { -+ u8 null_key[16] = {0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; -+ -+ pframe = pxmitframe->buf_addr + hw_hdr_offset; -+ -+ if (bmcst) { -+ if (_rtw_memcmp(psecuritypriv->dot118021XGrptxmickey[psecuritypriv->dot118021XGrpKeyid].skey, null_key, 16) == _TRUE) { -+ /* DbgPrint("\nxmitframe_addmic:stainfo->dot11tkiptxmickey==0\n"); */ -+ /* rtw_msleep_os(10); */ -+ return _FAIL; -+ } -+ /* start to calculate the mic code */ -+ rtw_secmicsetkey(&micdata, psecuritypriv->dot118021XGrptxmickey[psecuritypriv->dot118021XGrpKeyid].skey); -+ } else { -+ if (_rtw_memcmp(&pattrib->dot11tkiptxmickey.skey[0], null_key, 16) == _TRUE) { -+ /* DbgPrint("\nxmitframe_addmic:stainfo->dot11tkiptxmickey==0\n"); */ -+ /* rtw_msleep_os(10); */ -+ return _FAIL; -+ } -+ /* start to calculate the mic code */ -+ rtw_secmicsetkey(&micdata, &pattrib->dot11tkiptxmickey.skey[0]); -+ } -+ -+ if (pframe[1] & 1) { /* ToDS==1 */ -+ rtw_secmicappend(&micdata, &pframe[16], 6); /* DA */ -+ if (pframe[1] & 2) /* From Ds==1 */ -+ rtw_secmicappend(&micdata, &pframe[24], 6); -+ else -+ rtw_secmicappend(&micdata, &pframe[10], 6); -+ } else { /* ToDS==0 */ -+ rtw_secmicappend(&micdata, &pframe[4], 6); /* DA */ -+ if (pframe[1] & 2) /* From Ds==1 */ -+ rtw_secmicappend(&micdata, &pframe[16], 6); -+ else -+ rtw_secmicappend(&micdata, &pframe[10], 6); -+ -+ } -+ -+ /* if(pqospriv->qos_option==1) */ -+ if (pattrib->qos_en) -+ priority[0] = (u8)pxmitframe->attrib.priority; -+ -+ -+ rtw_secmicappend(&micdata, &priority[0], 4); -+ -+ payload = pframe; -+ -+ for (curfragnum = 0; curfragnum < pattrib->nr_frags; curfragnum++) { -+ payload = (u8 *)RND4((SIZE_PTR)(payload)); -+ -+ payload = payload + pattrib->hdrlen + pattrib->iv_len; -+ if ((curfragnum + 1) == pattrib->nr_frags) { -+ length = pattrib->last_txcmdsz - pattrib->hdrlen - pattrib->iv_len - ((pattrib->bswenc) ? pattrib->icv_len : 0); -+ rtw_secmicappend(&micdata, payload, length); -+ payload = payload + length; -+ } else { -+ length = pxmitpriv->frag_len - pattrib->hdrlen - pattrib->iv_len - ((pattrib->bswenc) ? pattrib->icv_len : 0); -+ rtw_secmicappend(&micdata, payload, length); -+ payload = payload + length + pattrib->icv_len; -+ } -+ } -+ rtw_secgetmic(&micdata, &(mic[0])); -+ /* add mic code and add the mic code length in last_txcmdsz */ -+ -+ _rtw_memcpy(payload, &(mic[0]), 8); -+ pattrib->last_txcmdsz += 8; -+ -+ payload = payload - pattrib->last_txcmdsz + 8; -+ } -+ } -+ -+ -+ return _SUCCESS; -+} -+ -+/*#define DBG_TX_SW_ENCRYPTOR*/ -+ -+static s32 xmitframe_swencrypt(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ /* struct security_priv *psecuritypriv=&padapter->securitypriv; */ -+ -+ -+ /* if((psecuritypriv->sw_encrypt)||(pattrib->bswenc)) */ -+ if (pattrib->bswenc) { -+#ifdef DBG_TX_SW_ENCRYPTOR -+ RTW_INFO(ADPT_FMT" - sec_type:%s DO SW encryption\n", -+ ADPT_ARG(padapter), security_type_str(pattrib->encrypt)); -+#endif -+ -+ switch (pattrib->encrypt) { -+ case _WEP40_: -+ case _WEP104_: -+ rtw_wep_encrypt(padapter, (u8 *)pxmitframe); -+ break; -+ case _TKIP_: -+ rtw_tkip_encrypt(padapter, (u8 *)pxmitframe); -+ break; -+ case _AES_: -+ rtw_aes_encrypt(padapter, (u8 *)pxmitframe); -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ rtw_sms4_encrypt(padapter, (u8 *)pxmitframe); -+#endif -+ default: -+ break; -+ } -+ -+ } -+ -+ -+ return _SUCCESS; -+} -+ -+s32 rtw_make_wlanhdr(_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib) -+{ -+ u16 *qc; -+ -+ struct rtw_ieee80211_hdr *pwlanhdr = (struct rtw_ieee80211_hdr *)hdr; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ u8 qos_option = _FALSE; -+ sint res = _SUCCESS; -+ u16 *fctrl = &pwlanhdr->frame_ctl; -+ -+ /* struct sta_info *psta; */ -+ -+ /* sint bmcst = IS_MCAST(pattrib->ra); */ -+ -+ -+ /* -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if(pattrib->psta != psta) -+ { -+ RTW_INFO("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return; -+ } -+ -+ if(psta==NULL) -+ { -+ RTW_INFO("%s, psta==NUL\n", __func__); -+ return _FAIL; -+ } -+ -+ if(!(psta->state &_FW_LINKED)) -+ { -+ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FAIL; -+ } -+ */ -+ -+ _rtw_memset(hdr, 0, WLANHDR_OFFSET); -+ -+ SetFrameSubType(fctrl, pattrib->subtype); -+ -+ if (pattrib->subtype & WIFI_DATA_TYPE) { -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)) { -+#ifdef CONFIG_TDLS -+ if (pattrib->direct_link == _TRUE) { -+ /* TDLS data transfer, ToDS=0, FrDs=0 */ -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); -+ -+ if (pattrib->qos_en) -+ qos_option = _TRUE; -+ } else -+#endif /* CONFIG_TDLS */ -+ { -+ /* to_ds = 1, fr_ds = 0; */ -+ /* 1.Data transfer to AP */ -+ /* 2.Arp pkt will relayed by AP */ -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->ta, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); -+ -+ if (pqospriv->qos_option) -+ qos_option = _TRUE; -+ } -+ } else if ((check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE)) { -+ /* to_ds = 0, fr_ds = 1; */ -+ SetFrDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pattrib->src, ETH_ALEN); -+ -+ if (pattrib->qos_en) -+ qos_option = _TRUE; -+ } else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->ta, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); -+ -+ if (pattrib->qos_en) -+ qos_option = _TRUE; -+ } else { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ if (pattrib->mdata) -+ SetMData(fctrl); -+ -+ if (pattrib->encrypt) -+ SetPrivacy(fctrl); -+ -+ if (qos_option) { -+ qc = (unsigned short *)(hdr + pattrib->hdrlen - 2); -+ -+ if (pattrib->priority) -+ SetPriority(qc, pattrib->priority); -+ -+ SetEOSP(qc, pattrib->eosp); -+ -+ SetAckpolicy(qc, pattrib->ack_policy); -+ } -+ -+ /* TODO: fill HT Control Field */ -+ -+ /* Update Seq Num will be handled by f/w */ -+ { -+ struct sta_info *psta; -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if (pattrib->psta != psta) { -+ RTW_INFO("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return _FAIL; -+ } -+ -+ if (psta == NULL) { -+ RTW_INFO("%s, psta==NUL\n", __func__); -+ return _FAIL; -+ } -+ -+ if (!(psta->state & _FW_LINKED)) { -+ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FAIL; -+ } -+ -+ -+ if (psta) { -+ psta->sta_xmitpriv.txseq_tid[pattrib->priority]++; -+ psta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; -+ pattrib->seqnum = psta->sta_xmitpriv.txseq_tid[pattrib->priority]; -+ -+ SetSeqNum(hdr, pattrib->seqnum); -+ -+#ifdef CONFIG_80211N_HT -+ /* check if enable ampdu */ -+ if (pattrib->ht_en && psta->htpriv.ampdu_enable) { -+ if (psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) -+ pattrib->ampdu_en = _TRUE; -+ } -+ -+ /* re-check if enable ampdu by BA_starting_seqctrl */ -+ if (pattrib->ampdu_en == _TRUE) { -+ u16 tx_seq; -+ -+ tx_seq = psta->BA_starting_seqctrl[pattrib->priority & 0x0f]; -+ -+ /* check BA_starting_seqctrl */ -+ if (SN_LESS(pattrib->seqnum, tx_seq)) { -+ /* RTW_INFO("tx ampdu seqnum(%d) < tx_seq(%d)\n", pattrib->seqnum, tx_seq); */ -+ pattrib->ampdu_en = _FALSE;/* AGG BK */ -+ } else if (SN_EQUAL(pattrib->seqnum, tx_seq)) { -+ psta->BA_starting_seqctrl[pattrib->priority & 0x0f] = (tx_seq + 1) & 0xfff; -+ -+ pattrib->ampdu_en = _TRUE;/* AGG EN */ -+ } else { -+ /* RTW_INFO("tx ampdu over run\n"); */ -+ psta->BA_starting_seqctrl[pattrib->priority & 0x0f] = (pattrib->seqnum + 1) & 0xfff; -+ pattrib->ampdu_en = _TRUE;/* AGG EN */ -+ } -+ -+ } -+#endif /* CONFIG_80211N_HT */ -+ } -+ } -+ -+ } else { -+ -+ } -+ -+exit: -+ -+ -+ return res; -+} -+ -+s32 rtw_txframes_pending(_adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ return ((_rtw_queue_empty(&pxmitpriv->be_pending) == _FALSE) || -+ (_rtw_queue_empty(&pxmitpriv->bk_pending) == _FALSE) || -+ (_rtw_queue_empty(&pxmitpriv->vi_pending) == _FALSE) || -+ (_rtw_queue_empty(&pxmitpriv->vo_pending) == _FALSE)); -+} -+ -+s32 rtw_txframes_sta_ac_pending(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ struct sta_info *psta; -+ struct tx_servq *ptxservq; -+ int priority = pattrib->priority; -+ /* -+ if(pattrib->psta) -+ { -+ psta = pattrib->psta; -+ } -+ else -+ { -+ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); -+ psta=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0]); -+ } -+ */ -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if (pattrib->psta != psta) { -+ RTW_INFO("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return 0; -+ } -+ -+ if (psta == NULL) { -+ RTW_INFO("%s, psta==NUL\n", __func__); -+ return 0; -+ } -+ -+ if (!(psta->state & _FW_LINKED)) { -+ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return 0; -+ } -+ -+ switch (priority) { -+ case 1: -+ case 2: -+ ptxservq = &(psta->sta_xmitpriv.bk_q); -+ break; -+ case 4: -+ case 5: -+ ptxservq = &(psta->sta_xmitpriv.vi_q); -+ break; -+ case 6: -+ case 7: -+ ptxservq = &(psta->sta_xmitpriv.vo_q); -+ break; -+ case 0: -+ case 3: -+ default: -+ ptxservq = &(psta->sta_xmitpriv.be_q); -+ break; -+ -+ } -+ -+ return ptxservq->qcnt; -+} -+ -+#ifdef CONFIG_TDLS -+ -+int rtw_build_tdls_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ int res = _SUCCESS; -+ -+ switch (ptxmgmt->action_code) { -+ case TDLS_SETUP_REQUEST: -+ rtw_build_tdls_setup_req_ies(padapter, pxmitframe, pframe, ptxmgmt); -+ break; -+ case TDLS_SETUP_RESPONSE: -+ rtw_build_tdls_setup_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt); -+ break; -+ case TDLS_SETUP_CONFIRM: -+ rtw_build_tdls_setup_cfm_ies(padapter, pxmitframe, pframe, ptxmgmt); -+ break; -+ case TDLS_TEARDOWN: -+ rtw_build_tdls_teardown_ies(padapter, pxmitframe, pframe, ptxmgmt); -+ break; -+ case TDLS_DISCOVERY_REQUEST: -+ rtw_build_tdls_dis_req_ies(padapter, pxmitframe, pframe, ptxmgmt); -+ break; -+ case TDLS_PEER_TRAFFIC_INDICATION: -+ rtw_build_tdls_peer_traffic_indication_ies(padapter, pxmitframe, pframe, ptxmgmt); -+ break; -+#ifdef CONFIG_TDLS_CH_SW -+ case TDLS_CHANNEL_SWITCH_REQUEST: -+ rtw_build_tdls_ch_switch_req_ies(padapter, pxmitframe, pframe, ptxmgmt); -+ break; -+ case TDLS_CHANNEL_SWITCH_RESPONSE: -+ rtw_build_tdls_ch_switch_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt); -+ break; -+#endif -+ case TDLS_PEER_TRAFFIC_RESPONSE: -+ rtw_build_tdls_peer_traffic_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt); -+ break; -+#ifdef CONFIG_WFD -+ case TUNNELED_PROBE_REQ: -+ rtw_build_tunneled_probe_req_ies(padapter, pxmitframe, pframe); -+ break; -+ case TUNNELED_PROBE_RSP: -+ rtw_build_tunneled_probe_rsp_ies(padapter, pxmitframe, pframe); -+ break; -+#endif /* CONFIG_WFD */ -+ default: -+ res = _FAIL; -+ break; -+ } -+ -+ return res; -+} -+ -+s32 rtw_make_tdls_wlanhdr(_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt) -+{ -+ u16 *qc; -+ struct rtw_ieee80211_hdr *pwlanhdr = (struct rtw_ieee80211_hdr *)hdr; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL, *ptdls_sta = NULL; -+ u8 tdls_seq = 0, baddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; -+ -+ sint res = _SUCCESS; -+ u16 *fctrl = &pwlanhdr->frame_ctl; -+ -+ -+ _rtw_memset(hdr, 0, WLANHDR_OFFSET); -+ -+ SetFrameSubType(fctrl, pattrib->subtype); -+ -+ switch (ptxmgmt->action_code) { -+ case TDLS_SETUP_REQUEST: -+ case TDLS_SETUP_RESPONSE: -+ case TDLS_SETUP_CONFIRM: -+ case TDLS_PEER_TRAFFIC_INDICATION: -+ case TDLS_PEER_PSM_REQUEST: -+ case TUNNELED_PROBE_REQ: -+ case TUNNELED_PROBE_RSP: -+ case TDLS_DISCOVERY_REQUEST: -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); -+ break; -+ case TDLS_CHANNEL_SWITCH_REQUEST: -+ case TDLS_CHANNEL_SWITCH_RESPONSE: -+ case TDLS_PEER_PSM_RESPONSE: -+ case TDLS_PEER_TRAFFIC_RESPONSE: -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); -+ tdls_seq = 1; -+ break; -+ case TDLS_TEARDOWN: -+ if (ptxmgmt->status_code == _RSON_TDLS_TEAR_UN_RSN_) { -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); -+ tdls_seq = 1; -+ } else { -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); -+ } -+ break; -+ } -+ -+ if (pattrib->encrypt) -+ SetPrivacy(fctrl); -+ -+ if (ptxmgmt->action_code == TDLS_PEER_TRAFFIC_RESPONSE) -+ SetPwrMgt(fctrl); -+ -+ if (pqospriv->qos_option) { -+ qc = (unsigned short *)(hdr + pattrib->hdrlen - 2); -+ if (pattrib->priority) -+ SetPriority(qc, pattrib->priority); -+ SetAckpolicy(qc, pattrib->ack_policy); -+ } -+ -+ psta = pattrib->psta; -+ -+ /* 1. update seq_num per link by sta_info */ -+ /* 2. rewrite encrypt to _AES_, also rewrite iv_len, icv_len */ -+ if (tdls_seq == 1) { -+ ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ if (ptdls_sta) { -+ ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority]++; -+ ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; -+ pattrib->seqnum = ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority]; -+ SetSeqNum(hdr, pattrib->seqnum); -+ -+ if (pattrib->encrypt) { -+ pattrib->encrypt = _AES_; -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 8; -+ pattrib->bswenc = _FALSE; -+ } -+ pattrib->mac_id = ptdls_sta->mac_id; -+ } else { -+ res = _FAIL; -+ goto exit; -+ } -+ } else if (psta) { -+ psta->sta_xmitpriv.txseq_tid[pattrib->priority]++; -+ psta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; -+ pattrib->seqnum = psta->sta_xmitpriv.txseq_tid[pattrib->priority]; -+ SetSeqNum(hdr, pattrib->seqnum); -+ } -+ -+ -+exit: -+ -+ -+ return res; -+} -+ -+s32 rtw_xmit_tdls_coalesce(_adapter *padapter, struct xmit_frame *pxmitframe, struct tdls_txmgmt *ptxmgmt) -+{ -+ s32 llc_sz; -+ -+ u8 *pframe, *mem_start; -+ -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 *pbuf_start; -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ s32 res = _SUCCESS; -+ -+ -+ if (pattrib->psta) -+ psta = pattrib->psta; -+ else { -+ if (bmcst) -+ psta = rtw_get_bcmc_stainfo(padapter); -+ else -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ } -+ -+ if (psta == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ if (pxmitframe->buf_addr == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pbuf_start = pxmitframe->buf_addr; -+ mem_start = pbuf_start + TXDESC_OFFSET; -+ -+ if (rtw_make_tdls_wlanhdr(padapter, mem_start, pattrib, ptxmgmt) == _FAIL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pframe = mem_start; -+ pframe += pattrib->hdrlen; -+ -+ /* adding icv, if necessary... */ -+ if (pattrib->iv_len) { -+ if (psta != NULL) { -+ switch (pattrib->encrypt) { -+ case _WEP40_: -+ case _WEP104_: -+ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ break; -+ case _TKIP_: -+ if (bmcst) -+ TKIP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ TKIP_IV(pattrib->iv, psta->dot11txpn, 0); -+ break; -+ case _AES_: -+ if (bmcst) -+ AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ AES_IV(pattrib->iv, psta->dot11txpn, 0); -+ break; -+ } -+ } -+ -+ _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); -+ pframe += pattrib->iv_len; -+ -+ } -+ -+ llc_sz = rtw_put_snap(pframe, pattrib->ether_type); -+ pframe += llc_sz; -+ -+ /* pattrib->pktlen will be counted in rtw_build_tdls_ies */ -+ pattrib->pktlen = 0; -+ -+ rtw_build_tdls_ies(padapter, pxmitframe, pframe, ptxmgmt); -+ -+ if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { -+ pframe += pattrib->pktlen; -+ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); -+ pframe += pattrib->icv_len; -+ } -+ -+ pattrib->nr_frags = 1; -+ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + llc_sz + -+ ((pattrib->bswenc) ? pattrib->icv_len : 0) + pattrib->pktlen; -+ -+ if (xmitframe_addmic(padapter, pxmitframe) == _FAIL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ xmitframe_swencrypt(padapter, pxmitframe); -+ -+ update_attrib_vcs_info(padapter, pxmitframe); -+ -+exit: -+ -+ -+ return res; -+} -+#endif /* CONFIG_TDLS */ -+ -+/* -+ * Calculate wlan 802.11 packet MAX size from pkt_attrib -+ * This function doesn't consider fragment case -+ */ -+u32 rtw_calculate_wlan_pkt_size_by_attribue(struct pkt_attrib *pattrib) -+{ -+ u32 len = 0; -+ -+ len = pattrib->hdrlen + pattrib->iv_len; /* WLAN Header and IV */ -+ len += SNAP_SIZE + sizeof(u16); /* LLC */ -+ len += pattrib->pktlen; -+ if (pattrib->encrypt == _TKIP_) -+ len += 8; /* MIC */ -+ len += ((pattrib->bswenc) ? pattrib->icv_len : 0); /* ICV */ -+ -+ return len; -+} -+ -+/* -+ -+This sub-routine will perform all the following: -+ -+1. remove 802.3 header. -+2. create wlan_header, based on the info in pxmitframe -+3. append sta's iv/ext-iv -+4. append LLC -+5. move frag chunk from pframe to pxmitframe->mem -+6. apply sw-encrypt, if necessary. -+ -+*/ -+s32 rtw_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe) -+{ -+ struct pkt_file pktfile; -+ -+ s32 frg_inx, frg_len, mpdu_len, llc_sz, mem_sz; -+ -+ SIZE_PTR addr; -+ -+ u8 *pframe, *mem_start; -+ u8 hw_hdr_offset; -+ -+ /* struct sta_info *psta; */ -+ /* struct sta_priv *pstapriv = &padapter->stapriv; */ -+ /* struct mlme_priv *pmlmepriv = &padapter->mlmepriv; */ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+ u8 *pbuf_start; -+ -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ s32 res = _SUCCESS; -+ -+ -+ /* -+ if (pattrib->psta) -+ { -+ psta = pattrib->psta; -+ } else -+ { -+ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ } -+ -+ if(psta==NULL) -+ { -+ -+ RTW_INFO("%s, psta==NUL\n", __func__); -+ return _FAIL; -+ } -+ -+ -+ if(!(psta->state &_FW_LINKED)) -+ { -+ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FAIL; -+ } -+ */ -+ if (pxmitframe->buf_addr == NULL) { -+ RTW_INFO("==> %s buf_addr==NULL\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+ pbuf_start = pxmitframe->buf_addr; -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ hw_hdr_offset = TXDESC_SIZE + (pxmitframe->pkt_offset * PACKET_OFFSET_SZ); -+#else -+#ifdef CONFIG_TX_EARLY_MODE /* for SDIO && Tx Agg */ -+ hw_hdr_offset = TXDESC_OFFSET + EARLY_MODE_INFO_SIZE; -+#else -+ hw_hdr_offset = TXDESC_OFFSET; -+#endif -+#endif -+ -+ mem_start = pbuf_start + hw_hdr_offset; -+ -+ if (rtw_make_wlanhdr(padapter, mem_start, pattrib) == _FAIL) { -+ RTW_INFO("rtw_xmitframe_coalesce: rtw_make_wlanhdr fail; drop pkt\n"); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_open_pktfile(pkt, &pktfile); -+ _rtw_pktfile_read(&pktfile, NULL, pattrib->pkt_hdrlen); -+ -+ frg_inx = 0; -+ frg_len = pxmitpriv->frag_len - 4;/* 2346-4 = 2342 */ -+ -+ while (1) { -+ llc_sz = 0; -+ -+ mpdu_len = frg_len; -+ -+ pframe = mem_start; -+ -+ SetMFrag(mem_start); -+ -+ pframe += pattrib->hdrlen; -+ mpdu_len -= pattrib->hdrlen; -+ -+ /* adding icv, if necessary... */ -+ if (pattrib->iv_len) { -+#if 0 -+ /* if (check_fwstate(pmlmepriv, WIFI_MP_STATE)) */ -+ /* psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); */ -+ /* else */ -+ /* psta = rtw_get_stainfo(pstapriv, pattrib->ra); */ -+ -+ if (psta != NULL) { -+ switch (pattrib->encrypt) { -+ case _WEP40_: -+ case _WEP104_: -+ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ break; -+ case _TKIP_: -+ if (bmcst) -+ TKIP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ TKIP_IV(pattrib->iv, psta->dot11txpn, 0); -+ break; -+ case _AES_: -+ if (bmcst) -+ AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ AES_IV(pattrib->iv, psta->dot11txpn, 0); -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ rtw_wapi_get_iv(padapter, pattrib->ra, pattrib->iv); -+ break; -+#endif -+ } -+ } -+#endif -+ _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); -+ -+ -+ pframe += pattrib->iv_len; -+ -+ mpdu_len -= pattrib->iv_len; -+ } -+ -+ if (frg_inx == 0) { -+ llc_sz = rtw_put_snap(pframe, pattrib->ether_type); -+ pframe += llc_sz; -+ mpdu_len -= llc_sz; -+ } -+ -+ if ((pattrib->icv_len > 0) && (pattrib->bswenc)) -+ mpdu_len -= pattrib->icv_len; -+ -+ -+ if (bmcst) { -+ /* don't do fragment to broadcat/multicast packets */ -+ mem_sz = _rtw_pktfile_read(&pktfile, pframe, pattrib->pktlen); -+ } else -+ mem_sz = _rtw_pktfile_read(&pktfile, pframe, mpdu_len); -+ -+ pframe += mem_sz; -+ -+ if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { -+ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); -+ pframe += pattrib->icv_len; -+ } -+ -+ frg_inx++; -+ -+ if (bmcst || (rtw_endofpktfile(&pktfile) == _TRUE)) { -+ pattrib->nr_frags = frg_inx; -+ -+ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + ((pattrib->nr_frags == 1) ? llc_sz : 0) + -+ ((pattrib->bswenc) ? pattrib->icv_len : 0) + mem_sz; -+ -+ ClearMFrag(mem_start); -+ -+ break; -+ } -+ -+ addr = (SIZE_PTR)(pframe); -+ -+ mem_start = (unsigned char *)RND4(addr) + hw_hdr_offset; -+ _rtw_memcpy(mem_start, pbuf_start + hw_hdr_offset, pattrib->hdrlen); -+ -+ } -+ -+ if (xmitframe_addmic(padapter, pxmitframe) == _FAIL) { -+ RTW_INFO("xmitframe_addmic(padapter, pxmitframe)==_FAIL\n"); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ xmitframe_swencrypt(padapter, pxmitframe); -+ -+ if (bmcst == _FALSE) -+ update_attrib_vcs_info(padapter, pxmitframe); -+ else -+ pattrib->vcs_mode = NONE_VCS; -+ -+exit: -+ -+ -+ return res; -+} -+ -+#ifdef CONFIG_IEEE80211W -+/* broadcast or multicast management pkt use BIP, unicast management pkt use CCMP encryption */ -+s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe) -+{ -+ struct pkt_file pktfile; -+ s32 frg_inx, frg_len, mpdu_len, llc_sz, mem_sz; -+ SIZE_PTR addr; -+ u8 *pframe, *mem_start = NULL, *tmp_buf = NULL; -+ u8 hw_hdr_offset, subtype ; -+ struct sta_info *psta = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 *pbuf_start; -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ s32 res = _FAIL; -+ u8 *BIP_AAD = NULL; -+ u8 *MGMT_body = NULL; -+ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u8 MME[_MME_IE_LENGTH_]; -+ -+ _irqL irqL; -+ u32 ori_len; -+ mem_start = pframe = (u8 *)(pxmitframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ ori_len = BIP_AAD_SIZE + pattrib->pktlen; -+ tmp_buf = BIP_AAD = rtw_zmalloc(ori_len); -+ subtype = GetFrameSubType(pframe); /* bit(7)~bit(2) */ -+ -+ if (BIP_AAD == NULL) -+ return _FAIL; -+ -+ _enter_critical_bh(&padapter->security_key_mutex, &irqL); -+ -+ -+ /* IGTK key is not install, it may not support 802.11w */ -+ if (padapter->securitypriv.binstallBIPkey != _TRUE) { -+ RTW_INFO("no instll BIP key\n"); -+ goto xmitframe_coalesce_success; -+ } -+ /* station mode doesn't need TX BIP, just ready the code */ -+ if (bmcst) { -+ int frame_body_len; -+ u8 mic[16]; -+ -+ _rtw_memset(MME, 0, _MME_IE_LENGTH_); -+ -+ /* other types doesn't need the BIP */ -+ if (GetFrameSubType(pframe) != WIFI_DEAUTH && GetFrameSubType(pframe) != WIFI_DISASSOC) -+ goto xmitframe_coalesce_fail; -+ -+ MGMT_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ pframe += pattrib->pktlen; -+ -+ /* octent 0 and 1 is key index ,BIP keyid is 4 or 5, LSB only need octent 0 */ -+ MME[0] = padapter->securitypriv.dot11wBIPKeyid; -+ /* copy packet number */ -+ _rtw_memcpy(&MME[2], &pmlmeext->mgnt_80211w_IPN, 6); -+ /* increase the packet number */ -+ pmlmeext->mgnt_80211w_IPN++; -+ -+ /* add MME IE with MIC all zero, MME string doesn't include element id and length */ -+ pframe = rtw_set_ie(pframe, _MME_IE_ , 16 , MME, &(pattrib->pktlen)); -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ /* total frame length - header length */ -+ frame_body_len = pattrib->pktlen - sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* conscruct AAD, copy frame control field */ -+ _rtw_memcpy(BIP_AAD, &pwlanhdr->frame_ctl, 2); -+ ClearRetry(BIP_AAD); -+ ClearPwrMgt(BIP_AAD); -+ ClearMData(BIP_AAD); -+ /* conscruct AAD, copy address 1 to address 3 */ -+ _rtw_memcpy(BIP_AAD + 2, pwlanhdr->addr1, 18); -+ /* copy management fram body */ -+ _rtw_memcpy(BIP_AAD + BIP_AAD_SIZE, MGMT_body, frame_body_len); -+#if 0 -+ /* dump total packet include MME with zero MIC */ -+ { -+ int i; -+ printk("Total packet: "); -+ for (i = 0; i < BIP_AAD_SIZE + frame_body_len; i++) -+ printk(" %02x ", BIP_AAD[i]); -+ printk("\n"); -+ } -+#endif -+ /* calculate mic */ -+ if (omac1_aes_128(padapter->securitypriv.dot11wBIPKey[padapter->securitypriv.dot11wBIPKeyid].skey -+ , BIP_AAD, BIP_AAD_SIZE + frame_body_len, mic)) -+ goto xmitframe_coalesce_fail; -+ -+#if 0 -+ /* dump calculated mic result */ -+ { -+ int i; -+ printk("Calculated mic result: "); -+ for (i = 0; i < 16; i++) -+ printk(" %02x ", mic[i]); -+ printk("\n"); -+ } -+#endif -+ /* copy right BIP mic value, total is 128bits, we use the 0~63 bits */ -+ _rtw_memcpy(pframe - 8, mic, 8); -+ /*/dump all packet after mic ok -+ { -+ int pp; -+ printk("pattrib->pktlen = %d\n", pattrib->pktlen); -+ for(pp=0;pp< pattrib->pktlen; pp++) -+ printk(" %02x ", mem_start[pp]); -+ printk("\n"); -+ }*/ -+ } else { /* unicast mgmt frame TX */ -+ /* start to encrypt mgmt frame */ -+ if (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || -+ subtype == WIFI_REASSOCREQ || subtype == WIFI_ACTION) { -+ if (pattrib->psta) -+ psta = pattrib->psta; -+ else -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ -+ if (psta == NULL) { -+ -+ RTW_INFO("%s, psta==NUL\n", __func__); -+ goto xmitframe_coalesce_fail; -+ } -+ -+ if (pxmitframe->buf_addr == NULL) { -+ RTW_INFO("%s, pxmitframe->buf_addr\n", __func__); -+ goto xmitframe_coalesce_fail; -+ } -+ -+ /* RTW_INFO("%s, action frame category=%d\n", __func__, pframe[WLAN_HDR_A3_LEN]); */ -+ /* according 802.11-2012 standard, these five types are not robust types */ -+ if (subtype == WIFI_ACTION && -+ (pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_PUBLIC || -+ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_HT || -+ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_UNPROTECTED_WNM || -+ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_SELF_PROTECTED || -+ pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_P2P)) -+ goto xmitframe_coalesce_fail; -+ /* before encrypt dump the management packet content */ -+ /*{ -+ int i; -+ printk("Management pkt: "); -+ for(i=0; ipktlen; i++) -+ printk(" %02x ", pframe[i]); -+ printk("=======\n"); -+ }*/ -+ if (pattrib->encrypt > 0) -+ _rtw_memcpy(pattrib->dot118021x_UncstKey.skey, psta->dot118021x_UncstKey.skey, 16); -+ -+ /* To use wrong key */ -+ if (pattrib->key_type == IEEE80211W_WRONG_KEY) { -+ RTW_INFO("use wrong key\n"); -+ pattrib->dot118021x_UncstKey.skey[0] = 0xff; -+ } -+ -+ /* bakeup original management packet */ -+ _rtw_memcpy(tmp_buf, pframe, pattrib->pktlen); -+ /* move to data portion */ -+ pframe += pattrib->hdrlen; -+ -+ /* 802.11w unicast management packet must be _AES_ */ -+ pattrib->iv_len = 8; -+ /* it's MIC of AES */ -+ pattrib->icv_len = 8; -+ -+ switch (pattrib->encrypt) { -+ case _AES_: -+ /* set AES IV header */ -+ AES_IV(pattrib->iv, psta->dot11wtxpn, 0); -+ break; -+ default: -+ goto xmitframe_coalesce_fail; -+ } -+ /* insert iv header into management frame */ -+ _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); -+ pframe += pattrib->iv_len; -+ /* copy mgmt data portion after CCMP header */ -+ _rtw_memcpy(pframe, tmp_buf + pattrib->hdrlen, pattrib->pktlen - pattrib->hdrlen); -+ /* move pframe to end of mgmt pkt */ -+ pframe += pattrib->pktlen - pattrib->hdrlen; -+ /* add 8 bytes CCMP IV header to length */ -+ pattrib->pktlen += pattrib->iv_len; -+#if 0 -+ /* dump management packet include AES IV header */ -+ { -+ int i; -+ printk("Management pkt + IV: "); -+ /* for(i=0; ipktlen; i++) */ -+ -+ printk("@@@@@@@@@@@@@\n"); -+ } -+#endif -+ -+ if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { -+ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); -+ pframe += pattrib->icv_len; -+ } -+ /* add 8 bytes MIC */ -+ pattrib->pktlen += pattrib->icv_len; -+ /* set final tx command size */ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ /* set protected bit must be beofre SW encrypt */ -+ SetPrivacy(mem_start); -+#if 0 -+ /* dump management packet include AES header */ -+ { -+ int i; -+ printk("prepare to enc Management pkt + IV: "); -+ for (i = 0; i < pattrib->pktlen; i++) -+ printk(" %02x ", mem_start[i]); -+ printk("@@@@@@@@@@@@@\n"); -+ } -+#endif -+ /* software encrypt */ -+ xmitframe_swencrypt(padapter, pxmitframe); -+ } -+ } -+ -+xmitframe_coalesce_success: -+ _exit_critical_bh(&padapter->security_key_mutex, &irqL); -+ rtw_mfree(BIP_AAD, ori_len); -+ return _SUCCESS; -+ -+xmitframe_coalesce_fail: -+ _exit_critical_bh(&padapter->security_key_mutex, &irqL); -+ rtw_mfree(BIP_AAD, ori_len); -+ -+ return _FAIL; -+} -+#endif /* CONFIG_IEEE80211W */ -+ -+/* Logical Link Control(LLC) SubNetwork Attachment Point(SNAP) header -+ * IEEE LLC/SNAP header contains 8 octets -+ * First 3 octets comprise the LLC portion -+ * SNAP portion, 5 octets, is divided into two fields: -+ * Organizationally Unique Identifier(OUI), 3 octets, -+ * type, defined by that organization, 2 octets. -+ */ -+s32 rtw_put_snap(u8 *data, u16 h_proto) -+{ -+ struct ieee80211_snap_hdr *snap; -+ u8 *oui; -+ -+ -+ snap = (struct ieee80211_snap_hdr *)data; -+ snap->dsap = 0xaa; -+ snap->ssap = 0xaa; -+ snap->ctrl = 0x03; -+ -+ if (h_proto == 0x8137 || h_proto == 0x80f3) -+ oui = P802_1H_OUI; -+ else -+ oui = RFC1042_OUI; -+ -+ snap->oui[0] = oui[0]; -+ snap->oui[1] = oui[1]; -+ snap->oui[2] = oui[2]; -+ -+ *(u16 *)(data + SNAP_SIZE) = htons(h_proto); -+ -+ -+ return SNAP_SIZE + sizeof(u16); -+} -+ -+void rtw_update_protection(_adapter *padapter, u8 *ie, uint ie_len) -+{ -+ -+ uint protection; -+ u8 *perp; -+ sint erp_len; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ -+ switch (pxmitpriv->vcs_setting) { -+ case DISABLE_VCS: -+ pxmitpriv->vcs = NONE_VCS; -+ break; -+ -+ case ENABLE_VCS: -+ break; -+ -+ case AUTO_VCS: -+ default: -+ perp = rtw_get_ie(ie, _ERPINFO_IE_, &erp_len, ie_len); -+ if (perp == NULL) -+ pxmitpriv->vcs = NONE_VCS; -+ else { -+ protection = (*(perp + 2)) & BIT(1); -+ if (protection) { -+ if (pregistrypriv->vcs_type == RTS_CTS) -+ pxmitpriv->vcs = RTS_CTS; -+ else -+ pxmitpriv->vcs = CTS_TO_SELF; -+ } else -+ pxmitpriv->vcs = NONE_VCS; -+ } -+ -+ break; -+ -+ } -+ -+ -+} -+ -+void rtw_count_tx_stats(PADAPTER padapter, struct xmit_frame *pxmitframe, int sz) -+{ -+ struct sta_info *psta = NULL; -+ struct stainfo_stats *pstats = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 pkt_num = 1; -+ -+ if ((pxmitframe->frame_tag & 0x0f) == DATA_FRAMETAG) { -+#if defined(CONFIG_USB_TX_AGGREGATION) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pkt_num = pxmitframe->agg_num; -+#endif -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod += pkt_num; -+ -+ pxmitpriv->tx_pkts += pkt_num; -+ -+ pxmitpriv->tx_bytes += sz; -+ -+ psta = pxmitframe->attrib.psta; -+ if (psta) { -+ pstats = &psta->sta_stats; -+ -+ pstats->tx_pkts += pkt_num; -+ -+ pstats->tx_bytes += sz; -+#ifdef CONFIG_TDLS -+ if (pxmitframe->attrib.ptdls_sta != NULL) { -+ pstats = &(pxmitframe->attrib.ptdls_sta->sta_stats); -+ pstats->tx_pkts += pkt_num; -+ pstats->tx_bytes += sz; -+ } -+#endif /* CONFIG_TDLS */ -+ } -+ -+#ifdef CONFIG_CHECK_LEAVE_LPS -+ /* traffic_check_for_leave_lps(padapter, _TRUE); */ -+#endif /* CONFIG_LPS */ -+ -+ } -+} -+ -+static struct xmit_buf *__rtw_alloc_cmd_xmitbuf(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type) -+{ -+ struct xmit_buf *pxmitbuf = NULL; -+ -+ -+ pxmitbuf = &pxmitpriv->pcmd_xmitbuf[buf_type]; -+ if (pxmitbuf != NULL) { -+ pxmitbuf->priv_data = NULL; -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+ pxmitbuf->agg_num = 0; -+ pxmitbuf->pg_num = 0; -+#endif -+#ifdef CONFIG_PCI_HCI -+ pxmitbuf->len = 0; -+#ifdef CONFIG_TRX_BD_ARCH -+ /*pxmitbuf->buf_desc = NULL;*/ -+#else -+ pxmitbuf->desc = NULL; -+#endif -+#endif -+ -+ if (pxmitbuf->sctx) { -+ RTW_INFO("%s pxmitbuf->sctx is not NULL\n", __func__); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); -+ } -+ } else -+ RTW_INFO("%s fail, no xmitbuf available !!!\n", __func__); -+ -+exit: -+ -+ -+ return pxmitbuf; -+} -+ -+struct xmit_frame *__rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type) -+{ -+ struct xmit_frame *pcmdframe; -+ struct xmit_buf *pxmitbuf; -+ -+ pcmdframe = rtw_alloc_xmitframe(pxmitpriv); -+ if (pcmdframe == NULL) { -+ RTW_INFO("%s, alloc xmitframe fail\n", __FUNCTION__); -+ return NULL; -+ } -+ -+ pxmitbuf = __rtw_alloc_cmd_xmitbuf(pxmitpriv, buf_type); -+ if (pxmitbuf == NULL) { -+ RTW_INFO("%s, alloc xmitbuf fail\n", __FUNCTION__); -+ rtw_free_xmitframe(pxmitpriv, pcmdframe); -+ return NULL; -+ } -+ -+ pcmdframe->frame_tag = MGNT_FRAMETAG; -+ -+ pcmdframe->pxmitbuf = pxmitbuf; -+ -+ pcmdframe->buf_addr = pxmitbuf->pbuf; -+ -+ /* initial memory to zero */ -+ _rtw_memset(pcmdframe->buf_addr, 0, pxmitbuf->alloc_sz); -+ -+ pxmitbuf->priv_data = pcmdframe; -+ -+ return pcmdframe; -+ -+} -+ -+struct xmit_buf *rtw_alloc_xmitbuf_ext(struct xmit_priv *pxmitpriv) -+{ -+ _irqL irqL; -+ struct xmit_buf *pxmitbuf = NULL; -+ _list *plist, *phead; -+ _queue *pfree_queue = &pxmitpriv->free_xmit_extbuf_queue; -+ -+ -+ _enter_critical(&pfree_queue->lock, &irqL); -+ -+ if (_rtw_queue_empty(pfree_queue) == _TRUE) -+ pxmitbuf = NULL; -+ else { -+ -+ phead = get_list_head(pfree_queue); -+ -+ plist = get_next(phead); -+ -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ -+ rtw_list_delete(&(pxmitbuf->list)); -+ } -+ -+ if (pxmitbuf != NULL) { -+ pxmitpriv->free_xmit_extbuf_cnt--; -+#ifdef DBG_XMIT_BUF_EXT -+ RTW_INFO("DBG_XMIT_BUF_EXT ALLOC no=%d, free_xmit_extbuf_cnt=%d\n", pxmitbuf->no, pxmitpriv->free_xmit_extbuf_cnt); -+#endif -+ -+ -+ pxmitbuf->priv_data = NULL; -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+ pxmitbuf->agg_num = 1; -+#endif -+#ifdef CONFIG_PCI_HCI -+ pxmitbuf->len = 0; -+#ifdef CONFIG_TRX_BD_ARCH -+ /*pxmitbuf->buf_desc = NULL;*/ -+#else -+ pxmitbuf->desc = NULL; -+#endif -+#endif -+ -+ if (pxmitbuf->sctx) { -+ RTW_INFO("%s pxmitbuf->sctx is not NULL\n", __func__); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); -+ } -+ -+ } -+ -+ _exit_critical(&pfree_queue->lock, &irqL); -+ -+ -+ return pxmitbuf; -+} -+ -+s32 rtw_free_xmitbuf_ext(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf) -+{ -+ _irqL irqL; -+ _queue *pfree_queue = &pxmitpriv->free_xmit_extbuf_queue; -+ -+ -+ if (pxmitbuf == NULL) -+ return _FAIL; -+ -+ _enter_critical(&pfree_queue->lock, &irqL); -+ -+ rtw_list_delete(&pxmitbuf->list); -+ -+ rtw_list_insert_tail(&(pxmitbuf->list), get_list_head(pfree_queue)); -+ pxmitpriv->free_xmit_extbuf_cnt++; -+#ifdef DBG_XMIT_BUF_EXT -+ RTW_INFO("DBG_XMIT_BUF_EXT FREE no=%d, free_xmit_extbuf_cnt=%d\n", pxmitbuf->no , pxmitpriv->free_xmit_extbuf_cnt); -+#endif -+ -+ _exit_critical(&pfree_queue->lock, &irqL); -+ -+ -+ return _SUCCESS; -+} -+ -+struct xmit_buf *rtw_alloc_xmitbuf(struct xmit_priv *pxmitpriv) -+{ -+ _irqL irqL; -+ struct xmit_buf *pxmitbuf = NULL; -+ _list *plist, *phead; -+ _queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue; -+ -+ -+ /* RTW_INFO("+rtw_alloc_xmitbuf\n"); */ -+ -+ _enter_critical(&pfree_xmitbuf_queue->lock, &irqL); -+ -+ if (_rtw_queue_empty(pfree_xmitbuf_queue) == _TRUE) -+ pxmitbuf = NULL; -+ else { -+ -+ phead = get_list_head(pfree_xmitbuf_queue); -+ -+ plist = get_next(phead); -+ -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ -+ rtw_list_delete(&(pxmitbuf->list)); -+ } -+ -+ if (pxmitbuf != NULL) { -+ pxmitpriv->free_xmitbuf_cnt--; -+#ifdef DBG_XMIT_BUF -+ RTW_INFO("DBG_XMIT_BUF ALLOC no=%d, free_xmitbuf_cnt=%d\n", pxmitbuf->no, pxmitpriv->free_xmitbuf_cnt); -+#endif -+ /* RTW_INFO("alloc, free_xmitbuf_cnt=%d\n", pxmitpriv->free_xmitbuf_cnt); */ -+ -+ pxmitbuf->priv_data = NULL; -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxmitbuf->len = 0; -+ pxmitbuf->pdata = pxmitbuf->ptail = pxmitbuf->phead; -+ pxmitbuf->agg_num = 0; -+ pxmitbuf->pg_num = 0; -+#endif -+#ifdef CONFIG_PCI_HCI -+ pxmitbuf->len = 0; -+#ifdef CONFIG_TRX_BD_ARCH -+ /*pxmitbuf->buf_desc = NULL;*/ -+#else -+ pxmitbuf->desc = NULL; -+#endif -+#endif -+ -+ if (pxmitbuf->sctx) { -+ RTW_INFO("%s pxmitbuf->sctx is not NULL\n", __func__); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); -+ } -+ } -+#ifdef DBG_XMIT_BUF -+ else -+ RTW_INFO("DBG_XMIT_BUF rtw_alloc_xmitbuf return NULL\n"); -+#endif -+ -+ _exit_critical(&pfree_xmitbuf_queue->lock, &irqL); -+ -+ -+ return pxmitbuf; -+} -+ -+s32 rtw_free_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf) -+{ -+ _irqL irqL; -+ _queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue; -+ -+ -+ /* RTW_INFO("+rtw_free_xmitbuf\n"); */ -+ -+ if (pxmitbuf == NULL) -+ return _FAIL; -+ -+ if (pxmitbuf->sctx) { -+ RTW_INFO("%s pxmitbuf->sctx is not NULL\n", __func__); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_FREE); -+ } -+ -+ if (pxmitbuf->buf_tag == XMITBUF_CMD) { -+ } else if (pxmitbuf->buf_tag == XMITBUF_MGNT) -+ rtw_free_xmitbuf_ext(pxmitpriv, pxmitbuf); -+ else { -+ _enter_critical(&pfree_xmitbuf_queue->lock, &irqL); -+ -+ rtw_list_delete(&pxmitbuf->list); -+ -+ rtw_list_insert_tail(&(pxmitbuf->list), get_list_head(pfree_xmitbuf_queue)); -+ -+ pxmitpriv->free_xmitbuf_cnt++; -+ /* RTW_INFO("FREE, free_xmitbuf_cnt=%d\n", pxmitpriv->free_xmitbuf_cnt); */ -+#ifdef DBG_XMIT_BUF -+ RTW_INFO("DBG_XMIT_BUF FREE no=%d, free_xmitbuf_cnt=%d\n", pxmitbuf->no , pxmitpriv->free_xmitbuf_cnt); -+#endif -+ _exit_critical(&pfree_xmitbuf_queue->lock, &irqL); -+ } -+ -+ -+ return _SUCCESS; -+} -+ -+void rtw_init_xmitframe(struct xmit_frame *pxframe) -+{ -+ if (pxframe != NULL) { /* default value setting */ -+ pxframe->buf_addr = NULL; -+ pxframe->pxmitbuf = NULL; -+ -+ _rtw_memset(&pxframe->attrib, 0, sizeof(struct pkt_attrib)); -+ /* pxframe->attrib.psta = NULL; */ -+ -+ pxframe->frame_tag = DATA_FRAMETAG; -+ -+#ifdef CONFIG_USB_HCI -+ pxframe->pkt = NULL; -+#ifdef USB_PACKET_OFFSET_SZ -+ pxframe->pkt_offset = (PACKET_OFFSET_SZ / 8); -+#else -+ pxframe->pkt_offset = 1;/* default use pkt_offset to fill tx desc */ -+#endif -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ pxframe->agg_num = 1; -+#endif -+ -+#endif /* #ifdef CONFIG_USB_HCI */ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pxframe->pg_num = 1; -+ pxframe->agg_num = 1; -+#endif -+ -+#ifdef CONFIG_XMIT_ACK -+ pxframe->ack_report = 0; -+#endif -+ -+ } -+} -+ -+/* -+Calling context: -+1. OS_TXENTRY -+2. RXENTRY (rx_thread or RX_ISR/RX_CallBack) -+ -+If we turn on USE_RXTHREAD, then, no need for critical section. -+Otherwise, we must use _enter/_exit critical to protect free_xmit_queue... -+ -+Must be very very cautious... -+ -+*/ -+struct xmit_frame *rtw_alloc_xmitframe(struct xmit_priv *pxmitpriv)/* (_queue *pfree_xmit_queue) */ -+{ -+ /* -+ Please remember to use all the osdep_service api, -+ and lock/unlock or _enter/_exit critical to protect -+ pfree_xmit_queue -+ */ -+ -+ _irqL irqL; -+ struct xmit_frame *pxframe = NULL; -+ _list *plist, *phead; -+ _queue *pfree_xmit_queue = &pxmitpriv->free_xmit_queue; -+ -+ -+ _enter_critical_bh(&pfree_xmit_queue->lock, &irqL); -+ -+ if (_rtw_queue_empty(pfree_xmit_queue) == _TRUE) { -+ pxframe = NULL; -+ } else { -+ phead = get_list_head(pfree_xmit_queue); -+ -+ plist = get_next(phead); -+ -+ pxframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ -+ rtw_list_delete(&(pxframe->list)); -+ pxmitpriv->free_xmitframe_cnt--; -+ } -+ -+ _exit_critical_bh(&pfree_xmit_queue->lock, &irqL); -+ -+ rtw_init_xmitframe(pxframe); -+ -+ -+ return pxframe; -+} -+ -+struct xmit_frame *rtw_alloc_xmitframe_ext(struct xmit_priv *pxmitpriv) -+{ -+ _irqL irqL; -+ struct xmit_frame *pxframe = NULL; -+ _list *plist, *phead; -+ _queue *queue = &pxmitpriv->free_xframe_ext_queue; -+ -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ if (_rtw_queue_empty(queue) == _TRUE) { -+ pxframe = NULL; -+ } else { -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ pxframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ -+ rtw_list_delete(&(pxframe->list)); -+ pxmitpriv->free_xframe_ext_cnt--; -+ } -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ rtw_init_xmitframe(pxframe); -+ -+ -+ return pxframe; -+} -+ -+struct xmit_frame *rtw_alloc_xmitframe_once(struct xmit_priv *pxmitpriv) -+{ -+ struct xmit_frame *pxframe = NULL; -+ u8 *alloc_addr; -+ -+ alloc_addr = rtw_zmalloc(sizeof(struct xmit_frame) + 4); -+ -+ if (alloc_addr == NULL) -+ goto exit; -+ -+ pxframe = (struct xmit_frame *)N_BYTE_ALIGMENT((SIZE_PTR)(alloc_addr), 4); -+ pxframe->alloc_addr = alloc_addr; -+ -+ pxframe->padapter = pxmitpriv->adapter; -+ pxframe->frame_tag = NULL_FRAMETAG; -+ -+ pxframe->pkt = NULL; -+ -+ pxframe->buf_addr = NULL; -+ pxframe->pxmitbuf = NULL; -+ -+ rtw_init_xmitframe(pxframe); -+ -+ RTW_INFO("################## %s ##################\n", __func__); -+ -+exit: -+ return pxframe; -+} -+ -+s32 rtw_free_xmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe) -+{ -+ _irqL irqL; -+ _queue *queue = NULL; -+ _adapter *padapter = pxmitpriv->adapter; -+ _pkt *pndis_pkt = NULL; -+ -+ -+ if (pxmitframe == NULL) { -+ goto exit; -+ } -+ -+ if (pxmitframe->pkt) { -+ pndis_pkt = pxmitframe->pkt; -+ pxmitframe->pkt = NULL; -+ } -+ -+ if (pxmitframe->alloc_addr) { -+ RTW_INFO("################## %s with alloc_addr ##################\n", __func__); -+ rtw_mfree(pxmitframe->alloc_addr, sizeof(struct xmit_frame) + 4); -+ goto check_pkt_complete; -+ } -+ -+ if (pxmitframe->ext_tag == 0) -+ queue = &pxmitpriv->free_xmit_queue; -+ else if (pxmitframe->ext_tag == 1) -+ queue = &pxmitpriv->free_xframe_ext_queue; -+ else -+ rtw_warn_on(1); -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ rtw_list_delete(&pxmitframe->list); -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(queue)); -+ if (pxmitframe->ext_tag == 0) { -+ pxmitpriv->free_xmitframe_cnt++; -+ } else if (pxmitframe->ext_tag == 1) { -+ pxmitpriv->free_xframe_ext_cnt++; -+ } else { -+ } -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+check_pkt_complete: -+ -+ if (pndis_pkt) -+ rtw_os_pkt_complete(padapter, pndis_pkt); -+ -+exit: -+ -+ -+ return _SUCCESS; -+} -+ -+void rtw_free_xmitframe_queue(struct xmit_priv *pxmitpriv, _queue *pframequeue) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct xmit_frame *pxmitframe; -+ -+ -+ _enter_critical_bh(&(pframequeue->lock), &irqL); -+ -+ phead = get_list_head(pframequeue); -+ plist = get_next(phead); -+ -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ -+ pxmitframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ -+ plist = get_next(plist); -+ -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ } -+ _exit_critical_bh(&(pframequeue->lock), &irqL); -+ -+} -+ -+s32 rtw_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue); -+ if (rtw_xmit_classifier(padapter, pxmitframe) == _FAIL) { -+ /* pxmitframe->pkt = NULL; */ -+ return _FAIL; -+ } -+ -+ return _SUCCESS; -+} -+ -+static struct xmit_frame *dequeue_one_xmitframe(struct xmit_priv *pxmitpriv, struct hw_xmit *phwxmit, struct tx_servq *ptxservq, _queue *pframe_queue) -+{ -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe = NULL; -+ -+ xmitframe_phead = get_list_head(pframe_queue); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ /* xmitframe_plist = get_next(xmitframe_plist); */ -+ -+ /*#ifdef RTK_DMP_PLATFORM -+ #ifdef CONFIG_USB_TX_AGGREGATION -+ if((ptxservq->qcnt>0) && (ptxservq->qcnt<=2)) -+ { -+ pxmitframe = NULL; -+ -+ tasklet_schedule(&pxmitpriv->xmit_tasklet); -+ -+ break; -+ } -+ #endif -+ #endif*/ -+ rtw_list_delete(&pxmitframe->list); -+ -+ ptxservq->qcnt--; -+ -+ /* rtw_list_insert_tail(&pxmitframe->list, &phwxmit->pending); */ -+ -+ /* ptxservq->qcnt--; */ -+ -+ break; -+ -+ /* pxmitframe = NULL; */ -+ -+ } -+ -+ return pxmitframe; -+} -+ -+struct xmit_frame *rtw_dequeue_xframe(struct xmit_priv *pxmitpriv, struct hw_xmit *phwxmit_i, sint entry) -+{ -+ _irqL irqL0; -+ _list *sta_plist, *sta_phead; -+ struct hw_xmit *phwxmit; -+ struct tx_servq *ptxservq = NULL; -+ _queue *pframe_queue = NULL; -+ struct xmit_frame *pxmitframe = NULL; -+ _adapter *padapter = pxmitpriv->adapter; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ int i, inx[4]; -+#ifdef CONFIG_USB_HCI -+ /* int j, tmp, acirp_cnt[4]; */ -+#endif -+ -+ -+ inx[0] = 0; -+ inx[1] = 1; -+ inx[2] = 2; -+ inx[3] = 3; -+ -+ if (pregpriv->wifi_spec == 1) { -+ int j, tmp, acirp_cnt[4]; -+#if 0 -+ if (flags < XMIT_QUEUE_ENTRY) { -+ /* priority exchange according to the completed xmitbuf flags. */ -+ inx[flags] = 0; -+ inx[0] = flags; -+ } -+#endif -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_PCI_HCI) -+ for (j = 0; j < 4; j++) -+ inx[j] = pxmitpriv->wmm_para_seq[j]; -+#endif -+ } -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ for (i = 0; i < entry; i++) { -+ phwxmit = phwxmit_i + inx[i]; -+ -+ /* _enter_critical_ex(&phwxmit->sta_queue->lock, &irqL0); */ -+ -+ sta_phead = get_list_head(phwxmit->sta_queue); -+ sta_plist = get_next(sta_phead); -+ -+ while ((rtw_end_of_queue_search(sta_phead, sta_plist)) == _FALSE) { -+ -+ ptxservq = LIST_CONTAINOR(sta_plist, struct tx_servq, tx_pending); -+ -+ pframe_queue = &ptxservq->sta_pending; -+ -+ pxmitframe = dequeue_one_xmitframe(pxmitpriv, phwxmit, ptxservq, pframe_queue); -+ -+ if (pxmitframe) { -+ phwxmit->accnt--; -+ -+ /* Remove sta node when there is no pending packets. */ -+ if (_rtw_queue_empty(pframe_queue)) /* must be done after get_next and before break */ -+ rtw_list_delete(&ptxservq->tx_pending); -+ -+ /* _exit_critical_ex(&phwxmit->sta_queue->lock, &irqL0); */ -+ -+ goto exit; -+ } -+ -+ sta_plist = get_next(sta_plist); -+ -+ } -+ -+ /* _exit_critical_ex(&phwxmit->sta_queue->lock, &irqL0); */ -+ -+ } -+ -+exit: -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ -+ return pxmitframe; -+} -+ -+#if 1 -+struct tx_servq *rtw_get_sta_pending(_adapter *padapter, struct sta_info *psta, sint up, u8 *ac) -+{ -+ struct tx_servq *ptxservq = NULL; -+ -+ -+ switch (up) { -+ case 1: -+ case 2: -+ ptxservq = &(psta->sta_xmitpriv.bk_q); -+ *(ac) = 3; -+ break; -+ -+ case 4: -+ case 5: -+ ptxservq = &(psta->sta_xmitpriv.vi_q); -+ *(ac) = 1; -+ break; -+ -+ case 6: -+ case 7: -+ ptxservq = &(psta->sta_xmitpriv.vo_q); -+ *(ac) = 0; -+ break; -+ -+ case 0: -+ case 3: -+ default: -+ ptxservq = &(psta->sta_xmitpriv.be_q); -+ *(ac) = 2; -+ break; -+ -+ } -+ -+ -+ return ptxservq; -+} -+#else -+__inline static struct tx_servq *rtw_get_sta_pending -+(_adapter *padapter, _queue **ppstapending, struct sta_info *psta, sint up) -+{ -+ struct tx_servq *ptxservq; -+ struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; -+ -+ -+#ifdef CONFIG_RTL8711 -+ -+ if (IS_MCAST(psta->hwaddr)) { -+ ptxservq = &(psta->sta_xmitpriv.be_q); /* we will use be_q to queue bc/mc frames in BCMC_stainfo */ -+ *ppstapending = &padapter->xmitpriv.bm_pending; -+ } else -+#endif -+ { -+ switch (up) { -+ case 1: -+ case 2: -+ ptxservq = &(psta->sta_xmitpriv.bk_q); -+ *ppstapending = &padapter->xmitpriv.bk_pending; -+ (phwxmits + 3)->accnt++; -+ break; -+ -+ case 4: -+ case 5: -+ ptxservq = &(psta->sta_xmitpriv.vi_q); -+ *ppstapending = &padapter->xmitpriv.vi_pending; -+ (phwxmits + 1)->accnt++; -+ break; -+ -+ case 6: -+ case 7: -+ ptxservq = &(psta->sta_xmitpriv.vo_q); -+ *ppstapending = &padapter->xmitpriv.vo_pending; -+ (phwxmits + 0)->accnt++; -+ break; -+ -+ case 0: -+ case 3: -+ default: -+ ptxservq = &(psta->sta_xmitpriv.be_q); -+ *ppstapending = &padapter->xmitpriv.be_pending; -+ (phwxmits + 2)->accnt++; -+ break; -+ -+ } -+ -+ } -+ -+ -+ return ptxservq; -+} -+#endif -+ -+/* -+ * Will enqueue pxmitframe to the proper queue, -+ * and indicate it to xx_pending list..... -+ */ -+s32 rtw_xmit_classifier(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ /* _irqL irqL0; */ -+ u8 ac_index; -+ struct sta_info *psta; -+ struct tx_servq *ptxservq; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; -+ sint res = _SUCCESS; -+ -+ -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class); -+ -+ /* -+ if (pattrib->psta) { -+ psta = pattrib->psta; -+ } else { -+ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ } -+ */ -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if (pattrib->psta != psta) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_sta); -+ RTW_INFO("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return _FAIL; -+ } -+ -+ if (psta == NULL) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_nosta); -+ res = _FAIL; -+ RTW_INFO("rtw_xmit_classifier: psta == NULL\n"); -+ goto exit; -+ } -+ -+ if (!(psta->state & _FW_LINKED)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_enqueue_class_err_fwlink); -+ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FAIL; -+ } -+ -+ ptxservq = rtw_get_sta_pending(padapter, psta, pattrib->priority, (u8 *)(&ac_index)); -+ -+ /* _enter_critical(&pstapending->lock, &irqL0); */ -+ -+ if (rtw_is_list_empty(&ptxservq->tx_pending)) -+ rtw_list_insert_tail(&ptxservq->tx_pending, get_list_head(phwxmits[ac_index].sta_queue)); -+ -+ /* _enter_critical(&ptxservq->sta_pending.lock, &irqL1); */ -+ -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&ptxservq->sta_pending)); -+ ptxservq->qcnt++; -+ phwxmits[ac_index].accnt++; -+ -+ /* _exit_critical(&ptxservq->sta_pending.lock, &irqL1); */ -+ -+ /* _exit_critical(&pstapending->lock, &irqL0); */ -+ -+exit: -+ -+ -+ return res; -+} -+ -+void rtw_alloc_hwxmits(_adapter *padapter) -+{ -+ struct hw_xmit *hwxmits; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ pxmitpriv->hwxmit_entry = HWXMIT_ENTRY; -+ -+ pxmitpriv->hwxmits = NULL; -+ -+ pxmitpriv->hwxmits = (struct hw_xmit *)rtw_zmalloc(sizeof(struct hw_xmit) * pxmitpriv->hwxmit_entry); -+ -+ if (pxmitpriv->hwxmits == NULL) { -+ RTW_INFO("alloc hwxmits fail!...\n"); -+ return; -+ } -+ -+ hwxmits = pxmitpriv->hwxmits; -+ -+ if (pxmitpriv->hwxmit_entry == 5) { -+ /* pxmitpriv->bmc_txqueue.head = 0; */ -+ /* hwxmits[0] .phwtxqueue = &pxmitpriv->bmc_txqueue; */ -+ hwxmits[0] .sta_queue = &pxmitpriv->bm_pending; -+ -+ /* pxmitpriv->vo_txqueue.head = 0; */ -+ /* hwxmits[1] .phwtxqueue = &pxmitpriv->vo_txqueue; */ -+ hwxmits[1] .sta_queue = &pxmitpriv->vo_pending; -+ -+ /* pxmitpriv->vi_txqueue.head = 0; */ -+ /* hwxmits[2] .phwtxqueue = &pxmitpriv->vi_txqueue; */ -+ hwxmits[2] .sta_queue = &pxmitpriv->vi_pending; -+ -+ /* pxmitpriv->bk_txqueue.head = 0; */ -+ /* hwxmits[3] .phwtxqueue = &pxmitpriv->bk_txqueue; */ -+ hwxmits[3] .sta_queue = &pxmitpriv->bk_pending; -+ -+ /* pxmitpriv->be_txqueue.head = 0; */ -+ /* hwxmits[4] .phwtxqueue = &pxmitpriv->be_txqueue; */ -+ hwxmits[4] .sta_queue = &pxmitpriv->be_pending; -+ -+ } else if (pxmitpriv->hwxmit_entry == 4) { -+ -+ /* pxmitpriv->vo_txqueue.head = 0; */ -+ /* hwxmits[0] .phwtxqueue = &pxmitpriv->vo_txqueue; */ -+ hwxmits[0] .sta_queue = &pxmitpriv->vo_pending; -+ -+ /* pxmitpriv->vi_txqueue.head = 0; */ -+ /* hwxmits[1] .phwtxqueue = &pxmitpriv->vi_txqueue; */ -+ hwxmits[1] .sta_queue = &pxmitpriv->vi_pending; -+ -+ /* pxmitpriv->be_txqueue.head = 0; */ -+ /* hwxmits[2] .phwtxqueue = &pxmitpriv->be_txqueue; */ -+ hwxmits[2] .sta_queue = &pxmitpriv->be_pending; -+ -+ /* pxmitpriv->bk_txqueue.head = 0; */ -+ /* hwxmits[3] .phwtxqueue = &pxmitpriv->bk_txqueue; */ -+ hwxmits[3] .sta_queue = &pxmitpriv->bk_pending; -+ } else { -+ -+ -+ } -+ -+ -+} -+ -+void rtw_free_hwxmits(_adapter *padapter) -+{ -+ struct hw_xmit *hwxmits; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ hwxmits = pxmitpriv->hwxmits; -+ if (hwxmits) -+ rtw_mfree((u8 *)hwxmits, (sizeof(struct hw_xmit) * pxmitpriv->hwxmit_entry)); -+} -+ -+void rtw_init_hwxmits(struct hw_xmit *phwxmit, sint entry) -+{ -+ sint i; -+ for (i = 0; i < entry; i++, phwxmit++) { -+ /* _rtw_spinlock_init(&phwxmit->xmit_lock); */ -+ /* _rtw_init_listhead(&phwxmit->pending); */ -+ /* phwxmit->txcmdcnt = 0; */ -+ phwxmit->accnt = 0; -+ } -+} -+ -+#ifdef CONFIG_BR_EXT -+int rtw_br_client_tx(_adapter *padapter, struct sk_buff **pskb) -+{ -+ struct sk_buff *skb = *pskb; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _irqL irqL; -+ /* if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == _TRUE) */ -+ { -+ void dhcp_flag_bcast(_adapter *priv, struct sk_buff *skb); -+ int res, is_vlan_tag = 0, i, do_nat25 = 1; -+ unsigned short vlan_hdr = 0; -+ void *br_port = NULL; -+ -+ /* mac_clone_handle_frame(priv, skb); */ -+ -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ br_port = padapter->pnetdev->br_port; -+#else /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ -+ rcu_read_lock(); -+ br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); -+ rcu_read_unlock(); -+#endif /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ -+ _enter_critical_bh(&padapter->br_ext_lock, &irqL); -+ if (!(skb->data[0] & 1) && -+ br_port && -+ memcmp(skb->data + MACADDRLEN, padapter->br_mac, MACADDRLEN) && -+ *((unsigned short *)(skb->data + MACADDRLEN * 2)) != __constant_htons(ETH_P_8021Q) && -+ *((unsigned short *)(skb->data + MACADDRLEN * 2)) == __constant_htons(ETH_P_IP) && -+ !memcmp(padapter->scdb_mac, skb->data + MACADDRLEN, MACADDRLEN) && padapter->scdb_entry) { -+ memcpy(skb->data + MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); -+ padapter->scdb_entry->ageing_timer = jiffies; -+ _exit_critical_bh(&padapter->br_ext_lock, &irqL); -+ } else -+ /* if (!priv->pmib->ethBrExtInfo.nat25_disable) */ -+ { -+ /* if (priv->dev->br_port && -+ * !memcmp(skb->data+MACADDRLEN, priv->br_mac, MACADDRLEN)) { */ -+#if 1 -+ if (*((unsigned short *)(skb->data + MACADDRLEN * 2)) == __constant_htons(ETH_P_8021Q)) { -+ is_vlan_tag = 1; -+ vlan_hdr = *((unsigned short *)(skb->data + MACADDRLEN * 2 + 2)); -+ for (i = 0; i < 6; i++) -+ *((unsigned short *)(skb->data + MACADDRLEN * 2 + 2 - i * 2)) = *((unsigned short *)(skb->data + MACADDRLEN * 2 - 2 - i * 2)); -+ skb_pull(skb, 4); -+ } -+ /* if SA == br_mac && skb== IP => copy SIP to br_ip ?? why */ -+ if (!memcmp(skb->data + MACADDRLEN, padapter->br_mac, MACADDRLEN) && -+ (*((unsigned short *)(skb->data + MACADDRLEN * 2)) == __constant_htons(ETH_P_IP))) -+ memcpy(padapter->br_ip, skb->data + WLAN_ETHHDR_LEN + 12, 4); -+ -+ if (*((unsigned short *)(skb->data + MACADDRLEN * 2)) == __constant_htons(ETH_P_IP)) { -+ if (memcmp(padapter->scdb_mac, skb->data + MACADDRLEN, MACADDRLEN)) { -+ void *scdb_findEntry(_adapter *priv, unsigned char *macAddr, unsigned char *ipAddr); -+ -+ padapter->scdb_entry = (struct nat25_network_db_entry *)scdb_findEntry(padapter, -+ skb->data + MACADDRLEN, skb->data + WLAN_ETHHDR_LEN + 12); -+ if (padapter->scdb_entry != NULL) { -+ memcpy(padapter->scdb_mac, skb->data + MACADDRLEN, MACADDRLEN); -+ memcpy(padapter->scdb_ip, skb->data + WLAN_ETHHDR_LEN + 12, 4); -+ padapter->scdb_entry->ageing_timer = jiffies; -+ do_nat25 = 0; -+ } -+ } else { -+ if (padapter->scdb_entry) { -+ padapter->scdb_entry->ageing_timer = jiffies; -+ do_nat25 = 0; -+ } else { -+ memset(padapter->scdb_mac, 0, MACADDRLEN); -+ memset(padapter->scdb_ip, 0, 4); -+ } -+ } -+ } -+ _exit_critical_bh(&padapter->br_ext_lock, &irqL); -+#endif /* 1 */ -+ if (do_nat25) { -+ int nat25_db_handle(_adapter *priv, struct sk_buff *skb, int method); -+ if (nat25_db_handle(padapter, skb, NAT25_CHECK) == 0) { -+ struct sk_buff *newskb; -+ -+ if (is_vlan_tag) { -+ skb_push(skb, 4); -+ for (i = 0; i < 6; i++) -+ *((unsigned short *)(skb->data + i * 2)) = *((unsigned short *)(skb->data + 4 + i * 2)); -+ *((unsigned short *)(skb->data + MACADDRLEN * 2)) = __constant_htons(ETH_P_8021Q); -+ *((unsigned short *)(skb->data + MACADDRLEN * 2 + 2)) = vlan_hdr; -+ } -+ -+ newskb = rtw_skb_copy(skb); -+ if (newskb == NULL) { -+ /* priv->ext_stats.tx_drops++; */ -+ DEBUG_ERR("TX DROP: rtw_skb_copy fail!\n"); -+ /* goto stop_proc; */ -+ return -1; -+ } -+ rtw_skb_free(skb); -+ -+ *pskb = skb = newskb; -+ if (is_vlan_tag) { -+ vlan_hdr = *((unsigned short *)(skb->data + MACADDRLEN * 2 + 2)); -+ for (i = 0; i < 6; i++) -+ *((unsigned short *)(skb->data + MACADDRLEN * 2 + 2 - i * 2)) = *((unsigned short *)(skb->data + MACADDRLEN * 2 - 2 - i * 2)); -+ skb_pull(skb, 4); -+ } -+ } -+ -+ if (skb_is_nonlinear(skb)) -+ DEBUG_ERR("%s(): skb_is_nonlinear!!\n", __FUNCTION__); -+ -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 18)) -+ res = skb_linearize(skb, GFP_ATOMIC); -+#else /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 18)) */ -+ res = skb_linearize(skb); -+#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 18)) */ -+ if (res < 0) { -+ DEBUG_ERR("TX DROP: skb_linearize fail!\n"); -+ /* goto free_and_stop; */ -+ return -1; -+ } -+ -+ res = nat25_db_handle(padapter, skb, NAT25_INSERT); -+ if (res < 0) { -+ if (res == -2) { -+ /* priv->ext_stats.tx_drops++; */ -+ DEBUG_ERR("TX DROP: nat25_db_handle fail!\n"); -+ /* goto free_and_stop; */ -+ return -1; -+ -+ } -+ /* we just print warning message and let it go */ -+ /* DEBUG_WARN("%s()-%d: nat25_db_handle INSERT Warning!\n", __FUNCTION__, __LINE__); */ -+ /* return -1; */ /* return -1 will cause system crash on 2011/08/30! */ -+ return 0; -+ } -+ } -+ -+ memcpy(skb->data + MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); -+ -+ dhcp_flag_bcast(padapter, skb); -+ -+ if (is_vlan_tag) { -+ skb_push(skb, 4); -+ for (i = 0; i < 6; i++) -+ *((unsigned short *)(skb->data + i * 2)) = *((unsigned short *)(skb->data + 4 + i * 2)); -+ *((unsigned short *)(skb->data + MACADDRLEN * 2)) = __constant_htons(ETH_P_8021Q); -+ *((unsigned short *)(skb->data + MACADDRLEN * 2 + 2)) = vlan_hdr; -+ } -+ } -+#if 0 -+ else { -+ if (*((unsigned short *)(skb->data + MACADDRLEN * 2)) == __constant_htons(ETH_P_8021Q)) -+ is_vlan_tag = 1; -+ -+ if (is_vlan_tag) { -+ if (ICMPV6_MCAST_MAC(skb->data) && ICMPV6_PROTO1A_VALN(skb->data)) -+ memcpy(skb->data + MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); -+ } else { -+ if (ICMPV6_MCAST_MAC(skb->data) && ICMPV6_PROTO1A(skb->data)) -+ memcpy(skb->data + MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); -+ } -+ } -+#endif /* 0 */ -+ -+ /* check if SA is equal to our MAC */ -+ if (memcmp(skb->data + MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN)) { -+ /* priv->ext_stats.tx_drops++; */ -+ DEBUG_ERR("TX DROP: untransformed frame SA:%02X%02X%02X%02X%02X%02X!\n", -+ skb->data[6], skb->data[7], skb->data[8], skb->data[9], skb->data[10], skb->data[11]); -+ /* goto free_and_stop; */ -+ return -1; -+ } -+ } -+ return 0; -+} -+#endif /* CONFIG_BR_EXT */ -+ -+u32 rtw_get_ff_hwaddr(struct xmit_frame *pxmitframe) -+{ -+ u32 addr; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+ switch (pattrib->qsel) { -+ case 0: -+ case 3: -+ addr = BE_QUEUE_INX; -+ break; -+ case 1: -+ case 2: -+ addr = BK_QUEUE_INX; -+ break; -+ case 4: -+ case 5: -+ addr = VI_QUEUE_INX; -+ break; -+ case 6: -+ case 7: -+ addr = VO_QUEUE_INX; -+ break; -+ case 0x10: -+ addr = BCN_QUEUE_INX; -+ break; -+ case 0x11: /* BC/MC in PS (HIQ) */ -+ addr = HIGH_QUEUE_INX; -+ break; -+ case 0x13: -+ addr = TXCMD_QUEUE_INX; -+ break; -+ case 0x12: -+ default: -+ addr = MGT_QUEUE_INX; -+ break; -+ -+ } -+ -+ return addr; -+ -+} -+ -+static void do_queue_select(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ u8 qsel; -+ -+ qsel = pattrib->priority; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ /* if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) -+ * qsel = 7; */ -+#endif -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) { -+ /* Under MCC */ -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) { -+ if (padapter->mcc_adapterpriv.role == MCC_ROLE_GO -+ || padapter->mcc_adapterpriv.role == MCC_ROLE_AP) { -+ pattrib->qsel = QSLT_VO; /* AP interface VO queue */ -+ } else { -+ pattrib->qsel = QSLT_BE; /* STA interface BE queue */ -+ } -+ } else -+ /* Not Under MCC */ -+ pattrib->qsel = qsel; -+ } else -+ /* Not enable MCC */ -+ pattrib->qsel = qsel; -+#else /* !CONFIG_MCC_MODE */ -+ pattrib->qsel = qsel; -+#endif /* CONFIG_MCC_MODE */ -+} -+ -+/* -+ * The main transmit(tx) entry -+ * -+ * Return -+ * 1 enqueue -+ * 0 success, hardware will handle this xmit frame(packet) -+ * <0 fail -+ */ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+s32 rtw_monitor_xmit_entry(struct sk_buff *skb, struct net_device *ndev) -+{ -+ int ret = 0; -+ int rtap_len; -+ int qos_len = 0; -+ int dot11_hdr_len = 24; -+ int snap_len = 6; -+ unsigned char *pdata; -+ u16 frame_ctl; -+ unsigned char src_mac_addr[6]; -+ unsigned char dst_mac_addr[6]; -+ struct rtw_ieee80211_hdr *dot11_hdr; -+ struct ieee80211_radiotap_header *rtap_hdr; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ if (skb) -+ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize); -+ -+ if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header))) -+ goto fail; -+ -+ rtap_hdr = (struct ieee80211_radiotap_header *)skb->data; -+ if (unlikely(rtap_hdr->it_version)) -+ goto fail; -+ -+ rtap_len = ieee80211_get_radiotap_len(skb->data); -+ if (unlikely(skb->len < rtap_len)) -+ goto fail; -+ -+ if (rtap_len != 12) { -+ RTW_INFO("radiotap len (should be 14): %d\n", rtap_len); -+ goto fail; -+ } -+ -+ /* Skip the ratio tap header */ -+ skb_pull(skb, rtap_len); -+ -+ dot11_hdr = (struct rtw_ieee80211_hdr *)skb->data; -+ frame_ctl = le16_to_cpu(dot11_hdr->frame_ctl); -+ /* Check if the QoS bit is set */ -+ -+ if ((frame_ctl & RTW_IEEE80211_FCTL_FTYPE) == RTW_IEEE80211_FTYPE_DATA) { -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ u8 *buf = skb->data; -+ u32 len = skb->len; -+ u8 category, action; -+ int type = -1; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ rtw_udelay_os(500); -+ goto fail; -+ } -+ pattrib = &pmgntframe->attrib; -+ -+ update_monitor_frame_attrib(padapter, pattrib); -+ -+ pattrib->retry_ctrl = _FALSE; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ _rtw_memcpy(pframe, (void *)buf, len); -+ -+ pattrib->pktlen = len; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ if (is_broadcast_mac_addr(pwlanhdr->addr3) || is_broadcast_mac_addr(pwlanhdr->addr1)) -+ pattrib->rate = MGN_24M; -+ -+ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ pmlmeext->mgnt_seq++; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ } else { -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ u8 *buf = skb->data; -+ u32 len = skb->len; -+ u8 category, action; -+ int type = -1; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto fail; -+ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = _FALSE; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ _rtw_memcpy(pframe, (void *)buf, len); -+ -+ pattrib->pktlen = len; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ pmlmeext->mgnt_seq++; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ } -+ -+fail: -+ -+ rtw_skb_free(skb); -+ -+ return 0; -+} -+#endif -+/* -+ * The main transmit(tx) entry -+ * -+ * Return -+ * 1 enqueue -+ * 0 success, hardware will handle this xmit frame(packet) -+ * <0 fail -+ */ -+s32 rtw_xmit(_adapter *padapter, _pkt **ppkt) -+{ -+ static u32 start = 0; -+ static u32 drop_cnt = 0; -+#ifdef CONFIG_AP_MODE -+ _irqL irqL0; -+#endif -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_frame *pxmitframe = NULL; -+#ifdef CONFIG_BR_EXT -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ void *br_port = NULL; -+#endif /* CONFIG_BR_EXT */ -+ -+ s32 res; -+ -+ DBG_COUNTER(padapter->tx_logs.core_tx); -+ -+ if (start == 0) -+ start = rtw_get_current_time(); -+ -+ pxmitframe = rtw_alloc_xmitframe(pxmitpriv); -+ -+ if (rtw_get_passing_time_ms(start) > 2000) { -+ if (drop_cnt) -+ RTW_INFO("DBG_TX_DROP_FRAME %s no more pxmitframe, drop_cnt:%u\n", __FUNCTION__, drop_cnt); -+ start = rtw_get_current_time(); -+ drop_cnt = 0; -+ } -+ -+ if (pxmitframe == NULL) { -+ drop_cnt++; -+ /*RTW_INFO("%s-"ADPT_FMT" no more xmitframe\n", __func__, ADPT_ARG(padapter));*/ -+ DBG_COUNTER(padapter->tx_logs.core_tx_err_pxmitframe); -+ return -1; -+ } -+ -+#ifdef CONFIG_BR_EXT -+ -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ br_port = padapter->pnetdev->br_port; -+#else /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ -+ rcu_read_lock(); -+ br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); -+ rcu_read_unlock(); -+#endif /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ -+ -+ if (br_port && check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) == _TRUE) { -+ res = rtw_br_client_tx(padapter, ppkt); -+ if (res == -1) { -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ DBG_COUNTER(padapter->tx_logs.core_tx_err_brtx); -+ return -1; -+ } -+ } -+ -+#endif /* CONFIG_BR_EXT */ -+ -+ res = update_attrib(padapter, *ppkt, &pxmitframe->attrib); -+ -+#ifdef CONFIG_MCC_MODE -+ /* record data kernel TX to driver to check MCC concurrent TX */ -+ rtw_hal_mcc_calc_tx_bytes_from_kernel(padapter, pxmitframe->attrib.pktlen); -+#endif /* CONFIG_MCC_MODE */ -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (pxmitframe->attrib.ether_type != 0x88B4) { -+ if (rtw_wapi_drop_for_key_absent(padapter, pxmitframe->attrib.ra)) { -+ WAPI_TRACE(WAPI_RX, "drop for key absend when tx\n"); -+ res = _FAIL; -+ } -+ } -+#endif -+ if (res == _FAIL) { -+ /*RTW_INFO("%s-"ADPT_FMT" update attrib fail\n", __func__, ADPT_ARG(padapter));*/ -+#ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s update attrib fail\n", __FUNCTION__); -+#endif -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ return -1; -+ } -+ pxmitframe->pkt = *ppkt; -+ -+ rtw_led_control(padapter, LED_CTL_TX); -+ -+ do_queue_select(padapter, &pxmitframe->attrib); -+ -+#ifdef CONFIG_AP_MODE -+ _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ if (xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe) == _TRUE) { -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue); -+ return 1; -+ } -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+#endif -+ -+ /* pre_xmitframe */ -+ if (rtw_hal_xmit(padapter, pxmitframe) == _FALSE) -+ return 1; -+ -+ return 0; -+} -+ -+#ifdef CONFIG_TDLS -+sint xmitframe_enqueue_for_tdls_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ sint ret = _FALSE; -+ -+ _irqL irqL; -+ struct sta_info *ptdls_sta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ int i; -+ -+ ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ if (ptdls_sta == NULL) -+ return ret; -+ else if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { -+ -+ if (pattrib->triggered == 1) { -+ ret = _TRUE; -+ return ret; -+ } -+ -+ _enter_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); -+ -+ if (ptdls_sta->state & WIFI_SLEEP_STATE) { -+ rtw_list_delete(&pxmitframe->list); -+ -+ /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&ptdls_sta->sleep_q)); -+ -+ ptdls_sta->sleepq_len++; -+ ptdls_sta->sleepq_ac_len++; -+ -+ /* indicate 4-AC queue bit in TDLS peer traffic indication */ -+ switch (pattrib->priority) { -+ case 1: -+ case 2: -+ ptdls_sta->uapsd_bk |= BIT(1); -+ break; -+ case 4: -+ case 5: -+ ptdls_sta->uapsd_vi |= BIT(1); -+ break; -+ case 6: -+ case 7: -+ ptdls_sta->uapsd_vo |= BIT(1); -+ break; -+ case 0: -+ case 3: -+ default: -+ ptdls_sta->uapsd_be |= BIT(1); -+ break; -+ } -+ -+ /* Transmit TDLS PTI via AP */ -+ if (ptdls_sta->sleepq_len == 1) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ISSUE_PTI); -+ -+ ret = _TRUE; -+ } -+ -+ _exit_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); -+ } -+ -+ return ret; -+ -+} -+#endif /* CONFIG_TDLS */ -+ -+#define RTW_HIQ_FILTER_ALLOW_ALL 0 -+#define RTW_HIQ_FILTER_ALLOW_SPECIAL 1 -+#define RTW_HIQ_FILTER_DENY_ALL 2 -+ -+inline bool xmitframe_hiq_filter(struct xmit_frame *xmitframe) -+{ -+ bool allow = _FALSE; -+ _adapter *adapter = xmitframe->padapter; -+ struct registry_priv *registry = &adapter->registrypriv; -+ -+ if (rtw_get_intf_type(adapter) != RTW_PCIE) { -+ -+ if (adapter->registrypriv.wifi_spec == 1) -+ allow = _TRUE; -+ else if (registry->hiq_filter == RTW_HIQ_FILTER_ALLOW_SPECIAL) { -+ -+ struct pkt_attrib *attrib = &xmitframe->attrib; -+ -+ if (attrib->ether_type == 0x0806 -+ || attrib->ether_type == 0x888e -+#ifdef CONFIG_WAPI_SUPPORT -+ || attrib->ether_type == 0x88B4 -+#endif -+ || attrib->dhcp_pkt -+ ) { -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" ether_type:0x%04x%s\n", FUNC_ADPT_ARG(xmitframe->padapter) -+ , attrib->ether_type, attrib->dhcp_pkt ? " DHCP" : ""); -+ allow = _TRUE; -+ } -+ } else if (registry->hiq_filter == RTW_HIQ_FILTER_ALLOW_ALL) -+ allow = _TRUE; -+ else if (registry->hiq_filter == RTW_HIQ_FILTER_DENY_ALL) { -+ } else -+ rtw_warn_on(1); -+ } -+ return allow; -+} -+ -+#if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) -+ -+sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ _irqL irqL; -+ sint ret = _FALSE; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ sint bmcst = IS_MCAST(pattrib->ra); -+ bool update_tim = _FALSE; -+#ifdef CONFIG_TDLS -+ -+ if (padapter->tdlsinfo.link_established == _TRUE) -+ ret = xmitframe_enqueue_for_tdls_sleeping_sta(padapter, pxmitframe); -+#endif /* CONFIG_TDLS */ -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _FALSE) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_fwstate); -+ return ret; -+ } -+ /* -+ if(pattrib->psta) -+ { -+ psta = pattrib->psta; -+ } -+ else -+ { -+ RTW_INFO("%s, call rtw_get_stainfo()\n", __func__); -+ psta=rtw_get_stainfo(pstapriv, pattrib->ra); -+ } -+ */ -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if (pattrib->psta != psta) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_sta); -+ RTW_INFO("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return _FALSE; -+ } -+ -+ if (psta == NULL) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_nosta); -+ RTW_INFO("%s, psta==NUL\n", __func__); -+ return _FALSE; -+ } -+ -+ if (!(psta->state & _FW_LINKED)) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_link); -+ RTW_INFO("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FALSE; -+ } -+ -+ if (pattrib->triggered == 1) { -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_trigger); -+ /* RTW_INFO("directly xmit pspoll_triggered packet\n"); */ -+ -+ /* pattrib->triggered=0; */ -+ if (bmcst && xmitframe_hiq_filter(pxmitframe) == _TRUE) -+ pattrib->qsel = QSLT_HIGH;/* HIQ */ -+ -+ return ret; -+ } -+ -+ -+ if (bmcst) { -+ _enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ if (pstapriv->sta_dz_bitmap) { /* if anyone sta is in ps mode */ -+ /* pattrib->qsel = QSLT_HIGH; */ /* HIQ */ -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ /*_enter_critical_bh(&psta->sleep_q.lock, &irqL);*/ -+ -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&psta->sleep_q)); -+ -+ psta->sleepq_len++; -+ -+ if (!(pstapriv->tim_bitmap & BIT(0))) -+ update_tim = _TRUE; -+ -+ pstapriv->tim_bitmap |= BIT(0); -+ pstapriv->sta_dz_bitmap |= BIT(0); -+ -+ /* RTW_INFO("enqueue, sq_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ -+ if (update_tim == _TRUE) { -+ if (is_broadcast_mac_addr(pattrib->ra)) -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "buffer BC"); -+ else -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "buffer MC"); -+ } else -+ chk_bmc_sleepq_cmd(padapter); -+ -+ /*_exit_critical_bh(&psta->sleep_q.lock, &irqL);*/ -+ -+ ret = _TRUE; -+ -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_mcast); -+ -+ } -+ -+ _exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ return ret; -+ -+ } -+ -+ -+ _enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ if (psta->state & WIFI_SLEEP_STATE) { -+ u8 wmmps_ac = 0; -+ -+ if (pstapriv->sta_dz_bitmap & BIT(psta->aid)) { -+ rtw_list_delete(&pxmitframe->list); -+ -+ /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&psta->sleep_q)); -+ -+ psta->sleepq_len++; -+ -+ switch (pattrib->priority) { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk & BIT(0); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi & BIT(0); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo & BIT(0); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be & BIT(0); -+ break; -+ } -+ -+ if (wmmps_ac) -+ psta->sleepq_ac_len++; -+ -+ if (((psta->has_legacy_ac) && (!wmmps_ac)) || ((!psta->has_legacy_ac) && (wmmps_ac))) { -+ if (!(pstapriv->tim_bitmap & BIT(psta->aid))) -+ update_tim = _TRUE; -+ -+ pstapriv->tim_bitmap |= BIT(psta->aid); -+ -+ /* RTW_INFO("enqueue, sq_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ -+ -+ if (update_tim == _TRUE) { -+ /* RTW_INFO("sleepq_len==1, update BCNTIM\n"); */ -+ /* upate BCN for TIM IE */ -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "buffer UC"); -+ } -+ } -+ -+ /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ -+ /* if(psta->sleepq_len > (NR_XMITFRAME>>3)) */ -+ /* { */ -+ /* wakeup_sta_to_xmit(padapter, psta); */ -+ /* } */ -+ -+ ret = _TRUE; -+ -+ DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_ucast); -+ } -+ -+ } -+ -+ _exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ return ret; -+ -+} -+ -+static void dequeue_xmitframes_to_sleeping_queue(_adapter *padapter, struct sta_info *psta, _queue *pframequeue) -+{ -+ sint ret; -+ _list *plist, *phead; -+ u8 ac_index; -+ struct tx_servq *ptxservq; -+ struct pkt_attrib *pattrib; -+ struct xmit_frame *pxmitframe; -+ struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; -+ -+ phead = get_list_head(pframequeue); -+ plist = get_next(phead); -+ -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ pxmitframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ -+ plist = get_next(plist); -+ -+ pattrib = &pxmitframe->attrib; -+ -+ pattrib->triggered = 0; -+ -+ ret = xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe); -+ -+ if (_TRUE == ret) { -+ ptxservq = rtw_get_sta_pending(padapter, psta, pattrib->priority, (u8 *)(&ac_index)); -+ -+ ptxservq->qcnt--; -+ phwxmits[ac_index].accnt--; -+ } else { -+ /* RTW_INFO("xmitframe_enqueue_for_sleeping_sta return _FALSE\n"); */ -+ } -+ -+ } -+ -+} -+ -+void stop_sta_xmit(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL0; -+ struct sta_info *psta_bmc; -+ struct sta_xmit_priv *pstaxmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ pstaxmitpriv = &psta->sta_xmitpriv; -+ -+ /* for BC/MC Frames */ -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ psta->state |= WIFI_SLEEP_STATE; -+ -+#ifdef CONFIG_TDLS -+ if (!(psta->tdls_sta_state & TDLS_LINKED_STATE)) -+#endif /* CONFIG_TDLS */ -+ pstapriv->sta_dz_bitmap |= BIT(psta->aid); -+ -+ -+ -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->vo_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending)); -+ -+ -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->vi_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->vi_q.tx_pending)); -+ -+ -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->be_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); -+ -+ -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->bk_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending)); -+ -+#ifdef CONFIG_TDLS -+ if (!(psta->tdls_sta_state & TDLS_LINKED_STATE) && (psta_bmc != NULL)) { -+#endif /* CONFIG_TDLS */ -+ -+ -+ /* for BC/MC Frames */ -+ pstaxmitpriv = &psta_bmc->sta_xmitpriv; -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->be_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); -+ -+ -+#ifdef CONFIG_TDLS -+ } -+#endif /* CONFIG_TDLS */ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ -+} -+ -+void wakeup_sta_to_xmit(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL; -+ u8 update_mask = 0, wmmps_ac = 0; -+ struct sta_info *psta_bmc; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ -+ -+ /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&psta->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ switch (pxmitframe->attrib.priority) { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk & BIT(1); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi & BIT(1); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo & BIT(1); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be & BIT(1); -+ break; -+ } -+ -+ psta->sleepq_len--; -+ if (psta->sleepq_len > 0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ if (wmmps_ac) { -+ psta->sleepq_ac_len--; -+ if (psta->sleepq_ac_len > 0) { -+ pxmitframe->attrib.mdata = 1; -+ pxmitframe->attrib.eosp = 0; -+ } else { -+ pxmitframe->attrib.mdata = 0; -+ pxmitframe->attrib.eosp = 1; -+ } -+ } -+ -+ pxmitframe->attrib.triggered = 1; -+ -+ /* -+ _exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ if(rtw_hal_xmit(padapter, pxmitframe) == _TRUE) -+ { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ } -+ _enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ */ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ -+ } -+ -+ if (psta->sleepq_len == 0) { -+#ifdef CONFIG_TDLS -+ if (psta->tdls_sta_state & TDLS_LINKED_STATE) { -+ if (psta->state & WIFI_SLEEP_STATE) -+ psta->state ^= WIFI_SLEEP_STATE; -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ return; -+ } -+#endif /* CONFIG_TDLS */ -+ -+ if (pstapriv->tim_bitmap & BIT(psta->aid)) { -+ /* RTW_INFO("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); */ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_mask = BIT(0); -+ } -+ -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ if (psta->state & WIFI_SLEEP_STATE) -+ psta->state ^= WIFI_SLEEP_STATE; -+ -+ if (psta->state & WIFI_STA_ALIVE_CHK_STATE) { -+ RTW_INFO("%s alive check\n", __func__); -+ psta->expire_to = pstapriv->expire_to; -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ } -+ -+ pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); -+ } -+ -+ /* for BC/MC Frames */ -+ if (!psta_bmc) -+ goto _exit; -+ -+ if ((pstapriv->sta_dz_bitmap & 0xfffe) == 0x0) { /* no any sta in ps mode */ -+ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ psta_bmc->sleepq_len--; -+ if (psta_bmc->sleepq_len > 0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ -+ pxmitframe->attrib.triggered = 1; -+ /* -+ _exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); -+ if(rtw_hal_xmit(padapter, pxmitframe) == _TRUE) -+ { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ } -+ _enter_critical_bh(&psta_bmc->sleep_q.lock, &irqL); -+ -+ */ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ } -+ -+ if (psta_bmc->sleepq_len == 0) { -+ if (pstapriv->tim_bitmap & BIT(0)) { -+ /* RTW_INFO("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); */ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_mask |= BIT(1); -+ } -+ pstapriv->tim_bitmap &= ~BIT(0); -+ pstapriv->sta_dz_bitmap &= ~BIT(0); -+ } -+ -+ } -+ -+_exit: -+ -+ /* _exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); */ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ if (update_mask) { -+ /* update_BCNTIM(padapter); */ -+ if ((update_mask & (BIT(0) | BIT(1))) == (BIT(0) | BIT(1))) -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "clear UC&BMC"); -+ else if ((update_mask & BIT(1)) == BIT(1)) -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "clear BMC"); -+ else -+ _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "clear UC"); -+ } -+ -+} -+ -+void xmit_delivery_enabled_frames(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL; -+ u8 wmmps_ac = 0; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ -+ /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&psta->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ switch (pxmitframe->attrib.priority) { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk & BIT(1); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi & BIT(1); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo & BIT(1); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be & BIT(1); -+ break; -+ } -+ -+ if (!wmmps_ac) -+ continue; -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ psta->sleepq_len--; -+ psta->sleepq_ac_len--; -+ -+ if (psta->sleepq_ac_len > 0) { -+ pxmitframe->attrib.mdata = 1; -+ pxmitframe->attrib.eosp = 0; -+ } else { -+ pxmitframe->attrib.mdata = 0; -+ pxmitframe->attrib.eosp = 1; -+ } -+ -+ pxmitframe->attrib.triggered = 1; -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ if ((psta->sleepq_ac_len == 0) && (!psta->has_legacy_ac) && (wmmps_ac)) { -+#ifdef CONFIG_TDLS -+ if (psta->tdls_sta_state & TDLS_LINKED_STATE) { -+ /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ goto exit; -+ } -+#endif /* CONFIG_TDLS */ -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ /* RTW_INFO("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); */ -+ /* upate BCN for TIM IE */ -+ /* update_BCNTIM(padapter); */ -+ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); -+ /* update_mask = BIT(0); */ -+ } -+ -+ } -+ -+exit: -+ /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ return; -+} -+ -+#endif /* defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) */ -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+void enqueue_pending_xmitbuf( -+ struct xmit_priv *pxmitpriv, -+ struct xmit_buf *pxmitbuf) -+{ -+ _irqL irql; -+ _queue *pqueue; -+ _adapter *pri_adapter = pxmitpriv->adapter; -+ -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ _enter_critical_bh(&pqueue->lock, &irql); -+ rtw_list_delete(&pxmitbuf->list); -+ rtw_list_insert_tail(&pxmitbuf->list, get_list_head(pqueue)); -+ _exit_critical_bh(&pqueue->lock, &irql); -+ -+#if defined(CONFIG_SDIO_HCI) && defined(CONFIG_CONCURRENT_MODE) -+ pri_adapter = GET_PRIMARY_ADAPTER(pri_adapter); -+#endif /*SDIO_HCI + CONCURRENT*/ -+ _rtw_up_sema(&(pri_adapter->xmitpriv.xmit_sema)); -+} -+ -+void enqueue_pending_xmitbuf_to_head( -+ struct xmit_priv *pxmitpriv, -+ struct xmit_buf *pxmitbuf) -+{ -+ _irqL irql; -+ _queue *pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ _enter_critical_bh(&pqueue->lock, &irql); -+ rtw_list_delete(&pxmitbuf->list); -+ rtw_list_insert_head(&pxmitbuf->list, get_list_head(pqueue)); -+ _exit_critical_bh(&pqueue->lock, &irql); -+} -+ -+struct xmit_buf *dequeue_pending_xmitbuf( -+ struct xmit_priv *pxmitpriv) -+{ -+ _irqL irql; -+ struct xmit_buf *pxmitbuf; -+ _queue *pqueue; -+ -+ -+ pxmitbuf = NULL; -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ _enter_critical_bh(&pqueue->lock, &irql); -+ -+ if (_rtw_queue_empty(pqueue) == _FALSE) { -+ _list *plist, *phead; -+ -+ phead = get_list_head(pqueue); -+ plist = get_next(phead); -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ rtw_list_delete(&pxmitbuf->list); -+ } -+ -+ _exit_critical_bh(&pqueue->lock, &irql); -+ -+ return pxmitbuf; -+} -+ -+static struct xmit_buf *dequeue_pending_xmitbuf_under_survey( -+ struct xmit_priv *pxmitpriv) -+{ -+ _irqL irql; -+ struct xmit_buf *pxmitbuf; -+#ifdef CONFIG_USB_HCI -+ struct xmit_frame *pxmitframe; -+#endif -+ _queue *pqueue; -+ -+ -+ pxmitbuf = NULL; -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ _enter_critical_bh(&pqueue->lock, &irql); -+ -+ if (_rtw_queue_empty(pqueue) == _FALSE) { -+ _list *plist, *phead; -+ u8 type; -+ -+ phead = get_list_head(pqueue); -+ plist = phead; -+ do { -+ plist = get_next(plist); -+ if (plist == phead) -+ break; -+ -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ -+#ifdef CONFIG_USB_HCI -+ pxmitframe = (struct xmit_frame *)pxmitbuf->priv_data; -+ if (pxmitframe) -+ type = GetFrameSubType(pxmitbuf->pbuf + TXDESC_SIZE + pxmitframe->pkt_offset * PACKET_OFFSET_SZ); -+ else -+ RTW_INFO("%s, !!!ERROR!!! For USB, TODO ITEM\n", __FUNCTION__); -+#else -+ type = GetFrameSubType(pxmitbuf->pbuf + TXDESC_OFFSET); -+#endif -+ -+ if ((type == WIFI_PROBEREQ) || -+ (type == WIFI_DATA_NULL) || -+ (type == WIFI_QOS_DATA_NULL)) { -+ rtw_list_delete(&pxmitbuf->list); -+ break; -+ } -+ pxmitbuf = NULL; -+ } while (1); -+ } -+ -+ _exit_critical_bh(&pqueue->lock, &irql); -+ -+ return pxmitbuf; -+} -+ -+static struct xmit_buf *dequeue_pending_xmitbuf_ext( -+ struct xmit_priv *pxmitpriv) -+{ -+ _irqL irql; -+ struct xmit_buf *pxmitbuf; -+ _queue *pqueue; -+ -+ pxmitbuf = NULL; -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ _enter_critical_bh(&pqueue->lock, &irql); -+ -+ if (_rtw_queue_empty(pqueue) == _FALSE) { -+ _list *plist, *phead; -+ u8 type; -+ -+ phead = get_list_head(pqueue); -+ plist = phead; -+ do { -+ plist = get_next(plist); -+ if (plist == phead) -+ break; -+ -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ -+ if (pxmitbuf->buf_tag == XMITBUF_MGNT) { -+ rtw_list_delete(&pxmitbuf->list); -+ break; -+ } -+ pxmitbuf = NULL; -+ } while (1); -+ } -+ -+ _exit_critical_bh(&pqueue->lock, &irql); -+ -+ return pxmitbuf; -+} -+ -+struct xmit_buf *select_and_dequeue_pending_xmitbuf(_adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_buf *pxmitbuf = NULL; -+ -+ if (rtw_xmit_ac_blocked(padapter) == _TRUE) -+ pxmitbuf = dequeue_pending_xmitbuf_under_survey(pxmitpriv); -+ else { -+ pxmitbuf = dequeue_pending_xmitbuf_ext(pxmitpriv); -+ if (pxmitbuf == NULL) -+ pxmitbuf = dequeue_pending_xmitbuf(pxmitpriv); -+ } -+ -+ return pxmitbuf; -+} -+ -+sint check_pending_xmitbuf( -+ struct xmit_priv *pxmitpriv) -+{ -+ _irqL irql; -+ _queue *pqueue; -+ sint ret = _FALSE; -+ -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ _enter_critical_bh(&pqueue->lock, &irql); -+ -+ if (_rtw_queue_empty(pqueue) == _FALSE) -+ ret = _TRUE; -+ -+ _exit_critical_bh(&pqueue->lock, &irql); -+ -+ return ret; -+} -+ -+thread_return rtw_xmit_thread(thread_context context) -+{ -+ s32 err; -+ PADAPTER padapter; -+ -+ -+ err = _SUCCESS; -+ padapter = (PADAPTER)context; -+ -+ thread_enter("RTW_XMIT_THREAD"); -+ padapter->xmitpriv.stop_req = 0; -+ -+ do { -+ err = rtw_hal_xmit_thread_handler(padapter); -+ flush_signals_thread(); -+ } while (_SUCCESS == err); -+ -+ /*_rtw_up_sema(&padapter->xmitpriv.terminate_xmitthread_sema);*/ -+ thread_exit(&padapter->xmitpriv.xmitthread_comp); -+ return 0; -+} -+#endif -+ -+bool rtw_xmit_ac_blocked(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface; -+ struct mlme_ext_priv *mlmeext; -+ struct mlme_ext_info *mlmeextinfo; -+ bool blocked = _FALSE; -+ int i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlmeext = &iface->mlmeextpriv; -+ -+ /* check scan state */ -+ if (mlmeext_scan_state(mlmeext) != SCAN_DISABLE -+ && mlmeext_scan_state(mlmeext) != SCAN_BACK_OP -+ ) { -+ blocked = _TRUE; -+ goto exit; -+ } -+ -+ if (mlmeext_scan_state(mlmeext) == SCAN_BACK_OP -+ && !mlmeext_chk_scan_backop_flags(mlmeext, SS_BACKOP_TX_RESUME) -+ ) { -+ blocked = _TRUE; -+ goto exit; -+ } -+ } -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(adapter)) { -+ if (rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) { -+ if (MCC_STOP(adapter)) { -+ blocked = _TRUE; -+ goto exit; -+ } -+ } -+ } -+#endif /* CONFIG_MCC_MODE */ -+ -+exit: -+ return blocked; -+} -+ -+void rtw_sctx_init(struct submit_ctx *sctx, int timeout_ms) -+{ -+ sctx->timeout_ms = timeout_ms; -+ sctx->submit_time = rtw_get_current_time(); -+#ifdef PLATFORM_LINUX /* TODO: add condition wating interface for other os */ -+ init_completion(&sctx->done); -+#endif -+ sctx->status = RTW_SCTX_SUBMITTED; -+} -+ -+int rtw_sctx_wait(struct submit_ctx *sctx, const char *msg) -+{ -+ int ret = _FAIL; -+ unsigned long expire; -+ int status = 0; -+ -+#ifdef PLATFORM_LINUX -+ expire = sctx->timeout_ms ? msecs_to_jiffies(sctx->timeout_ms) : MAX_SCHEDULE_TIMEOUT; -+ if (!wait_for_completion_timeout(&sctx->done, expire)) { -+ /* timeout, do something?? */ -+ status = RTW_SCTX_DONE_TIMEOUT; -+ RTW_INFO("%s timeout: %s\n", __func__, msg); -+ } else -+ status = sctx->status; -+#endif -+ -+ if (status == RTW_SCTX_DONE_SUCCESS) -+ ret = _SUCCESS; -+ -+ return ret; -+} -+ -+bool rtw_sctx_chk_waring_status(int status) -+{ -+ switch (status) { -+ case RTW_SCTX_DONE_UNKNOWN: -+ case RTW_SCTX_DONE_BUF_ALLOC: -+ case RTW_SCTX_DONE_BUF_FREE: -+ -+ case RTW_SCTX_DONE_DRV_STOP: -+ case RTW_SCTX_DONE_DEV_REMOVE: -+ return _TRUE; -+ default: -+ return _FALSE; -+ } -+} -+ -+void rtw_sctx_done_err(struct submit_ctx **sctx, int status) -+{ -+ if (*sctx) { -+ if (rtw_sctx_chk_waring_status(status)) -+ RTW_INFO("%s status:%d\n", __func__, status); -+ (*sctx)->status = status; -+#ifdef PLATFORM_LINUX -+ complete(&((*sctx)->done)); -+#endif -+ *sctx = NULL; -+ } -+} -+ -+void rtw_sctx_done(struct submit_ctx **sctx) -+{ -+ rtw_sctx_done_err(sctx, RTW_SCTX_DONE_SUCCESS); -+} -+ -+#ifdef CONFIG_XMIT_ACK -+int rtw_ack_tx_wait(struct xmit_priv *pxmitpriv, u32 timeout_ms) -+{ -+ struct submit_ctx *pack_tx_ops = &pxmitpriv->ack_tx_ops; -+ -+ pack_tx_ops->submit_time = rtw_get_current_time(); -+ pack_tx_ops->timeout_ms = timeout_ms; -+ pack_tx_ops->status = RTW_SCTX_SUBMITTED; -+ -+ return rtw_sctx_wait(pack_tx_ops, __func__); -+} -+ -+void rtw_ack_tx_done(struct xmit_priv *pxmitpriv, int status) -+{ -+ struct submit_ctx *pack_tx_ops = &pxmitpriv->ack_tx_ops; -+ -+ if (pxmitpriv->ack_tx) -+ rtw_sctx_done_err(&pack_tx_ops, status); -+ else -+ RTW_INFO("%s ack_tx not set\n", __func__); -+} -+#endif /* CONFIG_XMIT_ACK */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.c 2018-02-11 21:44:27.143146025 +0200 -@@ -0,0 +1,1987 @@ -+//============================================================ -+// Description: -+// -+// This file is for 92CE/92CU BT 1 Antenna Co-exist mechanism -+// -+// By cosa 02/11/2011 -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8188c2Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8188C_2ANT GLCoexDm8188c2Ant; -+static PCOEX_DM_8188C_2ANT pCoexDm=&GLCoexDm8188c2Ant; -+static COEX_STA_8188C_2ANT GLCoexSta8188c2Ant; -+static PCOEX_STA_8188C_2ANT pCoexSta=&GLCoexSta8188c2Ant; -+ -+//============================================================ -+// local function start with btdm_ -+//============================================================ -+u1Byte -+halbtc8188c2ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+u1Byte -+halbtc8188c2ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ u1Byte algorithm=BT_8188C_2ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ if(!pStackInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pStackInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(pStackInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO algorithm\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(numOfDiffProfile == 1) -+ { -+ if(pStackInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_HID; -+ } -+ else if(pStackInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_A2DP; -+ } -+ else if(pStackInfo->bPanExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN only\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_PAN; -+ } -+ } -+ else -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_HID_PAN; -+ } -+ else if( pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN + A2DP\n")); -+ algorithm = BT_8188C_2ANT_COEX_ALGO_PAN_A2DP; -+ } -+ } -+ } -+ return algorithm; -+} -+ -+VOID -+halbtc8188c2ant_SetFwBalance( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBalanceOn, -+ IN u1Byte ms0, -+ IN u1Byte ms1 -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ -+ if(bBalanceOn) -+ { -+ H2C_Parameter[2] = 1; -+ H2C_Parameter[1] = ms1; -+ H2C_Parameter[0] = ms0; -+ } -+ else -+ { -+ H2C_Parameter[2] = 0; -+ H2C_Parameter[1] = 0; -+ H2C_Parameter[0] = 0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Balance=[%s:%dms:%dms], write 0xc=0x%x\n", -+ bBalanceOn?"ON":"OFF", ms0, ms1, -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0xc, 3, H2C_Parameter); -+} -+ -+VOID -+halbtc8188c2ant_Balance( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bBalanceOn, -+ IN u1Byte ms0, -+ IN u1Byte ms1 -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Balance %s\n", -+ (bForceExec? "force to":""), (bBalanceOn? "ON":"OFF"))); -+ pCoexDm->bCurBalanceOn = bBalanceOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBalanceOn == pCoexDm->bCurBalanceOn) -+ return; -+ } -+ halbtc8188c2ant_SetFwBalance(pBtCoexist, bBalanceOn, ms0, ms1); -+ -+ pCoexDm->bPreBalanceOn = pCoexDm->bCurBalanceOn; -+} -+ -+VOID -+halbtc8188c2ant_SetFwDiminishWifi( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bDacOn, -+ IN BOOLEAN bInterruptOn, -+ IN u1Byte fwDacSwingLvl, -+ IN BOOLEAN bNavOn -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ -+ if((pBtCoexist->stackInfo.minBtRssi <= -5) && (fwDacSwingLvl == 0x20)) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], DiminishWiFi 0x20 original, but set 0x18 for Low RSSI!\n")); -+ fwDacSwingLvl = 0x18; -+ } -+ -+ H2C_Parameter[2] = 0; -+ H2C_Parameter[1] = fwDacSwingLvl; -+ H2C_Parameter[0] = 0; -+ if(bDacOn) -+ { -+ H2C_Parameter[2] |= 0x01; //BIT0 -+ if(bInterruptOn) -+ { -+ H2C_Parameter[2] |= 0x02; //BIT1 -+ } -+ } -+ if(bNavOn) -+ { -+ H2C_Parameter[2] |= 0x08; //BIT3 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bDacOn=%s, bInterruptOn=%s, bNavOn=%s, write 0xe=0x%x\n", -+ (bDacOn?"ON":"OFF"), (bInterruptOn?"ON":"OFF"), (bNavOn?"ON":"OFF"), -+ (H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2]))); -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0xe, 3, H2C_Parameter); -+} -+ -+VOID -+halbtc8188c2ant_DiminishWifi( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacOn, -+ IN BOOLEAN bInterruptOn, -+ IN u1Byte fwDacSwingLvl, -+ IN BOOLEAN bNavOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set Diminish Wifi, bDacOn=%s, bInterruptOn=%s, fwDacSwingLvl=%d, bNavOn=%s\n", -+ (bForceExec? "force to":""), (bDacOn? "ON":"OFF"), (bInterruptOn? "ON":"OFF"), fwDacSwingLvl, (bNavOn? "ON":"OFF"))); -+ -+ pCoexDm->bCurDacOn = bDacOn; -+ pCoexDm->bCurInterruptOn = bInterruptOn; -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ pCoexDm->bCurNavOn = bNavOn; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacOn==pCoexDm->bCurDacOn) && -+ (pCoexDm->bPreInterruptOn==pCoexDm->bCurInterruptOn) && -+ (pCoexDm->preFwDacSwingLvl==pCoexDm->curFwDacSwingLvl) && -+ (pCoexDm->bPreNavOn==pCoexDm->bCurNavOn) ) -+ return; -+ } -+ halbtc8188c2ant_SetFwDiminishWifi(pBtCoexist, bDacOn, bInterruptOn, fwDacSwingLvl, bNavOn); -+ -+ pCoexDm->bPreDacOn = pCoexDm->bCurDacOn; -+ pCoexDm->bPreInterruptOn = pCoexDm->bCurInterruptOn; -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+ pCoexDm->bPreNavOn = pCoexDm->bCurNavOn; -+} -+ -+VOID -+halbtc8188c2ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xf0, 0xf); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xf0, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+VOID -+halbtc8188c2ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8188c2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8188c2ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte tmpU1; -+ -+ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); -+ if(bLowPenaltyRa) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); -+ tmpU1 &= ~BIT2; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); -+ tmpU1 |= BIT2; -+ } -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -+} -+ -+VOID -+halbtc8188c2ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8188c2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8188c2ant_SetSwFullTimeDacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwDacSwingOn, -+ IN u4Byte swDacSwingLvl -+ ) -+{ -+ u4Byte dacSwingLvl; -+ -+ if(bSwDacSwingOn) -+ { -+ if((pBtCoexist->stackInfo.minBtRssi <= -5) && (swDacSwingLvl == 0x20)) -+ { -+ dacSwingLvl = 0x18; -+ } -+ else -+ { -+ dacSwingLvl = swDacSwingLvl; -+ } -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, dacSwingLvl); -+ } -+ else -+ { -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, 0x30); -+ } -+} -+ -+VOID -+halbtc8188c2ant_DacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacSwingOn, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", -+ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) -+ return; -+ } -+ delay_ms(30); -+ halbtc8188c2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+VOID -+halbtc8188c2ant_SetAdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ if(bAdcBackOff) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a07611); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a05611); -+ } -+} -+ -+VOID -+halbtc8188c2ant_AdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", -+ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); -+ pCoexDm->bCurAdcBackOff = bAdcBackOff; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) -+ return; -+ } -+ halbtc8188c2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); -+ -+ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -+} -+ -+VOID -+halbtc8188c2ant_SetAgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ u1Byte rssiAdjustVal=0; -+ -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4e1c0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4d1d0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4c1e0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4b1f0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4a200001); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xdc000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x90000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x51000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x12000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x00255); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x641c0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x631d0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x621e0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x611f0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x60200001); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x32000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x71000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xb0000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xfc000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x10255); -+ } -+ -+ // set rssiAdjustVal for wifi module. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+} -+ -+ -+VOID -+halbtc8188c2ant_AgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", -+ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8188c2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+VOID -+halbtc8188c2ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u4Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8188c2ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u4Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c4, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8188c2ant_SetCoexTable(pBtCoexist, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8188c2ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw mechanism -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+} -+VOID -+halbtc8188c2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+ -+VOID -+halbtc8188c2ant_MonitorBtState( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN stateChange=FALSE; -+ u4Byte BT_Polling, Ratio_Act, Ratio_STA; -+ u4Byte BT_Active, BT_State; -+ u4Byte regBTActive=0, regBTState=0, regBTPolling=0; -+ u4Byte btBusyThresh=0; -+ u4Byte fwVer=0; -+ static BOOLEAN bBtBusyTraffic=FALSE; -+ BOOLEAN bRejApAggPkt=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FirmwareVersion = 0x%x(%d)\n", fwVer, fwVer)); -+ if(fwVer < 62) -+ { -+ regBTActive = 0x488; -+ regBTState = 0x48c; -+ regBTPolling = 0x490; -+ } -+ else -+ { -+ regBTActive = 0x444; -+ regBTState = 0x448; -+ if(fwVer >= 74) -+ regBTPolling = 0x44c; -+ else -+ regBTPolling = 0x700; -+ } -+ btBusyThresh = 60; -+ -+ BT_Active = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTActive); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Active(0x%x)=0x%x\n", regBTActive, BT_Active)); -+ BT_Active = BT_Active & 0x00ffffff; -+ -+ BT_State = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTState); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_State(0x%x)=0x%x\n", regBTState, BT_State)); -+ BT_State = BT_State & 0x00ffffff; -+ -+ BT_Polling = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTPolling); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Polling(0x%x)=0x%x\n", regBTPolling, BT_Polling)); -+ -+ if(BT_Active==0xffffffff && BT_State==0xffffffff && BT_Polling==0xffffffff ) -+ return; -+ -+ // 2011/05/04 MH For Slim combo test meet a problem. Surprise remove and WLAN is running -+ // DHCP process. At the same time, the register read value might be zero. And cause BSOD 0x7f -+ // EXCEPTION_DIVIDED_BY_ZERO. In This case, the stack content may always be wrong due to -+ // HW divide trap. -+ if (BT_Polling==0) -+ return; -+ -+ Ratio_Act = BT_Active*1000/BT_Polling; -+ Ratio_STA = BT_State*1000/BT_Polling; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_Act=%d\n", Ratio_Act)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_STA=%d\n", Ratio_STA)); -+ -+ if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ if(Ratio_STA < 60) // BT PAN idle -+ { -+ } -+ else -+ { -+ // Check if BT PAN (under BT 2.1) is uplink or downlink -+ if((Ratio_Act/Ratio_STA) < 2) -+ { // BT PAN Uplink -+ pCoexSta->bBtUplink = TRUE; -+ } -+ else -+ { // BT PAN downlink -+ pCoexSta->bBtUplink = FALSE; -+ } -+ } -+ } -+ -+ // Check BT is idle or not -+ if(!pBtCoexist->stackInfo.bBtLinkExist) -+ { -+ pCoexSta->bBtBusy = FALSE; -+ } -+ else -+ { -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ if(Ratio_Act<20) -+ { -+ pCoexSta->bBtBusy = FALSE; -+ } -+ else -+ { -+ pCoexSta->bBtBusy = TRUE; -+ } -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ if(Ratio_STA < btBusyThresh) -+ { -+ pCoexSta->bBtBusy = FALSE; -+ } -+ else -+ { -+ pCoexSta->bBtBusy = TRUE; -+ } -+ -+ if( (Ratio_STA < btBusyThresh) || -+ (Ratio_Act<180 && Ratio_STA<130) ) -+ { -+ pCoexSta->bA2dpBusy = FALSE; -+ } -+ else -+ { -+ pCoexSta->bA2dpBusy = TRUE; -+ } -+ } -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &pCoexSta->bBtBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &pCoexSta->bBtBusy); -+ -+ if(bBtBusyTraffic != pCoexSta->bBtBusy) -+ { // BT idle or BT non-idle -+ bBtBusyTraffic = pCoexSta->bBtBusy; -+ stateChange = TRUE; -+ } -+ -+ if(stateChange) -+ { -+ if(!pCoexSta->bBtBusy) -+ { -+ halbtc8188c2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ } -+ else -+ { -+ halbtc8188c2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ } -+ -+ if(stateChange) -+ { -+ bRejApAggPkt = pCoexSta->bBtBusy; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejApAggPkt); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionA2dpBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw, wifiTrafficDir; -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ -+ if(pCoexSta->bBtBusy) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism first -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ } -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionA2dpBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw, wifiTrafficDir; -+ BOOLEAN bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ if(pCoexSta->bA2dpBusy && bWifiBusy) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ -+ // fw mechanism first -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x18); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ } -+ else if(pCoexSta->bA2dpBusy) -+ { -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, TRUE, 0x18, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionA2dpBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionA2dpBc8(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionPanBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ if(bBtHsOn) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ else -+ { -+ if(pCoexSta->bBtBusy && bWifiBusy) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ } -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+} -+ -+VOID -+halbtc8188c2ant_ActionPanBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ u4Byte wifiBw, wifiTrafficDir; -+ s4Byte wifiRssi; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(bBtHsOn) -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ else -+ { -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 3, 25, 50); -+ -+ if(pCoexSta->bBtBusy && bWifiBusy) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ // fw mechanism first -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ } -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ } -+ else if( (wifiRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_MEDIUM) ) -+ { -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); -+ -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); -+ else -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ // sw mechanism -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); -+ -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ if(pCoexSta->bBtUplink) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); -+ } -+ else -+ { -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ } -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else if(pCoexSta->bBtBusy && !bWifiBusy && (wifiRssi < 30)) -+ { -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x0a, 0x20); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionPan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionPanBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionPanBc8(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte wifiBw, wifiTrafficDir; -+ BOOLEAN bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ if(BTC_WIFI_BW_LEGACY == wifiBw) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else if(!bWifiBusy) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+} -+ -+ -+VOID -+halbtc8188c2ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw; -+ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ -+ // fw mechanism -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionHidA2dpBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw, wifiTrafficDir; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ -+ if(pCoexSta->bBtBusy) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism first -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x7, 0x20); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ } -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else -+ { -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ // fw mechanism first -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x7, 0x20); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+} -+VOID -+halbtc8188c2ant_ActionHidA2dpBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw; -+ -+ if(pCoexSta->bBtBusy) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism first -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else -+ { -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ // fw mechanism -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionHidA2dpBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionHidA2dpBc8(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionHidPanBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u4Byte wifiBw, wifiTrafficDir; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(bBtHsOn) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ if(BTC_WIFI_BW_LEGACY == wifiBw) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(!bWifiBusy) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ } -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+} -+VOID -+halbtc8188c2ant_ActionHidPanBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ u4Byte wifiBw, wifiTrafficDir; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!bBtHsOn) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); -+ if((pCoexSta->bBtBusy && bWifiBusy)) -+ { -+ // fw mechanism first -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); -+ } -+ else -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); -+ } -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+ else -+ { -+ if(BTC_INTF_USB == pBtCoexist->chipInterface) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ } -+ else -+ { -+ if(pCoexSta->bBtBusy) -+ { -+ // fw mechanism -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionHidPan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionHidPanBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionHidPanBc8(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionPanA2dpBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ if(bBtHsOn) -+ { -+ if(pCoexSta->bBtBusy) -+ { -+ // fw mechanism -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ if(pCoexSta->bBtBusy && bWifiBusy) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+} -+VOID -+halbtc8188c2ant_ActionPanA2dpBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!bBtHsOn) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); -+ if((pCoexSta->bBtBusy && bWifiBusy)) -+ { -+ // fw mechanism first -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); -+ } -+ else -+ { -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); -+ } -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+ else -+ { -+ if(pCoexSta->bBtBusy) -+ { -+ // fw mechanism -+ halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+} -+ -+VOID -+halbtc8188c2ant_ActionPanA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionPanA2dpBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8188c2ant_ActionPanA2dpBc8(pBtCoexist); -+ } -+} -+ -+//============================================================ -+// extern function start with EXhalbtc8188c2ant_ -+//============================================================ -+VOID -+EXhalbtc8188c2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8188c2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ u1Byte u1Tmp=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xf0); -+ -+ if( (BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) || -+ (BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ) -+ { -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd) & BIT0; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, u1Tmp); -+ -+ halbtc8188c2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0xaaaa9aaa, 0xffbd0040, 0x40000010); -+ } -+} -+ -+VOID -+EXhalbtc8188c2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8188c2ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8188c2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pStackInfo->bProfileNotified) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ -+ u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8188c2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ //halbtc8188c2ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8188c2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ halbtc8188c2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ halbtc8188c2ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8188c2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8188c2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8188c2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+ -+} -+ -+VOID -+EXhalbtc8188c2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8188c2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8188c2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ EXhalbtc8188c2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8188c2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte algorithm; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Periodical!!\n")); -+ -+ // NOTE: -+ // sw mechanism must be done after fw mechanism -+ // -+ -+ if((BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) || -+ (BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_GET_BT_RSSI, NULL); -+ -+ halbtc8188c2ant_MonitorBtState(pBtCoexist); -+ algorithm = halbtc8188c2ant_ActionAlgorithm(pBtCoexist); -+ pCoexDm->curAlgorithm = algorithm; -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8188C_2ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO\n")); -+ halbtc8188c2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8188C_2ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID\n")); -+ halbtc8188c2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8188C_2ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP\n")); -+ halbtc8188c2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8188C_2ANT_COEX_ALGO_PAN: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN\n")); -+ halbtc8188c2ant_ActionPan(pBtCoexist); -+ break; -+ case BT_8188C_2ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP\n")); -+ halbtc8188c2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ case BT_8188C_2ANT_COEX_ALGO_HID_PAN: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+HID\n")); -+ halbtc8188c2ant_ActionHidPan(pBtCoexist); -+ break; -+ case BT_8188C_2ANT_COEX_ALGO_PAN_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP\n")); -+ halbtc8188c2ant_ActionPanA2dp(pBtCoexist); -+ break; -+ default: -+ break; -+ } -+ } -+} -+ -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8188c2Ant.h 2018-02-11 21:44:27.143146025 +0200 -@@ -0,0 +1,149 @@ -+//=========================================== -+// The following is for 8188C 2Ant BT Co-exist definition -+//=========================================== -+#define BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT 6 -+ -+typedef enum _BT_INFO_SRC_8188C_2ANT{ -+ BT_INFO_SRC_8188C_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8188C_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8188C_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8188C_2ANT_MAX -+}BT_INFO_SRC_8188C_2ANT,*PBT_INFO_SRC_8188C_2ANT; -+ -+typedef enum _BT_8188C_2ANT_BT_STATUS{ -+ BT_8188C_2ANT_BT_STATUS_IDLE = 0x0, -+ BT_8188C_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8188C_2ANT_BT_STATUS_NON_IDLE = 0x2, -+ BT_8188C_2ANT_BT_STATUS_MAX -+}BT_8188C_2ANT_BT_STATUS,*PBT_8188C_2ANT_BT_STATUS; -+ -+typedef enum _BT_8188C_2ANT_COEX_ALGO{ -+ BT_8188C_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8188C_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8188C_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8188C_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8188C_2ANT_COEX_ALGO_PAN = 0x4, -+ BT_8188C_2ANT_COEX_ALGO_HID_A2DP = 0x5, -+ BT_8188C_2ANT_COEX_ALGO_HID_PAN = 0x6, -+ BT_8188C_2ANT_COEX_ALGO_PAN_A2DP = 0x7, -+ BT_8188C_2ANT_COEX_ALGO_MAX -+}BT_8188C_2ANT_COEX_ALGO,*PBT_8188C_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8188C_2ANT{ -+ // fw mechanism -+ BOOLEAN bPreBalanceOn; -+ BOOLEAN bCurBalanceOn; -+ -+ // diminishWifi -+ BOOLEAN bPreDacOn; -+ BOOLEAN bCurDacOn; -+ BOOLEAN bPreInterruptOn; -+ BOOLEAN bCurInterruptOn; -+ u1Byte preFwDacSwingLvl; -+ u1Byte curFwDacSwingLvl; -+ BOOLEAN bPreNavOn; -+ BOOLEAN bCurNavOn; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ BOOLEAN bPreDacSwingOn; -+ u4Byte preDacSwingLvl; -+ BOOLEAN bCurDacSwingOn; -+ u4Byte curDacSwingLvl; -+ BOOLEAN bPreAdcBackOff; -+ BOOLEAN bCurAdcBackOff; -+ BOOLEAN bPreAgcTableEn; -+ BOOLEAN bCurAgcTableEn; -+ //u4Byte preVal0x6c0; -+ //u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u4Byte preVal0x6cc; -+ u4Byte curVal0x6cc; -+ //BOOLEAN bLimitedDig; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ //u1Byte btStatus; -+ //u1Byte wifiChnlInfo[3]; -+} COEX_DM_8188C_2ANT, *PCOEX_DM_8188C_2ANT; -+ -+typedef struct _COEX_STA_8188C_2ANT{ -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bBtBusy; -+ BOOLEAN bBtUplink; -+ BOOLEAN bBtDownLink; -+ BOOLEAN bA2dpBusy; -+}COEX_STA_8188C_2ANT, *PCOEX_STA_8188C_2ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8188c2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8188c2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8188c2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8188c2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8188c2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8188c2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8188c2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8188c2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8188c2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8188c2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8188c2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8188c2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8188c2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.c 2018-02-11 21:44:27.143146025 +0200 -@@ -0,0 +1,1992 @@ -+//============================================================ -+// Description: -+// -+// This file is for 92D BT 2 Antenna Co-exist mechanism -+// -+// By cosa 02/11/2011 -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8192d2Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8192D_2ANT GLCoexDm8192d2Ant; -+static PCOEX_DM_8192D_2ANT pCoexDm=&GLCoexDm8192d2Ant; -+static COEX_STA_8192D_2ANT GLCoexSta8192d2Ant; -+static PCOEX_STA_8192D_2ANT pCoexSta=&GLCoexSta8192d2Ant; -+ -+//============================================================ -+// local function start with btdm_ -+//============================================================ -+u1Byte -+halbtc8192d2ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+u1Byte -+halbtc8192d2ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ BOOLEAN bBtHsOn=FALSE; -+ u1Byte algorithm=BT_8192D_2ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!pStackInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pStackInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(pStackInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO algorithm\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(numOfDiffProfile == 1) -+ { -+ if(pStackInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_HID; -+ } -+ else if(pStackInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_A2DP; -+ } -+ else if(pStackInfo->bPanExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN only\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_PAN; -+ } -+ } -+ else -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_HID_PAN; -+ } -+ else if( pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN + A2DP\n")); -+ algorithm = BT_8192D_2ANT_COEX_ALGO_PAN_A2DP; -+ } -+ } -+ } -+ return algorithm; -+} -+ -+VOID -+halbtc8192d2ant_SetFwBalance( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bBalanceOn, -+ IN u1Byte ms0, -+ IN u1Byte ms1 -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ -+ if(bBalanceOn) -+ { -+ H2C_Parameter[2] = 1; -+ H2C_Parameter[1] = ms1; -+ H2C_Parameter[0] = ms0; -+ } -+ else -+ { -+ H2C_Parameter[2] = 0; -+ H2C_Parameter[1] = 0; -+ H2C_Parameter[0] = 0; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Balance=[%s:%dms:%dms], write 0xc=0x%x\n", -+ bBalanceOn?"ON":"OFF", ms0, ms1, -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0xc, 3, H2C_Parameter); -+} -+ -+VOID -+halbtc8192d2ant_Balance( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bBalanceOn, -+ IN u1Byte ms0, -+ IN u1Byte ms1 -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Balance %s\n", -+ (bForceExec? "force to":""), (bBalanceOn? "ON":"OFF"))); -+ pCoexDm->bCurBalanceOn = bBalanceOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreBalanceOn == pCoexDm->bCurBalanceOn) -+ return; -+ } -+ halbtc8192d2ant_SetFwBalance(pBtCoexist, bBalanceOn, ms0, ms1); -+ -+ pCoexDm->bPreBalanceOn = pCoexDm->bCurBalanceOn; -+} -+ -+VOID -+halbtc8192d2ant_SetFwDiminishWifi( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bDacOn, -+ IN BOOLEAN bInterruptOn, -+ IN u1Byte fwDacSwingLvl, -+ IN BOOLEAN bNavOn -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ -+ if((pBtCoexist->stackInfo.minBtRssi <= -5) && (fwDacSwingLvl == 0x20)) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], DiminishWiFi 0x20 original, but set 0x18 for Low RSSI!\n")); -+ fwDacSwingLvl = 0x18; -+ } -+ -+ H2C_Parameter[2] = 0; -+ H2C_Parameter[1] = fwDacSwingLvl; -+ H2C_Parameter[0] = 0; -+ if(bDacOn) -+ { -+ H2C_Parameter[2] |= 0x01; //BIT0 -+ if(bInterruptOn) -+ { -+ H2C_Parameter[2] |= 0x02; //BIT1 -+ } -+ } -+ if(bNavOn) -+ { -+ H2C_Parameter[2] |= 0x08; //BIT3 -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bDacOn=%s, bInterruptOn=%s, bNavOn=%s, write 0x12=0x%x\n", -+ (bDacOn?"ON":"OFF"), (bInterruptOn?"ON":"OFF"), (bNavOn?"ON":"OFF"), -+ (H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2]))); -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x12, 3, H2C_Parameter); -+} -+ -+ -+VOID -+halbtc8192d2ant_DiminishWifi( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacOn, -+ IN BOOLEAN bInterruptOn, -+ IN u1Byte fwDacSwingLvl, -+ IN BOOLEAN bNavOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set Diminish Wifi, bDacOn=%s, bInterruptOn=%s, fwDacSwingLvl=%d, bNavOn=%s\n", -+ (bForceExec? "force to":""), (bDacOn? "ON":"OFF"), (bInterruptOn? "ON":"OFF"), fwDacSwingLvl, (bNavOn? "ON":"OFF"))); -+ -+ pCoexDm->bCurDacOn = bDacOn; -+ pCoexDm->bCurInterruptOn = bInterruptOn; -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ pCoexDm->bCurNavOn = bNavOn; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacOn==pCoexDm->bCurDacOn) && -+ (pCoexDm->bPreInterruptOn==pCoexDm->bCurInterruptOn) && -+ (pCoexDm->preFwDacSwingLvl==pCoexDm->curFwDacSwingLvl) && -+ (pCoexDm->bPreNavOn==pCoexDm->bCurNavOn) ) -+ return; -+ } -+ halbtc8192d2ant_SetFwDiminishWifi(pBtCoexist, bDacOn, bInterruptOn, fwDacSwingLvl, bNavOn); -+ -+ pCoexDm->bPreDacOn = pCoexDm->bCurDacOn; -+ pCoexDm->bPreInterruptOn = pCoexDm->bCurInterruptOn; -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+ pCoexDm->bPreNavOn = pCoexDm->bCurNavOn; -+} -+ -+VOID -+halbtc8192d2ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xf2ff7); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+ -+VOID -+halbtc8192d2ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8192d2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8192d2ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte tmpU1; -+ -+ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); -+ if(bLowPenaltyRa) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); -+ tmpU1 &= ~BIT2; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); -+ tmpU1 |= BIT2; -+ } -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -+} -+ -+VOID -+halbtc8192d2ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8192d2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8192d2ant_SetSwFullTimeDacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwDacSwingOn, -+ IN u4Byte swDacSwingLvl -+ ) -+{ -+ u4Byte dacSwingLvl; -+ -+ if(bSwDacSwingOn) -+ { -+ if((pBtCoexist->stackInfo.minBtRssi <= -5) && (swDacSwingLvl == 0x20)) -+ { -+ dacSwingLvl = 0x18; -+ } -+ else -+ { -+ dacSwingLvl = swDacSwingLvl; -+ } -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, dacSwingLvl); -+ } -+ else -+ { -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, 0x30); -+ } -+} -+ -+VOID -+halbtc8192d2ant_DacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacSwingOn, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", -+ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) -+ return; -+ } -+ delay_ms(30); -+ halbtc8192d2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+VOID -+halbtc8192d2ant_SetAdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ if(bAdcBackOff) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a07611); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a05611); -+ } -+} -+ -+VOID -+halbtc8192d2ant_AdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", -+ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); -+ pCoexDm->bCurAdcBackOff = bAdcBackOff; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) -+ return; -+ } -+ halbtc8192d2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); -+ -+ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -+} -+ -+VOID -+halbtc8192d2ant_SetAgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ u1Byte rssiAdjustVal=0; -+ -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0xa99); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xd4000); -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b000001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b010001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b020001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b030001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b040001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b050001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b060001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b070001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b080001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b090001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b0A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b0B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7a0C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x790D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x780E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x770F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x76100001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x75110001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x74120001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x73130001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x72140001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x71150001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x70160001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6f170001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6e180001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6d190001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6c1A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6b1B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6a1C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x691D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4f1E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4e1F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4d200001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4c210001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4b220001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4a230001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x49240001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x48250001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x47260001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x46270001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x45280001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x44290001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x432A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x422B0001); -+ -+ rssiAdjustVal = 12; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x30a99); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xdc000); -+ -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B000001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B010001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B020001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B030001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B040001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B050001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B060001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7A070001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x79080001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x78090001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x770A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x760B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x750C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x740D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x730E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x720F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x71100001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x70110001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6F120001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6E130001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6D140001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6C150001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6B160001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6A170001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x69180001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x68190001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x671A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x661B0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x651C0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x641D0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x631E0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x621F0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x61200001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x60210001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x49220001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x48230001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x47240001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x46250001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x45260001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x44270001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x43280001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x42290001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x412A0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x402B0001); -+ } -+ -+ // set rssiAdjustVal for wifi module. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+} -+ -+ -+ -+VOID -+halbtc8192d2ant_AgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", -+ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8192d2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+VOID -+halbtc8192d2ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u4Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8192d2ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c4, -+ IN u4Byte val0x6c8, -+ IN u4Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c4, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c4 = val0x6c4; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8192d2ant_SetCoexTable(pBtCoexist, val0x6c4, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8192d2ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw mechanism -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+} -+VOID -+halbtc8192d2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+halbtc8192d2ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte btActive -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtDisabled=FALSE, bForceToRoam=FALSE; -+ u4Byte u4Tmp=0; -+ -+ // This function check if bt is disabled -+ if(btActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ -+ bForceToRoam = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_FORCE_TO_ROAM, &bForceToRoam); -+ -+ bPreBtDisabled = bBtDisabled; -+ } -+} -+ -+VOID -+halbtc8192d2ant_MonitorBtState( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN stateChange=FALSE; -+ u4Byte BT_Polling, Ratio_Act, Ratio_STA; -+ u4Byte BT_Active, BT_State; -+ u4Byte regBTActive=0, regBTState=0, regBTPolling=0; -+ u4Byte btBusyThresh=0; -+ u4Byte fwVer=0; -+ static BOOLEAN bBtBusyTraffic=FALSE; -+ BOOLEAN bRejApAggPkt=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FirmwareVersion = 0x%x(%d)\n", fwVer, fwVer)); -+ -+ regBTActive = 0x444; -+ regBTState = 0x448; -+ regBTPolling = 0x44c; -+ -+ btBusyThresh = 40; -+ -+ BT_Active = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTActive); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Active(0x%x)=0x%x\n", regBTActive, BT_Active)); -+ BT_Active = BT_Active & 0x00ffffff; -+ -+ BT_State = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTState); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_State(0x%x)=0x%x\n", regBTState, BT_State)); -+ BT_State = BT_State & 0x00ffffff; -+ -+ BT_Polling = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTPolling); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Polling(0x%x)=0x%x\n", regBTPolling, BT_Polling)); -+ -+ if(BT_Active==0xffffffff && BT_State==0xffffffff && BT_Polling==0xffffffff ) -+ return; -+ -+ // 2011/05/04 MH For Slim combo test meet a problem. Surprise remove and WLAN is running -+ // DHCP process. At the same time, the register read value might be zero. And cause BSOD 0x7f -+ // EXCEPTION_DIVIDED_BY_ZERO. In This case, the stack content may always be wrong due to -+ // HW divide trap. -+ if (BT_Polling==0) -+ return; -+ -+ halbtc8192d2ant_MonitorBtEnableDisable(pBtCoexist, BT_Active); -+ -+ Ratio_Act = BT_Active*1000/BT_Polling; -+ Ratio_STA = BT_State*1000/BT_Polling; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_Act=%d\n", Ratio_Act)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_STA=%d\n", Ratio_STA)); -+ -+ if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ if(Ratio_STA < 60) // BT PAN idle -+ { -+ } -+ else -+ { -+ // Check if BT PAN (under BT 2.1) is uplink or downlink -+ if((Ratio_Act/Ratio_STA) < 2) -+ { // BT PAN Uplink -+ pCoexSta->bBtUplink = TRUE; -+ } -+ else -+ { // BT PAN downlink -+ pCoexSta->bBtUplink = FALSE; -+ } -+ } -+ } -+ -+ // Check BT is idle or not -+ if(!pBtCoexist->stackInfo.bBtLinkExist) -+ { -+ pCoexSta->bBtBusy = FALSE; -+ } -+ else -+ { -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ if(Ratio_Act<20) -+ { -+ pCoexSta->bBtBusy = FALSE; -+ } -+ else -+ { -+ pCoexSta->bBtBusy = TRUE; -+ } -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ if(Ratio_STA < btBusyThresh) -+ { -+ pCoexSta->bBtBusy = FALSE; -+ } -+ else -+ { -+ pCoexSta->bBtBusy = TRUE; -+ } -+ -+ if( (Ratio_STA < btBusyThresh) || -+ (Ratio_Act<180 && Ratio_STA<130) ) -+ { -+ pCoexSta->bA2dpBusy = FALSE; -+ } -+ else -+ { -+ pCoexSta->bA2dpBusy = TRUE; -+ } -+ } -+ } -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &pCoexSta->bBtBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &pCoexSta->bBtBusy); -+ -+ if(bBtBusyTraffic != pCoexSta->bBtBusy) -+ { // BT idle or BT non-idle -+ bBtBusyTraffic = pCoexSta->bBtBusy; -+ stateChange = TRUE; -+ } -+ -+ if(stateChange) -+ { -+ if(!pCoexSta->bBtBusy) -+ { -+ halbtc8192d2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ } -+ else -+ { -+ halbtc8192d2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ } -+ -+ if(stateChange) -+ { -+ bRejApAggPkt = pCoexSta->bBtBusy; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejApAggPkt); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ } -+} -+ -+VOID -+halbtc8192d2ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiBw, wifiTrafficDir; -+ BOOLEAN bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ if(pCoexSta->bA2dpBusy && bWifiBusy) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ } -+ else -+ { -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 25, 0); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 40, 0); -+ } -+ } -+ -+ // fw mechanism first -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x18); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ } -+ else if(pCoexSta->bA2dpBusy) -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, TRUE, 0x18, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8192d2ant_ActionPan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState, wifiRssiState1; -+ u4Byte wifiBw, wifiTrafficDir; -+ s4Byte wifiRssi; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(bBtHsOn) -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ else -+ { -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 3, 25, 50); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ } -+ else -+ { -+ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 25, 0); -+ } -+ -+ if(pCoexSta->bBtBusy && bWifiBusy) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ // fw mechanism first -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ } -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ } -+ else if( (wifiRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_MEDIUM) ) -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); -+ -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); -+ else -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); -+ -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ if(pCoexSta->bBtUplink) -+ { -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); -+ } -+ else -+ { -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ } -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else if(pCoexSta->bBtBusy && -+ !bWifiBusy && -+ (wifiRssi < 30)) -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x0a, 0x20); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+} -+ -+ -+VOID -+halbtc8192d2ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; -+ u4Byte wifiTrafficDir; -+ BOOLEAN bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 45, 0); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 20, 0); -+ } -+ -+ if(pCoexSta->bBtBusy && bWifiBusy) -+ { -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ // fw mechanism first -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, TRUE, 0x18, FALSE); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x15); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x30, FALSE); -+ } -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+} -+ -+ -+ -+VOID -+halbtc8192d2ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+} -+ -+VOID -+halbtc8192d2ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1; -+ u4Byte wifiBw; -+ -+ if(pCoexSta->bBtBusy) -+ { -+ wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 35, 0); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ // fw mechanism first -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else -+ { -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ // fw mechanism -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else -+ { -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+} -+ -+ -+VOID -+halbtc8192d2ant_ActionHidPanBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u4Byte wifiBw, wifiTrafficDir; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(bBtHsOn) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ if(BTC_WIFI_BW_LEGACY == wifiBw) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else if(!bWifiBusy) -+ { -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ } -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+} -+VOID -+halbtc8192d2ant_ActionHidPanBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ u4Byte wifiBw, wifiTrafficDir; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!bBtHsOn) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); -+ if((pCoexSta->bBtBusy && bWifiBusy)) -+ { -+ // fw mechanism first -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); -+ } -+ else -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); -+ } -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+ else -+ { -+ if(BTC_INTF_USB == pBtCoexist->chipInterface) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ -+ halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) -+ { -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); -+ } -+ } -+ else -+ { -+ if(pCoexSta->bBtBusy) -+ { -+ // fw mechanism -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ } -+} -+ -+VOID -+halbtc8192d2ant_ActionHidPan( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8192d2ant_ActionHidPanBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8192d2ant_ActionHidPanBc8(pBtCoexist); -+ } -+} -+ -+VOID -+halbtc8192d2ant_ActionPanA2dpBc4( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); -+ if(bBtHsOn) -+ { -+ if(pCoexSta->bBtBusy) -+ { -+ // fw mechanism -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ if(pCoexSta->bBtBusy && bWifiBusy) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ } -+ else -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); -+ } -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+} -+VOID -+halbtc8192d2ant_ActionPanA2dpBc8( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; -+ u1Byte wifiRssiState; -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ if(!bBtHsOn) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); -+ if((pCoexSta->bBtBusy && bWifiBusy)) -+ { -+ // fw mechanism first -+ if(pCoexSta->bBtUplink) -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); -+ } -+ else -+ { -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); -+ } -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+ else -+ { -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ } -+ else -+ { -+ if(pCoexSta->bBtBusy) -+ { -+ // fw mechanism -+ halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); -+ halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); -+ -+ // sw mechanism -+ halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); -+ } -+ else -+ { -+ halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -+ } -+ } -+} -+ -+VOID -+halbtc8192d2ant_ActionPanA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8192d2ant_ActionPanA2dpBc4(pBtCoexist); -+ } -+ else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ halbtc8192d2ant_ActionPanA2dpBc8(pBtCoexist); -+ } -+} -+ -+BOOLEAN -+halbtc8192d2ant_IsBtCoexistEnter( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte macPhyMode; -+ BOOLEAN bRet=TRUE; -+ BOOLEAN bWifiUnder5G=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_MAC_PHY_MODE, &macPhyMode); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); -+ -+ if(BTC_SMSP != macPhyMode) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Only support single mac single phy!!\n")); -+ bRet = FALSE; -+ } -+ -+ if(bWifiUnder5G) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under 5G or A band\n")); -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ bRet = FALSE; -+ } -+ -+ return bRet; -+} -+ -+//============================================================ -+// extern function start with EXhalbtc8192d2ant_ -+//============================================================ -+VOID -+EXhalbtc8192d2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8192d2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ u1Byte u1Tmp=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ if( (BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) || -+ (BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ) -+ { -+ u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd) & BIT0; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, u1Tmp); -+ -+ halbtc8192d2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0xaaaa9aaa, 0xffbd0040, 0x40000010); -+ -+ // switch control, here we set pathA to control -+ // 0x878[13] = 1, 0:pathB, 1:pathA(default) -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x878, BIT13, 0x1); -+ -+ // antsel control, here we use phy0 and enable antsel. -+ // 0x87c[16:15] = b'11, enable antsel, antsel output pin -+ // 0x87c[30] = 0, 0: phy0, 1:phy 1 -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x87c, bMaskDWord, 0x1fff8); -+ -+ // antsel to Bt or Wifi, it depends Bt on/off. -+ // 0x860[9:8] = 'b10, b10:Bt On, WL2G off(default), b01:Bt off, WL2G on. -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x860, BIT9|BIT8, 0x2); -+ -+ // sw/hw control switch, here we set sw control -+ // 0x870[9:8] = 'b11 sw control, 'b00 hw control -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x870, BIT9|BIT8, 0x3); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8192d2ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8192d2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(pStackInfo->bProfileNotified) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ -+ u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8192d2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ //halbtc8192d2ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ halbtc8192d2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ halbtc8192d2ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8192d2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8192d2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ EXhalbtc8192d2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8192d2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte algorithm; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Periodical!!\n")); -+ -+ // NOTE: -+ // sw mechanism must be done after fw mechanism -+ // -+ if(!halbtc8192d2ant_IsBtCoexistEnter(pBtCoexist)) -+ return; -+ -+ if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_GET_BT_RSSI, NULL); -+ -+ halbtc8192d2ant_MonitorBtState(pBtCoexist); -+ algorithm = halbtc8192d2ant_ActionAlgorithm(pBtCoexist); -+ pCoexDm->curAlgorithm = algorithm; -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8192D_2ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO\n")); -+ halbtc8192d2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8192D_2ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID\n")); -+ halbtc8192d2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8192D_2ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP\n")); -+ halbtc8192d2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8192D_2ANT_COEX_ALGO_PAN: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN\n")); -+ halbtc8192d2ant_ActionPan(pBtCoexist); -+ break; -+ case BT_8192D_2ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP\n")); -+ halbtc8192d2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ case BT_8192D_2ANT_COEX_ALGO_HID_PAN: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+HID\n")); -+ halbtc8192d2ant_ActionHidPan(pBtCoexist); -+ break; -+ case BT_8192D_2ANT_COEX_ALGO_PAN_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP\n")); -+ halbtc8192d2ant_ActionPanA2dp(pBtCoexist); -+ break; -+ default: -+ break; -+ } -+ } -+} -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192d2Ant.h 2018-02-11 21:44:27.143146025 +0200 -@@ -0,0 +1,170 @@ -+//=========================================== -+// The following is for 8192D 2Ant BT Co-exist definition -+//=========================================== -+#define BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT 6 -+ -+typedef enum _BT_INFO_SRC_8192D_2ANT{ -+ BT_INFO_SRC_8192D_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8192D_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8192D_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8192D_2ANT_MAX -+}BT_INFO_SRC_8192D_2ANT,*PBT_INFO_SRC_8192D_2ANT; -+ -+typedef enum _BT_8192D_2ANT_BT_STATUS{ -+ BT_8192D_2ANT_BT_STATUS_IDLE = 0x0, -+ BT_8192D_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8192D_2ANT_BT_STATUS_NON_IDLE = 0x2, -+ BT_8192D_2ANT_BT_STATUS_MAX -+}BT_8192D_2ANT_BT_STATUS,*PBT_8192D_2ANT_BT_STATUS; -+ -+typedef enum _BT_8192D_2ANT_COEX_ALGO{ -+ BT_8192D_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8192D_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8192D_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8192D_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8192D_2ANT_COEX_ALGO_PAN = 0x4, -+ BT_8192D_2ANT_COEX_ALGO_HID_A2DP = 0x5, -+ BT_8192D_2ANT_COEX_ALGO_HID_PAN = 0x6, -+ BT_8192D_2ANT_COEX_ALGO_PAN_A2DP = 0x7, -+ BT_8192D_2ANT_COEX_ALGO_MAX -+}BT_8192D_2ANT_COEX_ALGO,*PBT_8192D_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8192D_2ANT{ -+ // fw mechanism -+ BOOLEAN bPreBalanceOn; -+ BOOLEAN bCurBalanceOn; -+ -+ // diminishWifi -+ BOOLEAN bPreDacOn; -+ BOOLEAN bCurDacOn; -+ BOOLEAN bPreInterruptOn; -+ BOOLEAN bCurInterruptOn; -+ u1Byte preFwDacSwingLvl; -+ u1Byte curFwDacSwingLvl; -+ BOOLEAN bPreNavOn; -+ BOOLEAN bCurNavOn; -+ -+ -+ -+ -+ -+ //BOOLEAN bPreDecBtPwr; -+ //BOOLEAN bCurDecBtPwr; -+ -+ //u1Byte preFwDacSwingLvl; -+ //u1Byte curFwDacSwingLvl; -+ //BOOLEAN bCurIgnoreWlanAct; -+ //BOOLEAN bPreIgnoreWlanAct; -+ //u1Byte prePsTdma; -+ //u1Byte curPsTdma; -+ //u1Byte psTdmaPara[5]; -+ //u1Byte psTdmaDuAdjType; -+ //BOOLEAN bResetTdmaAdjust; -+ //BOOLEAN bPrePsTdmaOn; -+ //BOOLEAN bCurPsTdmaOn; -+ //BOOLEAN bPreBtAutoReport; -+ //BOOLEAN bCurBtAutoReport; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ BOOLEAN bPreDacSwingOn; -+ u4Byte preDacSwingLvl; -+ BOOLEAN bCurDacSwingOn; -+ u4Byte curDacSwingLvl; -+ BOOLEAN bPreAdcBackOff; -+ BOOLEAN bCurAdcBackOff; -+ BOOLEAN bPreAgcTableEn; -+ BOOLEAN bCurAgcTableEn; -+ //u4Byte preVal0x6c0; -+ //u4Byte curVal0x6c0; -+ u4Byte preVal0x6c4; -+ u4Byte curVal0x6c4; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u4Byte preVal0x6cc; -+ u4Byte curVal0x6cc; -+ //BOOLEAN bLimitedDig; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ //u1Byte btStatus; -+ //u1Byte wifiChnlInfo[3]; -+} COEX_DM_8192D_2ANT, *PCOEX_DM_8192D_2ANT; -+ -+typedef struct _COEX_STA_8192D_2ANT{ -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bBtBusy; -+ BOOLEAN bBtUplink; -+ BOOLEAN bBtDownLink; -+ BOOLEAN bA2dpBusy; -+}COEX_STA_8192D_2ANT, *PCOEX_STA_8192D_2ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8192d2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192d2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8192d2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192d2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192d2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192d2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192d2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192d2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192d2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8192d2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192d2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8192d2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8192d2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.c 2018-02-11 21:44:27.144146040 +0200 -@@ -0,0 +1,3417 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8192E Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8192E_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8192e_1ant glcoex_dm_8192e_1ant; -+static struct coex_dm_8192e_1ant *coex_dm = &glcoex_dm_8192e_1ant; -+static struct coex_sta_8192e_1ant glcoex_sta_8192e_1ant; -+static struct coex_sta_8192e_1ant *coex_sta = &glcoex_sta_8192e_1ant; -+ -+const char *const glbt_info_src_8192e_1ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8192e_1ant = 20140527; -+u32 glcoex_ver_8192e_1ant = 0x4f; -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8192e1ant_ -+ * ************************************************************ */ -+u8 halbtc8192e1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_bt_rssi_state; -+ } -+ -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8192e1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_wifi_rssi_state[index]; -+ } -+ -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8192e1ant_update_ra_mask(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 dis_rate_mask) -+{ -+ coex_dm->cur_ra_mask = dis_rate_mask; -+ -+ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, -+ &coex_dm->cur_ra_mask); -+ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -+} -+ -+void halbtc8192e1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ coex_dm->cur_arfr_type = type; -+ -+ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { -+ switch (coex_dm->cur_arfr_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_4byte(btcoexist, 0x430, -+ coex_dm->backup_arfr_cnt1); -+ btcoexist->btc_write_4byte(btcoexist, 0x434, -+ coex_dm->backup_arfr_cnt2); -+ break; -+ case 1: -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x01010101); -+ } else { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -+} -+ -+void halbtc8192e1ant_retry_limit(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_retry_limit_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_retry_limit_type != -+ coex_dm->cur_retry_limit_type)) { -+ switch (coex_dm->cur_retry_limit_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ coex_dm->backup_retry_limit); -+ break; -+ case 1: /* retry limit=8 */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -+} -+ -+void halbtc8192e1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_ampdu_time_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { -+ switch (coex_dm->cur_ampdu_time_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ coex_dm->backup_ampdu_max_time); -+ break; -+ case 1: /* AMPDU timw = 0x38 * 32us */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -+} -+ -+void halbtc8192e1ant_limited_tx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, -+ IN u8 retry_limit_type, IN u8 ampdu_time_type) -+{ -+ switch (ra_mask_type) { -+ case 0: /* normal mode */ -+ halbtc8192e1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0); -+ break; -+ case 1: /* disable cck 1/2 */ -+ halbtc8192e1ant_update_ra_mask(btcoexist, force_exec, -+ 0x00000003); -+ break; -+ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ -+ halbtc8192e1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8192e1ant_auto_rate_fallback_retry(btcoexist, force_exec, -+ arfr_type); -+ halbtc8192e1ant_retry_limit(btcoexist, force_exec, retry_limit_type); -+ halbtc8192e1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -+} -+ -+void halbtc8192e1ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+void halbtc8192e1ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ coex_sta->c2h_bt_info_req_sent = true; -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+} -+ -+void halbtc8192e1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ static u8 num_of_bt_counter_chk = 0; -+ -+ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ -+ /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ -+ -+ if (coex_sta->under_ips) { -+ coex_sta->high_priority_tx = 65535; -+ coex_sta->high_priority_rx = 65535; -+ coex_sta->low_priority_tx = 65535; -+ coex_sta->low_priority_rx = 65535; -+ return; -+ } -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ if ((coex_sta->low_priority_tx >= 1050) && -+ (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->pop_event_cnt++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); -+ BTC_TRACE(trace_buf); -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+ -+ if ((reg_hp_tx == 0) && (reg_hp_rx == 0) && (reg_lp_tx == 0) && -+ (reg_lp_rx == 0)) { -+ num_of_bt_counter_chk++; -+ if (num_of_bt_counter_chk >= 3) { -+ halbtc8192e1ant_query_bt_info(btcoexist); -+ num_of_bt_counter_chk = 0; -+ } -+ } -+} -+ -+ -+void halbtc8192e1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -+{ -+ s32 wifi_rssi = 0; -+ boolean wifi_busy = false, wifi_under_b_mode = false; -+ static u8 cck_lock_counter = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ if (coex_sta->under_ips) { -+ coex_sta->crc_ok_cck = 0; -+ coex_sta->crc_ok_11g = 0; -+ coex_sta->crc_ok_11n = 0; -+ coex_sta->crc_ok_11n_agg = 0; -+ -+ coex_sta->crc_err_cck = 0; -+ coex_sta->crc_err_11g = 0; -+ coex_sta->crc_err_11n = 0; -+ coex_sta->crc_err_11n_agg = 0; -+ } else { -+ coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, -+ 0xf88); -+ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf94); -+ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf90); -+ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xfb8); -+ -+ coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, -+ 0xf84); -+ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf96); -+ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf92); -+ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xfba); -+ } -+ -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); -+ -+ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { -+ if ((coex_dm->bt_status == BT_8192E_1ANT_BT_STATUS_ACL_BUSY) || -+ (coex_dm->bt_status == -+ BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (coex_dm->bt_status == -+ BT_8192E_1ANT_BT_STATUS_SCO_BUSY)) { -+ if (coex_sta->crc_ok_cck > (coex_sta->crc_ok_11g + -+ coex_sta->crc_ok_11n + -+ coex_sta->crc_ok_11n_agg)) { -+ if (cck_lock_counter < 5) -+ cck_lock_counter++; -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ if (!coex_sta->pre_ccklock) { -+ -+ if (cck_lock_counter >= 5) -+ coex_sta->cck_lock = true; -+ else -+ coex_sta->cck_lock = false; -+ } else { -+ if (cck_lock_counter == 0) -+ coex_sta->cck_lock = false; -+ else -+ coex_sta->cck_lock = true; -+ } -+ -+ coex_sta->pre_ccklock = coex_sta->cck_lock; -+ -+ -+} -+ -+boolean halbtc8192e1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ } -+ -+ return false; -+} -+ -+void halbtc8192e1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+} -+ -+u8 halbtc8192e1ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8192E_1ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_HID_A2DP; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+void halbtc8192e1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8192e1ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8192e1ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8192e1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ -+ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+} -+ -+void halbtc8192e1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8192e1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8192e1ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8192e1ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8192e1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8192e1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** CoexTable(%d) **********\n", type); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->coex_table_type = type; -+ -+ switch (type) { -+ case 0: -+ halbtc8192e1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8192e1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8192e1ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8192e1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8192e1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8192e1ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0xaa5a5a5a, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8192e1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8192e1ant_coex_table(btcoexist, force_exec, -+ 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8192e1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8192e1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8192e1ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8192e1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8192e1ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8192e1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8192e1ant_sw_mechanism(IN struct btc_coexist *btcoexist, -+ IN boolean low_penalty_ra) -+{ -+ halbtc8192e1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -+} -+ -+void halbtc8192e1ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -+{ -+ u32 u32tmp = 0; -+ -+ if (init_hwcfg) { -+ btcoexist->btc_write_1byte(btcoexist, 0x944, 0x24); -+ btcoexist->btc_write_4byte(btcoexist, 0x930, 0x700700); -+ if (btcoexist->chip_interface == BTC_INTF_USB) -+ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30430004); -+ else -+ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30030004); -+ -+ /* 0x4c[27][24]='00', Set Antenna to BB */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp &= ~BIT(24); -+ u32tmp &= ~BIT(27); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ } else if (wifi_off) { -+ if (btcoexist->chip_interface == BTC_INTF_USB) -+ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30430004); -+ else -+ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30030004); -+ -+ /* 0x4c[27][24]='11', Set Antenna to BT, 0x64[8:7]=0, 0x64[2]=1 */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp |= BIT(24); -+ u32tmp |= BIT(27); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ } -+ -+ /* ext switch setting */ -+ switch (ant_pos_type) { -+ case BTC_ANT_PATH_WIFI: -+ btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x4); -+ break; -+ case BTC_ANT_PATH_BT: -+ btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x20); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x4); -+ break; -+ } -+} -+ -+void halbtc8192e1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ if (ap_enable) { -+ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], FW for 1Ant AP mode\n"); -+ BTC_TRACE(trace_buf); -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ } -+ } -+ -+ h2c_parameter[0] = real_byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = real_byte5; -+ -+ coex_dm->ps_tdma_para[0] = real_byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = real_byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+ -+void halbtc8192e1ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_busy = false; -+ u8 rssi_adjust_val = 0; -+ u8 ps_tdma_byte4_val = 0x50, ps_tdma_byte0_val = 0x51, -+ ps_tdma_byte3_val = 0x10; -+ s8 wifi_duration_adjust = 0x0; -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (coex_dm->cur_ps_tdma_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(on, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(off, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ -+ if (coex_sta->scan_ap_num <= 5) -+ wifi_duration_adjust = 5; -+ else if (coex_sta->scan_ap_num >= 40) -+ wifi_duration_adjust = -15; -+ else if (coex_sta->scan_ap_num >= 20) -+ wifi_duration_adjust = -10; -+ -+ if (!coex_sta->force_lps_on) { /* only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 */ -+ ps_tdma_byte0_val = 0x61; /* no null-pkt */ -+ ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */ -+ ps_tdma_byte4_val = 0x10; /* 0x778 = d/1 toggle */ -+ } -+ -+ if ((type == 3) || (type == 13) || (type == 14)) -+ ps_tdma_byte4_val = ps_tdma_byte4_val & -+ 0xbf; /* no dynamic slot for multi-profile */ -+ -+ if (bt_link_info->slave_role == true) -+ ps_tdma_byte4_val = ps_tdma_byte4_val | -+ 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+ -+ if (turn_on) { -+ switch (type) { -+ default: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x1a, 0x1a, 0x0, ps_tdma_byte4_val); -+ break; -+ case 1: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x3a + -+ wifi_duration_adjust, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 2: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x2d + -+ wifi_duration_adjust, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 3: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x1d, 0x1d, 0x0, ps_tdma_byte4_val); -+ break; -+ case 4: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x15, 0x3, 0x14, 0x0); -+ break; -+ case 5: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x15, 0x3, 0x11, 0x11); -+ break; -+ case 6: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x20, 0x3, 0x11, 0x11); -+ break; -+ case 7: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x13, -+ 0xc, 0x5, 0x0, 0x0); -+ break; -+ case 8: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 9: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x21, 0x3, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 10: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x13, -+ 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 11: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x21, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 12: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x0a, 0x0a, 0x0, 0x50); -+ break; -+ case 13: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x12, 0x12, 0x0, ps_tdma_byte4_val); -+ break; -+ case 14: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x21, 0x3, 0x10, ps_tdma_byte4_val); -+ break; -+ case 15: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x13, -+ 0xa, 0x3, 0x8, 0x0); -+ break; -+ case 16: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x15, 0x3, 0x10, 0x0); -+ break; -+ case 18: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 20: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x3f, 0x03, 0x11, 0x10); -+ break; -+ case 21: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x25, 0x03, 0x11, 0x11); -+ break; -+ case 22: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x25, 0x03, 0x11, 0x10); -+ break; -+ case 23: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x3, 0x31, 0x18); -+ break; -+ case 24: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x15, 0x3, 0x31, 0x18); -+ break; -+ case 25: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 26: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 27: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x3, 0x31, 0x98); -+ break; -+ case 28: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x69, -+ 0x25, 0x3, 0x31, 0x0); -+ break; -+ case 29: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xab, -+ 0x1a, 0x1a, 0x1, 0x10); -+ break; -+ case 30: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x30, 0x3, 0x10, 0x10); -+ break; -+ case 31: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x1a, 0x1a, 0, 0x58); -+ break; -+ case 32: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x35, 0x3, 0x11, 0x11); -+ break; -+ case 33: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xa3, -+ 0x25, 0x3, 0x30, 0x90); -+ break; -+ case 34: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x53, -+ 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 35: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x63, -+ 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 36: -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x12, 0x3, 0x14, 0x50); -+ break; -+ case 40: /* SoftAP only with no sta associated,BT disable ,TDMA mode for power saving */ -+ /* here softap mode screen off will cost 70-80mA for phone */ -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x23, -+ 0x18, 0x00, 0x10, 0x24); -+ break; -+ } -+ } else { -+ -+ /* disable PS tdma */ -+ switch (type) { -+ case 8: /* PTA Control */ -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x8, -+ 0x0, 0x0, 0x0, 0x0); -+ halbtc8192e1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_PTA, false, false); -+ break; -+ case 0: -+ default: /* Software control, Antenna at BT side */ -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x0, 0x0); -+ halbtc8192e1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_BT, false, false); -+ break; -+ case 9: /* Software control, Antenna at WiFi side */ -+ halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x0, 0x0); -+ halbtc8192e1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_WIFI, false, false); -+ break; -+ } -+ } -+ rssi_adjust_val = 0; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val); -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", -+ btcoexist->btc_read_4byte(btcoexist, 0x948), -+ btcoexist->btc_read_1byte(btcoexist, 0x765), -+ btcoexist->btc_read_1byte(btcoexist, 0x67)); -+ BTC_TRACE(trace_buf); -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+void halbtc8192e1ant_coex_all_off(IN struct btc_coexist *btcoexist) -+{ -+ /* sw all off */ -+ halbtc8192e1ant_sw_mechanism(btcoexist, false); -+ -+ /* hw all off */ -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+boolean halbtc8192e1ant_is_common_action(IN struct btc_coexist *btcoexist) -+{ -+ boolean common = false, wifi_connected = false, wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!wifi_connected && -+ BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else { -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ common = false; -+ } -+ -+ return common; -+} -+ -+ -+void halbtc8192e1ant_tdma_duration_adjust_for_acl(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ static s32 up, dn, m, n, wait_count; -+ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ -+ u8 retry_count = 0, bt_info_ext; -+ boolean wifi_busy = false; -+ /*static boolean pre_wifi_busy = false;*/ -+ -+ if (BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifi_status) -+ wifi_busy = true; -+ else -+ wifi_busy = false; -+ -+ if ((BT_8192E_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == -+ wifi_status) || -+ (BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifi_status) || -+ (BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT == -+ wifi_status)) { -+ if (coex_dm->cur_ps_tdma != 1 && -+ coex_dm->cur_ps_tdma != 2 && -+ coex_dm->cur_ps_tdma != 3 && -+ coex_dm->cur_ps_tdma != 9) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } -+ return; -+ } -+ -+ if (!coex_dm->auto_tdma_adjust) { -+ coex_dm->auto_tdma_adjust = true; -+ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ /* ============ */ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } else { -+ /* accquire the BT TRx retry count from BT_Info byte2 */ -+ retry_count = coex_sta->bt_retry_cnt; -+ bt_info_ext = coex_sta->bt_info_ext; -+ -+ if ((coex_sta->low_priority_tx) > 1050 || -+ (coex_sta->low_priority_rx) > 1250) -+ retry_count++; -+ -+ result = 0; -+ wait_count++; -+ -+ if (retry_count == -+ 0) { /* no retry in the last 2-second duration */ -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ -+ wait_count = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ } -+ } else if (retry_count <= -+ 3) { /* <=3 retry in the last 2-second duration */ -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ -+ if (wait_count <= 2) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ -+ if (wait_count == 1) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ -+ if (result == -1) { -+ if ((BT_INFO_8192E_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && -+ ((coex_dm->cur_ps_tdma == 1) || -+ (coex_dm->cur_ps_tdma == 2))) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } -+ } else if (result == 1) { -+ if ((BT_INFO_8192E_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && -+ ((coex_dm->cur_ps_tdma == 1) || -+ (coex_dm->cur_ps_tdma == 2))) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = 1; -+ } -+ } else { /* no change */ -+ /* Bryant Modify -+ if(wifi_busy != pre_wifi_busy) -+ { -+ pre_wifi_busy = wifi_busy; -+ halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, true, coex_dm->cur_ps_tdma); -+ } -+ */ -+ } -+ -+ if (coex_dm->cur_ps_tdma != 1 && -+ coex_dm->cur_ps_tdma != 2 && -+ coex_dm->cur_ps_tdma != 9 && -+ coex_dm->cur_ps_tdma != 11) { -+ /* recover to previous adjust type */ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ coex_dm->ps_tdma_du_adj_type); -+ } -+ } -+} -+ -+void halbtc8192e1ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8192e1ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8192e1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8192e1ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ coex_sta->force_lps_on = true; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8192e1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, false); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8192e1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 9); -+} -+ -+void halbtc8192e1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ -+ /* This function check if bt is disabled */ -+ -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ bt_disable_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt all counters=0, %d times!!\n", -+ bt_disable_cnt); -+ BTC_TRACE(trace_buf); -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e1ant_action_wifi_only(btcoexist); -+ } -+ } -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ if (!bt_disabled) { -+ } else { -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ } -+ } -+} -+ -+/* ********************************************* -+ * -+ * Software Coex Mechanism start -+ * -+ * ********************************************* */ -+ -+/* SCO only or SCO+PAN(HS) */ -+ -+/* -+void halbtc8192e1ant_action_sco(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8192e1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8192e1ant_action_hid(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8192e1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8192e1ant_action_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8192e1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8192e1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8192e1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8192e1ant_action_pan_edr(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8192e1ant_sw_mechanism(btcoexist, false); -+} -+ -+ -+void halbtc8192e1ant_action_pan_hs(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8192e1ant_sw_mechanism(btcoexist, false); -+} -+ -+ -+void halbtc8192e1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8192e1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8192e1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8192e1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8192e1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8192e1ant_sw_mechanism(btcoexist, true); -+} -+ -+void halbtc8192e1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8192e1ant_sw_mechanism(btcoexist, true); -+} -+ -+*/ -+ -+/* ********************************************* -+ * -+ * Non-Software Coex Mechanism start -+ * -+ * ********************************************* */ -+void halbtc8192e1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8192e1ant_action_hs(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8192e1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, -+ bt_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) { -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ /* SCO/HID/A2DP busy */ -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if ((bt_link_info->pan_exist) || (wifi_busy)) { -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ } -+} -+ -+void halbtc8192e1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ /* tdma and coex table */ -+ -+ if (bt_link_info->sco_exist) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } else { /* HID */ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } -+} -+ -+void halbtc8192e1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ u8 bt_rssi_state; -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ bt_rssi_state = halbtc8192e1ant_bt_rssi_state(2, 28, 0); -+ -+ if ((coex_sta->low_priority_rx >= 1000) && -+ (coex_sta->low_priority_rx != 65535)) -+ bt_link_info->slave_role = true; -+ else -+ bt_link_info->slave_role = false; -+ -+ if (bt_link_info->hid_only) { /* HID */ -+ halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, -+ wifi_status); -+ coex_dm->auto_tdma_adjust = false; -+ return; -+ } else if (bt_link_info->a2dp_only) { /* A2DP */ -+ if (BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ halbtc8192e1ant_tdma_duration_adjust_for_acl(btcoexist, -+ wifi_status); -+#if 0 -+ if (coex_sta->cck_lock) -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 3); -+ else -+#endif -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = true; -+ } -+ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || -+ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { /* HID+A2DP */ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); -+ coex_dm->auto_tdma_adjust = false; -+ -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && -+ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ /* BT no-profile busy (0x9) */ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } -+} -+ -+void halbtc8192e1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -+{ -+ /* power save state */ -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8192e1ant_action_wifi_not_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 20); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if ((BT_8192E_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ /* Bryant Add */ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8192e1ant_action_wifi_not_connected_asso_auth( -+ IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if (bt_link_info->pan_exist) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8192e1ant_action_wifi_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 20); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if ((BT_8192E_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ /* Bryant Add */ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8192e1ant_action_wifi_connected_specific_packet( -+ IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if (bt_link_info->pan_exist) { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8192e1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_busy = false; -+ boolean scan = false, link = false, roam = false; -+ boolean under_4way = false, ap_enable = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ if (under_4way) { -+ halbtc8192e1ant_action_wifi_connected_specific_packet(btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8192e1ant_action_wifi_connected_scan(btcoexist); -+ else -+ halbtc8192e1ant_action_wifi_connected_specific_packet( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ /* power save state */ -+ if (!ap_enable && -+ BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status && -+ !btcoexist->bt_link_info.hid_only) { -+ if (btcoexist->bt_link_info.a2dp_only) { /* A2DP */ -+ if (!wifi_busy) -+ halbtc8192e1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else { /* busy */ -+ if (coex_sta->scan_ap_num >= -+ BT_8192E_1ANT_WIFI_NOISY_THRESH) /* no force LPS, no PS-TDMA, use pure TDMA */ -+ halbtc8192e1ant_power_save_state( -+ btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ else -+ halbtc8192e1ant_power_save_state( -+ btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ } else if ((coex_sta->pan_exist == false) && -+ (coex_sta->a2dp_exist == false) && -+ (coex_sta->hid_exist == false)) -+ halbtc8192e1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e1ant_power_save_state(btcoexist, -+ BTC_PS_LPS_ON, 0x50, 0x4); -+ } else -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ -+ /* tdma and coex table */ -+ if (!wifi_busy) { -+ if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8192e1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else if ((BT_8192E_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ -+ if ((coex_sta->high_priority_tx) + -+ (coex_sta->high_priority_rx) <= 60) -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 2); -+ else -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 7); -+ } -+ } else { -+ if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8192e1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else if ((BT_8192E_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else { -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ -+ if ((coex_sta->high_priority_tx) + -+ (coex_sta->high_priority_rx) <= 60) -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 2); -+ else -+ halbtc8192e1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 7); -+ } -+ } -+} -+ -+void halbtc8192e1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ u8 algorithm = 0; -+ -+ algorithm = halbtc8192e1ant_action_algorithm(btcoexist); -+ coex_dm->cur_algorithm = algorithm; -+ -+ if (halbtc8192e1ant_is_common_action(btcoexist)) { -+ -+ } else { -+ switch (coex_dm->cur_algorithm) { -+ case BT_8192E_1ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_action_sco(btcoexist); */ -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_action_hid(btcoexist); */ -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_action_a2dp(btcoexist); */ -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_action_a2dp_pan_hs(btcoexist); */ -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_action_pan_edr(btcoexist); */ -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_action_pan_hs(btcoexist); */ -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_action_pan_edr_a2dp(btcoexist); */ -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_action_pan_edr_hid(btcoexist); */ -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_action_hid_a2dp_pan_edr(btcoexist); */ -+ break; -+ case BT_8192E_1ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_action_hid_a2dp(btcoexist); */ -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8192e1ant_coex_all_off(btcoexist); */ -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+} -+ -+void halbtc8192e1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ boolean increase_scan_dev_num = false; -+ boolean bt_ctrl_agg_buf_size = false; -+ boolean miracast_plus_bt = false; -+ u8 agg_buf_size = 5; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if ((BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8192E_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ increase_scan_dev_num = true; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, -+ &increase_scan_dev_num); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if ((num_of_wifi_link >= 2) || -+ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", -+ num_of_wifi_link, wifi_link_status); -+ BTC_TRACE(trace_buf); -+ -+ if (bt_link_info->bt_link_exist) { -+ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, -+ 0, 1); -+ miracast_plus_bt = true; -+ } else { -+ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, -+ 0, 0); -+ miracast_plus_bt = false; -+ } -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if ((bt_link_info->a2dp_exist) && -+ (coex_sta->c2h_bt_inquiry_page)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8192e1ant_action_wifi_multi_port(btcoexist); -+ -+ return; -+ } else { -+ miracast_plus_bt = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ -+ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { -+ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ -+ if (bt_link_info->sco_exist) -+ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, -+ false, true, 0x5); -+ else -+ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, -+ false, true, 0x8); -+ -+ halbtc8192e1ant_sw_mechanism(btcoexist, true); -+ halbtc8192e1ant_run_sw_coexist_mechanism( -+ btcoexist); /* just print debug message */ -+ } else { -+ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x5); -+ -+ halbtc8192e1ant_sw_mechanism(btcoexist, false); -+ halbtc8192e1ant_run_sw_coexist_mechanism( -+ btcoexist); /* just print debug message */ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8192e1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ -+ if (!wifi_connected) { -+ boolean scan = false, link = false, roam = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is non connected-idle !!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8192e1ant_action_wifi_not_connected_scan( -+ btcoexist); -+ else -+ halbtc8192e1ant_action_wifi_not_connected_asso_auth( -+ btcoexist); -+ } else -+ halbtc8192e1ant_action_wifi_not_connected(btcoexist); -+ } else /* wifi LPS/Busy */ -+ halbtc8192e1ant_action_wifi_connected(btcoexist); -+} -+ -+void halbtc8192e1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ -+ /* sw all off */ -+ halbtc8192e1ant_sw_mechanism(btcoexist, false); -+ -+ /* halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ -+ halbtc8192e1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ coex_sta->pop_event_cnt = 0; -+} -+ -+void halbtc8192e1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ u16 u16tmp = 0; -+ u8 u8tmp = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 1Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* antenna sw ctrl to bt */ -+ halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, true, false); -+ -+ halbtc8192e1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ /* antenna switch control parameter */ -+ btcoexist->btc_write_4byte(btcoexist, 0x858, 0x55555555); -+ -+ /* coex parameters */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); -+ /* 0x790[5:0]=0x5 */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); -+ u8tmp &= 0xc0; -+ u8tmp |= 0x5; -+ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); -+ -+ /* enable counter statistics */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); -+ -+ /* enable PTA */ -+ btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); -+ /* enable mailbox interface */ -+ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x40); -+ u16tmp |= BIT(9); -+ btcoexist->btc_write_2byte(btcoexist, 0x40, u16tmp); -+ -+ /* enable PTA I2C mailbox */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x101); -+ u8tmp |= BIT(4); -+ btcoexist->btc_write_1byte(btcoexist, 0x101, u8tmp); -+ -+ /* enable bt clock when wifi is disabled. */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x93); -+ u8tmp |= BIT(0); -+ btcoexist->btc_write_1byte(btcoexist, 0x93, u8tmp); -+ /* enable bt clock when suspend. */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x7); -+ u8tmp |= BIT(0); -+ btcoexist->btc_write_1byte(btcoexist, 0x7, u8tmp); -+} -+ -+ -+/* -+void halbtc8192e1ant_wifi_off_hw_cfg(IN struct btc_coexist* btcoexist) -+{ -+ -+ -+} -+*/ -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8192e1ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8192e1ant_ -+ * ************************************************************ */ -+void ex_halbtc8192e1ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+#if 0 -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp = 0x0; -+ u16 u16tmp = 0x0; -+ -+ btcoexist->stop_coex_dm = true; -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x67, 0x20); -+ -+ /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ -+ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); -+ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); -+ -+ /* set GRAN_BT = 1 */ -+ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); -+ /* set WLAN_ACT = 0 */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); -+ -+ /* */ -+ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ -+ if (btcoexist->chip_interface == BTC_INTF_USB) { -+ /* fixed at S0 for USB interface */ -+ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); -+ -+ u8tmp |= 0x1; /* antenna inverse */ -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); -+ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; -+ } else { -+ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ -+ if (board_info->single_ant_path == 0) { -+ /* set to S1 */ -+ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x280); -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+ } else if (board_info->single_ant_path == 1) { -+ /* set to S0 */ -+ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); -+ u8tmp |= 0x1; /* antenna inverse */ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ -+ if (btcoexist->chip_interface == BTC_INTF_PCI) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384, -+ u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_SDIO) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, -+ u8tmp); -+ } -+#endif -+} -+ -+void ex_halbtc8192e1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -+{ -+} -+ -+void ex_halbtc8192e1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ halbtc8192e1ant_init_hw_config(btcoexist, wifi_only); -+ btcoexist->stop_coex_dm = false; -+} -+ -+void ex_halbtc8192e1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = false; -+ -+ halbtc8192e1ant_init_coex_dm(btcoexist); -+ -+ halbtc8192e1ant_query_bt_info(btcoexist); -+} -+ -+void ex_halbtc8192e1ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u32 u32tmp[4]; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ if (btcoexist->stop_coex_dm) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", -+ "Ant PG number/ Ant mechanism:", -+ board_info->pg_ant_num, board_info->btdm_ant_num); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", -+ "CoexVer/ FwVer/ PatchVer", -+ glcoex_ver_date_8192e_1ant, glcoex_ver_8192e_1ant, fw_ver, -+ bt_patch_ver, bt_patch_ver); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") -+ : ((BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi, coex_sta->bt_retry_cnt); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP", -+ bt_link_info->sco_exist, bt_link_info->hid_exist, -+ bt_link_info->pan_exist, bt_link_info->a2dp_exist); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "BT Info A2DP rate", -+ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); -+ CL_PRINTF(cli_buf); -+ -+ for (i = 0; i < BT_INFO_SRC_8192E_1ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8192e_1ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ if (!btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms]============"); -+ CL_PRINTF(cli_buf); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ coex_dm->auto_tdma_adjust); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", -+ "Latest error condition(should be 0)", -+ coex_dm->error_condition); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", -+ "IgnWlanAct", -+ coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ } -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc04); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xd04); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x90c); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0xc04/ 0xd04/ 0x90c", -+ u32tmp[0], u32tmp[1], u32tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x778", -+ u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x92c); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x930); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x92c/ 0x930", -+ (u8tmp[0]), u32tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x4f); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x40/ 0x4f", -+ u8tmp[0], u8tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x550(bcn ctrl)/0x522", -+ u32tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", -+ u32tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(hp rx[31:16]/tx[15:0])", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(lp rx[31:16]/tx[15:0])", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+#if (BT_AUTO_REPORT_ONLY_8192E_1ANT == 1) -+ halbtc8192e1ant_monitor_bt_ctr(btcoexist); -+#endif -+ -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+void ex_halbtc8192e1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, -+ true); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = false; -+ -+ halbtc8192e1ant_init_hw_config(btcoexist, false); -+ halbtc8192e1ant_init_coex_dm(btcoexist); -+ halbtc8192e1ant_query_bt_info(btcoexist); -+ } -+} -+ -+void ex_halbtc8192e1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ } -+} -+ -+void ex_halbtc8192e1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ u8 u8tmpa, u8tmpb; -+ u32 u32tmp; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_SCAN_START == type) { -+ coex_sta->wifi_is_high_pri_task = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, -+ 8); /* Force antenna setup for no scan result issue */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); -+ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", -+ u32tmp, u8tmpa, u8tmpb); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ } -+ -+ if (coex_sta->bt_disabled) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ halbtc8192e1ant_query_bt_info(btcoexist); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ if (num_of_wifi_link >= 2) { -+ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8192e1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8192e1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8192e1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ if (BTC_SCAN_START == type) { -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8192e1ant_action_wifi_not_connected_scan( -+ btcoexist); -+ else /* wifi is connected */ -+ halbtc8192e1ant_action_wifi_connected_scan(btcoexist); -+ } else if (BTC_SCAN_FINISH == type) { -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8192e1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8192e1ant_action_wifi_connected(btcoexist); -+ } -+} -+ -+void ex_halbtc8192e1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ if (BTC_ASSOCIATE_START == type) { -+ coex_sta->wifi_is_high_pri_task = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->arp_cnt = 0; -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ /* coex_dm->arp_cnt = 0; */ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ if (num_of_wifi_link >= 2) { -+ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8192e1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8192e1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8192e1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ if (BTC_ASSOCIATE_START == type) -+ halbtc8192e1ant_action_wifi_not_connected_asso_auth(btcoexist); -+ else if (BTC_ASSOCIATE_FINISH == type) { -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8192e1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8192e1ant_action_wifi_connected(btcoexist); -+ } -+} -+ -+void ex_halbtc8192e1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ boolean wifi_under_b_mode = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ /* Set CCK Tx/Rx high Pri except 11b mode */ -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x00); /* CCK Rx */ -+ } else { -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x10); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x10); /* CCK Rx */ -+ } -+ -+ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, -+ 0x430); -+ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, -+ 0x434); -+ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( -+ btcoexist, 0x42a); -+ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( -+ btcoexist, 0x456); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->arp_cnt = 0; -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ -+ } -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ /* h2c_parameter[0] = 0x1; */ -+ h2c_parameter[0] = 0x0; -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -+} -+ -+void ex_halbtc8192e1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ if (BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ BTC_PACKET_ARP == type) { -+ if (BTC_PACKET_ARP == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ARP notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_dm->arp_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ARP Packet Count = %d\n", -+ coex_dm->arp_cnt); -+ BTC_TRACE(trace_buf); -+ -+ if (coex_dm->arp_cnt >= -+ 10) /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecificPacket(btcoexist) */ -+ coex_sta->wifi_is_high_pri_task = false; -+ else -+ coex_sta->wifi_is_high_pri_task = true; -+ } else { -+ coex_sta->wifi_is_high_pri_task = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet DHCP or EAPOL notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet [Type = %d] notify\n", type); -+ BTC_TRACE(trace_buf); -+ } -+ -+ coex_sta->specific_pkt_period_cnt = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ if (num_of_wifi_link >= 2) { -+ halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8192e1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8192e1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8192e1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ if (BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ ((BTC_PACKET_ARP == type) && (coex_sta->wifi_is_high_pri_task))) -+ halbtc8192e1ant_action_wifi_connected_specific_packet(btcoexist); -+} -+ -+void ex_halbtc8192e1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source = 0; -+ boolean wifi_connected = false; -+ boolean bt_busy = false; -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8192E_1ANT_MAX) -+ rsp_source = BT_INFO_SRC_8192E_1ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (BT_INFO_SRC_8192E_1ANT_WIFI_FW != rsp_source) { -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; -+ -+ if (coex_sta->bt_retry_cnt >= 1) -+ coex_sta->pop_event_cnt++; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) -+ coex_sta->c2h_bt_page = true; -+ else -+ coex_sta->c2h_bt_page = false; -+ -+ coex_sta->bt_rssi = -+ coex_sta->bt_info_c2h[rsp_source][3] * 2 - 90; -+ /* coex_sta->bt_info_c2h[rsp_source][3]*2+10; */ -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+ coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] -+ & 0x40); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, -+ &coex_sta->bt_tx_rx_mask); -+ if (!coex_sta->bt_tx_rx_mask) { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, -+ 0x3c, 0x15); -+ } -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ if (coex_sta->bt_info_ext & BIT(1)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (wifi_connected) -+ ex_halbtc8192e1ant_media_status_notify( -+ btcoexist, BTC_MEDIA_CONNECT); -+ else -+ ex_halbtc8192e1ant_media_status_notify( -+ btcoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ if (coex_sta->bt_info_ext & BIT(3)) { -+ if (!btcoexist->manual_control && -+ !btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e1ant_ignore_wlan_act(btcoexist, -+ FORCE_EXEC, false); -+ } -+ } else { -+ /* BT already NOT ignore Wlan active, do nothing here. */ -+ } -+#if (BT_AUTO_REPORT_ONLY_8192E_1ANT == 0) -+ if ((coex_sta->bt_info_ext & BIT(4))) { -+ /* BT auto report already enabled, do nothing */ -+ } else -+ halbtc8192e1ant_bt_auto_report(btcoexist, FORCE_EXEC, -+ true); -+#endif -+ } -+ -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (bt_info & BT_INFO_8192E_1ANT_B_INQ_PAGE) -+ coex_sta->c2h_bt_inquiry_page = true; -+ else -+ coex_sta->c2h_bt_inquiry_page = false; -+ -+ /* set link exist status */ -+ if (!(bt_info & BT_INFO_8192E_1ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (bt_info & BT_INFO_8192E_1ANT_B_FTP) -+ coex_sta->pan_exist = true; -+ else -+ coex_sta->pan_exist = false; -+ if (bt_info & BT_INFO_8192E_1ANT_B_A2DP) -+ coex_sta->a2dp_exist = true; -+ else -+ coex_sta->a2dp_exist = false; -+ if (bt_info & BT_INFO_8192E_1ANT_B_HID) -+ coex_sta->hid_exist = true; -+ else -+ coex_sta->hid_exist = false; -+ if (bt_info & BT_INFO_8192E_1ANT_B_SCO_ESCO) -+ coex_sta->sco_exist = true; -+ else -+ coex_sta->sco_exist = false; -+ } -+ -+ halbtc8192e1ant_update_bt_link_info(btcoexist); -+ -+ bt_info = bt_info & -+ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ -+ -+ if (!(bt_info & BT_INFO_8192E_1ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info == -+ BT_INFO_8192E_1ANT_B_CONNECTION) { /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if ((bt_info & BT_INFO_8192E_1ANT_B_SCO_ESCO) || -+ (bt_info & BT_INFO_8192E_1ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8192E_1ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info & BT_INFO_8192E_1ANT_B_ACL_BUSY) { -+ if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) -+ coex_dm->auto_tdma_adjust = false; -+ coex_dm->bt_status = BT_8192E_1ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_dm->bt_status = BT_8192E_1ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if ((BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8192E_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ bt_busy = true; -+ else -+ bt_busy = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ halbtc8192e1ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8192e1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u32 u32tmp; -+ u8 u8tmpa, u8tmpb, u8tmpc; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_RF_ON == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->stop_coex_dm = false; -+ } else if (BTC_RF_OFF == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, -+ true); -+ -+ halbtc8192e1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ btcoexist->stop_coex_dm = true; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); -+ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ u8tmpc = btcoexist->btc_read_1byte(btcoexist, 0x76e); -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x, 0x76e=0x%x\n", -+ u32tmp, u8tmpa, u8tmpb, u8tmpc); -+ BTC_TRACE(trace_buf); -+ -+ } -+} -+ -+void ex_halbtc8192e1ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, true); -+ -+ halbtc8192e1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ -+ ex_halbtc8192e1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+ -+ btcoexist->stop_coex_dm = true; -+} -+ -+void ex_halbtc8192e1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_WIFI_PNP_SLEEP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, -+ true); -+ -+ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ -+ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ -+ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ -+ coex_sta->under_ips = false; -+ coex_sta->under_lps = false; -+ btcoexist->stop_coex_dm = true; -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->stop_coex_dm = false; -+ halbtc8192e1ant_init_hw_config(btcoexist, false); -+ halbtc8192e1ant_init_coex_dm(btcoexist); -+ halbtc8192e1ant_query_bt_info(btcoexist); -+ } -+} -+ -+void ex_halbtc8192e1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], *****************Coex DM Reset*****************\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8192e1ant_init_hw_config(btcoexist, false); -+ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ -+ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); */ -+ halbtc8192e1ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8192e1ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+#if (BT_AUTO_REPORT_ONLY_8192E_1ANT == 0) -+ halbtc8192e1ant_query_bt_info(btcoexist); -+ halbtc8192e1ant_monitor_bt_enable_disable(btcoexist); -+#else -+ halbtc8192e1ant_monitor_bt_ctr(btcoexist); -+ halbtc8192e1ant_monitor_wifi_ctr(btcoexist); -+ -+ if (halbtc8192e1ant_is_wifi_status_changed(btcoexist) || -+ coex_dm->auto_tdma_adjust) -+ -+ halbtc8192e1ant_run_coexist_mechanism(btcoexist); -+ -+ coex_sta->specific_pkt_period_cnt++; -+#endif -+} -+ -+ -+void ex_halbtc8192e1ant_dbg_control(IN struct btc_coexist *btcoexist, -+ IN u8 op_code, IN u8 op_len, IN u8 *pdata) -+{ -+ switch (op_code) { -+ case BTC_DBG_SET_COEX_NORMAL: -+ btcoexist->manual_control = false; -+ halbtc8192e1ant_init_coex_dm(btcoexist); -+ break; -+ case BTC_DBG_SET_COEX_WIFI_ONLY: -+ btcoexist->manual_control = true; -+ halbtc8192e1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 9); -+ break; -+ case BTC_DBG_SET_COEX_BT_ONLY: -+ /* todo */ -+ break; -+ default: -+ break; -+ } -+} -+ -+#endif /* #if (RTL8192E_SUPPORT == 1) */ -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -\ Ingen nyrad vid filslut -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e1Ant.h 2018-02-11 21:44:27.144146040 +0200 -@@ -0,0 +1,226 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8192E_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8192E 1ANT BT Co-exist definition -+ * ******************************************* */ -+#define BT_AUTO_REPORT_ONLY_8192E_1ANT 1 -+ -+#define BT_INFO_8192E_1ANT_B_FTP BIT(7) -+#define BT_INFO_8192E_1ANT_B_A2DP BIT(6) -+#define BT_INFO_8192E_1ANT_B_HID BIT(5) -+#define BT_INFO_8192E_1ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8192E_1ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8192E_1ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8192E_1ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8192E_1ANT_B_CONNECTION BIT(0) -+ -+#define BT_INFO_8192E_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT(0))) ? true : false) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT 2 -+ -+#define BT_8192E_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ -+ -+enum bt_info_src_8192e_1ant { -+ BT_INFO_SRC_8192E_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8192E_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8192E_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8192E_1ANT_MAX -+}; -+ -+enum bt_8192e_1ant_bt_status { -+ BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8192E_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8192E_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8192E_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8192E_1ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8192e_1ant_wifi_status { -+ BT_8192E_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8192E_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8192E_1ANT_WIFI_STATUS_MAX -+}; -+ -+enum bt_8192e_1ant_coex_algo { -+ BT_8192E_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8192E_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8192E_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8192E_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8192E_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8192E_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8192E_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8192E_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8192E_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8192E_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8192E_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8192E_1ANT_COEX_ALGO_MAX = 0xb, -+}; -+ -+struct coex_dm_8192e_1ant { -+ /* fw mechanism */ -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean auto_tdma_adjust; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ /* sw mechanism */ -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ -+ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ -+ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ -+ u16 backup_retry_limit; -+ u8 backup_ampdu_max_time; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ u32 pre_ra_mask; -+ u32 cur_ra_mask; -+ u8 pre_arfr_type; -+ u8 cur_arfr_type; -+ u8 pre_retry_limit_type; -+ u8 cur_retry_limit_type; -+ u8 pre_ampdu_time_type; -+ u8 cur_ampdu_time_type; -+ u32 arp_cnt; -+ -+ u8 error_condition; -+}; -+ -+struct coex_sta_8192e_1ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 specific_pkt_period_cnt; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ s8 bt_rssi; -+ boolean bt_tx_rx_mask; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8192E_1ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8192E_1ANT_MAX]; -+ boolean c2h_bt_inquiry_page; -+ boolean c2h_bt_page; /* Add for win8.1 page out issue */ -+ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ u32 pop_event_cnt; -+ u8 scan_ap_num; -+ -+ u32 crc_ok_cck; -+ u32 crc_ok_11g; -+ u32 crc_ok_11n; -+ u32 crc_ok_11n_agg; -+ -+ u32 crc_err_cck; -+ u32 crc_err_11g; -+ u32 crc_err_11n; -+ u32 crc_err_11n_agg; -+ -+ boolean cck_lock; -+ boolean pre_ccklock; -+ u8 coex_table_type; -+ -+ boolean force_lps_on; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8192e1ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8192e1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -+void ex_halbtc8192e1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8192e1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8192e1ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e1ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8192e1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e1ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8192e1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8192e1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -+void ex_halbtc8192e1ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8192e1ant_display_coex_info(IN struct btc_coexist *btcoexist); -+void ex_halbtc8192e1ant_dbg_control(IN struct btc_coexist *btcoexist, -+ IN u8 op_code, IN u8 op_len, IN u8 *pdata); -+ -+#else /* #if (RTL8192E_SUPPORT == 1) */ -+#define ex_halbtc8192e1ant_power_on_setting(btcoexist) -+#define ex_halbtc8192e1ant_pre_load_firmware(btcoexist) -+#define ex_halbtc8192e1ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8192e1ant_init_coex_dm(btcoexist) -+#define ex_halbtc8192e1ant_ips_notify(btcoexist, type) -+#define ex_halbtc8192e1ant_lps_notify(btcoexist, type) -+#define ex_halbtc8192e1ant_scan_notify(btcoexist, type) -+#define ex_halbtc8192e1ant_connect_notify(btcoexist, type) -+#define ex_halbtc8192e1ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8192e1ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8192e1ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8192e1ant_rf_status_notify(btcoexist, type) -+#define ex_halbtc8192e1ant_halt_notify(btcoexist) -+#define ex_halbtc8192e1ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8192e1ant_coex_dm_reset(btcoexist) -+#define ex_halbtc8192e1ant_periodical(btcoexist) -+#define ex_halbtc8192e1ant_display_coex_info(btcoexist) -+#define ex_halbtc8192e1ant_dbg_control(btcoexist, op_code, op_len, pdata) -+ -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.c 2018-02-11 21:44:27.144146040 +0200 -@@ -0,0 +1,4068 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8192E Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8192E_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8192e_2ant glcoex_dm_8192e_2ant; -+static struct coex_dm_8192e_2ant *coex_dm = &glcoex_dm_8192e_2ant; -+static struct coex_sta_8192e_2ant glcoex_sta_8192e_2ant; -+static struct coex_sta_8192e_2ant *coex_sta = &glcoex_sta_8192e_2ant; -+ -+const char *const glbt_info_src_8192e_2ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8192e_2ant = 20160412; -+u32 glcoex_ver_8192e_2ant = 0x42; -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8192e2ant_ -+ * ************************************************************ */ -+u8 halbtc8192e2ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_bt_rssi_state; -+ } -+ -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8192e2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_wifi_rssi_state[index]; -+ } -+ -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8192e2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ -+ /* This function check if bt is disabled */ -+ -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ bt_disable_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt all counters=0, %d times!!\n", -+ bt_disable_cnt); -+ BTC_TRACE(trace_buf); -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ if (!bt_disabled) { -+ } else { -+ } -+ } -+} -+ -+u32 halbtc8192e2ant_decide_ra_mask(IN struct btc_coexist *btcoexist, -+ IN u8 ss_type, IN u32 ra_mask_type) -+{ -+ u32 dis_ra_mask = 0x0; -+ -+ switch (ra_mask_type) { -+ case 0: /* normal mode */ -+ if (ss_type == 2) -+ dis_ra_mask = 0x0; /* enable 2ss */ -+ else -+ dis_ra_mask = 0xfff00000; /* disable 2ss */ -+ break; -+ case 1: /* disable cck 1/2 */ -+ if (ss_type == 2) -+ dis_ra_mask = 0x00000003; /* enable 2ss */ -+ else -+ dis_ra_mask = 0xfff00003; /* disable 2ss */ -+ break; -+ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ -+ if (ss_type == 2) -+ dis_ra_mask = 0x0001f1f7; /* enable 2ss */ -+ else -+ dis_ra_mask = 0xfff1f1f7; /* disable 2ss */ -+ break; -+ default: -+ break; -+ } -+ -+ return dis_ra_mask; -+} -+ -+void halbtc8192e2ant_update_ra_mask(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 dis_rate_mask) -+{ -+ coex_dm->cur_ra_mask = dis_rate_mask; -+ -+ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, -+ &coex_dm->cur_ra_mask); -+ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -+} -+ -+void halbtc8192e2ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ coex_dm->cur_arfr_type = type; -+ -+ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { -+ switch (coex_dm->cur_arfr_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_4byte(btcoexist, 0x430, -+ coex_dm->backup_arfr_cnt1); -+ btcoexist->btc_write_4byte(btcoexist, 0x434, -+ coex_dm->backup_arfr_cnt2); -+ break; -+ case 1: -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x01010101); -+ } else { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -+} -+ -+void halbtc8192e2ant_retry_limit(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_retry_limit_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_retry_limit_type != -+ coex_dm->cur_retry_limit_type)) { -+ switch (coex_dm->cur_retry_limit_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ coex_dm->backup_retry_limit); -+ break; -+ case 1: /* retry limit=8 */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -+} -+ -+void halbtc8192e2ant_ampdu_max_time(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_ampdu_time_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { -+ switch (coex_dm->cur_ampdu_time_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ coex_dm->backup_ampdu_max_time); -+ break; -+ case 1: /* AMPDU timw = 0x38 * 32us */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -+} -+ -+void halbtc8192e2ant_limited_tx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, -+ IN u8 retry_limit_type, IN u8 ampdu_time_type) -+{ -+ u32 dis_ra_mask = 0x0; -+ -+ coex_dm->cur_ra_mask_type = ra_mask_type; -+ dis_ra_mask = halbtc8192e2ant_decide_ra_mask(btcoexist, -+ coex_dm->cur_ss_type, ra_mask_type); -+ halbtc8192e2ant_update_ra_mask(btcoexist, force_exec, dis_ra_mask); -+ -+ halbtc8192e2ant_auto_rate_fallback_retry(btcoexist, force_exec, -+ arfr_type); -+ halbtc8192e2ant_retry_limit(btcoexist, force_exec, retry_limit_type); -+ halbtc8192e2ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -+} -+ -+void halbtc8192e2ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+void halbtc8192e2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); -+ BTC_TRACE(trace_buf); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); -+ BTC_TRACE(trace_buf); -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+} -+ -+void halbtc8192e2ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ coex_sta->c2h_bt_info_req_sent = true; -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+} -+ -+boolean halbtc8192e2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ -+ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); -+ -+ if ((BTC_RSSI_STATE_HIGH == wifi_rssi_state) || (BTC_RSSI_STATE_LOW == wifi_rssi_state)) -+ return true; -+ } -+ -+ return false; -+} -+ -+void halbtc8192e2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+} -+ -+u8 halbtc8192e2ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ struct btc_stack_info *stack_info = &btcoexist->stack_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8192E_2ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_SCO_PAN; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ if (stack_info->num_of_hid >= 2) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID*2 + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_SCO_PAN; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8192E_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8192E_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+void halbtc8192e2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, -+ IN u8 dac_swing_lvl) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ /* There are several type of dacswing */ -+ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ -+ h2c_parameter[0] = dac_swing_lvl; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); -+} -+ -+void halbtc8192e2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN u8 dec_bt_pwr_lvl) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = dec_bt_pwr_lvl; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); -+} -+ -+void halbtc8192e2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 dec_bt_pwr_lvl) -+{ -+ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; -+ -+ if (!force_exec) { -+#if 0 /* work around, avoid h2c command fail. */ -+ if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) -+ return; -+#endif -+ } -+ halbtc8192e2ant_set_fw_dec_bt_pwr(btcoexist, -+ coex_dm->cur_bt_dec_pwr_lvl); -+ -+ coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; -+} -+ -+void halbtc8192e2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8192e2ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8192e2ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8192e2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 fw_dac_swing_lvl) -+{ -+ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_fw_dac_swing_lvl == -+ coex_dm->cur_fw_dac_swing_lvl) -+ return; -+ } -+ -+ halbtc8192e2ant_set_fw_dac_swing_level(btcoexist, -+ coex_dm->cur_fw_dac_swing_lvl); -+ -+ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; -+} -+ -+void halbtc8192e2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist *btcoexist, -+ IN boolean rx_rf_shrink_on) -+{ -+ if (rx_rf_shrink_on) { -+ /* Shrink RF Rx LPF corner */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Shrink RF Rx LPF corner!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, -+ 0xffffc); -+ } else { -+ /* Resume RF Rx LPF corner */ -+ /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ -+ if (btcoexist->initilized) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Resume RF Rx LPF corner!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, -+ 0xfffff, coex_dm->bt_rf_0x1e_backup); -+ } -+ } -+} -+ -+void halbtc8192e2ant_rf_shrink(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rx_rf_shrink_on) -+{ -+ coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_rf_rx_lpf_shrink == -+ coex_dm->cur_rf_rx_lpf_shrink) -+ return; -+ } -+ halbtc8192e2ant_set_sw_rf_rx_lpf_corner(btcoexist, -+ coex_dm->cur_rf_rx_lpf_shrink); -+ -+ coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; -+} -+ -+void halbtc8192e2ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ -+ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+} -+ -+void halbtc8192e2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8192e2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8192e2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, -+ IN u32 level) -+{ -+ u8 val = (u8)level; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Write SwDacSwing = 0x%x\n", level); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x883, 0x3e, val); -+} -+ -+void halbtc8192e2ant_set_sw_full_time_dac_swing(IN struct btc_coexist -+ *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) -+{ -+ if (sw_dac_swing_on) -+ halbtc8192e2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); -+ else -+ halbtc8192e2ant_set_dac_swing_reg(btcoexist, 0x18); -+} -+ -+ -+void halbtc8192e2ant_dac_swing(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) -+{ -+ coex_dm->cur_dac_swing_on = dac_swing_on; -+ coex_dm->cur_dac_swing_lvl = dac_swing_lvl; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && -+ (coex_dm->pre_dac_swing_lvl == -+ coex_dm->cur_dac_swing_lvl)) -+ return; -+ } -+ delay_ms(30); -+ halbtc8192e2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, -+ dac_swing_lvl); -+ -+ coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; -+ coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; -+} -+ -+void halbtc8192e2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, -+ IN boolean adc_back_off) -+{ -+ if (adc_back_off) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB BackOff Level On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc05, 0x30, 0x3); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB BackOff Level Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc05, 0x30, 0x1); -+ } -+} -+ -+void halbtc8192e2ant_adc_back_off(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean adc_back_off) -+{ -+ coex_dm->cur_adc_back_off = adc_back_off; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) -+ return; -+ } -+ halbtc8192e2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); -+ -+ coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; -+} -+ -+void halbtc8192e2ant_set_agc_table(IN struct btc_coexist *btcoexist, -+ IN boolean agc_table_en) -+{ -+ /* =================BB AGC Gain Table */ -+ if (agc_table_en) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB Agc Table On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x0a1A0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x091B0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x081C0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x071D0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x061E0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x051F0001); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB Agc Table Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xaa1A0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa91B0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa81C0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa71D0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa61E0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa51F0001); -+ } -+} -+ -+void halbtc8192e2ant_agc_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean agc_table_en) -+{ -+ coex_dm->cur_agc_table_en = agc_table_en; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) -+ return; -+ } -+ halbtc8192e2ant_set_agc_table(btcoexist, agc_table_en); -+ -+ coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; -+} -+ -+void halbtc8192e2ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8192e2ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8192e2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8192e2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ switch (type) { -+ case 0: -+ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5fdf5fdf, 0x5fdb5fdb, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0xdfffdfff, 0x5ffb5ffb, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5ddd5ddd, 0x5fdb5fdb, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5fff5fff, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 7: -+ if (coex_sta->scan_ap_num <= NOISY_AP_NUM_THRESH_8192E) -+ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0xffffffff, 0xfafafafa, 0xffffff, 0x3); -+ else -+ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0xffffffff, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 8: -+ halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5f5f5f5f, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8192e2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8192e2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8192e2ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8192e2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8192e2ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8192e2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8192e2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ u8 realByte1 = byte1, realByte5 = byte5; -+ boolean bApEnable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ if (bApEnable) { -+ if ((byte1 & BIT4) && !(byte1 & BIT5)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], FW for 1Ant AP mode\n"); -+ realByte1 &= ~BIT4; -+ realByte1 |= BIT5; -+ -+ realByte5 |= BIT5; -+ realByte5 &= ~BIT6; -+ } -+ } -+ -+ h2c_parameter[0] = byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = byte5; -+ -+ coex_dm->ps_tdma_para[0] = byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+void halbtc8192e2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, -+ IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, -+ IN boolean limited_dig, IN boolean bt_lna_constrain) -+{ -+ /* -+ u32 wifi_bw; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if(BTC_WIFI_BW_HT40 != wifi_bw) -+ { -+ if (shrink_rx_lpf) -+ shrink_rx_lpf = false; -+ } -+ */ -+ -+ halbtc8192e2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); -+ /* halbtc8192e2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); */ -+} -+ -+void halbtc8192e2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, -+ IN boolean agc_table_shift, IN boolean adc_back_off, -+ IN boolean sw_dac_swing, IN u32 dac_swing_lvl) -+{ -+ halbtc8192e2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); -+ /* halbtc8192e2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ -+ halbtc8192e2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, -+ dac_swing_lvl); -+} -+ -+void halbtc8192e2ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -+{ -+ u32 u32tmp = 0; -+ -+ if (init_hwcfg) { -+ btcoexist->btc_write_1byte(btcoexist, 0x944, 0x24); -+ btcoexist->btc_write_4byte(btcoexist, 0x930, 0x700700); -+ if (btcoexist->chip_interface == BTC_INTF_USB) -+ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30430004); -+ else -+ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30030004); -+ -+ /* 0x4c[27][24]='00', Set Antenna to BB */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp &= ~BIT(24); -+ u32tmp &= ~BIT(27); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ } else if (wifi_off) { -+ if (btcoexist->chip_interface == BTC_INTF_USB) -+ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30430004); -+ else -+ btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30030004); -+ -+ /* 0x4c[27][24]='11', Set Antenna to BT, 0x64[8:7]=0, 0x64[2]=1 */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp |= BIT(24); -+ u32tmp |= BIT(27); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ } -+ -+ /* ext switch setting */ -+ switch (ant_pos_type) { -+ case BTC_ANT_PATH_WIFI: -+ btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x4); -+ break; -+ case BTC_ANT_PATH_BT: -+ btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x20); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x4); -+ break; -+ } -+} -+ -+void halbtc8192e2ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ s8 nWiFiDurationAdjust = 0x0; -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ -+ if (coex_sta->scan_ap_num >= 40) -+ nWiFiDurationAdjust = -15; -+ else if (coex_sta->scan_ap_num >= 20) -+ nWiFiDurationAdjust = -10; -+ -+ if (turn_on) { -+ switch (type) { -+ case 1: -+ default: /*d1,wb*/ -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x3c, 0x03, 0x11, 0x10); -+ break; -+ case 2: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x32, 0x03, 0x11, 0x10); -+ break; -+ case 3: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x28, 0x03, 0x11, 0x10); -+ break; -+ case 4: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1e, 0x03, 0x11, 0x10); -+ break; -+ case 5: /*d1,pb,TXpause*/ -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x3c, 0x03, 0x90, 0x10); -+ break; -+ case 6: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x32, 0x03, 0x90, 0x10); -+ break; -+ case 7: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x28, 0x03, 0x90, 0x10); -+ break; -+ case 8: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x1e, 0x03, 0x90, 0x10); -+ break; -+ case 9: /*d1,bb*/ -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x3c, 0x03, 0x31, 0x10); -+ break; -+ case 10: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x32, 0x03, 0x31, 0x10); -+ break; -+ case 11: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x28, 0x03, 0x31, 0x10); -+ break; -+ case 12: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1e, 0x03, 0x31, 0x10); -+ break; -+ case 13: /*d1,bb,TXpause*/ -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x3c, 0x03, 0x30, 0x10); -+ break; -+ case 14: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x32, 0x03, 0x30, 0x10); -+ break; -+ case 15: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x28, 0x03, 0x30, 0x10); -+ break; -+ case 16: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1e, 0x03, 0x30, 0x10); -+ break; -+ case 17: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x61, 0x20, 0x03, 0x10, 0x10); -+ break; -+ case 18: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 19: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x25, 0x25, 0xe1, 0x90); -+ break; -+ case 20: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x25, 0x25, 0x60, 0x90); -+ break; -+ case 21: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x61, 0x35, 0x03, 0x11, 0x11); -+ break; -+ case 22: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, 0x03, 0x11, 0x14); -+ break; -+ case 23: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x14, 0x03, 0x90, 0x14); -+ break; -+ case 24: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, 0x03, 0x31, 0x14); -+ break; -+ case 25: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, 0x03, 0x30, 0x14); -+ break; -+ case 71: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ case 80: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x3c, 0x3, 0x10, 0x50); -+ break; -+ case 81: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x3a+nWiFiDurationAdjust, 0x3, 0x10, 0x50); -+ break; -+ case 82: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x30+nWiFiDurationAdjust, 0x03, 0x10, 0x50); -+ break; -+ case 83: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x21, 0x03, 0x10, 0x50); -+ break; -+ case 84: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x15, 0x3, 0x10, 0x50); -+ break; -+ case 85: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x3a, 0x03, 0x10, 0x50); -+ break; -+ case 86: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x21, 0x03, 0x10, 0x50); -+ break; -+ case 87: -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x14, 0x03, 0x10, 0x54); -+ break; -+ -+ } -+ } else { -+ /* disable PS tdma */ -+ switch (type) { -+ default: -+ case 0: /* ANT2PTA, 0x778=1 */ -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x8, -+ 0x0, 0x0, 0x0, 0x0); -+ halbtc8192e2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_PTA, false, false); -+ break; -+ case 1: /* ANT2BT, 0x778=3 */ -+ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x8, 0x0); -+ delay_ms(5); -+ halbtc8192e2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_BT, false, false); -+ break; -+ -+ } -+ } -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+void halbtc8192e2ant_set_switch_ss_type(IN struct btc_coexist *btcoexist, -+ IN u8 ss_type) -+{ -+ u8 mimo_ps = BTC_MIMO_PS_DYNAMIC; -+ u32 dis_ra_mask = 0x0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], REAL set SS Type = %d\n", ss_type); -+ BTC_TRACE(trace_buf); -+ -+ dis_ra_mask = halbtc8192e2ant_decide_ra_mask(btcoexist, ss_type, -+ coex_dm->cur_ra_mask_type); -+ halbtc8192e2ant_update_ra_mask(btcoexist, FORCE_EXEC, dis_ra_mask); -+ -+ if (ss_type == 1) { -+ halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); -+ /* switch ofdm path */ -+ btcoexist->btc_write_1byte(btcoexist, 0xc04, 0x11); -+ btcoexist->btc_write_1byte(btcoexist, 0xd04, 0x1); -+ btcoexist->btc_write_4byte(btcoexist, 0x90c, 0x81111111); -+ /* switch cck patch */ -+ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0xe77, 0x4, 0x1); */ -+ /* btcoexist->btc_write_1byte(btcoexist, 0xa07, 0x81); */ -+ mimo_ps = BTC_MIMO_PS_STATIC; -+ } else if (ss_type == 2) { -+ halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ btcoexist->btc_write_1byte(btcoexist, 0xc04, 0x33); -+ btcoexist->btc_write_1byte(btcoexist, 0xd04, 0x3); -+ btcoexist->btc_write_4byte(btcoexist, 0x90c, 0x81121313); -+ /* remove, if 0xe77[2]=0x0 then CCK will fail, advised by Jenyu */ -+ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0xe77, 0x4, 0x0); */ -+ /* btcoexist->btc_write_1byte(btcoexist, 0xa07, 0x41); */ -+ mimo_ps = BTC_MIMO_PS_DYNAMIC; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_SEND_MIMO_PS, -+ &mimo_ps); /* set rx 1ss or 2ss */ -+} -+ -+void halbtc8192e2ant_switch_ss_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 new_ss_type) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s Switch SS Type = %d\n", -+ (force_exec ? "force to" : ""), new_ss_type); -+ BTC_TRACE(trace_buf); -+ coex_dm->cur_ss_type = new_ss_type; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ss_type == coex_dm->cur_ss_type) -+ return; -+ } -+ halbtc8192e2ant_set_switch_ss_type(btcoexist, coex_dm->cur_ss_type); -+ -+ coex_dm->pre_ss_type = coex_dm->cur_ss_type; -+} -+ -+void halbtc8192e2ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8192e2ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ boolean bApEnable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ if (bApEnable) { -+ ps_type = BTC_PS_WIFI_NATIVE; -+ lps_val = 0x0; -+ rpwm_val = 0x0; -+ } -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8192e2ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8192e2ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+void halbtc8192e2ant_coex_all_off(IN struct btc_coexist *btcoexist) -+{ -+ /* fw all off */ -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ /* hw all off */ -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8192e2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); -+ -+ halbtc8192e2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ halbtc8192e2ant_switch_ss_type(btcoexist, FORCE_EXEC, 2); -+ -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+void halbtc8192e2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ -+ -+/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 1);*/ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+boolean halbtc8192e2ant_is_common_action(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean common = false, wifi_connected = false, wifi_busy = false; -+ boolean bt_hs_on = false, low_pwr_disable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (bt_link_info->sco_exist || bt_link_info->hid_exist) -+ halbtc8192e2ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 0, 0, 0); -+ else -+ halbtc8192e2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ if (!wifi_connected) { -+ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non-connected idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if ((BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) || -+ (BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 2);*/ -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else { -+/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 1);*/ -+ halbtc8192e2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 1); -+ } -+ -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, -+ 0x18); -+ -+ common = true; -+ } else { -+ if (BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 2);*/ -+ -+ halbtc8192e2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 6); -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+ common = true; -+ } else if (BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ -+ if (bt_hs_on) -+ return false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 2);*/ -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 6); -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+ common = true; -+ } else { -+ -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ common = false; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 1);*/ -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 21); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, -+ NORMAL_EXEC, 6); -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, -+ NORMAL_EXEC, 0); -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, -+ false, false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ common = true; -+ } -+ } -+ } -+ -+ return common; -+} -+void halbtc8192e2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, -+ IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) -+{ -+ static s32 up, dn, m, n, wait_count; -+ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ -+ u8 retry_count = 0; -+ -+ -+ if (!coex_dm->auto_tdma_adjust) { -+ coex_dm->auto_tdma_adjust = true; -+ { -+ if (sco_hid) { -+ if (tx_pause) { -+ if (max_interval == 1) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 13); -+ coex_dm->ps_tdma_du_adj_type = -+ 13; -+ } else if (max_interval == 2) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (max_interval == 3) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } -+ } else { -+ if (max_interval == 1) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = -+ 9; -+ } else if (max_interval == 2) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (max_interval == 3) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } -+ } -+ } else { -+ if (tx_pause) { -+ if (max_interval == 1) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 5); -+ coex_dm->ps_tdma_du_adj_type = -+ 5; -+ } else if (max_interval == 2) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (max_interval == 3) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } -+ } else { -+ if (max_interval == 1) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (max_interval == 2) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (max_interval == 3) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } -+ } -+ } -+ } -+ /* ============ */ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } else { -+ /* accquire the BT TRx retry count from BT_Info byte2 */ -+ retry_count = coex_sta->bt_retry_cnt; -+ result = 0; -+ wait_count++; -+ -+ if (retry_count == -+ 0) { /* no retry in the last 2-second duration */ -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ -+ wait_count = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ } -+ } else if (retry_count <= -+ 3) { /* <=3 retry in the last 2-second duration */ -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ -+ if (wait_count <= 2) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ -+ if (wait_count == 1) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ -+ if (max_interval == 1) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 5); -+ coex_dm->ps_tdma_du_adj_type = 5; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 13); -+ coex_dm->ps_tdma_du_adj_type = 13; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 5); -+ coex_dm->ps_tdma_du_adj_type = -+ 5; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 13); -+ coex_dm->ps_tdma_du_adj_type = -+ 13; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 1); -+ coex_dm->ps_tdma_du_adj_type = 1; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 71); -+ coex_dm->ps_tdma_du_adj_type = -+ 71; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = -+ 9; -+ } -+ } -+ } -+ } else if (max_interval == 2) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } -+ } -+ } -+ } else if (max_interval == 3) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8192e2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8192e2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } -+ } -+ } -+ } -+ } -+ -+ /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ -+ /* then we have to adjust it back to the previous record one. */ -+ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { -+ boolean scan = false, link = false, roam = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", -+ coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (!scan && !link && !roam) -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ coex_dm->ps_tdma_du_adj_type); -+ else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+} -+ -+/* ****************** -+ * pstdma for wifi rssi low -+ * ****************** */ -+void halbtc8192e2ant_tdma_duration_adjust_for_wifi_rssi_low( -+ IN struct btc_coexist *btcoexist/* , */ /* IN u8 wifi_status */) -+{ -+ static s32 up, dn, m, n, wait_count; -+ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ -+ u8 retry_count = 0, bt_info_ext; -+ -+ coex_dm->auto_tdma_adjust = false; -+ -+ retry_count = coex_sta->bt_retry_cnt; -+ bt_info_ext = coex_sta->bt_info_ext; -+ -+ if (!coex_dm->auto_tdma_adjust_low_rssi) { -+ coex_dm->auto_tdma_adjust_low_rssi = true; -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 81); -+ coex_dm->ps_tdma_du_adj_type = 81; -+ /* ============ */ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } else { -+ /*acquire the BT TRx retry count from BT_Info byte2*/ -+ /* retry_count = coex_sta->bt_retry_cnt;*/ -+ /* bt_info_ext = coex_sta->bt_info_ext; */ -+ result = 0; -+ wait_count++; -+ -+ if ((coex_sta->low_priority_tx) > 1050 || -+ (coex_sta->low_priority_rx) > 1250) -+ retry_count++; -+ -+ if (retry_count == -+ 0) { /* no retry in the last 2-second duration */ -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ -+ wait_count = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ } -+ } else if (retry_count <= -+ 3) { /* <=3 retry in the last 2-second duration */ -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ -+ if (wait_count <= 2) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ -+ if (wait_count == 1) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 80) { -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 81); -+ coex_dm->ps_tdma_du_adj_type = 81; -+ } else if (coex_dm->cur_ps_tdma == 81) { -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 82); -+ coex_dm->ps_tdma_du_adj_type = 82; -+ } else if (coex_dm->cur_ps_tdma == 82) { -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 83); -+ coex_dm->ps_tdma_du_adj_type = 83; -+ } else if (coex_dm->cur_ps_tdma == 83) { -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 84); -+ coex_dm->ps_tdma_du_adj_type = 84; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 84) { -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 83); -+ coex_dm->ps_tdma_du_adj_type = 83; -+ } else if (coex_dm->cur_ps_tdma == 83) { -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 82); -+ coex_dm->ps_tdma_du_adj_type = 82; -+ } else if (coex_dm->cur_ps_tdma == 82) { -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 81); -+ coex_dm->ps_tdma_du_adj_type = 81; -+ } else if ((coex_dm->cur_ps_tdma == 81) && (coex_sta->scan_ap_num <= 5)) { -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 81); -+ coex_dm->ps_tdma_du_adj_type = 81; -+ } -+ } -+ -+ if (coex_dm->cur_ps_tdma != 80 && -+ coex_dm->cur_ps_tdma != 81 && -+ coex_dm->cur_ps_tdma != 82 && -+ coex_dm->cur_ps_tdma != 83 && -+ coex_dm->cur_ps_tdma != 84) { -+ /* recover to previous adjust type */ -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ coex_dm->ps_tdma_du_adj_type); -+ } -+ } -+} -+ -+ -+void halbtc8192e2ant_get_bt_rssi_threshold(IN struct btc_coexist *btcoexist, -+ IN u8 *pThres0, IN u8 *pThres1) -+{ -+ u8 ant_type; -+ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ ant_type = board_info->ant_type; -+ -+ switch (ant_type) { -+ case BTC_ANT_TYPE_0: -+ *pThres0 = 100; -+ *pThres1 = 100; -+ break; -+ case BTC_ANT_TYPE_1: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ case BTC_ANT_TYPE_2: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ case BTC_ANT_TYPE_3: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ case BTC_ANT_TYPE_4: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+ -+ -+/* SCO only or SCO+PAN(HS) */ -+void halbtc8192e2ant_action_sco(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ u32 wifi_bw; -+ u8 btThresh0 = 0, btThresh1 = 0; -+ -+ halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); -+ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); -+ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ else -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ else -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+void halbtc8192e2ant_action_sco_pan(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ u32 wifi_bw; -+ u8 btThresh0 = 0, btThresh1 = 0; -+ -+ -+ halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); -+ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); -+ -+ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); -+ -+ if ((BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ else -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 10); -+ else -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); -+ -+ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ else -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+ -+void halbtc8192e2ant_action_hid(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 anttype = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); -+ -+ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); -+ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); -+ -+ if (anttype == 0) { -+ /*ANTTYPE = 0 92E 2ant with SPDT*/ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if (anttype == 1) { -+ /*92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation*/ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if (anttype == 2) { -+ /*ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation*/ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ } else { -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ } -+ } else if (anttype == 3) { -+ /*ANTTYPE = 3, 92E 3ant with good ant. isolation*/ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else { -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } -+ } -+ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -+void halbtc8192e2ant_action_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ boolean long_dist = false; -+ u8 anttype = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); -+ -+ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); -+ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); -+ -+ if (anttype == 0) { -+ /*ANTTYPE = 0 92E 2ant with SPDT*/ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ } else if (anttype == 1) { -+ /*92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation*/ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 25); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ } else { -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ } -+ } else if (anttype == 2) { -+ /*ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation*/ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } else { -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ } -+ } else if (anttype == 3) { -+ /*ANTTYPE = 3, 92E 3ant with good ant. isolation*/ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } -+ -+ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, true, 0x06); -+ else -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+void halbtc8192e2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); -+ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); -+ -+ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ halbtc8192e2ant_tdma_duration_adjust(btcoexist, false, true, 2); -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ } else if ((bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { -+ halbtc8192e2ant_tdma_duration_adjust(btcoexist, false, false, 2); -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ } else if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8192e2ant_tdma_duration_adjust(btcoexist, false, false, 2); -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ } -+ -+ /* sw mechanism */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, true, 0x6); -+ } else { -+ halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, true, 0x6); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, true, 0x6); -+ } else { -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, true, 0x6); -+ } -+ } -+} -+ -+void halbtc8192e2ant_action_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 btThresh0 = 0, btThresh1 = 0; -+ -+ halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); -+ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); -+ /*wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0);*/ -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); -+ else -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 85); -+ -+ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ else -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+/* PAN(HS) only */ -+void halbtc8192e2ant_action_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); -+ -+ /* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 1);*/ -+ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if ((bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+/* PAN(EDR)+A2DP */ -+void halbtc8192e2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 btThresh0 = 0, btThresh1 = 0; -+ -+ halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); -+ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); -+ /*wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0);*/ -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ -+ if ((BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 4); -+ else -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); -+ -+ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ else -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+} -+ -+void halbtc8192e2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 btThresh0 = 0, btThresh1 = 0; -+ -+ halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); -+ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); -+ -+ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); -+ -+ if ((BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ else -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 10); -+ else -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); -+ -+ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ else -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ -+} -+ -+/* HID+A2DP+PAN(EDR) */ -+void halbtc8192e2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 btThresh0 = 0, btThresh1 = 0; -+ -+ halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); -+ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); -+ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); -+ -+ if ((BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ else -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 4); -+ else -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); -+ -+ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ else -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+void halbtc8192e2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 btThresh0 = 0, btThresh1 = 0, anttype = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); -+ -+ wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); -+ bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); -+ -+ if (anttype == 0) { -+ /*92E 2ant with SPDT*/ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ -+ } else if (anttype == 1) { -+ /*92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation*/ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 25); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ } else { -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ } -+ } else if (anttype == 2) { -+ /*ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation*/ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 25); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ } else { -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ } -+ } else if (anttype == 3) { -+ /*ANTTYPE = 3, 92E 3ant with good ant. isolation*/ -+ halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } -+ -+ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && -+ (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, true, 0x06); -+ else -+ halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+void halbtc8192e2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ u8 algorithm = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ algorithm = halbtc8192e2ant_action_algorithm(btcoexist); -+ if (coex_sta->c2h_bt_inquiry_page && -+ (BT_8192E_2ANT_COEX_ALGO_PANHS != algorithm)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under inquiry/page scan !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_action_bt_inquiry(btcoexist); -+ return; -+ } -+ -+ coex_dm->cur_algorithm = algorithm; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", -+ coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ -+ if (halbtc8192e2ant_is_common_action(btcoexist)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant common.\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->auto_tdma_adjust = false; -+ coex_dm->auto_tdma_adjust_low_rssi = false; -+ -+ } else { -+ if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", -+ coex_dm->pre_algorithm, coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ coex_dm->auto_tdma_adjust = false; -+ coex_dm->auto_tdma_adjust_low_rssi = false; -+ -+ } -+ switch (coex_dm->cur_algorithm) { -+ case BT_8192E_2ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_action_sco(btcoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_SCO_PAN: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = SCO+PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_action_sco_pan(btcoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_action_hid(btcoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_action_a2dp(btcoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_action_a2dp_pan_hs(btcoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_action_pan_edr(btcoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_action_pan_hs(btcoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_action_pan_edr_a2dp(btcoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_action_pan_edr_hid(btcoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_action_hid_a2dp_pan_edr( -+ btcoexist); -+ break; -+ case BT_8192E_2ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_action_hid_a2dp(btcoexist); -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = unknown!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_coex_all_off(btcoexist); -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+} -+ -+void halbtc8192e2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean back_up) -+{ -+ u16 u16tmp = 0; -+ u8 u8tmp = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 2Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (back_up) { -+ /* backup rf 0x1e value */ -+ coex_dm->bt_rf_0x1e_backup = -+ btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1e, -+ 0xfffff); -+ -+ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, -+ 0x430); -+ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, -+ 0x434); -+ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( -+ btcoexist, 0x42a); -+ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( -+ btcoexist, 0x456); -+ } -+ -+ /* antenna sw ctrl to bt */ -+ halbtc8192e2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, true, false); -+ -+ halbtc8192e2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ /* antenna switch control parameter */ -+ btcoexist->btc_write_4byte(btcoexist, 0x858, 0x55555555); -+ -+ /* coex parameters */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); -+ /* 0x790[5:0]=0x5 */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); -+ u8tmp &= 0xc0; -+ u8tmp |= 0x5; -+ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); -+ -+ /* enable counter statistics */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); -+ -+ /* enable PTA */ -+ btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); -+ /* enable mailbox interface */ -+ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x40); -+ u16tmp |= BIT(9); -+ btcoexist->btc_write_2byte(btcoexist, 0x40, u16tmp); -+ -+ /* enable PTA I2C mailbox */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x101); -+ u8tmp |= BIT(4); -+ btcoexist->btc_write_1byte(btcoexist, 0x101, u8tmp); -+ -+ /* enable bt clock when wifi is disabled. */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x93); -+ u8tmp |= BIT(0); -+ btcoexist->btc_write_1byte(btcoexist, 0x93, u8tmp); -+ /* enable bt clock when suspend. */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x7); -+ u8tmp |= BIT(0); -+ btcoexist->btc_write_1byte(btcoexist, 0x7, u8tmp); -+} -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8192e2ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8192e2ant_ -+ * ************************************************************ */ -+void ex_halbtc8192e2ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+} -+ -+void ex_halbtc8192e2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ halbtc8192e2ant_init_hw_config(btcoexist, true); -+} -+ -+void ex_halbtc8192e2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8192e2ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8192e2ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_stack_info *stack_info = &btcoexist->stack_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u16 u16tmp[4]; -+ u32 u32tmp[4]; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", -+ "Ant PG number/ Ant mechanism:", -+ board_info->pg_ant_num, board_info->btdm_ant_num); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Antenna type:", -+ board_info->ant_type); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", -+ "CoexVer/ FwVer/ PatchVer", -+ glcoex_ver_date_8192e_2ant, glcoex_ver_8192e_2ant, fw_ver, -+ bt_patch_ver, bt_patch_ver); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") -+ : ((BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi, coex_sta->bt_retry_cnt); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP", -+ stack_info->sco_exist, stack_info->hid_exist, -+ stack_info->pan_exist, stack_info->a2dp_exist); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "BT Info A2DP rate", -+ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); -+ CL_PRINTF(cli_buf); -+ -+ for (i = 0; i < BT_INFO_SRC_8192E_2ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8192e_2ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "SS Type", -+ coex_dm->cur_ss_type); -+ CL_PRINTF(cli_buf); -+ -+ /* Sw mechanism */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Sw mechanism]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", -+ "SM1[ShRf/ LpRA/ LimDig]", -+ coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, -+ coex_dm->limited_dig); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", -+ "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", -+ coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, -+ coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); -+ CL_PRINTF(cli_buf); -+ -+ /* Fw mechanism */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Fw mechanism]============"); -+ CL_PRINTF(cli_buf); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ coex_dm->auto_tdma_adjust); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", -+ "DecBtPwr/ IgnWlanAct", -+ coex_dm->cur_bt_dec_pwr_lvl, coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", -+ "RF-A, 0x1e initVal", -+ coex_dm->bt_rf_0x1e_backup); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "backup ARFR1/ARFR2/RL/AMaxTime", -+ coex_dm->backup_arfr_cnt1, coex_dm->backup_arfr_cnt2, -+ coex_dm->backup_retry_limit, -+ coex_dm->backup_ampdu_max_time); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "0x430/0x434/0x42a/0x456", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc04); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xd04); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x90c); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0xc04/ 0xd04/ 0x90c", -+ u32tmp[0], u32tmp[1], u32tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x778", -+ u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x92c); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x930); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x92c/ 0x930", -+ (u8tmp[0]), u32tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x4f); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x40/ 0x4f", -+ u8tmp[0], u8tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x550(bcn ctrl)/0x522", -+ u32tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", -+ u32tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(hp rx[31:16]/tx[15:0])", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(lp rx[31:16]/tx[15:0])", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+#if (BT_AUTO_REPORT_ONLY_8192E_2ANT == 1) -+ halbtc8192e2ant_monitor_bt_ctr(btcoexist); -+#endif -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void ex_halbtc8192e2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ halbtc8192e2ant_coex_all_off(btcoexist); -+ halbtc8192e2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, -+ true); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = false; -+ } -+} -+ -+void ex_halbtc8192e2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ } -+} -+ -+void ex_halbtc8192e2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (BTC_SCAN_START == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ } else if (BTC_SCAN_FINISH == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); -+ -+ } -+} -+ -+void ex_halbtc8192e2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (BTC_ASSOCIATE_START == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ } else if (BTC_ASSOCIATE_FINISH == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8192e2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ h2c_parameter[0] = 0x1; -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -+} -+ -+void ex_halbtc8192e2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (type == BTC_PACKET_DHCP) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], DHCP Packet notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8192e2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source = 0; -+ boolean bt_busy = false, limited_dig = false; -+ boolean wifi_connected = false; -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8192E_2ANT_MAX) -+ rsp_source = BT_INFO_SRC_8192E_2ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (BT_INFO_SRC_8192E_2ANT_WIFI_FW != rsp_source) { -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; -+ -+ coex_sta->bt_rssi = -+ coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ if ((coex_sta->bt_info_ext & BIT(1))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (wifi_connected) -+ ex_halbtc8192e2ant_media_status_notify( -+ btcoexist, BTC_MEDIA_CONNECT); -+ else -+ ex_halbtc8192e2ant_media_status_notify( -+ btcoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ if ((coex_sta->bt_info_ext & BIT(3))) { -+ if (!btcoexist->manual_control && -+ !btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8192e2ant_ignore_wlan_act(btcoexist, -+ FORCE_EXEC, false); -+ } -+ } else { -+ /* BT already NOT ignore Wlan active, do nothing here. */ -+ } -+ -+#if (BT_AUTO_REPORT_ONLY_8192E_2ANT == 0) -+ if ((coex_sta->bt_info_ext & BIT(4))) { -+ /* BT auto report already enabled, do nothing */ -+ } else -+ halbtc8192e2ant_bt_auto_report(btcoexist, FORCE_EXEC, -+ true); -+#endif -+ } -+ -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (bt_info & BT_INFO_8192E_2ANT_B_INQ_PAGE) -+ coex_sta->c2h_bt_inquiry_page = true; -+ else -+ coex_sta->c2h_bt_inquiry_page = false; -+ -+ /* set link exist status */ -+ if (!(bt_info & BT_INFO_8192E_2ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (bt_info & BT_INFO_8192E_2ANT_B_FTP) -+ coex_sta->pan_exist = true; -+ else -+ coex_sta->pan_exist = false; -+ if (bt_info & BT_INFO_8192E_2ANT_B_A2DP) -+ coex_sta->a2dp_exist = true; -+ else -+ coex_sta->a2dp_exist = false; -+ if (bt_info & BT_INFO_8192E_2ANT_B_HID) -+ coex_sta->hid_exist = true; -+ else -+ coex_sta->hid_exist = false; -+ if (bt_info & BT_INFO_8192E_2ANT_B_SCO_ESCO) -+ coex_sta->sco_exist = true; -+ else -+ coex_sta->sco_exist = false; -+ } -+ -+ halbtc8192e2ant_update_bt_link_info(btcoexist); -+ -+ if (!(bt_info & BT_INFO_8192E_2ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info == -+ BT_INFO_8192E_2ANT_B_CONNECTION) { /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if ((bt_info & BT_INFO_8192E_2ANT_B_SCO_ESCO) || -+ (bt_info & BT_INFO_8192E_2ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8192E_2ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info & BT_INFO_8192E_2ANT_B_ACL_BUSY) { -+ coex_dm->bt_status = BT_8192E_2ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_dm->bt_status = BT_8192E_2ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if ((BT_8192E_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8192E_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8192E_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { -+ bt_busy = true; -+ limited_dig = true; -+ } else { -+ bt_busy = false; -+ limited_dig = false; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ coex_dm->limited_dig = limited_dig; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); -+ -+ halbtc8192e2ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8192e2ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8192e2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, true); -+ halbtc8192e2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ ex_halbtc8192e2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+void ex_halbtc8192e2ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+#if (BT_AUTO_REPORT_ONLY_8192E_2ANT == 0) -+ halbtc8192e2ant_query_bt_info(btcoexist); -+ halbtc8192e2ant_monitor_bt_ctr(btcoexist); -+ halbtc8192e2ant_monitor_bt_enable_disable(btcoexist); -+#else -+ if (halbtc8192e2ant_is_wifi_status_changed(btcoexist) || -+ coex_dm->auto_tdma_adjust) -+ halbtc8192e2ant_run_coexist_mechanism(btcoexist); -+#endif -+} -+ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8192e2Ant.h 2018-02-11 21:44:27.144146040 +0200 -@@ -0,0 +1,199 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8192E_SUPPORT == 1) -+/* ******************************************* -+ * The following is for 8192E 2Ant BT Co-exist definition -+ * ******************************************* */ -+#define BT_AUTO_REPORT_ONLY_8192E_2ANT 0 -+ -+#define BT_INFO_8192E_2ANT_B_FTP BIT(7) -+#define BT_INFO_8192E_2ANT_B_A2DP BIT(6) -+#define BT_INFO_8192E_2ANT_B_HID BIT(5) -+#define BT_INFO_8192E_2ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8192E_2ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8192E_2ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8192E_2ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8192E_2ANT_B_CONNECTION BIT(0) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT 2 -+#define NOISY_AP_NUM_THRESH_8192E 10 -+ -+enum bt_info_src_8192e_2ant { -+ BT_INFO_SRC_8192E_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8192E_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8192E_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8192E_2ANT_MAX -+}; -+ -+enum bt_8192e_2ant_bt_status { -+ BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8192E_2ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8192E_2ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8192E_2ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8192E_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8192E_2ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8192e_2ant_coex_algo { -+ BT_8192E_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8192E_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8192E_2ANT_COEX_ALGO_SCO_PAN = 0x2, -+ BT_8192E_2ANT_COEX_ALGO_HID = 0x3, -+ BT_8192E_2ANT_COEX_ALGO_A2DP = 0x4, -+ BT_8192E_2ANT_COEX_ALGO_A2DP_PANHS = 0x5, -+ BT_8192E_2ANT_COEX_ALGO_PANEDR = 0x6, -+ BT_8192E_2ANT_COEX_ALGO_PANHS = 0x7, -+ BT_8192E_2ANT_COEX_ALGO_PANEDR_A2DP = 0x8, -+ BT_8192E_2ANT_COEX_ALGO_PANEDR_HID = 0x9, -+ BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0xa, -+ BT_8192E_2ANT_COEX_ALGO_HID_A2DP = 0xb, -+ BT_8192E_2ANT_COEX_ALGO_MAX = 0xc -+}; -+ -+struct coex_dm_8192e_2ant { -+ /* fw mechanism */ -+ u8 pre_bt_dec_pwr_lvl; -+ u8 cur_bt_dec_pwr_lvl; -+ u8 pre_fw_dac_swing_lvl; -+ u8 cur_fw_dac_swing_lvl; -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean reset_tdma_adjust; -+ boolean auto_tdma_adjust; -+ boolean auto_tdma_adjust_low_rssi; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ -+ /* sw mechanism */ -+ boolean pre_rf_rx_lpf_shrink; -+ boolean cur_rf_rx_lpf_shrink; -+ u32 bt_rf_0x1e_backup; -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ boolean pre_dac_swing_on; -+ u32 pre_dac_swing_lvl; -+ boolean cur_dac_swing_on; -+ u32 cur_dac_swing_lvl; -+ boolean pre_adc_back_off; -+ boolean cur_adc_back_off; -+ boolean pre_agc_table_en; -+ boolean cur_agc_table_en; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ -+ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ -+ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ -+ u16 backup_retry_limit; -+ u8 backup_ampdu_max_time; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ u8 pre_ss_type; -+ u8 cur_ss_type; -+ -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ -+ u32 pre_ra_mask; -+ u32 cur_ra_mask; -+ u8 cur_ra_mask_type; -+ u8 pre_arfr_type; -+ u8 cur_arfr_type; -+ u8 pre_retry_limit_type; -+ u8 cur_retry_limit_type; -+ u8 pre_ampdu_time_type; -+ u8 cur_ampdu_time_type; -+}; -+ -+struct coex_sta_8192e_2ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ u8 bt_rssi; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8192E_2ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8192E_2ANT_MAX]; -+ boolean c2h_bt_inquiry_page; -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ u8 scan_ap_num; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8192e2ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8192e2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8192e2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8192e2ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e2ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8192e2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8192e2ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8192e2ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8192e2ant_display_coex_info(IN struct btc_coexist *btcoexist); -+ -+#else /* #if (RTL8192E_SUPPORT == 1) */ -+#define ex_halbtc8192e2ant_power_on_setting(btcoexist) -+#define ex_halbtc8192e2ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8192e2ant_init_coex_dm(btcoexist) -+#define ex_halbtc8192e2ant_ips_notify(btcoexist, type) -+#define ex_halbtc8192e2ant_lps_notify(btcoexist, type) -+#define ex_halbtc8192e2ant_scan_notify(btcoexist, type) -+#define ex_halbtc8192e2ant_connect_notify(btcoexist, type) -+#define ex_halbtc8192e2ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8192e2ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8192e2ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8192e2ant_halt_notify(btcoexist) -+#define ex_halbtc8192e2ant_periodical(btcoexist) -+#define ex_halbtc8192e2ant_display_coex_info(btcoexist) -+ -+#endif -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.c 2018-02-11 21:44:27.145146055 +0200 -@@ -0,0 +1,4592 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8703B Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8703B_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8703b_1ant glcoex_dm_8703b_1ant; -+static struct coex_dm_8703b_1ant *coex_dm = &glcoex_dm_8703b_1ant; -+static struct coex_sta_8703b_1ant glcoex_sta_8703b_1ant; -+static struct coex_sta_8703b_1ant *coex_sta = &glcoex_sta_8703b_1ant; -+static struct psdscan_sta_8703b_1ant gl_psd_scan_8703b_1ant; -+static struct psdscan_sta_8703b_1ant *psd_scan = &gl_psd_scan_8703b_1ant; -+ -+ -+const char *const glbt_info_src_8703b_1ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8703b_1ant = 20160218; -+u32 glcoex_ver_8703b_1ant = 0x09; -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8703b1ant_ -+ * ************************************************************ */ -+u8 halbtc8703b1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_bt_rssi_state; -+ } -+ -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8703b1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_wifi_rssi_state[index]; -+ } -+ -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8703b1ant_update_ra_mask(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 dis_rate_mask) -+{ -+ coex_dm->cur_ra_mask = dis_rate_mask; -+ -+ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, -+ &coex_dm->cur_ra_mask); -+ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -+} -+ -+void halbtc8703b1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ coex_dm->cur_arfr_type = type; -+ -+ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { -+ switch (coex_dm->cur_arfr_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_4byte(btcoexist, 0x430, -+ coex_dm->backup_arfr_cnt1); -+ btcoexist->btc_write_4byte(btcoexist, 0x434, -+ coex_dm->backup_arfr_cnt2); -+ break; -+ case 1: -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x01010101); -+ } else { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -+} -+ -+void halbtc8703b1ant_retry_limit(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_retry_limit_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_retry_limit_type != -+ coex_dm->cur_retry_limit_type)) { -+ switch (coex_dm->cur_retry_limit_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ coex_dm->backup_retry_limit); -+ break; -+ case 1: /* retry limit=8 */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -+} -+ -+void halbtc8703b1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_ampdu_time_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { -+ switch (coex_dm->cur_ampdu_time_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ coex_dm->backup_ampdu_max_time); -+ break; -+ case 1: /* AMPDU timw = 0x38 * 32us */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -+} -+ -+void halbtc8703b1ant_limited_tx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, -+ IN u8 retry_limit_type, IN u8 ampdu_time_type) -+{ -+ switch (ra_mask_type) { -+ case 0: /* normal mode */ -+ halbtc8703b1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0); -+ break; -+ case 1: /* disable cck 1/2 */ -+ halbtc8703b1ant_update_ra_mask(btcoexist, force_exec, -+ 0x00000003); -+ break; -+ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ -+ halbtc8703b1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8703b1ant_auto_rate_fallback_retry(btcoexist, force_exec, -+ arfr_type); -+ halbtc8703b1ant_retry_limit(btcoexist, force_exec, retry_limit_type); -+ halbtc8703b1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -+} -+ -+void halbtc8703b1ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+void halbtc8703b1ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ coex_sta->c2h_bt_info_req_sent = true; -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+} -+ -+void halbtc8703b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ static u8 num_of_bt_counter_chk = 0, cnt_slave = 0; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ -+ /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); -+ -+ BTC_TRACE(trace_buf); -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+ -+ if ((coex_sta->low_priority_tx > 1150) && -+ (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->pop_event_cnt++; -+ -+ if ((coex_sta->low_priority_rx >= 1150) && (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) -+ && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist)) { -+ if (cnt_slave >= 3) { -+ bt_link_info->slave_role = true; -+ cnt_slave = 3; -+ } else -+ cnt_slave++; -+ } else { -+ if (cnt_slave == 0) { -+ bt_link_info->slave_role = false; -+ cnt_slave = 0; -+ } else -+ cnt_slave--; -+ -+ } -+ -+ if ((coex_sta->high_priority_tx == 0) && (coex_sta->high_priority_rx == 0) && (coex_sta->low_priority_tx == 0) && -+ (coex_sta->low_priority_rx == 0)) { -+ num_of_bt_counter_chk++; -+ if (num_of_bt_counter_chk >= 3) { -+ halbtc8703b1ant_query_bt_info(btcoexist); -+ num_of_bt_counter_chk = 0; -+ } -+ } -+ -+ -+#if 0 -+ /* Add Hi-Pri Tx/Rx counter to avoid false detection */ -+ if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && -+ (coex_sta->high_priority_tx + coex_sta->high_priority_rx -+ >= 160) -+ && (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->bt_hi_pri_link_exist = true; -+ else -+ coex_sta->bt_hi_pri_link_exist = false; -+ -+ if ((coex_sta->acl_busy) && -+ (coex_sta->num_of_profile == 0)) { -+ if (coex_sta->low_priority_tx + -+ coex_sta->low_priority_rx >= 160) { -+ coex_sta->pan_exist = true; -+ coex_sta->num_of_profile++; -+ coex_sta->wrong_profile_notification++; -+ } -+ } -+#endif -+ -+} -+ -+ -+void halbtc8703b1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -+{ -+ s32 wifi_rssi = 0; -+ boolean wifi_busy = false, wifi_under_b_mode = false; -+ static u8 cck_lock_counter = 0; -+ u32 total_cnt; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ if (coex_sta->under_ips) { -+ coex_sta->crc_ok_cck = 0; -+ coex_sta->crc_ok_11g = 0; -+ coex_sta->crc_ok_11n = 0; -+ coex_sta->crc_ok_11n_agg = 0; -+ -+ coex_sta->crc_err_cck = 0; -+ coex_sta->crc_err_11g = 0; -+ coex_sta->crc_err_11n = 0; -+ coex_sta->crc_err_11n_agg = 0; -+ } else { -+ coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, -+ 0xf88); -+ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf94); -+ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf90); -+ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xfb8); -+ -+ coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, -+ 0xf84); -+ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf96); -+ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf92); -+ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xfba); -+ } -+ -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); -+ -+ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { -+ total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + -+ coex_sta->crc_ok_11n + -+ coex_sta->crc_ok_11n_agg; -+ -+ if ((coex_dm->bt_status == BT_8703B_1ANT_BT_STATUS_ACL_BUSY) || -+ (coex_dm->bt_status == -+ BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (coex_dm->bt_status == -+ BT_8703B_1ANT_BT_STATUS_SCO_BUSY)) { -+ if (coex_sta->crc_ok_cck > (total_cnt - -+ coex_sta->crc_ok_cck)) { -+ if (cck_lock_counter < 3) -+ cck_lock_counter++; -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ if (!coex_sta->pre_ccklock) { -+ -+ if (cck_lock_counter >= 3) -+ coex_sta->cck_lock = true; -+ else -+ coex_sta->cck_lock = false; -+ } else { -+ if (cck_lock_counter == 0) -+ coex_sta->cck_lock = false; -+ else -+ coex_sta->cck_lock = true; -+ } -+ -+ if (coex_sta->cck_lock) -+ coex_sta->cck_ever_lock = true; -+ -+ coex_sta->pre_ccklock = coex_sta->cck_lock; -+ -+ -+} -+ -+boolean halbtc8703b1ant_is_wifibt_status_changed(IN struct btc_coexist *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false, pre_bt_off = false; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (coex_sta->bt_disabled != pre_bt_off) { -+ pre_bt_off = coex_sta->bt_disabled; -+ -+ if (coex_sta->bt_disabled) -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ else -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ -+ BTC_TRACE(trace_buf); -+ return true; -+ } -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ } -+ -+ return false; -+} -+ -+void halbtc8703b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; -+ bt_link_info->acl_busy = coex_sta->acl_busy; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+} -+ -+void halbtc8703b1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ h2c_parameter[0] = -+ 0x1; /* enable BT AFH skip WL channel for 8703b because BT Rx LO interference */ -+ /* h2c_parameter[0] = 0x0; */ -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -+ -+} -+ -+void halbtc8703b1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8703b1ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8703b1ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8703b1ant_set_fw_low_penalty_ra(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ -+ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+} -+ -+void halbtc8703b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8703b1ant_set_fw_low_penalty_ra(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8703b1ant_write_score_board( -+ IN struct btc_coexist *btcoexist, -+ IN u16 bitpos, -+ IN BOOLEAN state -+) -+{ -+ -+ static u16 originalval = 0x8002; -+ -+ if (state) -+ originalval = originalval | bitpos; -+ else -+ originalval = originalval & (~bitpos); -+ -+ -+ btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); -+#if 0 -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "\n [BTCoex], ********** Write Scoreboard = %x**********\n", -+ originalval); -+ BTC_TRACE(trace_buf); -+#endif -+ -+} -+ -+void halbtc8703b1ant_read_score_board( -+ IN struct btc_coexist *btcoexist, -+ IN u16 *score_board_val -+) -+{ -+ -+ *score_board_val = (btcoexist->btc_read_2byte(btcoexist, -+ 0xaa)) & 0x7fff; -+} -+ -+void halbtc8703b1ant_post_activestate_to_bt( -+ IN struct btc_coexist *btcoexist, -+ IN boolean wifi_active -+) -+{ -+ -+ if (wifi_active) -+ halbtc8703b1ant_write_score_board(btcoexist, (u16) BIT(0), TRUE); -+ else -+ halbtc8703b1ant_write_score_board(btcoexist, (u16) BIT(0), FALSE); -+ -+ /* The BT should set "No Shunt-down" mode if WL = Active for BT Synthesizer on/off interference WL Lo issue at 8703b b-cut. */ -+ -+} -+ -+void halbtc8703b1ant_post_onoffState_to_bt( -+ IN struct btc_coexist *btcoexist, -+ IN boolean wifi_on -+) -+{ -+ -+ if (wifi_on) -+ halbtc8703b1ant_write_score_board(btcoexist, (u16) BIT(1), TRUE); -+ else -+ halbtc8703b1ant_write_score_board(btcoexist, (u16) BIT(1), FALSE); -+ -+} -+ -+void halbtc8703b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ u16 u16tmp; -+ -+ /* This function check if bt is disabled */ -+#if 1 -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ -+ -+#else /* 8703b BT can't show correct on/off status in scoreboard[1] 2015/11/26 */ -+ -+ halbtc8703b1ant_read_score_board(btcoexist, &u16tmp); -+ -+ bt_active = u16tmp & BIT(1); -+ -+ -+#endif -+ -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ } else { -+ -+ bt_disable_cnt++; -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ bt_disable_cnt = 2; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ } -+ -+ -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ -+ } -+} -+ -+void halbtc8703b1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, -+ IN boolean isenable) -+{ -+ -+#if (BT_8703B_1ANT_ENABLE_GNTBT_TO_GPIO14 == 1) -+ if (isenable) { -+ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); -+ -+ /* enable GNT_BT debug to GPIO */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); -+ } else { -+ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); -+ -+ /* Disable GNT_BT debug to GPIO, and enable chip_wakeup_host */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x1); -+ } -+#endif -+} -+ -+u32 halbtc8703b1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, -+ IN u16 reg_addr) -+{ -+ u32 j = 0; -+ -+ -+ /* wait for ready bit before access 0x7c0 */ -+ btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr); -+ -+ do { -+ j++; -+ } while (((btcoexist->btc_read_1byte(btcoexist, -+ 0x7c3)&BIT(5)) == 0) && -+ (j < BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); -+ -+ -+ return btcoexist->btc_read_4byte(btcoexist, -+ 0x7c8); /* get read data */ -+ -+} -+ -+void halbtc8703b1ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist, -+ IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) -+{ -+ u32 val, i = 0, j = 0, bitpos = 0; -+ -+ -+ if (bit_mask == 0x0) -+ return; -+ if (bit_mask == 0xffffffff) { -+ btcoexist->btc_write_4byte(btcoexist, 0x7c4, -+ reg_value); /* put write data */ -+ -+ /* wait for ready bit before access 0x7c0 */ -+ do { -+ j++; -+ } while (((btcoexist->btc_read_1byte(btcoexist, -+ 0x7c3)&BIT(5)) == 0) && -+ (j < BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); -+ -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x7c0, -+ 0xc00F0000 | reg_addr); -+ } else { -+ for (i = 0; i <= 31; i++) { -+ if (((bit_mask >> i) & 0x1) == 0x1) { -+ bitpos = i; -+ break; -+ } -+ } -+ -+ /* read back register value before write */ -+ val = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, -+ reg_addr); -+ val = (val & (~bit_mask)) | (reg_value << bitpos); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x7c4, -+ val); /* put write data */ -+ -+ /* wait for ready bit before access 0x7c0 */ -+ do { -+ j++; -+ } while (((btcoexist->btc_read_1byte(btcoexist, -+ 0x7c3)&BIT(5)) == 0) && -+ (j < BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); -+ -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x7c0, -+ 0xc00F0000 | reg_addr); -+ -+ } -+ -+} -+ -+void halbtc8703b1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 val; -+ -+ val = (enable) ? 1 : 0; -+ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, -+ val); /* 0x38[7] */ -+ -+} -+ -+void halbtc8703b1ant_sw_mechanism(IN struct btc_coexist *btcoexist, -+ IN boolean low_penalty_ra) -+{ -+ halbtc8703b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -+} -+ -+void halbtc8703b1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_control) -+{ -+ u8 val; -+ -+ val = (wifi_control) ? 1 : 0; -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, -+ val); /* 0x70[26] */ -+ -+} -+ -+void halbtc8703b1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, -+ IN u8 control_block, IN boolean sw_control, IN u8 state) -+{ -+ u32 val = 0, bit_mask; -+ -+ state = state & 0x1; -+ val = (sw_control) ? ((state << 1) | 0x1) : 0; -+ -+ switch (control_block) { -+ case BT_8703B_1ANT_GNT_BLOCK_RFC_BB: -+ default: -+ bit_mask = 0xc000; -+ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[15:14] */ -+ bit_mask = 0x0c00; -+ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[11:10] */ -+ break; -+ case BT_8703B_1ANT_GNT_BLOCK_RFC: -+ bit_mask = 0xc000; -+ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[15:14] */ -+ break; -+ case BT_8703B_1ANT_GNT_BLOCK_BB: -+ bit_mask = 0x0c00; -+ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[11:10] */ -+ break; -+ -+ } -+ -+} -+ -+void halbtc8703b1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, -+ IN u8 control_block, IN boolean sw_control, IN u8 state) -+{ -+ u32 val = 0, bit_mask; -+ -+ state = state & 0x1; -+ val = (sw_control) ? ((state << 1) | 0x1) : 0; -+ -+ switch (control_block) { -+ case BT_8703B_1ANT_GNT_BLOCK_RFC_BB: -+ default: -+ bit_mask = 0x3000; -+ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[13:12] */ -+ bit_mask = 0x0300; -+ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[9:8] */ -+ break; -+ case BT_8703B_1ANT_GNT_BLOCK_RFC: -+ bit_mask = 0x3000; -+ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[13:12] */ -+ break; -+ case BT_8703B_1ANT_GNT_BLOCK_BB: -+ bit_mask = 0x0300; -+ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[9:8] */ -+ break; -+ -+ } -+ -+} -+ -+void halbtc8703b1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u8 table_type, IN u16 table_content) -+{ -+ u16 reg_addr = 0x0000; -+ -+ switch (table_type) { -+ case BT_8703B_1ANT_CTT_WL_VS_LTE: -+ reg_addr = 0xa0; -+ break; -+ case BT_8703B_1ANT_CTT_BT_VS_LTE: -+ reg_addr = 0xa4; -+ break; -+ } -+ -+ if (reg_addr != 0x0000) -+ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, -+ 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ -+ -+ -+} -+ -+ -+void halbtc8703b1ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, -+ IN u8 table_type, IN u8 table_content) -+{ -+ u16 reg_addr = 0x0000; -+ -+ switch (table_type) { -+ case BT_8703B_1ANT_LBTT_WL_BREAK_LTE: -+ reg_addr = 0xa8; -+ break; -+ case BT_8703B_1ANT_LBTT_BT_BREAK_LTE: -+ reg_addr = 0xac; -+ break; -+ case BT_8703B_1ANT_LBTT_LTE_BREAK_WL: -+ reg_addr = 0xb0; -+ break; -+ case BT_8703B_1ANT_LBTT_LTE_BREAK_BT: -+ reg_addr = 0xb4; -+ break; -+ } -+ -+ if (reg_addr != 0x0000) -+ halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, -+ 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ -+ -+ -+} -+ -+void halbtc8703b1ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8703b1ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8703b1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8703b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ u32 break_table; -+ u8 select_table; -+ -+ coex_sta->coex_table_type = type; -+ -+ if (coex_sta->concurrent_rx_mode_on == true) { -+ break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ -+ select_table = -+ 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ -+ } else { -+ break_table = 0xffffff; -+ select_table = 0x3; -+ } -+ -+ switch (type) { -+ case 0: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x55555555, break_table, -+ select_table); -+ break; -+ case 1: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 2: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0xaa5a5a5a, 0xaa5a5a5a, break_table, -+ select_table); -+ break; -+ case 3: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0xaa555555, 0xaa5a5a5a, break_table, -+ select_table); -+ break; -+ case 4: -+ halbtc8703b1ant_coex_table(btcoexist, -+ force_exec, 0xaa555555, 0xaa5a5a5a, -+ break_table, select_table); -+ break; -+ case 5: -+ halbtc8703b1ant_coex_table(btcoexist, -+ force_exec, 0x5a5a5a5a, 0x5a5a5a5a, -+ break_table, select_table); -+ break; -+ case 6: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 7: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0xaaaaaaaa, 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 8: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, break_table, -+ select_table); -+ break; -+ case 9: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, break_table, -+ select_table); -+ break; -+ case 10: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, break_table, -+ select_table); -+ break; -+ case 11: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, break_table, -+ select_table); -+ break; -+ case 12: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, break_table, -+ select_table); -+ break; -+ case 13: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 14: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0x5ada5ada, break_table, -+ select_table); -+ break; -+ case 15: -+ halbtc8703b1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8703b1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8703b1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8703b1ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8703b1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8703b1ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8703b1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8703b1ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ /*halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); */ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ /*halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8);*/ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8703b1ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ coex_sta->force_lps_on = false; -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ -+ break; -+ case BTC_PS_LPS_ON: -+ coex_sta->force_lps_on = true; -+ halbtc8703b1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8703b1ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ -+ break; -+ case BTC_PS_LPS_OFF: -+ coex_sta->force_lps_on = false; -+ halbtc8703b1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, false); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+ -+void halbtc8703b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ if (ap_enable) { -+ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], FW for 1Ant AP mode\n"); -+ BTC_TRACE(trace_buf); -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ -+ halbtc8703b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ } -+ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ -+ halbtc8703b1ant_power_save_state( -+ btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } else { -+ halbtc8703b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ } -+ -+ -+ h2c_parameter[0] = real_byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = real_byte5; -+ -+ coex_dm->ps_tdma_para[0] = real_byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = real_byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+ -+void halbtc8703b1ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_busy = false; -+ u8 rssi_adjust_val = 0; -+ static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; -+ static boolean pre_wifi_busy = false; -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (wifi_busy != pre_wifi_busy) { -+ force_exec = true; -+ pre_wifi_busy = wifi_busy; -+ } -+ -+ /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+ if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) -+ psTdmaByte4Modify = 0x1; -+ else -+ psTdmaByte4Modify = 0x0; -+ -+ if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { -+ -+ force_exec = true; -+ pre_psTdmaByte4Modify = psTdmaByte4Modify; -+ } -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ -+ if (coex_dm->cur_ps_tdma_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(on, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(off, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (turn_on) { -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ } -+ -+ -+ if (turn_on) { -+ switch (type) { -+ default: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x35, 0x03, 0x11, 0x11); -+ break; -+ -+ case 3: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x3a, 0x03, 0x10, 0x10); -+ break; -+ case 4: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x21, 0x03, 0x10, 0x10); -+ break; -+ case 5: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x15, 0x03, 0x11, 0x11); -+ break; -+ case 6: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x20, 0x03, 0x11, 0x11); -+ break; -+ case 7: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); -+ break; -+ case 8: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); -+ break; -+ case 13: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x25, 0x03, 0x10, 0x10 | psTdmaByte4Modify); -+ break; -+ case 14: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x15, 0x03, 0x10, 0x10 | psTdmaByte4Modify); -+ break; -+ case 15: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x20, 0x03, 0x10, 0x10 | psTdmaByte4Modify); -+ break; -+ case 17: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x10, 0x03, 0x11, 0x14 | psTdmaByte4Modify); -+ break; -+ case 19: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x15, 0x03, 0x11, 0x10); -+ break; -+ case 20: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x30, 0x03, 0x11, 0x10); -+ break; -+ case 21: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x30, 0x03, 0x11, 0x10); -+ break; -+ case 22: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x25, 0x03, 0x11, 0x10); -+ break; -+ case 32: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x35, 0x03, 0x11, 0x11); -+ break; -+ case 33: -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x35, 0x03, 0x11, 0x10); -+ break; -+ -+ } -+ } else { -+ -+ /* disable PS tdma */ -+ switch (type) { -+ case 8: /* PTA Control */ -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, 0x8, -+ 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 0: -+ default: /* Software control, Antenna at BT side */ -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ -+ halbtc8703b1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x48, 0x0); -+ break; -+ } -+ } -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+void halbtc8703b1ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean force_exec, IN boolean init_hwcfg, -+ IN boolean wifi_off) -+{ -+ u32 cnt_bt_cal_chk = 0; -+ boolean is_in_mp_mode = false; -+ u8 u8tmp = 0; -+ u32 u32tmp1 = 0, u32tmp2 = 0; -+ -+ coex_dm->cur_ant_pos_type = ant_pos_type; -+ -+#if 1 -+ u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x38); -+ u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x54); -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (Before Ant Setup) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u8tmp, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+#endif -+ -+ if (init_hwcfg) { -+ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ -+ halbtc8703b1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8703b1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8703B_1ANT_CTT_WL_VS_LTE, 0xffff); -+ -+ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8703b1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8703B_1ANT_CTT_BT_VS_LTE, 0xffff); -+ -+ /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ -+ while (cnt_bt_cal_chk <= 20) { -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, -+ 0x49d); -+ cnt_bt_cal_chk++; -+ if (u8tmp & BIT(0)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ delay_ms(50); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ break; -+ } -+ } -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8703b1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8703B_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW high */ -+ halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8703B_1ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to SW low */ -+ halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8703B_1ANT_SIG_STA_SET_TO_LOW); -+ -+ coex_sta->gnt_control_by_PTA = false; -+ -+ } else if (wifi_off) { -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8703b1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* set Path control owner to BT */ -+ halbtc8703b1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8703B_1ANT_PCO_BTSIDE); -+ -+ coex_sta->gnt_control_by_PTA = false; -+ } else { -+ -+ halbtc8703b1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8703B_1ANT_PCO_WLSIDE); -+ -+ -+ if (force_exec || -+ (coex_dm->cur_ant_pos_type != coex_dm->pre_ant_pos_type) || -+ init_hwcfg || wifi_off) { -+ /* internal switch setting */ -+ switch (ant_pos_type) { -+ case BTC_ANT_PATH_WIFI: -+ /* set GNT_BT to low */ -+ halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8703B_1ANT_SIG_STA_SET_TO_LOW); -+ /* Set GNT_WL to high */ -+ halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8703B_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ coex_sta->gnt_control_by_PTA = false; -+ break; -+ case BTC_ANT_PATH_BT: -+ /*halbtc8703b1ant_ltecoex_pathcontrol_owner( -+ btcoexist, BT_8703B_1ANT_PCO_BTSIDE);*/ -+ /* set GNT_BT to high */ -+ halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8703B_1ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to low */ -+ halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8703B_1ANT_SIG_STA_SET_TO_LOW); -+ -+ coex_sta->gnt_control_by_PTA = false; -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ /* set GNT_BT to PTA */ -+ halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_PTA, -+ BT_8703B_1ANT_SIG_STA_SET_BY_HW); -+ /* Set GNT_WL to PTA */ -+ halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_PTA, -+ BT_8703B_1ANT_SIG_STA_SET_BY_HW); -+ -+ coex_sta->gnt_control_by_PTA = true; -+ break; -+ } -+ } -+ } -+ -+#if 1 -+ u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ if (init_hwcfg) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Ant-Setup Init) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u8tmp, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ } else if (wifi_off) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Ant-Setup WiFi off) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u8tmp, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Ant-Setup Run time) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u8tmp, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ } -+#endif -+ -+ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; -+} -+ -+ -+boolean halbtc8703b1ant_is_common_action(IN struct btc_coexist *btcoexist) -+{ -+ boolean common = false, wifi_connected = false, wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!wifi_connected && -+ BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else { -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ common = false; -+ } -+ -+ return common; -+} -+ -+/* ********************************************* -+ * -+ * Software Coex Mechanism start -+ * -+ * ********************************************* */ -+ -+/* SCO only or SCO+PAN(HS) */ -+ -+/* -+void halbtc8703b1ant_action_sco(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8703b1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8703b1ant_action_hid(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8703b1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8703b1ant_action_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8703b1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8703b1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8703b1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8703b1ant_action_pan_edr(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8703b1ant_sw_mechanism(btcoexist, false); -+} -+ -+ -+void halbtc8703b1ant_action_pan_hs(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8703b1ant_sw_mechanism(btcoexist, false); -+} -+ -+ -+void halbtc8703b1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8703b1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8703b1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8703b1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8703b1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8703b1ant_sw_mechanism(btcoexist, true); -+} -+ -+void halbtc8703b1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8703b1ant_sw_mechanism(btcoexist, true); -+} -+ -+*/ -+ -+/* ********************************************* -+ * -+ * Non-Software Coex Mechanism start -+ * -+ * ********************************************* */ -+u8 halbtc8703b1ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8703B_1ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_HID_A2DP; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8703B_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+ -+ -+void halbtc8703b1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, -+ false, false); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8703b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, -+ false, false); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+} -+ -+void halbtc8703b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, -+ false, false); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8703b1ant_action_hs(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8703b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, -+ bt_busy = false; -+ boolean wifi_scan = false, wifi_link = false, wifi_roam = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); -+ -+ if ((wifi_link) || (wifi_roam) || (coex_sta->wifi_is_high_pri_task)) { -+ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); -+ -+ } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { -+ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); -+ -+ } else if ((!wifi_connected) && (!wifi_scan)) { -+ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { -+ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ } else if (bt_link_info->a2dp_exist) { -+ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if (wifi_scan) { -+ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ } else if (wifi_busy) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); -+ -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 19); -+ -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } -+} -+ -+void halbtc8703b1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ /* tdma and coex table */ -+ -+ if (bt_link_info->sco_exist) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } else { /* HID */ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } -+} -+ -+void halbtc8703b1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_busy = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ -+ if (bt_link_info->hid_only) { /* HID */ -+ halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ wifi_status); -+ coex_dm->auto_tdma_adjust = false; -+ return; -+ } else if (bt_link_info->a2dp_only) { /* A2DP */ -+ if (BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ -+ if (coex_sta->scan_ap_num >= -+ BT_8703B_1ANT_WIFI_NOISY_THRESH) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 17); -+ } else { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 7); -+ } -+ -+ halbtc8703b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = true; -+ } -+ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || -+ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ -+ -+ if (wifi_busy) { -+ -+ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 15); -+ else -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); -+ } else -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); -+ -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ coex_dm->auto_tdma_adjust = false; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { /* HID+A2DP */ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); -+ coex_dm->auto_tdma_adjust = false; -+ -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && -+ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ -+ if (BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 4); -+ else -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -+ -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ /* BT no-profile busy (0x9) */ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } -+} -+ -+void halbtc8703b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -+{ -+ -+ /* tdma and coex table */ -+ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, -+ false, false); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8703b1ant_action_wifi_not_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if (num_of_wifi_link >= 2) { -+ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8703b1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8703b1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8703b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8703b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ /* tdma and coex table */ -+ if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8703b1ant_action_wifi_not_connected_asso_auth( -+ IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if (num_of_wifi_link >= 2) { -+ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8703b1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8703b1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8703b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8703b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); -+ } else if (bt_link_info->pan_exist) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); -+ } else { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); -+ } -+} -+ -+void halbtc8703b1ant_action_wifi_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if (num_of_wifi_link >= 2) { -+ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8703b1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8703b1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8703b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8703b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ /* tdma and coex table */ -+ if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8703b1ant_action_wifi_connected_specific_packet( -+ IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ boolean wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if (num_of_wifi_link >= 2) { -+ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8703b1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8703b1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8703b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8703b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ /* no specific packet process for both WiFi and BT very busy */ -+ if ((wifi_busy) && ((bt_link_info->pan_exist) || -+ (coex_sta->num_of_profile >= 2))) -+ return; -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } else if (bt_link_info->a2dp_exist) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if (bt_link_info->pan_exist) { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8703b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_busy = false; -+ boolean scan = false, link = false, roam = false; -+ boolean under_4way = false, ap_enable = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ if (under_4way) { -+ halbtc8703b1ant_action_wifi_connected_specific_packet(btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8703b1ant_action_wifi_connected_scan(btcoexist); -+ else -+ halbtc8703b1ant_action_wifi_connected_specific_packet( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ -+ /* tdma and coex table */ -+ if (!wifi_busy) { -+ if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8703b1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else { -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ halbtc8703b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 2); -+ } -+ } else { -+ if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8703b1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else { -+ /* halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); */ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8703b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); -+ /* halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); */ -+ halbtc8703b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } -+} -+ -+void halbtc8703b1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ u8 algorithm = 0; -+ -+ algorithm = halbtc8703b1ant_action_algorithm(btcoexist); -+ coex_dm->cur_algorithm = algorithm; -+ -+ if (halbtc8703b1ant_is_common_action(btcoexist)) { -+ -+ } else { -+ switch (coex_dm->cur_algorithm) { -+ case BT_8703B_1ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8703b1ant_action_sco(btcoexist); */ -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8703b1ant_action_hid(btcoexist); */ -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8703b1ant_action_a2dp(btcoexist); */ -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8703b1ant_action_a2dp_pan_hs(btcoexist); */ -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8703b1ant_action_pan_edr(btcoexist); */ -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8703b1ant_action_pan_hs(btcoexist); */ -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8703b1ant_action_pan_edr_a2dp(btcoexist); */ -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8703b1ant_action_pan_edr_hid(btcoexist); */ -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8703b1ant_action_hid_a2dp_pan_edr(btcoexist); */ -+ break; -+ case BT_8703B_1ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8703b1ant_action_hid_a2dp(btcoexist); */ -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8703b1ant_coex_all_off(btcoexist); */ -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+} -+ -+void halbtc8703b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ boolean increase_scan_dev_num = false; -+ boolean bt_ctrl_agg_buf_size = false; -+ boolean miracast_plus_bt = false; -+ u8 agg_buf_size = 5; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0, wifi_bw; -+ u8 iot_peer = BTC_IOT_PEER_UNKNOWN; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->bt_whck_test) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under WHCK TEST!!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8703b1ant_action_bt_whck_test(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!!\n"); -+ halbtc8703b1ant_action_wifi_only(btcoexist); -+ return; -+ } -+ -+ if ((BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ increase_scan_dev_num = true; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, -+ &increase_scan_dev_num); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if ((num_of_wifi_link >= 2) || -+ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", -+ num_of_wifi_link, wifi_link_status); -+ BTC_TRACE(trace_buf); -+ -+ if (bt_link_info->bt_link_exist) { -+ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, -+ 0, 1); -+ miracast_plus_bt = true; -+ } else { -+ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ miracast_plus_bt = false; -+ } -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8703b1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8703b1ant_action_wifi_multi_port(btcoexist); -+ -+ return; -+ } else { -+ miracast_plus_bt = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { -+ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); -+ -+ if (BTC_IOT_PEER_CISCO != iot_peer) { -+ if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ -+ halbtc8703b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, true, false, 0x5); -+ else -+ halbtc8703b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, false, 0x5); -+ } else { -+ if (bt_link_info->sco_exist) -+ halbtc8703b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, true, false, 0x5); -+ else { -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ halbtc8703b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, true, 0x10); -+ else -+ halbtc8703b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, true, 0x8); -+ } -+ } -+ -+ halbtc8703b1ant_sw_mechanism(btcoexist, true); -+ halbtc8703b1ant_run_sw_coexist_mechanism( -+ btcoexist); /* just print debug message */ -+ } else { -+ halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x5); -+ -+ halbtc8703b1ant_sw_mechanism(btcoexist, false); -+ halbtc8703b1ant_run_sw_coexist_mechanism( -+ btcoexist); /* just print debug message */ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8703b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8703b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ -+ if (!wifi_connected) { -+ boolean scan = false, link = false, roam = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is non connected-idle !!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8703b1ant_action_wifi_not_connected_scan( -+ btcoexist); -+ else -+ halbtc8703b1ant_action_wifi_not_connected_asso_auth( -+ btcoexist); -+ } else -+ halbtc8703b1ant_action_wifi_not_connected(btcoexist); -+ } else /* wifi LPS/Busy */ -+ halbtc8703b1ant_action_wifi_connected(btcoexist); -+} -+ -+u32 halbtc8703b1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) -+{ -+ u8 j; -+ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; -+ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, -+ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, -+ 32, 23, 15, 7, 0 -+ }; -+ -+ if (val == 0) -+ return 0; -+ -+ tmp = val; -+ -+ while (1) { -+ if (tmp == 1) -+ break; -+ else { -+ tmp = (tmp >> 1); -+ shiftcount++; -+ } -+ } -+ -+ -+ val_integerd_b = shiftcount + 1; -+ -+ tmp2 = 1; -+ for (j = 1; j <= val_integerd_b; j++) -+ tmp2 = tmp2 * 2; -+ -+ tmp = (val * 100) / tmp2; -+ tindex = tmp / 5; -+ -+ if (tindex > 20) -+ tindex = 20; -+ -+ val_fractiond_b = table_fraction[tindex]; -+ -+ result = val_integerd_b * 100 - val_fractiond_b; -+ -+ return result; -+ -+ -+} -+ -+void halbtc8703b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ -+ /* sw all off */ -+ halbtc8703b1ant_sw_mechanism(btcoexist, false); -+ -+ /* halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ -+ /* halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ -+ -+ coex_sta->pop_event_cnt = 0; -+} -+ -+void halbtc8703b1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean back_up, IN boolean wifi_only) -+{ -+ u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0; -+ -+ u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70), -+ u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "\n [BTCoex], ********** 0x70/ 0x38/ 0x54 (Before Init HW config) = 0x%x/ 0x%x/ 0x%x**********\n", -+ u32tmp0, -+ u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 1Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* 0xf0[15:12] --> Chip Cut information */ -+ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, -+ 0xf1) & 0xf0) >> 4; -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ -+ /* BT report packet sample rate */ -+ btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); -+ -+ /* Enable BT counter statistics */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); -+ -+ /* Enable PTA (3-wire function form BT side) */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); -+ -+ /* Enable PTA (tx/rx signal form WiFi side) */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); -+ -+ halbtc8703b1ant_enable_gnt_to_gpio(btcoexist, FALSE); -+ -+ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) -+ halbtc8703b1ant_post_onoffState_to_bt(btcoexist, true); -+ -+ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ -+ /* Antenna config */ -+ if (wifi_only) { -+ coex_sta->concurrent_rx_mode_on = false; -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, -+ FORCE_EXEC, true, false); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, -+ FORCE_EXEC, false, false); -+ } else { -+ coex_sta->concurrent_rx_mode_on = true; -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); -+ /* RF 0x1[0] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x1, 0x0); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, true, false); -+ } -+ -+ /* PTA parameter */ -+ halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70), -+ u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** 0x70/ 0x38/ 0x54 (After Init HW config) = 0x%x/ 0x%x/ 0x%x**********\n", -+ u32tmp0, -+ u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+ -+ -+void halbtc8703b1ant_psd_showdata(IN struct btc_coexist *btcoexist) -+{ -+ u8 *cli_buf = btcoexist->cli_buf; -+ u32 delta_freq_per_point; -+ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n\n============[PSD info] (%d)============\n", -+ psd_scan->psd_gen_count); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->psd_gen_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); -+ CL_PRINTF(cli_buf); -+ return; -+ } -+ -+ if (psd_scan->psd_point == 0) -+ delta_freq_per_point = 0; -+ else -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* if (psd_scan->is_psd_show_max_only) */ -+ if (0) { -+ psd_rep1 = psd_scan->psd_max_value / 100; -+ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; -+ -+ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + -+ psd_scan->psd_max_value_point * delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.0%d MHz", -+ freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.%d MHz", -+ freq1, freq2); -+ -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.0%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ -+ CL_PRINTF(cli_buf); -+ } else { -+ m = psd_scan->psd_start_point; -+ n = psd_scan->psd_start_point; -+ i = 1; -+ j = 1; -+ -+ while (1) { -+ do { -+ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * -+ delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (i == 1) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.0%2d", freq1, -+ freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.%3d", freq1, -+ freq2); -+ } else if ((i % 8 == 0) || -+ (m == psd_scan->psd_stop_point)) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.000\n", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.0%2d\n", freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.%3d\n", freq1, freq2); -+ } else { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.0%2d", freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.%3d", freq1, freq2); -+ } -+ -+ i++; -+ m++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); -+ -+ -+ do { -+ psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; -+ psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * -+ 100; -+ -+ if (j == 1) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.0%d", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.%d", psd_rep1, -+ psd_rep2); -+ } else if ((j % 8 == 0) || -+ (n == psd_scan->psd_stop_point)) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.0%d\n", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.%d\n", psd_rep1, psd_rep2); -+ } else { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.0%d", psd_rep1, psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.%d", psd_rep1, psd_rep2); -+ } -+ -+ j++; -+ n++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); -+ -+ if ((m > psd_scan->psd_stop_point) || -+ (n > psd_scan->psd_stop_point)) -+ break; -+ else { -+ i = 1; -+ j = 1; -+ } -+ -+ } -+ } -+ -+ -+} -+ -+void halbtc8703b1ant_psd_maxholddata(IN struct btc_coexist *btcoexist, -+ IN u32 gen_count) -+{ -+ u32 i = 0, i_max = 0, val_max = 0; -+ -+ if (gen_count == 1) { -+ memcpy(psd_scan->psd_report_max_hold, -+ psd_scan->psd_report, -+ BT_8703B_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); -+ -+ for (i = psd_scan->psd_start_point; -+ i <= psd_scan->psd_stop_point; i++) { -+ -+ } -+ -+ psd_scan->psd_max_value_point = 0; -+ psd_scan->psd_max_value = 0; -+ -+ } else { -+ for (i = psd_scan->psd_start_point; -+ i <= psd_scan->psd_stop_point; i++) { -+ if (psd_scan->psd_report[i] > -+ psd_scan->psd_report_max_hold[i]) -+ psd_scan->psd_report_max_hold[i] = -+ psd_scan->psd_report[i]; -+ -+ /* search Max Value */ -+ if (i == psd_scan->psd_start_point) { -+ i_max = i; -+ val_max = psd_scan->psd_report_max_hold[i]; -+ } else { -+ if (psd_scan->psd_report_max_hold[i] > -+ val_max) { -+ i_max = i; -+ val_max = psd_scan->psd_report_max_hold[i]; -+ } -+ } -+ -+ -+ } -+ -+ psd_scan->psd_max_value_point = i_max; -+ psd_scan->psd_max_value = val_max; -+ -+ } -+ -+ -+} -+ -+u32 halbtc8703b1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) -+{ -+ /* reg 0x808[9:0]: FFT data x */ -+ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ -+ /* reg 0x8b4[15:0]: FFT data y report */ -+ -+ u32 val = 0, psd_report = 0; -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ -+ val &= 0xffbffc00; -+ val |= point; -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ val |= 0x00400000; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); -+ -+ psd_report = val & 0x0000ffff; -+ -+ return psd_report; -+} -+ -+ -+boolean halbtc8703b1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, -+ IN u32 avgnum, IN u32 loopcnt) -+{ -+ u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; -+ u32 points1 = 0, psd_report = 0; -+ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; -+ u32 psd_center_freq = 20 * 10 ^ 6; -+ boolean outloop = false, scan , roam, is_sweep_ok = true; -+ u8 flag = 0; -+ u32 tmp = 0, u32tmp1 = 0; -+ u32 wifi_original_channel = 1; -+ -+ psd_scan->is_psd_running = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ do { -+ switch (flag) { -+ case 0: /* Get PSD parameters */ -+ default: -+ -+ psd_scan->psd_band_width = 40 * 1000000; -+ psd_scan->psd_point = points; -+ psd_scan->psd_start_base = points / 2; -+ psd_scan->psd_avg_num = avgnum; -+ psd_scan->real_cent_freq = cent_freq; -+ psd_scan->real_offset = offset; -+ psd_scan->real_span = span; -+ -+ -+ points1 = psd_scan->psd_point; -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* PSD point setup */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffff0fff; -+ -+ switch (psd_scan->psd_point) { -+ case 128: -+ val |= 0x0; -+ break; -+ case 256: -+ default: -+ val |= 0x00004000; -+ break; -+ case 512: -+ val |= 0x00008000; -+ break; -+ case 1024: -+ val |= 0x0000c000; -+ break; -+ } -+ -+ switch (psd_scan->psd_avg_num) { -+ case 1: -+ val |= 0x0; -+ break; -+ case 8: -+ val |= 0x00001000; -+ break; -+ case 16: -+ val |= 0x00002000; -+ break; -+ case 32: -+ default: -+ val |= 0x00003000; -+ break; -+ } -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ flag = 1; -+ break; -+ case 1: /* calculate the PSD point index from freq/offset/span */ -+ psd_center_freq = psd_scan->psd_band_width / 2 + -+ offset * (1000000); -+ -+ start_p = psd_scan->psd_start_base + (psd_center_freq - -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_start_point = start_p - -+ psd_scan->psd_start_base; -+ -+ stop_p = psd_scan->psd_start_base + (psd_center_freq + -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_stop_point = stop_p - -+ psd_scan->psd_start_base - 1; -+ -+ flag = 2; -+ break; -+ case 2: /* set RF channel/BW/Mode */ -+ -+ /* set 3-wire off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val |= 0x00300000; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val &= 0xfeffffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* Tx-pause on */ -+ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); -+ -+ /* store WiFi original channel */ -+ wifi_original_channel = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x18, 0x3ff); -+ -+ /* Set RF channel */ -+ if (cent_freq == 2484) -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, 0xe); -+ else -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, (cent_freq - 2412) / 5 + -+ 1); /* WiFi TRx Mask on */ -+ -+ /* save original RCK value */ -+ u32tmp1 = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x1d, 0xfffff); -+ -+ /* Enter debug mode */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, -+ 0x2, 0x1); -+ -+ /* Set RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, -+ 0xfffff, 0x2e); -+ -+ -+ /* Set RF mode = Rx, RF Gain = 0x320a0 */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, -+ 0xfffff, 0x320a0); -+ -+ while (1) { -+ if (k++ > BT_8703B_1ANT_ANTDET_SWEEPPOINT_DELAY) -+ break; -+ } -+ flag = 3; -+ break; -+ case 3: -+ psd_scan->psd_gen_count = 0; -+ for (j = 1; j <= loopcnt; j++) { -+ -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || roam) { -+ is_sweep_ok = false; -+ break; -+ } -+ memset(psd_scan->psd_report, 0, -+ psd_scan->psd_point * sizeof(u32)); -+ start_p = psd_scan->psd_start_point + -+ psd_scan->psd_start_base; -+ stop_p = psd_scan->psd_stop_point + -+ psd_scan->psd_start_base + 1; -+ -+ i = start_p; -+ point_index = 0; -+ -+ while (i < stop_p) { -+ if (i >= points1) -+ psd_report = -+ halbtc8703b1ant_psd_getdata( -+ btcoexist, i - points1); -+ else -+ psd_report = -+ halbtc8703b1ant_psd_getdata( -+ btcoexist, i); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Point=%d, psd_raw_data = 0x%08x\n", -+ i, psd_report); -+ BTC_TRACE(trace_buf); -+ if (psd_report == 0) -+ tmp = 0; -+ else -+ /* tmp = 20*log10((double)psd_report); */ -+ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ -+ tmp = 6 * halbtc8703b1ant_psd_log2base( -+ btcoexist, psd_report); -+ -+ n = i - psd_scan->psd_start_base; -+ psd_scan->psd_report[n] = tmp; -+ -+ -+ halbtc8703b1ant_psd_maxholddata( -+ btcoexist, j); -+ -+ i++; -+ -+ } -+ -+ psd_scan->psd_gen_count = j; -+ } -+ -+ flag = 100; -+ break; -+ case 99: /* error */ -+ -+ outloop = true; -+ break; -+ case 100: /* recovery */ -+ -+ /* set 3-wire on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val &= 0xffcfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val |= 0x01000000; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* Tx-pause off */ -+ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); -+ -+ /* PSD off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffbfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ /* restore RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, -+ 0xfffff, u32tmp1); -+ -+ /* Exit debug mode */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, -+ 0x2, 0x0); -+ -+ /* restore WiFi original channel */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, -+ 0x3ff, wifi_original_channel); -+ -+ outloop = true; -+ break; -+ -+ } -+ -+ } while (!outloop); -+ -+ -+ -+ psd_scan->is_psd_running = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); -+ BTC_TRACE(trace_buf); -+ return is_sweep_ok; -+ -+} -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8703b1ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8703b1ant_ -+ * ************************************************************ */ -+void ex_halbtc8703b1ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp = 0x0; -+ u16 u16tmp = 0x0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Execute 8703b 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Ant Det Finish = %s, Ant Det Number = %d\n", -+ (board_info->btdm_ant_det_finish ? "Yes" : "No"), -+ board_info->btdm_ant_num_by_ant_det); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = true; -+ -+ /* enable BB, REG_SYS_FUNC_EN such that we can write BB/MAC reg correctly. */ -+ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); -+ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); -+ -+ /* set Path control owner to WiFi */ -+ halbtc8703b1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8703B_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to high */ -+ halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8703B_1ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to low */ -+ halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8703B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8703B_1ANT_SIG_STA_SET_TO_LOW); -+ -+ /* set WLAN_ACT = 0 */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); -+ -+ halbtc8703b1ant_enable_gnt_to_gpio(btcoexist, FALSE); -+ -+ /* */ -+ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ -+ -+ u8tmp = 0; -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+ -+ if (btcoexist->chip_interface == BTC_INTF_USB) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_SDIO) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); -+ -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** 0x70(MAC)/0x38/0x54 (Power-On) =0x%x/ 0x%x/ 0x%x**********\n", -+ btcoexist->btc_read_4byte(btcoexist, 0x70), -+ halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38), -+ halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54)); -+ BTC_TRACE(trace_buf); -+ -+ -+} -+ -+void ex_halbtc8703b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -+{ -+} -+ -+void ex_halbtc8703b1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ halbtc8703b1ant_init_hw_config(btcoexist, true, wifi_only); -+ btcoexist->stop_coex_dm = false; -+} -+ -+void ex_halbtc8703b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8703b1ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_stack_info *stack_info = &btcoexist->stack_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u16 u16tmp[4]; -+ u32 u32tmp[4]; -+ u32 fa_of_dm, fa_cck; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ static u8 pop_report_in_10s = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ if (btcoexist->stop_coex_dm) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (psd_scan->ant_det_try_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", -+ "Ant PG Num/ Mech/ Pos", -+ board_info->pg_ant_num, board_info->btdm_ant_num, -+ board_info->btdm_ant_pos); -+ CL_PRINTF(cli_buf); -+ } else { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d (%d/%d/%d)", -+ "Ant PG Num/ Mech(Ant_Det)/ Pos", -+ board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, -+ board_info->btdm_ant_pos, -+ psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, -+ psd_scan->ant_det_result); -+ CL_PRINTF(cli_buf); -+ -+ if (board_info->btdm_ant_det_finish) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "Ant Det PSD Value", -+ psd_scan->ant_det_peak_val); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", -+ "BT stack/ hci ext ver", -+ ((stack_info->profile_notified) ? "Yes" : "No"), -+ stack_info->hci_version); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", -+ "Version Coex/ Fw/ Patch/ Cut", -+ glcoex_ver_date_8703b_1ant, glcoex_ver_8703b_1ant, fw_ver, -+ bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", -+ "WifibHiPri/ Ccklock/ CckEverLock", -+ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), -+ (coex_sta->cck_lock ? "Yes" : "No"), -+ (coex_sta->cck_ever_lock ? "Yes" : "No")); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ pop_report_in_10s++; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt/ popCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") -+ : ((BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, -+ coex_sta->pop_event_cnt); -+ CL_PRINTF(cli_buf); -+ -+ if (pop_report_in_10s >= 5) { -+ coex_sta->pop_event_cnt = 0; -+ pop_report_in_10s = 0; -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d / %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP/Hi-Pri", -+ bt_link_info->sco_exist, bt_link_info->hid_exist, -+ bt_link_info->pan_exist, bt_link_info->a2dp_exist, -+ bt_link_info->bt_hi_pri_link_exist); -+ CL_PRINTF(cli_buf); -+ -+ if (stack_info->profile_notified) -+ btcoexist->btc_disp_dbg_msg(btcoexist, -+ BTC_DBG_DISP_BT_LINK_INFO); -+ else { -+ bt_info_ext = coex_sta->bt_info_ext; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d", -+ "Role/A2DP Rate/Bitpool", -+ ((bt_link_info->slave_role) ? "Slave" : "Master"), -+ (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool); -+ CL_PRINTF(cli_buf); -+ } -+ -+ -+ for (i = 0; i < BT_INFO_SRC_8703B_1ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8703b_1ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ if (btcoexist->manual_control) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms] (before Manual)============"); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "SM[LowPenaltyRA]", -+ coex_dm->cur_low_penalty_ra); -+ CL_PRINTF(cli_buf); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), -+ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); -+ -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "WL/BT Coex Table Type", -+ coex_sta->coex_table_type); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x778/0x6cc/IgnWlanAct", -+ u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa0); -+ u32tmp[1] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "LTE Coex Table W_L/B_L", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa8); -+ u32tmp[1] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xac); -+ u32tmp[2] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb0); -+ u32tmp[3] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "LTE Break Table W_L/B_L/L_W/L_B", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, -+ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "0x430/0x434/0x42a/0x456", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", -+ "LTE CoexOn/Path Ctrl Owner", -+ (int)((u32tmp[0] & BIT(7)) >> 7), ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "LTE 3Wire/OPMode/UART/UARTMode", -+ (int)((u32tmp[0] & BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), -+ (int)((u32tmp[0] & BIT(3)) >> 3), -+ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", -+ "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", -+ (int)((u32tmp[0] & BIT(12)) >> 12), (int)((u32tmp[0] & BIT(14)) >> 14), -+ ((u8tmp[0] & BIT(3)) ? "On" : "Off")); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", -+ (int)((u32tmp[0] & BIT(2)) >> 2), (int)((u32tmp[0] & BIT(3)) >> 3), -+ (int)((u32tmp[0] & BIT(1)) >> 1), (int)(u32tmp[0] & BIT(0))); -+ CL_PRINTF(cli_buf); -+ -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x4c6[4]/0x40[5] (WL/BT PTA)", -+ (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s", -+ "0x550(bcn ctrl)/0x522/4-RxAGC", -+ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); -+ u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); -+ -+ fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) -+ >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + -+ ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & -+ 0xffff) ; -+ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; -+ -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xc50); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0xc50/OFDM-CCA/OFDM-FA/CCK-FA", -+ u32tmp[1] & 0xff, u32tmp[0] & 0xffff, fa_of_dm, fa_cck); -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_OK CCK/11g/11n/11n-Agg", -+ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, -+ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_Err CCK/11g/11n/11n-Agg", -+ coex_sta->crc_err_cck, coex_sta->crc_err_11g, -+ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(high-pri rx/tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(low-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+ -+ halbtc8703b1ant_read_score_board(btcoexist, &u16tmp[0]); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", -+ "ScoreBoard[14:0] (from BT)", u16tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void ex_halbtc8703b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ coex_sta->under_lps = false; -+ -+ /* Write WL "Active" in Score-board for LPS off */ -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); -+ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, false, true); -+ halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); -+ -+ halbtc8703b1ant_init_hw_config(btcoexist, false, false); -+ halbtc8703b1ant_init_coex_dm(btcoexist); -+ halbtc8703b1ant_query_bt_info(btcoexist); -+ -+ coex_sta->under_ips = false; -+ } -+} -+ -+void ex_halbtc8703b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ coex_sta->under_ips = false; -+ -+ if (coex_sta->force_lps_on == true) { /* LPS No-32K */ -+ /* Write WL "Active" in Score-board for PS-TDMA */ -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); -+ -+ } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ -+ /* Write WL "Non-Active" in Score-board for Native-PS */ -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); -+ -+ } -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ -+ -+ /* Write WL "Active" in Score-board for LPS off */ -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); -+ -+ } -+} -+ -+void ex_halbtc8703b1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ halbtc8703b1ant_query_bt_info(btcoexist); -+ -+ if (BTC_SCAN_START == type) { -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); -+ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, -+ 8); -+ -+ /* Force antenna setup for no scan result issue */ -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ FORCE_EXEC, false, false); -+ -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8703b1ant_action_wifi_not_connected_scan(btcoexist); -+ else /* wifi is connected */ -+ halbtc8703b1ant_action_wifi_connected_scan(btcoexist); -+ -+ } else { -+ -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num); -+ BTC_TRACE(trace_buf); -+ -+ if (!wifi_connected) -+ halbtc8703b1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8703b1ant_action_wifi_connected(btcoexist); -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START Notify() end\n"); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+void ex_halbtc8703b1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ if (BTC_ASSOCIATE_START == type) { -+ coex_sta->wifi_is_high_pri_task = true; -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); -+ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, -+ 8); -+ -+ /* Force antenna setup for no scan result issue */ -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ FORCE_EXEC, false, false); -+ /* psd_scan->ant_det_is_ant_det_available = TRUE; */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->arp_cnt = 0; -+ -+ halbtc8703b1ant_action_wifi_not_connected_asso_auth(btcoexist); -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8703b1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8703b1ant_action_wifi_connected(btcoexist); -+ } -+ -+} -+ -+void ex_halbtc8703b1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); -+ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, -+ 8); -+ -+ /* Force antenna setup for no scan result issue */ -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ FORCE_EXEC, false, false); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ /* Set CCK Tx/Rx high Pri except 11b mode */ -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x00); /* CCK Rx */ -+ } else { -+ /* btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x10); */ /*CCK Tx */ -+ /* btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); */ /*CCK Rx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x10); /* CCK Rx */ -+ } -+ -+ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, -+ 0x430); -+ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, -+ 0x434); -+ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( -+ btcoexist, 0x42a); -+ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( -+ btcoexist, 0x456); -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ -+ -+ coex_sta->cck_ever_lock = false; -+ } -+ -+ halbtc8703b1ant_update_wifi_channel_info(btcoexist, type); -+ -+} -+ -+void ex_halbtc8703b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean under_4way = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (under_4way) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ---- under_4way!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } else if (BTC_PACKET_ARP == type) { -+ -+ coex_dm->arp_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } -+ -+ if (coex_sta->wifi_is_high_pri_task) -+ halbtc8703b1ant_action_wifi_connected_specific_packet(btcoexist); -+} -+ -+void ex_halbtc8703b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source = 0; -+ boolean wifi_connected = false; -+ boolean bt_busy = false; -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8703B_1ANT_MAX) -+ rsp_source = BT_INFO_SRC_8703B_1ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (BT_INFO_SRC_8703B_1ANT_WIFI_FW != rsp_source) { -+ -+ /* if 0xff, it means BT is under WHCK test */ -+ if (bt_info == 0xff) -+ coex_sta->bt_whck_test = true; -+ else -+ coex_sta->bt_whck_test = false; -+ -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; -+ -+ if (coex_sta->bt_retry_cnt >= 1) -+ coex_sta->pop_event_cnt++; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) -+ coex_sta->c2h_bt_page = true; -+ else -+ coex_sta->c2h_bt_page = false; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80) -+ coex_sta->bt_create_connection = true; -+ else -+ coex_sta->bt_create_connection = false; -+ -+ /* unit: %, value-100 to translate to unit: dBm */ -+ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; -+ -+ /* coex_sta->bt_info_c2h[rsp_source][3]*2+10; */ -+ -+ if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { -+ coex_sta->a2dp_bit_pool = -+ coex_sta->bt_info_c2h[rsp_source][6]; -+ } else -+ coex_sta->a2dp_bit_pool = 0; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9) -+ coex_sta->acl_busy = true; -+ else -+ coex_sta->acl_busy = false; -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ -+ if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) { -+ -+ /* Re-Init */ -+ if (coex_sta->bt_info_ext & BIT(1)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (wifi_connected) -+ halbtc8703b1ant_update_wifi_channel_info(btcoexist, -+ BTC_MEDIA_CONNECT); -+ else -+ halbtc8703b1ant_update_wifi_channel_info(btcoexist, -+ BTC_MEDIA_DISCONNECT); -+ } -+ -+ /* If Ignore_WLanAct && not SetUp_Link */ -+ if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8703b1ant_ignore_wlan_act(btcoexist, -+ FORCE_EXEC, false); -+ } -+ } -+ -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (bt_info & BT_INFO_8703B_1ANT_B_INQ_PAGE) -+ coex_sta->c2h_bt_inquiry_page = true; -+ else -+ coex_sta->c2h_bt_inquiry_page = false; -+ -+ } -+ -+ coex_sta->num_of_profile = 0; -+ -+ /* set link exist status */ -+ if (!(bt_info & BT_INFO_8703B_1ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ -+ coex_sta->bt_hi_pri_link_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (bt_info & BT_INFO_8703B_1ANT_B_FTP) { -+ coex_sta->pan_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->pan_exist = false; -+ if (bt_info & BT_INFO_8703B_1ANT_B_A2DP) { -+ coex_sta->a2dp_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->a2dp_exist = false; -+ if (bt_info & BT_INFO_8703B_1ANT_B_HID) { -+ coex_sta->hid_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->hid_exist = false; -+ if (bt_info & BT_INFO_8703B_1ANT_B_SCO_ESCO) { -+ coex_sta->sco_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->sco_exist = false; -+ -+ } -+ -+ -+ -+ halbtc8703b1ant_update_bt_link_info(btcoexist); -+ -+ bt_info = bt_info & -+ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ -+ -+ if (!(bt_info & BT_INFO_8703B_1ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info == -+ BT_INFO_8703B_1ANT_B_CONNECTION) { /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if ((bt_info & BT_INFO_8703B_1ANT_B_SCO_ESCO) || -+ (bt_info & BT_INFO_8703B_1ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info & BT_INFO_8703B_1ANT_B_ACL_BUSY) { -+ if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) -+ coex_dm->auto_tdma_adjust = false; -+ coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if ((BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ bt_busy = true; -+ else -+ bt_busy = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Manual CTRL<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ /* don't run coex mechanism while receve BTInfo if GNT_WL/GNT_BT control by SW */ -+ if (!coex_sta->gnt_control_by_PTA) -+ return; -+ -+ halbtc8703b1ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8703b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_RF_ON == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_rf_off_on_event = true; -+ btcoexist->stop_coex_dm = false; -+ -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); -+ halbtc8703b1ant_post_onoffState_to_bt(btcoexist, true); -+ -+ /* halbtc8703b1ant_init_hw_config(btcoexist, false, false); */ -+ } else if (BTC_RF_OFF == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); -+ halbtc8703b1ant_post_onoffState_to_bt(btcoexist, false); -+ -+ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, false, true); -+ -+ btcoexist->stop_coex_dm = true; -+ coex_sta->wl_rf_off_on_event = false; -+ -+ } -+} -+ -+void ex_halbtc8703b1ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); -+ halbtc8703b1ant_post_onoffState_to_bt(btcoexist, false); -+ -+ halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, -+ false, true); -+ -+ ex_halbtc8703b1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+ -+ halbtc8703b1ant_enable_gnt_to_gpio(btcoexist, FALSE); -+ -+ btcoexist->stop_coex_dm = true; -+} -+ -+void ex_halbtc8703b1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_WIFI_PNP_SLEEP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); -+ halbtc8703b1ant_post_onoffState_to_bt(btcoexist, false); -+ -+ halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, false, true); -+ -+ btcoexist->stop_coex_dm = true; -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); -+ halbtc8703b1ant_post_onoffState_to_bt(btcoexist, true); -+ -+ btcoexist->stop_coex_dm = false; -+ } -+} -+ -+void ex_halbtc8703b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], *****************Coex DM Reset*****************\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8703b1ant_init_hw_config(btcoexist, false, false); -+ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ -+ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); */ -+ halbtc8703b1ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8703b1ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+ -+#if (BT_AUTO_REPORT_ONLY_8703B_1ANT == 0) -+ halbtc8703b1ant_query_bt_info(btcoexist); -+#endif -+ -+ halbtc8703b1ant_monitor_bt_ctr(btcoexist); -+ halbtc8703b1ant_monitor_wifi_ctr(btcoexist); -+ -+ halbtc8703b1ant_monitor_bt_enable_disable(btcoexist); -+ -+ /* for 4-way, DHCP, EAPOL packet */ -+ if (coex_sta->specific_pkt_period_cnt > 0) { -+ -+ coex_sta->specific_pkt_period_cnt--; -+ -+ if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); -+ BTC_TRACE(trace_buf); -+ -+ } -+ -+ if (halbtc8703b1ant_is_wifibt_status_changed(btcoexist)) -+ halbtc8703b1ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8703b1ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+ /* No Antenna Detection required because 8730b is only 1-Ant */ -+} -+ -+void ex_halbtc8703b1ant_antenna_isolation(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+ -+ -+} -+ -+void ex_halbtc8703b1ant_psd_scan(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+ -+ -+} -+ -+void ex_halbtc8703b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) -+{ -+ -+} -+ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8703b1Ant.h 2018-02-11 21:44:27.145146055 +0200 -@@ -0,0 +1,348 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8703B_SUPPORT == 1) -+/* ******************************************* -+ * The following is for 8703B 1ANT BT Co-exist definition -+ * ******************************************* */ -+#define BT_AUTO_REPORT_ONLY_8703B_1ANT 1 -+#define BT_8703B_1ANT_ENABLE_GNTBT_TO_GPIO14 0 -+ -+#define BT_INFO_8703B_1ANT_B_FTP BIT(7) -+#define BT_INFO_8703B_1ANT_B_A2DP BIT(6) -+#define BT_INFO_8703B_1ANT_B_HID BIT(5) -+#define BT_INFO_8703B_1ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8703B_1ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8703B_1ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8703B_1ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8703B_1ANT_B_CONNECTION BIT(0) -+ -+#define BT_INFO_8703B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT(0))) ? true : false) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT 2 -+ -+#define BT_8703B_1ANT_WIFI_NOISY_THRESH 50 /* max: 255 */ -+ -+/* for Antenna detection */ -+#define BT_8703B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 -+#define BT_8703B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -+#define BT_8703B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 -+#define BT_8703B_1ANT_ANTDET_PSDTHRES_1ANT 35 -+#define BT_8703B_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -+#define BT_8703B_1ANT_ANTDET_SWEEPPOINT_DELAY 40000 -+#define BT_8703B_1ANT_ANTDET_ENABLE 0 -+#define BT_8703B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 -+ -+#define BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 -+ -+enum bt_8703b_1ant_signal_state { -+ BT_8703B_1ANT_SIG_STA_SET_TO_LOW = 0x0, -+ BT_8703B_1ANT_SIG_STA_SET_BY_HW = 0x0, -+ BT_8703B_1ANT_SIG_STA_SET_TO_HIGH = 0x1, -+ BT_8703B_1ANT_SIG_STA_MAX -+}; -+ -+enum bt_8703b_1ant_path_ctrl_owner { -+ BT_8703B_1ANT_PCO_BTSIDE = 0x0, -+ BT_8703B_1ANT_PCO_WLSIDE = 0x1, -+ BT_8703B_1ANT_PCO_MAX -+}; -+ -+enum bt_8703b_1ant_gnt_ctrl_type { -+ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, -+ BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW = 0x1, -+ BT_8703B_1ANT_GNT_TYPE_MAX -+}; -+ -+enum bt_8703b_1ant_gnt_ctrl_block { -+ BT_8703B_1ANT_GNT_BLOCK_RFC_BB = 0x0, -+ BT_8703B_1ANT_GNT_BLOCK_RFC = 0x1, -+ BT_8703B_1ANT_GNT_BLOCK_BB = 0x2, -+ BT_8703B_1ANT_GNT_BLOCK_MAX -+}; -+ -+enum bt_8703b_1ant_lte_coex_table_type { -+ BT_8703B_1ANT_CTT_WL_VS_LTE = 0x0, -+ BT_8703B_1ANT_CTT_BT_VS_LTE = 0x1, -+ BT_8703B_1ANT_CTT_MAX -+}; -+ -+enum bt_8703b_1ant_lte_break_table_type { -+ BT_8703B_1ANT_LBTT_WL_BREAK_LTE = 0x0, -+ BT_8703B_1ANT_LBTT_BT_BREAK_LTE = 0x1, -+ BT_8703B_1ANT_LBTT_LTE_BREAK_WL = 0x2, -+ BT_8703B_1ANT_LBTT_LTE_BREAK_BT = 0x3, -+ BT_8703B_1ANT_LBTT_MAX -+}; -+ -+enum bt_info_src_8703b_1ant { -+ BT_INFO_SRC_8703B_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8703B_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8703B_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8703B_1ANT_MAX -+}; -+ -+enum bt_8703b_1ant_bt_status { -+ BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8703B_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8703B_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8703B_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8703B_1ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8703b_1ant_wifi_status { -+ BT_8703B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8703B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8703B_1ANT_WIFI_STATUS_MAX -+}; -+ -+enum bt_8703b_1ant_coex_algo { -+ BT_8703B_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8703B_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8703B_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8703B_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8703B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8703B_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8703B_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8703B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8703B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8703B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8703B_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8703B_1ANT_COEX_ALGO_MAX = 0xb, -+}; -+ -+struct coex_dm_8703b_1ant { -+ /* hw setting */ -+ u8 pre_ant_pos_type; -+ u8 cur_ant_pos_type; -+ /* fw mechanism */ -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean auto_tdma_adjust; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ /* sw mechanism */ -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ -+ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ -+ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ -+ u16 backup_retry_limit; -+ u8 backup_ampdu_max_time; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ u32 pre_ra_mask; -+ u32 cur_ra_mask; -+ u8 pre_arfr_type; -+ u8 cur_arfr_type; -+ u8 pre_retry_limit_type; -+ u8 cur_retry_limit_type; -+ u8 pre_ampdu_time_type; -+ u8 cur_ampdu_time_type; -+ u32 arp_cnt; -+ -+ u8 error_condition; -+}; -+ -+struct coex_sta_8703b_1ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ boolean bt_hi_pri_link_exist; -+ u8 num_of_profile; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 specific_pkt_period_cnt; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ s8 bt_rssi; -+ boolean bt_tx_rx_mask; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8703B_1ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8703B_1ANT_MAX]; -+ boolean bt_whck_test; -+ boolean c2h_bt_inquiry_page; -+ boolean c2h_bt_page; /* Add for win8.1 page out issue */ -+ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ u32 pop_event_cnt; -+ u8 scan_ap_num; -+ -+ u32 crc_ok_cck; -+ u32 crc_ok_11g; -+ u32 crc_ok_11n; -+ u32 crc_ok_11n_agg; -+ -+ u32 crc_err_cck; -+ u32 crc_err_11g; -+ u32 crc_err_11n; -+ u32 crc_err_11n_agg; -+ -+ boolean cck_lock; -+ boolean pre_ccklock; -+ boolean cck_ever_lock; -+ u8 coex_table_type; -+ -+ boolean force_lps_on; -+ u32 wrong_profile_notification; -+ -+ boolean concurrent_rx_mode_on; -+ -+ u16 score_board; -+ -+ u8 a2dp_bit_pool; -+ u8 cut_version; -+ boolean acl_busy; -+ boolean wl_rf_off_on_event; -+ boolean bt_create_connection; -+ boolean gnt_control_by_PTA; -+}; -+ -+#define BT_8703B_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -+#define BT_8703B_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -+#define BT_8703B_1ANT_ANTDET_BUF_LEN 16 -+ -+struct psdscan_sta_8703b_1ant { -+ -+ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ -+ u32 ant_det_bt_tx_time; -+ u32 ant_det_pre_psdscan_peak_val; -+ boolean ant_det_is_ant_det_available; -+ u32 ant_det_psd_scan_peak_val; -+ boolean ant_det_is_btreply_available; -+ u32 ant_det_psd_scan_peak_freq; -+ -+ u8 ant_det_result; -+ u8 ant_det_peak_val[BT_8703B_1ANT_ANTDET_BUF_LEN]; -+ u8 ant_det_peak_freq[BT_8703B_1ANT_ANTDET_BUF_LEN]; -+ u32 ant_det_try_count; -+ u32 ant_det_fail_count; -+ u32 ant_det_inteval_count; -+ u32 ant_det_thres_offset; -+ -+ u32 real_cent_freq; -+ s32 real_offset; -+ u32 real_span; -+ -+ u32 psd_band_width; /* unit: Hz */ -+ u32 psd_point; /* 128/256/512/1024 */ -+ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_start_point; -+ u32 psd_stop_point; -+ u32 psd_max_value_point; -+ u32 psd_max_value; -+ u32 psd_start_base; -+ u32 psd_avg_num; /* 1/8/16/32 */ -+ u32 psd_gen_count; -+ boolean is_psd_running; -+ boolean is_psd_show_max_only; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8703b1ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8703b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -+void ex_halbtc8703b1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8703b1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8703b1ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8703b1ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8703b1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8703b1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8703b1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8703b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8703b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8703b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8703b1ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8703b1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8703b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -+void ex_halbtc8703b1ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist); -+void ex_halbtc8703b1ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+void ex_halbtc8703b1ant_antenna_isolation(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+ -+void ex_halbtc8703b1ant_psd_scan(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+void ex_halbtc8703b1ant_display_ant_detection(IN struct btc_coexist *btcoexist); -+ -+#else -+#define ex_halbtc8703b1ant_power_on_setting(btcoexist) -+#define ex_halbtc8703b1ant_pre_load_firmware(btcoexist) -+#define ex_halbtc8703b1ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8703b1ant_init_coex_dm(btcoexist) -+#define ex_halbtc8703b1ant_ips_notify(btcoexist, type) -+#define ex_halbtc8703b1ant_lps_notify(btcoexist, type) -+#define ex_halbtc8703b1ant_scan_notify(btcoexist, type) -+#define ex_halbtc8703b1ant_connect_notify(btcoexist, type) -+#define ex_halbtc8703b1ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8703b1ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8703b1ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8703b1ant_rf_status_notify(btcoexist, type) -+#define ex_halbtc8703b1ant_halt_notify(btcoexist) -+#define ex_halbtc8703b1ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8703b1ant_coex_dm_reset(btcoexist) -+#define ex_halbtc8703b1ant_periodical(btcoexist) -+#define ex_halbtc8703b1ant_display_coex_info(btcoexist) -+#define ex_halbtc8703b1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8703b1ant_antenna_isolation(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8703b1ant_psd_scan(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8703b1ant_display_ant_detection(btcoexist) -+ -+#endif -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.c 2018-02-11 21:44:27.145146055 +0200 -@@ -0,0 +1,1544 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8723A Co-exist mechanism -+// -+// History -+// 2012/08/22 Cosa first check in. -+// 2012/11/14 Cosa Revise for 8723A 1Ant out sourcing. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8723a1Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8723A_1ANT GLCoexDm8723a1Ant; -+static PCOEX_DM_8723A_1ANT pCoexDm=&GLCoexDm8723a1Ant; -+static COEX_STA_8723A_1ANT GLCoexSta8723a1Ant; -+static PCOEX_STA_8723A_1ANT pCoexSta=&GLCoexSta8723a1Ant; -+ -+const char *const GLBtInfoSrc8723a1Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8723a1ant_ -+//============================================================ -+VOID -+halbtc8723a1ant_Reg0x550Bit3( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSet -+ ) -+{ -+ u1Byte u1tmp=0; -+ -+ u1tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x550); -+ if(bSet) -+ { -+ u1tmp |= BIT3; -+ } -+ else -+ { -+ u1tmp &= ~BIT3; -+ } -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x550, u1tmp); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set 0x550[3]=%d\n", (bSet? 1:0))); -+} -+ -+VOID -+halbtc8723a1ant_NotifyFwScan( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte scanType -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(BTC_SCAN_START == scanType) -+ H2C_Parameter[0] = 0x1; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Notify FW for wifi scan, write 0x3b=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x3b, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a1ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x38=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x38, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a1ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xf0ff7); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+VOID -+halbtc8723a1ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8723a1ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8723a1ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte tmpU1; -+ -+ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); -+ tmpU1 |= BIT0; -+ if(bLowPenaltyRa) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); -+ tmpU1 &= ~BIT2; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); -+ tmpU1 |= BIT2; -+ } -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -+} -+ -+VOID -+halbtc8723a1ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ return; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8723a1ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8723a1ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8723a1ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8723a1ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8723a1ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x25=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x25, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a1ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8723a1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8723a1ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ u1Byte realByte1=byte1, realByte5=byte5; -+ BOOLEAN bApEnable=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); -+ -+ // byte1[1:0] != 0 means enable pstdma -+ // for 2Ant bt coexist, if byte1 != 0 means enable pstdma -+ if(byte1) -+ { -+ if(bApEnable) -+ { -+ if(type != 5 && type != 12) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW for 1Ant AP mode\n")); -+ realByte1 &= ~BIT4; -+ realByte1 |= BIT5; -+ -+ realByte5 |= BIT5; -+ realByte5 &= ~BIT6; -+ } -+ } -+ } -+ H2C_Parameter[0] = realByte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = realByte5; -+ -+ pCoexDm->psTdmaPara[0] = realByte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = realByte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x3a(5bytes)=0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x3a, 5, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a1ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", -+ (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ if(pCoexDm->bCurPsTdmaOn) -+ { -+ switch(pCoexDm->curPsTdma) -+ { -+ case 1: -+ default: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x1a, 0x1a, 0x0, 0x40); -+ break; -+ case 2: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x12, 0x12, 0x0, 0x40); -+ break; -+ case 3: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x3f, 0x3, 0x10, 0x40); -+ break; -+ case 4: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x15, 0x3, 0x10, 0x0); -+ break; -+ case 5: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0xa9, 0x15, 0x3, 0x35, 0xc0); -+ break; -+ -+ case 8: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 9: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 10: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 11: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x5, 0x5, 0x0, 0x40); -+ break; -+ case 12: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0xa9, 0xa, 0x3, 0x15, 0xc0); -+ break; -+ -+ case 18: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ -+ case 20: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x2a, 0x2a, 0x0, 0x0); -+ break; -+ case 21: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x20, 0x3, 0x10, 0x40); -+ break; -+ case 22: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x1a, 0x1a, 0x2, 0x40); -+ break; -+ case 23: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x12, 0x12, 0x2, 0x40); -+ break; -+ case 24: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0xa, 0xa, 0x2, 0x40); -+ break; -+ case 25: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x5, 0x5, 0x2, 0x40); -+ break; -+ case 26: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 27: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x5, 0x5, 0x2, 0x40); -+ break; -+ case 28: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x3, 0x2f, 0x2f, 0x0, 0x0); -+ break; -+ -+ } -+ } -+ else -+ { -+ // disable PS tdma -+ switch(pCoexDm->curPsTdma) -+ { -+ case 8: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x8, 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 0: -+ default: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x0, 0x0, 0x0, 0x0, 0x0); -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x860, 0x210); -+ break; -+ case 9: -+ halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x0, 0x0, 0x0, 0x0, 0x0); -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x860, 0x110); -+ break; -+ -+ } -+ } -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+ -+VOID -+halbtc8723a1ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw all off -+ halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ // sw all off -+ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ // hw all off -+ halbtc8723a1ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+} -+ -+VOID -+halbtc8723a1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+} -+ -+VOID -+halbtc8723a1ant_BtEnableAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+} -+ -+VOID -+halbtc8723a1ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp; -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+} -+ -+VOID -+halbtc8723a1ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ bPreBtDisabled = bBtDisabled; -+ if(!bBtDisabled) -+ { -+ halbtc8723a1ant_BtEnableAction(pBtCoexist); -+ } -+ else -+ { -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ } -+ } -+} -+ -+VOID -+halbtc8723a1ant_TdmaDurationAdjust( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0; -+ u1Byte btState; -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ u4Byte wifiBw; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ btState = pCoexDm->btStatus; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], TdmaDurationAdjust()\n")); -+ if(pCoexDm->psTdmaGlobalCnt != pCoexDm->psTdmaMonitorCnt) -+ { -+ pCoexDm->psTdmaMonitorCnt = 0; -+ pCoexDm->psTdmaGlobalCnt = 0; -+ } -+ if(pCoexDm->psTdmaMonitorCnt == 0) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], first run BT A2DP + WiFi busy state!!\n")); -+ if(btState == BT_STATE_8723A_1ANT_ACL_ONLY_BUSY) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ pCoexDm->psTdmaDuAdjType = 22; -+ } -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], retryCount = %d\n", retryCount)); -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if ³sÄò n ­Ó2¬í retry count¬°0, «h½Õ¼eWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if ³sÄò 2 ­Ó2¬í retry count< 3, «h½Õ¯¶WiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, ¥u­n1¦¸ retry count > 3, «h½Õ¯¶WiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT TxRx counter H+L <= 1200\n")); -+ if(btState != BT_STATE_8723A_1ANT_ACL_ONLY_BUSY) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], NOT ACL only busy!\n")); -+ if(BTC_WIFI_BW_HT40 != wifiBw) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 20MHz\n")); -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 22) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ pCoexDm->psTdmaDuAdjType = 23; -+ } -+ else if(pCoexDm->curPsTdma == 23) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); -+ pCoexDm->psTdmaDuAdjType = 24; -+ } -+ else if(pCoexDm->curPsTdma == 24) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); -+ pCoexDm->psTdmaDuAdjType = 25; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 25) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); -+ pCoexDm->psTdmaDuAdjType = 24; -+ } -+ else if(pCoexDm->curPsTdma == 24) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ pCoexDm->psTdmaDuAdjType = 23; -+ } -+ else if(pCoexDm->curPsTdma == 23) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); -+ pCoexDm->psTdmaDuAdjType = 22; -+ } -+ } -+ // error handle, if not in the following state, -+ // set psTdma again. -+ if( (pCoexDm->psTdmaDuAdjType != 22) && -+ (pCoexDm->psTdmaDuAdjType != 23) && -+ (pCoexDm->psTdmaDuAdjType != 24) && -+ (pCoexDm->psTdmaDuAdjType != 25) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], duration case out of handle!!\n")); -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ pCoexDm->psTdmaDuAdjType = 23; -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 40MHz\n")); -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 23) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); -+ pCoexDm->psTdmaDuAdjType = 24; -+ } -+ else if(pCoexDm->curPsTdma == 24) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); -+ pCoexDm->psTdmaDuAdjType = 25; -+ } -+ else if(pCoexDm->curPsTdma == 25) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 27); -+ pCoexDm->psTdmaDuAdjType = 27; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 27) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); -+ pCoexDm->psTdmaDuAdjType = 25; -+ } -+ else if(pCoexDm->curPsTdma == 25) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); -+ pCoexDm->psTdmaDuAdjType = 24; -+ } -+ else if(pCoexDm->curPsTdma == 24) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); -+ pCoexDm->psTdmaDuAdjType = 23; -+ } -+ } -+ // error handle, if not in the following state, -+ // set psTdma again. -+ if( (pCoexDm->psTdmaDuAdjType != 23) && -+ (pCoexDm->psTdmaDuAdjType != 24) && -+ (pCoexDm->psTdmaDuAdjType != 25) && -+ (pCoexDm->psTdmaDuAdjType != 27) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], duration case out of handle!!\n")); -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); -+ pCoexDm->psTdmaDuAdjType = 24; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ACL only busy\n")); -+ if (result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ } -+ -+ // error handle, if not in the following state, -+ // set psTdma again. -+ if( (pCoexDm->psTdmaDuAdjType != 1) && -+ (pCoexDm->psTdmaDuAdjType != 2) && -+ (pCoexDm->psTdmaDuAdjType != 9) && -+ (pCoexDm->psTdmaDuAdjType != 11) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], duration case out of handle!!\n")); -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ } -+ } -+ } -+ -+ // if current PsTdma not match with the recorded one (when scan, dhcp...), -+ // then we have to adjust it back to the previous record one. -+ if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", -+ pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if( !bScan && !bLink && !bRoam) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); -+ } -+ } -+ pCoexDm->psTdmaMonitorCnt++; -+} -+ -+ -+VOID -+halbtc8723a1ant_CoexForWifiConnect( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bWifiBusy=FALSE; -+ u1Byte btState, btInfoOriginal=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ btState = pCoexDm->btStatus; -+ btInfoOriginal = pCoexSta->btInfoC2h[BT_INFO_SRC_8723A_1ANT_BT_RSP][0]; -+ -+ if(bWifiConnected) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi connected!!\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if( !bWifiBusy && -+ ((BT_STATE_8723A_1ANT_NO_CONNECTION == btState) || -+ (BT_STATE_8723A_1ANT_CONNECT_IDLE == btState)) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], [Wifi is idle] or [Bt is non connected idle or Bt is connected idle]!!\n")); -+ -+ if(BT_STATE_8723A_1ANT_NO_CONNECTION == btState) -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+ else if(BT_STATE_8723A_1ANT_CONNECT_IDLE == btState) -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0xc0); -+ } -+ else -+ { -+ if( (BT_STATE_8723A_1ANT_SCO_ONLY_BUSY == btState) || -+ (BT_STATE_8723A_1ANT_ACL_SCO_BUSY == btState) || -+ (BT_STATE_8723A_1ANT_HID_BUSY == btState) || -+ (BT_STATE_8723A_1ANT_HID_SCO_BUSY == btState) ) -+ { -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0x60); -+ } -+ else -+ { -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0xc0); -+ } -+ switch(btState) -+ { -+ case BT_STATE_8723A_1ANT_NO_CONNECTION: -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ break; -+ case BT_STATE_8723A_1ANT_CONNECT_IDLE: -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ break; -+ case BT_STATE_8723A_1ANT_INQ_OR_PAG: -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ break; -+ case BT_STATE_8723A_1ANT_SCO_ONLY_BUSY: -+ case BT_STATE_8723A_1ANT_ACL_SCO_BUSY: -+ case BT_STATE_8723A_1ANT_HID_BUSY: -+ case BT_STATE_8723A_1ANT_HID_SCO_BUSY: -+ halbtc8723a1ant_TdmaDurationAdjust(pBtCoexist); -+ break; -+ case BT_STATE_8723A_1ANT_ACL_ONLY_BUSY: -+ if (btInfoOriginal&BT_INFO_8723A_1ANT_B_A2DP) -+ { -+ halbtc8723a1ant_TdmaDurationAdjust(pBtCoexist); -+ } -+ else if(btInfoOriginal&BT_INFO_8723A_1ANT_B_FTP) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ } -+ else if( (btInfoOriginal&BT_INFO_8723A_1ANT_B_A2DP) && -+ (btInfoOriginal&BT_INFO_8723A_1ANT_B_FTP) ) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ } -+ else -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ } -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], error!!!, undefined case in halbtc8723a1ant_CoexForWifiConnect()!!\n")); -+ break; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is disconnected!!\n")); -+ } -+ -+ pCoexDm->psTdmaGlobalCnt++; -+} -+ -+//============================================================ -+// work around function start with wa_halbtc8723a1ant_ -+//============================================================ -+VOID -+wa_halbtc8723a1ant_MonitorC2h( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte tmp1b=0x0; -+ u4Byte curC2hTotalCnt=0x0; -+ static u4Byte preC2hTotalCnt=0x0, sameCntPollingTime=0x0; -+ -+ curC2hTotalCnt+=pCoexSta->btInfoC2hCnt[BT_INFO_SRC_8723A_1ANT_BT_RSP]; -+ -+ if(curC2hTotalCnt == preC2hTotalCnt) -+ { -+ sameCntPollingTime++; -+ } -+ else -+ { -+ preC2hTotalCnt = curC2hTotalCnt; -+ sameCntPollingTime = 0; -+ } -+ -+ if(sameCntPollingTime >= 2) -+ { -+ tmp1b = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x1af); -+ if(tmp1b != 0x0) -+ { -+ pCoexSta->c2hHangDetectCnt++; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x1af, 0x0); -+ } -+ } -+} -+ -+//============================================================ -+// extern function start with EXhalbtc8723a1ant_ -+//============================================================ -+VOID -+EXhalbtc8723a1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Init HW Config!!\n")); -+ -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); -+ -+ // enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ -+ // coex table -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, 0x0); // 1-Ant coex -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, 0xffff); // wifi break table -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, 0x55555555); //coex table -+ -+ // antenna switch control parameter -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x858, 0xaaaaaaaa); -+ -+ pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x860, 0x210); //set antenna at wifi side if ANTSW is software control -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x870, 0x300); //SPDT(connected with TRSW) control by hardware PTA -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x874, 0x22804000); //ANTSW keep by GNT_BT -+ -+ // coexistence parameters -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1); // enable RTK mode PTA -+} -+ -+VOID -+EXhalbtc8723a1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8723a1ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8723a1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8723A_1ANT_BT_STATUS_IDLE == pCoexDm->btStatus)? "idle":( (BT_8723A_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy"))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt); -+ CL_PRINTF(cliBuf); -+ -+ if(pStackInfo->bProfileNotified) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723a1Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "write 0x1af=0x0 num", \ -+ pCoexSta->c2hHangDetectCnt); -+ CL_PRINTF(cliBuf); -+ -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "SM1[ShRf/ LpRA/ LimDig]", \ -+ pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(!pBtCoexist->bManualControl) -+ { -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", "IgnWlanAct", \ -+ pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ } -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x783); -+ u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x796); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/ 0x783/ 0x796", \ -+ u1Tmp[0], u1Tmp[1], u1Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x880", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ -+ u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x484); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x484(rate adaptive)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); -+ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xdac); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0xda0/0xda4/0xda8/0xdac(FA cnt)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u4Tmp[3]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770 (hp rx[31:16]/tx[15:0])", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(lp rx[31:16]/tx[15:0])", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8723a1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ halbtc8723a1ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ //halbtc8723a1ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE; -+ -+ halbtc8723a1ant_NotifyFwScan(pBtCoexist, type); -+ -+ if(pBtCoexist->btInfo.bBtDisabled) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+ } -+ else -+ { -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ //set 0x550[3]=1 before PsTdma -+ halbtc8723a1ant_Reg0x550Bit3(pBtCoexist, TRUE); -+ } -+ -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ else -+ { -+ halbtc8723a1ant_CoexForWifiConnect(pBtCoexist); -+ } -+ } -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE; -+ -+ if(pBtCoexist->btInfo.bBtDisabled) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+ } -+ else -+ { -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ //set 0x550[3]=1 before PsTdma -+ halbtc8723a1ant_Reg0x550Bit3(pBtCoexist, TRUE); -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); // extend wifi slot -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(!bWifiConnected) // non-connected scan -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ else -+ { -+ halbtc8723a1ant_CoexForWifiConnect(pBtCoexist); -+ } -+ } -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ if(pBtCoexist->btInfo.bBtDisabled) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+ } -+ else -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 18); -+ } -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bBtHsOn=FALSE, bBtBusy=FALSE, bForceLps=FALSE; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ -+ rspSource = BT_INFO_SRC_8723A_1ANT_BT_RSP; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 0) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if(BT_INFO_SRC_8723A_1ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = -+ pCoexSta->btInfoC2h[rspSource][1]; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][2]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][3]; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8723A_1ANT_B_INQ_PAGE) -+ { -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ } -+ else -+ { -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ } -+ btInfo &= ~BIT2; -+ if(!(btInfo & BIT0)) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_NO_CONNECTION; -+ bForceLps = FALSE; -+ } -+ else -+ { -+ bForceLps = TRUE; -+ if(btInfo == 0x1) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_CONNECT_IDLE; -+ } -+ else if(btInfo == 0x9) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_ACL_ONLY_BUSY; -+ bBtBusy = TRUE; -+ } -+ else if(btInfo == 0x13) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_SCO_ONLY_BUSY; -+ bBtBusy = TRUE; -+ } -+ else if(btInfo == 0x1b) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_ACL_SCO_BUSY; -+ bBtBusy = TRUE; -+ } -+ else if(btInfo == 0x29) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_HID_BUSY; -+ bBtBusy = TRUE; -+ } -+ else if(btInfo == 0x3b) -+ { -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_HID_SCO_BUSY; -+ bBtBusy = TRUE; -+ } -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bBtBusy); -+ if(bForceLps) -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); -+ else -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); -+ -+ if( (BT_STATE_8723A_1ANT_NO_CONNECTION == pCoexDm->btStatus) || -+ (BT_STATE_8723A_1ANT_CONNECT_IDLE == pCoexDm->btStatus) ) -+ { -+ if(pCoexSta->bC2hBtInquiryPage) -+ pCoexDm->btStatus = BT_STATE_8723A_1ANT_INQ_OR_PAG; -+ } -+} -+ -+VOID -+EXhalbtc8723a1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ halbtc8723a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ -+ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, FORCE_EXEC, FALSE); -+ halbtc8723a1ant_RfShrink(pBtCoexist, FORCE_EXEC, FALSE); -+ -+ halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ EXhalbtc8723a1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8723a1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE, bWifiConnected=FALSE; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Periodical!!\n")); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ // work around for c2h hang -+ wa_halbtc8723a1ant_MonitorC2h(pBtCoexist); -+ -+ halbtc8723a1ant_QueryBtInfo(pBtCoexist); -+ halbtc8723a1ant_MonitorBtCtr(pBtCoexist); -+ halbtc8723a1ant_MonitorBtEnableDisable(pBtCoexist); -+ -+ -+ if(bScan) -+ return; -+ if(bLink) -+ return; -+ -+ if(bWifiConnected) -+ { -+ if(pBtCoexist->btInfo.bBtDisabled) -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); -+ -+ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ else -+ { -+ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a1ant_CoexForWifiConnect(pBtCoexist); -+ } -+ } -+ else -+ { -+ halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+} -+ -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a1Ant.h 2018-02-11 21:44:27.145146055 +0200 -@@ -0,0 +1,171 @@ -+//=========================================== -+// The following is for 8723A 1Ant BT Co-exist definition -+//=========================================== -+#define BT_INFO_8723A_1ANT_B_FTP BIT7 -+#define BT_INFO_8723A_1ANT_B_A2DP BIT6 -+#define BT_INFO_8723A_1ANT_B_HID BIT5 -+#define BT_INFO_8723A_1ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8723A_1ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8723A_1ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8723A_1ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8723A_1ANT_B_CONNECTION BIT0 -+ -+typedef enum _BT_STATE_8723A_1ANT{ -+ BT_STATE_8723A_1ANT_DISABLED = 0, -+ BT_STATE_8723A_1ANT_NO_CONNECTION = 1, -+ BT_STATE_8723A_1ANT_CONNECT_IDLE = 2, -+ BT_STATE_8723A_1ANT_INQ_OR_PAG = 3, -+ BT_STATE_8723A_1ANT_ACL_ONLY_BUSY = 4, -+ BT_STATE_8723A_1ANT_SCO_ONLY_BUSY = 5, -+ BT_STATE_8723A_1ANT_ACL_SCO_BUSY = 6, -+ BT_STATE_8723A_1ANT_HID_BUSY = 7, -+ BT_STATE_8723A_1ANT_HID_SCO_BUSY = 8, -+ BT_STATE_8723A_1ANT_MAX -+}BT_STATE_8723A_1ANT, *PBT_STATE_8723A_1ANT; -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8723A_1ANT 2 -+ -+typedef enum _BT_INFO_SRC_8723A_1ANT{ -+ BT_INFO_SRC_8723A_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8723A_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8723A_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8723A_1ANT_MAX -+}BT_INFO_SRC_8723A_1ANT,*PBT_INFO_SRC_8723A_1ANT; -+ -+typedef enum _BT_8723A_1ANT_BT_STATUS{ -+ BT_8723A_1ANT_BT_STATUS_IDLE = 0x0, -+ BT_8723A_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8723A_1ANT_BT_STATUS_NON_IDLE = 0x2, -+ BT_8723A_1ANT_BT_STATUS_MAX -+}BT_8723A_1ANT_BT_STATUS,*PBT_8723A_1ANT_BT_STATUS; -+ -+typedef enum _BT_8723A_1ANT_COEX_ALGO{ -+ BT_8723A_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8723A_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8723A_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8723A_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8723A_1ANT_COEX_ALGO_PANEDR = 0x4, -+ BT_8723A_1ANT_COEX_ALGO_PANHS = 0x5, -+ BT_8723A_1ANT_COEX_ALGO_PANEDR_A2DP = 0x6, -+ BT_8723A_1ANT_COEX_ALGO_PANEDR_HID = 0x7, -+ BT_8723A_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x8, -+ BT_8723A_1ANT_COEX_ALGO_HID_A2DP = 0x9, -+ BT_8723A_1ANT_COEX_ALGO_MAX -+}BT_8723A_1ANT_COEX_ALGO,*PBT_8723A_1ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8723A_1ANT{ -+ // fw mechanism -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ u4Byte psTdmaMonitorCnt; -+ u4Byte psTdmaGlobalCnt; -+ BOOLEAN bResetTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+} COEX_DM_8723A_1ANT, *PCOEX_DM_8723A_1ANT; -+ -+typedef struct _COEX_STA_8723A_1ANT{ -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ u1Byte btRssi; -+ u1Byte preBtRssiState; -+ u1Byte preBtRssiState1; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8723A_1ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8723A_1ANT_MAX]; -+ BOOLEAN bC2hBtInquiryPage; -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ //BOOLEAN bHoldForStackOperation; -+ //u1Byte bHoldPeriodCnt; -+ // this is for c2h hang work-around -+ u4Byte c2hHangDetectCnt; -+}COEX_STA_8723A_1ANT, *PCOEX_STA_8723A_1ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8723a1ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a1ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a1ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a1ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a1ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a1ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a1ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a1ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a1ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8723a1ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a1ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a1ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.c 2018-02-11 21:44:27.145146055 +0200 -@@ -0,0 +1,3746 @@ -+//============================================================ -+// Description: -+// -+// This file is for RTL8723A Co-exist mechanism -+// -+// History -+// 2012/08/22 Cosa first check in. -+// 2012/11/14 Cosa Revise for 8723A 2Ant out sourcing. -+// -+//============================================================ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+#include "HalBtc8723a2Ant.tmh" -+#endif -+ -+#if(BT_30_SUPPORT == 1) -+//============================================================ -+// Global variables, these are static variables -+//============================================================ -+static COEX_DM_8723A_2ANT GLCoexDm8723a2Ant; -+static PCOEX_DM_8723A_2ANT pCoexDm=&GLCoexDm8723a2Ant; -+static COEX_STA_8723A_2ANT GLCoexSta8723a2Ant; -+static PCOEX_STA_8723A_2ANT pCoexSta=&GLCoexSta8723a2Ant; -+ -+const char *const GLBtInfoSrc8723a2Ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+//============================================================ -+// local function proto type if needed -+//============================================================ -+//============================================================ -+// local function start with halbtc8723a2ant_ -+//============================================================ -+BOOLEAN -+halbtc8723a2ant_IsWifiIdle( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if(bWifiConnected) -+ return FALSE; -+ if(bScan) -+ return FALSE; -+ if(bLink) -+ return FALSE; -+ if(bRoam) -+ return FALSE; -+ -+ return TRUE; -+} -+ -+BOOLEAN -+halbtc8723a2ant_IsWifiConnectedIdle( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE, bScan=FALSE, bLink=FALSE, bRoam=FALSE, bWifiBusy=FALSE; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ -+ if(bScan) -+ return FALSE; -+ if(bLink) -+ return FALSE; -+ if(bRoam) -+ return FALSE; -+ if(bWifiConnected && !bWifiBusy) -+ return TRUE; -+ else -+ return FALSE; -+} -+ -+u1Byte -+halbtc8723a2ant_BtRssiState( -+ u1Byte levelNum, -+ u1Byte rssiThresh, -+ u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte btRssi=0; -+ u1Byte btRssiState=pCoexSta->preBtRssiState; -+ -+ btRssi = pCoexSta->btRssi; -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); -+ return pCoexSta->preBtRssiState; -+ } -+ -+ if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) -+ { -+ btRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(btRssi < rssiThresh) -+ { -+ btRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(btRssi < rssiThresh1) -+ { -+ btRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ btRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preBtRssiState = btRssiState; -+ -+ return btRssiState; -+} -+ -+u1Byte -+halbtc8723a2ant_WifiRssiState( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte index, -+ IN u1Byte levelNum, -+ IN u1Byte rssiThresh, -+ IN u1Byte rssiThresh1 -+ ) -+{ -+ s4Byte wifiRssi=0; -+ u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ -+ if(levelNum == 2) -+ { -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ else if(levelNum == 3) -+ { -+ if(rssiThresh > rssiThresh1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); -+ return pCoexSta->preWifiRssiState[index]; -+ } -+ -+ if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) -+ { -+ if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_LOW; -+ } -+ } -+ else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || -+ (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) -+ { -+ if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) -+ { -+ wifiRssiState = BTC_RSSI_STATE_HIGH; -+ } -+ else if(wifiRssi < rssiThresh) -+ { -+ wifiRssiState = BTC_RSSI_STATE_LOW; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; -+ } -+ } -+ else -+ { -+ if(wifiRssi < rssiThresh1) -+ { -+ wifiRssiState = BTC_RSSI_STATE_MEDIUM; -+ } -+ else -+ { -+ wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ } -+ -+ pCoexSta->preWifiRssiState[index] = wifiRssiState; -+ -+ return wifiRssiState; -+} -+ -+VOID -+halbtc8723a2ant_IndicateWifiChnlBwInfo( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ u1Byte H2C_Parameter[3] ={0}; -+ u4Byte wifiBw; -+ u1Byte wifiCentralChnl; -+ -+ // only 2.4G we need to inform bt the chnl mask -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); -+ if( (BTC_MEDIA_CONNECT == type) && -+ (wifiCentralChnl <= 14) ) -+ { -+ H2C_Parameter[0] = 0x1; -+ H2C_Parameter[1] = wifiCentralChnl; -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ H2C_Parameter[2] = 0x30; -+ else -+ H2C_Parameter[2] = 0x20; -+ } -+ -+ pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; -+ pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; -+ pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x19=0x%x\n", -+ H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x19, 3, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a2ant_QueryBtInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ pCoexSta->bC2hBtInfoReqSent = TRUE; -+ -+ H2C_Parameter[0] |= BIT0; // trigger -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x38=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x38, 1, H2C_Parameter); -+} -+u1Byte -+halbtc8723a2ant_ActionAlgorithm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ BOOLEAN bBtHsOn=FALSE, bBtBusy=FALSE, bLimitedDig=FALSE; -+ u1Byte algorithm=BT_8723A_2ANT_COEX_ALGO_UNDEFINED; -+ u1Byte numOfDiffProfile=0; -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ -+ //====================== -+ // here we get BT status first -+ //====================== -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_IDLE; -+ -+ if((pStackInfo->bScoExist) ||(bBtHsOn) ||(pStackInfo->bHidExist)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO or HID or HS exists, set BT non-idle !!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; -+ } -+ else -+ { -+ // A2dp profile -+ if( (pBtCoexist->stackInfo.numOfLink == 1) && -+ (pStackInfo->bA2dpExist) ) -+ { -+ if( (pCoexSta->lowPriorityTx+ pCoexSta->lowPriorityRx) < 100) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP, low priority tx+rx < 100, set BT connected-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP, low priority tx+rx >= 100, set BT non-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; -+ } -+ } -+ // Pan profile -+ if( (pBtCoexist->stackInfo.numOfLink == 1) && -+ (pStackInfo->bPanExist) ) -+ { -+ if((pCoexSta->lowPriorityTx+ pCoexSta->lowPriorityRx) < 600) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN, low priority tx+rx < 600, set BT connected-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ } -+ else -+ { -+ if(pCoexSta->lowPriorityTx) -+ { -+ if((pCoexSta->lowPriorityRx /pCoexSta->lowPriorityTx)>9 ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN, low priority rx/tx > 9, set BT connected-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ } -+ } -+ } -+ if(BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN, set BT non-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; -+ } -+ } -+ // Pan+A2dp profile -+ if( (pBtCoexist->stackInfo.numOfLink == 2) && -+ (pStackInfo->bA2dpExist) && -+ (pStackInfo->bPanExist) ) -+ { -+ if((pCoexSta->lowPriorityTx+ pCoexSta->lowPriorityRx) < 600) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN+A2DP, low priority tx+rx < 600, set BT connected-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ } -+ else -+ { -+ if(pCoexSta->lowPriorityTx) -+ { -+ if((pCoexSta->lowPriorityRx /pCoexSta->lowPriorityTx)>9 ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN+A2DP, low priority rx/tx > 9, set BT connected-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ } -+ } -+ } -+ if(BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN+A2DP, set BT non-idle!!!\n")); -+ pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; -+ } -+ } -+ } -+ if(BT_8723A_2ANT_BT_STATUS_IDLE != pCoexDm->btStatus) -+ { -+ bBtBusy = TRUE; -+ bLimitedDig = TRUE; -+ } -+ else -+ { -+ bBtBusy = FALSE; -+ bLimitedDig = FALSE; -+ } -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bLimitedDig); -+ //====================== -+ -+ if(!pStackInfo->bBtLinkExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); -+ return algorithm; -+ } -+ -+ if(pStackInfo->bScoExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bHidExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bPanExist) -+ numOfDiffProfile++; -+ if(pStackInfo->bA2dpExist) -+ numOfDiffProfile++; -+ -+ if(numOfDiffProfile == 1) -+ { -+ if(pStackInfo->bScoExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO only\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ if(pStackInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID; -+ } -+ else if(pStackInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_A2DP; -+ } -+ else if(pStackInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(HS) only\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANHS; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(EDR) only\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 2) -+ { -+ if(pStackInfo->bScoExist) -+ { -+ if(pStackInfo->bHidExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID; -+ } -+ else if(pStackInfo->bA2dpExist) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP ==> SCO\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; -+ } -+ else if(pStackInfo->bPanExist) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(HS)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(EDR)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(HS)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(EDR)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(HS)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(EDR)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile == 3) -+ { -+ if(pStackInfo->bScoExist) -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bA2dpExist ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP ==> HID\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID; -+ } -+ else if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(HS)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(EDR)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ else if( pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(HS)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ else -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(HS)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(EDR)\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ else if(numOfDiffProfile >= 3) -+ { -+ if(pStackInfo->bScoExist) -+ { -+ if( pStackInfo->bHidExist && -+ pStackInfo->bPanExist && -+ pStackInfo->bA2dpExist ) -+ { -+ if(bBtHsOn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n")); -+ -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); -+ algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+BOOLEAN -+halbtc8723a2ant_NeedToDecBtPwr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bRet=FALSE; -+ BOOLEAN bBtHsOn=FALSE, bWifiConnected=FALSE; -+ s4Byte btHsRssi=0; -+ u1Byte btRssiState=BTC_RSSI_STATE_HIGH; -+ -+ btRssiState = halbtc8723a2ant_BtRssiState(2, 42, 0); -+ -+ if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn)) -+ return FALSE; -+ if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected)) -+ return FALSE; -+ if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_HS_RSSI, &btHsRssi)) -+ return FALSE; -+ if(BTC_RSSI_LOW(btRssiState)) -+ return FALSE; -+ -+ if(bWifiConnected) -+ { -+ if(bBtHsOn) -+ { -+ if(btHsRssi > 37) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Need to decrease bt power for HS mode!!\n")); -+ bRet = TRUE; -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Need to decrease bt power for Wifi is connected!!\n")); -+ bRet = TRUE; -+ } -+ } -+ -+ return bRet; -+} -+ -+VOID -+halbtc8723a2ant_SetFwDacSwingLevel( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte dacSwingLvl -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ // There are several type of dacswing -+ // 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 -+ H2C_Parameter[0] = dacSwingLvl; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Set Dac Swing Level=0x%x\n", dacSwingLvl)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x29=0x%x\n", H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x29, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a2ant_SetFwDecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bDecBtPwr -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ H2C_Parameter[0] = 0; -+ -+ if(bDecBtPwr) -+ { -+ H2C_Parameter[0] |= BIT1; -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], decrease Bt Power : %s, FW write 0x21=0x%x\n", -+ (bDecBtPwr? "Yes!!":"No!!"), H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x21, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a2ant_DecBtPwr( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDecBtPwr -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s Dec BT power = %s\n", -+ (bForceExec? "force to":""), ((bDecBtPwr)? "ON":"OFF"))); -+ pCoexDm->bCurDecBtPwr = bDecBtPwr; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreDecBtPwr == pCoexDm->bCurDecBtPwr) -+ return; -+ } -+ halbtc8723a2ant_SetFwDecBtPwr(pBtCoexist, pCoexDm->bCurDecBtPwr); -+ -+ pCoexDm->bPreDecBtPwr = pCoexDm->bCurDecBtPwr; -+} -+ -+VOID -+halbtc8723a2ant_FwDacSwingLvl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u1Byte fwDacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set FW Dac Swing level = %d\n", -+ (bForceExec? "force to":""), fwDacSwingLvl)); -+ pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->preFwDacSwingLvl == pCoexDm->curFwDacSwingLvl) -+ return; -+ } -+ -+ halbtc8723a2ant_SetFwDacSwingLevel(pBtCoexist, pCoexDm->curFwDacSwingLvl); -+ -+ pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -+} -+ -+VOID -+halbtc8723a2ant_SetSwRfRxLpfCorner( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ if(bRxRfShrinkOn) -+ { -+ //Shrink RF Rx LPF corner -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xf0ff7); -+ } -+ else -+ { -+ //Resume RF Rx LPF corner -+ // After initialized, we can use pCoexDm->btRf0x1eBackup -+ if(pBtCoexist->bInitilized) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); -+ } -+ } -+} -+ -+VOID -+halbtc8723a2ant_RfShrink( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bRxRfShrinkOn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", -+ (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); -+ pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) -+ return; -+ } -+ halbtc8723a2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); -+ -+ pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -+} -+ -+VOID -+halbtc8723a2ant_SetSwPenaltyTxRateAdaptive( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ u1Byte tmpU1; -+ -+ tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); -+ tmpU1 |= BIT0; -+ if(bLowPenaltyRa) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); -+ tmpU1 &= ~BIT2; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); -+ tmpU1 |= BIT2; -+ } -+ -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -+} -+ -+VOID -+halbtc8723a2ant_LowPenaltyRa( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bLowPenaltyRa -+ ) -+{ -+ return; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", -+ (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); -+ pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) -+ return; -+ } -+ halbtc8723a2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); -+ -+ pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -+} -+ -+VOID -+halbtc8723a2ant_SetSwFullTimeDacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bSwDacSwingOn, -+ IN u4Byte swDacSwingLvl -+ ) -+{ -+ if(bSwDacSwingOn) -+ { -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, swDacSwingLvl); -+ } -+ else -+ { -+ pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0xc0); -+ } -+} -+ -+ -+VOID -+halbtc8723a2ant_DacSwing( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bDacSwingOn, -+ IN u4Byte dacSwingLvl -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", -+ (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); -+ pCoexDm->bCurDacSwingOn = bDacSwingOn; -+ pCoexDm->curDacSwingLvl = dacSwingLvl; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && -+ (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) -+ return; -+ } -+ delay_ms(30); -+ halbtc8723a2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); -+ -+ pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; -+ pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -+} -+ -+VOID -+halbtc8723a2ant_SetAdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ if(bAdcBackOff) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a07611); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a05611); -+ } -+} -+ -+VOID -+halbtc8723a2ant_AdcBackOff( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAdcBackOff -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", -+ (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); -+ pCoexDm->bCurAdcBackOff = bAdcBackOff; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) -+ return; -+ } -+ halbtc8723a2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); -+ -+ pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -+} -+ -+VOID -+halbtc8723a2ant_SetAgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ u1Byte rssiAdjustVal=0; -+ -+ if(bAgcTableEn) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4e1c0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4d1d0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4c1e0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4b1f0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4a200001); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xdc000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x90000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x51000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x12000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x00355); -+ -+ rssiAdjustVal = 6; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x641c0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x631d0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x621e0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x611f0001); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x60200001); -+ -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x32000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x71000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xb0000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xfc000); -+ pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x30355); -+ } -+ -+ // set rssiAdjustVal for wifi module. -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -+} -+ -+ -+VOID -+halbtc8723a2ant_AgcTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bAgcTableEn -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", -+ (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); -+ pCoexDm->bCurAgcTableEn = bAgcTableEn; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) -+ return; -+ } -+ halbtc8723a2ant_SetAgcTable(pBtCoexist, bAgcTableEn); -+ -+ pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -+} -+ -+VOID -+halbtc8723a2ant_SetCoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); -+ pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -+} -+ -+VOID -+halbtc8723a2ant_CoexTable( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN u4Byte val0x6c0, -+ IN u4Byte val0x6c8, -+ IN u1Byte val0x6cc -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", -+ (bForceExec? "force to":""), val0x6c0, val0x6c8, val0x6cc)); -+ pCoexDm->curVal0x6c0 = val0x6c0; -+ pCoexDm->curVal0x6c8 = val0x6c8; -+ pCoexDm->curVal0x6cc = val0x6cc; -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && -+ (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && -+ (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) -+ return; -+ } -+ halbtc8723a2ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c8, val0x6cc); -+ -+ pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; -+ pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; -+ pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -+} -+ -+VOID -+halbtc8723a2ant_SetFwIgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bEnable -+ ) -+{ -+ u1Byte H2C_Parameter[1] ={0}; -+ -+ if(bEnable) -+ { -+ H2C_Parameter[0] |= BIT0; // function enable -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x25=0x%x\n", -+ H2C_Parameter[0])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x25, 1, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a2ant_IgnoreWlanAct( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bEnable -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", -+ (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); -+ pCoexDm->bCurIgnoreWlanAct = bEnable; -+ -+ if(!bForceExec) -+ { -+ if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) -+ return; -+ } -+ halbtc8723a2ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); -+ -+ pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -+} -+ -+VOID -+halbtc8723a2ant_SetFwPstdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3, -+ IN u1Byte byte4, -+ IN u1Byte byte5 -+ ) -+{ -+ u1Byte H2C_Parameter[5] ={0}; -+ -+ H2C_Parameter[0] = byte1; -+ H2C_Parameter[1] = byte2; -+ H2C_Parameter[2] = byte3; -+ H2C_Parameter[3] = byte4; -+ H2C_Parameter[4] = byte5; -+ -+ pCoexDm->psTdmaPara[0] = byte1; -+ pCoexDm->psTdmaPara[1] = byte2; -+ pCoexDm->psTdmaPara[2] = byte3; -+ pCoexDm->psTdmaPara[3] = byte4; -+ pCoexDm->psTdmaPara[4] = byte5; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x3a(5bytes)=0x%x%08x\n", -+ H2C_Parameter[0], -+ H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); -+ -+ pBtCoexist->fBtcFillH2c(pBtCoexist, 0x3a, 5, H2C_Parameter); -+} -+ -+VOID -+halbtc8723a2ant_PsTdma( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bForceExec, -+ IN BOOLEAN bTurnOn, -+ IN u1Byte type -+ ) -+{ -+ u4Byte btTxRxCnt=0; -+ -+ btTxRxCnt = pCoexSta->highPriorityTx+pCoexSta->highPriorityRx+ -+ pCoexSta->lowPriorityTx+pCoexSta->lowPriorityRx; -+ -+ if(btTxRxCnt > 3000) -+ { -+ pCoexDm->bCurPsTdmaOn = TRUE; -+ pCoexDm->curPsTdma = 8; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], turn ON PS TDMA, type=%d for BT tx/rx counters=%d(>3000)\n", -+ pCoexDm->curPsTdma, btTxRxCnt)); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", -+ (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); -+ pCoexDm->bCurPsTdmaOn = bTurnOn; -+ pCoexDm->curPsTdma = type; -+ } -+ -+ if(!bForceExec) -+ { -+ if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && -+ (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) -+ return; -+ } -+ if(pCoexDm->bCurPsTdmaOn) -+ { -+ switch(pCoexDm->curPsTdma) -+ { -+ case 1: -+ default: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x98); -+ break; -+ case 2: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x98); -+ break; -+ case 3: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0xe1, 0x98); -+ break; -+ case 4: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x5, 0x5, 0xe1, 0x80); -+ break; -+ case 5: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x98); -+ break; -+ case 6: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x98); -+ break; -+ case 7: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0x60, 0x98); -+ break; -+ case 8: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x5, 0x5, 0x60, 0x80); -+ break; -+ case 9: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x98); -+ break; -+ case 10: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x98); -+ break; -+ case 11: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0xe1, 0x98); -+ break; -+ case 12: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x98); -+ break; -+ case 13: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x98); -+ break; -+ case 14: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x98); -+ break; -+ case 15: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0x60, 0x98); -+ break; -+ case 16: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0x60, 0x98); -+ break; -+ case 17: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x2f, 0x2f, 0x60, 0x80); -+ break; -+ case 18: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x98); -+ break; -+ case 19: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0xe1, 0x98); -+ break; -+ case 20: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0x60, 0x98); -+ break; -+ } -+ } -+ else -+ { -+ // disable PS tdma -+ switch(pCoexDm->curPsTdma) -+ { -+ case 0: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x8, 0x0); -+ break; -+ case 1: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); -+ break; -+ default: -+ halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x8, 0x0); -+ break; -+ } -+ } -+ -+ // update pre state -+ pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; -+ pCoexDm->prePsTdma = pCoexDm->curPsTdma; -+} -+ -+ -+VOID -+halbtc8723a2ant_CoexAllOff( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // fw all off -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ // sw all off -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ // hw all off -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+} -+ -+VOID -+halbtc8723a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ // force to reset coex mechanism -+ halbtc8723a2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0x55555555, 0xffff, 0x3); -+ halbtc8723a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, FORCE_EXEC, FALSE); -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, FORCE_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, FORCE_EXEC, FALSE); -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, FORCE_EXEC, FALSE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, FORCE_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, FORCE_EXEC, FALSE, 0xc0); -+} -+ -+VOID -+halbtc8723a2ant_BtInquiryPage( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bLowPwrDisable=TRUE; -+ -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+} -+ -+VOID -+halbtc8723a2ant_BtEnableAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ BOOLEAN bWifiConnected=FALSE; -+ -+ // Here we need to resend some wifi info to BT -+ // because bt is reset and loss of the info. -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ if(bWifiConnected) -+ { -+ halbtc8723a2ant_IndicateWifiChnlBwInfo(pBtCoexist, BTC_MEDIA_CONNECT); -+ } -+ else -+ { -+ halbtc8723a2ant_IndicateWifiChnlBwInfo(pBtCoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -+} -+ -+VOID -+halbtc8723a2ant_MonitorBtCtr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u4Byte regHPTxRx, regLPTxRx, u4Tmp; -+ u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; -+ u1Byte u1Tmp; -+ -+ regHPTxRx = 0x770; -+ regLPTxRx = 0x774; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); -+ regHPTx = u4Tmp & bMaskLWord; -+ regHPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); -+ regLPTx = u4Tmp & bMaskLWord; -+ regLPRx = (u4Tmp & bMaskHWord)>>16; -+ -+ pCoexSta->highPriorityTx = regHPTx; -+ pCoexSta->highPriorityRx = regHPRx; -+ pCoexSta->lowPriorityTx = regLPTx; -+ pCoexSta->lowPriorityRx = regLPRx; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); -+ -+ // reset counter -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -+} -+ -+VOID -+halbtc8723a2ant_MonitorBtEnableDisable( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ static BOOLEAN bPreBtDisabled=FALSE; -+ static u4Byte btDisableCnt=0; -+ BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; -+ -+ // This function check if bt is disabled -+ -+ if( pCoexSta->highPriorityTx == 0 && -+ pCoexSta->highPriorityRx == 0 && -+ pCoexSta->lowPriorityTx == 0 && -+ pCoexSta->lowPriorityRx == 0) -+ { -+ bBtActive = FALSE; -+ } -+ if( pCoexSta->highPriorityTx == 0xffff && -+ pCoexSta->highPriorityRx == 0xffff && -+ pCoexSta->lowPriorityTx == 0xffff && -+ pCoexSta->lowPriorityRx == 0xffff) -+ { -+ bBtActive = FALSE; -+ } -+ if(bBtActive) -+ { -+ btDisableCnt = 0; -+ bBtDisabled = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); -+ } -+ else -+ { -+ btDisableCnt++; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", -+ btDisableCnt)); -+ if(btDisableCnt >= 2) -+ { -+ bBtDisabled = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); -+ } -+ } -+ if(bPreBtDisabled != bBtDisabled) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", -+ (bPreBtDisabled ? "disabled":"enabled"), -+ (bBtDisabled ? "disabled":"enabled"))); -+ bPreBtDisabled = bBtDisabled; -+ if(!bBtDisabled) -+ { -+ halbtc8723a2ant_BtEnableAction(pBtCoexist); -+ } -+ } -+} -+ -+BOOLEAN -+halbtc8723a2ant_IsCommonAction( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ BOOLEAN bCommon=FALSE, bWifiConnected=FALSE; -+ BOOLEAN bLowPwrDisable=FALSE; -+ -+ if(!pStackInfo->bBtLinkExist) -+ { -+ bLowPwrDisable = FALSE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ } -+ else -+ { -+ bLowPwrDisable = TRUE; -+ pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); -+ -+ if(halbtc8723a2ant_IsWifiIdle(pBtCoexist) && -+ BT_8723A_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle + Bt idle!!\n")); -+ -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ bCommon = TRUE; -+ } -+ else if(!halbtc8723a2ant_IsWifiIdle(pBtCoexist) && -+ (BT_8723A_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-idle + BT idle!!\n")); -+ -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ bCommon = TRUE; -+ } -+ else if(halbtc8723a2ant_IsWifiIdle(pBtCoexist) && -+ (BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle + Bt connected idle!!\n")); -+ -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ bCommon = TRUE; -+ } -+ else if(!halbtc8723a2ant_IsWifiIdle(pBtCoexist) && -+ (BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-idle + Bt connected idle!!\n")); -+ -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ bCommon = TRUE; -+ } -+ else if(halbtc8723a2ant_IsWifiIdle(pBtCoexist) && -+ (BT_8723A_2ANT_BT_STATUS_NON_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle + BT non-idle!!\n")); -+ -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ bCommon = TRUE; -+ } -+ else if(halbtc8723a2ant_IsWifiConnectedIdle(pBtCoexist) && -+ (BT_8723A_2ANT_BT_STATUS_NON_IDLE == pCoexDm->btStatus) ) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected-idle + BT non-idle!!\n")); -+ -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ -+ bCommon = TRUE; -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-idle + BT non-idle!!\n")); -+ halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); -+ -+ bCommon = FALSE; -+ } -+ -+ return bCommon; -+} -+VOID -+halbtc8723a2ant_TdmaDurationAdjust( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bScoHid, -+ IN BOOLEAN bTxPause, -+ IN u1Byte maxInterval -+ ) -+{ -+ static s4Byte up,dn,m,n,WaitCount; -+ s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration -+ u1Byte retryCount=0; -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjust()\n")); -+ -+ if(pCoexDm->bResetTdmaAdjust) -+ { -+ pCoexDm->bResetTdmaAdjust = FALSE; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); -+ { -+ if(bScoHid) -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ else -+ { -+ if(bTxPause) -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ } -+ else -+ { -+ if(maxInterval == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(maxInterval == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(maxInterval == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ } -+ } -+ } -+ //============ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n= 3; -+ result = 0; -+ WaitCount = 0; -+ } -+ else -+ { -+ //accquire the BT TRx retry count from BT_Info byte2 -+ retryCount = pCoexSta->btRetryCnt; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], retryCount = %d\n", retryCount)); -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], up=%d, dn=%d, m=%d, n=%d, WaitCount=%d\n", -+ up, dn, m, n, WaitCount)); -+ result = 0; -+ WaitCount++; -+ -+ if(retryCount == 0) // no retry in the last 2-second duration -+ { -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if(up >= n) // if ³sÄò n ­Ó2¬í retry count¬°0, «h½Õ¼eWiFi duration -+ { -+ WaitCount = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); -+ } -+ } -+ else if (retryCount <= 3) // <=3 retry in the last 2-second duration -+ { -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) // if ³sÄò 2 ­Ó2¬í retry count< 3, «h½Õ¯¶WiFi duration -+ { -+ if (WaitCount <= 2) -+ m++; // ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); -+ } -+ } -+ else //retry count > 3, ¥u­n1¦¸ retry count > 3, «h½Õ¯¶WiFi duration -+ { -+ if (WaitCount == 1) -+ m++; // ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ -+ else -+ m = 1; -+ -+ if ( m >= 20) //m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. -+ m = 20; -+ -+ n = 3*m; -+ up = 0; -+ dn = 0; -+ WaitCount = 0; -+ result = -1; -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); -+ } -+ -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], max Interval = %d\n", maxInterval)); -+ if(maxInterval == 1) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); -+ pCoexDm->psTdmaDuAdjType = 5; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ pCoexDm->psTdmaDuAdjType = 13; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); -+ pCoexDm->psTdmaDuAdjType = 1; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ pCoexDm->psTdmaDuAdjType = 9; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 2) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ pCoexDm->psTdmaDuAdjType = 6; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ pCoexDm->psTdmaDuAdjType = 14; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ pCoexDm->psTdmaDuAdjType = 2; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ pCoexDm->psTdmaDuAdjType = 10; -+ } -+ } -+ } -+ } -+ else if(maxInterval == 3) -+ { -+ if(bTxPause) -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ pCoexDm->psTdmaDuAdjType = 8; -+ } -+ else if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ pCoexDm->psTdmaDuAdjType = 16; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); -+ pCoexDm->psTdmaDuAdjType = 7; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ pCoexDm->psTdmaDuAdjType = 15; -+ } -+ } -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); -+ if(pCoexDm->curPsTdma == 5) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 6) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 7) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 8) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ if(pCoexDm->curPsTdma == 13) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 14) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 15) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 16) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ if(result == -1) -+ { -+ if(pCoexDm->curPsTdma == 1) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ pCoexDm->psTdmaDuAdjType = 4; -+ } -+ else if(pCoexDm->curPsTdma == 9) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ pCoexDm->psTdmaDuAdjType = 12; -+ } -+ } -+ else if (result == 1) -+ { -+ if(pCoexDm->curPsTdma == 4) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 3) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 2) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); -+ pCoexDm->psTdmaDuAdjType = 3; -+ } -+ else if(pCoexDm->curPsTdma == 12) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 11) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ else if(pCoexDm->curPsTdma == 10) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ pCoexDm->psTdmaDuAdjType = 11; -+ } -+ } -+ } -+ } -+ } -+ -+ // if current PsTdma not match with the recorded one (when scan, dhcp...), -+ // then we have to adjust it back to the previous record one. -+ if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) -+ { -+ BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", -+ pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ -+ if( !bScan && !bLink && !bRoam) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); -+ } -+ } -+} -+ -+// SCO only or SCO+PAN(HS) -+VOID -+halbtc8723a2ant_ActionSco( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1; -+ u4Byte wifiBw; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+ -+VOID -+halbtc8723a2ant_ActionHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1; -+ u4Byte wifiBw; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -+VOID -+halbtc8723a2ant_ActionA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); -+ } -+ else -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ } -+ else -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); -+ } -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); -+ } -+ else -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); -+ } -+ else -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+VOID -+halbtc8723a2ant_ActionPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+ -+//PAN(HS) only -+VOID -+halbtc8723a2ant_ActionPanHs( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState; -+ u4Byte wifiBw; -+ -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ } -+ else -+ { -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ } -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ else -+ { -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+//PAN(EDR)+A2DP -+VOID -+halbtc8723a2ant_ActionPanEdrA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ } -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+VOID -+halbtc8723a2ant_ActionPanEdrHid( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1; -+ u4Byte wifiBw; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ } -+ else -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+// HID+A2DP+PAN(EDR) -+VOID -+halbtc8723a2ant_ActionHidA2dpPanEdr( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ } -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+VOID -+halbtc8723a2ant_ActionHidA2dp( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte wifiRssiState, wifiRssiState1, btInfoExt; -+ u4Byte wifiBw; -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ -+ if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); -+ else -+ halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ if(BTC_WIFI_BW_HT40 == wifiBw) -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 1); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 1); -+ } -+ } -+ -+ // sw mechanism -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); -+ wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); -+ -+ // fw mechanism -+ if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 1); -+ } -+ } -+ else -+ { -+ if(btInfoExt&BIT0) //a2dp basic rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); -+ } -+ else //a2dp edr rate -+ { -+ halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 1); -+ } -+ } -+ -+ // sw mechanism -+ if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || -+ (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ else -+ { -+ halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); -+ halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); -+ } -+ } -+} -+ -+VOID -+halbtc8723a2ant_RunCoexistMechanism( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ u1Byte btInfoOriginal=0, btRetryCnt=0; -+ u1Byte algorithm=0; -+ -+ if(pBtCoexist->bManualControl) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Manual control!!!\n")); -+ return; -+ } -+ -+ if(pStackInfo->bProfileNotified) -+ { -+ if(pCoexSta->bHoldForStackOperation) -+ { -+ // if bt inquiry/page/pair, do not execute. -+ return; -+ } -+ -+ algorithm = halbtc8723a2ant_ActionAlgorithm(pBtCoexist); -+ if(pCoexSta->bHoldPeriodCnt && (BT_8723A_2ANT_COEX_ALGO_PANHS!=algorithm)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex],Hold BT inquiry/page scan setting (cnt = %d)!!\n", -+ pCoexSta->bHoldPeriodCnt)); -+ if(pCoexSta->bHoldPeriodCnt >= 6) -+ { -+ pCoexSta->bHoldPeriodCnt = 0; -+ // next time the coexist parameters should be reset again. -+ } -+ else -+ pCoexSta->bHoldPeriodCnt++; -+ return; -+ } -+ -+ pCoexDm->curAlgorithm = algorithm; -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Algorithm = %d \n", pCoexDm->curAlgorithm)); -+ if(halbtc8723a2ant_IsCommonAction(pBtCoexist)) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant common.\n")); -+ pCoexDm->bResetTdmaAdjust = TRUE; -+ } -+ else -+ { -+ if(pCoexDm->curAlgorithm != pCoexDm->preAlgorithm) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], preAlgorithm=%d, curAlgorithm=%d\n", -+ pCoexDm->preAlgorithm, pCoexDm->curAlgorithm)); -+ pCoexDm->bResetTdmaAdjust = TRUE; -+ } -+ switch(pCoexDm->curAlgorithm) -+ { -+ case BT_8723A_2ANT_COEX_ALGO_SCO: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO.\n")); -+ halbtc8723a2ant_ActionSco(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID.\n")); -+ halbtc8723a2ant_ActionHid(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP.\n")); -+ halbtc8723a2ant_ActionA2dp(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n")); -+ halbtc8723a2ant_ActionPanEdr(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_PANHS: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HS mode.\n")); -+ halbtc8723a2ant_ActionPanHs(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_PANEDR_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n")); -+ halbtc8723a2ant_ActionPanEdrA2dp(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_PANEDR_HID: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n")); -+ halbtc8723a2ant_ActionPanEdrHid(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n")); -+ halbtc8723a2ant_ActionHidA2dpPanEdr(pBtCoexist); -+ break; -+ case BT_8723A_2ANT_COEX_ALGO_HID_A2DP: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n")); -+ halbtc8723a2ant_ActionHidA2dp(pBtCoexist); -+ break; -+ default: -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n")); -+ halbtc8723a2ant_CoexAllOff(pBtCoexist); -+ break; -+ } -+ pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; -+ } -+ } -+} -+ -+//============================================================ -+// work around function start with wa_halbtc8723a2ant_ -+//============================================================ -+VOID -+wa_halbtc8723a2ant_MonitorC2h( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ u1Byte tmp1b=0x0; -+ u4Byte curC2hTotalCnt=0x0; -+ static u4Byte preC2hTotalCnt=0x0, sameCntPollingTime=0x0; -+ -+ curC2hTotalCnt+=pCoexSta->btInfoC2hCnt[BT_INFO_SRC_8723A_2ANT_BT_RSP]; -+ -+ if(curC2hTotalCnt == preC2hTotalCnt) -+ { -+ sameCntPollingTime++; -+ } -+ else -+ { -+ preC2hTotalCnt = curC2hTotalCnt; -+ sameCntPollingTime = 0; -+ } -+ -+ if(sameCntPollingTime >= 2) -+ { -+ tmp1b = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x1af); -+ if(tmp1b != 0x0) -+ { -+ pCoexSta->c2hHangDetectCnt++; -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x1af, 0x0); -+ } -+ } -+} -+ -+//============================================================ -+// extern function start with EXhalbtc8723a2ant_ -+//============================================================ -+VOID -+EXhalbtc8723a2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+} -+ -+VOID -+EXhalbtc8723a2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ) -+{ -+ u4Byte u4Tmp=0; -+ u1Byte u1Tmp=0; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); -+ -+ // backup rf 0x1e value -+ pCoexDm->btRf0x1eBackup = -+ pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ // Enable counter statistics -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x3); -+ pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); -+} -+ -+VOID -+EXhalbtc8723a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); -+ -+ halbtc8723a2ant_InitCoexDm(pBtCoexist); -+} -+ -+VOID -+EXhalbtc8723a2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; -+ PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; -+ pu1Byte cliBuf=pBtCoexist->cliBuf; -+ u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; -+ u4Byte u4Tmp[4]; -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ -+ pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); -+ CL_PRINTF(cliBuf); -+ -+ if(pBtCoexist->bManualControl) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); -+ CL_PRINTF(cliBuf); -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ -+ ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ -+ pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], -+ pCoexDm->wifiChnlInfo[2]); -+ CL_PRINTF(cliBuf); -+ -+ // wifi status -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); -+ CL_PRINTF(cliBuf); -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ -+ ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8723A_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus)? "idle":( (BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy"))), -+ pCoexSta->btRssi, pCoexSta->btRetryCnt); -+ CL_PRINTF(cliBuf); -+ -+ if(pStackInfo->bProfileNotified) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ -+ pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ -+ btInfoExt = pCoexSta->btInfoExt; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ -+ (btInfoExt&BIT0)? "Basic rate":"EDR rate"); -+ CL_PRINTF(cliBuf); -+ -+ for(i=0; ibtInfoC2hCnt[i]) -+ { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723a2Ant[i], \ -+ pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], -+ pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], -+ pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], -+ pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "write 0x1af=0x0 num", \ -+ pCoexSta->c2hHangDetectCnt); -+ CL_PRINTF(cliBuf); -+ -+ // Sw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "SM1[ShRf/ LpRA/ LimDig]", \ -+ pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ -+ pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); -+ CL_PRINTF(cliBuf); -+ -+ // Fw mechanism -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); -+ CL_PRINTF(cliBuf); -+ -+ if(!pBtCoexist->bManualControl) -+ { -+ psTdmaCase = pCoexDm->curPsTdma; -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", "PS TDMA", \ -+ pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], -+ pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], -+ pCoexDm->psTdmaPara[4], psTdmaCase); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "DecBtPwr/ IgnWlanAct", \ -+ pCoexDm->bCurDecBtPwr, pCoexDm->bCurIgnoreWlanAct); -+ CL_PRINTF(cliBuf); -+ } -+ -+ // Hw setting -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ -+ pCoexDm->btRf0x1eBackup); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); -+ u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x783); -+ u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x796); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/ 0x783/ 0x796", \ -+ u1Tmp[0], u1Tmp[1], u1Tmp[2]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x880", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ -+ u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ -+ u4Tmp[0], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x484); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x484(rate adaptive)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ -+ u4Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); -+ u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xdac); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0xda0/0xda4/0xda8/0xdac(FA cnt)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u4Tmp[3]); -+ CL_PRINTF(cliBuf); -+ -+ u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); -+ u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); -+ u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); -+ u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ -+ u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770 (hp rx[31:16]/tx[15:0])", \ -+ pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(lp rx[31:16]/tx[15:0])", \ -+ pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+VOID -+EXhalbtc8723a2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_IPS_ENTER == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); -+ halbtc8723a2ant_CoexAllOff(pBtCoexist); -+ } -+ else if(BTC_IPS_LEAVE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); -+ //halbtc8723a2ant_InitCoexDm(pBtCoexist); -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_LPS_ENABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); -+ } -+ else if(BTC_LPS_DISABLE == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_SCAN_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); -+ } -+ else if(BTC_SCAN_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_ASSOCIATE_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); -+ } -+ else if(BTC_ASSOCIATE_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_MEDIA_CONNECT == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); -+ } -+ -+ halbtc8723a2ant_IndicateWifiChnlBwInfo(pBtCoexist, type); -+} -+ -+VOID -+EXhalbtc8723a2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(type == BTC_PACKET_DHCP) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ) -+{ -+ u1Byte btInfo=0; -+ u1Byte i, rspSource=0; -+ BOOLEAN bBtBusy=FALSE, bLimitedDig=FALSE; -+ BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; -+ -+ pCoexSta->bC2hBtInfoReqSent = FALSE; -+ -+ rspSource = BT_INFO_SRC_8723A_2ANT_BT_RSP; -+ pCoexSta->btInfoC2hCnt[rspSource]++; -+ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); -+ for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; -+ if(i == 0) -+ btInfo = tmpBuf[i]; -+ if(i == length-1) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); -+ } -+ else -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); -+ } -+ } -+ -+ if(BT_INFO_SRC_8723A_2ANT_WIFI_FW != rspSource) -+ { -+ pCoexSta->btRetryCnt = -+ pCoexSta->btInfoC2h[rspSource][1]; -+ -+ pCoexSta->btRssi = -+ pCoexSta->btInfoC2h[rspSource][2]*2+10; -+ -+ pCoexSta->btInfoExt = -+ pCoexSta->btInfoC2h[rspSource][3]; -+ } -+ -+ pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); -+ // check BIT2 first ==> check if bt is under inquiry or page scan -+ if(btInfo & BT_INFO_8723A_2ANT_B_INQ_PAGE) -+ { -+ pCoexSta->bC2hBtInquiryPage = TRUE; -+ } -+ else -+ { -+ pCoexSta->bC2hBtInquiryPage = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_StackOperationNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ) -+{ -+ if(BTC_STACK_OP_INQ_PAGE_PAIR_START == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], StackOP Inquiry/page/pair start notify\n")); -+ pCoexSta->bHoldForStackOperation = TRUE; -+ pCoexSta->bHoldPeriodCnt = 1; -+ halbtc8723a2ant_BtInquiryPage(pBtCoexist); -+ } -+ else if(BTC_STACK_OP_INQ_PAGE_PAIR_FINISH == type) -+ { -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], StackOP Inquiry/page/pair finish notify\n")); -+ pCoexSta->bHoldForStackOperation = FALSE; -+ } -+} -+ -+VOID -+EXhalbtc8723a2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); -+ -+ halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); -+ EXhalbtc8723a2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+VOID -+EXhalbtc8723a2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ) -+{ -+ RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Periodical!!\n")); -+ -+ // work around for c2h hang -+ wa_halbtc8723a2ant_MonitorC2h(pBtCoexist); -+ -+ halbtc8723a2ant_QueryBtInfo(pBtCoexist); -+ halbtc8723a2ant_MonitorBtCtr(pBtCoexist); -+ halbtc8723a2ant_MonitorBtEnableDisable(pBtCoexist); -+ -+ halbtc8723a2ant_RunCoexistMechanism(pBtCoexist); -+} -+ -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723a2Ant.h 2018-02-11 21:44:27.145146055 +0200 -@@ -0,0 +1,184 @@ -+//=========================================== -+// The following is for 8723A 2Ant BT Co-exist definition -+//=========================================== -+#define BT_INFO_8723A_2ANT_B_FTP BIT7 -+#define BT_INFO_8723A_2ANT_B_A2DP BIT6 -+#define BT_INFO_8723A_2ANT_B_HID BIT5 -+#define BT_INFO_8723A_2ANT_B_SCO_BUSY BIT4 -+#define BT_INFO_8723A_2ANT_B_ACL_BUSY BIT3 -+#define BT_INFO_8723A_2ANT_B_INQ_PAGE BIT2 -+#define BT_INFO_8723A_2ANT_B_SCO_ESCO BIT1 -+#define BT_INFO_8723A_2ANT_B_CONNECTION BIT0 -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT 2 -+ -+typedef enum _BT_INFO_SRC_8723A_2ANT{ -+ BT_INFO_SRC_8723A_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8723A_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8723A_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8723A_2ANT_MAX -+}BT_INFO_SRC_8723A_2ANT,*PBT_INFO_SRC_8723A_2ANT; -+ -+typedef enum _BT_8723A_2ANT_BT_STATUS{ -+ BT_8723A_2ANT_BT_STATUS_IDLE = 0x0, -+ BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8723A_2ANT_BT_STATUS_NON_IDLE = 0x2, -+ BT_8723A_2ANT_BT_STATUS_MAX -+}BT_8723A_2ANT_BT_STATUS,*PBT_8723A_2ANT_BT_STATUS; -+ -+typedef enum _BT_8723A_2ANT_COEX_ALGO{ -+ BT_8723A_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8723A_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8723A_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8723A_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8723A_2ANT_COEX_ALGO_PANEDR = 0x4, -+ BT_8723A_2ANT_COEX_ALGO_PANHS = 0x5, -+ BT_8723A_2ANT_COEX_ALGO_PANEDR_A2DP = 0x6, -+ BT_8723A_2ANT_COEX_ALGO_PANEDR_HID = 0x7, -+ BT_8723A_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x8, -+ BT_8723A_2ANT_COEX_ALGO_HID_A2DP = 0x9, -+ BT_8723A_2ANT_COEX_ALGO_MAX -+}BT_8723A_2ANT_COEX_ALGO,*PBT_8723A_2ANT_COEX_ALGO; -+ -+typedef struct _COEX_DM_8723A_2ANT{ -+ // fw mechanism -+ BOOLEAN bPreDecBtPwr; -+ BOOLEAN bCurDecBtPwr; -+ //BOOLEAN bPreBtLnaConstrain; -+ //BOOLEAN bCurBtLnaConstrain; -+ //u1Byte bPreBtPsdMode; -+ //u1Byte bCurBtPsdMode; -+ u1Byte preFwDacSwingLvl; -+ u1Byte curFwDacSwingLvl; -+ BOOLEAN bCurIgnoreWlanAct; -+ BOOLEAN bPreIgnoreWlanAct; -+ u1Byte prePsTdma; -+ u1Byte curPsTdma; -+ u1Byte psTdmaPara[5]; -+ u1Byte psTdmaDuAdjType; -+ BOOLEAN bResetTdmaAdjust; -+ BOOLEAN bPrePsTdmaOn; -+ BOOLEAN bCurPsTdmaOn; -+ //BOOLEAN bPreBtAutoReport; -+ //BOOLEAN bCurBtAutoReport; -+ -+ // sw mechanism -+ BOOLEAN bPreRfRxLpfShrink; -+ BOOLEAN bCurRfRxLpfShrink; -+ u4Byte btRf0x1eBackup; -+ BOOLEAN bPreLowPenaltyRa; -+ BOOLEAN bCurLowPenaltyRa; -+ BOOLEAN bPreDacSwingOn; -+ u4Byte preDacSwingLvl; -+ BOOLEAN bCurDacSwingOn; -+ u4Byte curDacSwingLvl; -+ BOOLEAN bPreAdcBackOff; -+ BOOLEAN bCurAdcBackOff; -+ BOOLEAN bPreAgcTableEn; -+ BOOLEAN bCurAgcTableEn; -+ u4Byte preVal0x6c0; -+ u4Byte curVal0x6c0; -+ u4Byte preVal0x6c8; -+ u4Byte curVal0x6c8; -+ u1Byte preVal0x6cc; -+ u1Byte curVal0x6cc; -+ BOOLEAN bLimitedDig; -+ -+ // algorithm related -+ u1Byte preAlgorithm; -+ u1Byte curAlgorithm; -+ u1Byte btStatus; -+ u1Byte wifiChnlInfo[3]; -+} COEX_DM_8723A_2ANT, *PCOEX_DM_8723A_2ANT; -+ -+typedef struct _COEX_STA_8723A_2ANT{ -+ u4Byte highPriorityTx; -+ u4Byte highPriorityRx; -+ u4Byte lowPriorityTx; -+ u4Byte lowPriorityRx; -+ u1Byte btRssi; -+ u1Byte preBtRssiState; -+ u1Byte preBtRssiState1; -+ u1Byte preWifiRssiState[4]; -+ BOOLEAN bC2hBtInfoReqSent; -+ u1Byte btInfoC2h[BT_INFO_SRC_8723A_2ANT_MAX][10]; -+ u4Byte btInfoC2hCnt[BT_INFO_SRC_8723A_2ANT_MAX]; -+ BOOLEAN bC2hBtInquiryPage; -+ u1Byte btRetryCnt; -+ u1Byte btInfoExt; -+ BOOLEAN bHoldForStackOperation; -+ u1Byte bHoldPeriodCnt; -+ // this is for c2h hang work-around -+ u4Byte c2hHangDetectCnt; -+}COEX_STA_8723A_2ANT, *PCOEX_STA_8723A_2ANT; -+ -+//=========================================== -+// The following is interface which will notify coex module. -+//=========================================== -+VOID -+EXhalbtc8723a2ant_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a2ant_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtc8723a2ant_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a2ant_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_SpecialPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a2ant_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtc8723a2ant_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtc8723a2ant_StackOperationNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtc8723a2ant_DisplayCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.c 2018-02-11 21:44:27.146146071 +0200 -@@ -0,0 +1,4845 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8723B Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8723B_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8723b_1ant glcoex_dm_8723b_1ant; -+static struct coex_dm_8723b_1ant *coex_dm = &glcoex_dm_8723b_1ant; -+static struct coex_sta_8723b_1ant glcoex_sta_8723b_1ant; -+static struct coex_sta_8723b_1ant *coex_sta = &glcoex_sta_8723b_1ant; -+static struct psdscan_sta_8723b_1ant gl_psd_scan_8723b_1ant; -+static struct psdscan_sta_8723b_1ant *psd_scan = &gl_psd_scan_8723b_1ant; -+ -+ -+const char *const glbt_info_src_8723b_1ant[]={ -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8723b_1ant = 20151015; -+u32 glcoex_ver_8723b_1ant = 0x63; -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8723b1ant_ -+ * ************************************************************ */ -+ -+void halbtc8723b1ant_update_ra_mask(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 dis_rate_mask) -+{ -+ coex_dm->cur_ra_mask = dis_rate_mask; -+ -+ if( force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, -+ &coex_dm->cur_ra_mask); -+ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -+} -+ -+void halbtc8723b1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ coex_dm->cur_arfr_type = type; -+ -+ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { -+ switch (coex_dm->cur_arfr_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_4byte(btcoexist, 0x430, -+ coex_dm->backup_arfr_cnt1); -+ btcoexist->btc_write_4byte(btcoexist, 0x434, -+ coex_dm->backup_arfr_cnt2); -+ break; -+ case 1: -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x01010101); -+ } else { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -+} -+ -+void halbtc8723b1ant_retry_limit(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_retry_limit_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_retry_limit_type != -+ coex_dm->cur_retry_limit_type)) { -+ switch (coex_dm->cur_retry_limit_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ coex_dm->backup_retry_limit); -+ break; -+ case 1: /* retry limit=8 */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -+} -+ -+void halbtc8723b1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_ampdu_time_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { -+ switch (coex_dm->cur_ampdu_time_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ coex_dm->backup_ampdu_max_time); -+ break; -+ case 1: /* AMPDU timw = 0x38 * 32us */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -+} -+ -+void halbtc8723b1ant_limited_tx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, -+ IN u8 retry_limit_type, IN u8 ampdu_time_type) -+{ -+ switch (ra_mask_type) { -+ case 0: /* normal mode */ -+ halbtc8723b1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0); -+ break; -+ case 1: /* disable cck 1/2 */ -+ halbtc8723b1ant_update_ra_mask(btcoexist, force_exec, -+ 0x00000003); -+ break; -+ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ -+ halbtc8723b1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8723b1ant_auto_rate_fallback_retry(btcoexist, force_exec, -+ arfr_type); -+ halbtc8723b1ant_retry_limit(btcoexist, force_exec, retry_limit_type); -+ halbtc8723b1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -+} -+ -+void halbtc8723b1ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+void halbtc8723b1ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ coex_sta->c2h_bt_info_req_sent = true; -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+} -+ -+void halbtc8723b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ static u32 num_of_bt_counter_chk = 0; -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ if ((coex_sta->low_priority_tx > 1050) && -+ (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->pop_event_cnt++; -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+ -+ /* This part is for wifi FW and driver to update BT's status as disabled. */ -+ /* The flow is as the following */ -+ /* 1. disable BT */ -+ /* 2. if all BT Tx/Rx counter=0, after 6 sec we query bt info */ -+ /* 3. Because BT will not rsp from mailbox, so wifi fw will know BT is disabled */ -+ /* 4. FW will rsp c2h for BT that driver will know BT is disabled. */ -+ if ((reg_hp_tx == 0) && (reg_hp_rx == 0) && (reg_lp_tx == 0) && -+ (reg_lp_rx == 0)) { -+ num_of_bt_counter_chk++; -+ if (num_of_bt_counter_chk == 3) -+ halbtc8723b1ant_query_bt_info(btcoexist); -+ } else -+ num_of_bt_counter_chk = 0; -+} -+ -+ -+void halbtc8723b1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -+{ -+ s32 wifi_rssi = 0; -+ boolean wifi_busy = false, wifi_under_b_mode = false; -+ static u8 cck_lock_counter = 0; -+ u32 total_cnt; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ if (coex_sta->under_ips) { -+ coex_sta->crc_ok_cck = 0; -+ coex_sta->crc_ok_11g = 0; -+ coex_sta->crc_ok_11n = 0; -+ coex_sta->crc_ok_11n_agg = 0; -+ -+ coex_sta->crc_err_cck = 0; -+ coex_sta->crc_err_11g = 0; -+ coex_sta->crc_err_11n = 0; -+ coex_sta->crc_err_11n_agg = 0; -+ } else { -+ coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, -+ 0xf88); -+ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf94); -+ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf90); -+ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xfb8); -+ -+ coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, -+ 0xf84); -+ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf96); -+ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf92); -+ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xfba); -+ } -+ -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); -+ -+ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { -+ total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + -+ coex_sta->crc_ok_11n + -+ coex_sta->crc_ok_11n_agg; -+ -+ if ( (coex_dm->bt_status == BT_8723B_1ANT_BT_STATUS_ACL_BUSY) || -+ (coex_dm->bt_status == -+ BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (coex_dm->bt_status == -+ BT_8723B_1ANT_BT_STATUS_SCO_BUSY)) { -+ if (coex_sta->crc_ok_cck > (total_cnt - -+coex_sta->crc_ok_cck)) { -+ if (cck_lock_counter < 3) -+ cck_lock_counter++; -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ if (!coex_sta->pre_ccklock) { -+ -+ if (cck_lock_counter >= 3) -+ coex_sta->cck_lock = true; -+ else -+ coex_sta->cck_lock = false; -+ } else { -+ if (cck_lock_counter == 0) -+ coex_sta->cck_lock = false; -+ else -+ coex_sta->cck_lock = true; -+ } -+ -+ if (coex_sta->cck_lock) -+ coex_sta->cck_ever_lock = true; -+ -+ coex_sta->pre_ccklock = coex_sta->cck_lock; -+ -+ -+} -+ -+boolean halbtc8723b1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ -+ -+ } -+ -+ return false; -+} -+ -+void halbtc8723b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if( bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist ) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if( !bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist ) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if( !bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist ) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if( !bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist ) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+} -+ -+void halbtc8723b1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8723b1ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8723b1ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8723b1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ -+ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+} -+ -+void halbtc8723b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8723b1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8723b1ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8723b1ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8723b1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8723b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+#if BT_8723B_1ANT_ANTDET_ENABLE -+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE -+ if (board_info->btdm_ant_num_by_ant_det == 2) { -+ if (type == 3) -+ type = 14; -+ else if (type == 4) -+ type = 13; -+ else if (type == 5) -+ type = 8; -+ } -+#endif -+#endif -+ -+ coex_sta->coex_table_type = type; -+ -+ switch (type) { -+ case 0: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 4: -+ if ((coex_sta->cck_ever_lock) && -+ (coex_sta->scan_ap_num <= 5)) -+ halbtc8723b1ant_coex_table(btcoexist, -+ force_exec, 0x55555555, 0xaaaa5a5a, -+ 0xffffff, 0x3); -+ else -+ halbtc8723b1ant_coex_table(btcoexist, -+ force_exec, 0x55555555, 0x5a5a5a5a, -+ 0xffffff, 0x3); -+ break; -+ case 5: -+ if ((coex_sta->cck_ever_lock) && -+ (coex_sta->scan_ap_num <= 5)) -+ halbtc8723b1ant_coex_table(btcoexist, -+ force_exec, 0x5a5a5a5a, 0x5aaa5a5a, -+ 0xffffff, 0x3); -+ else -+ halbtc8723b1ant_coex_table(btcoexist, -+ force_exec, 0x5a5a5a5a, 0x5aaa5a5a, -+ 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 8: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 9: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 10: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 11: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 12: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 13: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 14: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 15: -+ halbtc8723b1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8723b1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8723b1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8723b1ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8723b1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8723b1ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8723b1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8723b1ant_sw_mechanism(IN struct btc_coexist *btcoexist, -+ IN boolean low_penalty_ra) -+{ -+ halbtc8723b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -+} -+ -+void halbtc8723b1ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean force_exec, IN boolean init_hwcfg, -+ IN boolean wifi_off) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u32 fw_ver = 0, u32tmp = 0, cnt_bt_cal_chk = 0; -+ boolean pg_ext_switch = false; -+ boolean use_ext_switch = false; -+ boolean is_in_mp_mode = false; -+ u8 h2c_parameter[2] = {0}, u8tmp = 0; -+ -+ coex_dm->cur_ant_pos_type = ant_pos_type; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_EXT_SWITCH, &pg_ext_switch); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, -+ &fw_ver); /* [31:16]=fw ver, [15:0]=fw sub ver */ -+ -+ if ((fw_ver > 0 && fw_ver < 0xc0000) || pg_ext_switch) -+ use_ext_switch = true; -+ -+#if BT_8723B_1ANT_ANTDET_ENABLE -+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE -+ if (ant_pos_type == BTC_ANT_PATH_PTA) { -+ if ((board_info->btdm_ant_det_finish) && -+ (board_info->btdm_ant_num_by_ant_det == 2)) { -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = BTC_ANT_PATH_WIFI; -+ else -+ ant_pos_type = BTC_ANT_PATH_BT; -+ } -+ } -+#endif -+#endif -+ -+ if (init_hwcfg) { -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, -+ 0x780); /* WiFi TRx Mask on */ -+ /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ -+ /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT TRx Mask on */ -+ -+ if (fw_ver >= 0x180000) { -+ /* Use H2C to set GNT_BT to HIGH */ -+ h2c_parameter[0] = 1; -+ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, -+ h2c_parameter); -+ } else { -+ /* set grant_bt to high */ -+ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); -+ } -+ /* set wlan_act control by PTA */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, -+ 0x0); /* BT select s0/s1 is controlled by BT */ -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x39, 0x8, 0x1); -+ btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x944, 0x3, 0x3); -+ btcoexist->btc_write_1byte(btcoexist, 0x930, 0x77); -+ } else if (wifi_off) { -+ if (fw_ver >= 0x180000) { -+ /* Use H2C to set GNT_BT to HIGH */ -+ h2c_parameter[0] = 1; -+ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, -+ h2c_parameter); -+ } else { -+ /* set grant_bt to high */ -+ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); -+ } -+ /* set wlan_act to always low */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, -+ &is_in_mp_mode); -+ if (!is_in_mp_mode) -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, -+ 0x20, 0x0); /* BT select s0/s1 is controlled by BT */ -+ else -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, -+ 0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */ -+ -+ /* 0x4c[24:23]=00, Set Antenna control by BT_RFE_CTRL BT Vendor 0xac=0xf002 */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp &= ~BIT(23); -+ u32tmp &= ~BIT(24); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ } else { -+ /* Use H2C to set GNT_BT to LOW */ -+ if (fw_ver >= 0x180000) { -+ if (btcoexist->btc_read_1byte(btcoexist, 0x765) != 0) { -+ h2c_parameter[0] = 0; -+ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, -+ h2c_parameter); -+ } -+ } else { -+ /* BT calibration check */ -+ while (cnt_bt_cal_chk <= 20) { -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, -+ 0x49d); -+ cnt_bt_cal_chk++; -+ if (u8tmp & BIT(0)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ delay_ms(50); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ break; -+ } -+ } -+ -+ /* set grant_bt to PTA */ -+ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x0); -+ } -+ -+ if (btcoexist->btc_read_1byte(btcoexist, 0x76e) != 0xc) { -+ /* set wlan_act control by PTA */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+ } -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, -+ 0x1); /* BT select s0/s1 is controlled by WiFi */ -+ } -+ -+ if (use_ext_switch) { -+ if (init_hwcfg) { -+ /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp &= ~BIT(23); -+ u32tmp |= BIT(24); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x948, -+ 0x0); /* fixed internal switch S1->WiFi, S0->BT */ -+ -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) { -+ /* tell firmware "no antenna inverse" */ -+ h2c_parameter[0] = 0; -+ h2c_parameter[1] = 1; /* ext switch type */ -+ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, -+ h2c_parameter); -+ } else { -+ /* tell firmware "antenna inverse" */ -+ h2c_parameter[0] = 1; -+ h2c_parameter[1] = 1; /* ext switch type */ -+ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, -+ h2c_parameter); -+ } -+ } -+ -+ if (force_exec || -+ (coex_dm->cur_ant_pos_type != -+ coex_dm->pre_ant_pos_type)) { -+ /* ext switch setting */ -+ switch (ant_pos_type) { -+ case BTC_ANT_PATH_WIFI: -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ btcoexist->btc_write_1byte_bitmask( -+ btcoexist, 0x92c, 0x3, -+ 0x1); -+ else -+ btcoexist->btc_write_1byte_bitmask( -+ btcoexist, 0x92c, 0x3, -+ 0x2); -+ break; -+ case BTC_ANT_PATH_BT: -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ btcoexist->btc_write_1byte_bitmask( -+ btcoexist, 0x92c, 0x3, -+ 0x2); -+ else -+ btcoexist->btc_write_1byte_bitmask( -+ btcoexist, 0x92c, 0x3, -+ 0x1); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ btcoexist->btc_write_1byte_bitmask( -+ btcoexist, 0x92c, 0x3, -+ 0x1); -+ else -+ btcoexist->btc_write_1byte_bitmask( -+ btcoexist, 0x92c, 0x3, -+ 0x2); -+ break; -+ } -+ } -+ } else { -+ if (init_hwcfg) { -+ /* 0x4c[23]=1, 0x4c[24]=0 Antenna control by 0x64 */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp |= BIT(23); -+ u32tmp &= ~BIT(24); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ -+ /* Fix Ext switch Main->S1, Aux->S0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, -+ 0x0); -+ -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) { -+ -+ /* tell firmware "no antenna inverse" */ -+ h2c_parameter[0] = 0; -+ h2c_parameter[1] = -+ 0; /* internal switch type */ -+ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, -+ h2c_parameter); -+ } else { -+ -+ /* tell firmware "antenna inverse" */ -+ h2c_parameter[0] = 1; -+ h2c_parameter[1] = -+ 0; /* internal switch type */ -+ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, -+ h2c_parameter); -+ } -+ } -+ -+ if (force_exec || -+ (coex_dm->cur_ant_pos_type != -+ coex_dm->pre_ant_pos_type)) { -+ /* internal switch setting */ -+ switch (ant_pos_type) { -+ case BTC_ANT_PATH_WIFI: -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ btcoexist->btc_write_4byte( -+ btcoexist, 0x948, 0x0); -+ else -+ btcoexist->btc_write_4byte( -+ btcoexist, 0x948, -+ 0x280); -+ break; -+ case BTC_ANT_PATH_BT: -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ btcoexist->btc_write_4byte( -+ btcoexist, 0x948, -+ 0x280); -+ else -+ btcoexist->btc_write_4byte( -+ btcoexist, 0x948, 0x0); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ btcoexist->btc_write_4byte( -+ btcoexist, 0x948, -+ 0x200); -+ else -+ btcoexist->btc_write_4byte( -+ btcoexist, 0x948, 0x80); -+ break; -+ } -+ } -+ } -+ -+ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; -+} -+ -+void halbtc8723b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ if (ap_enable) { -+ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ } -+ } -+ -+ h2c_parameter[0] = real_byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = real_byte5; -+ -+ coex_dm->ps_tdma_para[0] = real_byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = real_byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+ -+void halbtc8723b1ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_busy = false; -+ u8 rssi_adjust_val = 0; -+ u8 ps_tdma_byte4_val = 0x50, ps_tdma_byte0_val = 0x51, -+ ps_tdma_byte3_val = 0x10; -+ s8 wifi_duration_adjust = 0x0; -+ static boolean pre_wifi_busy = false; -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+#if BT_8723B_1ANT_ANTDET_ENABLE -+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE -+ if (board_info->btdm_ant_num_by_ant_det == 2) { -+ if (turn_on) -+ type = type + -+ 100; /* for WiFi RSSI low or BT RSSI low */ -+ else -+ type = 1; /* always translate to TDMA(off,1) for TDMA-off case */ -+ } -+ -+#endif -+#endif -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (wifi_busy != pre_wifi_busy) { -+ force_exec = true; -+ pre_wifi_busy = wifi_busy; -+ } -+ -+ if (!force_exec) { -+ if( (coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma) ) -+ return; -+ } -+ -+ if (coex_sta->scan_ap_num <= 5) { -+ wifi_duration_adjust = 5; -+ -+ if (coex_sta->a2dp_bit_pool >= 35) -+ wifi_duration_adjust = -10; -+ else if (coex_sta->a2dp_bit_pool >= 45) -+ wifi_duration_adjust = -15; -+ } else if (coex_sta->scan_ap_num >= 40) { -+ wifi_duration_adjust = -15; -+ -+ if (coex_sta->a2dp_bit_pool < 35) -+ wifi_duration_adjust = -5; -+ else if (coex_sta->a2dp_bit_pool < 45) -+ wifi_duration_adjust = -10; -+ } else if (coex_sta->scan_ap_num >= 20) { -+ wifi_duration_adjust = -10; -+ -+ if (coex_sta->a2dp_bit_pool >= 45) -+ wifi_duration_adjust = -15; -+ } else { -+ wifi_duration_adjust = 0; -+ -+ if (coex_sta->a2dp_bit_pool >= 35) -+ wifi_duration_adjust = -10; -+ else if (coex_sta->a2dp_bit_pool >= 45) -+ wifi_duration_adjust = -15; -+ } -+ -+ if ((type == 1) || (type == 2) || (type == 9) || (type == 11) || -+ (type == 101) -+ || (type == 102) || (type == 109) || (type == 101)) { -+ if (!coex_sta->force_lps_on) { /* Native power save TDMA, only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 */ -+ ps_tdma_byte0_val = 0x61; /* no null-pkt */ -+ ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */ -+ ps_tdma_byte4_val = -+ 0x10; /* 0x778 = d/1 toggle, no dynamic slot */ -+ } else { -+ ps_tdma_byte0_val = 0x51; /* null-pkt */ -+ ps_tdma_byte3_val = 0x10; /* tx-pause at BT-slot */ -+ ps_tdma_byte4_val = -+ 0x50; /* 0x778 = d/1 toggle, dynamic slot */ -+ } -+ } else if ((type == 3) || (type == 13) || (type == 14) || -+ (type == 103) || (type == 113) || (type == 114)) { -+ ps_tdma_byte0_val = 0x51; /* null-pkt */ -+ ps_tdma_byte3_val = 0x10; /* tx-pause at BT-slot */ -+ ps_tdma_byte4_val = -+ 0x10; /* 0x778 = d/1 toggle, no dynamic slot */ -+#if 0 -+ if (!wifi_busy) -+ ps_tdma_byte4_val = ps_tdma_byte4_val | -+ 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+#endif -+ } else { /* native power save case */ -+ ps_tdma_byte0_val = 0x61; /* no null-pkt */ -+ ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */ -+ ps_tdma_byte4_val = -+ 0x11; /* 0x778 = d/1 toggle, no dynamic slot */ -+ /* psTdmaByte4Va is not defne for 0x778 = d/1, 1/1 case */ -+ } -+ -+ /* if (bt_link_info->slave_role == true) */ -+ if ((bt_link_info->slave_role == true) && (bt_link_info->a2dp_exist)) -+ ps_tdma_byte4_val = ps_tdma_byte4_val | -+ 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+ -+ if (type > 100) { -+ ps_tdma_byte0_val = ps_tdma_byte0_val | -+ 0x82; /* set antenna control by SW */ -+ ps_tdma_byte3_val = ps_tdma_byte3_val | -+ 0x60; /* set antenna no toggle, control by antenna diversity */ -+ } -+ -+ -+ if (turn_on) { -+ switch (type) { -+ default: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x1a, 0x1a, 0x0, ps_tdma_byte4_val); -+ break; -+ case 1: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x3a + -+ wifi_duration_adjust, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 2: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x2d + -+ wifi_duration_adjust, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 3: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x30, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 4: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x15, 0x3, 0x14, 0x0); -+ break; -+ case 5: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x1f, 0x3, -+ ps_tdma_byte3_val, 0x11); -+ break; -+ case 6: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x20, 0x3, -+ ps_tdma_byte3_val, 0x11); -+ break; -+ case 7: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13, -+ 0xc, 0x5, 0x0, 0x0); -+ break; -+ case 8: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 9: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x21, 0x3, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 10: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13, -+ 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 11: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x21, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 12: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x0a, 0x0a, 0x0, 0x50); -+ break; -+ case 13: -+ if (coex_sta->scan_ap_num <= 3) -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x40, 0x3, -+ ps_tdma_byte3_val, -+ ps_tdma_byte4_val); -+ else -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x21, 0x3, -+ ps_tdma_byte3_val, -+ ps_tdma_byte4_val); -+ break; -+ case 14: -+ if (coex_sta->scan_ap_num <= 3) -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x30, 0x3, 0x10, 0x50); -+ else -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x21, 0x3, -+ ps_tdma_byte3_val, -+ ps_tdma_byte4_val); -+ break; -+ case 15: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13, -+ 0xa, 0x3, 0x8, 0x0); -+ break; -+ case 16: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x15, 0x3, 0x10, 0x0); -+ break; -+ case 18: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 20: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x3f, 0x03, -+ ps_tdma_byte3_val, 0x10); -+ break; -+ case 21: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x25, 0x03, 0x11, 0x11); -+ break; -+ case 22: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x25, 0x03, -+ ps_tdma_byte3_val, 0x10); -+ break; -+ case 23: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x3, 0x31, 0x18); -+ break; -+ case 24: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x15, 0x3, 0x31, 0x18); -+ break; -+ case 25: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 26: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 27: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x3, 0x31, 0x98); -+ break; -+ case 28: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x69, -+ 0x25, 0x3, 0x31, 0x0); -+ break; -+ case 29: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xab, -+ 0x1a, 0x1a, 0x1, 0x10); -+ break; -+ case 30: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x30, 0x3, 0x10, 0x10); -+ break; -+ case 31: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x1a, 0x1a, 0, 0x58); -+ break; -+ case 32: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x35, 0x3, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 33: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x35, 0x3, -+ ps_tdma_byte3_val, 0x10); -+ break; -+ case 34: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x53, -+ 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 35: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x63, -+ 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 36: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x12, 0x3, 0x14, 0x50); -+ break; -+ case 40: /* SoftAP only with no sta associated,BT disable ,TDMA mode for power saving */ -+ /* here softap mode screen off will cost 70-80mA for phone */ -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x23, -+ 0x18, 0x00, 0x10, 0x24); -+ break; -+ -+ /* for 1-Ant translate to 2-Ant */ -+ case 101: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x3a + -+ wifi_duration_adjust, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 102: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x2d + -+ wifi_duration_adjust, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 103: -+ /* halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, 0x1d, 0x1d, 0x0, ps_tdma_byte4_val); */ -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x3a, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 105: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x15, 0x3, -+ ps_tdma_byte3_val, 0x11); -+ break; -+ case 106: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x20, 0x3, -+ ps_tdma_byte3_val, 0x11); -+ break; -+ case 109: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x21, 0x3, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 111: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x21, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 113: -+ /* halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, 0x12, 0x12, 0x0, ps_tdma_byte4_val); */ -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x21, 0x3, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 114: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x21, 0x3, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 120: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x3f, 0x03, -+ ps_tdma_byte3_val, 0x10); -+ break; -+ case 122: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x25, 0x03, -+ ps_tdma_byte3_val, 0x10); -+ break; -+ case 132: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x25, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 133: -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x25, 0x03, -+ ps_tdma_byte3_val, 0x11); -+ break; -+ -+ } -+ } else { -+ -+ /* disable PS tdma */ -+ switch (type) { -+ case 8: /* PTA Control */ -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x8, -+ 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 0: -+ default: /* Software control, Antenna at BT side */ -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ -+ halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x48, 0x0); -+ break; -+ } -+ } -+ rssi_adjust_val = 0; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", -+ btcoexist->btc_read_4byte(btcoexist, 0x948), -+ btcoexist->btc_read_1byte(btcoexist, 0x765), -+ btcoexist->btc_read_1byte(btcoexist, 0x67)); -+ BTC_TRACE(trace_buf); -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+void halbtc8723b1ant_tdma_duration_adjust_for_acl(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ static s32 up, dn, m, n, wait_count; -+ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ -+ u8 retry_count = 0, bt_info_ext; -+ boolean wifi_busy = false; -+ -+ if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifi_status) -+ wifi_busy = true; -+ else -+ wifi_busy = false; -+ -+ if ((BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == -+ wifi_status) || -+ (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifi_status) || -+ (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT == -+ wifi_status)) { -+ if (coex_dm->cur_ps_tdma != 1 && -+ coex_dm->cur_ps_tdma != 2 && -+ coex_dm->cur_ps_tdma != 3 && -+ coex_dm->cur_ps_tdma != 9) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } -+ return; -+ } -+ -+ if (!coex_dm->auto_tdma_adjust) { -+ coex_dm->auto_tdma_adjust = true; -+ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ /* ============ */ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } else { -+ /* accquire the BT TRx retry count from BT_Info byte2 */ -+ retry_count = coex_sta->bt_retry_cnt; -+ bt_info_ext = coex_sta->bt_info_ext; -+ -+ if ((coex_sta->low_priority_tx) > 1050 || -+ (coex_sta->low_priority_rx) > 1250) -+ retry_count++; -+ -+ result = 0; -+ wait_count++; -+ -+ if (retry_count == -+ 0) { /* no retry in the last 2-second duration */ -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ -+ wait_count = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ } -+ } else if (retry_count <= -+ 3) { /* <=3 retry in the last 2-second duration */ -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ -+ if (wait_count <= 2) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ -+ if (wait_count == 1) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ -+ if (result == -1) { -+ /* if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && -+ ((coex_dm->cur_ps_tdma == 1) ||(coex_dm->cur_ps_tdma == 2)) ) -+ { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } -+ else */ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } -+ } else if (result == 1) { -+ /* if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && -+ ((coex_dm->cur_ps_tdma == 1) ||(coex_dm->cur_ps_tdma == 2)) ) -+ { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } -+ else */ if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = 1; -+ } -+ } else { /* no change */ -+ /* Bryant Modify -+ if(wifi_busy != pre_wifi_busy) -+ { -+ pre_wifi_busy = wifi_busy; -+ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, true, coex_dm->cur_ps_tdma); -+ } -+ */ -+ -+ } -+ -+ if (coex_dm->cur_ps_tdma != 1 && -+ coex_dm->cur_ps_tdma != 2 && -+ coex_dm->cur_ps_tdma != 9 && -+ coex_dm->cur_ps_tdma != 11) { -+ /* recover to previous adjust type */ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ coex_dm->ps_tdma_du_adj_type); -+ } -+ } -+} -+ -+void halbtc8723b1ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8723b1ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8723b1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8723b1ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ coex_sta->force_lps_on = true; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8723b1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, false); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8723b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, -+ false, false); -+} -+ -+void halbtc8723b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ -+ /* This function check if bt is disabled */ -+ -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ } else { -+ bt_disable_cnt++; -+ if (bt_disable_cnt >= 2) -+ bt_disabled = true; -+ } -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->bt_disabled = bt_disabled; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ if (bt_disabled) { -+ halbtc8723b1ant_action_wifi_only(btcoexist); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ } -+ } -+} -+ -+/* ********************************************* -+ * -+ * Non-Software Coex Mechanism start -+ * -+ * ********************************************* */ -+void halbtc8723b1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, -+ false, false); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8723b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, -+ false, false); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8723b1ant_action_hs(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8723b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, -+ bt_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ if (coex_sta->bt_abnormal_scan) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 33); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ } else if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) { -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ /* SCO/HID/A2DP busy */ -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ -+ if (coex_sta->c2h_bt_remote_name_req) -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 33); -+ else -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if ((bt_link_info->pan_exist) || (wifi_busy)) { -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ -+ if (coex_sta->c2h_bt_remote_name_req) -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 33); -+ else -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ -+ } -+} -+ -+void halbtc8723b1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ /* tdma and coex table */ -+ -+ if (bt_link_info->sco_exist) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } else { /* HID */ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } -+} -+ -+void halbtc8723b1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ if ((coex_sta->low_priority_rx >= 950) && (!coex_sta->under_ips)) -+ bt_link_info->slave_role = true; -+ else -+ bt_link_info->slave_role = false; -+ -+ if (bt_link_info->hid_only) { /* HID */ -+ halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ wifi_status); -+ coex_dm->auto_tdma_adjust = false; -+ return; -+ } else if (bt_link_info->a2dp_only) { /* A2DP */ -+ if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ halbtc8723b1ant_tdma_duration_adjust_for_acl(btcoexist, -+ wifi_status); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = true; -+ } -+ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || -+ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { /* HID+A2DP */ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); -+ coex_dm->auto_tdma_adjust = false; -+ -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && -+ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ /* BT no-profile busy (0x9) */ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } -+} -+ -+void halbtc8723b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -+{ -+ /* power save state */ -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, -+ false, false); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8723b1ant_action_wifi_not_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 20); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ /* Bryant Add */ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8723b1ant_action_wifi_not_connected_asso_auth( -+ IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); -+ } else if (bt_link_info->pan_exist) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); -+ } else { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); -+ } -+} -+ -+void halbtc8723b1ant_action_wifi_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 20); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ /* Bryant Add */ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8723b1ant_action_wifi_connected_specific_packet( -+ IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ /* no specific packet process for both WiFi and BT very busy */ -+ if ((wifi_busy) && ((bt_link_info->pan_exist) || -+ (coex_sta->num_of_profile >= 2))) -+ return; -+ -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } else if (bt_link_info->a2dp_exist) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if (bt_link_info->pan_exist) { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8723b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_busy = false; -+ boolean scan = false, link = false, roam = false; -+ boolean under_4way = false, ap_enable = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ if (under_4way) { -+ halbtc8723b1ant_action_wifi_connected_specific_packet(btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8723b1ant_action_wifi_connected_scan(btcoexist); -+ else -+ halbtc8723b1ant_action_wifi_connected_specific_packet( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ /* power save state */ -+ if (!ap_enable && -+ BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status && -+ !btcoexist->bt_link_info.hid_only) { -+ if (btcoexist->bt_link_info.a2dp_only) { /* A2DP */ -+ if (!wifi_busy) -+ halbtc8723b1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else { /* busy */ -+ if (coex_sta->scan_ap_num >= -+ BT_8723B_1ANT_WIFI_NOISY_THRESH) /* no force LPS, no PS-TDMA, use pure TDMA */ -+ halbtc8723b1ant_power_save_state( -+ btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ else -+ halbtc8723b1ant_power_save_state( -+ btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ } else if ((coex_sta->pan_exist == false) && -+ (coex_sta->a2dp_exist == false) && -+ (coex_sta->hid_exist == false)) -+ halbtc8723b1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8723b1ant_power_save_state(btcoexist, -+ BTC_PS_LPS_ON, 0x50, 0x4); -+ } else -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ -+ /* tdma and coex table */ -+ if (!wifi_busy) { -+ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8723b1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else { -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ halbtc8723b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); -+ /* if ((coex_sta->high_priority_tx) + -+ (coex_sta->high_priority_rx) <= 60) */ -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 2); -+ /* else -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 7); */ -+ } -+ } else { -+ if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8723b1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else { -+ /* halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ halbtc8723b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); -+ if ((coex_sta->high_priority_tx) + -+ (coex_sta->high_priority_rx) <= 60) -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 2); -+ else -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 7); */ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8723b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ -+ } -+ } -+} -+ -+void halbtc8723b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false, wifi_busy = false; -+ boolean increase_scan_dev_num = false; -+ boolean bt_ctrl_agg_buf_size = false; -+ boolean miracast_plus_bt = false; -+ u8 agg_buf_size = 5; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0, wifi_bw; -+ u8 iot_peer = BTC_IOT_PEER_UNKNOWN; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->bt_whck_test) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under WHCK TEST!!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b1ant_action_bt_whck_test(btcoexist); -+ return; -+ } -+ -+ if ((BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ increase_scan_dev_num = true; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, -+ &increase_scan_dev_num); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if ((num_of_wifi_link >= 2) || -+ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { -+ if (bt_link_info->bt_link_exist) { -+ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, -+ 0, 1); -+ miracast_plus_bt = true; -+ } else { -+ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, -+ 0, 0); -+ miracast_plus_bt = false; -+ } -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (((bt_link_info->a2dp_exist) || (wifi_busy)) && -+ (coex_sta->c2h_bt_inquiry_page)) -+ halbtc8723b1ant_action_bt_inquiry(btcoexist); -+ else -+ halbtc8723b1ant_action_wifi_multi_port(btcoexist); -+ -+ return; -+ } else { -+ miracast_plus_bt = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { -+ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); -+ -+ /* if(BTC_IOT_PEER_CISCO != iot_peer) */ -+ if ((BTC_IOT_PEER_CISCO != iot_peer) && -+ (BTC_IOT_PEER_BROADCOM != iot_peer)) { -+ if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ -+ /* halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, true, false, 0x5); */ -+ halbtc8723b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, false, 0x5); -+ else -+ halbtc8723b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, false, 0x5); -+ /* halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x8); */ -+ } else { -+ if (bt_link_info->sco_exist) -+ halbtc8723b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, true, false, 0x5); -+ else { -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ halbtc8723b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, true, 0x10); -+ else -+ halbtc8723b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, true, 0x8); -+ } -+ } -+ -+ halbtc8723b1ant_sw_mechanism(btcoexist, true); -+ } else { -+ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x5); -+ -+ halbtc8723b1ant_sw_mechanism(btcoexist, false); -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8723b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8723b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ -+ if (!wifi_connected) { -+ boolean scan = false, link = false, roam = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is non connected-idle !!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8723b1ant_action_wifi_not_connected_scan( -+ btcoexist); -+ else -+ halbtc8723b1ant_action_wifi_not_connected_asso_auth( -+ btcoexist); -+ } else -+ halbtc8723b1ant_action_wifi_not_connected(btcoexist); -+ } else /* wifi LPS/Busy */ -+ halbtc8723b1ant_action_wifi_connected(btcoexist); -+} -+ -+void halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ -+ /* sw all off */ -+ halbtc8723b1ant_sw_mechanism(btcoexist, false); -+ -+ /* halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ -+ /* halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ -+ -+ coex_sta->pop_event_cnt = 0; -+} -+ -+void halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean back_up, IN boolean wifi_only) -+{ -+ u32 u32tmp = 0; /* , fw_ver; */ -+ u8 u8tmpa = 0, u8tmpb = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 1Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ psd_scan->ant_det_is_ant_det_available = false; -+ -+ /* 0xf0[15:12] --> Chip Cut information */ -+ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, -+ 0xf1) & 0xf0) >> 4; -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ -+ /* 0x790[5:0]=0x5 */ -+ btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); -+ -+ /* Enable counter statistics */ -+ /* btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); //0x76e[3] =1, WLAN_Act control by PTA */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -+ -+ -+ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, 0x1); //BT select s0/s1 is controlled by WiFi */ -+ -+ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ -+ /* Antenna config */ -+ if (wifi_only) -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, -+ FORCE_EXEC, true, false); -+ else -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, true, false); -+ -+ /* PTA parameter */ -+ halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); -+ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", -+ u32tmp, u8tmpa, u8tmpb); -+ BTC_TRACE(trace_buf); -+} -+ -+void halbtc8723b1ant_mechanism_switch(IN struct btc_coexist *btcoexist, -+ IN boolean bSwitchTo2Antenna) -+{ -+ -+ if (bSwitchTo2Antenna) { /* 1-Ant -> 2-Ant */ -+ /* un-lock TRx Mask setup for 8723b f-cut */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, 0x80, 0x1); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, 0x1, 0x1); -+ /* WiFi TRx Mask on */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, -+ 0x0); -+ -+ /* BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1 */ -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x2c, -+ 0x7c45); -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x30, -+ 0x7c45); -+ -+ /* BT TRx Mask on */ -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x1); -+ -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, false, false); -+ } else { -+ /* WiFi TRx Mask on */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, -+ 0x780); -+ -+ /* lock TRx Mask setup for 8723b f-cut */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, 0x80, 0x0); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, 0x1, 0x0); -+ -+ /* BT TRx Mask on */ -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); -+ -+ /* BT TRx Mask ock 0x2c[0], 0x30[0] = 0 */ -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x2c, -+ 0x7c44); -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x30, -+ 0x7c44); -+ -+ -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ FORCE_EXEC, false, false); -+ } -+ -+} -+ -+u32 halbtc8723b1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) -+{ -+ u8 j; -+ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; -+ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, -+ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, -+ 32, 23, 15, 7, 0 -+ }; -+ -+ if (val == 0) -+ return 0; -+ -+ tmp = val; -+ -+ while (1) { -+ if (tmp == 1) -+ break; -+ else { -+ tmp = (tmp >> 1); -+ shiftcount++; -+ } -+ } -+ -+ -+ val_integerd_b = shiftcount + 1; -+ -+ tmp2 = 1; -+ for (j = 1; j <= val_integerd_b; j++) -+ tmp2 = tmp2 * 2; -+ -+ tmp = (val * 100) / tmp2; -+ tindex = tmp / 5; -+ -+ if (tindex > 20) -+ tindex = 20; -+ -+ val_fractiond_b = table_fraction[tindex]; -+ -+ result = val_integerd_b * 100 - val_fractiond_b; -+ -+ return result; -+ -+ -+} -+ -+void halbtc8723b1ant_psd_show_antenna_detect_result(IN struct btc_coexist -+ *btcoexist) -+{ -+ u8 *cli_buf = btcoexist->cli_buf; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n============[Antenna Detection info] ============\n"); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->ant_det_result == 1) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", -+ "Ant Det Result", "2-Antenna (Bad-Isolation)", -+ BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else if (psd_scan->ant_det_result == 2) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "2-Antenna (Good-Isolation)", -+ BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset, -+ BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "1-Antenna", -+ BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT, -+ BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset); -+ -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", -+ "Antenna Detection Finish", -+ (board_info->btdm_ant_det_finish -+ ? "Yes" : "No")); -+ CL_PRINTF(cli_buf); -+ -+ switch (psd_scan->ant_det_result) { -+ case 0: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is not available)"); -+ break; -+ case 1: /* 2-Ant bad-isolation */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 2: /* 2-Ant good-isolation */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 3: /* 1-Ant */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 4: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Uncertainty result)"); -+ break; -+ case 5: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); -+ break; -+ case 6: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(WiFi is Scanning)"); -+ break; -+ case 7: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is not idle)"); -+ break; -+ case 8: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Abort by WiFi Scanning)"); -+ break; -+ case 9: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Antenna Init is not ready)"); -+ break; -+ case 10: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is Inquiry or page)"); -+ break; -+ case 11: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is Disabled)"); -+ break; -+ } -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Ant Detect Total Count", psd_scan->ant_det_try_count); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Ant Detect Fail Count", psd_scan->ant_det_fail_count); -+ CL_PRINTF(cli_buf); -+ -+ if ((!board_info->btdm_ant_det_finish) && -+ (psd_scan->ant_det_result != 5)) -+ return; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", -+ (psd_scan->ant_det_result ? "ok" : "fail")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", -+ psd_scan->ant_det_bt_tx_time); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", -+ psd_scan->ant_det_bt_le_channel); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", -+ "WiFi PSD Cent-Ch/Offset/Span", -+ psd_scan->real_cent_freq, psd_scan->real_offset, -+ psd_scan->real_span); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", -+ "PSD Pre-Scan Peak Value", -+ psd_scan->ant_det_pre_psdscan_peak_val / 100); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", -+ "PSD Pre-Scan result", -+ (psd_scan->ant_det_result != 5 ? "ok" : "fail"), -+ BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->ant_det_result == 5) -+ return; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", -+ "PSD Scan Peak Value", psd_scan->ant_det_peak_val); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", -+ "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", -+ (board_info->tfbga_package) ? "Yes" : "No"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "PSD Threshold Offset", psd_scan->ant_det_thres_offset); -+ CL_PRINTF(cli_buf); -+ -+} -+ -+void halbtc8723b1ant_psd_showdata(IN struct btc_coexist *btcoexist) -+{ -+ u8 *cli_buf = btcoexist->cli_buf; -+ u32 delta_freq_per_point; -+ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n\n============[PSD info] (%d)============\n", -+ psd_scan->psd_gen_count); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->psd_gen_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); -+ CL_PRINTF(cli_buf); -+ return; -+ } -+ -+ if (psd_scan->psd_point == 0) -+ delta_freq_per_point = 0; -+ else -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* if (psd_scan->is_psd_show_max_only) */ -+ if (0) { -+ psd_rep1 = psd_scan->psd_max_value / 100; -+ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; -+ -+ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + -+ psd_scan->psd_max_value_point * delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.0%d MHz", -+ freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.%d MHz", -+ freq1, freq2); -+ -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.0%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ -+ CL_PRINTF(cli_buf); -+ } else { -+ m = psd_scan->psd_start_point; -+ n = psd_scan->psd_start_point; -+ i = 1; -+ j = 1; -+ -+ while (1) { -+ do { -+ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * -+ delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (i == 1) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.0%2d", freq1, -+ freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.%3d", freq1, -+ freq2); -+ } else if ((i % 8 == 0) || -+ (m == psd_scan->psd_stop_point)) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.000\n", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.0%2d\n", freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.%3d\n", freq1, freq2); -+ } else { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.0%2d", freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.%3d", freq1, freq2); -+ } -+ -+ i++; -+ m++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); -+ -+ -+ do { -+ psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; -+ psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * -+ 100; -+ -+ if (j == 1) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.0%d", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.%d", psd_rep1, -+ psd_rep2); -+ } else if ((j % 8 == 0) || -+ (n == psd_scan->psd_stop_point)) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.0%d\n", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.%d\n", psd_rep1, psd_rep2); -+ } else { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.0%d", psd_rep1, psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.%d", psd_rep1, psd_rep2); -+ } -+ -+ j++; -+ n++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); -+ -+ if ((m > psd_scan->psd_stop_point) || -+ (n > psd_scan->psd_stop_point)) -+ break; -+ else { -+ i = 1; -+ j = 1; -+ } -+ -+ } -+ } -+ -+ -+} -+ -+void halbtc8723b1ant_psd_max_holddata(IN struct btc_coexist *btcoexist, -+ IN u32 gen_count) -+{ -+ u32 i = 0, i_max = 0, val_max = 0; -+ -+ if (gen_count == 1) { -+ memcpy(psd_scan->psd_report_max_hold, -+ psd_scan->psd_report, -+ BT_8723B_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); -+ -+ psd_scan->psd_max_value_point = 0; -+ psd_scan->psd_max_value = 0; -+ -+ } else { -+ for (i = psd_scan->psd_start_point; -+ i <= psd_scan->psd_stop_point; i++) { -+ if (psd_scan->psd_report[i] > -+ psd_scan->psd_report_max_hold[i]) -+ psd_scan->psd_report_max_hold[i] = -+ psd_scan->psd_report[i]; -+ -+ /* search Max Value */ -+ if (i == psd_scan->psd_start_point) { -+ i_max = i; -+ val_max = psd_scan->psd_report_max_hold[i]; -+ } else { -+ if (psd_scan->psd_report_max_hold[i] > -+ val_max) { -+ i_max = i; -+ val_max = psd_scan->psd_report_max_hold[i]; -+ } -+ } -+ -+ } -+ -+ psd_scan->psd_max_value_point = i_max; -+ psd_scan->psd_max_value = val_max; -+ -+ } -+ -+ -+} -+ -+u32 halbtc8723b1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) -+{ -+ /* reg 0x808[9:0]: FFT data x */ -+ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ -+ /* reg 0x8b4[15:0]: FFT data y report */ -+ -+ u32 val = 0, psd_report = 0; -+ int k = 0; -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ -+ val &= 0xffbffc00; -+ val |= point; -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ val |= 0x00400000; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ while (1) { -+ if (k++ > BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY) -+ break; -+ } -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); -+ -+ psd_report = val & 0x0000ffff; -+ -+ return psd_report; -+} -+ -+ -+boolean halbtc8723b1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, -+ IN u32 avgnum, IN u32 loopcnt) -+{ -+ u32 i, val, n, k = 0, j, point_index = 0; -+ u32 points1 = 0, psd_report = 0; -+ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; -+ u32 psd_center_freq = 20 * 10 ^ 6; -+ boolean outloop = false, scan , roam, is_sweep_ok = true; -+ u8 flag = 0; -+ u32 tmp; -+ u32 wifi_original_channel = 1; -+ -+ psd_scan->is_psd_running = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ do { -+ switch (flag) { -+ case 0: /* Get PSD parameters */ -+ default: -+ -+ psd_scan->psd_band_width = 40 * 1000000; -+ psd_scan->psd_point = points; -+ psd_scan->psd_start_base = points / 2; -+ psd_scan->psd_avg_num = avgnum; -+ psd_scan->real_cent_freq = cent_freq; -+ psd_scan->real_offset = offset; -+ psd_scan->real_span = span; -+ -+ -+ points1 = psd_scan->psd_point; -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* PSD point setup */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffff0fff; -+ -+ switch (psd_scan->psd_point) { -+ case 128: -+ val |= 0x0; -+ break; -+ case 256: -+ default: -+ val |= 0x00004000; -+ break; -+ case 512: -+ val |= 0x00008000; -+ break; -+ case 1024: -+ val |= 0x0000c000; -+ break; -+ } -+ -+ switch (psd_scan->psd_avg_num) { -+ case 1: -+ val |= 0x0; -+ break; -+ case 8: -+ val |= 0x00001000; -+ break; -+ case 16: -+ val |= 0x00002000; -+ break; -+ case 32: -+ default: -+ val |= 0x00003000; -+ break; -+ } -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ flag = 1; -+ break; -+ case 1: /* calculate the PSD point index from freq/offset/span */ -+ psd_center_freq = psd_scan->psd_band_width / 2 + -+ offset * (1000000); -+ -+ start_p = psd_scan->psd_start_base + (psd_center_freq - -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_start_point = start_p - -+ psd_scan->psd_start_base; -+ -+ stop_p = psd_scan->psd_start_base + (psd_center_freq + -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_stop_point = stop_p - -+ psd_scan->psd_start_base - 1; -+ -+ flag = 2; -+ break; -+ case 2: /* set RF channel/BW/Mode */ -+ -+ /* set 3-wire off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val |= 0x00300000; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val &= 0xfeffffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* store WiFi original channel */ -+ wifi_original_channel = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x18, 0x3ff); -+ -+ /* Set RF channel */ -+ if (cent_freq == 2484) -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, 0xe); -+ else -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, (cent_freq - 2412) / 5 + -+ 1); /* WiFi TRx Mask on */ -+ -+ -+ /* Set RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, -+ 0xfffff, 0x3e4); -+ -+ /* Set TRx mask off */ -+ /* un-lock TRx Mask setup */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, -+ 0x80, 0x1); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, -+ 0x1, 0x1); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, -+ 0xfffff, 0x0); -+ -+ /* Set RF mode = Rx, RF Gain = 0x8a0 */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, -+ 0xfffff, 0x308a0); -+ -+ while (1) { -+ if (k++ > BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY) -+ break; -+ } -+ flag = 3; -+ break; -+ case 3: -+ psd_scan->psd_gen_count = 0; -+ for (j = 1; j <= loopcnt; j++) { -+ -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || roam) { -+ is_sweep_ok = false; -+ break; -+ } -+ memset(psd_scan->psd_report, 0, -+ psd_scan->psd_point * sizeof(u32)); -+ start_p = psd_scan->psd_start_point + -+ psd_scan->psd_start_base; -+ stop_p = psd_scan->psd_stop_point + -+ psd_scan->psd_start_base + 1; -+ -+ i = start_p; -+ point_index = 0; -+ -+ while (i < stop_p) { -+ if (i >= points1) -+ psd_report = -+ halbtc8723b1ant_psd_getdata( -+ btcoexist, i - points1); -+ else -+ psd_report = -+ halbtc8723b1ant_psd_getdata( -+ btcoexist, i); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Point=%d, psd_raw_data = 0x%08x\n", -+ i, psd_report); -+ BTC_TRACE(trace_buf); -+ if (psd_report == 0) -+ tmp = 0; -+ else -+ /* tmp = 20*log10((double)psd_report); */ -+ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ -+ tmp = 6 * halbtc8723b1ant_psd_log2base( -+ btcoexist, psd_report); -+ -+ n = i - psd_scan->psd_start_base; -+ psd_scan->psd_report[n] = tmp; -+ -+ -+ halbtc8723b1ant_psd_max_holddata( -+ btcoexist, j); -+ -+ i++; -+ -+ } -+ -+ psd_scan->psd_gen_count = j; -+ } -+ -+ flag = 100; -+ break; -+ case 99: /* error */ -+ -+ outloop = true; -+ break; -+ case 100: /* recovery */ -+ -+ /* set 3-wire on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val &= 0xffcfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val |= 0x01000000; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* PSD off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffbfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ /* TRx Mask on */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, -+ 0xfffff, 0x780); -+ -+ /* lock TRx Mask setup */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, -+ 0x80, 0x0); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, -+ 0x1, 0x0); -+ -+ /* Set RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, -+ 0xfffff, 0x0); -+ -+ /* restore WiFi original channel */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, -+ 0x3ff, wifi_original_channel); -+ -+ outloop = true; -+ break; -+ -+ } -+ -+ } while (!outloop); -+ -+ -+ -+ psd_scan->is_psd_running = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); -+ BTC_TRACE(trace_buf); -+ return is_sweep_ok; -+ -+} -+ -+void halbtc8723b1ant_psd_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 bt_tx_time, IN u32 bt_le_channel) -+{ -+ u32 i = 0; -+ u32 wlpsd_cent_freq = 2484, wlpsd_span = 2, wlpsd_sweep_count = 50; -+ s32 wlpsd_offset = -4; -+ u8 bt_le_ch[13] = {3,6,8,11,13,16,18,21,23,26,28,31,33}; -+ -+ u8 h2c_parameter[3] ={0},u8tmpa,u8tmpb; -+ -+ u8 state=0; -+ boolean outloop = false, bt_resp = false; -+ u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, -+ u32tmp; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ board_info->btdm_ant_det_finish = false; -+ memset(psd_scan->ant_det_peak_val, 0, 16*sizeof(u8)); -+ memset(psd_scan->ant_det_peak_freq, 0, 16*sizeof(u8)); -+ -+ if (board_info->tfbga_package) /* for TFBGA */ -+ psd_scan->ant_det_thres_offset = 5; -+ else -+ psd_scan->ant_det_thres_offset = 0; -+ -+ do { -+ switch (state) { -+ case 0: -+ if (bt_le_channel == 39) -+ wlpsd_cent_freq = 2484; -+ else { -+ for (i = 1; i <= 13; i++) { -+ if (bt_le_ch[i - 1] == -+ bt_le_channel) { -+ wlpsd_cent_freq = 2412 -+ + (i - 1) * 5; -+ break; -+ } -+ } -+ -+ if (i == 14) { -+ -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", -+ bt_le_channel); -+ BTC_TRACE(trace_buf); -+ outloop = true; -+ break; -+ } -+ } -+ -+ wlpsd_sweep_count = bt_tx_time * 238 / -+ 100; /* bt_tx_time/0.42 */ -+ wlpsd_sweep_count = wlpsd_sweep_count / 5; -+ -+ if (wlpsd_sweep_count % 5 != 0) -+ wlpsd_sweep_count = (wlpsd_sweep_count / -+ 5 + 1) * 5; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", -+ bt_tx_time, bt_le_channel); -+ BTC_TRACE(trace_buf); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", -+ wlpsd_cent_freq, -+ wlpsd_offset, -+ wlpsd_span, -+ wlpsd_sweep_count); -+ BTC_TRACE(trace_buf); -+ -+ state = 1; -+ break; -+ case 1: /* stop coex DM & set antenna path */ -+ /* Stop Coex DM */ -+ btcoexist->stop_coex_dm = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* set native power save */ -+ halbtc8723b1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ -+ /* Set TDMA off, */ -+ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, -+ false, 0); -+ -+ /* Set coex table */ -+ halbtc8723b1ant_coex_table_with_type(btcoexist, -+ FORCE_EXEC, 0); -+ -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ /* Set Antenna path, switch WiFi to un-certain antenna port */ -+ halbtc8723b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_BT, FORCE_EXEC, false, -+ false); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ -+ h2c_parameter[0] = 0x1; -+ h2c_parameter[1] = 0xd; -+ h2c_parameter[2] = 0x14; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", -+ h2c_parameter[1], -+ h2c_parameter[2]); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, -+ h2c_parameter); -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, -+ 0x948); -+ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); -+ u8tmpb = btcoexist->btc_read_1byte(btcoexist, -+ 0x778); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x778=0x%x\n", -+ u32tmp, u8tmpa, u8tmpb); -+ BTC_TRACE(trace_buf); -+ -+ state = 2; -+ break; -+ case 2: /* Pre-sweep background psd */ -+ if (!halbtc8723b1ant_psd_sweep_point(btcoexist, -+ wlpsd_cent_freq, wlpsd_offset, wlpsd_span, -+ BT_8723B_1ANT_ANTDET_PSD_POINTS, -+ BT_8723B_1ANT_ANTDET_PSD_AVGNUM, 3)) { -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ psd_scan->ant_det_result = 8; -+ state = 99; -+ break; -+ } -+ -+ psd_scan->ant_det_pre_psdscan_peak_val = -+ psd_scan->psd_max_value; -+ -+ if (psd_scan->psd_max_value > -+ (BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset) * 100) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", -+ psd_scan->psd_max_value / 100, -+ BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ BTC_TRACE(trace_buf); -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ psd_scan->ant_det_result = 5; -+ state = 99; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", -+ psd_scan->psd_max_value / 100, -+ BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ BTC_TRACE(trace_buf); -+ state = 3; -+ } -+ break; -+ case 3: -+ bt_resp = btcoexist->btc_set_bt_ant_detection( -+ btcoexist, (u8)(bt_tx_time & 0xff), -+ (u8)(bt_le_channel & 0xff)); -+ -+ if (!halbtc8723b1ant_psd_sweep_point(btcoexist, -+ wlpsd_cent_freq, wlpsd_offset, -+ wlpsd_span, -+ BT_8723B_1ANT_ANTDET_PSD_POINTS, -+ BT_8723B_1ANT_ANTDET_PSD_AVGNUM, -+ wlpsd_sweep_count)) { -+ board_info->btdm_ant_det_finish -+ = false; -+ board_info->btdm_ant_num_by_ant_det -+ = 1; -+ psd_scan->ant_det_result = 8; -+ state = 99; -+ break; -+ } -+ -+ psd_scan->ant_det_psd_scan_peak_val = -+ psd_scan->psd_max_value; -+ psd_scan->ant_det_psd_scan_peak_freq = -+ psd_scan->psd_max_value_point; -+ state = 4; -+ break; -+ case 4: -+ -+ if (psd_scan->psd_point == 0) -+ delta_freq_per_point = 0; -+ else -+ delta_freq_per_point = -+ psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ psd_rep1 = psd_scan->psd_max_value / 100; -+ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * -+ 100; -+ -+ freq = ((psd_scan->real_cent_freq - 20) * -+ 1000000 + psd_scan->psd_max_value_point -+ * delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (freq2 < 100) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", -+ freq1, freq2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_freq, -+ BT_8723B_1ANT_ANTDET_BUF_LEN, -+ "%d.0%d", freq1, freq2); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", -+ freq1, freq2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_freq, -+ BT_8723B_1ANT_ANTDET_BUF_LEN, -+ "%d.%d", freq1, freq2); -+ } -+ -+ if (psd_rep2 < 10) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.0%d dB\n", -+ psd_rep1, psd_rep2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_val, -+ BT_8723B_1ANT_ANTDET_BUF_LEN, -+ "%d.0%d", psd_rep1, psd_rep2); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.%d dB\n", -+ psd_rep1, psd_rep2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_val, -+ BT_8723B_1ANT_ANTDET_BUF_LEN, -+ "%d.%d", psd_rep1, psd_rep2); -+ } -+ -+ psd_scan->ant_det_is_btreply_available = true; -+ -+ if (bt_resp == false) { -+ psd_scan->ant_det_is_btreply_available = -+ false; -+ psd_scan->ant_det_result = 0; -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->psd_max_value > -+ (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) -+ * 100) { -+ psd_scan->ant_det_result = 1; -+ board_info->btdm_ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 2; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->psd_max_value > -+ (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset) * 100) { -+ psd_scan->ant_det_result = 2; -+ board_info->btdm_ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 2; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->psd_max_value > -+ (BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT) * -+ 100) { -+ psd_scan->ant_det_result = 3; -+ board_info->btdm_ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ psd_scan->ant_det_result = 4; -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ state = 99; -+ break; -+ case 99: /* restore setup */ -+ -+ /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ -+ h2c_parameter[0] = 0x0; -+ h2c_parameter[1] = 0x0; -+ h2c_parameter[2] = 0x0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", -+ h2c_parameter[1], h2c_parameter[2]); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, -+ h2c_parameter); -+ -+ /* Set Antenna Path */ -+ halbtc8723b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_PTA, FORCE_EXEC, false, -+ false); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ /* Resume Coex DM */ -+ btcoexist->stop_coex_dm = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ /* stimulate coex running */ -+ halbtc8723b1ant_run_coexist_mechanism( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ outloop = true; -+ break; -+ } -+ -+ } while (!outloop); -+ -+ -+ -+} -+ -+void halbtc8723b1ant_psd_antenna_detection_check(IN struct btc_coexist -+ *btcoexist) -+{ -+ static u32 ant_det_count = 0, ant_det_fail_count = 0; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ boolean scan, roam; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ -+ /* psd_scan->ant_det_bt_tx_time = 20; */ -+ psd_scan->ant_det_bt_tx_time = -+ BT_8723B_1ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ -+ psd_scan->ant_det_bt_le_channel = BT_8723B_1ANT_ANTDET_BTTXCHANNEL; -+ -+ ant_det_count++; -+ -+ psd_scan->ant_det_try_count = ant_det_count; -+ -+ if (scan || roam) { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 6; -+ } else if (coex_sta->bt_disabled) { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 11; -+ } else if (coex_sta->num_of_profile >= 1) { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 7; -+ } else if ( -+ !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 9; -+ } else if (coex_sta->c2h_bt_inquiry_page) { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 10; -+ } else -+ halbtc8723b1ant_psd_antenna_detection(btcoexist, -+ psd_scan->ant_det_bt_tx_time, -+ psd_scan->ant_det_bt_le_channel); -+ -+ if (!board_info->btdm_ant_det_finish) -+ ant_det_fail_count++; -+ -+ psd_scan->ant_det_fail_count = ant_det_fail_count; -+ -+} -+ -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8723b1ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8723b1ant_ -+ * ************************************************************ */ -+void ex_halbtc8723b1ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp=0x0; -+ u16 u16tmp=0x0; -+ u32 value; -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Execute 8723b 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Ant Det Finish = %s, Ant Det Number = %d\n", -+ (board_info->btdm_ant_det_finish ? "Yes" : "No"), -+ board_info->btdm_ant_num_by_ant_det); -+ BTC_TRACE(trace_buf); -+ -+ -+ btcoexist->stop_coex_dm = true; -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x67, 0x20); -+ -+ /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ -+ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); -+ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); -+ -+ /* set GRAN_BT = 1 */ -+ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); -+ /* set WLAN_ACT = 0 */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); -+ -+ /* */ -+ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ -+ if(btcoexist->chip_interface == BTC_INTF_USB) { -+ /* fixed at S0 for USB interface */ -+ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); -+ -+ u8tmp |= 0x1; /* antenna inverse */ -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); -+ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; -+ } else { -+ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ -+ if (board_info->single_ant_path == 0) { -+ /* set to S1 */ -+ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x280); -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+ value = 1; -+ } else if (board_info->single_ant_path == 1) { -+ /* set to S0 */ -+ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); -+ u8tmp |= 0x1; /* antenna inverse */ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; -+ value = 0; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, -+ &value); -+ -+ if(btcoexist->chip_interface == BTC_INTF_PCI) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384, -+ u8tmp); -+ else if(btcoexist->chip_interface == BTC_INTF_SDIO) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, -+ u8tmp); -+ } -+} -+ -+void ex_halbtc8723b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -+{ -+} -+ -+void ex_halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ halbtc8723b1ant_init_hw_config(btcoexist, true, wifi_only); -+ btcoexist->stop_coex_dm = false; -+} -+ -+void ex_halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = false; -+ -+ halbtc8723b1ant_init_coex_dm(btcoexist); -+ -+ halbtc8723b1ant_query_bt_info(btcoexist); -+} -+ -+void ex_halbtc8723b1ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case=0; -+ u16 u16tmp[4]; -+ u32 u32tmp[4]; -+ u32 fa_ofdm, fa_cck; -+ u32 fw_ver=0, bt_patch_ver=0; -+ static u8 pop_report_in_10s = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if(btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ if(btcoexist->stop_coex_dm) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (psd_scan->ant_det_try_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", -+ "Ant PG Num/ Mech/ Pos", -+ board_info->pg_ant_num, board_info->btdm_ant_num, -+ board_info->btdm_ant_pos); -+ CL_PRINTF(cli_buf); -+ } else { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d (%d/%d/%d)", -+ "Ant PG Num/ Mech(Ant_Det)/ Pos", -+ board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, -+ board_info->btdm_ant_pos, -+ psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, -+ psd_scan->ant_det_result); -+ CL_PRINTF(cli_buf); -+ -+ if (board_info->btdm_ant_det_finish) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "Ant Det PSD Value", -+ psd_scan->ant_det_peak_val); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", -+ "Version Coex/ Fw/ Patch/ Cut", -+ glcoex_ver_date_8723b_1ant, glcoex_ver_8723b_1ant, fw_ver, -+ bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", -+ "WifibHiPri/ Ccklock/ CckEverLock", -+ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), -+ (coex_sta->cck_lock ? "Yes" : "No"), -+ (coex_sta->cck_ever_lock ? "Yes" : "No")); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "BT Abnormal scan", -+ (coex_sta->bt_abnormal_scan) ? "Yes" : "No"); -+ CL_PRINTF(cli_buf); -+ -+ pop_report_in_10s++; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt/ popCnt]", -+ ((coex_sta->bt_disabled)? ("disabled"): (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") -+ : ((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi, coex_sta->bt_retry_cnt, -+ coex_sta->pop_event_cnt); -+ CL_PRINTF(cli_buf); -+ -+ if (pop_report_in_10s >= 5) { -+ coex_sta->pop_event_cnt = 0; -+ pop_report_in_10s = 0; -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d / %d / %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP/NameReq/WHQL", -+ bt_link_info->sco_exist, bt_link_info->hid_exist, -+ bt_link_info->pan_exist, bt_link_info->a2dp_exist, -+ coex_sta->c2h_bt_remote_name_req, -+ coex_sta->bt_whck_test); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "BT Role", -+ (bt_link_info->slave_role) ? "Slave" : "Master"); -+ CL_PRINTF(cli_buf); -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d", -+ "A2DP Rate/Bitpool", -+ (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool); -+ CL_PRINTF(cli_buf); -+ -+ for (i = 0; i < BT_INFO_SRC_8723B_1ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8723b_1ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ -+ if(btcoexist->manual_control) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms] (before Manual)============"); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "SM[LowPenaltyRA]", -+ coex_dm->cur_low_penalty_ra); -+ CL_PRINTF(cli_buf); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ if (board_info->btdm_ant_num_by_ant_det == 2) { -+ if (coex_dm->cur_ps_tdma_on) -+ ps_tdma_case = ps_tdma_case + -+ 100; /* for WiFi RSSI low or BT RSSI low */ -+ else -+ ps_tdma_case = -+ 1; /* always translate to TDMA(off,1) for TDMA-off case */ -+ } -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), -+ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); -+ -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Coex Table Type", -+ coex_sta->coex_table_type); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "IgnWlanAct", -+ coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ -+ /* -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)", -+ coex_dm->error_condition); -+ CL_PRINTF(cli_buf); -+ */ -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "backup ARFR1/ARFR2/RL/AMaxTime", -+ coex_dm->backup_arfr_cnt1, coex_dm->backup_arfr_cnt2, -+ coex_dm->backup_retry_limit, -+ coex_dm->backup_ampdu_max_time); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "0x430/0x434/0x42a/0x456", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x880); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x778/0x6cc/0x880[29:25]", -+ u8tmp[0], u32tmp[0], (u32tmp[1] & 0x3e000000) >> 25); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x764); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x76e); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x948/ 0x67[5] / 0x764 / 0x76e", -+ u32tmp[0], ((u8tmp[0] & 0x20) >> 5), (u32tmp[1] & 0xffff), -+ u8tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x92c); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x930); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x944); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", -+ u32tmp[0] & 0x3, u32tmp[1] & 0xff, u32tmp[2] & 0x3); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x39); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x38[11]/0x40/0x4c[24:23]/0x64[0]", -+ ((u8tmp[0] & 0x8) >> 3), u8tmp[1], -+ ((u32tmp[0] & 0x01800000) >> 23), u8tmp[2] & 0x1); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x550(bcn ctrl)/0x522", -+ u32tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x49c); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0xc50(dig)/0x49c(null-drop)", -+ u32tmp[0] & 0xff, u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); -+ u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); -+ -+ fa_ofdm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) -+ >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + -+ ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & -+ 0xffff) ; -+ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "OFDM-CCA/OFDM-FA/CCK-FA", -+ u32tmp[0] & 0xffff, fa_ofdm, fa_cck); -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_OK CCK/11g/11n/11n-Agg", -+ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, -+ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_Err CCK/11g/11n/11n-Agg", -+ coex_sta->crc_err_cck, coex_sta->crc_err_11g, -+ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(high-pri rx/tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(low-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+#if (BT_AUTO_REPORT_ONLY_8723B_1ANT == 1) -+ /* halbtc8723b1ant_monitor_bt_ctr(btcoexist); */ -+#endif -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void ex_halbtc8723b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if(btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, false, true); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723b1ant_init_hw_config(btcoexist, false, false); -+ halbtc8723b1ant_init_coex_dm(btcoexist); -+ halbtc8723b1ant_query_bt_info(btcoexist); -+ -+ coex_sta->under_ips = false; -+ } -+} -+ -+void ex_halbtc8723b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if(btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ } -+} -+ -+void ex_halbtc8723b1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected=false, bt_hs_on=false; -+ u32 wifi_link_status=0; -+ u32 num_of_wifi_link=0; -+ boolean bt_ctrl_agg_buf_size=false; -+ u8 agg_buf_size=5; -+ -+ u8 u8tmpa, u8tmpb; -+ u32 u32tmp; -+ -+ if(btcoexist->manual_control || -+ btcoexist->stop_coex_dm ) -+ return; -+ -+ if (BTC_SCAN_START == type) { -+ coex_sta->wifi_is_high_pri_task = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ psd_scan->ant_det_is_ant_det_available = true; -+ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, -+ 8); /* Force antenna setup for no scan result issue */ -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ FORCE_EXEC, false, false); -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); -+ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", -+ u32tmp, u8tmpa, u8tmpb); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ } -+ -+ if(coex_sta->bt_disabled) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+&wifi_connected); -+ -+ halbtc8723b1ant_query_bt_info(btcoexist); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status>>16; -+ if (num_of_wifi_link >= 2) { -+ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8723b1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8723b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8723b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ if (BTC_SCAN_START == type) { -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8723b1ant_action_wifi_not_connected_scan( -+ btcoexist); -+ else /* wifi is connected */ -+ halbtc8723b1ant_action_wifi_connected_scan(btcoexist); -+ } else if (BTC_SCAN_FINISH == type) { -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8723b1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8723b1ant_action_wifi_connected(btcoexist); -+ } -+} -+ -+void ex_halbtc8723b1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected=false, bt_hs_on=false; -+ u32 wifi_link_status=0; -+ u32 num_of_wifi_link=0; -+ boolean bt_ctrl_agg_buf_size=false; -+ u8 agg_buf_size=5; -+ -+ if(btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled ) -+ return; -+ -+ if (BTC_ASSOCIATE_START == type) { -+ coex_sta->wifi_is_high_pri_task = true; -+ psd_scan->ant_det_is_ant_det_available = true; -+ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, -+ 8); /* Force antenna setup for no scan result issue */ -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ FORCE_EXEC, false, false); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->arp_cnt = 0; -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ /* coex_dm->arp_cnt = 0; */ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ if (num_of_wifi_link >= 2) { -+ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8723b1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8723b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8723b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ if (BTC_ASSOCIATE_START == type) -+ halbtc8723b1ant_action_wifi_not_connected_asso_auth(btcoexist); -+ else if (BTC_ASSOCIATE_FINISH == type) { -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8723b1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8723b1ant_action_wifi_connected(btcoexist); -+ } -+} -+ -+void ex_halbtc8723b1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] ={0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ boolean wifi_under_b_mode = false; -+ -+ if(btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled ) -+ return; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, -+ 8); /* Force antenna setup for no scan result issue */ -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ FORCE_EXEC, false, false); -+ psd_scan->ant_det_is_ant_det_available = true; -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ /* Set CCK Tx/Rx high Pri except 11b mode */ -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x00); /* CCK Rx */ -+ } else { -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x10); /* CCK Rx */ -+ } -+ -+ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, -+ 0x430); -+ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, -+ 0x434); -+ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( -+ btcoexist, 0x42a); -+ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( -+ btcoexist, 0x456); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->arp_cnt = 0; -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ -+ -+ coex_sta->cck_ever_lock = false; -+ } -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ /* h2c_parameter[0] = 0x1; */ -+ h2c_parameter[0] = 0x0; -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -+} -+ -+void ex_halbtc8723b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean bt_hs_on=false; -+ u32 wifi_link_status=0; -+ u32 num_of_wifi_link=0; -+ boolean bt_ctrl_agg_buf_size=false, under_4way=false; -+ u8 agg_buf_size=5; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if(btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled ) -+ return; -+ -+ if (BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ BTC_PACKET_ARP == type) { -+ if (BTC_PACKET_ARP == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ARP notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_dm->arp_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ARP Packet Count = %d\n", -+ coex_dm->arp_cnt); -+ BTC_TRACE(trace_buf); -+ -+ if ((coex_dm->arp_cnt >= 10) && -+ (!under_4way)) /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecificPacket(btcoexist) */ -+ coex_sta->wifi_is_high_pri_task = false; -+ else -+ coex_sta->wifi_is_high_pri_task = true; -+ } else { -+ coex_sta->wifi_is_high_pri_task = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet DHCP or EAPOL notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet [Type = %d] notify\n", type); -+ BTC_TRACE(trace_buf); -+ } -+ -+ coex_sta->specific_pkt_period_cnt = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ if (num_of_wifi_link >= 2) { -+ halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8723b1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8723b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8723b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ if (BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ ((BTC_PACKET_ARP == type) && (coex_sta->wifi_is_high_pri_task))) -+ halbtc8723b1ant_action_wifi_connected_specific_packet(btcoexist); -+} -+ -+void ex_halbtc8723b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source=0; -+ boolean wifi_connected=false; -+ boolean bt_busy=false; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ -+ rsp_source = tmp_buf[0]&0xf; -+ if(rsp_source >= BT_INFO_SRC_8723B_1ANT_MAX) -+ rsp_source = BT_INFO_SRC_8723B_1ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+"[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+length); -+ BTC_TRACE(trace_buf); -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ /* if 0xff, it means BT is under WHCK test */ -+ if (bt_info == 0xff) -+ coex_sta->bt_whck_test = true; -+ else -+ coex_sta->bt_whck_test = false; -+ -+ if (BT_INFO_SRC_8723B_1ANT_WIFI_FW != rsp_source) { -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2]&0xf; -+ -+ if (coex_sta->bt_retry_cnt >= 1) -+ coex_sta->pop_event_cnt++; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2]&0x20) -+ coex_sta->c2h_bt_remote_name_req = true; -+ else -+ coex_sta->c2h_bt_remote_name_req = false; -+ -+ coex_sta->bt_rssi = -+ coex_sta->bt_info_c2h[rsp_source][3]*2-90; -+ /* coex_sta->bt_info_c2h[rsp_source][3]*2+10; */ -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][1] == 0x49) { -+ coex_sta->a2dp_bit_pool = -+ coex_sta->bt_info_c2h[rsp_source][6]; -+ } else -+ coex_sta->a2dp_bit_pool = 0; -+ -+ coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] -+ & 0x40); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, -+ &coex_sta->bt_tx_rx_mask); -+ -+#if BT_8723B_1ANT_ANTDET_ENABLE -+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE -+ if ((board_info->btdm_ant_det_finish) && -+ (board_info->btdm_ant_num_by_ant_det == 2)) { -+ if (coex_sta->bt_tx_rx_mask) { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x1\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1 */ -+ btcoexist->btc_set_bt_reg(btcoexist, -+ BTC_BT_REG_RF, 0x2c, 0x7c45); -+ btcoexist->btc_set_bt_reg(btcoexist, -+ BTC_BT_REG_RF, 0x30, 0x7c45); -+ -+ btcoexist->btc_set_bt_reg(btcoexist, -+ BTC_BT_REG_RF, 0x3c, 0x1); -+ } -+ } else -+#endif -+#endif -+ -+ { -+ if (!coex_sta->bt_tx_rx_mask) { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, -+ 0x3c, 0x15); -+ -+ /* BT TRx Mask lock 0x2c[0], 0x30[0] = 0 */ -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, -+ 0x2c, 0x7c44); -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, -+ 0x30, 0x7c44); -+ } -+ } -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ if (coex_sta->bt_info_ext & BIT(1)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (wifi_connected) -+ ex_halbtc8723b1ant_media_status_notify( -+ btcoexist, BTC_MEDIA_CONNECT); -+ else -+ ex_halbtc8723b1ant_media_status_notify( -+ btcoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ if (coex_sta->bt_info_ext & BIT(3)) { -+ if(!btcoexist->manual_control && -+ !btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b1ant_ignore_wlan_act(btcoexist, -+ FORCE_EXEC, false); -+ } -+ } else { -+ /* BT already NOT ignore Wlan active, do nothing here. */ -+ } -+#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 0) -+ if ((coex_sta->bt_info_ext & BIT(4))) { -+ /* BT auto report already enabled, do nothing */ -+ } else -+ halbtc8723b1ant_bt_auto_report(btcoexist, FORCE_EXEC, -+ true); -+#endif -+ } -+ -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (bt_info & BT_INFO_8723B_1ANT_B_INQ_PAGE) -+ coex_sta->c2h_bt_inquiry_page = true; -+ else -+ coex_sta->c2h_bt_inquiry_page = false; -+ -+ coex_sta->num_of_profile = 0; -+ -+ /* set link exist status */ -+ if (!(bt_info & BT_INFO_8723B_1ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ -+ coex_sta->bt_hi_pri_link_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (bt_info & BT_INFO_8723B_1ANT_B_FTP) { -+ coex_sta->pan_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->pan_exist = false; -+ if (bt_info & BT_INFO_8723B_1ANT_B_A2DP) { -+ coex_sta->a2dp_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->a2dp_exist = false; -+ if (bt_info & BT_INFO_8723B_1ANT_B_HID) { -+ coex_sta->hid_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->hid_exist = false; -+ if (bt_info & BT_INFO_8723B_1ANT_B_SCO_ESCO) { -+ coex_sta->sco_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->sco_exist = false; -+ -+ if ((coex_sta->hid_exist == false) && -+ (coex_sta->c2h_bt_inquiry_page == false) && -+ (coex_sta->sco_exist == false)) { -+ if (coex_sta->high_priority_tx + -+ coex_sta->high_priority_rx >= 160) { -+ coex_sta->hid_exist = true; -+ coex_sta->wrong_profile_notification++; -+ coex_sta->num_of_profile++; -+ bt_info = bt_info | 0x28; -+ } -+ } -+ -+ /* Add Hi-Pri Tx/Rx counter to avoid false detection */ -+ if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && -+ (coex_sta->high_priority_tx + -+ coex_sta->high_priority_rx >= 160) -+ && (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->bt_hi_pri_link_exist = true; -+ -+ if ((bt_info & BT_INFO_8723B_1ANT_B_ACL_BUSY) && -+ (coex_sta->num_of_profile == 0)) { -+ if (coex_sta->low_priority_tx + -+ coex_sta->low_priority_rx >= 160) { -+ coex_sta->pan_exist = true; -+ coex_sta->num_of_profile++; -+ coex_sta->wrong_profile_notification++; -+ bt_info = bt_info | 0x88; -+ } -+ } -+ } -+ -+ halbtc8723b1ant_update_bt_link_info(btcoexist); -+ -+ bt_info = bt_info & -+ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ -+ -+ if (!(bt_info & BT_INFO_8723B_1ANT_B_CONNECTION)) -+ coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ else if (bt_info == -+ BT_INFO_8723B_1ANT_B_CONNECTION) /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE; -+ else if ((bt_info & BT_INFO_8723B_1ANT_B_SCO_ESCO) || -+ (bt_info & BT_INFO_8723B_1ANT_B_SCO_BUSY)) -+ coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_SCO_BUSY; -+ else if (bt_info & BT_INFO_8723B_1ANT_B_ACL_BUSY) { -+ if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) -+ coex_dm->auto_tdma_adjust = false; -+ coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_ACL_BUSY; -+ } else -+ coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_MAX; -+ -+ if( (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status) ) -+ bt_busy = true; -+ else -+ bt_busy = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ halbtc8723b1ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8723b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u32 u32tmp; -+ u8 u8tmpa,u8tmpb, u8tmpc; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_RF_ON == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->stop_coex_dm = false; -+ } else if (BTC_RF_OFF == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+0x0, 0x0); -+ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+FORCE_EXEC, false, true); -+ -+ halbtc8723b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ btcoexist->stop_coex_dm = true; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); -+ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ u8tmpc = btcoexist->btc_read_1byte(btcoexist, 0x76e); -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x, 0x76e=0x%x\n", -+ u32tmp, u8tmpa, u8tmpb, u8tmpc); -+ BTC_TRACE(trace_buf); -+ -+ } -+} -+ -+void ex_halbtc8723b1ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, -+ false, true); -+ -+ halbtc8723b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ -+ ex_halbtc8723b1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+ -+ btcoexist->stop_coex_dm = true; -+} -+ -+void ex_halbtc8723b1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ if (BTC_WIFI_PNP_SLEEP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, false, true); -+ halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ -+ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ -+ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ -+ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ -+ coex_sta->under_ips = false; -+ coex_sta->under_lps = false; -+ btcoexist->stop_coex_dm = true; -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->stop_coex_dm = false; -+ halbtc8723b1ant_init_hw_config(btcoexist, false, false); -+ halbtc8723b1ant_init_coex_dm(btcoexist); -+ halbtc8723b1ant_query_bt_info(btcoexist); -+ } -+} -+ -+void ex_halbtc8723b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) -+{ -+ -+ halbtc8723b1ant_init_hw_config(btcoexist, false, false); -+ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ -+ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); */ -+ halbtc8723b1ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8723b1ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ==========================Periodical===========================\n"); -+ BTC_TRACE(trace_buf); -+ -+#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 0) -+ halbtc8723b1ant_query_bt_info(btcoexist); -+ halbtc8723b1ant_monitor_bt_enable_disable(btcoexist); -+#else -+ halbtc8723b1ant_monitor_bt_ctr(btcoexist); -+ halbtc8723b1ant_monitor_wifi_ctr(btcoexist); -+#if BT_8723B_1ANT_ANTDET_ENABLE -+ halbtc8723b1ant_monitor_bt_enable_disable(btcoexist); -+#endif -+ -+ if ((coex_sta->high_priority_tx + coex_sta->high_priority_rx < 50) && -+ (bt_link_info->hid_exist == true)) -+ bt_link_info->hid_exist = false; -+ -+ if( halbtc8723b1ant_is_wifi_status_changed(btcoexist) || -+ coex_dm->auto_tdma_adjust ) -+ halbtc8723b1ant_run_coexist_mechanism(btcoexist); -+ -+ coex_sta->specific_pkt_period_cnt++; -+ -+ /* sample to set bt to execute Ant detection */ -+ /* btcoexist->btc_set_bt_ant_detection(btcoexist, 20, 14); -+ * -+ if (psd_scan->is_ant_det_enable) -+ { -+ if (psd_scan->psd_gen_count > psd_scan->realseconds) -+ psd_scan->psd_gen_count = 0; -+ -+ halbtc8723b1ant_antenna_detection(btcoexist, psd_scan->realcent_freq, psd_scan->realoffset, psd_scan->realspan, psd_scan->realseconds); -+ psd_scan->psd_gen_total_count +=2; -+ psd_scan->psd_gen_count += 2; -+ } -+ */ -+#endif -+} -+ -+void ex_halbtc8723b1ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+#if BT_8723B_1ANT_ANTDET_ENABLE -+ static u32 ant_det_count = 0, ant_det_fail_count = 0; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ /*boolean scan, roam;*/ -+ -+ if (seconds == 0) { -+ psd_scan->ant_det_try_count = 0; -+ psd_scan->ant_det_fail_count = 0; -+ ant_det_count = 0; -+ ant_det_fail_count = 0; -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ return; -+ } -+ -+ if (!board_info->btdm_ant_det_finish) { -+ psd_scan->ant_det_inteval_count = -+ psd_scan->ant_det_inteval_count + 2; -+ -+ if (psd_scan->ant_det_inteval_count >= -+ BT_8723B_1ANT_ANTDET_RETRY_INTERVAL) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b1ant_psd_antenna_detection_check(btcoexist); -+ -+ if (board_info->btdm_ant_det_finish) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); -+ BTC_TRACE(trace_buf); -+#if 1 -+ if (board_info->btdm_ant_num_by_ant_det == 2) -+ halbtc8723b1ant_mechanism_switch( -+ btcoexist, true); -+ else -+ halbtc8723b1ant_mechanism_switch( -+ btcoexist, false); -+#endif -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ psd_scan->ant_det_inteval_count = 0; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", -+ psd_scan->ant_det_inteval_count); -+ BTC_TRACE(trace_buf); -+ } -+ -+ } -+#endif -+ -+ -+/* -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ -+ psd_scan->ant_det_bt_tx_time = seconds; -+ psd_scan->ant_det_bt_le_channel = cent_freq; -+ -+ if (seconds == 0) -+ { -+ psd_scan->ant_det_try_count = 0; -+ psd_scan->ant_det_fail_count = 0; -+ ant_det_count = 0; -+ ant_det_fail_count = 0; -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ return; -+ } -+ else -+ { -+ ant_det_count++; -+ -+ psd_scan->ant_det_try_count = ant_det_count; -+ -+ if (scan ||roam) -+ { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 6; -+ } -+ else if (coex_sta->num_of_profile >= 1) -+ { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 7; -+ } -+ else if (!psd_scan->ant_det_is_ant_det_available) -+ { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 9; -+ } -+ else if (coex_sta->c2h_bt_inquiry_page) -+ { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 10; -+ } -+ else -+ { -+ -+ } -+ -+ if (!board_info->btdm_ant_det_finish) -+ ant_det_fail_count++; -+ -+ psd_scan->ant_det_fail_count = ant_det_fail_count; -+ } -+*/ -+} -+ -+ -+void ex_halbtc8723b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) -+{ -+#if BT_8723B_1ANT_ANTDET_ENABLE -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ if (psd_scan->ant_det_try_count != 0) { -+ halbtc8723b1ant_psd_show_antenna_detect_result(btcoexist); -+ -+ if (board_info->btdm_ant_det_finish) -+ halbtc8723b1ant_psd_showdata(btcoexist); -+ return; -+ } -+#endif -+ -+ /* halbtc8723b1ant_show_psd_data(btcoexist); */ -+} -+ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b1Ant.h 2018-02-11 21:44:27.146146071 +0200 -@@ -0,0 +1,288 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8723B_SUPPORT == 1) -+/* ******************************************* -+ * The following is for 8723B 1ANT BT Co-exist definition -+ * ******************************************* */ -+#define BT_AUTO_REPORT_ONLY_8723B_1ANT 1 -+ -+#define BT_INFO_8723B_1ANT_B_FTP BIT(7) -+#define BT_INFO_8723B_1ANT_B_A2DP BIT(6) -+#define BT_INFO_8723B_1ANT_B_HID BIT(5) -+#define BT_INFO_8723B_1ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8723B_1ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8723B_1ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8723B_1ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8723B_1ANT_B_CONNECTION BIT(0) -+ -+#define BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT(0))) ? true : false) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT 2 -+ -+#define BT_8723B_1ANT_WIFI_NOISY_THRESH 50 /* 30 //max: 255 */ -+ -+/* for Antenna detection */ -+#define BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 -+#define BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -+#define BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 -+#define BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT 32 -+#define BT_8723B_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -+#define BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY 40000 -+#define BT_8723B_1ANT_ANTDET_ENABLE 1 -+#define BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 1 -+#define BT_8723B_1ANT_ANTDET_BTTXTIME 100 -+#define BT_8723B_1ANT_ANTDET_BTTXCHANNEL 39 -+ -+enum bt_info_src_8723b_1ant { -+ BT_INFO_SRC_8723B_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8723B_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8723B_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8723B_1ANT_MAX -+}; -+ -+enum bt_8723b_1ant_bt_status { -+ BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8723B_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8723B_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8723B_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8723B_1ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8723b_1ant_wifi_status { -+ BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8723B_1ANT_WIFI_STATUS_MAX -+}; -+ -+enum bt_8723b_1ant_coex_algo { -+ BT_8723B_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8723B_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8723B_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8723B_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8723B_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8723B_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8723B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8723B_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8723B_1ANT_COEX_ALGO_MAX = 0xb, -+}; -+ -+struct coex_dm_8723b_1ant { -+ /* hw setting */ -+ u8 pre_ant_pos_type; -+ u8 cur_ant_pos_type; -+ /* fw mechanism */ -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean auto_tdma_adjust; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ /* sw mechanism */ -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ -+ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ -+ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ -+ u16 backup_retry_limit; -+ u8 backup_ampdu_max_time; -+ -+ /* algorithm related */ -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ u32 pre_ra_mask; -+ u32 cur_ra_mask; -+ u8 pre_arfr_type; -+ u8 cur_arfr_type; -+ u8 pre_retry_limit_type; -+ u8 cur_retry_limit_type; -+ u8 pre_ampdu_time_type; -+ u8 cur_ampdu_time_type; -+ u32 arp_cnt; -+ -+ u8 error_condition; -+}; -+ -+struct coex_sta_8723b_1ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ boolean bt_hi_pri_link_exist; -+ u8 num_of_profile; -+ boolean bt_abnormal_scan; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 specific_pkt_period_cnt; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ s8 bt_rssi; -+ boolean bt_tx_rx_mask; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8723B_1ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8723B_1ANT_MAX]; -+ boolean bt_whck_test; -+ boolean c2h_bt_inquiry_page; -+ boolean c2h_bt_remote_name_req; -+ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ u32 pop_event_cnt; -+ u8 scan_ap_num; -+ -+ u32 crc_ok_cck; -+ u32 crc_ok_11g; -+ u32 crc_ok_11n; -+ u32 crc_ok_11n_agg; -+ -+ u32 crc_err_cck; -+ u32 crc_err_11g; -+ u32 crc_err_11n; -+ u32 crc_err_11n_agg; -+ -+ boolean cck_lock; -+ boolean pre_ccklock; -+ boolean cck_ever_lock; -+ u8 coex_table_type; -+ -+ boolean force_lps_on; -+ u32 wrong_profile_notification; -+ -+ u8 a2dp_bit_pool; -+ u8 cut_version; -+}; -+ -+#define BT_8723B_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -+#define BT_8723B_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -+#define BT_8723B_1ANT_ANTDET_BUF_LEN 16 -+ -+struct psdscan_sta_8723b_1ant { -+ -+ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ -+ u32 ant_det_bt_tx_time; -+ u32 ant_det_pre_psdscan_peak_val; -+ boolean ant_det_is_ant_det_available; -+ u32 ant_det_psd_scan_peak_val; -+ boolean ant_det_is_btreply_available; -+ u32 ant_det_psd_scan_peak_freq; -+ -+ u8 ant_det_result; -+ u8 ant_det_peak_val[BT_8723B_1ANT_ANTDET_BUF_LEN]; -+ u8 ant_det_peak_freq[BT_8723B_1ANT_ANTDET_BUF_LEN]; -+ u32 ant_det_try_count; -+ u32 ant_det_fail_count; -+ u32 ant_det_inteval_count; -+ u32 ant_det_thres_offset; -+ -+ u32 real_cent_freq; -+ s32 real_offset; -+ u32 real_span; -+ -+ u32 psd_band_width; /* unit: Hz */ -+ u32 psd_point; /* 128/256/512/1024 */ -+ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_start_point; -+ u32 psd_stop_point; -+ u32 psd_max_value_point; -+ u32 psd_max_value; -+ u32 psd_start_base; -+ u32 psd_avg_num; /* 1/8/16/32 */ -+ u32 psd_gen_count; -+ boolean is_psd_running; -+ boolean is_psd_show_max_only; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8723b1ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723b1ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b1ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8723b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b1ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723b1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8723b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723b1ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723b1ant_display_coex_info(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723b1ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+ -+void ex_halbtc8723b1ant_display_ant_detection(IN struct btc_coexist *btcoexist); -+ -+#else -+#define ex_halbtc8723b1ant_power_on_setting(btcoexist) -+#define ex_halbtc8723b1ant_pre_load_firmware(btcoexist) -+#define ex_halbtc8723b1ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8723b1ant_init_coex_dm(btcoexist) -+#define ex_halbtc8723b1ant_ips_notify(btcoexist, type) -+#define ex_halbtc8723b1ant_lps_notify(btcoexist, type) -+#define ex_halbtc8723b1ant_scan_notify(btcoexist, type) -+#define ex_halbtc8723b1ant_connect_notify(btcoexist, type) -+#define ex_halbtc8723b1ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8723b1ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8723b1ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8723b1ant_rf_status_notify(btcoexist, type) -+#define ex_halbtc8723b1ant_halt_notify(btcoexist) -+#define ex_halbtc8723b1ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8723b1ant_coex_dm_reset(btcoexist) -+#define ex_halbtc8723b1ant_periodical(btcoexist) -+#define ex_halbtc8723b1ant_display_coex_info(btcoexist) -+#define ex_halbtc8723b1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8723b1ant_display_ant_detection(btcoexist) -+ -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.c 2018-02-11 21:44:27.146146071 +0200 -@@ -0,0 +1,4920 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8723B Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8723B_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8723b_2ant glcoex_dm_8723b_2ant; -+static struct coex_dm_8723b_2ant *coex_dm = &glcoex_dm_8723b_2ant; -+static struct coex_sta_8723b_2ant glcoex_sta_8723b_2ant; -+static struct coex_sta_8723b_2ant *coex_sta = &glcoex_sta_8723b_2ant; -+ -+const char *const glbt_info_src_8723b_2ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8723b_2ant = 20151223; -+u32 glcoex_ver_8723b_2ant = 0x4a; -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8723b2ant_ -+ * ************************************************************ */ -+u8 halbtc8723b2ant_bt_rssi_state(u8 *ppre_bt_rssi_state, u8 level_num, -+ u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = *ppre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return *ppre_bt_rssi_state; -+ } -+ -+ if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || -+ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ *ppre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8723b2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 *pprewifi_rssi_state, IN u8 level_num, IN u8 rssi_thresh, -+ IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = *pprewifi_rssi_state; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || -+ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return *pprewifi_rssi_state; -+ } -+ -+ if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || -+ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((*pprewifi_rssi_state == BTC_RSSI_STATE_MEDIUM) || -+ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ *pprewifi_rssi_state = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8723b2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ -+ /* This function check if bt is disabled */ -+ -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ } else { -+ bt_disable_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt all counters=0, %d times!!\n", -+ bt_disable_cnt); -+ BTC_TRACE(trace_buf); -+ if (bt_disable_cnt >= 2) -+ bt_disabled = true; -+ } -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->bt_disabled = bt_disabled; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ if (bt_disabled) { -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ } -+ } -+} -+ -+ -+void halbtc8723b2ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+} -+ -+void halbtc8723b2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ if ((coex_sta->low_priority_tx > 1050) && -+ (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->pop_event_cnt++; -+ -+ if ((coex_sta->low_priority_rx >= 950) && -+ (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) && -+ (!coex_sta->under_ips)) -+ bt_link_info->slave_role = true; -+ else -+ bt_link_info->slave_role = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); -+ BTC_TRACE(trace_buf); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); -+ BTC_TRACE(trace_buf); -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+} -+ -+void halbtc8723b2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -+{ -+ -+ -+ if (coex_sta->under_ips) { -+ coex_sta->crc_ok_cck = 0; -+ coex_sta->crc_ok_11g = 0; -+ coex_sta->crc_ok_11n = 0; -+ coex_sta->crc_ok_11n_agg = 0; -+ -+ coex_sta->crc_err_cck = 0; -+ coex_sta->crc_err_11g = 0; -+ coex_sta->crc_err_11n = 0; -+ coex_sta->crc_err_11n_agg = 0; -+ } else { -+ coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, -+ 0xf88); -+ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf94); -+ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf90); -+ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xfb8); -+ -+ coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, -+ 0xf84); -+ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf96); -+ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf92); -+ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xfba); -+ } -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); -+} -+ -+void halbtc8723b2ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ coex_sta->c2h_bt_info_req_sent = true; -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+} -+ -+boolean halbtc8723b2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false; -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ -+ if ((BTC_RSSI_STATE_HIGH == wifi_rssi_state) || -+ (BTC_RSSI_STATE_LOW == wifi_rssi_state)) -+ return true; -+ -+ } -+ -+ return false; -+} -+ -+void halbtc8723b2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+} -+ -+u8 halbtc8723b2ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8723B_2ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+void halbtc8723b2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, -+ IN u8 dac_swing_lvl) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ /* There are several type of dacswing */ -+ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ -+ h2c_parameter[0] = dac_swing_lvl; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); -+} -+ -+void halbtc8723b2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN u8 dec_bt_pwr_lvl) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = dec_bt_pwr_lvl; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); -+} -+ -+void halbtc8723b2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 dec_bt_pwr_lvl) -+{ -+ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) -+ return; -+ } -+ halbtc8723b2ant_set_fw_dec_bt_pwr(btcoexist, -+ coex_dm->cur_bt_dec_pwr_lvl); -+ -+ coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; -+} -+ -+void halbtc8723b2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8723b2ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8723b2ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8723b2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 fw_dac_swing_lvl) -+{ -+ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_fw_dac_swing_lvl == -+ coex_dm->cur_fw_dac_swing_lvl) -+ return; -+ } -+ -+ halbtc8723b2ant_set_fw_dac_swing_level(btcoexist, -+ coex_dm->cur_fw_dac_swing_lvl); -+ -+ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; -+} -+ -+void halbtc8723b2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist *btcoexist, -+ IN boolean rx_rf_shrink_on) -+{ -+ if (rx_rf_shrink_on) { -+ /* Shrink RF Rx LPF corner */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Shrink RF Rx LPF corner!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, -+ 0xffffc); -+ } else { -+ /* Resume RF Rx LPF corner */ -+ /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ -+ if (btcoexist->initilized) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Resume RF Rx LPF corner!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, -+ 0xfffff, coex_dm->bt_rf_0x1e_backup); -+ } -+ } -+} -+ -+void halbtc8723b2ant_rf_shrink(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rx_rf_shrink_on) -+{ -+ coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_rf_rx_lpf_shrink == -+ coex_dm->cur_rf_rx_lpf_shrink) -+ return; -+ } -+ halbtc8723b2ant_set_sw_rf_rx_lpf_corner(btcoexist, -+ coex_dm->cur_rf_rx_lpf_shrink); -+ -+ coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; -+} -+ -+void halbtc8723b2ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf4; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xf5; /* MCS6 or OFDM48 */ -+ h2c_parameter[5] = 0xf6; /* MCS5 or OFDM36 */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+} -+ -+void halbtc8723b2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8723b2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8723b2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, -+ IN u32 level) -+{ -+ u8 val = (u8)level; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Write SwDacSwing = 0x%x\n", level); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x883, 0x3e, val); -+} -+ -+void halbtc8723b2ant_set_sw_full_time_dac_swing(IN struct btc_coexist -+ *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) -+{ -+ if (sw_dac_swing_on) -+ halbtc8723b2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); -+ else -+ halbtc8723b2ant_set_dac_swing_reg(btcoexist, 0x18); -+} -+ -+ -+void halbtc8723b2ant_dac_swing(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) -+{ -+ coex_dm->cur_dac_swing_on = dac_swing_on; -+ coex_dm->cur_dac_swing_lvl = dac_swing_lvl; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && -+ (coex_dm->pre_dac_swing_lvl == -+ coex_dm->cur_dac_swing_lvl)) -+ return; -+ } -+ delay_ms(30); -+ halbtc8723b2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, -+ dac_swing_lvl); -+ -+ coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; -+ coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; -+} -+ -+void halbtc8723b2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, -+ IN boolean adc_back_off) -+{ -+ if (adc_back_off) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB BackOff Level On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc05, 0x30, 0x3); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB BackOff Level Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc05, 0x30, 0x1); -+ } -+} -+ -+void halbtc8723b2ant_adc_back_off(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean adc_back_off) -+{ -+ coex_dm->cur_adc_back_off = adc_back_off; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) -+ return; -+ } -+ halbtc8723b2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); -+ -+ coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; -+} -+ -+void halbtc8723b2ant_set_agc_table(IN struct btc_coexist *btcoexist, -+ IN boolean agc_table_en) -+{ -+ u8 rssi_adjust_val = 0; -+ -+ /* =================BB AGC Gain Table */ -+ if (agc_table_en) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB Agc Table On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6e1A0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6d1B0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6c1C0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6b1D0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6a1E0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x691F0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x68200001); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB Agc Table Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xaa1A0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa91B0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa81C0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa71D0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa61E0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa51F0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa4200001); -+ } -+ -+ -+ /* =================RF Gain */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); -+ if (agc_table_en) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Agc Table On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x38fff); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x38ffe); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Agc Table Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x380c3); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x28ce6); -+ } -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xed, 0xfffff, 0x1); -+ if (agc_table_en) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Agc Table On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, -+ 0x38fff); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, -+ 0x38ffe); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Agc Table Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, -+ 0x380c3); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, -+ 0x28ce6); -+ } -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xed, 0xfffff, 0x0); -+ -+ /* set rssi_adjust_val for wifi module. */ -+ if (agc_table_en) -+ rssi_adjust_val = 8; -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, -+ &rssi_adjust_val); -+} -+ -+void halbtc8723b2ant_agc_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean agc_table_en) -+{ -+ coex_dm->cur_agc_table_en = agc_table_en; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) -+ return; -+ } -+ halbtc8723b2ant_set_agc_table(btcoexist, agc_table_en); -+ -+ coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; -+} -+ -+void halbtc8723b2ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8723b2ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8723b2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8723b2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_sta->coex_table_type = type; -+ -+ switch (type) { -+ case 0: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5afa5afa, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x5ada5ada, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0xffffffff, 0xffffffff, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0x5fff5fff, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x55ff55ff, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 8: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 9: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 10: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 11: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 12: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 13: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 14: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 15: -+ halbtc8723b2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8723b2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8723b2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8723b2ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8723b2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8723b2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8723b2ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8723b2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ -+ -+ if ((coex_sta->a2dp_exist) && (coex_sta->hid_exist)) -+ byte5 = byte5 | 0x1; -+ -+ h2c_parameter[0] = byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = byte5; -+ -+ coex_dm->ps_tdma_para[0] = byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+void halbtc8723b2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, -+ IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, -+ IN boolean limited_dig, IN boolean bt_lna_constrain) -+{ -+ /* -+ u32 wifi_bw; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if(BTC_WIFI_BW_HT40 != wifi_bw) -+ { -+ if (shrink_rx_lpf) -+ shrink_rx_lpf = false; -+ } -+ */ -+ -+ /* halbtc8723b2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); */ -+ halbtc8723b2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -+} -+ -+void halbtc8723b2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, -+ IN boolean agc_table_shift, IN boolean adc_back_off, -+ IN boolean sw_dac_swing, IN u32 dac_swing_lvl) -+{ -+ /* halbtc8723b2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ -+ /* halbtc8723b2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ -+ /* halbtc8723b2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, dac_swing_lvl); */ -+} -+ -+void halbtc8723b2ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ PADAPTER pAdapter = btcoexist->Adapter; -+ u32 fw_ver = 0, u32tmp = 0, cnt_bt_cal_chk = 0; -+ boolean pg_ext_switch = false; -+ boolean use_ext_switch = false; -+ u8 h2c_parameter[2] = {0}; -+ u32 u32tmp_1[4]; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_EXT_SWITCH, &pg_ext_switch); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, -+ &fw_ver); /* [31:16]=fw ver, [15:0]=fw sub ver */ -+ -+ if ((fw_ver > 0 && fw_ver < 0xc0000) || pg_ext_switch) -+ use_ext_switch = true; -+ -+ if (init_hwcfg) { -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x39, 0x8, 0x1); -+ btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x944, 0x3, 0x3); -+ btcoexist->btc_write_1byte(btcoexist, 0x930, 0x77); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, 0x1); -+ -+ if (fw_ver >= 0x180000) { -+ /* Use H2C to set GNT_BT to High to avoid A2DP click */ -+ h2c_parameter[0] = 1; -+ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, -+ h2c_parameter); -+ -+ cnt_bt_cal_chk = 0; -+ while(1) -+ { -+ if( pAdapter->bFWReady == FALSE ) -+ { -+ //RT_TRACE(COMP_INIT , DBG_LOUD, ("halbtc8723b2ant_SetAntPath(): we don't need to wait for H2C command completion because of Fw download fail!!!\n")); -+ break; -+ } -+ -+ if( btcoexist->btc_read_1byte(btcoexist, 0x765) == 0x18 ) -+ break; -+ -+ cnt_bt_cal_chk++; -+ if( cnt_bt_cal_chk > 20 ) -+ break; -+ } -+ } else -+ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); -+ u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ if( (u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) -+ btcoexist->btc_write_4byte(btcoexist, 0x948, u32tmp_1[0]); -+ else -+ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, -+ 0x0); /* WiFi TRx Mask off */ -+ /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ -+ /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x01); //BT TRx Mask off */ -+ -+ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { -+ /* tell firmware "no antenna inverse" */ -+ h2c_parameter[0] = 0; -+ } else { -+ /* tell firmware "antenna inverse" */ -+ h2c_parameter[0] = 1; -+ } -+ -+ if (use_ext_switch) { -+ /* ext switch type */ -+ h2c_parameter[1] = 1; -+ } else { -+ /* int switch type */ -+ h2c_parameter[1] = 0; -+ } -+ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, h2c_parameter); -+ } else { -+ if (fw_ver >= 0x180000) { -+ /* Use H2C to set GNT_BT to "Control by PTA"*/ -+ h2c_parameter[0] = 0; -+ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, -+ h2c_parameter); -+ -+ cnt_bt_cal_chk = 0; -+ while(1) -+ { -+ if( pAdapter->bFWReady == FALSE ) -+ { -+ //RT_TRACE(COMP_INIT , DBG_LOUD, ("halbtc8723b2ant_SetAntPath(): we don't need to wait for H2C command completion because of Fw download fail!!!\n")); -+ break; -+ } -+ -+ if( btcoexist->btc_read_1byte(btcoexist, 0x765) == 0x0 ) -+ break; -+ -+ cnt_bt_cal_chk++; -+ if( cnt_bt_cal_chk > 20 ) -+ break; -+ } -+ } else -+ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x0); -+ } -+ -+ /* ext switch setting */ -+ if (use_ext_switch) { -+ if (init_hwcfg) { -+ /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp &= ~BIT(23); -+ u32tmp |= BIT(24); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ } -+ u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ if( (u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) -+ btcoexist->btc_write_4byte(btcoexist, 0x948, u32tmp_1[0]); -+ else -+ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); -+ -+ switch (ant_pos_type) { -+ case BTC_ANT_WIFI_AT_MAIN: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, -+ 0x92c, 0x3, -+ 0x1); /* ext switch main at wifi */ -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, -+ 0x92c, 0x3, -+ 0x2); /* ext switch aux at wifi */ -+ break; -+ } -+ } else { /* internal switch */ -+ if (init_hwcfg) { -+ /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp |= BIT(23); -+ u32tmp &= ~BIT(24); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ } -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, -+ 0x0); /* fixed external switch S1->Main, S0->Aux */ -+ switch (ant_pos_type) { -+ case BTC_ANT_WIFI_AT_MAIN: -+ u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ if( (u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) -+ btcoexist->btc_write_4byte(btcoexist, 0x948, u32tmp_1[0]); -+ else -+ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ if( (u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) -+ btcoexist->btc_write_4byte(btcoexist, 0x948, u32tmp_1[0]); -+ else -+ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x280); -+ break; -+ } -+ } -+} -+#if 0 -+boolean halbtc8723b2ant_CoexSwitchThresCheck(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state1, bt_rssi_state; -+ u32 vendor; -+ u8 offset = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor); -+ -+ /* if (vendor == BTC_VENDOR_LENOVO) */ -+ /* offset = 20; */ -+ -+ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES -+ - coex_dm->switch_thres_offset, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ -+ if (BTC_RSSI_LOW(wifi_rssi_state1) || BTC_RSSI_LOW(bt_rssi_state)) -+ return true; -+ -+ return false; -+} -+#endif -+ -+void halbtc8723b2ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state1, bt_rssi_state; -+ s8 wifi_duration_adjust = 0x0; -+ u8 psTdmaByte4Modify = 0x0; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES -+ - coex_dm->switch_thres_offset, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s turn %s PS TDMA, type=%d\n", -+ (force_exec ? "force to" : ""), (turn_on ? "ON" : "OFF"), type); -+ BTC_TRACE(trace_buf); -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ if (!(BTC_RSSI_HIGH(wifi_rssi_state1) && -+ BTC_RSSI_HIGH(bt_rssi_state)) && turn_on) -+ /* if (halbtc8723b2ant_CoexSwitchThresCheck(btcoexist) && turn_on) */ -+ { -+ type = type + 100; /* for WiFi RSSI low or BT RSSI low */ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ } else -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ -+ if (coex_sta->scan_ap_num <= 5) { -+ if (coex_sta->a2dp_bit_pool >= 45) -+ wifi_duration_adjust = -15; -+ else if (coex_sta->a2dp_bit_pool >= 35) -+ wifi_duration_adjust = -10; -+ else -+ wifi_duration_adjust = 5; -+ } else if (coex_sta->scan_ap_num <= 20) { -+ if (coex_sta->a2dp_bit_pool >= 45) -+ wifi_duration_adjust = -15; -+ else if (coex_sta->a2dp_bit_pool >= 35) -+ wifi_duration_adjust = -10; -+ else -+ wifi_duration_adjust = 0; -+ } else if (coex_sta->scan_ap_num <= 40) { -+ if (coex_sta->a2dp_bit_pool >= 45) -+ wifi_duration_adjust = -15; -+ else if (coex_sta->a2dp_bit_pool >= 35) -+ wifi_duration_adjust = -10; -+ else -+ wifi_duration_adjust = -5; -+ } else { -+ if (coex_sta->a2dp_bit_pool >= 45) -+ wifi_duration_adjust = -15; -+ else if (coex_sta->a2dp_bit_pool >= 35) -+ wifi_duration_adjust = -10; -+ else -+ wifi_duration_adjust = -10; -+ } -+ -+ if ((bt_link_info->slave_role == true) && (bt_link_info->a2dp_exist)) -+ psTdmaByte4Modify = -+ 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+ -+ -+ if (turn_on) { -+ switch (type) { -+ case 1: -+ default: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c + wifi_duration_adjust, 0x03, 0xf1, -+ 0x90 | psTdmaByte4Modify); -+ break; -+ case 2: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x2d + wifi_duration_adjust, 0x03, 0xf1, -+ 0x90 | psTdmaByte4Modify); -+ break; -+ case 3: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0xf1, 0x90 | -+ psTdmaByte4Modify); -+ break; -+ case 4: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x10, 0x03, 0xf1, 0x90 | -+ psTdmaByte4Modify); -+ break; -+ case 5: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c + wifi_duration_adjust, 0x3, 0x70, -+ 0x90 | psTdmaByte4Modify); -+ break; -+ case 6: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x2d + wifi_duration_adjust, 0x3, 0x70, -+ 0x90 | psTdmaByte4Modify); -+ break; -+ case 7: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0x70, 0x90 | -+ psTdmaByte4Modify); -+ break; -+ case 8: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xa3, -+ 0x10, 0x3, 0x70, 0x90 | -+ psTdmaByte4Modify); -+ break; -+ case 9: -+ /* -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c + wifi_duration_adjust, 0x03, 0xf1, -+ 0x90 | psTdmaByte4Modify); -+ */ -+ /* Bryant Modify for BT no-profile busy case */ -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c + wifi_duration_adjust, 0x03, 0xf1, -+ 0x91); -+ -+ break; -+ case 10: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x2d + wifi_duration_adjust, 0x03, 0xf1, -+ 0x90 | psTdmaByte4Modify); -+ break; -+ case 11: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0xf1, 0x90 | -+ psTdmaByte4Modify); -+ break; -+ case 12: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x10, 0x3, 0xf1, 0x90 | -+ psTdmaByte4Modify); -+ break; -+ case 13: -+ /* -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c + wifi_duration_adjust, 0x3, 0x70, -+ 0x90 | psTdmaByte4Modify); -+ */ -+ /* Bryant Modify for BT no-profile busy case */ -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c + wifi_duration_adjust, 0x3, 0x70, -+ 0x91); -+ break; -+ case 14: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x2d + wifi_duration_adjust, 0x3, 0x70, -+ 0x90 | psTdmaByte4Modify); -+ break; -+ case 15: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0x70, 0x90 | -+ psTdmaByte4Modify); -+ break; -+ case 16: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x10, 0x3, 0x70, 0x90 | -+ psTdmaByte4Modify); -+ break; -+ case 17: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xa3, -+ 0x2f, 0x2f, 0x60, 0x90); -+ break; -+ case 18: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 19: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x25, 0xe1, 0x90); -+ break; -+ case 20: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x25, 0x60, 0x90); -+ break; -+ case 21: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x15, 0x03, 0x70, 0x90); -+ break; -+ case 22: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x35, 0x03, 0xf1, 0x90); -+ break; -+ case 23: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x35, 0x03, 0x71, 0x10); -+ break; -+ -+ case 33: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0xf1, 0x91); -+ -+ break; -+ case 71: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c + wifi_duration_adjust, 0x03, 0xf1, -+ 0x90); -+ break; -+ case 101: -+ case 105: -+ case 113: -+ case 171: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x3a + wifi_duration_adjust, 0x03, 0x70, -+ 0x50 | psTdmaByte4Modify); -+ break; -+ case 102: -+ case 106: -+ case 110: -+ case 114: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x2d + wifi_duration_adjust, 0x03, 0x70, -+ 0x50 | psTdmaByte4Modify); -+ break; -+ case 103: -+ case 107: -+ case 111: -+ case 115: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x1c, 0x03, 0x70, 0x50 | -+ psTdmaByte4Modify); -+ break; -+ case 104: -+ case 108: -+ case 112: -+ case 116: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x10, 0x03, 0x70, 0x50 | -+ psTdmaByte4Modify); -+ break; -+ case 109: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c, 0x03, 0xf1, 0x90 | -+ psTdmaByte4Modify); -+ break; -+ /* case 113: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c, 0x03, 0x70, 0x90 | -+ psTdmaByte4Modify); -+ break; */ -+ case 121: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x15, 0x03, 0x70, 0x90 | -+ psTdmaByte4Modify); -+ break; -+ case 122: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x35, 0x03, 0x71, 0x11); -+ break; -+ case 123: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x35, 0x03, 0x71, 0x10); -+ break; -+ case 133: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x1c, 0x3, 0x70, 0x51); -+ -+ break; -+ } -+ } else { -+ /* disable PS tdma */ -+ switch (type) { -+ case 0: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x40, 0x0); -+ break; -+ case 1: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x48, 0x0); -+ break; -+ default: -+ halbtc8723b2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x40, 0x0); -+ break; -+ } -+ } -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+void halbtc8723b2ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 1); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 1); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8723b2ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8723b2ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8723b2ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ coex_sta->force_lps_on = true; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8723b2ant_ps_tdma_check_for_power_save_state( -+ btcoexist, false); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+void halbtc8723b2ant_coex_all_off(IN struct btc_coexist *btcoexist) -+{ -+ /* fw all off */ -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ /* hw all off */ -+ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8723b2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8723b2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); -+ -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ coex_sta->pop_event_cnt = 0; -+ -+} -+ -+void halbtc8723b2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, -+ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ boolean wifi_connected = false; -+ boolean low_pwr_disable = true; -+ boolean scan = false, link = false, roam = false; -+ boolean wifi_busy = false; -+ -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, 15, 0); -+ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state1, 2, -+ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ if (coex_sta->bt_abnormal_scan) { -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 23); -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ } else if (scan || link || roam) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi link process + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 7); -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -+ } else if (wifi_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 7); -+ -+ if (wifi_busy) -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -+ else -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi no-link + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ } -+ -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ /* -+ coex_dm->need_recover0x948 = true; -+ coex_dm->backup0x948 = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ -+ halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_AUX, false, false); -+ */ -+} -+ -+ -+void halbtc8723b2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist) -+{ -+ u32 u32tmp; -+ u8 u8tmpa, u8tmpb; -+ -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 15); -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); -+ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x76e=0x%x\n", -+ u32tmp, u8tmpa, u8tmpb); -+ BTC_TRACE(trace_buf); -+} -+ -+boolean halbtc8723b2ant_action_wifi_idle_process(IN struct btc_coexist -+ *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, -+ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u8 ap_num = 0; -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, 15, 0); -+ /* wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES-coex_dm->switch_thres_offset-coex_dm->switch_thres_offset, 0); */ -+ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state1, 2, -+ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset - coex_dm->switch_thres_offset, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset - coex_dm->switch_thres_offset, 0); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); -+ -+ /* define the office environment */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && -+ (coex_sta->hid_exist == true) && -+ (coex_sta->a2dp_exist == true)) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi idle process for BT HID+A2DP exist!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723b2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x6); -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, -+ 0x18); -+ -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ -+ return true; -+ } else { -+ halbtc8723b2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x18); -+ return false; -+ } -+ -+ -+} -+ -+ -+ -+boolean halbtc8723b2ant_is_common_action(IN struct btc_coexist *btcoexist) -+{ -+ boolean common = false, wifi_connected = false, wifi_busy = false; -+ boolean bt_hs_on = false, low_pwr_disable = false; -+ boolean asus_8723b = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!wifi_connected) { -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non-connected idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, -+ 0x0); -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, -+ 0x18); -+ -+ common = true; -+ } else { -+ if (BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, -+ false, false, 0x8); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, -+ 0xfffff, 0x0); -+ halbtc8723b2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 1); -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 0xb); -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+ common = true; -+ } else if (BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ -+ if (bt_hs_on) -+ return false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, -+ false, false, 0x8); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, -+ 0xfffff, 0x0); -+ halbtc8723b2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 1); -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 0xb); -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+ common = true; -+ } else { -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ /* btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_IS_ASUS_8723B, &asus_8723b); -+ if (!asus_8723b) -+ common = false; -+ else -+ common = halbtc8723b2ant_action_wifi_idle_process( -+ btcoexist); */ -+ common = false; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ /* common = false; */ -+ common = halbtc8723b2ant_action_wifi_idle_process( -+ btcoexist); -+ } -+ } -+ } -+ -+ return common; -+} -+void halbtc8723b2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, -+ IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) -+{ -+ static s32 up, dn, m, n, wait_count; -+ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ -+ u8 retry_count = 0; -+ -+ if (!coex_dm->auto_tdma_adjust) { -+ coex_dm->auto_tdma_adjust = true; -+ { -+ if (sco_hid) { -+ if (tx_pause) { -+ if (max_interval == 1) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 13); -+ coex_dm->ps_tdma_du_adj_type = -+ 13; -+ } else if (max_interval == 2) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (max_interval == 3) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } -+ } else { -+ if (max_interval == 1) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = -+ 9; -+ } else if (max_interval == 2) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (max_interval == 3) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } -+ } -+ } else { -+ if (tx_pause) { -+ if (max_interval == 1) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 5); -+ coex_dm->ps_tdma_du_adj_type = -+ 5; -+ } else if (max_interval == 2) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (max_interval == 3) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } -+ } else { -+ if (max_interval == 1) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (max_interval == 2) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (max_interval == 3) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } -+ } -+ } -+ } -+ /* ============ */ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } else { -+ /* accquire the BT TRx retry count from BT_Info byte2 */ -+ retry_count = coex_sta->bt_retry_cnt; -+ -+ if ((coex_sta->low_priority_tx) > 1050 || -+ (coex_sta->low_priority_rx) > 1250) -+ retry_count++; -+ -+ result = 0; -+ wait_count++; -+ -+ if (retry_count == -+ 0) { /* no retry in the last 2-second duration */ -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ -+ wait_count = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ } -+ } else if (retry_count <= -+ 3) { /* <=3 retry in the last 2-second duration */ -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) {/* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ -+ if (wait_count <= 2) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ -+ if (wait_count == 1) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ -+ if (max_interval == 1) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 71) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 5); -+ coex_dm->ps_tdma_du_adj_type = 5; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 5); -+ coex_dm->ps_tdma_du_adj_type = 5; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 13); -+ coex_dm->ps_tdma_du_adj_type = 13; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 5); -+ coex_dm->ps_tdma_du_adj_type = -+ 5; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 13); -+ coex_dm->ps_tdma_du_adj_type = -+ 13; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 71); -+ coex_dm->ps_tdma_du_adj_type = 71; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 71) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 71); -+ coex_dm->ps_tdma_du_adj_type = -+ 71; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = -+ 9; -+ } -+ } -+ } -+ } else if (max_interval == 2) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } -+ } -+ } -+ } else if (max_interval == 3) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8723b2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8723b2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } -+ } -+ } -+ } -+ } -+ -+ /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ -+ /* then we have to adjust it back to the previous record one. */ -+ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { -+ boolean scan = false, link = false, roam = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", -+ coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (!scan && !link && !roam) -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ coex_dm->ps_tdma_du_adj_type); -+ else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+} -+ -+/* SCO only or SCO+PAN(HS) */ -+void halbtc8723b2ant_action_sco(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, 15, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 4); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for SCO quality at 11b/g mode */ -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ else /* for SCO quality & wifi performance balance at 11n mode */ -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); /* for voice quality */ -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ true, 0x4); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ true, 0x4); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ true, 0x4); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ true, 0x4); -+ } -+ } -+} -+ -+ -+void halbtc8723b2ant_action_hid(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, 15, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ else /* for HID quality & wifi performance balance at 11n mode */ -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 9); -+ -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); -+ else -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -+void halbtc8723b2ant_action_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, -+ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ u8 ap_num = 0; -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, 15, 0); -+ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state1, 2, -+ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); -+ -+ /* define the office environment */ -+ if ((ap_num >= 10) && BTC_RSSI_HIGH(wifi_rssi_state1) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ /* dbg_print(" AP#>10(%d)\n", ap_num); */ -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, -+ 0x0); -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ -+ /* sw mechanism */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ true, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ true, 0x18); -+ } -+ return; -+ -+ } -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ } else { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 13); -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, false, false, -+ 1); -+ else -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, false, true, 1); -+ -+ /* sw mechanism */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8723b2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, -+ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, 15, 0); -+ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state1, 2, -+ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ } else { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 13); -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, false, true, 2); -+ -+ /* sw mechanism */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8723b2ant_action_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, -+ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, 15, 0); -+ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state1, 2, -+ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 10); -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ } else { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 13); -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); -+ else -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ -+ /* sw mechanism */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+ -+/* PAN(HS) only */ -+void halbtc8723b2ant_action_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, -+ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, 15, 0); -+ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state1, 2, -+ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+/* PAN(EDR)+A2DP */ -+void halbtc8723b2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, -+ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u8 ap_num = 0; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, 15, 0); -+ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state1, 2, -+ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ else -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &ap_num); -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 12); -+ -+ if(ap_num < 10) -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 1); -+ else -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 3); -+ -+ } else { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 13); -+ if(ap_num < 10) -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 1); -+ else -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 3); -+ } -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8723b2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, -+ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, 15, 0); -+ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state1, 2, -+ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ } else { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 14); -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 3); -+ /* halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, -+ 0xfffff, 0x780); -+ } else { -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 6); -+ /* halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, -+ 0xfffff, 0x0); -+ } -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 2); -+ } else { -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ /* halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, -+ 0x0); -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 2); -+ } -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+/* HID+A2DP+PAN(EDR) */ -+void halbtc8723b2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, -+ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, 15, 0); -+ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state1, 2, -+ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ } else { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 14); -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, -+ true, 3); -+ else -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, -+ false, 3); -+ } else -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 3); -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8723b2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, -+ prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ u8 ap_num = 0; -+ -+ wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, 15, 0); -+ /* bt_rssi_state = halbtc8723b2ant_bt_rssi_state(2, 29, 0); */ -+ wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state1, 2, -+ BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 0); -+ bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 3, -+ BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - -+ coex_dm->switch_thres_offset, 37); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &ap_num); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x5); -+ -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) { -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ } else { -+ /* only 802.11N mode we have to dec bt power to 4 degree */ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) { -+ /* need to check ap Number of Not */ -+ if (ap_num < 10) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, -+ NORMAL_EXEC, 4); -+ else -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, -+ NORMAL_EXEC, 2); -+ } else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ } -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ } else { -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 14); -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ -+ if(BTC_RSSI_HIGH(bt_rssi_state)) { -+ if(ap_num < 10) -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 1); -+ else -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 3); -+ } else { -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 18); -+ btcoexist->btc_write_1byte(btcoexist, 0x456, 0x38); -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, 0x0808); -+ btcoexist->btc_write_4byte(btcoexist, 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, 0x434, 0x01010000); -+ -+ if(ap_num < 10) -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 1); -+ else -+ halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 3); -+ } -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8723b2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8723b2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ /* hw all off */ -+ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ -+ halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+} -+ -+void halbtc8723b2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ u8 algorithm = 0; -+ u32 num_of_wifi_link = 0; -+ u32 wifi_link_status = 0; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean miracast_plus_bt = false; -+ boolean scan = false, link = false, roam = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->bt_whck_test) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under WHCK TEST!!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_bt_whck_test(btcoexist); -+ return; -+ } -+ -+ algorithm = halbtc8723b2ant_action_algorithm(btcoexist); -+ if (coex_sta->c2h_bt_inquiry_page && -+ (BT_8723B_2ANT_COEX_ALGO_PANHS != algorithm)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under inquiry/page scan !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_bt_inquiry(btcoexist); -+ return; -+ } else { -+ /* -+ if(coex_dm->need_recover0x948) -+ { -+ coex_dm->need_recover0x948 = false; -+ btcoexist->btc_write_4byte(btcoexist, 0x948, coex_dm->backup0x948); -+ } -+ */ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || link || roam) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under Link Process !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_wifi_link_process(btcoexist); -+ return; -+ } -+ -+ /* for P2P */ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if ((num_of_wifi_link >= 2) || -+ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", -+ num_of_wifi_link, wifi_link_status); -+ BTC_TRACE(trace_buf); -+ -+ if (bt_link_info->bt_link_exist) -+ miracast_plus_bt = true; -+ else -+ miracast_plus_bt = false; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ halbtc8723b2ant_action_wifi_multi_port(btcoexist); -+ -+ return; -+ } else { -+ miracast_plus_bt = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ -+ coex_dm->cur_algorithm = algorithm; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", -+ coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ -+ if (halbtc8723b2ant_is_common_action(btcoexist)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant common.\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", -+ coex_dm->pre_algorithm, coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ coex_dm->auto_tdma_adjust = false; -+ } -+ switch (coex_dm->cur_algorithm) { -+ case BT_8723B_2ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_sco(btcoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_hid(btcoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_a2dp(btcoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_a2dp_pan_hs(btcoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_pan_edr(btcoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_pan_hs(btcoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_pan_edr_a2dp(btcoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_pan_edr_hid(btcoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_hid_a2dp_pan_edr( -+ btcoexist); -+ break; -+ case BT_8723B_2ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_action_hid_a2dp(btcoexist); -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_coex_all_off(btcoexist); -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+} -+ -+void halbtc8723b2ant_wifi_off_hw_cfg(IN struct btc_coexist *btcoexist) -+{ -+ boolean is_in_mp_mode = false; -+ u8 h2c_parameter[2] = {0}; -+ u32 fw_ver = 0; -+ -+ /* set wlan_act to low */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, -+ 0x780); /* WiFi goto standby while GNT_BT 0-->1 */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ if (fw_ver >= 0x180000) { -+ /* Use H2C to set GNT_BT to HIGH */ -+ h2c_parameter[0] = 1; -+ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, h2c_parameter); -+ } else -+ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, -+ &is_in_mp_mode); -+ if (!is_in_mp_mode) -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, -+ 0x0); /* BT select s0/s1 is controlled by BT */ -+ else -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, -+ 0x1); /* BT select s0/s1 is controlled by WiFi */ -+} -+ -+void halbtc8723b2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean back_up) -+{ -+ u8 u8tmp = 0; -+ u32 vendor; -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 2Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor); -+ if (vendor == BTC_VENDOR_LENOVO) -+ coex_dm->switch_thres_offset = 0; -+ else if (vendor == BTC_VENDOR_ASUS) -+ coex_dm->switch_thres_offset = 0; -+ else -+ coex_dm->switch_thres_offset = 20; -+ -+ /* 0xf0[15:12] --> Chip Cut information */ -+ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, -+ 0xf1) & 0xf0) >> 4; -+ -+ /* backup rf 0x1e value */ -+ coex_dm->bt_rf_0x1e_backup = -+ btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ /* 0x790[5:0]=0x5 */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); -+ u8tmp &= 0xc0; -+ u8tmp |= 0x5; -+ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); -+ -+ /* Antenna config */ -+ halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, true, -+ false); -+ coex_sta->dis_ver_info_cnt = 0; -+ -+ /* PTA parameter */ -+ halbtc8723b2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ /* Enable counter statistics */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, -+ 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -+} -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8723b2ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8723b2ant_ -+ * ************************************************************ */ -+void ex_halbtc8723b2ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u16 u16tmp = 0x0; -+ u32 value = 0; -+ u32 u32tmp_1[4]; -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x67, 0x20); -+ -+ /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ -+ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); -+ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); -+ DbgPrint("--- TEST 5 ---\n"); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); -+ -+ if (btcoexist->chip_interface == BTC_INTF_USB) { -+ /* fixed at S0 for USB interface */ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; -+ } else { -+ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ -+ if (board_info->single_ant_path == 0) { -+ /* set to S1 */ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+ } else if (board_info->single_ant_path == 1) { -+ /* set to S0 */ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; -+ } -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, -+ &value); -+ } -+} -+ -+void ex_halbtc8723b2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ -+ -+ /* */ -+ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ -+ if (btcoexist->chip_interface == BTC_INTF_USB) { -+ /* fixed at S0 for USB interface */ -+ u8tmp |= 0x1; /* antenna inverse */ -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); -+ } else { -+ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ -+ if (board_info->single_ant_path == 0) { -+ } else if (board_info->single_ant_path == 1) { -+ /* set to S0 */ -+ u8tmp |= 0x1; /* antenna inverse */ -+ } -+ -+ if (btcoexist->chip_interface == BTC_INTF_PCI) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384, -+ u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_SDIO) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, -+ u8tmp); -+ } -+} -+ -+void ex_halbtc8723b2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ halbtc8723b2ant_init_hw_config(btcoexist, true); -+} -+ -+void ex_halbtc8723b2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723b2ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8723b2ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u32 u32tmp[4]; -+ u32 fa_of_dm, fa_cck; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ static u8 pop_report_in_10s = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", -+ "Ant PG number/ Ant mechanism:", -+ board_info->pg_ant_num, board_info->btdm_ant_num); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", -+ "Version Coex/ Fw/ Patch/ Cut", -+ glcoex_ver_date_8723b_2ant, glcoex_ver_8723b_2ant, fw_ver, -+ bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "BT Abnormal scan", -+ (coex_sta->bt_abnormal_scan) ? "Yes" : "No"); -+ CL_PRINTF(cli_buf); -+ -+ pop_report_in_10s++; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt/ popCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") -+ : ((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, -+ coex_sta->pop_event_cnt); -+ CL_PRINTF(cli_buf); -+ -+ if (pop_report_in_10s >= 5) { -+ coex_sta->pop_event_cnt = 0; -+ pop_report_in_10s = 0; -+ } -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d / %d / %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP/NameReq/WHQL", -+ bt_link_info->sco_exist, bt_link_info->hid_exist, -+ bt_link_info->pan_exist, bt_link_info->a2dp_exist, -+ coex_sta->c2h_bt_remote_name_req, -+ coex_sta->bt_whck_test); -+ CL_PRINTF(cli_buf); -+ -+ { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "BT Role", -+ (bt_link_info->slave_role) ? "Slave" : "Master"); -+ CL_PRINTF(cli_buf); -+ } -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", -+ "A2DP Rate/Bitpool", -+ (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool); -+ CL_PRINTF(cli_buf); -+ -+ for (i = 0; i < BT_INFO_SRC_8723B_2ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8723b_2ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ /* Sw mechanism */ -+ if (btcoexist->manual_control) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Sw mechanism] (before Manual)============"); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Sw mechanism]============"); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", -+ "SM1[ShRf/ LpRA/ LimDig]", -+ coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, -+ coex_dm->limited_dig); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", -+ "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", -+ coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, -+ coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); -+ CL_PRINTF(cli_buf); -+ -+ /* Fw mechanism */ -+ if (btcoexist->manual_control) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Fw mechanism] (before Manual) ============"); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Fw mechanism]============"); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ -+ if (coex_dm->is_switch_to_1dot5_ant) -+ ps_tdma_case = ps_tdma_case + 100; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), -+ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Coex Table Type", -+ coex_sta->coex_table_type); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", -+ "DecBtPwr/ IgnWlanAct", -+ coex_dm->cur_bt_dec_pwr_lvl, coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", -+ "RF-A, 0x1e initVal", -+ coex_dm->bt_rf_0x1e_backup); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x880); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x778/0x880[29:25]", -+ u8tmp[0], (u32tmp[0] & 0x3e000000) >> 25); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x765); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x948/ 0x67[5] / 0x765", -+ u32tmp[0], ((u8tmp[0] & 0x20) >> 5), u8tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x92c); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x930); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x944); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", -+ u32tmp[0] & 0x3, u32tmp[1] & 0xff, u32tmp[2] & 0x3); -+ CL_PRINTF(cli_buf); -+ -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x39); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x38[11]/0x40/0x4c[24:23]/0x64[0]", -+ ((u8tmp[0] & 0x8) >> 3), u8tmp[1], -+ ((u32tmp[0] & 0x01800000) >> 23), u8tmp[2] & 0x1); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x550(bcn ctrl)/0x522", -+ u32tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x49c); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0xc50(dig)/0x49c(null-drop)", -+ u32tmp[0] & 0xff, u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); -+ u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); -+ -+ fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) -+ >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + \ -+ ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & -+ 0xffff) ; -+ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "OFDM-CCA/OFDM-FA/CCK-FA", -+ u32tmp[0] & 0xffff, fa_of_dm, fa_cck); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_OK CCK/11g/11n/11n-Agg", -+ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, -+ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_Err CCK/11g/11n/11n-Agg", -+ coex_sta->crc_err_cck, coex_sta->crc_err_11g, -+ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(high-pri rx/tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(low-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+#if (BT_AUTO_REPORT_ONLY_8723B_2ANT == 1) -+ /* halbtc8723b2ant_monitor_bt_ctr(btcoexist); */ -+#endif -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void ex_halbtc8723b2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ halbtc8723b2ant_wifi_off_hw_cfg(btcoexist); -+ halbtc8723b2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ halbtc8723b2ant_coex_all_off(btcoexist); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = false; -+ halbtc8723b2ant_init_hw_config(btcoexist, false); -+ halbtc8723b2ant_init_coex_dm(btcoexist); -+ halbtc8723b2ant_query_bt_info(btcoexist); -+ } -+} -+ -+void ex_halbtc8723b2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ } -+} -+ -+void ex_halbtc8723b2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u32 u32tmp; -+ u8 u8tmpa, u8tmpb; -+ -+ -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); -+ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); -+ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); -+ -+ if (BTC_SCAN_START == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, FALSE, FALSE); -+ } else if (BTC_SCAN_FINISH == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x76e=0x%x\n", -+ u32tmp, u8tmpa, u8tmpb); -+ BTC_TRACE(trace_buf); -+} -+ -+void ex_halbtc8723b2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (BTC_ASSOCIATE_START == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, FALSE, FALSE); -+ } else if (BTC_ASSOCIATE_FINISH == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8723b2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ u8 ap_num = 0; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, FALSE, FALSE); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ h2c_parameter[0] = 0x1; -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else { -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &ap_num); -+ if (ap_num < 10) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -+} -+ -+void ex_halbtc8723b2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (type == BTC_PACKET_DHCP) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], DHCP Packet notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8723b2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source = 0; -+ boolean bt_busy = false, limited_dig = false; -+ boolean wifi_connected = false; -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8723B_2ANT_MAX) -+ rsp_source = BT_INFO_SRC_8723B_2ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), return for Manual CTRL<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ /* if 0xff, it means BT is under WHCK test */ -+ if (bt_info == 0xff) -+ coex_sta->bt_whck_test = true; -+ else -+ coex_sta->bt_whck_test = false; -+ -+ if (BT_INFO_SRC_8723B_2ANT_WIFI_FW != rsp_source) { -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; -+ -+ if (coex_sta->bt_retry_cnt >= 1) -+ coex_sta->pop_event_cnt++; -+ -+ coex_sta->bt_rssi = -+ coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) -+ coex_sta->c2h_bt_remote_name_req = true; -+ else -+ coex_sta->c2h_bt_remote_name_req = false; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][1] == 0x49) { -+ coex_sta->a2dp_bit_pool = -+ coex_sta->bt_info_c2h[rsp_source][6]; -+ } else -+ coex_sta->a2dp_bit_pool = 0; -+ -+ coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] -+ & 0x40); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, -+ &coex_sta->bt_tx_rx_mask); -+ if (coex_sta->bt_tx_rx_mask) { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x01 => Need to switch BT TRx Mask */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x01\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, -+ 0x3c, 0x01); -+ } -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ if ((coex_sta->bt_info_ext & BIT(1))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (wifi_connected) -+ ex_halbtc8723b2ant_media_status_notify( -+ btcoexist, BTC_MEDIA_CONNECT); -+ else -+ ex_halbtc8723b2ant_media_status_notify( -+ btcoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ if ((coex_sta->bt_info_ext & BIT(3))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, -+ false); -+ } else { -+ /* BT already NOT ignore Wlan active, do nothing here. */ -+ } -+#if (BT_AUTO_REPORT_ONLY_8723B_2ANT == 0) -+ if ((coex_sta->bt_info_ext & BIT(4))) { -+ /* BT auto report already enabled, do nothing */ -+ } else -+ halbtc8723b2ant_bt_auto_report(btcoexist, FORCE_EXEC, -+ true); -+#endif -+ } -+ -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (bt_info & BT_INFO_8723B_2ANT_B_INQ_PAGE) -+ coex_sta->c2h_bt_inquiry_page = true; -+ else -+ coex_sta->c2h_bt_inquiry_page = false; -+ -+ /* set link exist status */ -+ if (!(bt_info & BT_INFO_8723B_2ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (bt_info & BT_INFO_8723B_2ANT_B_FTP) -+ coex_sta->pan_exist = true; -+ else -+ coex_sta->pan_exist = false; -+ if (bt_info & BT_INFO_8723B_2ANT_B_A2DP) -+ coex_sta->a2dp_exist = true; -+ else -+ coex_sta->a2dp_exist = false; -+ if (bt_info & BT_INFO_8723B_2ANT_B_HID) -+ coex_sta->hid_exist = true; -+ else -+ coex_sta->hid_exist = false; -+ if (bt_info & BT_INFO_8723B_2ANT_B_SCO_ESCO) -+ coex_sta->sco_exist = true; -+ else -+ coex_sta->sco_exist = false; -+ -+ if ((coex_sta->hid_exist == false) && -+ (coex_sta->c2h_bt_inquiry_page == false) && -+ (coex_sta->sco_exist == false)) { -+ if (coex_sta->high_priority_tx + -+ coex_sta->high_priority_rx >= 160) { -+ coex_sta->hid_exist = true; -+ bt_info = bt_info | 0x28; -+ } -+ } -+ } -+ -+ halbtc8723b2ant_update_bt_link_info(btcoexist); -+ -+ if (!(bt_info & BT_INFO_8723B_2ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info == -+ BT_INFO_8723B_2ANT_B_CONNECTION) { /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if ((bt_info & BT_INFO_8723B_2ANT_B_SCO_ESCO) || -+ (bt_info & BT_INFO_8723B_2ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info & BT_INFO_8723B_2ANT_B_ACL_BUSY) { -+ coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if ((BT_8723B_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8723B_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8723B_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { -+ bt_busy = true; -+ limited_dig = true; -+ } else { -+ bt_busy = false; -+ limited_dig = false; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ coex_dm->limited_dig = limited_dig; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); -+ -+ halbtc8723b2ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8723b2ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723b2ant_wifi_off_hw_cfg(btcoexist); -+ /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ -+ /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT goto standby while GNT_BT 1-->0 */ -+ halbtc8723b2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ -+ ex_halbtc8723b2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+void ex_halbtc8723b2ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_WIFI_PNP_SLEEP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ -+ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ -+ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ -+ coex_sta->under_ips = false; -+ coex_sta->under_lps = false; -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_init_hw_config(btcoexist, false); -+ halbtc8723b2ant_init_coex_dm(btcoexist); -+ halbtc8723b2ant_query_bt_info(btcoexist); -+ } -+} -+ -+void ex_halbtc8723b2ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ==========================Periodical===========================\n"); -+ BTC_TRACE(trace_buf); -+ if (coex_sta->dis_ver_info_cnt <= 5) { -+ coex_sta->dis_ver_info_cnt += 1; -+ if (coex_sta->dis_ver_info_cnt == 3) { -+ /* Antenna config to set 0x765 = 0x0 (GNT_BT control by PTA) after initial */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set GNT_BT control by PTA\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723b2ant_set_ant_path(btcoexist, -+ BTC_ANT_WIFI_AT_MAIN, false, false); -+ } -+ } -+ -+#if (BT_AUTO_REPORT_ONLY_8723B_2ANT == 0) -+ halbtc8723b2ant_query_bt_info(btcoexist); -+ halbtc8723b2ant_monitor_bt_enable_disable(btcoexist); -+#else -+ halbtc8723b2ant_monitor_bt_ctr(btcoexist); -+ halbtc8723b2ant_monitor_wifi_ctr(btcoexist); -+ -+ /* for some BT speaker that Hi-Pri pkt appear begore start play, this will cause HID exist */ -+ if ((coex_sta->high_priority_tx + coex_sta->high_priority_rx < 50) && -+ (bt_link_info->hid_exist == true)) -+ bt_link_info->hid_exist = false; -+ -+ if (halbtc8723b2ant_is_wifi_status_changed(btcoexist) || -+ coex_dm->auto_tdma_adjust) -+ halbtc8723b2ant_run_coexist_mechanism(btcoexist); -+#endif -+} -+ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8723b2Ant.h 2018-02-11 21:44:27.146146071 +0200 -@@ -0,0 +1,214 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8723B_SUPPORT == 1) -+/* ******************************************* -+ * The following is for 8723B 2Ant BT Co-exist definition -+ * ******************************************* */ -+#define BT_AUTO_REPORT_ONLY_8723B_2ANT 1 -+ -+ -+#define BT_INFO_8723B_2ANT_B_FTP BIT(7) -+#define BT_INFO_8723B_2ANT_B_A2DP BIT(6) -+#define BT_INFO_8723B_2ANT_B_HID BIT(5) -+#define BT_INFO_8723B_2ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8723B_2ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8723B_2ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8723B_2ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8723B_2ANT_B_CONNECTION BIT(0) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT 2 -+ -+ -+#define BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES 42 /* WiFi RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation */ -+#define BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES 46 /* BT RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation */ -+ -+enum bt_info_src_8723b_2ant { -+ BT_INFO_SRC_8723B_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8723B_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8723B_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8723B_2ANT_MAX -+}; -+ -+enum bt_8723b_2ant_bt_status { -+ BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8723B_2ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8723B_2ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8723B_2ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8723B_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8723B_2ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8723b_2ant_coex_algo { -+ BT_8723B_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8723B_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8723B_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8723B_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8723B_2ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8723B_2ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8723B_2ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8723B_2ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8723B_2ANT_COEX_ALGO_MAX = 0xb, -+}; -+ -+struct coex_dm_8723b_2ant { -+ /* fw mechanism */ -+ u8 pre_bt_dec_pwr_lvl; -+ u8 cur_bt_dec_pwr_lvl; -+ u8 pre_fw_dac_swing_lvl; -+ u8 cur_fw_dac_swing_lvl; -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean reset_tdma_adjust; -+ boolean auto_tdma_adjust; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ -+ /* sw mechanism */ -+ boolean pre_rf_rx_lpf_shrink; -+ boolean cur_rf_rx_lpf_shrink; -+ u32 bt_rf_0x1e_backup; -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ boolean pre_dac_swing_on; -+ u32 pre_dac_swing_lvl; -+ boolean cur_dac_swing_on; -+ u32 cur_dac_swing_lvl; -+ boolean pre_adc_back_off; -+ boolean cur_adc_back_off; -+ boolean pre_agc_table_en; -+ boolean cur_agc_table_en; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ boolean need_recover0x948; -+ u32 backup0x948; -+ -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ boolean is_switch_to_1dot5_ant; -+ u8 switch_thres_offset; -+}; -+ -+struct coex_sta_8723b_2ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ boolean bt_abnormal_scan; -+ boolean under_lps; -+ boolean under_ips; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ u8 bt_rssi; -+ boolean bt_tx_rx_mask; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8723B_2ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8723B_2ANT_MAX]; -+ boolean bt_whck_test; -+ boolean c2h_bt_inquiry_page; -+ boolean c2h_bt_remote_name_req; -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ u32 pop_event_cnt; -+ u8 scan_ap_num; -+ -+ u32 crc_ok_cck; -+ u32 crc_ok_11g; -+ u32 crc_ok_11n; -+ u32 crc_ok_11n_agg; -+ -+ u32 crc_err_cck; -+ u32 crc_err_11g; -+ u32 crc_err_11n; -+ u32 crc_err_11n_agg; -+ -+ u8 coex_table_type; -+ boolean force_lps_on; -+ -+ u8 dis_ver_info_cnt; -+ -+ u8 a2dp_bit_pool; -+ u8 cut_version; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8723b2ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723b2ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723b2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8723b2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723b2ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b2ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723b2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8723b2ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723b2ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8723b2ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723b2ant_display_coex_info(IN struct btc_coexist *btcoexist); -+ -+#else -+#define ex_halbtc8723b2ant_power_on_setting(btcoexist) -+#define ex_halbtc8723b2ant_pre_load_firmware(btcoexist) -+#define ex_halbtc8723b2ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8723b2ant_init_coex_dm(btcoexist) -+#define ex_halbtc8723b2ant_ips_notify(btcoexist, type) -+#define ex_halbtc8723b2ant_lps_notify(btcoexist, type) -+#define ex_halbtc8723b2ant_scan_notify(btcoexist, type) -+#define ex_halbtc8723b2ant_connect_notify(btcoexist, type) -+#define ex_halbtc8723b2ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8723b2ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8723b2ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8723b2ant_halt_notify(btcoexist) -+#define ex_halbtc8723b2ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8723b2ant_periodical(btcoexist) -+#define ex_halbtc8723b2ant_display_coex_info(btcoexist) -+ -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.c 2018-02-11 21:44:27.149146116 +0200 -@@ -0,0 +1,6290 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8723D Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8723D_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8723d_1ant glcoex_dm_8723d_1ant; -+static struct coex_dm_8723d_1ant *coex_dm = &glcoex_dm_8723d_1ant; -+static struct coex_sta_8723d_1ant glcoex_sta_8723d_1ant; -+static struct coex_sta_8723d_1ant *coex_sta = &glcoex_sta_8723d_1ant; -+static struct psdscan_sta_8723d_1ant gl_psd_scan_8723d_1ant; -+static struct psdscan_sta_8723d_1ant *psd_scan = &gl_psd_scan_8723d_1ant; -+ -+ -+const char *const glbt_info_src_8723d_1ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+/* ************************************************************ -+ * BtCoex Version Format: -+ * 1. date : glcoex_ver_date_XXXXX_1ant -+ * 2. WifiCoexVersion : glcoex_ver_XXXX_1ant -+ * 3. BtCoexVersion : glcoex_ver_btdesired_XXXXX_1ant -+ * 4. others : glcoex_ver_XXXXXX_XXXXX_1ant -+ * -+ * Variable should be indicated IC and Antenna numbers !!! -+ * Please strictly follow this order and naming style !!! -+ * -+ * ************************************************************ */ -+u32 glcoex_ver_date_8723d_1ant = 20170111; -+u32 glcoex_ver_8723d_1ant = 0x14; -+u32 glcoex_ver_btdesired_8723d_1ant = 0x10; -+ -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8723d1ant_ -+ * ************************************************************ */ -+u8 halbtc8723d1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_bt_rssi_state; -+ } -+ -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8723d1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_wifi_rssi_state[index]; -+ } -+ -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8723d1ant_update_ra_mask(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 dis_rate_mask) -+{ -+ coex_dm->cur_ra_mask = dis_rate_mask; -+ -+ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, -+ &coex_dm->cur_ra_mask); -+ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -+} -+ -+void halbtc8723d1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ coex_dm->cur_arfr_type = type; -+ -+ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { -+ switch (coex_dm->cur_arfr_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_4byte(btcoexist, 0x430, -+ coex_dm->backup_arfr_cnt1); -+ btcoexist->btc_write_4byte(btcoexist, 0x434, -+ coex_dm->backup_arfr_cnt2); -+ break; -+ case 1: -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x01010101); -+ } else { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -+} -+ -+void halbtc8723d1ant_retry_limit(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_retry_limit_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_retry_limit_type != -+ coex_dm->cur_retry_limit_type)) { -+ switch (coex_dm->cur_retry_limit_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ coex_dm->backup_retry_limit); -+ break; -+ case 1: /* retry limit=8 */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -+} -+ -+void halbtc8723d1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_ampdu_time_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { -+ switch (coex_dm->cur_ampdu_time_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ coex_dm->backup_ampdu_max_time); -+ break; -+ case 1: /* AMPDU timw = 0x38 * 32us */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -+} -+ -+void halbtc8723d1ant_limited_tx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, -+ IN u8 retry_limit_type, IN u8 ampdu_time_type) -+{ -+ switch (ra_mask_type) { -+ case 0: /* normal mode */ -+ halbtc8723d1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0); -+ break; -+ case 1: /* disable cck 1/2 */ -+ halbtc8723d1ant_update_ra_mask(btcoexist, force_exec, -+ 0x00000003); -+ break; -+ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ -+ halbtc8723d1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8723d1ant_auto_rate_fallback_retry(btcoexist, force_exec, -+ arfr_type); -+ halbtc8723d1ant_retry_limit(btcoexist, force_exec, retry_limit_type); -+ halbtc8723d1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -+} -+ -+void halbtc8723d1ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+void halbtc8723d1ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WL query BT info!!\n"); -+ BTC_TRACE(trace_buf); -+} -+ -+void halbtc8723d1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ static u8 num_of_bt_counter_chk = 0, cnt_slave = 0, cnt_overhead = 0, -+ cnt_autoslot_hang = 0; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ -+ /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ if (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ -+ if (coex_sta->high_priority_rx >= 15) { -+ if (cnt_overhead < 3) -+ cnt_overhead++; -+ -+ if (cnt_overhead == 3) -+ coex_sta->is_hiPri_rx_overhead = true; -+ } else { -+ if (cnt_overhead > 0) -+ cnt_overhead--; -+ -+ if (cnt_overhead == 0) -+ coex_sta->is_hiPri_rx_overhead = false; -+ } -+ } else -+ coex_sta->is_hiPri_rx_overhead = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); -+ -+ BTC_TRACE(trace_buf); -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+ -+ if ((coex_sta->low_priority_tx > 1150) && -+ (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->pop_event_cnt++; -+ -+ if ((coex_sta->low_priority_rx >= 1150) && -+ (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) -+ && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && -+ (coex_sta->bt_link_exist)) { -+ if (cnt_slave >= 2) { -+ bt_link_info->slave_role = true; -+ cnt_slave = 2; -+ } else -+ cnt_slave++; -+ } else { -+ if (cnt_slave == 0) { -+ bt_link_info->slave_role = false; -+ cnt_slave = 0; -+ } else -+ cnt_slave--; -+ -+ } -+ -+ if (coex_sta->is_tdma_btautoslot) { -+ if ((coex_sta->low_priority_tx >= 1300) && -+ (coex_sta->low_priority_rx <= 150)) { -+ if (cnt_autoslot_hang >= 2) { -+ coex_sta->is_tdma_btautoslot_hang = true; -+ cnt_autoslot_hang = 2; -+ } else -+ cnt_autoslot_hang++; -+ } else { -+ if (cnt_autoslot_hang == 0) { -+ coex_sta->is_tdma_btautoslot_hang = false; -+ cnt_autoslot_hang = 0; -+ } else -+ cnt_autoslot_hang--; -+ } -+ } -+ -+ if (!coex_sta->bt_disabled) { -+ -+ if ((coex_sta->high_priority_tx == 0) && -+ (coex_sta->high_priority_rx == 0) && -+ (coex_sta->low_priority_tx == 0) && -+ (coex_sta->low_priority_rx == 0)) { -+ num_of_bt_counter_chk++; -+ if (num_of_bt_counter_chk >= 3) { -+ halbtc8723d1ant_query_bt_info(btcoexist); -+ num_of_bt_counter_chk = 0; -+ } -+ } -+ } -+ -+} -+ -+void halbtc8723d1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -+{ -+#if 1 -+ s32 wifi_rssi = 0; -+ boolean wifi_busy = false, wifi_under_b_mode = false, -+ wifi_scan = false; -+ boolean bt_idle = false, wl_idle = false; -+ static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, -+ wl_noisy_count1 = 3, wl_noisy_count2 = 0; -+ u32 total_cnt, reg_val1, reg_val2, cck_cnt; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); -+ -+ coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_OK_CCK); -+ coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_OK_LEGACY); -+ coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_OK_HT); -+ coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_OK_VHT); -+ -+ coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); -+ coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); -+ coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_ERROR_HT); -+ coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_ERROR_VHT); -+ -+ cck_cnt = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; -+ -+ if (cck_cnt > 250) { -+ if (wl_noisy_count2 < 3) -+ wl_noisy_count2++; -+ -+ if (wl_noisy_count2 == 3) { -+ wl_noisy_count0 = 0; -+ wl_noisy_count1 = 0; -+ } -+ } else if (cck_cnt < 50) { -+ if (wl_noisy_count0 < 3) -+ wl_noisy_count0++; -+ -+ if (wl_noisy_count0 == 3) { -+ wl_noisy_count1 = 0; -+ wl_noisy_count2 = 0; -+ } -+ } else { -+ if (wl_noisy_count1 < 3) -+ wl_noisy_count1++; -+ -+ if (wl_noisy_count1 == 3) { -+ wl_noisy_count0 = 0; -+ wl_noisy_count2 = 0; -+ } -+ } -+ -+ if (wl_noisy_count2 == 3) -+ coex_sta->wl_noisy_level = 2; -+ else if (wl_noisy_count1 == 3) -+ coex_sta->wl_noisy_level = 1; -+ else -+ coex_sta->wl_noisy_level = 0; -+ -+ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { -+ total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + -+ coex_sta->crc_ok_11n + coex_sta->crc_ok_11n_vht; -+ -+ if ((coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_ACL_BUSY) || -+ (coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_SCO_BUSY)) { -+ if (coex_sta->crc_ok_cck > (total_cnt - -+ coex_sta->crc_ok_cck)) { -+ if (cck_lock_counter < 3) -+ cck_lock_counter++; -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ if (!coex_sta->pre_ccklock) { -+ -+ if (cck_lock_counter >= 3) -+ coex_sta->cck_lock = true; -+ else -+ coex_sta->cck_lock = false; -+ } else { -+ if (cck_lock_counter == 0) -+ coex_sta->cck_lock = false; -+ else -+ coex_sta->cck_lock = true; -+ } -+ -+ if (coex_sta->cck_lock) -+ coex_sta->cck_ever_lock = true; -+ -+ coex_sta->pre_ccklock = coex_sta->cck_lock; -+ -+#endif -+} -+ -+void halbtc8723d1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ boolean bt_busy = false; -+ -+ -+ coex_sta->num_of_profile = 0; -+ -+ /* set link exist status */ -+ if (!(coex_sta->bt_info & BT_INFO_8723D_1ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_FTP) { -+ coex_sta->pan_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->pan_exist = false; -+ -+ if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_A2DP) { -+ coex_sta->a2dp_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->a2dp_exist = false; -+ -+ if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_HID) { -+ coex_sta->hid_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->hid_exist = false; -+ -+ if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_ESCO) { -+ coex_sta->sco_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->sco_exist = false; -+ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ bt_link_info->acl_busy = coex_sta->acl_busy; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+ -+ if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_INQ_PAGE) { -+ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_INQ_PAGE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n"); -+ } else if (!(coex_sta->bt_info & BT_INFO_8723D_1ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ } else if (coex_sta->bt_info == BT_INFO_8723D_1ANT_B_CONNECTION) { -+ /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ } else if (((coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_ESCO) || -+ (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_BUSY)) && -+ (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_ACL_BUSY)) { -+ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n"); -+ } else if ((coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_ESCO) || -+ (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ } else if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_ACL_BUSY) { -+ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ } else { -+ coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ } -+ -+ BTC_TRACE(trace_buf); -+ -+ if ((BT_8723D_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8723D_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ bt_busy = true; -+ else -+ bt_busy = false; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+} -+ -+ -+void halbtc8723d1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ h2c_parameter[0] = -+ 0x1; /* enable BT AFH skip WL channel for 8723d because BT Rx LO interference */ -+ /* h2c_parameter[0] = 0x0; */ -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -+ -+} -+ -+u8 halbtc8723d1ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8723D_1ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_1ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_1ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_1ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_1ANT_COEX_ALGO_HID_A2DP; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+void halbtc8723d1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8723d1ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8723d1ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8723d1ant_set_fw_low_penalty_ra(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+#if 1 -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ -+ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+#endif -+} -+ -+void halbtc8723d1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+#if 1 -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ -+ halbtc8723d1ant_set_fw_low_penalty_ra(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+#if 0 -+ if (low_penalty_ra) -+ btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 15); -+ else -+ btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 0); -+#endif -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+ -+#endif -+ -+} -+ -+void halbtc8723d1ant_write_score_board( -+ IN struct btc_coexist *btcoexist, -+ IN u16 bitpos, -+ IN boolean state -+) -+{ -+ -+ static u16 originalval = 0x8002; -+ -+ if (state) -+ originalval = originalval | bitpos; -+ else -+ originalval = originalval & (~bitpos); -+ -+ -+ btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); -+ -+} -+ -+void halbtc8723d1ant_read_score_board( -+ IN struct btc_coexist *btcoexist, -+ IN u16 *score_board_val -+) -+{ -+ -+ *score_board_val = (btcoexist->btc_read_2byte(btcoexist, -+ 0xaa)) & 0x7fff; -+} -+ -+void halbtc8723d1ant_post_state_to_bt( -+ IN struct btc_coexist *btcoexist, -+ IN u16 type, -+ IN boolean state -+) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], halbtc8723d1ant_post_state_to_bt: type = %d, state =%d\n", -+ type, state); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_write_score_board(btcoexist, (u16) type, state); -+} -+ -+boolean halbtc8723d1ant_is_wifibt_status_changed(IN struct btc_coexist -+ *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false, pre_bt_off = false, pre_bt_slave = false; -+ static u8 pre_hid_busy_num = 0, pre_wl_noisy_level = 0; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (coex_sta->bt_disabled != pre_bt_off) { -+ pre_bt_off = coex_sta->bt_disabled; -+ -+ if (coex_sta->bt_disabled) -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ else -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->bt_coex_supported_feature = 0; -+ coex_sta->bt_coex_supported_version = 0; -+ coex_sta->bt_ble_scan_type = 0; -+ coex_sta->bt_ble_scan_para[0] = 0; -+ coex_sta->bt_ble_scan_para[1] = 0; -+ coex_sta->bt_ble_scan_para[2] = 0; -+ coex_sta->bt_reg_vendor_ac = 0xffff; -+ coex_sta->bt_reg_vendor_ae = 0xffff; -+ return true; -+ } -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ -+ if (wifi_busy) -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, true); -+ else -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, false); -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ if (coex_sta->wl_noisy_level != pre_wl_noisy_level) { -+ pre_wl_noisy_level = coex_sta->wl_noisy_level; -+ return true; -+ } -+ } -+ -+ if (!coex_sta->bt_disabled) { -+ if (coex_sta->hid_busy_num != pre_hid_busy_num) { -+ pre_hid_busy_num = coex_sta->hid_busy_num; -+ return true; -+ } -+ } -+ -+ if (bt_link_info->slave_role != pre_bt_slave) { -+ pre_bt_slave = bt_link_info->slave_role; -+ return true; -+ } -+ -+ return false; -+} -+ -+void halbtc8723d1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ u16 u16tmp; -+ -+ /* This function check if bt is disabled */ -+#if 0 -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ -+ -+#else -+ -+ /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ -+ halbtc8723d1ant_read_score_board(btcoexist, &u16tmp); -+ -+ bt_active = u16tmp & BIT(1); -+ -+ -+#endif -+ -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ } else { -+ -+ bt_disable_cnt++; -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ bt_disable_cnt = 2; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ } -+ -+ if (bt_disabled) -+ halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); -+ else -+ halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, true); -+ -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ } -+ -+} -+ -+ -+ -+void halbtc8723d1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, -+ boolean isenable) -+{ -+#if BT_8723D_1ANT_COEX_DBG -+ if (isenable) { -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); -+ -+ /* enable GNT_BT to GPIO debug */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); -+ -+ /* 0x48[20] = 0 for GPIO14 = GNT_WL*/ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x0); -+ /* 0x40[17] = 0 for GPIO14 = GNT_WL*/ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, 0x02, 0x0); -+ -+ /* 0x66[9] = 0 for GPIO15 = GNT_B T*/ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x02, 0x0); -+ /* 0x66[7] = 0 -+ for GPIO15 = GNT_BT*/ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, 0x80, 0x0); -+ /* 0x8[8] = 0 for GPIO15 = GNT_BT*/ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x9, 0x1, 0x0); -+ -+ /* BT Vendor Reg 0x76[0] = 0 for GPIO15 = GNT_BT, this is not set here*/ -+ } else { -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); -+ -+ /* Disable GNT_BT debug to GPIO, and enable chip_wakeup_host */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x1); -+ -+ /* 0x48[20] = 0 for GPIO14 = GNT_WL*/ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x1); -+ } -+ -+#endif -+} -+ -+u32 halbtc8723d1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, -+ IN u16 reg_addr) -+{ -+ u32 j = 0, delay_count = 0; -+ -+ -+ /* wait for ready bit before access 0x7c0 */ -+ btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr); -+ -+ while (1) { -+ if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { -+ delay_ms(50); -+ delay_count++; -+ if (delay_count >= 10) { -+ delay_count = 0; -+ break; -+ } -+ } else -+ break; -+ } -+ -+ return btcoexist->btc_read_4byte(btcoexist, -+ 0x7c8); /* get read data */ -+ -+} -+ -+void halbtc8723d1ant_ltecoex_indirect_write_reg(IN struct btc_coexist -+ *btcoexist, -+ IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) -+{ -+ u32 val, i = 0, j = 0, bitpos = 0, delay_count = 0; -+ -+ -+ if (bit_mask == 0x0) -+ return; -+ if (bit_mask == 0xffffffff) { -+ btcoexist->btc_write_4byte(btcoexist, 0x7c4, -+ reg_value); /* put write data */ -+ -+ /* wait for ready bit before access 0x7c0 */ -+ while (1) { -+ if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { -+ delay_ms(50); -+ delay_count++; -+ if (delay_count >= 10) { -+ delay_count = 0; -+ break; -+ } -+ } else -+ break; -+ } -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x7c0, -+ 0xc00F0000 | reg_addr); -+ } else { -+ for (i = 0; i <= 31; i++) { -+ if (((bit_mask >> i) & 0x1) == 0x1) { -+ bitpos = i; -+ break; -+ } -+ } -+ -+ /* read back register value before write */ -+ val = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, -+ reg_addr); -+ val = (val & (~bit_mask)) | (reg_value << bitpos); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x7c4, -+ val); /* put write data */ -+ -+ /* wait for ready bit before access 0x7c0 */ -+ while (1) { -+ if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { -+ delay_ms(50); -+ delay_count++; -+ if (delay_count >= 10) { -+ delay_count = 0; -+ break; -+ } -+ } else -+ break; -+ } -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x7c0, -+ 0xc00F0000 | reg_addr); -+ -+ } -+ -+} -+ -+void halbtc8723d1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 val; -+ -+ val = (enable) ? 1 : 0; -+ halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, -+ val); /* 0x38[7] */ -+ -+} -+ -+void halbtc8723d1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_control) -+{ -+ u8 val; -+ -+ val = (wifi_control) ? 1 : 0; -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, -+ val); /* 0x70[26] */ -+ -+} -+ -+void halbtc8723d1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, -+ IN u8 control_block, IN boolean sw_control, IN u8 state) -+{ -+ u32 val = 0, val_orig = 0; -+ -+ if (!sw_control) -+ val = 0x0; -+ else if (state & 0x1) -+ val = 0x3; -+ else -+ val = 0x1; -+ -+ val_orig = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x38); -+ -+ switch (control_block) { -+ case BT_8723D_1ANT_GNT_BLOCK_RFC_BB: -+ default: -+ val = ((val << 14) | (val << 10)) | (val_orig & 0xffff33ff); -+ break; -+ case BT_8723D_1ANT_GNT_BLOCK_RFC: -+ val = (val << 14) | (val_orig & 0xffff3fff); -+ break; -+ case BT_8723D_1ANT_GNT_BLOCK_BB: -+ val = (val << 10) | (val_orig & 0xfffff3ff); -+ break; -+ } -+ -+ halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, 0xffffffff, val); -+} -+ -+ -+void halbtc8723d1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, -+ IN u8 control_block, IN boolean sw_control, IN u8 state) -+{ -+ u32 val = 0, val_orig = 0; -+ -+ if (!sw_control) -+ val = 0x0; -+ else if (state & 0x1) -+ val = 0x3; -+ else -+ val = 0x1; -+ -+ val_orig = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x38); -+ -+ switch (control_block) { -+ case BT_8723D_1ANT_GNT_BLOCK_RFC_BB: -+ default: -+ val = ((val << 12) | (val << 8)) | (val_orig & 0xffffccff); -+ break; -+ case BT_8723D_1ANT_GNT_BLOCK_RFC: -+ val = (val << 12) | (val_orig & 0xffffcfff); -+ break; -+ case BT_8723D_1ANT_GNT_BLOCK_BB: -+ val = (val << 8) | (val_orig & 0xfffffcff); -+ break; -+ } -+ -+ halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, -+ 0xffffffff, val); -+} -+ -+ -+void halbtc8723d1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u8 table_type, IN u16 table_content) -+{ -+ u16 reg_addr = 0x0000; -+ -+ switch (table_type) { -+ case BT_8723D_1ANT_CTT_WL_VS_LTE: -+ reg_addr = 0xa0; -+ break; -+ case BT_8723D_1ANT_CTT_BT_VS_LTE: -+ reg_addr = 0xa4; -+ break; -+ } -+ -+ if (reg_addr != 0x0000) -+ halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, -+ 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ -+ -+ -+} -+ -+ -+void halbtc8723d1ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, -+ IN u8 table_type, IN u8 table_content) -+{ -+ u16 reg_addr = 0x0000; -+ -+ switch (table_type) { -+ case BT_8723D_1ANT_LBTT_WL_BREAK_LTE: -+ reg_addr = 0xa8; -+ break; -+ case BT_8723D_1ANT_LBTT_BT_BREAK_LTE: -+ reg_addr = 0xac; -+ break; -+ case BT_8723D_1ANT_LBTT_LTE_BREAK_WL: -+ reg_addr = 0xb0; -+ break; -+ case BT_8723D_1ANT_LBTT_LTE_BREAK_BT: -+ reg_addr = 0xb4; -+ break; -+ } -+ -+ if (reg_addr != 0x0000) -+ halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, -+ 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ -+ -+} -+ -+void halbtc8723d1ant_set_wltoggle_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 interval, -+ IN u8 val0x6c4_b0, IN u8 val0x6c4_b1, IN u8 val0x6c4_b2, -+ IN u8 val0x6c4_b3) -+{ -+ static u8 pre_h2c_parameter[6] = {0}; -+ u8 cur_h2c_parameter[6] = {0}; -+ u8 i, match_cnt = 0; -+ -+ cur_h2c_parameter[0] = 0x7; /* op_code, 0x7= wlan toggle slot*/ -+ -+ cur_h2c_parameter[1] = interval; -+ cur_h2c_parameter[2] = val0x6c4_b0; -+ cur_h2c_parameter[3] = val0x6c4_b1; -+ cur_h2c_parameter[4] = val0x6c4_b2; -+ cur_h2c_parameter[5] = val0x6c4_b3; -+ -+ if (!force_exec) { -+ for (i = 1; i <= 5; i++) { -+ if (cur_h2c_parameter[i] != pre_h2c_parameter[i]) -+ break; -+ -+ match_cnt++; -+ } -+ -+ if (match_cnt == 5) -+ return; -+ } -+ -+ for (i = 1; i <= 5; i++) -+ pre_h2c_parameter[i] = cur_h2c_parameter[i]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, cur_h2c_parameter); -+} -+ -+ -+void halbtc8723d1ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8723d1ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ -+ halbtc8723d1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8723d1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ u32 break_table; -+ u8 select_table; -+ -+ coex_sta->coex_table_type = type; -+ -+ if (coex_sta->concurrent_rx_mode_on == true) { -+ break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ -+ select_table = -+ 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ -+ } else { -+ break_table = 0xffffff; -+ select_table = 0x3; -+ } -+ -+ switch (type) { -+ case 0: -+ halbtc8723d1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x55555555, break_table, -+ select_table); -+ break; -+ case 1: -+ halbtc8723d1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 2: -+ halbtc8723d1ant_coex_table(btcoexist, force_exec, -+ 0xaa5a5a5a, 0xaa5a5a5a, break_table, -+ select_table); -+ break; -+ case 3: -+ halbtc8723d1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 4: -+ halbtc8723d1ant_coex_table(btcoexist, force_exec, -+ 0xa5555555, 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 5: -+ halbtc8723d1ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 6: -+ halbtc8723d1ant_coex_table(btcoexist, force_exec, -+ 0xa5555555, 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 7: -+ halbtc8723d1ant_coex_table(btcoexist, force_exec, -+ 0xaa555555, 0xaa555555, break_table, -+ select_table); -+ break; -+ case 8: -+ halbtc8723d1ant_coex_table(btcoexist, force_exec, -+ 0xa5555555, 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 9: -+ halbtc8723d1ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0xaaaa5aaa, break_table, -+ select_table); -+ break; -+ case 10: -+ halbtc8723d1ant_coex_table(btcoexist, force_exec, -+ 0xaaaaaaaa, 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8723d1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8723d1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8723d1ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8723d1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8723d1ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8723d1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8723d1ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ /*halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); */ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, -+ h2c_parameter); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ /*halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8);*/ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, -+ h2c_parameter); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8723d1ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ coex_sta->force_lps_on = false; -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ -+ break; -+ case BTC_PS_LPS_ON: -+ coex_sta->force_lps_on = true; -+ halbtc8723d1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8723d1ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ -+ break; -+ case BTC_PS_LPS_OFF: -+ coex_sta->force_lps_on = false; -+ halbtc8723d1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, false); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+void halbtc8723d1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = false; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ if (byte5 & BIT(2)) -+ coex_sta->is_tdma_btautoslot = true; -+ else -+ coex_sta->is_tdma_btautoslot = false; -+ -+ /* release bt-auto slot for auto-slot hang is detected!! */ -+ if (coex_sta->is_tdma_btautoslot) -+ if ((coex_sta->is_tdma_btautoslot_hang) || -+ (bt_link_info->slave_role)) -+ byte5 = byte5 & 0xfb; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], FW for AP mode\n"); -+ BTC_TRACE(trace_buf); -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ -+ halbtc8723d1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ -+ halbtc8723d1ant_power_save_state( -+ btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } else { -+ halbtc8723d1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, -+ 0x0); -+ } -+ -+ -+ h2c_parameter[0] = real_byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = real_byte5; -+ -+ coex_dm->ps_tdma_para[0] = real_byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = real_byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+ -+void halbtc8723d1ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ boolean wifi_busy = false; -+ static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; -+ static boolean pre_wifi_busy = false; -+ -+ -+#if BT_8723D_1ANT_ANTDET_ENABLE -+ -+ if (board_info->btdm_ant_num_by_ant_det == 2) { -+#if 0 -+ if (turn_on) -+ type = type + -+ 100; -+#endif -+ } -+ -+#endif -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (wifi_busy != pre_wifi_busy) { -+ force_exec = true; -+ pre_wifi_busy = wifi_busy; -+ } -+ -+ /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+ if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) -+ psTdmaByte4Modify = 0x1; -+ else -+ psTdmaByte4Modify = 0x0; -+ -+ if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { -+ -+ force_exec = true; -+ pre_psTdmaByte4Modify = psTdmaByte4Modify; -+ } -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ -+ if (coex_dm->cur_ps_tdma_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(on, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(off, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } -+ -+ -+ if (turn_on) { -+ switch (type) { -+ default: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x35, 0x03, 0x11, 0x11); -+ break; -+ case 3: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x3a, 0x03, 0x10, 0x50); -+ break; -+ case 4: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x21, 0x03, 0x10, 0x50); -+ break; -+ case 5: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x15, 0x03, 0x11, 0x11); -+ break; -+ case 6: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x20, 0x03, 0x11, 0x11); -+ break; -+ case 7: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x10, 0x03, 0x10, 0x54 | -+ psTdmaByte4Modify); -+ break; -+ case 8: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x10, 0x03, 0x10, 0x54 | -+ psTdmaByte4Modify); -+ break; -+ case 9: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x55, 0x10, 0x03, 0x10, 0x54 | -+ psTdmaByte4Modify); -+ break; -+ case 10: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x30, 0x03, 0x11, 0x10); -+ break; -+ case 11: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x65, 0x25, 0x03, 0x11, 0x11 | -+ psTdmaByte4Modify); -+ break; -+ case 12: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x55, 0x30, 0x03, 0x10, 0x50 | -+ psTdmaByte4Modify); -+ break; -+ case 13: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x25, 0x03, 0x10, 0x50 | -+ psTdmaByte4Modify); -+ break; -+ case 14: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x15, 0x03, 0x10, 0x50 | -+ psTdmaByte4Modify); -+ break; -+ case 15: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x20, 0x03, 0x10, 0x50 | -+ psTdmaByte4Modify); -+ break; -+ case 16: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x10, 0x03, 0x11, 0x15 | -+ psTdmaByte4Modify); -+ break; -+ case 17: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x10, 0x03, 0x11, 0x14); -+ break; -+ case 18: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x30, 0x03, 0x10, 0x50 | -+ psTdmaByte4Modify); -+ break; -+ case 19: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x15, 0x03, 0x11, 0x10); -+ break; -+ case 20: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x30, 0x03, 0x11, 0x10); -+ break; -+ case 21: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x30, 0x03, 0x11, 0x10); -+ break; -+ case 22: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x25, 0x03, 0x11, 0x10); -+ break; -+ case 23: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x10, 0x03, 0x11, 0x10); -+ break; -+ case 27: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x10, 0x03, 0x11, 0x15); -+ break; -+ case 32: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x35, 0x03, 0x11, 0x11); -+ break; -+ case 33: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x35, 0x03, 0x11, 0x10); -+ break; -+ case 57: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x10, 0x03, 0x10, 0x50 | -+ psTdmaByte4Modify); -+ break; -+ case 58: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x10, 0x03, 0x10, 0x50 | -+ psTdmaByte4Modify); -+ break; -+ case 67: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x10, 0x03, 0x11, 0x10 | -+ psTdmaByte4Modify); -+ break; -+ /* 1-Ant to 2-Ant TDMA case */ -+ case 103: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x3a, 0x03, 0x70, 0x10); -+ break; -+ case 104: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x21, 0x03, 0x70, 0x10); -+ break; -+ case 105: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x15, 0x03, 0x71, 0x11); -+ break; -+ case 106: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x20, 0x03, 0x71, 0x11); -+ break; -+ case 107: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x10, 0x03, 0x70, 0x14 | -+ psTdmaByte4Modify); -+ break; -+ case 108: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x10, 0x03, 0x70, 0x14 | -+ psTdmaByte4Modify); -+ break; -+ case 113: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x25, 0x03, 0x70, 0x10 | -+ psTdmaByte4Modify); -+ break; -+ case 114: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x15, 0x03, 0x70, 0x10 | -+ psTdmaByte4Modify); -+ break; -+ case 115: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x20, 0x03, 0x70, 0x10 | -+ psTdmaByte4Modify); -+ break; -+ case 117: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x10, 0x03, 0x71, 0x14 | -+ psTdmaByte4Modify); -+ break; -+ case 119: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x15, 0x03, 0x71, 0x10); -+ break; -+ case 120: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x30, 0x03, 0x71, 0x10); -+ break; -+ case 121: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x30, 0x03, 0x71, 0x10); -+ break; -+ case 122: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x25, 0x03, 0x71, 0x10); -+ break; -+ case 132: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x35, 0x03, 0x71, 0x11); -+ break; -+ case 133: -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x35, 0x03, 0x71, 0x10); -+ break; -+ } -+ } else { -+ -+ /* disable PS tdma */ -+ switch (type) { -+ case 8: /* PTA Control */ -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x8, -+ 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 0: -+ default: /* Software control, Antenna at BT side */ -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ -+ halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x48, 0x0); -+ break; -+ } -+ } -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+ -+void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean force_exec, -+ IN u8 phase) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u32 cnt_bt_cal_chk = 0; -+ boolean is_in_mp_mode = false, is_hw_ant_div_on = false; -+ u8 u8tmp0 = 0, u8tmp1 = 0; -+ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ u16 u16tmp0, u16tmp1 = 0; -+ -+#if BT_8723D_1ANT_ANTDET_ENABLE -+ -+ if (ant_pos_type == BTC_ANT_PATH_PTA) { -+ if ((board_info->btdm_ant_det_finish) && -+ (board_info->btdm_ant_num_by_ant_det == 2)) { -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = BTC_ANT_PATH_WIFI; -+ else -+ ant_pos_type = BTC_ANT_PATH_BT; -+ } -+ } -+ -+#endif -+ -+ u32tmp1 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x38); -+ -+ /* To avoid indirect access fail */ -+ if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) { -+ force_exec = true; -+ coex_sta->gnt_error_cnt++; -+ } -+ -+#if BT_8723D_1ANT_COEX_DBG -+ u32tmp2 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa); -+ u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); -+ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before Set Ant Pat)\n", -+ u8tmp0, u16tmp1, u8tmp1); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa = 0x%x(Before Set Ant Path)\n", -+ u32tmp1, u32tmp2, u16tmp0); -+ BTC_TRACE(trace_buf); -+#endif -+ -+ coex_dm->cur_ant_pos_type = ant_pos_type; -+ -+ if (!force_exec) { -+ if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** Skip Antenna Path Setup because no change!!**********\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ } -+ -+ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; -+ -+ -+ switch (phase) { -+ case BT_8723D_1ANT_PHASE_COEX_POWERON: -+ /* Set Path control to WL */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, -+ 0x80, 0x0); -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8723D_1ANT_PCO_BTSIDE); -+ -+ /* set GNT_BT to SW high */ -+ halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to SW low */ -+ halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ -+ coex_sta->run_time_state = false; -+ -+ break; -+ case BT_8723D_1ANT_PHASE_COEX_INIT: -+ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ -+ halbtc8723d1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8723d1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8723D_1ANT_CTT_WL_VS_LTE, 0xffff); -+ -+ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8723d1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8723D_1ANT_CTT_BT_VS_LTE, 0xffff); -+ -+ /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ -+ while (cnt_bt_cal_chk <= 20) { -+ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, -+ 0x49d); -+ cnt_bt_cal_chk++; -+ if (u8tmp0 & BIT(0)) { -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ delay_ms(50); -+ } else { -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** WL is NOT calibrating (wait cnt=%d)**********\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ break; -+ } -+ } -+ -+ /* Set Path control to WL */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, -+ 0x80, 0x1); -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8723D_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW high */ -+ halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to SW low */ -+ halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ -+ coex_sta->run_time_state = false; -+ break; -+ case BT_8723D_1ANT_PHASE_WLANONLY_INIT: -+ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ -+ halbtc8723d1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8723d1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8723D_1ANT_CTT_WL_VS_LTE, 0xffff); -+ -+ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8723d1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8723D_1ANT_CTT_BT_VS_LTE, 0xffff); -+ -+ /* Set Path control to WL */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, -+ 0x80, 0x1); -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8723D_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW low */ -+ halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_1ANT_SIG_STA_SET_TO_LOW); -+ /* Set GNT_WL to SW high */ -+ halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_WIFI; -+ -+ coex_sta->run_time_state = false; -+ break; -+ case BT_8723D_1ANT_PHASE_WLAN_OFF: -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8723d1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* Set Path control to BT */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, -+ 0x80, 0x0); -+ -+ /* set Path control owner to BT */ -+ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8723D_1ANT_PCO_BTSIDE); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ -+ coex_sta->run_time_state = false; -+ break; -+ case BT_8723D_1ANT_PHASE_2G_RUNTIME: -+ -+ /* wait for WL/BT IQK finish, keep 0x38 = 0xff00 for WL IQK */ -+ while (cnt_bt_cal_chk <= 20) { -+ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, -+ 0x1e6); -+ -+ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, -+ 0x49d); -+ -+ cnt_bt_cal_chk++; -+ if ((u8tmp0 & BIT(0)) || (u8tmp1 & BIT(0))) { -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "[BTCoex], ########### WL or BT is IQK (wait cnt=%d)\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ delay_ms(50); -+ } else { -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** WL and BT is NOT IQK (wait cnt=%d)\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ break; -+ } -+ } -+ -+ -+ /* Set Path control to WL */ -+ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1); */ -+ -+ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8723D_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to PTA */ -+ halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_PTA, -+ BT_8723D_1ANT_SIG_STA_SET_BY_HW); -+ /* Set GNT_WL to PTA */ -+ halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_PTA, -+ BT_8723D_1ANT_SIG_STA_SET_BY_HW); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_PTA; -+ -+ coex_sta->run_time_state = true; -+ break; -+ case BT_8723D_1ANT_PHASE_BTMPMODE: -+ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8723D_1ANT_PCO_WLSIDE); -+ -+ /* Set Path control to WL */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, -+ 0x80, 0x1); -+ -+ /* set GNT_BT to high */ -+ halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to low */ -+ halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_1ANT_SIG_STA_SET_TO_LOW); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ -+ coex_sta->run_time_state = false; -+ break; -+ case BT_8723D_1ANT_PHASE_ANTENNA_DET: -+ halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8723D_1ANT_PCO_WLSIDE); -+ -+ /* Set Path control to WL */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, -+ 0x80, 0x1); -+ -+ /* set GNT_BT to high */ -+ halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to high */ -+ halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ -+ coex_sta->run_time_state = false; -+ -+ break; -+ } -+ -+ -+ is_hw_ant_div_on = board_info->ant_div_cfg; -+ -+ if ((is_hw_ant_div_on) && (phase != BT_8723D_1ANT_PHASE_ANTENNA_DET)) -+ -+ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) -+ /* 0x948 = 0x200, 0x0 while antenna diversity */ -+ btcoexist->btc_write_2byte(btcoexist, 0x948, 0x100); -+ else /* 0x948 = 0x80, 0x0 while antenna diversity */ -+ btcoexist->btc_write_2byte(btcoexist, 0x948, 0x40); -+ -+ else if ((is_hw_ant_div_on == false) && -+ (phase != BT_8723D_1ANT_PHASE_WLAN_OFF)) { /* internal switch setting */ -+ -+ switch (ant_pos_type) { -+ -+ case BTC_ANT_PATH_WIFI: -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ -+ btcoexist->btc_write_2byte( -+ btcoexist, 0x948, 0x0); -+ else -+ btcoexist->btc_write_2byte( -+ btcoexist, 0x948, 0x280); -+ -+ break; -+ case BTC_ANT_PATH_BT: -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ -+ btcoexist->btc_write_2byte( -+ btcoexist, 0x948, 0x280); -+ else -+ btcoexist->btc_write_2byte( -+ btcoexist, 0x948, 0x0); -+ -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ btcoexist->btc_write_2byte( -+ btcoexist, 0x948, -+ 0x200); -+ else -+ btcoexist->btc_write_2byte( -+ btcoexist, 0x948, 0x80); -+ break; -+ } -+ } -+ -+ -+#if BT_8723D_1ANT_COEX_DBG -+ u32tmp1 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa); -+ u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); -+ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(After Set Ant Pat)\n", -+ u8tmp0, u16tmp1, u8tmp1); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa = 0x%x(After Set Ant Path)\n", -+ u32tmp1, u32tmp2, u16tmp0); -+ BTC_TRACE(trace_buf); -+#endif -+ -+} -+ -+ -+boolean halbtc8723d1ant_is_common_action(IN struct btc_coexist *btcoexist) -+{ -+ boolean common = false, wifi_connected = false, wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!wifi_connected && -+ BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ common = true; -+ } else if (wifi_connected && -+ (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ common = true; -+ } else if (wifi_connected && -+ (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE != -+ coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ common = true; -+ } else { -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ common = false; -+ } -+ -+ return common; -+} -+ -+ -+/* ********************************************* -+ * -+ * Non-Software Coex Mechanism start -+ * -+ * ********************************************* */ -+void halbtc8723d1ant_action_bt_whql_test(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8723d1ant_action_bt_hs(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8723d1ant_action_bt_relink(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ coex_sta->bt_relink_downcount = 2; -+} -+ -+void halbtc8723d1ant_action_bt_idle(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!wifi_busy) { -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ } else { -+ /* if wl busy */ -+ if (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 8); -+ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); -+ } else { -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ } -+} -+ -+} -+ -+void halbtc8723d1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, wifi_busy = false, bt_busy = false; -+ boolean wifi_scan = false, wifi_link = false, wifi_roam = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); -+ -+ -+ if ((coex_sta->bt_create_connection) && ((wifi_link) || (wifi_roam) -+ || (wifi_scan) || (wifi_busy) || (coex_sta->wifi_is_high_pri_task))) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi link/roam/Scan/busy/hi-pri-task + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ -+ if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist)) -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 17); -+ else -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); -+ } else if ((!wifi_connected) && (!wifi_scan)) { -+ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if (bt_link_info->pan_exist) { -+ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ } else if (bt_link_info->a2dp_exist) { -+ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16); -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ -+ if ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy) -+ || (coex_sta->wifi_is_high_pri_task)) -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); -+ else -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } -+} -+ -+ -+void halbtc8723d1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, wifi_busy = false; -+ u32 wifi_bw = 1; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, -+ &wifi_bw); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ -+ if (bt_link_info->sco_exist) { -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 5); -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 5); -+ } else if (coex_sta->hid_busy_num >= 2) { -+ /*for 4/18 hid */ -+ /* if 11bg mode */ -+ if (wifi_bw == 0) { -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 6); -+ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x1, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 11); -+ } else { -+ -+ if (wifi_busy) { -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 6); -+ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x2, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 11); -+ } else { -+ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 6); -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 3); -+ -+ } -+ } -+ } else { -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 6); -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 3); -+ } -+} -+ -+ -+void halbtc8723d1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ /* halbtc8723d1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 10); -+} -+ -+void halbtc8723d1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ -+ if ((BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) || -+ (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status)) -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ else if (!bt_link_info->pan_exist) -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ else -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8723d1ant_action_wifi_linkscan_process(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ if (bt_link_info->pan_exist) { -+ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ } else if (bt_link_info->a2dp_exist) { -+ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 27); -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } -+} -+ -+void halbtc8723d1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_busy = false, wifi_turbo = false; -+ u32 wifi_bw = 1; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], scan_ap_num = %d, wl_noisy_level = %d\n", -+ coex_sta->scan_ap_num, coex_sta->wl_noisy_level); -+ BTC_TRACE(trace_buf); -+ -+#if 1 -+ if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) -+ wifi_turbo = true; -+#endif -+ -+ if ((coex_sta->bt_relink_downcount != 0) -+ && (!bt_link_info->pan_exist) && (wifi_busy)) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); -+ BTC_TRACE(trace_buf); -+ -+ /*halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32);*/ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ } else if (bt_link_info->a2dp_only) { /* A2DP */ -+ if (!wifi_busy) { -+ /*halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32);*/ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 27); -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ -+ if (coex_sta->wl_noisy_level == 2) -+ halbtc8723d1ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 17); -+ else -+ halbtc8723d1ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ -+ if (wifi_turbo) -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 8); -+ else -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if (((bt_link_info->a2dp_exist) && -+ (bt_link_info->pan_exist)) || -+ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ -+ -+ if ((bt_link_info->hid_exist) && (coex_sta->hid_busy_num >= 2)) { -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 6); -+ if (wifi_bw == 0) /* 11bg mode */ -+ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x1, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ else -+ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x2, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 12); -+ } else if (wifi_busy) { -+ if (((coex_sta->a2dp_bit_pool > 40) && -+ (coex_sta->a2dp_bit_pool < 255)) || -+ (!coex_sta->is_A2DP_3M)) -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 15); -+ else if (wifi_turbo) -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 18); -+ else -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 13); -+ } else -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 14); -+ -+ if (bt_link_info->hid_exist) -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ else if (wifi_turbo) -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 8); -+ else -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { /* HID+A2DP */ -+ -+ if ((wifi_busy) && (coex_sta->hid_busy_num >= 2)) { /*for 4/18 hid */ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 6); -+ if (wifi_bw == 0) /* 11bg mode */ -+ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x1, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ else -+ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x2, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 9); -+ } else { -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 8); -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } -+ -+ } else if ((bt_link_info->pan_only) -+ || (bt_link_info->hid_exist && bt_link_info->pan_exist)) { -+ /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ -+ -+ if ((bt_link_info->hid_exist) && (bt_link_info->pan_exist) && -+ (coex_sta->hid_busy_num >= 2)) { -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 6); -+ if (wifi_bw == 0) /* 11bg mode */ -+ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x1, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ else -+ halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x2, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 12); -+ } else { -+ if (!wifi_busy) -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 4); -+ else -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 3); -+ -+ if (bt_link_info->hid_exist) -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ else if (wifi_turbo) -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 8); -+ else -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else { -+ /* BT no-profile busy (0x9) */ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } -+} -+ -+void halbtc8723d1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -+{ -+ /* tdma and coex table */ -+ halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+ -+void halbtc8723d1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_busy = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ -+ if (BT_8723D_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ -+ if (bt_link_info->hid_only) /* HID only */ -+ halbtc8723d1ant_action_bt_sco_hid_only_busy(btcoexist); -+ else -+ halbtc8723d1ant_action_wifi_connected_bt_acl_busy(btcoexist); -+ -+ } else if ((BT_8723D_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8723d1ant_action_bt_sco_hid_only_busy(btcoexist); -+ } else -+ halbtc8723d1ant_action_bt_idle(btcoexist); -+} -+ -+ -+void halbtc8723d1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ u8 algorithm = 0; -+ -+ algorithm = halbtc8723d1ant_action_algorithm(btcoexist); -+ coex_dm->cur_algorithm = algorithm; -+ -+ if (halbtc8723d1ant_is_common_action(btcoexist)) { -+ -+ } else { -+ switch (coex_dm->cur_algorithm) { -+ case BT_8723D_1ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ break; -+ case BT_8723D_1ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ break; -+ case BT_8723D_1ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ break; -+ case BT_8723D_1ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ break; -+ case BT_8723D_1ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ break; -+ case BT_8723D_1ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ break; -+ case BT_8723D_1ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ break; -+ case BT_8723D_1ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ break; -+ case BT_8723D_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ break; -+ case BT_8723D_1ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+} -+ -+ -+void halbtc8723d1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ boolean increase_scan_dev_num = false; -+ boolean bt_ctrl_agg_buf_size = false; -+ boolean miracast_plus_bt = false, wifi_under_5g = false; -+ u8 agg_buf_size = 5; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0, wifi_bw; -+ u8 iot_peer = BTC_IOT_PEER_UNKNOWN; -+ boolean scan = false, link = false, roam = false, under_4way = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (!coex_sta->run_time_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], return for run_time_state = false !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->freeze_coexrun_by_btinfo) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), return for freeze_coexrun_by_btinfo\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->bt_whck_test) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under WHCK TEST!!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d1ant_action_bt_whql_test(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!!\n"); -+ halbtc8723d1ant_action_wifi_only(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under inquiry/page scan !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d1ant_action_bt_inquiry(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->is_setupLink) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is re-link !!!\n"); -+ halbtc8723d1ant_action_bt_relink(btcoexist); -+ return; -+ } -+ -+ if ((BT_8723D_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8723D_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ increase_scan_dev_num = true; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, -+ &increase_scan_dev_num); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if ((num_of_wifi_link >= 2) || -+ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", -+ num_of_wifi_link, wifi_link_status); -+ BTC_TRACE(trace_buf); -+ -+ if (bt_link_info->bt_link_exist) -+ miracast_plus_bt = true; -+ else -+ miracast_plus_bt = false; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ -+ halbtc8723d1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ false, 0x5); -+ -+ if (scan || link || roam || under_4way) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n", -+ scan, link, roam, under_4way); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under linkscan process + Multi-Port !!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_action_wifi_linkscan_process(btcoexist); -+ } else -+ -+ halbtc8723d1ant_action_wifi_multi_port(btcoexist); -+ -+ return; -+ } else { -+ -+ miracast_plus_bt = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); -+ -+ if (BTC_IOT_PEER_CISCO == iot_peer) { -+ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ halbtc8723d1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, true, 0x10); -+ else -+ halbtc8723d1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, true, 0x8); -+ } else -+ halbtc8723d1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x5); -+ } -+ -+ halbtc8723d1ant_run_sw_coexist_mechanism( -+ btcoexist); /* just print debug message */ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is hs\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d1ant_action_bt_hs(btcoexist); -+ return; -+ } -+ -+ if ((BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) || -+ (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is idle\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d1ant_action_bt_idle(btcoexist); -+ return; -+ } -+ -+ if (scan || link || roam || under_4way) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n", -+ scan, link, roam, under_4way); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under linkscan process!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_action_wifi_linkscan_process(btcoexist); -+ } else if (wifi_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under connected!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_action_wifi_connected(btcoexist); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under not-connected!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_action_wifi_not_connected(btcoexist); -+ } -+} -+ -+ -+void halbtc8723d1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->pop_event_cnt = 0; -+ coex_sta->cnt_RemoteNameReq = 0; -+ coex_sta->cnt_ReInit = 0; -+ coex_sta->cnt_setupLink = 0; -+ coex_sta->cnt_IgnWlanAct = 0; -+ coex_sta->cnt_Page = 0; -+ coex_sta->cnt_RoleSwitch = 0; -+ -+ halbtc8723d1ant_query_bt_info(btcoexist); -+} -+ -+void halbtc8723d1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean back_up, IN boolean wifi_only) -+{ -+ u32 u32tmp1 = 0, u32tmp2 = 0; -+ u16 u16tmp1 = 0; -+ u8 u8tmp0 = 0, u8tmp1 = 0; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 i = 0; -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 1Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+#if BT_8723D_1ANT_COEX_DBG -+ u32tmp1 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x38); -+ u32tmp2 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x54); -+ u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); -+ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before init_hw_config)\n", -+ u8tmp0, u16tmp1, u8tmp1); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x (Before init_hw_config)\n", -+ u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+#endif -+ -+ -+ coex_sta->bt_coex_supported_feature = 0; -+ coex_sta->bt_coex_supported_version = 0; -+ coex_sta->bt_ble_scan_type = 0; -+ coex_sta->bt_ble_scan_para[0] = 0; -+ coex_sta->bt_ble_scan_para[1] = 0; -+ coex_sta->bt_ble_scan_para[2] = 0; -+ coex_sta->bt_reg_vendor_ac = 0xffff; -+ coex_sta->bt_reg_vendor_ae = 0xffff; -+ coex_sta->isolation_btween_wb = BT_8723D_1ANT_DEFAULT_ISOLATION; -+ coex_sta->gnt_error_cnt = 0; -+ coex_sta->bt_relink_downcount = 0; -+ -+ for (i = 0; i <= 9; i++) -+ coex_sta->bt_afh_map[i] = 0; -+ -+ /* 0xf0[15:12] --> Chip Cut information */ -+ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, -+ 0xf1) & 0xf0) >> 4; -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ -+ /* BT report packet sample rate */ -+ btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); -+ -+ /* Init 0x778 = 0x1 for 1-Ant */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); -+ -+ /* Enable PTA (3-wire function form BT side) */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); -+ -+ /* Enable PTA (tx/rx signal form WiFi side) */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); -+ -+ halbtc8723d1ant_enable_gnt_to_gpio(btcoexist, true); -+ -+#if 0 -+ /* check if WL firmware download ok */ -+ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ONOFF, true); -+#endif -+ -+ /* PTA parameter */ -+ halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ psd_scan->ant_det_is_ant_det_available = true; -+ -+ /* Antenna config */ -+ if (wifi_only) { -+ coex_sta->concurrent_rx_mode_on = false; -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_WLANONLY_INIT); -+ -+ btcoexist->stop_coex_dm = true; -+ } else { -+ /*Set BT polluted packet on for Tx rate adaptive not including Tx retry break by PTA, 0x45c[19] =1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); -+ -+ coex_sta->concurrent_rx_mode_on = true; -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); -+ /* RF 0x1[0] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x1, 0x0); -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_COEX_INIT); -+ -+ btcoexist->stop_coex_dm = false; -+ } -+ -+ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** Single Antenna, Antenna at Main Port: S1**********\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** Single Antenna, Antenna at Aux Port: S0**********\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+} -+ -+u32 halbtc8723d1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) -+{ -+ u8 j; -+ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; -+ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, -+ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, -+ 32, 23, 15, 7, 0 -+ }; -+ -+ if (val == 0) -+ return 0; -+ -+ tmp = val; -+ -+ while (1) { -+ if (tmp == 1) -+ break; -+ else { -+ tmp = (tmp >> 1); -+ shiftcount++; -+ } -+ } -+ -+ -+ val_integerd_b = shiftcount + 1; -+ -+ tmp2 = 1; -+ for (j = 1; j <= val_integerd_b; j++) -+ tmp2 = tmp2 * 2; -+ -+ tmp = (val * 100) / tmp2; -+ tindex = tmp / 5; -+ -+ if (tindex > 20) -+ tindex = 20; -+ -+ val_fractiond_b = table_fraction[tindex]; -+ -+ result = val_integerd_b * 100 - val_fractiond_b; -+ -+ return result; -+ -+ -+} -+ -+void halbtc8723d1ant_psd_show_antenna_detect_result(IN struct btc_coexist -+ *btcoexist) -+{ -+ u8 *cli_buf = btcoexist->cli_buf; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n============[Antenna Detection info] ============\n"); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->ant_det_result == 12) { /* Get Ant Det from BT */ -+ -+ if (board_info->btdm_ant_num_by_ant_det == 1) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "1-Antenna", -+ BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT, -+ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION); -+ else { -+ -+ if (psd_scan->ant_det_psd_scan_peak_val > -+ (BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) -+ * 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s (>%d)", -+ "Ant Det Result", "2-Antenna (Bad-Isolation)", -+ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "2-Antenna (Good-Isolation)", -+ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION, -+ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ } -+ } else if (psd_scan->ant_det_result == 1) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", -+ "Ant Det Result", "2-Antenna (Bad-Isolation)", -+ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else if (psd_scan->ant_det_result == 2) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "2-Antenna (Good-Isolation)", -+ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset, -+ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "1-Antenna", -+ BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT, -+ BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset); -+ -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", -+ "Antenna Detection Finish", -+ (board_info->btdm_ant_det_finish -+ ? "Yes" : "No")); -+ CL_PRINTF(cli_buf); -+ -+ switch (psd_scan->ant_det_result) { -+ case 0: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is not available)"); -+ break; -+ case 1: /* 2-Ant bad-isolation */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 2: /* 2-Ant good-isolation */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 3: /* 1-Ant */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 4: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Uncertainty result)"); -+ break; -+ case 5: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); -+ break; -+ case 6: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(WiFi is Scanning)"); -+ break; -+ case 7: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is not idle)"); -+ break; -+ case 8: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Abort by WiFi Scanning)"); -+ break; -+ case 9: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Antenna Init is not ready)"); -+ break; -+ case 10: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is Inquiry or page)"); -+ break; -+ case 11: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is Disabled)"); -+ case 12: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available, result from BT"); -+ break; -+ } -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->ant_det_result == 12) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", -+ "PSD Scan Peak Value", -+ psd_scan->ant_det_psd_scan_peak_val / 100); -+ CL_PRINTF(cli_buf); -+ return; -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Ant Detect Total Count", psd_scan->ant_det_try_count); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Ant Detect Fail Count", psd_scan->ant_det_fail_count); -+ CL_PRINTF(cli_buf); -+ -+ if ((!board_info->btdm_ant_det_finish) && -+ (psd_scan->ant_det_result != 5)) -+ return; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", -+ (psd_scan->ant_det_result ? "ok" : "fail")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", -+ psd_scan->ant_det_bt_tx_time); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", -+ psd_scan->ant_det_bt_le_channel); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", -+ "WiFi PSD Cent-Ch/Offset/Span", -+ psd_scan->real_cent_freq, psd_scan->real_offset, -+ psd_scan->real_span); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", -+ "PSD Pre-Scan Peak Value", -+ psd_scan->ant_det_pre_psdscan_peak_val / 100); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", -+ "PSD Pre-Scan result", -+ (psd_scan->ant_det_result != 5 ? "ok" : "fail"), -+ BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->ant_det_result == 5) -+ return; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", -+ "PSD Scan Peak Value", psd_scan->ant_det_peak_val); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", -+ "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", -+ (board_info->tfbga_package) ? "Yes" : "No"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "PSD Threshold Offset", psd_scan->ant_det_thres_offset); -+ CL_PRINTF(cli_buf); -+ -+} -+ -+ -+ -+void halbtc8723d1ant_psd_showdata(IN struct btc_coexist *btcoexist) -+{ -+ u8 *cli_buf = btcoexist->cli_buf; -+ u32 delta_freq_per_point; -+ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; -+ -+ if (psd_scan->ant_det_result == 12) -+ return; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n\n============[PSD info] (%d)============\n", -+ psd_scan->psd_gen_count); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->psd_gen_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); -+ CL_PRINTF(cli_buf); -+ return; -+ } -+ -+ if (psd_scan->psd_point == 0) -+ delta_freq_per_point = 0; -+ else -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* if (psd_scan->is_psd_show_max_only) */ -+ if (0) { -+ psd_rep1 = psd_scan->psd_max_value / 100; -+ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; -+ -+ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + -+ psd_scan->psd_max_value_point * delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.0%d MHz", -+ freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.%d MHz", -+ freq1, freq2); -+ -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.0%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ -+ CL_PRINTF(cli_buf); -+ } else { -+ m = psd_scan->psd_start_point; -+ n = psd_scan->psd_start_point; -+ i = 1; -+ j = 1; -+ -+ while (1) { -+ do { -+ freq = ((psd_scan->real_cent_freq - 20) * -+ 1000000 + m * -+ delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (i == 1) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.000", -+ freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.0%2d", -+ freq1, -+ freq2); -+ else -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.%3d", -+ freq1, -+ freq2); -+ } else if ((i % 8 == 0) || -+ (m == psd_scan->psd_stop_point)) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%6d.000\n", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%6d.0%2d\n", freq1, -+ freq2); -+ else -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%6d.%3d\n", freq1, -+ freq2); -+ } else { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%6d.0%2d", freq1, -+ freq2); -+ else -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%6d.%3d", freq1, -+ freq2); -+ } -+ -+ i++; -+ m++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); -+ -+ -+ do { -+ psd_rep1 = psd_scan->psd_report_max_hold[n] / -+ 100; -+ psd_rep2 = psd_scan->psd_report_max_hold[n] - -+ psd_rep1 * -+ 100; -+ -+ if (j == 1) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.0%d", -+ psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.%d", -+ psd_rep1, -+ psd_rep2); -+ } else if ((j % 8 == 0) || -+ (n == psd_scan->psd_stop_point)) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%7d.0%d\n", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%7d.%d\n", psd_rep1, -+ psd_rep2); -+ } else { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%7d.0%d", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%7d.%d", psd_rep1, -+ psd_rep2); -+ } -+ -+ j++; -+ n++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); -+ -+ if ((m > psd_scan->psd_stop_point) || -+ (n > psd_scan->psd_stop_point)) -+ break; -+ else { -+ i = 1; -+ j = 1; -+ } -+ -+ } -+ } -+ -+ -+} -+ -+ -+#ifdef PLATFORM_WINDOWS -+#pragma optimize("", off) -+#endif -+void halbtc8723d1ant_psd_maxholddata(IN struct btc_coexist *btcoexist, -+ IN u32 gen_count) -+{ -+ u32 i = 0; -+ u32 loop_i_max = 0, loop_val_max = 0; -+ -+ if (gen_count == 1) { -+ memcpy(psd_scan->psd_report_max_hold, -+ psd_scan->psd_report, -+ BT_8723D_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); -+ } -+ -+ for (i = psd_scan->psd_start_point; -+ i <= psd_scan->psd_stop_point; i++) { -+ -+ /* update max-hold value at each freq point */ -+ if (psd_scan->psd_report[i] > psd_scan->psd_report_max_hold[i]) -+ psd_scan->psd_report_max_hold[i] = -+ psd_scan->psd_report[i]; -+ -+ /* search the max value in this seep */ -+ if (psd_scan->psd_report[i] > loop_val_max) { -+ loop_val_max = psd_scan->psd_report[i]; -+ loop_i_max = i; -+ } -+ } -+ -+ if (gen_count <= BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT) -+ psd_scan->psd_loop_max_value[gen_count - 1] = loop_val_max; -+} -+ -+#ifdef PLATFORM_WINDOWS -+#pragma optimize("", off) -+#endif -+u32 halbtc8723d1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) -+{ -+ /* reg 0x808[9:0]: FFT data x */ -+ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ -+ /* reg 0x8b4[15:0]: FFT data y report */ -+ -+ u32 val = 0, psd_report = 0; -+ int k = 0; -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ -+ val &= 0xffbffc00; -+ val |= point; -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ val |= 0x00400000; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ while (1) { -+ if (k++ > BT_8723D_1ANT_ANTDET_SWEEPPOINT_DELAY) -+ break; -+ } -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); -+ -+ psd_report = val & 0x0000ffff; -+ -+ return psd_report; -+} -+ -+#ifdef PLATFORM_WINDOWS -+#pragma optimize("", off) -+#endif -+boolean halbtc8723d1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, -+ IN u32 avgnum, IN u32 loopcnt) -+{ -+ u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; -+ u32 points1 = 0, psd_report = 0; -+ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; -+ u32 psd_center_freq = 20 * 10 ^ 6; -+ boolean outloop = false, scan , roam, is_sweep_ok = true; -+ u8 flag = 0; -+ u32 tmp = 0, u32tmp1 = 0; -+ u32 wifi_original_channel = 1; -+ u32 psd_sum = 0, avg_cnt = 0; -+ u32 i_max = 0, val_max = 0, val_max2 = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ do { -+ switch (flag) { -+ case 0: /* Get PSD parameters */ -+ default: -+ -+ psd_scan->psd_band_width = 40 * 1000000; -+ psd_scan->psd_point = points; -+ psd_scan->psd_start_base = points / 2; -+ psd_scan->psd_avg_num = avgnum; -+ psd_scan->real_cent_freq = cent_freq; -+ psd_scan->real_offset = offset; -+ psd_scan->real_span = span; -+ -+ -+ points1 = psd_scan->psd_point; -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* PSD point setup */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffff0fff; -+ -+ switch (psd_scan->psd_point) { -+ case 128: -+ val |= 0x0; -+ break; -+ case 256: -+ default: -+ val |= 0x00004000; -+ break; -+ case 512: -+ val |= 0x00008000; -+ break; -+ case 1024: -+ val |= 0x0000c000; -+ break; -+ } -+ -+ switch (psd_scan->psd_avg_num) { -+ case 1: -+ val |= 0x0; -+ break; -+ case 8: -+ val |= 0x00001000; -+ break; -+ case 16: -+ val |= 0x00002000; -+ break; -+ case 32: -+ default: -+ val |= 0x00003000; -+ break; -+ } -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ flag = 1; -+ break; -+ case 1: /* calculate the PSD point index from freq/offset/span */ -+ psd_center_freq = psd_scan->psd_band_width / 2 + -+ offset * (1000000); -+ -+ start_p = psd_scan->psd_start_base + (psd_center_freq - -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_start_point = start_p - -+ psd_scan->psd_start_base; -+ -+ stop_p = psd_scan->psd_start_base + (psd_center_freq + -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_stop_point = stop_p - -+ psd_scan->psd_start_base - 1; -+ -+ flag = 2; -+ break; -+ case 2: /* set RF channel/BW/Mode */ -+ -+ /* set 3-wire off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val |= 0x00300000; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val &= 0xfeffffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* Tx-pause on */ -+ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); -+ -+ /* store WiFi original channel */ -+ wifi_original_channel = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x18, 0x3ff); -+ -+ /* Set RF channel */ -+ if (cent_freq == 2484) -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, 0xe); -+ else -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, (cent_freq - 2412) / 5 + -+ 1); /* WiFi TRx Mask on */ -+ -+ /* save original RCK value */ -+ u32tmp1 = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x1d, 0xfffff); -+ -+ /* Enter debug mode */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, -+ 0x2, 0x1); -+ -+ /* Set RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, -+ 0xfffff, 0x2e); -+ -+ -+ /* Set RF mode = Rx, RF Gain = 0x320a0 */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, -+ 0xfffff, 0x320a0); -+ -+ while (1) { -+ if (k++ > BT_8723D_1ANT_ANTDET_SWEEPPOINT_DELAY) -+ break; -+ } -+ flag = 3; -+ break; -+ case 3: -+ psd_scan->psd_gen_count = 0; -+ for (j = 1; j <= loopcnt; j++) { -+ -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || roam) { -+ is_sweep_ok = false; -+ break; -+ } -+ memset(psd_scan->psd_report, 0, -+ psd_scan->psd_point * sizeof(u32)); -+ start_p = psd_scan->psd_start_point + -+ psd_scan->psd_start_base; -+ stop_p = psd_scan->psd_stop_point + -+ psd_scan->psd_start_base + 1; -+ -+ i = start_p; -+ point_index = 0; -+ -+ while (i < stop_p) { -+ if (i >= points1) -+ psd_report = -+ halbtc8723d1ant_psd_getdata( -+ btcoexist, i - points1); -+ else -+ psd_report = -+ halbtc8723d1ant_psd_getdata( -+ btcoexist, i); -+ -+ if (psd_report == 0) -+ tmp = 0; -+ else -+ /* tmp = 20*log10((double)psd_report); */ -+ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ -+ tmp = 6 * halbtc8723d1ant_psd_log2base( -+ btcoexist, psd_report); -+ -+ n = i - psd_scan->psd_start_base; -+ psd_scan->psd_report[n] = tmp; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Point=%d, psd_dB_data = %d\n", -+ i, psd_scan->psd_report[n]); -+ BTC_TRACE(trace_buf); -+ -+ i++; -+ -+ } -+ -+ halbtc8723d1ant_psd_maxholddata(btcoexist, j); -+ -+ psd_scan->psd_gen_count = j; -+ -+ /*Accumulate Max PSD value in this loop if the value > threshold */ -+ if (psd_scan->psd_loop_max_value[j - 1] >= -+ 4000) { -+ psd_sum = psd_sum + -+ psd_scan->psd_loop_max_value[j - -+ 1]; -+ avg_cnt++; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Loop=%d, Max_dB_data = %d\n", -+ j, psd_scan->psd_loop_max_value[j -+ - 1]); -+ BTC_TRACE(trace_buf); -+ -+ } -+ -+ if (loopcnt == BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT) { -+ -+ /* search the Max Value between each-freq-point-max-hold value of all sweep*/ -+ for (i = 1; -+ i <= BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT; -+ i++) { -+ -+ if (i == 1) { -+ i_max = i; -+ val_max = psd_scan->psd_loop_max_value[i -+ - 1]; -+ val_max2 = -+ psd_scan->psd_loop_max_value[i -+ - 1]; -+ } else if ( -+ psd_scan->psd_loop_max_value[i - -+ 1] > val_max) { -+ val_max2 = val_max; -+ i_max = i; -+ val_max = psd_scan->psd_loop_max_value[i -+ - 1]; -+ } else if ( -+ psd_scan->psd_loop_max_value[i - -+ 1] > val_max2) -+ val_max2 = -+ psd_scan->psd_loop_max_value[i -+ - 1]; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "i = %d, val_hold= %d, val_max = %d, val_max2 = %d\n", -+ i, psd_scan->psd_loop_max_value[i -+ - 1], -+ val_max, val_max2); -+ -+ BTC_TRACE(trace_buf); -+ } -+ -+ psd_scan->psd_max_value_point = i_max; -+ psd_scan->psd_max_value = val_max; -+ psd_scan->psd_max_value2 = val_max2; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "val_max = %d, val_max2 = %d\n", -+ psd_scan->psd_max_value, -+ psd_scan->psd_max_value2); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (avg_cnt != 0) { -+ psd_scan->psd_avg_value = (psd_sum / avg_cnt); -+ if ((psd_sum % avg_cnt) >= (avg_cnt / 2)) -+ psd_scan->psd_avg_value++; -+ } else -+ psd_scan->psd_avg_value = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "AvgLoop=%d, Avg_dB_data = %d\n", -+ avg_cnt, psd_scan->psd_avg_value); -+ BTC_TRACE(trace_buf); -+ -+ flag = 100; -+ break; -+ case 99: /* error */ -+ -+ outloop = true; -+ break; -+ case 100: /* recovery */ -+ -+ /* set 3-wire on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val &= 0xffcfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val |= 0x01000000; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* Tx-pause off */ -+ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); -+ -+ /* PSD off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffbfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ /* restore RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, -+ 0xfffff, u32tmp1); -+ -+ /* Exit debug mode */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, -+ 0x2, 0x0); -+ -+ /* restore WiFi original channel */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, -+ 0x3ff, wifi_original_channel); -+ -+ outloop = true; -+ break; -+ -+ } -+ -+ } while (!outloop); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); -+ BTC_TRACE(trace_buf); -+ return is_sweep_ok; -+ -+} -+ -+#ifdef PLATFORM_WINDOWS -+#pragma optimize("", off) -+#endif -+boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist -+ *btcoexist) -+{ -+ u32 i = 0; -+ u32 wlpsd_cent_freq = 2484, wlpsd_span = 2; -+ s32 wlpsd_offset = -4; -+ u32 bt_tx_time, bt_le_channel; -+ u8 bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33}; -+ -+ u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; -+ -+ u8 state = 0; -+ boolean outloop = false, bt_resp = false, ant_det_finish = false; -+ u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, -+ u32tmp, u32tmp0, u32tmp1, u32tmp2 ; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); -+ memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); -+ -+ psd_scan->ant_det_bt_tx_time = -+ BT_8723D_1ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ -+ psd_scan->ant_det_bt_le_channel = BT_8723D_1ANT_ANTDET_BTTXCHANNEL; -+ -+ bt_tx_time = psd_scan->ant_det_bt_tx_time; -+ bt_le_channel = psd_scan->ant_det_bt_le_channel; -+ -+ if (board_info->tfbga_package) /* for TFBGA */ -+ psd_scan->ant_det_thres_offset = 5; -+ else -+ psd_scan->ant_det_thres_offset = 0; -+ -+ do { -+ switch (state) { -+ case 0: -+ if (bt_le_channel == 39) -+ wlpsd_cent_freq = 2484; -+ else { -+ for (i = 1; i <= 13; i++) { -+ if (bt_le_ch[i - 1] == -+ bt_le_channel) { -+ wlpsd_cent_freq = 2412 -+ + (i - 1) * 5; -+ break; -+ } -+ } -+ -+ if (i == 14) { -+ -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", -+ bt_le_channel); -+ BTC_TRACE(trace_buf); -+ outloop = true; -+ break; -+ } -+ } -+#if 0 -+ wlpsd_sweep_count = bt_tx_time * 238 / -+ 100; /* bt_tx_time/0.42 */ -+ wlpsd_sweep_count = wlpsd_sweep_count / 5; -+ -+ if (wlpsd_sweep_count % 5 != 0) -+ wlpsd_sweep_count = (wlpsd_sweep_count / -+ 5 + 1) * 5; -+#endif -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", -+ bt_tx_time, bt_le_channel); -+ BTC_TRACE(trace_buf); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", -+ wlpsd_cent_freq, -+ wlpsd_offset, -+ wlpsd_span, -+ BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT); -+ BTC_TRACE(trace_buf); -+ -+ state = 1; -+ break; -+ case 1: /* stop coex DM & set antenna path */ -+ /* Stop Coex DM */ -+ btcoexist->stop_coex_dm = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* Set TDMA off, */ -+ halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, -+ false, 0); -+ -+ /* Set coex table */ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, -+ FORCE_EXEC, 0); -+ -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ /* Set Antenna path, switch WiFi to un-certain antenna port */ -+ /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_ANTENNA_DET); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ -+ h2c_parameter[0] = 0x1; -+ h2c_parameter[1] = 0xd; -+ h2c_parameter[2] = 0x14; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", -+ h2c_parameter[1], -+ h2c_parameter[2]); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, -+ h2c_parameter); -+ -+ u32tmp = btcoexist->btc_read_2byte(btcoexist, 0x948); -+ u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70); -+ u32tmp1 = halbtc8723d1ant_ltecoex_indirect_read_reg( -+ btcoexist, 0x38); -+ u32tmp2 = halbtc8723d1ant_ltecoex_indirect_read_reg( -+ btcoexist, 0x54); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** 0x948 = 0x%x, 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Ant Det)\n", -+ u32tmp, u32tmp0, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ -+ state = 2; -+ break; -+ case 2: /* Pre-sweep background psd */ -+ if (!halbtc8723d1ant_psd_sweep_point(btcoexist, -+ wlpsd_cent_freq, wlpsd_offset, wlpsd_span, -+ BT_8723D_1ANT_ANTDET_PSD_POINTS, -+ BT_8723D_1ANT_ANTDET_PSD_AVGNUM, 3)) { -+ ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ psd_scan->ant_det_result = 8; -+ state = 99; -+ break; -+ } -+ -+ psd_scan->ant_det_pre_psdscan_peak_val = -+ psd_scan->psd_max_value; -+ -+ if (psd_scan->ant_det_pre_psdscan_peak_val > -+ (BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset) * 100) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", -+ psd_scan->ant_det_pre_psdscan_peak_val / -+ 100, -+ BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ BTC_TRACE(trace_buf); -+ ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ psd_scan->ant_det_result = 5; -+ state = 99; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", -+ psd_scan->ant_det_pre_psdscan_peak_val / -+ 100, -+ BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ BTC_TRACE(trace_buf); -+ state = 3; -+ } -+ break; -+ case 3: -+ -+ bt_resp = btcoexist->btc_set_bt_ant_detection( -+ btcoexist, (u8)(bt_tx_time & 0xff), -+ (u8)(bt_le_channel & 0xff)); -+ -+ /* Sync WL Rx PSD with BT Tx time because H2C->Mailbox delay */ -+ delay_ms(20); -+ -+ if (!halbtc8723d1ant_psd_sweep_point(btcoexist, -+ wlpsd_cent_freq, wlpsd_offset, -+ wlpsd_span, -+ BT_8723D_1ANT_ANTDET_PSD_POINTS, -+ BT_8723D_1ANT_ANTDET_PSD_AVGNUM, -+ BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT)) { -+ ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ psd_scan->ant_det_result = 8; -+ state = 99; -+ break; -+ } -+ -+#if 1 -+ psd_scan->ant_det_psd_scan_peak_val = -+ psd_scan->psd_max_value; -+#endif -+#if 0 -+ psd_scan->ant_det_psd_scan_peak_val = -+ ((psd_scan->psd_max_value - psd_scan->psd_avg_value) < -+ 800) ? -+ psd_scan->psd_max_value : (( -+ psd_scan->psd_max_value - -+ psd_scan->psd_max_value2 <= 300) ? -+ psd_scan->psd_avg_value : -+ psd_scan->psd_max_value2); -+#endif -+ psd_scan->ant_det_psd_scan_peak_freq = -+ psd_scan->psd_max_value_point; -+ state = 4; -+ break; -+ case 4: -+ -+ if (psd_scan->psd_point == 0) -+ delta_freq_per_point = 0; -+ else -+ delta_freq_per_point = -+ psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ psd_rep1 = psd_scan->ant_det_psd_scan_peak_val / 100; -+ psd_rep2 = psd_scan->ant_det_psd_scan_peak_val - -+ psd_rep1 * -+ 100; -+ -+ freq = ((psd_scan->real_cent_freq - 20) * -+ 1000000 + psd_scan->psd_max_value_point -+ * delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (freq2 < 100) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", -+ freq1, freq2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_freq, -+ BT_8723D_1ANT_ANTDET_BUF_LEN, -+ "%d.0%d", freq1, freq2); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", -+ freq1, freq2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_freq, -+ BT_8723D_1ANT_ANTDET_BUF_LEN, -+ "%d.%d", freq1, freq2); -+ } -+ -+ if (psd_rep2 < 10) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.0%d dB\n", -+ psd_rep1, psd_rep2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_val, -+ BT_8723D_1ANT_ANTDET_BUF_LEN, -+ "%d.0%d", psd_rep1, psd_rep2); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.%d dB\n", -+ psd_rep1, psd_rep2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_val, -+ BT_8723D_1ANT_ANTDET_BUF_LEN, -+ "%d.%d", psd_rep1, psd_rep2); -+ } -+ -+ psd_scan->ant_det_is_btreply_available = true; -+ -+ if (bt_resp == false) { -+ psd_scan->ant_det_is_btreply_available = -+ false; -+ psd_scan->ant_det_result = 0; -+ ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->ant_det_psd_scan_peak_val > -+ (BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) -+ * 100) { -+ psd_scan->ant_det_result = 1; -+ ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 2; -+ coex_sta->isolation_btween_wb = (u8)(85 - -+ psd_scan->ant_det_psd_scan_peak_val / -+ 100) & 0xff; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->ant_det_psd_scan_peak_val > -+ (BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset) * 100) { -+ psd_scan->ant_det_result = 2; -+ ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 2; -+ coex_sta->isolation_btween_wb = (u8)(85 - -+ psd_scan->ant_det_psd_scan_peak_val / -+ 100) & 0xff; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->ant_det_psd_scan_peak_val > -+ (BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT) * -+ 100) { -+ psd_scan->ant_det_result = 3; -+ ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ coex_sta->isolation_btween_wb = (u8)(85 - -+ psd_scan->ant_det_psd_scan_peak_val / -+ 100) & 0xff; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ psd_scan->ant_det_result = 4; -+ ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ state = 99; -+ break; -+ case 99: /* restore setup */ -+ -+ /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ -+ h2c_parameter[0] = 0x0; -+ h2c_parameter[1] = 0x0; -+ h2c_parameter[2] = 0x0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", -+ h2c_parameter[1], h2c_parameter[2]); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, -+ h2c_parameter); -+ -+ /* Set Antenna Path, GNT_WL/GNT_BT control by PTA */ -+ /* Set Antenna path, switch WiFi to certain antenna port */ -+ halbtc8723d1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ outloop = true; -+ break; -+ } -+ -+ } while (!outloop); -+ -+ return ant_det_finish; -+ -+} -+ -+#ifdef PLATFORM_WINDOWS -+#pragma optimize("", off) -+#endif -+boolean halbtc8723d1ant_psd_antenna_detection_check(IN struct btc_coexist -+ *btcoexist) -+{ -+ static u32 ant_det_count = 0, ant_det_fail_count = 0; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ boolean scan, roam, ant_det_finish = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ ant_det_count++; -+ -+ psd_scan->ant_det_try_count = ant_det_count; -+ -+ if (scan || roam) { -+ ant_det_finish = false; -+ psd_scan->ant_det_result = 6; -+ } else if (coex_sta->bt_disabled) { -+ ant_det_finish = false; -+ psd_scan->ant_det_result = 11; -+ } else if (coex_sta->num_of_profile >= 1) { -+ ant_det_finish = false; -+ psd_scan->ant_det_result = 7; -+ } else if ( -+ !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ -+ ant_det_finish = false; -+ psd_scan->ant_det_result = 9; -+ } else if (coex_sta->c2h_bt_inquiry_page) { -+ ant_det_finish = false; -+ psd_scan->ant_det_result = 10; -+ } else { -+ -+ ant_det_finish = halbtc8723d1ant_psd_antenna_detection( -+ btcoexist); -+ -+ delay_ms(psd_scan->ant_det_bt_tx_time); -+ } -+ -+ /* board_info->ant_det_result = psd_scan->ant_det_result; */ -+ -+ if (!ant_det_finish) -+ ant_det_fail_count++; -+ -+ psd_scan->ant_det_fail_count = ant_det_fail_count; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n", -+ psd_scan->ant_det_result, -+ psd_scan->ant_det_fail_count, -+ ant_det_finish == true ? "Yes" : "No"); -+ BTC_TRACE(trace_buf); -+ -+ return ant_det_finish; -+ -+} -+ -+ -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8723d1ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8723d1ant_ -+ * ************************************************************ */ -+void ex_halbtc8723d1ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp = 0x0; -+ u16 u16tmp = 0x0; -+ u32 value = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Execute 8723d 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Ant Det Finish = %s, Ant Det Number = %d\n", -+ (board_info->btdm_ant_det_finish ? "Yes" : "No"), -+ board_info->btdm_ant_num_by_ant_det); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = true; -+ psd_scan->ant_det_is_ant_det_available = false; -+ -+ /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ -+ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); -+ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); -+ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ -+ -+ /* Set Antenna Path to BT side */ -+ /* Check efuse 0xc3[6] for Single Antenna Path */ -+ if (board_info->single_ant_path == 0) { -+ /* set to S1 */ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+ u8tmp = 0; -+ value = 1; -+ } else if (board_info->single_ant_path == 1) { -+ /* set to S0 */ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; -+ u8tmp = 1; -+ value = 0; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (Power On) single_ant_path = %d, btdm_ant_pos = %d **********\n", -+ board_info->single_ant_path , board_info->btdm_ant_pos); -+ BTC_TRACE(trace_buf); -+ -+ /* Set Antenna Path to BT side */ -+ halbtc8723d1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_COEX_POWERON); -+ -+ /* Write Single Antenna Position to Registry to tell BT for 8723d. This line can be removed -+ since BT EFuse also add "single antenna position" in EFuse for 8723d*/ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, -+ &value); -+ -+ /* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at power on */ -+ if (btcoexist->chip_interface == BTC_INTF_PCI) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_USB) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_SDIO) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); -+ -+ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ -+ halbtc8723d1ant_enable_gnt_to_gpio(btcoexist, true); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", -+ halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0x948 (Power-On) = 0x%x / 0x%x**********\n", -+ btcoexist->btc_read_4byte(btcoexist, 0x70), -+ btcoexist->btc_read_2byte(btcoexist, 0x948)); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+void ex_halbtc8723d1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -+{ -+} -+ -+void ex_halbtc8723d1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ halbtc8723d1ant_init_hw_config(btcoexist, true, wifi_only); -+} -+ -+void ex_halbtc8723d1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723d1ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_stack_info *stack_info = &btcoexist->stack_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, ps_tdma_case = 0; -+ u16 u16tmp[4]; -+ u32 u32tmp[4]; -+ u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; -+ u32 fw_ver = 0, bt_patch_ver = 0, bt_coex_ver = 0; -+ static u8 pop_report_in_10s = 0, cnt = 0; -+ u32 phyver = 0; -+ boolean lte_coex_on = false; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ if (btcoexist->stop_coex_dm) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (!coex_sta->bt_disabled) { -+ if (coex_sta->bt_coex_supported_feature == 0) -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, -+ &coex_sta->bt_coex_supported_feature); -+ -+ if ((coex_sta->bt_coex_supported_version == 0) || -+ (coex_sta->bt_coex_supported_version == 0xffff)) -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, -+ &coex_sta->bt_coex_supported_version); -+ -+ if (coex_sta->bt_reg_vendor_ac == 0xffff) -+ coex_sta->bt_reg_vendor_ac = (u16)( -+ btcoexist->btc_get_bt_reg(btcoexist, 3, -+ 0xac) & 0xffff); -+ -+ if (coex_sta->bt_reg_vendor_ae == 0xffff) -+ coex_sta->bt_reg_vendor_ae = (u16)( -+ btcoexist->btc_get_bt_reg(btcoexist, 3, -+ 0xae) & 0xffff); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, -+ &bt_patch_ver); -+ btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; -+ -+ if (coex_sta->num_of_profile > 0) { -+ cnt++; -+ -+ if (cnt >= 3) { -+ btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, -+ &coex_sta->bt_afh_map[0]); -+ cnt = 0; -+ } -+ } -+ } -+ -+ if (psd_scan->ant_det_try_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", -+ "Ant PG Num/ Mech/ Pos", -+ board_info->pg_ant_num, board_info->btdm_ant_num, -+ (board_info->btdm_ant_pos == 1 ? "S1" : "S0")); -+ CL_PRINTF(cli_buf); -+ } else { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %s (%d/%d/%d)", -+ "Ant PG Num/ Mech(Ant_Det)/ Pos", -+ board_info->pg_ant_num, -+ board_info->btdm_ant_num_by_ant_det, -+ (board_info->btdm_ant_pos == 1 ? "S1" : "S0"), -+ psd_scan->ant_det_try_count, -+ psd_scan->ant_det_fail_count, -+ psd_scan->ant_det_result); -+ CL_PRINTF(cli_buf); -+ -+ if (board_info->btdm_ant_det_finish) { -+ -+ if (psd_scan->ant_det_result != 12) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", -+ "Ant Det PSD Value", -+ psd_scan->ant_det_peak_val); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d", -+ "Ant Det PSD Value", -+ psd_scan->ant_det_psd_scan_peak_val -+ / 100); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ if (board_info->ant_det_result_five_complete) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d", -+ "AntDet(Registry) Num/PSD Value", -+ board_info->btdm_ant_num_by_ant_det, -+ (board_info->antdetval & 0x7f)); -+ CL_PRINTF(cli_buf); -+ } -+ -+ bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); -+ -+ bt_coex_ver = ((coex_sta->bt_coex_supported_version & 0xff00) >> 8); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", -+ "CoexVer WL/ BT_Desired/ BT_Report", -+ glcoex_ver_date_8723d_1ant, glcoex_ver_8723d_1ant, -+ glcoex_ver_btdesired_8723d_1ant, -+ bt_coex_ver, -+ (bt_coex_ver == 0xff ? "Unknown" : -+ (coex_sta->bt_disabled ? "BT-disable" : -+ (bt_coex_ver >= glcoex_ver_btdesired_8723d_1ant ? -+ "Match" : "Mis-Match")))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", -+ "W_FW/ B_FW/ Phy/ Kt", -+ fw_ver, bt_patch_ver, phyver, -+ coex_sta->cut_version + 65); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ pop_report_in_10s++; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = [%s/ %d dBm/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt/ popCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") -+ : ((BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, -+ coex_sta->pop_event_cnt); -+ CL_PRINTF(cli_buf); -+ -+ if (pop_report_in_10s >= 5) { -+ coex_sta->pop_event_cnt = 0; -+ pop_report_in_10s = 0; -+ } -+ -+ if (coex_sta->num_of_profile != 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s%s%s%s%s", -+ "Profiles", -+ ((bt_link_info->a2dp_exist) ? "A2DP," : ""), -+ ((bt_link_info->sco_exist) ? "SCO," : ""), -+ ((bt_link_info->hid_exist) ? -+ ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : -+ "HID(2/18),") : ""), -+ ((bt_link_info->pan_exist) ? "PAN," : ""), -+ ((coex_sta->voice_over_HOGP) ? "Voice" : "")); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = None", -+ "Profiles"); -+ -+ CL_PRINTF(cli_buf); -+ -+ if (bt_link_info->a2dp_exist) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s", -+ "A2DP Rate/Bitpool/Auto_Slot", -+ ((coex_sta->is_A2DP_3M) ? "3M" : "No_3M"), -+ coex_sta->a2dp_bit_pool, -+ ((coex_sta->is_autoslot) ? "On" : "Off") -+ ); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (bt_link_info->hid_exist) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "HID PairNum/Forbid_Slot", -+ coex_sta->hid_pair_cnt, -+ coex_sta->forbidden_slot -+ ); -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s/ 0x%x", -+ "Role/RoleSwCnt/IgnWlact/Feature", -+ ((bt_link_info->slave_role) ? "Slave" : "Master"), -+ coex_sta->cnt_RoleSwitch, -+ ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"), -+ coex_sta->bt_coex_supported_feature); -+ CL_PRINTF(cli_buf); -+ -+ if ((coex_sta->bt_ble_scan_type & 0x7) != 0x0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "BLEScan Type/TV/Init/Ble", -+ coex_sta->bt_ble_scan_type, -+ (coex_sta->bt_ble_scan_type & 0x1 ? -+ coex_sta->bt_ble_scan_para[0] : 0x0), -+ (coex_sta->bt_ble_scan_type & 0x2 ? -+ coex_sta->bt_ble_scan_para[1] : 0x0), -+ (coex_sta->bt_ble_scan_type & 0x4 ? -+ coex_sta->bt_ble_scan_para[2] : 0x0)); -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", -+ "ReInit/ReLink/IgnWlact/Page/NameReq", -+ coex_sta->cnt_ReInit, -+ coex_sta->cnt_setupLink, -+ coex_sta->cnt_IgnWlanAct, -+ coex_sta->cnt_Page, -+ coex_sta->cnt_RemoteNameReq -+ ); -+ CL_PRINTF(cli_buf); -+ -+ halbtc8723d1ant_read_score_board(btcoexist, &u16tmp[0]); -+ -+ if ((coex_sta->bt_reg_vendor_ae == 0xffff) || -+ (coex_sta->bt_reg_vendor_ac == 0xffff)) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ %04x", -+ "0xae[4]/0xac[1:0]/Scoreboard", u16tmp[0]); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ %04x", -+ "0xae[4]/0xac[1:0]/Scoreboard", -+ ((coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4), -+ coex_sta->bt_reg_vendor_ac & 0x3, u16tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ if (coex_sta->num_of_profile > 0) { -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x", -+ "AFH MAP", -+ coex_sta->bt_afh_map[0], -+ coex_sta->bt_afh_map[1], -+ coex_sta->bt_afh_map[2], -+ coex_sta->bt_afh_map[3], -+ coex_sta->bt_afh_map[4], -+ coex_sta->bt_afh_map[5], -+ coex_sta->bt_afh_map[6], -+ coex_sta->bt_afh_map[7], -+ coex_sta->bt_afh_map[8], -+ coex_sta->bt_afh_map[9] -+ ); -+ CL_PRINTF(cli_buf); -+ } -+ -+ for (i = 0; i < BT_INFO_SRC_8723D_1ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x (%d)", -+ glbt_info_src_8723d_1ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ -+ if (btcoexist->manual_control) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms] (before Manual)============"); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Mechanisms]============"); -+ -+ CL_PRINTF(cli_buf); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x (case-%d, %s)", -+ "TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ (coex_dm->cur_ps_tdma_on ? "TDMA On" : "TDMA Off")); -+ -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ 0x%x/ 0x%x/ 0x%x", -+ "Table/0x6c0/0x6c4/0x6c8", -+ coex_sta->coex_table_type, u32tmp[0], u32tmp[1], u32tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x", -+ "0x778/0x6cc", -+ u8tmp[0], u32tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", -+ "AntDiv/ ForceLPS", -+ ((board_info->ant_div_cfg) ? "On" : "Off"), -+ ((coex_sta->force_lps_on) ? "On" : "Off")); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? true : false; -+ -+ if (lte_coex_on) { -+ -+ u32tmp[0] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa0); -+ u32tmp[1] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "LTE Coex Table W_L/B_L", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa8); -+ u32tmp[1] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xac); -+ u32tmp[2] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb0); -+ u32tmp[3] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "LTE Break Table W_L/B_L/L_W/L_B", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, -+ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ } -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ /* -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "0x430/0x434/0x42a/0x456", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ */ -+ -+ u32tmp[0] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp[1] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", -+ "LTE Coex/Path Owner", -+ ((lte_coex_on) ? "On" : "Off") , -+ ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); -+ CL_PRINTF(cli_buf); -+ -+ if (lte_coex_on) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d/ %d", -+ "LTE 3Wire/OPMode/UART/UARTMode", -+ (int)((u32tmp[0] & BIT(6)) >> 6), -+ (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), -+ (int)((u32tmp[0] & BIT(3)) >> 3), -+ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "LTE_Busy/UART_Busy", -+ (int)((u32tmp[1] & BIT(1)) >> 1), (int)(u32tmp[1] & BIT(0))); -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s %d", -+ "GNT_WL_Ctrl/GNT_BT_Ctrl/Dbg", -+ ((u32tmp[0] & BIT(12)) ? "SW" : "HW"), -+ ((u32tmp[0] & BIT(8)) ? "SW" : "HW"), -+ ((u32tmp[0] & BIT(14)) ? "SW" : "HW"), -+ ((u32tmp[0] & BIT(10)) ? "SW" : "HW"), -+ ((u8tmp[0] & BIT(3)) ? "On" : "Off"), -+ coex_sta->gnt_error_cnt); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "GNT_WL/GNT_BT", -+ (int)((u32tmp[1] & BIT(2)) >> 2), -+ (int)((u32tmp[1] & BIT(3)) >> 3)); -+ CL_PRINTF(cli_buf); -+ -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x948); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x948/0x67[7]", -+ u16tmp[0], (int)((u8tmp[0] & BIT(7)) >> 7)); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x964); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x864); -+ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xab7); -+ u8tmp[3] = btcoexist->btc_read_1byte(btcoexist, 0xa01); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x964[1]/0x864[0]/0xab7[5]/0xa01[7]", -+ (int)((u8tmp[0] & BIT(1)) >> 1), (int)((u8tmp[1] & BIT(0))), -+ (int)((u8tmp[2] & BIT(3)) >> 3), -+ (int)((u8tmp[3] & BIT(7)) >> 7)); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x45e); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x4c6[4]/0x40[5]/0x45e[3](TxRetry)", -+ (int)((u8tmp[0] & BIT(4)) >> 4), -+ (int)((u8tmp[1] & BIT(5)) >> 5), -+ (int)((u8tmp[2] & BIT(3)) >> 3)); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s", -+ "0x550/0x522/4-RxAGC", -+ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); -+ CL_PRINTF(cli_buf); -+ -+ fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_FA_OFDM); -+ fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_FA_CCK); -+ cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_CCA_OFDM); -+ cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_CCA_CCK); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", -+ cca_cck, fa_cck, cca_ofdm, fa_ofdm); -+ CL_PRINTF(cli_buf); -+ -+#if 1 -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_OK CCK/11g/11n/11n-agg", -+ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, -+ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_Err CCK/11g/11n/11n-agg", -+ coex_sta->crc_err_cck, coex_sta->crc_err_11g, -+ coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); -+ CL_PRINTF(cli_buf); -+#endif -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", -+ "WlHiPri/ Locking/ Locked/ Noisy", -+ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), -+ (coex_sta->cck_lock ? "Yes" : "No"), -+ (coex_sta->cck_ever_lock ? "Yes" : "No"), -+ coex_sta->wl_noisy_level); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", -+ "0x770(Hi-pri rx/tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx, -+ (coex_sta->is_hiPri_rx_overhead ? "(scan overhead!!)" : "")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", -+ "0x774(Lo-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx, -+ (bt_link_info->slave_role ? "(Slave!!)" : ( -+ coex_sta->is_tdma_btautoslot_hang ? "(auto-slot hang!!)" : ""))); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void ex_halbtc8723d1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ -+ /* Write WL "Active" in Score-board for LPS off */ -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_1ANT_SCOREBOARD_ONOFF | -+ BT_8723D_1ANT_SCOREBOARD_SCAN | -+ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, -+ false); -+ -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_WLAN_OFF); -+ -+ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+#if 0 -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); -+ -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ONOFF, true); -+#endif -+ -+ halbtc8723d1ant_init_hw_config(btcoexist, false, false); -+ halbtc8723d1ant_init_coex_dm(btcoexist);; -+ -+ coex_sta->under_ips = false; -+ } -+} -+ -+void ex_halbtc8723d1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ -+ if (coex_sta->force_lps_on == true) { /* LPS No-32K */ -+ /* Write WL "Active" in Score-board for PS-TDMA */ -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); -+ -+ } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ -+ /* Write WL "Non-Active" in Score-board for Native-PS */ -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE, false); -+ -+ } -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ -+ /* Write WL "Active" in Score-board for LPS off */ -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); -+ -+ } -+} -+ -+void ex_halbtc8723d1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ coex_sta->freeze_coexrun_by_btinfo = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ halbtc8723d1ant_query_bt_info(btcoexist); -+ -+ if (BTC_SCAN_START == type) { -+ -+ if (!wifi_connected) -+ coex_sta->wifi_is_high_pri_task = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_1ANT_SCOREBOARD_SCAN | -+ BT_8723D_1ANT_SCOREBOARD_ONOFF, -+ true); -+ -+ /* Force antenna setup for no scan result issue */ -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8723d1ant_run_coexist_mechanism(btcoexist); -+ -+ } else { -+ -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", -+ coex_sta->scan_ap_num); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_run_coexist_mechanism(btcoexist); -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN Notify() end\n"); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+void ex_halbtc8723d1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ if (BTC_ASSOCIATE_START == type) { -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_1ANT_SCOREBOARD_SCAN | -+ BT_8723D_1ANT_SCOREBOARD_ONOFF, -+ true); -+ -+ /* Force antenna setup for no scan result issue */ -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_dm->arp_cnt = 0; -+ -+ halbtc8723d1ant_run_coexist_mechanism(btcoexist); -+ -+ /* To keep TDMA case during connect process, -+ to avoid changed by Btinfo and runcoexmechanism */ -+ coex_sta->freeze_coexrun_by_btinfo = true; -+ } else { -+ -+ coex_sta->wifi_is_high_pri_task = false; -+ coex_sta->freeze_coexrun_by_btinfo = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_run_coexist_mechanism(btcoexist); -+ } -+ -+} -+ -+void ex_halbtc8723d1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_1ANT_SCOREBOARD_ONOFF, -+ true); -+ -+ /* Force antenna setup for no scan result issue */ -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ /* Set CCK Tx/Rx high Pri except 11b mode */ -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x00); /* CCK Rx */ -+ } else { -+ /* btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x10); */ /*CCK Tx */ -+ /* btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); */ /*CCK Rx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x10); /* CCK Rx */ -+ } -+ -+ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, -+ 0x430); -+ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, -+ 0x434); -+ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( -+ btcoexist, 0x42a); -+ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( -+ btcoexist, 0x456); -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE, false); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ -+ -+ coex_sta->cck_ever_lock = false; -+ } -+ -+ halbtc8723d1ant_update_wifi_channel_info(btcoexist, type); -+ -+} -+ -+void ex_halbtc8723d1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean under_4way = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (under_4way) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ---- under_4way!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } else if (BTC_PACKET_ARP == type) { -+ -+ coex_dm->arp_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ARP notify -cnt = %d\n", -+ coex_dm->arp_cnt); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", -+ type); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } -+ -+ if (coex_sta->wifi_is_high_pri_task) { -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_SCAN, true); -+ halbtc8723d1ant_run_coexist_mechanism(btcoexist); -+ } -+} -+ -+void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 i, rsp_source = 0; -+ boolean wifi_connected = false; -+ boolean wifi_scan = false, wifi_link = false, wifi_roam = false, -+ wifi_busy = false; -+ static boolean is_scoreboard_scan = false; -+ -+ if (psd_scan->is_AntDet_running == true) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt_info_notify return for AntDet is running\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8723D_1ANT_MAX) -+ rsp_source = BT_INFO_SRC_8723D_1ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt_info[%d], len=%d, data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ coex_sta->bt_info = coex_sta->bt_info_c2h[rsp_source][1]; -+ coex_sta->bt_info_ext = coex_sta->bt_info_c2h[rsp_source][4]; -+ coex_sta->bt_info_ext2 = coex_sta->bt_info_c2h[rsp_source][5]; -+ -+ if (BT_INFO_SRC_8723D_1ANT_WIFI_FW != rsp_source) { -+ -+ /* if 0xff, it means BT is under WHCK test */ -+ coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? true : -+ false); -+ -+ coex_sta->bt_create_connection = (( -+ coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? true : -+ false); -+ -+ /* unit: %, value-100 to translate to unit: dBm */ -+ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + -+ 10; -+ -+ coex_sta->c2h_bt_remote_name_req = (( -+ coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? true : -+ false); -+ -+ coex_sta->is_A2DP_3M = ((coex_sta->bt_info_c2h[rsp_source][2] & -+ 0x10) ? true : false); -+ -+ coex_sta->acl_busy = ((coex_sta->bt_info_c2h[rsp_source][1] & -+ 0x9) ? true : false); -+ -+ coex_sta->voice_over_HOGP = ((coex_sta->bt_info_ext & 0x10) ? -+ true : false); -+ -+ coex_sta->c2h_bt_inquiry_page = ((coex_sta->bt_info & -+ BT_INFO_8723D_1ANT_B_INQ_PAGE) ? true : false); -+ -+ coex_sta->a2dp_bit_pool = ((( -+ coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) ? -+ coex_sta->bt_info_c2h[rsp_source][6] : 0); -+ -+ coex_sta->bt_retry_cnt = coex_sta->bt_info_c2h[rsp_source][2] & -+ 0xf; -+ -+ coex_sta->is_autoslot = coex_sta->bt_info_ext2 & 0x8; -+ -+ coex_sta->forbidden_slot = coex_sta->bt_info_ext2 & 0x7; -+ -+ coex_sta->hid_busy_num = (coex_sta->bt_info_ext2 & 0x30) >> 4; -+ -+ coex_sta->hid_pair_cnt = (coex_sta->bt_info_ext2 & 0xc0) >> 6; -+ -+ if (coex_sta->bt_retry_cnt >= 1) -+ coex_sta->pop_event_cnt++; -+ -+ if (coex_sta->c2h_bt_remote_name_req) -+ coex_sta->cnt_RemoteNameReq++; -+ -+ if (coex_sta->bt_info_ext & BIT(1)) -+ coex_sta->cnt_ReInit++; -+ -+ if (coex_sta->bt_info_ext & BIT(2)) { -+ coex_sta->cnt_setupLink++; -+ coex_sta->is_setupLink = true; -+ } else -+ coex_sta->is_setupLink = false; -+ -+ if (coex_sta->bt_info_ext & BIT(3)) -+ coex_sta->cnt_IgnWlanAct++; -+ -+ if (coex_sta->bt_info_ext & BIT(6)) -+ coex_sta->cnt_RoleSwitch++; -+ -+ if (coex_sta->bt_create_connection) { -+ coex_sta->cnt_Page++; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, -+ &wifi_busy); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); -+ -+ if ((wifi_link) || (wifi_roam) || (wifi_scan) || -+ (coex_sta->wifi_is_high_pri_task) || (wifi_busy)) { -+ -+ is_scoreboard_scan = true; -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_SCAN, true); -+ -+ } else -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_SCAN, false); -+ -+ } else { -+ if (is_scoreboard_scan) { -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_SCAN, false); -+ is_scoreboard_scan = false; -+ } -+ } -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ -+ if ((!btcoexist->manual_control) && -+ (!btcoexist->stop_coex_dm)) { -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ /* Re-Init */ -+ if ((coex_sta->bt_info_ext & BIT(1))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ if (wifi_connected) -+ halbtc8723d1ant_update_wifi_channel_info( -+ btcoexist, BTC_MEDIA_CONNECT); -+ else -+ halbtc8723d1ant_update_wifi_channel_info( -+ btcoexist, -+ BTC_MEDIA_DISCONNECT); -+ } -+ -+ -+ /* If Ignore_WLanAct && not SetUp_Link or Role_Switch */ -+ if ((coex_sta->bt_info_ext & BIT(3)) && -+ (!(coex_sta->bt_info_ext & BIT(2))) && -+ (!(coex_sta->bt_info_ext & BIT(6)))) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d1ant_ignore_wlan_act(btcoexist, -+ FORCE_EXEC, false); -+ } else { -+ if (coex_sta->bt_info_ext & BIT(2)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ignore Wlan active because Re-link!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (coex_sta->bt_info_ext & BIT(6)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ignore Wlan active because Role-Switch!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ } -+ -+ } -+ -+ if ((coex_sta->bt_info_ext & BIT(5))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist); -+ -+ if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) -+ coex_sta->bt_ble_scan_para[0] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x1); -+ if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) -+ coex_sta->bt_ble_scan_para[1] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x2); -+ if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) -+ coex_sta->bt_ble_scan_para[2] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x4); -+ } -+ -+ halbtc8723d1ant_update_bt_link_info(btcoexist); -+ -+ halbtc8723d1ant_run_coexist_mechanism(btcoexist); -+} -+ -+ -+ -+void ex_halbtc8723d1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_RF_ON == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = false; -+#if 0 -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ONOFF, true); -+#endif -+ -+ } else if (BTC_RF_OFF == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_1ANT_SCOREBOARD_ONOFF | -+ BT_8723D_1ANT_SCOREBOARD_SCAN | -+ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, -+ false); -+ -+ halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_WLAN_OFF); -+ -+ btcoexist->stop_coex_dm = true; -+ } -+} -+ -+void ex_halbtc8723d1ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_1ANT_SCOREBOARD_ONOFF | -+ BT_8723D_1ANT_SCOREBOARD_SCAN | -+ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, -+ false); -+ -+ halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_WLAN_OFF); -+ -+ halbtc8723d1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ -+ ex_halbtc8723d1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+ -+ btcoexist->stop_coex_dm = true; -+} -+ -+void ex_halbtc8723d1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if ((BTC_WIFI_PNP_SLEEP == pnp_state) || -+ (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_1ANT_SCOREBOARD_ONOFF | -+ BT_8723D_1ANT_SCOREBOARD_SCAN | -+ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, -+ false); -+ -+ if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { -+ -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ } else { -+ -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_WLAN_OFF); -+ } -+ -+ btcoexist->stop_coex_dm = true; -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+#if 0 -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_ONOFF, true); -+#endif -+ btcoexist->stop_coex_dm = false; -+ } -+} -+ -+ -+void ex_halbtc8723d1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], *****************Coex DM Reset*****************\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d1ant_init_hw_config(btcoexist, false, false); -+ halbtc8723d1ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8723d1ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ boolean wifi_busy = false; -+ u4Byte value = 0; -+ u32 bt_patch_ver; -+ static u8 cnt = 0; -+ boolean bt_relink_finish = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ************* Periodical *************\n"); -+ BTC_TRACE(trace_buf); -+ -+#if (BT_AUTO_REPORT_ONLY_8723D_1ANT == 0) -+ halbtc8723d1ant_query_bt_info(btcoexist); -+ -+#endif -+ -+ halbtc8723d1ant_monitor_bt_ctr(btcoexist); -+ halbtc8723d1ant_monitor_wifi_ctr(btcoexist); -+ -+ halbtc8723d1ant_monitor_bt_enable_disable(btcoexist); -+ -+#if 0 -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ /* halbtc8723d1ant_read_score_board(btcoexist, &bt_scoreboard_val); */ -+ -+ if (wifi_busy) { -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, true); -+ /* -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_WLBUSY, true); -+ -+ if (bt_scoreboard_val & BIT(6)) -+ halbtc8723d1ant_query_bt_info(btcoexist); */ -+ } else { -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_UNDERTEST, false); -+ /* -+ halbtc8723d1ant_post_state_to_bt(btcoexist, -+ BT_8723D_1ANT_SCOREBOARD_WLBUSY, -+ false); */ -+ } -+#endif -+ -+ if (coex_sta->bt_relink_downcount != 0) { -+ coex_sta->bt_relink_downcount--; -+ -+ if (coex_sta->bt_relink_downcount == 0) -+ bt_relink_finish = true; -+ } -+ -+ /* for 4-way, DHCP, EAPOL packet */ -+ if (coex_sta->specific_pkt_period_cnt > 0) { -+ -+ coex_sta->specific_pkt_period_cnt--; -+ -+ if ((coex_sta->specific_pkt_period_cnt == 0) && -+ (coex_sta->wifi_is_high_pri_task)) -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", -+ (coex_sta->wifi_is_high_pri_task ? "Yes" : -+ "No")); -+ BTC_TRACE(trace_buf); -+ -+ } -+ -+ if (!coex_sta->bt_disabled) { -+ -+#if BT_8723D_1ANT_ANTDET_ENABLE -+ -+ if (board_info->btdm_ant_det_finish) { -+ if ((psd_scan->ant_det_result == 12) && -+ (psd_scan->ant_det_psd_scan_peak_val == 0) -+ && (!psd_scan->is_AntDet_running)) { -+ psd_scan->ant_det_psd_scan_peak_val = -+ btcoexist->btc_get_ant_det_val_from_bt( -+ btcoexist) * 100; -+ -+ board_info->antdetval = psd_scan->ant_det_psd_scan_peak_val/100; -+ value = board_info->antdetval; -+ -+#ifdef PLATFORM_WINDOWS -+ { -+ PWCHAR registryName; -+ -+ registryName = L"antdetval"; -+ PlatformWriteCommonDwordRegistry(registryName, &value); -+ } -+#endif -+ } -+ } -+ -+#endif -+ } -+ -+ if (halbtc8723d1ant_is_wifibt_status_changed(btcoexist)) -+ halbtc8723d1ant_run_coexist_mechanism(btcoexist); -+ -+ -+} -+ -+void ex_halbtc8723d1ant_set_antenna_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (type == 2) { /* two antenna */ -+ board_info->ant_div_cfg = true; -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ } else { /* one antenna */ -+ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ } -+} -+ -+#ifdef PLATFORM_WINDOWS -+#pragma optimize("", off) -+#endif -+void ex_halbtc8723d1ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+ -+ static u32 ant_det_count = 0, ant_det_fail_count = 0; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u16 u16tmp; -+ u8 AntDetval = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n"); -+ BTC_TRACE(trace_buf); -+ -+#if BT_8723D_1ANT_ANTDET_ENABLE -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Call AntennaDetect()!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (seconds == 0) { -+ psd_scan->ant_det_try_count = 0; -+ psd_scan->ant_det_fail_count = 0; -+ ant_det_count = 0; -+ ant_det_fail_count = 0; -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ return; -+ } -+ -+ if (!board_info->btdm_ant_det_finish) { -+ psd_scan->ant_det_inteval_count = -+ psd_scan->ant_det_inteval_count + 2; -+ -+ if (psd_scan->ant_det_inteval_count >= -+ BT_8723D_2ANT_ANTDET_RETRY_INTERVAL) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ psd_scan->is_AntDet_running = true; -+ -+ halbtc8723d1ant_read_score_board(btcoexist, &u16tmp); -+ -+ if (u16tmp & BIT( -+ 2)) { /* Antenna detection is already done before last WL power on */ -+ board_info->btdm_ant_det_finish = true; -+ psd_scan->ant_det_try_count = 1; -+ psd_scan->ant_det_fail_count = 0; -+ board_info->btdm_ant_num_by_ant_det = (u16tmp & -+ BIT(3)) ? 1 : 2; -+ psd_scan->ant_det_result = 12; -+ -+ psd_scan->ant_det_psd_scan_peak_val = -+ btcoexist->btc_get_ant_det_val_from_bt( -+ btcoexist) * 100; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Result from BT (%d-Ant)\n", -+ board_info->btdm_ant_num_by_ant_det); -+ BTC_TRACE(trace_buf); -+ } else -+ board_info->btdm_ant_det_finish = -+ halbtc8723d1ant_psd_antenna_detection_check( -+ btcoexist); -+ -+ board_info->ant_det_result = psd_scan->ant_det_result; -+ btcoexist->bdontenterLPS = false; -+ -+ if (board_info->btdm_ant_det_finish) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (board_info->btdm_ant_num_by_ant_det == 2) { -+ board_info->ant_div_cfg = true; -+ halbtc8723d1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_WIFI, FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ } else -+ halbtc8723d1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME); -+ -+ /*for 8723d, btc_set_bt_trx_mask is just used to -+ notify BT stop le tx and Ant Det Result , not set BT RF TRx Mask */ -+ if (psd_scan->ant_det_result != 12) { -+ -+ AntDetval = (u8)( -+ psd_scan->ant_det_psd_scan_peak_val -+ / 100) & 0x7f; -+ -+ AntDetval = -+ (board_info->btdm_ant_num_by_ant_det -+ == 1) ? (AntDetval | 0x80) : -+ AntDetval; -+ board_info->antdetval = AntDetval; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxx AntennaDetect(), Ant Count = %d, PSD Val = %d\n", -+ ((AntDetval & -+ 0x80) ? 1 -+ : 2), AntDetval -+ & 0x7f); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->btc_set_bt_trx_mask( -+ btcoexist, AntDetval)) -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask ok!\n"); -+ else -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask fail!\n"); -+ -+ BTC_TRACE(trace_buf); -+ } else -+ board_info->antdetval = -+ psd_scan->ant_det_psd_scan_peak_val/100; -+ -+ board_info->btdm_ant_det_complete_fail = false; -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ board_info->btdm_ant_det_complete_fail = true; -+ } -+ -+ psd_scan->ant_det_inteval_count = 0; -+ psd_scan->is_AntDet_running = false; -+ /* stimulate coex running */ -+ halbtc8723d1ant_run_coexist_mechanism( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", -+ psd_scan->ant_det_inteval_count); -+ BTC_TRACE(trace_buf); -+ -+ if (psd_scan->ant_det_inteval_count == 8) -+ btcoexist->bdontenterLPS = true; -+ else -+ btcoexist->bdontenterLPS = false; -+ } -+ -+ } -+#endif -+ -+ -+} -+ -+ -+void ex_halbtc8723d1ant_display_ant_detection(IN struct btc_coexist *btcoexist) -+{ -+#if BT_8723D_1ANT_ANTDET_ENABLE -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ if (psd_scan->ant_det_try_count != 0) { -+ halbtc8723d1ant_psd_show_antenna_detect_result(btcoexist); -+ -+ if (board_info->btdm_ant_det_finish) -+ halbtc8723d1ant_psd_showdata(btcoexist); -+ } -+#endif -+ -+} -+ -+void ex_halbtc8723d1ant_antenna_isolation(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+ -+ -+} -+ -+void ex_halbtc8723d1ant_psd_scan(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+ -+ -+} -+ -+ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d1ant.h 2018-02-11 21:44:27.149146116 +0200 -@@ -0,0 +1,413 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8723D_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8723D 1ANT BT Co-exist definition -+ * ******************************************* */ -+#define BT_8723D_1ANT_COEX_DBG 0 -+#define BT_AUTO_REPORT_ONLY_8723D_1ANT 1 -+ -+#define BT_INFO_8723D_1ANT_B_FTP BIT(7) -+#define BT_INFO_8723D_1ANT_B_A2DP BIT(6) -+#define BT_INFO_8723D_1ANT_B_HID BIT(5) -+#define BT_INFO_8723D_1ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8723D_1ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8723D_1ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8723D_1ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8723D_1ANT_B_CONNECTION BIT(0) -+ -+#define BT_INFO_8723D_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT(0))) ? true : false) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT 2 -+ -+#define BT_8723D_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ -+#define BT_8723D_1ANT_DEFAULT_ISOLATION 15 /* unit: dB */ -+ -+ -+/* for Antenna detection */ -+#define BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 -+#define BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -+#define BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 -+#define BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT 35 -+#define BT_8723D_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -+#define BT_8723D_1ANT_ANTDET_SWEEPPOINT_DELAY 60000 -+#define BT_8723D_1ANT_ANTDET_ENABLE 1 -+#define BT_8723D_1ANT_ANTDET_BTTXTIME 100 -+#define BT_8723D_1ANT_ANTDET_BTTXCHANNEL 39 -+#define BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT 50 -+ -+#define BT_8723D_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 -+ -+enum bt_8723d_1ant_signal_state { -+ BT_8723D_1ANT_SIG_STA_SET_TO_LOW = 0x0, -+ BT_8723D_1ANT_SIG_STA_SET_BY_HW = 0x0, -+ BT_8723D_1ANT_SIG_STA_SET_TO_HIGH = 0x1, -+ BT_8723D_1ANT_SIG_STA_MAX -+}; -+ -+enum bt_8723d_1ant_path_ctrl_owner { -+ BT_8723D_1ANT_PCO_BTSIDE = 0x0, -+ BT_8723D_1ANT_PCO_WLSIDE = 0x1, -+ BT_8723D_1ANT_PCO_MAX -+}; -+ -+enum bt_8723d_1ant_gnt_ctrl_type { -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, -+ BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW = 0x1, -+ BT_8723D_1ANT_GNT_TYPE_MAX -+}; -+ -+enum bt_8723d_1ant_gnt_ctrl_block { -+ BT_8723D_1ANT_GNT_BLOCK_RFC_BB = 0x0, -+ BT_8723D_1ANT_GNT_BLOCK_RFC = 0x1, -+ BT_8723D_1ANT_GNT_BLOCK_BB = 0x2, -+ BT_8723D_1ANT_GNT_BLOCK_MAX -+}; -+ -+enum bt_8723d_1ant_lte_coex_table_type { -+ BT_8723D_1ANT_CTT_WL_VS_LTE = 0x0, -+ BT_8723D_1ANT_CTT_BT_VS_LTE = 0x1, -+ BT_8723D_1ANT_CTT_MAX -+}; -+ -+enum bt_8723d_1ant_lte_break_table_type { -+ BT_8723D_1ANT_LBTT_WL_BREAK_LTE = 0x0, -+ BT_8723D_1ANT_LBTT_BT_BREAK_LTE = 0x1, -+ BT_8723D_1ANT_LBTT_LTE_BREAK_WL = 0x2, -+ BT_8723D_1ANT_LBTT_LTE_BREAK_BT = 0x3, -+ BT_8723D_1ANT_LBTT_MAX -+}; -+ -+enum bt_info_src_8723d_1ant { -+ BT_INFO_SRC_8723D_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8723D_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8723D_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8723D_1ANT_MAX -+}; -+ -+enum bt_8723d_1ant_bt_status { -+ BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8723D_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8723D_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8723D_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8723D_1ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8723d_1ant_wifi_status { -+ BT_8723D_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8723D_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8723D_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8723D_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, -+ BT_8723D_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8723D_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8723D_1ANT_WIFI_STATUS_MAX -+}; -+ -+enum bt_8723d_1ant_coex_algo { -+ BT_8723D_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8723D_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8723D_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8723D_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8723D_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8723D_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8723D_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8723D_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8723D_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8723D_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8723D_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8723D_1ANT_COEX_ALGO_MAX = 0xb, -+}; -+ -+enum bt_8723d_1ant_phase { -+ BT_8723D_1ANT_PHASE_COEX_INIT = 0x0, -+ BT_8723D_1ANT_PHASE_WLANONLY_INIT = 0x1, -+ BT_8723D_1ANT_PHASE_WLAN_OFF = 0x2, -+ BT_8723D_1ANT_PHASE_2G_RUNTIME = 0x3, -+ BT_8723D_1ANT_PHASE_5G_RUNTIME = 0x4, -+ BT_8723D_1ANT_PHASE_BTMPMODE = 0x5, -+ BT_8723D_1ANT_PHASE_ANTENNA_DET = 0x6, -+ BT_8723D_1ANT_PHASE_COEX_POWERON = 0x7, -+ BT_8723D_1ANT_PHASE_MAX -+}; -+ -+enum bt_8723d_1ant_Scoreboard { -+ BT_8723D_1ANT_SCOREBOARD_ACTIVE = BIT(0), -+ BT_8723D_1ANT_SCOREBOARD_ONOFF = BIT(1), -+ BT_8723D_1ANT_SCOREBOARD_SCAN = BIT(2), -+ BT_8723D_1ANT_SCOREBOARD_UNDERTEST = BIT(3), -+ BT_8723D_1ANT_SCOREBOARD_WLBUSY = BIT(6) -+}; -+ -+struct coex_dm_8723d_1ant { -+ /* hw setting */ -+ u8 pre_ant_pos_type; -+ u8 cur_ant_pos_type; -+ /* fw mechanism */ -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ /* sw mechanism */ -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ -+ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ -+ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ -+ u16 backup_retry_limit; -+ u8 backup_ampdu_max_time; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ u32 pre_ra_mask; -+ u32 cur_ra_mask; -+ u8 pre_arfr_type; -+ u8 cur_arfr_type; -+ u8 pre_retry_limit_type; -+ u8 cur_retry_limit_type; -+ u8 pre_ampdu_time_type; -+ u8 cur_ampdu_time_type; -+ u32 arp_cnt; -+ -+ u8 error_condition; -+}; -+ -+struct coex_sta_8723d_1ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ boolean bt_hi_pri_link_exist; -+ u8 num_of_profile; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 specific_pkt_period_cnt; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ boolean is_hiPri_rx_overhead; -+ s8 bt_rssi; -+ boolean bt_tx_rx_mask; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ u8 bt_info_c2h[BT_INFO_SRC_8723D_1ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8723D_1ANT_MAX]; -+ boolean bt_whck_test; -+ boolean c2h_bt_inquiry_page; -+ boolean c2h_bt_remote_name_req; -+ boolean c2h_bt_page; /* Add for win8.1 page out issue */ -+ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ u8 bt_info_ext2; -+ u32 pop_event_cnt; -+ u8 scan_ap_num; -+ -+ u32 crc_ok_cck; -+ u32 crc_ok_11g; -+ u32 crc_ok_11n; -+ u32 crc_ok_11n_vht; -+ -+ u32 crc_err_cck; -+ u32 crc_err_11g; -+ u32 crc_err_11n; -+ u32 crc_err_11n_vht; -+ -+ boolean cck_lock; -+ boolean pre_ccklock; -+ boolean cck_ever_lock; -+ u8 coex_table_type; -+ -+ boolean force_lps_on; -+ -+ boolean concurrent_rx_mode_on; -+ -+ u16 score_board; -+ u8 isolation_btween_wb; /* 0~ 50 */ -+ -+ u8 a2dp_bit_pool; -+ u8 cut_version; -+ boolean acl_busy; -+ boolean bt_create_connection; -+ -+ u32 bt_coex_supported_feature; -+ u32 bt_coex_supported_version; -+ -+ u8 bt_ble_scan_type; -+ u32 bt_ble_scan_para[3]; -+ -+ boolean run_time_state; -+ boolean freeze_coexrun_by_btinfo; -+ -+ boolean is_A2DP_3M; -+ boolean voice_over_HOGP; -+ u8 bt_info; -+ boolean is_autoslot; -+ u8 forbidden_slot; -+ u8 hid_busy_num; -+ u8 hid_pair_cnt; -+ -+ u32 cnt_RemoteNameReq; -+ u32 cnt_setupLink; -+ u32 cnt_ReInit; -+ u32 cnt_IgnWlanAct; -+ u32 cnt_Page; -+ u32 cnt_RoleSwitch; -+ -+ u16 bt_reg_vendor_ac; -+ u16 bt_reg_vendor_ae; -+ -+ boolean is_setupLink; -+ u8 wl_noisy_level; -+ u32 gnt_error_cnt; -+ -+ u8 bt_afh_map[10]; -+ u8 bt_relink_downcount; -+ boolean is_tdma_btautoslot; -+ boolean is_tdma_btautoslot_hang; -+}; -+ -+#define BT_8723D_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -+#define BT_8723D_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -+#define BT_8723D_1ANT_ANTDET_BUF_LEN 16 -+ -+struct psdscan_sta_8723d_1ant { -+ -+ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ -+ u32 ant_det_bt_tx_time; -+ u32 ant_det_pre_psdscan_peak_val; -+ boolean ant_det_is_ant_det_available; -+ u32 ant_det_psd_scan_peak_val; -+ boolean ant_det_is_btreply_available; -+ u32 ant_det_psd_scan_peak_freq; -+ -+ u8 ant_det_result; -+ u8 ant_det_peak_val[BT_8723D_1ANT_ANTDET_BUF_LEN]; -+ u8 ant_det_peak_freq[BT_8723D_1ANT_ANTDET_BUF_LEN]; -+ u32 ant_det_try_count; -+ u32 ant_det_fail_count; -+ u32 ant_det_inteval_count; -+ u32 ant_det_thres_offset; -+ -+ u32 real_cent_freq; -+ s32 real_offset; -+ u32 real_span; -+ -+ u32 psd_band_width; /* unit: Hz */ -+ u32 psd_point; /* 128/256/512/1024 */ -+ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_start_point; -+ u32 psd_stop_point; -+ u32 psd_max_value_point; -+ u32 psd_max_value; -+ u32 psd_max_value2; -+ u32 psd_avg_value; /* filter loop_max_value that below BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT, and average the rest*/ -+ u32 psd_loop_max_value[BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT]; /*max value in each loop */ -+ u32 psd_start_base; -+ u32 psd_avg_num; /* 1/8/16/32 */ -+ u32 psd_gen_count; -+ boolean is_AntDet_running; -+ boolean is_psd_show_max_only; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8723d1ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8723d1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d1ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d1ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8723d1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d1ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8723d1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d1ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d1ant_set_antenna_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d1ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+void ex_halbtc8723d1ant_antenna_isolation(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+ -+void ex_halbtc8723d1ant_psd_scan(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+void ex_halbtc8723d1ant_display_ant_detection(IN struct btc_coexist *btcoexist); -+ -+#else -+#define ex_halbtc8723d1ant_power_on_setting(btcoexist) -+#define ex_halbtc8723d1ant_pre_load_firmware(btcoexist) -+#define ex_halbtc8723d1ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8723d1ant_init_coex_dm(btcoexist) -+#define ex_halbtc8723d1ant_ips_notify(btcoexist, type) -+#define ex_halbtc8723d1ant_lps_notify(btcoexist, type) -+#define ex_halbtc8723d1ant_scan_notify(btcoexist, type) -+#define ex_halbtc8723d1ant_connect_notify(btcoexist, type) -+#define ex_halbtc8723d1ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8723d1ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8723d1ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8723d1ant_rf_status_notify(btcoexist, type) -+#define ex_halbtc8723d1ant_halt_notify(btcoexist) -+#define ex_halbtc8723d1ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8723d1ant_coex_dm_reset(btcoexist) -+#define ex_halbtc8723d1ant_periodical(btcoexist) -+#define ex_halbtc8723d1ant_display_coex_info(btcoexist) -+#define ex_halbtc8723d1ant_set_antenna_notify(btcoexist, type) -+#define ex_halbtc8723d1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8723d1ant_antenna_isolation(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8723d1ant_psd_scan(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8723d1ant_display_ant_detection(btcoexist) -+#endif -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.c 2018-02-11 21:44:27.149146116 +0200 -@@ -0,0 +1,6835 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8723D Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8723D_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8723d_2ant glcoex_dm_8723d_2ant; -+static struct coex_dm_8723d_2ant *coex_dm = &glcoex_dm_8723d_2ant; -+static struct coex_sta_8723d_2ant glcoex_sta_8723d_2ant; -+static struct coex_sta_8723d_2ant *coex_sta = &glcoex_sta_8723d_2ant; -+static struct psdscan_sta_8723d_2ant gl_psd_scan_8723d_2ant; -+static struct psdscan_sta_8723d_2ant *psd_scan = &gl_psd_scan_8723d_2ant; -+ -+const char *const glbt_info_src_8723d_2ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+/* ************************************************************ -+ * BtCoex Version Format: -+ * 1. date : glcoex_ver_date_XXXXX_1ant -+ * 2. WifiCoexVersion : glcoex_ver_XXXX_1ant -+ * 3. BtCoexVersion : glcoex_ver_btdesired_XXXXX_1ant -+ * 4. others : glcoex_ver_XXXXXX_XXXXX_1ant -+ * -+ * Variable should be indicated IC and Antenna numbers !!! -+ * Please strictly follow this order and naming style !!! -+ * -+ * ************************************************************ */ -+u32 glcoex_ver_date_8723d_2ant = 20170111; -+u32 glcoex_ver_8723d_2ant = 0x14; -+u32 glcoex_ver_btdesired_8723d_2ant = 0x10; -+ -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8723d2ant_ -+ * ************************************************************ */ -+u8 halbtc8723d2ant_bt_rssi_state(u8 *ppre_bt_rssi_state, u8 level_num, -+ u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = *ppre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return *ppre_bt_rssi_state; -+ } -+ -+ if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || -+ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ *ppre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8723d2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 *pprewifi_rssi_state, IN u8 level_num, IN u8 rssi_thresh, -+ IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = *pprewifi_rssi_state; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || -+ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return *pprewifi_rssi_state; -+ } -+ -+ if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || -+ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((*pprewifi_rssi_state == BTC_RSSI_STATE_MEDIUM) || -+ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ *pprewifi_rssi_state = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8723d2ant_coex_switch_threshold(IN struct btc_coexist *btcoexist, -+ IN u8 isolation_measuared) -+{ -+ s8 interference_wl_tx = 0, interference_bt_tx = 0; -+ -+ -+ interference_wl_tx = BT_8723D_2ANT_WIFI_MAX_TX_POWER - -+ isolation_measuared; -+ interference_bt_tx = BT_8723D_2ANT_BT_MAX_TX_POWER - -+ isolation_measuared; -+ -+ -+ -+ coex_sta->wifi_coex_thres = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; -+ coex_sta->wifi_coex_thres2 = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES2; -+ -+ coex_sta->bt_coex_thres = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1; -+ coex_sta->bt_coex_thres2 = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES2; -+ -+ -+ /* -+ coex_sta->wifi_coex_thres = interference_wl_tx + BT_8723D_2ANT_WIFI_SIR_THRES1; -+ coex_sta->wifi_coex_thres2 = interference_wl_tx + BT_8723D_2ANT_WIFI_SIR_THRES2; -+ -+ coex_sta->bt_coex_thres = interference_bt_tx + BT_8723D_2ANT_BT_SIR_THRES1; -+ coex_sta->bt_coex_thres2 = interference_bt_tx + BT_8723D_2ANT_BT_SIR_THRES2; -+ */ -+ -+ -+ -+ -+ -+ /* -+ if ( BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - -+ BT_8723D_2ANT_DEFAULT_ISOLATION) ) -+ coex_sta->wifi_coex_thres = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; -+ else -+ coex_sta->wifi_coex_thres = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - -+ BT_8723D_2ANT_DEFAULT_ISOLATION); -+ -+ if ( BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - -+ BT_8723D_2ANT_DEFAULT_ISOLATION) ) -+ coex_sta->bt_coex_thres = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1; -+ else -+ coex_sta->bt_coex_thres = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - -+ BT_8723D_2ANT_DEFAULT_ISOLATION); -+ -+ */ -+} -+ -+ -+void halbtc8723d2ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+} -+ -+void halbtc8723d2ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+} -+ -+void halbtc8723d2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ static u8 num_of_bt_counter_chk = 0, cnt_slave = 0, cnt_overhead = 0, -+ cnt_autoslot_hang = 0; -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ if (BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ -+ if (coex_sta->high_priority_rx >= 15) { -+ if (cnt_overhead < 3) -+ cnt_overhead++; -+ -+ if (cnt_overhead == 3) -+ coex_sta->is_hiPri_rx_overhead = true; -+ } else { -+ if (cnt_overhead > 0) -+ cnt_overhead--; -+ -+ if (cnt_overhead == 0) -+ coex_sta->is_hiPri_rx_overhead = false; -+ } -+ } else -+ coex_sta->is_hiPri_rx_overhead = false; -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+ -+ if ((coex_sta->low_priority_tx > 1050) && -+ (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->pop_event_cnt++; -+ -+ if ((coex_sta->low_priority_rx >= 950) && -+ (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) -+ && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && -+ (coex_sta->bt_link_exist)) { -+ if (cnt_slave >= 2) { -+ bt_link_info->slave_role = true; -+ cnt_slave = 2; -+ } else -+ cnt_slave++; -+ } else { -+ if (cnt_slave == 0) { -+ bt_link_info->slave_role = false; -+ cnt_slave = 0; -+ } else -+ cnt_slave--; -+ -+ } -+ -+ if (coex_sta->is_tdma_btautoslot) { -+ if ((coex_sta->low_priority_tx >= 1300) && -+ (coex_sta->low_priority_rx <= 150)) { -+ if (cnt_autoslot_hang >= 2) { -+ coex_sta->is_tdma_btautoslot_hang = true; -+ cnt_autoslot_hang = 2; -+ } else -+ cnt_autoslot_hang++; -+ } else { -+ if (cnt_autoslot_hang == 0) { -+ coex_sta->is_tdma_btautoslot_hang = false; -+ cnt_autoslot_hang = 0; -+ } else -+ cnt_autoslot_hang--; -+ } -+ } -+ -+ if (coex_sta->sco_exist) { -+ if ((coex_sta->high_priority_tx >= 400) && -+ (coex_sta->high_priority_rx >= 400)) -+ coex_sta->is_eSCO_mode = false; -+ else -+ coex_sta->is_eSCO_mode = true; -+ } -+ -+ if (!coex_sta->bt_disabled) { -+ -+ if ((coex_sta->high_priority_tx == 0) && -+ (coex_sta->high_priority_rx == 0) && -+ (coex_sta->low_priority_tx == 0) && -+ (coex_sta->low_priority_rx == 0)) { -+ num_of_bt_counter_chk++; -+ if (num_of_bt_counter_chk >= 3) { -+ halbtc8723d2ant_query_bt_info(btcoexist); -+ num_of_bt_counter_chk = 0; -+ } -+ } -+ } -+ -+} -+ -+void halbtc8723d2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -+{ -+#if 1 -+ s32 wifi_rssi = 0; -+ boolean wifi_busy = false, wifi_under_b_mode = false, -+ wifi_scan = false; -+ boolean bt_idle = false, wl_idle = false; -+ static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, -+ wl_noisy_count1 = 3, wl_noisy_count2 = 0; -+ u32 total_cnt, reg_val1, reg_val2, cck_cnt; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_OK_CCK); -+ coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_OK_LEGACY); -+ coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_OK_HT); -+ coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_OK_VHT); -+ -+ coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); -+ coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); -+ coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_ERROR_HT); -+ coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter( -+ btcoexist, PHYDM_INFO_CRC32_ERROR_VHT); -+ -+ cck_cnt = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; -+ -+ if (cck_cnt > 250) { -+ if (wl_noisy_count2 < 3) -+ wl_noisy_count2++; -+ -+ if (wl_noisy_count2 == 3) { -+ wl_noisy_count0 = 0; -+ wl_noisy_count1 = 0; -+ } -+ } else if (cck_cnt < 50) { -+ if (wl_noisy_count0 < 3) -+ wl_noisy_count0++; -+ -+ if (wl_noisy_count0 == 3) { -+ wl_noisy_count1 = 0; -+ wl_noisy_count2 = 0; -+ } -+ } else { -+ if (wl_noisy_count1 < 3) -+ wl_noisy_count1++; -+ -+ if (wl_noisy_count1 == 3) { -+ wl_noisy_count0 = 0; -+ wl_noisy_count2 = 0; -+ } -+ } -+ -+ if (wl_noisy_count2 == 3) -+ coex_sta->wl_noisy_level = 2; -+ else if (wl_noisy_count1 == 3) -+ coex_sta->wl_noisy_level = 1; -+ else -+ coex_sta->wl_noisy_level = 0; -+ -+ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { -+ total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + -+ coex_sta->crc_ok_11n + coex_sta->crc_ok_11n_vht; -+ -+ if ((coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_ACL_BUSY) || -+ (coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_SCO_BUSY)) { -+ if (coex_sta->crc_ok_cck > (total_cnt - -+ coex_sta->crc_ok_cck)) { -+ if (cck_lock_counter < 3) -+ cck_lock_counter++; -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ if (!coex_sta->pre_ccklock) { -+ -+ if (cck_lock_counter >= 3) -+ coex_sta->cck_lock = true; -+ else -+ coex_sta->cck_lock = false; -+ } else { -+ if (cck_lock_counter == 0) -+ coex_sta->cck_lock = false; -+ else -+ coex_sta->cck_lock = true; -+ } -+ -+ if (coex_sta->cck_lock) -+ coex_sta->cck_ever_lock = true; -+ -+ coex_sta->pre_ccklock = coex_sta->cck_lock; -+ -+#endif -+} -+ -+void halbtc8723d2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ boolean bt_busy = false; -+ -+ -+ coex_sta->num_of_profile = 0; -+ -+ /* set link exist status */ -+ if (!(coex_sta->bt_info & BT_INFO_8723D_2ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_FTP) { -+ coex_sta->pan_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->pan_exist = false; -+ -+ if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_A2DP) { -+ coex_sta->a2dp_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->a2dp_exist = false; -+ -+ if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_HID) { -+ coex_sta->hid_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->hid_exist = false; -+ -+ if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_ESCO) { -+ coex_sta->sco_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->sco_exist = false; -+ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ bt_link_info->acl_busy = coex_sta->acl_busy; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+ -+ if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_INQ_PAGE) { -+ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_INQ_PAGE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n"); -+ } else if (!(coex_sta->bt_info & BT_INFO_8723D_2ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ } else if (coex_sta->bt_info == BT_INFO_8723D_2ANT_B_CONNECTION) { -+ /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ } else if (((coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_ESCO) || -+ (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_BUSY)) && -+ (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_ACL_BUSY)) { -+ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n"); -+ } else if ((coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_ESCO) || -+ (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ } else if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_ACL_BUSY) { -+ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ } else { -+ coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ } -+ -+ BTC_TRACE(trace_buf); -+ -+ if ((BT_8723D_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8723D_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ bt_busy = true; -+ else -+ bt_busy = false; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+} -+ -+void halbtc8723d2ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ h2c_parameter[0] = -+ 0x1; /* enable BT AFH skip WL channel for 8723d because BT Rx LO interference */ -+ /* h2c_parameter[0] = 0x0; */ -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -+ -+} -+ -+void halbtc8723d2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, -+ IN u8 dac_swing_lvl) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ /* There are several type of dacswing */ -+ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ -+ h2c_parameter[0] = dac_swing_lvl; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); -+} -+ -+void halbtc8723d2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 fw_dac_swing_lvl) -+{ -+ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_fw_dac_swing_lvl == -+ coex_dm->cur_fw_dac_swing_lvl) -+ return; -+ } -+ -+ halbtc8723d2ant_set_fw_dac_swing_level(btcoexist, -+ coex_dm->cur_fw_dac_swing_lvl); -+ -+ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; -+} -+ -+void halbtc8723d2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN u8 dec_bt_pwr_lvl) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = dec_bt_pwr_lvl; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); -+} -+ -+void halbtc8723d2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 dec_bt_pwr_lvl) -+{ -+ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) -+ return; -+ } -+ halbtc8723d2ant_set_fw_dec_bt_pwr(btcoexist, -+ coex_dm->cur_bt_dec_pwr_lvl); -+ -+ coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; -+} -+ -+void halbtc8723d2ant_set_fw_low_penalty_ra(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+#if 1 -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ -+ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+#endif -+} -+ -+void halbtc8723d2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+#if 1 -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ -+ halbtc8723d2ant_set_fw_low_penalty_ra(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+#if 0 -+ if (low_penalty_ra) -+ btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 15); -+ else -+ btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 0); -+#endif -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+ -+#endif -+} -+ -+void halbtc8723d2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8723d2ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8723d2ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8723d2ant_write_score_board( -+ IN struct btc_coexist *btcoexist, -+ IN u16 bitpos, -+ IN boolean state -+) -+{ -+ -+ static u16 originalval = 0x8002; -+ -+ if (state) -+ originalval = originalval | bitpos; -+ else -+ originalval = originalval & (~bitpos); -+ -+ -+ btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); -+ -+} -+ -+void halbtc8723d2ant_read_score_board( -+ IN struct btc_coexist *btcoexist, -+ IN u16 *score_board_val -+) -+{ -+ -+ *score_board_val = (btcoexist->btc_read_2byte(btcoexist, -+ 0xaa)) & 0x7fff; -+} -+ -+ -+void halbtc8723d2ant_post_state_to_bt( -+ IN struct btc_coexist *btcoexist, -+ IN u16 type, -+ IN boolean state -+) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], halbtc8723d2ant_post_state_to_bt: type = %d, state =%d\n", -+ type, state); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_write_score_board(btcoexist, (u16) type, state); -+ -+} -+ -+boolean halbtc8723d2ant_is_wifibt_status_changed(IN struct btc_coexist -+ *btcoexist) -+{ -+ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false, pre_bt_off = false, pre_bt_slave = false; -+ static u8 pre_hid_busy_num = 0, pre_wl_noisy_level = 0; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (coex_sta->bt_disabled != pre_bt_off) { -+ pre_bt_off = coex_sta->bt_disabled; -+ -+ if (coex_sta->bt_disabled) -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ else -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->bt_coex_supported_feature = 0; -+ coex_sta->bt_coex_supported_version = 0; -+ coex_sta->bt_ble_scan_type = 0; -+ coex_sta->bt_ble_scan_para[0] = 0; -+ coex_sta->bt_ble_scan_para[1] = 0; -+ coex_sta->bt_ble_scan_para[2] = 0; -+ coex_sta->bt_reg_vendor_ac = 0xffff; -+ coex_sta->bt_reg_vendor_ae = 0xffff; -+ return true; -+ } -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ -+ if (wifi_busy) -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, true); -+ else -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, false); -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ if (coex_sta->wl_noisy_level != pre_wl_noisy_level) { -+ pre_wl_noisy_level = coex_sta->wl_noisy_level; -+ return true; -+ } -+ } -+ -+ if (!coex_sta->bt_disabled) { -+ if (coex_sta->hid_busy_num != pre_hid_busy_num) { -+ pre_hid_busy_num = coex_sta->hid_busy_num; -+ return true; -+ } -+ } -+ -+ if (bt_link_info->slave_role != pre_bt_slave) { -+ pre_bt_slave = bt_link_info->slave_role; -+ return true; -+ } -+ -+ return false; -+} -+ -+void halbtc8723d2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ u16 u16tmp; -+ -+ /* This function check if bt is disabled */ -+#if 0 -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ -+ -+#else -+ -+ /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ -+ halbtc8723d2ant_read_score_board(btcoexist, &u16tmp); -+ -+ bt_active = u16tmp & BIT(1); -+ -+ -+#endif -+ -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ } else { -+ -+ bt_disable_cnt++; -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ bt_disable_cnt = 2; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ } -+ -+ if (bt_disabled) -+ halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); -+ else -+ halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, true); -+ -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ } -+ -+} -+ -+ -+ -+void halbtc8723d2ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, -+ boolean isenable) -+{ -+#if BT_8723D_2ANT_COEX_DBG -+ if (isenable) { -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); -+ -+ /* enable GNT_BT to GPIO debug */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); -+ -+ /* 0x48[20] = 0 for GPIO14 = GNT_WL*/ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x0); -+ /* 0x40[17] = 0 for GPIO14 = GNT_WL*/ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, 0x02, 0x0); -+ -+ /* 0x66[9] = 0 for GPIO15 = GNT_BT*/ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x02, 0x0); -+ /* 0x66[7] = 0 -+ for GPIO15 = GNT_BT*/ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, 0x80, 0x0); -+ /* 0x8[8] = 0 for GPIO15 = GNT_BT*/ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x9, 0x1, 0x0); -+ -+ /* BT Vendor Reg 0x76[0] = 0 for GPIO15 = GNT_BT, this is not set here*/ -+ } else { -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); -+ -+ /* Disable GNT_BT debug to GPIO, and enable chip_wakeup_host */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x1); -+ -+ /* 0x48[20] = 0 for GPIO14 = GNT_WL*/ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x1); -+ } -+ -+#endif -+} -+ -+u32 halbtc8723d2ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, -+ IN u16 reg_addr) -+{ -+ u32 j = 0, delay_count = 0; -+ -+ -+ /* wait for ready bit before access 0x7c0 */ -+ btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr); -+ -+ while (1) { -+ if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { -+ delay_ms(50); -+ delay_count++; -+ if (delay_count >= 10) { -+ delay_count = 0; -+ break; -+ } -+ } else -+ break; -+ } -+ -+ return btcoexist->btc_read_4byte(btcoexist, -+ 0x7c8); /* get read data */ -+ -+} -+ -+void halbtc8723d2ant_ltecoex_indirect_write_reg(IN struct btc_coexist -+ *btcoexist, -+ IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) -+{ -+ u32 val, i = 0, j = 0, bitpos = 0, delay_count = 0; -+ -+ -+ if (bit_mask == 0x0) -+ return; -+ if (bit_mask == 0xffffffff) { -+ btcoexist->btc_write_4byte(btcoexist, 0x7c4, -+ reg_value); /* put write data */ -+ -+ /* wait for ready bit before access 0x7c0 */ -+ while (1) { -+ if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { -+ delay_ms(50); -+ delay_count++; -+ if (delay_count >= 10) { -+ delay_count = 0; -+ break; -+ } -+ } else -+ break; -+ } -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x7c0, -+ 0xc00F0000 | reg_addr); -+ } else { -+ for (i = 0; i <= 31; i++) { -+ if (((bit_mask >> i) & 0x1) == 0x1) { -+ bitpos = i; -+ break; -+ } -+ } -+ -+ /* read back register value before write */ -+ val = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, -+ reg_addr); -+ val = (val & (~bit_mask)) | (reg_value << bitpos); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x7c4, -+ val); /* put write data */ -+ -+ /* wait for ready bit before access 0x7c0 */ -+ while (1) { -+ if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { -+ delay_ms(50); -+ delay_count++; -+ if (delay_count >= 10) { -+ delay_count = 0; -+ break; -+ } -+ } else -+ break; -+ } -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x7c0, -+ 0xc00F0000 | reg_addr); -+ -+ } -+ -+} -+ -+void halbtc8723d2ant_ltecoex_enable(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 val; -+ -+ val = (enable) ? 1 : 0; -+ halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, -+ val); /* 0x38[7] */ -+ -+} -+ -+void halbtc8723d2ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_control) -+{ -+ u8 val; -+ -+ val = (wifi_control) ? 1 : 0; -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, -+ val); /* 0x70[26] */ -+ -+} -+ -+void halbtc8723d2ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, -+ IN u8 control_block, IN boolean sw_control, IN u8 state) -+{ -+ u32 val = 0, val_orig = 0; -+ -+ if (!sw_control) -+ val = 0x0; -+ else if (state & 0x1) -+ val = 0x3; -+ else -+ val = 0x1; -+ -+ val_orig = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x38); -+ -+ switch (control_block) { -+ case BT_8723D_2ANT_GNT_BLOCK_RFC_BB: -+ default: -+ val = ((val << 14) | (val << 10)) | (val_orig & 0xffff33ff); -+ break; -+ case BT_8723D_2ANT_GNT_BLOCK_RFC: -+ val = (val << 14) | (val_orig & 0xffff3fff); -+ break; -+ case BT_8723D_2ANT_GNT_BLOCK_BB: -+ val = (val << 10) | (val_orig & 0xfffff3ff); -+ break; -+ } -+ -+ halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, 0xffffffff, val); -+} -+ -+ -+void halbtc8723d2ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, -+ IN u8 control_block, IN boolean sw_control, IN u8 state) -+{ -+ u32 val = 0, val_orig = 0; -+ -+ if (!sw_control) -+ val = 0x0; -+ else if (state & 0x1) -+ val = 0x3; -+ else -+ val = 0x1; -+ -+ val_orig = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x38); -+ -+ switch (control_block) { -+ case BT_8723D_2ANT_GNT_BLOCK_RFC_BB: -+ default: -+ val = ((val << 12) | (val << 8)) | (val_orig & 0xffffccff); -+ break; -+ case BT_8723D_2ANT_GNT_BLOCK_RFC: -+ val = (val << 12) | (val_orig & 0xffffcfff); -+ break; -+ case BT_8723D_2ANT_GNT_BLOCK_BB: -+ val = (val << 8) | (val_orig & 0xfffffcff); -+ break; -+ } -+ -+ halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, 0xffffffff, val); -+} -+ -+void halbtc8723d2ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u8 table_type, IN u16 table_content) -+{ -+ u16 reg_addr = 0x0000; -+ -+ switch (table_type) { -+ case BT_8723D_2ANT_CTT_WL_VS_LTE: -+ reg_addr = 0xa0; -+ break; -+ case BT_8723D_2ANT_CTT_BT_VS_LTE: -+ reg_addr = 0xa4; -+ break; -+ } -+ -+ if (reg_addr != 0x0000) -+ halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, -+ 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ -+ -+ -+} -+ -+ -+void halbtc8723d2ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, -+ IN u8 table_type, IN u8 table_content) -+{ -+ u16 reg_addr = 0x0000; -+ -+ switch (table_type) { -+ case BT_8723D_2ANT_LBTT_WL_BREAK_LTE: -+ reg_addr = 0xa8; -+ break; -+ case BT_8723D_2ANT_LBTT_BT_BREAK_LTE: -+ reg_addr = 0xac; -+ break; -+ case BT_8723D_2ANT_LBTT_LTE_BREAK_WL: -+ reg_addr = 0xb0; -+ break; -+ case BT_8723D_2ANT_LBTT_LTE_BREAK_BT: -+ reg_addr = 0xb4; -+ break; -+ } -+ -+ if (reg_addr != 0x0000) -+ halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, -+ 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ -+ -+ -+} -+ -+void halbtc8723d2ant_set_wltoggle_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 interval, -+ IN u8 val0x6c4_b0, IN u8 val0x6c4_b1, IN u8 val0x6c4_b2, -+ IN u8 val0x6c4_b3) -+{ -+ static u8 pre_h2c_parameter[6] = {0}; -+ u8 cur_h2c_parameter[6] = {0}; -+ u8 i, match_cnt = 0; -+ -+ cur_h2c_parameter[0] = 0x7; /* op_code, 0x7= wlan toggle slot*/ -+ -+ cur_h2c_parameter[1] = interval; -+ cur_h2c_parameter[2] = val0x6c4_b0; -+ cur_h2c_parameter[3] = val0x6c4_b1; -+ cur_h2c_parameter[4] = val0x6c4_b2; -+ cur_h2c_parameter[5] = val0x6c4_b3; -+ -+ if (!force_exec) { -+ for (i = 1; i <= 5; i++) { -+ if (cur_h2c_parameter[i] != pre_h2c_parameter[i]) -+ break; -+ -+ match_cnt++; -+ } -+ -+ if (match_cnt == 5) -+ return; -+ } -+ -+ for (i = 1; i <= 5; i++) -+ pre_h2c_parameter[i] = cur_h2c_parameter[i]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, cur_h2c_parameter); -+} -+ -+void halbtc8723d2ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8723d2ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8723d2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8723d2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ u32 break_table; -+ u8 select_table; -+ -+ coex_sta->coex_table_type = type; -+ -+ if (coex_sta->concurrent_rx_mode_on == true) { -+ break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ -+ select_table = -+ 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ -+ } else { -+ break_table = 0xffffff; -+ select_table = 0x3; -+ } -+ -+ switch (type) { -+ case 0: -+ halbtc8723d2ant_coex_table(btcoexist, force_exec, -+ 0xffffffff, 0xffffffff, break_table, select_table); -+ break; -+ case 1: -+ halbtc8723d2ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, break_table, select_table); -+ break; -+ case 2: -+ halbtc8723d2ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0x5a5a5a5a, break_table, select_table); -+ break; -+ case 3: -+ halbtc8723d2ant_coex_table(btcoexist, force_exec, -+ 0xaa555555, 0xaa5a5a5a, break_table, select_table); -+ break; -+ case 4: -+ halbtc8723d2ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, break_table, select_table); -+ break; -+ case 5: -+ halbtc8723d2ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x55555555, break_table, select_table); -+ break; -+ case 6: -+ halbtc8723d2ant_coex_table(btcoexist, force_exec, -+ 0xa5555555, 0xfafafafa, break_table, select_table); -+ break; -+ case 7: -+ halbtc8723d2ant_coex_table(btcoexist, force_exec, -+ 0xa5555555, 0xaa5a5a5a, break_table, select_table); -+ break; -+ case 8: -+ halbtc8723d2ant_coex_table(btcoexist, force_exec, -+ 0xa5555555, 0xfafafafa, break_table, select_table); -+ break; -+ case 9: -+ halbtc8723d2ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0xaaaa5aaa, break_table, select_table); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8723d2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8723d2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8723d2ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8723d2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8723d2ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8723d2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8723d2ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ u8 h2c_parameter[5] = {0, 0, 0, 0x40, 0}; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ /*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); */ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, -+ h2c_parameter); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ /*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8);*/ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, -+ h2c_parameter); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8723d2ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8723d2ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8723d2ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ coex_sta->force_lps_on = true; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8723d2ant_ps_tdma_check_for_power_save_state( -+ btcoexist, false); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+ -+void halbtc8723d2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = false; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ if (byte5 & BIT(2)) -+ coex_sta->is_tdma_btautoslot = true; -+ else -+ coex_sta->is_tdma_btautoslot = false; -+ -+ /* release bt-auto slot for auto-slot hang is detected!! */ -+ if (coex_sta->is_tdma_btautoslot) -+ if ((coex_sta->is_tdma_btautoslot_hang) || -+ (bt_link_info->slave_role)) -+ byte5 = byte5 & 0xfb; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], FW for AP mode\n"); -+ BTC_TRACE(trace_buf); -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ -+ halbtc8723d2ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ -+ halbtc8723d2ant_power_save_state( -+ btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } else { -+ halbtc8723d2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, -+ 0x0); -+ } -+ -+ -+ h2c_parameter[0] = real_byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = real_byte5; -+ -+ coex_dm->ps_tdma_para[0] = real_byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = real_byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+void halbtc8723d2ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ -+ static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+ if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) -+ psTdmaByte4Modify = 0x1; -+ else -+ psTdmaByte4Modify = 0x0; -+ -+ if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { -+ -+ force_exec = true; -+ pre_psTdmaByte4Modify = psTdmaByte4Modify; -+ } -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ -+ if (coex_dm->cur_ps_tdma_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(on, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(off, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } -+ -+ -+ if (turn_on) { -+ switch (type) { -+ case 1: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x10, 0x03, 0x91, -+ 0x54 | psTdmaByte4Modify); -+ break; -+ case 2: -+ default: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x35, 0x03, 0x11, -+ 0x11 | psTdmaByte4Modify); -+ break; -+ case 3: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x3a, 0x3, 0x91, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 4: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x21, 0x3, 0x91, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 5: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x25, 0x3, 0x91, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 6: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x10, 0x3, 0x91, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 7: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x20, 0x3, 0x91, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 8: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x15, 0x03, 0x11, -+ 0x11); -+ break; -+ case 10: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x30, 0x03, 0x11, -+ 0x10); -+ break; -+ case 11: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x35, 0x03, 0x11, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 12: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x35, 0x03, 0x11, 0x11); -+ break; -+ case 13: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x1c, 0x03, 0x11, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 14: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x20, 0x03, 0x11, -+ 0x11); -+ break; -+ case 15: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x10, 0x03, 0x11, -+ 0x14); -+ break; -+ case 16: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x10, 0x03, 0x11, -+ 0x15); -+ break; -+ case 21: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x30, 0x03, 0x11, -+ 0x10); -+ break; -+ case 22: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x25, 0x03, 0x11, -+ 0x10); -+ break; -+ case 23: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x10, 0x03, 0x11, -+ 0x10); -+ break; -+ case 51: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x10, 0x03, 0x91, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 101: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x10, 0x03, 0x10, -+ 0x54 | psTdmaByte4Modify); -+ break; -+ case 102: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x35, 0x03, 0x11, -+ 0x11 | psTdmaByte4Modify); -+ break; -+ case 103: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x3a, 0x3, 0x10, -+ 0x50 | psTdmaByte4Modify); -+ break; -+ case 104: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x21, 0x3, 0x10, -+ 0x50 | psTdmaByte4Modify); -+ break; -+ case 105: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x25, 0x3, 0x10, -+ 0x50 | psTdmaByte4Modify); -+ break; -+ case 106: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x10, 0x3, 0x10, -+ 0x50 | psTdmaByte4Modify); -+ break; -+ case 107: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x20, 0x3, 0x10, -+ 0x50 | psTdmaByte4Modify); -+ break; -+ case 108: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x30, 0x3, 0x10, -+ 0x50 | psTdmaByte4Modify); -+ break; -+ case 109: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x55, -+ 0x10, 0x03, 0x10, -+ 0x54 | psTdmaByte4Modify); -+ break; -+ case 110: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x55, -+ 0x30, 0x03, 0x10, -+ 0x50 | psTdmaByte4Modify); -+ break; -+ case 111: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x65, -+ 0x25, 0x03, 0x11, -+ 0x11 | psTdmaByte4Modify); -+ break; -+ case 151: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x10, 0x03, 0x10, -+ 0x50 | psTdmaByte4Modify); -+ break; -+ } -+ } else { -+ /* disable PS tdma */ -+ switch (type) { -+ case 0: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x40, 0x0); -+ break; -+ case 1: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x48, 0x0); -+ break; -+ default: -+ halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x40, 0x0); -+ break; -+ } -+ } -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean force_exec, -+ IN u8 phase) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u32 u32tmp = 0; -+ boolean pg_ext_switch = false, is_hw_ant_div_on = false; -+ u8 h2c_parameter[2] = {0}; -+ u32 cnt_bt_cal_chk = 0; -+ u8 u8tmp0 = 0, u8tmp1 = 0; -+ boolean is_in_mp_mode = false; -+ u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0; -+ u16 u16tmp0 = 0, u16tmp1 = 0; -+ -+ -+ u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x38); -+ -+ /* To avoid indirect access fail */ -+ if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) { -+ force_exec = true; -+ coex_sta->gnt_error_cnt++; -+ } -+ -+ -+#if BT_8723D_2ANT_COEX_DBG -+ u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa); -+ u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); -+ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before Set Ant Pat)\n", -+ u8tmp0, u16tmp1, u8tmp1); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa = 0x%x (Before Set Ant Path)\n", -+ u32tmp1, u32tmp2, u16tmp0); -+ BTC_TRACE(trace_buf); -+#endif -+ -+ coex_dm->cur_ant_pos_type = ant_pos_type; -+ -+ if (!force_exec) { -+ if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** Skip Antenna Path Setup because no change!!**********\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ } -+ -+ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; -+ -+ switch (phase) { -+ case BT_8723D_2ANT_PHASE_COEX_POWERON: -+ /* Set Path control to WL */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, -+ 0x80, 0x0); -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8723d2ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8723D_2ANT_PCO_BTSIDE); -+ -+ /* set GNT_BT to SW high */ -+ halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to SW low */ -+ halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_WIFI; -+ -+ coex_sta->run_time_state = false; -+ -+ break; -+ case BT_8723D_2ANT_PHASE_COEX_INIT: -+ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ -+ halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8723d2ant_ltecoex_set_coex_table( -+ btcoexist, -+ BT_8723D_2ANT_CTT_WL_VS_LTE, -+ 0xffff); -+ -+ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8723d2ant_ltecoex_set_coex_table( -+ btcoexist, -+ BT_8723D_2ANT_CTT_BT_VS_LTE, -+ 0xffff); -+ -+ /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ -+ while (cnt_bt_cal_chk <= 20) { -+ u8tmp0 = btcoexist->btc_read_1byte( -+ btcoexist, -+ 0x49d); -+ cnt_bt_cal_chk++; -+ if (u8tmp0 & BIT(0)) { -+ BTC_SPRINTF( -+ trace_buf, -+ BT_TMP_BUF_SIZE, -+ "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE( -+ trace_buf); -+ delay_ms(50); -+ } else { -+ BTC_SPRINTF( -+ trace_buf, -+ BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE( -+ trace_buf); -+ break; -+ } -+ } -+ -+ -+ /* Set Path control to WL */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, -+ 0x67, 0x80, 0x1); -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8723d2ant_ltecoex_pathcontrol_owner( -+ btcoexist, -+ BT_8723D_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW high */ -+ halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to SW high */ -+ halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ coex_sta->run_time_state = false; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) { -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = -+ BTC_ANT_WIFI_AT_MAIN; -+ else -+ ant_pos_type = -+ BTC_ANT_WIFI_AT_AUX; -+ } -+ -+ break; -+ case BT_8723D_2ANT_PHASE_WLANONLY_INIT: -+ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ -+ halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8723d2ant_ltecoex_set_coex_table( -+ btcoexist, -+ BT_8723D_2ANT_CTT_WL_VS_LTE, -+ 0xffff); -+ -+ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8723d2ant_ltecoex_set_coex_table( -+ btcoexist, -+ BT_8723D_2ANT_CTT_BT_VS_LTE, -+ 0xffff); -+ -+ /* Set Path control to WL */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, -+ 0x67, 0x80, 0x1); -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8723d2ant_ltecoex_pathcontrol_owner( -+ btcoexist, -+ BT_8723D_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Low */ -+ halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_2ANT_SIG_STA_SET_TO_LOW); -+ /* Set GNT_WL to SW high */ -+ halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ coex_sta->run_time_state = false; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) { -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = -+ BTC_ANT_WIFI_AT_MAIN; -+ else -+ ant_pos_type = -+ BTC_ANT_WIFI_AT_AUX; -+ } -+ -+ break; -+ case BT_8723D_2ANT_PHASE_WLAN_OFF: -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* Set Path control to BT */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, -+ 0x67, 0x80, 0x0); -+ -+ /* set Path control owner to BT */ -+ halbtc8723d2ant_ltecoex_pathcontrol_owner( -+ btcoexist, -+ BT_8723D_2ANT_PCO_BTSIDE); -+ -+ coex_sta->run_time_state = false; -+ break; -+ case BT_8723D_2ANT_PHASE_2G_RUNTIME: -+ -+ /* wait for WL/BT IQK finish, keep 0x38 = 0xff00 for WL IQK */ -+ while (cnt_bt_cal_chk <= 20) { -+ u8tmp0 = btcoexist->btc_read_1byte( -+ btcoexist, -+ 0x1e6); -+ -+ u8tmp1 = btcoexist->btc_read_1byte( -+ btcoexist, -+ 0x49d); -+ -+ cnt_bt_cal_chk++; -+ if ((u8tmp0 & BIT(0)) || -+ (u8tmp1 & BIT(0))) { -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "[BTCoex], ########### WL or BT is IQK (wait cnt=%d)\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ delay_ms(50); -+ } else { -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** WL and BT is NOT IQK (wait cnt=%d)\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ break; -+ } -+ } -+ -+ /* Set Path control to WL */ -+ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1);*/ -+ -+ /* set Path control owner to WL at runtime step */ -+ halbtc8723d2ant_ltecoex_pathcontrol_owner( -+ btcoexist, -+ BT_8723D_2ANT_PCO_WLSIDE); -+ -+ -+ halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA, -+ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ /* Set GNT_WL to PTA */ -+ halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA, -+ BT_8723D_2ANT_SIG_STA_SET_BY_HW); -+ -+ coex_sta->run_time_state = true; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) { -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = -+ BTC_ANT_WIFI_AT_MAIN; -+ else -+ ant_pos_type = -+ BTC_ANT_WIFI_AT_AUX; -+ } -+ -+ break; -+ case BT_8723D_2ANT_PHASE_BTMPMODE: -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* Set Path control to WL */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, -+ 0x67, 0x80, 0x1); -+ -+ /* set Path control owner to WL */ -+ halbtc8723d2ant_ltecoex_pathcontrol_owner( -+ btcoexist, -+ BT_8723D_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Hi */ -+ halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ /* Set GNT_WL to SW Lo */ -+ halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_2ANT_SIG_STA_SET_TO_LOW); -+ -+ coex_sta->run_time_state = false; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) { -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = -+ BTC_ANT_WIFI_AT_MAIN; -+ else -+ ant_pos_type = -+ BTC_ANT_WIFI_AT_AUX; -+ } -+ -+ break; -+ case BT_8723D_2ANT_PHASE_ANTENNA_DET: -+ -+ /* Set Path control to WL */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, -+ 0x80, 0x1); -+ -+ /* set Path control owner to WL */ -+ halbtc8723d2ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8723D_2ANT_PCO_WLSIDE); -+ -+ /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ -+ /* set GNT_BT to SW high */ -+ halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ /* Set GNT_WL to SW high */ -+ halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_WIFI_AT_AUX; -+ -+ coex_sta->run_time_state = false; -+ -+ break; -+ } -+ -+ is_hw_ant_div_on = board_info->ant_div_cfg; -+ -+ if ((is_hw_ant_div_on) && (phase != BT_8723D_2ANT_PHASE_ANTENNA_DET)) -+ btcoexist->btc_write_2byte(btcoexist, 0x948, 0x140); -+ else if ((is_hw_ant_div_on == false) && -+ (phase != BT_8723D_2ANT_PHASE_WLAN_OFF)) { -+ -+ switch (ant_pos_type) { -+ case BTC_ANT_WIFI_AT_MAIN: -+ -+ btcoexist->btc_write_2byte(btcoexist, -+ 0x948, 0x0); -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ -+ btcoexist->btc_write_2byte(btcoexist, -+ 0x948, 0x280); -+ break; -+ } -+ } -+ -+ -+#if BT_8723D_2ANT_COEX_DBG -+ u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa); -+ u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); -+ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(After Set Ant Pat)\n", -+ u8tmp0, u16tmp1, u8tmp1); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa= 0x%x (After Set Ant Path)\n", -+ u32tmp1, u32tmp2, u16tmp0); -+ BTC_TRACE(trace_buf); -+#endif -+ -+} -+ -+u8 halbtc8723d2ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8723D_2ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 0) { -+ -+ if (bt_link_info->acl_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No-Profile busy\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY; -+ } -+ } else if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_2ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_2ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_2ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_2ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP ==> A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_2ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_2ANT_COEX_ALGO_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP ==> HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8723D_2ANT_COEX_ALGO_HID_A2DP; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_PANEDR_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+ -+ -+void halbtc8723d2ant_action_coex_all_off(IN struct btc_coexist *btcoexist) -+{ -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* fw all off */ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8723d2ant_action_bt_whql_test(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+} -+ -+void halbtc8723d2ant_action_bt_hs(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false, wifi_turbo = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", -+ coex_sta->scan_ap_num, coex_sta->wl_noisy_level); -+ BTC_TRACE(trace_buf); -+ -+#if 1 -+ if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) -+ wifi_turbo = true; -+#endif -+ -+ -+ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ -+ } else { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } -+ -+} -+ -+ -+void halbtc8723d2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ -+ boolean wifi_connected = false; -+ boolean wifi_scan = false, wifi_link = false, wifi_roam = false; -+ boolean wifi_busy = false; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); -+ -+ if ((coex_sta->bt_create_connection) && ((wifi_link) || (wifi_roam) -+ || (wifi_scan) || (wifi_busy) || (coex_sta->wifi_is_high_pri_task))) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi link/roam/Scan/busy/hi-pri-task + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 8); -+ -+ if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist)) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 15); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 11); -+ } else if ((!wifi_connected) && (!wifi_scan)) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi no-link + no-scan + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (bt_link_info->pan_exist) { -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ -+ } else if (bt_link_info->a2dp_exist) { -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16); -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ } else { -+ -+ if ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy) -+ || (coex_sta->wifi_is_high_pri_task)) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ } -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+} -+ -+ -+void halbtc8723d2ant_action_bt_relink(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ coex_sta->bt_relink_downcount = 2; -+} -+ -+void halbtc8723d2ant_action_bt_idle(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!wifi_busy) { -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 8); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); -+ } else { /* if wl busy */ -+ -+ if (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else { -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 8); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 12); -+ } -+ } -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+} -+ -+ -+ -+/* SCO only or SCO+PAN(HS) */ -+void halbtc8723d2ant_action_sco(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ u32 wifi_bw = 1; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, -+ &wifi_bw); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ if (coex_sta->is_eSCO_mode) -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ else /* 2-Ant free run if eSCO mode */ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); -+ } -+ -+} -+ -+ -+void halbtc8723d2ant_action_hid(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ u32 wifi_bw = 1; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ /*for 4/18 hid */ -+ if (coex_sta->hid_busy_num >= 2) { -+ if (wifi_bw == 0) { /* if 11bg mode */ -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 8); -+ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x1, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 111); -+ } else { -+ -+ if (wifi_busy) { -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 8); -+ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x2, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 111); -+ } else { -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 3); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); -+ } -+ } -+ } else { -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 3); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); -+ } -+ } -+ -+} -+ -+ -+/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -+void halbtc8723d2ant_action_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false, wifi_turbo = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", -+ coex_sta->scan_ap_num, coex_sta->wl_noisy_level); -+ BTC_TRACE(trace_buf); -+ -+#if 1 -+ if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) -+ wifi_turbo = true; -+#endif -+ -+ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 1); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 16); -+ } else { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ if ((coex_sta->bt_relink_downcount != 0) -+ && (wifi_busy)) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ -+ } else { -+ -+ if (wifi_turbo) -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 6); -+ else -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 7); -+ -+ if (wifi_busy) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 101); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 16); -+ /*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 102);*/ -+ } -+ -+ } -+ -+} -+ -+ -+void halbtc8723d2ant_action_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false, wifi_turbo = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", -+ coex_sta->scan_ap_num, coex_sta->wl_noisy_level); -+ BTC_TRACE(trace_buf); -+ -+#if 1 -+ if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) -+ wifi_turbo = true; -+#endif -+ -+ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+#if 0 -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+#endif -+ -+ -+#if 1 -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 3); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 4); -+ } else { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ if (wifi_turbo) -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 6); -+ else -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 7); -+ -+ if (wifi_busy) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 103); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 104); -+ -+ } -+ -+#endif -+ -+} -+ -+void halbtc8723d2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ u32 wifi_bw = 1; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, -+ &wifi_bw); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 1); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 16); -+ } else { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ if ((coex_sta->bt_relink_downcount != 0) -+ && (wifi_busy)) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } else if (wifi_busy) { -+ if (coex_sta->hid_busy_num >= 2) { -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 8); -+ if (wifi_bw == 0) /*11bg mode */ -+ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x1, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ else -+ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x2, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 109); -+ } else { -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 101); -+ } -+ } else { -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 1); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 16); -+ } -+ -+ } -+ -+} -+ -+ -+void halbtc8723d2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false, wifi_turbo = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", -+ coex_sta->scan_ap_num, coex_sta->wl_noisy_level); -+ BTC_TRACE(trace_buf); -+ -+#if 1 -+ if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) -+ wifi_turbo = true; -+#endif -+ -+ -+ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) { -+ -+ if ((coex_sta->a2dp_bit_pool > 40) && -+ (coex_sta->a2dp_bit_pool < 255)) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 7); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 5); -+ } else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 6); -+ -+ } else { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ if (wifi_turbo) -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 6); -+ else -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 7); -+ -+ if (wifi_busy) { -+ -+ if ((coex_sta->a2dp_bit_pool > 40) && -+ (coex_sta->a2dp_bit_pool < 255)) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 107); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 105); -+ } else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 106); -+ -+ } -+ -+} -+ -+ -+/* PAN(EDR)+A2DP */ -+void halbtc8723d2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false, wifi_turbo = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", -+ coex_sta->scan_ap_num, coex_sta->wl_noisy_level); -+ BTC_TRACE(trace_buf); -+ -+#if 1 -+ if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) -+ wifi_turbo = true; -+#endif -+ -+ -+ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) { -+ -+ if (((coex_sta->a2dp_bit_pool > 40) && -+ (coex_sta->a2dp_bit_pool < 255)) || -+ (!coex_sta->is_A2DP_3M)) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 7); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 5); -+ } else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 6); -+ } else { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ if (wifi_turbo) -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 6); -+ else -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 7); -+ -+ if (wifi_busy) { -+ -+ if ((coex_sta->a2dp_bit_pool > 40) && -+ (coex_sta->a2dp_bit_pool < 255)) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 107); -+ else if (wifi_turbo) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 108); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 105); -+ } else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 106); -+ -+ } -+ -+} -+ -+ -+void halbtc8723d2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ u32 wifi_bw = 1; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, -+ &wifi_bw); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 3); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 4); -+ } else { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ if (coex_sta->hid_busy_num >= 2) { -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 8); -+ if (wifi_bw == 0) /*11bg mode */ -+ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x1, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ else -+ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x2, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 110); -+ } else { -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ -+ if (wifi_busy) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 103); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 104); -+ } -+ -+ } -+ -+} -+ -+ -+/* HID+A2DP+PAN(EDR) */ -+void halbtc8723d2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ u32 wifi_bw = 1; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, -+ &wifi_bw); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) { -+ -+ if (((coex_sta->a2dp_bit_pool > 40) && -+ (coex_sta->a2dp_bit_pool < 255)) || -+ (!coex_sta->is_A2DP_3M)) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 7); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 5); -+ } else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 6); -+ } else { -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ if (coex_sta->hid_busy_num >= 2) { -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 8); -+ if (wifi_bw == 0) /*11bg mode */ -+ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x1, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ else -+ halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, -+ NORMAL_EXEC, -+ 0x2, 0xaa, -+ 0x5a, 0xaa, -+ 0xaa); -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 110); -+ } else { -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ -+ if (wifi_busy) { -+ -+ if ((coex_sta->a2dp_bit_pool > 40) && -+ (coex_sta->a2dp_bit_pool < 255)) -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 107); -+ else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 105); -+ } else -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 106); -+ } -+ } -+ -+} -+ -+ -+void halbtc8723d2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* hw all off */ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+} -+ -+void halbtc8723d2ant_action_wifi_linkscan_process(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ -+ if (bt_link_info->pan_exist) { -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ -+ } else if (bt_link_info->a2dp_exist) { -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16); -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ } else { -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ } -+ -+} -+ -+void halbtc8723d2ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* fw all off */ -+ halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8723d2ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -+{ -+ switch (coex_dm->cur_algorithm) { -+ -+ case BT_8723D_2ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_sco(btcoexist); -+ break; -+ case BT_8723D_2ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_hid(btcoexist); -+ break; -+ case BT_8723D_2ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_a2dp(btcoexist); -+ break; -+ case BT_8723D_2ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_a2dp_pan_hs(btcoexist); -+ break; -+ case BT_8723D_2ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_pan_edr(btcoexist); -+ break; -+ case BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_pan_edr_a2dp(btcoexist); -+ break; -+ case BT_8723D_2ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_pan_edr_hid(btcoexist); -+ break; -+ case BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_hid_a2dp_pan_edr( -+ btcoexist); -+ break; -+ case BT_8723D_2ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_hid_a2dp(btcoexist); -+ break; -+ case BT_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = No-Profile busy.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_bt_idle(btcoexist); -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_coex_all_off(btcoexist); -+ break; -+ } -+ -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ -+} -+ -+ -+void halbtc8723d2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ u8 algorithm = 0; -+ u32 num_of_wifi_link = 0; -+ u32 wifi_link_status = 0; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean miracast_plus_bt = false; -+ boolean scan = false, link = false, roam = false, -+ under_4way = false, -+ wifi_connected = false, wifi_under_5g = false, -+ bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (!coex_sta->run_time_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], return for run_time_state = false !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->freeze_coexrun_by_btinfo) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), return for freeze_coexrun_by_btinfo\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->bt_whck_test) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under WHCK TEST!!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_bt_whql_test(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled!!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_coex_all_off(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under inquiry/page scan !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_bt_inquiry(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->is_setupLink) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is re-link !!!\n"); -+ halbtc8723d2ant_action_bt_relink(btcoexist); -+ return; -+ } -+ -+ /* for P2P */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if ((num_of_wifi_link >= 2) || -+ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", -+ num_of_wifi_link, wifi_link_status); -+ BTC_TRACE(trace_buf); -+ -+ if (bt_link_info->bt_link_exist) -+ miracast_plus_bt = true; -+ else -+ miracast_plus_bt = false; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ -+ if (scan || link || roam || under_4way) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n", -+ scan, link, roam, under_4way); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under linkscan process + Multi-Port !!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_action_wifi_linkscan_process(btcoexist); -+ } else -+ -+ halbtc8723d2ant_action_wifi_multi_port(btcoexist); -+ -+ return; -+ } else { -+ miracast_plus_bt = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is hs\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_bt_hs(btcoexist); -+ return; -+ } -+ -+ if ((BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) || -+ (BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, bt idle!!.\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_action_bt_idle(btcoexist); -+ return; -+ } -+ -+ algorithm = halbtc8723d2ant_action_algorithm(btcoexist); -+ coex_dm->cur_algorithm = algorithm; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", -+ coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ if (scan || link || roam || under_4way) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under Link Process !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_wifi_linkscan_process(btcoexist); -+ } else if (wifi_connected) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, wifi connected!!.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_wifi_connected(btcoexist); -+ -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, wifi not-connected!!.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_action_wifi_not_connected(btcoexist); -+ } -+} -+ -+ -+void halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); -+ -+ coex_sta->pop_event_cnt = 0; -+ coex_sta->cnt_RemoteNameReq = 0; -+ coex_sta->cnt_ReInit = 0; -+ coex_sta->cnt_setupLink = 0; -+ coex_sta->cnt_IgnWlanAct = 0; -+ coex_sta->cnt_Page = 0; -+ -+ halbtc8723d2ant_query_bt_info(btcoexist); -+} -+ -+ -+void halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ u8 u8tmp0 = 0, u8tmp1 = 0; -+ u32 vendor; -+ u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0; -+ u16 u16tmp1 = 0; -+ u8 i = 0; -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 2Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+#if BT_8723D_2ANT_COEX_DBG -+ u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x38); -+ u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x54); -+ u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); -+ u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before init_hw_config)\n", -+ u8tmp0, u16tmp1, u8tmp1); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x (Before init_hw_config)\n", -+ u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+#endif -+ -+ -+ coex_sta->bt_coex_supported_feature = 0; -+ coex_sta->bt_coex_supported_version = 0; -+ coex_sta->bt_ble_scan_type = 0; -+ coex_sta->bt_ble_scan_para[0] = 0; -+ coex_sta->bt_ble_scan_para[1] = 0; -+ coex_sta->bt_ble_scan_para[2] = 0; -+ coex_sta->bt_reg_vendor_ac = 0xffff; -+ coex_sta->bt_reg_vendor_ae = 0xffff; -+ coex_sta->gnt_error_cnt = 0; -+ coex_sta->bt_relink_downcount = 0; -+ -+ for (i = 0; i <= 9; i++) -+ coex_sta->bt_afh_map[i] = 0; -+ -+#if 0 -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor); -+ if (vendor == BTC_VENDOR_LENOVO) -+ coex_dm->switch_thres_offset = 0; -+ else -+ coex_dm->switch_thres_offset = 20; -+#endif -+ /* 0xf0[15:12] --> Chip Cut information */ -+ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, -+ 0xf1) & 0xf0) >> 4; -+ -+ coex_sta->dis_ver_info_cnt = 0; -+ -+ /* default isolation = 15dB */ -+ coex_sta->isolation_btween_wb = BT_8723D_2ANT_DEFAULT_ISOLATION; -+ halbtc8723d2ant_coex_switch_threshold(btcoexist, -+ coex_sta->isolation_btween_wb); -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ -+ /* BT report packet sample rate */ -+ btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); -+ -+ /* Init 0x778 = 0x1 for 2-Ant */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); -+ -+ /* Enable PTA (3-wire function form BT side) */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); -+ -+ /* Enable PTA (tx/rx signal form WiFi side) */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); -+ -+ halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, true); -+ -+#if 0 -+ /* check if WL firmware download ok */ -+ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ONOFF, true); -+#endif -+ -+ /* Enable counter statistics */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, -+ 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ -+ -+ /* WLAN_Tx by GNT_WL 0x950[29] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x20, 0x0); -+ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ -+ psd_scan->ant_det_is_ant_det_available = true; -+ -+ if (wifi_only) { -+ coex_sta->concurrent_rx_mode_on = false; -+ /* Path config */ -+ /* Set Antenna Path */ -+ halbtc8723d2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_WLANONLY_INIT); -+ -+ btcoexist->stop_coex_dm = true; -+ } else { -+ /*Set BT polluted packet on for Tx rate adaptive not including Tx retry break by PTA, 0x45c[19] =1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); -+ -+ coex_sta->concurrent_rx_mode_on = true; -+ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); */ -+ -+ /* RF 0x1[0] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x1, 0x0); -+ -+ /* Path config */ -+ halbtc8723d2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_COEX_INIT); -+ -+ btcoexist->stop_coex_dm = false; -+ } -+ -+ -+} -+ -+u32 halbtc8723d2ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) -+{ -+ u8 j; -+ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; -+ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, -+ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, -+ 32, 23, 15, 7, 0 -+ }; -+ -+ if (val == 0) -+ return 0; -+ -+ tmp = val; -+ -+ while (1) { -+ if (tmp == 1) -+ break; -+ else { -+ tmp = (tmp >> 1); -+ shiftcount++; -+ } -+ } -+ -+ -+ val_integerd_b = shiftcount + 1; -+ -+ tmp2 = 1; -+ for (j = 1; j <= val_integerd_b; j++) -+ tmp2 = tmp2 * 2; -+ -+ tmp = (val * 100) / tmp2; -+ tindex = tmp / 5; -+ -+ if (tindex > 20) -+ tindex = 20; -+ -+ val_fractiond_b = table_fraction[tindex]; -+ -+ result = val_integerd_b * 100 - val_fractiond_b; -+ -+ return result; -+ -+ -+} -+ -+void halbtc8723d2ant_psd_show_antenna_detect_result(IN struct btc_coexist -+ *btcoexist) -+{ -+ u8 *cli_buf = btcoexist->cli_buf; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n============[Antenna Detection info] ============\n"); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->ant_det_result == 12) { /* Get Ant Det from BT */ -+ -+ if (board_info->btdm_ant_num_by_ant_det == 1) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "1-Antenna", -+ BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT, -+ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION); -+ else { -+ -+ if (psd_scan->ant_det_psd_scan_peak_val > -+ (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) -+ * 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s (>%d)", -+ "Ant Det Result", "2-Antenna (Bad-Isolation)", -+ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "2-Antenna (Good-Isolation)", -+ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset, -+ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ } -+ -+ } else if (psd_scan->ant_det_result == 1) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", -+ "Ant Det Result", "2-Antenna (Bad-Isolation)", -+ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else if (psd_scan->ant_det_result == 2) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "2-Antenna (Good-Isolation)", -+ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset, -+ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "1-Antenna", -+ BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT, -+ BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset); -+ -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", -+ "Antenna Detection Finish", -+ (board_info->btdm_ant_det_finish -+ ? "Yes" : "No")); -+ CL_PRINTF(cli_buf); -+ -+ switch (psd_scan->ant_det_result) { -+ case 0: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is not available)"); -+ break; -+ case 1: /* 2-Ant bad-isolation */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 2: /* 2-Ant good-isolation */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 3: /* 1-Ant */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 4: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Uncertainty result)"); -+ break; -+ case 5: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); -+ break; -+ case 6: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(WiFi is Scanning)"); -+ break; -+ case 7: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is not idle)"); -+ break; -+ case 8: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Abort by WiFi Scanning)"); -+ break; -+ case 9: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Antenna Init is not ready)"); -+ break; -+ case 10: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is Inquiry or page)"); -+ break; -+ case 11: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is Disabled)"); -+ case 12: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available, result from BT"); -+ break; -+ } -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->ant_det_result == 12) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", -+ "PSD Scan Peak Value", -+ psd_scan->ant_det_psd_scan_peak_val / 100); -+ CL_PRINTF(cli_buf); -+ return; -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Ant Detect Total Count", psd_scan->ant_det_try_count); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Ant Detect Fail Count", psd_scan->ant_det_fail_count); -+ CL_PRINTF(cli_buf); -+ -+ if ((!board_info->btdm_ant_det_finish) && -+ (psd_scan->ant_det_result != 5)) -+ return; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", -+ (psd_scan->ant_det_result ? "ok" : "fail")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", -+ psd_scan->ant_det_bt_tx_time); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", -+ psd_scan->ant_det_bt_le_channel); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", -+ "WiFi PSD Cent-Ch/Offset/Span", -+ psd_scan->real_cent_freq, psd_scan->real_offset, -+ psd_scan->real_span); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", -+ "PSD Pre-Scan Peak Value", -+ psd_scan->ant_det_pre_psdscan_peak_val / 100); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", -+ "PSD Pre-Scan result", -+ (psd_scan->ant_det_result != 5 ? "ok" : "fail"), -+ BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->ant_det_result == 5) -+ return; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", -+ "PSD Scan Peak Value", psd_scan->ant_det_peak_val); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", -+ "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", -+ (board_info->tfbga_package) ? "Yes" : "No"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "PSD Threshold Offset", psd_scan->ant_det_thres_offset); -+ CL_PRINTF(cli_buf); -+ -+} -+ -+void halbtc8723d2ant_psd_showdata(IN struct btc_coexist *btcoexist) -+{ -+ u8 *cli_buf = btcoexist->cli_buf; -+ u32 delta_freq_per_point; -+ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; -+ -+ if (psd_scan->ant_det_result == 12) -+ return; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n\n============[PSD info] (%d)============\n", -+ psd_scan->psd_gen_count); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->psd_gen_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); -+ CL_PRINTF(cli_buf); -+ return; -+ } -+ -+ if (psd_scan->psd_point == 0) -+ delta_freq_per_point = 0; -+ else -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* if (psd_scan->is_psd_show_max_only) */ -+ if (0) { -+ psd_rep1 = psd_scan->psd_max_value / 100; -+ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; -+ -+ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + -+ psd_scan->psd_max_value_point * delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.0%d MHz", -+ freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.%d MHz", -+ freq1, freq2); -+ -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.0%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ -+ CL_PRINTF(cli_buf); -+ } else { -+ m = psd_scan->psd_start_point; -+ n = psd_scan->psd_start_point; -+ i = 1; -+ j = 1; -+ -+ while (1) { -+ do { -+ freq = ((psd_scan->real_cent_freq - 20) * -+ 1000000 + m * -+ delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (i == 1) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.000", -+ freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.0%2d", -+ freq1, -+ freq2); -+ else -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.%3d", -+ freq1, -+ freq2); -+ } else if ((i % 8 == 0) || -+ (m == psd_scan->psd_stop_point)) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%6d.000\n", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%6d.0%2d\n", freq1, -+ freq2); -+ else -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%6d.%3d\n", freq1, -+ freq2); -+ } else { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%6d.0%2d", freq1, -+ freq2); -+ else -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%6d.%3d", freq1, -+ freq2); -+ } -+ -+ i++; -+ m++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); -+ -+ -+ do { -+ psd_rep1 = psd_scan->psd_report_max_hold[n] / -+ 100; -+ psd_rep2 = psd_scan->psd_report_max_hold[n] - -+ psd_rep1 * -+ 100; -+ -+ if (j == 1) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.0%d", -+ psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.%d", -+ psd_rep1, -+ psd_rep2); -+ } else if ((j % 8 == 0) || -+ (n == psd_scan->psd_stop_point)) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%7d.0%d\n", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%7d.%d\n", psd_rep1, -+ psd_rep2); -+ } else { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%7d.0%d", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, -+ BT_TMP_BUF_SIZE, -+ "%7d.%d", psd_rep1, -+ psd_rep2); -+ } -+ -+ j++; -+ n++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); -+ -+ if ((m > psd_scan->psd_stop_point) || -+ (n > psd_scan->psd_stop_point)) -+ break; -+ else { -+ i = 1; -+ j = 1; -+ } -+ -+ } -+ } -+ -+ -+} -+ -+#ifdef PLATFORM_WINDOWS -+#pragma optimize("", off) -+#endif -+void halbtc8723d2ant_psd_maxholddata(IN struct btc_coexist *btcoexist, -+ IN u32 gen_count) -+{ -+ u32 i = 0; -+ u32 loop_i_max = 0, loop_val_max = 0; -+ -+ if (gen_count == 1) { -+ memcpy(psd_scan->psd_report_max_hold, -+ psd_scan->psd_report, -+ BT_8723D_2ANT_ANTDET_PSD_POINTS * sizeof(u32)); -+ } -+ -+ for (i = psd_scan->psd_start_point; -+ i <= psd_scan->psd_stop_point; i++) { -+ -+ /* update max-hold value at each freq point */ -+ if (psd_scan->psd_report[i] > psd_scan->psd_report_max_hold[i]) -+ psd_scan->psd_report_max_hold[i] = -+ psd_scan->psd_report[i]; -+ -+ /* search the max value in this seep */ -+ if (psd_scan->psd_report[i] > loop_val_max) { -+ loop_val_max = psd_scan->psd_report[i]; -+ loop_i_max = i; -+ } -+ } -+ -+ if (gen_count <= BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT) -+ psd_scan->psd_loop_max_value[gen_count - 1] = loop_val_max; -+ -+} -+ -+ -+#ifdef PLATFORM_WINDOWS -+#pragma optimize("", off) -+#endif -+u32 halbtc8723d2ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) -+{ -+ /* reg 0x808[9:0]: FFT data x */ -+ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ -+ /* reg 0x8b4[15:0]: FFT data y report */ -+ -+ u32 val = 0, psd_report = 0; -+ int k = 0; -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ -+ val &= 0xffbffc00; -+ val |= point; -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ val |= 0x00400000; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ while (1) { -+ if (k++ > BT_8723D_2ANT_ANTDET_SWEEPPOINT_DELAY) -+ break; -+ } -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); -+ -+ psd_report = val & 0x0000ffff; -+ -+ return psd_report; -+} -+ -+#ifdef PLATFORM_WINDOWS -+#pragma optimize("", off) -+#endif -+boolean halbtc8723d2ant_psd_sweep_point(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, -+ IN u32 avgnum, IN u32 loopcnt) -+{ -+ u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; -+ u32 points1 = 0, psd_report = 0; -+ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; -+ u32 psd_center_freq = 20 * 10 ^ 6; -+ boolean outloop = false, scan , roam, is_sweep_ok = true; -+ u8 flag = 0; -+ u32 tmp = 0, u32tmp1 = 0; -+ u32 wifi_original_channel = 1; -+ u32 psd_sum = 0, avg_cnt = 0; -+ u32 i_max = 0, val_max = 0, val_max2 = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ do { -+ switch (flag) { -+ case 0: /* Get PSD parameters */ -+ default: -+ -+ psd_scan->psd_band_width = 40 * 1000000; -+ psd_scan->psd_point = points; -+ psd_scan->psd_start_base = points / 2; -+ psd_scan->psd_avg_num = avgnum; -+ psd_scan->real_cent_freq = cent_freq; -+ psd_scan->real_offset = offset; -+ psd_scan->real_span = span; -+ -+ -+ points1 = psd_scan->psd_point; -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* PSD point setup */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffff0fff; -+ -+ switch (psd_scan->psd_point) { -+ case 128: -+ val |= 0x0; -+ break; -+ case 256: -+ default: -+ val |= 0x00004000; -+ break; -+ case 512: -+ val |= 0x00008000; -+ break; -+ case 1024: -+ val |= 0x0000c000; -+ break; -+ } -+ -+ switch (psd_scan->psd_avg_num) { -+ case 1: -+ val |= 0x0; -+ break; -+ case 8: -+ val |= 0x00001000; -+ break; -+ case 16: -+ val |= 0x00002000; -+ break; -+ case 32: -+ default: -+ val |= 0x00003000; -+ break; -+ } -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ flag = 1; -+ break; -+ case 1: /* calculate the PSD point index from freq/offset/span */ -+ psd_center_freq = psd_scan->psd_band_width / 2 + -+ offset * (1000000); -+ -+ start_p = psd_scan->psd_start_base + (psd_center_freq - -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_start_point = start_p - -+ psd_scan->psd_start_base; -+ -+ stop_p = psd_scan->psd_start_base + (psd_center_freq + -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_stop_point = stop_p - -+ psd_scan->psd_start_base - 1; -+ -+ flag = 2; -+ break; -+ case 2: /* set RF channel/BW/Mode */ -+ -+ /* set 3-wire off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val |= 0x00300000; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val &= 0xfeffffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* Tx-pause on */ -+ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); -+ -+ /* store WiFi original channel */ -+ wifi_original_channel = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x18, 0x3ff); -+ -+ /* Set RF channel */ -+ if (cent_freq == 2484) -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, 0xe); -+ else -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, (cent_freq - 2412) / 5 + -+ 1); /* WiFi TRx Mask on */ -+ -+ /* save original RCK value */ -+ u32tmp1 = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x1d, 0xfffff); -+ -+ /* Enter debug mode */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, -+ 0x2, 0x1); -+ -+ /* Set RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, -+ 0xfffff, 0x2e); -+ -+ -+ /* Set RF mode = Rx, RF Gain = 0x320a0 */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, -+ 0xfffff, 0x320a0); -+ -+ while (1) { -+ if (k++ > BT_8723D_2ANT_ANTDET_SWEEPPOINT_DELAY) -+ break; -+ } -+ flag = 3; -+ break; -+ case 3: -+ psd_scan->psd_gen_count = 0; -+ for (j = 1; j <= loopcnt; j++) { -+ -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || roam) { -+ is_sweep_ok = false; -+ break; -+ } -+ memset(psd_scan->psd_report, 0, -+ psd_scan->psd_point * sizeof(u32)); -+ start_p = psd_scan->psd_start_point + -+ psd_scan->psd_start_base; -+ stop_p = psd_scan->psd_stop_point + -+ psd_scan->psd_start_base + 1; -+ -+ i = start_p; -+ point_index = 0; -+ -+ while (i < stop_p) { -+ if (i >= points1) -+ psd_report = -+ halbtc8723d2ant_psd_getdata( -+ btcoexist, i - points1); -+ else -+ psd_report = -+ halbtc8723d2ant_psd_getdata( -+ btcoexist, i); -+ -+ if (psd_report == 0) -+ tmp = 0; -+ else -+ /* tmp = 20*log10((double)psd_report); */ -+ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ -+ tmp = 6 * halbtc8723d2ant_psd_log2base( -+ btcoexist, psd_report); -+ -+ n = i - psd_scan->psd_start_base; -+ psd_scan->psd_report[n] = tmp; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Point=%d, psd_dB_data = %d\n", -+ i, psd_scan->psd_report[n]); -+ BTC_TRACE(trace_buf); -+ -+ i++; -+ -+ } -+ -+ halbtc8723d2ant_psd_maxholddata(btcoexist, j); -+ -+ psd_scan->psd_gen_count = j; -+ -+ /*Accumulate Max PSD value in this loop if the value > threshold */ -+ if (psd_scan->psd_loop_max_value[j - 1] >= -+ 4000) { -+ psd_sum = psd_sum + -+ psd_scan->psd_loop_max_value[j - -+ 1]; -+ avg_cnt++; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Loop=%d, Max_dB_data = %d\n", -+ j, psd_scan->psd_loop_max_value[j -+ - 1]); -+ BTC_TRACE(trace_buf); -+ -+ } -+ -+ if (loopcnt == BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT) { -+ -+ /* search the Max Value between each-freq-point-max-hold value of all sweep*/ -+ for (i = 1; -+ i <= BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT; -+ i++) { -+ -+ if (i == 1) { -+ i_max = i; -+ val_max = psd_scan->psd_loop_max_value[i -+ - 1]; -+ val_max2 = -+ psd_scan->psd_loop_max_value[i -+ - 1]; -+ } else if ( -+ psd_scan->psd_loop_max_value[i - -+ 1] > val_max) { -+ val_max2 = val_max; -+ i_max = i; -+ val_max = psd_scan->psd_loop_max_value[i -+ - 1]; -+ } else if ( -+ psd_scan->psd_loop_max_value[i - -+ 1] > val_max2) -+ val_max2 = -+ psd_scan->psd_loop_max_value[i -+ - 1]; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "i = %d, val_hold= %d, val_max = %d, val_max2 = %d\n", -+ i, psd_scan->psd_loop_max_value[i -+ - 1], -+ val_max, val_max2); -+ -+ BTC_TRACE(trace_buf); -+ } -+ -+ psd_scan->psd_max_value_point = i_max; -+ psd_scan->psd_max_value = val_max; -+ psd_scan->psd_max_value2 = val_max2; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "val_max = %d, val_max2 = %d\n", -+ psd_scan->psd_max_value, -+ psd_scan->psd_max_value2); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (avg_cnt != 0) { -+ psd_scan->psd_avg_value = (psd_sum / avg_cnt); -+ if ((psd_sum % avg_cnt) >= (avg_cnt / 2)) -+ psd_scan->psd_avg_value++; -+ } else -+ psd_scan->psd_avg_value = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "AvgLoop=%d, Avg_dB_data = %d\n", -+ avg_cnt, psd_scan->psd_avg_value); -+ BTC_TRACE(trace_buf); -+ -+ flag = 100; -+ break; -+ case 99: /* error */ -+ -+ outloop = true; -+ break; -+ case 100: /* recovery */ -+ -+ /* set 3-wire on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val &= 0xffcfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val |= 0x01000000; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* Tx-pause off */ -+ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); -+ -+ /* PSD off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffbfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ /* restore RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, -+ 0xfffff, u32tmp1); -+ -+ /* Exit debug mode */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, -+ 0x2, 0x0); -+ -+ /* restore WiFi original channel */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, -+ 0x3ff, wifi_original_channel); -+ -+ outloop = true; -+ break; -+ -+ } -+ -+ } while (!outloop); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); -+ BTC_TRACE(trace_buf); -+ return is_sweep_ok; -+ -+} -+ -+#ifdef PLATFORM_WINDOWS -+#pragma optimize("", off) -+#endif -+boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist -+ *btcoexist) -+{ -+ u32 i = 0; -+ u32 wlpsd_cent_freq = 2484, wlpsd_span = 2; -+ s32 wlpsd_offset = -4; -+ u32 bt_tx_time, bt_le_channel; -+ u8 bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33}; -+ -+ u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; -+ -+ u8 state = 0; -+ boolean outloop = false, bt_resp = false, ant_det_finish = false; -+ u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, -+ u32tmp, u32tmp0, u32tmp1, u32tmp2 ; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); -+ memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); -+ -+ psd_scan->ant_det_bt_tx_time = -+ BT_8723D_2ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ -+ psd_scan->ant_det_bt_le_channel = BT_8723D_2ANT_ANTDET_BTTXCHANNEL; -+ -+ bt_tx_time = psd_scan->ant_det_bt_tx_time; -+ bt_le_channel = psd_scan->ant_det_bt_le_channel; -+ -+ if (board_info->tfbga_package) /* for TFBGA */ -+ psd_scan->ant_det_thres_offset = 5; -+ else -+ psd_scan->ant_det_thres_offset = 0; -+ -+ do { -+ switch (state) { -+ case 0: -+ if (bt_le_channel == 39) -+ wlpsd_cent_freq = 2484; -+ else { -+ for (i = 1; i <= 13; i++) { -+ if (bt_le_ch[i - 1] == -+ bt_le_channel) { -+ wlpsd_cent_freq = 2412 -+ + (i - 1) * 5; -+ break; -+ } -+ } -+ -+ if (i == 14) { -+ -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", -+ bt_le_channel); -+ BTC_TRACE(trace_buf); -+ outloop = true; -+ break; -+ } -+ } -+#if 0 -+ wlpsd_sweep_count = bt_tx_time * 238 / -+ 100; /* bt_tx_time/0.42 */ -+ wlpsd_sweep_count = wlpsd_sweep_count / 5; -+ -+ if (wlpsd_sweep_count % 5 != 0) -+ wlpsd_sweep_count = (wlpsd_sweep_count / -+ 5 + 1) * 5; -+#endif -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", -+ bt_tx_time, bt_le_channel); -+ BTC_TRACE(trace_buf); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", -+ wlpsd_cent_freq, -+ wlpsd_offset, -+ wlpsd_span, -+ BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT); -+ BTC_TRACE(trace_buf); -+ -+ state = 1; -+ break; -+ case 1: /* stop coex DM & set antenna path */ -+ /* Stop Coex DM */ -+ btcoexist->stop_coex_dm = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* Set TDMA off, */ -+ halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, -+ false, 0); -+ -+ /* Set coex table */ -+ halbtc8723d2ant_coex_table_with_type(btcoexist, -+ FORCE_EXEC, 0); -+ -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ /* Set Antenna path, switch WiFi to un-certain antenna port */ -+ /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ -+ halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_ANTENNA_DET); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ -+ h2c_parameter[0] = 0x1; -+ h2c_parameter[1] = 0xd; -+ h2c_parameter[2] = 0x14; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", -+ h2c_parameter[1], -+ h2c_parameter[2]); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, -+ h2c_parameter); -+ -+ u32tmp = btcoexist->btc_read_2byte(btcoexist, 0x948); -+ u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70); -+ u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg( -+ btcoexist, 0x38); -+ u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg( -+ btcoexist, 0x54); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** 0x948 = 0x%x, 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Ant Det)\n", -+ u32tmp, u32tmp0, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ -+ state = 2; -+ break; -+ case 2: /* Pre-sweep background psd */ -+ if (!halbtc8723d2ant_psd_sweep_point(btcoexist, -+ wlpsd_cent_freq, wlpsd_offset, wlpsd_span, -+ BT_8723D_2ANT_ANTDET_PSD_POINTS, -+ BT_8723D_2ANT_ANTDET_PSD_AVGNUM, 3)) { -+ ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ psd_scan->ant_det_result = 8; -+ state = 99; -+ break; -+ } -+ -+ psd_scan->ant_det_pre_psdscan_peak_val = -+ psd_scan->psd_max_value; -+ -+ if (psd_scan->ant_det_pre_psdscan_peak_val > -+ (BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset) * 100) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", -+ psd_scan->ant_det_pre_psdscan_peak_val / -+ 100, -+ BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ BTC_TRACE(trace_buf); -+ ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ psd_scan->ant_det_result = 5; -+ state = 99; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", -+ psd_scan->ant_det_pre_psdscan_peak_val / -+ 100, -+ BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ BTC_TRACE(trace_buf); -+ state = 3; -+ } -+ break; -+ case 3: -+ bt_resp = btcoexist->btc_set_bt_ant_detection( -+ btcoexist, (u8)(bt_tx_time & 0xff), -+ (u8)(bt_le_channel & 0xff)); -+ -+ /* Sync WL Rx PSD with BT Tx time because H2C->Mailbox delay */ -+ delay_ms(20); -+ -+ if (!halbtc8723d2ant_psd_sweep_point(btcoexist, -+ wlpsd_cent_freq, wlpsd_offset, -+ wlpsd_span, -+ BT_8723D_2ANT_ANTDET_PSD_POINTS, -+ BT_8723D_2ANT_ANTDET_PSD_AVGNUM, -+ BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT)) { -+ ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ psd_scan->ant_det_result = 8; -+ state = 99; -+ break; -+ } -+ -+#if 1 -+ psd_scan->ant_det_psd_scan_peak_val = -+ psd_scan->psd_max_value; -+#endif -+#if 0 -+ psd_scan->ant_det_psd_scan_peak_val = -+ ((psd_scan->psd_max_value - psd_scan->psd_avg_value) < -+ 800) ? -+ psd_scan->psd_max_value : (( -+ psd_scan->psd_max_value - -+ psd_scan->psd_max_value2 <= 300) ? -+ psd_scan->psd_avg_value : -+ psd_scan->psd_max_value2); -+#endif -+ psd_scan->ant_det_psd_scan_peak_freq = -+ psd_scan->psd_max_value_point; -+ state = 4; -+ break; -+ case 4: -+ -+ if (psd_scan->psd_point == 0) -+ delta_freq_per_point = 0; -+ else -+ delta_freq_per_point = -+ psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ psd_rep1 = psd_scan->ant_det_psd_scan_peak_val / 100; -+ psd_rep2 = psd_scan->ant_det_psd_scan_peak_val - -+ psd_rep1 * -+ 100; -+ -+ freq = ((psd_scan->real_cent_freq - 20) * -+ 1000000 + psd_scan->psd_max_value_point -+ * delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (freq2 < 100) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", -+ freq1, freq2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_freq, -+ BT_8723D_2ANT_ANTDET_BUF_LEN, -+ "%d.0%d", freq1, freq2); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", -+ freq1, freq2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_freq, -+ BT_8723D_2ANT_ANTDET_BUF_LEN, -+ "%d.%d", freq1, freq2); -+ } -+ -+ if (psd_rep2 < 10) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.0%d dB\n", -+ psd_rep1, psd_rep2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_val, -+ BT_8723D_2ANT_ANTDET_BUF_LEN, -+ "%d.0%d", psd_rep1, psd_rep2); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.%d dB\n", -+ psd_rep1, psd_rep2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_val, -+ BT_8723D_2ANT_ANTDET_BUF_LEN, -+ "%d.%d", psd_rep1, psd_rep2); -+ } -+ -+ psd_scan->ant_det_is_btreply_available = true; -+ -+ if (bt_resp == false) { -+ psd_scan->ant_det_is_btreply_available = -+ false; -+ psd_scan->ant_det_result = 0; -+ ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->ant_det_psd_scan_peak_val > -+ (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) -+ * 100) { -+ psd_scan->ant_det_result = 1; -+ ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 2; -+ coex_sta->isolation_btween_wb = (u8)(85 - -+ psd_scan->ant_det_psd_scan_peak_val / -+ 100) & 0xff; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->ant_det_psd_scan_peak_val > -+ (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset) * 100) { -+ psd_scan->ant_det_result = 2; -+ ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 2; -+ coex_sta->isolation_btween_wb = (u8)(85 - -+ psd_scan->ant_det_psd_scan_peak_val / -+ 100) & 0xff; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->ant_det_psd_scan_peak_val > -+ (BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT) * -+ 100) { -+ psd_scan->ant_det_result = 3; -+ ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ coex_sta->isolation_btween_wb = (u8)(85 - -+ psd_scan->ant_det_psd_scan_peak_val / -+ 100) & 0xff; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ psd_scan->ant_det_result = 4; -+ ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ state = 99; -+ break; -+ case 99: /* restore setup */ -+ -+ /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ -+ h2c_parameter[0] = 0x0; -+ h2c_parameter[1] = 0x0; -+ h2c_parameter[2] = 0x0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", -+ h2c_parameter[1], h2c_parameter[2]); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, -+ h2c_parameter); -+ -+ /* Set Antenna Path, GNT_WL/GNT_BT control by PTA */ -+ /* Set Antenna path, switch WiFi to certain antenna port */ -+ halbtc8723d2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_2G_RUNTIME); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ outloop = true; -+ break; -+ } -+ -+ } while (!outloop); -+ -+ return ant_det_finish; -+ -+} -+ -+#ifdef PLATFORM_WINDOWS -+#pragma optimize("", off) -+#endif -+boolean halbtc8723d2ant_psd_antenna_detection_check(IN struct btc_coexist -+ *btcoexist) -+{ -+ static u32 ant_det_count = 0, ant_det_fail_count = 0; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ boolean scan, roam, ant_det_finish = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ ant_det_count++; -+ -+ psd_scan->ant_det_try_count = ant_det_count; -+ -+ if (scan || roam) { -+ ant_det_finish = false; -+ psd_scan->ant_det_result = 6; -+ } else if (coex_sta->bt_disabled) { -+ ant_det_finish = false; -+ psd_scan->ant_det_result = 11; -+ } else if (coex_sta->num_of_profile >= 1) { -+ ant_det_finish = false; -+ psd_scan->ant_det_result = 7; -+ } else if ( -+ !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ -+ ant_det_finish = false; -+ psd_scan->ant_det_result = 9; -+ } else if (coex_sta->c2h_bt_inquiry_page) { -+ ant_det_finish = false; -+ psd_scan->ant_det_result = 10; -+ } else { -+ -+ ant_det_finish = halbtc8723d2ant_psd_antenna_detection( -+ btcoexist); -+ -+ delay_ms(psd_scan->ant_det_bt_tx_time); -+ } -+ -+ -+ if (!ant_det_finish) -+ ant_det_fail_count++; -+ -+ psd_scan->ant_det_fail_count = ant_det_fail_count; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n", -+ psd_scan->ant_det_result, -+ psd_scan->ant_det_fail_count, -+ ant_det_finish == true ? "Yes" : "No"); -+ BTC_TRACE(trace_buf); -+ -+ return ant_det_finish; -+ -+} -+ -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8723d2ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8723d2ant_ -+ * ************************************************************ */ -+void ex_halbtc8723d2ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp = 0x0; -+ u16 u16tmp = 0x0; -+ u32 value = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Execute 8723d 2-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Ant Det Finish = %s, Ant Det Number = %d\n", -+ (board_info->btdm_ant_det_finish ? "Yes" : "No"), -+ board_info->btdm_ant_num_by_ant_det); -+ BTC_TRACE(trace_buf); -+ -+ -+ btcoexist->stop_coex_dm = true; -+ psd_scan->ant_det_is_ant_det_available = false; -+ -+ /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ -+ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); -+ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); -+ -+ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ -+ -+ /* Set path control to WL */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1); -+ btcoexist->btc_write_2byte(btcoexist, 0x948, 0x0); -+ -+ /* Check efuse 0xc3[6] for Single Antenna Path */ -+ if (board_info->single_ant_path == 0) { -+ /* set to S1 */ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+ u8tmp = 4; -+ value = 1; -+ } else if (board_info->single_ant_path == 1) { -+ /* set to S0 */ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; -+ u8tmp = 5; -+ value = 0; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (Power On) single_ant_path = %d, btdm_ant_pos = %d **********\n", -+ board_info->single_ant_path , board_info->btdm_ant_pos); -+ BTC_TRACE(trace_buf); -+ -+ /* Set Antenna Path to BT side */ -+ halbtc8723d2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_1ANT_PHASE_COEX_POWERON); -+ -+ /* Write Single Antenna Position to Registry to tell BT for 872db. This line can be removed -+ since BT EFuse also add "single antenna position" in EFuse for 8723d*/ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, -+ &value); -+ -+ /* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at power on */ -+ if (btcoexist->chip_interface == BTC_INTF_PCI) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_USB) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_SDIO) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); -+ -+ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ -+ halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, true); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", -+ halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0x948 (Power-On) = 0x%x / 0x%x**********\n", -+ btcoexist->btc_read_4byte(btcoexist, 0x70), -+ btcoexist->btc_read_2byte(btcoexist, 0x948)); -+ BTC_TRACE(trace_buf); -+} -+ -+void ex_halbtc8723d2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ -+ -+ /* */ -+ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ -+ if (btcoexist->chip_interface == BTC_INTF_USB) { -+ /* fixed at S0 for USB interface */ -+ u8tmp |= 0x1; /* antenna inverse */ -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); -+ } else { -+ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ -+ if (board_info->single_ant_path == 0) { -+ } else if (board_info->single_ant_path == 1) { -+ /* set to S0 */ -+ u8tmp |= 0x1; /* antenna inverse */ -+ } -+ -+ if (btcoexist->chip_interface == BTC_INTF_PCI) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, -+ u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_SDIO) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, -+ u8tmp); -+ } -+} -+ -+ -+void ex_halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ halbtc8723d2ant_init_hw_config(btcoexist, wifi_only); -+} -+ -+void ex_halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ -+ halbtc8723d2ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, ps_tdma_case = 0; -+ u32 u32tmp[4]; -+ u16 u16tmp[4]; -+ u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck, bt_coex_ver = 0; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ static u8 pop_report_in_10s = 0, cnt = 0; -+ u32 phyver = 0; -+ boolean lte_coex_on = false; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (!coex_sta->bt_disabled) { -+ -+ if (coex_sta->bt_coex_supported_feature == 0) -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, -+ &coex_sta->bt_coex_supported_feature); -+ -+ if ((coex_sta->bt_coex_supported_version == 0) || -+ (coex_sta->bt_coex_supported_version == 0xffff)) -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, -+ &coex_sta->bt_coex_supported_version); -+ -+ if (coex_sta->bt_reg_vendor_ac == 0xffff) -+ coex_sta->bt_reg_vendor_ac = (u16)( -+ btcoexist->btc_get_bt_reg(btcoexist, 3, -+ 0xac) & 0xffff); -+ -+ if (coex_sta->bt_reg_vendor_ae == 0xffff) -+ coex_sta->bt_reg_vendor_ae = (u16)( -+ btcoexist->btc_get_bt_reg(btcoexist, 3, -+ 0xae) & 0xffff); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, -+ &bt_patch_ver); -+ btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; -+ -+ if (coex_sta->num_of_profile > 0) { -+ cnt++; -+ -+ if (cnt >= 3) { -+ btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, -+ &coex_sta->bt_afh_map[0]); -+ cnt = 0; -+ } -+ } -+ } -+ -+ if (psd_scan->ant_det_try_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", -+ "Ant PG Num/ Mech/ Pos", -+ board_info->pg_ant_num, board_info->btdm_ant_num, -+ (board_info->btdm_ant_pos == 1 ? "S1" : "S0")); -+ CL_PRINTF(cli_buf); -+ } else { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %s (retry=%d/fail=%d/result=%d)", -+ "Ant PG Num/ Mech(Ant_Det)/ Pos", -+ board_info->pg_ant_num, -+ board_info->btdm_ant_num_by_ant_det, -+ (board_info->btdm_ant_pos == 1 ? "S1" : "S0"), -+ psd_scan->ant_det_try_count, -+ psd_scan->ant_det_fail_count, -+ psd_scan->ant_det_result); -+ CL_PRINTF(cli_buf); -+ -+ if (board_info->btdm_ant_det_finish) { -+ -+ if (psd_scan->ant_det_result != 12) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s", -+ "Ant Det PSD Value", -+ psd_scan->ant_det_peak_val); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d", -+ "Ant Det PSD Value", -+ psd_scan->ant_det_psd_scan_peak_val -+ / 100); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ if (board_info->ant_det_result_five_complete) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d", -+ "AntDet(Registry) Num/PSD Value", -+ board_info->btdm_ant_num_by_ant_det, -+ (board_info->antdetval & 0x7f)); -+ CL_PRINTF(cli_buf); -+ } -+ -+ -+ bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); -+ -+ bt_coex_ver = coex_sta->bt_coex_supported_version & 0xff; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", -+ "CoexVer WL/ BT_Desired/ BT_Report", -+ glcoex_ver_date_8723d_2ant, glcoex_ver_8723d_2ant, -+ glcoex_ver_btdesired_8723d_2ant, -+ bt_coex_ver, -+ (bt_coex_ver == 0xff ? "Unknown" : -+ (coex_sta->bt_disabled ? "BT-disable" : -+ (bt_coex_ver >= glcoex_ver_btdesired_8723d_2ant ? -+ "Match" : "Mis-Match")))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", -+ "W_FW/ B_FW/ Phy/ Kt", -+ fw_ver, bt_patch_ver, phyver, -+ coex_sta->cut_version + 65); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d ", -+ "Isolation/WL_Thres/BT_Thres", -+ coex_sta->isolation_btween_wb, -+ coex_sta->wifi_coex_thres, -+ coex_sta->bt_coex_thres); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ pop_report_in_10s++; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = [%s/ %d dBm/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt/ popCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") -+ : ((BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, -+ coex_sta->pop_event_cnt); -+ CL_PRINTF(cli_buf); -+ -+ if (pop_report_in_10s >= 5) { -+ coex_sta->pop_event_cnt = 0; -+ pop_report_in_10s = 0; -+ } -+ -+ -+ if (coex_sta->num_of_profile != 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s%s%s%s%s", -+ "Profiles", -+ ((bt_link_info->a2dp_exist) ? "A2DP," : ""), -+ ((bt_link_info->sco_exist) ? "SCO," : ""), -+ ((bt_link_info->hid_exist) ? -+ ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : -+ "HID(2/18),") : ""), -+ ((bt_link_info->pan_exist) ? "PAN," : ""), -+ ((coex_sta->voice_over_HOGP) ? "Voice" : "")); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = None", -+ "Profiles"); -+ -+ CL_PRINTF(cli_buf); -+ -+ -+ if (bt_link_info->a2dp_exist) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s", -+ "A2DP Rate/Bitpool/Auto_Slot", -+ ((coex_sta->is_A2DP_3M) ? "3M" : "No_3M"), -+ coex_sta->a2dp_bit_pool, -+ ((coex_sta->is_autoslot) ? "On" : "Off") -+ ); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (bt_link_info->hid_exist) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "HID PairNum/Forbid_Slot", -+ coex_sta->hid_pair_cnt, -+ coex_sta->forbidden_slot -+ ); -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s/ 0x%x/ 0x%x", -+ "Role/IgnWlanAct/Feature/BLEScan", -+ ((bt_link_info->slave_role) ? "Slave" : "Master"), -+ ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"), -+ coex_sta->bt_coex_supported_feature, -+ coex_sta->bt_ble_scan_type); -+ CL_PRINTF(cli_buf); -+ -+ if ((coex_sta->bt_ble_scan_type & 0x7) != 0x0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%08x/ 0x%08x/ 0x%08x", -+ "BLEScan Intv-Win TV/Init/Ble", -+ (coex_sta->bt_ble_scan_type & 0x1 ? -+ coex_sta->bt_ble_scan_para[0] : 0x0), -+ (coex_sta->bt_ble_scan_type & 0x2 ? -+ coex_sta->bt_ble_scan_para[1] : 0x0), -+ (coex_sta->bt_ble_scan_type & 0x4 ? -+ coex_sta->bt_ble_scan_para[2] : 0x0)); -+ -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", -+ "ReInit/ReLink/IgnWlact/Page/NameReq", -+ coex_sta->cnt_ReInit, -+ coex_sta->cnt_setupLink, -+ coex_sta->cnt_IgnWlanAct, -+ coex_sta->cnt_Page, -+ coex_sta->cnt_RemoteNameReq -+ ); -+ CL_PRINTF(cli_buf); -+ -+ halbtc8723d2ant_read_score_board(btcoexist, &u16tmp[0]); -+ -+ if ((coex_sta->bt_reg_vendor_ae == 0xffff) || -+ (coex_sta->bt_reg_vendor_ac == 0xffff)) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ %04x", -+ "0xae[4]/0xac[1:0]/Scoreboard", u16tmp[0]); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ %04x", -+ "0xae[4]/0xac[1:0]/Scoreboard", -+ ((coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4), -+ coex_sta->bt_reg_vendor_ac & 0x3, u16tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ if (coex_sta->num_of_profile > 0) { -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x", -+ "AFH MAP", -+ coex_sta->bt_afh_map[0], -+ coex_sta->bt_afh_map[1], -+ coex_sta->bt_afh_map[2], -+ coex_sta->bt_afh_map[3], -+ coex_sta->bt_afh_map[4], -+ coex_sta->bt_afh_map[5], -+ coex_sta->bt_afh_map[6], -+ coex_sta->bt_afh_map[7], -+ coex_sta->bt_afh_map[8], -+ coex_sta->bt_afh_map[9] -+ ); -+ CL_PRINTF(cli_buf); -+ } -+ -+ for (i = 0; i < BT_INFO_SRC_8723D_2ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x (%d)", -+ glbt_info_src_8723d_2ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ /* Sw mechanism */ -+ if (btcoexist->manual_control) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanism] (before Manual)============"); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Mechanism]============"); -+ -+ CL_PRINTF(cli_buf); -+ -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x (case-%d, %s, %s)", -+ "TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ (coex_dm->cur_ps_tdma_on ? "TDMA On" : "TDMA Off"), -+ (coex_dm->is_switch_to_1dot5_ant ? "1.5Ant" : "2Ant")); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ 0x%x/ 0x%x/ 0x%x", -+ "Table/0x6c0/0x6c4/0x6c8", -+ coex_sta->coex_table_type, u32tmp[0], u32tmp[1], u32tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x", -+ "0x778/0x6cc", -+ u8tmp[0], u32tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", -+ "AntDiv/ ForceLPS", -+ ((board_info->ant_div_cfg) ? "On" : "Off"), -+ ((coex_sta->force_lps_on) ? "On" : "Off")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "WL_DACSwing/ BT_Dec_Pwr", coex_dm->cur_fw_dac_swing_lvl, -+ coex_dm->cur_bt_dec_pwr_lvl); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? true : false; -+ -+ if (lte_coex_on) { -+ -+ u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa0); -+ u32tmp[1] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "LTE Coex Table W_L/B_L", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa8); -+ u32tmp[1] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xac); -+ u32tmp[2] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb0); -+ u32tmp[3] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "LTE Break Table W_L/B_L/L_W/L_B", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, -+ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ } -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ /* -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "0x430/0x434/0x42a/0x456", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ */ -+ u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp[1] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", -+ "LTE Coex/Path Owner", -+ ((lte_coex_on) ? "On" : "Off") , -+ ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); -+ CL_PRINTF(cli_buf); -+ -+ if (lte_coex_on) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d/ %d", -+ "LTE 3Wire/OPMode/UART/UARTMode", -+ (int)((u32tmp[0] & BIT(6)) >> 6), -+ (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), -+ (int)((u32tmp[0] & BIT(3)) >> 3), -+ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "LTE_Busy/UART_Busy", -+ (int)((u32tmp[1] & BIT(1)) >> 1), (int)(u32tmp[1] & BIT(0))); -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s %d", -+ "GNT_WL_Ctrl/GNT_BT_Ctrl/Dbg", -+ ((u32tmp[0] & BIT(12)) ? "SW" : "HW"), -+ ((u32tmp[0] & BIT(8)) ? "SW" : "HW"), -+ ((u32tmp[0] & BIT(14)) ? "SW" : "HW"), -+ ((u32tmp[0] & BIT(10)) ? "SW" : "HW"), -+ ((u8tmp[0] & BIT(3)) ? "On" : "Off"), -+ coex_sta->gnt_error_cnt); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "GNT_WL/GNT_BT", -+ (int)((u32tmp[1] & BIT(2)) >> 2), -+ (int)((u32tmp[1] & BIT(3)) >> 3)); -+ CL_PRINTF(cli_buf); -+ -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x948); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x948/0x67[7]", -+ u16tmp[0], (int)((u8tmp[0] & BIT(7)) >> 7)); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x964); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x864); -+ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xab7); -+ u8tmp[3] = btcoexist->btc_read_1byte(btcoexist, 0xa01); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x964[1]/0x864[0]/0xab7[5]/0xa01[7]", -+ (int)((u8tmp[0] & BIT(1)) >> 1), (int)((u8tmp[1] & BIT(0))), -+ (int)((u8tmp[2] & BIT(3)) >> 3), -+ (int)((u8tmp[3] & BIT(7)) >> 7)); -+ CL_PRINTF(cli_buf); -+ -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x45e); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x4c6[4]/0x40[5]/0x45e[3](TxRetry)", -+ (int)((u8tmp[0] & BIT(4)) >> 4), -+ (int)((u8tmp[1] & BIT(5)) >> 5), -+ (int)((u8tmp[2] & BIT(3)) >> 3)); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s", -+ "0x550/0x522/4-RxAGC", -+ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); -+ CL_PRINTF(cli_buf); -+ -+ fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_FA_OFDM); -+ fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_FA_CCK); -+ cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_CCA_OFDM); -+ cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_CCA_CCK); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", -+ cca_cck, fa_cck, cca_ofdm, fa_ofdm); -+ CL_PRINTF(cli_buf); -+ -+#if 1 -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_OK CCK/11g/11n/11n-agg", -+ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, -+ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_Err CCK/11g/11n/11n-agg", -+ coex_sta->crc_err_cck, coex_sta->crc_err_11g, -+ coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); -+ CL_PRINTF(cli_buf); -+#endif -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", -+ "WlHiPri/ Locking/ Locked/ Noisy", -+ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), -+ (coex_sta->cck_lock ? "Yes" : "No"), -+ (coex_sta->cck_ever_lock ? "Yes" : "No"), -+ coex_sta->wl_noisy_level); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", -+ "0x770(Hi-pri rx/tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx, -+ (coex_sta->is_hiPri_rx_overhead ? "(scan overhead!!)" : "")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", -+ "0x774(Lo-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx, -+ (bt_link_info->slave_role ? "(Slave!!)" : ( -+ coex_sta->is_tdma_btautoslot_hang ? "(auto-slot hang!!)" : ""))); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void ex_halbtc8723d2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ coex_sta->under_lps = false; -+ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_2ANT_SCOREBOARD_ONOFF | -+ BT_8723D_2ANT_SCOREBOARD_SCAN | -+ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, -+ false); -+ -+ halbtc8723d2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_WLAN_OFF); -+ -+ halbtc8723d2ant_action_coex_all_off(btcoexist); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = false; -+#if 0 -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); -+ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ONOFF, true); -+#endif -+ halbtc8723d2ant_init_hw_config(btcoexist, false); -+ halbtc8723d2ant_init_coex_dm(btcoexist); -+ halbtc8723d2ant_query_bt_info(btcoexist); -+ } -+} -+ -+void ex_halbtc8723d2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ coex_sta->under_ips = false; -+ -+ if (coex_sta->force_lps_on == true) { /* LPS No-32K */ -+ /* Write WL "Active" in Score-board for PS-TDMA */ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); -+ -+ } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ -+ /* Write WL "Non-Active" in Score-board for Native-PS */ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE, false); -+ } -+ -+ -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); -+ } -+} -+ -+void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u32 u32tmp; -+ u8 u8tmpa, u8tmpb; -+ boolean wifi_connected = false; -+ -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ /* this can't be removed for RF off_on event, or BT would dis-connect */ -+ halbtc8723d2ant_query_bt_info(btcoexist); -+ -+ if (BTC_SCAN_START == type) { -+ -+ if (!wifi_connected) -+ coex_sta->wifi_is_high_pri_task = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_2ANT_SCOREBOARD_SCAN | -+ BT_8723D_2ANT_SCOREBOARD_ONOFF, -+ true); -+ -+ halbtc8723d2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8723d2ant_run_coexist_mechanism(btcoexist); -+ -+ } else if (BTC_SCAN_FINISH == type) { -+ -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", -+ coex_sta->scan_ap_num); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_SCAN, false); -+ -+ halbtc8723d2ant_run_coexist_mechanism(btcoexist); -+ } -+ -+} -+ -+void ex_halbtc8723d2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_ASSOCIATE_START == type) { -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_2ANT_SCOREBOARD_SCAN | -+ BT_8723D_2ANT_SCOREBOARD_ONOFF, -+ true); -+ -+ halbtc8723d2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8723d2ant_run_coexist_mechanism(btcoexist); -+ /* To keep TDMA case during connect process, -+ to avoid changed by Btinfo and runcoexmechanism */ -+ coex_sta->freeze_coexrun_by_btinfo = true; -+ -+ coex_dm->arp_cnt = 0; -+ -+ } else if (BTC_ASSOCIATE_FINISH == type) { -+ -+ coex_sta->wifi_is_high_pri_task = false; -+ coex_sta->freeze_coexrun_by_btinfo = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_run_coexist_mechanism(btcoexist); -+ } -+} -+ -+void ex_halbtc8723d2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ u8 ap_num = 0; -+ boolean wifi_under_b_mode = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_2ANT_SCOREBOARD_ONOFF, -+ true); -+ -+ halbtc8723d2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_2G_RUNTIME); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ /* Set CCK Tx/Rx high Pri except 11b mode */ -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x00); /* CCK Rx */ -+ } else { -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x10); /* CCK Rx */ -+ } -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ -+ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE, false); -+ } -+ -+ -+ halbtc8723d2ant_update_wifi_channel_info(btcoexist, type); -+} -+ -+void ex_halbtc8723d2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean under_4way = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (under_4way) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ---- under_4way!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ coex_sta->specific_pkt_period_cnt = 2; -+ -+ } else if (BTC_PACKET_ARP == type) { -+ -+ coex_dm->arp_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ARP notify -cnt = %d\n", -+ coex_dm->arp_cnt); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", -+ type); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } -+ -+ if (coex_sta->wifi_is_high_pri_task) { -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); -+ halbtc8723d2ant_run_coexist_mechanism(btcoexist); -+ } -+ -+} -+ -+void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 i, rsp_source = 0; -+ boolean wifi_connected = false; -+ boolean wifi_scan = false, wifi_link = false, wifi_roam = false, -+ wifi_busy = false; -+ static boolean is_scoreboard_scan = false; -+ -+ if (psd_scan->is_AntDet_running == true) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt_info_notify return for AntDet is running\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8723D_2ANT_MAX) -+ rsp_source = BT_INFO_SRC_8723D_2ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt_info[%d], len=%d, data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ coex_sta->bt_info = coex_sta->bt_info_c2h[rsp_source][1]; -+ coex_sta->bt_info_ext = coex_sta->bt_info_c2h[rsp_source][4]; -+ coex_sta->bt_info_ext2 = coex_sta->bt_info_c2h[rsp_source][5]; -+ -+ if (BT_INFO_SRC_8723D_2ANT_WIFI_FW != rsp_source) { -+ -+ /* if 0xff, it means BT is under WHCK test */ -+ coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? true : -+ false); -+ -+ coex_sta->bt_create_connection = (( -+ coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? true : -+ false); -+ -+ /* unit: %, value-100 to translate to unit: dBm */ -+ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + -+ 10; -+ -+ coex_sta->c2h_bt_remote_name_req = (( -+ coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? true : -+ false); -+ -+ coex_sta->is_A2DP_3M = ((coex_sta->bt_info_c2h[rsp_source][2] & -+ 0x10) ? true : false); -+ -+ coex_sta->acl_busy = ((coex_sta->bt_info_c2h[rsp_source][1] & -+ 0x9) ? true : false); -+ -+ coex_sta->voice_over_HOGP = ((coex_sta->bt_info_ext & 0x10) ? -+ true : false); -+ -+ coex_sta->c2h_bt_inquiry_page = ((coex_sta->bt_info & -+ BT_INFO_8723D_2ANT_B_INQ_PAGE) ? true : false); -+ -+ coex_sta->a2dp_bit_pool = ((( -+ coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) ? -+ coex_sta->bt_info_c2h[rsp_source][6] : 0); -+ -+ coex_sta->bt_retry_cnt = coex_sta->bt_info_c2h[rsp_source][2] & -+ 0xf; -+ -+ coex_sta->is_autoslot = coex_sta->bt_info_ext2 & 0x8; -+ -+ coex_sta->forbidden_slot = coex_sta->bt_info_ext2 & 0x7; -+ -+ coex_sta->hid_busy_num = (coex_sta->bt_info_ext2 & 0x30) >> 4; -+ -+ coex_sta->hid_pair_cnt = (coex_sta->bt_info_ext2 & 0xc0) >> 6; -+ -+ if (coex_sta->bt_retry_cnt >= 1) -+ coex_sta->pop_event_cnt++; -+ -+ if (coex_sta->c2h_bt_remote_name_req) -+ coex_sta->cnt_RemoteNameReq++; -+ -+ if (coex_sta->bt_info_ext & BIT(1)) -+ coex_sta->cnt_ReInit++; -+ -+ if (coex_sta->bt_info_ext & BIT(2)) { -+ coex_sta->cnt_setupLink++; -+ coex_sta->is_setupLink = true; -+ } else -+ coex_sta->is_setupLink = false; -+ -+ if (coex_sta->bt_info_ext & BIT(3)) -+ coex_sta->cnt_IgnWlanAct++; -+ -+ if (coex_sta->bt_create_connection) { -+ coex_sta->cnt_Page++; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, -+ &wifi_busy); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); -+ -+ if ((wifi_link) || (wifi_roam) || (wifi_scan) || -+ (coex_sta->wifi_is_high_pri_task) || (wifi_busy)) { -+ -+ is_scoreboard_scan = true; -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_SCAN, true); -+ -+ } else -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_SCAN, false); -+ -+ } else { -+ if (is_scoreboard_scan) { -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_SCAN, false); -+ is_scoreboard_scan = false; -+ } -+ } -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ -+ if ((!btcoexist->manual_control) && -+ (!btcoexist->stop_coex_dm)) { -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ /* Re-Init */ -+ if ((coex_sta->bt_info_ext & BIT(1))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ if (wifi_connected) -+ halbtc8723d2ant_update_wifi_channel_info( -+ btcoexist, BTC_MEDIA_CONNECT); -+ else -+ halbtc8723d2ant_update_wifi_channel_info( -+ btcoexist, -+ BTC_MEDIA_DISCONNECT); -+ } -+ -+ -+ /* If Ignore_WLanAct && not SetUp_Link or Role_Switch */ -+ if ((coex_sta->bt_info_ext & BIT(3)) && -+ (!(coex_sta->bt_info_ext & BIT(2))) && -+ (!(coex_sta->bt_info_ext & BIT(6)))) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8723d2ant_ignore_wlan_act(btcoexist, -+ FORCE_EXEC, false); -+ } else { -+ if (coex_sta->bt_info_ext & BIT(2)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ignore Wlan active because Re-link!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (coex_sta->bt_info_ext & BIT(6)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ignore Wlan active because Role-Switch!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ } -+ -+ } -+ -+ if ((coex_sta->bt_info_ext & BIT(5))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist); -+ -+ if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) -+ coex_sta->bt_ble_scan_para[0] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x1); -+ if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) -+ coex_sta->bt_ble_scan_para[1] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x2); -+ if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) -+ coex_sta->bt_ble_scan_para[2] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x4); -+ } -+ -+ halbtc8723d2ant_update_bt_link_info(btcoexist); -+ -+ halbtc8723d2ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8723d2ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_RF_ON == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = false; -+#if 0 -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ONOFF, true); -+#endif -+ } else if (BTC_RF_OFF == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_WLAN_OFF); -+ -+ halbtc8723d2ant_action_coex_all_off(btcoexist); -+ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_2ANT_SCOREBOARD_ONOFF | -+ BT_8723D_2ANT_SCOREBOARD_SCAN | -+ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, -+ false); -+ -+ btcoexist->stop_coex_dm = true; -+ -+ } -+} -+ -+void ex_halbtc8723d2ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8723d2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_WLAN_OFF); -+ -+ ex_halbtc8723d2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_2ANT_SCOREBOARD_ONOFF | -+ BT_8723D_2ANT_SCOREBOARD_SCAN | -+ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, -+ false); -+} -+ -+void ex_halbtc8723d2ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if ((BTC_WIFI_PNP_SLEEP == pnp_state) || -+ (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ -+ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ -+ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ -+ coex_sta->under_ips = false; -+ coex_sta->under_lps = false; -+ -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE | -+ BT_8723D_2ANT_SCOREBOARD_ONOFF | -+ BT_8723D_2ANT_SCOREBOARD_SCAN | -+ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, -+ false); -+ -+ if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { -+ -+ halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_2G_RUNTIME); -+ } else { -+ -+ halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_WLAN_OFF); -+ } -+ -+ -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+#if 0 -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_ONOFF, true); -+#endif -+ } -+} -+ -+void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ boolean wifi_busy = false; -+ u32 bt_patch_ver; -+ static u8 cnt = 0; -+ boolean bt_relink_finish = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ************* Periodical *************\n"); -+ BTC_TRACE(trace_buf); -+ -+#if (BT_AUTO_REPORT_ONLY_8723D_2ANT == 0) -+ halbtc8723d2ant_query_bt_info(btcoexist); -+#endif -+ -+ halbtc8723d2ant_monitor_bt_ctr(btcoexist); -+ halbtc8723d2ant_monitor_wifi_ctr(btcoexist); -+ halbtc8723d2ant_monitor_bt_enable_disable(btcoexist); -+ -+#if 0 -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ /* halbtc8723d2ant_read_score_board(btcoexist, &bt_scoreboard_val); */ -+ -+ if (wifi_busy) { -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, true); -+ /* -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_WLBUSY, true); -+ -+ if (bt_scoreboard_val & BIT(6)) -+ halbtc8723d2ant_query_bt_info(btcoexist); */ -+ } else { -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_UNDERTEST, false); -+ /* -+ halbtc8723d2ant_post_state_to_bt(btcoexist, -+ BT_8723D_2ANT_SCOREBOARD_WLBUSY, -+ false); */ -+ } -+#endif -+ -+ if (coex_sta->bt_relink_downcount != 0) { -+ coex_sta->bt_relink_downcount--; -+ -+ if (coex_sta->bt_relink_downcount == 0) -+ bt_relink_finish = true; -+ } -+ -+ /* for 4-way, DHCP, EAPOL packet */ -+ if (coex_sta->specific_pkt_period_cnt > 0) { -+ -+ coex_sta->specific_pkt_period_cnt--; -+ -+ if ((coex_sta->specific_pkt_period_cnt == 0) && -+ (coex_sta->wifi_is_high_pri_task)) -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", -+ (coex_sta->wifi_is_high_pri_task ? "Yes" : -+ "No")); -+ BTC_TRACE(trace_buf); -+ -+ } -+ -+ if (!coex_sta->bt_disabled) { -+ -+#if BT_8723D_2ANT_ANTDET_ENABLE -+ -+ if (board_info->btdm_ant_det_finish) { -+ if ((psd_scan->ant_det_result == 12) && -+ (psd_scan->ant_det_psd_scan_peak_val == 0) -+ && (!psd_scan->is_AntDet_running)) -+ psd_scan->ant_det_psd_scan_peak_val = -+ btcoexist->btc_get_ant_det_val_from_bt( -+ btcoexist) * 100; -+ } -+ -+#endif -+ } -+ -+ -+ if (halbtc8723d2ant_is_wifibt_status_changed(btcoexist)) -+ halbtc8723d2ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8723d2ant_set_antenna_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (type == 2) { /* two antenna */ -+ board_info->ant_div_cfg = true; -+ -+ halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_2G_RUNTIME); -+ -+ } else { /* one antenna */ -+ -+ halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8723D_2ANT_PHASE_2G_RUNTIME); -+ -+ } -+} -+ -+#ifdef PLATFORM_WINDOWS -+#pragma optimize("", off) -+#endif -+void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+ -+ static u32 ant_det_count = 0, ant_det_fail_count = 0; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u16 u16tmp; -+ u8 AntDetval = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n"); -+ BTC_TRACE(trace_buf); -+ -+#if BT_8723D_2ANT_ANTDET_ENABLE -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Call AntennaDetect()!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (seconds == 0) { -+ psd_scan->ant_det_try_count = 0; -+ psd_scan->ant_det_fail_count = 0; -+ ant_det_count = 0; -+ ant_det_fail_count = 0; -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ return; -+ } -+ -+ if (!board_info->btdm_ant_det_finish) { -+ psd_scan->ant_det_inteval_count = -+ psd_scan->ant_det_inteval_count + 2; -+ -+ if (psd_scan->ant_det_inteval_count >= -+ BT_8723D_2ANT_ANTDET_RETRY_INTERVAL) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ psd_scan->is_AntDet_running = true; -+ -+ halbtc8723d2ant_read_score_board(btcoexist, &u16tmp); -+ -+ if (u16tmp & BIT( -+ 2)) { /* Antenna detection is already done before last WL power on */ -+ board_info->btdm_ant_det_finish = true; -+ psd_scan->ant_det_try_count = 1; -+ psd_scan->ant_det_fail_count = 0; -+ board_info->btdm_ant_num_by_ant_det = (u16tmp & -+ BIT(3)) ? 1 : 2; -+ psd_scan->ant_det_result = 12; -+ -+ psd_scan->ant_det_psd_scan_peak_val = -+ btcoexist->btc_get_ant_det_val_from_bt( -+ btcoexist) * 100; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Result from BT (%d-Ant)\n", -+ board_info->btdm_ant_num_by_ant_det); -+ BTC_TRACE(trace_buf); -+ } else -+ board_info->btdm_ant_det_finish = -+ halbtc8723d2ant_psd_antenna_detection_check( -+ btcoexist); -+ -+ btcoexist->bdontenterLPS = false; -+ -+ if (board_info->btdm_ant_det_finish) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /*for 8723d, btc_set_bt_trx_mask is just used to -+ notify BT stop le tx and Ant Det Result , not set BT RF TRx Mask */ -+ if (psd_scan->ant_det_result != 12) { -+ -+ AntDetval = (u8)( -+ psd_scan->ant_det_psd_scan_peak_val -+ / 100) & 0x7f; -+ -+ AntDetval = -+ (board_info->btdm_ant_num_by_ant_det -+ == 1) ? (AntDetval | 0x80) : -+ AntDetval; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxx AntennaDetect(), Ant Count = %d, PSD Val = %d\n", -+ ((AntDetval & -+ 0x80) ? 1 -+ : 2), AntDetval -+ & 0x7f); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->btc_set_bt_trx_mask( -+ btcoexist, AntDetval)) -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask ok!\n"); -+ else -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask fail!\n"); -+ -+ BTC_TRACE(trace_buf); -+ } else -+ board_info->antdetval = -+ psd_scan->ant_det_psd_scan_peak_val/100; -+ -+ board_info->btdm_ant_det_complete_fail = false; -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ psd_scan->ant_det_inteval_count = 0; -+ psd_scan->is_AntDet_running = false; -+ -+ /* stimulate coex running */ -+ halbtc8723d2ant_run_coexist_mechanism( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", -+ psd_scan->ant_det_inteval_count); -+ BTC_TRACE(trace_buf); -+ -+ if (psd_scan->ant_det_inteval_count == 8) -+ btcoexist->bdontenterLPS = true; -+ else -+ btcoexist->bdontenterLPS = false; -+ } -+ -+ } -+#endif -+ -+ -+} -+ -+ -+void ex_halbtc8723d2ant_display_ant_detection(IN struct btc_coexist *btcoexist) -+{ -+ -+#if BT_8723D_2ANT_ANTDET_ENABLE -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ if (psd_scan->ant_det_try_count != 0) { -+ halbtc8723d2ant_psd_show_antenna_detect_result(btcoexist); -+ -+ if (board_info->btdm_ant_det_finish) -+ halbtc8723d2ant_psd_showdata(btcoexist); -+ } -+#endif -+ -+} -+ -+ -+#endif -+ -+#endif /* #if (RTL8723D_SUPPORT == 1) */ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8723d2ant.h 2018-02-11 21:44:27.149146116 +0200 -@@ -0,0 +1,420 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8723D_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8723D 2Ant BT Co-exist definition -+ * ******************************************* */ -+#define BT_8723D_2ANT_COEX_DBG 0 -+#define BT_AUTO_REPORT_ONLY_8723D_2ANT 1 -+ -+ -+#define BT_INFO_8723D_2ANT_B_FTP BIT(7) -+#define BT_INFO_8723D_2ANT_B_A2DP BIT(6) -+#define BT_INFO_8723D_2ANT_B_HID BIT(5) -+#define BT_INFO_8723D_2ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8723D_2ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8723D_2ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8723D_2ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8723D_2ANT_B_CONNECTION BIT(0) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT 2 -+ -+ -+#define BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 80 /* unit: % WiFi RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 42 */ -+#define BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 80 /* unit: % BT RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 46 */ -+#define BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES2 80 /* unit: % WiFi RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 42 */ -+#define BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES2 80 /* unit: % BT RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 46 */ -+#define BT_8723D_2ANT_DEFAULT_ISOLATION 15 /* unit: dB */ -+#define BT_8723D_2ANT_WIFI_MAX_TX_POWER 15 /* unit: dBm */ -+#define BT_8723D_2ANT_BT_MAX_TX_POWER 3 /* unit: dBm */ -+#define BT_8723D_2ANT_WIFI_SIR_THRES1 -15 /* unit: dB */ -+#define BT_8723D_2ANT_WIFI_SIR_THRES2 -30 /* unit: dB */ -+#define BT_8723D_2ANT_BT_SIR_THRES1 -15 /* unit: dB */ -+#define BT_8723D_2ANT_BT_SIR_THRES2 -30 /* unit: dB */ -+ -+ -+/* for Antenna detection */ -+#define BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND 50 -+#define BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -+#define BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 52 -+#define BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT 40 -+#define BT_8723D_2ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -+#define BT_8723D_2ANT_ANTDET_SWEEPPOINT_DELAY 60000 -+#define BT_8723D_2ANT_ANTDET_ENABLE 1 -+#define BT_8723D_2ANT_ANTDET_BTTXTIME 100 -+#define BT_8723D_2ANT_ANTDET_BTTXCHANNEL 39 -+#define BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT 50 -+ -+ -+#define BT_8723D_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 -+ -+enum bt_8723d_2ant_signal_state { -+ BT_8723D_2ANT_SIG_STA_SET_TO_LOW = 0x0, -+ BT_8723D_2ANT_SIG_STA_SET_BY_HW = 0x0, -+ BT_8723D_2ANT_SIG_STA_SET_TO_HIGH = 0x1, -+ BT_8723D_2ANT_SIG_STA_MAX -+}; -+ -+enum bt_8723d_2ant_path_ctrl_owner { -+ BT_8723D_2ANT_PCO_BTSIDE = 0x0, -+ BT_8723D_2ANT_PCO_WLSIDE = 0x1, -+ BT_8723D_2ANT_PCO_MAX -+}; -+ -+enum bt_8723d_2ant_gnt_ctrl_type { -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, -+ BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW = 0x1, -+ BT_8723D_2ANT_GNT_TYPE_MAX -+}; -+ -+enum bt_8723d_2ant_gnt_ctrl_block { -+ BT_8723D_2ANT_GNT_BLOCK_RFC_BB = 0x0, -+ BT_8723D_2ANT_GNT_BLOCK_RFC = 0x1, -+ BT_8723D_2ANT_GNT_BLOCK_BB = 0x2, -+ BT_8723D_2ANT_GNT_BLOCK_MAX -+}; -+ -+enum bt_8723d_2ant_lte_coex_table_type { -+ BT_8723D_2ANT_CTT_WL_VS_LTE = 0x0, -+ BT_8723D_2ANT_CTT_BT_VS_LTE = 0x1, -+ BT_8723D_2ANT_CTT_MAX -+}; -+ -+enum bt_8723d_2ant_lte_break_table_type { -+ BT_8723D_2ANT_LBTT_WL_BREAK_LTE = 0x0, -+ BT_8723D_2ANT_LBTT_BT_BREAK_LTE = 0x1, -+ BT_8723D_2ANT_LBTT_LTE_BREAK_WL = 0x2, -+ BT_8723D_2ANT_LBTT_LTE_BREAK_BT = 0x3, -+ BT_8723D_2ANT_LBTT_MAX -+}; -+ -+enum bt_info_src_8723d_2ant { -+ BT_INFO_SRC_8723D_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8723D_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8723D_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8723D_2ANT_MAX -+}; -+ -+enum bt_8723d_2ant_bt_status { -+ BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8723D_2ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8723D_2ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8723D_2ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8723D_2ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8723d_2ant_coex_algo { -+ BT_8723D_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8723D_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8723D_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8723D_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8723D_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8723D_2ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8723D_2ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8723D_2ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8723D_2ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY = 0xb, -+ BT_8723D_2ANT_COEX_ALGO_MAX -+}; -+ -+enum bt_8723d_2ant_phase { -+ BT_8723D_2ANT_PHASE_COEX_INIT = 0x0, -+ BT_8723D_2ANT_PHASE_WLANONLY_INIT = 0x1, -+ BT_8723D_2ANT_PHASE_WLAN_OFF = 0x2, -+ BT_8723D_2ANT_PHASE_2G_RUNTIME = 0x3, -+ BT_8723D_2ANT_PHASE_5G_RUNTIME = 0x4, -+ BT_8723D_2ANT_PHASE_BTMPMODE = 0x5, -+ BT_8723D_2ANT_PHASE_ANTENNA_DET = 0x6, -+ BT_8723D_2ANT_PHASE_COEX_POWERON = 0x7, -+ BT_8723D_2ANT_PHASE_MAX -+}; -+ -+enum bt_8723d_2ant_Scoreboard { -+ BT_8723D_2ANT_SCOREBOARD_ACTIVE = BIT(0), -+ BT_8723D_2ANT_SCOREBOARD_ONOFF = BIT(1), -+ BT_8723D_2ANT_SCOREBOARD_SCAN = BIT(2), -+ BT_8723D_2ANT_SCOREBOARD_UNDERTEST = BIT(3), -+ BT_8723D_2ANT_SCOREBOARD_WLBUSY = BIT(6) -+}; -+ -+ -+ -+struct coex_dm_8723d_2ant { -+ /* fw mechanism */ -+ u8 pre_bt_dec_pwr_lvl; -+ u8 cur_bt_dec_pwr_lvl; -+ u8 pre_fw_dac_swing_lvl; -+ u8 cur_fw_dac_swing_lvl; -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean reset_tdma_adjust; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ -+ /* sw mechanism */ -+ boolean pre_rf_rx_lpf_shrink; -+ boolean cur_rf_rx_lpf_shrink; -+ u32 bt_rf_0x1e_backup; -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ boolean pre_dac_swing_on; -+ u32 pre_dac_swing_lvl; -+ boolean cur_dac_swing_on; -+ u32 cur_dac_swing_lvl; -+ boolean pre_adc_back_off; -+ boolean cur_adc_back_off; -+ boolean pre_agc_table_en; -+ boolean cur_agc_table_en; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ boolean need_recover0x948; -+ u32 backup0x948; -+ -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ boolean is_switch_to_1dot5_ant; -+ u8 switch_thres_offset; -+ u32 arp_cnt; -+ -+ u8 pre_ant_pos_type; -+ u8 cur_ant_pos_type; -+}; -+ -+struct coex_sta_8723d_2ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ boolean is_hiPri_rx_overhead; -+ u8 bt_rssi; -+ boolean bt_tx_rx_mask; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ u8 bt_info_c2h[BT_INFO_SRC_8723D_2ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8723D_2ANT_MAX]; -+ boolean bt_whck_test; -+ boolean c2h_bt_inquiry_page; -+ boolean c2h_bt_remote_name_req; -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ u8 bt_info_ext2; -+ u32 pop_event_cnt; -+ u8 scan_ap_num; -+ -+ u32 crc_ok_cck; -+ u32 crc_ok_11g; -+ u32 crc_ok_11n; -+ u32 crc_ok_11n_vht; -+ -+ u32 crc_err_cck; -+ u32 crc_err_11g; -+ u32 crc_err_11n; -+ u32 crc_err_11n_vht; -+ -+ boolean cck_lock; -+ boolean pre_ccklock; -+ boolean cck_ever_lock; -+ u8 coex_table_type; -+ boolean force_lps_on; -+ -+ u8 dis_ver_info_cnt; -+ -+ u8 a2dp_bit_pool; -+ u8 cut_version; -+ -+ boolean concurrent_rx_mode_on; -+ -+ u16 score_board; -+ u8 isolation_btween_wb; /* 0~ 50 */ -+ u8 wifi_coex_thres; -+ u8 bt_coex_thres; -+ u8 wifi_coex_thres2; -+ u8 bt_coex_thres2; -+ -+ u8 num_of_profile; -+ boolean acl_busy; -+ boolean bt_create_connection; -+ boolean wifi_is_high_pri_task; -+ u32 specific_pkt_period_cnt; -+ u32 bt_coex_supported_feature; -+ u32 bt_coex_supported_version; -+ -+ u8 bt_ble_scan_type; -+ u32 bt_ble_scan_para[3]; -+ -+ boolean run_time_state; -+ boolean freeze_coexrun_by_btinfo; -+ -+ boolean is_A2DP_3M; -+ boolean voice_over_HOGP; -+ u8 bt_info; -+ boolean is_autoslot; -+ u8 forbidden_slot; -+ u8 hid_busy_num; -+ u8 hid_pair_cnt; -+ -+ u32 cnt_RemoteNameReq; -+ u32 cnt_setupLink; -+ u32 cnt_ReInit; -+ u32 cnt_IgnWlanAct; -+ u32 cnt_Page; -+ u32 cnt_RoleSwitch; -+ -+ u16 bt_reg_vendor_ac; -+ u16 bt_reg_vendor_ae; -+ -+ boolean is_setupLink; -+ boolean wl_noisy_level; -+ u32 gnt_error_cnt; -+ -+ u8 bt_afh_map[10]; -+ u8 bt_relink_downcount; -+ boolean is_tdma_btautoslot; -+ boolean is_tdma_btautoslot_hang; -+ -+ boolean is_eSCO_mode; -+}; -+ -+#define BT_8723D_2ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -+#define BT_8723D_2ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -+#define BT_8723D_2ANT_ANTDET_BUF_LEN 16 -+ -+struct psdscan_sta_8723d_2ant { -+ -+ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ -+ u32 ant_det_bt_tx_time; -+ u32 ant_det_pre_psdscan_peak_val; -+ boolean ant_det_is_ant_det_available; -+ u32 ant_det_psd_scan_peak_val; -+ boolean ant_det_is_btreply_available; -+ u32 ant_det_psd_scan_peak_freq; -+ -+ u8 ant_det_result; -+ u8 ant_det_peak_val[BT_8723D_2ANT_ANTDET_BUF_LEN]; -+ u8 ant_det_peak_freq[BT_8723D_2ANT_ANTDET_BUF_LEN]; -+ u32 ant_det_try_count; -+ u32 ant_det_fail_count; -+ u32 ant_det_inteval_count; -+ u32 ant_det_thres_offset; -+ -+ u32 real_cent_freq; -+ s32 real_offset; -+ u32 real_span; -+ -+ u32 psd_band_width; /* unit: Hz */ -+ u32 psd_point; /* 128/256/512/1024 */ -+ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_start_point; -+ u32 psd_stop_point; -+ u32 psd_max_value_point; -+ u32 psd_max_value; -+ u32 psd_max_value2; -+ u32 psd_avg_value; /* filter loop_max_value that below BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT, and average the rest*/ -+ u32 psd_loop_max_value[BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT]; /*max value in each loop */ -+ u32 psd_start_base; -+ u32 psd_avg_num; /* 1/8/16/32 */ -+ u32 psd_gen_count; -+ boolean is_AntDet_running; -+ boolean is_psd_show_max_only; -+}; -+ -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8723d2ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d2ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d2ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d2ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8723d2ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d2ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d2ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8723d2ant_set_antenna_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist); -+void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+void ex_halbtc8723d2ant_display_ant_detection(IN struct btc_coexist *btcoexist); -+ -+ -+#else -+#define ex_halbtc8723d2ant_power_on_setting(btcoexist) -+#define ex_halbtc8723d2ant_pre_load_firmware(btcoexist) -+#define ex_halbtc8723d2ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8723d2ant_init_coex_dm(btcoexist) -+#define ex_halbtc8723d2ant_ips_notify(btcoexist, type) -+#define ex_halbtc8723d2ant_lps_notify(btcoexist, type) -+#define ex_halbtc8723d2ant_scan_notify(btcoexist, type) -+#define ex_halbtc8723d2ant_connect_notify(btcoexist, type) -+#define ex_halbtc8723d2ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8723d2ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8723d2ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8723d2ant_rf_status_notify(btcoexist, type) -+#define ex_halbtc8723d2ant_halt_notify(btcoexist) -+#define ex_halbtc8723d2ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8723d2ant_periodical(btcoexist) -+#define ex_halbtc8723d2ant_display_coex_info(btcoexist) -+#define ex_halbtc8723d2ant_set_antenna_notify(btcoexist, type) -+#define ex_halbtc8723d2ant_display_ant_detection(btcoexist) -+#define ex_halbtc8723d2ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) -+#endif -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.c 2018-02-11 21:44:27.147146086 +0200 -@@ -0,0 +1,3457 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8812A Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8812A_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8812a_1ant glcoex_dm_8812a_1ant; -+static struct coex_dm_8812a_1ant *coex_dm = &glcoex_dm_8812a_1ant; -+static struct coex_sta_8812a_1ant glcoex_sta_8812a_1ant; -+static struct coex_sta_8812a_1ant *coex_sta = &glcoex_sta_8812a_1ant; -+ -+const char *const glbt_info_src_8812a_1ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8812a_1ant = 20140708; -+u32 glcoex_ver_8812a_1ant = 0x52; -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8812a1ant_ -+ * ************************************************************ */ -+u8 halbtc8812a1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_bt_rssi_state; -+ } -+ -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8812a1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_wifi_rssi_state[index]; -+ } -+ -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8812a1ant_update_ra_mask(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 dis_rate_mask) -+{ -+ coex_dm->cur_ra_mask = dis_rate_mask; -+ -+ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, -+ &coex_dm->cur_ra_mask); -+ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -+} -+ -+/* to check 0x430/0x434 is correct?? */ -+void halbtc8812a1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ coex_dm->cur_arfr_type = type; -+ -+ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { -+ switch (coex_dm->cur_arfr_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_4byte(btcoexist, 0x430, -+ coex_dm->backup_arfr_cnt1); -+ btcoexist->btc_write_4byte(btcoexist, 0x434, -+ coex_dm->backup_arfr_cnt2); -+ break; -+ case 1: -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x01010101); -+ } else { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -+} -+ -+/* to check 0x42a ?? */ -+void halbtc8812a1ant_retry_limit(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_retry_limit_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_retry_limit_type != -+ coex_dm->cur_retry_limit_type)) { -+ switch (coex_dm->cur_retry_limit_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ coex_dm->backup_retry_limit); -+ break; -+ case 1: /* retry limit=8 */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -+} -+ -+/* to check 0x456?? */ -+void halbtc8812a1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_ampdu_time_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { -+ switch (coex_dm->cur_ampdu_time_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ coex_dm->backup_ampdu_max_time); -+ break; -+ case 1: /* AMPDU timw = 0x38 * 32us */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -+} -+ -+void halbtc8812a1ant_limited_tx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, -+ IN u8 retry_limit_type, IN u8 ampdu_time_type) -+{ -+ switch (ra_mask_type) { -+ case 0: /* normal mode */ -+ halbtc8812a1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0); -+ break; -+ case 1: /* disable cck 1/2 */ -+ halbtc8812a1ant_update_ra_mask(btcoexist, force_exec, -+ 0x00000003); -+ break; -+ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ -+ halbtc8812a1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8812a1ant_auto_rate_fallback_retry(btcoexist, force_exec, -+ arfr_type); -+ halbtc8812a1ant_retry_limit(btcoexist, force_exec, retry_limit_type); -+ halbtc8812a1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -+} -+ -+void halbtc8812a1ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+void halbtc8812a1ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 data_len = 3; -+ u8 buf[5] = {0}; -+ -+ if (!coex_sta->bt_disabled) { -+ if (!coex_sta->bt_info_query_cnt || -+ (coex_sta->bt_info_c2h_cnt[BT_INFO_SRC_8812A_1ANT_BT_RSP] -+ - coex_sta->bt_info_query_cnt) > 2) { -+ buf[0] = data_len; -+ buf[1] = 0x1; /* polling enable, 1=enable, 0=disable */ -+ buf[2] = 0x2; /* polling time in seconds */ -+ buf[3] = 0x1; /* auto report enable, 1=enable, 0=disable */ -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_INFO, -+ (void *)&buf[0]); -+ } -+ } -+ coex_sta->bt_info_query_cnt++; -+} -+ -+void halbtc8812a1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ static u8 num_of_bt_counter_chk = 0; -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ if ((coex_sta->low_priority_tx > 1150) && -+ (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->pop_event_cnt++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); -+ BTC_TRACE(trace_buf); -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+ -+ if ((reg_hp_tx == 0) && (reg_hp_rx == 0) && (reg_lp_tx == 0) && -+ (reg_lp_rx == 0)) { -+ num_of_bt_counter_chk++; -+ if (num_of_bt_counter_chk >= 3) { -+ halbtc8812a1ant_query_bt_info(btcoexist); -+ num_of_bt_counter_chk = 0; -+ } -+ } -+} -+ -+/* to check registers */ -+void halbtc8812a1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -+{ -+ s32 wifi_rssi = 0; -+ boolean wifi_busy = false, wifi_under_b_mode = false; -+ static u8 cck_lock_counter = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ if (coex_sta->under_ips) { -+ coex_sta->crc_ok_cck = 0; -+ coex_sta->crc_ok_11g = 0; -+ coex_sta->crc_ok_11n = 0; -+ coex_sta->crc_ok_11n_agg = 0; -+ -+ coex_sta->crc_err_cck = 0; -+ coex_sta->crc_err_11g = 0; -+ coex_sta->crc_err_11n = 0; -+ coex_sta->crc_err_11n_agg = 0; -+ } else { -+ coex_sta->crc_ok_cck = btcoexist->btc_read_2byte(btcoexist, -+ 0xf04); -+ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf14); -+ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf10); -+ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xf40); -+ -+ coex_sta->crc_err_cck = btcoexist->btc_read_2byte(btcoexist, -+ 0xf06); -+ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf16); -+ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf12); -+ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xf42); -+ } -+ -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x0); -+ -+ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { -+ if ((coex_dm->bt_status == BT_8812A_1ANT_BT_STATUS_ACL_BUSY) || -+ (coex_dm->bt_status == -+ BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (coex_dm->bt_status == -+ BT_8812A_1ANT_BT_STATUS_SCO_BUSY)) { -+ if (coex_sta->crc_ok_cck > (coex_sta->crc_ok_11g + -+ coex_sta->crc_ok_11n + -+ coex_sta->crc_ok_11n_agg)) { -+ if (cck_lock_counter < 5) -+ cck_lock_counter++; -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ if (!coex_sta->pre_ccklock) { -+ -+ if (cck_lock_counter >= 5) -+ coex_sta->cck_lock = true; -+ else -+ coex_sta->cck_lock = false; -+ } else { -+ if (cck_lock_counter == 0) -+ coex_sta->cck_lock = false; -+ else -+ coex_sta->cck_lock = true; -+ } -+ -+ coex_sta->pre_ccklock = coex_sta->cck_lock; -+ -+ -+} -+ -+boolean halbtc8812a1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ } -+ -+ return false; -+} -+ -+void halbtc8812a1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+} -+ -+u8 halbtc8812a1ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8812A_1ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_HID_A2DP; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+void halbtc8812a1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8812a1ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8812a1ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+/* to check */ -+void halbtc8812a1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 tmp_u1; -+ -+ tmp_u1 = btcoexist->btc_read_1byte(btcoexist, 0x4fd); -+ tmp_u1 |= BIT(0); -+ if (low_penalty_ra) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Tx rate adaptive, set low penalty!!\n"); -+ BTC_TRACE(trace_buf); -+ tmp_u1 &= ~BIT(2); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Tx rate adaptive, set normal!!\n"); -+ BTC_TRACE(trace_buf); -+ tmp_u1 |= BIT(2); -+ } -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x4fd, tmp_u1); -+} -+ -+void halbtc8812a1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8812a1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8812a1ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8812a1ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8812a1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8812a1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** CoexTable(%d) **********\n", type); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->coex_table_type = type; -+ -+ switch (type) { -+ case 0: -+ halbtc8812a1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8812a1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8812a1ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8812a1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8812a1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8812a1ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0xaa5a5a5a, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8812a1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8812a1ant_coex_table(btcoexist, force_exec, -+ 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8812a1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 data_len = 3; -+ u8 buf[5] = {0}; -+ -+ buf[0] = data_len; -+ buf[1] = 0x1; /* OP_Code */ -+ buf[2] = 0x1; /* OP_Code_Length */ -+ if (enable) -+ buf[3] = 0x1; /* OP_Code_Content */ -+ else -+ buf[3] = 0x0; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, -+ (void *)&buf[0]); -+} -+ -+void halbtc8812a1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8812a1ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8812a1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8812a1ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8812a1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8812a1ant_sw_mechanism(IN struct btc_coexist *btcoexist, -+ IN boolean low_penalty_ra) -+{ -+ halbtc8812a1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -+} -+ -+/* to check force_exec */ -+void halbtc8812a1ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean force_exec, IN boolean init_hwcfg, -+ IN boolean wifi_off) -+{ -+ u8 u8tmp = 0; -+ -+ coex_dm->cur_ant_pos_type = ant_pos_type; -+ -+ if (init_hwcfg) { -+ btcoexist->btc_write_1byte(btcoexist, 0xcb3, 0x77); -+ btcoexist->btc_write_4byte(btcoexist, 0x900, 0x00000400); -+ btcoexist->btc_write_1byte(btcoexist, 0x76d, 0x1); -+ } else if (wifi_off) { -+ btcoexist->btc_write_1byte(btcoexist, 0xcb3, 0x77); -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0xcb7); -+ u8tmp &= ~BIT(3); -+ u8tmp |= BIT(2); -+ btcoexist->btc_write_1byte(btcoexist, 0xcb7, u8tmp); -+ } -+ -+ if (force_exec || -+ (coex_dm->cur_ant_pos_type != coex_dm->pre_ant_pos_type)) { -+ /* ext switch setting */ -+ switch (ant_pos_type) { -+ case BTC_ANT_PATH_WIFI: -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, -+ 0xcb7); -+ u8tmp |= BIT(3); -+ u8tmp &= ~BIT(2); -+ btcoexist->btc_write_1byte(btcoexist, 0xcb7, -+ u8tmp); -+ break; -+ case BTC_ANT_PATH_BT: -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, -+ 0xcb7); -+ u8tmp &= ~BIT(3); -+ u8tmp |= BIT(2); -+ btcoexist->btc_write_1byte(btcoexist, 0xcb7, -+ u8tmp); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, -+ 0xcb7); -+ u8tmp |= BIT(3); -+ u8tmp &= ~BIT(2); -+ btcoexist->btc_write_1byte(btcoexist, 0xcb7, -+ u8tmp); -+ break; -+ } -+ } -+ -+ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; -+} -+ -+void halbtc8812a1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ if (ap_enable) { -+ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], FW for 1Ant AP mode\n"); -+ BTC_TRACE(trace_buf); -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ } -+ } -+ -+ h2c_parameter[0] = real_byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = real_byte5; -+ -+ coex_dm->ps_tdma_para[0] = real_byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = real_byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+ -+void halbtc8812a1ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_busy = false; -+ u8 rssi_adjust_val = 0; -+ u8 ps_tdma_byte4_val = 0x50, ps_tdma_byte0_val = 0x51, -+ ps_tdma_byte3_val = 0x10; -+ s8 wifi_duration_adjust = 0x0; -+ static boolean pre_wifi_busy = false; -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (wifi_busy != pre_wifi_busy) { -+ force_exec = true; -+ pre_wifi_busy = wifi_busy; -+ } -+ -+ if (coex_dm->cur_ps_tdma_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(on, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(off, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ -+ if (coex_sta->scan_ap_num <= 5) -+ wifi_duration_adjust = 2; -+ else if (coex_sta->scan_ap_num >= 40) -+ wifi_duration_adjust = -15; -+ else if (coex_sta->scan_ap_num >= 20) -+ wifi_duration_adjust = -10; -+ -+ if (!coex_sta->force_lps_on) { /* only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 */ -+ ps_tdma_byte0_val = 0x61; /* no null-pkt */ -+ ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */ -+ ps_tdma_byte4_val = 0x10; /* 0x778 = d/1 toggle */ -+ } -+ -+ if ((type == 3) || (type == 13) || (type == 14)) { -+ ps_tdma_byte4_val = ps_tdma_byte4_val & -+ 0xbf; /* no dynamic slot for multi-profile */ -+ -+ if (!wifi_busy) -+ ps_tdma_byte4_val = ps_tdma_byte4_val | -+ 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+ } -+ -+ if (bt_link_info->slave_role == true) -+ ps_tdma_byte4_val = ps_tdma_byte4_val | -+ 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+ -+ if (turn_on) { -+ switch (type) { -+ default: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x1a, 0x1a, 0x0, ps_tdma_byte4_val); -+ break; -+ case 1: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x3a + -+ wifi_duration_adjust, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 2: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x2d + -+ wifi_duration_adjust, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 3: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x1d, 0x1d, 0x0, ps_tdma_byte4_val); -+ break; -+ case 4: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x15, 0x3, 0x14, 0x0); -+ break; -+ case 5: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x15, 0x3, 0x11, 0x11); -+ break; -+ case 6: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x20, 0x3, 0x11, 0x11); -+ break; -+ case 7: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x13, -+ 0xc, 0x5, 0x0, 0x0); -+ break; -+ case 8: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 9: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x21, 0x3, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 10: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x13, -+ 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 11: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, -+ ps_tdma_byte0_val, 0x21, 0x03, -+ ps_tdma_byte3_val, ps_tdma_byte4_val); -+ break; -+ case 12: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x0a, 0x0a, 0x0, 0x50); -+ break; -+ case 13: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x12, 0x12, 0x0, ps_tdma_byte4_val); -+ break; -+ case 14: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x21, 0x3, 0x10, ps_tdma_byte4_val); -+ break; -+ case 15: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x13, -+ 0xa, 0x3, 0x8, 0x0); -+ break; -+ case 16: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x15, 0x3, 0x10, 0x0); -+ break; -+ case 18: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 20: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x3f, 0x03, 0x11, 0x10); -+ break; -+ case 21: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x25, 0x03, 0x11, 0x11); -+ break; -+ case 22: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x25, 0x03, 0x11, 0x10); -+ break; -+ case 23: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x3, 0x31, 0x18); -+ break; -+ case 24: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x15, 0x3, 0x31, 0x18); -+ break; -+ case 25: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 26: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0xa, 0x3, 0x31, 0x18); -+ break; -+ case 27: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x3, 0x31, 0x98); -+ break; -+ case 28: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x69, -+ 0x25, 0x3, 0x31, 0x0); -+ break; -+ case 29: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xab, -+ 0x1a, 0x1a, 0x1, 0x10); -+ break; -+ case 30: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x30, 0x3, 0x10, 0x10); -+ break; -+ case 31: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x1a, 0x1a, 0, 0x58); -+ break; -+ case 32: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x35, 0x3, 0x11, 0x11); -+ break; -+ case 33: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xa3, -+ 0x25, 0x3, 0x30, 0x90); -+ break; -+ case 34: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x53, -+ 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 35: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x63, -+ 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 36: -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x12, 0x3, 0x14, 0x50); -+ break; -+ case 40: /* SoftAP only with no sta associated,BT disable ,TDMA mode for power saving */ -+ /* here softap mode screen off will cost 70-80mA for phone */ -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x23, -+ 0x18, 0x00, 0x10, 0x24); -+ break; -+ } -+ } else { -+ -+ /* disable PS tdma */ -+ switch (type) { -+ case 8: /* PTA Control */ -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x8, -+ 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 0: -+ default: /* Software control, Antenna at BT side */ -+ halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x0, 0x0); -+ break; -+ } -+ } -+ rssi_adjust_val = 0; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val); -+ -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+boolean halbtc8812a1ant_is_common_action(IN struct btc_coexist *btcoexist) -+{ -+ boolean common = false, wifi_connected = false, wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!wifi_connected && -+ BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else { -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ common = false; -+ } -+ -+ return common; -+} -+ -+ -+void halbtc8812a1ant_tdma_duration_adjust_for_acl(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ static s32 up, dn, m, n, wait_count; -+ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ -+ u8 retry_count = 0, bt_info_ext; -+ boolean wifi_busy = false; -+ -+ if (BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifi_status) -+ wifi_busy = true; -+ else -+ wifi_busy = false; -+ -+ if ((BT_8812A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == -+ wifi_status) || -+ (BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifi_status) || -+ (BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT == -+ wifi_status)) { -+ if (coex_dm->cur_ps_tdma != 1 && -+ coex_dm->cur_ps_tdma != 2 && -+ coex_dm->cur_ps_tdma != 3 && -+ coex_dm->cur_ps_tdma != 9) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } -+ return; -+ } -+ -+ if (!coex_dm->auto_tdma_adjust) { -+ coex_dm->auto_tdma_adjust = true; -+ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ /* ============ */ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } else { -+ /* accquire the BT TRx retry count from BT_Info byte2 */ -+ retry_count = coex_sta->bt_retry_cnt; -+ bt_info_ext = coex_sta->bt_info_ext; -+ -+ if ((coex_sta->low_priority_tx) > 1150 || -+ (coex_sta->low_priority_rx) > 1250) -+ retry_count++; -+ -+ result = 0; -+ wait_count++; -+ -+ if (retry_count == -+ 0) { /* no retry in the last 2-second duration */ -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ -+ wait_count = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ } -+ } else if (retry_count <= -+ 3) { /* <=3 retry in the last 2-second duration */ -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ -+ if (wait_count <= 2) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ -+ if (wait_count == 1) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ -+ if (result == -1) { -+ if ((BT_INFO_8812A_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && -+ ((coex_dm->cur_ps_tdma == 1) || -+ (coex_dm->cur_ps_tdma == 2))) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } -+ } else if (result == 1) { -+ if ((BT_INFO_8812A_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && -+ ((coex_dm->cur_ps_tdma == 1) || -+ (coex_dm->cur_ps_tdma == 2))) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = 1; -+ } -+ } else { /* no change */ -+ /* Bryant Modify -+ if(wifi_busy != pre_wifi_busy) -+ { -+ pre_wifi_busy = wifi_busy; -+ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, true, coex_dm->cur_ps_tdma); -+ } -+ */ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(on, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (coex_dm->cur_ps_tdma != 1 && -+ coex_dm->cur_ps_tdma != 2 && -+ coex_dm->cur_ps_tdma != 9 && -+ coex_dm->cur_ps_tdma != 11) { -+ /* recover to previous adjust type */ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ coex_dm->ps_tdma_du_adj_type); -+ } -+ } -+} -+ -+void halbtc8812a1ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8812a1ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8812a1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8812a1ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ coex_sta->force_lps_on = true; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8812a1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, false); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8812a1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, -+ false, false); -+} -+ -+void halbtc8812a1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ -+ /* This function check if bt is disabled */ -+ -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ bt_disable_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt all counters=0, %d times!!\n", -+ bt_disable_cnt); -+ BTC_TRACE(trace_buf); -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a1ant_action_wifi_only(btcoexist); -+ } -+ } -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ if (!bt_disabled) { -+ } else { -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ } -+ } -+} -+ -+/* ********************************************* -+ * -+ * Software Coex Mechanism start -+ * -+ * ********************************************* */ -+ -+/* SCO only or SCO+PAN(HS) */ -+ -+/* -+void halbtc8812a1ant_action_sco(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8812a1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8812a1ant_action_hid(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8812a1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8812a1ant_action_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8812a1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8812a1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8812a1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8812a1ant_action_pan_edr(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8812a1ant_sw_mechanism(btcoexist, false); -+} -+ -+ -+void halbtc8812a1ant_action_pan_hs(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8812a1ant_sw_mechanism(btcoexist, false); -+} -+ -+ -+void halbtc8812a1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8812a1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8812a1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8812a1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8812a1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8812a1ant_sw_mechanism(btcoexist, true); -+} -+ -+void halbtc8812a1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8812a1ant_sw_mechanism(btcoexist, true); -+} -+ -+*/ -+ -+/* ********************************************* -+ * -+ * Non-Software Coex Mechanism start -+ * -+ * ********************************************* */ -+void halbtc8812a1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, -+ false, false); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8812a1ant_action_hs(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8812a1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, -+ bt_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) { -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ /* SCO/HID/A2DP busy */ -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if ((bt_link_info->pan_exist) || (wifi_busy)) { -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ } -+} -+ -+void halbtc8812a1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ /* tdma and coex table */ -+ -+ if (bt_link_info->sco_exist) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } else { /* HID */ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } -+} -+ -+void halbtc8812a1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ u8 bt_rssi_state; -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ bt_rssi_state = halbtc8812a1ant_bt_rssi_state(2, 28, 0); -+ -+ if ((coex_sta->low_priority_rx >= 950) && (!coex_sta->under_ips)) -+ bt_link_info->slave_role = true; -+ else -+ bt_link_info->slave_role = false; -+ -+ if (bt_link_info->hid_only) { /* HID */ -+ halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, -+ wifi_status); -+ coex_dm->auto_tdma_adjust = false; -+ return; -+ } else if (bt_link_info->a2dp_only) { /* A2DP */ -+ if (BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ halbtc8812a1ant_tdma_duration_adjust_for_acl(btcoexist, -+ wifi_status); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = true; -+ } -+ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || -+ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { /* HID+A2DP */ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); -+ coex_dm->auto_tdma_adjust = false; -+ -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && -+ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ /* BT no-profile busy (0x9) */ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } -+} -+ -+void halbtc8812a1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -+{ -+ /* power save state */ -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, -+ false, false); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8812a1ant_action_wifi_not_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 20); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if ((BT_8812A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ /* Bryant Add */ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8812a1ant_action_wifi_not_connected_asso_auth( -+ IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); -+ } else if (bt_link_info->pan_exist) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); -+ } else { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); -+ } -+} -+ -+void halbtc8812a1ant_action_wifi_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 20); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if ((BT_8812A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ /* Bryant Add */ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8812a1ant_action_wifi_connected_specific_packet( -+ IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if (bt_link_info->pan_exist) { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ NORMAL_EXEC, false, false); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8812a1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_busy = false; -+ boolean scan = false, link = false, roam = false; -+ boolean under_4way = false, ap_enable = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ if (under_4way) { -+ halbtc8812a1ant_action_wifi_connected_specific_packet(btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8812a1ant_action_wifi_connected_scan(btcoexist); -+ else -+ halbtc8812a1ant_action_wifi_connected_specific_packet( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ /* power save state */ -+ if (!ap_enable && -+ BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status && -+ !btcoexist->bt_link_info.hid_only) { -+ if (btcoexist->bt_link_info.a2dp_only) { /* A2DP */ -+ if (!wifi_busy) -+ halbtc8812a1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else { /* busy */ -+ if (coex_sta->scan_ap_num >= -+ BT_8812A_1ANT_WIFI_NOISY_THRESH) /* no force LPS, no PS-TDMA, use pure TDMA */ -+ halbtc8812a1ant_power_save_state( -+ btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ else -+ halbtc8812a1ant_power_save_state( -+ btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ } else if ((coex_sta->pan_exist == false) && -+ (coex_sta->a2dp_exist == false) && -+ (coex_sta->hid_exist == false)) -+ halbtc8812a1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8812a1ant_power_save_state(btcoexist, -+ BTC_PS_LPS_ON, 0x50, 0x4); -+ } else -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ -+ /* tdma and coex table */ -+ if (!wifi_busy) { -+ if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8812a1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else if ((BT_8812A_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ halbtc8812a1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); -+ if ((coex_sta->high_priority_tx) + -+ (coex_sta->high_priority_rx) <= 60) -+ halbtc8812a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 2); -+ else -+ halbtc8812a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 7); -+ } -+ } else { -+ if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8812a1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else if ((BT_8812A_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else { -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ halbtc8812a1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); -+ if ((coex_sta->high_priority_tx) + -+ (coex_sta->high_priority_rx) <= 60) -+ halbtc8812a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 2); -+ else -+ halbtc8812a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 7); -+ } -+ } -+} -+ -+void halbtc8812a1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ u8 algorithm = 0; -+ -+ algorithm = halbtc8812a1ant_action_algorithm(btcoexist); -+ coex_dm->cur_algorithm = algorithm; -+ -+ if (halbtc8812a1ant_is_common_action(btcoexist)) { -+ -+ } else { -+ switch (coex_dm->cur_algorithm) { -+ case BT_8812A_1ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8812a1ant_action_sco(btcoexist); */ -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8812a1ant_action_hid(btcoexist); */ -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8812a1ant_action_a2dp(btcoexist); */ -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8812a1ant_action_a2dp_pan_hs(btcoexist); */ -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8812a1ant_action_pan_edr(btcoexist); */ -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8812a1ant_action_pan_hs(btcoexist); */ -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8812a1ant_action_pan_edr_a2dp(btcoexist); */ -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8812a1ant_action_pan_edr_hid(btcoexist); */ -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8812a1ant_action_hid_a2dp_pan_edr(btcoexist); */ -+ break; -+ case BT_8812A_1ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8812a1ant_action_hid_a2dp(btcoexist); */ -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8812a1ant_coex_all_off(btcoexist); */ -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+} -+ -+void halbtc8812a1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ boolean increase_scan_dev_num = false; -+ boolean bt_ctrl_agg_buf_size = false; -+ boolean miracast_plus_bt = false; -+ u8 agg_buf_size = 5; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0, wifi_bw; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if ((BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8812A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ increase_scan_dev_num = true; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, -+ &increase_scan_dev_num); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if ((num_of_wifi_link >= 2) || -+ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", -+ num_of_wifi_link, wifi_link_status); -+ BTC_TRACE(trace_buf); -+ -+ if (bt_link_info->bt_link_exist) { -+ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, -+ 0, 1); -+ miracast_plus_bt = true; -+ } else { -+ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, -+ 0, 0); -+ miracast_plus_bt = false; -+ } -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if ((bt_link_info->a2dp_exist) && -+ (coex_sta->c2h_bt_inquiry_page)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8812a1ant_action_wifi_multi_port(btcoexist); -+ -+ return; -+ } else { -+ miracast_plus_bt = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { -+ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ -+ if (bt_link_info->sco_exist) -+ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, true, -+ false, 0x5); -+ else { -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, -+ false, true, 0x10); -+ else -+ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, -+ false, true, 0x8); -+ } -+ -+ halbtc8812a1ant_sw_mechanism(btcoexist, true); -+ halbtc8812a1ant_run_sw_coexist_mechanism( -+ btcoexist); /* just print debug message */ -+ } else { -+ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x5); -+ -+ halbtc8812a1ant_sw_mechanism(btcoexist, false); -+ halbtc8812a1ant_run_sw_coexist_mechanism( -+ btcoexist); /* //just print debug message */ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8812a1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ -+ if (!wifi_connected) { -+ boolean scan = false, link = false, roam = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is non connected-idle !!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8812a1ant_action_wifi_not_connected_scan( -+ btcoexist); -+ else -+ halbtc8812a1ant_action_wifi_not_connected_asso_auth( -+ btcoexist); -+ } else -+ halbtc8812a1ant_action_wifi_not_connected(btcoexist); -+ } else /* wifi LPS/Busy */ -+ halbtc8812a1ant_action_wifi_connected(btcoexist); -+} -+ -+void halbtc8812a1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ -+ /* sw all off */ -+ halbtc8812a1ant_sw_mechanism(btcoexist, false); -+ -+ /* halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ -+ /* halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ -+ -+ coex_sta->pop_event_cnt = 0; -+} -+ -+void halbtc8812a1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean back_up, IN boolean wifi_only) -+{ -+ u8 u8tmp = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 1Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* ant sw control to BT */ -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, -+ true, false); -+ -+ /* 0x790[5:0]=0x5 */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); -+ u8tmp &= 0xc0; -+ u8tmp |= 0x5; -+ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); -+ -+ /* PTA parameter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, 0xffff); -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, 0x55555555); -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, 0x55555555); -+ -+ /* coex parameters */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); -+ -+ /* enable counter statistics */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); -+ -+ /* enable PTA */ -+ btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); -+ -+ /* bt clock related */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x4); -+ u8tmp |= BIT(7); -+ btcoexist->btc_write_1byte(btcoexist, 0x4, u8tmp); -+ -+ /* bt clock related */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x7); -+ u8tmp |= BIT(1); -+ btcoexist->btc_write_1byte(btcoexist, 0x7, u8tmp); -+} -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8812a1ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8812a1ant_ -+ * ************************************************************ */ -+void ex_halbtc8812a1ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+} -+ -+void ex_halbtc8812a1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -+{ -+} -+ -+void ex_halbtc8812a1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ halbtc8812a1ant_init_hw_config(btcoexist, true, wifi_only); -+ btcoexist->stop_coex_dm = false; -+} -+ -+void ex_halbtc8812a1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = false; -+ -+ halbtc8812a1ant_init_coex_dm(btcoexist); -+ -+ halbtc8812a1ant_query_bt_info(btcoexist); -+} -+ -+void ex_halbtc8812a1ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u32 u32tmp[4]; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ if (btcoexist->stop_coex_dm) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", -+ "Ant PG number/ Ant mechanism:", -+ board_info->pg_ant_num, board_info->btdm_ant_num); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", -+ "CoexVer/ FwVer/ PatchVer", -+ glcoex_ver_date_8812a_1ant, glcoex_ver_8812a_1ant, fw_ver, -+ bt_patch_ver, bt_patch_ver); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") -+ : ((BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi, coex_sta->bt_retry_cnt); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP", -+ bt_link_info->sco_exist, bt_link_info->hid_exist, -+ bt_link_info->pan_exist, bt_link_info->a2dp_exist); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "BT Info A2DP rate", -+ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); -+ CL_PRINTF(cli_buf); -+ -+ for (i = 0; i < BT_INFO_SRC_8812A_1ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8812a_1ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ if (!btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms]============"); -+ CL_PRINTF(cli_buf); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", -+ "Latest error condition(should be 0)", -+ coex_dm->error_condition); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", -+ "IgnWlanAct", -+ coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ } -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x778", -+ u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcb3); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xcb7); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x900); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0xcb3/0xcb7/0x900", -+ u8tmp[0], u8tmp[1], u32tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", -+ u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x550(bcn ctrl)/0x522", -+ u32tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", -+ u32tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(hp rx[31:16]/tx[15:0])", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(lp rx[31:16]/tx[15:0])", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+ -+void ex_halbtc8812a1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, false, true); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8812a1ant_init_hw_config(btcoexist, false, false); -+ halbtc8812a1ant_init_coex_dm(btcoexist); -+ halbtc8812a1ant_query_bt_info(btcoexist); -+ -+ coex_sta->under_ips = false; -+ } -+} -+ -+void ex_halbtc8812a1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ } -+} -+ -+void ex_halbtc8812a1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_SCAN_START == type) { -+ coex_sta->wifi_is_high_pri_task = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, -+ 8); /* Force antenna setup for no scan result issue */ -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ FORCE_EXEC, false, false); -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ } -+ -+ if (coex_sta->bt_disabled) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ halbtc8812a1ant_query_bt_info(btcoexist); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ if (num_of_wifi_link >= 2) { -+ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8812a1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8812a1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8812a1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ if (BTC_SCAN_START == type) { -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8812a1ant_action_wifi_not_connected_scan( -+ btcoexist); -+ else /* wifi is connected */ -+ halbtc8812a1ant_action_wifi_connected_scan(btcoexist); -+ } else if (BTC_SCAN_FINISH == type) { -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8812a1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8812a1ant_action_wifi_connected(btcoexist); -+ } -+} -+ -+void ex_halbtc8812a1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ if (BTC_ASSOCIATE_START == type) { -+ coex_sta->wifi_is_high_pri_task = true; -+ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, -+ 8); /* Force antenna setup for no scan result issue */ -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ FORCE_EXEC, false, false); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->arp_cnt = 0; -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ /* coex_dm->arp_cnt = 0; */ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ if (num_of_wifi_link >= 2) { -+ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8812a1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8812a1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8812a1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ if (BTC_ASSOCIATE_START == type) -+ halbtc8812a1ant_action_wifi_not_connected_asso_auth(btcoexist); -+ else if (BTC_ASSOCIATE_FINISH == type) { -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8812a1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8812a1ant_action_wifi_connected(btcoexist); -+ } -+} -+ -+/* to check registers... */ -+void ex_halbtc8812a1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 data_len = 5; -+ u8 buf[6] = {0}; -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ boolean wifi_under_b_mode = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, -+ 8); /* Force antenna setup for no scan result issue */ -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ FORCE_EXEC, false, false); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+#if 0 -+ /* Set CCK Tx/Rx high Pri except 11b mode */ -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x00); /* CCK Rx */ -+ } else { -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x10); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x10); /* CCK Rx */ -+ } -+#endif -+ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, -+ 0x430); -+ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, -+ 0x434); -+ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( -+ btcoexist, 0x42a); -+ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( -+ btcoexist, 0x456); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->arp_cnt = 0; -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ -+ } -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ /* h2c_parameter[0] = 0x1; */ -+ h2c_parameter[0] = 0x0; -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ buf[0] = data_len; -+ buf[1] = 0x5; /* OP_Code */ -+ buf[2] = 0x3; /* OP_Code_Length */ -+ buf[3] = h2c_parameter[0]; /* OP_Code_Content */ -+ buf[4] = h2c_parameter[1]; -+ buf[5] = h2c_parameter[2]; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, -+ (void *)&buf[0]); -+} -+ -+void ex_halbtc8812a1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ if (BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ BTC_PACKET_ARP == type) { -+ if (BTC_PACKET_ARP == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ARP notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_dm->arp_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ARP Packet Count = %d\n", -+ coex_dm->arp_cnt); -+ BTC_TRACE(trace_buf); -+ -+ if (coex_dm->arp_cnt >= -+ 10) /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecificPacket(btcoexist) */ -+ coex_sta->wifi_is_high_pri_task = false; -+ else -+ coex_sta->wifi_is_high_pri_task = true; -+ } else { -+ coex_sta->wifi_is_high_pri_task = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet DHCP or EAPOL notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet [Type = %d] notify\n", type); -+ BTC_TRACE(trace_buf); -+ } -+ -+ coex_sta->specific_pkt_period_cnt = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ if (num_of_wifi_link >= 2) { -+ halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8812a1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8812a1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8812a1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ if (BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ ((BTC_PACKET_ARP == type) && (coex_sta->wifi_is_high_pri_task))) -+ halbtc8812a1ant_action_wifi_connected_specific_packet(btcoexist); -+} -+ -+void ex_halbtc8812a1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source = 0; -+ boolean wifi_connected = false; -+ boolean bt_busy = false; -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8812A_1ANT_MAX) -+ rsp_source = BT_INFO_SRC_8812A_1ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (BT_INFO_SRC_8812A_1ANT_WIFI_FW != rsp_source) { -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; -+ -+ if (coex_sta->bt_retry_cnt >= 1) -+ coex_sta->pop_event_cnt++; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) -+ coex_sta->c2h_bt_page = true; -+ else -+ coex_sta->c2h_bt_page = false; -+ -+ coex_sta->bt_rssi = -+ coex_sta->bt_info_c2h[rsp_source][3] * 2 - 90; -+ /* coex_sta->bt_info_c2h[rsp_source][3]*2+10; */ -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+ coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] -+ & 0x40); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, -+ &coex_sta->bt_tx_rx_mask); -+ if (!coex_sta->bt_tx_rx_mask) { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, -+ 0x3c, 0x15); -+ } -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ if (coex_sta->bt_info_ext & BIT(1)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (wifi_connected) -+ ex_halbtc8812a1ant_media_status_notify( -+ btcoexist, BTC_MEDIA_CONNECT); -+ else -+ ex_halbtc8812a1ant_media_status_notify( -+ btcoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ if (coex_sta->bt_info_ext & BIT(3)) { -+ if (!btcoexist->manual_control && -+ !btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a1ant_ignore_wlan_act(btcoexist, -+ FORCE_EXEC, false); -+ } -+ } else { -+ /* BT already NOT ignore Wlan active, do nothing here. */ -+ } -+#if (BT_AUTO_REPORT_ONLY_8812A_1ANT == 0) -+ if ((coex_sta->bt_info_ext & BIT(4))) { -+ /* BT auto report already enabled, do nothing */ -+ } else -+ halbtc8812a1ant_bt_auto_report(btcoexist, FORCE_EXEC, -+ true); -+#endif -+ } -+ -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (bt_info & BT_INFO_8812A_1ANT_B_INQ_PAGE) -+ coex_sta->c2h_bt_inquiry_page = true; -+ else -+ coex_sta->c2h_bt_inquiry_page = false; -+ -+ /* set link exist status */ -+ if (!(bt_info & BT_INFO_8812A_1ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (bt_info & BT_INFO_8812A_1ANT_B_FTP) -+ coex_sta->pan_exist = true; -+ else -+ coex_sta->pan_exist = false; -+ if (bt_info & BT_INFO_8812A_1ANT_B_A2DP) -+ coex_sta->a2dp_exist = true; -+ else -+ coex_sta->a2dp_exist = false; -+ if (bt_info & BT_INFO_8812A_1ANT_B_HID) -+ coex_sta->hid_exist = true; -+ else -+ coex_sta->hid_exist = false; -+ if (bt_info & BT_INFO_8812A_1ANT_B_SCO_ESCO) -+ coex_sta->sco_exist = true; -+ else -+ coex_sta->sco_exist = false; -+ } -+ -+ halbtc8812a1ant_update_bt_link_info(btcoexist); -+ -+ bt_info = bt_info & -+ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ -+ -+ if (!(bt_info & BT_INFO_8812A_1ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info == -+ BT_INFO_8812A_1ANT_B_CONNECTION) { /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if ((bt_info & BT_INFO_8812A_1ANT_B_SCO_ESCO) || -+ (bt_info & BT_INFO_8812A_1ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8812A_1ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info & BT_INFO_8812A_1ANT_B_ACL_BUSY) { -+ if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) -+ coex_dm->auto_tdma_adjust = false; -+ coex_dm->bt_status = BT_8812A_1ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_dm->bt_status = BT_8812A_1ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if ((BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8812A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ bt_busy = true; -+ else -+ bt_busy = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ halbtc8812a1ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8812a1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_RF_ON == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->stop_coex_dm = false; -+ } else if (BTC_RF_OFF == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, false, true); -+ -+ halbtc8812a1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ btcoexist->stop_coex_dm = true; -+ } -+} -+ -+void ex_halbtc8812a1ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, -+ false, true); -+ -+ halbtc8812a1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ -+ ex_halbtc8812a1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+ -+ btcoexist->stop_coex_dm = true; -+} -+ -+void ex_halbtc8812a1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_WIFI_PNP_SLEEP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -+ FORCE_EXEC, false, true); -+ halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ -+ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ -+ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ -+ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ -+ coex_sta->under_ips = false; -+ coex_sta->under_lps = false; -+ btcoexist->stop_coex_dm = true; -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->stop_coex_dm = false; -+ halbtc8812a1ant_init_hw_config(btcoexist, false, false); -+ halbtc8812a1ant_init_coex_dm(btcoexist); -+ halbtc8812a1ant_query_bt_info(btcoexist); -+ } -+} -+ -+void ex_halbtc8812a1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], *****************Coex DM Reset*****************\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8812a1ant_init_hw_config(btcoexist, false, false); -+ halbtc8812a1ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8812a1ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+#if (BT_AUTO_REPORT_ONLY_8812A_1ANT == 0) -+ halbtc8812a1ant_query_bt_info(btcoexist); -+ halbtc8812a1ant_monitor_bt_enable_disable(btcoexist); -+#else -+ halbtc8812a1ant_monitor_bt_ctr(btcoexist); -+ halbtc8812a1ant_monitor_wifi_ctr(btcoexist); -+ -+ if (halbtc8812a1ant_is_wifi_status_changed(btcoexist) || -+ coex_dm->auto_tdma_adjust) -+ halbtc8812a1ant_run_coexist_mechanism(btcoexist); -+ -+ coex_sta->specific_pkt_period_cnt++; -+#endif -+} -+ -+void ex_halbtc8812a1ant_dbg_control(IN struct btc_coexist *btcoexist, -+ IN u8 op_code, IN u8 op_len, IN u8 *pdata) -+{ -+ switch (op_code) { -+ case BTC_DBG_SET_COEX_NORMAL: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set CoexMode to Normal\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->manual_control = false; -+ halbtc8812a1ant_init_coex_dm(btcoexist); -+ break; -+ case BTC_DBG_SET_COEX_WIFI_ONLY: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set CoexMode to Wifi Only\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->manual_control = true; -+ halbtc8812a1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 9); -+ break; -+ case BTC_DBG_SET_COEX_BT_ONLY: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set CoexMode to BT only\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->manual_control = true; -+ halbtc8812a1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ break; -+ case BTC_DBG_SET_COEX_DEC_BT_PWR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set Dec BT power\n"); -+ BTC_TRACE(trace_buf); -+ { -+ u8 data_len = 4; -+ u8 buf[6] = {0}; -+ u8 dec_bt_pwr = 0, pwr_level = 0; -+ if (op_len == 2) { -+ dec_bt_pwr = pdata[0]; -+ pwr_level = pdata[1]; -+ -+ buf[0] = data_len; -+ buf[1] = 0x3; /* OP_Code */ -+ buf[2] = 0x2; /* OP_Code_Length */ -+ -+ buf[3] = dec_bt_pwr; /* OP_Code_Content */ -+ buf[4] = pwr_level; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set Dec BT power=%d, pwr_level=%d\n", -+ dec_bt_pwr, pwr_level); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_CTRL_BT_COEX, -+ (void *)&buf[0]); -+ } -+ } -+ break; -+ -+ case BTC_DBG_SET_COEX_BT_AFH_MAP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set BT AFH Map\n"); -+ BTC_TRACE(trace_buf); -+ { -+ u8 data_len = 5; -+ u8 buf[6] = {0}; -+ if (op_len == 3) { -+ buf[0] = data_len; -+ buf[1] = 0x5; /* OP_Code */ -+ buf[2] = 0x3; /* OP_Code_Length */ -+ -+ buf[3] = pdata[0]; /* OP_Code_Content */ -+ buf[4] = pdata[1]; -+ buf[5] = pdata[2]; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set BT AFH Map = %02x %02x %02x\n", -+ pdata[0], pdata[1], pdata[2]); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_CTRL_BT_COEX, -+ (void *)&buf[0]); -+ } -+ } -+ break; -+ -+ case BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set BT Ignore Wlan Active\n"); -+ BTC_TRACE(trace_buf); -+ { -+ u8 data_len = 3; -+ u8 buf[6] = {0}; -+ if (op_len == 1) { -+ buf[0] = data_len; -+ buf[1] = 0x1; /* OP_Code */ -+ buf[2] = 0x1; /* OP_Code_Length */ -+ -+ buf[3] = pdata[0]; /* OP_Code_Content */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set BT Ignore Wlan Active = 0x%x\n", -+ pdata[0]); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_CTRL_BT_COEX, -+ (void *)&buf[0]); -+ } -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -\ Ingen nyrad vid filslut -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a1Ant.h 2018-02-11 21:44:27.147146086 +0200 -@@ -0,0 +1,230 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8812A_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8812A 1ANT BT Co-exist definition -+ * ******************************************* */ -+#define BT_AUTO_REPORT_ONLY_8812A_1ANT 1 -+ -+#define BT_INFO_8812A_1ANT_B_FTP BIT(7) -+#define BT_INFO_8812A_1ANT_B_A2DP BIT(6) -+#define BT_INFO_8812A_1ANT_B_HID BIT(5) -+#define BT_INFO_8812A_1ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8812A_1ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8812A_1ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8812A_1ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8812A_1ANT_B_CONNECTION BIT(0) -+ -+#define BT_INFO_8812A_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT(0))) ? true : false) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT 2 -+ -+#define BT_8812A_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ -+ -+enum bt_info_src_8812a_1ant { -+ BT_INFO_SRC_8812A_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8812A_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8812A_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8812A_1ANT_MAX -+}; -+ -+enum bt_8812a_1ant_bt_status { -+ BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8812A_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8812A_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8812A_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8812A_1ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8812a_1ant_wifi_status { -+ BT_8812A_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8812A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8812A_1ANT_WIFI_STATUS_MAX -+}; -+ -+enum bt_8812a_1ant_coex_algo { -+ BT_8812A_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8812A_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8812A_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8812A_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8812A_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8812A_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8812A_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8812A_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8812A_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8812A_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8812A_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8812A_1ANT_COEX_ALGO_MAX = 0xb, -+}; -+ -+struct coex_dm_8812a_1ant { -+ /* hw setting */ -+ u8 pre_ant_pos_type; -+ u8 cur_ant_pos_type; -+ /* fw mechanism */ -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean auto_tdma_adjust; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ /* sw mechanism */ -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ -+ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ -+ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ -+ u16 backup_retry_limit; -+ u8 backup_ampdu_max_time; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ u32 pre_ra_mask; -+ u32 cur_ra_mask; -+ u8 pre_arfr_type; -+ u8 cur_arfr_type; -+ u8 pre_retry_limit_type; -+ u8 cur_retry_limit_type; -+ u8 pre_ampdu_time_type; -+ u8 cur_ampdu_time_type; -+ u32 arp_cnt; -+ -+ u8 error_condition; -+}; -+ -+struct coex_sta_8812a_1ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 specific_pkt_period_cnt; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ s8 bt_rssi; -+ boolean bt_tx_rx_mask; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8812A_1ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8812A_1ANT_MAX]; -+ u32 bt_info_query_cnt; -+ boolean c2h_bt_inquiry_page; -+ boolean c2h_bt_page; /* Add for win8.1 page out issue */ -+ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ u32 pop_event_cnt; -+ u8 scan_ap_num; -+ -+ u32 crc_ok_cck; -+ u32 crc_ok_11g; -+ u32 crc_ok_11n; -+ u32 crc_ok_11n_agg; -+ -+ u32 crc_err_cck; -+ u32 crc_err_11g; -+ u32 crc_err_11n; -+ u32 crc_err_11n_agg; -+ -+ boolean cck_lock; -+ boolean pre_ccklock; -+ u8 coex_table_type; -+ -+ boolean force_lps_on; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8812a1ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8812a1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -+void ex_halbtc8812a1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8812a1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8812a1ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a1ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8812a1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a1ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8812a1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8812a1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -+void ex_halbtc8812a1ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8812a1ant_dbg_control(IN struct btc_coexist *btcoexist, -+ IN u8 op_code, IN u8 op_len, IN u8 *pdata); -+void ex_halbtc8812a1ant_display_coex_info(IN struct btc_coexist *btcoexist); -+ -+#else -+#define ex_halbtc8812a1ant_power_on_setting(btcoexist) -+#define ex_halbtc8812a1ant_pre_load_firmware(btcoexist) -+#define ex_halbtc8812a1ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8812a1ant_init_coex_dm(btcoexist) -+#define ex_halbtc8812a1ant_ips_notify(btcoexist, type) -+#define ex_halbtc8812a1ant_lps_notify(btcoexist, type) -+#define ex_halbtc8812a1ant_scan_notify(btcoexist, type) -+#define ex_halbtc8812a1ant_connect_notify(btcoexist, type) -+#define ex_halbtc8812a1ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8812a1ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8812a1ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8812a1ant_rf_status_notify(btcoexist, type) -+#define ex_halbtc8812a1ant_halt_notify(btcoexist) -+#define ex_halbtc8812a1ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8812a1ant_coex_dm_reset(btcoexist) -+#define ex_halbtc8812a1ant_periodical(btcoexist) -+#define ex_halbtc8812a1ant_dbg_control(btcoexist, op_code, op_len, pdata) -+#define ex_halbtc8812a1ant_display_coex_info(btcoexist) -+ -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.c 2018-02-11 21:44:27.147146086 +0200 -@@ -0,0 +1,4782 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8812A Co-exist mechanism -+ * -+ * History -+ * 2012/08/22 Cosa first check in. -+ * 2012/11/14 Cosa Revise for 8812A 2Ant out sourcing. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8812A_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8812a_2ant glcoex_dm_8812a_2ant; -+static struct coex_dm_8812a_2ant *coex_dm = &glcoex_dm_8812a_2ant; -+static struct coex_sta_8812a_2ant glcoex_sta_8812a_2ant; -+static struct coex_sta_8812a_2ant *coex_sta = &glcoex_sta_8812a_2ant; -+ -+const char *const glbt_info_src_8812a_2ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8812a_2ant = 20150724; -+u32 glcoex_ver_8812a_2ant = 0x37; -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8812a2ant_ -+ * ************************************************************ */ -+u8 halbtc8812a2ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_bt_rssi_state; -+ } -+ -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8812a2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_wifi_rssi_state[index]; -+ } -+ -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8812a2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_stack_info *stack_info = &btcoexist->stack_info; -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ -+ /* This function check if bt is disabled */ -+ -+ /* only 8812a need to consider if core stack is installed. */ -+ if (!stack_info->hci_version) -+ bt_active = false; -+ -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ bt_disable_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt is detected as disabled %d times!!\n", -+ bt_disable_cnt); -+ BTC_TRACE(trace_buf); -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ if (!bt_disabled) { -+ } else { -+ } -+ } -+} -+ -+u32 halbtc8812a2ant_decide_ra_mask(IN struct btc_coexist *btcoexist, -+ IN u32 ra_mask_type) -+{ -+ u32 dis_ra_mask = 0x0; -+ -+ switch (ra_mask_type) { -+ case 0: /* normal mode */ -+ dis_ra_mask = 0x0; -+ break; -+ case 1: /* disable cck 1/2 */ -+ dis_ra_mask = 0x00000003; -+ break; -+ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ -+ dis_ra_mask = 0x0001f1f7; -+ break; -+ default: -+ break; -+ } -+ -+ return dis_ra_mask; -+} -+ -+void halbtc8812a2ant_update_ra_mask(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 dis_rate_mask) -+{ -+ coex_dm->cur_ra_mask = dis_rate_mask; -+ -+ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, -+ &coex_dm->cur_ra_mask); -+ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -+} -+ -+void halbtc8812a2ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ coex_dm->cur_arfr_type = type; -+ -+ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { -+ switch (coex_dm->cur_arfr_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_4byte(btcoexist, 0x430, -+ coex_dm->backup_arfr_cnt1); -+ btcoexist->btc_write_4byte(btcoexist, 0x434, -+ coex_dm->backup_arfr_cnt2); -+ break; -+ case 1: -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x01010101); -+ } else { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -+} -+ -+void halbtc8812a2ant_retry_limit(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_retry_limit_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_retry_limit_type != -+ coex_dm->cur_retry_limit_type)) { -+ switch (coex_dm->cur_retry_limit_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ coex_dm->backup_retry_limit); -+ break; -+ case 1: /* retry limit=8 */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -+} -+ -+void halbtc8812a2ant_ampdu_max_time(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_ampdu_time_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { -+ switch (coex_dm->cur_ampdu_time_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ coex_dm->backup_ampdu_max_time); -+ break; -+ case 1: /* AMPDU timw = 0x38 * 32us */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -+} -+ -+void halbtc8812a2ant_limited_tx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, -+ IN u8 retry_limit_type, IN u8 ampdu_time_type) -+{ -+ u32 dis_ra_mask = 0x0; -+ -+ coex_dm->cur_ra_mask_type = ra_mask_type; -+ dis_ra_mask = halbtc8812a2ant_decide_ra_mask(btcoexist, ra_mask_type); -+ halbtc8812a2ant_update_ra_mask(btcoexist, force_exec, dis_ra_mask); -+ -+ halbtc8812a2ant_auto_rate_fallback_retry(btcoexist, force_exec, -+ arfr_type); -+ halbtc8812a2ant_retry_limit(btcoexist, force_exec, retry_limit_type); -+ halbtc8812a2ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -+} -+ -+void halbtc8812a2ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+void halbtc8812a2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); -+ BTC_TRACE(trace_buf); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); -+ BTC_TRACE(trace_buf); -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+} -+ -+void halbtc8812a2ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 data_len = 3; -+ u8 buf[5] = {0}; -+ -+ if (!coex_sta->bt_disabled) { -+ if (!coex_sta->bt_info_query_cnt || -+ (coex_sta->bt_info_c2h_cnt[BT_INFO_SRC_8812A_2ANT_BT_RSP] -+ - coex_sta->bt_info_query_cnt) > 2) { -+ buf[0] = data_len; -+ buf[1] = 0x1; /* polling enable, 1=enable, 0=disable */ -+ buf[2] = 0x2; /* polling time in seconds */ -+ buf[3] = 0x1; /* auto report enable, 1=enable, 0=disable */ -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_INFO, -+ (void *)&buf[0]); -+ } -+ } -+ coex_sta->bt_info_query_cnt++; -+} -+ -+boolean halbtc8812a2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ } -+ -+ return false; -+} -+ -+void halbtc8812a2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ bt_link_info->acl_busy = coex_sta->acl_busy; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+} -+ -+u8 halbtc8812a2ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ struct btc_stack_info *stack_info = &btcoexist->stack_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8812A_2ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 0) { -+ if (bt_link_info->acl_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ACL Busy only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR; -+ } -+ } else if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ if (stack_info->num_of_hid >= 2) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID*2 + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_SCO_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_SCO_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8812A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+void halbtc8812a2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, -+ IN u8 dac_swing_lvl) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ /* There are several type of dacswing */ -+ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ -+ h2c_parameter[0] = dac_swing_lvl; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); -+} -+ -+void halbtc8812a2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN u8 dec_bt_pwr_lvl) -+{ -+ u8 data_len = 4; -+ u8 buf[6] = {0}; -+ -+ buf[0] = data_len; -+ buf[1] = 0x3; /* OP_Code */ -+ buf[2] = 0x2; /* OP_Code_Length */ -+ if (dec_bt_pwr_lvl) -+ buf[3] = 0x1; /* OP_Code_Content */ -+ else -+ buf[3] = 0x0; -+ buf[4] = dec_bt_pwr_lvl;/* pwr_level */ -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, -+ (void *)&buf[0]); -+} -+ -+void halbtc8812a2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 dec_bt_pwr_lvl) -+{ -+ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) -+ return; -+ } -+ halbtc8812a2ant_set_fw_dec_bt_pwr(btcoexist, -+ coex_dm->cur_bt_dec_pwr_lvl); -+ -+ coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; -+} -+ -+void halbtc8812a2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 fw_dac_swing_lvl) -+{ -+ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_fw_dac_swing_lvl == -+ coex_dm->cur_fw_dac_swing_lvl) -+ return; -+ } -+ -+ halbtc8812a2ant_set_fw_dac_swing_level(btcoexist, -+ coex_dm->cur_fw_dac_swing_lvl); -+ -+ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; -+} -+ -+void halbtc8812a2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist *btcoexist, -+ IN boolean rx_rf_shrink_on) -+{ -+ if (rx_rf_shrink_on) { -+ /* Shrink RF Rx LPF corner */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Shrink RF Rx LPF corner!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, -+ 0xffffc); -+ } else { -+ /* Resume RF Rx LPF corner */ -+ /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ -+ if (btcoexist->initilized) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Resume RF Rx LPF corner!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, -+ 0xfffff, coex_dm->bt_rf_0x1e_backup); -+ } -+ } -+} -+ -+void halbtc8812a2ant_rf_shrink(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rx_rf_shrink_on) -+{ -+ coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_rf_rx_lpf_shrink == -+ coex_dm->cur_rf_rx_lpf_shrink) -+ return; -+ } -+ halbtc8812a2ant_set_sw_rf_rx_lpf_corner(btcoexist, -+ coex_dm->cur_rf_rx_lpf_shrink); -+ -+ coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; -+} -+ -+void halbtc8812a2ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 tmp_u1; -+ -+ tmp_u1 = btcoexist->btc_read_1byte(btcoexist, 0x4fd); -+ tmp_u1 |= BIT(0); -+ if (low_penalty_ra) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Tx rate adaptive, set low penalty!!\n"); -+ BTC_TRACE(trace_buf); -+ tmp_u1 &= ~BIT(2); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Tx rate adaptive, set normal!!\n"); -+ BTC_TRACE(trace_buf); -+ tmp_u1 |= BIT(2); -+ } -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x4fd, tmp_u1); -+} -+ -+void halbtc8812a2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ return; -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8812a2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8812a2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, -+ IN u32 level) -+{ -+ u8 val = (u8)level; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Write SwDacSwing = 0x%x\n", level); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc5b, 0x3e, val); -+} -+ -+void halbtc8812a2ant_set_sw_full_time_dac_swing(IN struct btc_coexist -+ *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) -+{ -+ if (sw_dac_swing_on) -+ halbtc8812a2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); -+ else -+ halbtc8812a2ant_set_dac_swing_reg(btcoexist, 0x18); -+} -+ -+ -+void halbtc8812a2ant_dac_swing(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) -+{ -+ coex_dm->cur_dac_swing_on = dac_swing_on; -+ coex_dm->cur_dac_swing_lvl = dac_swing_lvl; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && -+ (coex_dm->pre_dac_swing_lvl == -+ coex_dm->cur_dac_swing_lvl)) -+ return; -+ } -+ delay_ms(30); -+ halbtc8812a2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, -+ dac_swing_lvl); -+ -+ coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; -+ coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; -+} -+ -+void halbtc8812a2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, -+ IN boolean adc_back_off) -+{ -+ if (adc_back_off) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB BackOff Level On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x3); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB BackOff Level Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x1); -+ } -+} -+ -+void halbtc8812a2ant_adc_back_off(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean adc_back_off) -+{ -+ coex_dm->cur_adc_back_off = adc_back_off; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) -+ return; -+ } -+ halbtc8812a2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); -+ -+ coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; -+} -+ -+void halbtc8812a2ant_set_agc_table(IN struct btc_coexist *btcoexist, -+ IN boolean agc_table_en) -+{ -+ u8 rssi_adjust_val = 0; -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); -+ if (agc_table_en) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Agc Table On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x28F4B); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x10AB2); -+ rssi_adjust_val = 8; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Agc Table Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x2884B); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x104B2); -+ } -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); -+ -+ /* set rssi_adjust_val for wifi module. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, -+ &rssi_adjust_val); -+} -+ -+void halbtc8812a2ant_agc_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean agc_table_en) -+{ -+ coex_dm->cur_agc_table_en = agc_table_en; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) -+ return; -+ } -+ halbtc8812a2ant_set_agc_table(btcoexist, agc_table_en); -+ -+ coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; -+} -+ -+void halbtc8812a2ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8812a2ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8812a2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8812a2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ switch (type) { -+ case 0: -+ halbtc8812a2ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8812a2ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8812a2ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5ffb5ffb, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8812a2ant_coex_table(btcoexist, force_exec, -+ 0x5fdf5fdf, 0x5fdb5fdb, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8812a2ant_coex_table(btcoexist, force_exec, -+ 0xdfffdfff, 0x5fdb5fdb, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8812a2ant_coex_table(btcoexist, force_exec, -+ 0x5ddd5ddd, 0x5fdb5fdb, 0xffffff, 0x3); -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+void halbtc8812a2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 data_len = 3; -+ u8 buf[5] = {0}; -+ -+ buf[0] = data_len; -+ buf[1] = 0x1; /* OP_Code */ -+ buf[2] = 0x1; /* OP_Code_Length */ -+ if (enable) -+ buf[3] = 0x1; /* OP_Code_Content */ -+ else -+ buf[3] = 0x0; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, -+ (void *)&buf[0]); -+} -+ -+void halbtc8812a2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8812a2ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8812a2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ if (ap_enable) { -+ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], FW for 1Ant AP mode\n"); -+ BTC_TRACE(trace_buf); -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ } -+ } -+ -+ h2c_parameter[0] = real_byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = real_byte5; -+ -+ -+ coex_dm->ps_tdma_para[0] = real_byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = real_byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+void halbtc8812a2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8812a2ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8812a2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8812a2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, -+ IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, -+ IN boolean limited_dig, IN boolean bt_lna_constrain) -+{ -+ /* -+ u32 wifi_bw; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if(BTC_WIFI_BW_HT40 != wifi_bw) -+ { -+ if (shrink_rx_lpf) -+ shrink_rx_lpf = false; -+ } -+ */ -+ -+ halbtc8812a2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); -+ /* halbtc8812a2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); */ -+} -+ -+void halbtc8812a2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, -+ IN boolean agc_table_shift, IN boolean adc_back_off, -+ IN boolean sw_dac_swing, IN u32 dac_swing_lvl) -+{ -+ /* halbtc8812a2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ -+ halbtc8812a2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); -+ halbtc8812a2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, -+ dac_swing_lvl); -+} -+ -+void halbtc8812a2ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -+{ -+ u8 u8tmp = 0; -+ -+ if (init_hwcfg) { -+ btcoexist->btc_write_4byte(btcoexist, 0x900, 0x00000400); -+ btcoexist->btc_write_1byte(btcoexist, 0x76d, 0x1); -+ } else if (wifi_off) { -+ -+ } -+ -+ /* ext switch setting */ -+ switch (ant_pos_type) { -+ case BTC_ANT_WIFI_AT_CPL_MAIN: -+ break; -+ case BTC_ANT_WIFI_AT_CPL_AUX: -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0xcb7); -+ u8tmp &= ~BIT(3); -+ u8tmp |= BIT(2); -+ btcoexist->btc_write_1byte(btcoexist, 0xcb7, u8tmp); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8812a2ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ if (turn_on) { -+ switch (type) { -+ case 1: -+ default: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1a, 0x1a, 0xa1, 0x90); -+ break; -+ case 2: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x12, 0x12, 0xa1, 0x90); -+ break; -+ case 3: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0xb1, 0x90); -+ break; -+ case 4: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x10, 0x3, 0xb1, 0x90); -+ break; -+ case 5: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1a, 0x1a, 0x21, 0x10); -+ break; -+ case 6: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x12, 0x12, 0x21, 0x10); -+ break; -+ case 7: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0x21, 0x10); -+ break; -+ case 8: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x10, 0x3, 0x21, 0x10); -+ break; -+ case 9: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1a, 0x1a, 0xa1, 0x10); -+ break; -+ case 10: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x12, 0x12, 0xa1, 0x10); -+ break; -+ case 11: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0xb1, 0x10); -+ break; -+ case 12: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x10, 0x3, 0xb1, 0x10); -+ break; -+ case 13: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1a, 0x1a, 0x21, 0x10); -+ break; -+ case 14: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x12, 0x12, 0x21, 0x10); -+ break; -+ case 15: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0x21, 0x10); -+ break; -+ case 16: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x10, 0x3, 0x21, 0x10); -+ break; -+ case 17: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x35, 0x3, 0xb1, 0x11); -+ break; -+ case 18: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 19: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x25, 0xe1, 0x90); -+ break; -+ case 20: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x25, 0x60, 0x90); -+ break; -+ case 21: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x15, 0x3, 0x70, 0x90); -+ break; -+ case 22: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x1a, 0x1a, 0x21, 0x10); -+ break; -+ case 23: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x03, 0x31, 0x10); -+ break; -+ -+ case 71: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ -+ /* following cases is for wifi rssi low, started from 81 */ -+ case 81: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x3a, 0x3, 0x90, 0x50); -+ break; -+ case 82: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x2b, 0x3, 0x90, 0x50); -+ break; -+ case 83: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x21, 0x3, 0x90, 0x50); -+ break; -+ case 84: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x15, 0x3, 0x90, 0x50); -+ break; -+ case 85: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x1d, 0x1d, 0x80, 0x50); -+ break; -+ case 86: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x15, 0x15, 0x80, 0x50); -+ break; -+ } -+ } else { -+ /* disable PS tdma */ -+ switch (type) { -+ case 0: /* ANT2PTA, 0x778=0x1 */ -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x8, -+ 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 1: /* ANT2BT, 0x778=3 */ -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x8, 0x0); -+ delay_ms(5); -+ halbtc8812a2ant_set_ant_path(btcoexist, -+ BTC_ANT_WIFI_AT_CPL_AUX, false, false); -+ break; -+ default: -+ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x0, 0x0); -+ break; -+ } -+ } -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+void halbtc8812a2ant_coex_all_off(IN struct btc_coexist *btcoexist) -+{ -+ /* fw all off */ -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ /* hw all off */ -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8812a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ -+ halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); -+ -+ halbtc8812a2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+void halbtc8812a2ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8812a2ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN boolean low_pwr_disable, IN u8 lps_val, -+ IN u8 rpwm_val) -+{ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8812a2ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8812a2ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8812a2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, -+ 0x0, 0x0); -+ -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+boolean halbtc8812a2ant_is_common_action(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean common = false, wifi_connected = false, wifi_busy = false; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under inquiry/page scan !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_bt_inquiry(btcoexist); -+ return true; -+ } -+ -+ if (bt_link_info->sco_exist || bt_link_info->hid_exist) -+ halbtc8812a2ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 0, 0, 0); -+ else -+ halbtc8812a2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ if (!wifi_connected) { -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ false, 0x0, 0x0); -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non-connected idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if ((BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) || -+ (BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ halbtc8812a2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ } else { -+ halbtc8812a2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 0); -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 1); -+ } -+ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, -+ 0x18); -+ -+ common = true; -+ } else { -+ if (BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, false, 0x0, 0x0); -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, -+ false, false, 0x8); -+ -+ halbtc8812a2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 0); -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 6); -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+ common = true; -+ } else if (BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ if (bt_hs_on) -+ return false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, true, 0x0, 0x0); -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, -+ false, false, 0x8); -+ -+ halbtc8812a2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 0); -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 6); -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+ common = true; -+ } else { -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ common = false; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8812a2ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, true, 0x0, 0x0); -+ -+ halbtc8812a2ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8812a2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 0); -+ -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 17); -+ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, -+ NORMAL_EXEC, 6); -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, -+ NORMAL_EXEC, 0); -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, -+ false, false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ common = true; -+ } -+ } -+ } -+ -+ return common; -+} -+ -+void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, -+ IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) -+{ -+ static s32 up, dn, m, n, wait_count; -+ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ -+ u8 retry_count = 0; -+ -+ coex_dm->auto_tdma_adjust_low_rssi = false; -+ -+ if (!coex_dm->auto_tdma_adjust) { -+ coex_dm->auto_tdma_adjust = true; -+ { -+ if (sco_hid) { -+ if (tx_pause) { -+ if (max_interval == 1) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 13); -+ coex_dm->ps_tdma_du_adj_type = -+ 13; -+ } else if (max_interval == 2) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (max_interval == 3) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } -+ } else { -+ if (max_interval == 1) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = -+ 9; -+ } else if (max_interval == 2) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (max_interval == 3) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } -+ } -+ } else { -+ if (tx_pause) { -+ if (max_interval == 1) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 5); -+ coex_dm->ps_tdma_du_adj_type = -+ 5; -+ } else if (max_interval == 2) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (max_interval == 3) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } -+ } else { -+ if (max_interval == 1) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (max_interval == 2) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (max_interval == 3) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } -+ } -+ } -+ } -+ /* ============ */ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } else { -+ /* accquire the BT TRx retry count from BT_Info byte2 */ -+ retry_count = coex_sta->bt_retry_cnt; -+ result = 0; -+ wait_count++; -+ -+ if (retry_count == -+ 0) { /* no retry in the last 2-second duration */ -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if (up >= n) { /* if ³sÄò n ­Ó2¬í retry count¬°0, «h½Õ¼eWiFi duration */ -+ wait_count = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ } -+ } else if (retry_count <= -+ 3) { /* <=3 retry in the last 2-second duration */ -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) { /* if ³sÄò 2 ­Ó2¬í retry count< 3, «h½Õ¯¶WiFi duration */ -+ if (wait_count <= 2) -+ m++; /* ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ } else { /* retry count > 3, ¥u­n1¦¸ retry count > 3, «h½Õ¯¶WiFi duration */ -+ if (wait_count == 1) -+ m++; /* ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ -+ if (max_interval == 1) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 71) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 5); -+ coex_dm->ps_tdma_du_adj_type = 5; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 5); -+ coex_dm->ps_tdma_du_adj_type = 5; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 13); -+ coex_dm->ps_tdma_du_adj_type = 13; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 5); -+ coex_dm->ps_tdma_du_adj_type = -+ 5; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 13); -+ coex_dm->ps_tdma_du_adj_type = -+ 13; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 71); -+ coex_dm->ps_tdma_du_adj_type = 71; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 71) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 71); -+ coex_dm->ps_tdma_du_adj_type = -+ 71; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = -+ 9; -+ } -+ } -+ } -+ } else if (max_interval == 2) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } -+ } -+ } -+ } else if (max_interval == 3) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8812a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8812a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } -+ } -+ } -+ } -+ } -+ -+ /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ -+ /* then we have to adjust it back to the previous record one. */ -+ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { -+ boolean scan = false, link = false, roam = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", -+ coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (!scan && !link && !roam) -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ coex_dm->ps_tdma_du_adj_type); -+ else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+} -+ -+/* ****************** -+ * pstdma for wifi rssi low -+ * ****************** */ -+void halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( -+ IN struct btc_coexist *btcoexist/* , */ /* IN u8 wifi_status */) -+{ -+ static s32 up, dn, m, n, wait_count; -+ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ -+ u8 retry_count = 0, bt_info_ext; -+ -+ coex_dm->auto_tdma_adjust = false; -+ -+ retry_count = coex_sta->bt_retry_cnt; -+ bt_info_ext = coex_sta->bt_info_ext; -+ -+ if (!coex_dm->auto_tdma_adjust_low_rssi) { -+ coex_dm->auto_tdma_adjust_low_rssi = true; -+ -+ if (BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(bt_info_ext)) { -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 83); -+ coex_dm->ps_tdma_du_adj_type = 83; -+ } else { -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 82); -+ coex_dm->ps_tdma_du_adj_type = 82; -+ } -+ /* ============ */ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } else { -+ /* accquire the BT TRx retry count from BT_Info byte2 -+ * retry_count = coex_sta->bt_retry_cnt; -+ * bt_info_ext = coex_sta->bt_info_ext; */ -+ result = 0; -+ wait_count++; -+ -+ if ((coex_sta->low_priority_tx) > 1150 || -+ (coex_sta->low_priority_rx) > 1250) -+ retry_count++; -+ -+ if (retry_count == -+ 0) { /* no retry in the last 2-second duration */ -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ -+ wait_count = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ } -+ } else if (retry_count <= -+ 3) { /* <=3 retry in the last 2-second duration */ -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ -+ if (wait_count <= 2) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ -+ if (wait_count == 1) -+ m++; /* to avoid loop between the two levels */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ -+ if (result == -1) { -+ if ((BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(bt_info_ext)) && -+ ((coex_dm->cur_ps_tdma == 81) || -+ (coex_dm->cur_ps_tdma == 82))) { -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 84); -+ coex_dm->ps_tdma_du_adj_type = 84; -+ } else if (coex_dm->cur_ps_tdma == 81) { -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 82); -+ coex_dm->ps_tdma_du_adj_type = 82; -+ } else if (coex_dm->cur_ps_tdma == 82) { -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 83); -+ coex_dm->ps_tdma_du_adj_type = 83; -+ } else if (coex_dm->cur_ps_tdma == 83) { -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 84); -+ coex_dm->ps_tdma_du_adj_type = 84; -+ } -+ } else if (result == 1) { -+ if ((BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(bt_info_ext)) && -+ ((coex_dm->cur_ps_tdma == 81) || -+ (coex_dm->cur_ps_tdma == 82))) { -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 83); -+ coex_dm->ps_tdma_du_adj_type = 83; -+ } else if (coex_dm->cur_ps_tdma == 84) { -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 83); -+ coex_dm->ps_tdma_du_adj_type = 83; -+ } else if (coex_dm->cur_ps_tdma == 83) { -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 82); -+ coex_dm->ps_tdma_du_adj_type = 82; -+ } else if (coex_dm->cur_ps_tdma == 82) { -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ true, 81); -+ coex_dm->ps_tdma_du_adj_type = 81; -+ } -+ } -+ -+ if (coex_dm->cur_ps_tdma != 81 && -+ coex_dm->cur_ps_tdma != 82 && -+ coex_dm->cur_ps_tdma != 83 && -+ coex_dm->cur_ps_tdma != 84) { -+ /* recover to previous adjust type */ -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ coex_dm->ps_tdma_du_adj_type); -+ } -+ } -+} -+ -+void halbtc8812a2ant_get_bt_rssi_threshold(IN struct btc_coexist *btcoexist, -+ IN u8 *pThres0, IN u8 *pThres1) -+{ -+ u8 ant_type; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &ant_type); -+ -+ switch (ant_type) { -+ case BTC_ANT_TYPE_0: -+ *pThres0 = 100; -+ *pThres1 = 100; -+ break; -+ case BTC_ANT_TYPE_1: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ case BTC_ANT_TYPE_2: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ case BTC_ANT_TYPE_3: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ case BTC_ANT_TYPE_4: -+ *pThres0 = 34; -+ *pThres1 = 42; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+ -+void halbtc8812a2ant_action_sco(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 bt_thresh0 = 0, bt_thresh1 = 0; -+ -+ -+ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, -+ &bt_thresh1); -+ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, -+ bt_thresh1); -+ -+ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, -+ 0); -+ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ -+ -+ /* power save state */ -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, -+ 0x0, 0x0); -+ -+ /* coex table */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ else -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ /* pstdma */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); -+ else -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); -+ -+ /* decrease BT power */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ -+ /* limited Rx */ -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ /* fw dac swing level */ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ true, 0x6); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ true, 0x6); -+ } -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ true, 0x6); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ true, 0x6); -+ } -+ } -+} -+ -+void halbtc8812a2ant_action_sco_hid(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 bt_thresh0 = 0, bt_thresh1 = 0; -+ -+ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, -+ &bt_thresh1); -+ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, -+ bt_thresh1); -+ -+ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, -+ 0); -+ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ -+ -+ /* power save state */ -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, -+ 0x0, 0x0); -+ -+ /* coex table */ -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ /* pstdma */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); -+ else -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); -+ -+ /* decrease BT power */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ -+ /* limited Rx */ -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x8); -+ -+ /* fw dac swing level */ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x6); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x6); -+ } -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x6); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x6); -+ } -+ } -+} -+ -+void halbtc8812a2ant_action_hid(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 bt_thresh0 = 0, bt_thresh1 = 0; -+ -+ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, -+ &bt_thresh1); -+ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, -+ bt_thresh1); -+ -+ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, -+ 0); -+ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ -+ -+ /* power save state */ -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, -+ 0x0, 0x0); -+ -+ /* coex table */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ else -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* pstdma */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); -+ else -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ -+ /* decrease BT power */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ -+ /* limited Rx */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ else -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, -+ 0x8); -+ -+ -+ /* fw dac swing level */ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -+void halbtc8812a2ant_action_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 bt_thresh0 = 0, bt_thresh1 = 0; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, -+ &bt_thresh1); -+ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, -+ bt_thresh1); -+ -+ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, -+ 0); -+ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ -+ -+ /* power save state */ -+ if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state)))) -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ true, 0x0, 0x0); -+ else -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, -+ 0x50, 0x4); -+ -+ /* coex table */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* pstdma */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, false, -+ 1); -+ else -+ halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( -+ btcoexist); -+ -+ /* decrease BT power */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ -+ /* limited Rx */ -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ /* fw dac swing level */ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ -+ /* sw mechanism */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8812a2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 bt_thresh0 = 0, bt_thresh1 = 0; -+ -+ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, -+ &bt_thresh1); -+ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, -+ bt_thresh1); -+ -+ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, -+ 0); -+ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ -+ -+ /* power save state */ -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, -+ 0x0, 0x0); -+ -+ /* coex table */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ -+ /* pstdma */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, false, -+ 2); -+ else -+ halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, true, 2); -+ -+ /* decrease BT power */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ -+ /* limited Rx */ -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ /* fw dac swing level */ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ -+ /* sw mechanism */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ true, 0x6); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ true, 0x6); -+ } -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ true, 0x6); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ true, 0x6); -+ } -+ } -+} -+ -+void halbtc8812a2ant_action_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 bt_thresh0 = 0, bt_thresh1 = 0; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ -+ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, -+ &bt_thresh1); -+ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, -+ bt_thresh1); -+ -+ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, -+ 0); -+ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ -+ -+ /* power save state */ -+ if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state)))) -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ true, 0x0, 0x0); -+ else -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, -+ 0x50, 0x4); -+ -+ /* coex table */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* pstdma */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); -+ else -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 85); -+ -+ /* decrease BT power */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ -+ /* limited Rx */ -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ /* fw dac swing level */ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ -+ /* sw mechanism */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+/* PAN(HS) only */ -+void halbtc8812a2ant_action_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, -+ 0); -+ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); -+ -+ /* power save state */ -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, -+ 0x0, 0x0); -+ -+ /* coex table */ -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ -+ /* pstdma */ -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ -+ /* decrease BT power */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ -+ /* limited Rx */ -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ /* fw dac swing level */ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+/* PAN(EDR)+A2DP */ -+void halbtc8812a2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 bt_thresh0 = 0, bt_thresh1 = 0; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, -+ &bt_thresh1); -+ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, -+ bt_thresh1); -+ -+ -+ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, -+ 0); -+ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ -+ -+ /* power save state */ -+ if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state)))) -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ true, 0x0, 0x0); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ true, 0x0, 0x0); -+ else -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, -+ 0x50, 0x4); -+ -+ /* coex table */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ else -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* pstdma */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, false, -+ 3); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, true, 3); -+ else { -+ coex_dm->auto_tdma_adjust = false; -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); -+ } -+ -+ /* decrease BT power */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ -+ /* limited Rx */ -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ /* fw dac swing level */ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8812a2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 bt_thresh0 = 0, bt_thresh1 = 0; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, -+ &bt_thresh1); -+ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, -+ bt_thresh1); -+ -+ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, -+ 0); -+ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ -+ -+ /* power save state */ -+ if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state)))) -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ true, 0x0, 0x0); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ true, 0x0, 0x0); -+ else -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, -+ 0x50, 0x4); -+ -+ /* coex table */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ else -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* pstdma */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 10); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); -+ else -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 85); -+ -+ /* decrease BT power */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ -+ /* limited Rx */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ else -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, -+ 0x8); -+ -+ /* fw dac swing level */ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+/* HID+A2DP+PAN(EDR) */ -+void halbtc8812a2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 bt_thresh0 = 0, bt_thresh1 = 0; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, -+ &bt_thresh1); -+ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, -+ bt_thresh1); -+ -+ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, -+ 0); -+ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ -+ -+ /* power save state */ -+ if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state)))) -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ true, 0x0, 0x0); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ true, 0x0, 0x0); -+ else -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, -+ 0x50, 0x4); -+ -+ /* coex table */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ else -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* pstdma */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, false, 3); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, true, 3); -+ else { -+ coex_dm->auto_tdma_adjust = false; -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); -+ } -+ -+ /* decrease BT power */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ -+ /* limited Rx */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ else -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, -+ 0x8); -+ -+ -+ /* fw dac swing level */ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8812a2ant_action_hid_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 bt_thresh0 = 0, bt_thresh1 = 0; -+ -+ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, -+ &bt_thresh1); -+ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, -+ bt_thresh1); -+ -+ -+ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, -+ 0); -+ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ -+ -+ /* power save state */ -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, -+ 0x0, 0x0); -+ -+ /* coex table */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ else -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* pstdma */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, false, 2); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, true, 2); -+ else -+ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, true, 2); -+ -+ /* decrease BT power */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ -+ /* limited Rx */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ else -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, -+ 0x8); -+ -+ /* fw dac swing level */ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8812a2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_bw; -+ u8 bt_thresh0 = 0, bt_thresh1 = 0; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, -+ &bt_thresh1); -+ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, -+ bt_thresh1); -+ -+ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, -+ 0); -+ /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ -+ -+ /* power save state */ -+ if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state)))) -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ true, 0x0, 0x0); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ true, 0x0, 0x0); -+ else -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, -+ 0x50, 0x4); -+ -+ /* coex table */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ else -+ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* pstdma */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, false, 2); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, true, 2); -+ else { -+ coex_dm->auto_tdma_adjust = false; -+ halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 82); -+ } -+ -+ /* decrease BT power */ -+ if (BTC_RSSI_LOW(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); -+ -+ /* limited Rx */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ else if (BTC_RSSI_LOW(wifi_rssi_state) && -+ (!BTC_RSSI_LOW(bt_rssi_state))) -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ else -+ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, -+ 0x8); -+ -+ /* fw dac swing level */ -+ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if (BTC_RSSI_HIGH(wifi_rssi_state)) { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+ -+void halbtc8812a2ant_coex_under_5g(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8812a2ant_coex_all_off(btcoexist); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Under 5G, force set BT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); -+} -+/* **************************************************** */ -+void halbtc8812a2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_under_5g = false; -+ u8 algorithm = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if (wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), run 5G coex setting!!<===\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_coex_under_5g(btcoexist); -+ return; -+ } -+ -+ -+ algorithm = halbtc8812a2ant_action_algorithm(btcoexist); -+ if (coex_sta->c2h_bt_inquiry_page && -+ (BT_8812A_2ANT_COEX_ALGO_PANHS != algorithm)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under inquiry/page scan !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_bt_inquiry(btcoexist); -+ return; -+ } -+ -+ coex_dm->cur_algorithm = algorithm; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", -+ coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ -+ if (halbtc8812a2ant_is_common_action(btcoexist)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant common.\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->auto_tdma_adjust = false; -+ coex_dm->auto_tdma_adjust_low_rssi = false; -+ } else { -+ if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", -+ coex_dm->pre_algorithm, coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ coex_dm->auto_tdma_adjust = false; -+ coex_dm->auto_tdma_adjust_low_rssi = false; -+ } -+ switch (coex_dm->cur_algorithm) { -+ case BT_8812A_2ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_sco(btcoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_SCO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = SCO+HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_sco_hid(btcoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_hid(btcoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_a2dp(btcoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_a2dp_pan_hs(btcoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_pan_edr(btcoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_pan_hs(btcoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_pan_edr_a2dp(btcoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_pan_edr_hid(btcoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_hid_a2dp_pan_edr( -+ btcoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_hid_a2dp_pan_hs( -+ btcoexist); -+ break; -+ case BT_8812A_2ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_action_hid_a2dp(btcoexist); -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_coex_all_off(btcoexist); -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+ -+} -+ -+void halbtc8812a2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean back_up) -+{ -+ u8 u8tmp = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 2Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (back_up) { -+ /* backup rf 0x1e value */ -+ coex_dm->bt_rf_0x1e_backup = -+ btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1e, -+ 0xfffff); -+ -+ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, -+ 0x430); -+ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, -+ 0x434); -+ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( -+ btcoexist, 0x42a); -+ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( -+ btcoexist, 0x456); -+ } -+ -+ /* ant sw control to BT */ -+ halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_CPL_AUX, true, -+ false); -+ -+ /* 0x790[5:0]=0x5 */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); -+ u8tmp &= 0xc0; -+ u8tmp |= 0x5; -+ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); -+ -+ /* PTA parameter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, 0xffff); -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, 0x55555555); -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, 0x55555555); -+ -+ /* coex parameters */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); -+ -+ /* enable counter statistics */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); -+ -+ /* enable PTA */ -+ btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); -+ -+ /* bt clock related */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x4); -+ u8tmp |= BIT(7); -+ btcoexist->btc_write_1byte(btcoexist, 0x4, u8tmp); -+ -+ /* bt clock related */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x7); -+ u8tmp |= BIT(1); -+ btcoexist->btc_write_1byte(btcoexist, 0x7, u8tmp); -+} -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8812a2ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8812a2ant_ -+ * ************************************************************ */ -+void ex_halbtc8812a2ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+} -+ -+void ex_halbtc8812a2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ halbtc8812a2ant_init_hw_config(btcoexist, true); -+ btcoexist->stop_coex_dm = false; -+} -+ -+void ex_halbtc8812a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->stop_coex_dm = false; -+ halbtc8812a2ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8812a2ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u16 u16tmp[4]; -+ u32 u32tmp[4]; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", -+ "Ant PG number/ Ant mechanism:", -+ board_info->pg_ant_num, board_info->btdm_ant_num); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", -+ "CoexVer/ FwVer/ PatchVer", -+ glcoex_ver_date_8812a_2ant, glcoex_ver_8812a_2ant, fw_ver, -+ bt_patch_ver, bt_patch_ver); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") -+ : ((BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi, coex_sta->bt_retry_cnt); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP", -+ bt_link_info->sco_exist, bt_link_info->hid_exist, -+ bt_link_info->pan_exist, bt_link_info->a2dp_exist); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "BT Info A2DP rate", -+ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); -+ CL_PRINTF(cli_buf); -+ -+ for (i = 0; i < BT_INFO_SRC_8812A_2ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8812a_2ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ /* Sw mechanism */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Sw mechanism]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", -+ "SM1[ShRf/ LpRA/ LimDig]", -+ coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, -+ coex_dm->limited_dig); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", -+ "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", -+ coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, -+ coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); -+ CL_PRINTF(cli_buf); -+ -+ /* Fw mechanism */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Fw mechanism]============"); -+ CL_PRINTF(cli_buf); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d/%d)", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], -+ ps_tdma_case, coex_dm->auto_tdma_adjust, -+ coex_dm->auto_tdma_adjust_low_rssi); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", -+ "DecBtPwr/ IgnWlanAct", -+ coex_dm->cur_bt_dec_pwr_lvl, coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", -+ "RF-A, 0x1e initVal", -+ coex_dm->bt_rf_0x1e_backup); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "backup ARFR1/ARFR2/RL/AMaxTime", -+ coex_dm->backup_arfr_cnt1, coex_dm->backup_arfr_cnt2, -+ coex_dm->backup_retry_limit, -+ coex_dm->backup_ampdu_max_time); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "0x430/0x434/0x42a/0x456", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x ", -+ "0x778 (W_Act)/ 0x6cc (CoTab Sel)", -+ u8tmp[0], u8tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x8db); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xc5b); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x8db(ADC)/0xc5b[29:25](DAC)", -+ ((u8tmp[0] & 0x60) >> 5), ((u8tmp[1] & 0x3e) >> 1)); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcb3); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xcb7); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0xcb3/ 0xcb7", -+ u8tmp[0], u8tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x974); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x40/ 0x4c[24:23]/ 0x974", -+ u8tmp[0], ((u32tmp[0] & 0x01800000) >> 23), u32tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x550(bcn ctrl)/0x522", -+ u32tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa0a); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0xc50(DIG)/0xa0a(CCK-TH)", -+ u32tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0xf48/ 0xa5b (FA cnt-- OFDM : CCK)", -+ u32tmp[0], (u8tmp[0] << 8) + u8tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(high-pri rx/tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(low-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+#if (BT_AUTO_REPORT_ONLY_8812A_2ANT == 1) -+ halbtc8812a2ant_monitor_bt_ctr(btcoexist); -+#endif -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void ex_halbtc8812a2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ boolean wifi_under_5g = false; -+ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ halbtc8812a2ant_coex_all_off(btcoexist); -+ halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_CPL_AUX, -+ false, true); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS notify, force set BT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ ex_halbtc8812a2ant_media_status_notify(btcoexist, -+ BTC_MEDIA_DISCONNECT); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, -+ &wifi_under_5g); -+ if (!wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS notify, force set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, -+ false); -+ } -+ } -+} -+ -+void ex_halbtc8812a2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ } -+} -+ -+void ex_halbtc8812a2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (BTC_SCAN_START == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ } else if (BTC_SCAN_FINISH == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8812a2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (BTC_ASSOCIATE_START == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ } else if (BTC_ASSOCIATE_FINISH == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8812a2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 data_len = 5; -+ u8 buf[6] = {0}; -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ h2c_parameter[0] = 0x1; -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ buf[0] = data_len; -+ buf[1] = 0x5; /* OP_Code */ -+ buf[2] = 0x3; /* OP_Code_Length */ -+ buf[3] = h2c_parameter[0]; /* OP_Code_Content */ -+ buf[4] = h2c_parameter[1]; -+ buf[5] = h2c_parameter[2]; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, -+ (void *)&buf[0]); -+} -+ -+void ex_halbtc8812a2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (type == BTC_PACKET_DHCP) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], DHCP Packet notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+} -+ -+void ex_halbtc8812a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source = 0; -+ boolean bt_busy = false, limited_dig = false; -+ boolean wifi_connected = false, wifi_under_5g = false; -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8812A_2ANT_MAX) -+ rsp_source = BT_INFO_SRC_8812A_2ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (BT_INFO_SRC_8812A_2ANT_WIFI_FW != rsp_source) { -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; -+ -+ coex_sta->bt_rssi = -+ coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ if ((coex_sta->bt_info_ext & BIT(1))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (wifi_connected) -+ ex_halbtc8812a2ant_media_status_notify( -+ btcoexist, BTC_MEDIA_CONNECT); -+ else -+ ex_halbtc8812a2ant_media_status_notify( -+ btcoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ if ((coex_sta->bt_info_ext & BIT(3)) && !wifi_under_5g) { -+ /* BT already ignored WlanAct */ -+ if (!btcoexist->manual_control && -+ !btcoexist->stop_coex_dm) { -+ if (!coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_ignore_wlan_act( -+ btcoexist, FORCE_EXEC, false); -+ } -+ } -+ } else { -+ /* BT already NOT ignore Wlan active, do nothing here. */ -+ -+ if (coex_sta->under_ips) { -+ /* work around for 8812a combo hw bug => when IPS, wlanAct is always high. */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS, set BT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_ignore_wlan_act(btcoexist, -+ FORCE_EXEC, true); -+ } -+ } -+ } -+ -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (bt_info & BT_INFO_8812A_2ANT_B_INQ_PAGE) -+ coex_sta->c2h_bt_inquiry_page = true; -+ else -+ coex_sta->c2h_bt_inquiry_page = false; -+ -+ /* set link exist status */ -+ if (!(bt_info & BT_INFO_8812A_2ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ coex_sta->acl_busy = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (bt_info & BT_INFO_8812A_2ANT_B_FTP) -+ coex_sta->pan_exist = true; -+ else -+ coex_sta->pan_exist = false; -+ if (bt_info & BT_INFO_8812A_2ANT_B_A2DP) -+ coex_sta->a2dp_exist = true; -+ else -+ coex_sta->a2dp_exist = false; -+ if (bt_info & BT_INFO_8812A_2ANT_B_HID) -+ coex_sta->hid_exist = true; -+ else -+ coex_sta->hid_exist = false; -+ if (bt_info & BT_INFO_8812A_2ANT_B_SCO_ESCO) -+ coex_sta->sco_exist = true; -+ else -+ coex_sta->sco_exist = false; -+ if (bt_info & BT_INFO_8812A_2ANT_B_ACL_BUSY) -+ coex_sta->acl_busy = true; -+ else -+ coex_sta->acl_busy = false; -+ -+ } -+ -+ halbtc8812a2ant_update_bt_link_info(btcoexist); -+ -+ if (!(bt_info & BT_INFO_8812A_2ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info == -+ BT_INFO_8812A_2ANT_B_CONNECTION) { /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if ((bt_info & BT_INFO_8812A_2ANT_B_SCO_ESCO) || -+ (bt_info & BT_INFO_8812A_2ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8812A_2ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info & BT_INFO_8812A_2ANT_B_ACL_BUSY) { -+ coex_dm->bt_status = BT_8812A_2ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_dm->bt_status = BT_8812A_2ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if ((BT_8812A_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8812A_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8812A_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { -+ bt_busy = true; -+ if (!wifi_under_5g) -+ limited_dig = true; -+ } else { -+ bt_busy = false; -+ limited_dig = false; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ coex_dm->limited_dig = limited_dig; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); -+ -+ halbtc8812a2ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8812a2ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_RF_ON == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->stop_coex_dm = false; -+ } -+ if (BTC_RF_OFF == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ true, 0x0, 0x0); -+ halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); -+ /* halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, false, true); */ -+ halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ btcoexist->stop_coex_dm = true; -+ -+ } -+} -+ -+ -+void ex_halbtc8812a2ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_CPL_AUX, false, -+ true); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Halt notify, force set BT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ ex_halbtc8812a2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+ -+ /* 0x522=0xff, pause tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x522, 0xff); -+ /* 0x40[7:6]=2'b01, modify BT mode. */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0xc0, 0x2); -+ btcoexist->stop_coex_dm = true; -+} -+ -+void ex_halbtc8812a2ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+#if (BT_AUTO_REPORT_ONLY_8812A_2ANT == 0) -+ halbtc8812a2ant_query_bt_info(btcoexist); -+ halbtc8812a2ant_monitor_bt_ctr(btcoexist); -+ halbtc8812a2ant_monitor_bt_enable_disable(btcoexist); -+#else -+ if (halbtc8812a2ant_is_wifi_status_changed(btcoexist) || -+ coex_dm->auto_tdma_adjust || -+ coex_dm->auto_tdma_adjust_low_rssi) -+ halbtc8812a2ant_run_coexist_mechanism(btcoexist); -+#endif -+} -+ -+void ex_halbtc8812a2ant_dbg_control(IN struct btc_coexist *btcoexist, -+ IN u8 op_code, IN u8 op_len, IN u8 *pdata) -+{ -+ switch (op_code) { -+ case BTC_DBG_SET_COEX_DEC_BT_PWR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set Dec BT power\n"); -+ BTC_TRACE(trace_buf); -+ { -+ u8 data_len = 4; -+ u8 buf[6] = {0}; -+ u8 dec_bt_pwr = 0, pwr_level = 0; -+ if (op_len == 2) { -+ dec_bt_pwr = pdata[0]; -+ pwr_level = pdata[1]; -+ -+ buf[0] = data_len; -+ buf[1] = 0x3; /* OP_Code */ -+ buf[2] = 0x2; /* OP_Code_Length */ -+ -+ buf[3] = dec_bt_pwr; /* OP_Code_Content */ -+ buf[4] = pwr_level; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set Dec BT power=%d, pwr_level=%d\n", -+ dec_bt_pwr, pwr_level); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_CTRL_BT_COEX, -+ (void *)&buf[0]); -+ } -+ } -+ break; -+ -+ case BTC_DBG_SET_COEX_BT_AFH_MAP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set BT AFH Map\n"); -+ BTC_TRACE(trace_buf); -+ { -+ u8 data_len = 5; -+ u8 buf[6] = {0}; -+ if (op_len == 3) { -+ buf[0] = data_len; -+ buf[1] = 0x5; /* OP_Code */ -+ buf[2] = 0x3; /* OP_Code_Length */ -+ -+ buf[3] = pdata[0]; /* OP_Code_Content */ -+ buf[4] = pdata[1]; -+ buf[5] = pdata[2]; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set BT AFH Map = %02x %02x %02x\n", -+ pdata[0], pdata[1], pdata[2]); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_CTRL_BT_COEX, -+ (void *)&buf[0]); -+ } -+ } -+ break; -+ -+ case BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set BT Ignore Wlan Active\n"); -+ BTC_TRACE(trace_buf); -+ { -+ u8 data_len = 3; -+ u8 buf[6] = {0}; -+ if (op_len == 1) { -+ buf[0] = data_len; -+ buf[1] = 0x1; /* OP_Code */ -+ buf[2] = 0x1; /* OP_Code_Length */ -+ -+ buf[3] = pdata[0]; /* OP_Code_Content */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set BT Ignore Wlan Active = 0x%x\n", -+ pdata[0]); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_CTRL_BT_COEX, -+ (void *)&buf[0]); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -\ Ingen nyrad vid filslut -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8812a2Ant.h 2018-02-11 21:44:27.147146086 +0200 -@@ -0,0 +1,202 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8812A_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8812A 2Ant BT Co-exist definition -+ * ******************************************* */ -+#define BT_AUTO_REPORT_ONLY_8812A_2ANT 0 -+ -+#define BT_INFO_8812A_2ANT_B_FTP BIT(7) -+#define BT_INFO_8812A_2ANT_B_A2DP BIT(6) -+#define BT_INFO_8812A_2ANT_B_HID BIT(5) -+#define BT_INFO_8812A_2ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8812A_2ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8812A_2ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8812A_2ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8812A_2ANT_B_CONNECTION BIT(0) -+ -+#define BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT(0))) ? true : false) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT 2 -+ -+enum bt_info_src_8812a_2ant { -+ BT_INFO_SRC_8812A_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8812A_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8812A_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8812A_2ANT_MAX -+}; -+ -+enum bt_8812a_2ant_bt_status { -+ BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8812A_2ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8812A_2ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8812A_2ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8812A_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8812A_2ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8812a_2ant_coex_algo { -+ BT_8812A_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8812A_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8812A_2ANT_COEX_ALGO_SCO_HID = 0x2, -+ BT_8812A_2ANT_COEX_ALGO_HID = 0x3, -+ BT_8812A_2ANT_COEX_ALGO_A2DP = 0x4, -+ BT_8812A_2ANT_COEX_ALGO_A2DP_PANHS = 0x5, -+ BT_8812A_2ANT_COEX_ALGO_PANEDR = 0x6, -+ BT_8812A_2ANT_COEX_ALGO_PANHS = 0x7, -+ BT_8812A_2ANT_COEX_ALGO_PANEDR_A2DP = 0x8, -+ BT_8812A_2ANT_COEX_ALGO_PANEDR_HID = 0x9, -+ BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0xa, -+ BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANHS = 0xb, -+ BT_8812A_2ANT_COEX_ALGO_HID_A2DP = 0xc, -+ BT_8812A_2ANT_COEX_ALGO_MAX = 0xd -+}; -+ -+struct coex_dm_8812a_2ant { -+ /* fw mechanism */ -+ u8 pre_bt_dec_pwr_lvl; -+ u8 cur_bt_dec_pwr_lvl; -+ u8 pre_fw_dac_swing_lvl; -+ u8 cur_fw_dac_swing_lvl; -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean auto_tdma_adjust; -+ boolean auto_tdma_adjust_low_rssi; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ /* sw mechanism */ -+ boolean pre_rf_rx_lpf_shrink; -+ boolean cur_rf_rx_lpf_shrink; -+ u32 bt_rf_0x1e_backup; -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ boolean pre_dac_swing_on; -+ u32 pre_dac_swing_lvl; -+ boolean cur_dac_swing_on; -+ u32 cur_dac_swing_lvl; -+ boolean pre_adc_back_off; -+ boolean cur_adc_back_off; -+ boolean pre_agc_table_en; -+ boolean cur_agc_table_en; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ -+ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ -+ u16 backup_retry_limit; -+ u8 backup_ampdu_max_time; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ u32 pre_ra_mask; -+ u32 cur_ra_mask; -+ u8 cur_ra_mask_type; -+ u8 pre_arfr_type; -+ u8 cur_arfr_type; -+ u8 pre_retry_limit_type; -+ u8 cur_retry_limit_type; -+ u8 pre_ampdu_time_type; -+ u8 cur_ampdu_time_type; -+}; -+ -+struct coex_sta_8812a_2ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ boolean acl_busy; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ u8 bt_rssi; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8812A_2ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8812A_2ANT_MAX]; -+ u32 bt_info_query_cnt; -+ boolean c2h_bt_inquiry_page; -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8812a2ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8812a2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8812a2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8812a2ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a2ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8812a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8812a2ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+ -+void ex_halbtc8812a2ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8812a2ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8812a2ant_display_coex_info(IN struct btc_coexist *btcoexist); -+void ex_halbtc8812a2ant_dbg_control(IN struct btc_coexist *btcoexist, -+ IN u8 op_code, IN u8 op_len, IN u8 *pdata); -+ -+#else -+#define ex_halbtc8812a2ant_power_on_setting(btcoexist) -+#define ex_halbtc8812a2ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8812a2ant_init_coex_dm(btcoexist) -+#define ex_halbtc8812a2ant_ips_notify(btcoexist, type) -+#define ex_halbtc8812a2ant_lps_notify(btcoexist, type) -+#define ex_halbtc8812a2ant_scan_notify(btcoexist, type) -+#define ex_halbtc8812a2ant_connect_notify(btcoexist, type) -+#define ex_halbtc8812a2ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8812a2ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8812a2ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8812a2ant_rf_status_notify(btcoexist, type) -+#define ex_halbtc8812a2ant_halt_notify(btcoexist) -+#define ex_halbtc8812a2ant_periodical(btcoexist) -+#define ex_halbtc8812a2ant_display_coex_info(btcoexist) -+#define ex_halbtc8812a2ant_dbg_control(btcoexist, op_code, op_len, pdata) -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.c 2018-02-11 21:44:27.147146086 +0200 -@@ -0,0 +1,3100 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for 8821A_1ANT Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ -+ * SY modify 2015/04/27 -+ * ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821A_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8821a_1ant glcoex_dm_8821a_1ant; -+static struct coex_dm_8821a_1ant *coex_dm = &glcoex_dm_8821a_1ant; -+static struct coex_sta_8821a_1ant glcoex_sta_8821a_1ant; -+static struct coex_sta_8821a_1ant *coex_sta = &glcoex_sta_8821a_1ant; -+ -+const char *const glbt_info_src_8821a_1ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8821a_1ant = 20150615; -+u32 glcoex_ver_8821a_1ant = 0x61; -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8821a1ant_ -+ * ************************************************************ */ -+u8 halbtc8821a1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_bt_rssi_state; -+ } -+ -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8821a1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_wifi_rssi_state[index]; -+ } -+ -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8821a1ant_update_ra_mask(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 dis_rate_mask) -+{ -+ coex_dm->cur_ra_mask = dis_rate_mask; -+ -+ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, -+ &coex_dm->cur_ra_mask); -+ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -+} -+ -+void halbtc8821a1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ coex_dm->cur_arfr_type = type; -+ -+ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { -+ switch (coex_dm->cur_arfr_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_4byte(btcoexist, 0x430, -+ coex_dm->backup_arfr_cnt1); -+ btcoexist->btc_write_4byte(btcoexist, 0x434, -+ coex_dm->backup_arfr_cnt2); -+ break; -+ case 1: -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x01010101); -+ } else { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -+} -+ -+void halbtc8821a1ant_retry_limit(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_retry_limit_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_retry_limit_type != -+ coex_dm->cur_retry_limit_type)) { -+ switch (coex_dm->cur_retry_limit_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ coex_dm->backup_retry_limit); -+ break; -+ case 1: /* retry limit=8 */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -+} -+ -+void halbtc8821a1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_ampdu_time_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { -+ switch (coex_dm->cur_ampdu_time_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ coex_dm->backup_ampdu_max_time); -+ break; -+ case 1: /* AMPDU timw = 0x38 * 32us */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -+} -+ -+void halbtc8821a1ant_limited_tx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, -+ IN u8 retry_limit_type, IN u8 ampdu_time_type) -+{ -+ switch (ra_mask_type) { -+ case 0: /* normal mode */ -+ halbtc8821a1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0); -+ break; -+ case 1: /* disable cck 1/2 */ -+ halbtc8821a1ant_update_ra_mask(btcoexist, force_exec, -+ 0x00000003); -+ break; -+ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ -+ halbtc8821a1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8821a1ant_auto_rate_fallback_retry(btcoexist, force_exec, -+ arfr_type); -+ halbtc8821a1ant_retry_limit(btcoexist, force_exec, retry_limit_type); -+ halbtc8821a1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -+} -+ -+ -+/* ture/xxxx/x:1 -+ * false/false/x: 64 -+ * false/ture/x:x */ -+void halbtc8821a1ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+void halbtc8821a1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+#if 0 -+ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ -+ if (!(btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8)) { -+ coex_sta->high_priority_tx = 65535; -+ coex_sta->high_priority_rx = 65535; -+ coex_sta->low_priority_tx = 65535; -+ coex_sta->low_priority_rx = 65535; -+ return; -+ } -+#endif -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+} -+ -+void halbtc8821a1ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ coex_sta->c2h_bt_info_req_sent = true; -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+} -+ -+boolean halbtc8821a1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ } -+ -+ return false; -+} -+ -+void halbtc8821a1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+} -+ -+u8 halbtc8821a1ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8821A_1ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_HID_A2DP; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+void halbtc8821a1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8821a1ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8821a1ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8821a1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf5; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xa0; /* MCS6 or OFDM48// */ -+ h2c_parameter[5] = 0xa0; /* MCS5 or OFDM36 // */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+} -+ -+void halbtc8821a1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8821a1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8821a1ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8821a1ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8821a1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8821a1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** CoexTable(%d) **********\n", type); -+ BTC_TRACE(trace_buf); -+ -+ switch (type) { -+ case 0: -+ halbtc8821a1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8821a1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8821a1ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8821a1ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8821a1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8821a1ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0xaaaa5a5a, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8821a1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8821a1ant_coex_table(btcoexist, force_exec, -+ 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8821a1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8821a1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8821a1ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8821a1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ if (ap_enable) { -+ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], FW for 1Ant AP mode\n"); -+ BTC_TRACE(trace_buf); -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ } -+ } -+ -+ h2c_parameter[0] = real_byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = real_byte5; -+ -+ coex_dm->ps_tdma_para[0] = real_byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = real_byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+void halbtc8821a1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8821a1ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8821a1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8821a1ant_sw_mechanism(IN struct btc_coexist *btcoexist, -+ IN boolean low_penalty_ra) -+{ -+ halbtc8821a1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -+} -+ -+void halbtc8821a1ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u32 u32tmp = 0; -+ u8 h2c_parameter[2] = {0}; -+ -+ if (init_hwcfg) { -+ /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp &= ~BIT(23); -+ u32tmp |= BIT(24); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ -+ /* 0x765 = 0x18 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x765, 0x18, 0x3); -+ -+ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { -+ /* tell firmware "antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ -+ h2c_parameter[0] = 1; -+ h2c_parameter[1] = 1; -+ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, -+ h2c_parameter); -+ -+ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, 0x1); //Main Ant to BT for IPS case 0x4c[23]=1 */ -+ } else { -+ /* tell firmware "no antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ -+ h2c_parameter[0] = 0; -+ h2c_parameter[1] = 1; -+ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, -+ h2c_parameter); -+ -+ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, 0x0); //Aux Ant to BT for IPS case 0x4c[23]=1 */ -+ } -+ } else if (wifi_off) { -+ /* 0x4c[24:23]=00, Set Antenna control by BT_RFE_CTRL BT Vendor 0xac=0xf002 */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp &= ~BIT(23); -+ u32tmp &= ~BIT(24); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ -+ /* 0x765 = 0x18 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x765, 0x18, 0x3); -+ } else { -+ /* 0x765 = 0x0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x765, 0x18, 0x0); -+ } -+ -+ /* ext switch setting */ -+ switch (ant_pos_type) { -+ case BTC_ANT_PATH_WIFI: -+ btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ btcoexist->btc_write_1byte_bitmask(btcoexist, -+ 0xcb7, 0x30, 0x1); -+ else -+ btcoexist->btc_write_1byte_bitmask(btcoexist, -+ 0xcb7, 0x30, 0x2); -+ break; -+ case BTC_ANT_PATH_BT: -+ btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ btcoexist->btc_write_1byte_bitmask(btcoexist, -+ 0xcb7, 0x30, 0x2); -+ else -+ btcoexist->btc_write_1byte_bitmask(btcoexist, -+ 0xcb7, 0x30, 0x1); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x66); -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ btcoexist->btc_write_1byte_bitmask(btcoexist, -+ 0xcb7, 0x30, 0x1); -+ else -+ btcoexist->btc_write_1byte_bitmask(btcoexist, -+ 0xcb7, 0x30, 0x2); -+ break; -+ } -+} -+ -+void halbtc8821a1ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ u8 rssi_adjust_val = 0; -+ /* u32 fw_ver=0; */ -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ if (coex_dm->cur_ps_tdma_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(on, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(off, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ if (turn_on) { -+ switch (type) { -+ default: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x1a, 0x1a, 0x0, 0x50); -+ break; -+ case 1: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x3a, 0x03, 0x10, 0x50); -+ rssi_adjust_val = 11; -+ break; -+ case 2: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x2b, 0x03, 0x10, 0x50); -+ rssi_adjust_val = 14; -+ break; -+ case 3: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x1d, 0x1d, 0x0, 0x52); -+ break; -+ case 4: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x15, 0x3, 0x14, 0x0); -+ rssi_adjust_val = 17; -+ break; -+ case 5: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x15, 0x3, 0x11, 0x10); -+ break; -+ case 6: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x20, 0x3, 0x11, 0x13); -+ break; -+ case 7: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x13, -+ 0xc, 0x5, 0x0, 0x0); -+ break; -+ case 8: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x25, 0x3, 0x10, 0x0); -+ break; -+ case 9: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x21, 0x3, 0x10, 0x50); -+ rssi_adjust_val = 18; -+ break; -+ case 10: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x13, -+ 0xa, 0xa, 0x0, 0x40); -+ break; -+ case 11: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x15, 0x03, 0x10, 0x50); -+ rssi_adjust_val = 20; -+ break; -+ case 12: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x0a, 0x0a, 0x0, 0x50); -+ break; -+ case 13: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x12, 0x12, 0x0, 0x50); -+ break; -+ case 14: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x1e, 0x3, 0x10, 0x14); -+ break; -+ case 15: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x13, -+ 0xa, 0x3, 0x8, 0x0); -+ break; -+ case 16: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x15, 0x3, 0x10, 0x0); -+ rssi_adjust_val = 18; -+ break; -+ case 18: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x93, -+ 0x25, 0x3, 0x10, 0x0); -+ rssi_adjust_val = 14; -+ break; -+ case 20: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x35, 0x03, 0x11, 0x10); -+ break; -+ case 21: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x25, 0x03, 0x11, 0x11); -+ break; -+ case 22: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x25, 0x03, 0x11, 0x10); -+ break; -+ case 23: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x3, 0x31, 0x18); -+ rssi_adjust_val = 22; -+ break; -+ case 24: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x15, 0x3, 0x31, 0x18); -+ rssi_adjust_val = 22; -+ break; -+ case 25: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0xa, 0x3, 0x31, 0x18); -+ rssi_adjust_val = 22; -+ break; -+ case 26: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0xa, 0x3, 0x31, 0x18); -+ rssi_adjust_val = 22; -+ break; -+ case 27: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x3, 0x31, 0x98); -+ rssi_adjust_val = 22; -+ break; -+ case 28: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x69, -+ 0x25, 0x3, 0x31, 0x0); -+ break; -+ case 29: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xab, -+ 0x1a, 0x1a, 0x1, 0x10); -+ break; -+ case 30: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x30, 0x3, 0x10, 0x10); -+ break; -+ case 31: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x1a, 0x1a, 0, 0x58); -+ break; -+ case 32: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, -+ 0x35, 0x3, 0x11, 0x11); -+ break; -+ case 33: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xa3, -+ 0x25, 0x3, 0x30, 0x90); -+ break; -+ case 34: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x53, -+ 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 35: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x63, -+ 0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 36: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x12, 0x3, 0x14, 0x50); -+ break; -+ case 40: /* SoftAP only with no sta associated,BT disable ,TDMA mode for power saving */ -+ /* here softap mode screen off will cost 70-80mA for phone */ -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x23, -+ 0x18, 0x00, 0x10, 0x24); -+ break; -+ case 41: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x15, 0x3, 0x11, 0x11); -+ break; -+ case 42: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x20, 0x3, 0x11, 0x11); -+ break; -+ case 43: -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, -+ 0x30, 0x3, 0x10, 0x11); -+ break; -+ } -+ } else { -+ /* disable PS tdma */ -+ switch (type) { -+ case 8: /* PTA Control */ -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x8, -+ 0x0, 0x0, 0x0, 0x0); -+ halbtc8821a1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_PTA, false, false); -+ break; -+ case 0: -+ default: /* Software control, Antenna at BT side */ -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x0, 0x0); -+ halbtc8821a1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_BT, false, false); -+ break; -+ case 9: /* Software control, Antenna at WiFi side */ -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x0, 0x0); -+ halbtc8821a1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_WIFI, false, false); -+ break; -+ case 10: /* under 5G */ -+ halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x8, 0x0); -+ halbtc8821a1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_BT, false, false); -+ break; -+ } -+ } -+ rssi_adjust_val = 0; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val); -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+void halbtc8821a1ant_coex_all_off(IN struct btc_coexist *btcoexist) -+{ -+ /* sw all off */ -+ halbtc8821a1ant_sw_mechanism(btcoexist, false); -+ -+ /* hw all off */ -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+boolean halbtc8821a1ant_is_common_action(IN struct btc_coexist *btcoexist) -+{ -+ boolean common = false, wifi_connected = false, wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!wifi_connected && -+ BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_sw_mechanism(btcoexist, false); -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_sw_mechanism(btcoexist, false); -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_sw_mechanism(btcoexist, false); -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_sw_mechanism(btcoexist, false); -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_sw_mechanism(btcoexist, false); -+ -+ common = true; -+ } else { -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ common = false; -+ } -+ -+ return common; -+} -+ -+void halbtc8821a1ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 1); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8821a1ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8821a1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8821a1ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8821a1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, false); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8821a1ant_coex_under_5g(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ halbtc8821a1ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); -+ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 10); -+ -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 5); -+} -+ -+void halbtc8821a1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 9); -+} -+ -+void halbtc8821a1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ -+ /* This function check if bt is disabled */ -+ -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ bt_disable_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt all counters=0, %d times!!\n", -+ bt_disable_cnt); -+ BTC_TRACE(trace_buf); -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_action_wifi_only(btcoexist); -+ } -+ } -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ if (!bt_disabled) { -+ } else { -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ } -+ } -+} -+ -+/* ********************************************* -+ * -+ * Software Coex Mechanism start -+ * -+ * ********************************************* */ -+ -+void halbtc8821a1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ /* halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); */ -+ halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, false, false); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+/* SCO only or SCO+PAN(HS) */ -+void halbtc8821a1ant_action_sco(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_sw_mechanism(btcoexist, true); -+} -+ -+void halbtc8821a1ant_action_hid(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_sw_mechanism(btcoexist, true); -+} -+ -+/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -+void halbtc8821a1ant_action_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8821a1ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8821a1ant_action_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_sw_mechanism(btcoexist, false); -+} -+ -+/* PAN(HS) only */ -+void halbtc8821a1ant_action_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_sw_mechanism(btcoexist, false); -+} -+ -+/* PAN(EDR)+A2DP */ -+void halbtc8821a1ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8821a1ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_sw_mechanism(btcoexist, true); -+} -+ -+/* HID+A2DP+PAN(EDR) */ -+void halbtc8821a1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_sw_mechanism(btcoexist, true); -+} -+ -+void halbtc8821a1ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_sw_mechanism(btcoexist, true); -+} -+ -+/* ********************************************* -+ * -+ * Non-Software Coex Mechanism start -+ * -+ * ********************************************* */ -+void halbtc8821a1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8821a1ant_action_hs(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8821a1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, -+ bt_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) { -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } -+ -+ /* sy modify */ -+ else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ /* SCO/HID/A2DP busy */ -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } -+ -+ /* sy modify */ -+ -+ else if ((bt_link_info->a2dp_exist) && -+ (bt_link_info->hid_exist)) { -+ /* A2DP+HID busy */ -+ halbtc8821a1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 14); -+ -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } -+ -+ -+ else if ((bt_link_info->pan_exist) || (wifi_busy)) { -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ } -+} -+ -+void halbtc8821a1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ /* tdma and coex table */ -+ -+ if (bt_link_info->sco_exist) { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 41); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } else { /* HID */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 42); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8821a1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ u8 bt_rssi_state; -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ bt_rssi_state = halbtc8821a1ant_bt_rssi_state(2, 28, 0); -+ -+ if (bt_link_info->hid_only) { /* HID */ -+ halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, -+ wifi_status); -+ coex_dm->auto_tdma_adjust = false; -+ return; -+ } else if (bt_link_info->a2dp_only) { /* A2DP */ -+ if (BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { -+ /* halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); */ -+ /* halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ coex_dm->auto_tdma_adjust = false; -+ } else if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ /* halbtc8821a1ant_tdma_duration_adjust_for_acl(btcoexist, wifi_status); */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 14); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } else { /* for low BT RSSI */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 14); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ coex_dm->auto_tdma_adjust = false; -+ } -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { /* HID+A2DP */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 14); -+ coex_dm->auto_tdma_adjust = false; -+ } else { /* for low BT RSSI */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 14); -+ coex_dm->auto_tdma_adjust = false; -+ } -+ -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && -+ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); -+ coex_dm->auto_tdma_adjust = false; -+ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || -+ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 43); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ coex_dm->auto_tdma_adjust = false; -+ } -+} -+ -+void halbtc8821a1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -+{ -+ /* power save state */ -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ halbtc8821a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8821a1ant_action_wifi_not_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ /* sy modify */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 14); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } else if (bt_link_info->a2dp_exist && bt_link_info->pan_exist) { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 20); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if ((BT_8821A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ /* halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); */ -+ /* halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); */ -+ -+ /* Bryant Add */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8821a1ant_action_wifi_not_connected_asso_auth( -+ IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { -+ /* sy modify */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ } else if ((bt_link_info->a2dp_exist) || (bt_link_info->pan_exist)) { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8821a1ant_action_wifi_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ /* sy modify */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 14); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 20); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if ((BT_8821A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ /* halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); */ -+ /* halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); */ -+ -+ /* Bryant Add */ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8821a1ant_action_wifi_connected_specific_packet( -+ IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ /* tdma and coex table */ -+ /* sy modify */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } -+ -+ if ((bt_link_info->hid_exist) && (bt_link_info->a2dp_exist)) { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 14); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } -+ -+ -+ else if (bt_link_info->pan_exist) { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8821a1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_busy = false; -+ boolean scan = false, link = false, roam = false; -+ boolean under_4way = false, ap_enable = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ if (under_4way) { -+ halbtc8821a1ant_action_wifi_connected_specific_packet(btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8821a1ant_action_wifi_connected_scan(btcoexist); -+ else -+ halbtc8821a1ant_action_wifi_connected_specific_packet( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ /* power save state */ -+ if (!ap_enable && -+ BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status && -+ !btcoexist->bt_link_info.hid_only) { -+ if (!wifi_busy && btcoexist->bt_link_info.a2dp_only) /* A2DP */ -+ halbtc8821a1ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ else -+ halbtc8821a1ant_power_save_state(btcoexist, -+ BTC_PS_LPS_ON, 0x50, 0x4); -+ } else -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ -+ /* tdma and coex table */ -+ if (!wifi_busy) { -+ if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8821a1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else if ((BT_8821A_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 2); -+ } -+ } else { -+ if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8821a1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else if ((BT_8821A_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else { -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 2); -+ } -+ } -+} -+ -+void halbtc8821a1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ u8 algorithm = 0; -+ -+ algorithm = halbtc8821a1ant_action_algorithm(btcoexist); -+ coex_dm->cur_algorithm = algorithm; -+ -+ if (halbtc8821a1ant_is_common_action(btcoexist)) { -+ -+ } else { -+ switch (coex_dm->cur_algorithm) { -+ case BT_8821A_1ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_action_sco(btcoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_action_hid(btcoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_action_a2dp(btcoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_action_a2dp_pan_hs(btcoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_action_pan_edr(btcoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_action_pan_hs(btcoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_action_pan_edr_a2dp(btcoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_action_pan_edr_hid(btcoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_action_hid_a2dp_pan_edr( -+ btcoexist); -+ break; -+ case BT_8821A_1ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_action_hid_a2dp(btcoexist); -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8821a1ant_coex_all_off(btcoexist); */ -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+} -+ -+void halbtc8821a1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ boolean increase_scan_dev_num = false; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean wifi_under_5g = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if (wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_coex_under_5g(btcoexist); -+ return; -+ } -+ if (coex_sta->bt_whck_test) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under WHCK TEST!!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_action_bt_whck_test(btcoexist); -+ return; -+ } -+ -+ if ((BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8821A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ increase_scan_dev_num = true; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, -+ &increase_scan_dev_num); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ if ((num_of_wifi_link >= 2) || -+ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { -+ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8821a1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (!bt_link_info->sco_exist && !bt_link_info->hid_exist) -+ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ else { -+ if (wifi_connected) { -+ wifi_rssi_state = halbtc8821a1ant_wifi_rssi_state( -+ btcoexist, 1, 2, 30, 0); -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ /* halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 1, 1); */ -+ halbtc8821a1ant_limited_tx(btcoexist, -+ NORMAL_EXEC, 1, 1, 0, 1); -+ } else { -+ /* halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 1, 1); */ -+ halbtc8821a1ant_limited_tx(btcoexist, -+ NORMAL_EXEC, 1, 1, 0, 1); -+ } -+ } else -+ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, -+ 0, 0); -+ -+ } -+ -+ if (bt_link_info->sco_exist) { -+ bt_ctrl_agg_buf_size = true; -+ agg_buf_size = 0x3; -+ } else if (bt_link_info->hid_exist) { -+ bt_ctrl_agg_buf_size = true; -+ agg_buf_size = 0x5; -+ } else if (bt_link_info->a2dp_exist || bt_link_info->pan_exist) { -+ bt_ctrl_agg_buf_size = true; -+ agg_buf_size = 0x8; -+ } -+ halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ halbtc8821a1ant_run_sw_coexist_mechanism(btcoexist); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8821a1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8821a1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ -+ if (!wifi_connected) { -+ boolean scan = false, link = false, roam = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is non connected-idle !!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8821a1ant_action_wifi_not_connected_scan( -+ btcoexist); -+ else -+ halbtc8821a1ant_action_wifi_not_connected_asso_auth( -+ btcoexist); -+ } else -+ halbtc8821a1ant_action_wifi_not_connected(btcoexist); -+ } else /* wifi LPS/Busy */ -+ halbtc8821a1ant_action_wifi_connected(btcoexist); -+} -+ -+void halbtc8821a1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ /* sw all off */ -+ halbtc8821a1ant_sw_mechanism(btcoexist, false); -+ -+ /* halbtc8821a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ -+ halbtc8821a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+} -+ -+void halbtc8821a1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean back_up, IN boolean wifi_only) -+{ -+ u8 u8tmp = 0; -+ boolean wifi_under_5g = false; -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 1Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (wifi_only) -+ return; -+ -+ if (back_up) { -+ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, -+ 0x430); -+ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, -+ 0x434); -+ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( -+ btcoexist, 0x42a); -+ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( -+ btcoexist, 0x456); -+ } -+ -+ /* 0x790[5:0]=0x5 */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); -+ u8tmp &= 0xc0; -+ u8tmp |= 0x5; -+ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ /* Antenna config */ -+ if (wifi_under_5g) -+ halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, true, -+ false); -+ else -+ halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, true, -+ false); -+ -+ /* PTA parameter */ -+ halbtc8821a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ /* Enable counter statistics */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, -+ 0xc); /* 0x76e[3] =1, WLAN_Act control by PTA */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -+} -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8821a1ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8821a1ant_ -+ * ************************************************************ */ -+void ex_halbtc8821a1ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+} -+ -+void ex_halbtc8821a1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ halbtc8821a1ant_init_hw_config(btcoexist, true, wifi_only); -+} -+ -+void ex_halbtc8821a1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = false; -+ -+ halbtc8821a1ant_init_coex_dm(btcoexist); -+ -+ halbtc8821a1ant_query_bt_info(btcoexist); -+} -+ -+void ex_halbtc8821a1ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u16 u16tmp[4]; -+ u32 u32tmp[4]; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ if (btcoexist->stop_coex_dm) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", -+ "Ant PG Num/ Ant Mech/ Ant Pos:", -+ board_info->pg_ant_num, board_info->btdm_ant_num, -+ board_info->btdm_ant_pos); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", -+ "CoexVer/ FwVer/ PatchVer", -+ glcoex_ver_date_8821a_1ant, glcoex_ver_8821a_1ant, fw_ver, -+ bt_patch_ver, bt_patch_ver); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") -+ : ((BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi, coex_sta->bt_retry_cnt); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP", -+ bt_link_info->sco_exist, bt_link_info->hid_exist, -+ bt_link_info->pan_exist, bt_link_info->a2dp_exist); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_BT_LINK_INFO); -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "BT Info A2DP rate", -+ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); -+ CL_PRINTF(cli_buf); -+ -+ for (i = 0; i < BT_INFO_SRC_8821A_1ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8821a_1ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ if (!btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "SM[LowPenaltyRA]", -+ coex_dm->cur_low_penalty_ra); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms]============"); -+ CL_PRINTF(cli_buf); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ coex_dm->auto_tdma_adjust); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", -+ "IgnWlanAct", -+ coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", -+ "Latest error condition(should be 0)", -+ coex_dm->error_condition); -+ CL_PRINTF(cli_buf); -+ } -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "backup ARFR1/ARFR2/RL/AMaxTime", -+ coex_dm->backup_arfr_cnt1, coex_dm->backup_arfr_cnt2, -+ coex_dm->backup_retry_limit, -+ coex_dm->backup_ampdu_max_time); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "0x430/0x434/0x42a/0x456", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc58); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x778/ 0xc58[29:25]", -+ u8tmp[0], (u32tmp[0] & 0x3e000000) >> 25); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x8db); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8db[6:5]", -+ ((u8tmp[0] & 0x60) >> 5)); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x975); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0xcb4[29:28]/0xcb4[7:0]/0x974[9:8]", -+ (u32tmp[0] & 0x30000000) >> 28, u32tmp[0] & 0xff, -+ u8tmp[0] & 0x3); -+ CL_PRINTF(cli_buf); -+ -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x64); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x40/0x4c[24:23]/0x64[0]", -+ u8tmp[0], ((u32tmp[0] & 0x01800000) >> 23), u8tmp[1] & 0x1); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x550(bcn ctrl)/0x522", -+ u32tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", -+ u32tmp[0] & 0xff); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5d); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "OFDM-FA/ CCK-FA", -+ u32tmp[0], (u8tmp[0] << 8) + u8tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(high-pri rx/tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(low-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+#if (BT_AUTO_REPORT_ONLY_8821A_1ANT == 1) -+ halbtc8821a1ant_monitor_bt_ctr(btcoexist); -+#endif -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void ex_halbtc8821a1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ boolean wifi_under_5g = false; -+ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, -+ &wifi_under_5g); -+ if (wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_coex_under_5g(btcoexist); -+ return; -+ } -+ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, -+ true); -+ /* halbtc8821a1ant_set_ant_path_d_cut(btcoexist, false, false, false, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); */ -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = false; -+ -+ halbtc8821a1ant_init_hw_config(btcoexist, false, false); -+ halbtc8821a1ant_init_coex_dm(btcoexist); -+ halbtc8821a1ant_query_bt_info(btcoexist); -+ } -+} -+ -+void ex_halbtc8821a1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ -+ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ } -+} -+ -+void ex_halbtc8821a1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ boolean wifi_under_5g = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if (wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_coex_under_5g(btcoexist); -+ return; -+ } -+ -+ if (BTC_SCAN_START == type) { -+ coex_sta->wifi_is_high_pri_task = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, -+ 8); /* Force antenna setup for no scan result issue */ -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (coex_sta->bt_disabled) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ halbtc8821a1ant_query_bt_info(btcoexist); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ if (num_of_wifi_link >= 2) { -+ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8821a1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8821a1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8821a1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ if (BTC_SCAN_START == type) { -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8821a1ant_action_wifi_not_connected_scan( -+ btcoexist); -+ else /* wifi is connected */ -+ halbtc8821a1ant_action_wifi_connected_scan(btcoexist); -+ } else if (BTC_SCAN_FINISH == type) { -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8821a1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8821a1ant_action_wifi_connected(btcoexist); -+ } -+} -+ -+void ex_halbtc8821a1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ boolean wifi_under_5g = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if (wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_coex_under_5g(btcoexist); -+ return; -+ } -+ -+ if (BTC_ASSOCIATE_START == type) { -+ coex_sta->wifi_is_high_pri_task = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->arp_cnt = 0; -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->arp_cnt = 0; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ if (num_of_wifi_link >= 2) { -+ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8821a1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8821a1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8821a1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ if (BTC_ASSOCIATE_START == type) -+ halbtc8821a1ant_action_wifi_not_connected_asso_auth(btcoexist); -+ else if (BTC_ASSOCIATE_FINISH == type) { -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8821a1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8821a1ant_action_wifi_connected(btcoexist); -+ } -+} -+ -+void ex_halbtc8821a1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ boolean wifi_under_5g = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if (wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_coex_under_5g(btcoexist); -+ return; -+ } -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->arp_cnt = 0; -+ } -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ /* h2c_parameter[0] = 0x1; */ -+ h2c_parameter[0] = 0x0; -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -+} -+ -+void ex_halbtc8821a1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ boolean wifi_under_5g = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if (wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_coex_under_5g(btcoexist); -+ return; -+ } -+ -+ if (BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ BTC_PACKET_ARP == type) { -+ coex_sta->wifi_is_high_pri_task = true; -+ -+ if (BTC_PACKET_ARP == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ARP notify\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet DHCP or EAPOL notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet [Type = %d] notify\n", type); -+ BTC_TRACE(trace_buf); -+ } -+ -+ coex_sta->specific_pkt_period_cnt = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ if (num_of_wifi_link >= 2) { -+ halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ halbtc8821a1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8821a1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8821a1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ if (BTC_PACKET_DHCP == type || -+ BTC_PACKET_EAPOL == type || -+ BTC_PACKET_ARP == type) { -+ if (BTC_PACKET_ARP == type) { -+ coex_dm->arp_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ARP Packet Count = %d\n", -+ coex_dm->arp_cnt); -+ BTC_TRACE(trace_buf); -+ if (coex_dm->arp_cnt >= -+ 10) /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecificPacket(btcoexist) */ -+ return; -+ } -+ -+ halbtc8821a1ant_action_wifi_connected_specific_packet(btcoexist); -+ } -+} -+ -+void ex_halbtc8821a1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source = 0; -+ boolean wifi_connected = false; -+ boolean bt_busy = false; -+ boolean wifi_under_5g = false; -+ -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8821A_1ANT_MAX) -+ rsp_source = BT_INFO_SRC_8821A_1ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ /* if 0xff, it means BT is under WHCK test */ -+ if (bt_info == 0xff) -+ coex_sta->bt_whck_test = true; -+ else -+ coex_sta->bt_whck_test = false; -+ -+ if (BT_INFO_SRC_8821A_1ANT_WIFI_FW != rsp_source) { -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) -+ coex_sta->c2h_bt_page = true; -+ else -+ coex_sta->c2h_bt_page = false; -+ -+ coex_sta->bt_rssi = -+ coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+ coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] -+ & 0x40); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, -+ &coex_sta->bt_tx_rx_mask); -+ if (!coex_sta->bt_tx_rx_mask) { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, -+ 0x3c, 0x15); -+ } -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ if (coex_sta->bt_info_ext & BIT(1)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (wifi_connected) -+ ex_halbtc8821a1ant_media_status_notify( -+ btcoexist, BTC_MEDIA_CONNECT); -+ else -+ ex_halbtc8821a1ant_media_status_notify( -+ btcoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ if ((coex_sta->bt_info_ext & BIT(3)) && !wifi_under_5g) { -+ if (!btcoexist->manual_control && -+ !btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_ignore_wlan_act(btcoexist, -+ FORCE_EXEC, false); -+ } -+ } else { -+ /* BT already NOT ignore Wlan active, do nothing here. */ -+ } -+#if (BT_AUTO_REPORT_ONLY_8821A_1ANT == 0) -+ if ((coex_sta->bt_info_ext & BIT(4))) { -+ /* BT auto report already enabled, do nothing */ -+ } else -+ halbtc8821a1ant_bt_auto_report(btcoexist, FORCE_EXEC, -+ true); -+#endif -+ } -+ -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (bt_info & BT_INFO_8821A_1ANT_B_INQ_PAGE) -+ coex_sta->c2h_bt_inquiry_page = true; -+ else -+ coex_sta->c2h_bt_inquiry_page = false; -+ -+ /* set link exist status */ -+ if (!(bt_info & BT_INFO_8821A_1ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (bt_info & BT_INFO_8821A_1ANT_B_FTP) -+ coex_sta->pan_exist = true; -+ else -+ coex_sta->pan_exist = false; -+ if (bt_info & BT_INFO_8821A_1ANT_B_A2DP) -+ coex_sta->a2dp_exist = true; -+ else -+ coex_sta->a2dp_exist = false; -+ if (bt_info & BT_INFO_8821A_1ANT_B_HID) -+ coex_sta->hid_exist = true; -+ else -+ coex_sta->hid_exist = false; -+ if (bt_info & BT_INFO_8821A_1ANT_B_SCO_ESCO) -+ coex_sta->sco_exist = true; -+ else -+ coex_sta->sco_exist = false; -+ } -+ -+ halbtc8821a1ant_update_bt_link_info(btcoexist); -+ -+ bt_info = bt_info & -+ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ -+ -+ if (!(bt_info & BT_INFO_8821A_1ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info == -+ BT_INFO_8821A_1ANT_B_CONNECTION) { /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if ((bt_info & BT_INFO_8821A_1ANT_B_SCO_ESCO) || -+ (bt_info & BT_INFO_8821A_1ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8821A_1ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info & BT_INFO_8821A_1ANT_B_ACL_BUSY) { -+ if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) -+ coex_dm->auto_tdma_adjust = false; -+ coex_dm->bt_status = BT_8821A_1ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_dm->bt_status = BT_8821A_1ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if ((BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8821A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ bt_busy = true; -+ else -+ bt_busy = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ halbtc8821a1ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8821a1ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_under_5g = false; -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if (wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_coex_under_5g(btcoexist); -+ return; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8821a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, true); -+ /* halbtc8821a1ant_set_ant_path_d_cut(btcoexist, false, false, false, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); */ -+ -+ halbtc8821a1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ -+ ex_halbtc8821a1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+ -+ btcoexist->stop_coex_dm = true; -+} -+ -+void ex_halbtc8821a1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ boolean wifi_under_5g = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if (wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a1ant_coex_under_5g(btcoexist); -+ return; -+ } -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_WIFI_PNP_SLEEP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, -+ true); -+ /* halbtc8821a1ant_set_ant_path_d_cut(btcoexist, false, false, false, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); */ -+ -+ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ -+ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ -+ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ -+ coex_sta->under_ips = false; -+ coex_sta->under_lps = false; -+ btcoexist->stop_coex_dm = true; -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->stop_coex_dm = false; -+ halbtc8821a1ant_init_hw_config(btcoexist, false, false); -+ halbtc8821a1ant_init_coex_dm(btcoexist); -+ halbtc8821a1ant_query_bt_info(btcoexist); -+ } -+} -+ -+void ex_halbtc8821a1ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+#if (BT_AUTO_REPORT_ONLY_8821A_1ANT == 0) -+ halbtc8821a1ant_query_bt_info(btcoexist); -+ halbtc8821a1ant_monitor_bt_ctr(btcoexist); -+ halbtc8821a1ant_monitor_bt_enable_disable(btcoexist); -+#else -+ if (halbtc8821a1ant_is_wifi_status_changed(btcoexist) || -+ coex_dm->auto_tdma_adjust) { -+ /* if(coex_sta->specific_pkt_period_cnt > 2) */ -+ /* { */ -+ halbtc8821a1ant_run_coexist_mechanism(btcoexist); -+ /* } */ -+ } -+ -+ coex_sta->specific_pkt_period_cnt++; -+#endif -+} -+ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a1Ant.h 2018-02-11 21:44:27.147146086 +0200 -@@ -0,0 +1,197 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821A_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8821A 1ANT BT Co-exist definition -+ * ******************************************* */ -+#define BT_AUTO_REPORT_ONLY_8821A_1ANT 1 -+ -+#define BT_INFO_8821A_1ANT_B_FTP BIT(7) -+#define BT_INFO_8821A_1ANT_B_A2DP BIT(6) -+#define BT_INFO_8821A_1ANT_B_HID BIT(5) -+#define BT_INFO_8821A_1ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8821A_1ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8821A_1ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8821A_1ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8821A_1ANT_B_CONNECTION BIT(0) -+ -+#define BT_INFO_8821A_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT(0))) ? true : false) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT 2 -+ -+enum bt_info_src_8821a_1ant { -+ BT_INFO_SRC_8821A_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8821A_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8821A_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8821A_1ANT_MAX -+}; -+ -+enum bt_8821a_1ant_bt_status { -+ BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8821A_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8821A_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8821A_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8821A_1ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8821a_1ant_wifi_status { -+ BT_8821A_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8821A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8821A_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8821A_1ANT_WIFI_STATUS_MAX -+}; -+ -+enum bt_8821a_1ant_coex_algo { -+ BT_8821A_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8821A_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8821A_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8821A_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8821A_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8821A_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8821A_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8821A_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8821A_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8821A_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8821A_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8821A_1ANT_COEX_ALGO_MAX = 0xb, -+}; -+ -+struct coex_dm_8821a_1ant { -+ /* fw mechanism */ -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean auto_tdma_adjust; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ /* sw mechanism */ -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ -+ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ -+ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ -+ u16 backup_retry_limit; -+ u8 backup_ampdu_max_time; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ u32 pre_ra_mask; -+ u32 cur_ra_mask; -+ u8 pre_arfr_type; -+ u8 cur_arfr_type; -+ u8 pre_retry_limit_type; -+ u8 cur_retry_limit_type; -+ u8 pre_ampdu_time_type; -+ u8 cur_ampdu_time_type; -+ u32 arp_cnt; -+ -+ u8 error_condition; -+}; -+ -+struct coex_sta_8821a_1ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 specific_pkt_period_cnt; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ u8 bt_rssi; -+ boolean bt_tx_rx_mask; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8821A_1ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8821A_1ANT_MAX]; -+ boolean c2h_bt_inquiry_page; -+ boolean c2h_bt_page; /* Add for win8.1 page out issue */ -+ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ boolean -+ bt_whck_test; /* Add for ASUS WHQL TEST that enable wifi test bt */ -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8821a1ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821a1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8821a1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821a1ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821a1ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821a1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821a1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821a1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821a1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821a1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8821a1ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821a1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8821a1ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821a1ant_display_coex_info(IN struct btc_coexist *btcoexist); -+ -+#else -+#define ex_halbtc8821a1ant_power_on_setting(btcoexist) -+#define ex_halbtc8821a1ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8821a1ant_init_coex_dm(btcoexist) -+#define ex_halbtc8821a1ant_ips_notify(btcoexist, type) -+#define ex_halbtc8821a1ant_lps_notify(btcoexist, type) -+#define ex_halbtc8821a1ant_scan_notify(btcoexist, type) -+#define ex_halbtc8821a1ant_connect_notify(btcoexist, type) -+#define ex_halbtc8821a1ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8821a1ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8821a1ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8821a1ant_halt_notify(btcoexist) -+#define ex_halbtc8821a1ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8821a1ant_periodical(btcoexist) -+#define ex_halbtc8821a1ant_display_coex_info(btcoexist) -+ -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.c 2018-02-11 21:44:27.147146086 +0200 -@@ -0,0 +1,4560 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8821A Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821A_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8821a_2ant glcoex_dm_8821a_2ant; -+static struct coex_dm_8821a_2ant *coex_dm = &glcoex_dm_8821a_2ant; -+static struct coex_sta_8821a_2ant glcoex_sta_8821a_2ant; -+static struct coex_sta_8821a_2ant *coex_sta = &glcoex_sta_8821a_2ant; -+ -+const char *const glbt_info_src_8821a_2ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8821a_2ant = 20150921; -+u32 glcoex_ver_8821a_2ant = 0x58; -+/* modify 20140903v43 a2dpandhid tdmaonoff a2dp glitch _ tdma off 778=3(case1)->778=1(case0) -+ * and to improve tp while a2dphid case23->case25 , case123->case125 for asus spec -+ * and modify for asus bt WHQL test _ tdma off_ 778=3->1_ -+ * ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8821a2ant_ -+ * ************************************************************ */ -+u8 halbtc8821a2ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_bt_rssi_state; -+ } -+ -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8821a2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_wifi_rssi_state[index]; -+ } -+ -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8821a2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ -+ /* This function check if bt is disabled */ -+ -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ bt_disable_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt all counters=0, %d times!!\n", -+ bt_disable_cnt); -+ BTC_TRACE(trace_buf); -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ if (!bt_disabled) { -+ } else { -+ } -+ } -+} -+ -+void halbtc8821a2ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+} -+ -+void halbtc8821a2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ if ((coex_sta->low_priority_rx >= 950) && -+ (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) && -+ (!coex_sta->under_ips)) -+ bt_link_info->slave_role = true; -+ else -+ bt_link_info->slave_role = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); -+ BTC_TRACE(trace_buf); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); -+ BTC_TRACE(trace_buf); -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+} -+ -+void halbtc8821a2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -+{ -+ if (coex_sta->under_ips) { -+ coex_sta->crc_ok_cck = 0; -+ coex_sta->crc_ok_11g = 0; -+ coex_sta->crc_ok_11n = 0; -+ coex_sta->crc_ok_11n_agg = 0; -+ -+ coex_sta->crc_err_cck = 0; -+ coex_sta->crc_err_11g = 0; -+ coex_sta->crc_err_11n = 0; -+ coex_sta->crc_err_11n_agg = 0; -+ } else { -+ coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, -+ 0xf88); -+ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf94); -+ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf90); -+ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xfb8); -+ -+ coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, -+ 0xf84); -+ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf96); -+ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf92); -+ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xfba); -+ } -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); -+} -+ -+void halbtc8821a2ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ coex_sta->c2h_bt_info_req_sent = true; -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+} -+ -+boolean halbtc8821a2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 3, -+ 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ -+ if ((BTC_RSSI_STATE_HIGH == wifi_rssi_state) || -+ (BTC_RSSI_STATE_LOW == wifi_rssi_state)) -+ return true; -+ -+ } -+ -+ return false; -+} -+ -+void halbtc8821a2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+} -+ -+u8 halbtc8821a2ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8821A_2ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_2ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_2ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(HS) ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(EDR) ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_2ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+void halbtc8821a2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, -+ IN u8 dac_swing_lvl) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ /* There are several type of dacswing */ -+ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ -+ h2c_parameter[0] = dac_swing_lvl; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); -+} -+ -+void halbtc8821a2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN u8 dec_bt_pwr_lvl) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = dec_bt_pwr_lvl; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); -+} -+ -+void halbtc8821a2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 dec_bt_pwr_lvl) -+{ -+ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) -+ return; -+ } -+ halbtc8821a2ant_set_fw_dec_bt_pwr(btcoexist, -+ coex_dm->cur_bt_dec_pwr_lvl); -+ -+ coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; -+} -+ -+void halbtc8821a2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8821a2ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8821a2ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8821a2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 fw_dac_swing_lvl) -+{ -+ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_fw_dac_swing_lvl == -+ coex_dm->cur_fw_dac_swing_lvl) -+ return; -+ } -+ -+ halbtc8821a2ant_set_fw_dac_swing_level(btcoexist, -+ coex_dm->cur_fw_dac_swing_lvl); -+ -+ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; -+} -+ -+void halbtc8821a2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist *btcoexist, -+ IN boolean rx_rf_shrink_on) -+{ -+ if (rx_rf_shrink_on) { -+ /* Shrink RF Rx LPF corner */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Shrink RF Rx LPF corner!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, -+ 0xffffc); -+ } else { -+ /* Resume RF Rx LPF corner */ -+ /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ -+ if (btcoexist->initilized) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Resume RF Rx LPF corner!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, -+ 0xfffff, coex_dm->bt_rf_0x1e_backup); -+ } -+ } -+} -+ -+void halbtc8821a2ant_rf_shrink(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rx_rf_shrink_on) -+{ -+ coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_rf_rx_lpf_shrink == -+ coex_dm->cur_rf_rx_lpf_shrink) -+ return; -+ } -+ halbtc8821a2ant_set_sw_rf_rx_lpf_corner(btcoexist, -+ coex_dm->cur_rf_rx_lpf_shrink); -+ -+ coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; -+} -+ -+void halbtc8821a2ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf5; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xa0; /* MCS6 or OFDM48 */ -+ h2c_parameter[5] = 0xa0; /* MCS5 or OFDM36 */ -+ /* h2c_parameter[3] = 0xf7; //MCS7 or OFDM54 */ -+ /* h2c_parameter[4] = 0xf8; //MCS6 or OFDM48 */ -+ /* h2c_parameter[5] = 0xf9; //MCS5 or OFDM36 */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+} -+ -+void halbtc8821a2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8821a2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8821a2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, -+ IN u32 level) -+{ -+ u8 val = (u8)level; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Write SwDacSwing = 0x%x\n", level); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc5b, 0x3e, val); -+} -+ -+void halbtc8821a2ant_set_sw_full_time_dac_swing(IN struct btc_coexist -+ *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) -+{ -+ if (sw_dac_swing_on) -+ halbtc8821a2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); -+ else -+ halbtc8821a2ant_set_dac_swing_reg(btcoexist, 0x18); -+} -+ -+ -+void halbtc8821a2ant_dac_swing(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) -+{ -+ coex_dm->cur_dac_swing_on = dac_swing_on; -+ coex_dm->cur_dac_swing_lvl = dac_swing_lvl; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && -+ (coex_dm->pre_dac_swing_lvl == -+ coex_dm->cur_dac_swing_lvl)) -+ return; -+ } -+ delay_ms(30); -+ halbtc8821a2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, -+ dac_swing_lvl); -+ -+ coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; -+ coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; -+} -+ -+void halbtc8821a2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, -+ IN boolean adc_back_off) -+{ -+ if (adc_back_off) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB BackOff Level On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x3); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB BackOff Level Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x1); -+ } -+} -+ -+void halbtc8821a2ant_adc_back_off(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean adc_back_off) -+{ -+ coex_dm->cur_adc_back_off = adc_back_off; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) -+ return; -+ } -+ halbtc8821a2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); -+ -+ coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; -+} -+ -+void halbtc8821a2ant_set_agc_table(IN struct btc_coexist *btcoexist, -+ IN boolean agc_table_en) -+{ -+ u8 rssi_adjust_val = 0; -+ -+ /* =================BB AGC Gain Table */ -+ if (agc_table_en) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB Agc Table On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6e1A0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6d1B0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6c1C0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6b1D0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6a1E0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x691F0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x68200001); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB Agc Table Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xaa1A0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa91B0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa81C0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa71D0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa61E0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa51F0001); -+ btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa4200001); -+ } -+ -+ -+ /* =================RF Gain */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); -+ if (agc_table_en) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Agc Table On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x38fff); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x38ffe); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Agc Table Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x380c3); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x28ce6); -+ } -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xed, 0xfffff, 0x1); -+ if (agc_table_en) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Agc Table On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, -+ 0x38fff); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, -+ 0x38ffe); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Agc Table Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, -+ 0x380c3); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, -+ 0x28ce6); -+ } -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xed, 0xfffff, 0x0); -+ -+ /* set rssi_adjust_val for wifi module. */ -+ if (agc_table_en) -+ rssi_adjust_val = 8; -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, -+ &rssi_adjust_val); -+} -+ -+void halbtc8821a2ant_agc_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean agc_table_en) -+{ -+ coex_dm->cur_agc_table_en = agc_table_en; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) -+ return; -+ } -+ halbtc8821a2ant_set_agc_table(btcoexist, agc_table_en); -+ -+ coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; -+} -+ -+void halbtc8821a2ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8821a2ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8821a2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8821a2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_sta->coex_table_type = type; -+ -+ switch (type) { -+ case 0: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x55555555, 0xffffff, 0x3); -+ break; -+ case 1: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5afa5afa, 0xffffff, 0x3); -+ break; -+ case 2: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x5ada5ada, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 3: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 4: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0xffffffff, 0xffffffff, 0xffffff, 0x3); -+ break; -+ case 5: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0x5fff5fff, 0xffffff, 0x3); -+ break; -+ case 6: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x55ff55ff, 0x5a5a5a5a, 0xffffff, 0x3); -+ break; -+ case 7: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 8: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 9: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 10: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 11: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 12: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 13: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 14: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); -+ break; -+ case 15: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); -+ break; -+ case 16: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0x5fdf5fdf, 0x5fdb5fdb, 0xffffff, 0x3); -+ break; -+ case 17: -+ halbtc8821a2ant_coex_table(btcoexist, force_exec, -+ 0xfafafafa, 0xfafafafa, 0xffffff, 0x3); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8821a2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8821a2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8821a2ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8821a2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8821a2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8821a2ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8821a2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ -+ h2c_parameter[0] = byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = byte5; -+ -+ coex_dm->ps_tdma_para[0] = byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+void halbtc8821a2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, -+ IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, -+ IN boolean limited_dig, IN boolean bt_lna_constrain) -+{ -+ /* -+ u32 wifi_bw; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if(BTC_WIFI_BW_HT40 != wifi_bw) -+ { -+ if (shrink_rx_lpf) -+ shrink_rx_lpf = false; -+ } -+ */ -+ -+ /* halbtc8821a2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); */ -+ halbtc8821a2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -+} -+ -+void halbtc8821a2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, -+ IN boolean agc_table_shift, IN boolean adc_back_off, -+ IN boolean sw_dac_swing, IN u32 dac_swing_lvl) -+{ -+ /* halbtc8821a2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ -+ /* halbtc8821a2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ -+ halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, -+ dac_swing_lvl); -+} -+ -+void halbtc8821a2ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u32 u32tmp = 0; -+ u8 h2c_parameter[2] = {0}; -+ -+ if (init_hwcfg) { -+ /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp &= ~BIT(23); -+ u32tmp |= BIT(24); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x974, 0x3ff); -+ /* btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); */ -+ -+ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { -+ /* tell firmware "antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ -+ h2c_parameter[0] = 1; -+ h2c_parameter[1] = 1; -+ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, -+ h2c_parameter); -+ } else { -+ /* tell firmware "no antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ -+ h2c_parameter[0] = 0; -+ h2c_parameter[1] = 1; -+ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, -+ h2c_parameter); -+ } -+ } -+ -+ /* ext switch setting */ -+ switch (ant_pos_type) { -+ case BTC_ANT_WIFI_AT_MAIN: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, -+ 0x30, 0x1); -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, -+ 0x30, 0x2); -+ break; -+ } -+} -+ -+void halbtc8821a2ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ u8 wifi_rssi_state1, bt_rssi_state; -+ -+ -+ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, -+ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ if (!(BTC_RSSI_HIGH(wifi_rssi_state1) && -+ BTC_RSSI_HIGH(bt_rssi_state)) && turn_on) { -+ type = type + 100; /* for WiFi RSSI low or BT RSSI low */ -+ } -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ if (turn_on) { -+ switch (type) { -+ case 1: -+ default: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); */ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c, 0x03, 0xf1, 0x90); -+ break; -+ case 2: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); */ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x2d, 0x03, 0xf1, 0x90); -+ break; -+ case 3: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0xf1, 0x90); -+ break; -+ case 4: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x10, 0x03, 0xf1, 0x90); -+ break; -+ case 5: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); */ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c, 0x3, 0x70, 0x90); -+ break; -+ case 6: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); */ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x2d, 0x3, 0x70, 0x90); -+ break; -+ case 7: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0x70, 0x90); -+ break; -+ case 8: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xa3, -+ 0x10, 0x3, 0x70, 0x90); -+ break; -+ case 9: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); */ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c, 0x03, 0xf1, 0x90); -+ break; -+ case 10: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); */ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x2d, 0x03, 0xf1, 0x90); -+ break; -+ case 11: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0xa, 0xa, 0xe1, 0x90); */ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0xf1, 0x90); -+ break; -+ case 12: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); */ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x10, 0x3, 0xf1, 0x90); -+ break; -+ case 13: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); */ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c, 0x3, 0x70, 0x90); -+ break; -+ case 14: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); */ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x2d, 0x3, 0x70, 0x90); -+ break; -+ case 15: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0xa, 0xa, 0x60, 0x90); */ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0x70, 0x90); -+ break; -+ case 16: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x5, 0x5, 0x60, 0x90); */ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x10, 0x3, 0x70, 0x90); -+ break; -+ case 17: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xa3, -+ 0x2f, 0x2f, 0x60, 0x90); -+ break; -+ case 18: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 19: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x25, 0xe1, 0x90); -+ break; -+ case 20: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x25, 0x60, 0x90); -+ break; -+ case 21: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x15, 0x03, 0x70, 0x90); -+ break; -+ case 23: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1e, 0x03, 0xf0, 0x14); -+ break; -+ case 24: -+ case 124: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x3c, 0x03, 0x70, 0x50); -+ break; -+ /* case25/case125 : for lenovo bt pan tp degrade<30% while wifi downlink */ -+ case 25: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x14, 0x03, 0xf1, 0x90); -+ break; -+ case 26: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x30, 0x03, 0xf1, 0x90); -+ break; -+ case 71: -+ /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); */ -+ -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c, 0x03, 0xf1, 0x90); -+ break; -+ case 101: -+ case 105: -+ case 171: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x3a, 0x03, 0x70, 0x50); -+ break; -+ case 102: -+ case 106: -+ case 110: -+ case 114: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x2d, 0x03, 0x70, 0x50); -+ break; -+ case 103: -+ case 107: -+ case 111: -+ case 115: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x1c, 0x03, 0x70, 0x50); -+ break; -+ case 104: -+ case 108: -+ case 112: -+ case 116: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x10, 0x03, 0x70, 0x50); -+ break; -+ case 109: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c, 0x03, 0xf1, 0x90); -+ break; -+ case 113: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3c, 0x03, 0x70, 0x90); -+ break; -+ case 121: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x15, 0x03, 0x70, 0x90); -+ break; -+ case 22: -+ case 122: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x35, 0x03, 0x71, 0x11); -+ break; -+ case 123: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x1c, 0x03, 0x70, 0x54); -+ break; -+ /* case25/case125 : for lenovo bt pan tp degrade<30% while wifi downlink */ -+ case 125: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x14, 0x03, 0x70, 0x50); -+ break; -+ case 126: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x30, 0x03, 0x70, 0x50); -+ break; -+ } -+ } else { -+ /* disable PS tdma */ -+ switch (type) { -+ case 0: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x40, 0x0); -+ break; -+ case 1: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x48, 0x0); -+ break; -+ default: -+ halbtc8821a2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x40, 0x0); -+ break; -+ } -+ } -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+void halbtc8821a2ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 1); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 1); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8821a2ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8821a2ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8821a2ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ coex_sta->force_lps_on = true; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8821a2ant_ps_tdma_check_for_power_save_state( -+ btcoexist, false); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+void halbtc8821a2ant_coex_all_off(IN struct btc_coexist *btcoexist) -+{ -+ /* fw all off */ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ /* hw all off */ -+ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8821a2ant_coex_under_5g(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a2ant_coex_all_off(btcoexist); -+ -+ halbtc8821a2ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); -+} -+ -+void halbtc8821a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8821a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); -+ -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+void halbtc8821a2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ boolean wifi_connected = false; -+ boolean low_pwr_disable = true; -+ boolean scan = false, link = false, roam = false; -+ -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, -+ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ if (scan || link || roam) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi link process + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 15); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ } else if (wifi_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 15); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi no-link + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ } -+ -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+} -+ -+ -+void halbtc8821a2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist) -+{ -+ u8 u8tmpa, u8tmpb; -+ -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 15); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ -+ -+ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); -+ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], 0x765=0x%x, 0x76e=0x%x\n", u8tmpa, -+ u8tmpb); -+ BTC_TRACE(trace_buf); -+} -+ -+boolean halbtc8821a2ant_action_wifi_idle_process(IN struct btc_coexist -+ *btcoexist) -+{ -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u8 ap_num = 0; -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ /* wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); */ -+ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, -+ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES - 20, 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); -+ -+ /* define the office environment */ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && -+ (coex_sta->hid_exist == true) && -+ (coex_sta->a2dp_exist == true)) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi idle process for BT HID+A2DP exist!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x6); -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, -+ 0x18); -+ -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ -+ return true; -+ } -+ -+ /* */ -+ else if (coex_sta->pan_exist == true) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi idle process for BT PAN exist!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x6); -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, -+ 0x18); -+ -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ -+ return true; -+ } -+ -+ else { -+ halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x18); -+ return false; -+ } -+ -+ -+} -+ -+ -+ -+boolean halbtc8821a2ant_is_common_action(IN struct btc_coexist *btcoexist) -+{ -+ boolean common = false, wifi_connected = false, wifi_busy = false; -+ boolean bt_hs_on = false, low_pwr_disable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!wifi_connected) { -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non-connected idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, -+ 0x0); -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, -+ 0x18); -+ -+ common = true; -+ } else { -+ if (BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, -+ false, false, 0x8); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, -+ 0xfffff, 0x0); -+ halbtc8821a2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 1); -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 0xb); -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+ common = true; -+ } else if (BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ -+ if (bt_hs_on) -+ return false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, -+ false, false, 0x8); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, -+ 0xfffff, 0x0); -+ halbtc8821a2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_power_save_state(btcoexist, -+ BTC_PS_WIFI_NATIVE, 0x0, 0x0); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 1); -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 0xb); -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+ common = true; -+ } else { -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ common = false; -+ /* common = halbtc8821a2ant_action_wifi_idle_process(btcoexist); */ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ /* common = false; */ -+ common = halbtc8821a2ant_action_wifi_idle_process( -+ btcoexist); -+ } -+ } -+ } -+ -+ return common; -+} -+void halbtc8821a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, -+ IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) -+{ -+ static s32 up, dn, m, n, wait_count; -+ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ -+ u8 retry_count = 0; -+ -+ if (!coex_dm->auto_tdma_adjust) { -+ coex_dm->auto_tdma_adjust = true; -+ { -+ if (sco_hid) { -+ if (tx_pause) { -+ if (max_interval == 1) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 13); -+ coex_dm->ps_tdma_du_adj_type = -+ 13; -+ } else if (max_interval == 2) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (max_interval == 3) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } -+ } else { -+ if (max_interval == 1) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = -+ 9; -+ } else if (max_interval == 2) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (max_interval == 3) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } -+ } -+ } else { -+ if (tx_pause) { -+ if (max_interval == 1) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 5); -+ coex_dm->ps_tdma_du_adj_type = -+ 5; -+ } else if (max_interval == 2) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (max_interval == 3) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } -+ } else { -+ if (max_interval == 1) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (max_interval == 2) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (max_interval == 3) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } -+ } -+ } -+ } -+ /* ============ */ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } else { -+ /* accquire the BT TRx retry count from BT_Info byte2 */ -+ retry_count = coex_sta->bt_retry_cnt; -+ result = 0; -+ wait_count++; -+ -+ if (retry_count == -+ 0) { /* no retry in the last 2-second duration */ -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if (up >= n) { /* if ³sÄò n ­Ó2¬í retry count¬°0, «h½Õ¼eWiFi duration */ -+ wait_count = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ } -+ } else if (retry_count <= -+ 3) { /* <=3 retry in the last 2-second duration */ -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) { /* if ³sÄò 2 ­Ó2¬í retry count< 3, «h½Õ¯¶WiFi duration */ -+ if (wait_count <= 2) -+ m++; /* ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ } else { /* retry count > 3, ¥u­n1¦¸ retry count > 3, «h½Õ¯¶WiFi duration */ -+ if (wait_count == 1) -+ m++; /* ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ -+ if (max_interval == 1) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 71) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 5); -+ coex_dm->ps_tdma_du_adj_type = 5; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 5); -+ coex_dm->ps_tdma_du_adj_type = 5; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 13); -+ coex_dm->ps_tdma_du_adj_type = 13; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 5); -+ coex_dm->ps_tdma_du_adj_type = -+ 5; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 13); -+ coex_dm->ps_tdma_du_adj_type = -+ 13; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 71); -+ coex_dm->ps_tdma_du_adj_type = 71; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 71) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 71); -+ coex_dm->ps_tdma_du_adj_type = -+ 71; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = -+ 9; -+ } -+ } -+ } -+ } else if (max_interval == 2) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } -+ } -+ } -+ } else if (max_interval == 3) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8821a2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821a2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } -+ } -+ } -+ } -+ } -+ -+ /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ -+ /* then we have to adjust it back to the previous record one. */ -+ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { -+ boolean scan = false, link = false, roam = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", -+ coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (!scan && !link && !roam) -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ coex_dm->ps_tdma_du_adj_type); -+ else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+} -+ -+/* SCO only or SCO+PAN(HS) */ -+void halbtc8821a2ant_action_sco(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 wifi_rssi_state, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 4); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for SCO quality at 11b/g mode */ -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ else { /* for SCO quality & wifi performance balance at 11n mode */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ halbtc8821a2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 8); -+ else { -+ if (bt_link_info->sco_only) -+ halbtc8821a2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 17); -+ else -+ halbtc8821a2ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 12); -+ } -+ } -+ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 0); /* for voice quality */ -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ true, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ true, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ true, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ true, 0x18); -+ } -+ } -+} -+ -+ -+void halbtc8821a2ant_action_hid(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ else /* for HID quality & wifi performance balance at 11n mode */ -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 24); -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -+void halbtc8821a2ant_action_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ u8 ap_num = 0; -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, -+ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); -+ -+ /* define the office environment */ -+ if ((ap_num >= 10) && BTC_RSSI_HIGH(wifi_rssi_state1) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ /* dbg_print(" AP#>10(%d)\n", ap_num); */ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, -+ 0x0); -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x8); -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ /* halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); */ -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); -+ -+ /* sw mechanism */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ true, 0x6); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ true, 0x6); -+ } -+ return; -+ -+ } -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ } else { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 13); -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, false, 1); */ -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); -+ } else { -+ /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, true, 1); */ -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); -+ } -+ -+ /* sw mechanism */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8821a2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, -+ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ } else { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 13); -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ -+ halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, true, 2); -+ -+ /* sw mechanism */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8821a2ant_action_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, -+ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 10); -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ } else { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 13); -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 26); -+ else -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 26); -+ -+ /* sw mechanism */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+ -+/* PAN(HS) only */ -+void halbtc8821a2ant_action_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, -+ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+/* PAN(EDR)+A2DP */ -+void halbtc8821a2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, -+ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ else -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 12); -+ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, -+ true, 3); -+ else -+ halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, -+ false, 3); -+ } else { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 13); -+ halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, true, 3); -+ } -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8821a2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, -+ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ } else { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 14); -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 3); -+ /* halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, -+ 0xfffff, 0x780); -+ } else { -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 6); -+ /* halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, -+ 0xfffff, 0x0); -+ } -+ halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, false, 2); -+ } else { -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ /* halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, -+ 0x0); -+ halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, true, 2); -+ } -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+/* HID+A2DP+PAN(EDR) */ -+void halbtc8821a2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, -+ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); -+ -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ } else { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 14); -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, -+ true, 3); -+ else -+ halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, -+ false, 3); -+ } else -+ halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, true, 3); -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8821a2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; -+ u32 wifi_bw; -+ u8 ap_num = 0; -+ -+ wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, -+ 0); -+ /* bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, 29, 0); */ -+ wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, -+ BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); -+ bt_rssi_state = halbtc8821a2ant_bt_rssi_state(3, -+ BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 37); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); -+ -+ halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x5); -+ -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) { -+ if (BTC_RSSI_HIGH(bt_rssi_state)) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ } else { -+ /* only 802.11N mode we have to dec bt power to 4 degree */ -+ if (BTC_RSSI_HIGH(bt_rssi_state)) { -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &ap_num); -+ /* need to check ap Number of Not */ -+ if (ap_num < 10) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, -+ NORMAL_EXEC, 4); -+ else -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, -+ NORMAL_EXEC, 2); -+ } else if (BTC_RSSI_MEDIUM(bt_rssi_state)) -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ else -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ } -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -+ 0x0, 0x0); -+ } else { -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 14); -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, false, 3); */ -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); -+ } else { -+ /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, true, 3); */ -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); -+ } -+ -+ /* sw mechanism */ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } else { -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, -+ false, 0x18); -+ } else { -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ } -+ } -+} -+ -+void halbtc8821a2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8821a2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ /* hw all off */ -+ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ -+ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+} -+ -+void halbtc8821a2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_under_5g = false; -+ u8 algorithm = 0; -+ u32 num_of_wifi_link = 0; -+ u32 wifi_link_status = 0; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean miracast_plus_bt = false; -+ boolean scan = false, link = false, roam = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if (wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), run 5G coex setting!!<===\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_coex_under_5g(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->bt_whck_test) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under WHCK TEST!!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_bt_whck_test(btcoexist); -+ return; -+ } -+ -+ algorithm = halbtc8821a2ant_action_algorithm(btcoexist); -+ if (coex_sta->c2h_bt_inquiry_page && -+ (BT_8821A_2ANT_COEX_ALGO_PANHS != algorithm)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under inquiry/page scan !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_bt_inquiry(btcoexist); -+ return; -+ } else { -+ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || link || roam) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under Link Process !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_wifi_link_process(btcoexist); -+ return; -+ } -+ -+ /* for P2P */ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if ((num_of_wifi_link >= 2) || -+ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", -+ num_of_wifi_link, wifi_link_status); -+ BTC_TRACE(trace_buf); -+ -+ if (bt_link_info->bt_link_exist) -+ miracast_plus_bt = true; -+ else -+ miracast_plus_bt = false; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ halbtc8821a2ant_action_wifi_multi_port(btcoexist); -+ -+ return; -+ } else { -+ miracast_plus_bt = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ -+ coex_dm->cur_algorithm = algorithm; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", -+ coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ -+ if (halbtc8821a2ant_is_common_action(btcoexist)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant common.\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", -+ coex_dm->pre_algorithm, coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ coex_dm->auto_tdma_adjust = false; -+ } -+ switch (coex_dm->cur_algorithm) { -+ case BT_8821A_2ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_sco(btcoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_hid(btcoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_a2dp(btcoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_a2dp_pan_hs(btcoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_pan_edr(btcoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_pan_hs(btcoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_pan_edr_a2dp(btcoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_pan_edr_hid(btcoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_hid_a2dp_pan_edr( -+ btcoexist); -+ break; -+ case BT_8821A_2ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_action_hid_a2dp(btcoexist); -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_coex_all_off(btcoexist); -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+} -+ -+void halbtc8821a2ant_wifi_off_hw_cfg(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[2] = {0}; -+ u32 fw_ver = 0; -+ -+ /* set wlan_act to low */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, -+ 0x780); /* WiFi goto standby while GNT_BT 0-->1 */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ if (fw_ver >= 0x180000) { -+ /* Use H2C to set GNT_BT to HIGH */ -+ h2c_parameter[0] = 1; -+ btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, h2c_parameter); -+ } else -+ btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); -+} -+ -+void halbtc8821a2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean back_up) -+{ -+ u8 u8tmp = 0; -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 2Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* backup rf 0x1e value */ -+ coex_dm->bt_rf_0x1e_backup = -+ btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff); -+ -+ /* 0x790[5:0]=0x5 */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); -+ u8tmp &= 0xc0; -+ u8tmp |= 0x5; -+ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); -+ -+ /* Antenna config */ -+ halbtc8821a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, true, -+ false); -+ coex_sta->dis_ver_info_cnt = 0; -+ -+ /* PTA parameter */ -+ halbtc8821a2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ /* Enable counter statistics */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, -+ 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -+} -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8821a2ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8821a2ant_ -+ * ************************************************************ */ -+void ex_halbtc8821a2ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+ -+} -+ -+void ex_halbtc8821a2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ -+ -+ /* */ -+ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ -+ if (btcoexist->chip_interface == BTC_INTF_USB) { -+ /* fixed at S0 for USB interface */ -+ u8tmp |= 0x1; /* antenna inverse */ -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); -+ } else { -+ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ -+ if (board_info->single_ant_path == 0) { -+ } else if (board_info->single_ant_path == 1) { -+ /* set to S0 */ -+ u8tmp |= 0x1; /* antenna inverse */ -+ } -+ -+ if (btcoexist->chip_interface == BTC_INTF_PCI) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384, -+ u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_SDIO) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, -+ u8tmp); -+ } -+} -+ -+void ex_halbtc8821a2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ halbtc8821a2ant_init_hw_config(btcoexist, true); -+} -+ -+void ex_halbtc8821a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821a2ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8821a2ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u32 u32tmp[4]; -+ u32 fa_of_dm, fa_cck; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", -+ "Ant PG number/ Ant mechanism:", -+ board_info->pg_ant_num, board_info->btdm_ant_num); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", -+ "CoexVer/ FwVer/ PatchVer", -+ glcoex_ver_date_8821a_2ant, glcoex_ver_8821a_2ant, fw_ver, -+ bt_patch_ver, bt_patch_ver); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %ddBm/ %d] ", -+ "BT [status/ rssi/ retryCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") -+ : ((BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP", -+ bt_link_info->sco_exist, bt_link_info->hid_exist, -+ bt_link_info->pan_exist, bt_link_info->a2dp_exist); -+ CL_PRINTF(cli_buf); -+ -+ { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "BT Role", -+ (bt_link_info->slave_role) ? "Slave" : "Master"); -+ CL_PRINTF(cli_buf); -+ } -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "BT Info A2DP rate", -+ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); -+ CL_PRINTF(cli_buf); -+ -+ for (i = 0; i < BT_INFO_SRC_8821A_2ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8821a_2ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ /* Sw mechanism */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Sw mechanism]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", -+ "SM1[ShRf/ LpRA/ LimDig]", -+ coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, -+ coex_dm->limited_dig); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", -+ "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", -+ coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, -+ coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); -+ CL_PRINTF(cli_buf); -+ -+ /* Fw mechanism */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Fw mechanism]============"); -+ CL_PRINTF(cli_buf); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ coex_dm->auto_tdma_adjust); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Coex Table Type", -+ coex_sta->coex_table_type); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", -+ "DecBtPwr/ IgnWlanAct", -+ coex_dm->cur_bt_dec_pwr_lvl, coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", -+ "RF-A, 0x1e initVal", -+ coex_dm->bt_rf_0x1e_backup); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xc5b); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x880); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x778/0x880[29:25]/0xc58[29:25]", -+ u8tmp[0], (u32tmp[0] & 0x3e000000) >> 25, -+ ((u8tmp[1] & 0x3e) >> 1)); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x764); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x76e); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x764/ 0x765/ 0x76e", -+ (u32tmp[0] & 0xff), (u32tmp[0] & 0xff00) >> 8, u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0xcb4[7:0](ctrl)/ 0xcb4[29:28](val)", -+ u32tmp[0] & 0xff, ((u32tmp[0] & 0x30000000) >> 28)); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x974); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x40/ 0x4c[24:23]/ 0x974", -+ u8tmp[0], ((u32tmp[0] & 0x01800000) >> 23), u32tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x550(bcn ctrl)/0x522", -+ u32tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x49c); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0xc50(dig)/0x49c(null-drop)", -+ u32tmp[0] & 0xff, u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); -+ u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); -+ -+ fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) -+ >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + \ -+ ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & -+ 0xffff) ; -+ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "OFDM-CCA/OFDM-FA/CCK-FA", -+ u32tmp[0] & 0xffff, fa_of_dm, fa_cck); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_OK CCK/11g/11n/11n-Agg", -+ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, -+ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_Err CCK/11g/11n/11n-Agg", -+ coex_sta->crc_err_cck, coex_sta->crc_err_11g, -+ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(high-pri rx/tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(low-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+#if (BT_AUTO_REPORT_ONLY_8821A_2ANT == 1) -+ /* halbtc8821a2ant_monitor_bt_ctr(btcoexist); */ -+#endif -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void ex_halbtc8821a2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ halbtc8821a2ant_wifi_off_hw_cfg(btcoexist); -+ halbtc8821a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ halbtc8821a2ant_coex_all_off(btcoexist); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = false; -+ halbtc8821a2ant_init_hw_config(btcoexist, false); -+ halbtc8821a2ant_init_coex_dm(btcoexist); -+ halbtc8821a2ant_query_bt_info(btcoexist); -+ } -+} -+ -+void ex_halbtc8821a2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ } -+} -+ -+void ex_halbtc8821a2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 u8tmpa, u8tmpb; -+ -+ u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); -+ u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); -+ -+ if (BTC_SCAN_START == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ } else if (BTC_SCAN_FINISH == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], 0x765=0x%x, 0x76e=0x%x\n", u8tmpa, -+ u8tmpb); -+ BTC_TRACE(trace_buf); -+} -+ -+void ex_halbtc8821a2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (BTC_ASSOCIATE_START == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ } else if (BTC_ASSOCIATE_FINISH == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8821a2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ u8 ap_num = 0; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ h2c_parameter[0] = 0x1; -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else { -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &ap_num); -+ if (ap_num < 10) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -+} -+ -+void ex_halbtc8821a2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (type == BTC_PACKET_DHCP) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], DHCP Packet notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8821a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source = 0; -+ boolean bt_busy = false, limited_dig = false; -+ boolean wifi_connected = false, wifi_under_5g = false; -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8821A_2ANT_MAX) -+ rsp_source = BT_INFO_SRC_8821A_2ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), return for Manual CTRL<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ /* if 0xff, it means BT is under WHCK test */ -+ if (bt_info == 0xff) -+ coex_sta->bt_whck_test = true; -+ else -+ coex_sta->bt_whck_test = false; -+ -+ if (BT_INFO_SRC_8821A_2ANT_WIFI_FW != rsp_source) { -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; -+ -+ coex_sta->bt_rssi = -+ coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+ coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] -+ & 0x40); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, -+ &coex_sta->bt_tx_rx_mask); -+ if (coex_sta->bt_tx_rx_mask) { -+ /* BT into is responded by BT FW and BT RF REG 0x3C != 0x01 => Need to switch BT TRx Mask */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x01\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, -+ 0x3c, 0x01); -+ } -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ if ((coex_sta->bt_info_ext & BIT(1))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ if (wifi_connected) -+ ex_halbtc8821a2ant_media_status_notify( -+ btcoexist, BTC_MEDIA_CONNECT); -+ else -+ ex_halbtc8821a2ant_media_status_notify( -+ btcoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ -+ if (!btcoexist->manual_control && !wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info = 0x%x!!\n", -+ coex_sta->bt_info_ext); -+ BTC_TRACE(trace_buf); -+ if ((coex_sta->bt_info_ext & BIT(3))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3=1, wifi_connected=%d\n", -+ wifi_connected); -+ BTC_TRACE(trace_buf); -+ if (wifi_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_ignore_wlan_act( -+ btcoexist, FORCE_EXEC, false); -+ } -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3=0, wifi_connected=%d\n", -+ wifi_connected); -+ BTC_TRACE(trace_buf); -+ /* BT already NOT ignore Wlan active, do nothing here. */ -+ if (!wifi_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_ignore_wlan_act( -+ btcoexist, FORCE_EXEC, true); -+ } -+ } -+ } -+ -+#if (BT_AUTO_REPORT_ONLY_8821A_2ANT == 0) -+ if ((coex_sta->bt_info_ext & BIT(4))) { -+ /* BT auto report already enabled, do nothing */ -+ } else -+ halbtc8821a2ant_bt_auto_report(btcoexist, FORCE_EXEC, -+ true); -+#endif -+ } -+ -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (bt_info & BT_INFO_8821A_2ANT_B_INQ_PAGE) -+ coex_sta->c2h_bt_inquiry_page = true; -+ else -+ coex_sta->c2h_bt_inquiry_page = false; -+ -+ /* set link exist status */ -+ if (!(bt_info & BT_INFO_8821A_2ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (bt_info & BT_INFO_8821A_2ANT_B_FTP) -+ coex_sta->pan_exist = true; -+ else -+ coex_sta->pan_exist = false; -+ if (bt_info & BT_INFO_8821A_2ANT_B_A2DP) -+ coex_sta->a2dp_exist = true; -+ else -+ coex_sta->a2dp_exist = false; -+ if (bt_info & BT_INFO_8821A_2ANT_B_HID) -+ coex_sta->hid_exist = true; -+ else -+ coex_sta->hid_exist = false; -+ if (bt_info & BT_INFO_8821A_2ANT_B_SCO_ESCO) -+ coex_sta->sco_exist = true; -+ else -+ coex_sta->sco_exist = false; -+ -+ if ((coex_sta->hid_exist == false) && -+ (coex_sta->c2h_bt_inquiry_page == false) && -+ (coex_sta->sco_exist == false)) { -+ if (coex_sta->high_priority_tx + -+ coex_sta->high_priority_rx >= 160) -+ coex_sta->hid_exist = true; -+ } -+ } -+ -+ halbtc8821a2ant_update_bt_link_info(btcoexist); -+ -+ if (!(bt_info & BT_INFO_8821A_2ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info == -+ BT_INFO_8821A_2ANT_B_CONNECTION) { /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if ((bt_info & BT_INFO_8821A_2ANT_B_SCO_ESCO) || -+ (bt_info & BT_INFO_8821A_2ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8821A_2ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info & BT_INFO_8821A_2ANT_B_ACL_BUSY) { -+ coex_dm->bt_status = BT_8821A_2ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_dm->bt_status = BT_8821A_2ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if ((BT_8821A_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8821A_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8821A_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { -+ bt_busy = true; -+ limited_dig = true; -+ } else { -+ bt_busy = false; -+ limited_dig = false; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ coex_dm->limited_dig = limited_dig; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); -+ -+ halbtc8821a2ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8821a2ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821a2ant_wifi_off_hw_cfg(btcoexist); -+ /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ -+ /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT goto standby while GNT_BT 1-->0 */ -+ halbtc8821a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ -+ ex_halbtc8821a2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+} -+ -+void ex_halbtc8821a2ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_WIFI_PNP_SLEEP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_init_hw_config(btcoexist, false); -+ halbtc8821a2ant_init_coex_dm(btcoexist); -+ halbtc8821a2ant_query_bt_info(btcoexist); -+ } -+} -+ -+void ex_halbtc8821a2ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ==========================Periodical===========================\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (coex_sta->dis_ver_info_cnt <= 5) { -+ coex_sta->dis_ver_info_cnt += 1; -+ if (coex_sta->dis_ver_info_cnt == 3) { -+ /* Antenna config to set 0x765 = 0x0 (GNT_BT control by PTA) after initial */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Set GNT_BT control by PTA\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821a2ant_set_ant_path(btcoexist, -+ BTC_ANT_WIFI_AT_MAIN, false, false); -+ } -+ } -+ -+#if (BT_AUTO_REPORT_ONLY_8821A_2ANT == 0) -+ halbtc8821a2ant_query_bt_info(btcoexist); -+ halbtc8821a2ant_monitor_bt_enable_disable(btcoexist); -+#else -+ halbtc8821a2ant_monitor_bt_ctr(btcoexist); -+ halbtc8821a2ant_monitor_wifi_ctr(btcoexist); -+ -+ if (halbtc8821a2ant_is_wifi_status_changed(btcoexist) || -+ coex_dm->auto_tdma_adjust) -+ halbtc8821a2ant_run_coexist_mechanism(btcoexist); -+#endif -+} -+ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -\ Ingen nyrad vid filslut -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821a2Ant.h 2018-02-11 21:44:27.147146086 +0200 -@@ -0,0 +1,205 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821A_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8821A 2Ant BT Co-exist definition -+ * ******************************************* */ -+#define BT_AUTO_REPORT_ONLY_8821A_2ANT 1 -+ -+ -+#define BT_INFO_8821A_2ANT_B_FTP BIT(7) -+#define BT_INFO_8821A_2ANT_B_A2DP BIT(6) -+#define BT_INFO_8821A_2ANT_B_HID BIT(5) -+#define BT_INFO_8821A_2ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8821A_2ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8821A_2ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8821A_2ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8821A_2ANT_B_CONNECTION BIT(0) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT 2 -+ -+ -+#define BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES 42 /* WiFi RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation */ -+#define BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES 46 /* BT RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation */ -+ -+enum bt_info_src_8821a_2ant { -+ BT_INFO_SRC_8821A_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8821A_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8821A_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8821A_2ANT_MAX -+}; -+ -+enum bt_8821a_2ant_bt_status { -+ BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8821A_2ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8821A_2ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8821A_2ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8821A_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8821A_2ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8821a_2ant_coex_algo { -+ BT_8821A_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8821A_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8821A_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8821A_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8821A_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8821A_2ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8821A_2ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8821A_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8821A_2ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8821A_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8821A_2ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8821A_2ANT_COEX_ALGO_MAX = 0xb, -+}; -+ -+struct coex_dm_8821a_2ant { -+ /* fw mechanism */ -+ u8 pre_bt_dec_pwr_lvl; -+ u8 cur_bt_dec_pwr_lvl; -+ u8 pre_fw_dac_swing_lvl; -+ u8 cur_fw_dac_swing_lvl; -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean reset_tdma_adjust; -+ boolean auto_tdma_adjust; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ -+ /* sw mechanism */ -+ boolean pre_rf_rx_lpf_shrink; -+ boolean cur_rf_rx_lpf_shrink; -+ u32 bt_rf_0x1e_backup; -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ boolean pre_dac_swing_on; -+ u32 pre_dac_swing_lvl; -+ boolean cur_dac_swing_on; -+ u32 cur_dac_swing_lvl; -+ boolean pre_adc_back_off; -+ boolean cur_adc_back_off; -+ boolean pre_agc_table_en; -+ boolean cur_agc_table_en; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ boolean need_recover0x948; -+ u32 backup0x948; -+ -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+}; -+ -+struct coex_sta_8821a_2ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ u8 bt_rssi; -+ boolean bt_tx_rx_mask; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8821A_2ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8821A_2ANT_MAX]; -+ boolean bt_whck_test; -+ boolean c2h_bt_inquiry_page; -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ -+ u32 crc_ok_cck; -+ u32 crc_ok_11g; -+ u32 crc_ok_11n; -+ u32 crc_ok_11n_agg; -+ -+ u32 crc_err_cck; -+ u32 crc_err_11g; -+ u32 crc_err_11n; -+ u32 crc_err_11n_agg; -+ -+ u8 coex_table_type; -+ boolean force_lps_on; -+ -+ u8 dis_ver_info_cnt; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8821a2ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821a2ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821a2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8821a2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821a2ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821a2ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821a2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821a2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821a2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821a2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8821a2ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821a2ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8821a2ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821a2ant_display_coex_info(IN struct btc_coexist *btcoexist); -+ -+#else -+#define ex_halbtc8821a2ant_power_on_setting(btcoexist) -+#define ex_halbtc8821a2ant_pre_load_firmware(btcoexist) -+#define ex_halbtc8821a2ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8821a2ant_init_coex_dm(btcoexist) -+#define ex_halbtc8821a2ant_ips_notify(btcoexist, type) -+#define ex_halbtc8821a2ant_lps_notify(btcoexist, type) -+#define ex_halbtc8821a2ant_scan_notify(btcoexist, type) -+#define ex_halbtc8821a2ant_connect_notify(btcoexist, type) -+#define ex_halbtc8821a2ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8821a2ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8821a2ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8821a2ant_halt_notify(btcoexist) -+#define ex_halbtc8821a2ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8821a2ant_periodical(btcoexist) -+#define ex_halbtc8821a2ant_display_coex_info(btcoexist) -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.c 2018-02-11 21:44:27.147146086 +0200 -@@ -0,0 +1,3997 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8821A_CSR_CSR Co-exist mechanism -+ * -+ * History -+ * 2012/08/22 Cosa first check in. -+ * 2012/11/14 Cosa Revise for 8821A_CSR 2Ant out sourcing. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821A_SUPPORT == 1) -+ -+#define _BTCOEX_CSR 1 -+ -+#ifndef rtw_warn_on_8821acsr2ant -+#define rtw_warn_on_8821acsr2ant(condition) do {} while (0) -+#endif -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8821a_csr_2ant glcoex_dm_8821a_csr_2ant; -+static struct coex_dm_8821a_csr_2ant *coex_dm = &glcoex_dm_8821a_csr_2ant; -+static struct coex_sta_8821a_csr_2ant glcoex_sta_8821a_csr_2ant; -+static struct coex_sta_8821a_csr_2ant *coex_sta = &glcoex_sta_8821a_csr_2ant; -+ -+const char *const glbt_info_src_8821a_csr_2ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8821a_csr_2ant = 20140901; -+u32 glcoex_ver_8821a_csr_2ant = 0x51; -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8821aCsr2ant_ -+ * ************************************************************ */ -+u8 halbtc8821aCsr2ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, -+ u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_bt_rssi_state; -+ } -+ -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8821aCsr2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_wifi_rssi_state[index]; -+ } -+ -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8821aCsr2ant_monitor_bt_enable_disable(IN struct btc_coexist -+ *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ -+ /* This function check if bt is disabled */ -+ -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ bt_disable_cnt++; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], bt all counters=0, %d times!!\n", -+ bt_disable_cnt); -+ BTC_TRACE(trace_buf); -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ if (!bt_disabled) { -+ } else { -+ } -+ } -+} -+ -+void halbtc8821aCsr2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); -+ BTC_TRACE(trace_buf); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", -+ reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); -+ BTC_TRACE(trace_buf); -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x5d); -+} -+ -+void halbtc8821aCsr2ant_update_ra_mask(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 dis_rate_mask) -+{ -+ coex_dm->cur_ra_mask = dis_rate_mask; -+ -+ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, -+ &coex_dm->cur_ra_mask); -+ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -+} -+ -+void halbtc8821aCsr2ant_auto_rate_fallback_retry(IN struct btc_coexist -+ *btcoexist, IN boolean force_exec, IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ coex_dm->cur_arfr_type = type; -+ -+ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { -+ switch (coex_dm->cur_arfr_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_4byte(btcoexist, 0x430, -+ coex_dm->backup_arfr_cnt1); -+ btcoexist->btc_write_4byte(btcoexist, 0x434, -+ coex_dm->backup_arfr_cnt2); -+ break; -+ case 1: -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x01010101); -+ } else { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -+} -+ -+void halbtc8821aCsr2ant_retry_limit(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_retry_limit_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_retry_limit_type != -+ coex_dm->cur_retry_limit_type)) { -+ switch (coex_dm->cur_retry_limit_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ coex_dm->backup_retry_limit); -+ break; -+ case 1: /* retry limit=8 */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -+} -+ -+void halbtc8821aCsr2ant_ampdu_max_time(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_ampdu_time_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { -+ switch (coex_dm->cur_ampdu_time_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ coex_dm->backup_ampdu_max_time); -+ break; -+ case 1: /* AMPDU timw = 0x38 * 32us */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ 0x38); -+ break; -+ case 2: -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ 0x17); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -+} -+ -+void halbtc8821aCsr2Ant_AmpduMaxNum(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_ampdu_num_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_ampdu_num_type != coex_dm->cur_ampdu_num_type)) { -+ switch (coex_dm->cur_ampdu_num_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_2byte(btcoexist, 0x4ca, -+ coex_dm->backup_ampdu_max_num); -+ break; -+ case 1: -+ btcoexist->btc_write_2byte(btcoexist, 0x4ca, -+ 0x0808); -+ break; -+ case 2: -+ btcoexist->btc_write_2byte(btcoexist, 0x4ca, -+ 0x1f1f); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_ampdu_num_type = coex_dm->cur_ampdu_num_type; -+ -+} -+ -+void halbtc8821aCsr2ant_limited_tx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, -+ IN u8 retry_limit_type, IN u8 ampdu_time_type, IN u8 ampdu_num_type) -+{ -+ switch (ra_mask_type) { -+ case 0: /* normal mode */ -+ halbtc8821aCsr2ant_update_ra_mask(btcoexist, force_exec, -+ 0x0); -+ break; -+ case 1: /* disable cck 1/2 */ -+ halbtc8821aCsr2ant_update_ra_mask(btcoexist, force_exec, -+ 0x00000003); -+ break; -+ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ -+ halbtc8821aCsr2ant_update_ra_mask(btcoexist, force_exec, -+ 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8821aCsr2ant_auto_rate_fallback_retry(btcoexist, force_exec, -+ arfr_type); -+ halbtc8821aCsr2ant_retry_limit(btcoexist, force_exec, retry_limit_type); -+ halbtc8821aCsr2ant_ampdu_max_time(btcoexist, force_exec, -+ ampdu_time_type); -+ halbtc8821aCsr2Ant_AmpduMaxNum(btcoexist, force_exec, ampdu_num_type); -+} -+ -+ -+ -+void halbtc8821aCsr2ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+} -+ -+void halbtc8821aCsr2ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ coex_sta->c2h_bt_info_req_sent = true; -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ rtw_warn_on_8821acsr2ant(_BTCOEX_CSR); -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+} -+ -+u8 halbtc8821aCsr2ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_stack_info *stack_info = &btcoexist->stack_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ /* sync StackInfo with BT firmware and stack */ -+ stack_info->hid_exist = coex_sta->hid_exist; -+ stack_info->bt_link_exist = coex_sta->bt_link_exist; -+ stack_info->sco_exist = coex_sta->sco_exist; -+ stack_info->pan_exist = coex_sta->pan_exist; -+ stack_info->a2dp_exist = coex_sta->a2dp_exist; -+ -+ if (!stack_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No profile exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (stack_info->sco_exist) -+ num_of_diff_profile++; -+ if (stack_info->hid_exist) -+ num_of_diff_profile++; -+ if (stack_info->pan_exist) -+ num_of_diff_profile++; -+ if (stack_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 1) { -+ if (stack_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_SCO; -+ } else { -+ if (stack_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_HID; -+ } else if (stack_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_A2DP; -+ } else if (stack_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (stack_info->sco_exist) { -+ if (stack_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if (stack_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if (stack_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (stack_info->hid_exist && -+ stack_info->a2dp_exist) { -+ if (stack_info->num_of_hid >= 2) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID*2 + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } else if (stack_info->hid_exist && -+ stack_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (stack_info->pan_exist && -+ stack_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (stack_info->sco_exist) { -+ if (stack_info->hid_exist && -+ stack_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } else if (stack_info->hid_exist && -+ stack_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (stack_info->pan_exist && -+ stack_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (stack_info->hid_exist && -+ stack_info->pan_exist && -+ stack_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (stack_info->sco_exist) { -+ if (stack_info->hid_exist && -+ stack_info->pan_exist && -+ stack_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+boolean halbtc8821aCsr2ant_need_to_dec_bt_pwr(IN struct btc_coexist *btcoexist) -+{ -+ boolean ret = false; -+ boolean bt_hs_on = false, wifi_connected = false; -+ s32 bt_hs_rssi = 0; -+ u8 bt_rssi_state; -+ -+ if (!btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on)) -+ return false; -+ if (!btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected)) -+ return false; -+ if (!btcoexist->btc_get(btcoexist, BTC_GET_S4_HS_RSSI, &bt_hs_rssi)) -+ return false; -+ -+ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); -+ -+ if (wifi_connected) { -+ if (bt_hs_on) { -+ if (bt_hs_rssi > 37) -+ ret = true; -+ } else { -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ ret = true; -+ } -+ } -+ -+ return ret; -+} -+ -+void halbtc8821aCsr2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, -+ IN u8 dac_swing_lvl) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ /* There are several type of dacswing */ -+ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ -+ h2c_parameter[0] = dac_swing_lvl; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); -+} -+ -+void halbtc8821aCsr2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN boolean dec_bt_pwr) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (dec_bt_pwr) -+ h2c_parameter[0] |= BIT(1); -+ -+ rtw_warn_on_8821acsr2ant(_BTCOEX_CSR); -+ btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); -+} -+ -+void halbtc8821aCsr2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean dec_bt_pwr) -+{ -+ coex_dm->cur_dec_bt_pwr = dec_bt_pwr; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_dec_bt_pwr == coex_dm->cur_dec_bt_pwr) -+ return; -+ } -+ -+ /* TODO: may CSR consider to decrease BT power? */ -+ /* halbtc8821aCsr2ant_set_fw_dec_bt_pwr(btcoexist, coex_dm->cur_dec_bt_pwr); */ -+ -+ coex_dm->pre_dec_bt_pwr = coex_dm->cur_dec_bt_pwr; -+} -+ -+void halbtc8821aCsr2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ rtw_warn_on_8821acsr2ant(_BTCOEX_CSR); -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8821aCsr2ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ /* halbtc8821aCsr2ant_set_bt_auto_report(btcoexist, coex_dm->cur_bt_auto_report); */ -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8821aCsr2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 fw_dac_swing_lvl) -+{ -+ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_fw_dac_swing_lvl == -+ coex_dm->cur_fw_dac_swing_lvl) -+ return; -+ } -+ -+ halbtc8821aCsr2ant_set_fw_dac_swing_level(btcoexist, -+ coex_dm->cur_fw_dac_swing_lvl); -+ -+ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; -+} -+ -+void halbtc8821aCsr2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist -+ *btcoexist, IN boolean rx_rf_shrink_on) -+{ -+ if (rx_rf_shrink_on) { -+ /* Shrink RF Rx LPF corner */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Shrink RF Rx LPF corner!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, -+ 0xffffc); -+ } else { -+ /* Resume RF Rx LPF corner */ -+ /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ -+ if (btcoexist->initilized) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Resume RF Rx LPF corner!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, -+ 0xfffff, coex_dm->bt_rf_0x1e_backup); -+ } -+ } -+} -+ -+void halbtc8821aCsr2ant_rf_shrink(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rx_rf_shrink_on) -+{ -+ coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_rf_rx_lpf_shrink == -+ coex_dm->cur_rf_rx_lpf_shrink) -+ return; -+ } -+ halbtc8821aCsr2ant_set_sw_rf_rx_lpf_corner(btcoexist, -+ coex_dm->cur_rf_rx_lpf_shrink); -+ -+ coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; -+} -+ -+void halbtc8821aCsr2ant_set_sw_penalty_tx_rate_adaptive( -+ IN struct btc_coexist *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ -+ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+} -+ -+void halbtc8821aCsr2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8821aCsr2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8821aCsr2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, -+ IN u32 level) -+{ -+ u8 val = (u8)level; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Write SwDacSwing = 0x%x\n", level); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc5b, 0x3e, val); -+} -+ -+void halbtc8821aCsr2ant_set_sw_full_time_dac_swing(IN struct btc_coexist -+ *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) -+{ -+ if (sw_dac_swing_on) -+ halbtc8821aCsr2ant_set_dac_swing_reg(btcoexist, -+ sw_dac_swing_lvl); -+ else -+ halbtc8821aCsr2ant_set_dac_swing_reg(btcoexist, 0x18); -+} -+ -+ -+void halbtc8821aCsr2ant_dac_swing(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) -+{ -+ coex_dm->cur_dac_swing_on = dac_swing_on; -+ coex_dm->cur_dac_swing_lvl = dac_swing_lvl; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && -+ (coex_dm->pre_dac_swing_lvl == -+ coex_dm->cur_dac_swing_lvl)) -+ return; -+ } -+ delay_ms(30); -+ halbtc8821aCsr2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, -+ dac_swing_lvl); -+ -+ coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; -+ coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; -+} -+ -+void halbtc8821aCsr2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, -+ IN boolean adc_back_off) -+{ -+ if (adc_back_off) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB BackOff Level On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x3); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BB BackOff Level Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x1); -+ } -+} -+ -+void halbtc8821aCsr2ant_adc_back_off(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean adc_back_off) -+{ -+ coex_dm->cur_adc_back_off = adc_back_off; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) -+ return; -+ } -+ halbtc8821aCsr2ant_set_adc_back_off(btcoexist, -+ coex_dm->cur_adc_back_off); -+ -+ coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; -+} -+ -+void halbtc8821aCsr2ant_set_agc_table(IN struct btc_coexist *btcoexist, -+ IN boolean agc_table_en) -+{ -+ u8 rssi_adjust_val = 0; -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); -+ if (agc_table_en) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Agc Table On!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x28F4B); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x10AB2); -+ rssi_adjust_val = 8; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Agc Table Off!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x2884B); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, -+ 0x104B2); -+ } -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); -+ -+ /* set rssi_adjust_val for wifi module. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, -+ &rssi_adjust_val); -+} -+ -+void halbtc8821aCsr2ant_agc_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean agc_table_en) -+{ -+ coex_dm->cur_agc_table_en = agc_table_en; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) -+ return; -+ } -+ halbtc8821aCsr2ant_set_agc_table(btcoexist, agc_table_en); -+ -+ coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; -+} -+ -+void halbtc8821aCsr2ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8821aCsr2ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8821aCsr2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, -+ val0x6c8, val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8821aCsr2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ rtw_warn_on_8821acsr2ant(_BTCOEX_CSR); -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8821aCsr2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ /* halbtc8821aCsr2ant_set_fw_ignore_wlan_act(btcoexist, enable); */ -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8821aCsr2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = byte5; -+ h2c_parameter[5] = 0x01; -+ -+ coex_dm->ps_tdma_para[0] = byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = byte5; -+ coex_dm->ps_tdma_para[5] = 0x01; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 6, h2c_parameter); -+} -+ -+void halbtc8821aCsr2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, -+ IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, -+ IN boolean limited_dig, IN boolean bt_lna_constrain) -+{ -+ u32 wifi_bw; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_HT40 != wifi_bw) { /* only shrink RF Rx LPF for HT40 */ -+ if (shrink_rx_lpf) -+ shrink_rx_lpf = false; -+ } -+ -+ halbtc8821aCsr2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); -+ halbtc8821aCsr2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, -+ low_penalty_ra); -+ -+ /* no limited DIG */ -+ /* halbtc8821aCsr2ant_setBtLnaConstrain(btcoexist, NORMAL_EXEC, bt_lna_constrain); */ -+} -+ -+void halbtc8821aCsr2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, -+ IN boolean agc_table_shift, IN boolean adc_back_off, -+ IN boolean sw_dac_swing, IN u32 dac_swing_lvl) -+{ -+ /* halbtc8821aCsr2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ -+ halbtc8821aCsr2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); -+ halbtc8821aCsr2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, -+ dac_swing_lvl); -+} -+ -+void halbtc8821aCsr2ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u32 u32tmp = 0; -+ u8 h2c_parameter[2] = {0}; -+ -+ if (init_hwcfg) { -+ /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp &= ~BIT(23); -+ u32tmp |= BIT(24); -+ btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x974, 0x3ff); -+ btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); -+ -+ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { -+ /* tell firmware "antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ -+ h2c_parameter[0] = 1; -+ h2c_parameter[1] = 1; -+ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, -+ h2c_parameter); -+ } else { -+ /* tell firmware "no antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ -+ h2c_parameter[0] = 0; -+ h2c_parameter[1] = 1; -+ btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, -+ h2c_parameter); -+ } -+ } -+ -+ /* ext switch setting */ -+ switch (ant_pos_type) { -+ case BTC_ANT_WIFI_AT_MAIN: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, -+ 0x30, 0x1); -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, -+ 0x30, 0x2); -+ break; -+ } -+} -+ -+void halbtc8821aCsr2ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ if (turn_on) { -+ switch (type) { -+ case 1: -+ default: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ case 2: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x12, 0x12, 0xe1, 0x90); -+ break; -+ case 3: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x1c, 0x3, 0xf1, 0x90); -+ break; -+ case 4: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x10, 0x03, 0xf1, 0x90); -+ break; -+ case 5: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x1a, 0x1a, 0x60, 0x90); -+ break; -+ case 6: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x12, 0x12, 0x60, 0x90); -+ break; -+ case 7: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x1c, 0x3, 0x70, 0x90); -+ break; -+ case 8: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xa3, 0x10, 0x3, 0x70, 0x90); -+ break; -+ case 9: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ case 10: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x12, 0x12, 0xe1, 0x90); -+ break; -+ case 11: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0xa, 0xa, 0xe1, 0x90); -+ break; -+ case 12: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 13: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x1a, 0x1a, 0x60, 0x90); -+ break; -+ case 14: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x12, 0x12, 0x60, 0x90); -+ break; -+ case 15: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0xa, 0xa, 0x60, 0x90); -+ break; -+ case 16: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x5, 0x5, 0x60, 0x90); -+ break; -+ case 17: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xa3, 0x2f, 0x2f, 0x60, 0x90); -+ break; -+ case 18: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x5, 0x5, 0xe1, 0x90); -+ break; -+ case 19: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x25, 0x25, 0xe1, 0x90); -+ break; -+ case 20: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x25, 0x25, 0x60, 0x90); -+ break; -+ case 21: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x15, 0x03, 0x70, 0x90); -+ break; -+ case 22: /* ad2dp master */ -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xeb, 0x11, 0x11, 0x21, 0x10); -+ break; -+ case 23: /* a2dp slave */ -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xeb, 0x12, 0x12, 0x20, 0x10); -+ break; -+ case 71: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x1a, 0x1a, 0xe1, 0x90); -+ break; -+ } -+ } else { -+ /* disable PS tdma */ -+ switch (type) { -+ case 0: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x40, 0x0); -+ break; -+ case 1: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x48, 0x0); -+ break; -+ default: -+ halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x40, 0x0); -+ break; -+ } -+ } -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+void halbtc8821aCsr2ant_coex_all_off(IN struct btc_coexist *btcoexist) -+{ -+ /* fw all off */ -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ /* sw all off */ -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ /* hw all off */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55555555, -+ 0x55555555, 0xffff, 0x3); -+} -+ -+void halbtc8821aCsr2ant_coex_under_5g(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821aCsr2ant_coex_all_off(btcoexist); -+ -+ halbtc8821aCsr2ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); -+} -+ -+void halbtc8821aCsr2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, FORCE_EXEC, 0x55555555, -+ 0x55555555, 0xffff, 0x3); -+ -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, false); -+ -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+void halbtc8821aCsr2ant_bt_inquiry_page(IN struct btc_coexist *btcoexist) -+{ -+ boolean low_pwr_disable = true; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55ff55ff, -+ 0x5afa5afa, 0xffff, 0x3); -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -+} -+boolean halbtc8821aCsr2ant_is_common_action(IN struct btc_coexist *btcoexist) -+{ -+ boolean common = false, wifi_connected = false, wifi_busy = false; -+ boolean low_pwr_disable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!wifi_connected && -+ BT_8821A_CSR_2ANT_BT_STATUS_IDLE == coex_dm->bt_status) { -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi IPS + BT IPS!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, -+ 0x18); -+ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, -+ 0, 0); -+ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8821A_CSR_2ANT_BT_STATUS_IDLE == -+ coex_dm->bt_status)) { -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Busy + BT IPS!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ false, 1); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi LPS + BT IPS!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ false, 1); -+ } -+ -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, -+ 0x18); -+ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, -+ 0, 0); -+ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi IPS + BT LPS!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, -+ 0x18); -+ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, -+ 0, 0); -+ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Busy + BT LPS!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ false, 1); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi LPS + BT LPS!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ false, 1); -+ } -+ -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, true, -+ true); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, -+ 0x18); -+ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, -+ 0, 0); -+ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE == -+ coex_dm->bt_status)) { -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi IPS + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); */ -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, -+ false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, -+ 0x18); -+ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, -+ 0, 0); -+ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); -+ -+ common = true; -+ } else { -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Busy + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ common = false; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi LPS + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 21); -+ -+ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, -+ NORMAL_EXEC, true); -+ else -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, -+ NORMAL_EXEC, false); -+ -+ common = true; -+ } -+ -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, true, -+ true); -+ } -+ -+ if (common == true) -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); -+ -+ return common; -+} -+void halbtc8821aCsr2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, -+ IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) -+{ -+ static s32 up, dn, m, n, wait_count; -+ s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ -+ u8 retry_count = 0; -+ -+ if (coex_dm->reset_tdma_adjust) { -+ coex_dm->reset_tdma_adjust = false; -+ { -+ if (sco_hid) { -+ if (tx_pause) { -+ if (max_interval == 1) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 13); -+ coex_dm->ps_tdma_du_adj_type = -+ 13; -+ } else if (max_interval == 2) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (max_interval == 3) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } -+ } else { -+ if (max_interval == 1) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = -+ 9; -+ } else if (max_interval == 2) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (max_interval == 3) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } -+ } -+ } else { -+ if (tx_pause) { -+ if (max_interval == 1) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 5); -+ coex_dm->ps_tdma_du_adj_type = -+ 5; -+ } else if (max_interval == 2) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (max_interval == 3) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } -+ } else { -+ if (max_interval == 1) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (max_interval == 2) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (max_interval == 3) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } -+ } -+ } -+ } -+ /* ============ */ -+ up = 0; -+ dn = 0; -+ m = 1; -+ n = 3; -+ result = 0; -+ wait_count = 0; -+ } else { -+ /* accquire the BT TRx retry count from BT_Info byte2 */ -+ retry_count = coex_sta->bt_retry_cnt; -+ result = 0; -+ wait_count++; -+ -+ if (retry_count == -+ 0) { /* no retry in the last 2-second duration */ -+ up++; -+ dn--; -+ -+ if (dn <= 0) -+ dn = 0; -+ -+ if (up >= n) { /* if ³sÄò n ­Ó2¬í retry count¬°0, «h½Õ¼eWiFi duration */ -+ wait_count = 0; -+ n = 3; -+ up = 0; -+ dn = 0; -+ result = 1; -+ } -+ } else if (retry_count <= -+ 3) { /* <=3 retry in the last 2-second duration */ -+ up--; -+ dn++; -+ -+ if (up <= 0) -+ up = 0; -+ -+ if (dn == 2) { /* if ³sÄò 2 ­Ó2¬í retry count< 3, «h½Õ¯¶WiFi duration */ -+ if (wait_count <= 2) -+ m++; /* ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ } else { /* retry count > 3, ¥u­n1¦¸ retry count > 3, «h½Õ¯¶WiFi duration */ -+ if (wait_count == 1) -+ m++; /* ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ */ -+ else -+ m = 1; -+ -+ if (m >= 20) /* m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. */ -+ m = 20; -+ -+ n = 3 * m; -+ up = 0; -+ dn = 0; -+ wait_count = 0; -+ result = -1; -+ } -+ -+ if (max_interval == 1) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 71) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 5); -+ coex_dm->ps_tdma_du_adj_type = 5; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 5); -+ coex_dm->ps_tdma_du_adj_type = 5; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 13); -+ coex_dm->ps_tdma_du_adj_type = 13; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 5); -+ coex_dm->ps_tdma_du_adj_type = -+ 5; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 13); -+ coex_dm->ps_tdma_du_adj_type = -+ 13; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 71); -+ coex_dm->ps_tdma_du_adj_type = 71; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 9); -+ coex_dm->ps_tdma_du_adj_type = 9; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 71) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 1); -+ coex_dm->ps_tdma_du_adj_type = -+ 1; -+ } else if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 71); -+ coex_dm->ps_tdma_du_adj_type = -+ 71; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 9); -+ coex_dm->ps_tdma_du_adj_type = -+ 9; -+ } -+ } -+ } -+ } else if (max_interval == 2) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 6); -+ coex_dm->ps_tdma_du_adj_type = 6; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 14); -+ coex_dm->ps_tdma_du_adj_type = 14; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 6); -+ coex_dm->ps_tdma_du_adj_type = -+ 6; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 14); -+ coex_dm->ps_tdma_du_adj_type = -+ 14; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 2); -+ coex_dm->ps_tdma_du_adj_type = 2; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 10); -+ coex_dm->ps_tdma_du_adj_type = 10; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 2); -+ coex_dm->ps_tdma_du_adj_type = -+ 2; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 10); -+ coex_dm->ps_tdma_du_adj_type = -+ 10; -+ } -+ } -+ } -+ } else if (max_interval == 3) { -+ if (tx_pause) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 7); -+ coex_dm->ps_tdma_du_adj_type = 7; -+ } else if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 8); -+ coex_dm->ps_tdma_du_adj_type = 8; -+ } -+ if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 15); -+ coex_dm->ps_tdma_du_adj_type = 15; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 16); -+ coex_dm->ps_tdma_du_adj_type = 16; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 8); -+ coex_dm->ps_tdma_du_adj_type = -+ 8; -+ } else if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 16); -+ coex_dm->ps_tdma_du_adj_type = -+ 16; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 7); -+ coex_dm->ps_tdma_du_adj_type = -+ 7; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 15); -+ coex_dm->ps_tdma_du_adj_type = -+ 15; -+ } -+ } -+ } else { -+ if (coex_dm->cur_ps_tdma == 5) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 6) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 7) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 3); -+ coex_dm->ps_tdma_du_adj_type = 3; -+ } else if (coex_dm->cur_ps_tdma == 8) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 4); -+ coex_dm->ps_tdma_du_adj_type = 4; -+ } -+ if (coex_dm->cur_ps_tdma == 13) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 14) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 15) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 11); -+ coex_dm->ps_tdma_du_adj_type = 11; -+ } else if (coex_dm->cur_ps_tdma == 16) { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, -+ NORMAL_EXEC, true, 12); -+ coex_dm->ps_tdma_du_adj_type = 12; -+ } -+ if (result == -1) { -+ if (coex_dm->cur_ps_tdma == 1) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 4); -+ coex_dm->ps_tdma_du_adj_type = -+ 4; -+ } else if (coex_dm->cur_ps_tdma == 9) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 12); -+ coex_dm->ps_tdma_du_adj_type = -+ 12; -+ } -+ } else if (result == 1) { -+ if (coex_dm->cur_ps_tdma == 4) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 3) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 2) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 3); -+ coex_dm->ps_tdma_du_adj_type = -+ 3; -+ } else if (coex_dm->cur_ps_tdma == 12) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 11) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } else if (coex_dm->cur_ps_tdma == 10) { -+ halbtc8821aCsr2ant_ps_tdma( -+ btcoexist, NORMAL_EXEC, -+ true, 11); -+ coex_dm->ps_tdma_du_adj_type = -+ 11; -+ } -+ } -+ } -+ } -+ } -+ -+ /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ -+ /* then we have to adjust it back to the previous record one. */ -+ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { -+ boolean scan = false, link = false, roam = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", -+ coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (!scan && !link && !roam) -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ coex_dm->ps_tdma_du_adj_type); -+ else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ /* when halbtc8821aCsr2ant_tdma_duration_adjust() is called, fw dac swing is included in the function. */ -+ /* if(coex_dm->ps_tdma_du_adj_type == 71) */ -+ /* halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc); //Skip because A2DP get worse at HT40 */ -+ /* else */ -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, -+ 0x6); -+} -+ -+/* SCO only or SCO+PAN(HS) */ -+void halbtc8821aCsr2ant_action_sco(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55555555, -+ 0x55555555, 0xffffff, 0x3); -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ halbtc8821aCsr2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, true); -+ -+ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 1, 0, 2, 0); -+ -+ if (coex_sta->slave == false) -+ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ true, 0x4); -+ else -+ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ true, 0x2); -+ -+ /* -+ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); -+ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); -+ -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 4); -+ -+ if(halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); -+ else -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) -+ { -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x5a5a5a5a, 0x5a5a5a5a, 0xffff, 0x3); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x5aea5aea, 0x5aea5aea, 0xffff, 0x3); -+ } -+ -+ if(BTC_WIFI_BW_HT40 == wifi_bw) -+ { -+ -+ -+ -+ -+ if( (bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } -+ -+ -+ if( (wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,true,true,false,false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,true,false,false,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,true,true,false,false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,false,false,false,0x18); -+ } -+ } -+ else -+ { -+ -+ -+ -+ if( (bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } -+ -+ -+ if( (wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,false,true,false,false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,true,false,false,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,false,true,false,false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,false,false,false,0x18); -+ } -+ } -+ */ -+} -+ -+ -+void halbtc8821aCsr2ant_action_hid(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, -+ 15, 0); -+ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); -+ -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); -+ else -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); -+ else /* for HID quality & wifi performance balance at 11n mode */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5aea5aea, 0xffff, 0x3); -+ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ /* fw mechanism */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 9); -+ else -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 13); -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } else { -+ /* fw mechanism */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 9); -+ else -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 13); -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ true, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ true, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } -+} -+ -+/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -+void halbtc8821aCsr2ant_action_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x8); -+ -+ if (coex_sta->slave == false) { -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0xfdfdfdfd, 0xdfdadfda, 0xffffff, 0x3); -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, -+ 0, 1); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, true, -+ 0x0c); -+ } else { -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0xfdfdfdfd, 0xdfdadfda, 0xffffff, 0x3); -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); -+ halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, -+ 0, 2); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, true, -+ 0x18); -+ } -+ -+ /* -+ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); -+ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); -+ -+ -+ -+ -+ -+ if(halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); -+ else -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if(BTC_WIFI_BW_HT40 == wifi_bw) -+ { -+ -+ if( (bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, false, false, 1); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, false, true, 1); -+ } -+ -+ -+ if( (wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,true,false,false,false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,true,false,false,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,true,false,false,false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,false,false,false,0x18); -+ } -+ } -+ else -+ { -+ -+ if( (bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, false, false, 1); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, false, true, 1); -+ } -+ -+ -+ if( (wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) -+ { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,false,false,false,false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,true,false,false,0x18); -+ } -+ else -+ { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist,false,false,false,false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist,false,false,false,0x18); -+ } -+ } -+ */ -+} -+ -+void halbtc8821aCsr2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state, bt_info_ext; -+ u32 wifi_bw; -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, -+ 15, 0); -+ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); -+ -+ /* fw dac swing is called in halbtc8821aCsr2ant_tdma_duration_adjust() */ -+ /* halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); */ -+ -+ -+ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); -+ else -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ /* fw mechanism */ -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, -+ false, true, 2); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, -+ false, true, 1); -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } else { -+ /* fw mechanism */ -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, -+ false, true, 2); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, -+ false, true, 1); -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } -+} -+ -+void halbtc8821aCsr2ant_action_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, -+ 15, 0); -+ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); -+ -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); -+ else -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5aff5aff, 0xffff, 0x3); -+ else /* for HID quality & wifi performance balance at 11n mode */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5aff5aff, 0xffff, 0x3); -+ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ /* fw mechanism */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 1); -+ else -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 5); -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } else { -+ /* fw mechanism */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 1); -+ else -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 5); -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } -+} -+ -+ -+/* PAN(HS) only */ -+void halbtc8821aCsr2ant_action_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, -+ 15, 0); -+ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); -+ -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ /* fw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, -+ true); -+ else -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, -+ false); -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } else { -+ /* fw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, -+ true); -+ else -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, -+ false); -+ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ false, 1); -+ else -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, -+ false, 1); -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } -+} -+ -+/* PAN(EDR)+A2DP */ -+void halbtc8821aCsr2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state, bt_info_ext; -+ u32 wifi_bw; -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, -+ 15, 0); -+ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); -+ -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); -+ else -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); -+ else /* for HID quality & wifi performance balance at 11n mode */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); -+ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ /* fw mechanism */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, false, false, 3); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, false, false, 3); -+ } else { -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, false, true, 3); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, false, true, 3); -+ } -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ }; -+ } else { -+ /* fw mechanism */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, false, false, 3); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, false, false, 3); -+ } else { -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, false, true, 3); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, false, true, 3); -+ } -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ false, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } -+} -+ -+void halbtc8821aCsr2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state; -+ u32 wifi_bw; -+ -+ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, -+ 15, 0); -+ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); -+ -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); -+ else -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5a5f5a5f, 0xffff, 0x3); -+ else /* for HID quality & wifi performance balance at 11n mode */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5a5f5a5f, 0xffff, 0x3); -+ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 3); -+ /* fw mechanism */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 10); -+ else -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 14); -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } else { -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ /* fw mechanism */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 10); -+ else -+ halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 14); -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ true, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ true, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } -+} -+ -+/* HID+A2DP+PAN(EDR) */ -+void halbtc8821aCsr2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist -+ *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state, bt_info_ext; -+ u32 wifi_bw; -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, -+ 15, 0); -+ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); -+ -+ halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ -+ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); -+ else -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); -+ else /* for HID quality & wifi performance balance at 11n mode */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); -+ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ /* fw mechanism */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 3); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 3); -+ } else { -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 3); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 3); -+ } -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } else { -+ /* fw mechanism */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, false, 3); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, false, 3); -+ } else { -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 3); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 3); -+ } -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ true, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ true, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } -+} -+ -+void halbtc8821aCsr2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ u8 wifi_rssi_state, bt_rssi_state, bt_info_ext; -+ u32 wifi_bw; -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, -+ 15, 0); -+ bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); -+ -+ if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); -+ else -+ halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_LEGACY == wifi_bw) { /* for HID at 11b/g mode */ -+ /* Allen halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5f5b5f5b, 0xffffff, 0x3); -+ } else { /* for HID quality & wifi performance balance at 11n mode */ -+ /* Allen halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, -+ 0x55ff55ff, 0x5f5b5f5b, 0xffffff, 0x3); -+ -+ } -+ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) { -+ /* fw mechanism */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 2); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 2); -+ } else { -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 2); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 2); -+ } -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, -+ false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } else { -+ /* fw mechanism */ -+ if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ if (bt_info_ext & BIT(0)) { /* a2dp basic rate */ -+ /* halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, true, false, 2); */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 2); -+ -+ } else { /* a2dp edr rate */ -+ /* Allen halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, true, false, 2); */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 2); -+ } -+ } else { -+ if (bt_info_ext & BIT(0)) /* a2dp basic rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 2); -+ else /* a2dp edr rate */ -+ halbtc8821aCsr2ant_tdma_duration_adjust( -+ btcoexist, true, true, 2); -+ } -+ -+ /* sw mechanism */ -+ if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || -+ (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ true, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, -+ false, false, 0x18); -+ } else { -+ halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, -+ true, false, false); -+ halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, -+ false, false, 0x18); -+ } -+ } -+} -+ -+void halbtc8821aCsr2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_under_5g = false; -+ u8 algorithm = 0; -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Manual control!!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ if (wifi_under_5g) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), run 5G coex setting!!<===\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_coex_under_5g(btcoexist); -+ return; -+ } -+ -+ { -+ algorithm = halbtc8821aCsr2ant_action_algorithm(btcoexist); -+ if (coex_sta->c2h_bt_inquiry_page && -+ (BT_8821A_CSR_2ANT_COEX_ALGO_PANHS != algorithm)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under inquiry/page scan !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_bt_inquiry_page(btcoexist); -+ return; -+ } -+ -+ coex_dm->cur_algorithm = algorithm; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Algorithm = %d\n", coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ -+ if (halbtc8821aCsr2ant_is_common_action(btcoexist)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant common.\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->reset_tdma_adjust = true; -+ } else { -+ if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", -+ coex_dm->pre_algorithm, -+ coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ coex_dm->reset_tdma_adjust = true; -+ } -+ switch (coex_dm->cur_algorithm) { -+ case BT_8821A_CSR_2ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_action_sco( -+ btcoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_action_hid( -+ btcoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_action_a2dp( -+ btcoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_action_a2dp_pan_hs( -+ btcoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_action_pan_edr( -+ btcoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_action_pan_hs( -+ btcoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_action_pan_edr_a2dp( -+ btcoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_action_pan_edr_hid( -+ btcoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR -+ : -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_action_hid_a2dp_pan_edr( -+ btcoexist); -+ break; -+ case BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_action_hid_a2dp( -+ btcoexist); -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_coex_all_off( -+ btcoexist); -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+ } -+} -+ -+ -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8821aCsr2ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8821aCsr2ant_ -+ * ************************************************************ */ -+void ex_halbtc8821aCsr2ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+} -+ -+void ex_halbtc8821aCsr2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 2Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (wifi_only) -+ return; -+ -+ /* if(back_up) */ -+ { -+ /* backup rf 0x1e value */ -+ coex_dm->bt_rf_0x1e_backup = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x1e, 0xfffff); -+ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, -+ 0x430); -+ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, -+ 0x434); -+ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( -+ btcoexist, 0x42a); -+ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( -+ btcoexist, 0x456); -+ coex_dm->backup_ampdu_max_num = btcoexist->btc_read_2byte( -+ btcoexist, 0x4ca); -+ } -+ -+#if 0 /* REMOVE */ -+ /* 0x790[5:0]=0x5 */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); -+ u8tmp &= 0xc0; -+ u8tmp |= 0x5; -+ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); -+#endif -+ -+ /* Antenna config */ -+ halbtc8821aCsr2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, true, -+ false); -+ -+ /* PTA parameter */ -+ halbtc8821aCsr2ant_coex_table(btcoexist, FORCE_EXEC, 0x55555555, -+ 0x55555555, 0xffff, 0x3); -+ -+ /* Enable counter statistics */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, -+ 0xc); /* 0x76e[3] =1, WLAN_Act control by PTA */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); -+ -+#if 0 /* REMOVE */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -+#endif -+} -+ -+void ex_halbtc8821aCsr2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821aCsr2ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8821aCsr2ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_stack_info *stack_info = &btcoexist->stack_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u32 u32tmp[4]; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", -+ "Ant PG number/ Ant mechanism:", -+ board_info->pg_ant_num, board_info->btdm_ant_num); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "[Action Manual control]!!"); -+ CL_PRINTF(cli_buf); -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", -+ "CoexVer/ FwVer/ PatchVer", -+ glcoex_ver_date_8821a_csr_2ant, glcoex_ver_8821a_csr_2ant, -+ fw_ver, bt_patch_ver, bt_patch_ver); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt]", -+ ((coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") : (( -+ BT_8821A_CSR_2ANT_BT_STATUS_IDLE == coex_dm->bt_status) -+ ? "idle" : ((BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE -+ == coex_dm->bt_status) ? "connected-idle" : "busy"))), -+ coex_sta->bt_rssi, coex_sta->bt_retry_cnt); -+ CL_PRINTF(cli_buf); -+ -+ if (stack_info->profile_notified) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", -+ stack_info->sco_exist, stack_info->hid_exist, -+ stack_info->pan_exist, stack_info->a2dp_exist); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_disp_dbg_msg(btcoexist, -+ BTC_DBG_DISP_BT_LINK_INFO); -+ } -+ -+ bt_info_ext = coex_sta->bt_info_ext; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "BT Info A2DP rate", -+ (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); -+ CL_PRINTF(cli_buf); -+ -+ for (i = 0; i < BT_INFO_SRC_8821A_CSR_2ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8821a_csr_2ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ /* Sw mechanism */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Sw mechanism]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", -+ "SM1[ShRf/ LpRA/ LimDig]", -+ coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, -+ coex_dm->limited_dig); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", -+ "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", -+ coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, -+ coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); -+ CL_PRINTF(cli_buf); -+ -+ /* Fw mechanism */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Fw mechanism]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (!btcoexist->manual_control) { -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", -+ "DecBtPwr/ IgnWlanAct", -+ coex_dm->cur_dec_bt_pwr, coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ } -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", -+ "RF-A, 0x1e initVal", -+ coex_dm->bt_rf_0x1e_backup); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x ", -+ "0x778 (W_Act)/ 0x6cc (CoTab Sel)", -+ u8tmp[0], u8tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x8db); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xc5b); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x8db(ADC)/0xc5b[29:25](DAC)", -+ ((u8tmp[0] & 0x60) >> 5), ((u8tmp[1] & 0x3e) >> 1)); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0xcb4[7:0](ctrl)/ 0xcb4[29:28](val)", -+ u32tmp[0] & 0xff, ((u32tmp[0] & 0x30000000) >> 28)); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x974); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x40/ 0x4c[24:23]/ 0x974", -+ u8tmp[0], ((u32tmp[0] & 0x01800000) >> 23), u32tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x550(bcn ctrl)/0x522", -+ u32tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa0a); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0xc50(DIG)/0xa0a(CCK-TH)", -+ u32tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "OFDM-FA/ CCK-FA", -+ u32tmp[0], (u8tmp[0] << 8) + u8tmp[1]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8", -+ u32tmp[0], u32tmp[1], u32tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770 (hi-pri Rx/Tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(low-pri Rx/Tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void ex_halbtc8821aCsr2ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ halbtc8821aCsr2ant_coex_all_off(btcoexist); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = false; -+ /* halbtc8821aCsr2ant_init_coex_dm(btcoexist); */ -+ } -+} -+ -+void ex_halbtc8821aCsr2ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ } -+} -+ -+void ex_halbtc8821aCsr2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (BTC_SCAN_START == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ } else if (BTC_SCAN_FINISH == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8821aCsr2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ if (BTC_ASSOCIATE_START == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ } else if (BTC_ASSOCIATE_FINISH == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8821aCsr2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ h2c_parameter[0] = 0x1; -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+} -+ -+void ex_halbtc8821aCsr2ant_specific_packet_notify(IN struct btc_coexist -+ *btcoexist, IN u8 type) -+{ -+ if (type == BTC_PACKET_DHCP) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], DHCP Packet notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8821aCsr2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source = 0; -+ boolean bt_busy = false, limited_dig = false; -+ boolean wifi_connected = false, bt_hs_on = false, -+ wifi_under_5g = false; -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8821A_CSR_2ANT_MAX) -+ rsp_source = BT_INFO_SRC_8821A_CSR_2ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (BT_INFO_SRC_8821A_CSR_2ANT_WIFI_FW != rsp_source) { -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; -+ -+ coex_sta->bt_rssi = -+ coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+#if 0 /* REMOVE */ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ if ((coex_sta->bt_info_ext & BIT(1))) { -+ -+ if (wifi_connected) -+ ex_halbtc8821aCsr2ant_media_status_notify( -+ btcoexist, BTC_MEDIA_CONNECT); -+ else -+ ex_halbtc8821aCsr2ant_media_status_notify( -+ btcoexist, BTC_MEDIA_DISCONNECT); -+ } -+#endif -+ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (bt_info == -+ BT_INFO_8821A_CSR_2ANT_B_CONNECTION) { /* connection exists but no busy */ -+ coex_sta->bt_link_exist = true; -+ coex_dm->bt_status = -+ BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE; -+ } else if (bt_info & -+ BT_INFO_8821A_CSR_2ANT_B_CONNECTION) { /* connection exists and some link is busy */ -+ coex_sta->bt_link_exist = true; -+ -+ if (bt_info & BT_INFO_8821A_CSR_2ANT_B_FTP) -+ coex_sta->pan_exist = true; -+ else -+ coex_sta->pan_exist = false; -+ -+ if (bt_info & BT_INFO_8821A_CSR_2ANT_B_A2DP) -+ coex_sta->a2dp_exist = true; -+ else -+ coex_sta->a2dp_exist = false; -+ -+ if (bt_info & BT_INFO_8821A_CSR_2ANT_B_HID) -+ coex_sta->hid_exist = true; -+ else -+ coex_sta->hid_exist = false; -+ -+ if (bt_info & BT_INFO_8821A_CSR_2ANT_B_SCO_ESCO) -+ coex_sta->sco_exist = true; -+ else -+ coex_sta->sco_exist = false; -+ -+ if (coex_sta->bt_info_ext & 0x80) -+ coex_sta->slave = true; /* Slave */ -+ else -+ coex_sta->slave = false; /* Master */ -+ -+ coex_dm->bt_status = -+ BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE; -+ } else { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->slave = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ coex_dm->bt_status = BT_8821A_CSR_2ANT_BT_STATUS_IDLE; -+ } -+ -+ if (bt_hs_on) -+ coex_dm->bt_status = -+ BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE; -+ -+ if (bt_info & BT_INFO_8821A_CSR_2ANT_B_INQ_PAGE) { -+ coex_sta->c2h_bt_inquiry_page = true; -+ coex_dm->bt_status = BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE; -+ } else -+ coex_sta->c2h_bt_inquiry_page = false; -+ -+ -+ if (BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE == coex_dm->bt_status) -+ bt_busy = true; -+ else -+ bt_busy = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ if (BT_8821A_CSR_2ANT_BT_STATUS_IDLE != coex_dm->bt_status) -+ limited_dig = true; -+ else -+ limited_dig = false; -+ coex_dm->limited_dig = limited_dig; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); -+ -+ halbtc8821aCsr2ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8821aCsr2ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821aCsr2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ ex_halbtc8821aCsr2ant_media_status_notify(btcoexist, -+ BTC_MEDIA_DISCONNECT); -+} -+ -+void ex_halbtc8821aCsr2ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_WIFI_PNP_SLEEP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821aCsr2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ -+ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ -+ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ -+ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ -+ coex_sta->under_ips = false; -+ coex_sta->under_lps = false; -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ } -+} -+ -+void ex_halbtc8821aCsr2ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821aCsr2ant_monitor_bt_ctr(btcoexist); -+ halbtc8821aCsr2ant_monitor_bt_enable_disable(btcoexist); -+} -+ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -\ Ingen nyrad vid filslut -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8821aCsr2Ant.h 2018-02-11 21:44:27.147146086 +0200 -@@ -0,0 +1,188 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821A_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8821A_CSR 2Ant BT Co-exist definition -+ * ******************************************* */ -+#define BT_INFO_8821A_CSR_2ANT_B_FTP BIT(7) -+#define BT_INFO_8821A_CSR_2ANT_B_A2DP BIT(6) -+#define BT_INFO_8821A_CSR_2ANT_B_HID BIT(5) -+#define BT_INFO_8821A_CSR_2ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8821A_CSR_2ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8821A_CSR_2ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8821A_CSR_2ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8821A_CSR_2ANT_B_CONNECTION BIT(0) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT 2 -+ -+enum bt_info_src_8821a_csr_2ant { -+ BT_INFO_SRC_8821A_CSR_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8821A_CSR_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8821A_CSR_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8821A_CSR_2ANT_MAX -+}; -+ -+enum bt_8821a_csr_2ant_bt_status { -+ BT_8821A_CSR_2ANT_BT_STATUS_IDLE = 0x0, -+ BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE = 0x2, -+ BT_8821A_CSR_2ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8821a_csr_2ant_coex_algo { -+ BT_8821A_CSR_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8821A_CSR_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8821A_CSR_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8821A_CSR_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8821A_CSR_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8821A_CSR_2ANT_COEX_ALGO_MAX = 0xb, -+}; -+ -+struct coex_dm_8821a_csr_2ant { -+ /* fw mechanism */ -+ boolean pre_dec_bt_pwr; -+ boolean cur_dec_bt_pwr; -+ u8 pre_fw_dac_swing_lvl; -+ u8 cur_fw_dac_swing_lvl; -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[6]; -+ u8 ps_tdma_du_adj_type; -+ boolean reset_tdma_adjust; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ -+ /* sw mechanism */ -+ boolean pre_rf_rx_lpf_shrink; -+ boolean cur_rf_rx_lpf_shrink; -+ u32 bt_rf_0x1e_backup; -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ boolean pre_dac_swing_on; -+ u32 pre_dac_swing_lvl; -+ boolean cur_dac_swing_on; -+ u32 cur_dac_swing_lvl; -+ boolean pre_adc_back_off; -+ boolean cur_adc_back_off; -+ boolean pre_agc_table_en; -+ boolean cur_agc_table_en; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ -+ u32 pre_ra_mask; -+ u32 cur_ra_mask; -+ -+ u8 cur_ampdu_num_type; -+ u8 pre_ampdu_num_type; -+ u16 backup_ampdu_max_num; -+ -+ u8 cur_ampdu_time_type; -+ u8 pre_ampdu_time_type; -+ u8 backup_ampdu_max_time; -+ -+ u8 cur_arfr_type; -+ u8 pre_arfr_type; -+ u32 backup_arfr_cnt1; -+ u32 backup_arfr_cnt2; -+ -+ u8 cur_retry_limit_type; -+ u8 pre_retry_limit_type; -+ u16 backup_retry_limit; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+}; -+ -+struct coex_sta_8821a_csr_2ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean slave; -+ boolean hid_exist; -+ boolean pan_exist; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ u8 bt_rssi; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8821A_CSR_2ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8821A_CSR_2ANT_MAX]; -+ boolean c2h_bt_inquiry_page; -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8821aCsr2ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821aCsr2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8821aCsr2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821aCsr2ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821aCsr2ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821aCsr2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821aCsr2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821aCsr2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821aCsr2ant_specific_packet_notify(IN struct btc_coexist -+ *btcoexist, IN u8 type); -+void ex_halbtc8821aCsr2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8821aCsr2ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821aCsr2ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8821aCsr2ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821aCsr2ant_display_coex_info(IN struct btc_coexist *btcoexist); -+ -+#else -+#define ex_halbtc8821aCsr2ant_power_on_setting(btcoexist) -+#define ex_halbtc8821aCsr2ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8821aCsr2ant_init_coex_dm(btcoexist) -+#define ex_halbtc8821aCsr2ant_ips_notify(btcoexist, type) -+#define ex_halbtc8821aCsr2ant_lps_notify(btcoexist, type) -+#define ex_halbtc8821aCsr2ant_scan_notify(btcoexist, type) -+#define ex_halbtc8821aCsr2ant_connect_notify(btcoexist, type) -+#define ex_halbtc8821aCsr2ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8821aCsr2ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8821aCsr2ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8821aCsr2ant_halt_notify(btcoexist) -+#define ex_halbtc8821aCsr2ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8821aCsr2ant_periodical(btcoexist) -+#define ex_halbtc8821aCsr2ant_display_coex_info(btcoexist) -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.c 2018-02-11 21:44:27.149146116 +0200 -@@ -0,0 +1,5979 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8821C Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821C_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8821c_1ant glcoex_dm_8821c_1ant; -+static struct coex_dm_8821c_1ant *coex_dm = &glcoex_dm_8821c_1ant; -+static struct coex_sta_8821c_1ant glcoex_sta_8821c_1ant; -+static struct coex_sta_8821c_1ant *coex_sta = &glcoex_sta_8821c_1ant; -+static struct psdscan_sta_8821c_1ant gl_psd_scan_8821c_1ant; -+static struct psdscan_sta_8821c_1ant *psd_scan = &gl_psd_scan_8821c_1ant; -+static struct rfe_type_8821c_1ant gl_rfe_type_8821c_1ant; -+static struct rfe_type_8821c_1ant *rfe_type = &gl_rfe_type_8821c_1ant; -+ -+ -+const char *const glbt_info_src_8821c_1ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8821c_1ant = 20160316; -+u32 glcoex_ver_8821c_1ant = 0x00; -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8821c1ant_ -+ * ************************************************************ */ -+u8 halbtc8821c1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_bt_rssi_state; -+ } -+ -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8821c1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_wifi_rssi_state[index]; -+ } -+ -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8821c1ant_update_ra_mask(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 dis_rate_mask) -+{ -+ coex_dm->cur_ra_mask = dis_rate_mask; -+ -+ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, -+ &coex_dm->cur_ra_mask); -+ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -+} -+ -+void halbtc8821c1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ coex_dm->cur_arfr_type = type; -+ -+ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { -+ switch (coex_dm->cur_arfr_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_4byte(btcoexist, 0x430, -+ coex_dm->backup_arfr_cnt1); -+ btcoexist->btc_write_4byte(btcoexist, 0x434, -+ coex_dm->backup_arfr_cnt2); -+ break; -+ case 1: -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x01010101); -+ } else { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -+} -+ -+void halbtc8821c1ant_retry_limit(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_retry_limit_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_retry_limit_type != -+ coex_dm->cur_retry_limit_type)) { -+ switch (coex_dm->cur_retry_limit_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ coex_dm->backup_retry_limit); -+ break; -+ case 1: /* retry limit=8 */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -+} -+ -+void halbtc8821c1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_ampdu_time_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { -+ switch (coex_dm->cur_ampdu_time_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ coex_dm->backup_ampdu_max_time); -+ break; -+ case 1: /* AMPDU timw = 0x38 * 32us */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -+} -+ -+void halbtc8821c1ant_limited_tx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, -+ IN u8 retry_limit_type, IN u8 ampdu_time_type) -+{ -+ switch (ra_mask_type) { -+ case 0: /* normal mode */ -+ halbtc8821c1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0); -+ break; -+ case 1: /* disable cck 1/2 */ -+ halbtc8821c1ant_update_ra_mask(btcoexist, force_exec, -+ 0x00000003); -+ break; -+ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ -+ halbtc8821c1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8821c1ant_auto_rate_fallback_retry(btcoexist, force_exec, -+ arfr_type); -+ halbtc8821c1ant_retry_limit(btcoexist, force_exec, retry_limit_type); -+ halbtc8821c1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -+} -+ -+void halbtc8821c1ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+void halbtc8821c1ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ coex_sta->c2h_bt_info_req_sent = true; -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WL query BT info!!\n"); -+ BTC_TRACE(trace_buf); -+} -+ -+void halbtc8821c1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ static u8 num_of_bt_counter_chk = 0, cnt_slave = 0; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ -+ /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); -+ -+ BTC_TRACE(trace_buf); -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+ -+ if ((coex_sta->low_priority_tx > 1150) && -+ (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->pop_event_cnt++; -+ -+ if ((coex_sta->low_priority_rx >= 1150) && (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) -+ && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist)) { -+ if (cnt_slave >= 3) { -+ bt_link_info->slave_role = true; -+ cnt_slave = 3; -+ } else -+ cnt_slave++; -+ } else { -+ if (cnt_slave == 0) { -+ bt_link_info->slave_role = false; -+ cnt_slave = 0; -+ } else -+ cnt_slave--; -+ -+ } -+ -+ if ((coex_sta->high_priority_tx == 0) && (coex_sta->high_priority_rx == 0) && (coex_sta->low_priority_tx == 0) && -+ (coex_sta->low_priority_rx == 0)) { -+ num_of_bt_counter_chk++; -+ if (num_of_bt_counter_chk >= 3) { -+ halbtc8821c1ant_query_bt_info(btcoexist); -+ num_of_bt_counter_chk = 0; -+ } -+ } -+ -+#if 0 -+ /* Add Hi-Pri Tx/Rx counter to avoid false detection */ -+ if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && -+ (coex_sta->high_priority_tx + coex_sta->high_priority_rx -+ >= 160) -+ && (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->bt_hi_pri_link_exist = true; -+ else -+ coex_sta->bt_hi_pri_link_exist = false; -+ -+ if ((coex_sta->acl_busy) && -+ (coex_sta->num_of_profile == 0)) { -+ if (coex_sta->low_priority_tx + -+ coex_sta->low_priority_rx >= 160) { -+ coex_sta->pan_exist = true; -+ coex_sta->num_of_profile++; -+ coex_sta->wrong_profile_notification++; -+ } -+ } -+#endif -+ -+} -+ -+ -+ -+void halbtc8821c1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -+{ -+ s32 wifi_rssi = 0; -+ boolean wifi_busy = false, wifi_under_b_mode = false; -+ static u8 cck_lock_counter = 0; -+ u32 total_cnt; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ if (coex_sta->under_ips) { -+ coex_sta->crc_ok_cck = 0; -+ coex_sta->crc_ok_11g = 0; -+ coex_sta->crc_ok_11n = 0; -+ coex_sta->crc_ok_11n_agg = 0; -+ -+ coex_sta->crc_err_cck = 0; -+ coex_sta->crc_err_11g = 0; -+ coex_sta->crc_err_11n = 0; -+ coex_sta->crc_err_11n_agg = 0; -+ } else { -+ coex_sta->crc_ok_cck = btcoexist->btc_read_2byte(btcoexist, -+ 0xf04); -+ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf14); -+ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf10); -+ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xf0c); -+ -+ coex_sta->crc_err_cck = btcoexist->btc_read_2byte(btcoexist,0xf00) + btcoexist->btc_read_2byte(btcoexist,0xf06); -+ -+ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf16); -+ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf12); -+ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xf0e); -+ } -+ -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x0); -+ -+ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { -+ total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + -+ coex_sta->crc_ok_11n + -+ coex_sta->crc_ok_11n_agg; -+ -+ if ((coex_dm->bt_status == BT_8821C_1ANT_BT_STATUS_ACL_BUSY) || -+ (coex_dm->bt_status == -+ BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (coex_dm->bt_status == -+ BT_8821C_1ANT_BT_STATUS_SCO_BUSY)) { -+ if (coex_sta->crc_ok_cck > (total_cnt - -+ coex_sta->crc_ok_cck)) { -+ if (cck_lock_counter < 3) -+ cck_lock_counter++; -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ if (!coex_sta->pre_ccklock) { -+ -+ if (cck_lock_counter >= 3) -+ coex_sta->cck_lock = true; -+ else -+ coex_sta->cck_lock = false; -+ } else { -+ if (cck_lock_counter == 0) -+ coex_sta->cck_lock = false; -+ else -+ coex_sta->cck_lock = true; -+ } -+ -+ if (coex_sta->cck_lock) -+ coex_sta->cck_ever_lock = true; -+ -+ coex_sta->pre_ccklock = coex_sta->cck_lock; -+ -+ -+} -+ -+boolean halbtc8821c1ant_is_wifibt_status_changed(IN struct btc_coexist *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false, pre_bt_off = false; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (coex_sta->bt_disabled != pre_bt_off) { -+ pre_bt_off = coex_sta->bt_disabled; -+ -+ if (coex_sta->bt_disabled) -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ else -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->bt_coex_supported_feature = 0; -+ coex_sta->bt_coex_supported_version = 0; -+ return true; -+ } -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ } -+ -+ return false; -+} -+ -+void halbtc8821c1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; -+ bt_link_info->acl_busy = coex_sta->acl_busy; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+} -+ -+void halbtc8821c1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ h2c_parameter[0] = -+ 0x1; /* enable BT AFH skip WL channel for 8821c because BT Rx LO interference */ -+ /* h2c_parameter[0] = 0x0; */ -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -+ -+} -+ -+u8 halbtc8821c1ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8821C_1ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_ALGO_HID_A2DP; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+void halbtc8821c1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8821c1ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8821c1ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8821c1ant_set_fw_low_penalty_ra(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ -+ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+} -+ -+void halbtc8821c1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8821c1ant_set_fw_low_penalty_ra(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8821c1ant_sw_mechanism(IN struct btc_coexist *btcoexist, -+ IN boolean low_penalty_ra) -+{ -+ halbtc8821c1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -+} -+ -+void halbtc8821c1ant_write_score_board( -+ IN struct btc_coexist *btcoexist, -+ IN u16 bitpos, -+ IN BOOLEAN state -+) -+{ -+ -+ static u16 originalval = 0x8002; -+ -+ if (state) -+ originalval = originalval | bitpos; -+ else -+ originalval = originalval & (~bitpos); -+ -+ btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); -+} -+ -+void halbtc8821c1ant_read_score_board( -+ IN struct btc_coexist *btcoexist, -+ IN u16 *score_board_val -+) -+{ -+ -+ *score_board_val = (btcoexist->btc_read_2byte(btcoexist, -+ 0xaa)) & 0x7fff; -+} -+ -+void halbtc8821c1ant_post_activestate_to_bt( -+ IN struct btc_coexist *btcoexist, -+ IN boolean wifi_active -+) -+{ -+ -+ if (wifi_active) -+ halbtc8821c1ant_write_score_board(btcoexist, (u16) BIT(0), TRUE); -+ else -+ halbtc8821c1ant_write_score_board(btcoexist, (u16) BIT(0), FALSE); -+} -+ -+ -+void halbtc8821c1ant_post_onoffstate_to_bt( -+ IN struct btc_coexist *btcoexist, -+ IN boolean wifi_on -+) -+{ -+ -+ if (wifi_on) -+ halbtc8821c1ant_write_score_board(btcoexist, (u16) BIT(1), TRUE); -+ else -+ halbtc8821c1ant_write_score_board(btcoexist, (u16) BIT(1), FALSE); -+} -+ -+void halbtc8821c1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ u16 u16tmp; -+ -+ /* This function check if bt is disabled */ -+#if 0 -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ -+ -+#else -+ -+ /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ -+ halbtc8821c1ant_read_score_board(btcoexist, &u16tmp); -+ -+ bt_active = u16tmp & BIT(1); -+ -+ -+#endif -+ -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ } else { -+ -+ bt_disable_cnt++; -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ bt_disable_cnt = 2; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ } -+ -+ -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ } -+ -+} -+ -+void halbtc8821c1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, -+ boolean isenable) -+{ -+ static u8 bitVal[5] = {0,0,0,0,0}; -+ static boolean state = false; -+ -+ if (state ==isenable) -+ return; -+ else -+ state = isenable; -+ -+ if (isenable) { -+ -+ /* enable GNT_WL, GNT_BT to GPIO for debug */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); -+ -+ /* store original value */ -+ bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, 0x66) & BIT(4)) >>4; /*0x66[4] */ -+ bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, 0x67) & BIT(0)); /*0x66[8] */ -+ bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, 0x42) & BIT(3)) >> 3; /*0x40[19] */ -+ bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, 0x65) & BIT(7)) >> 7; /*0x64[15] */ -+ bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, 0x72) & BIT(2)) >> 2; /*0x70[18] */ -+ -+ /* switch GPIO Mux */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), 0x0); /*0x66[4] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), 0x0); /*0x66[8] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), 0x0); /*0x40[19] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), 0x0); /*0x64[15] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), 0x0); /*0x70[18] = 0 */ -+ -+ -+ } else { -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); -+ -+ /* Restore original value */ -+ /* switch GPIO Mux */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), bitVal[0]); /*0x66[4] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), bitVal[1]); /*0x66[8] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), bitVal[2]); /*0x40[19] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), bitVal[3]); /*0x64[15] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), bitVal[4]); /*0x70[18] = 0 */ -+ } -+ -+} -+ -+u32 halbtc8821c1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, -+ IN u16 reg_addr) -+{ -+ u32 j = 0; -+ -+ -+ /* wait for ready bit before access 0x1700 */ -+ btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); -+ -+ do { -+ j++; -+ } while (((btcoexist->btc_read_1byte(btcoexist, -+ 0x1703)&BIT(5)) == 0) && -+ (j < BT_8821C_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); -+ -+ -+ return btcoexist->btc_read_4byte(btcoexist, -+ 0x1708); /* get read data */ -+ -+} -+ -+void halbtc8821c1ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist, -+ IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) -+{ -+ u32 val, i = 0, j = 0, bitpos = 0; -+ -+ -+ if (bit_mask == 0x0) -+ return; -+ if (bit_mask == 0xffffffff) { -+ btcoexist->btc_write_4byte(btcoexist, 0x1704, -+ reg_value); /* put write data */ -+ -+ /* wait for ready bit before access 0x1700 */ -+ do { -+ j++; -+ } while (((btcoexist->btc_read_1byte(btcoexist, -+ 0x1703)&BIT(5)) == 0) && -+ (j < BT_8821C_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); -+ -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x1700, -+ 0xc00F0000 | reg_addr); -+ } else { -+ for (i = 0; i <= 31; i++) { -+ if (((bit_mask >> i) & 0x1) == 0x1) { -+ bitpos = i; -+ break; -+ } -+ } -+ -+ /* read back register value before write */ -+ val = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, -+ reg_addr); -+ val = (val & (~bit_mask)) | (reg_value << bitpos); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x1704, -+ val); /* put write data */ -+ -+ /* wait for ready bit before access 0x1700 */ -+ do { -+ j++; -+ } while (((btcoexist->btc_read_1byte(btcoexist, -+ 0x1703)&BIT(5)) == 0) && -+ (j < BT_8821C_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); -+ -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x1700, -+ 0xc00F0000 | reg_addr); -+ -+ } -+ -+} -+ -+void halbtc8821c1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 val; -+ -+ val = (enable) ? 1 : 0; -+ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, -+ val); /* 0x38[7] */ -+ -+} -+ -+void halbtc8821c1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_control) -+{ -+ u8 val; -+ -+ val = (wifi_control) ? 1 : 0; -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, -+ val); /* 0x70[26] */ -+ -+} -+ -+void halbtc8821c1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, -+ IN u8 control_block, IN boolean sw_control, IN u8 state) -+{ -+ u32 val = 0, bit_mask; -+ -+ state = state & 0x1; -+ val = (sw_control) ? ((state << 1) | 0x1) : 0; -+ -+ switch (control_block) { -+ case BT_8821C_1ANT_GNT_BLOCK_RFC_BB: -+ default: -+ bit_mask = 0xc000; -+ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[15:14] */ -+ bit_mask = 0x0c00; -+ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[11:10] */ -+ break; -+ case BT_8821C_1ANT_GNT_BLOCK_RFC: -+ bit_mask = 0xc000; -+ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[15:14] */ -+ break; -+ case BT_8821C_1ANT_GNT_BLOCK_BB: -+ bit_mask = 0x0c00; -+ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[11:10] */ -+ break; -+ -+ } -+ -+} -+ -+void halbtc8821c1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, -+ IN u8 control_block, IN boolean sw_control, IN u8 state) -+{ -+ u32 val = 0, bit_mask; -+ -+ state = state & 0x1; -+ val = (sw_control) ? ((state << 1) | 0x1) : 0; -+ -+ switch (control_block) { -+ case BT_8821C_1ANT_GNT_BLOCK_RFC_BB: -+ default: -+ bit_mask = 0x3000; -+ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[13:12] */ -+ bit_mask = 0x0300; -+ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[9:8] */ -+ break; -+ case BT_8821C_1ANT_GNT_BLOCK_RFC: -+ bit_mask = 0x3000; -+ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[13:12] */ -+ break; -+ case BT_8821C_1ANT_GNT_BLOCK_BB: -+ bit_mask = 0x0300; -+ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[9:8] */ -+ break; -+ -+ } -+ -+} -+ -+void halbtc8821c1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u8 table_type, IN u16 table_content) -+{ -+ u16 reg_addr = 0x0000; -+ -+ switch (table_type) { -+ case BT_8821C_1ANT_CTT_WL_VS_LTE: -+ reg_addr = 0xa0; -+ break; -+ case BT_8821C_1ANT_CTT_BT_VS_LTE: -+ reg_addr = 0xa4; -+ break; -+ } -+ -+ if (reg_addr != 0x0000) -+ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, -+ 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ -+ -+ -+} -+ -+ -+void halbtc8821c1ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, -+ IN u8 table_type, IN u8 table_content) -+{ -+ u16 reg_addr = 0x0000; -+ -+ switch (table_type) { -+ case BT_8821C_1ANT_LBTT_WL_BREAK_LTE: -+ reg_addr = 0xa8; -+ break; -+ case BT_8821C_1ANT_LBTT_BT_BREAK_LTE: -+ reg_addr = 0xac; -+ break; -+ case BT_8821C_1ANT_LBTT_LTE_BREAK_WL: -+ reg_addr = 0xb0; -+ break; -+ case BT_8821C_1ANT_LBTT_LTE_BREAK_BT: -+ reg_addr = 0xb4; -+ break; -+ } -+ -+ if (reg_addr != 0x0000) -+ halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, -+ 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ -+ -+ -+} -+ -+void halbtc8821c1ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8821c1ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ -+ halbtc8821c1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8821c1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ u32 break_table; -+ u8 select_table; -+ -+ coex_sta->coex_table_type = type; -+ -+ if (coex_sta->concurrent_rx_mode_on == true) { -+ break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ -+ select_table = -+ 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ -+ } else { -+ break_table = 0xffffff; -+ select_table = 0x3; -+ } -+ -+ switch (type) { -+ case 0: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x55555555, break_table, -+ select_table); -+ break; -+ case 1: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 2: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0xaa5a5a5a, 0xaa5a5a5a, break_table, -+ select_table); -+ break; -+ case 3: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0xaa555555, 0xaa5a5a5a, break_table, -+ select_table); -+ break; -+ case 4: -+ halbtc8821c1ant_coex_table(btcoexist, -+ force_exec, 0xaa555555, 0xaa5a5a5a, -+ break_table, select_table); -+ break; -+ case 5: -+ halbtc8821c1ant_coex_table(btcoexist, -+ force_exec, 0x5a5a5a5a, 0x5a5a5a5a, -+ break_table, select_table); -+ break; -+ case 6: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 7: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0xaaaaaaaa, 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 8: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, break_table, -+ select_table); -+ break; -+ case 9: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, break_table, -+ select_table); -+ break; -+ case 10: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, break_table, -+ select_table); -+ break; -+ case 11: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, break_table, -+ select_table); -+ break; -+ case 12: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0x5ada5ada, break_table, -+ select_table); -+ break; -+ case 13: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 14: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0x5ada5ada, break_table, -+ select_table); -+ break; -+ case 15: -+ halbtc8821c1ant_coex_table(btcoexist, force_exec, -+ 0x55dd55dd, 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8821c1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8821c1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8821c1ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8821c1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8821c1ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8821c1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8821c1ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ /*halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); */ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ /*halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8);*/ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8821c1ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ coex_sta->force_lps_on = false; -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ -+ break; -+ case BTC_PS_LPS_ON: -+ coex_sta->force_lps_on = true; -+ halbtc8821c1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8821c1ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ -+ break; -+ case BTC_PS_LPS_OFF: -+ coex_sta->force_lps_on = false; -+ halbtc8821c1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, false); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+void halbtc8821c1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ if (ap_enable) { -+ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], FW for 1Ant AP mode\n"); -+ BTC_TRACE(trace_buf); -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ -+ halbtc8821c1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ } -+ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ -+ halbtc8821c1ant_power_save_state( -+ btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } else { -+ halbtc8821c1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ } -+ -+ -+ h2c_parameter[0] = real_byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = real_byte5; -+ -+ coex_dm->ps_tdma_para[0] = real_byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = real_byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+ -+void halbtc8821c1ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ boolean wifi_busy = false; -+ static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; -+ static boolean pre_wifi_busy = false; -+ -+ -+#if BT_8821C_1ANT_ANTDET_ENABLE -+#if BT_8821C_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE -+ if (board_info->btdm_ant_num_by_ant_det == 2) { -+ if (turn_on) -+ type = type + -+ 100; /* for WiFi RSSI low or BT RSSI low */ -+ } -+ -+#endif -+#endif -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (wifi_busy != pre_wifi_busy) { -+ force_exec = true; -+ pre_wifi_busy = wifi_busy; -+ } -+ -+ /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+ if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) -+ psTdmaByte4Modify = 0x1; -+ else -+ psTdmaByte4Modify = 0x0; -+ -+ if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { -+ -+ force_exec = true; -+ pre_psTdmaByte4Modify = psTdmaByte4Modify; -+ } -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ -+ if (coex_dm->cur_ps_tdma_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(on, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** TDMA(off, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } -+ -+ -+ if (turn_on) { -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ -+ switch (type) { -+ default: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x35, 0x03, 0x11, 0x11); -+ break; -+ -+ case 3: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x3a, 0x03, 0x10, 0x10); -+ break; -+ case 4: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x21, 0x03, 0x10, 0x10); -+ break; -+ case 5: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x15, 0x03, 0x11, 0x11); -+ break; -+ case 6: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x20, 0x03, 0x11, 0x11); -+ break; -+ case 7: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); -+ break; -+ case 8: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); -+ break; -+ case 13: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x25, 0x03, 0x10, 0x10 | psTdmaByte4Modify); -+ break; -+ case 14: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x15, 0x03, 0x10, 0x10 | psTdmaByte4Modify); -+ break; -+ case 15: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x20, 0x03, 0x10, 0x10 | psTdmaByte4Modify); -+ break; -+ case 17: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x10, 0x03, 0x11, 0x14 | psTdmaByte4Modify); -+ break;; -+ case 19: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x15, 0x03, 0x11, 0x10); -+ break; -+ case 20: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x30, 0x03, 0x11, 0x10); -+ break; -+ case 21: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x30, 0x03, 0x11, 0x10); -+ break; -+ case 22: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x25, 0x03, 0x11, 0x10); -+ break; -+ case 32: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x35, 0x03, 0x11, 0x11); -+ break; -+ case 33: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x35, 0x03, 0x11, 0x10); -+ break; -+ -+ /* 1-Ant to 2-Ant TDMA case */ -+ case 103: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x3a, 0x03, 0x70, 0x10); -+ break; -+ case 104: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x21, 0x03, 0x70, 0x10); -+ break; -+ case 105: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x15, 0x03, 0x71, 0x11); -+ break; -+ case 106: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x20, 0x03, 0x71, 0x11); -+ break; -+ case 107: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x10, 0x03, 0x70, 0x14 | psTdmaByte4Modify); -+ break; -+ case 108: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x10, 0x03, 0x70, 0x14 | psTdmaByte4Modify); -+ break; -+ case 113: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x25, 0x03, 0x70, 0x10 | psTdmaByte4Modify); -+ break; -+ case 114: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x15, 0x03, 0x70, 0x10 | psTdmaByte4Modify); -+ break; -+ case 115: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xd3, 0x20, 0x03, 0x70, 0x10 | psTdmaByte4Modify); -+ break; -+ case 117: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x10, 0x03, 0x71, 0x14 | psTdmaByte4Modify); -+ break;; -+ case 119: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x15, 0x03, 0x71, 0x10); -+ break; -+ case 120: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x30, 0x03, 0x71, 0x10); -+ break; -+ case 121: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x30, 0x03, 0x71, 0x10); -+ break; -+ case 122: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x25, 0x03, 0x71, 0x10); -+ break; -+ case 132: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x35, 0x03, 0x71, 0x11); -+ break; -+ case 133: -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, -+ 0xe3, 0x35, 0x03, 0x71, 0x10); -+ break; -+ -+ } -+ } else { -+ -+ /* disable PS tdma */ -+ switch (type) { -+ case 8: /* PTA Control */ -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, 0x8, -+ 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 0: -+ default: /* Software control, Antenna at BT side */ -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x0, 0x0); -+ break; -+ case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ -+ halbtc8821c1ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x48, 0x0); -+ break; -+ } -+ } -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+void halbtc8821c1ant_set_int_block(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 pos_type) -+{ -+ u8 regval_0xcba; -+ u32 u32tmp1 = 0; -+ -+ coex_dm->cur_int_block_status = pos_type; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_int_block_status == coex_dm->cur_int_block_status) -+ return; -+ } -+ -+ coex_dm->pre_int_block_status = coex_dm->cur_int_block_status; -+ -+ regval_0xcba = btcoexist->btc_read_1byte(btcoexist, 0xcba); -+ -+ switch(pos_type){ -+ -+ case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG: -+ regval_0xcba = regval_0xcba & (~(BIT(2)) ) | BIT(0); /* 0xcb8[16] = 1, 0xcb8[18] = 0, WL_G select BTG */ -+ break; -+ case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG: -+ regval_0xcba = regval_0xcba & (~(BIT(2) | BIT(0)) ); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ -+ regval_0xcba = regval_0xcba | BIT(4) | BIT(5) ; /* 0xcb8[21:20] = 2b'11, WL_G @ WLAG on */ -+ regval_0xcba = regval_0xcba & (~(BIT(7)) ) | BIT(6); /* 0xcb8[23:22] = 2b'01, WL_A @ WLAG off */ -+ -+ break; -+ case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG: -+ regval_0xcba = regval_0xcba & (~(BIT(2) | BIT(0)) ); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ -+ regval_0xcba = regval_0xcba & (~(BIT(5))) | BIT(4); /* 0xcb8[21:20] = 2b'01, WL_G @ WLAG off */ -+ regval_0xcba = regval_0xcba | BIT(6) | BIT(7); /* 0xcb8[23:22] = 2b'11, WL_A @ WLAG on */ -+ -+ break; -+ } -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcba, 0xff, regval_0xcba); -+ -+ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb8); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Int Block setup) 0xcb8 = 0x%08x **********\n", -+ u32tmp1); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+void halbtc8821c1ant_set_ext_band_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 pos_type) -+{ -+ -+#if 0 -+ boolean switch_polatiry_inverse = false; -+ u8 regval_0xcb6; -+ u32 u32tmp1 = 0, u32tmp2 = 0; -+ -+ if (!rfe_type->ext_band_switch_exist) -+ return; -+ -+ coex_dm->cur_ext_band_switch_status = pos_type; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ext_band_switch_status == coex_dm->cur_ext_band_switch_status) -+ return; -+ } -+ -+ coex_dm->pre_ext_band_switch_status = coex_dm->cur_ext_band_switch_status; -+ -+ /* swap control polarity if use different switch control polarity*/ -+ switch_polatiry_inverse = (rfe_type->ext_band_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); -+ -+ /*swap control polarity for WL_A, default polarity 0xcb4[21] = 0 && 0xcb4[23] = 1 is for WL_G */ -+ switch_polatiry_inverse = (pos_type == BT_8821C_1ANT_EXT_BAND_SWITCH_TO_WLA? ~switch_polatiry_inverse: switch_polatiry_inverse); -+ -+ regval_0xcb6 = btcoexist->btc_read_1byte(btcoexist, 0xcb6); -+ -+ /* for normal switch polrity, 0xcb4[21] =1 && 0xcb4[23] = 0 for WL_A, vice versa */ -+ regval_0xcb6 = (switch_polatiry_inverse == 1? ( (regval_0xcb6 & (~(BIT(7))) ) | BIT(5)) : ( (regval_0xcb6 & (~(BIT(5))) ) | BIT(7)) ); -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb6, 0xff, regval_0xcb6); -+ -+ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb0); -+ u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Ext Band switch setup) 0xcb0 = 0x%08x, 0xcb4 = 0x%08x**********\n", -+ u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+#endif -+ -+} -+ -+void halbtc8821c1ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ boolean switch_polatiry_inverse = false; -+ u8 regval_0xcb7 = 0, regval_0x64; -+ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ -+ if (!rfe_type->ext_ant_switch_exist) -+ return; -+ -+ coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ext_ant_switch_status == coex_dm->cur_ext_ant_switch_status) -+ return; -+ } -+ -+ coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; -+ -+ /* swap control polarity if use different switch control polarity*/ -+ /* Normal switch polarity for DPDT, 0xcb4[29:28] = 2b'01 => BTG to Main, WLG to Aux, 0xcb4[29:28] = 2b'10 => BTG to Aux, WLG to Main */ -+ /* Normal switch polarity for SPDT, 0xcb4[29:28] = 2b'01 => Ant to BTG, 0xcb4[29:28] = 2b'10 => Ant to WLG */ -+ switch_polatiry_inverse = (rfe_type->ext_ant_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); -+ -+ /* swap control polarity if 1-Ant at Aux */ -+ if ( (rfe_type->ext_ant_switch_type == BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT) && (board_info->single_ant_path == 0) ) -+ switch_polatiry_inverse = ~switch_polatiry_inverse; -+ -+ switch(pos_type) -+ { -+ default: -+ case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT: -+ case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE: -+ -+ break; -+ case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLG: -+ switch_polatiry_inverse = (rfe_type->wlg_Locate_at_btg == 0? ~switch_polatiry_inverse: switch_polatiry_inverse); -+ break; -+ case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLA: -+ /*switch_polatiry_inverse = (rfe_type->ext_band_switch_exist == 1? ~switch_polatiry_inverse: switch_polatiry_inverse);*/ -+ break; -+ } -+ -+ -+ switch(ctrl_type) -+ { -+ default: -+ case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x77); /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ -+ -+ regval_0xcb7 = (switch_polatiry_inverse == false? 0x1 : 0x2); /* 0xcb4[29:28] = 2b'01 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, 0x30, regval_0xcb7); -+ -+ break; -+ case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x66); /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ -+ -+ regval_0xcb7 = (switch_polatiry_inverse == false? 0x2 : 0x1); /* 0xcb4[29:28] = 2b'10 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 @ GNT_BT=1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, 0x30, regval_0xcb7); -+ -+ break; -+ case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x88); /* */ -+ -+ /* no regval_0xcb7 setup required, because antenna switch control value by antenna diversity */ -+ -+ break; -+ case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x1); /* 0x4c[23] = 1 */ -+ -+ regval_0x64 = (switch_polatiry_inverse == false? 0x0 : 0x1); /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, regval_0x64); -+ break; -+ case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x0); /* 0x4c[24] = 0 */ -+ -+ /* no setup required, because antenna switch control value by BT vendor 0xac[1:0] */ -+ break; -+ } -+ -+ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Ext Ant switch setup) 0xcb4 = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x**********\n", -+ u32tmp1, u32tmp2, u32tmp3); -+ BTC_TRACE(trace_buf); -+ -+ -+} -+ -+void halbtc8821c1ant_set_rfe_type(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+#if 0 -+ rfe_type->ext_band_switch_exist = false; -+ rfe_type->ext_band_switch_type = BT_8821C_1ANT_EXT_BAND_SWITCH_USE_SPDT; // SPDT; -+ rfe_type->ext_band_switch_ctrl_polarity = 0; -+ -+ if (rfe_type->ext_band_switch_exist) { -+ -+ /* band switch use RFE_ctrl1 (pin name: PAPE_A) and RFE_ctrl3 (pin name: LNAON_A) */ -+ -+ /* set RFE_ctrl1 as software control */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb0, 0xf0, 0x7); -+ -+ /* set RFE_ctrl3 as software control */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb1, 0xf0, 0x7); -+ -+ } -+#endif -+ -+ /* the following setup should be got from Efuse in the future */ -+ rfe_type->rfe_module_type = board_info->rfe_type; -+ -+ rfe_type->ext_ant_switch_ctrl_polarity = 0; -+ rfe_type->ext_ant_switch_diversity = false; -+ -+ switch(rfe_type->rfe_module_type) -+ { -+ case 0: -+ default: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, WLG*/ -+ rfe_type->wlg_Locate_at_btg = false; -+ rfe_type->ext_ant_switch_diversity = true; -+ break; -+ case 1: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, WLG */ -+ rfe_type->wlg_Locate_at_btg = false; -+ break; -+ case 2: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, BTG */ -+ rfe_type->wlg_Locate_at_btg = true; -+ break; -+ case 3: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, WLG */ -+ rfe_type->wlg_Locate_at_btg = false; -+ break; -+ case 4: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, BTG */; -+ rfe_type->wlg_Locate_at_btg = true; -+ break; -+ case 5: -+ rfe_type->ext_ant_switch_exist = false; /*2-Ant, no antenna switch, WLG*/ -+ rfe_type->wlg_Locate_at_btg = false; -+ -+ } -+ -+ -+ if (rfe_type->wlg_Locate_at_btg) -+ halbtc8821c1ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); -+ else -+ halbtc8821c1ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); -+ -+ -+} -+ -+ -+void halbtc8821c1ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean force_exec, -+ IN u8 phase ) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u32 cnt_bt_cal_chk = 0; -+ boolean is_in_mp_mode = false; -+ u8 u8tmp = 0; -+ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ u16 u16tmp1 = 0; -+ -+#if BT_8821C_1ANT_ANTDET_ENABLE -+#if BT_8821C_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE -+ if (ant_pos_type == BTC_ANT_PATH_PTA) { -+ if ((board_info->btdm_ant_det_finish) && -+ (board_info->btdm_ant_num_by_ant_det == 2)) { -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = BTC_ANT_PATH_WIFI; -+ else -+ ant_pos_type = BTC_ANT_PATH_BT; -+ } -+ } -+#endif -+#endif -+ -+ coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; -+ -+ if (!force_exec) { -+ if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) -+ return; -+ } -+ -+ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; -+ -+#if 1 -+ u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x38); -+ u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x54); -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u32tmp3, u8tmp, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+#endif -+ -+ -+ switch (phase) -+ { -+ case BT_8821C_1ANT_PHASE_COEX_INIT: -+ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ -+ halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8821c1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8821C_1ANT_CTT_WL_VS_LTE, 0xffff); -+ -+ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8821c1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8821C_1ANT_CTT_BT_VS_LTE, 0xffff); -+ -+ /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ -+ while (cnt_bt_cal_chk <= 20) { -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, -+ 0x49d); -+ cnt_bt_cal_chk++; -+ if (u8tmp & BIT(0)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ delay_ms(50); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ break; -+ } -+ } -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8821C_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW high */ -+ halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to SW low */ -+ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_1ANT_SIG_STA_SET_TO_LOW); -+ -+ coex_sta->run_time_state = false; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ -+ break; -+ case BT_8821C_1ANT_PHASE_WLANONLY_INIT: -+ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ -+ halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8821c1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8821C_1ANT_CTT_WL_VS_LTE, 0xffff); -+ -+ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8821c1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8821C_1ANT_CTT_BT_VS_LTE, 0xffff); -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8821C_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Low */ -+ halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_1ANT_SIG_STA_SET_TO_LOW); -+ /* Set GNT_WL to SW high */ -+ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ coex_sta->run_time_state = false; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_WIFI; -+ -+ break; -+ case BT_8821C_1ANT_PHASE_WLAN_OFF: -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* set Path control owner to BT */ -+ halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8821C_1ANT_PCO_BTSIDE); -+ -+ /* Set Ext Ant Switch to BT control at wifi off step */ -+ halbtc8821c1ant_set_ext_ant_switch(btcoexist, -+ FORCE_EXEC, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE); -+ -+ coex_sta->run_time_state = false; -+ break; -+ case BT_8821C_1ANT_PHASE_2G_RUNTIME: -+ -+ /* set Path control owner to WL at runtime step */ -+ halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8821C_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to PTA */ -+ halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_PTA, -+ BT_8821C_1ANT_SIG_STA_SET_BY_HW); -+ -+ if (rfe_type->wlg_Locate_at_btg) /* Set GNT_WL to PTA */ -+ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_PTA, -+ BT_8821C_1ANT_SIG_STA_SET_BY_HW); -+ else /* Set GNT_WL to SW High */ -+ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ coex_sta->run_time_state = true; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type){ -+ if (rfe_type->wlg_Locate_at_btg) -+ ant_pos_type = BTC_ANT_PATH_WIFI; -+ else -+ ant_pos_type = BTC_ANT_PATH_PTA; -+ } -+ -+ if (rfe_type->wlg_Locate_at_btg) -+ halbtc8821c1ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); -+ else -+ halbtc8821c1ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); -+ -+ break; -+ case BT_8821C_1ANT_PHASE_5G_RUNTIME: -+ -+ /* set Path control owner to WL at runtime step */ -+ halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8821C_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Hi */ -+ halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ /* Set GNT_WL to SW Hi */ -+ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ coex_sta->run_time_state = true; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) { -+ /* if (rfe_type->ext_band_switch_exist) -+ ant_pos_type = BTC_ANT_PATH_PTA; -+ else */ -+ ant_pos_type = BTC_ANT_PATH_WIFI5G; -+ } -+ -+ halbtc8821c1ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG); -+ -+ break; -+ case BT_8821C_1ANT_PHASE_BTMPMODE: -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* set Path control owner to WL */ -+ halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8821C_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Hi */ -+ halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ /* Set GNT_WL to SW Lo */ -+ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_1ANT_SIG_STA_SET_TO_LOW); -+ -+ coex_sta->run_time_state = false; -+ -+ /* Set Ext Ant Switch to BT side at BT MP mode */ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ -+ break; -+ } -+ -+ if (phase != BT_8821C_1ANT_PHASE_WLAN_OFF) -+ { -+ switch (ant_pos_type) { -+ case BTC_ANT_PATH_WIFI: -+ halbtc8821c1ant_set_ext_ant_switch( btcoexist, -+ force_exec, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLG); -+ break; -+ case BTC_ANT_PATH_WIFI5G: -+ halbtc8821c1ant_set_ext_ant_switch( btcoexist, -+ force_exec, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLA); -+ break; -+ case BTC_ANT_PATH_BT: -+ halbtc8821c1ant_set_ext_ant_switch( btcoexist, -+ force_exec, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ halbtc8821c1ant_set_ext_ant_switch( btcoexist, -+ force_exec, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE); -+ break; -+ } -+ -+ } -+#if 1 -+ u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Ant-Setup phase---%d) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ phase, u32tmp3, u8tmp, u32tmp1, u32tmp2); -+ -+ BTC_TRACE(trace_buf); -+#endif -+} -+ -+ -+boolean halbtc8821c1ant_is_common_action(IN struct btc_coexist *btcoexist) -+{ -+ boolean common = false, wifi_connected = false, wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!wifi_connected && -+ BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else { -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ common = false; -+ } -+ -+ return common; -+} -+ -+ -+/* ********************************************* -+ * -+ * Software Coex Mechanism start -+ * -+ * ********************************************* */ -+ -+/* SCO only or SCO+PAN(HS) */ -+ -+/* -+void halbtc8821c1ant_action_sco(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8821c1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8821c1ant_action_hid(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8821c1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8821c1ant_action_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8821c1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8821c1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8821c1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8821c1ant_action_pan_edr(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8821c1ant_sw_mechanism(btcoexist, false); -+} -+ -+ -+void halbtc8821c1ant_action_pan_hs(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8821c1ant_sw_mechanism(btcoexist, false); -+} -+ -+ -+void halbtc8821c1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8821c1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8821c1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8821c1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8821c1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8821c1ant_sw_mechanism(btcoexist, true); -+} -+ -+void halbtc8821c1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8821c1ant_sw_mechanism(btcoexist, true); -+} -+ -+*/ -+ -+/* ********************************************* -+ * -+ * Non-Software Coex Mechanism start -+ * -+ * ********************************************* */ -+void halbtc8821c1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, -+ BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8821c1ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) -+{ -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, -+ BT_8821C_1ANT_PHASE_5G_RUNTIME); -+} -+ -+ -+void halbtc8821c1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_under_5g = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if(wifi_under_5g) -+ { -+ halbtc8821c1ant_action_wifi_under5g(btcoexist); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (wlan only -- under 5g ) **********\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, -+ BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+} -+ -+void halbtc8821c1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, -+ BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8821c1ant_action_hs(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, -+ BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+} -+ -+void halbtc8821c1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, -+ bt_busy = false; -+ boolean wifi_scan = false, wifi_link = false, wifi_roam = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); -+ -+ if ((wifi_link) || (wifi_roam) || (coex_sta->wifi_is_high_pri_task)) { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); -+ -+ } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); -+ -+ } else if ((!wifi_connected) && (!wifi_scan)) { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ } else if (bt_link_info->a2dp_exist) { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if (wifi_scan) { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ } else if (wifi_busy) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 19); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } -+} -+ -+void halbtc8821c1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ /* tdma and coex table */ -+ -+ if (bt_link_info->sco_exist) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } else { /* HID */ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } -+} -+ -+void halbtc8821c1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (bt_link_info->hid_only) { /* HID */ -+ halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, -+ wifi_status); -+ coex_dm->auto_tdma_adjust = false; -+ return; -+ } else if (bt_link_info->a2dp_only) { /* A2DP */ -+ if (BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ -+ if (coex_sta->scan_ap_num >= -+ BT_8821C_1ANT_WIFI_NOISY_THRESH) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 17); -+ } else { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 7); -+ } -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = true; -+ } -+ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || -+ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ -+ -+ if (wifi_busy) { -+ -+ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 15); -+ else -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); -+ } else -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ coex_dm->auto_tdma_adjust = false; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { /* HID+A2DP */ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); -+ coex_dm->auto_tdma_adjust = false; -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && -+ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ -+ if (BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 4); -+ else -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); -+ coex_dm->auto_tdma_adjust = false; -+ } else { -+ /* BT no-profile busy (0x9) */ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ coex_dm->auto_tdma_adjust = false; -+ } -+} -+ -+void halbtc8821c1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -+{ -+ /* tdma and coex table */ -+ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, -+ BT_8821C_1ANT_PHASE_2G_RUNTIME ); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8821c1ant_action_wifi_not_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if (num_of_wifi_link >= 2) { -+ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8821c1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8821c1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8821c1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ /* tdma and coex table */ -+ if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if ((BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8821c1ant_action_wifi_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if (num_of_wifi_link >= 2) { -+ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8821c1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8821c1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8821c1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ -+ /* tdma and coex table */ -+ if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } else { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } else if ((BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8821c1ant_action_wifi_not_connected_asso_auth( -+ IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if (num_of_wifi_link >= 2) { -+ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8821c1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8821c1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8821c1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); -+ } else if (bt_link_info->pan_exist) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); -+ } else { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); -+ } -+} -+ -+void halbtc8821c1ant_action_wifi_connected_specific_packet( -+ IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ boolean wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if (num_of_wifi_link >= 2) { -+ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8821c1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8821c1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8821c1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ /* no specific packet process for both WiFi and BT very busy */ -+ if ((wifi_busy) && ((bt_link_info->pan_exist) || -+ (coex_sta->num_of_profile >= 2))) -+ return; -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } else if (bt_link_info->a2dp_exist) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if (bt_link_info->pan_exist) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -+ } -+} -+ -+void halbtc8821c1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_busy = false; -+ boolean scan = false, link = false, roam = false; -+ boolean under_4way = false, ap_enable = false, wifi_under_5g = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ if (wifi_under_5g) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 5G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_action_wifi_under5g(btcoexist); -+ return; -+ } else { -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ if (under_4way) { -+ halbtc8821c1ant_action_wifi_connected_specific_packet(btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8821c1ant_action_wifi_connected_scan(btcoexist); -+ else -+ halbtc8821c1ant_action_wifi_connected_specific_packet( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ -+ /* tdma and coex table */ -+ if (!wifi_busy) { -+ if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8821c1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else if ((BT_8821C_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 2); -+ } -+ } else { -+ if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8821c1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else if ((BT_8821C_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 4); -+ } -+ } -+} -+ -+void halbtc8821c1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ u8 algorithm = 0; -+ -+ algorithm = halbtc8821c1ant_action_algorithm(btcoexist); -+ coex_dm->cur_algorithm = algorithm; -+ -+ if (halbtc8821c1ant_is_common_action(btcoexist)) { -+ -+ } else { -+ switch (coex_dm->cur_algorithm) { -+ case BT_8821C_1ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8821c1ant_action_sco(btcoexist); */ -+ break; -+ case BT_8821C_1ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8821c1ant_action_hid(btcoexist); */ -+ break; -+ case BT_8821C_1ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8821c1ant_action_a2dp(btcoexist); */ -+ break; -+ case BT_8821C_1ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8821c1ant_action_a2dp_pan_hs(btcoexist); */ -+ break; -+ case BT_8821C_1ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8821c1ant_action_pan_edr(btcoexist); */ -+ break; -+ case BT_8821C_1ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8821c1ant_action_pan_hs(btcoexist); */ -+ break; -+ case BT_8821C_1ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8821c1ant_action_pan_edr_a2dp(btcoexist); */ -+ break; -+ case BT_8821C_1ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8821c1ant_action_pan_edr_hid(btcoexist); */ -+ break; -+ case BT_8821C_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8821c1ant_action_hid_a2dp_pan_edr(btcoexist); */ -+ break; -+ case BT_8821C_1ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8821c1ant_action_hid_a2dp(btcoexist); */ -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8821c1ant_coex_all_off(btcoexist); */ -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+} -+ -+ -+void halbtc8821c1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ boolean increase_scan_dev_num = false; -+ boolean bt_ctrl_agg_buf_size = false; -+ boolean miracast_plus_bt = false, wifi_under_5g = false; -+ u8 agg_buf_size = 5; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0, wifi_bw; -+ u8 iot_peer = BTC_IOT_PEER_UNKNOWN; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (!coex_sta->run_time_state){ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], return for run_time_state = false !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ if (wifi_under_5g) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 5G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_action_wifi_under5g(btcoexist); -+ return; -+ } else{ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 2G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ } -+ -+ if (coex_sta->bt_whck_test) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under WHCK TEST!!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_action_bt_whck_test(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!!\n"); -+ halbtc8821c1ant_action_wifi_only(btcoexist); -+ return; -+ } -+ -+ if ((BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ increase_scan_dev_num = true; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, -+ &increase_scan_dev_num); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if ((num_of_wifi_link >= 2) || -+ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", -+ num_of_wifi_link, wifi_link_status); -+ BTC_TRACE(trace_buf); -+ -+ if (bt_link_info->bt_link_exist) { -+ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, -+ 0, 1); -+ miracast_plus_bt = true; -+ } else { -+ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ miracast_plus_bt = false; -+ } -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8821c1ant_action_wifi_multi_port(btcoexist); -+ -+ -+ return; -+ } else { -+ miracast_plus_bt = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { -+ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); -+ -+ if (BTC_IOT_PEER_CISCO != iot_peer) { -+ if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ -+ halbtc8821c1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, true, false, 0x5); -+ else -+ halbtc8821c1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, false, 0x5); -+ } else { -+ if (bt_link_info->sco_exist) -+ halbtc8821c1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, true, false, 0x5); -+ else { -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ halbtc8821c1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, true, 0x10); -+ else -+ halbtc8821c1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, true, 0x8); -+ } -+ } -+ -+ halbtc8821c1ant_sw_mechanism(btcoexist, true); -+ halbtc8821c1ant_run_sw_coexist_mechanism( -+ btcoexist); /* just print debug message */ -+ } else { -+ halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x5); -+ -+ halbtc8821c1ant_sw_mechanism(btcoexist, false); -+ halbtc8821c1ant_run_sw_coexist_mechanism( -+ btcoexist); /* just print debug message */ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8821c1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ -+ if (!wifi_connected) { -+ boolean scan = false, link = false, roam = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is non connected-idle !!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8821c1ant_action_wifi_not_connected_scan( -+ btcoexist); -+ else -+ halbtc8821c1ant_action_wifi_not_connected_asso_auth( -+ btcoexist); -+ } else -+ halbtc8821c1ant_action_wifi_not_connected(btcoexist); -+ } else /* wifi LPS/Busy */ -+ halbtc8821c1ant_action_wifi_connected(btcoexist); -+} -+ -+void halbtc8821c1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ -+ /* sw all off */ -+ halbtc8821c1ant_sw_mechanism(btcoexist, false); -+ -+ coex_sta->pop_event_cnt = 0; -+} -+ -+void halbtc8821c1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean back_up, IN boolean wifi_only) -+{ -+ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ u16 u16tmp1 = 0; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u32tmp3, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 1Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->bt_coex_supported_feature = 0; -+ coex_sta->bt_coex_supported_version = 0; -+ -+ /* Setup RF front end type */ -+ halbtc8821c1ant_set_rfe_type(btcoexist); -+ -+ /* 0xf0[15:12] --> Chip Cut information */ -+ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, -+ 0xf1) & 0xf0) >> 4; -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ -+ /* BT report packet sample rate */ -+ btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); -+ -+ /* Init 0x778 = 0x1 for 1-Ant */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); -+ -+ /* Enable PTA (3-wire function form BT side) */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); -+ -+ /* Enable PTA (tx/rx signal form WiFi side) */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); -+ -+ halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, TRUE); -+ -+ /* check if WL firmware download ok */ -+ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) -+ halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, TRUE); -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ -+ /* Antenna config */ -+ if (wifi_only) { -+ coex_sta->concurrent_rx_mode_on = false; -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, -+ FORCE_EXEC, BT_8821C_1ANT_PHASE_WLANONLY_INIT); -+ } else { -+ coex_sta->concurrent_rx_mode_on = true; -+ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); */ -+ -+ /* RF 0x1[1] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx, mask Tx only */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x2, 0x0); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, BT_8821C_1ANT_PHASE_COEX_INIT); -+ } -+ -+ /* PTA parameter */ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ psd_scan->ant_det_is_ant_det_available = TRUE; -+ -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u32tmp3, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+u32 halbtc8821c1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) -+{ -+ u8 j; -+ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; -+ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, -+ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, -+ 32, 23, 15, 7, 0 -+ }; -+ -+ if (val == 0) -+ return 0; -+ -+ tmp = val; -+ -+ while (1) { -+ if (tmp == 1) -+ break; -+ else { -+ tmp = (tmp >> 1); -+ shiftcount++; -+ } -+ } -+ -+ -+ val_integerd_b = shiftcount + 1; -+ -+ tmp2 = 1; -+ for (j = 1; j <= val_integerd_b; j++) -+ tmp2 = tmp2 * 2; -+ -+ tmp = (val * 100) / tmp2; -+ tindex = tmp / 5; -+ -+ if (tindex > 20) -+ tindex = 20; -+ -+ val_fractiond_b = table_fraction[tindex]; -+ -+ result = val_integerd_b * 100 - val_fractiond_b; -+ -+ return result; -+ -+ -+} -+ -+void halbtc8821c1ant_psd_show_antenna_detect_result(IN struct btc_coexist -+ *btcoexist) -+{ -+ u8 *cli_buf = btcoexist->cli_buf; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n============[Antenna Detection info] ============\n"); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->ant_det_result == 1) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", -+ "Ant Det Result", "2-Antenna (Bad-Isolation)", -+ BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else if (psd_scan->ant_det_result == 2) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "2-Antenna (Good-Isolation)", -+ BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset, -+ BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "1-Antenna", -+ BT_8821C_1ANT_ANTDET_PSDTHRES_1ANT, -+ BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset); -+ -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", -+ "Antenna Detection Finish", -+ (board_info->btdm_ant_det_finish -+ ? "Yes" : "No")); -+ CL_PRINTF(cli_buf); -+ -+ switch (psd_scan->ant_det_result) { -+ case 0: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is not available)"); -+ break; -+ case 1: /* 2-Ant bad-isolation */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 2: /* 2-Ant good-isolation */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 3: /* 1-Ant */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 4: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Uncertainty result)"); -+ break; -+ case 5: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); -+ break; -+ case 6: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(WiFi is Scanning)"); -+ break; -+ case 7: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is not idle)"); -+ break; -+ case 8: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Abort by WiFi Scanning)"); -+ break; -+ case 9: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Antenna Init is not ready)"); -+ break; -+ case 10: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is Inquiry or page)"); -+ break; -+ case 11: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is Disabled)"); -+ break; -+ } -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Ant Detect Total Count", psd_scan->ant_det_try_count); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Ant Detect Fail Count", psd_scan->ant_det_fail_count); -+ CL_PRINTF(cli_buf); -+ -+ if ((!board_info->btdm_ant_det_finish) && -+ (psd_scan->ant_det_result != 5)) -+ return; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", -+ (psd_scan->ant_det_result ? "ok" : "fail")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", -+ psd_scan->ant_det_bt_tx_time); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", -+ psd_scan->ant_det_bt_le_channel); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", -+ "WiFi PSD Cent-Ch/Offset/Span", -+ psd_scan->real_cent_freq, psd_scan->real_offset, -+ psd_scan->real_span); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", -+ "PSD Pre-Scan Peak Value", -+ psd_scan->ant_det_pre_psdscan_peak_val / 100); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", -+ "PSD Pre-Scan result", -+ (psd_scan->ant_det_result != 5 ? "ok" : "fail"), -+ BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->ant_det_result == 5) -+ return; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", -+ "PSD Scan Peak Value", psd_scan->ant_det_peak_val); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", -+ "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", -+ (board_info->tfbga_package) ? "Yes" : "No"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "PSD Threshold Offset", psd_scan->ant_det_thres_offset); -+ CL_PRINTF(cli_buf); -+ -+} -+ -+ -+ -+void halbtc8821c1ant_psd_showdata(IN struct btc_coexist *btcoexist) -+{ -+ u8 *cli_buf = btcoexist->cli_buf; -+ u32 delta_freq_per_point; -+ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n\n============[PSD info] (%d)============\n", -+ psd_scan->psd_gen_count); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->psd_gen_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); -+ CL_PRINTF(cli_buf); -+ return; -+ } -+ -+ if (psd_scan->psd_point == 0) -+ delta_freq_per_point = 0; -+ else -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* if (psd_scan->is_psd_show_max_only) */ -+ if (0) { -+ psd_rep1 = psd_scan->psd_max_value / 100; -+ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; -+ -+ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + -+ psd_scan->psd_max_value_point * delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.0%d MHz", -+ freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.%d MHz", -+ freq1, freq2); -+ -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.0%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ -+ CL_PRINTF(cli_buf); -+ } else { -+ m = psd_scan->psd_start_point; -+ n = psd_scan->psd_start_point; -+ i = 1; -+ j = 1; -+ -+ while (1) { -+ do { -+ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * -+ delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (i == 1) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.0%2d", freq1, -+ freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.%3d", freq1, -+ freq2); -+ } else if ((i % 8 == 0) || -+ (m == psd_scan->psd_stop_point)) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.000\n", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.0%2d\n", freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.%3d\n", freq1, freq2); -+ } else { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.0%2d", freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.%3d", freq1, freq2); -+ } -+ -+ i++; -+ m++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); -+ -+ -+ do { -+ psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; -+ psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * -+ 100; -+ -+ if (j == 1) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.0%d", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.%d", psd_rep1, -+ psd_rep2); -+ } else if ((j % 8 == 0) || -+ (n == psd_scan->psd_stop_point)) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.0%d\n", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.%d\n", psd_rep1, psd_rep2); -+ } else { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.0%d", psd_rep1, psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.%d", psd_rep1, psd_rep2); -+ } -+ -+ j++; -+ n++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); -+ -+ if ((m > psd_scan->psd_stop_point) || -+ (n > psd_scan->psd_stop_point)) -+ break; -+ else { -+ i = 1; -+ j = 1; -+ } -+ -+ } -+ } -+ -+ -+} -+ -+void halbtc8821c1ant_psd_maxholddata(IN struct btc_coexist *btcoexist, -+ IN u32 gen_count) -+{ -+ u32 i = 0, i_max = 0, val_max = 0; -+ -+ if (gen_count == 1) { -+ memcpy(psd_scan->psd_report_max_hold, -+ psd_scan->psd_report, -+ BT_8821C_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); -+ -+ for (i = psd_scan->psd_start_point; -+ i <= psd_scan->psd_stop_point; i++) { -+ -+ } -+ -+ psd_scan->psd_max_value_point = 0; -+ psd_scan->psd_max_value = 0; -+ -+ } else { -+ for (i = psd_scan->psd_start_point; -+ i <= psd_scan->psd_stop_point; i++) { -+ if (psd_scan->psd_report[i] > -+ psd_scan->psd_report_max_hold[i]) -+ psd_scan->psd_report_max_hold[i] = -+ psd_scan->psd_report[i]; -+ -+ /* search Max Value */ -+ if (i == psd_scan->psd_start_point) { -+ i_max = i; -+ val_max = psd_scan->psd_report_max_hold[i]; -+ } else { -+ if (psd_scan->psd_report_max_hold[i] > -+ val_max) { -+ i_max = i; -+ val_max = psd_scan->psd_report_max_hold[i]; -+ } -+ } -+ -+ -+ } -+ -+ psd_scan->psd_max_value_point = i_max; -+ psd_scan->psd_max_value = val_max; -+ -+ } -+ -+ -+} -+ -+u32 halbtc8821c1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) -+{ -+ /* reg 0x808[9:0]: FFT data x */ -+ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ -+ /* reg 0x8b4[15:0]: FFT data y report */ -+ -+ u32 val = 0, psd_report = 0; -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ -+ val &= 0xffbffc00; -+ val |= point; -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ val |= 0x00400000; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); -+ -+ psd_report = val & 0x0000ffff; -+ -+ return psd_report; -+} -+ -+ -+boolean halbtc8821c1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, -+ IN u32 avgnum, IN u32 loopcnt) -+{ -+ u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; -+ u32 points1 = 0, psd_report = 0; -+ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; -+ u32 psd_center_freq = 20 * 10 ^ 6; -+ boolean outloop = false, scan , roam, is_sweep_ok = true; -+ u8 flag = 0; -+ u32 tmp = 0, u32tmp1 = 0; -+ u32 wifi_original_channel = 1; -+ -+ psd_scan->is_psd_running = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ do { -+ switch (flag) { -+ case 0: /* Get PSD parameters */ -+ default: -+ -+ psd_scan->psd_band_width = 40 * 1000000; -+ psd_scan->psd_point = points; -+ psd_scan->psd_start_base = points / 2; -+ psd_scan->psd_avg_num = avgnum; -+ psd_scan->real_cent_freq = cent_freq; -+ psd_scan->real_offset = offset; -+ psd_scan->real_span = span; -+ -+ -+ points1 = psd_scan->psd_point; -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* PSD point setup */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffff0fff; -+ -+ switch (psd_scan->psd_point) { -+ case 128: -+ val |= 0x0; -+ break; -+ case 256: -+ default: -+ val |= 0x00004000; -+ break; -+ case 512: -+ val |= 0x00008000; -+ break; -+ case 1024: -+ val |= 0x0000c000; -+ break; -+ } -+ -+ switch (psd_scan->psd_avg_num) { -+ case 1: -+ val |= 0x0; -+ break; -+ case 8: -+ val |= 0x00001000; -+ break; -+ case 16: -+ val |= 0x00002000; -+ break; -+ case 32: -+ default: -+ val |= 0x00003000; -+ break; -+ } -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ flag = 1; -+ break; -+ case 1: /* calculate the PSD point index from freq/offset/span */ -+ psd_center_freq = psd_scan->psd_band_width / 2 + -+ offset * (1000000); -+ -+ start_p = psd_scan->psd_start_base + (psd_center_freq - -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_start_point = start_p - -+ psd_scan->psd_start_base; -+ -+ stop_p = psd_scan->psd_start_base + (psd_center_freq + -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_stop_point = stop_p - -+ psd_scan->psd_start_base - 1; -+ -+ flag = 2; -+ break; -+ case 2: /* set RF channel/BW/Mode */ -+ -+ /* set 3-wire off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val |= 0x00300000; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val &= 0xfeffffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* Tx-pause on */ -+ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); -+ -+ /* store WiFi original channel */ -+ wifi_original_channel = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x18, 0x3ff); -+ -+ /* Set RF channel */ -+ if (cent_freq == 2484) -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, 0xe); -+ else -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, (cent_freq - 2412) / 5 + -+ 1); /* WiFi TRx Mask on */ -+ -+ /* save original RCK value */ -+ u32tmp1 = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x1d, 0xfffff); -+ -+ /* Enter debug mode */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, -+ 0x2, 0x1); -+ -+ /* Set RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, -+ 0xfffff, 0x2e); -+ -+ -+ /* Set RF mode = Rx, RF Gain = 0x320a0 */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, -+ 0xfffff, 0x320a0); -+ -+ while (1) { -+ if (k++ > BT_8821C_1ANT_ANTDET_SWEEPPOINT_DELAY) -+ break; -+ } -+ flag = 3; -+ break; -+ case 3: -+ psd_scan->psd_gen_count = 0; -+ for (j = 1; j <= loopcnt; j++) { -+ -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || roam) { -+ is_sweep_ok = false; -+ break; -+ } -+ memset(psd_scan->psd_report, 0, -+ psd_scan->psd_point * sizeof(u32)); -+ start_p = psd_scan->psd_start_point + -+ psd_scan->psd_start_base; -+ stop_p = psd_scan->psd_stop_point + -+ psd_scan->psd_start_base + 1; -+ -+ i = start_p; -+ point_index = 0; -+ -+ while (i < stop_p) { -+ if (i >= points1) -+ psd_report = -+ halbtc8821c1ant_psd_getdata( -+ btcoexist, i - points1); -+ else -+ psd_report = -+ halbtc8821c1ant_psd_getdata( -+ btcoexist, i); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Point=%d, psd_raw_data = 0x%08x\n", -+ i, psd_report); -+ BTC_TRACE(trace_buf); -+ if (psd_report == 0) -+ tmp = 0; -+ else -+ /* tmp = 20*log10((double)psd_report); */ -+ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ -+ tmp = 6 * halbtc8821c1ant_psd_log2base( -+ btcoexist, psd_report); -+ -+ n = i - psd_scan->psd_start_base; -+ psd_scan->psd_report[n] = tmp; -+ -+ -+ halbtc8821c1ant_psd_maxholddata( -+ btcoexist, j); -+ -+ i++; -+ -+ } -+ -+ psd_scan->psd_gen_count = j; -+ } -+ -+ flag = 100; -+ break; -+ case 99: /* error */ -+ -+ outloop = true; -+ break; -+ case 100: /* recovery */ -+ -+ /* set 3-wire on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val &= 0xffcfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val |= 0x01000000; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* Tx-pause off */ -+ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); -+ -+ /* PSD off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffbfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ /* restore RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, -+ 0xfffff, u32tmp1); -+ -+ /* Exit debug mode */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, -+ 0x2, 0x0); -+ -+ /* restore WiFi original channel */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, -+ 0x3ff, wifi_original_channel); -+ -+ outloop = true; -+ break; -+ -+ } -+ -+ } while (!outloop); -+ -+ -+ -+ psd_scan->is_psd_running = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); -+ BTC_TRACE(trace_buf); -+ return is_sweep_ok; -+ -+} -+ -+ -+void halbtc8821c1ant_psd_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 bt_tx_time, IN u32 bt_le_channel) -+{ -+ u32 i = 0; -+ u32 wlpsd_cent_freq = 2484, wlpsd_span = 2, wlpsd_sweep_count = 50; -+ s32 wlpsd_offset = -4; -+ u8 bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33}; -+ -+ u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; -+ -+ u8 state = 0; -+ boolean outloop = false, bt_resp = false; -+ u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, -+ u32tmp, u32tmp0, u32tmp1, u32tmp2 ; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ board_info->btdm_ant_det_finish = false; -+ memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); -+ memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); -+ -+ if (board_info->tfbga_package) /* for TFBGA */ -+ psd_scan->ant_det_thres_offset = 5; -+ else -+ psd_scan->ant_det_thres_offset = 0; -+ -+ do { -+ switch (state) { -+ case 0: -+ if (bt_le_channel == 39) -+ wlpsd_cent_freq = 2484; -+ else { -+ for (i = 1; i <= 13; i++) { -+ if (bt_le_ch[i - 1] == -+ bt_le_channel) { -+ wlpsd_cent_freq = 2412 -+ + (i - 1) * 5; -+ break; -+ } -+ } -+ -+ if (i == 14) { -+ -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", -+ bt_le_channel); -+ BTC_TRACE(trace_buf); -+ outloop = true; -+ break; -+ } -+ } -+ -+ wlpsd_sweep_count = bt_tx_time * 238 / -+ 100; /* bt_tx_time/0.42 */ -+ wlpsd_sweep_count = wlpsd_sweep_count / 5; -+ -+ if (wlpsd_sweep_count % 5 != 0) -+ wlpsd_sweep_count = (wlpsd_sweep_count / -+ 5 + 1) * 5; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", -+ bt_tx_time, bt_le_channel); -+ BTC_TRACE(trace_buf); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", -+ wlpsd_cent_freq, -+ wlpsd_offset, -+ wlpsd_span, -+ wlpsd_sweep_count); -+ BTC_TRACE(trace_buf); -+ -+ state = 1; -+ break; -+ case 1: /* stop coex DM & set antenna path */ -+ /* Stop Coex DM */ -+ btcoexist->stop_coex_dm = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* Set TDMA off, */ -+ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, -+ false, 0); -+ -+ /* Set coex table */ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, -+ FORCE_EXEC, 0); -+ -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ halbtc8821c1ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); -+ -+ halbtc8821c1ant_set_ext_ant_switch( btcoexist, -+ FORCE_EXEC, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT); -+ -+ /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ -+ /* set GNT_BT to SW high */ -+ halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to SW high */ -+ halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ -+ h2c_parameter[0] = 0x1; -+ h2c_parameter[1] = 0xd; -+ h2c_parameter[2] = 0x14; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", -+ h2c_parameter[1], -+ h2c_parameter[2]); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, -+ h2c_parameter); -+ -+ u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70); -+ u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Ant Det) **********\n", -+ u32tmp0, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ -+ state = 2; -+ break; -+ case 2: /* Pre-sweep background psd */ -+ if (!halbtc8821c1ant_psd_sweep_point(btcoexist, -+ wlpsd_cent_freq, wlpsd_offset, wlpsd_span, -+ BT_8821C_1ANT_ANTDET_PSD_POINTS, -+ BT_8821C_1ANT_ANTDET_PSD_AVGNUM, 3)) { -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ psd_scan->ant_det_result = 8; -+ state = 99; -+ break; -+ } -+ -+ psd_scan->ant_det_pre_psdscan_peak_val = -+ psd_scan->psd_max_value; -+ -+ if (psd_scan->psd_max_value > -+ (BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset) * 100) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", -+ psd_scan->psd_max_value / 100, -+ BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ BTC_TRACE(trace_buf); -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ psd_scan->ant_det_result = 5; -+ state = 99; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", -+ psd_scan->psd_max_value / 100, -+ BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ BTC_TRACE(trace_buf); -+ state = 3; -+ } -+ break; -+ case 3: -+ -+ bt_resp = btcoexist->btc_set_bt_ant_detection( -+ btcoexist, (u8)(bt_tx_time & 0xff), -+ (u8)(bt_le_channel & 0xff)); -+ -+ if (!halbtc8821c1ant_psd_sweep_point(btcoexist, -+ wlpsd_cent_freq, wlpsd_offset, -+ wlpsd_span, -+ BT_8821C_1ANT_ANTDET_PSD_POINTS, -+ BT_8821C_1ANT_ANTDET_PSD_AVGNUM, -+ wlpsd_sweep_count)) { -+ board_info->btdm_ant_det_finish -+ = false; -+ board_info->btdm_ant_num_by_ant_det -+ = 1; -+ psd_scan->ant_det_result = 8; -+ state = 99; -+ break; -+ } -+ -+ psd_scan->ant_det_psd_scan_peak_val = -+ psd_scan->psd_max_value; -+ psd_scan->ant_det_psd_scan_peak_freq = -+ psd_scan->psd_max_value_point; -+ state = 4; -+ break; -+ case 4: -+ -+ if (psd_scan->psd_point == 0) -+ delta_freq_per_point = 0; -+ else -+ delta_freq_per_point = -+ psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ psd_rep1 = psd_scan->psd_max_value / 100; -+ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * -+ 100; -+ -+ freq = ((psd_scan->real_cent_freq - 20) * -+ 1000000 + psd_scan->psd_max_value_point -+ * delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (freq2 < 100) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", -+ freq1, freq2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_freq, -+ BT_8821C_1ANT_ANTDET_BUF_LEN, -+ "%d.0%d", freq1, freq2); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", -+ freq1, freq2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_freq, -+ BT_8821C_1ANT_ANTDET_BUF_LEN, -+ "%d.%d", freq1, freq2); -+ } -+ -+ if (psd_rep2 < 10) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.0%d dB\n", -+ psd_rep1, psd_rep2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_val, -+ BT_8821C_1ANT_ANTDET_BUF_LEN, -+ "%d.0%d", psd_rep1, psd_rep2); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.%d dB\n", -+ psd_rep1, psd_rep2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_val, -+ BT_8821C_1ANT_ANTDET_BUF_LEN, -+ "%d.%d", psd_rep1, psd_rep2); -+ } -+ -+ psd_scan->ant_det_is_btreply_available = true; -+ -+ if (bt_resp == false) { -+ psd_scan->ant_det_is_btreply_available = -+ false; -+ psd_scan->ant_det_result = 0; -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->psd_max_value > -+ (BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) -+ * 100) { -+ psd_scan->ant_det_result = 1; -+ board_info->btdm_ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 2; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->psd_max_value > -+ (BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset) * 100) { -+ psd_scan->ant_det_result = 2; -+ board_info->btdm_ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 2; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->psd_max_value > -+ (BT_8821C_1ANT_ANTDET_PSDTHRES_1ANT) * -+ 100) { -+ psd_scan->ant_det_result = 3; -+ board_info->btdm_ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ psd_scan->ant_det_result = 4; -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ state = 99; -+ break; -+ case 99: /* restore setup */ -+ -+ /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ -+ h2c_parameter[0] = 0x0; -+ h2c_parameter[1] = 0x0; -+ h2c_parameter[2] = 0x0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", -+ h2c_parameter[1], h2c_parameter[2]); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, -+ h2c_parameter); -+ -+ /* Set Antenna Path, GNT_WL/GNT_BT control by PTA */ -+ halbtc8821c1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ /* Resume Coex DM */ -+ btcoexist->stop_coex_dm = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ /* stimulate coex running */ -+ halbtc8821c1ant_run_coexist_mechanism( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ outloop = true; -+ break; -+ } -+ -+ } while (!outloop); -+ -+ -+ -+} -+ -+void halbtc8821c1ant_psd_antenna_detection_check(IN struct btc_coexist -+ *btcoexist) -+{ -+ static u32 ant_det_count = 0, ant_det_fail_count = 0; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ boolean scan, roam; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ -+ /* psd_scan->ant_det_bt_tx_time = 20; */ -+ psd_scan->ant_det_bt_tx_time = -+ BT_8821C_1ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ -+ psd_scan->ant_det_bt_le_channel = BT_8821C_1ANT_ANTDET_BTTXCHANNEL; -+ -+ ant_det_count++; -+ -+ psd_scan->ant_det_try_count = ant_det_count; -+ -+ if (scan || roam) { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 6; -+ } else if (coex_sta->bt_disabled) { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 11; -+ } else if (coex_sta->num_of_profile >= 1) { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 7; -+ } else if ( -+ !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 9; -+ } else if (coex_sta->c2h_bt_inquiry_page) { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 10; -+ } else { -+ -+ btcoexist->stop_coex_dm = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_psd_antenna_detection(btcoexist, -+ psd_scan->ant_det_bt_tx_time, -+ psd_scan->ant_det_bt_le_channel); -+ -+ delay_ms(psd_scan->ant_det_bt_tx_time); -+ -+ btcoexist->stop_coex_dm = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ /* stimulate coex running */ -+ /* -+ halbtc8821c1ant_run_coexist_mechanism( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); -+ BTC_TRACE(trace_buf); -+ */ -+ } -+ -+ if (!board_info->btdm_ant_det_finish) -+ ant_det_fail_count++; -+ -+ psd_scan->ant_det_fail_count = ant_det_fail_count; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n", -+ psd_scan->ant_det_result, -+ psd_scan->ant_det_fail_count, -+ board_info->btdm_ant_det_finish == TRUE ? "Yes" : "No"); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8821c1ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8821c1ant_ -+ * ************************************************************ */ -+void ex_halbtc8821c1ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp = 0x0; -+ u16 u16tmp = 0x0; -+ u32 value = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Execute 8821c 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Ant Det Finish = %s, Ant Det Number = %d\n", -+ (board_info->btdm_ant_det_finish ? "Yes" : "No"), -+ board_info->btdm_ant_num_by_ant_det); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = true; -+ psd_scan->ant_det_is_ant_det_available = FALSE; -+ -+ /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ -+ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); -+ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); -+ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ -+ -+ /* Check efuse 0xc3[6] for Single Antenna Path */ -+ if (board_info->single_ant_path == 0) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** Single Antenna, Antenna at Aux Port**********\n"); -+ BTC_TRACE(trace_buf); -+ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; -+ -+ u8tmp = 1; -+ } else if (board_info->single_ant_path == 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** Single Antenna, Antenna at Main Port**********\n"); -+ BTC_TRACE(trace_buf); -+ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+ -+ u8tmp = 0; -+ } -+ -+ -+ /* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at power on */ -+ if (btcoexist->chip_interface == BTC_INTF_PCI) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_USB) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_SDIO) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); -+ -+ /* Setup RF front end type */ -+ halbtc8821c1ant_set_rfe_type(btcoexist); -+ -+ /* Set Antenna Path to BT side */ -+ halbtc8821c1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_1ANT_PHASE_COEX_INIT); -+ -+ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ -+ halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, TRUE); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", -+ halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0xcb4 (Power-On) = 0x%x / 0x%x**********\n", -+ btcoexist->btc_read_4byte(btcoexist, 0x70), btcoexist->btc_read_4byte(btcoexist, 0xcb4)); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+void ex_halbtc8821c1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -+{ -+} -+ -+void ex_halbtc8821c1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ halbtc8821c1ant_init_hw_config(btcoexist, true, wifi_only); -+ btcoexist->stop_coex_dm = false; -+ -+} -+ -+void ex_halbtc8821c1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_init_coex_dm(btcoexist); -+ -+ /* halbtc8821c1ant_query_bt_info(btcoexist); */ -+} -+ -+void ex_halbtc8821c1ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_stack_info *stack_info = &btcoexist->stack_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u16 u16tmp[4]; -+ u32 u32tmp[4]; -+ u32 fa_of_dm, fa_cck; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ static u8 pop_report_in_10s = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ if (btcoexist->stop_coex_dm) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (psd_scan->ant_det_try_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s / %d", -+ "Ant PG Num/ Mech/ Pos/ RFE", -+ board_info->pg_ant_num, board_info->btdm_ant_num, -+ (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT? "Main" : "Aux"), -+ rfe_type->rfe_module_type); -+ CL_PRINTF(cli_buf); -+ } else { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %s/ %d (%d/%d/%d)", -+ "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", -+ board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, -+ (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT ? "Main" : "Aux"), -+ rfe_type->rfe_module_type, -+ psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, -+ psd_scan->ant_det_result); -+ CL_PRINTF(cli_buf); -+ -+ if (board_info->btdm_ant_det_finish) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "Ant Det PSD Value", -+ psd_scan->ant_det_peak_val); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", -+ "BT stack/ hci ext ver", -+ ((stack_info->profile_notified) ? "Yes" : "No"), -+ stack_info->hci_version); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", -+ "Version Coex/ Fw/ Patch/ Cut", -+ glcoex_ver_date_8821c_1ant, glcoex_ver_8821c_1ant, fw_ver, -+ bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", -+ "WifibHiPri/ Ccklock/ CckEverLock", -+ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), -+ (coex_sta->cck_lock ? "Yes" : "No"), -+ (coex_sta->cck_ever_lock ? "Yes" : "No")); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ pop_report_in_10s++; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt/ popCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") -+ : ((BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, -+ coex_sta->pop_event_cnt); -+ CL_PRINTF(cli_buf); -+ -+ if (pop_report_in_10s >= 5) { -+ coex_sta->pop_event_cnt = 0; -+ pop_report_in_10s = 0; -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d / %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP/Hi-Pri", -+ bt_link_info->sco_exist, bt_link_info->hid_exist, -+ bt_link_info->pan_exist, bt_link_info->a2dp_exist, -+ bt_link_info->bt_hi_pri_link_exist); -+ CL_PRINTF(cli_buf); -+ -+ if (stack_info->profile_notified) -+ btcoexist->btc_disp_dbg_msg(btcoexist, -+ BTC_DBG_DISP_BT_LINK_INFO); -+ else { -+ bt_info_ext = coex_sta->bt_info_ext; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d/ %x/ %04x", -+ "Role/A2DP Rate/Bitpool/Feature/Ver", -+ ((bt_link_info->slave_role) ? "Slave" : "Master"), -+ (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool, -+ coex_sta->bt_coex_supported_feature, -+ coex_sta->bt_coex_supported_version); -+ CL_PRINTF(cli_buf); -+ } -+ -+ -+ for (i = 0; i < BT_INFO_SRC_8821C_1ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8821c_1ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ -+ if (btcoexist->manual_control) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms] (before Manual)============"); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms]============"); -+ -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "SM[LowPenaltyRA]", -+ coex_dm->cur_low_penalty_ra); -+ CL_PRINTF(cli_buf); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), -+ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); -+ -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "WL/BT Coex Table Type", -+ coex_sta->coex_table_type); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x778/0x6cc/IgnWlanAct", -+ u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa0); -+ u32tmp[1] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "LTE Coex Table W_L/B_L", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa8); -+ u32tmp[1] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xac); -+ u32tmp[2] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb0); -+ u32tmp[3] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "LTE Break Table W_L/B_L/L_W/L_B", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, -+ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "0x430/0x434/0x42a/0x456", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", -+ "LTE CoexOn/Path Ctrl Owner", -+ (int)((u32tmp[0] & BIT(7)) >> 7), ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "LTE 3Wire/OPMode/UART/UARTMode", -+ (int)((u32tmp[0] & BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), -+ (int)((u32tmp[0] & BIT(3)) >> 3), -+ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", -+ "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", -+ (int)((u32tmp[0] & BIT(12)) >> 12), (int)((u32tmp[0] & BIT(14)) >> 14), -+ ((u8tmp[0] & BIT(3)) ? "On" : "Off")); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", -+ (int)((u32tmp[0] & BIT(2)) >> 2), (int)((u32tmp[0] & BIT(3)) >> 3), -+ (int)((u32tmp[0] & BIT(1)) >> 1), (int)(u32tmp[0] & BIT(0))); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcba); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%04x/ 0x%04x/ 0x%02x %s", -+ "0xcb0/0xcb4/0xcb8[23:16]", -+ u32tmp[0], u32tmp[1],u8tmp[0], ( (u8tmp[0] & 0x5) == 0x1 ? "BTG": ( (u8tmp[0] & 0xf0) == 0x70? "WL_G" : "WL_A" ) )); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x4c[24:23]/0x64[0]/x4c6[4]/0x40[5]", -+ (u32tmp[0] & ( BIT(24) | BIT(23) )) >> 23 , u8tmp[2]&0x1 , (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); -+ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xc50); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s/ 0x%x", -+ "0x550/0x522/4-RxAGC/0xc50", -+ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off", u8tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xf4c); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xf08); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5d); -+ -+ fa_of_dm = (u32tmp[0] & 0xffff) + (u32tmp[1] & 0xffff); -+ -+ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", -+ u32tmp[2] & 0xffff, fa_cck, ((u32tmp[2] & 0xffff0000) >> 16), fa_of_dm); -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_OK CCK/11g/11n/11ac", -+ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, -+ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_Err CCK/11g/11n/11ac", -+ coex_sta->crc_err_cck, coex_sta->crc_err_11g, -+ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(high-pri rx/tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(low-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+ -+ halbtc8821c1ant_read_score_board(btcoexist, &u16tmp[0]); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", -+ "ScoreBoard[14:0] (from BT)", u16tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void ex_halbtc8821c1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ -+ /* Write WL "Active" in Score-board for LPS off */ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, false); -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_1ANT_PHASE_WLAN_OFF); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); -+ -+ halbtc8821c1ant_init_hw_config(btcoexist, false, false); -+ halbtc8821c1ant_init_coex_dm(btcoexist);; -+ -+ coex_sta->under_ips = false; -+ } -+} -+ -+void ex_halbtc8821c1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ -+ if (coex_sta->force_lps_on == true) { /* LPS No-32K */ -+ /* Write WL "Active" in Score-board for PS-TDMA */ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); -+ -+ } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ -+ /* Write WL "Non-Active" in Score-board for Native-PS */ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, false); -+ -+ } -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ -+ /* Write WL "Active" in Score-board for LPS off */ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); -+ -+ } -+} -+ -+void ex_halbtc8821c1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false; -+ -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN notify()\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_SCAN_START == type) //for dual band, no action for BTC_SCAN_START, the action is change to switchband_notify -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ halbtc8821c1ant_query_bt_info(btcoexist); -+ -+ if (BTC_SCAN_START_2G == type) { -+ -+ if (!wifi_connected) -+ coex_sta->wifi_is_high_pri_task = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify (2G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, -+ 8); -+ -+ /* Force antenna setup for no scan result issue */ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8821c1ant_action_wifi_not_connected_scan(btcoexist); -+ else /* wifi is connected */ -+ halbtc8821c1ant_action_wifi_connected_scan(btcoexist); -+ -+ } else { -+ -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num); -+ BTC_TRACE(trace_buf); -+ -+ if (!wifi_connected) -+ halbtc8821c1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8821c1ant_action_wifi_connected(btcoexist); -+ } -+ -+ -+} -+ -+void ex_halbtc8821c1ant_switchband_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ -+ if(type == BTC_SWITCH_TO_5G) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], switchband_notify --- switch to 5G\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_action_wifi_under5g(btcoexist); -+ -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], switchband_notify --- switch to 2G\n"); -+ BTC_TRACE(trace_buf); -+ -+ ex_halbtc8821c1ant_scan_notify(btcoexist, -+ BTC_SCAN_START_2G); -+ } -+} -+ -+ -+void ex_halbtc8821c1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false; -+ -+ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ if ( (BTC_ASSOCIATE_5G_START == type) || (BTC_ASSOCIATE_5G_FINISH== type)) { -+ -+ if (BTC_ASSOCIATE_5G_START == type) -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], connect_notify --- 5G start\n"); -+ else -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], connect_notify --- 5G finish\n"); -+ -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_action_wifi_under5g(btcoexist); -+ return; -+ } -+ -+ if (BTC_ASSOCIATE_START == type) { -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ -+ /* Force antenna setup for no scan result issue */ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify (2G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_dm->arp_cnt = 0; -+ -+ halbtc8821c1ant_action_wifi_not_connected_asso_auth(btcoexist); -+ } else { -+ -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify (2G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8821c1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8821c1ant_action_wifi_connected(btcoexist); -+ } -+ -+} -+ -+void ex_halbtc8821c1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_under_b_mode = false, wifi_under_5g = false; -+ -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ if (wifi_under_5g) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 5G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); -+ halbtc8821c1ant_action_wifi_under5g(btcoexist); -+ return; -+ } -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); -+ -+ /* Force antenna setup for no scan result issue */ -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ /* Set CCK Tx/Rx high Pri except 11b mode */ -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x00); /* CCK Rx */ -+ } else { -+ /* btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x10); */ /*CCK Tx */ -+ /* btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); */ /*CCK Rx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x10); /* CCK Rx */ -+ } -+ -+ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, -+ 0x430); -+ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, -+ 0x434); -+ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( -+ btcoexist, 0x42a); -+ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( -+ btcoexist, 0x456); -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, false); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ -+ -+ coex_sta->cck_ever_lock = false; -+ } -+ -+ halbtc8821c1ant_update_wifi_channel_info(btcoexist, type); -+ -+} -+ -+void ex_halbtc8821c1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean under_4way = false, wifi_under_5g = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ if (wifi_under_5g) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 5G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_action_wifi_under5g(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (under_4way) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ---- under_4way!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } else if (BTC_PACKET_ARP == type) { -+ -+ coex_dm->arp_cnt++; -+ -+ if (coex_sta->wifi_is_high_pri_task) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt); -+ BTC_TRACE(trace_buf); -+ } -+ -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } -+ -+ if (coex_sta->wifi_is_high_pri_task) -+ halbtc8821c1ant_action_wifi_connected_specific_packet(btcoexist); -+} -+ -+void ex_halbtc8821c1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source = 0; -+ boolean wifi_connected = false; -+ boolean bt_busy = false; -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8821C_1ANT_MAX) -+ rsp_source = BT_INFO_SRC_8821C_1ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (BT_INFO_SRC_8821C_1ANT_WIFI_FW != rsp_source) { -+ -+ /* if 0xff, it means BT is under WHCK test */ -+ if (bt_info == 0xff) -+ coex_sta->bt_whck_test = true; -+ else -+ coex_sta->bt_whck_test = false; -+ -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; -+ -+ if (coex_sta->bt_retry_cnt >= 1) -+ coex_sta->pop_event_cnt++; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) -+ coex_sta->c2h_bt_page = true; -+ else -+ coex_sta->c2h_bt_page = false; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80) -+ coex_sta->bt_create_connection = true; -+ else -+ coex_sta->bt_create_connection = false; -+ -+ /* unit: %, value-100 to translate to unit: dBm */ -+ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; -+ -+ /* coex_sta->bt_info_c2h[rsp_source][3] * 2 - 90; */ -+ -+ if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { -+ coex_sta->a2dp_bit_pool = -+ coex_sta->bt_info_c2h[rsp_source][6]; -+ } else -+ coex_sta->a2dp_bit_pool = 0; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9) -+ coex_sta->acl_busy = true; -+ else -+ coex_sta->acl_busy = false; -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ -+ if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) { -+ -+ /* Re-Init */ -+ if (coex_sta->bt_info_ext & BIT(1)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (wifi_connected) -+ halbtc8821c1ant_update_wifi_channel_info(btcoexist, -+ BTC_MEDIA_CONNECT); -+ else -+ halbtc8821c1ant_update_wifi_channel_info(btcoexist, -+ BTC_MEDIA_DISCONNECT); -+ } -+ -+ /* If Ignore_WLanAct && not SetUp_Link */ -+ if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_ignore_wlan_act(btcoexist, -+ FORCE_EXEC, false); -+ } -+ } -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (bt_info & BT_INFO_8821C_1ANT_B_INQ_PAGE) -+ coex_sta->c2h_bt_inquiry_page = true; -+ else -+ coex_sta->c2h_bt_inquiry_page = false; -+ } -+ -+ coex_sta->num_of_profile = 0; -+ -+ /* set link exist status */ -+ if (!(bt_info & BT_INFO_8821C_1ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ -+ coex_sta->bt_hi_pri_link_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (bt_info & BT_INFO_8821C_1ANT_B_FTP) { -+ coex_sta->pan_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->pan_exist = false; -+ if (bt_info & BT_INFO_8821C_1ANT_B_A2DP) { -+ coex_sta->a2dp_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->a2dp_exist = false; -+ if (bt_info & BT_INFO_8821C_1ANT_B_HID) { -+ coex_sta->hid_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->hid_exist = false; -+ if (bt_info & BT_INFO_8821C_1ANT_B_SCO_ESCO) { -+ coex_sta->sco_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->sco_exist = false; -+ -+ } -+ -+ halbtc8821c1ant_update_bt_link_info(btcoexist); -+ -+ bt_info = bt_info & -+ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ -+ -+ if (!(bt_info & BT_INFO_8821C_1ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info == -+ BT_INFO_8821C_1ANT_B_CONNECTION) { /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if ((bt_info & BT_INFO_8821C_1ANT_B_SCO_ESCO) || -+ (bt_info & BT_INFO_8821C_1ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info & BT_INFO_8821C_1ANT_B_ACL_BUSY) { -+ if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) -+ coex_dm->auto_tdma_adjust = false; -+ coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if ((BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ bt_busy = true; -+ else -+ bt_busy = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Manual CTRL<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ halbtc8821c1ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8821c1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_RF_ON == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_rf_off_on_event = true; -+ btcoexist->stop_coex_dm = false; -+ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, TRUE); -+ halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, TRUE); -+ -+ } else if (BTC_RF_OFF == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, FALSE); -+ halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, FALSE); -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ halbtc8821c1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_1ANT_PHASE_WLAN_OFF); -+ -+ btcoexist->stop_coex_dm = true; -+ coex_sta->wl_rf_off_on_event = false; -+ } -+} -+ -+void ex_halbtc8821c1ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ -+ halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, FALSE); -+ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, FALSE); -+ halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, FALSE); -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_1ANT_PHASE_WLAN_OFF); -+ -+ halbtc8821c1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ -+ ex_halbtc8821c1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+ -+ btcoexist->stop_coex_dm = true; -+} -+ -+void ex_halbtc8821c1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_WIFI_PNP_SLEEP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ -+ halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, FALSE); -+ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, FALSE); -+ halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, FALSE); -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ halbtc8821c1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_1ANT_PHASE_WLAN_OFF); -+ -+ btcoexist->stop_coex_dm = true; -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_post_activestate_to_bt(btcoexist, TRUE); -+ halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, TRUE); -+ -+ btcoexist->stop_coex_dm = false; -+ } -+} -+ -+ -+void ex_halbtc8821c1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], *****************Coex DM Reset*****************\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c1ant_init_hw_config(btcoexist, false, false); -+ halbtc8821c1ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8821c1ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ============== Periodical ==============\n"); -+ BTC_TRACE(trace_buf); -+ -+#if (BT_AUTO_REPORT_ONLY_8821C_1ANT == 0) -+ halbtc8821c1ant_query_bt_info(btcoexist); -+ -+#endif -+ -+ halbtc8821c1ant_monitor_bt_ctr(btcoexist); -+ halbtc8821c1ant_monitor_wifi_ctr(btcoexist); -+ -+ halbtc8821c1ant_monitor_bt_enable_disable(btcoexist); -+ -+ /* for 4-way, DHCP, EAPOL packet */ -+ if (coex_sta->specific_pkt_period_cnt > 0) { -+ -+ coex_sta->specific_pkt_period_cnt--; -+ -+ if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (coex_sta->bt_coex_supported_feature == 0) -+ coex_sta->bt_coex_supported_feature = btcoexist->btc_get_bt_coex_supported_feature(btcoexist); -+ -+ if ( (coex_sta->bt_coex_supported_version == 0) && (!coex_sta->bt_disabled) ) -+ coex_sta->bt_coex_supported_version = btcoexist->btc_get_bt_coex_supported_version(btcoexist); -+ -+ if (halbtc8821c1ant_is_wifibt_status_changed(btcoexist)) -+ halbtc8821c1ant_run_coexist_mechanism(btcoexist); -+ -+ -+} -+ -+void ex_halbtc8821c1ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+#if BT_8821C_1ANT_ANTDET_ENABLE -+ static u32 ant_det_count = 0, ant_det_fail_count = 0; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ /*boolean scan, roam;*/ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Call AntennaDetect()!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (seconds == 0) { -+ psd_scan->ant_det_try_count = 0; -+ psd_scan->ant_det_fail_count = 0; -+ ant_det_count = 0; -+ ant_det_fail_count = 0; -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ return; -+ } -+ -+ if (!board_info->btdm_ant_det_finish) { -+ psd_scan->ant_det_inteval_count = -+ psd_scan->ant_det_inteval_count + 2; -+ -+ if (psd_scan->ant_det_inteval_count >= -+ BT_8821C_2ANT_ANTDET_RETRY_INTERVAL) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c1ant_psd_antenna_detection_check(btcoexist); -+ -+ if (board_info->btdm_ant_det_finish) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); -+ BTC_TRACE(trace_buf); -+#if 1 -+ if (board_info->btdm_ant_num_by_ant_det == 2) -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, -+ FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+ else -+ halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, -+ FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -+#endif -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ psd_scan->ant_det_inteval_count = 0; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", -+ psd_scan->ant_det_inteval_count); -+ BTC_TRACE(trace_buf); -+ } -+ -+ } -+#endif -+ -+ -+} -+ -+ -+void ex_halbtc8821c1ant_display_ant_detection(IN struct btc_coexist *btcoexist) -+{ -+#if BT_8821C_1ANT_ANTDET_ENABLE -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ if (psd_scan->ant_det_try_count != 0) { -+ halbtc8821c1ant_psd_show_antenna_detect_result(btcoexist); -+ -+ if (board_info->btdm_ant_det_finish) -+ halbtc8821c1ant_psd_showdata(btcoexist); -+ return; -+ } -+#endif -+ -+} -+ -+void ex_halbtc8821c1ant_antenna_isolation(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+ -+ -+} -+ -+void ex_halbtc8821c1ant_psd_scan(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+ -+ -+} -+ -+ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c1ant.h 2018-02-11 21:44:27.150146132 +0200 -@@ -0,0 +1,432 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821C_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8821C 1ANT BT Co-exist definition -+ * ******************************************* */ -+#define BT_AUTO_REPORT_ONLY_8821C_1ANT 1 -+ -+#define BT_INFO_8821C_1ANT_B_FTP BIT(7) -+#define BT_INFO_8821C_1ANT_B_A2DP BIT(6) -+#define BT_INFO_8821C_1ANT_B_HID BIT(5) -+#define BT_INFO_8821C_1ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8821C_1ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8821C_1ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8821C_1ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8821C_1ANT_B_CONNECTION BIT(0) -+ -+#define BT_INFO_8821C_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT(0))) ? true : false) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT 2 -+ -+#define BT_8821C_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ -+ -+/* for Antenna detection */ -+#define BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 -+#define BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -+#define BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 -+#define BT_8821C_1ANT_ANTDET_PSDTHRES_1ANT 35 -+#define BT_8821C_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -+#define BT_8821C_1ANT_ANTDET_SWEEPPOINT_DELAY 40000 -+#define BT_8821C_1ANT_ANTDET_ENABLE 0 -+#define BT_8821C_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 -+#define BT_8821C_1ANT_ANTDET_BTTXTIME 100 -+#define BT_8821C_1ANT_ANTDET_BTTXCHANNEL 39 -+ -+#define BT_8821C_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 -+ -+enum bt_8821c_1ant_signal_state { -+ BT_8821C_1ANT_SIG_STA_SET_TO_LOW = 0x0, -+ BT_8821C_1ANT_SIG_STA_SET_BY_HW = 0x0, -+ BT_8821C_1ANT_SIG_STA_SET_TO_HIGH = 0x1, -+ BT_8821C_1ANT_SIG_STA_MAX -+}; -+ -+enum bt_8821c_1ant_path_ctrl_owner { -+ BT_8821C_1ANT_PCO_BTSIDE = 0x0, -+ BT_8821C_1ANT_PCO_WLSIDE = 0x1, -+ BT_8821C_1ANT_PCO_MAX -+}; -+ -+enum bt_8821c_1ant_gnt_ctrl_type { -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, -+ BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW = 0x1, -+ BT_8821C_1ANT_GNT_TYPE_MAX -+}; -+ -+enum bt_8821c_1ant_gnt_ctrl_block { -+ BT_8821C_1ANT_GNT_BLOCK_RFC_BB = 0x0, -+ BT_8821C_1ANT_GNT_BLOCK_RFC = 0x1, -+ BT_8821C_1ANT_GNT_BLOCK_BB = 0x2, -+ BT_8821C_1ANT_GNT_BLOCK_MAX -+}; -+ -+enum bt_8821c_1ant_lte_coex_table_type { -+ BT_8821C_1ANT_CTT_WL_VS_LTE = 0x0, -+ BT_8821C_1ANT_CTT_BT_VS_LTE = 0x1, -+ BT_8821C_1ANT_CTT_MAX -+}; -+ -+enum bt_8821c_1ant_lte_break_table_type { -+ BT_8821C_1ANT_LBTT_WL_BREAK_LTE = 0x0, -+ BT_8821C_1ANT_LBTT_BT_BREAK_LTE = 0x1, -+ BT_8821C_1ANT_LBTT_LTE_BREAK_WL = 0x2, -+ BT_8821C_1ANT_LBTT_LTE_BREAK_BT = 0x3, -+ BT_8821C_1ANT_LBTT_MAX -+}; -+ -+enum bt_info_src_8821c_1ant { -+ BT_INFO_SRC_8821C_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8821C_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8821C_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8821C_1ANT_MAX -+}; -+ -+enum bt_8821c_1ant_bt_status { -+ BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8821C_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8821C_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8821C_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8821C_1ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8821c_1ant_wifi_status { -+ BT_8821C_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8821C_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, -+ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8821C_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8821C_1ANT_WIFI_STATUS_MAX -+}; -+ -+enum bt_8821c_1ant_coex_algo { -+ BT_8821C_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8821C_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8821C_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8821C_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8821C_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8821C_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8821C_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8821C_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8821C_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8821C_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8821C_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8821C_1ANT_COEX_ALGO_MAX = 0xb, -+}; -+ -+enum bt_8821c_1ant_ext_ant_switch_type { -+ BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT = 0x0, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT = 0x1, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_MAX -+}; -+ -+ -+enum bt_8821c_1ant_ext_ant_switch_ctrl_type { -+ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW = 0x0, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA = 0x1, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV = 0x2, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC = 0x3, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT = 0x4, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_MAX -+}; -+ -+enum bt_8821c_1ant_ext_ant_switch_pos_type { -+ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT = 0x0, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLG = 0x1, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLA = 0x2, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE = 0x3, -+ BT_8821C_1ANT_EXT_ANT_SWITCH_TO_MAX -+}; -+ -+enum bt_8821c_1ant_ext_band_switch_pos_type { -+ BT_8821C_1ANT_EXT_BAND_SWITCH_TO_WLG = 0x0, -+ BT_8821C_1ANT_EXT_BAND_SWITCH_TO_WLA = 0x1, -+ BT_8821C_1ANT_EXT_BAND_SWITCH_TO_MAX -+}; -+ -+enum bt_8821c_1ant_int_block{ -+ BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG = 0x0, -+ BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG = 0x1, -+ BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG = 0x2, -+ BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_MAX -+}; -+ -+enum bt_8821c_1ant_phase{ -+ BT_8821C_1ANT_PHASE_COEX_INIT = 0x0, -+ BT_8821C_1ANT_PHASE_WLANONLY_INIT = 0x1, -+ BT_8821C_1ANT_PHASE_WLAN_OFF = 0x2, -+ BT_8821C_1ANT_PHASE_2G_RUNTIME = 0x3, -+ BT_8821C_1ANT_PHASE_5G_RUNTIME = 0x4, -+ BT_8821C_1ANT_PHASE_BTMPMODE = 0x5, -+ BT_8821C_1ANT_PHASE_MAX -+}; -+ -+ -+struct coex_dm_8821c_1ant { -+ /* hw setting */ -+ u32 pre_ant_pos_type; -+ u32 cur_ant_pos_type; -+ /* fw mechanism */ -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean auto_tdma_adjust; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ /* sw mechanism */ -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ -+ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ -+ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ -+ u16 backup_retry_limit; -+ u8 backup_ampdu_max_time; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ u32 pre_ra_mask; -+ u32 cur_ra_mask; -+ u8 pre_arfr_type; -+ u8 cur_arfr_type; -+ u8 pre_retry_limit_type; -+ u8 cur_retry_limit_type; -+ u8 pre_ampdu_time_type; -+ u8 cur_ampdu_time_type; -+ u32 arp_cnt; -+ -+ u32 pre_ext_ant_switch_status; -+ u32 cur_ext_ant_switch_status; -+ -+ u8 pre_ext_band_switch_status; -+ u8 cur_ext_band_switch_status; -+ -+ u8 pre_int_block_status; -+ u8 cur_int_block_status; -+ -+ u8 error_condition; -+}; -+ -+struct coex_sta_8821c_1ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ boolean bt_hi_pri_link_exist; -+ u8 num_of_profile; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 specific_pkt_period_cnt; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ s8 bt_rssi; -+ boolean bt_tx_rx_mask; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8821C_1ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8821C_1ANT_MAX]; -+ boolean bt_whck_test; -+ boolean c2h_bt_inquiry_page; -+ boolean c2h_bt_page; /* Add for win8.1 page out issue */ -+ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ u32 pop_event_cnt; -+ u8 scan_ap_num; -+ -+ u32 crc_ok_cck; -+ u32 crc_ok_11g; -+ u32 crc_ok_11n; -+ u32 crc_ok_11n_agg; -+ -+ u32 crc_err_cck; -+ u32 crc_err_11g; -+ u32 crc_err_11n; -+ u32 crc_err_11n_agg; -+ -+ boolean cck_lock; -+ boolean pre_ccklock; -+ boolean cck_ever_lock; -+ u8 coex_table_type; -+ -+ boolean force_lps_on; -+ u32 wrong_profile_notification; -+ -+ boolean concurrent_rx_mode_on; -+ -+ u16 score_board; -+ -+ u8 a2dp_bit_pool; -+ u8 cut_version; -+ boolean acl_busy; -+ boolean wl_rf_off_on_event; -+ boolean bt_create_connection; -+ boolean run_time_state; -+ -+ u32 bt_coex_supported_feature; -+ u32 bt_coex_supported_version; -+}; -+ -+ -+#define BT_8821C_1ANT_EXT_BAND_SWITCH_USE_DPDT 0 -+#define BT_8821C_1ANT_EXT_BAND_SWITCH_USE_SPDT 1 -+ -+ -+struct rfe_type_8821c_1ant{ -+ -+ u8 rfe_module_type; -+ boolean ext_ant_switch_exist; -+ u8 ext_ant_switch_type; /* 0:DPDT, 1:SPDT */ -+ u8 ext_ant_switch_ctrl_polarity; /* iF 0: DPDT_P=0, DPDT_N=1 => BTG to Main, WL_A+G to Aux */ -+ -+ boolean ext_band_switch_exist; -+ u8 ext_band_switch_type; /* 0:DPDT, 1:SPDT */ -+ u8 ext_band_switch_ctrl_polarity; -+ -+ boolean wlg_Locate_at_btg; /* If true: WLG at BTG, If false: WLG at WLAG */ -+ -+ boolean ext_ant_switch_diversity; /* If diversity on */ -+}; -+ -+#define BT_8821C_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -+#define BT_8821C_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -+#define BT_8821C_1ANT_ANTDET_BUF_LEN 16 -+ -+struct psdscan_sta_8821c_1ant { -+ -+ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ -+ u32 ant_det_bt_tx_time; -+ u32 ant_det_pre_psdscan_peak_val; -+ boolean ant_det_is_ant_det_available; -+ u32 ant_det_psd_scan_peak_val; -+ boolean ant_det_is_btreply_available; -+ u32 ant_det_psd_scan_peak_freq; -+ -+ u8 ant_det_result; -+ u8 ant_det_peak_val[BT_8821C_1ANT_ANTDET_BUF_LEN]; -+ u8 ant_det_peak_freq[BT_8821C_1ANT_ANTDET_BUF_LEN]; -+ u32 ant_det_try_count; -+ u32 ant_det_fail_count; -+ u32 ant_det_inteval_count; -+ u32 ant_det_thres_offset; -+ -+ u32 real_cent_freq; -+ s32 real_offset; -+ u32 real_span; -+ -+ u32 psd_band_width; /* unit: Hz */ -+ u32 psd_point; /* 128/256/512/1024 */ -+ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_start_point; -+ u32 psd_stop_point; -+ u32 psd_max_value_point; -+ u32 psd_max_value; -+ u32 psd_start_base; -+ u32 psd_avg_num; /* 1/8/16/32 */ -+ u32 psd_gen_count; -+ boolean is_psd_running; -+ boolean is_psd_show_max_only; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8821c1ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8821c1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c1ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c1ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c1ant_switchband_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8821c1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c1ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8821c1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c1ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c1ant_display_coex_info(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c1ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+void ex_halbtc8821c1ant_antenna_isolation(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+ -+void ex_halbtc8821c1ant_psd_scan(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+void ex_halbtc8821c1ant_display_ant_detection(IN struct btc_coexist *btcoexist); -+ -+#else -+#define ex_halbtc8821c1ant_power_on_setting(btcoexist) -+#define ex_halbtc8821c1ant_pre_load_firmware(btcoexist) -+#define ex_halbtc8821c1ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8821c1ant_init_coex_dm(btcoexist) -+#define ex_halbtc8821c1ant_ips_notify(btcoexist, type) -+#define ex_halbtc8821c1ant_lps_notify(btcoexist, type) -+#define ex_halbtc8821c1ant_scan_notify(btcoexist, type) -+#define ex_halbtc8821c1ant_switchband_notify(btcoexist,type) -+#define ex_halbtc8821c1ant_connect_notify(btcoexist, type) -+#define ex_halbtc8821c1ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8821c1ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8821c1ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8821c1ant_rf_status_notify(btcoexist, type) -+#define ex_halbtc8821c1ant_halt_notify(btcoexist) -+#define ex_halbtc8821c1ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8821c1ant_coex_dm_reset(btcoexist) -+#define ex_halbtc8821c1ant_periodical(btcoexist) -+#define ex_halbtc8821c1ant_display_coex_info(btcoexist) -+#define ex_halbtc8821c1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8821c1ant_antenna_isolation(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8821c1ant_psd_scan(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8821c1ant_display_ant_detection(btcoexist) -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.c 2018-02-11 21:44:27.150146132 +0200 -@@ -0,0 +1,6096 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8821C Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821C_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8821c_2ant glcoex_dm_8821c_2ant; -+static struct coex_dm_8821c_2ant *coex_dm = &glcoex_dm_8821c_2ant; -+static struct coex_sta_8821c_2ant glcoex_sta_8821c_2ant; -+static struct coex_sta_8821c_2ant *coex_sta = &glcoex_sta_8821c_2ant; -+static struct psdscan_sta_8821c_2ant gl_psd_scan_8821c_2ant; -+static struct psdscan_sta_8821c_2ant *psd_scan = &gl_psd_scan_8821c_2ant; -+static struct rfe_type_8821c_2ant gl_rfe_type_8821c_2ant; -+static struct rfe_type_8821c_2ant *rfe_type = &gl_rfe_type_8821c_2ant; -+ -+const char *const glbt_info_src_8821c_2ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8821c_2ant = 20160316; -+u32 glcoex_ver_8821c_2ant = 0x00; -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8821c2ant_ -+ * ************************************************************ */ -+u8 halbtc8821c2ant_bt_rssi_state(u8 *ppre_bt_rssi_state, u8 level_num, -+ u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = *ppre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return *ppre_bt_rssi_state; -+ } -+ -+ if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || -+ (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ *ppre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8821c2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 *pprewifi_rssi_state, IN u8 level_num, IN u8 rssi_thresh, -+ IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = *pprewifi_rssi_state; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || -+ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return *pprewifi_rssi_state; -+ } -+ -+ if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || -+ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((*pprewifi_rssi_state == BTC_RSSI_STATE_MEDIUM) || -+ (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ *pprewifi_rssi_state = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8821c2ant_coex_switch_threshold(IN struct btc_coexist *btcoexist, -+ IN u8 isolation_measuared) -+{ -+ s8 interference_wl_tx = 0, interference_bt_tx = 0; -+ -+ -+ interference_wl_tx = BT_8821C_2ANT_WIFI_MAX_TX_POWER - isolation_measuared; -+ interference_bt_tx = BT_8821C_2ANT_BT_MAX_TX_POWER - isolation_measuared; -+ -+ -+ -+ coex_sta->wifi_coex_thres = BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; -+ coex_sta->wifi_coex_thres2 = BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES2; -+ -+ coex_sta->bt_coex_thres = BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1; -+ coex_sta->bt_coex_thres2 = BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES2; -+ -+ -+ /* -+ coex_sta->wifi_coex_thres = interference_wl_tx + BT_8821C_2ANT_WIFI_SIR_THRES1; -+ coex_sta->wifi_coex_thres2 = interference_wl_tx + BT_8821C_2ANT_WIFI_SIR_THRES2; -+ -+ coex_sta->bt_coex_thres = interference_bt_tx + BT_8821C_2ANT_BT_SIR_THRES1; -+ coex_sta->bt_coex_thres2 = interference_bt_tx + BT_8821C_2ANT_BT_SIR_THRES2; -+ */ -+ -+ -+ -+ -+ -+ /* -+ if ( BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - -+ BT_8821C_2ANT_DEFAULT_ISOLATION) ) -+ coex_sta->wifi_coex_thres = BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; -+ else -+ coex_sta->wifi_coex_thres = BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - -+ BT_8821C_2ANT_DEFAULT_ISOLATION); -+ -+ if ( BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - -+ BT_8821C_2ANT_DEFAULT_ISOLATION) ) -+ coex_sta->bt_coex_thres = BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1; -+ else -+ coex_sta->bt_coex_thres = BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - -+ BT_8821C_2ANT_DEFAULT_ISOLATION); -+ -+ */ -+} -+ -+ -+void halbtc8821c2ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+} -+ -+void halbtc8821c2ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ coex_sta->c2h_bt_info_req_sent = true; -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+} -+ -+void halbtc8821c2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ static u8 num_of_bt_counter_chk = 0, cnt_slave = 0; -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+ -+ if ((coex_sta->low_priority_tx > 1050) && -+ (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->pop_event_cnt++; -+ -+ if ((coex_sta->low_priority_rx >= 950) && (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) -+ && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist)) { -+ if (cnt_slave >= 2) { -+ bt_link_info->slave_role = true; -+ cnt_slave = 2; -+ } else -+ cnt_slave++; -+ } else { -+ if (cnt_slave == 0) { -+ bt_link_info->slave_role = false; -+ cnt_slave = 0; -+ } else -+ cnt_slave--; -+ -+ } -+ -+ if ((coex_sta->high_priority_tx == 0) && (coex_sta->high_priority_rx == 0) && (coex_sta->low_priority_tx == 0) && -+ (coex_sta->low_priority_rx == 0)) { -+ num_of_bt_counter_chk++; -+ if (num_of_bt_counter_chk >= 3) { -+ halbtc8821c2ant_query_bt_info(btcoexist); -+ num_of_bt_counter_chk = 0; -+ } -+ } -+ -+} -+ -+void halbtc8821c2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -+{ -+ -+ -+ if (coex_sta->under_ips) { -+ coex_sta->crc_ok_cck = 0; -+ coex_sta->crc_ok_11g = 0; -+ coex_sta->crc_ok_11n = 0; -+ coex_sta->crc_ok_11n_agg = 0; -+ -+ coex_sta->crc_err_cck = 0; -+ coex_sta->crc_err_11g = 0; -+ coex_sta->crc_err_11n = 0; -+ coex_sta->crc_err_11n_agg = 0; -+ } else { -+ coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, -+ 0xf88); -+ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf94); -+ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf90); -+ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xfb8); -+ -+ coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, -+ 0xf84); -+ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf96); -+ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf92); -+ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xfba); -+ } -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); -+} -+ -+ -+boolean halbtc8821c2ant_is_wifibt_status_changed(IN struct btc_coexist *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false, pre_bt_off = false; -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (coex_sta->bt_disabled != pre_bt_off) { -+ pre_bt_off = coex_sta->bt_disabled; -+ -+ if (coex_sta->bt_disabled) -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ else -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->bt_coex_supported_feature = 0; -+ coex_sta->bt_coex_supported_version = 0; -+ return true; -+ } -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ -+ } -+ -+ return false; -+} -+ -+void halbtc8821c2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ bt_link_info->acl_busy = coex_sta->acl_busy; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+} -+ -+void halbtc8821c2ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ h2c_parameter[0] = -+ 0x1; /* enable BT AFH skip WL channel for 8821c because BT Rx LO interference */ -+ /* h2c_parameter[0] = 0x0; */ -+ h2c_parameter[1] = wifi_central_chnl; -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -+ -+} -+ -+void halbtc8821c2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, -+ IN u8 dac_swing_lvl) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ /* There are several type of dacswing */ -+ /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ -+ h2c_parameter[0] = dac_swing_lvl; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); -+} -+ -+void halbtc8821c2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 fw_dac_swing_lvl) -+{ -+ coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_fw_dac_swing_lvl == -+ coex_dm->cur_fw_dac_swing_lvl) -+ return; -+ } -+ -+ halbtc8821c2ant_set_fw_dac_swing_level(btcoexist, -+ coex_dm->cur_fw_dac_swing_lvl); -+ -+ coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; -+} -+ -+void halbtc8821c2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN u8 dec_bt_pwr_lvl) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = dec_bt_pwr_lvl; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); -+} -+ -+void halbtc8821c2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 dec_bt_pwr_lvl) -+{ -+ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) -+ return; -+ } -+ halbtc8821c2ant_set_fw_dec_bt_pwr(btcoexist, -+ coex_dm->cur_bt_dec_pwr_lvl); -+ -+ coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; -+} -+ -+void halbtc8821c2ant_set_fw_low_penalty_ra(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ -+ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+} -+ -+void halbtc8821c2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8821c2ant_set_fw_low_penalty_ra(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8821c2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8821c2ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8821c2ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8821c2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, -+ IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, -+ IN boolean limited_dig, IN boolean bt_lna_constrain) -+{ -+ -+ halbtc8821c2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -+} -+ -+void halbtc8821c2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, -+ IN boolean agc_table_shift, IN boolean adc_back_off, -+ IN boolean sw_dac_swing, IN u32 dac_swing_lvl) -+{ -+ /* halbtc8821c2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ -+ /* halbtc8821c2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ -+} -+ -+void halbtc8821c2ant_write_score_board( -+ IN struct btc_coexist *btcoexist, -+ IN u16 bitpos, -+ IN BOOLEAN state -+) -+{ -+ -+ static u16 originalval = 0x8002; -+ -+ if (state) -+ originalval = originalval | bitpos; -+ else -+ originalval = originalval & (~bitpos); -+ -+ -+ btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); -+ -+} -+ -+void halbtc8821c2ant_read_score_board( -+ IN struct btc_coexist *btcoexist, -+ IN u16 *score_board_val -+) -+{ -+ -+ *score_board_val = (btcoexist->btc_read_2byte(btcoexist, -+ 0xaa)) & 0x7fff; -+} -+ -+void halbtc8821c2ant_post_activestate_to_bt( -+ IN struct btc_coexist *btcoexist, -+ IN boolean wifi_active -+) -+{ -+ -+ if (wifi_active) -+ halbtc8821c2ant_write_score_board(btcoexist, (u16) BIT(0), TRUE); -+ else -+ halbtc8821c2ant_write_score_board(btcoexist, (u16) BIT(0), FALSE); -+ -+ /* The BT should set "No Shunt-down" mode if WL = Active for BT Synthesizer on/off interference WL Lo issue at 8703b b-cut. */ -+ -+} -+ -+void halbtc8821c2ant_post_onoffstate_to_bt( -+ IN struct btc_coexist *btcoexist, -+ IN boolean wifi_on -+) -+{ -+ -+ if (wifi_on) -+ halbtc8821c2ant_write_score_board(btcoexist, (u16) BIT(1), TRUE); -+ else -+ halbtc8821c2ant_write_score_board(btcoexist, (u16) BIT(1), FALSE); -+ -+} -+ -+void halbtc8821c2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ u16 u16tmp; -+ -+ /* This function check if bt is disabled */ -+#if 0 -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ -+ -+#else -+ -+ /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ -+ halbtc8821c2ant_read_score_board(btcoexist, &u16tmp); -+ -+ bt_active = u16tmp & BIT(1); -+ -+ -+#endif -+ -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ } else { -+ -+ bt_disable_cnt++; -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ bt_disable_cnt = 2; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ } -+ -+ -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ } -+ -+} -+ -+void halbtc8821c2ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, -+ boolean isenable) -+{ -+ static u8 bitVal[5] = {0,0,0,0,0}; -+ static boolean state = false; -+ -+ if (state ==isenable) -+ return; -+ else -+ state = isenable; -+ -+ if (isenable) { -+ -+ /* enable GNT_WL, GNT_BT to GPIO for debug */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); -+ -+ /* store original value */ -+ bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, 0x66) & BIT(4)) >>4; /*0x66[4] */ -+ bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, 0x67) & BIT(0)); /*0x66[8] */ -+ bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, 0x42) & BIT(3)) >> 3; /*0x40[19] */ -+ bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, 0x65) & BIT(7)) >> 7; /*0x64[15] */ -+ bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, 0x72) & BIT(2)) >> 2; /*0x70[18] */ -+ -+ /* switch GPIO Mux */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), 0x0); /*0x66[4] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), 0x0); /*0x66[8] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), 0x0); /*0x40[19] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), 0x0); /*0x64[15] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), 0x0); /*0x70[18] = 0 */ -+ -+ -+ } else { -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); -+ -+ /* Restore original value */ -+ /* switch GPIO Mux */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), bitVal[0]); /*0x66[4] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), bitVal[1]); /*0x66[8] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), bitVal[2]); /*0x40[19] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), bitVal[3]); /*0x64[15] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), bitVal[4]); /*0x70[18] = 0 */ -+ } -+ -+} -+ -+u32 halbtc8821c2ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, -+ IN u16 reg_addr) -+{ -+ u32 j = 0; -+ -+ -+ /* wait for ready bit before access 0x1700 */ -+ btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); -+ -+ do { -+ j++; -+ } while (((btcoexist->btc_read_1byte(btcoexist, -+ 0x1703)&BIT(5)) == 0) && -+ (j < BT_8821C_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); -+ -+ -+ return btcoexist->btc_read_4byte(btcoexist, -+ 0x1708); /* get read data */ -+ -+} -+ -+void halbtc8821c2ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist, -+ IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) -+{ -+ u32 val, i = 0, j = 0, bitpos = 0; -+ -+ -+ if (bit_mask == 0x0) -+ return; -+ if (bit_mask == 0xffffffff) { -+ btcoexist->btc_write_4byte(btcoexist, 0x1704, -+ reg_value); /* put write data */ -+ -+ /* wait for ready bit before access 0x1700 */ -+ do { -+ j++; -+ } while (((btcoexist->btc_read_1byte(btcoexist, -+ 0x1703)&BIT(5)) == 0) && -+ (j < BT_8821C_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); -+ -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x1700, -+ 0xc00F0000 | reg_addr); -+ } else { -+ for (i = 0; i <= 31; i++) { -+ if (((bit_mask >> i) & 0x1) == 0x1) { -+ bitpos = i; -+ break; -+ } -+ } -+ -+ /* read back register value before write */ -+ val = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, -+ reg_addr); -+ val = (val & (~bit_mask)) | (reg_value << bitpos); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x1704, -+ val); /* put write data */ -+ -+ /* wait for ready bit before access 0x7c0 */ -+ do { -+ j++; -+ } while (((btcoexist->btc_read_1byte(btcoexist, -+ 0x1703)&BIT(5)) == 0) && -+ (j < BT_8821C_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); -+ -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x1700, -+ 0xc00F0000 | reg_addr); -+ -+ } -+ -+} -+ -+void halbtc8821c2ant_ltecoex_enable(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 val; -+ -+ val = (enable) ? 1 : 0; -+ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, -+ val); /* 0x38[7] */ -+ -+} -+ -+void halbtc8821c2ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_control) -+{ -+ u8 val; -+ -+ val = (wifi_control) ? 1 : 0; -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, -+ val); /* 0x70[26] */ -+ -+} -+ -+void halbtc8821c2ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, -+ IN u8 control_block, IN boolean sw_control, IN u8 state) -+{ -+ u32 val = 0, bit_mask; -+ -+ state = state & 0x1; -+ val = (sw_control) ? ((state << 1) | 0x1) : 0; -+ -+ switch (control_block) { -+ case BT_8821C_2ANT_GNT_BLOCK_RFC_BB: -+ default: -+ bit_mask = 0xc000; -+ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[15:14] */ -+ bit_mask = 0x0c00; -+ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[11:10] */ -+ break; -+ case BT_8821C_2ANT_GNT_BLOCK_RFC: -+ bit_mask = 0xc000; -+ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[15:14] */ -+ break; -+ case BT_8821C_2ANT_GNT_BLOCK_BB: -+ bit_mask = 0x0c00; -+ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[11:10] */ -+ break; -+ -+ } -+ -+} -+ -+void halbtc8821c2ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, -+ IN u8 control_block, IN boolean sw_control, IN u8 state) -+{ -+ u32 val = 0, bit_mask; -+ -+ state = state & 0x1; -+ val = (sw_control) ? ((state << 1) | 0x1) : 0; -+ -+ switch (control_block) { -+ case BT_8821C_2ANT_GNT_BLOCK_RFC_BB: -+ default: -+ bit_mask = 0x3000; -+ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[13:12] */ -+ bit_mask = 0x0300; -+ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[9:8] */ -+ break; -+ case BT_8821C_2ANT_GNT_BLOCK_RFC: -+ bit_mask = 0x3000; -+ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[13:12] */ -+ break; -+ case BT_8821C_2ANT_GNT_BLOCK_BB: -+ bit_mask = 0x0300; -+ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[9:8] */ -+ break; -+ -+ } -+ -+} -+ -+void halbtc8821c2ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u8 table_type, IN u16 table_content) -+{ -+ u16 reg_addr = 0x0000; -+ -+ switch (table_type) { -+ case BT_8821C_2ANT_CTT_WL_VS_LTE: -+ reg_addr = 0xa0; -+ break; -+ case BT_8821C_2ANT_CTT_BT_VS_LTE: -+ reg_addr = 0xa4; -+ break; -+ } -+ -+ if (reg_addr != 0x0000) -+ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, -+ 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ -+ -+ -+} -+ -+ -+void halbtc8821c2ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, -+ IN u8 table_type, IN u8 table_content) -+{ -+ u16 reg_addr = 0x0000; -+ -+ switch (table_type) { -+ case BT_8821C_2ANT_LBTT_WL_BREAK_LTE: -+ reg_addr = 0xa8; -+ break; -+ case BT_8821C_2ANT_LBTT_BT_BREAK_LTE: -+ reg_addr = 0xac; -+ break; -+ case BT_8821C_2ANT_LBTT_LTE_BREAK_WL: -+ reg_addr = 0xb0; -+ break; -+ case BT_8821C_2ANT_LBTT_LTE_BREAK_BT: -+ reg_addr = 0xb4; -+ break; -+ } -+ -+ if (reg_addr != 0x0000) -+ halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, -+ 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ -+ -+ -+} -+ -+ -+void halbtc8821c2ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8821c2ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8821c2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8821c2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ u32 break_table; -+ u8 select_table; -+ -+ coex_sta->coex_table_type = type; -+ -+ if (coex_sta->concurrent_rx_mode_on == true) { -+ break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ -+ select_table = -+ 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ -+ } else { -+ break_table = 0xffffff; -+ select_table = 0x3; -+ } -+ -+ switch (type) { -+ case 0: -+ halbtc8821c2ant_coex_table(btcoexist, force_exec, -+ 0xffffffff, 0xffffffff, break_table, select_table); -+ break; -+ case 1: -+ halbtc8821c2ant_coex_table(btcoexist, force_exec, -+ 0xaaaaaaaa, 0xaaaaaaaa, break_table, select_table); -+ break; -+ case 2: -+ halbtc8821c2ant_coex_table(btcoexist, force_exec, -+ 0x5a5a5a5a, 0x5a5a5a5a, break_table, select_table); -+ break; -+ case 3: -+ halbtc8821c2ant_coex_table(btcoexist, force_exec, -+ 0xdafadafa, 0xdafadafa, break_table, select_table); -+ break; -+ case 4: -+ halbtc8821c2ant_coex_table(btcoexist, force_exec, -+ 0xddffddff, 0xffbbffbb, break_table, select_table); -+ break; -+ case 5: -+ halbtc8821c2ant_coex_table(btcoexist, force_exec, -+ 0x5fff5fff, 0x5fff5fff, break_table, select_table); -+ break; -+ case 6: -+ halbtc8821c2ant_coex_table(btcoexist, force_exec, -+ 0x55ff55ff, 0x5a5a5a5a, break_table, select_table); -+ break; -+ case 7: -+ halbtc8821c2ant_coex_table(btcoexist, force_exec, -+ 0x5aff55ff, 0x5a7a5a7a, break_table, select_table); -+ break; -+ case 8: -+ halbtc8821c2ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0xaaaaaaaa, break_table, select_table); -+ break; -+ default: -+ break; -+ } -+} -+ -+void halbtc8821c2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8821c2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ return; -+ } -+ halbtc8821c2ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8821c2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8821c2ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8821c2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8821c2ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ u8 h2c_parameter[5] = {0, 0, 0, 0x40, 0}; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ /*halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); */ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ /*halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8);*/ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+void halbtc8821c2ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ case BTC_PS_LPS_ON: -+ halbtc8821c2ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8821c2ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ coex_sta->force_lps_on = true; -+ break; -+ case BTC_PS_LPS_OFF: -+ halbtc8821c2ant_ps_tdma_check_for_power_save_state( -+ btcoexist, false); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+ -+void halbtc8821c2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ if (ap_enable) { -+ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], FW for 1Ant AP mode\n"); -+ BTC_TRACE(trace_buf); -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ -+ halbtc8821c2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ } -+ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ -+ halbtc8821c2ant_power_save_state( -+ btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } else { -+ halbtc8821c2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ } -+ -+ -+ h2c_parameter[0] = real_byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = real_byte5; -+ -+ coex_dm->ps_tdma_para[0] = real_byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = real_byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+void halbtc8821c2ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ -+ static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+ if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) -+ psTdmaByte4Modify = 0x1; -+ else -+ psTdmaByte4Modify = 0x0; -+ -+ if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { -+ -+ force_exec = true; -+ pre_psTdmaByte4Modify = psTdmaByte4Modify; -+ } -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ return; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], %s turn %s PS TDMA, type=%d\n", -+ (force_exec ? "force to" : ""), (turn_on ? "ON" : "OFF"), type); -+ BTC_TRACE(trace_buf); -+ -+ -+ if (turn_on) { -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ } -+ -+ -+ if (turn_on) { -+ switch (type) { -+ case 1: -+ default: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x10, 0x03, 0xf1, -+ 0x14 | psTdmaByte4Modify); -+ break; -+ case 2: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x35, 0x03, 0x71, -+ 0x11 | psTdmaByte4Modify); -+ break; -+ case 3: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x3a, 0x3, 0xf1, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 4: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x21, 0x3, 0xf1, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 5: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x30, 0x3, 0xf1, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 6: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x3, 0xf1, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 7: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x25, 0x3, 0xf1, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 11: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x30, 0x03, 0x71, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 12: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x21, 0x03, 0x71, -+ 0x11 | psTdmaByte4Modify); -+ break; -+ case 13: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x1c, 0x03, 0x71, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 101: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x10, 0x03, 0x70, -+ 0x14 | psTdmaByte4Modify); -+ break; -+ case 102: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, -+ 0x35, 0x03, 0x71, -+ 0x11 | psTdmaByte4Modify); -+ break; -+ case 103: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x3a, 0x3, 0x70, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 104: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x21, 0x3, 0x70, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 105: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x30, 0x3, 0x70, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 106: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x1c, 0x3, 0x70, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ case 107: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, -+ 0x25, 0x3, 0x70, -+ 0x10 | psTdmaByte4Modify); -+ break; -+ -+ -+ } -+ } else { -+ /* disable PS tdma */ -+ switch (type) { -+ case 0: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x40, 0x0); -+ break; -+ case 1: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x48, 0x0); -+ break; -+ default: -+ halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x0, -+ 0x0, 0x0, 0x40, 0x0); -+ break; -+ } -+ } -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+void halbtc8821c2ant_set_int_block(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 pos_type) -+{ -+ u8 regval_0xcba; -+ u32 u32tmp1 = 0; -+ -+ coex_dm->cur_int_block_status = pos_type; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_int_block_status == coex_dm->cur_int_block_status) -+ return; -+ } -+ -+ coex_dm->pre_int_block_status = coex_dm->cur_int_block_status; -+ -+ regval_0xcba = btcoexist->btc_read_1byte(btcoexist, 0xcba); -+ -+ switch(pos_type){ -+ -+ case BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG: -+ regval_0xcba = regval_0xcba & (~(BIT(2)) ) | BIT(0); /* 0xcb8[16] = 1, 0xcb8[18] = 0, WL_G select BTG */ -+ break; -+ case BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG: -+ regval_0xcba = regval_0xcba & (~(BIT(2) | BIT(0)) ); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ -+ regval_0xcba = regval_0xcba | BIT(4) | BIT(5) ; /* 0xcb8[21:20] = 2b'11, WL_G @ WLAG on */ -+ regval_0xcba = regval_0xcba & (~(BIT(7)) ) | BIT(6); /* 0xcb8[23:22] = 2b'01, WL_A @ WLAG off */ -+ -+ break; -+ case BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG: -+ regval_0xcba = regval_0xcba & (~(BIT(2) | BIT(0)) ); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ -+ regval_0xcba = regval_0xcba & (~(BIT(5))) | BIT(4); /* 0xcb8[21:20] = 2b'01, WL_G @ WLAG off */ -+ regval_0xcba = regval_0xcba | BIT(6) | BIT(7); /* 0xcb8[23:22] = 2b'11, WL_A @ WLAG on */ -+ -+ break; -+ } -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcba, 0xff, regval_0xcba); -+ -+ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb8); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Int Block setup) 0xcb8 = 0x%08x **********\n", -+ u32tmp1); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+void halbtc8821c2ant_set_ext_band_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 pos_type) -+{ -+ -+#if 0 -+ boolean switch_polatiry_inverse = false; -+ u8 regval_0xcb6; -+ u32 u32tmp1 = 0, u32tmp2 = 0; -+ -+ if (!rfe_type->ext_band_switch_exist) -+ return; -+ -+ coex_dm->cur_ext_band_switch_status = pos_type; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ext_band_switch_status == coex_dm->cur_ext_band_switch_status) -+ return; -+ } -+ -+ coex_dm->pre_ext_band_switch_status = coex_dm->cur_ext_band_switch_status; -+ -+ /* swap control polarity if use different switch control polarity*/ -+ switch_polatiry_inverse = (rfe_type->ext_band_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); -+ -+ /*swap control polarity for WL_A, default polarity 0xcb4[21] = 0 && 0xcb4[23] = 1 is for WL_G */ -+ switch_polatiry_inverse = (pos_type == BT_8821C_2ANT_EXT_BAND_SWITCH_TO_WLA? ~switch_polatiry_inverse: switch_polatiry_inverse); -+ -+ regval_0xcb6 = btcoexist->btc_read_1byte(btcoexist, 0xcb6); -+ -+ /* for normal switch polrity, 0xcb4[21] =1 && 0xcb4[23] = 0 for WL_A, vice versa */ -+ regval_0xcb6 = (switch_polatiry_inverse == 1? ( (regval_0xcb6 & (~(BIT(7))) ) | BIT(5)) : ( (regval_0xcb6 & (~(BIT(5))) ) | BIT(7)) ); -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb6, 0xff, regval_0xcb6); -+ -+ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb0); -+ u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Ext Band switch setup) 0xcb0 = 0x%08x, 0xcb4 = 0x%08x**********\n", -+ u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+#endif -+ -+} -+ -+void halbtc8821c2ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ boolean switch_polatiry_inverse = false; -+ u8 regval_0xcb7 = 0, regval_0x64; -+ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ -+ if (!rfe_type->ext_ant_switch_exist) -+ return; -+ -+ coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ext_ant_switch_status == coex_dm->cur_ext_ant_switch_status) -+ return; -+ } -+ -+ coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; -+ -+ /* swap control polarity if use different switch control polarity*/ -+ /* Normal switch polarity for DPDT, 0xcb4[29:28] = 2b'01 => BTG to Main, WLG to Aux, 0xcb4[29:28] = 2b'10 => BTG to Aux, WLG to Main */ -+ /* Normal switch polarity for SPDT, 0xcb4[29:28] = 2b'01 => Ant to BTG, 0xcb4[29:28] = 2b'10 => Ant to WLG */ -+ switch_polatiry_inverse = (rfe_type->ext_ant_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); -+ -+ switch(pos_type) -+ { -+ default: -+ case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT: -+ case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE: -+ -+ break; -+ case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG: -+ switch_polatiry_inverse = (rfe_type->wlg_Locate_at_btg == 0? ~switch_polatiry_inverse: switch_polatiry_inverse); -+ break; -+ case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLA: -+ -+ break; -+ } -+ -+ -+ switch(ctrl_type) -+ { -+ default: -+ case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x77); /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ -+ -+ regval_0xcb7 = (switch_polatiry_inverse == false? 0x1 : 0x2); /* 0xcb4[29:28] = 2b'01 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, 0x30, regval_0xcb7); -+ -+ break; -+ case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x66); /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ -+ -+ regval_0xcb7 = (switch_polatiry_inverse == false? 0x2 : 0x1); /* 0xcb4[29:28] = 2b'10 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 @ GNT_BT=1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, 0x30, regval_0xcb7); -+ -+ break; -+ case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x88); /* */ -+ -+ /* no regval_0xcb7 setup required, because antenna switch control value by antenna diversity */ -+ -+ break; -+ case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x1); /* 0x4c[23] = 1 */ -+ -+ regval_0x64 = (switch_polatiry_inverse == false? 0x0 : 0x1); /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, regval_0x64); -+ break; -+ case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x0); /* 0x4c[24] = 0 */ -+ -+ /* no setup required, because antenna switch control value by BT vendor 0x1c[1:0] */ -+ break; -+ } -+ -+ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Ext Ant switch setup) 0xcb4 = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x**********\n", -+ u32tmp1, u32tmp2, u32tmp3); -+ BTC_TRACE(trace_buf); -+ -+ -+} -+ -+void halbtc8821c2ant_set_rfe_type(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+#if 0 -+ rfe_type->ext_band_switch_exist = false; -+ rfe_type->ext_band_switch_type = BT_8821C_2ANT_EXT_BAND_SWITCH_USE_SPDT; // SPDT; -+ rfe_type->ext_band_switch_ctrl_polarity = 0; -+ -+ if (rfe_type->ext_band_switch_exist) { -+ -+ /* band switch use RFE_ctrl1 (pin name: PAPE_A) and RFE_ctrl3 (pin name: LNAON_A) */ -+ -+ /* set RFE_ctrl1 as software control */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb0, 0xf0, 0x7); -+ -+ /* set RFE_ctrl3 as software control */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb1, 0xf0, 0x7); -+ -+ } -+#endif -+ -+ /* the following setup should be got from Efuse in the future */ -+ rfe_type->rfe_module_type = board_info->rfe_type; -+ -+ rfe_type->ext_ant_switch_ctrl_polarity = 0; -+ rfe_type->ext_ant_switch_diversity = false; -+ -+ switch(rfe_type->rfe_module_type) -+ { -+ case 0: -+ default: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, WLG*/ -+ rfe_type->wlg_Locate_at_btg = false; -+ /*rfe_type->ext_ant_switch_diversity = true;*/ -+ break; -+ case 1: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, WLG */ -+ rfe_type->wlg_Locate_at_btg = false; -+ break; -+ case 2: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, BTG */ -+ rfe_type->wlg_Locate_at_btg = true; -+ break; -+ case 3: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, WLG */ -+ rfe_type->wlg_Locate_at_btg = false; -+ break; -+ case 4: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, BTG */; -+ rfe_type->wlg_Locate_at_btg = true; -+ break; -+ case 5: -+ rfe_type->ext_ant_switch_exist = false; /*2-Ant, no antenna switch, WLG*/ -+ rfe_type->wlg_Locate_at_btg = false; -+ -+ } -+ -+ -+ if (rfe_type->wlg_Locate_at_btg) -+ halbtc8821c2ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); -+ else -+ halbtc8821c2ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); -+ -+ -+} -+ -+ -+void halbtc8821c2ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean force_exec, -+ IN u8 phase ) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u32 cnt_bt_cal_chk = 0; -+ boolean is_in_mp_mode = false; -+ u8 u8tmp = 0; -+ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ u16 u16tmp1 = 0; -+ -+#if BT_8821C_2ANT_ANTDET_ENABLE -+#if BT_8821C_2ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE -+ if (ant_pos_type == BTC_ANT_PATH_PTA) { -+ if ((board_info->btdm_ant_det_finish) && -+ (board_info->btdm_ant_num_by_ant_det == 2)) { -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = BTC_ANT_WIFI_AT_MAIN; -+ else -+ ant_pos_type = BTC_ANT_WIFI_AT_AUX; -+ } -+ } -+#endif -+#endif -+ -+ coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; -+ -+ if (!force_exec) { -+ if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) -+ return; -+ } -+ -+ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; -+ -+#if 1 -+ u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x38); -+ u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x54); -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u32tmp3, u8tmp, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+#endif -+ -+ -+ switch (phase) -+ { -+ case BT_8821C_2ANT_PHASE_COEX_INIT: -+ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ -+ halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8821c2ant_ltecoex_set_coex_table(btcoexist, -+ BT_8821C_2ANT_CTT_WL_VS_LTE, 0xffff); -+ -+ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8821c2ant_ltecoex_set_coex_table(btcoexist, -+ BT_8821C_2ANT_CTT_BT_VS_LTE, 0xffff); -+ -+ /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ -+ while (cnt_bt_cal_chk <= 20) { -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, -+ 0x49d); -+ cnt_bt_cal_chk++; -+ if (u8tmp & BIT(0)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ delay_ms(50); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", -+ cnt_bt_cal_chk); -+ BTC_TRACE(trace_buf); -+ break; -+ } -+ } -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8821C_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW high */ -+ halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to SW high */ -+ halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ coex_sta->run_time_state = false; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ { -+ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = BTC_ANT_WIFI_AT_MAIN; -+ else -+ ant_pos_type = BTC_ANT_WIFI_AT_AUX; -+ } -+ -+ break; -+ case BT_8821C_2ANT_PHASE_WLANONLY_INIT: -+ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ -+ halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8821c2ant_ltecoex_set_coex_table(btcoexist, -+ BT_8821C_2ANT_CTT_WL_VS_LTE, 0xffff); -+ -+ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8821c2ant_ltecoex_set_coex_table(btcoexist, -+ BT_8821C_2ANT_CTT_BT_VS_LTE, 0xffff); -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8821C_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Low */ -+ halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_2ANT_SIG_STA_SET_TO_LOW); -+ /* Set GNT_WL to SW high */ -+ halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ coex_sta->run_time_state = false; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ { -+ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = BTC_ANT_WIFI_AT_MAIN; -+ else -+ ant_pos_type = BTC_ANT_WIFI_AT_AUX; -+ } -+ -+ break; -+ case BT_8821C_2ANT_PHASE_WLAN_OFF: -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* set Path control owner to BT */ -+ halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8821C_2ANT_PCO_BTSIDE); -+ -+ /* Set Ext Ant Switch to BT control at wifi off step */ -+ halbtc8821c2ant_set_ext_ant_switch(btcoexist, -+ FORCE_EXEC, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE); -+ coex_sta->run_time_state = false; -+ break; -+ case BT_8821C_2ANT_PHASE_2G_RUNTIME: -+ -+ /* set Path control owner to WL at runtime step */ -+ halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8821C_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to PTA */ -+ halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA, -+ BT_8821C_2ANT_SIG_STA_SET_BY_HW); -+ -+ /* Set GNT_WL to PTA */ -+ halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA, -+ BT_8821C_2ANT_SIG_STA_SET_BY_HW); -+ -+ coex_sta->run_time_state = true; -+ -+ if (rfe_type->wlg_Locate_at_btg) -+ halbtc8821c2ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); -+ else -+ halbtc8821c2ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ { -+ if (rfe_type->ext_ant_switch_diversity) -+ ant_pos_type = BTC_ANT_WIFI_AT_DIVERSITY; -+ else { -+ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = BTC_ANT_WIFI_AT_MAIN; -+ else -+ ant_pos_type = BTC_ANT_WIFI_AT_AUX; -+ } -+ } -+ -+ break; -+ case BT_8821C_2ANT_PHASE_5G_RUNTIME: -+ -+ /* set Path control owner to WL at runtime step */ -+ halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8821C_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Hi */ -+ halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ /* Set GNT_WL to SW Hi */ -+ halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ coex_sta->run_time_state = true; -+ -+ halbtc8821c2ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ { -+ if (rfe_type->ext_ant_switch_diversity) -+ ant_pos_type = BTC_ANT_WIFI_AT_DIVERSITY; -+ else { -+ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = BTC_ANT_WIFI_AT_MAIN; -+ else -+ ant_pos_type = BTC_ANT_WIFI_AT_AUX; -+ } -+ } -+ -+ break; -+ case BT_8821C_2ANT_PHASE_BTMPMODE: -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* set Path control owner to WL */ -+ halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8821C_2ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to SW Hi */ -+ halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ /* Set GNT_WL to SW Lo */ -+ halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_2ANT_SIG_STA_SET_TO_LOW); -+ -+ coex_sta->run_time_state = false; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ { -+ if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) -+ ant_pos_type = BTC_ANT_WIFI_AT_MAIN; -+ else -+ ant_pos_type = BTC_ANT_WIFI_AT_AUX; -+ } -+ -+ break; -+ } -+ -+ if (phase != BT_8821C_2ANT_PHASE_WLAN_OFF) -+ { -+ switch (ant_pos_type) { -+ default: -+ case BTC_ANT_WIFI_AT_MAIN: -+ halbtc8821c2ant_set_ext_ant_switch( btcoexist, -+ force_exec, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG); -+ break; -+ case BTC_ANT_WIFI_AT_AUX: -+ halbtc8821c2ant_set_ext_ant_switch( btcoexist, -+ force_exec, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT); -+ break; -+ case BTC_ANT_WIFI_AT_DIVERSITY: -+ halbtc8821c2ant_set_ext_ant_switch( btcoexist, -+ force_exec, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE); -+ break; -+ } -+ -+ } -+#if 1 -+ u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Ant-Setup phase---%d) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ phase, u32tmp3, u8tmp, u32tmp1, u32tmp2); -+ -+ BTC_TRACE(trace_buf); -+#endif -+ -+} -+ -+ -+u8 halbtc8821c2ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8821C_2ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 0) { -+ -+ if (bt_link_info->acl_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No-Profile busy\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_ALGO_NOPROFILEBUSY; -+ } -+ } else if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP ==> A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_HID_A2DP; -+ } -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_ALGO_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP ==> HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8821C_2ANT_COEX_ALGO_HID_A2DP; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_PANEDR_HID; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+ -+ -+void halbtc8821c2ant_action_coex_all_off(IN struct btc_coexist *btcoexist) -+{ -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* fw all off */ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+} -+ -+void halbtc8821c2ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) -+{ -+ -+ /* fw all off */ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, -+ BT_8821C_2ANT_PHASE_5G_RUNTIME); -+} -+ -+void halbtc8821c2ant_action_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* fw all off */ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ coex_sta->pop_event_cnt = 0; -+} -+ -+void halbtc8821c2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ -+ boolean wifi_connected = false; -+ boolean scan = false, link = false, roam = false; -+ boolean wifi_busy = false; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (link || roam || coex_sta->wifi_is_high_pri_task) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi link/roam/hi-pri-task process + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 8); -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); -+ -+ } else if (scan) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi scan process + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 8); -+ -+ if (coex_sta->bt_create_connection) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 12); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); -+ -+ } else if (wifi_connected) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 7); -+ -+ if (wifi_busy) { -+ -+ if ((bt_link_info->a2dp_exist) && (bt_link_info->acl_busy)) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); -+ -+ } else -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi no-link + BT Inq/Page!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+} -+ -+void halbtc8821c2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist) -+{ -+ u32 u32tmp, u32tmpb; -+ u8 u8tmpa; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ -+ if ((bt_link_info->a2dp_exist) && (bt_link_info->acl_busy)) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); -+ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+} -+ -+ -+void halbtc8821c2ant_action_wifi_nonconnected(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ /* fw all off */ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw all off */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+} -+ -+void halbtc8821c2ant_action_bt_idle(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ -+ boolean wifi_connected = false; -+ boolean scan = false, link = false, roam = false; -+ boolean wifi_busy = false; -+ -+ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || link || roam) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi link process + BT Idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 7); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); -+ } else if (wifi_connected) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT Idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (wifi_busy) { -+ if (!BTC_RSSI_HIGH(bt_rssi_state2)) -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 2); -+ else -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 0); -+ } else { -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 0); -+ } -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi no-link + BT Idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+} -+ -+ -+/* SCO only or SCO+PAN(HS) */ -+void halbtc8821c2ant_action_sco(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } -+ -+ -+ /* sw mechanism */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+} -+ -+ -+void halbtc8821c2ant_action_hid(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } -+ -+ -+ /* sw mechanism */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+} -+ -+/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -+void halbtc8821c2ant_action_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); -+ else -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); -+ } else { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ -+ if (wifi_busy) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 101); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 102); -+ -+ } -+ -+ /* sw mechanism */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+} -+ -+void halbtc8821c2ant_action_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+#if 0 -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+#endif -+ -+ -+#if 1 -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 4); -+ } else { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ -+ if (wifi_busy) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 103); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 104); -+ -+ } -+ -+#endif -+ -+ -+ /* sw mechanism */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+} -+ -+ -+/* PAN(HS) only */ -+void halbtc8821c2ant_action_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ -+ } else { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } -+ -+ -+ /* sw mechanism */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+} -+ -+ -+void halbtc8821c2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); -+ -+ -+ } else { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ -+ if (wifi_busy) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 101); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 102); -+ -+ } -+ -+ -+ /* sw mechanism */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+} -+ -+ -+void halbtc8821c2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) { -+ -+ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ } else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); -+ -+ } else { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ -+ if (wifi_busy) { -+ -+ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 107); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 105); -+ } else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 106); -+ -+ } -+ -+ -+ /* sw mechanism */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+} -+ -+ -+ -+/* PAN(EDR)+A2DP */ -+void halbtc8821c2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) { -+ -+ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ } else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); -+ } else { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ -+ if (wifi_busy) { -+ -+ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 107); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 105); -+ } else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 106); -+ -+ } -+ -+ -+ /* sw mechanism */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+} -+ -+void halbtc8821c2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -+ else -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 4); -+ -+ -+ } else { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ -+ if (wifi_busy) -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 103); -+ else -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 104); -+ -+ } -+ -+ -+ /* sw mechanism */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+} -+ -+/* HID+A2DP+PAN(EDR) */ -+void halbtc8821c2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) -+{ -+ static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state, bt_rssi_state; -+ -+ static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; -+ static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; -+ u8 wifi_rssi_state2, bt_rssi_state2; -+ boolean wifi_busy = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state, 2, -+ coex_sta->wifi_coex_thres , 0); -+ -+ wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, -+ &prewifi_rssi_state2, 2, -+ coex_sta->wifi_coex_thres2 , 0); -+ -+ bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, -+ coex_sta->bt_coex_thres , 0); -+ -+ bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, -+ coex_sta->bt_coex_thres2 , 0); -+ -+ -+ if (BTC_RSSI_HIGH(wifi_rssi_state) && -+ BTC_RSSI_HIGH(bt_rssi_state)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && -+ BTC_RSSI_HIGH(bt_rssi_state2)) { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); -+ -+ coex_dm->is_switch_to_1dot5_ant = false; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ if (wifi_busy) { -+ -+ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ } else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); -+ } else { -+ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ coex_dm->is_switch_to_1dot5_ant = true; -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); -+ -+ if (wifi_busy) { -+ -+ if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 107); -+ else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 105); -+ } else -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 106); -+ } -+ -+ /* sw mechanism */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, -+ false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, -+ false, 0x18); -+ -+} -+ -+ -+ -+void halbtc8821c2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw mechanism all off */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+} -+ -+void halbtc8821c2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -+{ -+ halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); -+ halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -+ -+ /* sw mechanism all off */ -+ halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); -+ halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -+ -+ /* hw all off */ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+} -+ -+void halbtc8821c2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ u8 algorithm = 0; -+ u32 num_of_wifi_link = 0; -+ u32 wifi_link_status = 0; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean miracast_plus_bt = false; -+ boolean scan = false, link = false, roam = false, wifi_connected = false, wifi_under_5g =false; -+ -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (!coex_sta->run_time_state){ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], return for run_time_state = false !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ if (wifi_under_5g) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 5G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_action_wifi_under5g(btcoexist); -+ return; -+ } else{ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 2G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, BT_8821C_2ANT_PHASE_2G_RUNTIME); -+ } -+ -+ -+ if (coex_sta->bt_whck_test) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under WHCK TEST!!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_bt_whck_test(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled!!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_coex_all_off(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under inquiry/page scan !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_bt_inquiry(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || link || roam) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under Link Process !!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_wifi_link_process(btcoexist); -+ return; -+ } -+ -+ /* for P2P */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if ((num_of_wifi_link >= 2) || -+ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", -+ num_of_wifi_link, wifi_link_status); -+ BTC_TRACE(trace_buf); -+ -+ if (bt_link_info->bt_link_exist) -+ miracast_plus_bt = true; -+ else -+ miracast_plus_bt = false; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ halbtc8821c2ant_action_wifi_multi_port(btcoexist); -+ -+ return; -+ } else { -+ miracast_plus_bt = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ -+ -+ algorithm = halbtc8821c2ant_action_algorithm(btcoexist); -+ coex_dm->cur_algorithm = algorithm; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", -+ coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ if (!wifi_connected) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, wifi non-connected!!.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_wifi_nonconnected(btcoexist); -+ -+ } else if ((BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) || (BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, bt idle!!.\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_action_bt_idle(btcoexist); -+ -+ } else { -+ -+ if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", -+ coex_dm->pre_algorithm, coex_dm->cur_algorithm); -+ BTC_TRACE(trace_buf); -+ } -+ -+ switch (coex_dm->cur_algorithm) { -+ -+ case BT_8821C_2ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_sco(btcoexist); -+ break; -+ case BT_8821C_2ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_hid(btcoexist); -+ break; -+ case BT_8821C_2ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_a2dp(btcoexist); -+ break; -+ case BT_8821C_2ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_a2dp_pan_hs(btcoexist); -+ break; -+ case BT_8821C_2ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_pan_edr(btcoexist); -+ break; -+ case BT_8821C_2ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_pan_hs(btcoexist); -+ break; -+ case BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_pan_edr_a2dp(btcoexist); -+ break; -+ case BT_8821C_2ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_pan_edr_hid(btcoexist); -+ break; -+ case BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_hid_a2dp_pan_edr( -+ btcoexist); -+ break; -+ case BT_8821C_2ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_hid_a2dp(btcoexist); -+ break; -+ case BT_8821C_2ANT_COEX_ALGO_NOPROFILEBUSY: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = No-Profile busy.\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_bt_idle(btcoexist); -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_action_coex_all_off(btcoexist); -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+} -+ -+void halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ u8 u8tmp = 0; -+ u32 vendor; -+ u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0, u32tmp3 =0; -+ -+ -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u32tmp3, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf);; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 2Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->bt_coex_supported_feature = 0; -+ coex_sta->bt_coex_supported_version = 0; -+ -+ -+ /* 0xf0[15:12] --> Chip Cut information */ -+ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, -+ 0xf1) & 0xf0) >> 4; -+ -+ coex_sta->dis_ver_info_cnt = 0; -+ -+ /* default isolation = 15dB */ -+ coex_sta->isolation_btween_wb = BT_8821C_2ANT_DEFAULT_ISOLATION; -+ halbtc8821c2ant_coex_switch_threshold(btcoexist, coex_sta->isolation_btween_wb); -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ -+ /* BT report packet sample rate */ -+ btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); -+ -+ /* Init 0x778 = 0x1 for 2-Ant */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); -+ -+ /* Enable PTA (3-wire function form BT side) */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); -+ -+ /* Enable PTA (tx/rx signal form WiFi side) */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); -+ -+ halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, TRUE); -+ -+ /* check if WL firmware download ok */ -+ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) -+ halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, true); -+ -+ /* Enable counter statistics */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, -+ 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ -+ -+ if (wifi_only) { -+ -+ coex_sta->concurrent_rx_mode_on = false; -+ -+ /* Set Antenna Path */ -+ halbtc8821c2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_2ANT_PHASE_WLANONLY_INIT); -+ } else { -+ coex_sta->concurrent_rx_mode_on = true; -+ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); */ -+ -+ /* RF 0x1[1] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx, mask Tx only */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x2, 0x0); -+ -+ /* Set Antenna Path */ -+ halbtc8821c2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_2ANT_PHASE_COEX_INIT); -+ } -+ -+ /* WLAN_Tx by GNT_WL 0x950[29] = 0 */ -+ /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x20, 0x0); */ -+ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ halbtc8821c2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ -+ psd_scan->ant_det_is_ant_det_available = TRUE; -+ -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u32tmp3, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+u32 halbtc8821c2ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) -+{ -+ u8 j; -+ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; -+ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, -+ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, -+ 32, 23, 15, 7, 0 -+ }; -+ -+ if (val == 0) -+ return 0; -+ -+ tmp = val; -+ -+ while (1) { -+ if (tmp == 1) -+ break; -+ else { -+ tmp = (tmp >> 1); -+ shiftcount++; -+ } -+ } -+ -+ -+ val_integerd_b = shiftcount + 1; -+ -+ tmp2 = 1; -+ for (j = 1; j <= val_integerd_b; j++) -+ tmp2 = tmp2 * 2; -+ -+ tmp = (val * 100) / tmp2; -+ tindex = tmp / 5; -+ -+ if (tindex > 20) -+ tindex = 20; -+ -+ val_fractiond_b = table_fraction[tindex]; -+ -+ result = val_integerd_b * 100 - val_fractiond_b; -+ -+ return result; -+ -+ -+} -+ -+void halbtc8821c2ant_psd_show_antenna_detect_result(IN struct btc_coexist -+ *btcoexist) -+{ -+ u8 *cli_buf = btcoexist->cli_buf; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n============[Antenna Detection info] ============\n"); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->ant_det_result == 1) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", -+ "Ant Det Result", "2-Antenna (Bad-Isolation)", -+ BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else if (psd_scan->ant_det_result == 2) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "2-Antenna (Good-Isolation)", -+ BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset, -+ BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", -+ "Ant Det Result", "1-Antenna", -+ BT_8821C_2ANT_ANTDET_PSDTHRES_1ANT, -+ BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset); -+ -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", -+ "Antenna Detection Finish", -+ (board_info->btdm_ant_det_finish -+ ? "Yes" : "No")); -+ CL_PRINTF(cli_buf); -+ -+ switch (psd_scan->ant_det_result) { -+ case 0: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is not available)"); -+ break; -+ case 1: /* 2-Ant bad-isolation */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 2: /* 2-Ant good-isolation */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 3: /* 1-Ant */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is available)"); -+ break; -+ case 4: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Uncertainty result)"); -+ break; -+ case 5: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); -+ break; -+ case 6: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(WiFi is Scanning)"); -+ break; -+ case 7: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is not idle)"); -+ break; -+ case 8: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Abort by WiFi Scanning)"); -+ break; -+ case 9: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(Antenna Init is not ready)"); -+ break; -+ case 10: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is Inquiry or page)"); -+ break; -+ case 11: -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "(BT is Disabled)"); -+ break; -+ } -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Ant Detect Total Count", psd_scan->ant_det_try_count); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "Ant Detect Fail Count", psd_scan->ant_det_fail_count); -+ CL_PRINTF(cli_buf); -+ -+ if ((!board_info->btdm_ant_det_finish) && -+ (psd_scan->ant_det_result != 5)) -+ return; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", -+ (psd_scan->ant_det_result ? "ok" : "fail")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", -+ psd_scan->ant_det_bt_tx_time); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", -+ psd_scan->ant_det_bt_le_channel); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", -+ "WiFi PSD Cent-Ch/Offset/Span", -+ psd_scan->real_cent_freq, psd_scan->real_offset, -+ psd_scan->real_span); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", -+ "PSD Pre-Scan Peak Value", -+ psd_scan->ant_det_pre_psdscan_peak_val / 100); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", -+ "PSD Pre-Scan result", -+ (psd_scan->ant_det_result != 5 ? "ok" : "fail"), -+ BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->ant_det_result == 5) -+ return; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", -+ "PSD Scan Peak Value", psd_scan->ant_det_peak_val); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", -+ "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", -+ (board_info->tfbga_package) ? "Yes" : "No"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "PSD Threshold Offset", psd_scan->ant_det_thres_offset); -+ CL_PRINTF(cli_buf); -+ -+} -+ -+void halbtc8821c2ant_psd_showdata(IN struct btc_coexist *btcoexist) -+{ -+ u8 *cli_buf = btcoexist->cli_buf; -+ u32 delta_freq_per_point; -+ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n\n============[PSD info] (%d)============\n", -+ psd_scan->psd_gen_count); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->psd_gen_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); -+ CL_PRINTF(cli_buf); -+ return; -+ } -+ -+ if (psd_scan->psd_point == 0) -+ delta_freq_per_point = 0; -+ else -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* if (psd_scan->is_psd_show_max_only) */ -+ if (0) { -+ psd_rep1 = psd_scan->psd_max_value / 100; -+ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; -+ -+ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + -+ psd_scan->psd_max_value_point * delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.0%d MHz", -+ freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.%d MHz", -+ freq1, freq2); -+ -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.0%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ -+ CL_PRINTF(cli_buf); -+ } else { -+ m = psd_scan->psd_start_point; -+ n = psd_scan->psd_start_point; -+ i = 1; -+ j = 1; -+ -+ while (1) { -+ do { -+ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * -+ delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (i == 1) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.0%2d", freq1, -+ freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.%3d", freq1, -+ freq2); -+ } else if ((i % 8 == 0) || -+ (m == psd_scan->psd_stop_point)) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.000\n", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.0%2d\n", freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.%3d\n", freq1, freq2); -+ } else { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.0%2d", freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.%3d", freq1, freq2); -+ } -+ -+ i++; -+ m++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); -+ -+ -+ do { -+ psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; -+ psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * -+ 100; -+ -+ if (j == 1) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.0%d", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.%d", psd_rep1, -+ psd_rep2); -+ } else if ((j % 8 == 0) || -+ (n == psd_scan->psd_stop_point)) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.0%d\n", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.%d\n", psd_rep1, psd_rep2); -+ } else { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.0%d", psd_rep1, psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.%d", psd_rep1, psd_rep2); -+ } -+ -+ j++; -+ n++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); -+ -+ if ((m > psd_scan->psd_stop_point) || -+ (n > psd_scan->psd_stop_point)) -+ break; -+ else { -+ i = 1; -+ j = 1; -+ } -+ -+ } -+ } -+ -+ -+} -+ -+void halbtc8821c2ant_psd_maxholddata(IN struct btc_coexist *btcoexist, -+ IN u32 gen_count) -+{ -+ u32 i = 0, i_max = 0, val_max = 0; -+ -+ if (gen_count == 1) { -+ memcpy(psd_scan->psd_report_max_hold, -+ psd_scan->psd_report, -+ BT_8821C_2ANT_ANTDET_PSD_POINTS * sizeof(u32)); -+ -+ psd_scan->psd_max_value_point = 0; -+ psd_scan->psd_max_value = 0; -+ -+ } else { -+ for (i = psd_scan->psd_start_point; -+ i <= psd_scan->psd_stop_point; i++) { -+ if (psd_scan->psd_report[i] > -+ psd_scan->psd_report_max_hold[i]) -+ psd_scan->psd_report_max_hold[i] = -+ psd_scan->psd_report[i]; -+ -+ /* search Max Value */ -+ if (i == psd_scan->psd_start_point) { -+ i_max = i; -+ val_max = psd_scan->psd_report_max_hold[i]; -+ } else { -+ if (psd_scan->psd_report_max_hold[i] > -+ val_max) { -+ i_max = i; -+ val_max = psd_scan->psd_report_max_hold[i]; -+ } -+ } -+ -+ } -+ -+ psd_scan->psd_max_value_point = i_max; -+ psd_scan->psd_max_value = val_max; -+ -+ } -+ -+ -+} -+ -+u32 halbtc8821c2ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) -+{ -+ /* reg 0x808[9:0]: FFT data x */ -+ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ -+ /* reg 0x8b4[15:0]: FFT data y report */ -+ -+ u32 val = 0, psd_report = 0; -+ int k = 0; -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ -+ val &= 0xffbffc00; -+ val |= point; -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ val |= 0x00400000; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ while (1) { -+ if (k++ > BT_8821C_2ANT_ANTDET_SWEEPPOINT_DELAY) -+ break; -+ } -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); -+ -+ psd_report = val & 0x0000ffff; -+ -+ return psd_report; -+} -+ -+ -+boolean halbtc8821c2ant_psd_sweep_point(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, -+ IN u32 avgnum, IN u32 loopcnt) -+{ -+ u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; -+ u32 points1 = 0, psd_report = 0; -+ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; -+ u32 psd_center_freq = 20 * 10 ^ 6; -+ boolean outloop = false, scan , roam, is_sweep_ok = true; -+ u8 flag = 0; -+ u32 tmp = 0, u32tmp1 = 0; -+ u32 wifi_original_channel = 1; -+ -+ psd_scan->is_psd_running = true; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ do { -+ switch (flag) { -+ case 0: /* Get PSD parameters */ -+ default: -+ -+ psd_scan->psd_band_width = 40 * 1000000; -+ psd_scan->psd_point = points; -+ psd_scan->psd_start_base = points / 2; -+ psd_scan->psd_avg_num = avgnum; -+ psd_scan->real_cent_freq = cent_freq; -+ psd_scan->real_offset = offset; -+ psd_scan->real_span = span; -+ -+ -+ points1 = psd_scan->psd_point; -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* PSD point setup */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffff0fff; -+ -+ switch (psd_scan->psd_point) { -+ case 128: -+ val |= 0x0; -+ break; -+ case 256: -+ default: -+ val |= 0x00004000; -+ break; -+ case 512: -+ val |= 0x00008000; -+ break; -+ case 1024: -+ val |= 0x0000c000; -+ break; -+ } -+ -+ switch (psd_scan->psd_avg_num) { -+ case 1: -+ val |= 0x0; -+ break; -+ case 8: -+ val |= 0x00001000; -+ break; -+ case 16: -+ val |= 0x00002000; -+ break; -+ case 32: -+ default: -+ val |= 0x00003000; -+ break; -+ } -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ flag = 1; -+ break; -+ case 1: /* calculate the PSD point index from freq/offset/span */ -+ psd_center_freq = psd_scan->psd_band_width / 2 + -+ offset * (1000000); -+ -+ start_p = psd_scan->psd_start_base + (psd_center_freq - -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_start_point = start_p - -+ psd_scan->psd_start_base; -+ -+ stop_p = psd_scan->psd_start_base + (psd_center_freq + -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_stop_point = stop_p - -+ psd_scan->psd_start_base - 1; -+ -+ flag = 2; -+ break; -+ case 2: /* set RF channel/BW/Mode */ -+ -+ /* set 3-wire off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val |= 0x00300000; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val &= 0xfeffffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* Tx-pause on */ -+ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); -+ -+ /* store WiFi original channel */ -+ wifi_original_channel = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x18, 0x3ff); -+ -+ /* Set RF channel */ -+ if (cent_freq == 2484) -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, 0xe); -+ else -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, (cent_freq - 2412) / 5 + -+ 1); /* WiFi TRx Mask on */ -+ -+ /* save original RCK value */ -+ u32tmp1 = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x1d, 0xfffff); -+ -+ /* Enter debug mode */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, -+ 0x2, 0x1); -+ -+ /* Set RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, -+ 0xfffff, 0x2e); -+ -+ -+ /* Set RF mode = Rx, RF Gain = 0x320a0 */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, -+ 0xfffff, 0x320a0); -+ -+ while (1) { -+ if (k++ > BT_8821C_2ANT_ANTDET_SWEEPPOINT_DELAY) -+ break; -+ } -+ flag = 3; -+ break; -+ case 3: -+ psd_scan->psd_gen_count = 0; -+ -+ for (j = 1; j <= loopcnt; j++) { -+ -+ /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, 0xfffff, 0x320a0); */ -+ -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || roam) { -+ is_sweep_ok = false; -+ break; -+ } -+ memset(psd_scan->psd_report, 0, -+ psd_scan->psd_point * sizeof(u32)); -+ start_p = psd_scan->psd_start_point + -+ psd_scan->psd_start_base; -+ stop_p = psd_scan->psd_stop_point + -+ psd_scan->psd_start_base + 1; -+ -+ i = start_p; -+ point_index = 0; -+ -+ while (i < stop_p) { -+ if (i >= points1) -+ psd_report = -+ halbtc8821c2ant_psd_getdata( -+ btcoexist, i - points1); -+ else -+ psd_report = -+ halbtc8821c2ant_psd_getdata( -+ btcoexist, i); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Point=%d, psd_raw_data = 0x%08x\n", -+ i, psd_report); -+ BTC_TRACE(trace_buf); -+ if (psd_report == 0) -+ tmp = 0; -+ else -+ /* tmp = 20*log10((double)psd_report); */ -+ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ -+ tmp = 6 * halbtc8821c2ant_psd_log2base( -+ btcoexist, psd_report); -+ -+ n = i - psd_scan->psd_start_base; -+ psd_scan->psd_report[n] = tmp; -+ -+ -+ halbtc8821c2ant_psd_maxholddata( -+ btcoexist, j); -+ -+ i++; -+ -+ } -+ -+ psd_scan->psd_gen_count = j; -+ -+ -+ /* -+ val = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ tmp = btcoexist->btc_read_4byte(btcoexist, 0x64); -+ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "0x54 = 0x%08x, 0x67 = 0x%08x, 0x6c4 = 0x%08x\n", val, (tmp & 0xff000000) >> 24 ,u32tmp1); -+ BTC_TRACE(trace_buf); -+ */ -+ -+ } -+ -+ flag = 100; -+ break; -+ case 99: /* error */ -+ -+ outloop = true; -+ break; -+ case 100: /* recovery */ -+ -+ /* set 3-wire on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val &= 0xffcfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val |= 0x01000000; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* Tx-pause off */ -+ btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); -+ -+ /* PSD off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffbfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ /* restore RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, -+ 0xfffff, u32tmp1); -+ -+ /* Exit debug mode */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, -+ 0x2, 0x0); -+ -+ /* restore WiFi original channel */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, -+ 0x3ff, wifi_original_channel); -+ -+ outloop = true; -+ break; -+ -+ } -+ -+ } while (!outloop); -+ -+ -+ -+ psd_scan->is_psd_running = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); -+ BTC_TRACE(trace_buf); -+ return is_sweep_ok; -+ -+} -+ -+void halbtc8821c2ant_psd_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 bt_tx_time, IN u32 bt_le_channel) -+{ -+ u32 i = 0; -+ u32 wlpsd_cent_freq = 2484, wlpsd_span = 2, wlpsd_sweep_count = 50; -+ s32 wlpsd_offset = -4; -+ u8 bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33}; -+ -+ u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; -+ -+ u8 state = 0; -+ boolean outloop = false, bt_resp = false; -+ u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, -+ u32tmp, u32tmp0, u32tmp1, u32tmp2 ; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ board_info->btdm_ant_det_finish = false; -+ memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); -+ memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); -+ -+ if (board_info->tfbga_package) /* for TFBGA */ -+ psd_scan->ant_det_thres_offset = 5; -+ else -+ psd_scan->ant_det_thres_offset = 0; -+ -+ do { -+ switch (state) { -+ case 0: -+ if (bt_le_channel == 39) -+ wlpsd_cent_freq = 2484; -+ else { -+ for (i = 1; i <= 13; i++) { -+ if (bt_le_ch[i - 1] == -+ bt_le_channel) { -+ wlpsd_cent_freq = 2412 -+ + (i - 1) * 5; -+ break; -+ } -+ } -+ -+ if (i == 14) { -+ -+ BTC_SPRINTF(trace_buf, -+ BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", -+ bt_le_channel); -+ BTC_TRACE(trace_buf); -+ outloop = true; -+ break; -+ } -+ } -+ -+ wlpsd_sweep_count = bt_tx_time * 238 / -+ 100; /* bt_tx_time/0.42 */ -+ wlpsd_sweep_count = wlpsd_sweep_count / 5; -+ -+ if (wlpsd_sweep_count % 5 != 0) -+ wlpsd_sweep_count = (wlpsd_sweep_count / -+ 5 + 1) * 5; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", -+ bt_tx_time, bt_le_channel); -+ BTC_TRACE(trace_buf); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", -+ wlpsd_cent_freq, -+ wlpsd_offset, -+ wlpsd_span, -+ wlpsd_sweep_count); -+ BTC_TRACE(trace_buf); -+ -+ state = 1; -+ break; -+ case 1: /* stop coex DM & set antenna path */ -+ /* Stop Coex DM */ -+ /* -+ btcoexist->stop_coex_dm = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); -+ BTC_TRACE(trace_buf); */ -+ -+ /* Set TDMA off, */ -+ halbtc8821c2ant_ps_tdma(btcoexist, FORCE_EXEC, -+ false, 0); -+ -+ /* Set coex table */ -+ halbtc8821c2ant_coex_table_with_type(btcoexist, -+ FORCE_EXEC, 0); -+ -+ if (board_info->btdm_ant_pos == -+ BTC_ANTENNA_AT_MAIN_PORT) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); -+ -+ halbtc8821c2ant_set_ext_ant_switch( btcoexist, -+ FORCE_EXEC, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT); -+ -+ /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ -+ /* set GNT_BT to SW high */ -+ halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to SW high */ -+ halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, -+ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); -+ -+ -+ /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ -+ h2c_parameter[0] = 0x1; -+ h2c_parameter[1] = 0xd; -+ h2c_parameter[2] = 0x14; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", -+ h2c_parameter[1], -+ h2c_parameter[2]); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, -+ h2c_parameter); -+ -+ u32tmp = btcoexist->btc_read_2byte(btcoexist, 0x948); -+ u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70); -+ u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** 0x948 = 0x%x, 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Ant Det) **********\n", -+ u32tmp, u32tmp0, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ -+ state = 2; -+ break; -+ case 2: /* Pre-sweep background psd */ -+ if (!halbtc8821c2ant_psd_sweep_point(btcoexist, -+ wlpsd_cent_freq, wlpsd_offset, wlpsd_span, -+ BT_8821C_2ANT_ANTDET_PSD_POINTS, -+ BT_8821C_2ANT_ANTDET_PSD_AVGNUM, 3)) { -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ psd_scan->ant_det_result = 8; -+ state = 99; -+ break; -+ } -+ -+ psd_scan->ant_det_pre_psdscan_peak_val = -+ psd_scan->psd_max_value; -+ -+ if (psd_scan->psd_max_value > -+ (BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset) * 100) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", -+ psd_scan->psd_max_value / 100, -+ BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ BTC_TRACE(trace_buf); -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ psd_scan->ant_det_result = 5; -+ state = 99; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", -+ psd_scan->psd_max_value / 100, -+ BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND -+ + psd_scan->ant_det_thres_offset); -+ BTC_TRACE(trace_buf); -+ state = 3; -+ } -+ break; -+ case 3: -+ bt_resp = btcoexist->btc_set_bt_ant_detection( -+ btcoexist, (u8)(bt_tx_time & 0xff), -+ (u8)(bt_le_channel & 0xff)); -+ -+ if (!halbtc8821c2ant_psd_sweep_point(btcoexist, -+ wlpsd_cent_freq, wlpsd_offset, -+ wlpsd_span, -+ BT_8821C_2ANT_ANTDET_PSD_POINTS, -+ BT_8821C_2ANT_ANTDET_PSD_AVGNUM, -+ wlpsd_sweep_count)) { -+ board_info->btdm_ant_det_finish -+ = false; -+ board_info->btdm_ant_num_by_ant_det -+ = 1; -+ psd_scan->ant_det_result = 8; -+ state = 99; -+ break; -+ } -+ -+ psd_scan->ant_det_psd_scan_peak_val = -+ psd_scan->psd_max_value; -+ psd_scan->ant_det_psd_scan_peak_freq = -+ psd_scan->psd_max_value_point; -+ state = 4; -+ break; -+ case 4: -+ -+ if (psd_scan->psd_point == 0) -+ delta_freq_per_point = 0; -+ else -+ delta_freq_per_point = -+ psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ psd_rep1 = psd_scan->psd_max_value / 100; -+ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * -+ 100; -+ -+ freq = ((psd_scan->real_cent_freq - 20) * -+ 1000000 + psd_scan->psd_max_value_point -+ * delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (freq2 < 100) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", -+ freq1, freq2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_freq, -+ BT_8821C_2ANT_ANTDET_BUF_LEN, -+ "%d.0%d", freq1, freq2); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", -+ freq1, freq2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_freq, -+ BT_8821C_2ANT_ANTDET_BUF_LEN, -+ "%d.%d", freq1, freq2); -+ } -+ -+ if (psd_rep2 < 10) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.0%d dB\n", -+ psd_rep1, psd_rep2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_val, -+ BT_8821C_2ANT_ANTDET_BUF_LEN, -+ "%d.0%d", psd_rep1, psd_rep2); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.%d dB\n", -+ psd_rep1, psd_rep2); -+ BTC_TRACE(trace_buf); -+ CL_SPRINTF(psd_scan->ant_det_peak_val, -+ BT_8821C_2ANT_ANTDET_BUF_LEN, -+ "%d.%d", psd_rep1, psd_rep2); -+ } -+ -+ psd_scan->ant_det_is_btreply_available = true; -+ -+ if (bt_resp == false) { -+ psd_scan->ant_det_is_btreply_available = -+ false; -+ psd_scan->ant_det_result = 0; -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->psd_max_value > -+ (BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) -+ * 100) { -+ psd_scan->ant_det_result = 1; -+ board_info->btdm_ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 2; -+ coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->psd_max_value / 100) & 0xff; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->psd_max_value > -+ (BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION -+ + psd_scan->ant_det_thres_offset) * 100) { -+ psd_scan->ant_det_result = 2; -+ board_info->btdm_ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 2; -+ coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->psd_max_value / 100) & 0xff; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (psd_scan->psd_max_value > -+ (BT_8821C_2ANT_ANTDET_PSDTHRES_1ANT) * -+ 100) { -+ psd_scan->ant_det_result = 3; -+ board_info->btdm_ant_det_finish = true; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->psd_max_value / 100) & 0xff; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ psd_scan->ant_det_result = 4; -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ state = 99; -+ break; -+ case 99: /* restore setup */ -+ -+ /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ -+ h2c_parameter[0] = 0x0; -+ h2c_parameter[1] = 0x0; -+ h2c_parameter[2] = 0x0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", -+ h2c_parameter[1], h2c_parameter[2]); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, -+ h2c_parameter); -+ -+ /* Set Antenna Path, GNT_WL/GNT_BT control by PTA */ -+ /* Set Antenna path, switch WiFi to certain antenna port */ -+ halbtc8821c2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_2ANT_PHASE_2G_RUNTIME); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ /* Resume Coex DM */ -+ /* -+ btcoexist->stop_coex_dm = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); -+ BTC_TRACE(trace_buf); */ -+ -+ /* stimulate coex running */ -+ -+ halbtc8821c2ant_run_coexist_mechanism( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ outloop = true; -+ break; -+ } -+ -+ } while (!outloop); -+ -+ -+ -+} -+ -+void halbtc8821c2ant_psd_antenna_detection_check(IN struct btc_coexist -+ *btcoexist) -+{ -+ static u32 ant_det_count = 0, ant_det_fail_count = 0; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ boolean scan, roam; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ -+ /* psd_scan->ant_det_bt_tx_time = 20; */ -+ psd_scan->ant_det_bt_tx_time = -+ BT_8821C_2ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ -+ psd_scan->ant_det_bt_le_channel = BT_8821C_2ANT_ANTDET_BTTXCHANNEL; -+ -+ ant_det_count++; -+ -+ psd_scan->ant_det_try_count = ant_det_count; -+ -+ if (scan || roam) { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 6; -+ } else if (coex_sta->bt_disabled) { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 11; -+ } else if (coex_sta->num_of_profile >= 1) { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 7; -+ } else if ( -+ !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 9; -+ } else if (coex_sta->c2h_bt_inquiry_page) { -+ board_info->btdm_ant_det_finish = false; -+ psd_scan->ant_det_result = 10; -+ } else { -+ -+ btcoexist->stop_coex_dm = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_psd_antenna_detection(btcoexist, -+ psd_scan->ant_det_bt_tx_time, -+ psd_scan->ant_det_bt_le_channel); -+ -+ delay_ms(psd_scan->ant_det_bt_tx_time); -+ -+ btcoexist->stop_coex_dm = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); -+ BTC_TRACE(trace_buf); -+ -+ /* stimulate coex running */ -+ -+ halbtc8821c2ant_run_coexist_mechanism( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ -+ if (!board_info->btdm_ant_det_finish) -+ ant_det_fail_count++; -+ -+ psd_scan->ant_det_fail_count = ant_det_fail_count; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n", -+ psd_scan->ant_det_result, -+ psd_scan->ant_det_fail_count, -+ board_info->btdm_ant_det_finish == TRUE ? "Yes" : "No"); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8821c2ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8821c2ant_ -+ * ************************************************************ */ -+void ex_halbtc8821c2ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp = 0x0; -+ u16 u16tmp = 0x0; -+ u32 value = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Execute 8821c 2-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Ant Det Finish = %s, Ant Det Number = %d\n", -+ (board_info->btdm_ant_det_finish ? "Yes" : "No"), -+ board_info->btdm_ant_num_by_ant_det); -+ BTC_TRACE(trace_buf); -+ -+ -+ btcoexist->stop_coex_dm = true; -+ psd_scan->ant_det_is_ant_det_available = FALSE; -+ -+ /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ -+ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); -+ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); -+ -+ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ -+ -+ /* Check efuse 0xc3[6] for Single Antenna Path */ -+ if (board_info->single_ant_path == 0) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** Single Antenna, Antenna at Aux Port**********\n"); -+ BTC_TRACE(trace_buf); -+ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; -+ -+ u8tmp = 7; -+ } else if (board_info->single_ant_path == 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** Single Antenna, Antenna at Main Port**********\n"); -+ BTC_TRACE(trace_buf); -+ -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+ -+ u8tmp = 6; -+ } -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (Power On) single_ant_path = %d, btdm_ant_pos = %d **********\n", -+ board_info->single_ant_path , board_info->btdm_ant_pos); -+ BTC_TRACE(trace_buf); -+ -+ /* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at power on */ -+ if (btcoexist->chip_interface == BTC_INTF_PCI) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_USB) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_SDIO) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); -+ -+ /* Setup RF front end type */ -+ halbtc8821c2ant_set_rfe_type(btcoexist); -+ -+ /* Set Antenna Path by Efuse */ -+ halbtc8821c2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_2ANT_PHASE_COEX_INIT); -+ -+ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ -+ halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, TRUE); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", -+ halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0xcb4 (Power-On) = 0x%x / 0x%x**********\n", -+ btcoexist->btc_read_4byte(btcoexist, 0x70), btcoexist->btc_read_4byte(btcoexist, 0xcb4)); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+void ex_halbtc8821c2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ -+ -+ /* */ -+ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ -+ if (btcoexist->chip_interface == BTC_INTF_USB) { -+ /* fixed at S0 for USB interface */ -+ u8tmp |= 0x1; /* antenna inverse */ -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); -+ } else { -+ /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ -+ if (board_info->single_ant_path == 0) { -+ } else if (board_info->single_ant_path == 1) { -+ /* set to S0 */ -+ u8tmp |= 0x1; /* antenna inverse */ -+ } -+ -+ if (btcoexist->chip_interface == BTC_INTF_PCI) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, -+ u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_SDIO) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, -+ u8tmp); -+ } -+} -+ -+ -+void ex_halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ btcoexist->stop_coex_dm = false; -+ halbtc8821c2ant_init_hw_config(btcoexist, wifi_only); -+} -+ -+void ex_halbtc8821c2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = false; -+ -+ halbtc8821c2ant_action_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8821c2ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_stack_info *stack_info = &btcoexist->stack_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u16 u16tmp[4]; -+ u32 u32tmp[4]; -+ u32 fa_of_dm, fa_cck; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ static u8 pop_report_in_10s = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ if (btcoexist->stop_coex_dm) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (psd_scan->ant_det_try_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s / %d", -+ "Ant PG Num/ Mech/ Pos/ RFE", -+ board_info->pg_ant_num, board_info->btdm_ant_num, -+ (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT? "Main" : "Aux"), -+ rfe_type->rfe_module_type); -+ CL_PRINTF(cli_buf); -+ } else { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %s/ %d (%d/%d/%d)", -+ "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", -+ board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, -+ (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT ? "Main" : "Aux"), -+ rfe_type->rfe_module_type, -+ psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, -+ psd_scan->ant_det_result); -+ CL_PRINTF(cli_buf); -+ -+ if (board_info->btdm_ant_det_finish) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "Ant Det PSD Value", -+ psd_scan->ant_det_peak_val); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", -+ "BT stack/ hci ext ver", -+ ((stack_info->profile_notified) ? "Yes" : "No"), -+ stack_info->hci_version); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", -+ "Version Coex/ Fw/ Patch/ Cut", -+ glcoex_ver_date_8821c_2ant, glcoex_ver_8821c_2ant, fw_ver, -+ bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", -+ "WifibHiPri/ Ccklock/ CckEverLock", -+ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), -+ (coex_sta->cck_lock ? "Yes" : "No"), -+ (coex_sta->cck_ever_lock ? "Yes" : "No")); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ pop_report_in_10s++; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt/ popCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") -+ : ((BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, -+ coex_sta->pop_event_cnt); -+ CL_PRINTF(cli_buf); -+ -+ if (pop_report_in_10s >= 5) { -+ coex_sta->pop_event_cnt = 0; -+ pop_report_in_10s = 0; -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d / %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP/Hi-Pri", -+ bt_link_info->sco_exist, bt_link_info->hid_exist, -+ bt_link_info->pan_exist, bt_link_info->a2dp_exist, -+ bt_link_info->bt_hi_pri_link_exist); -+ CL_PRINTF(cli_buf); -+ -+ if (stack_info->profile_notified) -+ btcoexist->btc_disp_dbg_msg(btcoexist, -+ BTC_DBG_DISP_BT_LINK_INFO); -+ else { -+ bt_info_ext = coex_sta->bt_info_ext; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d/ %x/ %04x", -+ "Role/A2DP Rate/Bitpool/Feature/Ver", -+ ((bt_link_info->slave_role) ? "Slave" : "Master"), -+ (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool, -+ coex_sta->bt_coex_supported_feature, -+ coex_sta->bt_coex_supported_version); -+ CL_PRINTF(cli_buf); -+ } -+ -+ -+ for (i = 0; i < BT_INFO_SRC_8821C_2ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8821c_2ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ -+ if (btcoexist->manual_control) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms] (before Manual)============"); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms]============"); -+ -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "SM[LowPenaltyRA]", -+ coex_dm->cur_low_penalty_ra); -+ CL_PRINTF(cli_buf); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), -+ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); -+ -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "WL/BT Coex Table Type", -+ coex_sta->coex_table_type); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x778/0x6cc/IgnWlanAct", -+ u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa0); -+ u32tmp[1] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "LTE Coex Table W_L/B_L", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa8); -+ u32tmp[1] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xac); -+ u32tmp[2] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb0); -+ u32tmp[3] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "LTE Break Table W_L/B_L/L_W/L_B", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, -+ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "0x430/0x434/0x42a/0x456", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", -+ "LTE CoexOn/Path Ctrl Owner", -+ (int)((u32tmp[0] & BIT(7)) >> 7), ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "LTE 3Wire/OPMode/UART/UARTMode", -+ (int)((u32tmp[0] & BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), -+ (int)((u32tmp[0] & BIT(3)) >> 3), -+ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", -+ "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", -+ (int)((u32tmp[0] & BIT(12)) >> 12), (int)((u32tmp[0] & BIT(14)) >> 14), -+ ((u8tmp[0] & BIT(3)) ? "On" : "Off")); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", -+ (int)((u32tmp[0] & BIT(2)) >> 2), (int)((u32tmp[0] & BIT(3)) >> 3), -+ (int)((u32tmp[0] & BIT(1)) >> 1), (int)(u32tmp[0] & BIT(0))); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcba); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%04x/ 0x%04x/ 0x%02x %s", -+ "0xcb0/0xcb4/0xcb8[23:16]", -+ u32tmp[0], u32tmp[1],u8tmp[0], ( (u8tmp[0] & 0x5) == 0x1 ? "BTG": ( (u8tmp[0] & 0xf0) == 0x70? "WL_G" : "WL_A" ) )); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x4c[24:23]/0x64[0]/x4c6[4]/0x40[5]", -+ (u32tmp[0] & ( BIT(24) | BIT(23) )) >> 23 , u8tmp[2]&0x1 , (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); -+ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xc50); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s/ 0x%x", -+ "0x550/0x522/4-RxAGC/0xc50", -+ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off", u8tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xf4c); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xf08); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5d); -+ -+ fa_of_dm = (u32tmp[0] & 0xffff) + (u32tmp[1] & 0xffff); -+ -+ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", -+ u32tmp[2] & 0xffff, fa_cck, ((u32tmp[2] & 0xffff0000) >> 16), fa_of_dm); -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_OK CCK/11g/11n/11ac", -+ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, -+ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_Err CCK/11g/11n/11ac", -+ coex_sta->crc_err_cck, coex_sta->crc_err_11g, -+ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(high-pri rx/tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(low-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+ -+ halbtc8821c2ant_read_score_board(btcoexist, &u16tmp[0]); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", -+ "ScoreBoard[14:0] (from BT)", u16tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+ -+ -+void ex_halbtc8821c2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ coex_sta->under_lps = false; -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, false); -+ -+ halbtc8821c2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_2ANT_PHASE_WLAN_OFF); -+ -+ halbtc8821c2ant_action_coex_all_off(btcoexist); -+ } else if (BTC_IPS_LEAVE == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->under_ips = false; -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); -+ -+ halbtc8821c2ant_init_hw_config(btcoexist, false); -+ halbtc8821c2ant_action_init_coex_dm(btcoexist); -+ halbtc8821c2ant_query_bt_info(btcoexist); -+ } -+} -+ -+void ex_halbtc8821c2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_LPS_ENABLE == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->under_lps = true; -+ coex_sta->under_ips = false; -+ -+ if (coex_sta->force_lps_on == true) { /* LPS No-32K */ -+ /* Write WL "Active" in Score-board for PS-TDMA */ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); -+ -+ } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ -+ /* Write WL "Non-Active" in Score-board for Native-PS */ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, false); -+ -+ } -+ } else if (BTC_LPS_DISABLE == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->under_lps = false; -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); -+ } -+} -+ -+void ex_halbtc8821c2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u32 u32tmp; -+ u8 u8tmpa, u8tmpb; -+ boolean wifi_connected = false; -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN notify()\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_SCAN_START == type) //for dual band, no action for BTC_SCAN_START, the action is change to switchband_notify -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ halbtc8821c2ant_query_bt_info(btcoexist); /* this can't be removed for RF off_on event, or BT would dis-connect */ -+ -+ if (BTC_SCAN_START_2G == type) { -+ -+ if (!wifi_connected) -+ coex_sta->wifi_is_high_pri_task = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify (2G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_2ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8821c2ant_run_coexist_mechanism(btcoexist); -+ -+ } else if (BTC_SCAN_FINISH == type) { -+ -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_run_coexist_mechanism(btcoexist); -+ } -+ -+} -+ -+void ex_halbtc8821c2ant_switchband_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ if(type == BTC_SWITCH_TO_5G) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], switchband_notify --- switch to 5G\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_action_wifi_under5g(btcoexist); -+ -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], switchband_notify --- switch to 2G\n"); -+ BTC_TRACE(trace_buf); -+ -+ ex_halbtc8821c2ant_scan_notify(btcoexist, -+ BTC_SCAN_START_2G); -+ } -+} -+ -+ -+void ex_halbtc8821c2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ if ( (BTC_ASSOCIATE_5G_START == type) || (BTC_ASSOCIATE_5G_FINISH== type)) { -+ -+ if (BTC_ASSOCIATE_5G_START == type) -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], connect_notify --- 5G start\n"); -+ else -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], connect_notify --- 5G finish\n"); -+ -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_action_wifi_under5g(btcoexist); -+ return; -+ } -+ -+ -+ if (BTC_ASSOCIATE_START == type) { -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify (2G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_2ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8821c2ant_run_coexist_mechanism(btcoexist); -+ -+ coex_dm->arp_cnt = 0; -+ -+ } else if (BTC_ASSOCIATE_FINISH == type) { -+ -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify (2G)\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_run_coexist_mechanism(btcoexist); -+ } -+} -+ -+void ex_halbtc8821c2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ u8 ap_num = 0; -+ boolean wifi_under_b_mode = false, wifi_under_5g = false; -+ -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ if (wifi_under_5g) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 5G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); -+ halbtc8821c2ant_action_wifi_under5g(btcoexist); -+ return; -+ } -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA connect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); -+ -+ halbtc8821c2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_2ANT_PHASE_2G_RUNTIME); -+ -+ /* psd_scan->ant_det_is_ant_det_available = TRUE; */ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ /* Set CCK Tx/Rx high Pri except 11b mode */ -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x00); /* CCK Rx */ -+ } else { -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x10); /* CCK Rx */ -+ } -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], MEDIA disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, false); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ -+ } -+ -+ -+ halbtc8821c2ant_update_wifi_channel_info(btcoexist, type); -+} -+ -+void ex_halbtc8821c2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean under_4way = false, wifi_under_5g = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ if (wifi_under_5g) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 5G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_action_wifi_under5g(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (under_4way) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ---- under_4way!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ coex_sta->specific_pkt_period_cnt = 2; -+ -+ } else if (BTC_PACKET_ARP == type) { -+ -+ coex_dm->arp_cnt++; -+ -+ if (coex_sta->wifi_is_high_pri_task) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt); -+ BTC_TRACE(trace_buf); -+ } -+ -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } -+ -+ if (coex_sta->wifi_is_high_pri_task) -+ halbtc8821c2ant_run_coexist_mechanism(btcoexist); -+ -+} -+ -+void ex_halbtc8821c2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source = 0; -+ boolean bt_busy = false, limited_dig = false; -+ boolean wifi_connected = false; -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8821C_2ANT_MAX) -+ rsp_source = BT_INFO_SRC_8821C_2ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ if (BT_INFO_SRC_8821C_2ANT_WIFI_FW != rsp_source) { -+ -+ /* if 0xff, it means BT is under WHCK test */ -+ if (bt_info == 0xff) -+ coex_sta->bt_whck_test = true; -+ else -+ coex_sta->bt_whck_test = false; -+ -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; -+ -+ if (coex_sta->bt_retry_cnt >= 1) -+ coex_sta->pop_event_cnt++; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80) -+ coex_sta->bt_create_connection = true; -+ else -+ coex_sta->bt_create_connection = false; -+ -+ /* unit: %, value-100 to translate to unit: dBm */ -+ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) -+ coex_sta->c2h_bt_remote_name_req = true; -+ else -+ coex_sta->c2h_bt_remote_name_req = false; -+ -+ if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { -+ coex_sta->a2dp_bit_pool = -+ coex_sta->bt_info_c2h[rsp_source][6]; -+ } else -+ coex_sta->a2dp_bit_pool = 0; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9) -+ coex_sta->acl_busy = true; -+ else -+ coex_sta->acl_busy = false; -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ -+ if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) { -+ -+ /* Re-Init */ -+ if ((coex_sta->bt_info_ext & BIT(1))) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ if (wifi_connected) -+ ex_halbtc8821c2ant_media_status_notify( -+ btcoexist, BTC_MEDIA_CONNECT); -+ else -+ ex_halbtc8821c2ant_media_status_notify( -+ btcoexist, BTC_MEDIA_DISCONNECT); -+ } -+ -+ -+ /* If Ignore_WLanAct && not SetUp_Link */ -+ if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_ignore_wlan_act(btcoexist, -+ FORCE_EXEC, false); -+ } -+ } -+ -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (bt_info & BT_INFO_8821C_2ANT_B_INQ_PAGE) -+ coex_sta->c2h_bt_inquiry_page = true; -+ else -+ coex_sta->c2h_bt_inquiry_page = false; -+ } -+ -+ coex_sta->num_of_profile = 0; -+ -+ /* set link exist status */ -+ if (!(bt_info & BT_INFO_8821C_2ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (bt_info & BT_INFO_8821C_2ANT_B_FTP) { -+ coex_sta->pan_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->pan_exist = false; -+ -+ if (bt_info & BT_INFO_8821C_2ANT_B_A2DP) { -+ coex_sta->a2dp_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->a2dp_exist = false; -+ -+ if (bt_info & BT_INFO_8821C_2ANT_B_HID) { -+ coex_sta->hid_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->hid_exist = false; -+ -+ if (bt_info & BT_INFO_8821C_2ANT_B_SCO_ESCO) { -+ coex_sta->sco_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->sco_exist = false; -+ -+ } -+ -+ halbtc8821c2ant_update_bt_link_info(btcoexist); -+ -+ if (!(bt_info & BT_INFO_8821C_2ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info == -+ BT_INFO_8821C_2ANT_B_CONNECTION) { /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if ((bt_info & BT_INFO_8821C_2ANT_B_SCO_ESCO) || -+ (bt_info & BT_INFO_8821C_2ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info & BT_INFO_8821C_2ANT_B_ACL_BUSY) { -+ coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if ((BT_8821C_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8821C_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8821C_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { -+ bt_busy = true; -+ limited_dig = true; -+ } else { -+ bt_busy = false; -+ limited_dig = false; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ coex_dm->limited_dig = limited_dig; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Manual CTRL<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ halbtc8821c2ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8821c2ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_RF_ON == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wl_rf_off_on_event = true; -+ btcoexist->stop_coex_dm = false; -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, TRUE); -+ halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, TRUE); -+ } else if (BTC_RF_OFF == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_2ANT_PHASE_WLAN_OFF); -+ -+ halbtc8821c2ant_action_coex_all_off(btcoexist); -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, FALSE); -+ halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, FALSE); -+ btcoexist->stop_coex_dm = true; -+ coex_sta->wl_rf_off_on_event = false; -+ -+ } -+} -+ -+void ex_halbtc8821c2ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8821C_2ANT_PHASE_WLAN_OFF); -+ -+ ex_halbtc8821c2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+ -+ halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, FALSE); -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, FALSE); -+ halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, FALSE); -+} -+ -+void ex_halbtc8821c2ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_WIFI_PNP_SLEEP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ -+ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ -+ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ -+ coex_sta->under_ips = false; -+ coex_sta->under_lps = false; -+ -+ halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, FALSE); -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, FALSE); -+ halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, FALSE); -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8821c2ant_post_activestate_to_bt(btcoexist, TRUE); -+ halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, TRUE); -+ } -+} -+ -+void ex_halbtc8821c2ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ============== Periodical ==============\n"); -+ BTC_TRACE(trace_buf); -+ -+#if (BT_AUTO_REPORT_ONLY_8821C_2ANT == 0) -+ halbtc8821c2ant_query_bt_info(btcoexist); -+#endif -+ -+ halbtc8821c2ant_monitor_bt_ctr(btcoexist); -+ halbtc8821c2ant_monitor_wifi_ctr(btcoexist); -+ halbtc8821c2ant_monitor_bt_enable_disable(btcoexist); -+ -+ /* for 4-way, DHCP, EAPOL packet */ -+ if (coex_sta->specific_pkt_period_cnt > 0) { -+ -+ coex_sta->specific_pkt_period_cnt--; -+ -+ if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); -+ BTC_TRACE(trace_buf); -+ -+ } -+ -+ if (coex_sta->bt_coex_supported_feature == 0) -+ coex_sta->bt_coex_supported_feature = btcoexist->btc_get_bt_coex_supported_feature(btcoexist); -+ -+ if ( (coex_sta->bt_coex_supported_version == 0) && (!coex_sta->bt_disabled) ) -+ coex_sta->bt_coex_supported_version = btcoexist->btc_get_bt_coex_supported_version(btcoexist); -+ -+ if (halbtc8821c2ant_is_wifibt_status_changed(btcoexist)) -+ halbtc8821c2ant_run_coexist_mechanism(btcoexist); -+} -+ -+ -+void ex_halbtc8821c2ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n"); -+ BTC_TRACE(trace_buf); -+ -+#if BT_8821C_2ANT_ANTDET_ENABLE -+ static u32 ant_det_count = 0, ant_det_fail_count = 0; -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ /*boolean scan, roam;*/ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Call AntennaDetect()!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (seconds == 0) { -+ psd_scan->ant_det_try_count = 0; -+ psd_scan->ant_det_fail_count = 0; -+ ant_det_count = 0; -+ ant_det_fail_count = 0; -+ board_info->btdm_ant_det_finish = false; -+ board_info->btdm_ant_num_by_ant_det = 1; -+ return; -+ } -+ -+ if (!board_info->btdm_ant_det_finish) { -+ psd_scan->ant_det_inteval_count = -+ psd_scan->ant_det_inteval_count + 2; -+ -+ if (psd_scan->ant_det_inteval_count >= -+ BT_8821C_2ANT_ANTDET_RETRY_INTERVAL) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8821c2ant_psd_antenna_detection_check(btcoexist); -+ -+ if (board_info->btdm_ant_det_finish) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); -+ BTC_TRACE(trace_buf); -+ -+#if 0 -+ board_info->btdm_ant_det_finish = false; -+#endif -+ -+#if 0 -+ if (board_info->btdm_ant_num_by_ant_det == 2) -+ halbtc8821c2ant_mechanism_switch( -+ btcoexist, true); -+ else -+ halbtc8821c2ant_mechanism_switch( -+ btcoexist, false); -+#endif -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ psd_scan->ant_det_inteval_count = 0; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", -+ psd_scan->ant_det_inteval_count); -+ BTC_TRACE(trace_buf); -+ } -+ -+ } -+#endif -+ -+ -+} -+ -+ -+void ex_halbtc8821c2ant_display_ant_detection(IN struct btc_coexist *btcoexist) -+{ -+ -+#if BT_8821C_2ANT_ANTDET_ENABLE -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ if (psd_scan->ant_det_try_count != 0) { -+ halbtc8821c2ant_psd_show_antenna_detect_result(btcoexist); -+ -+ if (board_info->btdm_ant_det_finish) -+ halbtc8821c2ant_psd_showdata(btcoexist); -+ return; -+ } -+#endif -+ -+} -+ -+ -+#endif -+ -+#endif /* #if (RTL8821C_SUPPORT == 1) */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/halbtc8821c2ant.h 2018-02-11 21:44:27.150146132 +0200 -@@ -0,0 +1,433 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8821C_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8821C 2Ant BT Co-exist definition -+ * ******************************************* */ -+#define BT_AUTO_REPORT_ONLY_8821C_2ANT 1 -+ -+ -+#define BT_INFO_8821C_2ANT_B_FTP BIT(7) -+#define BT_INFO_8821C_2ANT_B_A2DP BIT(6) -+#define BT_INFO_8821C_2ANT_B_HID BIT(5) -+#define BT_INFO_8821C_2ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8821C_2ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8821C_2ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8821C_2ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8821C_2ANT_B_CONNECTION BIT(0) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT 2 -+ -+ -+#define BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 80 /* unit: % WiFi RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 42 */ -+#define BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1 80 /* unit: % BT RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 46 */ -+#define BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES2 80 /* unit: % WiFi RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 42 */ -+#define BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES2 80 /* unit: % BT RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 46 */ -+#define BT_8821C_2ANT_DEFAULT_ISOLATION 15 /* unit: dB */ -+#define BT_8821C_2ANT_WIFI_MAX_TX_POWER 15 /* unit: dBm */ -+#define BT_8821C_2ANT_BT_MAX_TX_POWER 3 /* unit: dBm */ -+#define BT_8821C_2ANT_WIFI_SIR_THRES1 -15 /* unit: dB */ -+#define BT_8821C_2ANT_WIFI_SIR_THRES2 -30 /* unit: dB */ -+#define BT_8821C_2ANT_BT_SIR_THRES1 -15 /* unit: dB */ -+#define BT_8821C_2ANT_BT_SIR_THRES2 -30 /* unit: dB */ -+ -+ -+/* for Antenna detection */ -+#define BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND 50 -+#define BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -+#define BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 52 -+#define BT_8821C_2ANT_ANTDET_PSDTHRES_1ANT 40 -+#define BT_8821C_2ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -+#define BT_8821C_2ANT_ANTDET_SWEEPPOINT_DELAY 40000 -+#define BT_8821C_2ANT_ANTDET_ENABLE 0 -+#define BT_8821C_2ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 -+#define BT_8821C_2ANT_ANTDET_BTTXTIME 100 -+#define BT_8821C_2ANT_ANTDET_BTTXCHANNEL 39 -+ -+#define BT_8821C_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 -+ -+enum bt_8821c_2ant_signal_state { -+ BT_8821C_2ANT_SIG_STA_SET_TO_LOW = 0x0, -+ BT_8821C_2ANT_SIG_STA_SET_BY_HW = 0x0, -+ BT_8821C_2ANT_SIG_STA_SET_TO_HIGH = 0x1, -+ BT_8821C_2ANT_SIG_STA_MAX -+}; -+ -+enum bt_8821c_2ant_path_ctrl_owner { -+ BT_8821C_2ANT_PCO_BTSIDE = 0x0, -+ BT_8821C_2ANT_PCO_WLSIDE = 0x1, -+ BT_8821C_2ANT_PCO_MAX -+}; -+ -+enum bt_8821c_2ant_gnt_ctrl_type { -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, -+ BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW = 0x1, -+ BT_8821C_2ANT_GNT_TYPE_MAX -+}; -+ -+enum bt_8821c_2ant_gnt_ctrl_block { -+ BT_8821C_2ANT_GNT_BLOCK_RFC_BB = 0x0, -+ BT_8821C_2ANT_GNT_BLOCK_RFC = 0x1, -+ BT_8821C_2ANT_GNT_BLOCK_BB = 0x2, -+ BT_8821C_2ANT_GNT_BLOCK_MAX -+}; -+ -+enum bt_8821c_2ant_lte_coex_table_type { -+ BT_8821C_2ANT_CTT_WL_VS_LTE = 0x0, -+ BT_8821C_2ANT_CTT_BT_VS_LTE = 0x1, -+ BT_8821C_2ANT_CTT_MAX -+}; -+ -+enum bt_8821c_2ant_lte_break_table_type { -+ BT_8821C_2ANT_LBTT_WL_BREAK_LTE = 0x0, -+ BT_8821C_2ANT_LBTT_BT_BREAK_LTE = 0x1, -+ BT_8821C_2ANT_LBTT_LTE_BREAK_WL = 0x2, -+ BT_8821C_2ANT_LBTT_LTE_BREAK_BT = 0x3, -+ BT_8821C_2ANT_LBTT_MAX -+}; -+ -+enum bt_info_src_8821c_2ant { -+ BT_INFO_SRC_8821C_2ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8821C_2ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8821C_2ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8821C_2ANT_MAX -+}; -+ -+enum bt_8821c_2ant_bt_status { -+ BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8821C_2ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8821C_2ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8821C_2ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8821C_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8821C_2ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8821c_2ant_coex_algo { -+ BT_8821C_2ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8821C_2ANT_COEX_ALGO_SCO = 0x1, -+ BT_8821C_2ANT_COEX_ALGO_HID = 0x2, -+ BT_8821C_2ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8821C_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8821C_2ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8821C_2ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8821C_2ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8821C_2ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8821C_2ANT_COEX_ALGO_NOPROFILEBUSY = 0xb, -+ BT_8821C_2ANT_COEX_ALGO_MAX -+}; -+ -+enum bt_8821c_2ant_ext_ant_switch_ctrl_type { -+ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW = 0x0, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_PTA = 0x1, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV = 0x2, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_MAC = 0x3, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT = 0x4, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_MAX -+}; -+ -+enum bt_8821c_2ant_ext_ant_switch_pos_type { -+ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT = 0x0, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG = 0x1, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLA = 0x2, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE = 0x3, -+ BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_MAX -+}; -+ -+enum bt_8821c_2ant_ext_band_switch_pos_type { -+ BT_8821C_2ANT_EXT_BAND_SWITCH_TO_WLG = 0x0, -+ BT_8821C_2ANT_EXT_BAND_SWITCH_TO_WLA = 0x1, -+ BT_8821C_2ANT_EXT_BAND_SWITCH_TO_MAX -+}; -+ -+enum bt_8821c_2ant_int_block{ -+ BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG = 0x0, -+ BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG = 0x1, -+ BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG = 0x2, -+ BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_MAX -+}; -+ -+enum bt_8821c_2ant_phase{ -+ BT_8821C_2ANT_PHASE_COEX_INIT = 0x0, -+ BT_8821C_2ANT_PHASE_WLANONLY_INIT = 0x1, -+ BT_8821C_2ANT_PHASE_WLAN_OFF = 0x2, -+ BT_8821C_2ANT_PHASE_2G_RUNTIME = 0x3, -+ BT_8821C_2ANT_PHASE_5G_RUNTIME = 0x4, -+ BT_8821C_2ANT_PHASE_BTMPMODE = 0x5, -+ BT_8821C_2ANT_PHASE_MAX -+}; -+ -+struct coex_dm_8821c_2ant { -+ /* hw setting */ -+ u32 pre_ant_pos_type; -+ u32 cur_ant_pos_type; -+ /* fw mechanism */ -+ u8 pre_bt_dec_pwr_lvl; -+ u8 cur_bt_dec_pwr_lvl; -+ u8 pre_fw_dac_swing_lvl; -+ u8 cur_fw_dac_swing_lvl; -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean reset_tdma_adjust; -+ boolean auto_tdma_adjust; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ -+ /* sw mechanism */ -+ boolean pre_rf_rx_lpf_shrink; -+ boolean cur_rf_rx_lpf_shrink; -+ u32 bt_rf_0x1e_backup; -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ boolean pre_dac_swing_on; -+ u32 pre_dac_swing_lvl; -+ boolean cur_dac_swing_on; -+ u32 cur_dac_swing_lvl; -+ boolean pre_adc_back_off; -+ boolean cur_adc_back_off; -+ boolean pre_agc_table_en; -+ boolean cur_agc_table_en; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ boolean need_recover0x948; -+ u32 backup0x948; -+ -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ boolean is_switch_to_1dot5_ant; -+ u8 switch_thres_offset; -+ u32 arp_cnt; -+ -+ u32 pre_ext_ant_switch_status; -+ u32 cur_ext_ant_switch_status; -+ -+ u8 pre_ext_band_switch_status; -+ u8 cur_ext_band_switch_status; -+ -+ u8 pre_int_block_status; -+ u8 cur_int_block_status; -+}; -+ -+struct coex_sta_8821c_2ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ u8 bt_rssi; -+ boolean bt_tx_rx_mask; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8821C_2ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8821C_2ANT_MAX]; -+ boolean bt_whck_test; -+ boolean c2h_bt_inquiry_page; -+ boolean c2h_bt_remote_name_req; -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ u32 pop_event_cnt; -+ u8 scan_ap_num; -+ -+ u32 crc_ok_cck; -+ u32 crc_ok_11g; -+ u32 crc_ok_11n; -+ u32 crc_ok_11n_agg; -+ -+ u32 crc_err_cck; -+ u32 crc_err_11g; -+ u32 crc_err_11n; -+ u32 crc_err_11n_agg; -+ -+ -+ boolean cck_lock; -+ boolean pre_ccklock; -+ boolean cck_ever_lock; -+ -+ u8 coex_table_type; -+ boolean force_lps_on; -+ -+ u8 dis_ver_info_cnt; -+ -+ u8 a2dp_bit_pool; -+ u8 cut_version; -+ -+ boolean concurrent_rx_mode_on; -+ -+ u16 score_board; -+ u8 isolation_btween_wb; /* 0~ 50 */ -+ u8 wifi_coex_thres; -+ u8 bt_coex_thres; -+ u8 wifi_coex_thres2; -+ u8 bt_coex_thres2; -+ -+ u8 num_of_profile; -+ boolean acl_busy; -+ boolean wl_rf_off_on_event; -+ boolean bt_create_connection; -+ boolean run_time_state; -+ boolean wifi_is_high_pri_task; -+ u32 specific_pkt_period_cnt; -+ u32 bt_coex_supported_feature; -+ u32 bt_coex_supported_version; -+}; -+ -+#define BT_8821C_2ANT_EXT_ANT_SWITCH_USE_DPDT 0 -+#define BT_8821C_2ANT_EXT_ANT_SWITCH_USE_SPDT 1 -+ -+#define BT_8821C_2ANT_EXT_BAND_SWITCH_USE_DPDT 0 -+#define BT_8821C_2ANT_EXT_BAND_SWITCH_USE_SPDT 1 -+ -+ -+struct rfe_type_8821c_2ant{ -+ -+ u8 rfe_module_type; -+ boolean ext_ant_switch_exist; -+ u8 ext_ant_switch_type; /* 0:DPDT, 1:SPDT */ -+ u8 ext_ant_switch_ctrl_polarity; /* iF 0: DPDT_P=0, DPDT_N=1 => BTG to Main, WL_A+G to Aux */ -+ -+ boolean ext_band_switch_exist; -+ u8 ext_band_switch_type; /* 0:DPDT, 1:SPDT */ -+ u8 ext_band_switch_ctrl_polarity; -+ -+ boolean wlg_Locate_at_btg; /* If true: WLG at BTG, If false: WLG at WLAG */ -+ -+ boolean ext_ant_switch_diversity; /* If diversity on */ -+}; -+ -+#define BT_8821C_2ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -+#define BT_8821C_2ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -+#define BT_8821C_2ANT_ANTDET_BUF_LEN 16 -+ -+struct psdscan_sta_8821c_2ant { -+ -+ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ -+ u32 ant_det_bt_tx_time; -+ u32 ant_det_pre_psdscan_peak_val; -+ boolean ant_det_is_ant_det_available; -+ u32 ant_det_psd_scan_peak_val; -+ boolean ant_det_is_btreply_available; -+ u32 ant_det_psd_scan_peak_freq; -+ -+ u8 ant_det_result; -+ u8 ant_det_peak_val[BT_8821C_2ANT_ANTDET_BUF_LEN]; -+ u8 ant_det_peak_freq[BT_8821C_2ANT_ANTDET_BUF_LEN]; -+ u32 ant_det_try_count; -+ u32 ant_det_fail_count; -+ u32 ant_det_inteval_count; -+ u32 ant_det_thres_offset; -+ -+ u32 real_cent_freq; -+ s32 real_offset; -+ u32 real_span; -+ -+ u32 psd_band_width; /* unit: Hz */ -+ u32 psd_point; /* 128/256/512/1024 */ -+ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_start_point; -+ u32 psd_stop_point; -+ u32 psd_max_value_point; -+ u32 psd_max_value; -+ u32 psd_start_base; -+ u32 psd_avg_num; /* 1/8/16/32 */ -+ u32 psd_gen_count; -+ boolean is_psd_running; -+ boolean is_psd_show_max_only; -+}; -+ -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8821c2ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c2ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8821c2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c2ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c2ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c2ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c2ant_switchband_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c2ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c2ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c2ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8821c2ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8821c2ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c2ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8821c2ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c2ant_display_coex_info(IN struct btc_coexist *btcoexist); -+void ex_halbtc8821c2ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+void ex_halbtc8821c2ant_display_ant_detection(IN struct btc_coexist *btcoexist); -+ -+ -+#else -+#define ex_halbtc8821c2ant_power_on_setting(btcoexist) -+#define ex_halbtc8821c2ant_pre_load_firmware(btcoexist) -+#define ex_halbtc8821c2ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8821c2ant_init_coex_dm(btcoexist) -+#define ex_halbtc8821c2ant_ips_notify(btcoexist, type) -+#define ex_halbtc8821c2ant_lps_notify(btcoexist, type) -+#define ex_halbtc8821c2ant_scan_notify(btcoexist, type) -+#define ex_halbtc8821c2ant_switchband_notify(btcoexist,type) -+#define ex_halbtc8821c2ant_connect_notify(btcoexist, type) -+#define ex_halbtc8821c2ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8821c2ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8821c2ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8821c2ant_rf_status_notify(btcoexist, type) -+#define ex_halbtc8821c2ant_halt_notify(btcoexist) -+#define ex_halbtc8821c2ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8821c2ant_periodical(btcoexist) -+#define ex_halbtc8821c2ant_display_coex_info(btcoexist) -+#define ex_halbtc8821c2ant_display_ant_detection(btcoexist) -+#define ex_halbtc8821c2ant_antenna_detection(btcoexist, centFreq, offset, span, seconds) -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.c 2018-02-11 21:44:27.148146101 +0200 -@@ -0,0 +1,6006 @@ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for RTL8822B Co-exist mechanism -+ * -+ * History -+ * 2012/11/15 Cosa first check in. -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include "Mp_Precomp.h" -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8822B_SUPPORT == 1) -+/* ************************************************************ -+ * Global variables, these are static variables -+ * ************************************************************ */ -+static u8 *trace_buf = &gl_btc_trace_buf[0]; -+static struct coex_dm_8822b_1ant glcoex_dm_8822b_1ant; -+static struct coex_dm_8822b_1ant *coex_dm = &glcoex_dm_8822b_1ant; -+static struct coex_sta_8822b_1ant glcoex_sta_8822b_1ant; -+static struct coex_sta_8822b_1ant *coex_sta = &glcoex_sta_8822b_1ant; -+static struct psdscan_sta_8822b_1ant gl_psd_scan_8822b_1ant; -+static struct psdscan_sta_8822b_1ant *psd_scan = &gl_psd_scan_8822b_1ant; -+static struct rfe_type_8822b_1ant gl_rfe_type_8822b_1ant; -+static struct rfe_type_8822b_1ant *rfe_type = &gl_rfe_type_8822b_1ant; -+ -+ -+ -+const char *const glbt_info_src_8822b_1ant[] = { -+ "BT Info[wifi fw]", -+ "BT Info[bt rsp]", -+ "BT Info[bt auto report]", -+}; -+ -+u32 glcoex_ver_date_8822b_1ant = 20160411; -+u32 glcoex_ver_8822b_1ant = 0x14; -+ -+/* ************************************************************ -+ * local function proto type if needed -+ * ************************************************************ -+ * ************************************************************ -+ * local function start with halbtc8822b1ant_ -+ * ************************************************************ */ -+u8 halbtc8822b1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) -+{ -+ s32 bt_rssi = 0; -+ u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; -+ -+ bt_rssi = coex_sta->bt_rssi; -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Rssi thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_bt_rssi_state; -+ } -+ -+ if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (bt_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_bt_rssi_state == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (bt_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) -+ bt_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (bt_rssi < rssi_thresh) -+ bt_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (bt_rssi < rssi_thresh1) -+ bt_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_bt_rssi_state = bt_rssi_state; -+ -+ return bt_rssi_state; -+} -+ -+u8 halbtc8822b1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, -+ IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -+{ -+ s32 wifi_rssi = 0; -+ u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ -+ if (level_num == 2) { -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else { -+ if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } else if (level_num == 3) { -+ if (rssi_thresh > rssi_thresh1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi RSSI thresh error!!\n"); -+ BTC_TRACE(trace_buf); -+ return coex_sta->pre_wifi_rssi_state[index]; -+ } -+ -+ if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) -+ || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_LOW)) { -+ if (wifi_rssi >= (rssi_thresh + -+ BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; -+ } else if ((coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_MEDIUM) || -+ (coex_sta->pre_wifi_rssi_state[index] == -+ BTC_RSSI_STATE_STAY_MEDIUM)) { -+ if (wifi_rssi >= (rssi_thresh1 + -+ BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) -+ wifi_rssi_state = BTC_RSSI_STATE_HIGH; -+ else if (wifi_rssi < rssi_thresh) -+ wifi_rssi_state = BTC_RSSI_STATE_LOW; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; -+ } else { -+ if (wifi_rssi < rssi_thresh1) -+ wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; -+ else -+ wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; -+ } -+ } -+ -+ coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; -+ -+ return wifi_rssi_state; -+} -+ -+void halbtc8822b1ant_update_ra_mask(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 dis_rate_mask) -+{ -+ coex_dm->cur_ra_mask = dis_rate_mask; -+ -+ if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, -+ &coex_dm->cur_ra_mask); -+ coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -+} -+ -+void halbtc8822b1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ -+ coex_dm->cur_arfr_type = type; -+ -+ if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { -+ switch (coex_dm->cur_arfr_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_4byte(btcoexist, 0x430, -+ coex_dm->backup_arfr_cnt1); -+ btcoexist->btc_write_4byte(btcoexist, 0x434, -+ coex_dm->backup_arfr_cnt2); -+ break; -+ case 1: -+ btcoexist->btc_get(btcoexist, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ if (wifi_under_b_mode) { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x01010101); -+ } else { -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x430, 0x0); -+ btcoexist->btc_write_4byte(btcoexist, -+ 0x434, 0x04030201); -+ } -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -+} -+ -+void halbtc8822b1ant_retry_limit(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_retry_limit_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_retry_limit_type != -+ coex_dm->cur_retry_limit_type)) { -+ switch (coex_dm->cur_retry_limit_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ coex_dm->backup_retry_limit); -+ break; -+ case 1: /* retry limit=8 */ -+ btcoexist->btc_write_2byte(btcoexist, 0x42a, -+ 0x0808); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -+} -+ -+void halbtc8822b1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ coex_dm->cur_ampdu_time_type = type; -+ -+ if (force_exec || -+ (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { -+ switch (coex_dm->cur_ampdu_time_type) { -+ case 0: /* normal mode */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ coex_dm->backup_ampdu_max_time); -+ break; -+ case 1: /* AMPDU timw = 0x38 * 32us */ -+ btcoexist->btc_write_1byte(btcoexist, 0x456, -+ 0x38); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -+} -+ -+void halbtc8822b1ant_limited_tx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, -+ IN u8 retry_limit_type, IN u8 ampdu_time_type) -+{ -+ switch (ra_mask_type) { -+ case 0: /* normal mode */ -+ halbtc8822b1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0); -+ break; -+ case 1: /* disable cck 1/2 */ -+ halbtc8822b1ant_update_ra_mask(btcoexist, force_exec, -+ 0x00000003); -+ break; -+ case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ -+ halbtc8822b1ant_update_ra_mask(btcoexist, force_exec, -+ 0x0001f1f7); -+ break; -+ default: -+ break; -+ } -+ -+ halbtc8822b1ant_auto_rate_fallback_retry(btcoexist, force_exec, -+ arfr_type); -+ halbtc8822b1ant_retry_limit(btcoexist, force_exec, retry_limit_type); -+ halbtc8822b1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -+} -+ -+/* -+1: true / don't care / don't care -+max: false / false / don't care -+7: false / true / 7 -+*/ -+ -+void halbtc8822b1ant_limited_rx(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean rej_ap_agg_pkt, -+ IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -+{ -+ boolean reject_rx_agg = rej_ap_agg_pkt; -+ boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; -+ u8 rx_agg_size = agg_buf_size; -+ -+ /* ============================================ */ -+ /* Rx Aggregation related setting */ -+ /* ============================================ */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ &reject_rx_agg); -+ /* decide BT control aggregation buf size or not */ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ &bt_ctrl_rx_agg_size); -+ /* aggregation buf size, only work when BT control Rx aggregation size. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); -+ /* real update aggregation setting */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -+ -+ -+} -+ -+void halbtc8822b1ant_query_bt_info(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ coex_sta->c2h_bt_info_req_sent = true; -+ -+ h2c_parameter[0] |= BIT(0); /* trigger */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -+} -+ -+void halbtc8822b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -+{ -+ u32 reg_hp_txrx, reg_lp_txrx, u32tmp; -+ u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; -+ static u8 num_of_bt_counter_chk = 0, cnt_slave = 0; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ -+ /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ -+ -+ if (coex_sta->under_ips) { -+ /* coex_sta->high_priority_tx = 65535; */ -+ /* coex_sta->high_priority_rx = 65535; */ -+ /* coex_sta->low_priority_tx = 65535; */ -+ /* coex_sta->low_priority_rx = 65535; */ -+ /* return; */ -+ } -+ -+ reg_hp_txrx = 0x770; -+ reg_lp_txrx = 0x774; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); -+ reg_hp_tx = u32tmp & MASKLWORD; -+ reg_hp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); -+ reg_lp_tx = u32tmp & MASKLWORD; -+ reg_lp_rx = (u32tmp & MASKHWORD) >> 16; -+ -+ coex_sta->high_priority_tx = reg_hp_tx; -+ coex_sta->high_priority_rx = reg_hp_rx; -+ coex_sta->low_priority_tx = reg_lp_tx; -+ coex_sta->low_priority_rx = reg_lp_rx; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", -+ reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); -+ BTC_TRACE(trace_buf); -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -+ -+ if ((coex_sta->low_priority_tx > 1150) && -+ (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->pop_event_cnt++; -+ -+ if ((coex_sta->low_priority_rx >= 1150) && (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) -+ && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist) ) { -+ if (cnt_slave >= 3) { -+ bt_link_info->slave_role = true; -+ cnt_slave = 3; -+ } else { -+ cnt_slave ++; -+ } -+ } else { -+ if(cnt_slave == 0) { -+ bt_link_info->slave_role = false; -+ cnt_slave = 0; -+ } else{ -+ cnt_slave--; -+ } -+ -+ } -+ -+ if ((coex_sta->high_priority_tx == 0) && (coex_sta->high_priority_rx == 0) && (coex_sta->low_priority_tx == 0) && -+ (coex_sta->low_priority_rx == 0)) { -+ num_of_bt_counter_chk++; -+ -+ if (num_of_bt_counter_chk >= 3) { -+ halbtc8822b1ant_query_bt_info(btcoexist); -+ num_of_bt_counter_chk = 0; -+ } -+ } -+#if 0 -+ /* Add Hi-Pri Tx/Rx counter to avoid false detection */ -+ if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && -+ (coex_sta->high_priority_tx + coex_sta->high_priority_rx -+ >= 160) -+ && (!coex_sta->c2h_bt_inquiry_page)) -+ coex_sta->bt_hi_pri_link_exist = true; -+ else -+ coex_sta->bt_hi_pri_link_exist = false; -+ -+ if ((coex_sta->acl_busy) && -+ (coex_sta->num_of_profile == 0)) { -+ if (coex_sta->low_priority_tx + -+ coex_sta->low_priority_rx >= 160) { -+ coex_sta->pan_exist = true; -+ coex_sta->num_of_profile++; -+ coex_sta->wrong_profile_notification++; -+ } -+ } -+#endif -+ -+} -+ -+ -+void halbtc8822b1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -+ { -+ s32 wifi_rssi = 0; -+ boolean wifi_busy = false, wifi_under_b_mode = false; -+ static u8 cck_lock_counter = 0; -+ u32 total_cnt; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE,&wifi_under_b_mode); -+ -+ if (coex_sta->under_ips) { -+ coex_sta->crc_ok_cck = 0; -+ coex_sta->crc_ok_11g = 0; -+ coex_sta->crc_ok_11n = 0; -+ coex_sta->crc_ok_11n_agg = 0; -+ -+ coex_sta->crc_err_cck = 0; -+ coex_sta->crc_err_11g = 0; -+ coex_sta->crc_err_11n = 0; -+ coex_sta->crc_err_11n_agg = 0; -+ } else { -+ coex_sta->crc_ok_cck = btcoexist->btc_read_2byte(btcoexist, -+ 0xf04); -+ coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf14); -+ coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf10); -+ coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xf0c); -+ -+ coex_sta->crc_err_cck = btcoexist->btc_read_2byte(btcoexist,0xf00) + btcoexist->btc_read_2byte(btcoexist,0xf06); -+ -+ coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, -+ 0xf16); -+ coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, -+ 0xf12); -+ coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, -+ 0xf0e); -+ } -+ -+ -+ /* reset counter */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x0); -+ -+ if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { -+ total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + -+ coex_sta->crc_ok_11n + -+ coex_sta->crc_ok_11n_agg; -+ -+ if ((coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_ACL_BUSY) || -+ (coex_dm->bt_status == -+ BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY) || -+ (coex_dm->bt_status == -+ BT_8822B_1ANT_BT_STATUS_SCO_BUSY)) { -+ if (coex_sta->crc_ok_cck > (total_cnt - -+ coex_sta->crc_ok_cck)) { -+ if (cck_lock_counter < 3) -+ cck_lock_counter++; -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ } else { -+ if (cck_lock_counter > 0) -+ cck_lock_counter--; -+ } -+ -+ if (!coex_sta->pre_ccklock) { -+ -+ if (cck_lock_counter >= 3) -+ coex_sta->cck_lock = true; -+ else -+ coex_sta->cck_lock = false; -+ } else { -+ if (cck_lock_counter == 0) -+ coex_sta->cck_lock = false; -+ else -+ coex_sta->cck_lock = true; -+ } -+ -+ if (coex_sta->cck_lock) -+ coex_sta->cck_ever_lock = true; -+ -+ coex_sta->pre_ccklock = coex_sta->cck_lock; -+ -+ -+ } -+ -+ -+boolean halbtc8822b1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) -+{ -+ static boolean pre_wifi_busy = false, pre_under_4way = false, -+ pre_bt_hs_on = false, pre_bt_off = false; -+ boolean wifi_busy = false, under_4way = false, bt_hs_on = false; -+ boolean wifi_connected = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ if (coex_sta->bt_disabled != pre_bt_off) -+ { -+ pre_bt_off = coex_sta->bt_disabled; -+ -+ if (coex_sta->bt_disabled) -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!\n"); -+ else -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is enabled !!\n"); -+ -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->bt_coex_supported_feature = 0; -+ coex_sta->bt_coex_supported_version = 0; -+ return true; -+ } -+ -+ if (wifi_connected) { -+ if (wifi_busy != pre_wifi_busy) { -+ pre_wifi_busy = wifi_busy; -+ return true; -+ } -+ if (under_4way != pre_under_4way) { -+ pre_under_4way = under_4way; -+ return true; -+ } -+ if (bt_hs_on != pre_bt_hs_on) { -+ pre_bt_hs_on = bt_hs_on; -+ return true; -+ } -+ } -+ -+ return false; -+} -+ -+void halbtc8822b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ bt_link_info->bt_link_exist = coex_sta->bt_link_exist; -+ bt_link_info->sco_exist = coex_sta->sco_exist; -+ bt_link_info->a2dp_exist = coex_sta->a2dp_exist; -+ bt_link_info->pan_exist = coex_sta->pan_exist; -+ bt_link_info->hid_exist = coex_sta->hid_exist; -+ bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; -+ bt_link_info->acl_busy = coex_sta->acl_busy; -+ -+ /* work around for HS mode. */ -+ if (bt_hs_on) { -+ bt_link_info->pan_exist = true; -+ bt_link_info->bt_link_exist = true; -+ } -+ -+ /* check if Sco only */ -+ if (bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->sco_only = true; -+ else -+ bt_link_info->sco_only = false; -+ -+ /* check if A2dp only */ -+ if (!bt_link_info->sco_exist && -+ bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->a2dp_only = true; -+ else -+ bt_link_info->a2dp_only = false; -+ -+ /* check if Pan only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist && -+ !bt_link_info->hid_exist) -+ bt_link_info->pan_only = true; -+ else -+ bt_link_info->pan_only = false; -+ -+ /* check if Hid only */ -+ if (!bt_link_info->sco_exist && -+ !bt_link_info->a2dp_exist && -+ !bt_link_info->pan_exist && -+ bt_link_info->hid_exist) -+ bt_link_info->hid_only = true; -+ else -+ bt_link_info->hid_only = false; -+} -+ -+void halbtc8822b1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_parameter[3] = {0}; -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ -+ /* only 2.4G we need to inform bt the chnl mask */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ if ((BTC_MEDIA_CONNECT == type) && -+ (wifi_central_chnl <= 14)) { -+ -+ h2c_parameter[0] = 0x1; /* enable BT AFH skip WL channel for 8822b because BT Rx LO interference */ -+ h2c_parameter[1] = wifi_central_chnl; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ h2c_parameter[2] = 0x30; -+ else -+ h2c_parameter[2] = 0x20; -+ } -+ -+ coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; -+ coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; -+ coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -+ -+} -+ -+u8 halbtc8822b1ant_action_algorithm(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean bt_hs_on = false; -+ u8 algorithm = BT_8822B_1ANT_COEX_ALGO_UNDEFINED; -+ u8 num_of_diff_profile = 0; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ -+ if (!bt_link_info->bt_link_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], No BT link exists!!!\n"); -+ BTC_TRACE(trace_buf); -+ return algorithm; -+ } -+ -+ if (bt_link_info->sco_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->hid_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->pan_exist) -+ num_of_diff_profile++; -+ if (bt_link_info->a2dp_exist) -+ num_of_diff_profile++; -+ -+ if (num_of_diff_profile == 1) { -+ if (bt_link_info->sco_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; -+ } else { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8822B_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8822B_1ANT_COEX_ALGO_A2DP; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(HS) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = PAN(EDR) only\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 2) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8822B_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; -+ } else if (bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8822B_1ANT_COEX_ALGO_HID_A2DP; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_A2DP_PANHS; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_PANEDR_A2DP; -+ } -+ } -+ } -+ } else if (num_of_diff_profile == 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8822B_1ANT_COEX_ALGO_HID; -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } else if (bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } else { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_HID_A2DP; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_HID_A2DP_PANEDR; -+ } -+ } -+ } -+ } else if (num_of_diff_profile >= 3) { -+ if (bt_link_info->sco_exist) { -+ if (bt_link_info->hid_exist && -+ bt_link_info->pan_exist && -+ bt_link_info->a2dp_exist) { -+ if (bt_hs_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); -+ BTC_TRACE(trace_buf); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = -+ BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; -+ } -+ } -+ } -+ } -+ -+ return algorithm; -+} -+ -+void halbtc8822b1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean enable_auto_report) -+{ -+ u8 h2c_parameter[1] = {0}; -+ -+ h2c_parameter[0] = 0; -+ -+ if (enable_auto_report) -+ h2c_parameter[0] |= BIT(0); -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -+} -+ -+void halbtc8822b1ant_bt_auto_report(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable_auto_report) -+{ -+ coex_dm->cur_bt_auto_report = enable_auto_report; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) -+ return; -+ } -+ halbtc8822b1ant_set_bt_auto_report(btcoexist, -+ coex_dm->cur_bt_auto_report); -+ -+ coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -+} -+ -+void halbtc8822b1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist -+ *btcoexist, IN boolean low_penalty_ra) -+{ -+ u8 h2c_parameter[6] = {0}; -+ -+ h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ -+ -+ if (low_penalty_ra) { -+ h2c_parameter[1] |= BIT(0); -+ h2c_parameter[2] = -+ 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ -+ h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ -+ h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ -+ h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -+} -+ -+void halbtc8822b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean low_penalty_ra) -+{ -+ coex_dm->cur_low_penalty_ra = low_penalty_ra; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) -+ return; -+ } -+ halbtc8822b1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, -+ coex_dm->cur_low_penalty_ra); -+ -+ coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -+} -+ -+void halbtc8822b1ant_write_score_board( -+ IN struct btc_coexist *btcoexist, -+ IN u16 bitpos, -+ IN BOOLEAN state -+) -+{ -+ -+ static u16 originalval = 0x8002; -+ -+ if (state) -+ originalval = originalval | bitpos; -+ else -+ originalval = originalval & (~bitpos); -+ -+ btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); -+} -+ -+void halbtc8822b1ant_read_score_board( -+ IN struct btc_coexist *btcoexist, -+ IN u16 *score_board_val -+) -+{ -+ -+ *score_board_val = (btcoexist->btc_read_2byte(btcoexist, -+ 0xaa)) & 0x7fff; -+} -+ -+void halbtc8822b1ant_post_activestate_to_bt( -+ IN struct btc_coexist *btcoexist, -+ IN boolean wifi_active -+) -+{ -+ -+ if (wifi_active) -+ halbtc8822b1ant_write_score_board(btcoexist, (u16) BIT(0), TRUE); -+ else -+ halbtc8822b1ant_write_score_board(btcoexist, (u16) BIT(0), FALSE); -+} -+ -+ -+void halbtc8822b1ant_post_onoffstate_to_bt( -+ IN struct btc_coexist *btcoexist, -+ IN boolean wifi_on -+) -+{ -+ -+ if (wifi_on) -+ halbtc8822b1ant_write_score_board(btcoexist, (u16) BIT(1), TRUE); -+ else -+ halbtc8822b1ant_write_score_board(btcoexist, (u16) BIT(1), FALSE); -+} -+ -+ -+void halbtc8822b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -+{ -+ static u32 bt_disable_cnt = 0; -+ boolean bt_active = true, bt_disabled = false; -+ u16 u16tmp; -+ -+ /* This function check if bt is disabled */ -+#if 1 -+ if (coex_sta->high_priority_tx == 0 && -+ coex_sta->high_priority_rx == 0 && -+ coex_sta->low_priority_tx == 0 && -+ coex_sta->low_priority_rx == 0) -+ bt_active = false; -+ if (coex_sta->high_priority_tx == 0xffff && -+ coex_sta->high_priority_rx == 0xffff && -+ coex_sta->low_priority_tx == 0xffff && -+ coex_sta->low_priority_rx == 0xffff) -+ bt_active = false; -+ -+ -+#else -+ -+ /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ -+ halbtc8822b1ant_read_score_board(btcoexist, &u16tmp); -+ -+ bt_active = u16tmp & BIT(1); -+ -+ -+#endif -+ -+ if (bt_active) { -+ bt_disable_cnt = 0; -+ bt_disabled = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ } else { -+ -+ bt_disable_cnt++; -+ if (bt_disable_cnt >= 2) { -+ bt_disabled = true; -+ bt_disable_cnt = 2; -+ } -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, -+ &bt_disabled); -+ } -+ -+ -+ if (coex_sta->bt_disabled != bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is from %s to %s!!\n", -+ (coex_sta->bt_disabled ? "disabled" : "enabled"), -+ (bt_disabled ? "disabled" : "enabled")); -+ BTC_TRACE(trace_buf); -+ coex_sta->bt_disabled = bt_disabled; -+ } -+ -+} -+ -+ -+ -+void halbtc8822b1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, -+ boolean isenable) -+{ -+ static u8 bitVal[5] = {0,0,0,0,0}; -+ static boolean state = false; -+ -+ if (state ==isenable) -+ return; -+ else -+ state = isenable; -+ -+ if (isenable) { -+ -+ /* enable GNT_WL, GNT_BT to GPIO for debug */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); -+ -+ /* store original value */ -+ bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, 0x66) & BIT(4)) >>4; /*0x66[4] */ -+ bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, 0x67) & BIT(0)); /*0x66[8] */ -+ bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, 0x42) & BIT(3)) >> 3; /*0x40[19] */ -+ bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, 0x65) & BIT(7)) >> 7; /*0x64[15] */ -+ bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, 0x72) & BIT(2)) >> 2; /*0x70[18] */ -+ -+ /* switch GPIO Mux */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), 0x0); /*0x66[4] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), 0x0); /*0x66[8] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), 0x0); /*0x40[19] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), 0x0); /*0x64[15] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), 0x0); /*0x70[18] = 0 */ -+ -+ -+ } else { -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); -+ -+ /* Restore original value */ -+ /* switch GPIO Mux */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), bitVal[0]); /*0x66[4] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), bitVal[1]); /*0x66[8] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), bitVal[2]); /*0x40[19] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), bitVal[3]); /*0x64[15] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), bitVal[4]); /*0x70[18] = 0 */ -+ } -+ -+} -+ -+ -+u32 halbtc8822b1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, -+ IN u16 reg_addr) -+{ -+ u32 j = 0; -+ -+ -+ /* wait for ready bit before access 0x1700 */ -+ btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); -+ -+ do { -+ j++; -+ } while (((btcoexist->btc_read_1byte(btcoexist, -+ 0x1703) & BIT(5)) == 0) && -+ (j < BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); -+ -+ -+ return btcoexist->btc_read_4byte(btcoexist, -+ 0x1708); /* get read data */ -+ -+} -+ -+void halbtc8822b1ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist, -+ IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) -+{ -+ u32 val, i = 0, j = 0, bitpos = 0; -+ -+ -+ if (bit_mask == 0x0) -+ return; -+ if (bit_mask == 0xffffffff) { -+ btcoexist->btc_write_4byte(btcoexist, 0x1704, -+ reg_value); /* put write data */ -+ -+ /* wait for ready bit before access 0x1700 */ -+ do { -+ j++; -+ } while (((btcoexist->btc_read_1byte(btcoexist, -+ 0x1703) & BIT(5)) == 0) && -+ (j < BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); -+ -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x1700, -+ 0xc00F0000 | reg_addr); -+ } else { -+ for (i = 0; i <= 31; i++) { -+ if (((bit_mask >> i) & 0x1) == 0x1) { -+ bitpos = i; -+ break; -+ } -+ } -+ -+ /* read back register value before write */ -+ val = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ reg_addr); -+ val = (val & (~bit_mask)) | (reg_value << bitpos); -+ -+ /* put write data value */ -+ btcoexist->btc_write_4byte(btcoexist, 0x1704, -+ val); /* put write data */ -+ -+ /* wait for ready bit before access 0x1700 */ -+ do { -+ j++; -+ } while (((btcoexist->btc_read_1byte(btcoexist, -+ 0x1703) & BIT(5)) == 0) && -+ (j < BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); -+ -+ /* write data add*/ -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x1700, -+ 0xc00F0000 | reg_addr); -+ -+ } -+ -+} -+ -+void halbtc8822b1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ u8 val; -+ -+ val = (enable) ? 1 : 0; -+ /* 0x38[7] */ -+ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, -+ val); /* 0x38[7] */ -+ -+} -+ -+ -+void halbtc8822b1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_control) -+{ -+ u8 val; -+ -+ val = (wifi_control) ? 1 : 0; -+ /* 0x70[26] */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, -+ val); /* 0x70[26] */ -+ -+} -+ -+void halbtc8822b1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, -+ IN u8 control_block, IN boolean sw_control, IN u8 state) -+{ -+ u32 val = 0, bit_mask; -+ -+ state = state & 0x1; -+ /*LTE indirect 0x38=0xccxx (sw : gnt_wl=1,sw gnt_bt=1) -+ 0x38=0xddxx (sw : gnt_bt=1 , sw gnt_wl=0) -+ 0x38=0x55xx(hw pta :gnt_wl /gnt_bt ) */ -+ val = (sw_control) ? ((state << 1) | 0x1) : 0; -+ -+ switch (control_block) { -+ case BT_8822B_1ANT_GNT_BLOCK_RFC_BB: -+ default: -+ bit_mask = 0xc000; -+ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[15:14] */ -+ bit_mask = 0x0c00; -+ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[11:10] */ -+ break; -+ case BT_8822B_1ANT_GNT_BLOCK_RFC: -+ bit_mask = 0xc000; -+ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[15:14] */ -+ break; -+ case BT_8822B_1ANT_GNT_BLOCK_BB: -+ bit_mask = 0x0c00; -+ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[11:10] */ -+ break; -+ -+ } -+ -+} -+ -+void halbtc8822b1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, -+ IN u8 control_block, IN boolean sw_control, IN u8 state) -+{ -+ u32 val = 0, bit_mask; -+ /*LTE indirect 0x38=0xccxx (sw : gnt_wl=1,sw gnt_bt=1) -+ 0x38=0xddxx (sw : gnt_bt=1 , sw gnt_wl=0) -+ 0x38=0x55xx(hw pta :gnt_wl /gnt_bt ) */ -+ -+ state = state & 0x1; -+ val = (sw_control) ? ((state << 1) | 0x1) : 0; -+ -+ switch (control_block) { -+ case BT_8822B_1ANT_GNT_BLOCK_RFC_BB: -+ default: -+ bit_mask = 0x3000; -+ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[13:12] */ -+ bit_mask = 0x0300; -+ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[9:8] */ -+ break; -+ case BT_8822B_1ANT_GNT_BLOCK_RFC: -+ bit_mask = 0x3000; -+ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[13:12] */ -+ break; -+ case BT_8822B_1ANT_GNT_BLOCK_BB: -+ bit_mask = 0x0300; -+ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, -+ 0x38, bit_mask, val); /* 0x38[9:8] */ -+ break; -+ -+ } -+ -+} -+ -+void halbtc8822b1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u8 table_type, IN u16 table_content) -+{ -+ u16 reg_addr = 0x0000; -+ -+ switch (table_type) { -+ case BT_8822B_1ANT_CTT_WL_VS_LTE: -+ reg_addr = 0xa0; -+ break; -+ case BT_8822B_1ANT_CTT_BT_VS_LTE: -+ reg_addr = 0xa4; -+ break; -+ } -+ -+ if (reg_addr != 0x0000) -+ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, -+ 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ -+ -+ -+} -+ -+ -+void halbtc8822b1ant_ltcoex_set_break_table(IN struct btc_coexist *btcoexist, -+ IN u8 table_type, IN u8 table_content) -+{ -+ u16 reg_addr = 0x0000; -+ -+ switch (table_type) { -+ case BT_8822B_1ANT_LBTT_WL_BREAK_LTE: -+ reg_addr = 0xa8; -+ break; -+ case BT_8822B_1ANT_LBTT_BT_BREAK_LTE: -+ reg_addr = 0xac; -+ break; -+ case BT_8822B_1ANT_LBTT_LTE_BREAK_WL: -+ reg_addr = 0xb0; -+ break; -+ case BT_8822B_1ANT_LBTT_LTE_BREAK_BT: -+ reg_addr = 0xb4; -+ break; -+ } -+ -+ if (reg_addr != 0x0000) -+ halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, -+ 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ -+ -+ -+} -+ -+void halbtc8822b1ant_set_coex_table(IN struct btc_coexist *btcoexist, -+ IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -+} -+ -+void halbtc8822b1ant_coex_table(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, -+ IN u32 val0x6c8, IN u8 val0x6cc) -+{ -+ coex_dm->cur_val0x6c0 = val0x6c0; -+ coex_dm->cur_val0x6c4 = val0x6c4; -+ coex_dm->cur_val0x6c8 = val0x6c8; -+ coex_dm->cur_val0x6cc = val0x6cc; -+ -+ -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && -+ (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && -+ (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && -+ (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) -+ return; -+ } -+ halbtc8822b1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, -+ val0x6cc); -+ -+ coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; -+ coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; -+ coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; -+ coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -+} -+ -+void halbtc8822b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 type) -+{ -+ u32 break_table; -+ u8 select_table; -+ -+ -+ -+ coex_sta->coex_table_type = type; -+ -+ if (coex_sta->concurrent_rx_mode_on == true) { -+ -+ break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ -+ select_table = -+ 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ -+ } else { -+ -+ break_table = 0xffffff; -+ select_table = 0x3; -+ } -+ -+ switch (type) { -+ case 0: -+ halbtc8822b1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x55555555, break_table, -+ select_table); -+ break; -+ case 1: -+ halbtc8822b1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0x5a5a5a5a, break_table, -+ select_table); -+ break; -+ case 2: -+ halbtc8822b1ant_coex_table(btcoexist, force_exec, -+ 0xaa5a5a5a, 0xaa5a5a5a, break_table, -+ select_table); -+ break; -+ case 3: -+ halbtc8822b1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0xaa5a5a5a, break_table, -+ select_table); -+ break; -+ case 4: -+ halbtc8822b1ant_coex_table(btcoexist, -+ force_exec, 0xaa555555, 0xaa5a5a5a, -+ break_table, select_table); -+ break; -+ case 5: -+ halbtc8822b1ant_coex_table(btcoexist, -+ force_exec, 0x5a5a5a5a, 0x5a5a5a5a, -+ break_table, select_table); -+ break; -+ case 6: -+ halbtc8822b1ant_coex_table(btcoexist, force_exec, -+ 0x55555555, 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 7: -+ halbtc8822b1ant_coex_table(btcoexist, force_exec, -+ 0xaaaaaaaa, 0xaaaaaaaa, break_table, -+ select_table); -+ break; -+ case 8: -+ halbtc8822b1ant_coex_table(btcoexist, force_exec, -+ 0xffffffff, 0xffffffff, break_table, -+ select_table); -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+void halbtc8822b1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean enable) -+{ -+ -+ -+ u8 h2c_parameter[1] = {0}; -+ -+ if (enable) { -+ h2c_parameter[0] |= BIT(0); /* function enable */ -+ } -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -+} -+ -+void halbtc8822b1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean enable) -+{ -+ -+ coex_dm->cur_ignore_wlan_act = enable; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ignore_wlan_act == -+ coex_dm->cur_ignore_wlan_act) -+ { -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+ return; -+ } -+ } -+ -+ halbtc8822b1ant_set_fw_ignore_wlan_act(btcoexist, enable); -+ -+ coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -+} -+ -+void halbtc8822b1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN u8 lps_val, IN u8 rpwm_val) -+{ -+ u8 lps = lps_val; -+ u8 rpwm = rpwm_val; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); -+ btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -+} -+ -+void halbtc8822b1ant_lps_rpwm(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ coex_dm->cur_lps = lps_val; -+ coex_dm->cur_rpwm = rpwm_val; -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_lps == coex_dm->cur_lps) && -+ (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) -+ return; -+ } -+ halbtc8822b1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); -+ -+ coex_dm->pre_lps = coex_dm->cur_lps; -+ coex_dm->pre_rpwm = coex_dm->cur_rpwm; -+} -+ -+void halbtc8822b1ant_ps_tdma_check_for_power_save_state( -+ IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -+{ -+ u8 lps_mode = 0x0; -+ u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); -+ -+ if (lps_mode) { /* already under LPS state */ -+ if (new_ps_state) { -+ /* keep state under LPS, do nothing. */ -+ } else { -+ /* will leave LPS state, turn off psTdma first */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+ } -+ } else { /* NO PS state */ -+ if (new_ps_state) { -+ /* will enter LPS state, turn off psTdma first */ -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+ } else { -+ /* keep state under NO PS state, do nothing. */ -+ } -+ } -+} -+ -+ -+void halbtc8822b1ant_power_save_state(IN struct btc_coexist *btcoexist, -+ IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -+{ -+ boolean low_pwr_disable = false; -+ -+ switch (ps_type) { -+ case BTC_PS_WIFI_NATIVE: -+ /* recover to original 32k low power setting */ -+ coex_sta->force_lps_on = false; -+ low_pwr_disable = false; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ case BTC_PS_LPS_ON: -+ -+ coex_sta->force_lps_on = true; -+ halbtc8822b1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, true); -+ halbtc8822b1ant_lps_rpwm(btcoexist, NORMAL_EXEC, -+ lps_val, rpwm_val); -+ /* when coex force to enter LPS, do not enter 32k low power. */ -+ low_pwr_disable = true; -+ btcoexist->btc_set(btcoexist, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ &low_pwr_disable); -+ /* power save must executed before psTdma. */ -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, -+ NULL); -+ coex_sta->force_lps_on = true; -+ break; -+ case BTC_PS_LPS_OFF: -+ -+ coex_sta->force_lps_on = false; -+ halbtc8822b1ant_ps_tdma_check_for_power_save_state( -+ btcoexist, false); -+ btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, -+ NULL); -+ coex_sta->force_lps_on = false; -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+void halbtc8822b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, -+ IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -+{ -+ u8 h2c_parameter[5] = {0}; -+ u8 real_byte1 = byte1, real_byte5 = byte5; -+ boolean ap_enable = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ -+ if (ap_enable) { -+ if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], FW for 1Ant AP mode\n"); -+ BTC_TRACE(trace_buf); -+ -+ real_byte1 &= ~BIT(4); -+ real_byte1 |= BIT(5); -+ -+ real_byte5 |= BIT(5); -+ real_byte5 &= ~BIT(6); -+ -+ halbtc8822b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ } -+ } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { -+ -+ halbtc8822b1ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, -+ 0x4); -+ } else { -+ halbtc8822b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, -+ 0x0); -+ } -+ -+ -+ h2c_parameter[0] = real_byte1; -+ h2c_parameter[1] = byte2; -+ h2c_parameter[2] = byte3; -+ h2c_parameter[3] = byte4; -+ h2c_parameter[4] = real_byte5; -+ -+ coex_dm->ps_tdma_para[0] = real_byte1; -+ coex_dm->ps_tdma_para[1] = byte2; -+ coex_dm->ps_tdma_para[2] = byte3; -+ coex_dm->ps_tdma_para[3] = byte4; -+ coex_dm->ps_tdma_para[4] = real_byte5; -+ -+ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -+} -+ -+void halbtc8822b1ant_ps_tdma(IN struct btc_coexist *btcoexist, -+ IN boolean force_exec, IN boolean turn_on, IN u8 type) -+{ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_busy = false; -+ static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; -+ static boolean pre_wifi_busy = false; -+ -+ coex_dm->cur_ps_tdma_on = turn_on; -+ coex_dm->cur_ps_tdma = type; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (wifi_busy != pre_wifi_busy) { -+ force_exec = true; -+ pre_wifi_busy = wifi_busy; -+ } -+ -+ /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -+ if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) -+ psTdmaByte4Modify = 0x1; -+ else -+ psTdmaByte4Modify = 0x0; -+ -+ if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { -+ -+ force_exec = true; -+ pre_psTdmaByte4Modify = psTdmaByte4Modify; -+ } -+ -+ if (coex_dm->cur_ps_tdma_on) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********TDMA(on, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], **********TDMA(off, %d) **********\n", -+ coex_dm->cur_ps_tdma); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if (!force_exec) { -+ if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && -+ (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) -+ { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], return for no-TDMA case change\n"); -+ BTC_TRACE(trace_buf); -+ -+ return; -+ } -+ } -+ -+ -+ if (turn_on) { -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ -+ switch (type) { -+ default: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51,0x1a, 0x1a, 0x0, 0x10); -+ break; -+ case 1: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x3a,0x03,0x11, 0x10); -+ break; -+ case 3: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x3a, 0x03, 0x10, 0x10); -+ break; -+ case 4: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x21, 0x03, 0x10, 0x10); -+ break; -+ case 5: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x15, 0x3,0x11, 0x11); -+ break; -+ case 7: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); -+ break; -+ case 8: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); -+ break; -+ case 13: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x25, 0x03, 0x10, 0x10 | psTdmaByte4Modify); -+ break; -+ case 14: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x15, 0x03, 0x10, 0x10 | psTdmaByte4Modify); -+ break; -+ case 15: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51, 0x20, 0x03, 0x10, 0x10 | psTdmaByte4Modify); -+ break; -+ case 17: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x10, 0x03, 0x11, 0x14 | psTdmaByte4Modify); -+ break;; -+ -+ case 20: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x30, 0x03,0x11, 0x10); -+ break; -+ case 22: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x25, 0x03,0x11, 0x10); -+ break; -+ case 32: -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x61, 0x35, 0x3,0x11, 0x11); -+ break; -+ case 41:/*HID*/ -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51,0x45, 0x3, 0x11, 0x11); -+ break; -+ case 42:/*A2DP*/ -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51,0x1e, 0x3, 0x10, 0x14| psTdmaByte4Modify); -+ break; -+ case 43:/*A2DP+HID*/ -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51,0x45, 0x3, 0x10, 0x14); -+ break; -+ case 44:/*A2DP+OPP old */ -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51,0x25, 0x3, 0x10, 0x10); -+ break; -+ case 45:/*OPP new -> WIFI FW check the ncuu_p ack of AP , if has no null_p ack , wifi fw will extened wifi slot */ -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51,0x3a, 0x3, 0x10, 0x10); -+ break; -+ case 46:/*A2DP+OPP new-> WIFI FW check the ncuu_p ack of AP , if has no null_p ack , wifi fw will extened wifi slot*/ -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x51,0x1a, 0x3, 0x10, 0x10); -+ break; -+ -+ } -+ } else { -+ -+ switch (type) { -+ case 0: -+ default: /* Software control, Antenna at BT side */ -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x0,0x0, 0x0, 0x0, 0x0); -+ /* -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_BT, FORCE_EXEC, false, -+ false); */ -+ break; -+ case 8: /* PTA Control */ -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x8,0x0, 0x0, 0x0, 0x0); -+ /* -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_PTA, FORCE_EXEC, false, -+ false); */ -+ break; -+ case 9: /* Software control, Antenna at WiFi side */ -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x0,0x0, 0x0, 0x0, 0x0); -+ /* -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_WIFI, FORCE_EXEC,false,false); */ -+ break; -+ case 10: /* under 5G , 0x778=1*/ -+ halbtc8822b1ant_set_fw_pstdma(btcoexist, -+ 0x0,0x0, 0x0, 0x0, 0x0); -+ -+ /* -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_WIFI5G, FORCE_EXEC, false, -+ false); */ -+ -+ break; -+ } -+ } -+ -+ -+ /* update pre state */ -+ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; -+ coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -+} -+ -+ -+void halbtc8822b1ant_sw_mechanism(IN struct btc_coexist *btcoexist, -+ IN boolean low_penalty_ra) -+{ -+ halbtc8822b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -+} -+ -+void halbtc8822b1ant_set_rfe_type(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ -+ -+ /* the following setup should be got from Efuse in the future */ -+ rfe_type->rfe_module_type = board_info->rfe_type; -+ -+ rfe_type->ext_ant_switch_ctrl_polarity = 0;; -+ -+ switch(rfe_type->rfe_module_type) -+ { -+ case 0: -+ default: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; -+ break; -+ case 1: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; -+ break; -+ case 2: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; -+ break; -+ case 3: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; -+ break; -+ case 4: -+ rfe_type->ext_ant_switch_exist = true; -+ rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SP3T; /* SP3T */; -+ break; -+ } -+ -+ -+} -+ -+ -+void halbtc8822b1ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ boolean switch_polatiry_inverse = false; -+ u8 regval_0xcbd = 0, regval_0x64; -+ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ -+ if (!rfe_type->ext_ant_switch_exist) -+ return; -+ -+ coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; -+ -+ if (!force_exec) { -+ if (coex_dm->pre_ext_ant_switch_status == coex_dm->cur_ext_ant_switch_status) -+ return; -+ } -+ -+ coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; -+ -+ /* swap control polarity if use different switch control polarity*/ -+ /* Normal switch polarity for SPDT, 0xcbd[1:0] = 2b'01 => Ant to BTG, 0xcbd[1:0] = 2b'10 => Ant to WLG */ -+ switch_polatiry_inverse = (rfe_type->ext_ant_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); -+ -+ -+ switch(pos_type) -+ { -+ default: -+ case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_BT: -+ case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE: -+ -+ break; -+ case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLG: -+ switch_polatiry_inverse = ~switch_polatiry_inverse; -+ break; -+ case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLA: -+ break; -+ } -+ -+ -+ if (rfe_type->ext_ant_switch_type == BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT) -+ { -+ switch(ctrl_type) -+ { -+ default: -+ case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x77); /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ -+ -+ regval_0xcbd = (switch_polatiry_inverse == false? 0x1 : 0x2); /* 0xcbd[1:0] = 2b'01 for no switch_polatiry_inverse, ANTSWB =1, ANTSW =0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x3, regval_0xcbd); -+ -+ break; -+ case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x66); /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ -+ -+ regval_0xcbd = (switch_polatiry_inverse == false? 0x2 : 0x1); /* 0xcbd[1:0] = 2b'10 for no switch_polatiry_inverse, ANTSWB =1, ANTSW =0 @ GNT_BT=1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x3, regval_0xcbd); -+ -+ break; -+ case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x88); /* */ -+ -+ /* no regval_0xcbd setup required, because antenna switch control value by antenna diversity */ -+ -+ break; -+ case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x1); /* 0x4c[23] = 1 */ -+ -+ regval_0x64 = (switch_polatiry_inverse == false? 0x0 : 0x1); /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, regval_0x64); -+ break; -+ case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT: -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x0); /* 0x4c[24] = 0 */ -+ -+ /* no setup required, because antenna switch control value by BT vendor 0xac[1:0] */ -+ break; -+ } -+ } -+ -+ u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcbd); -+ u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Ext Ant switch setup) 0xcbd = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x**********\n", -+ u32tmp1, u32tmp2, u32tmp3); -+ BTC_TRACE(trace_buf); -+ -+ -+} -+ -+ -+void halbtc8822b1ant_set_ant_path(IN struct btc_coexist *btcoexist, -+ IN u8 ant_pos_type, IN boolean force_exec, -+ IN u8 phase) -+ -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp = 0; -+ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ -+ coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; -+ -+ if (!force_exec) { -+ if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) -+ return; -+ } -+ -+ coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; -+ -+#if 1 -+ u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x38); -+ u32tmp2 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0x54); -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u32tmp3, u8tmp, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+#endif -+ -+ switch (phase) -+ { -+ case BT_8822B_1ANT_PHASE_COEX_INIT: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_COEX_INIT) **********\n" ); -+ BTC_TRACE(trace_buf); -+ -+ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ -+ halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8822B_1ANT_CTT_WL_VS_LTE, 0xffff); -+ -+ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8822B_1ANT_CTT_BT_VS_LTE, 0xffff); -+ -+ /* set GNT_BT to SW high */ -+ halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8822B_1ANT_GNT_CTRL_BY_SW, -+ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ /* set GNT_WL to SW low */ -+ halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8822B_1ANT_GNT_CTRL_BY_SW, -+ BT_8822B_1ANT_SIG_STA_SET_TO_LOW); -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8822B_1ANT_PCO_WLSIDE); -+ -+ coex_sta->run_time_state = false; -+ -+ /* Ext switch buffer mux */ -+ btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ -+ break; -+ case BT_8822B_1ANT_PHASE_WLANONLY_INIT: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_WLANONLY_INIT) **********\n" ); -+ BTC_TRACE(trace_buf); -+ -+ /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ -+ halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8822B_1ANT_CTT_WL_VS_LTE, 0xffff); -+ -+ /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ -+ halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, -+ BT_8822B_1ANT_CTT_BT_VS_LTE, 0xffff); -+ -+ /* set GNT_BT to SW Low */ -+ halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8822B_1ANT_GNT_CTRL_BY_SW, -+ BT_8822B_1ANT_SIG_STA_SET_TO_LOW); -+ -+ /* Set GNT_WL to SW high */ -+ halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8822B_1ANT_GNT_CTRL_BY_SW, -+ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ /* set Path control owner to WL at initial step */ -+ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8822B_1ANT_PCO_WLSIDE); -+ -+ coex_sta->run_time_state = false; -+ -+ /* Ext switch buffer mux */ -+ btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_WIFI; -+ -+ break; -+ case BT_8822B_1ANT_PHASE_WLAN_OFF: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_WLAN_OFF) **********\n" ); -+ BTC_TRACE(trace_buf); -+ -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* set Path control owner to BT */ -+ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8822B_1ANT_PCO_BTSIDE); -+ -+ /* Set Ext Ant Switch to BT control at wifi off step */ -+ halbtc8822b1ant_set_ext_ant_switch(btcoexist, -+ FORCE_EXEC, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE); -+ -+ coex_sta->run_time_state = false; -+ -+ break; -+ case BT_8822B_1ANT_PHASE_2G_RUNTIME: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_2G_RUNTIME) **********\n" ); -+ BTC_TRACE(trace_buf); -+ -+ /* set GNT_BT to PTA */ -+ halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8822B_1ANT_GNT_CTRL_BY_PTA, -+ BT_8822B_1ANT_SIG_STA_SET_BY_HW); -+ -+ /* Set GNT_WL to PTA */ -+ halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8822B_1ANT_GNT_CTRL_BY_PTA, -+ BT_8822B_1ANT_SIG_STA_SET_BY_HW); -+ -+ /* set Path control owner to WL at runtime step */ -+ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8822B_1ANT_PCO_WLSIDE); -+ -+ coex_sta->run_time_state = true; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_PTA; -+ -+ break; -+ case BT_8822B_1ANT_PHASE_5G_RUNTIME: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_5G_RUNTIME) **********\n" ); -+ BTC_TRACE(trace_buf); -+ -+ /* set GNT_BT to SW Hi */ -+ halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8822B_1ANT_GNT_CTRL_BY_SW, -+ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ /* Set GNT_WL to SW Hi */ -+ halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8822B_1ANT_GNT_CTRL_BY_SW, -+ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ /* set Path control owner to WL at runtime step */ -+ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8822B_1ANT_PCO_WLSIDE); -+ -+ coex_sta->run_time_state = true; -+ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_WIFI5G; -+ -+ break; -+ case BT_8822B_1ANT_PHASE_BTMPMODE : -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_BTMPMODE) **********\n" ); -+ BTC_TRACE(trace_buf); -+ -+ /* Disable LTE Coex Function in WiFi side */ -+ halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); -+ -+ /* set GNT_BT to SW Hi */ -+ halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8822B_1ANT_GNT_CTRL_BY_SW, -+ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); -+ -+ /* Set GNT_WL to SW Lo */ -+ halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8822B_1ANT_GNT_CTRL_BY_SW, -+ BT_8822B_1ANT_SIG_STA_SET_TO_LOW); -+ -+ /* set Path control owner to WL */ -+ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8822B_1ANT_PCO_WLSIDE); -+ -+ coex_sta->run_time_state = false; -+ -+ /* Set Ext Ant Switch to BT side at BT MP mode */ -+ if (BTC_ANT_PATH_AUTO == ant_pos_type) -+ ant_pos_type = BTC_ANT_PATH_BT; -+ -+ break; -+ } -+ -+ -+ if (phase != BT_8822B_1ANT_PHASE_WLAN_OFF) -+ { -+ switch (ant_pos_type) { -+ case BTC_ANT_PATH_WIFI: -+ halbtc8822b1ant_set_ext_ant_switch( btcoexist, -+ force_exec, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLG); -+ break; -+ case BTC_ANT_PATH_WIFI5G: -+ halbtc8822b1ant_set_ext_ant_switch( btcoexist, -+ force_exec, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLA); -+ break; -+ case BTC_ANT_PATH_BT: -+ halbtc8822b1ant_set_ext_ant_switch( btcoexist, -+ force_exec, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_BT); -+ break; -+ default: -+ case BTC_ANT_PATH_PTA: -+ halbtc8822b1ant_set_ext_ant_switch( btcoexist, -+ force_exec, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE); -+ break; -+ } -+ -+ } -+#if 1 -+ u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (After Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u32tmp3, u8tmp, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ -+#endif -+ -+} -+ -+ -+void halbtc8822b1ant_coex_all_off(IN struct btc_coexist *btcoexist) -+{ -+ /* sw all off */ -+ halbtc8822b1ant_sw_mechanism(btcoexist, false); -+ -+ /* hw all off */ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+boolean halbtc8822b1ant_is_common_action(IN struct btc_coexist *btcoexist) -+{ -+ boolean common = false, wifi_connected = false, wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ if (!wifi_connected && -+ BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT non connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (wifi_connected && -+ (BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi connected + BT connected-idle!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else if (!wifi_connected && -+ (BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ -+ -+ common = true; -+ } else { -+ if (wifi_busy) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ common = false; -+ } -+ -+ return common; -+} -+ -+void halbtc8822b1ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], under 5g start \n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 10); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, -+ BT_8822B_1ANT_PHASE_5G_RUNTIME); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); -+ -+ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 5); -+ -+} -+ -+ -+ -+void halbtc8822b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -+{ -+ boolean wifi_under_5g = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if(wifi_under_5g) -+ { -+ halbtc8822b1ant_action_wifi_under5g(btcoexist); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (wlan only -- under 5g ) **********\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (wlan only -- under 2g ) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+} -+ -+/* ********************************************* -+ * -+ * Software Coex Mechanism start -+ * -+ * ********************************************* */ -+ -+/* SCO only or SCO+PAN(HS) */ -+ -+/* -+void halbtc8822b1ant_action_sco(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8822b1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8822b1ant_action_hid(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8822b1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8822b1ant_action_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8822b1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8822b1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8822b1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8822b1ant_action_pan_edr(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8822b1ant_sw_mechanism(btcoexist, false); -+} -+ -+ -+void halbtc8822b1ant_action_pan_hs(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8822b1ant_sw_mechanism(btcoexist, false); -+} -+ -+ -+void halbtc8822b1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8822b1ant_sw_mechanism(btcoexist, false); -+} -+ -+void halbtc8822b1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8822b1ant_sw_mechanism(btcoexist, true); -+} -+ -+ -+void halbtc8822b1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8822b1ant_sw_mechanism(btcoexist, true); -+} -+ -+void halbtc8822b1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) -+{ -+ halbtc8822b1ant_sw_mechanism(btcoexist, true); -+} -+ -+*/ -+ -+/* ********************************************* -+ * -+ * Non-Software Coex Mechanism start -+ * -+ * ********************************************* */ -+void halbtc8822b1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex],action_bt_whck_test\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+void halbtc8822b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex],action_wifi_multi_port\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+} -+ -+void halbtc8822b1ant_action_hs(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], action_hs\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+} -+ -+/*"""bt inquiry"""" + wifi any + bt any*/ -+void halbtc8822b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -+{ -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, ap_enable = false, wifi_busy = false, -+ bt_busy = false; -+ -+ -+ boolean wifi_scan = false, link = false, roam = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (bt inquiry) **********\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** scan = %d, link =%d, roam = %d**********\n", -+ wifi_scan, link, roam); -+ BTC_TRACE(trace_buf); -+ -+ if ( (link) || (roam) || (coex_sta->wifi_is_high_pri_task)){ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (bt inquiry wifi connect or scan ) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); -+ -+ } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); -+ -+ } else if ((!wifi_connected) && (!wifi_scan)) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (bt inquiry wifi non connect) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ -+ } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if (bt_link_info->a2dp_exist) { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if (wifi_scan) { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if (wifi_busy) { -+ -+ /* for BT inquiry/page fail after S4 resume */ -+ /* halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); */ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 1); -+ }else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (bt inquiry wifi connect) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 1); -+ } -+ -+/* -+ if ((wifi_link) || (wifi_roam) || (coex_sta->wifi_is_high_pri_task)) { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); -+ -+ } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); -+ -+ } else if ((!wifi_connected) && (!wifi_scan)) { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ } else if (bt_link_info->a2dp_exist) { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else if (wifi_scan) { -+ -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ -+ } else if (wifi_busy) { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } else { -+ halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 19); -+ -+ halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); -+ } -+*/ -+} -+ -+void halbtc8822b1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (bt sco hid only busy) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ /*SCO + wifi conected idle or busy / 0x778=1@wifi slot*/ -+ if (bt_link_info->sco_exist) { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ -+ } else { /* HID + wifi conected idle or busy / 0x778=1@wifi slot */ -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ -+ } -+} -+ -+/*wifi connected + bt acl busy*/ -+void halbtc8822b1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist -+ *btcoexist, IN u8 wifi_status) -+{ -+ -+ u8 bt_rssi_state; -+ -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ bt_rssi_state = halbtc8822b1ant_bt_rssi_state(2, 28, 0); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (wifi connect acl busy) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (bt_link_info->hid_only) { /* HID + wifi conected idle or busy / 0x778=1@wifi slot */ -+ halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ wifi_status); -+ return; -+ } else if (bt_link_info->a2dp_only) { /* A2DP + wifi conected idle or busy */ -+ if (BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } else { -+ if (coex_sta->scan_ap_num >= -+ BT_8822B_1ANT_WIFI_NOISY_THRESH) { -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 17); -+ } else { -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 42); -+ } -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ coex_dm->auto_tdma_adjust = true; -+ } -+ -+ /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ -+ } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || -+ (bt_link_info->hid_exist && bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 44); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 1); -+ } else if (bt_link_info->hid_exist && -+ bt_link_info->a2dp_exist) { /* HID+A2DP */ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 42); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 1); -+ -+ } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && -+ bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP)*/ -+ /* -+ if (BT_8723D_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) -+ halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 4); -+ else -+ */ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 45); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 1); -+ } else { -+ /* BT no-profile busy (0x9) */ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 1); -+ } -+} -+ -+/*wifi not connected + bt action*/ -+void halbtc8822b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (wifi not connect) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ /* tdma and coex table */ -+ halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+} -+ -+/*""""wl not connected scan"""" + bt action*/ -+void halbtc8822b1ant_action_wifi_not_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (wifi non connect scan) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if (num_of_wifi_link >= 2) { -+ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8822b1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8822b1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8822b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8822b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ /* tdma and coex table */ -+ if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } else { -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } -+ } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 5); -+ } -+} -+ -+/*""""wl not connected asso"""" + bt action*/ -+void halbtc8822b1ant_action_wifi_not_connected_asso_auth( -+ IN struct btc_coexist *btcoexist) -+{ -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (wifi non connect asso_auth) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if (num_of_wifi_link >= 2) { -+ -+ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8822b1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8822b1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8822b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8822b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || -+ (bt_link_info->a2dp_exist)) { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); -+ } else if (bt_link_info->pan_exist) { -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); -+ } else { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); -+ } -+} -+ -+/*""""wl connected scan"""" + bt action*/ -+void halbtc8822b1ant_action_wifi_connected_scan(IN struct btc_coexist -+ *btcoexist) -+{ -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (wifi connect scan) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if (num_of_wifi_link >= 2) { -+ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8822b1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8822b1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8822b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8822b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ /* tdma and coex table */ -+ if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ if (bt_link_info->a2dp_exist) { -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 32); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } else if (bt_link_info->a2dp_exist && -+ bt_link_info->pan_exist) { -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, -+ 22); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } else { -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ } -+ } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_SCAN); -+ } else { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 5); -+ } -+} -+ -+/*""""wl connected specific packet"""" + bt action*/ -+void halbtc8822b1ant_action_wifi_connected_specific_packet( -+ IN struct btc_coexist *btcoexist) -+{ -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0; -+ boolean bt_ctrl_agg_buf_size = false; -+ u8 agg_buf_size = 5; -+ boolean wifi_busy = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (wifi connect specific packet) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if (num_of_wifi_link >= 2) { -+ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8822b1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8822b1ant_action_wifi_multi_port(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->c2h_bt_inquiry_page) { -+ halbtc8822b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8822b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ /* no specific packet process for both WiFi and BT very busy */ -+ if ((wifi_busy) && ((bt_link_info->pan_exist) || -+ (coex_sta->num_of_profile >= 2))) -+ return; -+ -+ /* tdma and coex table */ -+ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -+ } else if (bt_link_info->a2dp_exist) { -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 1); -+ } else if (bt_link_info->pan_exist) { -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 1); -+ } else { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 5); -+ } -+} -+ -+/*wifi connected input point : to set different ps and tdma case (+bt different case)*/ -+void halbtc8822b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -+{ -+ -+ boolean wifi_busy = false; -+ boolean scan = false, link = false, roam = false; -+ boolean under_4way = false, ap_enable = false, wifi_under_5g=false; -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ if (wifi_under_5g) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under 5g<===\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_action_wifi_under5g(btcoexist); -+ -+ return; -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under 2g<===\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ } -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (under_4way) { -+ halbtc8822b1ant_action_wifi_connected_specific_packet(btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8822b1ant_action_wifi_connected_scan(btcoexist); -+ else -+ halbtc8822b1ant_action_wifi_connected_specific_packet( -+ btcoexist); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ &ap_enable); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ /* tdma and coex table */ -+ if (!wifi_busy) { -+ if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8822b1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE); -+ } else { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ if ((coex_sta->high_priority_tx) + -+ (coex_sta->high_priority_rx) <= 60) -+ /*sy modify case16 -> case17*/ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ else -+ halbtc8822b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 7); -+ } -+ } else { -+ if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { -+ halbtc8822b1ant_action_wifi_connected_bt_acl_busy( -+ btcoexist, -+ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == -+ coex_dm->bt_status) || -+ (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == -+ coex_dm->bt_status)) { -+ halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, -+ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_BUSY); -+ } else { -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, -+ 8); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ if ((coex_sta->high_priority_tx) + -+ (coex_sta->high_priority_rx) <= 60) -+ /*sy modify case16 -> case17*/ -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 1); -+ else -+ halbtc8822b1ant_coex_table_with_type(btcoexist, -+ NORMAL_EXEC, 7); -+ } -+ } -+} -+ -+void halbtc8822b1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ -+ u8 algorithm = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (runswcoexmech) **********\n"); -+ BTC_TRACE(trace_buf); -+ algorithm = halbtc8822b1ant_action_algorithm(btcoexist); -+ coex_dm->cur_algorithm = algorithm; -+ -+ if (halbtc8822b1ant_is_common_action(btcoexist)) { -+ -+ } else { -+ switch (coex_dm->cur_algorithm) { -+ case BT_8822B_1ANT_COEX_ALGO_SCO: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = SCO.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8822b1ant_action_sco(btcoexist); */ -+ break; -+ case BT_8822B_1ANT_COEX_ALGO_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8822b1ant_action_hid(btcoexist); */ -+ break; -+ case BT_8822B_1ANT_COEX_ALGO_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8822b1ant_action_a2dp(btcoexist); */ -+ break; -+ case BT_8822B_1ANT_COEX_ALGO_A2DP_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8822b1ant_action_a2dp_pan_hs(btcoexist); */ -+ break; -+ case BT_8822B_1ANT_COEX_ALGO_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR).\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8822b1ant_action_pan_edr(btcoexist); */ -+ break; -+ case BT_8822B_1ANT_COEX_ALGO_PANHS: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HS mode.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8822b1ant_action_pan_hs(btcoexist); */ -+ break; -+ case BT_8822B_1ANT_COEX_ALGO_PANEDR_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8822b1ant_action_pan_edr_a2dp(btcoexist); */ -+ break; -+ case BT_8822B_1ANT_COEX_ALGO_PANEDR_HID: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8822b1ant_action_pan_edr_hid(btcoexist); */ -+ break; -+ case BT_8822B_1ANT_COEX_ALGO_HID_A2DP_PANEDR: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8822b1ant_action_hid_a2dp_pan_edr(btcoexist); */ -+ break; -+ case BT_8822B_1ANT_COEX_ALGO_HID_A2DP: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = HID+A2DP.\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8822b1ant_action_hid_a2dp(btcoexist); */ -+ break; -+ default: -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Action algorithm = coexist All Off!!\n"); -+ BTC_TRACE(trace_buf); -+ /* halbtc8822b1ant_coex_all_off(btcoexist); */ -+ break; -+ } -+ coex_dm->pre_algorithm = coex_dm->cur_algorithm; -+ } -+} -+ -+void halbtc8822b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -+{ -+ -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ boolean wifi_connected = false, bt_hs_on = false; -+ boolean increase_scan_dev_num = false; -+ boolean bt_ctrl_agg_buf_size = false; -+ boolean miracast_plus_bt = false; -+ u8 agg_buf_size = 5; -+ u32 wifi_link_status = 0; -+ u32 num_of_wifi_link = 0, wifi_bw; -+ u8 iot_peer = BTC_IOT_PEER_UNKNOWN; -+ boolean wifi_under_5g = false; -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism()===>\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (coex_sta->under_ips) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is under IPS !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ if (!coex_sta->run_time_state){ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], return for run_time_state = false !!!\n"); -+ BTC_TRACE(trace_buf); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if(wifi_under_5g) -+ { -+ halbtc8822b1ant_action_wifi_under5g(btcoexist); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 5G!!! \n"); -+ BTC_TRACE(trace_buf); -+ return; -+ }else{ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], WiFi is under 2G!!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ NORMAL_EXEC, BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ } -+ -+ if (coex_sta->bt_whck_test) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is under WHCK TEST!!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8822b1ant_action_bt_whck_test(btcoexist); -+ return; -+ } -+ -+ if (coex_sta->bt_disabled) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT is disabled !!!\n"); -+ halbtc8822b1ant_action_wifi_only(btcoexist); -+ return; -+ } -+ -+ if ((BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ increase_scan_dev_num = true; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, -+ &increase_scan_dev_num); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, -+ &wifi_link_status); -+ num_of_wifi_link = wifi_link_status >> 16; -+ -+ if ((num_of_wifi_link >= 2) || -+ (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", -+ num_of_wifi_link, wifi_link_status); -+ BTC_TRACE(trace_buf); -+ -+ if (bt_link_info->bt_link_exist) { -+ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, -+ 0, 1); -+ miracast_plus_bt = true; -+ } else { -+ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ miracast_plus_bt = false; -+ } -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, -+ bt_ctrl_agg_buf_size, agg_buf_size); -+ -+ if ((bt_link_info->a2dp_exist) && -+ (coex_sta->c2h_bt_inquiry_page)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8822b1ant_action_bt_inquiry(btcoexist); -+ } else -+ halbtc8822b1ant_action_wifi_multi_port(btcoexist); -+ -+ return; -+ } else { -+ miracast_plus_bt = false; -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, -+ &miracast_plus_bt); -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ -+ if ((bt_link_info->bt_link_exist) && (wifi_connected)) { -+ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); -+ -+ if (BTC_IOT_PEER_CISCO != iot_peer) { -+ if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ -+ halbtc8822b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, true, false, 0x5); -+ else -+ halbtc8822b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, false, 0x5); -+ } else { -+ if (bt_link_info->sco_exist) -+ halbtc8822b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, true, false, 0x5); -+ else { -+ if (BTC_WIFI_BW_HT40 == wifi_bw) -+ halbtc8822b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, true, 0x10); -+ else -+ halbtc8822b1ant_limited_rx(btcoexist, -+ NORMAL_EXEC, false, true, 0x8); -+ } -+ } -+ -+ halbtc8822b1ant_sw_mechanism(btcoexist, true); -+ halbtc8822b1ant_run_sw_coexist_mechanism( -+ btcoexist); /* just print debug message */ -+ } else { -+ halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); -+ -+ halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, -+ 0x5); -+ -+ halbtc8822b1ant_sw_mechanism(btcoexist, false); -+ halbtc8822b1ant_run_sw_coexist_mechanism( -+ btcoexist); /* //just print debug message */ -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); -+ if (coex_sta->c2h_bt_inquiry_page) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "############# [BTCoex], BT Is Inquirying\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8822b1ant_action_bt_inquiry(btcoexist); -+ return; -+ } else if (bt_hs_on) { -+ halbtc8822b1ant_action_hs(btcoexist); -+ return; -+ } -+ -+ -+ if (!wifi_connected) { -+ boolean scan = false, link = false, roam = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], wifi is non connected-idle !!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); -+ -+ if (scan || link || roam) { -+ if (scan) -+ halbtc8822b1ant_action_wifi_not_connected_scan( -+ btcoexist); -+ else -+ halbtc8822b1ant_action_wifi_not_connected_asso_auth( -+ btcoexist); -+ } else -+ halbtc8822b1ant_action_wifi_not_connected(btcoexist); -+ } else /* wifi LPS/Busy */ -+ halbtc8822b1ant_action_wifi_connected(btcoexist); -+} -+ -+u32 halbtc8822b1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) -+{ -+ u8 j; -+ u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; -+ u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, -+ 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, -+ 32, 23, 15, 7, 0 -+ }; -+ -+ if (val == 0) -+ return 0; -+ -+ tmp = val; -+ -+ while (1) { -+ if (tmp == 1) -+ break; -+ else { -+ tmp = (tmp >> 1); -+ shiftcount++; -+ } -+ } -+ -+ -+ val_integerd_b = shiftcount + 1; -+ -+ tmp2 = 1; -+ for (j = 1; j <= val_integerd_b; j++) -+ tmp2 = tmp2 * 2; -+ -+ tmp = (val * 100) / tmp2; -+ tindex = tmp / 5; -+ -+ if (tindex > 20) -+ tindex = 20; -+ -+ val_fractiond_b = table_fraction[tindex]; -+ -+ result = val_integerd_b * 100 - val_fractiond_b; -+ -+ return result; -+ -+ -+} -+ -+void halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ /* force to reset coex mechanism */ -+ -+ /* sw all off */ -+ halbtc8822b1ant_sw_mechanism(btcoexist, false); -+ -+ /* halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ -+ /* halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ -+ -+ coex_sta->pop_event_cnt = 0; -+} -+ -+void halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean back_up, IN boolean wifi_only) -+{ -+ -+ u8 u8tmp = 0; -+ boolean wifi_under_5g = false; -+ u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; -+ -+ -+ u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); -+ u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u32tmp2 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", -+ u32tmp3, u32tmp1, u32tmp2); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 1Ant Init HW Config!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->bt_coex_supported_feature = 0; -+ coex_sta->bt_coex_supported_version = 0; -+ -+ /* Setup RF front end type */ -+ halbtc8822b1ant_set_rfe_type(btcoexist); -+ -+ /* 0xf0[15:12] --> Chip Cut information */ -+ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, -+ 0xf1) & 0xf0) >> 4; -+ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, -+ 0x1); /* enable TBTT nterrupt */ -+ -+ /* BT report packet sample rate */ -+ /* 0x790[5:0]=0x5 */ -+ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); -+ u8tmp &= 0xc0; -+ u8tmp |= 0x5; -+ btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); -+ -+ /* Enable BT counter statistics */ -+ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); -+ -+ /* Enable PTA (3-wire function form BT side) */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); -+ -+ /* Enable PTA (tx/rx signal form WiFi side) */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); -+ -+ /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ -+ /*btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1);*/ -+ -+ /* enable GNT_WL */ -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); -+ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); -+ -+ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) -+ halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, TRUE); -+ -+ /* Antenna config */ -+ if (wifi_only) { -+ -+ coex_sta->concurrent_rx_mode_on = false; -+ halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, -+ FORCE_EXEC, BT_8822B_1ANT_PHASE_WLANONLY_INIT); -+ } else { -+ -+ coex_sta->concurrent_rx_mode_on = true; -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, BT_8822B_1ANT_PHASE_COEX_INIT); -+ } -+ -+ -+ /* PTA parameter */ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -+ -+ halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, TRUE); -+ -+} -+ -+ -+ -+void halbtc8822b1ant_psd_showdata(IN struct btc_coexist *btcoexist) -+{ -+ u8 *cli_buf = btcoexist->cli_buf; -+ u32 delta_freq_per_point; -+ u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n\n============[PSD info] (%d)============\n", -+ psd_scan->psd_gen_count); -+ CL_PRINTF(cli_buf); -+ -+ if (psd_scan->psd_gen_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); -+ CL_PRINTF(cli_buf); -+ return; -+ } -+ -+ if (psd_scan->psd_point == 0) -+ delta_freq_per_point = 0; -+ else -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* if (psd_scan->is_psd_show_max_only) */ -+ if (0) { -+ psd_rep1 = psd_scan->psd_max_value / 100; -+ psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; -+ -+ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + -+ psd_scan->psd_max_value_point * delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.0%d MHz", -+ freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq = %d.%d MHz", -+ freq1, freq2); -+ -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.0%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ ", Value = %d.%d dB, (%d)\n", -+ psd_rep1, psd_rep2, psd_scan->psd_max_value); -+ -+ CL_PRINTF(cli_buf); -+ } else { -+ m = psd_scan->psd_start_point; -+ n = psd_scan->psd_start_point; -+ i = 1; -+ j = 1; -+ -+ while (1) { -+ do { -+ freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * -+ delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ if (i == 1) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.0%2d", freq1, -+ freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Freq%6d.%3d", freq1, -+ freq2); -+ } else if ((i % 8 == 0) || -+ (m == psd_scan->psd_stop_point)) { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.000\n", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.0%2d\n", freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.%3d\n", freq1, freq2); -+ } else { -+ if (freq2 == 0) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.000", freq1); -+ else if (freq2 < 100) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.0%2d", freq1, freq2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%6d.%3d", freq1, freq2); -+ } -+ -+ i++; -+ m++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); -+ -+ -+ do { -+ psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; -+ psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * -+ 100; -+ -+ if (j == 1) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.0%d", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n Val %7d.%d", psd_rep1, -+ psd_rep2); -+ } else if ((j % 8 == 0) || -+ (n == psd_scan->psd_stop_point)) { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.0%d\n", psd_rep1, -+ psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.%d\n", psd_rep1, psd_rep2); -+ } else { -+ if (psd_rep2 < 10) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.0%d", psd_rep1, psd_rep2); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "%7d.%d", psd_rep1, psd_rep2); -+ } -+ -+ j++; -+ n++; -+ CL_PRINTF(cli_buf); -+ -+ } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); -+ -+ if ((m > psd_scan->psd_stop_point) || -+ (n > psd_scan->psd_stop_point)) -+ break; -+ else { -+ i = 1; -+ j = 1; -+ } -+ -+ } -+ } -+ -+ -+} -+ -+void halbtc8822b1ant_psd_max_holddata(IN struct btc_coexist *btcoexist, -+ IN u32 gen_count) -+{ -+ u32 i = 0, i_max = 0, val_max = 0; -+ -+ if (gen_count == 1) { -+ memcpy(psd_scan->psd_report_max_hold, -+ psd_scan->psd_report, -+ BT_8822B_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); -+ -+ for (i = psd_scan->psd_start_point; -+ i <= psd_scan->psd_stop_point; i++) { -+ -+ } -+ -+ psd_scan->psd_max_value_point = 0; -+ psd_scan->psd_max_value = 0; -+ -+ } else { -+ for (i = psd_scan->psd_start_point; -+ i <= psd_scan->psd_stop_point; i++) { -+ if (psd_scan->psd_report[i] > -+ psd_scan->psd_report_max_hold[i]) -+ psd_scan->psd_report_max_hold[i] = -+ psd_scan->psd_report[i]; -+ -+ /* search Max Value */ -+ if (i == psd_scan->psd_start_point) { -+ i_max = i; -+ val_max = psd_scan->psd_report_max_hold[i]; -+ } else { -+ if (psd_scan->psd_report_max_hold[i] > -+ val_max) { -+ i_max = i; -+ val_max = psd_scan->psd_report_max_hold[i]; -+ } -+ } -+ -+ -+ -+ } -+ -+ psd_scan->psd_max_value_point = i_max; -+ psd_scan->psd_max_value = val_max; -+ -+ } -+ -+ -+} -+ -+u32 halbtc8822b1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) -+{ -+ /* reg 0x808[9:0]: FFT data x */ -+ /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ -+ /* reg 0x8b4[15:0]: FFT data y report */ -+ -+ u32 val = 0, psd_report = 0; -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ -+ val &= 0xffbffc00; -+ val |= point; -+ -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ val |= 0x00400000; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); -+ -+ psd_report = val & 0x0000ffff; -+ -+ return psd_report; -+} -+ -+ -+void halbtc8822b1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, -+ IN u32 avgnum) -+{ -+ u32 i, val, n, k = 0; -+ u32 points1 = 0, psd_report = 0; -+ u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; -+ u32 psd_center_freq = 20 * 10 ^ 6, freq, freq1, freq2; -+ boolean outloop = false; -+ u8 flag = 0; -+ u32 tmp, psd_rep1, psd_rep2; -+ u32 wifi_original_channel = 1; -+ -+ psd_scan->is_psd_running = true; -+ -+ do { -+ switch (flag) { -+ case 0: /* Get PSD parameters */ -+ default: -+ -+ psd_scan->psd_band_width = 40 * 1000000; -+ psd_scan->psd_point = points; -+ psd_scan->psd_start_base = points / 2; -+ psd_scan->psd_avg_num = avgnum; -+ psd_scan->real_cent_freq = cent_freq; -+ psd_scan->real_offset = offset; -+ psd_scan->real_span = span; -+ -+ -+ points1 = psd_scan->psd_point; -+ delta_freq_per_point = psd_scan->psd_band_width / -+ psd_scan->psd_point; -+ -+ /* PSD point setup */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffff0fff; -+ -+ switch (psd_scan->psd_point) { -+ case 128: -+ val |= 0x0; -+ break; -+ case 256: -+ default: -+ val |= 0x00004000; -+ break; -+ case 512: -+ val |= 0x00008000; -+ break; -+ case 1024: -+ val |= 0x0000c000; -+ break; -+ } -+ -+ switch (psd_scan->psd_avg_num) { -+ case 1: -+ val |= 0x0; -+ break; -+ case 8: -+ val |= 0x00001000; -+ break; -+ case 16: -+ val |= 0x00002000; -+ break; -+ case 32: -+ default: -+ val |= 0x00003000; -+ break; -+ } -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ flag = 1; -+ break; -+ case 1: /* calculate the PSD point index from freq/offset/span */ -+ psd_center_freq = psd_scan->psd_band_width / 2 + -+ offset * (1000000); -+ -+ start_p = psd_scan->psd_start_base + (psd_center_freq - -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_start_point = start_p - -+ psd_scan->psd_start_base; -+ -+ stop_p = psd_scan->psd_start_base + (psd_center_freq + -+ span * (1000000) / 2) / delta_freq_per_point; -+ psd_scan->psd_stop_point = stop_p - -+ psd_scan->psd_start_base - 1; -+ -+ flag = 2; -+ break; -+ case 2: /* set RF channel/BW/Mode */ -+ -+ /* set 3-wire off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val |= 0x00300000; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val &= 0xfeffffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* store WiFi original channel */ -+ wifi_original_channel = btcoexist->btc_get_rf_reg( -+ btcoexist, BTC_RF_A, 0x18, 0x3ff); -+ -+ /* Set RF channel */ -+ if (cent_freq == 2484) -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, 0xe); -+ else -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, -+ 0x18, 0x3ff, (cent_freq - 2412) / 5 + -+ 1); /* WiFi TRx Mask on */ -+ -+ /* Set RF mode = Rx, RF Gain = 0x8a0 */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, -+ 0xfffff, 0x308a0); -+ -+ /* Set RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, -+ 0xfffff, 0x3e4); -+ -+ /* Set TRx mask off */ -+ /* un-lock TRx Mask setup */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, -+ 0x80, 0x1); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, -+ 0x1, 0x1); -+ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, -+ 0xfffff, 0x0); -+ -+ flag = 3; -+ break; -+ case 3: -+ memset(psd_scan->psd_report, 0, -+ psd_scan->psd_point * sizeof(u32)); -+ start_p = psd_scan->psd_start_point + -+ psd_scan->psd_start_base; -+ stop_p = psd_scan->psd_stop_point + -+ psd_scan->psd_start_base + 1; -+ -+ i = start_p; -+ -+ while (i < stop_p) { -+ if (i >= points1) -+ psd_report = -+ halbtc8822b1ant_psd_getdata( -+ btcoexist, i - points1); -+ else -+ psd_report = -+ halbtc8822b1ant_psd_getdata( -+ btcoexist, i); -+ -+ if (psd_report == 0) -+ tmp = 0; -+ else -+ /* tmp = 20*log10((double)psd_report); */ -+ /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ -+ tmp = 6 * halbtc8822b1ant_psd_log2base( -+ btcoexist, psd_report); -+ -+ n = i - psd_scan->psd_start_base; -+ psd_scan->psd_report[n] = tmp; -+ psd_rep1 = psd_scan->psd_report[n] / 100; -+ psd_rep2 = psd_scan->psd_report[n] - psd_rep1 * -+ 100; -+ -+ freq = ((cent_freq - 20) * 1000000 + n * -+ delta_freq_per_point); -+ freq1 = freq / 1000000; -+ freq2 = freq / 1000 - freq1 * 1000; -+ -+ i++; -+ -+ k = 0; -+ -+ /* Add Delay between PSD point */ -+ while (1) { -+ if (k++ > 20000) -+ break; -+ } -+ -+ } -+ -+ flag = 100; -+ break; -+ case 99: /* error */ -+ -+ outloop = true; -+ break; -+ case 100: /* recovery */ -+ -+ /* set 3-wire on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x88c); -+ val &= 0xffcfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x88c, val); -+ -+ /* CCK on */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x800); -+ val |= 0x01000000; -+ btcoexist->btc_write_4byte(btcoexist, 0x800, val); -+ -+ /* PSD off */ -+ val = btcoexist->btc_read_4byte(btcoexist, 0x808); -+ val &= 0xffbfffff; -+ btcoexist->btc_write_4byte(btcoexist, 0x808, val); -+ -+ /* TRx Mask on */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, -+ 0xfffff, 0x780); -+ -+ /* lock TRx Mask setup */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, -+ 0x80, 0x0); -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, -+ 0x1, 0x0); -+ -+ /* Set RF Rx filter corner */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, -+ 0xfffff, 0x0); -+ -+ /* restore WiFi original channel */ -+ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, -+ 0x3ff, wifi_original_channel); -+ -+ outloop = true; -+ break; -+ -+ } -+ -+ } while (!outloop); -+ -+ -+ -+ psd_scan->is_psd_running = false; -+ -+ -+} -+ -+#if (BTC_COEX_OFFLOAD == 1) -+void halbtc8822b1ant_wifi_info_notify(IN struct btc_coexist *btcoexist) -+{ -+ u8 h2c_para[4] = {0}; -+ u8 opcode_ver = 0; -+ u8 ap_num = 0; -+ s32 wifi_rssi = 0; -+ boolean wifi_busy = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); -+ -+ h2c_para[0] = ap_num; /* AP number */ -+ h2c_para[1] = (u8)wifi_busy; /* Busy */ -+ h2c_para[2] = (u8)wifi_rssi; /* RSSI */ -+ -+ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_INFO_NOTIFY, -+ opcode_ver, &h2c_para[0], 3); -+} -+ -+void halbtc8822b1ant_setManual(IN struct btc_coexist *btcoexist, -+ IN boolean manual) -+{ -+ u8 h2c_para[4] = {0}; -+ u8 opcode_ver = 0; -+ u8 set_type = 0; -+ -+ if (manual) -+ set_type = 1; -+ else -+ set_type = 0; -+ -+ h2c_para[0] = set_type; /* set_type */ -+ -+ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_SET_CONTROL, opcode_ver, -+ &h2c_para[0], 1); -+} -+ -+/* ************************************************************ -+ * work around function start with wa_halbtc8822b1ant_ -+ * ************************************************************ -+ * ************************************************************ -+ * extern function start with ex_halbtc8822b1ant_ -+ * ************************************************************ */ -+ -+void ex_halbtc8822b1ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{} -+void ex_halbtc8822b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -+{} -+void ex_halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{} -+void ex_halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{} -+void ex_halbtc8822b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ u8 h2c_para[4] = {0}; -+ u8 opcode_ver = 0; -+ u8 ips_notify = 0; -+ -+ if (BTC_IPS_ENTER == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ ips_notify = 1; -+ } else if (BTC_IPS_LEAVE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ h2c_para[0] = ips_notify; /* IPS notify */ -+ h2c_para[1] = 0xff; /* LPS notify */ -+ h2c_para[2] = 0xff; /* RF state notify */ -+ h2c_para[3] = 0xff; /* pnp notify */ -+ -+ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_POWER_STATE_NOTIFY, -+ opcode_ver, &h2c_para[0], 4); -+} -+void ex_halbtc8822b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ u8 h2c_para[4] = {0}; -+ u8 opcode_ver = 0; -+ u8 lps_notify = 0; -+ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ lps_notify = 1; -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ h2c_para[0] = 0xff; /* IPS notify */ -+ h2c_para[1] = lps_notify; /* LPS notify */ -+ h2c_para[2] = 0xff; /* RF state notify */ -+ h2c_para[3] = 0xff; /* pnp notify */ -+ -+ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_POWER_STATE_NOTIFY, -+ opcode_ver, &h2c_para[0], 4); -+} -+ -+void ex_halbtc8822b1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_para[4] = {0}; -+ u8 opcode_ver = 0; -+ u8 scan_start = 0; -+ boolean under_4way = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ if (BTC_SCAN_START == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ scan_start = 1; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ h2c_para[0] = scan_start; /* scan notify */ -+ h2c_para[1] = 0xff; /* connect notify */ -+ h2c_para[2] = 0xff; /* specific packet notify */ -+ if (under_4way) -+ h2c_para[3] = 1; /* under 4way progress */ -+ else -+ h2c_para[3] = 0; -+ -+ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_PROGRESS_NOTIFY, -+ opcode_ver, &h2c_para[0], 4); -+} -+ -+void ex_halbtc8822b1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_para[4] = {0}; -+ u8 opcode_ver = 0; -+ u8 connect_start = 0; -+ boolean under_4way = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ if (BTC_ASSOCIATE_START == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ connect_start = 1; -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], CONNECT FINISH notify\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ h2c_para[0] = 0xff; /* scan notify */ -+ h2c_para[1] = connect_start; /* connect notify */ -+ h2c_para[2] = 0xff; /* specific packet notify */ -+ if (under_4way) -+ h2c_para[3] = 1; /* under 4way progress */ -+ else -+ h2c_para[3] = 0; -+ -+ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_PROGRESS_NOTIFY, -+ opcode_ver, &h2c_para[0], 4); -+} -+ -+void ex_halbtc8822b1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u32 wifi_bw; -+ u8 wifi_central_chnl; -+ u8 h2c_para[5] = {0}; -+ u8 opcode_ver = 0; -+ u8 port = 0, connected = 0, freq = 0, bandwidth = 0, iot_peer = 0; -+ boolean wifi_under_5g = false; -+ -+ if (BTC_MEDIA_CONNECT == type) -+ connected = 1; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); -+ bandwidth = (u8)wifi_bw; -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if (wifi_under_5g) -+ freq = 1; -+ else -+ freq = 0; -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ &wifi_central_chnl); -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); -+ -+ h2c_para[0] = (connected << 4) | -+ port; /* port need to be implemented in the future (p2p port, ...) */ -+ h2c_para[1] = (freq << 4) | bandwidth; -+ h2c_para[2] = wifi_central_chnl; -+ h2c_para[3] = iot_peer; -+ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_STATUS_NOTIFY, -+ opcode_ver, &h2c_para[0], 4); -+} -+ -+void ex_halbtc8822b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_para[4] = {0}; -+ u8 opcode_ver = 0; -+ u8 connect_start = 0; -+ boolean under_4way = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ h2c_para[0] = 0xff; /* scan notify */ -+ h2c_para[1] = 0xff; /* connect notify */ -+ h2c_para[2] = type; /* specific packet notify */ -+ if (under_4way) -+ h2c_para[3] = 1; /* under 4way progress */ -+ else -+ h2c_para[3] = 0; -+ -+ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_PROGRESS_NOTIFY, -+ opcode_ver, &h2c_para[0], 4); -+} -+ -+void ex_halbtc8822b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{} -+void ex_halbtc8822b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ u8 h2c_para[4] = {0}; -+ u8 opcode_ver = 0; -+ u8 rfstate_notify = 0; -+ -+ if (BTC_RF_ON == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ rfstate_notify = 1; -+ } else if (BTC_RF_OFF == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ h2c_para[0] = 0xff; /* IPS notify */ -+ h2c_para[1] = 0xff; /* LPS notify */ -+ h2c_para[2] = rfstate_notify; /* RF state notify */ -+ h2c_para[3] = 0xff; /* pnp notify */ -+ -+ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_POWER_STATE_NOTIFY, -+ opcode_ver, &h2c_para[0], 4); -+} -+ -+void ex_halbtc8822b1ant_halt_notify(IN struct btc_coexist *btcoexist) -+{} -+void ex_halbtc8822b1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ u8 h2c_para[4] = {0}; -+ u8 opcode_ver = 0; -+ u8 pnp_notify = 0; -+ -+ if (BTC_WIFI_PNP_SLEEP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ pnp_notify = 1; -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ h2c_para[0] = 0xff; /* IPS notify */ -+ h2c_para[1] = 0xff; /* LPS notify */ -+ h2c_para[2] = 0xff; /* RF state notify */ -+ h2c_para[3] = pnp_notify; /* pnp notify */ -+ -+ btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_POWER_STATE_NOTIFY, -+ opcode_ver, &h2c_para[0], 4); -+} -+ -+void ex_halbtc8822b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) -+{} -+void ex_halbtc8822b1ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+ -+ halbtc8822b1ant_wifi_info_notify(btcoexist); -+} -+ -+void ex_halbtc8822b1ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u16 u16tmp[4]; -+ u32 u32tmp[4]; -+ u32 fa_of_dm, fa_cck; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ static u8 pop_report_in_10s = 0; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ if (btcoexist->stop_coex_dm) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (psd_scan->ant_det_try_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", -+ "Ant PG Num/ Mech/ Pos", -+ board_info->pg_ant_num, board_info->btdm_ant_num, -+ board_info->btdm_ant_pos); -+ CL_PRINTF(cli_buf); -+ } else { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d (%d/%d/%d)", -+ "Ant PG Num/ Mech(Ant_Det)/ Pos", -+ board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, -+ board_info->btdm_ant_pos, -+ psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, -+ psd_scan->ant_det_result); -+ CL_PRINTF(cli_buf); -+ -+ if (board_info->btdm_ant_det_finish) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "Ant Det PSD Value", -+ psd_scan->ant_det_peak_val); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", -+ "CoexVer/ FwVer/ PatchVer", -+ glcoex_ver_date_8822b_1ant, glcoex_ver_8822b_1ant, fw_ver, -+ bt_patch_ver, bt_patch_ver); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", -+ "WifibHiPri/ Ccklock/ CckEverLock", -+ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), -+ (coex_sta->cck_lock ? "Yes" : "No"), -+ (coex_sta->cck_ever_lock ? "Yes" : "No")); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ pop_report_in_10s++; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt/ popCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") -+ : ((BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi, coex_sta->bt_retry_cnt, -+ coex_sta->pop_event_cnt); -+ CL_PRINTF(cli_buf); -+ -+ if (pop_report_in_10s >= 5) { -+ coex_sta->pop_event_cnt = 0; -+ pop_report_in_10s = 0; -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d / %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP/Hi-Pri", -+ bt_link_info->sco_exist, bt_link_info->hid_exist, -+ bt_link_info->pan_exist, bt_link_info->a2dp_exist, -+ bt_link_info->bt_hi_pri_link_exist); -+ CL_PRINTF(cli_buf); -+ -+ { -+ bt_info_ext = coex_sta->bt_info_ext; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", -+ "BT Role/A2DP rate", -+ (bt_link_info->slave_role) ? "Slave" : "Master", -+ (bt_info_ext & BIT(0)) ? "BR" : "EDR"); -+ CL_PRINTF(cli_buf); -+ } -+ -+ /*bt info*/ -+ for (i = 0; i < BT_INFO_SRC_8822B_1ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8822b_1ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ -+ if (btcoexist->manual_control) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms] (before Manual)============"); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "SM[LowPenaltyRA]", -+ coex_dm->cur_low_penalty_ra); -+ CL_PRINTF(cli_buf); -+ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), -+ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); -+ -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "WL/BT Coex Table Type", -+ coex_sta->coex_table_type); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x778/0x6cc/IgnWlanAct", -+ u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa0); -+ u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "LTE Coex Table W_L/B_L", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa8); -+ u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xac); -+ u32tmp[2] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb0); -+ u32tmp[3] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "LTE Break Table W_L/B_L/L_W/L_B", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, -+ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "0x430/0x434/0x42a/0x456", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", -+ "LTE CoexOn/Path Ctrl Owner", -+ (int)((u32tmp[0]&BIT(7)) >> 7), ((u8tmp[0]&BIT(2)) ? "WL" : "BT")); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "LTE 3Wire/OPMode/UART/UARTMode", -+ (int)((u32tmp[0]&BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), -+ (int)((u32tmp[0]&BIT(3)) >> 3), -+ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", -+ "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", -+ (int)((u32tmp[0]&BIT(12)) >> 12), (int)((u32tmp[0]&BIT(14)) >> 14), -+ ((u8tmp[0]&BIT(3)) ? "On" : "Off")); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", -+ (int)((u32tmp[0]&BIT(2)) >> 2), (int)((u32tmp[0]&BIT(3)) >> 3), -+ (int)((u32tmp[0]&BIT(1)) >> 1), (int)(u32tmp[0]&BIT(0))); -+ CL_PRINTF(cli_buf); -+ -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x4c6[4]/0x40[5] (WL/BT PTA)", -+ (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s", -+ "0x550(bcn ctrl)/0x522/4-RxAGC", -+ u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); -+ u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); -+ -+ fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) -+ >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + \ -+ ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & -+ 0xffff) ; -+ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; -+ -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xc50); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0xc50/OFDM-CCA/OFDM-FA/CCK-FA", -+ u32tmp[1] & 0xff, u32tmp[0] & 0xffff, fa_of_dm, fa_cck); -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_OK CCK/11g/11n/11n-Agg", -+ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, -+ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_Err CCK/11g/11n/11n-Agg", -+ coex_sta->crc_err_cck, coex_sta->crc_err_11g, -+ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(high-pri rx/tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(low-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+#if (BT_AUTO_REPORT_ONLY_8822B_1ANT == 1) -+ /* halbtc8822b1ant_monitor_bt_ctr(btcoexist); */ -+#endif -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+} -+void ex_halbtc8822b1ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{} -+void ex_halbtc8822b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) -+{} -+void ex_halbtc8822b1ant_dbg_control(IN struct btc_coexist *btcoexist, -+ IN u8 op_code, IN u8 op_len, IN u8 *pdata) -+{ -+ switch (op_code) { -+ case BTC_DBG_SET_COEX_MANUAL_CTRL: { -+ boolean manual = (boolean)*pdata; -+ -+ halbtc8822b1ant_setManual(btcoexist, manual); -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+#else -+void ex_halbtc8822b1ant_power_on_setting(IN struct btc_coexist *btcoexist) -+{ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ u8 u8tmp = 0x0; -+ u16 u16tmp = 0x0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "xxxxxxxxxxxxxxxx Execute 8822b 1-Ant PowerOn Setting!! xxxxxxxxxxxxxxxx\n"); -+ BTC_TRACE(trace_buf); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "Ant Det Finish = %s, Ant Det Number = %d\n", -+ board_info->btdm_ant_det_finish ? "Yes" : "No", -+ board_info->btdm_ant_num_by_ant_det); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = true; -+ -+ /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ -+ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); -+ btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); -+ -+ /* set Path control owner to WiFi */ -+ halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, -+ BT_8822B_1ANT_PCO_WLSIDE); -+ -+ /* set GNT_BT to high */ -+ halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8822B_1ANT_GNT_CTRL_BY_SW, -+ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); -+ /* Set GNT_WL to low */ -+ halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB, -+ BT_8822B_1ANT_GNT_CTRL_BY_SW, -+ BT_8822B_1ANT_SIG_STA_SET_TO_LOW); -+ -+ /* set WLAN_ACT = 0 */ -+ //btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); -+ -+ /* SD1 Chunchu red x issue */ -+ btcoexist->btc_write_1byte(btcoexist, 0xff1a, 0x0); -+ -+ halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, TRUE); -+ -+ /* */ -+ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ -+ /* Local setting bit define */ -+ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ -+ /* BIT1: "0" for internal switch; "1" for external switch */ -+ /* BIT2: "0" for one antenna; "1" for two antenna */ -+ /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ -+ -+ u8tmp = 0; -+ board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+ -+ if (btcoexist->chip_interface == BTC_INTF_USB) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); -+ else if (btcoexist->chip_interface == BTC_INTF_SDIO) -+ btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); -+ -+ BTC_TRACE(trace_buf); -+ -+ -+} -+ -+void ex_halbtc8822b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -+{ -+} -+ -+void ex_halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (ini hw config) **********\n"); -+ -+ halbtc8822b1ant_init_hw_config(btcoexist, true, wifi_only); -+ btcoexist->stop_coex_dm = false; -+} -+ -+void ex_halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Coex Mechanism Init!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ btcoexist->stop_coex_dm = false; -+ -+ halbtc8822b1ant_init_coex_dm(btcoexist); -+ -+ halbtc8822b1ant_query_bt_info(btcoexist); -+} -+ -+void ex_halbtc8822b1ant_display_coex_info(IN struct btc_coexist *btcoexist) -+{ -+ -+ struct btc_board_info *board_info = &btcoexist->board_info; -+ struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; -+ u8 *cli_buf = btcoexist->cli_buf; -+ u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; -+ u16 u16tmp[4]; -+ u32 u32tmp[4]; -+ u32 fa_of_dm, fa_cck; -+ u32 fw_ver = 0, bt_patch_ver = 0; -+ static u8 pop_report_in_10s = 0; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (display coexinfo) **********\n"); -+ BTC_TRACE(trace_buf); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** displaycoexinfostart, 0xcb4/0xcbd = 0x%x/0x%x\n", -+ btcoexist->btc_read_1byte(btcoexist, 0xcb4), -+ btcoexist->btc_read_1byte(btcoexist, 0xcbd)); -+ BTC_TRACE(trace_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[BT Coexist info]============"); -+ CL_PRINTF(cli_buf); -+ -+ if (btcoexist->manual_control) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Under Manual Control]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (btcoexist->stop_coex_dm) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n ============[Coex is STOPPED]============"); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n =========================================="); -+ CL_PRINTF(cli_buf); -+ } -+ -+ if (psd_scan->ant_det_try_count == 0) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "Ant PG Num/ Mech/ Pos/ RFE", -+ board_info->pg_ant_num, board_info->btdm_ant_num, -+ board_info->btdm_ant_pos, -+ rfe_type->rfe_module_type); -+ CL_PRINTF(cli_buf); -+ } else { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d/ %d/ %d/ %d (%d/%d/%d)", -+ "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", -+ board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, -+ board_info->btdm_ant_pos, -+ rfe_type->rfe_module_type, -+ psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, -+ psd_scan->ant_det_result); -+ CL_PRINTF(cli_buf); -+ -+ if (board_info->btdm_ant_det_finish) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", -+ "Ant Det PSD Value", -+ psd_scan->ant_det_peak_val); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", -+ "Version Coex/ Fw/ Patch/ Cut", -+ glcoex_ver_date_8822b_1ant, glcoex_ver_8822b_1ant, fw_ver, -+ bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", -+ "Wifi channel informed to BT", -+ coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], -+ coex_dm->wifi_chnl_info[2]); -+ CL_PRINTF(cli_buf); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", -+ "WifibHiPri/ Ccklock/ CckEverLock", -+ (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), -+ (coex_sta->cck_lock ? "Yes" : "No"), -+ (coex_sta->cck_ever_lock ? "Yes" : "No")); -+ CL_PRINTF(cli_buf); -+ -+ /* wifi status */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Wifi Status]============"); -+ CL_PRINTF(cli_buf); -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[BT Status]============"); -+ CL_PRINTF(cli_buf); -+ -+ pop_report_in_10s++; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", -+ "BT [status/ rssi/ retryCnt/ popCnt]", -+ ((coex_sta->bt_disabled) ? ("disabled") : (( -+ coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") -+ : ((BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == -+ coex_dm->bt_status) ? "non-connected idle" : -+ ((BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) -+ ? "connected-idle" : "busy")))), -+ coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, -+ coex_sta->pop_event_cnt); -+ CL_PRINTF(cli_buf); -+ /*bt rssi */ -+ /*bt pop_even_cnt : bt retry*/ -+ -+ if (pop_report_in_10s >= 5) { -+ coex_sta->pop_event_cnt = 0; -+ pop_report_in_10s = 0; -+ } -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %d / %d / %d / %d / %d", -+ "SCO/HID/PAN/A2DP/Hi-Pri", -+ bt_link_info->sco_exist, bt_link_info->hid_exist, -+ bt_link_info->pan_exist, bt_link_info->a2dp_exist, -+ bt_link_info->bt_hi_pri_link_exist); -+ CL_PRINTF(cli_buf); -+ -+ { -+ bt_info_ext = coex_sta->bt_info_ext; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d/ %x/ %04x", -+ "Role/A2DP Rate/Bitpool/Feature/Ver", -+ ((bt_link_info->slave_role) ? "Slave" : "Master"), -+ (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool, -+ coex_sta->bt_coex_supported_feature, -+ coex_sta->bt_coex_supported_version); -+ CL_PRINTF(cli_buf); -+ } -+ -+ /*bt info*/ -+ for (i = 0; i < BT_INFO_SRC_8822B_1ANT_MAX; i++) { -+ if (coex_sta->bt_info_c2h_cnt[i]) { -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", -+ glbt_info_src_8822b_1ant[i], -+ coex_sta->bt_info_c2h[i][0], -+ coex_sta->bt_info_c2h[i][1], -+ coex_sta->bt_info_c2h[i][2], -+ coex_sta->bt_info_c2h[i][3], -+ coex_sta->bt_info_c2h[i][4], -+ coex_sta->bt_info_c2h[i][5], -+ coex_sta->bt_info_c2h[i][6], -+ coex_sta->bt_info_c2h_cnt[i]); -+ CL_PRINTF(cli_buf); -+ } -+ } -+ -+ -+ if (btcoexist->manual_control) -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms] (before Manual)============"); -+ else -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[mechanisms]============"); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "SM[LowPenaltyRA]", -+ coex_dm->cur_low_penalty_ra); -+ CL_PRINTF(cli_buf); -+ -+ /*(ps)tdma*/ -+ ps_tdma_case = coex_dm->cur_ps_tdma; -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", -+ "PS TDMA", -+ coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], -+ coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], -+ coex_dm->ps_tdma_para[4], ps_tdma_case, -+ (coex_dm->cur_ps_tdma_on ? "On" : "Off"), -+ (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); -+ -+ CL_PRINTF(cli_buf); -+ -+ /*coex table type*/ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", -+ "WL/BT Coex Table Type", -+ coex_sta->coex_table_type); -+ CL_PRINTF(cli_buf); -+ -+ /*coex table :0x6c0 0x6c4 , break table: 0x6c8*/ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x6c0/0x6c4/0x6c8(coexTable)", -+ u32tmp[0], u32tmp[1], u32tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ /*PTA : 0x778=1/3/d , WL BA,RTS,CTS :0x6cc H/L pri */ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x778/0x6cc/IgnWlanAct", -+ u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); -+ CL_PRINTF(cli_buf); -+ -+ -+ /*LTE : WL/LTE coex table : 0xa0 */ -+ -+ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa0); -+ -+ /*LTE : BT/LTE coex table : 0xa4 */ -+ u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "LTE Coex Table W_L/B_L", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ /*LTE : WL/LTE break table : 0xa8 */ -+ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xa8); -+ /*LTE : WL/LTE break table : 0xac */ -+ u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xac); -+ /*LTE : LTE/WL break table : 0xb0 */ -+ u32tmp[2] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb0); -+ /*LTE : LTE/BT break table : 0xb4 */ -+ u32tmp[3] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, -+ 0xb4); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "LTE Break Table W_L/B_L/L_W/L_B", -+ u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, -+ u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); -+ CL_PRINTF(cli_buf); -+ -+ /* Hw setting */ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", -+ "============[Hw setting]============"); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); -+ u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", -+ "0x430/0x434/0x42a/0x456", -+ u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); -+ CL_PRINTF(cli_buf); -+ -+ /*ANT setting*/ -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xcb4); -+ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xcbd); -+ u8tmp[3] = btcoexist->btc_read_1byte(btcoexist, 0x1991); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0xcb4/0xcbd/0x1991", -+ u8tmp[1], u8tmp[2], u8tmp[3]); -+ CL_PRINTF(cli_buf); -+ -+ /*LTE on/off , Path ctrl owner*/ -+ /*sy add*/ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x64); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", -+ "0x73/ 0x4c/ 0x64[0]", u8tmp[0], (u32tmp[0] & ( BIT(24) | BIT(23) )) >> 23, u8tmp[1]&0x1); -+ CL_PRINTF(cli_buf); -+ -+ -+ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", -+ "LTE CoexOn/Path Ctrl Owner", -+ (int)((u32tmp[0]&BIT(7)) >> 7), ((u8tmp[0]&BIT(2)) ? "WL" : "BT")); -+ CL_PRINTF(cli_buf); -+ -+ /*LTE mode*/ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "LTE 3Wire/OPMode/UART/UARTMode", -+ (int)((u32tmp[0]&BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), -+ (int)((u32tmp[0]&BIT(3)) >> 3), -+ (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", -+ "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", -+ (int)((u32tmp[0]&BIT(12)) >> 12), (int)((u32tmp[0]&BIT(14)) >> 14), -+ ((u8tmp[0]&BIT(3)) ? "On" : "Off")); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", -+ (int)((u32tmp[0]&BIT(2)) >> 2), (int)((u32tmp[0]&BIT(3)) >> 3), -+ (int)((u32tmp[0]&BIT(1)) >> 1), (int)(u32tmp[0]&BIT(0))); -+ CL_PRINTF(cli_buf); -+ -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", -+ "0x4c6[4]/0x40[5] (WL/BT PTA)", -+ (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x974); -+ u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xc50); -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "0x550(bcn ctrl)/0x522/0x974/0xc50", -+ u32tmp[0], u8tmp[0], u8tmp[1], u8tmp[2]); -+ CL_PRINTF(cli_buf); -+ -+ u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); -+ u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xf4c); -+ u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xf08); -+ -+ u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); -+ u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5d); -+ -+ fa_of_dm = (u32tmp[0] & 0xffff) + (u32tmp[1] & 0xffff); -+ -+ fa_cck = (u8tmp[0] << 8) + u8tmp[1]; -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, -+ "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", -+ "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", -+ u32tmp[2] & 0xffff, fa_cck, ((u32tmp[2] & 0xffff0000) >> 16), fa_of_dm); -+ CL_PRINTF(cli_buf); -+ -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_OK CCK/11g/11n/11ac", -+ coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, -+ coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", -+ "CRC_Err CCK/11g/11n/11ac", -+ coex_sta->crc_err_cck, coex_sta->crc_err_11g, -+ coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); -+ CL_PRINTF(cli_buf); -+ -+ /*0x770:bt high pri trx*/ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x770(high-pri rx/tx)", -+ coex_sta->high_priority_rx, coex_sta->high_priority_tx); -+ CL_PRINTF(cli_buf); -+ /*0x774:bt low pri trx*/ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", -+ "0x774(low-pri rx/tx)", -+ coex_sta->low_priority_rx, coex_sta->low_priority_tx); -+ CL_PRINTF(cli_buf); -+ -+ halbtc8822b1ant_read_score_board(btcoexist, &u16tmp[0]); -+ -+ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", -+ "ScoreBoard[14:0] (from BT)", u16tmp[0]); -+ -+ btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** displaycoexinfo end, 0xcb4/0xcbd = 0x%x/0x%x\n", -+ btcoexist->btc_read_1byte(btcoexist, 0xcb4), -+ btcoexist->btc_read_1byte(btcoexist, 0xcbd)); -+ BTC_TRACE(trace_buf); -+} -+ -+ -+void ex_halbtc8822b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ -+ if (BTC_IPS_ENTER == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS ENTER notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_ips = true; -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8822B_1ANT_PHASE_WLAN_OFF); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -+ } else if (BTC_IPS_LEAVE == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], IPS LEAVE notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); -+ -+ /*leave IPS : run ini hw config (exclude wifi only)*/ -+ halbtc8822b1ant_init_hw_config(btcoexist, false, false); -+ /*sw all off*/ -+ halbtc8822b1ant_init_coex_dm(btcoexist); -+ /*leave IPS : Query bt info*/ -+ halbtc8822b1ant_query_bt_info(btcoexist); -+ -+ coex_sta->under_ips = false; -+ } -+} -+ -+void ex_halbtc8822b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -+{ -+ if (btcoexist->manual_control || btcoexist->stop_coex_dm) -+ return; -+ -+ if (BTC_LPS_ENABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS ENABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = true; -+ -+ if (coex_sta->force_lps_on == true) { /* LPS No-32K */ -+ /* Write WL "Active" in Score-board for PS-TDMA */ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); -+ -+ } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ -+ /* Write WL "Non-Active" in Score-board for Native-PS */ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); -+ -+ } -+ } else if (BTC_LPS_DISABLE == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], LPS DISABLE notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->under_lps = false; -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); -+ } -+} -+ -+ -+void ex_halbtc8822b1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN notify()\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ if (BTC_SCAN_START == type) -+ return; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ -+ if (BTC_SCAN_START_2G == type) { -+ coex_sta->wifi_is_high_pri_task = true; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 2g SCAN START notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8822b1ant_action_wifi_not_connected_scan( -+ btcoexist); -+ else /* wifi is connected */ -+ halbtc8822b1ant_action_wifi_connected_scan(btcoexist); -+ -+ } else { -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ /*WL scan finish , then get and update sacn ap numbers */ -+ btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, -+ &coex_sta->scan_ap_num); -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num); -+ BTC_TRACE(trace_buf); -+ -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8822b1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8822b1ant_action_wifi_connected(btcoexist); -+ } -+ -+ -+} -+ -+void ex_halbtc8822b1ant_switchband_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ -+ boolean wifi_connected = false; -+ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (switchband_notify) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm) -+ return; -+ -+ -+ if(type == BTC_SWITCH_TO_5G) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (switchband_notify BTC_SWITCH_TO_5G) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_action_wifi_under5g(btcoexist); -+ return; -+ } else if (type == BTC_SWITCH_TO_24G_NoForScan) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (switchband_notify BTC_SWITCH_TO_2G (no for scan)) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_run_coexist_mechanism(btcoexist); -+ -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (switchband_notify BTC_SWITCH_TO_2G) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ ex_halbtc8822b1ant_scan_notify(btcoexist, -+ BTC_SCAN_START_2G); -+ } -+ -+} -+ -+void ex_halbtc8822b1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_connected = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (connect notify) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); -+ -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ -+ if ( (BTC_ASSOCIATE_5G_START == type) || (BTC_ASSOCIATE_5G_FINISH== type)) { -+ -+ if (BTC_ASSOCIATE_5G_START== type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (5G associate start notify) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_action_wifi_under5g(btcoexist); -+ -+ } else if (BTC_ASSOCIATE_5G_FINISH == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (5G associate finish notify) **********\n"); -+ BTC_TRACE(trace_buf); -+ -+ } -+ -+ return; -+ -+} -+ -+ -+ if (BTC_ASSOCIATE_START == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 2G CONNECT START notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME); -+ -+ coex_dm->arp_cnt = 0; -+ -+ halbtc8822b1ant_action_wifi_not_connected_asso_auth(btcoexist); -+ -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 2G CONNECT Finish notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ -+ if (!wifi_connected) /* non-connected scan */ -+ halbtc8822b1ant_action_wifi_not_connected(btcoexist); -+ else -+ halbtc8822b1ant_action_wifi_connected(btcoexist); -+ } -+ -+} -+ -+void ex_halbtc8822b1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean wifi_under_b_mode = false; -+ boolean wifi_under_5g = false; -+ u32 cnt_bt_cal_chk = 0; -+ boolean is_in_mp_mode = false; -+ u8 u8tmp = 0; -+ u32 u32tmp1 = 0, u32tmp2 = 0; -+ -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if(wifi_under_5g) -+ { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 5g media notify \n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); -+ -+ halbtc8822b1ant_action_wifi_under5g(btcoexist); -+ return; -+ } -+ -+ -+ -+ if (BTC_MEDIA_CONNECT == type) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 2g media connect notify"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, -+ &wifi_under_b_mode); -+ -+ /* Set CCK Tx/Rx high Pri except 11b mode */ -+ if (wifi_under_b_mode) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (media status notity under b mode) **********\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x00); /* CCK Rx */ -+ } else { -+ /* btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x10); */ /*CCK Tx */ -+ /* btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); */ /*CCK Rx */ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (media status notity not under b mode) **********\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, -+ 0x00); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, -+ 0x10); /* CCK Rx */ -+ } -+ -+ coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, -+ 0x430); -+ coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, -+ 0x434); -+ coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( -+ btcoexist, 0x42a); -+ coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( -+ btcoexist, 0x456); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 2g media disconnect notify\n"); -+ BTC_TRACE(trace_buf); -+ coex_dm->arp_cnt = 0; -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); -+ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ -+ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ -+ -+ coex_sta->cck_ever_lock = false; -+ } -+ -+ halbtc8822b1ant_update_wifi_channel_info(btcoexist, type); -+ -+} -+ -+void ex_halbtc8822b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ boolean under_4way = false, wifi_under_5g = false; -+ -+ if (btcoexist->manual_control || -+ btcoexist->stop_coex_dm || -+ coex_sta->bt_disabled) -+ return; -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ if(wifi_under_5g) -+ { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], 5g special packet notify \n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_action_wifi_under5g(btcoexist); -+ return; -+ } -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ &under_4way); -+ -+ if (under_4way) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ---- under_4way!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } else if (BTC_PACKET_ARP == type) { -+ -+ coex_dm->arp_cnt++; -+ -+ if (coex_sta->wifi_is_high_pri_task) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt); -+ BTC_TRACE(trace_buf); -+ } -+ -+ } else { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type); -+ BTC_TRACE(trace_buf); -+ -+ coex_sta->wifi_is_high_pri_task = true; -+ coex_sta->specific_pkt_period_cnt = 2; -+ } -+ -+ if (coex_sta->wifi_is_high_pri_task) -+ halbtc8822b1ant_action_wifi_connected_specific_packet(btcoexist); -+ -+} -+ -+void ex_halbtc8822b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length) -+{ -+ u8 bt_info = 0; -+ u8 i, rsp_source = 0; -+ boolean bt_busy = false; -+ boolean wifi_connected = false; -+ boolean wifi_under_5g = false; -+ -+ -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); -+ -+ coex_sta->c2h_bt_info_req_sent = false; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ********** (BtInfo Notify) **********\n" ); -+ BTC_TRACE(trace_buf); -+ -+ rsp_source = tmp_buf[0] & 0xf; -+ if (rsp_source >= BT_INFO_SRC_8822B_1ANT_MAX) -+ rsp_source = BT_INFO_SRC_8822B_1ANT_WIFI_FW; -+ coex_sta->bt_info_c2h_cnt[rsp_source]++; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -+ length); -+ BTC_TRACE(trace_buf); -+ -+ for (i = 0; i < length; i++) { -+ coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; -+ if (i == 1) -+ bt_info = tmp_buf[i]; -+ if (i == length - 1) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } else { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", -+ tmp_buf[i]); -+ BTC_TRACE(trace_buf); -+ } -+ } -+ -+ -+ if (BT_INFO_SRC_8822B_1ANT_WIFI_FW != rsp_source) { -+ -+ /* if 0xff, it means BT is under WHCK test */ -+ if (bt_info == 0xff) -+ coex_sta->bt_whck_test = true; -+ else -+ coex_sta->bt_whck_test = false; -+ -+ coex_sta->bt_retry_cnt = /* [3:0] */ -+ coex_sta->bt_info_c2h[rsp_source][2] & 0xf; -+ -+ if (coex_sta->bt_retry_cnt >= 1) -+ coex_sta->pop_event_cnt++; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) -+ coex_sta->c2h_bt_page = true; -+ else -+ coex_sta->c2h_bt_page = false; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80) -+ coex_sta->bt_create_connection = true; -+ else -+ coex_sta->bt_create_connection = false; -+ -+ /* unit: %, value-100 to translate to unit: dBm */ -+ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; -+ -+ /* coex_sta->bt_info_c2h[rsp_source][3] * 2 - 90; */ -+ -+ if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { -+ coex_sta->a2dp_bit_pool = -+ coex_sta->bt_info_c2h[rsp_source][6]; -+ } else -+ coex_sta->a2dp_bit_pool = 0; -+ -+ if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9) -+ coex_sta->acl_busy = true; -+ else -+ coex_sta->acl_busy = false; -+ -+ coex_sta->bt_info_ext = -+ coex_sta->bt_info_c2h[rsp_source][4]; -+ -+ /* Here we need to resend some wifi info to BT */ -+ /* because bt is reset and loss of the info. */ -+ -+ if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) { -+ -+ /* Re-Init */ -+ if (coex_sta->bt_info_ext & BIT(1)) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -+ &wifi_connected); -+ if (wifi_connected) -+ halbtc8822b1ant_update_wifi_channel_info(btcoexist, -+ BTC_MEDIA_CONNECT); -+ else -+ halbtc8822b1ant_update_wifi_channel_info(btcoexist, -+ BTC_MEDIA_DISCONNECT); -+ } -+ -+ /* If Ignore_WLanAct && not SetUp_Link */ -+ if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); -+ BTC_TRACE(trace_buf); -+ halbtc8822b1ant_ignore_wlan_act(btcoexist, -+ FORCE_EXEC, false); -+ } -+ } -+ /* check BIT2 first ==> check if bt is under inquiry or page scan */ -+ if (bt_info & BT_INFO_8822B_1ANT_B_INQ_PAGE) -+ coex_sta->c2h_bt_inquiry_page = true; -+ else -+ coex_sta->c2h_bt_inquiry_page = false; -+ } -+ -+ coex_sta->num_of_profile = 0; -+ -+ /* set link exist status */ -+ if (!(bt_info & BT_INFO_8822B_1ANT_B_CONNECTION)) { -+ coex_sta->bt_link_exist = false; -+ coex_sta->pan_exist = false; -+ coex_sta->a2dp_exist = false; -+ coex_sta->hid_exist = false; -+ coex_sta->sco_exist = false; -+ -+ coex_sta->bt_hi_pri_link_exist = false; -+ } else { /* connection exists */ -+ coex_sta->bt_link_exist = true; -+ if (bt_info & BT_INFO_8822B_1ANT_B_FTP) { -+ coex_sta->pan_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->pan_exist = false; -+ if (bt_info & BT_INFO_8822B_1ANT_B_A2DP) { -+ coex_sta->a2dp_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->a2dp_exist = false; -+ if (bt_info & BT_INFO_8822B_1ANT_B_HID) { -+ coex_sta->hid_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->hid_exist = false; -+ if (bt_info & BT_INFO_8822B_1ANT_B_SCO_ESCO) { -+ coex_sta->sco_exist = true; -+ coex_sta->num_of_profile++; -+ } else -+ coex_sta->sco_exist = false; -+ -+ } -+ -+ halbtc8822b1ant_update_bt_link_info(btcoexist); -+ -+ bt_info = bt_info & -+ 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ -+ -+ if (!(bt_info & BT_INFO_8822B_1ANT_B_CONNECTION)) { -+ coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info == -+ BT_INFO_8822B_1ANT_B_CONNECTION) { /* connection exists but no busy */ -+ coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if ((bt_info & BT_INFO_8822B_1ANT_B_SCO_ESCO) || -+ (bt_info & BT_INFO_8822B_1ANT_B_SCO_BUSY)) { -+ coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_SCO_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else if (bt_info & BT_INFO_8822B_1ANT_B_ACL_BUSY) { -+ if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) -+ coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_ACL_BUSY; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); -+ BTC_TRACE(trace_buf); -+ } else { -+ coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_MAX; -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); -+ BTC_TRACE(trace_buf); -+ } -+ -+ if ((BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || -+ (BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || -+ (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) -+ bt_busy = true; -+ else -+ bt_busy = false; -+ -+ btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -+ -+ halbtc8822b1ant_run_coexist_mechanism(btcoexist); -+} -+ -+void ex_halbtc8822b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_RF_ON == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned ON!!\n"); -+ BTC_TRACE(trace_buf); -+ btcoexist->stop_coex_dm = false; -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); -+ halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, true); -+ } else if (BTC_RF_OFF == type) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], RF is turned OFF!!\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8822B_1ANT_PHASE_WLAN_OFF); -+ -+ halbtc8822b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ -+ btcoexist->stop_coex_dm = true; -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); -+ halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, false); -+ -+ } -+} -+ -+void ex_halbtc8822b1ant_halt_notify(IN struct btc_coexist *btcoexist) -+{ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); -+ halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, false); -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8822B_1ANT_PHASE_WLAN_OFF); -+ -+ halbtc8822b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); -+ -+ ex_halbtc8822b1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -+ -+ halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, FALSE); -+ -+ btcoexist->stop_coex_dm = true; -+} -+ -+void ex_halbtc8822b1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state) -+{ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); -+ BTC_TRACE(trace_buf); -+ -+ if (BTC_WIFI_PNP_SLEEP == pnp_state) { -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to SLEEP\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); -+ halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, false); -+ -+ halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -+ -+ halbtc8822b1ant_set_ant_path(btcoexist, -+ BTC_ANT_PATH_AUTO, -+ FORCE_EXEC, -+ BT_8822B_1ANT_PHASE_WLAN_OFF); -+ -+ halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, -+ 5); -+ -+ halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, FALSE); -+ -+ btcoexist->stop_coex_dm = true; -+ } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], Pnp notify to WAKE UP\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); -+ halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, true); -+ -+ btcoexist->stop_coex_dm = false; -+ } -+} -+ -+void ex_halbtc8822b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) -+{ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], *****************Coex DM Reset*****************\n"); -+ BTC_TRACE(trace_buf); -+ -+ halbtc8822b1ant_init_hw_config(btcoexist, false, false); -+ halbtc8822b1ant_init_coex_dm(btcoexist); -+} -+ -+void ex_halbtc8822b1ant_periodical(IN struct btc_coexist *btcoexist) -+{ -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ==========================Periodical===========================\n"); -+ BTC_TRACE(trace_buf); -+ -+#if (BT_AUTO_REPORT_ONLY_8822B_1ANT == 0) -+ halbtc8822b1ant_query_bt_info(btcoexist); -+#endif -+ -+ halbtc8822b1ant_monitor_bt_ctr(btcoexist); -+ halbtc8822b1ant_monitor_wifi_ctr(btcoexist); -+ -+ halbtc8822b1ant_monitor_bt_enable_disable(btcoexist); -+ -+ /* for 4-way, DHCP, EAPOL packet */ -+ if (coex_sta->specific_pkt_period_cnt > 0) { -+ -+ coex_sta->specific_pkt_period_cnt--; -+ -+ if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) -+ coex_sta->wifi_is_high_pri_task = false; -+ -+ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -+ "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); -+ BTC_TRACE(trace_buf); -+ } -+ -+ -+ if (coex_sta->bt_coex_supported_feature == 0) -+ coex_sta->bt_coex_supported_feature = btcoexist->btc_get_bt_coex_supported_feature(btcoexist); -+ -+ if ( (coex_sta->bt_coex_supported_version == 0) && (!coex_sta->bt_disabled) ) -+ coex_sta->bt_coex_supported_version = btcoexist->btc_get_bt_coex_supported_version(btcoexist); -+ -+ if (halbtc8822b1ant_is_wifi_status_changed(btcoexist)) -+ halbtc8822b1ant_run_coexist_mechanism(btcoexist); -+ -+} -+ -+void ex_halbtc8822b1ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+} -+ -+void ex_halbtc8822b1ant_antenna_isolation(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+ -+ -+} -+ -+void ex_halbtc8822b1ant_psd_scan(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -+{ -+ -+ -+} -+ -+void ex_halbtc8822b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) -+{ -+ -+} -+ -+void ex_halbtc8822b1ant_dbg_control(IN struct btc_coexist *btcoexist, -+ IN u8 op_code, IN u8 op_len, IN u8 *pdata) -+{} -+#endif /* #if(BTC_COEX_OFFLOAD == 1) */ -+ -+#endif -+ -+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtc8822b1Ant.h 2018-02-11 21:44:27.148146101 +0200 -@@ -0,0 +1,408 @@ -+ -+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) -+ -+#if (RTL8822B_SUPPORT == 1) -+ -+/* ******************************************* -+ * The following is for 8822B 1ANT BT Co-exist definition -+ * ******************************************* */ -+#define BT_AUTO_REPORT_ONLY_8822B_1ANT 1 -+ -+#define BT_INFO_8822B_1ANT_B_FTP BIT(7) -+#define BT_INFO_8822B_1ANT_B_A2DP BIT(6) -+#define BT_INFO_8822B_1ANT_B_HID BIT(5) -+#define BT_INFO_8822B_1ANT_B_SCO_BUSY BIT(4) -+#define BT_INFO_8822B_1ANT_B_ACL_BUSY BIT(3) -+#define BT_INFO_8822B_1ANT_B_INQ_PAGE BIT(2) -+#define BT_INFO_8822B_1ANT_B_SCO_ESCO BIT(1) -+#define BT_INFO_8822B_1ANT_B_CONNECTION BIT(0) -+ -+#define BT_INFO_8822B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ -+ (((_BT_INFO_EXT_&BIT(0))) ? true : false) -+ -+#define BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT 2 -+ -+#define BT_8822B_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ -+ -+/* for Antenna detection */ -+#define BT_8822B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 -+#define BT_8822B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -+#define BT_8822B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 -+#define BT_8822B_1ANT_ANTDET_PSDTHRES_1ANT 35 -+#define BT_8822B_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -+#define BT_8822B_1ANT_ANTDET_ENABLE 0 -+#define BT_8822B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 -+ -+#define BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 -+#define BT_8822B_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ -+ -+ -+enum bt_8822b_1ant_signal_state { -+ BT_8822B_1ANT_SIG_STA_SET_TO_LOW = 0x0, -+ BT_8822B_1ANT_SIG_STA_SET_BY_HW = 0x0, -+ BT_8822B_1ANT_SIG_STA_SET_TO_HIGH = 0x1, -+ BT_8822B_1ANT_SIG_STA_MAX -+}; -+ -+enum bt_8822b_1ant_path_ctrl_owner { -+ BT_8822B_1ANT_PCO_BTSIDE = 0x0, -+ BT_8822B_1ANT_PCO_WLSIDE = 0x1, -+ BT_8822B_1ANT_PCO_MAX -+}; -+ -+enum bt_8822b_1ant_gnt_ctrl_type { -+ BT_8822B_1ANT_GNT_CTRL_BY_PTA = 0x0, -+ BT_8822B_1ANT_GNT_CTRL_BY_SW = 0x1, -+ BT_8822B_1ANT_GNT_CTRL_MAX -+}; -+ -+enum bt_8822b_1ant_gnt_ctrl_block { -+ BT_8822B_1ANT_GNT_BLOCK_RFC_BB = 0x0, -+ BT_8822B_1ANT_GNT_BLOCK_RFC = 0x1, -+ BT_8822B_1ANT_GNT_BLOCK_BB = 0x2, -+ BT_8822B_1ANT_GNT_BLOCK_MAX -+}; -+ -+enum bt_8822b_1ant_lte_coex_table_type { -+ BT_8822B_1ANT_CTT_WL_VS_LTE = 0x0, -+ BT_8822B_1ANT_CTT_BT_VS_LTE = 0x1, -+ BT_8822B_1ANT_CTT_MAX -+}; -+ -+enum bt_8822b_1ant_lte_break_table_type { -+ BT_8822B_1ANT_LBTT_WL_BREAK_LTE = 0x0, -+ BT_8822B_1ANT_LBTT_BT_BREAK_LTE = 0x1, -+ BT_8822B_1ANT_LBTT_LTE_BREAK_WL = 0x2, -+ BT_8822B_1ANT_LBTT_LTE_BREAK_BT = 0x3, -+ BT_8822B_1ANT_LBTT_MAX -+}; -+ -+enum bt_info_src_8822b_1ant { -+ BT_INFO_SRC_8822B_1ANT_WIFI_FW = 0x0, -+ BT_INFO_SRC_8822B_1ANT_BT_RSP = 0x1, -+ BT_INFO_SRC_8822B_1ANT_BT_ACTIVE_SEND = 0x2, -+ BT_INFO_SRC_8822B_1ANT_MAX -+}; -+ -+enum bt_8822b_1ant_bt_status { -+ BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, -+ BT_8822B_1ANT_BT_STATUS_INQ_PAGE = 0x2, -+ BT_8822B_1ANT_BT_STATUS_ACL_BUSY = 0x3, -+ BT_8822B_1ANT_BT_STATUS_SCO_BUSY = 0x4, -+ BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, -+ BT_8822B_1ANT_BT_STATUS_MAX -+}; -+ -+enum bt_8822b_1ant_wifi_status { -+ BT_8822B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, -+ BT_8822B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, -+ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, -+ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, -+ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, -+ BT_8822B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, -+ BT_8822B_1ANT_WIFI_STATUS_MAX -+}; -+ -+enum bt_8822b_1ant_coex_algo { -+ BT_8822B_1ANT_COEX_ALGO_UNDEFINED = 0x0, -+ BT_8822B_1ANT_COEX_ALGO_SCO = 0x1, -+ BT_8822B_1ANT_COEX_ALGO_HID = 0x2, -+ BT_8822B_1ANT_COEX_ALGO_A2DP = 0x3, -+ BT_8822B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, -+ BT_8822B_1ANT_COEX_ALGO_PANEDR = 0x5, -+ BT_8822B_1ANT_COEX_ALGO_PANHS = 0x6, -+ BT_8822B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, -+ BT_8822B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, -+ BT_8822B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, -+ BT_8822B_1ANT_COEX_ALGO_HID_A2DP = 0xa, -+ BT_8822B_1ANT_COEX_ALGO_MAX = 0xb, -+}; -+ -+enum bt_8822b_1ant_ext_ant_switch_type { -+ BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT = 0x0, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SP3T = 0x1, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_MAX -+}; -+ -+enum bt_8822b_1ant_ext_ant_switch_ctrl_type { -+ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW = 0x0, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA = 0x1, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV = 0x2, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC = 0x3, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT = 0x4, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_MAX -+}; -+ -+enum bt_8822b_1ant_ext_ant_switch_pos_type { -+ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_BT = 0x0, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLG = 0x1, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLA = 0x2, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE = 0x3, -+ BT_8822B_1ANT_EXT_ANT_SWITCH_TO_MAX -+}; -+ -+enum bt_8822b_1ant_phase{ -+ BT_8822B_1ANT_PHASE_COEX_INIT = 0x0, -+ BT_8822B_1ANT_PHASE_WLANONLY_INIT = 0x1, -+ BT_8822B_1ANT_PHASE_WLAN_OFF = 0x2, -+ BT_8822B_1ANT_PHASE_2G_RUNTIME = 0x3, -+ BT_8822B_1ANT_PHASE_5G_RUNTIME = 0x4, -+ BT_8822B_1ANT_PHASE_BTMPMODE = 0x5, -+ BT_8822B_1ANT_PHASE_MAX -+}; -+ -+ -+struct coex_dm_8822b_1ant { -+ /* hw setting */ -+ u32 pre_ant_pos_type; -+ u32 cur_ant_pos_type; -+ /* fw mechanism */ -+ boolean cur_ignore_wlan_act; -+ boolean pre_ignore_wlan_act; -+ u8 pre_ps_tdma; -+ u8 cur_ps_tdma; -+ u8 ps_tdma_para[5]; -+ u8 ps_tdma_du_adj_type; -+ boolean auto_tdma_adjust; -+ boolean pre_ps_tdma_on; -+ boolean cur_ps_tdma_on; -+ boolean pre_bt_auto_report; -+ boolean cur_bt_auto_report; -+ u8 pre_lps; -+ u8 cur_lps; -+ u8 pre_rpwm; -+ u8 cur_rpwm; -+ -+ /* sw mechanism */ -+ boolean pre_low_penalty_ra; -+ boolean cur_low_penalty_ra; -+ u32 pre_val0x6c0; -+ u32 cur_val0x6c0; -+ u32 pre_val0x6c4; -+ u32 cur_val0x6c4; -+ u32 pre_val0x6c8; -+ u32 cur_val0x6c8; -+ u8 pre_val0x6cc; -+ u8 cur_val0x6cc; -+ boolean limited_dig; -+ -+ u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ -+ u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ -+ u16 backup_retry_limit; -+ u8 backup_ampdu_max_time; -+ -+ /* algorithm related */ -+ u8 pre_algorithm; -+ u8 cur_algorithm; -+ u8 bt_status; -+ u8 wifi_chnl_info[3]; -+ -+ u32 pre_ra_mask; -+ u32 cur_ra_mask; -+ u8 pre_arfr_type; -+ u8 cur_arfr_type; -+ u8 pre_retry_limit_type; -+ u8 cur_retry_limit_type; -+ u8 pre_ampdu_time_type; -+ u8 cur_ampdu_time_type; -+ u32 arp_cnt; -+ -+ u32 pre_ext_ant_switch_status; -+ u32 cur_ext_ant_switch_status; -+ -+ u8 error_condition; -+}; -+ -+struct coex_sta_8822b_1ant { -+ boolean bt_disabled; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ boolean pan_exist; -+ boolean bt_hi_pri_link_exist; -+ u8 num_of_profile; -+ -+ boolean under_lps; -+ boolean under_ips; -+ u32 specific_pkt_period_cnt; -+ u32 high_priority_tx; -+ u32 high_priority_rx; -+ u32 low_priority_tx; -+ u32 low_priority_rx; -+ s8 bt_rssi; -+ boolean bt_tx_rx_mask; -+ u8 pre_bt_rssi_state; -+ u8 pre_wifi_rssi_state[4]; -+ boolean c2h_bt_info_req_sent; -+ u8 bt_info_c2h[BT_INFO_SRC_8822B_1ANT_MAX][10]; -+ u32 bt_info_c2h_cnt[BT_INFO_SRC_8822B_1ANT_MAX]; -+ boolean bt_whck_test; -+ boolean c2h_bt_inquiry_page; -+ boolean c2h_bt_page; /* Add for win8.1 page out issue */ -+ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ -+ u8 bt_retry_cnt; -+ u8 bt_info_ext; -+ u32 pop_event_cnt; -+ u8 scan_ap_num; -+ -+ u32 crc_ok_cck; -+ u32 crc_ok_11g; -+ u32 crc_ok_11n; -+ u32 crc_ok_11n_agg; -+ -+ u32 crc_err_cck; -+ u32 crc_err_11g; -+ u32 crc_err_11n; -+ u32 crc_err_11n_agg; -+ -+ boolean cck_lock; -+ boolean pre_ccklock; -+ boolean cck_ever_lock; -+ u8 coex_table_type; -+ -+ boolean force_lps_on; -+ u32 wrong_profile_notification; -+ -+ boolean concurrent_rx_mode_on; -+ -+ u32 special_pkt_period_cnt; -+ -+ u16 score_board; -+ -+ u8 a2dp_bit_pool; -+ u8 cut_version; -+ boolean acl_busy; -+ boolean wl_rf_off_on_event; -+ boolean bt_create_connection; -+ boolean run_time_state; -+ -+ u32 bt_coex_supported_feature; -+ u32 bt_coex_supported_version; -+}; -+ -+struct rfe_type_8822b_1ant{ -+ -+ u8 rfe_module_type; -+ boolean ext_ant_switch_exist; -+ u8 ext_ant_switch_type; -+ u8 ext_ant_switch_ctrl_polarity; /* iF 0: ANTSW(rfe_sel9)=0, ANTSWB(rfe_sel8)=1 => Ant to BT/5G */ -+}; -+ -+ -+#define BT_8822B_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -+#define BT_8822B_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -+#define BT_8822B_1ANT_ANTDET_BUF_LEN 16 -+ -+struct psdscan_sta_8822b_1ant { -+ -+ u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ -+ u32 ant_det_bt_tx_time; -+ u32 ant_det_pre_psdscan_peak_val; -+ boolean ant_det_is_ant_det_available; -+ u32 ant_det_psd_scan_peak_val; -+ boolean ant_det_is_btreply_available; -+ u32 ant_det_psd_scan_peak_freq; -+ -+ u8 ant_det_result; -+ u8 ant_det_peak_val[BT_8822B_1ANT_ANTDET_BUF_LEN]; -+ u8 ant_det_peak_freq[BT_8822B_1ANT_ANTDET_BUF_LEN]; -+ u32 ant_det_try_count; -+ u32 ant_det_fail_count; -+ u32 ant_det_inteval_count; -+ u32 ant_det_thres_offset; -+ -+ u32 real_cent_freq; -+ s32 real_offset; -+ u32 real_span; -+ -+ u32 psd_band_width; /* unit: Hz */ -+ u32 psd_point; /* 128/256/512/1024 */ -+ u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ -+ u32 psd_start_point; -+ u32 psd_stop_point; -+ u32 psd_max_value_point; -+ u32 psd_max_value; -+ u32 psd_start_base; -+ u32 psd_avg_num; /* 1/8/16/32 */ -+ u32 psd_gen_count; -+ boolean is_psd_running; -+ boolean is_psd_show_max_only; -+}; -+ -+/* ******************************************* -+ * The following is interface which will notify coex module. -+ * ******************************************* */ -+void ex_halbtc8822b1ant_power_on_setting(IN struct btc_coexist *btcoexist); -+void ex_halbtc8822b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -+void ex_halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, -+ IN boolean wifi_only); -+void ex_halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -+void ex_halbtc8822b1ant_ips_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8822b1ant_lps_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8822b1ant_scan_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8822b1ant_switchband_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8822b1ant_connect_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8822b1ant_media_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8822b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8822b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8822b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, -+ IN u8 type); -+void ex_halbtc8822b1ant_halt_notify(IN struct btc_coexist *btcoexist); -+void ex_halbtc8822b1ant_pnp_notify(IN struct btc_coexist *btcoexist, -+ IN u8 pnp_state); -+void ex_halbtc8822b1ant_ScoreBoardStatusNotify(IN struct btc_coexist *btcoexist, -+ IN u8 *tmp_buf, IN u8 length); -+void ex_halbtc8822b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -+void ex_halbtc8822b1ant_periodical(IN struct btc_coexist *btcoexist); -+void ex_halbtc8822b1ant_display_coex_info(IN struct btc_coexist *btcoexist); -+void ex_halbtc8822b1ant_antenna_detection(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+void ex_halbtc8822b1ant_antenna_isolation(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+ -+void ex_halbtc8822b1ant_psd_scan(IN struct btc_coexist *btcoexist, -+ IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -+void ex_halbtc8822b1ant_display_ant_detection(IN struct btc_coexist *btcoexist); -+ -+void ex_halbtc8822b1ant_dbg_control(IN struct btc_coexist *btcoexist, -+ IN u8 op_code, IN u8 op_len, IN u8 *pdata); -+ -+#else -+#define ex_halbtc8822b1ant_power_on_setting(btcoexist) -+#define ex_halbtc8822b1ant_pre_load_firmware(btcoexist) -+#define ex_halbtc8822b1ant_init_hw_config(btcoexist, wifi_only) -+#define ex_halbtc8822b1ant_init_coex_dm(btcoexist) -+#define ex_halbtc8822b1ant_ips_notify(btcoexist, type) -+#define ex_halbtc8822b1ant_lps_notify(btcoexist, type) -+#define ex_halbtc8822b1ant_scan_notify(btcoexist, type) -+#define ex_halbtc8822b1ant_switchband_notify(btcoexist, type) -+#define ex_halbtc8822b1ant_connect_notify(btcoexist, type) -+#define ex_halbtc8822b1ant_media_status_notify(btcoexist, type) -+#define ex_halbtc8822b1ant_specific_packet_notify(btcoexist, type) -+#define ex_halbtc8822b1ant_bt_info_notify(btcoexist, tmp_buf, length) -+#define ex_halbtc8822b1ant_rf_status_notify(btcoexist, type) -+#define ex_halbtc8822b1ant_halt_notify(btcoexist) -+#define ex_halbtc8822b1ant_pnp_notify(btcoexist, pnp_state) -+#define ex_halbtc8822b1ant_ScoreBoardStatusNotify(btcoexist, tmp_buf, length) -+#define ex_halbtc8822b1ant_coex_dm_reset(btcoexist) -+#define ex_halbtc8822b1ant_periodical(btcoexist) -+#define ex_halbtc8822b1ant_display_coex_info(btcoexist) -+#define ex_halbtc8822b1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8822b1ant_antenna_isolation(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8822b1ant_psd_scan(btcoexist, cent_freq, offset, span, seconds) -+#define ex_halbtc8822b1ant_display_ant_detection(btcoexist) -+#define ex_halbtc8822b1ant_dbg_control(btcoexist, op_code, op_len, pdata) -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtcOutSrc.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtcOutSrc.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/HalBtcOutSrc.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/HalBtcOutSrc.h 2018-02-11 21:44:27.148146101 +0200 -@@ -0,0 +1,1000 @@ -+#ifndef __HALBTC_OUT_SRC_H__ -+#define __HALBTC_OUT_SRC_H__ -+ -+ -+#define BTC_COEX_OFFLOAD 0 -+#define BTC_TMP_BUF_SHORT 20 -+ -+extern u1Byte gl_btc_trace_buf[]; -+#define BTC_SPRINTF rsprintf -+#define BTC_TRACE(_MSG_)\ -+do {\ -+ if (GLBtcDbgType[COMP_COEX] & BIT(DBG_LOUD)) {\ -+ RTW_INFO("%s", _MSG_);\ -+ } \ -+} while (0) -+#define BT_PrintData(adapter, _MSG_, len, data) RTW_DBG_DUMP((_MSG_), data, len) -+ -+ -+#define NORMAL_EXEC FALSE -+#define FORCE_EXEC TRUE -+ -+#define BTC_RF_OFF 0x0 -+#define BTC_RF_ON 0x1 -+ -+#define BTC_RF_A 0x0 -+#define BTC_RF_B 0x1 -+#define BTC_RF_C 0x2 -+#define BTC_RF_D 0x3 -+ -+#define BTC_SMSP SINGLEMAC_SINGLEPHY -+#define BTC_DMDP DUALMAC_DUALPHY -+#define BTC_DMSP DUALMAC_SINGLEPHY -+#define BTC_MP_UNKNOWN 0xff -+ -+#define BT_COEX_ANT_TYPE_PG 0 -+#define BT_COEX_ANT_TYPE_ANTDIV 1 -+#define BT_COEX_ANT_TYPE_DETECTED 2 -+ -+#define BTC_MIMO_PS_STATIC 0 /* 1ss */ -+#define BTC_MIMO_PS_DYNAMIC 1 /* 2ss */ -+ -+#define BTC_RATE_DISABLE 0 -+#define BTC_RATE_ENABLE 1 -+ -+/* single Antenna definition */ -+#define BTC_ANT_PATH_WIFI 0 -+#define BTC_ANT_PATH_BT 1 -+#define BTC_ANT_PATH_PTA 2 -+#define BTC_ANT_PATH_WIFI5G 3 -+#define BTC_ANT_PATH_AUTO 4 -+/* dual Antenna definition */ -+#define BTC_ANT_WIFI_AT_MAIN 0 -+#define BTC_ANT_WIFI_AT_AUX 1 -+#define BTC_ANT_WIFI_AT_DIVERSITY 2 -+/* coupler Antenna definition */ -+#define BTC_ANT_WIFI_AT_CPL_MAIN 0 -+#define BTC_ANT_WIFI_AT_CPL_AUX 1 -+ -+typedef enum _BTC_POWERSAVE_TYPE { -+ BTC_PS_WIFI_NATIVE = 0, /* wifi original power save behavior */ -+ BTC_PS_LPS_ON = 1, -+ BTC_PS_LPS_OFF = 2, -+ BTC_PS_MAX -+} BTC_POWERSAVE_TYPE, *PBTC_POWERSAVE_TYPE; -+ -+typedef enum _BTC_BT_REG_TYPE { -+ BTC_BT_REG_RF = 0, -+ BTC_BT_REG_MODEM = 1, -+ BTC_BT_REG_BLUEWIZE = 2, -+ BTC_BT_REG_VENDOR = 3, -+ BTC_BT_REG_LE = 4, -+ BTC_BT_REG_MAX -+} BTC_BT_REG_TYPE, *PBTC_BT_REG_TYPE; -+ -+typedef enum _BTC_CHIP_INTERFACE { -+ BTC_INTF_UNKNOWN = 0, -+ BTC_INTF_PCI = 1, -+ BTC_INTF_USB = 2, -+ BTC_INTF_SDIO = 3, -+ BTC_INTF_MAX -+} BTC_CHIP_INTERFACE, *PBTC_CHIP_INTERFACE; -+ -+typedef enum _BTC_CHIP_TYPE { -+ BTC_CHIP_UNDEF = 0, -+ BTC_CHIP_CSR_BC4 = 1, -+ BTC_CHIP_CSR_BC8 = 2, -+ BTC_CHIP_RTL8723A = 3, -+ BTC_CHIP_RTL8821 = 4, -+ BTC_CHIP_RTL8723B = 5, -+ BTC_CHIP_MAX -+} BTC_CHIP_TYPE, *PBTC_CHIP_TYPE; -+ -+/* following is for wifi link status */ -+#define WIFI_STA_CONNECTED BIT0 -+#define WIFI_AP_CONNECTED BIT1 -+#define WIFI_HS_CONNECTED BIT2 -+#define WIFI_P2P_GO_CONNECTED BIT3 -+#define WIFI_P2P_GC_CONNECTED BIT4 -+ -+/* following is for command line utility */ -+#define CL_SPRINTF rsprintf -+#define CL_PRINTF DCMD_Printf -+ -+struct btc_board_info { -+ /* The following is some board information */ -+ u8 bt_chip_type; -+ u8 pg_ant_num; /* pg ant number */ -+ u8 btdm_ant_num; /* ant number for btdm */ -+ u8 btdm_ant_num_by_ant_det; /* ant number for btdm after antenna detection */ -+ u8 btdm_ant_pos; /* Bryant Add to indicate Antenna Position for (pg_ant_num = 2) && (btdm_ant_num =1) (DPDT+1Ant case) */ -+ u8 single_ant_path; /* current used for 8723b only, 1=>s0, 0=>s1 */ -+ boolean tfbga_package; /* for Antenna detect threshold */ -+ boolean btdm_ant_det_finish; -+ u8 ant_type; -+ u8 rfe_type; -+ u8 ant_div_cfg; -+ boolean btdm_ant_det_complete_fail; -+ u8 ant_det_result; -+ boolean ant_det_result_five_complete; -+ u32 antdetval; -+}; -+ -+typedef enum _BTC_DBG_OPCODE { -+ BTC_DBG_SET_COEX_NORMAL = 0x0, -+ BTC_DBG_SET_COEX_WIFI_ONLY = 0x1, -+ BTC_DBG_SET_COEX_BT_ONLY = 0x2, -+ BTC_DBG_SET_COEX_DEC_BT_PWR = 0x3, -+ BTC_DBG_SET_COEX_BT_AFH_MAP = 0x4, -+ BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT = 0x5, -+ BTC_DBG_SET_COEX_MANUAL_CTRL = 0x6, -+ BTC_DBG_MAX -+} BTC_DBG_OPCODE, *PBTC_DBG_OPCODE; -+ -+typedef enum _BTC_RSSI_STATE { -+ BTC_RSSI_STATE_HIGH = 0x0, -+ BTC_RSSI_STATE_MEDIUM = 0x1, -+ BTC_RSSI_STATE_LOW = 0x2, -+ BTC_RSSI_STATE_STAY_HIGH = 0x3, -+ BTC_RSSI_STATE_STAY_MEDIUM = 0x4, -+ BTC_RSSI_STATE_STAY_LOW = 0x5, -+ BTC_RSSI_MAX -+} BTC_RSSI_STATE, *PBTC_RSSI_STATE; -+#define BTC_RSSI_HIGH(_rssi_) ((_rssi_ == BTC_RSSI_STATE_HIGH || _rssi_ == BTC_RSSI_STATE_STAY_HIGH) ? TRUE:FALSE) -+#define BTC_RSSI_MEDIUM(_rssi_) ((_rssi_ == BTC_RSSI_STATE_MEDIUM || _rssi_ == BTC_RSSI_STATE_STAY_MEDIUM) ? TRUE:FALSE) -+#define BTC_RSSI_LOW(_rssi_) ((_rssi_ == BTC_RSSI_STATE_LOW || _rssi_ == BTC_RSSI_STATE_STAY_LOW) ? TRUE:FALSE) -+ -+typedef enum _BTC_WIFI_ROLE { -+ BTC_ROLE_STATION = 0x0, -+ BTC_ROLE_AP = 0x1, -+ BTC_ROLE_IBSS = 0x2, -+ BTC_ROLE_HS_MODE = 0x3, -+ BTC_ROLE_MAX -+} BTC_WIFI_ROLE, *PBTC_WIFI_ROLE; -+ -+typedef enum _BTC_WIRELESS_FREQ { -+ BTC_FREQ_2_4G = 0x0, -+ BTC_FREQ_5G = 0x1, -+ BTC_FREQ_MAX -+} BTC_WIRELESS_FREQ, *PBTC_WIRELESS_FREQ; -+ -+typedef enum _BTC_WIFI_BW_MODE { -+ BTC_WIFI_BW_LEGACY = 0x0, -+ BTC_WIFI_BW_HT20 = 0x1, -+ BTC_WIFI_BW_HT40 = 0x2, -+ BTC_WIFI_BW_HT80 = 0x3, -+ BTC_WIFI_BW_HT160 = 0x4, -+ BTC_WIFI_BW_MAX -+} BTC_WIFI_BW_MODE, *PBTC_WIFI_BW_MODE; -+ -+typedef enum _BTC_WIFI_TRAFFIC_DIR { -+ BTC_WIFI_TRAFFIC_TX = 0x0, -+ BTC_WIFI_TRAFFIC_RX = 0x1, -+ BTC_WIFI_TRAFFIC_MAX -+} BTC_WIFI_TRAFFIC_DIR, *PBTC_WIFI_TRAFFIC_DIR; -+ -+typedef enum _BTC_WIFI_PNP { -+ BTC_WIFI_PNP_WAKE_UP = 0x0, -+ BTC_WIFI_PNP_SLEEP = 0x1, -+ BTC_WIFI_PNP_SLEEP_KEEP_ANT = 0x2, -+ BTC_WIFI_PNP_MAX -+} BTC_WIFI_PNP, *PBTC_WIFI_PNP; -+ -+typedef enum _BTC_IOT_PEER { -+ BTC_IOT_PEER_UNKNOWN = 0, -+ BTC_IOT_PEER_REALTEK = 1, -+ BTC_IOT_PEER_REALTEK_92SE = 2, -+ BTC_IOT_PEER_BROADCOM = 3, -+ BTC_IOT_PEER_RALINK = 4, -+ BTC_IOT_PEER_ATHEROS = 5, -+ BTC_IOT_PEER_CISCO = 6, -+ BTC_IOT_PEER_MERU = 7, -+ BTC_IOT_PEER_MARVELL = 8, -+ BTC_IOT_PEER_REALTEK_SOFTAP = 9, /* peer is RealTek SOFT_AP, by Bohn, 2009.12.17 */ -+ BTC_IOT_PEER_SELF_SOFTAP = 10, /* Self is SoftAP */ -+ BTC_IOT_PEER_AIRGO = 11, -+ BTC_IOT_PEER_INTEL = 12, -+ BTC_IOT_PEER_RTK_APCLIENT = 13, -+ BTC_IOT_PEER_REALTEK_81XX = 14, -+ BTC_IOT_PEER_REALTEK_WOW = 15, -+ BTC_IOT_PEER_REALTEK_JAGUAR_BCUTAP = 16, -+ BTC_IOT_PEER_REALTEK_JAGUAR_CCUTAP = 17, -+ BTC_IOT_PEER_MAX, -+} BTC_IOT_PEER, *PBTC_IOT_PEER; -+ -+/* for 8723b-d cut large current issue */ -+typedef enum _BTC_WIFI_COEX_STATE { -+ BTC_WIFI_STAT_INIT, -+ BTC_WIFI_STAT_IQK, -+ BTC_WIFI_STAT_NORMAL_OFF, -+ BTC_WIFI_STAT_MP_OFF, -+ BTC_WIFI_STAT_NORMAL, -+ BTC_WIFI_STAT_ANT_DIV, -+ BTC_WIFI_STAT_MAX -+} BTC_WIFI_COEX_STATE, *PBTC_WIFI_COEX_STATE; -+ -+typedef enum _BTC_ANT_TYPE { -+ BTC_ANT_TYPE_0, -+ BTC_ANT_TYPE_1, -+ BTC_ANT_TYPE_2, -+ BTC_ANT_TYPE_3, -+ BTC_ANT_TYPE_4, -+ BTC_ANT_TYPE_MAX -+} BTC_ANT_TYPE, *PBTC_ANT_TYPE; -+ -+typedef enum _BTC_VENDOR { -+ BTC_VENDOR_LENOVO, -+ BTC_VENDOR_ASUS, -+ BTC_VENDOR_OTHER -+} BTC_VENDOR, *PBTC_VENDOR; -+ -+ -+/* defined for BFP_BTC_GET */ -+typedef enum _BTC_GET_TYPE { -+ /* type BOOLEAN */ -+ BTC_GET_BL_HS_OPERATION, -+ BTC_GET_BL_HS_CONNECTING, -+ BTC_GET_BL_WIFI_CONNECTED, -+ BTC_GET_BL_WIFI_BUSY, -+ BTC_GET_BL_WIFI_SCAN, -+ BTC_GET_BL_WIFI_LINK, -+ BTC_GET_BL_WIFI_ROAM, -+ BTC_GET_BL_WIFI_4_WAY_PROGRESS, -+ BTC_GET_BL_WIFI_UNDER_5G, -+ BTC_GET_BL_WIFI_AP_MODE_ENABLE, -+ BTC_GET_BL_WIFI_ENABLE_ENCRYPTION, -+ BTC_GET_BL_WIFI_UNDER_B_MODE, -+ BTC_GET_BL_EXT_SWITCH, -+ BTC_GET_BL_WIFI_IS_IN_MP_MODE, -+ BTC_GET_BL_IS_ASUS_8723B, -+ -+ /* type s4Byte */ -+ BTC_GET_S4_WIFI_RSSI, -+ BTC_GET_S4_HS_RSSI, -+ -+ /* type u4Byte */ -+ BTC_GET_U4_WIFI_BW, -+ BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, -+ BTC_GET_U4_WIFI_FW_VER, -+ BTC_GET_U4_WIFI_LINK_STATUS, -+ BTC_GET_U4_BT_PATCH_VER, -+ BTC_GET_U4_VENDOR, -+ BTC_GET_U4_SUPPORTED_VERSION, -+ BTC_GET_U4_SUPPORTED_FEATURE, -+ BTC_GET_U4_WIFI_IQK_TOTAL, -+ BTC_GET_U4_WIFI_IQK_OK, -+ BTC_GET_U4_WIFI_IQK_FAIL, -+ -+ /* type u1Byte */ -+ BTC_GET_U1_WIFI_DOT11_CHNL, -+ BTC_GET_U1_WIFI_CENTRAL_CHNL, -+ BTC_GET_U1_WIFI_HS_CHNL, -+ BTC_GET_U1_WIFI_P2P_CHNL, -+ BTC_GET_U1_MAC_PHY_MODE, -+ BTC_GET_U1_AP_NUM, -+ BTC_GET_U1_ANT_TYPE, -+ BTC_GET_U1_IOT_PEER, -+ -+ /*===== for 1Ant ======*/ -+ BTC_GET_U1_LPS_MODE, -+ -+ BTC_GET_MAX -+} BTC_GET_TYPE, *PBTC_GET_TYPE; -+ -+/* defined for BFP_BTC_SET */ -+typedef enum _BTC_SET_TYPE { -+ /* type BOOLEAN */ -+ BTC_SET_BL_BT_DISABLE, -+ BTC_SET_BL_BT_TRAFFIC_BUSY, -+ BTC_SET_BL_BT_LIMITED_DIG, -+ BTC_SET_BL_FORCE_TO_ROAM, -+ BTC_SET_BL_TO_REJ_AP_AGG_PKT, -+ BTC_SET_BL_BT_CTRL_AGG_SIZE, -+ BTC_SET_BL_INC_SCAN_DEV_NUM, -+ BTC_SET_BL_BT_TX_RX_MASK, -+ BTC_SET_BL_MIRACAST_PLUS_BT, -+ -+ /* type u1Byte */ -+ BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, -+ BTC_SET_U1_AGG_BUF_SIZE, -+ -+ /* type trigger some action */ -+ BTC_SET_ACT_GET_BT_RSSI, -+ BTC_SET_ACT_AGGREGATE_CTRL, -+ BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, -+ /*===== for 1Ant ======*/ -+ /* type BOOLEAN */ -+ -+ /* type u1Byte */ -+ BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, -+ BTC_SET_U1_LPS_VAL, -+ BTC_SET_U1_RPWM_VAL, -+ /* type trigger some action */ -+ BTC_SET_ACT_LEAVE_LPS, -+ BTC_SET_ACT_ENTER_LPS, -+ BTC_SET_ACT_NORMAL_LPS, -+ BTC_SET_ACT_DISABLE_LOW_POWER, -+ BTC_SET_ACT_UPDATE_RAMASK, -+ BTC_SET_ACT_SEND_MIMO_PS, -+ /* BT Coex related */ -+ BTC_SET_ACT_CTRL_BT_INFO, -+ BTC_SET_ACT_CTRL_BT_COEX, -+ BTC_SET_ACT_CTRL_8723B_ANT, -+ /*=================*/ -+ BTC_SET_MAX -+} BTC_SET_TYPE, *PBTC_SET_TYPE; -+ -+typedef enum _BTC_DBG_DISP_TYPE { -+ BTC_DBG_DISP_COEX_STATISTICS = 0x0, -+ BTC_DBG_DISP_BT_LINK_INFO = 0x1, -+ BTC_DBG_DISP_WIFI_STATUS = 0x2, -+ BTC_DBG_DISP_MAX -+} BTC_DBG_DISP_TYPE, *PBTC_DBG_DISP_TYPE; -+ -+typedef enum _BTC_NOTIFY_TYPE_IPS { -+ BTC_IPS_LEAVE = 0x0, -+ BTC_IPS_ENTER = 0x1, -+ BTC_IPS_MAX -+} BTC_NOTIFY_TYPE_IPS, *PBTC_NOTIFY_TYPE_IPS; -+typedef enum _BTC_NOTIFY_TYPE_LPS { -+ BTC_LPS_DISABLE = 0x0, -+ BTC_LPS_ENABLE = 0x1, -+ BTC_LPS_MAX -+} BTC_NOTIFY_TYPE_LPS, *PBTC_NOTIFY_TYPE_LPS; -+typedef enum _BTC_NOTIFY_TYPE_SCAN { -+ BTC_SCAN_FINISH = 0x0, -+ BTC_SCAN_START = 0x1, -+ BTC_SCAN_START_2G = 0x2, -+ BTC_SCAN_MAX -+} BTC_NOTIFY_TYPE_SCAN, *PBTC_NOTIFY_TYPE_SCAN; -+typedef enum _BTC_NOTIFY_TYPE_SWITCHBAND { -+ BTC_NOT_SWITCH = 0x0, -+ BTC_SWITCH_TO_24G = 0x1, -+ BTC_SWITCH_TO_5G = 0x2, -+ BTC_SWITCH_TO_24G_NOFORSCAN = 0x3, -+ BTC_SWITCH_MAX -+} BTC_NOTIFY_TYPE_SWITCHBAND, *PBTC_NOTIFY_TYPE_SWITCHBAND; -+typedef enum _BTC_NOTIFY_TYPE_ASSOCIATE { -+ BTC_ASSOCIATE_FINISH = 0x0, -+ BTC_ASSOCIATE_START = 0x1, -+ BTC_ASSOCIATE_5G_FINISH = 0x2, -+ BTC_ASSOCIATE_5G_START = 0x3, -+ BTC_ASSOCIATE_MAX -+} BTC_NOTIFY_TYPE_ASSOCIATE, *PBTC_NOTIFY_TYPE_ASSOCIATE; -+typedef enum _BTC_NOTIFY_TYPE_MEDIA_STATUS { -+ BTC_MEDIA_DISCONNECT = 0x0, -+ BTC_MEDIA_CONNECT = 0x1, -+ BTC_MEDIA_MAX -+} BTC_NOTIFY_TYPE_MEDIA_STATUS, *PBTC_NOTIFY_TYPE_MEDIA_STATUS; -+typedef enum _BTC_NOTIFY_TYPE_SPECIFIC_PACKET { -+ BTC_PACKET_UNKNOWN = 0x0, -+ BTC_PACKET_DHCP = 0x1, -+ BTC_PACKET_ARP = 0x2, -+ BTC_PACKET_EAPOL = 0x3, -+ BTC_PACKET_MAX -+} BTC_NOTIFY_TYPE_SPECIFIC_PACKET, *PBTC_NOTIFY_TYPE_SPECIFIC_PACKET; -+typedef enum _BTC_NOTIFY_TYPE_STACK_OPERATION { -+ BTC_STACK_OP_NONE = 0x0, -+ BTC_STACK_OP_INQ_PAGE_PAIR_START = 0x1, -+ BTC_STACK_OP_INQ_PAGE_PAIR_FINISH = 0x2, -+ BTC_STACK_OP_MAX -+} BTC_NOTIFY_TYPE_STACK_OPERATION, *PBTC_NOTIFY_TYPE_STACK_OPERATION; -+ -+/* Bryant Add */ -+typedef enum _BTC_ANTENNA_POS { -+ BTC_ANTENNA_AT_MAIN_PORT = 0x1, -+ BTC_ANTENNA_AT_AUX_PORT = 0x2, -+} BTC_ANTENNA_POS, *PBTC_ANTENNA_POS; -+ -+/* Bryant Add */ -+typedef enum _BTC_BT_OFFON { -+ BTC_BT_OFF = 0x0, -+ BTC_BT_ON = 0x1, -+} BTC_BTOFFON, *PBTC_BT_OFFON; -+ -+/*================================================== -+For following block is for coex offload -+==================================================*/ -+typedef struct _COL_H2C { -+ u1Byte opcode; -+ u1Byte opcode_ver:4; -+ u1Byte req_num:4; -+ u1Byte buf[1]; -+} COL_H2C, *PCOL_H2C; -+ -+#define COL_C2H_ACK_HDR_LEN 3 -+typedef struct _COL_C2H_ACK { -+ u1Byte status; -+ u1Byte opcode_ver:4; -+ u1Byte req_num:4; -+ u1Byte ret_len; -+ u1Byte buf[1]; -+} COL_C2H_ACK, *PCOL_C2H_ACK; -+ -+#define COL_C2H_IND_HDR_LEN 3 -+typedef struct _COL_C2H_IND { -+ u1Byte type; -+ u1Byte version; -+ u1Byte length; -+ u1Byte data[1]; -+} COL_C2H_IND, *PCOL_C2H_IND; -+ -+/*============================================ -+NOTE: for debug message, the following define should match -+the strings in coexH2cResultString. -+============================================*/ -+typedef enum _COL_H2C_STATUS { -+ /* c2h status */ -+ COL_STATUS_C2H_OK = 0x00, /* Wifi received H2C request and check content ok. */ -+ COL_STATUS_C2H_UNKNOWN = 0x01, /* Not handled routine */ -+ COL_STATUS_C2H_UNKNOWN_OPCODE = 0x02, /* Invalid OP code, It means that wifi firmware received an undefiend OP code. */ -+ COL_STATUS_C2H_OPCODE_VER_MISMATCH = 0x03, /* Wifi firmware and wifi driver mismatch, need to update wifi driver or wifi or. */ -+ COL_STATUS_C2H_PARAMETER_ERROR = 0x04, /* Error paraneter.(ex: parameters = NULL but it should have values) */ -+ COL_STATUS_C2H_PARAMETER_OUT_OF_RANGE = 0x05, /* Wifi firmware needs to check the parameters from H2C request and return the status.(ex: ch = 500, it's wrong) */ -+ /* other COL status start from here */ -+ COL_STATUS_C2H_REQ_NUM_MISMATCH , /* c2h req_num mismatch, means this c2h is not we expected. */ -+ COL_STATUS_H2C_HALMAC_FAIL , /* HALMAC return fail. */ -+ COL_STATUS_H2C_TIMTOUT , /* not received the c2h response from fw */ -+ COL_STATUS_INVALID_C2H_LEN , /* invalid coex offload c2h ack length, must >= 3 */ -+ COL_STATUS_COEX_DATA_OVERFLOW , /* coex returned length over the c2h ack length. */ -+ COL_STATUS_MAX -+} COL_H2C_STATUS, *PCOL_H2C_STATUS; -+ -+#define COL_MAX_H2C_REQ_NUM 16 -+ -+#define COL_H2C_BUF_LEN 20 -+typedef enum _COL_OPCODE { -+ COL_OP_WIFI_STATUS_NOTIFY = 0x0, -+ COL_OP_WIFI_PROGRESS_NOTIFY = 0x1, -+ COL_OP_WIFI_INFO_NOTIFY = 0x2, -+ COL_OP_WIFI_POWER_STATE_NOTIFY = 0x3, -+ COL_OP_SET_CONTROL = 0x4, -+ COL_OP_GET_CONTROL = 0x5, -+ COL_OP_WIFI_OPCODE_MAX -+} COL_OPCODE, *PCOL_OPCODE; -+ -+typedef enum _COL_IND_TYPE { -+ COL_IND_BT_INFO = 0x0, -+ COL_IND_PSTDMA = 0x1, -+ COL_IND_LIMITED_TX_RX = 0x2, -+ COL_IND_COEX_TABLE = 0x3, -+ COL_IND_REQ = 0x4, -+ COL_IND_MAX -+} COL_IND_TYPE, *PCOL_IND_TYPE; -+ -+typedef struct _COL_SINGLE_H2C_RECORD { -+ u1Byte h2c_buf[COL_H2C_BUF_LEN]; /* the latest sent h2c buffer */ -+ u4Byte h2c_len; -+ u1Byte c2h_ack_buf[COL_H2C_BUF_LEN]; /* the latest received c2h buffer */ -+ u4Byte c2h_ack_len; -+ u4Byte count; /* the total number of the sent h2c command */ -+ u4Byte status[COL_STATUS_MAX]; /* the c2h status for the sent h2c command */ -+} COL_SINGLE_H2C_RECORD, *PCOL_SINGLE_H2C_RECORD; -+ -+typedef struct _COL_SINGLE_C2H_IND_RECORD { -+ u1Byte ind_buf[COL_H2C_BUF_LEN]; /* the latest received c2h indication buffer */ -+ u4Byte ind_len; -+ u4Byte count; /* the total number of the rcvd c2h indication */ -+ u4Byte status[COL_STATUS_MAX]; /* the c2h indication verified status */ -+} COL_SINGLE_C2H_IND_RECORD, *PCOL_SINGLE_C2H_IND_RECORD; -+ -+typedef struct _BTC_OFFLOAD { -+ /* H2C command related */ -+ u1Byte h2c_req_num; -+ u4Byte cnt_h2c_sent; -+ COL_SINGLE_H2C_RECORD h2c_record[COL_OP_WIFI_OPCODE_MAX]; -+ -+ /* C2H Ack related */ -+ u4Byte cnt_c2h_ack; -+ u4Byte status[COL_STATUS_MAX]; -+ struct completion c2h_event[COL_MAX_H2C_REQ_NUM]; /* for req_num = 1~COL_MAX_H2C_REQ_NUM */ -+ u1Byte c2h_ack_buf[COL_MAX_H2C_REQ_NUM][COL_H2C_BUF_LEN]; -+ u1Byte c2h_ack_len[COL_MAX_H2C_REQ_NUM]; -+ -+ /* C2H Indication related */ -+ u4Byte cnt_c2h_ind; -+ COL_SINGLE_C2H_IND_RECORD c2h_ind_record[COL_IND_MAX]; -+ u4Byte c2h_ind_status[COL_STATUS_MAX]; -+ u1Byte c2h_ind_buf[COL_H2C_BUF_LEN]; -+ u1Byte c2h_ind_len; -+} BTC_OFFLOAD, *PBTC_OFFLOAD; -+extern BTC_OFFLOAD gl_coex_offload; -+/*==================================================*/ -+ -+typedef u1Byte -+(*BFP_BTC_R1)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr -+ ); -+typedef u2Byte -+(*BFP_BTC_R2)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr -+ ); -+typedef u4Byte -+(*BFP_BTC_R4)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr -+ ); -+typedef VOID -+(*BFP_BTC_W1)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr, -+ IN u1Byte Data -+ ); -+typedef VOID -+(*BFP_BTC_W1_BIT_MASK)( -+ IN PVOID pBtcContext, -+ IN u4Byte regAddr, -+ IN u1Byte bitMask, -+ IN u1Byte data1b -+ ); -+typedef VOID -+(*BFP_BTC_W2)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr, -+ IN u2Byte Data -+ ); -+typedef VOID -+(*BFP_BTC_W4)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr, -+ IN u4Byte Data -+ ); -+typedef VOID -+(*BFP_BTC_LOCAL_REG_W1)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr, -+ IN u1Byte Data -+ ); -+typedef VOID -+(*BFP_BTC_SET_BB_REG)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ); -+typedef u4Byte -+(*BFP_BTC_GET_BB_REG)( -+ IN PVOID pBtcContext, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ); -+typedef VOID -+(*BFP_BTC_SET_RF_REG)( -+ IN PVOID pBtcContext, -+ IN u1Byte eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ); -+typedef u4Byte -+(*BFP_BTC_GET_RF_REG)( -+ IN PVOID pBtcContext, -+ IN u1Byte eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ); -+typedef VOID -+(*BFP_BTC_FILL_H2C)( -+ IN PVOID pBtcContext, -+ IN u1Byte elementId, -+ IN u4Byte cmdLen, -+ IN pu1Byte pCmdBuffer -+ ); -+ -+typedef BOOLEAN -+(*BFP_BTC_GET)( -+ IN PVOID pBtCoexist, -+ IN u1Byte getType, -+ OUT PVOID pOutBuf -+ ); -+ -+typedef BOOLEAN -+(*BFP_BTC_SET)( -+ IN PVOID pBtCoexist, -+ IN u1Byte setType, -+ OUT PVOID pInBuf -+ ); -+typedef u2Byte -+(*BFP_BTC_SET_BT_REG)( -+ IN PVOID pBtcContext, -+ IN u1Byte regType, -+ IN u4Byte offset, -+ IN u4Byte value -+ ); -+typedef BOOLEAN -+(*BFP_BTC_SET_BT_ANT_DETECTION)( -+ IN PVOID pBtcContext, -+ IN u1Byte txTime, -+ IN u1Byte btChnl -+ ); -+ -+typedef BOOLEAN -+(*BFP_BTC_SET_BT_TRX_MASK)( -+ IN PVOID pBtcContext, -+ IN u1Byte bt_trx_mask -+ ); -+ -+typedef u4Byte -+(*BFP_BTC_GET_BT_REG)( -+ IN PVOID pBtcContext, -+ IN u1Byte regType, -+ IN u4Byte offset -+ ); -+typedef VOID -+(*BFP_BTC_DISP_DBG_MSG)( -+ IN PVOID pBtCoexist, -+ IN u1Byte dispType -+ ); -+ -+typedef COL_H2C_STATUS -+(*BFP_BTC_COEX_H2C_PROCESS)( -+ IN PVOID pBtCoexist, -+ IN u1Byte opcode, -+ IN u1Byte opcode_ver, -+ IN pu1Byte ph2c_par, -+ IN u1Byte h2c_par_len -+ ); -+ -+typedef u4Byte -+(*BFP_BTC_GET_BT_COEX_SUPPORTED_FEATURE)( -+ IN PVOID pBtcContext -+ ); -+ -+typedef u4Byte -+(*BFP_BTC_GET_BT_COEX_SUPPORTED_VERSION)( -+ IN PVOID pBtcContext -+ ); -+ -+typedef u4Byte -+(*BFP_BTC_GET_PHYDM_VERSION)( -+ IN PVOID pBtcContext -+ ); -+ -+typedef VOID -+(*BTC_PHYDM_MODIFY_RA_PCR_THRESHLOD)( -+ IN PVOID pDM_Odm, -+ IN u1Byte RA_offset_direction, -+ IN u1Byte RA_threshold_offset -+ ); -+ -+typedef u4Byte -+(*BTC_PHYDM_CMNINFOQUERY)( -+ IN PVOID pDM_Odm, -+ IN u1Byte info_type -+ ); -+ -+typedef u1Byte -+(*BFP_BTC_GET_ANT_DET_VAL_FROM_BT)( -+ -+ IN PVOID pBtcContext -+ ); -+ -+typedef u1Byte -+(*BFP_BTC_GET_BLE_SCAN_TYPE_FROM_BT)( -+ IN PVOID pBtcContext -+ ); -+ -+typedef u4Byte -+(*BFP_BTC_GET_BLE_SCAN_PARA_FROM_BT)( -+ IN PVOID pBtcContext, -+ IN u1Byte scanType -+ ); -+ -+typedef BOOLEAN -+(*BFP_BTC_GET_BT_AFH_MAP_FROM_BT)( -+ IN PVOID pBtcContext, -+ IN u1Byte mapType, -+ OUT pu1Byte afhMap -+ ); -+ -+struct btc_bt_info { -+ boolean bt_disabled; -+ boolean bt_enable_disable_change; -+ u8 rssi_adjust_for_agc_table_on; -+ u8 rssi_adjust_for_1ant_coex_type; -+ boolean pre_bt_ctrl_agg_buf_size; -+ boolean bt_ctrl_agg_buf_size; -+ boolean pre_reject_agg_pkt; -+ boolean reject_agg_pkt; -+ boolean increase_scan_dev_num; -+ boolean bt_tx_rx_mask; -+ u8 pre_agg_buf_size; -+ u8 agg_buf_size; -+ boolean bt_busy; -+ boolean limited_dig; -+ u16 bt_hci_ver; -+ u16 bt_real_fw_ver; -+ u8 bt_fw_ver; -+ u32 get_bt_fw_ver_cnt; -+ u32 bt_get_fw_ver; -+ boolean miracast_plus_bt; -+ -+ boolean bt_disable_low_pwr; -+ -+ boolean bt_ctrl_lps; -+ boolean bt_lps_on; -+ boolean force_to_roam; /* for 1Ant solution */ -+ u8 lps_val; -+ u8 rpwm_val; -+ u32 ra_mask; -+}; -+ -+struct btc_stack_info { -+ boolean profile_notified; -+ u16 hci_version; /* stack hci version */ -+ u8 num_of_link; -+ boolean bt_link_exist; -+ boolean sco_exist; -+ boolean acl_exist; -+ boolean a2dp_exist; -+ boolean hid_exist; -+ u8 num_of_hid; -+ boolean pan_exist; -+ boolean unknown_acl_exist; -+ s8 min_bt_rssi; -+}; -+ -+struct btc_bt_link_info { -+ boolean bt_link_exist; -+ boolean bt_hi_pri_link_exist; -+ boolean sco_exist; -+ boolean sco_only; -+ boolean a2dp_exist; -+ boolean a2dp_only; -+ boolean hid_exist; -+ boolean hid_only; -+ boolean pan_exist; -+ boolean pan_only; -+ boolean slave_role; -+ boolean acl_busy; -+}; -+ -+struct btc_statistics { -+ u32 cnt_bind; -+ u32 cnt_power_on; -+ u32 cnt_pre_load_firmware; -+ u32 cnt_init_hw_config; -+ u32 cnt_init_coex_dm; -+ u32 cnt_ips_notify; -+ u32 cnt_lps_notify; -+ u32 cnt_scan_notify; -+ u32 cnt_connect_notify; -+ u32 cnt_media_status_notify; -+ u32 cnt_specific_packet_notify; -+ u32 cnt_bt_info_notify; -+ u32 cnt_rf_status_notify; -+ u32 cnt_periodical; -+ u32 cnt_coex_dm_switch; -+ u32 cnt_stack_operation_notify; -+ u32 cnt_dbg_ctrl; -+}; -+ -+struct btc_coexist { -+ BOOLEAN bBinded; /*make sure only one adapter can bind the data context*/ -+ PVOID Adapter; /*default adapter*/ -+ struct btc_board_info board_info; -+ struct btc_bt_info bt_info; /*some bt info referenced by non-bt module*/ -+ struct btc_stack_info stack_info; -+ struct btc_bt_link_info bt_link_info; -+ BTC_CHIP_INTERFACE chip_interface; -+ PVOID odm_priv; -+ -+ BOOLEAN initilized; -+ BOOLEAN stop_coex_dm; -+ BOOLEAN manual_control; -+ BOOLEAN bdontenterLPS; -+ pu1Byte cli_buf; -+ struct btc_statistics statistics; -+ u1Byte pwrModeVal[10]; -+ -+ /* function pointers */ -+ /* io related */ -+ BFP_BTC_R1 btc_read_1byte; -+ BFP_BTC_W1 btc_write_1byte; -+ BFP_BTC_W1_BIT_MASK btc_write_1byte_bitmask; -+ BFP_BTC_R2 btc_read_2byte; -+ BFP_BTC_W2 btc_write_2byte; -+ BFP_BTC_R4 btc_read_4byte; -+ BFP_BTC_W4 btc_write_4byte; -+ BFP_BTC_LOCAL_REG_W1 btc_write_local_reg_1byte; -+ /* read/write bb related */ -+ BFP_BTC_SET_BB_REG btc_set_bb_reg; -+ BFP_BTC_GET_BB_REG btc_get_bb_reg; -+ -+ /* read/write rf related */ -+ BFP_BTC_SET_RF_REG btc_set_rf_reg; -+ BFP_BTC_GET_RF_REG btc_get_rf_reg; -+ -+ /* fill h2c related */ -+ BFP_BTC_FILL_H2C btc_fill_h2c; -+ /* other */ -+ BFP_BTC_DISP_DBG_MSG btc_disp_dbg_msg; -+ /* normal get/set related */ -+ BFP_BTC_GET btc_get; -+ BFP_BTC_SET btc_set; -+ -+ BFP_BTC_GET_BT_REG btc_get_bt_reg; -+ BFP_BTC_SET_BT_REG btc_set_bt_reg; -+ -+ BFP_BTC_SET_BT_ANT_DETECTION btc_set_bt_ant_detection; -+ -+ BFP_BTC_COEX_H2C_PROCESS btc_coex_h2c_process; -+ BFP_BTC_SET_BT_TRX_MASK btc_set_bt_trx_mask; -+ BFP_BTC_GET_BT_COEX_SUPPORTED_FEATURE btc_get_bt_coex_supported_feature; -+ BFP_BTC_GET_BT_COEX_SUPPORTED_VERSION btc_get_bt_coex_supported_version; -+ BFP_BTC_GET_PHYDM_VERSION btc_get_bt_phydm_version; -+ BTC_PHYDM_MODIFY_RA_PCR_THRESHLOD btc_phydm_modify_RA_PCR_threshold; -+ BTC_PHYDM_CMNINFOQUERY btc_phydm_query_PHY_counter; -+ BFP_BTC_GET_ANT_DET_VAL_FROM_BT btc_get_ant_det_val_from_bt; -+ BFP_BTC_GET_BLE_SCAN_TYPE_FROM_BT btc_get_ble_scan_type_from_bt; -+ BFP_BTC_GET_BLE_SCAN_PARA_FROM_BT btc_get_ble_scan_para_from_bt; -+ BFP_BTC_GET_BT_AFH_MAP_FROM_BT btc_get_bt_afh_map_from_bt; -+}; -+typedef struct btc_coexist *PBTC_COEXIST; -+ -+extern struct btc_coexist GLBtCoexist; -+ -+BOOLEAN -+EXhalbtcoutsrc_InitlizeVariables( -+ IN PVOID Adapter -+ ); -+VOID -+EXhalbtcoutsrc_PowerOnSetting( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_PreLoadFirmware( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_InitHwConfig( -+ IN PBTC_COEXIST pBtCoexist, -+ IN BOOLEAN bWifiOnly -+ ); -+VOID -+EXhalbtcoutsrc_InitCoexDm( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_IpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtcoutsrc_LpsNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtcoutsrc_ScanNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtcoutsrc_SetAntennaPathNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtcoutsrc_ConnectNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte action -+ ); -+VOID -+EXhalbtcoutsrc_MediaStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN RT_MEDIA_STATUS mediaStatus -+ ); -+VOID -+EXhalbtcoutsrc_SpecificPacketNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pktType -+ ); -+VOID -+EXhalbtcoutsrc_BtInfoNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN pu1Byte tmpBuf, -+ IN u1Byte length -+ ); -+VOID -+EXhalbtcoutsrc_RfStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtcoutsrc_StackOperationNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+ ); -+VOID -+EXhalbtcoutsrc_HaltNotify( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_PnpNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte pnpState -+ ); -+VOID -+EXhalbtcoutsrc_CoexDmSwitch( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_Periodical( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_DbgControl( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte opCode, -+ IN u1Byte opLen, -+ IN pu1Byte pData -+ ); -+VOID -+EXhalbtcoutsrc_AntennaDetection( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+ ); -+VOID -+EXhalbtcoutsrc_StackUpdateProfileInfo( -+ VOID -+ ); -+VOID -+EXhalbtcoutsrc_SetHciVersion( -+ IN u2Byte hciVersion -+ ); -+VOID -+EXhalbtcoutsrc_SetBtPatchVersion( -+ IN u2Byte btHciVersion, -+ IN u2Byte btPatchVersion -+ ); -+VOID -+EXhalbtcoutsrc_UpdateMinBtRssi( -+ IN s1Byte btRssi -+ ); -+#if 0 -+VOID -+EXhalbtcoutsrc_SetBtExist( -+ IN BOOLEAN bBtExist -+ ); -+#endif -+VOID -+EXhalbtcoutsrc_SetChipType( -+ IN u1Byte chipType -+ ); -+VOID -+EXhalbtcoutsrc_SetAntNum( -+ IN u1Byte type, -+ IN u1Byte antNum -+ ); -+VOID -+EXhalbtcoutsrc_SetSingleAntPath( -+ IN u1Byte singleAntPath -+ ); -+VOID -+EXhalbtcoutsrc_DisplayBtCoexInfo( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+VOID -+EXhalbtcoutsrc_DisplayAntDetection( -+ IN PBTC_COEXIST pBtCoexist -+ ); -+ -+#define MASKBYTE0 0xff -+#define MASKBYTE1 0xff00 -+#define MASKBYTE2 0xff0000 -+#define MASKBYTE3 0xff000000 -+#define MASKHWORD 0xffff0000 -+#define MASKLWORD 0x0000ffff -+#define MASKDWORD 0xffffffff -+#define MASK12BITS 0xfff -+#define MASKH4BITS 0xf0000000 -+#define MASKOFDM_D 0xffc00000 -+#define MASKCCK 0x3f3f3f3f -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/btc/Mp_Precomp.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/Mp_Precomp.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/btc/Mp_Precomp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/btc/Mp_Precomp.h 2018-02-11 21:44:27.148146101 +0200 -@@ -0,0 +1,89 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __MP_PRECOMP_H__ -+#define __MP_PRECOMP_H__ -+ -+#include -+#include -+ -+#define BT_TMP_BUF_SIZE 100 -+ -+#ifdef PLATFORM_LINUX -+#define rsprintf snprintf -+#elif defined(PLATFORM_WINDOWS) -+#define rsprintf sprintf_s -+#endif -+ -+#define DCMD_Printf DBG_BT_INFO -+ -+#define delay_ms(ms) rtw_mdelay_os(ms) -+ -+#ifdef bEnable -+#undef bEnable -+#endif -+ -+#define WPP_SOFTWARE_TRACE 0 -+ -+typedef enum _BTC_MSG_COMP_TYPE{ -+ COMP_COEX = 0, -+ COMP_MAX -+}BTC_MSG_COMP_TYPE; -+extern u4Byte GLBtcDbgType[]; -+ -+#define DBG_OFF 0 -+#define DBG_SEC 1 -+#define DBG_SERIOUS 2 -+#define DBG_WARNING 3 -+#define DBG_LOUD 4 -+#define DBG_TRACE 5 -+ -+#ifdef CONFIG_BT_COEXIST -+#define BT_SUPPORT 1 -+#define COEX_SUPPORT 1 -+#define HS_SUPPORT 1 -+#else -+#define BT_SUPPORT 0 -+#define COEX_SUPPORT 0 -+#define HS_SUPPORT 0 -+#endif -+ -+#include "HalBtcOutSrc.h" -+#include "HalBtc8188c2Ant.h" -+#include "HalBtc8192d2Ant.h" -+#include "HalBtc8192e1Ant.h" -+#include "HalBtc8192e2Ant.h" -+#include "HalBtc8723a1Ant.h" -+#include "HalBtc8723a2Ant.h" -+#include "HalBtc8723b1Ant.h" -+#include "HalBtc8723b2Ant.h" -+#include "HalBtc8812a1Ant.h" -+#include "HalBtc8812a2Ant.h" -+#include "HalBtc8821a1Ant.h" -+#include "HalBtc8821a2Ant.h" -+#include "HalBtc8821aCsr2Ant.h" -+#include "HalBtc8703b1Ant.h" -+#include "halbtc8723d1ant.h" -+#include "halbtc8723d2ant.h" -+#include "HalBtc8822b1Ant.h" -+#include "halbtc8821c1ant.h" -+#include "halbtc8821c2ant.h" -+ -+ -+#endif // __MP_PRECOMP_H__ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/efuse_mask.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/efuse_mask.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/efuse_mask.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/efuse_mask.h 2018-02-11 21:44:27.150146132 +0200 -@@ -0,0 +1,98 @@ -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ -+#if defined(CONFIG_RTL8188E) -+ #include "rtl8188e/HalEfuseMask8188E_USB.h" -+#endif -+ -+#if defined(CONFIG_RTL8812A) -+ #include "rtl8812a/HalEfuseMask8812A_USB.h" -+#endif -+ -+#if defined(CONFIG_RTL8821A) -+ #include "rtl8812a/HalEfuseMask8821A_USB.h" -+#endif -+ -+#if defined(CONFIG_RTL8192E) -+ #include "rtl8192e/HalEfuseMask8192E_USB.h" -+#endif -+ -+#if defined(CONFIG_RTL8723B) -+ #include "rtl8723b/HalEfuseMask8723B_USB.h" -+#endif -+ -+#if defined(CONFIG_RTL8814A) -+ #include "rtl8814a/HalEfuseMask8814A_USB.h" -+#endif -+ -+#if defined(CONFIG_RTL8703B) -+ #include "rtl8703b/HalEfuseMask8703B_USB.h" -+#endif -+ -+#if defined(CONFIG_RTL8723D) -+ #include "rtl8723d/HalEfuseMask8723D_USB.h" -+#endif -+ -+#if defined(CONFIG_RTL8188F) -+ #include "rtl8188f/HalEfuseMask8188F_USB.h" -+#endif -+ -+#if defined(CONFIG_RTL8822B) -+ #include "rtl8822b/HalEfuseMask8822B_USB.h" -+#endif -+ -+#elif DEV_BUS_TYPE == RT_PCI_INTERFACE -+ -+#if defined(CONFIG_RTL8188E) -+ #include "rtl8188e/HalEfuseMask8188E_PCIE.h" -+#endif -+ -+#if defined(CONFIG_RTL8812A) -+ #include "rtl8812a/HalEfuseMask8812A_PCIE.h" -+#endif -+ -+#if defined(CONFIG_RTL8821A) -+ #include "rtl8812a/HalEfuseMask8821A_PCIE.h" -+#endif -+ -+#if defined(CONFIG_RTL8192E) -+ #include "rtl8192e/HalEfuseMask8192E_PCIE.h" -+#endif -+ -+#if defined(CONFIG_RTL8723B) -+ #include "rtl8723b/HalEfuseMask8723B_PCIE.h" -+#endif -+ -+#if defined(CONFIG_RTL8814A) -+ #include "rtl8814a/HalEfuseMask8814A_PCIE.h" -+#endif -+ -+#if defined(CONFIG_RTL8703B) -+ #include "rtl8703b/HalEfuseMask8703B_PCIE.h" -+#endif -+ -+#if defined(CONFIG_RTL8822B) -+ #include "rtl8822b/HalEfuseMask8822B_PCIE.h" -+#endif -+#if defined(CONFIG_RTL8723D) -+ #include "rtl8723d/HalEfuseMask8723D_PCIE.h" -+#endif -+ -+#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ -+#if defined(CONFIG_RTL8188E) -+ #include "rtl8188e/HalEfuseMask8188E_SDIO.h" -+#endif -+ -+#if defined(CONFIG_RTL8703B) -+ #include "rtl8703b/HalEfuseMask8703B_SDIO.h" -+#endif -+ -+#if defined(CONFIG_RTL8188F) -+ #include "rtl8188f/HalEfuseMask8188F_SDIO.h" -+#endif -+ -+#if defined(CONFIG_RTL8723D) -+ #include "rtl8723d/HalEfuseMask8723D_SDIO.h" -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.c 2018-02-11 21:44:27.150146132 +0200 -@@ -0,0 +1,96 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*#include "Mp_Precomp.h"*/ -+#include -+ -+#include "HalEfuseMask8723D_PCIE.h" -+ -+/****************************************************************************** -+* MPCIE.TXT -+******************************************************************************/ -+ -+u1Byte Array_MP_8723D_MPCIE[] = { -+ 0xFF, -+ 0xF3, -+ 0x00, -+ 0x0E, -+ 0x70, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x07, -+ 0xF3, -+ 0xFF, -+ 0xFF, -+ 0x7C, -+ 0x70, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+}; -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8723D_MPCIE(VOID) -+{ -+ return sizeof(Array_MP_8723D_MPCIE) / sizeof(u1Byte); -+} -+ -+VOID -+EFUSE_GetMaskArray_MP_8723D_MPCIE( -+ IN OUT pu1Byte Array -+) -+{ -+ u2Byte len = EFUSE_GetArrayLen_MP_8723D_MPCIE(), i = 0; -+ -+ for (i = 0; i < len; ++i) -+ Array[i] = Array_MP_8723D_MPCIE[i]; -+} -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8723D_MPCIE( -+ IN u2Byte Offset -+) -+{ -+ int r = Offset / 16; -+ int c = (Offset % 16) / 2; -+ int result = 0; -+ -+ if (c < 4) /* Upper double word */ -+ result = (Array_MP_8723D_MPCIE[r] & (0x10 << c)); -+ else -+ result = (Array_MP_8723D_MPCIE[r] & (0x01 << (c - 4))); -+ -+ return (result > 0) ? 0 : 1; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.h 2018-02-11 21:44:27.150146132 +0200 -@@ -0,0 +1,37 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/****************************************************************************** -+* MPCIE.TXT -+******************************************************************************/ -+ -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8723D_MPCIE(VOID); -+ -+VOID -+EFUSE_GetMaskArray_MP_8723D_MPCIE( -+ IN OUT pu1Byte Array -+); -+ -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8723D_MPCIE(/* TC: Test Chip, MP: MP Chip */ -+ IN u2Byte Offset -+); -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.c 2018-02-11 21:44:27.150146132 +0200 -@@ -0,0 +1,93 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+******************************************************************************/ -+ -+#include -+#include "HalEfuseMask8723D_SDIO.h" -+ -+/****************************************************************************** -+* MSDIO.TXT -+******************************************************************************/ -+ -+u1Byte Array_MP_8723D_MSDIO[] = { -+ 0xFF, -+ 0xF3, -+ 0x00, -+ 0x0E, -+ 0x70, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x07, -+ 0xF3, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+}; -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8723D_MSDIO(VOID) -+{ -+ return sizeof(Array_MP_8723D_MSDIO) / sizeof(u1Byte); -+} -+ -+VOID -+EFUSE_GetMaskArray_MP_8723D_MSDIO( -+ IN OUT pu1Byte Array -+) -+{ -+ u2Byte len = EFUSE_GetArrayLen_MP_8723D_MSDIO(), i = 0; -+ -+ for (i = 0; i < len; ++i) -+ Array[i] = Array_MP_8723D_MSDIO[i]; -+} -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8723D_MSDIO( -+ IN u2Byte Offset -+) -+{ -+ int r = Offset / 16; -+ int c = (Offset % 16) / 2; -+ int result = 0; -+ /* Upper double word */ -+ if (c < 4) -+ result = (Array_MP_8723D_MSDIO[r] & (0x10 << c)); -+ else -+ result = (Array_MP_8723D_MSDIO[r] & (0x01 << (c - 4))); -+ -+ return (result > 0) ? 0 : 1; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.h 2018-02-11 21:44:27.150146132 +0200 -@@ -0,0 +1,35 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+******************************************************************************/ -+ -+/****************************************************************************** -+* MSDIO.TXT -+******************************************************************************/ -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8723D_MSDIO(VOID); -+ -+VOID -+EFUSE_GetMaskArray_MP_8723D_MSDIO( -+ IN OUT pu1Byte Array -+); -+/* TC: Test Chip, MP: MP Chip */ -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8723D_MSDIO( -+ IN u2Byte Offset -+); -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.c 2018-02-11 21:44:27.150146132 +0200 -@@ -0,0 +1,97 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/* #include "Mp_Precomp.h" */ -+/* #include "../odm_precomp.h" */ -+ -+#include -+#include "HalEfuseMask8723D_USB.h" -+/****************************************************************************** -+* MUSB.TXT -+******************************************************************************/ -+ -+u1Byte Array_MP_8723D_MUSB[] = { -+ 0xFF, -+ 0xF3, -+ 0x00, -+ 0x0E, -+ 0x70, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x07, -+ 0xF3, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xFF, -+ 0xB0, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ 0x00, -+ -+}; -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8723D_MUSB(VOID) -+{ -+ return sizeof(Array_MP_8723D_MUSB) / sizeof(u1Byte); -+} -+ -+VOID -+EFUSE_GetMaskArray_MP_8723D_MUSB( -+ IN OUT pu1Byte Array -+) -+{ -+ u2Byte len = EFUSE_GetArrayLen_MP_8723D_MUSB(), i = 0; -+ -+ for (i = 0; i < len; ++i) -+ Array[i] = Array_MP_8723D_MUSB[i]; -+} -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8723D_MUSB( -+ IN u2Byte Offset -+) -+{ -+ int r = Offset / 16; -+ int c = (Offset % 16) / 2; -+ int result = 0; -+ -+ if (c < 4) /* Upper double word */ -+ result = (Array_MP_8723D_MUSB[r] & (0x10 << c)); -+ else -+ result = (Array_MP_8723D_MUSB[r] & (0x01 << (c - 4))); -+ -+ return (result > 0) ? 0 : 1; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.h 2018-02-11 21:44:27.150146132 +0200 -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+ -+ -+/****************************************************************************** -+* MUSB.TXT -+******************************************************************************/ -+ -+ -+u2Byte -+EFUSE_GetArrayLen_MP_8723D_MUSB(VOID); -+ -+VOID -+EFUSE_GetMaskArray_MP_8723D_MUSB( -+ IN OUT pu1Byte Array -+); -+ -+BOOLEAN -+EFUSE_IsAddressMasked_MP_8723D_MUSB(/* TC: Test Chip, MP: MP Chip */ -+ IN u2Byte Offset -+); -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_btcoex.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_btcoex.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_btcoex.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_btcoex.c 2018-02-11 21:44:27.150146132 +0200 -@@ -0,0 +1,4411 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define __HAL_BTCOEX_C__ -+ -+#ifdef CONFIG_BT_COEXIST -+ -+#include -+#include -+#include -+ -+/* ************************************ -+ * Global variables -+ * ************************************ */ -+const char *const BtProfileString[] = { -+ "NONE", -+ "A2DP", -+ "PAN", -+ "HID", -+ "SCO", -+}; -+ -+const char *const BtSpecString[] = { -+ "1.0b", -+ "1.1", -+ "1.2", -+ "2.0+EDR", -+ "2.1+EDR", -+ "3.0+HS", -+ "4.0", -+}; -+ -+const char *const BtLinkRoleString[] = { -+ "Master", -+ "Slave", -+}; -+ -+const char *const h2cStaString[] = { -+ "successful", -+ "h2c busy", -+ "rf off", -+ "fw not read", -+}; -+ -+const char *const ioStaString[] = { -+ "success", -+ "can not IO", -+ "rf off", -+ "fw not read", -+ "wait io timeout", -+ "invalid len", -+ "idle Q empty", -+ "insert waitQ fail", -+ "unknown fail", -+ "wrong level", -+ "h2c stopped", -+}; -+ -+const char *const GLBtcWifiBwString[] = { -+ "11bg", -+ "HT20", -+ "HT40", -+ "HT80", -+ "HT160" -+}; -+ -+const char *const GLBtcWifiFreqString[] = { -+ "2.4G", -+ "5G" -+}; -+ -+const char *const GLBtcIotPeerString[] = { -+ "UNKNOWN", -+ "REALTEK", -+ "REALTEK_92SE", -+ "BROADCOM", -+ "RALINK", -+ "ATHEROS", -+ "CISCO", -+ "MERU", -+ "MARVELL", -+ "REALTEK_SOFTAP", /* peer is RealTek SOFT_AP, by Bohn, 2009.12.17 */ -+ "SELF_SOFTAP", /* Self is SoftAP */ -+ "AIRGO", -+ "INTEL", -+ "RTK_APCLIENT", -+ "REALTEK_81XX", -+ "REALTEK_WOW", -+ "REALTEK_JAGUAR_BCUTAP", -+ "REALTEK_JAGUAR_CCUTAP" -+}; -+ -+const char *const coexOpcodeString[] = { -+ "Wifi status notify", -+ "Wifi progress", -+ "Wifi info", -+ "Power state", -+ "Set Control", -+ "Get Control" -+}; -+ -+const char *const coexIndTypeString[] = { -+ "bt info", -+ "pstdma", -+ "limited tx/rx", -+ "coex table", -+ "request" -+}; -+ -+const char *const coexH2cResultString[] = { -+ "ok", -+ "unknown", -+ "un opcode", -+ "opVer MM", -+ "par Err", -+ "par OoR", -+ "reqNum MM", -+ "halMac Fail", -+ "h2c TimeOut", -+ "Invalid c2h Len", -+ "data overflow" -+}; -+ -+#define HALBTCOUTSRC_AGG_CHK_WINDOW_IN_MS 8000 -+ -+struct btc_coexist GLBtCoexist; -+BTC_OFFLOAD gl_coex_offload; -+u8 GLBtcWiFiInScanState; -+u8 GLBtcWiFiInIQKState; -+u8 GLBtcWiFiInIPS; -+u8 GLBtcWiFiInLPS; -+u8 GLBtcBtCoexAliveRegistered; -+ -+/* -+ * BT control H2C/C2H -+ */ -+/* EXT_EID */ -+typedef enum _bt_ext_eid { -+ C2H_WIFI_FW_ACTIVE_RSP = 0, -+ C2H_TRIG_BY_BT_FW -+} BT_EXT_EID; -+ -+/* C2H_STATUS */ -+typedef enum _bt_c2h_status { -+ BT_STATUS_OK = 0, -+ BT_STATUS_VERSION_MISMATCH, -+ BT_STATUS_UNKNOWN_OPCODE, -+ BT_STATUS_ERROR_PARAMETER -+} BT_C2H_STATUS; -+ -+/* C2H BT OP CODES */ -+typedef enum _bt_op_code { -+ BT_OP_GET_BT_VERSION = 0x00, -+ BT_OP_WRITE_REG_ADDR = 0x0c, -+ BT_OP_WRITE_REG_VALUE = 0x0d, -+ -+ BT_OP_READ_REG = 0x11, -+ -+ BT_LO_OP_GET_AFH_MAP_L = 0x1e, -+ BT_LO_OP_GET_AFH_MAP_M = 0x1f, -+ BT_LO_OP_GET_AFH_MAP_H = 0x20, -+ -+ BT_OP_GET_BT_COEX_SUPPORTED_FEATURE = 0x2a, -+ BT_OP_GET_BT_COEX_SUPPORTED_VERSION = 0x2b, -+ BT_OP_GET_BT_ANT_DET_VAL = 0x2c, -+ BT_OP_GET_BT_BLE_SCAN_PARA = 0x2d, -+ BT_OP_GET_BT_BLE_SCAN_TYPE = 0x2e, -+ BT_OP_MAX -+} BT_OP_CODE; -+ -+#define BTC_MPOPER_TIMEOUT 50 /* unit: ms */ -+ -+#define C2H_MAX_SIZE 16 -+u8 GLBtcBtMpOperSeq; -+_mutex GLBtcBtMpOperLock; -+_timer GLBtcBtMpOperTimer; -+_sema GLBtcBtMpRptSema; -+u8 GLBtcBtMpRptSeq; -+u8 GLBtcBtMpRptStatus; -+u8 GLBtcBtMpRptRsp[C2H_MAX_SIZE]; -+u8 GLBtcBtMpRptRspSize; -+u8 GLBtcBtMpRptWait; -+u8 GLBtcBtMpRptWiFiOK; -+u8 GLBtcBtMpRptBTOK; -+ -+/* -+ * Debug -+ */ -+u32 GLBtcDbgType[COMP_MAX]; -+u8 GLBtcDbgBuf[BT_TMP_BUF_SIZE]; -+u1Byte gl_btc_trace_buf[BT_TMP_BUF_SIZE]; -+ -+typedef struct _btcoexdbginfo { -+ u8 *info; -+ u32 size; /* buffer total size */ -+ u32 len; /* now used length */ -+} BTCDBGINFO, *PBTCDBGINFO; -+ -+BTCDBGINFO GLBtcDbgInfo; -+ -+#define BT_Operation(Adapter) _FALSE -+ -+static void DBG_BT_INFO_INIT(PBTCDBGINFO pinfo, u8 *pbuf, u32 size) -+{ -+ if (NULL == pinfo) -+ return; -+ -+ _rtw_memset(pinfo, 0, sizeof(BTCDBGINFO)); -+ -+ if (pbuf && size) { -+ pinfo->info = pbuf; -+ pinfo->size = size; -+ } -+} -+ -+void DBG_BT_INFO(u8 *dbgmsg) -+{ -+ PBTCDBGINFO pinfo; -+ u32 msglen, buflen; -+ u8 *pbuf; -+ -+ -+ pinfo = &GLBtcDbgInfo; -+ -+ if (NULL == pinfo->info) -+ return; -+ -+ msglen = strlen(dbgmsg); -+ if (pinfo->len + msglen > pinfo->size) -+ return; -+ -+ pbuf = pinfo->info + pinfo->len; -+ _rtw_memcpy(pbuf, dbgmsg, msglen); -+ pinfo->len += msglen; -+} -+ -+/* ************************************ -+ * Debug related function -+ * ************************************ */ -+static u8 halbtcoutsrc_IsBtCoexistAvailable(PBTC_COEXIST pBtCoexist) -+{ -+ if (!pBtCoexist->bBinded || -+ NULL == pBtCoexist->Adapter) -+ return _FALSE; -+ return _TRUE; -+} -+ -+static void halbtcoutsrc_DbgInit(void) -+{ -+ u8 i; -+ -+ for (i = 0; i < COMP_MAX; i++) -+ GLBtcDbgType[i] = 0; -+} -+ -+static u8 halbtcoutsrc_IsCsrBtCoex(PBTC_COEXIST pBtCoexist) -+{ -+ if (pBtCoexist->board_info.bt_chip_type == BTC_CHIP_CSR_BC4 -+ || pBtCoexist->board_info.bt_chip_type == BTC_CHIP_CSR_BC8 -+ ) -+ return _TRUE; -+ return _FALSE; -+} -+ -+static void halbtcoutsrc_EnterPwrLock(PBTC_COEXIST pBtCoexist) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj((PADAPTER)pBtCoexist->Adapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ -+ _enter_pwrlock(&pwrpriv->lock); -+} -+ -+static void halbtcoutsrc_ExitPwrLock(PBTC_COEXIST pBtCoexist) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj((PADAPTER)pBtCoexist->Adapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ -+ _exit_pwrlock(&pwrpriv->lock); -+} -+ -+static u8 halbtcoutsrc_IsHwMailboxExist(PBTC_COEXIST pBtCoexist) -+{ -+ if (pBtCoexist->board_info.bt_chip_type == BTC_CHIP_CSR_BC4 -+ || pBtCoexist->board_info.bt_chip_type == BTC_CHIP_CSR_BC8 -+ ) -+ return _FALSE; -+ else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) -+ return _FALSE; -+ else -+ return _TRUE; -+} -+ -+static void halbtcoutsrc_LeaveLps(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ -+ -+ padapter = pBtCoexist->Adapter; -+ -+ pBtCoexist->bt_info.bt_ctrl_lps = _TRUE; -+ pBtCoexist->bt_info.bt_lps_on = _FALSE; -+ -+ rtw_btcoex_LPS_Leave(padapter); -+} -+ -+void halbtcoutsrc_EnterLps(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ -+ -+ padapter = pBtCoexist->Adapter; -+ -+ if (pBtCoexist->bdontenterLPS == _FALSE) { -+ pBtCoexist->bt_info.bt_ctrl_lps = _TRUE; -+ pBtCoexist->bt_info.bt_lps_on = _TRUE; -+ -+ rtw_btcoex_LPS_Enter(padapter); -+ } -+} -+ -+void halbtcoutsrc_NormalLps(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ -+ -+ -+ padapter = pBtCoexist->Adapter; -+ -+ if (pBtCoexist->bt_info.bt_ctrl_lps) { -+ pBtCoexist->bt_info.bt_lps_on = _FALSE; -+ rtw_btcoex_LPS_Leave(padapter); -+ pBtCoexist->bt_info.bt_ctrl_lps = _FALSE; -+ -+ /* recover the LPS state to the original */ -+#if 0 -+ padapter->HalFunc.UpdateLPSStatusHandler( -+ padapter, -+ pPSC->RegLeisurePsMode, -+ pPSC->RegPowerSaveMode); -+#endif -+ } -+} -+ -+/* -+ * Constraint: -+ * 1. this function will request pwrctrl->lock -+ */ -+void halbtcoutsrc_LeaveLowPower(PBTC_COEXIST pBtCoexist) -+{ -+#ifdef CONFIG_LPS_LCLK -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ struct pwrctrl_priv *pwrctrl; -+ s32 ready; -+ u32 stime; -+ s32 utime; -+ u32 timeout; /* unit: ms */ -+ -+ -+ padapter = pBtCoexist->Adapter; -+ pHalData = GET_HAL_DATA(padapter); -+ pwrctrl = adapter_to_pwrctl(padapter); -+ ready = _FAIL; -+#ifdef LPS_RPWM_WAIT_MS -+ timeout = LPS_RPWM_WAIT_MS; -+#else /* !LPS_RPWM_WAIT_MS */ -+ timeout = 30; -+#endif /* !LPS_RPWM_WAIT_MS */ -+ -+ if (GLBtcBtCoexAliveRegistered == _TRUE) -+ return; -+ -+ stime = rtw_get_current_time(); -+ do { -+ ready = rtw_register_task_alive(padapter, BTCOEX_ALIVE); -+ if (_SUCCESS == ready) -+ break; -+ -+ utime = rtw_get_passing_time_ms(stime); -+ if (utime > timeout) -+ break; -+ -+ rtw_msleep_os(1); -+ } while (1); -+ -+ GLBtcBtCoexAliveRegistered = _TRUE; -+#endif /* CONFIG_LPS_LCLK */ -+} -+ -+/* -+ * Constraint: -+ * 1. this function will request pwrctrl->lock -+ */ -+void halbtcoutsrc_NormalLowPower(PBTC_COEXIST pBtCoexist) -+{ -+#ifdef CONFIG_LPS_LCLK -+ PADAPTER padapter; -+ -+ if (GLBtcBtCoexAliveRegistered == _FALSE) -+ return; -+ -+ padapter = pBtCoexist->Adapter; -+ rtw_unregister_task_alive(padapter, BTCOEX_ALIVE); -+ -+ GLBtcBtCoexAliveRegistered = _FALSE; -+#endif /* CONFIG_LPS_LCLK */ -+} -+ -+void halbtcoutsrc_DisableLowPower(PBTC_COEXIST pBtCoexist, u8 bLowPwrDisable) -+{ -+ pBtCoexist->bt_info.bt_disable_low_pwr = bLowPwrDisable; -+ if (bLowPwrDisable) -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); /* leave 32k low power. */ -+ else -+ halbtcoutsrc_NormalLowPower(pBtCoexist); /* original 32k low power behavior. */ -+} -+ -+void halbtcoutsrc_AggregationCheck(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ BOOLEAN bNeedToAct = _FALSE; -+ static u32 preTime = 0; -+ u32 curTime = 0; -+ -+ padapter = pBtCoexist->Adapter; -+ -+ /* ===================================== */ -+ /* To void continuous deleteBA=>addBA=>deleteBA=>addBA */ -+ /* This function is not allowed to continuous called. */ -+ /* It can only be called after 8 seconds. */ -+ /* ===================================== */ -+ -+ curTime = rtw_systime_to_ms(rtw_get_current_time()); -+ if ((curTime - preTime) < HALBTCOUTSRC_AGG_CHK_WINDOW_IN_MS) /* over 8 seconds you can execute this function again. */ -+ return; -+ else -+ preTime = curTime; -+ -+ if (pBtCoexist->bt_info.reject_agg_pkt) { -+ bNeedToAct = _TRUE; -+ pBtCoexist->bt_info.pre_reject_agg_pkt = pBtCoexist->bt_info.reject_agg_pkt; -+ } else { -+ if (pBtCoexist->bt_info.pre_reject_agg_pkt) { -+ bNeedToAct = _TRUE; -+ pBtCoexist->bt_info.pre_reject_agg_pkt = pBtCoexist->bt_info.reject_agg_pkt; -+ } -+ -+ if (pBtCoexist->bt_info.pre_bt_ctrl_agg_buf_size != -+ pBtCoexist->bt_info.bt_ctrl_agg_buf_size) { -+ bNeedToAct = _TRUE; -+ pBtCoexist->bt_info.pre_bt_ctrl_agg_buf_size = pBtCoexist->bt_info.bt_ctrl_agg_buf_size; -+ } -+ -+ if (pBtCoexist->bt_info.bt_ctrl_agg_buf_size) { -+ if (pBtCoexist->bt_info.pre_agg_buf_size != -+ pBtCoexist->bt_info.agg_buf_size) -+ bNeedToAct = _TRUE; -+ pBtCoexist->bt_info.pre_agg_buf_size = pBtCoexist->bt_info.agg_buf_size; -+ } -+ } -+ -+ if (bNeedToAct) -+ rtw_btcoex_rx_ampdu_apply(padapter); -+} -+ -+u8 halbtcoutsrc_IsWifiBusy(PADAPTER padapter) -+{ -+ if (rtw_mi_check_status(padapter, MI_AP_MODE)) -+ return _TRUE; -+ if (rtw_mi_busy_traffic_check(padapter, _FALSE)) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+static u32 _halbtcoutsrc_GetWifiLinkStatus(PADAPTER padapter) -+{ -+ struct mlme_priv *pmlmepriv; -+ u8 bp2p; -+ u32 portConnectedStatus; -+ -+ -+ pmlmepriv = &padapter->mlmepriv; -+ bp2p = _FALSE; -+ portConnectedStatus = 0; -+ -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE)) -+ bp2p = _TRUE; -+#endif /* CONFIG_P2P */ -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ if (_TRUE == bp2p) -+ portConnectedStatus |= WIFI_P2P_GO_CONNECTED; -+ else -+ portConnectedStatus |= WIFI_AP_CONNECTED; -+ } else { -+ if (_TRUE == bp2p) -+ portConnectedStatus |= WIFI_P2P_GC_CONNECTED; -+ else -+ portConnectedStatus |= WIFI_STA_CONNECTED; -+ } -+ } -+ -+ return portConnectedStatus; -+} -+ -+u32 halbtcoutsrc_GetWifiLinkStatus(PBTC_COEXIST pBtCoexist) -+{ -+ /* ================================= */ -+ /* return value: */ -+ /* [31:16]=> connected port number */ -+ /* [15:0]=> port connected bit define */ -+ /* ================================ */ -+ -+ PADAPTER padapter; -+ u32 retVal; -+ u32 portConnectedStatus, numOfConnectedPort; -+ struct dvobj_priv *dvobj; -+ _adapter *iface; -+ int i; -+ -+ padapter = pBtCoexist->Adapter; -+ retVal = 0; -+ portConnectedStatus = 0; -+ numOfConnectedPort = 0; -+ dvobj = adapter_to_dvobj(padapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ retVal = _halbtcoutsrc_GetWifiLinkStatus(iface); -+ if (retVal) { -+ portConnectedStatus |= retVal; -+ numOfConnectedPort++; -+ } -+ } -+ } -+ retVal = (numOfConnectedPort << 16) | portConnectedStatus; -+ -+ return retVal; -+} -+ -+static void _btmpoper_timer_hdl(void *p) -+{ -+ if (GLBtcBtMpRptWait) { -+ GLBtcBtMpRptWait = 0; -+ _rtw_up_sema(&GLBtcBtMpRptSema); -+ } -+} -+ -+/* -+ * !IMPORTANT! -+ * Before call this function, caller should acquire "GLBtcBtMpOperLock"! -+ * Othrewise there will be racing problem and something may go wrong. -+ */ -+static u8 _btmpoper_cmd(PBTC_COEXIST pBtCoexist, u8 opcode, u8 opcodever, u8 *cmd, u8 size) -+{ -+ PADAPTER padapter; -+ u8 buf[H2C_BTMP_OPER_LEN] = {0}; -+ u8 buflen; -+ u8 seq; -+ u8 timer_cancelled; -+ s32 ret; -+ -+ -+ if (!cmd && size) -+ size = 0; -+ if ((size + 2) > H2C_BTMP_OPER_LEN) -+ return BT_STATUS_H2C_LENGTH_EXCEEDED; -+ buflen = size + 2; -+ -+ seq = GLBtcBtMpOperSeq & 0xF; -+ GLBtcBtMpOperSeq++; -+ -+ buf[0] = (opcodever & 0xF) | (seq << 4); -+ buf[1] = opcode; -+ if (cmd && size) -+ _rtw_memcpy(buf + 2, cmd, size); -+ -+ GLBtcBtMpRptWait = 1; -+ GLBtcBtMpRptWiFiOK = 0; -+ GLBtcBtMpRptBTOK = 0; -+ GLBtcBtMpRptStatus = 0; -+ padapter = pBtCoexist->Adapter; -+ _set_timer(&GLBtcBtMpOperTimer, BTC_MPOPER_TIMEOUT); -+ if (rtw_hal_fill_h2c_cmd(padapter, H2C_BT_MP_OPER, buflen, buf) == _FAIL) { -+ _cancel_timer(&GLBtcBtMpOperTimer, &timer_cancelled); -+ ret = BT_STATUS_H2C_FAIL; -+ goto exit; -+ } -+ -+ _rtw_down_sema(&GLBtcBtMpRptSema); -+ /* GLBtcBtMpRptWait should be 0 here*/ -+ -+ if (!GLBtcBtMpRptWiFiOK) { -+ RTW_ERR("%s: Didn't get H2C Rsp Event!\n", __FUNCTION__); -+ ret = BT_STATUS_H2C_TIMTOUT; -+ goto exit; -+ } -+ if (!GLBtcBtMpRptBTOK) { -+ RTW_DBG("%s: Didn't get BT response!\n", __FUNCTION__); -+ ret = BT_STATUS_H2C_BT_NO_RSP; -+ goto exit; -+ } -+ if (seq != GLBtcBtMpRptSeq) { -+ RTW_ERR("%s: Sequence number not match!(%d!=%d)!\n", -+ __FUNCTION__, seq, GLBtcBtMpRptSeq); -+ ret = BT_STATUS_C2H_REQNUM_MISMATCH; -+ goto exit; -+ } -+ -+ switch (GLBtcBtMpRptStatus) { -+ /* Examine the status reported from C2H */ -+ case BT_STATUS_OK: -+ ret = BT_STATUS_BT_OP_SUCCESS; -+ RTW_DBG("%s: C2H status = BT_STATUS_BT_OP_SUCCESS\n", __FUNCTION__); -+ break; -+ case BT_STATUS_VERSION_MISMATCH: -+ ret = BT_STATUS_OPCODE_L_VERSION_MISMATCH; -+ RTW_DBG("%s: C2H status = BT_STATUS_OPCODE_L_VERSION_MISMATCH\n", __FUNCTION__); -+ break; -+ case BT_STATUS_UNKNOWN_OPCODE: -+ ret = BT_STATUS_UNKNOWN_OPCODE_L; -+ RTW_DBG("%s: C2H status = MP_BT_STATUS_UNKNOWN_OPCODE_L\n", __FUNCTION__); -+ break; -+ case BT_STATUS_ERROR_PARAMETER: -+ ret = BT_STATUS_PARAMETER_FORMAT_ERROR_L; -+ RTW_DBG("%s: C2H status = MP_BT_STATUS_PARAMETER_FORMAT_ERROR_L\n", __FUNCTION__); -+ break; -+ default: -+ ret = BT_STATUS_UNKNOWN_STATUS_L; -+ RTW_DBG("%s: C2H status = MP_BT_STATUS_UNKNOWN_STATUS_L\n", __FUNCTION__); -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+u32 halbtcoutsrc_GetBtPatchVer(PBTC_COEXIST pBtCoexist) -+{ -+ if (pBtCoexist->bt_info.get_bt_fw_ver_cnt <= 5) { -+ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { -+ _irqL irqL; -+ u8 ret; -+ -+ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ ret = _btmpoper_cmd(pBtCoexist, BT_OP_GET_BT_VERSION, 0, NULL, 0); -+ if (BT_STATUS_BT_OP_SUCCESS == ret) { -+ pBtCoexist->bt_info.bt_real_fw_ver = le16_to_cpu(*(u16 *)GLBtcBtMpRptRsp); -+ pBtCoexist->bt_info.bt_fw_ver = *(GLBtcBtMpRptRsp + 2); -+ pBtCoexist->bt_info.get_bt_fw_ver_cnt++; -+ } -+ -+ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ } else { -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ u1Byte dataLen = 2; -+ u1Byte buf[4] = {0}; -+ -+ buf[0] = 0x0; /* OP_Code */ -+ buf[1] = 0x0; /* OP_Code_Length */ -+ BT_SendEventExtBtCoexControl(pBtCoexist->Adapter, _FALSE, dataLen, &buf[0]); -+#endif /* !CONFIG_BT_COEXIST_SOCKET_TRX */ -+ } -+ } -+ -+exit: -+ return pBtCoexist->bt_info.bt_real_fw_ver; -+} -+ -+s32 halbtcoutsrc_GetWifiRssi(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ s32 UndecoratedSmoothedPWDB = 0; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ -+ return UndecoratedSmoothedPWDB; -+} -+ -+u32 halbtcoutsrc_GetBtCoexSupportedFeature(void *pBtcContext) -+{ -+ PBTC_COEXIST pBtCoexist; -+ u32 ret = BT_STATUS_BT_OP_SUCCESS; -+ u32 data = 0; -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ -+ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { -+ u8 buf[3] = {0}; -+ _irqL irqL; -+ u8 op_code; -+ u8 status; -+ -+ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ op_code = BT_OP_GET_BT_COEX_SUPPORTED_FEATURE; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); -+ if (status == BT_STATUS_BT_OP_SUCCESS) -+ data = le16_to_cpu(*(u16 *)GLBtcBtMpRptRsp); -+ else -+ ret = SET_BT_MP_OPER_RET(op_code, status); -+ -+ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ } else -+ ret = BT_STATUS_NOT_IMPLEMENT; -+ -+ return data; -+} -+ -+u32 halbtcoutsrc_GetBtCoexSupportedVersion(void *pBtcContext) -+{ -+ PBTC_COEXIST pBtCoexist; -+ u32 ret = BT_STATUS_BT_OP_SUCCESS; -+ u32 data = 0xFFFF; -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ -+ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { -+ u8 buf[3] = {0}; -+ _irqL irqL; -+ u8 op_code; -+ u8 status; -+ -+ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ op_code = BT_OP_GET_BT_COEX_SUPPORTED_VERSION; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); -+ if (status == BT_STATUS_BT_OP_SUCCESS) -+ data = le16_to_cpu(*(u16 *)GLBtcBtMpRptRsp); -+ else -+ ret = SET_BT_MP_OPER_RET(op_code, status); -+ -+ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ } else -+ ret = BT_STATUS_NOT_IMPLEMENT; -+ -+ return data; -+} -+ -+static u8 halbtcoutsrc_GetWifiScanAPNum(PADAPTER padapter) -+{ -+ struct mlme_priv *pmlmepriv; -+ struct mlme_ext_priv *pmlmeext; -+ static u8 scan_AP_num = 0; -+ -+ -+ pmlmepriv = &padapter->mlmepriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ -+ if (GLBtcWiFiInScanState == _FALSE) { -+ if (pmlmepriv->num_of_scanned > 0xFF) -+ scan_AP_num = 0xFF; -+ else -+ scan_AP_num = (u8)pmlmepriv->num_of_scanned; -+ } -+ -+ return scan_AP_num; -+} -+ -+u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ struct mlme_ext_priv *mlmeext; -+ u8 bSoftApExist, bVwifiExist; -+ u8 *pu8; -+ s32 *pS4Tmp; -+ u32 *pU4Tmp; -+ u8 *pU1Tmp; -+ u8 ret; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return _FALSE; -+ -+ padapter = pBtCoexist->Adapter; -+ pHalData = GET_HAL_DATA(padapter); -+ mlmeext = &padapter->mlmeextpriv; -+ bSoftApExist = _FALSE; -+ bVwifiExist = _FALSE; -+ pu8 = (u8 *)pOutBuf; -+ pS4Tmp = (s32 *)pOutBuf; -+ pU4Tmp = (u32 *)pOutBuf; -+ pU1Tmp = (u8 *)pOutBuf; -+ ret = _TRUE; -+ -+ switch (getType) { -+ case BTC_GET_BL_HS_OPERATION: -+ *pu8 = _FALSE; -+ ret = _FALSE; -+ break; -+ -+ case BTC_GET_BL_HS_CONNECTING: -+ *pu8 = _FALSE; -+ ret = _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_CONNECTED: -+ *pu8 = (rtw_mi_check_status(padapter, MI_LINKED)) ? _TRUE : _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_BUSY: -+ *pu8 = halbtcoutsrc_IsWifiBusy(padapter); -+ break; -+ -+ case BTC_GET_BL_WIFI_SCAN: -+#if 0 -+ *pu8 = (rtw_mi_check_fwstate(padapter, WIFI_SITE_MONITOR)) ? _TRUE : _FALSE; -+#else -+ /* Use the value of the new variable GLBtcWiFiInScanState to judge whether WiFi is in scan state or not, since the originally used flag -+ WIFI_SITE_MONITOR in fwstate may not be cleared in time */ -+ *pu8 = GLBtcWiFiInScanState; -+#endif -+ break; -+ -+ case BTC_GET_BL_WIFI_LINK: -+ *pu8 = (rtw_mi_check_status(padapter, MI_STA_LINKING)) ? _TRUE : _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_ROAM: -+ *pu8 = (rtw_mi_check_status(padapter, MI_STA_LINKING)) ? _TRUE : _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_4_WAY_PROGRESS: -+ *pu8 = _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_UNDER_5G: -+ *pu8 = (pHalData->CurrentBandType == 1) ? _TRUE : _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_AP_MODE_ENABLE: -+ *pu8 = (rtw_mi_check_status(padapter, MI_AP_MODE)) ? _TRUE : _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_ENABLE_ENCRYPTION: -+ *pu8 = padapter->securitypriv.dot11PrivacyAlgrthm == 0 ? _FALSE : _TRUE; -+ break; -+ -+ case BTC_GET_BL_WIFI_UNDER_B_MODE: -+ if (mlmeext->cur_wireless_mode == WIRELESS_11B) -+ *pu8 = _TRUE; -+ else -+ *pu8 = _FALSE; -+ break; -+ -+ case BTC_GET_BL_WIFI_IS_IN_MP_MODE: -+ if (padapter->registrypriv.mp_mode == 0) -+ *pu8 = _FALSE; -+ else -+ *pu8 = _TRUE; -+ break; -+ -+ case BTC_GET_BL_EXT_SWITCH: -+ *pu8 = _FALSE; -+ break; -+ case BTC_GET_BL_IS_ASUS_8723B: -+ /* Always return FALSE in linux driver since this case is added only for windows driver */ -+ *pu8 = _FALSE; -+ break; -+ -+ case BTC_GET_S4_WIFI_RSSI: -+ *pS4Tmp = halbtcoutsrc_GetWifiRssi(padapter); -+ break; -+ -+ case BTC_GET_S4_HS_RSSI: -+ *pS4Tmp = 0; -+ ret = _FALSE; -+ break; -+ -+ case BTC_GET_U4_WIFI_BW: -+ if (IsLegacyOnly(mlmeext->cur_wireless_mode)) -+ *pU4Tmp = BTC_WIFI_BW_LEGACY; -+ else { -+ switch (pHalData->CurrentChannelBW) { -+ case CHANNEL_WIDTH_20: -+ *pU4Tmp = BTC_WIFI_BW_HT20; -+ break; -+ case CHANNEL_WIDTH_40: -+ *pU4Tmp = BTC_WIFI_BW_HT40; -+ break; -+ case CHANNEL_WIDTH_80: -+ *pU4Tmp = BTC_WIFI_BW_HT80; -+ break; -+ case CHANNEL_WIDTH_160: -+ *pU4Tmp = BTC_WIFI_BW_HT160; -+ break; -+ default: -+ RTW_INFO("[BTCOEX] unkown bandwidth(%d)\n", pHalData->CurrentChannelBW); -+ *pU4Tmp = BTC_WIFI_BW_HT40; -+ break; -+ } -+ -+ } -+ break; -+ -+ case BTC_GET_U4_WIFI_TRAFFIC_DIRECTION: { -+ PRT_LINK_DETECT_T plinkinfo; -+ plinkinfo = &padapter->mlmepriv.LinkDetectInfo; -+ -+ if (plinkinfo->NumTxOkInPeriod > plinkinfo->NumRxOkInPeriod) -+ *pU4Tmp = BTC_WIFI_TRAFFIC_TX; -+ else -+ *pU4Tmp = BTC_WIFI_TRAFFIC_RX; -+ } -+ break; -+ -+ case BTC_GET_U4_WIFI_FW_VER: -+ *pU4Tmp = pHalData->FirmwareVersion << 16; -+ *pU4Tmp |= pHalData->FirmwareSubVersion; -+ break; -+ -+ case BTC_GET_U4_WIFI_LINK_STATUS: -+ *pU4Tmp = halbtcoutsrc_GetWifiLinkStatus(pBtCoexist); -+ break; -+ -+ case BTC_GET_U4_BT_PATCH_VER: -+ *pU4Tmp = halbtcoutsrc_GetBtPatchVer(pBtCoexist); -+ break; -+ -+ case BTC_GET_U4_VENDOR: -+ *pU4Tmp = BTC_VENDOR_OTHER; -+ break; -+ -+ case BTC_GET_U4_SUPPORTED_VERSION: -+ *pU4Tmp = halbtcoutsrc_GetBtCoexSupportedVersion(pBtCoexist); -+ break; -+ case BTC_GET_U4_SUPPORTED_FEATURE: -+ *pU4Tmp = halbtcoutsrc_GetBtCoexSupportedFeature(pBtCoexist); -+ break; -+ -+ case BTC_GET_U4_WIFI_IQK_TOTAL: -+ *pU4Tmp = pHalData->odmpriv.nIQK_Cnt; -+ break; -+ -+ case BTC_GET_U4_WIFI_IQK_OK: -+ *pU4Tmp = pHalData->odmpriv.nIQK_OK_Cnt; -+ break; -+ -+ case BTC_GET_U4_WIFI_IQK_FAIL: -+ *pU4Tmp = pHalData->odmpriv.nIQK_Fail_Cnt; -+ break; -+ -+ case BTC_GET_U1_WIFI_DOT11_CHNL: -+ *pU1Tmp = padapter->mlmeextpriv.cur_channel; -+ break; -+ -+ case BTC_GET_U1_WIFI_CENTRAL_CHNL: -+ *pU1Tmp = pHalData->CurrentChannel; -+ break; -+ -+ case BTC_GET_U1_WIFI_HS_CHNL: -+ *pU1Tmp = 0; -+ ret = _FALSE; -+ break; -+ -+ case BTC_GET_U1_WIFI_P2P_CHNL: -+#ifdef CONFIG_P2P -+ { -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ *pU1Tmp = pwdinfo->operating_channel; -+ } -+#else -+ *pU1Tmp = 0; -+#endif -+ break; -+ -+ case BTC_GET_U1_MAC_PHY_MODE: -+ /* *pU1Tmp = BTC_SMSP; -+ * *pU1Tmp = BTC_DMSP; -+ * *pU1Tmp = BTC_DMDP; -+ * *pU1Tmp = BTC_MP_UNKNOWN; */ -+ break; -+ -+ case BTC_GET_U1_AP_NUM: -+ *pU1Tmp = halbtcoutsrc_GetWifiScanAPNum(padapter); -+ break; -+ case BTC_GET_U1_ANT_TYPE: -+ switch (pHalData->bt_coexist.btAntisolation) { -+ case 0: -+ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_0; -+ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_0; -+ break; -+ case 1: -+ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_1; -+ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_1; -+ break; -+ case 2: -+ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_2; -+ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_2; -+ break; -+ case 3: -+ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_3; -+ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_3; -+ break; -+ case 4: -+ *pU1Tmp = (u1Byte)BTC_ANT_TYPE_4; -+ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_4; -+ break; -+ } -+ break; -+ case BTC_GET_U1_IOT_PEER: -+ *pU1Tmp = mlmeext->mlmext_info.assoc_AP_vendor; -+ break; -+ -+ /* =======1Ant=========== */ -+ case BTC_GET_U1_LPS_MODE: -+ *pU1Tmp = padapter->dvobj->pwrctl_priv.pwr_mode; -+ break; -+ -+ default: -+ ret = _FALSE; -+ break; -+ } -+ -+ return ret; -+} -+ -+u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ u8 *pu8; -+ u8 *pU1Tmp; -+ u32 *pU4Tmp; -+ u8 ret; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ pHalData = GET_HAL_DATA(padapter); -+ pu8 = (u8 *)pInBuf; -+ pU1Tmp = (u8 *)pInBuf; -+ pU4Tmp = (u32 *)pInBuf; -+ ret = _TRUE; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return _FALSE; -+ -+ switch (setType) { -+ /* set some u8 type variables. */ -+ case BTC_SET_BL_BT_DISABLE: -+ pBtCoexist->bt_info.bt_disabled = *pu8; -+ break; -+ -+ case BTC_SET_BL_BT_TRAFFIC_BUSY: -+ pBtCoexist->bt_info.bt_busy = *pu8; -+ break; -+ -+ case BTC_SET_BL_BT_LIMITED_DIG: -+ pBtCoexist->bt_info.limited_dig = *pu8; -+ break; -+ -+ case BTC_SET_BL_FORCE_TO_ROAM: -+ pBtCoexist->bt_info.force_to_roam = *pu8; -+ break; -+ -+ case BTC_SET_BL_TO_REJ_AP_AGG_PKT: -+ pBtCoexist->bt_info.reject_agg_pkt = *pu8; -+ break; -+ -+ case BTC_SET_BL_BT_CTRL_AGG_SIZE: -+ pBtCoexist->bt_info.bt_ctrl_agg_buf_size = *pu8; -+ break; -+ -+ case BTC_SET_BL_INC_SCAN_DEV_NUM: -+ pBtCoexist->bt_info.increase_scan_dev_num = *pu8; -+ break; -+ -+ case BTC_SET_BL_BT_TX_RX_MASK: -+ pBtCoexist->bt_info.bt_tx_rx_mask = *pu8; -+ break; -+ -+ case BTC_SET_BL_MIRACAST_PLUS_BT: -+ pBtCoexist->bt_info.miracast_plus_bt = *pu8; -+ break; -+ -+ /* set some u8 type variables. */ -+ case BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON: -+ pBtCoexist->bt_info.rssi_adjust_for_agc_table_on = *pU1Tmp; -+ break; -+ -+ case BTC_SET_U1_AGG_BUF_SIZE: -+ pBtCoexist->bt_info.agg_buf_size = *pU1Tmp; -+ break; -+ -+ /* the following are some action which will be triggered */ -+ case BTC_SET_ACT_GET_BT_RSSI: -+#if 0 -+ BT_SendGetBtRssiEvent(padapter); -+#else -+ ret = _FALSE; -+#endif -+ break; -+ -+ case BTC_SET_ACT_AGGREGATE_CTRL: -+ halbtcoutsrc_AggregationCheck(pBtCoexist); -+ break; -+ -+ /* =======1Ant=========== */ -+ /* set some u8 type variables. */ -+ case BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE: -+ pBtCoexist->bt_info.rssi_adjust_for_1ant_coex_type = *pU1Tmp; -+ break; -+ -+ case BTC_SET_U1_LPS_VAL: -+ pBtCoexist->bt_info.lps_val = *pU1Tmp; -+ break; -+ -+ case BTC_SET_U1_RPWM_VAL: -+ pBtCoexist->bt_info.rpwm_val = *pU1Tmp; -+ break; -+ -+ /* the following are some action which will be triggered */ -+ case BTC_SET_ACT_LEAVE_LPS: -+ halbtcoutsrc_LeaveLps(pBtCoexist); -+ break; -+ -+ case BTC_SET_ACT_ENTER_LPS: -+ halbtcoutsrc_EnterLps(pBtCoexist); -+ break; -+ -+ case BTC_SET_ACT_NORMAL_LPS: -+ halbtcoutsrc_NormalLps(pBtCoexist); -+ break; -+ -+ case BTC_SET_ACT_DISABLE_LOW_POWER: -+ halbtcoutsrc_DisableLowPower(pBtCoexist, *pu8); -+ break; -+ -+ case BTC_SET_ACT_UPDATE_RAMASK: -+ pBtCoexist->bt_info.ra_mask = *pU4Tmp; -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ struct sta_info *psta; -+ PWLAN_BSSID_EX cur_network; -+ -+ cur_network = &padapter->mlmeextpriv.mlmext_info.network; -+ psta = rtw_get_stainfo(&padapter->stapriv, cur_network->MacAddress); -+ rtw_hal_update_ra_mask(psta, 0); -+ } -+ break; -+ -+ case BTC_SET_ACT_SEND_MIMO_PS: { -+ u8 newMimoPsMode = 3; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* *pU1Tmp = 0 use SM_PS static type */ -+ /* *pU1Tmp = 1 disable SM_PS */ -+ if (*pU1Tmp == 0) -+ newMimoPsMode = WLAN_HT_CAP_SM_PS_STATIC; -+ else if (*pU1Tmp == 1) -+ newMimoPsMode = WLAN_HT_CAP_SM_PS_DISABLED; -+ -+ if (check_fwstate(&padapter->mlmepriv , WIFI_ASOC_STATE) == _TRUE) { -+ /* issue_action_SM_PS(padapter, get_my_bssid(&(pmlmeinfo->network)), newMimoPsMode); */ -+ issue_action_SM_PS_wait_ack(padapter , get_my_bssid(&(pmlmeinfo->network)) , newMimoPsMode, 3 , 1); -+ } -+ } -+ break; -+ -+ case BTC_SET_ACT_CTRL_BT_INFO: -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ { -+ u8 dataLen = *pU1Tmp; -+ u8 tmpBuf[BTC_TMP_BUF_SHORT]; -+ if (dataLen) -+ _rtw_memcpy(tmpBuf, pU1Tmp + 1, dataLen); -+ BT_SendEventExtBtInfoControl(padapter, dataLen, &tmpBuf[0]); -+ } -+#else /* !CONFIG_BT_COEXIST_SOCKET_TRX */ -+ ret = _FALSE; -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ break; -+ -+ case BTC_SET_ACT_CTRL_BT_COEX: -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ { -+ u8 dataLen = *pU1Tmp; -+ u8 tmpBuf[BTC_TMP_BUF_SHORT]; -+ if (dataLen) -+ _rtw_memcpy(tmpBuf, pU1Tmp + 1, dataLen); -+ BT_SendEventExtBtCoexControl(padapter, _FALSE, dataLen, &tmpBuf[0]); -+ } -+#else /* !CONFIG_BT_COEXIST_SOCKET_TRX */ -+ ret = _FALSE; -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ break; -+ case BTC_SET_ACT_CTRL_8723B_ANT: -+#if 0 -+ { -+ u1Byte dataLen = *pU1Tmp; -+ u1Byte tmpBuf[BTC_TMP_BUF_SHORT]; -+ if (dataLen) -+ PlatformMoveMemory(&tmpBuf[0], pU1Tmp + 1, dataLen); -+ BT_Set8723bAnt(Adapter, dataLen, &tmpBuf[0]); -+ } -+#else -+ ret = _FALSE; -+#endif -+ break; -+ /* ===================== */ -+ default: -+ ret = _FALSE; -+ break; -+ } -+ -+ return ret; -+} -+ -+u8 halbtcoutsrc_UnderIps(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ struct pwrctrl_priv *pwrpriv; -+ u8 bMacPwrCtrlOn; -+ -+ padapter = pBtCoexist->Adapter; -+ pwrpriv = &padapter->dvobj->pwrctl_priv; -+ bMacPwrCtrlOn = _FALSE; -+ -+ if ((_TRUE == pwrpriv->bips_processing) -+ && (IPS_NONE != pwrpriv->ips_mode_req) -+ ) -+ return _TRUE; -+ -+ if (rf_off == pwrpriv->rf_pwrstate) -+ return _TRUE; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if (_FALSE == bMacPwrCtrlOn) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+u8 halbtcoutsrc_UnderLps(PBTC_COEXIST pBtCoexist) -+{ -+ return GLBtcWiFiInLPS; -+} -+ -+u8 halbtcoutsrc_Under32K(PBTC_COEXIST pBtCoexist) -+{ -+ /* todo: the method to check whether wifi is under 32K or not */ -+ return _FALSE; -+} -+ -+u8 halbtcoutsrc_is_autoload_fail(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ -+ padapter = pBtCoexist->Adapter; -+ pHalData = GET_HAL_DATA(padapter); -+ -+ return pHalData->bautoload_fail_flag; -+} -+ -+u8 halbtcoutsrc_is_fw_ready(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter; -+ -+ padapter = pBtCoexist->Adapter; -+ -+ return padapter->bFWReady; -+} -+ -+void halbtcoutsrc_DisplayCoexStatistics(PBTC_COEXIST pBtCoexist) -+{ -+#if 0 -+ PADAPTER padapter = (PADAPTER)pBtCoexist->Adapter; -+ PBT_MGNT pBtMgnt = &padapter->MgntInfo.BtInfo.BtMgnt; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ u8 *cliBuf = pBtCoexist->cliBuf; -+ u1Byte i, j; -+ u1Byte tmpbuf[BTC_TMP_BUF_SHORT]; -+ -+ -+ if (gl_coex_offload.cnt_h2c_sent) { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Coex h2c notify]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = H2c(%d)/Ack(%d)", "Coex h2c/c2h overall statistics", -+ gl_coex_offload.cnt_h2c_sent, gl_coex_offload.cnt_c2h_ack); -+ for (j = 0; j < COL_STATUS_MAX; j++) { -+ if (gl_coex_offload.status[j]) { -+ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, ", %s:%d", coexH2cResultString[j], gl_coex_offload.status[j]); -+ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, BTC_TMP_BUF_SHORT); -+ } -+ } -+ CL_PRINTF(cliBuf); -+ } -+ for (i = 0; i < COL_OP_WIFI_OPCODE_MAX; i++) { -+ if (gl_coex_offload.h2c_record[i].count) { -+ /*==========================================*/ -+ /* H2C result statistics*/ -+ /*==========================================*/ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = total:%d", coexOpcodeString[i], gl_coex_offload.h2c_record[i].count); -+ for (j = 0; j < COL_STATUS_MAX; j++) { -+ if (gl_coex_offload.h2c_record[i].status[j]) { -+ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, ", %s:%d", coexH2cResultString[j], gl_coex_offload.h2c_record[i].status[j]); -+ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, BTC_TMP_BUF_SHORT); -+ } -+ } -+ CL_PRINTF(cliBuf); -+ /*==========================================*/ -+ /* H2C/C2H content*/ -+ /*==========================================*/ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = ", "H2C / C2H content"); -+ for (j = 0; j < gl_coex_offload.h2c_record[i].h2c_len; j++) { -+ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, "%02x ", gl_coex_offload.h2c_record[i].h2c_buf[j]); -+ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, 3); -+ } -+ if (gl_coex_offload.h2c_record[i].c2h_ack_len) { -+ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, "/ ", 2); -+ for (j = 0; j < gl_coex_offload.h2c_record[i].c2h_ack_len; j++) { -+ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, "%02x ", gl_coex_offload.h2c_record[i].c2h_ack_buf[j]); -+ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, 3); -+ } -+ } -+ CL_PRINTF(cliBuf); -+ /*==========================================*/ -+ } -+ } -+ -+ if (gl_coex_offload.cnt_c2h_ind) { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Coex c2h indication]============"); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = Ind(%d)", "C2H indication statistics", -+ gl_coex_offload.cnt_c2h_ind); -+ for (j = 0; j < COL_STATUS_MAX; j++) { -+ if (gl_coex_offload.c2h_ind_status[j]) { -+ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, ", %s:%d", coexH2cResultString[j], gl_coex_offload.c2h_ind_status[j]); -+ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, BTC_TMP_BUF_SHORT); -+ } -+ } -+ CL_PRINTF(cliBuf); -+ } -+ for (i = 0; i < COL_IND_MAX; i++) { -+ if (gl_coex_offload.c2h_ind_record[i].count) { -+ /*==========================================*/ -+ /* H2C result statistics*/ -+ /*==========================================*/ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = total:%d", coexIndTypeString[i], gl_coex_offload.c2h_ind_record[i].count); -+ for (j = 0; j < COL_STATUS_MAX; j++) { -+ if (gl_coex_offload.c2h_ind_record[i].status[j]) { -+ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, ", %s:%d", coexH2cResultString[j], gl_coex_offload.c2h_ind_record[i].status[j]); -+ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, BTC_TMP_BUF_SHORT); -+ } -+ } -+ CL_PRINTF(cliBuf); -+ /*==========================================*/ -+ /* content*/ -+ /*==========================================*/ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = ", "C2H indication content"); -+ for (j = 0; j < gl_coex_offload.c2h_ind_record[i].ind_len; j++) { -+ CL_SPRINTF(tmpbuf, BTC_TMP_BUF_SHORT, "%02x ", gl_coex_offload.c2h_ind_record[i].ind_buf[j]); -+ CL_STRNCAT(cliBuf, BT_TMP_BUF_SIZE, tmpbuf, 3); -+ } -+ CL_PRINTF(cliBuf); -+ /*==========================================*/ -+ } -+ } -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Statistics]============"); -+ CL_PRINTF(cliBuf); -+ -+#if (H2C_USE_IO_THREAD != 1) -+ for (i = 0; i < H2C_STATUS_MAX; i++) { -+ if (pHalData->h2cStatistics[i]) { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s] = %d", "H2C statistics", \ -+ h2cStaString[i], pHalData->h2cStatistics[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+#else -+ for (i = 0; i < IO_STATUS_MAX; i++) { -+ if (Adapter->ioComStr.ioH2cStatistics[i]) { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s] = %d", "H2C statistics", \ -+ ioStaString[i], Adapter->ioComStr.ioH2cStatistics[i]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+#endif -+#if 0 -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "lastHMEBoxNum", \ -+ pHalData->LastHMEBoxNum); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x / 0x%x", "LastOkH2c/FirstFailH2c(fwNotRead)", \ -+ pHalData->lastSuccessH2cEid, pHalData->firstFailedH2cEid); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "c2hIsr/c2hIntr/clr1AF/noRdy/noBuf", \ -+ pHalData->InterruptLog.nIMR_C2HCMD, DBG_Var.c2hInterruptCnt, DBG_Var.c2hClrReadC2hCnt, -+ DBG_Var.c2hNotReadyCnt, DBG_Var.c2hBufAlloFailCnt); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "c2hPacket", \ -+ DBG_Var.c2hPacketCnt); -+ CL_PRINTF(cliBuf); -+#endif -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "Periodical/ DbgCtrl", \ -+ pBtCoexist->statistics.cntPeriodical, pBtCoexist->statistics.cntDbgCtrl); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "PowerOn/InitHw/InitCoexDm/RfStatus", \ -+ pBtCoexist->statistics.cntPowerOn, pBtCoexist->statistics.cntInitHwConfig, pBtCoexist->statistics.cntInitCoexDm, -+ pBtCoexist->statistics.cntRfStatusNotify); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "Ips/Lps/Scan/Connect/Mstatus", \ -+ pBtCoexist->statistics.cntIpsNotify, pBtCoexist->statistics.cntLpsNotify, -+ pBtCoexist->statistics.cntScanNotify, pBtCoexist->statistics.cntConnectNotify, -+ pBtCoexist->statistics.cntMediaStatusNotify); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "Special pkt/Bt info/ bind", -+ pBtCoexist->statistics.cntSpecialPacketNotify, pBtCoexist->statistics.cntBtInfoNotify, -+ pBtCoexist->statistics.cntBind); -+ CL_PRINTF(cliBuf); -+#endif -+ PADAPTER padapter = pBtCoexist->Adapter; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ u8 *cliBuf = pBtCoexist->cli_buf; -+ -+ if (pHalData->EEPROMBluetoothCoexist == 1) { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Coex Status]============"); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", "IsBtDisabled", rtw_btcoex_IsBtDisabled(padapter)); -+ CL_PRINTF(cliBuf); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", "IsBtControlLps", rtw_btcoex_IsBtControlLps(padapter)); -+ CL_PRINTF(cliBuf); -+ } -+} -+ -+void halbtcoutsrc_DisplayBtLinkInfo(PBTC_COEXIST pBtCoexist) -+{ -+#if 0 -+ PADAPTER padapter = (PADAPTER)pBtCoexist->Adapter; -+ PBT_MGNT pBtMgnt = &padapter->MgntInfo.BtInfo.BtMgnt; -+ u8 *cliBuf = pBtCoexist->cliBuf; -+ u8 i; -+ -+ -+ if (pBtCoexist->stack_info.profile_notified) { -+ for (i = 0; i < pBtMgnt->ExtConfig.NumberOfACL; i++) { -+ if (pBtMgnt->ExtConfig.HCIExtensionVer >= 1) { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", "Bt link type/spec/role", \ -+ BtProfileString[pBtMgnt->ExtConfig.aclLink[i].BTProfile], -+ BtSpecString[pBtMgnt->ExtConfig.aclLink[i].BTCoreSpec], -+ BtLinkRoleString[pBtMgnt->ExtConfig.aclLink[i].linkRole]); -+ CL_PRINTF(cliBuf); -+ } else { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", "Bt link type/spec", \ -+ BtProfileString[pBtMgnt->ExtConfig.aclLink[i].BTProfile], -+ BtSpecString[pBtMgnt->ExtConfig.aclLink[i].BTCoreSpec]); -+ CL_PRINTF(cliBuf); -+ } -+ } -+ } -+#endif -+} -+ -+void halbtcoutsrc_DisplayWifiStatus(PBTC_COEXIST pBtCoexist) -+{ -+ PADAPTER padapter = pBtCoexist->Adapter; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 *cliBuf = pBtCoexist->cli_buf; -+ s32 wifiRssi = 0, btHsRssi = 0; -+ BOOLEAN bScan = _FALSE, bLink = _FALSE, bRoam = _FALSE, bWifiBusy = _FALSE, bWifiUnderBMode = _FALSE; -+ u32 wifiBw = BTC_WIFI_BW_HT20, wifiTrafficDir = BTC_WIFI_TRAFFIC_TX, wifiFreq = BTC_FREQ_2_4G; -+ u32 wifiLinkStatus = 0x0; -+ BOOLEAN bBtHsOn = _FALSE, bLowPower = _FALSE; -+ u8 wifiChnl = 0, wifiP2PChnl = 0, nScanAPNum = 0, FwPSState; -+ u32 iqk_cnt_total = 0, iqk_cnt_ok = 0, iqk_cnt_fail = 0; -+ -+ wifiLinkStatus = halbtcoutsrc_GetWifiLinkStatus(pBtCoexist); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "STA/vWifi/HS/p2pGo/p2pGc", \ -+ ((wifiLinkStatus & WIFI_STA_CONNECTED) ? 1 : 0), ((wifiLinkStatus & WIFI_AP_CONNECTED) ? 1 : 0), -+ ((wifiLinkStatus & WIFI_HS_CONNECTED) ? 1 : 0), ((wifiLinkStatus & WIFI_P2P_GO_CONNECTED) ? 1 : 0), -+ ((wifiLinkStatus & WIFI_P2P_GC_CONNECTED) ? 1 : 0)); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", "Link/ Roam/ Scan", \ -+ bLink, bRoam, bScan); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_IQK_TOTAL, &iqk_cnt_total); -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_IQK_OK, &iqk_cnt_ok); -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_IQK_FAIL, &iqk_cnt_fail); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d %s %s", -+ "IQK All/ OK/ Fail/AutoLoad/FWDL", iqk_cnt_total, iqk_cnt_ok, iqk_cnt_fail, -+ ((halbtcoutsrc_is_autoload_fail(pBtCoexist) == _TRUE) ? "fail":"ok"), ((halbtcoutsrc_is_fw_ready(pBtCoexist) == _TRUE) ? "ok":"fail")); -+ CL_PRINTF(cliBuf); -+ -+ if (wifiLinkStatus & WIFI_STA_CONNECTED) { -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "IOT Peer", GLBtcIotPeerString[padapter->mlmeextpriv.mlmext_info.assoc_AP_vendor]); -+ CL_PRINTF(cliBuf); -+ } -+ -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U1_WIFI_DOT11_CHNL, &wifiChnl); -+ if ((wifiLinkStatus & WIFI_P2P_GO_CONNECTED) || (wifiLinkStatus & WIFI_P2P_GC_CONNECTED)) -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U1_WIFI_P2P_CHNL, &wifiP2PChnl); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dBm/ %d/ %d", "RSSI/ STA_Chnl/ P2P_Chnl", \ -+ wifiRssi -100, wifiChnl, wifiP2PChnl); -+ CL_PRINTF(cliBuf); -+ -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifiFreq); -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); -+ pBtCoexist->btc_get(pBtCoexist, BTC_GET_U1_AP_NUM, &nScanAPNum); -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s/ %s/ %d ", "Band/ BW/ Traffic/ APCnt", \ -+ GLBtcWifiFreqString[wifiFreq], ((bWifiUnderBMode) ? "11b" : GLBtcWifiBwString[wifiBw]), -+ ((!bWifiBusy) ? "idle" : ((BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ? "uplink" : "downlink")), -+ nScanAPNum); -+ CL_PRINTF(cliBuf); -+ -+ /* power status */ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s%s%s", "Power Status", \ -+ ((halbtcoutsrc_UnderIps(pBtCoexist) == _TRUE) ? "IPS ON" : "IPS OFF"), -+ ((halbtcoutsrc_UnderLps(pBtCoexist) == _TRUE) ? ", LPS ON" : ", LPS OFF"), -+ ((halbtcoutsrc_Under32K(pBtCoexist) == _TRUE) ? ", 32k" : "")); -+ CL_PRINTF(cliBuf); -+ -+ CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x (0x%x/0x%x)", "Power mode cmd(lps/rpwm)", \ -+ pBtCoexist->pwrModeVal[0], pBtCoexist->pwrModeVal[1], -+ pBtCoexist->pwrModeVal[2], pBtCoexist->pwrModeVal[3], -+ pBtCoexist->pwrModeVal[4], pBtCoexist->pwrModeVal[5], -+ pBtCoexist->bt_info.lps_val, -+ pBtCoexist->bt_info.rpwm_val); -+ CL_PRINTF(cliBuf); -+} -+ -+void halbtcoutsrc_DisplayDbgMsg(void *pBtcContext, u8 dispType) -+{ -+ PBTC_COEXIST pBtCoexist; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ switch (dispType) { -+ case BTC_DBG_DISP_COEX_STATISTICS: -+ halbtcoutsrc_DisplayCoexStatistics(pBtCoexist); -+ break; -+ case BTC_DBG_DISP_BT_LINK_INFO: -+ halbtcoutsrc_DisplayBtLinkInfo(pBtCoexist); -+ break; -+ case BTC_DBG_DISP_WIFI_STATUS: -+ halbtcoutsrc_DisplayWifiStatus(pBtCoexist); -+ break; -+ default: -+ break; -+ } -+} -+ -+/* ************************************ -+ * IO related function -+ * ************************************ */ -+u8 halbtcoutsrc_Read1Byte(void *pBtcContext, u32 RegAddr) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return rtw_read8(padapter, RegAddr); -+} -+ -+u16 halbtcoutsrc_Read2Byte(void *pBtcContext, u32 RegAddr) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return rtw_read16(padapter, RegAddr); -+} -+ -+u32 halbtcoutsrc_Read4Byte(void *pBtcContext, u32 RegAddr) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return rtw_read32(padapter, RegAddr); -+} -+ -+void halbtcoutsrc_Write1Byte(void *pBtcContext, u32 RegAddr, u8 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ rtw_write8(padapter, RegAddr, Data); -+} -+ -+void halbtcoutsrc_BitMaskWrite1Byte(void *pBtcContext, u32 regAddr, u8 bitMask, u8 data1b) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ u8 originalValue, bitShift; -+ u8 i; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ originalValue = 0; -+ bitShift = 0; -+ -+ if (bitMask != 0xff) { -+ originalValue = rtw_read8(padapter, regAddr); -+ -+ for (i = 0; i <= 7; i++) { -+ if ((bitMask >> i) & 0x1) -+ break; -+ } -+ bitShift = i; -+ -+ data1b = (originalValue & ~bitMask) | ((data1b << bitShift) & bitMask); -+ } -+ -+ rtw_write8(padapter, regAddr, data1b); -+} -+ -+void halbtcoutsrc_Write2Byte(void *pBtcContext, u32 RegAddr, u16 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ rtw_write16(padapter, RegAddr, Data); -+} -+ -+void halbtcoutsrc_Write4Byte(void *pBtcContext, u32 RegAddr, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ rtw_write32(padapter, RegAddr, Data); -+} -+ -+void halbtcoutsrc_WriteLocalReg1Byte(void *pBtcContext, u32 RegAddr, u8 Data) -+{ -+ PBTC_COEXIST pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ PADAPTER Adapter = pBtCoexist->Adapter; -+ -+ if (BTC_INTF_SDIO == pBtCoexist->chip_interface) -+ rtw_write8(Adapter, SDIO_LOCAL_BASE | RegAddr, Data); -+ else -+ rtw_write8(Adapter, RegAddr, Data); -+} -+ -+void halbtcoutsrc_SetBbReg(void *pBtcContext, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ PHY_SetBBReg(padapter, RegAddr, BitMask, Data); -+} -+ -+ -+u32 halbtcoutsrc_GetBbReg(void *pBtcContext, u32 RegAddr, u32 BitMask) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return PHY_QueryBBReg(padapter, RegAddr, BitMask); -+} -+ -+void halbtcoutsrc_SetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ PHY_SetRFReg(padapter, eRFPath, RegAddr, BitMask, Data); -+} -+ -+u32 halbtcoutsrc_GetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMask) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ return PHY_QueryRFReg(padapter, eRFPath, RegAddr, BitMask); -+} -+ -+u16 halbtcoutsrc_SetBtReg(void *pBtcContext, u8 RegType, u32 RegAddr, u32 Data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ u16 ret = BT_STATUS_BT_OP_SUCCESS; -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ -+ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { -+ u8 buf[3] = {0}; -+ _irqL irqL; -+ u8 op_code; -+ u8 status; -+ -+ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ Data = cpu_to_le32(Data); -+ op_code = BT_OP_WRITE_REG_VALUE; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, (u8 *)&Data, 3); -+ if (status != BT_STATUS_BT_OP_SUCCESS) -+ ret = SET_BT_MP_OPER_RET(op_code, status); -+ else { -+ buf[0] = RegType; -+ *(u16 *)(buf + 1) = cpu_to_le16((u16)RegAddr); -+ op_code = BT_OP_WRITE_REG_ADDR; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 3); -+ if (status != BT_STATUS_BT_OP_SUCCESS) -+ ret = SET_BT_MP_OPER_RET(op_code, status); -+ } -+ -+ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ } else -+ ret = BT_STATUS_NOT_IMPLEMENT; -+ -+ return ret; -+} -+ -+u8 halbtcoutsrc_SetBtAntDetection(void *pBtcContext, u8 txTime, u8 btChnl) -+{ -+ /* Always return _FALSE since we don't implement this yet */ -+#if 0 -+ PBTC_COEXIST pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ PADAPTER Adapter = pBtCoexist->Adapter; -+ u1Byte btCanTx = 0; -+ BOOLEAN bStatus = FALSE; -+ -+ bStatus = NDBG_SetBtAntDetection(Adapter, txTime, btChnl, &btCanTx); -+ if (bStatus && btCanTx) -+ return _TRUE; -+ else -+ return _FALSE; -+#else -+ return _FALSE; -+#endif -+} -+ -+BOOLEAN -+halbtcoutsrc_SetBtTRXMASK( -+ IN PVOID pBtcContext, -+ IN u1Byte bt_trx_mask -+ ) -+{ -+#if 0 -+ struct btc_coexist *pBtCoexist=(struct btc_coexist *)pBtcContext; -+ PADAPTER Adapter=pBtCoexist->Adapter; -+ BOOLEAN bStatus=FALSE; -+ u1Byte btCanTx=0; -+ -+ if(IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) -+ { -+ bStatus = NDBG_SetBtTRXMASK(Adapter, 1, bt_trx_mask, &btCanTx); -+ } -+ -+ -+ if(bStatus && btCanTx) -+ return TRUE; -+ else -+ return FALSE; -+#else -+ return _FALSE; -+#endif -+} -+ -+u16 halbtcoutsrc_GetBtReg_with_status(void *pBtcContext, u8 RegType, u32 RegAddr, u32 *data) -+{ -+ PBTC_COEXIST pBtCoexist; -+ u16 ret = BT_STATUS_BT_OP_SUCCESS; -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ -+ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { -+ u8 buf[3] = {0}; -+ _irqL irqL; -+ u8 op_code; -+ u8 status; -+ -+ buf[0] = RegType; -+ *(u16 *)(buf + 1) = cpu_to_le16((u16)RegAddr); -+ -+ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ op_code = BT_OP_READ_REG; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 3); -+ if (status == BT_STATUS_BT_OP_SUCCESS) -+ *data = le16_to_cpu(*(u16 *)GLBtcBtMpRptRsp); -+ else -+ ret = SET_BT_MP_OPER_RET(op_code, status); -+ -+ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ } else -+ ret = BT_STATUS_NOT_IMPLEMENT; -+ -+ return ret; -+} -+ -+u32 halbtcoutsrc_GetBtReg(void *pBtcContext, u8 RegType, u32 RegAddr) -+{ -+ u32 regVal; -+ -+ return (BT_STATUS_BT_OP_SUCCESS == halbtcoutsrc_GetBtReg_with_status(pBtcContext, RegType, RegAddr, ®Val)) ? regVal : 0xffffffff; -+} -+ -+void halbtcoutsrc_FillH2cCmd(void *pBtcContext, u8 elementId, u32 cmdLen, u8 *pCmdBuffer) -+{ -+ PBTC_COEXIST pBtCoexist; -+ PADAPTER padapter; -+ -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ padapter = pBtCoexist->Adapter; -+ -+ rtw_hal_fill_h2c_cmd(padapter, elementId, cmdLen, pCmdBuffer); -+} -+ -+static void halbtcoutsrc_coex_offload_init(void) -+{ -+ u1Byte i; -+ -+ gl_coex_offload.h2c_req_num = 0; -+ gl_coex_offload.cnt_h2c_sent = 0; -+ gl_coex_offload.cnt_c2h_ack = 0; -+ gl_coex_offload.cnt_c2h_ind = 0; -+ -+ for (i = 0; i < COL_MAX_H2C_REQ_NUM; i++) -+ init_completion(&gl_coex_offload.c2h_event[i]); -+} -+ -+static COL_H2C_STATUS halbtcoutsrc_send_h2c(PADAPTER Adapter, PCOL_H2C pcol_h2c, u16 h2c_cmd_len) -+{ -+ COL_H2C_STATUS h2c_status = COL_STATUS_C2H_OK; -+ u8 i; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0)) -+ reinit_completion(&gl_coex_offload.c2h_event[pcol_h2c->req_num]); /* set event to un signaled state */ -+#else -+ INIT_COMPLETION(gl_coex_offload.c2h_event[pcol_h2c->req_num]); -+#endif -+ -+ if (TRUE) { -+#if 0 /*(USE_HAL_MAC_API == 1) */ -+ if (RT_STATUS_SUCCESS == HAL_MAC_Send_BT_COEX(&GET_HAL_MAC_INFO(Adapter), (pu1Byte)(pcol_h2c), (u4Byte)h2c_cmd_len, 1)) { -+ if (!wait_for_completion_timeout(&gl_coex_offload.c2h_event[pcol_h2c->req_num], 20)) { -+ h2c_status = COL_STATUS_H2C_TIMTOUT; -+ } -+ } else { -+ h2c_status = COL_STATUS_H2C_HALMAC_FAIL; -+ } -+#endif -+ } -+ -+ return h2c_status; -+} -+ -+static COL_H2C_STATUS halbtcoutsrc_check_c2h_ack(PADAPTER Adapter, PCOL_SINGLE_H2C_RECORD pH2cRecord) -+{ -+ COL_H2C_STATUS c2h_status = COL_STATUS_C2H_OK; -+ PCOL_H2C p_h2c_cmd = (PCOL_H2C)&pH2cRecord->h2c_buf[0]; -+ u8 req_num = p_h2c_cmd->req_num; -+ PCOL_C2H_ACK p_c2h_ack = (PCOL_C2H_ACK)&gl_coex_offload.c2h_ack_buf[req_num]; -+ -+ -+ if ((COL_C2H_ACK_HDR_LEN + p_c2h_ack->ret_len) > gl_coex_offload.c2h_ack_len[req_num]) { -+ c2h_status = COL_STATUS_COEX_DATA_OVERFLOW; -+ return c2h_status; -+ } -+ /* else */ -+ { -+ _rtw_memmove(&pH2cRecord->c2h_ack_buf[0], &gl_coex_offload.c2h_ack_buf[req_num], gl_coex_offload.c2h_ack_len[req_num]); -+ pH2cRecord->c2h_ack_len = gl_coex_offload.c2h_ack_len[req_num]; -+ } -+ -+ -+ if (p_c2h_ack->req_num != p_h2c_cmd->req_num) { -+ c2h_status = COL_STATUS_C2H_REQ_NUM_MISMATCH; -+ } else if (p_c2h_ack->opcode_ver != p_h2c_cmd->opcode_ver) { -+ c2h_status = COL_STATUS_C2H_OPCODE_VER_MISMATCH; -+ } else { -+ c2h_status = p_c2h_ack->status; -+ } -+ -+ return c2h_status; -+} -+ -+COL_H2C_STATUS halbtcoutsrc_CoexH2cProcess(void *pBtCoexist, -+ u8 opcode, u8 opcode_ver, u8 *ph2c_par, u8 h2c_par_len) -+{ -+ PADAPTER Adapter = ((struct btc_coexist *)pBtCoexist)->Adapter; -+ u8 H2C_Parameter[BTC_TMP_BUF_SHORT] = {0}; -+ PCOL_H2C pcol_h2c = (PCOL_H2C)&H2C_Parameter[0]; -+ u16 paraLen = 0; -+ COL_H2C_STATUS h2c_status = COL_STATUS_C2H_OK, c2h_status = COL_STATUS_C2H_OK; -+ COL_H2C_STATUS ret_status = COL_STATUS_C2H_OK; -+ u16 i, col_h2c_len = 0; -+ -+ pcol_h2c->opcode = opcode; -+ pcol_h2c->opcode_ver = opcode_ver; -+ pcol_h2c->req_num = gl_coex_offload.h2c_req_num; -+ gl_coex_offload.h2c_req_num++; -+ gl_coex_offload.h2c_req_num %= 16; -+ -+ _rtw_memmove(&pcol_h2c->buf[0], ph2c_par, h2c_par_len); -+ -+ -+ col_h2c_len = h2c_par_len + 2; /* 2=sizeof(OPCode, OPCode_version and Request number) */ -+ BT_PrintData(Adapter, "[COL], H2C cmd: ", col_h2c_len, H2C_Parameter); -+ -+ gl_coex_offload.cnt_h2c_sent++; -+ -+ gl_coex_offload.h2c_record[opcode].count++; -+ gl_coex_offload.h2c_record[opcode].h2c_len = col_h2c_len; -+ _rtw_memmove((PVOID)&gl_coex_offload.h2c_record[opcode].h2c_buf[0], (PVOID)pcol_h2c, col_h2c_len); -+ -+ h2c_status = halbtcoutsrc_send_h2c(Adapter, pcol_h2c, col_h2c_len); -+ -+ gl_coex_offload.h2c_record[opcode].c2h_ack_len = 0; -+ -+ if (COL_STATUS_C2H_OK == h2c_status) { -+ /* if reach here, it means H2C get the correct c2h response, */ -+ c2h_status = halbtcoutsrc_check_c2h_ack(Adapter, &gl_coex_offload.h2c_record[opcode]); -+ ret_status = c2h_status; -+ } else { -+ /* check h2c status error, return error status code to upper layer. */ -+ ret_status = h2c_status; -+ } -+ gl_coex_offload.h2c_record[opcode].status[ret_status]++; -+ gl_coex_offload.status[ret_status]++; -+ -+ return ret_status; -+} -+ -+u8 halbtcoutsrc_GetAntDetValFromBt(void *pBtcContext) -+{ -+ /* Always return 0 since we don't implement this yet */ -+#if 0 -+ struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; -+ PADAPTER Adapter = pBtCoexist->Adapter; -+ u1Byte AntDetVal = 0x0; -+ u1Byte opcodeVer = 1; -+ BOOLEAN status = false; -+ -+ status = NDBG_GetAntDetValFromBt(Adapter, opcodeVer, &AntDetVal); -+ -+ RT_TRACE(COMP_DBG, DBG_LOUD, ("$$$ halbtcoutsrc_GetAntDetValFromBt(): status = %d, feature = %x\n", status, AntDetVal)); -+ -+ return AntDetVal; -+#else -+ return 0; -+#endif -+} -+ -+u8 halbtcoutsrc_GetBleScanTypeFromBt(void *pBtcContext) -+{ -+ PBTC_COEXIST pBtCoexist; -+ u32 ret = BT_STATUS_BT_OP_SUCCESS; -+ u8 data = 0; -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ -+ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { -+ u8 buf[3] = {0}; -+ _irqL irqL; -+ u8 op_code; -+ u8 status; -+ -+ -+ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ op_code = BT_OP_GET_BT_BLE_SCAN_TYPE; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); -+ if (status == BT_STATUS_BT_OP_SUCCESS) -+ data = *(u8 *)GLBtcBtMpRptRsp; -+ else -+ ret = SET_BT_MP_OPER_RET(op_code, status); -+ -+ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ } else -+ ret = BT_STATUS_NOT_IMPLEMENT; -+ -+ return data; -+} -+ -+u32 halbtcoutsrc_GetBleScanParaFromBt(void *pBtcContext, u8 scanType) -+{ -+ PBTC_COEXIST pBtCoexist; -+ u32 ret = BT_STATUS_BT_OP_SUCCESS; -+ u32 data = 0; -+ -+ pBtCoexist = (PBTC_COEXIST)pBtcContext; -+ -+ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { -+ u8 buf[3] = {0}; -+ _irqL irqL; -+ u8 op_code; -+ u8 status; -+ -+ -+ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ op_code = BT_OP_GET_BT_BLE_SCAN_PARA; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); -+ if (status == BT_STATUS_BT_OP_SUCCESS) -+ data = le32_to_cpu(*(u32 *)GLBtcBtMpRptRsp); -+ else -+ ret = SET_BT_MP_OPER_RET(op_code, status); -+ -+ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ } else -+ ret = BT_STATUS_NOT_IMPLEMENT; -+ -+ return data; -+} -+ -+u8 halbtcoutsrc_GetBtAFHMapFromBt(void *pBtcContext, u8 mapType, u8 *afhMap) -+{ -+ struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; -+ u8 buf[2] = {0}; -+ _irqL irqL; -+ u8 op_code; -+ u32 *AfhMapL = (u32 *)&(afhMap[0]); -+ u32 *AfhMapM = (u32 *)&(afhMap[4]); -+ u16 *AfhMapH = (u16 *)&(afhMap[8]); -+ u8 status; -+ u32 ret = BT_STATUS_BT_OP_SUCCESS; -+ -+ if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _FALSE) -+ return _FALSE; -+ -+ buf[0] = 0; -+ buf[1] = mapType; -+ -+ _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ op_code = BT_LO_OP_GET_AFH_MAP_L; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); -+ if (status == BT_STATUS_BT_OP_SUCCESS) -+ *AfhMapL = le32_to_cpu(*(u32 *)GLBtcBtMpRptRsp); -+ else { -+ ret = SET_BT_MP_OPER_RET(op_code, status); -+ goto exit; -+ } -+ -+ op_code = BT_LO_OP_GET_AFH_MAP_M; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); -+ if (status == BT_STATUS_BT_OP_SUCCESS) -+ *AfhMapM = le32_to_cpu(*(u32 *)GLBtcBtMpRptRsp); -+ else { -+ ret = SET_BT_MP_OPER_RET(op_code, status); -+ goto exit; -+ } -+ -+ op_code = BT_LO_OP_GET_AFH_MAP_H; -+ status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); -+ if (status == BT_STATUS_BT_OP_SUCCESS) -+ *AfhMapH = le16_to_cpu(*(u16 *)GLBtcBtMpRptRsp); -+ else { -+ ret = SET_BT_MP_OPER_RET(op_code, status); -+ goto exit; -+ } -+ -+exit: -+ -+ _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); -+ -+ return (ret == BT_STATUS_BT_OP_SUCCESS) ? _TRUE : _FALSE; -+} -+ -+u32 halbtcoutsrc_GetPhydmVersion(void *pBtcContext) -+{ -+ struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; -+ PADAPTER Adapter = pBtCoexist->Adapter; -+ -+#ifdef CONFIG_RTL8192E -+ return RELEASE_VERSION_8192E; -+#endif -+ -+#ifdef CONFIG_RTL8821A -+ return RELEASE_VERSION_8821A; -+#endif -+ -+#ifdef CONFIG_RTL8723B -+ return RELEASE_VERSION_8723B; -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ return RELEASE_VERSION_8812A; -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ return RELEASE_VERSION_8703B; -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ return RELEASE_VERSION_8822B; -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ return RELEASE_VERSION_8723D; -+#endif -+ -+} -+ -+void halbtcoutsrc_phydm_modify_RA_PCR_threshold(void *pBtcContext, u8 RA_offset_direction, u8 RA_threshold_offset) -+{ -+ struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; -+ -+/* switch to #if 0 in case the phydm version does not provide the function */ -+#if 1 -+ phydm_modify_RA_PCR_threshold(pBtCoexist->odm_priv, RA_offset_direction, RA_threshold_offset); -+#endif -+} -+ -+u32 halbtcoutsrc_phydm_query_PHY_counter(void *pBtcContext, u8 info_type) -+{ -+ struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; -+ -+/* switch to #if 0 in case the phydm version does not provide the function */ -+#if 1 -+ return PHYDM_CmnInfoQuery((PDM_ODM_T)pBtCoexist->odm_priv, (PHYDM_INFO_QUERY_E)info_type); -+#else -+ return 0; -+#endif -+} -+ -+#if 0 -+static void BT_CoexOffloadRecordErrC2hAck(PADAPTER Adapter) -+{ -+ PADAPTER pDefaultAdapter = GetDefaultAdapter(Adapter); -+ -+ if (pDefaultAdapter != Adapter) -+ return; -+ -+ if (!hal_btcoex_IsBtExist(Adapter)) -+ return; -+ -+ gl_coex_offload.cnt_c2h_ack++; -+ -+ gl_coex_offload.status[COL_STATUS_INVALID_C2H_LEN]++; -+} -+ -+static void BT_CoexOffloadC2hAckCheck(PADAPTER Adapter, u8 *tmpBuf, u8 length) -+{ -+ PADAPTER pDefaultAdapter = GetDefaultAdapter(Adapter); -+ PCOL_C2H_ACK p_c2h_ack = NULL; -+ u8 req_num = 0xff; -+ -+ if (pDefaultAdapter != Adapter) -+ return; -+ -+ if (!hal_btcoex_IsBtExist(Adapter)) -+ return; -+ -+ gl_coex_offload.cnt_c2h_ack++; -+ -+ if (length < COL_C2H_ACK_HDR_LEN) { /* c2h ack length must >= 3 (status, opcode_ver, req_num and ret_len) */ -+ gl_coex_offload.status[COL_STATUS_INVALID_C2H_LEN]++; -+ } else { -+ BT_PrintData(Adapter, "[COL], c2h ack:", length, tmpBuf); -+ -+ p_c2h_ack = (PCOL_C2H_ACK)tmpBuf; -+ req_num = p_c2h_ack->req_num; -+ -+ _rtw_memmove(&gl_coex_offload.c2h_ack_buf[req_num][0], tmpBuf, length); -+ gl_coex_offload.c2h_ack_len[req_num] = length; -+ -+ complete(&gl_coex_offload.c2h_event[req_num]); -+ } -+} -+ -+static void BT_CoexOffloadC2hIndCheck(PADAPTER Adapter, u8 *tmpBuf, u8 length) -+{ -+ PADAPTER pDefaultAdapter = GetDefaultAdapter(Adapter); -+ PCOL_C2H_IND p_c2h_ind = NULL; -+ u8 ind_type = 0, ind_version = 0, ind_length = 0; -+ -+ if (pDefaultAdapter != Adapter) -+ return; -+ -+ if (!hal_btcoex_IsBtExist(Adapter)) -+ return; -+ -+ gl_coex_offload.cnt_c2h_ind++; -+ -+ if (length < COL_C2H_IND_HDR_LEN) { /* c2h indication length must >= 3 (type, version and length) */ -+ gl_coex_offload.c2h_ind_status[COL_STATUS_INVALID_C2H_LEN]++; -+ } else { -+ BT_PrintData(Adapter, "[COL], c2h indication:", length, tmpBuf); -+ -+ p_c2h_ind = (PCOL_C2H_IND)tmpBuf; -+ ind_type = p_c2h_ind->type; -+ ind_version = p_c2h_ind->version; -+ ind_length = p_c2h_ind->length; -+ -+ _rtw_memmove(&gl_coex_offload.c2h_ind_buf[0], tmpBuf, length); -+ gl_coex_offload.c2h_ind_len = length; -+ -+ /* log */ -+ gl_coex_offload.c2h_ind_record[ind_type].count++; -+ gl_coex_offload.c2h_ind_record[ind_type].status[COL_STATUS_C2H_OK]++; -+ _rtw_memmove(&gl_coex_offload.c2h_ind_record[ind_type].ind_buf[0], tmpBuf, length); -+ gl_coex_offload.c2h_ind_record[ind_type].ind_len = length; -+ -+ gl_coex_offload.c2h_ind_status[COL_STATUS_C2H_OK]++; -+ /*TODO: need to check c2h indication length*/ -+ /* TODO: Notification */ -+ } -+} -+ -+void BT_CoexOffloadC2hCheck(PADAPTER Adapter, u8 *Buffer, u8 Length) -+{ -+#if 0 /*(USE_HAL_MAC_API == 1)*/ -+ u8 c2hSubCmdId = 0, c2hAckLen = 0, h2cCmdId = 0, h2cSubCmdId = 0, c2hIndLen = 0; -+ -+ BT_PrintData(Adapter, "[COL], c2h packet:", Length - 2, Buffer + 2); -+ c2hSubCmdId = (u1Byte)C2H_HDR_GET_C2H_SUB_CMD_ID(Buffer); -+ -+ if (c2hSubCmdId == C2H_SUB_CMD_ID_H2C_ACK_HDR || -+ c2hSubCmdId == C2H_SUB_CMD_ID_BT_COEX_INFO) { -+ if (c2hSubCmdId == C2H_SUB_CMD_ID_H2C_ACK_HDR) { -+ /* coex c2h ack */ -+ h2cCmdId = (u1Byte)H2C_ACK_HDR_GET_H2C_CMD_ID(Buffer); -+ h2cSubCmdId = (u1Byte)H2C_ACK_HDR_GET_H2C_SUB_CMD_ID(Buffer); -+ if (h2cCmdId == 0xff && h2cSubCmdId == 0x60) { -+ c2hAckLen = (u1Byte)C2H_HDR_GET_LEN(Buffer); -+ if (c2hAckLen >= 8) -+ BT_CoexOffloadC2hAckCheck(Adapter, &Buffer[12], (u1Byte)(c2hAckLen - 8)); -+ else -+ BT_CoexOffloadRecordErrC2hAck(Adapter); -+ } -+ } else if (c2hSubCmdId == C2H_SUB_CMD_ID_BT_COEX_INFO) { -+ /* coex c2h indication */ -+ c2hIndLen = (u1Byte)C2H_HDR_GET_LEN(Buffer); -+ BT_CoexOffloadC2hIndCheck(Adapter, &Buffer[4], (u1Byte)c2hIndLen); -+ } -+ } -+#endif -+} -+#endif -+ -+/* ************************************ -+ * Extern functions called by other module -+ * ************************************ */ -+u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ u8 antNum = 1, chipType = 0, singleAntPath = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA((PADAPTER)padapter); -+ -+ if (pBtCoexist->bBinded) -+ return _FALSE; -+ else -+ pBtCoexist->bBinded = _TRUE; -+ -+ pBtCoexist->statistics.cnt_bind++; -+ -+ pBtCoexist->Adapter = padapter; -+ pBtCoexist->odm_priv = (PVOID)&(pHalData->odmpriv); -+ -+ pBtCoexist->stack_info.profile_notified = _FALSE; -+ -+ pBtCoexist->bt_info.bt_ctrl_agg_buf_size = _FALSE; -+ pBtCoexist->bt_info.agg_buf_size = 5; -+ -+ pBtCoexist->bt_info.increase_scan_dev_num = _FALSE; -+ pBtCoexist->bt_info.miracast_plus_bt = _FALSE; -+ -+ antNum = rtw_btcoex_get_pg_ant_num((PADAPTER)padapter); -+ EXhalbtcoutsrc_SetAntNum(BT_COEX_ANT_TYPE_PG, antNum); -+ -+ if (antNum == 1) { -+ singleAntPath = rtw_btcoex_get_pg_single_ant_path((PADAPTER)padapter); -+ EXhalbtcoutsrc_SetSingleAntPath(singleAntPath); -+ } -+ /* set default antenna position to main port */ -+ pBtCoexist->board_info.btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+ -+ pBtCoexist->board_info.btdm_ant_det_finish = _FALSE; -+ pBtCoexist->board_info.btdm_ant_num_by_ant_det = 1; -+ -+ pBtCoexist->board_info.tfbga_package = rtw_btcoex_is_tfbga_package_type((PADAPTER)padapter); -+ -+ pBtCoexist->board_info.ant_div_cfg = rtw_btcoex_get_ant_div_cfg((PADAPTER)padapter); -+ -+ return _TRUE; -+} -+ -+u8 EXhalbtcoutsrc_InitlizeVariables(void *padapter) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ -+ /* pBtCoexist->statistics.cntBind++; */ -+ -+ halbtcoutsrc_DbgInit(); -+ -+ halbtcoutsrc_coex_offload_init(); -+ -+#ifdef CONFIG_PCI_HCI -+ pBtCoexist->chip_interface = BTC_INTF_PCI; -+#elif defined(CONFIG_USB_HCI) -+ pBtCoexist->chip_interface = BTC_INTF_USB; -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ pBtCoexist->chip_interface = BTC_INTF_SDIO; -+#else -+ pBtCoexist->chip_interface = BTC_INTF_UNKNOWN; -+#endif -+ -+ EXhalbtcoutsrc_BindBtCoexWithAdapter(padapter); -+ -+ pBtCoexist->btc_read_1byte = halbtcoutsrc_Read1Byte; -+ pBtCoexist->btc_write_1byte = halbtcoutsrc_Write1Byte; -+ pBtCoexist->btc_write_1byte_bitmask = halbtcoutsrc_BitMaskWrite1Byte; -+ pBtCoexist->btc_read_2byte = halbtcoutsrc_Read2Byte; -+ pBtCoexist->btc_write_2byte = halbtcoutsrc_Write2Byte; -+ pBtCoexist->btc_read_4byte = halbtcoutsrc_Read4Byte; -+ pBtCoexist->btc_write_4byte = halbtcoutsrc_Write4Byte; -+ pBtCoexist->btc_write_local_reg_1byte = halbtcoutsrc_WriteLocalReg1Byte; -+ -+ pBtCoexist->btc_set_bb_reg = halbtcoutsrc_SetBbReg; -+ pBtCoexist->btc_get_bb_reg = halbtcoutsrc_GetBbReg; -+ -+ pBtCoexist->btc_set_rf_reg = halbtcoutsrc_SetRfReg; -+ pBtCoexist->btc_get_rf_reg = halbtcoutsrc_GetRfReg; -+ -+ pBtCoexist->btc_fill_h2c = halbtcoutsrc_FillH2cCmd; -+ pBtCoexist->btc_disp_dbg_msg = halbtcoutsrc_DisplayDbgMsg; -+ -+ pBtCoexist->btc_get = halbtcoutsrc_Get; -+ pBtCoexist->btc_set = halbtcoutsrc_Set; -+ pBtCoexist->btc_get_bt_reg = halbtcoutsrc_GetBtReg; -+ pBtCoexist->btc_set_bt_reg = halbtcoutsrc_SetBtReg; -+ pBtCoexist->btc_set_bt_ant_detection = halbtcoutsrc_SetBtAntDetection; -+ pBtCoexist->btc_set_bt_trx_mask = halbtcoutsrc_SetBtTRXMASK; -+ pBtCoexist->btc_coex_h2c_process = halbtcoutsrc_CoexH2cProcess; -+ pBtCoexist->btc_get_bt_coex_supported_feature = halbtcoutsrc_GetBtCoexSupportedFeature; -+ pBtCoexist->btc_get_bt_coex_supported_version= halbtcoutsrc_GetBtCoexSupportedVersion; -+ pBtCoexist->btc_get_ant_det_val_from_bt = halbtcoutsrc_GetAntDetValFromBt; -+ pBtCoexist->btc_get_ble_scan_type_from_bt = halbtcoutsrc_GetBleScanTypeFromBt; -+ pBtCoexist->btc_get_ble_scan_para_from_bt = halbtcoutsrc_GetBleScanParaFromBt; -+ pBtCoexist->btc_get_bt_afh_map_from_bt = halbtcoutsrc_GetBtAFHMapFromBt; -+ pBtCoexist->btc_get_bt_phydm_version = halbtcoutsrc_GetPhydmVersion; -+ pBtCoexist->btc_phydm_modify_RA_PCR_threshold = halbtcoutsrc_phydm_modify_RA_PCR_threshold; -+ pBtCoexist->btc_phydm_query_PHY_counter = halbtcoutsrc_phydm_query_PHY_counter; -+ -+ pBtCoexist->cli_buf = &GLBtcDbgBuf[0]; -+ -+ GLBtcWiFiInScanState = _FALSE; -+ -+ GLBtcWiFiInIQKState = _FALSE; -+ -+ GLBtcWiFiInIPS = _FALSE; -+ -+ GLBtcWiFiInLPS = _FALSE; -+ -+ GLBtcBtCoexAliveRegistered = _FALSE; -+ -+ /* BT Control H2C/C2H*/ -+ GLBtcBtMpOperSeq = 0; -+ _rtw_mutex_init(&GLBtcBtMpOperLock); -+ _init_timer(&GLBtcBtMpOperTimer, ((PADAPTER)padapter)->pnetdev, _btmpoper_timer_hdl, pBtCoexist); -+ _rtw_init_sema(&GLBtcBtMpRptSema, 0); -+ GLBtcBtMpRptSeq = 0; -+ GLBtcBtMpRptStatus = 0; -+ _rtw_memset(GLBtcBtMpRptRsp, 0, C2H_MAX_SIZE); -+ GLBtcBtMpRptRspSize = 0; -+ GLBtcBtMpRptWait = 0; -+ GLBtcBtMpRptWiFiOK = 0; -+ GLBtcBtMpRptBTOK = 0; -+ -+ return _TRUE; -+} -+ -+void EXhalbtcoutsrc_PowerOnSetting(PBTC_COEXIST pBtCoexist) -+{ -+ HAL_DATA_TYPE *pHalData = NULL; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pHalData = GET_HAL_DATA((PADAPTER)pBtCoexist->Adapter); -+ -+ /* Power on setting function is only added in 8723B currently */ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_power_on_setting(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_power_on_setting(pBtCoexist); -+ } -+ -+ if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_power_on_setting(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_power_on_setting(pBtCoexist); -+ } -+ -+ if ((IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) && (pHalData->EEPROMBluetoothCoexist == _TRUE)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_power_on_setting(pBtCoexist); -+ } -+ -+ if ((IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) && (pHalData->EEPROMBluetoothCoexist == _TRUE)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_power_on_setting(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_power_on_setting(pBtCoexist); -+ } -+} -+ -+void EXhalbtcoutsrc_PreLoadFirmware(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cnt_pre_load_firmware++; -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_pre_load_firmware(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_pre_load_firmware(pBtCoexist); -+ } -+ -+ if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_pre_load_firmware(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_pre_load_firmware(pBtCoexist); -+ } -+ -+ if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_pre_load_firmware(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_pre_load_firmware(pBtCoexist); -+ } -+} -+ -+void EXhalbtcoutsrc_init_hw_config(PBTC_COEXIST pBtCoexist, u8 bWifiOnly) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cnt_init_hw_config++; -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_init_hw_config(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_init_hw_config(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_init_hw_config(pBtCoexist, bWifiOnly); -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_init_hw_config(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_init_hw_config(pBtCoexist, bWifiOnly); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_init_hw_config(pBtCoexist, bWifiOnly); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_init_hw_config(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_init_hw_config(pBtCoexist, bWifiOnly); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8192e2ant_init_hw_config(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_init_hw_config(pBtCoexist, bWifiOnly); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_init_hw_config(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_init_hw_config(pBtCoexist, bWifiOnly); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_init_hw_config(pBtCoexist, bWifiOnly); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_init_hw_config(pBtCoexist, bWifiOnly); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_init_hw_config(pBtCoexist, bWifiOnly); -+ } -+} -+ -+void EXhalbtcoutsrc_init_coex_dm(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cnt_init_coex_dm++; -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_init_coex_dm(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_init_coex_dm(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_init_coex_dm(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_init_coex_dm(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_init_coex_dm(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_init_coex_dm(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_init_coex_dm(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_init_coex_dm(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8192e2ant_init_coex_dm(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_init_coex_dm(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_init_coex_dm(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_init_coex_dm(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_init_coex_dm(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_init_coex_dm(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_init_coex_dm(pBtCoexist); -+ } -+ -+ pBtCoexist->initilized = _TRUE; -+} -+ -+void EXhalbtcoutsrc_ips_notify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ u8 ipsType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cnt_ips_notify++; -+ if (pBtCoexist->manual_control) -+ return; -+ -+ if (IPS_NONE == type) { -+ ipsType = BTC_IPS_LEAVE; -+ GLBtcWiFiInIPS = _FALSE; -+ } else { -+ ipsType = BTC_IPS_ENTER; -+ GLBtcWiFiInIPS = _TRUE; -+ } -+ -+ /* All notify is called in cmd thread, don't need to leave low power again -+ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_ips_notify(pBtCoexist, ipsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_ips_notify(pBtCoexist, ipsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_ips_notify(pBtCoexist, ipsType); -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_ips_notify(pBtCoexist, ipsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_ips_notify(pBtCoexist, ipsType); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_ips_notify(pBtCoexist, ipsType); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_ips_notify(pBtCoexist, ipsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_ips_notify(pBtCoexist, ipsType); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8192e2ant_ips_notify(pBtCoexist, ipsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_ips_notify(pBtCoexist, ipsType); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_ips_notify(pBtCoexist, ipsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_ips_notify(pBtCoexist, ipsType); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_ips_notify(pBtCoexist, ipsType); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_ips_notify(pBtCoexist, ipsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_ips_notify(pBtCoexist, ipsType); -+ } -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_lps_notify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ u8 lpsType; -+ -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cnt_lps_notify++; -+ if (pBtCoexist->manual_control) -+ return; -+ -+ if (PS_MODE_ACTIVE == type) { -+ lpsType = BTC_LPS_DISABLE; -+ GLBtcWiFiInLPS = _FALSE; -+ } else { -+ lpsType = BTC_LPS_ENABLE; -+ GLBtcWiFiInLPS = _TRUE; -+ } -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_lps_notify(pBtCoexist, lpsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_lps_notify(pBtCoexist, lpsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_lps_notify(pBtCoexist, lpsType); -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_lps_notify(pBtCoexist, lpsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_lps_notify(pBtCoexist, lpsType); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_lps_notify(pBtCoexist, lpsType); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_lps_notify(pBtCoexist, lpsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_lps_notify(pBtCoexist, lpsType); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8192e2ant_lps_notify(pBtCoexist, lpsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_lps_notify(pBtCoexist, lpsType); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_lps_notify(pBtCoexist, lpsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_lps_notify(pBtCoexist, lpsType); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_lps_notify(pBtCoexist, lpsType); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_lps_notify(pBtCoexist, lpsType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_lps_notify(pBtCoexist, lpsType); -+ } -+} -+ -+void EXhalbtcoutsrc_scan_notify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+ u8 scanType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cnt_scan_notify++; -+ if (pBtCoexist->manual_control) -+ return; -+ -+ if (type) { -+ scanType = BTC_SCAN_START; -+ GLBtcWiFiInScanState = _TRUE; -+ } else { -+ scanType = BTC_SCAN_FINISH; -+ GLBtcWiFiInScanState = _FALSE; -+ } -+ -+ /* All notify is called in cmd thread, don't need to leave low power again -+ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_scan_notify(pBtCoexist, scanType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_scan_notify(pBtCoexist, scanType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_scan_notify(pBtCoexist, scanType); -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_scan_notify(pBtCoexist, scanType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_scan_notify(pBtCoexist, scanType); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_scan_notify(pBtCoexist, scanType); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_scan_notify(pBtCoexist, scanType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_scan_notify(pBtCoexist, scanType); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8192e2ant_scan_notify(pBtCoexist, scanType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_scan_notify(pBtCoexist, scanType); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_scan_notify(pBtCoexist, scanType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_scan_notify(pBtCoexist, scanType); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_scan_notify(pBtCoexist, scanType); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_scan_notify(pBtCoexist, scanType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_scan_notify(pBtCoexist, scanType); -+ } -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_SetAntennaPathNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+#if 0 -+ u8 switchType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ if (pBtCoexist->manual_control) -+ return; -+ -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ switchType = type; -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_set_antenna_notify(pBtCoexist, type); -+ } -+ if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_set_antenna_notify(pBtCoexist, type); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_set_antenna_notify(pBtCoexist, type); -+ } -+ -+ halbtcoutsrc_NormalLowPower(pBtCoexist); -+#endif -+} -+ -+void EXhalbtcoutsrc_connect_notify(PBTC_COEXIST pBtCoexist, u8 action) -+{ -+ u8 assoType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cnt_connect_notify++; -+ if (pBtCoexist->manual_control) -+ return; -+ -+ if (action) -+ assoType = BTC_ASSOCIATE_START; -+ else -+ assoType = BTC_ASSOCIATE_FINISH; -+ -+ /* All notify is called in cmd thread, don't need to leave low power again -+ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_connect_notify(pBtCoexist, assoType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_connect_notify(pBtCoexist, assoType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_connect_notify(pBtCoexist, assoType); -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_connect_notify(pBtCoexist, assoType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_connect_notify(pBtCoexist, assoType); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_connect_notify(pBtCoexist, assoType); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_connect_notify(pBtCoexist, assoType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_connect_notify(pBtCoexist, assoType); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8192e2ant_connect_notify(pBtCoexist, assoType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_connect_notify(pBtCoexist, assoType); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_connect_notify(pBtCoexist, assoType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_connect_notify(pBtCoexist, assoType); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_connect_notify(pBtCoexist, assoType); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_connect_notify(pBtCoexist, assoType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_connect_notify(pBtCoexist, assoType); -+ } -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_media_status_notify(PBTC_COEXIST pBtCoexist, RT_MEDIA_STATUS mediaStatus) -+{ -+ u8 mStatus; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cnt_media_status_notify++; -+ if (pBtCoexist->manual_control) -+ return; -+ -+ if (RT_MEDIA_CONNECT == mediaStatus) -+ mStatus = BTC_MEDIA_CONNECT; -+ else -+ mStatus = BTC_MEDIA_DISCONNECT; -+ -+ /* All notify is called in cmd thread, don't need to leave low power again -+ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_media_status_notify(pBtCoexist, mStatus); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_media_status_notify(pBtCoexist, mStatus); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_media_status_notify(pBtCoexist, mStatus); -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_media_status_notify(pBtCoexist, mStatus); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_media_status_notify(pBtCoexist, mStatus); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_media_status_notify(pBtCoexist, mStatus); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_media_status_notify(pBtCoexist, mStatus); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_media_status_notify(pBtCoexist, mStatus); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8192e2ant_media_status_notify(pBtCoexist, mStatus); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_media_status_notify(pBtCoexist, mStatus); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_media_status_notify(pBtCoexist, mStatus); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_media_status_notify(pBtCoexist, mStatus); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_media_status_notify(pBtCoexist, mStatus); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_media_status_notify(pBtCoexist, mStatus); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_media_status_notify(pBtCoexist, mStatus); -+ } -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_specific_packet_notify(PBTC_COEXIST pBtCoexist, u8 pktType) -+{ -+ u8 packetType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cnt_specific_packet_notify++; -+ if (pBtCoexist->manual_control) -+ return; -+ -+ if (PACKET_DHCP == pktType) -+ packetType = BTC_PACKET_DHCP; -+ else if (PACKET_EAPOL == pktType) -+ packetType = BTC_PACKET_EAPOL; -+ else if (PACKET_ARP == pktType) -+ packetType = BTC_PACKET_ARP; -+ else { -+ packetType = BTC_PACKET_UNKNOWN; -+ return; -+ } -+ -+ /* All notify is called in cmd thread, don't need to leave low power again -+ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_specific_packet_notify(pBtCoexist, packetType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_specific_packet_notify(pBtCoexist, packetType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_specific_packet_notify(pBtCoexist, packetType); -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_specific_packet_notify(pBtCoexist, packetType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_specific_packet_notify(pBtCoexist, packetType); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_specific_packet_notify(pBtCoexist, packetType); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_specific_packet_notify(pBtCoexist, packetType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_specific_packet_notify(pBtCoexist, packetType); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8192e2ant_specific_packet_notify(pBtCoexist, packetType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_specific_packet_notify(pBtCoexist, packetType); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_specific_packet_notify(pBtCoexist, packetType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_specific_packet_notify(pBtCoexist, packetType); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_specific_packet_notify(pBtCoexist, packetType); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_specific_packet_notify(pBtCoexist, packetType); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_specific_packet_notify(pBtCoexist, packetType); -+ } -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_bt_info_notify(PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 length) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cnt_bt_info_notify++; -+ -+ /* All notify is called in cmd thread, don't need to leave low power again -+ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8192e2ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_bt_info_notify(pBtCoexist, tmpBuf, length); -+ } -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+VOID -+EXhalbtcoutsrc_RfStatusNotify( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u1Byte type -+) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cnt_rf_status_notify++; -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_rf_status_notify(pBtCoexist, type); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_rf_status_notify(pBtCoexist, type); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_rf_status_notify(pBtCoexist, type); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_rf_status_notify(pBtCoexist, type); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_rf_status_notify(pBtCoexist, type); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_rf_status_notify(pBtCoexist, type); -+ } -+} -+ -+void EXhalbtcoutsrc_StackOperationNotify(PBTC_COEXIST pBtCoexist, u8 type) -+{ -+#if 0 -+ u8 stackOpType; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cntStackOperationNotify++; -+ if (pBtCoexist->manual_control) -+ return; -+ -+ if ((HCI_BT_OP_INQUIRY_START == type) || -+ (HCI_BT_OP_PAGING_START == type) || -+ (HCI_BT_OP_PAIRING_START == type)) -+ stackOpType = BTC_STACK_OP_INQ_PAGE_PAIR_START; -+ else if ((HCI_BT_OP_INQUIRY_FINISH == type) || -+ (HCI_BT_OP_PAGING_SUCCESS == type) || -+ (HCI_BT_OP_PAGING_UNSUCCESS == type) || -+ (HCI_BT_OP_PAIRING_FINISH == type)) -+ stackOpType = BTC_STACK_OP_INQ_PAGE_PAIR_FINISH; -+ else -+ stackOpType = BTC_STACK_OP_NONE; -+ -+#endif -+} -+ -+void EXhalbtcoutsrc_halt_notify(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_halt_notify(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_halt_notify(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_halt_notify(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_halt_notify(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_halt_notify(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_halt_notify(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_halt_notify(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_halt_notify(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8192e2ant_halt_notify(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_halt_notify(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_halt_notify(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_halt_notify(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_halt_notify(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_halt_notify(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_halt_notify(pBtCoexist); -+ } -+} -+ -+void EXhalbtcoutsrc_SwitchBtTRxMask(PBTC_COEXIST pBtCoexist) -+{ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) { -+ halbtcoutsrc_SetBtReg(pBtCoexist, 0, 0x3c, 0x01); /* BT goto standby while GNT_BT 1-->0 */ -+ } else if (pBtCoexist->board_info.btdm_ant_num == 1) { -+ halbtcoutsrc_SetBtReg(pBtCoexist, 0, 0x3c, 0x15); /* BT goto standby while GNT_BT 1-->0 */ -+ } -+ } -+} -+ -+void EXhalbtcoutsrc_pnp_notify(PBTC_COEXIST pBtCoexist, u8 pnpState) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ /* */ -+ /* currently only 1ant we have to do the notification, */ -+ /* once pnp is notified to sleep state, we have to leave LPS that we can sleep normally. */ -+ /* */ -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_pnp_notify(pBtCoexist, pnpState); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_pnp_notify(pBtCoexist, pnpState); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_pnp_notify(pBtCoexist, pnpState); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_pnp_notify(pBtCoexist, pnpState); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_pnp_notify(pBtCoexist, pnpState); -+ } else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_pnp_notify(pBtCoexist, pnpState); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_pnp_notify(pBtCoexist, pnpState); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_pnp_notify(pBtCoexist, pnpState); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_pnp_notify(pBtCoexist, pnpState); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_pnp_notify(pBtCoexist, pnpState); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_pnp_notify(pBtCoexist, pnpState); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_pnp_notify(pBtCoexist, pnpState); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_pnp_notify(pBtCoexist, pnpState); -+ } -+} -+ -+void EXhalbtcoutsrc_CoexDmSwitch(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cnt_coex_dm_switch++; -+ -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) { -+ pBtCoexist->stop_coex_dm = TRUE; -+ ex_halbtc8723b1ant_coex_dm_reset(pBtCoexist); -+ EXhalbtcoutsrc_SetAntNum(BT_COEX_ANT_TYPE_DETECTED, 2); -+ ex_halbtc8723b2ant_init_hw_config(pBtCoexist, FALSE); -+ ex_halbtc8723b2ant_init_coex_dm(pBtCoexist); -+ pBtCoexist->stop_coex_dm = FALSE; -+ } -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) { -+ pBtCoexist->stop_coex_dm = TRUE; -+ ex_halbtc8723d1ant_coex_dm_reset(pBtCoexist); -+ EXhalbtcoutsrc_SetAntNum(BT_COEX_ANT_TYPE_DETECTED, 2); -+ ex_halbtc8723d2ant_init_hw_config(pBtCoexist, FALSE); -+ ex_halbtc8723d2ant_init_coex_dm(pBtCoexist); -+ pBtCoexist->stop_coex_dm = FALSE; -+ } -+ } -+ -+ halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_periodical(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ pBtCoexist->statistics.cnt_periodical++; -+ -+ /* Periodical should be called in cmd thread, */ -+ /* don't need to leave low power again -+ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_periodical(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_periodical(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) { -+ if (!halbtcoutsrc_UnderIps(pBtCoexist)) -+ ex_halbtc8821a1ant_periodical(pBtCoexist); -+ } -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_periodical(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_periodical(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_periodical(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_periodical(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_periodical(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8192e2ant_periodical(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_periodical(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_periodical(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_periodical(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_periodical(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_periodical(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_periodical(pBtCoexist); -+ } -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+void EXhalbtcoutsrc_dbg_control(PBTC_COEXIST pBtCoexist, u8 opCode, u8 opLen, u8 *pData) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->statistics.cnt_dbg_ctrl++; -+ -+ /* This function doesn't be called yet, */ -+ /* default no need to leave low power to avoid deadlock -+ * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ -+ -+ if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_dbg_control(pBtCoexist, opCode, opLen, pData); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_dbg_control(pBtCoexist, opCode, opLen, pData); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_dbg_control(pBtCoexist, opCode, opLen, pData); -+ } else if(IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) -+ if(pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_dbg_control(pBtCoexist, opCode, opLen, pData); -+ -+ /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ -+} -+ -+#if 0 -+VOID -+EXhalbtcoutsrc_AntennaDetection( -+ IN PBTC_COEXIST pBtCoexist, -+ IN u4Byte centFreq, -+ IN u4Byte offset, -+ IN u4Byte span, -+ IN u4Byte seconds -+) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ /* Need to refine the following power save operations to enable this function in the future */ -+#if 0 -+ IPSDisable(pBtCoexist->Adapter, FALSE, 0); -+ LeisurePSLeave(pBtCoexist->Adapter, LPS_DISABLE_BT_COEX); -+#endif -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_AntennaDetection(pBtCoexist, centFreq, offset, span, seconds); -+ } -+ -+ /* IPSReturn(pBtCoexist->Adapter, 0xff); */ -+} -+#endif -+ -+void EXhalbtcoutsrc_StackUpdateProfileInfo(void) -+{ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ PADAPTER padapter = (PADAPTER)GLBtCoexist.Adapter; -+ PBT_MGNT pBtMgnt = &padapter->coex_info.BtMgnt; -+ u8 i; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->stack_info.profile_notified = _TRUE; -+ -+ pBtCoexist->stack_info.num_of_link = -+ pBtMgnt->ExtConfig.NumberOfACL + pBtMgnt->ExtConfig.NumberOfSCO; -+ -+ /* reset first */ -+ pBtCoexist->stack_info.bt_link_exist = _FALSE; -+ pBtCoexist->stack_info.sco_exist = _FALSE; -+ pBtCoexist->stack_info.acl_exist = _FALSE; -+ pBtCoexist->stack_info.a2dp_exist = _FALSE; -+ pBtCoexist->stack_info.hid_exist = _FALSE; -+ pBtCoexist->stack_info.num_of_hid = 0; -+ pBtCoexist->stack_info.pan_exist = _FALSE; -+ -+ if (!pBtMgnt->ExtConfig.NumberOfACL) -+ pBtCoexist->stack_info.min_bt_rssi = 0; -+ -+ if (pBtCoexist->stack_info.num_of_link) { -+ pBtCoexist->stack_info.bt_link_exist = _TRUE; -+ if (pBtMgnt->ExtConfig.NumberOfSCO) -+ pBtCoexist->stack_info.sco_exist = _TRUE; -+ if (pBtMgnt->ExtConfig.NumberOfACL) -+ pBtCoexist->stack_info.acl_exist = _TRUE; -+ } -+ -+ for (i = 0; i < pBtMgnt->ExtConfig.NumberOfACL; i++) { -+ if (BT_PROFILE_A2DP == pBtMgnt->ExtConfig.aclLink[i].BTProfile) -+ pBtCoexist->stack_info.a2dp_exist = _TRUE; -+ else if (BT_PROFILE_PAN == pBtMgnt->ExtConfig.aclLink[i].BTProfile) -+ pBtCoexist->stack_info.pan_exist = _TRUE; -+ else if (BT_PROFILE_HID == pBtMgnt->ExtConfig.aclLink[i].BTProfile) { -+ pBtCoexist->stack_info.hid_exist = _TRUE; -+ pBtCoexist->stack_info.num_of_hid++; -+ } else -+ pBtCoexist->stack_info.unknown_acl_exist = _TRUE; -+ } -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+} -+ -+void EXhalbtcoutsrc_UpdateMinBtRssi(s8 btRssi) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->stack_info.min_bt_rssi = btRssi; -+} -+ -+void EXhalbtcoutsrc_SetHciVersion(u16 hciVersion) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->stack_info.hci_version = hciVersion; -+} -+ -+void EXhalbtcoutsrc_SetBtPatchVersion(u16 btHciVersion, u16 btPatchVersion) -+{ -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ pBtCoexist->bt_info.bt_real_fw_ver = btPatchVersion; -+ pBtCoexist->bt_info.bt_hci_ver = btHciVersion; -+} -+ -+#if 0 -+void EXhalbtcoutsrc_SetBtExist(u8 bBtExist) -+{ -+ GLBtCoexist.boardInfo.bBtExist = bBtExist; -+} -+#endif -+void EXhalbtcoutsrc_SetChipType(u8 chipType) -+{ -+ switch (chipType) { -+ default: -+ case BT_2WIRE: -+ case BT_ISSC_3WIRE: -+ case BT_ACCEL: -+ case BT_RTL8756: -+ GLBtCoexist.board_info.bt_chip_type = BTC_CHIP_UNDEF; -+ break; -+ case BT_CSR_BC4: -+ GLBtCoexist.board_info.bt_chip_type = BTC_CHIP_CSR_BC4; -+ break; -+ case BT_CSR_BC8: -+ GLBtCoexist.board_info.bt_chip_type = BTC_CHIP_CSR_BC8; -+ break; -+ case BT_RTL8723A: -+ GLBtCoexist.board_info.bt_chip_type = BTC_CHIP_RTL8723A; -+ break; -+ case BT_RTL8821: -+ GLBtCoexist.board_info.bt_chip_type = BTC_CHIP_RTL8821; -+ break; -+ case BT_RTL8723B: -+ GLBtCoexist.board_info.bt_chip_type = BTC_CHIP_RTL8723B; -+ break; -+ } -+} -+ -+void EXhalbtcoutsrc_SetAntNum(u8 type, u8 antNum) -+{ -+ if (BT_COEX_ANT_TYPE_PG == type) { -+ GLBtCoexist.board_info.pg_ant_num = antNum; -+ GLBtCoexist.board_info.btdm_ant_num = antNum; -+#if 0 -+ /* The antenna position: Main (default) or Aux for pgAntNum=2 && btdmAntNum =1 */ -+ /* The antenna position should be determined by auto-detect mechanism */ -+ /* The following is assumed to main, and those must be modified if y auto-detect mechanism is ready */ -+ if ((GLBtCoexist.board_info.pg_ant_num == 2) && (GLBtCoexist.board_info.btdm_ant_num == 1)) -+ GLBtCoexist.board_info.btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+ else -+ GLBtCoexist.board_info.btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; -+#endif -+ } else if (BT_COEX_ANT_TYPE_ANTDIV == type) { -+ GLBtCoexist.board_info.btdm_ant_num = antNum; -+ /* GLBtCoexist.boardInfo.btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; */ -+ } else if (BT_COEX_ANT_TYPE_DETECTED == type) { -+ GLBtCoexist.board_info.btdm_ant_num = antNum; -+ /* GLBtCoexist.boardInfo.btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT; */ -+ } -+} -+ -+/* -+ * Currently used by 8723b only, S0 or S1 -+ * */ -+void EXhalbtcoutsrc_SetSingleAntPath(u8 singleAntPath) -+{ -+ GLBtCoexist.board_info.single_ant_path = singleAntPath; -+} -+ -+void EXhalbtcoutsrc_DisplayBtCoexInfo(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ /* To prevent the racing with IPS enter */ -+ halbtcoutsrc_EnterPwrLock(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -+ if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) -+ ex_halbtc8821aCsr2ant_display_coex_info(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821a2ant_display_coex_info(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821a1ant_display_coex_info(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723b2ant_display_coex_info(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_display_coex_info(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8703b1ant_display_coex_info(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8723d2ant_display_coex_info(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723d1ant_display_coex_info(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8192e2ant_display_coex_info(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8192e1ant_display_coex_info(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_display_coex_info(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8812a1ant_display_coex_info(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_display_coex_info(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_display_coex_info(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_display_coex_info(pBtCoexist); -+ } -+ -+ halbtcoutsrc_ExitPwrLock(pBtCoexist); -+ -+ halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_DisplayAntDetection(PBTC_COEXIST pBtCoexist) -+{ -+ if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8723b1ant_display_ant_detection(pBtCoexist); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_display_ant_detection(pBtCoexist); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_display_ant_detection(pBtCoexist); -+ } -+ -+ halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+void EXhalbtcoutsrc_BTOffOnNotify(PBTC_COEXIST pBtCoexist, u8 bBTON) -+{ -+#if 0 /* Jenyu Need commit to windows' SVN */ -+ if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8812a2ant_bt_off_on_notify(pBtCoexist, (bBTON == _TRUE) ? BTC_BT_ON : BTC_BT_OFF); -+ } -+#endif -+} -+ -+void EXhalbtcoutsrc_set_rfe_type(u8 type) -+{ -+ GLBtCoexist.board_info.rfe_type= type; -+} -+ -+void EXhalbtcoutsrc_switchband_notify(struct btc_coexist *pBtCoexist, u8 type) -+{ -+ if(!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) -+ return; -+ -+ if(pBtCoexist->manual_control) -+ return; -+ -+ -+ halbtcoutsrc_LeaveLowPower(pBtCoexist); -+ -+ if(IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { -+ if(pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8822b1ant_switchband_notify(pBtCoexist, type); -+ } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { -+ if (pBtCoexist->board_info.btdm_ant_num == 2) -+ ex_halbtc8821c2ant_switchband_notify(pBtCoexist, type); -+ else if (pBtCoexist->board_info.btdm_ant_num == 1) -+ ex_halbtc8821c1ant_switchband_notify(pBtCoexist, type); -+ } -+ -+ halbtcoutsrc_NormalLowPower(pBtCoexist); -+} -+ -+static void halbt_init_hw_config92C(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 u1Tmp; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if ((pHalData->bt_coexist.btChipType == BT_CSR_BC4) || -+ (pHalData->bt_coexist.btChipType == BT_CSR_BC8)) { -+ if (pHalData->rf_type == RF_1T1R) { -+ /* Config to 1T1R */ -+ u1Tmp = rtw_read8(padapter, rOFDM0_TRxPathEnable); -+ u1Tmp &= ~BIT(1); -+ rtw_write8(padapter, rOFDM0_TRxPathEnable, u1Tmp); -+ RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xC04 = 0x%x\n", u1Tmp)); -+ -+ u1Tmp = rtw_read8(padapter, rOFDM1_TRxPathEnable); -+ u1Tmp &= ~BIT(1); -+ rtw_write8(padapter, rOFDM1_TRxPathEnable, u1Tmp); -+ RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xD04 = 0x%x\n", u1Tmp)); -+ } -+ } -+} -+ -+static void halbt_init_hw_config92D(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 u1Tmp; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ if ((pHalData->bt_coexist.btChipType == BT_CSR_BC4) || -+ (pHalData->bt_coexist.btChipType == BT_CSR_BC8)) { -+ if (pHalData->rf_type == RF_1T1R) { -+ /* Config to 1T1R */ -+ u1Tmp = rtw_read8(padapter, rOFDM0_TRxPathEnable); -+ u1Tmp &= ~BIT(1); -+ rtw_write8(padapter, rOFDM0_TRxPathEnable, u1Tmp); -+ RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xC04 = 0x%x\n", u1Tmp)); -+ -+ u1Tmp = rtw_read8(padapter, rOFDM1_TRxPathEnable); -+ u1Tmp &= ~BIT(1); -+ rtw_write8(padapter, rOFDM1_TRxPathEnable, u1Tmp); -+ RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xD04 = 0x%x\n", u1Tmp)); -+ } -+ } -+} -+ -+/* -+ * Description: -+ * Run BT-Coexist mechansim or not -+ * -+ */ -+void hal_btcoex_SetBTCoexist(PADAPTER padapter, u8 bBtExist) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pHalData->bt_coexist.bBtExist = bBtExist; -+} -+ -+/* -+ * Dewcription: -+ * Check is co-exist mechanism enabled or not -+ * -+ * Return: -+ * _TRUE Enable BT co-exist mechanism -+ * _FALSE Disable BT co-exist mechanism -+ */ -+u8 hal_btcoex_IsBtExist(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ return pHalData->bt_coexist.bBtExist; -+} -+ -+u8 hal_btcoex_IsBtDisabled(PADAPTER padapter) -+{ -+ if (!hal_btcoex_IsBtExist(padapter)) -+ return _TRUE; -+ -+ if (GLBtCoexist.bt_info.bt_disabled) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+void hal_btcoex_SetChipType(PADAPTER padapter, u8 chipType) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pHalData->bt_coexist.btChipType = chipType; -+} -+ -+void hal_btcoex_SetPgAntNum(PADAPTER padapter, u8 antNum) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ pHalData->bt_coexist.btTotalAntNum = antNum; -+} -+ -+u8 hal_btcoex_Initialize(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 ret; -+ -+ -+ _rtw_memset(&GLBtCoexist, 0, sizeof(GLBtCoexist)); -+ -+ hal_btcoex_SetBTCoexist(padapter, rtw_btcoex_get_bt_coexist(padapter)); -+ hal_btcoex_SetChipType(padapter, rtw_btcoex_get_chip_type(padapter)); -+ hal_btcoex_SetPgAntNum(padapter, rtw_btcoex_get_pg_ant_num(padapter)); -+ -+ ret = EXhalbtcoutsrc_InitlizeVariables((void *)padapter); -+ -+ return ret; -+} -+ -+void hal_btcoex_PowerOnSetting(PADAPTER padapter) -+{ -+ EXhalbtcoutsrc_PowerOnSetting(&GLBtCoexist); -+} -+ -+void hal_btcoex_PowerOffSetting(PADAPTER padapter) -+{ -+ /* Clear the WiFi on/off bit in scoreboard reg. if necessary */ -+ if (IS_HARDWARE_TYPE_8703B(padapter) || IS_HARDWARE_TYPE_8723D(padapter) -+ || IS_HARDWARE_TYPE_8821C(padapter) || IS_HARDWARE_TYPE_8822B(padapter)) -+ rtw_write16(padapter, 0xaa, 0x8000); -+} -+ -+void hal_btcoex_PreLoadFirmware(PADAPTER padapter) -+{ -+ EXhalbtcoutsrc_PreLoadFirmware(&GLBtCoexist); -+} -+ -+void hal_btcoex_InitHwConfig(PADAPTER padapter, u8 bWifiOnly) -+{ -+ if (!hal_btcoex_IsBtExist(padapter)) -+ return; -+ -+ EXhalbtcoutsrc_init_hw_config(&GLBtCoexist, bWifiOnly); -+ EXhalbtcoutsrc_init_coex_dm(&GLBtCoexist); -+} -+ -+void hal_btcoex_IpsNotify(PADAPTER padapter, u8 type) -+{ -+ EXhalbtcoutsrc_ips_notify(&GLBtCoexist, type); -+} -+ -+void hal_btcoex_LpsNotify(PADAPTER padapter, u8 type) -+{ -+ EXhalbtcoutsrc_lps_notify(&GLBtCoexist, type); -+} -+ -+void hal_btcoex_ScanNotify(PADAPTER padapter, u8 type) -+{ -+ EXhalbtcoutsrc_scan_notify(&GLBtCoexist, type); -+} -+ -+void hal_btcoex_ConnectNotify(PADAPTER padapter, u8 action) -+{ -+ EXhalbtcoutsrc_connect_notify(&GLBtCoexist, action); -+} -+ -+void hal_btcoex_MediaStatusNotify(PADAPTER padapter, u8 mediaStatus) -+{ -+ EXhalbtcoutsrc_media_status_notify(&GLBtCoexist, mediaStatus); -+} -+ -+void hal_btcoex_SpecialPacketNotify(PADAPTER padapter, u8 pktType) -+{ -+ EXhalbtcoutsrc_specific_packet_notify(&GLBtCoexist, pktType); -+} -+ -+void hal_btcoex_IQKNotify(PADAPTER padapter, u8 state) -+{ -+ GLBtcWiFiInIQKState = state; -+} -+ -+void hal_btcoex_BtInfoNotify(PADAPTER padapter, u8 length, u8 *tmpBuf) -+{ -+ if (GLBtcWiFiInIQKState == _TRUE) -+ return; -+ -+ EXhalbtcoutsrc_bt_info_notify(&GLBtCoexist, tmpBuf, length); -+} -+ -+void hal_btcoex_BtMpRptNotify(PADAPTER padapter, u8 length, u8 *tmpBuf) -+{ -+ u8 extid, status, len, seq; -+ -+ -+ if (!GLBtcBtMpRptWait) -+ return; -+ -+ if ((length < 3) || (!tmpBuf)) -+ return; -+ -+ extid = tmpBuf[0]; -+ /* not response from BT FW then exit*/ -+ switch (extid) { -+ case C2H_WIFI_FW_ACTIVE_RSP: -+ GLBtcBtMpRptWiFiOK = 1; -+ return; -+ -+ case C2H_TRIG_BY_BT_FW: -+ _cancel_timer_ex(&GLBtcBtMpOperTimer); -+ GLBtcBtMpRptWait = 0; -+ GLBtcBtMpRptBTOK = 1; -+ break; -+ -+ default: -+ return; -+ } -+ -+ status = tmpBuf[1] & 0xF; -+ len = length - 3; -+ seq = tmpBuf[2] >> 4; -+ -+ GLBtcBtMpRptSeq = seq; -+ GLBtcBtMpRptStatus = status; -+ _rtw_memcpy(GLBtcBtMpRptRsp, tmpBuf + 3, len); -+ GLBtcBtMpRptRspSize = len; -+ _rtw_up_sema(&GLBtcBtMpRptSema); -+} -+ -+void hal_btcoex_SuspendNotify(PADAPTER padapter, u8 state) -+{ -+ switch (state) { -+ case BTCOEX_SUSPEND_STATE_SUSPEND: -+ EXhalbtcoutsrc_pnp_notify(&GLBtCoexist, BTC_WIFI_PNP_SLEEP); -+ break; -+ case BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT: -+ /* should switch to "#if 1" once all ICs' coex. revision are upgraded to support the KEEP_ANT case */ -+#if 0 -+ EXhalbtcoutsrc_pnp_notify(&GLBtCoexist, BTC_WIFI_PNP_SLEEP_KEEP_ANT); -+#else -+ EXhalbtcoutsrc_pnp_notify(&GLBtCoexist, BTC_WIFI_PNP_SLEEP); -+ EXhalbtcoutsrc_pnp_notify(&GLBtCoexist, BTC_WIFI_PNP_SLEEP_KEEP_ANT); -+#endif -+ break; -+ case BTCOEX_SUSPEND_STATE_RESUME: -+ EXhalbtcoutsrc_pnp_notify(&GLBtCoexist, BTC_WIFI_PNP_WAKE_UP); -+ break; -+ } -+} -+ -+void hal_btcoex_HaltNotify(PADAPTER padapter, u8 do_halt) -+{ -+ if (do_halt == 1) -+ EXhalbtcoutsrc_halt_notify(&GLBtCoexist); -+ -+ GLBtCoexist.bBinded = _FALSE; -+ GLBtCoexist.Adapter = NULL; -+} -+ -+void hal_btcoex_SwitchBtTRxMask(PADAPTER padapter) -+{ -+ EXhalbtcoutsrc_SwitchBtTRxMask(&GLBtCoexist); -+} -+ -+void hal_btcoex_Hanlder(PADAPTER padapter) -+{ -+ u32 bt_patch_ver; -+ -+ EXhalbtcoutsrc_periodical(&GLBtCoexist); -+ -+ if (GLBtCoexist.bt_info.bt_get_fw_ver == 0) { -+ GLBtCoexist.btc_get(&GLBtCoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); -+ GLBtCoexist.bt_info.bt_get_fw_ver = bt_patch_ver; -+ } -+} -+ -+s32 hal_btcoex_IsBTCoexRejectAMPDU(PADAPTER padapter) -+{ -+ return (s32)GLBtCoexist.bt_info.reject_agg_pkt; -+} -+ -+s32 hal_btcoex_IsBTCoexCtrlAMPDUSize(PADAPTER padapter) -+{ -+ return (s32)GLBtCoexist.bt_info.bt_ctrl_agg_buf_size; -+} -+ -+u32 hal_btcoex_GetAMPDUSize(PADAPTER padapter) -+{ -+ return (u32)GLBtCoexist.bt_info.agg_buf_size; -+} -+ -+void hal_btcoex_SetManualControl(PADAPTER padapter, u8 bmanual) -+{ -+ GLBtCoexist.manual_control = bmanual; -+} -+ -+u8 hal_btcoex_1Ant(PADAPTER padapter) -+{ -+ if (hal_btcoex_IsBtExist(padapter) == _FALSE) -+ return _FALSE; -+ -+ if (GLBtCoexist.board_info.btdm_ant_num == 1) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+u8 hal_btcoex_IsBtControlLps(PADAPTER padapter) -+{ -+ if (GLBtCoexist.bdontenterLPS == _TRUE) -+ return _TRUE; -+ -+ if (hal_btcoex_IsBtExist(padapter) == _FALSE) -+ return _FALSE; -+ -+ if (GLBtCoexist.bt_info.bt_disabled) -+ return _FALSE; -+ -+ if (GLBtCoexist.bt_info.bt_ctrl_lps) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+u8 hal_btcoex_IsLpsOn(PADAPTER padapter) -+{ -+ if (GLBtCoexist.bdontenterLPS == _TRUE) -+ return _FALSE; -+ -+ if (hal_btcoex_IsBtExist(padapter) == _FALSE) -+ return _FALSE; -+ -+ if (GLBtCoexist.bt_info.bt_disabled) -+ return _FALSE; -+ -+ if (GLBtCoexist.bt_info.bt_lps_on) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+u8 hal_btcoex_RpwmVal(PADAPTER padapter) -+{ -+ return GLBtCoexist.bt_info.rpwm_val; -+} -+ -+u8 hal_btcoex_LpsVal(PADAPTER padapter) -+{ -+ return GLBtCoexist.bt_info.lps_val; -+} -+ -+u32 hal_btcoex_GetRaMask(PADAPTER padapter) -+{ -+ if (!hal_btcoex_IsBtExist(padapter)) -+ return 0; -+ -+ if (GLBtCoexist.bt_info.bt_disabled) -+ return 0; -+ -+ /* Modify by YiWei , suggest by Cosa and Jenyu -+ * Remove the limit antenna number , because 2 antenna case (ex: 8192eu)also want to get BT coex report rate mask. -+ */ -+ /*if (GLBtCoexist.board_info.btdm_ant_num != 1) -+ return 0;*/ -+ -+ return GLBtCoexist.bt_info.ra_mask; -+} -+ -+void hal_btcoex_RecordPwrMode(PADAPTER padapter, u8 *pCmdBuf, u8 cmdLen) -+{ -+ -+ _rtw_memcpy(GLBtCoexist.pwrModeVal, pCmdBuf, cmdLen); -+} -+ -+void hal_btcoex_DisplayBtCoexInfo(PADAPTER padapter, u8 *pbuf, u32 bufsize) -+{ -+ PBTCDBGINFO pinfo; -+ -+ -+ pinfo = &GLBtcDbgInfo; -+ DBG_BT_INFO_INIT(pinfo, pbuf, bufsize); -+ EXhalbtcoutsrc_DisplayBtCoexInfo(&GLBtCoexist); -+ DBG_BT_INFO_INIT(pinfo, NULL, 0); -+} -+ -+void hal_btcoex_SetDBG(PADAPTER padapter, u32 *pDbgModule) -+{ -+ u32 i; -+ -+ -+ if (NULL == pDbgModule) -+ return; -+ -+ for (i = 0; i < COMP_MAX; i++) -+ GLBtcDbgType[i] = pDbgModule[i]; -+} -+ -+u32 hal_btcoex_GetDBG(PADAPTER padapter, u8 *pStrBuf, u32 bufSize) -+{ -+ s32 count; -+ u8 *pstr; -+ u32 leftSize; -+ -+ -+ if ((NULL == pStrBuf) || (0 == bufSize)) -+ return 0; -+ -+ count = 0; -+ pstr = pStrBuf; -+ leftSize = bufSize; -+ /* RTW_INFO(FUNC_ADPT_FMT ": bufsize=%d\n", FUNC_ADPT_ARG(padapter), bufSize); */ -+ -+ count = rtw_sprintf(pstr, leftSize, "#define DBG\t%d\n", DBG); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+ count = rtw_sprintf(pstr, leftSize, "BTCOEX Debug Setting:\n"); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+ count = rtw_sprintf(pstr, leftSize, -+ "COMP_COEX: 0x%08X\n\n", -+ GLBtcDbgType[COMP_COEX]); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+#if 0 -+ count = rtw_sprintf(pstr, leftSize, "INTERFACE Debug Setting Definition:\n"); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[0]=%d for INTF_INIT\n", -+ GLBtcDbgType[BTC_MSG_INTERFACE] & INTF_INIT ? 1 : 0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[2]=%d for INTF_NOTIFY\n\n", -+ GLBtcDbgType[BTC_MSG_INTERFACE] & INTF_NOTIFY ? 1 : 0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ -+ count = rtw_sprintf(pstr, leftSize, "ALGORITHM Debug Setting Definition:\n"); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[0]=%d for BT_RSSI_STATE\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_BT_RSSI_STATE ? 1 : 0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[1]=%d for WIFI_RSSI_STATE\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_WIFI_RSSI_STATE ? 1 : 0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[2]=%d for BT_MONITOR\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_BT_MONITOR ? 1 : 0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[3]=%d for TRACE\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE ? 1 : 0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[4]=%d for TRACE_FW\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE_FW ? 1 : 0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[5]=%d for TRACE_FW_DETAIL\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE_FW_DETAIL ? 1 : 0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[6]=%d for TRACE_FW_EXEC\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE_FW_EXEC ? 1 : 0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[7]=%d for TRACE_SW\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE_SW ? 1 : 0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[8]=%d for TRACE_SW_DETAIL\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE_SW_DETAIL ? 1 : 0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+ count = rtw_sprintf(pstr, leftSize, "\tbit[9]=%d for TRACE_SW_EXEC\n", -+ GLBtcDbgType[BTC_MSG_ALGORITHM] & ALGO_TRACE_SW_EXEC ? 1 : 0); -+ if ((count < 0) || (count >= leftSize)) -+ goto exit; -+ pstr += count; -+ leftSize -= count; -+#endif -+ -+exit: -+ count = pstr - pStrBuf; -+ /* RTW_INFO(FUNC_ADPT_FMT ": usedsize=%d\n", FUNC_ADPT_ARG(padapter), count); */ -+ -+ return count; -+} -+ -+u8 hal_btcoex_IncreaseScanDeviceNum(PADAPTER padapter) -+{ -+ if (!hal_btcoex_IsBtExist(padapter)) -+ return _FALSE; -+ -+ if (GLBtCoexist.bt_info.increase_scan_dev_num) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+u8 hal_btcoex_IsBtLinkExist(PADAPTER padapter) -+{ -+ if (GLBtCoexist.bt_link_info.bt_link_exist) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+void hal_btcoex_SetBtPatchVersion(PADAPTER padapter, u16 btHciVer, u16 btPatchVer) -+{ -+ EXhalbtcoutsrc_SetBtPatchVersion(btHciVer, btPatchVer); -+} -+ -+void hal_btcoex_SetHciVersion(PADAPTER padapter, u16 hciVersion) -+{ -+ EXhalbtcoutsrc_SetHciVersion(hciVersion); -+} -+ -+void hal_btcoex_StackUpdateProfileInfo(void) -+{ -+ EXhalbtcoutsrc_StackUpdateProfileInfo(); -+} -+ -+void hal_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON) -+{ -+ EXhalbtcoutsrc_BTOffOnNotify(&GLBtCoexist, bBTON); -+} -+ -+/* -+ * Description: -+ * Setting BT coex antenna isolation type . -+ * coex mechanisn/ spital stream/ best throughput -+ * anttype = 0 , PSTDMA / 2SS / 0.5T , bad isolation , WiFi/BT ANT Distance<15cm , (<20dB) for 2,3 antenna -+ * anttype = 1 , PSTDMA / 1SS / 0.5T , normal isolaiton , 50cm>WiFi/BT ANT Distance>15cm , (>20dB) for 2 antenna -+ * anttype = 2 , TDMA / 2SS / T , normal isolaiton , 50cm>WiFi/BT ANT Distance>15cm , (>20dB) for 3 antenna -+ * anttype = 3 , no TDMA / 1SS / 0.5T , good isolation , WiFi/BT ANT Distance >50cm , (>40dB) for 2 antenna -+ * anttype = 4 , no TDMA / 2SS / T , good isolation , WiFi/BT ANT Distance >50cm , (>40dB) for 3 antenna -+ * wifi only throughput ~ T -+ * wifi/BT share one antenna with SPDT -+ */ -+void hal_btcoex_SetAntIsolationType(PADAPTER padapter, u8 anttype) -+{ -+ PHAL_DATA_TYPE pHalData; -+ PBTC_COEXIST pBtCoexist = &GLBtCoexist; -+ -+ /*RTW_INFO("####%s , anttype = %d , %d\n" , __func__ , anttype , __LINE__); */ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ -+ pHalData->bt_coexist.btAntisolation = anttype; -+ -+ switch (pHalData->bt_coexist.btAntisolation) { -+ case 0: -+ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_0; -+ break; -+ case 1: -+ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_1; -+ break; -+ case 2: -+ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_2; -+ break; -+ case 3: -+ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_3; -+ break; -+ case 4: -+ pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_4; -+ break; -+ } -+ -+} -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+int -+hal_btcoex_ParseAntIsolationConfigFile( -+ PADAPTER Adapter, -+ char *buffer -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u32 i = 0 , j = 0; -+ char *szLine , *ptmp; -+ int rtStatus = _SUCCESS; -+ char param_value_string[10]; -+ u8 param_value; -+ u8 anttype = 4; -+ -+ u8 ant_num = 3 , ant_distance = 50 , rfe_type = 1; -+ -+ typedef struct ant_isolation { -+ char *param_name; /* antenna isolation config parameter name */ -+ u8 *value; /* antenna isolation config parameter value */ -+ } ANT_ISOLATION; -+ -+ ANT_ISOLATION ant_isolation_param[] = { -+ {"ANT_NUMBER" , &ant_num}, -+ {"ANT_DISTANCE" , &ant_distance}, -+ {"RFE_TYPE" , &rfe_type}, -+ {NULL , 0} -+ }; -+ -+ -+ -+ /* RTW_INFO("===>Hal_ParseAntIsolationConfigFile()\n" ); */ -+ -+ ptmp = buffer; -+ for (szLine = GetLineFromBuffer(ptmp) ; szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ /* skip comment */ -+ if (IsCommentString(szLine)) -+ continue; -+ -+ /* RTW_INFO("%s : szLine = %s , strlen(szLine) = %d\n" , __func__ , szLine , strlen(szLine));*/ -+ for (j = 0 ; ant_isolation_param[j].param_name != NULL ; j++) { -+ if (strstr(szLine , ant_isolation_param[j].param_name) != NULL) { -+ i = 0; -+ while (i < strlen(szLine)) { -+ if (szLine[i] != '"') -+ ++i; -+ else { -+ /* skip only has one " */ -+ if (strpbrk(szLine , "\"") == strrchr(szLine , '"')) { -+ RTW_INFO("Fail to parse parameters , format error!\n"); -+ break; -+ } -+ _rtw_memset((PVOID)param_value_string , 0 , 10); -+ if (!ParseQualifiedString(szLine , &i , param_value_string , '"' , '"')) { -+ RTW_INFO("Fail to parse parameters\n"); -+ return _FAIL; -+ } else if (!GetU1ByteIntegerFromStringInDecimal(param_value_string , ant_isolation_param[j].value)) -+ RTW_INFO("Fail to GetU1ByteIntegerFromStringInDecimal\n"); -+ -+ break; -+ } -+ } -+ } -+ } -+ } -+ -+ /* YiWei 20140716 , for BT coex antenna isolation control */ -+ /* rfe_type = 0 was SPDT , rfe_type = 1 was coupler */ -+ if (ant_num == 3 && ant_distance >= 50) -+ anttype = 3; -+ else if (ant_num == 2 && ant_distance >= 50 && rfe_type == 1) -+ anttype = 2; -+ else if (ant_num == 3 && ant_distance >= 15 && ant_distance < 50) -+ anttype = 2; -+ else if (ant_num == 2 && ant_distance >= 15 && ant_distance < 50 && rfe_type == 1) -+ anttype = 2; -+ else if ((ant_num == 2 && ant_distance < 15 && rfe_type == 1) || (ant_num == 3 && ant_distance < 15)) -+ anttype = 1; -+ else if (ant_num == 2 && rfe_type == 0) -+ anttype = 0; -+ else -+ anttype = 0; -+ -+ hal_btcoex_SetAntIsolationType(Adapter, anttype); -+ -+ RTW_INFO("%s : ant_num = %d\n" , __func__ , ant_num); -+ RTW_INFO("%s : ant_distance = %d\n" , __func__ , ant_distance); -+ RTW_INFO("%s : rfe_type = %d\n" , __func__ , rfe_type); -+ /* RTW_INFO("<===Hal_ParseAntIsolationConfigFile()\n"); */ -+ return rtStatus; -+} -+ -+ -+int -+hal_btcoex_AntIsolationConfig_ParaFile( -+ IN PADAPTER Adapter, -+ IN char *pFileName -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0 , rtStatus = _FAIL; -+ -+ _rtw_memset(pHalData->para_file_buf , 0 , MAX_PARA_FILE_BUF_LEN); -+ -+ rtw_get_phy_file_path(Adapter, pFileName); -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) -+ rtStatus = _SUCCESS; -+ } -+ -+ -+ if (rtStatus == _SUCCESS) { -+ /*RTW_INFO("%s(): read %s ok\n", __func__ , pFileName);*/ -+ rtStatus = hal_btcoex_ParseAntIsolationConfigFile(Adapter , pHalData->para_file_buf); -+ } else -+ RTW_INFO("%s(): No File %s, Load from *** Array!\n" , __func__ , pFileName); -+ -+ return rtStatus; -+} -+#endif /* CONFIG_LOAD_PHY_PARA_FROM_FILE */ -+ -+u16 hal_btcoex_btreg_read(PADAPTER padapter, u8 type, u16 addr, u32 *data) -+{ -+ u16 ret = 0; -+ -+ halbtcoutsrc_LeaveLowPower(&GLBtCoexist); -+ -+ ret = halbtcoutsrc_GetBtReg_with_status(&GLBtCoexist, type, addr, data); -+ -+ halbtcoutsrc_NormalLowPower(&GLBtCoexist); -+ -+ return ret; -+} -+ -+u16 hal_btcoex_btreg_write(PADAPTER padapter, u8 type, u16 addr, u16 val) -+{ -+ u16 ret = 0; -+ -+ halbtcoutsrc_LeaveLowPower(&GLBtCoexist); -+ -+ ret = halbtcoutsrc_SetBtReg(&GLBtCoexist, type, addr, val); -+ -+ halbtcoutsrc_NormalLowPower(&GLBtCoexist); -+ -+ return ret; -+} -+ -+void hal_btcoex_set_rfe_type(u8 type) -+{ -+ EXhalbtcoutsrc_set_rfe_type(type); -+} -+void hal_btcoex_switchband_notify(u8 under_scan, u8 band_type) -+{ -+ switch (band_type) { -+ case BAND_ON_2_4G: -+ if (under_scan) -+ EXhalbtcoutsrc_switchband_notify(&GLBtCoexist, BTC_SWITCH_TO_24G); -+ else -+ EXhalbtcoutsrc_switchband_notify(&GLBtCoexist, BTC_SWITCH_TO_24G_NOFORSCAN); -+ break; -+ case BAND_ON_5G: -+ EXhalbtcoutsrc_switchband_notify(&GLBtCoexist, BTC_SWITCH_TO_5G); -+ break; -+ default: -+ RTW_INFO("[BTCOEX] unkown switch band type\n"); -+ break; -+ } -+} -+#endif /* CONFIG_BT_COEXIST */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_com.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_com.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_com.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_com.c 2018-02-11 21:44:27.151146147 +0200 -@@ -0,0 +1,10423 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _HAL_COM_C_ -+ -+#include -+#include "hal_com_h2c.h" -+ -+#include "hal_data.h" -+ -+/* #define CONFIG_GTK_OL_DBG */ -+ -+/*#define DBG_SEC_CAM_MOVE*/ -+#ifdef DBG_SEC_CAM_MOVE -+void rtw_hal_move_sta_gk_to_dk(_adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ int cam_id, index = 0; -+ u8 *addr = NULL; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ return; -+ -+ addr = get_bssid(pmlmepriv); -+ -+ if (addr == NULL) { -+ RTW_INFO("%s: get bssid MAC addr fail!!\n", __func__); -+ return; -+ } -+ -+ rtw_clean_dk_section(adapter); -+ -+ do { -+ cam_id = rtw_camid_search(adapter, addr, index, 1); -+ -+ if (cam_id == -1) -+ RTW_INFO("%s: cam_id: %d, key_id:%d\n", __func__, cam_id, index); -+ else -+ rtw_sec_cam_swap(adapter, cam_id, index); -+ -+ index++; -+ } while (index < 4); -+ -+} -+ -+void rtw_hal_read_sta_dk_key(_adapter *adapter, u8 key_id) -+{ -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ u8 get_key[16]; -+ -+ _rtw_memset(get_key, 0, sizeof(get_key)); -+ -+ if (key_id > 4) { -+ RTW_INFO("%s [ERROR] gtk_keyindex:%d invalid\n", __func__, key_id); -+ rtw_warn_on(1); -+ return; -+ } -+ rtw_sec_read_cam_ent(adapter, key_id, NULL, NULL, get_key); -+ -+ /*update key into related sw variable*/ -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ if (_rtw_camid_is_gk(adapter, key_id)) { -+ RTW_INFO("[HW KEY] -Key-id:%d "KEY_FMT"\n", key_id, KEY_ARG(get_key)); -+ RTW_INFO("[cam_cache KEY] - Key-id:%d "KEY_FMT"\n", key_id, KEY_ARG(&dvobj->cam_cache[key_id].key)); -+ } -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ -+} -+#endif -+ -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ char rtw_phy_para_file_path[PATH_LENGTH_MAX]; -+#endif -+ -+void dump_chip_info(HAL_VERSION ChipVersion) -+{ -+ int cnt = 0; -+ u8 buf[128] = {0}; -+ -+ if (IS_8188E(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8188E_"); -+ else if (IS_8188F(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8188F_"); -+ else if (IS_8812_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8812_"); -+ else if (IS_8192E(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8192E_"); -+ else if (IS_8821_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8821_"); -+ else if (IS_8723B_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8723B_"); -+ else if (IS_8703B_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8703B_"); -+ else if (IS_8723D_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8723D_"); -+ else if (IS_8814A_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8814A_"); -+ else if (IS_8822B_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8822B_"); -+ else if (IS_8821C_SERIES(ChipVersion)) -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8821C_"); -+ else -+ cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_UNKNOWN_"); -+ -+ cnt += sprintf((buf + cnt), "%s_", IS_NORMAL_CHIP(ChipVersion) ? "Normal_Chip" : "Test_Chip"); -+ if (IS_CHIP_VENDOR_TSMC(ChipVersion)) -+ cnt += sprintf((buf + cnt), "%s_", "TSMC"); -+ else if (IS_CHIP_VENDOR_UMC(ChipVersion)) -+ cnt += sprintf((buf + cnt), "%s_", "UMC"); -+ else if (IS_CHIP_VENDOR_SMIC(ChipVersion)) -+ cnt += sprintf((buf + cnt), "%s_", "SMIC"); -+ -+ if (IS_A_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "A_CUT_"); -+ else if (IS_B_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "B_CUT_"); -+ else if (IS_C_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "C_CUT_"); -+ else if (IS_D_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "D_CUT_"); -+ else if (IS_E_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "E_CUT_"); -+ else if (IS_F_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "F_CUT_"); -+ else if (IS_I_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "I_CUT_"); -+ else if (IS_J_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "J_CUT_"); -+ else if (IS_K_CUT(ChipVersion)) -+ cnt += sprintf((buf + cnt), "K_CUT_"); -+ else -+ cnt += sprintf((buf + cnt), "UNKNOWN_CUT(%d)_", ChipVersion.CUTVersion); -+ -+ if (IS_1T1R(ChipVersion)) -+ cnt += sprintf((buf + cnt), "1T1R_"); -+ else if (IS_1T2R(ChipVersion)) -+ cnt += sprintf((buf + cnt), "1T2R_"); -+ else if (IS_2T2R(ChipVersion)) -+ cnt += sprintf((buf + cnt), "2T2R_"); -+ else if (IS_3T3R(ChipVersion)) -+ cnt += sprintf((buf + cnt), "3T3R_"); -+ else if (IS_3T4R(ChipVersion)) -+ cnt += sprintf((buf + cnt), "3T4R_"); -+ else if (IS_4T4R(ChipVersion)) -+ cnt += sprintf((buf + cnt), "4T4R_"); -+ else -+ cnt += sprintf((buf + cnt), "UNKNOWN_RFTYPE(%d)_", ChipVersion.RFType); -+ -+ cnt += sprintf((buf + cnt), "RomVer(%d)\n", ChipVersion.ROMVer); -+ -+ RTW_INFO("%s", buf); -+} -+void rtw_hal_config_rftype(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (IS_1T1R(pHalData->VersionID)) { -+ pHalData->rf_type = RF_1T1R; -+ pHalData->NumTotalRFPath = 1; -+ } else if (IS_2T2R(pHalData->VersionID)) { -+ pHalData->rf_type = RF_2T2R; -+ pHalData->NumTotalRFPath = 2; -+ } else if (IS_1T2R(pHalData->VersionID)) { -+ pHalData->rf_type = RF_1T2R; -+ pHalData->NumTotalRFPath = 2; -+ } else if (IS_3T3R(pHalData->VersionID)) { -+ pHalData->rf_type = RF_3T3R; -+ pHalData->NumTotalRFPath = 3; -+ } else if (IS_4T4R(pHalData->VersionID)) { -+ pHalData->rf_type = RF_4T4R; -+ pHalData->NumTotalRFPath = 4; -+ } else { -+ pHalData->rf_type = RF_1T1R; -+ pHalData->NumTotalRFPath = 1; -+ } -+ -+ RTW_INFO("%s RF_Type is %d TotalTxPath is %d\n", __FUNCTION__, pHalData->rf_type, pHalData->NumTotalRFPath); -+} -+ -+#define EEPROM_CHANNEL_PLAN_BY_HW_MASK 0x80 -+ -+/* -+ * Description: -+ * Use hardware(efuse), driver parameter(registry) and default channel plan -+ * to decide which one should be used. -+ * -+ * Parameters: -+ * padapter pointer of adapter -+ * hw_alpha2 country code from HW (efuse/eeprom/mapfile) -+ * hw_chplan channel plan from HW (efuse/eeprom/mapfile) -+ * BIT[7] software configure mode; 0:Enable, 1:disable -+ * BIT[6:0] Channel Plan -+ * sw_alpha2 country code from HW (registry/module param) -+ * sw_chplan channel plan from SW (registry/module param) -+ * def_chplan channel plan used when HW/SW both invalid -+ * AutoLoadFail efuse autoload fail or not -+ * -+ * Return: -+ * Final channel plan decision -+ * -+ */ -+u8 hal_com_config_channel_plan( -+ IN PADAPTER padapter, -+ IN char *hw_alpha2, -+ IN u8 hw_chplan, -+ IN char *sw_alpha2, -+ IN u8 sw_chplan, -+ IN u8 def_chplan, -+ IN BOOLEAN AutoLoadFail -+) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 force_hw_chplan = _FALSE; -+ int chplan = -1; -+ const struct country_chplan *country_ent = NULL, *ent; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ /* treat 0xFF as invalid value, bypass hw_chplan & force_hw_chplan parsing */ -+ if (hw_chplan == 0xFF) -+ goto chk_hw_country_code; -+ -+ if (AutoLoadFail == _TRUE) -+ goto chk_sw_config; -+ -+#ifndef CONFIG_FORCE_SW_CHANNEL_PLAN -+ if (hw_chplan & EEPROM_CHANNEL_PLAN_BY_HW_MASK) -+ force_hw_chplan = _TRUE; -+#endif -+ -+ hw_chplan &= (~EEPROM_CHANNEL_PLAN_BY_HW_MASK); -+ -+chk_hw_country_code: -+ if (hw_alpha2 && !IS_ALPHA2_NO_SPECIFIED(hw_alpha2)) { -+ ent = rtw_get_chplan_from_country(hw_alpha2); -+ if (ent) { -+ /* get chplan from hw country code, by pass hw chplan setting */ -+ country_ent = ent; -+ chplan = ent->chplan; -+ goto chk_sw_config; -+ } else -+ RTW_PRINT("%s unsupported hw_alpha2:\"%c%c\"\n", __func__, hw_alpha2[0], hw_alpha2[1]); -+ } -+ -+ if (rtw_is_channel_plan_valid(hw_chplan)) -+ chplan = hw_chplan; -+ else if (force_hw_chplan == _TRUE) { -+ RTW_PRINT("%s unsupported hw_chplan:0x%02X\n", __func__, hw_chplan); -+ /* hw infomaton invalid, refer to sw information */ -+ force_hw_chplan = _FALSE; -+ } -+ -+chk_sw_config: -+ if (force_hw_chplan == _TRUE) -+ goto done; -+ -+ if (sw_alpha2 && !IS_ALPHA2_NO_SPECIFIED(sw_alpha2)) { -+ ent = rtw_get_chplan_from_country(sw_alpha2); -+ if (ent) { -+ /* get chplan from sw country code, by pass sw chplan setting */ -+ country_ent = ent; -+ chplan = ent->chplan; -+ goto done; -+ } else -+ RTW_PRINT("%s unsupported sw_alpha2:\"%c%c\"\n", __func__, sw_alpha2[0], sw_alpha2[1]); -+ } -+ -+ if (rtw_is_channel_plan_valid(sw_chplan)) { -+ /* cancel hw_alpha2 because chplan is specified by sw_chplan*/ -+ country_ent = NULL; -+ chplan = sw_chplan; -+ } else if (sw_chplan != RTW_CHPLAN_MAX) -+ RTW_PRINT("%s unsupported sw_chplan:0x%02X\n", __func__, sw_chplan); -+ -+done: -+ if (chplan == -1) { -+ RTW_PRINT("%s use def_chplan:0x%02X\n", __func__, def_chplan); -+ chplan = def_chplan; -+ } else if (country_ent) { -+ RTW_PRINT("%s country code:\"%c%c\" with chplan:0x%02X\n", __func__ -+ , country_ent->alpha2[0], country_ent->alpha2[1], country_ent->chplan); -+ } else -+ RTW_PRINT("%s chplan:0x%02X\n", __func__, chplan); -+ -+ padapter->mlmepriv.country_ent = country_ent; -+ pHalData->bDisableSWChannelPlan = force_hw_chplan; -+ -+ return chplan; -+} -+ -+BOOLEAN -+HAL_IsLegalChannel( -+ IN PADAPTER Adapter, -+ IN u32 Channel -+) -+{ -+ BOOLEAN bLegalChannel = _TRUE; -+ -+ if (Channel > 14) { -+ if (IsSupported5G(Adapter->registrypriv.wireless_mode) == _FALSE) { -+ bLegalChannel = _FALSE; -+ RTW_INFO("Channel > 14 but wireless_mode do not support 5G\n"); -+ } -+ } else if ((Channel <= 14) && (Channel >= 1)) { -+ if (IsSupported24G(Adapter->registrypriv.wireless_mode) == _FALSE) { -+ bLegalChannel = _FALSE; -+ RTW_INFO("(Channel <= 14) && (Channel >=1) but wireless_mode do not support 2.4G\n"); -+ } -+ } else { -+ bLegalChannel = _FALSE; -+ RTW_INFO("Channel is Invalid !!!\n"); -+ } -+ -+ return bLegalChannel; -+} -+ -+u8 MRateToHwRate(u8 rate) -+{ -+ u8 ret = DESC_RATE1M; -+ -+ switch (rate) { -+ case MGN_1M: -+ ret = DESC_RATE1M; -+ break; -+ case MGN_2M: -+ ret = DESC_RATE2M; -+ break; -+ case MGN_5_5M: -+ ret = DESC_RATE5_5M; -+ break; -+ case MGN_11M: -+ ret = DESC_RATE11M; -+ break; -+ case MGN_6M: -+ ret = DESC_RATE6M; -+ break; -+ case MGN_9M: -+ ret = DESC_RATE9M; -+ break; -+ case MGN_12M: -+ ret = DESC_RATE12M; -+ break; -+ case MGN_18M: -+ ret = DESC_RATE18M; -+ break; -+ case MGN_24M: -+ ret = DESC_RATE24M; -+ break; -+ case MGN_36M: -+ ret = DESC_RATE36M; -+ break; -+ case MGN_48M: -+ ret = DESC_RATE48M; -+ break; -+ case MGN_54M: -+ ret = DESC_RATE54M; -+ break; -+ -+ case MGN_MCS0: -+ ret = DESC_RATEMCS0; -+ break; -+ case MGN_MCS1: -+ ret = DESC_RATEMCS1; -+ break; -+ case MGN_MCS2: -+ ret = DESC_RATEMCS2; -+ break; -+ case MGN_MCS3: -+ ret = DESC_RATEMCS3; -+ break; -+ case MGN_MCS4: -+ ret = DESC_RATEMCS4; -+ break; -+ case MGN_MCS5: -+ ret = DESC_RATEMCS5; -+ break; -+ case MGN_MCS6: -+ ret = DESC_RATEMCS6; -+ break; -+ case MGN_MCS7: -+ ret = DESC_RATEMCS7; -+ break; -+ case MGN_MCS8: -+ ret = DESC_RATEMCS8; -+ break; -+ case MGN_MCS9: -+ ret = DESC_RATEMCS9; -+ break; -+ case MGN_MCS10: -+ ret = DESC_RATEMCS10; -+ break; -+ case MGN_MCS11: -+ ret = DESC_RATEMCS11; -+ break; -+ case MGN_MCS12: -+ ret = DESC_RATEMCS12; -+ break; -+ case MGN_MCS13: -+ ret = DESC_RATEMCS13; -+ break; -+ case MGN_MCS14: -+ ret = DESC_RATEMCS14; -+ break; -+ case MGN_MCS15: -+ ret = DESC_RATEMCS15; -+ break; -+ case MGN_MCS16: -+ ret = DESC_RATEMCS16; -+ break; -+ case MGN_MCS17: -+ ret = DESC_RATEMCS17; -+ break; -+ case MGN_MCS18: -+ ret = DESC_RATEMCS18; -+ break; -+ case MGN_MCS19: -+ ret = DESC_RATEMCS19; -+ break; -+ case MGN_MCS20: -+ ret = DESC_RATEMCS20; -+ break; -+ case MGN_MCS21: -+ ret = DESC_RATEMCS21; -+ break; -+ case MGN_MCS22: -+ ret = DESC_RATEMCS22; -+ break; -+ case MGN_MCS23: -+ ret = DESC_RATEMCS23; -+ break; -+ case MGN_MCS24: -+ ret = DESC_RATEMCS24; -+ break; -+ case MGN_MCS25: -+ ret = DESC_RATEMCS25; -+ break; -+ case MGN_MCS26: -+ ret = DESC_RATEMCS26; -+ break; -+ case MGN_MCS27: -+ ret = DESC_RATEMCS27; -+ break; -+ case MGN_MCS28: -+ ret = DESC_RATEMCS28; -+ break; -+ case MGN_MCS29: -+ ret = DESC_RATEMCS29; -+ break; -+ case MGN_MCS30: -+ ret = DESC_RATEMCS30; -+ break; -+ case MGN_MCS31: -+ ret = DESC_RATEMCS31; -+ break; -+ -+ case MGN_VHT1SS_MCS0: -+ ret = DESC_RATEVHTSS1MCS0; -+ break; -+ case MGN_VHT1SS_MCS1: -+ ret = DESC_RATEVHTSS1MCS1; -+ break; -+ case MGN_VHT1SS_MCS2: -+ ret = DESC_RATEVHTSS1MCS2; -+ break; -+ case MGN_VHT1SS_MCS3: -+ ret = DESC_RATEVHTSS1MCS3; -+ break; -+ case MGN_VHT1SS_MCS4: -+ ret = DESC_RATEVHTSS1MCS4; -+ break; -+ case MGN_VHT1SS_MCS5: -+ ret = DESC_RATEVHTSS1MCS5; -+ break; -+ case MGN_VHT1SS_MCS6: -+ ret = DESC_RATEVHTSS1MCS6; -+ break; -+ case MGN_VHT1SS_MCS7: -+ ret = DESC_RATEVHTSS1MCS7; -+ break; -+ case MGN_VHT1SS_MCS8: -+ ret = DESC_RATEVHTSS1MCS8; -+ break; -+ case MGN_VHT1SS_MCS9: -+ ret = DESC_RATEVHTSS1MCS9; -+ break; -+ case MGN_VHT2SS_MCS0: -+ ret = DESC_RATEVHTSS2MCS0; -+ break; -+ case MGN_VHT2SS_MCS1: -+ ret = DESC_RATEVHTSS2MCS1; -+ break; -+ case MGN_VHT2SS_MCS2: -+ ret = DESC_RATEVHTSS2MCS2; -+ break; -+ case MGN_VHT2SS_MCS3: -+ ret = DESC_RATEVHTSS2MCS3; -+ break; -+ case MGN_VHT2SS_MCS4: -+ ret = DESC_RATEVHTSS2MCS4; -+ break; -+ case MGN_VHT2SS_MCS5: -+ ret = DESC_RATEVHTSS2MCS5; -+ break; -+ case MGN_VHT2SS_MCS6: -+ ret = DESC_RATEVHTSS2MCS6; -+ break; -+ case MGN_VHT2SS_MCS7: -+ ret = DESC_RATEVHTSS2MCS7; -+ break; -+ case MGN_VHT2SS_MCS8: -+ ret = DESC_RATEVHTSS2MCS8; -+ break; -+ case MGN_VHT2SS_MCS9: -+ ret = DESC_RATEVHTSS2MCS9; -+ break; -+ case MGN_VHT3SS_MCS0: -+ ret = DESC_RATEVHTSS3MCS0; -+ break; -+ case MGN_VHT3SS_MCS1: -+ ret = DESC_RATEVHTSS3MCS1; -+ break; -+ case MGN_VHT3SS_MCS2: -+ ret = DESC_RATEVHTSS3MCS2; -+ break; -+ case MGN_VHT3SS_MCS3: -+ ret = DESC_RATEVHTSS3MCS3; -+ break; -+ case MGN_VHT3SS_MCS4: -+ ret = DESC_RATEVHTSS3MCS4; -+ break; -+ case MGN_VHT3SS_MCS5: -+ ret = DESC_RATEVHTSS3MCS5; -+ break; -+ case MGN_VHT3SS_MCS6: -+ ret = DESC_RATEVHTSS3MCS6; -+ break; -+ case MGN_VHT3SS_MCS7: -+ ret = DESC_RATEVHTSS3MCS7; -+ break; -+ case MGN_VHT3SS_MCS8: -+ ret = DESC_RATEVHTSS3MCS8; -+ break; -+ case MGN_VHT3SS_MCS9: -+ ret = DESC_RATEVHTSS3MCS9; -+ break; -+ case MGN_VHT4SS_MCS0: -+ ret = DESC_RATEVHTSS4MCS0; -+ break; -+ case MGN_VHT4SS_MCS1: -+ ret = DESC_RATEVHTSS4MCS1; -+ break; -+ case MGN_VHT4SS_MCS2: -+ ret = DESC_RATEVHTSS4MCS2; -+ break; -+ case MGN_VHT4SS_MCS3: -+ ret = DESC_RATEVHTSS4MCS3; -+ break; -+ case MGN_VHT4SS_MCS4: -+ ret = DESC_RATEVHTSS4MCS4; -+ break; -+ case MGN_VHT4SS_MCS5: -+ ret = DESC_RATEVHTSS4MCS5; -+ break; -+ case MGN_VHT4SS_MCS6: -+ ret = DESC_RATEVHTSS4MCS6; -+ break; -+ case MGN_VHT4SS_MCS7: -+ ret = DESC_RATEVHTSS4MCS7; -+ break; -+ case MGN_VHT4SS_MCS8: -+ ret = DESC_RATEVHTSS4MCS8; -+ break; -+ case MGN_VHT4SS_MCS9: -+ ret = DESC_RATEVHTSS4MCS9; -+ break; -+ default: -+ break; -+ } -+ -+ return ret; -+} -+ -+u8 HwRateToMRate(u8 rate) -+{ -+ u8 ret_rate = MGN_1M; -+ -+ switch (rate) { -+ -+ case DESC_RATE1M: -+ ret_rate = MGN_1M; -+ break; -+ case DESC_RATE2M: -+ ret_rate = MGN_2M; -+ break; -+ case DESC_RATE5_5M: -+ ret_rate = MGN_5_5M; -+ break; -+ case DESC_RATE11M: -+ ret_rate = MGN_11M; -+ break; -+ case DESC_RATE6M: -+ ret_rate = MGN_6M; -+ break; -+ case DESC_RATE9M: -+ ret_rate = MGN_9M; -+ break; -+ case DESC_RATE12M: -+ ret_rate = MGN_12M; -+ break; -+ case DESC_RATE18M: -+ ret_rate = MGN_18M; -+ break; -+ case DESC_RATE24M: -+ ret_rate = MGN_24M; -+ break; -+ case DESC_RATE36M: -+ ret_rate = MGN_36M; -+ break; -+ case DESC_RATE48M: -+ ret_rate = MGN_48M; -+ break; -+ case DESC_RATE54M: -+ ret_rate = MGN_54M; -+ break; -+ case DESC_RATEMCS0: -+ ret_rate = MGN_MCS0; -+ break; -+ case DESC_RATEMCS1: -+ ret_rate = MGN_MCS1; -+ break; -+ case DESC_RATEMCS2: -+ ret_rate = MGN_MCS2; -+ break; -+ case DESC_RATEMCS3: -+ ret_rate = MGN_MCS3; -+ break; -+ case DESC_RATEMCS4: -+ ret_rate = MGN_MCS4; -+ break; -+ case DESC_RATEMCS5: -+ ret_rate = MGN_MCS5; -+ break; -+ case DESC_RATEMCS6: -+ ret_rate = MGN_MCS6; -+ break; -+ case DESC_RATEMCS7: -+ ret_rate = MGN_MCS7; -+ break; -+ case DESC_RATEMCS8: -+ ret_rate = MGN_MCS8; -+ break; -+ case DESC_RATEMCS9: -+ ret_rate = MGN_MCS9; -+ break; -+ case DESC_RATEMCS10: -+ ret_rate = MGN_MCS10; -+ break; -+ case DESC_RATEMCS11: -+ ret_rate = MGN_MCS11; -+ break; -+ case DESC_RATEMCS12: -+ ret_rate = MGN_MCS12; -+ break; -+ case DESC_RATEMCS13: -+ ret_rate = MGN_MCS13; -+ break; -+ case DESC_RATEMCS14: -+ ret_rate = MGN_MCS14; -+ break; -+ case DESC_RATEMCS15: -+ ret_rate = MGN_MCS15; -+ break; -+ case DESC_RATEMCS16: -+ ret_rate = MGN_MCS16; -+ break; -+ case DESC_RATEMCS17: -+ ret_rate = MGN_MCS17; -+ break; -+ case DESC_RATEMCS18: -+ ret_rate = MGN_MCS18; -+ break; -+ case DESC_RATEMCS19: -+ ret_rate = MGN_MCS19; -+ break; -+ case DESC_RATEMCS20: -+ ret_rate = MGN_MCS20; -+ break; -+ case DESC_RATEMCS21: -+ ret_rate = MGN_MCS21; -+ break; -+ case DESC_RATEMCS22: -+ ret_rate = MGN_MCS22; -+ break; -+ case DESC_RATEMCS23: -+ ret_rate = MGN_MCS23; -+ break; -+ case DESC_RATEMCS24: -+ ret_rate = MGN_MCS24; -+ break; -+ case DESC_RATEMCS25: -+ ret_rate = MGN_MCS25; -+ break; -+ case DESC_RATEMCS26: -+ ret_rate = MGN_MCS26; -+ break; -+ case DESC_RATEMCS27: -+ ret_rate = MGN_MCS27; -+ break; -+ case DESC_RATEMCS28: -+ ret_rate = MGN_MCS28; -+ break; -+ case DESC_RATEMCS29: -+ ret_rate = MGN_MCS29; -+ break; -+ case DESC_RATEMCS30: -+ ret_rate = MGN_MCS30; -+ break; -+ case DESC_RATEMCS31: -+ ret_rate = MGN_MCS31; -+ break; -+ case DESC_RATEVHTSS1MCS0: -+ ret_rate = MGN_VHT1SS_MCS0; -+ break; -+ case DESC_RATEVHTSS1MCS1: -+ ret_rate = MGN_VHT1SS_MCS1; -+ break; -+ case DESC_RATEVHTSS1MCS2: -+ ret_rate = MGN_VHT1SS_MCS2; -+ break; -+ case DESC_RATEVHTSS1MCS3: -+ ret_rate = MGN_VHT1SS_MCS3; -+ break; -+ case DESC_RATEVHTSS1MCS4: -+ ret_rate = MGN_VHT1SS_MCS4; -+ break; -+ case DESC_RATEVHTSS1MCS5: -+ ret_rate = MGN_VHT1SS_MCS5; -+ break; -+ case DESC_RATEVHTSS1MCS6: -+ ret_rate = MGN_VHT1SS_MCS6; -+ break; -+ case DESC_RATEVHTSS1MCS7: -+ ret_rate = MGN_VHT1SS_MCS7; -+ break; -+ case DESC_RATEVHTSS1MCS8: -+ ret_rate = MGN_VHT1SS_MCS8; -+ break; -+ case DESC_RATEVHTSS1MCS9: -+ ret_rate = MGN_VHT1SS_MCS9; -+ break; -+ case DESC_RATEVHTSS2MCS0: -+ ret_rate = MGN_VHT2SS_MCS0; -+ break; -+ case DESC_RATEVHTSS2MCS1: -+ ret_rate = MGN_VHT2SS_MCS1; -+ break; -+ case DESC_RATEVHTSS2MCS2: -+ ret_rate = MGN_VHT2SS_MCS2; -+ break; -+ case DESC_RATEVHTSS2MCS3: -+ ret_rate = MGN_VHT2SS_MCS3; -+ break; -+ case DESC_RATEVHTSS2MCS4: -+ ret_rate = MGN_VHT2SS_MCS4; -+ break; -+ case DESC_RATEVHTSS2MCS5: -+ ret_rate = MGN_VHT2SS_MCS5; -+ break; -+ case DESC_RATEVHTSS2MCS6: -+ ret_rate = MGN_VHT2SS_MCS6; -+ break; -+ case DESC_RATEVHTSS2MCS7: -+ ret_rate = MGN_VHT2SS_MCS7; -+ break; -+ case DESC_RATEVHTSS2MCS8: -+ ret_rate = MGN_VHT2SS_MCS8; -+ break; -+ case DESC_RATEVHTSS2MCS9: -+ ret_rate = MGN_VHT2SS_MCS9; -+ break; -+ case DESC_RATEVHTSS3MCS0: -+ ret_rate = MGN_VHT3SS_MCS0; -+ break; -+ case DESC_RATEVHTSS3MCS1: -+ ret_rate = MGN_VHT3SS_MCS1; -+ break; -+ case DESC_RATEVHTSS3MCS2: -+ ret_rate = MGN_VHT3SS_MCS2; -+ break; -+ case DESC_RATEVHTSS3MCS3: -+ ret_rate = MGN_VHT3SS_MCS3; -+ break; -+ case DESC_RATEVHTSS3MCS4: -+ ret_rate = MGN_VHT3SS_MCS4; -+ break; -+ case DESC_RATEVHTSS3MCS5: -+ ret_rate = MGN_VHT3SS_MCS5; -+ break; -+ case DESC_RATEVHTSS3MCS6: -+ ret_rate = MGN_VHT3SS_MCS6; -+ break; -+ case DESC_RATEVHTSS3MCS7: -+ ret_rate = MGN_VHT3SS_MCS7; -+ break; -+ case DESC_RATEVHTSS3MCS8: -+ ret_rate = MGN_VHT3SS_MCS8; -+ break; -+ case DESC_RATEVHTSS3MCS9: -+ ret_rate = MGN_VHT3SS_MCS9; -+ break; -+ case DESC_RATEVHTSS4MCS0: -+ ret_rate = MGN_VHT4SS_MCS0; -+ break; -+ case DESC_RATEVHTSS4MCS1: -+ ret_rate = MGN_VHT4SS_MCS1; -+ break; -+ case DESC_RATEVHTSS4MCS2: -+ ret_rate = MGN_VHT4SS_MCS2; -+ break; -+ case DESC_RATEVHTSS4MCS3: -+ ret_rate = MGN_VHT4SS_MCS3; -+ break; -+ case DESC_RATEVHTSS4MCS4: -+ ret_rate = MGN_VHT4SS_MCS4; -+ break; -+ case DESC_RATEVHTSS4MCS5: -+ ret_rate = MGN_VHT4SS_MCS5; -+ break; -+ case DESC_RATEVHTSS4MCS6: -+ ret_rate = MGN_VHT4SS_MCS6; -+ break; -+ case DESC_RATEVHTSS4MCS7: -+ ret_rate = MGN_VHT4SS_MCS7; -+ break; -+ case DESC_RATEVHTSS4MCS8: -+ ret_rate = MGN_VHT4SS_MCS8; -+ break; -+ case DESC_RATEVHTSS4MCS9: -+ ret_rate = MGN_VHT4SS_MCS9; -+ break; -+ -+ default: -+ RTW_INFO("HwRateToMRate(): Non supported Rate [%x]!!!\n", rate); -+ break; -+ } -+ -+ return ret_rate; -+} -+ -+void HalSetBrateCfg( -+ IN PADAPTER Adapter, -+ IN u8 *mBratesOS, -+ OUT u16 *pBrateCfg) -+{ -+ u8 i, is_brate, brate; -+ -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ is_brate = mBratesOS[i] & IEEE80211_BASIC_RATE_MASK; -+ brate = mBratesOS[i] & 0x7f; -+ -+ if (is_brate) { -+ switch (brate) { -+ case IEEE80211_CCK_RATE_1MB: -+ *pBrateCfg |= RATE_1M; -+ break; -+ case IEEE80211_CCK_RATE_2MB: -+ *pBrateCfg |= RATE_2M; -+ break; -+ case IEEE80211_CCK_RATE_5MB: -+ *pBrateCfg |= RATE_5_5M; -+ break; -+ case IEEE80211_CCK_RATE_11MB: -+ *pBrateCfg |= RATE_11M; -+ break; -+ case IEEE80211_OFDM_RATE_6MB: -+ *pBrateCfg |= RATE_6M; -+ break; -+ case IEEE80211_OFDM_RATE_9MB: -+ *pBrateCfg |= RATE_9M; -+ break; -+ case IEEE80211_OFDM_RATE_12MB: -+ *pBrateCfg |= RATE_12M; -+ break; -+ case IEEE80211_OFDM_RATE_18MB: -+ *pBrateCfg |= RATE_18M; -+ break; -+ case IEEE80211_OFDM_RATE_24MB: -+ *pBrateCfg |= RATE_24M; -+ break; -+ case IEEE80211_OFDM_RATE_36MB: -+ *pBrateCfg |= RATE_36M; -+ break; -+ case IEEE80211_OFDM_RATE_48MB: -+ *pBrateCfg |= RATE_48M; -+ break; -+ case IEEE80211_OFDM_RATE_54MB: -+ *pBrateCfg |= RATE_54M; -+ break; -+ } -+ } -+ } -+} -+ -+static VOID -+_OneOutPipeMapping( -+ IN PADAPTER pAdapter -+) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];/* VI */ -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[0];/* BE */ -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[0];/* BK */ -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ -+} -+ -+static VOID -+_TwoOutPipeMapping( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bWIFICfg -+) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); -+ -+ if (bWIFICfg) { /* WMM */ -+ -+ /* BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA */ -+ /* { 0, 1, 0, 1, 0, 0, 0, 0, 0 }; */ -+ /* 0:ep_0 num, 1:ep_1 num */ -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[1];/* VO */ -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];/* VI */ -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[1];/* BE */ -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[0];/* BK */ -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ -+ -+ } else { /* typical setting */ -+ -+ -+ /* BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA */ -+ /* { 1, 1, 0, 0, 0, 0, 0, 0, 0 }; */ -+ /* 0:ep_0 num, 1:ep_1 num */ -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];/* VI */ -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[1];/* BE */ -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];/* BK */ -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ -+ -+ } -+ -+} -+ -+static VOID _ThreeOutPipeMapping( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bWIFICfg -+) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); -+ -+ if (bWIFICfg) { /* for WMM */ -+ -+ /* BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA */ -+ /* { 1, 2, 1, 0, 0, 0, 0, 0, 0 }; */ -+ /* 0:H, 1:N, 2:L */ -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];/* VI */ -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];/* BE */ -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];/* BK */ -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ -+ -+ } else { /* typical setting */ -+ -+ -+ /* BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA */ -+ /* { 2, 2, 1, 0, 0, 0, 0, 0, 0 }; */ -+ /* 0:H, 1:N, 2:L */ -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];/* VI */ -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];/* BE */ -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[2];/* BK */ -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];/* HIGH */ -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ -+ } -+ -+} -+static VOID _FourOutPipeMapping( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bWIFICfg -+) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); -+ -+ if (bWIFICfg) { /* for WMM */ -+ -+ /* BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA */ -+ /* { 1, 2, 1, 0, 0, 0, 0, 0, 0 }; */ -+ /* 0:H, 1:N, 2:L ,3:E */ -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];/* VI */ -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];/* BE */ -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];/* BK */ -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[3];/* HIGH */ -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ -+ -+ } else { /* typical setting */ -+ -+ -+ /* BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA */ -+ /* { 2, 2, 1, 0, 0, 0, 0, 0, 0 }; */ -+ /* 0:H, 1:N, 2:L */ -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];/* VO */ -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];/* VI */ -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];/* BE */ -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[2];/* BK */ -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];/* BCN */ -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];/* MGT */ -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[3];/* HIGH */ -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ -+ } -+ -+} -+BOOLEAN -+Hal_MappingOutPipe( -+ IN PADAPTER pAdapter, -+ IN u8 NumOutPipe -+) -+{ -+ struct registry_priv *pregistrypriv = &pAdapter->registrypriv; -+ -+ BOOLEAN bWIFICfg = (pregistrypriv->wifi_spec) ? _TRUE : _FALSE; -+ -+ BOOLEAN result = _TRUE; -+ -+ switch (NumOutPipe) { -+ case 2: -+ _TwoOutPipeMapping(pAdapter, bWIFICfg); -+ break; -+ case 3: -+ case 4: -+ _ThreeOutPipeMapping(pAdapter, bWIFICfg); -+ break; -+ case 1: -+ _OneOutPipeMapping(pAdapter); -+ break; -+ default: -+ result = _FALSE; -+ break; -+ } -+ -+ return result; -+ -+} -+ -+void rtw_hal_dump_macaddr(void *sel, _adapter *adapter) -+{ -+ int i; -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 mac_addr[ETH_ALEN]; -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_mbid_cam_dump(sel, __func__, adapter); -+#else -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface) { -+ rtw_hal_get_macaddr_port(iface, mac_addr); -+ RTW_PRINT_SEL(sel, ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", -+ ADPT_ARG(iface), iface->hw_port, MAC_ARG(mac_addr)); -+ } -+ } -+#endif -+} -+ -+void rtw_restore_mac_addr(_adapter *adapter) -+{ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ rtw_mbid_cam_restore(adapter); -+#else -+ int i; -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface) -+ rtw_hal_set_macaddr_port(iface, adapter_mac_addr(iface)); -+ } -+#endif -+ if (1) -+ rtw_hal_dump_macaddr(RTW_DBGDUMP, adapter); -+} -+ -+void rtw_init_hal_com_default_value(PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ struct registry_priv *regsty = adapter_to_regsty(Adapter); -+ -+ pHalData->AntDetection = 1; -+ pHalData->u1ForcedIgiLb = regsty->force_igi_lb; -+} -+ -+#ifdef CONFIG_FW_C2H_REG -+void c2h_evt_clear(_adapter *adapter) -+{ -+ rtw_write8(adapter, REG_C2HEVT_CLEAR, C2H_EVT_HOST_CLOSE); -+} -+ -+s32 c2h_evt_read_88xx(_adapter *adapter, u8 *buf) -+{ -+ s32 ret = _FAIL; -+ int i; -+ u8 trigger; -+ -+ if (buf == NULL) -+ goto exit; -+ -+ trigger = rtw_read8(adapter, REG_C2HEVT_CLEAR); -+ -+ if (trigger == C2H_EVT_HOST_CLOSE) { -+ goto exit; /* Not ready */ -+ } else if (trigger != C2H_EVT_FW_CLOSE) { -+ goto clear_evt; /* Not a valid value */ -+ } -+ -+ _rtw_memset(buf, 0, C2H_REG_LEN); -+ -+ /* Read ID, LEN, SEQ */ -+ SET_C2H_ID_88XX(buf, rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL)); -+ SET_C2H_SEQ_88XX(buf, rtw_read8(adapter, REG_C2HEVT_CMD_SEQ_88XX)); -+ SET_C2H_PLEN_88XX(buf, rtw_read8(adapter, REG_C2HEVT_CMD_LEN_88XX)); -+ -+ if (0) { -+ RTW_INFO("%s id=0x%02x, seq=%u, plen=%u, trigger=0x%02x\n", __func__ -+ , C2H_ID_88XX(buf), C2H_SEQ_88XX(buf), C2H_PLEN_88XX(buf), trigger); -+ } -+ -+ /* Read the content */ -+ for (i = 0; i < C2H_PLEN_88XX(buf); i++) -+ *(C2H_PAYLOAD_88XX(buf) + i) = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + 2 + i); -+ -+ RTW_DBG_DUMP("payload:\n", C2H_PAYLOAD_88XX(buf), C2H_PLEN_88XX(buf)); -+ -+ ret = _SUCCESS; -+ -+clear_evt: -+ /* -+ * Clear event to notify FW we have read the command. -+ * If this field isn't clear, the FW won't update the next command message. -+ */ -+ c2h_evt_clear(adapter); -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_FW_C2H_REG */ -+ -+#ifdef CONFIG_FW_C2H_PKT -+#ifndef DBG_C2H_PKT_PRE_HDL -+#define DBG_C2H_PKT_PRE_HDL 0 -+#endif -+#ifndef DBG_C2H_PKT_HDL -+#define DBG_C2H_PKT_HDL 0 -+#endif -+void rtw_hal_c2h_pkt_pre_hdl(_adapter *adapter, u8 *buf, u16 len) -+{ -+#ifdef RTW_HALMAC -+ /* TODO: extract hal_mac IC's code here*/ -+#else -+ u8 parse_fail = 0; -+ u8 hdl_here = 0; -+ s32 ret = _FAIL; -+ u8 id, seq, plen; -+ u8 *payload; -+ -+ if (rtw_hal_c2h_pkt_hdr_parse(adapter, buf, len, &id, &seq, &plen, &payload) != _SUCCESS) { -+ parse_fail = 1; -+ goto exit; -+ } -+ -+ hdl_here = rtw_hal_c2h_id_handle_directly(adapter, id, seq, plen, payload) == _TRUE ? 1 : 0; -+ if (hdl_here) -+ ret = rtw_hal_c2h_handler(adapter, id, seq, plen, payload); -+ else -+ ret = rtw_c2h_packet_wk_cmd(adapter, buf, len); -+ -+exit: -+ if (parse_fail) -+ RTW_ERR("%s parse fail, buf=%p, len=:%u\n", __func__, buf, len); -+ else if (ret != _SUCCESS || DBG_C2H_PKT_PRE_HDL > 0) { -+ RTW_PRINT("%s: id=0x%02x, seq=%u, plen=%u, %s %s\n", __func__, id, seq, plen -+ , hdl_here ? "handle" : "enqueue" -+ , ret == _SUCCESS ? "ok" : "fail" -+ ); -+ if (DBG_C2H_PKT_PRE_HDL >= 2) -+ RTW_PRINT_DUMP("dump: ", buf, len); -+ } -+#endif -+} -+ -+void rtw_hal_c2h_pkt_hdl(_adapter *adapter, u8 *buf, u16 len) -+{ -+#ifdef RTW_HALMAC -+ adapter->HalFunc.hal_mac_c2h_handler(adapter, buf, len); -+#else -+ u8 parse_fail = 0; -+ u8 bypass = 0; -+ s32 ret = _FAIL; -+ u8 id, seq, plen; -+ u8 *payload; -+ -+ if (rtw_hal_c2h_pkt_hdr_parse(adapter, buf, len, &id, &seq, &plen, &payload) != _SUCCESS) { -+ parse_fail = 1; -+ goto exit; -+ } -+ -+#ifdef CONFIG_WOWLAN -+ if (adapter_to_pwrctl(adapter)->wowlan_mode == _TRUE) { -+ bypass = 1; -+ ret = _SUCCESS; -+ goto exit; -+ } -+#endif -+ -+ ret = rtw_hal_c2h_handler(adapter, id, seq, plen, payload); -+ -+exit: -+ if (parse_fail) -+ RTW_ERR("%s parse fail, buf=%p, len=:%u\n", __func__, buf, len); -+ else if (ret != _SUCCESS || bypass || DBG_C2H_PKT_HDL > 0) { -+ RTW_PRINT("%s: id=0x%02x, seq=%u, plen=%u, %s %s\n", __func__, id, seq, plen -+ , !bypass ? "handle" : "bypass" -+ , ret == _SUCCESS ? "ok" : "fail" -+ ); -+ if (DBG_C2H_PKT_HDL >= 2) -+ RTW_PRINT_DUMP("dump: ", buf, len); -+ } -+#endif -+} -+#endif /* CONFIG_FW_C2H_PKT */ -+ -+void c2h_iqk_offload(_adapter *adapter, u8 *data, u8 len) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct submit_ctx *iqk_sctx = &hal_data->iqk_sctx; -+ -+ RTW_INFO("IQK offload finish in %dms\n", rtw_get_passing_time_ms(iqk_sctx->submit_time)); -+ if (0) -+ RTW_INFO_DUMP("C2H_IQK_FINISH: ", data, len); -+ -+ rtw_sctx_done(&iqk_sctx); -+} -+ -+int c2h_iqk_offload_wait(_adapter *adapter, u32 timeout_ms) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct submit_ctx *iqk_sctx = &hal_data->iqk_sctx; -+ -+ iqk_sctx->submit_time = rtw_get_current_time(); -+ iqk_sctx->timeout_ms = timeout_ms; -+ iqk_sctx->status = RTW_SCTX_SUBMITTED; -+ -+ return rtw_sctx_wait(iqk_sctx, __func__); -+} -+ -+#define GET_C2H_MAC_HIDDEN_RPT_UUID_X(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 0, 0, 8) -+#define GET_C2H_MAC_HIDDEN_RPT_UUID_Y(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 1, 0, 8) -+#define GET_C2H_MAC_HIDDEN_RPT_UUID_Z(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 2, 0, 5) -+#define GET_C2H_MAC_HIDDEN_RPT_UUID_CRC(_data) LE_BITS_TO_2BYTE(((u8 *)(_data)) + 2, 5, 11) -+#define GET_C2H_MAC_HIDDEN_RPT_HCI_TYPE(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 4, 0, 4) -+#define GET_C2H_MAC_HIDDEN_RPT_PACKAGE_TYPE(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 4, 4, 3) -+#define GET_C2H_MAC_HIDDEN_RPT_TR_SWITCH(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 4, 7, 1) -+#define GET_C2H_MAC_HIDDEN_RPT_WL_FUNC(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 5, 0, 4) -+#define GET_C2H_MAC_HIDDEN_RPT_HW_STYPE(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 5, 4, 4) -+#define GET_C2H_MAC_HIDDEN_RPT_BW(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 0, 3) -+#define GET_C2H_MAC_HIDDEN_RPT_FAB(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 3, 2) -+#define GET_C2H_MAC_HIDDEN_RPT_ANT_NUM(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 5, 3) -+#define GET_C2H_MAC_HIDDEN_RPT_80211_PROTOCOL(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 7, 2, 2) -+#define GET_C2H_MAC_HIDDEN_RPT_NIC_ROUTER(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 7, 6, 2) -+ -+#ifndef DBG_C2H_MAC_HIDDEN_RPT_HANDLE -+#define DBG_C2H_MAC_HIDDEN_RPT_HANDLE 0 -+#endif -+ -+#ifdef CONFIG_RTW_MAC_HIDDEN_RPT -+int c2h_mac_hidden_rpt_hdl(_adapter *adapter, u8 *data, u8 len) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ int ret = _FAIL; -+ -+ u32 uuid; -+ u8 uuid_x; -+ u8 uuid_y; -+ u8 uuid_z; -+ u16 uuid_crc; -+ -+ u8 hci_type; -+ u8 package_type; -+ u8 tr_switch; -+ u8 wl_func; -+ u8 hw_stype; -+ u8 bw; -+ u8 fab; -+ u8 ant_num; -+ u8 protocol; -+ u8 nic; -+ -+ int i; -+ -+ if (len < MAC_HIDDEN_RPT_LEN) { -+ RTW_WARN("%s len(%u) < %d\n", __func__, len, MAC_HIDDEN_RPT_LEN); -+ goto exit; -+ } -+ -+ uuid_x = GET_C2H_MAC_HIDDEN_RPT_UUID_X(data); -+ uuid_y = GET_C2H_MAC_HIDDEN_RPT_UUID_Y(data); -+ uuid_z = GET_C2H_MAC_HIDDEN_RPT_UUID_Z(data); -+ uuid_crc = GET_C2H_MAC_HIDDEN_RPT_UUID_CRC(data); -+ -+ hci_type = GET_C2H_MAC_HIDDEN_RPT_HCI_TYPE(data); -+ package_type = GET_C2H_MAC_HIDDEN_RPT_PACKAGE_TYPE(data); -+ -+ tr_switch = GET_C2H_MAC_HIDDEN_RPT_TR_SWITCH(data); -+ -+ wl_func = GET_C2H_MAC_HIDDEN_RPT_WL_FUNC(data); -+ hw_stype = GET_C2H_MAC_HIDDEN_RPT_HW_STYPE(data); -+ -+ bw = GET_C2H_MAC_HIDDEN_RPT_BW(data); -+ fab = GET_C2H_MAC_HIDDEN_RPT_FAB(data); -+ ant_num = GET_C2H_MAC_HIDDEN_RPT_ANT_NUM(data); -+ -+ protocol = GET_C2H_MAC_HIDDEN_RPT_80211_PROTOCOL(data); -+ nic = GET_C2H_MAC_HIDDEN_RPT_NIC_ROUTER(data); -+ -+ if (DBG_C2H_MAC_HIDDEN_RPT_HANDLE) { -+ for (i = 0; i < len; i++) -+ RTW_PRINT("%s: 0x%02X\n", __func__, *(data + i)); -+ -+ RTW_PRINT("uuid x:0x%02x y:0x%02x z:0x%x crc:0x%x\n", uuid_x, uuid_y, uuid_z, uuid_crc); -+ RTW_PRINT("hci_type:0x%x\n", hci_type); -+ RTW_PRINT("package_type:0x%x\n", package_type); -+ RTW_PRINT("tr_switch:0x%x\n", tr_switch); -+ RTW_PRINT("wl_func:0x%x\n", wl_func); -+ RTW_PRINT("hw_stype:0x%x\n", hw_stype); -+ RTW_PRINT("bw:0x%x\n", bw); -+ RTW_PRINT("fab:0x%x\n", fab); -+ RTW_PRINT("ant_num:0x%x\n", ant_num); -+ RTW_PRINT("protocol:0x%x\n", protocol); -+ RTW_PRINT("nic:0x%x\n", nic); -+ } -+ -+ /* -+ * NOTICE: -+ * for now, the following is common info/format -+ * if there is any hal difference need to export -+ * some IC dependent code will need to be implement -+ */ -+ hal_data->PackageType = package_type; -+ hal_spec->wl_func &= mac_hidden_wl_func_to_hal_wl_func(wl_func); -+ hal_spec->bw_cap &= mac_hidden_max_bw_to_hal_bw_cap(bw); -+ hal_spec->nss_num = rtw_min(hal_spec->nss_num, ant_num); -+ hal_spec->proto_cap &= mac_hidden_proto_to_hal_proto_cap(protocol); -+ -+ /* TODO: tr_switch */ -+ /* TODO: fab */ -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+int c2h_mac_hidden_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ int ret = _FAIL; -+ -+ int i; -+ -+ if (len < MAC_HIDDEN_RPT_2_LEN) { -+ RTW_WARN("%s len(%u) < %d\n", __func__, len, MAC_HIDDEN_RPT_2_LEN); -+ goto exit; -+ } -+ -+ if (DBG_C2H_MAC_HIDDEN_RPT_HANDLE) { -+ for (i = 0; i < len; i++) -+ RTW_PRINT("%s: 0x%02X\n", __func__, *(data + i)); -+ } -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+int hal_read_mac_hidden_rpt(_adapter *adapter) -+{ -+ int ret = _FAIL; -+ int ret_fwdl; -+ u8 mac_hidden_rpt[MAC_HIDDEN_RPT_LEN + MAC_HIDDEN_RPT_2_LEN] = {0}; -+ u32 start = rtw_get_current_time(); -+ u32 cnt = 0; -+ u32 timeout_ms = 800; -+ u32 min_cnt = 10; -+ u8 id = C2H_DEFEATURE_RSVD; -+ int i; -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) -+ u8 hci_type = rtw_get_intf_type(adapter); -+ -+ if ((hci_type == RTW_USB || hci_type == RTW_PCIE) -+ && !rtw_is_hw_init_completed(adapter)) -+ rtw_hal_power_on(adapter); -+#endif -+ -+ /* inform FW mac hidden rpt from reg is needed */ -+ rtw_write8(adapter, REG_C2HEVT_MSG_NORMAL, C2H_DEFEATURE_RSVD); -+ -+ /* download FW */ -+ ret_fwdl = rtw_hal_fw_dl(adapter, _FALSE); -+ if (ret_fwdl != _SUCCESS) -+ goto mac_hidden_rpt_hdl; -+ -+ /* polling for data ready */ -+ start = rtw_get_current_time(); -+ do { -+ cnt++; -+ id = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL); -+ if (id == C2H_MAC_HIDDEN_RPT || RTW_CANNOT_IO(adapter)) -+ break; -+ rtw_msleep_os(10); -+ } while (rtw_get_passing_time_ms(start) < timeout_ms || cnt < min_cnt); -+ -+ if (id == C2H_MAC_HIDDEN_RPT) { -+ /* read data */ -+ for (i = 0; i < MAC_HIDDEN_RPT_LEN + MAC_HIDDEN_RPT_2_LEN; i++) -+ mac_hidden_rpt[i] = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + 2 + i); -+ } -+ -+ /* inform FW mac hidden rpt has read */ -+ rtw_write8(adapter, REG_C2HEVT_MSG_NORMAL, C2H_DBG); -+ -+mac_hidden_rpt_hdl: -+ c2h_mac_hidden_rpt_hdl(adapter, mac_hidden_rpt, MAC_HIDDEN_RPT_LEN); -+ c2h_mac_hidden_rpt_2_hdl(adapter, mac_hidden_rpt + MAC_HIDDEN_RPT_LEN, MAC_HIDDEN_RPT_2_LEN); -+ -+ if (ret_fwdl == _SUCCESS && id == C2H_MAC_HIDDEN_RPT) -+ ret = _SUCCESS; -+ -+exit: -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) -+ if ((hci_type == RTW_USB || hci_type == RTW_PCIE) -+ && !rtw_is_hw_init_completed(adapter)) -+ rtw_hal_power_off(adapter); -+#endif -+ -+ RTW_INFO("%s %s! (%u, %dms), fwdl:%d, id:0x%02x\n", __func__ -+ , (ret == _SUCCESS) ? "OK" : "Fail", cnt, rtw_get_passing_time_ms(start), ret_fwdl, id); -+ -+ return ret; -+} -+#endif /* CONFIG_RTW_MAC_HIDDEN_RPT */ -+ -+int c2h_defeature_dbg_hdl(_adapter *adapter, u8 *data, u8 len) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ int ret = _FAIL; -+ -+ int i; -+ -+ if (len < DEFEATURE_DBG_LEN) { -+ RTW_WARN("%s len(%u) < %d\n", __func__, len, DEFEATURE_DBG_LEN); -+ goto exit; -+ } -+ -+ for (i = 0; i < len; i++) -+ RTW_PRINT("%s: 0x%02X\n", __func__, *(data + i)); -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+#ifndef DBG_CUSTOMER_STR_RPT_HANDLE -+#define DBG_CUSTOMER_STR_RPT_HANDLE 0 -+#endif -+ -+#ifdef CONFIG_RTW_CUSTOMER_STR -+s32 rtw_hal_h2c_customer_str_req(_adapter *adapter) -+{ -+ u8 h2c_data[H2C_CUSTOMER_STR_REQ_LEN] = {0}; -+ -+ SET_H2CCMD_CUSTOMER_STR_REQ_EN(h2c_data, 1); -+ return rtw_hal_fill_h2c_cmd(adapter, H2C_CUSTOMER_STR_REQ, H2C_CUSTOMER_STR_REQ_LEN, h2c_data); -+} -+ -+#define C2H_CUSTOMER_STR_RPT_BYTE0(_data) ((u8 *)(_data)) -+#define C2H_CUSTOMER_STR_RPT_2_BYTE8(_data) ((u8 *)(_data)) -+ -+int c2h_customer_str_rpt_hdl(_adapter *adapter, u8 *data, u8 len) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ int ret = _FAIL; -+ int i; -+ -+ if (len < CUSTOMER_STR_RPT_LEN) { -+ RTW_WARN("%s len(%u) < %d\n", __func__, len, CUSTOMER_STR_RPT_LEN); -+ goto exit; -+ } -+ -+ if (DBG_CUSTOMER_STR_RPT_HANDLE) -+ RTW_PRINT_DUMP("customer_str_rpt: ", data, CUSTOMER_STR_RPT_LEN); -+ -+ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ -+ if (dvobj->customer_str_sctx != NULL) { -+ if (dvobj->customer_str_sctx->status != RTW_SCTX_SUBMITTED) -+ RTW_WARN("%s invalid sctx.status:%d\n", __func__, dvobj->customer_str_sctx->status); -+ _rtw_memcpy(dvobj->customer_str, C2H_CUSTOMER_STR_RPT_BYTE0(data), CUSTOMER_STR_RPT_LEN); -+ dvobj->customer_str_sctx->status = RTX_SCTX_CSTR_WAIT_RPT2; -+ } else -+ RTW_WARN("%s sctx not set\n", __func__); -+ -+ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+int c2h_customer_str_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ int ret = _FAIL; -+ int i; -+ -+ if (len < CUSTOMER_STR_RPT_2_LEN) { -+ RTW_WARN("%s len(%u) < %d\n", __func__, len, CUSTOMER_STR_RPT_2_LEN); -+ goto exit; -+ } -+ -+ if (DBG_CUSTOMER_STR_RPT_HANDLE) -+ RTW_PRINT_DUMP("customer_str_rpt_2: ", data, CUSTOMER_STR_RPT_2_LEN); -+ -+ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ -+ if (dvobj->customer_str_sctx != NULL) { -+ if (dvobj->customer_str_sctx->status != RTX_SCTX_CSTR_WAIT_RPT2) -+ RTW_WARN("%s rpt not ready\n", __func__); -+ _rtw_memcpy(dvobj->customer_str + CUSTOMER_STR_RPT_LEN, C2H_CUSTOMER_STR_RPT_2_BYTE8(data), CUSTOMER_STR_RPT_2_LEN); -+ rtw_sctx_done(&dvobj->customer_str_sctx); -+ } else -+ RTW_WARN("%s sctx not set\n", __func__); -+ -+ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+/* read customer str */ -+s32 rtw_hal_customer_str_read(_adapter *adapter, u8 *cs) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct submit_ctx sctx; -+ s32 ret = _SUCCESS; -+ -+ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ if (dvobj->customer_str_sctx != NULL) -+ ret = _FAIL; -+ else { -+ rtw_sctx_init(&sctx, 2 * 1000); -+ dvobj->customer_str_sctx = &sctx; -+ } -+ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ -+ if (ret == _FAIL) { -+ RTW_WARN("%s another handle ongoing\n", __func__); -+ goto exit; -+ } -+ -+ ret = rtw_customer_str_req_cmd(adapter); -+ if (ret != _SUCCESS) { -+ RTW_WARN("%s read cmd fail\n", __func__); -+ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ dvobj->customer_str_sctx = NULL; -+ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ goto exit; -+ } -+ -+ /* wait till rpt done or timeout */ -+ rtw_sctx_wait(&sctx, __func__); -+ -+ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ dvobj->customer_str_sctx = NULL; -+ if (sctx.status == RTW_SCTX_DONE_SUCCESS) -+ _rtw_memcpy(cs, dvobj->customer_str, RTW_CUSTOMER_STR_LEN); -+ else -+ ret = _FAIL; -+ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ -+exit: -+ return ret; -+} -+ -+s32 rtw_hal_h2c_customer_str_write(_adapter *adapter, const u8 *cs) -+{ -+ u8 h2c_data_w1[H2C_CUSTOMER_STR_W1_LEN] = {0}; -+ u8 h2c_data_w2[H2C_CUSTOMER_STR_W2_LEN] = {0}; -+ u8 h2c_data_w3[H2C_CUSTOMER_STR_W3_LEN] = {0}; -+ s32 ret; -+ -+ SET_H2CCMD_CUSTOMER_STR_W1_EN(h2c_data_w1, 1); -+ _rtw_memcpy(H2CCMD_CUSTOMER_STR_W1_BYTE0(h2c_data_w1), cs, 6); -+ -+ SET_H2CCMD_CUSTOMER_STR_W2_EN(h2c_data_w2, 1); -+ _rtw_memcpy(H2CCMD_CUSTOMER_STR_W2_BYTE6(h2c_data_w2), cs + 6, 6); -+ -+ SET_H2CCMD_CUSTOMER_STR_W3_EN(h2c_data_w3, 1); -+ _rtw_memcpy(H2CCMD_CUSTOMER_STR_W3_BYTE12(h2c_data_w3), cs + 6 + 6, 4); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_CUSTOMER_STR_W1, H2C_CUSTOMER_STR_W1_LEN, h2c_data_w1); -+ if (ret != _SUCCESS) { -+ RTW_WARN("%s w1 fail\n", __func__); -+ goto exit; -+ } -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_CUSTOMER_STR_W2, H2C_CUSTOMER_STR_W2_LEN, h2c_data_w2); -+ if (ret != _SUCCESS) { -+ RTW_WARN("%s w2 fail\n", __func__); -+ goto exit; -+ } -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_CUSTOMER_STR_W3, H2C_CUSTOMER_STR_W3_LEN, h2c_data_w3); -+ if (ret != _SUCCESS) { -+ RTW_WARN("%s w3 fail\n", __func__); -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+/* write customer str and check if value reported is the same as requested */ -+s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct submit_ctx sctx; -+ s32 ret = _SUCCESS; -+ -+ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ if (dvobj->customer_str_sctx != NULL) -+ ret = _FAIL; -+ else { -+ rtw_sctx_init(&sctx, 2 * 1000); -+ dvobj->customer_str_sctx = &sctx; -+ } -+ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ -+ if (ret == _FAIL) { -+ RTW_WARN("%s another handle ongoing\n", __func__); -+ goto exit; -+ } -+ -+ ret = rtw_customer_str_write_cmd(adapter, cs); -+ if (ret != _SUCCESS) { -+ RTW_WARN("%s write cmd fail\n", __func__); -+ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ dvobj->customer_str_sctx = NULL; -+ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ goto exit; -+ } -+ -+ ret = rtw_customer_str_req_cmd(adapter); -+ if (ret != _SUCCESS) { -+ RTW_WARN("%s read cmd fail\n", __func__); -+ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ dvobj->customer_str_sctx = NULL; -+ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ goto exit; -+ } -+ -+ /* wait till rpt done or timeout */ -+ rtw_sctx_wait(&sctx, __func__); -+ -+ _enter_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ dvobj->customer_str_sctx = NULL; -+ if (sctx.status == RTW_SCTX_DONE_SUCCESS) { -+ if (_rtw_memcmp(cs, dvobj->customer_str, RTW_CUSTOMER_STR_LEN) != _TRUE) { -+ RTW_WARN("%s read back check fail\n", __func__); -+ RTW_INFO_DUMP("write req: ", cs, RTW_CUSTOMER_STR_LEN); -+ RTW_INFO_DUMP("read back: ", dvobj->customer_str, RTW_CUSTOMER_STR_LEN); -+ ret = _FAIL; -+ } -+ } else -+ ret = _FAIL; -+ _exit_critical_mutex(&dvobj->customer_str_mutex, NULL); -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_RTW_CUSTOMER_STR */ -+ -+u8 rtw_hal_networktype_to_raid(_adapter *adapter, struct sta_info *psta) -+{ -+#ifdef CONFIG_GET_RAID_BY_DRV /*Just for 8188E now*/ -+ if (IS_NEW_GENERATION_IC(adapter)) -+ return networktype_to_raid_ex(adapter, psta); -+ else -+ return networktype_to_raid(adapter, psta); -+#else -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ u8 bw; -+ -+ bw = rtw_get_tx_bw_mode(adapter, psta); -+ -+ return phydm_rate_id_mapping(&pHalData->odmpriv, psta->wireless_mode, pHalData->rf_type, bw); -+#endif -+} -+u8 rtw_get_mgntframe_raid(_adapter *adapter, unsigned char network_type) -+{ -+ -+ u8 raid; -+ if (IS_NEW_GENERATION_IC(adapter)) { -+ -+ raid = (network_type & WIRELESS_11B) ? RATEID_IDX_B -+ : RATEID_IDX_G; -+ } else { -+ raid = (network_type & WIRELESS_11B) ? RATR_INX_WIRELESS_B -+ : RATR_INX_WIRELESS_G; -+ } -+ return raid; -+} -+ -+void rtw_hal_update_sta_rate_mask(PADAPTER padapter, struct sta_info *psta) -+{ -+ u8 i, rf_type, limit; -+ u64 tx_ra_bitmap; -+ -+ if (psta == NULL) -+ return; -+ -+ tx_ra_bitmap = 0; -+ -+ /* b/g mode ra_bitmap */ -+ for (i = 0; i < sizeof(psta->bssrateset); i++) { -+ if (psta->bssrateset[i]) -+ tx_ra_bitmap |= rtw_get_bit_value_from_ieee_value(psta->bssrateset[i] & 0x7f); -+ } -+ -+#ifdef CONFIG_80211N_HT -+#ifdef CONFIG_80211AC_VHT -+ /* AC mode ra_bitmap */ -+ if (psta->vhtpriv.vht_option) -+ tx_ra_bitmap |= (rtw_vht_rate_to_bitmap(psta->vhtpriv.vht_mcs_map) << 12); -+ else -+#endif /* CONFIG_80211AC_VHT */ -+ { -+ /* n mode ra_bitmap */ -+ if (psta->htpriv.ht_option) { -+ rf_type = RF_1T1R; -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if (rf_type == RF_2T2R) -+ limit = 16; /* 2R */ -+ else if (rf_type == RF_3T3R) -+ limit = 24; /* 3R */ -+ else -+ limit = 8; /* 1R */ -+ -+ -+ /* Handling SMPS mode for AP MODE only*/ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { -+ /*0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ -+ if (psta->htpriv.smps_cap == 0 || psta->htpriv.smps_cap == 1) { -+ /*operate with only one active receive chain // 11n-MCS rate <= MSC7*/ -+ limit = 8;/* 1R*/ -+ } -+ } -+ -+ for (i = 0; i < limit; i++) { -+ if (psta->htpriv.ht_cap.supp_mcs_set[i / 8] & BIT(i % 8)) -+ tx_ra_bitmap |= BIT(i + 12); -+ } -+ } -+ } -+ RTW_INFO("supp_mcs_set = %02x, %02x, %02x, rf_type=%d, tx_ra_bitmap=%016llx\n" -+ , psta->htpriv.ht_cap.supp_mcs_set[0], psta->htpriv.ht_cap.supp_mcs_set[1], psta->htpriv.ht_cap.supp_mcs_set[2], rf_type, tx_ra_bitmap); -+#endif /* CONFIG_80211N_HT */ -+ psta->ra_mask = tx_ra_bitmap; -+ psta->init_rate = get_highest_rate_idx(tx_ra_bitmap) & 0x3f; -+} -+ -+#ifndef SEC_CAM_ACCESS_TIMEOUT_MS -+ #define SEC_CAM_ACCESS_TIMEOUT_MS 200 -+#endif -+ -+#ifndef DBG_SEC_CAM_ACCESS -+ #define DBG_SEC_CAM_ACCESS 0 -+#endif -+ -+u32 rtw_sec_read_cam(_adapter *adapter, u8 addr) -+{ -+ _mutex *mutex = &adapter_to_dvobj(adapter)->cam_ctl.sec_cam_access_mutex; -+ u32 rdata; -+ u32 cnt = 0; -+ u32 start = 0, end = 0; -+ u8 timeout = 0; -+ u8 sr = 0; -+ -+ _enter_critical_mutex(mutex, NULL); -+ -+ rtw_write32(adapter, REG_CAMCMD, CAM_POLLINIG | addr); -+ -+ start = rtw_get_current_time(); -+ while (1) { -+ if (rtw_is_surprise_removed(adapter)) { -+ sr = 1; -+ break; -+ } -+ -+ cnt++; -+ if (0 == (rtw_read32(adapter, REG_CAMCMD) & CAM_POLLINIG)) -+ break; -+ -+ if (rtw_get_passing_time_ms(start) > SEC_CAM_ACCESS_TIMEOUT_MS) { -+ timeout = 1; -+ break; -+ } -+ } -+ end = rtw_get_current_time(); -+ -+ rdata = rtw_read32(adapter, REG_CAMREAD); -+ -+ _exit_critical_mutex(mutex, NULL); -+ -+ if (DBG_SEC_CAM_ACCESS || timeout) { -+ RTW_INFO(FUNC_ADPT_FMT" addr:0x%02x, rdata:0x%08x, to:%u, polling:%u, %d ms\n" -+ , FUNC_ADPT_ARG(adapter), addr, rdata, timeout, cnt, rtw_get_time_interval_ms(start, end)); -+ } -+ -+ return rdata; -+} -+ -+void rtw_sec_write_cam(_adapter *adapter, u8 addr, u32 wdata) -+{ -+ _mutex *mutex = &adapter_to_dvobj(adapter)->cam_ctl.sec_cam_access_mutex; -+ u32 cnt = 0; -+ u32 start = 0, end = 0; -+ u8 timeout = 0; -+ u8 sr = 0; -+ -+ _enter_critical_mutex(mutex, NULL); -+ -+ rtw_write32(adapter, REG_CAMWRITE, wdata); -+ rtw_write32(adapter, REG_CAMCMD, CAM_POLLINIG | CAM_WRITE | addr); -+ -+ start = rtw_get_current_time(); -+ while (1) { -+ if (rtw_is_surprise_removed(adapter)) { -+ sr = 1; -+ break; -+ } -+ -+ cnt++; -+ if (0 == (rtw_read32(adapter, REG_CAMCMD) & CAM_POLLINIG)) -+ break; -+ -+ if (rtw_get_passing_time_ms(start) > SEC_CAM_ACCESS_TIMEOUT_MS) { -+ timeout = 1; -+ break; -+ } -+ } -+ end = rtw_get_current_time(); -+ -+ _exit_critical_mutex(mutex, NULL); -+ -+ if (DBG_SEC_CAM_ACCESS || timeout) { -+ RTW_INFO(FUNC_ADPT_FMT" addr:0x%02x, wdata:0x%08x, to:%u, polling:%u, %d ms\n" -+ , FUNC_ADPT_ARG(adapter), addr, wdata, timeout, cnt, rtw_get_time_interval_ms(start, end)); -+ } -+} -+ -+void rtw_sec_read_cam_ent(_adapter *adapter, u8 id, u8 *ctrl, u8 *mac, u8 *key) -+{ -+ unsigned int val, addr; -+ u8 i; -+ u32 rdata; -+ u8 begin = 0; -+ u8 end = 5; /* TODO: consider other key length accordingly */ -+ -+ if (!ctrl && !mac && !key) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ /* TODO: check id range */ -+ -+ if (!ctrl && !mac) -+ begin = 2; /* read from key */ -+ -+ if (!key && !mac) -+ end = 0; /* read to ctrl */ -+ else if (!key) -+ end = 2; /* read to mac */ -+ -+ for (i = begin; i <= end; i++) { -+ rdata = rtw_sec_read_cam(adapter, (id << 3) | i); -+ -+ switch (i) { -+ case 0: -+ if (ctrl) -+ _rtw_memcpy(ctrl, (u8 *)(&rdata), 2); -+ if (mac) -+ _rtw_memcpy(mac, ((u8 *)(&rdata)) + 2, 2); -+ break; -+ case 1: -+ if (mac) -+ _rtw_memcpy(mac + 2, (u8 *)(&rdata), 4); -+ break; -+ default: -+ if (key) -+ _rtw_memcpy(key + (i - 2) * 4, (u8 *)(&rdata), 4); -+ break; -+ } -+ } -+ -+exit: -+ return; -+} -+ -+ -+void rtw_sec_write_cam_ent(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) -+{ -+ unsigned int i; -+ int j; -+ u8 addr; -+ u32 wdata; -+ -+ /* TODO: consider other key length accordingly */ -+#if 0 -+ switch ((ctrl & 0x1c) >> 2) { -+ case _WEP40_: -+ case _TKIP_: -+ case _AES_: -+ case _WEP104_: -+ -+ } -+#else -+ j = 7; -+#endif -+ -+ for (; j >= 0; j--) { -+ switch (j) { -+ case 0: -+ wdata = (ctrl | (mac[0] << 16) | (mac[1] << 24)); -+ break; -+ case 1: -+ wdata = (mac[2] | (mac[3] << 8) | (mac[4] << 16) | (mac[5] << 24)); -+ break; -+ case 6: -+ case 7: -+ wdata = 0; -+ break; -+ default: -+ i = (j - 2) << 2; -+ wdata = (key[i] | (key[i + 1] << 8) | (key[i + 2] << 16) | (key[i + 3] << 24)); -+ break; -+ } -+ -+ addr = (id << 3) + j; -+ -+ rtw_sec_write_cam(adapter, addr, wdata); -+ } -+} -+ -+void rtw_sec_clr_cam_ent(_adapter *adapter, u8 id) -+{ -+ u8 addr; -+ -+ addr = (id << 3); -+ rtw_sec_write_cam(adapter, addr, 0); -+} -+ -+bool rtw_sec_read_cam_is_gk(_adapter *adapter, u8 id) -+{ -+ bool res; -+ u16 ctrl; -+ -+ rtw_sec_read_cam_ent(adapter, id, (u8 *)&ctrl, NULL, NULL); -+ -+ res = (ctrl & BIT6) ? _TRUE : _FALSE; -+ return res; -+} -+#ifdef CONFIG_MBSSID_CAM -+void rtw_mbid_cam_init(struct dvobj_priv *dvobj) -+{ -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ -+ _rtw_spinlock_init(&mbid_cam_ctl->lock); -+ mbid_cam_ctl->bitmap = 0; -+ ATOMIC_SET(&mbid_cam_ctl->mbid_entry_num, 0); -+ _rtw_memset(&dvobj->mbid_cam_cache, 0, sizeof(dvobj->mbid_cam_cache)); -+} -+ -+void rtw_mbid_cam_deinit(struct dvobj_priv *dvobj) -+{ -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ -+ _rtw_spinlock_free(&mbid_cam_ctl->lock); -+} -+ -+void rtw_mbid_cam_reset(_adapter *adapter) -+{ -+ _irqL irqL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ -+ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ mbid_cam_ctl->bitmap = 0; -+ _rtw_memset(&dvobj->mbid_cam_cache, 0, sizeof(dvobj->mbid_cam_cache)); -+ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ -+ ATOMIC_SET(&mbid_cam_ctl->mbid_entry_num, 0); -+} -+static u8 _rtw_mbid_cam_search_by_macaddr(_adapter *adapter, u8 *mac_addr) -+{ -+ u8 i; -+ u8 cam_id = INVALID_CAM_ID; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { -+ if (mac_addr && _rtw_memcmp(dvobj->mbid_cam_cache[i].mac_addr, mac_addr, ETH_ALEN) == _TRUE) { -+ cam_id = i; -+ break; -+ } -+ } -+ -+ RTW_INFO("%s mac:"MAC_FMT" - cam_id:%d\n", __func__, MAC_ARG(mac_addr), cam_id); -+ return cam_id; -+} -+ -+u8 rtw_mbid_cam_search_by_macaddr(_adapter *adapter, u8 *mac_addr) -+{ -+ _irqL irqL; -+ -+ u8 cam_id = INVALID_CAM_ID; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ -+ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ cam_id = _rtw_mbid_cam_search_by_macaddr(adapter, mac_addr); -+ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ -+ return cam_id; -+} -+static u8 _rtw_mbid_cam_search_by_ifaceid(_adapter *adapter, u8 iface_id) -+{ -+ u8 i; -+ u8 cam_id = INVALID_CAM_ID; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { -+ if (iface_id == dvobj->mbid_cam_cache[i].iface_id) { -+ cam_id = i; -+ break; -+ } -+ } -+ if (cam_id != INVALID_CAM_ID) -+ RTW_INFO("%s iface_id:%d mac:"MAC_FMT" - cam_id:%d\n", -+ __func__, iface_id, MAC_ARG(dvobj->mbid_cam_cache[cam_id].mac_addr), cam_id); -+ -+ return cam_id; -+} -+ -+u8 rtw_mbid_cam_search_by_ifaceid(_adapter *adapter, u8 iface_id) -+{ -+ _irqL irqL; -+ u8 cam_id = INVALID_CAM_ID; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ -+ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ cam_id = _rtw_mbid_cam_search_by_ifaceid(adapter, iface_id); -+ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ -+ return cam_id; -+} -+u8 rtw_get_max_mbid_cam_id(_adapter *adapter) -+{ -+ _irqL irqL; -+ s8 i; -+ u8 cam_id = INVALID_CAM_ID; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ -+ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ for (i = (TOTAL_MBID_CAM_NUM - 1); i >= 0; i--) { -+ if (mbid_cam_ctl->bitmap & BIT(i)) { -+ cam_id = i; -+ break; -+ } -+ } -+ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ /*RTW_INFO("%s max cam_id:%d\n", __func__, cam_id);*/ -+ return cam_id; -+} -+ -+inline u8 rtw_get_mbid_cam_entry_num(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ -+ return ATOMIC_READ(&mbid_cam_ctl->mbid_entry_num); -+} -+ -+static inline void mbid_cam_cache_init(_adapter *adapter, struct mbid_cam_cache *pmbid_cam, u8 *mac_addr) -+{ -+ if (adapter && pmbid_cam && mac_addr) { -+ _rtw_memcpy(pmbid_cam->mac_addr, mac_addr, ETH_ALEN); -+ pmbid_cam->iface_id = adapter->iface_id; -+ } -+} -+static inline void mbid_cam_cache_clr(struct mbid_cam_cache *pmbid_cam) -+{ -+ if (pmbid_cam) { -+ _rtw_memset(pmbid_cam->mac_addr, 0, ETH_ALEN); -+ pmbid_cam->iface_id = CONFIG_IFACE_NUMBER; -+ } -+} -+ -+u8 rtw_mbid_camid_alloc(_adapter *adapter, u8 *mac_addr) -+{ -+ _irqL irqL; -+ u8 cam_id = INVALID_CAM_ID, i; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ u8 entry_num = ATOMIC_READ(&mbid_cam_ctl->mbid_entry_num); -+ -+ if (entry_num >= TOTAL_MBID_CAM_NUM) { -+ RTW_INFO(FUNC_ADPT_FMT" failed !! MBSSID number :%d over TOTAL_CAM_ENTRY(8)\n", FUNC_ADPT_ARG(adapter), entry_num); -+ rtw_warn_on(1); -+ } -+ -+ if (INVALID_CAM_ID != rtw_mbid_cam_search_by_macaddr(adapter, mac_addr)) -+ goto exit; -+ -+ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { -+ if (!(mbid_cam_ctl->bitmap & BIT(i))) { -+ mbid_cam_ctl->bitmap |= BIT(i); -+ cam_id = i; -+ break; -+ } -+ } -+ if ((cam_id != INVALID_CAM_ID) && (mac_addr)) -+ mbid_cam_cache_init(adapter, &dvobj->mbid_cam_cache[cam_id], mac_addr); -+ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ -+ if (cam_id != INVALID_CAM_ID) { -+ ATOMIC_INC(&mbid_cam_ctl->mbid_entry_num); -+ RTW_INFO("%s mac:"MAC_FMT" - cam_id:%d\n", __func__, MAC_ARG(mac_addr), cam_id); -+#ifdef DBG_MBID_CAM_DUMP -+ rtw_mbid_cam_cache_dump(RTW_DBGDUMP, __func__, adapter); -+#endif -+ } else -+ RTW_INFO("%s [WARN] "MAC_FMT" - invalid cam_id:%d\n", __func__, MAC_ARG(mac_addr), cam_id); -+exit: -+ return cam_id; -+} -+ -+u8 rtw_mbid_cam_info_change(_adapter *adapter, u8 *mac_addr) -+{ -+ _irqL irqL; -+ u8 entry_id = INVALID_CAM_ID; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ -+ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ entry_id = _rtw_mbid_cam_search_by_ifaceid(adapter, adapter->iface_id); -+ if (entry_id != INVALID_CAM_ID) -+ mbid_cam_cache_init(adapter, &dvobj->mbid_cam_cache[entry_id], mac_addr); -+ -+ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ -+ return entry_id; -+} -+ -+u8 rtw_mbid_cam_assign(_adapter *adapter, u8 *mac_addr, u8 camid) -+{ -+ _irqL irqL; -+ u8 ret = _FALSE; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ -+ if ((camid >= TOTAL_MBID_CAM_NUM) || (camid == INVALID_CAM_ID)) { -+ RTW_INFO(FUNC_ADPT_FMT" failed !! invlaid mbid_canid :%d\n", FUNC_ADPT_ARG(adapter), camid); -+ rtw_warn_on(1); -+ } -+ if (INVALID_CAM_ID != rtw_mbid_cam_search_by_macaddr(adapter, mac_addr)) -+ goto exit; -+ -+ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ if (!(mbid_cam_ctl->bitmap & BIT(camid))) { -+ if (mac_addr) { -+ mbid_cam_ctl->bitmap |= BIT(camid); -+ mbid_cam_cache_init(adapter, &dvobj->mbid_cam_cache[camid], mac_addr); -+ ret = _TRUE; -+ } -+ } -+ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ -+ if (ret == _TRUE) { -+ ATOMIC_INC(&mbid_cam_ctl->mbid_entry_num); -+ RTW_INFO("%s mac:"MAC_FMT" - cam_id:%d\n", __func__, MAC_ARG(mac_addr), camid); -+#ifdef DBG_MBID_CAM_DUMP -+ rtw_mbid_cam_cache_dump(RTW_DBGDUMP, __func__, adapter); -+#endif -+ } else -+ RTW_INFO("%s [WARN] mac:"MAC_FMT" - cam_id:%d assigned failed\n", __func__, MAC_ARG(mac_addr), camid); -+ -+exit: -+ return ret; -+} -+ -+void rtw_mbid_camid_clean(_adapter *adapter, u8 mbss_canid) -+{ -+ _irqL irqL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ -+ if ((mbss_canid >= TOTAL_MBID_CAM_NUM) || (mbss_canid == INVALID_CAM_ID)) { -+ RTW_INFO(FUNC_ADPT_FMT" failed !! invlaid mbid_canid :%d\n", FUNC_ADPT_ARG(adapter), mbss_canid); -+ rtw_warn_on(1); -+ } -+ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ mbid_cam_cache_clr(&dvobj->mbid_cam_cache[mbss_canid]); -+ mbid_cam_ctl->bitmap &= (~BIT(mbss_canid)); -+ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ ATOMIC_DEC(&mbid_cam_ctl->mbid_entry_num); -+ RTW_INFO("%s - cam_id:%d\n", __func__, mbss_canid); -+} -+int rtw_mbid_cam_cache_dump(void *sel, const char *fun_name, _adapter *adapter) -+{ -+ _irqL irqL; -+ u8 i; -+ _adapter *iface; -+ u8 iface_id; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ u8 entry_num = ATOMIC_READ(&mbid_cam_ctl->mbid_entry_num); -+ u8 max_cam_id = rtw_get_max_mbid_cam_id(adapter); -+ -+ RTW_PRINT_SEL(sel, "== MBSSID CAM DUMP (%s)==\n", fun_name); -+ -+ _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ RTW_PRINT_SEL(sel, "Entry numbers:%d, max_camid:%d, bitmap:0x%08x\n", entry_num, max_cam_id, mbid_cam_ctl->bitmap); -+ for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { -+ RTW_PRINT_SEL(sel, "CAM_ID = %d\t", i); -+ -+ if (mbid_cam_ctl->bitmap & BIT(i)) { -+ iface_id = dvobj->mbid_cam_cache[i].iface_id; -+ RTW_PRINT_SEL(sel, "IF_ID:%d\t", iface_id); -+ RTW_PRINT_SEL(sel, "MAC Addr:"MAC_FMT"\t", MAC_ARG(dvobj->mbid_cam_cache[i].mac_addr)); -+ -+ iface = dvobj->padapters[iface_id]; -+ if (iface) { -+ if (check_fwstate(&iface->mlmepriv, WIFI_STATION_STATE) == _TRUE) -+ RTW_PRINT_SEL(sel, "ROLE:%s\n", "STA"); -+ else if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE) -+ RTW_PRINT_SEL(sel, "ROLE:%s\n", "AP"); -+ else -+ RTW_PRINT_SEL(sel, "ROLE:%s\n", "NONE"); -+ } -+ -+ } else -+ RTW_PRINT_SEL(sel, "N/A\n"); -+ } -+ _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); -+ return 0; -+} -+ -+static void read_mbssid_cam(_adapter *padapter, u8 cam_addr, u8 *mac) -+{ -+ u8 poll = 1; -+ u8 cam_ready = _FALSE; -+ u32 cam_data1 = 0; -+ u16 cam_data2 = 0; -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ return; -+ -+ rtw_write32(padapter, REG_MBIDCAMCFG_2, BIT_MBIDCAM_POLL | ((cam_addr & MBIDCAM_ADDR_MASK) << MBIDCAM_ADDR_SHIFT)); -+ -+ do { -+ if (0 == (rtw_read32(padapter, REG_MBIDCAMCFG_2) & BIT_MBIDCAM_POLL)) { -+ cam_ready = _TRUE; -+ break; -+ } -+ poll++; -+ } while ((poll % 10) != 0 && !RTW_CANNOT_RUN(padapter)); -+ -+ if (cam_ready) { -+ cam_data1 = rtw_read32(padapter, REG_MBIDCAMCFG_1); -+ mac[0] = cam_data1 & 0xFF; -+ mac[1] = (cam_data1 >> 8) & 0xFF; -+ mac[2] = (cam_data1 >> 16) & 0xFF; -+ mac[3] = (cam_data1 >> 24) & 0xFF; -+ -+ cam_data2 = rtw_read16(padapter, REG_MBIDCAMCFG_2); -+ mac[4] = cam_data2 & 0xFF; -+ mac[5] = (cam_data2 >> 8) & 0xFF; -+ } -+ -+} -+int rtw_mbid_cam_dump(void *sel, const char *fun_name, _adapter *adapter) -+{ -+ /*_irqL irqL;*/ -+ u8 i; -+ u8 mac_addr[ETH_ALEN]; -+ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ -+ RTW_PRINT_SEL(sel, "\n== MBSSID HW-CAM DUMP (%s)==\n", fun_name); -+ -+ /*_enter_critical_bh(&mbid_cam_ctl->lock, &irqL);*/ -+ for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { -+ RTW_PRINT_SEL(sel, "CAM_ID = %d\t", i); -+ _rtw_memset(mac_addr, 0, ETH_ALEN); -+ read_mbssid_cam(adapter, i, mac_addr); -+ RTW_PRINT_SEL(sel, "MAC Addr:"MAC_FMT"\n", MAC_ARG(mac_addr)); -+ } -+ /*_exit_critical_bh(&mbid_cam_ctl->lock, &irqL);*/ -+ return 0; -+} -+ -+static void write_mbssid_cam(_adapter *padapter, u8 cam_addr, u8 *mac) -+{ -+ u32 cam_val[2] = {0}; -+ -+ cam_val[0] = (mac[3] << 24) | (mac[2] << 16) | (mac[1] << 8) | mac[0]; -+ cam_val[1] = ((cam_addr & MBIDCAM_ADDR_MASK) << MBIDCAM_ADDR_SHIFT) | (mac[5] << 8) | mac[4]; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MBSSID_CAM_WRITE, (u8 *)cam_val); -+} -+ -+static void clear_mbssid_cam(_adapter *padapter, u8 cam_addr) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MBSSID_CAM_CLEAR, &cam_addr); -+} -+static void enable_mbssid_cam(_adapter *adapter) -+{ -+ u8 max_cam_id = rtw_get_max_mbid_cam_id(adapter); -+ /*enable MBSSID*/ -+ rtw_write32(adapter, REG_RCR, rtw_read32(adapter, REG_RCR) | RCR_ENMBID); -+ if (max_cam_id != INVALID_CAM_ID) { -+ rtw_write8(adapter, REG_MBID_NUM, -+ ((rtw_read8(adapter, REG_MBID_NUM) & 0xF8) | (max_cam_id & 0x07))); -+ } -+} -+void rtw_mbid_cam_restore(_adapter *adapter) -+{ -+ u8 i; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; -+ -+#ifdef DBG_MBID_CAM_DUMP -+ rtw_mbid_cam_cache_dump(RTW_DBGDUMP, __func__, adapter); -+#endif -+ -+ for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { -+ if (mbid_cam_ctl->bitmap & BIT(i)) { -+ write_mbssid_cam(adapter, i, dvobj->mbid_cam_cache[i].mac_addr); -+ RTW_INFO("%s - cam_id:%d => mac:"MAC_FMT"\n", __func__, i, MAC_ARG(dvobj->mbid_cam_cache[i].mac_addr)); -+ } -+ } -+ enable_mbssid_cam(adapter); -+} -+#endif /*CONFIG_MBSSID_CAM*/ -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+void rtw_hal_set_macaddr_mbid(_adapter *adapter, u8 *mac_addr) -+{ -+ -+#if 0 /*TODO - modify for more flexible*/ -+ u8 idx = 0; -+ -+ if ((check_fwstate(&adapter->mlmepriv, WIFI_STATION_STATE) == _TRUE) && -+ (DEV_STA_NUM(adapter_to_dvobj(adapter)) == 1)) { -+ for (idx = 0; idx < 6; idx++) -+ rtw_write8(GET_PRIMARY_ADAPTER(adapter), (REG_MACID + idx), val[idx]); -+ } else { -+ /*MBID entry_id = 0~7 ,0 for root AP, 1~7 for VAP*/ -+ u8 entry_id; -+ -+ if ((check_fwstate(&adapter->mlmepriv, WIFI_AP_STATE) == _TRUE) && -+ (DEV_AP_NUM(adapter_to_dvobj(adapter)) == 1)) { -+ entry_id = 0; -+ if (rtw_mbid_cam_assign(adapter, val, entry_id)) { -+ RTW_INFO(FUNC_ADPT_FMT" Root AP assigned success\n", FUNC_ADPT_ARG(adapter)); -+ write_mbssid_cam(adapter, entry_id, val); -+ } -+ } else { -+ entry_id = rtw_mbid_camid_alloc(adapter, val); -+ if (entry_id != INVALID_CAM_ID) -+ write_mbssid_cam(adapter, entry_id, val); -+ } -+ } -+#else -+ { -+ /* -+ MBID entry_id = 0~7 ,for IFACE_ID0 ~ IFACE_IDx -+ */ -+ u8 entry_id = rtw_mbid_camid_alloc(adapter, mac_addr); -+ -+ -+ if (entry_id != INVALID_CAM_ID) { -+ write_mbssid_cam(adapter, entry_id, mac_addr); -+ enable_mbssid_cam(adapter); -+ } -+ } -+#endif -+} -+ -+void rtw_hal_change_macaddr_mbid(_adapter *adapter, u8 *mac_addr) -+{ -+ u8 idx = 0; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 entry_id; -+ -+ if (!mac_addr) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ -+ entry_id = rtw_mbid_cam_info_change(adapter, mac_addr); -+ -+ if (entry_id != INVALID_CAM_ID) -+ write_mbssid_cam(adapter, entry_id, mac_addr); -+} -+ -+ -+#endif/*#ifdef CONFIG_MI_WITH_MBSSID_CAM*/ -+ -+void rtw_hal_set_macaddr_port(_adapter *adapter, u8 *val) -+{ -+ u8 idx = 0; -+ u32 reg_macid = 0; -+ -+ if (val == NULL) -+ return; -+ -+ RTW_INFO("%s "ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", __func__, -+ ADPT_ARG(adapter), adapter->hw_port, MAC_ARG(val)); -+ -+ switch (adapter->hw_port) { -+ case HW_PORT0: -+ default: -+ reg_macid = REG_MACID; -+ break; -+ case HW_PORT1: -+ reg_macid = REG_MACID1; -+ break; -+#if defined(CONFIG_RTL8814A) -+ case HW_PORT2: -+ reg_macid = REG_MACID2; -+ break; -+ case HW_PORT3: -+ reg_macid = REG_MACID3; -+ break; -+ case HW_PORT4: -+ reg_macid = REG_MACID4; -+ break; -+#endif/*defined(CONFIG_RTL8814A)*/ -+ } -+ -+ for (idx = 0; idx < 6; idx++) -+ rtw_write8(GET_PRIMARY_ADAPTER(adapter), (reg_macid + idx), val[idx]); -+} -+void rtw_hal_get_macaddr_port(_adapter *adapter, u8 *mac_addr) -+{ -+ u8 idx = 0; -+ u32 reg_macid = 0; -+ -+ if (mac_addr == NULL) -+ return; -+ -+ _rtw_memset(mac_addr, 0, ETH_ALEN); -+ switch (adapter->hw_port) { -+ case HW_PORT0: -+ default: -+ reg_macid = REG_MACID; -+ break; -+ case HW_PORT1: -+ reg_macid = REG_MACID1; -+ break; -+#if defined(CONFIG_RTL8814A) -+ case HW_PORT2: -+ reg_macid = REG_MACID2; -+ break; -+ case HW_PORT3: -+ reg_macid = REG_MACID3; -+ break; -+ case HW_PORT4: -+ reg_macid = REG_MACID4; -+ break; -+#endif /*defined(CONFIG_RTL8814A)*/ -+ } -+ -+ for (idx = 0; idx < 6; idx++) -+ mac_addr[idx] = rtw_read8(GET_PRIMARY_ADAPTER(adapter), (reg_macid + idx)); -+ -+ RTW_INFO("%s "ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", __func__, -+ ADPT_ARG(adapter), adapter->hw_port, MAC_ARG(mac_addr)); -+} -+ -+void rtw_hal_set_bssid(_adapter *adapter, u8 *val) -+{ -+ u8 idx = 0; -+ u32 reg_bssid = 0; -+ -+ switch (adapter->hw_port) { -+ case HW_PORT0: -+ default: -+ reg_bssid = REG_BSSID; -+ break; -+ case HW_PORT1: -+ reg_bssid = REG_BSSID1; -+ break; -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) -+ case HW_PORT2: -+ reg_bssid = REG_BSSID2; -+ break; -+ case HW_PORT3: -+ reg_bssid = REG_BSSID3; -+ break; -+ case HW_PORT4: -+ reg_bssid = REG_BSSID4; -+ break; -+#endif/*defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B)*/ -+ } -+ -+ for (idx = 0 ; idx < 6; idx++) -+ rtw_write8(adapter, (reg_bssid + idx), val[idx]); -+ -+ RTW_INFO("%s "ADPT_FMT"- hw port -%d BSSID: "MAC_FMT"\n", __func__, ADPT_ARG(adapter), adapter->hw_port, MAC_ARG(val)); -+} -+ -+void rtw_hal_get_msr(_adapter *adapter, u8 *net_type) -+{ -+ switch (adapter->hw_port) { -+ case HW_PORT0: -+ /*REG_CR - BIT[17:16]-Network Type for port 1*/ -+ *net_type = rtw_read8(adapter, MSR) & 0x03; -+ break; -+ case HW_PORT1: -+ /*REG_CR - BIT[19:18]-Network Type for port 1*/ -+ *net_type = (rtw_read8(adapter, MSR) & 0x0C) >> 2; -+ break; -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) -+ case HW_PORT2: -+ /*REG_CR_EXT- BIT[1:0]-Network Type for port 2*/ -+ *net_type = rtw_read8(adapter, MSR1) & 0x03; -+ break; -+ case HW_PORT3: -+ /*REG_CR_EXT- BIT[3:2]-Network Type for port 3*/ -+ *net_type = (rtw_read8(adapter, MSR1) & 0x0C) >> 2; -+ break; -+ case HW_PORT4: -+ /*REG_CR_EXT- BIT[5:4]-Network Type for port 4*/ -+ *net_type = (rtw_read8(adapter, MSR1) & 0x30) >> 4; -+ break; -+#endif /*#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B)*/ -+ default: -+ RTW_INFO("[WARN] "ADPT_FMT"- invalid hw port -%d\n", -+ ADPT_ARG(adapter), adapter->hw_port); -+ rtw_warn_on(1); -+ break; -+ } -+} -+ -+void rtw_hal_set_msr(_adapter *adapter, u8 net_type) -+{ -+ u8 val8 = 0; -+ -+ switch (adapter->hw_port) { -+ case HW_PORT0: -+#if defined(CONFIG_MI_WITH_MBSSID_CAM) && defined(CONFIG_MBSSID_CAM) /*For 2 hw ports - 88E/92E/8812/8821/8723B*/ -+ if (rtw_get_mbid_cam_entry_num(adapter)) { -+ if (net_type != _HW_STATE_NOLINK_) -+ net_type = _HW_STATE_AP_; -+ } -+#endif -+ /*REG_CR - BIT[17:16]-Network Type for port 0*/ -+ val8 = rtw_read8(adapter, MSR) & 0x0C; -+ val8 |= net_type; -+ rtw_write8(adapter, MSR, val8); -+ break; -+ case HW_PORT1: -+ /*REG_CR - BIT[19:18]-Network Type for port 1*/ -+ val8 = rtw_read8(adapter, MSR) & 0x03; -+ val8 |= net_type << 2; -+ rtw_write8(adapter, MSR, val8); -+ break; -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ case HW_PORT2: -+ /*REG_CR_EXT- BIT[1:0]-Network Type for port 2*/ -+ val8 = rtw_read8(adapter, MSR1) & 0xFC; -+ val8 |= net_type; -+ rtw_write8(adapter, MSR1, val8); -+ break; -+ case HW_PORT3: -+ /*REG_CR_EXT- BIT[3:2]-Network Type for port 3*/ -+ val8 = rtw_read8(adapter, MSR1) & 0xF3; -+ val8 |= net_type << 2; -+ rtw_write8(adapter, MSR1, val8); -+ break; -+ case HW_PORT4: -+ /*REG_CR_EXT- BIT[5:4]-Network Type for port 4*/ -+ val8 = rtw_read8(adapter, MSR1) & 0xCF; -+ val8 |= net_type << 4; -+ rtw_write8(adapter, MSR1, val8); -+ break; -+#endif /* CONFIG_RTL8814A | CONFIG_RTL8822B */ -+ default: -+ RTW_INFO("[WARN] "ADPT_FMT"- invalid hw port -%d\n", -+ ADPT_ARG(adapter), adapter->hw_port); -+ rtw_warn_on(1); -+ break; -+ } -+} -+ -+void rtw_hal_port_reconfig(_adapter *adapter, u8 port) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 hal_port_num = 0; -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ if (port > (hal_spec->port_num - 1)) { -+ RTW_INFO("[WARN] "ADPT_FMT"- hw_port : %d,will switch to invalid port-%d\n", -+ ADPT_ARG(adapter), adapter->hw_port, port); -+ rtw_warn_on(1); -+ } -+ -+ RTW_PRINT(ADPT_FMT"- hw_port : %d,will switch to port-%d\n", -+ ADPT_ARG(adapter), adapter->hw_port, port); -+ -+#endif -+ -+} -+ -+ -+void hw_var_port_switch(_adapter *adapter) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_RUNTIME_PORT_SWITCH -+ /* -+ 0x102: MSR -+ 0x550: REG_BCN_CTRL -+ 0x551: REG_BCN_CTRL_1 -+ 0x55A: REG_ATIMWND -+ 0x560: REG_TSFTR -+ 0x568: REG_TSFTR1 -+ 0x570: REG_ATIMWND_1 -+ 0x610: REG_MACID -+ 0x618: REG_BSSID -+ 0x700: REG_MACID1 -+ 0x708: REG_BSSID1 -+ */ -+ -+ int i; -+ u8 msr; -+ u8 bcn_ctrl; -+ u8 bcn_ctrl_1; -+ u8 atimwnd[2]; -+ u8 atimwnd_1[2]; -+ u8 tsftr[8]; -+ u8 tsftr_1[8]; -+ u8 macid[6]; -+ u8 bssid[6]; -+ u8 macid_1[6]; -+ u8 bssid_1[6]; -+ -+ u8 hw_port; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ _adapter *iface = NULL; -+ -+ msr = rtw_read8(adapter, MSR); -+ bcn_ctrl = rtw_read8(adapter, REG_BCN_CTRL); -+ bcn_ctrl_1 = rtw_read8(adapter, REG_BCN_CTRL_1); -+ -+ for (i = 0; i < 2; i++) -+ atimwnd[i] = rtw_read8(adapter, REG_ATIMWND + i); -+ for (i = 0; i < 2; i++) -+ atimwnd_1[i] = rtw_read8(adapter, REG_ATIMWND_1 + i); -+ -+ for (i = 0; i < 8; i++) -+ tsftr[i] = rtw_read8(adapter, REG_TSFTR + i); -+ for (i = 0; i < 8; i++) -+ tsftr_1[i] = rtw_read8(adapter, REG_TSFTR1 + i); -+ -+ for (i = 0; i < 6; i++) -+ macid[i] = rtw_read8(adapter, REG_MACID + i); -+ -+ for (i = 0; i < 6; i++) -+ bssid[i] = rtw_read8(adapter, REG_BSSID + i); -+ -+ for (i = 0; i < 6; i++) -+ macid_1[i] = rtw_read8(adapter, REG_MACID1 + i); -+ -+ for (i = 0; i < 6; i++) -+ bssid_1[i] = rtw_read8(adapter, REG_BSSID1 + i); -+ -+#ifdef DBG_RUNTIME_PORT_SWITCH -+ RTW_INFO(FUNC_ADPT_FMT" before switch\n" -+ "msr:0x%02x\n" -+ "bcn_ctrl:0x%02x\n" -+ "bcn_ctrl_1:0x%02x\n" -+ "atimwnd:0x%04x\n" -+ "atimwnd_1:0x%04x\n" -+ "tsftr:%llu\n" -+ "tsftr1:%llu\n" -+ "macid:"MAC_FMT"\n" -+ "bssid:"MAC_FMT"\n" -+ "macid_1:"MAC_FMT"\n" -+ "bssid_1:"MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter) -+ , msr -+ , bcn_ctrl -+ , bcn_ctrl_1 -+ , *((u16 *)atimwnd) -+ , *((u16 *)atimwnd_1) -+ , *((u64 *)tsftr) -+ , *((u64 *)tsftr_1) -+ , MAC_ARG(macid) -+ , MAC_ARG(bssid) -+ , MAC_ARG(macid_1) -+ , MAC_ARG(bssid_1) -+ ); -+#endif /* DBG_RUNTIME_PORT_SWITCH */ -+ -+ /* disable bcn function, disable update TSF */ -+ rtw_write8(adapter, REG_BCN_CTRL, (bcn_ctrl & (~EN_BCN_FUNCTION)) | DIS_TSF_UDT); -+ rtw_write8(adapter, REG_BCN_CTRL_1, (bcn_ctrl_1 & (~EN_BCN_FUNCTION)) | DIS_TSF_UDT); -+ -+ /* switch msr */ -+ msr = (msr & 0xf0) | ((msr & 0x03) << 2) | ((msr & 0x0c) >> 2); -+ rtw_write8(adapter, MSR, msr); -+ -+ /* write port0 */ -+ rtw_write8(adapter, REG_BCN_CTRL, bcn_ctrl_1 & ~EN_BCN_FUNCTION); -+ for (i = 0; i < 2; i++) -+ rtw_write8(adapter, REG_ATIMWND + i, atimwnd_1[i]); -+ for (i = 0; i < 8; i++) -+ rtw_write8(adapter, REG_TSFTR + i, tsftr_1[i]); -+ for (i = 0; i < 6; i++) -+ rtw_write8(adapter, REG_MACID + i, macid_1[i]); -+ for (i = 0; i < 6; i++) -+ rtw_write8(adapter, REG_BSSID + i, bssid_1[i]); -+ -+ /* write port1 */ -+ rtw_write8(adapter, REG_BCN_CTRL_1, bcn_ctrl & ~EN_BCN_FUNCTION); -+ for (i = 0; i < 2; i++) -+ rtw_write8(adapter, REG_ATIMWND_1 + i, atimwnd[i]); -+ for (i = 0; i < 8; i++) -+ rtw_write8(adapter, REG_TSFTR1 + i, tsftr[i]); -+ for (i = 0; i < 6; i++) -+ rtw_write8(adapter, REG_MACID1 + i, macid[i]); -+ for (i = 0; i < 6; i++) -+ rtw_write8(adapter, REG_BSSID1 + i, bssid[i]); -+ -+ /* write bcn ctl */ -+#ifdef CONFIG_BT_COEXIST -+ /* always enable port0 beacon function for PSTDMA */ -+ if (IS_HARDWARE_TYPE_8723B(adapter) || IS_HARDWARE_TYPE_8703B(adapter) -+ || IS_HARDWARE_TYPE_8723D(adapter)) -+ bcn_ctrl_1 |= EN_BCN_FUNCTION; -+ /* always disable port1 beacon function for PSTDMA */ -+ if (IS_HARDWARE_TYPE_8723B(adapter) || IS_HARDWARE_TYPE_8703B(adapter)) -+ bcn_ctrl &= ~EN_BCN_FUNCTION; -+#endif -+ rtw_write8(adapter, REG_BCN_CTRL, bcn_ctrl_1); -+ rtw_write8(adapter, REG_BCN_CTRL_1, bcn_ctrl); -+ -+ if (adapter->iface_id == IFACE_ID0) -+ iface = dvobj->padapters[IFACE_ID1]; -+ else if (adapter->iface_id == IFACE_ID1) -+ iface = dvobj->padapters[IFACE_ID0]; -+ -+ -+ if (adapter->hw_port == HW_PORT0) { -+ adapter->hw_port = HW_PORT1; -+ iface->hw_port = HW_PORT0; -+ RTW_PRINT("port switch - port0("ADPT_FMT"), port1("ADPT_FMT")\n", -+ ADPT_ARG(iface), ADPT_ARG(adapter)); -+ } else { -+ adapter->hw_port = HW_PORT0; -+ iface->hw_port = HW_PORT1; -+ RTW_PRINT("port switch - port0("ADPT_FMT"), port1("ADPT_FMT")\n", -+ ADPT_ARG(adapter), ADPT_ARG(iface)); -+ } -+ -+#ifdef DBG_RUNTIME_PORT_SWITCH -+ msr = rtw_read8(adapter, MSR); -+ bcn_ctrl = rtw_read8(adapter, REG_BCN_CTRL); -+ bcn_ctrl_1 = rtw_read8(adapter, REG_BCN_CTRL_1); -+ -+ for (i = 0; i < 2; i++) -+ atimwnd[i] = rtw_read8(adapter, REG_ATIMWND + i); -+ for (i = 0; i < 2; i++) -+ atimwnd_1[i] = rtw_read8(adapter, REG_ATIMWND_1 + i); -+ -+ for (i = 0; i < 8; i++) -+ tsftr[i] = rtw_read8(adapter, REG_TSFTR + i); -+ for (i = 0; i < 8; i++) -+ tsftr_1[i] = rtw_read8(adapter, REG_TSFTR1 + i); -+ -+ for (i = 0; i < 6; i++) -+ macid[i] = rtw_read8(adapter, REG_MACID + i); -+ -+ for (i = 0; i < 6; i++) -+ bssid[i] = rtw_read8(adapter, REG_BSSID + i); -+ -+ for (i = 0; i < 6; i++) -+ macid_1[i] = rtw_read8(adapter, REG_MACID1 + i); -+ -+ for (i = 0; i < 6; i++) -+ bssid_1[i] = rtw_read8(adapter, REG_BSSID1 + i); -+ -+ RTW_INFO(FUNC_ADPT_FMT" after switch\n" -+ "msr:0x%02x\n" -+ "bcn_ctrl:0x%02x\n" -+ "bcn_ctrl_1:0x%02x\n" -+ "atimwnd:%u\n" -+ "atimwnd_1:%u\n" -+ "tsftr:%llu\n" -+ "tsftr1:%llu\n" -+ "macid:"MAC_FMT"\n" -+ "bssid:"MAC_FMT"\n" -+ "macid_1:"MAC_FMT"\n" -+ "bssid_1:"MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter) -+ , msr -+ , bcn_ctrl -+ , bcn_ctrl_1 -+ , *((u16 *)atimwnd) -+ , *((u16 *)atimwnd_1) -+ , *((u64 *)tsftr) -+ , *((u64 *)tsftr_1) -+ , MAC_ARG(macid) -+ , MAC_ARG(bssid) -+ , MAC_ARG(macid_1) -+ , MAC_ARG(bssid_1) -+ ); -+#endif /* DBG_RUNTIME_PORT_SWITCH */ -+ -+#endif /* CONFIG_RUNTIME_PORT_SWITCH */ -+#endif /* CONFIG_CONCURRENT_MODE */ -+} -+ -+const char *const _h2c_msr_role_str[] = { -+ "RSVD", -+ "STA", -+ "AP", -+ "GC", -+ "GO", -+ "TDLS", -+ "ADHOC", -+ "INVALID", -+}; -+ -+/* -+* rtw_hal_set_FwMediaStatusRpt_cmd - -+* -+* @adapter: -+* @opmode: 0:disconnect, 1:connect -+* @miracast: 0:it's not in miracast scenario. 1:it's in miracast scenario -+* @miracast_sink: 0:source. 1:sink -+* @role: The role of this macid. 0:rsvd. 1:STA. 2:AP. 3:GC. 4:GO. 5:TDLS -+* @macid: -+* @macid_ind: 0:update Media Status to macid. 1:update Media Status from macid to macid_end -+* @macid_end: -+*/ -+s32 rtw_hal_set_FwMediaStatusRpt_cmd(_adapter *adapter, bool opmode, bool miracast, bool miracast_sink, u8 role, u8 macid, bool macid_ind, u8 macid_end) -+{ -+ struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; -+ u8 parm[H2C_MEDIA_STATUS_RPT_LEN] = {0}; -+ int i; -+ s32 ret; -+ -+ SET_H2CCMD_MSRRPT_PARM_OPMODE(parm, opmode); -+ SET_H2CCMD_MSRRPT_PARM_MACID_IND(parm, macid_ind); -+ SET_H2CCMD_MSRRPT_PARM_MIRACAST(parm, miracast); -+ SET_H2CCMD_MSRRPT_PARM_MIRACAST_SINK(parm, miracast_sink); -+ SET_H2CCMD_MSRRPT_PARM_ROLE(parm, role); -+ SET_H2CCMD_MSRRPT_PARM_MACID(parm, macid); -+ SET_H2CCMD_MSRRPT_PARM_MACID_END(parm, macid_end); -+ -+ RTW_DBG_DUMP("MediaStatusRpt parm:", parm, H2C_MEDIA_STATUS_RPT_LEN); -+ -+#ifdef CONFIG_DFS_MASTER -+ /* workaround for TXPAUSE cleared issue by FW's MediaStatusRpt handling */ -+ if (macid_ind == 0 && macid == 1) { -+ u8 parm0_bak = parm[0]; -+ -+ SET_H2CCMD_MSRRPT_PARM_MACID_IND(&parm0_bak, 0); -+ if (macid_ctl->h2c_msr[macid] == parm0_bak) { -+ ret = _SUCCESS; -+ goto post_action; -+ } -+ } -+#endif -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_MEDIA_STATUS_RPT, H2C_MEDIA_STATUS_RPT_LEN, parm); -+ if (ret != _SUCCESS) -+ goto exit; -+ -+#ifdef CONFIG_DFS_MASTER -+post_action: -+#endif -+ -+#if defined(CONFIG_RTL8188E) -+ if (rtw_get_chip_type(adapter) == RTL8188E) { -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ /* 8188E FW doesn't set macid no link, driver does it by self */ -+ if (opmode) -+ rtw_hal_set_hwreg(adapter, HW_VAR_MACID_LINK, &macid); -+ else -+ rtw_hal_set_hwreg(adapter, HW_VAR_MACID_NOLINK, &macid); -+ -+ /* for 8188E RA */ -+#if (RATE_ADAPTIVE_SUPPORT == 1) -+ if (hal_data->fw_ractrl == _FALSE) { -+ u8 max_macid; -+ -+ max_macid = rtw_search_max_mac_id(adapter); -+ rtw_hal_set_hwreg(adapter, HW_VAR_TX_RPT_MAX_MACID, &max_macid); -+ } -+#endif -+ } -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ /* TODO: this should move to IOT issue area */ -+ if (rtw_get_chip_type(adapter) == RTL8812 -+ || rtw_get_chip_type(adapter) == RTL8821 -+ ) { -+ if (MLME_IS_STA(adapter)) -+ Hal_PatchwithJaguar_8812(adapter, opmode); -+ } -+#endif -+ -+ SET_H2CCMD_MSRRPT_PARM_MACID_IND(parm, 0); -+ if (macid_ind == 0) -+ macid_end = macid; -+ -+ for (i = macid; macid <= macid_end; macid++) { -+ rtw_macid_ctl_set_h2c_msr(macid_ctl, macid, parm[0]); -+ if (!opmode) { -+ rtw_macid_ctl_set_bw(macid_ctl, macid, CHANNEL_WIDTH_20); -+ rtw_macid_ctl_set_vht_en(macid_ctl, macid, 0); -+ rtw_macid_ctl_set_rate_bmp0(macid_ctl, macid, 0); -+ rtw_macid_ctl_set_rate_bmp1(macid_ctl, macid, 0); -+ } -+ } -+ if (!opmode) -+ rtw_update_tx_rate_bmp(adapter_to_dvobj(adapter)); -+ -+exit: -+ return ret; -+} -+ -+inline s32 rtw_hal_set_FwMediaStatusRpt_single_cmd(_adapter *adapter, bool opmode, bool miracast, bool miracast_sink, u8 role, u8 macid) -+{ -+ return rtw_hal_set_FwMediaStatusRpt_cmd(adapter, opmode, miracast, miracast_sink, role, macid, 0, 0); -+} -+ -+inline s32 rtw_hal_set_FwMediaStatusRpt_range_cmd(_adapter *adapter, bool opmode, bool miracast, bool miracast_sink, u8 role, u8 macid, u8 macid_end) -+{ -+ return rtw_hal_set_FwMediaStatusRpt_cmd(adapter, opmode, miracast, miracast_sink, role, macid, 1, macid_end); -+} -+ -+void rtw_hal_set_FwRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ u8 u1H2CRsvdPageParm[H2C_RSVDPAGE_LOC_LEN] = {0}; -+ u8 ret = 0; -+ -+ RTW_INFO("RsvdPageLoc: ProbeRsp=%d PsPoll=%d Null=%d QoSNull=%d BTNull=%d\n", -+ rsvdpageloc->LocProbeRsp, rsvdpageloc->LocPsPoll, -+ rsvdpageloc->LocNullData, rsvdpageloc->LocQosNull, -+ rsvdpageloc->LocBTQosNull); -+ -+ SET_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(u1H2CRsvdPageParm, rsvdpageloc->LocProbeRsp); -+ SET_H2CCMD_RSVDPAGE_LOC_PSPOLL(u1H2CRsvdPageParm, rsvdpageloc->LocPsPoll); -+ SET_H2CCMD_RSVDPAGE_LOC_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocNullData); -+ SET_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocQosNull); -+ SET_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocBTQosNull); -+ -+ ret = rtw_hal_fill_h2c_cmd(padapter, -+ H2C_RSVD_PAGE, -+ H2C_RSVDPAGE_LOC_LEN, -+ u1H2CRsvdPageParm); -+ -+} -+ -+#ifdef CONFIG_RTW_SDIO_OOB_INT -+void rtw_hal_switch_ood_int_ctrl(_adapter *padapter, u8 enable) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ RTW_INFO("%s: >>>>>>\n", __func__); -+ if (IS_8723D_SERIES(pHalData->VersionID)) -+ rtw_hal_set_hwreg(padapter, HW_SET_OOB_CTRL, (u8 *)(&enable)); -+} -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+void rtw_hal_switch_gpio_wl_ctrl(_adapter *padapter, u8 index, u8 enable) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ if (IS_8723D_SERIES(pHalData->VersionID)) -+ rtw_hal_set_hwreg(padapter, HW_SET_GPIO_WL_CTRL, (u8 *)(&enable)); -+ /* -+ * Switch GPIO_13, GPIO_14 to wlan control, or pull GPIO_13,14 MUST fail. -+ * It happended at 8723B/8192E/8821A. New IC will check multi function GPIO, -+ * and implement HAL function. -+ * TODO: GPIO_8 multi function? -+ */ -+ -+ if (index == 13 || index == 14) -+ rtw_hal_set_hwreg(padapter, HW_SET_GPIO_WL_CTRL, (u8 *)(&enable)); -+} -+ -+void rtw_hal_set_output_gpio(_adapter *padapter, u8 index, u8 outputval) -+{ -+ if (index <= 7) { -+ /* config GPIO mode */ -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 3, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL + 3) & ~BIT(index)); -+ -+ /* config GPIO Sel */ -+ /* 0: input */ -+ /* 1: output */ -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 2, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL + 2) | BIT(index)); -+ -+ /* set output value */ -+ if (outputval) { -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 1, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL + 1) | BIT(index)); -+ } else { -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 1, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL + 1) & ~BIT(index)); -+ } -+ } else if (index <= 15) { -+ /* 88C Series: */ -+ /* index: 11~8 transform to 3~0 */ -+ /* 8723 Series: */ -+ /* index: 12~8 transform to 4~0 */ -+ -+ index -= 8; -+ -+ /* config GPIO mode */ -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 3, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 3) & ~BIT(index)); -+ -+ /* config GPIO Sel */ -+ /* 0: input */ -+ /* 1: output */ -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 2, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 2) | BIT(index)); -+ -+ /* set output value */ -+ if (outputval) { -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 1, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 1) | BIT(index)); -+ } else { -+ rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 1, -+ rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 1) & ~BIT(index)); -+ } -+ } else { -+ RTW_INFO("%s: invalid GPIO%d=%d\n", -+ __FUNCTION__, index, outputval); -+ } -+} -+#endif -+ -+void rtw_hal_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 res = 0, count = 0, ret = 0; -+#ifdef CONFIG_WOWLAN -+ u8 u1H2CAoacRsvdPageParm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; -+ -+ RTW_INFO("AOACRsvdPageLoc: RWC=%d ArpRsp=%d NbrAdv=%d GtkRsp=%d GtkInfo=%d ProbeReq=%d NetworkList=%d\n", -+ rsvdpageloc->LocRemoteCtrlInfo, rsvdpageloc->LocArpRsp, -+ rsvdpageloc->LocNbrAdv, rsvdpageloc->LocGTKRsp, -+ rsvdpageloc->LocGTKInfo, rsvdpageloc->LocProbeReq, -+ rsvdpageloc->LocNetList); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocRemoteCtrlInfo); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocArpRsp); -+ /* SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(u1H2CAoacRsvdPageParm, rsvdpageloc->LocNbrAdv); */ -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKRsp); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKInfo); -+#ifdef CONFIG_GTK_OL -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKEXTMEM); -+#endif /* CONFIG_GTK_OL */ -+ ret = rtw_hal_fill_h2c_cmd(padapter, -+ H2C_AOAC_RSVD_PAGE, -+ H2C_AOAC_RSVDPAGE_LOC_LEN, -+ u1H2CAoacRsvdPageParm); -+ -+ _rtw_memset(&u1H2CAoacRsvdPageParm, 0, sizeof(u1H2CAoacRsvdPageParm)); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_AOAC_REPORT(u1H2CAoacRsvdPageParm, -+ rsvdpageloc->LocAOACReport); -+ ret = rtw_hal_fill_h2c_cmd(padapter, -+ H2C_AOAC_RSVDPAGE3, -+ H2C_AOAC_RSVDPAGE_LOC_LEN, -+ u1H2CAoacRsvdPageParm); -+ pwrpriv->wowlan_aoac_rpt_loc = rsvdpageloc->LocAOACReport; -+ } -+#ifdef CONFIG_PNO_SUPPORT -+ else { -+ -+ if (!pwrpriv->wowlan_in_resume) { -+ RTW_INFO("NLO_INFO=%d\n", rsvdpageloc->LocPNOInfo); -+ _rtw_memset(&u1H2CAoacRsvdPageParm, 0, -+ sizeof(u1H2CAoacRsvdPageParm)); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_NLO_INFO(u1H2CAoacRsvdPageParm, -+ rsvdpageloc->LocPNOInfo); -+ ret = rtw_hal_fill_h2c_cmd(padapter, -+ H2C_AOAC_RSVDPAGE3, -+ H2C_AOAC_RSVDPAGE_LOC_LEN, -+ u1H2CAoacRsvdPageParm); -+ } -+ } -+#endif /* CONFIG_PNO_SUPPORT */ -+#endif /* CONFIG_WOWLAN */ -+} -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+static void rtw_hal_force_enable_rxdma(_adapter *adapter) -+{ -+ RTW_INFO("%s: Set 0x690=0x00\n", __func__); -+ rtw_write8(adapter, REG_WOW_CTRL, -+ (rtw_read8(adapter, REG_WOW_CTRL) & 0xf0)); -+ RTW_PRINT("%s: Release RXDMA\n", __func__); -+ rtw_write32(adapter, REG_RXPKT_NUM, -+ (rtw_read32(adapter, REG_RXPKT_NUM) & (~RW_RELEASE_EN))); -+} -+ -+static void rtw_hal_disable_tx_report(_adapter *adapter) -+{ -+ rtw_write8(adapter, REG_TX_RPT_CTRL, -+ ((rtw_read8(adapter, REG_TX_RPT_CTRL) & ~BIT(1))) & ~BIT(5)); -+ RTW_INFO("disable TXRPT:0x%02x\n", rtw_read8(adapter, REG_TX_RPT_CTRL)); -+} -+ -+static void rtw_hal_enable_tx_report(_adapter *adapter) -+{ -+ rtw_write8(adapter, REG_TX_RPT_CTRL, -+ ((rtw_read8(adapter, REG_TX_RPT_CTRL) | BIT(1))) | BIT(5)); -+ RTW_INFO("enable TX_RPT:0x%02x\n", rtw_read8(adapter, REG_TX_RPT_CTRL)); -+} -+ -+static void rtw_hal_release_rx_dma(_adapter *adapter) -+{ -+ u32 val32 = 0; -+ -+ val32 = rtw_read32(adapter, REG_RXPKT_NUM); -+ -+ rtw_write32(adapter, REG_RXPKT_NUM, (val32 & (~RW_RELEASE_EN))); -+ -+ RTW_INFO("%s, [0x%04x]: 0x%08x\n", -+ __func__, REG_RXPKT_NUM, (val32 & (~RW_RELEASE_EN))); -+} -+ -+static u8 rtw_hal_pause_rx_dma(_adapter *adapter) -+{ -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ u8 ret = 0; -+ s8 trycnt = 100; -+ u16 len = 0; -+ u32 tmp = 0; -+ int res = 0; -+ /* RX DMA stop */ -+ RTW_PRINT("Pause DMA\n"); -+ rtw_write32(adapter, REG_RXPKT_NUM, -+ (rtw_read32(adapter, REG_RXPKT_NUM) | RW_RELEASE_EN)); -+ do { -+ if ((rtw_read32(adapter, REG_RXPKT_NUM) & RXDMA_IDLE)) { -+#ifdef CONFIG_USB_HCI -+ /* stop interface before leave */ -+ if (_TRUE == hal->usb_intf_start) { -+ rtw_intf_stop(adapter); -+ RTW_ENABLE_FUNC(adapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(adapter, DF_TX_BIT); -+ } -+#endif /* CONFIG_USB_HCI */ -+ -+ RTW_PRINT("RX_DMA_IDLE is true\n"); -+ ret = _SUCCESS; -+ break; -+ } -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ else { -+ /* If RX_DMA is not idle, receive one pkt from DMA */ -+ res = sdio_local_read(adapter, -+ SDIO_REG_RX0_REQ_LEN, 4, (u8 *)&tmp); -+ len = le16_to_cpu(tmp); -+ RTW_PRINT("RX len:%d\n", len); -+ -+ if (len > 0) -+ res = RecvOnePkt(adapter, len); -+ else -+ RTW_PRINT("read length fail %d\n", len); -+ -+ RTW_PRINT("RecvOnePkt Result: %d\n", res); -+ } -+#endif /* CONFIG_SDIO_HCI || CONFIG_GSPI_HCI */ -+ -+#ifdef CONFIG_USB_HCI -+ else { -+ /* to avoid interface start repeatedly */ -+ if (_FALSE == hal->usb_intf_start) -+ rtw_intf_start(adapter); -+ } -+#endif /* CONFIG_USB_HCI */ -+ } while (trycnt--); -+ -+ if (trycnt < 0) { -+ tmp = rtw_read16(adapter, REG_RXPKT_NUM + 3); -+ -+ RTW_PRINT("Stop RX DMA failed......\n"); -+ RTW_PRINT("%s, RXPKT_NUM: 0x%04x\n", -+ __func__, tmp); -+ tmp = rtw_read16(adapter, REG_RXPKT_NUM + 2); -+ if (tmp & BIT(3)) -+ RTW_PRINT("%s, RX DMA has req\n", -+ __func__); -+ else -+ RTW_PRINT("%s, RX DMA no req\n", -+ __func__); -+ ret = _FAIL; -+ } -+ -+ return ret; -+} -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+static u8 rtw_hal_enable_cpwm2(_adapter *adapter) -+{ -+ u8 ret = 0; -+ int res = 0; -+ u32 tmp = 0; -+#ifdef CONFIG_GPIO_WAKEUP -+ return _SUCCESS; -+#else -+ RTW_PRINT("%s\n", __func__); -+ -+ res = sdio_local_read(adapter, SDIO_REG_HIMR, 4, (u8 *)&tmp); -+ if (!res) -+ RTW_INFO("read SDIO_REG_HIMR: 0x%08x\n", tmp); -+ else -+ RTW_INFO("sdio_local_read fail\n"); -+ -+ tmp = SDIO_HIMR_CPWM2_MSK; -+ -+ res = sdio_local_write(adapter, SDIO_REG_HIMR, 4, (u8 *)&tmp); -+ -+ if (!res) { -+ res = sdio_local_read(adapter, SDIO_REG_HIMR, 4, (u8 *)&tmp); -+ RTW_INFO("read again SDIO_REG_HIMR: 0x%08x\n", tmp); -+ ret = _SUCCESS; -+ } else { -+ RTW_INFO("sdio_local_write fail\n"); -+ ret = _FAIL; -+ } -+ -+ return ret; -+#endif /* CONFIG_CPIO_WAKEUP */ -+} -+#endif /* CONFIG_SDIO_HCI, CONFIG_GSPI_HCI */ -+#endif /* CONFIG_WOWLAN || CONFIG_AP_WOWLAN */ -+ -+#ifdef CONFIG_WOWLAN -+/* -+ * rtw_hal_check_wow_ctrl -+ * chk_type: _TRUE means to check enable, if 0x690 & bit1, WOW enable successful -+ * _FALSE means to check disable, if 0x690 & bit1, WOW disable fail -+ */ -+static u8 rtw_hal_check_wow_ctrl(_adapter *adapter, u8 chk_type) -+{ -+ u8 mstatus = 0; -+ u8 trycnt = 25; -+ u8 res = _FALSE; -+ -+ mstatus = rtw_read8(adapter, REG_WOW_CTRL); -+ RTW_INFO("%s mstatus:0x%02x\n", __func__, mstatus); -+ -+ if (chk_type) { -+ while (!(mstatus & BIT1) && trycnt > 1) { -+ mstatus = rtw_read8(adapter, REG_WOW_CTRL); -+ RTW_PRINT("Loop index: %d :0x%02x\n", -+ trycnt, mstatus); -+ trycnt--; -+ rtw_msleep_os(20); -+ } -+ if (mstatus & BIT1) -+ res = _TRUE; -+ else -+ res = _FALSE; -+ } else { -+ while (mstatus & BIT1 && trycnt > 1) { -+ mstatus = rtw_read8(adapter, REG_WOW_CTRL); -+ RTW_PRINT("Loop index: %d :0x%02x\n", -+ trycnt, mstatus); -+ trycnt--; -+ rtw_msleep_os(20); -+ } -+ -+ if (mstatus & BIT1) -+ res = _FALSE; -+ else -+ res = _TRUE; -+ } -+ RTW_PRINT("%s check_type: %d res: %d trycnt: %d\n", -+ __func__, chk_type, res, (25 - trycnt)); -+ return res; -+} -+ -+#ifdef CONFIG_PNO_SUPPORT -+static u8 rtw_hal_check_pno_enabled(_adapter *adapter) -+{ -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); -+ u8 res = 0, count = 0; -+ u8 ret = _FALSE; -+ -+ if (ppwrpriv->wowlan_pno_enable && ppwrpriv->wowlan_in_resume == _FALSE) { -+ res = rtw_read8(adapter, REG_PNO_STATUS); -+ while (!(res & BIT(7)) && count < 25) { -+ RTW_INFO("[%d] cmd: 0x81 REG_PNO_STATUS: 0x%02x\n", -+ count, res); -+ res = rtw_read8(adapter, REG_PNO_STATUS); -+ count++; -+ rtw_msleep_os(2); -+ } -+ if (res & BIT(7)) -+ ret = _TRUE; -+ else -+ ret = _FALSE; -+ RTW_INFO("cmd: 0x81 REG_PNO_STATUS: ret(%d)\n", ret); -+ } -+ return ret; -+} -+#endif -+ -+static void rtw_hal_backup_rate(_adapter *adapter) -+{ -+ RTW_INFO("%s\n", __func__); -+ /* backup data rate to register 0x8b for wowlan FW */ -+ rtw_write8(adapter, 0x8d, 1); -+ rtw_write8(adapter, 0x8c, 0); -+ rtw_write8(adapter, 0x8f, 0x40); -+ rtw_write8(adapter, 0x8b, rtw_read8(adapter, 0x2f0)); -+} -+ -+#ifdef CONFIG_GTK_OL -+static void rtw_hal_fw_sync_cam_id(_adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ int cam_id, index = 0; -+ u8 *addr = NULL; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ return; -+ -+ addr = get_bssid(pmlmepriv); -+ -+ if (addr == NULL) { -+ RTW_INFO("%s: get bssid MAC addr fail!!\n", __func__); -+ return; -+ } -+ -+ rtw_clean_dk_section(adapter); -+ -+ do { -+ cam_id = rtw_camid_search(adapter, addr, index, 1); -+ -+ if (cam_id == -1) -+ RTW_INFO("%s: cam_id: %d, key_id:%d\n", __func__, cam_id, index); -+ else -+ rtw_sec_cam_swap(adapter, cam_id, index); -+ -+ index++; -+ } while (index < 4); -+ -+ rtw_write8(adapter, REG_SECCFG, 0xcc); -+} -+static void rtw_hal_update_gtk_offload_info(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct aoac_report *paoac_rpt = &pwrctl->wowlan_aoac_rpt; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ _irqL irqL; -+ u8 get_key[16]; -+ u8 gtk_keyindex = 0, offset = 0; -+ u64 replay_count = 0; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ return; -+ -+ _rtw_memset(get_key, 0, sizeof(get_key)); -+ _rtw_memcpy(&replay_count, -+ paoac_rpt->replay_counter_eapol_key, 8); -+ -+ /*read gtk key index*/ -+ gtk_keyindex = paoac_rpt->key_index; -+ -+ if (gtk_keyindex == 5 || gtk_keyindex == 0) { -+ RTW_INFO("%s no rekey event happened.\n", __func__); -+ } else if (gtk_keyindex > 0 && gtk_keyindex < 4) { -+ -+ RTW_INFO("%s update security key.\n", __func__); -+ -+ /*read key from sec-cam,for DK ,keyindex is equal to cam-id*/ -+ rtw_sec_read_cam_ent(adapter, gtk_keyindex, NULL, NULL, get_key); -+ -+ rtw_clean_hw_dk_cam(adapter); -+ if (_rtw_camid_is_gk(adapter, gtk_keyindex)) { -+ _enter_critical_bh(&cam_ctl->lock, &irqL); -+ _rtw_memcpy(&dvobj->cam_cache[gtk_keyindex].key, get_key, 16); -+ _exit_critical_bh(&cam_ctl->lock, &irqL); -+ } else { -+ struct setkey_parm parm_gtk; -+ -+ parm_gtk.algorithm = psecuritypriv->dot118021XGrpPrivacy; -+ parm_gtk.keyid = gtk_keyindex; -+ _rtw_memcpy(parm_gtk.key, get_key, 16); -+ setkey_hdl(adapter, (u8 *)&parm_gtk); -+ } -+ -+ /*update key into related sw variable and sec-cam cache*/ -+ psecuritypriv->dot118021XGrpKeyid = gtk_keyindex; -+ _rtw_memcpy(&psecuritypriv->dot118021XGrpKey[gtk_keyindex], -+ get_key, 16); -+ /* update SW TKIP TX/RX MIC value */ -+ if (psecuritypriv->dot118021XGrpPrivacy == _TKIP_) { -+ offset = RTW_KEK_LEN + RTW_TKIP_MIC_LEN; -+ _rtw_memcpy( -+ &psecuritypriv->dot118021XGrptxmickey[gtk_keyindex], -+ &(paoac_rpt->group_key[offset]), -+ RTW_TKIP_MIC_LEN); -+ -+ offset = RTW_KEK_LEN; -+ _rtw_memcpy( -+ &psecuritypriv->dot118021XGrprxmickey[gtk_keyindex], -+ &(paoac_rpt->group_key[offset]), -+ RTW_TKIP_MIC_LEN); -+ } -+ -+ RTW_PRINT("GTK (%d) "KEY_FMT"\n", gtk_keyindex, -+ KEY_ARG(psecuritypriv->dot118021XGrpKey[gtk_keyindex].skey)); -+ } -+ -+ rtw_clean_dk_section(adapter); -+ -+ rtw_write8(adapter, REG_SECCFG, 0x0c); -+ -+ #ifdef CONFIG_GTK_OL_DBG -+ /* if (gtk_keyindex != 5) */ -+ dump_sec_cam(RTW_DBGDUMP, adapter); -+ dump_sec_cam_cache(RTW_DBGDUMP, adapter); -+ #endif -+} -+#endif -+ -+static void rtw_dump_aoac_rpt(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct aoac_report *paoac_rpt = &pwrctl->wowlan_aoac_rpt; -+ -+ RTW_INFO_DUMP("[AOAC-RPT] IV -", paoac_rpt->iv, 8); -+ RTW_INFO_DUMP("[AOAC-RPT] Replay counter of EAPOL key - ", -+ paoac_rpt->replay_counter_eapol_key, 8); -+ RTW_INFO_DUMP("[AOAC-RPT] Group key - ", paoac_rpt->group_key, 32); -+ RTW_INFO("[AOAC-RPT] Key Index - %d\n", paoac_rpt->key_index); -+ RTW_INFO("[AOAC-RPT] Security Type - %d\n", paoac_rpt->scurity_type); -+} -+ -+static bool rtw_hal_get_rsvd_page(_adapter *adapter, u32 page_offset, -+ u32 page_num, u8 *buffer, u32 buffer_size) -+{ -+ u32 addr = 0, size = 0, page_size = 0, data_low = 0, data_high = 0; -+ u16 txbndy = 0, offset = 0; -+ u8 i = 0, count = 0; -+ bool rst = _FALSE; -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); -+ -+ addr = page_offset * page_size; -+ size = page_num * page_size; -+ -+ if (buffer_size < size) { -+ RTW_ERR("%s buffer_size(%d) < get page total size(%d)\n", -+ __func__, buffer_size, size); -+ return rst; -+ } -+ -+ txbndy = rtw_read8(adapter, REG_TDECTRL + 1); -+ -+ offset = (txbndy + page_offset) << 4; -+ count = (sizeof(struct aoac_report) / 8) + 1; -+ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, 0x69); -+ -+ for (i = 0 ; i < count ; i++) { -+ rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, offset + i); -+ data_low = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L); -+ data_high = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); -+ _rtw_memcpy(buffer + (i * 8), -+ &data_low, sizeof(data_low)); -+ _rtw_memcpy(buffer + ((i * 8) + 4), -+ &data_high, sizeof(data_high)); -+ } -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, 0x0); -+ return _TRUE; -+} -+ -+static void rtw_hal_get_aoac_rpt(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct aoac_report *paoac_rpt = &pwrctl->wowlan_aoac_rpt; -+ u32 page_offset = 0, page_number = 0; -+ u32 page_size = 0, buf_size = 0; -+ u8 *buffer = NULL; -+ u8 i = 0, tmp = 0; -+ int ret = -1; -+ -+ /* read aoac report from rsvd page */ -+ page_offset = pwrctl->wowlan_aoac_rpt_loc; -+ page_number = 1; -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); -+ buf_size = page_size * page_number; -+ -+ buffer = rtw_zvmalloc(buf_size); -+ -+ if (NULL == buffer) { -+ RTW_ERR("%s buffer allocate failed size(%d)\n", -+ __func__, buf_size); -+ return; -+ } -+ -+ RTW_INFO("Get AOAC Report from rsvd page_offset:%d\n", page_offset); -+ -+ ret = rtw_hal_get_rsvd_page(adapter, page_offset, -+ page_number, buffer, buf_size); -+ -+ if (ret == _FALSE) { -+ RTW_ERR("%s get aoac report failed\n", __func__); -+ rtw_warn_on(1); -+ goto _exit; -+ } -+ -+ _rtw_memset(paoac_rpt, 0, sizeof(struct aoac_report)); -+ _rtw_memcpy(paoac_rpt, buffer, sizeof(struct aoac_report)); -+ -+ for (i = 0 ; i < 4 ; i++) { -+ tmp = paoac_rpt->replay_counter_eapol_key[i]; -+ paoac_rpt->replay_counter_eapol_key[i] = -+ paoac_rpt->replay_counter_eapol_key[7 - i]; -+ paoac_rpt->replay_counter_eapol_key[7 - i] = tmp; -+ } -+ -+ /* rtw_dump_aoac_rpt(adapter); */ -+ -+_exit: -+ if (buffer) -+ rtw_vmfree(buffer, buf_size); -+ -+} -+ -+static void rtw_hal_update_tx_iv(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct aoac_report *paoac_rpt = &pwrctl->wowlan_aoac_rpt; -+ struct sta_info *psta; -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct security_priv *psecpriv = &adapter->securitypriv; -+ -+ u16 val16 = 0; -+ u32 val32 = 0; -+ u64 txiv = 0; -+ u8 *pval = NULL; -+ -+ psta = rtw_get_stainfo(&adapter->stapriv, -+ get_my_bssid(&pmlmeinfo->network)); -+ -+ /* Update TX iv data. */ -+ pval = (u8 *)&paoac_rpt->iv; -+ -+ if (psecpriv->dot11PrivacyAlgrthm == _TKIP_) { -+ val16 = ((u16)(paoac_rpt->iv[2]) << 0) + -+ ((u16)(paoac_rpt->iv[0]) << 8); -+ val32 = ((u32)(paoac_rpt->iv[4])<< 0) + -+ ((u32)(paoac_rpt->iv[5]) << 8) + -+ ((u32)(paoac_rpt->iv[6]) << 16) + -+ ((u32)(paoac_rpt->iv[7]) << 24); -+ } else if (psecpriv->dot11PrivacyAlgrthm == _AES_) { -+ val16 = ((u16)(paoac_rpt->iv[0]) << 0) + -+ ((u16)(paoac_rpt->iv[1]) << 8); -+ val32 = ((u32) (paoac_rpt->iv[4]) << 0) + -+ ((u32)(paoac_rpt->iv[5]) << 8) + -+ ((u32)(paoac_rpt->iv[6]) << 16) + -+ ((u32)(paoac_rpt->iv[7]) << 24); -+ } -+ -+ if (psta) { -+ txiv = val16 + ((u64)val32 << 16); -+ if (txiv != 0) -+ psta->dot11txpn.val = txiv; -+ } -+} -+ -+static void rtw_hal_update_sw_security_info(_adapter *adapter) -+{ -+ rtw_hal_update_tx_iv(adapter); -+ rtw_hal_update_gtk_offload_info(adapter); -+} -+ -+static u8 rtw_hal_set_keep_alive_cmd(_adapter *adapter, u8 enable, u8 pkt_type) -+{ -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ -+ u8 u1H2CKeepAliveParm[H2C_KEEP_ALIVE_CTRL_LEN] = {0}; -+ u8 adopt = 1, check_period = 5; -+ u8 ret = _FAIL; -+ -+ RTW_INFO("%s(): enable = %d\n", __func__, enable); -+ SET_H2CCMD_KEEPALIVE_PARM_ENABLE(u1H2CKeepAliveParm, enable); -+ SET_H2CCMD_KEEPALIVE_PARM_ADOPT(u1H2CKeepAliveParm, adopt); -+ SET_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(u1H2CKeepAliveParm, pkt_type); -+ SET_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(u1H2CKeepAliveParm, check_period); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_KEEP_ALIVE, -+ H2C_KEEP_ALIVE_CTRL_LEN, -+ u1H2CKeepAliveParm); -+ -+ return ret; -+} -+ -+static u8 rtw_hal_set_disconnect_decision_cmd(_adapter *adapter, u8 enable) -+{ -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u8 u1H2CDisconDecisionParm[H2C_DISCON_DECISION_LEN] = {0}; -+ u8 adopt = 1, check_period = 10, trypkt_num = 0; -+ u8 ret = _FAIL; -+ -+ RTW_INFO("%s(): enable = %d\n", __func__, enable); -+ SET_H2CCMD_DISCONDECISION_PARM_ENABLE(u1H2CDisconDecisionParm, enable); -+ SET_H2CCMD_DISCONDECISION_PARM_ADOPT(u1H2CDisconDecisionParm, adopt); -+ SET_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(u1H2CDisconDecisionParm, check_period); -+ SET_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(u1H2CDisconDecisionParm, trypkt_num); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_DISCON_DECISION, -+ H2C_DISCON_DECISION_LEN, -+ u1H2CDisconDecisionParm); -+ return ret; -+} -+ -+static u8 rtw_hal_set_wowlan_ctrl_cmd(_adapter *adapter, u8 enable, u8 change_unit) -+{ -+ struct security_priv *psecpriv = &adapter->securitypriv; -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ -+ u8 u1H2CWoWlanCtrlParm[H2C_WOWLAN_LEN] = {0}; -+ u8 discont_wake = 1, gpionum = 0, gpio_dur = 0; -+ u8 hw_unicast = 0, gpio_pulse_cnt = 0, gpio_pulse_en = 0; -+ u8 sdio_wakeup_enable = 1; -+ u8 gpio_high_active = 0; -+ u8 magic_pkt = 0; -+ u8 gpio_unit = 0; /*0: 64ns, 1: 8ms*/ -+ u8 ret = _FAIL; -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ gpio_high_active = ppwrpriv->is_high_active; -+ gpionum = WAKEUP_GPIO_IDX; -+ sdio_wakeup_enable = 0; -+#endif /* CONFIG_GPIO_WAKEUP */ -+ -+ if (!ppwrpriv->wowlan_pno_enable) -+ magic_pkt = enable; -+ -+ if (psecpriv->dot11PrivacyAlgrthm == _WEP40_ || psecpriv->dot11PrivacyAlgrthm == _WEP104_) -+ hw_unicast = 1; -+ else -+ hw_unicast = 0; -+ -+ RTW_INFO("%s(): enable=%d change_unit=%d\n", __func__, -+ enable, change_unit); -+ -+ /* time = (gpio_dur/2) * gpio_unit, default:256 ms */ -+ if (enable && change_unit) { -+ gpio_dur = 0x40; -+ gpio_unit = 1; -+ gpio_pulse_en = 1; -+ } -+ -+#ifdef CONFIG_PLATFORM_ARM_RK3188 -+ if (enable) { -+ gpio_pulse_en = 1; -+ gpio_pulse_cnt = 0x04; -+ } -+#endif -+ -+ SET_H2CCMD_WOWLAN_FUNC_ENABLE(u1H2CWoWlanCtrlParm, enable); -+ SET_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(u1H2CWoWlanCtrlParm, enable); -+ SET_H2CCMD_WOWLAN_MAGIC_PKT_ENABLE(u1H2CWoWlanCtrlParm, magic_pkt); -+ SET_H2CCMD_WOWLAN_UNICAST_PKT_ENABLE(u1H2CWoWlanCtrlParm, hw_unicast); -+ SET_H2CCMD_WOWLAN_ALL_PKT_DROP(u1H2CWoWlanCtrlParm, 0); -+ SET_H2CCMD_WOWLAN_GPIO_ACTIVE(u1H2CWoWlanCtrlParm, gpio_high_active); -+ -+#ifdef CONFIG_GTK_OL -+ SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(u1H2CWoWlanCtrlParm, 0); -+#else -+ SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(u1H2CWoWlanCtrlParm, enable); -+#endif -+ SET_H2CCMD_WOWLAN_DISCONNECT_WAKE_UP(u1H2CWoWlanCtrlParm, discont_wake); -+ SET_H2CCMD_WOWLAN_GPIONUM(u1H2CWoWlanCtrlParm, gpionum); -+ SET_H2CCMD_WOWLAN_DATAPIN_WAKE_UP(u1H2CWoWlanCtrlParm, sdio_wakeup_enable); -+ -+ SET_H2CCMD_WOWLAN_GPIO_DURATION(u1H2CWoWlanCtrlParm, gpio_dur); -+ SET_H2CCMD_WOWLAN_CHANGE_UNIT(u1H2CWoWlanCtrlParm, gpio_unit); -+ -+ SET_H2CCMD_WOWLAN_GPIO_PULSE_EN(u1H2CWoWlanCtrlParm, gpio_pulse_en); -+ SET_H2CCMD_WOWLAN_GPIO_PULSE_COUNT(u1H2CWoWlanCtrlParm, gpio_pulse_cnt); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_WOWLAN, -+ H2C_WOWLAN_LEN, -+ u1H2CWoWlanCtrlParm); -+ return ret; -+} -+ -+static u8 rtw_hal_set_remote_wake_ctrl_cmd(_adapter *adapter, u8 enable) -+{ -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ struct security_priv *psecuritypriv = &(adapter->securitypriv); -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ u8 u1H2CRemoteWakeCtrlParm[H2C_REMOTE_WAKE_CTRL_LEN] = {0}; -+ u8 ret = _FAIL, count = 0; -+ -+ RTW_INFO("%s(): enable=%d\n", __func__, enable); -+ -+ if (!ppwrpriv->wowlan_pno_enable) { -+ SET_H2CCMD_REMOTE_WAKECTRL_ENABLE( -+ u1H2CRemoteWakeCtrlParm, enable); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, 1); -+#ifdef CONFIG_GTK_OL -+ if (psecuritypriv->binstallKCK_KEK == _TRUE) { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, 1); -+ } else { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, 0); -+ } -+#endif /* CONFIG_GTK_OL */ -+ -+ if (pregistrypriv->default_patterns_en == _FALSE) { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_FW_UNICAST_EN( -+ u1H2CRemoteWakeCtrlParm, enable); -+ /* -+ * filter NetBios name service pkt to avoid being waked-up -+ * by this kind of unicast pkt this exceptional modification -+ * is used for match competitor's behavior -+ */ -+ SET_H2CCMD_REMOTE_WAKE_CTRL_NBNS_FILTER_EN( -+ u1H2CRemoteWakeCtrlParm, enable); -+ } -+ -+ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) -+ SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, enable); -+ -+ if ((psecuritypriv->dot11PrivacyAlgrthm == _AES_) || -+ (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) || -+ (psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_)) { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( -+ u1H2CRemoteWakeCtrlParm, 0); -+ } else { -+ SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( -+ u1H2CRemoteWakeCtrlParm, 1); -+ } -+ -+ SET_H2CCMD_REMOTE_WAKE_CTRL_FW_PARSING_UNTIL_WAKEUP( -+ u1H2CRemoteWakeCtrlParm, 1); -+ } -+#ifdef CONFIG_PNO_SUPPORT -+ else { -+ SET_H2CCMD_REMOTE_WAKECTRL_ENABLE( -+ u1H2CRemoteWakeCtrlParm, enable); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_NLO_OFFLOAD_EN( -+ u1H2CRemoteWakeCtrlParm, enable); -+ } -+#endif -+ -+#ifdef CONFIG_P2P_WOWLAN -+ if (_TRUE == ppwrpriv->wowlan_p2p_mode) { -+ RTW_INFO("P2P OFFLOAD ENABLE\n"); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(u1H2CRemoteWakeCtrlParm, 1); -+ } else { -+ RTW_INFO("P2P OFFLOAD DISABLE\n"); -+ SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(u1H2CRemoteWakeCtrlParm, 0); -+ } -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_REMOTE_WAKE_CTRL, -+ H2C_REMOTE_WAKE_CTRL_LEN, -+ u1H2CRemoteWakeCtrlParm); -+ return ret; -+} -+ -+static u8 rtw_hal_set_global_info_cmd(_adapter *adapter, u8 group_alg, u8 pairwise_alg) -+{ -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u8 ret = _FAIL; -+ u8 u1H2CAOACGlobalInfoParm[H2C_AOAC_GLOBAL_INFO_LEN] = {0}; -+ -+ RTW_INFO("%s(): group_alg=%d pairwise_alg=%d\n", -+ __func__, group_alg, pairwise_alg); -+ SET_H2CCMD_AOAC_GLOBAL_INFO_PAIRWISE_ENC_ALG(u1H2CAOACGlobalInfoParm, -+ pairwise_alg); -+ SET_H2CCMD_AOAC_GLOBAL_INFO_GROUP_ENC_ALG(u1H2CAOACGlobalInfoParm, -+ group_alg); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_AOAC_GLOBAL_INFO, -+ H2C_AOAC_GLOBAL_INFO_LEN, -+ u1H2CAOACGlobalInfoParm); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_PNO_SUPPORT -+static u8 rtw_hal_set_scan_offload_info_cmd(_adapter *adapter, -+ PRSVDPAGE_LOC rsvdpageloc, u8 enable) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ -+ u8 u1H2CScanOffloadInfoParm[H2C_SCAN_OFFLOAD_CTRL_LEN] = {0}; -+ u8 res = 0, count = 0, ret = _FAIL; -+ -+ RTW_INFO("%s: loc_probe_packet:%d, loc_scan_info: %d loc_ssid_info:%d\n", -+ __func__, rsvdpageloc->LocProbePacket, -+ rsvdpageloc->LocScanInfo, rsvdpageloc->LocSSIDInfo); -+ -+ SET_H2CCMD_AOAC_NLO_FUN_EN(u1H2CScanOffloadInfoParm, enable); -+ SET_H2CCMD_AOAC_NLO_IPS_EN(u1H2CScanOffloadInfoParm, enable); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_SCAN_INFO(u1H2CScanOffloadInfoParm, -+ rsvdpageloc->LocScanInfo); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_PROBE_PACKET(u1H2CScanOffloadInfoParm, -+ rsvdpageloc->LocProbePacket); -+ /* -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_SSID_INFO(u1H2CScanOffloadInfoParm, -+ rsvdpageloc->LocSSIDInfo); -+ */ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_D0_SCAN_OFFLOAD_INFO, -+ H2C_SCAN_OFFLOAD_CTRL_LEN, -+ u1H2CScanOffloadInfoParm); -+ return ret; -+} -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+void rtw_hal_set_fw_wow_related_cmd(_adapter *padapter, u8 enable) -+{ -+ struct security_priv *psecpriv = &padapter->securitypriv; -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ u16 media_status_rpt; -+ u8 pkt_type = 0; -+ u8 ret = _SUCCESS; -+ -+ RTW_PRINT("+%s()+: enable=%d\n", __func__, enable); -+ -+ rtw_hal_set_wowlan_ctrl_cmd(padapter, enable, _FALSE); -+ -+ if (enable) { -+ rtw_hal_set_global_info_cmd(padapter, -+ psecpriv->dot118021XGrpPrivacy, -+ psecpriv->dot11PrivacyAlgrthm); -+ -+ if (!(ppwrpriv->wowlan_pno_enable)) { -+ rtw_hal_set_disconnect_decision_cmd(padapter, enable); -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ if ((psecpriv->dot11PrivacyAlgrthm == _WEP40_) || -+ (psecpriv->dot11PrivacyAlgrthm == _WEP104_)) -+ pkt_type = 0; -+ else -+ pkt_type = 1; -+#else -+ pkt_type = 0; -+#endif /* CONFIG_ARP_KEEP_ALIVE */ -+ rtw_hal_set_keep_alive_cmd(padapter, enable, pkt_type); -+ } -+ rtw_hal_set_remote_wake_ctrl_cmd(padapter, enable); -+#ifdef CONFIG_PNO_SUPPORT -+ rtw_hal_check_pno_enabled(padapter); -+#endif /* CONFIG_PNO_SUPPORT */ -+ } else { -+#if 0 -+ { -+ u32 PageSize = 0; -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&PageSize); -+ dump_TX_FIFO(padapter, 4, PageSize); -+ } -+#endif -+ -+ rtw_hal_set_remote_wake_ctrl_cmd(padapter, enable); -+ } -+ RTW_PRINT("-%s()-\n", __func__); -+} -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_AP_WOWLAN -+static u8 rtw_hal_set_ap_wowlan_ctrl_cmd(_adapter *adapter, u8 enable) -+{ -+ struct security_priv *psecpriv = &adapter->securitypriv; -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ -+ u8 u1H2CAPWoWlanCtrlParm[H2C_AP_WOW_GPIO_CTRL_LEN] = {0}; -+ u8 gpionum = 0, gpio_dur = 0; -+ u8 gpio_pulse = enable; -+ u8 sdio_wakeup_enable = 1; -+ u8 gpio_high_active = 0; -+ u8 ret = _FAIL; -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ gpio_high_active = ppwrpriv->is_high_active; -+ gpionum = WAKEUP_GPIO_IDX; -+ sdio_wakeup_enable = 0; -+#endif /*CONFIG_GPIO_WAKEUP*/ -+ -+ RTW_INFO("%s(): enable=%d\n", __func__, enable); -+ -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_INDEX(u1H2CAPWoWlanCtrlParm, -+ gpionum); -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_PLUS(u1H2CAPWoWlanCtrlParm, -+ gpio_pulse); -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_HIGH_ACTIVE(u1H2CAPWoWlanCtrlParm, -+ gpio_high_active); -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_EN(u1H2CAPWoWlanCtrlParm, -+ enable); -+ SET_H2CCMD_AP_WOW_GPIO_CTRL_DURATION(u1H2CAPWoWlanCtrlParm, -+ gpio_dur); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_AP_WOW_GPIO_CTRL, -+ H2C_AP_WOW_GPIO_CTRL_LEN, -+ u1H2CAPWoWlanCtrlParm); -+ -+ return ret; -+} -+ -+static u8 rtw_hal_set_ap_offload_ctrl_cmd(_adapter *adapter, u8 enable) -+{ -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u8 u1H2CAPOffloadCtrlParm[H2C_WOWLAN_LEN] = {0}; -+ u8 ret = _FAIL; -+ -+ RTW_INFO("%s(): bFuncEn=%d\n", __func__, enable); -+ -+ SET_H2CCMD_AP_WOWLAN_EN(u1H2CAPOffloadCtrlParm, enable); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_AP_OFFLOAD, -+ H2C_AP_OFFLOAD_LEN, -+ u1H2CAPOffloadCtrlParm); -+ -+ return ret; -+} -+ -+static u8 rtw_hal_set_ap_ps_cmd(_adapter *adapter, u8 enable) -+{ -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u8 ap_ps_parm[H2C_AP_PS_LEN] = {0}; -+ u8 ret = _FAIL; -+ -+ RTW_INFO("%s(): enable=%d\n" , __func__ , enable); -+ -+ SET_H2CCMD_AP_WOW_PS_EN(ap_ps_parm, enable); -+#ifndef CONFIG_USB_HCI -+ SET_H2CCMD_AP_WOW_PS_32K_EN(ap_ps_parm, enable); -+#endif /*CONFIG_USB_HCI*/ -+ SET_H2CCMD_AP_WOW_PS_RF(ap_ps_parm, enable); -+ -+ if (enable) -+ SET_H2CCMD_AP_WOW_PS_DURATION(ap_ps_parm, 0x32); -+ else -+ SET_H2CCMD_AP_WOW_PS_DURATION(ap_ps_parm, 0x0); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, H2C_SAP_PS_, -+ H2C_AP_PS_LEN, ap_ps_parm); -+ -+ return ret; -+} -+ -+static void rtw_hal_set_ap_rsvdpage_loc_cmd(PADAPTER padapter, -+ PRSVDPAGE_LOC rsvdpageloc) -+{ -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ u8 rsvdparm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; -+ u8 ret = _FAIL, header = 0; -+ -+ if (pHalFunc->fill_h2c_cmd == NULL) { -+ RTW_INFO("%s: Please hook fill_h2c_cmd first!\n", __func__); -+ return; -+ } -+ -+ header = rtw_read8(padapter, REG_BCNQ_BDNY); -+ -+ RTW_INFO("%s: beacon: %d, probeRsp: %d, header:0x%02x\n", __func__, -+ rsvdpageloc->LocApOffloadBCN, -+ rsvdpageloc->LocProbeRsp, -+ header); -+ -+ SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_BCN(rsvdparm, -+ rsvdpageloc->LocApOffloadBCN + header); -+ -+ ret = rtw_hal_fill_h2c_cmd(padapter, H2C_BCN_RSVDPAGE, -+ H2C_BCN_RSVDPAGE_LEN, rsvdparm); -+ -+ if (ret == _FAIL) -+ RTW_INFO("%s: H2C_BCN_RSVDPAGE cmd fail\n", __func__); -+ -+ rtw_msleep_os(10); -+ -+ _rtw_memset(&rsvdparm, 0, sizeof(rsvdparm)); -+ -+ SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_ProbeRsp(rsvdparm, -+ rsvdpageloc->LocProbeRsp + header); -+ -+ ret = rtw_hal_fill_h2c_cmd(padapter, H2C_PROBERSP_RSVDPAGE, -+ H2C_PROBERSP_RSVDPAGE_LEN, rsvdparm); -+ -+ if (ret == _FAIL) -+ RTW_INFO("%s: H2C_PROBERSP_RSVDPAGE cmd fail\n", __func__); -+ -+ rtw_msleep_os(10); -+} -+ -+static void rtw_hal_set_fw_ap_wow_related_cmd(_adapter *padapter, u8 enable) -+{ -+ rtw_hal_set_ap_offload_ctrl_cmd(padapter, enable); -+ rtw_hal_set_ap_wowlan_ctrl_cmd(padapter, enable); -+ rtw_hal_set_ap_ps_cmd(padapter, enable); -+} -+ -+static void rtw_hal_ap_wow_enable(_adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ struct sta_info *psta = NULL; -+#ifdef DBG_CHECK_FW_PS_STATE -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+#endif /*DBG_CHECK_FW_PS_STATE*/ -+ int res; -+ u16 media_status_rpt; -+ -+ RTW_INFO("%s, WOWLAN_AP_ENABLE\n", __func__); -+#ifdef DBG_CHECK_FW_PS_STATE -+ if (rtw_fw_ps_state(padapter) == _FAIL) { -+ pdbgpriv->dbg_enwow_dload_fw_fail_cnt++; -+ RTW_PRINT("wowlan enable no leave 32k\n"); -+ } -+#endif /*DBG_CHECK_FW_PS_STATE*/ -+ -+ /* 1. Download WOWLAN FW*/ -+ rtw_hal_fw_dl(padapter, _TRUE); -+ -+ media_status_rpt = RT_MEDIA_CONNECT; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, -+ (u8 *)&media_status_rpt); -+ -+ issue_beacon(padapter, 0); -+ -+ rtw_msleep_os(2); -+ -+ if (IS_HARDWARE_TYPE_8188E(padapter)) -+ rtw_hal_disable_tx_report(padapter); -+ -+ /* RX DMA stop */ -+ res = rtw_hal_pause_rx_dma(padapter); -+ if (res == _FAIL) -+ RTW_PRINT("[WARNING] pause RX DMA fail\n"); -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ /* Enable CPWM2 only. */ -+ res = rtw_hal_enable_cpwm2(padapter); -+ if (res == _FAIL) -+ RTW_PRINT("[WARNING] enable cpwm2 fail\n"); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ rtw_hal_switch_gpio_wl_ctrl(padapter, WAKEUP_GPIO_IDX, _TRUE); -+#endif -+ /* 5. Set Enable WOWLAN H2C command. */ -+ RTW_PRINT("Set Enable AP WOWLan cmd\n"); -+ rtw_hal_set_fw_ap_wow_related_cmd(padapter, 1); -+ -+ rtw_write8(padapter, REG_MCUTST_WOWLAN, 0); -+#ifdef CONFIG_USB_HCI -+ rtw_mi_intf_stop(padapter); -+ /* Invoid SE0 reset signal during suspending*/ -+ rtw_write8(padapter, REG_RSV_CTRL, 0x20); -+ rtw_write8(padapter, REG_RSV_CTRL, 0x60); -+#endif /*CONFIG_USB_HCI*/ -+} -+ -+static void rtw_hal_ap_wow_disable(_adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+#ifdef DBG_CHECK_FW_PS_STATE -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+#endif /*DBG_CHECK_FW_PS_STATE*/ -+ u16 media_status_rpt; -+ u8 val8; -+ -+ RTW_INFO("%s, WOWLAN_AP_DISABLE\n", __func__); -+ /* 1. Read wakeup reason*/ -+ pwrctl->wowlan_wake_reason = rtw_read8(padapter, REG_MCUTST_WOWLAN); -+ -+ RTW_PRINT("wakeup_reason: 0x%02x\n", -+ pwrctl->wowlan_wake_reason); -+ -+ rtw_hal_set_fw_ap_wow_related_cmd(padapter, 0); -+ -+ rtw_msleep_os(2); -+#ifdef DBG_CHECK_FW_PS_STATE -+ if (rtw_fw_ps_state(padapter) == _FAIL) { -+ pdbgpriv->dbg_diswow_dload_fw_fail_cnt++; -+ RTW_PRINT("wowlan enable no leave 32k\n"); -+ } -+#endif /*DBG_CHECK_FW_PS_STATE*/ -+ -+ if (IS_HARDWARE_TYPE_8188E(padapter)) -+ rtw_hal_enable_tx_report(padapter); -+ -+ rtw_hal_force_enable_rxdma(padapter); -+ -+ rtw_hal_fw_dl(padapter, _FALSE); -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ val8 = (pwrctl->is_high_active == 0) ? 1 : 0; -+ RTW_PRINT("Set Wake GPIO to default(%d).\n", val8); -+ rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, val8); -+#endif -+ media_status_rpt = RT_MEDIA_CONNECT; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, -+ (u8 *)&media_status_rpt); -+ -+ issue_beacon(padapter, 0); -+} -+#endif /*CONFIG_AP_WOWLAN*/ -+ -+#ifdef CONFIG_P2P_WOWLAN -+static int update_hidden_ssid(u8 *ies, u32 ies_len, u8 hidden_ssid_mode) -+{ -+ u8 *ssid_ie; -+ sint ssid_len_ori; -+ int len_diff = 0; -+ -+ ssid_ie = rtw_get_ie(ies, WLAN_EID_SSID, &ssid_len_ori, ies_len); -+ -+ /* RTW_INFO("%s hidden_ssid_mode:%u, ssid_ie:%p, ssid_len_ori:%d\n", __FUNCTION__, hidden_ssid_mode, ssid_ie, ssid_len_ori); */ -+ -+ if (ssid_ie && ssid_len_ori > 0) { -+ switch (hidden_ssid_mode) { -+ case 1: { -+ u8 *next_ie = ssid_ie + 2 + ssid_len_ori; -+ u32 remain_len = 0; -+ -+ remain_len = ies_len - (next_ie - ies); -+ -+ ssid_ie[1] = 0; -+ _rtw_memcpy(ssid_ie + 2, next_ie, remain_len); -+ len_diff -= ssid_len_ori; -+ -+ break; -+ } -+ case 2: -+ _rtw_memset(&ssid_ie[2], 0, ssid_len_ori); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ return len_diff; -+} -+ -+static void rtw_hal_construct_P2PBeacon(_adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ /* struct xmit_frame *pmgntframe; */ -+ /* struct pkt_attrib *pattrib; */ -+ /* unsigned char *pframe; */ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned int rate_len; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ u32 pktlen; -+ /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ -+ /* _irqL irqL; -+ * struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ * #endif */ /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P */ -+ -+ /* for debug */ -+ u8 *dbgbuf = pframe; -+ u8 dbgbufLen = 0, index = 0; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ -+ /* _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+ * #endif */ /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ /* pmlmeext->mgnt_seq++; */ -+ SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { -+ /* RTW_INFO("ie len=%d\n", cur_network->IELength); */ -+#ifdef CONFIG_P2P -+ /* for P2P : Primary Device Type & Device Name */ -+ u32 wpsielen = 0, insert_len = 0; -+ u8 *wpsie = NULL; -+ wpsie = rtw_get_wps_ie(cur_network->IEs + _FIXED_IE_LENGTH_, cur_network->IELength - _FIXED_IE_LENGTH_, NULL, &wpsielen); -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && wpsie && wpsielen > 0) { -+ uint wps_offset, remainder_ielen; -+ u8 *premainder_ie, *pframe_wscie; -+ -+ wps_offset = (uint)(wpsie - cur_network->IEs); -+ -+ premainder_ie = wpsie + wpsielen; -+ -+ remainder_ielen = cur_network->IELength - wps_offset - wpsielen; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (pmlmepriv->wps_beacon_ie && pmlmepriv->wps_beacon_ie_len > 0) { -+ _rtw_memcpy(pframe, cur_network->IEs, wps_offset); -+ pframe += wps_offset; -+ pktlen += wps_offset; -+ -+ _rtw_memcpy(pframe, pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len); -+ pframe += pmlmepriv->wps_beacon_ie_len; -+ pktlen += pmlmepriv->wps_beacon_ie_len; -+ -+ /* copy remainder_ie to pframe */ -+ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pktlen += remainder_ielen; -+ } else { -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ pframe += cur_network->IELength; -+ pktlen += cur_network->IELength; -+ } -+ } else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ { -+ pframe_wscie = pframe + wps_offset; -+ _rtw_memcpy(pframe, cur_network->IEs, wps_offset + wpsielen); -+ pframe += (wps_offset + wpsielen); -+ pktlen += (wps_offset + wpsielen); -+ -+ /* now pframe is end of wsc ie, insert Primary Device Type & Device Name */ -+ /* Primary Device Type */ -+ /* Type: */ -+ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_ATTR_PRIMARY_DEV_TYPE); -+ insert_len += 2; -+ -+ /* Length: */ -+ *(u16 *)(pframe + insert_len) = cpu_to_be16(0x0008); -+ insert_len += 2; -+ -+ /* Value: */ -+ /* Category ID */ -+ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); -+ insert_len += 2; -+ -+ /* OUI */ -+ *(u32 *)(pframe + insert_len) = cpu_to_be32(WPSOUI); -+ insert_len += 4; -+ -+ /* Sub Category ID */ -+ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); -+ insert_len += 2; -+ -+ -+ /* Device Name */ -+ /* Type: */ -+ *(u16 *)(pframe + insert_len) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); -+ insert_len += 2; -+ -+ /* Length: */ -+ *(u16 *)(pframe + insert_len) = cpu_to_be16(pwdinfo->device_name_len); -+ insert_len += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(pframe + insert_len, pwdinfo->device_name, pwdinfo->device_name_len); -+ insert_len += pwdinfo->device_name_len; -+ -+ -+ /* update wsc ie length */ -+ *(pframe_wscie + 1) = (wpsielen - 2) + insert_len; -+ -+ /* pframe move to end */ -+ pframe += insert_len; -+ pktlen += insert_len; -+ -+ /* copy remainder_ie to pframe */ -+ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pktlen += remainder_ielen; -+ } -+ } else -+#endif /* CONFIG_P2P */ -+ { -+ int len_diff; -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ len_diff = update_hidden_ssid( -+ pframe + _BEACON_IE_OFFSET_ -+ , cur_network->IELength - _BEACON_IE_OFFSET_ -+ , pmlmeinfo->hidden_ssid_mode -+ ); -+ pframe += (cur_network->IELength + len_diff); -+ pktlen += (cur_network->IELength + len_diff); -+ } -+#if 0 -+ { -+ u8 *wps_ie; -+ uint wps_ielen; -+ u8 sr = 0; -+ wps_ie = rtw_get_wps_ie(pmgntframe->buf_addr + TXDESC_OFFSET + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_, -+ pattrib->pktlen - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_, NULL, &wps_ielen); -+ if (wps_ie && wps_ielen > 0) -+ rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8 *)(&sr), NULL); -+ if (sr != 0) -+ set_fwstate(pmlmepriv, WIFI_UNDER_WPS); -+ else -+ _clr_fwstate_(pmlmepriv, WIFI_UNDER_WPS); -+ } -+#endif -+#ifdef CONFIG_P2P -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ u32 len; -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (pwdinfo->driver_interface == DRIVER_CFG80211) { -+ len = pmlmepriv->p2p_beacon_ie_len; -+ if (pmlmepriv->p2p_beacon_ie && len > 0) -+ _rtw_memcpy(pframe, pmlmepriv->p2p_beacon_ie, len); -+ } else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ { -+ len = build_beacon_p2p_ie(pwdinfo, pframe); -+ } -+ -+ pframe += len; -+ pktlen += len; -+ -+ #ifdef CONFIG_WFD -+ len = rtw_append_beacon_wfd_ie(padapter, pframe); -+ pframe += len; -+ pktlen += len; -+ #endif -+ -+ } -+#endif /* CONFIG_P2P */ -+ -+ goto _issue_bcn; -+ -+ } -+ -+ /* below for ad-hoc mode */ -+ -+ /* timestamp will be inserted by hardware */ -+ pframe += 8; -+ pktlen += 8; -+ -+ /* beacon interval: 2 bytes */ -+ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ /* capability info: 2 bytes */ -+ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen); -+ -+ /* supported rates... */ -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pktlen); -+ -+ /* DS parameter set */ -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen); -+ -+ /* if( (pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) */ -+ { -+ u8 erpinfo = 0; -+ u32 ATIMWindow; -+ /* IBSS Parameter Set... */ -+ /* ATIMWindow = cur->Configuration.ATIMWindow; */ -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen); -+ -+ /* ERP IE */ -+ pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pktlen); -+ } -+ -+ -+ /* EXTERNDED SUPPORTED RATE */ -+ if (rate_len > 8) -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); -+ -+ -+ /* todo:HT for adhoc */ -+ -+_issue_bcn: -+ -+ /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ -+ /* pmlmepriv->update_bcn = _FALSE; -+ * -+ * _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+ * #endif */ /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ -+ -+ *pLength = pktlen; -+#if 0 -+ /* printf dbg msg */ -+ dbgbufLen = pktlen; -+ RTW_INFO("======> DBG MSG FOR CONSTRAUCT P2P BEACON\n"); -+ -+ for (index = 0; index < dbgbufLen; index++) -+ printk("%x ", *(dbgbuf + index)); -+ -+ printk("\n"); -+ RTW_INFO("<====== DBG MSG FOR CONSTRAUCT P2P BEACON\n"); -+ -+#endif -+} -+ -+static int get_reg_classes_full_count(struct p2p_channels channel_list) -+{ -+ int cnt = 0; -+ int i; -+ -+ for (i = 0; i < channel_list.reg_classes; i++) -+ cnt += channel_list.reg_class[i].channels; -+ -+ return cnt; -+} -+ -+static void rtw_hal_construct_P2PProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ /* struct xmit_frame *pmgntframe; */ -+ /* struct pkt_attrib *pattrib; */ -+ /* unsigned char *pframe; */ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned char *mac; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ /* WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); */ -+ u16 beacon_interval = 100; -+ u16 capInfo = 0; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 wpsie[255] = { 0x00 }; -+ u32 wpsielen = 0, p2pielen = 0; -+ u32 pktlen; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+#ifdef CONFIG_INTEL_WIDI -+ u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ /* for debug */ -+ u8 *dbgbuf = pframe; -+ u8 dbgbufLen = 0, index = 0; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = adapter_mac_addr(padapter); -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ /* DA filled by FW */ -+ _rtw_memset(pwlanhdr->addr1, 0, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ /* Use the device address for BSSID field. */ -+ _rtw_memcpy(pwlanhdr->addr3, mac, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(fctrl, WIFI_PROBERSP); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pframe += pktlen; -+ -+ -+ /* timestamp will be inserted by hardware */ -+ pframe += 8; -+ pktlen += 8; -+ -+ /* beacon interval: 2 bytes */ -+ _rtw_memcpy(pframe, (unsigned char *) &beacon_interval, 2); -+ pframe += 2; -+ pktlen += 2; -+ -+ /* capability info: 2 bytes */ -+ /* ESS and IBSS bits must be 0 (defined in the 3.1.2.1.1 of WiFi Direct Spec) */ -+ capInfo |= cap_ShortPremble; -+ capInfo |= cap_ShortSlot; -+ -+ _rtw_memcpy(pframe, (unsigned char *) &capInfo, 2); -+ pframe += 2; -+ pktlen += 2; -+ -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, 7, pwdinfo->p2p_wildcard_ssid, &pktlen); -+ -+ /* supported rates... */ -+ /* Use the OFDM rate in the P2P probe response frame. ( 6(B), 9(B), 12, 18, 24, 36, 48, 54 ) */ -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pwdinfo->support_rate, &pktlen); -+ -+ /* DS parameter set */ -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&pwdinfo->listen_channel, &pktlen); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (pmlmepriv->wps_probe_resp_ie != NULL && pmlmepriv->p2p_probe_resp_ie != NULL) { -+ /* WPS IE */ -+ _rtw_memcpy(pframe, pmlmepriv->wps_probe_resp_ie, pmlmepriv->wps_probe_resp_ie_len); -+ pktlen += pmlmepriv->wps_probe_resp_ie_len; -+ pframe += pmlmepriv->wps_probe_resp_ie_len; -+ -+ /* P2P IE */ -+ _rtw_memcpy(pframe, pmlmepriv->p2p_probe_resp_ie, pmlmepriv->p2p_probe_resp_ie_len); -+ pktlen += pmlmepriv->p2p_probe_resp_ie_len; -+ pframe += pmlmepriv->p2p_probe_resp_ie_len; -+ } -+ } else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ { -+ -+ /* Todo: WPS IE */ -+ /* Noted by Albert 20100907 */ -+ /* According to the WPS specification, all the WPS attribute is presented by Big Endian. */ -+ -+ wpsielen = 0; -+ /* WPS OUI */ -+ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); -+ wpsielen += 4; -+ -+ /* WPS version */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ -+ -+#ifdef CONFIG_INTEL_WIDI -+ /* Commented by Kurt */ -+ /* Appended WiDi info. only if we did issued_probereq_widi(), and then we saved ven. ext. in pmlmepriv->sa_ext. */ -+ if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE -+ || pmlmepriv->num_p2p_sdt != 0) { -+ /* Sec dev type */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SEC_DEV_TYPE_LIST); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0008); -+ wpsielen += 2; -+ -+ /* Value: */ -+ /* Category ID */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_CID_DISPLAYS); -+ wpsielen += 2; -+ -+ /* OUI */ -+ *(u32 *)(wpsie + wpsielen) = cpu_to_be32(INTEL_DEV_TYPE_OUI); -+ wpsielen += 4; -+ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_SCID_WIDI_CONSUMER_SINK); -+ wpsielen += 2; -+ -+ if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE) { -+ /* Vendor Extension */ -+ _rtw_memcpy(wpsie + wpsielen, pmlmepriv->sa_ext, L2SDTA_SERVICE_VE_LEN); -+ wpsielen += L2SDTA_SERVICE_VE_LEN; -+ } -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ /* WiFi Simple Config State */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SIMPLE_CONF_STATE); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_WSC_STATE_NOT_CONFIG; /* Not Configured. */ -+ -+ /* Response Type */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_RESP_TYPE); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_RESPONSE_TYPE_8021X; -+ -+ /* UUID-E */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_UUID_E); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0010); -+ wpsielen += 2; -+ -+ /* Value: */ -+ if (pwdinfo->external_uuid == 0) { -+ _rtw_memset(wpsie + wpsielen, 0x0, 16); -+ _rtw_memcpy(wpsie + wpsielen, mac, ETH_ALEN); -+ } else -+ _rtw_memcpy(wpsie + wpsielen, pwdinfo->uuid, 0x10); -+ wpsielen += 0x10; -+ -+ /* Manufacturer */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_MANUFACTURER); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0007); -+ wpsielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(wpsie + wpsielen, "Realtek", 7); -+ wpsielen += 7; -+ -+ /* Model Name */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_MODEL_NAME); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0006); -+ wpsielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(wpsie + wpsielen, "8192CU", 6); -+ wpsielen += 6; -+ -+ /* Model Number */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_MODEL_NUMBER); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = 0x31; /* character 1 */ -+ -+ /* Serial Number */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SERIAL_NUMBER); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(ETH_ALEN); -+ wpsielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(wpsie + wpsielen, "123456" , ETH_ALEN); -+ wpsielen += ETH_ALEN; -+ -+ /* Primary Device Type */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_PRIMARY_DEV_TYPE); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0008); -+ wpsielen += 2; -+ -+ /* Value: */ -+ /* Category ID */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); -+ wpsielen += 2; -+ -+ /* OUI */ -+ *(u32 *)(wpsie + wpsielen) = cpu_to_be32(WPSOUI); -+ wpsielen += 4; -+ -+ /* Sub Category ID */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); -+ wpsielen += 2; -+ -+ /* Device Name */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->device_name_len); -+ wpsielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(wpsie + wpsielen, pwdinfo->device_name, pwdinfo->device_name_len); -+ wpsielen += pwdinfo->device_name_len; -+ -+ /* Config Method */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_CONF_METHOD); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); -+ wpsielen += 2; -+ -+ /* Value: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->supported_wps_cm); -+ wpsielen += 2; -+ -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pktlen); -+ -+ -+ p2pielen = build_probe_resp_p2p_ie(pwdinfo, pframe); -+ pframe += p2pielen; -+ pktlen += p2pielen; -+ } -+ -+#ifdef CONFIG_WFD -+ wfdielen = rtw_append_probe_resp_wfd_ie(padapter, pframe); -+ pframe += wfdielen; -+ pktlen += wfdielen; -+#endif -+ -+ *pLength = pktlen; -+ -+#if 0 -+ /* printf dbg msg */ -+ dbgbufLen = pktlen; -+ RTW_INFO("======> DBG MSG FOR CONSTRAUCT P2P Probe Rsp\n"); -+ -+ for (index = 0; index < dbgbufLen; index++) -+ printk("%x ", *(dbgbuf + index)); -+ -+ printk("\n"); -+ RTW_INFO("<====== DBG MSG FOR CONSTRAUCT P2P Probe Rsp\n"); -+#endif -+} -+static void rtw_hal_construct_P2PNegoRsp(_adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_GO_NEGO_RESP; -+ u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; -+ u8 p2pielen = 0, i; -+ uint wpsielen = 0; -+ u16 wps_devicepassword_id = 0x0000; -+ uint wps_devicepassword_id_len = 0; -+ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh; -+ u16 len_channellist_attr = 0; -+ u32 pktlen; -+ u8 dialogToken = 0; -+ -+ /* struct xmit_frame *pmgntframe; */ -+ /* struct pkt_attrib *pattrib; */ -+ /* unsigned char *pframe; */ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ /* WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); */ -+ -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+ /* for debug */ -+ u8 *dbgbuf = pframe; -+ u8 dbgbufLen = 0, index = 0; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ /* RA, filled by FW */ -+ _rtw_memset(pwlanhdr->addr1, 0, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pframe += pktlen; -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pktlen)); -+ -+ /* dialog token, filled by FW */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pktlen)); -+ -+ _rtw_memset(wpsie, 0x00, 255); -+ wpsielen = 0; -+ -+ /* WPS Section */ -+ wpsielen = 0; -+ /* WPS OUI */ -+ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); -+ wpsielen += 4; -+ -+ /* WPS version */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ -+ -+ /* Device Password ID */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_DEVICE_PWID); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); -+ wpsielen += 2; -+ -+ /* Value: */ -+ if (wps_devicepassword_id == WPS_DPID_USER_SPEC) -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_REGISTRAR_SPEC); -+ else if (wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_USER_SPEC); -+ else -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_DPID_PBC); -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pktlen); -+ -+ -+ /* P2P IE Section. */ -+ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Commented by Albert 20100908 */ -+ /* According to the P2P Specification, the group negoitation response frame should contain 9 P2P attributes */ -+ /* 1. Status */ -+ /* 2. P2P Capability */ -+ /* 3. Group Owner Intent */ -+ /* 4. Configuration Timeout */ -+ /* 5. Operating Channel */ -+ /* 6. Intended P2P Interface Address */ -+ /* 7. Channel List */ -+ /* 8. Device Info */ -+ /* 9. Group ID ( Only GO ) */ -+ -+ -+ /* ToDo: */ -+ -+ /* P2P Status */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_STATUS; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); -+ p2pielen += 2; -+ -+ /* Value, filled by FW */ -+ p2pie[p2pielen++] = 1; -+ -+ /* P2P Capability */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CAPABILITY; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Device Capability Bitmap, 1 byte */ -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { -+ /* Commented by Albert 2011/03/08 */ -+ /* According to the P2P specification */ -+ /* if the sending device will be client, the P2P Capability should be reserved of group negotation response frame */ -+ p2pie[p2pielen++] = 0; -+ } else { -+ /* Be group owner or meet the error case */ -+ p2pie[p2pielen++] = DMP_P2P_DEVCAP_SUPPORT; -+ } -+ -+ /* Group Capability Bitmap, 1 byte */ -+ if (pwdinfo->persistent_supported) -+ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN | P2P_GRPCAP_PERSISTENT_GROUP; -+ else -+ p2pie[p2pielen++] = P2P_GRPCAP_CROSS_CONN; -+ -+ /* Group Owner Intent */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_GO_INTENT; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); -+ p2pielen += 2; -+ -+ /* Value: */ -+ if (pwdinfo->peer_intent & 0x01) { -+ /* Peer's tie breaker bit is 1, our tie breaker bit should be 0 */ -+ p2pie[p2pielen++] = (pwdinfo->intent << 1); -+ } else { -+ /* Peer's tie breaker bit is 0, our tie breaker bit should be 1 */ -+ p2pie[p2pielen++] = ((pwdinfo->intent << 1) | BIT(0)); -+ } -+ -+ -+ /* Configuration Timeout */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CONF_TIMEOUT; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P GO */ -+ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P Client */ -+ -+ /* Operating Channel */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Operating Class */ -+ if (pwdinfo->operating_channel <= 14) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x51; -+ } else if ((pwdinfo->operating_channel >= 36) && (pwdinfo->operating_channel <= 48)) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x73; -+ } else { -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x7c; -+ } -+ -+ /* Channel Number */ -+ p2pie[p2pielen++] = pwdinfo->operating_channel; /* operating channel number */ -+ -+ /* Intended P2P Interface Address */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_INTENDED_IF_ADDR; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* Channel List */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; -+ -+ /* Country String(3) */ -+ /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ -+ /* + number of channels in all classes */ -+ len_channellist_attr = 3 -+ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes -+ + get_reg_classes_full_count(pmlmeext->channel_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, _FW_LINKED)) -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(5 + 1); -+ else -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); -+ -+#else -+ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); -+ -+#endif -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Channel Entry List */ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ -+ /* Operating Class */ -+ if (union_ch > 14) { -+ if (union_ch >= 149) -+ p2pie[p2pielen++] = 0x7c; -+ else -+ p2pie[p2pielen++] = 0x73; -+ } else -+ p2pie[p2pielen++] = 0x51; -+ -+ -+ /* Number of Channels */ -+ /* Just support 1 channel and this channel is AP's channel */ -+ p2pie[p2pielen++] = 1; -+ -+ /* Channel List */ -+ p2pie[p2pielen++] = union_ch; -+ } else { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+#else /* CONFIG_CONCURRENT_MODE */ -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ -+ /* Device Info */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ -+ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(21 + pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* P2P Device Address */ -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* Config Method */ -+ /* This field should be big endian. Noted by P2P specification. */ -+ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->supported_wps_cm); -+ -+ p2pielen += 2; -+ -+ /* Primary Device Type */ -+ /* Category ID */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_CID_MULIT_MEDIA); -+ p2pielen += 2; -+ -+ /* OUI */ -+ *(u32 *)(p2pie + p2pielen) = cpu_to_be32(WPSOUI); -+ p2pielen += 4; -+ -+ /* Sub Category ID */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_PDT_SCID_MEDIA_SERVER); -+ p2pielen += 2; -+ -+ /* Number of Secondary Device Types */ -+ p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ -+ -+ /* Device Name */ -+ /* Type: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(WPS_ATTR_DEVICE_NAME); -+ p2pielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_be16(pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->device_name , pwdinfo->device_name_len); -+ p2pielen += pwdinfo->device_name_len; -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ /* Group ID Attribute */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_GROUP_ID; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN + pwdinfo->nego_ssidlen); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* p2P Device Address */ -+ _rtw_memcpy(p2pie + p2pielen , pwdinfo->device_addr, ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ /* SSID */ -+ _rtw_memcpy(p2pie + p2pielen, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen); -+ p2pielen += pwdinfo->nego_ssidlen; -+ -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pktlen); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_nego_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pktlen += wfdielen; -+#endif -+ -+ *pLength = pktlen; -+#if 0 -+ /* printf dbg msg */ -+ dbgbufLen = pktlen; -+ RTW_INFO("======> DBG MSG FOR CONSTRAUCT Nego Rsp\n"); -+ -+ for (index = 0; index < dbgbufLen; index++) -+ printk("%x ", *(dbgbuf + index)); -+ -+ printk("\n"); -+ RTW_INFO("<====== DBG MSG FOR CONSTRAUCT Nego Rsp\n"); -+#endif -+} -+ -+static void rtw_hal_construct_P2PInviteRsp(_adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_INVIT_RESP; -+ u8 p2pie[255] = { 0x00 }; -+ u8 p2pielen = 0, i; -+ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; -+ u16 len_channellist_attr = 0; -+ u32 pktlen; -+ u8 dialogToken = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+ /* struct xmit_frame *pmgntframe; */ -+ /* struct pkt_attrib *pattrib; */ -+ /* unsigned char *pframe; */ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ /* for debug */ -+ u8 *dbgbuf = pframe; -+ u8 dbgbufLen = 0, index = 0; -+ -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ /* RA fill by FW */ -+ _rtw_memset(pwlanhdr->addr1, 0, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ /* BSSID fill by FW */ -+ _rtw_memset(pwlanhdr->addr3, 0, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pktlen)); -+ -+ /* dialog token, filled by FW */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pktlen)); -+ -+ /* P2P IE Section. */ -+ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2pie[p2pielen++] = 0x50; -+ p2pie[p2pielen++] = 0x6F; -+ p2pie[p2pielen++] = 0x9A; -+ p2pie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Commented by Albert 20101005 */ -+ /* According to the P2P Specification, the P2P Invitation response frame should contain 5 P2P attributes */ -+ /* 1. Status */ -+ /* 2. Configuration Timeout */ -+ /* 3. Operating Channel ( Only GO ) */ -+ /* 4. P2P Group BSSID ( Only GO ) */ -+ /* 5. Channel List */ -+ -+ /* P2P Status */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_STATUS; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0001); -+ p2pielen += 2; -+ -+ /* Value: filled by FW, defult value is FAIL INFO UNAVAILABLE */ -+ p2pie[p2pielen++] = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ -+ /* Configuration Timeout */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CONF_TIMEOUT; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P GO */ -+ p2pie[p2pielen++] = 200; /* 2 seconds needed to be the P2P Client */ -+ -+ /* due to defult value is FAIL INFO UNAVAILABLE, so the following IE is not needed */ -+#if 0 -+ if (status_code == P2P_STATUS_SUCCESS) { -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ /* The P2P Invitation request frame asks this Wi-Fi device to be the P2P GO */ -+ /* In this case, the P2P Invitation response frame should carry the two more P2P attributes. */ -+ /* First one is operating channel attribute. */ -+ /* Second one is P2P Group BSSID attribute. */ -+ -+ /* Operating Channel */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_OPERATING_CH; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(0x0005); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Operating Class */ -+ p2pie[p2pielen++] = 0x51; /* Copy from SD7 */ -+ -+ /* Channel Number */ -+ p2pie[p2pielen++] = pwdinfo->operating_channel; /* operating channel number */ -+ -+ -+ /* P2P Group BSSID */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_GROUP_BSSID; -+ -+ /* Length: */ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(ETH_ALEN); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* P2P Device Address for GO */ -+ _rtw_memcpy(p2pie + p2pielen, adapter_mac_addr(padapter), ETH_ALEN); -+ p2pielen += ETH_ALEN; -+ -+ } -+ -+ /* Channel List */ -+ /* Type: */ -+ p2pie[p2pielen++] = P2P_ATTR_CH_LIST; -+ -+ /* Length: */ -+ /* Country String(3) */ -+ /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ -+ /* + number of channels in all classes */ -+ len_channellist_attr = 3 -+ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes -+ + get_reg_classes_full_count(pmlmeext->channel_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(5 + 1); -+ else -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); -+ -+#else -+ -+ *(u16 *)(p2pie + p2pielen) = cpu_to_le16(len_channellist_attr); -+ -+#endif -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Country String */ -+ p2pie[p2pielen++] = 'X'; -+ p2pie[p2pielen++] = 'X'; -+ -+ /* The third byte should be set to 0x04. */ -+ /* Described in the "Operating Channel Attribute" section. */ -+ p2pie[p2pielen++] = 0x04; -+ -+ /* Channel Entry List */ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ -+ /* Operating Class */ -+ if (union_ch > 14) { -+ if (union_ch >= 149) -+ p2pie[p2pielen++] = 0x7c; -+ else -+ p2pie[p2pielen++] = 0x73; -+ -+ } else -+ p2pie[p2pielen++] = 0x51; -+ -+ -+ /* Number of Channels */ -+ /* Just support 1 channel and this channel is AP's channel */ -+ p2pie[p2pielen++] = 1; -+ -+ /* Channel List */ -+ p2pie[p2pielen++] = union_ch; -+ } else { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+#else /* CONFIG_CONCURRENT_MODE */ -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ /* Operating Class */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ /* Number of Channels */ -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ /* Channel List */ -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ } -+#endif -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pktlen); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_invitation_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pktlen += wfdielen; -+#endif -+ -+ *pLength = pktlen; -+ -+#if 0 -+ /* printf dbg msg */ -+ dbgbufLen = pktlen; -+ RTW_INFO("======> DBG MSG FOR CONSTRAUCT Invite Rsp\n"); -+ -+ for (index = 0; index < dbgbufLen; index++) -+ printk("%x ", *(dbgbuf + index)); -+ -+ printk("\n"); -+ RTW_INFO("<====== DBG MSG FOR CONSTRAUCT Invite Rsp\n"); -+#endif -+} -+ -+ -+static void rtw_hal_construct_P2PProvisionDisRsp(_adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u8 dialogToken = 0; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_PROVISION_DISC_RESP; -+ u8 wpsie[100] = { 0x00 }; -+ u8 wpsielen = 0; -+ u32 pktlen; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+ /* struct xmit_frame *pmgntframe; */ -+ /* struct pkt_attrib *pattrib; */ -+ /* unsigned char *pframe; */ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ /* for debug */ -+ u8 *dbgbuf = pframe; -+ u8 dbgbufLen = 0, index = 0; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ /* RA filled by FW */ -+ _rtw_memset(pwlanhdr->addr1, 0, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pktlen)); -+ /* dialog token, filled by FW */ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pktlen)); -+ -+ wpsielen = 0; -+ /* WPS OUI */ -+ /* *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); */ -+ RTW_PUT_BE32(wpsie, WPSOUI); -+ wpsielen += 4; -+ -+#if 0 -+ /* WPS version */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ -+#endif -+ -+ /* Config Method */ -+ /* Type: */ -+ /* *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); */ -+ RTW_PUT_BE16(wpsie + wpsielen, WPS_ATTR_CONF_METHOD); -+ wpsielen += 2; -+ -+ /* Length: */ -+ /* *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); */ -+ RTW_PUT_BE16(wpsie + wpsielen, 0x0002); -+ wpsielen += 2; -+ -+ /* Value: filled by FW, default value is PBC */ -+ /* *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( config_method ); */ -+ RTW_PUT_BE16(wpsie + wpsielen, WPS_CM_PUSH_BUTTON); -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pktlen); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_provdisc_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pktlen += wfdielen; -+#endif -+ -+ *pLength = pktlen; -+ -+ /* printf dbg msg */ -+#if 0 -+ dbgbufLen = pktlen; -+ RTW_INFO("======> DBG MSG FOR CONSTRAUCT ProvisionDis Rsp\n"); -+ -+ for (index = 0; index < dbgbufLen; index++) -+ printk("%x ", *(dbgbuf + index)); -+ -+ printk("\n"); -+ RTW_INFO("<====== DBG MSG FOR CONSTRAUCT ProvisionDis Rsp\n"); -+#endif -+} -+ -+u8 rtw_hal_set_FwP2PRsvdPage_cmd(_adapter *adapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+ u8 u1H2CP2PRsvdPageParm[H2C_P2PRSVDPAGE_LOC_LEN] = {0}; -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u8 ret = _FAIL; -+ -+ RTW_INFO("P2PRsvdPageLoc: P2PBeacon=%d P2PProbeRsp=%d NegoRsp=%d InviteRsp=%d PDRsp=%d\n", -+ rsvdpageloc->LocP2PBeacon, rsvdpageloc->LocP2PProbeRsp, -+ rsvdpageloc->LocNegoRsp, rsvdpageloc->LocInviteRsp, -+ rsvdpageloc->LocPDRsp); -+ -+ SET_H2CCMD_RSVDPAGE_LOC_P2P_BCN(u1H2CP2PRsvdPageParm, rsvdpageloc->LocProbeRsp); -+ SET_H2CCMD_RSVDPAGE_LOC_P2P_PROBE_RSP(u1H2CP2PRsvdPageParm, rsvdpageloc->LocPsPoll); -+ SET_H2CCMD_RSVDPAGE_LOC_P2P_NEGO_RSP(u1H2CP2PRsvdPageParm, rsvdpageloc->LocNullData); -+ SET_H2CCMD_RSVDPAGE_LOC_P2P_INVITE_RSP(u1H2CP2PRsvdPageParm, rsvdpageloc->LocQosNull); -+ SET_H2CCMD_RSVDPAGE_LOC_P2P_PD_RSP(u1H2CP2PRsvdPageParm, rsvdpageloc->LocBTQosNull); -+ -+ /* FillH2CCmd8723B(padapter, H2C_8723B_P2P_OFFLOAD_RSVD_PAGE, H2C_P2PRSVDPAGE_LOC_LEN, u1H2CP2PRsvdPageParm); */ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_P2P_OFFLOAD_RSVD_PAGE, -+ H2C_P2PRSVDPAGE_LOC_LEN, -+ u1H2CP2PRsvdPageParm); -+ -+ return ret; -+} -+ -+u8 rtw_hal_set_p2p_wowlan_offload_cmd(_adapter *adapter) -+{ -+ -+ u8 offload_cmd[H2C_P2P_OFFLOAD_LEN] = {0}; -+ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); -+ struct P2P_WoWlan_Offload_t *p2p_wowlan_offload = (struct P2P_WoWlan_Offload_t *)offload_cmd; -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u8 ret = _FAIL; -+ -+ _rtw_memset(p2p_wowlan_offload, 0 , sizeof(struct P2P_WoWlan_Offload_t)); -+ RTW_INFO("%s\n", __func__); -+ switch (pwdinfo->role) { -+ case P2P_ROLE_DEVICE: -+ RTW_INFO("P2P_ROLE_DEVICE\n"); -+ p2p_wowlan_offload->role = 0; -+ break; -+ case P2P_ROLE_CLIENT: -+ RTW_INFO("P2P_ROLE_CLIENT\n"); -+ p2p_wowlan_offload->role = 1; -+ break; -+ case P2P_ROLE_GO: -+ RTW_INFO("P2P_ROLE_GO\n"); -+ p2p_wowlan_offload->role = 2; -+ break; -+ default: -+ RTW_INFO("P2P_ROLE_DISABLE\n"); -+ break; -+ } -+ p2p_wowlan_offload->Wps_Config[0] = pwdinfo->supported_wps_cm >> 8; -+ p2p_wowlan_offload->Wps_Config[1] = pwdinfo->supported_wps_cm; -+ offload_cmd = (u8 *)p2p_wowlan_offload; -+ RTW_INFO("p2p_wowlan_offload: %x:%x:%x\n", offload_cmd[0], offload_cmd[1], offload_cmd[2]); -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_P2P_OFFLOAD, -+ H2C_P2P_OFFLOAD_LEN, -+ offload_cmd); -+ return ret; -+ -+ /* FillH2CCmd8723B(adapter, H2C_8723B_P2P_OFFLOAD, sizeof(struct P2P_WoWlan_Offload_t), (u8 *)p2p_wowlan_offload); */ -+} -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+static void rtw_hal_construct_beacon(_adapter *padapter, -+ u8 *pframe, u32 *pLength) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 rate_len, pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ /* pmlmeext->mgnt_seq++; */ -+ SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* timestamp will be inserted by hardware */ -+ pframe += 8; -+ pktlen += 8; -+ -+ /* beacon interval: 2 bytes */ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ /* capability info: 2 bytes */ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { -+ /* RTW_INFO("ie len=%d\n", cur_network->IELength); */ -+ pktlen += cur_network->IELength - sizeof(NDIS_802_11_FIXED_IEs); -+ _rtw_memcpy(pframe, cur_network->IEs + sizeof(NDIS_802_11_FIXED_IEs), pktlen); -+ -+ goto _ConstructBeacon; -+ } -+ -+ /* below for ad-hoc mode */ -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen); -+ -+ /* supported rates... */ -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pktlen); -+ -+ /* DS parameter set */ -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen); -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { -+ u32 ATIMWindow; -+ /* IBSS Parameter Set... */ -+ /* ATIMWindow = cur->Configuration.ATIMWindow; */ -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen); -+ } -+ -+ -+ /* todo: ERP IE */ -+ -+ -+ /* EXTERNDED SUPPORTED RATE */ -+ if (rate_len > 8) -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); -+ -+ -+ /* todo:HT for adhoc */ -+ -+_ConstructBeacon: -+ -+ if ((pktlen + TXDESC_SIZE) > 512) { -+ RTW_INFO("beacon frame too large\n"); -+ return; -+ } -+ -+ *pLength = pktlen; -+ -+ /* RTW_INFO("%s bcn_sz=%d\n", __FUNCTION__, pktlen); */ -+ -+} -+ -+static void rtw_hal_construct_PSPoll(_adapter *padapter, -+ u8 *pframe, u32 *pLength) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ /* Frame control. */ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ SetPwrMgt(fctrl); -+ SetFrameSubType(pframe, WIFI_PSPOLL); -+ -+ /* AID. */ -+ SetDuration(pframe, (pmlmeinfo->aid | 0xc000)); -+ -+ /* BSSID. */ -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ /* TA. */ -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ *pLength = 16; -+} -+ -+void rtw_hal_construct_NullFunctionData( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength, -+ u8 *StaAddr, -+ u8 bQoS, -+ u8 AC, -+ u8 bEosp, -+ u8 bForcePowerSave) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ if (bForcePowerSave) -+ SetPwrMgt(fctrl); -+ -+ switch (cur_network->network.InfrastructureMode) { -+ case Ndis802_11Infrastructure: -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, StaAddr, ETH_ALEN); -+ break; -+ case Ndis802_11APMode: -+ SetFrDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ break; -+ case Ndis802_11IBSS: -+ default: -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ break; -+ } -+ -+ SetSeqNum(pwlanhdr, 0); -+ -+ if (bQoS == _TRUE) { -+ struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; -+ -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe; -+ SetPriority(&pwlanqoshdr->qc, AC); -+ SetEOSP(&pwlanqoshdr->qc, bEosp); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ } else { -+ SetFrameSubType(pframe, WIFI_DATA_NULL); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ } -+ -+ *pLength = pktlen; -+} -+ -+void rtw_hal_construct_ProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength, -+ u8 *StaAddr, BOOLEAN bHideSSID) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u8 *mac, *bssid; -+ u32 pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ -+ /*RTW_INFO("%s\n", __FUNCTION__);*/ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = adapter_mac_addr(padapter); -+ bssid = cur_network->MacAddress; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(fctrl, WIFI_PROBERSP); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pframe += pktlen; -+ -+ if (cur_network->IELength > MAX_IE_SZ) -+ return; -+ -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ pframe += cur_network->IELength; -+ pktlen += cur_network->IELength; -+ -+ *pLength = pktlen; -+} -+ -+#ifdef CONFIG_WOWLAN -+/* -+ * Description: -+ * Construct the ARP response packet to support ARP offload. -+ * */ -+static void rtw_hal_construct_ARPRsp( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength, -+ u8 *pIPAddress -+) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ static u8 ARPLLCHeader[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x08, 0x06}; -+ u8 *pARPRspPkt = pframe; -+ /* for TKIP Cal MIC */ -+ u8 *payload = pframe; -+ u8 EncryptionHeadOverhead = 0; -+ /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ /* ------------------------------------------------------------------------- */ -+ /* MAC Header. */ -+ /* ------------------------------------------------------------------------- */ -+ SetFrameType(fctrl, WIFI_DATA); -+ /* SetFrameSubType(fctrl, 0); */ -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetDuration(pwlanhdr, 0); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ *pLength = sMacHdrLng; -+#else -+ *pLength = 24; -+#endif -+ switch (psecuritypriv->dot11PrivacyAlgrthm) { -+ case _WEP40_: -+ case _WEP104_: -+ EncryptionHeadOverhead = 4; -+ break; -+ case _TKIP_: -+ EncryptionHeadOverhead = 8; -+ break; -+ case _AES_: -+ EncryptionHeadOverhead = 8; -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ EncryptionHeadOverhead = 18; -+ break; -+#endif -+ default: -+ EncryptionHeadOverhead = 0; -+ } -+ -+ if (EncryptionHeadOverhead > 0) { -+ _rtw_memset(&(pframe[*pLength]), 0, EncryptionHeadOverhead); -+ *pLength += EncryptionHeadOverhead; -+ /* SET_80211_HDR_WEP(pARPRspPkt, 1); */ /* Suggested by CCW. */ -+ SetPrivacy(fctrl); -+ } -+ -+ /* ------------------------------------------------------------------------- */ -+ /* Frame Body. */ -+ /* ------------------------------------------------------------------------- */ -+ pARPRspPkt = (u8 *)(pframe + *pLength); -+ payload = pARPRspPkt; /* Get Payload pointer */ -+ /* LLC header */ -+ _rtw_memcpy(pARPRspPkt, ARPLLCHeader, 8); -+ *pLength += 8; -+ -+ /* ARP element */ -+ pARPRspPkt += 8; -+ SET_ARP_PKT_HW(pARPRspPkt, 0x0100); -+ SET_ARP_PKT_PROTOCOL(pARPRspPkt, 0x0008); /* IP protocol */ -+ SET_ARP_PKT_HW_ADDR_LEN(pARPRspPkt, 6); -+ SET_ARP_PKT_PROTOCOL_ADDR_LEN(pARPRspPkt, 4); -+ SET_ARP_PKT_OPERATION(pARPRspPkt, 0x0200); /* ARP response */ -+ SET_ARP_PKT_SENDER_MAC_ADDR(pARPRspPkt, adapter_mac_addr(padapter)); -+ SET_ARP_PKT_SENDER_IP_ADDR(pARPRspPkt, pIPAddress); -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ if (!is_zero_mac_addr(pmlmepriv->gw_mac_addr)) { -+ SET_ARP_PKT_TARGET_MAC_ADDR(pARPRspPkt, pmlmepriv->gw_mac_addr); -+ SET_ARP_PKT_TARGET_IP_ADDR(pARPRspPkt, pmlmepriv->gw_ip); -+ } else -+#endif -+ { -+ SET_ARP_PKT_TARGET_MAC_ADDR(pARPRspPkt, -+ get_my_bssid(&(pmlmeinfo->network))); -+ SET_ARP_PKT_TARGET_IP_ADDR(pARPRspPkt, -+ pIPAddress); -+ RTW_INFO("%s Target Mac Addr:" MAC_FMT "\n", __FUNCTION__, -+ MAC_ARG(get_my_bssid(&(pmlmeinfo->network)))); -+ RTW_INFO("%s Target IP Addr" IP_FMT "\n", __FUNCTION__, -+ IP_ARG(pIPAddress)); -+ } -+ -+ *pLength += 28; -+ -+ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) -+ *pLength += 8; -+} -+ -+#ifdef CONFIG_PNO_SUPPORT -+static void rtw_hal_construct_ProbeReq(_adapter *padapter, u8 *pframe, -+ u32 *pLength, pno_ssid_t *ssid) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ unsigned char *mac; -+ unsigned char bssrate[NumRates]; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int bssrate_len = 0; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ mac = adapter_mac_addr(padapter); -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, bc_addr, ETH_ALEN); -+ -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(pframe, WIFI_PROBEREQ); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pframe += pktlen; -+ -+ if (ssid == NULL) -+ pframe = rtw_set_ie(pframe, _SSID_IE_, 0, NULL, &pktlen); -+ else { -+ /* RTW_INFO("%s len:%d\n", ssid->SSID, ssid->SSID_len); */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, ssid->SSID_len, ssid->SSID, &pktlen); -+ } -+ -+ get_rate_set(padapter, bssrate, &bssrate_len); -+ -+ if (bssrate_len > 8) { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &pktlen); -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &pktlen); -+ } else -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &pktlen); -+ -+ *pLength = pktlen; -+} -+ -+static void rtw_hal_construct_PNO_info(_adapter *padapter, -+ u8 *pframe, u32 *pLength) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ int i; -+ -+ u8 *pPnoInfoPkt = pframe; -+ pPnoInfoPkt = (u8 *)(pframe + *pLength); -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_num, 1); -+ -+ pPnoInfoPkt += 1; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->hidden_ssid_num, 1); -+ -+ pPnoInfoPkt += 3; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->fast_scan_period, 1); -+ -+ pPnoInfoPkt += 4; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->fast_scan_iterations, 4); -+ -+ pPnoInfoPkt += 4; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->slow_scan_period, 4); -+ -+ pPnoInfoPkt += 4; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_length, MAX_PNO_LIST_COUNT); -+ -+ pPnoInfoPkt += MAX_PNO_LIST_COUNT; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_cipher_info, MAX_PNO_LIST_COUNT); -+ -+ pPnoInfoPkt += MAX_PNO_LIST_COUNT; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->ssid_channel_info, MAX_PNO_LIST_COUNT); -+ -+ pPnoInfoPkt += MAX_PNO_LIST_COUNT; -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pnlo_info->loc_probe_req, MAX_HIDDEN_AP); -+ -+ pPnoInfoPkt += MAX_HIDDEN_AP; -+ -+ /* -+ SSID is located at 128th Byte in NLO info Page -+ */ -+ -+ *pLength += 128; -+ pPnoInfoPkt = pframe + 128; -+ -+ for (i = 0; i < pwrctl->pnlo_info->ssid_num ; i++) { -+ _rtw_memcpy(pPnoInfoPkt, &pwrctl->pno_ssid_list->node[i].SSID, -+ pwrctl->pnlo_info->ssid_length[i]); -+ *pLength += WLAN_SSID_MAXLEN; -+ pPnoInfoPkt += WLAN_SSID_MAXLEN; -+ } -+} -+ -+static void rtw_hal_construct_ssid_list(_adapter *padapter, -+ u8 *pframe, u32 *pLength) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ u8 *pSSIDListPkt = pframe; -+ int i; -+ -+ pSSIDListPkt = (u8 *)(pframe + *pLength); -+ -+ for (i = 0; i < pwrctl->pnlo_info->ssid_num ; i++) { -+ _rtw_memcpy(pSSIDListPkt, &pwrctl->pno_ssid_list->node[i].SSID, -+ pwrctl->pnlo_info->ssid_length[i]); -+ -+ *pLength += WLAN_SSID_MAXLEN; -+ pSSIDListPkt += WLAN_SSID_MAXLEN; -+ } -+} -+ -+static void rtw_hal_construct_scan_info(_adapter *padapter, -+ u8 *pframe, u32 *pLength) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ u8 *pScanInfoPkt = pframe; -+ int i; -+ -+ pScanInfoPkt = (u8 *)(pframe + *pLength); -+ -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->channel_num, 1); -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_ch, 1); -+ -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_bw, 1); -+ -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_40_offset, 1); -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->orig_80_offset, 1); -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->periodScan, 1); -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->period_scan_time, 1); -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->enableRFE, 1); -+ -+ *pLength += 1; -+ pScanInfoPkt += 1; -+ _rtw_memcpy(pScanInfoPkt, &pwrctl->pscan_info->rfe_type, 8); -+ -+ *pLength += 8; -+ pScanInfoPkt += 8; -+ -+ for (i = 0 ; i < MAX_SCAN_LIST_COUNT ; i++) { -+ _rtw_memcpy(pScanInfoPkt, -+ &pwrctl->pscan_info->ssid_channel_info[i], 4); -+ *pLength += 4; -+ pScanInfoPkt += 4; -+ } -+} -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+#ifdef CONFIG_GTK_OL -+static void rtw_hal_construct_GTKRsp( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength -+) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ static u8 LLCHeader[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x88, 0x8E}; -+ static u8 GTKbody_a[11] = {0x01, 0x03, 0x00, 0x5F, 0x02, 0x03, 0x12, 0x00, 0x10, 0x42, 0x0B}; -+ u8 mic[RTW_TKIP_MIC_LEN] = {0}; -+ u8 *pGTKRspPkt = pframe; -+ u8 EncryptionHeadOverhead = 0; -+ /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ /* ------------------------------------------------------------------------- */ -+ /* MAC Header. */ -+ /* ------------------------------------------------------------------------- */ -+ SetFrameType(fctrl, WIFI_DATA); -+ /* SetFrameSubType(fctrl, 0); */ -+ SetToDs(fctrl); -+ -+ _rtw_memcpy(pwlanhdr->addr1, -+ get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ _rtw_memcpy(pwlanhdr->addr2, -+ adapter_mac_addr(padapter), ETH_ALEN); -+ -+ _rtw_memcpy(pwlanhdr->addr3, -+ get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetDuration(pwlanhdr, 0); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ *pLength = sMacHdrLng; -+#else -+ *pLength = 24; -+#endif /* CONFIG_WAPI_SUPPORT */ -+ -+ /* ------------------------------------------------------------------------- */ -+ /* Security Header: leave space for it if necessary. */ -+ /* ------------------------------------------------------------------------- */ -+ switch (psecuritypriv->dot11PrivacyAlgrthm) { -+ case _WEP40_: -+ case _WEP104_: -+ EncryptionHeadOverhead = 4; -+ break; -+ case _TKIP_: -+ EncryptionHeadOverhead = 8; -+ break; -+ case _AES_: -+ EncryptionHeadOverhead = 8; -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ EncryptionHeadOverhead = 18; -+ break; -+#endif /* CONFIG_WAPI_SUPPORT */ -+ default: -+ EncryptionHeadOverhead = 0; -+ } -+ -+ if (EncryptionHeadOverhead > 0) { -+ _rtw_memset(&(pframe[*pLength]), 0, EncryptionHeadOverhead); -+ *pLength += EncryptionHeadOverhead; -+ /* SET_80211_HDR_WEP(pGTKRspPkt, 1); */ /* Suggested by CCW. */ -+ /* GTK's privacy bit is done by FW */ -+ /* SetPrivacy(fctrl); */ -+ } -+ /* ------------------------------------------------------------------------- */ -+ /* Frame Body. */ -+ /* ------------------------------------------------------------------------- */ -+ pGTKRspPkt = (u8 *)(pframe + *pLength); -+ /* LLC header */ -+ _rtw_memcpy(pGTKRspPkt, LLCHeader, 8); -+ *pLength += 8; -+ -+ /* GTK element */ -+ pGTKRspPkt += 8; -+ -+ /* GTK frame body after LLC, part 1 */ -+ /* TKIP key_length = 32, AES key_length = 16 */ -+ if (psecuritypriv->dot118021XGrpPrivacy == _TKIP_) -+ GTKbody_a[8] = 0x20; -+ -+ _rtw_memcpy(pGTKRspPkt, GTKbody_a, 11); -+ *pLength += 11; -+ pGTKRspPkt += 11; -+ /* GTK frame body after LLC, part 2 */ -+ _rtw_memset(&(pframe[*pLength]), 0, 88); -+ *pLength += 88; -+ pGTKRspPkt += 88; -+ -+ if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) -+ *pLength += 8; -+ -+} -+#endif /* CONFIG_GTK_OL */ -+ -+void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, -+ u8 tx_desc, u32 page_size, u8 *page_num, u32 *total_pkt_len, -+ RSVDPAGE_LOC *rsvd_page_loc) -+{ -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ u32 ARPLength = 0, GTKLength = 0, PNOLength = 0, ScanInfoLength = 0; -+ u32 SSIDLegnth = 0, ProbeReqLength = 0; -+ u8 CurtPktPageNum = 0; -+ u8 currentip[4]; -+ u8 cur_dot11txpn[8]; -+ -+#ifdef CONFIG_GTK_OL -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *psta; -+ u8 kek[RTW_KEK_LEN]; -+ u8 kck[RTW_KCK_LEN]; -+ u32 gtk_index = 0; -+#endif /* CONFIG_GTK_OL */ -+#ifdef CONFIG_PNO_SUPPORT -+ int pno_index; -+ u8 ssid_num; -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+ pmlmeext = &adapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ if (pwrctl->wowlan_pno_enable == _FALSE) { -+ /* ARP RSP * 1 page */ -+ rtw_get_current_ip_address(adapter, currentip); -+ -+ rsvd_page_loc->LocArpRsp = *page_num; -+ -+ RTW_INFO("LocArpRsp: %d\n", rsvd_page_loc->LocArpRsp); -+ -+ rtw_hal_construct_ARPRsp(adapter, &pframe[index], -+ &ARPLength, currentip); -+ -+ rtw_hal_fill_fake_txdesc(adapter, -+ &pframe[index - tx_desc], -+ ARPLength, _FALSE, _FALSE, _TRUE); -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + ARPLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ /* 3 SEC IV * 1 page */ -+ rtw_get_sec_iv(adapter, cur_dot11txpn, -+ get_my_bssid(&pmlmeinfo->network)); -+ -+ rsvd_page_loc->LocRemoteCtrlInfo = *page_num; -+ -+ RTW_INFO("LocRemoteCtrlInfo: %d\n", rsvd_page_loc->LocRemoteCtrlInfo); -+ -+ _rtw_memcpy(pframe + index - tx_desc, cur_dot11txpn, _AES_IV_LEN_); -+ -+ CurtPktPageNum = (u8)PageNum(_AES_IV_LEN_, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ *total_pkt_len = index + _AES_IV_LEN_; -+#ifdef CONFIG_GTK_OL -+ index += (CurtPktPageNum * page_size); -+ -+ /* if the ap staion info. exists, get the kek, kck from staion info. */ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ _rtw_memset(kek, 0, RTW_KEK_LEN); -+ _rtw_memset(kck, 0, RTW_KCK_LEN); -+ RTW_INFO("%s, KEK, KCK download rsvd page all zero\n", -+ __func__); -+ } else { -+ _rtw_memcpy(kek, psta->kek, RTW_KEK_LEN); -+ _rtw_memcpy(kck, psta->kck, RTW_KCK_LEN); -+ } -+ -+ /* 3 KEK, KCK */ -+ rsvd_page_loc->LocGTKInfo = *page_num; -+ -+ gtk_index = psecuritypriv->dot118021XGrpKeyid; -+ GTKLength = 0; -+ -+ RTW_INFO("LocGTKInfo: %d, gtk_index:%d\n", -+ rsvd_page_loc->LocGTKInfo, gtk_index); -+ -+ if (IS_HARDWARE_TYPE_8188E(adapter) || IS_HARDWARE_TYPE_8812(adapter)) { -+ _rtw_memcpy(pframe + index - tx_desc, -+ &psecuritypriv->dot11PrivacyAlgrthm, 1); -+ _rtw_memcpy(pframe + index - tx_desc + 1, -+ &psecuritypriv->dot118021XGrpPrivacy, 1); -+ _rtw_memcpy(pframe + index - tx_desc + 2, -+ kck, RTW_KCK_LEN); -+ _rtw_memcpy(pframe + index - tx_desc + 2 + RTW_KCK_LEN, -+ kek, RTW_KEK_LEN); -+ GTKLength = tx_desc + 2 + RTW_KCK_LEN + RTW_KEK_LEN; -+ } else { -+ _rtw_memcpy(pframe + index - tx_desc, kck, RTW_KCK_LEN); -+ _rtw_memcpy(pframe + index - tx_desc + RTW_KCK_LEN, kek, RTW_KEK_LEN); -+ GTKLength = tx_desc + RTW_KCK_LEN + RTW_KEK_LEN; -+ } -+ -+ if (psta != NULL && -+ psecuritypriv->dot118021XGrpPrivacy == _TKIP_) { -+ _rtw_memcpy(pframe + index - tx_desc + 56, -+ &psta->dot11tkiptxmickey, RTW_TKIP_MIC_LEN); -+ GTKLength += RTW_TKIP_MIC_LEN; -+ } -+ -+ CurtPktPageNum = (u8)PageNum(GTKLength, page_size); -+#if 0 -+ { -+ int i; -+ printk("\ntoFW KCK: "); -+ for (i = 0; i < 16; i++) -+ printk(" %02x ", kck[i]); -+ printk("\ntoFW KEK: "); -+ for (i = 0; i < 16; i++) -+ printk(" %02x ", kek[i]); -+ printk("\n"); -+ } -+ -+ RTW_INFO("%s(): HW_VAR_SET_TX_CMD: KEK KCK %p %d\n", -+ __FUNCTION__, &pframe[index - tx_desc], -+ (tx_desc + RTW_KCK_LEN + RTW_KEK_LEN)); -+#endif -+ GTKLength = 0; -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ /* 3 GTK Response */ -+ rsvd_page_loc->LocGTKRsp = *page_num; -+ RTW_INFO("LocGTKRsp: %d\n", rsvd_page_loc->LocGTKRsp); -+ rtw_hal_construct_GTKRsp(adapter, &pframe[index], >KLength); -+ -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], -+ GTKLength, _FALSE, _FALSE, _TRUE); -+#if 0 -+ { -+ int gj; -+ printk("123GTK pkt=>\n"); -+ for (gj = 0; gj < GTKLegnth + tx_desc; gj++) { -+ printk(" %02x ", pframe[index - tx_desc + gj]); -+ if ((gj + 1) % 16 == 0) -+ printk("\n"); -+ } -+ printk(" <=end\n"); -+ } -+ -+ RTW_INFO("%s(): HW_VAR_SET_TX_CMD: GTK RSP %p %d\n", -+ __FUNCTION__, &pframe[index - tx_desc], -+ (tx_desc + GTKLegnth)); -+#endif -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + GTKLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ /* below page is empty for GTK extension memory */ -+ /* 3(11) GTK EXT MEM */ -+ rsvd_page_loc->LocGTKEXTMEM = *page_num; -+ -+ CurtPktPageNum = 2; -+ -+ if (page_size >= 256) -+ CurtPktPageNum = 1; -+ -+ *page_num += CurtPktPageNum; -+ /* extension memory for FW */ -+ index += (CurtPktPageNum * page_size); -+ -+ /*Reserve 1 page for AOAC report*/ -+ rsvd_page_loc->LocAOACReport = *page_num; -+ RTW_INFO("LocAOACReport: %d\n", rsvd_page_loc->LocAOACReport); -+ -+ *page_num += 1; -+ *total_pkt_len = index + (page_size * 1); -+#endif /* CONFIG_GTK_OL */ -+ } else { -+#ifdef CONFIG_PNO_SUPPORT -+ if (pwrctl->wowlan_in_resume == _FALSE && -+ pwrctl->pno_inited == _TRUE) { -+ -+ /* Broadcast Probe Request */ -+ rsvd_page_loc->LocProbePacket = *page_num; -+ -+ RTW_INFO("loc_probe_req: %d\n", -+ rsvd_page_loc->LocProbePacket); -+ -+ rtw_hal_construct_ProbeReq( -+ adapter, -+ &pframe[index], -+ &ProbeReqLength, -+ NULL); -+ -+ rtw_hal_fill_fake_txdesc(adapter, -+ &pframe[index - tx_desc], -+ ProbeReqLength, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = -+ (u8)PageNum(tx_desc + ProbeReqLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ /* Hidden SSID Probe Request */ -+ ssid_num = pwrctl->pnlo_info->hidden_ssid_num; -+ -+ for (pno_index = 0 ; pno_index < ssid_num ; pno_index++) { -+ pwrctl->pnlo_info->loc_probe_req[pno_index] = -+ *page_num; -+ -+ rtw_hal_construct_ProbeReq( -+ adapter, -+ &pframe[index], -+ &ProbeReqLength, -+ &pwrctl->pno_ssid_list->node[pno_index]); -+ -+ rtw_hal_fill_fake_txdesc(adapter, -+ &pframe[index - tx_desc], -+ ProbeReqLength, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = -+ (u8)PageNum(tx_desc + ProbeReqLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ } -+ -+ /* PNO INFO Page */ -+ rsvd_page_loc->LocPNOInfo = *page_num; -+ RTW_INFO("LocPNOInfo: %d\n", rsvd_page_loc->LocPNOInfo); -+ rtw_hal_construct_PNO_info(adapter, -+ &pframe[index - tx_desc], -+ &PNOLength); -+ -+ CurtPktPageNum = (u8)PageNum(PNOLength, page_size); -+ *page_num += CurtPktPageNum; -+ index += (CurtPktPageNum * page_size); -+ -+ /* Scan Info Page */ -+ rsvd_page_loc->LocScanInfo = *page_num; -+ RTW_INFO("LocScanInfo: %d\n", rsvd_page_loc->LocScanInfo); -+ rtw_hal_construct_scan_info(adapter, -+ &pframe[index - tx_desc], -+ &ScanInfoLength); -+ -+ CurtPktPageNum = (u8)PageNum(ScanInfoLength, page_size); -+ *page_num += CurtPktPageNum; -+ *total_pkt_len = index + ScanInfoLength; -+ index += (CurtPktPageNum * page_size); -+ -+ } -+#endif /* CONFIG_PNO_SUPPORT */ -+ } -+} -+ -+static void rtw_hal_gate_bb(_adapter *adapter, bool stop) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ u8 val8 = 0; -+ u16 val16 = 0; -+ -+ if (stop) { -+ /* Pause TX*/ -+ pwrpriv->wowlan_txpause_status = rtw_read8(adapter, REG_TXPAUSE); -+ rtw_write8(adapter, REG_TXPAUSE, 0xff); -+ val8 = rtw_read8(adapter, REG_SYS_FUNC_EN); -+ val8 &= ~BIT(0); -+ rtw_write8(adapter, REG_SYS_FUNC_EN, val8); -+ RTW_INFO("%s: BB gated: 0x%02x, store TXPAUSE: %02x\n", -+ __func__, -+ rtw_read8(adapter, REG_SYS_FUNC_EN), -+ pwrpriv->wowlan_txpause_status); -+ } else { -+ val8 = rtw_read8(adapter, REG_SYS_FUNC_EN); -+ val8 |= BIT(0); -+ rtw_write8(adapter, REG_SYS_FUNC_EN, val8); -+ RTW_INFO("%s: BB release: 0x%02x, recover TXPAUSE:%02x\n", -+ __func__, rtw_read8(adapter, REG_SYS_FUNC_EN), -+ pwrpriv->wowlan_txpause_status); -+ /* release TX*/ -+ rtw_write8(adapter, REG_TXPAUSE, pwrpriv->wowlan_txpause_status); -+ } -+} -+ -+static void rtw_hal_reset_mac_rx(_adapter *adapter) -+{ -+ u8 val8 = 0; -+ /* Set REG_CR bit1, bit3, bit7 to 0*/ -+ val8 = rtw_read8(adapter, REG_CR); -+ val8 &= 0x75; -+ rtw_write8(adapter, REG_CR, val8); -+ val8 = rtw_read8(adapter, REG_CR); -+ /* Set REG_CR bit1, bit3, bit7 to 1*/ -+ val8 |= 0x8a; -+ rtw_write8(adapter, REG_CR, val8); -+ RTW_INFO("0x%04x: %02x\n", REG_CR, rtw_read8(adapter, REG_CR)); -+} -+ -+static void rtw_hal_set_wow_rxff_boundary(_adapter *adapter, bool wow_mode) -+{ -+ u8 val8 = 0; -+ u16 rxff_bndy = 0; -+ u32 rx_dma_buff_sz = 0; -+ -+ val8 = rtw_read8(adapter, REG_FIFOPAGE + 3); -+ if (val8 != 0) -+ RTW_INFO("%s:[%04x]some PKTs in TXPKTBUF\n", -+ __func__, (REG_FIFOPAGE + 3)); -+ -+ rtw_hal_reset_mac_rx(adapter); -+ -+ if (wow_mode) { -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, -+ (u8 *)&rx_dma_buff_sz); -+ rxff_bndy = rx_dma_buff_sz - 1; -+ -+ rtw_write16(adapter, (REG_TRXFF_BNDY + 2), rxff_bndy); -+ RTW_INFO("%s: wow mode, 0x%04x: 0x%04x\n", __func__, -+ REG_TRXFF_BNDY + 2, -+ rtw_read16(adapter, (REG_TRXFF_BNDY + 2))); -+ } else { -+ rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ, -+ (u8 *)&rx_dma_buff_sz); -+ rxff_bndy = rx_dma_buff_sz - 1; -+ rtw_write16(adapter, (REG_TRXFF_BNDY + 2), rxff_bndy); -+ RTW_INFO("%s: normal mode, 0x%04x: 0x%04x\n", __func__, -+ REG_TRXFF_BNDY + 2, -+ rtw_read16(adapter, (REG_TRXFF_BNDY + 2))); -+ } -+} -+ -+static int rtw_hal_set_pattern(_adapter *adapter, u8 *pattern, -+ u8 len, u8 *mask, u8 idx) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct mlme_ext_priv *pmlmeext = NULL; -+ struct mlme_ext_info *pmlmeinfo = NULL; -+ struct rtl_wow_pattern wow_pattern; -+ u8 mask_hw[MAX_WKFM_SIZE] = {0}; -+ u8 content[MAX_WKFM_PATTERN_SIZE] = {0}; -+ u8 broadcast_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 multicast_addr1[2] = {0x33, 0x33}; -+ u8 multicast_addr2[3] = {0x01, 0x00, 0x5e}; -+ u8 res = _FALSE, index = 0, mask_len = 0; -+ u8 mac_addr[ETH_ALEN] = {0}; -+ u16 count = 0; -+ int i, j; -+ -+ if (pwrctl->wowlan_pattern_idx > MAX_WKFM_NUM) { -+ RTW_INFO("%s pattern_idx is more than MAX_FMC_NUM: %d\n", -+ __func__, MAX_WKFM_NUM); -+ return _FALSE; -+ } -+ -+ pmlmeext = &adapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ _rtw_memcpy(mac_addr, adapter_mac_addr(adapter), ETH_ALEN); -+ _rtw_memset(&wow_pattern, 0, sizeof(struct rtl_wow_pattern)); -+ -+ mask_len = DIV_ROUND_UP(len, 8); -+ -+ /* 1. setup A1 table */ -+ if (memcmp(pattern, broadcast_addr, ETH_ALEN) == 0) -+ wow_pattern.type = PATTERN_BROADCAST; -+ else if (memcmp(pattern, multicast_addr1, 2) == 0) -+ wow_pattern.type = PATTERN_MULTICAST; -+ else if (memcmp(pattern, multicast_addr2, 3) == 0) -+ wow_pattern.type = PATTERN_MULTICAST; -+ else if (memcmp(pattern, mac_addr, ETH_ALEN) == 0) -+ wow_pattern.type = PATTERN_UNICAST; -+ else -+ wow_pattern.type = PATTERN_INVALID; -+ -+ /* translate mask from os to mask for hw */ -+ -+/****************************************************************************** -+ * pattern from OS uses 'ethenet frame', like this: -+ -+ | 6 | 6 | 2 | 20 | Variable | 4 | -+ |--------+--------+------+-----------+------------+-----| -+ | 802.3 Mac Header | IP Header | TCP Packet | FCS | -+ | DA | SA | Type | -+ -+ * BUT, packet catched by our HW is in '802.11 frame', begin from LLC, -+ -+ | 24 or 30 | 6 | 2 | 20 | Variable | 4 | -+ |-------------------+--------+------+-----------+------------+-----| -+ | 802.11 MAC Header | LLC | IP Header | TCP Packet | FCS | -+ | Others | Tpye | -+ -+ * Therefore, we need translate mask_from_OS to mask_to_hw. -+ * We should left-shift mask by 6 bits, then set the new bit[0~5] = 0, -+ * because new mask[0~5] means 'SA', but our HW packet begins from LLC, -+ * bit[0~5] corresponds to first 6 Bytes in LLC, they just don't match. -+ ******************************************************************************/ -+ /* Shift 6 bits */ -+ for (i = 0; i < mask_len - 1; i++) { -+ mask_hw[i] = mask[i] >> 6; -+ mask_hw[i] |= (mask[i + 1] & 0x3F) << 2; -+ } -+ -+ mask_hw[i] = (mask[i] >> 6) & 0x3F; -+ /* Set bit 0-5 to zero */ -+ mask_hw[0] &= 0xC0; -+ -+ for (i = 0; i < (MAX_WKFM_SIZE / 4); i++) { -+ wow_pattern.mask[i] = mask_hw[i * 4]; -+ wow_pattern.mask[i] |= (mask_hw[i * 4 + 1] << 8); -+ wow_pattern.mask[i] |= (mask_hw[i * 4 + 2] << 16); -+ wow_pattern.mask[i] |= (mask_hw[i * 4 + 3] << 24); -+ } -+ -+ /* To get the wake up pattern from the mask. -+ * We do not count first 12 bits which means -+ * DA[6] and SA[6] in the pattern to match HW design. */ -+ count = 0; -+ for (i = 12; i < len; i++) { -+ if ((mask[i / 8] >> (i % 8)) & 0x01) { -+ content[count] = pattern[i]; -+ count++; -+ } -+ } -+ -+ wow_pattern.crc = rtw_calc_crc(content, count); -+ -+ if (wow_pattern.crc != 0) { -+ if (wow_pattern.type == PATTERN_INVALID) -+ wow_pattern.type = PATTERN_VALID; -+ } -+ -+ index = idx; -+ -+ if (!pwrctl->bInSuspend) -+ index += 2; -+ -+ /* write pattern */ -+ res = rtw_write_to_frame_mask(adapter, index, &wow_pattern); -+ -+ if (res == _FALSE) -+ RTW_INFO("%s: ERROR!! idx: %d write_to_frame_mask_cam fail\n", -+ __func__, idx); -+ -+ return res; -+} -+ -+static void rtw_hal_dl_pattern(_adapter *adapter, u8 mode) -+{ -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ int i = 0, total = 0; -+ -+ total = pwrpriv->wowlan_pattern_idx; -+ -+ if (total > MAX_WKFM_NUM) -+ total = MAX_WKFM_NUM; -+ -+ rtw_clean_pattern(adapter); -+ -+ switch (mode) { -+ case 0: -+ RTW_INFO("%s: total patterns: %d\n", __func__, total); -+ break; -+ case 1: -+ rtw_set_default_pattern(adapter); -+ for (i = 0 ; i < total ; i++) { -+ rtw_hal_set_pattern(adapter, -+ pwrpriv->patterns[i].content, -+ pwrpriv->patterns[i].len, -+ pwrpriv->patterns[i].mask, i); -+ } -+ rtw_write8(adapter, REG_WKFMCAM_NUM, total); -+ RTW_INFO("%s: pattern total: %d downloaded\n", -+ __func__, total); -+ break; -+ case 2: -+ pwrpriv->wowlan_pattern_idx = DEFAULT_PATTERN_NUM; -+ -+ for (i = DEFAULT_PATTERN_NUM ; i < MAX_WKFM_NUM ; i++) { -+ _rtw_memset(pwrpriv->patterns[i].content, '\0', -+ sizeof(pwrpriv->patterns[i].content)); -+ _rtw_memset(pwrpriv->patterns[i].mask, '\0', -+ sizeof(pwrpriv->patterns[i].mask)); -+ pwrpriv->patterns[i].len = 0; -+ } -+ RTW_INFO("%s: clean patterns\n", __func__); -+ break; -+ default: -+ RTW_INFO("%s: unknown mode\n", __func__); -+ break; -+ } -+} -+ -+static void rtw_hal_wow_enable(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ struct sta_info *psta = NULL; -+ int res; -+ u16 media_status_rpt; -+ -+ -+ RTW_PRINT("%s, WOWLAN_ENABLE\n", __func__); -+ rtw_hal_gate_bb(adapter, _TRUE); -+#ifdef CONFIG_GTK_OL -+ if (psecuritypriv->binstallKCK_KEK == _TRUE) -+ rtw_hal_fw_sync_cam_id(adapter); -+#endif -+ if (IS_HARDWARE_TYPE_8723B(adapter)) -+ rtw_hal_backup_rate(adapter); -+ -+ /* RX DMA stop */ -+ if (IS_HARDWARE_TYPE_8188E(adapter)) -+ rtw_hal_disable_tx_report(adapter); -+ -+ res = rtw_hal_pause_rx_dma(adapter); -+ if (res == _FAIL) -+ RTW_PRINT("[WARNING] pause RX DMA fail\n"); -+ -+ /* Reconfig RX_FF Boundary */ -+ rtw_hal_set_wow_rxff_boundary(adapter, _TRUE); -+ -+ /* redownload wow pattern */ -+ rtw_hal_dl_pattern(adapter, 1); -+ -+ rtw_hal_fw_dl(adapter, _TRUE); -+ media_status_rpt = RT_MEDIA_CONNECT; -+ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_FW_JOINBSSRPT, -+ (u8 *)&media_status_rpt); -+ -+ if (!pwrctl->wowlan_pno_enable) { -+ psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); -+ if (psta != NULL) -+ rtw_sta_media_status_rpt(adapter, psta, 1); -+ } -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ /* Enable CPWM2 only. */ -+ res = rtw_hal_enable_cpwm2(adapter); -+ if (res == _FAIL) -+ RTW_PRINT("[WARNING] enable cpwm2 fail\n"); -+#endif -+#ifdef CONFIG_GPIO_WAKEUP -+ rtw_hal_switch_gpio_wl_ctrl(adapter, WAKEUP_GPIO_IDX, _TRUE); -+#endif -+ /* Set WOWLAN H2C command. */ -+ RTW_PRINT("Set WOWLan cmd\n"); -+ rtw_hal_set_fw_wow_related_cmd(adapter, 1); -+ -+ res = rtw_hal_check_wow_ctrl(adapter, _TRUE); -+ -+ if (res == _FALSE) -+ RTW_INFO("[Error]%s: set wowlan CMD fail!!\n", __func__); -+ -+ pwrctl->wowlan_wake_reason = -+ rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); -+ -+ RTW_PRINT("wowlan_wake_reason: 0x%02x\n", -+ pwrctl->wowlan_wake_reason); -+#ifdef CONFIG_GTK_OL_DBG -+ dump_sec_cam(RTW_DBGDUMP, adapter); -+#endif -+#ifdef CONFIG_USB_HCI -+ /* free adapter's resource */ -+ rtw_mi_intf_stop(adapter); -+ -+ /* Invoid SE0 reset signal during suspending*/ -+ rtw_write8(adapter, REG_RSV_CTRL, 0x20); -+ rtw_write8(adapter, REG_RSV_CTRL, 0x60); -+#endif /*CONFIG_USB_HCI*/ -+ -+ rtw_hal_gate_bb(adapter, _FALSE); -+} -+ -+static void rtw_hal_wow_disable(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ struct sta_info *psta = NULL; -+ int res; -+ u16 media_status_rpt; -+ u8 val8; -+ -+ RTW_PRINT("%s, WOWLAN_DISABLE\n", __func__); -+ -+ if (!pwrctl->wowlan_pno_enable) { -+ psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); -+ if (psta != NULL) -+ rtw_sta_media_status_rpt(adapter, psta, 0); -+ else -+ RTW_INFO("%s: psta is null\n", __func__); -+ } -+ -+ if (0) { -+ RTW_INFO("0x630:0x%02x\n", rtw_read8(adapter, 0x630)); -+ RTW_INFO("0x631:0x%02x\n", rtw_read8(adapter, 0x631)); -+ } -+ -+ pwrctl->wowlan_wake_reason = rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); -+ -+ RTW_PRINT("wakeup_reason: 0x%02x\n", -+ pwrctl->wowlan_wake_reason); -+ -+ rtw_hal_set_fw_wow_related_cmd(adapter, 0); -+ -+ res = rtw_hal_check_wow_ctrl(adapter, _FALSE); -+ -+ if (res == _FALSE) { -+ RTW_INFO("[Error]%s: disable WOW cmd fail\n!!", __func__); -+ rtw_hal_force_enable_rxdma(adapter); -+ } -+ -+ rtw_hal_gate_bb(adapter, _TRUE); -+ -+ res = rtw_hal_pause_rx_dma(adapter); -+ if (res == _FAIL) -+ RTW_PRINT("[WARNING] pause RX DMA fail\n"); -+ -+ /* clean HW pattern match */ -+ rtw_hal_dl_pattern(adapter, 0); -+ -+ /* config RXFF boundary to original */ -+ rtw_hal_set_wow_rxff_boundary(adapter, _FALSE); -+ -+ rtw_hal_release_rx_dma(adapter); -+ -+ if (IS_HARDWARE_TYPE_8188E(adapter)) -+ rtw_hal_enable_tx_report(adapter); -+ -+#ifdef CONFIG_GTK_OL -+ if (((pwrctl->wowlan_wake_reason != RX_DISASSOC) || -+ (pwrctl->wowlan_wake_reason != RX_DEAUTH) || -+ (pwrctl->wowlan_wake_reason != FW_DECISION_DISCONNECT)) && -+ psecuritypriv->binstallKCK_KEK == _TRUE) { -+ rtw_hal_get_aoac_rpt(adapter); -+ rtw_hal_update_sw_security_info(adapter); -+ } -+#endif /*CONFIG_GTK_OL*/ -+ -+ rtw_hal_fw_dl(adapter, _FALSE); -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ val8 = (pwrctl->is_high_active == 0) ? 1 : 0; -+ RTW_PRINT("Set Wake GPIO to default(%d).\n", val8); -+ rtw_hal_set_output_gpio(adapter, WAKEUP_GPIO_IDX, val8); -+#endif -+ -+ if ((pwrctl->wowlan_wake_reason != FW_DECISION_DISCONNECT) && -+ (pwrctl->wowlan_wake_reason != RX_PAIRWISEKEY) && -+ (pwrctl->wowlan_wake_reason != RX_DISASSOC) && -+ (pwrctl->wowlan_wake_reason != RX_DEAUTH)) { -+ -+ media_status_rpt = RT_MEDIA_CONNECT; -+ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_FW_JOINBSSRPT, -+ (u8 *)&media_status_rpt); -+ -+ if (psta != NULL) -+ rtw_sta_media_status_rpt(adapter, psta, 1); -+ } -+ rtw_hal_gate_bb(adapter, _FALSE); -+} -+#endif /*CONFIG_WOWLAN*/ -+ -+#ifdef CONFIG_P2P_WOWLAN -+void rtw_hal_set_p2p_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, -+ u8 tx_desc, u32 page_size, u8 *page_num, u32 *total_pkt_len, -+ RSVDPAGE_LOC *rsvd_page_loc) -+{ -+ u32 P2PNegoRspLength = 0, P2PInviteRspLength = 0; -+ u32 P2PPDRspLength = 0, P2PProbeRspLength = 0, P2PBCNLength = 0; -+ u8 CurtPktPageNum = 0; -+ -+ /* P2P Beacon */ -+ rsvd_page_loc->LocP2PBeacon = *page_num; -+ rtw_hal_construct_P2PBeacon(adapter, &pframe[index], &P2PBCNLength); -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], -+ P2PBCNLength, _FALSE, _FALSE, _FALSE); -+ -+#if 0 -+ RTW_INFO("%s(): HW_VAR_SET_TX_CMD: PROBE RSP %p %d\n", -+ __FUNCTION__, &pframe[index - tx_desc], (P2PBCNLength + tx_desc)); -+#endif -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + P2PBCNLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ /* P2P Probe rsp */ -+ rsvd_page_loc->LocP2PProbeRsp = *page_num; -+ rtw_hal_construct_P2PProbeRsp(adapter, &pframe[index], -+ &P2PProbeRspLength); -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], -+ P2PProbeRspLength, _FALSE, _FALSE, _FALSE); -+ -+ /* RTW_INFO("%s(): HW_VAR_SET_TX_CMD: PROBE RSP %p %d\n", */ -+ /* __FUNCTION__, &pframe[index-tx_desc], (P2PProbeRspLength+tx_desc)); */ -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + P2PProbeRspLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ /* P2P nego rsp */ -+ rsvd_page_loc->LocNegoRsp = *page_num; -+ rtw_hal_construct_P2PNegoRsp(adapter, &pframe[index], -+ &P2PNegoRspLength); -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], -+ P2PNegoRspLength, _FALSE, _FALSE, _FALSE); -+ -+ /* RTW_INFO("%s(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", */ -+ /* __FUNCTION__, &pframe[index-tx_desc], (NegoRspLength+tx_desc)); */ -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + P2PNegoRspLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ /* P2P invite rsp */ -+ rsvd_page_loc->LocInviteRsp = *page_num; -+ rtw_hal_construct_P2PInviteRsp(adapter, &pframe[index], -+ &P2PInviteRspLength); -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], -+ P2PInviteRspLength, _FALSE, _FALSE, _FALSE); -+ -+ /* RTW_INFO("%s(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", */ -+ /* __FUNCTION__, &pframe[index-tx_desc], (InviteRspLength+tx_desc)); */ -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + P2PInviteRspLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ /* P2P provision discovery rsp */ -+ rsvd_page_loc->LocPDRsp = *page_num; -+ rtw_hal_construct_P2PProvisionDisRsp(adapter, -+ &pframe[index], &P2PPDRspLength); -+ -+ rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], -+ P2PPDRspLength, _FALSE, _FALSE, _FALSE); -+ -+ /* RTW_INFO("%s(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", */ -+ /* __FUNCTION__, &pframe[index-tx_desc], (PDRspLength+tx_desc)); */ -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + P2PPDRspLength, page_size); -+ -+ *page_num += CurtPktPageNum; -+ -+ *total_pkt_len = index + P2PPDRspLength; -+ -+ index += (CurtPktPageNum * page_size); -+ -+ -+} -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+#ifdef CONFIG_LPS_PG -+ #define LPSPG_RSVD_PAGE_SET_MACID(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 0, 8, _value)/*used macid*/ -+ #define LPSPG_RSVD_PAGE_SET_MBSSCAMID(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 8, 8, _value)/*used BSSID CAM entry*/ -+ #define LPSPG_RSVD_PAGE_SET_PMC_NUM(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 16, 8, _value)/*Max used Pattern Match CAM entry*/ -+ #define LPSPG_RSVD_PAGE_SET_MU_RAID_GID(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 24, 8, _value)/*Max MU rate table Group ID*/ -+ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_NUM(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x04, 0, 8, _value)/*used Security CAM entry number*/ -+ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID1(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 0, 8, _value)/*used Security CAM entry -1*/ -+ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID2(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 8, 8, _value)/*used Security CAM entry -2*/ -+ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID3(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 16, 8, _value)/*used Security CAM entry -3*/ -+ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID4(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 24, 8, _value)/*used Security CAM entry -4*/ -+ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID5(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 0, 8, _value)/*used Security CAM entry -5*/ -+ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID6(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 8, 8, _value)/*used Security CAM entry -6*/ -+ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID7(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 16, 8, _value)/*used Security CAM entry -7*/ -+ #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID8(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 24, 8, _value)/*used Security CAM entry -8*/ -+#endif -+#ifdef CONFIG_LPS_PG -+#include "hal_halmac.h" -+ -+#define DBG_LPSPG_SEC_DUMP -+#define LPS_PG_INFO_RSVD_LEN 16 -+ -+static void rtw_hal_set_lps_pg_info_rsvd_page(_adapter *adapter) -+{ -+ u8 cur_pag_num = 0; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct sta_info *psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(&adapter->mlmepriv)); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 lps_pg_info[LPS_PG_INFO_RSVD_LEN] = {0}; -+#ifdef CONFIG_MBSSID_CAM -+ u8 cam_id = INVALID_CAM_ID; -+#endif -+ u8 *psec_cam_id = lps_pg_info + 8; -+ u8 sec_cam_num = 0; -+ -+ if (!psta) { -+ RTW_ERR("%s [ERROR] sta is NULL\n", __func__); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ LPSPG_RSVD_PAGE_SET_MACID(lps_pg_info, psta->mac_id); /*used macid*/ -+ RTW_INFO("[LPSPG-INFO] mac_id:%d\n", psta->mac_id); -+ -+#ifdef CONFIG_MBSSID_CAM -+ cam_id = rtw_mbid_cam_search_by_ifaceid(adapter, adapter->iface_id); -+ if (cam_id != INVALID_CAM_ID) -+ LPSPG_RSVD_PAGE_SET_MBSSCAMID(lps_pg_info, cam_id); /*used BSSID CAM entry*/ -+ RTW_INFO("[LPSPG-INFO] mbss_cam_id:%d\n", cam_id); -+#endif -+ -+#ifdef CONFIG_WOWLAN /*&& pattern match cam used*/ -+ if (pwrpriv->wowlan_mode == _TRUE && -+ check_fwstate(&adapter->mlmepriv, _FW_LINKED) == _TRUE) { -+ LPSPG_RSVD_PAGE_SET_PMC_NUM(lps_pg_info, pwrpriv->wowlan_pattern_idx); /*Max used Pattern Match CAM entry*/ -+ RTW_INFO("[LPSPG-INFO] Max Pattern Match CAM entry :%d\n", _value); -+ } -+#endif -+#ifdef CONFIG_BEAMFORMING /*&& MU BF*/ -+ LPSPG_RSVD_PAGE_SET_MU_RAID_GID(lps_pg_info, _value); /*Max MU rate table Group ID*/ -+ RTW_INFO("[LPSPG-INFO] Max MU rate table Group ID :%d\n", _value); -+#endif -+ -+ sec_cam_num = rtw_get_sec_camid(adapter, 8, psec_cam_id); -+ if (sec_cam_num < 8) -+ LPSPG_RSVD_PAGE_SET_SEC_CAM_NUM(lps_pg_info, sec_cam_num); /*used Security CAM entry number*/ -+ RTW_INFO("[LPSPG-INFO] Security CAM entry number :%d\n", sec_cam_num); -+ -+#ifdef DBG_LPSPG_SEC_DUMP -+ { -+ int i; -+ -+ for (i = 0; i < sec_cam_num; i++) -+ RTW_INFO("%d = sec_cam_id:%d\n", i, psec_cam_id[i]); -+ } -+#endif -+ -+#ifdef DBG_LPSPG_INFO_DUMP -+ RTW_INFO("==== DBG_LPSPG_INFO_RSVD_PAGE_DUMP====\n"); -+ RTW_INFO(" %02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X\n", -+ *(lps_pg_info), *(lps_pg_info + 1), *(lps_pg_info + 2), *(lps_pg_info + 3), -+ *(lps_pg_info + 4), *(lps_pg_info + 5), *(lps_pg_info + 6), *(lps_pg_info + 7)); -+ RTW_INFO(" %02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X\n", -+ *(lps_pg_info + 8), *(lps_pg_info + 9), *(lps_pg_info + 10), *(lps_pg_info + 11), -+ *(lps_pg_info + 12), *(lps_pg_info + 13), *(lps_pg_info + 14), *(lps_pg_info + 15)); -+ RTW_INFO("==== DBG_LPSPG_INFO_RSVD_PAGE_DUMP====\n"); -+#endif -+ -+ rtw_halmac_download_rsvd_page(dvobj, pwrpriv->lpspg_rsvd_page_locate, lps_pg_info, LPS_PG_INFO_RSVD_LEN); -+ -+} -+ -+#define DBG_LPSPG_INFO_DUMP -+static u8 rtw_hal_set_lps_pg_info_cmd(_adapter *adapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ u8 lpspg_info[H2C_LPS_PG_INFO_LEN] = {0}; -+ u8 ret = _FAIL; -+ -+ RTW_INFO("%s: loc_lpspg_info:%d\n", __func__, pwrpriv->lpspg_rsvd_page_locate); -+ -+ if (_NO_PRIVACY_ != adapter->securitypriv.dot11PrivacyAlgrthm) -+ SET_H2CCMD_LPSPG_SEC_CAM_EN(lpspg_info, 1); /*SecurityCAM_En*/ -+#ifdef CONFIG_MBSSID_CAM -+ SET_H2CCMD_LPSPG_MBID_CAM_EN(lpspg_info, 1); /*BSSIDCAM_En*/ -+#endif -+ -+#ifdef CONFIG_WOWLAN /*&& pattern match cam used*/ -+ if (pwrpriv->wowlan_mode == _TRUE && -+ check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ -+ SET_H2CCMD_LPSPG_PMC_CAM_EN(lpspg_info, 1); /*PatternMatchCAM_En*/ -+ } -+#endif -+ -+#ifdef CONFIG_MACID_SEARCH -+ SET_H2CCMD_LPSPG_MACID_SEARCH_EN(lpspg_info, 1); /*MACIDSearch_En*/ -+#endif -+ -+#ifdef CONFIG_TX_SC -+ SET_H2CCMD_LPSPG_TXSC_EN(lpspg_info, 1); /*TXSC_En*/ -+#endif -+ -+#ifdef CONFIG_BEAMFORMING /*&& MU BF*/ -+ SET_H2CCMD_LPSPG_MU_RATE_TB_EN(lpspg_info, 1); /*MURateTable_En*/ -+#endif -+ -+ SET_H2CCMD_LPSPG_LOC(lpspg_info, pwrpriv->lpspg_rsvd_page_locate); -+ -+#ifdef DBG_LPSPG_INFO_DUMP -+ RTW_INFO("==== DBG_LPSPG_INFO_CMD_DUMP====\n"); -+ RTW_INFO(" H2C_CMD: 0x%02x, H2C_LEN: %d\n", H2C_LPS_PG_INFO, H2C_LPS_PG_INFO_LEN); -+ RTW_INFO(" %02X:%02X\n", *(lpspg_info), *(lpspg_info + 1)); -+ RTW_INFO("==== DBG_LPSPG_INFO_CMD_DUMP====\n"); -+#endif -+ -+ ret = rtw_hal_fill_h2c_cmd(adapter, -+ H2C_LPS_PG_INFO, -+ H2C_LPS_PG_INFO_LEN, -+ lpspg_info); -+ return ret; -+} -+u8 rtw_hal_set_lps_pg_info(_adapter *adapter) -+{ -+ u8 ret = _FAIL; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ -+ if (pwrpriv->lpspg_rsvd_page_locate == 0) { -+ RTW_ERR("%s [ERROR] lpspg_rsvd_page_locate = 0\n", __func__); -+ rtw_warn_on(1); -+ return ret; -+ } -+ -+ rtw_hal_set_lps_pg_info_rsvd_page(adapter); -+ ret = rtw_hal_set_lps_pg_info_cmd(adapter); -+ if (_SUCCESS == ret) -+ pwrpriv->blpspg_info_up = _FALSE; -+ -+ return ret; -+} -+#endif /*CONFIG_LPS_PG*/ -+ -+/* -+ * Description: Fill the reserved packets that FW will use to RSVD page. -+ * Now we just send 4 types packet to rsvd page. -+ * (1)Beacon, (2)Ps-poll, (3)Null data, (4)ProbeRsp. -+ * Input: -+ * finished - FALSE:At the first time we will send all the packets as a large packet to Hw, -+ * so we need to set the packet length to total lengh. -+ * TRUE: At the second time, we should send the first packet (default:beacon) -+ * to Hw again and set the lengh in descriptor to the real beacon lengh. -+ * 2009.10.15 by tynli. -+ * -+ * Page Size = 128: 8188e, 8723a/b, 8192c/d, -+ * Page Size = 256: 8192e, 8821a -+ * Page Size = 512: 8812a -+ */ -+ -+void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) -+{ -+ PHAL_DATA_TYPE pHalData; -+ struct xmit_frame *pcmdframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ struct pwrctrl_priv *pwrctl; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct hal_ops *pHalFunc = &adapter->HalFunc; -+ u32 BeaconLength = 0, ProbeRspLength = 0, PSPollLength = 0; -+ u32 NullDataLength = 0, QosNullLength = 0, BTQosNullLength = 0; -+ u32 ProbeReqLength = 0, NullFunctionDataLength = 0; -+ u8 TxDescLen = TXDESC_SIZE, TxDescOffset = TXDESC_OFFSET; -+ u8 TotalPageNum = 0 , CurtPktPageNum = 0 , RsvdPageNum = 0; -+ u8 *ReservedPagePacket; -+ u16 BufIndex = 0; -+ u32 TotalPacketLen = 0, MaxRsvdPageBufSize = 0, PageSize = 0; -+ RSVDPAGE_LOC RsvdPageLoc; -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ struct sreset_priv *psrtpriv; -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ -+#ifdef CONFIG_MCC_MODE -+ u8 dl_mcc_page = _FAIL; -+#endif /* CONFIG_MCC_MODE */ -+ -+ pHalData = GET_HAL_DATA(adapter); -+#ifdef DBG_CONFIG_ERROR_DETECT -+ psrtpriv = &pHalData->srestpriv; -+#endif -+ pxmitpriv = &adapter->xmitpriv; -+ pmlmeext = &adapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ pwrctl = adapter_to_pwrctl(adapter); -+ -+ rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&PageSize); -+ -+ if (PageSize == 0) { -+ RTW_INFO("[Error]: %s, PageSize is zero!!\n", __func__); -+ return; -+ } -+ -+ if (pwrctl->wowlan_mode == _TRUE || pwrctl->wowlan_ap_mode == _TRUE) -+ RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _TRUE); -+ else -+ RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _FALSE); -+ -+ RTW_INFO("%s PageSize: %d, RsvdPageNUm: %d\n", __func__, PageSize, RsvdPageNum); -+ -+ MaxRsvdPageBufSize = RsvdPageNum * PageSize; -+ -+ if (MaxRsvdPageBufSize > MAX_CMDBUF_SZ) { -+ RTW_INFO("%s MaxRsvdPageBufSize(%d) is larger than MAX_CMDBUF_SZ(%d)", -+ __func__, MaxRsvdPageBufSize, MAX_CMDBUF_SZ); -+ rtw_warn_on(1); -+ return; -+ } -+ -+ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); -+ -+ if (pcmdframe == NULL) { -+ RTW_INFO("%s: alloc ReservedPagePacket fail!\n", __FUNCTION__); -+ return; -+ } -+ -+ ReservedPagePacket = pcmdframe->buf_addr; -+ _rtw_memset(&RsvdPageLoc, 0, sizeof(RSVDPAGE_LOC)); -+ -+ /* beacon * 2 pages */ -+ BufIndex = TxDescOffset; -+ rtw_hal_construct_beacon(adapter, -+ &ReservedPagePacket[BufIndex], &BeaconLength); -+ -+ /* -+ * When we count the first page size, we need to reserve description size for the RSVD -+ * packet, it will be filled in front of the packet in TXPKTBUF. -+ */ -+ CurtPktPageNum = (u8)PageNum((TxDescLen + BeaconLength), PageSize); -+ /* If we don't add 1 more page, ARP offload function will fail at 8723bs.*/ -+ if (CurtPktPageNum == 1) -+ CurtPktPageNum += 1; -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum * PageSize); -+ -+ if (pwrctl->wowlan_ap_mode == _TRUE) { -+ /* (4) probe response*/ -+ RsvdPageLoc.LocProbeRsp = TotalPageNum; -+ rtw_hal_construct_ProbeRsp( -+ adapter, &ReservedPagePacket[BufIndex], -+ &ProbeRspLength, -+ get_my_bssid(&pmlmeinfo->network), _FALSE); -+ rtw_hal_fill_fake_txdesc(adapter, -+ &ReservedPagePacket[BufIndex - TxDescLen], -+ ProbeRspLength, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum(TxDescLen + ProbeRspLength, PageSize); -+ TotalPageNum += CurtPktPageNum; -+ TotalPacketLen = BufIndex + ProbeRspLength; -+ BufIndex += (CurtPktPageNum * PageSize); -+ goto download_page; -+ } -+ -+ /* ps-poll * 1 page */ -+ RsvdPageLoc.LocPsPoll = TotalPageNum; -+ RTW_INFO("LocPsPoll: %d\n", RsvdPageLoc.LocPsPoll); -+ rtw_hal_construct_PSPoll(adapter, -+ &ReservedPagePacket[BufIndex], &PSPollLength); -+ rtw_hal_fill_fake_txdesc(adapter, -+ &ReservedPagePacket[BufIndex - TxDescLen], -+ PSPollLength, _TRUE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum((TxDescLen + PSPollLength), PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum * PageSize); -+ -+#ifdef CONFIG_BT_COEXIST -+ /* BT Qos null data * 1 page */ -+ RsvdPageLoc.LocBTQosNull = TotalPageNum; -+ RTW_INFO("LocBTQosNull: %d\n", RsvdPageLoc.LocBTQosNull); -+ rtw_hal_construct_NullFunctionData( -+ adapter, -+ &ReservedPagePacket[BufIndex], -+ &BTQosNullLength, -+ get_my_bssid(&pmlmeinfo->network), -+ _TRUE, 0, 0, _FALSE); -+ rtw_hal_fill_fake_txdesc(adapter, -+ &ReservedPagePacket[BufIndex - TxDescLen], -+ BTQosNullLength, _FALSE, _TRUE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum(TxDescLen + BTQosNullLength, PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum * PageSize); -+#endif /* CONFIG_BT_COEXIT */ -+ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(adapter)) { -+ dl_mcc_page = rtw_hal_dl_mcc_fw_rsvd_page(adapter, ReservedPagePacket, -+ &BufIndex, TxDescLen, PageSize, -+ &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); -+ } else -+ dl_mcc_page = _FAIL; -+ -+ if (dl_mcc_page == _FAIL) { -+#endif /* CONFIG_MCC_MODE */ -+ -+ /* null data * 1 page */ -+ RsvdPageLoc.LocNullData = TotalPageNum; -+ RTW_INFO("LocNullData: %d\n", RsvdPageLoc.LocNullData); -+ rtw_hal_construct_NullFunctionData( -+ adapter, -+ &ReservedPagePacket[BufIndex], -+ &NullDataLength, -+ get_my_bssid(&pmlmeinfo->network), -+ _FALSE, 0, 0, _FALSE); -+ rtw_hal_fill_fake_txdesc(adapter, -+ &ReservedPagePacket[BufIndex - TxDescLen], -+ NullDataLength, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum(TxDescLen + NullDataLength, PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum * PageSize); -+#ifdef CONFIG_MCC_MODE -+ } -+#endif /* CONFIG_MCC_MODE */ -+ -+ /* Qos null data * 1 page */ -+ RsvdPageLoc.LocQosNull = TotalPageNum; -+ RTW_INFO("LocQosNull: %d\n", RsvdPageLoc.LocQosNull); -+ rtw_hal_construct_NullFunctionData( -+ adapter, -+ &ReservedPagePacket[BufIndex], -+ &QosNullLength, -+ get_my_bssid(&pmlmeinfo->network), -+ _TRUE, 0, 0, _FALSE); -+ rtw_hal_fill_fake_txdesc(adapter, -+ &ReservedPagePacket[BufIndex - TxDescLen], -+ QosNullLength, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum(TxDescLen + QosNullLength, PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ TotalPacketLen = BufIndex + QosNullLength; -+ -+ BufIndex += (CurtPktPageNum * PageSize); -+ -+#ifdef CONFIG_WOWLAN -+ if (pwrctl->wowlan_mode == _TRUE && -+ pwrctl->wowlan_in_resume == _FALSE) { -+ rtw_hal_set_wow_fw_rsvd_page(adapter, ReservedPagePacket, -+ BufIndex, TxDescLen, PageSize, -+ &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); -+ } -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_P2P_WOWLAN -+ if (_TRUE == pwrctl->wowlan_p2p_mode) { -+ rtw_hal_set_p2p_wow_fw_rsvd_page(adapter, ReservedPagePacket, -+ BufIndex, TxDescLen, PageSize, -+ &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); -+ } -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+#ifdef CONFIG_LPS_PG -+ /* must reserved last 1 x page for LPS PG Info*/ -+ pwrctl->lpspg_rsvd_page_locate = TotalPageNum; -+ pwrctl->blpspg_info_up = _TRUE; -+#endif -+ -+download_page: -+ /* RTW_INFO("%s BufIndex(%d), TxDescLen(%d), PageSize(%d)\n",__func__, BufIndex, TxDescLen, PageSize);*/ -+ RTW_INFO("%s PageNum(%d), pktlen(%d)\n", -+ __func__, TotalPageNum, TotalPacketLen); -+ -+ if (TotalPacketLen > MaxRsvdPageBufSize) { -+ RTW_INFO("%s(ERROR): rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n", -+ __FUNCTION__, TotalPacketLen, MaxRsvdPageBufSize); -+ rtw_warn_on(1); -+ goto error; -+ } else { -+ /* update attribute */ -+ pattrib = &pcmdframe->attrib; -+ update_mgntframe_attrib(adapter, pattrib); -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->pktlen = TotalPacketLen - TxDescOffset; -+ pattrib->last_txcmdsz = TotalPacketLen - TxDescOffset; -+#ifdef CONFIG_PCI_HCI -+ dump_mgntframe(adapter, pcmdframe); -+#else -+ dump_mgntframe_and_wait(adapter, pcmdframe, 100); -+#endif -+ } -+ -+ RTW_INFO("%s: Set RSVD page location to Fw ,TotalPacketLen(%d), TotalPageNum(%d)\n", -+ __func__, TotalPacketLen, TotalPageNum); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ rtw_hal_set_FwRsvdPage_cmd(adapter, &RsvdPageLoc); -+#ifdef CONFIG_WOWLAN -+ if (pwrctl->wowlan_mode == _TRUE && -+ pwrctl->wowlan_in_resume == _FALSE) -+ rtw_hal_set_FwAoacRsvdPage_cmd(adapter, &RsvdPageLoc); -+#endif /* CONFIG_WOWLAN */ -+#ifdef CONFIG_AP_WOWLAN -+ if (pwrctl->wowlan_ap_mode == _TRUE) -+ rtw_hal_set_ap_rsvdpage_loc_cmd(adapter, &RsvdPageLoc); -+#endif /* CONFIG_AP_WOWLAN */ -+ } else if (pwrctl->wowlan_pno_enable) { -+#ifdef CONFIG_PNO_SUPPORT -+ rtw_hal_set_FwAoacRsvdPage_cmd(adapter, &RsvdPageLoc); -+ if (pwrctl->wowlan_in_resume) -+ rtw_hal_set_scan_offload_info_cmd(adapter, -+ &RsvdPageLoc, 0); -+ else -+ rtw_hal_set_scan_offload_info_cmd(adapter, -+ &RsvdPageLoc, 1); -+#endif /* CONFIG_PNO_SUPPORT */ -+ } -+#ifdef CONFIG_P2P_WOWLAN -+ if (_TRUE == pwrctl->wowlan_p2p_mode) -+ rtw_hal_set_FwP2PRsvdPage_cmd(adapter, &RsvdPageLoc); -+#endif /* CONFIG_P2P_WOWLAN */ -+ return; -+error: -+ rtw_free_xmitframe(pxmitpriv, pcmdframe); -+} -+static void rtw_hal_set_hw_update_tsf(PADAPTER padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+#if defined(CONFIG_RTL8822B) || defined(CONFIG_MI_WITH_MBSSID_CAM) -+ RTW_INFO("[Warn] %s "ADPT_FMT" enter func\n", __func__, ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ return; -+#endif -+ -+ if (!pmlmeext->en_hw_update_tsf) -+ return; -+ -+ /* check REG_RCR bit is set */ -+ if (!(rtw_read32(padapter, REG_RCR) & RCR_CBSSID_BCN)) -+ return; -+ -+ /* enable hw update tsf function for non-AP */ -+ if (rtw_linked_check(padapter) && -+ check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) { -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->hw_port == HW_PORT1) -+ rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1) & (~DIS_TSF_UDT)); -+ else -+#endif -+ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) & (~DIS_TSF_UDT)); -+ } -+ pmlmeext->en_hw_update_tsf = _FALSE; -+} -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+s32 rtw_hal_ch_sw_oper_offload(_adapter *padapter, u8 channel, u8 channel_offset, u16 bwmode) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ u8 ch_sw_h2c_buf[4] = {0x00, 0x00, 0x00, 0x00}; -+ -+ -+ SET_H2CCMD_CH_SW_OPER_OFFLOAD_CH_NUM(ch_sw_h2c_buf, channel); -+ SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_MODE(ch_sw_h2c_buf, bwmode); -+ switch (bwmode) { -+ case CHANNEL_WIDTH_40: -+ SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_40M_SC(ch_sw_h2c_buf, channel_offset); -+ break; -+ case CHANNEL_WIDTH_80: -+ SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_80M_SC(ch_sw_h2c_buf, channel_offset); -+ break; -+ case CHANNEL_WIDTH_20: -+ default: -+ break; -+ } -+ SET_H2CCMD_CH_SW_OPER_OFFLOAD_RFE_TYPE(ch_sw_h2c_buf, pHalData->RFEType); -+ -+ return rtw_hal_fill_h2c_cmd(padapter, H2C_CHNL_SWITCH_OPER_OFFLOAD, sizeof(ch_sw_h2c_buf), ch_sw_h2c_buf); -+} -+#endif -+#endif -+ -+void SetHwReg(_adapter *adapter, u8 variable, u8 *val) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ switch (variable) { -+ case HW_VAR_MEDIA_STATUS: { -+ u8 net_type = *((u8 *)val); -+ -+ rtw_hal_set_msr(adapter, net_type); -+ } -+ break; -+ case HW_VAR_MAC_ADDR: -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_hal_set_macaddr_mbid(adapter, val); -+#else -+ rtw_hal_set_macaddr_port(adapter, val); -+#endif -+ break; -+ case HW_VAR_BSSID: -+ rtw_hal_set_bssid(adapter, val); -+ break; -+#ifdef CONFIG_MBSSID_CAM -+ case HW_VAR_MBSSID_CAM_WRITE: { -+ u32 cmd = 0; -+ u32 *cam_val = (u32 *)val; -+ -+ rtw_write32(adapter, REG_MBIDCAMCFG_1, cam_val[0]); -+ cmd = BIT_MBIDCAM_POLL | BIT_MBIDCAM_WT_EN | BIT_MBIDCAM_VALID | cam_val[1]; -+ rtw_write32(adapter, REG_MBIDCAMCFG_2, cmd); -+ } -+ break; -+ case HW_VAR_MBSSID_CAM_CLEAR: { -+ u32 cmd; -+ u8 entry_id = *(u8 *)val; -+ -+ rtw_write32(adapter, REG_MBIDCAMCFG_1, 0); -+ -+ cmd = BIT_MBIDCAM_POLL | BIT_MBIDCAM_WT_EN | ((entry_id & MBIDCAM_ADDR_MASK) << MBIDCAM_ADDR_SHIFT); -+ rtw_write32(adapter, REG_MBIDCAMCFG_2, cmd); -+ } -+ break; -+ case HW_VAR_RCR_MBSSID_EN: -+ if (*((u8 *)val)) -+ rtw_write32(adapter, REG_RCR, rtw_read32(adapter, REG_RCR) | RCR_ENMBID); -+ else { -+ u32 val32; -+ -+ val32 = rtw_read32(adapter, REG_RCR); -+ val32 &= ~(RCR_ENMBID); -+ rtw_write32(adapter, REG_RCR, val32); -+ } -+ break; -+#endif -+ case HW_VAR_PORT_SWITCH: -+ hw_var_port_switch(adapter); -+ break; -+ case HW_VAR_INIT_RTS_RATE: { -+ u16 brate_cfg = *((u16 *)val); -+ u8 rate_index = 0; -+ HAL_VERSION *hal_ver = &hal_data->VersionID; -+ -+ if (IS_8188E(*hal_ver)) { -+ -+ while (brate_cfg > 0x1) { -+ brate_cfg = (brate_cfg >> 1); -+ rate_index++; -+ } -+ rtw_write8(adapter, REG_INIRTS_RATE_SEL, rate_index); -+ } else -+ rtw_warn_on(1); -+ } -+ break; -+ case HW_VAR_SEC_CFG: { -+ u16 reg_scr_ori; -+ u16 reg_scr; -+ -+ reg_scr = reg_scr_ori = rtw_read16(adapter, REG_SECCFG); -+ reg_scr |= (SCR_CHK_KEYID | SCR_RxDecEnable | SCR_TxEncEnable); -+ -+ if (_rtw_camctl_chk_cap(adapter, SEC_CAP_CHK_BMC)) -+ reg_scr |= SCR_CHK_BMC; -+ -+ if (_rtw_camctl_chk_flags(adapter, SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH)) -+ reg_scr |= SCR_NoSKMC; -+ -+ if (reg_scr != reg_scr_ori) -+ rtw_write16(adapter, REG_SECCFG, reg_scr); -+ } -+ break; -+ case HW_VAR_SEC_DK_CFG: { -+ struct security_priv *sec = &adapter->securitypriv; -+ u8 reg_scr = rtw_read8(adapter, REG_SECCFG); -+ -+ if (val) { /* Enable default key related setting */ -+ reg_scr |= SCR_TXBCUSEDK; -+ if (sec->dot11AuthAlgrthm != dot11AuthAlgrthm_8021X) -+ reg_scr |= (SCR_RxUseDK | SCR_TxUseDK); -+ } else /* Disable default key related setting */ -+ reg_scr &= ~(SCR_RXBCUSEDK | SCR_TXBCUSEDK | SCR_RxUseDK | SCR_TxUseDK); -+ -+ rtw_write8(adapter, REG_SECCFG, reg_scr); -+ } -+ break; -+ -+ case HW_VAR_ASIX_IOT: -+ /* enable ASIX IOT function */ -+ if (*((u8 *)val) == _TRUE) { -+ /* 0xa2e[0]=0 (disable rake receiver) */ -+ rtw_write8(adapter, rCCK0_FalseAlarmReport + 2, -+ rtw_read8(adapter, rCCK0_FalseAlarmReport + 2) & ~(BIT0)); -+ /* 0xa1c=0xa0 (reset channel estimation if signal quality is bad) */ -+ rtw_write8(adapter, rCCK0_DSPParameter2, 0xa0); -+ } else { -+ /* restore reg:0xa2e, reg:0xa1c */ -+ rtw_write8(adapter, rCCK0_FalseAlarmReport + 2, -+ rtw_read8(adapter, rCCK0_FalseAlarmReport + 2) | (BIT0)); -+ rtw_write8(adapter, rCCK0_DSPParameter2, 0x00); -+ } -+ break; -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ case HW_VAR_WOWLAN: { -+ struct wowlan_ioctl_param *poidparam; -+ -+ poidparam = (struct wowlan_ioctl_param *)val; -+ switch (poidparam->subcode) { -+#ifdef CONFIG_WOWLAN -+ case WOWLAN_PATTERN_CLEAN: -+ rtw_hal_dl_pattern(adapter, 2); -+ break; -+ case WOWLAN_ENABLE: -+ rtw_hal_wow_enable(adapter); -+ break; -+ case WOWLAN_DISABLE: -+ rtw_hal_wow_disable(adapter); -+ break; -+#endif /*CONFIG_WOWLAN*/ -+#ifdef CONFIG_AP_WOWLAN -+ case WOWLAN_AP_ENABLE: -+ rtw_hal_ap_wow_enable(adapter); -+ break; -+ case WOWLAN_AP_DISABLE: -+ rtw_hal_ap_wow_disable(adapter); -+ break; -+#endif /*CONFIG_AP_WOWLAN*/ -+ default: -+ break; -+ } -+ } -+ break; -+#endif /*defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN)*/ -+ -+ case HW_VAR_EN_HW_UPDATE_TSF: -+ rtw_hal_set_hw_update_tsf(adapter); -+ break; -+ -+ case HW_VAR_APFM_ON_MAC: -+ hal_data->bMacPwrCtrlOn = *val; -+ RTW_INFO("%s: bMacPwrCtrlOn=%d\n", __func__, hal_data->bMacPwrCtrlOn); -+ break; -+ default: -+ if (0) -+ RTW_PRINT(FUNC_ADPT_FMT" variable(%d) not defined!\n", -+ FUNC_ADPT_ARG(adapter), variable); -+ break; -+ } -+ -+} -+ -+void GetHwReg(_adapter *adapter, u8 variable, u8 *val) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ -+ switch (variable) { -+ case HW_VAR_BASIC_RATE: -+ *((u16 *)val) = hal_data->BasicRateSet; -+ break; -+ case HW_VAR_RF_TYPE: -+ *((u8 *)val) = hal_data->rf_type; -+ break; -+ case HW_VAR_MEDIA_STATUS: -+ rtw_hal_get_msr(adapter, val); -+ break; -+ case HW_VAR_DO_IQK: -+ *val = hal_data->bNeedIQK; -+ break; -+ case HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO: -+ if (hal_is_band_support(adapter, BAND_ON_5G)) -+ *val = _TRUE; -+ else -+ *val = _FALSE; -+ break; -+ case HW_VAR_APFM_ON_MAC: -+ *val = hal_data->bMacPwrCtrlOn; -+ break; -+ default: -+ if (0) -+ RTW_PRINT(FUNC_ADPT_FMT" variable(%d) not defined!\n", -+ FUNC_ADPT_ARG(adapter), variable); -+ break; -+ } -+ -+} -+ -+u8 -+SetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 bResult = _SUCCESS; -+ -+ switch (variable) { -+ -+ case HAL_DEF_DBG_DUMP_RXPKT: -+ hal_data->bDumpRxPkt = *((u8 *)value); -+ break; -+ case HAL_DEF_DBG_DUMP_TXPKT: -+ hal_data->bDumpTxPkt = *((u8 *)value); -+ break; -+ case HAL_DEF_ANT_DETECT: -+ hal_data->AntDetection = *((u8 *)value); -+ break; -+ case HAL_DEF_DBG_DIS_PWT: -+ hal_data->bDisableTXPowerTraining = *((u8 *)value); -+ break; -+ default: -+ RTW_PRINT("%s: [WARNING] HAL_DEF_VARIABLE(%d) not defined!\n", __FUNCTION__, variable); -+ bResult = _FAIL; -+ break; -+ } -+ -+ return bResult; -+} -+ -+#ifdef CONFIG_BEAMFORMING -+u8 rtw_hal_query_txbfer_rf_num(_adapter *adapter) -+{ -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ if ((pregistrypriv->beamformer_rf_num) && (IS_HARDWARE_TYPE_8814AE(adapter) || IS_HARDWARE_TYPE_8814AU(adapter) || IS_HARDWARE_TYPE_8822BU(adapter) || IS_HARDWARE_TYPE_8821C(adapter))) -+ return pregistrypriv->beamformer_rf_num; -+ else if (IS_HARDWARE_TYPE_8814AE(adapter) -+#if 0 -+#if defined(CONFIG_USB_HCI) -+ || (IS_HARDWARE_TYPE_8814AU(adapter) && (pUsbModeMech->CurUsbMode == 2 || pUsbModeMech->HubUsbMode == 2)) /* for USB3.0 */ -+#endif -+#endif -+ ) { -+ /*BF cap provided by Yu Chen, Sean, 2015, 01 */ -+ if (hal_data->rf_type == RF_3T3R) -+ return 2; -+ else if (hal_data->rf_type == RF_4T4R) -+ return 3; -+ else -+ return 1; -+ } else -+ return 1; -+ -+} -+u8 rtw_hal_query_txbfee_rf_num(_adapter *adapter) -+{ -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ if ((pregistrypriv->beamformee_rf_num) && (IS_HARDWARE_TYPE_8814AE(adapter) || IS_HARDWARE_TYPE_8814AU(adapter) || IS_HARDWARE_TYPE_8822BU(adapter) || IS_HARDWARE_TYPE_8821C(adapter))) -+ return pregistrypriv->beamformee_rf_num; -+ else if (IS_HARDWARE_TYPE_8814AE(adapter) || IS_HARDWARE_TYPE_8814AU(adapter)) { -+ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) -+ return 2; -+ else -+ return 2;/*TODO: May be 3 in the future, by ChenYu. */ -+ } else -+ return 1; -+ -+} -+#endif -+ -+u8 -+GetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 bResult = _SUCCESS; -+ -+ switch (variable) { -+ case HAL_DEF_UNDERCORATEDSMOOTHEDPWDB: { -+ struct mlme_priv *pmlmepriv; -+ struct sta_priv *pstapriv; -+ struct sta_info *psta; -+ -+ pmlmepriv = &adapter->mlmepriv; -+ pstapriv = &adapter->stapriv; -+ psta = rtw_get_stainfo(pstapriv, pmlmepriv->cur_network.network.MacAddress); -+ if (psta) -+ *((int *)value) = psta->rssi_stat.UndecoratedSmoothedPWDB; -+ } -+ break; -+ case HAL_DEF_DBG_DUMP_RXPKT: -+ *((u8 *)value) = hal_data->bDumpRxPkt; -+ break; -+ case HAL_DEF_DBG_DUMP_TXPKT: -+ *((u8 *)value) = hal_data->bDumpTxPkt; -+ break; -+ case HAL_DEF_ANT_DETECT: -+ *((u8 *)value) = hal_data->AntDetection; -+ break; -+ case HAL_DEF_MACID_SLEEP: -+ *(u8 *)value = _FALSE; -+ break; -+ case HAL_DEF_TX_PAGE_SIZE: -+ *((u32 *)value) = PAGE_SIZE_128; -+ break; -+ case HAL_DEF_DBG_DIS_PWT: -+ *(u8 *)value = hal_data->bDisableTXPowerTraining; -+ break; -+ case HAL_DEF_EXPLICIT_BEAMFORMER: -+ case HAL_DEF_EXPLICIT_BEAMFORMEE: -+ case HAL_DEF_VHT_MU_BEAMFORMER: -+ case HAL_DEF_VHT_MU_BEAMFORMEE: -+ *(u8 *)value = _FALSE; -+ break; -+#ifdef CONFIG_BEAMFORMING -+ case HAL_DEF_BEAMFORMER_CAP: -+ *(u8 *)value = rtw_hal_query_txbfer_rf_num(adapter); -+ break; -+ case HAL_DEF_BEAMFORMEE_CAP: -+ *(u8 *)value = rtw_hal_query_txbfee_rf_num(adapter); -+ break; -+#endif -+ default: -+ RTW_PRINT("%s: [WARNING] HAL_DEF_VARIABLE(%d) not defined!\n", __FUNCTION__, variable); -+ bResult = _FAIL; -+ break; -+ } -+ -+ return bResult; -+} -+ -+void SetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ PVOID pValue1, -+ BOOLEAN bSet) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ /* _irqL irqL; */ -+ switch (eVariable) { -+ case HAL_ODM_STA_INFO: { -+ struct sta_info *psta = (struct sta_info *)pValue1; -+ if (bSet) { -+ RTW_INFO("### Set STA_(%d) info ###\n", psta->mac_id); -+ ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS, psta->mac_id, psta); -+ } else { -+ RTW_INFO("### Clean STA_(%d) info ###\n", psta->mac_id); -+ /* _enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ -+ ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS, psta->mac_id, NULL); -+ -+ /* _exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ -+ } -+ } -+ break; -+ case HAL_ODM_P2P_STATE: -+ ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_WIFI_DIRECT, bSet); -+ break; -+ case HAL_ODM_WIFI_DISPLAY_STATE: -+ ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_WIFI_DISPLAY, bSet); -+ break; -+ case HAL_ODM_REGULATION: -+ ODM_CmnInfoInit(podmpriv, ODM_CMNINFO_DOMAIN_CODE_2G, pHalData->Regulation2_4G); -+ ODM_CmnInfoInit(podmpriv, ODM_CMNINFO_DOMAIN_CODE_5G, pHalData->Regulation5G); -+ break; -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ case HAL_ODM_NOISE_MONITOR: { -+ struct noise_info *pinfo = (struct noise_info *)pValue1; -+ -+#ifdef DBG_NOISE_MONITOR -+ RTW_INFO("### Noise monitor chan(%d)-bPauseDIG:%d,IGIValue:0x%02x,max_time:%d (ms) ###\n", -+ pinfo->chan, pinfo->bPauseDIG, pinfo->IGIValue, pinfo->max_time); -+#endif -+ -+ pHalData->noise[pinfo->chan] = ODM_InbandNoise_Monitor(podmpriv, pinfo->bPauseDIG, pinfo->IGIValue, pinfo->max_time); -+ RTW_INFO("chan_%d, noise = %d (dBm)\n", pinfo->chan, pHalData->noise[pinfo->chan]); -+#ifdef DBG_NOISE_MONITOR -+ RTW_INFO("noise_a = %d, noise_b = %d noise_all:%d\n", -+ podmpriv->noise_level.noise[ODM_RF_PATH_A], -+ podmpriv->noise_level.noise[ODM_RF_PATH_B], -+ podmpriv->noise_level.noise_all); -+#endif -+ } -+ break; -+#endif/*#ifdef CONFIG_BACKGROUND_NOISE_MONITOR*/ -+ -+ case HAL_ODM_INITIAL_GAIN: { -+ u8 rx_gain = *((u8 *)(pValue1)); -+ /*printk("rx_gain:%x\n",rx_gain);*/ -+ if (rx_gain == 0xff) {/*restore rx gain*/ -+ /*ODM_Write_DIG(podmpriv,pDigTable->BackupIGValue);*/ -+ odm_PauseDIG(podmpriv, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_0, rx_gain); -+ } else { -+ /*pDigTable->BackupIGValue = pDigTable->CurIGValue;*/ -+ /*ODM_Write_DIG(podmpriv,rx_gain);*/ -+ odm_PauseDIG(podmpriv, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_0, rx_gain); -+ } -+ } -+ break; -+ case HAL_ODM_FA_CNT_DUMP: -+ if (*((u8 *)pValue1)) -+ podmpriv->DebugComponents |= (ODM_COMP_DIG | ODM_COMP_FA_CNT); -+ else -+ podmpriv->DebugComponents &= ~(ODM_COMP_DIG | ODM_COMP_FA_CNT); -+ break; -+ case HAL_ODM_DBG_FLAG: -+ ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_DBG_COMP, *((u8Byte *)pValue1)); -+ break; -+ case HAL_ODM_DBG_LEVEL: -+ ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_DBG_LEVEL, *((u4Byte *)pValue1)); -+ break; -+ case HAL_ODM_RX_INFO_DUMP: { -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure(podmpriv , PHYDM_FALSEALMCNT); -+ pDIG_T pDM_DigTable = &podmpriv->DM_DigTable; -+ void *sel; -+ -+ sel = pValue1; -+ -+ _RTW_PRINT_SEL(sel , "============ Rx Info dump ===================\n"); -+ _RTW_PRINT_SEL(sel , "bLinked = %d, RSSI_Min = %d(%%), CurrentIGI = 0x%x\n", podmpriv->bLinked, podmpriv->RSSI_Min, pDM_DigTable->CurIGValue); -+ _RTW_PRINT_SEL(sel , "Cnt_Cck_fail = %d, Cnt_Ofdm_fail = %d, Total False Alarm = %d\n", FalseAlmCnt->Cnt_Cck_fail, FalseAlmCnt->Cnt_Ofdm_fail, FalseAlmCnt->Cnt_all); -+ -+ if (podmpriv->bLinked) { -+ _RTW_PRINT_SEL(sel , "RxRate = %s", HDATA_RATE(podmpriv->RxRate)); -+ _RTW_PRINT_SEL(sel , " RSSI_A = %d(%%), RSSI_B = %d(%%)\n", podmpriv->RSSI_A, podmpriv->RSSI_B); -+#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ rtw_dump_raw_rssi_info(Adapter, sel); -+#endif -+ } -+ } -+ break; -+ case HAL_ODM_RX_Dframe_INFO: { -+ void *sel; -+ -+ sel = pValue1; -+ -+ /*_RTW_PRINT_SEL(sel , "HAL_ODM_RX_Dframe_INFO\n");*/ -+#ifdef DBG_RX_DFRAME_RAW_DATA -+ rtw_dump_rx_dframe_info(Adapter, sel); -+#endif -+ } -+ break; -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ case HAL_ODM_AUTO_CHNL_SEL: { -+ ACS_OP acs_op = *(ACS_OP *)pValue1; -+ -+ rtw_phydm_func_set(Adapter, ODM_BB_NHM_CNT); -+ -+ if (ACS_INIT == acs_op) { -+#ifdef DBG_AUTO_CHNL_SEL_NHM -+ RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: ACS_INIT\n", ADPT_ARG(Adapter)); -+#endif -+ odm_AutoChannelSelectInit(podmpriv); -+ } else if (ACS_RESET == acs_op) { -+ /* Reset statistics for auto channel selection mechanism.*/ -+#ifdef DBG_AUTO_CHNL_SEL_NHM -+ RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: ACS_RESET\n", ADPT_ARG(Adapter)); -+#endif -+ odm_AutoChannelSelectReset(podmpriv); -+ -+ } else if (ACS_SELECT == acs_op) { -+ /* Collect NHM measurement result after current channel */ -+#ifdef DBG_AUTO_CHNL_SEL_NHM -+ RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: ACS_SELECT, CH(%d)\n", ADPT_ARG(Adapter), rtw_get_acs_channel(Adapter)); -+#endif -+ odm_AutoChannelSelect(podmpriv, rtw_get_acs_channel(Adapter)); -+ } else -+ RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: Unexpected OP\n", ADPT_ARG(Adapter)); -+ -+ } -+ break; -+#endif -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ case HAL_ODM_ANTDIV_SELECT: { -+ u8 antenna = (*(u8 *)pValue1); -+ -+ /*switch antenna*/ -+ ODM_UpdateRxIdleAnt(&pHalData->odmpriv, antenna); -+ /*RTW_INFO("==> HAL_ODM_ANTDIV_SELECT, Ant_(%s)\n", (antenna == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT");*/ -+ -+ } -+ break; -+#endif -+ -+ default: -+ break; -+ } -+} -+ -+void GetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ PVOID pValue1, -+ PVOID pValue2) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ -+ switch (eVariable) { -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ case HAL_ODM_NOISE_MONITOR: { -+ u8 chan = *(u8 *)pValue1; -+ *(s16 *)pValue2 = pHalData->noise[chan]; -+#ifdef DBG_NOISE_MONITOR -+ RTW_INFO("### Noise monitor chan(%d)-noise:%d (dBm) ###\n", -+ chan, pHalData->noise[chan]); -+#endif -+ } -+ break; -+#endif/*#ifdef CONFIG_BACKGROUND_NOISE_MONITOR*/ -+ case HAL_ODM_DBG_FLAG: -+ *((u8Byte *)pValue1) = podmpriv->DebugComponents; -+ break; -+ case HAL_ODM_DBG_LEVEL: -+ *((u4Byte *)pValue1) = podmpriv->DebugLevel; -+ break; -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ case HAL_ODM_AUTO_CHNL_SEL: { -+#ifdef DBG_AUTO_CHNL_SEL_NHM -+ RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: GET_BEST_CHAN\n", ADPT_ARG(Adapter)); -+#endif -+ /* Retrieve better channel from NHM mechanism */ -+ if (IsSupported24G(Adapter->registrypriv.wireless_mode)) -+ *((u8 *)(pValue1)) = ODM_GetAutoChannelSelectResult(podmpriv, BAND_ON_2_4G); -+ if (IsSupported5G(Adapter->registrypriv.wireless_mode)) -+ *((u8 *)(pValue2)) = ODM_GetAutoChannelSelectResult(podmpriv, BAND_ON_5G); -+ } -+ break; -+#endif -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ case HAL_ODM_ANTDIV_SELECT: { -+ pFAT_T pDM_FatTable = &podmpriv->DM_FatTable; -+ *((u8 *)pValue1) = pDM_FatTable->RxIdleAnt; -+ } -+ break; -+#endif -+ case HAL_ODM_INITIAL_GAIN: { -+ pDIG_T pDM_DigTable = &podmpriv->DM_DigTable; -+ *((u8 *)pValue1) = pDM_DigTable->CurIGValue; -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+ -+u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ u32 result = 0; -+ -+ switch (ops) { -+ case HAL_PHYDM_DIS_ALL_FUNC: -+ podmpriv->SupportAbility = DYNAMIC_FUNC_DISABLE; -+ break; -+ case HAL_PHYDM_FUNC_SET: -+ podmpriv->SupportAbility |= ability; -+ break; -+ case HAL_PHYDM_FUNC_CLR: -+ podmpriv->SupportAbility &= ~(ability); -+ break; -+ case HAL_PHYDM_ABILITY_BK: -+ /* dm flag backup*/ -+ podmpriv->BK_SupportAbility = podmpriv->SupportAbility; -+ break; -+ case HAL_PHYDM_ABILITY_RESTORE: -+ /* restore dm flag */ -+ podmpriv->SupportAbility = podmpriv->BK_SupportAbility; -+ break; -+ case HAL_PHYDM_ABILITY_SET: -+ podmpriv->SupportAbility = ability; -+ break; -+ case HAL_PHYDM_ABILITY_GET: -+ result = podmpriv->SupportAbility; -+ break; -+ } -+ return result; -+} -+ -+ -+BOOLEAN -+eqNByte( -+ u8 *str1, -+ u8 *str2, -+ u32 num -+) -+{ -+ if (num == 0) -+ return _FALSE; -+ while (num > 0) { -+ num--; -+ if (str1[num] != str2[num]) -+ return _FALSE; -+ } -+ return _TRUE; -+} -+ -+/* -+ * Description: -+ * Translate a character to hex digit. -+ * */ -+u32 -+MapCharToHexDigit( -+ IN char chTmp -+) -+{ -+ if (chTmp >= '0' && chTmp <= '9') -+ return chTmp - '0'; -+ else if (chTmp >= 'a' && chTmp <= 'f') -+ return 10 + (chTmp - 'a'); -+ else if (chTmp >= 'A' && chTmp <= 'F') -+ return 10 + (chTmp - 'A'); -+ else -+ return 0; -+} -+ -+ -+ -+/* -+ * Description: -+ * Parse hex number from the string pucStr. -+ * */ -+BOOLEAN -+GetHexValueFromString( -+ IN char *szStr, -+ IN OUT u32 *pu4bVal, -+ IN OUT u32 *pu4bMove -+) -+{ -+ char *szScan = szStr; -+ -+ /* Check input parameter. */ -+ if (szStr == NULL || pu4bVal == NULL || pu4bMove == NULL) { -+ RTW_INFO("GetHexValueFromString(): Invalid inpur argumetns! szStr: %p, pu4bVal: %p, pu4bMove: %p\n", szStr, pu4bVal, pu4bMove); -+ return _FALSE; -+ } -+ -+ /* Initialize output. */ -+ *pu4bMove = 0; -+ *pu4bVal = 0; -+ -+ /* Skip leading space. */ -+ while (*szScan != '\0' && -+ (*szScan == ' ' || *szScan == '\t')) { -+ szScan++; -+ (*pu4bMove)++; -+ } -+ -+ /* Skip leading '0x' or '0X'. */ -+ if (*szScan == '0' && (*(szScan + 1) == 'x' || *(szScan + 1) == 'X')) { -+ szScan += 2; -+ (*pu4bMove) += 2; -+ } -+ -+ /* Check if szScan is now pointer to a character for hex digit, */ -+ /* if not, it means this is not a valid hex number. */ -+ if (!IsHexDigit(*szScan)) -+ return _FALSE; -+ -+ /* Parse each digit. */ -+ do { -+ (*pu4bVal) <<= 4; -+ *pu4bVal += MapCharToHexDigit(*szScan); -+ -+ szScan++; -+ (*pu4bMove)++; -+ } while (IsHexDigit(*szScan)); -+ -+ return _TRUE; -+} -+ -+BOOLEAN -+GetFractionValueFromString( -+ IN char *szStr, -+ IN OUT u8 *pInteger, -+ IN OUT u8 *pFraction, -+ IN OUT u32 *pu4bMove -+) -+{ -+ char *szScan = szStr; -+ -+ /* Initialize output. */ -+ *pu4bMove = 0; -+ *pInteger = 0; -+ *pFraction = 0; -+ -+ /* Skip leading space. */ -+ while (*szScan != '\0' && (*szScan == ' ' || *szScan == '\t')) { -+ ++szScan; -+ ++(*pu4bMove); -+ } -+ -+ /* Parse each digit. */ -+ do { -+ (*pInteger) *= 10; -+ *pInteger += (*szScan - '0'); -+ -+ ++szScan; -+ ++(*pu4bMove); -+ -+ if (*szScan == '.') { -+ ++szScan; -+ ++(*pu4bMove); -+ -+ if (*szScan < '0' || *szScan > '9') -+ return _FALSE; -+ else { -+ *pFraction = *szScan - '0'; -+ ++szScan; -+ ++(*pu4bMove); -+ return _TRUE; -+ } -+ } -+ } while (*szScan >= '0' && *szScan <= '9'); -+ -+ return _TRUE; -+} -+ -+/* -+ * Description: -+ * Return TRUE if szStr is comment out with leading " */ /* ". -+ * */ -+BOOLEAN -+IsCommentString( -+ IN char *szStr -+) -+{ -+ if (*szStr == '/' && *(szStr + 1) == '/') -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+BOOLEAN -+GetU1ByteIntegerFromStringInDecimal( -+ IN char *Str, -+ IN OUT u8 *pInt -+) -+{ -+ u16 i = 0; -+ *pInt = 0; -+ -+ while (Str[i] != '\0') { -+ if (Str[i] >= '0' && Str[i] <= '9') { -+ *pInt *= 10; -+ *pInt += (Str[i] - '0'); -+ } else -+ return _FALSE; -+ ++i; -+ } -+ -+ return _TRUE; -+} -+ -+/* <20121004, Kordan> For example, -+ * ParseQualifiedString(inString, 0, outString, '[', ']') gets "Kordan" from a string "Hello [Kordan]". -+ * If RightQualifier does not exist, it will hang on in the while loop */ -+BOOLEAN -+ParseQualifiedString( -+ IN char *In, -+ IN OUT u32 *Start, -+ OUT char *Out, -+ IN char LeftQualifier, -+ IN char RightQualifier -+) -+{ -+ u32 i = 0, j = 0; -+ char c = In[(*Start)++]; -+ -+ if (c != LeftQualifier) -+ return _FALSE; -+ -+ i = (*Start); -+ while ((c = In[(*Start)++]) != RightQualifier) -+ ; /* find ']' */ -+ j = (*Start) - 2; -+ strncpy((char *)Out, (const char *)(In + i), j - i + 1); -+ -+ return _TRUE; -+} -+ -+BOOLEAN -+isAllSpaceOrTab( -+ u8 *data, -+ u8 size -+) -+{ -+ u8 cnt = 0, NumOfSpaceAndTab = 0; -+ -+ while (size > cnt) { -+ if (data[cnt] == ' ' || data[cnt] == '\t' || data[cnt] == '\0') -+ ++NumOfSpaceAndTab; -+ -+ ++cnt; -+ } -+ -+ return size == NumOfSpaceAndTab; -+} -+ -+ -+void rtw_hal_check_rxfifo_full(_adapter *adapter) -+{ -+ struct dvobj_priv *psdpriv = adapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); -+ struct registry_priv *regsty = &adapter->registrypriv; -+ int save_cnt = _FALSE; -+ -+ if (regsty->check_hw_status == 1) { -+ /* switch counter to RX fifo */ -+ if (IS_8188E(pHalData->VersionID) || -+ IS_8188F(pHalData->VersionID) || -+ IS_8812_SERIES(pHalData->VersionID) || -+ IS_8821_SERIES(pHalData->VersionID) || -+ IS_8723B_SERIES(pHalData->VersionID) || -+ IS_8192E(pHalData->VersionID) || -+ IS_8703B_SERIES(pHalData->VersionID) || -+ IS_8723D_SERIES(pHalData->VersionID)) { -+ rtw_write8(adapter, REG_RXERR_RPT + 3, rtw_read8(adapter, REG_RXERR_RPT + 3) | 0xa0); -+ save_cnt = _TRUE; -+ } else { -+ /* todo: other chips */ -+ } -+ -+ -+ if (save_cnt) { -+ pdbgpriv->dbg_rx_fifo_last_overflow = pdbgpriv->dbg_rx_fifo_curr_overflow; -+ pdbgpriv->dbg_rx_fifo_curr_overflow = rtw_read16(adapter, REG_RXERR_RPT); -+ pdbgpriv->dbg_rx_fifo_diff_overflow = pdbgpriv->dbg_rx_fifo_curr_overflow - pdbgpriv->dbg_rx_fifo_last_overflow; -+ } else { -+ /* special value to indicate no implementation */ -+ pdbgpriv->dbg_rx_fifo_last_overflow = 1; -+ pdbgpriv->dbg_rx_fifo_curr_overflow = 1; -+ pdbgpriv->dbg_rx_fifo_diff_overflow = 1; -+ } -+ } -+} -+ -+void linked_info_dump(_adapter *padapter, u8 benable) -+{ -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (padapter->bLinkInfoDump == benable) -+ return; -+ -+ RTW_INFO("%s %s\n", __FUNCTION__, (benable) ? "enable" : "disable"); -+ -+ if (benable) { -+#ifdef CONFIG_LPS -+ pwrctrlpriv->org_power_mgnt = pwrctrlpriv->power_mgnt;/* keep org value */ -+ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); -+#endif -+ -+#ifdef CONFIG_IPS -+ pwrctrlpriv->ips_org_mode = pwrctrlpriv->ips_mode;/* keep org value */ -+ rtw_pm_set_ips(padapter, IPS_NONE); -+#endif -+ } else { -+#ifdef CONFIG_IPS -+ rtw_pm_set_ips(padapter, pwrctrlpriv->ips_org_mode); -+#endif /* CONFIG_IPS */ -+ -+#ifdef CONFIG_LPS -+ rtw_pm_set_lps(padapter, pwrctrlpriv->org_power_mgnt); -+#endif /* CONFIG_LPS */ -+ } -+ padapter->bLinkInfoDump = benable ; -+} -+ -+#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+void rtw_get_raw_rssi_info(void *sel, _adapter *padapter) -+{ -+ u8 isCCKrate, rf_path; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; -+ RTW_PRINT_SEL(sel, "RxRate = %s, PWDBALL = %d(%%), rx_pwr_all = %d(dBm)\n", -+ HDATA_RATE(psample_pkt_rssi->data_rate), psample_pkt_rssi->pwdball, psample_pkt_rssi->pwr_all); -+ isCCKrate = (psample_pkt_rssi->data_rate <= DESC_RATE11M) ? TRUE : FALSE; -+ -+ if (isCCKrate) -+ psample_pkt_rssi->mimo_signal_strength[0] = psample_pkt_rssi->pwdball; -+ -+ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { -+ RTW_PRINT_SEL(sel, "RF_PATH_%d=>signal_strength:%d(%%),signal_quality:%d(%%)\n" -+ , rf_path, psample_pkt_rssi->mimo_signal_strength[rf_path], psample_pkt_rssi->mimo_signal_quality[rf_path]); -+ -+ if (!isCCKrate) { -+ RTW_PRINT_SEL(sel, "\trx_ofdm_pwr:%d(dBm),rx_ofdm_snr:%d(dB)\n", -+ psample_pkt_rssi->ofdm_pwr[rf_path], psample_pkt_rssi->ofdm_snr[rf_path]); -+ } -+ } -+} -+ -+void rtw_dump_raw_rssi_info(_adapter *padapter, void *sel) -+{ -+ u8 isCCKrate, rf_path; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; -+ _RTW_PRINT_SEL(sel, "============ RAW Rx Info dump ===================\n"); -+ _RTW_PRINT_SEL(sel, "RxRate = %s, PWDBALL = %d(%%), rx_pwr_all = %d(dBm)\n", HDATA_RATE(psample_pkt_rssi->data_rate), psample_pkt_rssi->pwdball, psample_pkt_rssi->pwr_all); -+ -+ isCCKrate = (psample_pkt_rssi->data_rate <= DESC_RATE11M) ? TRUE : FALSE; -+ -+ if (isCCKrate) -+ psample_pkt_rssi->mimo_signal_strength[0] = psample_pkt_rssi->pwdball; -+ -+ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { -+ _RTW_PRINT_SEL(sel , "RF_PATH_%d=>signal_strength:%d(%%),signal_quality:%d(%%)" -+ , rf_path, psample_pkt_rssi->mimo_signal_strength[rf_path], psample_pkt_rssi->mimo_signal_quality[rf_path]); -+ -+ if (!isCCKrate) -+ _RTW_PRINT_SEL(sel , ",rx_ofdm_pwr:%d(dBm),rx_ofdm_snr:%d(dB)\n", psample_pkt_rssi->ofdm_pwr[rf_path], psample_pkt_rssi->ofdm_snr[rf_path]); -+ else -+ _RTW_PRINT_SEL(sel , "\n"); -+ -+ } -+} -+#endif -+ -+#ifdef DBG_RX_DFRAME_RAW_DATA -+void rtw_dump_rx_dframe_info(_adapter *padapter, void *sel) -+{ -+ _irqL irqL; -+ u8 isCCKrate, rf_path; -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ struct sta_recv_dframe_info *psta_dframe_info; -+ int i; -+ _list *plist, *phead; -+ char *BW; -+ u8 bc_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 null_addr[6] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ -+ if (precvpriv->store_law_data_flag) { -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for (i = 0; i < NUM_STA; i++) { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ plist = get_next(plist); -+ -+ if (psta) { -+ psta_dframe_info = &psta->sta_dframe_info; -+ if ((_rtw_memcmp(psta->hwaddr, bc_addr, 6) != _TRUE) -+ && (_rtw_memcmp(psta->hwaddr, null_addr, 6) != _TRUE) -+ && (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), 6) != _TRUE)) { -+ -+ -+ isCCKrate = (psta_dframe_info->sta_data_rate <= DESC_RATE11M) ? TRUE : FALSE; -+ -+ switch (psta_dframe_info->sta_bw_mode) { -+ -+ case CHANNEL_WIDTH_20: -+ BW = "20M"; -+ break; -+ -+ case CHANNEL_WIDTH_40: -+ BW = "40M"; -+ break; -+ -+ case CHANNEL_WIDTH_80: -+ BW = "80M"; -+ break; -+ -+ case CHANNEL_WIDTH_160: -+ BW = "160M"; -+ break; -+ -+ default: -+ BW = ""; -+ break; -+ } -+ -+ RTW_PRINT_SEL(sel, "==============================\n"); -+ _RTW_PRINT_SEL(sel, "macaddr =" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ _RTW_PRINT_SEL(sel, "BW=%s, sgi =%d\n", BW, psta_dframe_info->sta_sgi); -+ _RTW_PRINT_SEL(sel, "Rx_Data_Rate = %s\n", HDATA_RATE(psta_dframe_info->sta_data_rate)); -+ -+ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { -+ -+ if (!isCCKrate) { -+ -+ _RTW_PRINT_SEL(sel , "RF_PATH_%d RSSI:%d(dBm)", rf_path, psta_dframe_info->sta_RxPwr[rf_path]); -+ _RTW_PRINT_SEL(sel , ",rx_ofdm_snr:%d(dB)\n", psta_dframe_info->sta_ofdm_snr[rf_path]); -+ -+ } else -+ -+ _RTW_PRINT_SEL(sel , "RF_PATH_%d RSSI:%d(dBm)\n", rf_path, (psta_dframe_info->sta_mimo_signal_strength[rf_path]) - 100); -+ } -+ } -+ } -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ } -+} -+#endif -+void rtw_store_phy_info(_adapter *padapter, union recv_frame *prframe) -+{ -+ u8 isCCKrate, rf_path , dframe_type; -+ u8 *ptr; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+#ifdef DBG_RX_DFRAME_RAW_DATA -+ struct sta_recv_dframe_info *psta_dframe_info; -+#endif -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ struct sta_info *psta = prframe->u.hdr.psta; -+ PODM_PHY_INFO_T pPhyInfo = (PODM_PHY_INFO_T)(&pattrib->phy_info); -+ struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; -+ psample_pkt_rssi->data_rate = pattrib->data_rate; -+ ptr = prframe->u.hdr.rx_data; -+ dframe_type = GetFrameType(ptr); -+ /*RTW_INFO("=>%s\n", __FUNCTION__);*/ -+ -+ -+ if (precvpriv->store_law_data_flag) { -+ isCCKrate = (pattrib->data_rate <= DESC_RATE11M) ? TRUE : FALSE; -+ -+ psample_pkt_rssi->pwdball = pPhyInfo->RxPWDBAll; -+ psample_pkt_rssi->pwr_all = pPhyInfo->RecvSignalPower; -+ -+ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { -+ psample_pkt_rssi->mimo_signal_strength[rf_path] = pPhyInfo->RxMIMOSignalStrength[rf_path]; -+ psample_pkt_rssi->mimo_signal_quality[rf_path] = pPhyInfo->RxMIMOSignalQuality[rf_path]; -+ if (!isCCKrate) { -+ psample_pkt_rssi->ofdm_pwr[rf_path] = pPhyInfo->RxPwr[rf_path]; -+ psample_pkt_rssi->ofdm_snr[rf_path] = pPhyInfo->RxSNR[rf_path]; -+ } -+ } -+#ifdef DBG_RX_DFRAME_RAW_DATA -+ if ((dframe_type == WIFI_DATA_TYPE) || (dframe_type == WIFI_QOS_DATA_TYPE) || (padapter->registrypriv.mp_mode == 1)) { -+ -+ /*RTW_INFO("=>%s WIFI_DATA_TYPE or WIFI_QOS_DATA_TYPE\n", __FUNCTION__);*/ -+ if (psta) { -+ psta_dframe_info = &psta->sta_dframe_info; -+ /*RTW_INFO("=>%s psta->hwaddr="MAC_FMT" !\n", __FUNCTION__, MAC_ARG(psta->hwaddr));*/ -+ if ((_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN) != _TRUE) || (padapter->registrypriv.mp_mode == 1)) { -+ psta_dframe_info->sta_data_rate = pattrib->data_rate; -+ psta_dframe_info->sta_sgi = pattrib->sgi; -+ psta_dframe_info->sta_bw_mode = pattrib->bw; -+ for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { -+ -+ psta_dframe_info->sta_mimo_signal_strength[rf_path] = (pPhyInfo->RxMIMOSignalStrength[rf_path]);/*Percentage to dbm*/ -+ -+ if (!isCCKrate) { -+ psta_dframe_info->sta_ofdm_snr[rf_path] = pPhyInfo->RxSNR[rf_path]; -+ psta_dframe_info->sta_RxPwr[rf_path] = pPhyInfo->RxPwr[rf_path]; -+ } -+ } -+ } -+ } -+ } -+#endif -+ } -+ -+} -+ -+ -+int check_phy_efuse_tx_power_info_valid(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ u8 *pContent = pHalData->efuse_eeprom_data; -+ int index = 0; -+ u16 tx_index_offset = 0x0000; -+ -+ switch (rtw_get_chip_type(padapter)) { -+ case RTL8723B: -+ tx_index_offset = EEPROM_TX_PWR_INX_8723B; -+ break; -+ case RTL8703B: -+ tx_index_offset = EEPROM_TX_PWR_INX_8703B; -+ break; -+ case RTL8723D: -+ tx_index_offset = EEPROM_TX_PWR_INX_8723D; -+ break; -+ case RTL8188E: -+ tx_index_offset = EEPROM_TX_PWR_INX_88E; -+ break; -+ case RTL8188F: -+ tx_index_offset = EEPROM_TX_PWR_INX_8188F; -+ break; -+ case RTL8192E: -+ tx_index_offset = EEPROM_TX_PWR_INX_8192E; -+ break; -+ case RTL8821: -+ tx_index_offset = EEPROM_TX_PWR_INX_8821; -+ break; -+ case RTL8812: -+ tx_index_offset = EEPROM_TX_PWR_INX_8812; -+ break; -+ case RTL8814A: -+ tx_index_offset = EEPROM_TX_PWR_INX_8814; -+ break; -+ case RTL8822B: -+ tx_index_offset = EEPROM_TX_PWR_INX_8822B; -+ break; -+ case RTL8821C: -+ tx_index_offset = EEPROM_TX_PWR_INX_8821C; -+ break; -+ default: -+ tx_index_offset = 0x0010; -+ break; -+ } -+ -+ /* TODO: chacking length by ICs */ -+ for (index = 0 ; index < 11 ; index++) { -+ if (pContent[tx_index_offset + index] == 0xFF) -+ return _FALSE; -+ } -+ return _TRUE; -+} -+ -+int hal_efuse_macaddr_offset(_adapter *adapter) -+{ -+ u8 interface_type = 0; -+ int addr_offset = -1; -+ -+ interface_type = rtw_get_intf_type(adapter); -+ -+ switch (rtw_get_chip_type(adapter)) { -+#ifdef CONFIG_RTL8723B -+ case RTL8723B: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8723BU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8723BS; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8723BE; -+ break; -+#endif -+#ifdef CONFIG_RTL8703B -+ case RTL8703B: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8703BU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8703BS; -+ break; -+#endif -+#ifdef CONFIG_RTL8723D -+ case RTL8723D: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8723DU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8723DS; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8723DE; -+ break; -+#endif -+ -+#ifdef CONFIG_RTL8188E -+ case RTL8188E: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_88EU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_88ES; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_88EE; -+ break; -+#endif -+#ifdef CONFIG_RTL8188F -+ case RTL8188F: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8188FU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8188FS; -+ break; -+#endif -+#ifdef CONFIG_RTL8812A -+ case RTL8812: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8812AU; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8812AE; -+ break; -+#endif -+#ifdef CONFIG_RTL8821A -+ case RTL8821: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8821AU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8821AS; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8821AE; -+ break; -+#endif -+#ifdef CONFIG_RTL8192E -+ case RTL8192E: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8192EU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8192ES; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8192EE; -+ break; -+#endif -+#ifdef CONFIG_RTL8814A -+ case RTL8814A: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8814AU; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8814AE; -+ break; -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ case RTL8822B: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8822BU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8822BS; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8822BE; -+ break; -+#endif /* CONFIG_RTL8822B */ -+ -+#ifdef CONFIG_RTL8821C -+ case RTL8821C: -+ if (interface_type == RTW_USB) -+ addr_offset = EEPROM_MAC_ADDR_8821CU; -+ else if (interface_type == RTW_SDIO) -+ addr_offset = EEPROM_MAC_ADDR_8821CS; -+ else if (interface_type == RTW_PCIE) -+ addr_offset = EEPROM_MAC_ADDR_8821CE; -+ break; -+#endif /* CONFIG_RTL8821C */ -+ } -+ -+ if (addr_offset == -1) { -+ RTW_ERR("%s: unknown combination - chip_type:%u, interface:%u\n" -+ , __func__, rtw_get_chip_type(adapter), rtw_get_intf_type(adapter)); -+ } -+ -+ return addr_offset; -+} -+ -+int Hal_GetPhyEfuseMACAddr(PADAPTER padapter, u8 *mac_addr) -+{ -+ int ret = _FAIL; -+ int addr_offset; -+ -+ addr_offset = hal_efuse_macaddr_offset(padapter); -+ if (addr_offset == -1) -+ goto exit; -+ -+ ret = rtw_efuse_map_read(padapter, addr_offset, ETH_ALEN, mac_addr); -+ -+exit: -+ return ret; -+} -+ -+void rtw_dump_cur_efuse(PADAPTER padapter) -+{ -+ int i =0; -+ int mapsize =0; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&mapsize, _FALSE); -+ -+ if (mapsize <= 0 || mapsize > EEPROM_MAX_SIZE) { -+ RTW_ERR("wrong map size %d\n", mapsize); -+ return; -+ } -+ -+ if (hal_data->efuse_file_status == EFUSE_FILE_LOADED) -+ RTW_INFO("EFUSE FILE\n"); -+ else -+ RTW_INFO("HW EFUSE\n"); -+ -+#ifdef CONFIG_RTW_DEBUG -+ for (i = 0; i < mapsize; i++) { -+ if (i % 16 == 0) -+ RTW_PRINT_SEL(RTW_DBGDUMP, "0x%03x: ", i); -+ -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "%02X%s" -+ , hal_data->efuse_eeprom_data[i] -+ , ((i + 1) % 16 == 0) ? "\n" : (((i + 1) % 8 == 0) ? " " : " ") -+ ); -+ } -+ _RTW_PRINT_SEL(RTW_DBGDUMP, "\n"); -+#endif -+} -+ -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+u32 Hal_readPGDataFromConfigFile(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ u32 ret = _FALSE; -+ u32 maplen = 0; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&maplen, _FALSE); -+ -+ if (maplen < 256 || maplen > EEPROM_MAX_SIZE) { -+ RTW_ERR("eFuse length error :%d\n", maplen); -+ return _FALSE; -+ } -+ -+ ret = rtw_read_efuse_from_file(EFUSE_MAP_PATH, hal_data->efuse_eeprom_data, maplen); -+ -+ hal_data->efuse_file_status = ((ret == _FAIL) ? EFUSE_FILE_FAILED : EFUSE_FILE_LOADED); -+ -+ if (hal_data->efuse_file_status == EFUSE_FILE_LOADED) -+ rtw_dump_cur_efuse(padapter); -+ -+ return ret; -+} -+ -+u32 Hal_ReadMACAddrFromFile(PADAPTER padapter, u8 *mac_addr) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ u32 ret = _FAIL; -+ -+ if (rtw_read_macaddr_from_file(WIFIMAC_PATH, mac_addr) == _SUCCESS -+ && rtw_check_invalid_mac_address(mac_addr, _TRUE) == _FALSE -+ ) { -+ hal_data->macaddr_file_status = MACADDR_FILE_LOADED; -+ ret = _SUCCESS; -+ } else -+ hal_data->macaddr_file_status = MACADDR_FILE_FAILED; -+ -+ return ret; -+} -+#endif /* CONFIG_EFUSE_CONFIG_FILE */ -+ -+int hal_config_macaddr(_adapter *adapter, bool autoload_fail) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 addr[ETH_ALEN]; -+ int addr_offset = hal_efuse_macaddr_offset(adapter); -+ u8 *hw_addr = NULL; -+ int ret = _SUCCESS; -+ -+ if (autoload_fail) -+ goto bypass_hw_pg; -+ -+ if (addr_offset != -1) -+ hw_addr = &hal_data->efuse_eeprom_data[addr_offset]; -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ /* if the hw_addr is written by efuse file, set to NULL */ -+ if (hal_data->efuse_file_status == EFUSE_FILE_LOADED) -+ hw_addr = NULL; -+#endif -+ -+ if (!hw_addr) { -+ /* try getting hw pg data */ -+ if (Hal_GetPhyEfuseMACAddr(adapter, addr) == _SUCCESS) -+ hw_addr = addr; -+ } -+ -+ /* check hw pg data */ -+ if (hw_addr && rtw_check_invalid_mac_address(hw_addr, _TRUE) == _FALSE) { -+ _rtw_memcpy(hal_data->EEPROMMACAddr, hw_addr, ETH_ALEN); -+ goto exit; -+ } -+ -+bypass_hw_pg: -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ /* check wifi mac file */ -+ if (Hal_ReadMACAddrFromFile(adapter, addr) == _SUCCESS) { -+ _rtw_memcpy(hal_data->EEPROMMACAddr, addr, ETH_ALEN); -+ goto exit; -+ } -+#endif -+ -+ _rtw_memset(hal_data->EEPROMMACAddr, 0, ETH_ALEN); -+ ret = _FAIL; -+ -+exit: -+ return ret; -+} -+ -+#ifdef CONFIG_RF_POWER_TRIM -+u32 Array_kfreemap[] = { -+ 0x08, 0xe, -+ 0x06, 0xc, -+ 0x04, 0xa, -+ 0x02, 0x8, -+ 0x00, 0x6, -+ 0x03, 0x4, -+ 0x05, 0x2, -+ 0x07, 0x0, -+ 0x09, 0x0, -+ 0x0c, 0x0, -+}; -+ -+void rtw_bb_rf_gain_offset(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ struct kfree_data_t *kfree_data = &pHalData->kfree_data; -+ u8 value = pHalData->EEPROMRFGainOffset; -+ u8 tmp = 0x3e; -+ u32 res, i = 0; -+ u4Byte ArrayLen = sizeof(Array_kfreemap) / sizeof(u32); -+ pu4Byte Array = Array_kfreemap; -+ u4Byte v1 = 0, v2 = 0, GainValue = 0, target = 0; -+ -+ if (registry_par->RegPwrTrimEnable == 2) { -+ RTW_INFO("Registry kfree default force disable.\n"); -+ return; -+ } -+ -+#if defined(CONFIG_RTL8723B) -+ if (value & BIT4 || (registry_par->RegPwrTrimEnable == 1)) { -+ RTW_INFO("Offset RF Gain.\n"); -+ RTW_INFO("Offset RF Gain. pHalData->EEPROMRFGainVal=0x%x\n", pHalData->EEPROMRFGainVal); -+ -+ if (pHalData->EEPROMRFGainVal != 0xff) { -+ -+ if (pHalData->ant_path == ODM_RF_PATH_A) -+ GainValue = (pHalData->EEPROMRFGainVal & 0x0f); -+ -+ else -+ GainValue = (pHalData->EEPROMRFGainVal & 0xf0) >> 4; -+ RTW_INFO("Ant PATH_%d GainValue Offset = 0x%x\n", (pHalData->ant_path == ODM_RF_PATH_A) ? (ODM_RF_PATH_A) : (ODM_RF_PATH_B), GainValue); -+ -+ for (i = 0; i < ArrayLen; i += 2) { -+ /* RTW_INFO("ArrayLen in =%d ,Array 1 =0x%x ,Array2 =0x%x\n",i,Array[i],Array[i]+1); */ -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ if (v1 == GainValue) { -+ RTW_INFO("Offset RF Gain. got v1 =0x%x ,v2 =0x%x\n", v1, v2); -+ target = v2; -+ break; -+ } -+ } -+ RTW_INFO("pHalData->EEPROMRFGainVal=0x%x ,Gain offset Target Value=0x%x\n", pHalData->EEPROMRFGainVal, target); -+ -+ res = rtw_hal_read_rfreg(padapter, RF_PATH_A, 0x7f, 0xffffffff); -+ RTW_INFO("Offset RF Gain. before reg 0x7f=0x%08x\n", res); -+ PHY_SetRFReg(padapter, RF_PATH_A, REG_RF_BB_GAIN_OFFSET, BIT18 | BIT17 | BIT16 | BIT15, target); -+ res = rtw_hal_read_rfreg(padapter, RF_PATH_A, 0x7f, 0xffffffff); -+ -+ RTW_INFO("Offset RF Gain. After reg 0x7f=0x%08x\n", res); -+ -+ } else -+ -+ RTW_INFO("Offset RF Gain. pHalData->EEPROMRFGainVal=0x%x != 0xff, didn't run Kfree\n", pHalData->EEPROMRFGainVal); -+ } else -+ RTW_INFO("Using the default RF gain.\n"); -+ -+#elif defined(CONFIG_RTL8188E) -+ if (value & BIT4 || (registry_par->RegPwrTrimEnable == 1)) { -+ RTW_INFO("8188ES Offset RF Gain.\n"); -+ RTW_INFO("8188ES Offset RF Gain. EEPROMRFGainVal=0x%x\n", -+ pHalData->EEPROMRFGainVal); -+ -+ if (pHalData->EEPROMRFGainVal != 0xff) { -+ res = rtw_hal_read_rfreg(padapter, RF_PATH_A, -+ REG_RF_BB_GAIN_OFFSET, 0xffffffff); -+ -+ RTW_INFO("Offset RF Gain. reg 0x55=0x%x\n", res); -+ res &= 0xfff87fff; -+ -+ res |= (pHalData->EEPROMRFGainVal & 0x0f) << 15; -+ RTW_INFO("Offset RF Gain. res=0x%x\n", res); -+ -+ rtw_hal_write_rfreg(padapter, RF_PATH_A, -+ REG_RF_BB_GAIN_OFFSET, -+ RF_GAIN_OFFSET_MASK, res); -+ } else { -+ RTW_INFO("Offset RF Gain. EEPROMRFGainVal=0x%x == 0xff, didn't run Kfree\n", -+ pHalData->EEPROMRFGainVal); -+ } -+ } else -+ RTW_INFO("Using the default RF gain.\n"); -+#else -+ /* TODO: call this when channel switch */ -+ if (kfree_data->flag & KFREE_FLAG_ON) -+ rtw_rf_apply_tx_gain_offset(padapter, 6); /* input ch6 to select BB_GAIN_2G */ -+#endif -+ -+} -+#endif /*CONFIG_RF_POWER_TRIM */ -+ -+bool kfree_data_is_bb_gain_empty(struct kfree_data_t *data) -+{ -+#ifdef CONFIG_RF_POWER_TRIM -+ int i, j; -+ -+ for (i = 0; i < BB_GAIN_NUM; i++) -+ for (j = 0; j < RF_PATH_MAX; j++) -+ if (data->bb_gain[i][j] != 0) -+ return 0; -+#endif -+ return 1; -+} -+ -+#ifdef CONFIG_USB_RX_AGGREGATION -+void rtw_set_usb_agg_by_mode_normal(_adapter *padapter, u8 cur_wireless_mode) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ if (cur_wireless_mode < WIRELESS_11_24N -+ && cur_wireless_mode > 0) { /* ABG mode */ -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ u32 remainder = 0; -+ u8 quotient = 0; -+ -+ remainder = MAX_RECVBUF_SZ % (4 * 1024); -+ quotient = (u8)(MAX_RECVBUF_SZ >> 12); -+ -+ if (quotient > 5) { -+ pHalData->rxagg_usb_size = 0x6; -+ pHalData->rxagg_usb_timeout = 0x10; -+ } else { -+ if (remainder >= 2048) { -+ pHalData->rxagg_usb_size = quotient; -+ pHalData->rxagg_usb_timeout = 0x10; -+ } else { -+ pHalData->rxagg_usb_size = (quotient - 1); -+ pHalData->rxagg_usb_timeout = 0x10; -+ } -+ } -+#else /* !CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ if (0x6 != pHalData->rxagg_usb_size || 0x10 != pHalData->rxagg_usb_timeout) { -+ pHalData->rxagg_usb_size = 0x6; -+ pHalData->rxagg_usb_timeout = 0x10; -+ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, -+ pHalData->rxagg_usb_size | (pHalData->rxagg_usb_timeout << 8)); -+ } -+#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ -+ } else if (cur_wireless_mode >= WIRELESS_11_24N -+ && cur_wireless_mode <= WIRELESS_MODE_MAX) { /* N AC mode */ -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ u32 remainder = 0; -+ u8 quotient = 0; -+ -+ remainder = MAX_RECVBUF_SZ % (4 * 1024); -+ quotient = (u8)(MAX_RECVBUF_SZ >> 12); -+ -+ if (quotient > 5) { -+ pHalData->rxagg_usb_size = 0x5; -+ pHalData->rxagg_usb_timeout = 0x20; -+ } else { -+ if (remainder >= 2048) { -+ pHalData->rxagg_usb_size = quotient; -+ pHalData->rxagg_usb_timeout = 0x10; -+ } else { -+ pHalData->rxagg_usb_size = (quotient - 1); -+ pHalData->rxagg_usb_timeout = 0x10; -+ } -+ } -+#else /* !CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ if ((0x5 != pHalData->rxagg_usb_size) || (0x20 != pHalData->rxagg_usb_timeout)) { -+ pHalData->rxagg_usb_size = 0x5; -+ pHalData->rxagg_usb_timeout = 0x20; -+ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, -+ pHalData->rxagg_usb_size | (pHalData->rxagg_usb_timeout << 8)); -+ } -+#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ -+ } else { -+ /* RTW_INFO("%s: Unknow wireless mode(0x%x)\n",__func__,padapter->mlmeextpriv.cur_wireless_mode); */ -+ } -+} -+ -+void rtw_set_usb_agg_by_mode_customer(_adapter *padapter, u8 cur_wireless_mode, u8 UsbDmaSize, u8 Legacy_UsbDmaSize) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (cur_wireless_mode < WIRELESS_11_24N -+ && cur_wireless_mode > 0) { /* ABG mode */ -+ if (Legacy_UsbDmaSize != pHalData->rxagg_usb_size -+ || 0x10 != pHalData->rxagg_usb_timeout) { -+ pHalData->rxagg_usb_size = Legacy_UsbDmaSize; -+ pHalData->rxagg_usb_timeout = 0x10; -+ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, -+ pHalData->rxagg_usb_size | (pHalData->rxagg_usb_timeout << 8)); -+ } -+ } else if (cur_wireless_mode >= WIRELESS_11_24N -+ && cur_wireless_mode <= WIRELESS_MODE_MAX) { /* N AC mode */ -+ if (UsbDmaSize != pHalData->rxagg_usb_size -+ || 0x20 != pHalData->rxagg_usb_timeout) { -+ pHalData->rxagg_usb_size = UsbDmaSize; -+ pHalData->rxagg_usb_timeout = 0x20; -+ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, -+ pHalData->rxagg_usb_size | (pHalData->rxagg_usb_timeout << 8)); -+ } -+ } else { -+ /* RTW_INFO("%s: Unknown wireless mode(0x%x)\n",__func__,padapter->mlmeextpriv.cur_wireless_mode); */ -+ } -+} -+ -+void rtw_set_usb_agg_by_mode(_adapter *padapter, u8 cur_wireless_mode) -+{ -+#ifdef CONFIG_PLATFORM_NOVATEK_NT72668 -+ rtw_set_usb_agg_by_mode_customer(padapter, cur_wireless_mode, 0x3, 0x3); -+ return; -+#endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ -+ -+ rtw_set_usb_agg_by_mode_normal(padapter, cur_wireless_mode); -+} -+#endif /* CONFIG_USB_RX_AGGREGATION */ -+ -+/* To avoid RX affect TX throughput */ -+void dm_DynamicUsbTxAgg(_adapter *padapter, u8 from_timer) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 cur_wireless_mode = WIRELESS_INVALID; -+ -+#ifdef CONFIG_USB_RX_AGGREGATION -+ if (IS_HARDWARE_TYPE_8821U(padapter)) { /* || IS_HARDWARE_TYPE_8192EU(padapter)) */ -+ /* This AGG_PH_TH only for UsbRxAggMode == USB_RX_AGG_USB */ -+ if ((pHalData->rxagg_mode == RX_AGG_USB) && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { -+ if (pdvobjpriv->traffic_stat.cur_tx_tp > 2 && pdvobjpriv->traffic_stat.cur_rx_tp < 30) -+ rtw_write16(padapter , REG_RXDMA_AGG_PG_TH , 0x1010); -+ else if (pdvobjpriv->traffic_stat.last_tx_bytes > 220000 && pdvobjpriv->traffic_stat.cur_rx_tp < 30) -+ rtw_write16(padapter , REG_RXDMA_AGG_PG_TH , 0x1006); -+ else -+ rtw_write16(padapter, REG_RXDMA_AGG_PG_TH, 0x2005); /* dmc agg th 20K */ -+ -+ /* RTW_INFO("TX_TP=%u, RX_TP=%u\n", pdvobjpriv->traffic_stat.cur_tx_tp, pdvobjpriv->traffic_stat.cur_rx_tp); */ -+ } -+ } else if (IS_HARDWARE_TYPE_8812(padapter)) { -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 i; -+ _adapter *iface; -+ u8 bassocaed = _FALSE; -+ struct mlme_ext_priv *mlmeext; -+ -+ for (i = 0; i < pdvobjpriv->iface_nums; i++) { -+ iface = pdvobjpriv->padapters[i]; -+ mlmeext = &iface->mlmeextpriv; -+ if (rtw_linked_check(iface) == _TRUE) { -+ if (mlmeext->cur_wireless_mode >= cur_wireless_mode) -+ cur_wireless_mode = mlmeext->cur_wireless_mode; -+ bassocaed = _TRUE; -+ } -+ } -+ if (bassocaed) -+#endif -+ rtw_set_usb_agg_by_mode(padapter, cur_wireless_mode); -+#ifdef CONFIG_PLATFORM_NOVATEK_NT72668 -+ } else { -+ rtw_set_usb_agg_by_mode(padapter, cur_wireless_mode); -+#endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ -+ } -+#endif -+} -+ -+/* bus-agg check for SoftAP mode */ -+inline u8 rtw_hal_busagg_qsel_check(_adapter *padapter, u8 pre_qsel, u8 next_qsel) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 chk_rst = _SUCCESS; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return chk_rst; -+ -+ /* if((pre_qsel == 0xFF)||(next_qsel== 0xFF)) */ -+ /* return chk_rst; */ -+ -+ if (((pre_qsel == QSLT_HIGH) || ((next_qsel == QSLT_HIGH))) -+ && (pre_qsel != next_qsel)) { -+ /* RTW_INFO("### bus-agg break cause of qsel misatch, pre_qsel=0x%02x,next_qsel=0x%02x ###\n", */ -+ /* pre_qsel,next_qsel); */ -+ chk_rst = _FAIL; -+ } -+ return chk_rst; -+} -+ -+/* -+ * Description: -+ * dump_TX_FIFO: This is only used to dump TX_FIFO for debug WoW mode offload -+ * contant. -+ * -+ * Input: -+ * adapter: adapter pointer. -+ * page_num: The max. page number that user want to dump. -+ * page_size: page size of each page. eg. 128 bytes, 256 bytes, 512byte. -+ */ -+void dump_TX_FIFO(_adapter *padapter, u8 page_num, u16 page_size) -+{ -+ -+ int i; -+ u8 val = 0; -+ u8 base = 0; -+ u32 addr = 0; -+ u32 count = (page_size / 8); -+ -+ if (page_num <= 0) { -+ RTW_INFO("!!%s: incorrect input page_num paramter!\n", __func__); -+ return; -+ } -+ -+ if (page_size < 128 || page_size > 512) { -+ RTW_INFO("!!%s: incorrect input page_size paramter!\n", __func__); -+ return; -+ } -+ -+ RTW_INFO("+%s+\n", __func__); -+ val = rtw_read8(padapter, 0x106); -+ rtw_write8(padapter, 0x106, 0x69); -+ RTW_INFO("0x106: 0x%02x\n", val); -+ base = rtw_read8(padapter, 0x209); -+ RTW_INFO("0x209: 0x%02x\n", base); -+ -+ addr = ((base)*page_size) / 8; -+ for (i = 0 ; i < page_num * count ; i += 2) { -+ rtw_write32(padapter, 0x140, addr + i); -+ printk(" %08x %08x ", rtw_read32(padapter, 0x144), rtw_read32(padapter, 0x148)); -+ rtw_write32(padapter, 0x140, addr + i + 1); -+ printk(" %08x %08x\n", rtw_read32(padapter, 0x144), rtw_read32(padapter, 0x148)); -+ } -+} -+ -+#ifdef CONFIG_GPIO_API -+u8 rtw_hal_get_gpio(_adapter *adapter, u8 gpio_num) -+{ -+ u8 value = 0; -+ u8 direction = 0; -+ u32 gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL + 2; -+ u8 gpio_num_to_set = gpio_num; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); -+ -+ if (rtw_hal_gpio_func_check(adapter, gpio_num) == _FAIL) -+ return value; -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ -+ RTW_INFO("rf_pwrstate=0x%02x\n", pwrpriv->rf_pwrstate); -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ if (gpio_num > 7) { -+ gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL_2 + 2; -+ gpio_num_to_set = gpio_num - 8; -+ } -+ -+ /* Read GPIO Direction */ -+ direction = (rtw_read8(adapter, gpio_ctrl_reg_to_set) & BIT(gpio_num_to_set)) >> gpio_num; -+ -+ /* According the direction to read register value */ -+ if (direction) -+ value = (rtw_read8(adapter, gpio_ctrl_reg_to_set) & BIT(gpio_num_to_set)) >> gpio_num; -+ else -+ value = (rtw_read8(adapter, gpio_ctrl_reg_to_set) & BIT(gpio_num_to_set)) >> gpio_num; -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ RTW_INFO("%s direction=%d value=%d\n", __FUNCTION__, direction, value); -+ -+ return value; -+} -+ -+int rtw_hal_set_gpio_output_value(_adapter *adapter, u8 gpio_num, bool isHigh) -+{ -+ u8 direction = 0; -+ u8 res = -1; -+ u32 gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL + 2; -+ u8 gpio_num_to_set = gpio_num; -+ -+ if (rtw_hal_gpio_func_check(adapter, gpio_num) == _FAIL) -+ return -1; -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ if (gpio_num > 7) { -+ gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL_2 + 2; -+ gpio_num_to_set = gpio_num - 8; -+ } -+ -+ /* Read GPIO direction */ -+ direction = (rtw_read8(adapter, REG_GPIO_PIN_CTRL + 2) & BIT(gpio_num)) >> gpio_num; -+ -+ /* If GPIO is output direction, setting value. */ -+ if (direction) { -+ if (isHigh) -+ rtw_write8(adapter, gpio_ctrl_reg_to_set, rtw_read8(adapter, gpio_ctrl_reg_to_set) | BIT(gpio_num_to_set)); -+ else -+ rtw_write8(adapter, gpio_ctrl_reg_to_set, rtw_read8(adapter, gpio_ctrl_reg_to_set) & ~BIT(gpio_num_to_set)); -+ -+ RTW_INFO("%s Set gpio %x[%d]=%d\n", __FUNCTION__, REG_GPIO_PIN_CTRL + 1, gpio_num, isHigh); -+ res = 0; -+ } else { -+ RTW_INFO("%s The gpio is input,not be set!\n", __FUNCTION__); -+ res = -1; -+ } -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ return res; -+} -+ -+int rtw_hal_config_gpio(_adapter *adapter, u8 gpio_num, bool isOutput) -+{ -+ u32 gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL + 2; -+ u8 gpio_num_to_set = gpio_num; -+ -+ if (rtw_hal_gpio_func_check(adapter, gpio_num) == _FAIL) -+ return -1; -+ -+ RTW_INFO("%s gpio_num =%d direction=%d\n", __FUNCTION__, gpio_num, isOutput); -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ rtw_hal_gpio_multi_func_reset(adapter, gpio_num); -+ -+ if (gpio_num > 7) { -+ gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL_2 + 2; -+ gpio_num_to_set = gpio_num - 8; -+ } -+ -+ if (isOutput) -+ rtw_write8(adapter, gpio_ctrl_reg_to_set, rtw_read8(adapter, gpio_ctrl_reg_to_set) | BIT(gpio_num_to_set)); -+ else -+ rtw_write8(adapter, gpio_ctrl_reg_to_set, rtw_read8(adapter, gpio_ctrl_reg_to_set) & ~BIT(gpio_num_to_set)); -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ -+ return 0; -+} -+int rtw_hal_register_gpio_interrupt(_adapter *adapter, int gpio_num, void(*callback)(u8 level)) -+{ -+ u8 value; -+ u8 direction; -+ PHAL_DATA_TYPE phal = GET_HAL_DATA(adapter); -+ -+ if (IS_HARDWARE_TYPE_8188E(adapter)) { -+ if (gpio_num > 7 || gpio_num < 4) { -+ RTW_PRINT("%s The gpio number does not included 4~7.\n", __FUNCTION__); -+ return -1; -+ } -+ } -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ /* Read GPIO direction */ -+ direction = (rtw_read8(adapter, REG_GPIO_PIN_CTRL + 2) & BIT(gpio_num)) >> gpio_num; -+ if (direction) { -+ RTW_PRINT("%s Can't register output gpio as interrupt.\n", __FUNCTION__); -+ return -1; -+ } -+ -+ /* Config GPIO Mode */ -+ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 3, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 3) | BIT(gpio_num)); -+ -+ /* Register GPIO interrupt handler*/ -+ adapter->gpiointpriv.callback[gpio_num] = callback; -+ -+ /* Set GPIO interrupt mode, 0:positive edge, 1:negative edge */ -+ value = rtw_read8(adapter, REG_GPIO_PIN_CTRL) & BIT(gpio_num); -+ adapter->gpiointpriv.interrupt_mode = rtw_read8(adapter, REG_HSIMR + 2) ^ value; -+ rtw_write8(adapter, REG_GPIO_INTM, adapter->gpiointpriv.interrupt_mode); -+ -+ /* Enable GPIO interrupt */ -+ adapter->gpiointpriv.interrupt_enable_mask = rtw_read8(adapter, REG_HSIMR + 2) | BIT(gpio_num); -+ rtw_write8(adapter, REG_HSIMR + 2, adapter->gpiointpriv.interrupt_enable_mask); -+ -+ rtw_hal_update_hisr_hsisr_ind(adapter, 1); -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ -+ return 0; -+} -+int rtw_hal_disable_gpio_interrupt(_adapter *adapter, int gpio_num) -+{ -+ u8 value; -+ u8 direction; -+ PHAL_DATA_TYPE phal = GET_HAL_DATA(adapter); -+ -+ if (IS_HARDWARE_TYPE_8188E(adapter)) { -+ if (gpio_num > 7 || gpio_num < 4) { -+ RTW_INFO("%s The gpio number does not included 4~7.\n", __FUNCTION__); -+ return -1; -+ } -+ } -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ /* Config GPIO Mode */ -+ rtw_write8(adapter, REG_GPIO_PIN_CTRL + 3, rtw_read8(adapter, REG_GPIO_PIN_CTRL + 3) & ~BIT(gpio_num)); -+ -+ /* Unregister GPIO interrupt handler*/ -+ adapter->gpiointpriv.callback[gpio_num] = NULL; -+ -+ /* Reset GPIO interrupt mode, 0:positive edge, 1:negative edge */ -+ adapter->gpiointpriv.interrupt_mode = rtw_read8(adapter, REG_GPIO_INTM) & ~BIT(gpio_num); -+ rtw_write8(adapter, REG_GPIO_INTM, 0x00); -+ -+ /* Disable GPIO interrupt */ -+ adapter->gpiointpriv.interrupt_enable_mask = rtw_read8(adapter, REG_HSIMR + 2) & ~BIT(gpio_num); -+ rtw_write8(adapter, REG_HSIMR + 2, adapter->gpiointpriv.interrupt_enable_mask); -+ -+ if (!adapter->gpiointpriv.interrupt_enable_mask) -+ rtw_hal_update_hisr_hsisr_ind(adapter, 0); -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ -+ return 0; -+} -+#endif -+ -+s8 rtw_hal_ch_sw_iqk_info_search(_adapter *padapter, u8 central_chnl, u8 bw_mode) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 i; -+ -+ for (i = 0; i < MAX_IQK_INFO_BACKUP_CHNL_NUM; i++) { -+ if ((pHalData->iqk_reg_backup[i].central_chnl != 0)) { -+ if ((pHalData->iqk_reg_backup[i].central_chnl == central_chnl) -+ && (pHalData->iqk_reg_backup[i].bw_mode == bw_mode)) -+ return i; -+ } -+ } -+ -+ return -1; -+} -+ -+void rtw_hal_ch_sw_iqk_info_backup(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ s8 res; -+ u8 i; -+ -+ /* If it's an existed record, overwrite it */ -+ res = rtw_hal_ch_sw_iqk_info_search(padapter, pHalData->CurrentChannel, pHalData->CurrentChannelBW); -+ if ((res >= 0) && (res < MAX_IQK_INFO_BACKUP_CHNL_NUM)) { -+ rtw_hal_set_hwreg(padapter, HW_VAR_CH_SW_IQK_INFO_BACKUP, (u8 *)&(pHalData->iqk_reg_backup[res])); -+ return; -+ } -+ -+ /* Search for the empty record to use */ -+ for (i = 0; i < MAX_IQK_INFO_BACKUP_CHNL_NUM; i++) { -+ if (pHalData->iqk_reg_backup[i].central_chnl == 0) { -+ rtw_hal_set_hwreg(padapter, HW_VAR_CH_SW_IQK_INFO_BACKUP, (u8 *)&(pHalData->iqk_reg_backup[i])); -+ return; -+ } -+ } -+ -+ /* Else, overwrite the oldest record */ -+ for (i = 1; i < MAX_IQK_INFO_BACKUP_CHNL_NUM; i++) -+ _rtw_memcpy(&(pHalData->iqk_reg_backup[i - 1]), &(pHalData->iqk_reg_backup[i]), sizeof(struct hal_iqk_reg_backup)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CH_SW_IQK_INFO_BACKUP, (u8 *)&(pHalData->iqk_reg_backup[MAX_IQK_INFO_BACKUP_CHNL_NUM - 1])); -+} -+ -+void rtw_hal_ch_sw_iqk_info_restore(_adapter *padapter, u8 ch_sw_use_case) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CH_SW_IQK_INFO_RESTORE, &ch_sw_use_case); -+} -+ -+void rtw_dump_mac_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter) -+{ -+ u32 mac_cck_ok = 0, mac_ofdm_ok = 0, mac_ht_ok = 0, mac_vht_ok = 0; -+ u32 mac_cck_err = 0, mac_ofdm_err = 0, mac_ht_err = 0, mac_vht_err = 0; -+ u32 mac_cck_fa = 0, mac_ofdm_fa = 0, mac_ht_fa = 0; -+ u32 DropPacket = 0; -+ -+ if (!rx_counter) { -+ rtw_warn_on(1); -+ return; -+ } -+ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ -+ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x3); -+ mac_cck_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x0); -+ mac_ofdm_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x6); -+ mac_ht_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ mac_vht_ok = 0; -+ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x0); -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x1); -+ mac_vht_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0]*/ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ -+ } -+ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x4); -+ mac_cck_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x1); -+ mac_ofdm_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x7); -+ mac_ht_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ mac_vht_err = 0; -+ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x1); -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x1); -+ mac_vht_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0]*/ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ -+ } -+ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x5); -+ mac_cck_fa = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x2); -+ mac_ofdm_fa = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x9); -+ mac_ht_fa = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ -+ -+ /* Mac_DropPacket */ -+ rtw_write32(padapter, REG_RXERR_RPT, (rtw_read32(padapter, REG_RXERR_RPT) & 0x0FFFFFFF) | Mac_DropPacket); -+ DropPacket = rtw_read32(padapter, REG_RXERR_RPT) & 0x0000FFFF; -+ -+ rx_counter->rx_pkt_ok = mac_cck_ok + mac_ofdm_ok + mac_ht_ok + mac_vht_ok; -+ rx_counter->rx_pkt_crc_error = mac_cck_err + mac_ofdm_err + mac_ht_err + mac_vht_err; -+ rx_counter->rx_cck_fa = mac_cck_fa; -+ rx_counter->rx_ofdm_fa = mac_ofdm_fa; -+ rx_counter->rx_ht_fa = mac_ht_fa; -+ rx_counter->rx_pkt_drop = DropPacket; -+} -+void rtw_reset_mac_rx_counters(_adapter *padapter) -+{ -+ -+ /* If no packet rx, MaxRx clock be gating ,BIT_DISGCLK bit19 set 1 for fix*/ -+ if (IS_HARDWARE_TYPE_8703B(padapter) || -+ IS_HARDWARE_TYPE_8723D(padapter) || -+ IS_HARDWARE_TYPE_8188F(padapter)) -+ PHY_SetMacReg(padapter, REG_RCR, BIT19, 0x1); -+ -+ /* reset mac counter */ -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT27, 0x1); -+ PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT27, 0x0); -+} -+ -+void rtw_dump_phy_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter) -+{ -+ u32 cckok = 0, cckcrc = 0, ofdmok = 0, ofdmcrc = 0, htok = 0, htcrc = 0, OFDM_FA = 0, CCK_FA = 0, vht_ok = 0, vht_err = 0; -+ if (!rx_counter) { -+ rtw_warn_on(1); -+ return; -+ } -+ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { -+ cckok = PHY_QueryBBReg(padapter, 0xF04, 0x3FFF); /* [13:0] */ -+ ofdmok = PHY_QueryBBReg(padapter, 0xF14, 0x3FFF); /* [13:0] */ -+ htok = PHY_QueryBBReg(padapter, 0xF10, 0x3FFF); /* [13:0] */ -+ vht_ok = PHY_QueryBBReg(padapter, 0xF0C, 0x3FFF); /* [13:0] */ -+ cckcrc = PHY_QueryBBReg(padapter, 0xF04, 0x3FFF0000); /* [29:16] */ -+ ofdmcrc = PHY_QueryBBReg(padapter, 0xF14, 0x3FFF0000); /* [29:16] */ -+ htcrc = PHY_QueryBBReg(padapter, 0xF10, 0x3FFF0000); /* [29:16] */ -+ vht_err = PHY_QueryBBReg(padapter, 0xF0C, 0x3FFF0000); /* [29:16] */ -+ CCK_FA = PHY_QueryBBReg(padapter, 0xA5C, bMaskLWord); -+ OFDM_FA = PHY_QueryBBReg(padapter, 0xF48, bMaskLWord); -+ } else { -+ cckok = PHY_QueryBBReg(padapter, 0xF88, bMaskDWord); -+ ofdmok = PHY_QueryBBReg(padapter, 0xF94, bMaskLWord); -+ htok = PHY_QueryBBReg(padapter, 0xF90, bMaskLWord); -+ vht_ok = 0; -+ cckcrc = PHY_QueryBBReg(padapter, 0xF84, bMaskDWord); -+ ofdmcrc = PHY_QueryBBReg(padapter, 0xF94, bMaskHWord); -+ htcrc = PHY_QueryBBReg(padapter, 0xF90, bMaskHWord); -+ vht_err = 0; -+ OFDM_FA = PHY_QueryBBReg(padapter, 0xCF0, bMaskLWord) + PHY_QueryBBReg(padapter, 0xCF2, bMaskLWord) + -+ PHY_QueryBBReg(padapter, 0xDA2, bMaskLWord) + PHY_QueryBBReg(padapter, 0xDA4, bMaskLWord) + -+ PHY_QueryBBReg(padapter, 0xDA6, bMaskLWord) + PHY_QueryBBReg(padapter, 0xDA8, bMaskLWord); -+ -+ CCK_FA = (rtw_read8(padapter, 0xA5B) << 8) | (rtw_read8(padapter, 0xA5C)); -+ } -+ -+ rx_counter->rx_pkt_ok = cckok + ofdmok + htok + vht_ok; -+ rx_counter->rx_pkt_crc_error = cckcrc + ofdmcrc + htcrc + vht_err; -+ rx_counter->rx_ofdm_fa = OFDM_FA; -+ rx_counter->rx_cck_fa = CCK_FA; -+ -+} -+ -+void rtw_reset_phy_trx_ok_counters(_adapter *padapter) -+{ -+ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { -+ PHY_SetBBReg(padapter, 0xB58, BIT0, 0x1); -+ PHY_SetBBReg(padapter, 0xB58, BIT0, 0x0); -+ } -+} -+void rtw_reset_phy_rx_counters(_adapter *padapter) -+{ -+ /* reset phy counter */ -+ if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { -+ rtw_reset_phy_trx_ok_counters(padapter); -+ -+ PHY_SetBBReg(padapter, 0x9A4, BIT17, 0x1);/* reset OFDA FA counter */ -+ PHY_SetBBReg(padapter, 0x9A4, BIT17, 0x0); -+ -+ PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x0);/* reset CCK FA counter */ -+ PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x1); -+ } else { -+ PHY_SetBBReg(padapter, 0xF14, BIT16, 0x1); -+ rtw_msleep_os(10); -+ PHY_SetBBReg(padapter, 0xF14, BIT16, 0x0); -+ -+ PHY_SetBBReg(padapter, 0xD00, BIT27, 0x1);/* reset OFDA FA counter */ -+ PHY_SetBBReg(padapter, 0xC0C, BIT31, 0x1);/* reset OFDA FA counter */ -+ PHY_SetBBReg(padapter, 0xD00, BIT27, 0x0); -+ PHY_SetBBReg(padapter, 0xC0C, BIT31, 0x0); -+ -+ PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x0);/* reset CCK FA counter */ -+ PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x1); -+ } -+} -+#ifdef DBG_RX_COUNTER_DUMP -+void rtw_dump_drv_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ if (!rx_counter) { -+ rtw_warn_on(1); -+ return; -+ } -+ rx_counter->rx_pkt_ok = padapter->drv_rx_cnt_ok; -+ rx_counter->rx_pkt_crc_error = padapter->drv_rx_cnt_crcerror; -+ rx_counter->rx_pkt_drop = precvpriv->rx_drop - padapter->drv_rx_cnt_drop; -+} -+void rtw_reset_drv_rx_counters(_adapter *padapter) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ padapter->drv_rx_cnt_ok = 0; -+ padapter->drv_rx_cnt_crcerror = 0; -+ padapter->drv_rx_cnt_drop = precvpriv->rx_drop; -+} -+void rtw_dump_phy_rxcnts_preprocess(_adapter *padapter, u8 rx_cnt_mode) -+{ -+ u8 initialgain; -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ -+ if ((!(padapter->dump_rx_cnt_mode & DUMP_PHY_RX_COUNTER)) && (rx_cnt_mode & DUMP_PHY_RX_COUNTER)) { -+ rtw_hal_get_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, NULL); -+ RTW_INFO("%s CurIGValue:0x%02x\n", __FUNCTION__, initialgain); -+ rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE); -+ /*disable dynamic functions, such as high power, DIG*/ -+ rtw_phydm_ability_backup(padapter); -+ rtw_phydm_func_clr(padapter, (ODM_BB_DIG | ODM_BB_FA_CNT)); -+ } else if ((padapter->dump_rx_cnt_mode & DUMP_PHY_RX_COUNTER) && (!(rx_cnt_mode & DUMP_PHY_RX_COUNTER))) { -+ /* turn on phy-dynamic functions */ -+ rtw_phydm_ability_restore(padapter); -+ initialgain = 0xff; /* restore RX GAIN */ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE); -+ -+ } -+} -+ -+void rtw_dump_rx_counters(_adapter *padapter) -+{ -+ struct dbg_rx_counter rx_counter; -+ -+ if (padapter->dump_rx_cnt_mode & DUMP_DRV_RX_COUNTER) { -+ _rtw_memset(&rx_counter, 0, sizeof(struct dbg_rx_counter)); -+ rtw_dump_drv_rx_counters(padapter, &rx_counter); -+ RTW_INFO("Drv Received packet OK:%d CRC error:%d Drop Packets: %d\n", -+ rx_counter.rx_pkt_ok, rx_counter.rx_pkt_crc_error, rx_counter.rx_pkt_drop); -+ rtw_reset_drv_rx_counters(padapter); -+ } -+ -+ if (padapter->dump_rx_cnt_mode & DUMP_MAC_RX_COUNTER) { -+ _rtw_memset(&rx_counter, 0, sizeof(struct dbg_rx_counter)); -+ rtw_dump_mac_rx_counters(padapter, &rx_counter); -+ RTW_INFO("Mac Received packet OK:%d CRC error:%d FA Counter: %d Drop Packets: %d\n", -+ rx_counter.rx_pkt_ok, rx_counter.rx_pkt_crc_error, -+ rx_counter.rx_cck_fa + rx_counter.rx_ofdm_fa + rx_counter.rx_ht_fa, -+ rx_counter.rx_pkt_drop); -+ rtw_reset_mac_rx_counters(padapter); -+ } -+ -+ if (padapter->dump_rx_cnt_mode & DUMP_PHY_RX_COUNTER) { -+ _rtw_memset(&rx_counter, 0, sizeof(struct dbg_rx_counter)); -+ rtw_dump_phy_rx_counters(padapter, &rx_counter); -+ /* RTW_INFO("%s: OFDM_FA =%d\n", __FUNCTION__, rx_counter.rx_ofdm_fa); */ -+ /* RTW_INFO("%s: CCK_FA =%d\n", __FUNCTION__, rx_counter.rx_cck_fa); */ -+ RTW_INFO("Phy Received packet OK:%d CRC error:%d FA Counter: %d\n", rx_counter.rx_pkt_ok, rx_counter.rx_pkt_crc_error, -+ rx_counter.rx_ofdm_fa + rx_counter.rx_cck_fa); -+ rtw_reset_phy_rx_counters(padapter); -+ } -+} -+#endif -+void rtw_get_noise(_adapter *padapter) -+{ -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct noise_info info; -+ if (rtw_linked_check(padapter)) { -+ info.bPauseDIG = _TRUE; -+ info.IGIValue = 0x1e; -+ info.max_time = 100;/* ms */ -+ info.chan = pmlmeext->cur_channel ;/* rtw_get_oper_ch(padapter); */ -+ rtw_ps_deny(padapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(padapter); -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &info, _FALSE); -+ /* ODM_InbandNoise_Monitor(podmpriv,_TRUE,0x20,100); */ -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(info.chan), &(padapter->recvpriv.noise)); -+#ifdef DBG_NOISE_MONITOR -+ RTW_INFO("chan:%d,noise_level:%d\n", info.chan, padapter->recvpriv.noise); -+#endif -+ } -+#endif -+ -+} -+u8 rtw_get_current_tx_sgi(_adapter *padapter, u8 macid) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u8 curr_tx_sgi = 0; -+ -+#if defined(CONFIG_RTL8188E) -+ curr_tx_sgi = ODM_RA_GetDecisionRate_8188E(pDM_Odm, macid); -+#else -+ curr_tx_sgi = ((pRA_Table->link_tx_rate[macid]) & 0x80) >> 7; -+#endif -+ -+ return curr_tx_sgi; -+ -+} -+u8 rtw_get_current_tx_rate(_adapter *padapter, u8 macid) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u8 rate_id = 0; -+ -+#if (RATE_ADAPTIVE_SUPPORT == 1) -+ rate_id = ODM_RA_GetDecisionRate_8188E(pDM_Odm, macid); -+#else -+ rate_id = (pRA_Table->link_tx_rate[macid]) & 0x7f; -+#endif -+ -+ return rate_id; -+ -+} -+ -+void update_IOT_info(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ switch (pmlmeinfo->assoc_AP_vendor) { -+ case HT_IOT_PEER_MARVELL: -+ pmlmeinfo->turboMode_cts2self = 1; -+ pmlmeinfo->turboMode_rtsen = 0; -+ break; -+ -+ case HT_IOT_PEER_RALINK: -+ pmlmeinfo->turboMode_cts2self = 0; -+ pmlmeinfo->turboMode_rtsen = 1; -+ /* disable high power */ -+ rtw_phydm_func_clr(padapter, ODM_BB_DYNAMIC_TXPWR); -+ break; -+ case HT_IOT_PEER_REALTEK: -+ /* rtw_write16(padapter, 0x4cc, 0xffff); */ -+ /* rtw_write16(padapter, 0x546, 0x01c0); */ -+ /* disable high power */ -+ rtw_phydm_func_clr(padapter, ODM_BB_DYNAMIC_TXPWR); -+ break; -+ default: -+ pmlmeinfo->turboMode_cts2self = 0; -+ pmlmeinfo->turboMode_rtsen = 1; -+ break; -+ } -+ -+} -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+void rtw_acs_start(_adapter *padapter, bool bStart) -+{ -+ if (_TRUE == bStart) { -+ ACS_OP acs_op = ACS_INIT; -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &acs_op, _TRUE); -+ rtw_set_acs_channel(padapter, 0); -+ SET_ACS_STATE(padapter, ACS_ENABLE); -+ } else { -+ SET_ACS_STATE(padapter, ACS_DISABLE); -+#ifdef DBG_AUTO_CHNL_SEL_NHM -+ if (1) { -+ u8 best_24g_ch = 0; -+ u8 best_5g_ch = 0; -+ -+ rtw_hal_get_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &(best_24g_ch), &(best_5g_ch)); -+ RTW_INFO("[ACS-"ADPT_FMT"] Best 2.4G CH:%u\n", ADPT_ARG(padapter), best_24g_ch); -+ RTW_INFO("[ACS-"ADPT_FMT"] Best 5G CH:%u\n", ADPT_ARG(padapter), best_5g_ch); -+ } -+#endif -+ } -+} -+#endif -+ -+/* TODO: merge with phydm, see odm_SetCrystalCap() */ -+void hal_set_crystal_cap(_adapter *adapter, u8 crystal_cap) -+{ -+ crystal_cap = crystal_cap & 0x3F; -+ -+ switch (rtw_get_chip_type(adapter)) { -+#if defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8188F) -+ case RTL8188E: -+ case RTL8188F: -+ /* write 0x24[16:11] = 0x24[22:17] = CrystalCap */ -+ PHY_SetBBReg(adapter, REG_AFE_XTAL_CTRL, 0x007FF800, (crystal_cap | (crystal_cap << 6))); -+ break; -+#endif -+#if defined(CONFIG_RTL8812A) -+ case RTL8812: -+ /* write 0x2C[30:25] = 0x2C[24:19] = CrystalCap */ -+ PHY_SetBBReg(adapter, REG_MAC_PHY_CTRL, 0x7FF80000, (crystal_cap | (crystal_cap << 6))); -+ break; -+#endif -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || \ -+ defined(CONFIG_RTL8723D) || defined(CONFIG_RTL8821A) || \ -+ defined(CONFIG_RTL8192E) -+ case RTL8723B: -+ case RTL8703B: -+ case RTL8723D: -+ case RTL8821: -+ case RTL8192E: -+ /* write 0x2C[23:18] = 0x2C[17:12] = CrystalCap */ -+ PHY_SetBBReg(adapter, REG_MAC_PHY_CTRL, 0x00FFF000, (crystal_cap | (crystal_cap << 6))); -+ break; -+#endif -+#if defined(CONFIG_RTL8814A) -+ case RTL8814A: -+ /* write 0x2C[26:21] = 0x2C[20:15] = CrystalCap*/ -+ PHY_SetBBReg(adapter, REG_MAC_PHY_CTRL, 0x07FF8000, (crystal_cap | (crystal_cap << 6))); -+ break; -+#endif -+#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ -+ case RTL8822B: -+ case RTL8821C: -+ /* write 0x28[6:1] = 0x24[30:25] = CrystalCap */ -+ crystal_cap = crystal_cap & 0x3F; -+ PHY_SetBBReg(adapter, REG_AFE_XTAL_CTRL, 0x7E000000, crystal_cap); -+ PHY_SetBBReg(adapter, REG_AFE_PLL_CTRL, 0x7E, crystal_cap); -+ break; -+#endif -+ default: -+ rtw_warn_on(1); -+ } -+} -+ -+int hal_spec_init(_adapter *adapter) -+{ -+ u8 interface_type = 0; -+ int ret = _SUCCESS; -+ -+ interface_type = rtw_get_intf_type(adapter); -+ -+ switch (rtw_get_chip_type(adapter)) { -+#ifdef CONFIG_RTL8723B -+ case RTL8723B: -+ init_hal_spec_8723b(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8703B -+ case RTL8703B: -+ init_hal_spec_8703b(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8723D -+ case RTL8723D: -+ init_hal_spec_8723d(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8188E -+ case RTL8188E: -+ init_hal_spec_8188e(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8188F -+ case RTL8188F: -+ init_hal_spec_8188f(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8812A -+ case RTL8812: -+ init_hal_spec_8812a(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8821A -+ case RTL8821: -+ init_hal_spec_8821a(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8192E -+ case RTL8192E: -+ init_hal_spec_8192e(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8814A -+ case RTL8814A: -+ init_hal_spec_8814a(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8822B -+ case RTL8822B: -+ rtl8822b_init_hal_spec(adapter); -+ break; -+#endif -+#ifdef CONFIG_RTL8821C -+ case RTL8821C: -+ init_hal_spec_rtl8821c(adapter); -+ break; -+#endif -+ default: -+ RTW_ERR("%s: unknown chip_type:%u\n" -+ , __func__, rtw_get_chip_type(adapter)); -+ ret = _FAIL; -+ break; -+ } -+ -+ return ret; -+} -+ -+static const char *const _band_cap_str[] = { -+ /* BIT0 */"2G", -+ /* BIT1 */"5G", -+}; -+ -+static const char *const _bw_cap_str[] = { -+ /* BIT0 */"5M", -+ /* BIT1 */"10M", -+ /* BIT2 */"20M", -+ /* BIT3 */"40M", -+ /* BIT4 */"80M", -+ /* BIT5 */"160M", -+ /* BIT6 */"80_80M", -+}; -+ -+static const char *const _proto_cap_str[] = { -+ /* BIT0 */"b", -+ /* BIT1 */"g", -+ /* BIT2 */"n", -+ /* BIT3 */"ac", -+}; -+ -+static const char *const _wl_func_str[] = { -+ /* BIT0 */"P2P", -+ /* BIT1 */"MIRACAST", -+ /* BIT2 */"TDLS", -+ /* BIT3 */"FTM", -+}; -+ -+void dump_hal_spec(void *sel, _adapter *adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ int i; -+ -+ RTW_PRINT_SEL(sel, "macid_num:%u\n", hal_spec->macid_num); -+ RTW_PRINT_SEL(sel, "sec_cap:0x%02x\n", hal_spec->sec_cap); -+ RTW_PRINT_SEL(sel, "sec_cam_ent_num:%u\n", hal_spec->sec_cam_ent_num); -+ RTW_PRINT_SEL(sel, "rfpath_num_2g:%u\n", hal_spec->rfpath_num_2g); -+ RTW_PRINT_SEL(sel, "rfpath_num_5g:%u\n", hal_spec->rfpath_num_5g); -+ RTW_PRINT_SEL(sel, "max_tx_cnt:%u\n", hal_spec->max_tx_cnt); -+ RTW_PRINT_SEL(sel, "nss_num:%u\n", hal_spec->nss_num); -+ -+ RTW_PRINT_SEL(sel, "band_cap:"); -+ for (i = 0; i < BAND_CAP_BIT_NUM; i++) { -+ if (((hal_spec->band_cap) >> i) & BIT0 && _band_cap_str[i]) -+ _RTW_PRINT_SEL(sel, "%s ", _band_cap_str[i]); -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "bw_cap:"); -+ for (i = 0; i < BW_CAP_BIT_NUM; i++) { -+ if (((hal_spec->bw_cap) >> i) & BIT0 && _bw_cap_str[i]) -+ _RTW_PRINT_SEL(sel, "%s ", _bw_cap_str[i]); -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "proto_cap:"); -+ for (i = 0; i < PROTO_CAP_BIT_NUM; i++) { -+ if (((hal_spec->proto_cap) >> i) & BIT0 && _proto_cap_str[i]) -+ _RTW_PRINT_SEL(sel, "%s ", _proto_cap_str[i]); -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "wl_func:"); -+ for (i = 0; i < WL_FUNC_BIT_NUM; i++) { -+ if (((hal_spec->wl_func) >> i) & BIT0 && _wl_func_str[i]) -+ _RTW_PRINT_SEL(sel, "%s ", _wl_func_str[i]); -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+} -+ -+inline bool hal_chk_band_cap(_adapter *adapter, u8 cap) -+{ -+ return GET_HAL_SPEC(adapter)->band_cap & cap; -+} -+ -+inline bool hal_chk_bw_cap(_adapter *adapter, u8 cap) -+{ -+ return GET_HAL_SPEC(adapter)->bw_cap & cap; -+} -+ -+inline bool hal_chk_proto_cap(_adapter *adapter, u8 cap) -+{ -+ return GET_HAL_SPEC(adapter)->proto_cap & cap; -+} -+ -+inline bool hal_chk_wl_func(_adapter *adapter, u8 func) -+{ -+ return GET_HAL_SPEC(adapter)->wl_func & func; -+} -+ -+inline bool hal_is_band_support(_adapter *adapter, u8 band) -+{ -+ return GET_HAL_SPEC(adapter)->band_cap & band_to_band_cap(band); -+} -+ -+inline bool hal_is_bw_support(_adapter *adapter, u8 bw) -+{ -+ return GET_HAL_SPEC(adapter)->bw_cap & ch_width_to_bw_cap(bw); -+} -+ -+inline bool hal_is_wireless_mode_support(_adapter *adapter, u8 mode) -+{ -+ u8 proto_cap = GET_HAL_SPEC(adapter)->proto_cap; -+ -+ if (mode == WIRELESS_11B) -+ if ((proto_cap & PROTO_CAP_11B) && hal_chk_band_cap(adapter, BAND_CAP_2G)) -+ return 1; -+ -+ if (mode == WIRELESS_11G) -+ if ((proto_cap & PROTO_CAP_11G) && hal_chk_band_cap(adapter, BAND_CAP_2G)) -+ return 1; -+ -+ if (mode == WIRELESS_11A) -+ if ((proto_cap & PROTO_CAP_11G) && hal_chk_band_cap(adapter, BAND_CAP_5G)) -+ return 1; -+ -+ if (mode == WIRELESS_11_24N) -+ if ((proto_cap & PROTO_CAP_11N) && hal_chk_band_cap(adapter, BAND_CAP_2G)) -+ return 1; -+ -+ if (mode == WIRELESS_11_5N) -+ if ((proto_cap & PROTO_CAP_11N) && hal_chk_band_cap(adapter, BAND_CAP_5G)) -+ return 1; -+ -+ if (mode == WIRELESS_11AC) -+ if ((proto_cap & PROTO_CAP_11AC) && hal_chk_band_cap(adapter, BAND_CAP_5G)) -+ return 1; -+ -+ return 0; -+} -+ -+/* -+* hal_largest_bw - starting from in_bw, get largest bw supported by HAL -+* @adapter: -+* @in_bw: starting bw, value of CHANNEL_WIDTH -+* -+* Returns: value of CHANNEL_WIDTH -+*/ -+u8 hal_largest_bw(_adapter *adapter, u8 in_bw) -+{ -+ for (; in_bw > CHANNEL_WIDTH_20; in_bw--) { -+ if (hal_is_bw_support(adapter, in_bw)) -+ break; -+ } -+ -+ if (!hal_is_bw_support(adapter, in_bw)) -+ rtw_warn_on(1); -+ -+ return in_bw; -+} -+ -+void rtw_hal_correct_tsf(_adapter *padapter, u8 hw_port, u64 tsf) -+{ -+ if (hw_port == HW_PORT0) { -+ /*disable related TSF function*/ -+ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) & (~EN_BCN_FUNCTION)); -+ -+ rtw_write32(padapter, REG_TSFTR, tsf); -+ rtw_write32(padapter, REG_TSFTR + 4, tsf >> 32); -+ -+ /*enable related TSF function*/ -+ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) | EN_BCN_FUNCTION); -+ } else if (hw_port == HW_PORT1) { -+ /*disable related TSF function*/ -+ rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1) & (~EN_BCN_FUNCTION)); -+ -+ rtw_write32(padapter, REG_TSFTR1, tsf); -+ rtw_write32(padapter, REG_TSFTR1 + 4, tsf >> 32); -+ -+ /*enable related TSF function*/ -+ rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1) | EN_BCN_FUNCTION); -+ } else -+ RTW_INFO("%s-[WARN] "ADPT_FMT" invalid hw_port:%d\n", __func__, ADPT_ARG(padapter), hw_port); -+} -+ -+void ResumeTxBeacon(_adapter *padapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ -+ /* 2010.03.01. Marked by tynli. No need to call workitem beacause we record the value */ -+ /* which should be read from register to a global variable. */ -+ -+ -+ pHalData->RegFwHwTxQCtrl |= BIT(6); -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl); -+ rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, 0xff); -+ pHalData->RegReg542 |= BIT(0); -+ rtw_write8(padapter, REG_TBTT_PROHIBIT + 2, pHalData->RegReg542); -+} -+ -+void StopTxBeacon(_adapter *padapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ -+ /* 2010.03.01. Marked by tynli. No need to call workitem beacause we record the value */ -+ /* which should be read from register to a global variable. */ -+ -+ -+ pHalData->RegFwHwTxQCtrl &= ~BIT(6); -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl); -+ rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, 0x64); -+ pHalData->RegReg542 &= ~BIT(0); -+ rtw_write8(padapter, REG_TBTT_PROHIBIT + 2, pHalData->RegReg542); -+ -+ /*CheckFwRsvdPageContent(padapter);*/ /* 2010.06.23. Added by tynli. */ -+} -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM /*HW port0 - MBSS*/ -+void hw_var_set_opmode_mbid(_adapter *Adapter, u8 mode) -+{ -+ RTW_INFO("%s()-"ADPT_FMT" mode = %d\n", __func__, ADPT_ARG(Adapter), mode); -+ -+ rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR) & (~(RCR_CBSSID_DATA | RCR_CBSSID_BCN))); -+ -+ /* disable Port0 TSF update*/ -+ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL) | DIS_TSF_UDT); -+ -+ /* set net_type */ -+ Set_MSR(Adapter, mode); -+ -+ if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { -+ if (!rtw_mi_check_status(Adapter, MI_AP_MODE)) -+ StopTxBeacon(Adapter); -+ -+ rtw_write8(Adapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_ATIM);/*disable atim wnd*/ -+ } else if (mode == _HW_STATE_ADHOC_) { -+ ResumeTxBeacon(Adapter); -+ rtw_write8(Adapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); -+ -+ } else if (mode == _HW_STATE_AP_) { -+ ResumeTxBeacon(Adapter); -+ -+ rtw_write8(Adapter, REG_BCN_CTRL, DIS_TSF_UDT | DIS_BCNQ_SUB); -+ -+ /*enable to rx data frame*/ -+ rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); -+ -+ /*Beacon Control related register for first time*/ -+ rtw_write8(Adapter, REG_BCNDMATIM, 0x02); /* 2ms */ -+ -+ /*rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF);*/ -+ rtw_write8(Adapter, REG_ATIMWND, 0x0a); /* 10ms */ -+ rtw_write16(Adapter, REG_BCNTCFG, 0x00); -+ rtw_write16(Adapter, REG_TBTT_PROHIBIT, 0xff04); -+ rtw_write16(Adapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ -+ -+ /*reset TSF*/ -+ rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(0)); -+ -+ /*enable BCN0 Function for if1*/ -+ /*don't enable update TSF0 for if1 (due to TSF update when beacon,probe rsp are received)*/ -+ rtw_write8(Adapter, REG_BCN_CTRL, (DIS_TSF_UDT | EN_BCN_FUNCTION | EN_TXBCN_RPT | DIS_BCNQ_SUB)); -+ -+ if (IS_HARDWARE_TYPE_8821(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter))/* select BCN on port 0 for DualBeacon*/ -+ rtw_write8(Adapter, REG_CCK_CHECK, rtw_read8(Adapter, REG_CCK_CHECK) & (~BIT_BCN_PORT_SEL)); -+ -+ } -+ -+} -+#endif -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+u8 rtw_hal_antdiv_before_linked(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 cur_ant, change_ant; -+ -+ if (!pHalData->AntDivCfg) -+ return _FALSE; -+ -+ if (pHalData->sw_antdiv_bl_state == 0) { -+ pHalData->sw_antdiv_bl_state = 1; -+ -+ rtw_hal_get_odm_var(padapter, HAL_ODM_ANTDIV_SELECT, &cur_ant, NULL); -+ change_ant = (cur_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; -+ -+ return rtw_antenna_select_cmd(padapter, change_ant, _FALSE); -+ } -+ -+ pHalData->sw_antdiv_bl_state = 0; -+ return _FALSE; -+} -+ -+void rtw_hal_antdiv_rssi_compared(_adapter *padapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (pHalData->AntDivCfg) { -+ /*RTW_INFO("update_network=> org-RSSI(%d), new-RSSI(%d)\n", dst->Rssi, src->Rssi);*/ -+ /*select optimum_antenna for before linked =>For antenna diversity*/ -+ if (dst->Rssi >= src->Rssi) {/*keep org parameter*/ -+ src->Rssi = dst->Rssi; -+ src->PhyInfo.Optimum_antenna = dst->PhyInfo.Optimum_antenna; -+ } -+ } -+} -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_com_c2h.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_com_c2h.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_com_c2h.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_com_c2h.h 2018-02-11 21:44:27.151146147 +0200 -@@ -0,0 +1,117 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __COMMON_C2H_H__ -+#define __COMMON_C2H_H__ -+ -+#define C2H_TYPE_REG 0 -+#define C2H_TYPE_PKT 1 -+ -+/* -+* C2H event format: -+* Fields TRIGGER PAYLOAD SEQ PLEN ID -+* BITS [127:120] [119:16] [15:8] [7:4] [3:0] -+*/ -+#define C2H_ID(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)), 0, 4) -+#define C2H_PLEN(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)), 4, 4) -+#define C2H_SEQ(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)) + 1, 0, 8) -+#define C2H_PAYLOAD(_c2h) (((u8*)(_c2h)) + 2) -+ -+#define SET_C2H_ID(_c2h, _val) SET_BITS_TO_LE_1BYTE(((u8*)(_c2h)), 0, 4, _val) -+#define SET_C2H_PLEN(_c2h, _val) SET_BITS_TO_LE_1BYTE(((u8*)(_c2h)), 4, 4, _val) -+#define SET_C2H_SEQ(_c2h, _val) SET_BITS_TO_LE_1BYTE(((u8*)(_c2h)) + 1 , 0, 8, _val) -+ -+/* -+* C2H event format: -+* Fields TRIGGER PLEN PAYLOAD SEQ ID -+* BITS [127:120] [119:112] [111:16] [15:8] [7:0] -+*/ -+#define C2H_ID_88XX(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)), 0, 8) -+#define C2H_SEQ_88XX(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)) + 1, 0, 8) -+#define C2H_PAYLOAD_88XX(_c2h) (((u8*)(_c2h)) + 2) -+#define C2H_PLEN_88XX(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)) + 14, 0, 8) -+#define C2H_TRIGGER_88XX(_c2h) LE_BITS_TO_1BYTE(((u8*)(_c2h)) + 15, 0, 8) -+ -+#define SET_C2H_ID_88XX(_c2h, _val) SET_BITS_TO_LE_1BYTE(((u8*)(_c2h)), 0, 8, _val) -+#define SET_C2H_SEQ_88XX(_c2h, _val) SET_BITS_TO_LE_1BYTE(((u8*)(_c2h)) + 1, 0, 8, _val) -+#define SET_C2H_PLEN_88XX(_c2h, _val) SET_BITS_TO_LE_1BYTE(((u8*)(_c2h)) + 14, 0, 8, _val) -+ -+typedef enum _C2H_EVT { -+ C2H_DBG = 0x00, -+ C2H_LB = 0x01, -+ C2H_TXBF = 0x02, -+ C2H_CCX_TX_RPT = 0x03, -+ C2H_FW_SCAN_COMPLETE = 0x7, -+ C2H_BT_INFO = 0x09, -+ C2H_BT_MP_INFO = 0x0B, -+ C2H_RA_RPT = 0x0C, -+ C2H_RA_PARA_RPT = 0x0E, -+ C2H_FW_CHNL_SWITCH_COMPLETE = 0x10, -+ C2H_IQK_FINISH = 0x11, -+ C2H_MAILBOX_STATUS = 0x15, -+ C2H_P2P_RPORT = 0x16, -+ C2H_MCC = 0x17, -+ C2H_MAC_HIDDEN_RPT = 0x19, -+ C2H_MAC_HIDDEN_RPT_2 = 0x1A, -+ C2H_BCN_EARLY_RPT = 0x1E, -+ C2H_DEFEATURE_DBG = 0x22, -+ C2H_CUSTOMER_STR_RPT = 0x24, -+ C2H_CUSTOMER_STR_RPT_2 = 0x25, -+ C2H_DEFEATURE_RSVD = 0xFD, -+ C2H_EXTEND = 0xff, -+} C2H_EVT; -+ -+typedef enum _EXTEND_C2H_EVT { -+ EXTEND_C2H_DBG_PRINT = 0 -+} EXTEND_C2H_EVT; -+ -+#define C2H_REG_LEN 16 -+ -+/* C2H_IQK_FINISH, 0x11 */ -+#define IQK_OFFLOAD_LEN 1 -+void c2h_iqk_offload(_adapter *adapter, u8 *data, u8 len); -+int c2h_iqk_offload_wait(_adapter *adapter, u32 timeout_ms); -+#define rtl8812_iqk_wait c2h_iqk_offload_wait /* TODO: remove this after phydm call c2h_iqk_offload_wait instead */ -+ -+#ifdef CONFIG_RTW_MAC_HIDDEN_RPT -+/* C2H_MAC_HIDDEN_RPT, 0x19 */ -+#define MAC_HIDDEN_RPT_LEN 8 -+int c2h_mac_hidden_rpt_hdl(_adapter *adapter, u8 *data, u8 len); -+ -+/* C2H_MAC_HIDDEN_RPT_2, 0x1A */ -+#define MAC_HIDDEN_RPT_2_LEN 5 -+int c2h_mac_hidden_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len); -+int hal_read_mac_hidden_rpt(_adapter *adapter); -+#endif /* CONFIG_RTW_MAC_HIDDEN_RPT */ -+ -+/* C2H_DEFEATURE_DBG, 0x22 */ -+#define DEFEATURE_DBG_LEN 1 -+int c2h_defeature_dbg_hdl(_adapter *adapter, u8 *data, u8 len); -+ -+#ifdef CONFIG_RTW_CUSTOMER_STR -+/* C2H_CUSTOMER_STR_RPT, 0x24 */ -+#define CUSTOMER_STR_RPT_LEN 8 -+int c2h_customer_str_rpt_hdl(_adapter *adapter, u8 *data, u8 len); -+ -+/* C2H_CUSTOMER_STR_RPT_2, 0x25 */ -+#define CUSTOMER_STR_RPT_2_LEN 8 -+int c2h_customer_str_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len); -+#endif /* CONFIG_RTW_CUSTOMER_STR */ -+ -+#endif /* __COMMON_C2H_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_com_phycfg.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_com_phycfg.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_com_phycfg.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_com_phycfg.c 2018-02-11 21:44:27.152146162 +0200 -@@ -0,0 +1,5452 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _HAL_COM_PHYCFG_C_ -+ -+#include -+#include -+ -+#define PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) (((_pg_v) & 0xf0) >> 4) -+#define PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) ((_pg_v) & 0x0f) -+#define PG_TXPWR_MSB_DIFF_TO_S8BIT(_pg_v) ((PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) & BIT3) ? (PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) | 0xF0) : PG_TXPWR_MSB_DIFF_S4BIT(_pg_v)) -+#define PG_TXPWR_LSB_DIFF_TO_S8BIT(_pg_v) ((PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) & BIT3) ? (PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) | 0xF0) : PG_TXPWR_LSB_DIFF_S4BIT(_pg_v)) -+#define IS_PG_TXPWR_BASE_INVALID(_base) ((_base) > 63) -+#define IS_PG_TXPWR_DIFF_INVALID(_diff) ((_diff) > 7 || (_diff) < -8) -+#define PG_TXPWR_INVALID_BASE 255 -+#define PG_TXPWR_INVALID_DIFF 8 -+ -+#if !IS_PG_TXPWR_BASE_INVALID(PG_TXPWR_INVALID_BASE) -+#error "PG_TXPWR_BASE definition has problem" -+#endif -+ -+#if !IS_PG_TXPWR_DIFF_INVALID(PG_TXPWR_INVALID_DIFF) -+#error "PG_TXPWR_DIFF definition has problem" -+#endif -+ -+#define PG_TXPWR_SRC_PG_DATA 0 -+#define PG_TXPWR_SRC_IC_DEF 1 -+#define PG_TXPWR_SRC_DEF 2 -+#define PG_TXPWR_SRC_NUM 3 -+ -+const char *const _pg_txpwr_src_str[] = { -+ "PG_DATA", -+ "IC_DEF", -+ "DEF", -+ "UNKNOWN" -+}; -+ -+#define pg_txpwr_src_str(src) (((src) >= PG_TXPWR_SRC_NUM) ? _pg_txpwr_src_str[PG_TXPWR_SRC_NUM] : _pg_txpwr_src_str[(src)]) -+ -+#ifndef DBG_PG_TXPWR_READ -+#define DBG_PG_TXPWR_READ 0 -+#endif -+ -+void dump_pg_txpwr_info_2g(void *sel, TxPowerInfo24G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt) -+{ -+ int path, group, tx_idx; -+ -+ RTW_PRINT_SEL(sel, "2.4G\n"); -+ RTW_PRINT_SEL(sel, "CCK-1T base:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (group = 0; group < MAX_CHNL_GROUP_24G; group++) -+ _RTW_PRINT_SEL(sel, "G%02d ", group); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (group = 0; group < MAX_CHNL_GROUP_24G; group++) -+ _RTW_PRINT_SEL(sel, "%3u ", txpwr_info->IndexCCK_Base[path][group]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "CCK diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) -+ _RTW_PRINT_SEL(sel, "%dT ", path + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->CCK_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW40-1S base:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++) -+ _RTW_PRINT_SEL(sel, "G%02d ", group); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++) -+ _RTW_PRINT_SEL(sel, "%3u ", txpwr_info->IndexBW40_Base[path][group]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "OFDM diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) -+ _RTW_PRINT_SEL(sel, "%dT ", path + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->OFDM_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW20 diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) -+ _RTW_PRINT_SEL(sel, "%dS ", path + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW20_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW40 diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) -+ _RTW_PRINT_SEL(sel, "%dS ", path + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW40_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+} -+ -+void dump_pg_txpwr_info_5g(void *sel, TxPowerInfo5G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt) -+{ -+ int path, group, tx_idx; -+ -+ RTW_PRINT_SEL(sel, "5G\n"); -+ RTW_PRINT_SEL(sel, "BW40-1S base:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (group = 0; group < MAX_CHNL_GROUP_5G; group++) -+ _RTW_PRINT_SEL(sel, "G%02d ", group); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (group = 0; group < MAX_CHNL_GROUP_5G; group++) -+ _RTW_PRINT_SEL(sel, "%3u ", txpwr_info->IndexBW40_Base[path][group]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "OFDM diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) -+ _RTW_PRINT_SEL(sel, "%dT ", path + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->OFDM_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW20 diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) -+ _RTW_PRINT_SEL(sel, "%dS ", path + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW20_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW40 diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) -+ _RTW_PRINT_SEL(sel, "%dS ", path + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW40_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW80 diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) -+ _RTW_PRINT_SEL(sel, "%dS ", path + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW80_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW160 diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) -+ _RTW_PRINT_SEL(sel, "%dS ", path + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW160_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+} -+ -+const struct map_t pg_txpwr_def_info = -+ MAP_ENT(0xB8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 168, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE, -+ 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, -+ 0x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, -+ 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, -+ 0xEE, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, -+ 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, -+ 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, -+ 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE, -+ 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE) -+ ); -+ -+#ifdef CONFIG_RTL8188E -+static const struct map_t rtl8188e_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 12, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24) -+ ); -+#endif -+ -+#ifdef CONFIG_RTL8188F -+static const struct map_t rtl8188f_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 12, -+ 0x22, 0x22, 0x22, 0x22, 0x22, 0x22, 0x27, 0x27, 0x27, 0x27, 0x27, 0x24) -+ ); -+#endif -+ -+#ifdef CONFIG_RTL8723B -+static const struct map_t rtl8723b_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 2, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 12, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0xE0) -+ , MAPSEG_ARRAY_ENT(0x3A, 12, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0xE0) -+ ); -+#endif -+ -+#ifdef CONFIG_RTL8703B -+static const struct map_t rtl8703b_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 12, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02) -+ ); -+#endif -+ -+#ifdef CONFIG_RTL8723D -+static const struct map_t rtl8723d_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 2, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 12, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02) -+ , MAPSEG_ARRAY_ENT(0x3A, 12, -+ 0x22, 0x22, 0x22, 0x22, 0x22, 0x22, 0x21, 0x21, 0x21, 0x21, 0x21, 0x02) -+ ); -+#endif -+ -+#ifdef CONFIG_RTL8192E -+static const struct map_t rtl8192e_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 2, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 14, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE) -+ , MAPSEG_ARRAY_ENT(0x3A, 14, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE) -+ ); -+#endif -+ -+#ifdef CONFIG_RTL8821A -+static const struct map_t rtl8821a_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 39, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xFF, 0xFF, 0xFF, 0xFF, -+ 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, -+ 0x04, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00) -+ ); -+#endif -+ -+#ifdef CONFIG_RTL8821C -+static const struct map_t rtl8821c_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 54, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xFF, 0xFF, 0xFF, 0xFF, -+ 0xFF, 0xFF, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, -+ 0x02, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xEC, 0xFF, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02) -+ ); -+#endif -+ -+#ifdef CONFIG_RTL8812A -+static const struct map_t rtl8812a_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 82, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, -+ 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, -+ 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, 0x00, 0xEE, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, -+ 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, -+ 0x00, 0xEE) -+ ); -+#endif -+ -+#ifdef CONFIG_RTL8822B -+static const struct map_t rtl8822b_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 82, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, -+ 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, -+ 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, 0xEC, 0xEC, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, -+ 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, -+ 0xEC, 0xEC) -+ ); -+#endif -+ -+#ifdef CONFIG_RTL8814A -+static const struct map_t rtl8814a_pg_txpwr_def_info = -+ MAP_ENT(0xB8, 1, 0xFF -+ , MAPSEG_ARRAY_ENT(0x10, 168, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, -+ 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, -+ 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, -+ 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, -+ 0x00, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, -+ 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, -+ 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, -+ 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, -+ 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, -+ 0xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE) -+ ); -+#endif -+ -+const struct map_t *hal_pg_txpwr_def_info(_adapter *adapter) -+{ -+ u8 interface_type = 0; -+ const struct map_t *map = NULL; -+ -+ interface_type = rtw_get_intf_type(adapter); -+ -+ switch (rtw_get_chip_type(adapter)) { -+#ifdef CONFIG_RTL8723B -+ case RTL8723B: -+ map = &rtl8723b_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8703B -+ case RTL8703B: -+ map = &rtl8703b_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8723D -+ case RTL8723D: -+ map = &rtl8723d_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8188E -+ case RTL8188E: -+ map = &rtl8188e_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8188F -+ case RTL8188F: -+ map = &rtl8188f_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8812A -+ case RTL8812: -+ map = &rtl8812a_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8821A -+ case RTL8821: -+ map = &rtl8821a_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8192E -+ case RTL8192E: -+ map = &rtl8192e_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8814A -+ case RTL8814A: -+ map = &rtl8814a_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8822B -+ case RTL8822B: -+ map = &rtl8822b_pg_txpwr_def_info; -+ break; -+#endif -+#ifdef CONFIG_RTL8821C -+ case RTL8821C: -+ map = &rtl8821c_pg_txpwr_def_info; -+ break; -+#endif -+ } -+ -+ if (map == NULL) { -+ RTW_ERR("%s: unknown chip_type:%u\n" -+ , __func__, rtw_get_chip_type(adapter)); -+ rtw_warn_on(1); -+ } -+ -+ return map; -+} -+ -+static u8 hal_chk_pg_txpwr_info_2g(_adapter *adapter, TxPowerInfo24G *pwr_info) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u8 path, group, tx_idx; -+ -+ if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_2G)) -+ return _SUCCESS; -+ -+ for (path = 0; path < MAX_RF_PATH; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) -+ continue; -+ for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { -+ if (IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexCCK_Base[path][group]) -+ || IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexBW40_Base[path][group])) -+ return _FAIL; -+ } -+ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { -+ if (!HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) -+ continue; -+ if (IS_PG_TXPWR_DIFF_INVALID(pwr_info->CCK_Diff[path][tx_idx]) -+ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) -+ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) -+ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx])) -+ return _FAIL; -+ } -+ } -+ -+ return _SUCCESS; -+} -+ -+static u8 hal_chk_pg_txpwr_info_5g(_adapter *adapter, TxPowerInfo5G *pwr_info) -+{ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u8 path, group, tx_idx; -+ -+ if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_5G)) -+ return _SUCCESS; -+ -+ for (path = 0; path < MAX_RF_PATH; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) -+ continue; -+ for (group = 0; group < MAX_CHNL_GROUP_5G; group++) -+ if (IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexBW40_Base[path][group])) -+ return _FAIL; -+ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { -+ if (!HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) -+ continue; -+ if (IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) -+ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) -+ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx]) -+ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW80_Diff[path][tx_idx]) -+ || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW160_Diff[path][tx_idx])) -+ return _FAIL; -+ } -+ } -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ return _SUCCESS; -+} -+ -+static inline void hal_init_pg_txpwr_info_2g(_adapter *adapter, TxPowerInfo24G *pwr_info) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u8 path, group, tx_idx; -+ -+ if (pwr_info == NULL) -+ return; -+ -+ _rtw_memset(pwr_info, 0, sizeof(TxPowerInfo24G)); -+ -+ /* init with invalid value */ -+ for (path = 0; path < MAX_RF_PATH; path++) { -+ for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { -+ pwr_info->IndexCCK_Base[path][group] = PG_TXPWR_INVALID_BASE; -+ pwr_info->IndexBW40_Base[path][group] = PG_TXPWR_INVALID_BASE; -+ } -+ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { -+ pwr_info->CCK_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; -+ pwr_info->OFDM_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; -+ pwr_info->BW20_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; -+ pwr_info->BW40_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; -+ } -+ } -+ -+ /* init for dummy base and diff */ -+ for (path = 0; path < MAX_RF_PATH; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) -+ break; -+ /* 2.4G BW40 base has 1 less group than CCK base*/ -+ pwr_info->IndexBW40_Base[path][MAX_CHNL_GROUP_24G - 1] = 0; -+ -+ /* dummy diff */ -+ pwr_info->CCK_Diff[path][0] = 0; /* 2.4G CCK-1TX */ -+ pwr_info->BW40_Diff[path][0] = 0; /* 2.4G BW40-1S */ -+ } -+} -+ -+static inline void hal_init_pg_txpwr_info_5g(_adapter *adapter, TxPowerInfo5G *pwr_info) -+{ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u8 path, group, tx_idx; -+ -+ if (pwr_info == NULL) -+ return; -+ -+ _rtw_memset(pwr_info, 0, sizeof(TxPowerInfo5G)); -+ -+ /* init with invalid value */ -+ for (path = 0; path < MAX_RF_PATH; path++) { -+ for (group = 0; group < MAX_CHNL_GROUP_5G; group++) -+ pwr_info->IndexBW40_Base[path][group] = PG_TXPWR_INVALID_BASE; -+ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { -+ pwr_info->OFDM_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; -+ pwr_info->BW20_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; -+ pwr_info->BW40_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; -+ pwr_info->BW80_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; -+ pwr_info->BW160_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; -+ } -+ } -+ -+ for (path = 0; path < MAX_RF_PATH; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) -+ break; -+ /* dummy diff */ -+ pwr_info->BW40_Diff[path][0] = 0; /* 5G BW40-1S */ -+ } -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+} -+ -+#if DBG_PG_TXPWR_READ -+#define LOAD_PG_TXPWR_WARN_COND(_txpwr_src) 1 -+#else -+#define LOAD_PG_TXPWR_WARN_COND(_txpwr_src) (_txpwr_src > PG_TXPWR_SRC_PG_DATA) -+#endif -+ -+u16 hal_load_pg_txpwr_info_path_2g( -+ _adapter *adapter, -+ TxPowerInfo24G *pwr_info, -+ u32 path, -+ u8 txpwr_src, -+ const struct map_t *txpwr_map, -+ u16 pg_offset) -+{ -+#define PG_TXPWR_1PATH_BYTE_NUM_2G 18 -+ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u16 offset = pg_offset; -+ u8 group, tx_idx; -+ u8 val; -+ u8 tmp_base; -+ s8 tmp_diff; -+ -+ if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_2G)) { -+ offset += PG_TXPWR_1PATH_BYTE_NUM_2G; -+ goto exit; -+ } -+ -+ if (DBG_PG_TXPWR_READ) -+ RTW_INFO("%s [%c] offset:0x%03x\n", __func__, rf_path_char(path), offset); -+ -+ for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { -+ if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) { -+ tmp_base = map_read8(txpwr_map, offset); -+ if (!IS_PG_TXPWR_BASE_INVALID(tmp_base) -+ && IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexCCK_Base[path][group]) -+ ) { -+ pwr_info->IndexCCK_Base[path][group] = tmp_base; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 2G G%02d CCK-1T base:%u from %s\n", rf_path_char(path), group, tmp_base, pg_txpwr_src_str(txpwr_src)); -+ } -+ } -+ offset++; -+ } -+ -+ for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++) { -+ if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) { -+ tmp_base = map_read8(txpwr_map, offset); -+ if (!IS_PG_TXPWR_BASE_INVALID(tmp_base) -+ && IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexBW40_Base[path][group]) -+ ) { -+ pwr_info->IndexBW40_Base[path][group] = tmp_base; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 2G G%02d BW40-1S base:%u from %s\n", rf_path_char(path), group, tmp_base, pg_txpwr_src_str(txpwr_src)); -+ } -+ } -+ offset++; -+ } -+ -+ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { -+ if (tx_idx == 0) { -+ if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) { -+ val = map_read8(txpwr_map, offset); -+ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) -+ ) { -+ pwr_info->BW20_Diff[path][tx_idx] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 2G BW20-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) -+ ) { -+ pwr_info->OFDM_Diff[path][tx_idx] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 2G OFDM-%dT diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ } -+ offset++; -+ } else { -+ if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) { -+ val = map_read8(txpwr_map, offset); -+ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx]) -+ ) { -+ pwr_info->BW40_Diff[path][tx_idx] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 2G BW40-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ -+ } -+ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) -+ ) { -+ pwr_info->BW20_Diff[path][tx_idx] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 2G BW20-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ } -+ offset++; -+ -+ if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) { -+ val = map_read8(txpwr_map, offset); -+ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) -+ ) { -+ pwr_info->OFDM_Diff[path][tx_idx] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 2G OFDM-%dT diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->CCK_Diff[path][tx_idx]) -+ ) { -+ pwr_info->CCK_Diff[path][tx_idx] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 2G CCK-%dT diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ } -+ offset++; -+ } -+ } -+ -+ if (offset != pg_offset + PG_TXPWR_1PATH_BYTE_NUM_2G) { -+ RTW_ERR("%s parse %d bytes != %d\n", __func__, offset - pg_offset, PG_TXPWR_1PATH_BYTE_NUM_2G); -+ rtw_warn_on(1); -+ } -+ -+exit: -+ return offset; -+} -+ -+u16 hal_load_pg_txpwr_info_path_5g( -+ _adapter *adapter, -+ TxPowerInfo5G *pwr_info, -+ u32 path, -+ u8 txpwr_src, -+ const struct map_t *txpwr_map, -+ u16 pg_offset) -+{ -+#define PG_TXPWR_1PATH_BYTE_NUM_5G 24 -+ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u16 offset = pg_offset; -+ u8 group, tx_idx; -+ u8 val; -+ u8 tmp_base; -+ s8 tmp_diff; -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_5G)) -+#endif -+ { -+ offset += PG_TXPWR_1PATH_BYTE_NUM_5G; -+ goto exit; -+ } -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ if (DBG_PG_TXPWR_READ) -+ RTW_INFO("%s[%c] eaddr:0x%03x\n", __func__, rf_path_char(path), offset); -+ -+ for (group = 0; group < MAX_CHNL_GROUP_5G; group++) { -+ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) { -+ tmp_base = map_read8(txpwr_map, offset); -+ if (!IS_PG_TXPWR_BASE_INVALID(tmp_base) -+ && IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexBW40_Base[path][group]) -+ ) { -+ pwr_info->IndexBW40_Base[path][group] = tmp_base; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 5G G%02d BW40-1S base:%u from %s\n", rf_path_char(path), group, tmp_base, pg_txpwr_src_str(txpwr_src)); -+ } -+ } -+ offset++; -+ } -+ -+ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { -+ if (tx_idx == 0) { -+ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) { -+ val = map_read8(txpwr_map, offset); -+ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) -+ ) { -+ pwr_info->BW20_Diff[path][tx_idx] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 5G BW20-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) -+ ) { -+ pwr_info->OFDM_Diff[path][tx_idx] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ } -+ offset++; -+ } else { -+ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) { -+ val = map_read8(txpwr_map, offset); -+ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx]) -+ ) { -+ pwr_info->BW40_Diff[path][tx_idx] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 5G BW40-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) -+ ) { -+ pwr_info->BW20_Diff[path][tx_idx] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 5G BW20-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ } -+ offset++; -+ } -+ } -+ -+ /* OFDM diff 2T ~ 3T */ -+ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, 1)) { -+ val = map_read8(txpwr_map, offset); -+ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][1]) -+ ) { -+ pwr_info->OFDM_Diff[path][1] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), 2, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ if (HAL_SPEC_CHK_TX_CNT(hal_spec, 2)) { -+ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][2]) -+ ) { -+ pwr_info->OFDM_Diff[path][2] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), 3, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ } -+ } -+ offset++; -+ -+ /* OFDM diff 4T */ -+ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, 3)) { -+ val = map_read8(txpwr_map, offset); -+ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][3]) -+ ) { -+ pwr_info->OFDM_Diff[path][3] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), 4, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ } -+ offset++; -+ -+ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { -+ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) { -+ val = map_read8(txpwr_map, offset); -+ tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW80_Diff[path][tx_idx]) -+ ) { -+ pwr_info->BW80_Diff[path][tx_idx] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 5G BW80-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); -+ if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) -+ && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW160_Diff[path][tx_idx]) -+ ) { -+ pwr_info->BW160_Diff[path][tx_idx] = tmp_diff; -+ if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) -+ RTW_INFO("[%c] 5G BW160-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); -+ } -+ } -+ offset++; -+ } -+ -+ if (offset != pg_offset + PG_TXPWR_1PATH_BYTE_NUM_5G) { -+ RTW_ERR("%s parse %d bytes != %d\n", __func__, offset - pg_offset, PG_TXPWR_1PATH_BYTE_NUM_5G); -+ rtw_warn_on(1); -+ } -+ -+#endif /* #ifdef CONFIG_IEEE80211_BAND_5GHZ */ -+ -+exit: -+ return offset; -+} -+ -+void hal_load_pg_txpwr_info( -+ _adapter *adapter, -+ TxPowerInfo24G *pwr_info_2g, -+ TxPowerInfo5G *pwr_info_5g, -+ u8 *pg_data, -+ BOOLEAN AutoLoadFail -+) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u8 path; -+ u16 pg_offset; -+ u8 txpwr_src = PG_TXPWR_SRC_PG_DATA; -+ struct map_t pg_data_map = MAP_ENT(184, 1, 0xFF, MAPSEG_PTR_ENT(0x00, 184, pg_data)); -+ const struct map_t *txpwr_map = NULL; -+ -+ /* init with invalid value and some dummy base and diff */ -+ hal_init_pg_txpwr_info_2g(adapter, pwr_info_2g); -+ hal_init_pg_txpwr_info_5g(adapter, pwr_info_5g); -+ -+select_src: -+ pg_offset = 0x10; -+ -+ switch (txpwr_src) { -+ case PG_TXPWR_SRC_PG_DATA: -+ txpwr_map = &pg_data_map; -+ break; -+ case PG_TXPWR_SRC_IC_DEF: -+ txpwr_map = hal_pg_txpwr_def_info(adapter); -+ break; -+ case PG_TXPWR_SRC_DEF: -+ default: -+ txpwr_map = &pg_txpwr_def_info; -+ break; -+ }; -+ -+ if (txpwr_map == NULL) -+ goto end_parse; -+ -+ for (path = 0; path < MAX_RF_PATH ; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && !HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) -+ break; -+ pg_offset = hal_load_pg_txpwr_info_path_2g(adapter, pwr_info_2g, path, txpwr_src, txpwr_map, pg_offset); -+ pg_offset = hal_load_pg_txpwr_info_path_5g(adapter, pwr_info_5g, path, txpwr_src, txpwr_map, pg_offset); -+ } -+ -+ if (hal_chk_pg_txpwr_info_2g(adapter, pwr_info_2g) == _SUCCESS -+ && hal_chk_pg_txpwr_info_5g(adapter, pwr_info_5g) == _SUCCESS) -+ goto exit; -+ -+end_parse: -+ txpwr_src++; -+ if (txpwr_src < PG_TXPWR_SRC_NUM) -+ goto select_src; -+ -+ if (hal_chk_pg_txpwr_info_2g(adapter, pwr_info_2g) != _SUCCESS -+ || hal_chk_pg_txpwr_info_5g(adapter, pwr_info_5g) != _SUCCESS) -+ rtw_warn_on(1); -+ -+exit: -+ if (DBG_PG_TXPWR_READ) { -+ if (pwr_info_2g) -+ dump_pg_txpwr_info_2g(RTW_DBGDUMP, pwr_info_2g, 4, 4); -+ if (pwr_info_5g) -+ dump_pg_txpwr_info_5g(RTW_DBGDUMP, pwr_info_5g, 4, 4); -+ } -+ -+ return; -+} -+ -+void hal_load_txpwr_info( -+ _adapter *adapter, -+ TxPowerInfo24G *pwr_info_2g, -+ TxPowerInfo5G *pwr_info_5g, -+ u8 *pg_data -+) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u8 max_tx_cnt = hal_spec->max_tx_cnt; -+ u8 rfpath, ch_idx, group, tx_idx; -+ -+ /* load from pg data (or default value) */ -+ hal_load_pg_txpwr_info(adapter, pwr_info_2g, pwr_info_5g, pg_data, _FALSE); -+ -+ /* transform to hal_data */ -+ for (rfpath = 0; rfpath < MAX_RF_PATH; rfpath++) { -+ -+ if (!pwr_info_2g || !HAL_SPEC_CHK_RF_PATH_2G(hal_spec, rfpath)) -+ goto bypass_2g; -+ -+ /* 2.4G base */ -+ for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) { -+ u8 cck_group; -+ -+ if (rtw_get_ch_group(ch_idx + 1, &group, &cck_group) != BAND_ON_2_4G) -+ continue; -+ -+ hal_data->Index24G_CCK_Base[rfpath][ch_idx] = pwr_info_2g->IndexCCK_Base[rfpath][cck_group]; -+ hal_data->Index24G_BW40_Base[rfpath][ch_idx] = pwr_info_2g->IndexBW40_Base[rfpath][group]; -+ } -+ -+ /* 2.4G diff */ -+ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { -+ if (tx_idx >= max_tx_cnt) -+ break; -+ -+ hal_data->CCK_24G_Diff[rfpath][tx_idx] = pwr_info_2g->CCK_Diff[rfpath][tx_idx]; -+ hal_data->OFDM_24G_Diff[rfpath][tx_idx] = pwr_info_2g->OFDM_Diff[rfpath][tx_idx]; -+ hal_data->BW20_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW20_Diff[rfpath][tx_idx]; -+ hal_data->BW40_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW40_Diff[rfpath][tx_idx]; -+ } -+bypass_2g: -+ ; -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ if (!pwr_info_5g || !HAL_SPEC_CHK_RF_PATH_5G(hal_spec, rfpath)) -+ goto bypass_5g; -+ -+ /* 5G base */ -+ for (ch_idx = 0; ch_idx < CENTER_CH_5G_ALL_NUM; ch_idx++) { -+ if (rtw_get_ch_group(center_ch_5g_all[ch_idx], &group, NULL) != BAND_ON_5G) -+ continue; -+ hal_data->Index5G_BW40_Base[rfpath][ch_idx] = pwr_info_5g->IndexBW40_Base[rfpath][group]; -+ } -+ -+ for (ch_idx = 0 ; ch_idx < CENTER_CH_5G_80M_NUM; ch_idx++) { -+ u8 upper, lower; -+ -+ if (rtw_get_ch_group(center_ch_5g_80m[ch_idx], &group, NULL) != BAND_ON_5G) -+ continue; -+ -+ upper = pwr_info_5g->IndexBW40_Base[rfpath][group]; -+ lower = pwr_info_5g->IndexBW40_Base[rfpath][group + 1]; -+ hal_data->Index5G_BW80_Base[rfpath][ch_idx] = (upper + lower) / 2; -+ } -+ -+ /* 5G diff */ -+ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { -+ if (tx_idx >= max_tx_cnt) -+ break; -+ -+ hal_data->OFDM_5G_Diff[rfpath][tx_idx] = pwr_info_5g->OFDM_Diff[rfpath][tx_idx]; -+ hal_data->BW20_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW20_Diff[rfpath][tx_idx]; -+ hal_data->BW40_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW40_Diff[rfpath][tx_idx]; -+ hal_data->BW80_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW80_Diff[rfpath][tx_idx]; -+ } -+bypass_5g: -+ ; -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ } -+} -+ -+void dump_hal_txpwr_info_2g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int path, ch_idx, tx_idx; -+ -+ RTW_PRINT_SEL(sel, "2.4G\n"); -+ RTW_PRINT_SEL(sel, "CCK-1T base:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", center_ch_2g[ch_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) -+ _RTW_PRINT_SEL(sel, "%2u ", hal_data->Index24G_CCK_Base[path][ch_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "CCK diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%dT ", tx_idx + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", hal_data->CCK_24G_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW40-1S base:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", center_ch_2g[ch_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) -+ _RTW_PRINT_SEL(sel, "%2u ", hal_data->Index24G_BW40_Base[path][ch_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "OFDM diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%dT ", tx_idx + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", hal_data->OFDM_24G_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW20 diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW20_24G_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW40 diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW40_24G_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+} -+ -+void dump_hal_txpwr_info_5g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt) -+{ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int path, ch_idx, tx_idx; -+ u8 dump_section = 0; -+ u8 ch_idx_s = 0; -+ -+ RTW_PRINT_SEL(sel, "5G\n"); -+ RTW_PRINT_SEL(sel, "BW40-1S base:\n"); -+ do { -+ #define DUMP_5G_BW40_BASE_SECTION_NUM 3 -+ u8 end[DUMP_5G_BW40_BASE_SECTION_NUM] = {64, 144, 177}; -+ -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (ch_idx = ch_idx_s; ch_idx < CENTER_CH_5G_ALL_NUM; ch_idx++) { -+ _RTW_PRINT_SEL(sel, "%3d ", center_ch_5g_all[ch_idx]); -+ if (end[dump_section] == center_ch_5g_all[ch_idx]) -+ break; -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (ch_idx = ch_idx_s; ch_idx < CENTER_CH_5G_ALL_NUM; ch_idx++) { -+ _RTW_PRINT_SEL(sel, "%3u ", hal_data->Index5G_BW40_Base[path][ch_idx]); -+ if (end[dump_section] == center_ch_5g_all[ch_idx]) -+ break; -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ ch_idx_s = ch_idx + 1; -+ dump_section++; -+ if (dump_section >= DUMP_5G_BW40_BASE_SECTION_NUM) -+ break; -+ } while (1); -+ -+ RTW_PRINT_SEL(sel, "BW80-1S base:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (ch_idx = 0; ch_idx < CENTER_CH_5G_80M_NUM; ch_idx++) -+ _RTW_PRINT_SEL(sel, "%3d ", center_ch_5g_80m[ch_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (ch_idx = 0; ch_idx < CENTER_CH_5G_80M_NUM; ch_idx++) -+ _RTW_PRINT_SEL(sel, "%3u ", hal_data->Index5G_BW80_Base[path][ch_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "OFDM diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%dT ", tx_idx + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", hal_data->OFDM_5G_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW20 diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW20_5G_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW40 diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW40_5G_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ RTW_PRINT_SEL(sel, "BW80 diff:\n"); -+ RTW_PRINT_SEL(sel, "%4s ", ""); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); -+ _RTW_PRINT_SEL(sel, "\n"); -+ for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { -+ RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); -+ for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) -+ _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW80_5G_Diff[path][tx_idx]); -+ _RTW_PRINT_SEL(sel, "\n"); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+} -+ -+/* -+* rtw_regsty_get_target_tx_power - -+* -+* Return dBm or -1 for undefined -+*/ -+s8 rtw_regsty_get_target_tx_power( -+ IN PADAPTER Adapter, -+ IN u8 Band, -+ IN u8 RfPath, -+ IN RATE_SECTION RateSection -+) -+{ -+ struct registry_priv *regsty = adapter_to_regsty(Adapter); -+ s8 value = 0; -+ -+ if (RfPath > RF_PATH_D) { -+ RTW_PRINT("%s invalid RfPath:%d\n", __func__, RfPath); -+ return -1; -+ } -+ -+ if (Band != BAND_ON_2_4G -+ #ifdef CONFIG_IEEE80211_BAND_5GHZ -+ && Band != BAND_ON_5G -+ #endif -+ ) { -+ RTW_PRINT("%s invalid Band:%d\n", __func__, Band); -+ return -1; -+ } -+ -+ if (RateSection >= RATE_SECTION_NUM -+ #ifdef CONFIG_IEEE80211_BAND_5GHZ -+ || (Band == BAND_ON_5G && RateSection == CCK) -+ #endif -+ ) { -+ RTW_PRINT("%s invalid RateSection:%d in Band:%d, RfPath:%d\n", __func__ -+ , RateSection, Band, RfPath); -+ return -1; -+ } -+ -+ if (Band == BAND_ON_2_4G) -+ value = regsty->target_tx_pwr_2g[RfPath][RateSection]; -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ else /* BAND_ON_5G */ -+ value = regsty->target_tx_pwr_5g[RfPath][RateSection - 1]; -+#endif -+ -+ return value; -+} -+ -+bool rtw_regsty_chk_target_tx_power_valid(_adapter *adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int path, tx_num, band, rs; -+ s8 target; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ if (!hal_is_band_support(adapter, band)) -+ continue; -+ -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) -+ break; -+ -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ tx_num = rate_section_to_tx_num(rs); -+ if (tx_num >= hal_spec->nss_num) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) -+ continue; -+ -+ target = rtw_regsty_get_target_tx_power(adapter, band, path, rs); -+ if (target == -1) { -+ RTW_PRINT("%s return _FALSE for band:%d, path:%d, rs:%d, t:%d\n", __func__, band, path, rs, target); -+ return _FALSE; -+ } -+ } -+ } -+ } -+ -+ return _TRUE; -+} -+ -+/* -+* PHY_GetTxPowerByRateBase - -+* -+* Return 2 times of dBm -+*/ -+u8 -+PHY_GetTxPowerByRateBase( -+ IN PADAPTER Adapter, -+ IN u8 Band, -+ IN u8 RfPath, -+ IN u8 TxNum, -+ IN RATE_SECTION RateSection -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 value = 0; -+ -+ if (RfPath > RF_PATH_D) { -+ RTW_PRINT("%s invalid RfPath:%d\n", __func__, RfPath); -+ return 0; -+ } -+ -+ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { -+ RTW_PRINT("%s invalid Band:%d\n", __func__, Band); -+ return 0; -+ } -+ -+ if (RateSection >= RATE_SECTION_NUM -+ || (Band == BAND_ON_5G && RateSection == CCK) -+ ) { -+ RTW_PRINT("%s invalid RateSection:%d in Band:%d, RfPath:%d, TxNum:%d\n", __func__ -+ , RateSection, Band, RfPath, TxNum); -+ return 0; -+ } -+ -+ if (Band == BAND_ON_2_4G) -+ value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][RateSection]; -+ else /* BAND_ON_5G */ -+ value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][RateSection - 1]; -+ -+ return value; -+} -+ -+VOID -+phy_SetTxPowerByRateBase( -+ IN PADAPTER Adapter, -+ IN u8 Band, -+ IN u8 RfPath, -+ IN RATE_SECTION RateSection, -+ IN u8 TxNum, -+ IN u8 Value -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if (RfPath > RF_PATH_D) { -+ RTW_PRINT("%s invalid RfPath:%d\n", __func__, RfPath); -+ return; -+ } -+ -+ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { -+ RTW_PRINT("%s invalid Band:%d\n", __func__, Band); -+ return; -+ } -+ -+ if (RateSection >= RATE_SECTION_NUM -+ || (Band == BAND_ON_5G && RateSection == CCK) -+ ) { -+ RTW_PRINT("%s invalid RateSection:%d in %sG, RfPath:%d, TxNum:%d\n", __func__ -+ , RateSection, (Band == BAND_ON_2_4G) ? "2.4" : "5", RfPath, TxNum); -+ return; -+ } -+ -+ if (Band == BAND_ON_2_4G) -+ pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][RateSection] = Value; -+ else /* BAND_ON_5G */ -+ pHalData->TxPwrByRateBase5G[RfPath][TxNum][RateSection - 1] = Value; -+} -+ -+static inline BOOLEAN phy_is_txpwr_by_rate_undefined_of_band_path(_adapter *adapter, u8 band, u8 path) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 tx_num = 0, rate_idx = 0; -+ -+ for (tx_num = 0; tx_num < TX_PWR_BY_RATE_NUM_RF; tx_num++) { -+ if (tx_num >= hal_spec->max_tx_cnt || tx_num >= hal_spec->nss_num) -+ goto exit; -+ for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) { -+ if (hal_data->TxPwrByRateOffset[band][path][tx_num][rate_idx] != 0) -+ goto exit; -+ } -+ } -+ -+exit: -+ return (tx_num >= hal_spec->max_tx_cnt || tx_num >= hal_spec->nss_num) ? _TRUE : _FALSE; -+} -+ -+static inline void phy_txpwr_by_rate_duplicate_band_path(_adapter *adapter, u8 band, u8 s_path, u8 t_path) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 tx_num = 0, rate_idx = 0; -+ -+ for (tx_num = 0; tx_num < TX_PWR_BY_RATE_NUM_RF; tx_num++) -+ for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) -+ hal_data->TxPwrByRateOffset[band][t_path][tx_num][rate_idx] = hal_data->TxPwrByRateOffset[band][s_path][tx_num][rate_idx]; -+} -+ -+static void phy_txpwr_by_rate_chk_for_path_dup(_adapter *adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 band, path; -+ s8 src_path; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) -+ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) -+ hal_data->txpwr_by_rate_undefined_band_path[band][path] = 0; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ if (!hal_is_band_support(adapter, band)) -+ continue; -+ -+ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) -+ continue; -+ -+ if (phy_is_txpwr_by_rate_undefined_of_band_path(adapter, band, path)) -+ hal_data->txpwr_by_rate_undefined_band_path[band][path] = 1; -+ } -+ } -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ if (!hal_is_band_support(adapter, band)) -+ continue; -+ -+ src_path = -1; -+ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) -+ continue; -+ -+ /* find src */ -+ if (src_path == -1 && hal_data->txpwr_by_rate_undefined_band_path[band][path] == 0) -+ src_path = path; -+ } -+ -+ if (src_path == -1) { -+ RTW_ERR("%s all power by rate undefined\n", __func__); -+ continue; -+ } -+ -+ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) -+ continue; -+ -+ /* duplicate src to undefined one */ -+ if (hal_data->txpwr_by_rate_undefined_band_path[band][path] == 1) { -+ RTW_INFO("%s duplicate %s [%c] to [%c]\n", __func__ -+ , band_str(band), rf_path_char(src_path), rf_path_char(path)); -+ phy_txpwr_by_rate_duplicate_band_path(adapter, band, src_path, path); -+ } -+ } -+ } -+} -+ -+VOID -+phy_StoreTxPowerByRateBase( -+ IN PADAPTER pAdapter -+) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(pAdapter); -+ struct registry_priv *regsty = adapter_to_regsty(pAdapter); -+ -+ u8 rate_sec_base[RATE_SECTION_NUM] = { -+ MGN_11M, -+ MGN_54M, -+ MGN_MCS7, -+ MGN_MCS15, -+ MGN_MCS23, -+ MGN_MCS31, -+ MGN_VHT1SS_MCS7, -+ MGN_VHT2SS_MCS7, -+ MGN_VHT3SS_MCS7, -+ MGN_VHT4SS_MCS7, -+ }; -+ -+ u8 band, path, rs, tx_num, base, index; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ if (!hal_is_band_support(pAdapter, band)) -+ continue; -+ -+ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) -+ break; -+ -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ tx_num = rate_section_to_tx_num(rs); -+ if (tx_num >= hal_spec->nss_num) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) -+ continue; -+ -+ if (regsty->target_tx_pwr_valid == _TRUE) -+ base = 2 * rtw_regsty_get_target_tx_power(pAdapter, band, path, rs); -+ else -+ base = _PHY_GetTxPowerByRate(pAdapter, band, path, tx_num, rate_sec_base[rs]); -+ phy_SetTxPowerByRateBase(pAdapter, band, path, rs, tx_num, base); -+ } -+ } -+ } -+} -+ -+VOID -+PHY_GetRateValuesOfTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Value, -+ OUT u8 *Rate, -+ OUT s8 *PwrByRateVal, -+ OUT u8 *RateNum -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 index = 0, i = 0; -+ -+ switch (RegAddr) { -+ case rTxAGC_A_Rate18_06: -+ case rTxAGC_B_Rate18_06: -+ Rate[0] = MGN_6M; -+ Rate[1] = MGN_9M; -+ Rate[2] = MGN_12M; -+ Rate[3] = MGN_18M; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_Rate54_24: -+ case rTxAGC_B_Rate54_24: -+ Rate[0] = MGN_24M; -+ Rate[1] = MGN_36M; -+ Rate[2] = MGN_48M; -+ Rate[3] = MGN_54M; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_CCK1_Mcs32: -+ Rate[0] = MGN_1M; -+ PwrByRateVal[0] = (s8)((((Value >> (8 + 4)) & 0xF)) * 10 + -+ ((Value >> 8) & 0xF)); -+ *RateNum = 1; -+ break; -+ -+ case rTxAGC_B_CCK11_A_CCK2_11: -+ if (BitMask == 0xffffff00) { -+ Rate[0] = MGN_2M; -+ Rate[1] = MGN_5_5M; -+ Rate[2] = MGN_11M; -+ for (i = 1; i < 4; ++i) { -+ PwrByRateVal[i - 1] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 3; -+ } else if (BitMask == 0x000000ff) { -+ Rate[0] = MGN_11M; -+ PwrByRateVal[0] = (s8)((((Value >> 4) & 0xF)) * 10 + -+ (Value & 0xF)); -+ *RateNum = 1; -+ } -+ break; -+ -+ case rTxAGC_A_Mcs03_Mcs00: -+ case rTxAGC_B_Mcs03_Mcs00: -+ Rate[0] = MGN_MCS0; -+ Rate[1] = MGN_MCS1; -+ Rate[2] = MGN_MCS2; -+ Rate[3] = MGN_MCS3; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_Mcs07_Mcs04: -+ case rTxAGC_B_Mcs07_Mcs04: -+ Rate[0] = MGN_MCS4; -+ Rate[1] = MGN_MCS5; -+ Rate[2] = MGN_MCS6; -+ Rate[3] = MGN_MCS7; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_Mcs11_Mcs08: -+ case rTxAGC_B_Mcs11_Mcs08: -+ Rate[0] = MGN_MCS8; -+ Rate[1] = MGN_MCS9; -+ Rate[2] = MGN_MCS10; -+ Rate[3] = MGN_MCS11; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case rTxAGC_A_Mcs15_Mcs12: -+ case rTxAGC_B_Mcs15_Mcs12: -+ Rate[0] = MGN_MCS12; -+ Rate[1] = MGN_MCS13; -+ Rate[2] = MGN_MCS14; -+ Rate[3] = MGN_MCS15; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ -+ break; -+ -+ case rTxAGC_B_CCK1_55_Mcs32: -+ Rate[0] = MGN_1M; -+ Rate[1] = MGN_2M; -+ Rate[2] = MGN_5_5M; -+ for (i = 1; i < 4; ++i) { -+ PwrByRateVal[i - 1] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 3; -+ break; -+ -+ case 0xC20: -+ case 0xE20: -+ case 0x1820: -+ case 0x1a20: -+ Rate[0] = MGN_1M; -+ Rate[1] = MGN_2M; -+ Rate[2] = MGN_5_5M; -+ Rate[3] = MGN_11M; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC24: -+ case 0xE24: -+ case 0x1824: -+ case 0x1a24: -+ Rate[0] = MGN_6M; -+ Rate[1] = MGN_9M; -+ Rate[2] = MGN_12M; -+ Rate[3] = MGN_18M; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC28: -+ case 0xE28: -+ case 0x1828: -+ case 0x1a28: -+ Rate[0] = MGN_24M; -+ Rate[1] = MGN_36M; -+ Rate[2] = MGN_48M; -+ Rate[3] = MGN_54M; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC2C: -+ case 0xE2C: -+ case 0x182C: -+ case 0x1a2C: -+ Rate[0] = MGN_MCS0; -+ Rate[1] = MGN_MCS1; -+ Rate[2] = MGN_MCS2; -+ Rate[3] = MGN_MCS3; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC30: -+ case 0xE30: -+ case 0x1830: -+ case 0x1a30: -+ Rate[0] = MGN_MCS4; -+ Rate[1] = MGN_MCS5; -+ Rate[2] = MGN_MCS6; -+ Rate[3] = MGN_MCS7; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC34: -+ case 0xE34: -+ case 0x1834: -+ case 0x1a34: -+ Rate[0] = MGN_MCS8; -+ Rate[1] = MGN_MCS9; -+ Rate[2] = MGN_MCS10; -+ Rate[3] = MGN_MCS11; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC38: -+ case 0xE38: -+ case 0x1838: -+ case 0x1a38: -+ Rate[0] = MGN_MCS12; -+ Rate[1] = MGN_MCS13; -+ Rate[2] = MGN_MCS14; -+ Rate[3] = MGN_MCS15; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC3C: -+ case 0xE3C: -+ case 0x183C: -+ case 0x1a3C: -+ Rate[0] = MGN_VHT1SS_MCS0; -+ Rate[1] = MGN_VHT1SS_MCS1; -+ Rate[2] = MGN_VHT1SS_MCS2; -+ Rate[3] = MGN_VHT1SS_MCS3; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC40: -+ case 0xE40: -+ case 0x1840: -+ case 0x1a40: -+ Rate[0] = MGN_VHT1SS_MCS4; -+ Rate[1] = MGN_VHT1SS_MCS5; -+ Rate[2] = MGN_VHT1SS_MCS6; -+ Rate[3] = MGN_VHT1SS_MCS7; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC44: -+ case 0xE44: -+ case 0x1844: -+ case 0x1a44: -+ Rate[0] = MGN_VHT1SS_MCS8; -+ Rate[1] = MGN_VHT1SS_MCS9; -+ Rate[2] = MGN_VHT2SS_MCS0; -+ Rate[3] = MGN_VHT2SS_MCS1; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC48: -+ case 0xE48: -+ case 0x1848: -+ case 0x1a48: -+ Rate[0] = MGN_VHT2SS_MCS2; -+ Rate[1] = MGN_VHT2SS_MCS3; -+ Rate[2] = MGN_VHT2SS_MCS4; -+ Rate[3] = MGN_VHT2SS_MCS5; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xC4C: -+ case 0xE4C: -+ case 0x184C: -+ case 0x1a4C: -+ Rate[0] = MGN_VHT2SS_MCS6; -+ Rate[1] = MGN_VHT2SS_MCS7; -+ Rate[2] = MGN_VHT2SS_MCS8; -+ Rate[3] = MGN_VHT2SS_MCS9; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xCD8: -+ case 0xED8: -+ case 0x18D8: -+ case 0x1aD8: -+ Rate[0] = MGN_MCS16; -+ Rate[1] = MGN_MCS17; -+ Rate[2] = MGN_MCS18; -+ Rate[3] = MGN_MCS19; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xCDC: -+ case 0xEDC: -+ case 0x18DC: -+ case 0x1aDC: -+ Rate[0] = MGN_MCS20; -+ Rate[1] = MGN_MCS21; -+ Rate[2] = MGN_MCS22; -+ Rate[3] = MGN_MCS23; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xCE0: -+ case 0xEE0: -+ case 0x18E0: -+ case 0x1aE0: -+ Rate[0] = MGN_VHT3SS_MCS0; -+ Rate[1] = MGN_VHT3SS_MCS1; -+ Rate[2] = MGN_VHT3SS_MCS2; -+ Rate[3] = MGN_VHT3SS_MCS3; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xCE4: -+ case 0xEE4: -+ case 0x18E4: -+ case 0x1aE4: -+ Rate[0] = MGN_VHT3SS_MCS4; -+ Rate[1] = MGN_VHT3SS_MCS5; -+ Rate[2] = MGN_VHT3SS_MCS6; -+ Rate[3] = MGN_VHT3SS_MCS7; -+ for (i = 0; i < 4; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 4; -+ break; -+ -+ case 0xCE8: -+ case 0xEE8: -+ case 0x18E8: -+ case 0x1aE8: -+ Rate[0] = MGN_VHT3SS_MCS8; -+ Rate[1] = MGN_VHT3SS_MCS9; -+ for (i = 0; i < 2; ++i) { -+ PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + -+ ((Value >> (i * 8)) & 0xF)); -+ } -+ *RateNum = 2; -+ break; -+ -+ default: -+ RTW_PRINT("Invalid RegAddr 0x%x in %s()\n", RegAddr, __func__); -+ break; -+ }; -+} -+ -+void -+PHY_StoreTxPowerByRateNew( -+ IN PADAPTER pAdapter, -+ IN u32 Band, -+ IN u32 RfPath, -+ IN u32 TxNum, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 i = 0, rates[4] = {0}, rateNum = 0; -+ s8 PwrByRateVal[4] = {0}; -+ -+ PHY_GetRateValuesOfTxPowerByRate(pAdapter, RegAddr, BitMask, Data, rates, PwrByRateVal, &rateNum); -+ -+ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { -+ RTW_PRINT("Invalid Band %d\n", Band); -+ return; -+ } -+ -+ if (RfPath > ODM_RF_PATH_D) { -+ RTW_PRINT("Invalid RfPath %d\n", RfPath); -+ return; -+ } -+ -+ if (TxNum > ODM_RF_PATH_D) { -+ RTW_PRINT("Invalid TxNum %d\n", TxNum); -+ return; -+ } -+ -+ for (i = 0; i < rateNum; ++i) { -+ u8 rate_idx = PHY_GetRateIndexOfTxPowerByRate(rates[i]); -+ -+ if (IS_1T_RATE(rates[i])) -+ pHalData->TxPwrByRateOffset[Band][RfPath][RF_1TX][rate_idx] = PwrByRateVal[i]; -+ else if (IS_2T_RATE(rates[i])) -+ pHalData->TxPwrByRateOffset[Band][RfPath][RF_2TX][rate_idx] = PwrByRateVal[i]; -+ else if (IS_3T_RATE(rates[i])) -+ pHalData->TxPwrByRateOffset[Band][RfPath][RF_3TX][rate_idx] = PwrByRateVal[i]; -+ else if (IS_4T_RATE(rates[i])) -+ pHalData->TxPwrByRateOffset[Band][RfPath][RF_4TX][rate_idx] = PwrByRateVal[i]; -+ else -+ rtw_warn_on(1); -+ } -+} -+ -+VOID -+PHY_InitTxPowerByRate( -+ IN PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 band = 0, rfPath = 0, TxNum = 0, rate = 0, i = 0, j = 0; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band) -+ for (rfPath = 0; rfPath < TX_PWR_BY_RATE_NUM_RF; ++rfPath) -+ for (TxNum = 0; TxNum < TX_PWR_BY_RATE_NUM_RF; ++TxNum) -+ for (rate = 0; rate < TX_PWR_BY_RATE_NUM_RATE; ++rate) -+ pHalData->TxPwrByRateOffset[band][rfPath][TxNum][rate] = 0; -+} -+ -+VOID -+PHY_StoreTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u32 Band, -+ IN u32 RfPath, -+ IN u32 TxNum, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ if (pDM_Odm->PhyRegPgVersion > 0) -+ PHY_StoreTxPowerByRateNew(pAdapter, Band, RfPath, TxNum, RegAddr, BitMask, Data); -+ else -+ RTW_INFO("Invalid PHY_REG_PG.txt version %d\n", pDM_Odm->PhyRegPgVersion); -+ -+} -+ -+VOID -+phy_ConvertTxPowerByRateInDbmToRelativeValues( -+ IN PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 base = 0, i = 0, value = 0, -+ band = 0, path = 0, txNum = 0, index = 0, -+ startIndex = 0, endIndex = 0; -+ u8 cckRates[4] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}, -+ ofdmRates[8] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M}, -+ mcs0_7Rates[8] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}, -+ mcs8_15Rates[8] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}, -+ mcs16_23Rates[8] = {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23}, -+ vht1ssRates[10] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4, -+ MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9}, -+ vht2ssRates[10] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, -+ MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9}, -+ vht3ssRates[10] = {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4, -+ MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9}; -+ -+ /* RTW_INFO("===>PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n" ); */ -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band) { -+ for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_D; ++path) { -+ for (txNum = RF_1TX; txNum < RF_MAX_TX_NUM; ++txNum) { -+ /* CCK */ -+ if (band == BAND_ON_2_4G) { -+ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, CCK); -+ for (i = 0; i < sizeof(cckRates); ++i) { -+ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, cckRates[i]); -+ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, cckRates[i], value - base); -+ } -+ } -+ -+ /* OFDM */ -+ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, OFDM); -+ for (i = 0; i < sizeof(ofdmRates); ++i) { -+ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, ofdmRates[i]); -+ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, ofdmRates[i], value - base); -+ } -+ -+ /* HT MCS0~7 */ -+ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, HT_1SS); -+ for (i = 0; i < sizeof(mcs0_7Rates); ++i) { -+ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, mcs0_7Rates[i]); -+ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, mcs0_7Rates[i], value - base); -+ } -+ -+ /* HT MCS8~15 */ -+ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, HT_2SS); -+ for (i = 0; i < sizeof(mcs8_15Rates); ++i) { -+ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, mcs8_15Rates[i]); -+ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, mcs8_15Rates[i], value - base); -+ } -+ -+ /* HT MCS16~23 */ -+ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, HT_3SS); -+ for (i = 0; i < sizeof(mcs16_23Rates); ++i) { -+ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, mcs16_23Rates[i]); -+ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, mcs16_23Rates[i], value - base); -+ } -+ -+ /* VHT 1SS */ -+ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, VHT_1SS); -+ for (i = 0; i < sizeof(vht1ssRates); ++i) { -+ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, vht1ssRates[i]); -+ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, vht1ssRates[i], value - base); -+ } -+ -+ /* VHT 2SS */ -+ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, VHT_2SS); -+ for (i = 0; i < sizeof(vht2ssRates); ++i) { -+ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, vht2ssRates[i]); -+ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, vht2ssRates[i], value - base); -+ } -+ -+ /* VHT 3SS */ -+ base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, VHT_3SS); -+ for (i = 0; i < sizeof(vht3ssRates); ++i) { -+ value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, vht3ssRates[i]); -+ PHY_SetTxPowerByRate(pAdapter, band, path, txNum, vht3ssRates[i], value - base); -+ } -+ } -+ } -+ } -+ -+ /* RTW_INFO("<===PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n" ); */ -+} -+ -+/* -+ * This function must be called if the value in the PHY_REG_PG.txt(or header) -+ * is exact dBm values -+ */ -+VOID -+PHY_TxPowerByRateConfiguration( -+ IN PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ phy_txpwr_by_rate_chk_for_path_dup(pAdapter); -+ phy_StoreTxPowerByRateBase(pAdapter); -+ phy_ConvertTxPowerByRateInDbmToRelativeValues(pAdapter); -+} -+ -+VOID -+PHY_SetTxPowerIndexByRateSection( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Channel, -+ IN u8 RateSection -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ -+ if (RateSection >= RATE_SECTION_NUM) { -+ RTW_INFO("Invalid RateSection %d in %s", RateSection, __func__); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (RateSection == CCK && pHalData->CurrentBandType != BAND_ON_2_4G) -+ goto exit; -+ -+ PHY_SetTxPowerIndexByRateArray(pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, -+ rates_by_sections[RateSection].rates, rates_by_sections[RateSection].rate_num); -+ -+exit: -+ return; -+} -+ -+BOOLEAN -+phy_GetChnlIndex( -+ IN u8 Channel, -+ OUT u8 *ChannelIdx -+) -+{ -+ u8 i = 0; -+ BOOLEAN bIn24G = _TRUE; -+ -+ if (Channel <= 14) { -+ bIn24G = _TRUE; -+ *ChannelIdx = Channel - 1; -+ } else { -+ bIn24G = _FALSE; -+ -+ for (i = 0; i < CENTER_CH_5G_ALL_NUM; ++i) { -+ if (center_ch_5g_all[i] == Channel) { -+ *ChannelIdx = i; -+ return bIn24G; -+ } -+ } -+ } -+ -+ return bIn24G; -+} -+ -+u8 -+PHY_GetTxPowerIndexBase( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel, -+ OUT PBOOLEAN bIn24G -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 i = 0; /* default set to 1S */ -+ u8 txPower = 0; -+ u8 chnlIdx = (Channel - 1); -+ -+ if (HAL_IsLegalChannel(pAdapter, Channel) == _FALSE) { -+ chnlIdx = 0; -+ RTW_INFO("Illegal channel!!\n"); -+ } -+ -+ *bIn24G = phy_GetChnlIndex(Channel, &chnlIdx); -+ -+ /* RTW_INFO("[%s] Channel Index: %d\n", (*bIn24G?"2.4G":"5G"), chnlIdx); */ -+ -+ if (*bIn24G) { /* 3 ============================== 2.4 G ============================== */ -+ if (IS_CCK_RATE(Rate)) -+ txPower = pHalData->Index24G_CCK_Base[RFPath][chnlIdx]; -+ else if (MGN_6M <= Rate) -+ txPower = pHalData->Index24G_BW40_Base[RFPath][chnlIdx]; -+ else -+ RTW_INFO("PHY_GetTxPowerIndexBase: INVALID Rate.\n"); -+ -+ /* RTW_INFO("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", */ -+ /* ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower); */ -+ -+ /* OFDM-1T */ -+ if ((MGN_6M <= Rate && Rate <= MGN_54M) && !IS_CCK_RATE(Rate)) { -+ txPower += pHalData->OFDM_24G_Diff[RFPath][TX_1S]; -+ /* RTW_INFO("+PowerDiff 2.4G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_24G_Diff[RFPath][TX_1S]); */ -+ } -+ /* BW20-1S, BW20-2S */ -+ if (BandWidth == CHANNEL_WIDTH_20) { -+ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_1S]; -+ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_2S]; -+ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_3S]; -+ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_4S]; -+ -+ /* RTW_INFO("+PowerDiff 2.4G (RF-%c): (BW20-1S, BW20-2S, BW20-3S, BW20-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ -+ /* pHalData->BW20_24G_Diff[RFPath][TX_1S], pHalData->BW20_24G_Diff[RFPath][TX_2S], */ -+ /* pHalData->BW20_24G_Diff[RFPath][TX_3S], pHalData->BW20_24G_Diff[RFPath][TX_4S]); */ -+ } -+ /* BW40-1S, BW40-2S */ -+ else if (BandWidth == CHANNEL_WIDTH_40) { -+ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; -+ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; -+ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_3S]; -+ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_4S]; -+ -+ /* RTW_INFO("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S, BW40-3S, BW40-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ -+ /* pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S], */ -+ /* pHalData->BW40_24G_Diff[RFPath][TX_3S], pHalData->BW40_24G_Diff[RFPath][TX_4S]); */ -+ } -+ /* Willis suggest adopt BW 40M power index while in BW 80 mode */ -+ else if (BandWidth == CHANNEL_WIDTH_80) { -+ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; -+ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; -+ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_3S]; -+ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_4S]; -+ -+ /* RTW_INFO("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S, BW40-3S, BW40-4T) = (%d, %d, %d, %d) P.S. Current is in BW 80MHz\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ -+ /* pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S], */ -+ /* pHalData->BW40_24G_Diff[RFPath][TX_3S], pHalData->BW40_24G_Diff[RFPath][TX_4S]); */ -+ } -+ } -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ else { /* 3 ============================== 5 G ============================== */ -+ if (MGN_6M <= Rate) -+ txPower = pHalData->Index5G_BW40_Base[RFPath][chnlIdx]; -+ else -+ RTW_INFO("===> mpt_ProQueryCalTxPower_Jaguar: INVALID Rate.\n"); -+ -+ /* RTW_INFO("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", */ -+ /* ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower); */ -+ -+ /* OFDM-1T */ -+ if ((MGN_6M <= Rate && Rate <= MGN_54M) && !IS_CCK_RATE(Rate)) { -+ txPower += pHalData->OFDM_5G_Diff[RFPath][TX_1S]; -+ /* RTW_INFO("+PowerDiff 5G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_5G_Diff[RFPath][TX_1S]); */ -+ } -+ -+ /* BW20-1S, BW20-2S */ -+ if (BandWidth == CHANNEL_WIDTH_20) { -+ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_1S]; -+ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_2S]; -+ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_3S]; -+ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_4S]; -+ -+ /* RTW_INFO("+PowerDiff 5G (RF-%c): (BW20-1S, BW20-2S, BW20-3S, BW20-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ -+ /* pHalData->BW20_5G_Diff[RFPath][TX_1S], pHalData->BW20_5G_Diff[RFPath][TX_2S], */ -+ /* pHalData->BW20_5G_Diff[RFPath][TX_3S], pHalData->BW20_5G_Diff[RFPath][TX_4S]); */ -+ } -+ /* BW40-1S, BW40-2S */ -+ else if (BandWidth == CHANNEL_WIDTH_40) { -+ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_1S]; -+ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_2S]; -+ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_3S]; -+ if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_4S]; -+ -+ /* RTW_INFO("+PowerDiff 5G(RF-%c): (BW40-1S, BW40-2S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ -+ /* pHalData->BW40_5G_Diff[RFPath][TX_1S], pHalData->BW40_5G_Diff[RFPath][TX_2S], */ -+ /* pHalData->BW40_5G_Diff[RFPath][TX_3S], pHalData->BW40_5G_Diff[RFPath][TX_4S]); */ -+ } -+ /* BW80-1S, BW80-2S */ -+ else if (BandWidth == CHANNEL_WIDTH_80) { -+ /* <20121220, Kordan> Get the index of array "Index5G_BW80_Base". */ -+ for (i = 0; i < CENTER_CH_5G_80M_NUM; ++i) -+ if (center_ch_5g_80m[i] == Channel) -+ chnlIdx = i; -+ -+ txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx]; -+ -+ if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += + pHalData->BW80_5G_Diff[RFPath][TX_1S]; -+ if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW80_5G_Diff[RFPath][TX_2S]; -+ if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW80_5G_Diff[RFPath][TX_3S]; -+ if ((MGN_MCS23 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) -+ txPower += pHalData->BW80_5G_Diff[RFPath][TX_4S]; -+ -+ /* RTW_INFO("+PowerDiff 5G(RF-%c): (BW80-1S, BW80-2S, BW80-3S, BW80-4S) = (%d, %d, %d, %d)\n",((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ -+ /* pHalData->BW80_5G_Diff[RFPath][TX_1S], pHalData->BW80_5G_Diff[RFPath][TX_2S], */ -+ /* pHalData->BW80_5G_Diff[RFPath][TX_3S], pHalData->BW80_5G_Diff[RFPath][TX_4S]); */ -+ } -+ } -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ -+ return txPower; -+} -+ -+s8 -+PHY_GetTxPowerTrackingOffset( -+ PADAPTER pAdapter, -+ u8 RFPath, -+ u8 Rate -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ s8 offset = 0; -+ -+ if (pDM_Odm->RFCalibrateInfo.TxPowerTrackControl == _FALSE) -+ return offset; -+ -+ if ((Rate == MGN_1M) || (Rate == MGN_2M) || (Rate == MGN_5_5M) || (Rate == MGN_11M)) { -+ offset = pDM_Odm->RFCalibrateInfo.Remnant_CCKSwingIdx; -+ /*RTW_INFO("+Remnant_CCKSwingIdx = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_CCKSwingIdx);*/ -+ } else { -+ offset = pDM_Odm->RFCalibrateInfo.Remnant_OFDMSwingIdx[RFPath]; -+ /*RTW_INFO("+Remanant_OFDMSwingIdx[RFPath %u][Rate 0x%x] = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath]); */ -+ -+ } -+ -+ return offset; -+} -+ -+/*The same as MRateToHwRate in hal_com.c*/ -+u8 -+PHY_GetRateIndexOfTxPowerByRate( -+ IN u8 Rate -+) -+{ -+ u8 index = 0; -+ switch (Rate) { -+ case MGN_1M: -+ index = 0; -+ break; -+ case MGN_2M: -+ index = 1; -+ break; -+ case MGN_5_5M: -+ index = 2; -+ break; -+ case MGN_11M: -+ index = 3; -+ break; -+ case MGN_6M: -+ index = 4; -+ break; -+ case MGN_9M: -+ index = 5; -+ break; -+ case MGN_12M: -+ index = 6; -+ break; -+ case MGN_18M: -+ index = 7; -+ break; -+ case MGN_24M: -+ index = 8; -+ break; -+ case MGN_36M: -+ index = 9; -+ break; -+ case MGN_48M: -+ index = 10; -+ break; -+ case MGN_54M: -+ index = 11; -+ break; -+ case MGN_MCS0: -+ index = 12; -+ break; -+ case MGN_MCS1: -+ index = 13; -+ break; -+ case MGN_MCS2: -+ index = 14; -+ break; -+ case MGN_MCS3: -+ index = 15; -+ break; -+ case MGN_MCS4: -+ index = 16; -+ break; -+ case MGN_MCS5: -+ index = 17; -+ break; -+ case MGN_MCS6: -+ index = 18; -+ break; -+ case MGN_MCS7: -+ index = 19; -+ break; -+ case MGN_MCS8: -+ index = 20; -+ break; -+ case MGN_MCS9: -+ index = 21; -+ break; -+ case MGN_MCS10: -+ index = 22; -+ break; -+ case MGN_MCS11: -+ index = 23; -+ break; -+ case MGN_MCS12: -+ index = 24; -+ break; -+ case MGN_MCS13: -+ index = 25; -+ break; -+ case MGN_MCS14: -+ index = 26; -+ break; -+ case MGN_MCS15: -+ index = 27; -+ break; -+ case MGN_MCS16: -+ index = 28; -+ break; -+ case MGN_MCS17: -+ index = 29; -+ break; -+ case MGN_MCS18: -+ index = 30; -+ break; -+ case MGN_MCS19: -+ index = 31; -+ break; -+ case MGN_MCS20: -+ index = 32; -+ break; -+ case MGN_MCS21: -+ index = 33; -+ break; -+ case MGN_MCS22: -+ index = 34; -+ break; -+ case MGN_MCS23: -+ index = 35; -+ break; -+ case MGN_MCS24: -+ index = 36; -+ break; -+ case MGN_MCS25: -+ index = 37; -+ break; -+ case MGN_MCS26: -+ index = 38; -+ break; -+ case MGN_MCS27: -+ index = 39; -+ break; -+ case MGN_MCS28: -+ index = 40; -+ break; -+ case MGN_MCS29: -+ index = 41; -+ break; -+ case MGN_MCS30: -+ index = 42; -+ break; -+ case MGN_MCS31: -+ index = 43; -+ break; -+ case MGN_VHT1SS_MCS0: -+ index = 44; -+ break; -+ case MGN_VHT1SS_MCS1: -+ index = 45; -+ break; -+ case MGN_VHT1SS_MCS2: -+ index = 46; -+ break; -+ case MGN_VHT1SS_MCS3: -+ index = 47; -+ break; -+ case MGN_VHT1SS_MCS4: -+ index = 48; -+ break; -+ case MGN_VHT1SS_MCS5: -+ index = 49; -+ break; -+ case MGN_VHT1SS_MCS6: -+ index = 50; -+ break; -+ case MGN_VHT1SS_MCS7: -+ index = 51; -+ break; -+ case MGN_VHT1SS_MCS8: -+ index = 52; -+ break; -+ case MGN_VHT1SS_MCS9: -+ index = 53; -+ break; -+ case MGN_VHT2SS_MCS0: -+ index = 54; -+ break; -+ case MGN_VHT2SS_MCS1: -+ index = 55; -+ break; -+ case MGN_VHT2SS_MCS2: -+ index = 56; -+ break; -+ case MGN_VHT2SS_MCS3: -+ index = 57; -+ break; -+ case MGN_VHT2SS_MCS4: -+ index = 58; -+ break; -+ case MGN_VHT2SS_MCS5: -+ index = 59; -+ break; -+ case MGN_VHT2SS_MCS6: -+ index = 60; -+ break; -+ case MGN_VHT2SS_MCS7: -+ index = 61; -+ break; -+ case MGN_VHT2SS_MCS8: -+ index = 62; -+ break; -+ case MGN_VHT2SS_MCS9: -+ index = 63; -+ break; -+ case MGN_VHT3SS_MCS0: -+ index = 64; -+ break; -+ case MGN_VHT3SS_MCS1: -+ index = 65; -+ break; -+ case MGN_VHT3SS_MCS2: -+ index = 66; -+ break; -+ case MGN_VHT3SS_MCS3: -+ index = 67; -+ break; -+ case MGN_VHT3SS_MCS4: -+ index = 68; -+ break; -+ case MGN_VHT3SS_MCS5: -+ index = 69; -+ break; -+ case MGN_VHT3SS_MCS6: -+ index = 70; -+ break; -+ case MGN_VHT3SS_MCS7: -+ index = 71; -+ break; -+ case MGN_VHT3SS_MCS8: -+ index = 72; -+ break; -+ case MGN_VHT3SS_MCS9: -+ index = 73; -+ break; -+ case MGN_VHT4SS_MCS0: -+ index = 74; -+ break; -+ case MGN_VHT4SS_MCS1: -+ index = 75; -+ break; -+ case MGN_VHT4SS_MCS2: -+ index = 76; -+ break; -+ case MGN_VHT4SS_MCS3: -+ index = 77; -+ break; -+ case MGN_VHT4SS_MCS4: -+ index = 78; -+ break; -+ case MGN_VHT4SS_MCS5: -+ index = 79; -+ break; -+ case MGN_VHT4SS_MCS6: -+ index = 80; -+ break; -+ case MGN_VHT4SS_MCS7: -+ index = 81; -+ break; -+ case MGN_VHT4SS_MCS8: -+ index = 82; -+ break; -+ case MGN_VHT4SS_MCS9: -+ index = 83; -+ break; -+ default: -+ RTW_INFO("Invalid rate 0x%x in %s\n", Rate, __FUNCTION__); -+ break; -+ }; -+ -+ return index; -+} -+ -+s8 -+_PHY_GetTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u8 Band, -+ IN u8 RFPath, -+ IN u8 TxNum, -+ IN u8 Rate -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ s8 value = 0; -+ u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate); -+ -+ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { -+ RTW_INFO("Invalid band %d in %s\n", Band, __func__); -+ goto exit; -+ } -+ if (RFPath > ODM_RF_PATH_D) { -+ RTW_INFO("Invalid RfPath %d in %s\n", RFPath, __func__); -+ goto exit; -+ } -+ if (TxNum >= RF_MAX_TX_NUM) { -+ RTW_INFO("Invalid TxNum %d in %s\n", TxNum, __func__); -+ goto exit; -+ } -+ if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { -+ RTW_INFO("Invalid RateIndex %d in %s\n", rateIndex, __func__); -+ goto exit; -+ } -+ -+ value = pHalData->TxPwrByRateOffset[Band][RFPath][TxNum][rateIndex]; -+ -+exit: -+ return value; -+} -+ -+ -+s8 -+PHY_GetTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u8 Band, -+ IN u8 RFPath, -+ IN u8 TxNum, -+ IN u8 Rate -+) -+{ -+ if (!phy_is_tx_power_by_rate_needed(pAdapter)) -+ return 0; -+ -+ return _PHY_GetTxPowerByRate(pAdapter, Band, RFPath, TxNum, Rate); -+} -+ -+#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI -+s8 -+PHY_GetTxPowerByRateOriginal( -+ IN PADAPTER pAdapter, -+ IN u8 Band, -+ IN u8 RFPath, -+ IN u8 TxNum, -+ IN u8 Rate -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ s8 value = 0, limit = 0; -+ u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate); -+ -+ if ((pAdapter->registrypriv.RegEnableTxPowerByRate == 2 && pHalData->EEPROMRegulatory == 2) || -+ pAdapter->registrypriv.RegEnableTxPowerByRate == 0) -+ return 0; -+ -+ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { -+ DBG_871X("Invalid band %d in %s\n", Band, __func__); -+ return value; -+ } -+ if (RFPath > ODM_RF_PATH_D) { -+ DBG_871X("Invalid RfPath %d in %s\n", RFPath, __func__); -+ return value; -+ } -+ if (TxNum >= RF_MAX_TX_NUM) { -+ DBG_871X("Invalid TxNum %d in %s\n", TxNum, __func__); -+ return value; -+ } -+ if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { -+ DBG_871X("Invalid RateIndex %d in %s\n", rateIndex, __func__); -+ return value; -+ } -+ -+ value = pHalData->TxPwrByRate[Band][RFPath][TxNum][rateIndex]; -+ -+ return value; -+} -+ -+#endif -+ -+ -+VOID -+PHY_SetTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u8 Band, -+ IN u8 RFPath, -+ IN u8 TxNum, -+ IN u8 Rate, -+ IN s8 Value -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate); -+ -+ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { -+ RTW_INFO("Invalid band %d in %s\n", Band, __FUNCTION__); -+ return; -+ } -+ if (RFPath > ODM_RF_PATH_D) { -+ RTW_INFO("Invalid RfPath %d in %s\n", RFPath, __FUNCTION__); -+ return; -+ } -+ if (TxNum >= RF_MAX_TX_NUM) { -+ RTW_INFO("Invalid TxNum %d in %s\n", TxNum, __FUNCTION__); -+ return; -+ } -+ if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { -+ RTW_INFO("Invalid RateIndex %d in %s\n", rateIndex, __FUNCTION__); -+ return; -+ } -+ -+ pHalData->TxPwrByRateOffset[Band][RFPath][TxNum][rateIndex] = Value; -+} -+ -+VOID -+PHY_SetTxPowerLevelByPath( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN u8 path -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ BOOLEAN bIsIn24G = (pHalData->CurrentBandType == BAND_ON_2_4G); -+ -+ /* if ( pMgntInfo->RegNByteAccess == 0 ) */ -+ { -+ if (bIsIn24G) -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, CCK); -+ -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, OFDM); -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, HT_MCS0_MCS7); -+ -+ if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter)) -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_1SSMCS0_1SSMCS9); -+ -+ if (pHalData->NumTotalRFPath >= 2) { -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, HT_MCS8_MCS15); -+ -+ if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter)) -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_2SSMCS0_2SSMCS9); -+ -+ if (IS_HARDWARE_TYPE_8814A(Adapter)) { -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, HT_MCS16_MCS23); -+ PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_3SSMCS0_3SSMCS9); -+ } -+ } -+ } -+} -+ -+#ifndef DBG_TX_POWER_IDX -+#define DBG_TX_POWER_IDX 0 -+#endif -+ -+VOID -+PHY_SetTxPowerIndexByRateArray( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel, -+ IN u8 *Rates, -+ IN u8 RateArraySize -+) -+{ -+ u32 powerIndex = 0; -+ int i = 0; -+ -+ for (i = 0; i < RateArraySize; ++i) { -+#if DBG_TX_POWER_IDX -+ struct txpwr_idx_comp tic; -+ -+ powerIndex = rtw_hal_get_tx_power_index(pAdapter, RFPath, Rates[i], BandWidth, Channel, &tic); -+ RTW_INFO("TXPWR: [%c][%s]ch:%u, %s, pwr_idx:%u = %u + (%d=%d:%d) + (%d) + (%d)\n" -+ , rf_path_char(RFPath), ch_width_str(BandWidth), Channel, MGN_RATE_STR(Rates[i]) -+ , powerIndex, tic.base, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt, tic.ebias); -+#else -+ powerIndex = PHY_GetTxPowerIndex(pAdapter, RFPath, Rates[i], BandWidth, Channel); -+#endif -+ PHY_SetTxPowerIndex(pAdapter, powerIndex, RFPath, Rates[i]); -+ } -+} -+ -+s8 -+phy_GetWorldWideLimit( -+ s8 *LimitTable -+) -+{ -+ s8 min = LimitTable[0]; -+ u8 i = 0; -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) { -+ if (LimitTable[i] < min) -+ min = LimitTable[i]; -+ } -+ -+ return min; -+} -+ -+s8 -+phy_GetChannelIndexOfTxPowerLimit( -+ IN u8 Band, -+ IN u8 Channel -+) -+{ -+ s8 channelIndex = -1; -+ u8 i = 0; -+ -+ if (Band == BAND_ON_2_4G) -+ channelIndex = Channel - 1; -+ else if (Band == BAND_ON_5G) { -+ for (i = 0; i < CENTER_CH_5G_ALL_NUM; ++i) { -+ if (center_ch_5g_all[i] == Channel) -+ channelIndex = i; -+ } -+ } else -+ RTW_PRINT("Invalid Band %d in %s\n", Band, __func__); -+ -+ if (channelIndex == -1) -+ RTW_PRINT("Invalid Channel %d of Band %d in %s\n", Channel, Band, __func__); -+ -+ return channelIndex; -+} -+ -+static s8 _phy_get_txpwr_lmt( -+ IN PADAPTER Adapter, -+ IN u32 RegPwrTblSel, -+ IN BAND_TYPE Band, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 RfPath, -+ IN u8 DataRate, -+ IN u8 Channel, -+ BOOLEAN no_sc -+) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(Adapter); -+ s8 regulation = -1, bw = -1, rs = -1; -+ u8 cch = 0; -+ u8 bw_bmp = 0; -+ s8 min_lmt = MAX_POWER_INDEX; -+ s8 tmp_lmt; -+ u8 final_bw = Bandwidth, final_cch = Channel; -+ -+ if ((Adapter->registrypriv.RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory != 1) || -+ Adapter->registrypriv.RegEnableTxPowerLimit == 0) -+ goto exit; -+ -+ switch (RegPwrTblSel) { -+ case 1: -+ regulation = TXPWR_LMT_ETSI; -+ break; -+ case 2: -+ regulation = TXPWR_LMT_MKK; -+ break; -+ case 3: -+ regulation = TXPWR_LMT_FCC; -+ break; -+ case 4: -+ regulation = TXPWR_LMT_WW; -+ break; -+ default: -+ regulation = (Band == BAND_ON_2_4G) ? hal_data->Regulation2_4G : hal_data->Regulation5G; -+ break; -+ } -+ -+ if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { -+ RTW_ERR("%s invalid band:%u\n", __func__, Band); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (IS_CCK_RATE(DataRate)) -+ rs = CCK; -+ else if (IS_OFDM_RATE(DataRate)) -+ rs = OFDM; -+ else if (IS_HT1SS_RATE(DataRate)) -+ rs = HT_1SS; -+ else if (IS_HT2SS_RATE(DataRate)) -+ rs = HT_2SS; -+ else if (IS_HT3SS_RATE(DataRate)) -+ rs = HT_3SS; -+ else if (IS_HT4SS_RATE(DataRate)) -+ rs = HT_4SS; -+ else if (IS_VHT1SS_RATE(DataRate)) -+ rs = VHT_1SS; -+ else if (IS_VHT2SS_RATE(DataRate)) -+ rs = VHT_2SS; -+ else if (IS_VHT3SS_RATE(DataRate)) -+ rs = VHT_3SS; -+ else if (IS_VHT4SS_RATE(DataRate)) -+ rs = VHT_4SS; -+ else { -+ RTW_ERR("%s invalid rate 0x%x\n", __func__, DataRate); -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (Band == BAND_ON_5G && rs == CCK) { -+ RTW_ERR("Wrong rate No CCK(0x%x) in 5G Band\n", DataRate); -+ goto exit; -+ } -+ -+ if (no_sc == _TRUE) { -+ /* use the input center channel and bandwidth directly */ -+ cch = Channel; -+ bw_bmp = ch_width_to_bw_cap(Bandwidth); -+ } else { -+ /* -+ * find the possible tx bandwidth bmp for this rate, and then will get center channel for each bandwidth -+ * if no possible tx bandwidth bmp, select valid bandwidth up to current RF bandwidth into bmp -+ */ -+ if (rs == CCK || rs == OFDM) -+ bw_bmp = BW_CAP_20M; /* CCK, OFDM only BW 20M */ -+ else if (IS_HT_RATE_SECTION(rs)) { -+ bw_bmp = rtw_get_tx_bw_bmp_of_ht_rate(dvobj, DataRate, Bandwidth); -+ if (bw_bmp == 0) -+ bw_bmp = ch_width_to_bw_cap(Bandwidth > CHANNEL_WIDTH_40 ? CHANNEL_WIDTH_40 : Bandwidth); -+ } else if (IS_VHT_RATE_SECTION(rs)) { -+ bw_bmp = rtw_get_tx_bw_bmp_of_vht_rate(dvobj, DataRate, Bandwidth); -+ if (bw_bmp == 0) -+ bw_bmp = ch_width_to_bw_cap(Bandwidth > CHANNEL_WIDTH_160 ? CHANNEL_WIDTH_160 : Bandwidth); -+ } else -+ rtw_warn_on(1); -+ } -+ -+ if (bw_bmp == 0) -+ goto exit; -+ -+ /* loop for each possible tx bandwidth to find minimum limit */ -+ for (bw = CHANNEL_WIDTH_20; bw <= Bandwidth; bw++) { -+ s8 ch_idx; -+ -+ if (!(ch_width_to_bw_cap(bw) & bw_bmp)) -+ continue; -+ -+ if (no_sc == _FALSE) { -+ if (bw == CHANNEL_WIDTH_20) -+ cch = hal_data->cch_20; -+ else if (bw == CHANNEL_WIDTH_40) -+ cch = hal_data->cch_40; -+ else if (bw == CHANNEL_WIDTH_80) -+ cch = hal_data->cch_80; -+ else { -+ cch = 0; -+ rtw_warn_on(1); -+ } -+ } -+ -+ ch_idx = phy_GetChannelIndexOfTxPowerLimit(Band, cch); -+ if (ch_idx == -1) -+ continue; -+ -+ if (Band == BAND_ON_2_4G) { -+ s8 limits[MAX_REGULATION_NUM] = {0}; -+ u8 i = 0; -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) -+ limits[i] = hal_data->TxPwrLimit_2_4G[i][bw][rs][ch_idx][RfPath]; -+ -+ tmp_lmt = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : -+ hal_data->TxPwrLimit_2_4G[regulation][bw][rs][ch_idx][RfPath]; -+ -+ } else if (Band == BAND_ON_5G) { -+ s8 limits[MAX_REGULATION_NUM] = {0}; -+ u8 i = 0; -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) -+ limits[i] = hal_data->TxPwrLimit_5G[i][bw][rs][ch_idx][RfPath]; -+ -+ tmp_lmt = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : -+ hal_data->TxPwrLimit_5G[regulation][bw][rs][ch_idx][RfPath]; -+ } else -+ continue; -+ -+ if (min_lmt >= tmp_lmt) { -+ min_lmt = tmp_lmt; -+ final_cch = cch; -+ final_bw = bw; -+ } -+ } -+ -+exit: -+ return min_lmt; -+} -+ -+inline s8 -+PHY_GetTxPowerLimit( -+ IN PADAPTER Adapter, -+ IN u32 RegPwrTblSel, -+ IN BAND_TYPE Band, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 RfPath, -+ IN u8 DataRate, -+ IN u8 Channel -+) -+{ -+ BOOLEAN no_sc = _FALSE; -+ -+ /* MP mode channel don't use secondary channel */ -+ if (rtw_mi_mp_mode_check(Adapter) == _TRUE) -+ no_sc = _TRUE; -+ -+ return _phy_get_txpwr_lmt(Adapter, RegPwrTblSel, Band, Bandwidth, RfPath, DataRate, Channel, no_sc); -+} -+ -+inline s8 -+PHY_GetTxPowerLimit_no_sc( -+ IN PADAPTER Adapter, -+ IN u32 RegPwrTblSel, -+ IN BAND_TYPE Band, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 RfPath, -+ IN u8 DataRate, -+ IN u8 Channel -+) -+{ -+ return _phy_get_txpwr_lmt(Adapter, RegPwrTblSel, Band, Bandwidth, RfPath, DataRate, Channel, _TRUE); -+} -+ -+#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI -+s8 -+PHY_GetTxPowerLimitOriginal( -+ IN PADAPTER Adapter, -+ IN u32 RegPwrTblSel, -+ IN BAND_TYPE Band, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 RfPath, -+ IN u8 DataRate, -+ IN u8 Channel -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ s16 band = -1, regulation = -1, bandwidth = -1, -+ rateSection = -1, channel = -1; -+ s8 powerLimit = MAX_POWER_INDEX; -+ -+ if ((Adapter->registrypriv.RegEnableTxPowerLimit == 2 && pHalData->EEPROMRegulatory != 1) || -+ Adapter->registrypriv.RegEnableTxPowerLimit == 0) -+ return MAX_POWER_INDEX; -+ -+ switch (Adapter->registrypriv.RegPwrTblSel) { -+ case 1: -+ regulation = TXPWR_LMT_ETSI; -+ break; -+ -+ case 2: -+ regulation = TXPWR_LMT_MKK; -+ break; -+ -+ case 3: -+ regulation = TXPWR_LMT_FCC; -+ break; -+ -+ case 4: -+ regulation = TXPWR_LMT_WW; -+ break; -+ -+ default: -+ regulation = (Band == BAND_ON_2_4G) ? pHalData->Regulation2_4G -+ : pHalData->Regulation5G; -+ break; -+ } -+ -+ /*DBG_871X("pMgntInfo->RegPwrTblSel %d, final regulation %d\n", Adapter->registrypriv.RegPwrTblSel, regulation );*/ -+ -+ -+ if (Band == BAND_ON_2_4G) -+ band = 0; -+ else if (Band == BAND_ON_5G) -+ band = 1; -+ -+ if (Bandwidth == CHANNEL_WIDTH_20) -+ bandwidth = 0; -+ else if (Bandwidth == CHANNEL_WIDTH_40) -+ bandwidth = 1; -+ else if (Bandwidth == CHANNEL_WIDTH_80) -+ bandwidth = 2; -+ else if (Bandwidth == CHANNEL_WIDTH_160) -+ bandwidth = 3; -+ -+ switch (DataRate) { -+ case MGN_1M: -+ case MGN_2M: -+ case MGN_5_5M: -+ case MGN_11M: -+ rateSection = 0; -+ break; -+ -+ case MGN_6M: -+ case MGN_9M: -+ case MGN_12M: -+ case MGN_18M: -+ case MGN_24M: -+ case MGN_36M: -+ case MGN_48M: -+ case MGN_54M: -+ rateSection = 1; -+ break; -+ -+ case MGN_MCS0: -+ case MGN_MCS1: -+ case MGN_MCS2: -+ case MGN_MCS3: -+ case MGN_MCS4: -+ case MGN_MCS5: -+ case MGN_MCS6: -+ case MGN_MCS7: -+ rateSection = 2; -+ break; -+ -+ case MGN_MCS8: -+ case MGN_MCS9: -+ case MGN_MCS10: -+ case MGN_MCS11: -+ case MGN_MCS12: -+ case MGN_MCS13: -+ case MGN_MCS14: -+ case MGN_MCS15: -+ rateSection = 3; -+ break; -+ -+ case MGN_MCS16: -+ case MGN_MCS17: -+ case MGN_MCS18: -+ case MGN_MCS19: -+ case MGN_MCS20: -+ case MGN_MCS21: -+ case MGN_MCS22: -+ case MGN_MCS23: -+ rateSection = 4; -+ break; -+ -+ case MGN_MCS24: -+ case MGN_MCS25: -+ case MGN_MCS26: -+ case MGN_MCS27: -+ case MGN_MCS28: -+ case MGN_MCS29: -+ case MGN_MCS30: -+ case MGN_MCS31: -+ rateSection = 5; -+ break; -+ -+ case MGN_VHT1SS_MCS0: -+ case MGN_VHT1SS_MCS1: -+ case MGN_VHT1SS_MCS2: -+ case MGN_VHT1SS_MCS3: -+ case MGN_VHT1SS_MCS4: -+ case MGN_VHT1SS_MCS5: -+ case MGN_VHT1SS_MCS6: -+ case MGN_VHT1SS_MCS7: -+ case MGN_VHT1SS_MCS8: -+ case MGN_VHT1SS_MCS9: -+ rateSection = 6; -+ break; -+ -+ case MGN_VHT2SS_MCS0: -+ case MGN_VHT2SS_MCS1: -+ case MGN_VHT2SS_MCS2: -+ case MGN_VHT2SS_MCS3: -+ case MGN_VHT2SS_MCS4: -+ case MGN_VHT2SS_MCS5: -+ case MGN_VHT2SS_MCS6: -+ case MGN_VHT2SS_MCS7: -+ case MGN_VHT2SS_MCS8: -+ case MGN_VHT2SS_MCS9: -+ rateSection = 7; -+ break; -+ -+ case MGN_VHT3SS_MCS0: -+ case MGN_VHT3SS_MCS1: -+ case MGN_VHT3SS_MCS2: -+ case MGN_VHT3SS_MCS3: -+ case MGN_VHT3SS_MCS4: -+ case MGN_VHT3SS_MCS5: -+ case MGN_VHT3SS_MCS6: -+ case MGN_VHT3SS_MCS7: -+ case MGN_VHT3SS_MCS8: -+ case MGN_VHT3SS_MCS9: -+ rateSection = 8; -+ break; -+ -+ case MGN_VHT4SS_MCS0: -+ case MGN_VHT4SS_MCS1: -+ case MGN_VHT4SS_MCS2: -+ case MGN_VHT4SS_MCS3: -+ case MGN_VHT4SS_MCS4: -+ case MGN_VHT4SS_MCS5: -+ case MGN_VHT4SS_MCS6: -+ case MGN_VHT4SS_MCS7: -+ case MGN_VHT4SS_MCS8: -+ case MGN_VHT4SS_MCS9: -+ rateSection = 9; -+ break; -+ -+ default: -+ DBG_871X("Wrong rate 0x%x\n", DataRate); -+ break; -+ } -+ -+ if (Band == BAND_ON_5G && rateSection == 0) -+ DBG_871X("Wrong rate 0x%x: No CCK in 5G Band\n", DataRate); -+ -+ /*workaround for wrong index combination to obtain tx power limit,*/ -+ /*OFDM only exists in BW 20M*/ -+ if (rateSection == 1) -+ bandwidth = 0; -+ -+ /*workaround for wrong index combination to obtain tx power limit,*/ -+ /*CCK table will only be given in BW 20M*/ -+ if (rateSection == 0) -+ bandwidth = 0; -+ -+ /*workaround for wrong indxe combination to obtain tx power limit,*/ -+ /*HT on 80M will reference to HT on 40M*/ -+ if ((rateSection == 2 || rateSection == 3) && Band == BAND_ON_5G && bandwidth == 2) -+ bandwidth = 1; -+ -+ if (Band == BAND_ON_2_4G) -+ channel = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_2_4G, Channel); -+ else if (Band == BAND_ON_5G) -+ channel = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_5G, Channel); -+ else if (Band == BAND_ON_BOTH) -+ /*BAND_ON_BOTH don't care temporarily*/ -+ -+ if (band == -1 || regulation == -1 || bandwidth == -1 || -+ rateSection == -1 || channel == -1) { -+ /*DBG_871X("Wrong index value to access power limit table [band %d][regulation %d][bandwidth %d][rf_path %d][rate_section %d][chnlGroup %d]\n",*/ -+ /* band, regulation, bandwidth, RfPath, rateSection, channelGroup );*/ -+ -+ return MAX_POWER_INDEX; -+ } -+ -+ if (Band == BAND_ON_2_4G) { -+ s8 limits[10] = {0}; -+ u8 i = 0; -+ -+ if (bandwidth >= MAX_2_4G_BANDWIDTH_NUM) -+ bandwidth = MAX_2_4G_BANDWIDTH_NUM - 1; -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) -+ limits[i] = pHalData->TxPwrLimit_2_4G_Original[i][bandwidth][rateSection][channel][RfPath]; -+ -+ powerLimit = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : -+ pHalData->TxPwrLimit_2_4G_Original[regulation][bandwidth][rateSection][channel][RfPath]; -+ -+ } else if (Band == BAND_ON_5G) { -+ s8 limits[10] = {0}; -+ u8 i = 0; -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) -+ limits[i] = pHalData->TxPwrLimit_5G_Original[i][bandwidth][rateSection][channel][RfPath]; -+ -+ powerLimit = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : -+ pHalData->TxPwrLimit_5G_Original[regulation][bandwidth][rateSection][channel][RfPath]; -+ } else -+ DBG_871X("No power limit table of the specified band\n"); -+ -+ /*combine 5G VHT & HT rate*/ -+ /*5G 20M and 40M HT and VHT can cross reference*/ -+ /* -+ if (Band == BAND_ON_5G && powerLimit == MAX_POWER_INDEX) { -+ if (bandwidth == 0 || bandwidth == 1) { -+ if (rateSection == 2) -+ powerLimit = pHalData->TxPwrLimit_5G_Original[regulation] -+ [bandwidth][4][channelGroup][RfPath]; -+ else if (rateSection == 4) -+ powerLimit = pHalData->TxPwrLimit_5G_Original[regulation] -+ [bandwidth][2][channelGroup][RfPath]; -+ else if (rateSection == 3) -+ powerLimit = pHalData->TxPwrLimit_5G_Original[regulation] -+ [bandwidth][5][channelGroup][RfPath]; -+ else if (rateSection == 5) -+ powerLimit = pHalData->TxPwrLimit_5G_Original[regulation] -+ [bandwidth][3][channelGroup][RfPath]; -+ } -+ } -+ */ -+ /*DBG_871X("TxPwrLmt[Regulation %d][Band %d][BW %d][RFPath %d][Rate 0x%x][Chnl %d] = %d\n",*/ -+ /* regulation, pHalData->CurrentBandType, Bandwidth, RfPath, DataRate, Channel, powerLimit);*/ -+ return powerLimit; -+} -+#endif -+ -+ -+VOID -+phy_CrossReferenceHTAndVHTTxPowerLimit( -+ IN PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 regulation, bw, channel, rs, ref_rs; -+ int ht_ref_vht_5g_20_40 = 0; -+ int vht_ref_ht_5g_20_40 = 0; -+ int ht_has_ref_5g_20_40 = 0; -+ int vht_has_ref_5g_20_40 = 0; -+ -+ pHalData->tx_pwr_lmt_5g_20_40_ref = 0; -+ -+ for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { -+ -+ for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) { -+ -+ for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { -+ -+ for (rs = 0; rs < MAX_RATE_SECTION_NUM; ++rs) { -+ -+ /* 5G 20M 40M VHT and HT can cross reference */ -+ if (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40) { -+ if (rs == HT_1SS) -+ ref_rs = VHT_1SS; -+ else if (rs == HT_2SS) -+ ref_rs = VHT_2SS; -+ else if (rs == HT_3SS) -+ ref_rs = VHT_3SS; -+ else if (rs == HT_4SS) -+ ref_rs = VHT_4SS; -+ else if (rs == VHT_1SS) -+ ref_rs = HT_1SS; -+ else if (rs == VHT_2SS) -+ ref_rs = HT_2SS; -+ else if (rs == VHT_3SS) -+ ref_rs = HT_3SS; -+ else if (rs == VHT_4SS) -+ ref_rs = HT_4SS; -+ else -+ continue; -+ -+ if (pHalData->TxPwrLimit_5G[regulation][bw][ref_rs][channel][RF_PATH_A] == MAX_POWER_INDEX) -+ continue; -+ -+ if (IS_HT_RATE_SECTION(rs)) -+ ht_has_ref_5g_20_40++; -+ else if (IS_VHT_RATE_SECTION(rs)) -+ vht_has_ref_5g_20_40++; -+ else -+ continue; -+ -+ if (pHalData->TxPwrLimit_5G[regulation][bw][rs][channel][RF_PATH_A] != MAX_POWER_INDEX) -+ continue; -+ -+ if (IS_HT_RATE_SECTION(rs) && IS_VHT_RATE_SECTION(ref_rs)) -+ ht_ref_vht_5g_20_40++; -+ else if (IS_VHT_RATE_SECTION(rs) && IS_HT_RATE_SECTION(ref_rs)) -+ vht_ref_ht_5g_20_40++; -+ -+ if (0) -+ RTW_INFO("reg:%u, bw:%u, ch:%u, %s ref %s\n" -+ , regulation, bw, channel -+ , rate_section_str(rs), rate_section_str(ref_rs)); -+ -+ pHalData->TxPwrLimit_5G[regulation][bw][rs][channel][RF_PATH_A] = -+ pHalData->TxPwrLimit_5G[regulation][bw][ref_rs][channel][RF_PATH_A]; -+ } -+ -+ } -+ } -+ } -+ } -+ -+ if (0) { -+ RTW_INFO("ht_ref_vht_5g_20_40:%d, ht_has_ref_5g_20_40:%d\n", ht_ref_vht_5g_20_40, ht_has_ref_5g_20_40); -+ RTW_INFO("vht_ref_hht_5g_20_40:%d, vht_has_ref_5g_20_40:%d\n", vht_ref_ht_5g_20_40, vht_has_ref_5g_20_40); -+ } -+ -+ /* 5G 20M&40M HT all come from VHT*/ -+ if (ht_ref_vht_5g_20_40 && ht_has_ref_5g_20_40 == ht_ref_vht_5g_20_40) -+ pHalData->tx_pwr_lmt_5g_20_40_ref |= TX_PWR_LMT_REF_HT_FROM_VHT; -+ -+ /* 5G 20M&40M VHT all come from HT*/ -+ if (vht_ref_ht_5g_20_40 && vht_has_ref_5g_20_40 == vht_ref_ht_5g_20_40) -+ pHalData->tx_pwr_lmt_5g_20_40_ref |= TX_PWR_LMT_REF_VHT_FROM_HT; -+} -+ -+VOID -+PHY_ConvertTxPowerLimitToPowerIndex( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 base; -+ u8 regulation, bw, channel, rateSection; -+ s8 tempValue = 0, tempPwrLmt = 0; -+ u8 rfPath = 0; -+ -+ if (pHalData->odmpriv.PhyRegPgValueType != PHY_REG_PG_EXACT_VALUE) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ phy_CrossReferenceHTAndVHTTxPowerLimit(Adapter); -+ -+ for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { -+ -+ for (bw = 0; bw < MAX_2_4G_BANDWIDTH_NUM; ++bw) { -+ -+ for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) { -+ -+ for (rateSection = CCK; rateSection <= HT_4SS; ++rateSection) { -+ tempPwrLmt = pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][channel][RF_PATH_A]; -+ -+ if (tempPwrLmt != MAX_POWER_INDEX) { -+ -+ for (rfPath = RF_PATH_A; rfPath < MAX_RF_PATH; ++rfPath) { -+ base = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_2_4G, rfPath, rate_section_to_tx_num(rateSection), rateSection); -+ tempValue = tempPwrLmt - base; -+ pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][channel][rfPath] = tempValue; -+ } -+ } -+ } -+ } -+ } -+ } -+ -+ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) { -+ -+ for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { -+ -+ for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) { -+ -+ for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { -+ -+ for (rateSection = OFDM; rateSection <= VHT_4SS; ++rateSection) { -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation][bw][rateSection][channel][RF_PATH_A]; -+ -+ if (tempPwrLmt != MAX_POWER_INDEX) { -+ -+ for (rfPath = RF_PATH_A; rfPath < MAX_RF_PATH; ++rfPath) { -+ base = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_5G, rfPath, rate_section_to_tx_num(rateSection), rateSection); -+ tempValue = tempPwrLmt - base; -+ pHalData->TxPwrLimit_5G[regulation][bw][rateSection][channel][rfPath] = tempValue; -+ } -+ } -+ } -+ } -+ } -+ } -+ } -+} -+ -+/* -+* PHY_InitTxPowerLimit - Set all hal_data.TxPwrLimit_2_4G, TxPwrLimit_5G array to MAX_POWER_INDEX -+*/ -+VOID -+PHY_InitTxPowerLimit( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 i, j, k, l, m; -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) -+ for (j = 0; j < MAX_2_4G_BANDWIDTH_NUM; ++j) -+ for (k = 0; k < MAX_RATE_SECTION_NUM; ++k) -+ for (m = 0; m < CENTER_CH_2G_NUM; ++m) -+ for (l = 0; l < MAX_RF_PATH; ++l) -+ pHalData->TxPwrLimit_2_4G[i][j][k][m][l] = MAX_POWER_INDEX; -+ -+ for (i = 0; i < MAX_REGULATION_NUM; ++i) -+ for (j = 0; j < MAX_5G_BANDWIDTH_NUM; ++j) -+ for (k = 0; k < MAX_RATE_SECTION_NUM; ++k) -+ for (m = 0; m < CENTER_CH_5G_ALL_NUM; ++m) -+ for (l = 0; l < MAX_RF_PATH; ++l) -+ pHalData->TxPwrLimit_5G[i][j][k][m][l] = MAX_POWER_INDEX; -+} -+ -+/* -+* PHY_SetTxPowerLimit - Parsing TX power limit from phydm array, called by odm_ConfigBB_TXPWR_LMT_XXX in phydm -+*/ -+VOID -+PHY_SetTxPowerLimit( -+ IN PDM_ODM_T pDM_Odm, -+ IN u8 *Regulation, -+ IN u8 *Band, -+ IN u8 *Bandwidth, -+ IN u8 *RateSection, -+ IN u8 *RfPath, -+ IN u8 *Channel, -+ IN u8 *PowerLimit -+) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 regulation = 0, bandwidth = 0, rateSection = 0, channel; -+ s8 powerLimit = 0, prevPowerLimit, channelIndex; -+ -+ if (0) -+ RTW_INFO("Index of power limit table [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s][val %s]\n" -+ , Band, Regulation, Bandwidth, RateSection, RfPath, Channel, PowerLimit); -+ -+ if (GetU1ByteIntegerFromStringInDecimal((s8 *)Channel, &channel) == _FALSE -+ || GetU1ByteIntegerFromStringInDecimal((s8 *)PowerLimit, &powerLimit) == _FALSE -+ ) { -+ RTW_PRINT("Illegal index of power limit table [ch %s][val %s]\n", Channel, PowerLimit); -+ return; -+ } -+ -+ powerLimit = powerLimit > MAX_POWER_INDEX ? MAX_POWER_INDEX : powerLimit; -+ -+ if (eqNByte(Regulation, (u8 *)("FCC"), 3)) -+ regulation = TXPWR_LMT_FCC; -+ else if (eqNByte(Regulation, (u8 *)("MKK"), 3)) -+ regulation = TXPWR_LMT_MKK; -+ else if (eqNByte(Regulation, (u8 *)("ETSI"), 4)) -+ regulation = TXPWR_LMT_ETSI; -+ else if (eqNByte(Regulation, (u8 *)("WW13"), 4)) -+ regulation = TXPWR_LMT_WW; -+ else { -+ RTW_PRINT("unknown regulation:%s", Regulation); -+ return; -+ } -+ -+ if (eqNByte(RateSection, (u8 *)("CCK"), 3) && eqNByte(RfPath, (u8 *)("1T"), 2)) -+ rateSection = CCK; -+ else if (eqNByte(RateSection, (u8 *)("OFDM"), 4) && eqNByte(RfPath, (u8 *)("1T"), 2)) -+ rateSection = OFDM; -+ else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("1T"), 2)) -+ rateSection = HT_1SS; -+ else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("2T"), 2)) -+ rateSection = HT_2SS; -+ else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("3T"), 2)) -+ rateSection = HT_3SS; -+ else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("4T"), 2)) -+ rateSection = HT_4SS; -+ else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("1T"), 2)) -+ rateSection = VHT_1SS; -+ else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("2T"), 2)) -+ rateSection = VHT_2SS; -+ else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("3T"), 2)) -+ rateSection = VHT_3SS; -+ else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("4T"), 2)) -+ rateSection = VHT_4SS; -+ else { -+ RTW_PRINT("Wrong rate section: (%s,%s)\n", RateSection, RfPath); -+ return; -+ } -+ -+ if (eqNByte(Bandwidth, (u8 *)("20M"), 3)) -+ bandwidth = CHANNEL_WIDTH_20; -+ else if (eqNByte(Bandwidth, (u8 *)("40M"), 3)) -+ bandwidth = CHANNEL_WIDTH_40; -+ else if (eqNByte(Bandwidth, (u8 *)("80M"), 3)) -+ bandwidth = CHANNEL_WIDTH_80; -+ else { -+ RTW_PRINT("unknown bandwidth: %s\n", Bandwidth); -+ return; -+ } -+ -+ if (eqNByte(Band, (u8 *)("2.4G"), 4)) { -+ channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_2_4G, channel); -+ -+ if (channelIndex == -1) { -+ RTW_PRINT("unsupported channel: %d at 2.4G\n", channel); -+ return; -+ } -+ -+ if (bandwidth >= MAX_2_4G_BANDWIDTH_NUM) { -+ RTW_PRINT("unsupported bandwidth: %s at 2.4G\n", Bandwidth); -+ return; -+ } -+ -+ prevPowerLimit = pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A]; -+ -+ if (prevPowerLimit != MAX_POWER_INDEX) -+ RTW_PRINT("duplicate tx power limit combination [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s]\n" -+ , Band, Regulation, Bandwidth, RateSection, RfPath, Channel); -+ -+ if (powerLimit < prevPowerLimit) -+ pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A] = powerLimit; -+ -+ if (0) -+ RTW_INFO("2.4G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n" -+ , regulation, bandwidth, rateSection, channelIndex, pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A]); -+ } else if (eqNByte(Band, (u8 *)("5G"), 2)) { -+ -+ channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_5G, channel); -+ -+ if (channelIndex == -1) { -+ RTW_PRINT("unsupported channel: %d at 5G\n", channel); -+ return; -+ } -+ -+ prevPowerLimit = pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A]; -+ -+ if (prevPowerLimit != MAX_POWER_INDEX) -+ RTW_PRINT("duplicate tx power limit combination [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s]\n" -+ , Band, Regulation, Bandwidth, RateSection, RfPath, Channel); -+ -+ if (powerLimit < prevPowerLimit) -+ pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A] = powerLimit; -+ -+ if (0) -+ RTW_INFO("5G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n" -+ , regulation, bandwidth, rateSection, channel, pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A]); -+ } else { -+ RTW_PRINT("Cannot recognize the band info in %s\n", Band); -+ return; -+ } -+} -+ -+u8 -+PHY_GetTxPowerIndex( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel -+) -+{ -+ return rtw_hal_get_tx_power_index(pAdapter, RFPath, Rate, BandWidth, Channel, NULL); -+} -+ -+VOID -+PHY_SetTxPowerIndex( -+ IN PADAPTER pAdapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+) -+{ -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) { -+#if (RTL8814A_SUPPORT == 1) -+ PHY_SetTxPowerIndex_8814A(pAdapter, PowerIndex, RFPath, Rate); -+#endif -+ } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) { -+#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -+ PHY_SetTxPowerIndex_8812A(pAdapter, PowerIndex, RFPath, Rate); -+#endif -+ } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+#if (RTL8723B_SUPPORT == 1) -+ PHY_SetTxPowerIndex_8723B(pAdapter, PowerIndex, RFPath, Rate); -+#endif -+ } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -+#if (RTL8703B_SUPPORT == 1) -+ PHY_SetTxPowerIndex_8703B(pAdapter, PowerIndex, RFPath, Rate); -+#endif -+ } else if (IS_HARDWARE_TYPE_8723D(pAdapter)) { -+#if (RTL8723D_SUPPORT == 1) -+ PHY_SetTxPowerIndex_8723D(pAdapter, PowerIndex, RFPath, Rate); -+#endif -+ } else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { -+#if (RTL8192E_SUPPORT == 1) -+ PHY_SetTxPowerIndex_8192E(pAdapter, PowerIndex, RFPath, Rate); -+#endif -+ } else if (IS_HARDWARE_TYPE_8188E(pAdapter)) { -+#if (RTL8188E_SUPPORT == 1) -+ PHY_SetTxPowerIndex_8188E(pAdapter, PowerIndex, RFPath, Rate); -+#endif -+ } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { -+#if (RTL8188F_SUPPORT == 1) -+ PHY_SetTxPowerIndex_8188F(pAdapter, PowerIndex, RFPath, Rate); -+#endif -+ } else if (IS_HARDWARE_TYPE_8822B(pAdapter)) -+ rtw_hal_set_tx_power_index(pAdapter, PowerIndex, RFPath, Rate); -+ else if (IS_HARDWARE_TYPE_8821C(pAdapter)) -+ rtw_hal_set_tx_power_index(pAdapter, PowerIndex, RFPath, Rate); -+} -+ -+void dump_tx_power_idx_title(void *sel, _adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ u8 bw = hal_data->CurrentChannelBW; -+ -+ RTW_PRINT_SEL(sel, "%s", ch_width_str(bw)); -+ if (bw >= CHANNEL_WIDTH_80) -+ _RTW_PRINT_SEL(sel, ", cch80:%u", hal_data->cch_80); -+ if (bw >= CHANNEL_WIDTH_40) -+ _RTW_PRINT_SEL(sel, ", cch40:%u", hal_data->cch_40); -+ _RTW_PRINT_SEL(sel, ", cch20:%u\n", hal_data->cch_20); -+ -+ RTW_PRINT_SEL(sel, "%-4s %-9s %-3s %-4s %-3s %-4s %-4s %-3s %-5s\n" -+ , "path", "rate", "pwr", "base", "", "(byr", "lmt)", "tpt", "ebias"); -+} -+ -+void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath, u8 rs) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ u8 power_idx; -+ struct txpwr_idx_comp tic; -+ u8 tx_num, i; -+ u8 band = hal_data->CurrentBandType; -+ u8 cch = hal_data->CurrentChannel; -+ u8 bw = hal_data->CurrentChannelBW; -+ -+ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, rfpath)) -+ return; -+ -+ if (rs >= RATE_SECTION_NUM) -+ return; -+ -+ tx_num = rate_section_to_tx_num(rs); -+ if (tx_num >= hal_spec->nss_num || tx_num >= hal_spec->max_tx_cnt) -+ return; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ return; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) -+ return; -+ -+ for (i = 0; i < rates_by_sections[rs].rate_num; i++) { -+ power_idx = rtw_hal_get_tx_power_index(adapter, rfpath, rates_by_sections[rs].rates[i], bw, cch, &tic); -+ -+ RTW_PRINT_SEL(sel, "%4c %9s %3u %4u %3d (%3d %3d) %3d %5d\n" -+ , rf_path_char(rfpath), MGN_RATE_STR(rates_by_sections[rs].rates[i]) -+ , power_idx, tic.base, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt, tic.ebias); -+ } -+} -+ -+void dump_tx_power_idx(void *sel, _adapter *adapter) -+{ -+ u8 rfpath, rs; -+ -+ dump_tx_power_idx_title(sel, adapter); -+ for (rfpath = RF_PATH_A; rfpath < RF_PATH_MAX; rfpath++) -+ for (rs = CCK; rs < RATE_SECTION_NUM; rs++) -+ dump_tx_power_idx_by_path_rs(sel, adapter, rfpath, rs); -+} -+ -+bool phy_is_tx_power_limit_needed(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); -+ -+ if (regsty->RegEnableTxPowerLimit == 1 -+ || (regsty->RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory == 1)) -+ return _TRUE; -+ return _FALSE; -+} -+ -+bool phy_is_tx_power_by_rate_needed(_adapter *adapter) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); -+ -+ if (regsty->RegEnableTxPowerByRate == 1 -+ || (regsty->RegEnableTxPowerByRate == 2 && hal_data->EEPROMRegulatory != 2)) -+ return _TRUE; -+ return _FALSE; -+} -+ -+int phy_load_tx_power_by_rate(_adapter *adapter, u8 chk_file) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); -+ int ret = _FAIL; -+ -+ hal_data->txpwr_by_rate_loaded = 0; -+ PHY_InitTxPowerByRate(adapter); -+ -+ /* tx power limit is based on tx power by rate */ -+ hal_data->txpwr_limit_loaded = 0; -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (chk_file -+ && phy_ConfigBBWithPgParaFile(adapter, PHY_FILE_PHY_REG_PG) == _SUCCESS -+ ) { -+ hal_data->txpwr_by_rate_from_file = 1; -+ goto post_hdl; -+ } -+#endif -+ -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS == ODM_ConfigBBWithHeaderFile(&hal_data->odmpriv, CONFIG_BB_PHY_REG_PG)) { -+ RTW_INFO("default power by rate loaded\n"); -+ hal_data->txpwr_by_rate_from_file = 0; -+ goto post_hdl; -+ } -+#endif -+ -+ RTW_ERR("%s():Read Tx power by rate fail\n", __func__); -+ goto exit; -+ -+post_hdl: -+ if (hal_data->odmpriv.PhyRegPgValueType != PHY_REG_PG_EXACT_VALUE) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ PHY_TxPowerByRateConfiguration(adapter); -+ hal_data->txpwr_by_rate_loaded = 1; -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+int phy_load_tx_power_limit(_adapter *adapter, u8 chk_file) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); -+ int ret = _FAIL; -+ -+ hal_data->txpwr_limit_loaded = 0; -+ PHY_InitTxPowerLimit(adapter); -+ -+ if (!hal_data->txpwr_by_rate_loaded && regsty->target_tx_pwr_valid != _TRUE) { -+ RTW_ERR("%s():Read Tx power limit before target tx power is specify\n", __func__); -+ goto exit; -+ } -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (chk_file -+ && PHY_ConfigRFWithPowerLimitTableParaFile(adapter, PHY_FILE_TXPWR_LMT) == _SUCCESS -+ ) { -+ hal_data->txpwr_limit_from_file = 1; -+ goto post_hdl; -+ } -+#endif -+ -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS == ODM_ConfigRFWithHeaderFile(&hal_data->odmpriv, CONFIG_RF_TXPWR_LMT, (ODM_RF_RADIO_PATH_E)0)) { -+ RTW_INFO("default power limit loaded\n"); -+ hal_data->txpwr_limit_from_file = 0; -+ goto post_hdl; -+ } -+#endif -+ -+ RTW_ERR("%s():Read Tx power limit fail\n", __func__); -+ goto exit; -+ -+post_hdl: -+ PHY_ConvertTxPowerLimitToPowerIndex(adapter); -+ hal_data->txpwr_limit_loaded = 1; -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+void phy_load_tx_power_ext_info(_adapter *adapter, u8 chk_file) -+{ -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ -+ /* check registy target tx power */ -+ regsty->target_tx_pwr_valid = rtw_regsty_chk_target_tx_power_valid(adapter); -+ -+ /* power by rate and limit */ -+ if (phy_is_tx_power_by_rate_needed(adapter) -+ || (phy_is_tx_power_limit_needed(adapter) && regsty->target_tx_pwr_valid != _TRUE) -+ ) -+ phy_load_tx_power_by_rate(adapter, chk_file); -+ -+ if (phy_is_tx_power_limit_needed(adapter)) -+ phy_load_tx_power_limit(adapter, chk_file); -+} -+ -+inline void phy_reload_tx_power_ext_info(_adapter *adapter) -+{ -+ phy_load_tx_power_ext_info(adapter, 1); -+} -+ -+inline void phy_reload_default_tx_power_ext_info(_adapter *adapter) -+{ -+ phy_load_tx_power_ext_info(adapter, 0); -+} -+ -+void dump_tx_power_ext_info(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ -+ if (regsty->target_tx_pwr_valid == _TRUE) -+ RTW_PRINT_SEL(sel, "target_tx_power: from registry\n"); -+ else if (phy_is_tx_power_by_rate_needed(adapter)) -+ RTW_PRINT_SEL(sel, "target_tx_power: from power by rate\n"); -+ else -+ RTW_PRINT_SEL(sel, "target_tx_power: unavailable\n"); -+ -+ RTW_PRINT_SEL(sel, "tx_power_by_rate: %s, %s, %s\n" -+ , phy_is_tx_power_by_rate_needed(adapter) ? "enabled" : "disabled" -+ , hal_data->txpwr_by_rate_loaded ? "loaded" : "unloaded" -+ , hal_data->txpwr_by_rate_from_file ? "file" : "default" -+ ); -+ -+ RTW_PRINT_SEL(sel, "tx_power_limit: %s, %s, %s\n" -+ , phy_is_tx_power_limit_needed(adapter) ? "enabled" : "disabled" -+ , hal_data->txpwr_limit_loaded ? "loaded" : "unloaded" -+ , hal_data->txpwr_limit_from_file ? "file" : "default" -+ ); -+} -+ -+void dump_target_tx_power(void *sel, _adapter *adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct registry_priv *regsty = adapter_to_regsty(adapter); -+ int path, tx_num, band, rs; -+ u8 target; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ if (!hal_is_band_support(adapter, band)) -+ continue; -+ -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) -+ break; -+ -+ RTW_PRINT_SEL(sel, "[%s][%c]%s\n", band_str(band), rf_path_char(path) -+ , (regsty->target_tx_pwr_valid == _FALSE && hal_data->txpwr_by_rate_undefined_band_path[band][path]) ? "(dup)" : ""); -+ -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ tx_num = rate_section_to_tx_num(rs); -+ if (tx_num >= hal_spec->nss_num) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) -+ continue; -+ -+ target = PHY_GetTxPowerByRateBase(adapter, band, path, rate_section_to_tx_num(rs), rs); -+ -+ if (target % 2) -+ _RTW_PRINT_SEL(sel, "%7s: %2d.5\n", rate_section_str(rs), target / 2); -+ else -+ _RTW_PRINT_SEL(sel, "%7s: %4d\n", rate_section_str(rs), target / 2); -+ } -+ } -+ } -+ -+exit: -+ return; -+} -+ -+void dump_tx_power_by_rate(void *sel, _adapter *adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ int path, tx_num, band, n, rs; -+ u8 rate_num, max_rate_num, base; -+ s8 by_rate_offset; -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ if (!hal_is_band_support(adapter, band)) -+ continue; -+ -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) -+ break; -+ -+ RTW_PRINT_SEL(sel, "[%s][%c]%s\n", band_str(band), rf_path_char(path) -+ , hal_data->txpwr_by_rate_undefined_band_path[band][path] ? "(dup)" : ""); -+ -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ tx_num = rate_section_to_tx_num(rs); -+ if (tx_num >= hal_spec->nss_num) -+ continue; -+ -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) -+ continue; -+ -+ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) -+ max_rate_num = 10; -+ else -+ max_rate_num = 8; -+ rate_num = rate_section_rate_num(rs); -+ base = PHY_GetTxPowerByRateBase(adapter, band, path, tx_num, rs); -+ -+ RTW_PRINT_SEL(sel, "%7s: ", rate_section_str(rs)); -+ -+ /* dump power by rate in db */ -+ for (n = rate_num - 1; n >= 0; n--) { -+ by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, tx_num, rates_by_sections[rs].rates[n]); -+ -+ if ((base + by_rate_offset) % 2) -+ _RTW_PRINT_SEL(sel, "%2d.5 ", (base + by_rate_offset) / 2); -+ else -+ _RTW_PRINT_SEL(sel, "%4d ", (base + by_rate_offset) / 2); -+ } -+ for (n = 0; n < max_rate_num - rate_num; n++) -+ _RTW_PRINT_SEL(sel, "%4s ", ""); -+ -+ _RTW_PRINT_SEL(sel, "|"); -+ -+ /* dump power by rate in offset */ -+ for (n = rate_num - 1; n >= 0; n--) { -+ by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, tx_num, rates_by_sections[rs].rates[n]); -+ _RTW_PRINT_SEL(sel, "%3d ", by_rate_offset); -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ -+ } -+ } -+ } -+} -+ -+void dump_tx_power_limit(void *sel, _adapter *adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); -+ -+ int bw, band, ch_num, rs, i, path; -+ u8 ch, n, rd, rfpath_num; -+ -+ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) -+ RTW_PRINT_SEL(sel, "tx_pwr_lmt_5g_20_40_ref:0x%02x\n", hal_data->tx_pwr_lmt_5g_20_40_ref); -+ -+ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { -+ if (!hal_is_band_support(adapter, band)) -+ continue; -+ -+ rd = (band == BAND_ON_2_4G ? hal_data->Regulation2_4G : hal_data->Regulation5G); -+ rfpath_num = (band == BAND_ON_2_4G ? hal_spec->rfpath_num_2g : hal_spec->rfpath_num_5g); -+ -+ for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; bw++) { -+ -+ if (bw >= CHANNEL_WIDTH_160) -+ break; -+ if (band == BAND_ON_2_4G && bw >= CHANNEL_WIDTH_80) -+ break; -+ -+ if (band == BAND_ON_2_4G) -+ ch_num = CENTER_CH_2G_NUM; -+ else -+ ch_num = center_chs_5g_num(bw); -+ -+ if (ch_num == 0) { -+ rtw_warn_on(1); -+ break; -+ } -+ -+ for (rs = 0; rs < RATE_SECTION_NUM; rs++) { -+ if (band == BAND_ON_2_4G && IS_VHT_RATE_SECTION(rs)) -+ continue; -+ if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) -+ continue; -+ if (bw > CHANNEL_WIDTH_20 && (IS_CCK_RATE_SECTION(rs) || IS_OFDM_RATE_SECTION(rs))) -+ continue; -+ if (bw > CHANNEL_WIDTH_40 && IS_HT_RATE_SECTION(rs)) -+ continue; -+ -+ if (rate_section_to_tx_num(rs) >= hal_spec->nss_num) -+ continue; -+ -+ if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) -+ continue; -+ -+ /* by pass 5G 20M, 40M pure reference */ -+ if (band == BAND_ON_5G && (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40)) { -+ if (hal_data->tx_pwr_lmt_5g_20_40_ref == TX_PWR_LMT_REF_HT_FROM_VHT) { -+ if (IS_HT_RATE_SECTION(rs)) -+ continue; -+ } else if (hal_data->tx_pwr_lmt_5g_20_40_ref == TX_PWR_LMT_REF_VHT_FROM_HT) { -+ if (IS_VHT_RATE_SECTION(rs) && bw <= CHANNEL_WIDTH_40) -+ continue; -+ } -+ } -+ -+ RTW_PRINT_SEL(sel, "[%s][%s][%s]\n" -+ , band_str(band) -+ , ch_width_str(bw) -+ , rate_section_str(rs) -+ ); -+ -+ /* header for limit in db */ -+ RTW_PRINT_SEL(sel, "%3s %5s %5s %5s %5s " -+ , "ch" -+ , (rd == TXPWR_LMT_FCC ? "*FCC" : "FCC") -+ , (rd == TXPWR_LMT_ETSI ? "*ETSI" : "ETSI") -+ , (rd == TXPWR_LMT_MKK ? "*MKK" : "MKK") -+ , (rd == TXPWR_LMT_WW ? "*WW" : "WW") -+ ); -+ -+ /* header for limit offset */ -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (path >= rfpath_num) -+ break; -+ _RTW_PRINT_SEL(sel, "|%3c %3c %3c %3c " -+ , (rd == TXPWR_LMT_FCC ? rf_path_char(path) : ' ') -+ , (rd == TXPWR_LMT_ETSI ? rf_path_char(path) : ' ') -+ , (rd == TXPWR_LMT_MKK ? rf_path_char(path) : ' ') -+ , (rd == TXPWR_LMT_WW ? rf_path_char(path) : ' ') -+ ); -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ -+ for (n = 0; n < ch_num; n++) { -+ s8 limit_idx[RF_PATH_MAX][MAX_REGULATION_NUM]; -+ s8 limit_offset[MAX_REGULATION_NUM]; -+ u8 base; -+ -+ if (band == BAND_ON_2_4G) -+ ch = n + 1; -+ else -+ ch = center_chs_5g(bw, n); -+ -+ if (ch == 0) { -+ rtw_warn_on(1); -+ break; -+ } -+ -+ /* dump limit in db (calculate from path A) */ -+ limit_offset[0] = PHY_GetTxPowerLimit_no_sc(adapter, 3, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* FCC */ -+ limit_offset[1] = PHY_GetTxPowerLimit_no_sc(adapter, 1, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* ETSI */ -+ limit_offset[2] = PHY_GetTxPowerLimit_no_sc(adapter, 2, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* MKK */ -+ limit_offset[3] = PHY_GetTxPowerLimit_no_sc(adapter, 4, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* WW */ -+ -+ base = PHY_GetTxPowerByRateBase(adapter, band, RF_PATH_A, rate_section_to_tx_num(rs), rs); -+ -+ RTW_PRINT_SEL(sel, "%3u ", ch); -+ for (i = 0; i < MAX_REGULATION_NUM; i++) { -+ if (limit_offset[i] == MAX_POWER_INDEX) { -+ limit_idx[0][i] = MAX_POWER_INDEX; -+ _RTW_PRINT_SEL(sel, "%5s ", "NA"); -+ } else { -+ limit_idx[0][i] = limit_offset[i] + base; -+ if ((limit_offset[i] + base) % 2) -+ _RTW_PRINT_SEL(sel, "%3d.5 ", (limit_offset[i] + base) / 2); -+ else -+ _RTW_PRINT_SEL(sel, "%5d ", (limit_offset[i] + base) / 2); -+ } -+ } -+ -+ /* dump limit offset of each path */ -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (path >= rfpath_num) -+ break; -+ limit_offset[0] = PHY_GetTxPowerLimit_no_sc(adapter, 3, band, bw, path, rates_by_sections[rs].rates[0], ch); /* FCC */ -+ limit_offset[1] = PHY_GetTxPowerLimit_no_sc(adapter, 1, band, bw, path, rates_by_sections[rs].rates[0], ch); /* ETSI */ -+ limit_offset[2] = PHY_GetTxPowerLimit_no_sc(adapter, 2, band, bw, path, rates_by_sections[rs].rates[0], ch); /* MKK */ -+ limit_offset[3] = PHY_GetTxPowerLimit_no_sc(adapter, 4, band, bw, path, rates_by_sections[rs].rates[0], ch); /* WW */ -+ -+ base = PHY_GetTxPowerByRateBase(adapter, band, path, rate_section_to_tx_num(rs), rs); -+ -+ _RTW_PRINT_SEL(sel, "|"); -+ for (i = 0; i < MAX_REGULATION_NUM; i++) { -+ if (limit_offset[i] == MAX_POWER_INDEX) { -+ limit_idx[path][i] = MAX_POWER_INDEX; -+ _RTW_PRINT_SEL(sel, "%3s ", "NA"); -+ } else { -+ limit_idx[path][i] = limit_offset[i] + base; -+ _RTW_PRINT_SEL(sel, "%3d ", limit_offset[i]); -+ } -+ } -+ } -+ -+ /* compare limit_idx of each path, print 'x' when mismatch */ -+ if (rfpath_num > 1) { -+ for (i = 0; i < MAX_REGULATION_NUM; i++) { -+ for (path = 0; path < RF_PATH_MAX; path++) { -+ if (path >= rfpath_num) -+ break; -+ if (limit_idx[path][i] != limit_idx[(path + 1) % rfpath_num][i]) -+ break; -+ } -+ if (path >= rfpath_num) -+ _RTW_PRINT_SEL(sel, " "); -+ else -+ _RTW_PRINT_SEL(sel, "x"); -+ } -+ } -+ _RTW_PRINT_SEL(sel, "\n"); -+ -+ } -+ RTW_PRINT_SEL(sel, "\n"); -+ } /* loop for rate sections */ -+ } /* loop for bandwidths */ -+ } /* loop for bands */ -+} -+ -+/* -+ * phy file path is stored in global char array rtw_phy_para_file_path -+ * need to care about racing -+ */ -+int rtw_get_phy_file_path(_adapter *adapter, const char *file_name) -+{ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ int len = 0; -+ -+ if (file_name) { -+ len += snprintf(rtw_phy_para_file_path, PATH_LENGTH_MAX, "%s", rtw_phy_file_path); -+ #if defined(CONFIG_MULTIDRV) || defined(REALTEK_CONFIG_PATH_WITH_IC_NAME_FOLDER) -+ len += snprintf(rtw_phy_para_file_path + len, PATH_LENGTH_MAX - len, "%s/", hal_spec->ic_name); -+ #endif -+ len += snprintf(rtw_phy_para_file_path + len, PATH_LENGTH_MAX - len, "%s", file_name); -+ -+ return _TRUE; -+ } -+#endif -+ return _FALSE; -+} -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+int -+phy_ConfigMACWithParaFile( -+ IN PADAPTER Adapter, -+ IN char *pFileName -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegValue, u4bMove; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_MAC_PARA_FILE)) -+ return rtStatus; -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pHalData->mac_reg_len == 0) && (pHalData->mac_reg == NULL)) { -+ rtw_get_phy_file_path(Adapter, pFileName); -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pHalData->mac_reg = rtw_zvmalloc(rlen); -+ if (pHalData->mac_reg) { -+ _rtw_memcpy(pHalData->mac_reg, pHalData->para_file_buf, rlen); -+ pHalData->mac_reg_len = rlen; -+ } else -+ RTW_INFO("%s mac_reg alloc fail !\n", __FUNCTION__); -+ } -+ } -+ } else { -+ if ((pHalData->mac_reg_len != 0) && (pHalData->mac_reg != NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pHalData->mac_reg, pHalData->mac_reg_len); -+ rtStatus = _SUCCESS; -+ } else -+ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ if (!IsCommentString(szLine)) { -+ /* Get 1st hex value as register offset */ -+ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { -+ if (u4bRegOffset == 0xffff) { -+ /* Ending. */ -+ break; -+ } -+ -+ /* Get 2nd hex value as register value. */ -+ szLine += u4bMove; -+ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) -+ rtw_write8(Adapter, u4bRegOffset, (u8)u4bRegValue); -+ } -+ } -+ } -+ } else -+ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ -+ return rtStatus; -+} -+ -+int -+phy_ConfigBBWithParaFile( -+ IN PADAPTER Adapter, -+ IN char *pFileName, -+ IN u32 ConfigType -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegValue, u4bMove; -+ char *pBuf = NULL; -+ u32 *pBufLen = NULL; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_BB_PARA_FILE)) -+ return rtStatus; -+ -+ switch (ConfigType) { -+ case CONFIG_BB_PHY_REG: -+ pBuf = pHalData->bb_phy_reg; -+ pBufLen = &pHalData->bb_phy_reg_len; -+ break; -+ case CONFIG_BB_AGC_TAB: -+ pBuf = pHalData->bb_agc_tab; -+ pBufLen = &pHalData->bb_agc_tab_len; -+ break; -+ default: -+ RTW_INFO("Unknown ConfigType!! %d\r\n", ConfigType); -+ break; -+ } -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) { -+ rtw_get_phy_file_path(Adapter, pFileName); -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pBuf = rtw_zvmalloc(rlen); -+ if (pBuf) { -+ _rtw_memcpy(pBuf, pHalData->para_file_buf, rlen); -+ *pBufLen = rlen; -+ -+ switch (ConfigType) { -+ case CONFIG_BB_PHY_REG: -+ pHalData->bb_phy_reg = pBuf; -+ break; -+ case CONFIG_BB_AGC_TAB: -+ pHalData->bb_agc_tab = pBuf; -+ break; -+ } -+ } else -+ RTW_INFO("%s(): ConfigType %d alloc fail !\n", __FUNCTION__, ConfigType); -+ } -+ } -+ } else { -+ if ((pBufLen != NULL) && (*pBufLen != 0) && (pBuf != NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pBuf, *pBufLen); -+ rtStatus = _SUCCESS; -+ } else -+ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ if (!IsCommentString(szLine)) { -+ /* Get 1st hex value as register offset. */ -+ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { -+ if (u4bRegOffset == 0xffff) { -+ /* Ending. */ -+ break; -+ } else if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) { -+#ifdef CONFIG_LONG_DELAY_ISSUE -+ rtw_msleep_os(50); -+#else -+ rtw_mdelay_os(50); -+#endif -+ } else if (u4bRegOffset == 0xfd) -+ rtw_mdelay_os(5); -+ else if (u4bRegOffset == 0xfc) -+ rtw_mdelay_os(1); -+ else if (u4bRegOffset == 0xfb) -+ rtw_udelay_os(50); -+ else if (u4bRegOffset == 0xfa) -+ rtw_udelay_os(5); -+ else if (u4bRegOffset == 0xf9) -+ rtw_udelay_os(1); -+ -+ /* Get 2nd hex value as register value. */ -+ szLine += u4bMove; -+ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { -+ /* RTW_INFO("[BB-ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue); */ -+ PHY_SetBBReg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); -+ -+ if (u4bRegOffset == 0xa24) -+ pHalData->odmpriv.RFCalibrateInfo.RegA24 = u4bRegValue; -+ -+ /* Add 1us delay between BB/RF register setting. */ -+ rtw_udelay_os(1); -+ } -+ } -+ } -+ } -+ } else -+ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ -+ return rtStatus; -+} -+ -+VOID -+phy_DecryptBBPgParaFile( -+ PADAPTER Adapter, -+ char *buffer -+) -+{ -+ u32 i = 0, j = 0; -+ u8 map[95] = {0}; -+ u8 currentChar; -+ char *BufOfLines, *ptmp; -+ -+ /* RTW_INFO("=====>phy_DecryptBBPgParaFile()\n"); */ -+ /* 32 the ascii code of the first visable char, 126 the last one */ -+ for (i = 0; i < 95; ++i) -+ map[i] = (u8)(94 - i); -+ -+ ptmp = buffer; -+ i = 0; -+ for (BufOfLines = GetLineFromBuffer(ptmp); BufOfLines != NULL; BufOfLines = GetLineFromBuffer(ptmp)) { -+ /* RTW_INFO("Encrypted Line: %s\n", BufOfLines); */ -+ -+ for (j = 0; j < strlen(BufOfLines); ++j) { -+ currentChar = BufOfLines[j]; -+ -+ if (currentChar == '\0') -+ break; -+ -+ currentChar -= (u8)((((i + j) * 3) % 128)); -+ -+ BufOfLines[j] = map[currentChar - 32] + 32; -+ } -+ /* RTW_INFO("Decrypted Line: %s\n", BufOfLines ); */ -+ if (strlen(BufOfLines) != 0) -+ i++; -+ BufOfLines[strlen(BufOfLines)] = '\n'; -+ } -+} -+ -+int -+phy_ParseBBPgParaFile( -+ PADAPTER Adapter, -+ char *buffer -+) -+{ -+ int rtStatus = _SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegMask, u4bRegValue; -+ u32 u4bMove; -+ BOOLEAN firstLine = _TRUE; -+ u8 tx_num = 0; -+ u8 band = 0, rf_path = 0; -+ -+ /* RTW_INFO("=====>phy_ParseBBPgParaFile()\n"); */ -+ -+ if (Adapter->registrypriv.RegDecryptCustomFile == 1) -+ phy_DecryptBBPgParaFile(Adapter, buffer); -+ -+ ptmp = buffer; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ if (isAllSpaceOrTab(szLine, sizeof(*szLine))) -+ continue; -+ -+ if (!IsCommentString(szLine)) { -+ /* Get header info (relative value or exact value) */ -+ if (firstLine) { -+ if (eqNByte(szLine, (u8 *)("#[v1]"), 5)) { -+ -+ pHalData->odmpriv.PhyRegPgVersion = szLine[3] - '0'; -+ /* RTW_INFO("This is a new format PHY_REG_PG.txt\n"); */ -+ } else if (eqNByte(szLine, (u8 *)("#[v0]"), 5)) { -+ pHalData->odmpriv.PhyRegPgVersion = szLine[3] - '0'; -+ /* RTW_INFO("This is a old format PHY_REG_PG.txt ok\n"); */ -+ } else { -+ RTW_INFO("The format in PHY_REG_PG are invalid %s\n", szLine); -+ return _FAIL; -+ } -+ -+ if (eqNByte(szLine + 5, (u8 *)("[Exact]#"), 8)) { -+ pHalData->odmpriv.PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ /* RTW_INFO("The values in PHY_REG_PG are exact values ok\n"); */ -+ firstLine = _FALSE; -+ continue; -+ } else if (eqNByte(szLine + 5, (pu1Byte)("[Relative]#"), 11)) { -+ pHalData->odmpriv.PhyRegPgValueType = PHY_REG_PG_RELATIVE_VALUE; -+ /* RTW_INFO("The values in PHY_REG_PG are relative values ok\n"); */ -+ firstLine = _FALSE; -+ continue; -+ } else { -+ RTW_INFO("The values in PHY_REG_PG are invalid %s\n", szLine); -+ return _FAIL; -+ } -+ } -+ -+ if (pHalData->odmpriv.PhyRegPgVersion == 0) { -+ /* Get 1st hex value as register offset. */ -+ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { -+ szLine += u4bMove; -+ if (u4bRegOffset == 0xffff) { -+ /* Ending. */ -+ break; -+ } -+ -+ /* Get 2nd hex value as register mask. */ -+ if (GetHexValueFromString(szLine, &u4bRegMask, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_RELATIVE_VALUE) { -+ /* Get 3rd hex value as register value. */ -+ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { -+ PHY_StoreTxPowerByRate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, u4bRegValue); -+ /* RTW_INFO("[ADDR] %03X=%08X Mask=%08x\n", u4bRegOffset, u4bRegValue, u4bRegMask); */ -+ } else -+ return _FAIL; -+ } else if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE) { -+ u32 combineValue = 0; -+ u8 integer = 0, fraction = 0; -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* RTW_INFO(" %d", integer ); */ -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue <<= 8; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* RTW_INFO(" %d", integer ); */ -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue <<= 8; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* RTW_INFO(" %d", integer ); */ -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue <<= 8; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* RTW_INFO(" %d", integer ); */ -+ PHY_StoreTxPowerByRate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, combineValue); -+ -+ /* RTW_INFO("[ADDR] 0x%3x = 0x%4x\n", u4bRegOffset, combineValue ); */ -+ } -+ } -+ } else if (pHalData->odmpriv.PhyRegPgVersion > 0) { -+ u32 index = 0, cnt = 0; -+ -+ if (eqNByte(szLine, "0xffff", 6)) -+ break; -+ -+ if (!eqNByte("#[END]#", szLine, 7)) { -+ /* load the table label info */ -+ if (szLine[0] == '#') { -+ index = 0; -+ if (eqNByte(szLine, "#[2.4G]" , 7)) { -+ band = BAND_ON_2_4G; -+ index += 8; -+ } else if (eqNByte(szLine, "#[5G]", 5)) { -+ band = BAND_ON_5G; -+ index += 6; -+ } else { -+ RTW_INFO("Invalid band %s in PHY_REG_PG.txt\n", szLine); -+ return _FAIL; -+ } -+ -+ rf_path = szLine[index] - 'A'; -+ /* RTW_INFO(" Table label Band %d, RfPath %d\n", band, rf_path ); */ -+ } else { /* load rows of tables */ -+ if (szLine[1] == '1') -+ tx_num = RF_1TX; -+ else if (szLine[1] == '2') -+ tx_num = RF_2TX; -+ else if (szLine[1] == '3') -+ tx_num = RF_3TX; -+ else if (szLine[1] == '4') -+ tx_num = RF_4TX; -+ else { -+ RTW_INFO("Invalid row in PHY_REG_PG.txt '%c'(%d)\n", szLine[1], szLine[1]); -+ return _FAIL; -+ } -+ -+ while (szLine[index] != ']') -+ ++index; -+ ++index;/* skip ] */ -+ -+ /* Get 2nd hex value as register offset. */ -+ szLine += index; -+ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ /* Get 2nd hex value as register mask. */ -+ if (GetHexValueFromString(szLine, &u4bRegMask, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_RELATIVE_VALUE) { -+ /* Get 3rd hex value as register value. */ -+ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { -+ PHY_StoreTxPowerByRate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, u4bRegValue); -+ /* RTW_INFO("[ADDR] %03X (tx_num %d) =%08X Mask=%08x\n", u4bRegOffset, tx_num, u4bRegValue, u4bRegMask); */ -+ } else -+ return _FAIL; -+ } else if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE) { -+ u32 combineValue = 0; -+ u8 integer = 0, fraction = 0; -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* RTW_INFO(" %d", integer ); */ -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue <<= 8; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* RTW_INFO(" %d", integer ); */ -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue <<= 8; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* RTW_INFO(" %d", integer ); */ -+ -+ if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) -+ szLine += u4bMove; -+ else -+ return _FAIL; -+ -+ integer *= 2; -+ if (fraction == 5) -+ integer += 1; -+ combineValue <<= 8; -+ combineValue |= (((integer / 10) << 4) + (integer % 10)); -+ /* RTW_INFO(" %d", integer ); */ -+ PHY_StoreTxPowerByRate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, combineValue); -+ -+ /* RTW_INFO("[ADDR] 0x%3x (tx_num %d) = 0x%4x\n", u4bRegOffset, tx_num, combineValue ); */ -+ } -+ } -+ } -+ } -+ } -+ } -+ /* RTW_INFO("<=====phy_ParseBBPgParaFile()\n"); */ -+ return rtStatus; -+} -+ -+int -+phy_ConfigBBWithPgParaFile( -+ IN PADAPTER Adapter, -+ IN const char *pFileName) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_BB_PG_PARA_FILE)) -+ return rtStatus; -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if (pHalData->bb_phy_reg_pg == NULL) { -+ rtw_get_phy_file_path(Adapter, pFileName); -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pHalData->bb_phy_reg_pg = rtw_zvmalloc(rlen); -+ if (pHalData->bb_phy_reg_pg) { -+ _rtw_memcpy(pHalData->bb_phy_reg_pg, pHalData->para_file_buf, rlen); -+ pHalData->bb_phy_reg_pg_len = rlen; -+ } else -+ RTW_INFO("%s bb_phy_reg_pg alloc fail !\n", __FUNCTION__); -+ } -+ } -+ } else { -+ if ((pHalData->bb_phy_reg_pg_len != 0) && (pHalData->bb_phy_reg_pg != NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pHalData->bb_phy_reg_pg, pHalData->bb_phy_reg_pg_len); -+ rtStatus = _SUCCESS; -+ } else -+ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ /* RTW_INFO("phy_ConfigBBWithPgParaFile(): read %s ok\n", pFileName); */ -+ phy_ParseBBPgParaFile(Adapter, pHalData->para_file_buf); -+ } else -+ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ -+ return rtStatus; -+} -+ -+#if (MP_DRIVER == 1) -+ -+int -+phy_ConfigBBWithMpParaFile( -+ IN PADAPTER Adapter, -+ IN char *pFileName -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegValue, u4bMove; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_BB_MP_PARA_FILE)) -+ return rtStatus; -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pHalData->bb_phy_reg_mp_len == 0) && (pHalData->bb_phy_reg_mp == NULL)) { -+ rtw_get_phy_file_path(Adapter, pFileName); -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pHalData->bb_phy_reg_mp = rtw_zvmalloc(rlen); -+ if (pHalData->bb_phy_reg_mp) { -+ _rtw_memcpy(pHalData->bb_phy_reg_mp, pHalData->para_file_buf, rlen); -+ pHalData->bb_phy_reg_mp_len = rlen; -+ } else -+ RTW_INFO("%s bb_phy_reg_mp alloc fail !\n", __FUNCTION__); -+ } -+ } -+ } else { -+ if ((pHalData->bb_phy_reg_mp_len != 0) && (pHalData->bb_phy_reg_mp != NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pHalData->bb_phy_reg_mp, pHalData->bb_phy_reg_mp_len); -+ rtStatus = _SUCCESS; -+ } else -+ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ /* RTW_INFO("phy_ConfigBBWithMpParaFile(): read %s ok\n", pFileName); */ -+ -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ if (!IsCommentString(szLine)) { -+ /* Get 1st hex value as register offset. */ -+ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { -+ if (u4bRegOffset == 0xffff) { -+ /* Ending. */ -+ break; -+ } else if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) { -+#ifdef CONFIG_LONG_DELAY_ISSUE -+ rtw_msleep_os(50); -+#else -+ rtw_mdelay_os(50); -+#endif -+ } else if (u4bRegOffset == 0xfd) -+ rtw_mdelay_os(5); -+ else if (u4bRegOffset == 0xfc) -+ rtw_mdelay_os(1); -+ else if (u4bRegOffset == 0xfb) -+ rtw_udelay_os(50); -+ else if (u4bRegOffset == 0xfa) -+ rtw_udelay_os(5); -+ else if (u4bRegOffset == 0xf9) -+ rtw_udelay_os(1); -+ -+ /* Get 2nd hex value as register value. */ -+ szLine += u4bMove; -+ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { -+ /* RTW_INFO("[ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue); */ -+ PHY_SetBBReg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); -+ -+ /* Add 1us delay between BB/RF register setting. */ -+ rtw_udelay_os(1); -+ } -+ } -+ } -+ } -+ } else -+ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ -+ return rtStatus; -+} -+ -+#endif -+ -+int -+PHY_ConfigRFWithParaFile( -+ IN PADAPTER Adapter, -+ IN char *pFileName, -+ IN u8 eRFPath -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 u4bRegOffset, u4bRegValue, u4bMove; -+ u16 i; -+ char *pBuf = NULL; -+ u32 *pBufLen = NULL; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_RF_PARA_FILE)) -+ return rtStatus; -+ -+ switch (eRFPath) { -+ case ODM_RF_PATH_A: -+ pBuf = pHalData->rf_radio_a; -+ pBufLen = &pHalData->rf_radio_a_len; -+ break; -+ case ODM_RF_PATH_B: -+ pBuf = pHalData->rf_radio_b; -+ pBufLen = &pHalData->rf_radio_b_len; -+ break; -+ default: -+ RTW_INFO("Unknown RF path!! %d\r\n", eRFPath); -+ break; -+ } -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) { -+ rtw_get_phy_file_path(Adapter, pFileName); -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pBuf = rtw_zvmalloc(rlen); -+ if (pBuf) { -+ _rtw_memcpy(pBuf, pHalData->para_file_buf, rlen); -+ *pBufLen = rlen; -+ -+ switch (eRFPath) { -+ case ODM_RF_PATH_A: -+ pHalData->rf_radio_a = pBuf; -+ break; -+ case ODM_RF_PATH_B: -+ pHalData->rf_radio_b = pBuf; -+ break; -+ } -+ } else -+ RTW_INFO("%s(): eRFPath=%d alloc fail !\n", __FUNCTION__, eRFPath); -+ } -+ } -+ } else { -+ if ((pBufLen != NULL) && (*pBufLen != 0) && (pBuf != NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pBuf, *pBufLen); -+ rtStatus = _SUCCESS; -+ } else -+ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ /* RTW_INFO("%s(): read %s successfully\n", __FUNCTION__, pFileName); */ -+ -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ if (!IsCommentString(szLine)) { -+ /* Get 1st hex value as register offset. */ -+ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { -+ if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) { -+ /* Deay specific ms. Only RF configuration require delay. */ -+#ifdef CONFIG_LONG_DELAY_ISSUE -+ rtw_msleep_os(50); -+#else -+ rtw_mdelay_os(50); -+#endif -+ } else if (u4bRegOffset == 0xfd) { -+ /* delay_ms(5); */ -+ for (i = 0; i < 100; i++) -+ rtw_udelay_os(MAX_STALL_TIME); -+ } else if (u4bRegOffset == 0xfc) { -+ /* delay_ms(1); */ -+ for (i = 0; i < 20; i++) -+ rtw_udelay_os(MAX_STALL_TIME); -+ } else if (u4bRegOffset == 0xfb) -+ rtw_udelay_os(50); -+ else if (u4bRegOffset == 0xfa) -+ rtw_udelay_os(5); -+ else if (u4bRegOffset == 0xf9) -+ rtw_udelay_os(1); -+ else if (u4bRegOffset == 0xffff) -+ break; -+ -+ /* Get 2nd hex value as register value. */ -+ szLine += u4bMove; -+ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { -+ PHY_SetRFReg(Adapter, eRFPath, u4bRegOffset, bRFRegOffsetMask, u4bRegValue); -+ -+ /* Temp add, for frequency lock, if no delay, that may cause */ -+ /* frequency shift, ex: 2412MHz => 2417MHz */ -+ /* If frequency shift, the following action may works. */ -+ /* Fractional-N table in radio_a.txt */ -+ /* 0x2a 0x00001 */ /* channel 1 */ -+ /* 0x2b 0x00808 frequency divider. */ -+ /* 0x2b 0x53333 */ -+ /* 0x2c 0x0000c */ -+ rtw_udelay_os(1); -+ } -+ } -+ } -+ } -+ } else -+ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ -+ return rtStatus; -+} -+ -+VOID -+initDeltaSwingIndexTables( -+ PADAPTER Adapter, -+ char *Band, -+ char *Path, -+ char *Sign, -+ char *Channel, -+ char *Rate, -+ char *Data -+) -+{ -+#define STR_EQUAL_5G(_band, _path, _sign, _rate, _chnl) \ -+ ((strcmp(Band, _band) == 0) && (strcmp(Path, _path) == 0) && (strcmp(Sign, _sign) == 0) &&\ -+ (strcmp(Rate, _rate) == 0) && (strcmp(Channel, _chnl) == 0)\ -+ ) -+#define STR_EQUAL_2G(_band, _path, _sign, _rate) \ -+ ((strcmp(Band, _band) == 0) && (strcmp(Path, _path) == 0) && (strcmp(Sign, _sign) == 0) &&\ -+ (strcmp(Rate, _rate) == 0)\ -+ ) -+ -+#define STORE_SWING_TABLE(_array, _iteratedIdx) \ -+ do { \ -+ for (token = strsep(&Data, delim); token != NULL; token = strsep(&Data, delim)) {\ -+ sscanf(token, "%d", &idx);\ -+ _array[_iteratedIdx++] = (u8)idx;\ -+ } } while (0)\ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ u32 j = 0; -+ char *token; -+ char delim[] = ","; -+ u32 idx = 0; -+ -+ /* RTW_INFO("===>initDeltaSwingIndexTables(): Band: %s;\nPath: %s;\nSign: %s;\nChannel: %s;\nRate: %s;\n, Data: %s;\n", */ -+ /* Band, Path, Sign, Channel, Rate, Data); */ -+ -+ if (STR_EQUAL_2G("2G", "A", "+", "CCK")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, j); -+ else if (STR_EQUAL_2G("2G", "A", "-", "CCK")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, j); -+ else if (STR_EQUAL_2G("2G", "B", "+", "CCK")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, j); -+ else if (STR_EQUAL_2G("2G", "B", "-", "CCK")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, j); -+ else if (STR_EQUAL_2G("2G", "A", "+", "ALL")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, j); -+ else if (STR_EQUAL_2G("2G", "A", "-", "ALL")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, j); -+ else if (STR_EQUAL_2G("2G", "B", "+", "ALL")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, j); -+ else if (STR_EQUAL_2G("2G", "B", "-", "ALL")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, j); -+ else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "0")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0], j); -+ else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "0")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0], j); -+ else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "0")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0], j); -+ else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "0")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0], j); -+ else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "1")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1], j); -+ else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "1")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1], j); -+ else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "1")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1], j); -+ else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "1")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1], j); -+ else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "2")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2], j); -+ else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "2")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2], j); -+ else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "2")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2], j); -+ else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "2")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2], j); -+ else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "3")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[3], j); -+ else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "3")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[3], j); -+ else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "3")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[3], j); -+ else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "3")) -+ STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[3], j); -+ else -+ RTW_INFO("===>initDeltaSwingIndexTables(): The input is invalid!!\n"); -+} -+ -+int -+PHY_ConfigRFWithTxPwrTrackParaFile( -+ IN PADAPTER Adapter, -+ IN char *pFileName -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ int rlen = 0, rtStatus = _FAIL; -+ char *szLine, *ptmp; -+ u32 i = 0, j = 0; -+ char c = 0; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_RF_TXPWR_TRACK_PARA_FILE)) -+ return rtStatus; -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if ((pHalData->rf_tx_pwr_track_len == 0) && (pHalData->rf_tx_pwr_track == NULL)) { -+ rtw_get_phy_file_path(Adapter, pFileName); -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pHalData->rf_tx_pwr_track = rtw_zvmalloc(rlen); -+ if (pHalData->rf_tx_pwr_track) { -+ _rtw_memcpy(pHalData->rf_tx_pwr_track, pHalData->para_file_buf, rlen); -+ pHalData->rf_tx_pwr_track_len = rlen; -+ } else -+ RTW_INFO("%s rf_tx_pwr_track alloc fail !\n", __FUNCTION__); -+ } -+ } -+ } else { -+ if ((pHalData->rf_tx_pwr_track_len != 0) && (pHalData->rf_tx_pwr_track != NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pHalData->rf_tx_pwr_track, pHalData->rf_tx_pwr_track_len); -+ rtStatus = _SUCCESS; -+ } else -+ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ /* RTW_INFO("%s(): read %s successfully\n", __FUNCTION__, pFileName); */ -+ -+ ptmp = pHalData->para_file_buf; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ if (!IsCommentString(szLine)) { -+ char band[5] = "", path[5] = "", sign[5] = ""; -+ char chnl[5] = "", rate[10] = ""; -+ char data[300] = ""; /* 100 is too small */ -+ -+ if (strlen(szLine) < 10 || szLine[0] != '[') -+ continue; -+ -+ strncpy(band, szLine + 1, 2); -+ strncpy(path, szLine + 5, 1); -+ strncpy(sign, szLine + 8, 1); -+ -+ i = 10; /* szLine+10 */ -+ if (!ParseQualifiedString(szLine, &i, rate, '[', ']')) { -+ /* RTW_INFO("Fail to parse rate!\n"); */ -+ } -+ if (!ParseQualifiedString(szLine, &i, chnl, '[', ']')) { -+ /* RTW_INFO("Fail to parse channel group!\n"); */ -+ } -+ while (szLine[i] != '{' && i < strlen(szLine)) -+ i++; -+ if (!ParseQualifiedString(szLine, &i, data, '{', '}')) { -+ /* RTW_INFO("Fail to parse data!\n"); */ -+ } -+ -+ initDeltaSwingIndexTables(Adapter, band, path, sign, chnl, rate, data); -+ } -+ } -+ } else -+ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+#if 0 -+ for (i = 0; i < DELTA_SWINGIDX_SIZE; ++i) { -+ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P[i]); -+ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N[i]); -+ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P[i]); -+ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N[i]); -+ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P[i]); -+ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N[i]); -+ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P[i]); -+ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N[i]); -+ -+ for (j = 0; j < 3; ++j) { -+ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[j][i]); -+ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[j][i]); -+ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[j][i]); -+ RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[j][i]); -+ } -+ } -+#endif -+ return rtStatus; -+} -+ -+int -+phy_ParsePowerLimitTableFile( -+ PADAPTER Adapter, -+ char *buffer -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ u32 i = 0, forCnt = 0; -+ u8 loadingStage = 0, limitValue = 0, fraction = 0; -+ char *szLine, *ptmp; -+ int rtStatus = _SUCCESS; -+ char band[10], bandwidth[10], rateSection[10], -+ regulation[TXPWR_LMT_MAX_REGULATION_NUM][10], rfPath[10], colNumBuf[10]; -+ u8 colNum = 0; -+ -+ RTW_INFO("===>phy_ParsePowerLimitTableFile()\n"); -+ -+ if (Adapter->registrypriv.RegDecryptCustomFile == 1) -+ phy_DecryptBBPgParaFile(Adapter, buffer); -+ -+ ptmp = buffer; -+ for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { -+ if (isAllSpaceOrTab(szLine, sizeof(*szLine))) -+ continue; -+ -+ /* skip comment */ -+ if (IsCommentString(szLine)) -+ continue; -+ -+ if (loadingStage == 0) { -+ for (forCnt = 0; forCnt < TXPWR_LMT_MAX_REGULATION_NUM; ++forCnt) -+ _rtw_memset((PVOID) regulation[forCnt], 0, 10); -+ _rtw_memset((PVOID) band, 0, 10); -+ _rtw_memset((PVOID) bandwidth, 0, 10); -+ _rtw_memset((PVOID) rateSection, 0, 10); -+ _rtw_memset((PVOID) rfPath, 0, 10); -+ _rtw_memset((PVOID) colNumBuf, 0, 10); -+ -+ if (szLine[0] != '#' || szLine[1] != '#') -+ continue; -+ -+ /* skip the space */ -+ i = 2; -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ szLine[--i] = ' '; /* return the space in front of the regulation info */ -+ -+ /* Parse the label of the table */ -+ if (!ParseQualifiedString(szLine, &i, band, ' ', ',')) { -+ RTW_INFO("Fail to parse band!\n"); -+ return _FAIL; -+ } -+ if (!ParseQualifiedString(szLine, &i, bandwidth, ' ', ',')) { -+ RTW_INFO("Fail to parse bandwidth!\n"); -+ return _FAIL; -+ } -+ if (!ParseQualifiedString(szLine, &i, rfPath, ' ', ',')) { -+ RTW_INFO("Fail to parse rf path!\n"); -+ return _FAIL; -+ } -+ if (!ParseQualifiedString(szLine, &i, rateSection, ' ', ',')) { -+ RTW_INFO("Fail to parse rate!\n"); -+ return _FAIL; -+ } -+ -+ loadingStage = 1; -+ } else if (loadingStage == 1) { -+ if (szLine[0] != '#' || szLine[1] != '#') -+ continue; -+ -+ /* skip the space */ -+ i = 2; -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ if (!eqNByte((u8 *)(szLine + i), (u8 *)("START"), 5)) { -+ RTW_INFO("Lost \"## START\" label\n"); -+ return _FAIL; -+ } -+ -+ loadingStage = 2; -+ } else if (loadingStage == 2) { -+ if (szLine[0] != '#' || szLine[1] != '#') -+ continue; -+ -+ /* skip the space */ -+ i = 2; -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ if (!ParseQualifiedString(szLine, &i, colNumBuf, '#', '#')) { -+ RTW_INFO("Fail to parse column number!\n"); -+ return _FAIL; -+ } -+ -+ if (!GetU1ByteIntegerFromStringInDecimal(colNumBuf, &colNum)) -+ return _FAIL; -+ -+ if (colNum > TXPWR_LMT_MAX_REGULATION_NUM) { -+ RTW_INFO("unvalid col number %d (greater than max %d)\n", -+ colNum, TXPWR_LMT_MAX_REGULATION_NUM); -+ return _FAIL; -+ } -+ -+ for (forCnt = 0; forCnt < colNum; ++forCnt) { -+ u8 regulation_name_cnt = 0; -+ -+ /* skip the space */ -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ while (szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0') -+ regulation[forCnt][regulation_name_cnt++] = szLine[i++]; -+ /* RTW_INFO("regulation %s!\n", regulation[forCnt]); */ -+ -+ if (regulation_name_cnt == 0) { -+ RTW_INFO("unvalid number of regulation!\n"); -+ return _FAIL; -+ } -+ } -+ -+ loadingStage = 3; -+ } else if (loadingStage == 3) { -+ char channel[10] = {0}, powerLimit[10] = {0}; -+ u8 cnt = 0; -+ -+ /* the table ends */ -+ if (szLine[0] == '#' && szLine[1] == '#') { -+ i = 2; -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ if (eqNByte((u8 *)(szLine + i), (u8 *)("END"), 3)) { -+ loadingStage = 0; -+ continue; -+ } else { -+ RTW_INFO("Wrong format\n"); -+ RTW_INFO("<===== phy_ParsePowerLimitTableFile()\n"); -+ return _FAIL; -+ } -+ } -+ -+ if ((szLine[0] != 'c' && szLine[0] != 'C') || -+ (szLine[1] != 'h' && szLine[1] != 'H')) { -+ RTW_INFO("Meet wrong channel => power limt pair '%c','%c'(%d,%d)\n", szLine[0], szLine[1], szLine[0], szLine[1]); -+ continue; -+ } -+ i = 2;/* move to the location behind 'h' */ -+ -+ /* load the channel number */ -+ cnt = 0; -+ while (szLine[i] >= '0' && szLine[i] <= '9') { -+ channel[cnt] = szLine[i]; -+ ++cnt; -+ ++i; -+ } -+ /* RTW_INFO("chnl %s!\n", channel); */ -+ -+ for (forCnt = 0; forCnt < colNum; ++forCnt) { -+ /* skip the space between channel number and the power limit value */ -+ while (szLine[i] == ' ' || szLine[i] == '\t') -+ ++i; -+ -+ /* load the power limit value */ -+ cnt = 0; -+ fraction = 0; -+ _rtw_memset((PVOID) powerLimit, 0, 10); -+ while ((szLine[i] >= '0' && szLine[i] <= '9') || szLine[i] == '.') { -+ if (szLine[i] == '.') { -+ if ((szLine[i + 1] >= '0' && szLine[i + 1] <= '9')) { -+ fraction = szLine[i + 1]; -+ i += 2; -+ } else { -+ RTW_INFO("Wrong fraction in TXPWR_LMT.txt\n"); -+ return _FAIL; -+ } -+ -+ break; -+ } -+ -+ powerLimit[cnt] = szLine[i]; -+ ++cnt; -+ ++i; -+ } -+ -+ if (powerLimit[0] == '\0') { -+ powerLimit[0] = '6'; -+ powerLimit[1] = '3'; -+ i += 2; -+ } else { -+ if (!GetU1ByteIntegerFromStringInDecimal(powerLimit, &limitValue)) -+ return _FAIL; -+ -+ limitValue *= 2; -+ cnt = 0; -+ if (fraction == '5') -+ ++limitValue; -+ -+ /* the value is greater or equal to 100 */ -+ if (limitValue >= 100) { -+ powerLimit[cnt++] = limitValue / 100 + '0'; -+ limitValue %= 100; -+ -+ if (limitValue >= 10) { -+ powerLimit[cnt++] = limitValue / 10 + '0'; -+ limitValue %= 10; -+ } else -+ powerLimit[cnt++] = '0'; -+ -+ powerLimit[cnt++] = limitValue + '0'; -+ } -+ /* the value is greater or equal to 10 */ -+ else if (limitValue >= 10) { -+ powerLimit[cnt++] = limitValue / 10 + '0'; -+ limitValue %= 10; -+ powerLimit[cnt++] = limitValue + '0'; -+ } -+ /* the value is less than 10 */ -+ else -+ powerLimit[cnt++] = limitValue + '0'; -+ -+ powerLimit[cnt] = '\0'; -+ } -+ -+ /* RTW_INFO("ch%s => %s\n", channel, powerLimit); */ -+ -+ /* store the power limit value */ -+ PHY_SetTxPowerLimit(pDM_Odm, (u8 *)regulation[forCnt], (u8 *)band, -+ (u8 *)bandwidth, (u8 *)rateSection, (u8 *)rfPath, (u8 *)channel, (u8 *)powerLimit); -+ -+ } -+ } else { -+ RTW_INFO("Abnormal loading stage in phy_ParsePowerLimitTableFile()!\n"); -+ rtStatus = _FAIL; -+ break; -+ } -+ } -+ -+ RTW_INFO("<===phy_ParsePowerLimitTableFile()\n"); -+ return rtStatus; -+} -+ -+int -+PHY_ConfigRFWithPowerLimitTableParaFile( -+ IN PADAPTER Adapter, -+ IN const char *pFileName -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rlen = 0, rtStatus = _FAIL; -+ -+ if (!(Adapter->registrypriv.load_phy_file & LOAD_RF_TXPWR_LMT_PARA_FILE)) -+ return rtStatus; -+ -+ _rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN); -+ -+ if (pHalData->rf_tx_pwr_lmt == NULL) { -+ rtw_get_phy_file_path(Adapter, pFileName); -+ if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { -+ rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); -+ if (rlen > 0) { -+ rtStatus = _SUCCESS; -+ pHalData->rf_tx_pwr_lmt = rtw_zvmalloc(rlen); -+ if (pHalData->rf_tx_pwr_lmt) { -+ _rtw_memcpy(pHalData->rf_tx_pwr_lmt, pHalData->para_file_buf, rlen); -+ pHalData->rf_tx_pwr_lmt_len = rlen; -+ } else -+ RTW_INFO("%s rf_tx_pwr_lmt alloc fail !\n", __FUNCTION__); -+ } -+ } -+ } else { -+ if ((pHalData->rf_tx_pwr_lmt_len != 0) && (pHalData->rf_tx_pwr_lmt != NULL)) { -+ _rtw_memcpy(pHalData->para_file_buf, pHalData->rf_tx_pwr_lmt, pHalData->rf_tx_pwr_lmt_len); -+ rtStatus = _SUCCESS; -+ } else -+ RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); -+ } -+ -+ if (rtStatus == _SUCCESS) { -+ /* RTW_INFO("%s(): read %s ok\n", __FUNCTION__, pFileName); */ -+ rtStatus = phy_ParsePowerLimitTableFile(Adapter, pHalData->para_file_buf); -+ } else -+ RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); -+ -+ return rtStatus; -+} -+ -+void phy_free_filebuf_mask(_adapter *padapter, u8 mask) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (pHalData->mac_reg && (mask & LOAD_MAC_PARA_FILE)) { -+ rtw_vmfree(pHalData->mac_reg, pHalData->mac_reg_len); -+ pHalData->mac_reg = NULL; -+ } -+ if (mask & LOAD_BB_PARA_FILE) { -+ if (pHalData->bb_phy_reg) { -+ rtw_vmfree(pHalData->bb_phy_reg, pHalData->bb_phy_reg_len); -+ pHalData->bb_phy_reg = NULL; -+ } -+ if (pHalData->bb_agc_tab) { -+ rtw_vmfree(pHalData->bb_agc_tab, pHalData->bb_agc_tab_len); -+ pHalData->bb_agc_tab = NULL; -+ } -+ } -+ if (pHalData->bb_phy_reg_pg && (mask & LOAD_BB_PG_PARA_FILE)) { -+ rtw_vmfree(pHalData->bb_phy_reg_pg, pHalData->bb_phy_reg_pg_len); -+ pHalData->bb_phy_reg_pg = NULL; -+ } -+ if (pHalData->bb_phy_reg_mp && (mask & LOAD_BB_MP_PARA_FILE)) { -+ rtw_vmfree(pHalData->bb_phy_reg_mp, pHalData->bb_phy_reg_mp_len); -+ pHalData->bb_phy_reg_mp = NULL; -+ } -+ if (mask & LOAD_RF_PARA_FILE) { -+ if (pHalData->rf_radio_a) { -+ rtw_vmfree(pHalData->rf_radio_a, pHalData->rf_radio_a_len); -+ pHalData->rf_radio_a = NULL; -+ } -+ if (pHalData->rf_radio_b) { -+ rtw_vmfree(pHalData->rf_radio_b, pHalData->rf_radio_b_len); -+ pHalData->rf_radio_b = NULL; -+ } -+ } -+ if (pHalData->rf_tx_pwr_track && (mask & LOAD_RF_TXPWR_TRACK_PARA_FILE)) { -+ rtw_vmfree(pHalData->rf_tx_pwr_track, pHalData->rf_tx_pwr_track_len); -+ pHalData->rf_tx_pwr_track = NULL; -+ } -+ if (pHalData->rf_tx_pwr_lmt && (mask & LOAD_RF_TXPWR_LMT_PARA_FILE)) { -+ rtw_vmfree(pHalData->rf_tx_pwr_lmt, pHalData->rf_tx_pwr_lmt_len); -+ pHalData->rf_tx_pwr_lmt = NULL; -+ } -+} -+ -+inline void phy_free_filebuf(_adapter *padapter) -+{ -+ phy_free_filebuf_mask(padapter, 0xFF); -+} -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_dm.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_dm.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_dm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_dm.c 2018-02-11 21:44:27.152146162 +0200 -@@ -0,0 +1,217 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2014 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+ -+/* A mapping from HalData to ODM. */ -+ODM_BOARD_TYPE_E boardType(u8 InterfaceSel) -+{ -+ ODM_BOARD_TYPE_E board = ODM_BOARD_DEFAULT; -+ -+#ifdef CONFIG_PCI_HCI -+ INTERFACE_SELECT_PCIE pcie = (INTERFACE_SELECT_PCIE)InterfaceSel; -+ switch (pcie) { -+ case INTF_SEL0_SOLO_MINICARD: -+ board |= ODM_BOARD_MINICARD; -+ break; -+ case INTF_SEL1_BT_COMBO_MINICARD: -+ board |= ODM_BOARD_BT; -+ board |= ODM_BOARD_MINICARD; -+ break; -+ default: -+ board = ODM_BOARD_DEFAULT; -+ break; -+ } -+ -+#elif defined(CONFIG_USB_HCI) -+ INTERFACE_SELECT_USB usb = (INTERFACE_SELECT_USB)InterfaceSel; -+ switch (usb) { -+ case INTF_SEL1_USB_High_Power: -+ board |= ODM_BOARD_EXT_LNA; -+ board |= ODM_BOARD_EXT_PA; -+ break; -+ case INTF_SEL2_MINICARD: -+ board |= ODM_BOARD_MINICARD; -+ break; -+ case INTF_SEL4_USB_Combo: -+ board |= ODM_BOARD_BT; -+ break; -+ case INTF_SEL5_USB_Combo_MF: -+ board |= ODM_BOARD_BT; -+ break; -+ case INTF_SEL0_USB: -+ case INTF_SEL3_USB_Solo: -+ default: -+ board = ODM_BOARD_DEFAULT; -+ break; -+ } -+ -+#endif -+ /* RTW_INFO("===> boardType(): (pHalData->InterfaceSel, pDM_Odm->BoardType) = (%d, %d)\n", InterfaceSel, board); */ -+ -+ return board; -+} -+ -+void Init_ODM_ComInfo(_adapter *adapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); -+ int i; -+ -+ _rtw_memset(pDM_Odm, 0, sizeof(*pDM_Odm)); -+ -+ pDM_Odm->Adapter = adapter; -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PLATFORM, ODM_CE); -+ -+ rtw_odm_init_ic_type(adapter); -+ -+ if (rtw_get_intf_type(adapter) == RTW_GSPI) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_INTERFACE, ODM_ITRF_SDIO); -+ else -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_INTERFACE, rtw_get_intf_type(adapter)); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_MP_TEST_CHIP, IS_NORMAL_CHIP(pHalData->VersionID)); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PATCH_ID, pHalData->CustomerID); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BWIFI_TEST, adapter->registrypriv.wifi_spec); -+ -+ -+ if (pHalData->rf_type == RF_1T1R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_1T1R); -+ else if (pHalData->rf_type == RF_1T2R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_1T2R); -+ else if (pHalData->rf_type == RF_2T2R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T2R); -+ else if (pHalData->rf_type == RF_2T2R_GREEN) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T2R_GREEN); -+ else if (pHalData->rf_type == RF_2T3R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T3R); -+ else if (pHalData->rf_type == RF_2T4R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T4R); -+ else if (pHalData->rf_type == RF_3T3R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_3T3R); -+ else if (pHalData->rf_type == RF_3T4R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_3T4R); -+ else if (pHalData->rf_type == RF_4T4R) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_4T4R); -+ else -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_XTXR); -+ -+ -+ { -+ /* 1 ======= BoardType: ODM_CMNINFO_BOARD_TYPE ======= */ -+ u8 odm_board_type = ODM_BOARD_DEFAULT; -+ -+ if (pHalData->ExternalLNA_2G != 0) { -+ odm_board_type |= ODM_BOARD_EXT_LNA; -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_LNA, 1); -+ } -+ if (pHalData->ExternalLNA_5G != 0) { -+ odm_board_type |= ODM_BOARD_EXT_LNA_5G; -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_5G_EXT_LNA, 1); -+ } -+ if (pHalData->ExternalPA_2G != 0) { -+ odm_board_type |= ODM_BOARD_EXT_PA; -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_PA, 1); -+ } -+ if (pHalData->ExternalPA_5G != 0) { -+ odm_board_type |= ODM_BOARD_EXT_PA_5G; -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_5G_EXT_PA, 1); -+ } -+ if (pHalData->EEPROMBluetoothCoexist) -+ odm_board_type |= ODM_BOARD_BT; -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BOARD_TYPE, odm_board_type); -+ /* 1 ============== End of BoardType ============== */ -+ } -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_DOMAIN_CODE_2G, pHalData->Regulation2_4G); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_DOMAIN_CODE_5G, pHalData->Regulation5G); -+ -+#ifdef CONFIG_DFS_MASTER -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_DFS_REGION_DOMAIN, adapter->registrypriv.dfs_region_domain); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_DFS_MASTER_ENABLE, &(adapter_to_rfctl(adapter)->dfs_master_enabled)); -+#endif -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_GPA, pHalData->TypeGPA); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_APA, pHalData->TypeAPA); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_GLNA, pHalData->TypeGLNA); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_ALNA, pHalData->TypeALNA); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RFE_TYPE, pHalData->RFEType); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_TRSW, 0); -+ -+ /*Add by YuChen for kfree init*/ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_REGRFKFREEENABLE, adapter->registrypriv.RegPwrTrimEnable); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RFKFREEENABLE, pHalData->RfKFreeEnable); -+ -+ /*Antenna diversity relative parameters*/ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, pHalData->TRxAntDivType); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BE_FIX_TX_ANT, pHalData->b_fix_tx_ant); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH, pHalData->with_extenal_ant_switch); -+ -+ /*Add by YuChen for adaptivity init*/ -+ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE, (adapter->registrypriv.adaptivity_mode != 0) ? TRUE : FALSE); -+ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_DCBACKOFF, adapter->registrypriv.adaptivity_dc_backoff); -+ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, (adapter->registrypriv.adaptivity_dml != 0) ? TRUE : FALSE); -+ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_TH_L2H_INI, adapter->registrypriv.adaptivity_th_l2h_ini); -+ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, adapter->registrypriv.adaptivity_th_edcca_hl_diff); -+ -+ -+ /* Pointer reference */ -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_TX_UNI, &(dvobj->traffic_stat.tx_bytes)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_RX_UNI, &(dvobj->traffic_stat.rx_bytes)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_WM_MODE, &(pmlmeext->cur_wireless_mode)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BAND, &(pHalData->CurrentBandType)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_RATE, &(pHalData->ForcedDataRate)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_IGI_LB, &(pHalData->u1ForcedIgiLb)); -+ -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SEC_CHNL_OFFSET, &(pHalData->nCur40MhzPrimeSC)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SEC_MODE, &(adapter->securitypriv.dot11PrivacyAlgrthm)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BW, &(pHalData->CurrentChannelBW)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_CHNL, &(pHalData->CurrentChannel)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_NET_CLOSED, &(adapter->net_closed)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_IGI_LB, &(pHalData->u1ForcedIgiLb)); -+ -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SCAN, &(pmlmepriv->bScanInProcess)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_POWER_SAVING, &(pwrctl->bpower_saving)); -+ /*Add by Yuchen for phydm beamforming*/ -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_TX_TP, &(dvobj->traffic_stat.cur_tx_tp)); -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_RX_TP, &(dvobj->traffic_stat.cur_rx_tp)); -+#ifdef CONFIG_USB_HCI -+ ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_HUBUSBMODE, &(dvobj->usb_speed)); -+#endif -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) -+ ODM_CmnInfoPtrArrayHook(pDM_Odm, ODM_CMNINFO_STA_STATUS, i, NULL); -+ -+ PHYDM_InitDebugSetting(pDM_Odm); -+ -+ /* TODO */ -+ /* ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BT_OPERATION, _FALSE); */ -+ /* ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BT_DISABLE_EDCA, _FALSE); */ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_dm.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_dm.h 2018-02-11 21:44:27.152146162 +0200 -@@ -0,0 +1,25 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_DM_H__ -+#define __HAL_DM_H__ -+ -+void Init_ODM_ComInfo(_adapter *adapter); -+ -+#endif /* __HAL_DM_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_halmac.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_halmac.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_halmac.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_halmac.c 2018-02-11 21:44:27.152146162 +0200 -@@ -0,0 +1,2379 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _HAL_HALMAC_C_ -+ -+#include /* PADAPTER, struct dvobj_priv, SDIO_ERR_VAL8 and etc. */ -+#include /* efuse, PHAL_DATA_TYPE and etc. */ -+#include "halmac/halmac_api.h" /* HALMAC_FW_SIZE_MAX_88XX and etc. */ -+#include "hal_halmac.h" /* dvobj_to_halmac() and ect. */ -+ -+#define DEFAULT_INDICATOR_TIMELMT 1000 /* ms */ -+#define FIRMWARE_MAX_SIZE HALMAC_FW_SIZE_MAX_88XX -+ -+/* -+ * Driver API for HALMAC operations -+ */ -+ -+#ifdef CONFIG_SDIO_HCI -+#include -+static u8 _halmac_sdio_cmd52_read(void *p, u32 offset) -+{ -+ struct dvobj_priv *d; -+ u8 val; -+ u8 ret; -+ -+ -+ d = (struct dvobj_priv *)p; -+ ret = rtw_sdio_read_cmd52(d, offset, &val, 1); -+ if (_FAIL == ret) { -+ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); -+ return SDIO_ERR_VAL8; -+ } -+ -+ return val; -+} -+ -+static void _halmac_sdio_cmd52_write(void *p, u32 offset, u8 val) -+{ -+ struct dvobj_priv *d; -+ u8 ret; -+ -+ -+ d = (struct dvobj_priv *)p; -+ ret = rtw_sdio_write_cmd52(d, offset, &val, 1); -+ if (_FAIL == ret) -+ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); -+} -+ -+static u8 _halmac_sdio_reg_read_8(void *p, u32 offset) -+{ -+ struct dvobj_priv *d; -+ u8 *pbuf; -+ u8 val; -+ int err; -+ -+ -+ d = (struct dvobj_priv *)p; -+ val = SDIO_ERR_VAL8; -+ pbuf = rtw_zmalloc(1); -+ if (!pbuf) -+ return val; -+ -+ err = d->intf_ops->read(d, offset, pbuf, 1, 0); -+ if (err) { -+ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ val = *pbuf; -+ -+exit: -+ rtw_mfree(pbuf, 1); -+ -+ return val; -+} -+ -+static u16 _halmac_sdio_reg_read_16(void *p, u32 offset) -+{ -+ struct dvobj_priv *d; -+ u8 *pbuf; -+ u16 val; -+ int err; -+ -+ -+ d = (struct dvobj_priv *)p; -+ val = SDIO_ERR_VAL16; -+ pbuf = rtw_zmalloc(2); -+ if (!pbuf) -+ return val; -+ -+ err = d->intf_ops->read(d, offset, pbuf, 2, 0); -+ if (err) { -+ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ val = le16_to_cpu(*(u16 *)pbuf); -+ -+exit: -+ rtw_mfree(pbuf, 2); -+ -+ return val; -+} -+ -+static u32 _halmac_sdio_reg_read_32(void *p, u32 offset) -+{ -+ struct dvobj_priv *d; -+ u8 *pbuf; -+ u32 val; -+ int err; -+ -+ -+ d = (struct dvobj_priv *)p; -+ val = SDIO_ERR_VAL32; -+ pbuf = rtw_zmalloc(4); -+ if (!pbuf) -+ return val; -+ -+ err = d->intf_ops->read(d, offset, pbuf, 4, 0); -+ if (err) { -+ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ val = le32_to_cpu(*(u32 *)pbuf); -+ -+exit: -+ rtw_mfree(pbuf, 4); -+ -+ return val; -+} -+ -+static u8 _halmac_sdio_reg_read_n(void *p, u32 offset, u32 size, u8 *data) -+{ -+ struct dvobj_priv *d = (struct dvobj_priv *)p; -+ PSDIO_DATA psdio = &d->intf_data; -+ -+ u8 *pbuf; -+ int err; -+ u8 rst = _FALSE; -+ u32 sdio_read_size; -+ -+ sdio_read_size = RND4(size); -+ if (sdio_read_size > psdio->block_transfer_len) -+ sdio_read_size = _RND(sdio_read_size, psdio->block_transfer_len); -+ -+ pbuf = rtw_zmalloc(sdio_read_size); -+ if ((!pbuf) || (!data)) -+ return rst; -+ -+ err = d->intf_ops->read(d, offset, pbuf, sdio_read_size, 0); -+ if (err) { -+ RTW_ERR("%s: [ERROR] I/O FAIL!\n", __func__); -+ goto exit; -+ } -+ -+ _rtw_memcpy(data, pbuf, size); -+ rst = _TRUE; -+exit: -+ rtw_mfree(pbuf, sdio_read_size); -+ -+ return rst; -+} -+ -+static void _halmac_sdio_reg_write_8(void *p, u32 offset, u8 val) -+{ -+ struct dvobj_priv *d; -+ u8 *pbuf; -+ int err; -+ -+ -+ d = (struct dvobj_priv *)p; -+ pbuf = rtw_zmalloc(1); -+ if (!pbuf) -+ return; -+ _rtw_memcpy(pbuf, &val, 1); -+ -+ err = d->intf_ops->write(d, offset, pbuf, 1, 0); -+ if (err) -+ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); -+ -+ rtw_mfree(pbuf, 1); -+} -+ -+static void _halmac_sdio_reg_write_16(void *p, u32 offset, u16 val) -+{ -+ struct dvobj_priv *d; -+ u8 *pbuf; -+ int err; -+ -+ -+ d = (struct dvobj_priv *)p; -+ val = cpu_to_le16(val); -+ pbuf = rtw_zmalloc(2); -+ if (!pbuf) -+ return; -+ _rtw_memcpy(pbuf, &val, 2); -+ -+ err = d->intf_ops->write(d, offset, pbuf, 2, 0); -+ if (err) -+ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); -+ -+ rtw_mfree(pbuf, 2); -+} -+ -+static void _halmac_sdio_reg_write_32(void *p, u32 offset, u32 val) -+{ -+ struct dvobj_priv *d; -+ u8 *pbuf; -+ int err; -+ -+ -+ d = (struct dvobj_priv *)p; -+ val = cpu_to_le32(val); -+ pbuf = rtw_zmalloc(4); -+ if (!pbuf) -+ return; -+ _rtw_memcpy(pbuf, &val, 4); -+ -+ err = d->intf_ops->write(d, offset, pbuf, 4, 0); -+ if (err) -+ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); -+ -+ rtw_mfree(pbuf, 4); -+} -+ -+#else /* !CONFIG_SDIO_HCI */ -+ -+static u8 _halmac_reg_read_8(void *p, u32 offset) -+{ -+ struct dvobj_priv *d; -+ PADAPTER adapter; -+ -+ -+ d = (struct dvobj_priv *)p; -+ adapter = d->padapters[IFACE_ID0]; -+ -+ return rtw_read8(adapter, offset); -+} -+ -+static u16 _halmac_reg_read_16(void *p, u32 offset) -+{ -+ struct dvobj_priv *d; -+ PADAPTER adapter; -+ -+ -+ d = (struct dvobj_priv *)p; -+ adapter = d->padapters[IFACE_ID0]; -+ -+ return rtw_read16(adapter, offset); -+} -+ -+static u32 _halmac_reg_read_32(void *p, u32 offset) -+{ -+ struct dvobj_priv *d; -+ PADAPTER adapter; -+ -+ -+ d = (struct dvobj_priv *)p; -+ adapter = d->padapters[IFACE_ID0]; -+ -+ return rtw_read32(adapter, offset); -+} -+ -+static void _halmac_reg_write_8(void *p, u32 offset, u8 val) -+{ -+ struct dvobj_priv *d; -+ PADAPTER adapter; -+ int err; -+ -+ -+ d = (struct dvobj_priv *)p; -+ adapter = d->padapters[IFACE_ID0]; -+ -+ err = rtw_write8(adapter, offset, val); -+ if (err == _FAIL) -+ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); -+} -+ -+static void _halmac_reg_write_16(void *p, u32 offset, u16 val) -+{ -+ struct dvobj_priv *d; -+ PADAPTER adapter; -+ int err; -+ -+ -+ d = (struct dvobj_priv *)p; -+ adapter = d->padapters[IFACE_ID0]; -+ -+ err = rtw_write16(adapter, offset, val); -+ if (err == _FAIL) -+ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); -+} -+ -+static void _halmac_reg_write_32(void *p, u32 offset, u32 val) -+{ -+ struct dvobj_priv *d; -+ PADAPTER adapter; -+ int err; -+ -+ -+ d = (struct dvobj_priv *)p; -+ adapter = d->padapters[IFACE_ID0]; -+ -+ err = rtw_write32(adapter, offset, val); -+ if (err == _FAIL) -+ RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); -+} -+#endif /* !CONFIG_SDIO_HCI */ -+ -+static u8 _halmac_mfree(void *p, void *buffer, u32 size) -+{ -+ rtw_mfree(buffer, size); -+ return _TRUE; -+} -+ -+static void *_halmac_malloc(void *p, u32 size) -+{ -+ return rtw_zmalloc(size); -+} -+ -+static u8 _halmac_memcpy(void *p, void *dest, void *src, u32 size) -+{ -+ _rtw_memcpy(dest, src, size); -+ return _TRUE; -+} -+ -+static u8 _halmac_memset(void *p, void *addr, u8 value, u32 size) -+{ -+ _rtw_memset(addr, value, size); -+ return _TRUE; -+} -+ -+static void _halmac_udelay(void *p, u32 us) -+{ -+ rtw_udelay_os(us); -+} -+ -+static u8 _halmac_mutex_init(void *p, HALMAC_MUTEX *pMutex) -+{ -+ _rtw_mutex_init(pMutex); -+ return _TRUE; -+} -+ -+static u8 _halmac_mutex_deinit(void *p, HALMAC_MUTEX *pMutex) -+{ -+ _rtw_mutex_free(pMutex); -+ return _TRUE; -+} -+ -+static u8 _halmac_mutex_lock(void *p, HALMAC_MUTEX *pMutex) -+{ -+ int err; -+ -+ err = _enter_critical_mutex(pMutex, NULL); -+ if (err) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+static u8 _halmac_mutex_unlock(void *p, HALMAC_MUTEX *pMutex) -+{ -+ _exit_critical_mutex(pMutex, NULL); -+ return _TRUE; -+} -+ -+static u8 _halmac_msg_print(void *p, u32 msg_type, u8 msg_level, s8 *fmt, ...) -+{ -+#define MSG_LEN 100 -+#define MSG_PREFIX "[HALMAC]" -+ va_list args; -+ u8 str[MSG_LEN] = {0}; -+ u32 type; -+ u8 level; -+ -+ -+ str[0] = '\n'; -+ type = 0xFFFFFFFF; -+ if (rtw_drv_log_level <= _DRV_ERR_) -+ level = HALMAC_DBG_ERR; -+ else if (rtw_drv_log_level <= _DRV_INFO_) -+ level = HALMAC_DBG_WARN; -+ else -+ level = HALMAC_DBG_TRACE; -+ -+ if (!(type & BIT(msg_type))) -+ return _TRUE; -+ if (level < msg_level) -+ return _TRUE; -+ -+ va_start(args, fmt); -+ vsnprintf(str, MSG_LEN, fmt, args); -+ va_end(args); -+ -+ if (msg_level <= HALMAC_DBG_ERR) -+ RTW_ERR(MSG_PREFIX "%s", str); -+ else if (msg_level <= HALMAC_DBG_WARN) -+ RTW_WARN(MSG_PREFIX "%s", str); -+ else -+ RTW_DBG(MSG_PREFIX "%s", str); -+ -+ return _TRUE; -+} -+ -+static u8 _halmac_buff_print(void *p, u32 msg_type, u8 msg_level, s8 *buf, u32 size) -+{ -+#define MSG_PREFIX "[HALMAC]" -+ u32 type; -+ u8 level; -+ -+ type = 0xFFFFFFFF; -+ if (rtw_drv_log_level <= _DRV_ERR_) -+ level = HALMAC_DBG_ERR; -+ else if (rtw_drv_log_level <= _DRV_INFO_) -+ level = HALMAC_DBG_WARN; -+ else -+ level = HALMAC_DBG_TRACE; -+ -+ if (!(type & BIT(msg_type))) -+ return _TRUE; -+ if (level < msg_level) -+ return _TRUE; -+ -+ if (msg_level <= HALMAC_DBG_WARN) -+ RTW_INFO_DUMP(MSG_PREFIX, buf, size); -+ else -+ RTW_DBG_DUMP(MSG_PREFIX, buf, size); -+ -+ return _TRUE; -+} -+ -+ -+const char *const RTW_HALMAC_FEATURE_NAME[] = { -+ "HALMAC_FEATURE_CFG_PARA", -+ "HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE", -+ "HALMAC_FEATURE_DUMP_LOGICAL_EFUSE", -+ "HALMAC_FEATURE_UPDATE_PACKET", -+ "HALMAC_FEATURE_UPDATE_DATAPACK", -+ "HALMAC_FEATURE_RUN_DATAPACK", -+ "HALMAC_FEATURE_CHANNEL_SWITCH", -+ "HALMAC_FEATURE_IQK", -+ "HALMAC_FEATURE_POWER_TRACKING", -+ "HALMAC_FEATURE_PSD", -+ "HALMAC_FEATURE_ALL" -+}; -+ -+static inline u8 is_valid_id_status(HALMAC_FEATURE_ID id, HALMAC_CMD_PROCESS_STATUS status) -+{ -+ switch (id) { -+ case HALMAC_FEATURE_CFG_PARA: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ break; -+ case HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ if (HALMAC_CMD_PROCESS_DONE != status) { -+ RTW_INFO("%s: id(%d) unspecified status(%d)!\n", -+ __FUNCTION__, id, status); -+ } -+ break; -+ case HALMAC_FEATURE_DUMP_LOGICAL_EFUSE: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ if (HALMAC_CMD_PROCESS_DONE != status) { -+ RTW_INFO("%s: id(%d) unspecified status(%d)!\n", -+ __FUNCTION__, id, status); -+ } -+ break; -+ case HALMAC_FEATURE_UPDATE_PACKET: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ break; -+ case HALMAC_FEATURE_UPDATE_DATAPACK: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ break; -+ case HALMAC_FEATURE_RUN_DATAPACK: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ break; -+ case HALMAC_FEATURE_CHANNEL_SWITCH: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ break; -+ case HALMAC_FEATURE_IQK: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ break; -+ case HALMAC_FEATURE_POWER_TRACKING: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ break; -+ case HALMAC_FEATURE_PSD: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ break; -+ case HALMAC_FEATURE_ALL: -+ RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); -+ break; -+ default: -+ RTW_INFO("%s: unknown feature id(%d)\n", __FUNCTION__, id); -+ return _FALSE; -+ } -+ -+ return _TRUE; -+} -+ -+static int init_halmac_event_with_waittime(struct dvobj_priv *d, HALMAC_FEATURE_ID id, u8 *buf, u32 size, u32 time) -+{ -+ struct submit_ctx *sctx; -+ -+ -+ if (!d->hmpriv.indicator[id].sctx) { -+ sctx = (struct submit_ctx *)rtw_zmalloc(sizeof(*sctx)); -+ if (!sctx) -+ return -1; -+ } else { -+ RTW_INFO("%s: id(%d) sctx is not NULL!!\n", __FUNCTION__, id); -+ sctx = d->hmpriv.indicator[id].sctx; -+ d->hmpriv.indicator[id].sctx = NULL; -+ } -+ -+ rtw_sctx_init(sctx, time); -+ d->hmpriv.indicator[id].buffer = buf; -+ d->hmpriv.indicator[id].buf_size = size; -+ d->hmpriv.indicator[id].ret_size = 0; -+ d->hmpriv.indicator[id].status = 0; -+ /* fill sctx at least to sure other variables are all ready! */ -+ d->hmpriv.indicator[id].sctx = sctx; -+ -+ return 0; -+} -+ -+static inline int init_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id, u8 *buf, u32 size) -+{ -+ return init_halmac_event_with_waittime(d, id, buf, size, DEFAULT_INDICATOR_TIMELMT); -+} -+ -+static void free_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id) -+{ -+ struct submit_ctx *sctx; -+ -+ -+ if (!d->hmpriv.indicator[id].sctx) -+ return; -+ -+ sctx = d->hmpriv.indicator[id].sctx; -+ d->hmpriv.indicator[id].sctx = NULL; -+ rtw_mfree((u8 *)sctx, sizeof(*sctx)); -+} -+ -+static int wait_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id) -+{ -+ struct submit_ctx *sctx; -+ int ret; -+ -+ -+ sctx = d->hmpriv.indicator[id].sctx; -+ if (!sctx) -+ return -1; -+ -+ ret = rtw_sctx_wait(sctx, RTW_HALMAC_FEATURE_NAME[id]); -+ free_halmac_event(d, id); -+ if (_SUCCESS == ret) -+ return 0; -+ -+ return -1; -+} -+ -+/* -+ * Return: -+ * Always return _TRUE, HALMAC don't care the return value. -+ */ -+static u8 _halmac_event_indication(void *p, HALMAC_FEATURE_ID feature_id, HALMAC_CMD_PROCESS_STATUS process_status, u8 *buf, u32 size) -+{ -+ struct dvobj_priv *d; -+ PADAPTER adapter; -+ PHAL_DATA_TYPE hal; -+ struct halmac_indicator *tbl, *indicator; -+ struct submit_ctx *sctx; -+ u32 cpsz; -+ u8 ret; -+ -+ -+ d = (struct dvobj_priv *)p; -+ adapter = d->padapters[IFACE_ID0]; -+ hal = GET_HAL_DATA(adapter); -+ tbl = d->hmpriv.indicator; -+ -+ ret = is_valid_id_status(feature_id, process_status); -+ if (_FALSE == ret) -+ goto exit; -+ -+ indicator = &tbl[feature_id]; -+ indicator->status = process_status; -+ indicator->ret_size = size; -+ if (!indicator->sctx) { -+ RTW_INFO("%s: No feature id(%d) waiting!!\n", __FUNCTION__, feature_id); -+ goto exit; -+ } -+ sctx = indicator->sctx; -+ -+ if (HALMAC_CMD_PROCESS_ERROR == process_status) { -+ RTW_INFO("%s: Something wrong id(%d)!!\n", __FUNCTION__, feature_id); -+ rtw_sctx_done_err(&sctx, RTW_SCTX_DONE_UNKNOWN); -+ goto exit; -+ } -+ -+ if (size > indicator->buf_size) { -+ RTW_INFO("%s: id(%d) buffer is not enough(%d<%d), data will be truncated!\n", -+ __FUNCTION__, feature_id, indicator->buf_size, size); -+ cpsz = indicator->buf_size; -+ } else -+ cpsz = size; -+ if (cpsz && indicator->buffer) -+ _rtw_memcpy(indicator->buffer, buf, cpsz); -+ -+ rtw_sctx_done(&sctx); -+ -+exit: -+ return _TRUE; -+} -+ -+HALMAC_PLATFORM_API rtw_halmac_platform_api = { -+ /* R/W register */ -+#ifdef CONFIG_SDIO_HCI -+ .SDIO_CMD52_READ = _halmac_sdio_cmd52_read, -+ .SDIO_CMD53_READ_8 = _halmac_sdio_reg_read_8, -+ .SDIO_CMD53_READ_16 = _halmac_sdio_reg_read_16, -+ .SDIO_CMD53_READ_32 = _halmac_sdio_reg_read_32, -+ .SDIO_CMD53_READ_N = _halmac_sdio_reg_read_n, -+ .SDIO_CMD52_WRITE = _halmac_sdio_cmd52_write, -+ .SDIO_CMD53_WRITE_8 = _halmac_sdio_reg_write_8, -+ .SDIO_CMD53_WRITE_16 = _halmac_sdio_reg_write_16, -+ .SDIO_CMD53_WRITE_32 = _halmac_sdio_reg_write_32, -+ -+#endif /* CONFIG_SDIO_HCI */ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCIE_HCI) -+ .REG_READ_8 = _halmac_reg_read_8, -+ .REG_READ_16 = _halmac_reg_read_16, -+ .REG_READ_32 = _halmac_reg_read_32, -+ .REG_WRITE_8 = _halmac_reg_write_8, -+ .REG_WRITE_16 = _halmac_reg_write_16, -+ .REG_WRITE_32 = _halmac_reg_write_32, -+#endif /* CONFIG_USB_HCI || CONFIG_PCIE_HCI */ -+ -+ /* Write data */ -+#if 0 -+ /* impletement in HAL-IC level */ -+ .SEND_RSVD_PAGE = sdio_write_data_rsvd_page, -+ .SEND_H2C_PKT = sdio_write_data_h2c, -+#endif -+ /* Memory allocate */ -+ .RTL_FREE = _halmac_mfree, -+ .RTL_MALLOC = _halmac_malloc, -+ .RTL_MEMCPY = _halmac_memcpy, -+ .RTL_MEMSET = _halmac_memset, -+ -+ /* Sleep */ -+ .RTL_DELAY_US = _halmac_udelay, -+ -+ /* Process Synchronization */ -+ .MUTEX_INIT = _halmac_mutex_init, -+ .MUTEX_DEINIT = _halmac_mutex_deinit, -+ .MUTEX_LOCK = _halmac_mutex_lock, -+ .MUTEX_UNLOCK = _halmac_mutex_unlock, -+ -+ .MSG_PRINT = _halmac_msg_print, -+ .BUFF_PRINT = _halmac_buff_print, -+ .EVENT_INDICATION = _halmac_event_indication, -+}; -+ -+u8 rtw_halmac_read8(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ -+ -+ /* WARNING: pintf_dev should not be null! */ -+ mac = dvobj_to_halmac(pintfhdl->pintf_dev); -+ api = HALMAC_GET_API(mac); -+ -+ return api->halmac_reg_read_8(mac, addr); -+} -+ -+u16 rtw_halmac_read16(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ -+ -+ /* WARNING: pintf_dev should not be null! */ -+ mac = dvobj_to_halmac(pintfhdl->pintf_dev); -+ api = HALMAC_GET_API(mac); -+ -+ return api->halmac_reg_read_16(mac, addr); -+} -+ -+u32 rtw_halmac_read32(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ -+ -+ /* WARNING: pintf_dev should not be null! */ -+ mac = dvobj_to_halmac(pintfhdl->pintf_dev); -+ api = HALMAC_GET_API(mac); -+ -+ return api->halmac_reg_read_32(mac, addr); -+} -+ -+void rtw_halmac_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem) -+{ -+#if defined(CONFIG_SDIO_HCI) -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ -+ if (pmem == NULL) { -+ RTW_ERR("pmem is NULL\n"); -+ return; -+ } -+ /* WARNING: pintf_dev should not be null! */ -+ mac = dvobj_to_halmac(pintfhdl->pintf_dev); -+ api = HALMAC_GET_API(mac); -+ -+ api->halmac_reg_sdio_cmd53_read_n(mac, addr, cnt, pmem); -+#endif -+} -+ -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+u8 rtw_halmac_iread8(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ -+ /* WARNING: pintf_dev should not be null! */ -+ mac = dvobj_to_halmac(pintfhdl->pintf_dev); -+ api = HALMAC_GET_API(mac); -+ -+ /*return api->halmac_reg_read_indirect_8(mac, addr);*/ -+ return api->halmac_reg_read_8(mac, addr); -+} -+ -+u16 rtw_halmac_iread16(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ u16 val16 = 0; -+ -+ /* WARNING: pintf_dev should not be null! */ -+ mac = dvobj_to_halmac(pintfhdl->pintf_dev); -+ api = HALMAC_GET_API(mac); -+ -+ /*return api->halmac_reg_read_indirect_16(mac, addr);*/ -+ return api->halmac_reg_read_16(mac, addr); -+} -+ -+u32 rtw_halmac_iread32(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ -+ -+ /* WARNING: pintf_dev should not be null! */ -+ mac = dvobj_to_halmac(pintfhdl->pintf_dev); -+ api = HALMAC_GET_API(mac); -+ -+ return api->halmac_reg_read_indirect_32(mac, addr); -+} -+#endif -+ -+int rtw_halmac_write8(struct intf_hdl *pintfhdl, u32 addr, u8 value) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ -+ -+ /* WARNING: pintf_dev should not be null! */ -+ mac = dvobj_to_halmac(pintfhdl->pintf_dev); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_reg_write_8(mac, addr, value); -+ -+ if (status == HALMAC_RET_SUCCESS) -+ return 0; -+ -+ return -1; -+} -+ -+int rtw_halmac_write16(struct intf_hdl *pintfhdl, u32 addr, u16 value) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ -+ -+ /* WARNING: pintf_dev should not be null! */ -+ mac = dvobj_to_halmac(pintfhdl->pintf_dev); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_reg_write_16(mac, addr, value); -+ -+ if (status == HALMAC_RET_SUCCESS) -+ return 0; -+ -+ return -1; -+} -+ -+int rtw_halmac_write32(struct intf_hdl *pintfhdl, u32 addr, u32 value) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ -+ -+ /* WARNING: pintf_dev should not be null! */ -+ mac = dvobj_to_halmac(pintfhdl->pintf_dev); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_reg_write_32(mac, addr, value); -+ -+ if (status == HALMAC_RET_SUCCESS) -+ return 0; -+ -+ return -1; -+} -+ -+static int init_priv(struct halmacpriv *priv) -+{ -+ struct halmac_indicator *indicator; -+ u32 count, size; -+ -+ -+ size = sizeof(*priv); -+ _rtw_memset(priv, 0, size); -+ -+ count = HALMAC_FEATURE_ALL + 1; -+ size = sizeof(*indicator) * count; -+ indicator = (struct halmac_indicator *)rtw_zmalloc(size); -+ if (!indicator) -+ return -1; -+ priv->indicator = indicator; -+ -+ return 0; -+} -+ -+static void deinit_priv(struct halmacpriv *priv) -+{ -+ struct halmac_indicator *indicator; -+ -+ -+ indicator = priv->indicator; -+ priv->indicator = NULL; -+ if (indicator) { -+ u32 count, size; -+ -+ count = HALMAC_FEATURE_ALL + 1; -+#ifdef CONFIG_RTW_DEBUG -+ { -+ struct submit_ctx *sctx; -+ u32 i; -+ -+ for (i = 0; i < count; i++) { -+ if (!indicator[i].sctx) -+ continue; -+ -+ RTW_INFO("%s: %s id(%d) sctx still exist!!\n", -+ __FUNCTION__, RTW_HALMAC_FEATURE_NAME[i], i); -+ sctx = indicator[i].sctx; -+ indicator[i].sctx = NULL; -+ rtw_mfree((u8 *)sctx, sizeof(*sctx)); -+ } -+ } -+#endif /* !CONFIG_RTW_DEBUG */ -+ size = sizeof(*indicator) * count; -+ rtw_mfree((u8 *)indicator, size); -+ } -+} -+ -+int rtw_halmac_init_adapter(struct dvobj_priv *d, PHALMAC_PLATFORM_API pf_api) -+{ -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ HALMAC_INTERFACE intf; -+ HALMAC_RET_STATUS status; -+ int err = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ if (halmac) { -+ err = 0; -+ goto out; -+ } -+ -+ err = init_priv(&d->hmpriv); -+ if (err) -+ goto out; -+ -+#ifdef CONFIG_SDIO_HCI -+ intf = HALMAC_INTERFACE_SDIO; -+#elif defined(CONFIG_USB_HCI) -+ intf = HALMAC_INTERFACE_USB; -+#elif defined(CONFIG_PCIE_HCI) -+ intf = HALMAC_INTERFACE_PCIE; -+#else -+#warning "INTERFACE(CONFIG_XXX_HCI) not be defined!!" -+ intf = HALMAC_INTERFACE_UNDEFINE; -+#endif -+ status = halmac_init_adapter(d, pf_api, intf, &halmac, &api); -+ if (HALMAC_RET_SUCCESS != status) { -+ RTW_INFO("%s: halmac_init_adapter fail!(status=%d)\n", __FUNCTION__, status); -+ err = -1; -+ goto out; -+ } -+ -+ dvobj_set_halmac(d, halmac); -+ -+out: -+ if (err) -+ rtw_halmac_deinit_adapter(d); -+ -+ return err; -+} -+ -+int rtw_halmac_deinit_adapter(struct dvobj_priv *d) -+{ -+ PHALMAC_ADAPTER halmac; -+ HALMAC_RET_STATUS status; -+ int err = 0; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ if (!halmac) { -+ err = 0; -+ goto out; -+ } -+ -+ deinit_priv(&d->hmpriv); -+ -+ status = halmac_deinit_adapter(halmac); -+ dvobj_set_halmac(d, NULL); -+ if (status != HALMAC_RET_SUCCESS) { -+ err = -1; -+ goto out; -+ } -+ -+out: -+ return err; -+} -+ -+int rtw_halmac_poweron(struct dvobj_priv *d) -+{ -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ int err = -1; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ if (!halmac) -+ goto out; -+ -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_pre_init_system_cfg(halmac); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ status = api->halmac_mac_power_switch(halmac, HALMAC_MAC_POWER_ON); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ status = api->halmac_init_system_cfg(halmac); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+int rtw_halmac_poweroff(struct dvobj_priv *d) -+{ -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ int err = -1; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ if (!halmac) -+ goto out; -+ -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_mac_power_switch(halmac, HALMAC_MAC_POWER_OFF); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+/* -+ * Note: -+ * When this function return, the register REG_RCR may be changed. -+ */ -+int rtw_halmac_config_rx_info(struct dvobj_priv *d, HALMAC_DRV_INFO info) -+{ -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ int err = -1; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_cfg_drv_info(halmac, info); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+static inline HALMAC_RX_FIFO_EXPANDING_MODE _trx_share_mode_drv2halmac(u8 trx_share_mode) -+{ -+ if (0 == trx_share_mode) -+ return HALMAC_RX_FIFO_EXPANDING_MODE_DISABLE; -+ else if (1 == trx_share_mode) -+ return HALMAC_RX_FIFO_EXPANDING_MODE_1_BLOCK; -+ else if (2 == trx_share_mode) -+ return HALMAC_RX_FIFO_EXPANDING_MODE_2_BLOCK; -+ else if (3 == trx_share_mode) -+ return HALMAC_RX_FIFO_EXPANDING_MODE_3_BLOCK; -+ else -+ return HALMAC_RX_FIFO_EXPANDING_MODE_DISABLE; -+} -+static HALMAC_RX_FIFO_EXPANDING_MODE _rtw_get_trx_share_mode(_adapter *adapter) -+{ -+ struct registry_priv *registry_par = &adapter->registrypriv; -+ -+ return _trx_share_mode_drv2halmac(registry_par->trx_share_mode); -+} -+void dump_trx_share_mode(void *sel, _adapter *adapter) -+{ -+ struct registry_priv *registry_par = &adapter->registrypriv; -+ u8 mode = _trx_share_mode_drv2halmac(registry_par->trx_share_mode); -+ -+ if (HALMAC_RX_FIFO_EXPANDING_MODE_1_BLOCK == mode) -+ RTW_PRINT_SEL(sel, "TRx share mode : %s\n", "RX_FIFO_EXPANDING_MODE_1"); -+ else if (HALMAC_RX_FIFO_EXPANDING_MODE_2_BLOCK == mode) -+ RTW_PRINT_SEL(sel, "TRx share mode : %s\n", "RX_FIFO_EXPANDING_MODE_2"); -+ else if (HALMAC_RX_FIFO_EXPANDING_MODE_3_BLOCK == mode) -+ RTW_PRINT_SEL(sel, "TRx share mode : %s\n", "RX_FIFO_EXPANDING_MODE_3"); -+ else -+ RTW_PRINT_SEL(sel, "TRx share mode : %s\n", "DISABLE"); -+} -+#endif -+ -+static HALMAC_RET_STATUS init_mac_flow(struct dvobj_priv *d) -+{ -+ PADAPTER p; -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ HALMAC_WLAN_ADDR hwa; -+ HALMAC_RET_STATUS status; -+ u8 wifi_test = 0; -+ u8 nettype; -+ int err; -+ -+ -+ p = d->padapters[IFACE_ID0]; -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ if (p->registrypriv.wifi_spec) -+ wifi_test = 1; -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+ status = api->halmac_cfg_rx_fifo_expanding_mode(halmac, _rtw_get_trx_share_mode(p)); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+#endif -+ -+#if 0 -+ status = api->halmac_cfg_drv_rsvd_pg_num(halmac, HALMAC_RSVD_PG_NUM16);/*HALMAC_RSVD_PG_NUM24/HALMAC_RSVD_PG_NUM32*/ -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ status = api->halmac_set_bulkout_num(halmac, d->RtNumOutPipes); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+#endif /* CONFIG_USB_HCI */ -+ -+ if (wifi_test) -+ status = api->halmac_init_mac_cfg(halmac, HALMAC_TRX_MODE_WMM); -+ else -+ status = api->halmac_init_mac_cfg(halmac, HALMAC_TRX_MODE_NORMAL); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = rtw_halmac_rx_agg_switch(d, _TRUE); -+ if (err) -+ goto out; -+ -+ nettype = dvobj_to_regsty(d)->wireless_mode; -+ if (IsSupportedVHT(nettype) == _TRUE) -+ status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_AC); -+ else if (IsSupportedHT(nettype) == _TRUE) -+ status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_N); -+ else if (IsSupportedTxOFDM(nettype) == _TRUE) -+ status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_G); -+ else -+ status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_B); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+out: -+ return status; -+} -+ -+static inline HALMAC_RF_TYPE _rf_type_drv2halmac(RT_RF_TYPE_DEF_E rf_drv) -+{ -+ HALMAC_RF_TYPE rf_mac; -+ -+ -+ switch (rf_drv) { -+ case RF_1T2R: -+ rf_mac = HALMAC_RF_1T2R; -+ break; -+ case RF_2T4R: -+ rf_mac = HALMAC_RF_2T4R; -+ break; -+ case RF_2T2R: -+ rf_mac = HALMAC_RF_2T2R; -+ break; -+ case RF_1T1R: -+ rf_mac = HALMAC_RF_1T1R; -+ break; -+ case RF_2T2R_GREEN: -+ rf_mac = HALMAC_RF_2T2R_GREEN; -+ break; -+ case RF_2T3R: -+ rf_mac = HALMAC_RF_2T3R; -+ break; -+ case RF_3T3R: -+ rf_mac = HALMAC_RF_3T3R; -+ break; -+ case RF_3T4R: -+ rf_mac = HALMAC_RF_3T4R; -+ break; -+ case RF_4T4R: -+ rf_mac = HALMAC_RF_4T4R; -+ break; -+ default: -+ rf_mac = (HALMAC_RF_TYPE)rf_drv; -+ break; -+ } -+ -+ return rf_mac; -+} -+ -+static int _send_general_info(struct dvobj_priv *d) -+{ -+ PADAPTER adapter; -+ PHAL_DATA_TYPE hal; -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ HALMAC_GENERAL_INFO info; -+ HALMAC_RET_STATUS status; -+ u8 val8; -+ -+ -+ adapter = d->padapters[IFACE_ID0]; -+ hal = GET_HAL_DATA(adapter); -+ halmac = dvobj_to_halmac(d); -+ if (!halmac) -+ return -1; -+ api = HALMAC_GET_API(halmac); -+ -+ _rtw_memset(&info, 0, sizeof(info)); -+ info.rfe_type = (u8)hal->RFEType; -+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, &val8); -+ info.rf_type = _rf_type_drv2halmac(val8); -+ -+ status = api->halmac_send_general_info(halmac, &info); -+ switch (status) { -+ case HALMAC_RET_SUCCESS: -+ break; -+ case HALMAC_RET_NO_DLFW: -+ RTW_WARN("%s: halmac_send_general_info() fail because fw not dl!\n", -+ __FUNCTION__); -+ /* go through */ -+ default: -+ return -1; -+ } -+ -+ return 0; -+} -+ -+/* -+ * Notices: -+ * Make sure -+ * 1. rtw_hal_get_hwreg(HW_VAR_RF_TYPE) -+ * 2. HAL_DATA_TYPE.rfe_type -+ * already ready for use before calling this function. -+ */ -+static int _halmac_init_hal(struct dvobj_priv *d, u8 *fw, u32 fwsize) -+{ -+ PADAPTER adapter; -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ u32 ok = _TRUE; -+ u8 fw_ok = _FALSE; -+ int err, err_ret = -1; -+ -+ -+ adapter = d->padapters[IFACE_ID0]; -+ halmac = dvobj_to_halmac(d); -+ if (!halmac) -+ goto out; -+ api = HALMAC_GET_API(halmac); -+ -+ /* StatePowerOff */ -+ -+ /* SKIP: halmac_init_adapter (Already done before) */ -+ -+ /* halmac_pre_Init_system_cfg */ -+ /* halmac_mac_power_switch(on) */ -+ /* halmac_Init_system_cfg */ -+ ok = rtw_hal_power_on(adapter); -+ if (_FALSE == ok) -+ goto out; -+ -+ /* StatePowerOn */ -+ -+ /* DownloadFW */ -+ d->hmpriv.send_general_info = 0; -+ if (fw && fwsize) { -+ err = rtw_halmac_dlfw(d, fw, fwsize); -+ if (err) -+ goto out; -+ fw_ok = _TRUE; -+ } -+ -+ /* InitMACFlow */ -+ status = init_mac_flow(d); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ /* halmac_send_general_info */ -+ if (_TRUE == fw_ok) { -+ d->hmpriv.send_general_info = 0; -+ err = _send_general_info(d); -+ if (err) -+ goto out; -+ } else -+ d->hmpriv.send_general_info = 1; -+ -+ /* Init Phy parameter-MAC */ -+ ok = rtw_hal_init_mac_register(adapter); -+ if (_FALSE == ok) -+ goto out; -+ -+ /* StateMacInitialized */ -+ -+ /* halmac_cfg_drv_info */ -+ err = rtw_halmac_config_rx_info(d, HALMAC_DRV_INFO_PHY_STATUS); -+ if (err) -+ goto out; -+ -+ /* halmac_set_hw_value(HALMAC_HW_EN_BB_RF) */ -+ /* Init BB, RF */ -+ ok = rtw_hal_init_phy(adapter); -+ if (_FALSE == ok) -+ goto out; -+ -+ status = api->halmac_init_interface_cfg(halmac); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ /* SKIP: halmac_verify_platform_api */ -+ /* SKIP: halmac_h2c_lb */ -+ -+ /* StateRxIdle */ -+ -+ err_ret = 0; -+out: -+ return err_ret; -+} -+ -+int rtw_halmac_init_hal(struct dvobj_priv *d) -+{ -+ return _halmac_init_hal(d, NULL, 0); -+} -+ -+/* -+ * Notices: -+ * Make sure -+ * 1. rtw_hal_get_hwreg(HW_VAR_RF_TYPE) -+ * 2. HAL_DATA_TYPE.rfe_type -+ * already ready for use before calling this function. -+ */ -+int rtw_halmac_init_hal_fw(struct dvobj_priv *d, u8 *fw, u32 fwsize) -+{ -+ return _halmac_init_hal(d, fw, fwsize); -+} -+ -+/* -+ * Notices: -+ * Make sure -+ * 1. rtw_hal_get_hwreg(HW_VAR_RF_TYPE) -+ * 2. HAL_DATA_TYPE.rfe_type -+ * already ready for use before calling this function. -+ */ -+int rtw_halmac_init_hal_fw_file(struct dvobj_priv *d, u8 *fwpath) -+{ -+ u8 *fw = NULL; -+ u32 fwmaxsize, size = 0; -+ int err = 0; -+ -+ -+ fwmaxsize = FIRMWARE_MAX_SIZE; -+ fw = rtw_zmalloc(fwmaxsize); -+ if (!fw) -+ return -1; -+ -+ size = rtw_retrieve_from_file(fwpath, fw, fwmaxsize); -+ if (!size) { -+ err = -1; -+ goto exit; -+ } -+ -+ err = _halmac_init_hal(d, fw, size); -+ -+exit: -+ rtw_mfree(fw, fwmaxsize); -+ fw = NULL; -+ -+ return err; -+} -+ -+int rtw_halmac_deinit_hal(struct dvobj_priv *d) -+{ -+ PADAPTER adapter; -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ int err = -1; -+ -+ -+ adapter = d->padapters[IFACE_ID0]; -+ halmac = dvobj_to_halmac(d); -+ if (!halmac) -+ goto out; -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_deinit_interface_cfg(halmac); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ rtw_hal_power_off(adapter); -+ -+ err = 0; -+out: -+ return err; -+} -+ -+int rtw_halmac_self_verify(struct dvobj_priv *d) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ int err = -1; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_verify_platform_api(mac); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ status = api->halmac_h2c_lb(mac); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+int rtw_halmac_dlfw(struct dvobj_priv *d, u8 *fw, u32 fwsize) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ int err = 0; -+ PHAL_DATA_TYPE hal; -+ HALMAC_FW_VERSION fw_vesion; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ hal = GET_HAL_DATA(d->padapters[IFACE_ID0]); -+ -+ if ((!fw) || (!fwsize)) -+ return -1; -+ -+ /* 1. Driver Stop Tx */ -+ /* ToDo */ -+ -+ /* 2. Driver Check Tx FIFO is empty */ -+ /* ToDo */ -+ -+ /* 3. Config MAX download size */ -+#ifdef CONFIG_USB_HCI -+ /* for USB do not exceed MAX_CMDBUF_SZ */ -+ api->halmac_cfg_max_dl_size(mac, 0x1000); -+#elif defined CONFIG_PCIE_HCI -+ /* required a even length from u32 */ -+ api->halmac_cfg_max_dl_size(mac, (MAX_CMDBUF_SZ - TXDESC_OFFSET) & 0xFFFFFFFE); -+#endif -+ -+ /* 4. Download Firmware */ -+ status = api->halmac_download_firmware(mac, fw, fwsize); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ -+ if (d->hmpriv.send_general_info) { -+ d->hmpriv.send_general_info = 0; -+ err = _send_general_info(d); -+ } -+ -+ /* 5. Driver resume TX if needed */ -+ /* ToDo */ -+ -+ /* 6. Reset driver variables if needed */ -+ hal->LastHMEBoxNum = 0; -+ -+ -+ /* 7. Get FW version */ -+ status = api->halmac_get_fw_version(mac, &fw_vesion); -+ if (status == HALMAC_RET_SUCCESS) { -+ hal->FirmwareVersion = fw_vesion.version; -+ hal->FirmwareSubVersion = fw_vesion.sub_version; -+ } -+ -+ return err; -+} -+ -+int rtw_halmac_dlfw_from_file(struct dvobj_priv *d, u8 *fwpath) -+{ -+ u8 *fw = NULL; -+ u32 fwmaxsize, size = 0; -+ int err = 0; -+ -+ -+ fwmaxsize = FIRMWARE_MAX_SIZE; -+ fw = rtw_zmalloc(fwmaxsize); -+ if (!fw) -+ return -1; -+ -+ size = rtw_retrieve_from_file(fwpath, fw, fwmaxsize); -+ if (size) -+ err = rtw_halmac_dlfw(d, fw, size); -+ else -+ err = -1; -+ -+ rtw_mfree(fw, fwmaxsize); -+ fw = NULL; -+ -+ return err; -+} -+ -+/* -+ * Description: -+ * Power on/off BB/RF domain. -+ * -+ * Parameters: -+ * enable _TRUE/_FALSE for power on/off -+ * -+ * Return: -+ * 0 Success -+ * others Fail -+ */ -+int rtw_halmac_phy_power_switch(struct dvobj_priv *d, u8 enable) -+{ -+ PADAPTER adapter; -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ -+ -+ adapter = d->padapters[IFACE_ID0]; -+ halmac = dvobj_to_halmac(d); -+ if (!halmac) -+ return -1; -+ api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_set_hw_value(halmac, HALMAC_HW_EN_BB_RF, &enable); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ return 0; -+} -+ -+static u8 _is_fw_read_cmd_down(PADAPTER adapter, u8 msgbox_num) -+{ -+ u8 read_down = _FALSE; -+ int retry_cnts = 100; -+ u8 valid; -+ -+ /* RTW_INFO("_is_fw_read_cmd_down, reg_1cc(%x), msg_box(%d)...\n", rtw_read8(adapter, REG_HMETFR), msgbox_num); */ -+ -+ do { -+ valid = rtw_read8(adapter, REG_HMETFR) & BIT(msgbox_num); -+ if (0 == valid) -+ read_down = _TRUE; -+ else -+ rtw_msleep_os(1); -+ } while ((!read_down) && (retry_cnts--)); -+ -+ return read_down; -+} -+ -+int rtw_halmac_send_h2c(struct dvobj_priv *d, u8 *h2c) -+{ -+ PADAPTER adapter = d->padapters[IFACE_ID0]; -+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); -+ u8 h2c_box_num = 0; -+ u32 msgbox_addr = 0; -+ u32 msgbox_ex_addr = 0; -+ u32 h2c_cmd = 0; -+ u32 h2c_cmd_ex = 0; -+ s32 ret = _FAIL; -+ -+ if (adapter->bFWReady == _FALSE) { -+ RTW_INFO("%s: return H2C cmd because fw is not ready\n", __FUNCTION__); -+ return ret; -+ } -+ -+ if (!h2c) { -+ RTW_INFO("%s: pbuf is NULL\n", __FUNCTION__); -+ return ret; -+ } -+ -+ if (rtw_is_surprise_removed(adapter)) { -+ RTW_INFO("%s: surprise removed\n", __FUNCTION__); -+ return ret; -+ } -+ -+ _enter_critical_mutex(&d->h2c_fwcmd_mutex, NULL); -+ -+ /* pay attention to if race condition happened in H2C cmd setting */ -+ h2c_box_num = hal->LastHMEBoxNum; -+ -+ if (!_is_fw_read_cmd_down(adapter, h2c_box_num)) { -+ RTW_INFO(" fw read cmd failed...\n"); -+ goto exit; -+ } -+ -+ /* Write Ext command(byte 4 -7) */ -+ msgbox_ex_addr = REG_HMEBOX_E0 + (h2c_box_num * EX_MESSAGE_BOX_SIZE); -+ _rtw_memcpy((u8 *)(&h2c_cmd_ex), h2c + 4, EX_MESSAGE_BOX_SIZE); -+ h2c_cmd_ex = le32_to_cpu(h2c_cmd_ex); -+ rtw_write32(adapter, msgbox_ex_addr, h2c_cmd_ex); -+ -+ /* Write command (byte 0 -3 ) */ -+ msgbox_addr = REG_HMEBOX0 + (h2c_box_num * MESSAGE_BOX_SIZE); -+ _rtw_memcpy((u8 *)(&h2c_cmd), h2c, 4); -+ h2c_cmd = le32_to_cpu(h2c_cmd); -+ rtw_write32(adapter, msgbox_addr, h2c_cmd); -+ -+ /* update last msg box number */ -+ hal->LastHMEBoxNum = (h2c_box_num + 1) % MAX_H2C_BOX_NUMS; -+ ret = _SUCCESS; -+ -+exit: -+ _exit_critical_mutex(&d->h2c_fwcmd_mutex, NULL); -+ return ret; -+} -+ -+int rtw_halmac_c2h_handle(struct dvobj_priv *d, u8 *c2h, u32 size) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_get_c2h_info(mac, c2h, size); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ -+ return 0; -+} -+ -+int rtw_halmac_get_physical_efuse_size(struct dvobj_priv *d, u32 *size) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ u32 val; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_get_efuse_size(mac, &val); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ -+ *size = val; -+ return 0; -+} -+ -+int rtw_halmac_read_physical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ HALMAC_FEATURE_ID id; -+ int ret; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ id = HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE; -+ -+ ret = init_halmac_event(d, id, map, size); -+ if (ret) -+ return -1; -+ -+ status = api->halmac_dump_efuse_map(mac, HALMAC_EFUSE_R_AUTO); -+ if (HALMAC_RET_SUCCESS != status) { -+ free_halmac_event(d, id); -+ return -1; -+ } -+ -+ ret = wait_halmac_event(d, id); -+ if (ret) -+ return -1; -+ -+ return 0; -+} -+ -+int rtw_halmac_read_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ u8 v; -+ u32 i; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ for (i = 0; i < cnt; i++) { -+ status = api->halmac_read_efuse(mac, offset + i, &v); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ data[i] = v; -+ } -+ -+ return 0; -+} -+ -+int rtw_halmac_write_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ u32 i; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ for (i = 0; i < cnt; i++) { -+ status = api->halmac_write_efuse(mac, offset + i, data[i]); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ } -+ -+ return 0; -+} -+ -+int rtw_halmac_get_logical_efuse_size(struct dvobj_priv *d, u32 *size) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ u32 val; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_get_logical_efuse_size(mac, &val); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ -+ *size = val; -+ return 0; -+} -+ -+int rtw_halmac_read_logical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ HALMAC_FEATURE_ID id; -+ int ret; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ id = HALMAC_FEATURE_DUMP_LOGICAL_EFUSE; -+ -+ ret = init_halmac_event(d, id, map, size); -+ if (ret) -+ return -1; -+ -+ status = api->halmac_dump_logical_efuse_map(mac, HALMAC_EFUSE_R_AUTO); -+ if (HALMAC_RET_SUCCESS != status) { -+ free_halmac_event(d, id); -+ return -1; -+ } -+ -+ ret = wait_halmac_event(d, id); -+ if (ret) -+ return -1; -+ -+ return 0; -+} -+ -+int rtw_halmac_write_logical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size, u8 *maskmap, u32 masksize) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_PG_EFUSE_INFO pginfo; -+ HALMAC_RET_STATUS status; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ pginfo.pEfuse_map = map; -+ pginfo.efuse_map_size = size; -+ pginfo.pEfuse_mask = maskmap; -+ pginfo.efuse_mask_size = masksize; -+ -+ status = api->halmac_pg_efuse_by_map(mac, &pginfo, HALMAC_EFUSE_R_AUTO); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ -+ return 0; -+} -+ -+int rtw_halmac_read_logical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ u8 v; -+ u32 i; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ for (i = 0; i < cnt; i++) { -+ status = api->halmac_read_logical_efuse(mac, offset + i, &v); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ data[i] = v; -+ } -+ -+ return 0; -+} -+ -+int rtw_halmac_write_logical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ u32 i; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ for (i = 0; i < cnt; i++) { -+ status = api->halmac_write_logical_efuse(mac, offset + i, data[i]); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ } -+ -+ return 0; -+} -+ -+int rtw_halmac_write_bt_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ u32 i; -+ u8 bank = 1; -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ for (i = 0; i < cnt; i++) { -+ status = api->halmac_write_efuse_bt(mac, offset + i, data[i], bank); -+ if (HALMAC_RET_SUCCESS != status) { -+ printk("%s: halmac_write_efuse_bt status = %d\n", __FUNCTION__, status); -+ return -1; -+ } -+ } -+ printk("%s: halmac_write_efuse_bt status = HALMAC_RET_SUCCESS %d\n", __FUNCTION__, status); -+ return 0; -+} -+ -+ -+int rtw_halmac_read_bt_physical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ HALMAC_FEATURE_ID id; -+ int ret; -+ int bank = 1; -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_dump_efuse_map_bt(mac, bank, size, map); -+ if (HALMAC_RET_SUCCESS != status) { -+ printk("%s: halmac_dump_efuse_map_bt fail!\n", __FUNCTION__); -+ return -1; -+ } -+ -+ printk("%s: OK!\n", __FUNCTION__); -+ -+ return 0; -+} -+ -+static inline u8 _hw_port_drv2halmac(enum _hw_port hwport) -+{ -+ u8 port = 0; -+ -+ -+ switch (hwport) { -+ case HW_PORT0: -+ port = 0; -+ break; -+ case HW_PORT1: -+ port = 1; -+ break; -+ case HW_PORT2: -+ port = 2; -+ break; -+ case HW_PORT3: -+ port = 3; -+ break; -+ case HW_PORT4: -+ port = 4; -+ break; -+ default: -+ port = hwport; -+ break; -+ } -+ -+ return port; -+} -+ -+int rtw_halmac_set_mac_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) -+{ -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ u8 port; -+ HALMAC_WLAN_ADDR hwa; -+ HALMAC_RET_STATUS status; -+ int err = -1; -+ -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ -+ port = _hw_port_drv2halmac(hwport); -+ _rtw_memset(&hwa, 0, sizeof(hwa)); -+ _rtw_memcpy(hwa.Address, addr, 6); -+ -+ status = api->halmac_cfg_mac_addr(halmac, port, &hwa); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+int rtw_halmac_set_bssid(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) -+{ -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ u8 port; -+ HALMAC_WLAN_ADDR hwa; -+ HALMAC_RET_STATUS status; -+ int err = -1; -+ -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ port = _hw_port_drv2halmac(hwport); -+ -+ _rtw_memset(&hwa, 0, sizeof(HALMAC_WLAN_ADDR)); -+ _rtw_memcpy(hwa.Address, addr, 6); -+ status = api->halmac_cfg_bssid(halmac, port, &hwa); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+int rtw_halmac_set_bandwidth(struct dvobj_priv *d, u8 channel, u8 pri_ch_idx, u8 bw) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_cfg_ch_bw(mac, channel, pri_ch_idx, bw); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ -+ return 0; -+} -+ -+int rtw_halmac_get_hw_value(struct dvobj_priv *d, HALMAC_HW_ID hw_id, VOID *pvalue) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_get_hw_value(mac, hw_id, pvalue); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ -+ return 0; -+} -+ -+int rtw_halmac_dump_fifo(struct dvobj_priv *d, HAL_FIFO_SEL halmac_fifo_sel) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ u8 *pfifo_map = NULL; -+ u32 fifo_size = 0; -+ s8 ret = 0; -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ fifo_size = api->halmac_get_fifo_size(mac, halmac_fifo_sel); -+ if (fifo_size) -+ pfifo_map = rtw_vmalloc(fifo_size); -+ if (pfifo_map == NULL) -+ return -1; -+ -+ status = api->halmac_dump_fifo(mac, halmac_fifo_sel, pfifo_map, fifo_size); -+ if (HALMAC_RET_SUCCESS != status) { -+ ret = -1; -+ goto _exit; -+ } -+ -+_exit: -+ if (pfifo_map) -+ rtw_vmfree(pfifo_map, fifo_size); -+ return ret; -+ -+} -+ -+int rtw_halmac_rx_agg_switch(struct dvobj_priv *d, u8 enable) -+{ -+ PADAPTER adapter; -+ PHAL_DATA_TYPE hal; -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ HALMAC_RXAGG_CFG rxaggcfg; -+ HALMAC_RET_STATUS status; -+ int err = -1; -+ -+ -+ adapter = d->padapters[IFACE_ID0]; -+ hal = GET_HAL_DATA(adapter); -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ _rtw_memset((void *)&rxaggcfg, 0, sizeof(rxaggcfg)); -+ -+ if (_TRUE == enable) { -+#ifdef CONFIG_SDIO_HCI -+ rxaggcfg.mode = HALMAC_RX_AGG_MODE_DMA; -+ rxaggcfg.threshold.drv_define = 0; -+#elif defined(CONFIG_USB_HCI) && defined(CONFIG_USB_RX_AGGREGATION) -+ switch (hal->rxagg_mode) { -+ case RX_AGG_DISABLE: -+ rxaggcfg.mode = HALMAC_RX_AGG_MODE_NONE; -+ break; -+ -+ case RX_AGG_DMA: -+ rxaggcfg.mode = HALMAC_RX_AGG_MODE_DMA; -+ if (hal->rxagg_dma_size || hal->rxagg_dma_timeout) { -+ rxaggcfg.threshold.drv_define = 1; -+ rxaggcfg.threshold.timeout = hal->rxagg_dma_timeout; -+ rxaggcfg.threshold.size = hal->rxagg_dma_size; -+ } -+ break; -+ -+ case RX_AGG_USB: -+ case RX_AGG_MIX: -+ rxaggcfg.mode = HALMAC_RX_AGG_MODE_USB; -+ if (hal->rxagg_usb_size || hal->rxagg_usb_timeout) { -+ rxaggcfg.threshold.drv_define = 1; -+ rxaggcfg.threshold.timeout = hal->rxagg_usb_timeout; -+ rxaggcfg.threshold.size = hal->rxagg_usb_size; -+ } -+ break; -+ } -+#endif /* CONFIG_USB_HCI */ -+ } else -+ rxaggcfg.mode = HALMAC_RX_AGG_MODE_NONE; -+ -+ status = api->halmac_cfg_rx_aggregation(halmac, &rxaggcfg); -+ if (status != HALMAC_RET_SUCCESS) -+ goto out; -+ -+ err = 0; -+out: -+ return err; -+} -+ -+int rtw_halmac_get_wow_reason(struct dvobj_priv *d, u8 *reason) -+{ -+ PADAPTER adapter; -+ u8 val8; -+ int err = -1; -+ -+ -+ adapter = d->padapters[IFACE_ID0]; -+ -+ val8 = rtw_read8(adapter, 0x1C7); -+ if (val8 == 0xEA) -+ goto out; -+ -+ *reason = val8; -+ err = 0; -+out: -+ return err; -+} -+ -+/* -+ * Description: -+ * Get RX driver info size. RX driver info is a small memory space between -+ * scriptor and RX payload. -+ * -+ * +-------------------------+ -+ * | RX descriptor | -+ * | usually 24 bytes | -+ * +-------------------------+ -+ * | RX driver info | -+ * | depends on driver cfg | -+ * +-------------------------+ -+ * | RX paylad | -+ * | | -+ * +-------------------------+ -+ * -+ * Parameter: -+ * d pointer to struct dvobj_priv of driver -+ * sz rx driver info size in bytes. -+ * -+ * Rteurn: -+ * 0 Success -+ * other Fail -+ */ -+int rtw_halmac_get_drv_info_sz(struct dvobj_priv *d, u8 *sz) -+{ -+ HALMAC_RET_STATUS status; -+ PHALMAC_ADAPTER halmac = dvobj_to_halmac(d); -+ PHALMAC_API api = HALMAC_GET_API(halmac); -+ u8 dw = 0; -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_DRV_INFO_SIZE, &dw); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ *sz = dw * 8; -+ return 0; -+} -+int rtw_halmac_get_rsvd_drv_pg_bndy(struct dvobj_priv *dvobj, u16 *drv_pg) -+{ -+ HALMAC_RET_STATUS status; -+ PHALMAC_ADAPTER halmac = dvobj_to_halmac(dvobj); -+ PHALMAC_API api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_RSVD_PG_BNDY, drv_pg); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ return 0; -+} -+ -+int rtw_halmac_download_rsvd_page(struct dvobj_priv *dvobj, u8 pg_offset, u8 *pbuf, u32 size) -+{ -+ HALMAC_RET_STATUS status = HALMAC_RET_SUCCESS; -+ PHALMAC_ADAPTER halmac = dvobj_to_halmac(dvobj); -+ PHALMAC_API api = HALMAC_GET_API(halmac); -+ -+ status = api->halmac_dl_drv_rsvd_page(halmac, pg_offset, pbuf, size); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ return 0; -+ -+} -+ -+#ifdef CONFIG_SDIO_HCI -+ -+/* -+ * Description: -+ * Update queue allocated page number to driver -+ * -+ * Parameter: -+ * d pointer to struct dvobj_priv of driver -+ * -+ * Rteurn: -+ * 0 Success, "page" is valid. -+ * others Fail, "page" is invalid. -+ */ -+int rtw_halmac_query_tx_page_num(struct dvobj_priv *d) -+{ -+ PADAPTER adapter; -+ struct halmacpriv *hmpriv; -+ PHALMAC_ADAPTER halmac; -+ PHALMAC_API api; -+ HALMAC_RQPN_MAP rqpn; -+ HALMAC_DMA_MAPPING dmaqueue; -+ HALMAC_TXFF_ALLOCATION fifosize; -+ HALMAC_RET_STATUS status; -+ u8 i; -+ -+ -+ adapter = d->padapters[IFACE_ID0]; -+ hmpriv = &d->hmpriv; -+ halmac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(halmac); -+ _rtw_memset((void *)&rqpn, 0, sizeof(rqpn)); -+ _rtw_memset((void *)&fifosize, 0, sizeof(fifosize)); -+ -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_RQPN_MAPPING, &rqpn); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ status = api->halmac_get_hw_value(halmac, HALMAC_HW_TXFF_ALLOCATION, &fifosize); -+ if (status != HALMAC_RET_SUCCESS) -+ return -1; -+ -+ for (i = 0; i < HW_QUEUE_ENTRY; i++) { -+ hmpriv->txpage[i] = 0; -+ -+ /* Driver index mapping to HALMAC DMA queue */ -+ dmaqueue = HALMAC_DMA_MAPPING_UNDEFINE; -+ switch (i) { -+ case VO_QUEUE_INX: -+ dmaqueue = rqpn.dma_map_vo; -+ break; -+ case VI_QUEUE_INX: -+ dmaqueue = rqpn.dma_map_vi; -+ break; -+ case BE_QUEUE_INX: -+ dmaqueue = rqpn.dma_map_be; -+ break; -+ case BK_QUEUE_INX: -+ dmaqueue = rqpn.dma_map_bk; -+ break; -+ case MGT_QUEUE_INX: -+ dmaqueue = rqpn.dma_map_mg; -+ break; -+ case HIGH_QUEUE_INX: -+ dmaqueue = rqpn.dma_map_hi; -+ break; -+ case BCN_QUEUE_INX: -+ case TXCMD_QUEUE_INX: -+ /* Unlimited */ -+ hmpriv->txpage[i] = 0xFFFF; -+ continue; -+ } -+ -+ switch (dmaqueue) { -+ case HALMAC_DMA_MAPPING_EXTRA: -+ hmpriv->txpage[i] = fifosize.extra_queue_pg_num; -+ break; -+ case HALMAC_DMA_MAPPING_LOW: -+ hmpriv->txpage[i] = fifosize.low_queue_pg_num; -+ break; -+ case HALMAC_DMA_MAPPING_NORMAL: -+ hmpriv->txpage[i] = fifosize.normal_queue_pg_num; -+ break; -+ case HALMAC_DMA_MAPPING_HIGH: -+ hmpriv->txpage[i] = fifosize.high_queue_pg_num; -+ break; -+ case HALMAC_DMA_MAPPING_UNDEFINE: -+ break; -+ } -+ hmpriv->txpage[i] += fifosize.pub_queue_pg_num; -+ } -+ -+ return 0; -+} -+ -+/* -+ * Description: -+ * Get specific queue allocated page number -+ * -+ * Parameter: -+ * d pointer to struct dvobj_priv of driver -+ * queue target queue to query, VO/VI/BE/BK/.../TXCMD_QUEUE_INX -+ * page return allocated page number -+ * -+ * Rteurn: -+ * 0 Success, "page" is valid. -+ * others Fail, "page" is invalid. -+ */ -+int rtw_halmac_get_tx_queue_page_num(struct dvobj_priv *d, u8 queue, u32 *page) -+{ -+ *page = 0; -+ if (queue < HW_QUEUE_ENTRY) -+ *page = d->hmpriv.txpage[queue]; -+ -+ return 0; -+} -+ -+/* -+ * Return: -+ * address for SDIO command -+ */ -+u32 rtw_halmac_sdio_get_tx_addr(struct dvobj_priv *d, u8 *desc, u32 size) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ u32 addr; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_get_sdio_tx_addr(mac, desc, size, &addr); -+ if (HALMAC_RET_SUCCESS != status) -+ return 0; -+ -+ return addr; -+} -+ -+int rtw_halmac_sdio_tx_allowed(struct dvobj_priv *d, u8 *buf, u32 size) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_tx_allowed_sdio(mac, buf, size); -+ if (HALMAC_RET_SUCCESS != status) -+ return -1; -+ -+ return 0; -+} -+ -+u32 rtw_halmac_sdio_get_rx_addr(struct dvobj_priv *d, u8 *seq) -+{ -+ u8 id; -+ -+#define RTW_SDIO_ADDR_RX_RX0FF_PRFIX 0x0E000 -+#define RTW_SDIO_ADDR_RX_RX0FF_GEN(a) (RTW_SDIO_ADDR_RX_RX0FF_PRFIX|(a&0x3)) -+ -+ id = *seq; -+ (*seq)++; -+ return RTW_SDIO_ADDR_RX_RX0FF_GEN(id); -+} -+#endif /* CONFIG_SDIO_HCI */ -+ -+#ifdef CONFIG_USB_HCI -+u8 rtw_halmac_usb_get_bulkout_id(struct dvobj_priv *d, u8 *buf, u32 size) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ u8 bulkout_id; -+ -+ -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ -+ status = api->halmac_get_usb_bulkout_id(mac, buf, size, &bulkout_id); -+ if (HALMAC_RET_SUCCESS != status) -+ return 0; -+ -+ return bulkout_id; -+} -+ -+static inline HALMAC_USB_MODE _usb_mode_drv2halmac(enum RTW_USB_SPEED usb_mode) -+{ -+ HALMAC_USB_MODE halmac_usb_mode = HALMAC_USB_MODE_U2; -+ -+ switch (usb_mode) { -+ case RTW_USB_SPEED_2: -+ halmac_usb_mode = HALMAC_USB_MODE_U2; -+ break; -+ case RTW_USB_SPEED_3: -+ halmac_usb_mode = HALMAC_USB_MODE_U3; -+ break; -+ default: -+ halmac_usb_mode = HALMAC_USB_MODE_U2; -+ break; -+ } -+ -+ return halmac_usb_mode; -+} -+ -+u8 rtw_halmac_switch_usb_mode(struct dvobj_priv *d, enum RTW_USB_SPEED usb_mode) -+{ -+ PHALMAC_ADAPTER mac; -+ PHALMAC_API api; -+ HALMAC_RET_STATUS status; -+ PADAPTER adapter; -+ HALMAC_USB_MODE halmac_usb_mode; -+ -+ adapter = d->padapters[IFACE_ID0]; -+ mac = dvobj_to_halmac(d); -+ api = HALMAC_GET_API(mac); -+ halmac_usb_mode = _usb_mode_drv2halmac(usb_mode); -+ status = api->halmac_set_hw_value(mac, HALMAC_HW_USB_MODE, (void *)&halmac_usb_mode); -+ -+ if (HALMAC_RET_SUCCESS != status) -+ return _FAIL; -+ -+ return _SUCCESS; -+} -+#endif /* CONFIG_USB_HCI */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_halmac.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_halmac.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_halmac.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_halmac.h 2018-02-11 21:44:27.152146162 +0200 -@@ -0,0 +1,118 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _HAL_HALMAC_H_ -+#define _HAL_HALMAC_H_ -+ -+#include /* adapter_to_dvobj(), struct intf_hdl and etc. */ -+#include "halmac/halmac_api.h" /* PHALMAC_ADAPTER and etc. */ -+ -+/* HALMAC Definition for Driver */ -+#define RTW_HALMAC_H2C_MAX_SIZE HALMAC_H2C_CMD_ORIGINAL_SIZE_88XX -+#define RTW_HALMAC_BA_SSN_RPT_SIZE 4 -+ -+#define dvobj_set_halmac(d, mac) ((d)->halmac = (mac)) -+#define dvobj_to_halmac(d) ((PHALMAC_ADAPTER)((d)->halmac)) -+#define adapter_to_halmac(p) dvobj_to_halmac(adapter_to_dvobj(p)) -+ -+/* for H2C cmd */ -+#define MAX_H2C_BOX_NUMS 4 -+#define MESSAGE_BOX_SIZE 4 -+#define EX_MESSAGE_BOX_SIZE 4 -+ -+typedef enum _RTW_HALMAC_MODE { -+ RTW_HALMAC_MODE_NORMAL, -+ RTW_HALMAC_MODE_WIFI_TEST, -+} RTW_HALMAC_MODE; -+ -+extern HALMAC_PLATFORM_API rtw_halmac_platform_api; -+ -+/* HALMAC API for Driver(HAL) */ -+u8 rtw_halmac_read8(struct intf_hdl *, u32 addr); -+u16 rtw_halmac_read16(struct intf_hdl *, u32 addr); -+u32 rtw_halmac_read32(struct intf_hdl *, u32 addr); -+void rtw_halmac_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+u8 rtw_halmac_iread8(struct intf_hdl *pintfhdl, u32 addr); -+u16 rtw_halmac_iread16(struct intf_hdl *pintfhdl, u32 addr); -+u32 rtw_halmac_iread32(struct intf_hdl *pintfhdl, u32 addr); -+#endif -+int rtw_halmac_write8(struct intf_hdl *, u32 addr, u8 value); -+int rtw_halmac_write16(struct intf_hdl *, u32 addr, u16 value); -+int rtw_halmac_write32(struct intf_hdl *, u32 addr, u32 value); -+ -+int rtw_halmac_init_adapter(struct dvobj_priv *, PHALMAC_PLATFORM_API); -+int rtw_halmac_deinit_adapter(struct dvobj_priv *); -+int rtw_halmac_poweron(struct dvobj_priv *); -+int rtw_halmac_poweroff(struct dvobj_priv *); -+int rtw_halmac_init_hal(struct dvobj_priv *); -+int rtw_halmac_init_hal_fw(struct dvobj_priv *, u8 *fw, u32 fwsize); -+int rtw_halmac_init_hal_fw_file(struct dvobj_priv *, u8 *fwpath); -+int rtw_halmac_deinit_hal(struct dvobj_priv *); -+int rtw_halmac_self_verify(struct dvobj_priv *); -+int rtw_halmac_dlfw(struct dvobj_priv *, u8 *fw, u32 fwsize); -+int rtw_halmac_dlfw_from_file(struct dvobj_priv *, u8 *fwpath); -+int rtw_halmac_phy_power_switch(struct dvobj_priv *, u8 enable); -+int rtw_halmac_send_h2c(struct dvobj_priv *, u8 *h2c); -+int rtw_halmac_c2h_handle(struct dvobj_priv *, u8 *c2h, u32 size); -+ -+int rtw_halmac_get_physical_efuse_size(struct dvobj_priv *, u32 *size); -+int rtw_halmac_read_physical_efuse_map(struct dvobj_priv *, u8 *map, u32 size); -+int rtw_halmac_read_physical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); -+int rtw_halmac_write_physical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); -+int rtw_halmac_get_logical_efuse_size(struct dvobj_priv *, u32 *size); -+int rtw_halmac_read_logical_efuse_map(struct dvobj_priv *, u8 *map, u32 size); -+int rtw_halmac_write_logical_efuse_map(struct dvobj_priv *, u8 *map, u32 size, u8 *maskmap, u32 masksize); -+int rtw_halmac_read_logical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); -+int rtw_halmac_write_logical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); -+ -+int rtw_halmac_write_bt_physical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); -+int rtw_halmac_read_bt_physical_efuse_map(struct dvobj_priv *, u8 *map, u32 size); -+ -+int rtw_halmac_config_rx_info(struct dvobj_priv *, HALMAC_DRV_INFO); -+int rtw_halmac_set_mac_address(struct dvobj_priv *, enum _hw_port, u8 *addr); -+int rtw_halmac_set_bssid(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr); -+ -+int rtw_halmac_set_bandwidth(struct dvobj_priv *, u8 channel, u8 pri_ch_idx, u8 bw); -+int rtw_halmac_rx_agg_switch(struct dvobj_priv *, u8 enable); -+int rtw_halmac_get_hw_value(struct dvobj_priv *d, HALMAC_HW_ID hw_id, VOID *pvalue); -+ -+int rtw_halmac_get_wow_reason(struct dvobj_priv *, u8 *reason); -+int rtw_halmac_get_drv_info_sz(struct dvobj_priv *d, u8 *sz); -+ -+int rtw_halmac_get_rsvd_drv_pg_bndy(struct dvobj_priv *dvobj, u16 *drv_pg); -+int rtw_halmac_download_rsvd_page(struct dvobj_priv *dvobj, u8 pg_offset, u8 *pbuf, u32 size); -+ -+#ifdef CONFIG_SDIO_HCI -+int rtw_halmac_query_tx_page_num(struct dvobj_priv *); -+int rtw_halmac_get_tx_queue_page_num(struct dvobj_priv *, u8 queue, u32 *page); -+u32 rtw_halmac_sdio_get_tx_addr(struct dvobj_priv *, u8 *desc, u32 size); -+int rtw_halmac_sdio_tx_allowed(struct dvobj_priv *, u8 *buf, u32 size); -+u32 rtw_halmac_sdio_get_rx_addr(struct dvobj_priv *, u8 *seq); -+#endif /* CONFIG_SDIO_HCI */ -+ -+#ifdef CONFIG_USB_HCI -+u8 rtw_halmac_usb_get_bulkout_id(struct dvobj_priv *, u8 *buf, u32 size); -+u8 rtw_halmac_switch_usb_mode(struct dvobj_priv *d, enum RTW_USB_SPEED usb_mode); -+#endif /* CONFIG_USB_HCI */ -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+void dump_trx_share_mode(void *sel, _adapter *adapter); -+#endif -+#endif /* _HAL_HALMAC_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_hci/hal_pci.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_hci/hal_pci.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_hci/hal_pci.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_hci/hal_pci.c 2018-02-11 21:44:27.152146162 +0200 -@@ -0,0 +1,23 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _HAL_PCI_C_ -+ -+#include -+#include -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_intf.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_intf.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_intf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_intf.c 2018-02-11 21:44:27.152146162 +0200 -@@ -0,0 +1,1319 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#define _HAL_INTF_C_ -+ -+#include -+#include -+ -+const u32 _chip_type_to_odm_ic_type[] = { -+ 0, -+ ODM_RTL8188E, -+ ODM_RTL8192E, -+ ODM_RTL8812, -+ ODM_RTL8821, -+ ODM_RTL8723B, -+ ODM_RTL8814A, -+ ODM_RTL8703B, -+ ODM_RTL8188F, -+ ODM_RTL8822B, -+ ODM_RTL8723D, -+ ODM_RTL8821C, -+ 0, -+}; -+ -+void rtw_hal_chip_configure(_adapter *padapter) -+{ -+ padapter->HalFunc.intf_chip_configure(padapter); -+} -+ -+void rtw_hal_read_chip_info(_adapter *padapter) -+{ -+ u8 hci_type = rtw_get_intf_type(padapter); -+ u32 start = rtw_get_current_time(); -+ -+ /* before access eFuse, make sure card enable has been called */ -+ if ((hci_type == RTW_SDIO || hci_type == RTW_GSPI) -+ && !rtw_is_hw_init_completed(padapter)) -+ rtw_hal_power_on(padapter); -+ -+ padapter->HalFunc.read_adapter_info(padapter); -+ -+ if ((hci_type == RTW_SDIO || hci_type == RTW_GSPI) -+ && !rtw_is_hw_init_completed(padapter)) -+ rtw_hal_power_off(padapter); -+ -+ RTW_INFO("%s in %d ms\n", __func__, rtw_get_passing_time_ms(start)); -+} -+ -+void rtw_hal_read_chip_version(_adapter *padapter) -+{ -+ padapter->HalFunc.read_chip_version(padapter); -+ rtw_odm_init_ic_type(padapter); -+} -+ -+void rtw_hal_def_value_init(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { -+ padapter->HalFunc.init_default_value(padapter); -+ -+ rtw_init_hal_com_default_value(padapter); -+ -+ { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); -+ -+ /* hal_spec is ready here */ -+ dvobj->macid_ctl.num = rtw_min(hal_spec->macid_num, MACID_NUM_SW_LIMIT); -+ -+ dvobj->cam_ctl.sec_cap = hal_spec->sec_cap; -+ dvobj->cam_ctl.num = rtw_min(hal_spec->sec_cam_ent_num, SEC_CAM_ENT_NUM_SW_LIMIT); -+ } -+ } -+} -+ -+u8 rtw_hal_data_init(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { -+ padapter->hal_data_sz = sizeof(HAL_DATA_TYPE); -+ padapter->HalData = rtw_zvmalloc(padapter->hal_data_sz); -+ if (padapter->HalData == NULL) { -+ RTW_INFO("cant not alloc memory for HAL DATA\n"); -+ return _FAIL; -+ } -+ } -+ return _SUCCESS; -+} -+ -+void rtw_hal_data_deinit(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { -+ if (padapter->HalData) { -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ phy_free_filebuf(padapter); -+#endif -+ rtw_vmfree(padapter->HalData, padapter->hal_data_sz); -+ padapter->HalData = NULL; -+ padapter->hal_data_sz = 0; -+ } -+ } -+} -+ -+void rtw_hal_free_data(_adapter *padapter) -+{ -+ /* free HAL Data */ -+ rtw_hal_data_deinit(padapter); -+} -+void rtw_hal_dm_init(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ padapter->HalFunc.dm_init(padapter); -+ -+ _rtw_spinlock_init(&pHalData->IQKSpinLock); -+ -+ phy_load_tx_power_ext_info(padapter, 1); -+ } -+} -+void rtw_hal_dm_deinit(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) { -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ padapter->HalFunc.dm_deinit(padapter); -+ -+ _rtw_spinlock_free(&pHalData->IQKSpinLock); -+ } -+} -+void rtw_hal_sw_led_init(_adapter *padapter) -+{ -+ if (padapter->HalFunc.InitSwLeds) -+ padapter->HalFunc.InitSwLeds(padapter); -+} -+ -+void rtw_hal_sw_led_deinit(_adapter *padapter) -+{ -+ if (padapter->HalFunc.DeInitSwLeds) -+ padapter->HalFunc.DeInitSwLeds(padapter); -+} -+ -+u32 rtw_hal_power_on(_adapter *padapter) -+{ -+ u32 ret = 0; -+ -+ ret = padapter->HalFunc.hal_power_on(padapter); -+ -+#ifdef CONFIG_BT_COEXIST -+ if (ret == _SUCCESS) -+ rtw_btcoex_PowerOnSetting(padapter); -+#endif -+ -+ return ret; -+} -+ -+void rtw_hal_power_off(_adapter *padapter) -+{ -+ struct macid_ctl_t *macid_ctl = &padapter->dvobj->macid_ctl; -+ -+ _rtw_memset(macid_ctl->h2c_msr, 0, MACID_NUM_SW_LIMIT); -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_PowerOffSetting(padapter); -+#endif -+ -+ padapter->HalFunc.hal_power_off(padapter); -+} -+ -+void rtw_hal_init_opmode(_adapter *padapter) -+{ -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType = Ndis802_11InfrastructureMax; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ sint fw_state; -+ -+ fw_state = get_fwstate(pmlmepriv); -+ -+ if (fw_state & WIFI_ADHOC_STATE) -+ networkType = Ndis802_11IBSS; -+ else if (fw_state & WIFI_STATION_STATE) -+ networkType = Ndis802_11Infrastructure; -+ else if (fw_state & WIFI_AP_STATE) -+ networkType = Ndis802_11APMode; -+ else -+ return; -+ -+ rtw_setopmode_cmd(padapter, networkType, _FALSE); -+} -+ -+uint rtw_hal_init(_adapter *padapter) -+{ -+ uint status = _SUCCESS; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ int i; -+ -+ status = padapter->HalFunc.hal_init(padapter); -+ -+ if (status == _SUCCESS) { -+ pHalData->hw_init_completed = _TRUE; -+ rtw_restore_mac_addr(padapter); -+ -+ if (padapter->registrypriv.notch_filter == 1) -+ rtw_hal_notch_filter(padapter, 1); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) -+ rtw_sec_restore_wep_key(dvobj->padapters[i]); -+ -+ rtw_led_control(padapter, LED_CTL_POWER_ON); -+ -+ init_hw_mlme_ext(padapter); -+ -+ rtw_hal_init_opmode(padapter); -+ -+#ifdef CONFIG_RF_POWER_TRIM -+ rtw_bb_rf_gain_offset(padapter); -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ -+ } else { -+ pHalData->hw_init_completed = _FALSE; -+ RTW_INFO("rtw_hal_init: hal__init fail\n"); -+ } -+ -+ -+ return status; -+ -+} -+ -+uint rtw_hal_deinit(_adapter *padapter) -+{ -+ uint status = _SUCCESS; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ int i; -+ -+ status = padapter->HalFunc.hal_deinit(padapter); -+ -+ if (status == _SUCCESS) { -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ pHalData->hw_init_completed = _FALSE; -+ } else -+ RTW_INFO("\n rtw_hal_deinit: hal_init fail\n"); -+ -+ -+ return status; -+} -+ -+void rtw_hal_set_hwreg(_adapter *padapter, u8 variable, u8 *val) -+{ -+ padapter->HalFunc.SetHwRegHandler(padapter, variable, val); -+} -+ -+void rtw_hal_get_hwreg(_adapter *padapter, u8 variable, u8 *val) -+{ -+ padapter->HalFunc.GetHwRegHandler(padapter, variable, val); -+} -+ -+u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue) -+{ -+ return padapter->HalFunc.SetHalDefVarHandler(padapter, eVariable, pValue); -+} -+u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue) -+{ -+ return padapter->HalFunc.GetHalDefVarHandler(padapter, eVariable, pValue); -+} -+ -+void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, BOOLEAN bSet) -+{ -+ padapter->HalFunc.SetHalODMVarHandler(padapter, eVariable, pValue1, bSet); -+} -+void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, PVOID pValue2) -+{ -+ padapter->HalFunc.GetHalODMVarHandler(padapter, eVariable, pValue1, pValue2); -+} -+ -+/* FOR SDIO & PCIE */ -+void rtw_hal_enable_interrupt(_adapter *padapter) -+{ -+#if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) -+ if (padapter->HalFunc.enable_interrupt) -+ padapter->HalFunc.enable_interrupt(padapter); -+ else -+ RTW_INFO("%s: HalFunc.enable_interrupt is NULL!\n", __func__); -+#endif /* #if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) */ -+} -+ -+/* FOR SDIO & PCIE */ -+void rtw_hal_disable_interrupt(_adapter *padapter) -+{ -+#if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) -+ if (padapter->HalFunc.disable_interrupt) -+ padapter->HalFunc.disable_interrupt(padapter); -+ else -+ RTW_INFO("%s: HalFunc.disable_interrupt is NULL!\n", __func__); -+#endif /* #if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) */ -+} -+ -+ -+u8 rtw_hal_check_ips_status(_adapter *padapter) -+{ -+ u8 val = _FALSE; -+ if (padapter->HalFunc.check_ips_status) -+ val = padapter->HalFunc.check_ips_status(padapter); -+ else -+ RTW_INFO("%s: HalFunc.check_ips_status is NULL!\n", __FUNCTION__); -+ -+ return val; -+} -+ -+s32 rtw_hal_fw_dl(_adapter *padapter, u8 wowlan) -+{ -+ return padapter->HalFunc.fw_dl(padapter, wowlan); -+} -+ -+void rtw_hal_clear_interrupt(_adapter *padapter) -+{ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ if (padapter->HalFunc.clear_interrupt) -+ padapter->HalFunc.clear_interrupt(padapter); -+ else -+ RTW_INFO("%s: HalFunc.clear_interrupt is NULL!\n", __func__); -+#endif -+} -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) -+u32 rtw_hal_inirp_init(_adapter *padapter) -+{ -+ if (is_primary_adapter(padapter)) -+ return padapter->HalFunc.inirp_init(padapter); -+ return _SUCCESS; -+} -+u32 rtw_hal_inirp_deinit(_adapter *padapter) -+{ -+ -+ if (is_primary_adapter(padapter)) -+ return padapter->HalFunc.inirp_deinit(padapter); -+ -+ return _SUCCESS; -+} -+#endif /* #if defined(CONFIG_USB_HCI) || defined (CONFIG_PCI_HCI) */ -+ -+#if defined(CONFIG_PCI_HCI) -+void rtw_hal_irp_reset(_adapter *padapter) -+{ -+ padapter->HalFunc.irp_reset(GET_PRIMARY_ADAPTER(padapter)); -+} -+#endif /* #if defined(CONFIG_PCI_HCI) */ -+ -+/* for USB Auto-suspend */ -+u8 rtw_hal_intf_ps_func(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val) -+{ -+ if (padapter->HalFunc.interface_ps_func) -+ return padapter->HalFunc.interface_ps_func(padapter, efunc_id, val); -+ return _FAIL; -+} -+ -+s32 rtw_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ return padapter->HalFunc.hal_xmitframe_enqueue(padapter, pxmitframe); -+} -+ -+s32 rtw_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ return padapter->HalFunc.hal_xmit(padapter, pxmitframe); -+} -+ -+/* -+ * [IMPORTANT] This function would be run in interrupt context. -+ */ -+s32 rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ s32 ret = _FAIL; -+ u8 *pframe, subtype; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ update_mgntframe_attrib_addr(padapter, pmgntframe); -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ subtype = GetFrameSubType(pframe); /* bit(7)~bit(2) */ -+ -+ /* pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; */ -+ /* _rtw_memcpy(pmgntframe->attrib.ra, pwlanhdr->addr1, ETH_ALEN); */ -+ -+#ifdef CONFIG_IEEE80211W -+ if (padapter->securitypriv.binstallBIPkey == _TRUE && (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || -+ subtype == WIFI_ACTION)) { -+ if (IS_MCAST(pmgntframe->attrib.ra) && pmgntframe->attrib.key_type != IEEE80211W_NO_KEY) { -+ pmgntframe->attrib.encrypt = _BIP_; -+ /* pmgntframe->attrib.bswenc = _TRUE; */ -+ } else if (pmgntframe->attrib.key_type != IEEE80211W_NO_KEY) { -+ psta = rtw_get_stainfo(pstapriv, pmgntframe->attrib.ra); -+ if (psta && psta->bpairwise_key_installed == _TRUE) { -+ pmgntframe->attrib.encrypt = _AES_; -+ pmgntframe->attrib.bswenc = _TRUE; -+ } else { -+ RTW_INFO("%s, %d, bpairwise_key_installed is FALSE\n", __func__, __LINE__); -+ goto no_mgmt_coalesce; -+ } -+ } -+ RTW_INFO("encrypt=%d, bswenc=%d\n", pmgntframe->attrib.encrypt, pmgntframe->attrib.bswenc); -+ rtw_mgmt_xmitframe_coalesce(padapter, pmgntframe->pkt, pmgntframe); -+ } -+#endif /* CONFIG_IEEE80211W */ -+no_mgmt_coalesce: -+ ret = padapter->HalFunc.mgnt_xmit(padapter, pmgntframe); -+ return ret; -+} -+ -+s32 rtw_hal_init_xmit_priv(_adapter *padapter) -+{ -+ return padapter->HalFunc.init_xmit_priv(padapter); -+} -+void rtw_hal_free_xmit_priv(_adapter *padapter) -+{ -+ padapter->HalFunc.free_xmit_priv(padapter); -+} -+ -+s32 rtw_hal_init_recv_priv(_adapter *padapter) -+{ -+ return padapter->HalFunc.init_recv_priv(padapter); -+} -+void rtw_hal_free_recv_priv(_adapter *padapter) -+{ -+ padapter->HalFunc.free_recv_priv(padapter); -+} -+void rtw_update_ramask(_adapter *padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level) -+{ -+ padapter->HalFunc.UpdateRAMaskHandler(padapter, psta, psta->mac_id, rssi_level); -+} -+void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level) -+{ -+ _adapter *padapter; -+ struct mlme_priv *pmlmepriv; -+ -+ if (!psta) -+ return; -+ -+ padapter = psta->padapter; -+ -+ pmlmepriv = &(padapter->mlmepriv); -+#ifdef CONFIG_AP_MODE -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ add_RATid(padapter, psta, rssi_level); -+ else { -+#else -+ { -+#endif -+ psta->raid = rtw_hal_networktype_to_raid(padapter, psta); -+ rtw_update_ramask(padapter, psta, psta->mac_id, rssi_level); -+ } -+} -+ -+/* Start specifical interface thread */ -+void rtw_hal_start_thread(_adapter *padapter) -+{ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifndef CONFIG_SDIO_TX_TASKLET -+ padapter->HalFunc.run_thread(padapter); -+#endif -+#endif -+} -+/* Start specifical interface thread */ -+void rtw_hal_stop_thread(_adapter *padapter) -+{ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifndef CONFIG_SDIO_TX_TASKLET -+ -+ padapter->HalFunc.cancel_thread(padapter); -+ -+#endif -+#endif -+} -+ -+u32 rtw_hal_read_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask) -+{ -+ u32 data = 0; -+ if (padapter->HalFunc.read_bbreg) -+ data = padapter->HalFunc.read_bbreg(padapter, RegAddr, BitMask); -+ return data; -+} -+void rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ if (padapter->HalFunc.write_bbreg) -+ padapter->HalFunc.write_bbreg(padapter, RegAddr, BitMask, Data); -+} -+ -+u32 rtw_hal_read_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask) -+{ -+ u32 data = 0; -+ -+ if (padapter->HalFunc.read_rfreg) { -+ data = padapter->HalFunc.read_rfreg(padapter, eRFPath, RegAddr, BitMask); -+ -+ if (match_rf_read_sniff_ranges(eRFPath, RegAddr, BitMask)) { -+ RTW_INFO("DBG_IO rtw_hal_read_rfreg(%u, 0x%04x, 0x%08x) read:0x%08x(0x%08x)\n" -+ , eRFPath, RegAddr, BitMask, (data << PHY_CalculateBitShift(BitMask)), data); -+ } -+ } -+ -+ return data; -+} -+ -+void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ if (padapter->HalFunc.write_rfreg) { -+ -+ if (match_rf_write_sniff_ranges(eRFPath, RegAddr, BitMask)) { -+ RTW_INFO("DBG_IO rtw_hal_write_rfreg(%u, 0x%04x, 0x%08x) write:0x%08x(0x%08x)\n" -+ , eRFPath, RegAddr, BitMask, (Data << PHY_CalculateBitShift(BitMask)), Data); -+ } -+ -+ padapter->HalFunc.write_rfreg(padapter, eRFPath, RegAddr, BitMask, Data); -+ -+#ifdef CONFIG_PCI_HCI -+ if (!IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(padapter)) /*For N-Series IC, suggest by Jenyu*/ -+ rtw_udelay_os(2); -+#endif -+ } -+} -+ -+#if defined(CONFIG_PCI_HCI) -+s32 rtw_hal_interrupt_handler(_adapter *padapter) -+{ -+ s32 ret = _FAIL; -+ ret = padapter->HalFunc.interrupt_handler(padapter); -+ return ret; -+} -+#endif -+#if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) -+void rtw_hal_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf) -+{ -+ padapter->HalFunc.interrupt_handler(padapter, pkt_len, pbuf); -+} -+#endif -+ -+void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ u8 cch_160 = Bandwidth == CHANNEL_WIDTH_160 ? channel : 0; -+ u8 cch_80 = Bandwidth == CHANNEL_WIDTH_80 ? channel : 0; -+ u8 cch_40 = Bandwidth == CHANNEL_WIDTH_40 ? channel : 0; -+ u8 cch_20 = Bandwidth == CHANNEL_WIDTH_20 ? channel : 0; -+ -+ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ if (pDM_Odm->RFCalibrateInfo.bIQKInProgress == _TRUE) -+ RTW_ERR("%s, %d, IQK may race condition\n", __func__, __LINE__); -+ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ -+ /* MP mode channel don't use secondary channel */ -+ if (rtw_mi_mp_mode_check(padapter) == _FALSE) { -+ #if 0 -+ if (cch_160 != 0) -+ cch_80 = rtw_get_scch_by_cch_offset(cch_160, CHANNEL_WIDTH_160, Offset80); -+ #endif -+ if (cch_80 != 0) -+ cch_40 = rtw_get_scch_by_cch_offset(cch_80, CHANNEL_WIDTH_80, Offset80); -+ if (cch_40 != 0) -+ cch_20 = rtw_get_scch_by_cch_offset(cch_40, CHANNEL_WIDTH_40, Offset40); -+ } -+ -+ pHalData->cch_80 = cch_80; -+ pHalData->cch_40 = cch_40; -+ pHalData->cch_20 = cch_20; -+ -+ if (0) -+ RTW_INFO("%s cch:%u, %s, offset40:%u, offset80:%u (%u, %u, %u)\n", __func__ -+ , channel, ch_width_str(Bandwidth), Offset40, Offset80 -+ , pHalData->cch_80, pHalData->cch_40, pHalData->cch_20); -+ -+ padapter->HalFunc.set_chnl_bw_handler(padapter, channel, Bandwidth, Offset40, Offset80); -+} -+ -+void rtw_hal_set_tx_power_level(_adapter *padapter, u8 channel) -+{ -+ if (padapter->HalFunc.set_tx_power_level_handler) -+ padapter->HalFunc.set_tx_power_level_handler(padapter, channel); -+} -+ -+void rtw_hal_get_tx_power_level(_adapter *padapter, s32 *powerlevel) -+{ -+ if (padapter->HalFunc.get_tx_power_level_handler) -+ padapter->HalFunc.get_tx_power_level_handler(padapter, powerlevel); -+} -+ -+void rtw_hal_dm_watchdog(_adapter *padapter) -+{ -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) { -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) -+ return; -+ } -+#endif /* CONFIG_MCC_MODE */ -+ -+ padapter->HalFunc.hal_dm_watchdog(padapter); -+ -+} -+ -+#ifdef CONFIG_LPS_LCLK_WD_TIMER -+void rtw_hal_dm_watchdog_in_lps(_adapter *padapter) -+{ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (padapter->hw_port != HW_PORT0) -+ return; -+#endif -+ -+ if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) { -+ padapter->HalFunc.hal_dm_watchdog_in_lps(padapter);/* this fuction caller is in interrupt context */ -+ } -+} -+#endif -+ -+void rtw_hal_bcn_related_reg_setting(_adapter *padapter) -+{ -+ padapter->HalFunc.SetBeaconRelatedRegistersHandler(padapter); -+} -+ -+#ifdef CONFIG_HOSTAPD_MLME -+s32 rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt) -+{ -+ if (padapter->HalFunc.hostap_mgnt_xmit_entry) -+ return padapter->HalFunc.hostap_mgnt_xmit_entry(padapter, pkt); -+ return _FAIL; -+} -+#endif /* CONFIG_HOSTAPD_MLME */ -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+void rtw_hal_sreset_init(_adapter *padapter) -+{ -+ padapter->HalFunc.sreset_init_value(padapter); -+} -+void rtw_hal_sreset_reset(_adapter *padapter) -+{ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ padapter->HalFunc.silentreset(padapter); -+} -+ -+void rtw_hal_sreset_reset_value(_adapter *padapter) -+{ -+ padapter->HalFunc.sreset_reset_value(padapter); -+} -+ -+void rtw_hal_sreset_xmit_status_check(_adapter *padapter) -+{ -+ padapter->HalFunc.sreset_xmit_status_check(padapter); -+} -+void rtw_hal_sreset_linked_status_check(_adapter *padapter) -+{ -+ padapter->HalFunc.sreset_linked_status_check(padapter); -+} -+u8 rtw_hal_sreset_get_wifi_status(_adapter *padapter) -+{ -+ return padapter->HalFunc.sreset_get_wifi_status(padapter); -+} -+ -+bool rtw_hal_sreset_inprogress(_adapter *padapter) -+{ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ return padapter->HalFunc.sreset_inprogress(padapter); -+} -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ -+#ifdef CONFIG_IOL -+int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt) -+{ -+ if (adapter->HalFunc.IOL_exec_cmds_sync) -+ return adapter->HalFunc.IOL_exec_cmds_sync(adapter, xmit_frame, max_wating_ms, bndy_cnt); -+ return _FAIL; -+} -+#endif -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+s32 rtw_hal_xmit_thread_handler(_adapter *padapter) -+{ -+ return padapter->HalFunc.xmit_thread_handler(padapter); -+} -+#endif -+ -+void rtw_hal_notch_filter(_adapter *adapter, bool enable) -+{ -+ if (adapter->HalFunc.hal_notch_filter) -+ adapter->HalFunc.hal_notch_filter(adapter, enable); -+} -+ -+#ifdef CONFIG_FW_C2H_REG -+inline bool rtw_hal_c2h_valid(_adapter *adapter, u8 *buf) -+{ -+ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); -+ HAL_VERSION *hal_ver = &HalData->VersionID; -+ bool ret = _FAIL; -+ -+ ret = C2H_ID_88XX(buf) || C2H_PLEN_88XX(buf); -+ -+ return ret; -+} -+ -+inline s32 rtw_hal_c2h_evt_read(_adapter *adapter, u8 *buf) -+{ -+ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); -+ HAL_VERSION *hal_ver = &HalData->VersionID; -+ s32 ret = _FAIL; -+ -+ ret = c2h_evt_read_88xx(adapter, buf); -+ -+ return ret; -+} -+ -+bool rtw_hal_c2h_reg_hdr_parse(_adapter *adapter, u8 *buf, u8 *id, u8 *seq, u8 *plen, u8 **payload) -+{ -+ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); -+ HAL_VERSION *hal_ver = &HalData->VersionID; -+ bool ret = _FAIL; -+ -+ *id = C2H_ID_88XX(buf); -+ *seq = C2H_SEQ_88XX(buf); -+ *plen = C2H_PLEN_88XX(buf); -+ *payload = C2H_PAYLOAD_88XX(buf); -+ ret = _SUCCESS; -+ -+ return ret; -+} -+#endif /* CONFIG_FW_C2H_REG */ -+ -+#ifdef CONFIG_FW_C2H_PKT -+bool rtw_hal_c2h_pkt_hdr_parse(_adapter *adapter, u8 *buf, u16 len, u8 *id, u8 *seq, u8 *plen, u8 **payload) -+{ -+ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); -+ HAL_VERSION *hal_ver = &HalData->VersionID; -+ bool ret = _FAIL; -+ -+ if (!buf || len > 256 || len < 3) -+ goto exit; -+ -+ *id = C2H_ID_88XX(buf); -+ *seq = C2H_SEQ_88XX(buf); -+ *plen = len - 2; -+ *payload = C2H_PAYLOAD_88XX(buf); -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_FW_C2H_PKT */ -+ -+#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTL8723B) -+#include /* for MPTBT_FwC2hBtMpCtrl */ -+#endif -+s32 c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) -+{ -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ DM_ODM_T *odm = &hal_data->odmpriv; -+ u8 sub_id = 0; -+ s32 ret = _SUCCESS; -+ -+ switch (id) { -+ case C2H_DBG: -+ RTW_INFO_DUMP("C2H_DBG: ", payload, plen); -+ break; -+ case C2H_FW_SCAN_COMPLETE: -+ RTW_INFO("[C2H], FW Scan Complete\n"); -+ break; -+ -+#ifdef CONFIG_BT_COEXIST -+ case C2H_BT_INFO: -+ rtw_btcoex_BtInfoNotify(adapter, plen, payload); -+ break; -+ case C2H_BT_MP_INFO: -+ #if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTL8723B) -+ MPTBT_FwC2hBtMpCtrl(adapter, payload, plen); -+ #endif -+ rtw_btcoex_BtMpRptNotify(adapter, plen, payload); -+ break; -+ case C2H_MAILBOX_STATUS: -+ RTW_INFO_DUMP("C2H_MAILBOX_STATUS: ", payload, plen); -+ break; -+#endif /* CONFIG_BT_COEXIST */ -+ -+ case C2H_IQK_FINISH: -+ c2h_iqk_offload(adapter, payload, plen); -+ break; -+ -+#if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) -+ case C2H_FW_CHNL_SWITCH_COMPLETE: -+ rtw_tdls_chsw_oper_done(adapter); -+ break; -+ case C2H_BCN_EARLY_RPT: -+ rtw_tdls_ch_sw_back_to_base_chnl(adapter); -+ break; -+#endif -+ -+#ifdef CONFIG_MCC_MODE -+ case C2H_MCC: -+ rtw_hal_mcc_c2h_handler(adapter, plen, payload); -+ break; -+#endif -+ -+#ifdef CONFIG_RTW_MAC_HIDDEN_RPT -+ case C2H_MAC_HIDDEN_RPT: -+ c2h_mac_hidden_rpt_hdl(adapter, payload, plen); -+ break; -+ case C2H_MAC_HIDDEN_RPT_2: -+ c2h_mac_hidden_rpt_2_hdl(adapter, payload, plen); -+ break; -+#endif -+ -+ case C2H_DEFEATURE_DBG: -+ c2h_defeature_dbg_hdl(adapter, payload, plen); -+ break; -+ -+#ifdef CONFIG_RTW_CUSTOMER_STR -+ case C2H_CUSTOMER_STR_RPT: -+ c2h_customer_str_rpt_hdl(adapter, payload, plen); -+ break; -+ case C2H_CUSTOMER_STR_RPT_2: -+ c2h_customer_str_rpt_2_hdl(adapter, payload, plen); -+ break; -+#endif -+ -+ case C2H_EXTEND: -+ sub_id = payload[0]; -+ /* no handle, goto default */ -+ -+ default: -+ if (phydm_c2H_content_parsing(odm, id, plen, payload) != TRUE) -+ ret = _FAIL; -+ break; -+ } -+ -+exit: -+ if (ret != _SUCCESS) { -+ if (id == C2H_EXTEND) -+ RTW_WARN("%s: unknown C2H(0x%02x, 0x%02x)\n", __func__, id, sub_id); -+ else -+ RTW_WARN("%s: unknown C2H(0x%02x)\n", __func__, id); -+ } -+ -+ return ret; -+} -+ -+#ifndef RTW_HALMAC -+s32 rtw_hal_c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) -+{ -+ s32 ret = _FAIL; -+ -+ ret = adapter->HalFunc.c2h_handler(adapter, id, seq, plen, payload); -+ if (ret != _SUCCESS) -+ ret = c2h_handler(adapter, id, seq, plen, payload); -+ -+ return ret; -+} -+ -+s32 rtw_hal_c2h_id_handle_directly(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) -+{ -+ switch (id) { -+ case C2H_CCX_TX_RPT: -+ case C2H_BT_MP_INFO: -+ case C2H_FW_CHNL_SWITCH_COMPLETE: -+ case C2H_IQK_FINISH: -+ case C2H_MCC: -+ case C2H_BCN_EARLY_RPT: -+ return _TRUE; -+ default: -+ return _FALSE; -+ } -+} -+#endif /* !RTW_HALMAC */ -+ -+s32 rtw_hal_is_disable_sw_channel_plan(PADAPTER padapter) -+{ -+ return GET_HAL_DATA(padapter)->bDisableSWChannelPlan; -+} -+ -+s32 rtw_hal_macid_sleep(PADAPTER padapter, u8 macid) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u8 support; -+ -+ support = _FALSE; -+ rtw_hal_get_def_var(padapter, HAL_DEF_MACID_SLEEP, &support); -+ if (_FALSE == support) -+ return _FAIL; -+ -+ if (macid >= macid_ctl->num) { -+ RTW_ERR(FUNC_ADPT_FMT": Invalid macid(%u)\n", -+ FUNC_ADPT_ARG(padapter), macid); -+ return _FAIL; -+ } -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MACID_SLEEP, &macid); -+ -+ return _SUCCESS; -+} -+ -+s32 rtw_hal_macid_wakeup(PADAPTER padapter, u8 macid) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u8 support; -+ -+ support = _FALSE; -+ rtw_hal_get_def_var(padapter, HAL_DEF_MACID_SLEEP, &support); -+ if (_FALSE == support) -+ return _FAIL; -+ -+ if (macid >= macid_ctl->num) { -+ RTW_ERR(FUNC_ADPT_FMT": Invalid macid(%u)\n", -+ FUNC_ADPT_ARG(padapter), macid); -+ return _FAIL; -+ } -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MACID_WAKEUP, &macid); -+ -+ return _SUCCESS; -+} -+ -+s32 rtw_hal_fill_h2c_cmd(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) -+{ -+ _adapter *pri_adapter = GET_PRIMARY_ADAPTER(padapter); -+ -+ if (pri_adapter->bFWReady == _TRUE) -+ return padapter->HalFunc.fill_h2c_cmd(padapter, ElementID, CmdLen, pCmdBuffer); -+ else if (padapter->registrypriv.mp_mode == 0) -+ RTW_PRINT(FUNC_ADPT_FMT" FW doesn't exit when no MP mode, by pass H2C id:0x%02x\n" -+ , FUNC_ADPT_ARG(padapter), ElementID); -+ return _FAIL; -+} -+ -+void rtw_hal_fill_fake_txdesc(_adapter *padapter, u8 *pDesc, u32 BufferLen, -+ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame) -+{ -+ padapter->HalFunc.fill_fake_txdesc(padapter, pDesc, BufferLen, IsPsPoll, IsBTQosNull, bDataFrame); -+ -+} -+u8 rtw_hal_get_txbuff_rsvd_page_num(_adapter *adapter, bool wowlan) -+{ -+ return adapter->HalFunc.hal_get_tx_buff_rsvd_page_num(adapter, wowlan); -+} -+ -+#ifdef CONFIG_GPIO_API -+void rtw_hal_update_hisr_hsisr_ind(_adapter *padapter, u32 flag) -+{ -+ if (padapter->HalFunc.update_hisr_hsisr_ind) -+ padapter->HalFunc.update_hisr_hsisr_ind(padapter, flag); -+} -+ -+int rtw_hal_gpio_func_check(_adapter *padapter, u8 gpio_num) -+{ -+ int ret = _SUCCESS; -+ -+ if (padapter->HalFunc.hal_gpio_func_check) -+ ret = padapter->HalFunc.hal_gpio_func_check(padapter, gpio_num); -+ -+ return ret; -+} -+ -+void rtw_hal_gpio_multi_func_reset(_adapter *padapter, u8 gpio_num) -+{ -+ if (padapter->HalFunc.hal_gpio_multi_func_reset) -+ padapter->HalFunc.hal_gpio_multi_func_reset(padapter, gpio_num); -+} -+#endif -+ -+void rtw_hal_fw_correct_bcn(_adapter *padapter) -+{ -+ if (padapter->HalFunc.fw_correct_bcn) -+ padapter->HalFunc.fw_correct_bcn(padapter); -+} -+ -+void rtw_hal_set_tx_power_index(PADAPTER padapter, u32 powerindex, u8 rfpath, u8 rate) -+{ -+ return padapter->HalFunc.set_tx_power_index_handler(padapter, powerindex, rfpath, rate); -+} -+ -+u8 rtw_hal_get_tx_power_index(PADAPTER padapter, u8 rfpath, u8 rate, u8 bandwidth, u8 channel, struct txpwr_idx_comp *tic) -+{ -+ return padapter->HalFunc.get_tx_power_index_handler(padapter, rfpath, rate, bandwidth, channel, tic); -+} -+ -+#ifdef RTW_HALMAC -+/* -+ * Description: -+ * Initialize MAC registers -+ * -+ * Return: -+ * _TRUE success -+ * _FALSE fail -+ */ -+u8 rtw_hal_init_mac_register(PADAPTER adapter) -+{ -+ return adapter->HalFunc.init_mac_register(adapter); -+} -+ -+/* -+ * Description: -+ * Initialize PHY(BB/RF) related functions -+ * -+ * Return: -+ * _TRUE success -+ * _FALSE fail -+ */ -+u8 rtw_hal_init_phy(PADAPTER adapter) -+{ -+ return adapter->HalFunc.init_phy(adapter); -+} -+#endif /* RTW_HALMAC */ -+ -+#define rtw_hal_error_msg(ops_fun) \ -+ RTW_PRINT("### %s - Error : Please hook HalFunc.%s ###\n", __FUNCTION__, ops_fun) -+ -+u8 rtw_hal_ops_check(_adapter *padapter) -+{ -+ u8 ret = _SUCCESS; -+#if 1 -+ /*** initialize section ***/ -+ if (NULL == padapter->HalFunc.read_chip_version) { -+ rtw_hal_error_msg("read_chip_version"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.init_default_value) { -+ rtw_hal_error_msg("init_default_value"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.intf_chip_configure) { -+ rtw_hal_error_msg("intf_chip_configure"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.read_adapter_info) { -+ rtw_hal_error_msg("read_adapter_info"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.hal_power_on) { -+ rtw_hal_error_msg("hal_power_on"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.hal_power_off) { -+ rtw_hal_error_msg("hal_power_off"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.hal_init) { -+ rtw_hal_error_msg("hal_init"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.hal_deinit) { -+ rtw_hal_error_msg("hal_deinit"); -+ ret = _FAIL; -+ } -+ -+ /*** xmit section ***/ -+ if (NULL == padapter->HalFunc.init_xmit_priv) { -+ rtw_hal_error_msg("init_xmit_priv"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.free_xmit_priv) { -+ rtw_hal_error_msg("free_xmit_priv"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.hal_xmit) { -+ rtw_hal_error_msg("hal_xmit"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.mgnt_xmit) { -+ rtw_hal_error_msg("mgnt_xmit"); -+ ret = _FAIL; -+ } -+#ifdef CONFIG_XMIT_THREAD_MODE -+ if (NULL == padapter->HalFunc.xmit_thread_handler) { -+ rtw_hal_error_msg("xmit_thread_handler"); -+ ret = _FAIL; -+ } -+#endif -+ if (NULL == padapter->HalFunc.hal_xmitframe_enqueue) { -+ rtw_hal_error_msg("hal_xmitframe_enqueue"); -+ ret = _FAIL; -+ } -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifndef CONFIG_SDIO_TX_TASKLET -+ if (NULL == padapter->HalFunc.run_thread) { -+ rtw_hal_error_msg("run_thread"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.cancel_thread) { -+ rtw_hal_error_msg("cancel_thread"); -+ ret = _FAIL; -+ } -+#endif -+#endif -+ -+ /*** recv section ***/ -+ if (NULL == padapter->HalFunc.init_recv_priv) { -+ rtw_hal_error_msg("init_recv_priv"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.free_recv_priv) { -+ rtw_hal_error_msg("free_recv_priv"); -+ ret = _FAIL; -+ } -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) -+ if (NULL == padapter->HalFunc.inirp_init) { -+ rtw_hal_error_msg("inirp_init"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.inirp_deinit) { -+ rtw_hal_error_msg("inirp_deinit"); -+ ret = _FAIL; -+ } -+#endif /* #if defined(CONFIG_USB_HCI) || defined (CONFIG_PCI_HCI) */ -+ -+ -+ /*** interrupt hdl section ***/ -+#if defined(CONFIG_PCI_HCI) -+ if (NULL == padapter->HalFunc.irp_reset) { -+ rtw_hal_error_msg("irp_reset"); -+ ret = _FAIL; -+ } -+#endif/*#if defined(CONFIG_PCI_HCI)*/ -+#if (defined(CONFIG_PCI_HCI)) || (defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT)) -+ if (NULL == padapter->HalFunc.interrupt_handler) { -+ rtw_hal_error_msg("interrupt_handler"); -+ ret = _FAIL; -+ } -+#endif /*#if (defined(CONFIG_PCI_HCI)) || (defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT))*/ -+ -+#if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) -+ if (NULL == padapter->HalFunc.enable_interrupt) { -+ rtw_hal_error_msg("enable_interrupt"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.disable_interrupt) { -+ rtw_hal_error_msg("disable_interrupt"); -+ ret = _FAIL; -+ } -+#endif /* defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) */ -+ -+ -+ /*** DM section ***/ -+ if (NULL == padapter->HalFunc.dm_init) { -+ rtw_hal_error_msg("dm_init"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.dm_deinit) { -+ rtw_hal_error_msg("dm_deinit"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.hal_dm_watchdog) { -+ rtw_hal_error_msg("hal_dm_watchdog"); -+ ret = _FAIL; -+ } -+#ifdef CONFIG_LPS_LCLK_WD_TIMER -+ if (NULL == padapter->HalFunc.hal_dm_watchdog_in_lps) { -+ rtw_hal_error_msg("hal_dm_watchdog_in_lps"); -+ ret = _FAIL; -+ } -+#endif -+ -+ /*** xxx section ***/ -+ if (NULL == padapter->HalFunc.set_chnl_bw_handler) { -+ rtw_hal_error_msg("set_chnl_bw_handler"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.SetHwRegHandler) { -+ rtw_hal_error_msg("SetHwRegHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.GetHwRegHandler) { -+ rtw_hal_error_msg("GetHwRegHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.GetHalDefVarHandler) { -+ rtw_hal_error_msg("GetHalDefVarHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.SetHalDefVarHandler) { -+ rtw_hal_error_msg("SetHalDefVarHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.GetHalODMVarHandler) { -+ rtw_hal_error_msg("GetHalODMVarHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.SetHalODMVarHandler) { -+ rtw_hal_error_msg("SetHalODMVarHandler"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.UpdateRAMaskHandler) { -+ rtw_hal_error_msg("UpdateRAMaskHandler"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.SetBeaconRelatedRegistersHandler) { -+ rtw_hal_error_msg("SetBeaconRelatedRegistersHandler"); -+ ret = _FAIL; -+ } -+ -+ if (NULL == padapter->HalFunc.fill_h2c_cmd) { -+ rtw_hal_error_msg("fill_h2c_cmd"); -+ ret = _FAIL; -+ } -+ -+#ifdef RTW_HALMAC -+ if (NULL == padapter->HalFunc.hal_mac_c2h_handler) { -+ rtw_hal_error_msg("hal_mac_c2h_handler"); -+ ret = _FAIL; -+ } -+#elif !defined(CONFIG_RTL8188E) -+ if (NULL == padapter->HalFunc.c2h_handler) { -+ rtw_hal_error_msg("c2h_handler"); -+ ret = _FAIL; -+ } -+#endif -+ -+#if defined(CONFIG_LPS) || defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ if (NULL == padapter->HalFunc.fill_fake_txdesc) { -+ rtw_hal_error_msg("fill_fake_txdesc"); -+ ret = _FAIL; -+ } -+#endif -+ if (NULL == padapter->HalFunc.hal_get_tx_buff_rsvd_page_num) { -+ rtw_hal_error_msg("hal_get_tx_buff_rsvd_page_num"); -+ ret = _FAIL; -+ } -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ if (NULL == padapter->HalFunc.clear_interrupt) { -+ rtw_hal_error_msg("clear_interrupt"); -+ ret = _FAIL; -+ } -+#endif -+#endif /* CONFIG_WOWLAN */ -+ -+ if (NULL == padapter->HalFunc.fw_dl) { -+ rtw_hal_error_msg("fw_dl"); -+ ret = _FAIL; -+ } -+ -+ if ((IS_HARDWARE_TYPE_8814A(padapter) -+ || IS_HARDWARE_TYPE_8822BU(padapter) || IS_HARDWARE_TYPE_8822BS(padapter)) -+ && NULL == padapter->HalFunc.fw_correct_bcn) { -+ rtw_hal_error_msg("fw_correct_bcn"); -+ ret = _FAIL; -+ } -+ -+ if (IS_HARDWARE_TYPE_8822B(padapter) || IS_HARDWARE_TYPE_8821C(padapter)) { -+ if (!padapter->HalFunc.set_tx_power_index_handler) { -+ rtw_hal_error_msg("set_tx_power_index_handler"); -+ ret = _FAIL; -+ } -+ } -+ -+ if (!padapter->HalFunc.get_tx_power_index_handler) { -+ rtw_hal_error_msg("get_tx_power_index_handler"); -+ ret = _FAIL; -+ } -+ -+ /*** SReset section ***/ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ if (NULL == padapter->HalFunc.sreset_init_value) { -+ rtw_hal_error_msg("sreset_init_value"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.sreset_reset_value) { -+ rtw_hal_error_msg("sreset_reset_value"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.silentreset) { -+ rtw_hal_error_msg("silentreset"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.sreset_xmit_status_check) { -+ rtw_hal_error_msg("sreset_xmit_status_check"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.sreset_linked_status_check) { -+ rtw_hal_error_msg("sreset_linked_status_check"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.sreset_get_wifi_status) { -+ rtw_hal_error_msg("sreset_get_wifi_status"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.sreset_inprogress) { -+ rtw_hal_error_msg("sreset_inprogress"); -+ ret = _FAIL; -+ } -+#endif /* #ifdef DBG_CONFIG_ERROR_DETECT */ -+ -+#ifdef RTW_HALMAC -+ if (NULL == padapter->HalFunc.init_mac_register) { -+ rtw_hal_error_msg("init_mac_register"); -+ ret = _FAIL; -+ } -+ if (NULL == padapter->HalFunc.init_phy) { -+ rtw_hal_error_msg("init_phy"); -+ ret = _FAIL; -+ } -+#endif /* RTW_HALMAC */ -+#endif -+ return ret; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_mcc.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_mcc.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_mcc.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_mcc.c 2018-02-11 21:44:27.152146162 +0200 -@@ -0,0 +1,1490 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ ******************************************************************************/ -+#ifdef CONFIG_MCC_MODE -+#define _HAL_MCC_C_ -+ -+#include /* PADAPTER */ -+#include /* mcc structure */ -+#include /* HAL_DATA */ -+#include /* power control */ -+ -+/* backup IQK value */ -+void rtw_hal_mcc_backup_IQK_val(PADAPTER padapter) -+{ -+ u8 take_care_iqk = _FALSE; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk); -+ if (take_care_iqk == _TRUE && MCC_EN(padapter)) -+ rtw_hal_ch_sw_iqk_info_restore(padapter, CH_SW_USE_CASE_MCC); -+} -+ -+u8 rtw_hal_check_mcc_status(PADAPTER padapter, u8 mcc_status) -+{ -+ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ -+ if (pmccobjpriv->mcc_status & (mcc_status)) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+void rtw_hal_set_mcc_status(PADAPTER padapter, u8 mcc_status) -+{ -+ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ -+ pmccobjpriv->mcc_status |= (mcc_status); -+} -+ -+void rtw_hal_clear_mcc_status(PADAPTER padapter, u8 mcc_status) -+{ -+ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ -+ pmccobjpriv->mcc_status &= (~mcc_status); -+} -+ -+static void rtw_hal_config_mcc_role_setting(PADAPTER padapter) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(pdvobjpriv->mcc_objpriv); -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ struct registry_priv *preg = &padapter->registrypriv; -+ -+ /* GO/AP is 1nd order GC/STA is 2nd order */ -+ switch (pmccadapriv->role) { -+ case MCC_ROLE_STA: -+ case MCC_ROLE_GC: -+ pmccadapriv->order = 1; -+ pmccadapriv->mcc_duration = pmccobjpriv->duration; -+ -+ switch (pmlmeext->cur_bwmode) { -+ case CHANNEL_WIDTH_20: -+ /* -+ * target tx byte(bytes) = target tx tp(Mbits/sec) * 1024 * 1024 / 8 * (duration(ms) / 1024) -+ * = target tx tp(Mbits/sec) * 128 * duration(ms) -+ * note: -+ * target tx tp(Mbits/sec) * 1024 * 1024 / 8 ==> Mbits to bytes -+ * duration(ms) / 1024 ==> msec to sec -+ */ -+ pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_sta_bw20_target_tx_tp * 128 * pmccadapriv->mcc_duration; -+ break; -+ case CHANNEL_WIDTH_40: -+ pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_sta_bw40_target_tx_tp * 128 * pmccadapriv->mcc_duration; -+ break; -+ case CHANNEL_WIDTH_80: -+ pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_sta_bw80_target_tx_tp * 128 * pmccadapriv->mcc_duration; -+ break; -+ case CHANNEL_WIDTH_160: -+ case CHANNEL_WIDTH_80_80: -+ RTW_INFO(FUNC_ADPT_FMT": not support bwmode = %d\n" -+ , FUNC_ADPT_ARG(padapter), pmlmeext->cur_bwmode); -+ break; -+ } -+ -+ /* assign used mac to avoid affecting RA */ -+ pmccadapriv->mgmt_queue_macid = MCC_ROLE_STA_GC_MGMT_QUEUE_MACID; -+ -+ psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); -+ if (psta) { -+ /* combine AP/GO macid and mgmt queue macid to bitmap */ -+ pmccadapriv->mcc_macid_bitmap = BIT(psta->mac_id) | BIT(pmccadapriv->mgmt_queue_macid); -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT":AP/GO station info is NULL\n", FUNC_ADPT_ARG(padapter)); -+ rtw_warn_on(1); -+ } -+ break; -+ case MCC_ROLE_AP: -+ case MCC_ROLE_GO: -+ pmccadapriv->order = 0; -+ pmccadapriv->mcc_duration = 100 - pmccobjpriv->duration; /* 100 means beacon interval */ -+ -+ switch (pmlmeext->cur_bwmode) { -+ case CHANNEL_WIDTH_20: -+ pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_ap_bw20_target_tx_tp * 128 * pmccadapriv->mcc_duration; -+ break; -+ case CHANNEL_WIDTH_40: -+ pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_ap_bw40_target_tx_tp * 128 * pmccadapriv->mcc_duration; -+ break; -+ case CHANNEL_WIDTH_80: -+ pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_ap_bw80_target_tx_tp * 128 * pmccadapriv->mcc_duration; -+ break; -+ case CHANNEL_WIDTH_160: -+ case CHANNEL_WIDTH_80_80: -+ RTW_INFO(FUNC_ADPT_FMT": not support bwmode = %d\n" -+ , FUNC_ADPT_ARG(padapter), pmlmeext->cur_bwmode); -+ break; -+ } -+ -+ -+ psta = rtw_get_bcmc_stainfo(padapter); -+ -+ if (psta != NULL) -+ pmccadapriv->mgmt_queue_macid = psta->mac_id; -+ else { -+ pmccadapriv->mgmt_queue_macid = MCC_ROLE_SOFTAP_GO_MGMT_QUEUE_MACID; -+ RTW_INFO(FUNC_ADPT_FMT":bcmc station is NULL, use macid %d\n" -+ , FUNC_ADPT_ARG(padapter), pmccadapriv->mgmt_queue_macid); -+ } -+ -+ /* combine client macid and mgmt queue macid to bitmap */ -+ pmccadapriv->mcc_macid_bitmap = (0xff << 8) | BIT(pmccadapriv->mgmt_queue_macid); -+ break; -+ default: -+ RTW_INFO("Unknown role\n"); -+ rtw_warn_on(1); -+ break; -+ } -+ -+ pmccobjpriv->iface[pmccadapriv->order] = padapter; -+ RTW_INFO(FUNC_ADPT_FMT": order:%d, role:%d, mcc duration:%d, target tx bytes:%d, mgmt queue macid:%d, bitmap:0x%02x\n" -+ , FUNC_ADPT_ARG(padapter), pmccadapriv->order, pmccadapriv->role, pmccadapriv->mcc_duration -+ , pmccadapriv->mcc_target_tx_bytes_to_port, pmccadapriv->mgmt_queue_macid, pmccadapriv->mcc_macid_bitmap); -+} -+ -+static void rtw_hal_clear_mcc_macid(PADAPTER padapter) -+{ -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ -+ switch (pmccadapriv->role) { -+ case MCC_ROLE_STA: -+ case MCC_ROLE_GC: -+ /* release mgmt queue macid */ -+ rtw_hal_set_FwMediaStatusRpt_single_cmd(padapter -+ , 0, 0, 0, H2C_MSR_ROLE_AP, pmccadapriv->mgmt_queue_macid); -+ break; -+ case MCC_ROLE_AP: -+ case MCC_ROLE_GO: -+ /* nothing to do */ -+ break; -+ default: -+ RTW_INFO("Unknown role\n"); -+ rtw_warn_on(1); -+ break; -+ } -+} -+static u8 rtw_hal_decide_mcc_role(PADAPTER padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface = NULL; -+ struct mcc_adapter_priv *pmccadapriv = NULL; -+ struct wifidirect_info *pwdinfo = NULL; -+ struct mlme_priv *pmlmepriv = NULL; -+ u8 ret = _SUCCESS, i = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ pmccadapriv = &iface->mcc_adapterpriv; -+ -+ if (MLME_IS_GO(iface)) -+ pmccadapriv->role = MCC_ROLE_GO; -+ else if (MLME_IS_AP(iface)) -+ pmccadapriv->role = MCC_ROLE_AP; -+ else if (MLME_IS_GC(iface)) -+ pmccadapriv->role = MCC_ROLE_GC; -+ else if (MLME_IS_STA(iface)) -+ pmccadapriv->role = MCC_ROLE_STA; -+ else { -+ pwdinfo = &iface->wdinfo; -+ pmlmepriv = &iface->mlmepriv; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(iface)); -+ RTW_INFO("Unknown:P2P state:%d, mlme state:0x%2x, mlmext info state:0x%02x\n", -+ pwdinfo->role, pmlmepriv->fw_state, iface->mlmeextpriv.mlmext_info.state); -+ rtw_warn_on(1); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if (ret == _SUCCESS) -+ rtw_hal_config_mcc_role_setting(iface); -+ } -+ -+exit: -+ return ret; -+} -+ -+static void rtw_hal_init_mcc_parameter(PADAPTER padapter) -+{ -+} -+ -+static void rtw_hal_construct_CTS(PADAPTER padapter, u8 *pframe, u32 *pLength) -+{ -+ u8 broadcast_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ /* frame type, length = 1*/ -+ SetFrameSubType(pframe, WIFI_RTS); -+ -+ /* frame control flag, length = 1 */ -+ *(pframe + 1) = 0; -+ -+ /* frame duration, length = 2 */ -+ *(pframe + 2) = 0x00; -+ *(pframe + 3) = 0x78; -+ -+ /* frame recvaddr, length = 6 */ -+ _rtw_memcpy((pframe + 4), broadcast_addr, ETH_ALEN); -+ _rtw_memcpy((pframe + 4 + ETH_ALEN), adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy((pframe + 4 + ETH_ALEN * 2), adapter_mac_addr(padapter), ETH_ALEN); -+ *pLength = 22; -+} -+ -+u8 rtw_hal_dl_mcc_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 *index, -+ u8 tx_desc, u32 page_size, u8 *page_num, u32 *total_pkt_len, -+ RSVDPAGE_LOC *rsvd_page_loc) -+{ -+ u32 len = 0; -+ _adapter *iface = NULL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); -+ struct mlme_ext_info *pmlmeinfo = NULL; -+ struct mlme_ext_priv *pmlmeext = NULL; -+ u8 ret = _SUCCESS, i = 0, order = 0, CurtPktPageNum = 0; -+ u8 bssid[ETH_ALEN] = {0}; -+ -+ /* check proccess mcc start setting */ -+ if (!rtw_hal_check_mcc_status(adapter, MCC_STATUS_PROCESS_MCC_START_SETTING)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ order = iface->mcc_adapterpriv.order; -+ dvobj->mcc_objpriv.mcc_loc_rsvd_paga[order] = *page_num; -+ -+ switch (iface->mcc_adapterpriv.role) { -+ case MCC_ROLE_STA: -+ case MCC_ROLE_GC: -+ /* Build NULL DATA */ -+ RTW_INFO("LocNull(order:%d): %d\n" -+ , order, dvobj->mcc_objpriv.mcc_loc_rsvd_paga[order]); -+ len = 0; -+ pmlmeext = &iface->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ _rtw_memcpy(bssid, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ rtw_hal_construct_NullFunctionData(iface -+ , &pframe[*index], &len, bssid, _FALSE, 0, 0, _FALSE); -+ rtw_hal_fill_fake_txdesc(iface, &pframe[*index - tx_desc], -+ len, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + len, page_size); -+ *page_num += CurtPktPageNum; -+ *index += (CurtPktPageNum * page_size); -+ *total_pkt_len = *index + len; -+ break; -+ case MCC_ROLE_AP: -+ /* Bulid CTS */ -+ RTW_INFO("LocCTS(order:%d): %d\n" -+ , order, dvobj->mcc_objpriv.mcc_loc_rsvd_paga[order]); -+ -+ len = 0; -+ rtw_hal_construct_CTS(iface, &pframe[*index], &len); -+ rtw_hal_fill_fake_txdesc(iface, &pframe[*index - tx_desc], -+ len, _FALSE, _FALSE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum(tx_desc + len, page_size); -+ *page_num += CurtPktPageNum; -+ *index += (CurtPktPageNum * page_size); -+ *total_pkt_len = *index + len; -+ break; -+ case MCC_ROLE_GO: -+ /* To DO */ -+ break; -+ } -+ } -+exit: -+ return ret; -+} -+ -+/* -+* 1. Download MCC rsvd page -+* 2. Re-Download beacon after download rsvd page -+*/ -+static void rtw_hal_set_fw_mcc_rsvd_page(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ PADAPTER port0_iface = dvobj_get_port0_adapter(dvobj); -+ PADAPTER iface = NULL; -+ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); -+ u8 mstatus = RT_MEDIA_CONNECT, i = 0; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ rtw_hal_set_hwreg(port0_iface, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); -+ -+ /* Re-Download beacon */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = pmccobjpriv->iface[i]; -+ pmccadapriv = &iface->mcc_adapterpriv; -+ if (pmccadapriv->role == MCC_ROLE_AP -+ || pmccadapriv->role == MCC_ROLE_GO) -+ tx_beacon_hdl(iface, NULL); -+ } -+} -+ -+static void rtw_hal_set_mcc_rsvdpage_cmd(_adapter *padapter) -+{ -+ u8 cmd[H2C_MCC_LOCATION_LEN] = {0}, i = 0, order = 0; -+ _adapter *iface = NULL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); -+ -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ order = iface->mcc_adapterpriv.order; -+ if (order >= H2C_MCC_LOCATION_LEN) { -+ RTW_INFO(FUNC_ADPT_FMT" only support 3 interface at most(%d)\n" -+ , FUNC_ADPT_ARG(padapter), order); -+ continue; -+ } -+ -+ SET_H2CCMD_MCC_RSVDPAGE_LOC((cmd + order), (pmccobjpriv->mcc_loc_rsvd_paga[order])); -+ } -+ -+#ifdef CONFIG_MCC_MODE_DEBUG -+ RTW_INFO("=========================\n"); -+ RTW_INFO("MCC RSVD PAGE LOC:\n"); -+ for (i = 0; i < H2C_MCC_LOCATION_LEN; i++) -+ pr_dbg("0x%x ", cmd[i]); -+ pr_dbg("\n"); -+ RTW_INFO("=========================\n"); -+#endif /* CONFIG_MCC_MODE_DEBUG */ -+ -+ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_LOCATION, H2C_MCC_LOCATION_LEN, cmd); -+} -+ -+static void rtw_hal_set_mcc_noa_cmd(PADAPTER padapter) -+{ -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 cmd[H2C_MCC_NOA_PARAM_LEN] = {0}; -+ u8 noa_fw_eable = 1; -+ u8 noa_tsf_sync_offset = 50; -+ u8 noa_start_time = 30; -+ u8 noa_interval = pmlmepriv->cur_network.network.Configuration.BeaconPeriod; -+ u8 swchannel_early_time = MCC_SWCH_FW_EARLY_TIME; -+ u8 i = 0; -+ -+ /* FW set NOA enable */ -+ SET_H2CCMD_MCC_NOA_FW_EN(cmd, noa_fw_eable); -+ /* TSF Sync offset */ -+ SET_H2CCMD_MCC_NOA_TSF_SYNC_OFFSET(cmd, noa_tsf_sync_offset); -+ /* NoA start time offset */ -+ SET_H2CCMD_MCC_NOA_START_TIME(cmd, noa_start_time); -+ /* NoA interval */ -+ SET_H2CCMD_MCC_NOA_INTERVAL(cmd, noa_interval); -+ /* Early time to inform driver by C2H before switch channel */ -+ SET_H2CCMD_MCC_EARLY_TIME(cmd, swchannel_early_time); -+ -+#ifdef CONFIG_MCC_MODE_DEBUG -+ RTW_INFO("=========================\n"); -+ RTW_INFO("NoA:\n"); -+ for (i = 0; i < H2C_MCC_NOA_PARAM_LEN; i++) -+ pr_dbg("0x%x ", cmd[i]); -+ pr_dbg("\n"); -+ RTW_INFO("=========================\n"); -+#endif /* CONFIG_MCC_MODE_DEBUG */ -+ -+ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_NOA_PARAM, H2C_MCC_NOA_PARAM_LEN, cmd); -+} -+ -+static void rtw_hal_set_mcc_IQK_offload_cmd(PADAPTER padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_adapter_priv *pmccadapriv = NULL; -+ _adapter *iface = NULL; -+ u8 cmd[H2C_MCC_IQK_PARAM_LEN] = {0}, bready = 0, i = 0, order = 0; -+ u16 TX_X = 0, TX_Y = 0, RX_X = 0, RX_Y = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ pmccadapriv = &iface->mcc_adapterpriv; -+ order = pmccadapriv->order; -+ /* TO DO for multi-antenna(FW not support) */ -+ TX_X = pmccadapriv->mcc_iqk_arr[0].TX_X & 0x7ff;/* [10:0] */ -+ TX_Y = pmccadapriv->mcc_iqk_arr[0].TX_Y & 0x7ff;/* [10:0] */ -+ RX_X = pmccadapriv->mcc_iqk_arr[0].RX_X & 0x3ff;/* [9:0] */ -+ RX_Y = pmccadapriv->mcc_iqk_arr[0].RX_Y & 0x3ff;/* [9:0] */ -+ _rtw_memset(cmd, 0, H2C_MCC_IQK_PARAM_LEN); -+ -+ /* ready or not */ -+ if (order == 1) -+ bready = 1; -+ else -+ bready = 0; -+ -+ SET_H2CCMD_MCC_IQK_READY(cmd, bready); -+ SET_H2CCMD_MCC_IQK_ORDER(cmd, order); -+ -+ /* fill RX_X[7:0] to (cmd+1)[7:0] bitlen=8 */ -+ SET_H2CCMD_MCC_IQK_RX_L(cmd, (u8)(RX_X & 0xff)); -+ /* fill RX_X[9:8] to (cmd+2)[1:0] bitlen=2 */ -+ SET_H2CCMD_MCC_IQK_RX_M1(cmd, (u8)((RX_X >> 8) & 0x03)); -+ /* fill RX_Y[5:0] to (cmd+2)[7:2] bitlen=6 */ -+ SET_H2CCMD_MCC_IQK_RX_M2(cmd, (u8)(RX_Y & 0x3f)); -+ /* fill RX_Y[9:6] to (cmd+3)[3:0] bitlen=4 */ -+ SET_H2CCMD_MCC_IQK_RX_H(cmd, (u8)((RX_Y >> 6) & 0x0f)); -+ -+ -+ /* fill TX_X[7:0] to (cmd+4)[7:0] bitlen=8 */ -+ SET_H2CCMD_MCC_IQK_TX_L(cmd, (u8)(TX_X & 0xff)); -+ /* fill TX_X[10:8] to (cmd+5)[2:0] bitlen=3 */ -+ SET_H2CCMD_MCC_IQK_TX_M1(cmd, (u8)((TX_X >> 8) & 0x07)); -+ /* fill TX_Y[4:0] to (cmd+5)[7:3] bitlen=5 */ -+ SET_H2CCMD_MCC_IQK_TX_M2(cmd, (u8)(TX_Y & 0x1f)); -+ /* fill TX_Y[10:5] to (cmd+6)[5:0] bitlen=6 */ -+ SET_H2CCMD_MCC_IQK_TX_H(cmd, (u8)((TX_Y >> 5) & 0x3f)); -+ -+#ifdef CONFIG_MCC_MODE_DEBUG -+ RTW_INFO("=========================\n"); -+ RTW_INFO(FUNC_ADPT_FMT" IQK:\n", FUNC_ADPT_ARG(iface)); -+ RTW_INFO("TX_X: 0x%02x\n", TX_X); -+ RTW_INFO("TX_Y: 0x%02x\n", TX_Y); -+ RTW_INFO("RX_X: 0x%02x\n", RX_X); -+ RTW_INFO("RX_Y: 0x%02x\n", RX_Y); -+ RTW_INFO("cmd[0]:0x%02x\n", cmd[0]); -+ RTW_INFO("cmd[1]:0x%02x\n", cmd[1]); -+ RTW_INFO("cmd[2]:0x%02x\n", cmd[2]); -+ RTW_INFO("cmd[3]:0x%02x\n", cmd[3]); -+ RTW_INFO("cmd[4]:0x%02x\n", cmd[4]); -+ RTW_INFO("cmd[5]:0x%02x\n", cmd[5]); -+ RTW_INFO("cmd[6]:0x%02x\n", cmd[6]); -+ RTW_INFO("=========================\n"); -+#endif /* CONFIG_MCC_MODE_DEBUG */ -+ -+ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_IQK_PARAM, H2C_MCC_IQK_PARAM_LEN, cmd); -+ } -+} -+ -+ -+static void rtw_hal_set_mcc_macid_cmd(PADAPTER padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_adapter_priv *pmccadapriv = NULL; -+ _adapter *iface = NULL; -+ u8 cmd[H2C_MCC_MACID_BITMAP_LEN] = {0}, i = 0, order = 0; -+ u16 bitmap = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ pmccadapriv = &iface->mcc_adapterpriv; -+ order = pmccadapriv->order; -+ bitmap = pmccadapriv->mcc_macid_bitmap; -+ -+ if (order >= (H2C_MCC_MACID_BITMAP_LEN / 2)) { -+ RTW_INFO(FUNC_ADPT_FMT" only support 3 interface at most(%d)\n" -+ , FUNC_ADPT_ARG(padapter), order); -+ continue; -+ } -+ SET_H2CCMD_MCC_MACID_BITMAP_L((cmd + order * 2), (u8)(bitmap & 0xff)); -+ SET_H2CCMD_MCC_MACID_BITMAP_H((cmd + order * 2), (u8)((bitmap >> 8) & 0xff)); -+ } -+ -+#ifdef CONFIG_MCC_MODE_DEBUG -+ RTW_INFO("=========================\n"); -+ RTW_INFO("MACID BITMAP: "); -+ for (i = 0; i < H2C_MCC_MACID_BITMAP_LEN; i++) -+ pr_dbg("0x%x ", cmd[i]); -+ pr_dbg("\n"); -+ RTW_INFO("=========================\n"); -+#endif /* CONFIG_MCC_MODE_DEBUG */ -+ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_MACID_BITMAP, H2C_MCC_MACID_BITMAP_LEN, cmd); -+} -+ -+static void rtw_hal_set_mcc_parameter_cmd(PADAPTER padapter, u8 stop) -+{ -+ u8 cmd[H2C_MCC_INFO_LEN] = {0}, i = 0; -+ u8 order = 0, totalnum = 0, chidx = 0, bw = 0, bw40sc = 0, bw80sc = 0; -+ u8 duration = 0, role = 0, incurch = 0, rfetype = 0, distxnull = 0, c2hrpt = 0, chscan = 0; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); -+ struct mlme_ext_priv *pmlmeext = NULL; -+ struct mlme_ext_info *pmlmeinfo = NULL; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ _adapter *iface = NULL; -+ -+ RTW_INFO(FUNC_ADPT_FMT": stop=%d\n", FUNC_ADPT_ARG(padapter), stop); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = pmccobjpriv->iface[i]; -+ if (iface == NULL) -+ continue; -+ -+ if (stop) { -+ if (iface != padapter) -+ continue; -+ } -+ -+ -+ order = iface->mcc_adapterpriv.order; -+ if (!stop) -+ totalnum = dvobj->iface_nums; -+ else -+ totalnum = 0xff; /* 0xff means stop */ -+ -+ pmlmeext = &iface->mlmeextpriv; -+ chidx = pmlmeext->cur_channel; -+ bw = pmlmeext->cur_bwmode; -+ bw40sc = pmlmeext->cur_ch_offset; -+ -+ /* decide 80 band width offset */ -+ if (bw == CHANNEL_WIDTH_80) { -+ u8 center_ch = rtw_get_center_ch(chidx, bw, bw40sc); -+ -+ if (center_ch > chidx) -+ bw80sc = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else if (center_ch < chidx) -+ bw80sc = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else -+ bw80sc = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } else -+ bw80sc = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ duration = iface->mcc_adapterpriv.mcc_duration; -+ role = iface->mcc_adapterpriv.role; -+ -+ incurch = _FALSE; -+ -+ if (IS_HARDWARE_TYPE_8812(padapter)) -+ rfetype = pHalData->RFEType; /* RFETYPE (only for 8812)*/ -+ else -+ rfetype = 0; -+ -+ /* STA/GC TX NULL data to inform AP/GC for ps mode */ -+ switch (role) { -+ case MCC_ROLE_GO: -+ case MCC_ROLE_AP: -+ distxnull = MCC_DISABLE_TX_NULL; -+ break; -+ case MCC_ROLE_GC: -+ case MCC_ROLE_STA: -+ distxnull = MCC_ENABLE_TX_NULL; -+ break; -+ } -+ -+ c2hrpt = MCC_C2H_REPORT_ALL_STATUS; -+ chscan = MCC_CHIDX; -+ -+ SET_H2CCMD_MCC_INFO_ORDER(cmd, order); -+ SET_H2CCMD_MCC_INFO_TOTALNUM(cmd, totalnum); -+ SET_H2CCMD_MCC_INFO_CHIDX(cmd, chidx); -+ SET_H2CCMD_MCC_INFO_BW(cmd, bw); -+ SET_H2CCMD_MCC_INFO_BW40SC(cmd, bw40sc); -+ SET_H2CCMD_MCC_INFO_BW80SC(cmd, bw80sc); -+ SET_H2CCMD_MCC_INFO_DURATION(cmd, duration); -+ SET_H2CCMD_MCC_INFO_ROLE(cmd, role); -+ SET_H2CCMD_MCC_INFO_INCURCH(cmd, incurch); -+ SET_H2CCMD_MCC_INFO_RFETYPE(cmd, rfetype); -+ SET_H2CCMD_MCC_INFO_DISTXNULL(cmd, distxnull); -+ SET_H2CCMD_MCC_INFO_C2HRPT(cmd, c2hrpt); -+ SET_H2CCMD_MCC_INFO_CHSCAN(cmd, chscan); -+ -+#ifdef CONFIG_MCC_MODE_DEBUG -+ RTW_INFO("=========================\n"); -+ RTW_INFO(FUNC_ADPT_FMT" MCC INFO:\n", FUNC_ADPT_ARG(iface)); -+ RTW_INFO("cmd[0]:0x%02x\n", cmd[0]); -+ RTW_INFO("cmd[1]:0x%02x\n", cmd[1]); -+ RTW_INFO("cmd[2]:0x%02x\n", cmd[2]); -+ RTW_INFO("cmd[3]:0x%02x\n", cmd[3]); -+ RTW_INFO("cmd[4]:0x%02x\n", cmd[4]); -+ RTW_INFO("cmd[5]:0x%02x\n", cmd[5]); -+ RTW_INFO("cmd[6]:0x%02x\n", cmd[6]); -+ RTW_INFO("=========================\n"); -+#endif /* CONFIG_MCC_MODE_DEBUG */ -+ -+ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_INFO, H2C_MCC_INFO_LEN, cmd); -+ } -+} -+ -+static u8 rtw_hal_set_mcc_start_setting(PADAPTER padapter, u8 status) -+{ -+ u8 ret = _SUCCESS; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ -+ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { -+ rtw_warn_on(1); -+ RTW_INFO("PS mode is not active before start mcc, force exit ps mode\n"); -+ LeaveAllPowerSaveModeDirect(padapter); -+ } -+ -+ if (dvobj->iface_nums > MAX_MCC_NUM) { -+ RTW_INFO("%s: current iface num(%d) > MAX_MCC_NUM(%d)\n", __func__, dvobj->iface_nums, MAX_MCC_NUM); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ if (rtw_hal_decide_mcc_role(padapter) == _FAIL) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* set mcc status to indicate process mcc start setting */ -+ rtw_hal_set_mcc_status(padapter, MCC_STATUS_PROCESS_MCC_START_SETTING); -+ -+ /* only download rsvd page for connect */ -+ if (status == MCC_SETCMD_STATUS_START_CONNECT) { -+ /* download mcc rsvd page */ -+ rtw_hal_set_fw_mcc_rsvd_page(padapter); -+ rtw_hal_set_mcc_rsvdpage_cmd(padapter); -+ } -+ -+ /* configure NoA setting */ -+ rtw_hal_set_mcc_noa_cmd(padapter); -+ -+ /* IQK value offload */ -+ rtw_hal_set_mcc_IQK_offload_cmd(padapter); -+ -+ /* set mac id to fw */ -+ rtw_hal_set_mcc_macid_cmd(padapter); -+ -+ /* set mcc parameter */ -+ rtw_hal_set_mcc_parameter_cmd(padapter, _FALSE); -+ -+exit: -+ return ret; -+} -+ -+static void rtw_hal_set_mcc_stop_setting(PADAPTER padapter, u8 status) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface = NULL; -+ u8 i = 0; -+ /* -+ * when adapter disconnect, stop mcc mod -+ * total=0xf means stop mcc mode -+ */ -+ -+ switch (status) { -+ default: -+ /* let fw switch to other interface channel */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ /* use other interface to set cmd */ -+ if (iface != padapter) { -+ rtw_hal_set_mcc_parameter_cmd(iface, _TRUE); -+ break; -+ } -+ } -+ break; -+ } -+} -+ -+static void rtw_hal_mcc_status_hdl(PADAPTER padapter, u8 status) -+{ -+ switch (status) { -+ case MCC_SETCMD_STATUS_STOP_DISCONNECT: -+ rtw_hal_clear_mcc_status(padapter, MCC_STATUS_NEED_MCC | MCC_STATUS_DOING_MCC); -+ break; -+ case MCC_SETCMD_STATUS_STOP_SCAN_START: -+ rtw_hal_set_mcc_status(padapter, MCC_STATUS_NEED_MCC); -+ rtw_hal_clear_mcc_status(padapter, MCC_STATUS_DOING_MCC); -+ break; -+ -+ case MCC_SETCMD_STATUS_START_CONNECT: -+ case MCC_SETCMD_STATUS_START_SCAN_DONE: -+ rtw_hal_set_mcc_status(padapter, MCC_STATUS_NEED_MCC | MCC_STATUS_DOING_MCC); -+ break; -+ default: -+ RTW_INFO(FUNC_ADPT_FMT" error status(%d)\n", FUNC_ADPT_ARG(padapter), status); -+ break; -+ } -+} -+ -+static void rtw_hal_mcc_stop_posthdl(PADAPTER padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface = NULL; -+ u8 i = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ /* release network queue */ -+ rtw_netif_wake_queue(iface->pnetdev); -+ iface->mcc_adapterpriv.mcc_tx_bytes_from_kernel = 0; -+ iface->mcc_adapterpriv.mcc_last_tx_bytes_from_kernel = 0; -+ iface->mcc_adapterpriv.mcc_tx_bytes_to_port = 0; -+ } -+} -+ -+static void rtw_hal_mcc_start_posthdl(PADAPTER padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface = NULL; -+ u8 i = 0; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ iface->mcc_adapterpriv.mcc_tx_bytes_from_kernel = 0; -+ iface->mcc_adapterpriv.mcc_last_tx_bytes_from_kernel = 0; -+ iface->mcc_adapterpriv.mcc_tx_bytes_to_port = 0; -+ } -+} -+ -+/* -+ * rtw_hal_set_mcc_setting - set mcc setting -+ * @padapter: currnet padapter to stop/start MCC -+ * @stop: stop mcc or not -+ * @return val: 1 for SUCCESS, 0 for fail -+ */ -+static u8 rtw_hal_set_mcc_setting(PADAPTER padapter, u8 status) -+{ -+ u8 ret = _FAIL; -+ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ u8 stop = (status < MCC_SETCMD_STATUS_START_CONNECT) ? _TRUE : _FALSE; -+ u32 start_time = rtw_get_current_time(); -+ -+ RTW_INFO("===> "FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ rtw_sctx_init(&pmccobjpriv->mcc_sctx, MCC_EXPIRE_TIME); -+ pmccobjpriv->mcc_c2h_status = MCC_RPT_MAX; -+ -+ if (stop == _FALSE) { -+ pmccobjpriv->duration = MCC_DURATION; -+ -+ /* handle mcc start */ -+ if (rtw_hal_set_mcc_start_setting(padapter, status) == _FAIL) -+ goto exit; -+ -+ /* wait for C2H */ -+ if (!rtw_sctx_wait(&pmccobjpriv->mcc_sctx, __func__)) -+ RTW_INFO(FUNC_ADPT_FMT": wait for mcc start C2H time out\n", FUNC_ADPT_ARG(padapter)); -+ else -+ ret = _SUCCESS; -+ -+ if (ret == _SUCCESS) { -+ RTW_INFO(FUNC_ADPT_FMT": mcc start sucecssfully\n", FUNC_ADPT_ARG(padapter)); -+ rtw_hal_mcc_start_posthdl(padapter); -+ } -+ } else { -+ -+ /* set mcc status to indicate process mcc start setting */ -+ rtw_hal_set_mcc_status(padapter, MCC_STATUS_PROCESS_MCC_STOP_SETTING); -+ -+ /* handle mcc stop */ -+ rtw_hal_set_mcc_stop_setting(padapter, status); -+ -+ /* wait for C2H */ -+ if (!rtw_sctx_wait(&pmccobjpriv->mcc_sctx, __func__)) -+ RTW_INFO(FUNC_ADPT_FMT": wait for mcc stop C2H time out\n", FUNC_ADPT_ARG(padapter)); -+ else { -+ ret = _SUCCESS; -+ rtw_hal_mcc_stop_posthdl(padapter); -+ } -+ } -+ -+exit: -+ -+ rtw_hal_mcc_status_hdl(padapter, status); -+ /* clear mcc status */ -+ rtw_hal_clear_mcc_status(padapter -+ , MCC_STATUS_PROCESS_MCC_START_SETTING | MCC_STATUS_PROCESS_MCC_STOP_SETTING); -+ -+ RTW_INFO(FUNC_ADPT_FMT" in %dms <===\n" -+ , FUNC_ADPT_ARG(padapter), rtw_get_passing_time_ms(start_time)); -+ return ret; -+} -+ -+/** -+ * rtw_hal_mcc_check_case_not_limit_traffic - handler flow ctrl for special case -+ * @cur_iface: fw stay channel setting of this iface -+ * @next_iface: fw will swich channel setting of this iface -+ */ -+static void rtw_hal_mcc_check_case_not_limit_traffic(PADAPTER cur_iface, PADAPTER next_iface) -+{ -+ u8 cur_bw = cur_iface->mlmeextpriv.cur_bwmode; -+ u8 next_bw = next_iface->mlmeextpriv.cur_bwmode; -+ -+ /* for both interface are VHT80, doesn't limit_traffic according to iperf results */ -+ if (cur_bw == CHANNEL_WIDTH_80 && next_bw == CHANNEL_WIDTH_80) { -+ cur_iface->mcc_adapterpriv.mcc_tp_limit = _FALSE; -+ next_iface->mcc_adapterpriv.mcc_tp_limit = _FALSE; -+ } -+} -+ -+ -+/** -+ * rtw_hal_mcc_sw_ch_fw_notify_hdl - handler flow ctrl -+ */ -+static void rtw_hal_mcc_sw_ch_fw_notify_hdl(PADAPTER padapter) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ struct mcc_adapter_priv *cur_mccadapriv = NULL, *next_mccadapriv = NULL; -+ _adapter *iface = NULL, *cur_iface = NULL, *next_iface = NULL; -+ struct registry_priv *preg = &padapter->registrypriv; -+ u8 cur_op_ch = pdvobjpriv->oper_channel; -+ u8 i = 0, iface_num = pdvobjpriv->iface_nums, cur_order = 0, next_order = 0; -+ static u8 cnt = 1; -+ u32 single_tx_cri = preg->rtw_mcc_single_tx_cri; -+ -+ for (i = 0; i < iface_num; i++) { -+ iface = pdvobjpriv->padapters[i]; -+ if (cur_op_ch == iface->mlmeextpriv.cur_channel) { -+ cur_iface = iface; -+ cur_mccadapriv = &cur_iface->mcc_adapterpriv; -+ cur_order = cur_mccadapriv->order; -+ next_order = (cur_order + 1) % iface_num; -+ next_iface = pmccobjpriv->iface[next_order]; -+ next_mccadapriv = &next_iface->mcc_adapterpriv; -+ break; -+ } -+ } -+ -+ /* check other interface tx busy traffic or not under every 2 switch channel notify(Mbits/100ms) */ -+ if (cnt == 2) { -+ cur_mccadapriv->mcc_tp = (cur_mccadapriv->mcc_tx_bytes_from_kernel -+ - cur_mccadapriv->mcc_last_tx_bytes_from_kernel) * 10 * 8 / 1024 / 1024; -+ cur_mccadapriv->mcc_last_tx_bytes_from_kernel = cur_mccadapriv->mcc_tx_bytes_from_kernel; -+ -+ next_mccadapriv->mcc_tp = (next_mccadapriv->mcc_tx_bytes_from_kernel -+ - next_mccadapriv->mcc_last_tx_bytes_from_kernel) * 10 * 8 / 1024 / 1024; -+ next_mccadapriv->mcc_last_tx_bytes_from_kernel = next_mccadapriv->mcc_tx_bytes_from_kernel; -+ -+ cnt = 1; -+ } else -+ cnt = 2; -+ -+ /* check single TX or cuncurrnet TX */ -+ if (next_mccadapriv->mcc_tp < single_tx_cri) { -+ /* single TX, does not stop */ -+ cur_mccadapriv->mcc_tx_stop = _FALSE; -+ cur_mccadapriv->mcc_tp_limit = _FALSE; -+ } else { -+ /* concurrent TX, stop */ -+ cur_mccadapriv->mcc_tx_stop = _TRUE; -+ cur_mccadapriv->mcc_tp_limit = _TRUE; -+ } -+ -+ if (cur_mccadapriv->mcc_tp < single_tx_cri) { -+ next_mccadapriv->mcc_tx_stop = _FALSE; -+ next_mccadapriv->mcc_tp_limit = _FALSE; -+ } else { -+ next_mccadapriv->mcc_tx_stop = _FALSE; -+ next_mccadapriv->mcc_tp_limit = _TRUE; -+ next_mccadapriv->mcc_tx_bytes_to_port = 0; -+ } -+ -+ /* stop current iface kernel queue or not */ -+ if (cur_mccadapriv->mcc_tx_stop) -+ rtw_netif_stop_queue(cur_iface->pnetdev); -+ else -+ rtw_netif_wake_queue(cur_iface->pnetdev); -+ -+ /* stop next iface kernel queue or not */ -+ if (next_mccadapriv->mcc_tx_stop) -+ rtw_netif_stop_queue(next_iface->pnetdev); -+ else -+ rtw_netif_wake_queue(next_iface->pnetdev); -+ -+ /* start xmit tasklet */ -+ rtw_os_xmit_schedule(next_iface); -+ -+ rtw_hal_mcc_check_case_not_limit_traffic(cur_iface, next_iface); -+ -+ if (0) { -+ RTW_INFO("order:%d, mcc_tx_stop:%d, mcc_tp:%d\n", -+ cur_mccadapriv->order, cur_mccadapriv->mcc_tx_stop, cur_mccadapriv->mcc_tp); -+ dump_os_queue(0, cur_iface); -+ RTW_INFO("order:%d, mcc_tx_stop:%d, mcc_tp:%d\n", -+ next_mccadapriv->order, next_mccadapriv->mcc_tx_stop, next_mccadapriv->mcc_tp); -+ dump_os_queue(0, next_iface); -+ } -+} -+ -+/** -+ * rtw_hal_mcc_c2h_handler - mcc c2h handler -+ */ -+void rtw_hal_mcc_c2h_handler(PADAPTER padapter, u8 buflen, u8 *tmpBuf) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ struct submit_ctx *mcc_sctx = &pmccobjpriv->mcc_sctx; -+ _irqL irqL; -+ -+ /* RTW_INFO("[length]=%d, [C2H data]="MAC_FMT"\n", buflen, MAC_ARG(tmpBuf)); */ -+ /* To avoid reg is set, but driver recive c2h to set wrong oper_channel */ -+ if (MCC_RPT_STOPMCC == pmccobjpriv->mcc_c2h_status) { -+ RTW_INFO(FUNC_ADPT_FMT" MCC alread stops return\n", FUNC_ADPT_ARG(padapter)); -+ return; -+ } -+ -+ pmccobjpriv->mcc_c2h_status = tmpBuf[0]; -+ switch (pmccobjpriv->mcc_c2h_status) { -+ case MCC_RPT_SUCCESS: -+ pdvobjpriv->oper_channel = tmpBuf[1]; -+ _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ pmccobjpriv->cur_mcc_success_cnt++; -+ _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ break; -+ case MCC_RPT_TXNULL_FAIL: -+ RTW_INFO("[MCC] TXNULL FAIL\n"); -+ break; -+ case MCC_RPT_STOPMCC: -+ RTW_INFO("[MCC] MCC stop (time:%d)\n", rtw_get_current_time()); -+ pmccobjpriv->mcc_c2h_status = MCC_RPT_STOPMCC; -+ rtw_sctx_done(&mcc_sctx); -+ break; -+ case MCC_RPT_READY: -+ _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ /* initialize counter & time */ -+ pmccobjpriv->mcc_launch_time = rtw_get_current_time(); -+ pmccobjpriv->mcc_c2h_status = MCC_RPT_READY; -+ pmccobjpriv->cur_mcc_success_cnt = 0; -+ pmccobjpriv->prev_mcc_success_cnt = 0; -+ pmccobjpriv->mcc_tolerance_time = MCC_TOLERANCE_TIME; -+ _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ -+ RTW_INFO("[MCC] MCC ready (time:%d)\n", pmccobjpriv->mcc_launch_time); -+ rtw_sctx_done(&mcc_sctx); -+ break; -+ case MCC_RPT_SWICH_CHANNEL_NOTIFY: -+ pdvobjpriv->oper_channel = tmpBuf[1]; -+ rtw_hal_mcc_sw_ch_fw_notify_hdl(padapter); -+ break; -+ default: -+ /* RTW_INFO("[MCC] Other MCC status(%d)\n", pmccobjpriv->mcc_c2h_status); */ -+ break; -+ } -+} -+ -+ -+/** -+ * rtw_hal_mcc_sw_status_check - check mcc swich channel status -+ * @padapter: primary adapter -+ */ -+void rtw_hal_mcc_sw_status_check(PADAPTER padapter) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ u8 cur_cnt = 0, prev_cnt = 0, diff_cnt = 0, check_ret = _FAIL; -+ _irqL irqL; -+ -+ /* #define MCC_RESTART 1 */ -+ -+ if (!MCC_EN(padapter)) -+ return; -+ -+ _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); -+ -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { -+ -+ if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { -+ rtw_warn_on(1); -+ RTW_INFO("PS mode is not active under mcc, force exit ps mode\n"); -+ LeaveAllPowerSaveModeDirect(padapter); -+ } -+ -+ if (rtw_get_passing_time_ms(pmccobjpriv->mcc_launch_time) > 2000) { -+ _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ -+ cur_cnt = pmccobjpriv->cur_mcc_success_cnt; -+ prev_cnt = pmccobjpriv->prev_mcc_success_cnt; -+ if (cur_cnt < prev_cnt) -+ diff_cnt = (cur_cnt + 255) - prev_cnt; -+ else -+ diff_cnt = cur_cnt - prev_cnt; -+ -+ if (diff_cnt < 30) { -+ pmccobjpriv->mcc_tolerance_time--; -+ RTW_INFO("%s: diff_cnt:%d, tolerance_time:%d\n", -+ __func__, diff_cnt, pmccobjpriv->mcc_tolerance_time); -+ } else -+ pmccobjpriv->mcc_tolerance_time = MCC_TOLERANCE_TIME; -+ -+ pmccobjpriv->prev_mcc_success_cnt = pmccobjpriv->cur_mcc_success_cnt; -+ -+ if (pmccobjpriv->mcc_tolerance_time != 0) -+ check_ret = _SUCCESS; -+ -+ _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ -+ if (check_ret != _SUCCESS) { -+ RTW_INFO("============ MCC swich channel check fail (%d)=============\n", diff_cnt); -+ /* restart MCC */ -+#ifdef MCC_RESTART -+ rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_STOP_DISCONNECT); -+ rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_CONNECT); -+#endif /* MCC_RESTART */ -+ } -+ } else { -+ _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ pmccobjpriv->prev_mcc_success_cnt = pmccobjpriv->cur_mcc_success_cnt; -+ _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); -+ } -+ -+ } -+ _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); -+} -+ -+/** -+ * rtw_hal_mcc_change_scan_flag - change scan flag under mcc -+ * -+ * MCC mode under sitesurvey goto AP channel to tx bcn & data -+ * MCC mode under sitesurvey doesn't support TX data for station mode (FW not support) -+ * -+ * @padapter: the adapter to be change scan flag -+ * @ch: pointer to rerurn ch -+ * @bw: pointer to rerurn bw -+ * @offset: pointer to rerurn offset -+ */ -+u8 rtw_hal_mcc_change_scan_flag(PADAPTER padapter, u8 *ch, u8 *bw, u8 *offset) -+{ -+ u8 need_ch_setting_union = _TRUE, i = 0, flags = 0, role = 0; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mcc_adapter_priv *pmccadapriv = NULL; -+ struct mlme_ext_priv *pmlmeext = NULL; -+ -+ if (!MCC_EN(padapter)) -+ goto exit; -+ -+ if (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) -+ goto exit; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ if (!dvobj->padapters[i]) -+ continue; -+ -+ pmlmeext = &dvobj->padapters[i]->mlmeextpriv; -+ pmccadapriv = &dvobj->padapters[i]->mcc_adapterpriv; -+ role = pmccadapriv->role; -+ -+ switch (role) { -+ case MCC_ROLE_AP: -+ case MCC_ROLE_GO: -+ *ch = pmlmeext->cur_channel; -+ *bw = pmlmeext->cur_bwmode; -+ *offset = pmlmeext->cur_ch_offset; -+ need_ch_setting_union = _FALSE; -+ break; -+ case MCC_ROLE_STA: -+ case MCC_ROLE_GC: -+ break; -+ default: -+ RTW_INFO("unknown role\n"); -+ rtw_warn_on(1); -+ break; -+ } -+ -+ /* check other scan flag */ -+ flags = mlmeext_scan_backop_flags(pmlmeext); -+ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC)) -+ flags &= ~SS_BACKOP_PS_ANNC; -+ -+ if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_TX_RESUME)) -+ flags &= ~SS_BACKOP_TX_RESUME; -+ -+ mlmeext_assign_scan_backop_flags(pmlmeext, flags); -+ -+ } -+exit: -+ return need_ch_setting_union; -+} -+ -+/** -+ * rtw_hal_mcc_calc_tx_bytes_from_kernel - calculte tx bytes from kernel to check concurrent tx or not -+ * @padapter: the adapter to be record tx bytes -+ * @len: data len -+ */ -+inline void rtw_hal_mcc_calc_tx_bytes_from_kernel(PADAPTER padapter, u32 len) -+{ -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ -+ if (MCC_EN(padapter)) { -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { -+ pmccadapriv->mcc_tx_bytes_from_kernel += len; -+ if (0) -+ RTW_INFO("%s(order:%d): mcc tx bytes from kernel:%lld\n" -+ , __func__, pmccadapriv->order, pmccadapriv->mcc_tx_bytes_from_kernel); -+ } -+ } -+} -+ -+/** -+ * rtw_hal_mcc_calc_tx_bytes_to_port - calculte tx bytes to write port in order to flow crtl -+ * @padapter: the adapter to be record tx bytes -+ * @len: data len -+ */ -+inline void rtw_hal_mcc_calc_tx_bytes_to_port(PADAPTER padapter, u32 len) -+{ -+ if (MCC_EN(padapter)) { -+ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) -+ pmccadapriv->mcc_tx_bytes_to_port += len; -+ if (0) -+ RTW_INFO("%s(order:%d): mcc tx bytes to port:%d, mcc target tx bytes to port:%d\n" -+ , __func__, pmccadapriv->order, pmccadapriv->mcc_tx_bytes_to_port -+ , pmccadapriv->mcc_target_tx_bytes_to_port); -+ } -+} -+ -+/** -+ * rtw_hal_mcc_stop_tx_bytes_to_port - stop write port to hw or not -+ * @padapter: the adapter to be stopped -+ */ -+inline u8 rtw_hal_mcc_stop_tx_bytes_to_port(PADAPTER padapter) -+{ -+ if (MCC_EN(padapter)) { -+ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; -+ -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { -+ if (pmccadapriv->mcc_tp_limit) { -+ if (pmccadapriv->mcc_tx_bytes_to_port >= pmccadapriv->mcc_target_tx_bytes_to_port) { -+ pmccadapriv->mcc_tx_stop = _TRUE; -+ rtw_netif_stop_queue(padapter->pnetdev); -+ return _TRUE; -+ } -+ } -+ } -+ } -+ -+ return _FALSE; -+} -+ -+/** -+ * rtw_hal_set_mcc_setting_scan_start - setting mcc under scan start -+ * @padapter: the adapter to be setted -+ * @ch_setting_changed: softap channel setting to be changed or not -+ */ -+u8 rtw_hal_set_mcc_setting_scan_start(PADAPTER padapter) -+{ -+ u8 ret = _FAIL; -+ -+ if (MCC_EN(padapter)) { -+ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ -+ _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) { -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { -+ ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_STOP_SCAN_START); -+ /* issue null data to all station connected to AP before scan */ -+ rtw_hal_mcc_issue_null_data(padapter, 0, 1); -+ } -+ } -+ _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); -+ } -+ -+ return ret; -+} -+ -+/** -+ * rtw_hal_set_mcc_setting_scan_complete - setting mcc after scan commplete -+ * @padapter: the adapter to be setted -+ * @ch_setting_changed: softap channel setting to be changed or not -+ */ -+u8 rtw_hal_set_mcc_setting_scan_complete(PADAPTER padapter) -+{ -+ u8 ret = _FAIL; -+ -+ if (MCC_EN(padapter)) { -+ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ -+ _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); -+ -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) -+ ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_SCAN_DONE); -+ -+ _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); -+ } -+ -+ return ret; -+} -+ -+ -+/** -+ * rtw_hal_set_mcc_setting_start_bss_network - setting mcc under softap start -+ * @padapter: the adapter to be setted -+ * @chbw_grouped: channel bw offset can not be allowed or not -+ */ -+u8 rtw_hal_set_mcc_setting_start_bss_network(PADAPTER padapter, u8 chbw_allow) -+{ -+ u8 ret = _FAIL; -+ -+ if (MCC_EN(padapter)) { -+ /* channel bw offset can not be allowed, start MCC */ -+ if (chbw_allow == _FALSE) { -+ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ -+ rtw_hal_mcc_backup_IQK_val(padapter); -+ _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); -+ ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_CONNECT); -+ _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); -+ } -+ } -+ -+ return ret; -+} -+ -+/** -+ * rtw_hal_set_mcc_setting_disconnect - setting mcc under mlme disconnect(stop softap/disconnect from AP) -+ * @padapter: the adapter to be setted -+ */ -+u8 rtw_hal_set_mcc_setting_disconnect(PADAPTER padapter) -+{ -+ u8 ret = _FAIL; -+ -+ if (MCC_EN(padapter)) { -+ struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); -+ -+ _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) { -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) -+ ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_STOP_DISCONNECT); -+ } -+ _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); -+ } -+ -+ return ret; -+} -+ -+/** -+ * rtw_hal_set_mcc_setting_join_done_chk_ch - setting mcc under join done -+ * @padapter: the adapter to be checked -+ */ -+u8 rtw_hal_set_mcc_setting_join_done_chk_ch(PADAPTER padapter) -+{ -+ u8 ret = _FAIL; -+ -+ if (MCC_EN(padapter)) { -+ struct mi_state mstate; -+ -+ rtw_mi_status_no_self(padapter, &mstate); -+ -+ if (MSTATE_STA_LD_NUM(&mstate) || MSTATE_STA_LG_NUM(&mstate) || MSTATE_AP_NUM(&mstate)) { -+ bool chbw_allow = _TRUE; -+ u8 u_ch, u_offset, u_bw; -+ struct mlme_ext_priv *cur_mlmeext = &padapter->mlmeextpriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ if (rtw_mi_get_ch_setting_union_no_self(padapter, &u_ch, &u_bw, &u_offset) <= 0) { -+ dump_adapters_status(RTW_DBGDUMP , dvobj); -+ rtw_warn_on(1); -+ } -+ RTW_INFO(FUNC_ADPT_FMT" union no self: %u,%u,%u\n" -+ , FUNC_ADPT_ARG(padapter), u_ch, u_bw, u_offset); -+ -+ /* chbw_allow? */ -+ chbw_allow = rtw_is_chbw_grouped(cur_mlmeext->cur_channel -+ , cur_mlmeext->cur_bwmode, cur_mlmeext->cur_ch_offset -+ , u_ch, u_bw, u_offset); -+ -+ RTW_INFO(FUNC_ADPT_FMT" chbw_allow:%d\n" -+ , FUNC_ADPT_ARG(padapter), chbw_allow); -+ -+ /* if chbw_allow = false, start MCC setting */ -+ if (chbw_allow == _FALSE) { -+ struct mcc_obj_priv *pmccobjpriv = &dvobj->mcc_objpriv; -+ -+ rtw_hal_mcc_backup_IQK_val(padapter); -+ _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); -+ ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_CONNECT); -+ _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); -+ } -+ } -+ } -+ -+ return ret; -+} -+ -+/** -+ * rtw_hal_set_mcc_setting_chk_start_clnt_join - check change channel under start clnt join -+ * @padapter: the adapter to be checked -+ * @ch: pointer to rerurn ch -+ * @bw: pointer to rerurn bw -+ * @offset: pointer to rerurn offset -+ * @chbw_allow: allow to use adapter's channel setting -+ */ -+u8 rtw_hal_set_mcc_setting_chk_start_clnt_join(PADAPTER padapter, u8 *ch, u8 *bw, u8 *offset, u8 chbw_allow) -+{ -+ u8 ret = _FAIL; -+ -+ /* if chbw_allow = false under en_mcc = TRUE, we do not change channel related setting */ -+ if (MCC_EN(padapter)) { -+ /* restore union channel related setting to current channel related setting */ -+ if (chbw_allow == _FALSE) { -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ *ch = pmlmeext->cur_channel; -+ *bw = pmlmeext->cur_bwmode; -+ *offset = pmlmeext->cur_ch_offset; -+ -+ RTW_INFO(FUNC_ADPT_FMT" en_mcc:%d(%d,%d,%d,)\n" -+ , FUNC_ADPT_ARG(padapter), padapter->registrypriv.en_mcc -+ , *ch, *bw, *offset); -+ ret = _SUCCESS; -+ } -+ } -+ -+ return ret; -+} -+ -+void rtw_hal_dump_mcc_info(void *sel, struct dvobj_priv *dvobj) -+{ -+ struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); -+ struct mcc_adapter_priv *pmccadapriv = NULL; -+ _adapter *iface = NULL, *adapter = NULL; -+ struct registry_priv *regpriv = NULL; -+ u8 i = 0; -+ -+ /* regpriv is common for all adapter */ -+ adapter = dvobj->padapters[IFACE_ID0]; -+ -+ RTW_PRINT_SEL(sel, "**********************************************\n"); -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ regpriv = &iface->registrypriv; -+ pmccadapriv = &iface->mcc_adapterpriv; -+ if (pmccadapriv) { -+ RTW_PRINT_SEL(sel, "adapter mcc info:\n"); -+ RTW_PRINT_SEL(sel, "ifname:%s\n", ADPT_ARG(iface)); -+ RTW_PRINT_SEL(sel, "order:%d\n", pmccadapriv->order); -+ RTW_PRINT_SEL(sel, "duration:%d\n", pmccadapriv->mcc_duration); -+ RTW_PRINT_SEL(sel, "target tx bytes:%d\n", pmccadapriv->mcc_target_tx_bytes_to_port); -+ RTW_PRINT_SEL(sel, "current TP:%d\n", pmccadapriv->mcc_tp); -+ RTW_PRINT_SEL(sel, "mgmt queue macid:%d\n", pmccadapriv->mgmt_queue_macid); -+ RTW_PRINT_SEL(sel, "macid bitmap:0x%02x\n\n", pmccadapriv->mcc_macid_bitmap); -+ RTW_PRINT_SEL(sel, "registry data:\n"); -+ RTW_PRINT_SEL(sel, "en_mcc:%d\n", regpriv->en_mcc); -+ RTW_PRINT_SEL(sel, "ap target tx TP(BW:20M):%d Mbps\n", regpriv->rtw_mcc_ap_bw20_target_tx_tp); -+ RTW_PRINT_SEL(sel, "ap target tx TP(BW:40M):%d Mbps\n", regpriv->rtw_mcc_ap_bw40_target_tx_tp); -+ RTW_PRINT_SEL(sel, "ap target tx TP(BW:80M):%d Mbps\n", regpriv->rtw_mcc_ap_bw80_target_tx_tp); -+ RTW_PRINT_SEL(sel, "sta target tx TP(BW:20M):%d Mbps\n", regpriv->rtw_mcc_sta_bw20_target_tx_tp); -+ RTW_PRINT_SEL(sel, "sta target tx TP(BW:40M ):%d Mbps\n", regpriv->rtw_mcc_sta_bw40_target_tx_tp); -+ RTW_PRINT_SEL(sel, "sta target tx TP(BW:80M):%d Mbps\n", regpriv->rtw_mcc_sta_bw80_target_tx_tp); -+ RTW_PRINT_SEL(sel, "single tx criteria:%d Mbps\n", regpriv->rtw_mcc_single_tx_cri); -+ RTW_PRINT_SEL(sel, "**********************************************\n"); -+ } -+ } -+ RTW_PRINT_SEL(sel, "------------------------------------------\n"); -+ RTW_PRINT_SEL(sel, "define data:\n"); -+ RTW_PRINT_SEL(sel, "ap target tx TP(BW:20M):%d Mbps\n", MCC_AP_BW20_TARGET_TX_TP); -+ RTW_PRINT_SEL(sel, "ap target tx TP(BW:40M):%d Mbps\n", MCC_AP_BW40_TARGET_TX_TP); -+ RTW_PRINT_SEL(sel, "ap target tx TP(BW:80M):%d Mbps\n", MCC_AP_BW80_TARGET_TX_TP); -+ RTW_PRINT_SEL(sel, "sta target tx TP(BW:20M):%d Mbps\n", MCC_STA_BW20_TARGET_TX_TP); -+ RTW_PRINT_SEL(sel, "sta target tx TP(BW:40M):%d Mbps\n", MCC_STA_BW40_TARGET_TX_TP); -+ RTW_PRINT_SEL(sel, "sta target tx TP(BW:80M):%d Mbps\n", MCC_STA_BW80_TARGET_TX_TP); -+ RTW_PRINT_SEL(sel, "single tx criteria:%d Mbps\n", MCC_SINGLE_TX_CRITERIA); -+ RTW_PRINT_SEL(sel, "------------------------------------------\n"); -+} -+ -+inline void update_mcc_mgntframe_attrib(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ if (MCC_EN(padapter)) { -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { -+ /* use QSLT_MGNT to check mgnt queue or bcn queue */ -+ if (pattrib->qsel == QSLT_MGNT) { -+ pattrib->mac_id = padapter->mcc_adapterpriv.mgmt_queue_macid; -+ pattrib->qsel = QSLT_VO; -+ } -+ } -+ } -+} -+ -+inline u8 rtw_hal_mcc_link_status_chk(_adapter *padapter, const char *msg) -+{ -+ u8 ret = _TRUE, i = 0; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface; -+ struct mlme_ext_priv *mlmeext; -+ -+ if (MCC_EN(padapter)) { -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) { -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ mlmeext = &iface->mlmeextpriv; -+ if (mlmeext_scan_state(mlmeext) != SCAN_DISABLE) { -+#ifdef DBG_EXPIRATION_CHK -+ RTW_INFO(FUNC_ADPT_FMT" don't enter %s under scan for MCC mode\n", FUNC_ADPT_ARG(padapter), msg); -+#endif -+ ret = _FALSE; -+ goto exit; -+ } -+ } -+ } -+ } -+ -+exit: -+ return ret; -+} -+ -+void rtw_hal_mcc_issue_null_data(_adapter *padapter, u8 chbw_allow, u8 ps_mode) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ _adapter *iface = NULL; -+ u32 start = rtw_get_current_time(); -+ u8 i = 0; -+ -+ if (MCC_EN(padapter)) { -+ if (chbw_allow == _FALSE) { -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ /* issue null data to inform ap station will leave */ -+ if (is_client_associated_to_ap(iface)) { -+ struct mlme_ext_priv *mlmeext = &iface->mlmeextpriv; -+ u8 ch = mlmeext->cur_channel; -+ u8 bw = mlmeext->cur_bwmode; -+ u8 offset = mlmeext->cur_ch_offset; -+ -+ set_channel_bwmode(iface, ch, bw, offset); -+ issue_nulldata(iface, NULL, ps_mode, 3, 50); -+ } -+ } -+ RTW_INFO("%s(%d ms)\n", __func__, rtw_get_passing_time_ms(start)); -+ } -+ } -+} -+ -+#endif /* CONFIG_MCC_MODE */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_mp.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_mp.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_mp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_mp.c 2018-02-11 21:44:27.152146162 +0200 -@@ -0,0 +1,2255 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _HAL_MP_C_ -+ -+#include -+ -+#ifdef CONFIG_MP_INCLUDED -+ -+#ifdef RTW_HALMAC -+ #include /* struct HAL_DATA_TYPE, RF register definition and etc. */ -+#else /* !RTW_HALMAC */ -+ #ifdef CONFIG_RTL8188E -+ #include -+ #endif -+ #ifdef CONFIG_RTL8723B -+ #include -+ #endif -+ #ifdef CONFIG_RTL8192E -+ #include -+ #endif -+ #ifdef CONFIG_RTL8814A -+ #include -+ #endif -+ #if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ #include -+ #endif -+ #ifdef CONFIG_RTL8703B -+ #include -+ #endif -+ #ifdef CONFIG_RTL8723D -+ #include -+ #endif -+ #ifdef CONFIG_RTL8188F -+ #include -+ #endif -+#endif /* !RTW_HALMAC */ -+ -+ -+u8 MgntQuery_NssTxRate(u16 Rate) -+{ -+ u8 NssNum = RF_TX_NUM_NONIMPLEMENT; -+ -+ if ((Rate >= MGN_MCS8 && Rate <= MGN_MCS15) || -+ (Rate >= MGN_VHT2SS_MCS0 && Rate <= MGN_VHT2SS_MCS9)) -+ NssNum = RF_2TX; -+ else if ((Rate >= MGN_MCS16 && Rate <= MGN_MCS23) || -+ (Rate >= MGN_VHT3SS_MCS0 && Rate <= MGN_VHT3SS_MCS9)) -+ NssNum = RF_3TX; -+ else if ((Rate >= MGN_MCS24 && Rate <= MGN_MCS31) || -+ (Rate >= MGN_VHT4SS_MCS0 && Rate <= MGN_VHT4SS_MCS9)) -+ NssNum = RF_4TX; -+ else -+ NssNum = RF_1TX; -+ -+ return NssNum; -+} -+ -+void hal_mpt_SwitchRfSetting(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u8 ChannelToSw = pMptCtx->MptChannelToSw; -+ ULONG ulRateIdx = pMptCtx->MptRateIndex; -+ ULONG ulbandwidth = pMptCtx->MptBandWidth; -+ -+ /* <20120525, Kordan> Dynamic mechanism for APK, asked by Dennis.*/ -+ if (IS_HARDWARE_TYPE_8188ES(pAdapter) && (1 <= ChannelToSw && ChannelToSw <= 11) && -+ (ulRateIdx == MPT_RATE_MCS0 || ulRateIdx == MPT_RATE_1M || ulRateIdx == MPT_RATE_6M)) { -+ pMptCtx->backup0x52_RF_A = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0); -+ pMptCtx->backup0x52_RF_B = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0); -+ -+ if ((PlatformEFIORead4Byte(pAdapter, 0xF4) & BIT29) == BIT29) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xB); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0xB); -+ } else { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xD); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0xD); -+ } -+ } else if (IS_HARDWARE_TYPE_8188EE(pAdapter)) { /* <20140903, VincentL> Asked by RF Eason and Edlu*/ -+ if (ChannelToSw == 3 && ulbandwidth == MPT_BW_40MHZ) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ -+ } else { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ -+ } -+ } else if (IS_HARDWARE_TYPE_8188E(pAdapter)) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, pMptCtx->backup0x52_RF_A); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, pMptCtx->backup0x52_RF_B); -+ } -+} -+ -+s32 hal_mpt_SetPowerTracking(PADAPTER padapter, u8 enable) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ -+ if (!netif_running(padapter->pnetdev)) { -+ return _FAIL; -+ } -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_MP_STATE) == _FALSE) { -+ return _FAIL; -+ } -+ if (enable) -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; -+ else -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _FALSE; -+ -+ return _SUCCESS; -+} -+ -+void hal_mpt_GetPowerTracking(PADAPTER padapter, u8 *enable) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ -+ *enable = pDM_Odm->RFCalibrateInfo.TxPowerTrackControl; -+} -+ -+ -+void hal_mpt_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) -+{ -+ u32 TempVal = 0, TempVal2 = 0, TempVal3 = 0; -+ u32 CurrCCKSwingVal = 0, CCKSwingIndex = 12; -+ u8 i; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ u1Byte u1Channel = pHalData->CurrentChannel; -+ ULONG ulRateIdx = pMptCtx->MptRateIndex; -+ u1Byte DataRate = 0xFF; -+ -+ /* Suggested by BB David. 2015.04.27*/ -+ if(IS_HARDWARE_TYPE_8188F(Adapter)) -+ return; -+ -+ /* Do not modify CCK TX filter parameters for 8822B*/ -+ if(IS_HARDWARE_TYPE_8822B(Adapter) || IS_HARDWARE_TYPE_8821C(Adapter) || IS_HARDWARE_TYPE_8723D(Adapter)) -+ return; -+ -+ DataRate = MptToMgntRate(ulRateIdx); -+ -+ if (u1Channel == 14 && IS_CCK_RATE(DataRate)) -+ pHalData->bCCKinCH14 = TRUE; -+ else -+ pHalData->bCCKinCH14 = FALSE; -+ -+ if (IS_HARDWARE_TYPE_8703B(Adapter)) { -+ if ((u1Channel == 14) && IS_CCK_RATE(DataRate)) { -+ /* Channel 14 in CCK, need to set 0xA26~0xA29 to 0 for 8703B */ -+ PHY_SetBBReg(Adapter, rCCK0_TxFilter2, bMaskHWord, 0); -+ PHY_SetBBReg(Adapter, rCCK0_DebugPort, bMaskLWord, 0); -+ -+ } else { -+ /* Normal setting for 8703B, just recover to the default setting. */ -+ /* This hardcore values reference from the parameter which BB team gave. */ -+ for (i = 0 ; i < 2 ; ++i) -+ PHY_SetBBReg(Adapter, pHalData->RegForRecover[i].offset, bMaskDWord, pHalData->RegForRecover[i].value); -+ -+ } -+ } else if (IS_HARDWARE_TYPE_8723D(Adapter)) { -+ /* 2.4G CCK TX DFIR */ -+ /* 2016.01.20 Suggest from RS BB mingzhi*/ -+ if ((u1Channel == 14)) { -+ PHY_SetBBReg(Adapter, rCCK0_TxFilter2, bMaskDWord, 0x0000B81C); -+ PHY_SetBBReg(Adapter, rCCK0_DebugPort, bMaskDWord, 0x00000000); -+ PHY_SetBBReg(Adapter, 0xAAC, bMaskDWord, 0x00003667); -+ } else { -+ for (i = 0 ; i < 3 ; ++i) { -+ PHY_SetBBReg(Adapter, -+ pHalData->RegForRecover[i].offset, -+ bMaskDWord, -+ pHalData->RegForRecover[i].value); -+ } -+ } -+ } else { -+ -+ /* get current cck swing value and check 0xa22 & 0xa23 later to match the table.*/ -+ CurrCCKSwingVal = read_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord); -+ -+ if (!pHalData->bCCKinCH14) { -+ /* Readback the current bb cck swing value and compare with the table to */ -+ /* get the current swing index */ -+ for (i = 0; i < CCK_TABLE_SIZE; i++) { -+ if (((CurrCCKSwingVal & 0xff) == (u32)CCKSwingTable_Ch1_Ch13[i][0]) && -+ (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)CCKSwingTable_Ch1_Ch13[i][1])) { -+ CCKSwingIndex = i; -+ break; -+ } -+ } -+ -+ /*Write 0xa22 0xa23*/ -+ TempVal = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][0] + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][1] << 8); -+ -+ -+ /*Write 0xa24 ~ 0xa27*/ -+ TempVal2 = 0; -+ TempVal2 = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][2] + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][3] << 8) + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][4] << 16) + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][5] << 24); -+ -+ /*Write 0xa28 0xa29*/ -+ TempVal3 = 0; -+ TempVal3 = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][6] + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][7] << 8); -+ } else { -+ for (i = 0; i < CCK_TABLE_SIZE; i++) { -+ if (((CurrCCKSwingVal & 0xff) == (u32)CCKSwingTable_Ch14[i][0]) && -+ (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)CCKSwingTable_Ch14[i][1])) { -+ CCKSwingIndex = i; -+ break; -+ } -+ } -+ -+ /*Write 0xa22 0xa23*/ -+ TempVal = CCKSwingTable_Ch14[CCKSwingIndex][0] + -+ (CCKSwingTable_Ch14[CCKSwingIndex][1] << 8); -+ -+ /*Write 0xa24 ~ 0xa27*/ -+ TempVal2 = 0; -+ TempVal2 = CCKSwingTable_Ch14[CCKSwingIndex][2] + -+ (CCKSwingTable_Ch14[CCKSwingIndex][3] << 8) + -+ (CCKSwingTable_Ch14[CCKSwingIndex][4] << 16) + -+ (CCKSwingTable_Ch14[CCKSwingIndex][5] << 24); -+ -+ /*Write 0xa28 0xa29*/ -+ TempVal3 = 0; -+ TempVal3 = CCKSwingTable_Ch14[CCKSwingIndex][6] + -+ (CCKSwingTable_Ch14[CCKSwingIndex][7] << 8); -+ } -+ -+ write_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord, TempVal); -+ write_bbreg(Adapter, rCCK0_TxFilter2, bMaskDWord, TempVal2); -+ write_bbreg(Adapter, rCCK0_DebugPort, bMaskLWord, TempVal3); -+ } -+ -+} -+ -+void hal_mpt_SetChannel(PADAPTER pAdapter) -+{ -+ u8 eRFPath; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ struct mp_priv *pmp = &pAdapter->mppriv; -+ u8 channel = pmp->channel; -+ u8 bandwidth = pmp->bandwidth; -+ -+ hal_mpt_SwitchRfSetting(pAdapter); -+ -+ pHalData->bSwChnl = _TRUE; -+ pHalData->bSetChnlBW = _TRUE; -+ rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, 0, 0); -+ -+ hal_mpt_CCKTxPowerAdjust(pAdapter, pHalData->bCCKinCH14); -+ -+} -+ -+/* -+ * Notice -+ * Switch bandwitdth may change center frequency(channel) -+ */ -+void hal_mpt_SetBandwidth(PADAPTER pAdapter) -+{ -+ struct mp_priv *pmp = &pAdapter->mppriv; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ u8 channel = pmp->channel; -+ u8 bandwidth = pmp->bandwidth; -+ -+ pHalData->bSwChnl = _TRUE; -+ pHalData->bSetChnlBW = _TRUE; -+ rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, 0, 0); -+ -+ hal_mpt_SwitchRfSetting(pAdapter); -+} -+ -+void mpt_SetTxPower_Old(PADAPTER pAdapter, MPT_TXPWR_DEF Rate, u8 *pTxPower) -+{ -+ switch (Rate) { -+ case MPT_CCK: { -+ u4Byte TxAGC = 0, pwr = 0; -+ u1Byte rf; -+ -+ pwr = pTxPower[ODM_RF_PATH_A]; -+ if (pwr < 0x3f) { -+ TxAGC = (pwr << 16) | (pwr << 8) | (pwr); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pTxPower[ODM_RF_PATH_A]); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, 0xffffff00, TxAGC); -+ } -+ pwr = pTxPower[ODM_RF_PATH_B]; -+ if (pwr < 0x3f) { -+ TxAGC = (pwr << 16) | (pwr << 8) | (pwr); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte0, pTxPower[ODM_RF_PATH_B]); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_CCK1_55_Mcs32, 0xffffff00, TxAGC); -+ } -+ } -+ break; -+ -+ case MPT_OFDM_AND_HT: { -+ u4Byte TxAGC = 0; -+ u1Byte pwr = 0, rf; -+ -+ pwr = pTxPower[0]; -+ if (pwr < 0x3f) { -+ TxAGC |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); -+ RTW_INFO("HT Tx-rf(A) Power = 0x%x\n", TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs11_Mcs08, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs15_Mcs12, bMaskDWord, TxAGC); -+ } -+ TxAGC = 0; -+ pwr = pTxPower[1]; -+ if (pwr < 0x3f) { -+ TxAGC |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); -+ RTW_INFO("HT Tx-rf(B) Power = 0x%x\n", TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_Rate18_06, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_Rate54_24, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs11_Mcs08, bMaskDWord, TxAGC); -+ PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs15_Mcs12, bMaskDWord, TxAGC); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+ RTW_INFO("<===mpt_SetTxPower_Old()\n"); -+} -+ -+void -+mpt_SetTxPower( -+ PADAPTER pAdapter, -+ MPT_TXPWR_DEF Rate, -+ pu1Byte pTxPower -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ u1Byte path = 0 , i = 0, MaxRate = MGN_6M; -+ u1Byte StartPath = ODM_RF_PATH_A, EndPath = ODM_RF_PATH_B; -+ -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ EndPath = ODM_RF_PATH_D; -+ else if (IS_HARDWARE_TYPE_8188F(pAdapter) || IS_HARDWARE_TYPE_8723D(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter)) -+ EndPath = ODM_RF_PATH_A; -+ -+ switch (Rate) { -+ case MPT_CCK: { -+ u1Byte rate[] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}; -+ -+ for (path = StartPath; path <= EndPath; path++) -+ for (i = 0; i < sizeof(rate); ++i) -+ PHY_SetTxPowerIndex(pAdapter, pTxPower[path], path, rate[i]); -+ } -+ break; -+ case MPT_OFDM: { -+ u1Byte rate[] = { -+ MGN_6M, MGN_9M, MGN_12M, MGN_18M, -+ MGN_24M, MGN_36M, MGN_48M, MGN_54M, -+ }; -+ -+ for (path = StartPath; path <= EndPath; path++) -+ for (i = 0; i < sizeof(rate); ++i) -+ PHY_SetTxPowerIndex(pAdapter, pTxPower[path], path, rate[i]); -+ } -+ break; -+ case MPT_HT: { -+ u1Byte rate[] = { -+ MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, -+ MGN_MCS5, MGN_MCS6, MGN_MCS7, MGN_MCS8, MGN_MCS9, -+ MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, -+ MGN_MCS15, MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, -+ MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23, MGN_MCS24, -+ MGN_MCS25, MGN_MCS26, MGN_MCS27, MGN_MCS28, MGN_MCS29, -+ MGN_MCS30, MGN_MCS31, -+ }; -+ if (pHalData->rf_type == RF_3T3R) -+ MaxRate = MGN_MCS23; -+ else if (pHalData->rf_type == RF_2T2R) -+ MaxRate = MGN_MCS15; -+ else -+ MaxRate = MGN_MCS7; -+ for (path = StartPath; path <= EndPath; path++) { -+ for (i = 0; i < sizeof(rate); ++i) { -+ if (rate[i] > MaxRate) -+ break; -+ PHY_SetTxPowerIndex(pAdapter, pTxPower[path], path, rate[i]); -+ } -+ } -+ } -+ break; -+ case MPT_VHT: { -+ u1Byte rate[] = { -+ MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4, -+ MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9, -+ MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, -+ MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9, -+ MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4, -+ MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9, -+ MGN_VHT4SS_MCS0, MGN_VHT4SS_MCS1, MGN_VHT4SS_MCS2, MGN_VHT4SS_MCS3, MGN_VHT4SS_MCS4, -+ MGN_VHT4SS_MCS5, MGN_VHT4SS_MCS6, MGN_VHT4SS_MCS7, MGN_VHT4SS_MCS8, MGN_VHT4SS_MCS9, -+ }; -+ if (pHalData->rf_type == RF_3T3R) -+ MaxRate = MGN_VHT3SS_MCS9; -+ else if (pHalData->rf_type == RF_2T2R || pHalData->rf_type == RF_2T4R) -+ MaxRate = MGN_VHT2SS_MCS9; -+ else -+ MaxRate = MGN_VHT1SS_MCS9; -+ -+ for (path = StartPath; path <= EndPath; path++) { -+ for (i = 0; i < sizeof(rate); ++i) { -+ if (rate[i] > MaxRate) -+ break; -+ PHY_SetTxPowerIndex(pAdapter, pTxPower[path], path, rate[i]); -+ } -+ } -+ } -+ break; -+ default: -+ RTW_INFO("<===mpt_SetTxPower: Illegal channel!!\n"); -+ break; -+ } -+} -+ -+void hal_mpt_SetTxPower(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ if (pHalData->rf_chip < RF_TYPE_MAX) { -+ if (IS_HARDWARE_TYPE_8188E(pAdapter) || -+ IS_HARDWARE_TYPE_8723B(pAdapter) || -+ IS_HARDWARE_TYPE_8192E(pAdapter) || -+ IS_HARDWARE_TYPE_8703B(pAdapter) || -+ IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ u8 path = (pHalData->AntennaTxPath == ANTENNA_A) ? (ODM_RF_PATH_A) : (ODM_RF_PATH_B); -+ -+ RTW_INFO("===> MPT_ProSetTxPower: Old\n"); -+ -+ mpt_SetTxPower_Old(pAdapter, MPT_CCK, pMptCtx->TxPwrLevel); -+ mpt_SetTxPower_Old(pAdapter, MPT_OFDM_AND_HT, pMptCtx->TxPwrLevel); -+ -+ } else { -+ RTW_INFO("===> MPT_ProSetTxPower: Jaguar/Jaguar2\n"); -+ mpt_SetTxPower(pAdapter, MPT_CCK, pMptCtx->TxPwrLevel); -+ mpt_SetTxPower(pAdapter, MPT_OFDM, pMptCtx->TxPwrLevel); -+ mpt_SetTxPower(pAdapter, MPT_HT, pMptCtx->TxPwrLevel); -+ mpt_SetTxPower(pAdapter, MPT_VHT, pMptCtx->TxPwrLevel); -+ -+ } -+ } else -+ RTW_INFO("RFChipID < RF_TYPE_MAX, the RF chip is not supported - %d\n", pHalData->rf_chip); -+ -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+} -+ -+void hal_mpt_SetDataRate(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u32 DataRate; -+ -+ DataRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ -+ hal_mpt_SwitchRfSetting(pAdapter); -+ -+ hal_mpt_CCKTxPowerAdjust(pAdapter, pHalData->bCCKinCH14); -+#ifdef CONFIG_RTL8723B -+ if (IS_HARDWARE_TYPE_8723B(pAdapter) || IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ if (IS_CCK_RATE(DataRate)) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, 0xF, 0x6); -+ else -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0x6); -+ } else { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, 0xF, 0xE); -+ else -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0xE); -+ } -+ } -+ -+ if ((IS_HARDWARE_TYPE_8723BS(pAdapter) && -+ ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)))) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, 0xF, 0xE); -+ else -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0xE); -+ } -+#endif -+} -+ -+#define RF_PATH_AB 22 -+ -+#ifdef CONFIG_RTL8814A -+VOID mpt_ToggleIG_8814A(PADAPTER pAdapter) -+{ -+ u1Byte Path = 0; -+ u4Byte IGReg = rA_IGI_Jaguar, IGvalue = 0; -+ -+ for (Path; Path <= ODM_RF_PATH_D; Path++) { -+ switch (Path) { -+ case ODM_RF_PATH_B: -+ IGReg = rB_IGI_Jaguar; -+ break; -+ case ODM_RF_PATH_C: -+ IGReg = rC_IGI_Jaguar2; -+ break; -+ case ODM_RF_PATH_D: -+ IGReg = rD_IGI_Jaguar2; -+ break; -+ default: -+ IGReg = rA_IGI_Jaguar; -+ break; -+ } -+ -+ IGvalue = PHY_QueryBBReg(pAdapter, IGReg, bMaskByte0); -+ PHY_SetBBReg(pAdapter, IGReg, bMaskByte0, IGvalue + 2); -+ PHY_SetBBReg(pAdapter, IGReg, bMaskByte0, IGvalue); -+ } -+} -+ -+VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; -+ R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ -+ R_ANTENNA_SELECT_CCK *p_cck_txrx; -+ u8 ForcedDataRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ u8 HtStbcCap = pAdapter->registrypriv.stbc_cap; -+ /*/PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pMgntInfo);*/ -+ /*/PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pMgntInfo);*/ -+ -+ u32 ulAntennaTx = pHalData->AntennaTxPath; -+ u32 ulAntennaRx = pHalData->AntennaRxPath; -+ u8 NssforRate = MgntQuery_NssTxRate(ForcedDataRate); -+ -+ if ((NssforRate == RF_2TX) || ((NssforRate == RF_1TX) && IS_HT_RATE(ForcedDataRate)) || ((NssforRate == RF_1TX) && IS_VHT_RATE(ForcedDataRate))) { -+ RTW_INFO("===> SetAntenna 2T ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_BC: -+ pMptCtx->MptRfPath = ODM_RF_PATH_BC; -+ /*pHalData->ValidTxPath = 0x06; linux no use */ -+ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x106); /*/ 0x940[15:4]=12'b0000_0100_0011*/ -+ break; -+ -+ case ANTENNA_CD: -+ pMptCtx->MptRfPath = ODM_RF_PATH_CD; -+ /*pHalData->ValidTxPath = 0x0C;*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x40c); /*/ 0x940[15:4]=12'b0000_0100_0011*/ -+ break; -+ case ANTENNA_AB: -+ default: -+ pMptCtx->MptRfPath = ODM_RF_PATH_AB; -+ /*pHalData->ValidTxPath = 0x03;*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x043); /*/ 0x940[15:4]=12'b0000_0100_0011*/ -+ break; -+ } -+ -+ } else if (NssforRate == RF_3TX) { -+ RTW_INFO("===> SetAntenna 3T ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_BCD: -+ pMptCtx->MptRfPath = ODM_RF_PATH_BCD; -+ /*pHalData->ValidTxPath = 0x0e;*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x90e); /*/ 0x940[27:16]=12'b0010_0100_0111*/ -+ break; -+ -+ case ANTENNA_ABC: -+ default: -+ pMptCtx->MptRfPath = ODM_RF_PATH_ABC; -+ /*pHalData->ValidTxPath = 0x0d;*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x247); /*/ 0x940[27:16]=12'b0010_0100_0111*/ -+ break; -+ } -+ -+ } else { /*/if(NssforRate == RF_1TX)*/ -+ RTW_INFO("===> SetAntenna 1T ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); -+ switch (ulAntennaTx) { -+ case ANTENNA_BCD: -+ pMptCtx->MptRfPath = ODM_RF_PATH_BCD; -+ /*pHalData->ValidTxPath = 0x0e;*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x7); -+ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0x000f00000, 0xe); -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0xe); -+ break; -+ -+ case ANTENNA_BC: -+ pMptCtx->MptRfPath = ODM_RF_PATH_BC; -+ /*pHalData->ValidTxPath = 0x06;*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x6); -+ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0x000f00000, 0x6); -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x6); -+ break; -+ case ANTENNA_B: -+ pMptCtx->MptRfPath = ODM_RF_PATH_B; -+ /*pHalData->ValidTxPath = 0x02;*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x4); /*/ 0xa07[7:4] = 4'b0100*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x002); /*/ 0x93C[31:20]=12'b0000_0000_0010*/ -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x2); /* 0x80C[7:4] = 4'b0010*/ -+ break; -+ -+ case ANTENNA_C: -+ pMptCtx->MptRfPath = ODM_RF_PATH_C; -+ /*pHalData->ValidTxPath = 0x04;*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x2); /*/ 0xa07[7:4] = 4'b0010*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x004); /*/ 0x93C[31:20]=12'b0000_0000_0100*/ -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x4); /*/ 0x80C[7:4] = 4'b0100*/ -+ break; -+ -+ case ANTENNA_D: -+ pMptCtx->MptRfPath = ODM_RF_PATH_D; -+ /*pHalData->ValidTxPath = 0x08;*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x1); /*/ 0xa07[7:4] = 4'b0001*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x008); /*/ 0x93C[31:20]=12'b0000_0000_1000*/ -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x8); /*/ 0x80C[7:4] = 4'b1000*/ -+ break; -+ -+ case ANTENNA_A: -+ default: -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ /*pHalData->ValidTxPath = 0x01;*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x8); /*/ 0xa07[7:4] = 4'b1000*/ -+ PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x001); /*/ 0x93C[31:20]=12'b0000_0000_0001*/ -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x1); /*/ 0x80C[7:4] = 4'b0001*/ -+ break; -+ } -+ } -+ -+ switch (ulAntennaRx) { -+ case ANTENNA_A: -+ /*pHalData->ValidRxPath = 0x01;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x0); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_B: -+ /*pHalData->ValidRxPath = 0x02;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x1); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_C: -+ /*pHalData->ValidRxPath = 0x04;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x44); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x2); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_D: -+ /*pHalData->ValidRxPath = 0x08;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x88); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x3); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_BC: -+ /*pHalData->ValidRxPath = 0x06;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x66); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x6); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_CD: -+ /*pHalData->ValidRxPath = 0x0C;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xcc); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0xB); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); -+ break; -+ -+ case ANTENNA_BCD: -+ /*pHalData->ValidRxPath = 0x0e;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xee); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x6); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, Rx mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); -+ break; -+ -+ case ANTENNA_ABCD: -+ /*pHalData->ValidRxPath = 0x0f;*/ -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xff); -+ PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x1); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ -+ /*/ CCA related PD_delay_th*/ -+ PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); -+ break; -+ -+ default: -+ break; -+ } -+ -+ PHY_Set_SecCCATH_by_RXANT_8814A(pAdapter, ulAntennaRx); -+ -+ mpt_ToggleIG_8814A(pAdapter); -+} -+#endif /* CONFIG_RTL8814A */ -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+VOID -+mpt_SetSingleTone_8814A( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bSingleTone, -+ IN BOOLEAN bEnPMacTx) -+{ -+ -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u1Byte StartPath = ODM_RF_PATH_A, EndPath = ODM_RF_PATH_A; -+ static u4Byte regIG0 = 0, regIG1 = 0, regIG2 = 0, regIG3 = 0; -+ -+ if (bSingleTone) { -+ regIG0 = PHY_QueryBBReg(pAdapter, rA_TxScale_Jaguar, bMaskDWord); /*/ 0xC1C[31:21]*/ -+ regIG1 = PHY_QueryBBReg(pAdapter, rB_TxScale_Jaguar, bMaskDWord); /*/ 0xE1C[31:21]*/ -+ regIG2 = PHY_QueryBBReg(pAdapter, rC_TxScale_Jaguar2, bMaskDWord); /*/ 0x181C[31:21]*/ -+ regIG3 = PHY_QueryBBReg(pAdapter, rD_TxScale_Jaguar2, bMaskDWord); /*/ 0x1A1C[31:21]*/ -+ -+ switch (pMptCtx->MptRfPath) { -+ case ODM_RF_PATH_A: -+ case ODM_RF_PATH_B: -+ case ODM_RF_PATH_C: -+ case ODM_RF_PATH_D: -+ StartPath = pMptCtx->MptRfPath; -+ EndPath = pMptCtx->MptRfPath; -+ break; -+ case ODM_RF_PATH_AB: -+ EndPath = ODM_RF_PATH_B; -+ break; -+ case ODM_RF_PATH_BC: -+ StartPath = ODM_RF_PATH_B; -+ EndPath = ODM_RF_PATH_C; -+ break; -+ case ODM_RF_PATH_ABC: -+ EndPath = ODM_RF_PATH_C; -+ break; -+ case ODM_RF_PATH_BCD: -+ StartPath = ODM_RF_PATH_B; -+ EndPath = ODM_RF_PATH_D; -+ break; -+ case ODM_RF_PATH_ABCD: -+ EndPath = ODM_RF_PATH_D; -+ break; -+ } -+ -+ if (bEnPMacTx == FALSE) { -+ hal_mpt_SetOFDMContinuousTx(pAdapter, _TRUE); -+ issue_nulldata(pAdapter, NULL, 1, 3, 500); -+ } -+ -+ PHY_SetBBReg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); /*/ Disable CCA*/ -+ -+ for (StartPath; StartPath <= EndPath; StartPath++) { -+ PHY_SetRFReg(pAdapter, StartPath, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ -+ PHY_SetRFReg(pAdapter, StartPath, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ -+ -+ PHY_SetRFReg(pAdapter, StartPath, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ -+ } -+ -+ PHY_SetBBReg(pAdapter, rA_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xC1C[31:21]*/ -+ PHY_SetBBReg(pAdapter, rB_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xE1C[31:21]*/ -+ PHY_SetBBReg(pAdapter, rC_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x181C[31:21]*/ -+ PHY_SetBBReg(pAdapter, rD_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x1A1C[31:21]*/ -+ } else { -+ switch (pMptCtx->MptRfPath) { -+ case ODM_RF_PATH_A: -+ case ODM_RF_PATH_B: -+ case ODM_RF_PATH_C: -+ case ODM_RF_PATH_D: -+ StartPath = pMptCtx->MptRfPath; -+ EndPath = pMptCtx->MptRfPath; -+ break; -+ case ODM_RF_PATH_AB: -+ EndPath = ODM_RF_PATH_B; -+ break; -+ case ODM_RF_PATH_BC: -+ StartPath = ODM_RF_PATH_B; -+ EndPath = ODM_RF_PATH_C; -+ break; -+ case ODM_RF_PATH_ABC: -+ EndPath = ODM_RF_PATH_C; -+ break; -+ case ODM_RF_PATH_BCD: -+ StartPath = ODM_RF_PATH_B; -+ EndPath = ODM_RF_PATH_D; -+ break; -+ case ODM_RF_PATH_ABCD: -+ EndPath = ODM_RF_PATH_D; -+ break; -+ } -+ for (StartPath; StartPath <= EndPath; StartPath++) -+ PHY_SetRFReg(pAdapter, StartPath, LNA_Low_Gain_3, BIT1, 0x0); /* RF LO disabled */ -+ -+ PHY_SetBBReg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); /* Enable CCA*/ -+ -+ if (bEnPMacTx == FALSE) -+ hal_mpt_SetOFDMContinuousTx(pAdapter, _FALSE); -+ -+ PHY_SetBBReg(pAdapter, rA_TxScale_Jaguar, bMaskDWord, regIG0); /* 0xC1C[31:21]*/ -+ PHY_SetBBReg(pAdapter, rB_TxScale_Jaguar, bMaskDWord, regIG1); /* 0xE1C[31:21]*/ -+ PHY_SetBBReg(pAdapter, rC_TxScale_Jaguar2, bMaskDWord, regIG2); /* 0x181C[31:21]*/ -+ PHY_SetBBReg(pAdapter, rD_TxScale_Jaguar2, bMaskDWord, regIG3); /* 0x1A1C[31:21]*/ -+ } -+} -+ -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+void mpt_SetRFPath_8812A(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; -+ struct mp_priv *pmp = &pAdapter->mppriv; -+ u8 channel = pmp->channel; -+ u8 bandwidth = pmp->bandwidth; -+ u8 eLNA_2g = pHalData->ExternalLNA_2G; -+ u32 ulAntennaTx, ulAntennaRx; -+ -+ ulAntennaTx = pHalData->AntennaTxPath; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_A: -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x1111); -+ if (pHalData->RFEType == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) -+ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0); -+ break; -+ case ANTENNA_B: -+ pMptCtx->MptRfPath = ODM_RF_PATH_B; -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x2222); -+ if (pHalData->RFEType == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) -+ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x1); -+ break; -+ case ANTENNA_AB: -+ pMptCtx->MptRfPath = ODM_RF_PATH_AB; -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x3333); -+ if (pHalData->RFEType == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) -+ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0); -+ break; -+ default: -+ pMptCtx->MptRfPath = ODM_RF_PATH_AB; -+ RTW_INFO("Unknown Tx antenna.\n"); -+ break; -+ } -+ -+ switch (ulAntennaRx) { -+ u32 reg0xC50 = 0; -+ case ANTENNA_A: -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, BIT19 | BIT18 | BIT17 | BIT16, 0x3); -+ -+ /*/ <20121101, Kordan> To prevent gain table from not switched, asked by Ynlin.*/ -+ reg0xC50 = PHY_QueryBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0); -+ PHY_SetBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50 + 2); -+ PHY_SetBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50); -+ -+ /* set PWED_TH for BB Yn user guide R29 */ -+ if (IS_HARDWARE_TYPE_8812(pAdapter)) { -+ if (channel <= 14) { /* 2.4G */ -+ if (bandwidth == CHANNEL_WIDTH_20 -+ && eLNA_2g == 0) { -+ /* 0x830[3:1]=3'b010 */ -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x02); -+ } else -+ /* 0x830[3:1]=3'b100 */ -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); -+ } else -+ /* 0x830[3:1]=3'b100 for 5G */ -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); -+ } -+ break; -+ case ANTENNA_B: -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1);/*/ RF_A_0x0[19:16] = 1, Standby mode */ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x1); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, BIT19 | BIT18 | BIT17 | BIT16, 0x3); -+ -+ /*/ <20121101, Kordan> To prevent gain table from not switched, asked by Ynlin.*/ -+ reg0xC50 = PHY_QueryBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0); -+ PHY_SetBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50 + 2); -+ PHY_SetBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50); -+ -+ /* set PWED_TH for BB Yn user guide R29 */ -+ if (IS_HARDWARE_TYPE_8812(pAdapter)) { -+ if (channel <= 14) { -+ if (bandwidth == CHANNEL_WIDTH_20 -+ && eLNA_2g == 0) { -+ /* 0x830[3:1]=3'b010 */ -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x02); -+ } else -+ /* 0x830[3:1]=3'b100 */ -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); -+ } else -+ /* 0x830[3:1]=3'b100 for 5G */ -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); -+ } -+ break; -+ case ANTENNA_AB: -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x33); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, Rx mode*/ -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); -+ /* set PWED_TH for BB Yn user guide R29 */ -+ PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); -+ break; -+ default: -+ RTW_INFO("Unknown Rx antenna.\n"); -+ break; -+ } -+} -+#endif -+ -+#ifdef CONFIG_RTL8723B -+void mpt_SetRFPath_8723B(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u32 ulAntennaTx, ulAntennaRx; -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ulAntennaTx = pHalData->AntennaTxPath; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ if (pHalData->rf_chip >= RF_TYPE_MAX) { -+ RTW_INFO("This RF chip ID is not supported\n"); -+ return; -+ } -+ -+ switch (pAdapter->mppriv.antenna_tx) { -+ u8 p = 0, i = 0; -+ case ANTENNA_A: { /*/ Actually path S1 (Wi-Fi)*/ -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x0); -+ PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x0); /* AGC Table Sel*/ -+ -+ /*/<20130522, Kordan> 0x51 and 0x71 should be set immediately after path switched, or they might be overwritten.*/ -+ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)) -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); -+ else -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); -+ -+ for (i = 0; i < 3; ++i) { -+ u4Byte offset = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_A][i][0]; -+ u4Byte data = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_A][i][1]; -+ -+ if (offset != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ RTW_INFO("Switch to S1 TxIQC(offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ for (i = 0; i < 2; ++i) { -+ u4Byte offset = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_A][i][0]; -+ u4Byte data = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_A][i][1]; -+ -+ if (offset != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ RTW_INFO("Switch to S1 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ } -+ break; -+ case ANTENNA_B: { /*/ Actually path S0 (BT)*/ -+ u4Byte offset; -+ u4Byte data; -+ -+ pMptCtx->MptRfPath = ODM_RF_PATH_B; -+ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x5); -+ PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x1); /*/ AGC Table Sel.*/ -+ /* <20130522, Kordan> 0x51 and 0x71 should be set immediately after path switched, or they might be overwritten.*/ -+ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)) -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); -+ else -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); -+ -+ for (i = 0; i < 3; ++i) { -+ /*/ <20130603, Kordan> Because BB suppors only 1T1R, we restore IQC to S1 instead of S0.*/ -+ offset = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_A][i][0]; -+ data = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_B][i][1]; -+ if (pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_B][i][0] != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ RTW_INFO("Switch to S0 TxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ /*/ <20130603, Kordan> Because BB suppors only 1T1R, we restore IQC to S1 instead of S0.*/ -+ for (i = 0; i < 2; ++i) { -+ offset = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_A][i][0]; -+ data = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_B][i][1]; -+ if (pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_B][i][0] != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ RTW_INFO("Switch to S0 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ } -+ break; -+ default: -+ pMptCtx->MptRfPath = RF_PATH_AB; -+ break; -+ } -+} -+#endif -+ -+#ifdef CONFIG_RTL8703B -+void mpt_SetRFPath_8703B(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u4Byte ulAntennaTx, ulAntennaRx; -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ulAntennaTx = pHalData->AntennaTxPath; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ if (pHalData->rf_chip >= RF_TYPE_MAX) { -+ RTW_INFO("This RF chip ID is not supported\n"); -+ return; -+ } -+ -+ switch (pAdapter->mppriv.antenna_tx) { -+ u1Byte p = 0, i = 0; -+ -+ case ANTENNA_A: { /* Actually path S1 (Wi-Fi) */ -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x0); -+ PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x0); /* AGC Table Sel*/ -+ -+ for (i = 0; i < 3; ++i) { -+ u4Byte offset = pRFCalibrateInfo->TxIQC_8703B[i][0]; -+ u4Byte data = pRFCalibrateInfo->TxIQC_8703B[i][1]; -+ -+ if (offset != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ RTW_INFO("Switch to S1 TxIQC(offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ -+ } -+ for (i = 0; i < 2; ++i) { -+ u4Byte offset = pRFCalibrateInfo->RxIQC_8703B[i][0]; -+ u4Byte data = pRFCalibrateInfo->RxIQC_8703B[i][1]; -+ -+ if (offset != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ RTW_INFO("Switch to S1 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ } -+ break; -+ case ANTENNA_B: { /* Actually path S0 (BT)*/ -+ pMptCtx->MptRfPath = ODM_RF_PATH_B; -+ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x5); -+ PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x1); /* AGC Table Sel */ -+ -+ for (i = 0; i < 3; ++i) { -+ u4Byte offset = pRFCalibrateInfo->TxIQC_8703B[i][0]; -+ u4Byte data = pRFCalibrateInfo->TxIQC_8703B[i][1]; -+ -+ if (pRFCalibrateInfo->TxIQC_8703B[i][0] != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ RTW_INFO("Switch to S0 TxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ for (i = 0; i < 2; ++i) { -+ u4Byte offset = pRFCalibrateInfo->RxIQC_8703B[i][0]; -+ u4Byte data = pRFCalibrateInfo->RxIQC_8703B[i][1]; -+ -+ if (pRFCalibrateInfo->RxIQC_8703B[i][0] != 0) { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); -+ RTW_INFO("Switch to S0 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); -+ } -+ } -+ } -+ break; -+ default: -+ pMptCtx->MptRfPath = RF_PATH_AB; -+ break; -+ } -+ -+} -+#endif -+ -+#ifdef CONFIG_RTL8723D -+void mpt_SetRFPath_8723D(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u1Byte p = 0, i = 0; -+ u4Byte ulAntennaTx, ulAntennaRx, offset = 0, data = 0, val32 = 0; -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ulAntennaTx = pHalData->AntennaTxPath; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ if (pHalData->rf_chip >= RF_TYPE_MAX) { -+ RTW_INFO("This RF chip ID is not supported\n"); -+ return; -+ } -+ -+ switch (pAdapter->mppriv.antenna_tx) { -+ /* Actually path S1 (Wi-Fi) */ -+ case ANTENNA_A: { -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7|BIT6, 0); -+ } -+ break; -+ /* Actually path S0 (BT) */ -+ case ANTENNA_B: { -+ pMptCtx->MptRfPath = ODM_RF_PATH_B; -+ PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7|BIT6, 0xA); -+ -+ } -+ break; -+ default: -+ pMptCtx->MptRfPath = RF_PATH_AB; -+ break; -+ } -+} -+#endif -+ -+VOID mpt_SetRFPath_819X(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u4Byte ulAntennaTx, ulAntennaRx; -+ R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ -+ R_ANTENNA_SELECT_CCK *p_cck_txrx; -+ u1Byte r_rx_antenna_ofdm = 0, r_ant_select_cck_val = 0; -+ u1Byte chgTx = 0, chgRx = 0; -+ u4Byte r_ant_sel_cck_val = 0, r_ant_select_ofdm_val = 0, r_ofdm_tx_en_val = 0; -+ -+ ulAntennaTx = pHalData->AntennaTxPath; -+ ulAntennaRx = pHalData->AntennaRxPath; -+ -+ p_ofdm_tx = (R_ANTENNA_SELECT_OFDM *)&r_ant_select_ofdm_val; -+ p_cck_txrx = (R_ANTENNA_SELECT_CCK *)&r_ant_select_cck_val; -+ -+ p_ofdm_tx->r_ant_ht1 = 0x1; -+ p_ofdm_tx->r_ant_ht2 = 0x2;/*Second TX RF path is A*/ -+ p_ofdm_tx->r_ant_non_ht = 0x3;/*/ 0x1+0x2=0x3 */ -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_A: -+ p_ofdm_tx->r_tx_antenna = 0x1; -+ r_ofdm_tx_en_val = 0x1; -+ p_ofdm_tx->r_ant_l = 0x1; -+ p_ofdm_tx->r_ant_ht_s1 = 0x1; -+ p_ofdm_tx->r_ant_non_ht_s1 = 0x1; -+ p_cck_txrx->r_ccktx_enable = 0x8; -+ chgTx = 1; -+ /*/ From SD3 Willis suggestion !!! Set RF A=TX and B as standby*/ -+ /*/if (IS_HARDWARE_TYPE_8192S(pAdapter))*/ -+ { -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 2); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 1); -+ r_ofdm_tx_en_val = 0x3; -+ /*/ Power save*/ -+ /*/cosa r_ant_select_ofdm_val = 0x11111111;*/ -+ /*/ We need to close RFB by SW control*/ -+ if (pHalData->rf_type == RF_2T2R) { -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 1); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 1); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 0); -+ } -+ } -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ break; -+ case ANTENNA_B: -+ p_ofdm_tx->r_tx_antenna = 0x2; -+ r_ofdm_tx_en_val = 0x2; -+ p_ofdm_tx->r_ant_l = 0x2; -+ p_ofdm_tx->r_ant_ht_s1 = 0x2; -+ p_ofdm_tx->r_ant_non_ht_s1 = 0x2; -+ p_cck_txrx->r_ccktx_enable = 0x4; -+ chgTx = 1; -+ /*/ From SD3 Willis suggestion !!! Set RF A as standby*/ -+ /*/if (IS_HARDWARE_TYPE_8192S(pAdapter))*/ -+ { -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 1); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 2); -+ -+ /*/ 2008/10/31 MH From SD3 Willi's suggestion. We must read RF 1T table.*/ -+ /*/ 2009/01/08 MH From Sd3 Willis. We need to close RFA by SW control*/ -+ if (pHalData->rf_type == RF_2T2R || pHalData->rf_type == RF_1T2R) { -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 1); -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_RFInterfaceOE, BIT10, 0); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0); -+ /*/PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0);*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 0); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); -+ } -+ } -+ pMptCtx->MptRfPath = ODM_RF_PATH_B; -+ break; -+ case ANTENNA_AB:/*/ For 8192S*/ -+ p_ofdm_tx->r_tx_antenna = 0x3; -+ r_ofdm_tx_en_val = 0x3; -+ p_ofdm_tx->r_ant_l = 0x3; -+ p_ofdm_tx->r_ant_ht_s1 = 0x3; -+ p_ofdm_tx->r_ant_non_ht_s1 = 0x3; -+ p_cck_txrx->r_ccktx_enable = 0xC; -+ chgTx = 1; -+ /*/ From SD3Willis suggestion !!! Set RF B as standby*/ -+ /*/if (IS_HARDWARE_TYPE_8192S(pAdapter))*/ -+ { -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 2); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 2); -+ /* Disable Power save*/ -+ /*cosa r_ant_select_ofdm_val = 0x3321333;*/ -+ /* 2009/01/08 MH From Sd3 Willis. We need to enable RFA/B by SW control*/ -+ if (pHalData->rf_type == RF_2T2R) { -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0); -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0); -+ /*/PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0);*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 1); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); -+ } -+ } -+ pMptCtx->MptRfPath = ODM_RF_PATH_AB; -+ break; -+ default: -+ break; -+ } -+#if 0 -+ /* r_rx_antenna_ofdm, bit0=A, bit1=B, bit2=C, bit3=D */ -+ /* r_cckrx_enable : CCK default, 0=A, 1=B, 2=C, 3=D */ -+ /* r_cckrx_enable_2 : CCK option, 0=A, 1=B, 2=C, 3=D */ -+#endif -+ switch (ulAntennaRx) { -+ case ANTENNA_A: -+ r_rx_antenna_ofdm = 0x1; /* A*/ -+ p_cck_txrx->r_cckrx_enable = 0x0; /* default: A*/ -+ p_cck_txrx->r_cckrx_enable_2 = 0x0; /* option: A*/ -+ chgRx = 1; -+ break; -+ case ANTENNA_B: -+ r_rx_antenna_ofdm = 0x2; /*/ B*/ -+ p_cck_txrx->r_cckrx_enable = 0x1; /*/ default: B*/ -+ p_cck_txrx->r_cckrx_enable_2 = 0x1; /*/ option: B*/ -+ chgRx = 1; -+ break; -+ case ANTENNA_AB:/*/ For 8192S and 8192E/U...*/ -+ r_rx_antenna_ofdm = 0x3;/*/ AB*/ -+ p_cck_txrx->r_cckrx_enable = 0x0;/*/ default:A*/ -+ p_cck_txrx->r_cckrx_enable_2 = 0x1;/*/ option:B*/ -+ chgRx = 1; -+ break; -+ default: -+ break; -+ } -+ -+ -+ if (chgTx && chgRx) { -+ switch (pHalData->rf_chip) { -+ case RF_8225: -+ case RF_8256: -+ case RF_6052: -+ /*/r_ant_sel_cck_val = r_ant_select_cck_val;*/ -+ PHY_SetBBReg(pAdapter, rFPGA1_TxInfo, 0x7fffffff, r_ant_select_ofdm_val); /*/OFDM Tx*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_TxInfo, 0x0000000f, r_ofdm_tx_en_val); /*/OFDM Tx*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRxPathEnable, 0x0000000f, r_rx_antenna_ofdm); /*/OFDM Rx*/ -+ PHY_SetBBReg(pAdapter, rOFDM1_TRxPathEnable, 0x0000000f, r_rx_antenna_ofdm); /*/OFDM Rx*/ -+ if (IS_HARDWARE_TYPE_8192E(pAdapter)) { -+ PHY_SetBBReg(pAdapter, rOFDM0_TRxPathEnable, 0x000000F0, r_rx_antenna_ofdm); /*/OFDM Rx*/ -+ PHY_SetBBReg(pAdapter, rOFDM1_TRxPathEnable, 0x000000F0, r_rx_antenna_ofdm); /*/OFDM Rx*/ -+ } -+ PHY_SetBBReg(pAdapter, rCCK0_AFESetting, bMaskByte3, r_ant_select_cck_val);/*/r_ant_sel_cck_val); /CCK TxRx*/ -+ break; -+ -+ default: -+ RTW_INFO("Unsupported RFChipID for switching antenna.\n"); -+ break; -+ } -+ } -+} /* MPT_ProSetRFPath */ -+ -+ -+void hal_mpt_SetAntenna(PADAPTER pAdapter) -+ -+{ -+ RTW_INFO("Do %s\n", __func__); -+#ifdef CONFIG_RTL8814A -+ if (IS_HARDWARE_TYPE_8814A(pAdapter)) { -+ mpt_SetRFPath_8814A(pAdapter); -+ return; -+ } -+#endif -+#ifdef CONFIG_RTL8822B -+ if (IS_HARDWARE_TYPE_8822B(pAdapter)) { -+ rtl8822b_mp_config_rfpath(pAdapter); -+ return; -+ } -+#endif -+#ifdef CONFIG_RTL8821C -+ if (IS_HARDWARE_TYPE_8821C(pAdapter)) { -+ rtl8821c_mp_config_rfpath(pAdapter); -+ return; -+ } -+#endif -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) { -+ mpt_SetRFPath_8812A(pAdapter); -+ return; -+ } -+#endif -+#ifdef CONFIG_RTL8723B -+ if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+ mpt_SetRFPath_8723B(pAdapter); -+ return; -+ } -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -+ mpt_SetRFPath_8703B(pAdapter); -+ return; -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ if (IS_HARDWARE_TYPE_8723D(pAdapter)) { -+ mpt_SetRFPath_8723D(pAdapter); -+ return; -+ } -+#endif -+ /* else if (IS_HARDWARE_TYPE_8821B(pAdapter)) -+ mpt_SetRFPath_8821B(pAdapter); -+ Prepare for 8822B -+ else if (IS_HARDWARE_TYPE_8822B(Context)) -+ mpt_SetRFPath_8822B(Context); -+ */ -+ mpt_SetRFPath_819X(pAdapter); -+ RTW_INFO("mpt_SetRFPath_819X Do %s\n", __func__); -+} -+ -+s32 hal_mpt_SetThermalMeter(PADAPTER pAdapter, u8 target_ther) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ if (!netif_running(pAdapter->pnetdev)) { -+ return _FAIL; -+ } -+ -+ -+ if (check_fwstate(&pAdapter->mlmepriv, WIFI_MP_STATE) == _FALSE) { -+ return _FAIL; -+ } -+ -+ -+ target_ther &= 0xff; -+ if (target_ther < 0x07) -+ target_ther = 0x07; -+ else if (target_ther > 0x1d) -+ target_ther = 0x1d; -+ -+ pHalData->EEPROMThermalMeter = target_ther; -+ -+ return _SUCCESS; -+} -+ -+ -+void hal_mpt_TriggerRFThermalMeter(PADAPTER pAdapter) -+{ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x42, BIT17 | BIT16, 0x03); -+ -+} -+ -+ -+u8 hal_mpt_ReadRFThermalMeter(PADAPTER pAdapter) -+ -+{ -+ u32 ThermalValue = 0; -+ -+ ThermalValue = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, 0x42, 0xfc00); /*0x42: RF Reg[15:10]*/ -+ return (u8)ThermalValue; -+ -+} -+ -+ -+void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 *value) -+{ -+#if 0 -+ fw_cmd(pAdapter, IOCMD_GET_THERMAL_METER); -+ rtw_msleep_os(1000); -+ fw_cmd_data(pAdapter, value, 1); -+ *value &= 0xFF; -+#else -+ hal_mpt_TriggerRFThermalMeter(pAdapter); -+ rtw_msleep_os(1000); -+ *value = hal_mpt_ReadRFThermalMeter(pAdapter); -+#endif -+ -+} -+ -+ -+void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ pAdapter->mppriv.MptCtx.bSingleCarrier = bStart; -+ -+ if (bStart) {/*/ Start Single Carrier.*/ -+ /*/ Start Single Carrier.*/ -+ /*/ 1. if OFDM block on?*/ -+ if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1); /*set OFDM block on*/ -+ -+ /*/ 2. set CCK test mode off, set to CCK normal mode*/ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0); -+ -+ /*/ 3. turn on scramble setting*/ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 1); -+ -+ /*/ 4. Turn On Continue Tx and turn off the other test modes.*/ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) -+ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_SingleCarrier); -+ else -+#endif /* CONFIG_RTL8812A || CONFIG_RTL8821A || CONFIG_RTL8814A || CONFIG_RTL8822B || CONFIG_RTL8821C */ -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_SingleCarrier); -+ -+ } else { -+ /*/ Stop Single Carrier.*/ -+ /*/ Stop Single Carrier.*/ -+ /*/ Turn off all test modes.*/ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) -+ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); -+ else -+#endif /* CONFIG_RTL8812A || CONFIG_RTL8821A || CONFIG_RTL8814A || CONFIG_RTL8822B || CONFIG_RTL8821C */ -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); -+ -+ rtw_msleep_os(10); -+ /*/BB Reset*/ -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ } -+} -+ -+ -+void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u4Byte ulAntennaTx = pHalData->AntennaTxPath; -+ static u4Byte regRF = 0, regBB0 = 0, regBB1 = 0, regBB2 = 0, regBB3 = 0; -+ u8 rfPath; -+ -+ switch (ulAntennaTx) { -+ case ANTENNA_B: -+ rfPath = ODM_RF_PATH_B; -+ break; -+ case ANTENNA_C: -+ rfPath = ODM_RF_PATH_C; -+ break; -+ case ANTENNA_D: -+ rfPath = ODM_RF_PATH_D; -+ break; -+ case ANTENNA_A: -+ default: -+ rfPath = ODM_RF_PATH_A; -+ break; -+ } -+ -+ pAdapter->mppriv.MptCtx.bSingleTone = bStart; -+ if (bStart) { -+ /*/ Start Single Tone.*/ -+ /*/ <20120326, Kordan> To amplify the power of tone for Xtal calibration. (asked by Edlu)*/ -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) { -+ regRF = PHY_QueryRFReg(pAdapter, rfPath, LNA_Low_Gain_3, bRFRegOffsetMask); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x0); -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x0); -+ } else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { /*/ USB need to do RF LO disable first, PCIE isn't required to follow this order.*/ -+ /*/Set MAC REG 88C: Prevent SingleTone Fail*/ -+ PHY_SetMacReg(pAdapter, 0x88C, 0xF00000, 0xF); -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO disabled*/ -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ -+ } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x56, 0xF, 0x1); /*/ RF LO enabled*/ -+ } else { -+ /*/ S0/S1 both use PATH A to configure*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x76, 0xF, 0x1); /*/ RF LO enabled*/ -+ } -+ } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /* Tx mode */ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, 0xF000, 0x1); /* RF LO enabled */ -+ } -+ } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ /*Set BB REG 88C: Prevent SingleTone Fail*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xF); -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x2); -+ -+ } else if (IS_HARDWARE_TYPE_8723D(pAdapter)) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x0); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, BIT0, 0x1); -+ } else {/* S0/S1 both use PATH A to configure */ -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x0); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x63, BIT0, 0x1); -+ } -+ } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8822B(pAdapter)) { -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ u1Byte p = ODM_RF_PATH_A; -+ -+ regRF = PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, bRFRegOffsetMask); -+ regBB0 = PHY_QueryBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord); -+ regBB1 = PHY_QueryBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord); -+ regBB2 = PHY_QueryBBReg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, bMaskDWord); -+ regBB3 = PHY_QueryBBReg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, bMaskDWord); -+ -+ PHY_SetBBReg(pAdapter, rOFDMCCKEN_Jaguar, BIT29 | BIT28, 0x0); /*/ Disable CCK and OFDM*/ -+ -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_AB) { -+ for (p = ODM_RF_PATH_A; p <= ODM_RF_PATH_B; ++p) { -+ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ -+ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ -+ PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ -+ } -+ } else { -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ -+ } -+ -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); /*/ 0xCB0[[23:16, 7:4] = 0x77007*/ -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); /*/ 0xCB0[[23:16, 7:4] = 0x77007*/ -+ -+ if (pHalData->ExternalPA_5G) { -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x12); /*/ 0xCB4[23:16] = 0x12*/ -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x12); /*/ 0xEB4[23:16] = 0x12*/ -+ } else if (pHalData->ExternalPA_2G) { -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x11); /*/ 0xCB4[23:16] = 0x11*/ -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x11); /*/ 0xEB4[23:16] = 0x11*/ -+ } -+#endif -+ } -+#ifdef CONFIG_RTL8814A -+ else if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ mpt_SetSingleTone_8814A(pAdapter, TRUE, FALSE); -+#endif -+ else /*/ Turn On SingleTone and turn off the other test modes.*/ -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_SingleTone); -+ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ } else {/*/ Stop Single Ton e.*/ -+ -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, LNA_Low_Gain_3, bRFRegOffsetMask, regRF); -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x1); -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x1); -+ } else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x3);/*/ Tx mode*/ -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x0);/*/ RF LO disabled */ -+ /*/ RESTORE MAC REG 88C: Enable RF Functions*/ -+ PHY_SetMacReg(pAdapter, 0x88C, 0xF00000, 0x0); -+ } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x56, 0xF, 0x0); /*/ RF LO disabled*/ -+ } else { -+ /*/ S0/S1 both use PATH A to configure*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x76, 0xF, 0x0); /*/ RF LO disabled*/ -+ } -+ } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /* Rx mode */ -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, 0xF000, 0x0); /* RF LO disabled */ -+ } -+ } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x3); /*Tx mode*/ -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x0); /*RF LO disabled*/ -+ /*Set BB REG 88C: Prevent SingleTone Fail*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xc); -+ } else if (IS_HARDWARE_TYPE_8723D(pAdapter)) { -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x3); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x1); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, BIT0, 0x0); -+ } else { /* S0/S1 both use PATH A to configure */ -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x3); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x1); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x63, BIT0, 0x0); -+ } -+ } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8822B(pAdapter)) { -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ u1Byte p = ODM_RF_PATH_A; -+ -+ PHY_SetBBReg(pAdapter, rOFDMCCKEN_Jaguar, BIT29 | BIT28, 0x3); /*/ Disable CCK and OFDM*/ -+ -+ if (pMptCtx->MptRfPath == ODM_RF_PATH_AB) { -+ for (p = ODM_RF_PATH_A; p <= ODM_RF_PATH_B; ++p) { -+ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); -+ PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x0); /*/ RF LO disabled*/ -+ } -+ } else { -+ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); -+ PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x0); /*/ RF LO disabled*/ -+ } -+ -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord, regBB0); -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord, regBB1); -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, bMaskDWord, regBB2); -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, bMaskDWord, regBB3); -+#endif -+ } -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ else if (IS_HARDWARE_TYPE_8814A(pAdapter)) -+ mpt_SetSingleTone_8814A(pAdapter, FALSE, FALSE); -+ -+ else/*/ Turn off all test modes.*/ -+ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); -+#endif -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ -+ } -+} -+ -+void hal_mpt_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) -+{ -+ u8 Rate; -+ -+ pAdapter->mppriv.MptCtx.bCarrierSuppression = bStart; -+ -+ Rate = HwRateToMPTRate(pAdapter->mppriv.rateidx); -+ if (bStart) {/* Start Carrier Suppression.*/ -+ if (Rate <= MPT_RATE_11M) { -+ /*/ 1. if CCK block on?*/ -+ if (!read_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn)) -+ write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, bEnable);/*set CCK block on*/ -+ -+ /*/Turn Off All Test Mode*/ -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) -+ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); /* rSingleTone_ContTx_Jaguar*/ -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); -+ -+ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*/transmit mode*/ -+ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, 0x0); /*/turn off scramble setting*/ -+ -+ /*/Set CCK Tx Test Rate*/ -+ write_bbreg(pAdapter, rCCK0_System, bCCKTxRate, 0x0); /*/Set FTxRate to 1Mbps*/ -+ } -+ -+ /*Set for dynamic set Power index*/ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ } else {/* Stop Carrier Suppression.*/ -+ -+ if (Rate <= MPT_RATE_11M) { -+ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); /*normal mode*/ -+ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ -+ -+ /*BB Reset*/ -+ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ } -+ /*Stop for dynamic set Power index*/ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ } -+ RTW_INFO("\n MPT_ProSetCarrierSupp() is finished.\n"); -+} -+ -+void hal_mpt_SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ u32 cckrate; -+ -+ if (bStart) { -+ -+ /*/ 1. if CCK block on?*/ -+ if (!read_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn)) -+ write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, bEnable);/*set CCK block on*/ -+ -+ /*/Turn Off All Test Mode*/ -+ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) -+ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); /*rSingleTone_ContTx_Jaguar*/ -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); -+ -+ /*/Set CCK Tx Test Rate*/ -+ -+ cckrate = pAdapter->mppriv.rateidx; -+ -+ write_bbreg(pAdapter, rCCK0_System, bCCKTxRate, cckrate); -+ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*/transmit mode*/ -+ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, bEnable); /*/turn on scramble setting*/ -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) { -+ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* rCCK0_RxHP 0xa15[1:0] = 11 force cck rxiq = 0*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /*/ 0xc08[16] = 1 force ofdm rxiq = ofdm txiq*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 1); -+ PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 1); -+ } -+ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ } else { -+ -+ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); /*/normal mode*/ -+ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, bEnable); /*/turn on scramble setting*/ -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_8814A(pAdapter) /* && !IS_HARDWARE_TYPE_8822B(pAdapter) */) { -+ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0);/* rCCK0_RxHP 0xa15[1:0] = 2b00*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /*/ 0xc08[16] = 0*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 0); -+ PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 0); -+ } -+ -+ /*/BB Reset*/ -+ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ } -+ -+ pAdapter->mppriv.MptCtx.bCckContTx = bStart; -+ pAdapter->mppriv.MptCtx.bOfdmContTx = _FALSE; -+} -+ -+void hal_mpt_SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ if (bStart) { -+ if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1);/*/set OFDM block on*/ -+ -+ /*/ 2. set CCK test mode off, set to CCK normal mode*/ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0); -+ -+ /*/ 3. turn on scramble setting*/ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 1); -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_8814A(pAdapter) /*&& !IS_HARDWARE_TYPE_8822B(pAdapter)*/) { -+ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* rCCK0_RxHP 0xa15[1:0] = 2b'11*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1*/ -+ } -+ -+ /*/ 4. Turn On Continue Tx and turn off the other test modes.*/ -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) -+ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ContinuousTx); /*rSingleTone_ContTx_Jaguar*/ -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ContinuousTx); -+ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ } else { -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) -+ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); -+ /*/Delay 10 ms*/ -+ rtw_msleep_os(10); -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_8814A(pAdapter) /*&&! IS_HARDWARE_TYPE_8822B(pAdapter)*/) { -+ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0);/*/ 0xa15[1:0] = 0*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0);/*/ 0xc08[16] = 0*/ -+ } -+ -+ /*/BB Reset*/ -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ } -+ -+ pAdapter->mppriv.MptCtx.bCckContTx = _FALSE; -+ pAdapter->mppriv.MptCtx.bOfdmContTx = bStart; -+} -+ -+void hal_mpt_SetContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ u8 Rate; -+ -+ Rate = HwRateToMPTRate(pAdapter->mppriv.rateidx); -+ pAdapter->mppriv.MptCtx.bStartContTx = bStart; -+ -+ if (Rate <= MPT_RATE_11M) -+ hal_mpt_SetCCKContinuousTx(pAdapter, bStart); -+ else if (Rate >= MPT_RATE_6M) -+ hal_mpt_SetOFDMContinuousTx(pAdapter, bStart); -+} -+ -+u32 hal_mpt_query_phytxok(PADAPTER pAdapter) -+{ -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; -+ u16 count = 0; -+ -+ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) -+ count = PHY_QueryBBReg(pAdapter, 0xF50, bMaskLWord); /* [15:0]*/ -+ else -+ count = PHY_QueryBBReg(pAdapter, 0xF50, bMaskHWord); /* [31:16]*/ -+ -+ if (count > 50000) { -+ rtw_reset_phy_trx_ok_counters(pAdapter); -+ pAdapter->mppriv.tx.sended += count; -+ count = 0; -+ } -+ -+ return pAdapter->mppriv.tx.sended + count; -+ -+} -+ -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+/* for HW TX mode */ -+static VOID mpt_StopCckContTx( -+ PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u1Byte u1bReg; -+ -+ pMptCtx->bCckContTx = FALSE; -+ pMptCtx->bOfdmContTx = FALSE; -+ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); /*normal mode*/ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) { -+ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0); /* 0xa15[1:0] = 2b00*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /* 0xc08[16] = 0*/ -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 0); -+ PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 0); -+ } -+ -+ /*BB Reset*/ -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ -+} /* mpt_StopCckContTx */ -+ -+ -+static VOID mpt_StopOfdmContTx( -+ PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u1Byte u1bReg; -+ u4Byte data; -+ -+ pMptCtx->bCckContTx = FALSE; -+ pMptCtx->bOfdmContTx = FALSE; -+ -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) -+ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); -+ -+ rtw_mdelay_os(10); -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) { -+ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0); /* 0xa15[1:0] = 0*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /* 0xc08[16] = 0*/ -+ } -+ -+ /*BB Reset*/ -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+} /* mpt_StopOfdmContTx */ -+ -+ -+static VOID mpt_StartCckContTx( -+ PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u4Byte cckrate; -+ -+ /* 1. if CCK block on */ -+ if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn)) -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn, 1);/*set CCK block on*/ -+ -+ /*Turn Off All Test Mode*/ -+ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) -+ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); -+ -+ cckrate = pAdapter->mppriv.rateidx; -+ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKTxRate, cckrate); -+ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*transmit mode*/ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) { -+ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* 0xa15[1:0] = 11 force cck rxiq = 0*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1 force ofdm rxiq = ofdm txiq*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 1); -+ PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 1); -+ } -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ pMptCtx->bCckContTx = TRUE; -+ pMptCtx->bOfdmContTx = FALSE; -+ -+} /* mpt_StartCckContTx */ -+ -+ -+static VOID mpt_StartOfdmContTx( -+ PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ -+ /* 1. if OFDM block on?*/ -+ if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) -+ PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1);/*set OFDM block on*/ -+ -+ /* 2. set CCK test mode off, set to CCK normal mode*/ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0); -+ -+ /* 3. turn on scramble setting*/ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 1); -+ -+ if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) { -+ PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* 0xa15[1:0] = 2b'11*/ -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1*/ -+ } -+ -+ /* 4. Turn On Continue Tx and turn off the other test modes.*/ -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) -+ PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ContinuousTx); -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ContinuousTx); -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ pMptCtx->bCckContTx = FALSE; -+ pMptCtx->bOfdmContTx = TRUE; -+} /* mpt_StartOfdmContTx */ -+ -+ -+void mpt_ProSetPMacTx(PADAPTER Adapter) -+{ -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; -+ u32 u4bTmp; -+ -+ DbgPrint("SGI %d bSPreamble %d bSTBC %d bLDPC %d NDP_sound %d\n", PMacTxInfo.bSGI, PMacTxInfo.bSPreamble, PMacTxInfo.bSTBC, PMacTxInfo.bLDPC, PMacTxInfo.NDP_sound); -+ DbgPrint("TXSC %d BandWidth %d PacketPeriod %d PacketCount %d PacketLength %d PacketPattern %d\n", PMacTxInfo.TX_SC, PMacTxInfo.BandWidth, PMacTxInfo.PacketPeriod, PMacTxInfo.PacketCount, -+ PMacTxInfo.PacketLength, PMacTxInfo.PacketPattern); -+#if 0 -+ PRINT_DATA("LSIG ", PMacTxInfo.LSIG, 3); -+ PRINT_DATA("HT_SIG", PMacTxInfo.HT_SIG, 6); -+ PRINT_DATA("VHT_SIG_A", PMacTxInfo.VHT_SIG_A, 6); -+ PRINT_DATA("VHT_SIG_B", PMacTxInfo.VHT_SIG_B, 4); -+ DbgPrint("VHT_SIG_B_CRC %x\n", PMacTxInfo.VHT_SIG_B_CRC); -+ PRINT_DATA("VHT_Delimiter", PMacTxInfo.VHT_Delimiter, 4); -+ -+ PRINT_DATA("Src Address", Adapter->mac_addr, 6); -+ PRINT_DATA("Dest Address", PMacTxInfo.MacAddress, 6); -+#endif -+ -+ if (PMacTxInfo.bEnPMacTx == FALSE) { -+ if (PMacTxInfo.Mode == CONTINUOUS_TX) { -+ PHY_SetBBReg(Adapter, 0xb04, 0xf, 2); /* TX Stop*/ -+ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) -+ mpt_StopCckContTx(Adapter); -+ else -+ mpt_StopOfdmContTx(Adapter); -+ } else if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) { -+ u4bTmp = PHY_QueryBBReg(Adapter, 0xf50, bMaskLWord); -+ PHY_SetBBReg(Adapter, 0xb1c, bMaskLWord, u4bTmp + 50); -+ PHY_SetBBReg(Adapter, 0xb04, 0xf, 2); /*TX Stop*/ -+ } else -+ PHY_SetBBReg(Adapter, 0xb04, 0xf, 2); /* TX Stop*/ -+ -+ if (PMacTxInfo.Mode == OFDM_Single_Tone_TX) { -+ /* Stop HW TX -> Stop Continuous TX -> Stop RF Setting*/ -+ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) -+ mpt_StopCckContTx(Adapter); -+ else -+ mpt_StopOfdmContTx(Adapter); -+ -+ mpt_SetSingleTone_8814A(Adapter, FALSE, TRUE); -+ } -+ -+ return; -+ } -+ -+ if (PMacTxInfo.Mode == CONTINUOUS_TX) { -+ PMacTxInfo.PacketCount = 1; -+ -+ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) -+ mpt_StartCckContTx(Adapter); -+ else -+ mpt_StartOfdmContTx(Adapter); -+ } else if (PMacTxInfo.Mode == OFDM_Single_Tone_TX) { -+ /* Continuous TX -> HW TX -> RF Setting */ -+ PMacTxInfo.PacketCount = 1; -+ -+ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) -+ mpt_StartCckContTx(Adapter); -+ else -+ mpt_StartOfdmContTx(Adapter); -+ } else if (PMacTxInfo.Mode == PACKETS_TX) { -+ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE) && PMacTxInfo.PacketCount == 0) -+ PMacTxInfo.PacketCount = 0xffff; -+ } -+ -+ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) { -+ /* 0xb1c[0:15] TX packet count 0xb1C[31:16] SFD*/ -+ u4bTmp = PMacTxInfo.PacketCount | (PMacTxInfo.SFD << 16); -+ PHY_SetBBReg(Adapter, 0xb1c, bMaskDWord, u4bTmp); -+ /* 0xb40 7:0 SIGNAL 15:8 SERVICE 31:16 LENGTH*/ -+ u4bTmp = PMacTxInfo.SignalField | (PMacTxInfo.ServiceField << 8) | (PMacTxInfo.LENGTH << 16); -+ PHY_SetBBReg(Adapter, 0xb40, bMaskDWord, u4bTmp); -+ u4bTmp = PMacTxInfo.CRC16[0] | (PMacTxInfo.CRC16[1] << 8); -+ PHY_SetBBReg(Adapter, 0xb44, bMaskLWord, u4bTmp); -+ -+ if (PMacTxInfo.bSPreamble) -+ PHY_SetBBReg(Adapter, 0xb0c, BIT27, 0); -+ else -+ PHY_SetBBReg(Adapter, 0xb0c, BIT27, 1); -+ } else { -+ PHY_SetBBReg(Adapter, 0xb18, 0xfffff, PMacTxInfo.PacketCount); -+ -+ u4bTmp = PMacTxInfo.LSIG[0] | ((PMacTxInfo.LSIG[1]) << 8) | ((PMacTxInfo.LSIG[2]) << 16) | ((PMacTxInfo.PacketPattern) << 24); -+ PHY_SetBBReg(Adapter, 0xb08, bMaskDWord, u4bTmp); /* Set 0xb08[23:0] = LSIG, 0xb08[31:24] = Data init octet*/ -+ -+ if (PMacTxInfo.PacketPattern == 0x12) -+ u4bTmp = 0x3000000; -+ else -+ u4bTmp = 0; -+ } -+ -+ if (IS_MPT_HT_RATE(PMacTxInfo.TX_RATE)) { -+ u4bTmp |= PMacTxInfo.HT_SIG[0] | ((PMacTxInfo.HT_SIG[1]) << 8) | ((PMacTxInfo.HT_SIG[2]) << 16); -+ PHY_SetBBReg(Adapter, 0xb0c, bMaskDWord, u4bTmp); -+ u4bTmp = PMacTxInfo.HT_SIG[3] | ((PMacTxInfo.HT_SIG[4]) << 8) | ((PMacTxInfo.HT_SIG[5]) << 16); -+ PHY_SetBBReg(Adapter, 0xb10, 0xffffff, u4bTmp); -+ } else if (IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) { -+ u4bTmp |= PMacTxInfo.VHT_SIG_A[0] | ((PMacTxInfo.VHT_SIG_A[1]) << 8) | ((PMacTxInfo.VHT_SIG_A[2]) << 16); -+ PHY_SetBBReg(Adapter, 0xb0c, bMaskDWord, u4bTmp); -+ u4bTmp = PMacTxInfo.VHT_SIG_A[3] | ((PMacTxInfo.VHT_SIG_A[4]) << 8) | ((PMacTxInfo.VHT_SIG_A[5]) << 16); -+ PHY_SetBBReg(Adapter, 0xb10, 0xffffff, u4bTmp); -+ -+ _rtw_memcpy(&u4bTmp, PMacTxInfo.VHT_SIG_B, 4); -+ PHY_SetBBReg(Adapter, 0xb14, bMaskDWord, u4bTmp); -+ } -+ -+ if (IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) { -+ u4bTmp = (PMacTxInfo.VHT_SIG_B_CRC << 24) | PMacTxInfo.PacketPeriod; /* for TX interval */ -+ PHY_SetBBReg(Adapter, 0xb20, bMaskDWord, u4bTmp); -+ -+ _rtw_memcpy(&u4bTmp, PMacTxInfo.VHT_Delimiter, 4); -+ PHY_SetBBReg(Adapter, 0xb24, bMaskDWord, u4bTmp); -+ -+ /* 0xb28 - 0xb34 24 byte Probe Request MAC Header*/ -+ /*& Duration & Frame control*/ -+ PHY_SetBBReg(Adapter, 0xb28, bMaskDWord, 0x00000040); -+ -+ /* Address1 [0:3]*/ -+ u4bTmp = PMacTxInfo.MacAddress[0] | (PMacTxInfo.MacAddress[1] << 8) | (PMacTxInfo.MacAddress[2] << 16) | (PMacTxInfo.MacAddress[3] << 24); -+ PHY_SetBBReg(Adapter, 0xb2C, bMaskDWord, u4bTmp); -+ -+ /* Address3 [3:0]*/ -+ PHY_SetBBReg(Adapter, 0xb38, bMaskDWord, u4bTmp); -+ -+ /* Address2[0:1] & Address1 [5:4]*/ -+ u4bTmp = PMacTxInfo.MacAddress[4] | (PMacTxInfo.MacAddress[5] << 8) | (Adapter->mac_addr[0] << 16) | (Adapter->mac_addr[1] << 24); -+ PHY_SetBBReg(Adapter, 0xb30, bMaskDWord, u4bTmp); -+ -+ /* Address2 [5:2]*/ -+ u4bTmp = Adapter->mac_addr[2] | (Adapter->mac_addr[3] << 8) | (Adapter->mac_addr[4] << 16) | (Adapter->mac_addr[5] << 24); -+ PHY_SetBBReg(Adapter, 0xb34, bMaskDWord, u4bTmp); -+ -+ /* Sequence Control & Address3 [5:4]*/ -+ /*u4bTmp = PMacTxInfo.MacAddress[4]|(PMacTxInfo.MacAddress[5] << 8) ;*/ -+ /*PHY_SetBBReg(Adapter, 0xb38, bMaskDWord, u4bTmp);*/ -+ } else { -+ PHY_SetBBReg(Adapter, 0xb20, bMaskDWord, PMacTxInfo.PacketPeriod); /* for TX interval*/ -+ /* & Duration & Frame control */ -+ PHY_SetBBReg(Adapter, 0xb24, bMaskDWord, 0x00000040); -+ -+ /* 0xb24 - 0xb38 24 byte Probe Request MAC Header*/ -+ /* Address1 [0:3]*/ -+ u4bTmp = PMacTxInfo.MacAddress[0] | (PMacTxInfo.MacAddress[1] << 8) | (PMacTxInfo.MacAddress[2] << 16) | (PMacTxInfo.MacAddress[3] << 24); -+ PHY_SetBBReg(Adapter, 0xb28, bMaskDWord, u4bTmp); -+ -+ /* Address3 [3:0]*/ -+ PHY_SetBBReg(Adapter, 0xb34, bMaskDWord, u4bTmp); -+ -+ /* Address2[0:1] & Address1 [5:4]*/ -+ u4bTmp = PMacTxInfo.MacAddress[4] | (PMacTxInfo.MacAddress[5] << 8) | (Adapter->mac_addr[0] << 16) | (Adapter->mac_addr[1] << 24); -+ PHY_SetBBReg(Adapter, 0xb2c, bMaskDWord, u4bTmp); -+ -+ /* Address2 [5:2] */ -+ u4bTmp = Adapter->mac_addr[2] | (Adapter->mac_addr[3] << 8) | (Adapter->mac_addr[4] << 16) | (Adapter->mac_addr[5] << 24); -+ PHY_SetBBReg(Adapter, 0xb30, bMaskDWord, u4bTmp); -+ -+ /* Sequence Control & Address3 [5:4]*/ -+ u4bTmp = PMacTxInfo.MacAddress[4] | (PMacTxInfo.MacAddress[5] << 8); -+ PHY_SetBBReg(Adapter, 0xb38, bMaskDWord, u4bTmp); -+ } -+ -+ PHY_SetBBReg(Adapter, 0xb48, bMaskByte3, PMacTxInfo.TX_RATE_HEX); -+ -+ /* 0xb4c 3:0 TXSC 5:4 BW 7:6 m_STBC 8 NDP_Sound*/ -+ u4bTmp = (PMacTxInfo.TX_SC) | ((PMacTxInfo.BandWidth) << 4) | ((PMacTxInfo.m_STBC - 1) << 6) | ((PMacTxInfo.NDP_sound) << 8); -+ PHY_SetBBReg(Adapter, 0xb4c, 0x1ff, u4bTmp); -+ -+ if (IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8822B(Adapter)) { -+ u4Byte offset = 0xb44; -+ -+ if (IS_MPT_OFDM_RATE(PMacTxInfo.TX_RATE)) -+ PHY_SetBBReg(Adapter, offset, 0xc0000000, 0); -+ else if (IS_MPT_HT_RATE(PMacTxInfo.TX_RATE)) -+ PHY_SetBBReg(Adapter, offset, 0xc0000000, 1); -+ else if (IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) -+ PHY_SetBBReg(Adapter, offset, 0xc0000000, 2); -+ } -+ -+ PHY_SetBBReg(Adapter, 0xb00, BIT8, 1); /* Turn on PMAC*/ -+ /* PHY_SetBBReg(Adapter, 0xb04, 0xf, 2); */ /* TX Stop */ -+ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) { -+ PHY_SetBBReg(Adapter, 0xb04, 0xf, 8); /*TX CCK ON*/ -+ PHY_SetBBReg(Adapter, 0xA84, BIT31, 0); -+ } else -+ PHY_SetBBReg(Adapter, 0xb04, 0xf, 4); /* TX Ofdm ON */ -+ -+ if (PMacTxInfo.Mode == OFDM_Single_Tone_TX) -+ mpt_SetSingleTone_8814A(Adapter, TRUE, TRUE); -+ -+} -+#endif -+ -+#endif /* CONFIG_MP_INCLUDE*/ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/hal_phy.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_phy.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/hal_phy.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/hal_phy.c 2018-02-11 21:44:27.152146162 +0200 -@@ -0,0 +1,260 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _HAL_PHY_C_ -+ -+#include -+ -+/* ******************************************************************************** -+ * Constant. -+ * ******************************************************************************** -+ * 2008/11/20 MH For Debug only, RF */ -+static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG]; -+ -+/** -+* Function: PHY_CalculateBitShift -+* -+* OverView: Get shifted position of the BitMask -+* -+* Input: -+* u4Byte BitMask, -+* -+* Output: none -+* Return: u4Byte Return the shift bit bit position of the mask -+*/ -+u32 -+PHY_CalculateBitShift( -+ u32 BitMask -+) -+{ -+ u32 i; -+ -+ for (i = 0; i <= 31; i++) { -+ if (((BitMask >> i) & 0x1) == 1) -+ break; -+ } -+ -+ return i; -+} -+ -+ -+/* -+ * ==> RF shadow Operation API Code Section!!! -+ * -+ *----------------------------------------------------------------------------- -+ * Function: PHY_RFShadowRead -+ * PHY_RFShadowWrite -+ * PHY_RFShadowCompare -+ * PHY_RFShadowRecorver -+ * PHY_RFShadowCompareAll -+ * PHY_RFShadowRecorverAll -+ * PHY_RFShadowCompareFlagSet -+ * PHY_RFShadowRecorverFlagSet -+ * -+ * Overview: When we set RF register, we must write shadow at first. -+ * When we are running, we must compare shadow abd locate error addr. -+ * Decide to recorver or not. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/20/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+u32 -+PHY_RFShadowRead( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset) -+{ -+ return RF_Shadow[eRFPath][Offset].Value; -+ -+} /* PHY_RFShadowRead */ -+ -+ -+VOID -+PHY_RFShadowWrite( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u32 Data) -+{ -+ RF_Shadow[eRFPath][Offset].Value = (Data & bRFRegOffsetMask); -+ RF_Shadow[eRFPath][Offset].Driver_Write = _TRUE; -+ -+} /* PHY_RFShadowWrite */ -+ -+ -+BOOLEAN -+PHY_RFShadowCompare( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset) -+{ -+ u32 reg; -+ /* Check if we need to check the register */ -+ if (RF_Shadow[eRFPath][Offset].Compare == _TRUE) { -+ reg = rtw_hal_read_rfreg(Adapter, eRFPath, Offset, bRFRegOffsetMask); -+ /* Compare shadow and real rf register for 20bits!! */ -+ if (RF_Shadow[eRFPath][Offset].Value != reg) { -+ /* Locate error position. */ -+ RF_Shadow[eRFPath][Offset].ErrorOrNot = _TRUE; -+ } -+ return RF_Shadow[eRFPath][Offset].ErrorOrNot ; -+ } -+ return _FALSE; -+} /* PHY_RFShadowCompare */ -+ -+ -+VOID -+PHY_RFShadowRecorver( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset) -+{ -+ /* Check if the address is error */ -+ if (RF_Shadow[eRFPath][Offset].ErrorOrNot == _TRUE) { -+ /* Check if we need to recorver the register. */ -+ if (RF_Shadow[eRFPath][Offset].Recorver == _TRUE) { -+ rtw_hal_write_rfreg(Adapter, eRFPath, Offset, bRFRegOffsetMask, -+ RF_Shadow[eRFPath][Offset].Value); -+ } -+ } -+ -+} /* PHY_RFShadowRecorver */ -+ -+ -+VOID -+PHY_RFShadowCompareAll( -+ IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0 ; -+ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { -+ for (Offset = 0; Offset < maxReg; Offset++) -+ PHY_RFShadowCompare(Adapter, eRFPath, Offset); -+ } -+ -+} /* PHY_RFShadowCompareAll */ -+ -+ -+VOID -+PHY_RFShadowRecorverAll( -+ IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { -+ for (Offset = 0; Offset < maxReg; Offset++) -+ PHY_RFShadowRecorver(Adapter, eRFPath, Offset); -+ } -+ -+} /* PHY_RFShadowRecorverAll */ -+ -+ -+VOID -+PHY_RFShadowCompareFlagSet( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u8 Type) -+{ -+ /* Set True or False!!! */ -+ RF_Shadow[eRFPath][Offset].Compare = Type; -+ -+} /* PHY_RFShadowCompareFlagSet */ -+ -+ -+VOID -+PHY_RFShadowRecorverFlagSet( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u8 Type) -+{ -+ /* Set True or False!!! */ -+ RF_Shadow[eRFPath][Offset].Recorver = Type; -+ -+} /* PHY_RFShadowRecorverFlagSet */ -+ -+ -+VOID -+PHY_RFShadowCompareFlagSetAll( -+ IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { -+ for (Offset = 0; Offset < maxReg; Offset++) { -+ /* 2008/11/20 MH For S3S4 test, we only check reg 26/27 now!!!! */ -+ if (Offset != 0x26 && Offset != 0x27) -+ PHY_RFShadowCompareFlagSet(Adapter, eRFPath, Offset, _FALSE); -+ else -+ PHY_RFShadowCompareFlagSet(Adapter, eRFPath, Offset, _TRUE); -+ } -+ } -+ -+} /* PHY_RFShadowCompareFlagSetAll */ -+ -+ -+VOID -+PHY_RFShadowRecorverFlagSetAll( -+ IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { -+ for (Offset = 0; Offset < maxReg; Offset++) { -+ /* 2008/11/20 MH For S3S4 test, we only check reg 26/27 now!!!! */ -+ if (Offset != 0x26 && Offset != 0x27) -+ PHY_RFShadowRecorverFlagSet(Adapter, eRFPath, Offset, _FALSE); -+ else -+ PHY_RFShadowRecorverFlagSet(Adapter, eRFPath, Offset, _TRUE); -+ } -+ } -+ -+} /* PHY_RFShadowCompareFlagSetAll */ -+ -+VOID -+PHY_RFShadowRefresh( -+ IN PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { -+ for (Offset = 0; Offset < maxReg; Offset++) { -+ RF_Shadow[eRFPath][Offset].Value = 0; -+ RF_Shadow[eRFPath][Offset].Compare = _FALSE; -+ RF_Shadow[eRFPath][Offset].Recorver = _FALSE; -+ RF_Shadow[eRFPath][Offset].ErrorOrNot = _FALSE; -+ RF_Shadow[eRFPath][Offset].Driver_Write = _FALSE; -+ } -+ } -+ -+} /* PHY_RFShadowRead */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/HalPwrSeqCmd.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/HalPwrSeqCmd.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/HalPwrSeqCmd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/HalPwrSeqCmd.c 2018-02-11 21:44:27.143146025 +0200 -@@ -0,0 +1,188 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/*++ -+Copyright (c) Realtek Semiconductor Corp. All rights reserved. -+ -+Module Name: -+ HalPwrSeqCmd.c -+ -+Abstract: -+ Implement HW Power sequence configuration CMD handling routine for Realtek devices. -+ -+Major Change History: -+ When Who What -+ ---------- --------------- ------------------------------- -+ 2011-10-26 Lucas Modify to be compatible with SD4-CE driver. -+ 2011-07-07 Roger Create. -+ -+--*/ -+#include -+ -+ -+/* -+ * Description: -+ * This routine deal with the Power Configuration CMDs parsing for RTL8723/RTL8188E Series IC. -+ * -+ * Assumption: -+ * We should follow specific format which was released from HW SD. -+ * -+ * 2011.07.07, added by Roger. -+ * */ -+u8 HalPwrSeqCmdParsing( -+ PADAPTER padapter, -+ u8 CutVersion, -+ u8 FabVersion, -+ u8 InterfaceType, -+ WLAN_PWR_CFG PwrSeqCmd[]) -+{ -+ WLAN_PWR_CFG PwrCfgCmd = {0}; -+ u8 bPollingBit = _FALSE; -+ u32 AryIdx = 0; -+ u8 value = 0; -+ u32 offset = 0; -+ u8 flag = 0; -+ u32 pollingCount = 0; /* polling autoload done. */ -+ u32 maxPollingCnt = 5000; -+ -+ do { -+ PwrCfgCmd = PwrSeqCmd[AryIdx]; -+ -+ -+ /* 2 Only Handle the command whose FAB, CUT, and Interface are matched */ -+ if ((GET_PWR_CFG_FAB_MASK(PwrCfgCmd) & FabVersion) && -+ (GET_PWR_CFG_CUT_MASK(PwrCfgCmd) & CutVersion) && -+ (GET_PWR_CFG_INTF_MASK(PwrCfgCmd) & InterfaceType)) { -+ switch (GET_PWR_CFG_CMD(PwrCfgCmd)) { -+ case PWR_CMD_READ: -+ break; -+ -+ case PWR_CMD_WRITE: -+ offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); -+ -+#ifdef CONFIG_SDIO_HCI -+ /* */ -+ /* We should deal with interface specific address mapping for some interfaces, e.g., SDIO interface */ -+ /* 2011.07.07. */ -+ /* */ -+ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) { -+ /* Read Back SDIO Local value */ -+ value = SdioLocalCmd52Read1Byte(padapter, offset); -+ -+ value &= ~(GET_PWR_CFG_MASK(PwrCfgCmd)); -+ value |= (GET_PWR_CFG_VALUE(PwrCfgCmd) & GET_PWR_CFG_MASK(PwrCfgCmd)); -+ -+ /* Write Back SDIO Local value */ -+ SdioLocalCmd52Write1Byte(padapter, offset, value); -+ } else -+#endif -+ { -+#ifdef CONFIG_GSPI_HCI -+ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) -+ offset = SPI_LOCAL_OFFSET | offset; -+#endif -+ /* Read the value from system register */ -+ value = rtw_read8(padapter, offset); -+ -+ value = value & (~(GET_PWR_CFG_MASK(PwrCfgCmd))); -+ value = value | (GET_PWR_CFG_VALUE(PwrCfgCmd) & GET_PWR_CFG_MASK(PwrCfgCmd)); -+ -+ /* Write the value back to sytem register */ -+ rtw_write8(padapter, offset, value); -+ } -+ break; -+ -+ case PWR_CMD_POLLING: -+ -+ bPollingBit = _FALSE; -+ offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); -+ -+ if (/*bHWICSpport &&*/ offset == 0x06) { -+ flag = 0; -+ maxPollingCnt = 100000; -+ } else -+ maxPollingCnt = 5000; -+ -+#ifdef CONFIG_GSPI_HCI -+ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) -+ offset = SPI_LOCAL_OFFSET | offset; -+#endif -+ do { -+#ifdef CONFIG_SDIO_HCI -+ if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) -+ value = SdioLocalCmd52Read1Byte(padapter, offset); -+ else -+#endif -+ value = rtw_read8(padapter, offset); -+ -+ value = value & GET_PWR_CFG_MASK(PwrCfgCmd); -+ if (value == (GET_PWR_CFG_VALUE(PwrCfgCmd) & GET_PWR_CFG_MASK(PwrCfgCmd))) -+ bPollingBit = _TRUE; -+ else -+ rtw_udelay_os(10); -+ -+ if (pollingCount++ > maxPollingCnt) { -+ RTW_ERR("HalPwrSeqCmdParsing: Fail to polling Offset[%#x]=%02x\n", offset, value); -+ -+ /* For PCIE + USB package poll power bit timeout issue only modify 8821AE and 8723BE */ -+ if (/*bHWICSpport &&*/ offset == 0x06 && flag == 0) { -+ -+ RTW_ERR("[WARNING] PCIE polling(0x%X) timeout(%d), Toggle 0x04[3] and try again.\n", offset, maxPollingCnt); -+ if (IS_HARDWARE_TYPE_8723DE(padapter)) -+ PlatformEFIOWrite1Byte(padapter, 0x40, (PlatformEFIORead1Byte(padapter, 0x40)) & (~BIT3)); -+ -+ PlatformEFIOWrite1Byte(padapter, 0x04, PlatformEFIORead1Byte(padapter, 0x04) | BIT3); -+ PlatformEFIOWrite1Byte(padapter, 0x04, PlatformEFIORead1Byte(padapter, 0x04) & ~BIT3); -+ -+ if (IS_HARDWARE_TYPE_8723DE(padapter)) -+ PlatformEFIOWrite1Byte(padapter, 0x40, PlatformEFIORead1Byte(padapter, 0x40)|BIT3); -+ -+ /* Retry Polling Process one more time */ -+ pollingCount = 0; -+ flag = 1; -+ } else { -+ return _FALSE; -+ } -+ } -+ } while (!bPollingBit); -+ -+ break; -+ -+ case PWR_CMD_DELAY: -+ if (GET_PWR_CFG_VALUE(PwrCfgCmd) == PWRSEQ_DELAY_US) -+ rtw_udelay_os(GET_PWR_CFG_OFFSET(PwrCfgCmd)); -+ else -+ rtw_udelay_os(GET_PWR_CFG_OFFSET(PwrCfgCmd) * 1000); -+ break; -+ -+ case PWR_CMD_END: -+ /* When this command is parsed, end the process */ -+ return _TRUE; -+ break; -+ -+ default: -+ break; -+ } -+ } -+ -+ AryIdx++;/* Add Array Index */ -+ } while (1); -+ -+ return _TRUE; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/led/hal_pci_led.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/led/hal_pci_led.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/led/hal_pci_led.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/led/hal_pci_led.c 2018-02-11 21:44:27.152146162 +0200 -@@ -0,0 +1,2166 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+ -+/* -+ * Description: -+ * Turn on LED according to LedPin specified. -+ * */ -+VOID -+HwLedBlink( -+ IN PADAPTER Adapter, -+ IN PLED_PCIE pLed -+) -+{ -+ -+ -+ switch (pLed->LedPin) { -+ case LED_PIN_GPIO0: -+ break; -+ -+ case LED_PIN_LED0: -+ /* rtw_write8(Adapter, LED0Cfg, 0x2); */ -+ break; -+ -+ case LED_PIN_LED1: -+ /* rtw_write8(Adapter, LED1Cfg, 0x2); */ -+ break; -+ -+ default: -+ break; -+ } -+ -+ pLed->bLedOn = _TRUE; -+} -+ -+/* -+ * Description: -+ * Implement LED blinking behavior for SW_LED_MODE0. -+ * It toggle off LED and schedule corresponding timer if necessary. -+ * */ -+VOID -+SwLedBlink( -+ IN PLED_PCIE pLed -+) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ /* Change LED according to BlinkingLedState specified. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) { -+ SwLedOn(Adapter, pLed); -+ } else { -+ SwLedOff(Adapter, pLed); -+ } -+ -+ /* Determine if we shall change LED state again. */ -+ pLed->BlinkTimes--; -+ switch (pLed->CurrLedState) { -+ case LED_BLINK_NORMAL: -+ case LED_BLINK_TXRX: -+ case LED_BLINK_RUNTOP: -+ if (pLed->BlinkTimes == 0) -+ bStopBlinking = _TRUE; -+ break; -+ -+ case LED_BLINK_SCAN: -+ if (((check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, _FW_LINKED)) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) && /* Linked. */ -+ (!check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) && /* Not in scan stage. */ -+ (pLed->BlinkTimes % 2 == 0)) /* Even */ -+ bStopBlinking = _TRUE; -+ break; -+ -+ case LED_BLINK_NO_LINK: -+ case LED_BLINK_StartToBlink: -+ if (check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ bStopBlinking = _TRUE; -+ else if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) -+ bStopBlinking = _TRUE; -+ else if (pLed->BlinkTimes == 0) -+ bStopBlinking = _TRUE; -+ break; -+ -+ case LED_BLINK_CAMEO: -+ if (check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ bStopBlinking = _TRUE; -+ else if (check_fwstate(pmlmepriv, _FW_LINKED) && -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) -+ bStopBlinking = _TRUE; -+ break; -+ -+ default: -+ bStopBlinking = _TRUE; -+ break; -+ } -+ -+ if (bStopBlinking) { -+ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on) -+ SwLedOff(Adapter, pLed); -+ else if (pLed->CurrLedState == LED_BLINK_TXRX) -+ SwLedOff(Adapter, pLed); -+ else if (pLed->CurrLedState == LED_BLINK_RUNTOP) -+ SwLedOff(Adapter, pLed); -+ else if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && pLed->bLedOn == _FALSE) -+ SwLedOn(Adapter, pLed); -+ else if ((check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE) && pLed->bLedOn == _TRUE) -+ SwLedOff(Adapter, pLed); -+ -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = _FALSE; -+ } else { -+ /* Assign LED state to toggle. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ /* Schedule a timer to toggle LED state. */ -+ switch (pLed->CurrLedState) { -+ case LED_BLINK_NORMAL: -+ case LED_BLINK_TXRX: -+ case LED_BLINK_StartToBlink: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ break; -+ -+ case LED_BLINK_SLOWLY: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ break; -+ -+ case LED_BLINK_SCAN: -+ case LED_BLINK_NO_LINK: -+ if (pLed->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_OFF_INTERVAL); -+ break; -+ -+ case LED_BLINK_RUNTOP: -+ _set_timer(&(pLed->BlinkTimer), LED_RunTop_BLINK_INTERVAL); -+ break; -+ -+ case LED_BLINK_CAMEO: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_PORNET); -+ break; -+ -+ default: -+ /* RTW_INFO("SwLedCm2Blink(): unexpected state!\n"); */ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ break; -+ } -+ } -+} -+ -+VOID -+SwLedBlink5( -+ IN PLED_PCIE pLed -+) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ /* Change LED according to BlinkingLedState specified. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) { -+ SwLedOn(Adapter, pLed); -+ } else { -+ SwLedOff(Adapter, pLed); -+ } -+ -+ switch (pLed->CurrLedState) { -+ case RTW_LED_OFF: -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ case LED_BLINK_SLOWLY: -+ if (pLed->bLedOn) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_NETTRONIX); -+ break; -+ -+ case LED_BLINK_NORMAL: -+ pLed->BlinkTimes--; -+ if (pLed->BlinkTimes == 0) -+ bStopBlinking = _TRUE; -+ if (bStopBlinking) { -+ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on) -+ SwLedOff(Adapter, pLed); -+ else { -+ pLed->bLedSlowBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if (pLed->bLedOn) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_NETTRONIX); -+ } -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = _FALSE; -+ } else { -+ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on) -+ SwLedOff(Adapter, pLed); -+ else { -+ if (pLed->bLedOn) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL_NETTRONIX); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+ -+VOID -+SwLedBlink6( -+ IN PLED_PCIE pLed -+) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ /* Change LED according to BlinkingLedState specified. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) { -+ SwLedOn(Adapter, pLed); -+ } else { -+ SwLedOff(Adapter, pLed); -+ } -+ -+ switch (pLed->CurrLedState) { -+ case RTW_LED_OFF: -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ case LED_BLINK_SLOWLY: -+ if (pLed->bLedOn) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_PORNET); -+ break; -+ -+ case LED_BLINK_NORMAL: -+ pLed->BlinkTimes--; -+ if (pLed->BlinkTimes == 0) -+ bStopBlinking = _TRUE; -+ if (bStopBlinking) { -+ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on) -+ SwLedOff(Adapter, pLed); -+ else { -+ pLed->bLedSlowBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if (pLed->bLedOn) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_PORNET); -+ } -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = _FALSE; -+ } else { -+ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on) -+ SwLedOff(Adapter, pLed); -+ else { -+ if (pLed->bLedOn) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL_PORNET); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+VOID -+SwLedBlink7( -+ IN PLED_PCIE pLed -+) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ -+ SwLedOn(Adapter, pLed); -+} -+ -+ -+ -+/* -+ * Description: -+ * Implement LED blinking behavior for SW_LED_MODE8. -+ * It toggle off LED and schedule corresponding timer if necessary. -+ * */ -+VOID -+SwLedBlink8( -+ IN PLED_PCIE pLed -+) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ /* Change LED according to BlinkingLedState specified. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) { -+ SwLedOn(Adapter, pLed); -+ } else { -+ SwLedOff(Adapter, pLed); -+ } -+ -+ -+ /* Determine if we shall change LED state again. */ -+ if (pLed->CurrLedState != LED_BLINK_NO_LINK) -+ pLed->BlinkTimes--; -+ -+ switch (pLed->CurrLedState) { -+ case LED_BLINK_NORMAL: -+ case LED_BLINK_SCAN: -+ if (pLed->BlinkTimes == 0) -+ bStopBlinking = _TRUE; -+ break; -+ -+ default: -+ break; -+ } -+ -+ if (bStopBlinking) { -+ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) { -+ pLed->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed); -+ } else { -+ pLed->CurrLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed); -+ } -+ -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = _FALSE; -+ } else { -+ /* Assign LED state to toggle. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ /* Schedule a timer to toggle LED state. */ -+ switch (pLed->CurrLedState) { -+ case LED_BLINK_NORMAL: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ break; -+ -+ default: -+ /* RTW_INFO("SwLedCm8Blink(): unexpected state!\n"); */ -+ break; -+ } -+ } -+} -+ -+VOID -+SwLedBlink9( -+ IN PLED_PCIE pLed -+) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ /* Change LED according to BlinkingLedState specified. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) { -+ SwLedOn(Adapter, pLed); -+ } else { -+ SwLedOff(Adapter, pLed); -+ } -+ -+ /* Determine if we shall change LED state again. */ -+ if (pLed->CurrLedState != LED_BLINK_NO_LINK) -+ pLed->BlinkTimes--; -+ -+ switch (pLed->CurrLedState) { -+ case LED_BLINK_NORMAL: -+ case LED_BLINK_SCAN: -+ if (pLed->BlinkTimes == 0) -+ bStopBlinking = _TRUE; -+ break; -+ -+ case LED_BLINK_NO_LINK: -+ if (check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ bStopBlinking = _TRUE; -+ else if (check_fwstate(pmlmepriv, _FW_LINKED) && -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) -+ bStopBlinking = _TRUE; -+ break; -+ -+ default: -+ break; -+ } -+ -+ if (bStopBlinking) { -+ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) { -+ pLed->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed); -+ } else if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ pLed->CurrLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed); -+ } else if (check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE) { -+ pLed->CurrLedState = LED_BLINK_NO_LINK; -+ if (pLed->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); -+ } -+ -+ pLed->BlinkTimes = 0; -+ if (pLed->CurrLedState != LED_BLINK_NO_LINK) -+ pLed->bLedBlinkInProgress = _FALSE; -+ } else { -+ /* Assign LED state to toggle. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ /* Schedule a timer to toggle LED state. */ -+ switch (pLed->CurrLedState) { -+ case LED_BLINK_NORMAL: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FAST_INTERVAL_BITLAND); -+ break; -+ -+ case LED_BLINK_SCAN: -+ case LED_BLINK_NO_LINK: -+ if (pLed->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); -+ break; -+ -+ default: -+ /* RTW_INFO("SwLedCm2Blink(): unexpected state!\n"); */ -+ break; -+ } -+ } -+ -+ -+} -+ -+ -+VOID -+SwLedBlink10( -+ IN PLED_PCIE pLed -+) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ /* Change LED according to BlinkingLedState specified. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) { -+ SwLedOn(Adapter, pLed); -+ } else { -+ SwLedOff(Adapter, pLed); -+ } -+ -+ /* Determine if we shall change LED state again. */ -+ if (pLed->CurrLedState != LED_BLINK_NO_LINK) -+ pLed->BlinkTimes--; -+ -+ switch (pLed->CurrLedState) { -+ case LED_BLINK_NORMAL: -+ case LED_BLINK_SCAN: -+ if (pLed->BlinkTimes == 0) -+ bStopBlinking = _TRUE; -+ break; -+ default: -+ break; -+ } -+ -+ if (bStopBlinking) { -+ pLed->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed); -+ -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = _FALSE; -+ } else { -+ /* Assign LED state to toggle. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ /* Schedule a timer to toggle LED state. */ -+ switch (pLed->CurrLedState) { -+ case LED_BLINK_NORMAL: -+ case LED_BLINK_SCAN: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FAST_INTERVAL_BITLAND); -+ break; -+ -+ default: -+ /* RT_ASSERT(_FALSE, ("SwLedCm2Blink(): unexpected state!\n")); */ -+ break; -+ } -+ } -+ -+ -+} -+ -+ -+VOID -+SwLedBlink11( -+ IN PLED_PCIE pLed -+) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ /* Change LED according to BlinkingLedState specified. */ -+ if (pLed->bLedBlinkInProgress == _TRUE) { -+ if (pLed->BlinkingLedState == RTW_LED_ON) { -+ SwLedOn(Adapter, pLed); -+ } else { -+ SwLedOff(Adapter, pLed); -+ } -+ } -+ -+ /* Determine if we shall change LED state again. */ -+ if (pLed->CurrLedState != LED_BLINK_NO_LINK) -+ pLed->BlinkTimes--; -+ -+ switch (pLed->CurrLedState) { -+ case RTW_LED_ON: -+ bStopBlinking = _TRUE; /* LED on for 3 seconds */ -+ default: -+ break; -+ } -+ -+ if (bStopBlinking) { -+ pLed->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed); -+ -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = _FALSE; -+ } else { -+ /* Assign LED state to toggle. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ /* Schedule a timer to toggle LED state. */ -+ switch (pLed->CurrLedState) { -+ case LED_BLINK_XAVI: -+ _set_timer(&(pLed->BlinkTimer), LED_CM11_BLINK_INTERVAL); -+ break; -+ -+ default: -+ /* RT_ASSERT(_FALSE, ("SwLedCm11Blink(): unexpected state!\n")); */ -+ break; -+ } -+ } -+ -+ -+} -+ -+ -+VOID -+SwLedBlink12( -+ IN PLED_PCIE pLed -+) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bStopBlinking = _FALSE; -+ -+ /* Change LED according to BlinkingLedState specified. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) { -+ SwLedOn(Adapter, pLed); -+ } else { -+ SwLedOff(Adapter, pLed); -+ } -+ -+ /* Determine if we shall change LED state again. */ -+ if (pLed->CurrLedState != LED_BLINK_NO_LINK && pLed->CurrLedState != LED_BLINK_Azurewave_5Mbps -+ && pLed->CurrLedState != LED_BLINK_Azurewave_10Mbps && pLed->CurrLedState != LED_BLINK_Azurewave_20Mbps -+ && pLed->CurrLedState != LED_BLINK_Azurewave_40Mbps && pLed->CurrLedState != LED_BLINK_Azurewave_80Mbps -+ && pLed->CurrLedState != LED_BLINK_Azurewave_MAXMbps) -+ pLed->BlinkTimes--; -+ -+ switch (pLed->CurrLedState) { -+ case LED_BLINK_NORMAL: -+ case LED_BLINK_SCAN: -+ if (pLed->BlinkTimes == 0) -+ bStopBlinking = _TRUE; -+ break; -+ -+ case LED_BLINK_NO_LINK: -+ if (check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ bStopBlinking = _TRUE; -+ else if (check_fwstate(pmlmepriv, _FW_LINKED) && -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) -+ bStopBlinking = _TRUE; -+ break; -+ -+ case LED_BLINK_Azurewave_5Mbps: -+ case LED_BLINK_Azurewave_10Mbps: -+ case LED_BLINK_Azurewave_20Mbps: -+ case LED_BLINK_Azurewave_40Mbps: -+ case LED_BLINK_Azurewave_80Mbps: -+ case LED_BLINK_Azurewave_MAXMbps: -+ /* if(pTurboCa->TxThroughput + pTurboCa->RxThroughput == 0) */ -+ /* bStopBlinking = _TRUE; */ -+ -+ default: -+ break; -+ } -+ -+ if (bStopBlinking) { -+ if (adapter_to_pwrctl(Adapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(Adapter)->rfoff_reason > RF_CHANGE_BY_PS) { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed); -+ } else if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed); -+ } else if (check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE) { -+ pLed->CurrLedState = LED_BLINK_NO_LINK; -+ if (pLed->bLedOn) { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ } else { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); -+ } -+ } -+ -+ pLed->BlinkTimes = 0; -+ if (pLed->CurrLedState != LED_BLINK_NO_LINK) -+ pLed->bLedBlinkInProgress = _FALSE; -+ } else { -+ /* Assign LED state to toggle. */ -+ if (pLed->BlinkingLedState == RTW_LED_ON) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ /* Schedule a timer to toggle LED state. */ -+ switch (pLed->CurrLedState) { -+ case LED_BLINK_Azurewave_5Mbps: -+ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_5Mbps); -+ break; -+ -+ case LED_BLINK_Azurewave_10Mbps: -+ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_10Mbps); -+ break; -+ -+ case LED_BLINK_Azurewave_20Mbps: -+ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_20Mbps); -+ break; -+ -+ case LED_BLINK_Azurewave_40Mbps: -+ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_40Mbps); -+ break; -+ -+ case LED_BLINK_Azurewave_80Mbps: -+ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_80Mbps); -+ break; -+ -+ case LED_BLINK_Azurewave_MAXMbps: -+ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_MAXMbps); -+ break; -+ -+ case LED_BLINK_SCAN: -+ case LED_BLINK_NO_LINK: -+ if (pLed->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); -+ break; -+ -+ default: -+ /* RT_ASSERT(_FALSE, ("SwLedCm12Blink(): unexpected state!\n")); */ -+ break; -+ } -+ } -+ -+ -+} -+ -+/* -+ * Description: -+ * Handler function of LED Blinking. -+ * We dispatch acture LED blink action according to LedStrategy. -+ * */ -+void BlinkHandler(PLED_PCIE pLed) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ return; -+ -+ if (IS_HARDWARE_TYPE_8188E(padapter) || -+ IS_HARDWARE_TYPE_JAGUAR(padapter) || -+ IS_HARDWARE_TYPE_8723B(padapter) || -+ IS_HARDWARE_TYPE_8192E(padapter)) -+ return; -+ -+ switch (ledpriv->LedStrategy) { -+ case SW_LED_MODE1: -+ /* SwLedBlink(pLed); */ -+ break; -+ case SW_LED_MODE2: -+ /* SwLedBlink(pLed); */ -+ break; -+ case SW_LED_MODE3: -+ /* SwLedBlink(pLed); */ -+ break; -+ case SW_LED_MODE5: -+ /* SwLedBlink5(pLed); */ -+ break; -+ case SW_LED_MODE6: -+ /* SwLedBlink6(pLed); */ -+ break; -+ case SW_LED_MODE7: -+ SwLedBlink7(pLed); -+ break; -+ case SW_LED_MODE8: -+ SwLedBlink8(pLed); -+ break; -+ -+ case SW_LED_MODE9: -+ SwLedBlink9(pLed); -+ break; -+ -+ case SW_LED_MODE10: -+ SwLedBlink10(pLed); -+ break; -+ -+ case SW_LED_MODE11: -+ SwLedBlink11(pLed); -+ break; -+ -+ case SW_LED_MODE12: -+ SwLedBlink12(pLed); -+ break; -+ -+ default: -+ /* SwLedBlink(pLed); */ -+ break; -+ } -+} -+ -+/* -+ * Description: -+ * Callback function of LED BlinkTimer, -+ * it just schedules to corresponding BlinkWorkItem/led_blink_hdl -+ * */ -+void BlinkTimerCallback(void *data) -+{ -+ PLED_PCIE pLed = (PLED_PCIE)data; -+ _adapter *padapter = pLed->padapter; -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ if (RTW_CANNOT_RUN(padapter) || (!rtw_is_hw_init_completed(padapter))) { -+ /*RTW_INFO("%s bDriverStopped:%s, bSurpriseRemoved:%s\n" -+ , __func__ -+ , rtw_is_drv_stopped(padapter)?"True":"False" -+ , rtw_is_surprise_removed(padapter)?"True":"False" ); -+ */ -+ return; -+ } -+ -+#ifdef CONFIG_LED_HANDLED_BY_CMD_THREAD -+ rtw_led_blink_cmd(padapter, pLed); -+#else -+ BlinkHandler(pLed); -+#endif -+} -+ -+/* -+ * Description: -+ * Implement each led action for SW_LED_MODE0. */ -+VOID -+SwLedControlMode0( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ PLED_PCIE pLed0 = &(ledpriv->SwLed0); -+ PLED_PCIE pLed1 = &(ledpriv->SwLed1); -+ -+ switch (LedAction) { -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ break; -+ -+ case LED_CTL_LINK: -+ pLed0->CurrLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed0); -+ -+ pLed1->CurrLedState = LED_BLINK_NORMAL; -+ HwLedBlink(Adapter, pLed1); -+ break; -+ -+ case LED_CTL_POWER_ON: -+ pLed0->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed0); -+ -+ pLed1->CurrLedState = LED_BLINK_NORMAL; -+ HwLedBlink(Adapter, pLed1); -+ -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed0->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed0); -+ -+ pLed1->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed1); -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ break; -+ -+ case LED_CTL_NO_LINK: -+ pLed0->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed0); -+ -+ pLed1->CurrLedState = LED_BLINK_NORMAL; -+ HwLedBlink(Adapter, pLed1); -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+ -+VOID -+SwLedControlMode1( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ PLED_PCIE pLed = &(ledpriv->SwLed1); -+ -+ /* Decide led state */ -+ switch (LedAction) { -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if (pLed->bLedBlinkInProgress == _FALSE) { -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ pLed->BlinkTimes = 2; -+ -+ if (pLed->bLedOn) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if (pLed->bLedBlinkInProgress == _FALSE) { -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) { -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 4; -+ } else { -+ pLed->CurrLedState = LED_BLINK_NO_LINK; -+ pLed->BlinkTimes = 24; -+ } -+ -+ if (pLed->bLedOn) { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ } else { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_OFF_INTERVAL); -+ } -+ } else { -+ if (pLed->CurrLedState != LED_BLINK_NO_LINK) { -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE)) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))) -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ else -+ pLed->CurrLedState = LED_BLINK_NO_LINK; -+ } -+ } -+ break; -+ -+ case LED_CTL_NO_LINK: -+ if (pLed->bLedBlinkInProgress == _FALSE) { -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ pLed->CurrLedState = LED_BLINK_NO_LINK; -+ pLed->BlinkTimes = 24; -+ -+ if (pLed->bLedOn) { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ } else { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_OFF_INTERVAL); -+ } -+ } else -+ pLed->CurrLedState = LED_BLINK_NO_LINK; -+ break; -+ -+ case LED_CTL_LINK: -+ pLed->CurrLedState = RTW_LED_ON; -+ if (pLed->bLedBlinkInProgress == _FALSE) -+ SwLedOn(Adapter, pLed); -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ if (pLed->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+VOID -+SwLedControlMode2( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ PLED_PCIE pLed0 = &(ledpriv->SwLed0); -+ PLED_PCIE pLed1 = &(ledpriv->SwLed1); -+ -+ /* Decide led state */ -+ switch (LedAction) { -+ case LED_CTL_POWER_ON: -+ pLed0->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed0); -+ -+ pLed1->CurrLedState = LED_BLINK_CAMEO; -+ if (pLed1->bLedBlinkInProgress == _FALSE) { -+ pLed1->bLedBlinkInProgress = _TRUE; -+ -+ pLed1->BlinkTimes = 6; -+ -+ if (pLed1->bLedOn) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_PORNET); -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if (pLed0->bLedBlinkInProgress == _FALSE) { -+ pLed0->bLedBlinkInProgress = _TRUE; -+ -+ pLed0->CurrLedState = LED_BLINK_TXRX; -+ pLed0->BlinkTimes = 2; -+ -+ if (pLed0->bLedOn) -+ pLed0->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed0->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed0->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_CTL_NO_LINK: -+ pLed1->CurrLedState = LED_BLINK_CAMEO; -+ if (pLed1->bLedBlinkInProgress == _FALSE) { -+ pLed1->bLedBlinkInProgress = _TRUE; -+ -+ pLed1->BlinkTimes = 6; -+ -+ if (pLed1->bLedOn) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_PORNET); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ pLed1->CurrLedState = RTW_LED_ON; -+ if (pLed1->bLedBlinkInProgress == _FALSE) -+ SwLedOn(Adapter, pLed1); -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed0->CurrLedState = RTW_LED_OFF; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ if (pLed0->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedBlinkInProgress = _FALSE; -+ } -+ if (pLed1->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed0); -+ SwLedOff(Adapter, pLed1); -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+ -+ -+VOID -+SwLedControlMode3( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ PLED_PCIE pLed0 = &(ledpriv->SwLed0); -+ PLED_PCIE pLed1 = &(ledpriv->SwLed1); -+ -+ /* Decide led state */ -+ switch (LedAction) { -+ case LED_CTL_POWER_ON: -+ pLed0->CurrLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed0); -+ pLed1->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed1); -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if (pLed1->bLedBlinkInProgress == _FALSE) { -+ pLed1->bLedBlinkInProgress = _TRUE; -+ -+ pLed1->CurrLedState = LED_BLINK_RUNTOP; -+ pLed1->BlinkTimes = 2; -+ -+ if (pLed1->bLedOn) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed1->BlinkTimer), LED_RunTop_BLINK_INTERVAL); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed0->CurrLedState = RTW_LED_OFF; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ if (pLed0->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedBlinkInProgress = _FALSE; -+ } -+ if (pLed1->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed0); -+ SwLedOff(Adapter, pLed1); -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+ -+VOID -+SwLedControlMode4( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ PLED_PCIE pLed0 = &(ledpriv->SwLed0); -+ PLED_PCIE pLed1 = &(ledpriv->SwLed1); -+ -+ /* Decide led state */ -+ switch (LedAction) { -+ case LED_CTL_POWER_ON: -+ pLed1->CurrLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed1); -+ pLed0->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed0); -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if (pLed0->bLedBlinkInProgress == _FALSE) { -+ pLed0->bLedBlinkInProgress = _TRUE; -+ -+ pLed0->CurrLedState = LED_BLINK_RUNTOP; -+ pLed0->BlinkTimes = 2; -+ -+ if (pLed0->bLedOn) -+ pLed0->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed0->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed0->BlinkTimer), LED_RunTop_BLINK_INTERVAL); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed0->CurrLedState = RTW_LED_OFF; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ if (pLed0->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedBlinkInProgress = _FALSE; -+ } -+ if (pLed1->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed0); -+ SwLedOff(Adapter, pLed1); -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+/* added by vivi, for led new mode */ -+VOID -+SwLedControlMode5( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ PLED_PCIE pLed0 = &(ledpriv->SwLed0); -+ PLED_PCIE pLed1 = &(ledpriv->SwLed1); -+ /* Decide led state */ -+ switch (LedAction) { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_START_TO_LINK: -+ case LED_CTL_NO_LINK: -+ pLed1->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed1); -+ -+ -+ if (pLed0->bLedSlowBlinkInProgress == _FALSE) { -+ pLed0->bLedSlowBlinkInProgress = _TRUE; -+ pLed0->CurrLedState = LED_BLINK_SLOWLY; -+ if (pLed0->bLedOn) -+ pLed0->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed0->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed0->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_NETTRONIX); -+ } -+ -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ pLed1->CurrLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed1); -+ -+ if (pLed0->bLedBlinkInProgress == _FALSE) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedSlowBlinkInProgress = _FALSE; -+ pLed0->bLedBlinkInProgress = _TRUE; -+ pLed0->CurrLedState = LED_BLINK_NORMAL; -+ pLed0->BlinkTimes = 2; -+ -+ if (pLed0->bLedOn) -+ pLed0->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed0->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed0->BlinkTimer), LED_BLINK_NORMAL_INTERVAL_NETTRONIX); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ pLed1->CurrLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed1); -+ -+ if (pLed0->bLedSlowBlinkInProgress == _FALSE) { -+ pLed0->bLedSlowBlinkInProgress = _TRUE; -+ pLed0->CurrLedState = LED_BLINK_SLOWLY; -+ if (pLed0->bLedOn) -+ pLed0->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed0->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed0->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_NETTRONIX); -+ } -+ break; -+ -+ -+ case LED_CTL_POWER_OFF: -+ pLed0->CurrLedState = RTW_LED_OFF; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ if (pLed0->bLedSlowBlinkInProgress == _TRUE) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedSlowBlinkInProgress = _FALSE; -+ } -+ if (pLed0->bLedBlinkInProgress == _TRUE) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed0); -+ SwLedOff(Adapter, pLed1); -+ break; -+ -+ default: -+ break; -+ } -+ -+ -+} -+ -+/* added by vivi, for led new mode */ -+VOID -+SwLedControlMode6( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ PLED_PCIE pLed0 = &(ledpriv->SwLed0); -+ PLED_PCIE pLed1 = &(ledpriv->SwLed1); -+ -+ -+ switch (LedAction) { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_START_TO_LINK: -+ case LED_CTL_NO_LINK: -+ case LED_CTL_LINK: -+ case LED_CTL_SITE_SURVEY: -+ pLed1->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed1); -+ -+ if (pLed0->bLedSlowBlinkInProgress == _FALSE) { -+ pLed0->bLedSlowBlinkInProgress = _TRUE; -+ pLed0->CurrLedState = LED_BLINK_SLOWLY; -+ if (pLed0->bLedOn) -+ pLed0->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed0->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed0->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL_PORNET); -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ pLed1->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed1); -+ if (pLed0->bLedBlinkInProgress == _FALSE) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedSlowBlinkInProgress = _FALSE; -+ pLed0->bLedBlinkInProgress = _TRUE; -+ pLed0->CurrLedState = LED_BLINK_NORMAL; -+ pLed0->BlinkTimes = 2; -+ if (pLed0->bLedOn) -+ pLed0->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed0->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed0->BlinkTimer), LED_BLINK_NORMAL_INTERVAL_PORNET); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed1->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed1); -+ -+ pLed0->CurrLedState = RTW_LED_OFF; -+ if (pLed0->bLedSlowBlinkInProgress == _TRUE) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedSlowBlinkInProgress = _FALSE; -+ } -+ if (pLed0->bLedBlinkInProgress == _TRUE) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed0); -+ break; -+ -+ default: -+ break; -+ -+ } -+} -+ -+ -+/* added by chiyokolin, for Lenovo */ -+VOID -+SwLedControlMode7( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ PLED_PCIE pLed0 = &(ledpriv->SwLed0); -+ -+ switch (LedAction) { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_LINK: -+ case LED_CTL_NO_LINK: -+ SwLedOn(Adapter, pLed0); -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ SwLedOff(Adapter, pLed0); -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+/* added by chiyokolin, for QMI */ -+VOID -+SwLedControlMode8( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ PLED_PCIE pLed = &(ledpriv->SwLed0); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ -+ /* Decide led state */ -+ switch (LedAction) { -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if (pLed->bLedBlinkInProgress == _FALSE && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ pLed->BlinkTimes = 2; -+ -+ if (pLed->bLedOn) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ case LED_CTL_POWER_ON: -+ case LED_CTL_NO_LINK: -+ case LED_CTL_LINK: -+ pLed->CurrLedState = RTW_LED_ON; -+ if (pLed->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOn(Adapter, pLed); -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ if (pLed->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+/* added by chiyokolin, for MSI */ -+VOID -+SwLedControlMode9( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ PLED_PCIE pLed = &(ledpriv->SwLed0); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ -+ /* Decide led state */ -+ switch (LedAction) { -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if (pLed->bLedBlinkInProgress == _FALSE && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ pLed->BlinkTimes = 2; -+ -+ if (pLed->bLedOn) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FAST_INTERVAL_BITLAND); -+ } -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if (pLed->bLedBlinkInProgress == _FALSE) { -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 2; -+ -+ if (pLed->bLedOn) { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ } else { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); -+ } -+ } else if (pLed->CurrLedState != LED_BLINK_SCAN) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 2; -+ -+ if (pLed->bLedOn) { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ } else { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_CTL_POWER_ON: -+ case LED_CTL_NO_LINK: -+ if (pLed->bLedBlinkInProgress == _FALSE) { -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ pLed->CurrLedState = LED_BLINK_NO_LINK; -+ pLed->BlinkTimes = 24; -+ -+ if (pLed->bLedOn) { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ } else { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); -+ } -+ } else if (pLed->CurrLedState != LED_BLINK_SCAN && pLed->CurrLedState != LED_BLINK_NO_LINK) { -+ pLed->CurrLedState = LED_BLINK_NO_LINK; -+ pLed->BlinkTimes = 24; -+ -+ if (pLed->bLedOn) { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ } else { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ pLed->CurrLedState = RTW_LED_ON; -+ if (pLed->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOn(Adapter, pLed); -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ if (pLed->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ default: -+ break; -+ } -+ -+ -+} -+ -+ -+/* added by chiyokolin, for Edimax-ASUS */ -+VOID -+SwLedControlMode10( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ PLED_PCIE pLed0 = &(ledpriv->SwLed0); -+ PLED_PCIE pLed1 = &(ledpriv->SwLed1); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ -+ /* Decide led state */ -+ switch (LedAction) { -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if (pLed1->bLedBlinkInProgress == _FALSE && pLed1->bLedWPSBlinkInProgress == _FALSE && -+ (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { -+ pLed1->bLedBlinkInProgress = _TRUE; -+ -+ pLed1->CurrLedState = LED_BLINK_NORMAL; -+ pLed1->BlinkTimes = 2; -+ -+ if (pLed1->bLedOn) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if (pLed1->bLedBlinkInProgress == _FALSE && pLed1->bLedWPSBlinkInProgress == _FALSE) { -+ pLed1->bLedBlinkInProgress = _TRUE; -+ pLed1->CurrLedState = LED_BLINK_SCAN; -+ pLed1->BlinkTimes = 12; -+ -+ if (pLed1->bLedOn) { -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } else { -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ } else if (pLed1->CurrLedState != LED_BLINK_SCAN && pLed1->bLedWPSBlinkInProgress == _FALSE) { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->CurrLedState = LED_BLINK_SCAN; -+ pLed1->BlinkTimes = 24; -+ -+ if (pLed1->bLedOn) { -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } else { -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_CTL_START_WPS: -+ case LED_CTL_START_WPS_BOTTON: -+ pLed1->CurrLedState = RTW_LED_ON; -+ if (pLed1->bLedBlinkInProgress == _TRUE) { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = _FALSE; -+ } -+ -+ if (pLed1->bLedWPSBlinkInProgress == _FALSE) { -+ pLed1->bLedWPSBlinkInProgress = _TRUE; -+ SwLedOn(Adapter, pLed1); -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ case LED_CTL_STOP_WPS_FAIL: -+ case LED_CTL_STOP_WPS_FAIL_OVERLAP: -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ pLed0->CurrLedState = RTW_LED_ON; -+ if (pLed0->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOn(Adapter, pLed0); -+ } else { -+ pLed0->CurrLedState = RTW_LED_OFF; -+ if (pLed0->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed0); -+ } -+ -+ pLed1->CurrLedState = RTW_LED_OFF; -+ if (pLed1->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed1); -+ -+ pLed1->bLedWPSBlinkInProgress = _FALSE; -+ -+ break; -+ -+ case LED_CTL_LINK: -+ pLed0->CurrLedState = RTW_LED_ON; -+ if (pLed0->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOn(Adapter, pLed0); -+ break; -+ -+ case LED_CTL_NO_LINK: -+ if (pLed1->bLedWPSBlinkInProgress == _TRUE) { -+ SwLedOn(Adapter, pLed1); -+ break; -+ } -+ -+ if (pLed1->CurrLedState == LED_BLINK_SCAN) -+ break; -+ -+ pLed0->CurrLedState = RTW_LED_OFF; -+ if (pLed0->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed0); -+ -+ pLed1->CurrLedState = RTW_LED_OFF; -+ if (pLed1->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed1); -+ -+ break; -+ -+ -+ case LED_CTL_POWER_ON: -+ case LED_CTL_POWER_OFF: -+ if (pLed1->bLedWPSBlinkInProgress == _TRUE) { -+ SwLedOn(Adapter, pLed1); -+ break; -+ } -+ pLed0->CurrLedState = RTW_LED_OFF; -+ if (pLed0->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed0); -+ -+ pLed1->CurrLedState = RTW_LED_OFF; -+ if (pLed1->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed1); -+ -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ -+} -+ -+ -+/* added by hpfan, for Xavi */ -+VOID -+SwLedControlMode11( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ PLED_PCIE pLed = &(ledpriv->SwLed0); -+ -+ /* Decide led state */ -+ switch (LedAction) { -+ case LED_CTL_START_WPS: -+ case LED_CTL_START_WPS_BOTTON: -+ pLed->bLedWPSBlinkInProgress = _TRUE; -+ if (pLed->bLedBlinkInProgress == _FALSE) { -+ pLed->bLedBlinkInProgress = _TRUE; -+ pLed->CurrLedState = LED_BLINK_XAVI; -+ -+ if (pLed->bLedOn) { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_CM11_BLINK_INTERVAL); -+ } else { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_CM11_BLINK_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ case LED_CTL_STOP_WPS_FAIL: -+ case LED_CTL_STOP_WPS_FAIL_OVERLAP: -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ if (pLed->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ pLed->CurrLedState = RTW_LED_OFF; -+ } -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ case LED_CTL_LINK: -+ if (pLed->bLedWPSBlinkInProgress) -+ break; -+ -+ if (pLed->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ pLed->CurrLedState = RTW_LED_ON; -+ -+ if (!pLed->bLedOn) -+ SwLedOn(Adapter, pLed); -+ } else { -+ pLed->CurrLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed); -+ } -+ -+ _set_timer(&(pLed->BlinkTimer), LED_CM11_LINK_ON_INTERVEL); -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ break; -+ -+ case LED_CTL_NO_LINK: -+ if (pLed->bLedWPSBlinkInProgress) -+ break; -+ -+ if (pLed->bLedBlinkInProgress == _TRUE) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ pLed->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ case LED_CTL_POWER_ON: -+ case LED_CTL_POWER_OFF: -+ if (pLed->bLedBlinkInProgress == _TRUE) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ -+ pLed->CurrLedState = RTW_LED_OFF; -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ -+} -+ -+/* added by chiyokolin, for Azurewave */ -+VOID -+SwLedControlMode12( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ PLED_PCIE pLed = &(ledpriv->SwLed0); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ LED_STATE LedState = LED_UNKNOWN; -+ -+ -+ /* Decide led state */ -+ switch (LedAction) { -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ if (pLed->CurrLedState == LED_BLINK_SCAN) -+ break; -+ -+ pLed->BlinkTimes = 0; -+ -+ if (pLed->bLedOn) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ /*if(pTurboCa->TotalThroughput <= 5) -+ LedState = LED_BLINK_Azurewave_5Mbps; -+ else if(pTurboCa->TotalThroughput <= 10) -+ LedState = LED_BLINK_Azurewave_10Mbps; -+ else if(pTurboCa->TotalThroughput <=20) -+ LedState = LED_BLINK_Azurewave_20Mbps; -+ else if(pTurboCa->TotalThroughput <=40) -+ LedState = LED_BLINK_Azurewave_40Mbps; -+ else if(pTurboCa->TotalThroughput <=80) -+ LedState = LED_BLINK_Azurewave_80Mbps; -+ else*/ -+ LedState = LED_BLINK_Azurewave_MAXMbps; -+ -+ if (pLed->bLedBlinkInProgress == _FALSE || pLed->CurrLedState != LedState) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->CurrLedState = LedState; -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ switch (LedState) { -+ case LED_BLINK_Azurewave_5Mbps: -+ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_5Mbps); -+ break; -+ -+ case LED_BLINK_Azurewave_10Mbps: -+ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_10Mbps); -+ break; -+ -+ case LED_BLINK_Azurewave_20Mbps: -+ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_20Mbps); -+ break; -+ -+ case LED_BLINK_Azurewave_40Mbps: -+ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_40Mbps); -+ break; -+ -+ case LED_BLINK_Azurewave_80Mbps: -+ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_80Mbps); -+ break; -+ -+ case LED_BLINK_Azurewave_MAXMbps: -+ _set_timer(&(pLed->BlinkTimer), LED_CM12_BLINK_INTERVAL_MAXMbps); -+ break; -+ -+ default: -+ break; -+ } -+ } -+ } -+ -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ case LED_CTL_START_WPS: -+ case LED_CTL_START_WPS_BOTTON: -+ if (pLed->bLedBlinkInProgress == _FALSE) -+ pLed->bLedBlinkInProgress = _TRUE; -+ else if (pLed->CurrLedState != LED_BLINK_SCAN) -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 2; -+ -+ if (pLed->bLedOn) { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ } else { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ pLed->CurrLedState = RTW_LED_ON; -+ if (pLed->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOn(Adapter, pLed); -+ break; -+ -+ case LED_CTL_NO_LINK: -+ case LED_CTL_POWER_ON: -+ if (pLed->CurrLedState == LED_BLINK_SCAN) -+ break; -+ -+ pLed->CurrLedState = LED_BLINK_NO_LINK; -+ pLed->bLedBlinkInProgress = _TRUE; -+ -+ if (pLed->bLedOn) { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_CM2_BLINK_ON_INTERVAL); -+ } else { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_CM8_BLINK_OFF_INTERVAL); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ if (pLed->bLedBlinkInProgress) { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = _FALSE; -+ } -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ -+} -+ -+void -+LedControlPCIE( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ -+#if (MP_DRIVER == 1) -+ if (padapter->registrypriv.mp_mode == 1) -+ return; -+#endif -+ -+ if (RTW_CANNOT_RUN(padapter) || (!rtw_is_hw_init_completed(padapter))) -+ return; -+ -+ /* if(priv->bInHctTest) */ -+ /* return; */ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ /* Only do led action for PRIMARY_ADAPTER */ -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ -+ if ((adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) && -+ (LedAction == LED_CTL_TX || -+ LedAction == LED_CTL_RX || -+ LedAction == LED_CTL_SITE_SURVEY || -+ LedAction == LED_CTL_LINK || -+ LedAction == LED_CTL_NO_LINK || -+ LedAction == LED_CTL_START_TO_LINK || -+ LedAction == LED_CTL_POWER_ON)) { -+ return; -+ } -+ -+ switch (ledpriv->LedStrategy) { -+ case SW_LED_MODE0: -+ /* SwLedControlMode0(padapter, LedAction); */ -+ break; -+ -+ case SW_LED_MODE1: -+ /* SwLedControlMode1(padapter, LedAction); */ -+ break; -+ -+ case SW_LED_MODE2: -+ /* SwLedControlMode2(padapter, LedAction); */ -+ break; -+ -+ case SW_LED_MODE3: -+ /* SwLedControlMode3(padapter, LedAction); */ -+ break; -+ -+ case SW_LED_MODE4: -+ /* SwLedControlMode4(padapter, LedAction); */ -+ break; -+ -+ case SW_LED_MODE5: -+ /* SwLedControlMode5(padapter, LedAction); */ -+ break; -+ -+ case SW_LED_MODE6: -+ /* SwLedControlMode6(padapter, LedAction); */ -+ break; -+ -+ case SW_LED_MODE7: -+ SwLedControlMode7(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE8: -+ SwLedControlMode8(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE9: -+ SwLedControlMode9(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE10: -+ SwLedControlMode10(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE11: -+ SwLedControlMode11(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE12: -+ SwLedControlMode12(padapter, LedAction); -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: gen_RefreshLedState() -+ * -+ * Overview: When we call the function, media status is no link. It must be in SW/HW -+ * radio off. Or IPS state. If IPS no link we will turn on LED, otherwise, we must turn off. -+ * After MAC IO reset, we must write LED control 0x2f2 again. -+ * -+ * Input: IN PADAPTER Adapter) -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 03/27/2009 MHC Create for LED judge only~!! -+ * -+ *---------------------------------------------------------------------------*/ -+VOID -+gen_RefreshLedState( -+ IN PADAPTER Adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(Adapter); -+ struct led_priv *pledpriv = &(Adapter->ledpriv); -+ PLED_PCIE pLed0 = &(Adapter->ledpriv.SwLed0); -+ -+ RTW_INFO("gen_RefreshLedState:() pwrctrlpriv->rfoff_reason=%x\n", pwrctrlpriv->rfoff_reason); -+ -+ if (Adapter->bDriverIsGoingToUnload) { -+ switch (pledpriv->LedStrategy) { -+ case SW_LED_MODE9: -+ case SW_LED_MODE10: -+ rtw_led_control(Adapter, LED_CTL_POWER_OFF); -+ break; -+ -+ default: -+ /* Turn off LED if RF is not ON. */ -+ SwLedOff(Adapter, pLed0); -+ break; -+ } -+ } else if (pwrctrlpriv->rfoff_reason == RF_CHANGE_BY_IPS) { -+ switch (pledpriv->LedStrategy) { -+ case SW_LED_MODE7: -+ SwLedOn(Adapter, pLed0); -+ break; -+ -+ case SW_LED_MODE8: -+ case SW_LED_MODE9: -+ rtw_led_control(Adapter, LED_CTL_NO_LINK); -+ break; -+ -+ default: -+ SwLedOn(Adapter, pLed0); -+ break; -+ } -+ } else if (pwrctrlpriv->rfoff_reason == RF_CHANGE_BY_INIT) { -+ switch (pledpriv->LedStrategy) { -+ case SW_LED_MODE7: -+ SwLedOn(Adapter, pLed0); -+ break; -+ -+ case SW_LED_MODE9: -+ rtw_led_control(Adapter, LED_CTL_NO_LINK); -+ break; -+ -+ default: -+ SwLedOn(Adapter, pLed0); -+ break; -+ -+ } -+ } else { /* SW/HW radio off */ -+ -+ switch (pledpriv->LedStrategy) { -+ case SW_LED_MODE9: -+ rtw_led_control(Adapter, LED_CTL_POWER_OFF); -+ break; -+ -+ default: -+ /* Turn off LED if RF is not ON. */ -+ SwLedOff(Adapter, pLed0); -+ break; -+ } -+ } -+ -+} -+ -+/* -+ * Description: -+ * Reset status of LED_871x object. -+ * */ -+void ResetLedStatus(PLED_PCIE pLed) -+{ -+ -+ pLed->CurrLedState = RTW_LED_OFF; /* Current LED state. */ -+ pLed->bLedOn = _FALSE; /* true if LED is ON, false if LED is OFF. */ -+ -+ pLed->bLedBlinkInProgress = _FALSE; /* true if it is blinking, false o.w.. */ -+ pLed->bLedWPSBlinkInProgress = _FALSE; -+ pLed->bLedSlowBlinkInProgress = _FALSE; -+ -+ pLed->BlinkTimes = 0; /* Number of times to toggle led state for blinking. */ -+ pLed->BlinkingLedState = LED_UNKNOWN; /* Next state for blinking, either RTW_LED_ON or RTW_LED_OFF are. */ -+} -+ -+/* -+* Description: -+* Initialize an LED_871x object. -+* */ -+void -+InitLed( -+ _adapter *padapter, -+ PLED_PCIE pLed, -+ LED_PIN LedPin -+) -+{ -+ pLed->padapter = padapter; -+ pLed->LedPin = LedPin; -+ -+ ResetLedStatus(pLed); -+ -+ _init_timer(&(pLed->BlinkTimer), padapter->pnetdev, BlinkTimerCallback, pLed); -+} -+ -+ -+/* -+ * Description: -+ * DeInitialize an LED_871x object. -+ * */ -+void -+DeInitLed( -+ PLED_PCIE pLed -+) -+{ -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ ResetLedStatus(pLed); -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halhwimg.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halhwimg.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halhwimg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halhwimg.h 2018-02-11 21:44:27.153146177 +0200 -@@ -0,0 +1,123 @@ -+#pragma once -+#ifndef __INC_HW_IMG_H -+#define __INC_HW_IMG_H -+ -+// -+// 2011/03/15 MH Add for different IC HW image file selection. code size consideration. -+// -+#if RT_PLATFORM == PLATFORM_LINUX -+ -+ #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ // For 92C -+ #define RTL8192CE_HWIMG_SUPPORT 1 -+ #define RTL8192CE_TEST_HWIMG_SUPPORT 0 -+ #define RTL8192CU_HWIMG_SUPPORT 0 -+ #define RTL8192CU_TEST_HWIMG_SUPPORT 0 -+ -+ // For 92D -+ #define RTL8192DE_HWIMG_SUPPORT 1 -+ #define RTL8192DE_TEST_HWIMG_SUPPORT 0 -+ #define RTL8192DU_HWIMG_SUPPORT 0 -+ #define RTL8192DU_TEST_HWIMG_SUPPORT 0 -+ -+ // For 8723 -+ #define RTL8723E_HWIMG_SUPPORT 1 -+ #define RTL8723U_HWIMG_SUPPORT 0 -+ #define RTL8723S_HWIMG_SUPPORT 0 -+ -+ //For 88E -+ #define RTL8188EE_HWIMG_SUPPORT 0 -+ #define RTL8188EU_HWIMG_SUPPORT 0 -+ #define RTL8188ES_HWIMG_SUPPORT 0 -+ -+ #elif (DEV_BUS_TYPE == RT_USB_INTERFACE) -+ // For 92C -+ #define RTL8192CE_HWIMG_SUPPORT 0 -+ #define RTL8192CE_TEST_HWIMG_SUPPORT 0 -+ #define RTL8192CU_HWIMG_SUPPORT 1 -+ #define RTL8192CU_TEST_HWIMG_SUPPORT 0 -+ -+ //For 92D -+ #define RTL8192DE_HWIMG_SUPPORT 0 -+ #define RTL8192DE_TEST_HWIMG_SUPPORT 0 -+ #define RTL8192DU_HWIMG_SUPPORT 1 -+ #define RTL8192DU_TEST_HWIMG_SUPPORT 0 -+ -+ // For 8723 -+ #define RTL8723E_HWIMG_SUPPORT 0 -+ #define RTL8723U_HWIMG_SUPPORT 1 -+ #define RTL8723S_HWIMG_SUPPORT 0 -+ -+ //For 88E -+ #define RTL8188EE_HWIMG_SUPPORT 0 -+ #define RTL8188EU_HWIMG_SUPPORT 0 -+ #define RTL8188ES_HWIMG_SUPPORT 0 -+ -+ #elif (DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+ // For 92C -+ #define RTL8192CE_HWIMG_SUPPORT 0 -+ #define RTL8192CE_TEST_HWIMG_SUPPORT 0 -+ #define RTL8192CU_HWIMG_SUPPORT 1 -+ #define RTL8192CU_TEST_HWIMG_SUPPORT 0 -+ -+ //For 92D -+ #define RTL8192DE_HWIMG_SUPPORT 0 -+ #define RTL8192DE_TEST_HWIMG_SUPPORT 0 -+ #define RTL8192DU_HWIMG_SUPPORT 1 -+ #define RTL8192DU_TEST_HWIMG_SUPPORT 0 -+ -+ // For 8723 -+ #define RTL8723E_HWIMG_SUPPORT 0 -+ #define RTL8723U_HWIMG_SUPPORT 0 -+ #define RTL8723S_HWIMG_SUPPORT 1 -+ -+ //For 88E -+ #define RTL8188EE_HWIMG_SUPPORT 0 -+ #define RTL8188EU_HWIMG_SUPPORT 0 -+ #define RTL8188ES_HWIMG_SUPPORT 0 -+ #endif -+ -+#else // PLATFORM_WINDOWS & MacOSX -+ -+//For 92C -+#define RTL8192CE_HWIMG_SUPPORT 1 -+#define RTL8192CE_TEST_HWIMG_SUPPORT 1 -+#define RTL8192CU_HWIMG_SUPPORT 1 -+#define RTL8192CU_TEST_HWIMG_SUPPORT 1 -+ -+// For 92D -+#define RTL8192DE_HWIMG_SUPPORT 1 -+#define RTL8192DE_TEST_HWIMG_SUPPORT 1 -+#define RTL8192DU_HWIMG_SUPPORT 1 -+#define RTL8192DU_TEST_HWIMG_SUPPORT 1 -+ -+ #if defined(UNDER_CE) -+ // For 8723 -+ #define RTL8723E_HWIMG_SUPPORT 0 -+ #define RTL8723U_HWIMG_SUPPORT 0 -+ #define RTL8723S_HWIMG_SUPPORT 1 -+ -+ // For 88E -+ #define RTL8188EE_HWIMG_SUPPORT 0 -+ #define RTL8188EU_HWIMG_SUPPORT 0 -+ #define RTL8188ES_HWIMG_SUPPORT 0 -+ -+ #else -+ -+ // For 8723 -+ #define RTL8723E_HWIMG_SUPPORT 1 -+ //#define RTL_8723E_TEST_HWIMG_SUPPORT 1 -+ #define RTL8723U_HWIMG_SUPPORT 1 -+ //#define RTL_8723U_TEST_HWIMG_SUPPORT 1 -+ #define RTL8723S_HWIMG_SUPPORT 1 -+ //#define RTL_8723S_TEST_HWIMG_SUPPORT 1 -+ -+ //For 88E -+ #define RTL8188EE_HWIMG_SUPPORT 1 -+ #define RTL8188EU_HWIMG_SUPPORT 1 -+ #define RTL8188ES_HWIMG_SUPPORT 1 -+ #endif -+ -+#endif -+ -+#endif //__INC_HW_IMG_H -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.c 2018-02-11 21:44:27.153146177 +0200 -@@ -0,0 +1,2790 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ #include "mp_precomp.h" -+ #include "phydm_precomp.h" -+ -+#ifndef index_mapping_NUM_88E -+ #define index_mapping_NUM_88E 15 -+#endif -+ -+//#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ -+ do {\ -+ for(_offset = 0; _offset < _size; _offset++)\ -+ {\ -+ if(_deltaThermal < thermalThreshold[_direction][_offset])\ -+ {\ -+ if(_offset != 0)\ -+ _offset--;\ -+ break;\ -+ }\ -+ } \ -+ if(_offset >= _size)\ -+ _offset = _size-1;\ -+ } while(0) -+ -+ -+void ConfigureTxpowerTrack( -+ IN PVOID pDM_VOID, -+ OUT PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if RTL8812A_SUPPORT -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ //if (IS_HARDWARE_TYPE_8812(pDM_Odm->Adapter)) -+ if(pDM_Odm->SupportICType==ODM_RTL8812) -+ ConfigureTxpowerTrack_8812A(pConfig); -+ //else -+#endif -+#endif -+ -+#if RTL8814A_SUPPORT -+ if(pDM_Odm->SupportICType== ODM_RTL8814A) -+ ConfigureTxpowerTrack_8814A(pConfig); -+#endif -+ -+ -+#if RTL8188E_SUPPORT -+ if(pDM_Odm->SupportICType==ODM_RTL8188E) -+ ConfigureTxpowerTrack_8188E(pConfig); -+#endif -+ -+#if RTL8197F_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8197F) -+ ConfigureTxpowerTrack_8197F(pConfig); -+#endif -+ -+#if RTL8822B_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ ConfigureTxpowerTrack_8822B(pConfig); -+#endif -+ -+ -+} -+ -+#if (RTL8192E_SUPPORT==1) -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_92E( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte ThermalValue = 0, delta, delta_IQK, delta_LCK, channel, is_decrease, rf_mimo_mode; -+ u1Byte ThermalValue_AVG_count = 0; -+ u1Byte OFDM_min_index = 10; //OFDM BB Swing should be less than +2.5dB, which is required by Arthur -+ s1Byte OFDM_index[2], index ; -+ u4Byte ThermalValue_AVG = 0, Reg0x18; -+ u4Byte i = 0, j = 0, rf; -+ s4Byte value32, CCK_index = 0, ele_A, ele_D, ele_C, X, Y; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ rf_mimo_mode = pDM_Odm->RFType; -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("%s:%d rf_mimo_mode:%d\n", __FUNCTION__, __LINE__, rf_mimo_mode)); -+ -+#ifdef MP_TEST -+ if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { -+ channel = priv->pshare->working_channel; -+ if (priv->pshare->mp_txpwr_tracking == FALSE) -+ return; -+ } else -+#endif -+ { -+ channel = (priv->pmib->dot11RFEntry.dot11channel); -+ } -+ -+ ThermalValue = (unsigned char)ODM_GetRFReg(pDM_Odm, RF_PATH_A, ODM_RF_T_METER_92E, 0xfc00); //0x42: RF Reg[15:10] 88E -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ -+ -+ switch (rf_mimo_mode) { -+ case MIMO_1T1R: -+ rf = 1; -+ break; -+ case MIMO_2T2R: -+ rf = 2; -+ break; -+ default: -+ rf = 2; -+ break; -+ } -+ -+ //Query OFDM path A default setting Bit[31:21] -+ ele_D = PHY_QueryBBReg(priv, rOFDM0_XATxIQImbalance, bMaskOFDM_D); -+ for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) { -+ if (ele_D == (OFDMSwingTable_92E[i] >> 22)) { -+ OFDM_index[0] = (unsigned char)i; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("PathA 0xC80[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[0])); -+ break; -+ } -+ } -+ -+ //Query OFDM path B default setting -+ if (rf_mimo_mode == MIMO_2T2R) { -+ ele_D = PHY_QueryBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskOFDM_D); -+ for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) { -+ if (ele_D == (OFDMSwingTable_92E[i] >> 22)) { -+ OFDM_index[1] = (unsigned char)i; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("PathB 0xC88[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[1])); -+ break; -+ } -+ } -+ } -+ -+ /* calculate average thermal meter */ -+ { -+ priv->pshare->ThermalValue_AVG_88XX[priv->pshare->ThermalValue_AVG_index_88XX] = ThermalValue; -+ priv->pshare->ThermalValue_AVG_index_88XX++; -+ if (priv->pshare->ThermalValue_AVG_index_88XX == AVG_THERMAL_NUM_88XX) -+ priv->pshare->ThermalValue_AVG_index_88XX = 0; -+ -+ for (i = 0; i < AVG_THERMAL_NUM_88XX; i++) { -+ if (priv->pshare->ThermalValue_AVG_88XX[i]) { -+ ThermalValue_AVG += priv->pshare->ThermalValue_AVG_88XX[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if (ThermalValue_AVG_count) { -+ ThermalValue = (unsigned char)(ThermalValue_AVG / ThermalValue_AVG_count); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("AVG Thermal Meter = 0x%x \n", ThermalValue)); -+ } -+ } -+ -+ /* Initialize */ -+ if (!priv->pshare->ThermalValue) { -+ priv->pshare->ThermalValue = priv->pmib->dot11RFEntry.ther; -+ priv->pshare->ThermalValue_IQK = ThermalValue; -+ priv->pshare->ThermalValue_LCK = ThermalValue; -+ } -+ -+ if (ThermalValue != priv->pshare->ThermalValue) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** START POWER TRACKING ********\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ -+ delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); -+ delta_IQK = RTL_ABS(ThermalValue, priv->pshare->ThermalValue_IQK); -+ delta_LCK = RTL_ABS(ThermalValue, priv->pshare->ThermalValue_LCK); -+ is_decrease = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 1 : 0); -+ -+#ifdef _TRACKING_TABLE_FILE -+ if (priv->pshare->rf_ft_var.pwr_track_file) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Diff: (%s)%d ==> get index from table : %d)\n", (is_decrease?"-":"+"), delta, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); -+ -+ if (is_decrease) { -+ for (i = 0; i < rf; i++) { -+ OFDM_index[i] = priv->pshare->OFDM_index0[i] + get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0); -+ OFDM_index[i] = ((OFDM_index[i] > (OFDM_TABLE_SIZE_92E- 1)) ? (OFDM_TABLE_SIZE_92E - 1) : OFDM_index[i]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> decrese power ---> new OFDM_INDEX:%d (%d + %d)\n", OFDM_index[i], priv->pshare->OFDM_index0[i], get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); -+ CCK_index = priv->pshare->CCK_index0 + get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1); -+ CCK_index = ((CCK_index > (CCK_TABLE_SIZE_92E - 1)) ? (CCK_TABLE_SIZE_92E - 1) : CCK_index); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> Decrese power ---> new CCK_INDEX:%d (%d + %d)\n", CCK_index, priv->pshare->CCK_index0, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1))); -+ } -+ } else { -+ for (i = 0; i < rf; i++) { -+ OFDM_index[i] = priv->pshare->OFDM_index0[i] - get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0); -+ OFDM_index[i] = ((OFDM_index[i] < OFDM_min_index) ? OFDM_min_index : OFDM_index[i]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> Increse power ---> new OFDM_INDEX:%d (%d - %d)\n", OFDM_index[i], priv->pshare->OFDM_index0[i], get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); -+ CCK_index = priv->pshare->CCK_index0 - get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1); -+ CCK_index = ((CCK_index < 0 )? 0 : CCK_index); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> Increse power ---> new CCK_INDEX:%d (%d - %d)\n", CCK_index, priv->pshare->CCK_index0, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1))); -+ } -+ } -+ } -+#endif //CFG_TRACKING_TABLE_FILE -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDMSwingTable_92E[(unsigned int)OFDM_index[0]] = %x \n",OFDMSwingTable_92E[(unsigned int)OFDM_index[0]])); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDMSwingTable_92E[(unsigned int)OFDM_index[1]] = %x \n",OFDMSwingTable_92E[(unsigned int)OFDM_index[1]])); -+ -+ //Adujst OFDM Ant_A according to IQK result -+ ele_D = (OFDMSwingTable_92E[(unsigned int)OFDM_index[0]] & 0xFFC00000) >> 22; -+ X = priv->pshare->RegE94; -+ Y = priv->pshare->RegE9C; -+ -+ if (X != 0) { -+ if ((X & 0x00000200) != 0) -+ X = X | 0xFFFFFC00; -+ ele_A = ((X * ele_D) >> 8) & 0x000003FF; -+ -+ //new element C = element D x Y -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ ele_C = ((Y * ele_D) >> 8) & 0x000003FF; -+ -+ //wirte new elements A, C, D to regC80 and regC94, element B is always 0 -+ value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; -+ PHY_SetBBReg(priv, rOFDM0_XATxIQImbalance, bMaskDWord, value32); -+ -+ value32 = (ele_C&0x000003C0)>>6; -+ PHY_SetBBReg(priv, rOFDM0_XCTxAFE, bMaskH4Bits, value32); -+ -+ value32 = ((X * ele_D)>>7)&0x01; -+ PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(24), value32); -+ } else { -+ PHY_SetBBReg(priv, rOFDM0_XATxIQImbalance, bMaskDWord, OFDMSwingTable_92E[(unsigned int)OFDM_index[0]]); -+ PHY_SetBBReg(priv, rOFDM0_XCTxAFE, bMaskH4Bits, 0x00); -+ PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(24), 0x00); -+ } -+ -+ set_CCK_swing_index(priv, CCK_index); -+ -+ if (rf == 2) { -+ ele_D = (OFDMSwingTable_92E[(unsigned int)OFDM_index[1]] & 0xFFC00000) >> 22; -+ X = priv->pshare->RegEB4; -+ Y = priv->pshare->RegEBC; -+ -+ if (X != 0) { -+ if ((X & 0x00000200) != 0) //consider minus -+ X = X | 0xFFFFFC00; -+ ele_A = ((X * ele_D) >> 8) & 0x000003FF; -+ -+ //new element C = element D x Y -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ ele_C = ((Y * ele_D) >> 8) & 0x00003FF; -+ -+ //wirte new elements A, C, D to regC88 and regC9C, element B is always 0 -+ value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; -+ PHY_SetBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskDWord, value32); -+ -+ value32 = (ele_C & 0x000003C0) >> 6; -+ PHY_SetBBReg(priv, rOFDM0_XDTxAFE, bMaskH4Bits, value32); -+ -+ value32 = ((X * ele_D) >> 7) & 0x01; -+ PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(28), value32); -+ } else { -+ PHY_SetBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskDWord, OFDMSwingTable_92E[(unsigned int)OFDM_index[1]]); -+ PHY_SetBBReg(priv, rOFDM0_XDTxAFE, bMaskH4Bits, 0x00); -+ PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(28), 0x00); -+ } -+ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0xc80 = 0x%x \n", PHY_QueryBBReg(priv, rOFDM0_XATxIQImbalance, bMaskDWord))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0xc88 = 0x%x \n", PHY_QueryBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskDWord))); -+ -+ if (delta_IQK > 3) { -+ priv->pshare->ThermalValue_IQK = ThermalValue; -+#ifdef MP_TEST -+ if (!(priv->pshare->rf_ft_var.mp_specific && (OPMODE & (WIFI_MP_CTX_BACKGROUND | WIFI_MP_CTX_PACKET)))) -+#endif -+ PHY_IQCalibrate_8192E(pDM_Odm,false); -+ } -+ -+ if (delta_LCK > 8) { -+ RTL_W8(0x522, 0xff); -+ Reg0x18 = PHY_QueryRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, 1); -+ PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 1); -+ PHY_SetRFReg(priv, RF_PATH_A, 0x18, BIT(15), 1); -+ delay_ms(1); -+ PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 0); -+ PHY_SetRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, Reg0x18); -+ RTL_W8(0x522, 0x0); -+ priv->pshare->ThermalValue_LCK = ThermalValue; -+ } -+ } -+ -+ //update thermal meter value -+ priv->pshare->ThermalValue = ThermalValue; -+ for (i = 0 ; i < rf ; i++) -+ priv->pshare->OFDM_index[i] = OFDM_index[i]; -+ priv->pshare->CCK_index = CCK_index; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n", __FUNCTION__)); -+} -+#endif -+ -+ -+ -+#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries3( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+#if 1 -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, channel, is_increase; -+ u1Byte ThermalValue_AVG_count = 0, p = 0, i = 0; -+ u4Byte ThermalValue_AVG = 0; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ TXPWRTRACK_CFG c; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ /*4 1. The following TWO tables decide the final index of OFDM/CCK swing table.*/ -+ pu1Byte deltaSwingTableIdx_TUP_A = NULL, deltaSwingTableIdx_TDOWN_A = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_B = NULL, deltaSwingTableIdx_TDOWN_B = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_CCK_A = NULL, deltaSwingTableIdx_TDOWN_CCK_A = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_CCK_B = NULL, deltaSwingTableIdx_TDOWN_CCK_B = NULL; -+ /*for 8814 add by Yu Chen*/ -+ pu1Byte deltaSwingTableIdx_TUP_C = NULL, deltaSwingTableIdx_TDOWN_C = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_D = NULL, deltaSwingTableIdx_TDOWN_D = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_CCK_C = NULL, deltaSwingTableIdx_TDOWN_CCK_C = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_CCK_D = NULL, deltaSwingTableIdx_TDOWN_CCK_D = NULL; -+ -+#ifdef MP_TEST -+ if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { -+ channel = priv->pshare->working_channel; -+ if (priv->pshare->mp_txpwr_tracking == FALSE) -+ return; -+ } else -+#endif -+ { -+ channel = (priv->pmib->dot11RFEntry.dot11channel); -+ } -+ -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ -+ (*c.GetDeltaAllSwingTable)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_A, (pu1Byte *)&deltaSwingTableIdx_TDOWN_A, -+ (pu1Byte *)&deltaSwingTableIdx_TUP_B, (pu1Byte *)&deltaSwingTableIdx_TDOWN_B, -+ (pu1Byte *)&deltaSwingTableIdx_TUP_CCK_A, (pu1Byte *)&deltaSwingTableIdx_TDOWN_CCK_A, -+ (pu1Byte *)&deltaSwingTableIdx_TUP_CCK_B, (pu1Byte *)&deltaSwingTableIdx_TDOWN_CCK_B); -+ -+ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); /*0x42: RF Reg[15:10] 88E*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Readback Thermal Meter = 0x%x(%d) EEPROMthermalmeter 0x%x(%d)\n" -+ , ThermalValue, ThermalValue, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther)); -+ -+ /* Initialize */ -+ if (!pDM_Odm->RFCalibrateInfo.ThermalValue) -+ pDM_Odm->RFCalibrateInfo.ThermalValue = priv->pmib->dot11RFEntry.ther; -+ -+ if (!pDM_Odm->RFCalibrateInfo.ThermalValue_LCK) -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = priv->pmib->dot11RFEntry.ther; -+ -+ if (!pDM_Odm->RFCalibrateInfo.ThermalValue_IQK) -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = priv->pmib->dot11RFEntry.ther; -+ -+ /* calculate average thermal meter */ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; -+ -+ if (pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) /*Average times = c.AverageThermalNum*/ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; -+ -+ for (i = 0; i < c.AverageThermalNum; i++) { -+ if (pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) { -+ ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if (ThermalValue_AVG_count) {/*Calculate Average ThermalValue after average enough times*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("ThermalValue_AVG=0x%x(%d) ThermalValue_AVG_count = %d\n" -+ , ThermalValue_AVG, ThermalValue_AVG, ThermalValue_AVG_count)); -+ -+ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("AVG Thermal Meter = 0x%X(%d), EEPROMthermalmeter = 0x%X(%d)\n", ThermalValue, ThermalValue, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther)); -+ } -+ -+ /*4 Calculate delta, delta_LCK, delta_IQK.*/ -+ delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); -+ delta_LCK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_LCK); -+ delta_IQK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_IQK); -+ is_increase = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 0 : 1); -+ -+ if (delta > 29) { /* power track table index(thermal diff.) upper bound*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta(%d) > 29, set delta to 29\n", delta)); -+ delta = 29; -+ } -+ -+ -+ /*4 if necessary, do LCK.*/ -+ -+ if (delta_LCK > c.Threshold_IQK) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; -+ if (c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ -+ if (delta_IQK > c.Threshold_IQK) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = ThermalValue; -+ if (c.DoIQK) -+ (*c.DoIQK)(pDM_Odm, TRUE, 0, 0); -+ } -+ -+ if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ -+ return; -+ -+ /*4 Do Power Tracking*/ -+ -+ if (ThermalValue != pDM_Odm->RFCalibrateInfo.ThermalValue) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n\n******** START POWER TRACKING ********\n")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Readback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", -+ ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ -+#ifdef _TRACKING_TABLE_FILE -+ if (priv->pshare->rf_ft_var.pwr_track_file) { -+ if (is_increase) { /*thermal is higher than base*/ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ switch (p) { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_B[%d] = %d deltaSwingTableIdx_TUP_CCK_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta], delta, deltaSwingTableIdx_TUP_CCK_B[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; -+ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = deltaSwingTableIdx_TUP_CCK_B[delta]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_C[%d] = %d deltaSwingTableIdx_TUP_CCK_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta], delta, deltaSwingTableIdx_TUP_CCK_C[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; -+ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = deltaSwingTableIdx_TUP_CCK_C[delta]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_D[%d] = %d deltaSwingTableIdx_TUP_CCK_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta], delta, deltaSwingTableIdx_TUP_CCK_D[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; -+ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = deltaSwingTableIdx_TUP_CCK_D[delta]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); -+ break; -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_A[%d] = %d deltaSwingTableIdx_TUP_CCK_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta], delta, deltaSwingTableIdx_TUP_CCK_A[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; -+ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = deltaSwingTableIdx_TUP_CCK_A[delta]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); -+ break; -+ } -+ } -+ } else { /* thermal is lower than base*/ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ switch (p) { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_B[%d] = %d deltaSwingTableIdx_TDOWN_CCK_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta], delta, deltaSwingTableIdx_TDOWN_CCK_B[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; -+ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_CCK_B[delta]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_C[%d] = %d deltaSwingTableIdx_TDOWN_CCK_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta], delta, deltaSwingTableIdx_TDOWN_CCK_C[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; -+ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_CCK_C[delta]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_D[%d] = %d deltaSwingTableIdx_TDOWN_CCK_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta], delta, deltaSwingTableIdx_TDOWN_CCK_D[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; -+ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_CCK_D[delta]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_A[%d] = %d deltaSwingTableIdx_TDOWN_CCK_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta], delta, deltaSwingTableIdx_TDOWN_CCK_A[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; -+ pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_CCK_A[delta]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); -+ break; -+ } -+ } -+ } -+ -+ if (is_increase) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> increse power --->\n")); -+ if (GET_CHIP_VER(priv) == VERSION_8197F) { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, 0); -+ } else if (GET_CHIP_VER(priv) == VERSION_8822B) { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> decrese power --->\n")); -+ if (GET_CHIP_VER(priv) == VERSION_8197F) { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, 0); -+ } else if (GET_CHIP_VER(priv) == VERSION_8822B) { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } -+ } -+ } -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n\n", __func__)); -+ /*update thermal meter value*/ -+ pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; -+ -+ } -+ -+#endif -+} -+#endif -+ -+/*#if (RTL8814A_SUPPORT == 1)*/ -+#if (RTL8814A_SUPPORT == 1) -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries2( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, channel, is_increase; -+ u1Byte ThermalValue_AVG_count = 0, p = 0, i = 0; -+ u4Byte ThermalValue_AVG = 0, Reg0x18; -+ u4Byte BBSwingReg[4] = {rA_TxScale_Jaguar,rB_TxScale_Jaguar,rC_TxScale_Jaguar2,rD_TxScale_Jaguar2}; -+ s4Byte ele_D; -+ u4Byte BBswingIdx; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ TXPWRTRACK_CFG c; -+ BOOLEAN bTSSIenable = FALSE; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. -+ pu1Byte deltaSwingTableIdx_TUP_A = NULL, deltaSwingTableIdx_TDOWN_A = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_B = NULL, deltaSwingTableIdx_TDOWN_B = NULL; -+ //for 8814 add by Yu Chen -+ pu1Byte deltaSwingTableIdx_TUP_C = NULL, deltaSwingTableIdx_TDOWN_C = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_D = NULL, deltaSwingTableIdx_TDOWN_D = NULL; -+ -+#ifdef MP_TEST -+ if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { -+ channel = priv->pshare->working_channel; -+ if (priv->pshare->mp_txpwr_tracking == FALSE) -+ return; -+ } else -+#endif -+ { -+ channel = (priv->pmib->dot11RFEntry.dot11channel); -+ } -+ -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ pRFCalibrateInfo->DefaultOfdmIndex = priv->pshare->OFDM_index0[ODM_RF_PATH_A]; -+ -+ (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_A, (pu1Byte*)&deltaSwingTableIdx_TDOWN_A, -+ (pu1Byte*)&deltaSwingTableIdx_TUP_B, (pu1Byte*)&deltaSwingTableIdx_TDOWN_B); -+ -+ if(pDM_Odm->SupportICType & ODM_RTL8814A) // for 8814 path C & D -+ (*c.GetDeltaSwingTable8814only)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_C, (pu1Byte*)&deltaSwingTableIdx_TDOWN_C, -+ (pu1Byte*)&deltaSwingTableIdx_TUP_D, (pu1Byte*)&deltaSwingTableIdx_TDOWN_D); -+ -+ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\nReadback Thermal Meter = 0x%x, pre thermal meter 0x%x, EEPROMthermalmeter 0x%x\n", ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ -+ /* Initialize */ -+ if (!pDM_Odm->RFCalibrateInfo.ThermalValue) { -+ pDM_Odm->RFCalibrateInfo.ThermalValue = priv->pmib->dot11RFEntry.ther; -+ } -+ -+ if (!pDM_Odm->RFCalibrateInfo.ThermalValue_LCK) { -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = priv->pmib->dot11RFEntry.ther; -+ } -+ -+ if (!pDM_Odm->RFCalibrateInfo.ThermalValue_IQK) { -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = priv->pmib->dot11RFEntry.ther; -+ } -+ -+ bTSSIenable = (BOOLEAN)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, rRF_TxGainOffset, BIT7); // check TSSI enable -+ -+ //4 Query OFDM BB swing default setting Bit[31:21] -+ for(p = ODM_RF_PATH_A ; p < c.RfPathCount ; p++) -+ { -+ ele_D = ODM_GetBBReg(pDM_Odm, BBSwingReg[p], 0xffe00000); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("0x%x:0x%x ([31:21] = 0x%x)\n", BBSwingReg[p], ODM_GetBBReg(pDM_Odm, BBSwingReg[p], bMaskDWord), ele_D)); -+ -+ for (BBswingIdx = 0; BBswingIdx < TXSCALE_TABLE_SIZE; BBswingIdx++) {//4 -+ if (ele_D == TxScalingTable_Jaguar[BBswingIdx]) { -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = (u1Byte)BBswingIdx; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("OFDM_index[%d]=%d\n",p, pDM_Odm->RFCalibrateInfo.OFDM_index[p])); -+ break; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("KfreeOffset[%d]=%d\n",p, pRFCalibrateInfo->KfreeOffset[p])); -+ -+ } -+ -+ /* calculate average thermal meter */ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; -+ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) //Average times = c.AverageThermalNum -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; -+ -+ for(i = 0; i < c.AverageThermalNum; i++) -+ { -+ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) -+ { -+ ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times -+ { -+ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("AVG Thermal Meter = 0x%X, EEPROMthermalmeter = 0x%X\n", ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ } -+ -+ //4 Calculate delta, delta_LCK, delta_IQK. -+ delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); -+ delta_LCK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_LCK); -+ delta_IQK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_IQK); -+ is_increase = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 0 : 1); -+ -+ //4 if necessary, do LCK. -+ if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { -+ if (delta_LCK > c.Threshold_IQK) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; -+ -+ /*Use RTLCK, so close power tracking driver LCK*/ -+ #if (RTL8814A_SUPPORT != 1) -+ if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { -+ if (c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ #endif -+ } -+ } -+ -+ if (delta_IQK > c.Threshold_IQK) -+ { -+ panic_printk("%s(%d)\n", __FUNCTION__, __LINE__); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = ThermalValue; -+ if(c.DoIQK) -+ (*c.DoIQK)(pDM_Odm, TRUE, 0, 0); -+ } -+ -+ if(!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ -+ return; -+ -+ //4 Do Power Tracking -+ -+ if(bTSSIenable == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("**********Enter PURE TSSI MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TSSI_MODE, p, 0); -+ } -+ else if (ThermalValue != pDM_Odm->RFCalibrateInfo.ThermalValue) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n******** START POWER TRACKING ********\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ -+#ifdef _TRACKING_TABLE_FILE -+ if (priv->pshare->rf_ft_var.pwr_track_file) -+ { -+ if (is_increase) // thermal is higher than base -+ { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ switch(p) -+ { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ } -+ } -+ } -+ else // thermal is lower than base -+ { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ switch(p) -+ { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; // Record delta swing for mix mode power tracking -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ } -+ } -+ } -+ -+ if (is_increase) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> increse power ---> \n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> decrese power --->\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } -+ } -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** END:%s() ********\n", __FUNCTION__)); -+ //update thermal meter value -+ pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; -+ -+ } -+} -+#endif -+ -+#if (RTL8812A_SUPPORT == 1 || RTL8881A_SUPPORT == 1) -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ unsigned char ThermalValue = 0, delta, delta_LCK, channel, is_decrease; -+ unsigned char ThermalValue_AVG_count = 0; -+ unsigned int ThermalValue_AVG = 0, Reg0x18; -+ unsigned int BBSwingReg[4]={0xc1c,0xe1c,0x181c,0x1a1c}; -+ int ele_D, value32; -+ char OFDM_index[2], index; -+ unsigned int i = 0, j = 0, rf_path, max_rf_path =2 ,rf; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ unsigned char OFDM_min_index = 7; //OFDM BB Swing should be less than +2.5dB, which is required by Arthur and Mimic -+ -+ -+ -+#ifdef MP_TEST -+ if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { -+ channel = priv->pshare->working_channel; -+ if (priv->pshare->mp_txpwr_tracking == FALSE) -+ return; -+ } else -+#endif -+ { -+ channel = (priv->pmib->dot11RFEntry.dot11channel); -+ } -+ -+#if RTL8881A_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8881A) { -+ max_rf_path = 1; -+ if ((get_bonding_type_8881A() == BOND_8881AM ||get_bonding_type_8881A() == BOND_8881AN) -+ && priv->pshare->rf_ft_var.use_intpa8881A && (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G)) -+ OFDM_min_index = 6; // intPA - upper bond set to +3 dB (base: -2 dB)ot11RFEntry.phyBandSelect == PHY_BAND_2G)) -+ else -+ OFDM_min_index = 10; //OFDM BB Swing should be less than +1dB, which is required by Arthur and Mimic -+ } -+#endif -+ -+ -+ ThermalValue = (unsigned char)PHY_QueryRFReg(priv, RF_PATH_A, 0x42, 0xfc00, 1); //0x42: RF Reg[15:10] 88E -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ -+ -+ //4 Query OFDM BB swing default setting Bit[31:21] -+ for(rf_path = 0 ; rf_path < max_rf_path ; rf_path++){ -+ ele_D = PHY_QueryBBReg(priv, BBSwingReg[rf_path], 0xffe00000); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("0x%x:0x%x ([31:21] = 0x%x)\n",BBSwingReg[rf_path], PHY_QueryBBReg(priv, BBSwingReg[rf_path], bMaskDWord),ele_D)); -+ for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {//4 -+ if (ele_D == OFDMSwingTable_8812[i]) { -+ OFDM_index[rf_path] = (unsigned char)i; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDM_index[%d]=%d\n",rf_path, OFDM_index[rf_path])); -+ break; -+ } -+ } -+ } -+#if 0 -+ //Query OFDM path A default setting Bit[31:21] -+ ele_D = PHY_QueryBBReg(priv, 0xc1c, 0xffe00000); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("0xc1c:0x%x ([31:21] = 0x%x)\n", PHY_QueryBBReg(priv, 0xc1c, bMaskDWord),ele_D)); -+ for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {//4 -+ if (ele_D == OFDMSwingTable_8812[i]) { -+ OFDM_index[0] = (unsigned char)i; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDM_index[0]=%d\n", OFDM_index[0])); -+ break; -+ } -+ } -+ //Query OFDM path B default setting -+ if (rf == 2) { -+ ele_D = PHY_QueryBBReg(priv, 0xe1c, 0xffe00000); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("0xe1c:0x%x ([32:21] = 0x%x)\n", PHY_QueryBBReg(priv, 0xe1c, bMaskDWord),ele_D)); -+ for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) { -+ if (ele_D == OFDMSwingTable_8812[i]) { -+ OFDM_index[1] = (unsigned char)i; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDM_index[1]=%d\n", OFDM_index[1])); -+ break; -+ } -+ } -+ } -+#endif -+ /* Initialize */ -+ if (!priv->pshare->ThermalValue) { -+ priv->pshare->ThermalValue = priv->pmib->dot11RFEntry.ther; -+ priv->pshare->ThermalValue_LCK = ThermalValue; -+ } -+ -+ /* calculate average thermal meter */ -+ { -+ priv->pshare->ThermalValue_AVG_8812[priv->pshare->ThermalValue_AVG_index_8812] = ThermalValue; -+ priv->pshare->ThermalValue_AVG_index_8812++; -+ if (priv->pshare->ThermalValue_AVG_index_8812 == AVG_THERMAL_NUM_8812) -+ priv->pshare->ThermalValue_AVG_index_8812 = 0; -+ -+ for (i = 0; i < AVG_THERMAL_NUM_8812; i++) { -+ if (priv->pshare->ThermalValue_AVG_8812[i]) { -+ ThermalValue_AVG += priv->pshare->ThermalValue_AVG_8812[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if (ThermalValue_AVG_count) { -+ ThermalValue = (unsigned char)(ThermalValue_AVG / ThermalValue_AVG_count); -+ //printk("AVG Thermal Meter = 0x%x \n", ThermalValue); -+ } -+ } -+ -+ -+ //4 If necessary, do power tracking -+ -+ if(!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ -+ return; -+ -+ if (ThermalValue != priv->pshare->ThermalValue) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** START POWER TRACKING ********\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); -+ delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); -+ delta_LCK = RTL_ABS(ThermalValue, priv->pshare->ThermalValue_LCK); -+ is_decrease = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 1 : 0); -+ //if (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) -+ { -+#ifdef _TRACKING_TABLE_FILE -+ if (priv->pshare->rf_ft_var.pwr_track_file) { -+ for (rf_path = 0; rf_path < max_rf_path; rf_path++) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Diff: (%s)%d ==> get index from table : %d)\n", (is_decrease?"-":"+"), delta, get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); -+ if (is_decrease) { -+ OFDM_index[rf_path] = priv->pshare->OFDM_index0[rf_path] + get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0); -+ OFDM_index[rf_path] = ((OFDM_index[rf_path] > (OFDM_TABLE_SIZE_8812 - 1)) ? (OFDM_TABLE_SIZE_8812 - 1) : OFDM_index[rf_path]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> decrese power ---> new OFDM_INDEX:%d (%d + %d)\n", OFDM_index[rf_path], priv->pshare->OFDM_index0[rf_path], get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); -+#if 0// RTL8881A_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8881A){ -+ if(priv->pshare->rf_ft_var.pwrtrk_TxAGC_enable){ -+ if(priv->pshare->AddTxAGC){//TxAGC has been added -+ AddTxPower88XX_AC(priv,0); -+ priv->pshare->AddTxAGC = 0; -+ priv->pshare->AddTxAGC_index = 0; -+ } -+ } -+ } -+#endif -+ } else { -+ -+ OFDM_index[rf_path] = priv->pshare->OFDM_index0[rf_path] - get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0); -+#if 0// RTL8881A_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8881A){ -+ if(priv->pshare->rf_ft_var.pwrtrk_TxAGC_enable){ -+ if(OFDM_index[i] < OFDM_min_index){ -+ priv->pshare->AddTxAGC_index = (OFDM_min_index - OFDM_index[i])/2; // Calculate Remnant TxAGC Value, 2 index for 1 TxAGC -+ AddTxPower88XX_AC(priv,priv->pshare->AddTxAGC_index); -+ priv->pshare->AddTxAGC = 1; //AddTxAGC Flag = 1 -+ OFDM_index[i] = OFDM_min_index; -+ } -+ else{ -+ if(priv->pshare->AddTxAGC){// TxAGC been added -+ priv->pshare->AddTxAGC = 0; -+ priv->pshare->AddTxAGC_index = 0; -+ AddTxPower88XX_AC(priv,0); //minus the added TPI -+ } -+ } -+ } -+ } -+#else -+ OFDM_index[rf_path] = ((OFDM_index[rf_path] < OFDM_min_index) ? OFDM_min_index : OFDM_index[rf_path]); -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> increse power ---> new OFDM_INDEX:%d (%d - %d)\n", OFDM_index[rf_path], priv->pshare->OFDM_index0[rf_path], get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); -+ } -+ } -+ } -+#endif -+ //4 Set new BB swing index -+ for (rf_path = 0; rf_path < max_rf_path; rf_path++) { -+ PHY_SetBBReg(priv, BBSwingReg[rf_path], 0xffe00000, OFDMSwingTable_8812[(unsigned int)OFDM_index[rf_path]]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Readback 0x%x[31:21] = 0x%x, OFDM_index:%d\n",BBSwingReg[rf_path], PHY_QueryBBReg(priv, BBSwingReg[rf_path], 0xffe00000), OFDM_index[rf_path])); -+ } -+ -+ } -+ if (delta_LCK > 8) { -+ RTL_W8(0x522, 0xff); -+ Reg0x18 = PHY_QueryRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, 1); -+ PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 1); -+ PHY_SetRFReg(priv, RF_PATH_A, 0x18, BIT(15), 1); -+ delay_ms(200); // frequency deviation -+ PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 0); -+ PHY_SetRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, Reg0x18); -+ #ifdef CONFIG_RTL_8812_SUPPORT -+ if (GET_CHIP_VER(priv)== VERSION_8812E) -+ UpdateBBRFVal8812(priv, priv->pmib->dot11RFEntry.dot11channel); -+ #endif -+ RTL_W8(0x522, 0x0); -+ priv->pshare->ThermalValue_LCK = ThermalValue; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** END:%s() ********\n", __FUNCTION__)); -+ -+ //update thermal meter value -+ priv->pshare->ThermalValue = ThermalValue; -+ for (rf_path = 0; rf_path < max_rf_path; rf_path++) -+ priv->pshare->OFDM_index[rf_path] = OFDM_index[rf_path]; -+ } -+} -+ -+#endif -+ -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ -+#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8197F || pDM_Odm->SupportICType == ODM_RTL8822B) { -+ ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries3(pDM_Odm); -+ return; -+ } -+#endif -+#if (RTL8814A_SUPPORT == 1) /*use this function to do power tracking after 8814 by YuChen*/ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) { -+ ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries2(pDM_Odm); -+ return; -+ } -+#endif -+#if (RTL8881A_SUPPORT || RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8812 || pDM_Odm->SupportICType & ODM_RTL8881A) { -+ ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries(pDM_Odm); -+ return; -+ } -+#endif -+ -+#if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType==ODM_RTL8192E) { -+ ODM_TXPowerTrackingCallback_ThermalMeter_92E(pDM_Odm); -+ return; -+ } -+#endif -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ //PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+#endif -+ -+ -+ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, offset; -+ u1Byte ThermalValue_AVG_count = 0; -+ u4Byte ThermalValue_AVG = 0; -+// s4Byte ele_A=0, ele_D, TempCCk, X, value32; -+// s4Byte Y, ele_C=0; -+// s1Byte OFDM_index[2], CCK_index=0, OFDM_index_old[2]={0,0}, CCK_index_old=0, index; -+// s1Byte deltaPowerIndex = 0; -+ u4Byte i = 0;//, j = 0; -+ BOOLEAN is2T = FALSE; -+// BOOLEAN bInteralPA = FALSE; -+ -+ u1Byte OFDM_max_index = 34, rf = (is2T) ? 2 : 1; //OFDM BB Swing should be less than +3.0dB, which is required by Arthur -+ u1Byte Indexforchannel = 0;/*GetRightChnlPlaceforIQK(pHalData->CurrentChannel)*/ -+ enum _POWER_DEC_INC { POWER_DEC, POWER_INC }; -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+ -+ TXPWRTRACK_CFG c; -+ -+ -+ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. -+ s1Byte deltaSwingTableIdx[2][index_mapping_NUM_88E] = { -+ // {{Power decreasing(lower temperature)}, {Power increasing(higher temperature)}} -+ {0,0,2,3,4,4,5,6,7,7,8,9,10,10,11}, {0,0,1,2,3,4,4,4,4,5,7,8,9,9,10} -+ }; -+ u1Byte thermalThreshold[2][index_mapping_NUM_88E]={ -+ // {{Power decreasing(lower temperature)}, {Power increasing(higher temperature)}} -+ {0,2,4,6,8,10,12,14,16,18,20,22,24,26,27}, {0,2,4,6,8,10,12,14,16,18,20,22,25,25,25} -+ }; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+#endif -+ -+ //4 2. Initilization ( 7 steps in total ) -+ -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ -+ pDM_Odm->RFCalibrateInfo.TXPowerTrackingCallbackCnt++; //cosa add for debug -+ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = TRUE; -+ -+#if (MP_DRIVER == 1) -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = pHalData->TxPowerTrackControl; // We should keep updating the control variable according to HalData. -+ // RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. -+ pDM_Odm->RFCalibrateInfo.RegA24 = 0x090e1317; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && defined(MP_TEST) -+ if ((OPMODE & WIFI_MP_STATE) || pDM_Odm->priv->pshare->rf_ft_var.mp_specific) { -+ if(pDM_Odm->priv->pshare->mp_txpwr_tracking == FALSE) -+ return; -+ } -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>odm_TXPowerTrackingCallback_ThermalMeter_8188E, pDM_Odm->BbSwingIdxCckBase: %d, pDM_Odm->BbSwingIdxOfdmBase: %d \n", pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->BbSwingIdxOfdmBase)); -+/* -+ if (!pDM_Odm->RFCalibrateInfo.TM_Trigger) { -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, c.ThermalRegAddr, BIT17 | BIT16, 0x3); -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; -+ return; -+ } -+*/ -+ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if( ! ThermalValue || ! pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -+#else -+ if( ! pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -+#endif -+ return; -+ -+ //4 3. Initialize ThermalValues of RFCalibrateInfo -+ -+ if( ! pDM_Odm->RFCalibrateInfo.ThermalValue) -+ { -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = ThermalValue; -+ } -+ -+ if(pDM_Odm->RFCalibrateInfo.bReloadtxpowerindex) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); -+ } -+ -+ //4 4. Calculate average thermal meter -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; -+ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; -+ -+ for(i = 0; i < c.AverageThermalNum; i++) -+ { -+ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) -+ { -+ ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if(ThermalValue_AVG_count) -+ { -+ // Give the new thermo value a weighting -+ ThermalValue_AVG += (ThermalValue*4); -+ -+ ThermalValue = (u1Byte)(ThermalValue_AVG / (ThermalValue_AVG_count+4)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("AVG Thermal Meter = 0x%x \n", ThermalValue)); -+ } -+ -+ //4 5. Calculate delta, delta_LCK, delta_IQK. -+ -+ delta = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue):(pDM_Odm->RFCalibrateInfo.ThermalValue - ThermalValue); -+ delta_LCK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_LCK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK):(pDM_Odm->RFCalibrateInfo.ThermalValue_LCK - ThermalValue); -+ delta_IQK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_IQK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK):(pDM_Odm->RFCalibrateInfo.ThermalValue_IQK - ThermalValue); -+ -+ //4 6. If necessary, do LCK. -+ if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { -+ /*if((delta_LCK > pHalData->Delta_LCK) && (pHalData->Delta_LCK != 0))*/ -+ if (delta_LCK >= c.Threshold_IQK) { -+ /*Delta temperature is equal to or larger than 20 centigrade.*/ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ } -+ -+ //3 7. If necessary, move the index of swing table to adjust Tx power. -+ -+ if (delta > 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -+ { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); -+#else -+ delta = (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther)?(ThermalValue - pDM_Odm->priv->pmib->dot11RFEntry.ther):(pDM_Odm->priv->pmib->dot11RFEntry.ther - ThermalValue); -+#endif -+ -+ -+ //4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(ThermalValue > pHalData->EEPROMThermalMeter) { -+#else -+ if(ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -+#endif -+ CALCULATE_SWINGTALBE_OFFSET(offset, POWER_INC, index_mapping_NUM_88E, delta); -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex = deltaSwingTableIdx[POWER_INC][offset]; -+ -+ } else { -+ -+ CALCULATE_SWINGTALBE_OFFSET(offset, POWER_DEC, index_mapping_NUM_88E, delta); -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex = (-1)*deltaSwingTableIdx[POWER_DEC][offset]; -+ } -+ -+ if (pDM_Odm->RFCalibrateInfo.DeltaPowerIndex == pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast) -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset = 0; -+ else -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex - pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast; -+ -+ for(i = 0; i < rf; i++) -+ pDM_Odm->RFCalibrateInfo.OFDM_index[i] = pRFCalibrateInfo->BbSwingIdxOfdmBase + pDM_Odm->RFCalibrateInfo.PowerIndexOffset; -+ pDM_Odm->RFCalibrateInfo.CCK_index = pRFCalibrateInfo->BbSwingIdxCckBase + pDM_Odm->RFCalibrateInfo.PowerIndexOffset; -+ -+ pRFCalibrateInfo->BbSwingIdxCck = pDM_Odm->RFCalibrateInfo.CCK_index; -+ pRFCalibrateInfo->BbSwingIdxOfdm[RF_PATH_A] = pDM_Odm->RFCalibrateInfo.OFDM_index[RF_PATH_A]; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxCck, pRFCalibrateInfo->BbSwingIdxCckBase, pDM_Odm->RFCalibrateInfo.PowerIndexOffset)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("The 'OFDM' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxOfdm[RF_PATH_A], pRFCalibrateInfo->BbSwingIdxOfdmBase, pDM_Odm->RFCalibrateInfo.PowerIndexOffset)); -+ -+ //4 7.1 Handle boundary conditions of index. -+ -+ -+ for(i = 0; i < rf; i++) -+ { -+ if(pDM_Odm->RFCalibrateInfo.OFDM_index[i] > OFDM_max_index) -+ { -+ pDM_Odm->RFCalibrateInfo.OFDM_index[i] = OFDM_max_index; -+ } -+ else if (pDM_Odm->RFCalibrateInfo.OFDM_index[i] < 0) -+ { -+ pDM_Odm->RFCalibrateInfo.OFDM_index[i] = 0; -+ } -+ } -+ -+ if(pDM_Odm->RFCalibrateInfo.CCK_index > c.SwingTableSize_CCK-1) -+ pDM_Odm->RFCalibrateInfo.CCK_index = c.SwingTableSize_CCK-1; -+ else if (pDM_Odm->RFCalibrateInfo.CCK_index < 0) -+ pDM_Odm->RFCalibrateInfo.CCK_index = 0; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The thermal meter is unchanged or TxPowerTracking OFF: ThermalValue: %d , pDM_Odm->RFCalibrateInfo.ThermalValue: %d)\n", ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset = 0; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", pDM_Odm->RFCalibrateInfo.CCK_index, pRFCalibrateInfo->BbSwingIdxCckBase)); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index: %d\n", pDM_Odm->RFCalibrateInfo.OFDM_index[RF_PATH_A], pRFCalibrateInfo->BbSwingIdxOfdmBase)); -+ -+ if (pDM_Odm->RFCalibrateInfo.PowerIndexOffset != 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -+ { -+ //4 7.2 Configure the Swing Table to adjust Tx Power. -+ -+ pDM_Odm->RFCalibrateInfo.bTxPowerChanged = TRUE; // Always TRUE after Tx Power is adjusted by power tracking. -+ // -+ // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital -+ // to increase TX power. Otherwise, EVM will be bad. -+ // -+ // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. -+ if (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue) -+ { -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ // ("Temperature Increasing: delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ // pDM_Odm->RFCalibrateInfo.PowerIndexOffset, delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ } -+ else if (ThermalValue < pDM_Odm->RFCalibrateInfo.ThermalValue)// Low temperature -+ { -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ // ("Temperature Decreasing: delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ // pDM_Odm->RFCalibrateInfo.PowerIndexOffset, delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ } -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (ThermalValue > pHalData->EEPROMThermalMeter) -+#else -+ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) -+#endif -+ { -+// ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Temperature(%d) hugher than PG value(%d), increases the power by TxAGC\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TXAGC, 0, 0); -+ } -+ else -+ { -+ // ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Temperature(%d) lower than PG value(%d), increases the power by TxAGC\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, RF_PATH_A, Indexforchannel); -+ if(is2T) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, RF_PATH_B, Indexforchannel); -+ } -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->BbSwingIdxCck; -+ pRFCalibrateInfo->BbSwingIdxOfdmBase = pRFCalibrateInfo->BbSwingIdxOfdm[RF_PATH_A]; -+ pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; -+ -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ // if((delta_IQK > pHalData->Delta_IQK) && (pHalData->Delta_IQK != 0)) -+ if ((delta_IQK >= 8)) // Delta temperature is equal to or larger than 20 centigrade. -+ (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("<===dm_TXPowerTrackingCallback_ThermalMeter_8188E\n")); -+ -+ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ -+VOID -+phy_PathAStandBy( -+ IN PADAPTER pAdapter -+ ) -+{ -+ RTPRINT(FINIT, INIT_IQK, ("Path-A standby mode!\n")); -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x0); -+ PHY_SetBBReg(pAdapter, 0x840, bMaskDWord, 0x00010000); -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x808000); -+} -+ -+//1 7. IQK -+//#define MAX_TOLERANCE 5 -+//#define IQK_DELAY_TIME 1 //ms -+ -+u1Byte //bit0 = 1 => Tx OK, bit1 = 1 => Rx OK -+phy_PathA_IQK_8192C( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN configPathB -+ ) -+{ -+ -+ u4Byte regEAC, regE94, regE9C, regEA4; -+ u1Byte result = 0x00; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ RTPRINT(FINIT, INIT_IQK, ("Path A IQK!\n")); -+ -+ //path-A IQK setting -+ RTPRINT(FINIT, INIT_IQK, ("Path-A IQK setting!\n")); -+ if(pAdapter->interfaceIndex == 0) -+ { -+ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x10008c1f); -+ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x10008c1f); -+ } -+ else -+ { -+ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x10008c22); -+ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x10008c22); -+ } -+ -+ PHY_SetBBReg(pAdapter, rTx_IQK_PI_A, bMaskDWord, 0x82140102); -+ -+ PHY_SetBBReg(pAdapter, rRx_IQK_PI_A, bMaskDWord, configPathB ? 0x28160202 : -+ IS_81xxC_VENDOR_UMC_B_CUT(pHalData->VersionID)?0x28160202:0x28160502); -+ -+ //path-B IQK setting -+ if(configPathB) -+ { -+ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_B, bMaskDWord, 0x10008c22); -+ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_B, bMaskDWord, 0x10008c22); -+ PHY_SetBBReg(pAdapter, rTx_IQK_PI_B, bMaskDWord, 0x82140102); -+ PHY_SetBBReg(pAdapter, rRx_IQK_PI_B, bMaskDWord, 0x28160202); -+ } -+ -+ //LO calibration setting -+ RTPRINT(FINIT, INIT_IQK, ("LO calibration setting!\n")); -+ PHY_SetBBReg(pAdapter, rIQK_AGC_Rsp, bMaskDWord, 0x001028d1); -+ -+ //One shot, path A LOK & IQK -+ RTPRINT(FINIT, INIT_IQK, ("One shot, path A LOK & IQK!\n")); -+ PHY_SetBBReg(pAdapter, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ PHY_SetBBReg(pAdapter, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ // delay x ms -+ RTPRINT(FINIT, INIT_IQK, ("Delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME)); -+ PlatformStallExecution(IQK_DELAY_TIME*1000); -+ -+ // Check failed -+ regEAC = PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_A_2, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xeac = 0x%x\n", regEAC)); -+ regE94 = PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_A, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xe94 = 0x%x\n", regE94)); -+ regE9C= PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_A, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xe9c = 0x%x\n", regE9C)); -+ regEA4= PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_A_2, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xea4 = 0x%x\n", regEA4)); -+ -+ if(!(regEAC & BIT28) && -+ (((regE94 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C & 0x03FF0000)>>16) != 0x42) ) -+ result |= 0x01; -+ else //if Tx not OK, ignore Rx -+ return result; -+ -+ if(!(regEAC & BIT27) && //if Tx is OK, check whether Rx is OK -+ (((regEA4 & 0x03FF0000)>>16) != 0x132) && -+ (((regEAC & 0x03FF0000)>>16) != 0x36)) -+ result |= 0x02; -+ else -+ RTPRINT(FINIT, INIT_IQK, ("Path A Rx IQK fail!!\n")); -+ -+ return result; -+ -+ -+} -+ -+u1Byte //bit0 = 1 => Tx OK, bit1 = 1 => Rx OK -+phy_PathB_IQK_8192C( -+ IN PADAPTER pAdapter -+ ) -+{ -+ u4Byte regEAC, regEB4, regEBC, regEC4, regECC; -+ u1Byte result = 0x00; -+ RTPRINT(FINIT, INIT_IQK, ("Path B IQK!\n")); -+ -+ //One shot, path B LOK & IQK -+ RTPRINT(FINIT, INIT_IQK, ("One shot, path A LOK & IQK!\n")); -+ PHY_SetBBReg(pAdapter, rIQK_AGC_Cont, bMaskDWord, 0x00000002); -+ PHY_SetBBReg(pAdapter, rIQK_AGC_Cont, bMaskDWord, 0x00000000); -+ -+ // delay x ms -+ RTPRINT(FINIT, INIT_IQK, ("Delay %d ms for One shot, path B LOK & IQK.\n", IQK_DELAY_TIME)); -+ PlatformStallExecution(IQK_DELAY_TIME*1000); -+ -+ // Check failed -+ regEAC = PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_A_2, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xeac = 0x%x\n", regEAC)); -+ regEB4 = PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_B, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xeb4 = 0x%x\n", regEB4)); -+ regEBC= PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_B, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xebc = 0x%x\n", regEBC)); -+ regEC4= PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_B_2, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xec4 = 0x%x\n", regEC4)); -+ regECC= PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_B_2, bMaskDWord); -+ RTPRINT(FINIT, INIT_IQK, ("0xecc = 0x%x\n", regECC)); -+ -+ if(!(regEAC & BIT31) && -+ (((regEB4 & 0x03FF0000)>>16) != 0x142) && -+ (((regEBC & 0x03FF0000)>>16) != 0x42)) -+ result |= 0x01; -+ else -+ return result; -+ -+ if(!(regEAC & BIT30) && -+ (((regEC4 & 0x03FF0000)>>16) != 0x132) && -+ (((regECC & 0x03FF0000)>>16) != 0x36)) -+ result |= 0x02; -+ else -+ RTPRINT(FINIT, INIT_IQK, ("Path B Rx IQK fail!!\n")); -+ -+ -+ return result; -+ -+} -+ -+VOID -+phy_PathAFillIQKMatrix( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bIQKOK, -+ IN s4Byte result[][8], -+ IN u1Byte final_candidate, -+ IN BOOLEAN bTxOnly -+ ) -+{ -+ u4Byte Oldval_0, X, TX0_A, reg; -+ s4Byte Y, TX0_C; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ RTPRINT(FINIT, INIT_IQK, ("Path A IQ Calibration %s !\n",(bIQKOK)?"Success":"Failed")); -+ -+ if(final_candidate == 0xFF) -+ return; -+ -+ else if(bIQKOK) -+ { -+ Oldval_0 = (PHY_QueryBBReg(pAdapter, rOFDM0_XATxIQImbalance, bMaskDWord) >> 22) & 0x3FF; -+ -+ X = result[final_candidate][0]; -+ if ((X & 0x00000200) != 0) -+ X = X | 0xFFFFFC00; -+ TX0_A = (X * Oldval_0) >> 8; -+ RTPRINT(FINIT, INIT_IQK, ("X = 0x%x, TX0_A = 0x%x, Oldval_0 0x%x\n", X, TX0_A, Oldval_0)); -+ PHY_SetBBReg(pAdapter, rOFDM0_XATxIQImbalance, 0x3FF, TX0_A); -+ PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(31), ((X * Oldval_0>>7) & 0x1)); -+ -+ Y = result[final_candidate][1]; -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ -+ //path B IQK result + 3 -+ if(pAdapter->interfaceIndex == 1 && pHalData->CurrentBandType == BAND_ON_5G) -+ Y += 3; -+ -+ TX0_C = (Y * Oldval_0) >> 8; -+ RTPRINT(FINIT, INIT_IQK, ("Y = 0x%x, TX = 0x%x\n", Y, TX0_C)); -+ PHY_SetBBReg(pAdapter, rOFDM0_XCTxAFE, 0xF0000000, ((TX0_C&0x3C0)>>6)); -+ PHY_SetBBReg(pAdapter, rOFDM0_XATxIQImbalance, 0x003F0000, (TX0_C&0x3F)); -+ PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(29), ((Y * Oldval_0>>7) & 0x1)); -+ -+ if(bTxOnly) -+ { -+ RTPRINT(FINIT, INIT_IQK, ("phy_PathAFillIQKMatrix only Tx OK\n")); -+ return; -+ } -+ -+ reg = result[final_candidate][2]; -+ PHY_SetBBReg(pAdapter, rOFDM0_XARxIQImbalance, 0x3FF, reg); -+ -+ reg = result[final_candidate][3] & 0x3F; -+ PHY_SetBBReg(pAdapter, rOFDM0_XARxIQImbalance, 0xFC00, reg); -+ -+ reg = (result[final_candidate][3] >> 6) & 0xF; -+ PHY_SetBBReg(pAdapter, rOFDM0_RxIQExtAnta, 0xF0000000, reg); -+ } -+} -+ -+VOID -+phy_PathBFillIQKMatrix( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bIQKOK, -+ IN s4Byte result[][8], -+ IN u1Byte final_candidate, -+ IN BOOLEAN bTxOnly //do Tx only -+ ) -+{ -+ u4Byte Oldval_1, X, TX1_A, reg; -+ s4Byte Y, TX1_C; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ RTPRINT(FINIT, INIT_IQK, ("Path B IQ Calibration %s !\n",(bIQKOK)?"Success":"Failed")); -+ -+ if(final_candidate == 0xFF) -+ return; -+ -+ else if(bIQKOK) -+ { -+ Oldval_1 = (PHY_QueryBBReg(pAdapter, rOFDM0_XBTxIQImbalance, bMaskDWord) >> 22) & 0x3FF; -+ -+ X = result[final_candidate][4]; -+ if ((X & 0x00000200) != 0) -+ X = X | 0xFFFFFC00; -+ TX1_A = (X * Oldval_1) >> 8; -+ RTPRINT(FINIT, INIT_IQK, ("X = 0x%x, TX1_A = 0x%x\n", X, TX1_A)); -+ PHY_SetBBReg(pAdapter, rOFDM0_XBTxIQImbalance, 0x3FF, TX1_A); -+ PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(27), ((X * Oldval_1>>7) & 0x1)); -+ -+ Y = result[final_candidate][5]; -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ if(pHalData->CurrentBandType == BAND_ON_5G) -+ Y += 3; //temp modify for preformance -+ TX1_C = (Y * Oldval_1) >> 8; -+ RTPRINT(FINIT, INIT_IQK, ("Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C)); -+ PHY_SetBBReg(pAdapter, rOFDM0_XDTxAFE, 0xF0000000, ((TX1_C&0x3C0)>>6)); -+ PHY_SetBBReg(pAdapter, rOFDM0_XBTxIQImbalance, 0x003F0000, (TX1_C&0x3F)); -+ PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(25), ((Y * Oldval_1>>7) & 0x1)); -+ -+ if(bTxOnly) -+ return; -+ -+ reg = result[final_candidate][6]; -+ PHY_SetBBReg(pAdapter, rOFDM0_XBRxIQImbalance, 0x3FF, reg); -+ -+ reg = result[final_candidate][7] & 0x3F; -+ PHY_SetBBReg(pAdapter, rOFDM0_XBRxIQImbalance, 0xFC00, reg); -+ -+ reg = (result[final_candidate][7] >> 6) & 0xF; -+ PHY_SetBBReg(pAdapter, rOFDM0_AGCRSSITable, 0x0000F000, reg); -+ } -+} -+ -+ -+BOOLEAN -+phy_SimularityCompare_92C( -+ IN PADAPTER pAdapter, -+ IN s4Byte result[][8], -+ IN u1Byte c1, -+ IN u1Byte c2 -+ ) -+{ -+ u4Byte i, j, diff, SimularityBitMap, bound = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u1Byte final_candidate[2] = {0xFF, 0xFF}; //for path A and path B -+ BOOLEAN bResult = TRUE, is2T = IS_92C_SERIAL( pHalData->VersionID); -+ -+ if(is2T) -+ bound = 8; -+ else -+ bound = 4; -+ -+ SimularityBitMap = 0; -+ -+ for( i = 0; i < bound; i++ ) -+ { -+ diff = (result[c1][i] > result[c2][i]) ? (result[c1][i] - result[c2][i]) : (result[c2][i] - result[c1][i]); -+ if (diff > MAX_TOLERANCE) -+ { -+ if((i == 2 || i == 6) && !SimularityBitMap) -+ { -+ if(result[c1][i]+result[c1][i+1] == 0) -+ final_candidate[(i/4)] = c2; -+ else if (result[c2][i]+result[c2][i+1] == 0) -+ final_candidate[(i/4)] = c1; -+ else -+ SimularityBitMap = SimularityBitMap|(1< do IQK again -+*/ -+BOOLEAN -+phy_SimularityCompare( -+ IN PADAPTER pAdapter, -+ IN s4Byte result[][8], -+ IN u1Byte c1, -+ IN u1Byte c2 -+ ) -+{ -+ return phy_SimularityCompare_92C(pAdapter, result, c1, c2); -+ -+} -+ -+VOID -+phy_IQCalibrate_8192C( -+ IN PADAPTER pAdapter, -+ IN s4Byte result[][8], -+ IN u1Byte t, -+ IN BOOLEAN is2T -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u4Byte i; -+ u1Byte PathAOK, PathBOK; -+ u4Byte ADDA_REG[IQK_ADDA_REG_NUM] = { -+ rFPGA0_XCD_SwitchControl, rBlue_Tooth, -+ rRx_Wait_CCA, rTx_CCK_RFON, -+ rTx_CCK_BBON, rTx_OFDM_RFON, -+ rTx_OFDM_BBON, rTx_To_Rx, -+ rTx_To_Tx, rRx_CCK, -+ rRx_OFDM, rRx_Wait_RIFS, -+ rRx_TO_Rx, rStandby, -+ rSleep, rPMPD_ANAEN }; -+ u4Byte IQK_MAC_REG[IQK_MAC_REG_NUM] = { -+ REG_TXPAUSE, REG_BCN_CTRL, -+ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; -+ -+ //since 92C & 92D have the different define in IQK_BB_REG -+ u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { -+ rOFDM0_TRxPathEnable, rOFDM0_TRMuxPar, -+ rFPGA0_XCD_RFInterfaceSW, rConfig_AntA, rConfig_AntB, -+ rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, -+ rFPGA0_XB_RFInterfaceOE, /*rFPGA0_RFMOD*/ rCCK0_AFESetting -+ }; -+ -+ u4Byte IQK_BB_REG_92D[IQK_BB_REG_NUM_92D] = { //for normal -+ rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, -+ rFPGA0_XB_RFInterfaceOE, rOFDM0_TRMuxPar, -+ rFPGA0_XCD_RFInterfaceSW, rOFDM0_TRxPathEnable, -+ /*rFPGA0_RFMOD*/ rCCK0_AFESetting, rFPGA0_AnalogParameter4, -+ rOFDM0_XAAGCCore1, rOFDM0_XBAGCCore1 -+ }; -+#if MP_DRIVER -+ const u4Byte retryCount = 9; -+#else -+ const u4Byte retryCount = 2; -+#endif -+ //Neil Chen--2011--05--19-- -+ //3 Path Div -+ u1Byte rfPathSwitch=0x0; -+ -+ // Note: IQ calibration must be performed after loading -+ // PHY_REG.txt , and radio_a, radio_b.txt -+ -+ u4Byte bbvalue; -+ -+ if(t==0) -+ { -+ //bbvalue = PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bMaskDWord); -+ // RTPRINT(FINIT, INIT_IQK, ("phy_IQCalibrate_8192C()==>0x%08x\n",bbvalue)); -+ -+ RTPRINT(FINIT, INIT_IQK, ("IQ Calibration for %s\n", (is2T ? "2T2R" : "1T1R"))); -+ -+ // Save ADDA parameters, turn Path A ADDA on -+ phy_SaveADDARegisters(pAdapter, ADDA_REG, pHalData->ADDA_backup, IQK_ADDA_REG_NUM); -+ phy_SaveMACRegisters(pAdapter, IQK_MAC_REG, pHalData->IQK_MAC_backup); -+ phy_SaveADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup, IQK_BB_REG_NUM); -+ } -+ -+ phy_PathADDAOn(pAdapter, ADDA_REG, TRUE, is2T); -+ -+ if(t==0) -+ { -+ pHalData->bRfPiEnable = (u1Byte)PHY_QueryBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, BIT(8)); -+ } -+ -+ if(!pHalData->bRfPiEnable){ -+ // Switch BB to PI mode to do IQ Calibration. -+ phy_PIModeSwitch(pAdapter, TRUE); -+ } -+ -+ //MAC settings -+ phy_MACSettingCalibration(pAdapter, IQK_MAC_REG, pHalData->IQK_MAC_backup); -+ -+ //PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, BIT24, 0x00); -+ PHY_SetBBReg(pAdapter, rCCK0_AFESetting, bMaskDWord, (0x0f000000 | (PHY_QueryBBReg(pAdapter, rCCK0_AFESetting, bMaskDWord))) ); -+ PHY_SetBBReg(pAdapter, rOFDM0_TRxPathEnable, bMaskDWord, 0x03a05600); -+ PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, bMaskDWord, 0x000800e4); -+ PHY_SetBBReg(pAdapter, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x22204000); -+ { -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0x01); -+ PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0x01); -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_RFInterfaceOE, BIT10, 0x00); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0x00); -+ } -+ -+ if(is2T) -+ { -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_LSSIParameter, bMaskDWord, 0x00010000); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_LSSIParameter, bMaskDWord, 0x00010000); -+ } -+ -+ { -+ //Page B init -+ PHY_SetBBReg(pAdapter, rConfig_AntA, bMaskDWord, 0x00080000); -+ -+ if(is2T) -+ { -+ PHY_SetBBReg(pAdapter, rConfig_AntB, bMaskDWord, 0x00080000); -+ } -+ } -+ // IQ calibration setting -+ RTPRINT(FINIT, INIT_IQK, ("IQK setting!\n")); -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x808000); -+ PHY_SetBBReg(pAdapter, rTx_IQK, bMaskDWord, 0x01007c00); -+ PHY_SetBBReg(pAdapter, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ for(i = 0 ; i < retryCount ; i++){ -+ PathAOK = phy_PathA_IQK_8192C(pAdapter, is2T); -+ if(PathAOK == 0x03){ -+ RTPRINT(FINIT, INIT_IQK, ("Path A IQK Success!!\n")); -+ result[t][0] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ result[t][1] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ result[t][2] = (PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; -+ result[t][3] = (PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; -+ break; -+ } -+ else if (i == (retryCount-1) && PathAOK == 0x01) //Tx IQK OK -+ { -+ RTPRINT(FINIT, INIT_IQK, ("Path A IQK Only Tx Success!!\n")); -+ -+ result[t][0] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ result[t][1] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ } -+ } -+ -+ if(0x00 == PathAOK){ -+ RTPRINT(FINIT, INIT_IQK, ("Path A IQK failed!!\n")); -+ } -+ -+ if(is2T){ -+ phy_PathAStandBy(pAdapter); -+ -+ // Turn Path B ADDA on -+ phy_PathADDAOn(pAdapter, ADDA_REG, FALSE, is2T); -+ -+ for(i = 0 ; i < retryCount ; i++){ -+ PathBOK = phy_PathB_IQK_8192C(pAdapter); -+ if(PathBOK == 0x03){ -+ RTPRINT(FINIT, INIT_IQK, ("Path B IQK Success!!\n")); -+ result[t][4] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_B, bMaskDWord)&0x3FF0000)>>16; -+ result[t][5] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_B, bMaskDWord)&0x3FF0000)>>16; -+ result[t][6] = (PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_B_2, bMaskDWord)&0x3FF0000)>>16; -+ result[t][7] = (PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_B_2, bMaskDWord)&0x3FF0000)>>16; -+ break; -+ } -+ else if (i == (retryCount - 1) && PathBOK == 0x01) //Tx IQK OK -+ { -+ RTPRINT(FINIT, INIT_IQK, ("Path B Only Tx IQK Success!!\n")); -+ result[t][4] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_B, bMaskDWord)&0x3FF0000)>>16; -+ result[t][5] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_B, bMaskDWord)&0x3FF0000)>>16; -+ } -+ } -+ -+ if(0x00 == PathBOK){ -+ RTPRINT(FINIT, INIT_IQK, ("Path B IQK failed!!\n")); -+ } -+ } -+ -+ //Back to BB mode, load original value -+ RTPRINT(FINIT, INIT_IQK, ("IQK:Back to BB mode, load original value!\n")); -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); -+ -+ if(t!=0) -+ { -+ if(!pHalData->bRfPiEnable){ -+ // Switch back BB to SI mode after finish IQ Calibration. -+ phy_PIModeSwitch(pAdapter, FALSE); -+ } -+ -+ // Reload ADDA power saving parameters -+ phy_ReloadADDARegisters(pAdapter, ADDA_REG, pHalData->ADDA_backup, IQK_ADDA_REG_NUM); -+ -+ // Reload MAC parameters -+ phy_ReloadMACRegisters(pAdapter, IQK_MAC_REG, pHalData->IQK_MAC_backup); -+ -+ // Reload BB parameters -+ phy_ReloadADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup, IQK_BB_REG_NUM); -+ -+ /*Restore RX initial gain*/ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_LSSIParameter, bMaskDWord, 0x00032ed3); -+ if (is2T) -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_LSSIParameter, bMaskDWord, 0x00032ed3); -+ //load 0xe30 IQC default value -+ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ -+ } -+ RTPRINT(FINIT, INIT_IQK, ("phy_IQCalibrate_8192C() <==\n")); -+ -+} -+ -+ -+VOID -+phy_LCCalibrate92C( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN is2T -+ ) -+{ -+ u1Byte tmpReg; -+ u4Byte RF_Amode=0, RF_Bmode=0, LC_Cal; -+// HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ //Check continuous TX and Packet TX -+ tmpReg = PlatformEFIORead1Byte(pAdapter, 0xd03); -+ -+ if((tmpReg&0x70) != 0) //Deal with contisuous TX case -+ PlatformEFIOWrite1Byte(pAdapter, 0xd03, tmpReg&0x8F); //disable all continuous TX -+ else // Deal with Packet TX case -+ PlatformEFIOWrite1Byte(pAdapter, REG_TXPAUSE, 0xFF); // block all queues -+ -+ if((tmpReg&0x70) != 0) -+ { -+ //1. Read original RF mode -+ //Path-A -+ RF_Amode = PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits); -+ -+ //Path-B -+ if(is2T) -+ RF_Bmode = PHY_QueryRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits); -+ -+ //2. Set RF mode = standby mode -+ //Path-A -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits, (RF_Amode&0x8FFFF)|0x10000); -+ -+ //Path-B -+ if(is2T) -+ PHY_SetRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits, (RF_Bmode&0x8FFFF)|0x10000); -+ } -+ -+ //3. Read RF reg18 -+ LC_Cal = PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_CHNLBW, bMask12Bits); -+ -+ //4. Set LC calibration begin bit15 -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_CHNLBW, bMask12Bits, LC_Cal|0x08000); -+ -+ delay_ms(100); -+ -+ -+ //Restore original situation -+ if((tmpReg&0x70) != 0) //Deal with contisuous TX case -+ { -+ //Path-A -+ PlatformEFIOWrite1Byte(pAdapter, 0xd03, tmpReg); -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits, RF_Amode); -+ -+ //Path-B -+ if(is2T) -+ PHY_SetRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits, RF_Bmode); -+ } -+ else // Deal with Packet TX case -+ { -+ PlatformEFIOWrite1Byte(pAdapter, REG_TXPAUSE, 0x00); -+ } -+} -+ -+ -+VOID -+phy_LCCalibrate( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN is2T -+ ) -+{ -+ phy_LCCalibrate92C(pAdapter, is2T); -+} -+ -+ -+ -+//Analog Pre-distortion calibration -+#define APK_BB_REG_NUM 8 -+#define APK_CURVE_REG_NUM 4 -+#define PATH_NUM 2 -+ -+VOID -+phy_APCalibrate_8192C( -+ IN PADAPTER pAdapter, -+ IN s1Byte delta, -+ IN BOOLEAN is2T -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ u4Byte regD[PATH_NUM]; -+ u4Byte tmpReg, index, offset, i, apkbound; -+ u1Byte path, pathbound = PATH_NUM; -+ u4Byte BB_backup[APK_BB_REG_NUM]; -+ u4Byte BB_REG[APK_BB_REG_NUM] = { -+ rFPGA1_TxBlock, rOFDM0_TRxPathEnable, -+ rFPGA0_RFMOD, rOFDM0_TRMuxPar, -+ rFPGA0_XCD_RFInterfaceSW, rFPGA0_XAB_RFInterfaceSW, -+ rFPGA0_XA_RFInterfaceOE, rFPGA0_XB_RFInterfaceOE }; -+ u4Byte BB_AP_MODE[APK_BB_REG_NUM] = { -+ 0x00000020, 0x00a05430, 0x02040000, -+ 0x000800e4, 0x00204000 }; -+ u4Byte BB_normal_AP_MODE[APK_BB_REG_NUM] = { -+ 0x00000020, 0x00a05430, 0x02040000, -+ 0x000800e4, 0x22204000 }; -+ -+ u4Byte AFE_backup[IQK_ADDA_REG_NUM]; -+ u4Byte AFE_REG[IQK_ADDA_REG_NUM] = { -+ rFPGA0_XCD_SwitchControl, rBlue_Tooth, -+ rRx_Wait_CCA, rTx_CCK_RFON, -+ rTx_CCK_BBON, rTx_OFDM_RFON, -+ rTx_OFDM_BBON, rTx_To_Rx, -+ rTx_To_Tx, rRx_CCK, -+ rRx_OFDM, rRx_Wait_RIFS, -+ rRx_TO_Rx, rStandby, -+ rSleep, rPMPD_ANAEN }; -+ -+ u4Byte MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte MAC_REG[IQK_MAC_REG_NUM] = { -+ REG_TXPAUSE, REG_BCN_CTRL, -+ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; -+ -+ u4Byte APK_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c}, -+ {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e} -+ }; -+ -+ u4Byte APK_normal_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x0852c, 0x0a52c, 0x3a52c, 0x5a52c, 0x5a52c}, //path settings equal to path b settings -+ {0x0852c, 0x0a52c, 0x5a52c, 0x5a52c, 0x5a52c} -+ }; -+ -+ u4Byte APK_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d}, -+ {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050} -+ }; -+ -+ u4Byte APK_normal_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a}, //path settings equal to path b settings -+ {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a} -+ }; -+#if 0 -+ u4Byte APK_RF_value_A[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x1adb0, 0x1adb0, 0x1ada0, 0x1ad90, 0x1ad80}, -+ {0x00fb0, 0x00fb0, 0x00fa0, 0x00f90, 0x00f80} -+ }; -+#endif -+ u4Byte AFE_on_off[PATH_NUM] = { -+ 0x04db25a4, 0x0b1b25a4}; //path A on path B off / path A off path B on -+ -+ u4Byte APK_offset[PATH_NUM] = { -+ rConfig_AntA, rConfig_AntB}; -+ -+ u4Byte APK_normal_offset[PATH_NUM] = { -+ rConfig_Pmpd_AntA, rConfig_Pmpd_AntB}; -+ -+ u4Byte APK_value[PATH_NUM] = { -+ 0x92fc0000, 0x12fc0000}; -+ -+ u4Byte APK_normal_value[PATH_NUM] = { -+ 0x92680000, 0x12680000}; -+ -+ s1Byte APK_delta_mapping[APK_BB_REG_NUM][13] = { -+ {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-6, -4, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-1, -1, -1, -1, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-11, -9, -7, -5, -3, -1, 0, 0, 0, 0, 0, 0, 0} -+ }; -+ -+ u4Byte APK_normal_setting_value_1[13] = { -+ 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28, -+ 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3, -+ 0x12680000, 0x00880000, 0x00880000 -+ }; -+ -+ u4Byte APK_normal_setting_value_2[16] = { -+ 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3, -+ 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025, -+ 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008, -+ 0x00050006 -+ }; -+ -+ u4Byte APK_result[PATH_NUM][APK_BB_REG_NUM]; //val_1_1a, val_1_2a, val_2a, val_3a, val_4a -+// u4Byte AP_curve[PATH_NUM][APK_CURVE_REG_NUM]; -+ -+ s4Byte BB_offset, delta_V, delta_offset; -+ -+#if MP_DRIVER == 1 -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+ -+ pMptCtx->APK_bound[0] = 45; -+ pMptCtx->APK_bound[1] = 52; -+#endif -+ -+ RTPRINT(FINIT, INIT_IQK, ("==>phy_APCalibrate_8192C() delta %d\n", delta)); -+ RTPRINT(FINIT, INIT_IQK, ("AP Calibration for %s\n", (is2T ? "2T2R" : "1T1R"))); -+ if(!is2T) -+ pathbound = 1; -+ -+ //2 FOR NORMAL CHIP SETTINGS -+ -+// Temporarily do not allow normal driver to do the following settings because these offset -+// and value will cause RF internal PA to be unpredictably disabled by HW, such that RF Tx signal -+// will disappear after disable/enable card many times on 88CU. RF SD and DD have not find the -+// root cause, so we remove these actions temporarily. Added by tynli and SD3 Allen. 2010.05.31. -+#if MP_DRIVER != 1 -+ return; -+#endif -+ //settings adjust for normal chip -+ for(index = 0; index < PATH_NUM; index ++) -+ { -+ APK_offset[index] = APK_normal_offset[index]; -+ APK_value[index] = APK_normal_value[index]; -+ AFE_on_off[index] = 0x6fdb25a4; -+ } -+ -+ for(index = 0; index < APK_BB_REG_NUM; index ++) -+ { -+ for(path = 0; path < pathbound; path++) -+ { -+ APK_RF_init_value[path][index] = APK_normal_RF_init_value[path][index]; -+ APK_RF_value_0[path][index] = APK_normal_RF_value_0[path][index]; -+ } -+ BB_AP_MODE[index] = BB_normal_AP_MODE[index]; -+ } -+ -+ apkbound = 6; -+ -+ //save BB default value -+ for(index = 0; index < APK_BB_REG_NUM ; index++) -+ { -+ if(index == 0) //skip -+ continue; -+ BB_backup[index] = PHY_QueryBBReg(pAdapter, BB_REG[index], bMaskDWord); -+ } -+ -+ //save MAC default value -+ phy_SaveMACRegisters(pAdapter, MAC_REG, MAC_backup); -+ -+ //save AFE default value -+ phy_SaveADDARegisters(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+ -+ for(path = 0; path < pathbound; path++) -+ { -+ -+ -+ if(path == RF_PATH_A) -+ { -+ //path A APK -+ //load APK setting -+ //path-A -+ offset = rPdp_AntA; -+ for(index = 0; index < 11; index ++) -+ { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ -+ PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); -+ -+ offset = rConfig_AntA; -+ for(; index < 13; index ++) -+ { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ -+ //page-B1 -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x400000); -+ -+ //path A -+ offset = rPdp_AntA; -+ for(index = 0; index < 16; index++) -+ { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_2[index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); -+ } -+ else if(path == RF_PATH_B) -+ { -+ //path B APK -+ //load APK setting -+ //path-B -+ offset = rPdp_AntB; -+ for(index = 0; index < 10; index ++) -+ { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntA, bMaskDWord, 0x12680000); -+ -+ PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); -+ -+ offset = rConfig_AntA; -+ index = 11; -+ for(; index < 13; index ++) //offset 0xb68, 0xb6c -+ { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ -+ //page-B1 -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x400000); -+ -+ //path B -+ offset = 0xb60; -+ for(index = 0; index < 16; index++) -+ { -+ PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_2[index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); -+ } -+ -+ //save RF default value -+ regD[path] = PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask); -+ -+ //Path A AFE all on, path B AFE All off or vise versa -+ for(index = 0; index < IQK_ADDA_REG_NUM ; index++) -+ PHY_SetBBReg(pAdapter, AFE_REG[index], bMaskDWord, AFE_on_off[path]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xe70 %x\n", PHY_QueryBBReg(pAdapter, rRx_Wait_CCA, bMaskDWord))); -+ -+ //BB to AP mode -+ if(path == 0) -+ { -+ for(index = 0; index < APK_BB_REG_NUM ; index++) -+ { -+ -+ if(index == 0) //skip -+ continue; -+ else if (index < 5) -+ PHY_SetBBReg(pAdapter, BB_REG[index], bMaskDWord, BB_AP_MODE[index]); -+ else if (BB_REG[index] == 0x870) -+ PHY_SetBBReg(pAdapter, BB_REG[index], bMaskDWord, BB_backup[index]|BIT10|BIT26); -+ else -+ PHY_SetBBReg(pAdapter, BB_REG[index], BIT10, 0x0); -+ } -+ -+ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ } -+ else //path B -+ { -+ PHY_SetBBReg(pAdapter, rTx_IQK_Tone_B, bMaskDWord, 0x01008c00); -+ PHY_SetBBReg(pAdapter, rRx_IQK_Tone_B, bMaskDWord, 0x01008c00); -+ -+ } -+ -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x800 %x\n", PHY_QueryBBReg(pAdapter, 0x800, bMaskDWord))); -+ -+ //MAC settings -+ phy_MACSettingCalibration(pAdapter, MAC_REG, MAC_backup); -+ -+ if(path == RF_PATH_A) //Path B to standby mode -+ { -+ PHY_SetRFReg(pAdapter, RF_PATH_B, RF_AC, bRFRegOffsetMask, 0x10000); -+ } -+ else //Path A to standby mode -+ { -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_AC, bRFRegOffsetMask, 0x10000); -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE1, bRFRegOffsetMask, 0x1000f); -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE2, bRFRegOffsetMask, 0x20103); -+ } -+ -+ delta_offset = ((delta+14)/2); -+ if(delta_offset < 0) -+ delta_offset = 0; -+ else if (delta_offset > 12) -+ delta_offset = 12; -+ -+ //AP calibration -+ for(index = 0; index < APK_BB_REG_NUM; index++) -+ { -+ if(index != 1) //only DO PA11+PAD01001, AP RF setting -+ continue; -+ -+ tmpReg = APK_RF_init_value[path][index]; -+#if 1 -+ if(!pHalData->bAPKThermalMeterIgnore) -+ { -+ BB_offset = (tmpReg & 0xF0000) >> 16; -+ -+ if(!(tmpReg & BIT15)) //sign bit 0 -+ { -+ BB_offset = -BB_offset; -+ } -+ -+ delta_V = APK_delta_mapping[index][delta_offset]; -+ -+ BB_offset += delta_V; -+ -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() APK index %d tmpReg 0x%x delta_V %d delta_offset %d\n", index, tmpReg, delta_V, delta_offset)); -+ -+ if(BB_offset < 0) -+ { -+ tmpReg = tmpReg & (~BIT15); -+ BB_offset = -BB_offset; -+ } -+ else -+ { -+ tmpReg = tmpReg | BIT15; -+ } -+ tmpReg = (tmpReg & 0xFFF0FFFF) | (BB_offset << 16); -+ } -+#endif -+ -+#if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ if(IS_81xxC_VENDOR_UMC_B_CUT(pHalData->VersionID)) -+ PHY_SetRFReg(pAdapter, path, RF_IPA_A, bRFRegOffsetMask, 0x894ae); -+ else -+#endif -+ PHY_SetRFReg(pAdapter, path, RF_IPA_A, bRFRegOffsetMask, 0x8992e); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xc %x\n", PHY_QueryRFReg(pAdapter, path, RF_IPA_A, bRFRegOffsetMask))); -+ PHY_SetRFReg(pAdapter, path, RF_AC, bRFRegOffsetMask, APK_RF_value_0[path][index]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x0 %x\n", PHY_QueryRFReg(pAdapter, path, RF_AC, bRFRegOffsetMask))); -+ PHY_SetRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask, tmpReg); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xd %x\n", PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask))); -+ -+ // PA11+PAD01111, one shot -+ i = 0; -+ do -+ { -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x800000); -+ { -+ PHY_SetBBReg(pAdapter, APK_offset[path], bMaskDWord, APK_value[0]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", APK_offset[path], PHY_QueryBBReg(pAdapter, APK_offset[path], bMaskDWord))); -+ delay_ms(3); -+ PHY_SetBBReg(pAdapter, APK_offset[path], bMaskDWord, APK_value[1]); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", APK_offset[path], PHY_QueryBBReg(pAdapter, APK_offset[path], bMaskDWord))); -+ -+ delay_ms(20); -+ } -+ PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); -+ -+ if(path == RF_PATH_A) -+ tmpReg = PHY_QueryBBReg(pAdapter, rAPK, 0x03E00000); -+ else -+ tmpReg = PHY_QueryBBReg(pAdapter, rAPK, 0xF8000000); -+ RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xbd8[25:21] %x\n", tmpReg)); -+ -+ -+ i++; -+ } -+ while(tmpReg > apkbound && i < 4); -+ -+ APK_result[path][index] = tmpReg; -+ } -+ } -+ -+ //reload MAC default value -+ phy_ReloadMACRegisters(pAdapter, MAC_REG, MAC_backup); -+ -+ //reload BB default value -+ for(index = 0; index < APK_BB_REG_NUM ; index++) -+ { -+ -+ if(index == 0) //skip -+ continue; -+ PHY_SetBBReg(pAdapter, BB_REG[index], bMaskDWord, BB_backup[index]); -+ } -+ -+ //reload AFE default value -+ phy_ReloadADDARegisters(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+ -+ //reload RF path default value -+ for(path = 0; path < pathbound; path++) -+ { -+ PHY_SetRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask, regD[path]); -+ if(path == RF_PATH_B) -+ { -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE1, bRFRegOffsetMask, 0x1000f); -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE2, bRFRegOffsetMask, 0x20101); -+ } -+ -+ //note no index == 0 -+ if (APK_result[path][1] > 6) -+ APK_result[path][1] = 6; -+ RTPRINT(FINIT, INIT_IQK, ("apk path %d result %d 0x%x \t", path, 1, APK_result[path][1])); -+ } -+ -+ RTPRINT(FINIT, INIT_IQK, ("\n")); -+ -+ -+ for(path = 0; path < pathbound; path++) -+ { -+ PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G1_G4, bRFRegOffsetMask, -+ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (APK_result[path][1] << 5) | APK_result[path][1])); -+ if(path == RF_PATH_A) -+ PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G5_G8, bRFRegOffsetMask, -+ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x00 << 5) | 0x05)); -+ else -+ PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G5_G8, bRFRegOffsetMask, -+ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x02 << 5) | 0x05)); -+ -+ PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G9_G11, bRFRegOffsetMask, ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) | 0x08)); -+ } -+ -+ pHalData->bAPKdone = TRUE; -+ -+ RTPRINT(FINIT, INIT_IQK, ("<==phy_APCalibrate_8192C()\n")); -+} -+ -+ -+VOID -+PHY_IQCalibrate_8192C( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ s4Byte result[4][8]; //last is final result -+ u1Byte i, final_candidate, Indexforchannel; -+ BOOLEAN bPathAOK, bPathBOK; -+ s4Byte RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC, RegTmp = 0; -+ BOOLEAN is12simular, is13simular, is23simular; -+ BOOLEAN bStartContTx = FALSE, bSingleTone = FALSE, bCarrierSuppression = FALSE; -+ u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { -+ rOFDM0_XARxIQImbalance, rOFDM0_XBRxIQImbalance, -+ rOFDM0_ECCAThreshold, rOFDM0_AGCRSSITable, -+ rOFDM0_XATxIQImbalance, rOFDM0_XBTxIQImbalance, -+ rOFDM0_XCTxAFE, rOFDM0_XDTxAFE, -+ rOFDM0_RxIQExtAnta}; -+ -+ if (ODM_CheckPowerStatus(pAdapter) == FALSE) -+ return; -+ -+#if MP_DRIVER == 1 -+ bStartContTx = pAdapter->MptCtx.bStartContTx; -+ bSingleTone = pAdapter->MptCtx.bSingleTone; -+ bCarrierSuppression = pAdapter->MptCtx.bCarrierSuppression; -+#endif -+ -+ //ignore IQK when continuous Tx -+ if(bStartContTx || bSingleTone || bCarrierSuppression) -+ return; -+ -+#ifdef DISABLE_BB_RF -+ return; -+#endif -+ if(pAdapter->bSlaveOfDMSP) -+ return; -+ -+ if (bReCovery) -+ { -+ phy_ReloadADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup_recover, 9); -+ return; -+ -+ } -+ -+ RTPRINT(FINIT, INIT_IQK, ("IQK:Start!!!\n")); -+ -+ for(i = 0; i < 8; i++) -+ { -+ result[0][i] = 0; -+ result[1][i] = 0; -+ result[2][i] = 0; -+ result[3][i] = 0; -+ } -+ final_candidate = 0xff; -+ bPathAOK = FALSE; -+ bPathBOK = FALSE; -+ is12simular = FALSE; -+ is23simular = FALSE; -+ is13simular = FALSE; -+ -+ AcquireCCKAndRWPageAControl(pAdapter); -+ /*RT_TRACE(COMP_INIT,DBG_LOUD,("Acquire Mutex in IQCalibrate\n"));*/ -+ for (i=0; i<3; i++) -+ { -+ /*For 88C 1T1R*/ -+ phy_IQCalibrate_8192C(pAdapter, result, i, FALSE); -+ -+ if(i == 1) -+ { -+ is12simular = phy_SimularityCompare(pAdapter, result, 0, 1); -+ if(is12simular) -+ { -+ final_candidate = 0; -+ break; -+ } -+ } -+ -+ if(i == 2) -+ { -+ is13simular = phy_SimularityCompare(pAdapter, result, 0, 2); -+ if(is13simular) -+ { -+ final_candidate = 0; -+ break; -+ } -+ -+ is23simular = phy_SimularityCompare(pAdapter, result, 1, 2); -+ if(is23simular) -+ final_candidate = 1; -+ else -+ { -+ for(i = 0; i < 8; i++) -+ RegTmp += result[3][i]; -+ -+ if(RegTmp != 0) -+ final_candidate = 3; -+ else -+ final_candidate = 0xFF; -+ } -+ } -+ } -+// RT_TRACE(COMP_INIT,DBG_LOUD,("Release Mutex in IQCalibrate \n")); -+ ReleaseCCKAndRWPageAControl(pAdapter); -+ -+ for (i=0; i<4; i++) -+ { -+ RegE94 = result[i][0]; -+ RegE9C = result[i][1]; -+ RegEA4 = result[i][2]; -+ RegEAC = result[i][3]; -+ RegEB4 = result[i][4]; -+ RegEBC = result[i][5]; -+ RegEC4 = result[i][6]; -+ RegECC = result[i][7]; -+ RTPRINT(FINIT, INIT_IQK, ("IQK: RegE94=%x RegE9C=%x RegEA4=%x RegEAC=%x RegEB4=%x RegEBC=%x RegEC4=%x RegECC=%x\n ", RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC)); -+ } -+ -+ if(final_candidate != 0xff) -+ { -+ pHalData->RegE94 = RegE94 = result[final_candidate][0]; -+ pHalData->RegE9C = RegE9C = result[final_candidate][1]; -+ RegEA4 = result[final_candidate][2]; -+ RegEAC = result[final_candidate][3]; -+ pHalData->RegEB4 = RegEB4 = result[final_candidate][4]; -+ pHalData->RegEBC = RegEBC = result[final_candidate][5]; -+ RegEC4 = result[final_candidate][6]; -+ RegECC = result[final_candidate][7]; -+ RTPRINT(FINIT, INIT_IQK, ("IQK: final_candidate is %x\n",final_candidate)); -+ RTPRINT(FINIT, INIT_IQK, ("IQK: RegE94=%x RegE9C=%x RegEA4=%x RegEAC=%x RegEB4=%x RegEBC=%x RegEC4=%x RegECC=%x\n ", RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC)); -+ bPathAOK = bPathBOK = TRUE; -+ } -+ else -+ { -+ RegE94 = RegEB4 = pHalData->RegE94 = pHalData->RegEB4 = 0x100; //X default value -+ RegE9C = RegEBC = pHalData->RegE9C = pHalData->RegEBC = 0x0; //Y default value -+ } -+ -+ if((RegE94 != 0)/*&&(RegEA4 != 0)*/) -+ { -+ if(pHalData->CurrentBandType == BAND_ON_5G) -+ phy_PathAFillIQKMatrix_5G_Normal(pAdapter, bPathAOK, result, final_candidate, (RegEA4 == 0)); -+ else -+ phy_PathAFillIQKMatrix(pAdapter, bPathAOK, result, final_candidate, (RegEA4 == 0)); -+ -+ } -+ -+ if (IS_92C_SERIAL(pHalData->VersionID) || IS_92D_SINGLEPHY(pHalData->VersionID)) -+ { -+ if((RegEB4 != 0)/*&&(RegEC4 != 0)*/) -+ { -+ if(pHalData->CurrentBandType == BAND_ON_5G) -+ phy_PathBFillIQKMatrix_5G_Normal(pAdapter, bPathBOK, result, final_candidate, (RegEC4 == 0)); -+ else -+ phy_PathBFillIQKMatrix(pAdapter, bPathBOK, result, final_candidate, (RegEC4 == 0)); -+ } -+ } -+ -+ phy_SaveADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup_recover, 9); -+ -+} -+ -+ -+VOID -+PHY_LCCalibrate_8192C( -+ IN PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ BOOLEAN bStartContTx = FALSE, bSingleTone = FALSE, bCarrierSuppression = FALSE; -+ PMGNT_INFO pMgntInfo=&pAdapter->MgntInfo; -+ PMGNT_INFO pMgntInfoBuddyAdapter; -+ u4Byte timeout = 2000, timecount = 0; -+ PADAPTER BuddyAdapter = pAdapter->BuddyAdapter; -+ -+#if MP_DRIVER == 1 -+ bStartContTx = pAdapter->MptCtx.bStartContTx; -+ bSingleTone = pAdapter->MptCtx.bSingleTone; -+ bCarrierSuppression = pAdapter->MptCtx.bCarrierSuppression; -+#endif -+ -+#ifdef DISABLE_BB_RF -+ return; -+#endif -+ -+ //ignore LCK when continuous Tx -+ if(bStartContTx || bSingleTone || bCarrierSuppression) -+ return; -+ -+ if(BuddyAdapter != NULL && -+ ((pAdapter->interfaceIndex == 0 && pHalData->CurrentBandType == BAND_ON_2_4G) || -+ (pAdapter->interfaceIndex == 1 && pHalData->CurrentBandType == BAND_ON_5G))) -+ { -+ pMgntInfoBuddyAdapter=&BuddyAdapter->MgntInfo; -+ while(pMgntInfoBuddyAdapter->bScanInProgress && timecount < timeout) -+ { -+ delay_ms(50); -+ timecount += 50; -+ } -+ } -+ -+ while(pMgntInfo->bScanInProgress && timecount < timeout) -+ { -+ delay_ms(50); -+ timecount += 50; -+ } -+ -+ pHalData->bLCKInProgress = TRUE; -+ -+ RTPRINT(FINIT, INIT_IQK, ("LCK:Start!!!interface %d currentband %x delay %d ms\n", pAdapter->interfaceIndex, pHalData->CurrentBandType, timecount)); -+ -+ //if(IS_92C_SERIAL(pHalData->VersionID) || IS_92D_SINGLEPHY(pHalData->VersionID)) -+ if(IS_2T2R(pHalData->VersionID)) -+ { -+ phy_LCCalibrate(pAdapter, TRUE); -+ } -+ else{ -+ // For 88C 1T1R -+ phy_LCCalibrate(pAdapter, FALSE); -+ } -+ -+ pHalData->bLCKInProgress = FALSE; -+ -+ RTPRINT(FINIT, INIT_IQK, ("LCK:Finish!!!interface %d\n", pAdapter->interfaceIndex)); -+ -+ -+} -+ -+VOID -+PHY_APCalibrate_8192C( -+ IN PADAPTER pAdapter, -+ IN s1Byte delta -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ //default disable APK, because Tx NG issue, suggest by Jenyu, 2011.11.25 -+ return; -+ -+#ifdef DISABLE_BB_RF -+ return; -+#endif -+ -+#if FOR_BRAZIL_PRETEST != 1 -+ if(pHalData->bAPKdone) -+#endif -+ return; -+ -+ if(IS_92C_SERIAL( pHalData->VersionID)){ -+ phy_APCalibrate_8192C(pAdapter, delta, TRUE); -+ } -+ else{ -+ // For 88C 1T1R -+ phy_APCalibrate_8192C(pAdapter, delta, FALSE); -+ } -+} -+ -+ -+#endif -+ -+ -+//3============================================================ -+//3 IQ Calibration -+//3============================================================ -+ -+VOID -+ODM_ResetIQKResult( -+ IN PVOID pDM_VOID -+) -+{ -+ return; -+} -+#if 1//!(DM_ODM_SUPPORT_TYPE & ODM_AP) -+u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) -+{ -+ u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = -+ {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; -+ u1Byte place = chnl; -+ -+ -+ if(chnl > 14) -+ { -+ for(place = 14; placeAdapter; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (*pDM_Odm->pIsFcsModeEnable) -+ return; -+#endif -+ -+ -+ -+ if (pDM_Odm->bLinked) { -+ if ((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) { -+ pDM_Odm->preChannel = *pDM_Odm->pChannel; -+ pDM_Odm->LinkedInterval = 0; -+ } -+ -+ if (pDM_Odm->LinkedInterval < 3) -+ pDM_Odm->LinkedInterval++; -+ -+ if (pDM_Odm->LinkedInterval == 2) { -+ -+ #if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ PHY_IQCalibrate_8814A(pDM_Odm, FALSE); -+ #endif -+ -+ #if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ PHY_IQCalibrate_8822B(pDM_Odm, FALSE); -+ #endif -+ -+ #if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ PHY_IQCalibrate_8821C(pDM_Odm, FALSE); -+ #endif -+ -+ #if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821) -+ PHY_IQCalibrate_8821A(pDM_Odm, FALSE); -+ #endif -+ -+ #if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ phy_IQCalibrate_8812A(pDM_Odm, FALSE); -+ #endif -+ } -+ } else -+ pDM_Odm->LinkedInterval = 0; -+ -+} -+ -+void phydm_rf_init(IN PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ odm_TXPowerTrackingInit(pDM_Odm); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ PHY_IQCalibrate_8814A_Init(pDM_Odm); -+#endif -+#endif -+ -+} -+ -+void phydm_rf_watchdog(IN PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ ODM_TXPowerTrackingCheck(pDM_Odm); -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ odm_IQCalibrate(pDM_Odm); -+#endif -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ap.h 2018-02-11 21:44:27.153146177 +0200 -@@ -0,0 +1,179 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ #ifndef __HAL_PHY_RF_H__ -+ #define __HAL_PHY_RF_H__ -+ -+#include "phydm_powertracking_ap.h" -+#if (RTL8814A_SUPPORT == 1) -+#include "rtl8814a/phydm_iqk_8814a.h" -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+#include "rtl8822b/phydm_iqk_8822b.h" -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+#include "rtl8822b/phydm_iqk_8821c.h" -+#endif -+ -+typedef enum _PWRTRACK_CONTROL_METHOD { -+ BBSWING, -+ TXAGC, -+ MIX_MODE, -+ TSSI_MODE -+} PWRTRACK_METHOD; -+ -+typedef VOID (*FuncSetPwr)(PVOID, PWRTRACK_METHOD, u1Byte, u1Byte); -+typedef VOID(*FuncIQK)(PVOID, u1Byte, u1Byte, u1Byte); -+typedef VOID (*FuncLCK)(PVOID); -+ //refine by YuChen for 8814A -+typedef VOID (*FuncSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+typedef VOID (*FuncSwing8814only)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+typedef VOID (*FuncAllSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+ -+ -+typedef struct _TXPWRTRACK_CFG { -+ u1Byte SwingTableSize_CCK; -+ u1Byte SwingTableSize_OFDM; -+ u1Byte Threshold_IQK; -+ u1Byte Threshold_DPK; -+ u1Byte AverageThermalNum; -+ u1Byte RfPathCount; -+ u4Byte ThermalRegAddr; -+ FuncSetPwr ODM_TxPwrTrackSetPwr; -+ FuncIQK DoIQK; -+ FuncLCK PHY_LCCalibrate; -+ FuncSwing GetDeltaSwingTable; -+ FuncSwing8814only GetDeltaSwingTable8814only; -+ FuncAllSwing GetDeltaAllSwingTable; -+} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; -+ -+VOID -+ConfigureTxpowerTrack( -+ IN PVOID pDM_VOID, -+ OUT PTXPWRTRACK_CFG pConfig -+ ); -+ -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+ -+#if (RTL8192E_SUPPORT==1) -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_92E( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+#endif -+ -+#if (RTL8814A_SUPPORT == 1) -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries2( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+ -+#elif ODM_IC_11AC_SERIES_SUPPORT -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+ -+#elif (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries3( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+ -+#endif -+ -+#define IS_CCK_RATE(_rate) (ODM_MGN_1M == _rate || _rate == ODM_MGN_2M || _rate == ODM_MGN_5_5M || _rate == ODM_MGN_11M ) -+ -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#define MAX_TOLERANCE 5 -+#define IQK_DELAY_TIME 1 //ms -+ -+ // -+// BB/MAC/RF other monitor API -+// -+ -+void PHY_SetMonitorMode8192C(IN PADAPTER pAdapter, -+ IN BOOLEAN bEnableMonitorMode ); -+ -+// -+// IQ calibrate -+// -+void -+PHY_IQCalibrate_8192C( IN PADAPTER pAdapter, -+ IN BOOLEAN bReCovery); -+ -+// -+// LC calibrate -+// -+void -+PHY_LCCalibrate_8192C( IN PADAPTER pAdapter); -+ -+// -+// AP calibrate -+// -+void -+PHY_APCalibrate_8192C( IN PADAPTER pAdapter, -+ IN s1Byte delta); -+#endif -+ -+#define ODM_TARGET_CHNL_NUM_2G_5G 59 -+ -+ -+VOID -+ODM_ResetIQKResult( -+ IN PVOID pDM_VOID -+); -+u1Byte -+ODM_GetRightChnlPlaceforIQK( -+ IN u1Byte chnl -+); -+ -+void phydm_rf_init(IN PVOID pDM_VOID); -+void phydm_rf_watchdog(IN PVOID pDM_VOID); -+ -+#endif // #ifndef __HAL_PHY_RF_H__ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.c 2018-02-11 21:44:27.153146177 +0200 -@@ -0,0 +1,807 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ -+ do {\ -+ for(_offset = 0; _offset < _size; _offset++)\ -+ {\ -+ if(_deltaThermal < thermalThreshold[_direction][_offset])\ -+ {\ -+ if(_offset != 0)\ -+ _offset--;\ -+ break;\ -+ }\ -+ } \ -+ if(_offset >= _size)\ -+ _offset = _size-1;\ -+ } while(0) -+ -+void ConfigureTxpowerTrack( -+ IN PVOID pDM_VOID, -+ OUT PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+#if RTL8192E_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8192E) -+ ConfigureTxpowerTrack_8192E(pConfig); -+#endif -+#if RTL8821A_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8821) -+ ConfigureTxpowerTrack_8821A(pConfig); -+#endif -+#if RTL8812A_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ ConfigureTxpowerTrack_8812A(pConfig); -+#endif -+#if RTL8188E_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ ConfigureTxpowerTrack_8188E(pConfig); -+#endif -+ -+#if RTL8723B_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) -+ ConfigureTxpowerTrack_8723B(pConfig); -+#endif -+ -+#if RTL8814A_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ ConfigureTxpowerTrack_8814A(pConfig); -+#endif -+ -+#if RTL8703B_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) -+ ConfigureTxpowerTrack_8703B(pConfig); -+#endif -+ -+#if RTL8188F_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ ConfigureTxpowerTrack_8188F(pConfig); -+#endif -+#if RTL8723D_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8723D) -+ ConfigureTxpowerTrack_8723D(pConfig); -+#endif -+#if RTL8822B_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ ConfigureTxpowerTrack_8822B(pConfig); -+#endif -+#if RTL8821C_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ ConfigureTxpowerTrack_8821C(pConfig); -+#endif -+ -+} -+ -+//====================================================================== -+// <20121113, Kordan> This function should be called when TxAGC changed. -+// Otherwise the previous compensation is gone, because we record the -+// delta of temperature between two TxPowerTracking watch dogs. -+// -+// NOTE: If Tx BB swing or Tx scaling is varified during run-time, still -+// need to call this function. -+//====================================================================== -+VOID -+ODM_ClearTxPowerTrackingState( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -+ u1Byte p = 0; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; -+ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->DefaultCckIndex; -+ pDM_Odm->RFCalibrateInfo.CCK_index = 0; -+ -+ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) -+ { -+ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ pRFCalibrateInfo->DeltaPowerIndex[p] = 0; -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; -+ -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = 0; /* Initial Mix mode power tracking*/ -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[p] = 0; -+ pRFCalibrateInfo->KfreeOffset[p] = 0; -+ } -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; /*Initial at Modify Tx Scaling Mode*/ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = FALSE; /*Initial at Modify Tx Scaling Mode*/ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathC = FALSE; /*Initial at Modify Tx Scaling Mode*/ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathD = FALSE; /*Initial at Modify Tx Scaling Mode*/ -+ pRFCalibrateInfo->Remnant_CCKSwingIdx = 0; -+ pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; -+ -+ pRFCalibrateInfo->Modify_TxAGC_Value_CCK=0; //modify by Mingzhi.Guo -+ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM=0; //modify by Mingzhi.Guo -+ -+} -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+#endif -+ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; -+ s1Byte diff_DPK[4] = {0}; -+ u1Byte ThermalValue_AVG_count = 0; -+ u4Byte ThermalValue_AVG = 0, RegC80, RegCd0, RegCd4, Regab4; -+ -+ u1Byte OFDM_min_index = 0; // OFDM BB Swing should be less than +3.0dB, which is required by Arthur -+ u1Byte Indexforchannel = 0; // GetRightChnlPlaceforIQK(pHalData->CurrentChannel) -+ u1Byte PowerTrackingType = pHalData->RfPowerTrackingType; -+ u1Byte XtalOffsetEanble = 0; -+ -+ TXPWRTRACK_CFG c; -+ -+ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. -+ pu1Byte deltaSwingTableIdx_TUP_A = NULL; -+ pu1Byte deltaSwingTableIdx_TDOWN_A = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_B = NULL; -+ pu1Byte deltaSwingTableIdx_TDOWN_B = NULL; -+ /*for 8814 add by Yu Chen*/ -+ pu1Byte deltaSwingTableIdx_TUP_C = NULL; -+ pu1Byte deltaSwingTableIdx_TDOWN_C = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_D = NULL; -+ pu1Byte deltaSwingTableIdx_TDOWN_D = NULL; -+ /*for Xtal Offset by James.Tung*/ -+ ps1Byte deltaSwingTableXtal_UP = NULL; -+ ps1Byte deltaSwingTableXtal_DOWN = NULL; -+ -+ //4 2. Initilization ( 7 steps in total ) -+ -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ -+ (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_A, (pu1Byte *)&deltaSwingTableIdx_TDOWN_A, -+ (pu1Byte *)&deltaSwingTableIdx_TUP_B, (pu1Byte *)&deltaSwingTableIdx_TDOWN_B); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) /*for 8814 path C & D*/ -+ (*c.GetDeltaSwingTable8814only)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_C, (pu1Byte *)&deltaSwingTableIdx_TDOWN_C, -+ (pu1Byte *)&deltaSwingTableIdx_TUP_D, (pu1Byte *)&deltaSwingTableIdx_TDOWN_D); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) /*for Xtal Offset*/ -+ (*c.GetDeltaSwingXtalTable)(pDM_Odm, (ps1Byte *)&deltaSwingTableXtal_UP, (ps1Byte *)&deltaSwingTableXtal_DOWN); -+ -+ pRFCalibrateInfo->TXPowerTrackingCallbackCnt++; /*cosa add for debug*/ -+ pRFCalibrateInfo->bTXPowerTrackingInit = TRUE; -+ -+ /*pRFCalibrateInfo->TxPowerTrackControl = pHalData->TxPowerTrackControl; -+ We should keep updating the control variable according to HalData. -+ RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. */ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ #if (MP_DRIVER == 1) -+ pRFCalibrateInfo->RegA24 = 0x090e1317; -+ #endif -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ if (pDM_Odm->mp_mode == TRUE) -+ pRFCalibrateInfo->RegA24 = 0x090e1317; -+ #endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("===>ODM_TXPowerTrackingCallback_ThermalMeter\n pRFCalibrateInfo->BbSwingIdxCckBase: %d, pRFCalibrateInfo->BbSwingIdxOfdmBase[A]: %d, pRFCalibrateInfo->DefaultOfdmIndex: %d\n", -+ pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_A], pRFCalibrateInfo->DefaultOfdmIndex)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("pRFCalibrateInfo->TxPowerTrackControl=%d, pHalData->EEPROMThermalMeter %d\n", pRFCalibrateInfo->TxPowerTrackControl, pHalData->EEPROMThermalMeter)); -+ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E -+ -+ /*add log by zhao he, check c80/c94/c14/ca0 value*/ -+ if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ RegC80 = ODM_GetBBReg(pDM_Odm, 0xc80, bMaskDWord); -+ RegCd0 = ODM_GetBBReg(pDM_Odm, 0xcd0, bMaskDWord); -+ RegCd4 = ODM_GetBBReg(pDM_Odm, 0xcd4, bMaskDWord); -+ Regab4 = ODM_GetBBReg(pDM_Odm, 0xab4, 0x000007FF); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", RegC80, RegCd0, RegCd4, Regab4)); -+ } -+ -+ if (!pRFCalibrateInfo->TxPowerTrackControl) -+ return; -+ -+ -+ /*4 3. Initialize ThermalValues of RFCalibrateInfo*/ -+ -+ if (pRFCalibrateInfo->bReloadtxpowerindex) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); -+ -+ /*4 4. Calculate average thermal meter*/ -+ -+ pRFCalibrateInfo->ThermalValue_AVG[pRFCalibrateInfo->ThermalValue_AVG_index] = ThermalValue; -+ pRFCalibrateInfo->ThermalValue_AVG_index++; -+ if (pRFCalibrateInfo->ThermalValue_AVG_index == c.AverageThermalNum) /*Average times = c.AverageThermalNum*/ -+ pRFCalibrateInfo->ThermalValue_AVG_index = 0; -+ -+ for(i = 0; i < c.AverageThermalNum; i++) -+ { -+ if (pRFCalibrateInfo->ThermalValue_AVG[i]) { -+ ThermalValue_AVG += pRFCalibrateInfo->ThermalValue_AVG[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times -+ { -+ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("AVG Thermal Meter = 0x%X, EFUSE Thermal Base = 0x%X\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ } -+ -+ //4 5. Calculate delta, delta_LCK, delta_IQK. -+ -+ //"delta" here is used to determine whether thermal value changes or not. -+ delta = (ThermalValue > pRFCalibrateInfo->ThermalValue)?(ThermalValue - pRFCalibrateInfo->ThermalValue):(pRFCalibrateInfo->ThermalValue - ThermalValue); -+ delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); -+ delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); -+ -+ if (pRFCalibrateInfo->ThermalValue_IQK == 0xff) { /*no PG, use thermal value for IQK*/ -+ pRFCalibrateInfo->ThermalValue_IQK = ThermalValue; -+ delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, use ThermalValue for IQK\n")); -+ } -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ diff_DPK[p] = (s1Byte)ThermalValue - (s1Byte)pRFCalibrateInfo->DpkThermal[p]; -+ -+ /*4 6. If necessary, do LCK.*/ -+ -+ if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { /*no PG , do LCK at initial status*/ -+ if (pRFCalibrateInfo->ThermalValue_LCK == 0xff) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, do LCK\n")); -+ pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; -+ -+ /*Use RTLCK, so close power tracking driver LCK*/ -+ if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { -+ if (c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ -+ delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK)); -+ -+ /* Delta temperature is equal to or larger than 20 centigrade.*/ -+ if (delta_LCK >= c.Threshold_IQK) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); -+ pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; -+ -+ /*Use RTLCK, so close power tracking driver LCK*/ -+ if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { -+ if (c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ } -+ } -+ -+ /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ -+ -+ if (delta > 0 && pRFCalibrateInfo->TxPowerTrackControl) -+ { -+ //"delta" here is used to record the absolute value of differrence. -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); -+#else -+ delta = (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther)?(ThermalValue - pDM_Odm->priv->pmib->dot11RFEntry.ther):(pDM_Odm->priv->pmib->dot11RFEntry.ther - ThermalValue); -+#endif -+ if (delta >= TXPWR_TRACK_TABLE_SIZE) -+ delta = TXPWR_TRACK_TABLE_SIZE - 1; -+ -+ /*4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset*/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(ThermalValue > pHalData->EEPROMThermalMeter) { -+#else -+ if(ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -+#endif -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; /*recording poer index offset*/ -+ switch (p) { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); -+ -+ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_B[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta])); -+ -+ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_C[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta])); -+ -+ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_D[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); -+ -+ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_A[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ } -+ } -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) { -+ /*Save XtalOffset from Xtal table*/ -+ pRFCalibrateInfo->XtalOffsetLast = pRFCalibrateInfo->XtalOffset; /*recording last Xtal offset*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("[Xtal] deltaSwingTableXtal_UP[%d] = %d\n", delta, deltaSwingTableXtal_UP[delta])); -+ pRFCalibrateInfo->XtalOffset = deltaSwingTableXtal_UP[delta]; -+ -+ if (pRFCalibrateInfo->XtalOffsetLast == pRFCalibrateInfo->XtalOffset) -+ XtalOffsetEanble = 0; -+ else -+ XtalOffsetEanble = 1; -+ } -+ -+ } else { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; /*recording poer index offset*/ -+ -+ switch (p) { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); -+ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta])); -+ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta])); -+ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); -+ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ } -+ } -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) { -+ /*Save XtalOffset from Xtal table*/ -+ pRFCalibrateInfo->XtalOffsetLast = pRFCalibrateInfo->XtalOffset; /*recording last Xtal offset*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("[Xtal] deltaSwingTableXtal_DOWN[%d] = %d\n", delta, deltaSwingTableXtal_DOWN[delta])); -+ pRFCalibrateInfo->XtalOffset = deltaSwingTableXtal_DOWN[delta]; -+ -+ if (pRFCalibrateInfo->XtalOffsetLast == pRFCalibrateInfo->XtalOffset) -+ XtalOffsetEanble = 0; -+ else -+ XtalOffsetEanble = 1; -+ } -+ -+ } -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n\n=========================== [Path-%d] Calculating PowerIndexOffset===========================\n", p)); -+ -+ if (pRFCalibrateInfo->DeltaPowerIndex[p] == pRFCalibrateInfo->DeltaPowerIndexLast[p]) /*If Thermal value changes but lookup table value still the same*/ -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ else -+ pRFCalibrateInfo->PowerIndexOffset[p] = pRFCalibrateInfo->DeltaPowerIndex[p] - pRFCalibrateInfo->DeltaPowerIndexLast[p]; /*Power Index Diff between 2 times Power Tracking*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("[Path-%d] PowerIndexOffset(%d) = DeltaPowerIndex(%d) - DeltaPowerIndexLast(%d)\n", p, pRFCalibrateInfo->PowerIndexOffset[p], pRFCalibrateInfo->DeltaPowerIndex[p], pRFCalibrateInfo->DeltaPowerIndexLast[p])); -+ -+ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->BbSwingIdxOfdmBase[p] + pRFCalibrateInfo->PowerIndexOffset[p]; -+ pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->BbSwingIdxCckBase + pRFCalibrateInfo->PowerIndexOffset[p]; -+ -+ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->CCK_index; -+ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->OFDM_index[p]; -+ -+ /*************Print BB Swing Base and Index Offset*************/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxCck, pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->PowerIndexOffset[p])); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The 'OFDM' final index(%d) = BaseIndex[%d](%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxOfdm[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p], pRFCalibrateInfo->PowerIndexOffset[p])); -+ -+ /*4 7.1 Handle boundary conditions of index.*/ -+ -+ if (pRFCalibrateInfo->OFDM_index[p] > c.SwingTableSize_OFDM-1) -+ pRFCalibrateInfo->OFDM_index[p] = c.SwingTableSize_OFDM-1; -+ else if (pRFCalibrateInfo->OFDM_index[p] <= OFDM_min_index) -+ pRFCalibrateInfo->OFDM_index[p] = OFDM_min_index; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n\n========================================================================================================\n")); -+ -+ if (pRFCalibrateInfo->CCK_index > c.SwingTableSize_CCK-1) -+ pRFCalibrateInfo->CCK_index = c.SwingTableSize_CCK-1; -+ else if (pRFCalibrateInfo->CCK_index <= 0) -+ pRFCalibrateInfo->CCK_index = 0; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The thermal meter is unchanged or TxPowerTracking OFF(%d): ThermalValue: %d , pRFCalibrateInfo->ThermalValue: %d\n", -+ pRFCalibrateInfo->TxPowerTrackControl, ThermalValue, pRFCalibrateInfo->ThermalValue)); -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", -+ pRFCalibrateInfo->CCK_index, pRFCalibrateInfo->BbSwingIdxCckBase)); /*Print Swing base & current*/ -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index[%d]: %d\n", -+ pRFCalibrateInfo->OFDM_index[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p])); -+ } -+ -+ if ((pDM_Odm->SupportICType & ODM_RTL8814A)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("PowerTrackingType=%d\n", PowerTrackingType)); -+ -+ if (PowerTrackingType == 0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } else if (PowerTrackingType == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(2G) TSSI(5G) MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_2G_TSSI_5G_MODE, p, 0); -+ } else if (PowerTrackingType == 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(5G) TSSI(2G)MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_5G_TSSI_2G_MODE, p, 0); -+ } else if (PowerTrackingType == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking TSSI MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TSSI_MODE, p, 0); -+ } -+ pRFCalibrateInfo->ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ -+ -+ } else if ((pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_A] != 0 || -+ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_B] != 0 || -+ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_C] != 0 || -+ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_D] != 0) && -+ pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) { -+ //4 7.2 Configure the Swing Table to adjust Tx Power. -+ -+ pRFCalibrateInfo->bTxPowerChanged = TRUE; /*Always TRUE after Tx Power is adjusted by power tracking.*/ -+ // -+ // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital -+ // to increase TX power. Otherwise, EVM will be bad. -+ // -+ // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. -+ if (ThermalValue > pRFCalibrateInfo->ThermalValue) { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature Increasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); -+ } -+ } else if (ThermalValue < pRFCalibrateInfo->ThermalValue) { /*Low temperature*/ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature Decreasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); -+ } -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (ThermalValue > pHalData->EEPROMThermalMeter) -+#else -+ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) -+#endif -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || -+ pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || -+ pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8822B || -+ pDM_Odm->SupportICType == ODM_RTL8723D || pDM_Odm->SupportICType == ODM_RTL8821C) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || -+ pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || -+ pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8822B || -+ pDM_Odm->SupportICType == ODM_RTL8723D || pDM_Odm->SupportICType == ODM_RTL8821C) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); -+ } -+ -+ } -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->BbSwingIdxCck; /*Record last time Power Tracking result as base.*/ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->BbSwingIdxOfdm[p]; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("pRFCalibrateInfo->ThermalValue = %d ThermalValue= %d\n", pRFCalibrateInfo->ThermalValue, ThermalValue)); -+ -+ pRFCalibrateInfo->ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ -+ -+ } -+ -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8723D) { -+ -+ if (XtalOffsetEanble != 0 && pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter Xtal Tracking**********\n")); -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (ThermalValue > pHalData->EEPROMThermalMeter) { -+#else -+ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -+#endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ (*c.ODM_TxXtalTrackSetXtal)(pDM_Odm); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ (*c.ODM_TxXtalTrackSetXtal)(pDM_Odm); -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********End Xtal Tracking**********\n")); -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ if (!IS_HARDWARE_TYPE_8723B(Adapter)) { -+ /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ -+ if (delta_IQK >= c.Threshold_IQK) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); -+ if (!pRFCalibrateInfo->bIQKInProgress) -+ (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); -+ } -+ } -+ if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_A] != 0) { -+ if (diff_DPK[ODM_RF_PATH_A] >= c.Threshold_DPK) { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK)); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else if ((diff_DPK[ODM_RF_PATH_A] <= -1 * c.Threshold_DPK)) { -+ s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, value); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } -+ } -+ if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_B] != 0) { -+ if (diff_DPK[ODM_RF_PATH_B] >= c.Threshold_DPK) { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK)); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else if ((diff_DPK[ODM_RF_PATH_B] <= -1 * c.Threshold_DPK)) { -+ s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, value); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } -+ } -+ -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("<===ODM_TXPowerTrackingCallback_ThermalMeter\n")); -+ -+ pRFCalibrateInfo->TXPowercount = 0; -+} -+ -+ -+ -+//3============================================================ -+//3 IQ Calibration -+//3============================================================ -+ -+VOID -+ODM_ResetIQKResult( -+ IN PVOID pDM_VOID -+) -+{ -+ return; -+} -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) -+{ -+ u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = -+ {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; -+ u1Byte place = chnl; -+ -+ -+ if(chnl > 14) -+ { -+ for(place = 14; placeAdapter; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (*pDM_Odm->pIsFcsModeEnable) -+ return; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ if (IS_HARDWARE_TYPE_8812AU(Adapter)) -+ return; -+#endif -+ -+ if (pDM_Odm->bLinked) { -+ if ((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) { -+ pDM_Odm->preChannel = *pDM_Odm->pChannel; -+ pDM_Odm->LinkedInterval = 0; -+ } -+ -+ if (pDM_Odm->LinkedInterval < 3) -+ pDM_Odm->LinkedInterval++; -+ -+ if (pDM_Odm->LinkedInterval == 2) { -+ if (IS_HARDWARE_TYPE_8814A(Adapter)) { -+ #if (RTL8814A_SUPPORT == 1) -+ PHY_IQCalibrate_8814A(pDM_Odm, FALSE); -+ #endif -+ } -+ -+ #if (RTL8822B_SUPPORT == 1) -+ else if (IS_HARDWARE_TYPE_8822B(Adapter)) -+ PHY_IQCalibrate_8822B(pDM_Odm, FALSE); -+ #endif -+ -+ #if (RTL8821C_SUPPORT == 1) -+ else if (IS_HARDWARE_TYPE_8821C(Adapter)) -+ PHY_IQCalibrate_8821C(pDM_Odm, FALSE); -+ #endif -+ -+ #if (RTL8821A_SUPPORT == 1) -+ else if (IS_HARDWARE_TYPE_8821(Adapter)) -+ PHY_IQCalibrate_8821A(pDM_Odm, FALSE); -+ #endif -+ } -+ } else -+ pDM_Odm->LinkedInterval = 0; -+} -+ -+void phydm_rf_init(IN PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ odm_TXPowerTrackingInit(pDM_Odm); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ PHY_IQCalibrate_8814A_Init(pDM_Odm); -+#endif -+#endif -+ -+} -+ -+void phydm_rf_watchdog(IN PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ ODM_TXPowerTrackingCheck(pDM_Odm); -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ odm_IQCalibrate(pDM_Odm); -+#endif -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_ce.h 2018-02-11 21:44:27.153146177 +0200 -@@ -0,0 +1,118 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ #ifndef __HAL_PHY_RF_H__ -+ #define __HAL_PHY_RF_H__ -+ -+#include "phydm_kfree.h" -+#if (RTL8814A_SUPPORT == 1) -+#include "rtl8814a/phydm_iqk_8814a.h" -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+#include "rtl8822b/phydm_iqk_8822b.h" -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+#include "rtl8821c/phydm_iqk_8821c.h" -+#endif -+ -+#include "phydm_powertracking_ce.h" -+ -+ -+typedef enum _SPUR_CAL_METHOD { -+ PLL_RESET, -+ AFE_PHASE_SEL -+} SPUR_CAL_METHOD; -+ -+typedef enum _PWRTRACK_CONTROL_METHOD { -+ BBSWING, -+ TXAGC, -+ MIX_MODE, -+ TSSI_MODE, -+ MIX_2G_TSSI_5G_MODE, -+ MIX_5G_TSSI_2G_MODE -+} PWRTRACK_METHOD; -+ -+typedef VOID (*FuncSetPwr)(PVOID, PWRTRACK_METHOD, u1Byte, u1Byte); -+typedef VOID(*FuncIQK)(PVOID, u1Byte, u1Byte, u1Byte); -+typedef VOID (*FuncLCK)(PVOID); -+typedef VOID (*FuncSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+typedef VOID (*FuncSwing8814only)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+typedef VOID(*FuncSwingXtal)(PVOID, ps1Byte*, ps1Byte*); -+typedef VOID(*FuncSetXtal)(PVOID); -+ -+typedef struct _TXPWRTRACK_CFG { -+ u1Byte SwingTableSize_CCK; -+ u1Byte SwingTableSize_OFDM; -+ u1Byte Threshold_IQK; -+ u1Byte Threshold_DPK; -+ u1Byte AverageThermalNum; -+ u1Byte RfPathCount; -+ u4Byte ThermalRegAddr; -+ FuncSetPwr ODM_TxPwrTrackSetPwr; -+ FuncIQK DoIQK; -+ FuncLCK PHY_LCCalibrate; -+ FuncSwing GetDeltaSwingTable; -+ FuncSwing8814only GetDeltaSwingTable8814only; -+ FuncSwingXtal GetDeltaSwingXtalTable; -+ FuncSetXtal ODM_TxXtalTrackSetXtal; -+} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; -+ -+VOID -+ConfigureTxpowerTrack( -+ IN PVOID pDM_VOID, -+ OUT PTXPWRTRACK_CFG pConfig -+ ); -+ -+ -+VOID -+ODM_ClearTxPowerTrackingState( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PVOID pDM_VOID -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+ -+ -+ -+#define ODM_TARGET_CHNL_NUM_2G_5G 59 -+ -+ -+VOID -+ODM_ResetIQKResult( -+ IN PVOID pDM_VOID -+); -+u1Byte -+ODM_GetRightChnlPlaceforIQK( -+ IN u1Byte chnl -+); -+ -+void phydm_rf_init( IN PVOID pDM_VOID); -+void phydm_rf_watchdog( IN PVOID pDM_VOID); -+ -+#endif // #ifndef __HAL_PHY_RF_H__ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_win.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_win.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_win.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_win.c 2018-02-11 21:44:27.153146177 +0200 -@@ -0,0 +1,792 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ -+ do {\ -+ for(_offset = 0; _offset < _size; _offset++)\ -+ {\ -+ if(_deltaThermal < thermalThreshold[_direction][_offset])\ -+ {\ -+ if(_offset != 0)\ -+ _offset--;\ -+ break;\ -+ }\ -+ } \ -+ if(_offset >= _size)\ -+ _offset = _size-1;\ -+ } while(0) -+ -+void ConfigureTxpowerTrack( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PTXPWRTRACK_CFG pConfig -+ ) -+{ -+#if RTL8192E_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8192E) -+ ConfigureTxpowerTrack_8192E(pConfig); -+#endif -+#if RTL8821A_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8821) -+ ConfigureTxpowerTrack_8821A(pConfig); -+#endif -+#if RTL8812A_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ ConfigureTxpowerTrack_8812A(pConfig); -+#endif -+#if RTL8188E_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ ConfigureTxpowerTrack_8188E(pConfig); -+#endif -+ -+#if RTL8188F_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ ConfigureTxpowerTrack_8188F(pConfig); -+#endif -+ -+#if RTL8723B_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) -+ ConfigureTxpowerTrack_8723B(pConfig); -+#endif -+ -+#if RTL8814A_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ ConfigureTxpowerTrack_8814A(pConfig); -+#endif -+ -+#if RTL8703B_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) -+ ConfigureTxpowerTrack_8703B(pConfig); -+#endif -+ -+#if RTL8822B_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ ConfigureTxpowerTrack_8822B(pConfig); -+#endif -+ -+#if RTL8723D_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8723D) -+ ConfigureTxpowerTrack_8723D(pConfig); -+#endif -+ -+#if RTL8821C_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ ConfigureTxpowerTrack_8821C(pConfig); -+#endif -+ -+} -+ -+//====================================================================== -+// <20121113, Kordan> This function should be called when TxAGC changed. -+// Otherwise the previous compensation is gone, because we record the -+// delta of temperature between two TxPowerTracking watch dogs. -+// -+// NOTE: If Tx BB swing or Tx scaling is varified during run-time, still -+// need to call this function. -+//====================================================================== -+VOID -+ODM_ClearTxPowerTrackingState( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -+ u1Byte p = 0; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; -+ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->DefaultCckIndex; -+ pRFCalibrateInfo->CCK_index = 0; -+ -+ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) -+ { -+ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ pRFCalibrateInfo->DeltaPowerIndex[p] = 0; -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; -+ -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = 0; /* Initial Mix mode power tracking*/ -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[p] = 0; -+ pRFCalibrateInfo->KfreeOffset[p] = 0; -+ } -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; /*Initial at Modify Tx Scaling Mode*/ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = FALSE; /*Initial at Modify Tx Scaling Mode*/ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathC = FALSE; /*Initial at Modify Tx Scaling Mode*/ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathD = FALSE; /*Initial at Modify Tx Scaling Mode*/ -+ pRFCalibrateInfo->Remnant_CCKSwingIdx = 0; -+ pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; -+ -+ pRFCalibrateInfo->Modify_TxAGC_Value_CCK=0; //modify by Mingzhi.Guo -+ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM=0; //modify by Mingzhi.Guo -+ -+} -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER Adapter -+#endif -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#endif -+ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; -+ s1Byte diff_DPK[4] = {0}; -+ u1Byte ThermalValue_AVG_count = 0; -+ u4Byte ThermalValue_AVG = 0, RegC80, RegCd0, RegCd4, Regab4; -+ -+ u1Byte OFDM_min_index = 0; // OFDM BB Swing should be less than +3.0dB, which is required by Arthur -+ u1Byte Indexforchannel = 0; // GetRightChnlPlaceforIQK(pHalData->CurrentChannel) -+ u1Byte PowerTrackingType = pHalData->RfPowerTrackingType; -+ u1Byte XtalOffsetEanble = 0; -+ -+ TXPWRTRACK_CFG c; -+ -+ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. -+ pu1Byte deltaSwingTableIdx_TUP_A = NULL; -+ pu1Byte deltaSwingTableIdx_TDOWN_A = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_B = NULL; -+ pu1Byte deltaSwingTableIdx_TDOWN_B = NULL; -+ /*for 8814 add by Yu Chen*/ -+ pu1Byte deltaSwingTableIdx_TUP_C = NULL; -+ pu1Byte deltaSwingTableIdx_TDOWN_C = NULL; -+ pu1Byte deltaSwingTableIdx_TUP_D = NULL; -+ pu1Byte deltaSwingTableIdx_TDOWN_D = NULL; -+ /*for Xtal Offset by James.Tung*/ -+ ps1Byte deltaSwingTableXtal_UP = NULL; -+ ps1Byte deltaSwingTableXtal_DOWN = NULL; -+ -+ //4 2. Initilization ( 7 steps in total ) -+ -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ -+ (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_A, (pu1Byte *)&deltaSwingTableIdx_TDOWN_A, -+ (pu1Byte *)&deltaSwingTableIdx_TUP_B, (pu1Byte *)&deltaSwingTableIdx_TDOWN_B); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) /*for 8814 path C & D*/ -+ (*c.GetDeltaSwingTable8814only)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_C, (pu1Byte *)&deltaSwingTableIdx_TDOWN_C, -+ (pu1Byte *)&deltaSwingTableIdx_TUP_D, (pu1Byte *)&deltaSwingTableIdx_TDOWN_D); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) /*for Xtal Offset*/ -+ (*c.GetDeltaSwingXtalTable)(pDM_Odm, (ps1Byte *)&deltaSwingTableXtal_UP, (ps1Byte *)&deltaSwingTableXtal_DOWN); -+ -+ -+ pRFCalibrateInfo->TXPowerTrackingCallbackCnt++; /*cosa add for debug*/ -+ pRFCalibrateInfo->bTXPowerTrackingInit = TRUE; -+ -+ /*pRFCalibrateInfo->TxPowerTrackControl = pHalData->TxPowerTrackControl; -+ We should keep updating the control variable according to HalData. -+ RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. */ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ #if (MP_DRIVER == 1) -+ pRFCalibrateInfo->RegA24 = 0x090e1317; -+ #endif -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ if (pDM_Odm->mp_mode == TRUE) -+ pRFCalibrateInfo->RegA24 = 0x090e1317; -+ #endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("===>ODM_TXPowerTrackingCallback_ThermalMeter\n pRFCalibrateInfo->BbSwingIdxCckBase: %d, pRFCalibrateInfo->BbSwingIdxOfdmBase[A]: %d, pRFCalibrateInfo->DefaultOfdmIndex: %d\n", -+ pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_A], pRFCalibrateInfo->DefaultOfdmIndex)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("pRFCalibrateInfo->TxPowerTrackControl=%d, pHalData->EEPROMThermalMeter %d\n", pRFCalibrateInfo->TxPowerTrackControl, pHalData->EEPROMThermalMeter)); -+ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E -+ -+ /*add log by zhao he, check c80/c94/c14/ca0 value*/ -+ if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ RegC80 = ODM_GetBBReg(pDM_Odm, 0xc80, bMaskDWord); -+ RegCd0 = ODM_GetBBReg(pDM_Odm, 0xcd0, bMaskDWord); -+ RegCd4 = ODM_GetBBReg(pDM_Odm, 0xcd4, bMaskDWord); -+ Regab4 = ODM_GetBBReg(pDM_Odm, 0xab4, 0x000007FF); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", RegC80, RegCd0, RegCd4, Regab4)); -+ } -+ -+ if (!pRFCalibrateInfo->TxPowerTrackControl) -+ return; -+ -+ -+ /*4 3. Initialize ThermalValues of RFCalibrateInfo*/ -+ -+ if (pRFCalibrateInfo->bReloadtxpowerindex) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); -+ -+ /*4 4. Calculate average thermal meter*/ -+ -+ pRFCalibrateInfo->ThermalValue_AVG[pRFCalibrateInfo->ThermalValue_AVG_index] = ThermalValue; -+ pRFCalibrateInfo->ThermalValue_AVG_index++; -+ if (pRFCalibrateInfo->ThermalValue_AVG_index == c.AverageThermalNum) /*Average times = c.AverageThermalNum*/ -+ pRFCalibrateInfo->ThermalValue_AVG_index = 0; -+ -+ for(i = 0; i < c.AverageThermalNum; i++) -+ { -+ if (pRFCalibrateInfo->ThermalValue_AVG[i]) { -+ ThermalValue_AVG += pRFCalibrateInfo->ThermalValue_AVG[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times -+ { -+ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("AVG Thermal Meter = 0x%X, EFUSE Thermal Base = 0x%X\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ } -+ -+ //4 5. Calculate delta, delta_LCK, delta_IQK. -+ -+ //"delta" here is used to determine whether thermal value changes or not. -+ delta = (ThermalValue > pRFCalibrateInfo->ThermalValue)?(ThermalValue - pRFCalibrateInfo->ThermalValue):(pRFCalibrateInfo->ThermalValue - ThermalValue); -+ delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); -+ delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); -+ -+ if (pRFCalibrateInfo->ThermalValue_IQK == 0xff) { /*no PG, use thermal value for IQK*/ -+ pRFCalibrateInfo->ThermalValue_IQK = ThermalValue; -+ delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, use ThermalValue for IQK\n")); -+ } -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ diff_DPK[p] = (s1Byte)ThermalValue - (s1Byte)pRFCalibrateInfo->DpkThermal[p]; -+ -+ /*4 6. If necessary, do LCK.*/ -+ -+ if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { /*no PG , do LCK at initial status*/ -+ if (pRFCalibrateInfo->ThermalValue_LCK == 0xff) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, do LCK\n")); -+ pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; -+ -+ /*Use RTLCK, so close power tracking driver LCK*/ -+ if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { -+ if (c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ -+ delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK)); -+ -+ /* Delta temperature is equal to or larger than 20 centigrade.*/ -+ if (delta_LCK >= c.Threshold_IQK) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); -+ pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; -+ -+ /*Use RTLCK, so close power tracking driver LCK*/ -+ if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { -+ if (c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ } -+ } -+ -+ /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ -+ -+ if (delta > 0 && pRFCalibrateInfo->TxPowerTrackControl) -+ { -+ //"delta" here is used to record the absolute value of differrence. -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); -+#else -+ delta = (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther)?(ThermalValue - pDM_Odm->priv->pmib->dot11RFEntry.ther):(pDM_Odm->priv->pmib->dot11RFEntry.ther - ThermalValue); -+#endif -+ if (delta >= TXPWR_TRACK_TABLE_SIZE) -+ delta = TXPWR_TRACK_TABLE_SIZE - 1; -+ -+ /*4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset*/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(ThermalValue > pHalData->EEPROMThermalMeter) { -+#else -+ if(ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -+#endif -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; /*recording poer index offset*/ -+ switch (p) { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); -+ -+ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_B[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta])); -+ -+ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_C[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta])); -+ -+ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_D[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); -+ -+ pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_A[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ } -+ } -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) { -+ /*Save XtalOffset from Xtal table*/ -+ pRFCalibrateInfo->XtalOffsetLast = pRFCalibrateInfo->XtalOffset; /*recording last Xtal offset*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("[Xtal] deltaSwingTableXtal_UP[%d] = %d\n", delta, deltaSwingTableXtal_UP[delta])); -+ pRFCalibrateInfo->XtalOffset = deltaSwingTableXtal_UP[delta]; -+ -+ if (pRFCalibrateInfo->XtalOffsetLast == pRFCalibrateInfo->XtalOffset) -+ XtalOffsetEanble = 0; -+ else -+ XtalOffsetEanble = 1; -+ } -+ -+ } else { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; /*recording poer index offset*/ -+ -+ switch (p) { -+ case ODM_RF_PATH_B: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); -+ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_C: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta])); -+ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ case ODM_RF_PATH_D: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta])); -+ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); -+ pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; -+ pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; /*Record delta swing for mix mode power tracking*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); -+ break; -+ } -+ } -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) { -+ /*Save XtalOffset from Xtal table*/ -+ pRFCalibrateInfo->XtalOffsetLast = pRFCalibrateInfo->XtalOffset; /*recording last Xtal offset*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("[Xtal] deltaSwingTableXtal_DOWN[%d] = %d\n", delta, deltaSwingTableXtal_DOWN[delta])); -+ pRFCalibrateInfo->XtalOffset = deltaSwingTableXtal_DOWN[delta]; -+ -+ if (pRFCalibrateInfo->XtalOffsetLast == pRFCalibrateInfo->XtalOffset) -+ XtalOffsetEanble = 0; -+ else -+ XtalOffsetEanble = 1; -+ } -+ -+ } -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n\n=========================== [Path-%d] Calculating PowerIndexOffset===========================\n", p)); -+ -+ if (pRFCalibrateInfo->DeltaPowerIndex[p] == pRFCalibrateInfo->DeltaPowerIndexLast[p]) /*If Thermal value changes but lookup table value still the same*/ -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ else -+ pRFCalibrateInfo->PowerIndexOffset[p] = pRFCalibrateInfo->DeltaPowerIndex[p] - pRFCalibrateInfo->DeltaPowerIndexLast[p]; /*Power Index Diff between 2 times Power Tracking*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("[Path-%d] PowerIndexOffset(%d) = DeltaPowerIndex(%d) - DeltaPowerIndexLast(%d)\n", p, pRFCalibrateInfo->PowerIndexOffset[p], pRFCalibrateInfo->DeltaPowerIndex[p], pRFCalibrateInfo->DeltaPowerIndexLast[p])); -+ -+ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->BbSwingIdxOfdmBase[p] + pRFCalibrateInfo->PowerIndexOffset[p]; -+ pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->BbSwingIdxCckBase + pRFCalibrateInfo->PowerIndexOffset[p]; -+ -+ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->CCK_index; -+ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->OFDM_index[p]; -+ -+ /*************Print BB Swing Base and Index Offset*************/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxCck, pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->PowerIndexOffset[p])); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The 'OFDM' final index(%d) = BaseIndex[%d](%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxOfdm[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p], pRFCalibrateInfo->PowerIndexOffset[p])); -+ -+ /*4 7.1 Handle boundary conditions of index.*/ -+ -+ if (pRFCalibrateInfo->OFDM_index[p] > c.SwingTableSize_OFDM-1) -+ pRFCalibrateInfo->OFDM_index[p] = c.SwingTableSize_OFDM-1; -+ else if (pRFCalibrateInfo->OFDM_index[p] <= OFDM_min_index) -+ pRFCalibrateInfo->OFDM_index[p] = OFDM_min_index; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n\n========================================================================================================\n")); -+ -+ if (pRFCalibrateInfo->CCK_index > c.SwingTableSize_CCK-1) -+ pRFCalibrateInfo->CCK_index = c.SwingTableSize_CCK-1; -+ else if (pRFCalibrateInfo->CCK_index <= 0) -+ pRFCalibrateInfo->CCK_index = 0; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The thermal meter is unchanged or TxPowerTracking OFF(%d): ThermalValue: %d , pRFCalibrateInfo->ThermalValue: %d\n", -+ pRFCalibrateInfo->TxPowerTrackControl, ThermalValue, pRFCalibrateInfo->ThermalValue)); -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", -+ pRFCalibrateInfo->CCK_index, pRFCalibrateInfo->BbSwingIdxCckBase)); /*Print Swing base & current*/ -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index[%d]: %d\n", -+ pRFCalibrateInfo->OFDM_index[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p])); -+ } -+ -+ if ((pDM_Odm->SupportICType & ODM_RTL8814A)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("PowerTrackingType=%d\n", PowerTrackingType)); -+ -+ if (PowerTrackingType == 0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } else if (PowerTrackingType == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(2G) TSSI(5G) MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_2G_TSSI_5G_MODE, p, 0); -+ } else if (PowerTrackingType == 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(5G) TSSI(2G)MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_5G_TSSI_2G_MODE, p, 0); -+ } else if (PowerTrackingType == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking TSSI MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TSSI_MODE, p, 0); -+ } -+ pRFCalibrateInfo->ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ -+ -+ } else if ((pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_A] != 0 || -+ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_B] != 0 || -+ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_C] != 0 || -+ pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_D] != 0) && -+ pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) { -+ //4 7.2 Configure the Swing Table to adjust Tx Power. -+ -+ pRFCalibrateInfo->bTxPowerChanged = TRUE; /*Always TRUE after Tx Power is adjusted by power tracking.*/ -+ // -+ // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital -+ // to increase TX power. Otherwise, EVM will be bad. -+ // -+ // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. -+ if (ThermalValue > pRFCalibrateInfo->ThermalValue) { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature Increasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); -+ } -+ } else if (ThermalValue < pRFCalibrateInfo->ThermalValue) { /*Low temperature*/ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature Decreasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); -+ } -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (ThermalValue > pHalData->EEPROMThermalMeter) -+#else -+ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) -+#endif -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || -+ pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || -+ pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8822B || -+ pDM_Odm->SupportICType == ODM_RTL8723D || pDM_Odm->SupportICType == ODM_RTL8821C) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || -+ pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || -+ pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8822B || -+ pDM_Odm->SupportICType == ODM_RTL8723D || pDM_Odm->SupportICType == ODM_RTL8821C) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); -+ } -+ -+ } -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->BbSwingIdxCck; /*Record last time Power Tracking result as base.*/ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->BbSwingIdxOfdm[p]; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("pRFCalibrateInfo->ThermalValue = %d ThermalValue= %d\n", pRFCalibrateInfo->ThermalValue, ThermalValue)); -+ -+ pRFCalibrateInfo->ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ -+ -+ } -+ -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8723D) { -+ -+ if (XtalOffsetEanble != 0 && pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter Xtal Tracking**********\n")); -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (ThermalValue > pHalData->EEPROMThermalMeter) { -+#else -+ if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -+#endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ (*c.ODM_TxXtalTrackSetXtal)(pDM_Odm); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ (*c.ODM_TxXtalTrackSetXtal)(pDM_Odm); -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********End Xtal Tracking**********\n")); -+ } -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ if (!IS_HARDWARE_TYPE_8723B(Adapter)) { -+ /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ -+ if (delta_IQK >= c.Threshold_IQK) { -+ pRFCalibrateInfo->ThermalValue_IQK = ThermalValue; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); -+ if (!pRFCalibrateInfo->bIQKInProgress) -+ (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); -+ } -+ } -+ if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_A] != 0) { -+ if (diff_DPK[ODM_RF_PATH_A] >= c.Threshold_DPK) { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK)); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else if ((diff_DPK[ODM_RF_PATH_A] <= -1 * c.Threshold_DPK)) { -+ s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, value); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } -+ } -+ if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_B] != 0) { -+ if (diff_DPK[ODM_RF_PATH_B] >= c.Threshold_DPK) { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK)); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else if ((diff_DPK[ODM_RF_PATH_B] <= -1 * c.Threshold_DPK)) { -+ s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, value); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); -+ } -+ } -+ -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("<===ODM_TXPowerTrackingCallback_ThermalMeter\n")); -+ -+ pRFCalibrateInfo->TXPowercount = 0; -+} -+ -+ -+ -+//3============================================================ -+//3 IQ Calibration -+//3============================================================ -+ -+VOID -+ODM_ResetIQKResult( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ return; -+} -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) -+{ -+ u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = -+ {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; -+ u1Byte place = chnl; -+ -+ -+ if(chnl > 14) -+ { -+ for(place = 14; placeAdapter; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (*pDM_Odm->pIsFcsModeEnable) -+ return; -+#endif -+ -+ if (pDM_Odm->bLinked) { -+ -+ if ((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) { -+ pDM_Odm->preChannel = *pDM_Odm->pChannel; -+ pDM_Odm->LinkedInterval = 0; -+ } -+ -+ if (pDM_Odm->LinkedInterval < 3) -+ pDM_Odm->LinkedInterval++; -+ -+ if (pDM_Odm->LinkedInterval == 2) { -+ PHY_IQCalibrate(Adapter, FALSE); -+ } -+ } else -+ pDM_Odm->LinkedInterval = 0; -+ -+} -+ -+void phydm_rf_init(IN PDM_ODM_T pDM_Odm) -+{ -+ -+ odm_TXPowerTrackingInit(pDM_Odm); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ PHY_IQCalibrate_8814A_Init(pDM_Odm); -+#endif -+#endif -+ -+} -+ -+void phydm_rf_watchdog(IN PDM_ODM_T pDM_Odm) -+{ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ -+ if(!pMgntInfo->IQKBeforeConnection) -+ { -+ ODM_TXPowerTrackingCheck(pDM_Odm); -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ odm_IQCalibrate(pDM_Odm); -+ } -+#endif -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_win.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_win.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/halphyrf_win.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/halphyrf_win.h 2018-02-11 21:44:27.153146177 +0200 -@@ -0,0 +1,120 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ #ifndef __HAL_PHY_RF_H__ -+ #define __HAL_PHY_RF_H__ -+ -+#include "phydm_kfree.h" -+#if (RTL8814A_SUPPORT == 1) -+#include "rtl8814a/phydm_iqk_8814a.h" -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+#include "rtl8822b/phydm_iqk_8822b.h" -+#include "../mac/Halmac_type.h" -+#endif -+#include "phydm_powertracking_win.h" -+ -+#if (RTL8821C_SUPPORT == 1) -+#include "rtl8821c/phydm_iqk_8821c.h" -+#endif -+ -+typedef enum _SPUR_CAL_METHOD { -+ PLL_RESET, -+ AFE_PHASE_SEL -+} SPUR_CAL_METHOD; -+ -+typedef enum _PWRTRACK_CONTROL_METHOD { -+ BBSWING, -+ TXAGC, -+ MIX_MODE, -+ TSSI_MODE, -+ MIX_2G_TSSI_5G_MODE, -+ MIX_5G_TSSI_2G_MODE -+} PWRTRACK_METHOD; -+ -+typedef VOID(*FuncSetPwr)(PVOID, PWRTRACK_METHOD, u1Byte, u1Byte); -+typedef VOID(*FuncIQK)(PVOID, u1Byte, u1Byte, u1Byte); -+typedef VOID(*FuncLCK)(PVOID); -+typedef VOID(*FuncSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+typedef VOID(*FuncSwing8814only)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+typedef VOID (*FuncSwingXtal)(PVOID, ps1Byte*, ps1Byte*); -+typedef VOID (*FuncSetXtal)(PVOID); -+typedef VOID(*FuncAllSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -+ -+typedef struct _TXPWRTRACK_CFG { -+ u1Byte SwingTableSize_CCK; -+ u1Byte SwingTableSize_OFDM; -+ u1Byte Threshold_IQK; -+ u1Byte Threshold_DPK; -+ u1Byte AverageThermalNum; -+ u1Byte RfPathCount; -+ u4Byte ThermalRegAddr; -+ FuncSetPwr ODM_TxPwrTrackSetPwr; -+ FuncIQK DoIQK; -+ FuncLCK PHY_LCCalibrate; -+ FuncSwing GetDeltaSwingTable; -+ FuncSwing8814only GetDeltaSwingTable8814only; -+ FuncSwingXtal GetDeltaSwingXtalTable; -+ FuncSetXtal ODM_TxXtalTrackSetXtal; -+ FuncAllSwing GetDeltaAllSwingTable; -+} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; -+ -+VOID -+ConfigureTxpowerTrack( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PTXPWRTRACK_CFG pConfig -+ ); -+ -+ -+VOID -+ODM_ClearTxPowerTrackingState( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_TXPowerTrackingCallback_ThermalMeter( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER Adapter -+#endif -+ ); -+ -+ -+ -+#define ODM_TARGET_CHNL_NUM_2G_5G 59 -+ -+ -+VOID -+ODM_ResetIQKResult( -+ IN PDM_ODM_T pDM_Odm -+); -+u1Byte -+ODM_GetRightChnlPlaceforIQK( -+ IN u1Byte chnl -+); -+ -+VOID odm_IQCalibrate(IN PDM_ODM_T pDM_Odm); -+VOID phydm_rf_init( IN PDM_ODM_T pDM_Odm); -+VOID phydm_rf_watchdog( IN PDM_ODM_T pDM_Odm); -+ -+#endif // #ifndef __HAL_PHY_RF_H__ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/mp_precomp.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/mp_precomp.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/mp_precomp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/mp_precomp.h 2018-02-11 21:44:27.153146177 +0200 -@@ -0,0 +1,20 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_acs.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_acs.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_acs.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_acs.c 2018-02-11 21:44:27.154146193 +0200 -@@ -0,0 +1,1226 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+ -+u1Byte -+ODM_GetAutoChannelSelectResult( -+ IN PVOID pDM_VOID, -+ IN u1Byte Band -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(Band == ODM_BAND_2_4G) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[ACS] ODM_GetAutoChannelSelectResult(): CleanChannel_2G(%d)\n", pACS->CleanChannel_2G)); -+ return (u1Byte)pACS->CleanChannel_2G; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[ACS] ODM_GetAutoChannelSelectResult(): CleanChannel_5G(%d)\n", pACS->CleanChannel_5G)); -+ return (u1Byte)pACS->CleanChannel_5G; -+ } -+#else -+ return (u1Byte)pACS->CleanChannel_2G; -+#endif -+ -+} -+ -+VOID -+odm_AutoChannelSelectSetting( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN IsEnable -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte period = 0x2710;// 40ms in default -+ u2Byte NHMType = 0x7; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectSetting()=========> \n")); -+ -+ if(IsEnable) -+ {//20 ms -+ period = 0x1388; -+ NHMType = 0x1; -+ } -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ //PHY parameters initialize for ac series -+ ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC+2, period); //0x990[31:16]=0x2710 Time duration for NHM unit: 4us, 0x2710=40ms -+ //ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT8|BIT9|BIT10, NHMType); //0x994[9:8]=3 enable CCX -+ } -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ //PHY parameters initialize for n series -+ ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11N+2, period); //0x894[31:16]=0x2710 Time duration for NHM unit: 4us, 0x2710=40ms -+ //ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10|BIT9|BIT8, NHMType); //0x890[9:8]=3 enable CCX -+ } -+#endif -+} -+ -+VOID -+odm_AutoChannelSelectInit( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ u1Byte i; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) -+ return; -+ -+ if(pACS->bForceACSResult) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectInit()=========> \n")); -+ -+ pACS->CleanChannel_2G = 1; -+ pACS->CleanChannel_5G = 36; -+ -+ for (i = 0; i < ODM_MAX_CHANNEL_2G; ++i) -+ { -+ pACS->Channel_Info_2G[0][i] = 0; -+ pACS->Channel_Info_2G[1][i] = 0; -+ } -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ for (i = 0; i < ODM_MAX_CHANNEL_5G; ++i) -+ { -+ pACS->Channel_Info_5G[0][i] = 0; -+ pACS->Channel_Info_5G[1][i] = 0; -+ } -+ } -+#endif -+} -+ -+VOID -+odm_AutoChannelSelectReset( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) -+ return; -+ -+ if(pACS->bForceACSResult) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectReset()=========> \n")); -+ -+ odm_AutoChannelSelectSetting(pDM_Odm,TRUE);// for 20ms measurement -+ Phydm_NHMCounterStatisticsReset(pDM_Odm); -+#endif -+} -+ -+VOID -+odm_AutoChannelSelect( -+ IN PVOID pDM_VOID, -+ IN u1Byte Channel -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ u1Byte ChannelIDX = 0, SearchIDX = 0; -+ u2Byte MaxScore=0; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Return: SupportAbility ODM_BB_NHM_CNT is disabled\n")); -+ return; -+ } -+ -+ if(pACS->bForceACSResult) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Force 2G clean channel = %d, 5G clean channel = %d\n", -+ pACS->CleanChannel_2G, pACS->CleanChannel_5G)); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Channel = %d=========> \n", Channel)); -+ -+ Phydm_GetNHMCounterStatistics(pDM_Odm); -+ odm_AutoChannelSelectSetting(pDM_Odm,FALSE); -+ -+ if(Channel >=1 && Channel <=14) -+ { -+ ChannelIDX = Channel - 1; -+ pACS->Channel_Info_2G[1][ChannelIDX]++; -+ -+ if(pACS->Channel_Info_2G[1][ChannelIDX] >= 2) -+ pACS->Channel_Info_2G[0][ChannelIDX] = (pACS->Channel_Info_2G[0][ChannelIDX] >> 1) + -+ (pACS->Channel_Info_2G[0][ChannelIDX] >> 2) + (pDM_Odm->NHM_cnt_0>>2); -+ else -+ pACS->Channel_Info_2G[0][ChannelIDX] = pDM_Odm->NHM_cnt_0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): NHM_cnt_0 = %d \n", pDM_Odm->NHM_cnt_0)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Channel_Info[0][%d] = %d, Channel_Info[1][%d] = %d\n", ChannelIDX, pACS->Channel_Info_2G[0][ChannelIDX], ChannelIDX, pACS->Channel_Info_2G[1][ChannelIDX])); -+ -+ for(SearchIDX = 0; SearchIDX < ODM_MAX_CHANNEL_2G; SearchIDX++) -+ { -+ if(pACS->Channel_Info_2G[1][SearchIDX] != 0) -+ { -+ if(pACS->Channel_Info_2G[0][SearchIDX] >= MaxScore) -+ { -+ MaxScore = pACS->Channel_Info_2G[0][SearchIDX]; -+ pACS->CleanChannel_2G = SearchIDX+1; -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("(1)odm_AutoChannelSelect(): 2G: CleanChannel_2G = %d, MaxScore = %d \n", -+ pACS->CleanChannel_2G, MaxScore)); -+ -+ } -+ else if(Channel >= 36) -+ { -+ // Need to do -+ pACS->CleanChannel_5G = Channel; -+ } -+#endif -+} -+ -+#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) -+ -+VOID -+phydm_AutoChannelSelectSettingAP( -+ IN PVOID pDM_VOID, -+ IN u4Byte setting, // 0: STORE_DEFAULT_NHM_SETTING; 1: RESTORE_DEFAULT_NHM_SETTING, 2: ACS_NHM_SETTING -+ IN u4Byte acs_step -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectSettingAP()=========> \n")); -+ -+ //3 Store Default Setting -+ if(setting == STORE_DEFAULT_NHM_SETTING) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("STORE_DEFAULT_NHM_SETTING\n")); -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) // store Reg0x990, Reg0x994, Reg0x998, Reg0x99C, Reg0x9a0 -+ { -+ pACS->Reg0x990 = ODM_Read4Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC); // Reg0x990 -+ pACS->Reg0x994 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC); // Reg0x994 -+ pACS->Reg0x998 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC); // Reg0x998 -+ pACS->Reg0x99C = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC); // Reg0x99c -+ pACS->Reg0x9A0 = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_TH8_11AC); // Reg0x9a0, u1Byte -+ } -+ else if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ pACS->Reg0x890 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N); // Reg0x890 -+ pACS->Reg0x894 = ODM_Read4Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11N); // Reg0x894 -+ pACS->Reg0x898 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N); // Reg0x898 -+ pACS->Reg0x89C = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N); // Reg0x89c -+ pACS->Reg0xE28 = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_TH8_11N); // Reg0xe28, u1Byte -+ } -+ } -+ -+ //3 Restore Default Setting -+ else if(setting == RESTORE_DEFAULT_NHM_SETTING) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("RESTORE_DEFAULT_NHM_SETTING\n")); -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) // store Reg0x990, Reg0x994, Reg0x998, Reg0x99C, Reg0x9a0 -+ { -+ ODM_Write4Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, pACS->Reg0x990); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, pACS->Reg0x994); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, pACS->Reg0x998); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, pACS->Reg0x99C); -+ ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11AC, pACS->Reg0x9A0); -+ } -+ else if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, pACS->Reg0x890); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, pACS->Reg0x894); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, pACS->Reg0x898); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, pACS->Reg0x89C); -+ ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11N, pACS->Reg0xE28); -+ } -+ } -+ -+ //3 ACS Setting -+ else if(setting == ACS_NHM_SETTING) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("ACS_NHM_SETTING\n")); -+ u2Byte period; -+ period = 0x61a8; -+ pACS->ACS_Step = acs_step; -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ //4 Set NHM period, 0x990[31:16]=0x61a8, Time duration for NHM unit: 4us, 0x61a8=100ms -+ ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC+2, period); -+ //4 Set NHM ignore_cca=1, ignore_txon=1, ccx_en=0 -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC,BIT8|BIT9|BIT10, 3); -+ -+ if(pACS->ACS_Step == 0) -+ { -+ //4 Set IGI -+ ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); -+ if (get_rf_mimo_mode(priv) != MIMO_1T1R) -+ ODM_SetBBReg(pDM_Odm,0xe50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); -+ -+ //4 Set ACS NHM threshold -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0x82786e64); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffff8c); -+ ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11AC, 0xff); -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC+2, 0xffff); -+ -+ } -+ else if(pACS->ACS_Step == 1) -+ { -+ //4 Set IGI -+ ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); -+ if (get_rf_mimo_mode(priv) != MIMO_1T1R) -+ ODM_SetBBReg(pDM_Odm,0xe50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); -+ -+ //4 Set ACS NHM threshold -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0x5a50463c); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffff64); -+ -+ } -+ -+ } -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ //4 Set NHM period, 0x894[31:16]=0x61a8, Time duration for NHM unit: 4us, 0x61a8=100ms -+ ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC+2, period); -+ //4 Set NHM ignore_cca=1, ignore_txon=1, ccx_en=0 -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N,BIT8|BIT9|BIT10, 3); -+ -+ if(pACS->ACS_Step == 0) -+ { -+ //4 Set IGI -+ ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); -+ if (get_rf_mimo_mode(priv) != MIMO_1T1R) -+ ODM_SetBBReg(pDM_Odm,0xc58,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); -+ -+ //4 Set ACS NHM threshold -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0x82786e64); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffff8c); -+ ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11N, 0xff); -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N+2, 0xffff); -+ -+ } -+ else if(pACS->ACS_Step == 1) -+ { -+ //4 Set IGI -+ ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); -+ if (get_rf_mimo_mode(priv) != MIMO_1T1R) -+ ODM_SetBBReg(pDM_Odm,0xc58,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); -+ -+ //4 Set ACS NHM threshold -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0x5a50463c); -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffff64); -+ -+ } -+ } -+ } -+ -+} -+ -+VOID -+phydm_GetNHMStatisticsAP( -+ IN PVOID pDM_VOID, -+ IN u4Byte idx, // @ 2G, Real channel number = idx+1 -+ IN u4Byte acs_step -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ u4Byte value32 = 0; -+ u1Byte i; -+ -+ pACS->ACS_Step = acs_step; -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ //4 Check if NHM result is ready -+ for (i=0; i<20; i++) { -+ -+ ODM_delay_ms(1); -+ if ( ODM_GetBBReg(pDM_Odm,rFPGA0_PSDReport,BIT17) ) -+ break; -+ } -+ -+ //4 Get NHM Statistics -+ if ( pACS->ACS_Step==1 ) { -+ -+ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT7_TO_CNT4_11N); -+ -+ pACS->NHM_Cnt[idx][9] = (value32 & bMaskByte1) >> 8; -+ pACS->NHM_Cnt[idx][8] = (value32 & bMaskByte0); -+ -+ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11N); // ODM_REG_NHM_CNT3_TO_CNT0_11N -+ -+ pACS->NHM_Cnt[idx][7] = (value32 & bMaskByte3) >> 24; -+ pACS->NHM_Cnt[idx][6] = (value32 & bMaskByte2) >> 16; -+ pACS->NHM_Cnt[idx][5] = (value32 & bMaskByte1) >> 8; -+ -+ } else if (pACS->ACS_Step==2) { -+ -+ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11N); // ODM_REG_NHM_CNT3_TO_CNT0_11N -+ -+ pACS->NHM_Cnt[idx][4] = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11N); -+ pACS->NHM_Cnt[idx][3] = (value32 & bMaskByte3) >> 24; -+ pACS->NHM_Cnt[idx][2] = (value32 & bMaskByte2) >> 16; -+ pACS->NHM_Cnt[idx][1] = (value32 & bMaskByte1) >> 8; -+ pACS->NHM_Cnt[idx][0] = (value32 & bMaskByte0); -+ } -+ } -+ else if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ //4 Check if NHM result is ready -+ for (i=0; i<20; i++) { -+ -+ ODM_delay_ms(1); -+ if (ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_DUR_READY_11AC, BIT16)) -+ break; -+ } -+ -+ if ( pACS->ACS_Step==1 ) { -+ -+ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT7_TO_CNT4_11AC); -+ -+ pACS->NHM_Cnt[idx][9] = (value32 & bMaskByte1) >> 8; -+ pACS->NHM_Cnt[idx][8] = (value32 & bMaskByte0); -+ -+ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11AC); // ODM_REG_NHM_CNT3_TO_CNT0_11AC -+ -+ pACS->NHM_Cnt[idx][7] = (value32 & bMaskByte3) >> 24; -+ pACS->NHM_Cnt[idx][6] = (value32 & bMaskByte2) >> 16; -+ pACS->NHM_Cnt[idx][5] = (value32 & bMaskByte1) >> 8; -+ -+ } else if (pACS->ACS_Step==2) { -+ -+ value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11AC); // ODM_REG_NHM_CNT3_TO_CNT0_11AC -+ -+ pACS->NHM_Cnt[idx][4] = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11AC); -+ pACS->NHM_Cnt[idx][3] = (value32 & bMaskByte3) >> 24; -+ pACS->NHM_Cnt[idx][2] = (value32 & bMaskByte2) >> 16; -+ pACS->NHM_Cnt[idx][1] = (value32 & bMaskByte1) >> 8; -+ pACS->NHM_Cnt[idx][0] = (value32 & bMaskByte0); -+ } -+ } -+ -+} -+ -+ -+//#define ACS_DEBUG_INFO //acs debug default off -+/* -+int phydm_AutoChannelSelectAP( -+ IN PVOID pDM_VOID, -+ IN u4Byte ACS_Type, // 0: RXCount_Type, 1:NHM_Type -+ IN u4Byte available_chnl_num // amount of all channels -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PACS pACS = &pDM_Odm->DM_ACS; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ static u4Byte score2G[MAX_2G_CHANNEL_NUM], score5G[MAX_5G_CHANNEL_NUM]; -+ u4Byte score[MAX_BSS_NUM], use_nhm = 0; -+ u4Byte minScore=0xffffffff; -+ u4Byte tmpScore, tmpIdx=0; -+ u4Byte traffic_check = 0; -+ u4Byte fa_count_weighting = 1; -+ int i, j, idx=0, idx_2G_end=-1, idx_5G_begin=-1, minChan=0; -+ struct bss_desc *pBss=NULL; -+ -+#ifdef _DEBUG_RTL8192CD_ -+ char tmpbuf[400]; -+ int len=0; -+#endif -+ -+ memset(score2G, '\0', sizeof(score2G)); -+ memset(score5G, '\0', sizeof(score5G)); -+ -+ for (i=0; iavailable_chnl_num; i++) { -+ if (priv->available_chnl[i] <= 14) -+ idx_2G_end = i; -+ else -+ break; -+ } -+ -+ for (i=0; iavailable_chnl_num; i++) { -+ if (priv->available_chnl[i] > 14) { -+ idx_5G_begin = i; -+ break; -+ } -+ } -+ -+// DELETE -+#ifndef CONFIG_RTL_NEW_AUTOCH -+ for (i=0; isite_survey->count; i++) { -+ pBss = &priv->site_survey->bss[i]; -+ for (idx=0; idxavailable_chnl_num; idx++) { -+ if (pBss->channel == priv->available_chnl[idx]) { -+ if (pBss->channel <= 14) -+ setChannelScore(idx, score2G, 0, MAX_2G_CHANNEL_NUM-1); -+ else -+ score5G[idx - idx_5G_begin] += 5; -+ break; -+ } -+ } -+ } -+#endif -+ -+ if (idx_2G_end >= 0) -+ for (i=0; i<=idx_2G_end; i++) -+ score[i] = score2G[i]; -+ if (idx_5G_begin >= 0) -+ for (i=idx_5G_begin; iavailable_chnl_num; i++) -+ score[i] = score5G[i - idx_5G_begin]; -+ -+#ifdef CONFIG_RTL_NEW_AUTOCH -+ { -+ u4Byte y, ch_begin=0, ch_end= priv->available_chnl_num; -+ -+ u4Byte do_ap_check = 1, ap_ratio = 0; -+ -+ if (idx_2G_end >= 0) -+ ch_end = idx_2G_end+1; -+ if (idx_5G_begin >= 0) -+ ch_begin = idx_5G_begin; -+ -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("\n"); -+ for (y=ch_begin; yavailable_chnl[y], -+ priv->chnl_ss_mac_rx_count[y], -+ priv->chnl_ss_mac_rx_count_40M[y], -+ priv->chnl_ss_fa_count[y], -+ score[y]); -+ printk("\n"); -+#endif -+ -+#if defined(CONFIG_RTL_88E_SUPPORT) || defined(CONFIG_WLAN_HAL_8192EE) -+ if( pDM_Odm->SupportICType&(ODM_RTL8188E|ODM_RTL8192E)&& priv->pmib->dot11RFEntry.acs_type ) -+ { -+ u4Byte tmp_score[MAX_BSS_NUM]; -+ memcpy(tmp_score, score, sizeof(score)); -+ if (find_clean_channel(priv, ch_begin, ch_end, tmp_score)) { -+ //memcpy(score, tmp_score, sizeof(score)); -+#ifdef _DEBUG_RTL8192CD_ -+ printk("!! Found clean channel, select minimum FA channel\n"); -+#endif -+ goto USE_CLN_CH; -+ } -+#ifdef _DEBUG_RTL8192CD_ -+ printk("!! Not found clean channel, use NHM algorithm\n"); -+#endif -+ use_nhm = 1; -+USE_CLN_CH: -+ for (y=ch_begin; ynhm_cnt[y][i]; -+ for (j=0; jL, score: %d\n", -+ y+1, priv->nhm_cnt[y][9], priv->nhm_cnt[y][8], priv->nhm_cnt[y][7], -+ priv->nhm_cnt[y][6], priv->nhm_cnt[y][5], priv->nhm_cnt[y][4], -+ priv->nhm_cnt[y][3], priv->nhm_cnt[y][2], priv->nhm_cnt[y][1], -+ priv->nhm_cnt[y][0], score[y]); -+#endif -+ } -+ -+ if (!use_nhm) -+ memcpy(score, tmp_score, sizeof(score)); -+ -+ goto choose_ch; -+ } -+#endif -+ -+ // For each channel, weighting behind channels with MAC RX counter -+ //For each channel, weighting the channel with FA counter -+ -+ for (y=ch_begin; ychnl_ss_mac_rx_count[y]; -+ if (priv->chnl_ss_mac_rx_count[y] > 30) -+ do_ap_check = 0; -+ if( priv->chnl_ss_mac_rx_count[y] > MAC_RX_COUNT_THRESHOLD ) -+ traffic_check = 1; -+ -+#ifdef RTK_5G_SUPPORT -+ if (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G) -+#endif -+ { -+ if ((int)(y-4) >= (int)ch_begin) -+ score[y-4] += 2 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y-3) >= (int)ch_begin) -+ score[y-3] += 8 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y-2) >= (int)ch_begin) -+ score[y-2] += 8 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y-1) >= (int)ch_begin) -+ score[y-1] += 10 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y+1) < (int)ch_end) -+ score[y+1] += 10 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y+2) < (int)ch_end) -+ score[y+2] += 8 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y+3) < (int)ch_end) -+ score[y+3] += 8 * priv->chnl_ss_mac_rx_count[y]; -+ if ((int)(y+4) < (int)ch_end) -+ score[y+4] += 2 * priv->chnl_ss_mac_rx_count[y]; -+ } -+ -+ //this is for CH_LOAD caculation -+ if( priv->chnl_ss_cca_count[y] > priv->chnl_ss_fa_count[y]) -+ priv->chnl_ss_cca_count[y]-= priv->chnl_ss_fa_count[y]; -+ else -+ priv->chnl_ss_cca_count[y] = 0; -+ } -+ -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("\n"); -+ for (y=ch_begin; yavailable_chnl[y], score[y]); -+ printk("\n"); -+#endif -+ -+ for (y=ch_begin; ychnl_ss_mac_rx_count_40M[y]) { -+ score[y] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if (priv->chnl_ss_mac_rx_count_40M[y] > 30) -+ do_ap_check = 0; -+ if( priv->chnl_ss_mac_rx_count_40M[y] > MAC_RX_COUNT_THRESHOLD ) -+ traffic_check = 1; -+ -+#ifdef RTK_5G_SUPPORT -+ if (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G) -+#endif -+ { -+ if ((int)(y-6) >= (int)ch_begin) -+ score[y-6] += 1 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y-5) >= (int)ch_begin) -+ score[y-5] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y-4) >= (int)ch_begin) -+ score[y-4] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y-3) >= (int)ch_begin) -+ score[y-3] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y-2) >= (int)ch_begin) -+ score[y-2] += (5 * priv->chnl_ss_mac_rx_count_40M[y])/2; -+ if ((int)(y-1) >= (int)ch_begin) -+ score[y-1] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y+1) < (int)ch_end) -+ score[y+1] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y+2) < (int)ch_end) -+ score[y+2] += (5 * priv->chnl_ss_mac_rx_count_40M[y])/2; -+ if ((int)(y+3) < (int)ch_end) -+ score[y+3] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y+4) < (int)ch_end) -+ score[y+4] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y+5) < (int)ch_end) -+ score[y+5] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; -+ if ((int)(y+6) < (int)ch_end) -+ score[y+6] += 1 * priv->chnl_ss_mac_rx_count_40M[y]; -+ } -+ } -+ } -+ -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("\n"); -+ for (y=ch_begin; yavailable_chnl[y], score[y]); -+ printk("\n"); -+ printk("4. do_ap_check=%d traffic_check=%d\n", do_ap_check, traffic_check); -+ printk("\n"); -+#endif -+ -+ if( traffic_check == 0) -+ fa_count_weighting = 5; -+ else -+ fa_count_weighting = 1; -+ -+ for (y=ch_begin; ychnl_ss_fa_count[y]; -+ } -+ -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("\n"); -+ for (y=ch_begin; yavailable_chnl[y], score[y]); -+ printk("\n"); -+#endif -+ -+ if (do_ap_check) { -+ for (i=0; isite_survey->count; i++) { -+ pBss = &priv->site_survey->bss[i]; -+ for (y=ch_begin; ychannel == priv->available_chnl[y]) { -+ if (pBss->channel <= 14) { -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("\n"); -+ printk("chnl[%d] has ap rssi=%d bw[0x%02x]\n", -+ pBss->channel, pBss->rssi, pBss->t_stamp[1]); -+ printk("\n"); -+#endif -+ if (pBss->rssi > 60) -+ ap_ratio = 4; -+ else if (pBss->rssi > 35) -+ ap_ratio = 2; -+ else -+ ap_ratio = 1; -+ -+ if ((pBss->t_stamp[1] & 0x6) == 0) { -+ score[y] += 50 * ap_ratio; -+ if ((int)(y-4) >= (int)ch_begin) -+ score[y-4] += 10 * ap_ratio; -+ if ((int)(y-3) >= (int)ch_begin) -+ score[y-3] += 20 * ap_ratio; -+ if ((int)(y-2) >= (int)ch_begin) -+ score[y-2] += 30 * ap_ratio; -+ if ((int)(y-1) >= (int)ch_begin) -+ score[y-1] += 40 * ap_ratio; -+ if ((int)(y+1) < (int)ch_end) -+ score[y+1] += 40 * ap_ratio; -+ if ((int)(y+2) < (int)ch_end) -+ score[y+2] += 30 * ap_ratio; -+ if ((int)(y+3) < (int)ch_end) -+ score[y+3] += 20 * ap_ratio; -+ if ((int)(y+4) < (int)ch_end) -+ score[y+4] += 10 * ap_ratio; -+ } -+ else if ((pBss->t_stamp[1] & 0x4) == 0) { -+ score[y] += 50 * ap_ratio; -+ if ((int)(y-3) >= (int)ch_begin) -+ score[y-3] += 20 * ap_ratio; -+ if ((int)(y-2) >= (int)ch_begin) -+ score[y-2] += 30 * ap_ratio; -+ if ((int)(y-1) >= (int)ch_begin) -+ score[y-1] += 40 * ap_ratio; -+ if ((int)(y+1) < (int)ch_end) -+ score[y+1] += 50 * ap_ratio; -+ if ((int)(y+2) < (int)ch_end) -+ score[y+2] += 50 * ap_ratio; -+ if ((int)(y+3) < (int)ch_end) -+ score[y+3] += 50 * ap_ratio; -+ if ((int)(y+4) < (int)ch_end) -+ score[y+4] += 50 * ap_ratio; -+ if ((int)(y+5) < (int)ch_end) -+ score[y+5] += 40 * ap_ratio; -+ if ((int)(y+6) < (int)ch_end) -+ score[y+6] += 30 * ap_ratio; -+ if ((int)(y+7) < (int)ch_end) -+ score[y+7] += 20 * ap_ratio; -+ } -+ else { -+ score[y] += 50 * ap_ratio; -+ if ((int)(y-7) >= (int)ch_begin) -+ score[y-7] += 20 * ap_ratio; -+ if ((int)(y-6) >= (int)ch_begin) -+ score[y-6] += 30 * ap_ratio; -+ if ((int)(y-5) >= (int)ch_begin) -+ score[y-5] += 40 * ap_ratio; -+ if ((int)(y-4) >= (int)ch_begin) -+ score[y-4] += 50 * ap_ratio; -+ if ((int)(y-3) >= (int)ch_begin) -+ score[y-3] += 50 * ap_ratio; -+ if ((int)(y-2) >= (int)ch_begin) -+ score[y-2] += 50 * ap_ratio; -+ if ((int)(y-1) >= (int)ch_begin) -+ score[y-1] += 50 * ap_ratio; -+ if ((int)(y+1) < (int)ch_end) -+ score[y+1] += 40 * ap_ratio; -+ if ((int)(y+2) < (int)ch_end) -+ score[y+2] += 30 * ap_ratio; -+ if ((int)(y+3) < (int)ch_end) -+ score[y+3] += 20 * ap_ratio; -+ } -+ } -+ else { -+ if ((pBss->t_stamp[1] & 0x6) == 0) { -+ score[y] += 500; -+ } -+ else if ((pBss->t_stamp[1] & 0x4) == 0) { -+ score[y] += 500; -+ if ((int)(y+1) < (int)ch_end) -+ score[y+1] += 500; -+ } -+ else { -+ score[y] += 500; -+ if ((int)(y-1) >= (int)ch_begin) -+ score[y-1] += 500; -+ } -+ } -+ break; -+ } -+ } -+ } -+ } -+ -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("\n"); -+ for (y=ch_begin; yavailable_chnl[y],score[y]); -+ printk("\n"); -+#endif -+ -+#ifdef SS_CH_LOAD_PROC -+ -+ // caculate noise level -- suggested by wilson -+ for (y=ch_begin; ychnl_ss_fa_count[y]>1000) { -+ fa_lv = 100; -+ } else if (priv->chnl_ss_fa_count[y]>500) { -+ fa_lv = 34 * (priv->chnl_ss_fa_count[y]-500) / 500 + 66; -+ } else if (priv->chnl_ss_fa_count[y]>200) { -+ fa_lv = 33 * (priv->chnl_ss_fa_count[y] - 200) / 300 + 33; -+ } else if (priv->chnl_ss_fa_count[y]>100) { -+ fa_lv = 18 * (priv->chnl_ss_fa_count[y] - 100) / 100 + 15; -+ } else { -+ fa_lv = 15 * priv->chnl_ss_fa_count[y] / 100; -+ } -+ if (priv->chnl_ss_cca_count[y]>400) { -+ cca_lv = 100; -+ } else if (priv->chnl_ss_cca_count[y]>200) { -+ cca_lv = 34 * (priv->chnl_ss_cca_count[y] - 200) / 200 + 66; -+ } else if (priv->chnl_ss_cca_count[y]>80) { -+ cca_lv = 33 * (priv->chnl_ss_cca_count[y] - 80) / 120 + 33; -+ } else if (priv->chnl_ss_cca_count[y]>40) { -+ cca_lv = 18 * (priv->chnl_ss_cca_count[y] - 40) / 40 + 15; -+ } else { -+ cca_lv = 15 * priv->chnl_ss_cca_count[y] / 40; -+ } -+ -+ priv->chnl_ss_load[y] = (((fa_lv > cca_lv)? fa_lv : cca_lv)*75+((score[y]>100)?100:score[y])*25)/100; -+ -+ DEBUG_INFO("ch:%d f=%d (%d), c=%d (%d), fl=%d, cl=%d, sc=%d, cu=%d\n", -+ priv->available_chnl[y], -+ priv->chnl_ss_fa_count[y], fa_thd, -+ priv->chnl_ss_cca_count[y], cca_thd, -+ fa_lv, -+ cca_lv, -+ score[y], -+ priv->chnl_ss_load[y]); -+ -+ } -+#endif -+ } -+#endif -+ -+choose_ch: -+ -+#ifdef DFS -+ // heavy weighted DFS channel -+ if (idx_5G_begin >= 0){ -+ for (i=idx_5G_begin; iavailable_chnl_num; i++) { -+ if (!priv->pmib->dot11DFSEntry.disable_DFS && is_DFS_channel(priv->available_chnl[i]) -+ && (score[i]!= 0xffffffff)){ -+ score[i] += 1600; -+ } -+ } -+ } -+#endif -+ -+ -+//prevent Auto Channel selecting wrong channel in 40M mode----------------- -+ if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) -+ && priv->pshare->is_40m_bw) { -+#if 0 -+ if (GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset == 1) { -+ //Upper Primary Channel, cannot select the two lowest channels -+ if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) { -+ score[0] = 0xffffffff; -+ score[1] = 0xffffffff; -+ score[2] = 0xffffffff; -+ score[3] = 0xffffffff; -+ score[4] = 0xffffffff; -+ -+ score[13] = 0xffffffff; -+ score[12] = 0xffffffff; -+ score[11] = 0xffffffff; -+ } -+ -+// if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11A) { -+// score[idx_5G_begin] = 0xffffffff; -+// score[idx_5G_begin + 1] = 0xffffffff; -+// } -+ } -+ else if (GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset == 2) { -+ //Lower Primary Channel, cannot select the two highest channels -+ if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) { -+ score[0] = 0xffffffff; -+ score[1] = 0xffffffff; -+ score[2] = 0xffffffff; -+ -+ score[13] = 0xffffffff; -+ score[12] = 0xffffffff; -+ score[11] = 0xffffffff; -+ score[10] = 0xffffffff; -+ score[9] = 0xffffffff; -+ } -+ -+// if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11A) { -+// score[priv->available_chnl_num - 2] = 0xffffffff; -+// score[priv->available_chnl_num - 1] = 0xffffffff; -+// } -+ } -+#endif -+ for (i=0; i<=idx_2G_end; ++i) -+ if (priv->available_chnl[i] == 14) -+ score[i] = 0xffffffff; // mask chan14 -+ -+#ifdef RTK_5G_SUPPORT -+ if (idx_5G_begin >= 0) { -+ for (i=idx_5G_begin; iavailable_chnl_num; i++) { -+ int ch = priv->available_chnl[i]; -+ if(priv->available_chnl[i] > 144) -+ --ch; -+ if((ch%4) || ch==140 || ch == 164 ) //mask ch 140, ch 165, ch 184... -+ score[i] = 0xffffffff; -+ } -+ } -+#endif -+ -+ -+ } -+ -+ if (priv->pmib->dot11RFEntry.disable_ch1213) { -+ for (i=0; i<=idx_2G_end; ++i) { -+ int ch = priv->available_chnl[i]; -+ if ((ch == 12) || (ch == 13)) -+ score[i] = 0xffffffff; -+ } -+ } -+ -+ if (((priv->pmib->dot11StationConfigEntry.dot11RegDomain == DOMAIN_GLOBAL) || -+ (priv->pmib->dot11StationConfigEntry.dot11RegDomain == DOMAIN_WORLD_WIDE)) && -+ (idx_2G_end >= 11) && (idx_2G_end < 14)) { -+ score[13] = 0xffffffff; // mask chan14 -+ score[12] = 0xffffffff; // mask chan13 -+ score[11] = 0xffffffff; // mask chan12 -+ } -+ -+//------------------------------------------------------------------ -+ -+#ifdef _DEBUG_RTL8192CD_ -+ for (i=0; iavailable_chnl_num; i++) { -+ len += sprintf(tmpbuf+len, "ch%d:%u ", priv->available_chnl[i], score[i]); -+ } -+ strcat(tmpbuf, "\n"); -+ panic_printk("%s", tmpbuf); -+ -+#endif -+ -+ if ( (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) -+ && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80)) -+ { -+ for (i=0; iavailable_chnl_num; i++) { -+ if (is80MChannel(priv->available_chnl, priv->available_chnl_num, priv->available_chnl[i])) { -+ tmpScore = 0; -+ for (j=0; j<4; j++) { -+ if ((tmpScore != 0xffffffff) && (score[i+j] != 0xffffffff)) -+ tmpScore += score[i+j]; -+ else -+ tmpScore = 0xffffffff; -+ } -+ tmpScore = tmpScore / 4; -+ if (minScore > tmpScore) { -+ minScore = tmpScore; -+ -+ tmpScore = 0xffffffff; -+ for (j=0; j<4; j++) { -+ if (score[i+j] < tmpScore) { -+ tmpScore = score[i+j]; -+ tmpIdx = i+j; -+ } -+ } -+ -+ idx = tmpIdx; -+ } -+ i += 3; -+ } -+ } -+ if (minScore == 0xffffffff) { -+ // there is no 80M channels -+ priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20; -+ for (i=0; iavailable_chnl_num; i++) { -+ if (score[i] < minScore) { -+ minScore = score[i]; -+ idx = i; -+ } -+ } -+ } -+ } -+ else if( (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) -+ && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_40)) -+ { -+ for (i=0; iavailable_chnl_num; i++) { -+ if(is40MChannel(priv->available_chnl,priv->available_chnl_num,priv->available_chnl[i])) { -+ tmpScore = 0; -+ for(j=0;j<2;j++) { -+ if ((tmpScore != 0xffffffff) && (score[i+j] != 0xffffffff)) -+ tmpScore += score[i+j]; -+ else -+ tmpScore = 0xffffffff; -+ } -+ tmpScore = tmpScore / 2; -+ if(minScore > tmpScore) { -+ minScore = tmpScore; -+ -+ tmpScore = 0xffffffff; -+ for (j=0; j<2; j++) { -+ if (score[i+j] < tmpScore) { -+ tmpScore = score[i+j]; -+ tmpIdx = i+j; -+ } -+ } -+ -+ idx = tmpIdx; -+ } -+ i += 1; -+ } -+ } -+ if (minScore == 0xffffffff) { -+ // there is no 40M channels -+ priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20; -+ for (i=0; iavailable_chnl_num; i++) { -+ if (score[i] < minScore) { -+ minScore = score[i]; -+ idx = i; -+ } -+ } -+ } -+ } -+ else if( (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G) -+ && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_40) -+ && (priv->available_chnl_num >= 8) ) -+ { -+ u4Byte groupScore[14]; -+ -+ memset(groupScore, 0xff , sizeof(groupScore)); -+ for (i=0; iavailable_chnl_num-4; i++) { -+ if (score[i] != 0xffffffff && score[i+4] != 0xffffffff) { -+ groupScore[i] = score[i] + score[i+4]; -+ DEBUG_INFO("groupScore, ch %d,%d: %d\n", i+1, i+5, groupScore[i]); -+ if (groupScore[i] < minScore) { -+#ifdef AUTOCH_SS_SPEEDUP -+ if(priv->pmib->miscEntry.autoch_1611_enable) -+ { -+ if(priv->available_chnl[i]==1 || priv->available_chnl[i]==6 || priv->available_chnl[i]==11) -+ { -+ minScore = groupScore[i]; -+ idx = i; -+ } -+ } -+ else -+#endif -+ { -+ minScore = groupScore[i]; -+ idx = i; -+ } -+ } -+ } -+ } -+ -+ if (score[idx] < score[idx+4]) { -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; -+ } else { -+ idx = idx + 4; -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; -+ } -+ } -+ else -+ { -+ for (i=0; iavailable_chnl_num; i++) { -+ if (score[i] < minScore) { -+#ifdef AUTOCH_SS_SPEEDUP -+ if(priv->pmib->miscEntry.autoch_1611_enable) -+ { -+ if(priv->available_chnl[i]==1 || priv->available_chnl[i]==6 || priv->available_chnl[i]==11) -+ { -+ minScore = score[i]; -+ idx = i; -+ } -+ } -+ else -+#endif -+ { -+ minScore = score[i]; -+ idx = i; -+ } -+ } -+ } -+ } -+ -+ if (IS_A_CUT_8881A(priv) && -+ (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80)) { -+ if ((priv->available_chnl[idx] == 36) || -+ (priv->available_chnl[idx] == 52) || -+ (priv->available_chnl[idx] == 100) || -+ (priv->available_chnl[idx] == 116) || -+ (priv->available_chnl[idx] == 132) || -+ (priv->available_chnl[idx] == 149) || -+ (priv->available_chnl[idx] == 165)) -+ idx++; -+ else if ((priv->available_chnl[idx] == 48) || -+ (priv->available_chnl[idx] == 64) || -+ (priv->available_chnl[idx] == 112) || -+ (priv->available_chnl[idx] == 128) || -+ (priv->available_chnl[idx] == 144) || -+ (priv->available_chnl[idx] == 161) || -+ (priv->available_chnl[idx] == 177)) -+ idx--; -+ } -+ -+ minChan = priv->available_chnl[idx]; -+ -+ // skip channel 14 if don't support ofdm -+ if ((priv->pmib->dot11RFEntry.disable_ch14_ofdm) && -+ (minChan == 14)) { -+ score[idx] = 0xffffffff; -+ -+ minScore = 0xffffffff; -+ for (i=0; iavailable_chnl_num; i++) { -+ if (score[i] < minScore) { -+ minScore = score[i]; -+ idx = i; -+ } -+ } -+ minChan = priv->available_chnl[idx]; -+ } -+ -+#if 0 -+ //Check if selected channel available for 80M/40M BW or NOT ? -+ if(priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) -+ { -+ if(priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80) -+ { -+ if(!is80MChannel(priv->available_chnl,priv->available_chnl_num,minChan)) -+ { -+ //printk("BW=80M, selected channel = %d is unavaliable! reduce to 40M\n", minChan); -+ //priv->pmib->dot11nConfigEntry.dot11nUse40M = HT_CHANNEL_WIDTH_20_40; -+ priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20_40; -+ } -+ } -+ -+ if(priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_40) -+ { -+ if(!is40MChannel(priv->available_chnl,priv->available_chnl_num,minChan)) -+ { -+ //printk("BW=40M, selected channel = %d is unavaliable! reduce to 20M\n", minChan); -+ //priv->pmib->dot11nConfigEntry.dot11nUse40M = HT_CHANNEL_WIDTH_20; -+ priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20; -+ } -+ } -+ } -+#endif -+ -+#ifdef CONFIG_RTL_NEW_AUTOCH -+ RTL_W32(RXERR_RPT, RXERR_RPT_RST); -+#endif -+ -+// auto adjust contro-sideband -+ if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) -+ && (priv->pshare->is_40m_bw ==1 || priv->pshare->is_40m_bw ==2)) { -+ -+#ifdef RTK_5G_SUPPORT -+ if (priv->pmib->dot11RFEntry.phyBandSelect & PHY_BAND_5G) { -+ if( (minChan>144) ? ((minChan-1)%8) : (minChan%8)) { -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; -+ } else { -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; -+ } -+ -+ } else -+#endif -+ { -+#if 0 -+#ifdef CONFIG_RTL_NEW_AUTOCH -+ unsigned int ch_max; -+ -+ if (priv->available_chnl[idx_2G_end] >= 13) -+ ch_max = 13; -+ else -+ ch_max = priv->available_chnl[idx_2G_end]; -+ -+ if ((minChan >= 5) && (minChan <= (ch_max-5))) { -+ if (score[minChan+4] > score[minChan-4]) { // what if some channels were cancelled? -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; -+ } else { -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; -+ } -+ } else -+#endif -+ { -+ if (minChan < 5) { -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; -+ } -+ else if (minChan > 7) { -+ GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; -+ priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; -+ } -+ } -+#endif -+ } -+ } -+//----------------------- -+ -+#if defined(__ECOS) && defined(CONFIG_SDIO_HCI) -+ panic_printk("Auto channel choose ch:%d\n", minChan); -+#else -+#ifdef _DEBUG_RTL8192CD_ -+ panic_printk("Auto channel choose ch:%d\n", minChan); -+#endif -+#endif -+#ifdef ACS_DEBUG_INFO//for debug -+ printk("7. minChan:%d 2nd_offset:%d\n", minChan, priv->pshare->offset_2nd_chan); -+#endif -+ -+ return minChan; -+} -+*/ -+ -+#endif -+ -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_acs.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_acs.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_acs.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_acs.h 2018-02-11 21:44:27.154146193 +0200 -@@ -0,0 +1,106 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMACS_H__ -+#define __PHYDMACS_H__ -+ -+#define ACS_VERSION "1.1" /*20150729 by YuChen*/ -+#define CLM_VERSION "1.0" -+ -+#define ODM_MAX_CHANNEL_2G 14 -+#define ODM_MAX_CHANNEL_5G 24 -+ -+// For phydm_AutoChannelSelectSettingAP() -+#define STORE_DEFAULT_NHM_SETTING 0 -+#define RESTORE_DEFAULT_NHM_SETTING 1 -+#define ACS_NHM_SETTING 2 -+ -+typedef struct _ACS_ -+{ -+ BOOLEAN bForceACSResult; -+ u1Byte CleanChannel_2G; -+ u1Byte CleanChannel_5G; -+ u2Byte Channel_Info_2G[2][ODM_MAX_CHANNEL_2G]; //Channel_Info[1]: Channel Score, Channel_Info[2]:Channel_Scan_Times -+ u2Byte Channel_Info_5G[2][ODM_MAX_CHANNEL_5G]; -+ -+#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) -+ u1Byte ACS_Step; -+ // NHM Count 0-11 -+ u1Byte NHM_Cnt[14][11]; -+ -+ // AC-Series, for storing previous setting -+ u4Byte Reg0x990; -+ u4Byte Reg0x994; -+ u4Byte Reg0x998; -+ u4Byte Reg0x99C; -+ u1Byte Reg0x9A0; // u1Byte -+ -+ // N-Series, for storing previous setting -+ u4Byte Reg0x890; -+ u4Byte Reg0x894; -+ u4Byte Reg0x898; -+ u4Byte Reg0x89C; -+ u1Byte Reg0xE28; // u1Byte -+#endif -+ -+}ACS, *PACS; -+ -+ -+VOID -+odm_AutoChannelSelectInit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_AutoChannelSelectReset( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_AutoChannelSelect( -+ IN PVOID pDM_VOID, -+ IN u1Byte Channel -+); -+ -+u1Byte -+ODM_GetAutoChannelSelectResult( -+ IN PVOID pDM_VOID, -+ IN u1Byte Band -+); -+ -+#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) -+ -+VOID -+phydm_AutoChannelSelectSettingAP( -+ IN PVOID pDM_VOID, -+ IN u4Byte Setting, // 0: STORE_DEFAULT_NHM_SETTING; 1: RESTORE_DEFAULT_NHM_SETTING, 2: ACS_NHM_SETTING -+ IN u4Byte acs_step -+); -+ -+VOID -+phydm_GetNHMStatisticsAP( -+ IN PVOID pDM_VOID, -+ IN u4Byte idx, // @ 2G, Real channel number = idx+1 -+ IN u4Byte acs_step -+); -+ -+#endif //#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) -+ -+#endif //#ifndef __PHYDMACS_H__ -\ Ingen nyrad vid filslut -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.c 2018-02-11 21:44:27.154146193 +0200 -@@ -0,0 +1,1101 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if WPP_SOFTWARE_TRACE -+#include "PhyDM_Adaptivity.tmh" -+#endif -+#endif -+ -+ -+VOID -+Phydm_CheckAdaptivity( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ -+ if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) { -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (pDM_Odm->APTotalNum > Adaptivity->APNumTH) { -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("AP total num > %d!!, disable adaptivity\n", Adaptivity->APNumTH)); -+ } else -+#endif -+ { -+ if (Adaptivity->DynamicLinkAdaptivity || Adaptivity->AcsForAdaptivity) { -+ if (pDM_Odm->bLinked && Adaptivity->bCheck == FALSE) { -+ Phydm_NHMCounterStatistics(pDM_Odm); -+ Phydm_CheckEnvironment(pDM_Odm); -+ } else if (!pDM_Odm->bLinked) -+ Adaptivity->bCheck = FALSE; -+ } else { -+ pDM_Odm->Adaptivity_enable = TRUE; -+ -+ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) -+ pDM_Odm->adaptivity_flag = FALSE; -+ else -+ pDM_Odm->adaptivity_flag = TRUE; -+ } -+ } -+ } else { -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ } -+ -+ -+ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+BOOLEAN -+Phydm_CheckChannelPlan( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ -+ if (pMgntInfo->RegEnableAdaptivity == 2) { -+ if (pDM_Odm->Carrier_Sense_enable == FALSE) { /*check domain Code for Adaptivity or CarrierSense*/ -+ if ((*pDM_Odm->pBandType == ODM_BAND_5G) && -+ !(pDM_Odm->odm_Regulation5G == REGULATION_ETSI || pDM_Odm->odm_Regulation5G == REGULATION_WW)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity skip 5G domain code : %d\n", pDM_Odm->odm_Regulation5G)); -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ return TRUE; -+ } else if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) && -+ !(pDM_Odm->odm_Regulation2_4G == REGULATION_ETSI || pDM_Odm->odm_Regulation2_4G == REGULATION_WW)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity skip 2.4G domain code : %d\n", pDM_Odm->odm_Regulation2_4G)); -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ return TRUE; -+ -+ } else if ((*pDM_Odm->pBandType != ODM_BAND_2_4G) && (*pDM_Odm->pBandType != ODM_BAND_5G)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity neither 2G nor 5G band, return\n")); -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ return TRUE; -+ } -+ } else { -+ if ((*pDM_Odm->pBandType == ODM_BAND_5G) && -+ !(pDM_Odm->odm_Regulation5G == REGULATION_MKK || pDM_Odm->odm_Regulation5G == REGULATION_WW)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense skip 5G domain code : %d\n", pDM_Odm->odm_Regulation5G)); -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ return TRUE; -+ } -+ -+ else if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) && -+ !(pDM_Odm->odm_Regulation2_4G == REGULATION_MKK || pDM_Odm->odm_Regulation2_4G == REGULATION_WW)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense skip 2.4G domain code : %d\n", pDM_Odm->odm_Regulation2_4G)); -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ return TRUE; -+ -+ } else if ((*pDM_Odm->pBandType != ODM_BAND_2_4G) && (*pDM_Odm->pBandType != ODM_BAND_5G)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense neither 2G nor 5G band, return\n")); -+ pDM_Odm->Adaptivity_enable = FALSE; -+ pDM_Odm->adaptivity_flag = FALSE; -+ return TRUE; -+ } -+ } -+ } -+ -+ return FALSE; -+ -+} -+#endif -+ -+VOID -+Phydm_NHMCounterStatisticsInit( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ /*PHY parameters initialize for n series*/ -+ ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11N+ 2, 0xC350); /*0x894[31:16]=0x0xC350 Time duration for NHM unit: us, 0xc350=200ms*/ -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N + 2, 0xffff); /*0x890[31:16]=0xffff th_9, th_10*/ -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0xffffff50); /*0x898=0xffffff52 th_3, th_2, th_1, th_0*/ -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffffff); /*0x89c=0xffffffff th_7, th_6, th_5, th_4*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_FPGA0_IQK_11N, bMaskByte0, 0xff); /*0xe28[7:0]=0xff th_8*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10 | BIT9 | BIT8, 0x1); /*0x890[10:8]=1 ignoreCCA ignore PHYTXON enable CCX*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT7, 0x1); /*0xc0c[7]=1 max power among all RX ants*/ -+ } -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ /*PHY parameters initialize for ac series*/ -+ ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC+ 2, 0xC350); /*0x990[31:16]=0xC350 Time duration for NHM unit: us, 0xc350=200ms*/ -+ ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC + 2, 0xffff); /*0x994[31:16]=0xffff th_9, th_10*/ -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0xffffff50); /*0x998=0xffffff52 th_3, th_2, th_1, th_0*/ -+ ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffffff); /*0x99c=0xffffffff th_7, th_6, th_5, th_4*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0, 0xff); /*0x9a0[7:0]=0xff th_8*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT8 | BIT9 | BIT10, 0x1); /*0x994[10:8]=1 ignoreCCA ignore PHYTXON enable CCX*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_9E8_11AC, BIT0, 0x1); /*0x9e8[7]=1 max power among all RX ants*/ -+ -+ } -+#endif -+} -+ -+VOID -+Phydm_NHMCounterStatistics( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) -+ return; -+ -+ /*Get NHM report*/ -+ Phydm_GetNHMCounterStatistics(pDM_Odm); -+ -+ /*Reset NHM counter*/ -+ Phydm_NHMCounterStatisticsReset(pDM_Odm); -+} -+ -+VOID -+Phydm_GetNHMCounterStatistics( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32 = 0; -+#if (RTL8195A_SUPPORT == 0) -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_CNT_11AC, bMaskDWord); -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+#endif -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_CNT_11N, bMaskDWord); -+ -+ pDM_Odm->NHM_cnt_0 = (u1Byte)(value32 & bMaskByte0); -+ pDM_Odm->NHM_cnt_1 = (u1Byte)((value32 & bMaskByte1) >> 8); -+ -+} -+ -+VOID -+Phydm_NHMCounterStatisticsReset( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 1); -+ } -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 1); -+ } -+ -+#endif -+ -+} -+ -+VOID -+Phydm_SetEDCCAThreshold( -+ IN PVOID pDM_VOID, -+ IN s1Byte H2L, -+ IN s1Byte L2H -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskByte2|bMaskByte0, (u4Byte)((u1Byte)L2H|(u1Byte)H2L<<16)); -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, bMaskLWord, (u2Byte)((u1Byte)L2H|(u1Byte)H2L<<8)); -+#endif -+ -+} -+ -+VOID -+Phydm_SetLNA( -+ IN PVOID pDM_VOID, -+ IN PhyDM_set_LNA type -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8188E | ODM_RTL8192E)) { -+ if (type == PhyDM_disable_LNA) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0000f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0x37f82); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x0000f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0x37f82); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); -+ } -+ } else if (type == PhyDM_enable_LNA) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0000f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0x77f82); /*back to normal*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x0000f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0x77f82); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); -+ } -+ } -+ } else if (pDM_Odm->SupportICType & ODM_RTL8723B) { -+ if (type == PhyDM_disable_LNA) { -+ /*S0*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0001f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xe6137); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ /*S1*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x43, 0xfffff, 0x3008d); /*select Rx mode and disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x0); -+ } else if (type == PhyDM_enable_LNA) { -+ /*S0*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0001f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xe6177); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ /*S1*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x43, 0xfffff, 0x300bd); /*select Rx mode and disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x0); -+ } -+ -+ } else if (pDM_Odm->SupportICType & ODM_RTL8812) { -+ if (type == PhyDM_disable_LNA) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xc22bf); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0xc22bf); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); -+ } -+ } else if (type == PhyDM_enable_LNA) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xc26bf); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0xc26bf); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); -+ } -+ } -+ } else if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8881A)) { -+ if (type == PhyDM_disable_LNA) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0002f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xfb09b); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ } else if (type == PhyDM_enable_LNA) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0002f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xfb0bb); /*disable LNA*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); -+ } -+ } -+} -+ -+ -+ -+VOID -+Phydm_SetTRxMux( -+ IN PVOID pDM_VOID, -+ IN PhyDM_Trx_MUX_Type txMode, -+ IN PhyDM_Trx_MUX_Type rxMode -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N, BIT3 | BIT2 | BIT1, txMode); /*set TXmod to standby mode to remove outside noise affect*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N, BIT22 | BIT21 | BIT20, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT3 | BIT2 | BIT1, txMode); /*set TXmod to standby mode to remove outside noise affect*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT22 | BIT21 | BIT20, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ -+ } -+ } -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC, BIT11 | BIT10 | BIT9 | BIT8, txMode); /*set TXmod to standby mode to remove outside noise affect*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC, BIT7 | BIT6 | BIT5 | BIT4, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC_B, BIT11 | BIT10 | BIT9 | BIT8, txMode); /*set TXmod to standby mode to remove outside noise affect*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC_B, BIT7 | BIT6 | BIT5 | BIT4, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ -+ } -+ } -+#endif -+ -+} -+ -+VOID -+Phydm_MACEDCCAState( -+ IN PVOID pDM_VOID, -+ IN PhyDM_MACEDCCA_Type State -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if (State == PhyDM_IGNORE_EDCCA) { -+ ODM_SetMACReg(pDM_Odm, REG_TX_PTCL_CTRL, BIT15, 1); /*ignore EDCCA reg520[15]=1*/ -+/* ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 0); *//*reg524[11]=0*/ -+ } else { /*don't set MAC ignore EDCCA signal*/ -+ ODM_SetMACReg(pDM_Odm, REG_TX_PTCL_CTRL, BIT15, 0); /*don't ignore EDCCA reg520[15]=0*/ -+/* ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 1); *//*reg524[11]=1 */ -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("EDCCA enable State = %d\n", State)); -+ -+} -+ -+BOOLEAN -+Phydm_CalNHMcnt( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte Base = 0; -+ -+ Base = pDM_Odm->NHM_cnt_0 + pDM_Odm->NHM_cnt_1; -+ -+ if (Base != 0) { -+ pDM_Odm->NHM_cnt_0 = ((pDM_Odm->NHM_cnt_0) << 8) / Base; -+ pDM_Odm->NHM_cnt_1 = ((pDM_Odm->NHM_cnt_1) << 8) / Base; -+ } -+ if ((pDM_Odm->NHM_cnt_0 - pDM_Odm->NHM_cnt_1) >= 100) -+ return TRUE; /*clean environment*/ -+ else -+ return FALSE; /*noisy environment*/ -+ -+} -+ -+ -+VOID -+Phydm_CheckEnvironment( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ BOOLEAN isCleanEnvironment = FALSE; -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+#endif -+ -+ if (Adaptivity->bFirstLink == TRUE) { -+ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) -+ pDM_Odm->adaptivity_flag = FALSE; -+ else -+ pDM_Odm->adaptivity_flag = TRUE; -+ -+ Adaptivity->bFirstLink = FALSE; -+ return; -+ } else { -+ if (Adaptivity->NHMWait < 3) { /*Start enter NHM after 4 NHMWait*/ -+ Adaptivity->NHMWait++; -+ Phydm_NHMCounterStatistics(pDM_Odm); -+ return; -+ } else { -+ Phydm_NHMCounterStatistics(pDM_Odm); -+ isCleanEnvironment = Phydm_CalNHMcnt(pDM_Odm); -+ if (isCleanEnvironment == TRUE) { -+ pDM_Odm->TH_L2H_ini = Adaptivity->TH_L2H_ini_backup; /*adaptivity mode*/ -+ pDM_Odm->TH_EDCCA_HL_diff = Adaptivity->TH_EDCCA_HL_diff_backup; -+ -+ pDM_Odm->Adaptivity_enable = TRUE; -+ -+ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) -+ pDM_Odm->adaptivity_flag = FALSE; -+ else -+ pDM_Odm->adaptivity_flag = TRUE; -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ priv->pshare->rf_ft_var.isCleanEnvironment = TRUE; -+#endif -+ } else { -+ if (!Adaptivity->AcsForAdaptivity) { -+ pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; /*mode2*/ -+ pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2; -+ -+ pDM_Odm->adaptivity_flag = FALSE; -+ pDM_Odm->Adaptivity_enable = FALSE; -+ } -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ priv->pshare->rf_ft_var.isCleanEnvironment = FALSE; -+#endif -+ } -+ Adaptivity->NHMWait = 0; -+ Adaptivity->bFirstLink = TRUE; -+ Adaptivity->bCheck = TRUE; -+ } -+ -+ } -+ -+ -+} -+ -+VOID -+Phydm_SearchPwdBLowerBound( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ u4Byte value32 = 0; -+ u1Byte cnt; -+ u1Byte txEdcca1 = 0, txEdcca0 = 0; -+ BOOLEAN bAdjust = TRUE; -+ s1Byte TH_L2H_dmc, TH_H2L_dmc, IGI_target = 0x32; -+ s1Byte Diff; -+ u1Byte IGI = Adaptivity->IGI_Base + 30 + (u1Byte)pDM_Odm->TH_L2H_ini - (u1Byte)pDM_Odm->TH_EDCCA_HL_diff; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) -+ Phydm_SetLNA(pDM_Odm, PhyDM_disable_LNA); -+ else { -+ Phydm_SetTRxMux(pDM_Odm, PhyDM_STANDBY_MODE, PhyDM_STANDBY_MODE); -+ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_0, 0x7e); -+ } -+ -+ Diff = IGI_target - (s1Byte)IGI; -+ TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; -+ if (TH_L2H_dmc > 10) -+ TH_L2H_dmc = 10; -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ -+ Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); -+ ODM_delay_ms(5); -+ -+ while (bAdjust) { -+ for (cnt = 0; cnt < 20; cnt++) { -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11N, bMaskDWord); -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC, bMaskDWord); -+#endif -+ if (value32 & BIT30 && (pDM_Odm->SupportICType & (ODM_RTL8723B | ODM_RTL8188E))) -+ txEdcca1 = txEdcca1 + 1; -+ else if (value32 & BIT29) -+ txEdcca1 = txEdcca1 + 1; -+ else -+ txEdcca0 = txEdcca0 + 1; -+ } -+ -+ if (txEdcca1 > 1) { -+ IGI = IGI - 1; -+ TH_L2H_dmc = TH_L2H_dmc + 1; -+ if (TH_L2H_dmc > 10) -+ TH_L2H_dmc = 10; -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ -+ Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); -+ if (TH_L2H_dmc == 10) { -+ bAdjust = FALSE; -+ Adaptivity->H2L_lb = TH_H2L_dmc; -+ Adaptivity->L2H_lb = TH_L2H_dmc; -+ pDM_Odm->Adaptivity_IGI_upper = IGI; -+ } -+ -+ txEdcca1 = 0; -+ txEdcca0 = 0; -+ -+ } else { -+ bAdjust = FALSE; -+ Adaptivity->H2L_lb = TH_H2L_dmc; -+ Adaptivity->L2H_lb = TH_L2H_dmc; -+ pDM_Odm->Adaptivity_IGI_upper = IGI; -+ txEdcca1 = 0; -+ txEdcca0 = 0; -+ } -+ } -+ -+ pDM_Odm->Adaptivity_IGI_upper = pDM_Odm->Adaptivity_IGI_upper - pDM_Odm->DCbackoff; -+ Adaptivity->H2L_lb = Adaptivity->H2L_lb + pDM_Odm->DCbackoff; -+ Adaptivity->L2H_lb = Adaptivity->L2H_lb + pDM_Odm->DCbackoff; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) -+ Phydm_SetLNA(pDM_Odm, PhyDM_enable_LNA); -+ else { -+ Phydm_SetTRxMux(pDM_Odm, PhyDM_TX_MODE, PhyDM_RX_MODE); -+ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_0, NONE); -+ } -+ -+ Phydm_SetEDCCAThreshold(pDM_Odm, 0x7f, 0x7f); /*resume to no link state*/ -+} -+ -+BOOLEAN -+phydm_reSearchCondition( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ /*PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY);*/ -+ u1Byte Adaptivity_IGI_upper; -+ /*s1Byte TH_L2H_dmc, IGI_target = 0x32;*/ -+ /*s1Byte Diff;*/ -+ -+ Adaptivity_IGI_upper = pDM_Odm->Adaptivity_IGI_upper + pDM_Odm->DCbackoff; -+ -+ /*TH_L2H_dmc = 10;*/ -+ -+ /*Diff = TH_L2H_dmc - pDM_Odm->TH_L2H_ini;*/ -+ /*lowest_IGI_upper = IGI_target - Diff;*/ -+ -+ /*if ((Adaptivity_IGI_upper - lowest_IGI_upper) <= 5)*/ -+ if (Adaptivity_IGI_upper <= 0x26) -+ return TRUE; -+ else -+ return FALSE; -+ -+} -+ -+VOID -+phydm_adaptivityInfoInit( -+ IN PVOID pDM_VOID, -+ IN PHYDM_ADAPINFO_E CmnInfo, -+ IN u4Byte Value -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ -+ switch (CmnInfo) { -+ case PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE: -+ pDM_Odm->Carrier_Sense_enable = (BOOLEAN)Value; -+ break; -+ -+ case PHYDM_ADAPINFO_DCBACKOFF: -+ pDM_Odm->DCbackoff = (u1Byte)Value; -+ break; -+ -+ case PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY: -+ Adaptivity->DynamicLinkAdaptivity = (BOOLEAN)Value; -+ break; -+ -+ case PHYDM_ADAPINFO_TH_L2H_INI: -+ pDM_Odm->TH_L2H_ini = (s1Byte)Value; -+ break; -+ -+ case PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF: -+ pDM_Odm->TH_EDCCA_HL_diff = (s1Byte)Value; -+ break; -+ -+ case PHYDM_ADAPINFO_AP_NUM_TH: -+ Adaptivity->APNumTH = (u1Byte)Value; -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+} -+ -+ -+ -+VOID -+Phydm_AdaptivityInit( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ s1Byte IGItarget = 0x32; -+ /*pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable;*/ -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ -+ if (pDM_Odm->Carrier_Sense_enable == FALSE) { -+ if (pDM_Odm->TH_L2H_ini == 0) -+ pDM_Odm->TH_L2H_ini = 0xf5; -+ } else -+ pDM_Odm->TH_L2H_ini = 0xa; -+ -+ if (pDM_Odm->TH_EDCCA_HL_diff == 0) -+ pDM_Odm->TH_EDCCA_HL_diff = 7; -+#if(DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ if (pDM_Odm->WIFITest == TRUE || pDM_Odm->mp_mode == TRUE) -+#else -+ if ((pDM_Odm->WIFITest & RT_WIFI_LOGO) == TRUE) -+#endif -+ pDM_Odm->EDCCA_enable = FALSE; /*even no adaptivity, we still enable EDCCA, AP side use mib control*/ -+ else -+ pDM_Odm->EDCCA_enable = TRUE; -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ if (pDM_Odm->Carrier_Sense_enable) { -+ pDM_Odm->TH_L2H_ini = 0xa; -+ pDM_Odm->TH_EDCCA_HL_diff = 7; -+ } else { -+ pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_default; /*set by mib*/ -+ pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_default; -+ } -+ -+ if (priv->pshare->rf_ft_var.adaptivity_enable == 3) -+ Adaptivity->AcsForAdaptivity = TRUE; -+ else -+ Adaptivity->AcsForAdaptivity = FALSE; -+ -+ if (priv->pshare->rf_ft_var.adaptivity_enable == 2) -+ Adaptivity->DynamicLinkAdaptivity = TRUE; -+ else -+ Adaptivity->DynamicLinkAdaptivity = FALSE; -+ -+ priv->pshare->rf_ft_var.isCleanEnvironment = FALSE; -+ -+#endif -+ -+ pDM_Odm->Adaptivity_IGI_upper = 0; -+ pDM_Odm->Adaptivity_enable = FALSE; /*use this flag to decide enable or disable*/ -+ -+ pDM_Odm->TH_L2H_ini_mode2 = 20; -+ pDM_Odm->TH_EDCCA_HL_diff_mode2 = 8; -+ Adaptivity->TH_L2H_ini_backup = pDM_Odm->TH_L2H_ini; -+ Adaptivity->TH_EDCCA_HL_diff_backup = pDM_Odm->TH_EDCCA_HL_diff; -+ -+ Adaptivity->IGI_Base = 0x32; -+ Adaptivity->IGI_target = 0x1c; -+ Adaptivity->H2L_lb = 0; -+ Adaptivity->L2H_lb = 0; -+ Adaptivity->NHMWait = 0; -+ Adaptivity->bCheck = FALSE; -+ Adaptivity->bFirstLink = TRUE; -+ Adaptivity->AdajustIGILevel = 0; -+ Adaptivity->bStopEDCCA = FALSE; -+ Adaptivity->backupH2L = 0; -+ Adaptivity->backupL2H = 0; -+ -+ Phydm_MACEDCCAState(pDM_Odm, PhyDM_DONT_IGNORE_EDCCA); -+ -+ /*Search pwdB lower bound*/ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11N, bMaskDWord, 0x208); -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC, bMaskDWord, 0x209); -+#endif -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_GAIN_IDX_EDCCA) { -+ /*ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DOWN_OPT_11N, BIT12 | BIT11 | BIT10, 0x7);*/ /*interfernce need > 2^x us, and then EDCCA will be 1*/ -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_PAGE_B1_97F, BIT30, 0x1); /*set to page B1*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DCNF_97F, BIT27 | BIT26, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_PAGE_B1_97F, BIT30, 0x0); -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (priv->pshare->rf_ft_var.adaptivity_enable == 1) -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT13, 0x1); /*0: mean, 1:max pwdB*/ -+#endif -+ } else -+ ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DCNF_11N, BIT21 | BIT20, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ -+ } -+#if (RTL8195A_SUPPORT == 0) -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_GAIN_IDX_EDCCA) { /*8814a no need to find pwdB lower bound, maybe*/ -+ /*ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DOWN_OPT, BIT30 | BIT29 | BIT28, 0x7);*/ /*interfernce need > 2^x us, and then EDCCA will be 1*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_ACBB_EDCCA_ENHANCE, BIT29 | BIT28, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ -+ } -+ -+ if (!(pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA))) { -+ Phydm_SearchPwdBLowerBound(pDM_Odm); -+ if (phydm_reSearchCondition(pDM_Odm)) -+ Phydm_SearchPwdBLowerBound(pDM_Odm); -+ } -+#endif -+ -+/*we need to consider PwdB upper bound for 8814 later IC*/ -+ Adaptivity->AdajustIGILevel = (u1Byte)((pDM_Odm->TH_L2H_ini + IGItarget) - PwdBUpperBound + DFIRloss); /*IGI = L2H - PwdB - DFIRloss*/ -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("TH_L2H_ini = 0x%x, TH_EDCCA_HL_diff = 0x%x, Adaptivity->AdajustIGILevel = 0x%x\n", pDM_Odm->TH_L2H_ini, pDM_Odm->TH_EDCCA_HL_diff, Adaptivity->AdajustIGILevel)); -+ -+ /*Check this later on Windows*/ -+ /*phydm_setEDCCAThresholdAPI(pDM_Odm, pDM_DigTable->CurIGValue);*/ -+ -+} -+ -+ -+VOID -+Phydm_Adaptivity( -+ IN PVOID pDM_VOID, -+ IN u1Byte IGI -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ s1Byte TH_L2H_dmc, TH_H2L_dmc; -+ s1Byte Diff = 0, IGI_target; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ BOOLEAN bFwCurrentInPSMode = FALSE; -+ -+ pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_FW_PSMODE_STATUS, (pu1Byte)(&bFwCurrentInPSMode)); -+ -+ /*Disable EDCCA mode while under LPS mode, added by Roger, 2012.09.14.*/ -+ if (bFwCurrentInPSMode) -+ return; -+#endif -+ -+ if ((pDM_Odm->EDCCA_enable == FALSE) || (Adaptivity->bStopEDCCA == TRUE)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Disable EDCCA!!!\n")); -+ return; -+ } -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("adaptivity disable, enable EDCCA mode!!!\n")); -+ pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; -+ pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2; -+ } -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ else{ -+ if (Phydm_CheckChannelPlan(pDM_Odm) || (pDM_Odm->APTotalNum > Adaptivity->APNumTH)) { -+ pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; -+ pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2; -+ } else { -+ pDM_Odm->TH_L2H_ini = Adaptivity->TH_L2H_ini_backup; -+ pDM_Odm->TH_EDCCA_HL_diff = Adaptivity->TH_EDCCA_HL_diff_backup; -+ } -+ } -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("odm_Adaptivity() =====>\n")); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("IGI_Base=0x%x, TH_L2H_ini = %d, TH_EDCCA_HL_diff = %d\n", -+ Adaptivity->IGI_Base, pDM_Odm->TH_L2H_ini, pDM_Odm->TH_EDCCA_HL_diff)); -+#if (RTL8195A_SUPPORT == 0) -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ /*fix AC series when enable EDCCA hang issue*/ -+ ODM_SetBBReg(pDM_Odm, 0x800, BIT10, 1); /*ADC_mask disable*/ -+ ODM_SetBBReg(pDM_Odm, 0x800, BIT10, 0); /*ADC_mask enable*/ -+ } -+#endif -+ if (*pDM_Odm->pBandWidth == ODM_BW20M) /*CHANNEL_WIDTH_20*/ -+ IGI_target = Adaptivity->IGI_Base; -+ else if (*pDM_Odm->pBandWidth == ODM_BW40M) -+ IGI_target = Adaptivity->IGI_Base + 2; -+#if (RTL8195A_SUPPORT == 0) -+ else if (*pDM_Odm->pBandWidth == ODM_BW80M) -+ IGI_target = Adaptivity->IGI_Base + 2; -+#endif -+ else -+ IGI_target = Adaptivity->IGI_Base; -+ Adaptivity->IGI_target = (u1Byte) IGI_target; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("BandWidth=%s, IGI_target=0x%x, DynamicLinkAdaptivity = %d, AcsForAdaptivity = %d\n", -+ (*pDM_Odm->pBandWidth == ODM_BW80M) ? "80M" : ((*pDM_Odm->pBandWidth == ODM_BW40M) ? "40M" : "20M"), IGI_target, Adaptivity->DynamicLinkAdaptivity, Adaptivity->AcsForAdaptivity)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("RSSI_min = %d, Adaptivity->AdajustIGILevel= 0x%x, adaptivity_flag = %d, Adaptivity_enable = %d\n", -+ pDM_Odm->RSSI_Min, Adaptivity->AdajustIGILevel, pDM_Odm->adaptivity_flag, pDM_Odm->Adaptivity_enable)); -+ -+ if ((Adaptivity->DynamicLinkAdaptivity == TRUE) && (!pDM_Odm->bLinked) && (pDM_Odm->Adaptivity_enable == FALSE)) { -+ Phydm_SetEDCCAThreshold(pDM_Odm, 0x7f, 0x7f); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("In DynamicLink mode(noisy) and No link, Turn off EDCCA!!\n")); -+ return; -+ } -+ -+ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { -+ if ((Adaptivity->AdajustIGILevel > IGI) && (pDM_Odm->Adaptivity_enable == TRUE)) -+ Diff = Adaptivity->AdajustIGILevel - IGI; -+ -+ TH_L2H_dmc = pDM_Odm->TH_L2H_ini - Diff + IGI_target; -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ } -+#if (RTL8195A_SUPPORT == 0) -+ else { -+ Diff = IGI_target - (s1Byte)IGI; -+ TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; -+ if (TH_L2H_dmc > 10 && (pDM_Odm->Adaptivity_enable == TRUE)) -+ TH_L2H_dmc = 10; -+ -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ -+ /*replace lower bound to prevent EDCCA always equal 1*/ -+ if (TH_H2L_dmc < Adaptivity->H2L_lb) -+ TH_H2L_dmc = Adaptivity->H2L_lb; -+ if (TH_L2H_dmc < Adaptivity->L2H_lb) -+ TH_L2H_dmc = Adaptivity->L2H_lb; -+ } -+#endif -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("IGI=0x%x, TH_L2H_dmc = %d, TH_H2L_dmc = %d\n", IGI, TH_L2H_dmc, TH_H2L_dmc)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity_IGI_upper=0x%x, H2L_lb = 0x%x, L2H_lb = 0x%x\n", pDM_Odm->Adaptivity_IGI_upper, Adaptivity->H2L_lb, Adaptivity->L2H_lb)); -+ -+ Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); -+ -+ if (pDM_Odm->Adaptivity_enable == TRUE) -+ ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 1); -+ -+ return; -+} -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+Phydm_AdaptivityBSOD( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ u1Byte count = 0; -+ u4Byte u4Value; -+ -+ /* -+ 1. turn off RF (TRX Mux in standby mode) -+ 2. H2C mac id drop -+ 3. ignore EDCCA -+ 4. wait for clear FIFO -+ 5. don't ignore EDCCA -+ 6. turn on RF (TRX Mux in TRx mdoe) -+ 7. H2C mac id resume -+ */ -+ -+ RT_TRACE(COMP_MLME, DBG_WARNING, ("MAC id drop packet!!!!!\n")); -+ -+ pAdapter->dropPktByMacIdCnt++; -+ pMgntInfo->bDropPktInProgress = TRUE; -+ -+ pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_MAX_Q_PAGE_NUM, (pu1Byte)(&u4Value)); -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("Queue Reserved Page Number = 0x%08x\n", u4Value)); -+ pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_AVBL_Q_PAGE_NUM, (pu1Byte)(&u4Value)); -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("Available Queue Page Number = 0x%08x\n", u4Value)); -+ -+ /*Standby mode*/ -+ Phydm_SetTRxMux(pDM_Odm, PhyDM_STANDBY_MODE, PhyDM_STANDBY_MODE); -+ ODM_Write_DIG(pDM_Odm, 0x20); -+ -+ /*H2C mac id drop*/ -+ MacIdIndicateDisconnect(pAdapter); -+ -+ /*Ignore EDCCA*/ -+ Phydm_MACEDCCAState(pDM_Odm, PhyDM_IGNORE_EDCCA); -+ -+ delay_ms(50); -+ count = 5; -+ -+ /*Resume EDCCA*/ -+ Phydm_MACEDCCAState(pDM_Odm, PhyDM_DONT_IGNORE_EDCCA); -+ -+ /*Turn on TRx mode*/ -+ Phydm_SetTRxMux(pDM_Odm, PhyDM_TX_MODE, PhyDM_RX_MODE); -+ ODM_Write_DIG(pDM_Odm, 0x20); -+ -+ /*Resume H2C macid*/ -+ MacIdRecoverMediaStatus(pAdapter); -+ -+ pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_AVBL_Q_PAGE_NUM, (pu1Byte)(&u4Value)); -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("Available Queue Page Number = 0x%08x\n", u4Value)); -+ -+ pMgntInfo->bDropPktInProgress = FALSE; -+ RT_TRACE(COMP_MLME, DBG_WARNING, ("End of MAC id drop packet, spent %dms\n", count * 10)); -+ -+} -+ -+#endif -+ -+/*This API is for solving USB can't Tx problem due to USB3.0 interference in 2.4G*/ -+VOID -+phydm_pauseEDCCA( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN bPasueEDCCA -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ u1Byte IGI = pDM_DigTable->CurIGValue; -+ s1Byte Diff = 0; -+ -+ if (bPasueEDCCA) { -+ Adaptivity->bStopEDCCA = TRUE; -+ -+ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { -+ if (Adaptivity->AdajustIGILevel > IGI) -+ Diff = Adaptivity->AdajustIGILevel - IGI; -+ -+ Adaptivity->backupL2H = pDM_Odm->TH_L2H_ini - Diff + Adaptivity->IGI_target; -+ Adaptivity->backupH2L = Adaptivity->backupL2H - pDM_Odm->TH_EDCCA_HL_diff; -+ } -+#if (RTL8195A_SUPPORT == 0) -+ else { -+ Diff = Adaptivity->IGI_target - (s1Byte)IGI; -+ Adaptivity->backupL2H = pDM_Odm->TH_L2H_ini + Diff; -+ if (Adaptivity->backupL2H > 10) -+ Adaptivity->backupL2H = 10; -+ -+ Adaptivity->backupH2L = Adaptivity->backupL2H - pDM_Odm->TH_EDCCA_HL_diff; -+ -+ /*replace lower bound to prevent EDCCA always equal 1*/ -+ if (Adaptivity->backupH2L < Adaptivity->H2L_lb) -+ Adaptivity->backupH2L = Adaptivity->H2L_lb; -+ if (Adaptivity->backupL2H < Adaptivity->L2H_lb) -+ Adaptivity->backupL2H = Adaptivity->L2H_lb; -+ } -+#endif -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("pauseEDCCA : L2Hbak = 0x%x, H2Lbak = 0x%x, IGI = 0x%x\n", Adaptivity->backupL2H, Adaptivity->backupH2L, IGI)); -+ -+ /*Disable EDCCA*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (PlatformIsWorkItemScheduled(&(Adaptivity->phydm_pauseEDCCAWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(Adaptivity->phydm_pauseEDCCAWorkItem)); -+#else -+ phydm_pauseEDCCA_WorkItemCallback(pDM_Odm); -+#endif -+ -+ } else { -+ -+ Adaptivity->bStopEDCCA = FALSE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("resumeEDCCA : L2Hbak = 0x%x, H2Lbak = 0x%x, IGI = 0x%x\n", Adaptivity->backupL2H, Adaptivity->backupH2L, IGI)); -+ /*Resume EDCCA*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (PlatformIsWorkItemScheduled(&(Adaptivity->phydm_resumeEDCCAWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(Adaptivity->phydm_resumeEDCCAWorkItem)); -+#else -+ phydm_resumeEDCCA_WorkItemCallback(pDM_Odm); -+#endif -+ -+ } -+ -+} -+ -+ -+VOID -+phydm_pauseEDCCA_WorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskByte2|bMaskByte0, (u4Byte)(0x7f|0x7f<<16)); -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, bMaskLWord, (u2Byte)(0x7f|0x7f<<8)); -+#endif -+ -+} -+ -+VOID -+phydm_resumeEDCCA_WorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskByte2|bMaskByte0, (u4Byte)((u1Byte)Adaptivity->backupL2H|(u1Byte)Adaptivity->backupH2L<<16)); -+#if (RTL8195A_SUPPORT == 0) -+ else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, bMaskLWord, (u2Byte)((u1Byte)Adaptivity->backupL2H|(u1Byte)Adaptivity->backupH2L<<8)); -+#endif -+ -+} -+ -+ -+VOID -+phydm_setEDCCAThresholdAPI( -+ IN PVOID pDM_VOID, -+ IN u1Byte IGI -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -+ s1Byte TH_L2H_dmc, TH_H2L_dmc; -+ s1Byte Diff = 0, IGI_target = 0x32; -+ -+ if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) { -+ if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { -+ if (Adaptivity->AdajustIGILevel > IGI) -+ Diff = Adaptivity->AdajustIGILevel - IGI; -+ -+ TH_L2H_dmc = pDM_Odm->TH_L2H_ini - Diff + IGI_target; -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ } -+#if (RTL8195A_SUPPORT == 0) -+ else { -+ Diff = IGI_target - (s1Byte)IGI; -+ TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; -+ if (TH_L2H_dmc > 10) -+ TH_L2H_dmc = 10; -+ -+ TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; -+ -+ /*replace lower bound to prevent EDCCA always equal 1*/ -+ if (TH_H2L_dmc < Adaptivity->H2L_lb) -+ TH_H2L_dmc = Adaptivity->H2L_lb; -+ if (TH_L2H_dmc < Adaptivity->L2H_lb) -+ TH_L2H_dmc = Adaptivity->L2H_lb; -+ } -+#endif -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("API :IGI=0x%x, TH_L2H_dmc = %d, TH_H2L_dmc = %d\n", IGI, TH_L2H_dmc, TH_H2L_dmc)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("API :Adaptivity_IGI_upper=0x%x, H2L_lb = 0x%x, L2H_lb = 0x%x\n", pDM_Odm->Adaptivity_IGI_upper, Adaptivity->H2L_lb, Adaptivity->L2H_lb)); -+ -+ Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); -+ } -+ -+} -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adaptivity.h 2018-02-11 21:44:27.154146193 +0200 -@@ -0,0 +1,222 @@ -+ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMADAPTIVITY_H__ -+#define __PHYDMADAPTIVITY_H__ -+ -+#define ADAPTIVITY_VERSION "9.3.4" /*20160512 changed by Kevin, modify 0xce8[13]=1 for 8197F when adaptivity is enabled*/ -+ -+#define PwdBUpperBound 7 -+#define DFIRloss 5 -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+typedef enum _tag_PhyDM_REGULATION_Type { -+ REGULATION_FCC = 0, -+ REGULATION_MKK = 1, -+ REGULATION_ETSI = 2, -+ REGULATION_WW = 3, -+ -+ MAX_REGULATION_NUM = 4 -+} PhyDM_REGULATION_TYPE; -+#endif -+ -+typedef enum _PHYDM_ADAPTIVITY_Info_Definition { -+ PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE = 0, -+ PHYDM_ADAPINFO_DCBACKOFF, -+ PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, -+ PHYDM_ADAPINFO_TH_L2H_INI, -+ PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, -+ PHYDM_ADAPINFO_AP_NUM_TH -+ -+} PHYDM_ADAPINFO_E; -+ -+ -+ -+typedef enum tag_PhyDM_set_LNA { -+ PhyDM_disable_LNA = 0, -+ PhyDM_enable_LNA = 1, -+} PhyDM_set_LNA; -+ -+ -+typedef enum tag_PhyDM_TRx_MUX_Type -+{ -+ PhyDM_SHUTDOWN = 0, -+ PhyDM_STANDBY_MODE = 1, -+ PhyDM_TX_MODE = 2, -+ PhyDM_RX_MODE = 3 -+}PhyDM_Trx_MUX_Type; -+ -+typedef enum tag_PhyDM_MACEDCCA_Type -+{ -+ PhyDM_IGNORE_EDCCA = 0, -+ PhyDM_DONT_IGNORE_EDCCA = 1 -+}PhyDM_MACEDCCA_Type; -+ -+typedef struct _ADAPTIVITY_STATISTICS { -+ s1Byte TH_L2H_ini_backup; -+ s1Byte TH_EDCCA_HL_diff_backup; -+ s1Byte IGI_Base; -+ u1Byte IGI_target; -+ u1Byte NHMWait; -+ s1Byte H2L_lb; -+ s1Byte L2H_lb; -+ BOOLEAN bFirstLink; -+ BOOLEAN bCheck; -+ BOOLEAN DynamicLinkAdaptivity; -+ u1Byte APNumTH; -+ u1Byte AdajustIGILevel; -+ BOOLEAN AcsForAdaptivity; -+ s1Byte backupL2H; -+ s1Byte backupH2L; -+ BOOLEAN bStopEDCCA; -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ RT_WORK_ITEM phydm_pauseEDCCAWorkItem; -+ RT_WORK_ITEM phydm_resumeEDCCAWorkItem; -+#endif -+} ADAPTIVITY_STATISTICS, *PADAPTIVITY_STATISTICS; -+ -+VOID -+phydm_pauseEDCCA( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN bPasueEDCCA -+); -+ -+VOID -+Phydm_CheckAdaptivity( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+Phydm_CheckEnvironment( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+Phydm_NHMCounterStatisticsInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+Phydm_NHMCounterStatistics( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+Phydm_NHMCounterStatisticsReset( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+Phydm_GetNHMCounterStatistics( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+Phydm_MACEDCCAState( -+ IN PVOID pDM_VOID, -+ IN PhyDM_MACEDCCA_Type State -+); -+ -+VOID -+Phydm_SetEDCCAThreshold( -+ IN PVOID pDM_VOID, -+ IN s1Byte H2L, -+ IN s1Byte L2H -+); -+ -+VOID -+Phydm_SetTRxMux( -+ IN PVOID pDM_VOID, -+ IN PhyDM_Trx_MUX_Type txMode, -+ IN PhyDM_Trx_MUX_Type rxMode -+); -+ -+BOOLEAN -+Phydm_CalNHMcnt( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+Phydm_SearchPwdBLowerBound( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_adaptivityInfoInit( -+ IN PVOID pDM_VOID, -+ IN PHYDM_ADAPINFO_E CmnInfo, -+ IN u4Byte Value -+ ); -+ -+VOID -+Phydm_AdaptivityInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+Phydm_Adaptivity( -+ IN PVOID pDM_VOID, -+ IN u1Byte IGI -+ ); -+ -+VOID -+phydm_setEDCCAThresholdAPI( -+ IN PVOID pDM_VOID, -+ IN u1Byte IGI -+); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+Phydm_DisableEDCCA( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+Phydm_DynamicEDCCA( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+Phydm_AdaptivityBSOD( -+ IN PVOID pDM_VOID -+); -+ -+#endif -+ -+VOID -+phydm_pauseEDCCA_WorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+phydm_resumeEDCCA_WorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.c 2018-02-11 21:44:27.154146193 +0200 -@@ -0,0 +1,374 @@ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+#if ((RTL8197F_SUPPORT == 1)||(RTL8822B_SUPPORT == 1)) -+#include "rtl8197f/Hal8197FPhyReg.h" -+#include "WlanHAL/HalMac88XX/halmac_reg2.h" -+#else -+#include "WlanHAL/HalHeader/HalComReg.h" -+#endif -+#endif -+ -+#if (PHYDM_LA_MODE_SUPPORT == 1) -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+BOOLEAN -+ADCSmp_BufferAllocate( -+ IN PADAPTER Adapter, -+ IN PRT_ADCSMP AdcSmp -+ ) -+{ -+ PRT_ADCSMP_STRING ADCSmpBuf = &(AdcSmp->ADCSmpBuf); -+ -+ if (ADCSmpBuf->Length == 0) { -+ if (PlatformAllocateMemoryWithZero(Adapter, (void **)&(ADCSmpBuf->Octet), ADCSmpBuf->buffer_size) == RT_STATUS_SUCCESS) -+ ADCSmpBuf->Length = ADCSmpBuf->buffer_size; -+ else -+ return FALSE; -+ } -+ -+ return TRUE; -+} -+#endif -+ -+VOID -+ADCSmp_GetTxPktBuf( -+ IN PVOID pDM_VOID, -+ IN PRT_ADCSMP_STRING ADCSmpBuf -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte i = 0, value32, DataL = 0, DataH = 0; -+ u4Byte Addr, Finish_Addr; -+ u4Byte End_Addr = (ADCSmpBuf->start_pos + ADCSmpBuf->buffer_size)-1; /*End_Addr = 0x3ffff;*/ -+ BOOLEAN bRoundUp; -+ static u4Byte page = 0xFF; -+ u4Byte while_cnt = 0; -+ -+ ODM_Memory_Set(pDM_Odm, ADCSmpBuf->Octet, 0, ADCSmpBuf->Length); -+ ODM_Write1Byte(pDM_Odm, 0x0106, 0x69); -+ -+ DbgPrint("%s\n", __func__); -+ -+ value32 = ODM_Read4Byte(pDM_Odm, 0x7c0); -+ bRoundUp = (BOOLEAN)((value32 & BIT31) >> 31); -+ Finish_Addr = (value32 & 0x7FFF0000) >> 16; /*Reg7C0[30:16]: finish addr (unit: 8byte)*/ -+ -+ if (bRoundUp) -+ Addr = (Finish_Addr+1)<<3; -+ else -+ Addr = ADCSmpBuf->start_pos; -+ -+ DbgPrint("bRoundUp = %d, Finish_Addr=0x%x, value32=0x%x\n", bRoundUp, Finish_Addr, value32); -+ DbgPrint("End_Addr = %x, ADCSmpBuf->start_pos = 0x%x, ADCSmpBuf->buffer_size = 0x%x\n", End_Addr, ADCSmpBuf->start_pos, ADCSmpBuf->buffer_size); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ watchdog_stop(pDM_Odm->priv); -+#endif -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) { -+ for (Addr = 0x0, i = 0; Addr < End_Addr; Addr += 8, i += 2) { /*64K byte*/ -+ if ((Addr&0xfff) == 0) -+ ODM_SetBBReg(pDM_Odm, 0x0140, bMaskLWord, 0x780+(Addr >> 12)); -+ DataL = ODM_GetBBReg(pDM_Odm, 0x8000+(Addr&0xfff), bMaskDWord); -+ DataH = ODM_GetBBReg(pDM_Odm, 0x8000+(Addr&0xfff)+4, bMaskDWord); -+ -+ DbgPrint("%08x%08x\n", DataH, DataL); -+ } -+ } else { -+ while (Addr != (Finish_Addr<<3)) { -+ if (page != (Addr >> 12)) { -+ /*Reg140=0x780+(Addr>>12), Addr=0x30~0x3F, total 16 pages*/ -+ page = (Addr >> 12); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x0140, bMaskLWord, 0x780+page); -+ -+ /*pDataL = 0x8000+(Addr&0xfff);*/ -+ DataL = ODM_GetBBReg(pDM_Odm, 0x8000+(Addr&0xfff), bMaskDWord); -+ DataH = ODM_GetBBReg(pDM_Odm, 0x8000+(Addr&0xfff)+4, bMaskDWord); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ ADCSmpBuf->Octet[i] = DataH; -+ ADCSmpBuf->Octet[i+1] = DataL; -+#endif -+ DbgPrint("%08x%08x\n", DataH, DataL); -+ i = i + 2; -+ -+ if ((Addr+8) >= End_Addr) -+ Addr = ADCSmpBuf->start_pos; -+ else -+ Addr = Addr + 8; -+ -+ while_cnt = while_cnt + 1; -+ if (while_cnt > ((ADCSmpBuf->buffer_size)>>3)) -+ break; -+ } -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ watchdog_resume(pDM_Odm->priv); -+#endif -+} -+ -+ -+VOID -+ADCSmp_Start( -+ IN PVOID pDM_VOID, -+ IN PRT_ADCSMP AdcSmp -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte tmpU1b; -+ PRT_ADCSMP_STRING Buffer = &(AdcSmp->ADCSmpBuf); -+ RT_ADCSMP_TRIG_SIG_SEL TrigSigSel = AdcSmp->ADCSmpTrigSigSel; -+ u1Byte backup_DMA, while_cnt = 0; -+ -+ DbgPrint("%s\n", __func__); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ ODM_SetBBReg(pDM_Odm, 0x9a0, 0xf00, AdcSmp->ADCSmpDmaDataSigSel); /*0x9A0[11:8]*/ -+ else -+ ODM_SetBBReg(pDM_Odm , ODM_ADC_TRIGGER_Jaguar2, 0xf00, AdcSmp->ADCSmpDmaDataSigSel); /*0x95C[11:8]*/ -+ -+ ODM_Write1Byte(pDM_Odm, 0x7c0+1, AdcSmp->ADCSmpTriggerTime); -+ -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ ODM_SetBBReg(pDM_Odm, 0xd00, BIT26, 0x1); -+ else { /*for 8814A and 8822B?*/ -+ ODM_Write1Byte(pDM_Odm, 0x198c, 0x7); -+ ODM_Write1Byte(pDM_Odm, 0x8b4, 0x80); -+ } -+ -+ if (AdcSmp->ADCSmpTrigSel == ADCSMP_MAC_TRIG) { /* trigger by MAC*/ -+ if (TrigSigSel == ADCSMP_TRIG_REG) { /* manual trigger 0x7C0[5] = 0 -> 1*/ -+ ODM_Write1Byte(pDM_Odm, 0x7c0, 0xCB); /*0x7C0[7:0]=8'b1100_1011*/ -+ ODM_Write1Byte(pDM_Odm, 0x7c0, 0xEB); /*0x7C0[7:0]=8'b1110_1011*/ -+ } else if (TrigSigSel == ADCSMP_TRIG_CCA) -+ ODM_Write1Byte(pDM_Odm, 0x7c0, 0x8B); /*0x7C0[7:0]=8'b1000_1011*/ -+ else if (TrigSigSel == ADCSMP_TRIG_CRCFAIL) -+ ODM_Write1Byte(pDM_Odm, 0x7c0, 0x4B); /*0x7C0[7:0]=8'b0100_1011*/ -+ else if (TrigSigSel == ADCSMP_TRIG_CRCOK) -+ ODM_Write1Byte(pDM_Odm, 0x7c0, 0x0B); /*0x7C0[7:0]=8'b0000_1011*/ -+ } else { /*trigger by BB*/ -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ ODM_SetBBReg(pDM_Odm, 0x9a0, 0x1f, TrigSigSel); /*0x9A0[4:0]*/ -+ else -+ ODM_SetBBReg(pDM_Odm , ODM_ADC_TRIGGER_Jaguar2, 0x1f, TrigSigSel); /*0x95C[4:0], 0x1F: trigger by CCA*/ -+ ODM_Write1Byte(pDM_Odm, 0x7c0, 0x03); /*0x7C0[7:0]=8'b0000_0011*/ -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ watchdog_stop(pDM_Odm->priv); -+#endif -+ -+ /*Polling time always use 100ms, when it exceed 2s, break while loop*/ -+ do { -+ tmpU1b = ODM_Read1Byte(pDM_Odm, 0x7c0); -+ -+ if (AdcSmp->ADCSmpState != ADCSMP_STATE_SET) { -+ DbgPrint("ADCSmpState != ADCSMP_STATE_SET\n"); -+ break; -+ -+ } else if (tmpU1b & BIT1) { -+ ODM_delay_ms(100); -+ while_cnt = while_cnt + 1; -+ continue; -+ } else { -+ DbgPrint("%s Query OK\n", __func__); -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ ODM_SetBBReg(pDM_Odm, 0x7c0, BIT0, 0x0); -+ break; -+ } -+ } while (while_cnt < 20); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ watchdog_resume(pDM_Odm->priv); -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) { -+ /*Stop DMA*/ -+ backup_DMA = ODM_GetMACReg(pDM_Odm, 0x300, bMaskLWord); -+ ODM_SetMACReg(pDM_Odm, 0x300, 0x7fff, backup_DMA|0x7fff); -+ -+ /*move LA mode content from IMEM to TxPktBuffer -+ Src : OCPBASE_IMEM 0x00000000 -+ Dest : OCPBASE_TXBUF 0x18780000 -+ Len : 64K*/ -+ GET_HAL_INTERFACE(pDM_Odm->priv)->InitDDMAHandler(pDM_Odm->priv, OCPBASE_IMEM, OCPBASE_TXBUF, 0x10000); -+ } -+#endif -+#endif -+ -+ if (AdcSmp->ADCSmpState == ADCSMP_STATE_SET) -+ ADCSmp_GetTxPktBuf(pDM_Odm, Buffer); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ ODM_SetMACReg(pDM_Odm, 0x300, 0x7fff, backup_DMA); /*Resume DMA*/ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (AdcSmp->ADCSmpState == ADCSMP_STATE_SET) -+ AdcSmp->ADCSmpState = ADCSMP_STATE_QUERY; -+#endif -+ -+ DbgPrint("%s Status %d\n", __func__, AdcSmp->ADCSmpState); -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+VOID -+ADCSmpWorkItemCallback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER Adapter = (PADAPTER)pContext; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); -+ -+ ADCSmp_Start(pDM_Odm, AdcSmp); -+ ADCSmp_Stop(pDM_Odm); -+} -+#endif -+ -+VOID -+ADCSmp_Set( -+ IN PVOID pDM_VOID, -+ IN RT_ADCSMP_TRIG_SEL TrigSel, -+ IN RT_ADCSMP_TRIG_SIG_SEL TrigSigSel, -+ IN u1Byte DmaDataSigSel, -+ IN u1Byte TriggerTime, -+ IN u2Byte PollingTime -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ BOOLEAN retValue = TRUE; -+ PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); -+ -+ AdcSmp->ADCSmpTrigSel = TrigSel; -+ AdcSmp->ADCSmpTrigSigSel = TrigSigSel; -+ AdcSmp->ADCSmpDmaDataSigSel = DmaDataSigSel; -+ AdcSmp->ADCSmpTriggerTime = TriggerTime; -+ AdcSmp->ADCSmpPollingTime = PollingTime; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (AdcSmp->ADCSmpState != ADCSMP_STATE_IDLE) -+ retValue = FALSE; -+ else if (AdcSmp->ADCSmpBuf.Length == 0) -+ retValue = ADCSmp_BufferAllocate(pDM_Odm->Adapter, AdcSmp); -+#endif -+ -+ if (retValue) { -+ AdcSmp->ADCSmpState = ADCSMP_STATE_SET; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ ODM_ScheduleWorkItem(&(AdcSmp->ADCSmpWorkItem)); -+#else -+ ADCSmp_Start(pDM_Odm, AdcSmp); -+#endif -+ } -+ -+ DbgPrint("ADCSmpState %d Return Status %d\n", AdcSmp->ADCSmpState, retValue); -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+RT_STATUS -+ADCSmp_Query( -+ IN PVOID pDM_VOID, -+ IN ULONG InformationBufferLength, -+ OUT PVOID InformationBuffer, -+ OUT PULONG BytesWritten -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); -+ RT_STATUS retStatus = RT_STATUS_SUCCESS; -+ PRT_ADCSMP_STRING ADCSmpBuf = &(AdcSmp->ADCSmpBuf); -+ -+ DbgPrint("%s ADCSmpState %d", __func__, AdcSmp->ADCSmpState); -+ -+ if (InformationBufferLength != ADCSmpBuf->buffer_size) { -+ *BytesWritten = 0; -+ retStatus = RT_STATUS_RESOURCE; -+ } else if (ADCSmpBuf->Length != ADCSmpBuf->buffer_size) { -+ *BytesWritten = 0; -+ retStatus = RT_STATUS_RESOURCE; -+ } else if (AdcSmp->ADCSmpState != ADCSMP_STATE_QUERY) { -+ *BytesWritten = 0; -+ retStatus = RT_STATUS_PENDING; -+ } else { -+ ODM_MoveMemory(pDM_Odm, InformationBuffer, ADCSmpBuf->Octet, ADCSmpBuf->buffer_size); -+ *BytesWritten = ADCSmpBuf->buffer_size; -+ -+ AdcSmp->ADCSmpState = ADCSMP_STATE_IDLE; -+ } -+ -+ DbgPrint("Return Status %d\n", retStatus); -+ -+ return retStatus; -+} -+#endif -+ -+VOID -+ADCSmp_Stop( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); -+ -+ AdcSmp->ADCSmpState = ADCSMP_STATE_IDLE; -+ -+ DbgPrint("%s status %d\n", __func__, AdcSmp->ADCSmpState); -+} -+ -+VOID -+ADCSmp_Init( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); -+ PRT_ADCSMP_STRING ADCSmpBuf = &(AdcSmp->ADCSmpBuf); -+ -+ AdcSmp->ADCSmpState = ADCSMP_STATE_IDLE; -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) { -+ ADCSmpBuf->start_pos = 0x30000; -+ ADCSmpBuf->buffer_size = 0x10000; -+ } else if (pDM_Odm->SupportICType & ODM_RTL8822B) { -+ ADCSmpBuf->start_pos = 0x20000; -+ ADCSmpBuf->buffer_size = 0x20000; -+ } else if (pDM_Odm->SupportICType & ODM_RTL8197F) { -+ ADCSmpBuf->start_pos = 0x00000; -+ ADCSmpBuf->buffer_size = 0x10000; -+ } else if (pDM_Odm->SupportICType & ODM_RTL8821C) { -+ ADCSmpBuf->start_pos = 0x8000; -+ ADCSmpBuf->buffer_size = 0x8000; -+ } -+ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+VOID -+ADCSmp_DeInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); -+ PRT_ADCSMP_STRING ADCSmpBuf = &(AdcSmp->ADCSmpBuf); -+ -+ ADCSmp_Stop(pDM_Odm); -+ -+ if (ADCSmpBuf->Length != 0x0) { -+ ODM_FreeMemory(pDM_Odm, ADCSmpBuf->Octet, ADCSmpBuf->Length); -+ ADCSmpBuf->Length = 0x0; -+ } -+} -+ -+#endif -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_adc_sampling.h 2018-02-11 21:44:27.154146193 +0200 -@@ -0,0 +1,91 @@ -+#ifndef __INC_ADCSMP_H -+#define __INC_ADCSMP_H -+ -+typedef struct _RT_ADCSMP_STRING { -+ pu4Byte Octet; -+ u4Byte Length; -+ u4Byte buffer_size; -+ u4Byte start_pos; -+} RT_ADCSMP_STRING, *PRT_ADCSMP_STRING; -+ -+ -+typedef enum _RT_ADCSMP_TRIG_SEL { -+ ADCSMP_BB_TRIG, -+ ADCSMP_MAC_TRIG, -+} RT_ADCSMP_TRIG_SEL, *PRT_ADCSMP_TRIG_SEL; -+ -+ -+typedef enum _RT_ADCSMP_TRIG_SIG_SEL { -+ ADCSMP_TRIG_CRCOK, -+ ADCSMP_TRIG_CRCFAIL, -+ ADCSMP_TRIG_CCA, -+ ADCSMP_TRIG_REG, -+} RT_ADCSMP_TRIG_SIG_SEL, *PRT_ADCSMP_TRIG_SIG_SEL; -+ -+ -+typedef enum _RT_ADCSMP_STATE { -+ ADCSMP_STATE_IDLE, -+ ADCSMP_STATE_SET, -+ ADCSMP_STATE_QUERY, -+} RT_ADCSMP_STATE, *PRT_ADCSMP_STATE; -+ -+ -+typedef struct _RT_ADCSMP { -+ RT_ADCSMP_STRING ADCSmpBuf; -+ RT_ADCSMP_STATE ADCSmpState; -+ RT_ADCSMP_TRIG_SEL ADCSmpTrigSel; -+ RT_ADCSMP_TRIG_SIG_SEL ADCSmpTrigSigSel; -+ u1Byte ADCSmpDmaDataSigSel; -+ u1Byte ADCSmpTriggerTime; -+ u2Byte ADCSmpPollingTime; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_WORK_ITEM ADCSmpWorkItem; -+ #endif -+} RT_ADCSMP, *PRT_ADCSMP; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+VOID -+ADCSmpWorkItemCallback( -+ IN PVOID pContext -+); -+#endif -+ -+VOID -+ADCSmp_Set( -+ IN PVOID pDM_VOID, -+ IN RT_ADCSMP_TRIG_SEL TrigSel, -+ IN RT_ADCSMP_TRIG_SIG_SEL TrigSigSel, -+ IN u1Byte DmaDataSigSel, -+ IN u1Byte TriggerTime, -+ IN u2Byte PollingTime -+); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+RT_STATUS -+ADCSmp_Query( -+ IN PVOID pDM_VOID, -+ IN ULONG InformationBufferLength, -+ OUT PVOID InformationBuffer, -+ OUT PULONG BytesWritten -+); -+#endif -+VOID -+ADCSmp_Stop( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+ADCSmp_Init( -+ IN PVOID pDM_VOID -+); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+VOID -+ADCSmp_DeInit( -+ IN PVOID pDM_VOID -+); -+ -+#endif -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdect.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdect.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdect.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdect.c 2018-02-11 21:44:27.154146193 +0200 -@@ -0,0 +1,964 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+//#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN |ODM_CE)) -+#if(defined(CONFIG_ANT_DETECTION)) -+ -+//IS_ANT_DETECT_SUPPORT_SINGLE_TONE(Adapter) -+//IS_ANT_DETECT_SUPPORT_RSSI(Adapter) -+//IS_ANT_DETECT_SUPPORT_PSD(Adapter) -+ -+//1 [1. Single Tone Method] =================================================== -+ -+// -+// Description: -+// Set Single/Dual Antenna default setting for products that do not do detection in advance. -+// -+// Added by Joseph, 2012.03.22 -+// -+VOID -+ODM_SingleDualAntennaDefaultSetting( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ -+ u1Byte btAntNum=BT_GetPgAntNum(pAdapter); -+ // Set default antenna A and B status -+ if(btAntNum == 2) -+ { -+ pDM_SWAT_Table->ANTA_ON=TRUE; -+ pDM_SWAT_Table->ANTB_ON=TRUE; -+ -+ } -+ else if(btAntNum == 1) -+ {// Set antenna A as default -+ pDM_SWAT_Table->ANTA_ON=TRUE; -+ pDM_SWAT_Table->ANTB_ON=FALSE; -+ -+ } -+ else -+ { -+ RT_ASSERT(FALSE, ("Incorrect antenna number!!\n")); -+ } -+} -+ -+ -+//2 8723A ANT DETECT -+// -+// Description: -+// Implement IQK single tone for RF DPK loopback and BB PSD scanning. -+// This function is cooperated with BB team Neil. -+// -+// Added by Roger, 2011.12.15 -+// -+BOOLEAN -+ODM_SingleDualAntennaDetection( -+ IN PVOID pDM_VOID, -+ IN u1Byte mode -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ u4Byte CurrentChannel,RfLoopReg; -+ u1Byte n; -+ u4Byte Reg88c, Regc08, Reg874, Regc50, Reg948, Regb2c, Reg92c, Reg930, Reg064, AFE_rRx_Wait_CCA; -+ u1Byte initial_gain = 0x5a; -+ u4Byte PSD_report_tmp; -+ u4Byte AntA_report = 0x0, AntB_report = 0x0, AntO_report = 0x0; -+ BOOLEAN bResult = TRUE; -+ u4Byte AFE_Backup[16]; -+ u4Byte AFE_REG_8723A[16] = { -+ rRx_Wait_CCA, rTx_CCK_RFON, -+ rTx_CCK_BBON, rTx_OFDM_RFON, -+ rTx_OFDM_BBON, rTx_To_Rx, -+ rTx_To_Tx, rRx_CCK, -+ rRx_OFDM, rRx_Wait_RIFS, -+ rRx_TO_Rx, rStandby, -+ rSleep, rPMPD_ANAEN, -+ rFPGA0_XCD_SwitchControl, rBlue_Tooth}; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection()============>\n")); -+ -+ -+ if (!(pDM_Odm->SupportICType & ODM_RTL8723B)) -+ return bResult; -+ -+ // Retrieve antenna detection registry info, added by Roger, 2012.11.27. -+ if(!IS_ANT_DETECT_SUPPORT_SINGLE_TONE(pAdapter)) -+ return bResult; -+ -+ //1 Backup Current RF/BB Settings -+ -+ CurrentChannel = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask); -+ RfLoopReg = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask); -+ if (pDM_Odm->SupportICType & ODM_RTL8723B) { -+ Reg92c = ODM_GetBBReg(pDM_Odm, rDPDT_control, bMaskDWord); -+ Reg930 = ODM_GetBBReg(pDM_Odm, rfe_ctrl_anta_src, bMaskDWord); -+ Reg948 = ODM_GetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord); -+ Regb2c = ODM_GetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord); -+ Reg064 = ODM_GetMACReg(pDM_Odm, rSYM_WLBT_PAPE_SEL, BIT29); -+ ODM_SetBBReg(pDM_Odm, rDPDT_control, 0x3, 0x1); -+ ODM_SetBBReg(pDM_Odm, rfe_ctrl_anta_src, 0xff, 0x77); -+ ODM_SetMACReg(pDM_Odm, rSYM_WLBT_PAPE_SEL, BIT29, 0x1); //dbg 7 -+ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0x3c0, 0x0);//dbg 8 -+ ODM_SetBBReg(pDM_Odm, rAGC_table_select, BIT31, 0x0); -+ } -+ -+ ODM_StallExecution(10); -+ -+ //Store A Path Register 88c, c08, 874, c50 -+ Reg88c = ODM_GetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord); -+ Regc08 = ODM_GetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord); -+ Reg874 = ODM_GetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord); -+ Regc50 = ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord); -+ -+ // Store AFE Registers -+ if (pDM_Odm->SupportICType & ODM_RTL8723B) -+ AFE_rRx_Wait_CCA = ODM_GetBBReg(pDM_Odm, rRx_Wait_CCA,bMaskDWord); -+ -+ //Set PSD 128 pts -+ ODM_SetBBReg(pDM_Odm, rFPGA0_PSDFunction, BIT14|BIT15, 0x0); //128 pts -+ -+ // To SET CH1 to do -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask, 0x7401); //Channel 1 -+ -+ // AFE all on step -+ if (pDM_Odm->SupportICType & ODM_RTL8723B) -+ ODM_SetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord, 0x01c00016); -+ -+ // 3 wire Disable -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord, 0xCCF000C0); -+ -+ //BB IQK Setting -+ ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, 0x000800E4); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x22208000); -+ -+ //IQK setting tone@ 4.34Mhz -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x10008C1C); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); -+ -+ //Page B init -+ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00080000); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x0f600000); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x10008c1f); -+ if (pDM_Odm->SupportICType & ODM_RTL8723B) { -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82150016); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28150016); -+ } -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x001028d0); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, 0x7f, initial_gain); -+ -+ //IQK Single tone start -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ ODM_StallExecution(10000); -+ -+ // PSD report of antenna A -+ PSD_report_tmp=0x0; -+ for (n=0;n<2;n++) -+ { -+ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); -+ if(PSD_report_tmp >AntA_report) -+ AntA_report=PSD_report_tmp; -+ } -+ -+ // change to Antenna B -+ if (pDM_Odm->SupportICType & ODM_RTL8723B) { -+ //ODM_SetBBReg(pDM_Odm, rDPDT_control, 0x3, 0x2); -+ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0xfff, 0x280); -+ ODM_SetBBReg(pDM_Odm, rAGC_table_select, BIT31, 0x1); -+ } -+ -+ ODM_StallExecution(10); -+ -+ // PSD report of antenna B -+ PSD_report_tmp=0x0; -+ for (n=0;n<2;n++) -+ { -+ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); -+ if(PSD_report_tmp > AntB_report) -+ AntB_report=PSD_report_tmp; -+ } -+ -+ //Close IQK Single Tone function -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ -+ //1 Return to antanna A -+ if (pDM_Odm->SupportICType & ODM_RTL8723B) { -+ // external DPDT -+ ODM_SetBBReg(pDM_Odm, rDPDT_control, bMaskDWord, Reg92c); -+ -+ //internal S0/S1 -+ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord, Reg948); -+ ODM_SetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord, Regb2c); -+ ODM_SetBBReg(pDM_Odm, rfe_ctrl_anta_src, bMaskDWord, Reg930); -+ ODM_SetMACReg(pDM_Odm, rSYM_WLBT_PAPE_SEL, BIT29, Reg064); -+ } -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord, Reg88c); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, Regc08); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, Reg874); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, 0x7F, 0x40); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord, Regc50); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask,CurrentChannel); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask,RfLoopReg); -+ -+ //Reload AFE Registers -+ if (pDM_Odm->SupportICType & ODM_RTL8723B) -+ ODM_SetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord, AFE_rRx_Wait_CCA); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8723B) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_A[%d]= %d\n", 2416, AntA_report)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_B[%d]= %d\n", 2416, AntB_report)); -+ -+ //2 Test Ant B based on Ant A is ON -+ if((AntA_report >= 100) && (AntB_report >= 100) && (AntA_report <= 135) && (AntB_report <= 135)) -+ { -+ u1Byte TH1=2, TH2=6; -+ -+ if((AntA_report - AntB_report < TH1) || (AntB_report - AntA_report < TH1)) -+ { -+ pDM_SWAT_Table->ANTA_ON=TRUE; -+ pDM_SWAT_Table->ANTB_ON=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SingleDualAntennaDetection(): Dual Antenna\n")); -+ } -+ else if(((AntA_report - AntB_report >= TH1) && (AntA_report - AntB_report <= TH2)) || -+ ((AntB_report - AntA_report >= TH1) && (AntB_report - AntA_report <= TH2))) -+ { -+ pDM_SWAT_Table->ANTA_ON=FALSE; -+ pDM_SWAT_Table->ANTB_ON=FALSE; -+ bResult = FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Need to check again\n")); -+ } -+ else -+ { -+ pDM_SWAT_Table->ANTA_ON = TRUE; -+ pDM_SWAT_Table->ANTB_ON=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SingleDualAntennaDetection(): Single Antenna\n")); -+ } -+ pDM_Odm->AntDetectedInfo.bAntDetected= TRUE; -+ pDM_Odm->AntDetectedInfo.dBForAntA = AntA_report; -+ pDM_Odm->AntDetectedInfo.dBForAntB = AntB_report; -+ pDM_Odm->AntDetectedInfo.dBForAntO = AntO_report; -+ -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("return FALSE!!\n")); -+ bResult = FALSE; -+ } -+ } -+ return bResult; -+ -+} -+ -+ -+ -+//1 [2. Scan AP RSSI Method] ================================================== -+ -+ -+ -+ -+BOOLEAN -+ODM_SwAntDivCheckBeforeLink( -+ IN PVOID pDM_VOID -+ ) -+{ -+ -+#if (RT_MEM_SIZE_LEVEL != RT_MEM_SIZE_MINIMUM) -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE* pHalData = GET_HAL_DATA(Adapter); -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ s1Byte Score = 0; -+ PRT_WLAN_BSS pTmpBssDesc, pTestBssDesc; -+ u1Byte power_target_L = 9, power_target_H = 16; -+ u1Byte tmp_power_diff = 0,power_diff = 0,avg_power_diff = 0,max_power_diff = 0,min_power_diff = 0xff; -+ u2Byte index, counter = 0; -+ static u1Byte ScanChannel; -+ u4Byte tmp_SWAS_NoLink_BK_Reg948; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ANTA_ON = (( %d )) , ANTB_ON = (( %d ))\n", pDM_Odm->DM_SWAT_Table.ANTA_ON, pDM_Odm->DM_SWAT_Table.ANTB_ON)); -+ -+ //if(HP id) -+ { -+ if(pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult==TRUE && pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("8723B RSSI-based Antenna Detection is done\n")); -+ return FALSE; -+ } -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ if(pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 == 0xff) -+ pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 = ODM_Read4Byte(pDM_Odm, rS0S1_PathSwitch ); -+ } -+ } -+ -+ if (pDM_Odm->Adapter == NULL) //For BSOD when plug/unplug fast. //By YJ,120413 -+ { // The ODM structure is not initialized. -+ return FALSE; -+ } -+ -+ // Retrieve antenna detection registry info, added by Roger, 2012.11.27. -+ if(!IS_ANT_DETECT_SUPPORT_RSSI(Adapter)) -+ { -+ return FALSE; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Antenna Detection: RSSI Method\n")); -+ } -+ -+ // Since driver is going to set BB register, it shall check if there is another thread controlling BB/RF. -+ PlatformAcquireSpinLock(Adapter, RT_RF_STATE_SPINLOCK); -+ if(pHalData->eRFPowerState!=eRfOn || pMgntInfo->RFChangeInProgress || pMgntInfo->bMediaConnect) -+ { -+ PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink(): RFChangeInProgress(%x), eRFPowerState(%x)\n", -+ pMgntInfo->RFChangeInProgress, pHalData->eRFPowerState)); -+ -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ -+ return FALSE; -+ } -+ else -+ { -+ PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("pDM_SWAT_Table->SWAS_NoLink_State = %d\n", pDM_SWAT_Table->SWAS_NoLink_State)); -+ //1 Run AntDiv mechanism "Before Link" part. -+ if(pDM_SWAT_Table->SWAS_NoLink_State == 0) -+ { -+ //1 Prepare to do Scan again to check current antenna state. -+ -+ // Set check state to next step. -+ pDM_SWAT_Table->SWAS_NoLink_State = 1; -+ -+ // Copy Current Scan list. -+ pMgntInfo->tmpNumBssDesc = pMgntInfo->NumBssDesc; -+ PlatformMoveMemory((PVOID)Adapter->MgntInfo.tmpbssDesc, (PVOID)pMgntInfo->bssDesc, sizeof(RT_WLAN_BSS)*MAX_BSS_DESC); -+ -+ // Go back to scan function again. -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Scan one more time\n")); -+ pMgntInfo->ScanStep=0; -+ pMgntInfo->bScanAntDetect = TRUE; -+ ScanChannel = odm_SwAntDivSelectScanChnl(Adapter); -+ -+ -+ if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8821)) -+ { -+ if(pDM_FatTable->RxIdleAnt == MAIN_ANT) -+ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); -+ else -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ if(ScanChannel == 0) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink(): No AP List Avaiable, Using Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"AUX_ANT":"MAIN_ANT")); -+ -+ if(IS_5G_WIRELESS_MODE(pMgntInfo->dot11CurrentWirelessMode)) -+ { -+ pDM_SWAT_Table->Ant5G = pDM_FatTable->RxIdleAnt; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant5G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ } -+ else -+ { -+ pDM_SWAT_Table->Ant2G = pDM_FatTable->RxIdleAnt; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant2G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ } -+ return FALSE; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink: Change to %s for testing.\n", ((pDM_FatTable->RxIdleAnt == MAIN_ANT)?"MAIN_ANT":"AUX_ANT"))); -+ } else if (pDM_Odm->SupportICType & (ODM_RTL8723B)) { -+ /*Switch Antenna to another one.*/ -+ -+ tmp_SWAS_NoLink_BK_Reg948 = ODM_Read4Byte(pDM_Odm, rS0S1_PathSwitch); -+ -+ if ((pDM_SWAT_Table->CurAntenna == MAIN_ANT) && (tmp_SWAS_NoLink_BK_Reg948 == 0x200)) { -+ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0xfff, 0x280); -+ ODM_SetBBReg(pDM_Odm, rAGC_table_select, BIT31, 0x1); -+ pDM_SWAT_Table->CurAntenna = AUX_ANT; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Reg[948]= (( %x )) was in wrong state\n", tmp_SWAS_NoLink_BK_Reg948)); -+ return FALSE; -+ } -+ ODM_StallExecution(10); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Change to (( %s-ant)) for testing.\n", (pDM_SWAT_Table->CurAntenna == MAIN_ANT)?"MAIN":"AUX")); -+ } -+ -+ odm_SwAntDivConstructScanChnl(Adapter, ScanChannel); -+ PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); -+ -+ return TRUE; -+ } -+ else //pDM_SWAT_Table->SWAS_NoLink_State == 1 -+ { -+ //1 ScanComple() is called after antenna swiched. -+ //1 Check scan result and determine which antenna is going -+ //1 to be used. -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,(" tmpNumBssDesc= (( %d )) \n",pMgntInfo->tmpNumBssDesc));// debug for Dino -+ -+ for(index = 0; index < pMgntInfo->tmpNumBssDesc; index++) -+ { -+ pTmpBssDesc = &(pMgntInfo->tmpbssDesc[index]); // Antenna 1 -+ pTestBssDesc = &(pMgntInfo->bssDesc[index]); // Antenna 2 -+ -+ if(PlatformCompareMemory(pTestBssDesc->bdBssIdBuf, pTmpBssDesc->bdBssIdBuf, 6)!=0) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): ERROR!! This shall not happen.\n")); -+ continue; -+ } -+ -+ if(pDM_Odm->SupportICType != ODM_RTL8723B) -+ { -+ if(pTmpBssDesc->ChannelNumber == ScanChannel) -+ { -+ if(pTmpBssDesc->RecvSignalPower > pTestBssDesc->RecvSignalPower) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Compare scan entry: Score++\n")); -+ RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", pTmpBssDesc->bdSsIdBuf, pTmpBssDesc->bdSsIdLen); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n\n", pTmpBssDesc->ChannelNumber, pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ -+ Score++; -+ PlatformMoveMemory(pTestBssDesc, pTmpBssDesc, sizeof(RT_WLAN_BSS)); -+ } -+ else if(pTmpBssDesc->RecvSignalPower < pTestBssDesc->RecvSignalPower) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Compare scan entry: Score--\n")); -+ RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", pTmpBssDesc->bdSsIdBuf, pTmpBssDesc->bdSsIdLen); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n\n", pTmpBssDesc->ChannelNumber, pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ Score--; -+ } -+ else -+ { -+ if(pTestBssDesc->bdTstamp - pTmpBssDesc->bdTstamp < 5000) -+ { -+ RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", pTmpBssDesc->bdSsIdBuf, pTmpBssDesc->bdSsIdLen); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n", pTmpBssDesc->ChannelNumber, pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("The 2nd Antenna didn't get this AP\n\n")); -+ } -+ } -+ } -+ } -+ else // 8723B -+ { -+ if(pTmpBssDesc->ChannelNumber == ScanChannel) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ChannelNumber == ScanChannel -> (( %d )) \n", pTmpBssDesc->ChannelNumber )); -+ -+ if(pTmpBssDesc->RecvSignalPower > pTestBssDesc->RecvSignalPower) // Pow(Ant1) > Pow(Ant2) -+ { -+ counter++; -+ tmp_power_diff=(u1Byte)(pTmpBssDesc->RecvSignalPower - pTestBssDesc->RecvSignalPower); -+ power_diff = power_diff + tmp_power_diff; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), pTmpBssDesc->bdSsIdBuf); -+ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), pTmpBssDesc->bdBssIdBuf); -+ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("tmp_power_diff: (( %d)),max_power_diff: (( %d)),min_power_diff: (( %d)) \n", tmp_power_diff,max_power_diff,min_power_diff)); -+ if(tmp_power_diff > max_power_diff) -+ max_power_diff=tmp_power_diff; -+ if(tmp_power_diff < min_power_diff) -+ min_power_diff=tmp_power_diff; -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("max_power_diff: (( %d)),min_power_diff: (( %d)) \n",max_power_diff,min_power_diff)); -+ -+ PlatformMoveMemory(pTestBssDesc, pTmpBssDesc, sizeof(RT_WLAN_BSS)); -+ } -+ else if(pTestBssDesc->RecvSignalPower > pTmpBssDesc->RecvSignalPower) // Pow(Ant1) < Pow(Ant2) -+ { -+ counter++; -+ tmp_power_diff=(u1Byte)(pTestBssDesc->RecvSignalPower - pTmpBssDesc->RecvSignalPower); -+ power_diff = power_diff + tmp_power_diff; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), pTmpBssDesc->bdSsIdBuf); -+ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), pTmpBssDesc->bdBssIdBuf); -+ if(tmp_power_diff > max_power_diff) -+ max_power_diff=tmp_power_diff; -+ if(tmp_power_diff < min_power_diff) -+ min_power_diff=tmp_power_diff; -+ } -+ else // Pow(Ant1) = Pow(Ant2) -+ { -+ if(pTestBssDesc->bdTstamp > pTmpBssDesc->bdTstamp) // Stamp(Ant1) < Stamp(Ant2) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("time_diff: %lld\n", (pTestBssDesc->bdTstamp-pTmpBssDesc->bdTstamp)/1000)); -+ if(pTestBssDesc->bdTstamp - pTmpBssDesc->bdTstamp > 5000) -+ { -+ counter++; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); -+ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), pTmpBssDesc->bdSsIdBuf); -+ ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), pTmpBssDesc->bdBssIdBuf); -+ min_power_diff = 0; -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Error !!!]: Time_diff: %lld\n", (pTestBssDesc->bdTstamp-pTmpBssDesc->bdTstamp)/1000)); -+ } -+ } -+ } -+ } -+ } -+ -+ if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8821)) -+ { -+ if(pMgntInfo->NumBssDesc!=0 && Score<0) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink(): Using Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ ("ODM_SwAntDivCheckBeforeLink(): Remain Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"AUX_ANT":"MAIN_ANT")); -+ -+ if(pDM_FatTable->RxIdleAnt == MAIN_ANT) -+ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); -+ else -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ } -+ -+ if(IS_5G_WIRELESS_MODE(pMgntInfo->dot11CurrentWirelessMode)) -+ { -+ pDM_SWAT_Table->Ant5G = pDM_FatTable->RxIdleAnt; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant5G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ } -+ else -+ { -+ pDM_SWAT_Table->Ant2G = pDM_FatTable->RxIdleAnt; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant2G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ } -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ if(counter == 0) -+ { -+ if(pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec == FALSE) -+ { -+ pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec = TRUE; -+ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Counter=(( 0 )) , [[ Cannot find any AP with Aux-ant ]] -> Scan Target-channel again \n")); -+ -+ //3 [ Scan again ] -+ odm_SwAntDivConstructScanChnl(Adapter, ScanChannel); -+ PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); -+ return TRUE; -+ } -+ else// Pre_Aux_FailDetec == TRUE -+ { -+ //2 [ Single Antenna ] -+ pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec = FALSE; -+ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Counter=(( 0 )) , [[ Still cannot find any AP ]] \n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); -+ } -+ pDM_Odm->DM_SWAT_Table.Aux_FailDetec_Counter++; -+ } -+ else -+ { -+ pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec = FALSE; -+ -+ if(counter==3) -+ { -+ avg_power_diff = ((power_diff-max_power_diff - min_power_diff)>>1)+ ((max_power_diff + min_power_diff)>>2); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("counter: (( %d )) , power_diff: (( %d )) \n", counter, power_diff)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ counter==3 ] Modified avg_power_diff: (( %d )) , max_power_diff: (( %d )) , min_power_diff: (( %d )) \n", avg_power_diff,max_power_diff, min_power_diff)); -+ } -+ else if(counter>=4) -+ { -+ avg_power_diff=(power_diff-max_power_diff - min_power_diff) / (counter - 2); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("counter: (( %d )) , power_diff: (( %d )) \n", counter, power_diff)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ counter>=4 ] Modified avg_power_diff: (( %d )) , max_power_diff: (( %d )) , min_power_diff: (( %d )) \n", avg_power_diff,max_power_diff, min_power_diff)); -+ -+ } -+ else//counter==1,2 -+ { -+ avg_power_diff=power_diff/counter; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("avg_power_diff: (( %d )) , counter: (( %d )) , power_diff: (( %d )) \n", avg_power_diff,counter, power_diff)); -+ } -+ -+ //2 [ Retry ] -+ if( (avg_power_diff >=power_target_L) && (avg_power_diff <=power_target_H) ) -+ { -+ pDM_Odm->DM_SWAT_Table.Retry_Counter++; -+ -+ if(pDM_Odm->DM_SWAT_Table.Retry_Counter<=3) -+ { -+ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[[ Low confidence result ]] avg_power_diff= (( %d )) -> Scan Target-channel again ]] \n", avg_power_diff)); -+ -+ //3 [ Scan again ] -+ odm_SwAntDivConstructScanChnl(Adapter, ScanChannel); -+ PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); -+ return TRUE; -+ } -+ else -+ { -+ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[[ Still Low confidence result ]] (( Retry_Counter > 3 )) \n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); -+ } -+ -+ } -+ //2 [ Dual Antenna ] -+ else if( (pMgntInfo->NumBssDesc != 0) && (avg_power_diff < power_target_L) ) -+ { -+ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; -+ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == FALSE) -+ { -+ pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; -+ pDM_Odm->DM_SWAT_Table.ANTB_ON = TRUE; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SwAntDivCheckBeforeLink(): Dual antenna\n")); -+ pDM_Odm->DM_SWAT_Table.Dual_Ant_Counter++; -+ -+ // set bt coexDM from 1ant coexDM to 2ant coexDM -+ BT_SetBtCoexAntNum(Adapter, BT_COEX_ANT_TYPE_DETECTED, 2); -+ -+ //3 [ Init antenna diversity ] -+ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; -+ ODM_AntDivInit(pDM_Odm); -+ } -+ //2 [ Single Antenna ] -+ else if(avg_power_diff > power_target_H) -+ { -+ pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; -+ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == TRUE) -+ { -+ pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; -+ pDM_Odm->DM_SWAT_Table.ANTB_ON = FALSE; -+ //BT_SetBtCoexAntNum(Adapter, BT_COEX_ANT_TYPE_DETECTED, 1); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); -+ pDM_Odm->DM_SWAT_Table.Single_Ant_Counter++; -+ } -+ } -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("bResult=(( %d ))\n",pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Dual_Ant_Counter = (( %d )), Single_Ant_Counter = (( %d )) , Retry_Counter = (( %d )) , Aux_FailDetec_Counter = (( %d ))\n\n\n", -+ pDM_Odm->DM_SWAT_Table.Dual_Ant_Counter,pDM_Odm->DM_SWAT_Table.Single_Ant_Counter,pDM_Odm->DM_SWAT_Table.Retry_Counter,pDM_Odm->DM_SWAT_Table.Aux_FailDetec_Counter)); -+ -+ //2 recover the antenna setting -+ -+ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == FALSE) -+ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0xfff, (pDM_SWAT_Table->SWAS_NoLink_BK_Reg948)); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("bResult=(( %d )), Recover Reg[948]= (( %x )) \n\n",pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult, pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 )); -+ -+ -+ } -+ -+ // Check state reset to default and wait for next time. -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ pMgntInfo->bScanAntDetect = FALSE; -+ -+ return FALSE; -+ } -+ -+#else -+ return FALSE; -+#endif -+ -+return FALSE; -+} -+ -+ -+ -+ -+ -+ -+//1 [3. PSD Method] ========================================================== -+ -+ -+ -+ -+u4Byte -+odm_GetPSDData( -+ IN PVOID pDM_VOID, -+ IN u2Byte point, -+ IN u1Byte initial_gain) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte psd_report; -+ -+ ODM_SetBBReg(pDM_Odm, 0x808, 0x3FF, point); -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 1); //Start PSD calculation, Reg808[22]=0->1 -+ ODM_StallExecution(150);//Wait for HW PSD report -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 0);//Stop PSD calculation, Reg808[22]=1->0 -+ psd_report = ODM_GetBBReg(pDM_Odm,0x8B4, bMaskDWord) & 0x0000FFFF;//Read PSD report, Reg8B4[15:0] -+ -+ psd_report = (u4Byte) (odm_ConvertTo_dB(psd_report));//+(u4Byte)(initial_gain); -+ return psd_report; -+} -+ -+ -+ -+VOID -+ODM_SingleDualAntennaDetection_PSD( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte Channel_ori; -+ u1Byte initial_gain = 0x36; -+ u1Byte tone_idx; -+ u1Byte Tone_lenth_1=7, Tone_lenth_2=4; -+ u2Byte Tone_idx_1[7]={88, 104, 120, 8, 24, 40, 56}; -+ u2Byte Tone_idx_2[4]={8, 24, 40, 56}; -+ u4Byte PSD_report_Main[11]={0}, PSD_report_Aux[11]={0}; -+ //u1Byte Tone_lenth_1=4, Tone_lenth_2=2; -+ //u2Byte Tone_idx_1[4]={88, 120, 24, 56}; -+ //u2Byte Tone_idx_2[2]={ 24, 56}; -+ //u4Byte PSD_report_Main[6]={0}, PSD_report_Aux[6]={0}; -+ -+ u4Byte PSD_report_temp,MAX_PSD_report_Main=0,MAX_PSD_report_Aux=0; -+ u4Byte PSD_power_threshold; -+ u4Byte Main_psd_result=0, Aux_psd_result=0; -+ u4Byte Regc50, Reg948, Regb2c,Regc14,Reg908; -+ u4Byte i=0,test_num=8; -+ -+ -+ if(pDM_Odm->SupportICType != ODM_RTL8723B) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection_PSD()============> \n")); -+ -+ //2 [ Backup Current RF/BB Settings ] -+ -+ Channel_ori = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask); -+ Reg948 = ODM_GetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord); -+ Regb2c = ODM_GetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord); -+ Regc50 = ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord); -+ Regc14 = ODM_GetBBReg(pDM_Odm, 0xc14, bMaskDWord); -+ Reg908 = ODM_GetBBReg(pDM_Odm, 0x908, bMaskDWord); -+ -+ //2 [ Setting for doing PSD function (CH4)] -+ ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 0); //disable whole CCK block -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF); // Turn off TX -> Pause TX Queue -+ ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, 0x0); // [ Set IQK Matrix = 0 ] equivalent to [ Turn off CCA] -+ -+ // PHYTXON while loop -+ ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, 0x803); -+ while (ODM_GetBBReg(pDM_Odm, 0xdf4, BIT6)) -+ { -+ i++; -+ if (i > 1000000) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Wait in %s() more than %d times!\n", __FUNCTION__, i)); -+ break; -+ } -+ } -+ -+ ODM_SetBBReg(pDM_Odm, 0xc50, 0x7f, initial_gain); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); // Set RF to CH4 & 40M -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0xf); // 3 wire Disable 88c[23:20]=0xf -+ ODM_SetBBReg(pDM_Odm, rFPGA0_PSDFunction, BIT14|BIT15, 0x0); //128 pt //Set PSD 128 ptss -+ ODM_StallExecution(3000); -+ -+ -+ //2 [ Doing PSD Function in (CH4)] -+ -+ //Antenna A -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Main-ant (CH4)\n")); -+ ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x200); -+ ODM_StallExecution(10); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("dbg\n")); -+ for (i=0;iPSD_report_Main[tone_idx] ) -+ PSD_report_Main[tone_idx]+=PSD_report_temp; -+ } -+ } -+ //Antenna B -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Aux-ant (CH4)\n")); -+ ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x280); -+ ODM_StallExecution(10); -+ for (i=0;iPSD_report_Aux[tone_idx] ) -+ PSD_report_Aux[tone_idx]+=PSD_report_temp; -+ } -+ } -+ //2 [ Doing PSD Function in (CH8)] -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0x0); // 3 wire enable 88c[23:20]=0x0 -+ ODM_StallExecution(3000); -+ -+ ODM_SetBBReg(pDM_Odm, 0xc50, 0x7f, initial_gain); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); // Set RF to CH8 & 40M -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0xf); // 3 wire Disable 88c[23:20]=0xf -+ ODM_StallExecution(3000); -+ -+ //Antenna A -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Main-ant (CH8)\n")); -+ ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x200); -+ ODM_StallExecution(10); -+ -+ for (i=0;iPSD_report_Main[tone_idx] ) -+ PSD_report_Main[Tone_lenth_1+tone_idx]+=PSD_report_temp; -+ } -+ } -+ -+ //Antenna B -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Aux-ant (CH8)\n")); -+ ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x280); -+ ODM_StallExecution(10); -+ -+ for (i=0;iPSD_report_Aux[tone_idx] ) -+ PSD_report_Aux[Tone_lenth_1+tone_idx]+=PSD_report_temp; -+ } -+ } -+ -+ //2 [ Calculate Result ] -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\nMain PSD Result: (ALL) \n")); -+ for (tone_idx=0;tone_idx<(Tone_lenth_1+Tone_lenth_2);tone_idx++) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Tone-%d]: %d, \n",(tone_idx+1), PSD_report_Main[tone_idx] )); -+ Main_psd_result+= PSD_report_Main[tone_idx]; -+ if(PSD_report_Main[tone_idx]>MAX_PSD_report_Main) -+ MAX_PSD_report_Main=PSD_report_Main[tone_idx]; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("--------------------------- \nTotal_Main= (( %d ))\n", Main_psd_result)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MAX_Main = (( %d ))\n", MAX_PSD_report_Main)); -+ -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\nAux PSD Result: (ALL) \n")); -+ for (tone_idx=0;tone_idx<(Tone_lenth_1+Tone_lenth_2);tone_idx++) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Tone-%d]: %d, \n",(tone_idx+1), PSD_report_Aux[tone_idx] )); -+ Aux_psd_result+= PSD_report_Aux[tone_idx]; -+ if(PSD_report_Aux[tone_idx]>MAX_PSD_report_Aux) -+ MAX_PSD_report_Aux=PSD_report_Aux[tone_idx]; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("--------------------------- \nTotal_Aux= (( %d ))\n", Aux_psd_result)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MAX_Aux = (( %d ))\n\n", MAX_PSD_report_Aux)); -+ -+ //Main_psd_result=Main_psd_result-MAX_PSD_report_Main; -+ //Aux_psd_result=Aux_psd_result-MAX_PSD_report_Aux; -+ PSD_power_threshold=(Main_psd_result*7)>>3; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Main_result , Aux_result ] = [ %d , %d ], PSD_power_threshold=(( %d ))\n", Main_psd_result, Aux_psd_result,PSD_power_threshold)); -+ -+ //3 [ Dual Antenna ] -+ if(Aux_psd_result >= PSD_power_threshold ) -+ { -+ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == FALSE) -+ { -+ pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; -+ pDM_Odm->DM_SWAT_Table.ANTB_ON = TRUE; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SwAntDivCheckBeforeLink(): Dual antenna\n")); -+ -+ // set bt coexDM from 1ant coexDM to 2ant coexDM -+ //BT_SetBtCoexAntNum(pAdapter, BT_COEX_ANT_TYPE_DETECTED, 2); -+ -+ // Init antenna diversity -+ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; -+ ODM_AntDivInit(pDM_Odm); -+ } -+ //3 [ Single Antenna ] -+ else -+ { -+ if(pDM_Odm->DM_SWAT_Table.ANTB_ON == TRUE) -+ { -+ pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; -+ pDM_Odm->DM_SWAT_Table.ANTB_ON = FALSE; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); -+ } -+ -+ //2 [ Recover all parameters ] -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask,Channel_ori); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0x0); // 3 wire enable 88c[23:20]=0x0 -+ ODM_SetBBReg(pDM_Odm, 0xc50, 0x7f, Regc50); -+ -+ ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord, Reg948); -+ ODM_SetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord, Regb2c); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 1); //enable whole CCK block -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x0); //Turn on TX // Resume TX Queue -+ ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, Regc14); // [ Set IQK Matrix = 0 ] equivalent to [ Turn on CCA] -+ ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, Reg908); -+ -+ return; -+ -+} -+ -+#endif -+void -+odm_SwAntDetectInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if(defined(CONFIG_ANT_DETECTION)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ //pDM_SWAT_Table->PreAntenna = MAIN_ANT; -+ //pDM_SWAT_Table->CurAntenna = MAIN_ANT; -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ pDM_SWAT_Table->Pre_Aux_FailDetec = FALSE; -+ pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 = 0xff; -+#endif -+} -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdect.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdect.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdect.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdect.h 2018-02-11 21:44:27.154146193 +0200 -@@ -0,0 +1,98 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMANTDECT_H__ -+#define __PHYDMANTDECT_H__ -+ -+#define ANTDECT_VERSION "2.1" /*2015.07.29 by YuChen*/ -+ -+#if(defined(CONFIG_ANT_DETECTION)) -+//#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN |ODM_CE)) -+//ANT Test -+#define ANTTESTALL 0x00 /*Ant A or B will be Testing*/ -+#define ANTTESTA 0x01 /*Ant A will be Testing*/ -+#define ANTTESTB 0x02 /*Ant B will be testing*/ -+ -+#define MAX_ANTENNA_DETECTION_CNT 10 -+ -+ -+typedef struct _ANT_DETECTED_INFO{ -+ BOOLEAN bAntDetected; -+ u4Byte dBForAntA; -+ u4Byte dBForAntB; -+ u4Byte dBForAntO; -+}ANT_DETECTED_INFO, *PANT_DETECTED_INFO; -+ -+ -+typedef enum tag_SW_Antenna_Switch_Definition -+{ -+ Antenna_A = 1, -+ Antenna_B = 2, -+ Antenna_MAX = 3, -+}DM_SWAS_E; -+ -+ -+ -+//1 [1. Single Tone Method] =================================================== -+ -+ -+ -+VOID -+ODM_SingleDualAntennaDefaultSetting( -+ IN PVOID pDM_VOID -+ ); -+ -+BOOLEAN -+ODM_SingleDualAntennaDetection( -+ IN PVOID pDM_VOID, -+ IN u1Byte mode -+ ); -+ -+//1 [2. Scan AP RSSI Method] ================================================== -+ -+#define SwAntDivCheckBeforeLink ODM_SwAntDivCheckBeforeLink -+ -+BOOLEAN -+ODM_SwAntDivCheckBeforeLink( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+ -+ -+//1 [3. PSD Method] ========================================================== -+ -+ -+VOID -+ODM_SingleDualAntennaDetection_PSD( -+ IN PVOID pDM_VOID -+); -+ -+#endif -+ -+VOID -+odm_SwAntDetectInit( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+#endif -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.c 2018-02-11 21:44:27.155146208 +0200 -@@ -0,0 +1,5431 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+//====================================================== -+// when antenna test utility is on or some testing need to disable antenna diversity -+// call this function to disable all ODM related mechanisms which will switch antenna. -+//====================================================== -+VOID -+ODM_StopAntennaSwitchDm( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ // disable ODM antenna diversity -+ pDM_Odm->SupportAbility &= ~ODM_BB_ANT_DIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("STOP Antenna Diversity \n")); -+} -+ -+VOID -+phydm_enable_antenna_diversity( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("AntDiv is enabled & Re-Init AntDiv\n")); -+ odm_AntennaDiversityInit(pDM_Odm); -+} -+ -+VOID -+ODM_SetAntConfig( -+ IN PVOID pDM_VOID, -+ IN u1Byte antSetting // 0=A, 1=B, 2=C, .... -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+ if (antSetting == 0) /* ant A*/ -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x00000000); -+ else if (antSetting == 1) -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x00000280); -+ } else if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ if (antSetting == 0) /* ant A*/ -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskLWord, 0x0000); -+ else if (antSetting == 1) -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskLWord, 0x0280); -+ } -+} -+ -+//====================================================== -+ -+ -+VOID -+ODM_SwAntDivRestAfterLink( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u4Byte i; -+ -+ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { -+ -+ pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; -+ pDM_SWAT_Table->RSSI_Trying = 0; -+ pDM_SWAT_Table->Double_chk_flag= 0; -+ -+ pDM_FatTable->RxIdleAnt=MAIN_ANT; -+ -+ for (i=0; iMainAnt_Sum[i] = 0; -+ pDM_FatTable->AuxAnt_Sum[i] = 0; -+ pDM_FatTable->MainAnt_Cnt[i] = 0; -+ pDM_FatTable->AuxAnt_Cnt[i] = 0; -+ } -+ -+ } -+} -+ -+ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+VOID -+odm_AntDiv_on_off( -+ IN PVOID pDM_VOID , -+ IN u1Byte swch -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ if(pDM_FatTable->AntDiv_OnOff != swch) -+ { -+ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) -+ return; -+ -+ if(pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) N-Series HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT7, swch); -+ ODM_SetBBReg(pDM_Odm, 0xa00 , BIT15, swch); -+ -+ } -+ else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) AC-Series HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); -+ if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT7, swch); //OFDM AntDiv function block enable -+ ODM_SetBBReg(pDM_Odm, 0xa00 , BIT15, swch); //CCK AntDiv function block enable -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , BIT24, swch); //OFDM AntDiv function block enable -+ -+ if( (pDM_Odm->CutVersion >= ODM_CUT_C) && (pDM_Odm->SupportICType == ODM_RTL8821) && ( pDM_Odm->AntDivType != S0S1_SW_ANTDIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) CCK HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); -+ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, swch); -+ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, swch); //CCK AntDiv function block enable -+ } else if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) CCK HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); -+ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, swch); -+ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, swch); //CCK AntDiv function block enable -+ } -+ } -+ } -+ } -+ pDM_FatTable->AntDiv_OnOff =swch; -+ -+} -+ -+VOID -+phydm_FastTraining_enable( -+ IN PVOID pDM_VOID, -+ IN u1Byte swch -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte enable; -+ -+ if (swch == FAT_ON) -+ enable=1; -+ else -+ enable=0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fast Ant Training_en = ((%d))\n", enable)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+ ODM_SetBBReg(pDM_Odm, 0xe08 , BIT16, enable); /*enable fast training*/ -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { -+ ODM_SetBBReg(pDM_Odm, 0xB34 , BIT28, enable); /*enable fast training (path-A)*/ -+ /*ODM_SetBBReg(pDM_Odm, 0xB34 , BIT29, enable);*/ /*enable fast training (path-B)*/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8821) { -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT19, enable); /*enable fast training */ -+ /**/ -+ } -+} -+ -+phydm_keep_RxAckAnt_By_TxAnt_time( -+ IN PVOID pDM_VOID, -+ IN u4Byte time -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /* Timming issue: keep Rx ant after tx for ACK ( time x 3.2 mu sec)*/ -+ if (pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) { -+ -+ ODM_SetBBReg(pDM_Odm, 0xE20, BIT23|BIT22|BIT21|BIT20, time); -+ /**/ -+ } else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) { -+ -+ ODM_SetBBReg(pDM_Odm, 0x818, BIT23|BIT22|BIT21|BIT20, time); -+ /**/ -+ } -+} -+ -+VOID -+odm_Tx_By_TxDesc_or_Reg( -+ IN PVOID pDM_VOID, -+ IN u1Byte swch -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u1Byte enable; -+ -+ if (pDM_FatTable->b_fix_tx_ant == NO_FIX_TX_ANT) -+ enable = (swch == TX_BY_DESC) ? 1 : 0; -+ else -+ enable = 0;/*Force TX by Reg*/ -+ -+ if(pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) -+ { -+ if(pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x80c , BIT21, enable); -+ } -+ else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, enable); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[AntDiv] TX_Ant_BY (( %s ))\n", (enable == TX_BY_DESC) ? "DESC":"REG")); -+ } -+} -+ -+VOID -+ODM_UpdateRxIdleAnt( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u4Byte DefaultAnt, OptionalAnt, value32, Default_tx_Ant; -+ -+ if(pDM_FatTable->RxIdleAnt != Ant) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] RxIdleAnt =%s\n",(Ant==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ -+ if(!(pDM_Odm->SupportICType & ODM_RTL8723B)) -+ pDM_FatTable->RxIdleAnt = Ant; -+ -+ if(Ant == MAIN_ANT) -+ { -+ DefaultAnt = ANT1_2G; -+ OptionalAnt = ANT2_2G; -+ } -+ else -+ { -+ DefaultAnt = ANT2_2G; -+ OptionalAnt = ANT1_2G; -+ } -+ -+ if (pDM_FatTable->b_fix_tx_ant != NO_FIX_TX_ANT) -+ Default_tx_Ant = (pDM_FatTable->b_fix_tx_ant == FIX_TX_AT_MAIN) ? 0 : 1; -+ else -+ Default_tx_Ant = DefaultAnt; -+ -+ if(pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) -+ { -+ if(pDM_Odm->SupportICType==ODM_RTL8192E) -+ { -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT5|BIT4|BIT3, DefaultAnt); //Default RX -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT8|BIT7|BIT6, OptionalAnt);//Optional RX -+ ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, DefaultAnt);//Default TX -+ } -+ #if (RTL8723B_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0x948, 0xFFF); -+ -+ if(value32 !=0x280) -+ ODM_UpdateRxIdleAnt_8723B(pDM_Odm, Ant, DefaultAnt, OptionalAnt); -+ else -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to 0x948 = 0x280\n")); -+ } -+ #endif -+ else { /*8188E & 8188F*/ -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ #if (RTL8723D_SUPPORT == 1) -+ phydm_set_tx_ant_pwr_8723d(pDM_Odm, Ant); -+ #endif -+ } -+ #if (RTL8188F_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ phydm_update_rx_idle_antenna_8188F(pDM_Odm, DefaultAnt); -+ /**/ -+ } -+ #endif -+ -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, DefaultAnt); /*Default RX*/ -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, OptionalAnt); /*Optional RX*/ -+ ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, Default_tx_Ant); /*Default TX*/ -+ } -+ } -+ else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) -+ { -+ u2Byte value16 = ODM_Read2Byte(pDM_Odm, ODM_REG_TRMUX_11AC+2); -+ // -+ // 2014/01/14 MH/Luke.Lee Add direct write for register 0xc0a to prevnt -+ // incorrect 0xc08 bit0-15 .We still not know why it is changed. -+ // -+ value16 &= ~(BIT11|BIT10|BIT9|BIT8|BIT7|BIT6|BIT5|BIT4|BIT3); -+ value16 |= ((u2Byte)DefaultAnt <<3); -+ value16 |= ((u2Byte)OptionalAnt <<6); -+ value16 |= ((u2Byte)DefaultAnt <<9); -+ ODM_Write2Byte(pDM_Odm, ODM_REG_TRMUX_11AC+2, value16); -+ /* -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC , BIT21|BIT20|BIT19, DefaultAnt); //Default RX -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC , BIT24|BIT23|BIT22, OptionalAnt);//Optional RX -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC , BIT27|BIT26|BIT25, DefaultAnt); //Default TX -+ */ -+ } -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ ODM_SetMACReg(pDM_Odm, 0x6D8 , BIT7|BIT6, Default_tx_Ant); /*PathA Resp Tx*/ -+ /**/ -+ } -+ else -+ { -+ ODM_SetMACReg(pDM_Odm, 0x6D8 , BIT10|BIT9|BIT8, Default_tx_Ant); /*PathA Resp Tx*/ -+ /**/ -+ } -+ -+ } -+ else// pDM_FatTable->RxIdleAnt == Ant -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Stay in Ori-Ant ] RxIdleAnt =%s\n",(Ant==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ pDM_FatTable->RxIdleAnt = Ant; -+ } -+} -+ -+VOID -+odm_UpdateTxAnt( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant, -+ IN u4Byte MacId -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u1Byte TxAnt; -+ -+ if (pDM_FatTable->b_fix_tx_ant != NO_FIX_TX_ANT) -+ Ant = (pDM_FatTable->b_fix_tx_ant == FIX_TX_AT_MAIN) ? MAIN_ANT : AUX_ANT; -+ -+ if (pDM_Odm->AntDivType==CG_TRX_SMART_ANTDIV) -+ { -+ TxAnt=Ant; -+ } -+ else -+ { -+ if(Ant == MAIN_ANT) -+ TxAnt = ANT1_2G; -+ else -+ TxAnt = ANT2_2G; -+ } -+ -+ pDM_FatTable->antsel_a[MacId] = TxAnt&BIT0; -+ pDM_FatTable->antsel_b[MacId] = (TxAnt&BIT1)>>1; -+ pDM_FatTable->antsel_c[MacId] = (TxAnt&BIT2)>>2; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Set TX-DESC value]: MacID:(( %d )), TxAnt = (( %s ))\n", MacId, (Ant == MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("antsel_tr_mux=(( 3'b%d%d%d ))\n",pDM_FatTable->antsel_c[MacId] , pDM_FatTable->antsel_b[MacId] , pDM_FatTable->antsel_a[MacId] )); -+ -+} -+ -+#ifdef BEAMFORMING_SUPPORT -+#if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+VOID -+odm_BDC_Init( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pBDC_T pDM_BdcTable=&pDM_Odm->DM_BdcTable; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n[ BDC Initialization......] \n")); -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ pDM_BdcTable->BDC_Mode=BDC_MODE_NULL; -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDCcoexType_wBfer=0; -+ pDM_Odm->bdc_holdstate=0xff; -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ ODM_SetBBReg(pDM_Odm, 0xd7c , 0x0FFFFFFF, 0x1081008); -+ ODM_SetBBReg(pDM_Odm, 0xd80 , 0x0FFFFFFF, 0); -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x9b0 , 0x0FFFFFFF, 0x1081008); //0x9b0[30:0] = 01081008 -+ ODM_SetBBReg(pDM_Odm, 0x9b4 , 0x0FFFFFFF, 0); //0x9b4[31:0] = 00000000 -+ } -+ -+} -+ -+ -+VOID -+odm_CSI_on_off( -+ IN PVOID pDM_VOID, -+ IN u1Byte CSI_en -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if(CSI_en==CSI_ON) -+ { -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ ODM_SetMACReg(pDM_Odm, 0xd84 , BIT11, 1); //0xd84[11]=1 -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ ODM_SetMACReg(pDM_Odm, 0x9b0 , BIT31, 1); //0x9b0[31]=1 -+ } -+ -+ } -+ else if(CSI_en==CSI_OFF) -+ { -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ ODM_SetMACReg(pDM_Odm, 0xd84 , BIT11, 0); //0xd84[11]=0 -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ ODM_SetMACReg(pDM_Odm, 0x9b0 , BIT31, 0); //0x9b0[31]=0 -+ } -+ } -+} -+ -+VOID -+odm_BDCcoexType_withBferClient( -+ IN PVOID pDM_VOID, -+ IN u1Byte swch -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; -+ u1Byte BDCcoexType_wBfer; -+ -+ if(swch==DIVON_CSIOFF) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BDCcoexType: 1] {DIV,CSI} ={1,0} \n")); -+ BDCcoexType_wBfer=1; -+ -+ if(BDCcoexType_wBfer != pDM_BdcTable->BDCcoexType_wBfer) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ odm_CSI_on_off(pDM_Odm,CSI_OFF); -+ pDM_BdcTable->BDCcoexType_wBfer=1; -+ } -+ } -+ else if(swch==DIVOFF_CSION) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BDCcoexType: 2] {DIV,CSI} ={0,1}\n")); -+ BDCcoexType_wBfer=2; -+ -+ if(BDCcoexType_wBfer != pDM_BdcTable->BDCcoexType_wBfer) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ odm_CSI_on_off(pDM_Odm,CSI_ON); -+ pDM_BdcTable->BDCcoexType_wBfer=2; -+ } -+ } -+} -+ -+VOID -+odm_BF_AntDiv_ModeArbitration( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; -+ u1Byte current_BDC_Mode; -+ -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n")); -+ -+ //2 Mode 1 -+ if((pDM_BdcTable->num_Txbfee_Client !=0) && (pDM_BdcTable->num_Txbfer_Client == 0)) -+ { -+ current_BDC_Mode=BDC_MODE_1; -+ -+ if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) -+ { -+ pDM_BdcTable->BDC_Mode=BDC_MODE_1; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ pDM_BdcTable->BDC_RxIdleUpdate_counter=1; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode1 ))\n")); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode1 ))\n")); -+ } -+ //2 Mode 2 -+ else if((pDM_BdcTable->num_Txbfee_Client ==0) && (pDM_BdcTable->num_Txbfer_Client != 0)) -+ { -+ current_BDC_Mode=BDC_MODE_2; -+ -+ if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) -+ { -+ pDM_BdcTable->BDC_Mode=BDC_MODE_2; -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ pDM_BdcTable->BDC_Try_flag=0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode2 ))\n")); -+ -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode2 ))\n")); -+ } -+ //2 Mode 3 -+ else if((pDM_BdcTable->num_Txbfee_Client !=0) && (pDM_BdcTable->num_Txbfer_Client != 0)) -+ { -+ current_BDC_Mode=BDC_MODE_3; -+ -+ if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) -+ { -+ pDM_BdcTable->BDC_Mode=BDC_MODE_3; -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_RxIdleUpdate_counter=1; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode3 ))\n")); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode3 ))\n")); -+ } -+ //2 Mode 4 -+ else if((pDM_BdcTable->num_Txbfee_Client ==0) && (pDM_BdcTable->num_Txbfer_Client == 0)) -+ { -+ current_BDC_Mode=BDC_MODE_4; -+ -+ if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) -+ { -+ pDM_BdcTable->BDC_Mode=BDC_MODE_4; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode4 ))\n")); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode4 ))\n")); -+ } -+ #endif -+ -+} -+ -+VOID -+odm_DivTrainState_setting( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pBDC_T pDM_BdcTable=&pDM_Odm->DM_BdcTable; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n*****[S T A R T ]***** [2-0. DIV_TRAIN_STATE] \n")); -+ pDM_BdcTable->BDC_Try_counter =2; -+ pDM_BdcTable->BDC_Try_flag=1; -+ pDM_BdcTable->BDC_state=BDC_BFer_TRAIN_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+} -+ -+VOID -+odm_BDCcoex_BFeeRxDiv_Arbitration( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; -+ BOOLEAN StopBF_flag; -+ u1Byte BDC_active_Mode; -+ -+ -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{ num_BFee, num_BFer , num_Client} = (( %d , %d , %d)) \n",pDM_BdcTable->num_Txbfee_Client,pDM_BdcTable->num_Txbfer_Client,pDM_BdcTable->num_Client)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{ num_BF_tars, num_DIV_tars } = (( %d , %d )) \n",pDM_BdcTable->num_BfTar , pDM_BdcTable->num_DivTar )); -+ -+ //2 [ MIB control ] -+ if (pDM_Odm->bdc_holdstate==2) -+ { -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ pDM_BdcTable->BDC_state=BDC_BF_HOLD_STATE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ BF STATE] \n")); -+ return; -+ } -+ else if (pDM_Odm->bdc_holdstate==1) -+ { -+ pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ DIV STATE] \n")); -+ return; -+ } -+ -+ //------------------------------------------------------------ -+ -+ -+ -+ //2 Mode 2 & 3 -+ if(pDM_BdcTable->BDC_Mode==BDC_MODE_2 ||pDM_BdcTable->BDC_Mode==BDC_MODE_3) -+ { -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n{ Try_flag , Try_counter } = { %d , %d } \n",pDM_BdcTable->BDC_Try_flag,pDM_BdcTable->BDC_Try_counter)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BDCcoexType = (( %d )) \n\n", pDM_BdcTable->BDCcoexType_wBfer)); -+ -+ // All Client have Bfer-Cap------------------------------- -+ if(pDM_BdcTable->num_Txbfer_Client == pDM_BdcTable->num_Client) //BFer STA Only?: yes -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BFer STA only? (( Yes ))\n")); -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ return; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BFer STA only? (( No ))\n")); -+ } -+ // -+ if(pDM_BdcTable->bAll_BFSta_Idle==FALSE && pDM_BdcTable->bAll_DivSta_Idle==TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("All DIV-STA are idle, but BF-STA not\n")); -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_state=BDC_BFer_TRAIN_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ return; -+ } -+ else if(pDM_BdcTable->bAll_BFSta_Idle==TRUE && pDM_BdcTable->bAll_DivSta_Idle==FALSE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("All BF-STA are idle, but DIV-STA not\n")); -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ return; -+ } -+ -+ //Select active mode-------------------------------------- -+ if(pDM_BdcTable->num_BfTar ==0) // Selsect_1, Selsect_2 -+ { -+ if(pDM_BdcTable->num_DivTar ==0) // Selsect_3 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 1 )) \n")); -+ pDM_BdcTable->BDC_active_Mode=1; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 2 ))\n")); -+ pDM_BdcTable->BDC_active_Mode=2; -+ } -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ return; -+ } -+ else // num_BfTar > 0 -+ { -+ if(pDM_BdcTable->num_DivTar ==0) // Selsect_3 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 3 ))\n")); -+ pDM_BdcTable->BDC_active_Mode=3; -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_state=BDC_BFer_TRAIN_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ return; -+ } -+ else // Selsect_4 -+ { -+ BDC_active_Mode=4; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 4 ))\n")); -+ -+ if(BDC_active_Mode!=pDM_BdcTable->BDC_active_Mode) -+ { -+ pDM_BdcTable->BDC_active_Mode=4; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to active mode (( 4 )) & return!!! \n")); -+ return; -+ } -+ } -+ } -+ -+#if 1 -+ if (pDM_Odm->bdc_holdstate==0xff) -+ { -+ pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ DIV STATE] \n")); -+ return; -+ } -+#endif -+ -+ // Does Client number changed ? ------------------------------- -+ if(pDM_BdcTable->num_Client !=pDM_BdcTable->pre_num_Client) -+ { -+ pDM_BdcTable->BDC_Try_flag=0; -+ pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ The number of client has been changed !!!] return to (( BDC_DIV_TRAIN_STATE )) \n")); -+ } -+ pDM_BdcTable->pre_num_Client=pDM_BdcTable->num_Client; -+ -+ if( pDM_BdcTable->BDC_Try_flag==0) -+ { -+ //2 DIV_TRAIN_STATE (Mode 2-0) -+ if(pDM_BdcTable->BDC_state==BDC_DIV_TRAIN_STATE) -+ { -+ odm_DivTrainState_setting( pDM_Odm); -+ } -+ //2 BFer_TRAIN_STATE (Mode 2-1) -+ else if(pDM_BdcTable->BDC_state==BDC_BFer_TRAIN_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-1. BFer_TRAIN_STATE ]***** \n")); -+ -+ //if(pDM_BdcTable->num_BfTar==0) -+ //{ -+ // ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( No )), [ BDC_BFer_TRAIN_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); -+ // odm_DivTrainState_setting( pDM_Odm); -+ //} -+ //else //num_BfTar != 0 -+ //{ -+ pDM_BdcTable->BDC_Try_counter=2; -+ pDM_BdcTable->BDC_Try_flag=1; -+ pDM_BdcTable->BDC_state=BDC_DECISION_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes )), [ BDC_BFer_TRAIN_STATE ] >> [BDC_DECISION_STATE] \n")); -+ //} -+ } -+ //2 DECISION_STATE (Mode 2-2) -+ else if(pDM_BdcTable->BDC_state==BDC_DECISION_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-2. DECISION_STATE]***** \n")); -+ //if(pDM_BdcTable->num_BfTar==0) -+ //{ -+ // ODM_AntDiv_Printk(("BF_tars exist? : (( No )), [ DECISION_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); -+ // odm_DivTrainState_setting( pDM_Odm); -+ //} -+ //else //num_BfTar != 0 -+ //{ -+ if(pDM_BdcTable->BF_pass==FALSE || pDM_BdcTable->DIV_pass == FALSE) -+ StopBF_flag=TRUE; -+ else -+ StopBF_flag=FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes )), {BF_pass, DIV_pass, StopBF_flag } = { %d, %d, %d } \n" ,pDM_BdcTable->BF_pass,pDM_BdcTable->DIV_pass,StopBF_flag)); -+ -+ if(StopBF_flag==TRUE) //DIV_en -+ { -+ pDM_BdcTable->BDC_Hold_counter=10; //20 -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ StopBF_flag= ((TRUE)), BDC_DECISION_STATE ] >> [BDC_DIV_HOLD_STATE] \n")); -+ } -+ else //BF_en -+ { -+ pDM_BdcTable->BDC_Hold_counter=10; //20 -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ pDM_BdcTable->BDC_state=BDC_BF_HOLD_STATE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[StopBF_flag= ((FALSE)), BDC_DECISION_STATE ] >> [BDC_BF_HOLD_STATE] \n")); -+ } -+ //} -+ } -+ //2 BF-HOLD_STATE (Mode 2-3) -+ else if(pDM_BdcTable->BDC_state==BDC_BF_HOLD_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-3. BF_HOLD_STATE ]*****\n")); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BDC_Hold_counter = (( %d )) \n",pDM_BdcTable->BDC_Hold_counter )); -+ -+ if(pDM_BdcTable->BDC_Hold_counter==1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); -+ odm_DivTrainState_setting( pDM_Odm); -+ } -+ else -+ { -+ pDM_BdcTable->BDC_Hold_counter--; -+ -+ //if(pDM_BdcTable->num_BfTar==0) -+ //{ -+ // ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( No )), [ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); -+ // odm_DivTrainState_setting( pDM_Odm); -+ //} -+ //else //num_BfTar != 0 -+ //{ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes ))\n")); -+ pDM_BdcTable->BDC_state=BDC_BF_HOLD_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_BF_HOLD_STATE ] >> [BDC_BF_HOLD_STATE] \n")); -+ //} -+ } -+ -+ } -+ //2 DIV-HOLD_STATE (Mode 2-4) -+ else if(pDM_BdcTable->BDC_state==BDC_DIV_HOLD_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-4. DIV_HOLD_STATE ]*****\n")); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BDC_Hold_counter = (( %d )) \n",pDM_BdcTable->BDC_Hold_counter )); -+ -+ if(pDM_BdcTable->BDC_Hold_counter==1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); -+ odm_DivTrainState_setting( pDM_Odm); -+ } -+ else -+ { -+ pDM_BdcTable->BDC_Hold_counter--; -+ pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; -+ odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_HOLD_STATE] \n")); -+ } -+ -+ } -+ -+ } -+ else if( pDM_BdcTable->BDC_Try_flag==1) -+ { -+ //2 Set Training Counter -+ if(pDM_BdcTable->BDC_Try_counter >1) -+ { -+ pDM_BdcTable->BDC_Try_counter--; -+ if(pDM_BdcTable->BDC_Try_counter ==1) -+ pDM_BdcTable->BDC_Try_flag=0; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training !!\n")); -+ //return ; -+ } -+ -+ } -+ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n[end]\n")); -+ -+ #endif //#if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ -+ -+ -+ -+ -+} -+ -+#endif -+#endif //#ifdef BEAMFORMING_SUPPORT -+ -+ -+#if (RTL8188E_SUPPORT == 1) -+ -+ -+VOID -+odm_RX_HWAntDiv_Init_88E( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ #if 0 -+ if(pDM_Odm->mp_mode == TRUE) -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_IGI_A_11N , BIT7, 0); // disable HW AntDiv -+ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT31, 1); // 1:CG, 0:CS -+ return; -+ } -+ #endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => AntDivType=[CGCS_RX_HW_ANTDIV]\n")); -+ -+ //MAC Setting -+ value32 = ODM_GetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord); -+ ODM_SetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord, value32|(BIT23|BIT25)); //Reg4C[25]=1, Reg4C[23]=1 for pin output -+ //Pin Settings -+ ODM_SetBBReg(pDM_Odm, ODM_REG_PIN_CTRL_11N , BIT9|BIT8, 0);//Reg870[8]=1'b0, Reg870[9]=1'b0 //antsel antselb by HW -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_ANT_CTRL_11N , BIT10, 0); //Reg864[10]=1'b0 //antsel2 by HW -+ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT22, 1); //Regb2c[22]=1'b0 //disable CS/CG switch -+ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT31, 1); //Regb2c[31]=1'b1 //output at CG only -+ //OFDM Settings -+ ODM_SetBBReg(pDM_Odm, ODM_REG_ANTDIV_PARA1_11N , bMaskDWord, 0x000000a0); -+ //CCK Settings -+ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_PWR_SAV4_11N , BIT7, 1); //Fix CCK PHY status report issue -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_ANTDIV_PARA2_11N , BIT4, 1); //CCK complete HW AntDiv within 64 samples -+ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_ANT_MAPPING1_11N , 0xFFFF, 0x0001); //antenna mapping table -+ -+ pDM_FatTable->enable_ctrl_frame_antdiv = 1; -+} -+ -+VOID -+odm_TRX_HWAntDiv_Init_88E( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ #if 0 -+ if(pDM_Odm->mp_mode == TRUE) -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_IGI_A_11N , BIT7, 0); // disable HW AntDiv -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_ANT_CTRL_11N , BIT5|BIT4|BIT3, 0); //Default RX (0/1) -+ return; -+ } -+ #endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => AntDivType=[CG_TRX_HW_ANTDIV (SPDT)]\n")); -+ -+ //MAC Setting -+ value32 = ODM_GetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord); -+ ODM_SetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord, value32|(BIT23|BIT25)); //Reg4C[25]=1, Reg4C[23]=1 for pin output -+ //Pin Settings -+ ODM_SetBBReg(pDM_Odm, ODM_REG_PIN_CTRL_11N , BIT9|BIT8, 0);//Reg870[8]=1'b0, Reg870[9]=1'b0 //antsel antselb by HW -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_ANT_CTRL_11N , BIT10, 0); //Reg864[10]=1'b0 //antsel2 by HW -+ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT22, 0); //Regb2c[22]=1'b0 //disable CS/CG switch -+ ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT31, 1); //Regb2c[31]=1'b1 //output at CG only -+ //OFDM Settings -+ ODM_SetBBReg(pDM_Odm, ODM_REG_ANTDIV_PARA1_11N , bMaskDWord, 0x000000a0); -+ //CCK Settings -+ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_PWR_SAV4_11N , BIT7, 1); //Fix CCK PHY status report issue -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_ANTDIV_PARA2_11N , BIT4, 1); //CCK complete HW AntDiv within 64 samples -+ -+ //antenna mapping table -+ if(!pDM_Odm->bIsMPChip) //testchip -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_DEFUALT_A_11N , BIT10|BIT9|BIT8, 1); //Reg858[10:8]=3'b001 -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RX_DEFUALT_A_11N , BIT13|BIT12|BIT11, 2); //Reg858[13:11]=3'b010 -+ } -+ else //MPchip -+ ODM_SetBBReg(pDM_Odm, ODM_REG_ANT_MAPPING1_11N , bMaskDWord, 0x0201); /*Reg914=3'b010, Reg915=3'b001*/ -+ -+ pDM_FatTable->enable_ctrl_frame_antdiv = 1; -+} -+ -+ -+#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+VOID -+odm_Smart_HWAntDiv_Init_88E( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32, i; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => AntDivType=[CG_TRX_SMART_ANTDIV]\n")); -+ -+ #if 0 -+ if(pDM_Odm->mp_mode == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("pDM_Odm->AntDivType: %d\n", pDM_Odm->AntDivType)); -+ return; -+ } -+ #endif -+ -+ pDM_FatTable->TrainIdx = 0; -+ pDM_FatTable->FAT_State = FAT_PREPARE_STATE; -+ -+ pDM_Odm->fat_comb_a=5; -+ pDM_Odm->antdiv_intvl = 0x64; // 100ms -+ -+ for(i=0; i<6; i++) -+ { -+ pDM_FatTable->Bssid[i] = 0; -+ } -+ for(i=0; i< (pDM_Odm->fat_comb_a) ; i++) -+ { -+ pDM_FatTable->antSumRSSI[i] = 0; -+ pDM_FatTable->antRSSIcnt[i] = 0; -+ pDM_FatTable->antAveRSSI[i] = 0; -+ } -+ -+ //MAC Setting -+ value32 = ODM_GetMACReg(pDM_Odm, 0x4c, bMaskDWord); -+ ODM_SetMACReg(pDM_Odm, 0x4c, bMaskDWord, value32|(BIT23|BIT25)); //Reg4C[25]=1, Reg4C[23]=1 for pin output -+ value32 = ODM_GetMACReg(pDM_Odm, 0x7B4, bMaskDWord); -+ ODM_SetMACReg(pDM_Odm, 0x7b4, bMaskDWord, value32|(BIT16|BIT17)); //Reg7B4[16]=1 enable antenna training, Reg7B4[17]=1 enable A2 match -+ //value32 = PlatformEFIORead4Byte(Adapter, 0x7B4); -+ //PlatformEFIOWrite4Byte(Adapter, 0x7b4, value32|BIT18); //append MACID in reponse packet -+ -+ //Match MAC ADDR -+ ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, 0); -+ ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, 0); -+ -+ ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0);//Reg870[8]=1'b0, Reg870[9]=1'b0 //antsel antselb by HW -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT10, 0); //Reg864[10]=1'b0 //antsel2 by HW -+ ODM_SetBBReg(pDM_Odm, 0xb2c , BIT22, 0); //Regb2c[22]=1'b0 //disable CS/CG switch -+ ODM_SetBBReg(pDM_Odm, 0xb2c , BIT31, 0); //Regb2c[31]=1'b1 //output at CS only -+ ODM_SetBBReg(pDM_Odm, 0xca4 , bMaskDWord, 0x000000a0); -+ -+ //antenna mapping table -+ if(pDM_Odm->fat_comb_a == 2) -+ { -+ if(!pDM_Odm->bIsMPChip) //testchip -+ { -+ ODM_SetBBReg(pDM_Odm, 0x858 , BIT10|BIT9|BIT8, 1); //Reg858[10:8]=3'b001 -+ ODM_SetBBReg(pDM_Odm, 0x858 , BIT13|BIT12|BIT11, 2); //Reg858[13:11]=3'b010 -+ } -+ else //MPchip -+ { -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 1); -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 2); -+ } -+ } -+ else -+ { -+ if(!pDM_Odm->bIsMPChip) //testchip -+ { -+ ODM_SetBBReg(pDM_Odm, 0x858 , BIT10|BIT9|BIT8, 0); //Reg858[10:8]=3'b000 -+ ODM_SetBBReg(pDM_Odm, 0x858 , BIT13|BIT12|BIT11, 1); //Reg858[13:11]=3'b001 -+ ODM_SetBBReg(pDM_Odm, 0x878 , BIT16, 0); -+ ODM_SetBBReg(pDM_Odm, 0x858 , BIT15|BIT14, 2); //(Reg878[0],Reg858[14:15])=3'b010 -+ ODM_SetBBReg(pDM_Odm, 0x878 , BIT19|BIT18|BIT17, 3);//Reg878[3:1]=3b'011 -+ ODM_SetBBReg(pDM_Odm, 0x878 , BIT22|BIT21|BIT20, 4);//Reg878[6:4]=3b'100 -+ ODM_SetBBReg(pDM_Odm, 0x878 , BIT25|BIT24|BIT23, 5);//Reg878[9:7]=3b'101 -+ ODM_SetBBReg(pDM_Odm, 0x878 , BIT28|BIT27|BIT26, 6);//Reg878[12:10]=3b'110 -+ ODM_SetBBReg(pDM_Odm, 0x878 , BIT31|BIT30|BIT29, 7);//Reg878[15:13]=3b'111 -+ } -+ else //MPchip -+ { -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 4); // 0: 3b'000 -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 2); // 1: 3b'001 -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte2, 0); // 2: 3b'010 -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte3, 1); // 3: 3b'011 -+ ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte0, 3); // 4: 3b'100 -+ ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte1, 5); // 5: 3b'101 -+ ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte2, 6); // 6: 3b'110 -+ ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte3, 255); // 7: 3b'111 -+ } -+ } -+ -+ //Default Ant Setting when no fast training -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, 0); //Default RX -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, 1); //Optional RX -+ ODM_SetBBReg(pDM_Odm, 0x860 , BIT14|BIT13|BIT12, 0);//Default TX -+ -+ //Enter Traing state -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT2|BIT1|BIT0, (pDM_Odm->fat_comb_a-1)); //Reg864[2:0]=3'd6 //ant combination=reg864[2:0]+1 -+ -+ //SW Control -+ //PHY_SetBBReg(Adapter, 0x864 , BIT10, 1); -+ //PHY_SetBBReg(Adapter, 0x870 , BIT9, 1); -+ //PHY_SetBBReg(Adapter, 0x870 , BIT8, 1); -+ //PHY_SetBBReg(Adapter, 0x864 , BIT11, 1); -+ //PHY_SetBBReg(Adapter, 0x860 , BIT9, 0); -+ //PHY_SetBBReg(Adapter, 0x860 , BIT8, 0); -+} -+#endif -+ -+#endif //#if (RTL8188E_SUPPORT == 1) -+ -+ -+#if (RTL8192E_SUPPORT == 1) -+VOID -+odm_RX_HWAntDiv_Init_92E( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ #if 0 -+ if(pDM_Odm->mp_mode == TRUE) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 0); //r_rxdiv_enable_anta Regc50[8]=1'b0 0: control by c50[9] -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT9, 1); // 1:CG, 0:CS -+ return; -+ } -+ #endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => AntDivType=[CGCS_RX_HW_ANTDIV]\n")); -+ -+ //Pin Settings -+ ODM_SetBBReg(pDM_Odm, 0x870 , BIT8, 0);//Reg870[8]=1'b0, // "antsel" is controled by HWs -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 1); //Regc50[8]=1'b1 //" CS/CG switching" is controled by HWs -+ -+ //Mapping table -+ ODM_SetBBReg(pDM_Odm, 0x914 , 0xFFFF, 0x0100); //antenna mapping table -+ -+ //OFDM Settings -+ ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF000, 0x0); //bias -+ -+ //CCK Settings -+ ODM_SetBBReg(pDM_Odm, 0xa04 , 0xF000000, 0); //Select which path to receive for CCK_1 & CCK_2 -+ ODM_SetBBReg(pDM_Odm, 0xb34 , BIT30, 0); //(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 -+ ODM_SetBBReg(pDM_Odm, 0xa74 , BIT7, 1); //Fix CCK PHY status report issue -+ ODM_SetBBReg(pDM_Odm, 0xa0c , BIT4, 1); //CCK complete HW AntDiv within 64 samples -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ //EVM enhance AntDiv method init---------------------------------------------------------------------- -+ pDM_FatTable->EVM_method_enable=0; -+ pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; -+ pDM_Odm->antdiv_intvl = 0x64; -+ ODM_SetBBReg(pDM_Odm, 0x910 , 0x3f, 0xf ); -+ pDM_Odm->antdiv_evm_en=1; -+ //pDM_Odm->antdiv_period=1; -+ pDM_Odm->evm_antdiv_period = 3; -+ -+ #endif -+ -+} -+ -+VOID -+odm_TRX_HWAntDiv_Init_92E( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ #if 0 -+ if(pDM_Odm->mp_mode == TRUE) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 0); //r_rxdiv_enable_anta Regc50[8]=1'b0 0: control by c50[9] -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT9, 1); // 1:CG, 0:CS -+ return; -+ } -+ #endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => AntDivType=[ Only for DIR605, CG_TRX_HW_ANTDIV]\n")); -+ -+ //3 --RFE pin setting--------- -+ //[MAC] -+ ODM_SetMACReg(pDM_Odm, 0x38, BIT11, 1); //DBG PAD Driving control (GPIO 8) -+ ODM_SetMACReg(pDM_Odm, 0x4c, BIT23, 0); //path-A , RFE_CTRL_3 -+ ODM_SetMACReg(pDM_Odm, 0x4c, BIT29, 1); //path-A , RFE_CTRL_8 -+ //[BB] -+ ODM_SetBBReg(pDM_Odm, 0x944 , BIT3, 1); //RFE_buffer -+ ODM_SetBBReg(pDM_Odm, 0x944 , BIT8, 1); -+ ODM_SetBBReg(pDM_Odm, 0x940 , BIT7|BIT6, 0x0); // r_rfe_path_sel_ (RFE_CTRL_3) -+ ODM_SetBBReg(pDM_Odm, 0x940 , BIT17|BIT16, 0x0); // r_rfe_path_sel_ (RFE_CTRL_8) -+ ODM_SetBBReg(pDM_Odm, 0x944 , BIT31, 0); //RFE_buffer -+ ODM_SetBBReg(pDM_Odm, 0x92C , BIT3, 0); //rfe_inv (RFE_CTRL_3) -+ ODM_SetBBReg(pDM_Odm, 0x92C , BIT8, 1); //rfe_inv (RFE_CTRL_8) -+ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF000, 0x8); //path-A , RFE_CTRL_3 -+ ODM_SetBBReg(pDM_Odm, 0x934 , 0xF, 0x8); //path-A , RFE_CTRL_8 -+ //3 ------------------------- -+ -+ //Pin Settings -+ ODM_SetBBReg(pDM_Odm, 0xC50 , BIT8, 0); //path-A //disable CS/CG switch -+ -+/* Let it follows PHY_REG for bit9 setting -+ if(pDM_Odm->priv->pshare->rf_ft_var.use_ext_pa || pDM_Odm->priv->pshare->rf_ft_var.use_ext_lna) -+ ODM_SetBBReg(pDM_Odm, 0xC50 , BIT9, 1);//path-A //output at CS -+ else -+ ODM_SetBBReg(pDM_Odm, 0xC50 , BIT9, 0); //path-A //output at CG ->normal power -+*/ -+ -+ ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0); //path-A //antsel antselb by HW -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT10, 0); //path-A //antsel2 by HW -+ -+ //Mapping table -+ ODM_SetBBReg(pDM_Odm, 0x914 , 0xFFFF, 0x0100); //antenna mapping table -+ -+ //OFDM Settings -+ ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF000, 0x0); //bias -+ -+ //CCK Settings -+ ODM_SetBBReg(pDM_Odm, 0xa04 , 0xF000000, 0); //Select which path to receive for CCK_1 & CCK_2 -+ ODM_SetBBReg(pDM_Odm, 0xb34 , BIT30, 0); //(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 -+ ODM_SetBBReg(pDM_Odm, 0xa74 , BIT7, 1); //Fix CCK PHY status report issue -+ ODM_SetBBReg(pDM_Odm, 0xa0c , BIT4, 1); //CCK complete HW AntDiv within 64 samples -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ //EVM enhance AntDiv method init---------------------------------------------------------------------- -+ pDM_FatTable->EVM_method_enable=0; -+ pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; -+ pDM_Odm->antdiv_intvl = 0x64; -+ ODM_SetBBReg(pDM_Odm, 0x910 , 0x3f, 0xf ); -+ pDM_Odm->antdiv_evm_en=1; -+ //pDM_Odm->antdiv_period=1; -+ pDM_Odm->evm_antdiv_period = 3; -+ #endif -+} -+ -+#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+VOID -+odm_Smart_HWAntDiv_Init_92E( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => AntDivType=[CG_TRX_SMART_ANTDIV]\n")); -+} -+#endif -+ -+#endif //#if (RTL8192E_SUPPORT == 1) -+ -+#if (RTL8723D_SUPPORT == 1) -+VOID -+odm_TRX_HWAntDiv_Init_8723D( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8723D] AntDiv_Init => AntDivType=[S0S1_HW_TRX_AntDiv]\n")); -+ -+ /*BT Coexistence*/ -+ /*keep antsel_map when GNT_BT = 1*/ -+ ODM_SetBBReg(pDM_Odm, 0x864, BIT12, 1); -+ /* //Disable hw antsw & fast_train.antsw when GNT_BT=1*/ -+ ODM_SetBBReg(pDM_Odm, 0x874 , BIT23, 0); -+ /*//Disable hw antsw & fast_train.antsw when BT TX/RX*/ -+ ODM_SetBBReg(pDM_Odm, 0xE64 , 0xFFFF0000, 0x000c); -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0); -+ /*PTA setting: WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL)*/ -+ /*ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0);*/ -+ /*ODM_SetBBReg(pDM_Odm, 0x948 , BIT8, 0);*/ -+ /*GNT_WL tx*/ -+ ODM_SetBBReg(pDM_Odm, 0x950 , BIT29, 0); -+ -+ -+ /*Mapping Table*/ -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 3); -+ /*ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, 0);*/ -+ /*ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, 1);*/ -+ -+ /* //Set WLBB_SEL_RF_ON 1 if RXFIR_PWDB > 0xCcc[3:0]*/ -+ ODM_SetBBReg(pDM_Odm, 0xCcc, BIT12, 0); -+ /* //Low-to-High threshold for WLBB_SEL_RF_ON when OFDM enable*/ -+ ODM_SetBBReg(pDM_Odm, 0xCcc , 0x0F, 0x01); -+ /*//High-to-Low threshold for WLBB_SEL_RF_ON when OFDM enable*/ -+ ODM_SetBBReg(pDM_Odm, 0xCcc , 0xF0, 0x0); -+ /* //b Low-to-High threshold for WLBB_SEL_RF_ON when OFDM disable ( only CCK )*/ -+ ODM_SetBBReg(pDM_Odm, 0xAbc , 0xFF, 0x06); -+ /* //High-to-Low threshold for WLBB_SEL_RF_ON when OFDM disable ( only CCK )*/ -+ ODM_SetBBReg(pDM_Odm, 0xAbc , 0xFF00, 0x00); -+ -+ -+ /*OFDM HW AntDiv Parameters*/ -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF, 0xa0); -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF000, 0x00); -+ ODM_SetBBReg(pDM_Odm, 0xC5C , BIT20|BIT19|BIT18, 0x04); -+ -+ /*CCK HW AntDiv Parameters*/ -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); -+ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); -+ ODM_SetBBReg(pDM_Odm, 0xAA8 , BIT8, 0); -+ -+ ODM_SetBBReg(pDM_Odm, 0xA0C , 0x0F, 0xf); -+ ODM_SetBBReg(pDM_Odm, 0xA14 , 0x1F, 0x8); -+ ODM_SetBBReg(pDM_Odm, 0xA10 , BIT13, 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT8, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xB34 , BIT30, 0x1); -+ -+ /*disable antenna training */ -+ ODM_SetBBReg(pDM_Odm, 0xE08 , BIT16, 0); -+ ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 0); -+ -+} -+ -+VOID -+phydm_set_tx_ant_pwr_8723d( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ pDM_FatTable->RxIdleAnt = Ant; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pAdapter->HalFunc.SetTxPowerLevelHandler(pAdapter, pHalData->CurrentChannel); -+ #elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ rtw_hal_set_tx_power_level(pAdapter, pHalData->CurrentChannel); -+ #endif -+ -+} -+#endif -+ -+#if (RTL8723B_SUPPORT == 1) -+VOID -+odm_TRX_HWAntDiv_Init_8723B( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8723B AntDiv_Init => AntDivType=[CG_TRX_HW_ANTDIV(DPDT)]\n")); -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 1); -+ -+ //OFDM HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF, 0xa0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF000, 0x00); //bias -+ -+ //CCK HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M -+ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples -+ -+ //BT Coexistence -+ ODM_SetBBReg(pDM_Odm, 0x864, BIT12, 0); //keep antsel_map when GNT_BT = 1 -+ ODM_SetBBReg(pDM_Odm, 0x874 , BIT23, 0); //Disable hw antsw & fast_train.antsw when GNT_BT=1 -+ -+ //Output Pin Settings -+ ODM_SetBBReg(pDM_Odm, 0x870 , BIT8, 0); // -+ -+ ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0); //WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL) -+ ODM_SetBBReg(pDM_Odm, 0x948 , BIT7, 0); -+ -+ ODM_SetMACReg(pDM_Odm, 0x40 , BIT3, 1); -+ ODM_SetMACReg(pDM_Odm, 0x38 , BIT11, 1); -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT24|BIT23, 2); //select DPDT_P and DPDT_N as output pin -+ -+ ODM_SetBBReg(pDM_Odm, 0x944 , BIT0|BIT1, 3); //in/out -+ ODM_SetBBReg(pDM_Odm, 0x944 , BIT31, 0); // -+ -+ ODM_SetBBReg(pDM_Odm, 0x92C , BIT1, 0); //DPDT_P non-inverse -+ ODM_SetBBReg(pDM_Odm, 0x92C , BIT0, 1); //DPDT_N inverse -+ -+ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF0, 8); // DPDT_P = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF, 8); // DPDT_N = ANTSEL[0] -+ -+ //2 [--For HW Bug Setting] -+ if(pDM_Odm->AntType == ODM_AUTO_ANT) -+ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable -+ -+} -+ -+ -+ -+VOID -+odm_S0S1_SWAntDiv_Init_8723B( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8723B AntDiv_Init => AntDivType=[ S0S1_SW_AntDiv] \n")); -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 1); -+ -+ //Output Pin Settings -+ //ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0); -+ -+ pDM_FatTable->bBecomeLinked =FALSE; -+ pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; -+ pDM_SWAT_Table->Double_chk_flag = 0; -+ -+ //2 [--For HW Bug Setting] -+ ODM_SetBBReg(pDM_Odm, 0x80C , BIT21, 0); //TX Ant by Reg -+ -+} -+ -+VOID -+ODM_UpdateRxIdleAnt_8723B( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant, -+ IN u4Byte DefaultAnt, -+ IN u4Byte OptionalAnt -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u1Byte count=0; -+ u1Byte u1Temp; -+ u1Byte H2C_Parameter; -+ -+ if ((!pDM_Odm->bLinked) && (pDM_Odm->AntType == ODM_AUTO_ANT)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to no link\n")); -+ return; -+ } -+ -+#if 0 -+ // Send H2C command to FW -+ // Enable wifi calibration -+ H2C_Parameter = TRUE; -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_WIFI_CALIBRATION, 1, &H2C_Parameter); -+ -+ // Check if H2C command sucess or not (0x1e6) -+ u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e6); -+ while((u1Temp != 0x1) && (count < 100)) -+ { -+ ODM_delay_us(10); -+ u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e6); -+ count++; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: H2C command status = %d, count = %d\n", u1Temp, count)); -+ -+ if(u1Temp == 0x1) -+ { -+ // Check if BT is doing IQK (0x1e7) -+ count = 0; -+ u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e7); -+ while((!(u1Temp & BIT0)) && (count < 100)) -+ { -+ ODM_delay_us(50); -+ u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e7); -+ count++; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: BT IQK status = %d, count = %d\n", u1Temp, count)); -+ -+ if(u1Temp & BIT0) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x948 , BIT9, DefaultAnt); -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, DefaultAnt); //Default RX -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, OptionalAnt); //Optional RX -+ ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, DefaultAnt); //Default TX -+ pDM_FatTable->RxIdleAnt = Ant; -+ -+ // Set TX AGC by S0/S1 -+ // Need to consider Linux driver -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pAdapter->HalFunc.SetTxPowerLevelHandler(pAdapter, pHalData->CurrentChannel); -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ rtw_hal_set_tx_power_level(pAdapter, pHalData->CurrentChannel); -+#endif -+ -+ // Set IQC by S0/S1 -+ ODM_SetIQCbyRFpath(pDM_Odm,DefaultAnt); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Sucess to set RX antenna\n")); -+ } -+ else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to BT IQK\n")); -+ } -+ else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to H2C command fail\n")); -+ -+ // Send H2C command to FW -+ // Disable wifi calibration -+ H2C_Parameter = FALSE; -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_WIFI_CALIBRATION, 1, &H2C_Parameter); -+#else -+ -+ ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x948 , BIT9, DefaultAnt); -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, DefaultAnt); /*Default RX*/ -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, OptionalAnt); /*Optional RX*/ -+ ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, DefaultAnt); /*Default TX*/ -+ pDM_FatTable->RxIdleAnt = Ant; -+ -+ /* Set TX AGC by S0/S1 */ -+ /* Need to consider Linux driver */ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pAdapter->HalFunc.SetTxPowerLevelHandler(pAdapter, pHalData->CurrentChannel); -+ #elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ rtw_hal_set_tx_power_level(pAdapter, pHalData->CurrentChannel); -+ #endif -+ -+ /* Set IQC by S0/S1 */ -+ ODM_SetIQCbyRFpath(pDM_Odm, DefaultAnt); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Success to set RX antenna\n")); -+ -+#endif -+} -+ -+BOOLEAN -+phydm_IsBtEnable_8723b( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte bt_state; -+ /*u4Byte reg75;*/ -+ -+ /*reg75 = ODM_GetBBReg(pDM_Odm, 0x74 , BIT8);*/ -+ /*ODM_SetBBReg(pDM_Odm, 0x74 , BIT8, 0x0);*/ -+ ODM_SetBBReg(pDM_Odm, 0xa0 , BIT24|BIT25|BIT26, 0x5); -+ bt_state = ODM_GetBBReg(pDM_Odm, 0xa0 , (BIT3|BIT2|BIT1|BIT0)); -+ /*ODM_SetBBReg(pDM_Odm, 0x74 , BIT8, reg75);*/ -+ -+ if ((bt_state == 4) || (bt_state == 7) || (bt_state == 9) || (bt_state == 13)) -+ return TRUE; -+ else -+ return FALSE; -+} -+#endif //#if (RTL8723B_SUPPORT == 1) -+ -+#if (RTL8821A_SUPPORT == 1) -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+VOID -+phydm_hl_smart_ant_type1_init_8821a( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u4Byte value32; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A SmartAnt_Init => AntDivType=[Hong-Lin Smart Ant Type1]\n")); -+ -+ /*---------------------------------------- -+ GPIO 2-3 for Beam control -+ reg0x66[2]=0 -+ reg0x44[27:26] = 0 -+ reg0x44[23:16] //enable_output for P_GPIO[7:0] -+ reg0x44[15:8] //output_value for P_GPIO[7:0] -+ reg0x40[1:0] = 0 //GPIO function -+ ------------------------------------------*/ -+ -+ /*GPIO Setting*/ -+ ODM_SetMACReg(pDM_Odm, 0x64 , BIT18, 0); -+ ODM_SetMACReg(pDM_Odm, 0x44 , BIT27|BIT26, 0); -+ ODM_SetMACReg(pDM_Odm, 0x44 , BIT19|BIT18, 0x3); /*enable_output for P_GPIO[3:2]*/ -+ /*ODM_SetMACReg(pDM_Odm, 0x44 , BIT11|BIT10, 0);*/ /*output value*/ -+ ODM_SetMACReg(pDM_Odm, 0x40 , BIT1|BIT0, 0); /*GPIO function*/ -+ -+ /*Hong_lin smart antenna HW Setting*/ -+ pdm_sat_table->data_codeword_bit_num = 24;/*max=32*/ -+ pdm_sat_table->beam_patten_num_each_ant = 4; -+ -+ #if DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ pdm_sat_table->latch_time = 100; /*mu sec*/ -+ #elif DEV_BUS_TYPE == RT_USB_INTERFACE -+ pdm_sat_table->latch_time = 100; /*mu sec*/ -+ #endif -+ pdm_sat_table->pkt_skip_statistic_en = 0; -+ -+ pdm_sat_table->ant_num = 1;/*max=8*/ -+ pdm_sat_table->ant_num_total = NUM_ANTENNA_8821A; -+ pdm_sat_table->first_train_ant = MAIN_ANT; -+ -+ pdm_sat_table->rfu_codeword_table[0] = 0x0; -+ pdm_sat_table->rfu_codeword_table[1] = 0x4; -+ pdm_sat_table->rfu_codeword_table[2] = 0x8; -+ pdm_sat_table->rfu_codeword_table[3] = 0xc; -+ -+ pdm_sat_table->rfu_codeword_table_5g[0] = 0x1; -+ pdm_sat_table->rfu_codeword_table_5g[1] = 0x2; -+ pdm_sat_table->rfu_codeword_table_5g[2] = 0x4; -+ pdm_sat_table->rfu_codeword_table_5g[3] = 0x8; -+ -+ pdm_sat_table->fix_beam_pattern_en = 0; -+ pdm_sat_table->decision_holding_period = 0; -+ -+ /*beam training setting*/ -+ pdm_sat_table->pkt_counter = 0; -+ pdm_sat_table->per_beam_training_pkt_num = 10; -+ -+ /*set default beam*/ -+ pdm_sat_table->fast_training_beam_num = 0; -+ pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; -+ phydm_set_all_ant_same_beam_num(pDM_Odm); -+ -+ pDM_FatTable->FAT_State = FAT_BEFORE_LINK_STATE; -+ -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskDWord, 0x01000100); -+ ODM_SetBBReg(pDM_Odm, 0xCA8 , bMaskDWord, 0x01000100); -+ -+ /*[BB] FAT Setting*/ -+ ODM_SetBBReg(pDM_Odm, 0xc08 , BIT18|BIT17|BIT16, pdm_sat_table->ant_num); -+ ODM_SetBBReg(pDM_Odm, 0xc08 , BIT31, 0); /*increase ant num every FAT period 0:+1, 1+2*/ -+ ODM_SetBBReg(pDM_Odm, 0x8c4 , BIT2|BIT1, 1); /*change cca antenna timming threshold if no CCA occurred: 0:200ms / 1:100ms / 2:no use / 3: 300*/ -+ ODM_SetBBReg(pDM_Odm, 0x8c4 , BIT0, 1); /*FAT_watchdog_en*/ -+ -+ value32 = ODM_GetMACReg(pDM_Odm, 0x7B4, bMaskDWord); -+ ODM_SetMACReg(pDM_Odm, 0x7b4, bMaskDWord, value32|(BIT16|BIT17)); /*Reg7B4[16]=1 enable antenna training */ -+ /*Reg7B4[17]=1 enable match MAC Addr*/ -+ ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, 0);/*Match MAC ADDR*/ -+ ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, 0); -+ -+} -+#endif -+ -+VOID -+odm_TRX_HWAntDiv_Init_8821A( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (DPDT)] \n")); -+ -+ //Output Pin Settings -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); -+ -+ ODM_SetMACReg(pDM_Odm, 0x64 , BIT29, 1); //PAPE by WLAN control -+ ODM_SetMACReg(pDM_Odm, 0x64 , BIT28, 1); //LNAON by WLAN control -+ -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , bMaskDWord, 0x77775745); -+ ODM_SetBBReg(pDM_Odm, 0xCB8 , BIT16, 0); -+ -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT23, 0); //select DPDT_P and DPDT_N as output pin -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT24, 1); //by WLAN control -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF, 8); // DPDT_P = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF0, 8); // DPDT_N = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT29, 0); //DPDT_P non-inverse -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT28, 1); //DPDT_N inverse -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); -+ -+ //OFDM HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x10); //bias -+ -+ //CCK HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M -+ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples -+ -+ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //ANTSEL_CCK sent to the smart_antenna circuit -+ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable -+ -+ //BT Coexistence -+ ODM_SetBBReg(pDM_Odm, 0xCAC , BIT9, 1); //keep antsel_map when GNT_BT = 1 -+ ODM_SetBBReg(pDM_Odm, 0x804 , BIT4, 1); //Disable hw antsw & fast_train.antsw when GNT_BT=1 -+ -+ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns -+ -+ //response TX ant by RX ant -+ ODM_SetMACReg(pDM_Odm, 0x668 , BIT3, 1); -+ -+} -+ -+VOID -+odm_S0S1_SWAntDiv_Init_8821A( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A AntDiv_Init => AntDivType=[ S0S1_SW_AntDiv]\n")); -+ -+ //Output Pin Settings -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); -+ -+ ODM_SetMACReg(pDM_Odm, 0x64 , BIT29, 1); //PAPE by WLAN control -+ ODM_SetMACReg(pDM_Odm, 0x64 , BIT28, 1); //LNAON by WLAN control -+ -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , bMaskDWord, 0x77775745); -+ ODM_SetBBReg(pDM_Odm, 0xCB8 , BIT16, 0); -+ -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT23, 0); //select DPDT_P and DPDT_N as output pin -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT24, 1); //by WLAN control -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF, 8); // DPDT_P = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF0, 8); // DPDT_N = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT29, 0); //DPDT_P non-inverse -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT28, 1); //DPDT_N inverse -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); -+ -+ //OFDM HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x10); //bias -+ -+ //CCK HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M -+ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples -+ -+ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //ANTSEL_CCK sent to the smart_antenna circuit -+ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable -+ -+ //BT Coexistence -+ ODM_SetBBReg(pDM_Odm, 0xCAC , BIT9, 1); //keep antsel_map when GNT_BT = 1 -+ ODM_SetBBReg(pDM_Odm, 0x804 , BIT4, 1); //Disable hw antsw & fast_train.antsw when GNT_BT=1 -+ -+ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns -+ -+ //response TX ant by RX ant -+ ODM_SetMACReg(pDM_Odm, 0x668 , BIT3, 1); -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, 0); -+ -+ pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; -+ pDM_SWAT_Table->Double_chk_flag = 0; -+ pDM_SWAT_Table->CurAntenna = MAIN_ANT; -+ pDM_SWAT_Table->PreAntenna = MAIN_ANT; -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ -+} -+#endif //#if (RTL8821A_SUPPORT == 1) -+ -+#if (RTL8821C_SUPPORT == 1) -+VOID -+odm_TRX_HWAntDiv_Init_8821C( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821C AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (DPDT)] \n")); -+ //Output Pin Settings -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); -+ -+ ODM_SetMACReg(pDM_Odm, 0x64 , BIT29, 1); //PAPE by WLAN control -+ ODM_SetMACReg(pDM_Odm, 0x64 , BIT28, 1); //LNAON by WLAN control -+ -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , bMaskDWord, 0x77775745); -+ ODM_SetBBReg(pDM_Odm, 0xCB8 , BIT16, 0); -+ -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT23, 0); //select DPDT_P and DPDT_N as output pin -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT24, 1); //by WLAN control -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF, 8); // DPDT_P = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF0, 8); // DPDT_N = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT29, 0); //DPDT_P non-inverse -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT28, 1); //DPDT_N inverse -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); -+ -+ //OFDM HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x10); //bias -+ -+ //CCK HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M -+ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples -+ -+ ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //ANTSEL_CCK sent to the smart_antenna circuit -+ ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable -+ -+ //BT Coexistence -+ ODM_SetBBReg(pDM_Odm, 0xCAC , BIT9, 1); //keep antsel_map when GNT_BT = 1 -+ ODM_SetBBReg(pDM_Odm, 0x804 , BIT4, 1); //Disable hw antsw & fast_train.antsw when GNT_BT=1 -+ -+ //Timming issue -+ ODM_SetBBReg(pDM_Odm, 0x818 , BIT23|BIT22|BIT21|BIT20, 8); /*keep antidx after tx for ACK ( unit x 3.2 mu sec)*/ -+ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns -+ -+ //response TX ant by RX ant -+ ODM_SetMACReg(pDM_Odm, 0x668 , BIT3, 1); -+ -+} -+#endif //#if (RTL8821C_SUPPORT == 1) -+ -+ -+#if (RTL8881A_SUPPORT == 1) -+VOID -+odm_TRX_HWAntDiv_Init_8881A( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8881A AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (SPDT)] \n")); -+ -+ //Output Pin Settings -+ // [SPDT related] -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); -+ ODM_SetMACReg(pDM_Odm, 0x4C , BIT26, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT31, 0); //delay buffer -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT22, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT24, 1); -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF00, 8); // DPDT_P = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF0000, 8); // DPDT_N = ANTSEL[0] -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); -+ -+ //OFDM HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x0); //bias -+ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns -+ -+ //CCK HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M -+ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples -+ -+ //2 [--For HW Bug Setting] -+ -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, 0); //TX Ant by Reg // A-cut bug -+} -+ -+#endif //#if (RTL8881A_SUPPORT == 1) -+ -+ -+#if (RTL8812A_SUPPORT == 1) -+VOID -+odm_TRX_HWAntDiv_Init_8812A( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8812A AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (SPDT)] \n")); -+ -+ //3 //3 --RFE pin setting--------- -+ //[BB] -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT10|BIT9|BIT8, 0x0); //disable SW switch -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT17|BIT16, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x974 , BIT7|BIT6, 0x3); // in/out -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT31, 0); //delay buffer -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT26, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT27, 1); -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF000000, 8); // DPDT_P = ANTSEL[0] -+ ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF0000000, 8); // DPDT_N = ANTSEL[0] -+ //3 ------------------------- -+ -+ //Mapping Table -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); -+ ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); -+ -+ //OFDM HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold -+ ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x0); //bias -+ ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns -+ -+ //CCK HW AntDiv Parameters -+ ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M -+ ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples -+ -+ //2 [--For HW Bug Setting] -+ -+ ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, 0); //TX Ant by Reg // A-cut bug -+ -+} -+ -+#endif //#if (RTL8812A_SUPPORT == 1) -+ -+#if (RTL8188F_SUPPORT == 1) -+VOID -+odm_S0S1_SWAntDiv_Init_8188F( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188F AntDiv_Init => AntDivType=[ S0S1_SW_AntDiv]\n")); -+ -+ -+ /*GPIO Setting*/ -+ /*ODM_SetMACReg(pDM_Odm, 0x64 , BIT18, 0); */ -+ /*ODM_SetMACReg(pDM_Odm, 0x44 , BIT28|BIT27, 0);*/ -+ ODM_SetMACReg(pDM_Odm, 0x44 , BIT20|BIT19, 0x3); /*enable_output for P_GPIO[4:3]*/ -+ /*ODM_SetMACReg(pDM_Odm, 0x44 , BIT12|BIT11, 0);*/ /*output value*/ -+ /*ODM_SetMACReg(pDM_Odm, 0x40 , BIT1|BIT0, 0);*/ /*GPIO function*/ -+ -+ pDM_FatTable->bBecomeLinked = FALSE; -+ pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; -+ pDM_SWAT_Table->Double_chk_flag = 0; -+} -+ -+VOID -+phydm_update_rx_idle_antenna_8188F( -+ IN PVOID pDM_VOID, -+ IN u4Byte default_ant -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte codeword; -+ -+ if (default_ant == ANT1_2G) -+ codeword = 1; /*2'b01*/ -+ else -+ codeword = 2;/*2'b10*/ -+ -+ ODM_SetMACReg(pDM_Odm, 0x44 , (BIT12|BIT11), codeword); /*GPIO[4:3] output value*/ -+} -+ -+#endif -+ -+ -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ -+VOID -+odm_EVM_FastAnt_Reset( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ pDM_FatTable->EVM_method_enable=0; -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; -+ pDM_Odm->antdiv_period=0; -+ ODM_SetMACReg(pDM_Odm, 0x608, BIT8, 0); -+} -+ -+ -+VOID -+odm_EVM_Enhance_AntDiv( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte Main_RSSI, Aux_RSSI ; -+ u4Byte Main_CRC_utility=0,Aux_CRC_utility=0,utility_ratio=1; -+ u4Byte Main_EVM, Aux_EVM,Diff_RSSI=0,diff_EVM=0; -+ u1Byte score_EVM=0,score_CRC=0; -+ u1Byte rssi_larger_ant = 0; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u4Byte value32, i; -+ BOOLEAN Main_above1=FALSE,Aux_above1=FALSE; -+ BOOLEAN Force_antenna=FALSE; -+ PSTA_INFO_T pEntry; -+ pDM_FatTable->TargetAnt_enhance=0xFF; -+ -+ -+ if((pDM_Odm->SupportICType & ODM_EVM_ENHANCE_ANTDIV_SUPPORT_IC)) -+ { -+ if(pDM_Odm->bOneEntryOnly) -+ { -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[One Client only] \n")); -+ i = pDM_Odm->OneEntry_MACID; -+ -+ Main_RSSI = (pDM_FatTable->MainAnt_Cnt[i]!=0)?(pDM_FatTable->MainAnt_Sum[i]/pDM_FatTable->MainAnt_Cnt[i]):0; -+ Aux_RSSI = (pDM_FatTable->AuxAnt_Cnt[i]!=0)?(pDM_FatTable->AuxAnt_Sum[i]/pDM_FatTable->AuxAnt_Cnt[i]):0; -+ -+ if((Main_RSSI==0 && Aux_RSSI !=0 && Aux_RSSI>=FORCE_RSSI_DIFF) || (Main_RSSI!=0 && Aux_RSSI==0 && Main_RSSI>=FORCE_RSSI_DIFF)) -+ { -+ Diff_RSSI=FORCE_RSSI_DIFF; -+ } -+ else if(Main_RSSI!=0 && Aux_RSSI !=0) -+ { -+ Diff_RSSI = (Main_RSSI>=Aux_RSSI)?(Main_RSSI-Aux_RSSI):(Aux_RSSI-Main_RSSI); -+ } -+ -+ if (Main_RSSI >= Aux_RSSI) -+ rssi_larger_ant = MAIN_ANT; -+ else -+ rssi_larger_ant = AUX_ANT; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Main_Cnt = (( %d )) , Main_RSSI= (( %d ))\n", pDM_FatTable->MainAnt_Cnt[i], Main_RSSI)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Aux_Cnt = (( %d )) , Aux_RSSI = (( %d ))\n", pDM_FatTable->AuxAnt_Cnt[i], Aux_RSSI)); -+ -+ if( ((Main_RSSI>=Evm_RSSI_TH_High||Aux_RSSI>=Evm_RSSI_TH_High )|| (pDM_FatTable->EVM_method_enable==1) ) -+ //&& (Diff_RSSI <= FORCE_RSSI_DIFF + 1) -+ ) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[> TH_H || EVM_method_enable==1] && ")); -+ -+ if(((Main_RSSI>=Evm_RSSI_TH_Low)||(Aux_RSSI>=Evm_RSSI_TH_Low) )) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[> TH_L ] \n")); -+ -+ //2 [ Normal state Main] -+ if(pDM_FatTable->FAT_State == NORMAL_STATE_MIAN) -+ { -+ -+ pDM_FatTable->EVM_method_enable=1; -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ pDM_Odm->antdiv_period = pDM_Odm->evm_antdiv_period; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ start training: MIAN] \n")); -+ pDM_FatTable->MainAntEVM_Sum[i] = 0; -+ pDM_FatTable->AuxAntEVM_Sum[i] = 0; -+ pDM_FatTable->MainAntEVM_Cnt[i] = 0; -+ pDM_FatTable->AuxAntEVM_Cnt[i] = 0; -+ -+ pDM_FatTable->FAT_State = NORMAL_STATE_AUX; -+ ODM_SetMACReg(pDM_Odm, 0x608, BIT8, 1); //Accept CRC32 Error packets. -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ -+ pDM_FatTable->CRC32_Ok_Cnt=0; -+ pDM_FatTable->CRC32_Fail_Cnt=0; -+ ODM_SetTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer, pDM_Odm->antdiv_intvl ); //m -+ } -+ //2 [ Normal state Aux ] -+ else if(pDM_FatTable->FAT_State == NORMAL_STATE_AUX) -+ { -+ pDM_FatTable->MainCRC32_Ok_Cnt=pDM_FatTable->CRC32_Ok_Cnt; -+ pDM_FatTable->MainCRC32_Fail_Cnt=pDM_FatTable->CRC32_Fail_Cnt; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ start training: AUX] \n")); -+ pDM_FatTable->FAT_State = TRAINING_STATE; -+ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); -+ -+ pDM_FatTable->CRC32_Ok_Cnt=0; -+ pDM_FatTable->CRC32_Fail_Cnt=0; -+ ODM_SetTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer, pDM_Odm->antdiv_intvl ); //ms -+ } -+ else if(pDM_FatTable->FAT_State == TRAINING_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Training state ] \n")); -+ pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; -+ -+ //3 [CRC32 statistic] -+ pDM_FatTable->AuxCRC32_Ok_Cnt=pDM_FatTable->CRC32_Ok_Cnt; -+ pDM_FatTable->AuxCRC32_Fail_Cnt=pDM_FatTable->CRC32_Fail_Cnt; -+ -+ if ((pDM_FatTable->MainCRC32_Ok_Cnt > ((pDM_FatTable->AuxCRC32_Ok_Cnt)<<1)) || ((Diff_RSSI >= 20) && (rssi_larger_ant == MAIN_ANT))) { -+ pDM_FatTable->TargetAnt_CRC32=MAIN_ANT; -+ Force_antenna=TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CRC32 Force Main\n")); -+ } else if ((pDM_FatTable->AuxCRC32_Ok_Cnt > ((pDM_FatTable->MainCRC32_Ok_Cnt)<<1)) || ((Diff_RSSI >= 20) && (rssi_larger_ant == AUX_ANT))) { -+ pDM_FatTable->TargetAnt_CRC32=AUX_ANT; -+ Force_antenna=TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CRC32 Force Aux\n")); -+ } -+ else -+ { -+ if(pDM_FatTable->MainCRC32_Fail_Cnt<=5) -+ pDM_FatTable->MainCRC32_Fail_Cnt=5; -+ -+ if(pDM_FatTable->AuxCRC32_Fail_Cnt<=5) -+ pDM_FatTable->AuxCRC32_Fail_Cnt=5; -+ -+ if(pDM_FatTable->MainCRC32_Ok_Cnt >pDM_FatTable->MainCRC32_Fail_Cnt ) -+ Main_above1=TRUE; -+ -+ if(pDM_FatTable->AuxCRC32_Ok_Cnt >pDM_FatTable->AuxCRC32_Fail_Cnt ) -+ Aux_above1=TRUE; -+ -+ if(Main_above1==TRUE && Aux_above1==FALSE) -+ { -+ Force_antenna=TRUE; -+ pDM_FatTable->TargetAnt_CRC32=MAIN_ANT; -+ } -+ else if(Main_above1==FALSE && Aux_above1==TRUE) -+ { -+ Force_antenna=TRUE; -+ pDM_FatTable->TargetAnt_CRC32=AUX_ANT; -+ } -+ else if(Main_above1==TRUE && Aux_above1==TRUE) -+ { -+ Main_CRC_utility=((pDM_FatTable->MainCRC32_Ok_Cnt)<<7)/pDM_FatTable->MainCRC32_Fail_Cnt; -+ Aux_CRC_utility=((pDM_FatTable->AuxCRC32_Ok_Cnt)<<7)/pDM_FatTable->AuxCRC32_Fail_Cnt; -+ pDM_FatTable->TargetAnt_CRC32 = (Main_CRC_utility==Aux_CRC_utility)?(pDM_FatTable->pre_TargetAnt_enhance):((Main_CRC_utility>=Aux_CRC_utility)?MAIN_ANT:AUX_ANT); -+ -+ if(Main_CRC_utility!=0 && Aux_CRC_utility!=0) -+ { -+ if(Main_CRC_utility>=Aux_CRC_utility) -+ utility_ratio=(Main_CRC_utility<<1)/Aux_CRC_utility; -+ else -+ utility_ratio=(Aux_CRC_utility<<1)/Main_CRC_utility; -+ } -+ } -+ else if(Main_above1==FALSE && Aux_above1==FALSE) -+ { -+ if(pDM_FatTable->MainCRC32_Ok_Cnt==0) -+ pDM_FatTable->MainCRC32_Ok_Cnt=1; -+ if(pDM_FatTable->AuxCRC32_Ok_Cnt==0) -+ pDM_FatTable->AuxCRC32_Ok_Cnt=1; -+ -+ Main_CRC_utility=((pDM_FatTable->MainCRC32_Fail_Cnt)<<7)/pDM_FatTable->MainCRC32_Ok_Cnt; -+ Aux_CRC_utility=((pDM_FatTable->AuxCRC32_Fail_Cnt)<<7)/pDM_FatTable->AuxCRC32_Ok_Cnt; -+ pDM_FatTable->TargetAnt_CRC32 = (Main_CRC_utility==Aux_CRC_utility)?(pDM_FatTable->pre_TargetAnt_enhance):((Main_CRC_utility<=Aux_CRC_utility)?MAIN_ANT:AUX_ANT); -+ -+ if(Main_CRC_utility!=0 && Aux_CRC_utility!=0) -+ { -+ if(Main_CRC_utility>=Aux_CRC_utility) -+ utility_ratio=(Main_CRC_utility<<1)/(Aux_CRC_utility); -+ else -+ utility_ratio=(Aux_CRC_utility<<1)/(Main_CRC_utility); -+ } -+ } -+ } -+ ODM_SetMACReg(pDM_Odm, 0x608, BIT8, 0);//NOT Accept CRC32 Error packets. -+ -+ //3 [EVM statistic] -+ Main_EVM = (pDM_FatTable->MainAntEVM_Cnt[i]!=0)?(pDM_FatTable->MainAntEVM_Sum[i]/pDM_FatTable->MainAntEVM_Cnt[i]):0; -+ Aux_EVM = (pDM_FatTable->AuxAntEVM_Cnt[i]!=0)?(pDM_FatTable->AuxAntEVM_Sum[i]/pDM_FatTable->AuxAntEVM_Cnt[i]):0; -+ pDM_FatTable->TargetAnt_EVM = (Main_EVM==Aux_EVM)?(pDM_FatTable->pre_TargetAnt_enhance):((Main_EVM>=Aux_EVM)?MAIN_ANT:AUX_ANT); -+ -+ if((Main_EVM==0 || Aux_EVM==0)) -+ diff_EVM=0; -+ else if(Main_EVM>=Aux_EVM) -+ diff_EVM=Main_EVM-Aux_EVM; -+ else -+ diff_EVM=Aux_EVM-Main_EVM; -+ -+ //2 [ Decision state ] -+ if (pDM_FatTable->TargetAnt_EVM == pDM_FatTable->TargetAnt_CRC32) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 1, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); -+ -+ if ((utility_ratio < 2 && Force_antenna == FALSE) && diff_EVM <= 30) -+ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->pre_TargetAnt_enhance; -+ else -+ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_EVM; -+ } else if ((diff_EVM <= 50 && (utility_ratio > 4 && Force_antenna == FALSE)) || (Force_antenna == TRUE)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 2, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); -+ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_CRC32; -+ } else if (diff_EVM >= 100) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 3, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); -+ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_EVM; -+ } else if (utility_ratio >= 6 && Force_antenna == FALSE) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 4, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); -+ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_CRC32; -+ } else { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 5, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); -+ -+ if (Force_antenna == TRUE) -+ score_CRC = 3; -+ else if (utility_ratio >= 3) /*>0.5*/ -+ score_CRC = 2; -+ else if (utility_ratio >= 2) /*>1*/ -+ score_CRC = 1; -+ else -+ score_CRC = 0; -+ -+ if (diff_EVM >= 100) -+ score_EVM = 2; -+ else if (diff_EVM >= 50) -+ score_EVM = 1; -+ else -+ score_EVM = 0; -+ -+ if (score_CRC > score_EVM) -+ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_CRC32; -+ else if (score_CRC < score_EVM) -+ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_EVM; -+ else -+ pDM_FatTable->TargetAnt_enhance = pDM_FatTable->pre_TargetAnt_enhance; -+ } -+ pDM_FatTable->pre_TargetAnt_enhance=pDM_FatTable->TargetAnt_enhance; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MainEVM_Cnt = (( %d )) , Main_EVM= (( %d )) \n",i, pDM_FatTable->MainAntEVM_Cnt[i], Main_EVM)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : AuxEVM_Cnt = (( %d )) , Aux_EVM = (( %d )) \n" ,i, pDM_FatTable->AuxAntEVM_Cnt[i] , Aux_EVM)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** TargetAnt_EVM = (( %s ))\n", ( pDM_FatTable->TargetAnt_EVM ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("M_CRC_Ok = (( %d )) , M_CRC_Fail = (( %d )), Main_CRC_utility = (( %d )) \n" , pDM_FatTable->MainCRC32_Ok_Cnt, pDM_FatTable->MainCRC32_Fail_Cnt,Main_CRC_utility)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("A_CRC_Ok = (( %d )) , A_CRC_Fail = (( %d )), Aux_CRC_utility = (( %d )) \n" , pDM_FatTable->AuxCRC32_Ok_Cnt, pDM_FatTable->AuxCRC32_Fail_Cnt,Aux_CRC_utility)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** TargetAnt_CRC32 = (( %s ))\n", ( pDM_FatTable->TargetAnt_CRC32 ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("****** TargetAnt_enhance = (( %s ))******\n", ( pDM_FatTable->TargetAnt_enhance ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ -+ -+ } -+ } -+ else // RSSI< = Evm_RSSI_TH_Low -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ TH_L ] \n")); -+ odm_EVM_FastAnt_Reset(pDM_Odm); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[escape from> TH_H || EVM_method_enable==1] \n")); -+ odm_EVM_FastAnt_Reset(pDM_Odm); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[multi-Client] \n")); -+ odm_EVM_FastAnt_Reset(pDM_Odm); -+ } -+ } -+} -+ -+VOID -+odm_EVM_FastAntTrainingCallback( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_EVM_FastAntTrainingCallback****** \n")); -+ odm_HW_AntDiv(pDM_Odm); -+} -+#endif -+ -+VOID -+odm_HW_AntDiv( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte i,MinMaxRSSI=0xFF, AntDivMaxRSSI=0, MaxRSSI=0, LocalMaxRSSI; -+ u4Byte Main_RSSI, Aux_RSSI, mian_cnt, aux_cnt; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u1Byte RxIdleAnt = pDM_FatTable->RxIdleAnt, TargetAnt = 7; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ PSTA_INFO_T pEntry; -+ -+ #if (BEAMFORMING_SUPPORT == 1) -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; -+ u4Byte TH1=500000; -+ u4Byte TH2=10000000; -+ u4Byte MA_rx_Temp, degrade_TP_temp, improve_TP_temp; -+ u1Byte Monitor_RSSI_threshold=30; -+ -+ pDM_BdcTable->BF_pass=TRUE; -+ pDM_BdcTable->DIV_pass=TRUE; -+ pDM_BdcTable->bAll_DivSta_Idle=TRUE; -+ pDM_BdcTable->bAll_BFSta_Idle=TRUE; -+ pDM_BdcTable->num_BfTar=0 ; -+ pDM_BdcTable->num_DivTar=0; -+ pDM_BdcTable->num_Client=0; -+ #endif -+ #endif -+ -+ if(!pDM_Odm->bLinked) //bLinked==False -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); -+ -+ if(pDM_FatTable->bBecomeLinked == TRUE) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); -+ pDM_Odm->antdiv_period=0; -+ -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ return; -+ } -+ else -+ { -+ if(pDM_FatTable->bBecomeLinked ==FALSE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ /*odm_Tx_By_TxDesc_or_Reg(pDM_Odm , TX_BY_DESC);*/ -+ -+ //if(pDM_Odm->SupportICType == ODM_RTL8821 ) -+ //ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //CCK AntDiv function disable -+ -+ //#if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ //else if(pDM_Odm->SupportICType == ODM_RTL8881A) -+ // ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //CCK AntDiv function disable -+ //#endif -+ -+ //else if(pDM_Odm->SupportICType == ODM_RTL8723B ||pDM_Odm->SupportICType == ODM_RTL8812) -+ //ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function disable -+ -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ -+ if(pDM_Odm->SupportICType==ODM_RTL8723B && pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF0, 8); // DPDT_P = ANTSEL[0] // for 8723B AntDiv function patch. BB Dino 130412 -+ ODM_SetBBReg(pDM_Odm, 0x930 , 0xF, 8); // DPDT_N = ANTSEL[0] -+ } -+ -+ //2 BDC Init -+ #if (BEAMFORMING_SUPPORT == 1) -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ odm_BDC_Init(pDM_Odm); -+ #endif -+ #endif -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ odm_EVM_FastAnt_Reset(pDM_Odm); -+ #endif -+ } -+ } -+ -+ if (*(pDM_FatTable->pForceTxAntByDesc) == FALSE) { -+ if (pDM_Odm->bOneEntryOnly == TRUE) -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); -+ else -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); -+ } -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ if(pDM_Odm->antdiv_evm_en==1) -+ { -+ odm_EVM_Enhance_AntDiv(pDM_Odm); -+ if(pDM_FatTable->FAT_State !=NORMAL_STATE_MIAN) -+ return; -+ } -+ else -+ { -+ odm_EVM_FastAnt_Reset(pDM_Odm); -+ } -+ #endif -+ -+ //2 BDC Mode Arbitration -+ #if (BEAMFORMING_SUPPORT == 1) -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if(pDM_Odm->antdiv_evm_en == 0 ||pDM_FatTable->EVM_method_enable==0) -+ { -+ odm_BF_AntDiv_ModeArbitration(pDM_Odm); -+ } -+ #endif -+ #endif -+ -+ for (i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pEntry)) -+ { -+ //2 Caculate RSSI per Antenna -+ if ((pDM_FatTable->MainAnt_Cnt[i] != 0) || (pDM_FatTable->AuxAnt_Cnt[i] != 0)) { -+ mian_cnt = pDM_FatTable->MainAnt_Cnt[i]; -+ aux_cnt = pDM_FatTable->AuxAnt_Cnt[i]; -+ Main_RSSI = (mian_cnt != 0) ? (pDM_FatTable->MainAnt_Sum[i] / mian_cnt) : 0; -+ Aux_RSSI = (aux_cnt != 0) ? (pDM_FatTable->AuxAnt_Sum[i] / aux_cnt) : 0; -+ TargetAnt = (mian_cnt == aux_cnt) ? pDM_FatTable->RxIdleAnt : ((mian_cnt >= aux_cnt) ? MAIN_ANT : AUX_ANT); /*Use counter number for OFDM*/ -+ -+ } else { /*CCK only case*/ -+ mian_cnt = pDM_FatTable->MainAnt_Cnt_cck[i]; -+ aux_cnt = pDM_FatTable->AuxAnt_Cnt_cck[i]; -+ Main_RSSI = (mian_cnt != 0) ? (pDM_FatTable->MainAnt_Sum_cck[i] / mian_cnt) : 0; -+ Aux_RSSI = (aux_cnt != 0) ? (pDM_FatTable->AuxAnt_Sum_cck[i] / aux_cnt) : 0; -+ TargetAnt = (Main_RSSI == Aux_RSSI) ? pDM_FatTable->RxIdleAnt : ((Main_RSSI >= Aux_RSSI) ? MAIN_ANT : AUX_ANT); /*Use RSSI for CCK only case*/ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : Main_Cnt = (( %d )) , CCK_Main_Cnt = (( %d )) , Main_RSSI= (( %d )) \n",i, pDM_FatTable->MainAnt_Cnt[i], pDM_FatTable->MainAnt_Cnt_cck[i], Main_RSSI)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : Aux_Cnt = (( %d )) , CCK_Aux_Cnt = (( %d )) , Aux_RSSI = (( %d )) \n" ,i, pDM_FatTable->AuxAnt_Cnt[i] ,pDM_FatTable->AuxAnt_Cnt_cck[i], Aux_RSSI)); -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** MAC ID:[ %d ] , TargetAnt = (( %s )) \n", i ,( TargetAnt ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ -+ LocalMaxRSSI = (Main_RSSI>Aux_RSSI)?Main_RSSI:Aux_RSSI; -+ //2 Select MaxRSSI for DIG -+ if((LocalMaxRSSI > AntDivMaxRSSI) && (LocalMaxRSSI < 40)) -+ AntDivMaxRSSI = LocalMaxRSSI; -+ if(LocalMaxRSSI > MaxRSSI) -+ MaxRSSI = LocalMaxRSSI; -+ -+ //2 Select RX Idle Antenna -+ if ( (LocalMaxRSSI != 0) && (LocalMaxRSSI < MinMaxRSSI) ) -+ { -+ RxIdleAnt = TargetAnt; -+ MinMaxRSSI = LocalMaxRSSI; -+ } -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ if(pDM_Odm->antdiv_evm_en==1) -+ { -+ if(pDM_FatTable->TargetAnt_enhance!=0xFF) -+ { -+ TargetAnt=pDM_FatTable->TargetAnt_enhance; -+ RxIdleAnt = pDM_FatTable->TargetAnt_enhance; -+ } -+ } -+ #endif -+ -+ //2 Select TX Antenna -+ if(pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) -+ { -+ #if (BEAMFORMING_SUPPORT == 1) -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if(pDM_BdcTable->w_BFee_Client[i]==0) -+ #endif -+ #endif -+ { -+ odm_UpdateTxAnt(pDM_Odm, TargetAnt, i); -+ } -+ } -+ -+ //------------------------------------------------------------ -+ -+ #if (BEAMFORMING_SUPPORT == 1) -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ pDM_BdcTable->num_Client++; -+ -+ if(pDM_BdcTable->BDC_Mode==BDC_MODE_2 ||pDM_BdcTable->BDC_Mode==BDC_MODE_3) -+ { -+ //2 Byte Counter -+ -+ MA_rx_Temp= (pEntry->rx_byte_cnt_LowMAW)<<3 ; // RX TP ( bit /sec) -+ -+ if(pDM_BdcTable->BDC_state==BDC_BFer_TRAIN_STATE) -+ { -+ pDM_BdcTable->MA_rx_TP_DIV[i]= MA_rx_Temp ; -+ } -+ else -+ { -+ pDM_BdcTable->MA_rx_TP[i] =MA_rx_Temp ; -+ } -+ -+ if( (MA_rx_Temp < TH2) && (MA_rx_Temp > TH1) && (LocalMaxRSSI<=Monitor_RSSI_threshold)) -+ { -+ if(pDM_BdcTable->w_BFer_Client[i]==1) // Bfer_Target -+ { -+ pDM_BdcTable->num_BfTar++; -+ -+ if(pDM_BdcTable->BDC_state==BDC_DECISION_STATE && pDM_BdcTable->BDC_Try_flag==0) -+ { -+ improve_TP_temp = (pDM_BdcTable->MA_rx_TP_DIV[i] * 9)>>3 ; //* 1.125 -+ pDM_BdcTable->BF_pass = (pDM_BdcTable->MA_rx_TP[i] > improve_TP_temp)?TRUE:FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : { MA_rx_TP,improve_TP_temp , MA_rx_TP_DIV, BF_pass}={ %d, %d, %d , %d } \n" ,i,pDM_BdcTable->MA_rx_TP[i],improve_TP_temp,pDM_BdcTable->MA_rx_TP_DIV[i], pDM_BdcTable->BF_pass )); -+ } -+ } -+ else// DIV_Target -+ { -+ pDM_BdcTable->num_DivTar++; -+ -+ if(pDM_BdcTable->BDC_state==BDC_DECISION_STATE && pDM_BdcTable->BDC_Try_flag==0) -+ { -+ degrade_TP_temp=(pDM_BdcTable->MA_rx_TP_DIV[i]*5)>>3;//* 0.625 -+ pDM_BdcTable->DIV_pass = (pDM_BdcTable->MA_rx_TP[i] >degrade_TP_temp)?TRUE:FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : { MA_rx_TP, degrade_TP_temp , MA_rx_TP_DIV, DIV_pass}=\n{ %d, %d, %d , %d } \n" ,i,pDM_BdcTable->MA_rx_TP[i],degrade_TP_temp,pDM_BdcTable->MA_rx_TP_DIV[i], pDM_BdcTable->DIV_pass )); -+ } -+ } -+ } -+ -+ if(MA_rx_Temp > TH1) -+ { -+ if(pDM_BdcTable->w_BFer_Client[i]==1) // Bfer_Target -+ { -+ pDM_BdcTable->bAll_BFSta_Idle=FALSE; -+ } -+ else// DIV_Target -+ { -+ pDM_BdcTable->bAll_DivSta_Idle=FALSE; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : { BFmeeCap , BFmerCap} = { %d , %d } \n" ,i, pDM_BdcTable->w_BFee_Client[i] , pDM_BdcTable->w_BFer_Client[i])); -+ -+ if(pDM_BdcTable->BDC_state==BDC_BFer_TRAIN_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MA_rx_TP_DIV = (( %d )) \n",i,pDM_BdcTable->MA_rx_TP_DIV[i] )); -+ -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MA_rx_TP = (( %d )) \n",i,pDM_BdcTable->MA_rx_TP[i] )); -+ } -+ -+ } -+ #endif -+ #endif -+ -+ } -+ -+ #if (BEAMFORMING_SUPPORT == 1) -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if(pDM_BdcTable->BDC_Try_flag==0) -+ #endif -+ #endif -+ { -+ pDM_FatTable->MainAnt_Sum[i] = 0; -+ pDM_FatTable->AuxAnt_Sum[i] = 0; -+ pDM_FatTable->MainAnt_Cnt[i] = 0; -+ pDM_FatTable->AuxAnt_Cnt[i] = 0; -+ pDM_FatTable->MainAnt_Cnt_cck[i]= 0; -+ pDM_FatTable->AuxAnt_Cnt_cck[i]= 0; -+ } -+ } -+ -+ -+ -+ //2 Set RX Idle Antenna & TX Antenna(Because of HW Bug ) -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP ) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** RxIdleAnt = (( %s ))\n\n", ( RxIdleAnt ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ -+ #if (BEAMFORMING_SUPPORT == 1) -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if(pDM_BdcTable->BDC_Mode==BDC_MODE_1 ||pDM_BdcTable->BDC_Mode==BDC_MODE_3) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** BDC_RxIdleUpdate_counter = (( %d ))\n", pDM_BdcTable->BDC_RxIdleUpdate_counter)); -+ -+ if(pDM_BdcTable->BDC_RxIdleUpdate_counter==1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***Update RxIdle Antenna!!! \n")); -+ pDM_BdcTable->BDC_RxIdleUpdate_counter=30; -+ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); -+ } -+ else -+ { -+ pDM_BdcTable->BDC_RxIdleUpdate_counter--; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***NOT update RxIdle Antenna because of BF ( need to fix TX-ant)\n")); -+ } -+ } -+ else -+ #endif -+ #endif -+ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); -+ #else -+ -+ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); -+ -+ #endif//#if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ -+ -+ //2 BDC Main Algorithm -+ #if (BEAMFORMING_SUPPORT == 1) -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if(pDM_Odm->antdiv_evm_en ==0 ||pDM_FatTable->EVM_method_enable==0) -+ { -+ odm_BDCcoex_BFeeRxDiv_Arbitration(pDM_Odm); -+ } -+ #endif -+ #endif -+ -+ if(AntDivMaxRSSI == 0) -+ pDM_DigTable->AntDiv_RSSI_max = pDM_Odm->RSSI_Min; -+ else -+ pDM_DigTable->AntDiv_RSSI_max = AntDivMaxRSSI; -+ -+ pDM_DigTable->RSSI_max = MaxRSSI; -+} -+ -+ -+ -+#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ -+VOID -+odm_S0S1_SWAntDiv_Reset( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ pDM_FatTable->bBecomeLinked = FALSE; -+ pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; -+ pDM_SWAT_Table->Double_chk_flag = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_S0S1_SWAntDiv_Reset(): pDM_FatTable->bBecomeLinked = %d\n", pDM_FatTable->bBecomeLinked)); -+} -+ -+VOID -+odm_S0S1_SwAntDiv( -+ IN PVOID pDM_VOID, -+ IN u1Byte Step -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u4Byte i, MinMaxRSSI = 0xFF, LocalMaxRSSI, LocalMinRSSI; -+ u4Byte Main_RSSI, Aux_RSSI; -+ u1Byte HighTraffic_TrainTime_U = 0x32, HighTraffic_TrainTime_L = 0, Train_time_temp; -+ u1Byte LowTraffic_TrainTime_U = 200, LowTraffic_TrainTime_L = 0; -+ u1Byte RxIdleAnt = pDM_SWAT_Table->PreAntenna, TargetAnt, nextAnt = 0; -+ PSTA_INFO_T pEntry = NULL; -+ u4Byte value32; -+ -+ -+ if(!pDM_Odm->bLinked) //bLinked==False -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); -+ if(pDM_FatTable->bBecomeLinked == TRUE) -+ { -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set REG 948[9:6]=0x0\n")); -+ ODM_SetBBReg(pDM_Odm, 0x948 , (BIT9|BIT8|BIT7|BIT6), 0x0); -+ } -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ return; -+ } -+ else -+ { -+ if(pDM_FatTable->bBecomeLinked ==FALSE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ value32 = ODM_GetBBReg(pDM_Odm, 0x864, BIT5|BIT4|BIT3); -+ -+ #if (RTL8723B_SUPPORT == 1) -+ if (value32 == 0x0) -+ ODM_UpdateRxIdleAnt_8723B(pDM_Odm, MAIN_ANT, ANT1_2G, ANT2_2G); -+ else if (value32 == 0x1) -+ ODM_UpdateRxIdleAnt_8723B(pDM_Odm, AUX_ANT, ANT2_2G, ANT1_2G); -+ #endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("8723B: First link! Force antenna to %s\n",(value32 == 0x0?"MAIN":"AUX") )); -+ } -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ } -+ -+ if (*(pDM_FatTable->pForceTxAntByDesc) == FALSE) { -+ if (pDM_Odm->bOneEntryOnly == TRUE) -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); -+ else -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[%d] { try_flag=(( %d )), Step=(( %d )), Double_chk_flag = (( %d )) }\n", -+ __LINE__,pDM_SWAT_Table->try_flag,Step,pDM_SWAT_Table->Double_chk_flag)); -+ -+ // Handling step mismatch condition. -+ // Peak step is not finished at last time. Recover the variable and check again. -+ if( Step != pDM_SWAT_Table->try_flag ) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Step != try_flag] Need to Reset After Link\n")); -+ ODM_SwAntDivRestAfterLink(pDM_Odm); -+ } -+ -+ if (pDM_SWAT_Table->try_flag == SWAW_STEP_INIT) { -+ -+ pDM_SWAT_Table->try_flag = SWAW_STEP_PEEK; -+ pDM_SWAT_Table->Train_time_flag=0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[set try_flag = 0] Prepare for peek!\n\n")); -+ return; -+ -+ } else { -+ -+ //1 Normal State (Begin Trying) -+ if (pDM_SWAT_Table->try_flag == SWAW_STEP_PEEK) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("TxOkCnt=(( %llu )), RxOkCnt=(( %llu )), TrafficLoad = (%d))\n", pDM_Odm->curTxOkCnt, pDM_Odm->curRxOkCnt, pDM_Odm->TrafficLoad)); -+ -+ if (pDM_Odm->TrafficLoad == TRAFFIC_HIGH) -+ { -+ Train_time_temp = pDM_SWAT_Table->Train_time ; -+ -+ if(pDM_SWAT_Table->Train_time_flag==3) -+ { -+ HighTraffic_TrainTime_L=0xa; -+ -+ if(Train_time_temp<=16) -+ Train_time_temp=HighTraffic_TrainTime_L; -+ else -+ Train_time_temp-=16; -+ -+ } -+ else if(pDM_SWAT_Table->Train_time_flag==2) -+ { -+ Train_time_temp-=8; -+ HighTraffic_TrainTime_L=0xf; -+ } -+ else if(pDM_SWAT_Table->Train_time_flag==1) -+ { -+ Train_time_temp-=4; -+ HighTraffic_TrainTime_L=0x1e; -+ } -+ else if(pDM_SWAT_Table->Train_time_flag==0) -+ { -+ Train_time_temp+=8; -+ HighTraffic_TrainTime_L=0x28; -+ } -+ -+ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Train_time_temp = ((%d))\n",Train_time_temp)); -+ -+ //-- -+ if(Train_time_temp > HighTraffic_TrainTime_U) -+ Train_time_temp=HighTraffic_TrainTime_U; -+ -+ else if(Train_time_temp < HighTraffic_TrainTime_L) -+ Train_time_temp=HighTraffic_TrainTime_L; -+ -+ pDM_SWAT_Table->Train_time = Train_time_temp; /*10ms~200ms*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Train_time_flag=((%d)), Train_time=((%d))\n", pDM_SWAT_Table->Train_time_flag, pDM_SWAT_Table->Train_time)); -+ -+ } else if ((pDM_Odm->TrafficLoad == TRAFFIC_MID) || (pDM_Odm->TrafficLoad == TRAFFIC_LOW)) { -+ -+ Train_time_temp=pDM_SWAT_Table->Train_time ; -+ -+ if(pDM_SWAT_Table->Train_time_flag==3) -+ { -+ LowTraffic_TrainTime_L=10; -+ if(Train_time_temp<50) -+ Train_time_temp=LowTraffic_TrainTime_L; -+ else -+ Train_time_temp-=50; -+ } -+ else if(pDM_SWAT_Table->Train_time_flag==2) -+ { -+ Train_time_temp-=30; -+ LowTraffic_TrainTime_L=36; -+ } -+ else if(pDM_SWAT_Table->Train_time_flag==1) -+ { -+ Train_time_temp-=10; -+ LowTraffic_TrainTime_L=40; -+ } else { -+ -+ Train_time_temp += 10; -+ LowTraffic_TrainTime_L = 50; -+ } -+ -+ //-- -+ if(Train_time_temp >= LowTraffic_TrainTime_U) -+ Train_time_temp=LowTraffic_TrainTime_U; -+ -+ else if(Train_time_temp <= LowTraffic_TrainTime_L) -+ Train_time_temp=LowTraffic_TrainTime_L; -+ -+ pDM_SWAT_Table->Train_time = Train_time_temp; /*10ms~200ms*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Train_time_flag=((%d)) , Train_time=((%d))\n", pDM_SWAT_Table->Train_time_flag, pDM_SWAT_Table->Train_time)); -+ -+ } else { -+ pDM_SWAT_Table->Train_time = 0xc8; /*200ms*/ -+ -+ } -+ -+ //----------------- -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Current MinMaxRSSI is ((%d))\n", pDM_FatTable->MinMaxRSSI)); -+ -+ //---reset index--- -+ if (pDM_SWAT_Table->reset_idx >= RSSI_CHECK_RESET_PERIOD) { -+ -+ pDM_FatTable->MinMaxRSSI = 0; -+ pDM_SWAT_Table->reset_idx = 0; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("reset_idx = (( %d ))\n", pDM_SWAT_Table->reset_idx)); -+ -+ pDM_SWAT_Table->reset_idx++; -+ -+ //---double check flag--- -+ if ((pDM_FatTable->MinMaxRSSI > RSSI_CHECK_THRESHOLD) && (pDM_SWAT_Table->Double_chk_flag == 0)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" MinMaxRSSI is ((%d)), and > %d\n", -+ pDM_FatTable->MinMaxRSSI, RSSI_CHECK_THRESHOLD)); -+ -+ pDM_SWAT_Table->Double_chk_flag =1; -+ pDM_SWAT_Table->try_flag = SWAW_STEP_DETERMINE; -+ pDM_SWAT_Table->RSSI_Trying = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Test the current Ant for (( %d )) ms again\n", pDM_SWAT_Table->Train_time)); -+ ODM_UpdateRxIdleAnt(pDM_Odm, pDM_FatTable->RxIdleAnt); -+ ODM_SetTimer(pDM_Odm, &(pDM_SWAT_Table->phydm_SwAntennaSwitchTimer), pDM_SWAT_Table->Train_time); /*ms*/ -+ return; -+ } -+ -+ nextAnt = (pDM_FatTable->RxIdleAnt == MAIN_ANT)? AUX_ANT : MAIN_ANT; -+ -+ pDM_SWAT_Table->try_flag = SWAW_STEP_DETERMINE; -+ -+ if(pDM_SWAT_Table->reset_idx<=1) -+ pDM_SWAT_Table->RSSI_Trying = 2; -+ else -+ pDM_SWAT_Table->RSSI_Trying = 1; -+ -+ odm_S0S1_SwAntDivByCtrlFrame(pDM_Odm, SWAW_STEP_PEEK); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[set try_flag=1] Normal State: Begin Trying!!\n")); -+ -+ } else if ((pDM_SWAT_Table->try_flag == SWAW_STEP_DETERMINE) && (pDM_SWAT_Table->Double_chk_flag == 0)) { -+ -+ nextAnt = (pDM_FatTable->RxIdleAnt == MAIN_ANT)? AUX_ANT : MAIN_ANT; -+ pDM_SWAT_Table->RSSI_Trying--; -+ } -+ -+ //1 Decision State -+ if ((pDM_SWAT_Table->try_flag == SWAW_STEP_DETERMINE) && (pDM_SWAT_Table->RSSI_Trying == 0)) { -+ -+ BOOLEAN bByCtrlFrame = FALSE; -+ u8Byte pkt_cnt_total = 0; -+ -+ for (i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pEntry)) -+ { -+ //2 Caculate RSSI per Antenna -+ Main_RSSI = (pDM_FatTable->MainAnt_Cnt[i]!=0)?(pDM_FatTable->MainAnt_Sum[i]/pDM_FatTable->MainAnt_Cnt[i]):0; -+ Aux_RSSI = (pDM_FatTable->AuxAnt_Cnt[i]!=0)?(pDM_FatTable->AuxAnt_Sum[i]/pDM_FatTable->AuxAnt_Cnt[i]):0; -+ -+ if(pDM_FatTable->MainAnt_Cnt[i]<=1 && pDM_FatTable->CCK_counter_main>=1) -+ Main_RSSI=0; -+ -+ if(pDM_FatTable->AuxAnt_Cnt[i]<=1 && pDM_FatTable->CCK_counter_aux>=1) -+ Aux_RSSI=0; -+ -+ TargetAnt = (Main_RSSI==Aux_RSSI)?pDM_SWAT_Table->PreAntenna:((Main_RSSI>=Aux_RSSI)?MAIN_ANT:AUX_ANT); -+ LocalMaxRSSI = (Main_RSSI>=Aux_RSSI) ? Main_RSSI : Aux_RSSI; -+ LocalMinRSSI = (Main_RSSI>=Aux_RSSI) ? Aux_RSSI : Main_RSSI; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** CCK_counter_main = (( %d )) , CCK_counter_aux= (( %d )) \n", pDM_FatTable->CCK_counter_main, pDM_FatTable->CCK_counter_aux)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** OFDM_counter_main = (( %d )) , OFDM_counter_aux= (( %d )) \n", pDM_FatTable->OFDM_counter_main, pDM_FatTable->OFDM_counter_aux)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Main_Cnt = (( %d )) , Main_RSSI= (( %d )) \n", pDM_FatTable->MainAnt_Cnt[i], Main_RSSI)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Aux_Cnt = (( %d )) , Aux_RSSI = (( %d )) \n", pDM_FatTable->AuxAnt_Cnt[i] , Aux_RSSI )); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** MAC ID:[ %d ] , TargetAnt = (( %s )) \n", i ,( TargetAnt ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); -+ -+ //2 Select RX Idle Antenna -+ -+ if (LocalMaxRSSI != 0 && LocalMaxRSSI < MinMaxRSSI) -+ { -+ RxIdleAnt = TargetAnt; -+ MinMaxRSSI = LocalMaxRSSI; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** LocalMaxRSSI-LocalMinRSSI = ((%d))\n",(LocalMaxRSSI-LocalMinRSSI))); -+ -+ if((LocalMaxRSSI-LocalMinRSSI)>8) -+ { -+ if(LocalMinRSSI != 0) -+ pDM_SWAT_Table->Train_time_flag=3; -+ else -+ { -+ if (MinMaxRSSI > RSSI_CHECK_THRESHOLD) -+ pDM_SWAT_Table->Train_time_flag=0; -+ else -+ pDM_SWAT_Table->Train_time_flag=3; -+ } -+ } -+ else if((LocalMaxRSSI-LocalMinRSSI)>5) -+ pDM_SWAT_Table->Train_time_flag=2; -+ else if((LocalMaxRSSI-LocalMinRSSI)>2) -+ pDM_SWAT_Table->Train_time_flag=1; -+ else -+ pDM_SWAT_Table->Train_time_flag=0; -+ -+ } -+ -+ //2 Select TX Antenna -+ if(TargetAnt == MAIN_ANT) -+ pDM_FatTable->antsel_a[i] = ANT1_2G; -+ else -+ pDM_FatTable->antsel_a[i] = ANT2_2G; -+ -+ } -+ pDM_FatTable->MainAnt_Sum[i] = 0; -+ pDM_FatTable->AuxAnt_Sum[i] = 0; -+ pDM_FatTable->MainAnt_Cnt[i] = 0; -+ pDM_FatTable->AuxAnt_Cnt[i] = 0; -+ } -+ -+ if(pDM_SWAT_Table->bSWAntDivByCtrlFrame) -+ { -+ odm_S0S1_SwAntDivByCtrlFrame(pDM_Odm, SWAW_STEP_DETERMINE); -+ bByCtrlFrame = TRUE; -+ } -+ -+ pkt_cnt_total = pDM_FatTable->CCK_counter_main + pDM_FatTable->CCK_counter_aux + -+ pDM_FatTable->OFDM_counter_main + pDM_FatTable->OFDM_counter_aux; -+ pDM_FatTable->CCK_counter_main=0; -+ pDM_FatTable->CCK_counter_aux=0; -+ pDM_FatTable->OFDM_counter_main=0; -+ pDM_FatTable->OFDM_counter_aux=0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Control frame packet counter = %d, Data frame packet counter = %llu\n", -+ pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame, pkt_cnt_total)); -+ -+ if(MinMaxRSSI == 0xff || ((pkt_cnt_total < (pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame >> 1)) && pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 2)) -+ { -+ MinMaxRSSI = 0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Check RSSI of control frame because MinMaxRSSI == 0xff\n")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("bByCtrlFrame = %d\n", bByCtrlFrame)); -+ -+ if(bByCtrlFrame) -+ { -+ Main_RSSI = (pDM_FatTable->MainAnt_CtrlFrame_Cnt!=0)?(pDM_FatTable->MainAnt_CtrlFrame_Sum/pDM_FatTable->MainAnt_CtrlFrame_Cnt):0; -+ Aux_RSSI = (pDM_FatTable->AuxAnt_CtrlFrame_Cnt!=0)?(pDM_FatTable->AuxAnt_CtrlFrame_Sum/pDM_FatTable->AuxAnt_CtrlFrame_Cnt):0; -+ -+ if(pDM_FatTable->MainAnt_CtrlFrame_Cnt<=1 && pDM_FatTable->CCK_CtrlFrame_Cnt_main>=1) -+ Main_RSSI=0; -+ -+ if(pDM_FatTable->AuxAnt_CtrlFrame_Cnt<=1 && pDM_FatTable->CCK_CtrlFrame_Cnt_aux>=1) -+ Aux_RSSI=0; -+ -+ if (Main_RSSI != 0 || Aux_RSSI != 0) -+ { -+ RxIdleAnt = (Main_RSSI==Aux_RSSI)?pDM_SWAT_Table->PreAntenna:((Main_RSSI>=Aux_RSSI)?MAIN_ANT:AUX_ANT); -+ LocalMaxRSSI = (Main_RSSI>=Aux_RSSI) ? Main_RSSI : Aux_RSSI; -+ LocalMinRSSI = (Main_RSSI>=Aux_RSSI) ? Aux_RSSI : Main_RSSI; -+ -+ if((LocalMaxRSSI-LocalMinRSSI)>8) -+ pDM_SWAT_Table->Train_time_flag=3; -+ else if((LocalMaxRSSI-LocalMinRSSI)>5) -+ pDM_SWAT_Table->Train_time_flag=2; -+ else if((LocalMaxRSSI-LocalMinRSSI)>2) -+ pDM_SWAT_Table->Train_time_flag=1; -+ else -+ pDM_SWAT_Table->Train_time_flag=0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Control frame: Main_RSSI = %d, Aux_RSSI = %d\n", Main_RSSI, Aux_RSSI)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("RxIdleAnt decided by control frame = %s\n", (RxIdleAnt == MAIN_ANT?"MAIN":"AUX"))); -+ } -+ } -+ } -+ -+ pDM_FatTable->MinMaxRSSI = MinMaxRSSI; -+ pDM_SWAT_Table->try_flag = SWAW_STEP_PEEK; -+ -+ if( pDM_SWAT_Table->Double_chk_flag==1) -+ { -+ pDM_SWAT_Table->Double_chk_flag=0; -+ -+ if (pDM_FatTable->MinMaxRSSI > RSSI_CHECK_THRESHOLD) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [Double check] MinMaxRSSI ((%d)) > %d again!!\n", -+ pDM_FatTable->MinMaxRSSI, RSSI_CHECK_THRESHOLD)); -+ -+ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[reset try_flag = 0] Training accomplished !!!]\n\n\n")); -+ return; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [Double check] MinMaxRSSI ((%d)) <= %d !!\n", -+ pDM_FatTable->MinMaxRSSI, RSSI_CHECK_THRESHOLD)); -+ -+ nextAnt = (pDM_FatTable->RxIdleAnt == MAIN_ANT)? AUX_ANT : MAIN_ANT; -+ pDM_SWAT_Table->try_flag = SWAW_STEP_PEEK; -+ pDM_SWAT_Table->reset_idx = RSSI_CHECK_RESET_PERIOD; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[set try_flag=0] Normal State: Need to tryg again!!\n\n\n")); -+ return; -+ } -+ } -+ else -+ { -+ if (pDM_FatTable->MinMaxRSSI < RSSI_CHECK_THRESHOLD) -+ pDM_SWAT_Table->reset_idx = RSSI_CHECK_RESET_PERIOD; -+ -+ pDM_SWAT_Table->PreAntenna =RxIdleAnt; -+ ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt ); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("[reset try_flag = 0] Training accomplished !!!] \n\n\n")); -+ return; -+ } -+ -+ } -+ -+ } -+ -+ //1 4.Change TRX antenna -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("RSSI_Trying = (( %d )), Ant: (( %s )) >>> (( %s )) \n", -+ pDM_SWAT_Table->RSSI_Trying, (pDM_FatTable->RxIdleAnt == MAIN_ANT?"MAIN":"AUX"),(nextAnt == MAIN_ANT?"MAIN":"AUX"))); -+ -+ ODM_UpdateRxIdleAnt(pDM_Odm, nextAnt); -+ -+ //1 5.Reset Statistics -+ -+ pDM_FatTable->RxIdleAnt = nextAnt; -+ -+ //1 6.Set next timer (Trying State) -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Test ((%s)) Ant for (( %d )) ms\n", (nextAnt == MAIN_ANT?"MAIN":"AUX"), pDM_SWAT_Table->Train_time)); -+ ODM_SetTimer(pDM_Odm, &(pDM_SWAT_Table->phydm_SwAntennaSwitchTimer), pDM_SWAT_Table->Train_time); /*ms*/ -+} -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+ODM_SW_AntDiv_Callback( -+ PRT_TIMER pTimer -+) -+{ -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ pSWAT_T pDM_SWAT_Table = &pHalData->DM_OutSrc.DM_SWAT_Table; -+ -+ #if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ #if USE_WORKITEM -+ ODM_ScheduleWorkItem(&pDM_SWAT_Table->phydm_SwAntennaSwitchWorkitem); -+ #else -+ { -+ //DbgPrint("SW_antdiv_Callback"); -+ odm_S0S1_SwAntDiv(&pHalData->DM_OutSrc, SWAW_STEP_DETERMINE); -+ } -+ #endif -+ #else -+ ODM_ScheduleWorkItem(&pDM_SWAT_Table->phydm_SwAntennaSwitchWorkitem); -+ #endif -+} -+VOID -+ODM_SW_AntDiv_WorkitemCallback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER pAdapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ //DbgPrint("SW_antdiv_Workitem_Callback"); -+ odm_S0S1_SwAntDiv(&pHalData->DM_OutSrc, SWAW_STEP_DETERMINE); -+} -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+VOID -+ODM_SW_AntDiv_WorkitemCallback( -+ IN PVOID pContext -+) -+{ -+ PADAPTER -+ pAdapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE -+ *pHalData = GET_HAL_DATA(pAdapter); -+ -+ /*DbgPrint("SW_antdiv_Workitem_Callback");*/ -+ odm_S0S1_SwAntDiv(&pHalData->odmpriv, SWAW_STEP_DETERMINE); -+} -+ -+VOID -+ODM_SW_AntDiv_Callback(void *FunctionContext) -+{ -+ PDM_ODM_T pDM_Odm= (PDM_ODM_T)FunctionContext; -+ PADAPTER padapter = pDM_Odm->Adapter; -+ if(padapter->net_closed == _TRUE) -+ return; -+ -+ #if 0 /* Can't do I/O in timer callback*/ -+ odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_DETERMINE); -+ #else -+ rtw_run_in_thread_cmd(padapter, ODM_SW_AntDiv_WorkitemCallback, padapter); -+ #endif -+} -+ -+ -+#endif -+ -+VOID -+odm_S0S1_SwAntDivByCtrlFrame( -+ IN PVOID pDM_VOID, -+ IN u1Byte Step -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ switch(Step) -+ { -+ case SWAW_STEP_PEEK: -+ pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame = 0; -+ pDM_SWAT_Table->bSWAntDivByCtrlFrame = TRUE; -+ pDM_FatTable->MainAnt_CtrlFrame_Cnt = 0; -+ pDM_FatTable->AuxAnt_CtrlFrame_Cnt = 0; -+ pDM_FatTable->MainAnt_CtrlFrame_Sum = 0; -+ pDM_FatTable->AuxAnt_CtrlFrame_Sum = 0; -+ pDM_FatTable->CCK_CtrlFrame_Cnt_main = 0; -+ pDM_FatTable->CCK_CtrlFrame_Cnt_aux = 0; -+ pDM_FatTable->OFDM_CtrlFrame_Cnt_main = 0; -+ pDM_FatTable->OFDM_CtrlFrame_Cnt_aux = 0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_S0S1_SwAntDivForAPMode(): Start peek and reset counter\n")); -+ break; -+ case SWAW_STEP_DETERMINE: -+ pDM_SWAT_Table->bSWAntDivByCtrlFrame = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_S0S1_SwAntDivForAPMode(): Stop peek\n")); -+ break; -+ default: -+ pDM_SWAT_Table->bSWAntDivByCtrlFrame = FALSE; -+ break; -+ } -+} -+ -+VOID -+odm_AntselStatisticsOfCtrlFrame( -+ IN PVOID pDM_VOID, -+ IN u1Byte antsel_tr_mux, -+ IN u4Byte RxPWDBAll -+ -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ if(antsel_tr_mux == ANT1_2G) -+ { -+ pDM_FatTable->MainAnt_CtrlFrame_Sum+=RxPWDBAll; -+ pDM_FatTable->MainAnt_CtrlFrame_Cnt++; -+ } -+ else -+ { -+ pDM_FatTable->AuxAnt_CtrlFrame_Sum+=RxPWDBAll; -+ pDM_FatTable->AuxAnt_CtrlFrame_Cnt++; -+ } -+} -+ -+VOID -+odm_S0S1_SwAntDivByCtrlFrame_ProcessRSSI( -+ IN PVOID pDM_VOID, -+ IN PVOID p_phy_info_void, -+ IN PVOID p_pkt_info_void -+ //IN PODM_PHY_INFO_T pPhyInfo, -+ //IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_PHY_INFO_T pPhyInfo=(PODM_PHY_INFO_T)p_phy_info_void; -+ PODM_PACKET_INFO_T pPktinfo=(PODM_PACKET_INFO_T)p_pkt_info_void; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ BOOLEAN isCCKrate; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ return; -+ -+ if(pDM_Odm->AntDivType != S0S1_SW_ANTDIV) -+ return; -+ -+ // In try state -+ if(!pDM_SWAT_Table->bSWAntDivByCtrlFrame) -+ return; -+ -+ // No HW error and match receiver address -+ if(!pPktinfo->bToSelf) -+ return; -+ -+ pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame++; -+ isCCKrate = ((pPktinfo->DataRate >= DESC_RATE1M ) && (pPktinfo->DataRate <= DESC_RATE11M ))?TRUE :FALSE; -+ -+ if(isCCKrate) -+ { -+ pDM_FatTable->antsel_rx_keep_0 = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? ANT1_2G : ANT2_2G; -+ -+ if(pDM_FatTable->antsel_rx_keep_0==ANT1_2G) -+ pDM_FatTable->CCK_CtrlFrame_Cnt_main++; -+ else -+ pDM_FatTable->CCK_CtrlFrame_Cnt_aux++; -+ -+ odm_AntselStatisticsOfCtrlFrame(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]); -+ } -+ else -+ { -+ if(pDM_FatTable->antsel_rx_keep_0==ANT1_2G) -+ pDM_FatTable->OFDM_CtrlFrame_Cnt_main++; -+ else -+ pDM_FatTable->OFDM_CtrlFrame_Cnt_aux++; -+ -+ odm_AntselStatisticsOfCtrlFrame(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPhyInfo->RxPWDBAll); -+ } -+} -+ -+#endif //#if (RTL8723B_SUPPORT == 1)||(RTL8821A_SUPPORT == 1) -+ -+ -+ -+ -+VOID -+odm_SetNextMACAddrTarget( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ PSTA_INFO_T pEntry; -+ u4Byte value32, i; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_SetNextMACAddrTarget() ==>\n")); -+ -+ if (pDM_Odm->bLinked) -+ { -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ -+ if ((pDM_FatTable->TrainIdx+1) == ODM_ASSOCIATE_ENTRY_NUM) -+ pDM_FatTable->TrainIdx = 0; -+ else -+ pDM_FatTable->TrainIdx++; -+ -+ pEntry = pDM_Odm->pODM_StaInfo[pDM_FatTable->TrainIdx]; -+ -+ if (IS_STA_VALID(pEntry)) { -+ -+ /*Match MAC ADDR*/ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) -+ value32 = (pEntry->hwaddr[5]<<8)|pEntry->hwaddr[4]; -+ #else -+ value32 = (pEntry->MacAddr[5]<<8)|pEntry->MacAddr[4]; -+ #endif -+ -+ ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, value32);/*0x7b4~0x7b5*/ -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) -+ value32 = (pEntry->hwaddr[3]<<24)|(pEntry->hwaddr[2]<<16) |(pEntry->hwaddr[1]<<8) |pEntry->hwaddr[0]; -+ #else -+ value32 = (pEntry->MacAddr[3]<<24)|(pEntry->MacAddr[2]<<16) |(pEntry->MacAddr[1]<<8) |pEntry->MacAddr[0]; -+ #endif -+ ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, value32);/*0x7b0~0x7b3*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_FatTable->TrainIdx=%d\n", pDM_FatTable->TrainIdx)); -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training MAC Addr = %x:%x:%x:%x:%x:%x\n", -+ pEntry->hwaddr[5], pEntry->hwaddr[4], pEntry->hwaddr[3], pEntry->hwaddr[2], pEntry->hwaddr[1], pEntry->hwaddr[0])); -+ #else -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training MAC Addr = %x:%x:%x:%x:%x:%x\n", -+ pEntry->MacAddr[5], pEntry->MacAddr[4], pEntry->MacAddr[3], pEntry->MacAddr[2], pEntry->MacAddr[1], pEntry->MacAddr[0])); -+ #endif -+ -+ break; -+ } -+ } -+ } -+ -+#if 0 -+ // -+ //2012.03.26 LukeLee: This should be removed later, the MAC address is changed according to MACID in turn -+ // -+ #if( DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ { -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ -+ for (i=0; i<6; i++) -+ { -+ Bssid[i] = pMgntInfo->Bssid[i]; -+ //DbgPrint("Bssid[%d]=%x\n", i, Bssid[i]); -+ } -+ } -+ #endif -+ -+ //odm_SetNextMACAddrTarget(pDM_Odm); -+ -+ //1 Select MAC Address Filter -+ for (i=0; i<6; i++) -+ { -+ if(Bssid[i] != pDM_FatTable->Bssid[i]) -+ { -+ bMatchBSSID = FALSE; -+ break; -+ } -+ } -+ if(bMatchBSSID == FALSE) -+ { -+ //Match MAC ADDR -+ value32 = (Bssid[5]<<8)|Bssid[4]; -+ ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, value32); -+ value32 = (Bssid[3]<<24)|(Bssid[2]<<16) |(Bssid[1]<<8) |Bssid[0]; -+ ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, value32); -+ } -+ -+ return bMatchBSSID; -+#endif -+ -+} -+ -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ -+VOID -+odm_FastAntTraining( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ u4Byte MaxRSSI_pathA=0, Pckcnt_pathA=0; -+ u1Byte i,TargetAnt_pathA=0; -+ BOOLEAN bPktFilterMacth_pathA = FALSE; -+ #if(RTL8192E_SUPPORT == 1) -+ u4Byte MaxRSSI_pathB=0, Pckcnt_pathB=0; -+ u1Byte TargetAnt_pathB=0; -+ BOOLEAN bPktFilterMacth_pathB = FALSE; -+ #endif -+ -+ -+ if(!pDM_Odm->bLinked) //bLinked==False -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); -+ -+ if(pDM_FatTable->bBecomeLinked == TRUE) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ phydm_FastTraining_enable(pDM_Odm , FAT_OFF); -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ return; -+ } -+ else -+ { -+ if(pDM_FatTable->bBecomeLinked ==FALSE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked!!!]\n")); -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ } -+ -+ if (*(pDM_FatTable->pForceTxAntByDesc) == FALSE) { -+ if (pDM_Odm->bOneEntryOnly == TRUE) -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); -+ else -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); -+ } -+ -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT2|BIT1|BIT0, ((pDM_Odm->fat_comb_a)-1)); -+ } -+ #if(RTL8192E_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT2|BIT1|BIT0, ((pDM_Odm->fat_comb_a)-1) ); //path-A // ant combination=regB38[2:0]+1 -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT18|BIT17|BIT16, ((pDM_Odm->fat_comb_b)-1) ); //path-B // ant combination=regB38[18:16]+1 -+ } -+ #endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("==>odm_FastAntTraining()\n")); -+ -+ //1 TRAINING STATE -+ if(pDM_FatTable->FAT_State == FAT_TRAINING_STATE) -+ { -+ //2 Caculate RSSI per Antenna -+ -+ //3 [path-A]--------------------------- -+ for (i=0; i<(pDM_Odm->fat_comb_a); i++) // i : antenna index -+ { -+ if(pDM_FatTable->antRSSIcnt[i] == 0) -+ pDM_FatTable->antAveRSSI[i] = 0; -+ else -+ { -+ pDM_FatTable->antAveRSSI[i] = pDM_FatTable->antSumRSSI[i] /pDM_FatTable->antRSSIcnt[i]; -+ bPktFilterMacth_pathA = TRUE; -+ } -+ -+ if(pDM_FatTable->antAveRSSI[i] > MaxRSSI_pathA) -+ { -+ MaxRSSI_pathA = pDM_FatTable->antAveRSSI[i]; -+ Pckcnt_pathA = pDM_FatTable ->antRSSIcnt[i]; -+ TargetAnt_pathA = i ; -+ } -+ else if(pDM_FatTable->antAveRSSI[i] == MaxRSSI_pathA) -+ { -+ if( (pDM_FatTable->antRSSIcnt[i] ) > Pckcnt_pathA) -+ { -+ MaxRSSI_pathA = pDM_FatTable->antAveRSSI[i]; -+ Pckcnt_pathA = pDM_FatTable ->antRSSIcnt[i]; -+ TargetAnt_pathA = i ; -+ } -+ } -+ -+ ODM_RT_TRACE("*** Ant-Index : [ %d ], Counter = (( %d )), Avg RSSI = (( %d )) \n", i, pDM_FatTable->antRSSIcnt[i], pDM_FatTable->antAveRSSI[i] ); -+ } -+ -+ -+ /* -+ #if(RTL8192E_SUPPORT == 1) -+ //3 [path-B]--------------------------- -+ for (i=0; i<(pDM_Odm->fat_comb_b); i++) -+ { -+ if(pDM_FatTable->antRSSIcnt_pathB[i] == 0) -+ pDM_FatTable->antAveRSSI_pathB[i] = 0; -+ else // (antRSSIcnt[i] != 0) -+ { -+ pDM_FatTable->antAveRSSI_pathB[i] = pDM_FatTable->antSumRSSI_pathB[i] /pDM_FatTable->antRSSIcnt_pathB[i]; -+ bPktFilterMacth_pathB = TRUE; -+ } -+ if(pDM_FatTable->antAveRSSI_pathB[i] > MaxRSSI_pathB) -+ { -+ MaxRSSI_pathB = pDM_FatTable->antAveRSSI_pathB[i]; -+ Pckcnt_pathB = pDM_FatTable ->antRSSIcnt_pathB[i]; -+ TargetAnt_pathB = (u1Byte) i; -+ } -+ if(pDM_FatTable->antAveRSSI_pathB[i] == MaxRSSI_pathB) -+ { -+ if(pDM_FatTable ->antRSSIcnt_pathB > Pckcnt_pathB) -+ { -+ MaxRSSI_pathB = pDM_FatTable->antAveRSSI_pathB[i]; -+ TargetAnt_pathB = (u1Byte) i; -+ } -+ } -+ if (pDM_Odm->fat_print_rssi==1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{Path-B}: Sum RSSI[%d] = (( %d )), cnt RSSI [%d] = (( %d )), Avg RSSI[%d] = (( %d )) \n", -+ i, pDM_FatTable->antSumRSSI_pathB[i], i, pDM_FatTable->antRSSIcnt_pathB[i], i, pDM_FatTable->antAveRSSI_pathB[i])); -+ } -+ } -+ #endif -+ */ -+ -+ //1 DECISION STATE -+ -+ //2 Select TRX Antenna -+ -+ phydm_FastTraining_enable(pDM_Odm, FAT_OFF); -+ -+ //3 [path-A]--------------------------- -+ if(bPktFilterMacth_pathA == FALSE) -+ { -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("{Path-A}: None Packet is matched\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("{Path-A}: None Packet is matched\n")); -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ } -+ else -+ { -+ ODM_RT_TRACE("TargetAnt_pathA = (( %d )) , MaxRSSI_pathA = (( %d )) \n",TargetAnt_pathA,MaxRSSI_pathA); -+ -+ //3 [ update RX-optional ant ] Default RX is Omni, Optional RX is the best decision by FAT -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, TargetAnt_pathA); -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT8|BIT7|BIT6, TargetAnt_pathA);//Optional RX [pth-A] -+ } -+ //3 [ update TX ant ] -+ odm_UpdateTxAnt(pDM_Odm, TargetAnt_pathA, (pDM_FatTable->TrainIdx)); -+ -+ if(TargetAnt_pathA == 0) -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ } -+ /* -+ #if(RTL8192E_SUPPORT == 1) -+ //3 [path-B]--------------------------- -+ if(bPktFilterMacth_pathB == FALSE) -+ { -+ if (pDM_Odm->fat_print_rssi==1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***[%d]{Path-B}: None Packet is matched\n\n\n",__LINE__)); -+ } -+ } -+ else -+ { -+ if (pDM_Odm->fat_print_rssi==1) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, -+ (" ***TargetAnt_pathB = (( %d )) *** MaxRSSI = (( %d ))***\n\n\n",TargetAnt_pathB,MaxRSSI_pathB)); -+ } -+ ODM_SetBBReg(pDM_Odm, 0xB38 , BIT21|BIT20|BIT19, TargetAnt_pathB); //Default RX is Omni, Optional RX is the best decision by FAT -+ ODM_SetBBReg(pDM_Odm, 0x80c , BIT21, 1); //Reg80c[21]=1'b1 //from TX Info -+ -+ pDM_FatTable->antsel_pathB[pDM_FatTable->TrainIdx] = TargetAnt_pathB; -+ } -+ #endif -+ */ -+ -+ //2 Reset Counter -+ for(i=0; i<(pDM_Odm->fat_comb_a); i++) -+ { -+ pDM_FatTable->antSumRSSI[i] = 0; -+ pDM_FatTable->antRSSIcnt[i] = 0; -+ } -+ /* -+ #if(RTL8192E_SUPPORT == 1) -+ for(i=0; i<=(pDM_Odm->fat_comb_b); i++) -+ { -+ pDM_FatTable->antSumRSSI_pathB[i] = 0; -+ pDM_FatTable->antRSSIcnt_pathB[i] = 0; -+ } -+ #endif -+ */ -+ -+ pDM_FatTable->FAT_State = FAT_PREPARE_STATE; -+ return; -+ } -+ -+ //1 NORMAL STATE -+ if (pDM_FatTable->FAT_State == FAT_PREPARE_STATE) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Start Prepare State ]\n")); -+ -+ odm_SetNextMACAddrTarget(pDM_Odm); -+ -+ //2 Prepare Training -+ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; -+ phydm_FastTraining_enable(pDM_Odm , FAT_ON); -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); //enable HW AntDiv -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Start Training State]\n")); -+ -+ ODM_SetTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer, pDM_Odm->antdiv_intvl ); //ms -+ } -+ -+} -+ -+VOID -+odm_FastAntTrainingCallback( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PADAPTER padapter = pDM_Odm->Adapter; -+ if(padapter->net_closed == _TRUE) -+ return; -+ //if(*pDM_Odm->pbNet_closed == TRUE) -+ // return; -+#endif -+ -+#if USE_WORKITEM -+ ODM_ScheduleWorkItem(&pDM_Odm->FastAntTrainingWorkitem); -+#else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_FastAntTrainingCallback****** \n")); -+ odm_FastAntTraining(pDM_Odm); -+#endif -+} -+ -+VOID -+odm_FastAntTrainingWorkItemCallback( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_FastAntTrainingWorkItemCallback****** \n")); -+ odm_FastAntTraining(pDM_Odm); -+} -+ -+#endif -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ -+u4Byte -+phydm_construct_hl_beam_codeword( -+ IN PVOID pDM_VOID, -+ IN u4Byte *beam_pattern_idx, -+ IN u4Byte ant_num -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ u4Byte codeword = 0; -+ u4Byte data_tmp; -+ u4Byte i; -+ u4Byte break_counter = 0; -+ -+ if (ant_num < 8) { -+ for (i = 0; i < (pdm_sat_table->ant_num_total); i++) { -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("beam_pattern_num[%x] = %x\n",i,beam_pattern_num[i] ));*/ -+ if ((i < (pdm_sat_table->first_train_ant-1)) || (break_counter >= (pdm_sat_table->ant_num))) { -+ data_tmp = 0; -+ /**/ -+ } else { -+ -+ break_counter++; -+ -+ if (beam_pattern_idx[i] == 0) { -+ -+ if (*pDM_Odm->pBandType == ODM_BAND_5G) -+ data_tmp = pdm_sat_table->rfu_codeword_table_5g[0]; -+ else -+ data_tmp = pdm_sat_table->rfu_codeword_table[0]; -+ -+ } else if (beam_pattern_idx[i] == 1) { -+ -+ -+ if (*pDM_Odm->pBandType == ODM_BAND_5G) -+ data_tmp = pdm_sat_table->rfu_codeword_table_5g[1]; -+ else -+ data_tmp = pdm_sat_table->rfu_codeword_table[1]; -+ -+ } else if (beam_pattern_idx[i] == 2) { -+ -+ if (*pDM_Odm->pBandType == ODM_BAND_5G) -+ data_tmp = pdm_sat_table->rfu_codeword_table_5g[2]; -+ else -+ data_tmp = pdm_sat_table->rfu_codeword_table[2]; -+ -+ } else if (beam_pattern_idx[i] == 3) { -+ -+ if (*pDM_Odm->pBandType == ODM_BAND_5G) -+ data_tmp = pdm_sat_table->rfu_codeword_table_5g[3]; -+ else -+ data_tmp = pdm_sat_table->rfu_codeword_table[3]; -+ } -+ } -+ -+ -+ codeword |= (data_tmp<<(i*4)); -+ -+ } -+ } -+ -+ return codeword; -+} -+ -+VOID -+phydm_update_beam_pattern( -+ IN PVOID pDM_VOID, -+ IN u4Byte codeword, -+ IN u4Byte codeword_length -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ u1Byte i; -+ BOOLEAN beam_ctrl_signal; -+ u4Byte one = 0x1; -+ u4Byte reg44_tmp_p, reg44_tmp_n, reg44_ori; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Set Beam Pattern =0x%x\n", codeword)); -+ -+ reg44_ori = ODM_GetMACReg(pDM_Odm, 0x44, bMaskDWord); -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("reg44_ori =0x%x\n", reg44_ori));*/ -+ -+ for (i = 0; i <= (codeword_length-1); i++) { -+ beam_ctrl_signal = (BOOLEAN)((codeword&BIT(i)) >> i); -+ -+ if (pDM_Odm->DebugComponents & ODM_COMP_ANT_DIV) { -+ -+ if (i == (codeword_length-1)) { -+ DbgPrint("%d ]\n", beam_ctrl_signal); -+ /**/ -+ } else if (i == 0) { -+ DbgPrint("Send codeword[1:24] ---> [ %d ", beam_ctrl_signal); -+ /**/ -+ } else if ((i % 4) == 3) { -+ DbgPrint("%d | ", beam_ctrl_signal); -+ /**/ -+ } else { -+ DbgPrint("%d ", beam_ctrl_signal); -+ /**/ -+ } -+ } -+ -+ #if 1 -+ reg44_tmp_p = reg44_ori & (~(BIT11|BIT10)); /*clean bit 10 & 11*/ -+ reg44_tmp_p |= ((1<<11) | (beam_ctrl_signal<<10)); -+ reg44_tmp_n = reg44_ori & (~(BIT11|BIT10)); -+ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n));*/ -+ ODM_SetMACReg(pDM_Odm, 0x44 , bMaskDWord, reg44_tmp_p); -+ ODM_SetMACReg(pDM_Odm, 0x44 , bMaskDWord, reg44_tmp_n); -+ #else -+ ODM_SetMACReg(pDM_Odm, 0x44 , BIT11|BIT10, ((1<<1) | beam_ctrl_signal)); -+ ODM_SetMACReg(pDM_Odm, 0x44 , BIT11, 0); -+ #endif -+ -+ } -+} -+ -+VOID -+phydm_update_rx_idle_beam( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ u4Byte i; -+ -+ pdm_sat_table->update_beam_codeword = phydm_construct_hl_beam_codeword(pDM_Odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set target beam_pattern codeword = (( 0x%x ))\n", pdm_sat_table->update_beam_codeword)); -+ -+ for (i = 0; i < (pdm_sat_table->ant_num); i++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Beam ] RxIdleBeam[%d] =%d\n", i, pdm_sat_table->rx_idle_beam[i])); -+ /**/ -+ } -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); -+ #else -+ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_workitem); -+ /*ODM_StallExecution(1);*/ -+ #endif -+ -+ pdm_sat_table->pre_codeword = pdm_sat_table->update_beam_codeword; -+} -+ -+VOID -+phydm_hl_smart_ant_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ u4Byte one = 0x1; -+ u4Byte codeword_length = pdm_sat_table->data_codeword_bit_num; -+ u4Byte beam_ctrl_signal, i; -+ -+ if (dm_value[0] == 1) { /*fix beam pattern*/ -+ -+ pdm_sat_table->fix_beam_pattern_en = dm_value[1]; -+ -+ if (pdm_sat_table->fix_beam_pattern_en == 1) { -+ -+ pdm_sat_table->fix_beam_pattern_codeword = dm_value[2]; -+ -+ if (pdm_sat_table->fix_beam_pattern_codeword > (one<fix_beam_pattern_codeword, codeword_length)); -+ (pdm_sat_table->fix_beam_pattern_codeword) &= 0xffffff; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Auto modify to (0x%x)\n", pdm_sat_table->fix_beam_pattern_codeword)); -+ } -+ -+ pdm_sat_table->update_beam_codeword = pdm_sat_table->fix_beam_pattern_codeword; -+ -+ /*---------------------------------------------------------*/ -+ PHYDM_SNPRINTF((output+used, out_len-used, "Fix Beam Pattern\n")); -+ for (i = 0; i <= (codeword_length-1); i++) { -+ beam_ctrl_signal = (BOOLEAN)((pdm_sat_table->update_beam_codeword&BIT(i)) >> i); -+ -+ if (i == (codeword_length-1)) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "%d]\n", beam_ctrl_signal)); -+ /**/ -+ } else if (i == 0) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "Send Codeword[1:24] to RFU -> [%d", beam_ctrl_signal)); -+ /**/ -+ } else if ((i % 4) == 3) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "%d|", beam_ctrl_signal)); -+ /**/ -+ } else { -+ PHYDM_SNPRINTF((output+used, out_len-used, "%d", beam_ctrl_signal)); -+ /**/ -+ } -+ } -+ /*---------------------------------------------------------*/ -+ -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); -+ #else -+ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_workitem); -+ /*ODM_StallExecution(1);*/ -+ #endif -+ } else if (pdm_sat_table->fix_beam_pattern_en == 0) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Smart Antenna: Enable\n")); -+ } -+ -+ } else if (dm_value[0] == 2) { /*set latch time*/ -+ -+ pdm_sat_table->latch_time = dm_value[1]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] latch_time =0x%x\n", pdm_sat_table->latch_time)); -+ } else if (dm_value[0] == 3) { -+ -+ pdm_sat_table->fix_training_num_en = dm_value[1]; -+ -+ if (pdm_sat_table->fix_training_num_en == 1) { -+ pdm_sat_table->per_beam_training_pkt_num = (u1Byte)dm_value[2]; -+ pdm_sat_table->decision_holding_period = (u1Byte)dm_value[3]; -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "[SmartAnt][Dbg] Fix_train_en = (( %d )), train_pkt_num = (( %d )), holding_period = (( %d )),\n", -+ pdm_sat_table->fix_training_num_en, pdm_sat_table->per_beam_training_pkt_num, pdm_sat_table->decision_holding_period)); -+ -+ } else if (pdm_sat_table->fix_training_num_en == 0) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] AUTO per_beam_training_pkt_num\n")); -+ /**/ -+ } -+ } else if (dm_value[0] == 4) { -+ -+ if (dm_value[1] == 1) { -+ pdm_sat_table->ant_num = 1; -+ pdm_sat_table->first_train_ant = MAIN_ANT; -+ -+ } else if (dm_value[1] == 2) { -+ pdm_sat_table->ant_num = 1; -+ pdm_sat_table->first_train_ant = AUX_ANT; -+ -+ } else if (dm_value[1] == 3) { -+ pdm_sat_table->ant_num = 2; -+ pdm_sat_table->first_train_ant = MAIN_ANT; -+ } -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Set Ant Num = (( %d )), first_train_ant = (( %d ))\n", -+ pdm_sat_table->ant_num, (pdm_sat_table->first_train_ant-1))); -+ } else if (dm_value[0] == 5) { -+ -+ if (dm_value[1] <= 3) { -+ pdm_sat_table->rfu_codeword_table[dm_value[1]] = dm_value[2]; -+ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Set Beam_2G: (( %d )), RFU codeword table = (( 0x%x ))\n", -+ dm_value[1], dm_value[2])); -+ } else { -+ for (i = 0; i < 4; i++) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Show Beam_2G: (( %d )), RFU codeword table = (( 0x%x ))\n", -+ i, pdm_sat_table->rfu_codeword_table[i])); -+ } -+ } -+ } else if (dm_value[0] == 6) { -+ -+ if (dm_value[1] <= 3) { -+ pdm_sat_table->rfu_codeword_table_5g[dm_value[1]] = dm_value[2]; -+ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Set Beam_5G: (( %d )), RFU codeword table = (( 0x%x ))\n", -+ dm_value[1], dm_value[2])); -+ } else { -+ for (i = 0; i < 4; i++) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Show Beam_5G: (( %d )), RFU codeword table = (( 0x%x ))\n", -+ i, pdm_sat_table->rfu_codeword_table_5g[i])); -+ } -+ } -+ } else if (dm_value[0] == 7) { -+ -+ if (dm_value[1] <= 4) { -+ -+ pdm_sat_table->beam_patten_num_each_ant = dm_value[1]; -+ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Set Beam number = (( %d ))\n", -+ pdm_sat_table->beam_patten_num_each_ant)); -+ } else { -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Show Beam number = (( %d ))\n", -+ pdm_sat_table->beam_patten_num_each_ant)); -+ } -+ } -+ -+} -+ -+ -+void -+phydm_set_all_ant_same_beam_num( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ -+ if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) { /*2Ant for 8821A*/ -+ -+ pdm_sat_table->rx_idle_beam[0] = pdm_sat_table->fast_training_beam_num; -+ pdm_sat_table->rx_idle_beam[1] = pdm_sat_table->fast_training_beam_num; -+ } -+ -+ pdm_sat_table->update_beam_codeword = phydm_construct_hl_beam_codeword(pDM_Odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Set all ant beam_pattern: codeword = (( 0x%x ))\n", pdm_sat_table->update_beam_codeword)); -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); -+ #else -+ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_workitem); -+ /*ODM_StallExecution(1);*/ -+ #endif -+} -+ -+VOID -+odm_FastAntTraining_hl_smart_antenna_type1( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ pFAT_T pDM_FatTable = &(pDM_Odm->DM_FatTable); -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ u4Byte codeword = 0, i, j; -+ u4Byte TargetAnt; -+ u4Byte avg_rssi_tmp, avg_rssi_tmp_ma; -+ u4Byte target_ant_beam_max_rssi[SUPPORT_RF_PATH_NUM] = {0}; -+ u4Byte max_beam_ant_rssi = 0; -+ u4Byte target_ant_beam[SUPPORT_RF_PATH_NUM] = {0}; -+ u4Byte beam_tmp; -+ u1Byte next_ant; -+ u4Byte rssi_sorting_seq[SUPPORT_BEAM_PATTERN_NUM] = {0}; -+ u4Byte rank_idx_seq[SUPPORT_BEAM_PATTERN_NUM] = {0}; -+ u4Byte rank_idx_out[SUPPORT_BEAM_PATTERN_NUM] = {0}; -+ u1Byte per_beam_rssi_diff_tmp = 0, training_pkt_num_offset; -+ u4Byte break_counter = 0; -+ u4Byte used_ant; -+ -+ -+ if (!pDM_Odm->bLinked) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); -+ -+ if (pDM_FatTable->bBecomeLinked == TRUE) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Link -> no Link\n")); -+ pDM_FatTable->FAT_State = FAT_BEFORE_LINK_STATE; -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("change to (( %d )) FAT_state\n", pDM_FatTable->FAT_State)); -+ -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ return; -+ -+ } else { -+ if (pDM_FatTable->bBecomeLinked == FALSE) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); -+ -+ pDM_FatTable->FAT_State = FAT_PREPARE_STATE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("change to (( %d )) FAT_state\n", pDM_FatTable->FAT_State)); -+ -+ /*pdm_sat_table->fast_training_beam_num = 0;*/ -+ /*phydm_set_all_ant_same_beam_num(pDM_Odm);*/ -+ -+ pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ } -+ -+ if (*(pDM_FatTable->pForceTxAntByDesc) == FALSE) { -+ if (pDM_Odm->bOneEntryOnly == TRUE) -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); -+ else -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); -+ } -+ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("HL Smart Ant Training: State (( %d ))\n", pDM_FatTable->FAT_State));*/ -+ -+ /* [DECISION STATE] */ -+ /*=======================================================================================*/ -+ if (pDM_FatTable->FAT_State == FAT_DECISION_STATE) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 3. In Decision State]\n")); -+ phydm_FastTraining_enable(pDM_Odm , FAT_OFF); -+ -+ break_counter = 0; -+ /*compute target beam in each antenna*/ -+ for (i = (pdm_sat_table->first_train_ant-1); i < pdm_sat_table->ant_num_total; i++) { -+ for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { -+ -+ if (pdm_sat_table->pkt_rssi_cnt[i][j] == 0) { -+ avg_rssi_tmp = pdm_sat_table->pkt_rssi_pre[i][j]; -+ avg_rssi_tmp = (avg_rssi_tmp >= 2) ? (avg_rssi_tmp - 2) : avg_rssi_tmp; -+ avg_rssi_tmp_ma = avg_rssi_tmp; -+ } else { -+ avg_rssi_tmp = (pdm_sat_table->pkt_rssi_sum[i][j]) / (pdm_sat_table->pkt_rssi_cnt[i][j]); -+ avg_rssi_tmp_ma = (avg_rssi_tmp + pdm_sat_table->pkt_rssi_pre[i][j])>>1; -+ } -+ -+ rssi_sorting_seq[j] = avg_rssi_tmp; -+ pdm_sat_table->pkt_rssi_pre[i][j] = avg_rssi_tmp; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Ant[%d], Beam[%d]: pkt_cnt=(( %d )), avg_rssi_MA=(( %d )), avg_rssi=(( %d ))\n", -+ i, j, pdm_sat_table->pkt_rssi_cnt[i][j], avg_rssi_tmp_ma, avg_rssi_tmp)); -+ -+ if (avg_rssi_tmp > target_ant_beam_max_rssi[i]) { -+ target_ant_beam[i] = j; -+ target_ant_beam_max_rssi[i] = avg_rssi_tmp; -+ } -+ -+ /*reset counter value*/ -+ pdm_sat_table->pkt_rssi_sum[i][j] = 0; -+ pdm_sat_table->pkt_rssi_cnt[i][j] = 0; -+ -+ } -+ pdm_sat_table->rx_idle_beam[i] = target_ant_beam[i]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("---------> Target of Ant[%d]: Beam_num-(( %d )) RSSI= ((%d))\n", -+ i, target_ant_beam[i], target_ant_beam_max_rssi[i])); -+ -+ /*sorting*/ -+ /* -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Pre]rssi_sorting_seq = [%d, %d, %d, %d]\n", rssi_sorting_seq[0], rssi_sorting_seq[1], rssi_sorting_seq[2], rssi_sorting_seq[3])); -+ */ -+ -+ /*phydm_seq_sorting(pDM_Odm, &rssi_sorting_seq[0], &rank_idx_seq[0], &rank_idx_out[0], SUPPORT_BEAM_PATTERN_NUM);*/ -+ -+ /* -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Post]rssi_sorting_seq = [%d, %d, %d, %d]\n", rssi_sorting_seq[0], rssi_sorting_seq[1], rssi_sorting_seq[2], rssi_sorting_seq[3])); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Post]rank_idx_seq = [%d, %d, %d, %d]\n", rank_idx_seq[0], rank_idx_seq[1], rank_idx_seq[2], rank_idx_seq[3])); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Post]rank_idx_out = [%d, %d, %d, %d]\n", rank_idx_out[0], rank_idx_out[1], rank_idx_out[2], rank_idx_out[3])); -+ */ -+ -+ if (target_ant_beam_max_rssi[i] > max_beam_ant_rssi) { -+ TargetAnt = i; -+ max_beam_ant_rssi = target_ant_beam_max_rssi[i]; -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Target of Ant = (( %d )) max_beam_ant_rssi = (( %d ))\n", -+ TargetAnt, max_beam_ant_rssi));*/ -+ } -+ break_counter++; -+ if (break_counter >= (pdm_sat_table->ant_num)) -+ break; -+ } -+ -+ #ifdef CONFIG_FAT_PATCH -+ break_counter = 0; -+ for (i = (pdm_sat_table->first_train_ant-1); i < pdm_sat_table->ant_num_total; i++) { -+ for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { -+ -+ per_beam_rssi_diff_tmp = (u1Byte)(max_beam_ant_rssi - pdm_sat_table->pkt_rssi_pre[i][j]); -+ pdm_sat_table->beam_train_rssi_diff[i][j] = per_beam_rssi_diff_tmp; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Ant[%d], Beam[%d]: RSSI_diff= ((%d))\n", -+ i, j, per_beam_rssi_diff_tmp)); -+ } -+ break_counter++; -+ if (break_counter >= (pdm_sat_table->ant_num)) -+ break; -+ } -+ #endif -+ -+ if (TargetAnt == 0) -+ TargetAnt = MAIN_ANT; -+ else if (TargetAnt == 1) -+ TargetAnt = AUX_ANT; -+ -+ if (pdm_sat_table->ant_num > 1) { -+ /* [ update RX ant ]*/ -+ ODM_UpdateRxIdleAnt(pDM_Odm, (u1Byte)TargetAnt); -+ -+ /* [ update TX ant ]*/ -+ odm_UpdateTxAnt(pDM_Odm, (u1Byte)TargetAnt, (pDM_FatTable->TrainIdx)); -+ } -+ -+ /*set beam in each antenna*/ -+ phydm_update_rx_idle_beam(pDM_Odm); -+ -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ pDM_FatTable->FAT_State = FAT_PREPARE_STATE; -+ -+ } -+ /* [TRAINING STATE] */ -+ else if (pDM_FatTable->FAT_State == FAT_TRAINING_STATE) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2. In Training State]\n")); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("fat_beam_n = (( %d )), pre_fat_beam_n = (( %d ))\n", -+ pdm_sat_table->fast_training_beam_num, pdm_sat_table->pre_fast_training_beam_num)); -+ -+ if (pdm_sat_table->fast_training_beam_num > pdm_sat_table->pre_fast_training_beam_num) { -+ -+ pdm_sat_table->force_update_beam_en = 0; -+ -+ } else { -+ -+ pdm_sat_table->force_update_beam_en = 1; -+ -+ pdm_sat_table->pkt_counter = 0; -+ beam_tmp = pdm_sat_table->fast_training_beam_num; -+ if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant-1)) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Timeout Update] Beam_num (( %d )) -> (( decision ))\n", pdm_sat_table->fast_training_beam_num)); -+ pDM_FatTable->FAT_State = FAT_DECISION_STATE; -+ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); -+ -+ } else { -+ pdm_sat_table->fast_training_beam_num++; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Timeout Update] Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); -+ phydm_set_all_ant_same_beam_num(pDM_Odm); -+ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; -+ -+ } -+ } -+ pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Update Pre_Beam =(( %d ))\n", pdm_sat_table->pre_fast_training_beam_num)); -+ } -+ /* [Prepare State] */ -+ /*=======================================================================================*/ -+ else if (pDM_FatTable->FAT_State == FAT_PREPARE_STATE) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n\n[ 1. In Prepare State]\n")); -+ -+ if (pDM_Odm->pre_TrafficLoad == (pDM_Odm->TrafficLoad)) { -+ if (pdm_sat_table->decision_holding_period != 0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Holding_period = (( %d )), return!!!\n", pdm_sat_table->decision_holding_period)); -+ pdm_sat_table->decision_holding_period--; -+ return; -+ } -+ } -+ -+ -+ /* Set training packet number*/ -+ if (pdm_sat_table->fix_training_num_en == 0) { -+ -+ switch (pDM_Odm->TrafficLoad) { -+ -+ case TRAFFIC_HIGH: -+ pdm_sat_table->per_beam_training_pkt_num = 8; -+ pdm_sat_table->decision_holding_period = 2; -+ break; -+ case TRAFFIC_MID: -+ pdm_sat_table->per_beam_training_pkt_num = 6; -+ pdm_sat_table->decision_holding_period = 3; -+ break; -+ case TRAFFIC_LOW: -+ pdm_sat_table->per_beam_training_pkt_num = 3; /*ping 60000*/ -+ pdm_sat_table->decision_holding_period = 4; -+ break; -+ case TRAFFIC_ULTRA_LOW: -+ pdm_sat_table->per_beam_training_pkt_num = 1; -+ pdm_sat_table->decision_holding_period = 6; -+ break; -+ default: -+ break; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fix_training_en = (( %d )), training_pkt_num_base = (( %d )), holding_period = ((%d))\n", -+ pdm_sat_table->fix_training_num_en , pdm_sat_table->per_beam_training_pkt_num, pdm_sat_table->decision_holding_period)); -+ -+ -+ #ifdef CONFIG_FAT_PATCH -+ break_counter = 0; -+ for (i = (pdm_sat_table->first_train_ant-1); i < pdm_sat_table->ant_num_total; i++) { -+ for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { -+ -+ per_beam_rssi_diff_tmp = pdm_sat_table->beam_train_rssi_diff[i][j]; -+ training_pkt_num_offset = per_beam_rssi_diff_tmp; -+ -+ if ((pdm_sat_table->per_beam_training_pkt_num) > training_pkt_num_offset) -+ pdm_sat_table->beam_train_cnt[i][j] = pdm_sat_table->per_beam_training_pkt_num - training_pkt_num_offset; -+ else -+ pdm_sat_table->beam_train_cnt[i][j] = 1; -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Ant[%d]: Beam_num-(( %d )) training_pkt_num = ((%d))\n", -+ i, j, pdm_sat_table->beam_train_cnt[i][j])); -+ } -+ break_counter++; -+ if (break_counter >= (pdm_sat_table->ant_num)) -+ break; -+ } -+ -+ -+ phydm_FastTraining_enable(pDM_Odm , FAT_OFF); -+ pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; -+ pdm_sat_table->update_beam_idx = 0; -+ -+ if (*pDM_Odm->pBandType == ODM_BAND_5G) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set 5G ant\n")); -+ /*used_ant = (pdm_sat_table->first_train_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT;*/ -+ used_ant = pdm_sat_table->first_train_ant; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set 2.4G ant\n")); -+ used_ant = pdm_sat_table->first_train_ant; -+ } -+ -+ ODM_UpdateRxIdleAnt(pDM_Odm, (u1Byte)used_ant); -+ -+ #else -+ /* Set training MAC Addr. of target */ -+ odm_SetNextMACAddrTarget(pDM_Odm); -+ phydm_FastTraining_enable(pDM_Odm , FAT_ON); -+ #endif -+ -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ pdm_sat_table->pkt_counter = 0; -+ pdm_sat_table->fast_training_beam_num = 0; -+ phydm_set_all_ant_same_beam_num(pDM_Odm); -+ pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; -+ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; -+ } -+ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+phydm_beam_switch_workitem_callback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER pAdapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ -+ #if DEV_BUS_TYPE != RT_PCI_INTERFACE -+ pdm_sat_table->pkt_skip_statistic_en = 1; -+ #endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Beam Switch Workitem Callback, pkt_skip_statistic_en = (( %d ))\n", pdm_sat_table->pkt_skip_statistic_en)); -+ -+ phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); -+ -+ #if DEV_BUS_TYPE != RT_PCI_INTERFACE -+ /*ODM_StallExecution(pdm_sat_table->latch_time);*/ -+ pdm_sat_table->pkt_skip_statistic_en = 0; -+ #endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pkt_skip_statistic_en = (( %d )), latch_time = (( %d ))\n", pdm_sat_table->pkt_skip_statistic_en, pdm_sat_table->latch_time)); -+} -+ -+VOID -+phydm_beam_decision_workitem_callback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER pAdapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Beam decision Workitem Callback\n")); -+ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); -+} -+#endif -+ -+#endif /*#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ -+ -+VOID -+ODM_AntDivInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] Not Support Antenna Diversity Function\n")); -+ return; -+ } -+ //--- -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_2G) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[2G AntDiv Init]: Only Support 2G Antenna Diversity Function\n")); -+ if(!(pDM_Odm->SupportICType & ODM_ANTDIV_2G_SUPPORT_IC)) -+ return; -+ } -+ else if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_5G) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[5G AntDiv Init]: Only Support 5G Antenna Diversity Function\n")); -+ if(!(pDM_Odm->SupportICType & ODM_ANTDIV_5G_SUPPORT_IC)) -+ return; -+ } -+ else if(pDM_FatTable->AntDiv_2G_5G == (ODM_ANTDIV_2G|ODM_ANTDIV_5G)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[2G & 5G AntDiv Init]:Support Both 2G & 5G Antenna Diversity Function\n")); -+ } -+ -+#endif -+ //--- -+ -+ //2 [--General---] -+ pDM_Odm->antdiv_period=0; -+ -+ pDM_FatTable->bBecomeLinked =FALSE; -+ pDM_FatTable->AntDiv_OnOff =0xff; -+ -+ //3 - AP - -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ #if (BEAMFORMING_SUPPORT == 1) -+ #if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ odm_BDC_Init(pDM_Odm); -+ #endif -+ #endif -+ -+ //3 - WIN - -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pDM_SWAT_Table->Ant5G = MAIN_ANT; -+ pDM_SWAT_Table->Ant2G = MAIN_ANT; -+ pDM_FatTable->CCK_counter_main=0; -+ pDM_FatTable->CCK_counter_aux=0; -+ pDM_FatTable->OFDM_counter_main=0; -+ pDM_FatTable->OFDM_counter_aux=0; -+ #endif -+ -+ //2 [---Set MAIN_ANT as default antenna if Auto-Ant enable---] -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ -+ pDM_Odm->AntType = ODM_AUTO_ANT; -+ -+ pDM_FatTable->RxIdleAnt = 0xff; /*to make RX-idle-antenna will be updated absolutly*/ -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ phydm_keep_RxAckAnt_By_TxAnt_time( pDM_Odm, 5); /* Timming issue: keep Rx ant after tx for ACK ( 5 x 3.2 mu = 16mu sec)*/ -+ -+ //2 [---Set TX Antenna---] -+ pDM_FatTable->ForceTxAntByDesc = 0; -+ pDM_FatTable->pForceTxAntByDesc = &(pDM_FatTable->ForceTxAntByDesc); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("pForceTxAntByDesc = %d\n", *pDM_FatTable->pForceTxAntByDesc)); -+ -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); -+ -+ -+ //2 [--88E---] -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ #if (RTL8188E_SUPPORT == 1) -+ //pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ //pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; -+ -+ if( (pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_SMART_ANTDIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 88E Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ -+ if(pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) -+ odm_RX_HWAntDiv_Init_88E(pDM_Odm); -+ else if(pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) -+ odm_TRX_HWAntDiv_Init_88E(pDM_Odm); -+ #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ else if(pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) -+ odm_Smart_HWAntDiv_Init_88E(pDM_Odm); -+ #endif -+ #endif -+ } -+ -+ //2 [--92E---] -+ #if (RTL8192E_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ //pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ //pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; -+ -+ if( (pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_SMART_ANTDIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8192E Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ -+ if(pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) -+ odm_RX_HWAntDiv_Init_92E(pDM_Odm); -+ else if(pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) -+ odm_TRX_HWAntDiv_Init_92E(pDM_Odm); -+ #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ else if(pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) -+ odm_Smart_HWAntDiv_Init_92E(pDM_Odm); -+ #endif -+ -+ } -+ #endif -+ -+ //2 [--8723B---] -+ #if (RTL8723B_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ -+ if(pDM_Odm->AntDivType != S0S1_SW_ANTDIV && pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8723B Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ -+ if( pDM_Odm->AntDivType==S0S1_SW_ANTDIV) -+ odm_S0S1_SWAntDiv_Init_8723B(pDM_Odm); -+ else if(pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV) -+ odm_TRX_HWAntDiv_Init_8723B(pDM_Odm); -+ } -+ #endif -+ /*2 [--8723D---]*/ -+ #if (RTL8723D_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ if (pDM_FatTable->pDefaultS0S1 == NULL) { -+ pDM_FatTable->DefaultS0S1 = 1; -+ pDM_FatTable->pDefaultS0S1 = &(pDM_FatTable->DefaultS0S1); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("DefaultS0S1 = %d\n", *pDM_FatTable->pDefaultS0S1)); -+ -+ if (*(pDM_FatTable->pDefaultS0S1) == TRUE) -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ else -+ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); -+ -+ if (pDM_Odm->AntDivType == S0S1_TRX_HW_ANTDIV) -+ odm_TRX_HWAntDiv_Init_8723D(pDM_Odm); -+ else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8723D Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ -+ } -+ #endif -+ //2 [--8811A 8821A---] -+ #if (RTL8821A_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ pDM_Odm->AntDivType = HL_SW_SMART_ANT_TYPE1; -+ -+ if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) { -+ -+ odm_TRX_HWAntDiv_Init_8821A(pDM_Odm); -+ phydm_hl_smart_ant_type1_init_8821a(pDM_Odm); -+ } else -+ #endif -+ { -+ /*pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV;*/ -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ -+ if (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV && pDM_Odm->AntDivType != S0S1_SW_ANTDIV) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8821A & 8811A Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) -+ odm_TRX_HWAntDiv_Init_8821A(pDM_Odm); -+ else if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) -+ odm_S0S1_SWAntDiv_Init_8821A(pDM_Odm); -+ } -+ } -+ #endif -+ -+ //2 [--8821C---] -+ #if (RTL8821C_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8821C) -+ { -+ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ if (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV ) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8821C Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ odm_TRX_HWAntDiv_Init_8821C(pDM_Odm); -+ } -+ #endif -+ -+ //2 [--8881A---] -+ #if (RTL8881A_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8881A) -+ { -+ //pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ -+ if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) { -+ -+ odm_TRX_HWAntDiv_Init_8881A(pDM_Odm); -+ /**/ -+ } else { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8881A Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ -+ odm_TRX_HWAntDiv_Init_8881A(pDM_Odm); -+ } -+ #endif -+ -+ //2 [--8812---] -+ #if (RTL8812A_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ -+ if( pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8812A Not Supprrt This AntDiv Type\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ return; -+ } -+ odm_TRX_HWAntDiv_Init_8812A(pDM_Odm); -+ } -+ #endif -+ -+ /*[--8188F---]*/ -+ #if (RTL8188F_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ odm_S0S1_SWAntDiv_Init_8188F(pDM_Odm); -+ } -+ #endif -+ /* -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** SupportICType=[%lu]\n",pDM_Odm->SupportICType)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** AntDiv SupportAbility=[%lu]\n",(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)>>6)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** AntDiv Type=[%d]\n",pDM_Odm->AntDivType)); -+ */ -+} -+ -+VOID -+ODM_AntDiv( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ #endif -+ -+ if(*pDM_Odm->pBandType == ODM_BAND_5G ) -+ { -+ if(pDM_FatTable->idx_AntDiv_counter_5G < pDM_Odm->antdiv_period ) -+ { -+ pDM_FatTable->idx_AntDiv_counter_5G++; -+ return; -+ } -+ else -+ pDM_FatTable->idx_AntDiv_counter_5G=0; -+ } -+ else if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) -+ { -+ if(pDM_FatTable->idx_AntDiv_counter_2G < pDM_Odm->antdiv_period ) -+ { -+ pDM_FatTable->idx_AntDiv_counter_2G++; -+ return; -+ } -+ else -+ pDM_FatTable->idx_AntDiv_counter_2G=0; -+ } -+ -+ //---------- -+ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] Not Support Antenna Diversity Function\n")); -+ return; -+ } -+ -+ //---------- -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ if (pDM_FatTable->enable_ctrl_frame_antdiv) { -+ -+ if ((pDM_Odm->data_frame_num <= 10) && (pDM_Odm->bLinked)) -+ pDM_FatTable->use_ctrl_frame_antdiv = 1; -+ else -+ pDM_FatTable->use_ctrl_frame_antdiv = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("use_ctrl_frame_antdiv = (( %d )), data_frame_num = (( %d ))\n", pDM_FatTable->use_ctrl_frame_antdiv, pDM_Odm->data_frame_num)); -+ pDM_Odm->data_frame_num = 0; -+ } -+ -+ if(pAdapter->MgntInfo.AntennaTest) -+ return; -+ -+ { -+ #if (BEAMFORMING_SUPPORT == 1) -+ BEAMFORMING_CAP BeamformCap = (pDM_Odm->BeamformingInfo.BeamformCap); -+ -+ if( BeamformCap & BEAMFORMEE_CAP ) // BFmee On && Div On -> Div Off -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ AntDiv : OFF ] BFmee ==1 \n")); -+ if(pDM_FatTable->fix_ant_bfee == 0) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ pDM_FatTable->fix_ant_bfee = 1; -+ } -+ return; -+ } -+ else // BFmee Off && Div Off -> Div On -+ { -+ if((pDM_FatTable->fix_ant_bfee == 1) && pDM_Odm->bLinked) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ AntDiv : ON ] BFmee ==0\n")); -+ if((pDM_Odm->AntDivType!=S0S1_SW_ANTDIV) ) -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ -+ pDM_FatTable->fix_ant_bfee = 0; -+ } -+ } -+ #endif -+ } -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ //----------just for fool proof -+ -+ if(pDM_Odm->antdiv_rssi) -+ pDM_Odm->DebugComponents |= ODM_COMP_ANT_DIV; -+ else -+ pDM_Odm->DebugComponents &= ~ODM_COMP_ANT_DIV; -+ -+ if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_2G) -+ { -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 2G AntDiv Running ]\n")); -+ if(!(pDM_Odm->SupportICType & ODM_ANTDIV_2G_SUPPORT_IC)) -+ return; -+ } -+ else if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_5G) -+ { -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 5G AntDiv Running ]\n")); -+ if(!(pDM_Odm->SupportICType & ODM_ANTDIV_5G_SUPPORT_IC)) -+ return; -+ } -+ //else if(pDM_FatTable->AntDiv_2G_5G == (ODM_ANTDIV_2G|ODM_ANTDIV_5G)) -+ //{ -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 2G & 5G AntDiv Running ]\n")); -+ //} -+#endif -+ -+ //---------- -+ -+ if (pDM_Odm->antdiv_select==1) -+ pDM_Odm->AntType = ODM_FIX_MAIN_ANT; -+ else if (pDM_Odm->antdiv_select==2) -+ pDM_Odm->AntType = ODM_FIX_AUX_ANT; -+ else //if (pDM_Odm->antdiv_select==0) -+ pDM_Odm->AntType = ODM_AUTO_ANT; -+ -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("AntType= (( %d )) , pre_AntType= (( %d )) \n",pDM_Odm->AntType,pDM_Odm->pre_AntType)); -+ -+ if(pDM_Odm->AntType != ODM_AUTO_ANT) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fix Antenna at (( %s ))\n",(pDM_Odm->AntType == ODM_FIX_MAIN_ANT)?"MAIN":"AUX")); -+ -+ if(pDM_Odm->AntType != pDM_Odm->pre_AntType) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); -+ -+ if(pDM_Odm->AntType == ODM_FIX_MAIN_ANT) -+ ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); -+ else if(pDM_Odm->AntType == ODM_FIX_AUX_ANT) -+ ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); -+ } -+ pDM_Odm->pre_AntType=pDM_Odm->AntType; -+ return; -+ } -+ else -+ { -+ if(pDM_Odm->AntType != pDM_Odm->pre_AntType) -+ { -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); -+ } -+ pDM_Odm->pre_AntType=pDM_Odm->AntType; -+ } -+ -+ -+ //3 ----------------------------------------------------------------------------------------------------------- -+ //2 [--88E---] -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ #if (RTL8188E_SUPPORT == 1) -+ if(pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV ||pDM_Odm->AntDivType==CGCS_RX_HW_ANTDIV) -+ odm_HW_AntDiv(pDM_Odm); -+ -+ #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ else if (pDM_Odm->AntDivType==CG_TRX_SMART_ANTDIV) -+ odm_FastAntTraining(pDM_Odm); -+ #endif -+ -+ #endif -+ -+ } -+ //2 [--92E---] -+ #if (RTL8192E_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ if(pDM_Odm->AntDivType==CGCS_RX_HW_ANTDIV || pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV) -+ odm_HW_AntDiv(pDM_Odm); -+ -+ #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ else if (pDM_Odm->AntDivType==CG_TRX_SMART_ANTDIV) -+ odm_FastAntTraining(pDM_Odm); -+ #endif -+ -+ } -+ #endif -+ -+ #if (RTL8723B_SUPPORT == 1) -+ //2 [--8723B---] -+ else if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ if (phydm_IsBtEnable_8723b(pDM_Odm)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BT is enable!!!]\n")); -+ if (pDM_FatTable->bBecomeLinked == TRUE) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set REG 948[9:6]=0x0\n")); -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) -+ ODM_SetBBReg(pDM_Odm, 0x948 , BIT9|BIT8|BIT7|BIT6, 0x0); -+ -+ pDM_FatTable->bBecomeLinked = FALSE; -+ } -+ } else { -+ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { -+ -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_PEEK); -+ #endif -+ } else if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) -+ odm_HW_AntDiv(pDM_Odm); -+ } -+ } -+ #endif -+ /*8723D*/ -+ #if (RTL8723D_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ -+ odm_HW_AntDiv(pDM_Odm); -+ /**/ -+ } -+ #endif -+ -+ //2 [--8821A---] -+ #if (RTL8821A_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) { -+ -+ if (pdm_sat_table->fix_beam_pattern_en != 0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [ SmartAnt ] Fix SmartAnt Pattern = 0x%x\n", pdm_sat_table->fix_beam_pattern_codeword)); -+ /*return;*/ -+ } else { -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] AntDivType = HL_SW_SMART_ANT_TYPE1\n"));*/ -+ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); -+ } -+ -+ } else -+ #endif -+ { -+ -+ if (!pDM_Odm->bBtEnabled) /*BT disabled*/ -+ { -+ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { -+ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [S0S1_SW_ANTDIV] -> [CG_TRX_HW_ANTDIV]\n")); -+ /*ODM_SetBBReg(pDM_Odm, 0x8D4 , BIT24, 1); */ -+ if (pDM_FatTable->bBecomeLinked == TRUE) -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); -+ } -+ -+ } else { /*BT enabled*/ -+ -+ if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) { -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [CG_TRX_HW_ANTDIV] -> [S0S1_SW_ANTDIV]\n")); -+ /*ODM_SetBBReg(pDM_Odm, 0x8D4 , BIT24, 0);*/ -+ odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); -+ } -+ } -+ -+ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { -+ -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_PEEK); -+ #endif -+ } else if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) -+ odm_HW_AntDiv(pDM_Odm); -+ } -+ } -+ #endif -+ -+ //2 [--8821C---] -+ #if (RTL8821C_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ { -+ odm_HW_AntDiv(pDM_Odm); -+ } -+ #endif -+ -+ //2 [--8881A---] -+ #if (RTL8881A_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8881A) -+ odm_HW_AntDiv(pDM_Odm); -+ #endif -+ -+ //2 [--8812A---] -+ #if (RTL8812A_SUPPORT == 1) -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) -+ odm_HW_AntDiv(pDM_Odm); -+ #endif -+ -+ #if (RTL8188F_SUPPORT == 1) -+ /* [--8188F---]*/ -+ else if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_PEEK); -+ #endif -+ } -+ #endif -+ -+} -+ -+ -+VOID -+odm_AntselStatistics( -+ IN PVOID pDM_VOID, -+ IN u1Byte antsel_tr_mux, -+ IN u4Byte MacId, -+ IN u4Byte utility, -+ IN u1Byte method, -+ IN u1Byte isCCKrate -+ -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ if (method == RSSI_METHOD) { -+ -+ if (isCCKrate) { -+ if (antsel_tr_mux == ANT1_2G) { -+ if (pDM_FatTable->MainAnt_Sum_cck[MacId] > 65435) /*to prevent u2Byte overflow, max(RSSI)=100, 65435+100 = 65535 (u2Byte)*/ -+ return; -+ -+ pDM_FatTable->MainAnt_Sum_cck[MacId] += (u2Byte)utility; -+ pDM_FatTable->MainAnt_Cnt_cck[MacId]++; -+ } else { -+ if (pDM_FatTable->AuxAnt_Sum_cck[MacId] > 65435) -+ return; -+ -+ pDM_FatTable->AuxAnt_Sum_cck[MacId] += (u2Byte)utility; -+ pDM_FatTable->AuxAnt_Cnt_cck[MacId]++; -+ } -+ -+ } else { /*ofdm rate*/ -+ -+ if (antsel_tr_mux == ANT1_2G) { -+ if (pDM_FatTable->MainAnt_Sum[MacId] > 65435) -+ return; -+ -+ pDM_FatTable->MainAnt_Sum[MacId] += (u2Byte)utility; -+ pDM_FatTable->MainAnt_Cnt[MacId]++; -+ } else { -+ if (pDM_FatTable->AuxAnt_Sum[MacId] > 65435) -+ return; -+ -+ pDM_FatTable->AuxAnt_Sum[MacId] += (u2Byte)utility; -+ pDM_FatTable->AuxAnt_Cnt[MacId]++; -+ } -+ } -+ } -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ else if(method==EVM_METHOD) -+ { -+ if(antsel_tr_mux == ANT1_2G) -+ { -+ pDM_FatTable->MainAntEVM_Sum[MacId]+=(utility<<5); -+ pDM_FatTable->MainAntEVM_Cnt[MacId]++; -+ } -+ else -+ { -+ pDM_FatTable->AuxAntEVM_Sum[MacId]+=(utility<<5); -+ pDM_FatTable->AuxAntEVM_Cnt[MacId]++; -+ } -+ } -+ else if(method==CRC32_METHOD) -+ { -+ if(utility==0) -+ pDM_FatTable->CRC32_Fail_Cnt++; -+ else -+ pDM_FatTable->CRC32_Ok_Cnt+=utility; -+ } -+ #endif -+} -+ -+ -+VOID -+ODM_Process_RSSIForAntDiv( -+ IN OUT PVOID pDM_VOID, -+ IN PVOID p_phy_info_void, -+ IN PVOID p_pkt_info_void -+ //IN PODM_PHY_INFO_T pPhyInfo, -+ //IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_PHY_INFO_T pPhyInfo=(PODM_PHY_INFO_T)p_phy_info_void; -+ PODM_PACKET_INFO_T pPktinfo=(PODM_PACKET_INFO_T)p_pkt_info_void; -+ u1Byte isCCKrate=0,CCKMaxRate=ODM_RATE11M; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); -+ u4Byte beam_tmp; -+ u1Byte next_ant; -+ u1Byte train_pkt_number; -+ #endif -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ u4Byte RxPower_Ant0, RxPower_Ant1; -+ u4Byte RxEVM_Ant0, RxEVM_Ant1; -+ #else -+ u1Byte RxPower_Ant0, RxPower_Ant1; -+ u1Byte RxEVM_Ant0, RxEVM_Ant1; -+ #endif -+ -+ CCKMaxRate=ODM_RATE11M; -+ isCCKrate = (pPktinfo->DataRate <= CCKMaxRate)?TRUE:FALSE; -+ -+ if ((pDM_Odm->SupportICType & (ODM_RTL8192E|ODM_RTL8812)) && (pPktinfo->DataRate > CCKMaxRate)) -+ { -+ RxPower_Ant0 = pPhyInfo->RxMIMOSignalStrength[0]; -+ RxPower_Ant1= pPhyInfo->RxMIMOSignalStrength[1]; -+ -+ RxEVM_Ant0 =pPhyInfo->RxMIMOSignalQuality[0]; -+ RxEVM_Ant1 =pPhyInfo->RxMIMOSignalQuality[1]; -+ } -+ else -+ RxPower_Ant0=pPhyInfo->RxPWDBAll; -+ -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ #ifdef CONFIG_FAT_PATCH -+ if ((pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) && (pDM_FatTable->FAT_State == FAT_TRAINING_STATE)) { -+ -+ /*[Beacon]*/ -+ if (pPktinfo->bPacketBeacon) { -+ -+ pdm_sat_table->beacon_counter++; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MatchBSSID_beacon_counter = ((%d))\n", pdm_sat_table->beacon_counter)); -+ -+ if (pdm_sat_table->beacon_counter >= pdm_sat_table->pre_beacon_counter + 2) { -+ -+ if (pdm_sat_table->ant_num > 1) { -+ next_ant = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? AUX_ANT : MAIN_ANT; -+ ODM_UpdateRxIdleAnt(pDM_Odm, next_ant); -+ } -+ -+ pdm_sat_table->update_beam_idx++; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pre_beacon_counter = ((%d)), pkt_counter = ((%d)), update_beam_idx = ((%d))\n", -+ pdm_sat_table->pre_beacon_counter, pdm_sat_table->pkt_counter, pdm_sat_table->update_beam_idx)); -+ -+ pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; -+ pdm_sat_table->pkt_counter = 0; -+ } -+ } -+ /*[Data]*/ -+ else if (pPktinfo->bPacketToSelf) { -+ -+ if (pdm_sat_table->pkt_skip_statistic_en == 0) { -+ /* -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", -+ pPktinfo->StationID, pDM_FatTable->antsel_rx_keep_0, pDM_FatTable->hw_antsw_occur, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); -+ */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ID[%d][pkt_cnt = %d]: {ANT, Beam} = {%d, %d}, RSSI = ((%d))\n", -+ pPktinfo->StationID, pdm_sat_table->pkt_counter, pDM_FatTable->antsel_rx_keep_0, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); -+ -+ pdm_sat_table->pkt_rssi_sum[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num] += RxPower_Ant0; -+ pdm_sat_table->pkt_rssi_cnt[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num]++; -+ pdm_sat_table->pkt_counter++; -+ -+ #if 1 -+ train_pkt_number = pdm_sat_table->beam_train_cnt[pDM_FatTable->RxIdleAnt-1][pdm_sat_table->fast_training_beam_num]; -+ #else -+ train_pkt_number = pdm_sat_table->per_beam_training_pkt_num; -+ #endif -+ -+ /*Swich Antenna erery N pkts*/ -+ if (pdm_sat_table->pkt_counter == train_pkt_number) { -+ -+ if (pdm_sat_table->ant_num > 1) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("packet enugh ((%d ))pkts ---> Switch antenna\n", train_pkt_number)); -+ next_ant = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? AUX_ANT : MAIN_ANT; -+ ODM_UpdateRxIdleAnt(pDM_Odm, next_ant); -+ } -+ -+ pdm_sat_table->update_beam_idx++; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pre_beacon_counter = ((%d)), update_beam_idx_counter = ((%d))\n", -+ pdm_sat_table->pre_beacon_counter, pdm_sat_table->update_beam_idx)); -+ -+ pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; -+ pdm_sat_table->pkt_counter = 0; -+ } -+ } -+ } -+ -+ /*Swich Beam after switch "pdm_sat_table->ant_num" antennas*/ -+ if (pdm_sat_table->update_beam_idx == pdm_sat_table->ant_num) { -+ -+ pdm_sat_table->update_beam_idx = 0; -+ pdm_sat_table->pkt_counter = 0; -+ beam_tmp = pdm_sat_table->fast_training_beam_num; -+ -+ if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant-1)) { -+ -+ pDM_FatTable->FAT_State = FAT_DECISION_STATE; -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); -+ #else -+ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_decision_workitem); -+ #endif -+ -+ -+ } else { -+ pdm_sat_table->fast_training_beam_num++; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); -+ phydm_set_all_ant_same_beam_num(pDM_Odm); -+ -+ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; -+ } -+ } -+ -+ } -+ #else -+ -+ if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) -+ { -+ if ((pDM_Odm->SupportICType & ODM_HL_SMART_ANT_TYPE1_SUPPORT) && -+ (pPktinfo->bPacketToSelf) && -+ (pDM_FatTable->FAT_State == FAT_TRAINING_STATE) -+ ) { -+ -+ if (pdm_sat_table->pkt_skip_statistic_en == 0) { -+ /* -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", -+ pPktinfo->StationID, pDM_FatTable->antsel_rx_keep_0, pDM_FatTable->hw_antsw_occur, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); -+ */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antsel_pathA = ((%d)), bPacketToSelf = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", -+ pPktinfo->StationID, pDM_FatTable->antsel_rx_keep_0, pPktinfo->bPacketToSelf, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); -+ -+ -+ pdm_sat_table->pkt_rssi_sum[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num] += RxPower_Ant0; -+ pdm_sat_table->pkt_rssi_cnt[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num]++; -+ pdm_sat_table->pkt_counter++; -+ -+ /*swich beam every N pkt*/ -+ if ((pdm_sat_table->pkt_counter) >= (pdm_sat_table->per_beam_training_pkt_num)) { -+ -+ pdm_sat_table->pkt_counter = 0; -+ beam_tmp = pdm_sat_table->fast_training_beam_num; -+ -+ if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant-1)) { -+ -+ pDM_FatTable->FAT_State = FAT_DECISION_STATE; -+ -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); -+ #else -+ ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_decision_workitem); -+ #endif -+ -+ -+ } else { -+ pdm_sat_table->fast_training_beam_num++; -+ phydm_set_all_ant_same_beam_num(pDM_Odm); -+ -+ pDM_FatTable->FAT_State = FAT_TRAINING_STATE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); -+ } -+ } -+ } -+ } -+ } -+ #endif -+ else -+ #endif -+ if (pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) { -+ if( (pDM_Odm->SupportICType & ODM_SMART_ANT_SUPPORT) && (pPktinfo->bPacketToSelf) && (pDM_FatTable->FAT_State == FAT_TRAINING_STATE) )//(pPktinfo->bPacketMatchBSSID && (!pPktinfo->bPacketBeacon)) -+ { -+ u1Byte antsel_tr_mux; -+ antsel_tr_mux = (pDM_FatTable->antsel_rx_keep_2<<2) |(pDM_FatTable->antsel_rx_keep_1 <<1) |pDM_FatTable->antsel_rx_keep_0; -+ pDM_FatTable->antSumRSSI[antsel_tr_mux] += RxPower_Ant0; -+ pDM_FatTable->antRSSIcnt[antsel_tr_mux]++; -+ } -+ } -+ else //AntDivType != CG_TRX_SMART_ANTDIV -+ { -+ if ((pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) && (pPktinfo->bPacketToSelf || pDM_FatTable->use_ctrl_frame_antdiv)) { -+ -+ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { -+ -+ if (isCCKrate) { -+ -+ pDM_FatTable->antsel_rx_keep_0 = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? ANT1_2G : ANT2_2G; -+ -+ if (pDM_FatTable->antsel_rx_keep_0 == ANT1_2G) -+ pDM_FatTable->CCK_counter_main++; -+ else -+ pDM_FatTable->CCK_counter_aux++; -+ -+ odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxPower_Ant0, RSSI_METHOD, isCCKrate); -+ -+ } else { -+ -+ if (pDM_FatTable->antsel_rx_keep_0 == ANT1_2G) -+ pDM_FatTable->OFDM_counter_main++; -+ else -+ pDM_FatTable->OFDM_counter_aux++; -+ -+ odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxPower_Ant0, RSSI_METHOD, isCCKrate); -+ } -+ } else { -+ -+ odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxPower_Ant0, RSSI_METHOD, isCCKrate); -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ if (pDM_Odm->SupportICType == ODM_RTL8192E) { -+ if (!isCCKrate) -+ odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxEVM_Ant0, EVM_METHOD, isCCKrate); -+ -+ } -+ #endif -+ } -+ } -+ } -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("isCCKrate=%d, PWDB_ALL=%d\n",isCCKrate, pPhyInfo->RxPWDBAll)); -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("antsel_tr_mux=3'b%d%d%d\n",pDM_FatTable->antsel_rx_keep_2, pDM_FatTable->antsel_rx_keep_1, pDM_FatTable->antsel_rx_keep_0)); -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+VOID -+ODM_SetTxAntByTxInfo( -+ IN PVOID pDM_VOID, -+ IN pu1Byte pDesc, -+ IN u1Byte macId -+ -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ return; -+ -+ if (pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) -+ return; -+ -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+#if (RTL8723B_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_8723B(pDesc, pDM_FatTable->antsel_a[macId]); -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8723B] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", -+ macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ -+#endif -+ } else if (pDM_Odm->SupportICType == ODM_RTL8821) { -+#if (RTL8821A_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_8812(pDesc, pDM_FatTable->antsel_a[macId]); -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8821A] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", -+ macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ -+#endif -+ } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+#if (RTL8188E_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_88E(pDesc, pDM_FatTable->antsel_a[macId]); -+ SET_TX_DESC_ANTSEL_B_88E(pDesc, pDM_FatTable->antsel_b[macId]); -+ SET_TX_DESC_ANTSEL_C_88E(pDesc, pDM_FatTable->antsel_c[macId]); -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8188E] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", -+ macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ -+#endif -+ } else if (pDM_Odm->SupportICType == ODM_RTL8821C) { -+#if (RTL8821C_SUPPORT == 1) -+ SET_TX_DESC_ANTSEL_A_8821C(pDesc, pDM_FatTable->antsel_a[macId]); -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8821C] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", -+ macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ -+#endif -+ } -+} -+#elif(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+VOID -+ODM_SetTxAntByTxInfo( -+ struct rtl8192cd_priv *priv, -+ struct tx_desc *pdesc, -+ unsigned short aid -+) -+{ -+ PDM_ODM_T pDM_Odm = &(priv->pshare->_dmODM); -+ pFAT_T pDM_FatTable = &priv->pshare->_dmODM.DM_FatTable; -+ u4Byte SupportICType = priv->pshare->_dmODM.SupportICType; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ return; -+ -+ if (pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) -+ return; -+ -+ if (SupportICType == ODM_RTL8881A) { -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__); */ -+ pdesc->Dword6 &= set_desc(~(BIT(18)|BIT(17)|BIT(16))); -+ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_a[aid]<<16); -+ } else if (SupportICType == ODM_RTL8192E) { -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8192E******\n",__FUNCTION__,__LINE__); */ -+ pdesc->Dword6 &= set_desc(~(BIT(18)|BIT(17)|BIT(16))); -+ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_a[aid]<<16); -+ } else if (SupportICType == ODM_RTL8188E) { -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8188E******\n",__FUNCTION__,__LINE__);*/ -+ pdesc->Dword2 &= set_desc(~BIT(24)); -+ pdesc->Dword2 &= set_desc(~BIT(25)); -+ pdesc->Dword7 &= set_desc(~BIT(29)); -+ -+ pdesc->Dword2 |= set_desc(pDM_FatTable->antsel_a[aid]<<24); -+ pdesc->Dword2 |= set_desc(pDM_FatTable->antsel_b[aid]<<25); -+ pdesc->Dword7 |= set_desc(pDM_FatTable->antsel_c[aid]<<29); -+ -+ -+ } else if (SupportICType == ODM_RTL8812) { -+ /*[path-A]*/ -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__);*/ -+ -+ pdesc->Dword6 &= set_desc(~BIT(16)); -+ pdesc->Dword6 &= set_desc(~BIT(17)); -+ pdesc->Dword6 &= set_desc(~BIT(18)); -+ -+ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_a[aid]<<16); -+ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_b[aid]<<17); -+ pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_c[aid]<<18); -+ -+ } -+} -+ -+ -+#if 1 /*def CONFIG_WLAN_HAL*/ -+VOID -+ODM_SetTxAntByTxInfo_HAL( -+ struct rtl8192cd_priv *priv, -+ PVOID pdesc_data, -+ u2Byte aid -+) -+{ -+ PDM_ODM_T pDM_Odm = &(priv->pshare->_dmODM); -+ pFAT_T pDM_FatTable = &priv->pshare->_dmODM.DM_FatTable; -+ u4Byte SupportICType = priv->pshare->_dmODM.SupportICType; -+ PTX_DESC_DATA_88XX pdescdata = (PTX_DESC_DATA_88XX)pdesc_data; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ return; -+ -+ if (pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) -+ return; -+ -+ if (SupportICType == ODM_RTL8881A || SupportICType == ODM_RTL8192E || SupportICType == ODM_RTL8814A) { -+ /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_HAL******\n",__FUNCTION__,__LINE__);*/ -+ pdescdata->antSel = 1; -+ pdescdata->antSel_A = pDM_FatTable->antsel_a[aid]; -+ } -+} -+#endif /*#ifdef CONFIG_WLAN_HAL*/ -+ -+#endif -+ -+ -+VOID -+ODM_AntDiv_Config( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ ODM_RT_TRACE (pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("WIN Config Antenna Diversity\n")); -+ /* -+ if(pDM_Odm->SupportICType==ODM_RTL8723B) -+ { -+ if((!pDM_Odm->DM_SWAT_Table.ANTA_ON || !pDM_Odm->DM_SWAT_Table.ANTB_ON)) -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ } -+ */ -+ if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ -+ pDM_Odm->AntDivType = S0S1_TRX_HW_ANTDIV; -+ /**/ -+ } -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CE Config Antenna Diversity\n")); -+ -+ if(pDM_Odm->SupportICType==ODM_RTL8723B) -+ { -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ -+ -+ } -+ -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("AP Config Antenna Diversity\n")); -+ -+ //2 [ NOT_SUPPORT_ANTDIV ] -+ #if(defined(CONFIG_NOT_SUPPORT_ANTDIV)) -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Disable AntDiv function] : Not Support 2.4G & 5G Antenna Diversity\n")); -+ -+ //2 [ 2G&5G_SUPPORT_ANTDIV ] -+ #elif(defined(CONFIG_2G5G_SUPPORT_ANTDIV)) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : 2.4G & 5G Support Antenna Diversity Simultaneously \n")); -+ pDM_FatTable->AntDiv_2G_5G = (ODM_ANTDIV_2G|ODM_ANTDIV_5G); -+ -+ if(pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) -+ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; -+ if(*pDM_Odm->pBandType == ODM_BAND_5G ) -+ { -+ #if ( defined(CONFIG_5G_CGCS_RX_DIVERSITY) ) -+ pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); -+ panic_printk("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n"); -+ #elif( defined(CONFIG_5G_CG_TRX_DIVERSITY)||defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A)) -+ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); -+ panic_printk("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n"); -+ #elif( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_SMART_ANTDIV\n")); -+ #elif( defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = S0S1_SW_ANTDIV\n")); -+ #endif -+ } -+ else if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) -+ { -+ #if ( defined(CONFIG_2G_CGCS_RX_DIVERSITY) ) -+ pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); -+ #elif( defined(CONFIG_2G_CG_TRX_DIVERSITY) || defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A)) -+ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); -+ #elif( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_SMART_ANTDIV\n")); -+ #elif( defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = S0S1_SW_ANTDIV\n")); -+ #endif -+ } -+ -+ //2 [ 5G_SUPPORT_ANTDIV ] -+ #elif(defined(CONFIG_5G_SUPPORT_ANTDIV)) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n")); -+ panic_printk("[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n"); -+ pDM_FatTable->AntDiv_2G_5G = (ODM_ANTDIV_5G); -+ if(*pDM_Odm->pBandType == ODM_BAND_5G ) -+ { -+ if(pDM_Odm->SupportICType & ODM_ANTDIV_5G_SUPPORT_IC) -+ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; -+ #if ( defined(CONFIG_5G_CGCS_RX_DIVERSITY) ) -+ pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); -+ panic_printk("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n"); -+ #elif( defined(CONFIG_5G_CG_TRX_DIVERSITY) ) -+ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ panic_printk("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n"); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); -+ #elif( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_SMART_ANTDIV\n")); -+ #elif( defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = S0S1_SW_ANTDIV\n")); -+ #endif -+ } -+ else if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Not Support 2G AntDivType\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ } -+ -+ //2 [ 2G_SUPPORT_ANTDIV ] -+ #elif(defined(CONFIG_2G_SUPPORT_ANTDIV)) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : Only 2.4G Support Antenna Diversity\n")); -+ pDM_FatTable->AntDiv_2G_5G = (ODM_ANTDIV_2G); -+ if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) -+ { -+ if(pDM_Odm->SupportICType & ODM_ANTDIV_2G_SUPPORT_IC) -+ pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; -+ #if ( defined(CONFIG_2G_CGCS_RX_DIVERSITY) ) -+ pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); -+ #elif( defined(CONFIG_2G_CG_TRX_DIVERSITY) ) -+ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); -+ #elif( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_SMART_ANTDIV\n")); -+ #elif( defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY) ) -+ pDM_Odm->AntDivType = S0S1_SW_ANTDIV; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = S0S1_SW_ANTDIV\n")); -+ #endif -+ } -+ else if(*pDM_Odm->pBandType == ODM_BAND_5G ) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Not Support 5G AntDivType\n")); -+ pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); -+ } -+ #endif -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[AntDiv Config Info] AntDiv_SupportAbility = (( %x ))\n", ((pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) ? 1 : 0))); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[AntDiv Config Info] be_fix_tx_ant = ((%d))\n", pDM_Odm->DM_FatTable.b_fix_tx_ant)); -+ -+} -+ -+ -+VOID -+ODM_AntDivTimers( -+ IN PVOID pDM_VOID, -+ IN u1Byte state -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if(state==INIT_ANTDIV_TIMMER) -+ { -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ ODM_InitializeTimer(pDM_Odm, &(pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchTimer), -+ (RT_TIMER_CALL_BACK)ODM_SW_AntDiv_Callback, NULL, "phydm_SwAntennaSwitchTimer"); -+ #elif ( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ ODM_InitializeTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer, -+ (RT_TIMER_CALL_BACK)odm_FastAntTrainingCallback, NULL, "FastAntTrainingTimer"); -+ #endif -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ ODM_InitializeTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer, -+ (RT_TIMER_CALL_BACK)odm_EVM_FastAntTrainingCallback, NULL, "EVM_FastAntTrainingTimer"); -+ #endif -+ } -+ else if(state==CANCEL_ANTDIV_TIMMER) -+ { -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ ODM_CancelTimer(pDM_Odm, &(pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchTimer)); -+ #elif ( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ ODM_CancelTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer); -+ #endif -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ ODM_CancelTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer); -+ #endif -+ } -+ else if(state==RELEASE_ANTDIV_TIMMER) -+ { -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ ODM_ReleaseTimer(pDM_Odm, &(pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchTimer)); -+ #elif ( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer); -+ #endif -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer); -+ #endif -+ } -+ -+} -+ -+VOID -+phydm_antdiv_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ /*pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable;*/ -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ if (dm_value[0] == 1) { /*fixed or auto antenna*/ -+ -+ if (dm_value[1] == 0) { -+ pDM_Odm->antdiv_select = 0; -+ PHYDM_SNPRINTF((output+used, out_len-used, "AntDiv: Auto\n")); -+ } else if (dm_value[1] == 1) { -+ pDM_Odm->antdiv_select = 1; -+ PHYDM_SNPRINTF((output+used, out_len-used, "AntDiv: Fix MAin\n")); -+ } else if (dm_value[1] == 2) { -+ pDM_Odm->antdiv_select = 2; -+ PHYDM_SNPRINTF((output+used, out_len-used, "AntDiv: Fix Aux\n")); -+ } -+ } else if (dm_value[0] == 2) { /*dynamic period for AntDiv*/ -+ -+ pDM_Odm->antdiv_period = (u1Byte)dm_value[1]; -+ PHYDM_SNPRINTF((output+used, out_len-used, "AntDiv_period = ((%d))\n", pDM_Odm->antdiv_period)); -+ } -+} -+ -+#endif /*#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))*/ -+ -+VOID -+ODM_AntDivReset( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) -+ { -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_S0S1_SWAntDiv_Reset(pDM_Odm); -+ #endif -+ } -+ -+} -+ -+VOID -+odm_AntennaDiversityInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ #if 0 -+ if(pDM_Odm->mp_mode == TRUE) -+ return; -+ #endif -+ -+ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ ODM_AntDiv_Config(pDM_Odm); -+ ODM_AntDivInit(pDM_Odm); -+ #endif -+} -+ -+VOID -+odm_AntennaDiversity( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if(pDM_Odm->mp_mode == TRUE) -+ return; -+ -+ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ ODM_AntDiv(pDM_Odm); -+ #endif -+} -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_antdiv.h 2018-02-11 21:44:27.155146208 +0200 -@@ -0,0 +1,634 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMANTDIV_H__ -+#define __PHYDMANTDIV_H__ -+ -+/*#define ANTDIV_VERSION "2.0" //2014.11.04*/ -+/*#define ANTDIV_VERSION "2.1" //2015.01.13 Dino*/ -+/*#define ANTDIV_VERSION "2.2" 2015.01.16 Dino*/ -+/*#define ANTDIV_VERSION "3.1" 2015.07.29 YuChen, remove 92c 92d 8723a*/ -+/*#define ANTDIV_VERSION "3.2" 2015.08.11 Stanley, disable antenna diversity when BT is enable for 8723B*/ -+/*#define ANTDIV_VERSION "3.3" 2015.08.12 Stanley. 8723B does not need to check the antenna is control by BT, -+ because antenna diversity only works when BT is disable or radio off*/ -+/*#define ANTDIV_VERSION "3.4" 2015.08.28 Dino 1.Add 8821A Smart Antenna 2. Add 8188F SW S0S1 Antenna Diversity*/ -+/*#define ANTDIV_VERSION "3.5" 2015.10.07 Stanley Always check antenna detection result from BT-coex. for 8723B, not from PHYDM*/ -+/*#define ANTDIV_VERSION "3.6"*/ /*2015.11.16 Stanley */ -+/*#define ANTDIV_VERSION "3.7"*/ /*2015.11.20 Dino Add SmartAnt FAT Patch */ -+/*#define ANTDIV_VERSION "3.8" 2015.12.21 Dino, Add SmartAnt dynamic training packet num */ -+#define ANTDIV_VERSION "3.9" /*2016.01.05 Dino, Add SmartAnt cmd for converting single & two smtant, and add cmd for adjust truth table */ -+ -+//1 ============================================================ -+//1 Definition -+//1 ============================================================ -+ -+#define ANTDIV_INIT 0xff -+#define MAIN_ANT 1 /*Ant A or Ant Main or S1*/ -+#define AUX_ANT 2 /*AntB or Ant Aux or S0*/ -+#define MAX_ANT 3 /* 3 for AP using*/ -+ -+#define ANT1_2G 0 /* = ANT2_5G for 8723D BTG S1 RX S0S1 diversity for 8723D, TX fixed at S1 */ -+#define ANT2_2G 1 /* = ANT1_5G for 8723D BTG S0 RX S0S1 diversity for 8723D, TX fixed at S1 */ -+/*smart antenna*/ -+#define SUPPORT_RF_PATH_NUM 4 -+#define SUPPORT_BEAM_PATTERN_NUM 4 -+#define NUM_ANTENNA_8821A 2 -+ -+#define NO_FIX_TX_ANT 0 -+#define FIX_TX_AT_MAIN 1 -+#define FIX_AUX_AT_MAIN 2 -+ -+//Antenna Diversty Control Type -+#define ODM_AUTO_ANT 0 -+#define ODM_FIX_MAIN_ANT 1 -+#define ODM_FIX_AUX_ANT 2 -+ -+#define ODM_N_ANTDIV_SUPPORT (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8188F|ODM_RTL8723D|ODM_RTL8195A) -+#define ODM_AC_ANTDIV_SUPPORT (ODM_RTL8821|ODM_RTL8881A|ODM_RTL8812|ODM_RTL8821C) -+#define ODM_ANTDIV_SUPPORT (ODM_N_ANTDIV_SUPPORT|ODM_AC_ANTDIV_SUPPORT) -+#define ODM_SMART_ANT_SUPPORT (ODM_RTL8188E|ODM_RTL8192E) -+#define ODM_HL_SMART_ANT_TYPE1_SUPPORT (ODM_RTL8821) -+ -+#define ODM_ANTDIV_2G_SUPPORT_IC (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8881A|ODM_RTL8188F|ODM_RTL8723D) -+#define ODM_ANTDIV_5G_SUPPORT_IC (ODM_RTL8821|ODM_RTL8881A|ODM_RTL8812|ODM_RTL8821C) -+ -+#define ODM_EVM_ENHANCE_ANTDIV_SUPPORT_IC (ODM_RTL8192E) -+ -+#define ODM_ANTDIV_2G BIT0 -+#define ODM_ANTDIV_5G BIT1 -+ -+#define ANTDIV_ON 1 -+#define ANTDIV_OFF 0 -+ -+#define FAT_ON 1 -+#define FAT_OFF 0 -+ -+#define TX_BY_DESC 1 -+#define TX_BY_REG 0 -+ -+#define RSSI_METHOD 0 -+#define EVM_METHOD 1 -+#define CRC32_METHOD 2 -+ -+#define INIT_ANTDIV_TIMMER 0 -+#define CANCEL_ANTDIV_TIMMER 1 -+#define RELEASE_ANTDIV_TIMMER 2 -+ -+#define CRC32_FAIL 1 -+#define CRC32_OK 0 -+ -+#define Evm_RSSI_TH_High 25 -+#define Evm_RSSI_TH_Low 20 -+ -+#define NORMAL_STATE_MIAN 1 -+#define NORMAL_STATE_AUX 2 -+#define TRAINING_STATE 3 -+ -+#define FORCE_RSSI_DIFF 10 -+ -+#define CSI_ON 1 -+#define CSI_OFF 0 -+ -+#define DIVON_CSIOFF 1 -+#define DIVOFF_CSION 2 -+ -+#define BDC_DIV_TRAIN_STATE 0 -+#define BDC_BFer_TRAIN_STATE 1 -+#define BDC_DECISION_STATE 2 -+#define BDC_BF_HOLD_STATE 3 -+#define BDC_DIV_HOLD_STATE 4 -+ -+#define BDC_MODE_1 1 -+#define BDC_MODE_2 2 -+#define BDC_MODE_3 3 -+#define BDC_MODE_4 4 -+#define BDC_MODE_NULL 0xff -+ -+/*SW S0S1 antenna diversity*/ -+#define SWAW_STEP_INIT 0xff -+#define SWAW_STEP_PEEK 0 -+#define SWAW_STEP_DETERMINE 1 -+ -+#define RSSI_CHECK_RESET_PERIOD 10 -+#define RSSI_CHECK_THRESHOLD 50 -+ -+/*Hong Lin Smart antenna*/ -+#define HL_SMTANT_2WIRE_DATA_LEN 24 -+ -+//1 ============================================================ -+//1 structure -+//1 ============================================================ -+ -+ -+typedef struct _SW_Antenna_Switch_ -+{ -+ u1Byte Double_chk_flag; /*If current antenna RSSI > "RSSI_CHECK_THRESHOLD", than check this antenna again*/ -+ u1Byte try_flag; -+ s4Byte PreRSSI; -+ u1Byte CurAntenna; -+ u1Byte PreAntenna; -+ u1Byte RSSI_Trying; -+ u1Byte reset_idx; -+ u1Byte Train_time; -+ u1Byte Train_time_flag; /*base on RSSI difference between two antennas*/ -+ RT_TIMER phydm_SwAntennaSwitchTimer; -+ u4Byte PktCnt_SWAntDivByCtrlFrame; -+ BOOLEAN bSWAntDivByCtrlFrame; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #if USE_WORKITEM -+ RT_WORK_ITEM phydm_SwAntennaSwitchWorkitem; -+ #endif -+ #endif -+ -+ /* AntDect (Before link Antenna Switch check) need to be moved*/ -+ u2Byte Single_Ant_Counter; -+ u2Byte Dual_Ant_Counter; -+ u2Byte Aux_FailDetec_Counter; -+ u2Byte Retry_Counter; -+ u1Byte SWAS_NoLink_State; -+ u4Byte SWAS_NoLink_BK_Reg948; -+ BOOLEAN ANTA_ON; /*To indicate Ant A is or not*/ -+ BOOLEAN ANTB_ON; /*To indicate Ant B is on or not*/ -+ BOOLEAN Pre_Aux_FailDetec; -+ BOOLEAN RSSI_AntDect_bResult; -+ u1Byte Ant5G; -+ u1Byte Ant2G; -+ -+ -+}SWAT_T, *pSWAT_T; -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+typedef struct _BF_DIV_COEX_ -+{ -+ BOOLEAN w_BFer_Client[ODM_ASSOCIATE_ENTRY_NUM]; -+ BOOLEAN w_BFee_Client[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte MA_rx_TP[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte MA_rx_TP_DIV[ODM_ASSOCIATE_ENTRY_NUM]; -+ -+ u1Byte BDCcoexType_wBfer; -+ u1Byte num_Txbfee_Client; -+ u1Byte num_Txbfer_Client; -+ u1Byte BDC_Try_counter; -+ u1Byte BDC_Hold_counter; -+ u1Byte BDC_Mode; -+ u1Byte BDC_active_Mode; -+ u1Byte BDC_state; -+ u1Byte BDC_RxIdleUpdate_counter; -+ u1Byte num_Client; -+ u1Byte pre_num_Client; -+ u1Byte num_BfTar; -+ u1Byte num_DivTar; -+ -+ BOOLEAN bAll_DivSta_Idle; -+ BOOLEAN bAll_BFSta_Idle; -+ BOOLEAN BDC_Try_flag; -+ BOOLEAN BF_pass; -+ BOOLEAN DIV_pass; -+}BDC_T,*pBDC_T; -+#endif -+#endif -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+typedef struct _SMART_ANTENNA_TRAINNING_ { -+ u4Byte latch_time; -+ BOOLEAN pkt_skip_statistic_en; -+ u4Byte fix_beam_pattern_en; -+ u4Byte fix_training_num_en; -+ u4Byte fix_beam_pattern_codeword; -+ u4Byte update_beam_codeword; -+ u4Byte ant_num; /*number of used smart beam antenna*/ -+ u4Byte ant_num_total;/*number of total smart beam antenna*/ -+ u4Byte first_train_ant; /*decide witch antenna to train first*/ -+ u4Byte rfu_codeword_table[4]; /*2G beam truth table*/ -+ u4Byte rfu_codeword_table_5g[4]; /*5G beam truth table*/ -+ u4Byte beam_patten_num_each_ant;/*number of beam can be switched in each antenna*/ -+ u4Byte data_codeword_bit_num; -+ u1Byte per_beam_training_pkt_num; -+ u1Byte decision_holding_period; -+ u1Byte pkt_counter; -+ u4Byte fast_training_beam_num; -+ u4Byte pre_fast_training_beam_num; -+ u4Byte pkt_rssi_pre[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; -+ u1Byte beam_train_cnt[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; -+ u1Byte beam_train_rssi_diff[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; -+ u4Byte pkt_rssi_sum[8][SUPPORT_BEAM_PATTERN_NUM]; -+ u4Byte pkt_rssi_cnt[8][SUPPORT_BEAM_PATTERN_NUM]; -+ u4Byte rx_idle_beam[SUPPORT_RF_PATH_NUM]; -+ u4Byte pre_codeword; -+ BOOLEAN force_update_beam_en; -+ u4Byte beacon_counter; -+ u4Byte pre_beacon_counter; -+ u1Byte update_beam_idx; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_WORK_ITEM hl_smart_antenna_workitem; -+ RT_WORK_ITEM hl_smart_antenna_decision_workitem; -+ #endif -+ -+} SAT_T, *pSAT_T; -+#endif -+ -+typedef struct _FAST_ANTENNA_TRAINNING_ -+{ -+ u1Byte Bssid[6]; -+ u1Byte antsel_rx_keep_0; -+ u1Byte antsel_rx_keep_1; -+ u1Byte antsel_rx_keep_2; -+ u1Byte antsel_rx_keep_3; -+ u4Byte antSumRSSI[7]; -+ u4Byte antRSSIcnt[7]; -+ u4Byte antAveRSSI[7]; -+ u1Byte FAT_State; -+ u4Byte TrainIdx; -+ u1Byte antsel_a[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte antsel_b[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte antsel_c[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte MainAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte AuxAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte MainAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte AuxAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte MainAnt_Sum_cck[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte AuxAnt_Sum_cck[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte MainAnt_Cnt_cck[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte AuxAnt_Cnt_cck[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte RxIdleAnt; -+ u1Byte AntDiv_OnOff; -+ BOOLEAN bBecomeLinked; -+ u4Byte MinMaxRSSI; -+ u1Byte idx_AntDiv_counter_2G; -+ u1Byte idx_AntDiv_counter_5G; -+ u1Byte AntDiv_2G_5G; -+ u4Byte CCK_counter_main; -+ u4Byte CCK_counter_aux; -+ u4Byte OFDM_counter_main; -+ u4Byte OFDM_counter_aux; -+ -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ u4Byte MainAntEVM_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte AuxAntEVM_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte MainAntEVM_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte AuxAntEVM_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ BOOLEAN EVM_method_enable; -+ u1Byte TargetAnt_EVM; -+ u1Byte TargetAnt_CRC32; -+ u1Byte TargetAnt_enhance; -+ u1Byte pre_TargetAnt_enhance; -+ u2Byte Main_MPDU_OK_cnt; -+ u2Byte Aux_MPDU_OK_cnt; -+ -+ u4Byte CRC32_Ok_Cnt; -+ u4Byte CRC32_Fail_Cnt; -+ u4Byte MainCRC32_Ok_Cnt; -+ u4Byte AuxCRC32_Ok_Cnt; -+ u4Byte MainCRC32_Fail_Cnt; -+ u4Byte AuxCRC32_Fail_Cnt; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ u4Byte CCK_CtrlFrame_Cnt_main; -+ u4Byte CCK_CtrlFrame_Cnt_aux; -+ u4Byte OFDM_CtrlFrame_Cnt_main; -+ u4Byte OFDM_CtrlFrame_Cnt_aux; -+ u4Byte MainAnt_CtrlFrame_Sum; -+ u4Byte AuxAnt_CtrlFrame_Sum; -+ u4Byte MainAnt_CtrlFrame_Cnt; -+ u4Byte AuxAnt_CtrlFrame_Cnt; -+ #endif -+ u1Byte b_fix_tx_ant; -+ BOOLEAN fix_ant_bfee; -+ BOOLEAN enable_ctrl_frame_antdiv; -+ BOOLEAN use_ctrl_frame_antdiv; -+ u1Byte hw_antsw_occur; -+ u1Byte *pForceTxAntByDesc; -+ u1Byte ForceTxAntByDesc; /*A temp value, will hook to driver team's outer parameter later*/ -+ u1Byte *pDefaultS0S1; -+ u1Byte DefaultS0S1; -+}FAT_T,*pFAT_T; -+ -+ -+//1 ============================================================ -+//1 enumeration -+//1 ============================================================ -+ -+ -+ -+typedef enum _FAT_STATE /*Fast antenna training*/ -+{ -+ FAT_BEFORE_LINK_STATE = 0, -+ FAT_PREPARE_STATE = 1, -+ FAT_TRAINING_STATE = 2, -+ FAT_DECISION_STATE = 3 -+}FAT_STATE_E, *PFAT_STATE_E; -+ -+typedef enum _ANT_DIV_TYPE -+{ -+ NO_ANTDIV = 0xFF, -+ CG_TRX_HW_ANTDIV = 0x01, -+ CGCS_RX_HW_ANTDIV = 0x02, -+ FIXED_HW_ANTDIV = 0x03, -+ CG_TRX_SMART_ANTDIV = 0x04, -+ CGCS_RX_SW_ANTDIV = 0x05, -+ S0S1_SW_ANTDIV = 0x06, /*8723B intrnal switch S0 S1*/ -+ S0S1_TRX_HW_ANTDIV = 0x07, /*TRX S0S1 diversity for 8723D*/ -+ HL_SW_SMART_ANT_TYPE1 = 0x10 /*Hong-Lin Smart antenna use for 8821AE which is a 2 Ant. entitys, and each Ant. is equipped with 4 antenna patterns*/ -+}ANT_DIV_TYPE_E, *PANT_DIV_TYPE_E; -+ -+ -+//1 ============================================================ -+//1 function prototype -+//1 ============================================================ -+ -+ -+VOID -+ODM_StopAntennaSwitchDm( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+phydm_enable_antenna_diversity( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+ODM_SetAntConfig( -+ IN PVOID pDM_VOID, -+ IN u1Byte antSetting // 0=A, 1=B, 2=C, .... -+ ); -+ -+ -+#define SwAntDivRestAfterLink ODM_SwAntDivRestAfterLink -+ -+VOID ODM_SwAntDivRestAfterLink( -+ IN PVOID pDM_VOID -+ ); -+ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ -+VOID -+ODM_UpdateRxIdleAnt( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant -+); -+ -+#if (RTL8723B_SUPPORT == 1) -+VOID -+ODM_UpdateRxIdleAnt_8723B( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant, -+ IN u4Byte DefaultAnt, -+ IN u4Byte OptionalAnt -+); -+#endif -+ -+#if (RTL8188F_SUPPORT == 1) -+VOID -+phydm_update_rx_idle_antenna_8188F( -+ IN PVOID pDM_VOID, -+ IN u4Byte default_ant -+); -+#endif -+ -+#if (RTL8723D_SUPPORT == 1) -+ -+VOID -+phydm_set_tx_ant_pwr_8723d( -+ IN PVOID pDM_VOID, -+ IN u1Byte Ant -+); -+ -+#endif -+ -+#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+ODM_SW_AntDiv_Callback( -+ IN PRT_TIMER pTimer -+ ); -+ -+VOID -+ODM_SW_AntDiv_WorkitemCallback( -+ IN PVOID pContext -+ ); -+ -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+VOID -+ODM_SW_AntDiv_WorkitemCallback( -+ IN PVOID pContext -+); -+ -+VOID -+ODM_SW_AntDiv_Callback( -+ void *FunctionContext -+ ); -+ -+#endif -+ -+VOID -+odm_S0S1_SwAntDivByCtrlFrame( -+ IN PVOID pDM_VOID, -+ IN u1Byte Step -+); -+ -+VOID -+odm_AntselStatisticsOfCtrlFrame( -+ IN PVOID pDM_VOID, -+ IN u1Byte antsel_tr_mux, -+ IN u4Byte RxPWDBAll -+); -+ -+VOID -+odm_S0S1_SwAntDivByCtrlFrame_ProcessRSSI( -+ IN PVOID pDM_VOID, -+ IN PVOID p_phy_info_void, -+ IN PVOID p_pkt_info_void -+); -+ -+#endif -+ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+VOID -+odm_EVM_FastAntTrainingCallback( -+ IN PVOID pDM_VOID -+); -+#endif -+ -+VOID -+odm_HW_AntDiv( -+ IN PVOID pDM_VOID -+); -+ -+#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+VOID -+odm_FastAntTraining( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_FastAntTrainingCallback( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_FastAntTrainingWorkItemCallback( -+ IN PVOID pDM_VOID -+); -+#endif -+ -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+phydm_beam_switch_workitem_callback( -+ IN PVOID pContext -+ ); -+ -+VOID -+phydm_beam_decision_workitem_callback( -+ IN PVOID pContext -+ ); -+ -+#endif -+ -+VOID -+phydm_update_beam_pattern( -+ IN PVOID pDM_VOID, -+ IN u4Byte codeword, -+ IN u4Byte codeword_length -+ ); -+ -+void -+phydm_set_all_ant_same_beam_num( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+phydm_hl_smart_ant_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+); -+ -+#endif/*#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ -+ -+VOID -+ODM_AntDivInit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+ODM_AntDiv( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_AntselStatistics( -+ IN PVOID pDM_VOID, -+ IN u1Byte antsel_tr_mux, -+ IN u4Byte MacId, -+ IN u4Byte utility, -+ IN u1Byte method, -+ IN u1Byte isCCKrate -+); -+ -+VOID -+ODM_Process_RSSIForAntDiv( -+ IN OUT PVOID pDM_VOID, -+ IN PVOID p_phy_info_void, -+ IN PVOID p_pkt_info_void -+); -+ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+VOID -+ODM_SetTxAntByTxInfo( -+ IN PVOID pDM_VOID, -+ IN pu1Byte pDesc, -+ IN u1Byte macId -+); -+ -+#elif(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+struct tx_desc; /*declared tx_desc here or compile error happened when enabled 8822B*/ -+ -+VOID -+ODM_SetTxAntByTxInfo( -+ struct rtl8192cd_priv *priv, -+ struct tx_desc *pdesc, -+ unsigned short aid -+); -+ -+#if 1/*def def CONFIG_WLAN_HAL*/ -+VOID -+ODM_SetTxAntByTxInfo_HAL( -+ struct rtl8192cd_priv *priv, -+ PVOID pdesc_data, -+ u2Byte aid -+); -+#endif /*#ifdef CONFIG_WLAN_HAL*/ -+#endif -+ -+ -+VOID -+ODM_AntDiv_Config( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+ODM_AntDivTimers( -+ IN PVOID pDM_VOID, -+ IN u1Byte state -+); -+ -+VOID -+phydm_antdiv_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+); -+ -+#endif /*#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))*/ -+ -+VOID -+ODM_AntDivReset( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_AntennaDiversityInit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_AntennaDiversity( -+ IN PVOID pDM_VOID -+); -+ -+#endif /*#ifndef __ODMANTDIV_H__*/ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.c 2018-02-11 21:44:27.155146208 +0200 -@@ -0,0 +1,1882 @@ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if WPP_SOFTWARE_TRACE -+#include "phydm_beamforming.tmh" -+#endif -+#endif -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ -+PRT_BEAMFORM_STAINFO -+phydm_staInfoInit( -+ IN PDM_ODM_T pDM_Odm, -+ IN u2Byte staIdx -+ ) -+{ -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORM_STAINFO pEntry = &(pBeamInfo->BeamformSTAinfo); -+ PSTA_INFO_T pSTA = pDM_Odm->pODM_StaInfo[staIdx]; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pMgntInfo); -+ PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pMgntInfo); -+ -+ ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, Adapter->CurrentAddress, 6); -+ -+ pEntry->HtBeamformCap = pHTInfo->HtBeamformCap; -+ pEntry->VhtBeamformCap = pVHTInfo->VhtBeamformCap; -+ -+ /*IBSS, AP mode*/ -+ if (staIdx != 0) { -+ pEntry->AID = pSTA->AID; -+ pEntry->RA = pSTA->MacAddr; -+ pEntry->MacID = pSTA->AssociatedMacId; -+ pEntry->WirelessMode = pSTA->WirelessMode; -+ pEntry->BW = pSTA->BandWidth; -+ pEntry->CurBeamform = pSTA->HTInfo.HtCurBeamform; -+ } else {/*client mode*/ -+ pEntry->AID = pMgntInfo->mAId; -+ pEntry->RA = pMgntInfo->Bssid; -+ pEntry->MacID = pMgntInfo->mMacId; -+ pEntry->WirelessMode = pMgntInfo->dot11CurrentWirelessMode; -+ pEntry->BW = pMgntInfo->dot11CurrentChannelBandWidth; -+ pEntry->CurBeamform = pHTInfo->HtCurBeamform; -+ } -+ -+ if ((pEntry->WirelessMode & WIRELESS_MODE_AC_5G) || (pEntry->WirelessMode & WIRELESS_MODE_AC_24G)) { -+ if (staIdx != 0) -+ pEntry->CurBeamformVHT = pSTA->VHTInfo.VhtCurBeamform; -+ else -+ pEntry->CurBeamformVHT = pVHTInfo->VhtCurBeamform; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("pSTA->wireless_mode = 0x%x, staidx = %d\n", pSTA->WirelessMode, staIdx)); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+ if (!IS_STA_VALID(pSTA)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s => sta_info(mac_id:%d) failed\n", __func__, staIdx)); -+ rtw_warn_on(1); -+ return pEntry; -+ } -+ -+ ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, adapter_mac_addr(pSTA->padapter), 6); -+ pEntry->HtBeamformCap = pSTA->htpriv.beamform_cap; -+ -+ pEntry->AID = pSTA->aid; -+ pEntry->RA = pSTA->hwaddr; -+ pEntry->MacID = pSTA->mac_id; -+ pEntry->WirelessMode = pSTA->wireless_mode; -+ pEntry->BW = pSTA->bw_mode; -+ -+ pEntry->CurBeamform = pSTA->htpriv.beamform_cap; -+#if ODM_IC_11AC_SERIES_SUPPORT -+ if ((pEntry->WirelessMode & WIRELESS_MODE_AC_5G) || (pEntry->WirelessMode & WIRELESS_MODE_AC_24G)) { -+ pEntry->CurBeamformVHT = pSTA->vhtpriv.beamform_cap; -+ pEntry->VhtBeamformCap = pSTA->vhtpriv.beamform_cap; -+ } -+#endif -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("pSTA->wireless_mode = 0x%x, staidx = %d\n", pSTA->wireless_mode, staIdx)); -+#endif -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("pEntry->CurBeamform = 0x%x, pEntry->CurBeamformVHT = 0x%x\n", pEntry->CurBeamform, pEntry->CurBeamformVHT)); -+ return pEntry; -+ -+} -+void phydm_staInfoUpdate( -+ IN PDM_ODM_T pDM_Odm, -+ IN u2Byte staIdx, -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry -+ ) -+{ -+ PSTA_INFO_T pSTA = pDM_Odm->pODM_StaInfo[staIdx]; -+ -+ if (!IS_STA_VALID(pSTA)) -+ return; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ pSTA->txbf_paid = pBeamformEntry->P_AID; -+ pSTA->txbf_gid = pBeamformEntry->G_ID; -+#endif -+} -+ -+PRT_BEAMFORMEE_ENTRY -+phydm_Beamforming_GetBFeeEntryByAddr( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformeeEntry[i].bUsed && (eqMacAddr(RA, pBeamInfo->BeamformeeEntry[i].MacAddr))) { -+ *Idx = i; -+ return &(pBeamInfo->BeamformeeEntry[i]); -+ } -+ } -+ -+ return NULL; -+} -+ -+PRT_BEAMFORMER_ENTRY -+phydm_Beamforming_GetBFerEntryByAddr( -+ IN PVOID pDM_VOID, -+ IN pu1Byte TA, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformerEntry[i].bUsed && (eqMacAddr(TA, pBeamInfo->BeamformerEntry[i].MacAddr))) { -+ *Idx = i; -+ return &(pBeamInfo->BeamformerEntry[i]); -+ } -+ } -+ -+ return NULL; -+} -+ -+ -+PRT_BEAMFORMEE_ENTRY -+phydm_Beamforming_GetEntryByMacId( -+ IN PVOID pDM_VOID, -+ IN u1Byte MacId, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformeeEntry[i].bUsed && (MacId == pBeamInfo->BeamformeeEntry[i].MacId)) { -+ *Idx = i; -+ return &(pBeamInfo->BeamformeeEntry[i]); -+ } -+ } -+ -+ return NULL; -+} -+ -+ -+BEAMFORMING_CAP -+phydm_Beamforming_GetEntryBeamCapByMacId( -+ IN PVOID pDM_VOID, -+ IN u1Byte MacId -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ BEAMFORMING_CAP BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformeeEntry[i].bUsed && (MacId == pBeamInfo->BeamformeeEntry[i].MacId)) { -+ BeamformEntryCap = pBeamInfo->BeamformeeEntry[i].BeamformEntryCap; -+ i = BEAMFORMEE_ENTRY_NUM; -+ } -+ } -+ -+ return BeamformEntryCap; -+} -+ -+ -+PRT_BEAMFORMEE_ENTRY -+phydm_Beamforming_GetFreeBFeeEntry( -+ IN PVOID pDM_VOID, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformeeEntry[i].bUsed == FALSE) { -+ *Idx = i; -+ return &(pBeamInfo->BeamformeeEntry[i]); -+ } -+ } -+ return NULL; -+} -+ -+PRT_BEAMFORMER_ENTRY -+phydm_Beamforming_GetFreeBFerEntry( -+ IN PVOID pDM_VOID, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s ===>\n", __func__)); -+ -+ for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformerEntry[i].bUsed == FALSE) { -+ *Idx = i; -+ return &(pBeamInfo->BeamformerEntry[i]); -+ } -+ } -+ return NULL; -+} -+ -+/* -+// Description: Get the first entry index of MU Beamformee. -+// -+// Return Value: Index of the first MU sta. -+// -+// 2015.05.25. Created by tynli. -+// -+*/ -+u1Byte -+phydm_Beamforming_GetFirstMUBFeeEntryIdx( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte idx = 0xFF; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ BOOLEAN bFound = FALSE; -+ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ if (pBeamInfo->BeamformeeEntry[idx].bUsed && pBeamInfo->BeamformeeEntry[idx].is_mu_sta) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx=%d!\n", __func__, idx)); -+ bFound = TRUE; -+ break; -+ } -+ } -+ -+ if (!bFound) -+ idx = 0xFF; -+ -+ return idx; -+} -+ -+ -+/*Add SU BFee and MU BFee*/ -+PRT_BEAMFORMEE_ENTRY -+Beamforming_AddBFeeEntry( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORM_STAINFO pSTA, -+ IN BEAMFORMING_CAP BeamformCap, -+ IN u1Byte NumofSoundingDim, -+ IN u1Byte CompSteeringNumofBFer, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMEE_ENTRY pEntry = phydm_Beamforming_GetFreeBFeeEntry(pDM_Odm, Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (pEntry != NULL) { -+ pEntry->bUsed = TRUE; -+ pEntry->AID = pSTA->AID; -+ pEntry->MacId = pSTA->MacID; -+ pEntry->SoundBW = pSTA->BW; -+ ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, pSTA->MyMacAddr, 6); -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) { -+ /*BSSID[44:47] xor BSSID[40:43]*/ -+ u2Byte BSSID = ((pSTA->MyMacAddr[5] & 0xf0) >> 4) ^ (pSTA->MyMacAddr[5] & 0xf); -+ /*(dec(A) + dec(B)*32) mod 512*/ -+ pEntry->P_AID = (pSTA->AID + BSSID * 32) & 0x1ff; -+ pEntry->G_ID = 63; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID addressed to STA=%d\n", __func__, pEntry->P_AID)); -+ } else if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) { -+ /*ad hoc mode*/ -+ pEntry->P_AID = 0; -+ pEntry->G_ID = 63; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID as IBSS=%d\n", __func__, pEntry->P_AID)); -+ } else { -+ /*client mode*/ -+ pEntry->P_AID = pSTA->RA[5]; -+ /*BSSID[39:47]*/ -+ pEntry->P_AID = (pEntry->P_AID << 1) | (pSTA->RA[4] >> 7); -+ pEntry->G_ID = 0; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID addressed to AP=0x%X\n", __func__, pEntry->P_AID)); -+ } -+ cpMacAddr(pEntry->MacAddr, pSTA->RA); -+ pEntry->bTxBF = FALSE; -+ pEntry->bSound = FALSE; -+ pEntry->SoundPeriod = 400; -+ pEntry->BeamformEntryCap = BeamformCap; -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ -+/* pEntry->LogSeq = 0xff; Move to Beamforming_AddBFerEntry*/ -+/* pEntry->LogRetryCnt = 0; Move to Beamforming_AddBFerEntry*/ -+/* pEntry->LogSuccessCnt = 0; Move to Beamforming_AddBFerEntry*/ -+ -+ pEntry->LogStatusFailCnt = 0; -+ -+ pEntry->NumofSoundingDim = NumofSoundingDim; -+ pEntry->CompSteeringNumofBFer = CompSteeringNumofBFer; -+ -+ if (BeamformCap & BEAMFORMER_CAP_VHT_MU) { -+ pDM_Odm->BeamformingInfo.beamformee_mu_cnt += 1; -+ pEntry->is_mu_sta = TRUE; -+ pDM_Odm->BeamformingInfo.FirstMUBFeeIndex = phydm_Beamforming_GetFirstMUBFeeEntryIdx(pDM_Odm); -+ } else if (BeamformCap & (BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { -+ pDM_Odm->BeamformingInfo.beamformee_su_cnt += 1; -+ pEntry->is_mu_sta = FALSE; -+ } -+ -+ return pEntry; -+ } -+ else -+ return NULL; -+} -+ -+/*Add SU BFee and MU BFer*/ -+PRT_BEAMFORMER_ENTRY -+Beamforming_AddBFerEntry( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORM_STAINFO pSTA, -+ IN BEAMFORMING_CAP BeamformCap, -+ IN u1Byte NumofSoundingDim, -+ OUT pu1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMER_ENTRY pEntry = phydm_Beamforming_GetFreeBFerEntry(pDM_Odm, Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (pEntry != NULL) { -+ pEntry->bUsed = TRUE; -+ ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, pSTA->MyMacAddr, 6); -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) { -+ /*BSSID[44:47] xor BSSID[40:43]*/ -+ u2Byte BSSID = ((pSTA->MyMacAddr[5] & 0xf0) >> 4) ^ (pSTA->MyMacAddr[5] & 0xf); -+ -+ pEntry->P_AID = (pSTA->AID + BSSID * 32) & 0x1ff; -+ pEntry->G_ID = 63; -+ /*(dec(A) + dec(B)*32) mod 512*/ -+ } else if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) { -+ pEntry->P_AID = 0; -+ pEntry->G_ID = 63; -+ } else { -+ pEntry->P_AID = pSTA->RA[5]; -+ /*BSSID[39:47]*/ -+ pEntry->P_AID = (pEntry->P_AID << 1) | (pSTA->RA[4] >> 7); -+ pEntry->G_ID = 0; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: P_AID addressed to AP=0x%X\n", __func__, pEntry->P_AID)); -+ } -+ -+ cpMacAddr(pEntry->MacAddr, pSTA->RA); -+ pEntry->BeamformEntryCap = BeamformCap; -+ -+ pEntry->PreLogSeq = 0; /*Modified by Jeffery @2015-04-13*/ -+ pEntry->LogSeq = 0; /*Modified by Jeffery @2014-10-29*/ -+ pEntry->LogRetryCnt = 0; /*Modified by Jeffery @2014-10-29*/ -+ pEntry->LogSuccess = 0; /*LogSuccess is NOT needed to be accumulated, so LogSuccessCnt->LogSuccess, 2015-04-13, Jeffery*/ -+ pEntry->ClockResetTimes = 0; /*Modified by Jeffery @2015-04-13*/ -+ -+ pEntry->NumofSoundingDim = NumofSoundingDim; -+ -+ if (BeamformCap & BEAMFORMEE_CAP_VHT_MU) { -+ pDM_Odm->BeamformingInfo.beamformer_mu_cnt += 1; -+ pEntry->is_mu_ap = TRUE; -+ pEntry->AID = pSTA->AID; -+ } else if (BeamformCap & (BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { -+ pDM_Odm->BeamformingInfo.beamformer_su_cnt += 1; -+ pEntry->is_mu_ap = FALSE; -+ } -+ -+ return pEntry; -+ } -+ else -+ return NULL; -+} -+ -+#if 0 -+BOOLEAN -+Beamforming_RemoveEntry( -+ IN PADAPTER Adapter, -+ IN pu1Byte RA, -+ OUT pu1Byte Idx -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ PRT_BEAMFORMER_ENTRY pBFerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, RA, Idx); -+ PRT_BEAMFORMEE_ENTRY pEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, Idx); -+ BOOLEAN ret = FALSE; -+ -+ RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s Start!\n", __func__)); -+ RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s, pBFerEntry=0x%x\n", __func__, pBFerEntry)); -+ RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s, pEntry=0x%x\n", __func__, pEntry)); -+ -+ if (pEntry != NULL) { -+ pEntry->bUsed = FALSE; -+ pEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ /*pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE;*/ -+ pEntry->bBeamformingInProgress = FALSE; -+ ret = TRUE; -+ } -+ if (pBFerEntry != NULL) { -+ pBFerEntry->bUsed = FALSE; -+ pBFerEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ ret = TRUE; -+ } -+ return ret; -+ -+} -+#endif -+ -+/* Used for BeamformingStart_V1 */ -+VOID -+phydm_Beamforming_NDPARate( -+ IN PVOID pDM_VOID, -+ CHANNEL_WIDTH BW, -+ u1Byte Rate -+) -+{ -+ u2Byte NDPARate = Rate; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (NDPARate == 0) { -+ if(pDM_Odm->RSSI_Min > 30) // link RSSI > 30% -+ NDPARate = ODM_RATE24M; -+ else -+ NDPARate = ODM_RATE6M; -+ } -+ -+ if (NDPARate < ODM_RATEMCS0) -+ BW = (CHANNEL_WIDTH)ODM_BW20M; -+ -+ NDPARate = (NDPARate << 8) | BW; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_RATE, (pu1Byte)&NDPARate); -+ -+} -+ -+ -+/* Used for BeamformingStart_SW and BeamformingStart_FW */ -+VOID -+phydm_Beamforming_DymNDPARate( -+ IN PVOID pDM_VOID -+) -+{ -+ u2Byte NDPARate = ODM_RATE6M, BW; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (pDM_Odm->RSSI_Min > 30) /*link RSSI > 30%*/ -+ NDPARate = ODM_RATE24M; -+ else -+ NDPARate = ODM_RATE6M; -+ -+ BW = ODM_BW20M; -+ NDPARate = NDPARate << 8 | BW; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_RATE, (pu1Byte)&NDPARate); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, NDPA Rate = 0x%X\n", __func__, NDPARate)); -+} -+ -+/* -+* SW Sounding : SW Timer unit 1ms -+* HW Timer unit (1/32000) s 32k is clock. -+* FW Sounding : FW Timer unit 10ms -+*/ -+VOID -+Beamforming_DymPeriod( -+ IN PVOID pDM_VOID, -+ IN u8 status -+) -+{ -+ u1Byte Idx; -+ BOOLEAN bChangePeriod = FALSE; -+ u2Byte SoundPeriod_SW, SoundPeriod_FW; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); -+ -+ PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ //3 TODO per-client throughput caculation. -+ -+ if ((*(pDM_Odm->pCurrentTxTP) + *(pDM_Odm->pCurrentRxTP) > 2) && ((pEntry->LogStatusFailCnt <= 20) || status)) { -+ SoundPeriod_SW = 40; /* 40ms */ -+ SoundPeriod_FW = 40; /* From H2C cmd, unit = 10ms */ -+ } else { -+ SoundPeriod_SW = 4000;/* 4s */ -+ SoundPeriod_FW = 400; -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]SoundPeriod_SW=%d, SoundPeriod_FW=%d\n", __func__, SoundPeriod_SW, SoundPeriod_FW)); -+ -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ pBeamformEntry = pBeamInfo->BeamformeeEntry+Idx; -+ -+ if (pBeamformEntry->DefaultCSICnt > 20) { -+ /*Modified by David*/ -+ SoundPeriod_SW = 4000; -+ SoundPeriod_FW = 400; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Period = %d\n", __func__, SoundPeriod_SW)); -+ if (pBeamformEntry->BeamformEntryCap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { -+ if (pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER) { -+ if (pBeamformEntry->SoundPeriod != SoundPeriod_FW) { -+ pBeamformEntry->SoundPeriod = SoundPeriod_FW; -+ bChangePeriod = TRUE; /*Only FW sounding need to send H2C packet to change sound period. */ -+ } -+ } else if (pBeamformEntry->SoundPeriod != SoundPeriod_SW) { -+ pBeamformEntry->SoundPeriod = SoundPeriod_SW; -+ } -+ } -+ } -+ -+ if (bChangePeriod) -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_FW_NDPA, (pu1Byte)&Idx); -+} -+ -+ -+ -+ -+BOOLEAN -+Beamforming_SendHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW, -+ IN u1Byte QIdx -+ ) -+{ -+ BOOLEAN ret = TRUE; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (QIdx == BEACON_QUEUE) -+ ret = SendFWHTNDPAPacket(pDM_Odm, RA, BW); -+ else -+ ret = SendSWHTNDPAPacket(pDM_Odm, RA, BW); -+ -+ return ret; -+} -+ -+ -+ -+BOOLEAN -+Beamforming_SendVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW, -+ IN u1Byte QIdx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ BOOLEAN ret = TRUE; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_GET_TX_RATE, NULL); -+ -+ if ((pDM_Odm->TxBfDataRate >= ODM_RATEVHTSS3MCS7) && (pDM_Odm->TxBfDataRate <= ODM_RATEVHTSS3MCS9) && (pBeamInfo->snding3SS == FALSE)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s: 3SS VHT 789 don't sounding\n", __func__)); -+ -+ } else { -+ if (QIdx == BEACON_QUEUE) /* Send to reserved page => FW NDPA */ -+ ret = SendFWVHTNDPAPacket(pDM_Odm, RA, AID, BW); -+ else { -+#ifdef SUPPORT_MU_BF -+ #if (SUPPORT_MU_BF == 1) -+ pBeamInfo->is_mu_sounding = TRUE; -+ ret = SendSWVHTMUNDPAPacket(pDM_Odm, BW); -+ #else -+ pBeamInfo->is_mu_sounding = FALSE; -+ ret = SendSWVHTNDPAPacket(pDM_Odm, RA, AID, BW); -+ #endif -+#else -+ pBeamInfo->is_mu_sounding = FALSE; -+ ret = SendSWVHTNDPAPacket(pDM_Odm, RA, AID, BW); -+#endif -+ } -+ } -+ return ret; -+} -+ -+ -+BEAMFORMING_NOTIFY_STATE -+phydm_beamfomring_bSounding( -+ IN PVOID pDM_VOID, -+ PRT_BEAMFORMING_INFO pBeamInfo, -+ pu1Byte Idx -+ ) -+{ -+ BEAMFORMING_NOTIFY_STATE bSounding = BEAMFORMING_NOTIFY_NONE; -+ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ /*if(( Beamforming_GetBeamCap(pBeamInfo) & BEAMFORMER_CAP) == 0)*/ -+ /*bSounding = BEAMFORMING_NOTIFY_RESET;*/ -+ if (BeamOidInfo.SoundOidMode == SOUNDING_STOP_All_TIMER) -+ bSounding = BEAMFORMING_NOTIFY_RESET; -+ else { -+ u1Byte i; -+ -+ for (i = 0 ; i < BEAMFORMEE_ENTRY_NUM ; i++) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s: BFee Entry %d bUsed=%d, bSound=%d\n", __func__, i, pBeamInfo->BeamformeeEntry[i].bUsed, pBeamInfo->BeamformeeEntry[i].bSound)); -+ if (pBeamInfo->BeamformeeEntry[i].bUsed && (!pBeamInfo->BeamformeeEntry[i].bSound)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Add BFee entry %d\n", __func__, i)); -+ *Idx = i; -+ if (pBeamInfo->BeamformeeEntry[i].is_mu_sta) -+ bSounding = BEAMFORMEE_NOTIFY_ADD_MU; -+ else -+ bSounding = BEAMFORMEE_NOTIFY_ADD_SU; -+ } -+ -+ if ((!pBeamInfo->BeamformeeEntry[i].bUsed) && pBeamInfo->BeamformeeEntry[i].bSound) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Delete BFee entry %d\n", __func__, i)); -+ *Idx = i; -+ if (pBeamInfo->BeamformeeEntry[i].is_mu_sta) -+ bSounding = BEAMFORMEE_NOTIFY_DELETE_MU; -+ else -+ bSounding = BEAMFORMEE_NOTIFY_DELETE_SU; -+ } -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, bSounding = %d\n", __func__, bSounding)); -+ return bSounding; -+} -+ -+ -+//This function is unused -+u1Byte -+phydm_beamforming_SoundingIdx( -+ IN PVOID pDM_VOID, -+ PRT_BEAMFORMING_INFO pBeamInfo -+ ) -+{ -+ u1Byte Idx = 0; -+ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (BeamOidInfo.SoundOidMode == SOUNDING_SW_HT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_SW_VHT_TIMER || -+ BeamOidInfo.SoundOidMode == SOUNDING_HW_HT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_HW_VHT_TIMER) -+ Idx = BeamOidInfo.SoundOidIdx; -+ else { -+ u1Byte i; -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ if (pBeamInfo->BeamformeeEntry[i].bUsed && (FALSE == pBeamInfo->BeamformeeEntry[i].bSound)) { -+ Idx = i; -+ break; -+ } -+ } -+ } -+ -+ return Idx; -+} -+ -+ -+SOUNDING_MODE -+phydm_beamforming_SoundingMode( -+ IN PVOID pDM_VOID, -+ PRT_BEAMFORMING_INFO pBeamInfo, -+ u1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte SupportInterface = pDM_Odm->SupportInterface; -+ -+ RT_BEAMFORMEE_ENTRY BeamEntry = pBeamInfo->BeamformeeEntry[Idx]; -+ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; -+ SOUNDING_MODE Mode = BeamOidInfo.SoundOidMode; -+ -+ if (BeamOidInfo.SoundOidMode == SOUNDING_SW_VHT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_HW_VHT_TIMER) { -+ if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) -+ Mode = BeamOidInfo.SoundOidMode; -+ else -+ Mode = SOUNDING_STOP_All_TIMER; -+ } else if (BeamOidInfo.SoundOidMode == SOUNDING_SW_HT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_HW_HT_TIMER) { -+ if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT) -+ Mode = BeamOidInfo.SoundOidMode; -+ else -+ Mode = SOUNDING_STOP_All_TIMER; -+ } else if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) { -+ if ((SupportInterface == ODM_ITRF_USB) && !(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B))) -+ Mode = SOUNDING_FW_VHT_TIMER; -+ else -+ Mode = SOUNDING_SW_VHT_TIMER; -+ } else if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT) { -+ if ((SupportInterface == ODM_ITRF_USB) && !(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B))) -+ Mode = SOUNDING_FW_HT_TIMER; -+ else -+ Mode = SOUNDING_SW_HT_TIMER; -+ } else -+ Mode = SOUNDING_STOP_All_TIMER; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SupportInterface=%d, Mode=%d\n", __func__, SupportInterface, Mode)); -+ -+ return Mode; -+} -+ -+ -+u2Byte -+phydm_beamforming_SoundingTime( -+ IN PVOID pDM_VOID, -+ PRT_BEAMFORMING_INFO pBeamInfo, -+ SOUNDING_MODE Mode, -+ u1Byte Idx -+ ) -+{ -+ u2Byte SoundingTime = 0xffff; -+ RT_BEAMFORMEE_ENTRY BeamEntry = pBeamInfo->BeamformeeEntry[Idx]; -+ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_HW_VHT_TIMER) -+ SoundingTime = BeamOidInfo.SoundOidPeriod * 32; -+ else if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_SW_VHT_TIMER) -+ /*Modified by David*/ -+ SoundingTime = BeamEntry.SoundPeriod; /*BeamOidInfo.SoundOidPeriod;*/ -+ else -+ SoundingTime = BeamEntry.SoundPeriod; -+ -+ return SoundingTime; -+} -+ -+ -+CHANNEL_WIDTH -+phydm_beamforming_SoundingBW( -+ IN PVOID pDM_VOID, -+ PRT_BEAMFORMING_INFO pBeamInfo, -+ SOUNDING_MODE Mode, -+ u1Byte Idx -+ ) -+{ -+ CHANNEL_WIDTH SoundingBW = CHANNEL_WIDTH_20; -+ RT_BEAMFORMEE_ENTRY BeamEntry = pBeamInfo->BeamformeeEntry[Idx]; -+ RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_HW_VHT_TIMER) -+ SoundingBW = BeamOidInfo.SoundOidBW; -+ else if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_SW_VHT_TIMER) -+ /*Modified by David*/ -+ SoundingBW = BeamEntry.SoundBW; /*BeamOidInfo.SoundOidBW;*/ -+ else -+ SoundingBW = BeamEntry.SoundBW; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, SoundingBW=0x%X\n", __func__, SoundingBW)); -+ -+ return SoundingBW; -+} -+ -+ -+BOOLEAN -+phydm_Beamforming_SelectBeamEntry( -+ IN PVOID pDM_VOID, -+ PRT_BEAMFORMING_INFO pBeamInfo -+ ) -+{ -+ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /*pEntry.bSound is different between first and latter NDPA, and should not be used as BFee entry selection*/ -+ /*BTW, latter modification should sync to the selection mechanism of AP/ADSL instead of the fixed SoundIdx.*/ -+ pSoundInfo->SoundIdx = phydm_beamforming_SoundingIdx(pDM_Odm, pBeamInfo); -+ /*pSoundInfo->SoundIdx = 0;*/ -+ -+ if (pSoundInfo->SoundIdx < BEAMFORMEE_ENTRY_NUM) -+ pSoundInfo->SoundMode = phydm_beamforming_SoundingMode(pDM_Odm, pBeamInfo, pSoundInfo->SoundIdx); -+ else -+ pSoundInfo->SoundMode = SOUNDING_STOP_All_TIMER; -+ -+ if (SOUNDING_STOP_All_TIMER == pSoundInfo->SoundMode) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Return because of SOUNDING_STOP_All_TIMER\n", __func__)); -+ return FALSE; -+ } else { -+ pSoundInfo->SoundBW = phydm_beamforming_SoundingBW(pDM_Odm, pBeamInfo, pSoundInfo->SoundMode, pSoundInfo->SoundIdx ); -+ pSoundInfo->SoundPeriod = phydm_beamforming_SoundingTime(pDM_Odm, pBeamInfo, pSoundInfo->SoundMode, pSoundInfo->SoundIdx ); -+ return TRUE; -+ } -+} -+ -+/*SU BFee Entry Only*/ -+BOOLEAN -+phydm_beamforming_StartPeriod( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ BOOLEAN Ret = TRUE; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); -+ -+ phydm_Beamforming_DymNDPARate(pDM_Odm); -+ -+ phydm_Beamforming_SelectBeamEntry(pDM_Odm, pBeamInfo); // Modified -+ -+ if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) -+ ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, pSoundInfo->SoundPeriod); -+ else if (pSoundInfo->SoundMode == SOUNDING_HW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_HW_HT_TIMER || -+ pSoundInfo->SoundMode == SOUNDING_AUTO_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_AUTO_HT_TIMER) { -+ HAL_HW_TIMER_TYPE TimerType = HAL_TIMER_TXBF; -+ u4Byte val = (pSoundInfo->SoundPeriod | (TimerType<<16)); -+ -+ //HW timer stop: All IC has the same setting -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_STOP, (pu1Byte)(&TimerType)); -+ //ODM_Write1Byte(pDM_Odm, 0x15F, 0); -+ //HW timer init: All IC has the same setting, but 92E & 8812A only write 2 bytes -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_INIT, (pu1Byte)(&val)); -+ //ODM_Write1Byte(pDM_Odm, 0x164, 1); -+ //ODM_Write4Byte(pDM_Odm, 0x15C, val); -+ //HW timer start: All IC has the same setting -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_START, (pu1Byte)(&TimerType)); -+ //ODM_Write1Byte(pDM_Odm, 0x15F, 0x5); -+ } else if (pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER) -+ Ret = BeamformingStart_FW(pDM_Odm, pSoundInfo->SoundIdx); -+ else -+ Ret = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SoundIdx=%d, SoundMode=%d, SoundBW=%d, SoundPeriod=%d\n", __func__, -+ pSoundInfo->SoundIdx, pSoundInfo->SoundMode, pSoundInfo->SoundBW, pSoundInfo->SoundPeriod)); -+ -+ return Ret; -+} -+ -+// Used after Beamforming_Leave, and will clear the setting of the "already deleted" entry -+/*SU BFee Entry Only*/ -+VOID -+phydm_beamforming_EndPeriod_SW( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); -+ -+ HAL_HW_TIMER_TYPE TimerType = HAL_TIMER_TXBF; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) -+ ODM_CancelTimer(pDM_Odm, &pBeamInfo->BeamformingTimer); -+ else if (pSoundInfo->SoundMode == SOUNDING_HW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_HW_HT_TIMER || -+ pSoundInfo->SoundMode == SOUNDING_AUTO_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_AUTO_HT_TIMER) -+ /*HW timer stop: All IC has the same setting*/ -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_STOP, (pu1Byte)(&TimerType)); -+ /*ODM_Write1Byte(pDM_Odm, 0x15F, 0);*/ -+} -+ -+VOID -+phydm_beamforming_EndPeriod_FW( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx = 0; -+ -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_FW_NDPA, (pu1Byte)&Idx); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]\n", __func__)); -+} -+ -+ -+/*SU BFee Entry Only*/ -+VOID -+phydm_beamforming_ClearEntry_SW( -+ IN PVOID pDM_VOID, -+ BOOLEAN IsDelete, -+ u1Byte DeleteIdx -+ ) -+{ -+ u1Byte Idx = 0; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ if (IsDelete) { -+ if (DeleteIdx < BEAMFORMEE_ENTRY_NUM) { -+ pBeamformEntry = pBeamInfo->BeamformeeEntry + DeleteIdx; -+ if (!((!pBeamformEntry->bUsed) && pBeamformEntry->bSound)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW DeleteIdx is wrong!!!!!\n", __func__)); -+ return; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW delete BFee entry %d\n", __func__, DeleteIdx)); -+ if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) { -+ pBeamformEntry->bBeamformingInProgress = FALSE; -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ } else if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&DeleteIdx); -+ } -+ pBeamformEntry->bSound = FALSE; -+ } else { -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ pBeamformEntry = pBeamInfo->BeamformeeEntry+Idx; -+ -+ /*Used after bSounding=RESET, and will clear the setting of "ever sounded" entry, which is not necessarily be deleted.*/ -+ /*This function is mainly used in case "BeamOidInfo.SoundOidMode == SOUNDING_STOP_All_TIMER".*/ -+ /*However, setting oid doesn't delete entries (bUsed is still TRUE), new entries may fail to be added in.*/ -+ -+ if (pBeamformEntry->bSound) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW reset BFee entry %d\n", __func__, Idx)); -+ /* -+ * If End procedure is -+ * 1. Between (Send NDPA, C2H packet return), reset state to initialized. -+ * After C2H packet return , status bit will be set to zero. -+ * -+ * 2. After C2H packet, then reset state to initialized and clear status bit. -+ */ -+ -+ if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ phydm_Beamforming_End_SW(pDM_Odm, 0); -+ else if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&Idx); -+ } -+ -+ pBeamformEntry->bSound = FALSE; -+ } -+ } -+ } -+} -+ -+VOID -+phydm_beamforming_ClearEntry_FW( -+ IN PVOID pDM_VOID, -+ BOOLEAN IsDelete, -+ u1Byte DeleteIdx -+ ) -+{ -+ u1Byte Idx = 0; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ if (IsDelete) { -+ if (DeleteIdx < BEAMFORMEE_ENTRY_NUM) { -+ pBeamformEntry = pBeamInfo->BeamformeeEntry + DeleteIdx; -+ -+ if (!((!pBeamformEntry->bUsed) && pBeamformEntry->bSound)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] FW DeleteIdx is wrong!!!!!\n", __func__)); -+ return; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: FW delete BFee entry %d\n", __func__, DeleteIdx)); -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; -+ pBeamformEntry->bSound = FALSE; -+ } else { -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ pBeamformEntry = pBeamInfo->BeamformeeEntry+Idx; -+ -+ /*Used after bSounding=RESET, and will clear the setting of "ever sounded" entry, which is not necessarily be deleted.*/ -+ /*This function is mainly used in case "BeamOidInfo.SoundOidMode == SOUNDING_STOP_All_TIMER".*/ -+ /*However, setting oid doesn't delete entries (bUsed is still TRUE), new entries may fail to be added in.*/ -+ -+ if (pBeamformEntry->bSound) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]FW reset BFee entry %d\n", __func__, Idx)); -+ /* -+ * If End procedure is -+ * 1. Between (Send NDPA, C2H packet return), reset state to initialized. -+ * After C2H packet return , status bit will be set to zero. -+ * -+ * 2. After C2H packet, then reset state to initialized and clear status bit. -+ */ -+ -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ pBeamformEntry->bSound = FALSE; -+ } -+ } -+ } -+} -+ -+/* -+* Called : -+* 1. Add and delete entry : Beamforming_Enter/Beamforming_Leave -+* 2. FW trigger : Beamforming_SetTxBFen -+* 3. Set OID_RT_BEAMFORMING_PERIOD : BeamformingControl_V2 -+*/ -+VOID -+phydm_Beamforming_Notify( -+ IN PVOID pDM_VOID -+ ) -+{ -+ u1Byte Idx=BEAMFORMEE_ENTRY_NUM; -+ BEAMFORMING_NOTIFY_STATE bSounding = BEAMFORMING_NOTIFY_NONE; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ bSounding = phydm_beamfomring_bSounding(pDM_Odm, pBeamInfo, &Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, Before notify, bSounding=%d, Idx=%d\n", __func__, bSounding, Idx)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: pBeamInfo->beamformee_su_cnt = %d\n", __func__, pBeamInfo->beamformee_su_cnt)); -+ -+ -+ switch (bSounding) { -+ case BEAMFORMEE_NOTIFY_ADD_SU: -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_ADD_SU\n", __func__)); -+ phydm_beamforming_StartPeriod(pDM_Odm); -+ break; -+ -+ case BEAMFORMEE_NOTIFY_DELETE_SU: -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_DELETE_SU\n", __func__)); -+ if (pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER) { -+ phydm_beamforming_ClearEntry_FW(pDM_Odm, TRUE, Idx); -+ if (pBeamInfo->beamformee_su_cnt == 0) { /* For 2->1 entry, we should not cancel SW timer */ -+ phydm_beamforming_EndPeriod_FW(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: No BFee left\n", __func__)); -+ } -+ } else { -+ phydm_beamforming_ClearEntry_SW(pDM_Odm, TRUE, Idx); -+ if (pBeamInfo->beamformee_su_cnt == 0) { /* For 2->1 entry, we should not cancel SW timer */ -+ phydm_beamforming_EndPeriod_SW(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: No BFee left\n", __func__)); -+ } -+ } -+ break; -+ -+ case BEAMFORMEE_NOTIFY_ADD_MU: -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_ADD_MU\n", __func__)); -+ if (pBeamInfo->beamformee_mu_cnt == 2) { -+ /*if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) -+ ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, pSoundInfo->SoundPeriod);*/ -+ ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, 1000); /*Do MU sounding every 1sec*/ -+ } else -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Less or larger than 2 MU STAs, not to set timer\n", __func__)); -+ break; -+ -+ case BEAMFORMEE_NOTIFY_DELETE_MU: -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_DELETE_MU\n", __func__)); -+ if (pBeamInfo->beamformee_mu_cnt == 1) { -+ /*if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER)*/{ -+ ODM_CancelTimer(pDM_Odm, &pBeamInfo->BeamformingTimer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Less than 2 MU STAs, stop sounding\n", __func__)); -+ } -+ } -+ break; -+ -+ case BEAMFORMING_NOTIFY_RESET: -+ if (pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER) { -+ phydm_beamforming_ClearEntry_FW(pDM_Odm, FALSE, Idx); -+ phydm_beamforming_EndPeriod_FW(pDM_Odm); -+ } else { -+ phydm_beamforming_ClearEntry_SW(pDM_Odm, FALSE, Idx); -+ phydm_beamforming_EndPeriod_SW(pDM_Odm); -+ } -+ -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+ -+ -+BOOLEAN -+Beamforming_InitEntry( -+ IN PVOID pDM_VOID, -+ IN u2Byte staIdx, -+ pu1Byte BFerBFeeIdx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; -+ PRT_BEAMFORMER_ENTRY pBeamformerEntry = NULL; -+ PRT_BEAMFORM_STAINFO pSTA = NULL; -+ BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; -+ u1Byte BFerIdx=0xF, BFeeIdx=0xF; -+ u1Byte NumofSoundingDim = 0, CompSteeringNumofBFer = 0; -+ -+ pSTA = phydm_staInfoInit(pDM_Odm, staIdx); -+ -+ /*The current setting does not support Beaforming*/ -+ if (BEAMFORMING_CAP_NONE == pSTA->HtBeamformCap && BEAMFORMING_CAP_NONE == pSTA->VhtBeamformCap) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("The configuration disabled Beamforming! Skip...\n")); -+ return FALSE; -+ } -+ -+ if (pSTA->WirelessMode < WIRELESS_MODE_N_24G) -+ return FALSE; -+ else { -+ if (pSTA->WirelessMode & WIRELESS_MODE_N_5G || pSTA->WirelessMode & WIRELESS_MODE_N_24G) {/*HT*/ -+ if (TEST_FLAG(pSTA->CurBeamform, BEAMFORMING_HT_BEAMFORMER_ENABLE)) {/*We are Beamformee because the STA is Beamformer*/ -+ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMEE_CAP_HT_EXPLICIT); -+ NumofSoundingDim = (pSTA->CurBeamform&BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP)>>6; -+ } -+ /*We are Beamformer because the STA is Beamformee*/ -+ if (TEST_FLAG(pSTA->CurBeamform, BEAMFORMING_HT_BEAMFORMEE_ENABLE) || -+ TEST_FLAG(pSTA->HtBeamformCap, BEAMFORMING_HT_BEAMFORMER_TEST)) { -+ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMER_CAP_HT_EXPLICIT); -+ CompSteeringNumofBFer = (pSTA->CurBeamform & BEAMFORMING_HT_BEAMFORMER_STEER_NUM)>>4; -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] HT CurBeamform=0x%X, BeamformCap=0x%X\n", __func__, pSTA->CurBeamform, BeamformCap)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] HT NumofSoundingDim=%d, CompSteeringNumofBFer=%d\n", __func__, NumofSoundingDim, CompSteeringNumofBFer)); -+ } -+#if (ODM_IC_11AC_SERIES_SUPPORT == 1) -+ if (pSTA->WirelessMode & WIRELESS_MODE_AC_5G || pSTA->WirelessMode & WIRELESS_MODE_AC_24G) { /*VHT*/ -+ -+ /* We are Beamformee because the STA is SU Beamformer*/ -+ if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { -+ BeamformCap =(BEAMFORMING_CAP)(BeamformCap |BEAMFORMEE_CAP_VHT_SU); -+ NumofSoundingDim = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM)>>12; -+ } -+ /* We are Beamformer because the STA is SU Beamformee*/ -+ if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) || -+ TEST_FLAG(pSTA->VhtBeamformCap, BEAMFORMING_VHT_BEAMFORMER_TEST)) { -+ BeamformCap =(BEAMFORMING_CAP)(BeamformCap |BEAMFORMER_CAP_VHT_SU); -+ CompSteeringNumofBFer = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMER_STS_CAP)>>8; -+ } -+ /* We are Beamformee because the STA is MU Beamformer*/ -+ if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) { -+ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMEE_CAP_VHT_MU); -+ NumofSoundingDim = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM)>>12; -+ } -+ /* We are Beamformer because the STA is MU Beamformee*/ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) { /* Only AP mode supports to act an MU beamformer */ -+ if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE) || -+ TEST_FLAG(pSTA->VhtBeamformCap, BEAMFORMING_VHT_BEAMFORMER_TEST)) { -+ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMER_CAP_VHT_MU); -+ CompSteeringNumofBFer = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMER_STS_CAP)>>8; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]VHT CurBeamformVHT=0x%X, BeamformCap=0x%X\n", __func__, pSTA->CurBeamformVHT, BeamformCap)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]VHT NumofSoundingDim=0x%X, CompSteeringNumofBFer=0x%X\n", __func__, NumofSoundingDim, CompSteeringNumofBFer)); -+ -+ } -+#endif -+ } -+ -+ -+ if(BeamformCap == BEAMFORMING_CAP_NONE) -+ return FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Self BF Entry Cap = 0x%02X\n", __func__, BeamformCap)); -+ -+ /*We are BFee, so the entry is BFer*/ -+ if (BeamformCap & (BEAMFORMEE_CAP_VHT_MU | BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP_HT_EXPLICIT)) { -+ pBeamformerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, pSTA->RA, &BFerIdx); -+ -+ if (pBeamformerEntry == NULL) { -+ pBeamformerEntry = Beamforming_AddBFerEntry(pDM_Odm, pSTA, BeamformCap, NumofSoundingDim , &BFerIdx); -+ if (pBeamformerEntry == NULL) -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Not enough BFer entry!!!!!\n", __func__)); -+ } -+ } -+ -+ /*We are BFer, so the entry is BFee*/ -+ if (BeamformCap & (BEAMFORMER_CAP_VHT_MU | BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP_HT_EXPLICIT)) { -+ pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, pSTA->RA, &BFeeIdx); -+ -+ /*¦pªGBFeeIdx = 0xF «h¥Nªí¥Ø«eentry·í¤¤¨S¦³¬Û¦PªºMACID¦b¤º*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get BFee entry 0x%X by address\n", __func__, BFeeIdx)); -+ if (pBeamformEntry == NULL) { -+ pBeamformEntry = Beamforming_AddBFeeEntry(pDM_Odm, pSTA, BeamformCap, NumofSoundingDim, CompSteeringNumofBFer, &BFeeIdx); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: pSTA->AID=%d, pSTA->MacID=%d\n", __func__, pSTA->AID, pSTA->MacID)); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: Add BFee entry %d\n", __func__, BFeeIdx)); -+ -+ if (pBeamformEntry == NULL) -+ return FALSE; -+ else -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZEING; -+ } else { -+ /*Entry has been created. If entry is initialing or progressing then errors occur.*/ -+ if (pBeamformEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_INITIALIZED && -+ pBeamformEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ return FALSE; -+ } else -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZEING; -+ } -+ pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ phydm_staInfoUpdate(pDM_Odm, staIdx, pBeamformEntry); -+ } -+ -+ *BFerBFeeIdx = (BFerIdx<<4) | BFeeIdx; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End: BFerIdx=0x%X, BFeeIdx=0x%X, BFerBFeeIdx=0x%X\n", __func__, BFerIdx, BFeeIdx, *BFerBFeeIdx)); -+ -+ return TRUE; -+} -+ -+ -+VOID -+Beamforming_DeInitEntry( -+ IN PVOID pDM_VOID, -+ pu1Byte RA -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx = 0; -+ -+ PRT_BEAMFORMER_ENTRY pBFerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, RA, &Idx); -+ PRT_BEAMFORMEE_ENTRY pBFeeEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ BOOLEAN ret = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (pBFeeEntry != NULL) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, pBFeeEntry\n", __func__)); -+ pBFeeEntry->bUsed = FALSE; -+ pBFeeEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ pBFeeEntry->bBeamformingInProgress = FALSE; -+ if (pBFeeEntry->is_mu_sta) { -+ pDM_Odm->BeamformingInfo.beamformee_mu_cnt -= 1; -+ pDM_Odm->BeamformingInfo.FirstMUBFeeIndex = phydm_Beamforming_GetFirstMUBFeeEntryIdx(pDM_Odm); -+ } else { -+ pDM_Odm->BeamformingInfo.beamformee_su_cnt -= 1; -+ } -+ ret = TRUE; -+ } -+ -+ if (pBFerEntry != NULL) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, pBFerEntry\n", __func__)); -+ pBFerEntry->bUsed = FALSE; -+ pBFerEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; -+ if (pBFerEntry->is_mu_ap) -+ pDM_Odm->BeamformingInfo.beamformer_mu_cnt -= 1; -+ else -+ pDM_Odm->BeamformingInfo.beamformer_su_cnt -= 1; -+ ret = TRUE; -+ } -+ -+ if (ret == TRUE) -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_LEAVE, (pu1Byte)&Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, Idx = 0x%X\n", __func__, Idx)); -+} -+ -+ -+BOOLEAN -+BeamformingStart_V1( -+ IN PVOID pDM_VOID, -+ pu1Byte RA, -+ BOOLEAN Mode, -+ CHANNEL_WIDTH BW, -+ u1Byte Rate -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx = 0; -+ PRT_BEAMFORMEE_ENTRY pEntry; -+ BOOLEAN ret = TRUE; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ -+ pEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ if (pEntry->bUsed == FALSE) { -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } else { -+ if (pEntry->bBeamformingInProgress) -+ return FALSE; -+ -+ pEntry->bBeamformingInProgress = TRUE; -+ -+ if (Mode == 1) { -+ if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT)) { -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } -+ } else if (Mode == 0) { -+ if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU)) { -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } -+ } -+ -+ if (pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_INITIALIZED && pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } else { -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSING; -+ pEntry->bSound = TRUE; -+ } -+ } -+ -+ pEntry->SoundBW = BW; -+ pBeamInfo->BeamformeeCurIdx = Idx; -+ phydm_Beamforming_NDPARate(pDM_Odm, BW, Rate); -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&Idx); -+ -+ if (Mode == 1) -+ ret = Beamforming_SendHTNDPAPacket(pDM_Odm, RA, BW, NORMAL_QUEUE); -+ else -+ ret = Beamforming_SendVHTNDPAPacket(pDM_Odm, RA, pEntry->AID, BW, NORMAL_QUEUE); -+ -+ if (ret == FALSE) { -+ Beamforming_Leave(pDM_Odm, RA); -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Idx %d\n", __func__, Idx)); -+ return TRUE; -+} -+ -+ -+BOOLEAN -+BeamformingStart_SW( -+ IN PVOID pDM_VOID, -+ u1Byte Idx, -+ u1Byte Mode, -+ CHANNEL_WIDTH BW -+ ) -+{ -+ pu1Byte RA = NULL; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMEE_ENTRY pEntry; -+ BOOLEAN ret = TRUE; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ -+ if (pBeamInfo->is_mu_sounding) { -+ pBeamInfo->is_mu_sounding_in_progress = TRUE; -+ pEntry = &(pBeamInfo->BeamformeeEntry[Idx]); -+ RA = pEntry->MacAddr; -+ -+ } else { -+ pEntry = &(pBeamInfo->BeamformeeEntry[Idx]); -+ -+ if (pEntry->bUsed == FALSE) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Skip Beamforming, no entry for Idx =%d\n", Idx)); -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } else { -+ if (pEntry->bBeamformingInProgress) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("bBeamformingInProgress, skip...\n")); -+ return FALSE; -+ } -+ -+ pEntry->bBeamformingInProgress = TRUE; -+ RA = pEntry->MacAddr; -+ -+ if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_AUTO_HT_TIMER) { -+ if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT)) { -+ pEntry->bBeamformingInProgress = FALSE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Return by not support BEAMFORMER_CAP_HT_EXPLICIT <==\n", __func__)); -+ return FALSE; -+ } -+ } else if (Mode == SOUNDING_SW_VHT_TIMER || Mode == SOUNDING_HW_VHT_TIMER || Mode == SOUNDING_AUTO_VHT_TIMER) { -+ if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU)) { -+ pEntry->bBeamformingInProgress = FALSE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Return by not support BEAMFORMER_CAP_VHT_SU <==\n", __func__)); -+ return FALSE; -+ } -+ } -+ if (pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_INITIALIZED && pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ pEntry->bBeamformingInProgress = FALSE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Return by incorrect BeamformEntryState(%d) <==\n", __func__, pEntry->BeamformEntryState)); -+ return FALSE; -+ } else { -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSING; -+ pEntry->bSound = TRUE; -+ } -+ } -+ -+ pBeamInfo->BeamformeeCurIdx = Idx; -+ } -+ -+ /*2014.12.22 Luke: Need to be checked*/ -+ /*GET_TXBF_INFO(Adapter)->fTxbfSet(Adapter, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&Idx);*/ -+ -+ if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_AUTO_HT_TIMER) -+ ret = Beamforming_SendHTNDPAPacket(pDM_Odm, RA , BW, NORMAL_QUEUE); -+ else -+ ret = Beamforming_SendVHTNDPAPacket(pDM_Odm, RA , pEntry->AID, BW, NORMAL_QUEUE); -+ -+ if (ret == FALSE) { -+ Beamforming_Leave(pDM_Odm, RA); -+ pEntry->bBeamformingInProgress = FALSE; -+ return FALSE; -+ } -+ -+ -+ /*-------------------------- -+ // Send BF Report Poll for MU BF -+ --------------------------*/ -+#ifdef SUPPORT_MU_BF -+#if (SUPPORT_MU_BF == 1) -+{ -+ u1Byte idx, PollSTACnt = 0; -+ BOOLEAN bGetFirstBFee = FALSE; -+ -+ if (pBeamInfo->beamformee_mu_cnt > 1) { /* More than 1 MU STA*/ -+ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ pEntry = &(pBeamInfo->BeamformeeEntry[idx]); -+ if (pEntry->is_mu_sta) { -+ if (bGetFirstBFee) { -+ PollSTACnt++; -+ if (PollSTACnt == (pBeamInfo->beamformee_mu_cnt - 1))/* The last STA*/ -+ SendSWVHTBFReportPoll(pDM_Odm, pEntry->MacAddr, TRUE); -+ else -+ SendSWVHTBFReportPoll(pDM_Odm, pEntry->MacAddr, FALSE); -+ } else { -+ bGetFirstBFee = TRUE; -+ } -+ } -+ } -+ } -+} -+#endif -+#endif -+ return TRUE; -+} -+ -+ -+BOOLEAN -+BeamformingStart_FW( -+ IN PVOID pDM_VOID, -+ u1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMEE_ENTRY pEntry; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ -+ pEntry = &(pBeamInfo->BeamformeeEntry[Idx]); -+ if (pEntry->bUsed == FALSE) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Skip Beamforming, no entry for Idx =%d\n", Idx)); -+ return FALSE; -+ } -+ -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSING; -+ pEntry->bSound = TRUE; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_FW_NDPA, (pu1Byte)&Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End, Idx=0x%X\n", __func__, Idx)); -+ return TRUE; -+} -+ -+VOID -+Beamforming_CheckSoundingSuccess( -+ IN PVOID pDM_VOID, -+ BOOLEAN Status -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[David]@%s Start!\n", __func__)); -+ -+ if (Status == 1) { -+ if (pEntry->LogStatusFailCnt == 21) -+ Beamforming_DymPeriod(pDM_Odm, Status); -+ pEntry->LogStatusFailCnt = 0; -+ } else if (pEntry->LogStatusFailCnt <= 20) { -+ pEntry->LogStatusFailCnt++; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s LogStatusFailCnt %d\n", __func__, pEntry->LogStatusFailCnt)); -+ } -+ if (pEntry->LogStatusFailCnt > 20) { -+ pEntry->LogStatusFailCnt = 21; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s LogStatusFailCnt > 20, Stop SOUNDING\n", __func__)); -+ Beamforming_DymPeriod(pDM_Odm, Status); -+ } -+} -+ -+VOID -+phydm_Beamforming_End_SW( -+ IN PVOID pDM_VOID, -+ BOOLEAN Status -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); -+ -+ if (pBeamInfo->is_mu_sounding) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: MU sounding done\n", __func__)); -+ pBeamInfo->is_mu_sounding_in_progress = FALSE; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); -+ } else { -+ if (pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSING) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BeamformStatus %d\n", __func__, pEntry->BeamformEntryState)); -+ return; -+ } -+ -+ if ((pDM_Odm->TxBfDataRate >= ODM_RATEVHTSS3MCS7) && (pDM_Odm->TxBfDataRate <= ODM_RATEVHTSS3MCS9) && (pBeamInfo->snding3SS == FALSE)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] VHT3SS 7,8,9, do not apply V matrix.\n", __func__)); -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); -+ } else if (Status == 1) { -+ pEntry->LogStatusFailCnt = 0; -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); -+ } else { -+ pEntry->LogStatusFailCnt++; -+ pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_TX_PATH_RESET, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] LogStatusFailCnt %d\n", __func__, pEntry->LogStatusFailCnt)); -+ } -+ -+ if (pEntry->LogStatusFailCnt > 50) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s LogStatusFailCnt > 50, Stop SOUNDING\n", __func__)); -+ pEntry->bSound = FALSE; -+ Beamforming_DeInitEntry(pDM_Odm, pEntry->MacAddr); -+ -+ /*Modified by David - Every action of deleting entry should follow by Notify*/ -+ phydm_Beamforming_Notify(pDM_Odm); -+ } -+ -+ pEntry->bBeamformingInProgress = FALSE; -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Status=%d\n", __func__, Status)); -+} -+ -+ -+VOID -+Beamforming_TimerCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PVOID pDM_VOID -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ IN PVOID pContext -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PADAPTER Adapter = (PADAPTER)pContext; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+ BOOLEAN ret = FALSE; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); -+ PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); -+ BOOLEAN bBeamformingInProgress; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ if (pBeamInfo->is_mu_sounding) -+ bBeamformingInProgress = pBeamInfo->is_mu_sounding_in_progress; -+ else -+ bBeamformingInProgress = pEntry->bBeamformingInProgress; -+ -+ if (bBeamformingInProgress) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("bBeamformingInProgress, reset it\n")); -+ phydm_Beamforming_End_SW(pDM_Odm, 0); -+ } -+ -+ ret = phydm_Beamforming_SelectBeamEntry(pDM_Odm, pBeamInfo); -+#if (SUPPORT_MU_BF == 1) -+ if (ret && pBeamInfo->beamformee_mu_cnt > 1) -+ ret = 1; -+ else -+ ret = 0; -+#endif -+ if (ret) -+ ret = BeamformingStart_SW(pDM_Odm, pSoundInfo->SoundIdx, pSoundInfo->SoundMode, pSoundInfo->SoundBW); -+ else -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, Error value return from BeamformingStart_V2\n", __func__)); -+ -+ if ((pBeamInfo->beamformee_su_cnt != 0) || (pBeamInfo->beamformee_mu_cnt > 1)) { -+ if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) -+ ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, pSoundInfo->SoundPeriod); -+ else { -+ u4Byte val = (pSoundInfo->SoundPeriod << 16) | HAL_TIMER_TXBF; -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_RESTART, (pu1Byte)(&val)); -+ } -+ } -+} -+ -+ -+VOID -+Beamforming_SWTimerCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PRT_TIMER pTimer -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ void *FunctionContext -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ Beamforming_TimerCallback(pDM_Odm); -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)FunctionContext; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if (Adapter->net_closed == TRUE) -+ return; -+ rtw_run_in_thread_cmd(Adapter, Beamforming_TimerCallback, Adapter); -+#endif -+ -+} -+ -+ -+VOID -+phydm_Beamforming_Init( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMING_OID_INFO pBeamOidInfo = &(pBeamInfo->BeamformingOidInfo); -+ -+ pBeamOidInfo->SoundOidMode = SOUNDING_STOP_OID_TIMER; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Mode (%d)\n", __func__, pBeamOidInfo->SoundOidMode)); -+ -+ pBeamInfo->beamformee_su_cnt = 0; -+ pBeamInfo->beamformer_su_cnt = 0; -+ pBeamInfo->beamformee_mu_cnt = 0; -+ pBeamInfo->beamformer_mu_cnt = 0; -+ pBeamInfo->beamformee_mu_reg_maping = 0; -+ pBeamInfo->mu_ap_index = 0; -+ pBeamInfo->is_mu_sounding = FALSE; -+ pBeamInfo->FirstMUBFeeIndex = 0xFF; -+ pBeamInfo->applyVmatrix = TRUE; -+ pBeamInfo->snding3SS = FALSE; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pBeamInfo->SourceAdapter = pDM_Odm->Adapter; -+#endif -+ halComTxbf_beamformInit(pDM_Odm); -+} -+ -+ -+BOOLEAN -+phydm_actingDetermine( -+ IN PVOID pDM_VOID, -+ IN PHYDM_ACTING_TYPE type -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ BOOLEAN ret = FALSE; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->BeamformingInfo.SourceAdapter; -+#else -+ PADAPTER Adapter = pDM_Odm->Adapter; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (type == PhyDM_ACTING_AS_AP) -+ ret = ACTING_AS_AP(Adapter); -+ else if (type == PhyDM_ACTING_AS_IBSS) -+ ret = ACTING_AS_IBSS(Adapter); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ -+ if (type == PhyDM_ACTING_AS_AP) -+ ret = check_fwstate(pmlmepriv, WIFI_AP_STATE); -+ else if (type == PhyDM_ACTING_AS_IBSS) -+ ret = check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+#endif -+ -+ return ret; -+ -+} -+ -+VOID -+Beamforming_Enter( -+ IN PVOID pDM_VOID, -+ IN u2Byte staIdx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte BFerBFeeIdx = 0xff; -+ -+ if (Beamforming_InitEntry(pDM_Odm, staIdx, &BFerBFeeIdx)) -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_ENTER, (pu1Byte)&BFerBFeeIdx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End!\n", __func__)); -+} -+ -+ -+VOID -+Beamforming_Leave( -+ IN PVOID pDM_VOID, -+ pu1Byte RA -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (RA != NULL) { -+ Beamforming_DeInitEntry(pDM_Odm, RA); -+ phydm_Beamforming_Notify(pDM_Odm); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End!!\n", __func__)); -+} -+ -+#if 0 -+//Nobody calls this function -+VOID -+phydm_Beamforming_SetTxBFen( -+ IN PVOID pDM_VOID, -+ u1Byte MacId, -+ BOOLEAN bTxBF -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx = 0; -+ PRT_BEAMFORMEE_ENTRY pEntry; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ pEntry = phydm_Beamforming_GetEntryByMacId(pDM_Odm, MacId, &Idx); -+ -+ if(pEntry == NULL) -+ return; -+ else -+ pEntry->bTxBF = bTxBF; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s MacId %d TxBF %d\n", __func__, pEntry->MacId, pEntry->bTxBF)); -+ -+ phydm_Beamforming_Notify(pDM_Odm); -+} -+#endif -+ -+BEAMFORMING_CAP -+phydm_Beamforming_GetBeamCap( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamInfo -+ ) -+{ -+ u1Byte i; -+ BOOLEAN bSelfBeamformer = FALSE; -+ BOOLEAN bSelfBeamformee = FALSE; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ BeamformeeEntry = pBeamInfo->BeamformeeEntry[i]; -+ -+ if (BeamformeeEntry.bUsed) { -+ bSelfBeamformer = TRUE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BFee entry %d bUsed=TRUE\n", __func__, i)); -+ break; -+ } -+ } -+ -+ for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { -+ BeamformerEntry = pBeamInfo->BeamformerEntry[i]; -+ -+ if (BeamformerEntry.bUsed) { -+ bSelfBeamformee = TRUE; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: BFer entry %d bUsed=TRUE\n", __func__, i)); -+ break; -+ } -+ } -+ -+ if (bSelfBeamformer) -+ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMER_CAP); -+ if (bSelfBeamformee) -+ BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMEE_CAP); -+ -+ return BeamformCap; -+} -+ -+ -+BOOLEAN -+BeamformingControl_V1( -+ IN PVOID pDM_VOID, -+ pu1Byte RA, -+ u1Byte AID, -+ u1Byte Mode, -+ CHANNEL_WIDTH BW, -+ u1Byte Rate -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ BOOLEAN ret = TRUE; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("AID (%d), Mode (%d), BW (%d)\n", AID, Mode, BW)); -+ -+ switch (Mode) { -+ case 0: -+ ret = BeamformingStart_V1(pDM_Odm, RA, 0, BW, Rate); -+ break; -+ case 1: -+ ret = BeamformingStart_V1(pDM_Odm, RA, 1, BW, Rate); -+ break; -+ case 2: -+ phydm_Beamforming_NDPARate(pDM_Odm, BW, Rate); -+ ret = Beamforming_SendVHTNDPAPacket(pDM_Odm, RA, AID, BW, NORMAL_QUEUE); -+ break; -+ case 3: -+ phydm_Beamforming_NDPARate(pDM_Odm, BW, Rate); -+ ret = Beamforming_SendHTNDPAPacket(pDM_Odm, RA, BW, NORMAL_QUEUE); -+ break; -+ } -+ return ret; -+} -+ -+/*Only OID uses this function*/ -+BOOLEAN -+phydm_BeamformingControl_V2( -+ IN PVOID pDM_VOID, -+ u1Byte Idx, -+ u1Byte Mode, -+ CHANNEL_WIDTH BW, -+ u2Byte Period -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMING_OID_INFO pBeamOidInfo = &(pBeamInfo->BeamformingOidInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Idx (%d), Mode (%d), BW (%d), Period (%d)\n", Idx, Mode, BW, Period)); -+ -+ pBeamOidInfo->SoundOidIdx = Idx; -+ pBeamOidInfo->SoundOidMode = (SOUNDING_MODE) Mode; -+ pBeamOidInfo->SoundOidBW = BW; -+ pBeamOidInfo->SoundOidPeriod = Period; -+ -+ phydm_Beamforming_Notify(pDM_Odm); -+ -+ return TRUE; -+} -+ -+ -+VOID -+phydm_Beamforming_Watchdog( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("%s Start!\n", __func__)); -+ -+ if (pBeamInfo->beamformee_su_cnt == 0) -+ return; -+ -+ Beamforming_DymPeriod(pDM_Odm,0); -+ phydm_Beamforming_DymNDPARate(pDM_Odm); -+ -+} -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_beamforming.h 2018-02-11 21:44:27.155146208 +0200 -@@ -0,0 +1,367 @@ -+#ifndef __INC_PHYDM_BEAMFORMING_H -+#define __INC_PHYDM_BEAMFORMING_H -+ -+#ifndef BEAMFORMING_SUPPORT -+#define BEAMFORMING_SUPPORT 0 -+#endif -+ -+/*Beamforming Related*/ -+#include "txbf/halcomtxbf.h" -+#include "txbf/haltxbfjaguar.h" -+#include "txbf/haltxbf8192e.h" -+#include "txbf/haltxbf8814a.h" -+#include "txbf/haltxbf8822b.h" -+#include "txbf/haltxbfinterface.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ -+#define MAX_BEAMFORMEE_SU 2 -+#define MAX_BEAMFORMER_SU 2 -+#if (RTL8822B_SUPPORT == 1) -+#define MAX_BEAMFORMEE_MU 6 -+#define MAX_BEAMFORMER_MU 1 -+#else -+#define MAX_BEAMFORMEE_MU 0 -+#define MAX_BEAMFORMER_MU 0 -+#endif -+ -+#define BEAMFORMEE_ENTRY_NUM (MAX_BEAMFORMEE_SU + MAX_BEAMFORMEE_MU) -+#define BEAMFORMER_ENTRY_NUM (MAX_BEAMFORMER_SU + MAX_BEAMFORMER_MU) -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+/*for different naming between WIN and CE*/ -+#define BEACON_QUEUE BCN_QUEUE_INX -+#define NORMAL_QUEUE MGT_QUEUE_INX -+#define RT_DISABLE_FUNC RTW_DISABLE_FUNC -+#define RT_ENABLE_FUNC RTW_ENABLE_FUNC -+#endif -+ -+typedef enum _BEAMFORMING_ENTRY_STATE { -+ BEAMFORMING_ENTRY_STATE_UNINITIALIZE, -+ BEAMFORMING_ENTRY_STATE_INITIALIZEING, -+ BEAMFORMING_ENTRY_STATE_INITIALIZED, -+ BEAMFORMING_ENTRY_STATE_PROGRESSING, -+ BEAMFORMING_ENTRY_STATE_PROGRESSED -+} BEAMFORMING_ENTRY_STATE, *PBEAMFORMING_ENTRY_STATE; -+ -+ -+typedef enum _BEAMFORMING_NOTIFY_STATE { -+ BEAMFORMING_NOTIFY_NONE, -+ BEAMFORMING_NOTIFY_ADD, -+ BEAMFORMING_NOTIFY_DELETE, -+ BEAMFORMEE_NOTIFY_ADD_SU, -+ BEAMFORMEE_NOTIFY_DELETE_SU, -+ BEAMFORMEE_NOTIFY_ADD_MU, -+ BEAMFORMEE_NOTIFY_DELETE_MU, -+ BEAMFORMING_NOTIFY_RESET -+} BEAMFORMING_NOTIFY_STATE, *PBEAMFORMING_NOTIFY_STATE; -+ -+typedef enum _BEAMFORMING_CAP { -+ BEAMFORMING_CAP_NONE = 0x0, -+ BEAMFORMER_CAP_HT_EXPLICIT = BIT1, -+ BEAMFORMEE_CAP_HT_EXPLICIT = BIT2, -+ BEAMFORMER_CAP_VHT_SU = BIT5, /* Self has er Cap, because Reg er & peer ee */ -+ BEAMFORMEE_CAP_VHT_SU = BIT6, /* Self has ee Cap, because Reg ee & peer er */ -+ BEAMFORMER_CAP_VHT_MU = BIT7, /* Self has er Cap, because Reg er & peer ee */ -+ BEAMFORMEE_CAP_VHT_MU = BIT8, /* Self has ee Cap, because Reg ee & peer er */ -+ BEAMFORMER_CAP = BIT9, -+ BEAMFORMEE_CAP = BIT10, -+}BEAMFORMING_CAP, *PBEAMFORMING_CAP; -+ -+ -+typedef enum _SOUNDING_MODE { -+ SOUNDING_SW_VHT_TIMER = 0x0, -+ SOUNDING_SW_HT_TIMER = 0x1, -+ SOUNDING_STOP_All_TIMER = 0x2, -+ SOUNDING_HW_VHT_TIMER = 0x3, -+ SOUNDING_HW_HT_TIMER = 0x4, -+ SOUNDING_STOP_OID_TIMER = 0x5, -+ SOUNDING_AUTO_VHT_TIMER = 0x6, -+ SOUNDING_AUTO_HT_TIMER = 0x7, -+ SOUNDING_FW_VHT_TIMER = 0x8, -+ SOUNDING_FW_HT_TIMER = 0x9, -+}SOUNDING_MODE, *PSOUNDING_MODE; -+ -+typedef struct _RT_BEAMFORM_STAINFO { -+ pu1Byte RA; -+ u2Byte AID; -+ u2Byte MacID; -+ u1Byte MyMacAddr[6]; -+ WIRELESS_MODE WirelessMode; -+ CHANNEL_WIDTH BW; -+ BEAMFORMING_CAP BeamformCap; -+ u1Byte HtBeamformCap; -+ u2Byte VhtBeamformCap; -+ u1Byte CurBeamform; -+ u2Byte CurBeamformVHT; -+} RT_BEAMFORM_STAINFO, *PRT_BEAMFORM_STAINFO; -+ -+ -+typedef struct _RT_BEAMFORMEE_ENTRY { -+ BOOLEAN bUsed; -+ BOOLEAN bTxBF; -+ BOOLEAN bSound; -+ u2Byte AID; /*Used to construct AID field of NDPA packet.*/ -+ u2Byte MacId; /*Used to Set Reg42C in IBSS mode. */ -+ u2Byte P_AID; /*Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ -+ u2Byte G_ID; /*Used to fill Tx DESC*/ -+ u1Byte MyMacAddr[6]; -+ u1Byte MacAddr[6]; /*Used to fill Reg6E4 to fill Mac address of CSI report frame.*/ -+ CHANNEL_WIDTH SoundBW; /*Sounding BandWidth*/ -+ u2Byte SoundPeriod; -+ BEAMFORMING_CAP BeamformEntryCap; -+ BEAMFORMING_ENTRY_STATE BeamformEntryState; -+ BOOLEAN bBeamformingInProgress; -+ /*u1Byte LogSeq; // Move to _RT_BEAMFORMER_ENTRY*/ -+ /*u2Byte LogRetryCnt:3; // 0~4 // Move to _RT_BEAMFORMER_ENTRY*/ -+ /*u2Byte LogSuccessCnt:2; // 0~2 // Move to _RT_BEAMFORMER_ENTRY*/ -+ u2Byte LogStatusFailCnt:5; // 0~21 -+ u2Byte DefaultCSICnt:5; // 0~21 -+ u1Byte CSIMatrix[327]; -+ u2Byte CSIMatrixLen; -+ u1Byte NumofSoundingDim; -+ u1Byte CompSteeringNumofBFer; -+ u1Byte su_reg_index; -+ /*For MU-MIMO*/ -+ BOOLEAN is_mu_sta; -+ u1Byte mu_reg_index; -+ u1Byte gid_valid[8]; -+ u1Byte user_position[16]; -+} RT_BEAMFORMEE_ENTRY, *PRT_BEAMFORMEE_ENTRY; -+ -+typedef struct _RT_BEAMFORMER_ENTRY { -+ BOOLEAN bUsed; -+ /*P_AID of BFer entry is probably not used*/ -+ u2Byte P_AID; /*Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ -+ u2Byte G_ID; -+ u1Byte MyMacAddr[6]; -+ u1Byte MacAddr[6]; -+ BEAMFORMING_CAP BeamformEntryCap; -+ u1Byte NumofSoundingDim; -+ u1Byte ClockResetTimes; /*Modified by Jeffery @2015-04-10*/ -+ u1Byte PreLogSeq; /*Modified by Jeffery @2015-03-30*/ -+ u1Byte LogSeq; /*Modified by Jeffery @2014-10-29*/ -+ u2Byte LogRetryCnt:3; /*Modified by Jeffery @2014-10-29*/ -+ u2Byte LogSuccess:2; /*Modified by Jeffery @2014-10-29*/ -+ u1Byte su_reg_index; -+ /*For MU-MIMO*/ -+ BOOLEAN is_mu_ap; -+ u1Byte gid_valid[8]; -+ u1Byte user_position[16]; -+ u2Byte AID; -+} RT_BEAMFORMER_ENTRY, *PRT_BEAMFORMER_ENTRY; -+ -+typedef struct _RT_SOUNDING_INFO { -+ u1Byte SoundIdx; -+ CHANNEL_WIDTH SoundBW; -+ SOUNDING_MODE SoundMode; -+ u2Byte SoundPeriod; -+} RT_SOUNDING_INFO, *PRT_SOUNDING_INFO; -+ -+ -+ -+typedef struct _RT_BEAMFORMING_OID_INFO { -+ u1Byte SoundOidIdx; -+ CHANNEL_WIDTH SoundOidBW; -+ SOUNDING_MODE SoundOidMode; -+ u2Byte SoundOidPeriod; -+} RT_BEAMFORMING_OID_INFO, *PRT_BEAMFORMING_OID_INFO; -+ -+ -+typedef struct _RT_BEAMFORMING_INFO { -+ BEAMFORMING_CAP BeamformCap; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry[BEAMFORMEE_ENTRY_NUM]; -+ RT_BEAMFORMER_ENTRY BeamformerEntry[BEAMFORMER_ENTRY_NUM]; -+ RT_BEAMFORM_STAINFO BeamformSTAinfo; -+ u1Byte BeamformeeCurIdx; -+ RT_TIMER BeamformingTimer; -+ RT_TIMER mu_timer; -+ RT_SOUNDING_INFO SoundingInfo; -+ RT_BEAMFORMING_OID_INFO BeamformingOidInfo; -+ HAL_TXBF_INFO TxbfInfo; -+ u1Byte SoundingSequence; -+ u1Byte beamformee_su_cnt; -+ u1Byte beamformer_su_cnt; -+ u4Byte beamformee_su_reg_maping; -+ u4Byte beamformer_su_reg_maping; -+ /*For MU-MINO*/ -+ u1Byte beamformee_mu_cnt; -+ u1Byte beamformer_mu_cnt; -+ u4Byte beamformee_mu_reg_maping; -+ u1Byte mu_ap_index; -+ BOOLEAN is_mu_sounding; -+ u1Byte FirstMUBFeeIndex; -+ BOOLEAN is_mu_sounding_in_progress; -+ BOOLEAN dbg_disable_mu_tx; -+ BOOLEAN applyVmatrix; -+ BOOLEAN snding3SS; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER SourceAdapter; -+#endif -+ /* Control register */ -+ u4Byte RegMUTxCtrl; /* For USB/SDIO interfaces aync I/O */ -+} RT_BEAMFORMING_INFO, *PRT_BEAMFORMING_INFO; -+ -+ -+typedef struct _RT_NDPA_STA_INFO { -+ u2Byte AID:12; -+ u2Byte FeedbackType:1; -+ u2Byte NcIndex:3; -+} RT_NDPA_STA_INFO, *PRT_NDPA_STA_INFO; -+ -+typedef enum _PHYDM_ACTING_TYPE { -+ PhyDM_ACTING_AS_IBSS = 0, -+ PhyDM_ACTING_AS_AP = 1 -+} PHYDM_ACTING_TYPE; -+ -+ -+BEAMFORMING_CAP -+phydm_Beamforming_GetEntryBeamCapByMacId( -+ IN PVOID pDM_VOID, -+ IN u1Byte MacId -+ ); -+ -+PRT_BEAMFORMEE_ENTRY -+phydm_Beamforming_GetBFeeEntryByAddr( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ OUT pu1Byte Idx -+ ); -+ -+PRT_BEAMFORMER_ENTRY -+phydm_Beamforming_GetBFerEntryByAddr( -+ IN PVOID pDM_VOID, -+ IN pu1Byte TA, -+ OUT pu1Byte Idx -+ ); -+ -+VOID -+phydm_Beamforming_Notify( -+ IN PVOID pDM_VOID -+ ); -+ -+BOOLEAN -+phydm_actingDetermine( -+ IN PVOID pDM_VOID, -+ IN PHYDM_ACTING_TYPE type -+ ); -+ -+VOID -+Beamforming_Enter( -+ IN PVOID pDM_VOID, -+ IN u2Byte staIdx -+ ); -+ -+VOID -+Beamforming_Leave( -+ IN PVOID pDM_VOID, -+ pu1Byte RA -+ ); -+ -+BOOLEAN -+BeamformingStart_FW( -+ IN PVOID pDM_VOID, -+ u1Byte Idx -+ ); -+ -+VOID -+Beamforming_CheckSoundingSuccess( -+ IN PVOID pDM_VOID, -+ BOOLEAN Status -+); -+ -+VOID -+phydm_Beamforming_End_SW( -+ IN PVOID pDM_VOID, -+ BOOLEAN Status -+ ); -+ -+VOID -+Beamforming_TimerCallback( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+phydm_Beamforming_Init( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+ -+BEAMFORMING_CAP -+phydm_Beamforming_GetBeamCap( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamInfo -+ ); -+ -+ -+BOOLEAN -+BeamformingControl_V1( -+ IN PVOID pDM_VOID, -+ pu1Byte RA, -+ u1Byte AID, -+ u1Byte Mode, -+ CHANNEL_WIDTH BW, -+ u1Byte Rate -+ ); -+ -+ -+BOOLEAN -+phydm_BeamformingControl_V2( -+ IN PVOID pDM_VOID, -+ u1Byte Idx, -+ u1Byte Mode, -+ CHANNEL_WIDTH BW, -+ u2Byte Period -+ ); -+ -+VOID -+phydm_Beamforming_Watchdog( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+Beamforming_SWTimerCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PRT_TIMER pTimer -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ void *FunctionContext -+#endif -+ ); -+ -+BOOLEAN -+Beamforming_SendHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW, -+ IN u1Byte QIdx -+ ); -+ -+ -+BOOLEAN -+Beamforming_SendVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW, -+ IN u1Byte QIdx -+ ); -+ -+#else -+#define Beamforming_GidPAid(Adapter, pTcb) -+#define phydm_actingDetermine(pDM_Odm, type) FALSE -+#define Beamforming_Enter(pDM_Odm, staIdx) -+#define Beamforming_Leave(pDM_Odm, RA) -+#define Beamforming_End_FW(pDMOdm) -+#define BeamformingControl_V1(pDM_Odm, RA, AID, Mode, BW, Rate) TRUE -+#define BeamformingControl_V2(pDM_Odm, Idx, Mode, BW, Period) TRUE -+#define phydm_Beamforming_End_SW(pDM_Odm, _Status) -+#define Beamforming_TimerCallback(pDM_Odm) -+#define phydm_Beamforming_Init(pDM_Odm) -+#define phydm_BeamformingControl_V2(pDM_Odm, _Idx, _Mode, _BW, _Period) FALSE -+#define Beamforming_Watchdog(pDM_Odm) -+#define phydm_Beamforming_Watchdog(pDM_Odm) -+ -+ -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm.c 2018-02-11 21:44:27.153146177 +0200 -@@ -0,0 +1,3340 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+const u2Byte dB_Invert_Table[12][8] = { -+ { 1, 1, 1, 2, 2, 2, 2, 3}, -+ { 3, 3, 4, 4, 4, 5, 6, 6}, -+ { 7, 8, 9, 10, 11, 13, 14, 16}, -+ { 18, 20, 22, 25, 28, 32, 35, 40}, -+ { 45, 50, 56, 63, 71, 79, 89, 100}, -+ { 112, 126, 141, 158, 178, 200, 224, 251}, -+ { 282, 316, 355, 398, 447, 501, 562, 631}, -+ { 708, 794, 891, 1000, 1122, 1259, 1413, 1585}, -+ { 1778, 1995, 2239, 2512, 2818, 3162, 3548, 3981}, -+ { 4467, 5012, 5623, 6310, 7079, 7943, 8913, 10000}, -+ { 11220, 12589, 14125, 15849, 17783, 19953, 22387, 25119}, -+ { 28184, 31623, 35481, 39811, 44668, 50119, 56234, 65535} -+}; -+ -+ -+//============================================================ -+// Local Function predefine. -+//============================================================ -+ -+/* START------------COMMON INFO RELATED--------------- */ -+ -+VOID -+odm_GlobalAdapterCheck( -+ IN VOID -+ ); -+ -+//move to odm_PowerTacking.h by YuChen -+ -+ -+ -+VOID -+odm_UpdatePowerTrainingState( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+//============================================================ -+//3 Export Interface -+//============================================================ -+ -+/*Y = 10*log(X)*/ -+s4Byte -+ODM_PWdB_Conversion( -+ IN s4Byte X, -+ IN u4Byte TotalBit, -+ IN u4Byte DecimalBit -+ ) -+{ -+ s4Byte Y, integer = 0, decimal = 0; -+ u4Byte i; -+ -+ if(X == 0) -+ X = 1; // log2(x), x can't be 0 -+ -+ for(i = (TotalBit-1); i > 0; i--) -+ { -+ if(X & BIT(i)) -+ { -+ integer = i; -+ if(i > 0) -+ decimal = (X & BIT(i-1))?2:0; //decimal is 0.5dB*3=1.5dB~=2dB -+ break; -+ } -+ } -+ -+ Y = 3*(integer-DecimalBit)+decimal; //10*log(x)=3*log2(x), -+ -+ return Y; -+} -+ -+s4Byte -+ODM_SignConversion( -+ IN s4Byte value, -+ IN u4Byte TotalBit -+ ) -+{ -+ if(value&BIT(TotalBit-1)) -+ value -= BIT(TotalBit); -+ return value; -+} -+ -+void -+phydm_seq_sorting( -+ IN PVOID pDM_VOID, -+ IN OUT u4Byte *p_value, -+ IN OUT u4Byte *rank_idx, -+ IN OUT u4Byte *p_idx_out, -+ IN u1Byte seq_length -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0 , j = 0; -+ u4Byte tmp_a, tmp_b; -+ u4Byte tmp_idx_a, tmp_idx_b; -+ -+ for (i = 0; i < seq_length; i++) { -+ rank_idx[i] = i; -+ /**/ -+ } -+ -+ for (i = 0; i < (seq_length - 1); i++) { -+ -+ for (j = 0; j < (seq_length - 1 - i); j++) { -+ -+ tmp_a = p_value[j]; -+ tmp_b = p_value[j+1]; -+ -+ tmp_idx_a = rank_idx[j]; -+ tmp_idx_b = rank_idx[j+1]; -+ -+ if (tmp_a < tmp_b) { -+ p_value[j] = tmp_b; -+ p_value[j+1] = tmp_a; -+ -+ rank_idx[j] = tmp_idx_b; -+ rank_idx[j+1] = tmp_idx_a; -+ } -+ } -+ } -+ -+ for (i = 0; i < seq_length; i++) { -+ p_idx_out[rank_idx[i]] = i+1; -+ /**/ -+ } -+ -+ -+ -+} -+ -+VOID -+ODM_InitMpDriverStatus( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ // Decide when compile time -+ #if(MP_DRIVER == 1) -+ pDM_Odm->mp_mode = TRUE; -+ #else -+ pDM_Odm->mp_mode = FALSE; -+ #endif -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ // Update information every period -+ pDM_Odm->mp_mode = (BOOLEAN)Adapter->registrypriv.mp_mode; -+ -+#else -+ -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ pDM_Odm->mp_mode = (BOOLEAN)priv->pshare->rf_ft_var.mp_specific; -+ -+#endif -+} -+ -+VOID -+ODM_UpdateMpDriverStatus( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ // Do nothing. -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ // Update information erery period -+ pDM_Odm->mp_mode = (BOOLEAN)Adapter->registrypriv.mp_mode; -+ -+#else -+ -+ // Do nothing. -+ -+#endif -+} -+ -+VOID -+PHYDM_InitTRXAntennaSetting( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+/*#if (RTL8814A_SUPPORT == 1)*/ -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8814A)) { -+ u1Byte RxAnt = 0, TxAnt = 0; -+ -+ RxAnt = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG(BB_RX_PATH, pDM_Odm), ODM_BIT(BB_RX_PATH, pDM_Odm)); -+ TxAnt = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG(BB_TX_PATH, pDM_Odm), ODM_BIT(BB_TX_PATH, pDM_Odm)); -+ pDM_Odm->TXAntStatus = (TxAnt & 0xf); -+ pDM_Odm->RXAntStatus = (RxAnt & 0xf); -+ } else if (pDM_Odm->SupportICType & (ODM_RTL8723D | ODM_RTL8821C)) { -+ pDM_Odm->TXAntStatus = 0x1; -+ pDM_Odm->RXAntStatus = 0x1; -+ -+ } -+/*#endif*/ -+} -+ -+void -+phydm_traffic_load_decision( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ /*---TP & Trafic-load calculation---*/ -+ -+ if (pDM_Odm->lastTxOkCnt > (*(pDM_Odm->pNumTxBytesUnicast))) -+ pDM_Odm->lastTxOkCnt = (*(pDM_Odm->pNumTxBytesUnicast)); -+ -+ if (pDM_Odm->lastRxOkCnt > (*(pDM_Odm->pNumRxBytesUnicast))) -+ pDM_Odm->lastRxOkCnt = (*(pDM_Odm->pNumRxBytesUnicast)); -+ -+ pDM_Odm->curTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast) - pDM_Odm->lastTxOkCnt; -+ pDM_Odm->curRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast) - pDM_Odm->lastRxOkCnt; -+ pDM_Odm->lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast); -+ pDM_Odm->lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast); -+ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ pDM_Odm->tx_tp = ((pDM_Odm->tx_tp)>>1) + (u4Byte)(((pDM_Odm->curTxOkCnt)>>17)>>1); /* <<3(8bit), >>20(10^6,M)*/ -+ pDM_Odm->rx_tp = ((pDM_Odm->rx_tp)>>1) + (u4Byte)(((pDM_Odm->curRxOkCnt)>>17)>>1); /* <<3(8bit), >>20(10^6,M)*/ -+ #else -+ pDM_Odm->tx_tp = ((pDM_Odm->tx_tp)>>1) + (u4Byte)(((pDM_Odm->curTxOkCnt)>>18)>>1); /* <<3(8bit), >>20(10^6,M), >>1(2sec)*/ -+ pDM_Odm->rx_tp = ((pDM_Odm->rx_tp)>>1) + (u4Byte)(((pDM_Odm->curRxOkCnt)>>18)>>1); /* <<3(8bit), >>20(10^6,M), >>1(2sec)*/ -+ #endif -+ pDM_Odm->total_tp = pDM_Odm->tx_tp + pDM_Odm->rx_tp; -+ -+ /* -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("curTxOkCnt = %d, curRxOkCnt = %d, lastTxOkCnt = %d, lastRxOkCnt = %d\n", -+ pDM_Odm->curTxOkCnt, pDM_Odm->curRxOkCnt, pDM_Odm->lastTxOkCnt, pDM_Odm->lastRxOkCnt)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("tx_tp = %d, rx_tp = %d\n", -+ pDM_Odm->tx_tp, pDM_Odm->rx_tp)); -+ */ -+ -+ pDM_Odm->pre_TrafficLoad = pDM_Odm->TrafficLoad; -+ -+ if (pDM_Odm->curTxOkCnt > 1875000 || pDM_Odm->curRxOkCnt > 1875000) { /* ( 1.875M * 8bit ) / 2sec= 7.5M bits /sec )*/ -+ -+ pDM_Odm->TrafficLoad = TRAFFIC_HIGH; -+ /**/ -+ } else if (pDM_Odm->curTxOkCnt > 500000 || pDM_Odm->curRxOkCnt > 500000) { /*( 0.5M * 8bit ) / 2sec = 2M bits /sec )*/ -+ -+ pDM_Odm->TrafficLoad = TRAFFIC_MID; -+ /**/ -+ } else if (pDM_Odm->curTxOkCnt > 100000 || pDM_Odm->curRxOkCnt > 100000) { /*( 0.1M * 8bit ) / 2sec = 0.4M bits /sec )*/ -+ -+ pDM_Odm->TrafficLoad = TRAFFIC_LOW; -+ /**/ -+ } else { -+ -+ pDM_Odm->TrafficLoad = TRAFFIC_ULTRA_LOW; -+ /**/ -+ } -+} -+ -+VOID -+phydm_config_ofdm_tx_path( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte path -+) -+{ -+ u1Byte ofdm_rx_path; -+ -+ #if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { -+ -+ if (path == PHYDM_A) { -+ ODM_SetBBReg(pDM_Odm, 0x90c , bMaskDWord, 0x81121111); -+ /**/ -+ } else if (path == PHYDM_B) { -+ ODM_SetBBReg(pDM_Odm, 0x90c , bMaskDWord, 0x82221222); -+ /**/ -+ } else if (path == PHYDM_AB) { -+ ODM_SetBBReg(pDM_Odm, 0x90c , bMaskDWord, 0x83321333); -+ /**/ -+ } -+ -+ -+ } -+ #endif -+} -+ -+VOID -+phydm_config_ofdm_rx_path( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte path -+) -+{ -+ u1Byte ofdm_rx_path = 0; -+ -+ #if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { -+ -+ if (path == PHYDM_A) { -+ ofdm_rx_path = 1; -+ /**/ -+ } else if (path == PHYDM_B) { -+ ofdm_rx_path = 2; -+ /**/ -+ } else if (path == PHYDM_AB) { -+ ofdm_rx_path = 3; -+ /**/ -+ } -+ -+ ODM_SetBBReg(pDM_Odm, 0xC04 , 0xff, (((ofdm_rx_path)<<4)|ofdm_rx_path)); -+ ODM_SetBBReg(pDM_Odm, 0xD04 , 0xf, ofdm_rx_path); -+ } -+ #endif -+} -+ -+VOID -+phydm_config_cck_rx_antenna_init( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ #if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { -+ -+ /*CCK 2R CCA parameters*/ -+ ODM_SetBBReg(pDM_Odm, 0xa2c , BIT18, 1); /*enable 2R Rx path*/ -+ ODM_SetBBReg(pDM_Odm, 0xa2c , BIT22, 1); /*enable 2R MRC*/ -+ ODM_SetBBReg(pDM_Odm, 0xa84 , BIT28, 1); /*1. pdx1[5:0] > 2*PD_lim 2. RXIQ_3 = 0 ( signed )*/ -+ ODM_SetBBReg(pDM_Odm, 0xa70 , BIT7, 0); /*Concurrent CCA at LSB & USB*/ -+ ODM_SetBBReg(pDM_Odm, 0xa74 , BIT8, 0); /*RX path diversity enable*/ -+ ODM_SetBBReg(pDM_Odm, 0xa08 , BIT28, 1); /* r_cck_2nd_sel_eco*/ -+ ODM_SetBBReg(pDM_Odm, 0xa14 , BIT7, 0); /* r_en_mrc_antsel*/ -+ } -+ #endif -+} -+ -+VOID -+phydm_config_cck_rx_path( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte path, -+ IN u1Byte path_div_en -+) -+{ -+ u1Byte path_div_select = 0; -+ u1Byte cck_1_path = 0, cck_2_path = 0; -+ -+ #if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { -+ -+ if (path == PHYDM_A) { -+ path_div_select = 0; -+ cck_1_path = 0; -+ cck_2_path = 0; -+ } else if (path == PHYDM_B) { -+ path_div_select = 0; -+ cck_1_path = 1; -+ cck_2_path = 1; -+ } else if (path == PHYDM_AB) { -+ -+ if (path_div_en == CCA_PATHDIV_ENABLE) -+ path_div_select = 1; -+ -+ cck_1_path = 0; -+ cck_2_path = 1; -+ -+ } -+ -+ ODM_SetBBReg(pDM_Odm, 0xa04 , (BIT27|BIT26), cck_1_path); -+ ODM_SetBBReg(pDM_Odm, 0xa04 , (BIT25|BIT24), cck_2_path); -+ ODM_SetBBReg(pDM_Odm, 0xa74 , BIT8, path_div_select); -+ -+ } -+ #endif -+} -+ -+VOID -+phydm_config_trx_path( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte pre_support_ability; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ /* CCK */ -+ if (dm_value[0] == 0) { -+ -+ if (dm_value[1] == 1) { /*TX*/ -+ if (dm_value[2] == 1) -+ ODM_SetBBReg(pDM_Odm, 0xa04, 0xf0000000, 0x8); -+ else if (dm_value[2] == 2) -+ ODM_SetBBReg(pDM_Odm, 0xa04, 0xf0000000, 0x4); -+ else if (dm_value[2] == 3) -+ ODM_SetBBReg(pDM_Odm, 0xa04, 0xf0000000, 0xc); -+ } else if (dm_value[1] == 2) { /*RX*/ -+ -+ phydm_config_cck_rx_antenna_init(pDM_Odm); -+ -+ if (dm_value[2] == 1) { -+ phydm_config_cck_rx_path(pDM_Odm, PHYDM_A, CCA_PATHDIV_DISABLE); -+ } else if (dm_value[2] == 2) { -+ phydm_config_cck_rx_path(pDM_Odm, PHYDM_B, CCA_PATHDIV_DISABLE); -+ } else if (dm_value[2] == 3) { -+ if (dm_value[3] == 1) /*enable path diversity*/ -+ phydm_config_cck_rx_path(pDM_Odm, PHYDM_AB, CCA_PATHDIV_ENABLE); -+ else -+ phydm_config_cck_rx_path(pDM_Odm, PHYDM_B, CCA_PATHDIV_DISABLE); -+ } -+ } -+ } -+ /* OFDM */ -+ else if (dm_value[0] == 1) { -+ -+ if (dm_value[1] == 1) { /*TX*/ -+ phydm_config_ofdm_tx_path(pDM_Odm, dm_value[2]); -+ /**/ -+ } else if (dm_value[1] == 2) { /*RX*/ -+ phydm_config_ofdm_rx_path(pDM_Odm, dm_value[2]); -+ /**/ -+ } -+ } -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "PHYDM Set Path [%s] [%s] = [%s%s%s%s]\n", -+ (dm_value[0] == 1) ? "OFDM" : "CCK", -+ (dm_value[1] == 1) ? "TX" : "RX", -+ (dm_value[2] & 0x1)?"A":"", -+ (dm_value[2] & 0x2)?"B":"", -+ (dm_value[2] & 0x4)?"C":"", -+ (dm_value[2] & 0x8)?"D":"" -+ )); -+ -+} -+ -+VOID -+phydm_Init_cck_setting( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte value_824,value_82c; -+ -+ pDM_Odm->bCckHighPower = (BOOLEAN) ODM_GetBBReg(pDM_Odm, ODM_REG(CCK_RPT_FORMAT,pDM_Odm), ODM_BIT(CCK_RPT_FORMAT,pDM_Odm)); -+ -+ #if (RTL8192E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType & (ODM_RTL8192E)) -+ { -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ phydm_config_cck_rx_antenna_init(pDM_Odm); -+ phydm_config_cck_rx_path(pDM_Odm, PHYDM_A, CCA_PATHDIV_DISABLE); -+ #endif -+ -+ /* 0x824[9] = 0x82C[9] = 0xA80[7] those registers setting should be equal or CCK RSSI report may be incorrect */ -+ value_824 = ODM_GetBBReg(pDM_Odm, 0x824, BIT9); -+ value_82c = ODM_GetBBReg(pDM_Odm, 0x82c, BIT9); -+ -+ if(value_824 != value_82c) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c , BIT9, value_824); -+ } -+ ODM_SetBBReg(pDM_Odm, 0xa80 , BIT7, value_824); -+ pDM_Odm->cck_agc_report_type = (BOOLEAN)value_824; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("cck_agc_report_type = (( %d )), ExtLNAGain = (( %d ))\n", pDM_Odm->cck_agc_report_type, pDM_Odm->ExtLNAGain)); -+ } -+ #endif -+ -+#if ((RTL8703B_SUPPORT == 1) || (RTL8723D_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType & (ODM_RTL8703B|ODM_RTL8723D)) { -+ -+ pDM_Odm->cck_agc_report_type = ODM_GetBBReg(pDM_Odm, 0x950, BIT11) ? 1 : 0; /*1: 4bit LNA , 0: 3bit LNA */ -+ -+ if (pDM_Odm->cck_agc_report_type != 1) { -+ DbgPrint("[Warning] 8703B/8723D CCK should be 4bit LNA, ie. 0x950[11] = 1\n"); -+ /**/ -+ } -+ } -+#endif -+ -+#if ((RTL8723D_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8723D|ODM_RTL8822B|ODM_RTL8197F)) { -+ pDM_Odm->cck_new_agc = ODM_GetBBReg(pDM_Odm, 0xa9c, BIT17)?TRUE:FALSE; /*1: new agc 0: old agc*/ -+ } else -+#endif -+ pDM_Odm->cck_new_agc = FALSE; -+ -+} -+ -+VOID -+PHYDM_InitSoftMLSetting( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->mp_mode == FALSE) { -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ ODM_SetBBReg(pDM_Odm, 0x19a8, bMaskDWord, 0xc10a0000); -+ } -+#endif -+} -+ -+VOID -+PHYDM_InitHwInfoByRfe( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ phydm_init_hw_info_by_rfe_type_8822b(pDM_Odm); -+#endif -+} -+ -+VOID -+odm_CommonInfoSelfInit( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ phydm_Init_cck_setting(pDM_Odm); -+ pDM_Odm->RFPathRxEnable = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(BB_RX_PATH,pDM_Odm), ODM_BIT(BB_RX_PATH,pDM_Odm)); -+#if (DM_ODM_SUPPORT_TYPE != ODM_CE) -+ pDM_Odm->pbNet_closed = &pDM_Odm->BOOLEAN_temp; -+ -+ PHYDM_InitDebugSetting(pDM_Odm); -+#endif -+ ODM_InitMpDriverStatus(pDM_Odm); -+ PHYDM_InitTRXAntennaSetting(pDM_Odm); -+ PHYDM_InitSoftMLSetting(pDM_Odm); -+ -+ pDM_Odm->phydm_period = PHYDM_WATCH_DOG_PERIOD; -+ pDM_Odm->phydm_sys_up_time = 0; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_1SS) -+ pDM_Odm->num_rf_path = 1; -+ else if (pDM_Odm->SupportICType & ODM_IC_2SS) -+ pDM_Odm->num_rf_path = 2; -+ else if(pDM_Odm->SupportICType & ODM_IC_3SS ) -+ pDM_Odm->num_rf_path = 3; -+ else if(pDM_Odm->SupportICType & ODM_IC_4SS ) -+ pDM_Odm->num_rf_path = 4; -+ -+ pDM_Odm->TxRate = 0xFF; -+ -+ pDM_Odm->number_linked_client = 0; -+ pDM_Odm->pre_number_linked_client = 0; -+ pDM_Odm->number_active_client = 0; -+ pDM_Odm->pre_number_active_client = 0; -+ -+ pDM_Odm->lastTxOkCnt = 0; -+ pDM_Odm->lastRxOkCnt = 0; -+ pDM_Odm->tx_tp = 0; -+ pDM_Odm->rx_tp = 0; -+ pDM_Odm->total_tp = 0; -+ pDM_Odm->TrafficLoad = TRAFFIC_LOW; -+ -+ pDM_Odm->nbi_set_result = 0; -+ -+} -+ -+VOID -+odm_CommonInfoSelfUpdate( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u1Byte EntryCnt = 0, num_active_client = 0; -+ u4Byte i, OneEntry_MACID = 0, ma_rx_tp = 0; -+ PSTA_INFO_T pEntry; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ -+ pEntry = pDM_Odm->pODM_StaInfo[0]; -+ if (pMgntInfo->mAssoc) { -+ pEntry->bUsed = TRUE; -+ for (i = 0; i < 6; i++) -+ pEntry->MacAddr[i] = pMgntInfo->Bssid[i]; -+ } else if (GetFirstClientPort(Adapter)) { -+ PADAPTER pClientAdapter = GetFirstClientPort(Adapter); -+ -+ pEntry->bUsed = TRUE; -+ for (i = 0; i < 6; i++) -+ pEntry->MacAddr[i] = pClientAdapter->MgntInfo.Bssid[i]; -+ } else { -+ pEntry->bUsed = FALSE; -+ for (i = 0; i < 6; i++) -+ pEntry->MacAddr[i] = 0; -+ } -+ -+ //STA mode is linked to AP -+ if(IS_STA_VALID(pDM_Odm->pODM_StaInfo[0]) && !ACTING_AS_AP(Adapter)) -+ pDM_Odm->bsta_state = TRUE; -+ else -+ pDM_Odm->bsta_state = FALSE; -+#endif -+ -+/* THis variable cannot be used because it is wrong*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ { -+ if (*(pDM_Odm->pSecChOffset) == 1) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) + 2; -+ else if (*(pDM_Odm->pSecChOffset) == 2) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) - 2; -+ } else if (*(pDM_Odm->pBandWidth) == ODM_BW80M) { -+ if (*(pDM_Odm->pSecChOffset) == 1) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) + 6; -+ else if (*(pDM_Odm->pSecChOffset) == 2) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) - 6; -+ } else -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel); -+#else -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) { -+ if (*(pDM_Odm->pSecChOffset) == 1) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) - 2; -+ else if (*(pDM_Odm->pSecChOffset) == 2) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) + 2; -+ } else -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel); -+#endif -+ -+ for (i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pEntry)) -+ { -+ EntryCnt++; -+ if(EntryCnt==1) -+ { -+ OneEntry_MACID=i; -+ } -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ ma_rx_tp = (pEntry->rx_byte_cnt_LowMAW)<<3; /* low moving average RX TP ( bit /sec)*/ -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("ClientTP[%d]: ((%d )) bit/sec\n", i, ma_rx_tp)); -+ -+ if (ma_rx_tp > ACTIVE_TP_THRESHOLD) -+ num_active_client++; -+ #endif -+ } -+ } -+ -+ if(EntryCnt == 1) -+ { -+ pDM_Odm->bOneEntryOnly = TRUE; -+ pDM_Odm->OneEntry_MACID=OneEntry_MACID; -+ } -+ else -+ pDM_Odm->bOneEntryOnly = FALSE; -+ -+ pDM_Odm->pre_number_linked_client = pDM_Odm->number_linked_client; -+ pDM_Odm->pre_number_active_client = pDM_Odm->number_active_client; -+ -+ pDM_Odm->number_linked_client = EntryCnt; -+ pDM_Odm->number_active_client = num_active_client; -+ -+ /* Update MP driver status*/ -+ ODM_UpdateMpDriverStatus(pDM_Odm); -+ -+ /*Traffic load information update*/ -+ phydm_traffic_load_decision(pDM_Odm); -+ -+ pDM_Odm->phydm_sys_up_time += pDM_Odm->phydm_period; -+} -+ -+VOID -+odm_CommonInfoSelfReset( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt = 0; -+#endif -+} -+ -+PVOID -+PhyDM_Get_Structure( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte Structure_Type -+) -+ -+{ -+ PVOID pStruct = NULL; -+#if RTL8195A_SUPPORT -+ switch (Structure_Type){ -+ case PHYDM_FALSEALMCNT: -+ pStruct = &FalseAlmCnt; -+ break; -+ -+ case PHYDM_CFOTRACK: -+ pStruct = &DM_CfoTrack; -+ break; -+ -+ case PHYDM_ADAPTIVITY: -+ pStruct = &(pDM_Odm->Adaptivity); -+ break; -+ -+ default: -+ break; -+ } -+ -+#else -+ switch (Structure_Type){ -+ case PHYDM_FALSEALMCNT: -+ pStruct = &(pDM_Odm->FalseAlmCnt); -+ break; -+ -+ case PHYDM_CFOTRACK: -+ pStruct = &(pDM_Odm->DM_CfoTrack); -+ break; -+ -+ case PHYDM_ADAPTIVITY: -+ pStruct = &(pDM_Odm->Adaptivity); -+ break; -+ -+ default: -+ break; -+ } -+ -+#endif -+ return pStruct; -+} -+ -+VOID -+odm_HWSetting( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (RTL8821A_SUPPORT == 1) -+ if(pDM_Odm->SupportICType & ODM_RTL8821) -+ odm_HWSetting_8821A(pDM_Odm); -+#endif -+ -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ phydm_hwsetting_8814a(pDM_Odm); -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ phydm_hwsetting_8822b(pDM_Odm); -+#endif -+} -+#if SUPPORTABLITY_PHYDMLIZE -+VOID -+phydm_supportability_Init( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte support_ability = 0; -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ #endif -+ -+ if (pDM_Odm->SupportICType != ODM_RTL8821C) -+ return; -+ -+ switch (pDM_Odm->SupportICType) -+ { -+ -+ /*---------------N Series--------------------*/ -+ case ODM_RTL8188E: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_DYNAMIC_TXPWR | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ ODM_RF_TX_PWR_TRACK | -+ ODM_RF_RX_GAIN_TRACK | -+ ODM_RF_CALIBRATION | -+ ODM_MAC_EDCA_TURBO | -+ ODM_MAC_EARLY_MODE | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_NHM_CNT | -+ ODM_BB_PRIMARY_CCA; -+ break; -+ -+ case ODM_RTL8192E: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_RF_TX_PWR_TRACK | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_MAC_EDCA_TURBO | -+ ODM_BB_CFO_TRACKING | -+/* ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_NHM_CNT | -+ ODM_BB_PRIMARY_CCA; -+ break; -+ -+ case ODM_RTL8723B: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ ODM_RF_TX_PWR_TRACK | -+ ODM_RF_RX_GAIN_TRACK | -+ ODM_RF_CALIBRATION | -+ ODM_MAC_EDCA_TURBO | -+ ODM_BB_CFO_TRACKING | -+/* ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_NHM_CNT; -+ break; -+ -+ case ODM_RTL8703B: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ ODM_BB_CFO_TRACKING | -+ //ODM_BB_PWR_TRAIN | -+ ODM_BB_NHM_CNT | -+ ODM_RF_TX_PWR_TRACK | -+ //ODM_RF_RX_GAIN_TRACK | -+ ODM_RF_CALIBRATION | -+ ODM_MAC_EDCA_TURBO; -+ break; -+ -+ case ODM_RTL8723D: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ ODM_BB_CFO_TRACKING | -+ //ODM_BB_PWR_TRAIN | -+ ODM_BB_NHM_CNT | -+ ODM_RF_TX_PWR_TRACK | -+ //ODM_RF_RX_GAIN_TRACK | -+ //ODM_RF_CALIBRATION | -+ ODM_MAC_EDCA_TURBO; -+ break; -+ -+ case ODM_RTL8188F: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_CCK_PD | -+ ODM_MAC_EDCA_TURBO | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_NHM_CNT | -+ ODM_RF_TX_PWR_TRACK | -+ ODM_RF_CALIBRATION; -+ break; -+ /*---------------AC Series-------------------*/ -+ -+ case ODM_RTL8812: -+ case ODM_RTL8821: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_RA_MASK | -+ ODM_RF_TX_PWR_TRACK | -+ ODM_MAC_EDCA_TURBO | -+ ODM_BB_CFO_TRACKING | -+/* ODM_BB_PWR_TRAIN |*/ -+ ODM_BB_DYNAMIC_TXPWR | -+ ODM_BB_NHM_CNT; -+ break; -+ -+ case ODM_RTL8814A: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_RA_MASK | -+ ODM_RF_TX_PWR_TRACK | -+ ODM_BB_CCK_PD | -+ ODM_MAC_EDCA_TURBO | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_DYNAMIC_TXPWR | -+ ODM_BB_NHM_CNT; -+ break; -+ -+ case ODM_RTL8822B: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_FA_CNT | -+ ODM_BB_CCK_PD | -+ ODM_BB_CFO_TRACKING | -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_RA_MASK | -+ ODM_RF_TX_PWR_TRACK | -+ ODM_MAC_EDCA_TURBO; -+ break; -+ -+ case ODM_RTL8821C: -+ support_ability |= -+ ODM_BB_DIG | -+ ODM_BB_RA_MASK | -+ ODM_BB_CCK_PD | -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_BB_RATE_ADAPTIVE | -+ ODM_RF_TX_PWR_TRACK | -+ ODM_MAC_EDCA_TURBO | -+ ODM_BB_CFO_TRACKING; //| -+/* ODM_BB_DYNAMIC_TXPWR |*/ -+/* ODM_BB_NHM_CNT;*/ -+ break; -+ default: -+ DbgPrint("[Warning] Supportability Init error !!!\n"); -+ break; -+ -+ } -+ -+ if(*(pDM_Odm->p_enable_antdiv)) -+ support_ability |= ODM_BB_ANT_DIV; -+ -+ if (*(pDM_Odm->p_enable_adaptivity)) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM Adaptivity is set to Enabled!!!\n")); -+ -+ support_ability |= ODM_BB_ADAPTIVITY; -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE, pMgntInfo->RegEnableCarrierSense); -+ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_DCBACKOFF, pMgntInfo->RegDCbackoff); -+ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, pMgntInfo->RegDmLinkAdaptivity); -+ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_AP_NUM_TH, pMgntInfo->RegAPNumTH); -+ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_TH_L2H_INI, pMgntInfo->RegL2HForAdaptivity); -+ phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, pMgntInfo->RegHLDiffForAdaptivity); -+ #endif -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM Adaptivity is set to disnabled!!!\n")); -+ /**/ -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("PHYDM support_ability = ((0x%x))\n", support_ability)); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_ABILITY, support_ability); -+} -+#endif -+ -+// -+// 2011/09/21 MH Add to describe different team necessary resource allocate?? -+// -+VOID -+ODM_DMInit( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+#endif -+ -+ #if SUPPORTABLITY_PHYDMLIZE -+ phydm_supportability_Init(pDM_Odm); -+ #endif -+ odm_CommonInfoSelfInit(pDM_Odm); -+ odm_DIGInit(pDM_Odm); -+ Phydm_NHMCounterStatisticsInit(pDM_Odm); -+ Phydm_AdaptivityInit(pDM_Odm); -+ phydm_ra_info_init(pDM_Odm); -+ odm_RateAdaptiveMaskInit(pDM_Odm); -+ ODM_CfoTrackingInit(pDM_Odm); -+ ODM_EdcaTurboInit(pDM_Odm); -+ odm_RSSIMonitorInit(pDM_Odm); -+ phydm_rf_init(pDM_Odm); -+ odm_TXPowerTrackingInit(pDM_Odm); -+ odm_AntennaDiversityInit(pDM_Odm); -+ odm_AutoChannelSelectInit(pDM_Odm); -+ odm_PathDiversityInit(pDM_Odm); -+ odm_DynamicTxPowerInit(pDM_Odm); -+ phydm_initRaInfo(pDM_Odm); -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#if (PHYDM_LA_MODE_SUPPORT == 1) -+ ADCSmp_Init(pDM_Odm); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#ifdef BEAMFORMING_VERSION_1 -+ if (pHalData->BeamformingVersion == BEAMFORMING_VERSION_1) -+#endif -+ { -+ phydm_Beamforming_Init(pDM_Odm); -+ } -+#endif -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+#if (defined(CONFIG_BB_POWER_SAVING)) -+ odm_DynamicBBPowerSavingInit(pDM_Odm); -+#endif -+ -+#if (RTL8188E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType==ODM_RTL8188E) -+ { -+ ODM_PrimaryCCA_Init(pDM_Odm); -+ ODM_RAInfo_Init_all(pDM_Odm); -+ } -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ -+ #if (RTL8723B_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8723B) -+ odm_SwAntDetectInit(pDM_Odm); -+ #endif -+ -+ #if (RTL8192E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType==ODM_RTL8192E) -+ odm_PrimaryCCA_Check_Init(pDM_Odm); -+ #endif -+ -+#endif -+ -+ } -+ -+} -+ -+VOID -+ODM_DMReset( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ ODM_AntDivReset(pDM_Odm); -+ phydm_setEDCCAThresholdAPI(pDM_Odm, pDM_DigTable->CurIGValue); -+} -+ -+ -+VOID -+phydm_support_ability_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte pre_support_ability; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ pre_support_ability = pDM_Odm->SupportAbility ; -+ PHYDM_SNPRINTF((output+used, out_len-used,"\n%s\n", "================================")); -+ if(dm_value[0] == 100) -+ { -+ PHYDM_SNPRINTF((output+used, out_len-used, "[Supportability] PhyDM Selection\n")); -+ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "================================")); -+ PHYDM_SNPRINTF((output+used, out_len-used, "00. (( %s ))DIG\n", ((pDM_Odm->SupportAbility & ODM_BB_DIG)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "01. (( %s ))RA_MASK\n", ((pDM_Odm->SupportAbility & ODM_BB_RA_MASK)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "02. (( %s ))DYNAMIC_TXPWR\n", ((pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "03. (( %s ))FA_CNT\n", ((pDM_Odm->SupportAbility & ODM_BB_FA_CNT)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "04. (( %s ))RSSI_MONITOR\n", ((pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "05. (( %s ))CCK_PD\n", ((pDM_Odm->SupportAbility & ODM_BB_CCK_PD)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "06. (( %s ))ANT_DIV\n", ((pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "08. (( %s ))PWR_TRAIN\n", ((pDM_Odm->SupportAbility & ODM_BB_PWR_TRAIN)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "09. (( %s ))RATE_ADAPTIVE\n", ((pDM_Odm->SupportAbility & ODM_BB_RATE_ADAPTIVE)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "10. (( %s ))PATH_DIV\n", ((pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "13. (( %s ))ADAPTIVITY\n", ((pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "14. (( %s ))CFO_TRACKING\n", ((pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "15. (( %s ))NHM_CNT\n", ((pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "16. (( %s ))PRIMARY_CCA\n", ((pDM_Odm->SupportAbility & ODM_BB_PRIMARY_CCA)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "17. (( %s ))TXBF\n", ((pDM_Odm->SupportAbility & ODM_BB_TXBF)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "18. (( %s ))DYNAMIC_ARFR\n", ((pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_ARFR)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "20. (( %s ))EDCA_TURBO\n", ((pDM_Odm->SupportAbility & ODM_MAC_EDCA_TURBO)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "21. (( %s ))EARLY_MODE\n", ((pDM_Odm->SupportAbility & ODM_MAC_EARLY_MODE)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "24. (( %s ))TX_PWR_TRACK\n", ((pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "25. (( %s ))RX_GAIN_TRACK\n", ((pDM_Odm->SupportAbility & ODM_RF_RX_GAIN_TRACK)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used, "26. (( %s ))RF_CALIBRATION\n", ((pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)?("V"):(".")))); -+ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "================================")); -+ } -+ /* -+ else if(dm_value[0] == 101) -+ { -+ pDM_Odm->SupportAbility = 0 ; -+ DbgPrint("Disable all SupportAbility components \n"); -+ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "Disable all SupportAbility components")); -+ } -+ */ -+ else -+ { -+ -+ if(dm_value[1] == 1) //enable -+ { -+ pDM_Odm->SupportAbility |= BIT(dm_value[0]) ; -+ if(BIT(dm_value[0]) & ODM_BB_PATH_DIV) -+ { -+ odm_PathDiversityInit(pDM_Odm); -+ } -+ } -+ else if(dm_value[1] == 2) //disable -+ { -+ pDM_Odm->SupportAbility &= ~(BIT(dm_value[0])) ; -+ } -+ else -+ { -+ //DbgPrint("\n[Warning!!!] 1:enable, 2:disable \n\n"); -+ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "[Warning!!!] 1:enable, 2:disable")); -+ } -+ } -+ PHYDM_SNPRINTF((output+used, out_len-used,"pre-SupportAbility = 0x%x\n", pre_support_ability )); -+ PHYDM_SNPRINTF((output+used, out_len-used,"Curr-SupportAbility = 0x%x\n", pDM_Odm->SupportAbility )); -+ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "================================")); -+} -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+// -+//tmp modify for LC Only -+// -+VOID -+ODM_DMWatchdog_LPS( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ odm_CommonInfoSelfUpdate(pDM_Odm); -+ odm_FalseAlarmCounterStatistics(pDM_Odm); -+ odm_RSSIMonitorCheck(pDM_Odm); -+ odm_DIGbyRSSI_LPS(pDM_Odm); -+ odm_CCKPacketDetectionThresh(pDM_Odm); -+ odm_CommonInfoSelfReset(pDM_Odm); -+ -+ if(*(pDM_Odm->pbPowerSaving)==TRUE) -+ return; -+} -+#endif -+// -+// 2011/09/20 MH This is the entry pointer for all team to execute HW out source DM. -+// You can not add any dummy function here, be care, you can only use DM structure -+// to perform any new ODM_DM. -+// -+VOID -+ODM_DMWatchdog( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ odm_CommonInfoSelfUpdate(pDM_Odm); -+ phydm_BasicDbgMessage(pDM_Odm); -+ odm_HWSetting(pDM_Odm); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ { -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ if( (priv->auto_channel != 0) && (priv->auto_channel != 2) )//if ACS running, do not do FA/CCA counter read -+ return; -+ } -+#endif -+ odm_FalseAlarmCounterStatistics(pDM_Odm); -+ phydm_NoisyDetection(pDM_Odm); -+ -+ odm_RSSIMonitorCheck(pDM_Odm); -+ -+ if(*(pDM_Odm->pbPowerSaving) == TRUE) -+ { -+ odm_DIGbyRSSI_LPS(pDM_Odm); -+ { -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ Phydm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue); -+ } -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ odm_AntennaDiversity(pDM_Odm); /*enable AntDiv in PS mode, request from SD4 Jeff*/ -+ #endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("DMWatchdog in power saving mode\n")); -+ return; -+ } -+ -+ Phydm_CheckAdaptivity(pDM_Odm); -+ odm_UpdatePowerTrainingState(pDM_Odm); -+ odm_DIG(pDM_Odm); -+ { -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ Phydm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue); -+ } -+ odm_CCKPacketDetectionThresh(pDM_Odm); -+ -+ phydm_ra_info_watchdog(pDM_Odm); -+ odm_EdcaTurboCheck(pDM_Odm); -+ odm_PathDiversity(pDM_Odm); -+ ODM_CfoTracking(pDM_Odm); -+ odm_DynamicTxPower(pDM_Odm); -+ odm_AntennaDiversity(pDM_Odm); -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ phydm_Beamforming_Watchdog(pDM_Odm); -+#endif -+ -+ phydm_rf_watchdog(pDM_Odm); -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ -+#if (RTL8188E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ ODM_DynamicPrimaryCCA(pDM_Odm); -+#endif -+ -+#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ -+ #if (RTL8192E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType==ODM_RTL8192E) -+ odm_DynamicPrimaryCCA_Check(pDM_Odm); -+ #endif -+#endif -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ odm_dtc(pDM_Odm); -+#endif -+ -+ odm_CommonInfoSelfReset(pDM_Odm); -+ -+} -+ -+ -+// -+// Init /.. Fixed HW value. Only init time. -+// -+VOID -+ODM_CmnInfoInit( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_CMNINFO_E CmnInfo, -+ IN u4Byte Value -+ ) -+{ -+ // -+ // This section is used for init value -+ // -+ switch (CmnInfo) -+ { -+ // -+ // Fixed ODM value. -+ // -+ case ODM_CMNINFO_ABILITY: -+ pDM_Odm->SupportAbility = (u4Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RF_TYPE: -+ pDM_Odm->RFType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_PLATFORM: -+ pDM_Odm->SupportPlatform = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_INTERFACE: -+ pDM_Odm->SupportInterface = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_MP_TEST_CHIP: -+ pDM_Odm->bIsMPChip= (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_IC_TYPE: -+ pDM_Odm->SupportICType = Value; -+ break; -+ -+ case ODM_CMNINFO_CUT_VER: -+ pDM_Odm->CutVersion = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_FAB_VER: -+ pDM_Odm->FabVersion = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RFE_TYPE: -+ pDM_Odm->RFEType = (u1Byte)Value; -+ PHYDM_InitHwInfoByRfe(pDM_Odm); -+ break; -+ -+ case ODM_CMNINFO_RF_ANTENNA_TYPE: -+ pDM_Odm->AntDivType= (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH: -+ pDM_Odm->with_extenal_ant_switch = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BE_FIX_TX_ANT: -+ pDM_Odm->DM_FatTable.b_fix_tx_ant = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BOARD_TYPE: -+ if (!pDM_Odm->bInitHwInfoByRfe) -+ pDM_Odm->BoardType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_PACKAGE_TYPE: -+ if (!pDM_Odm->bInitHwInfoByRfe) -+ pDM_Odm->PackageType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_EXT_LNA: -+ if (!pDM_Odm->bInitHwInfoByRfe) -+ pDM_Odm->ExtLNA = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_5G_EXT_LNA: -+ if (!pDM_Odm->bInitHwInfoByRfe) -+ pDM_Odm->ExtLNA5G = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_EXT_PA: -+ if (!pDM_Odm->bInitHwInfoByRfe) -+ pDM_Odm->ExtPA = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_5G_EXT_PA: -+ if (!pDM_Odm->bInitHwInfoByRfe) -+ pDM_Odm->ExtPA5G = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_GPA: -+ if (!pDM_Odm->bInitHwInfoByRfe) -+ pDM_Odm->TypeGPA = (u2Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_APA: -+ if (!pDM_Odm->bInitHwInfoByRfe) -+ pDM_Odm->TypeAPA = (u2Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_GLNA: -+ if (!pDM_Odm->bInitHwInfoByRfe) -+ pDM_Odm->TypeGLNA = (u2Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_ALNA: -+ if (!pDM_Odm->bInitHwInfoByRfe) -+ pDM_Odm->TypeALNA = (u2Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_EXT_TRSW: -+ pDM_Odm->ExtTRSW = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_EXT_LNA_GAIN: -+ pDM_Odm->ExtLNAGain = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_PATCH_ID: -+ pDM_Odm->PatchID = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_BINHCT_TEST: -+ pDM_Odm->bInHctTest = (BOOLEAN)Value; -+ break; -+ case ODM_CMNINFO_BWIFI_TEST: -+ pDM_Odm->WIFITest = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_SMART_CONCURRENT: -+ pDM_Odm->bDualMacSmartConcurrent = (BOOLEAN )Value; -+ break; -+ case ODM_CMNINFO_DOMAIN_CODE_2G: -+ pDM_Odm->odm_Regulation2_4G = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_DOMAIN_CODE_5G: -+ pDM_Odm->odm_Regulation5G = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_CONFIG_BB_RF: -+ pDM_Odm->ConfigBBRF = (BOOLEAN)Value; -+ break; -+ case ODM_CMNINFO_IQKFWOFFLOAD: -+ pDM_Odm->IQKFWOffload = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_IQKPAOFF: -+ pDM_Odm->RFCalibrateInfo.bIQKPAoff = (BOOLEAN )Value; -+ break; -+ case ODM_CMNINFO_REGRFKFREEENABLE: -+ pDM_Odm->RFCalibrateInfo.RegRfKFreeEnable = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_RFKFREEENABLE: -+ pDM_Odm->RFCalibrateInfo.RfKFreeEnable = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_NORMAL_RX_PATH_CHANGE: -+ pDM_Odm->Normalrxpath = (u1Byte)Value; -+ break; -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ case ODM_CMNINFO_DFS_REGION_DOMAIN: -+ pDM_Odm->DFS_RegionDomain = (u1Byte)Value; -+ break; -+#endif -+ //To remove the compiler warning, must add an empty default statement to handle the other values. -+ default: -+ //do nothing -+ break; -+ -+ } -+ -+} -+ -+ -+VOID -+ODM_CmnInfoHook( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_CMNINFO_E CmnInfo, -+ IN PVOID pValue -+ ) -+{ -+ // -+ // Hook call by reference pointer. -+ // -+ switch (CmnInfo) -+ { -+ // -+ // Dynamic call by reference pointer. -+ // -+ case ODM_CMNINFO_MAC_PHY_MODE: -+ pDM_Odm->pMacPhyMode = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_TX_UNI: -+ pDM_Odm->pNumTxBytesUnicast = (u8Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_RX_UNI: -+ pDM_Odm->pNumRxBytesUnicast = (u8Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_WM_MODE: -+ pDM_Odm->pWirelessMode = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_BAND: -+ pDM_Odm->pBandType = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_SEC_CHNL_OFFSET: -+ pDM_Odm->pSecChOffset = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_SEC_MODE: -+ pDM_Odm->pSecurity = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_BW: -+ pDM_Odm->pBandWidth = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_CHNL: -+ pDM_Odm->pChannel = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_DMSP_GET_VALUE: -+ pDM_Odm->pbGetValueFromOtherMac = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_BUDDY_ADAPTOR: -+ pDM_Odm->pBuddyAdapter = (PADAPTER *)pValue; -+ break; -+ -+ case ODM_CMNINFO_DMSP_IS_MASTER: -+ pDM_Odm->pbMasterOfDMSP = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_SCAN: -+ pDM_Odm->pbScanInProcess = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_POWER_SAVING: -+ pDM_Odm->pbPowerSaving = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_ONE_PATH_CCA: -+ pDM_Odm->pOnePathCCA = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_DRV_STOP: -+ pDM_Odm->pbDriverStopped = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_PNP_IN: -+ pDM_Odm->pbDriverIsGoingToPnpSetPowerSleep = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_INIT_ON: -+ pDM_Odm->pinit_adpt_in_progress = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_ANT_TEST: -+ pDM_Odm->pAntennaTest = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_NET_CLOSED: -+ pDM_Odm->pbNet_closed = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_FORCED_RATE: -+ pDM_Odm->pForcedDataRate = (pu2Byte)pValue; -+ break; -+ case ODM_CMNINFO_ANT_DIV: -+ pDM_Odm->p_enable_antdiv = (pu1Byte)pValue; -+ break; -+ case ODM_CMNINFO_ADAPTIVITY: -+ pDM_Odm->p_enable_adaptivity = (pu1Byte)pValue; -+ break; -+ case ODM_CMNINFO_FORCED_IGI_LB: -+ pDM_Odm->pu1ForcedIgiLb = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_P2P_LINK: -+ pDM_Odm->DM_DigTable.bP2PInProcess = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_IS1ANTENNA: -+ pDM_Odm->pIs1Antenna = (BOOLEAN *)pValue; -+ break; -+ -+ case ODM_CMNINFO_RFDEFAULTPATH: -+ pDM_Odm->pRFDefaultPath= (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_FCS_MODE: -+ pDM_Odm->pIsFcsModeEnable = (BOOLEAN *)pValue; -+ break; -+ /*add by YuChen for beamforming PhyDM*/ -+ case ODM_CMNINFO_HUBUSBMODE: -+ pDM_Odm->HubUsbMode = (u1Byte *)pValue; -+ break; -+ case ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS: -+ pDM_Odm->pbFwDwRsvdPageInProgress = (BOOLEAN *)pValue; -+ break; -+ case ODM_CMNINFO_TX_TP: -+ pDM_Odm->pCurrentTxTP = (u4Byte *)pValue; -+ break; -+ case ODM_CMNINFO_RX_TP: -+ pDM_Odm->pCurrentRxTP = (u4Byte *)pValue; -+ break; -+ case ODM_CMNINFO_SOUNDING_SEQ: -+ pDM_Odm->pSoundingSeq = (u1Byte *)pValue; -+ break; -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ case ODM_CMNINFO_DFS_MASTER_ENABLE: -+ pDM_Odm->dfs_master_enabled = (u1Byte *)pValue; -+ break; -+#endif -+ case ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC: -+ pDM_Odm->DM_FatTable.pForceTxAntByDesc = (u1Byte *)pValue; -+ break; -+ case ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA: -+ pDM_Odm->DM_FatTable.pDefaultS0S1 = (u1Byte *)pValue; -+ break; -+ -+ default: -+ /*do nothing*/ -+ break; -+ -+ } -+ -+} -+ -+ -+VOID -+ODM_CmnInfoPtrArrayHook( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_CMNINFO_E CmnInfo, -+ IN u2Byte Index, -+ IN PVOID pValue -+ ) -+{ -+ /*Hook call by reference pointer.*/ -+ switch (CmnInfo) -+ { -+ /*Dynamic call by reference pointer. */ -+ case ODM_CMNINFO_STA_STATUS: -+ pDM_Odm->pODM_StaInfo[Index] = (PSTA_INFO_T)pValue; -+ -+ if (IS_STA_VALID(pDM_Odm->pODM_StaInfo[Index])) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pDM_Odm->platform2phydm_macid_table[((PSTA_INFO_T)pValue)->AssociatedMacId] = Index; /*AssociatedMacId are unique bttween different Adapter*/ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ pDM_Odm->platform2phydm_macid_table[((PSTA_INFO_T)pValue)->aid] = Index; -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ pDM_Odm->platform2phydm_macid_table[((PSTA_INFO_T)pValue)->mac_id] = Index; -+ #endif -+ -+ break; -+ //To remove the compiler warning, must add an empty default statement to handle the other values. -+ default: -+ //do nothing -+ break; -+ } -+ -+} -+ -+ -+// -+// Update Band/CHannel/.. The values are dynamic but non-per-packet. -+// -+VOID -+ODM_CmnInfoUpdate( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte CmnInfo, -+ IN u8Byte Value -+ ) -+{ -+ // -+ // This init variable may be changed in run time. -+ // -+ switch (CmnInfo) -+ { -+ case ODM_CMNINFO_LINK_IN_PROGRESS: -+ pDM_Odm->bLinkInProcess = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_ABILITY: -+ pDM_Odm->SupportAbility = (u4Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RF_TYPE: -+ pDM_Odm->RFType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_WIFI_DIRECT: -+ pDM_Odm->bWIFI_Direct = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_WIFI_DISPLAY: -+ pDM_Odm->bWIFI_Display = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_LINK: -+ pDM_Odm->bLinked = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_STATION_STATE: -+ pDM_Odm->bsta_state = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_RSSI_MIN: -+ pDM_Odm->RSSI_Min= (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_DBG_COMP: -+ pDM_Odm->DebugComponents = (u4Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_DBG_LEVEL: -+ pDM_Odm->DebugLevel = (u4Byte)Value; -+ break; -+ case ODM_CMNINFO_RA_THRESHOLD_HIGH: -+ pDM_Odm->RateAdaptive.HighRSSIThresh = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RA_THRESHOLD_LOW: -+ pDM_Odm->RateAdaptive.LowRSSIThresh = (u1Byte)Value; -+ break; -+#if defined(BT_SUPPORT) && (BT_SUPPORT == 1) -+ // The following is for BT HS mode and BT coexist mechanism. -+ case ODM_CMNINFO_BT_ENABLED: -+ pDM_Odm->bBtEnabled = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_HS_CONNECT_PROCESS: -+ pDM_Odm->bBtConnectProcess = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_HS_RSSI: -+ pDM_Odm->btHsRssi = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_OPERATION: -+ pDM_Odm->bBtHsOperation = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_LIMITED_DIG: -+ pDM_Odm->bBtLimitedDig = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_DIG: -+ pDM_Odm->btHsDigVal = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_BUSY: -+ pDM_Odm->bBtBusy = (BOOLEAN)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_DISABLE_EDCA: -+ pDM_Odm->bBtDisableEdcaTurbo = (BOOLEAN)Value; -+ break; -+#endif -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_AP) // for repeater mode add by YuChen 2014.06.23 -+#ifdef UNIVERSAL_REPEATER -+ case ODM_CMNINFO_VXD_LINK: -+ pDM_Odm->VXD_bLinked= (BOOLEAN)Value; -+ break; -+#endif -+#endif -+ -+ case ODM_CMNINFO_AP_TOTAL_NUM: -+ pDM_Odm->APTotalNum = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_POWER_TRAINING: -+ pDM_Odm->bDisablePowerTraining = (BOOLEAN)Value; -+ break; -+ -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ case ODM_CMNINFO_DFS_REGION_DOMAIN: -+ pDM_Odm->DFS_RegionDomain = (u1Byte)Value; -+ break; -+#endif -+ -+/* -+ case ODM_CMNINFO_OP_MODE: -+ pDM_Odm->OPMode = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_WM_MODE: -+ pDM_Odm->WirelessMode = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BAND: -+ pDM_Odm->BandType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_SEC_CHNL_OFFSET: -+ pDM_Odm->SecChOffset = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_SEC_MODE: -+ pDM_Odm->Security = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BW: -+ pDM_Odm->BandWidth = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_CHNL: -+ pDM_Odm->Channel = (u1Byte)Value; -+ break; -+*/ -+ default: -+ //do nothing -+ break; -+ } -+ -+ -+} -+ -+u4Byte -+PHYDM_CmnInfoQuery( -+ IN PDM_ODM_T pDM_Odm, -+ IN PHYDM_INFO_QUERY_E info_type -+ ) -+{ -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_FALSEALMCNT); -+ -+ switch (info_type) { -+ case PHYDM_INFO_FA_OFDM: -+ return FalseAlmCnt->Cnt_Ofdm_fail; -+ -+ case PHYDM_INFO_FA_CCK: -+ return FalseAlmCnt->Cnt_Cck_fail; -+ -+ case PHYDM_INFO_FA_TOTAL: -+ return FalseAlmCnt->Cnt_all; -+ -+ case PHYDM_INFO_CCA_OFDM: -+ return FalseAlmCnt->Cnt_OFDM_CCA; -+ -+ case PHYDM_INFO_CCA_CCK: -+ return FalseAlmCnt->Cnt_CCK_CCA; -+ -+ case PHYDM_INFO_CCA_ALL: -+ return FalseAlmCnt->Cnt_CCA_all; -+ -+ case PHYDM_INFO_CRC32_OK_VHT: -+ return FalseAlmCnt->cnt_vht_crc32_ok; -+ -+ case PHYDM_INFO_CRC32_OK_HT: -+ return FalseAlmCnt->cnt_ht_crc32_ok; -+ -+ case PHYDM_INFO_CRC32_OK_LEGACY: -+ return FalseAlmCnt->cnt_ofdm_crc32_ok; -+ -+ case PHYDM_INFO_CRC32_OK_CCK: -+ return FalseAlmCnt->cnt_cck_crc32_ok; -+ -+ case PHYDM_INFO_CRC32_ERROR_VHT: -+ return FalseAlmCnt->cnt_vht_crc32_error; -+ -+ case PHYDM_INFO_CRC32_ERROR_HT: -+ return FalseAlmCnt->cnt_ht_crc32_error; -+ -+ case PHYDM_INFO_CRC32_ERROR_LEGACY: -+ return FalseAlmCnt->cnt_ofdm_crc32_error; -+ -+ case PHYDM_INFO_CRC32_ERROR_CCK: -+ return FalseAlmCnt->cnt_cck_crc32_error; -+ -+ case PHYDM_INFO_EDCCA_FLAG: -+ return FalseAlmCnt->edcca_flag; -+ -+ case PHYDM_INFO_OFDM_ENABLE: -+ return FalseAlmCnt->ofdm_block_enable; -+ -+ case PHYDM_INFO_CCK_ENABLE: -+ return FalseAlmCnt->cck_block_enable; -+ -+ case PHYDM_INFO_DBG_PORT_0: -+ return FalseAlmCnt->dbg_port0; -+ -+ default: -+ return 0xffffffff; -+ -+ } -+} -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+ODM_InitAllWorkItems(IN PDM_ODM_T pDM_Odm ) -+{ -+ -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+#if USE_WORKITEM -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ ODM_InitializeWorkItem( pDM_Odm, -+ &pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchWorkitem, -+ (RT_WORKITEM_CALL_BACK)ODM_SW_AntDiv_WorkitemCallback, -+ (PVOID)pAdapter, -+ "AntennaSwitchWorkitem"); -+ #endif -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ ODM_InitializeWorkItem(pDM_Odm, -+ &pDM_Odm->dm_sat_table.hl_smart_antenna_workitem, -+ (RT_WORKITEM_CALL_BACK)phydm_beam_switch_workitem_callback, -+ (PVOID)pAdapter, -+ "hl_smart_ant_workitem"); -+ -+ ODM_InitializeWorkItem(pDM_Odm, -+ &pDM_Odm->dm_sat_table.hl_smart_antenna_decision_workitem, -+ (RT_WORKITEM_CALL_BACK)phydm_beam_decision_workitem_callback, -+ (PVOID)pAdapter, -+ "hl_smart_ant_decision_workitem"); -+ #endif -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->PathDivSwitchWorkitem), -+ (RT_WORKITEM_CALL_BACK)odm_PathDivChkAntSwitchWorkitemCallback, -+ (PVOID)pAdapter, -+ "SWAS_WorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->CCKPathDiversityWorkitem), -+ (RT_WORKITEM_CALL_BACK)odm_CCKTXPathDiversityWorkItemCallback, -+ (PVOID)pAdapter, -+ "CCKTXPathDiversityWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->MPT_DIGWorkitem), -+ (RT_WORKITEM_CALL_BACK)odm_MPT_DIGWorkItemCallback, -+ (PVOID)pAdapter, -+ "MPT_DIGWorkitem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->RaRptWorkitem), -+ (RT_WORKITEM_CALL_BACK)ODM_UpdateInitRateWorkItemCallback, -+ (PVOID)pAdapter, -+ "RaRptWorkitem"); -+ -+#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->FastAntTrainingWorkitem), -+ (RT_WORKITEM_CALL_BACK)odm_FastAntTrainingWorkItemCallback, -+ (PVOID)pAdapter, -+ "FastAntTrainingWorkitem"); -+#endif -+ -+#endif /*#if USE_WORKITEM*/ -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_EnterWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_EnterWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_EnterWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_LeaveWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_LeaveWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_LeaveWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_FwNdpaWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_FwNdpaWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ClkWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_ClkWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_ClkWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_RateWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_RateWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_RateWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_StatusWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_StatusWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_StatusWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ResetTxPathWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_ResetTxPathWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_ResetTxPathWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_GetTxRateWorkItem), -+ (RT_WORKITEM_CALL_BACK)halComTxbf_GetTxRateWorkItemCallback, -+ (PVOID)pAdapter, -+ "Txbf_GetTxRateWorkItem"); -+#endif -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->Adaptivity.phydm_pauseEDCCAWorkItem), -+ (RT_WORKITEM_CALL_BACK)phydm_pauseEDCCA_WorkItemCallback, -+ (PVOID)pAdapter, -+ "phydm_pauseEDCCAWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->Adaptivity.phydm_resumeEDCCAWorkItem), -+ (RT_WORKITEM_CALL_BACK)phydm_resumeEDCCA_WorkItemCallback, -+ (PVOID)pAdapter, -+ "phydm_resumeEDCCAWorkItem"); -+ -+ ODM_InitializeWorkItem( -+ pDM_Odm, -+ &(pDM_Odm->adcsmp.ADCSmpWorkItem), -+ (RT_WORKITEM_CALL_BACK)ADCSmpWorkItemCallback, -+ (PVOID)pAdapter, -+ "ADCSmpWorkItem"); -+ -+} -+ -+VOID -+ODM_FreeAllWorkItems(IN PDM_ODM_T pDM_Odm ) -+{ -+#if USE_WORKITEM -+ -+#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ ODM_FreeWorkItem(&(pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchWorkitem)); -+#endif -+ -+#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ ODM_FreeWorkItem(&(pDM_Odm->dm_sat_table.hl_smart_antenna_workitem)); -+ ODM_FreeWorkItem(&(pDM_Odm->dm_sat_table.hl_smart_antenna_decision_workitem)); -+#endif -+ -+ ODM_FreeWorkItem(&(pDM_Odm->PathDivSwitchWorkitem)); -+ ODM_FreeWorkItem(&(pDM_Odm->CCKPathDiversityWorkitem)); -+#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ ODM_FreeWorkItem(&(pDM_Odm->FastAntTrainingWorkitem)); -+#endif -+ ODM_FreeWorkItem(&(pDM_Odm->MPT_DIGWorkitem)); -+ ODM_FreeWorkItem(&(pDM_Odm->RaRptWorkitem)); -+ /*ODM_FreeWorkItem((&pDM_Odm->sbdcnt_workitem));*/ -+#endif -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_EnterWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_LeaveWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ClkWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_RateWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_StatusWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ResetTxPathWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_GetTxRateWorkItem)); -+#endif -+ -+ ODM_FreeWorkItem((&pDM_Odm->Adaptivity.phydm_pauseEDCCAWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->Adaptivity.phydm_resumeEDCCAWorkItem)); -+ ODM_FreeWorkItem((&pDM_Odm->adcsmp.ADCSmpWorkItem)); -+ -+} -+#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+ -+/* -+VOID -+odm_FindMinimumRSSI( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte i; -+ u1Byte RSSI_Min = 0xFF; -+ -+ for(i=0; ipODM_StaInfo[i] != NULL) -+ if(IS_STA_VALID(pDM_Odm->pODM_StaInfo[i]) ) -+ { -+ if(pDM_Odm->pODM_StaInfo[i]->RSSI_Ave < RSSI_Min) -+ { -+ RSSI_Min = pDM_Odm->pODM_StaInfo[i]->RSSI_Ave; -+ } -+ } -+ } -+ -+ pDM_Odm->RSSI_Min = RSSI_Min; -+ -+} -+ -+VOID -+odm_IsLinked( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte i; -+ BOOLEAN Linked = FALSE; -+ -+ for(i=0; ipODM_StaInfo[i]) ) -+ { -+ Linked = TRUE; -+ break; -+ } -+ -+ } -+ -+ pDM_Odm->bLinked = Linked; -+} -+*/ -+ -+VOID -+ODM_InitAllTimers( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ ODM_AntDivTimers(pDM_Odm,INIT_ANTDIV_TIMMER); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#ifdef MP_TEST -+ if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer, -+ (RT_TIMER_CALL_BACK)odm_MPT_DIGCallback, NULL, "MPT_DIGTimer"); -+#endif -+#elif(DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer, -+ (RT_TIMER_CALL_BACK)odm_MPT_DIGCallback, NULL, "MPT_DIGTimer"); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer, -+ (RT_TIMER_CALL_BACK)odm_PathDivChkAntSwitchCallback, NULL, "PathDivTimer"); -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer, -+ (RT_TIMER_CALL_BACK)odm_CCKTXPathDiversityCallback, NULL, "CCKPathDiversityTimer"); -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer, -+ (RT_TIMER_CALL_BACK)phydm_sbd_callback, NULL, "SbdTimer"); -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaTimer, -+ (RT_TIMER_CALL_BACK)halComTxbf_FwNdpaTimerCallback, NULL, "Txbf_FwNdpaTimer"); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_InitializeTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.BeamformingTimer, -+ (RT_TIMER_CALL_BACK)Beamforming_SWTimerCallback, NULL, "BeamformingTimer"); -+#endif -+#endif -+} -+ -+VOID -+ODM_CancelAllTimers( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ // -+ // 2012/01/12 MH Temp BSOD fix. We need to find NIC allocate mem fail reason in -+ // win7 platform. -+ // -+ HAL_ADAPTER_STS_CHK(pDM_Odm) -+#endif -+ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ ODM_AntDivTimers(pDM_Odm,CANCEL_ANTDIV_TIMMER); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#ifdef MP_TEST -+ if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -+#endif -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer); -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer); -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer); -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaTimer); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_CancelTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.BeamformingTimer); -+#endif -+#endif -+ -+} -+ -+ -+VOID -+ODM_ReleaseAllTimers( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ ODM_AntDivTimers(pDM_Odm,RELEASE_ANTDIV_TIMMER); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #ifdef MP_TEST -+ if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -+ #endif -+#elif(DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer); -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer); -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer); -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaTimer); -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#if (BEAMFORMING_SUPPORT == 1) -+ ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.BeamformingTimer); -+#endif -+#endif -+} -+ -+ -+//3============================================================ -+//3 Tx Power Tracking -+//3============================================================ -+ -+ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+VOID -+ODM_InitAllThreads( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ #ifdef TPT_THREAD -+ kTPT_task_init(pDM_Odm->priv); -+ #endif -+} -+ -+VOID -+ODM_StopAllThreads( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ #ifdef TPT_THREAD -+ kTPT_task_stop(pDM_Odm->priv); -+ #endif -+} -+#endif -+ -+ -+#if( DM_ODM_SUPPORT_TYPE == ODM_WIN) -+// -+// 2011/07/26 MH Add an API for testing IQK fail case. -+// -+BOOLEAN -+ODM_CheckPowerStatus( -+ IN PADAPTER Adapter) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ RT_RF_POWER_STATE rtState; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ -+ // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. -+ if (pMgntInfo->init_adpt_in_progress == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter\n")); -+ return TRUE; -+ } -+ -+ // -+ // 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. -+ // -+ Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState)); -+ if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n", -+ Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState)); -+ return FALSE; -+ } -+ return TRUE; -+} -+#elif( DM_ODM_SUPPORT_TYPE == ODM_AP) -+BOOLEAN -+ODM_CheckPowerStatus( -+ IN PADAPTER Adapter) -+{ -+ /* -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ RT_RF_POWER_STATE rtState; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ -+ // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. -+ if (pMgntInfo->init_adpt_in_progress == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm,COMP_INIT, DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter")); -+ return TRUE; -+ } -+ -+ // -+ // 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. -+ // -+ Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState)); -+ if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff) -+ { -+ ODM_RT_TRACE(pDM_Odm,COMP_INIT, DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n", -+ Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState)); -+ return FALSE; -+ } -+ */ -+ return TRUE; -+} -+#endif -+ -+// need to ODM CE Platform -+//move to here for ANT detection mechanism using -+ -+#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN)||(DM_ODM_SUPPORT_TYPE == ODM_CE)) -+u4Byte -+GetPSDData( -+ IN PDM_ODM_T pDM_Odm, -+ unsigned int point, -+ u1Byte initial_gain_psd) -+{ -+ //unsigned int val, rfval; -+ //int psd_report; -+ u4Byte psd_report; -+ -+ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ //Debug Message -+ //val = PHY_QueryBBReg(Adapter,0x908, bMaskDWord); -+ //DbgPrint("Reg908 = 0x%x\n",val); -+ //val = PHY_QueryBBReg(Adapter,0xDF4, bMaskDWord); -+ //rfval = PHY_QueryRFReg(Adapter, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask); -+ //DbgPrint("RegDF4 = 0x%x, RFReg00 = 0x%x\n",val, rfval); -+ //DbgPrint("PHYTXON = %x, OFDMCCA_PP = %x, CCKCCA_PP = %x, RFReg00 = %x\n", -+ //(val&BIT25)>>25, (val&BIT14)>>14, (val&BIT15)>>15, rfval); -+ -+ //Set DCO frequency index, offset=(40MHz/SamplePts)*point -+ ODM_SetBBReg(pDM_Odm, 0x808, 0x3FF, point); -+ -+ //Start PSD calculation, Reg808[22]=0->1 -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 1); -+ //Need to wait for HW PSD report -+ ODM_StallExecution(1000); -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 0); -+ //Read PSD report, Reg8B4[15:0] -+ psd_report = ODM_GetBBReg(pDM_Odm,0x8B4, bMaskDWord) & 0x0000FFFF; -+ -+#if 1//(DEV_BUS_TYPE == RT_PCI_INTERFACE) && ( (RT_PLATFORM == PLATFORM_LINUX) || (RT_PLATFORM == PLATFORM_MACOSX)) -+ psd_report = (u4Byte) (odm_ConvertTo_dB(psd_report))+(u4Byte)(initial_gain_psd-0x1c); -+#else -+ psd_report = (int) (20*log10((double)psd_report))+(int)(initial_gain_psd-0x1c); -+#endif -+ -+ return psd_report; -+ -+} -+#endif -+ -+u4Byte -+odm_ConvertTo_dB( -+ u4Byte Value) -+{ -+ u1Byte i; -+ u1Byte j; -+ u4Byte dB; -+ -+ Value = Value & 0xFFFF; -+ -+ for (i = 0; i < 12; i++) -+ { -+ if (Value <= dB_Invert_Table[i][7]) -+ { -+ break; -+ } -+ } -+ -+ if (i >= 12) -+ { -+ return (96); // maximum 96 dB -+ } -+ -+ for (j = 0; j < 8; j++) -+ { -+ if (Value <= dB_Invert_Table[i][j]) -+ { -+ break; -+ } -+ } -+ -+ dB = (i << 3) + j + 1; -+ -+ return (dB); -+} -+ -+u4Byte -+odm_ConvertTo_linear( -+ u4Byte Value) -+{ -+ u1Byte i; -+ u1Byte j; -+ u4Byte linear; -+ -+ /* 1dB~96dB */ -+ -+ Value = Value & 0xFF; -+ -+ i = (u1Byte)((Value - 1) >> 3); -+ j = (u1Byte)(Value - 1) - (i << 3); -+ -+ linear = dB_Invert_Table[i][j]; -+ -+ return (linear); -+} -+ -+// -+// ODM multi-port consideration, added by Roger, 2013.10.01. -+// -+VOID -+ODM_AsocEntry_Init( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER pLoopAdapter = GetDefaultAdapter(pDM_Odm->Adapter); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pLoopAdapter); -+ PDM_ODM_T pDM_OutSrc = &pHalData->DM_OutSrc; -+ u1Byte TotalAssocEntryNum = 0; -+ u1Byte index = 0; -+ u1Byte adaptercount = 0; -+ -+ ODM_CmnInfoPtrArrayHook(pDM_OutSrc, ODM_CMNINFO_STA_STATUS, 0, &pLoopAdapter->MgntInfo.DefaultPort[0]); -+ pLoopAdapter->MgntInfo.DefaultPort[0].MultiPortStationIdx = TotalAssocEntryNum; -+ -+ adaptercount += 1; -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("adaptercount=%d\n", adaptercount)); -+ pLoopAdapter = GetNextExtAdapter(pLoopAdapter); -+ TotalAssocEntryNum +=1; -+ -+ while(pLoopAdapter) -+ { -+ for (index = 0; index MgntInfo.AsocEntry[index]); -+ pLoopAdapter->MgntInfo.AsocEntry[index].MultiPortStationIdx = TotalAssocEntryNum+index; -+ } -+ -+ TotalAssocEntryNum+= index; -+ if(IS_HARDWARE_TYPE_8188E((pDM_Odm->Adapter))) -+ pLoopAdapter->RASupport = TRUE; -+ adaptercount += 1; -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("adaptercount=%d\n", adaptercount)); -+ pLoopAdapter = GetNextExtAdapter(pLoopAdapter); -+ } -+ -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("TotalAssocEntryNum = %d\n", TotalAssocEntryNum)); -+ if (TotalAssocEntryNum < (ODM_ASSOCIATE_ENTRY_NUM-1)) { -+ -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("In hook null\n")); -+ for (index = TotalAssocEntryNum; index < ODM_ASSOCIATE_ENTRY_NUM; index++) -+ ODM_CmnInfoPtrArrayHook(pDM_OutSrc, ODM_CMNINFO_STA_STATUS, index, NULL); -+ } -+#endif -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+/* Justin: According to the current RRSI to adjust Response Frame TX power, 2012/11/05 */ -+void odm_dtc(PDM_ODM_T pDM_Odm) -+{ -+#ifdef CONFIG_DM_RESP_TXAGC -+ #define DTC_BASE 35 /* RSSI higher than this value, start to decade TX power */ -+ #define DTC_DWN_BASE (DTC_BASE-5) /* RSSI lower than this value, start to increase TX power */ -+ -+ /* RSSI vs TX power step mapping: decade TX power */ -+ static const u8 dtc_table_down[]={ -+ DTC_BASE, -+ (DTC_BASE+5), -+ (DTC_BASE+10), -+ (DTC_BASE+15), -+ (DTC_BASE+20), -+ (DTC_BASE+25) -+ }; -+ -+ /* RSSI vs TX power step mapping: increase TX power */ -+ static const u8 dtc_table_up[]={ -+ DTC_DWN_BASE, -+ (DTC_DWN_BASE-5), -+ (DTC_DWN_BASE-10), -+ (DTC_DWN_BASE-15), -+ (DTC_DWN_BASE-15), -+ (DTC_DWN_BASE-20), -+ (DTC_DWN_BASE-20), -+ (DTC_DWN_BASE-25), -+ (DTC_DWN_BASE-25), -+ (DTC_DWN_BASE-30), -+ (DTC_DWN_BASE-35) -+ }; -+ -+ u8 i; -+ u8 dtc_steps=0; -+ u8 sign; -+ u8 resp_txagc=0; -+ -+ #if 0 -+ /* As DIG is disabled, DTC is also disable */ -+ if(!(pDM_Odm->SupportAbility & ODM_XXXXXX)) -+ return; -+ #endif -+ -+ if (DTC_BASE < pDM_Odm->RSSI_Min) { -+ /* need to decade the CTS TX power */ -+ sign = 1; -+ for (i=0;i= pDM_Odm->RSSI_Min) || (dtc_steps >= 6)) -+ break; -+ else -+ dtc_steps++; -+ } -+ } -+#if 0 -+ else if (DTC_DWN_BASE > pDM_Odm->RSSI_Min) -+ { -+ /* needs to increase the CTS TX power */ -+ sign = 0; -+ dtc_steps = 1; -+ for (i=0;iRSSI_Min) || (dtc_steps>=10)) -+ break; -+ else -+ dtc_steps++; -+ } -+ } -+#endif -+ else -+ { -+ sign = 0; -+ dtc_steps = 0; -+ } -+ -+ resp_txagc = dtc_steps | (sign << 4); -+ resp_txagc = resp_txagc | (resp_txagc << 5); -+ ODM_Write1Byte(pDM_Odm, 0x06d9, resp_txagc); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PWR_TRAIN, ODM_DBG_LOUD, ("%s RSSI_Min:%u, set RESP_TXAGC to %s %u\n", -+ __func__, pDM_Odm->RSSI_Min, sign ? "minus" : "plus", dtc_steps)); -+#endif /* CONFIG_RESP_TXAGC_ADJUST */ -+} -+ -+#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ -+ -+VOID -+odm_UpdatePowerTrainingState( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm , PHYDM_FALSEALMCNT); -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ u4Byte score = 0; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_PWR_TRAIN)) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState()============>\n")); -+ pDM_Odm->bChangeState = FALSE; -+ -+ // Debug command -+ if(pDM_Odm->ForcePowerTrainingState) -+ { -+ if(pDM_Odm->ForcePowerTrainingState == 1 && !pDM_Odm->bDisablePowerTraining) -+ { -+ pDM_Odm->bChangeState = TRUE; -+ pDM_Odm->bDisablePowerTraining = TRUE; -+ } -+ else if(pDM_Odm->ForcePowerTrainingState == 2 && pDM_Odm->bDisablePowerTraining) -+ { -+ pDM_Odm->bChangeState = TRUE; -+ pDM_Odm->bDisablePowerTraining = FALSE; -+ } -+ -+ pDM_Odm->PT_score = 0; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): ForcePowerTrainingState = %d\n", -+ pDM_Odm->ForcePowerTrainingState)); -+ return; -+ } -+ -+ if(!pDM_Odm->bLinked) -+ return; -+ -+ // First connect -+ if((pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == FALSE)) -+ { -+ pDM_Odm->PT_score = 0; -+ pDM_Odm->bChangeState = TRUE; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): First Connect\n")); -+ return; -+ } -+ -+ // Compute score -+ if(pDM_Odm->NHM_cnt_0 >= 215) -+ score = 2; -+ else if(pDM_Odm->NHM_cnt_0 >= 190) -+ score = 1; // unknow state -+ else -+ { -+ u4Byte RX_Pkt_Cnt; -+ -+ RX_Pkt_Cnt = (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM) + (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK); -+ -+ if((FalseAlmCnt->Cnt_CCA_all > 31 && RX_Pkt_Cnt > 31) && (FalseAlmCnt->Cnt_CCA_all >= RX_Pkt_Cnt)) -+ { -+ if((RX_Pkt_Cnt + (RX_Pkt_Cnt >> 1)) <= FalseAlmCnt->Cnt_CCA_all) -+ score = 0; -+ else if((RX_Pkt_Cnt + (RX_Pkt_Cnt >> 2)) <= FalseAlmCnt->Cnt_CCA_all) -+ score = 1; -+ else -+ score = 2; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): RX_Pkt_Cnt = %d, Cnt_CCA_all = %d\n", -+ RX_Pkt_Cnt, FalseAlmCnt->Cnt_CCA_all)); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): NumQryPhyStatusOFDM = %d, NumQryPhyStatusCCK = %d\n", -+ (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM), (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): NHM_cnt_0 = %d, score = %d\n", -+ pDM_Odm->NHM_cnt_0, score)); -+ -+ // smoothing -+ pDM_Odm->PT_score = (score << 4) + (pDM_Odm->PT_score>>1) + (pDM_Odm->PT_score>>2); -+ score = (pDM_Odm->PT_score + 32) >> 6; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): PT_score = %d, score after smoothing = %d\n", -+ pDM_Odm->PT_score, score)); -+ -+ // Mode decision -+ if(score == 2) -+ { -+ if(pDM_Odm->bDisablePowerTraining) -+ { -+ pDM_Odm->bChangeState = TRUE; -+ pDM_Odm->bDisablePowerTraining = FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Change state\n")); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Enable Power Training\n")); -+ } -+ else if(score == 0) -+ { -+ if(!pDM_Odm->bDisablePowerTraining) -+ { -+ pDM_Odm->bChangeState = TRUE; -+ pDM_Odm->bDisablePowerTraining = TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Change state\n")); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Disable Power Training\n")); -+ } -+ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; -+#endif -+} -+ -+ -+ -+/*===========================================================*/ -+/* The following is for compile only*/ -+/*===========================================================*/ -+/*#define TARGET_CHNL_NUM_2G_5G 59*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+u1Byte GetRightChnlPlaceforIQK(u1Byte chnl) -+{ -+ u1Byte channel_all[TARGET_CHNL_NUM_2G_5G] = {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, 60, 62, 64, 100, -+ 102, 104, 106, 108, 110, 112, 114, 116, 118, 120, 122, 124, 126, 128, 130, 132, 134, 136, 138, 140, 149, 151, 153, 155, 157, 159, 161, 163, 165}; -+ u1Byte place = chnl; -+ -+ -+ if (chnl > 14) { -+ for (place = 14; place < sizeof(channel_all); place++) { -+ if (channel_all[place] == chnl) -+ return place-13; -+ } -+ } -+ -+ return 0; -+} -+ -+#endif -+/*===========================================================*/ -+ -+VOID -+phydm_NoisyDetection( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte Total_FA_Cnt, Total_CCA_Cnt; -+ u4Byte Score = 0, i, Score_Smooth; -+ -+ Total_CCA_Cnt = pDM_Odm->FalseAlmCnt.Cnt_CCA_all; -+ Total_FA_Cnt = pDM_Odm->FalseAlmCnt.Cnt_all; -+ -+/* -+ if( Total_FA_Cnt*16>=Total_CCA_Cnt*14 ) // 87.5 -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*12 ) // 75 -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*10 ) // 56.25 -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*8 ) // 50 -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*7 ) // 43.75 -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*6 ) // 37.5 -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*5 ) // 31.25% -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*4 ) // 25% -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*3 ) // 18.75% -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*2 ) // 12.5% -+ -+ else if( Total_FA_Cnt*16>=Total_CCA_Cnt*1 ) // 6.25% -+*/ -+ for(i=0;i<=16;i++) -+ { -+ if( Total_FA_Cnt*16>=Total_CCA_Cnt*(16-i) ) -+ { -+ Score = 16-i; -+ break; -+ } -+ } -+ -+ // NoisyDecision_Smooth = NoisyDecision_Smooth>>1 + (Score<<3)>>1; -+ pDM_Odm->NoisyDecision_Smooth = (pDM_Odm->NoisyDecision_Smooth>>1) + (Score<<2); -+ -+ // Round the NoisyDecision_Smooth: +"3" comes from (2^3)/2-1 -+ Score_Smooth = (Total_CCA_Cnt>=300)?((pDM_Odm->NoisyDecision_Smooth+3)>>3):0; -+ -+ pDM_Odm->NoisyDecision = (Score_Smooth>=3)?1:0; -+/* -+ switch(Score_Smooth) -+ { -+ case 0: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=0%%\n")); -+ break; -+ case 1: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=6.25%%\n")); -+ break; -+ case 2: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=12.5%%\n")); -+ break; -+ case 3: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=18.75%%\n")); -+ break; -+ case 4: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=25%%\n")); -+ break; -+ case 5: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=31.25%%\n")); -+ break; -+ case 6: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=37.5%%\n")); -+ break; -+ case 7: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=43.75%%\n")); -+ break; -+ case 8: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=50%%\n")); -+ break; -+ case 9: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=56.25%%\n")); -+ break; -+ case 10: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=62.5%%\n")); -+ break; -+ case 11: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=68.75%%\n")); -+ break; -+ case 12: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=75%%\n")); -+ break; -+ case 13: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=81.25%%\n")); -+ break; -+ case 14: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=87.5%%\n")); -+ break; -+ case 15: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=93.75%%\n")); -+ break; -+ case 16: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=100%%\n")); -+ break; -+ default: -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, -+ ("[NoisyDetection] Unknown Value!! Need Check!!\n")); -+ } -+*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, -+ ("[NoisyDetection] Total_CCA_Cnt=%d, Total_FA_Cnt=%d, NoisyDecision_Smooth=%d, Score=%d, Score_Smooth=%d, pDM_Odm->NoisyDecision=%d\n", -+ Total_CCA_Cnt, Total_FA_Cnt, pDM_Odm->NoisyDecision_Smooth, Score, Score_Smooth, pDM_Odm->NoisyDecision)); -+ -+} -+ -+VOID -+phydm_set_ext_switch( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ u4Byte ext_ant_switch = dm_value[0]; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8821|ODM_RTL8881A)) { -+ -+ /*Output Pin Settings*/ -+ ODM_SetMACReg(pDM_Odm, 0x4C, BIT23, 0); /*select DPDT_P and DPDT_N as output pin*/ -+ ODM_SetMACReg(pDM_Odm, 0x4C, BIT24, 1); /*by WLAN control*/ -+ -+ ODM_SetBBReg(pDM_Odm, 0xCB4, 0xF, 7); /*DPDT_P = 1b'0*/ -+ ODM_SetBBReg(pDM_Odm, 0xCB4, 0xF0, 7); /*DPDT_N = 1b'0*/ -+ -+ if (ext_ant_switch == MAIN_ANT) { -+ ODM_SetBBReg(pDM_Odm, 0xCB4, (BIT29|BIT28), 1); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("***8821A set Ant switch = 2b'01 (Main)\n")); -+ } else if (ext_ant_switch == AUX_ANT){ -+ ODM_SetBBReg(pDM_Odm, 0xCB4, BIT29|BIT28, 2); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("***8821A set Ant switch = 2b'10 (Aux)\n")); -+ } -+ } -+} -+ -+VOID -+phydm_csi_mask_enable( -+ IN PVOID pDM_VOID, -+ IN u4Byte enable -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte reg_value = 0; -+ -+ reg_value = (enable == CSI_MASK_ENABLE) ? 1 : 0; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ -+ ODM_SetBBReg(pDM_Odm, 0xD2C, BIT28, reg_value); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable CSI Mask: Reg 0xD2C[28] = ((0x%x))\n", reg_value)); -+ -+ } else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ -+ ODM_SetBBReg(pDM_Odm, 0x874, BIT0, reg_value); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable CSI Mask: Reg 0x874[0] = ((0x%x))\n", reg_value)); -+ } -+ -+} -+ -+VOID -+phydm_clean_all_csi_mask( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ -+ ODM_SetBBReg(pDM_Odm, 0xD40, bMaskDWord, 0); -+ ODM_SetBBReg(pDM_Odm, 0xD44, bMaskDWord, 0); -+ ODM_SetBBReg(pDM_Odm, 0xD48, bMaskDWord, 0); -+ ODM_SetBBReg(pDM_Odm, 0xD4c, bMaskDWord, 0); -+ -+ } else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ -+ ODM_SetBBReg(pDM_Odm, 0x880, bMaskDWord, 0); -+ ODM_SetBBReg(pDM_Odm, 0x884, bMaskDWord, 0); -+ ODM_SetBBReg(pDM_Odm, 0x888, bMaskDWord, 0); -+ ODM_SetBBReg(pDM_Odm, 0x88c, bMaskDWord, 0); -+ ODM_SetBBReg(pDM_Odm, 0x890, bMaskDWord, 0); -+ ODM_SetBBReg(pDM_Odm, 0x894, bMaskDWord, 0); -+ ODM_SetBBReg(pDM_Odm, 0x898, bMaskDWord, 0); -+ ODM_SetBBReg(pDM_Odm, 0x89c, bMaskDWord, 0); -+ } -+} -+ -+VOID -+phydm_set_csi_mask_reg( -+ IN PVOID pDM_VOID, -+ IN u4Byte tone_idx_tmp, -+ IN u1Byte tone_direction -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte byte_offset, bit_offset; -+ u4Byte target_reg; -+ u1Byte reg_tmp_value; -+ u4Byte tone_num = 64; -+ u4Byte tone_num_shift = 0; -+ u4Byte csi_mask_reg_p = 0, csi_mask_reg_n = 0; -+ -+ /* calculate real tone idx*/ -+ if ((tone_idx_tmp % 10) >= 5) -+ tone_idx_tmp += 10; -+ -+ tone_idx_tmp = (tone_idx_tmp/10); -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ -+ tone_num = 64; -+ csi_mask_reg_p = 0xD40; -+ csi_mask_reg_n = 0xD48; -+ -+ } else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ -+ tone_num = 128; -+ csi_mask_reg_p = 0x880; -+ csi_mask_reg_n = 0x890; -+ } -+ -+ if (tone_direction == FREQ_POSITIVE) { -+ -+ if (tone_idx_tmp >= (tone_num - 1)) -+ tone_idx_tmp = (tone_num - 1); -+ -+ byte_offset = (u1Byte)(tone_idx_tmp >> 3); -+ bit_offset = (u1Byte)(tone_idx_tmp & 0x7); -+ target_reg = csi_mask_reg_p + byte_offset; -+ -+ } else { -+ tone_num_shift = tone_num; -+ -+ if (tone_idx_tmp >= tone_num) -+ tone_idx_tmp = tone_num; -+ -+ tone_idx_tmp = tone_num - tone_idx_tmp; -+ -+ byte_offset = (u1Byte)(tone_idx_tmp >> 3); -+ bit_offset = (u1Byte)(tone_idx_tmp & 0x7); -+ target_reg = csi_mask_reg_n + byte_offset; -+ } -+ -+ reg_tmp_value = ODM_Read1Byte(pDM_Odm, target_reg); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Pre Mask tone idx[%d]: Reg0x%x = ((0x%x))\n", (tone_idx_tmp + tone_num_shift), target_reg, reg_tmp_value)); -+ reg_tmp_value |= BIT(bit_offset); -+ ODM_Write1Byte(pDM_Odm, target_reg, reg_tmp_value); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("New Mask tone idx[%d]: Reg0x%x = ((0x%x))\n", (tone_idx_tmp + tone_num_shift), target_reg, reg_tmp_value)); -+} -+ -+VOID -+phydm_set_nbi_reg( -+ IN PVOID pDM_VOID, -+ IN u4Byte tone_idx_tmp, -+ IN u4Byte bw -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte nbi_table_128[NBI_TABLE_SIZE_128] = {25, 55, 85, 115, 135, 155, 185, 205, 225, 245, /*1~10*/ /*tone_idx X 10*/ -+ 265, 285, 305, 335, 355, 375, 395, 415, 435, 455, /*11~20*/ -+ 485, 505, 525, 555, 585, 615, 635}; /*21~27*/ -+ -+ u4Byte nbi_table_256[NBI_TABLE_SIZE_256] = { 25, 55, 85, 115, 135, 155, 175, 195, 225, 245, /*1~10*/ -+ 265, 285, 305, 325, 345, 365, 385, 405, 425, 445, /*11~20*/ -+ 465, 485, 505, 525, 545, 565, 585, 605, 625, 645, /*21~30*/ -+ 665, 695, 715, 735, 755, 775, 795, 815, 835, 855, /*31~40*/ -+ 875, 895, 915, 935, 955, 975, 995, 1015, 1035, 1055, /*41~50*/ -+ 1085, 1105, 1125, 1145, 1175, 1195, 1225, 1255, 1275}; /*51~59*/ -+ -+ u4Byte reg_idx = 0; -+ u4Byte i; -+ u1Byte nbi_table_idx = FFT_128_TYPE; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ -+ nbi_table_idx = FFT_128_TYPE; -+ } else if (pDM_Odm->SupportICType & ODM_IC_11AC_1_SERIES) { -+ -+ nbi_table_idx = FFT_256_TYPE; -+ } else if (pDM_Odm->SupportICType & ODM_IC_11AC_2_SERIES) { -+ -+ if (bw == 80) -+ nbi_table_idx = FFT_256_TYPE; -+ else /*20M, 40M*/ -+ nbi_table_idx = FFT_128_TYPE; -+ } -+ -+ if (nbi_table_idx == FFT_128_TYPE) { -+ -+ for (i = 0; i < NBI_TABLE_SIZE_128; i++) { -+ if (tone_idx_tmp < nbi_table_128[i]) { -+ reg_idx = i+1; -+ break; -+ } -+ } -+ -+ } else if (nbi_table_idx == FFT_256_TYPE) { -+ -+ for (i = 0; i < NBI_TABLE_SIZE_256; i++) { -+ if (tone_idx_tmp < nbi_table_256[i]) { -+ reg_idx = i+1; -+ break; -+ } -+ } -+ } -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ ODM_SetBBReg(pDM_Odm, 0xc40, 0x1f000000, reg_idx); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Set tone idx: Reg0xC40[28:24] = ((0x%x))\n", reg_idx)); -+ /**/ -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x87c, 0xfc000, reg_idx); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Set tone idx: Reg0x87C[19:14] = ((0x%x))\n", reg_idx)); -+ /**/ -+ } -+} -+ -+ -+VOID -+phydm_nbi_enable( -+ IN PVOID pDM_VOID, -+ IN u4Byte enable -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte reg_value = 0; -+ -+ reg_value = (enable == NBI_ENABLE) ? 1 : 0; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ -+ ODM_SetBBReg(pDM_Odm, 0xc40, BIT9, reg_value); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable NBI Reg0xC40[9] = ((0x%x))\n", reg_value)); -+ -+ } else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ -+ ODM_SetBBReg(pDM_Odm, 0x87c, BIT13, reg_value); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable NBI Reg0x87C[13] = ((0x%x))\n", reg_value)); -+ } -+} -+ -+u1Byte -+phydm_calculate_fc( -+ IN PVOID pDM_VOID, -+ IN u4Byte channel, -+ IN u4Byte bw, -+ IN u4Byte Second_ch, -+ IN OUT u4Byte *fc_in -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte fc = *fc_in; -+ u4Byte start_ch_per_40m[NUM_START_CH_40M] = {36, 44, 52, 60, 100, 108, 116, 124, 132, 140, 149, 157, 165, 173}; -+ u4Byte start_ch_per_80m[NUM_START_CH_80M] = {36, 52, 100, 116, 132, 149, 165}; -+ pu4Byte p_start_ch = &(start_ch_per_40m[0]); -+ u4Byte num_start_channel = NUM_START_CH_40M; -+ u4Byte channel_offset = 0; -+ u4Byte i; -+ -+ /*2.4G*/ -+ if (channel <= 14 && channel > 0) { -+ -+ if (bw == 80) { -+ return SET_ERROR; -+ } -+ -+ fc = 2412 + (channel - 1)*5; -+ -+ if (bw == 40 && (Second_ch == PHYDM_ABOVE)) { -+ -+ if (channel >= 10) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)), Scnd_CH = ((%d)) Error Setting\n", channel, Second_ch)); -+ return SET_ERROR; -+ } -+ fc += 10; -+ } else if (bw == 40 && (Second_ch == PHYDM_BELOW)) { -+ -+ if (channel <= 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)), Scnd_CH = ((%d)) Error Setting\n", channel, Second_ch)); -+ return SET_ERROR; -+ } -+ fc -= 10; -+ } -+ } -+ /*5G*/ -+ else if (channel >= 36 && channel <= 177) { -+ -+ if (bw != 20) { -+ -+ if (bw == 40) { -+ num_start_channel = NUM_START_CH_40M; -+ p_start_ch = &(start_ch_per_40m[0]); -+ channel_offset = CH_OFFSET_40M; -+ } else if (bw == 80) { -+ num_start_channel = NUM_START_CH_80M; -+ p_start_ch = &(start_ch_per_80m[0]); -+ channel_offset = CH_OFFSET_80M; -+ } -+ -+ for (i = 0; i < num_start_channel; i++) { -+ -+ if (channel < p_start_ch[i+1]) { -+ channel = p_start_ch[i] + channel_offset; -+ break; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Mod_CH = ((%d))\n", channel)); -+ } -+ -+ fc = 5180 + (channel-36)*5; -+ -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)) Error Setting\n", channel)); -+ return SET_ERROR; -+ } -+ -+ *fc_in = fc; -+ -+ return SET_SUCCESS; -+} -+ -+ -+u1Byte -+phydm_calculate_intf_distance( -+ IN PVOID pDM_VOID, -+ IN u4Byte bw, -+ IN u4Byte fc, -+ IN u4Byte f_interference, -+ IN OUT u4Byte *p_tone_idx_tmp_in -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte bw_up, bw_low; -+ u4Byte int_distance; -+ u4Byte tone_idx_tmp; -+ u1Byte set_result = SET_NO_NEED; -+ -+ bw_up = fc + bw/2; -+ bw_low = fc - bw/2; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("[f_l, fc, fh] = [ %d, %d, %d ], f_int = ((%d))\n", bw_low, fc, bw_up, f_interference)); -+ -+ if ((f_interference >= bw_low) && (f_interference <= bw_up)) { -+ -+ int_distance = (fc >= f_interference) ? (fc - f_interference) : (f_interference - fc); -+ tone_idx_tmp = (int_distance<<5); /* =10*(int_distance /0.3125) */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("int_distance = ((%d MHz)) Mhz, tone_idx_tmp = ((%d.%d))\n", int_distance, (tone_idx_tmp/10), (tone_idx_tmp%10))); -+ *p_tone_idx_tmp_in = tone_idx_tmp; -+ set_result = SET_SUCCESS; -+ } -+ -+ return set_result; -+ -+} -+ -+ -+u1Byte -+phydm_csi_mask_setting( -+ IN PVOID pDM_VOID, -+ IN u4Byte enable, -+ IN u4Byte channel, -+ IN u4Byte bw, -+ IN u4Byte f_interference, -+ IN u4Byte Second_ch -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte fc; -+ u4Byte int_distance; -+ u1Byte tone_direction; -+ u4Byte tone_idx_tmp; -+ u1Byte set_result = SET_SUCCESS; -+ -+ if (enable == CSI_MASK_DISABLE) { -+ set_result = SET_SUCCESS; -+ phydm_clean_all_csi_mask(pDM_Odm); -+ -+ } else { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("[Set CSI MASK_] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", -+ channel, bw, f_interference, (((bw == 20) || (channel > 14)) ? "Don't care" : (Second_ch == PHYDM_ABOVE) ? "H" : "L"))); -+ -+ /*calculate fc*/ -+ if (phydm_calculate_fc(pDM_Odm, channel, bw, Second_ch, &fc) == SET_ERROR) -+ set_result = SET_ERROR; -+ -+ else { -+ /*calculate interference distance*/ -+ if (phydm_calculate_intf_distance(pDM_Odm, bw, fc, f_interference, &tone_idx_tmp) == SET_SUCCESS) { -+ -+ tone_direction = (f_interference >= fc) ? FREQ_POSITIVE : FREQ_NEGATIVE; -+ phydm_set_csi_mask_reg(pDM_Odm, tone_idx_tmp, tone_direction); -+ set_result = SET_SUCCESS; -+ } else -+ set_result = SET_NO_NEED; -+ } -+ } -+ -+ if (set_result == SET_SUCCESS) -+ phydm_csi_mask_enable(pDM_Odm, enable); -+ else -+ phydm_csi_mask_enable(pDM_Odm, CSI_MASK_DISABLE); -+ -+ return set_result; -+} -+ -+u1Byte -+phydm_nbi_setting( -+ IN PVOID pDM_VOID, -+ IN u4Byte enable, -+ IN u4Byte channel, -+ IN u4Byte bw, -+ IN u4Byte f_interference, -+ IN u4Byte Second_ch -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte fc; -+ u4Byte int_distance; -+ u4Byte tone_idx_tmp; -+ u1Byte set_result = SET_SUCCESS; -+ u4Byte bw_max = 40; -+ -+ if (enable == NBI_DISABLE) -+ set_result = SET_SUCCESS; -+ -+ else { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("[Set NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", -+ channel, bw, f_interference, (((Second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "Don't care" : (Second_ch == PHYDM_ABOVE) ? "H" : "L"))); -+ -+ /*calculate fc*/ -+ if (phydm_calculate_fc(pDM_Odm, channel, bw, Second_ch, &fc) == SET_ERROR) -+ set_result = SET_ERROR; -+ -+ else { -+ /*calculate interference distance*/ -+ if (phydm_calculate_intf_distance(pDM_Odm, bw, fc, f_interference, &tone_idx_tmp) == SET_SUCCESS) { -+ -+ phydm_set_nbi_reg(pDM_Odm, tone_idx_tmp, bw); -+ set_result = SET_SUCCESS; -+ } else -+ set_result = SET_NO_NEED; -+ } -+ } -+ -+ if (set_result == SET_SUCCESS) -+ phydm_nbi_enable(pDM_Odm, enable); -+ else -+ phydm_nbi_enable(pDM_Odm, NBI_DISABLE); -+ -+ return set_result; -+} -+ -+VOID -+phydm_api_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte function_map, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ u4Byte channel = dm_value[1]; -+ u4Byte bw = dm_value[2]; -+ u4Byte f_interference = dm_value[3]; -+ u4Byte Second_ch = dm_value[4]; -+ u1Byte set_result = 0; -+ -+ /*PHYDM_API_NBI*/ -+ /*-------------------------------------------------------------------------------------------------------------------------------*/ -+ if (function_map == PHYDM_API_NBI) { -+ -+ if (dm_value[0] == 100) { -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "[HELP-NBI] EN(on=1, off=2) CH BW(20/40/80) f_intf(Mhz) Scnd_CH(L=1, H=2)\n")); -+ return; -+ -+ } else if (dm_value[0] == NBI_ENABLE) { -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "[Enable NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", -+ channel, bw, f_interference, ((Second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "Don't care" : ((Second_ch == PHYDM_ABOVE) ? "H" : "L"))); -+ set_result = phydm_nbi_setting(pDM_Odm, NBI_ENABLE, channel, bw, f_interference, Second_ch); -+ -+ } else if (dm_value[0] == NBI_DISABLE) { -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "[Disable NBI]\n")); -+ set_result = phydm_nbi_setting(pDM_Odm, NBI_DISABLE, channel, bw, f_interference, Second_ch); -+ -+ } else { -+ -+ set_result = SET_ERROR; -+ } -+ PHYDM_SNPRINTF((output+used, out_len-used, "[NBI set result: %s]\n", (set_result == SET_SUCCESS) ? "Success" : ((set_result == SET_NO_NEED) ? "No need" : "Error"))); -+ -+ } -+ -+ /*PHYDM_CSI_MASK*/ -+ /*-------------------------------------------------------------------------------------------------------------------------------*/ -+ else if (function_map == PHYDM_API_CSI_MASK) { -+ -+ if (dm_value[0] == 100) { -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "[HELP-CSI MASK] EN(on=1, off=2) CH BW(20/40/80) f_intf(Mhz) Scnd_CH(L=1, H=2)\n")); -+ return; -+ -+ } else if (dm_value[0] == CSI_MASK_ENABLE) { -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "[Enable CSI MASK] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", -+ channel, bw, f_interference, (channel > 14)?"Don't care":(((Second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "H" : "L"))); -+ set_result = phydm_csi_mask_setting(pDM_Odm, CSI_MASK_ENABLE, channel, bw, f_interference, Second_ch); -+ -+ } else if (dm_value[0] == CSI_MASK_DISABLE) { -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "[Disable CSI MASK]\n")); -+ set_result = phydm_csi_mask_setting(pDM_Odm, CSI_MASK_DISABLE, channel, bw, f_interference, Second_ch); -+ -+ } else { -+ -+ set_result = SET_ERROR; -+ } -+ PHYDM_SNPRINTF((output+used, out_len-used, "[CSI MASK set result: %s]\n", (set_result == SET_SUCCESS) ? "Success" : ((set_result == SET_NO_NEED) ? "No need" : "Error"))); -+ } -+} -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_ccx.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_ccx.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_ccx.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_ccx.c 2018-02-11 21:44:27.155146208 +0200 -@@ -0,0 +1,400 @@ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+/*Set NHM period, threshold, disable ignore cca or not, disable ignore txon or not*/ -+VOID -+phydm_NHMsetting( -+ IN PVOID pDM_VOID, -+ u1Byte NHMsetting -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ -+ if (NHMsetting == SET_NHM_SETTING){ -+ -+ /*Set inexclude_cca, inexclude_txon*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT9, CCX_INFO->NHM_inexclude_cca); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT10, CCX_INFO->NHM_inexclude_txon); -+ -+ /*Set NHM period*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, bMaskHWord, CCX_INFO->NHM_period); -+ -+ /*Set NHM threshold*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte0, CCX_INFO->NHM_th[0]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte1, CCX_INFO->NHM_th[1]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte2, CCX_INFO->NHM_th[2]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte3, CCX_INFO->NHM_th[3]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte0, CCX_INFO->NHM_th[4]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte1, CCX_INFO->NHM_th[5]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte2, CCX_INFO->NHM_th[6]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte3, CCX_INFO->NHM_th[7]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0, CCX_INFO->NHM_th[8]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte2, CCX_INFO->NHM_th[9]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte3, CCX_INFO->NHM_th[10]); -+ -+ /*CCX EN*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT8, CCX_EN); -+ -+ } -+ else if (NHMsetting == STORE_NHM_SETTING) { -+ -+ /*Store pervious disable_ignore_cca, disable_ignore_txon*/ -+ CCX_INFO->NHM_inexclude_cca_restore = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT9); -+ CCX_INFO->NHM_inexclude_txon_restore = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT10); -+ -+ /*Store pervious NHM period*/ -+ CCX_INFO->NHM_period_restore = (u2Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, bMaskHWord); -+ -+ /*Store NHM threshold*/ -+ CCX_INFO->NHM_th_restore[0] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte0); -+ CCX_INFO->NHM_th_restore[1] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte1); -+ CCX_INFO->NHM_th_restore[2] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte2); -+ CCX_INFO->NHM_th_restore[3] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte3); -+ CCX_INFO->NHM_th_restore[4] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte0); -+ CCX_INFO->NHM_th_restore[5] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte1); -+ CCX_INFO->NHM_th_restore[6] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte2); -+ CCX_INFO->NHM_th_restore[7] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte3); -+ CCX_INFO->NHM_th_restore[8] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0); -+ CCX_INFO->NHM_th_restore[9] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte2); -+ CCX_INFO->NHM_th_restore[10] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte3); -+ } -+ else if (NHMsetting == RESTORE_NHM_SETTING) { -+ -+ /*Set disable_ignore_cca, disable_ignore_txon*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT9, CCX_INFO->NHM_inexclude_cca_restore); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT10, CCX_INFO->NHM_inexclude_txon_restore); -+ -+ /*Set NHM period*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, bMaskHWord, CCX_INFO->NHM_period); -+ -+ /*Set NHM threshold*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte0, CCX_INFO->NHM_th_restore[0]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte1, CCX_INFO->NHM_th_restore[1]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte2, CCX_INFO->NHM_th_restore[2]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte3, CCX_INFO->NHM_th_restore[3]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte0, CCX_INFO->NHM_th_restore[4]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte1, CCX_INFO->NHM_th_restore[5]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte2, CCX_INFO->NHM_th_restore[6]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte3, CCX_INFO->NHM_th_restore[7]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0, CCX_INFO->NHM_th_restore[8]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte2, CCX_INFO->NHM_th_restore[9]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte3, CCX_INFO->NHM_th_restore[10]); -+ } -+ else -+ return; -+ } -+ -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ -+ if (NHMsetting == SET_NHM_SETTING){ -+ -+ /*Set disable_ignore_cca, disable_ignore_txon*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT9, CCX_INFO->NHM_inexclude_cca); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10, CCX_INFO->NHM_inexclude_txon); -+ -+ /*Set NHM period*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11N, bMaskHWord, CCX_INFO->NHM_period); -+ -+ /*Set NHM threshold*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte0, CCX_INFO->NHM_th[0]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte1, CCX_INFO->NHM_th[1]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte2, CCX_INFO->NHM_th[2]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte3, CCX_INFO->NHM_th[3]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte0, CCX_INFO->NHM_th[4]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte1, CCX_INFO->NHM_th[5]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte2, CCX_INFO->NHM_th[6]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte3, CCX_INFO->NHM_th[7]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11N, bMaskByte0, CCX_INFO->NHM_th[8]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte2, CCX_INFO->NHM_th[9]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte3, CCX_INFO->NHM_th[10]); -+ -+ /*CCX EN*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT8, CCX_EN); -+ } -+ else if (NHMsetting == STORE_NHM_SETTING) { -+ -+ /*Store pervious disable_ignore_cca, disable_ignore_txon*/ -+ CCX_INFO->NHM_inexclude_cca_restore = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT9); -+ CCX_INFO->NHM_inexclude_txon_restore= (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10); -+ -+ /*Store pervious NHM period*/ -+ CCX_INFO->NHM_period_restore= (u2Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11N, bMaskHWord); -+ -+ /*Store NHM threshold*/ -+ CCX_INFO->NHM_th_restore[0] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte0); -+ CCX_INFO->NHM_th_restore[1] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte1); -+ CCX_INFO->NHM_th_restore[2] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte2); -+ CCX_INFO->NHM_th_restore[3] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte3); -+ CCX_INFO->NHM_th_restore[4] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte0); -+ CCX_INFO->NHM_th_restore[5] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte1); -+ CCX_INFO->NHM_th_restore[6] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte2); -+ CCX_INFO->NHM_th_restore[7] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte3); -+ CCX_INFO->NHM_th_restore[8] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11N, bMaskByte0); -+ CCX_INFO->NHM_th_restore[9] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte2); -+ CCX_INFO->NHM_th_restore[10] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte3); -+ -+ } -+ else if (NHMsetting == RESTORE_NHM_SETTING) { -+ -+ /*Set disable_ignore_cca, disable_ignore_txon*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT9, CCX_INFO->NHM_inexclude_cca_restore); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10, CCX_INFO->NHM_inexclude_txon_restore); -+ -+ /*Set NHM period*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11N, bMaskHWord, CCX_INFO->NHM_period_restore); -+ -+ /*Set NHM threshold*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte0, CCX_INFO->NHM_th_restore[0]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte1, CCX_INFO->NHM_th_restore[1]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte2, CCX_INFO->NHM_th_restore[2]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte3, CCX_INFO->NHM_th_restore[3]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte0, CCX_INFO->NHM_th_restore[4]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte1, CCX_INFO->NHM_th_restore[5]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte2, CCX_INFO->NHM_th_restore[6]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte3, CCX_INFO->NHM_th_restore[7]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11N, bMaskByte0, CCX_INFO->NHM_th_restore[8]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte2, CCX_INFO->NHM_th_restore[9]); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte3, CCX_INFO->NHM_th_restore[10]); -+ } -+ else -+ return; -+ -+ } -+} -+ -+VOID -+phydm_NHMtrigger( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ -+ /*Trigger NHM*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 1); -+ } -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ -+ /*Trigger NHM*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 1); -+ } -+} -+ -+VOID -+phydm_getNHMresult( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32; -+ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ -+ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT_11AC); -+ CCX_INFO->NHM_result[0] = (u1Byte)(value32 & bMaskByte0); -+ CCX_INFO->NHM_result[1] = (u1Byte)((value32 & bMaskByte1) >> 8); -+ CCX_INFO->NHM_result[2] = (u1Byte)((value32 & bMaskByte2) >> 16); -+ CCX_INFO->NHM_result[3] = (u1Byte)((value32 & bMaskByte3) >> 24); -+ -+ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11AC); -+ CCX_INFO->NHM_result[4] = (u1Byte)(value32 & bMaskByte0); -+ CCX_INFO->NHM_result[5] = (u1Byte)((value32 & bMaskByte1) >> 8); -+ CCX_INFO->NHM_result[6] = (u1Byte)((value32 & bMaskByte2) >> 16); -+ CCX_INFO->NHM_result[7] = (u1Byte)((value32 & bMaskByte3) >> 24); -+ -+ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT11_TO_CNT8_11AC); -+ CCX_INFO->NHM_result[8] = (u1Byte)(value32 & bMaskByte0); -+ CCX_INFO->NHM_result[9] = (u1Byte)((value32 & bMaskByte1) >> 8); -+ CCX_INFO->NHM_result[10] = (u1Byte)((value32 & bMaskByte2) >> 16); -+ CCX_INFO->NHM_result[11] = (u1Byte)((value32 & bMaskByte3) >> 24); -+ -+ /*Get NHM duration*/ -+ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_DUR_READY_11AC); -+ CCX_INFO->NHM_duration = (u2Byte)(value32 & bMaskLWord); -+ -+ } -+ -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ -+ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT_11N); -+ CCX_INFO->NHM_result[0] = (u1Byte)(value32 & bMaskByte0); -+ CCX_INFO->NHM_result[1] = (u1Byte)((value32 & bMaskByte1) >> 8); -+ CCX_INFO->NHM_result[2] = (u1Byte)((value32 & bMaskByte2) >> 16); -+ CCX_INFO->NHM_result[3] = (u1Byte)((value32 & bMaskByte3) >> 24); -+ -+ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11N); -+ CCX_INFO->NHM_result[4] = (u1Byte)(value32 & bMaskByte0); -+ CCX_INFO->NHM_result[5] = (u1Byte)((value32 & bMaskByte1) >> 8); -+ CCX_INFO->NHM_result[6] = (u1Byte)((value32 & bMaskByte2) >> 16); -+ CCX_INFO->NHM_result[7] = (u1Byte)((value32 & bMaskByte3) >> 24); -+ -+ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT9_TO_CNT8_11N); -+ CCX_INFO->NHM_result[8] = (u1Byte)((value32 & bMaskByte2) >> 16); -+ CCX_INFO->NHM_result[9] = (u1Byte)((value32 & bMaskByte3) >> 24); -+ -+ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT10_TO_CNT11_11N); -+ CCX_INFO->NHM_result[10] = (u1Byte)((value32 & bMaskByte2) >> 16); -+ CCX_INFO->NHM_result[11] = (u1Byte)((value32 & bMaskByte3) >> 24); -+ -+ /*Get NHM duration*/ -+ value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT10_TO_CNT11_11N); -+ CCX_INFO->NHM_duration = (u2Byte)(value32 & bMaskLWord); -+ -+ } -+ -+} -+ -+BOOLEAN -+phydm_checkNHMready( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32 = 0; -+ u1Byte i; -+ BOOLEAN ret = FALSE; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11AC, bMaskDWord); -+ -+ for (i = 0; i < 200; i ++) { -+ -+ ODM_delay_ms(1); -+ if (ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_DUR_READY_11AC, BIT17)) { -+ ret = 1; -+ break; -+ } -+ } -+ } -+ -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_READY_11N, bMaskDWord); -+ -+ for (i = 0; i < 200; i ++) { -+ -+ ODM_delay_ms(1); -+ if (ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_DUR_READY_11AC, BIT17) ) { -+ ret = 1; -+ break; -+ } -+ } -+ } -+ return ret; -+} -+ -+VOID -+phydm_storeNHMsetting( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ -+ -+ } -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ -+ -+ -+ } -+} -+ -+VOID -+phydm_CLMsetting( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; -+ -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, bMaskLWord, CCX_INFO->CLM_period); /*4us sample 1 time*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11AC, BIT8, 0x1); /*Enable CCX for CLM*/ -+ -+ } else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11N, bMaskLWord, CCX_INFO->CLM_period); /*4us sample 1 time*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11N, BIT8, 0x1); /*Enable CCX for CLM*/ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCX, ODM_DBG_LOUD, ("[%s] : CLM period = %dus\n", __func__, CCX_INFO->CLM_period*4)); -+ -+} -+ -+VOID -+phydm_CLMtrigger( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11AC, BIT0, 0x0); /*Trigger CLM*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11AC, BIT0, 0x1); -+ } else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11N, BIT0, 0x0); /*Trigger CLM*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11N, BIT0, 0x1); -+ } -+} -+ -+BOOLEAN -+phydm_checkCLMready( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte value32 = 0; -+ BOOLEAN ret = FALSE; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11AC, bMaskDWord); /*make sure CLM calc is ready*/ -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_READY_11N, bMaskDWord); /*make sure CLM calc is ready*/ -+ -+ if ((pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) && (value32 & BIT16)) -+ ret = TRUE; -+ else if ((pDM_Odm->SupportICType & ODM_IC_11N_SERIES) && (value32 & BIT17)) -+ ret = TRUE; -+ else -+ ret = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCX, ODM_DBG_LOUD, ("[%s] : CLM ready = %d\n", __func__, ret)); -+ -+ return ret; -+} -+ -+void -+phydm_getCLMresult( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; -+ -+ u4Byte value32 = 0; -+ u2Byte results = 0; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11AC, bMaskDWord); /*read CLM calc result*/ -+ else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11N, bMaskDWord); /*read CLM calc result*/ -+ -+ CCX_INFO->CLM_result = (u2Byte)(value32 & bMaskLWord); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCX, ODM_DBG_LOUD, ("[%s] : CLM result = %dus\n", __func__, CCX_INFO->CLM_result*4)); -+ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_ccx.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_ccx.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_ccx.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_ccx.h 2018-02-11 21:44:27.155146208 +0200 -@@ -0,0 +1,102 @@ -+#ifndef __PHYDMCCX_H__ -+#define __PHYDMCCX_H__ -+ -+#define CCX_EN 1 -+ -+#define SET_NHM_SETTING 0 -+#define STORE_NHM_SETTING 1 -+#define RESTORE_NHM_SETTING 2 -+ -+/* -+#define NHM_EXCLUDE_CCA 0 -+#define NHM_INCLUDE_CCA 1 -+#define NHM_EXCLUDE_TXON 0 -+#define NHM_INCLUDE_TXON 1 -+*/ -+ -+typedef enum NHM_inexclude_cca { -+ NHM_EXCLUDE_CCA, -+ NHM_INCLUDE_CCA -+}NHM_INEXCLUDE_CCA; -+ -+typedef enum NHM_inexclude_txon { -+ NHM_EXCLUDE_TXON, -+ NHM_INCLUDE_TXON -+}NHM_INEXCLUDE_TXON; -+ -+ -+typedef struct _CCX_INFO{ -+ -+ /*Settings*/ -+ u1Byte NHM_th[11]; -+ u2Byte NHM_period; /* 4us per unit */ -+ u2Byte CLM_period; /* 4us per unit */ -+ NHM_INEXCLUDE_TXON NHM_inexclude_txon; -+ NHM_INEXCLUDE_CCA NHM_inexclude_cca; -+ -+ /*Previous Settings*/ -+ u1Byte NHM_th_restore[11]; -+ u2Byte NHM_period_restore; /* 4us per unit */ -+ u2Byte CLM_period_restore; /* 4us per unit */ -+ NHM_INEXCLUDE_TXON NHM_inexclude_txon_restore; -+ NHM_INEXCLUDE_CCA NHM_inexclude_cca_restore; -+ -+ /*Report*/ -+ u1Byte NHM_result[12]; -+ u2Byte NHM_duration; -+ u2Byte CLM_result; -+ -+ -+ BOOLEAN echo_NHM_en; -+ BOOLEAN echo_CLM_en; -+ u1Byte echo_IGI; -+ -+}CCX_INFO, *PCCX_INFO; -+ -+/*NHM*/ -+ -+VOID -+phydm_NHMsetting( -+ IN PVOID pDM_VOID, -+ u1Byte NHMsetting -+); -+ -+VOID -+phydm_NHMtrigger( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_getNHMresult( -+ IN PVOID pDM_VOID -+); -+ -+BOOLEAN -+phydm_checkNHMready( -+ IN PVOID pDM_VOID -+); -+ -+/*CLM*/ -+ -+VOID -+phydm_CLMsetting( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_CLMtrigger( -+ IN PVOID pDM_VOID -+); -+ -+BOOLEAN -+phydm_checkCLMready( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_getCLMresult( -+ IN PVOID pDM_VOID -+); -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.c 2018-02-11 21:44:27.155146208 +0200 -@@ -0,0 +1,381 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+VOID -+odm_SetCrystalCap( -+ IN PVOID pDM_VOID, -+ IN u1Byte CrystalCap -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ -+ if(pCfoTrack->CrystalCap == CrystalCap) -+ return; -+ -+ pCfoTrack->CrystalCap = CrystalCap; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8188E | ODM_RTL8188F)) { -+ /* write 0x24[22:17] = 0x24[16:11] = CrystalCap */ -+ CrystalCap = CrystalCap & 0x3F; -+ ODM_SetBBReg(pDM_Odm, REG_AFE_XTAL_CTRL, 0x007ff800, (CrystalCap|(CrystalCap << 6))); -+ } else if (pDM_Odm->SupportICType & ODM_RTL8812) { -+ /* write 0x2C[30:25] = 0x2C[24:19] = CrystalCap */ -+ CrystalCap = CrystalCap & 0x3F; -+ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0x7FF80000, (CrystalCap|(CrystalCap << 6))); -+ } else if ((pDM_Odm->SupportICType & (ODM_RTL8703B|ODM_RTL8723B|ODM_RTL8192E|ODM_RTL8821))) { -+ /* 0x2C[23:18] = 0x2C[17:12] = CrystalCap */ -+ CrystalCap = CrystalCap & 0x3F; -+ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0x00FFF000, (CrystalCap|(CrystalCap << 6))); -+ } else if (pDM_Odm->SupportICType & ODM_RTL8814A) { -+ /* write 0x2C[26:21] = 0x2C[20:15] = CrystalCap */ -+ CrystalCap = CrystalCap & 0x3F; -+ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0x07FF8000, (CrystalCap|(CrystalCap << 6))); -+ } else if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8821C)) { -+ /* write 0x24[30:25] = 0x28[6:1] = CrystalCap */ -+ CrystalCap = CrystalCap & 0x3F; -+ ODM_SetBBReg(pDM_Odm, REG_AFE_XTAL_CTRL, 0x7e000000, CrystalCap); -+ ODM_SetBBReg(pDM_Odm, REG_AFE_PLL_CTRL, 0x7e, CrystalCap); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_SetCrystalCap(): Use default setting.\n")); -+ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCap|(CrystalCap << 6))); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_SetCrystalCap(): CrystalCap = 0x%x\n", CrystalCap)); -+#endif -+} -+ -+u1Byte -+odm_GetDefaultCrytaltalCap( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte CrystalCap = 0x20; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ CrystalCap = pHalData->CrystalCap; -+#else -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ if(priv->pmib->dot11RFEntry.xcap > 0) -+ CrystalCap = priv->pmib->dot11RFEntry.xcap; -+#endif -+ -+ CrystalCap = CrystalCap & 0x3f; -+ -+ return CrystalCap; -+} -+ -+VOID -+odm_SetATCStatus( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN ATCStatus -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ -+ if(pCfoTrack->bATCStatus == ATCStatus) -+ return; -+ -+ ODM_SetBBReg(pDM_Odm, ODM_REG(BB_ATC,pDM_Odm), ODM_BIT(BB_ATC,pDM_Odm), ATCStatus); -+ pCfoTrack->bATCStatus = ATCStatus; -+} -+ -+BOOLEAN -+odm_GetATCStatus( -+ IN PVOID pDM_VOID -+) -+{ -+ BOOLEAN ATCStatus; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ATCStatus = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG(BB_ATC,pDM_Odm), ODM_BIT(BB_ATC,pDM_Odm)); -+ return ATCStatus; -+} -+ -+VOID -+ODM_CfoTrackingReset( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ -+ pCfoTrack->DefXCap = odm_GetDefaultCrytaltalCap(pDM_Odm); -+ pCfoTrack->bAdjust = TRUE; -+ -+ if(pCfoTrack->CrystalCap > pCfoTrack->DefXCap) -+ { -+ odm_SetCrystalCap(pDM_Odm, pCfoTrack->CrystalCap - 1); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, -+ ("ODM_CfoTrackingReset(): approch default value (0x%x)\n", pCfoTrack->CrystalCap)); -+ } else if (pCfoTrack->CrystalCap < pCfoTrack->DefXCap) -+ { -+ odm_SetCrystalCap(pDM_Odm, pCfoTrack->CrystalCap + 1); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, -+ ("ODM_CfoTrackingReset(): approch default value (0x%x)\n", pCfoTrack->CrystalCap)); -+ } -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ odm_SetATCStatus(pDM_Odm, TRUE); -+ #endif -+} -+ -+VOID -+ODM_CfoTrackingInit( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ -+ pCfoTrack->DefXCap = pCfoTrack->CrystalCap = odm_GetDefaultCrytaltalCap(pDM_Odm); -+ pCfoTrack->bATCStatus = odm_GetATCStatus(pDM_Odm); -+ pCfoTrack->bAdjust = TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking_init()=========>\n")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking_init(): bATCStatus = %d, CrystalCap = 0x%x\n", pCfoTrack->bATCStatus, pCfoTrack->DefXCap)); -+ -+#if RTL8822B_SUPPORT -+ /* Crystal cap. control by WiFi */ -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ ODM_SetBBReg(pDM_Odm, 0x10, 0x40, 0x1); -+#endif -+ -+#if RTL8821C_SUPPORT -+ /* Crystal cap. control by WiFi */ -+ if (pDM_Odm->SupportICType & ODM_RTL8821C) -+ ODM_SetBBReg(pDM_Odm, 0x10, 0x40, 0x1); -+#endif -+} -+ -+VOID -+ODM_CfoTracking( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ s4Byte CFO_ave = 0; -+ u4Byte CFO_rpt_sum, CFO_kHz_avg[4] = {0}; -+ s4Byte CFO_ave_diff; -+ s1Byte CrystalCap = pCfoTrack->CrystalCap; -+ u1Byte Adjust_Xtal = 1, i, valid_path_cnt = 0; -+ -+ //4 Support ability -+ if(!(pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Return: SupportAbility ODM_BB_CFO_TRACKING is disabled\n")); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking()=========> \n")); -+ -+ if(!pDM_Odm->bLinked || !pDM_Odm->bOneEntryOnly) -+ { -+ //4 No link or more than one entry -+ ODM_CfoTrackingReset(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Reset: bLinked = %d, bOneEntryOnly = %d\n", -+ pDM_Odm->bLinked, pDM_Odm->bOneEntryOnly)); -+ } -+ else -+ { -+ //3 1. CFO Tracking -+ //4 1.1 No new packet -+ if(pCfoTrack->packetCount == pCfoTrack->packetCount_pre) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): packet counter doesn't change\n")); -+ return; -+ } -+ pCfoTrack->packetCount_pre = pCfoTrack->packetCount; -+ -+ //4 1.2 Calculate CFO -+ for (i = 0; i < pDM_Odm->num_rf_path; i++) { -+ -+ if (pCfoTrack->CFO_cnt[i] == 0) -+ continue; -+ -+ valid_path_cnt++; -+ CFO_rpt_sum = (u4Byte)((pCfoTrack->CFO_tail[i] < 0) ? (0 - pCfoTrack->CFO_tail[i]) : pCfoTrack->CFO_tail[i]); -+ CFO_kHz_avg[i] = CFO_HW_RPT_2_MHZ(CFO_rpt_sum) / pCfoTrack->CFO_cnt[i]; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("[Path %d] CFO_rpt_sum = (( %d )), CFO_cnt = (( %d )) , CFO_avg= (( %s%d )) kHz\n", -+ i, CFO_rpt_sum, pCfoTrack->CFO_cnt[i],((pCfoTrack->CFO_tail[i] < 0) ? "-" : " ") ,CFO_kHz_avg[i])); -+ } -+ -+ for (i = 0; i < valid_path_cnt; i++) { -+ -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("path [%d], pCfoTrack->CFO_tail = %d\n", i, pCfoTrack->CFO_tail[i])); -+ if (pCfoTrack->CFO_tail[i] < 0) { -+ CFO_ave += (0-(s4Byte)CFO_kHz_avg[i]); -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("CFO_ave = %d\n", CFO_ave)); -+ } -+ else -+ CFO_ave += (s4Byte)CFO_kHz_avg[i]; -+ } -+ -+ if (valid_path_cnt >= 2) -+ CFO_ave = CFO_ave / valid_path_cnt; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("valid_path_cnt = ((%d)), CFO_ave = ((%d kHz))\n", valid_path_cnt, CFO_ave)); -+ -+ /*reset counter*/ -+ for (i = 0; i < pDM_Odm->num_rf_path; i++) { -+ pCfoTrack->CFO_tail[i] = 0; -+ pCfoTrack->CFO_cnt[i] = 0; -+ } -+ -+ //4 1.3 Avoid abnormal large CFO -+ CFO_ave_diff = (pCfoTrack->CFO_ave_pre >= CFO_ave)?(pCfoTrack->CFO_ave_pre - CFO_ave):(CFO_ave - pCfoTrack->CFO_ave_pre); -+ if(CFO_ave_diff > 20 && pCfoTrack->largeCFOHit == 0 && !pCfoTrack->bAdjust) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): first large CFO hit\n")); -+ pCfoTrack->largeCFOHit = 1; -+ return; -+ } -+ else -+ pCfoTrack->largeCFOHit = 0; -+ pCfoTrack->CFO_ave_pre = CFO_ave; -+ -+ //4 1.4 Dynamic Xtal threshold -+ if(pCfoTrack->bAdjust == FALSE) -+ { -+ if(CFO_ave > CFO_TH_XTAL_HIGH || CFO_ave < (-CFO_TH_XTAL_HIGH)) -+ pCfoTrack->bAdjust = TRUE; -+ } -+ else -+ { -+ if(CFO_ave < CFO_TH_XTAL_LOW && CFO_ave > (-CFO_TH_XTAL_LOW)) -+ pCfoTrack->bAdjust = FALSE; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ //4 1.5 BT case: Disable CFO tracking -+ if(pDM_Odm->bBtEnabled) -+ { -+ pCfoTrack->bAdjust = FALSE; -+ odm_SetCrystalCap(pDM_Odm, pCfoTrack->DefXCap); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Disable CFO tracking for BT!!\n")); -+ } -+/* -+ //4 1.6 Big jump -+ if(pCfoTrack->bAdjust) -+ { -+ if(CFO_ave > CFO_TH_XTAL_LOW) -+ Adjust_Xtal = Adjust_Xtal + ((CFO_ave - CFO_TH_XTAL_LOW) >> 2); -+ else if(CFO_ave < (-CFO_TH_XTAL_LOW)) -+ Adjust_Xtal = Adjust_Xtal + ((CFO_TH_XTAL_LOW - CFO_ave) >> 2); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Crystal cap offset = %d\n", Adjust_Xtal)); -+ } -+*/ -+#endif -+ -+ //4 1.7 Adjust Crystal Cap. -+ if(pCfoTrack->bAdjust) -+ { -+ if(CFO_ave > CFO_TH_XTAL_LOW) -+ CrystalCap = CrystalCap + Adjust_Xtal; -+ else if(CFO_ave < (-CFO_TH_XTAL_LOW)) -+ CrystalCap = CrystalCap - Adjust_Xtal; -+ -+ if(CrystalCap > 0x3f) -+ CrystalCap = 0x3f; -+ else if (CrystalCap < 0) -+ CrystalCap = 0; -+ -+ odm_SetCrystalCap(pDM_Odm, (u1Byte)CrystalCap); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Crystal cap = 0x%x, Default Crystal cap = 0x%x\n", -+ pCfoTrack->CrystalCap, pCfoTrack->DefXCap)); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ return; -+ -+ //3 2. Dynamic ATC switch -+ if(CFO_ave < CFO_TH_ATC && CFO_ave > -CFO_TH_ATC) -+ { -+ odm_SetATCStatus(pDM_Odm, FALSE); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Disable ATC!!\n")); -+ } -+ else -+ { -+ odm_SetATCStatus(pDM_Odm, TRUE); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Enable ATC!!\n")); -+ } -+#endif -+ } -+} -+ -+VOID -+ODM_ParsingCFO( -+ IN PVOID pDM_VOID, -+ IN PVOID pPktinfo_VOID, -+ IN s1Byte* pcfotail, -+ IN u1Byte num_ss -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_PACKET_INFO_T pPktinfo = (PODM_PACKET_INFO_T)pPktinfo_VOID; -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ u1Byte i; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)) -+ return; -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(pPktinfo->bPacketMatchBSSID) -+#else -+ if(pPktinfo->StationID != 0) -+#endif -+ { -+ if (num_ss > pDM_Odm->num_rf_path) /*For fool proof*/ -+ num_ss = pDM_Odm->num_rf_path; -+ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("num_ss = ((%d)), pDM_Odm->num_rf_path = ((%d))\n", num_ss, pDM_Odm->num_rf_path));*/ -+ -+ -+ //3 Update CFO report for path-A & path-B -+ // Only paht-A and path-B have CFO tail and short CFO -+ for(i = 0; i < num_ss; i++) -+ { -+ pCfoTrack->CFO_tail[i] += pcfotail[i]; -+ pCfoTrack->CFO_cnt[i] ++; -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("[ID %d][path %d][Rate 0x%x] CFO_tail = ((%d)), CFO_tail_sum = ((%d)), CFO_cnt = ((%d))\n", -+ pPktinfo->StationID, i, pPktinfo->DataRate, pcfotail[i], pCfoTrack->CFO_tail[i], pCfoTrack->CFO_cnt[i])); -+ */ -+ } -+ -+ //3 Update packet counter -+ if(pCfoTrack->packetCount == 0xffffffff) -+ pCfoTrack->packetCount = 0; -+ else -+ pCfoTrack->packetCount++; -+ } -+} -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_cfotracking.h 2018-02-11 21:44:27.155146208 +0200 -@@ -0,0 +1,70 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMCFOTRACK_H__ -+#define __PHYDMCFOTRACK_H__ -+ -+#define CFO_TRACKING_VERSION "1.4" /*2015.10.01 Stanley, Modify for 8822B*/ -+ -+#define CFO_TH_XTAL_HIGH 20 // kHz -+#define CFO_TH_XTAL_LOW 10 // kHz -+#define CFO_TH_ATC 80 // kHz -+ -+typedef struct _CFO_TRACKING_ -+{ -+ BOOLEAN bATCStatus; -+ BOOLEAN largeCFOHit; -+ BOOLEAN bAdjust; -+ u1Byte CrystalCap; -+ u1Byte DefXCap; -+ s4Byte CFO_tail[4]; -+ u4Byte CFO_cnt[4]; -+ s4Byte CFO_ave_pre; -+ u4Byte packetCount; -+ u4Byte packetCount_pre; -+ -+ BOOLEAN bForceXtalCap; -+ BOOLEAN bReset; -+}CFO_TRACKING, *PCFO_TRACKING; -+ -+VOID -+ODM_CfoTrackingReset( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+ODM_CfoTrackingInit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+ODM_CfoTracking( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+ODM_ParsingCFO( -+ IN PVOID pDM_VOID, -+ IN PVOID pPktinfo_VOID, -+ IN s1Byte* pcfotail, -+ IN u1Byte num_ss -+); -+ -+#endif -\ Ingen nyrad vid filslut -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_debug.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_debug.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_debug.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_debug.c 2018-02-11 21:44:27.155146208 +0200 -@@ -0,0 +1,3015 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+VOID -+PHYDM_InitDebugSetting( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ pDM_Odm->DebugLevel = ODM_DBG_TRACE; -+ -+ pDM_Odm->fw_DebugComponents = 0; -+ pDM_Odm->DebugComponents = -+ \ -+#if DBG -+/*BB Functions*/ -+/* ODM_COMP_DIG |*/ -+/* ODM_COMP_RA_MASK |*/ -+/* ODM_COMP_DYNAMIC_TXPWR |*/ -+/* ODM_COMP_FA_CNT |*/ -+/* ODM_COMP_RSSI_MONITOR |*/ -+/* ODM_COMP_SNIFFER |*/ -+/* ODM_COMP_ANT_DIV |*/ -+/* ODM_COMP_NOISY_DETECT |*/ -+/* ODM_COMP_RATE_ADAPTIVE |*/ -+/* ODM_COMP_PATH_DIV |*/ -+/* ODM_COMP_DYNAMIC_PRICCA |*/ -+/* ODM_COMP_MP |*/ -+/* ODM_COMP_CFO_TRACKING |*/ -+/* ODM_COMP_ACS |*/ -+/* PHYDM_COMP_ADAPTIVITY |*/ -+/* PHYDM_COMP_RA_DBG |*/ -+/* PHYDM_COMP_TXBF |*/ -+ -+/*MAC Functions*/ -+/* ODM_COMP_EDCA_TURBO |*/ -+/* ODM_FW_DEBUG_TRACE |*/ -+ -+/*RF Functions*/ -+/* ODM_COMP_TX_PWR_TRACK |*/ -+/* ODM_COMP_CALIBRATION |*/ -+ -+/*Common*/ -+/* ODM_PHY_CONFIG |*/ -+/* ODM_COMP_INIT |*/ -+/* ODM_COMP_COMMON |*/ -+/* ODM_COMP_API |*/ -+ -+ -+#endif -+ 0; -+ -+ pDM_Odm->fw_buff_is_enpty = TRUE; -+ pDM_Odm->pre_c2h_seq = 0; -+} -+ -+VOID -+phydm_BB_RxHang_Info( -+ IN PVOID pDM_VOID, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ u4Byte value32 = 0; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ return; -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF80 , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rptreg of sc/bw/ht/...", value32)); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ ODM_SetBBReg(pDM_Odm, 0x198c , BIT2|BIT1|BIT0, 7); -+ -+ /* dbg_port = basic state machine */ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x000); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "basic state machine", value32)); -+ } -+ -+ /* dbg_port = state machine */ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x007); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "state machine", value32)); -+ } -+ -+ /* dbg_port = CCA-related*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x204); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "CCA-related", value32)); -+ } -+ -+ -+ /* dbg_port = edcca/rxd*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x278); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "edcca/rxd", value32)); -+ } -+ -+ /* dbg_port = rx_state/mux_state/ADC_MASK_OFDM*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x290); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx_state/mux_state/ADC_MASK_OFDM", value32)); -+ } -+ -+ /* dbg_port = bf-related*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x2B2); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "bf-related", value32)); -+ } -+ -+ /* dbg_port = bf-related*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x2B8); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "bf-related", value32)); -+ } -+ -+ /* dbg_port = txon/rxd*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xA03); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "txon/rxd", value32)); -+ } -+ -+ /* dbg_port = l_rate/l_length*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xA0B); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "l_rate/l_length", value32)); -+ } -+ -+ /* dbg_port = rxd/rxd_hit*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xA0D); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rxd/rxd_hit", value32)); -+ } -+ -+ /* dbg_port = dis_cca*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAA0); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "dis_cca", value32)); -+ } -+ -+ -+ /* dbg_port = tx*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAB0); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "tx", value32)); -+ } -+ -+ /* dbg_port = rx plcp*/ -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD0); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); -+ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD1); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); -+ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD2); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); -+ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD3); -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); -+ } -+ -+} -+ -+VOID -+phydm_BB_Debug_Info( -+ IN PVOID pDM_VOID, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ char *tmp_string = NULL; -+ -+ u1Byte RX_HT_BW, RX_VHT_BW, RXSC, RX_HT, RX_BW; -+ static u1Byte vRX_BW ; -+ u4Byte value32, value32_1, value32_2, value32_3; -+ s4Byte SFO_A, SFO_B, SFO_C, SFO_D; -+ s4Byte LFO_A, LFO_B, LFO_C, LFO_D; -+ static u1Byte MCSS, Tail, Parity, rsv, vrsv, idx, smooth, htsound, agg, stbc, vstbc, fec, fecext, sgi, sgiext, htltf, vgid, vNsts, vtxops, vrsv2, vbrsv, bf, vbcrc; -+ static u2Byte HLength, htcrc8, Length; -+ static u2Byte vpaid; -+ static u2Byte vLength, vhtcrc8, vMCSS, vTail, vbTail; -+ static u1Byte HMCSS, HRX_BW; -+ -+ u1Byte pwDB; -+ s1Byte RXEVM_0, RXEVM_1, RXEVM_2 ; -+ u1Byte RF_gain_pathA, RF_gain_pathB, RF_gain_pathC, RF_gain_pathD; -+ u1Byte RX_SNR_pathA, RX_SNR_pathB, RX_SNR_pathC, RX_SNR_pathD; -+ s4Byte sig_power; -+ -+ const char *L_rate[8] = {"6M", "9M", "12M", "18M", "24M", "36M", "48M", "54M"}; -+ -+ /* -+ const double evm_comp_20M = 0.579919469776867; //10*log10(64.0/56.0) -+ const double evm_comp_40M = 0.503051183113957; //10*log10(128.0/114.0) -+ const double evm_comp_80M = 0.244245993314183; //10*log10(256.0/242.0) -+ const double evm_comp_160M = 0.244245993314183; //10*log10(512.0/484.0) -+ */ -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ return; -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s\n", "BB Report Info")); -+ -+ /*BW & Mode Detection*/ -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf80 , bMaskDWord); -+ value32_2 = value32; -+ RX_HT_BW = (u1Byte)(value32 & 0x1); -+ RX_VHT_BW = (u1Byte)((value32 >> 1) & 0x3); -+ RXSC = (u1Byte)(value32 & 0x78); -+ value32_1 = (value32 & 0x180) >> 7; -+ RX_HT = (u1Byte)(value32_1); -+ -+ RX_BW = 0; -+ -+ if (RX_HT == 2) { -+ if (RX_VHT_BW == 0) { -+ tmp_string = "20M"; -+ } else if (RX_VHT_BW == 1) { -+ tmp_string = "40M"; -+ } else { -+ tmp_string = "80M"; -+ } -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s %s %s", "Mode", "VHT", tmp_string)); -+ RX_BW = RX_VHT_BW; -+ } else if (RX_HT == 1) { -+ if (RX_HT_BW == 0) { -+ tmp_string = "20M"; -+ } else if (RX_HT_BW == 1) { -+ tmp_string = "40M"; -+ } -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s %s %s", "Mode", "HT", tmp_string)); -+ RX_BW = RX_HT_BW; -+ } else { -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s %s", "Mode", "Legacy")); -+ } -+ -+ if (RX_HT != 0) { -+ if (RXSC == 0) -+ tmp_string = "duplicate/full bw"; -+ else if (RXSC == 1) -+ tmp_string = "usc20-1"; -+ else if (RXSC == 2) -+ tmp_string = "lsc20-1"; -+ else if (RXSC == 3) -+ tmp_string = "usc20-2"; -+ else if (RXSC == 4) -+ tmp_string = "lsc20-2"; -+ else if (RXSC == 9) -+ tmp_string = "usc40"; -+ else if (RXSC == 10) -+ tmp_string = "lsc40"; -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s", tmp_string)); -+ } -+ -+ /* RX signal power and AGC related info*/ -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF90 , bMaskDWord); -+ pwDB = (u1Byte)((value32 & bMaskByte1) >> 8); -+ pwDB = pwDB >> 1; -+ sig_power = -110 + pwDB; -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "OFDM RX Signal Power(dB)", sig_power)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xd14 , bMaskDWord); -+ RX_SNR_pathA = (u1Byte)(value32 & 0xFF) >> 1; -+ RF_gain_pathA = (s1Byte)((value32 & bMaskByte1) >> 8); -+ RF_gain_pathA *= 2; -+ value32 = ODM_GetBBReg(pDM_Odm, 0xd54 , bMaskDWord); -+ RX_SNR_pathB = (u1Byte)(value32 & 0xFF) >> 1; -+ RF_gain_pathB = (s1Byte)((value32 & bMaskByte1) >> 8); -+ RF_gain_pathB *= 2; -+ value32 = ODM_GetBBReg(pDM_Odm, 0xd94 , bMaskDWord); -+ RX_SNR_pathC = (u1Byte)(value32 & 0xFF) >> 1; -+ RF_gain_pathC = (s1Byte)((value32 & bMaskByte1) >> 8); -+ RF_gain_pathC *= 2; -+ value32 = ODM_GetBBReg(pDM_Odm, 0xdd4 , bMaskDWord); -+ RX_SNR_pathD = (u1Byte)(value32 & 0xFF) >> 1; -+ RF_gain_pathD = (s1Byte)((value32 & bMaskByte1) >> 8); -+ RF_gain_pathD *= 2; -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d / %d", "OFDM RX RF Gain(A/B/C/D)", RF_gain_pathA, RF_gain_pathB, RF_gain_pathC, RF_gain_pathD)); -+ -+ -+ /* RX Counter related info*/ -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF08, bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "OFDM CCA Counter", ((value32&0xFFFF0000)>>16))); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xFD0, bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "OFDM SBD Fail Counter", value32&0xFFFF)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xFC4, bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "VHT SIGA/SIGB CRC8 Fail Counter", value32&0xFFFF, ((value32&0xFFFF0000)>>16))); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xFCC, bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "CCK CCA Counter", value32&0xFFFF)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xFBC, bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "LSIG (Parity Fail/Rate Illegal) Counter", value32&0xFFFF, ((value32&0xFFFF0000)>>16))); -+ -+ value32_1 = ODM_GetBBReg(pDM_Odm, 0xFC8, bMaskDWord); -+ value32_2 = ODM_GetBBReg(pDM_Odm, 0xFC0, bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "HT/VHT MCS NOT SUPPORT counter", ((value32_2&0xFFFF0000)>>16), value32_1&0xFFFF)); -+ -+ /* PostFFT related info*/ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF8c , bMaskDWord); -+ RXEVM_0 = (s1Byte)((value32 & bMaskByte2) >> 16); -+ RXEVM_0 /= 2; -+ if (RXEVM_0 < -63) -+ RXEVM_0 = 0; -+ -+ RXEVM_1 = (s1Byte)((value32 & bMaskByte3) >> 24); -+ RXEVM_1 /= 2; -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF88 , bMaskDWord); -+ RXEVM_2 = (s1Byte)((value32 & bMaskByte2) >> 16); -+ RXEVM_2 /= 2; -+ -+ if (RXEVM_1 < -63) -+ RXEVM_1 = 0; -+ if (RXEVM_2 < -63) -+ RXEVM_2 = 0; -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d", "RXEVM (1ss/2ss/3ss)", RXEVM_0, RXEVM_1, RXEVM_2)); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d / %d", "RXSNR(A/B/C/D, dB)", RX_SNR_pathA, RX_SNR_pathB, RX_SNR_pathC, RX_SNR_pathD)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF8C , bMaskDWord); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "CSI_1st /CSI_2nd", value32&0xFFFF, ((value32&0xFFFF0000)>>16))); -+ -+ /*BW & Mode Detection*/ -+ -+ /*Reset Page F Counter*/ -+ ODM_SetBBReg(pDM_Odm, 0xB58 , BIT0, 1); -+ ODM_SetBBReg(pDM_Odm, 0xB58 , BIT0, 0); -+ -+ /*CFO Report Info*/ -+ /*Short CFO*/ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xd0c , bMaskDWord); -+ value32_1 = ODM_GetBBReg(pDM_Odm, 0xd4c , bMaskDWord); -+ value32_2 = ODM_GetBBReg(pDM_Odm, 0xd8c , bMaskDWord); -+ value32_3 = ODM_GetBBReg(pDM_Odm, 0xdcc , bMaskDWord); -+ -+ SFO_A = (s4Byte)(value32 & 0xfff); -+ SFO_B = (s4Byte)(value32_1 & 0xfff); -+ SFO_C = (s4Byte)(value32_2 & 0xfff); -+ SFO_D = (s4Byte)(value32_3 & 0xfff); -+ -+ LFO_A = (s4Byte)(value32 >> 16); -+ LFO_B = (s4Byte)(value32_1 >> 16); -+ LFO_C = (s4Byte)(value32_2 >> 16); -+ LFO_D = (s4Byte)(value32_3 >> 16); -+ -+ /*SFO 2's to dec*/ -+ if (SFO_A > 2047) -+ SFO_A = SFO_A - 4096; -+ SFO_A = (SFO_A * 312500) / 2048; -+ if (SFO_B > 2047) -+ SFO_B = SFO_B - 4096; -+ SFO_B = (SFO_B * 312500) / 2048; -+ if (SFO_C > 2047) -+ SFO_C = SFO_C - 4096; -+ SFO_C = (SFO_C * 312500) / 2048; -+ if (SFO_D > 2047) -+ SFO_D = SFO_D - 4096; -+ SFO_D = (SFO_D * 312500) / 2048; -+ -+ /*LFO 2's to dec*/ -+ -+ if (LFO_A > 4095) -+ LFO_A = LFO_A - 8192; -+ -+ if (LFO_B > 4095) -+ LFO_B = LFO_B - 8192; -+ -+ if (LFO_C > 4095) -+ LFO_C = LFO_C - 8192; -+ -+ if (LFO_D > 4095) -+ LFO_D = LFO_D - 8192; -+ LFO_A = LFO_A * 312500 / 4096; -+ LFO_B = LFO_B * 312500 / 4096; -+ LFO_C = LFO_C * 312500 / 4096; -+ LFO_D = LFO_D * 312500 / 4096; -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "CFO Report Info")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "Short CFO(Hz) ", SFO_A, SFO_B, SFO_C, SFO_D)); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "Long CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D)); -+ -+ /*SCFO*/ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xd10 , bMaskDWord); -+ value32_1 = ODM_GetBBReg(pDM_Odm, 0xd50 , bMaskDWord); -+ value32_2 = ODM_GetBBReg(pDM_Odm, 0xd90 , bMaskDWord); -+ value32_3 = ODM_GetBBReg(pDM_Odm, 0xdd0 , bMaskDWord); -+ -+ SFO_A = (s4Byte)(value32 & 0x7ff); -+ SFO_B = (s4Byte)(value32_1 & 0x7ff); -+ SFO_C = (s4Byte)(value32_2 & 0x7ff); -+ SFO_D = (s4Byte)(value32_3 & 0x7ff); -+ -+ if (SFO_A > 1023) -+ SFO_A = SFO_A - 2048; -+ -+ if (SFO_B > 2047) -+ SFO_B = SFO_B - 4096; -+ -+ if (SFO_C > 2047) -+ SFO_C = SFO_C - 4096; -+ -+ if (SFO_D > 2047) -+ SFO_D = SFO_D - 4096; -+ -+ SFO_A = SFO_A * 312500 / 1024; -+ SFO_B = SFO_B * 312500 / 1024; -+ SFO_C = SFO_C * 312500 / 1024; -+ SFO_D = SFO_D * 312500 / 1024; -+ -+ LFO_A = (s4Byte)(value32 >> 16); -+ LFO_B = (s4Byte)(value32_1 >> 16); -+ LFO_C = (s4Byte)(value32_2 >> 16); -+ LFO_D = (s4Byte)(value32_3 >> 16); -+ -+ if (LFO_A > 4095) -+ LFO_A = LFO_A - 8192; -+ -+ if (LFO_B > 4095) -+ LFO_B = LFO_B - 8192; -+ -+ if (LFO_C > 4095) -+ LFO_C = LFO_C - 8192; -+ -+ if (LFO_D > 4095) -+ LFO_D = LFO_D - 8192; -+ LFO_A = LFO_A * 312500 / 4096; -+ LFO_B = LFO_B * 312500 / 4096; -+ LFO_C = LFO_C * 312500 / 4096; -+ LFO_D = LFO_D * 312500 / 4096; -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "Value SCFO(Hz) ", SFO_A, SFO_B, SFO_C, SFO_D)); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "ACQ CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xd14 , bMaskDWord); -+ value32_1 = ODM_GetBBReg(pDM_Odm, 0xd54 , bMaskDWord); -+ value32_2 = ODM_GetBBReg(pDM_Odm, 0xd94 , bMaskDWord); -+ value32_3 = ODM_GetBBReg(pDM_Odm, 0xdd4 , bMaskDWord); -+ -+ LFO_A = (s4Byte)(value32 >> 16); -+ LFO_B = (s4Byte)(value32_1 >> 16); -+ LFO_C = (s4Byte)(value32_2 >> 16); -+ LFO_D = (s4Byte)(value32_3 >> 16); -+ -+ if (LFO_A > 4095) -+ LFO_A = LFO_A - 8192; -+ -+ if (LFO_B > 4095) -+ LFO_B = LFO_B - 8192; -+ -+ if (LFO_C > 4095) -+ LFO_C = LFO_C - 8192; -+ -+ if (LFO_D > 4095) -+ LFO_D = LFO_D - 8192; -+ -+ LFO_A = LFO_A * 312500 / 4096; -+ LFO_B = LFO_B * 312500 / 4096; -+ LFO_C = LFO_C * 312500 / 4096; -+ LFO_D = LFO_D * 312500 / 4096; -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "End CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf20 , bMaskDWord); /*L SIG*/ -+ -+ Tail = (u1Byte)((value32 & 0xfc0000) >> 16); -+ Parity = (u1Byte)((value32 & 0x20000) >> 16); -+ Length = (u2Byte)((value32 & 0x1ffe00) >> 8); -+ rsv = (u1Byte)(value32 & 0x10); -+ MCSS = (u1Byte)(value32 & 0x0f); -+ -+ switch (MCSS) { -+ case 0x0b: -+ idx = 0; -+ break; -+ case 0x0f: -+ idx = 1; -+ break; -+ case 0x0a: -+ idx = 2; -+ break; -+ case 0x0e: -+ idx = 3; -+ break; -+ case 0x09: -+ idx = 4; -+ break; -+ case 0x08: -+ idx = 5; -+ break; -+ case 0x0c: -+ idx = 6; -+ break; -+ default: -+ idx = 6; -+ break; -+ -+ } -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "L-SIG")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s : %s", "Rate", L_rate[idx])); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x", "Rsv/Length/Parity", rsv, RX_BW, Length)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf2c , bMaskDWord); /*HT SIG*/ -+ if (RX_HT == 1) { -+ -+ HMCSS = (u1Byte)(value32 & 0x7F); -+ HRX_BW = (u1Byte)(value32 & 0x80); -+ HLength = (u2Byte)((value32 >> 8) & 0xffff); -+ } -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "HT-SIG1")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x", "MCS/BW/Length", HMCSS, HRX_BW, HLength)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf30 , bMaskDWord); /*HT SIG*/ -+ -+ if (RX_HT == 1) { -+ smooth = (u1Byte)(value32 & 0x01); -+ htsound = (u1Byte)(value32 & 0x02); -+ rsv = (u1Byte)(value32 & 0x04); -+ agg = (u1Byte)(value32 & 0x08); -+ stbc = (u1Byte)(value32 & 0x30); -+ fec = (u1Byte)(value32 & 0x40); -+ sgi = (u1Byte)(value32 & 0x80); -+ htltf = (u1Byte)((value32 & 0x300) >> 8); -+ htcrc8 = (u2Byte)((value32 & 0x3fc00) >> 8); -+ Tail = (u1Byte)((value32 & 0xfc0000) >> 16); -+ } -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "HT-SIG2")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x / %x / %x", "Smooth/NoSound/Rsv/Aggregate/STBC/LDPC", smooth, htsound, rsv, agg, stbc, fec)); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x", "SGI/E-HT-LTFs/CRC/Tail", sgi, htltf, htcrc8, Tail)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf2c , bMaskDWord); /*VHT SIG A1*/ -+ if (RX_HT == 2) { -+ /* value32 = ODM_GetBBReg(pDM_Odm, 0xf2c ,bMaskDWord);*/ -+ vRX_BW = (u1Byte)(value32 & 0x03); -+ vrsv = (u1Byte)(value32 & 0x04); -+ vstbc = (u1Byte)(value32 & 0x08); -+ vgid = (u1Byte)((value32 & 0x3f0) >> 4); -+ vNsts = (u1Byte)(((value32 & 0x1c00) >> 8) + 1); -+ vpaid = (u2Byte)(value32 & 0x3fe); -+ vtxops = (u1Byte)((value32 & 0x400000) >> 20); -+ vrsv2 = (u1Byte)((value32 & 0x800000) >> 20); -+ } -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "VHT-SIG-A1")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x / %x / %x / %x / %x", "BW/Rsv1/STBC/GID/Nsts/PAID/TXOPPS/Rsv2", vRX_BW, vrsv, vstbc, vgid, vNsts, vpaid, vtxops, vrsv2)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf30 , bMaskDWord); /*VHT SIG*/ -+ -+ if (RX_HT == 2) { -+ /*value32 = ODM_GetBBReg(pDM_Odm, 0xf30 ,bMaskDWord); */ /*VHT SIG*/ -+ -+ //sgi=(u1Byte)(value32&0x01); -+ sgiext = (u1Byte)(value32 & 0x03); -+ //fec = (u1Byte)(value32&0x04); -+ fecext = (u1Byte)(value32 & 0x0C); -+ -+ vMCSS = (u1Byte)(value32 & 0xf0); -+ bf = (u1Byte)((value32 & 0x100) >> 8); -+ vrsv = (u1Byte)((value32 & 0x200) >> 8); -+ vhtcrc8 = (u2Byte)((value32 & 0x3fc00) >> 8); -+ vTail = (u1Byte)((value32 & 0xfc0000) >> 16); -+ } -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "VHT-SIG-A2")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x / %x / %x / %x", "SGI/FEC/MCS/BF/Rsv/CRC/Tail", sgiext, fecext, vMCSS, bf, vrsv, vhtcrc8, vTail)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf34 , bMaskDWord); /*VHT SIG*/ -+ { -+ vLength = (u2Byte)(value32 & 0x1fffff); -+ vbrsv = (u1Byte)((value32 & 0x600000) >> 20); -+ vbTail = (u2Byte)((value32 & 0x1f800000) >> 20); -+ vbcrc = (u1Byte)((value32 & 0x80000000) >> 28); -+ -+ } -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "VHT-SIG-B")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x", "Length/Rsv/Tail/CRC", vLength, vbrsv, vbTail, vbcrc)); -+ -+ /*for Condition number*/ -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) { -+ s4Byte condition_num = 0; -+ char *factor = NULL; -+ -+ ODM_SetBBReg(pDM_Odm, 0x1988 , BIT22, 0x1); /*enable report condition number*/ -+ -+ condition_num = ODM_GetBBReg(pDM_Odm, 0xf84, bMaskDWord); -+ condition_num = (condition_num & 0x3ffff) >> 4; -+ -+ if (*pDM_Odm->pBandWidth == ODM_BW80M) -+ factor = "256/234"; -+ else if (*pDM_Odm->pBandWidth == ODM_BW40M) -+ factor = "128/108"; -+ else if (*pDM_Odm->pBandWidth == ODM_BW20M) { -+ if (RX_HT != 2 || RX_HT != 1) -+ factor = "64/52"; /*HT or VHT*/ -+ else -+ factor = "64/48"; /*legacy*/ -+ } -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d (factor = %s)", "Condition Number", condition_num, factor)); -+ -+ } -+ -+} -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+void phydm_sbd_check( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ static u4Byte pkt_cnt = 0; -+ static BOOLEAN sbd_state = 0; -+ u4Byte sym_count, count, value32; -+ -+ if (sbd_state == 0) { -+ pkt_cnt++; -+ if (pkt_cnt % 5 == 0) { /*read SBD conter once every 5 packets*/ -+ ODM_SetTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer, 0); /*ms*/ -+ sbd_state = 1; -+ } -+ } else { /*read counter*/ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF98, bMaskDWord); -+ sym_count = (value32 & 0x7C000000) >> 26; -+ count = (value32 & 0x3F00000) >> 20; -+ DbgPrint("#SBD# sym_count %d count %d\n", sym_count, count); -+ sbd_state = 0; -+ } -+} -+ -+void phydm_sbd_callback( -+ PRT_TIMER pTimer -+) -+{ -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+#if USE_WORKITEM -+ ODM_ScheduleWorkItem(&pDM_Odm->sbdcnt_workitem); -+#else -+ phydm_sbd_check(pDM_Odm); -+#endif -+} -+ -+void phydm_sbd_workitem_callback( -+ IN PVOID pContext -+) -+{ -+ PADAPTER pAdapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ phydm_sbd_check(pDM_Odm); -+} -+#endif -+VOID -+phydm_BasicDbgMessage -+( -+ IN PVOID pDM_VOID -+) -+{ -+#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure(pDM_Odm , PHYDM_FALSEALMCNT); -+ PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u2Byte macid, phydm_macid, client_cnt = 0; -+ PSTA_INFO_T pEntry; -+ s4Byte tmp_val = 0; -+ u1Byte tmp_val_u1 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[PHYDM Common MSG] System up time: ((%d sec))----->\n", pDM_Odm->phydm_sys_up_time)); -+ -+ if (pDM_Odm->bLinked) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Curr_STA_ID = 0x%x\n", pDM_Odm->curr_station_id)); -+ -+ /*Print RX Rate*/ -+ if (pDM_Odm->RxRate <= ODM_RATE11M) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[CCK AGC Report] LNA_idx = 0x%x, VGA_idx = 0x%x\n", -+ pDM_Odm->cck_lna_idx, pDM_Odm->cck_vga_idx)); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[OFDM AGC Report] { 0x%x, 0x%x, 0x%x, 0x%x }\n", -+ pDM_Odm->ofdm_agc_idx[0], pDM_Odm->ofdm_agc_idx[1], pDM_Odm->ofdm_agc_idx[2], pDM_Odm->ofdm_agc_idx[3])); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("RSSI: { %d, %d, %d, %d }, RxRate:", -+ (pDM_Odm->RSSI_A == 0xff) ? 0 : pDM_Odm->RSSI_A , -+ (pDM_Odm->RSSI_B == 0xff) ? 0 : pDM_Odm->RSSI_B , -+ (pDM_Odm->RSSI_C == 0xff) ? 0 : pDM_Odm->RSSI_C, -+ (pDM_Odm->RSSI_D == 0xff) ? 0 : pDM_Odm->RSSI_D)); -+ -+ phydm_print_rate(pDM_Odm, pDM_Odm->RxRate, ODM_COMP_COMMON); -+ -+ /*Print TX Rate*/ -+ for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { -+ -+ pEntry = pDM_Odm->pODM_StaInfo[macid]; -+ if (IS_STA_VALID(pEntry)) { -+ -+ phydm_macid = (pDM_Odm->platform2phydm_macid_table[macid]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("TXRate [%d]:", macid)); -+ phydm_print_rate(pDM_Odm, pRA_Table->link_tx_rate[macid], ODM_COMP_COMMON); -+ -+ client_cnt++; -+ -+ if (client_cnt == pDM_Odm->number_linked_client) -+ break; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("TP { TX, RX, total} = {%d, %d, %d }Mbps, TrafficLoad = (%d))\n", -+ pDM_Odm->tx_tp, pDM_Odm->rx_tp, pDM_Odm->total_tp, pDM_Odm->TrafficLoad)); -+ -+ tmp_val_u1 = (pCfoTrack->CrystalCap > pCfoTrack->DefXCap) ? (pCfoTrack->CrystalCap - pCfoTrack->DefXCap) : (pCfoTrack->DefXCap - pCfoTrack->CrystalCap); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("CFO_avg = ((%d kHz)) , CrystalCap_tracking = ((%s%d))\n", -+ pCfoTrack->CFO_ave_pre, ((pCfoTrack->CrystalCap > pCfoTrack->DefXCap)?"+":"-"),tmp_val_u1)); -+ -+ /* Condition number */ -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) { -+ tmp_val = phydm_get_condition_number_8822B(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Condition number = ((%d))\n", tmp_val)); -+ } -+#endif -+ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+ /*STBC or LDPC pkt*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("LDPC = %s, STBC = %s\n", (pDM_Odm->PhyDbgInfo.bLdpcPkt)?"Y":"N", (pDM_Odm->PhyDbgInfo.bStbcPkt)?"Y":"N")); -+#endif -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("No Link !!!\n")); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", -+ FalseAlmCnt->Cnt_CCK_CCA, FalseAlmCnt->Cnt_OFDM_CCA, FalseAlmCnt->Cnt_CCA_all)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", -+ FalseAlmCnt->Cnt_Cck_fail, FalseAlmCnt->Cnt_Ofdm_fail, FalseAlmCnt->Cnt_all)); -+ -+ #if (ODM_IC_11N_SERIES_SUPPORT == 1) -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[OFDM FA Detail] Parity_Fail = (( %d )), Rate_Illegal = (( %d )), CRC8_fail = (( %d )), Mcs_fail = (( %d )), Fast_Fsync = (( %d )), SB_Search_fail = (( %d ))\n", -+ FalseAlmCnt->Cnt_Parity_Fail, FalseAlmCnt->Cnt_Rate_Illegal, FalseAlmCnt->Cnt_Crc8_fail, FalseAlmCnt->Cnt_Mcs_fail, FalseAlmCnt->Cnt_Fast_Fsync, FalseAlmCnt->Cnt_SB_Search_fail)); -+ } -+ #endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("bLinked = %d, Num_client = %d, RSSI_Min = %d, CurrentIGI = 0x%x, bNoisy=%d\n\n", -+ pDM_Odm->bLinked, pDM_Odm->number_linked_client, pDM_Odm->RSSI_Min, pDM_DigTable->CurIGValue, pDM_Odm->NoisyDecision)); -+ -+/* -+ temp_reg = ODM_GetBBReg(pDM_Odm, 0xDD0, bMaskByte0); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xDD0 = 0x%x\n",temp_reg)); -+ -+ temp_reg = ODM_GetBBReg(pDM_Odm, 0xDDc, bMaskByte1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xDDD = 0x%x\n",temp_reg)); -+ -+ temp_reg = ODM_GetBBReg(pDM_Odm, 0xc50, bMaskByte0); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xC50 = 0x%x\n",temp_reg)); -+ -+ temp_reg = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0, 0x3fe0); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("RF 0x0[13:5] = 0x%x\n\n",temp_reg)); -+*/ -+ -+#endif -+} -+ -+ -+VOID phydm_BasicProfile( -+ IN PVOID pDM_VOID, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ char *Cut = NULL; -+ char *ICType = NULL; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ u4Byte commit_ver = 0; -+ u4Byte date = 0; -+ char *commit_by = NULL; -+ u4Byte release_ver = 0; -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "% Basic Profile %")); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+ #if (RTL8188E_SUPPORT == 1) -+ ICType = "RTL8188E"; -+ date = RELEASE_DATE_8188E; -+ commit_by = COMMIT_BY_8188E; -+ release_ver = RELEASE_VERSION_8188E; -+ #endif -+ } -+ #if (RTL8812A_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ ICType = "RTL8812A"; -+ date = RELEASE_DATE_8812A; -+ commit_by = COMMIT_BY_8812A; -+ release_ver = RELEASE_VERSION_8812A; -+ } -+ #endif -+ #if (RTL8821A_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8821) { -+ ICType = "RTL8821A"; -+ date = RELEASE_DATE_8821A; -+ commit_by = COMMIT_BY_8821A; -+ release_ver = RELEASE_VERSION_8821A; -+ } -+ #endif -+ #if (RTL8192E_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8192E) { -+ ICType = "RTL8192E"; -+ date = RELEASE_DATE_8192E; -+ commit_by = COMMIT_BY_8192E; -+ release_ver = RELEASE_VERSION_8192E; -+ } -+ #endif -+ #if (RTL8723B_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+ ICType = "RTL8723B"; -+ date = RELEASE_DATE_8723B; -+ commit_by = COMMIT_BY_8723B; -+ release_ver = RELEASE_VERSION_8723B; -+ } -+ #endif -+ #if (RTL8814A_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8814A) { -+ ICType = "RTL8814A"; -+ date = RELEASE_DATE_8814A; -+ commit_by = COMMIT_BY_8814A; -+ release_ver = RELEASE_VERSION_8814A; -+ } -+ #endif -+ #if (RTL8881A_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8881A) { -+ ICType = "RTL8881A"; -+ /**/ -+ } -+ #endif -+ #if (RTL8822B_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8822B) { -+ ICType = "RTL8822B"; -+ date = RELEASE_DATE_8822B; -+ commit_by = COMMIT_BY_8822B; -+ release_ver = RELEASE_VERSION_8822B; -+ } -+ #endif -+ #if (RTL8197F_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8197F) { -+ ICType = "RTL8197F"; -+ date = RELEASE_DATE_8197F; -+ commit_by = COMMIT_BY_8197F; -+ release_ver = RELEASE_VERSION_8197F; -+ } -+ #endif -+ -+ #if (RTL8703B_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8703B) { -+ -+ ICType = "RTL8703B"; -+ date = RELEASE_DATE_8703B; -+ commit_by = COMMIT_BY_8703B; -+ release_ver = RELEASE_VERSION_8703B; -+ -+ } -+ #endif -+ #if (RTL8195A_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8195A) { -+ ICType = "RTL8195A"; -+ /**/ -+ } -+ #endif -+ #if (RTL8188F_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ ICType = "RTL8188F"; -+ date = RELEASE_DATE_8188F; -+ commit_by = COMMIT_BY_8188F; -+ release_ver = RELEASE_VERSION_8188F; -+ } -+ #endif -+ #if (RTL8723D_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ ICType = "RTL8723D"; -+ date = RELEASE_DATE_8723D; -+ commit_by = COMMIT_BY_8723D; -+ release_ver = RELEASE_VERSION_8723D; -+ /**/ -+ } -+ #endif -+ #if (RTL8821C_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType == ODM_RTL8821C) { -+ ICType = "RTL8821C"; -+ date = RELEASE_DATE_8821C; -+ commit_by = COMMIT_BY_8821C; -+ release_ver = RELEASE_VERSION_8821C; -+ } -+ #endif -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s (MP Chip: %s)\n", "IC Type", ICType, pDM_Odm->bIsMPChip ? "Yes" : "No")); -+ -+ if (pDM_Odm->CutVersion == ODM_CUT_A) -+ Cut = "A"; -+ else if (pDM_Odm->CutVersion == ODM_CUT_B) -+ Cut = "B"; -+ else if (pDM_Odm->CutVersion == ODM_CUT_C) -+ Cut = "C"; -+ else if (pDM_Odm->CutVersion == ODM_CUT_D) -+ Cut = "D"; -+ else if (pDM_Odm->CutVersion == ODM_CUT_E) -+ Cut = "E"; -+ else if (pDM_Odm->CutVersion == ODM_CUT_F) -+ Cut = "F"; -+ else if (pDM_Odm->CutVersion == ODM_CUT_I) -+ Cut = "I"; -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Cut Version", Cut)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Version", ODM_GetHWImgVersion(pDM_Odm))); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Commit date", date)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY Parameter Commit by", commit_by)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Release Version", release_ver)); -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ { -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Version", Adapter->MgntInfo.FirmwareVersion, Adapter->MgntInfo.FirmwareSubVersion)); -+ } -+#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ { -+ struct rtl8192cd_priv *priv = pDM_Odm->priv; -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Version", priv->pshare->fw_version, priv->pshare->fw_sub_version)); -+ } -+#else -+ { -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Version", pHalData->FirmwareVersion, pHalData->FirmwareSubVersion)); -+ } -+#endif -+ //1 PHY DM Version List -+ PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "% PHYDM Version %")); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Code Base", PHYDM_CODE_BASE)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Release Date", PHYDM_RELEASE_DATE)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Adaptivity", ADAPTIVITY_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "DIG", DIG_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Dynamic BB PowerSaving", DYNAMIC_BBPWRSAV_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "CFO Tracking", CFO_TRACKING_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Antenna Diversity", ANTDIV_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Power Tracking", POWRTRACKING_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Dynamic TxPower", DYNAMIC_TXPWR_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "RA Info", RAINFO_VERSION)); -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Antenna Detection", ANTDECT_VERSION)); -+#endif -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Auto Channel Selection", ACS_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "EDCA Turbo", EDCATURBO_VERSION)); -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Path Diversity", PATHDIV_VERSION)); -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY config 8822B", PHY_CONFIG_VERSION_8822B)); -+ -+#endif -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY config 8197F", PHY_CONFIG_VERSION_8197F)); -+#endif -+ *_used = used; -+ *_out_len = out_len; -+ -+} -+ -+VOID -+phydm_fw_trace_en_h2c( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN enable, -+ IN u4Byte fw_debug_component, -+ IN u4Byte monitor_mode, -+ IN u4Byte macid -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte H2C_Parameter[7] = {0}; -+ u1Byte cmd_length; -+ -+ if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES){ -+ -+ H2C_Parameter[0] = enable; -+ H2C_Parameter[1] = (u1Byte)(fw_debug_component & bMaskByte0); -+ H2C_Parameter[2] = (u1Byte)((fw_debug_component & bMaskByte1)>>8); -+ H2C_Parameter[3] = (u1Byte)((fw_debug_component & bMaskByte2)>>16); -+ H2C_Parameter[4] = (u1Byte)((fw_debug_component & bMaskByte3)>>24); -+ H2C_Parameter[5] = (u1Byte)monitor_mode; -+ H2C_Parameter[6] = (u1Byte)macid; -+ cmd_length = 7; -+ -+ } else { -+ -+ H2C_Parameter[0] = enable; -+ H2C_Parameter[1] = (u1Byte)monitor_mode; -+ H2C_Parameter[2] = (u1Byte)macid; -+ cmd_length = 3; -+ } -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("---->\n")); -+ if (monitor_mode == 0){ -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[H2C] FW_debug_en: (( %d ))\n", enable)); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[H2C] FW_debug_en: (( %d )), mode: (( %d )), macid: (( %d ))\n", enable, monitor_mode, macid)); -+ } -+ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_FW_TRACE_EN, cmd_length, H2C_Parameter); -+} -+ -+ -+#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) -+BOOLEAN -+phydm_api_set_txagc( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte PowerIndex, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN u1Byte HwRate, -+ IN BOOLEAN bSingleRate -+ ) -+{ -+ BOOLEAN ret = FALSE; -+ -+#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8821C)) { -+ if (bSingleRate) { -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ ret = phydm_write_txagc_1byte_8822b(pDM_Odm, PowerIndex, Path, HwRate); -+#endif -+#if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ ret = phydm_write_txagc_1byte_8821c(pDM_Odm, PowerIndex, Path, HwRate); -+#endif -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ SetCurrentTxAGC(pDM_Odm->priv, Path, HwRate, (u1Byte)PowerIndex); -+#endif -+ -+ } else { -+ u1Byte i; -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ ret = config_phydm_write_txagc_8822b(pDM_Odm, PowerIndex, Path, HwRate); -+#endif -+#if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ ret = config_phydm_write_txagc_8821c(pDM_Odm, PowerIndex, Path, HwRate); -+#endif -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ for (i = 0; i < 4; i++) -+ SetCurrentTxAGC(pDM_Odm->priv, Path, (HwRate + i), (u1Byte)PowerIndex); -+#endif -+ } -+ } -+#endif -+ -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ ret = config_phydm_write_txagc_8197f(pDM_Odm, PowerIndex, Path, HwRate); -+#endif -+ -+ return ret; -+} -+ -+u1Byte -+phydm_api_get_txagc( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E Path, -+ IN u1Byte HwRate -+ ) -+{ -+ u1Byte ret = 0; -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ ret = config_phydm_read_txagc_8822b(pDM_Odm, Path, HwRate); -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ ret = config_phydm_read_txagc_8197f(pDM_Odm, Path, HwRate); -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8821C) -+ ret = config_phydm_read_txagc_8821c(pDM_Odm, Path, HwRate); -+#endif -+ -+ return ret; -+} -+ -+ -+BOOLEAN -+phydm_api_switch_bw_channel( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte central_ch, -+ IN u1Byte primary_ch_idx, -+ IN ODM_BW_E bandwidth -+ ) -+{ -+ BOOLEAN ret = FALSE; -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ ret = config_phydm_switch_channel_bw_8822b(pDM_Odm, central_ch, primary_ch_idx, bandwidth); -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ ret = config_phydm_switch_channel_bw_8197f(pDM_Odm, central_ch, primary_ch_idx, bandwidth); -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8821C) -+ ret = config_phydm_switch_channel_bw_8821c(pDM_Odm, central_ch, primary_ch_idx, bandwidth); -+#endif -+ -+ return ret; -+} -+ -+BOOLEAN -+phydm_api_trx_mode( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_PATH_E TxPath, -+ IN ODM_RF_PATH_E RxPath, -+ IN BOOLEAN bTx2Path -+ ) -+{ -+ BOOLEAN ret = FALSE; -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ ret = config_phydm_trx_mode_8822b(pDM_Odm, TxPath, RxPath, bTx2Path); -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ ret = config_phydm_trx_mode_8197f(pDM_Odm, TxPath, RxPath, bTx2Path); -+#endif -+ -+ return ret; -+} -+#endif -+ -+VOID -+phydm_get_per_path_txagc( -+ IN PVOID pDM_VOID, -+ IN u1Byte path, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte rate_idx; -+ u1Byte txagc; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+#if ((RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) -+ if (((pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F)) && (path <= ODM_RF_PATH_B)) || -+ ((pDM_Odm->SupportICType & (ODM_RTL8821C)) && (path <= ODM_RF_PATH_A))) { -+ for (rate_idx = 0; rate_idx <= 0x53; rate_idx++) { -+ if (rate_idx == ODM_RATE1M) -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-35s\n", "CCK====>")); -+ else if (rate_idx == ODM_RATE6M) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "OFDM====>")); -+ else if (rate_idx == ODM_RATEMCS0) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 1ss====>")); -+ else if (rate_idx == ODM_RATEMCS8) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 2ss====>")); -+ else if (rate_idx == ODM_RATEMCS16) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 3ss====>")); -+ else if (rate_idx == ODM_RATEMCS24) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 4ss====>")); -+ else if (rate_idx == ODM_RATEVHTSS1MCS0) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 1ss====>")); -+ else if (rate_idx == ODM_RATEVHTSS2MCS0) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 2ss====>")); -+ else if (rate_idx == ODM_RATEVHTSS3MCS0) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 3ss====>")); -+ else if (rate_idx == ODM_RATEVHTSS4MCS0) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 4ss====>")); -+ -+ txagc = phydm_api_get_txagc(pDM_Odm, (ODM_RF_RADIO_PATH_E) path, rate_idx); -+ if (config_phydm_read_txagc_check(txagc)) -+ PHYDM_SNPRINTF((output + used, out_len - used, " 0x%02x ", txagc)); -+ else -+ PHYDM_SNPRINTF((output + used, out_len - used, " 0x%s ", "xx")); -+ } -+ } -+#endif -+} -+ -+ -+VOID -+phydm_get_txagc( -+ IN PVOID pDM_VOID, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ /* Path-A */ -+ PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "Path-A====================")); -+ phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_A, _used, output, _out_len); -+ -+ /* Path-B */ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "Path-B====================")); -+ phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_B, _used, output, _out_len); -+ -+ /* Path-C */ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "Path-C====================")); -+ phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_C, _used, output, _out_len); -+ -+ /* Path-D */ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "Path-D====================")); -+ phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_D, _used, output, _out_len); -+ -+} -+ -+VOID -+phydm_set_txagc( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+/*dm_value[1] = Path*/ -+/*dm_value[2] = HwRate*/ -+/*dm_value[3] = PowerIndex*/ -+ -+#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F|ODM_RTL8821C)) { -+ if (dm_value[1] <= 1) { -+ if ((u1Byte)dm_value[2] != 0xff) { -+ if (phydm_api_set_txagc(pDM_Odm, dm_value[3], (ODM_RF_RADIO_PATH_E) dm_value[1], (u1Byte)dm_value[2], TRUE)) -+ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s%x\n", "Write path-", dm_value[1], "rate index-0x", dm_value[2], " = 0x", dm_value[3])); -+ else -+ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s\n", "Write path-", (dm_value[1] & 0x1), "rate index-0x", (dm_value[2] & 0x7f), " fail")); -+ } else { -+ u1Byte i; -+ u4Byte power_index; -+ BOOLEAN status = TRUE; -+ -+ power_index = (dm_value[3] & 0x3f); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8821C)) { -+ power_index = (power_index << 24)|(power_index << 16)|(power_index << 8)|(power_index); -+ -+ for (i = 0; i < ODM_RATEVHTSS2MCS9; i += 4) -+ status = (status & phydm_api_set_txagc(pDM_Odm, power_index, (ODM_RF_RADIO_PATH_E) dm_value[1], i, FALSE)); -+ } else if (pDM_Odm->SupportICType & ODM_RTL8197F) { -+ for (i = 0; i <= ODM_RATEMCS15; i++) -+ status = (status & phydm_api_set_txagc(pDM_Odm, power_index, (ODM_RF_RADIO_PATH_E) dm_value[1], i, FALSE)); -+ } -+ -+ if (status) -+ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x\n", "Write all TXAGC of path-", dm_value[1], " = 0x", dm_value[3])); -+ else -+ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s\n", "Write all TXAGC of path-", dm_value[1], " fail")); -+ } -+ } else { -+ PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s\n", "Write path-", (dm_value[1] & 0x1), "rate index-0x", (dm_value[2] & 0x7f), " fail")); -+ } -+ } -+#endif -+} -+ -+VOID -+phydm_debug_trace( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte pre_debug_components, one = 1; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ pre_debug_components = pDM_Odm->DebugComponents; -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n%s\n", "================================")); -+ if (dm_value[0] == 100) { -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Debug Message] PhyDM Selection")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))DIG\n", ((pDM_Odm->DebugComponents & ODM_COMP_DIG) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))RA_MASK\n", ((pDM_Odm->DebugComponents & ODM_COMP_RA_MASK) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))DYNAMIC_TXPWR\n", ((pDM_Odm->DebugComponents & ODM_COMP_DYNAMIC_TXPWR) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))FA_CNT\n", ((pDM_Odm->DebugComponents & ODM_COMP_FA_CNT) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "04. (( %s ))RSSI_MONITOR\n", ((pDM_Odm->DebugComponents & ODM_COMP_RSSI_MONITOR) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "05. (( %s ))SNIFFER\n", ((pDM_Odm->DebugComponents & ODM_COMP_SNIFFER) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "06. (( %s ))ANT_DIV\n", ((pDM_Odm->DebugComponents & ODM_COMP_ANT_DIV) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "07. (( %s ))DFS\n", ((pDM_Odm->DebugComponents & ODM_COMP_DFS) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "08. (( %s ))NOISY_DETECT\n", ((pDM_Odm->DebugComponents & ODM_COMP_NOISY_DETECT) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "09. (( %s ))RATE_ADAPTIVE\n", ((pDM_Odm->DebugComponents & ODM_COMP_RATE_ADAPTIVE) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "10. (( %s ))PATH_DIV\n", ((pDM_Odm->DebugComponents & ODM_COMP_PATH_DIV) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "12. (( %s ))DYNAMIC_PRICCA\n", ((pDM_Odm->DebugComponents & ODM_COMP_DYNAMIC_PRICCA) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "14. (( %s ))MP\n", ((pDM_Odm->DebugComponents & ODM_COMP_MP) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "15. (( %s ))CFO_TRACKING\n", ((pDM_Odm->DebugComponents & ODM_COMP_CFO_TRACKING) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "16. (( %s ))ACS\n", ((pDM_Odm->DebugComponents & ODM_COMP_ACS) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "17. (( %s ))ADAPTIVITY\n", ((pDM_Odm->DebugComponents & PHYDM_COMP_ADAPTIVITY) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "18. (( %s ))RA_DBG\n", ((pDM_Odm->DebugComponents & PHYDM_COMP_RA_DBG) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "19. (( %s ))TXBF\n", ((pDM_Odm->DebugComponents & PHYDM_COMP_TXBF) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "20. (( %s ))EDCA_TURBO\n", ((pDM_Odm->DebugComponents & ODM_COMP_EDCA_TURBO) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "22. (( %s ))FW_DEBUG_TRACE\n", ((pDM_Odm->DebugComponents & ODM_FW_DEBUG_TRACE) ? ("V") : (".")))); -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "24. (( %s ))TX_PWR_TRACK\n", ((pDM_Odm->DebugComponents & ODM_COMP_TX_PWR_TRACK) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "26. (( %s ))CALIBRATION\n", ((pDM_Odm->DebugComponents & ODM_COMP_CALIBRATION) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "28. (( %s ))PHY_CONFIG\n", ((pDM_Odm->DebugComponents & ODM_PHY_CONFIG) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "29. (( %s ))INIT\n", ((pDM_Odm->DebugComponents & ODM_COMP_INIT) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "30. (( %s ))COMMON\n", ((pDM_Odm->DebugComponents & ODM_COMP_COMMON) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "31. (( %s ))API\n", ((pDM_Odm->DebugComponents & ODM_COMP_API) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); -+ -+ } else if (dm_value[0] == 101) { -+ pDM_Odm->DebugComponents = 0; -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Disable all debug components")); -+ } else { -+ if (dm_value[1] == 1) { /*enable*/ -+ pDM_Odm->DebugComponents |= (one << dm_value[0]); -+ } else if (dm_value[1] == 2) { /*disable*/ -+ pDM_Odm->DebugComponents &= ~(one << dm_value[0]); -+ } else -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable")); -+ } -+ PHYDM_SNPRINTF((output + used, out_len - used, "pre-DbgComponents = 0x%x\n", pre_debug_components)); -+ PHYDM_SNPRINTF((output + used, out_len - used, "Curr-DbgComponents = 0x%x\n", pDM_Odm->DebugComponents)); -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); -+} -+ -+VOID -+phydm_fw_debug_trace( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte pre_fw_debug_components, one = 1; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ pre_fw_debug_components = pDM_Odm->fw_DebugComponents; -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n%s\n", "================================")); -+ if (dm_value[0] == 100) { -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[FW Debug Component]")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))RA\n", ((pDM_Odm->fw_DebugComponents & PHYDM_FW_COMP_RA) ? ("V") : (".")))); -+ -+ if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES){ -+ PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))MU\n", ((pDM_Odm->fw_DebugComponents & PHYDM_FW_COMP_MU) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))Path Div\n", ((pDM_Odm->fw_DebugComponents & PHYDM_FW_COMP_PHY_CONFIG) ? ("V") : (".")))); -+ PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))Phy Config\n", ((pDM_Odm->fw_DebugComponents & PHYDM_FW_COMP_PHY_CONFIG) ? ("V") : (".")))); -+ } -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); -+ -+ } else { -+ if (dm_value[0] == 101) { -+ pDM_Odm->fw_DebugComponents = 0; -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Clear all fw debug components")); -+ } else { -+ if (dm_value[1] == 1) { /*enable*/ -+ pDM_Odm->fw_DebugComponents |= (one << dm_value[0]); -+ } else if (dm_value[1] == 2) { /*disable*/ -+ pDM_Odm->fw_DebugComponents &= ~(one << dm_value[0]); -+ } else -+ PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable")); -+ } -+ -+ if (pDM_Odm->fw_DebugComponents == 0) { -+ pDM_Odm->DebugComponents &= ~ODM_FW_DEBUG_TRACE; -+ phydm_fw_trace_en_h2c(pDM_Odm, FALSE, pDM_Odm->fw_DebugComponents, dm_value[2], dm_value[3]); /*H2C to enable C2H Msg*/ -+ } else { -+ pDM_Odm->DebugComponents |= ODM_FW_DEBUG_TRACE; -+ phydm_fw_trace_en_h2c(pDM_Odm, TRUE, pDM_Odm->fw_DebugComponents, dm_value[2], dm_value[3]); /*H2C to enable C2H Msg*/ -+ } -+ } -+} -+ -+VOID -+phydm_DumpBbReg( -+ IN PVOID pDM_VOID, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte Addr = 0; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ -+ /* BB Reg, For Nseries IC we only need to dump page8 to pageF using 3 digits*/ -+ for (Addr = 0x800; Addr < 0xfff; Addr += 4) { -+ if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%03x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); -+ else -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); -+ } -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8822B | ODM_RTL8814A | ODM_RTL8821C)) { -+ -+ if (pDM_Odm->RFType > ODM_2T2R) { -+ for (Addr = 0x1800; Addr < 0x18ff; Addr += 4) -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); -+ } -+ -+ if (pDM_Odm->RFType > ODM_3T3R) { -+ for (Addr = 0x1a00; Addr < 0x1aff; Addr += 4) -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); -+ } -+ -+ for (Addr = 0x1900; Addr < 0x19ff; Addr += 4) -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); -+ -+ for (Addr = 0x1c00; Addr < 0x1cff; Addr += 4) -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); -+ -+ for (Addr = 0x1f00; Addr < 0x1fff; Addr += 4) -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); -+ } -+} -+ -+VOID -+phydm_DumpAllReg( -+ IN PVOID pDM_VOID, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte Addr = 0; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ /* dump MAC register */ -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "MAC==========\n")); -+ for (Addr = 0; Addr < 0x7ff; Addr += 4) -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); -+ -+ for (Addr = 0x1000; Addr < 0x17ff; Addr += 4) -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); -+ -+ /* dump BB register */ -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "BB==========\n")); -+ phydm_DumpBbReg(pDM_Odm, &used, output, &out_len); -+ -+ /* dump RF register */ -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "RF-A==========\n")); -+ for (Addr = 0; Addr < 0xFF; Addr++) -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%02x 0x%05x,\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Addr, bRFRegOffsetMask))); -+ -+ if (pDM_Odm->RFType > ODM_1T1R) { -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "RF-B==========\n")); -+ for (Addr = 0; Addr < 0xFF; Addr++) -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%02x 0x%05x,\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, Addr, bRFRegOffsetMask))); -+ } -+ -+ if (pDM_Odm->RFType > ODM_2T2R) { -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "RF-C==========\n")); -+ for (Addr = 0; Addr < 0xFF; Addr++) -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%02x 0x%05x,\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_C, Addr, bRFRegOffsetMask))); -+ } -+ -+ if (pDM_Odm->RFType > ODM_3T3R) { -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "RF-D==========\n")); -+ for (Addr = 0; Addr < 0xFF; Addr++) -+ PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%02x 0x%05x,\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_D, Addr, bRFRegOffsetMask))); -+ } -+} -+ -+VOID -+phydm_EnableBigJump( -+ IN PDM_ODM_T pDM_Odm, -+ IN BOOLEAN state -+ ) -+{ -+#if (RTL8822B_SUPPORT == 1) -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ if (state == FALSE) { -+ pDM_Odm->DM_DigTable.enableAdjustBigJump = FALSE; -+ ODM_SetBBReg(pDM_Odm, 0x8c8, 0xfe, ((pDM_DigTable->bigJumpStep3<<5)|(pDM_DigTable->bigJumpStep2<<3)|pDM_DigTable->bigJumpStep1)); -+ } else -+ pDM_Odm->DM_DigTable.enableAdjustBigJump = TRUE; -+#endif -+} -+ -+#if (RTL8822B_SUPPORT == 1) -+ -+VOID -+phydm_showRxRate( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "=====Rx SU Rate Statistics=====\n")); -+ PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS0 = %d, 1SS MCS1 = %d, 1SS MCS2 = %d, 1SS MCS 3 = %d\n", -+ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[0], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[1], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[2], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[3])); -+ PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS4 = %d, 1SS MCS5 = %d, 1SS MCS6 = %d, 1SS MCS 7 = %d\n", -+ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[4], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[5], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[6], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[7])); -+ PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS8 = %d, 1SS MCS9 = %d\n", -+ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[8], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[9])); -+ PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS0 = %d, 2SS MCS1 = %d, 2SS MCS2 = %d, 2SS MCS 3 = %d\n", -+ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[10], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[11], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[12], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[13])); -+ PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS4 = %d, 2SS MCS5 = %d, 2SS MCS6 = %d, 2SS MCS 7 = %d\n", -+ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[14], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[15], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[16], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[17])); -+ PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS8 = %d, 2SS MCS9 = %d\n", -+ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[18], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[19])); -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "=====Rx MU Rate Statistics=====\n")); -+ PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS0 = %d, 1SS MCS1 = %d, 1SS MCS2 = %d, 1SS MCS 3 = %d\n", -+ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[0], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[1], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[2], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[3])); -+ PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS4 = %d, 1SS MCS5 = %d, 1SS MCS6 = %d, 1SS MCS 7 = %d\n", -+ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[4], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[5], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[6], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[7])); -+ PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS8 = %d, 1SS MCS9 = %d\n", -+ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[8], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[9])); -+ PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS0 = %d, 2SS MCS1 = %d, 2SS MCS2 = %d, 2SS MCS 3 = %d\n", -+ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[10], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[11], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[12], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[13])); -+ PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS4 = %d, 2SS MCS5 = %d, 2SS MCS6 = %d, 2SS MCS 7 = %d\n", -+ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[14], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[15], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[16], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[17])); -+ PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS8 = %d, 2SS MCS9 = %d\n", -+ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[18], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[19])); -+ -+} -+ -+#endif -+ -+ -+struct _PHYDM_COMMAND { -+ char name[16]; -+ u1Byte id; -+}; -+ -+enum PHYDM_CMD_ID { -+ PHYDM_HELP, -+ PHYDM_DEMO, -+ PHYDM_RA, -+ PHYDM_PROFILE, -+ PHYDM_ANTDIV, -+ PHYDM_PATHDIV, -+ PHYDM_DEBUG, -+ PHYDM_FW_DEBUG, -+ PHYDM_SUPPORT_ABILITY, -+ PHYDM_GET_TXAGC, -+ PHYDM_SET_TXAGC, -+ PHYDM_SMART_ANT, -+ PHYDM_API, -+ PHYDM_TRX_PATH, -+ PHYDM_LA_MODE, -+ PHYDM_DUMP_REG, -+ PHYDM_MU_MIMO, -+ PHYDM_HANG, -+ PHYDM_BIG_JUMP, -+ PHYDM_SHOW_RXRATE, -+ PHYDM_NBI_EN, -+ PHYDM_CSI_MASK_EN, -+ PHYDM_DFS, -+ PHYDM_IQK, -+ PHYDM_NHM, -+ PHYDM_CLM, -+ PHYDM_BB_INFO, -+ PHYDM_TXBF, -+ PHYDM_PAUSE_DIG_EN, -+ PHYDM_H2C, -+ PHYDM_ANT_SWITCH -+}; -+ -+struct _PHYDM_COMMAND phy_dm_ary[] = { -+ {"-h", PHYDM_HELP}, /*do not move this element to other position*/ -+ {"demo", PHYDM_DEMO}, /*do not move this element to other position*/ -+ {"ra", PHYDM_RA}, -+ {"profile", PHYDM_PROFILE}, -+ {"antdiv", PHYDM_ANTDIV}, -+ {"pathdiv", PHYDM_PATHDIV}, -+ {"dbg", PHYDM_DEBUG}, -+ {"fw_dbg", PHYDM_FW_DEBUG}, -+ {"ability", PHYDM_SUPPORT_ABILITY}, -+ {"get_txagc", PHYDM_GET_TXAGC}, -+ {"set_txagc", PHYDM_SET_TXAGC}, -+ {"smtant", PHYDM_SMART_ANT}, -+ {"api", PHYDM_API}, -+ {"trxpath", PHYDM_TRX_PATH}, -+ {"lamode", PHYDM_LA_MODE}, -+ {"dumpreg", PHYDM_DUMP_REG}, -+ {"mu", PHYDM_MU_MIMO}, -+ {"hang", PHYDM_HANG}, -+ {"bigjump", PHYDM_BIG_JUMP}, -+ {"rxrate", PHYDM_SHOW_RXRATE}, -+ {"nbi", PHYDM_NBI_EN}, -+ {"csi_mask", PHYDM_CSI_MASK_EN}, -+ {"dfs", PHYDM_DFS}, -+ {"iqk", PHYDM_IQK}, -+ {"nhm", PHYDM_NHM}, -+ {"clm", PHYDM_CLM}, -+ {"bbinfo", PHYDM_BB_INFO}, -+ {"txbf", PHYDM_TXBF}, -+ {"pause_dig", PHYDM_PAUSE_DIG_EN}, -+ {"h2c", PHYDM_H2C}, -+ {"ant_switch", PHYDM_ANT_SWITCH} -+}; -+ -+VOID -+phydm_cmd_parser( -+ IN PDM_ODM_T pDM_Odm, -+ IN char input[][MAX_ARGV], -+ IN u4Byte input_num, -+ IN u1Byte flag, -+ OUT char *output, -+ IN u4Byte out_len -+) -+{ -+ u4Byte used = 0; -+ u1Byte id = 0; -+ int var1[10] = {0}; -+ int i, input_idx = 0, phydm_ary_size; -+ char help[] = "-h"; -+ -+ if (flag == 0) { -+ PHYDM_SNPRINTF((output + used, out_len - used, "GET, nothing to print\n")); -+ return; -+ } -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n")); -+ -+ //Parsing Cmd ID -+ if (input_num) { -+ -+ phydm_ary_size = sizeof(phy_dm_ary) / sizeof(struct _PHYDM_COMMAND); -+ for (i = 0; i < phydm_ary_size; i++) { -+ if (strcmp(phy_dm_ary[i].name, input[0]) == 0) { -+ id = phy_dm_ary[i].id; -+ break; -+ } -+ } -+ if (i == phydm_ary_size) { -+ PHYDM_SNPRINTF((output + used, out_len - used, "SET, command not found!\n")); -+ return; -+ } -+ } -+ -+ switch (id) { -+ -+ case PHYDM_HELP: -+ { -+ PHYDM_SNPRINTF((output + used, out_len - used, "BB cmd ==>\n")); -+ for (i=0; i < phydm_ary_size-2; i++) { -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, " %-5d: %s\n", i, phy_dm_ary[i+2].name)); -+ /**/ -+ } -+ } -+ break; -+ -+ case PHYDM_DEMO: /*echo demo 10 0x3a z abcde >cmd*/ -+ { -+ u4Byte directory = 0; -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) -+ char char_temp; -+ #else -+ u4Byte char_temp = ' '; -+ #endif -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &directory); -+ PHYDM_SNPRINTF((output + used, out_len - used, "Decimal Value = %d\n", directory)); -+ PHYDM_SSCANF(input[2], DCMD_HEX, &directory); -+ PHYDM_SNPRINTF((output + used, out_len - used, "Hex Value = 0x%x\n", directory)); -+ PHYDM_SSCANF(input[3], DCMD_CHAR, &char_temp); -+ PHYDM_SNPRINTF((output + used, out_len - used, "Char = %c\n", char_temp)); -+ PHYDM_SNPRINTF((output + used, out_len - used, "String = %s\n", input[4])); -+ } -+ break; -+ -+ case PHYDM_RA: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ -+ /*PHYDM_SNPRINTF((output + used, out_len - used, "new SET, RA_var[%d]= (( %d ))\n", i , var1[i]));*/ -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_RA_debug\n"));*/ -+ #if (defined(CONFIG_RA_DBG_CMD)) -+ odm_RA_debug((PVOID)pDM_Odm, (pu4Byte) var1); -+ #else -+ phydm_RA_debug_PCR(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ #endif -+ } -+ -+ -+ break; -+ -+ case PHYDM_ANTDIV: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, PATHDIV_var[%d]= (( %d ))\n", i , var1[i]));*/ -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_PATHDIV_debug\n"));*/ -+ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ phydm_antdiv_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ #endif -+ } -+ -+ break; -+ -+ case PHYDM_PATHDIV: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, PATHDIV_var[%d]= (( %d ))\n", i , var1[i]));*/ -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_PATHDIV_debug\n"));*/ -+#if (defined(CONFIG_PATH_DIVERSITY)) -+ odm_pathdiv_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+#endif -+ } -+ -+ break; -+ -+ case PHYDM_DEBUG: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, Debug_var[%d]= (( %d ))\n", i , var1[i]));*/ -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_debug_comp\n"));*/ -+ phydm_debug_trace(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ } -+ -+ -+ break; -+ -+ case PHYDM_FW_DEBUG: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) -+ phydm_fw_debug_trace(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ -+ break; -+ -+ case PHYDM_SUPPORT_ABILITY: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, support ablity_var[%d]= (( %d ))\n", i , var1[i]));*/ -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ /*PHYDM_SNPRINTF((output+used, out_len-used, "support ablity\n"));*/ -+ phydm_support_ability_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ } -+ -+ break; -+ -+ case PHYDM_SMART_ANT: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ phydm_hl_smart_ant_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ #endif -+ #endif -+ } -+ -+ break; -+ -+ case PHYDM_API: -+#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) -+ { -+ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F | ODM_RTL8821C)) { -+ BOOLEAN bEnableDbgMode; -+ u1Byte central_ch, primary_ch_idx, bandwidth; -+ -+ for (i = 0; i < 4; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ -+ bEnableDbgMode = (BOOLEAN)var1[0]; -+ central_ch = (u1Byte) var1[1]; -+ primary_ch_idx = (u1Byte) var1[2]; -+ bandwidth = (ODM_BW_E) var1[3]; -+ -+ if (bEnableDbgMode) { -+ pDM_Odm->bDisablePhyApi = FALSE; -+ phydm_api_switch_bw_channel(pDM_Odm, central_ch, primary_ch_idx, (ODM_BW_E) bandwidth); -+ pDM_Odm->bDisablePhyApi = TRUE; -+ PHYDM_SNPRINTF((output+used, out_len-used, "central_ch = %d, primary_ch_idx = %d, bandwidth = %d\n", central_ch, primary_ch_idx, bandwidth)); -+ } else { -+ pDM_Odm->bDisablePhyApi = FALSE; -+ PHYDM_SNPRINTF((output+used, out_len-used, "Disable API debug mode\n")); -+ } -+ } else -+ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support PHYDM API function\n")); -+ } -+#else -+ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support PHYDM API function\n")); -+#endif -+ break; -+ -+ case PHYDM_PROFILE: /*echo profile, >cmd*/ -+ phydm_BasicProfile(pDM_Odm, &used, output, &out_len); -+ break; -+ -+ case PHYDM_GET_TXAGC: -+ phydm_get_txagc(pDM_Odm, &used, output, &out_len); -+ break; -+ -+ case PHYDM_SET_TXAGC: -+ { -+ BOOLEAN bEnableDbgMode; -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ input_idx++; -+ } -+ } -+ -+ if ((strcmp(input[1], help) == 0)) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "{En} {pathA~D(0~3)} {rate_idx(Hex), All_rate:0xff} {txagc_idx (Hex)}\n")); -+ /**/ -+ -+ } else { -+ -+ bEnableDbgMode = (BOOLEAN)var1[0]; -+ if (bEnableDbgMode) { -+ pDM_Odm->bDisablePhyApi = FALSE; -+ phydm_set_txagc(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ pDM_Odm->bDisablePhyApi = TRUE; -+ } else { -+ pDM_Odm->bDisablePhyApi = FALSE; -+ PHYDM_SNPRINTF((output+used, out_len-used, "Disable API debug mode\n")); -+ } -+ } -+ } -+ break; -+ -+ case PHYDM_TRX_PATH: -+ -+ for (i = 0; i < 4; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ #if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F)) { -+ u1Byte TxPath, RxPath; -+ BOOLEAN bEnableDbgMode, bTx2Path; -+ -+ bEnableDbgMode = (BOOLEAN)var1[0]; -+ TxPath = (u1Byte) var1[1]; -+ RxPath = (u1Byte) var1[2]; -+ bTx2Path = (BOOLEAN) var1[3]; -+ -+ if (bEnableDbgMode) { -+ pDM_Odm->bDisablePhyApi = FALSE; -+ phydm_api_trx_mode(pDM_Odm, (ODM_RF_PATH_E) TxPath, (ODM_RF_PATH_E) RxPath, bTx2Path); -+ pDM_Odm->bDisablePhyApi = TRUE; -+ PHYDM_SNPRINTF((output+used, out_len-used, "TxPath = 0x%x, RxPath = 0x%x, bTx2Path = %d\n", TxPath, RxPath, bTx2Path)); -+ } else { -+ pDM_Odm->bDisablePhyApi = FALSE; -+ PHYDM_SNPRINTF((output+used, out_len-used, "Disable API debug mode\n")); -+ } -+ } else -+ #endif -+ phydm_config_trx_path(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ -+ break; -+ -+ case PHYDM_LA_MODE: -+#if (PHYDM_LA_MODE_SUPPORT == 1) -+ -+ if (pDM_Odm->SupportICType & PHYDM_IC_SUPPORT_LA_MODE) { -+ u2Byte PollingTime; -+ u1Byte TrigSel, TrigSigSel, DmaDataSigSel, TriggerTime_unit_num; -+ BOOLEAN bEnableLaMode, bTriggerEdge; -+ u4Byte DbgPort, TriggerTime_mu_sec; -+ u1Byte sampling_rate = 0; -+ -+ for (i = 0; i < 6; i++) { -+ if (input[i + 1]) -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ } -+ -+ bEnableLaMode = (BOOLEAN)var1[0]; -+ DbgPrint("echo cmd input_num = %d\n", input_num); -+ /* if ((strcmp(input[1], help) == 0) && (input_num == 2)) {*/ -+ if ((strcmp(input[1], help) == 0)) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "{En} {0:BB,1:MAC} {BB:DbgPort[bit],MAC:0-ok/1-fail/2-cca} {RptFormat} {TrigTime} \n {PollingTime} {DbgPort} {0:P_Edge, 1:N_Edge} {SpRate:0-80M,1-40M,2-20M} {Capture num}\n")); -+ /**/ -+ /*} else if ((bEnableLaMode == 1) && (input_num == 10)) {*/ -+ } else if ((bEnableLaMode == 1)) { -+ TrigSel = (u1Byte)var1[1]; /*0: BB, 1: MAC*/ -+ TrigSigSel = (u1Byte)var1[2]; -+ DmaDataSigSel = (u1Byte)var1[3]; -+ TriggerTime_mu_sec = var1[4]; /*unit: us*/ -+ PollingTime = (((u1Byte)var1[5]) << 6); /*unit: ms*/ -+ -+ PHYDM_SSCANF(input[7], DCMD_HEX, &var1[6]); -+ PHYDM_SSCANF(input[8], DCMD_DECIMAL, &var1[7]); -+ PHYDM_SSCANF(input[9], DCMD_DECIMAL, &var1[8]); -+ PHYDM_SSCANF(input[10], DCMD_DECIMAL, &var1[9]); -+ -+ DbgPort = (u4Byte)var1[6]; -+ bTriggerEdge = (BOOLEAN) var1[7]; -+ sampling_rate = var1[8] & 0x7; -+ -+ #if 1 -+ TriggerTime_unit_num = phydm_la_mode_mac_setting(pDM_Odm, TriggerTime_mu_sec); -+ phydm_la_mode_bb_setting(pDM_Odm, DbgPort, bTriggerEdge, sampling_rate); -+ #else -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ ODM_SetBBReg(pDM_Odm, 0x198C , BIT2|BIT1|BIT0, 7); /*disable dbg clk gating*/ -+ ODM_SetBBReg(pDM_Odm, 0x8FC, bMaskDWord, DbgPort); -+ ODM_SetBBReg(pDM_Odm, 0x95C , BIT31, bTriggerEdge); /*0: posedge, 1: negedge*/ -+ ODM_SetBBReg(pDM_Odm, 0x95c, 0xe0, sampling_rate); -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, DbgPort); -+ ODM_SetBBReg(pDM_Odm, 0x9A0 , BIT31, bTriggerEdge); /*0: posedge, 1: negedge*/ -+ ODM_SetBBReg(pDM_Odm, 0x9A0, 0xe0, sampling_rate); -+ } -+ #endif -+ -+ pDM_Odm->ADCSmp_dbg_port = DbgPort; -+ pDM_Odm->ADCSmp_trigger_edge = bTriggerEdge; -+ pDM_Odm->ADCsmp_smp_rate = sampling_rate; -+ pDM_Odm->ADCSmp_count = var1[9]; -+ -+ DbgPrint("echo lamode %d %d %d %d %d %d %x %d %d %d\n", var1[0], var1[1], var1[2], var1[3], var1[4], var1[5], var1[6], var1[7], var1[8], var1[9]); -+ -+ ADCSmp_Set(pDM_Odm, (RT_ADCSMP_TRIG_SEL) TrigSel, (RT_ADCSMP_TRIG_SIG_SEL) TrigSigSel, DmaDataSigSel, TriggerTime_unit_num, PollingTime); -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "TrigSel = ((%s)), TrigSigSel = ((%d)), DmaDataSigSel = ((%d))\n", ((TrigSel)?"MAC":"BB"), TrigSigSel, DmaDataSigSel)); -+ PHYDM_SNPRINTF((output+used, out_len-used, "TriggerTime = ((%d * %d us)), PollingTime = ((%d)), sampling rate = ((%d MHz))\n", -+ TriggerTime_unit_num, ((pDM_Odm->ADCsmp_time_unit == 0) ? 1 : (2<<(pDM_Odm->ADCsmp_time_unit-1))), PollingTime, (80>>sampling_rate))); -+ } else { -+ ADCSmp_Stop(pDM_Odm); -+ PHYDM_SNPRINTF((output+used, out_len-used, "Disable LA mode\n")); -+ } -+ } else -+ #endif -+ PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support LA mode\n")); -+ break; -+ -+ case PHYDM_DUMP_REG: -+ { -+ u1Byte type = 0; -+ -+ if (input[1]) { -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ type = (u1Byte)var1[0]; -+ } -+ -+ if (type == 0) -+ phydm_DumpBbReg(pDM_Odm, &used, output, &out_len); -+ else if (type == 1) -+ phydm_DumpAllReg(pDM_Odm, &used, output, &out_len); -+ } -+ break; -+ -+ case PHYDM_MU_MIMO: -+#if (RTL8822B_SUPPORT == 1) -+ -+ if (input[1]) -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ else -+ var1[0] = 0; -+ -+ if (var1[0] == 1) { -+ int index, ptr; -+ u4Byte Dword_H, Dword_L; -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "Get MU BFee CSI\n")); -+ ODM_SetBBReg(pDM_Odm, 0x9e8, BIT17|BIT16, 2); /*Read BFee*/ -+ ODM_SetBBReg(pDM_Odm, 0x1910, BIT15, 1); /*Select BFee's CSI report*/ -+ ODM_SetBBReg(pDM_Odm, 0x19b8, BIT6, 1); /*set as CSI report*/ -+ ODM_SetBBReg(pDM_Odm, 0x19a8, 0xFFFF, 0xFFFF); /*disable gated_clk*/ -+ -+ for (index = 0; index < 80; index++) { -+ ptr = index + 256; -+ if (ptr > 311) -+ ptr -= 312; -+ ODM_SetBBReg(pDM_Odm, 0x1910, 0x03FF0000, ptr); /*Select Address*/ -+ Dword_H = ODM_GetBBReg(pDM_Odm, 0xF74, bMaskDWord); -+ Dword_L = ODM_GetBBReg(pDM_Odm, 0xF5C, bMaskDWord); -+ if (index % 2 == 0) -+ PHYDM_SNPRINTF((output+used, out_len-used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", -+ Dword_L & bMaskByte0, (Dword_L & bMaskByte1) >> 8, (Dword_L & bMaskByte2) >> 16, (Dword_L & bMaskByte3) >> 24, -+ Dword_H & bMaskByte0, (Dword_H & bMaskByte1) >> 8, (Dword_H & bMaskByte2) >> 16, (Dword_H & bMaskByte3) >> 24)); -+ else -+ PHYDM_SNPRINTF((output+used, out_len-used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", -+ Dword_L & bMaskByte0, (Dword_L & bMaskByte1) >> 8, (Dword_L & bMaskByte2) >> 16, (Dword_L & bMaskByte3) >> 24, -+ Dword_H & bMaskByte0, (Dword_H & bMaskByte1) >> 8, (Dword_H & bMaskByte2) >> 16, (Dword_H & bMaskByte3) >> 24)); -+ } -+ } else if (var1[0] == 2) { -+ int index, ptr; -+ u4Byte Dword_H, Dword_L; -+ -+ PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var1[1]); -+ PHYDM_SNPRINTF((output+used, out_len-used, "Get MU BFer's STA%d CSI\n", var1[1])); -+ ODM_SetBBReg(pDM_Odm, 0x9e8, BIT24, 0); /*Read BFer*/ -+ ODM_SetBBReg(pDM_Odm, 0x9e8, BIT25, 1); /*enable Read/Write RAM*/ -+ ODM_SetBBReg(pDM_Odm, 0x9e8, BIT30|BIT29|BIT28, var1[1]); /*read which STA's CSI report*/ -+ ODM_SetBBReg(pDM_Odm, 0x1910, BIT15, 0); /*select BFer's CSI*/ -+ ODM_SetBBReg(pDM_Odm, 0x19e0, 0x00003FC0, 0xFF); /*disable gated_clk*/ -+ -+ for (index = 0; index < 80; index++) { -+ ptr = index + 256; -+ if (ptr > 311) -+ ptr -= 312; -+ ODM_SetBBReg(pDM_Odm, 0x1910, 0x03FF0000, ptr); /*Select Address*/ -+ Dword_H = ODM_GetBBReg(pDM_Odm, 0xF74, bMaskDWord); -+ Dword_L = ODM_GetBBReg(pDM_Odm, 0xF5C, bMaskDWord); -+ if (index % 2 == 0) -+ PHYDM_SNPRINTF((output+used, out_len-used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", -+ Dword_L & bMaskByte0, (Dword_L & bMaskByte1) >> 8, (Dword_L & bMaskByte2) >> 16, (Dword_L & bMaskByte3) >> 24, -+ Dword_H & bMaskByte0, (Dword_H & bMaskByte1) >> 8, (Dword_H & bMaskByte2) >> 16, (Dword_H & bMaskByte3) >> 24)); -+ else -+ PHYDM_SNPRINTF((output+used, out_len-used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", -+ Dword_L & bMaskByte0, (Dword_L & bMaskByte1) >> 8, (Dword_L & bMaskByte2) >> 16, (Dword_L & bMaskByte3) >> 24, -+ Dword_H & bMaskByte0, (Dword_H & bMaskByte1) >> 8, (Dword_H & bMaskByte2) >> 16, (Dword_H & bMaskByte3) >> 24)); -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "ptr=%d : 0x%8x %8x\n", ptr, Dword_H, Dword_L)); -+ } -+ -+ } -+#endif -+ break; -+ -+ case PHYDM_BIG_JUMP: -+ { -+#if (RTL8822B_SUPPORT == 1) -+ if (input[1]) { -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ phydm_EnableBigJump(pDM_Odm, (BOOLEAN)(var1[0])); -+ } else -+ PHYDM_SNPRINTF((output + used, out_len - used, "unknown command!\n")); -+#else -+ PHYDM_SNPRINTF((output + used, out_len - used, "The command is only for 8822B!\n")); -+#endif -+ break; -+ } -+ -+ case PHYDM_HANG: -+ phydm_BB_RxHang_Info(pDM_Odm, &used, output, &out_len); -+ break; -+ -+ case PHYDM_SHOW_RXRATE: -+#if (RTL8822B_SUPPORT == 1) -+ { -+ u1Byte rate_idx; -+ -+ if (input[1]) -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if (var1[0] == 1) -+ phydm_showRxRate(pDM_Odm, &used, output, &out_len); -+ else { -+ PHYDM_SNPRINTF((output+used, out_len-used, "Reset Rx rate counter\n")); -+ -+ for (rate_idx = 0; rate_idx < 40; rate_idx++) { -+ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[rate_idx] = 0; -+ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[rate_idx] = 0; -+ } -+ } -+ } -+#endif -+ break; -+ -+ case PHYDM_NBI_EN: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ -+ phydm_api_debug(pDM_Odm, PHYDM_API_NBI, (u4Byte *)var1, &used, output, &out_len); -+ /**/ -+ } -+ -+ -+ break; -+ -+ case PHYDM_CSI_MASK_EN: -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ -+ phydm_api_debug(pDM_Odm, PHYDM_API_CSI_MASK, (u4Byte *)var1, &used, output, &out_len); -+ /**/ -+ } -+ -+ -+ break; -+ -+ case PHYDM_DFS: -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ { -+ u4Byte var[6] = {0}; -+ -+ for (i = 0; i < 6; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) -+ phydm_dfs_debug(pDM_Odm, var, &used, output, &out_len); -+ } -+#endif -+ break; -+ -+ case PHYDM_IQK: -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PHY_IQCalibrate(pDM_Odm->priv); -+ PHYDM_SNPRINTF((output + used, out_len - used, "IQK !!\n")); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PHY_IQCalibrate(pDM_Odm->Adapter, FALSE); -+ PHYDM_SNPRINTF((output + used, out_len - used, "IQK !!\n")); -+#endif -+ break; -+ -+ case PHYDM_NHM: -+ { -+ u1Byte target_rssi; -+ u4Byte value32; -+ u2Byte nhm_period = 0xC350; //200ms -+ u1Byte IGI; -+ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ if(input_num == 1) { -+ -+ CCX_INFO->echo_NHM_en = FALSE; -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Trigger NHM: echo nhm 1\n")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r (Exclude CCA)\n")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r Trigger NHM: echo nhm 2\n")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r (Include CCA)\n")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r Get NHM results: echo nhm 3\n")); -+ -+ return; -+ } -+ -+ /* NMH trigger */ -+ if ((var1[0] <= 2) && (var1[0] != 0)) { -+ -+ CCX_INFO->echo_NHM_en = TRUE; -+ CCX_INFO->echo_IGI = (u1Byte)ODM_GetBBReg(pDM_Odm, 0xC50, bMaskByte0); -+ -+ target_rssi = CCX_INFO->echo_IGI - 10; -+ -+ CCX_INFO->NHM_th[0] = (target_rssi -15 + 10) * 2; -+ -+ for(i = 1; i <= 10; i ++) { -+ CCX_INFO->NHM_th[i] = CCX_INFO->NHM_th[0] + 6 * i; -+ } -+ -+ //4 1. store previous NHM setting -+ phydm_NHMsetting(pDM_Odm, STORE_NHM_SETTING); -+ -+ //4 2. Set NHM period, 0x990[31:16]=0xC350, Time duration for NHM unit: 4us, 0xC350=200ms -+ CCX_INFO->NHM_period = nhm_period; -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Monitor NHM for %d us", nhm_period*4)); -+ -+ //4 3. Set NHM inexclude_txon, inexclude_cca, ccx_en -+ -+ -+ CCX_INFO->NHM_inexclude_cca = (var1[0] == 1) ? NHM_EXCLUDE_CCA : NHM_INCLUDE_CCA; -+ CCX_INFO->NHM_inexclude_txon = NHM_EXCLUDE_TXON; -+ -+ phydm_NHMsetting(pDM_Odm, SET_NHM_SETTING); -+ -+ for(i = 0; i <= 10; i ++) { -+ -+ if (i == 5) { -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n NHM_th[%d] = 0x%x, echo_IGI = 0x%x", i, CCX_INFO->NHM_th[i], CCX_INFO->echo_IGI)); -+ } -+ else if (i == 10) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n NHM_th[%d] = 0x%x\n", i, CCX_INFO->NHM_th[i])); -+ else -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n NHM_th[%d] = 0x%x", i, CCX_INFO->NHM_th[i])); -+ } -+ -+ //4 4. Trigger NHM -+ phydm_NHMtrigger(pDM_Odm); -+ -+ } -+ -+ /*Get NHM results*/ -+ else if (var1[0] == 3) { -+ -+ IGI = (u1Byte)ODM_GetBBReg(pDM_Odm, 0xC50, bMaskByte0); -+ -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Cur_IGI = 0x%x", IGI)); -+ -+ phydm_getNHMresult(pDM_Odm); -+ -+ //4 Resotre NHM setting -+ phydm_NHMsetting(pDM_Odm, RESTORE_NHM_SETTING); -+ -+ for(i = 0; i <= 11; i++) { -+ -+ if (i == 5) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n nhm_result[%d] = %d, echo_IGI = 0x%x", i, CCX_INFO->NHM_result[i], CCX_INFO->echo_IGI)); -+ else if (i == 11) -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n nhm_result[%d] = %d\n", i, CCX_INFO->NHM_result[i])); -+ else -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n nhm_result[%d] = %d", i, CCX_INFO->NHM_result[i])); -+ } -+ -+ CCX_INFO->echo_NHM_en = FALSE; -+ } -+ else { -+ -+ CCX_INFO->echo_NHM_en = FALSE; -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Trigger NHM: echo nhm 1\n")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r (Exclude CCA)\n")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r Trigger NHM: echo nhm 2\n")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r (Include CCA)\n")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r Get NHM results: echo nhm 3\n")); -+ -+ return; -+ } -+ } -+ break; -+ -+ case PHYDM_CLM: -+ { -+ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ -+ //PHYDM_SNPRINTF((output + used, out_len - used, "\r\n input_num = %d\n", input_num)); -+ -+ if (input_num == 1) { -+ -+ CCX_INFO->echo_CLM_en = FALSE; -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Trigger CLM: echo clm 1\n")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r Get CLM results: echo clm 2\n")); -+ return; -+ } -+ -+ /* Set & trigger CLM */ -+ if (var1[0] == 1) { -+ -+ CCX_INFO->echo_CLM_en = TRUE; -+ CCX_INFO->CLM_period = 0xC350; /*100ms*/ -+ phydm_CLMsetting(pDM_Odm); -+ phydm_CLMtrigger(pDM_Odm); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Monitor CLM for 200ms\n")); -+ } -+ -+ /* Get CLM results */ -+ else if (var1[0] == 2) { -+ -+ CCX_INFO->echo_CLM_en = FALSE; -+ phydm_getCLMresult(pDM_Odm); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n CLM_result = %d us\n", CCX_INFO->CLM_result*4)); -+ -+ } else { -+ -+ CCX_INFO->echo_CLM_en = FALSE; -+ PHYDM_SNPRINTF((output + used, out_len - used, "\n\r Error command !\n")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r Trigger CLM: echo clm 1\n")); -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r Get CLM results: echo clm 2\n")); -+ } -+ } -+ break; -+ -+ case PHYDM_BB_INFO: -+ { -+ s4Byte value32 = 0; -+ -+ phydm_BB_Debug_Info(pDM_Odm, &used, output, &out_len); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8822B && input[1]) { -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ ODM_SetBBReg(pDM_Odm, 0x1988, 0x003fff00, var1[0]); -+ value32 = ODM_GetBBReg(pDM_Odm, 0xf84, bMaskDWord); -+ value32 = (value32 & 0xff000000)>>24; -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = condition num = %d, subcarriers = %d\n", "Over condition num subcarrier", var1[0], value32)); -+ ODM_SetBBReg(pDM_Odm, 0x1988 , BIT22, 0x0); /*disable report condition number*/ -+ } -+ } -+ break; -+ -+ case PHYDM_TXBF: -+ { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+#if (BEAMFORMING_SUPPORT == 1) -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ -+ PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); -+ if (var1[0] == 1) { -+ pBeamformingInfo->applyVmatrix = TRUE; -+ pBeamformingInfo->snding3SS = FALSE; -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n apply V matrix and 3SS 789 dont snding\n")); -+ } else if (var1[0] == 0) { -+ pBeamformingInfo->applyVmatrix = FALSE; -+ pBeamformingInfo->snding3SS = TRUE; -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n dont apply V matrix and 3SS 789 snding\n")); -+ } else -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n unknown cmd!!\n")); -+#else -+ PHYDM_SNPRINTF((output + used, out_len - used, "\r\n no TxBF !!\n")); -+#endif -+#endif -+ } -+ break; -+ -+ case PHYDM_PAUSE_DIG_EN: -+ -+ -+ for (i = 0; i < 5; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ if (var1[0] == 0) { -+ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_7, (u1Byte)var1[1]); -+ PHYDM_SNPRINTF((output + used, out_len - used, "Set IGI_value = ((%x))\n", var1[1])); -+ } else if (var1[0] == 1) { -+ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_7, (u1Byte)var1[1]); -+ PHYDM_SNPRINTF((output + used, out_len - used, "Resume IGI_value\n")); -+ } else -+ PHYDM_SNPRINTF((output + used, out_len - used, "echo (1:pause, 2resume) (IGI_value)\n")); -+ } -+ -+ break; -+ -+ case PHYDM_H2C: -+ -+ for (i = 0; i < 8; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) -+ phydm_h2C_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ -+ -+ break; -+ -+ case PHYDM_ANT_SWITCH: -+ -+ for (i = 0; i < 8; i++) { -+ if (input[i + 1]) { -+ PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); -+ input_idx++; -+ } -+ } -+ -+ if (input_idx >= 1) { -+ -+ #if (RTL8821A_SUPPORT == 1) -+ phydm_set_ext_switch(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -+ #else -+ PHYDM_SNPRINTF((output + used, out_len - used, "Not Support IC")); -+ #endif -+ } -+ -+ -+ break; -+ -+ default: -+ PHYDM_SNPRINTF((output + used, out_len - used, "SET, unknown command!\n")); -+ break; -+ -+ } -+} -+ -+ -+VOID -+phydm_la_mode_bb_setting( -+ IN PVOID pDM_VOID, -+ IN u4Byte DbgPort, -+ IN BOOLEAN bTriggerEdge, -+ IN u1Byte sampling_rate -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ /*u4Byte dword;*/ -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ ODM_SetBBReg(pDM_Odm, 0x198C , BIT2|BIT1|BIT0, 7); /*disable dbg clk gating*/ -+ -+ /*dword= ODM_GetBBReg(pDM_Odm, 0x8FC, bMaskDWord);*/ -+ /*DbgPrint("dbg_port = ((0x%x))\n", dword);*/ -+ ODM_SetBBReg(pDM_Odm, 0x8FC, bMaskDWord, DbgPort); -+ ODM_SetBBReg(pDM_Odm, 0x95C , BIT31, bTriggerEdge); /*0: posedge, 1: negedge*/ -+ ODM_SetBBReg(pDM_Odm, 0x95c, 0xe0, sampling_rate); -+ /* (0:) '80MHz' -+ (1:) '40MHz' -+ (2:) '20MHz' -+ (3:) '10MHz' -+ (4:) '5MHz' -+ (5:) '2.5MHz' -+ (6:) '1.25MHz' -+ (7:) '160MHz (for BW160 ic)' -+ */ -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, DbgPort); -+ ODM_SetBBReg(pDM_Odm, 0x9A0 , BIT31, bTriggerEdge); /*0: posedge, 1: negedge*/ -+ ODM_SetBBReg(pDM_Odm, 0x9A0, 0xe0, sampling_rate); -+ /* (0:) '80MHz' -+ (1:) '40MHz' -+ (2:) '20MHz' -+ (3:) '10MHz' -+ (4:) '5MHz' -+ (5:) '2.5MHz' -+ (6:) '1.25MHz' -+ (7:) '160MHz (for BW160 ic)' -+ */ -+ } -+} -+ -+u1Byte -+phydm_la_mode_mac_setting( -+ IN PVOID pDM_VOID, -+ IN u4Byte TriggerTime_mu_sec -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte TriggerTime_unit_num; -+ u4Byte time_unit = 0; -+ -+ if (TriggerTime_mu_sec < 128) { -+ time_unit = 0; /*unit: 1mu sec*/ -+ } else if (TriggerTime_mu_sec < 256) { -+ time_unit = 1; /*unit: 2mu sec*/ -+ } else if (TriggerTime_mu_sec < 512) { -+ time_unit = 2; /*unit: 4mu sec*/ -+ } else if (TriggerTime_mu_sec < 1024) { -+ time_unit = 3; /*unit: 8mu sec*/ -+ } else if (TriggerTime_mu_sec < 2048) { -+ time_unit = 4; /*unit: 16mu sec*/ -+ } else if (TriggerTime_mu_sec < 4096) { -+ time_unit = 5; /*unit: 32mu sec*/ -+ } else if (TriggerTime_mu_sec < 8192) { -+ time_unit = 6; /*unit: 64mu sec*/ -+ } -+ -+ TriggerTime_unit_num = (u1Byte)(TriggerTime_mu_sec>>time_unit); -+ pDM_Odm->ADCsmp_time_unit = time_unit; -+ DbgPrint("time_unit = ((0x%x))\n", time_unit); -+ -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ ODM_SetMACReg(pDM_Odm, 0x7cc , BIT20|BIT19|BIT18, time_unit); -+ } else { -+ -+ } -+ return (TriggerTime_unit_num & 0x7f); -+ -+} -+ -+#ifdef __ECOS -+char *strsep(char **s, const char *ct) -+{ -+ char *sbegin = *s; -+ char *end; -+ -+ if (sbegin == NULL) -+ return NULL; -+ -+ end = strpbrk(sbegin, ct); -+ if (end) -+ *end++ = '\0'; -+ *s = end; -+ return sbegin; -+} -+#endif -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) -+s4Byte -+phydm_cmd( -+ IN PDM_ODM_T pDM_Odm, -+ IN char *input, -+ IN u4Byte in_len, -+ IN u1Byte flag, -+ OUT char *output, -+ IN u4Byte out_len -+) -+{ -+ char *token; -+ u4Byte Argc = 0; -+ char Argv[MAX_ARGC][MAX_ARGV]; -+ -+ do { -+ token = strsep(&input, ", "); -+ if (token) { -+ strcpy(Argv[Argc], token); -+ Argc++; -+ } else -+ break; -+ } while (Argc < MAX_ARGC); -+ -+ if (Argc == 1) -+ Argv[0][strlen(Argv[0]) - 1] = '\0'; -+ -+ phydm_cmd_parser(pDM_Odm, Argv, Argc, flag, output, out_len); -+ -+ return 0; -+} -+#endif -+ -+ -+VOID -+phydm_fw_trace_handler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /*u1Byte debug_trace_11byte[60];*/ -+ u1Byte freg_num, c2h_seq, buf_0 = 0; -+ -+ if (!(pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES)) -+ return; -+ -+ if (CmdLen > 12) -+ return; -+ -+ buf_0 = CmdBuf[0]; -+ freg_num = (buf_0 & 0xf); -+ c2h_seq = (buf_0 & 0xf0) >> 4; -+ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] freg_num = (( %d )), c2h_seq = (( %d ))\n", freg_num,c2h_seq ));*/ -+ -+ /*strncpy(debug_trace_11byte,&CmdBuf[1],(CmdLen-1));*/ -+ /*debug_trace_11byte[CmdLen-1] = '\0';*/ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] %s\n", debug_trace_11byte));*/ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] CmdLen = (( %d ))\n", CmdLen));*/ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] c2h_cmd_start = (( %d ))\n", pDM_Odm->c2h_cmd_start));*/ -+ -+ -+ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("pre_seq = (( %d )), current_seq = (( %d ))\n", pDM_Odm->pre_c2h_seq, c2h_seq));*/ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("fw_buff_is_enpty = (( %d ))\n", pDM_Odm->fw_buff_is_enpty));*/ -+ -+ if ((c2h_seq != pDM_Odm->pre_c2h_seq) && pDM_Odm->fw_buff_is_enpty == FALSE) { -+ pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start] = '\0'; -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW Dbg Queue Overflow] %s\n", pDM_Odm->fw_debug_trace)); -+ pDM_Odm->c2h_cmd_start = 0; -+ } -+ -+ if ((CmdLen - 1) > (60 - pDM_Odm->c2h_cmd_start)) { -+ pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start] = '\0'; -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW Dbg Queue error: wrong C2H length] %s\n", pDM_Odm->fw_debug_trace)); -+ pDM_Odm->c2h_cmd_start = 0; -+ return; -+ } -+ -+ strncpy((char *)&(pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start]), (char *)&CmdBuf[1], (CmdLen-1)); -+ pDM_Odm->c2h_cmd_start += (CmdLen - 1); -+ pDM_Odm->fw_buff_is_enpty = FALSE; -+ -+ if (freg_num == 0 || pDM_Odm->c2h_cmd_start >= 60) { -+ if (pDM_Odm->c2h_cmd_start < 60) -+ pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start] = '\0'; -+ else -+ pDM_Odm->fw_debug_trace[59] = '\0'; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s\n", pDM_Odm->fw_debug_trace)); -+ /*DbgPrint("[FW DBG Msg] %s\n", pDM_Odm->fw_debug_trace);*/ -+ pDM_Odm->c2h_cmd_start = 0; -+ pDM_Odm->fw_buff_is_enpty = TRUE; -+ } -+ -+ pDM_Odm->pre_c2h_seq = c2h_seq; -+} -+ -+VOID -+phydm_fw_trace_handler_code( -+ IN PVOID pDM_VOID, -+ IN pu1Byte Buffer, -+ IN u1Byte CmdLen -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte function = Buffer[0]; -+ u1Byte dbg_num = Buffer[1]; -+ u2Byte content_0 = (((u2Byte)Buffer[3])<<8)|((u2Byte)Buffer[2]); -+ u2Byte content_1 = (((u2Byte)Buffer[5])<<8)|((u2Byte)Buffer[4]); -+ u2Byte content_2 = (((u2Byte)Buffer[7])<<8)|((u2Byte)Buffer[6]); -+ u2Byte content_3 = (((u2Byte)Buffer[9])<<8)|((u2Byte)Buffer[8]); -+ u2Byte content_4 = (((u2Byte)Buffer[11])<<8)|((u2Byte)Buffer[10]); -+ -+ if(CmdLen >12) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW Msg] Invalid cmd length (( %d )) >12 \n", CmdLen)); -+ } -+ -+ //ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW Msg] Func=((%d)), num=((%d)), ct_0=((%d)), ct_1=((%d)), ct_2=((%d)), ct_3=((%d)), ct_4=((%d))\n", -+ // function, dbg_num, content_0, content_1, content_2, content_3, content_4)); -+ -+ /*--------------------------------------------*/ -+#if (CONFIG_RA_FW_DBG_CODE) -+ if(function == RATE_DECISION) { -+ if(dbg_num == 0) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RA_CNT=((%d)) Max_device=((%d))--------------------------->\n", content_1, content_2)); -+ } else if(content_0 == 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Check RA macid= ((%d)), MediaStatus=((%d)), Dis_RA=((%d)), try_bit=((0x%x))\n", content_1, content_2, content_3, content_4)); -+ } else if(content_0 == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Check RA total=((%d)), drop=((0x%x)), TXRPT_TRY_bit=((%x)), bNoisy=((%x))\n", content_1, content_2, content_3, content_4)); -+ } -+ } else if(dbg_num == 1) { -+ if (content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RTY[0,1,2,3]=[ %d , %d , %d , %d ]\n", content_1, content_2, content_3, content_4)); -+ } else if (content_0 == 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RTY[4]=[ %d ], drop=(( %d )), total=(( %d )), current_rate=((0x %x ))", content_1, content_2, content_3, content_4)); -+ phydm_print_rate(pDM_Odm, (u1Byte)content_4, ODM_FW_DEBUG_TRACE); -+ } else if (content_0 == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] penality_idx=(( %d ))\n", content_1)); -+ } else if (content_0 == 4) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RSSI=(( %d )), ra_stage = (( %d ))\n", content_1, content_2)); -+ } -+ } -+ -+ else if(dbg_num == 3) { -+ if (content_0 == 1) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( DOWN )) total=((%d)), total>>1=((%d)), R4+R3+R2 = ((%d)), RateDownHold = ((%d))\n", content_1, content_2, content_3, content_4)); -+ else if (content_0 == 2) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( UP )) total_acc=((%d)), total_acc>>1=((%d)), R4+R3+R2 = ((%d)), RateDownHold = ((%d))\n", content_1, content_2, content_3, content_4)); -+ else if (content_0 == 3) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( UP )) ((Rate Down Hold)) RA_CNT=((%d))\n", content_1)); -+ else if (content_0 == 4) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( UP )) ((tota_accl<5 skip)) RA_CNT=((%d))\n", content_1)); -+ else if (content_0 == 8) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( Reset Tx Rpt )) RA_CNT=((%d))\n", content_1)); -+ } -+ -+ else if (dbg_num == 4) { -+ if (content_0 == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RER_CNT PCR_ori =(( %d )), ratio_ori =(( %d )), pcr_updown_bitmap =(( 0x%x )), pcr_var_diff =(( %d ))\n", content_1, content_2, content_3, content_4)); -+ /**/ -+ } else if (content_0 == 4) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] pcr_shift_value =(( %s%d )), rate_down_threshold =(( %d )), rate_up_threshold =(( %d ))\n", ((content_1) ? "+" : "-"), content_2, content_3, content_4)); -+ /**/ -+ } else if (content_0 == 5) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] pcr_mean =(( %d )), PCR_VAR =(( %d )), offset =(( %d )), decision_offset_p =(( %d ))\n", content_1, content_2, content_3, content_4)); -+ /**/ -+ } -+ } -+ -+ else if(dbg_num == 5) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] (( UP)) Nsc=(( %d )), N_High=(( %d )), RateUp_Waiting=(( %d )), RateUp_Fail=(( %d ))\n", content_1, content_2, content_3, content_4)); -+ } else if(content_0 == 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((DOWN)) Nsc=(( %d )), N_Low=(( %d ))\n", content_1, content_2)); -+ } else if(content_0 == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((HOLD)) Nsc=((%d)), N_High=((%d)), N_Low=((%d)), Reset_CNT=((%d))\n", content_1, content_2, content_3, content_4)); -+ } -+ } -+ else if(dbg_num == 0x60) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((AP RPT)) macid=((%d)), BUPDATE[macid]=((%d))\n", content_1, content_2)); -+ } else if(content_0 == 4) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((AP RPT)) pass=((%d)), rty_num=((%d)), drop=((%d)), total=((%d))\n", content_1, content_2, content_3, content_4)); -+ } else if(content_0 == 5) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((AP RPT)) PASS=((%d)), RTY_NUM=((%d)), DROP=((%d)), TOTAL=((%d))\n", content_1, content_2, content_3, content_4)); -+ } -+ } -+ } -+ /*--------------------------------------------*/ -+ else if (function == INIT_RA_TABLE){ -+ if(dbg_num == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][INIT_RA_INFO] Ra_init, RA_SKIP_CNT = (( %d ))\n", content_0)); -+ } -+ -+ } -+ /*--------------------------------------------*/ -+ else if (function == RATE_UP) { -+ if(dbg_num == 2) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Highest rate -> return)), macid=((%d)) Nsc=((%d))\n", content_1, content_2)); -+ } -+ } else if(dbg_num == 5) { -+ if (content_0 == 0) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Rate UP)), up_rate_tmp=((0x%x)), rate_idx=((0x%x)), SGI_en=((%d)), SGI=((%d))\n", content_1, content_2, content_3, content_4)); -+ else if (content_0 == 1) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Rate UP)), rate_1=((0x%x)), rate_2=((0x%x)), BW=((%d)), Try_Bit=((%d))\n", content_1, content_2, content_3, content_4)); -+ } -+ -+ } -+ /*--------------------------------------------*/ -+ else if (function == RATE_DOWN) { -+ if(dbg_num == 5) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateDownStep] ((Rate Down)), macid=((%d)), rate1=((0x%x)), rate2=((0x%x)), BW=((%d))\n", content_1, content_2, content_3, content_4)); -+ } -+ } -+ } else if (function == TRY_DONE) { -+ if (dbg_num == 1) { -+ if (content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][Try Done] ((try succsess )) macid=((%d)), Try_Done_cnt=((%d))\n", content_1, content_2)); -+ /**/ -+ } -+ } else if (dbg_num == 2) { -+ if (content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][Try Done] ((try)) macid=((%d)), Try_Done_cnt=((%d)), rate_2=((%d)), try_succes=((%d))\n", content_1, content_2, content_3, content_4)); -+ /**/ -+ } -+ } -+ } -+ /*--------------------------------------------*/ -+ else if (function == RA_H2C) { -+ if (dbg_num == 1) { -+ if (content_0 == 0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][H2C=0x49] fw_trace_en=((%d)), mode =((%d)), macid=((%d))\n", content_1, content_2, content_3)); -+ /**/ -+ /*C2H_RA_Dbg_code(F_RA_H2C,1,0, SysMib.ODM.DEBUG.fw_trace_en, mode, macid , 0); //RA MASK*/ -+ } -+ #if 0 -+ else if (dbg_num == 2) { -+ -+ if (content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][H2C=0x40] MACID=((%d)), Rate ID=((%d)), SGI=((%d)), BW=((%d))\n", content_1, content_2, content_3, content_4)); -+ /**/ -+ } else if (content_0 == 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][H2C=0x40] VHT_en=((%d)), Disable_PowerTraining=((%d)), Disable_RA=((%d)), No_Update=((%d))\n", content_1, content_2, content_3, content_4)); -+ /**/ -+ } else if (content_0 == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][H2C=0x40] RA_MSK=[%x | %x | %x | %x ]\n", content_1, content_2, content_3, content_4)); -+ /**/ -+ } -+ } -+ #endif -+ } -+ } -+ /*--------------------------------------------*/ -+ else if (function == F_RATE_AP_RPT) { -+ if(dbg_num == 1) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] ((1)), SPE_STATIS=((0x%x))---------->\n", content_3)); -+ } -+ } else if(dbg_num == 2) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] RTY_all=((%d))\n", content_1)); -+ } -+ } else if(dbg_num == 3) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID1[%d], TOTAL=((%d)), RTY=((%d))\n", content_3, content_1, content_2)); -+ } -+ } else if(dbg_num == 4) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID2[%d], TOTAL=((%d)), RTY=((%d))\n", content_3, content_1, content_2)); -+ } -+ } else if(dbg_num == 5) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID1[%d], PASS=((%d)), DROP=((%d))\n", content_3, content_1, content_2)); -+ } -+ } else if(dbg_num == 6) { -+ if(content_0 == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID2[%d],, PASS=((%d)), DROP=((%d))\n", content_3, content_1, content_2)); -+ } -+ } -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][general][%d, %d, %d] = {%d, %d, %d, %d}\n", function, dbg_num, content_0, content_1, content_2, content_3, content_4)); -+ /**/ -+ } -+#else -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][general][%d, %d, %d] = {%d, %d, %d, %d}\n", function, dbg_num, content_0, content_1, content_2, content_3, content_4)); -+#endif -+ /*--------------------------------------------*/ -+ -+ -+} -+ -+VOID -+phydm_fw_trace_handler_8051( -+ IN PVOID pDM_VOID, -+ IN pu1Byte Buffer, -+ IN u1Byte CmdLen -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if 0 -+ if (CmdLen >= 3) -+ CmdBuf[CmdLen - 1] = '\0'; -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s\n", &(CmdBuf[3]))); -+#else -+ -+ int i = 0; -+ u1Byte Extend_c2hSubID = 0, Extend_c2hDbgLen = 0, Extend_c2hDbgSeq = 0; -+ u1Byte fw_debug_trace[128]; -+ pu1Byte Extend_c2hDbgContent = 0; -+ -+ if (CmdLen > 127) -+ return; -+ -+ Extend_c2hSubID = Buffer[0]; -+ Extend_c2hDbgLen = Buffer[1]; -+ Extend_c2hDbgContent = Buffer + 2; /*DbgSeq+DbgContent for show HEX*/ -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_DISP(FC2H, C2H_Summary, ("[Extend C2H packet], Extend_c2hSubId=0x%x, Extend_c2hDbgLen=%d\n", -+ Extend_c2hSubID, Extend_c2hDbgLen)); -+ -+ RT_DISP_DATA(FC2H, C2H_Summary, "[Extend C2H packet], Content Hex:", Extend_c2hDbgContent, CmdLen-2); -+ #endif -+ -+GoBackforAggreDbgPkt: -+ i = 0; -+ Extend_c2hDbgSeq = Buffer[2]; -+ Extend_c2hDbgContent = Buffer + 3; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_DISP(FC2H, C2H_Summary, ("[RTKFW, SEQ= %d] :", Extend_c2hDbgSeq)); -+ #endif -+ -+ for (; ; i++) { -+ fw_debug_trace[i] = Extend_c2hDbgContent[i]; -+ if (Extend_c2hDbgContent[i + 1] == '\0') { -+ fw_debug_trace[i + 1] = '\0'; -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s", &(fw_debug_trace[0]))); -+ break; -+ } else if (Extend_c2hDbgContent[i] == '\n') { -+ fw_debug_trace[i + 1] = '\0'; -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s", &(fw_debug_trace[0]))); -+ Buffer = Extend_c2hDbgContent + i + 3; -+ goto GoBackforAggreDbgPkt; -+ } -+ } -+ -+ -+#endif -+} -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_debug.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_debug.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_debug.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_debug.h 2018-02-11 21:44:27.155146208 +0200 -@@ -0,0 +1,357 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __ODM_DBG_H__ -+#define __ODM_DBG_H__ -+ -+/*#define DEBUG_VERSION "1.1"*/ /*2015.07.29 YuChen*/ -+/*#define DEBUG_VERSION "1.2"*/ /*2015.08.28 Dino*/ -+#define DEBUG_VERSION "1.3" /*2016.04.28 YuChen*/ -+//----------------------------------------------------------------------------- -+// Define the debug levels -+// -+// 1. DBG_TRACE and DBG_LOUD are used for normal cases. -+// So that, they can help SW engineer to develope or trace states changed -+// and also help HW enginner to trace every operation to and from HW, -+// e.g IO, Tx, Rx. -+// -+// 2. DBG_WARNNING and DBG_SERIOUS are used for unusual or error cases, -+// which help us to debug SW or HW. -+// -+//----------------------------------------------------------------------------- -+// -+// Never used in a call to ODM_RT_TRACE()! -+// -+#define ODM_DBG_OFF 1 -+ -+// -+// Fatal bug. -+// For example, Tx/Rx/IO locked up, OS hangs, memory access violation, -+// resource allocation failed, unexpected HW behavior, HW BUG and so on. -+// -+#define ODM_DBG_SERIOUS 2 -+ -+// -+// Abnormal, rare, or unexpeted cases. -+// For example, IRP/Packet/OID canceled, device suprisely unremoved and so on. -+// -+#define ODM_DBG_WARNING 3 -+ -+// -+// Normal case with useful information about current SW or HW state. -+// For example, Tx/Rx descriptor to fill, Tx/Rx descriptor completed status, -+// SW protocol state change, dynamic mechanism state change and so on. -+// -+#define ODM_DBG_LOUD 4 -+ -+// -+// Normal case with detail execution flow or information. -+// -+#define ODM_DBG_TRACE 5 -+ -+/*FW DBG MSG*/ -+#define RATE_DECISION BIT0 -+#define INIT_RA_TABLE BIT1 -+#define RATE_UP BIT2 -+#define RATE_DOWN BIT3 -+#define TRY_DONE BIT4 -+#define RA_H2C BIT5 -+#define F_RATE_AP_RPT BIT7 -+ -+//----------------------------------------------------------------------------- -+// Define the tracing components -+// -+//----------------------------------------------------------------------------- -+/*BB FW Functions*/ -+#define PHYDM_FW_COMP_RA BIT0 -+#define PHYDM_FW_COMP_MU BIT1 -+#define PHYDM_FW_COMP_PATH_DIV BIT2 -+#define PHYDM_FW_COMP_PHY_CONFIG BIT3 -+ -+ -+/*BB Driver Functions*/ -+#define ODM_COMP_DIG BIT0 -+#define ODM_COMP_RA_MASK BIT1 -+#define ODM_COMP_DYNAMIC_TXPWR BIT2 -+#define ODM_COMP_FA_CNT BIT3 -+#define ODM_COMP_RSSI_MONITOR BIT4 -+#define ODM_COMP_SNIFFER BIT5 -+#define ODM_COMP_ANT_DIV BIT6 -+#define ODM_COMP_DFS BIT7 -+#define ODM_COMP_NOISY_DETECT BIT8 -+#define ODM_COMP_RATE_ADAPTIVE BIT9 -+#define ODM_COMP_PATH_DIV BIT10 -+#define ODM_COMP_CCX BIT11 -+ -+#define ODM_COMP_DYNAMIC_PRICCA BIT12 -+ /*BIT13 TBD*/ -+#define ODM_COMP_MP BIT14 -+#define ODM_COMP_CFO_TRACKING BIT15 -+#define ODM_COMP_ACS BIT16 -+#define PHYDM_COMP_ADAPTIVITY BIT17 -+#define PHYDM_COMP_RA_DBG BIT18 -+#define PHYDM_COMP_TXBF BIT19 -+//MAC Functions -+#define ODM_COMP_EDCA_TURBO BIT20 -+ /*BIT21 TBD*/ -+#define ODM_FW_DEBUG_TRACE BIT22 -+//RF Functions -+ /*BIT23 TBD*/ -+#define ODM_COMP_TX_PWR_TRACK BIT24 -+ /*BIT25 TBD*/ -+#define ODM_COMP_CALIBRATION BIT26 -+//Common Functions -+ /*BIT27 TBD*/ -+#define ODM_PHY_CONFIG BIT28 -+#define ODM_COMP_INIT BIT29 -+#define ODM_COMP_COMMON BIT30 -+#define ODM_COMP_API BIT31 -+ -+ -+/*------------------------Export Marco Definition---------------------------*/ -+ -+#define config_phydm_read_txagc_check(data) (data != INVALID_TXAGC_DATA) -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #define RT_PRINTK DbgPrint -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #define DbgPrint printk -+ #define RT_PRINTK(fmt, args...) DbgPrint( "%s(): " fmt, __FUNCTION__, ## args); -+ #define RT_DISP(dbgtype, dbgflag, printstr) -+#else -+ #define DbgPrint panic_printk -+ #define RT_PRINTK(fmt, args...) DbgPrint( "%s(): " fmt, __FUNCTION__, ## args); -+#endif -+ -+#ifndef ASSERT -+ #define ASSERT(expr) -+#endif -+ -+#if DBG -+#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) \ -+ do { \ -+ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel || level == ODM_DBG_SERIOUS)) \ -+ { \ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) \ -+ DbgPrint("[PhyDM-8188E] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8192E) \ -+ DbgPrint("[PhyDM-8192E] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8812) \ -+ DbgPrint("[PhyDM-8812A] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8821) \ -+ DbgPrint("[PhyDM-8821A] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8814A) \ -+ DbgPrint("[PhyDM-8814A] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8703B) \ -+ DbgPrint("[PhyDM-8703B] "); \ -+ else if(pDM_Odm->SupportICType == ODM_RTL8822B) \ -+ DbgPrint("[PhyDM-8822B] "); \ -+ else if (pDM_Odm->SupportICType == ODM_RTL8188F) \ -+ DbgPrint("[PhyDM-8188F] "); \ -+ RT_PRINTK fmt; \ -+ } \ -+ } while (0) -+ -+#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) \ -+ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel)) \ -+ { \ -+ RT_PRINTK fmt; \ -+ } -+ -+#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) \ -+ if(!(expr)) { \ -+ DbgPrint( "Assertion failed! %s at ......\n", #expr); \ -+ DbgPrint( " ......%s,%s,line=%d\n",__FILE__,__FUNCTION__,__LINE__); \ -+ RT_PRINTK fmt; \ -+ ASSERT(FALSE); \ -+ } -+#define ODM_dbg_enter() { DbgPrint("==> %s\n", __FUNCTION__); } -+#define ODM_dbg_exit() { DbgPrint("<== %s\n", __FUNCTION__); } -+#define ODM_dbg_trace(str) { DbgPrint("%s:%s\n", __FUNCTION__, str); } -+ -+#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) \ -+ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel)) \ -+ { \ -+ int __i; \ -+ pu1Byte __ptr = (pu1Byte)ptr; \ -+ DbgPrint("[ODM] "); \ -+ DbgPrint(title_str); \ -+ DbgPrint(" "); \ -+ for( __i=0; __i<6; __i++ ) \ -+ DbgPrint("%02X%s", __ptr[__i], (__i==5)?"":"-"); \ -+ DbgPrint("\n"); \ -+ } -+#else -+#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) -+#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) -+#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) -+#define ODM_dbg_enter() -+#define ODM_dbg_exit() -+#define ODM_dbg_trace(str) -+#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) -+#endif -+ -+ -+VOID -+PHYDM_InitDebugSetting(IN PDM_ODM_T pDM_Odm); -+ -+VOID phydm_BasicDbgMessage( IN PVOID pDM_VOID); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define PHYDM_DBGPRINT 0 -+#define PHYDM_SSCANF(x, y, z) DCMD_Scanf(x, y, z) -+#define PHYDM_VAST_INFO_SNPRINTF PHYDM_SNPRINTF -+#if (PHYDM_DBGPRINT == 1) -+#define PHYDM_SNPRINTF(msg) \ -+ do {\ -+ rsprintf msg;\ -+ DbgPrint(output);\ -+ } while (0) -+#else -+#define PHYDM_SNPRINTF(msg) \ -+ do {\ -+ rsprintf msg;\ -+ DCMD_Printf(output);\ -+ } while (0) -+#endif -+#else -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) || defined(__OSK__) -+#define PHYDM_DBGPRINT 0 -+#else -+#define PHYDM_DBGPRINT 1 -+#endif -+#define MAX_ARGC 20 -+#define MAX_ARGV 16 -+#define DCMD_DECIMAL "%d" -+#define DCMD_CHAR "%c" -+#define DCMD_HEX "%x" -+ -+#define PHYDM_SSCANF(x, y, z) sscanf(x, y, z) -+ -+#define PHYDM_VAST_INFO_SNPRINTF(msg)\ -+ do {\ -+ snprintf msg;\ -+ DbgPrint(output);\ -+ } while (0) -+ -+#if (PHYDM_DBGPRINT == 1) -+#define PHYDM_SNPRINTF(msg)\ -+ do {\ -+ snprintf msg;\ -+ DbgPrint(output);\ -+ } while (0) -+#else -+#define PHYDM_SNPRINTF(msg)\ -+ do {\ -+ if(out_len > used)\ -+ used+=snprintf msg;\ -+ } while (0) -+#endif -+#endif -+ -+ -+VOID phydm_BasicProfile( -+ IN PVOID pDM_VOID, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ); -+#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) -+s4Byte -+phydm_cmd( -+ IN PDM_ODM_T pDM_Odm, -+ IN char *input, -+ IN u4Byte in_len, -+ IN u1Byte flag, -+ OUT char *output, -+ IN u4Byte out_len -+); -+#endif -+VOID -+phydm_cmd_parser( -+ IN PDM_ODM_T pDM_Odm, -+ IN char input[][16], -+ IN u4Byte input_num, -+ IN u1Byte flag, -+ OUT char *output, -+ IN u4Byte out_len -+); -+ -+VOID -+phydm_la_mode_bb_setting( -+ IN PVOID pDM_VOID, -+ IN u4Byte DbgPort, -+ IN BOOLEAN bTriggerEdge, -+ IN u1Byte sampling_rate -+); -+ -+u1Byte -+phydm_la_mode_mac_setting( -+ IN PVOID pDM_VOID, -+ IN u4Byte TriggerTime_mu_sec -+); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+void phydm_sbd_check( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+void phydm_sbd_callback( -+ PRT_TIMER pTimer -+ ); -+ -+void phydm_sbd_workitem_callback( -+ IN PVOID pContext -+ ); -+#endif -+ -+VOID -+phydm_fw_trace_en_h2c( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN enable, -+ IN u4Byte fw_debug_component, -+ IN u4Byte monitor_mode, -+ IN u4Byte macid -+); -+ -+VOID -+phydm_fw_trace_handler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+); -+ -+VOID -+phydm_fw_trace_handler_code( -+ IN PVOID pDM_VOID, -+ IN pu1Byte Buffer, -+ IN u1Byte CmdLen -+); -+ -+VOID -+phydm_fw_trace_handler_8051( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+); -+ -+#endif // __ODM_DBG_H__ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dfs.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dfs.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dfs.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dfs.c 2018-02-11 21:44:27.155146208 +0200 -@@ -0,0 +1,258 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+/* -+============================================================ -+ include files -+============================================================ -+*/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if defined(CONFIG_PHYDM_DFS_MASTER) -+VOID phydm_radar_detect_reset(PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 0); -+ ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 1); -+} -+ -+VOID phydm_radar_detect_disable(PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 0); -+} -+ -+static VOID phydm_radar_detect_with_dbg_parm(PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, pDM_Odm->radar_detect_reg_918); -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, pDM_Odm->radar_detect_reg_91c); -+ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, pDM_Odm->radar_detect_reg_920); -+ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, pDM_Odm->radar_detect_reg_924); -+} -+ -+/* Init radar detection parameters, called after ch, bw is set */ -+VOID phydm_radar_detect_enable(PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte region_domain = pDM_Odm->DFS_RegionDomain; -+ u1Byte c_channel = *(pDM_Odm->pChannel); -+ -+ if (region_domain == PHYDM_DFS_DOMAIN_UNKNOWN) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("PHYDM_DFS_DOMAIN_UNKNOWN\n")); -+ return; -+ } -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8812 | ODM_RTL8881A)) { -+ -+ ODM_SetBBReg(pDM_Odm, 0x814, 0x3fffffff, 0x04cc4d10); -+ ODM_SetBBReg(pDM_Odm, 0x834, bMaskByte0, 0x06); -+ -+ if (pDM_Odm->radar_detect_dbg_parm_en) { -+ phydm_radar_detect_with_dbg_parm(pDM_Odm); -+ goto exit; -+ } -+ -+ if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { -+ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c17ecdf); -+ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x01528500); -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0fa21a20); -+ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0f69204); -+ -+ } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { -+ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x01528500); -+ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0d67234); -+ -+ if (c_channel >= 52 && c_channel <= 64) { -+ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16ecdf); -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0f141a20); -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16acdf); -+ if (pDM_Odm->pBandWidth == ODM_BW20M) -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x64721a20); -+ else -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x68721a20); -+ } -+ -+ } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { -+ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16acdf); -+ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x01528500); -+ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0d67231); -+ if (pDM_Odm->pBandWidth == ODM_BW20M) -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x64741a20); -+ else -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x68741a20); -+ } else { -+ /* not supported */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("Unsupported DFS_RegionDomain:%d\n", region_domain)); -+ } -+ -+ } else if (pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B)) { -+ -+ ODM_SetBBReg(pDM_Odm, 0x814, 0x3fffffff, 0x04cc4d10); -+ ODM_SetBBReg(pDM_Odm, 0x834, bMaskByte0, 0x06); -+ -+ /* 8822B only, when BW = 20M, DFIR output is 40Mhz, but DFS input is 80MMHz, so it need to upgrade to 80MHz */ -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) { -+ if (pDM_Odm->pBandWidth == ODM_BW20M) -+ ODM_SetBBReg(pDM_Odm, 0x1984, BIT26, 1); -+ else -+ ODM_SetBBReg(pDM_Odm, 0x1984, BIT26, 0); -+ } -+ -+ if (pDM_Odm->radar_detect_dbg_parm_en) { -+ phydm_radar_detect_with_dbg_parm(pDM_Odm); -+ goto exit; -+ } -+ -+ if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { -+ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16acdf); -+ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x095a8500); -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0fa21a20); -+ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0f57204); -+ -+ } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { -+ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x095a8500); -+ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0d67234); -+ -+ if (c_channel >= 52 && c_channel <= 64) { -+ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16ecdf); -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0f141a20); -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c166cdf); -+ if (pDM_Odm->pBandWidth == ODM_BW20M) -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x64721a20); -+ else -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x68721a20); -+ } -+ } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { -+ ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c166cdf); -+ ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x095a8500); -+ ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0d67231); -+ if (pDM_Odm->pBandWidth == ODM_BW20M) -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x64741a20); -+ else -+ ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x68741a20); -+ } else { -+ /* not supported */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("Unsupported DFS_RegionDomain:%d\n", region_domain)); -+ } -+ } else { -+ /* not supported IC type*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("Unsupported IC Type:%d\n", pDM_Odm->SupportICType)); -+ } -+ -+exit: -+ phydm_radar_detect_reset(pDM_Odm); -+} -+ -+BOOLEAN phydm_radar_detect(PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ BOOLEAN enable_DFS = FALSE; -+ BOOLEAN radar_detected = FALSE; -+ u1Byte region_domain = pDM_Odm->DFS_RegionDomain; -+ -+ if (region_domain == PHYDM_DFS_DOMAIN_UNKNOWN) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("PHYDM_DFS_DOMAIN_UNKNOWN\n")); -+ return FALSE; -+ } -+ -+ if (ODM_GetBBReg(pDM_Odm , 0x924, BIT15)) -+ enable_DFS = TRUE; -+ -+ if ((ODM_GetBBReg(pDM_Odm , 0xf98, BIT17)) -+ || (!(region_domain == PHYDM_DFS_DOMAIN_ETSI) && (ODM_GetBBReg(pDM_Odm , 0xf98, BIT19)))) -+ radar_detected = TRUE; -+ -+ if (enable_DFS && radar_detected) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD -+ , ("Radar detect: enable_DFS:%d, radar_detected:%d\n" -+ , enable_DFS, radar_detected)); -+ -+ phydm_radar_detect_reset(pDM_Odm); -+ } -+ -+exit: -+ return (enable_DFS && radar_detected); -+} -+#endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ -+ -+BOOLEAN -+phydm_dfs_master_enabled( -+ IN PVOID pDM_VOID -+ ) -+{ -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ return *pDM_Odm->dfs_master_enabled ? TRUE : FALSE; -+#else -+ return FALSE; -+#endif -+} -+ -+VOID -+phydm_dfs_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const argv, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ switch (argv[0]) { -+ case 1: -+ #if defined(CONFIG_PHYDM_DFS_MASTER) -+ /* set dbg parameters for radar detection instead of the default value */ -+ if (argv[1] == 1) { -+ pDM_Odm->radar_detect_reg_918 = argv[2]; -+ pDM_Odm->radar_detect_reg_91c = argv[3]; -+ pDM_Odm->radar_detect_reg_920 = argv[4]; -+ pDM_Odm->radar_detect_reg_924 = argv[5]; -+ pDM_Odm->radar_detect_dbg_parm_en = 1; -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "Radar detection with dbg parameter\n")); -+ PHYDM_SNPRINTF((output+used, out_len-used, "reg918:0x%08X\n", pDM_Odm->radar_detect_reg_918)); -+ PHYDM_SNPRINTF((output+used, out_len-used, "reg91c:0x%08X\n", pDM_Odm->radar_detect_reg_91c)); -+ PHYDM_SNPRINTF((output+used, out_len-used, "reg920:0x%08X\n", pDM_Odm->radar_detect_reg_920)); -+ PHYDM_SNPRINTF((output+used, out_len-used, "reg924:0x%08X\n", pDM_Odm->radar_detect_reg_924)); -+ } else { -+ pDM_Odm->radar_detect_dbg_parm_en = 0; -+ PHYDM_SNPRINTF((output+used, out_len-used, "Radar detection with default parameter\n")); -+ } -+ phydm_radar_detect_enable(pDM_Odm); -+ #endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ -+ -+ break; -+ default: -+ break; -+ } -+} -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dfs.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dfs.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dfs.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dfs.h 2018-02-11 21:44:27.155146208 +0200 -@@ -0,0 +1,76 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDM_DFS_H__ -+#define __PHYDM_DFS_H__ -+ -+#define DFS_VERSION "0.0" -+ -+/* ============================================================ -+ Definition -+ ============================================================ -+*/ -+ -+/* -+============================================================ -+1 structure -+ ============================================================ -+*/ -+ -+/* ============================================================ -+ enumeration -+ ============================================================ -+*/ -+ -+typedef enum _tag_PhyDM_DFS_REGION_DOMAIN { -+ PHYDM_DFS_DOMAIN_UNKNOWN = 0, -+ PHYDM_DFS_DOMAIN_FCC = 1, -+ PHYDM_DFS_DOMAIN_MKK = 2, -+ PHYDM_DFS_DOMAIN_ETSI = 3, -+} PHYDM_DFS_REGION_DOMAIN; -+ -+/* -+============================================================ -+ function prototype -+============================================================ -+*/ -+#if defined(CONFIG_PHYDM_DFS_MASTER) -+VOID phydm_radar_detect_reset(PVOID pDM_VOID); -+VOID phydm_radar_detect_disable(PVOID pDM_VOID); -+VOID phydm_radar_detect_enable(PVOID pDM_VOID); -+BOOLEAN phydm_radar_detect(PVOID pDM_VOID); -+#endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ -+ -+BOOLEAN -+phydm_dfs_master_enabled( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+phydm_dfs_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const argv, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ); -+ -+#endif /*#ifndef __PHYDM_DFS_H__ */ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dig.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dig.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dig.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dig.c 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,2285 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+ -+VOID -+ODM_ChangeDynamicInitGainThresh( -+ IN PVOID pDM_VOID, -+ IN u4Byte DM_Type, -+ IN u4Byte DM_Value -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ if (DM_Type == DIG_TYPE_THRESH_HIGH) -+ { -+ pDM_DigTable->RssiHighThresh = DM_Value; -+ } -+ else if (DM_Type == DIG_TYPE_THRESH_LOW) -+ { -+ pDM_DigTable->RssiLowThresh = DM_Value; -+ } -+ else if (DM_Type == DIG_TYPE_ENABLE) -+ { -+ pDM_DigTable->Dig_Enable_Flag = TRUE; -+ } -+ else if (DM_Type == DIG_TYPE_DISABLE) -+ { -+ pDM_DigTable->Dig_Enable_Flag = FALSE; -+ } -+ else if (DM_Type == DIG_TYPE_BACKOFF) -+ { -+ if(DM_Value > 30) -+ DM_Value = 30; -+ pDM_DigTable->BackoffVal = (u1Byte)DM_Value; -+ } -+ else if(DM_Type == DIG_TYPE_RX_GAIN_MIN) -+ { -+ if(DM_Value == 0) -+ DM_Value = 0x1; -+ pDM_DigTable->rx_gain_range_min = (u1Byte)DM_Value; -+ } -+ else if(DM_Type == DIG_TYPE_RX_GAIN_MAX) -+ { -+ if(DM_Value > 0x50) -+ DM_Value = 0x50; -+ pDM_DigTable->rx_gain_range_max = (u1Byte)DM_Value; -+ } -+} // DM_ChangeDynamicInitGainThresh // -+ -+int -+getIGIForDiff(int value_IGI) -+{ -+ #define ONERCCA_LOW_TH 0x30 -+ #define ONERCCA_LOW_DIFF 8 -+ -+ if (value_IGI < ONERCCA_LOW_TH) { -+ if ((ONERCCA_LOW_TH - value_IGI) < ONERCCA_LOW_DIFF) -+ return ONERCCA_LOW_TH; -+ else -+ return value_IGI + ONERCCA_LOW_DIFF; -+ } else { -+ return value_IGI; -+ } -+} -+ -+VOID -+odm_FAThresholdCheck( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN bDFSBand, -+ IN BOOLEAN bPerformance, -+ IN u4Byte RxTp, -+ IN u4Byte TxTp, -+ OUT u4Byte* dm_FA_thres -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if(pDM_Odm->bLinked && (bPerformance||bDFSBand)) -+ { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ /*For AP*/ -+ if ((RxTp>>2) > TxTp && RxTp < 10000 && RxTp > 500) { /*10Mbps & 0.5Mbps*/ -+ dm_FA_thres[0] = 0x080; -+ dm_FA_thres[1] = 0x100; -+ dm_FA_thres[2] = 0x200; -+ } else { -+ dm_FA_thres[0] = 0x100; -+ dm_FA_thres[1] = 0x200; -+ dm_FA_thres[2] = 0x300; -+ } -+#else -+ /*For NIC*/ -+ dm_FA_thres[0] = DM_DIG_FA_TH0; -+ dm_FA_thres[1] = DM_DIG_FA_TH1; -+ dm_FA_thres[2] = DM_DIG_FA_TH2; -+#endif -+ } else { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) -+ if(bDFSBand) -+ { -+ // For DFS band and no link -+ dm_FA_thres[0] = 250; -+ dm_FA_thres[1] = 1000; -+ dm_FA_thres[2] = 2000; -+ } -+ else -+#endif -+ { -+ dm_FA_thres[0] = 2000; -+ dm_FA_thres[1] = 4000; -+ dm_FA_thres[2] = 5000; -+ } -+ } -+ return; -+} -+ -+u1Byte -+odm_ForbiddenIGICheck( -+ IN PVOID pDM_VOID, -+ IN u1Byte DIG_Dynamic_MIN, -+ IN u1Byte CurrentIGI -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+ u1Byte rx_gain_range_min = pDM_DigTable->rx_gain_range_min; -+ -+ if (pDM_DigTable->LargeFA_Timeout) { -+ if (--pDM_DigTable->LargeFA_Timeout == 0) -+ pDM_DigTable->LargeFAHit = 0; -+ } -+ -+ if (pFalseAlmCnt->Cnt_all > 10000) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormally false alarm case.\n")); -+ -+ if(pDM_DigTable->LargeFAHit != 3) -+ pDM_DigTable->LargeFAHit++; -+ -+ if(pDM_DigTable->ForbiddenIGI < CurrentIGI)//if(pDM_DigTable->ForbiddenIGI < pDM_DigTable->CurIGValue) -+ { -+ pDM_DigTable->ForbiddenIGI = CurrentIGI;//pDM_DigTable->ForbiddenIGI = pDM_DigTable->CurIGValue; -+ pDM_DigTable->LargeFAHit = 1; -+ pDM_DigTable->LargeFA_Timeout = LARGE_FA_TIMEOUT; -+ } -+ -+ if(pDM_DigTable->LargeFAHit >= 3) -+ { -+ if((pDM_DigTable->ForbiddenIGI + 2) > pDM_DigTable->rx_gain_range_max) -+ rx_gain_range_min = pDM_DigTable->rx_gain_range_max; -+ else -+ rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 2); -+ pDM_DigTable->Recover_cnt = 1800; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormally false alarm case: Recover_cnt = %d\n", pDM_DigTable->Recover_cnt)); -+ } -+ } -+ -+ else if (pFalseAlmCnt->Cnt_all > 2000) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Abnormally false alarm case.\n")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Cnt_all=%d, Cnt_all_pre=%d, CurrentIGI=0x%x, PreIGValue=0x%x\n", -+ pFalseAlmCnt->Cnt_all, pFalseAlmCnt->Cnt_all_pre, CurrentIGI, pDM_DigTable->PreIGValue)); -+ -+ /* pFalseAlmCnt->Cnt_all = 1.1875*pFalseAlmCnt->Cnt_all_pre */ -+ if ((pFalseAlmCnt->Cnt_all > (pFalseAlmCnt->Cnt_all_pre + (pFalseAlmCnt->Cnt_all_pre >> 3) + (pFalseAlmCnt->Cnt_all_pre >> 4))) && (CurrentIGI < pDM_DigTable->PreIGValue)) { -+ if (pDM_DigTable->LargeFAHit != 3) -+ pDM_DigTable->LargeFAHit++; -+ -+ if (pDM_DigTable->ForbiddenIGI < CurrentIGI) { /*if(pDM_DigTable->ForbiddenIGI < pDM_DigTable->CurIGValue)*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Updating ForbiddenIGI by CurrentIGI, ForbiddenIGI=0x%x, CurrentIGI=0x%x\n", -+ pDM_DigTable->ForbiddenIGI, CurrentIGI)); -+ -+ pDM_DigTable->ForbiddenIGI = CurrentIGI; /*pDM_DigTable->ForbiddenIGI = pDM_DigTable->CurIGValue;*/ -+ pDM_DigTable->LargeFAHit = 1; -+ pDM_DigTable->LargeFA_Timeout = LARGE_FA_TIMEOUT; -+ } -+ -+ } -+ -+ if (pDM_DigTable->LargeFAHit >= 3) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("FaHit is greater than 3, rx_gain_range_max=0x%x, rx_gain_range_min=0x%x, ForbiddenIGI=0x%x\n", -+ pDM_DigTable->rx_gain_range_max, rx_gain_range_min, pDM_DigTable->ForbiddenIGI)); -+ -+ if ((pDM_DigTable->ForbiddenIGI + 1) > pDM_DigTable->rx_gain_range_max) -+ rx_gain_range_min = pDM_DigTable->rx_gain_range_max; -+ else -+ rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 1); -+ -+ pDM_DigTable->Recover_cnt = 1200; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Abnormally false alarm case: Recover_cnt = %d, rx_gain_range_min = 0x%x\n", pDM_DigTable->Recover_cnt, rx_gain_range_min)); -+ } -+ } -+ -+ else -+ { -+ if (pDM_DigTable->Recover_cnt != 0) { -+ -+ pDM_DigTable->Recover_cnt --; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Recover_cnt = %d\n", pDM_DigTable->Recover_cnt)); -+ } -+ else -+ { -+ if(pDM_DigTable->LargeFAHit < 3) -+ { -+ if((pDM_DigTable->ForbiddenIGI - 2) < DIG_Dynamic_MIN) //DM_DIG_MIN) -+ { -+ pDM_DigTable->ForbiddenIGI = DIG_Dynamic_MIN; //DM_DIG_MIN; -+ rx_gain_range_min = DIG_Dynamic_MIN; //DM_DIG_MIN; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: At Lower Bound\n")); -+ } -+ else -+ { -+ if (pDM_DigTable->LargeFAHit == 0) { -+ pDM_DigTable->ForbiddenIGI -= 2; -+ rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 2); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Approach Lower Bound\n")); -+ } -+ } -+ } -+ else -+ { -+ pDM_DigTable->LargeFAHit = 0; -+ } -+ } -+ } -+ -+ return rx_gain_range_min; -+ -+} -+ -+VOID -+odm_InbandNoiseCalculate ( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ u1Byte IGIBackup, TimeCnt = 0, ValidCnt = 0; -+ BOOLEAN bTimeout = TRUE; -+ s1Byte sNoise_A, sNoise_B; -+ s4Byte NoiseRpt_A = 0,NoiseRpt_B = 0; -+ u4Byte tmp = 0; -+ static u1Byte failCnt = 0; -+ -+ if(!(pDM_Odm->SupportICType & (ODM_RTL8192E))) -+ return; -+ -+ if(pDM_Odm->RFType == ODM_1T1R || *(pDM_Odm->pOnePathCCA) != ODM_CCA_2R) -+ return; -+ -+ if(!pDM_DigTable->bNoiseEst) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_InbandNoiseEstimate()========>\n")); -+ -+ //1 Set initial gain. -+ IGIBackup = pDM_DigTable->CurIGValue; -+ pDM_DigTable->IGIOffset_A = 0; -+ pDM_DigTable->IGIOffset_B = 0; -+ ODM_Write_DIG(pDM_Odm, 0x24); -+ -+ //1 Update idle time power report -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TX_ANT_CTRL_11N, BIT25, 0x0); -+ -+ delay_ms(2); -+ -+ //1 Get noise power level -+ while(1) -+ { -+ //2 Read Noise Floor Report -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ tmp = ODM_GetBBReg(pDM_Odm, 0x8f8, bMaskLWord); -+ -+ sNoise_A = (s1Byte)(tmp & 0xff); -+ sNoise_B = (s1Byte)((tmp & 0xff00)>>8); -+ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("sNoise_A = %d, sNoise_B = %d\n",sNoise_A, sNoise_B)); -+ -+ if((sNoise_A < 20 && sNoise_A >= -70) && (sNoise_B < 20 && sNoise_B >= -70)) -+ { -+ ValidCnt++; -+ NoiseRpt_A += sNoise_A; -+ NoiseRpt_B += sNoise_B; -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("sNoise_A = %d, sNoise_B = %d\n",sNoise_A, sNoise_B)); -+ } -+ -+ TimeCnt++; -+ bTimeout = (TimeCnt >= 150)?TRUE:FALSE; -+ -+ if(ValidCnt == 20 || bTimeout) -+ break; -+ -+ delay_ms(2); -+ -+ } -+ -+ //1 Keep idle time power report -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ ODM_SetBBReg(pDM_Odm, ODM_REG_TX_ANT_CTRL_11N, BIT25, 0x1); -+ -+ //1 Recover IGI -+ ODM_Write_DIG(pDM_Odm, IGIBackup); -+ -+ //1 Calculate Noise Floor -+ if(ValidCnt != 0) -+ { -+ NoiseRpt_A /= (ValidCnt<<1); -+ NoiseRpt_B /= (ValidCnt<<1); -+ } -+ -+ if(bTimeout) -+ { -+ NoiseRpt_A = 0; -+ NoiseRpt_B = 0; -+ -+ failCnt ++; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("Noise estimate fail time = %d\n", failCnt)); -+ -+ if(failCnt == 3) -+ { -+ failCnt = 0; -+ pDM_DigTable->bNoiseEst = FALSE; -+ } -+ } -+ else -+ { -+ NoiseRpt_A = -110 + 0x24 + NoiseRpt_A -6; -+ NoiseRpt_B = -110 + 0x24 + NoiseRpt_B -6; -+ pDM_DigTable->bNoiseEst = FALSE; -+ failCnt = 0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("NoiseRpt_A = %d, NoiseRpt_B = %d\n", NoiseRpt_A, NoiseRpt_B)); -+ } -+ -+ //1 Calculate IGI Offset -+ if(NoiseRpt_A > NoiseRpt_B) -+ { -+ pDM_DigTable->IGIOffset_A = NoiseRpt_A - NoiseRpt_B; -+ pDM_DigTable->IGIOffset_B = 0; -+ } -+ else -+ { -+ pDM_DigTable->IGIOffset_A = 0; -+ pDM_DigTable->IGIOffset_B = NoiseRpt_B - NoiseRpt_A; -+ } -+ -+#endif -+ return; -+} -+ -+VOID -+odm_DigForBtHsMode( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable=&pDM_Odm->DM_DigTable; -+ u1Byte digForBtHs=0; -+ u1Byte digUpBound=0x5a; -+ -+ if (pDM_Odm->bBtConnectProcess) { -+ digForBtHs = 0x22; -+ } else { -+ // -+ // Decide DIG value by BT HS RSSI. -+ // -+ digForBtHs = pDM_Odm->btHsRssi+4; -+ -+ //DIG Bound -+ if(digForBtHs > digUpBound) -+ digForBtHs = digUpBound; -+ if(digForBtHs < 0x1c) -+ digForBtHs = 0x1c; -+ -+ // update Current IGI -+ pDM_DigTable->BT30_CurIGI = digForBtHs; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DigForBtHsMode() : set DigValue=0x%x\n", digForBtHs)); -+#endif -+} -+ -+VOID -+phydm_setBigJumpStep( -+ IN PVOID pDM_VOID, -+ IN u1Byte CurrentIGI -+) -+{ -+#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ u1Byte step1[8] = {24, 30, 40, 50, 60, 70, 80, 90}; -+ u1Byte i; -+ -+ if (pDM_DigTable->enableAdjustBigJump == 0) -+ return; -+ -+ for (i = 0; i <= pDM_DigTable->bigJumpStep1; i++) { -+ if ((CurrentIGI + step1[i]) > pDM_DigTable->bigJumpLmt[pDM_DigTable->agcTableIdx]) { -+ if (i != 0) -+ i = i - 1; -+ break; -+ } else if (i == pDM_DigTable->bigJumpStep1) -+ break; -+ } -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ ODM_SetBBReg(pDM_Odm, 0x8c8, 0xe, i); -+ else if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_AGC_SET_2_11N, 0xe, i); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_setBigJumpStep(): bigjump = %d (ori = 0x%d), LMT=0x%x\n", i, pDM_DigTable->bigJumpStep1, pDM_DigTable->bigJumpLmt[pDM_DigTable->agcTableIdx])); -+#endif -+} -+ -+VOID -+ODM_Write_DIG( -+ IN PVOID pDM_VOID, -+ IN u1Byte CurrentIGI -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ if (pDM_DigTable->bStopDIG) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_Write_DIG(): Stop Writing IGI\n")); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_Write_DIG(): ODM_REG(IGI_A,pDM_Odm)=0x%x, ODM_BIT(IGI,pDM_Odm)=0x%x\n", -+ ODM_REG(IGI_A,pDM_Odm),ODM_BIT(IGI,pDM_Odm))); -+ -+ //1 Check initial gain by upper bound -+ if ((!pDM_DigTable->bPSDInProgress) && pDM_Odm->bLinked) -+ { -+ if (CurrentIGI > pDM_DigTable->rx_gain_range_max) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_Write_DIG(): CurrentIGI(0x%02x) is larger than upper bound !!\n", CurrentIGI)); -+ CurrentIGI = pDM_DigTable->rx_gain_range_max; -+ } -+ if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY && pDM_Odm->adaptivity_flag == TRUE) -+ { -+ if(CurrentIGI > pDM_Odm->Adaptivity_IGI_upper) -+ CurrentIGI = pDM_Odm->Adaptivity_IGI_upper; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_Write_DIG(): Adaptivity case: Force upper bound to 0x%x !!!!!!\n", CurrentIGI)); -+ } -+ } -+ -+ if(pDM_DigTable->CurIGValue != CurrentIGI) -+ { -+ -+#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) -+ /* Modify big jump step for 8822B and 8197F */ -+ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F)) -+ phydm_setBigJumpStep(pDM_Odm, CurrentIGI); -+#endif -+ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+ /* Set IGI value of CCK for new CCK AGC */ -+ if (pDM_Odm->cck_new_agc) { -+ if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) -+ ODM_SetBBReg(pDM_Odm, 0xa0c, 0x00003f00, (CurrentIGI>>1)); -+ } -+#endif -+ -+ /*Add by YuChen for USB IO too slow issue*/ -+ if ((pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) && (CurrentIGI > pDM_DigTable->CurIGValue)) -+ Phydm_Adaptivity(pDM_Odm, CurrentIGI); -+ -+ //1 Set IGI value -+ if (pDM_Odm->SupportPlatform & (ODM_WIN|ODM_CE)) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ -+ if(pDM_Odm->RFType > ODM_1T1R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_C,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_D,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ } -+#endif -+ } else if (pDM_Odm->SupportPlatform & (ODM_AP)) { -+ switch(*(pDM_Odm->pOnePathCCA)) -+ { -+ case ODM_CCA_2R: -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ -+ if(pDM_Odm->RFType > ODM_1T1R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) { -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_C,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_D,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ } -+#endif -+ break; -+ case ODM_CCA_1R_A: -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ if(pDM_Odm->RFType != ODM_1T1R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), getIGIForDiff(CurrentIGI)); -+ break; -+ case ODM_CCA_1R_B: -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B, pDM_Odm), ODM_BIT(IGI, pDM_Odm), getIGIForDiff(CurrentIGI)); -+ if (pDM_Odm->RFType != ODM_1T1R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A, pDM_Odm), ODM_BIT(IGI, pDM_Odm), CurrentIGI); -+ break; -+ } -+ } -+ -+ pDM_DigTable->CurIGValue = CurrentIGI; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_Write_DIG(): CurrentIGI(0x%02x).\n", CurrentIGI)); -+ -+} -+ -+VOID -+odm_PauseDIG( -+ IN PVOID pDM_VOID, -+ IN PHYDM_PAUSE_TYPE PauseType, -+ IN PHYDM_PAUSE_LEVEL pause_level, -+ IN u1Byte IGIValue -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG()=========> level = %d\n", pause_level)); -+ -+ if ((pDM_DigTable->pause_dig_level == 0) && (!(pDM_Odm->SupportAbility & ODM_BB_DIG) || !(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, -+ ("odm_PauseDIG(): Return: SupportAbility DIG or FA is disabled !!\n")); -+ return; -+ } -+ -+ if (pause_level > DM_DIG_MAX_PAUSE_TYPE) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, -+ ("odm_PauseDIG(): Return: Wrong pause level !!\n")); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_dig_level, IGIValue)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", -+ pDM_DigTable->pause_dig_value[7], pDM_DigTable->pause_dig_value[6], pDM_DigTable->pause_dig_value[5], pDM_DigTable->pause_dig_value[4], -+ pDM_DigTable->pause_dig_value[3], pDM_DigTable->pause_dig_value[2], pDM_DigTable->pause_dig_value[1], pDM_DigTable->pause_dig_value[0])); -+ -+ switch (PauseType) { -+ /* Pause DIG */ -+ case PHYDM_PAUSE: -+ { -+ /* Disable DIG */ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility & (~ODM_BB_DIG)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Pause DIG !!\n")); -+ -+ /* Backup IGI value */ -+ if (pDM_DigTable->pause_dig_level == 0) { -+ pDM_DigTable->IGIBackup = pDM_DigTable->CurIGValue; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Backup IGI = 0x%x, new IGI = 0x%x\n", pDM_DigTable->IGIBackup, IGIValue)); -+ } -+ -+ /* Record IGI value */ -+ pDM_DigTable->pause_dig_value[pause_level] = IGIValue; -+ -+ /* Update pause level */ -+ pDM_DigTable->pause_dig_level = (pDM_DigTable->pause_dig_level | BIT(pause_level)); -+ -+ /* Write new IGI value */ -+ if (BIT(pause_level + 1) > pDM_DigTable->pause_dig_level) { -+ ODM_Write_DIG(pDM_Odm, IGIValue); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): IGI of higher level = 0x%x\n", IGIValue)); -+ } -+ break; -+ } -+ /* Resume DIG */ -+ case PHYDM_RESUME: -+ { -+ /* check if the level is illegal or not */ -+ if ((pDM_DigTable->pause_dig_level & (BIT(pause_level))) != 0) { -+ pDM_DigTable->pause_dig_level = pDM_DigTable->pause_dig_level & (~(BIT(pause_level))); -+ pDM_DigTable->pause_dig_value[pause_level] = 0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Resume DIG !!\n")); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Wrong resume level !!\n")); -+ break; -+ } -+ -+ /* Resume DIG */ -+ if (pDM_DigTable->pause_dig_level == 0) { -+ /* Write backup IGI value */ -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->IGIBackup); -+ pDM_DigTable->bIgnoreDIG = TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Write original IGI = 0x%x\n", pDM_DigTable->IGIBackup)); -+ -+ /* Enable DIG */ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility | ODM_BB_DIG); -+ break; -+ } -+ -+ if (BIT(pause_level) > pDM_DigTable->pause_dig_level) { -+ s1Byte max_level; -+ -+ /* Calculate the maximum level now */ -+ for (max_level = (pause_level - 1); max_level >= 0; max_level--) { -+ if ((pDM_DigTable->pause_dig_level & BIT(max_level)) > 0) -+ break; -+ } -+ -+ /* write IGI of lower level */ -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->pause_dig_value[max_level]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Write IGI (0x%x) of level (%d)\n", -+ pDM_DigTable->pause_dig_value[max_level], max_level)); -+ break; -+ } -+ break; -+ } -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Wrong type !!\n")); -+ break; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_dig_level, IGIValue)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", -+ pDM_DigTable->pause_dig_value[7], pDM_DigTable->pause_dig_value[6], pDM_DigTable->pause_dig_value[5], pDM_DigTable->pause_dig_value[4], -+ pDM_DigTable->pause_dig_value[3], pDM_DigTable->pause_dig_value[2], pDM_DigTable->pause_dig_value[1], pDM_DigTable->pause_dig_value[0])); -+ -+} -+ -+BOOLEAN -+odm_DigAbort( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+#endif -+ -+ //SupportAbility -+ if(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: SupportAbility ODM_BB_FA_CNT is disabled\n")); -+ return TRUE; -+ } -+ -+ //SupportAbility -+ if(!(pDM_Odm->SupportAbility & ODM_BB_DIG)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: SupportAbility ODM_BB_DIG is disabled\n")); -+ return TRUE; -+ } -+ -+ //ScanInProcess -+ if(*(pDM_Odm->pbScanInProcess)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: In Scan Progress \n")); -+ return TRUE; -+ } -+ -+ if(pDM_DigTable->bIgnoreDIG) -+ { -+ pDM_DigTable->bIgnoreDIG = FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Ignore DIG \n")); -+ return TRUE; -+ } -+ -+ //add by Neil Chen to avoid PSD is processing -+ if(pDM_Odm->bDMInitialGainEnable == FALSE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: PSD is Processing \n")); -+ return TRUE; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #if OS_WIN_FROM_WIN7(OS_VERSION) -+ if(IsAPModeExist( pAdapter) && pAdapter->bInHctTest) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Is AP mode or In HCT Test \n")); -+ return TRUE; -+ } -+ #endif -+ -+ if(pDM_Odm->bBtHsOperation) -+ { -+ odm_DigForBtHsMode(pDM_Odm); -+ } -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+ if((pDM_Odm->bLinked) && (pDM_Odm->Adapter->registrypriv.force_igi !=0)) -+ { -+ printk("pDM_Odm->RSSI_Min=%d \n",pDM_Odm->RSSI_Min); -+ ODM_Write_DIG(pDM_Odm,pDM_Odm->Adapter->registrypriv.force_igi); -+ return TRUE; -+ } -+ #endif -+#else -+ if (!(priv->up_time > 5)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Not In DIG Operation Period \n")); -+ return TRUE; -+ } -+#endif -+ -+ return FALSE; -+} -+ -+VOID -+odm_DIGInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+#endif -+ u4Byte ret_value; -+ u1Byte i; -+ -+ pDM_DigTable->bStopDIG = FALSE; -+ pDM_DigTable->bIgnoreDIG = FALSE; -+ pDM_DigTable->bPSDInProgress = FALSE; -+ pDM_DigTable->CurIGValue = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm)); -+ pDM_DigTable->PreIGValue = 0; -+ pDM_DigTable->RssiLowThresh = DM_DIG_THRESH_LOW; -+ pDM_DigTable->RssiHighThresh = DM_DIG_THRESH_HIGH; -+ pDM_DigTable->FALowThresh = DM_FALSEALARM_THRESH_LOW; -+ pDM_DigTable->FAHighThresh = DM_FALSEALARM_THRESH_HIGH; -+ pDM_DigTable->BackoffVal = DM_DIG_BACKOFF_DEFAULT; -+ pDM_DigTable->BackoffVal_range_max = DM_DIG_BACKOFF_MAX; -+ pDM_DigTable->BackoffVal_range_min = DM_DIG_BACKOFF_MIN; -+ pDM_DigTable->PreCCK_CCAThres = 0xFF; -+ pDM_DigTable->CurCCK_CCAThres = 0x83; -+ pDM_DigTable->ForbiddenIGI = DM_DIG_MIN_NIC; -+ pDM_DigTable->LargeFAHit = 0; -+ pDM_DigTable->LargeFA_Timeout = 0; -+ pDM_DigTable->Recover_cnt = 0; -+ pDM_DigTable->bMediaConnect_0 = FALSE; -+ pDM_DigTable->bMediaConnect_1 = FALSE; -+ -+ //To Initialize pDM_Odm->bDMInitialGainEnable == FALSE to avoid DIG error -+ pDM_Odm->bDMInitialGainEnable = TRUE; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ pDM_DigTable->DIG_Dynamic_MIN_0 = 0x25; -+ pDM_DigTable->DIG_Dynamic_MIN_1 = 0x25; -+ -+ // For AP\ ADSL modified DIG -+ pDM_DigTable->bTpTarget = FALSE; -+ pDM_DigTable->bNoiseEst = TRUE; -+ pDM_DigTable->IGIOffset_A = 0; -+ pDM_DigTable->IGIOffset_B = 0; -+ pDM_DigTable->TpTrainTH_min = 0; -+ -+ // For RTL8881A -+ FalseAlmCnt->Cnt_Ofdm_fail_pre = 0; -+ -+ //Dyanmic EDCCA -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ ODM_SetBBReg(pDM_Odm, 0xC50, 0xFFFF0000, 0xfafd); -+ } -+#else -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DM_DIG_MIN_NIC; -+ pDM_DigTable->DIG_Dynamic_MIN_1 = DM_DIG_MIN_NIC; -+ -+ //To Initi BT30 IGI -+ pDM_DigTable->BT30_CurIGI=0x32; -+ -+ ODM_Memory_Set(pDM_Odm, pDM_DigTable->pause_dig_value, 0, (DM_DIG_MAX_PAUSE_TYPE + 1)); -+ pDM_DigTable->pause_dig_level = 0; -+ ODM_Memory_Set(pDM_Odm, pDM_DigTable->pause_cckpd_value, 0, (DM_DIG_MAX_PAUSE_TYPE + 1)); -+ pDM_DigTable->pause_cckpd_level = 0; -+#endif -+ -+ if(pDM_Odm->BoardType & (ODM_BOARD_EXT_PA|ODM_BOARD_EXT_LNA)) -+ { -+ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; -+ pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; -+ } -+ else -+ { -+ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; -+ pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; -+ } -+ -+#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) -+ pDM_DigTable->enableAdjustBigJump = 1; -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) { -+ ret_value = ODM_GetBBReg(pDM_Odm, 0x8c8, bMaskLWord); -+ pDM_DigTable->bigJumpStep1 = (u1Byte)(ret_value & 0xe) >> 1; -+ pDM_DigTable->bigJumpStep2 = (u1Byte)(ret_value & 0x30)>>4; -+ pDM_DigTable->bigJumpStep3 = (u1Byte)(ret_value & 0xc0)>>6; -+ -+ } else if (pDM_Odm->SupportICType & ODM_RTL8197F) { -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_BB_AGC_SET_2_11N, bMaskLWord); -+ pDM_DigTable->bigJumpStep1 = (u1Byte)(ret_value & 0xe) >> 1; -+ pDM_DigTable->bigJumpStep2 = (u1Byte)(ret_value & 0x30)>>4; -+ pDM_DigTable->bigJumpStep3 = (u1Byte)(ret_value & 0xc0)>>6; -+ } -+ if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F)) { -+ for (i = 0; i < sizeof(pDM_DigTable->bigJumpLmt); i++) { -+ if (pDM_DigTable->bigJumpLmt[i] == 0) -+ pDM_DigTable->bigJumpLmt[i] = 0x64; /* Set -10dBm as default value */ -+ } -+ } -+#endif -+} -+ -+ -+VOID -+odm_DIG( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ PSTA_INFO_T pEntry; -+#endif -+ -+ // Common parameters -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+ BOOLEAN FirstConnect,FirstDisConnect; -+ u1Byte DIG_MaxOfMin, DIG_Dynamic_MIN; -+ u1Byte dm_dig_max, dm_dig_min; -+ u1Byte CurrentIGI = pDM_DigTable->CurIGValue; -+ u1Byte offset; -+ u4Byte dm_FA_thres[3]; -+ u4Byte TxTp = 0, RxTp = 0; -+ BOOLEAN DIG_GoUpCheck = TRUE; -+ BOOLEAN bDFSBand = FALSE; -+ BOOLEAN bPerformance = TRUE, bFirstTpTarget = FALSE, bFirstCoverage = FALSE; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ u4Byte TpTrainTH_MIN = DM_DIG_TP_Target_TH0; -+ static u1Byte TimeCnt = 0; -+ u1Byte i; -+#endif -+ -+ if(odm_DigAbort(pDM_Odm) == TRUE) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG()===========================>\n\n")); -+ -+ -+ //1 Update status -+ { -+ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; -+ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == FALSE); -+ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == TRUE); -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ //1 Noise Floor Estimate -+ //pDM_DigTable->bNoiseEst = (FirstConnect)?TRUE:pDM_DigTable->bNoiseEst; -+ //odm_InbandNoiseCalculate (pDM_Odm); -+ -+ //1 Mode decision -+ if(pDM_Odm->bLinked) -+ { -+ //2 Calculate total TP -+ for (i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pEntry)) -+ { -+ RxTp += (u4Byte)(pEntry->rx_byte_cnt_LowMAW>>7); -+ TxTp += (u4Byte)(pEntry->tx_byte_cnt_LowMAW>>7); //Kbps -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): TX TP = %dkbps, RX TP = %dkbps\n", TxTp, RxTp)); -+ } -+ -+ switch(pDM_Odm->priv->pshare->rf_ft_var.dig_cov_enable) -+ { -+ case 0: -+ { -+ bPerformance = TRUE; -+ break; -+ } -+ case 1: -+ { -+ bPerformance = FALSE; -+ break; -+ } -+ case 2: -+ { -+ if(pDM_Odm->bLinked) -+ { -+ if(pDM_DigTable->TpTrainTH_min > DM_DIG_TP_Target_TH0) -+ TpTrainTH_MIN = pDM_DigTable->TpTrainTH_min; -+ -+ if(pDM_DigTable->TpTrainTH_min > DM_DIG_TP_Target_TH1) -+ TpTrainTH_MIN = DM_DIG_TP_Target_TH1; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): TP training mode lower bound = %dkbps\n", TpTrainTH_MIN)); -+ -+ //2 Decide DIG mode by total TP -+ if((TxTp + RxTp) > DM_DIG_TP_Target_TH1) // change to performance mode -+ { -+ bFirstTpTarget = (!pDM_DigTable->bTpTarget)?TRUE:FALSE; -+ pDM_DigTable->bTpTarget = TRUE; -+ bPerformance = TRUE; -+ } -+ else if((TxTp + RxTp) < TpTrainTH_MIN) // change to coverage mode -+ { -+ bFirstCoverage = (pDM_DigTable->bTpTarget)?TRUE:FALSE; -+ -+ if(TimeCnt < DM_DIG_TP_Training_Period) -+ { -+ pDM_DigTable->bTpTarget = FALSE; -+ bPerformance = FALSE; -+ TimeCnt++; -+ } -+ else -+ { -+ pDM_DigTable->bTpTarget = TRUE; -+ bPerformance = TRUE; -+ bFirstTpTarget = TRUE; -+ TimeCnt = 0; -+ } -+ } -+ else // remain previous mode -+ { -+ bPerformance = pDM_DigTable->bTpTarget; -+ -+ if(!bPerformance) -+ { -+ if(TimeCnt < DM_DIG_TP_Training_Period) -+ TimeCnt++; -+ else -+ { -+ pDM_DigTable->bTpTarget = TRUE; -+ bPerformance = TRUE; -+ bFirstTpTarget = TRUE; -+ TimeCnt = 0; -+ } -+ } -+ } -+ -+ if(!bPerformance) -+ pDM_DigTable->TpTrainTH_min = RxTp + TxTp; -+ -+ } -+ else -+ { -+ bPerformance = FALSE; -+ pDM_DigTable->TpTrainTH_min = 0; -+ } -+ break; -+ } -+ default: -+ bPerformance = TRUE; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("====== DIG mode = %d ======\n", pDM_Odm->priv->pshare->rf_ft_var.dig_cov_enable)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("====== bPerformance = %d ======\n", bPerformance)); -+#endif -+ -+ //1 Boundary Decision -+ { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ //2 For AP\ADSL -+ if(!bPerformance) -+ { -+ dm_dig_max = DM_DIG_MAX_AP_COVERAGR; -+ dm_dig_min = DM_DIG_MIN_AP_COVERAGE; -+ DIG_MaxOfMin = DM_DIG_MAX_OF_MIN_COVERAGE; -+ } -+ else -+ { -+ if (pDM_Odm->RFType == ODM_1T1R) -+ dm_dig_max = DM_DIG_MAX_AP - 6; -+ else -+ dm_dig_max = DM_DIG_MAX_AP; -+ -+ if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) && (pDM_Odm->SupportICType & ODM_RTL8814A)) /* for 2G 8814 */ -+ dm_dig_min = 0x1c; -+ else -+ dm_dig_min = DM_DIG_MIN_AP; -+ DIG_MaxOfMin = DM_DIG_MAX_OF_MIN; -+ } -+ -+ //4 TX2path -+ if (priv->pmib->dot11RFEntry.tx2path && !bDFSBand && (*(pDM_Odm->pWirelessMode) == ODM_WM_B)) -+ dm_dig_max = 0x2A; -+ -+#if RTL8192E_SUPPORT -+#ifdef HIGH_POWER_EXT_LNA -+ if ((pDM_Odm->SupportICType & (ODM_RTL8192E)) && (pDM_Odm->ExtLNA)) -+ dm_dig_max = 0x42; -+#endif -+#endif -+ if (pDM_Odm->IGI_LowerBound) { -+ if (dm_dig_min < pDM_Odm->IGI_LowerBound) -+ dm_dig_min = pDM_Odm->IGI_LowerBound; -+ if (DIG_MaxOfMin < pDM_Odm->IGI_LowerBound) -+ DIG_MaxOfMin = pDM_Odm->IGI_LowerBound; -+ } -+ if (pDM_Odm->IGI_UpperBound) { -+ if (dm_dig_max > pDM_Odm->IGI_UpperBound) -+ dm_dig_max = pDM_Odm->IGI_UpperBound; -+ if (DIG_MaxOfMin > pDM_Odm->IGI_UpperBound) -+ DIG_MaxOfMin = pDM_Odm->IGI_UpperBound; -+ } -+#else -+ //2 For WIN\CE -+ if(pDM_Odm->SupportICType >= ODM_RTL8188E) -+ dm_dig_max = 0x5A; -+ else -+ dm_dig_max = DM_DIG_MAX_NIC; -+ -+ if(pDM_Odm->SupportICType != ODM_RTL8821) -+ dm_dig_min = DM_DIG_MIN_NIC; -+ else -+ dm_dig_min = 0x1C; -+ -+ DIG_MaxOfMin = DM_DIG_MAX_AP; -+#endif -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) -+ /* Modify lower bound for DFS band */ -+ if ((((*pDM_Odm->pChannel >= 52) && (*pDM_Odm->pChannel <= 64)) || -+ ((*pDM_Odm->pChannel >= 100) && (*pDM_Odm->pChannel <= 140))) -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ && phydm_dfs_master_enabled(pDM_Odm) == TRUE -+ #endif -+ ) { -+ bDFSBand = TRUE; -+ if (*pDM_Odm->pBandWidth == ODM_BW20M) -+ dm_dig_min = DM_DIG_MIN_AP_DFS+2; -+ else -+ dm_dig_min = DM_DIG_MIN_AP_DFS; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): ====== In DFS band ======\n")); -+ } -+#endif -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Absolutly upper bound = 0x%x, lower bound = 0x%x\n",dm_dig_max, dm_dig_min)); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if (pDM_Odm->pu1ForcedIgiLb && (0 < *pDM_Odm->pu1ForcedIgiLb)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Force IGI lb to: 0x%02x !!!!!!\n", *pDM_Odm->pu1ForcedIgiLb)); -+ dm_dig_min = *pDM_Odm->pu1ForcedIgiLb; -+ dm_dig_max = (dm_dig_min <= dm_dig_max) ? (dm_dig_max) : (dm_dig_min + 1); -+ } -+#endif -+ -+ //1 Adjust boundary by RSSI -+ if(pDM_Odm->bLinked && bPerformance) -+ { -+ //2 Modify DIG upper bound -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ offset = 15; -+#else -+ //4 Modify DIG upper bound for 92E, 8723A\B, 8821 & 8812 BT -+ if ((pDM_Odm->SupportICType & (ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8812|ODM_RTL8821)) && (pDM_Odm->bBtLimitedDig == 1)) -+ { -+ offset = 10; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Coex. case: Force upper bound to RSSI + %d !!!!!!\n", offset)); -+ } -+ else -+ offset = 15; -+#endif -+ -+ if((pDM_Odm->RSSI_Min + offset) > dm_dig_max ) -+ pDM_DigTable->rx_gain_range_max = dm_dig_max; -+ else if((pDM_Odm->RSSI_Min + offset) < dm_dig_min ) -+ pDM_DigTable->rx_gain_range_max = dm_dig_min; -+ else -+ pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + offset; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ //2 Modify DIG lower bound -+ //if(pDM_Odm->bOneEntryOnly) -+ { -+ if(pDM_Odm->RSSI_Min < dm_dig_min) -+ DIG_Dynamic_MIN = dm_dig_min; -+ else if (pDM_Odm->RSSI_Min > DIG_MaxOfMin) -+ DIG_Dynamic_MIN = DIG_MaxOfMin; -+ else -+ DIG_Dynamic_MIN = pDM_Odm->RSSI_Min; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ if (bDFSBand) { -+ DIG_Dynamic_MIN = dm_dig_min; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: Force lower bound to 0x%x after link !!!!!!\n", dm_dig_min)); -+ } -+#endif -+ } -+#else -+ { -+ //4 For AP -+#ifdef __ECOS -+ HAL_REORDER_BARRIER(); -+#else -+ rmb(); -+#endif -+ if (bDFSBand) -+ { -+ DIG_Dynamic_MIN = dm_dig_min; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: Force lower bound to 0x%x after link !!!!!!\n", dm_dig_min)); -+ } -+ else -+ { -+ if(pDM_Odm->RSSI_Min < dm_dig_min) -+ DIG_Dynamic_MIN = dm_dig_min; -+ else if (pDM_Odm->RSSI_Min > DIG_MaxOfMin) -+ DIG_Dynamic_MIN = DIG_MaxOfMin; -+ else -+ DIG_Dynamic_MIN = pDM_Odm->RSSI_Min; -+ } -+ } -+#endif -+ } -+ else -+ { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) -+ if(bPerformance && bDFSBand) -+ { -+ pDM_DigTable->rx_gain_range_max = 0x28; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: Force upper bound to 0x%x before link !!!!!!\n", pDM_DigTable->rx_gain_range_max)); -+ } -+ else -+#endif -+ { -+ if (bPerformance) -+ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_OF_MIN; -+ else -+ pDM_DigTable->rx_gain_range_max = dm_dig_max; -+ } -+ DIG_Dynamic_MIN = dm_dig_min; -+ } -+ -+ //1 Force Lower Bound for AntDiv -+ if(pDM_Odm->bLinked && !pDM_Odm->bOneEntryOnly) -+ { -+ if((pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) && (pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ { -+ if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV || pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) { -+ if (pDM_DigTable->AntDiv_RSSI_max > DIG_MaxOfMin) -+ DIG_Dynamic_MIN = DIG_MaxOfMin; -+ else -+ DIG_Dynamic_MIN = (u1Byte) pDM_DigTable->AntDiv_RSSI_max; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Antenna diversity case: Force lower bound to 0x%x !!!!!!\n", DIG_Dynamic_MIN)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Antenna diversity case: RSSI_max = 0x%x !!!!!!\n", pDM_DigTable->AntDiv_RSSI_max)); -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust boundary by RSSI Upper bound = 0x%x, Lower bound = 0x%x\n", -+ pDM_DigTable->rx_gain_range_max, DIG_Dynamic_MIN)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Link status: bLinked = %d, RSSI = %d, bFirstConnect = %d, bFirsrDisConnect = %d\n\n", -+ pDM_Odm->bLinked, pDM_Odm->RSSI_Min, FirstConnect, FirstDisConnect)); -+ -+ //1 Modify DIG lower bound, deal with abnormal case -+ //2 Abnormal false alarm case -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) -+ if(bDFSBand) -+ { -+ pDM_DigTable->rx_gain_range_min = DIG_Dynamic_MIN; -+ } -+ else -+#endif -+ { -+ if(!pDM_Odm->bLinked) -+ { -+ pDM_DigTable->rx_gain_range_min = DIG_Dynamic_MIN; -+ -+ if (FirstDisConnect) -+ pDM_DigTable->ForbiddenIGI = DIG_Dynamic_MIN; -+ } -+ else -+ pDM_DigTable->rx_gain_range_min = odm_ForbiddenIGICheck(pDM_Odm, DIG_Dynamic_MIN, CurrentIGI); -+ } -+ -+ //2 Abnormal # beacon case -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(pDM_Odm->bLinked && !FirstConnect) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Beacon Num (%d)\n", pDM_Odm->PhyDbgInfo.NumQryBeaconPkt)); -+ if((pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 5) && (pDM_Odm->bsta_state)) -+ { -+ pDM_DigTable->rx_gain_range_min = 0x1c; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnrormal #beacon (%d) case in STA mode: Force lower bound to 0x%x !!!!!!\n\n", -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt, pDM_DigTable->rx_gain_range_min)); -+ } -+ } -+#endif -+ -+ //2 Abnormal lower bound case -+ if(pDM_DigTable->rx_gain_range_min > pDM_DigTable->rx_gain_range_max) -+ { -+ pDM_DigTable->rx_gain_range_min = pDM_DigTable->rx_gain_range_max; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnrormal lower bound case: Force lower bound to 0x%x !!!!!!\n\n",pDM_DigTable->rx_gain_range_min)); -+ } -+ -+ -+ //1 False alarm threshold decision -+ odm_FAThresholdCheck(pDM_Odm, bDFSBand, bPerformance, RxTp, TxTp, dm_FA_thres); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): False alarm threshold = %d, %d, %d \n\n", dm_FA_thres[0], dm_FA_thres[1], dm_FA_thres[2])); -+ -+ //1 Adjust initial gain by false alarm -+ if(pDM_Odm->bLinked && bPerformance) -+ { -+ //2 After link -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust IGI after link\n")); -+ -+ if(bFirstTpTarget || (FirstConnect && bPerformance)) -+ { -+ pDM_DigTable->LargeFAHit = 0; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) -+ if(bDFSBand) -+ { -+ if(pDM_Odm->RSSI_Min > 0x28) -+ CurrentIGI = 0x28; -+ else -+ CurrentIGI = pDM_Odm->RSSI_Min; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: One-shot to 0x28 upmost!!!!!!\n")); -+ } -+ else -+#endif -+ { -+ if(pDM_Odm->RSSI_Min < DIG_MaxOfMin) -+ { -+ if(CurrentIGI < pDM_Odm->RSSI_Min) -+ CurrentIGI = pDM_Odm->RSSI_Min; -+ } -+ else -+ { -+ if(CurrentIGI < DIG_MaxOfMin) -+ CurrentIGI = DIG_MaxOfMin; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+#if (RTL8812A_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8812) -+ ODM_ConfigBBWithHeaderFile(pDM_Odm, CONFIG_BB_AGC_TAB_DIFF); -+#endif -+#endif -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): First connect case: IGI does on-shot to 0x%x\n", CurrentIGI)); -+ -+ } -+ else -+ { -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+ if (priv->pshare->rf_ft_var.dig_upcheck_enable) -+ DIG_GoUpCheck = phydm_DIG_GoUpCheck(pDM_Odm); -+#endif -+ -+ if((pFalseAlmCnt->Cnt_all > dm_FA_thres[2]) && DIG_GoUpCheck) -+ CurrentIGI = CurrentIGI + 4; -+ else if ((pFalseAlmCnt->Cnt_all > dm_FA_thres[1]) && DIG_GoUpCheck) -+ CurrentIGI = CurrentIGI + 2; -+ else if(pFalseAlmCnt->Cnt_all < dm_FA_thres[0]) -+ CurrentIGI = CurrentIGI - 2; -+ -+ //4 Abnormal # beacon case -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if((pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 5) && (pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH1) && (pDM_Odm->bsta_state)) -+ { -+ CurrentIGI = pDM_DigTable->rx_gain_range_min; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormal #beacon (%d) case: IGI does one-shot to 0x%x\n", -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt, CurrentIGI)); -+ } -+#endif -+ } -+ } -+ else -+ { -+ //2 Before link -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust IGI before link\n")); -+ -+ if(FirstDisConnect || bFirstCoverage) -+ { -+ CurrentIGI = dm_dig_min; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): First disconnect case: IGI does on-shot to lower bound\n")); -+ } -+ else -+ { -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ if (priv->pshare->rf_ft_var.dig_upcheck_enable) -+ DIG_GoUpCheck = phydm_DIG_GoUpCheck(pDM_Odm); -+#endif -+ -+ if((pFalseAlmCnt->Cnt_all > dm_FA_thres[2]) && DIG_GoUpCheck) -+ CurrentIGI = CurrentIGI + 4; -+ else if ((pFalseAlmCnt->Cnt_all > dm_FA_thres[1]) && DIG_GoUpCheck) -+ CurrentIGI = CurrentIGI + 2; -+ else if(pFalseAlmCnt->Cnt_all < dm_FA_thres[0]) -+ CurrentIGI = CurrentIGI - 2; -+ } -+ } -+ -+ //1 Check initial gain by upper/lower bound -+ if(CurrentIGI < pDM_DigTable->rx_gain_range_min) -+ CurrentIGI = pDM_DigTable->rx_gain_range_min; -+ -+ if(CurrentIGI > pDM_DigTable->rx_gain_range_max) -+ CurrentIGI = pDM_DigTable->rx_gain_range_max; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): CurIGValue=0x%x, TotalFA = %d\n\n", CurrentIGI, pFalseAlmCnt->Cnt_all)); -+ -+ //1 Update status -+ { -+#if ((DM_ODM_SUPPORT_TYPE & ODM_WIN) || ((DM_ODM_SUPPORT_TYPE & ODM_CE) && (ODM_CONFIG_BT_COEXIST == 1))) -+ if(pDM_Odm->bBtHsOperation) -+ { -+ if(pDM_Odm->bLinked) -+ { -+ if(pDM_DigTable->BT30_CurIGI > (CurrentIGI)) -+ ODM_Write_DIG(pDM_Odm, CurrentIGI); -+ else -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI); -+ -+ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; -+ } -+ else -+ { -+ if(pDM_Odm->bLinkInProcess) -+ ODM_Write_DIG(pDM_Odm, 0x1c); -+ else if(pDM_Odm->bBtConnectProcess) -+ ODM_Write_DIG(pDM_Odm, 0x28); -+ else -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); -+ } -+ } -+ else // BT is not using -+#endif -+ { -+ ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); -+ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; -+ } -+ } -+} -+ -+VOID -+odm_DIGbyRSSI_LPS( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+ -+ u1Byte RSSI_Lower=DM_DIG_MIN_NIC; //0x1E or 0x1C -+ u1Byte CurrentIGI=pDM_Odm->RSSI_Min; -+ -+ if(odm_DigAbort(pDM_Odm) == TRUE) -+ return; -+ -+ CurrentIGI=CurrentIGI+RSSI_OFFSET_DIG; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS()==>\n")); -+ -+ // Using FW PS mode to make IGI -+ //Adjust by FA in LPS MODE -+ if(pFalseAlmCnt->Cnt_all> DM_DIG_FA_TH2_LPS) -+ CurrentIGI = CurrentIGI+4; -+ else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1_LPS) -+ CurrentIGI = CurrentIGI+2; -+ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0_LPS) -+ CurrentIGI = CurrentIGI-2; -+ -+ -+ //Lower bound checking -+ -+ //RSSI Lower bound check -+ if((pDM_Odm->RSSI_Min-10) > DM_DIG_MIN_NIC) -+ RSSI_Lower =(pDM_Odm->RSSI_Min-10); -+ else -+ RSSI_Lower =DM_DIG_MIN_NIC; -+ -+ //Upper and Lower Bound checking -+ if(CurrentIGI > DM_DIG_MAX_NIC) -+ CurrentIGI = DM_DIG_MAX_NIC; -+ else if(CurrentIGI < RSSI_Lower) -+ CurrentIGI = RSSI_Lower; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS(): pFalseAlmCnt->Cnt_all = %d\n",pFalseAlmCnt->Cnt_all)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS(): pDM_Odm->RSSI_Min = %d\n",pDM_Odm->RSSI_Min)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS(): CurrentIGI = 0x%x\n",CurrentIGI)); -+ -+ ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); -+#endif -+} -+ -+//3============================================================ -+//3 FASLE ALARM CHECK -+//3============================================================ -+ -+VOID -+odm_FalseAlarmCounterStatistics( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+ u4Byte ret_value; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+//Mark there, and check this in odm_DMWatchDog -+#if 0 //(DM_ODM_SUPPORT_TYPE == ODM_AP) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ if( (priv->auto_channel != 0) && (priv->auto_channel != 2) ) -+ return; -+#endif -+#endif -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics()======>\n")); -+ -+#if (ODM_IC_11N_SERIES_SUPPORT == 1) -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ -+ //hold ofdm counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 1); //hold page C counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 1); //hold page D counter -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE1_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_Fast_Fsync = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_SB_Search_fail = ((ret_value&0xffff0000)>>16); -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE2_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_OFDM_CCA = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_Parity_Fail = ((ret_value&0xffff0000)>>16); -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE3_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_Rate_Illegal = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_Crc8_fail = ((ret_value&0xffff0000)>>16); -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE4_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_Mcs_fail = (ret_value&0xffff); -+ -+ FalseAlmCnt->Cnt_Ofdm_fail = FalseAlmCnt->Cnt_Parity_Fail + FalseAlmCnt->Cnt_Rate_Illegal + -+ FalseAlmCnt->Cnt_Crc8_fail + FalseAlmCnt->Cnt_Mcs_fail + -+ FalseAlmCnt->Cnt_Fast_Fsync + FalseAlmCnt->Cnt_SB_Search_fail; -+ -+ /* read CCK CRC32 counter */ -+ FalseAlmCnt->cnt_cck_crc32_error = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CRC32_ERROR_CNT_11N, bMaskDWord); -+ FalseAlmCnt->cnt_cck_crc32_ok= ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CRC32_OK_CNT_11N, bMaskDWord); -+ -+ /* read OFDM CRC32 counter */ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_CRC32_CNT_11N, bMaskDWord); -+ FalseAlmCnt->cnt_ofdm_crc32_error = (ret_value & 0xffff0000) >> 16; -+ FalseAlmCnt->cnt_ofdm_crc32_ok= ret_value & 0xffff; -+ -+ /* read HT CRC32 counter */ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_HT_CRC32_CNT_11N, bMaskDWord); -+ FalseAlmCnt->cnt_ht_crc32_error = (ret_value & 0xffff0000) >> 16; -+ FalseAlmCnt->cnt_ht_crc32_ok= ret_value & 0xffff; -+ -+ /* read VHT CRC32 counter */ -+ FalseAlmCnt->cnt_vht_crc32_error = 0; -+ FalseAlmCnt->cnt_vht_crc32_ok= 0; -+ -+#if (RTL8188E_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_SC_CNT_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_BW_LSC = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_BW_USC = ((ret_value&0xffff0000)>>16); -+ } -+#endif -+ -+ { -+ //hold cck counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT12, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT14, 1); -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_LSB_11N, bMaskByte0); -+ FalseAlmCnt->Cnt_Cck_fail = ret_value; -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_MSB_11N, bMaskByte3); -+ FalseAlmCnt->Cnt_Cck_fail += (ret_value& 0xff)<<8; -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CCA_CNT_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_CCK_CCA = ((ret_value&0xFF)<<8) |((ret_value&0xFF00)>>8); -+ } -+ -+ FalseAlmCnt->Cnt_all_pre = FalseAlmCnt->Cnt_all; -+ -+ FalseAlmCnt->Cnt_all = ( FalseAlmCnt->Cnt_Fast_Fsync + -+ FalseAlmCnt->Cnt_SB_Search_fail + -+ FalseAlmCnt->Cnt_Parity_Fail + -+ FalseAlmCnt->Cnt_Rate_Illegal + -+ FalseAlmCnt->Cnt_Crc8_fail + -+ FalseAlmCnt->Cnt_Mcs_fail + -+ FalseAlmCnt->Cnt_Cck_fail); -+ -+ FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_OFDM_CCA + FalseAlmCnt->Cnt_CCK_CCA; -+ -+ if (pDM_Odm->SupportICType >= ODM_RTL8188E) { -+ /*reset false alarm counter registers*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT31, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT31, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT27, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT27, 0); -+ -+ /*update ofdm counter*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 0); /*update page C counter*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 0); /*update page D counter*/ -+ -+ /*reset CCK CCA counter*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT13|BIT12, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT13|BIT12, 2); -+ -+ /*reset CCK FA counter*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT15|BIT14, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT15|BIT14, 2); -+ -+ /*reset CRC32 counter*/ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_PAGE_F_RST_11N, BIT16, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_PAGE_F_RST_11N, BIT16, 0); -+ } -+ -+ /* Get debug port 0 */ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11N, bMaskDWord, 0x0); -+ FalseAlmCnt->dbg_port0 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11N, bMaskDWord); -+ -+ /* Get EDCCA flag */ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11N, bMaskDWord, 0x208); -+ FalseAlmCnt->edcca_flag = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11N, BIT30); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Fast_Fsync=%d, Cnt_SB_Search_fail=%d\n", -+ FalseAlmCnt->Cnt_Fast_Fsync, FalseAlmCnt->Cnt_SB_Search_fail)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Parity_Fail=%d, Cnt_Rate_Illegal=%d\n", -+ FalseAlmCnt->Cnt_Parity_Fail, FalseAlmCnt->Cnt_Rate_Illegal)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Crc8_fail=%d, Cnt_Mcs_fail=%d\n", -+ FalseAlmCnt->Cnt_Crc8_fail, FalseAlmCnt->Cnt_Mcs_fail)); -+ } -+#endif -+ -+#if (ODM_IC_11AC_SERIES_SUPPORT == 1) -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ u4Byte CCKenable; -+ -+ /* read OFDM FA counter */ -+ FalseAlmCnt->Cnt_Ofdm_fail = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_11AC, bMaskLWord); -+ -+ /* Read CCK FA counter */ -+ FalseAlmCnt->Cnt_Cck_fail = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_11AC, bMaskLWord); -+ -+ /* read CCK/OFDM CCA counter */ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CCA_CNT_11AC, bMaskDWord); -+ FalseAlmCnt->Cnt_OFDM_CCA = (ret_value & 0xffff0000) >> 16; -+ FalseAlmCnt->Cnt_CCK_CCA = ret_value & 0xffff; -+ -+ /* read CCK CRC32 counter */ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CRC32_CNT_11AC, bMaskDWord); -+ FalseAlmCnt->cnt_cck_crc32_error = (ret_value & 0xffff0000) >> 16; -+ FalseAlmCnt->cnt_cck_crc32_ok= ret_value & 0xffff; -+ -+ /* read OFDM CRC32 counter */ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_CRC32_CNT_11AC, bMaskDWord); -+ FalseAlmCnt->cnt_ofdm_crc32_error = (ret_value & 0xffff0000) >> 16; -+ FalseAlmCnt->cnt_ofdm_crc32_ok= ret_value & 0xffff; -+ -+ /* read HT CRC32 counter */ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_HT_CRC32_CNT_11AC, bMaskDWord); -+ FalseAlmCnt->cnt_ht_crc32_error = (ret_value & 0xffff0000) >> 16; -+ FalseAlmCnt->cnt_ht_crc32_ok= ret_value & 0xffff; -+ -+ /* read VHT CRC32 counter */ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_VHT_CRC32_CNT_11AC, bMaskDWord); -+ FalseAlmCnt->cnt_vht_crc32_error = (ret_value & 0xffff0000) >> 16; -+ FalseAlmCnt->cnt_vht_crc32_ok= ret_value & 0xffff; -+ -+#if (RTL8881A_SUPPORT==1) -+ /* For 8881A */ -+ if(pDM_Odm->SupportICType == ODM_RTL8881A) -+ { -+ u4Byte Cnt_Ofdm_fail_temp = 0; -+ -+ if(FalseAlmCnt->Cnt_Ofdm_fail >= FalseAlmCnt->Cnt_Ofdm_fail_pre) -+ { -+ Cnt_Ofdm_fail_temp = FalseAlmCnt->Cnt_Ofdm_fail_pre; -+ FalseAlmCnt->Cnt_Ofdm_fail_pre = FalseAlmCnt->Cnt_Ofdm_fail; -+ FalseAlmCnt->Cnt_Ofdm_fail = FalseAlmCnt->Cnt_Ofdm_fail - Cnt_Ofdm_fail_temp; -+ } -+ else -+ FalseAlmCnt->Cnt_Ofdm_fail_pre = FalseAlmCnt->Cnt_Ofdm_fail; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail_pre)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail_pre=%d\n", Cnt_Ofdm_fail_temp)); -+ -+ /* Reset FA counter by enable/disable OFDM */ -+ if(FalseAlmCnt->Cnt_Ofdm_fail_pre >= 0x7fff) -+ { -+ // reset OFDM -+ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT29,0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT29,1); -+ FalseAlmCnt->Cnt_Ofdm_fail_pre = 0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Reset false alarm counter\n")); -+ } -+ } -+#endif -+ -+ /* reset OFDM FA coutner */ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RST_11AC, BIT17, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RST_11AC, BIT17, 0); -+ -+ /* reset CCK FA counter */ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11AC, BIT15, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11AC, BIT15, 1); -+ -+ /* reset CCA counter */ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RST_RPT_11AC, BIT0, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_RST_RPT_11AC, BIT0, 0); -+ -+ CCKenable = ODM_GetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT28); -+ if(CCKenable)//if(*pDM_Odm->pBandType == ODM_BAND_2_4G) -+ { -+ FalseAlmCnt->Cnt_all = FalseAlmCnt->Cnt_Ofdm_fail + FalseAlmCnt->Cnt_Cck_fail; -+ FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_CCK_CCA + FalseAlmCnt->Cnt_OFDM_CCA; -+ } -+ else -+ { -+ FalseAlmCnt->Cnt_all = FalseAlmCnt->Cnt_Ofdm_fail; -+ FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_OFDM_CCA; -+ } -+ if (pDM_Odm->ADCSmp_count == 0) { -+ /* Get debug port 0 */ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC, bMaskDWord, 0x0); -+ FalseAlmCnt->dbg_port0 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC, bMaskDWord); -+ -+ /* Get EDCCA flag */ -+ ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC, bMaskDWord, 0x209); -+ FalseAlmCnt->edcca_flag = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC, BIT30); -+ } -+ -+ } -+#endif -+ -+ -+ FalseAlmCnt->cnt_crc32_error_all = FalseAlmCnt->cnt_vht_crc32_error + FalseAlmCnt->cnt_ht_crc32_error + FalseAlmCnt->cnt_ofdm_crc32_error + FalseAlmCnt->cnt_cck_crc32_error; -+ FalseAlmCnt->cnt_crc32_ok_all = FalseAlmCnt->cnt_vht_crc32_ok + FalseAlmCnt->cnt_ht_crc32_ok + FalseAlmCnt->cnt_ofdm_crc32_ok + FalseAlmCnt->cnt_cck_crc32_ok; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_OFDM_CCA=%d\n", FalseAlmCnt->Cnt_OFDM_CCA)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_CCK_CCA=%d\n", FalseAlmCnt->Cnt_CCK_CCA)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_CCA_all=%d\n", FalseAlmCnt->Cnt_CCA_all)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Cck_fail=%d\n", FalseAlmCnt->Cnt_Cck_fail)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Total False Alarm=%d\n", FalseAlmCnt->Cnt_all)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): CCK CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_cck_crc32_error, FalseAlmCnt->cnt_cck_crc32_ok)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): OFDM CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_ofdm_crc32_error, FalseAlmCnt->cnt_ofdm_crc32_ok)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): HT CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_ht_crc32_error, FalseAlmCnt->cnt_ht_crc32_ok)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): VHT CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_vht_crc32_error, FalseAlmCnt->cnt_vht_crc32_ok)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Total CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_crc32_error_all, FalseAlmCnt->cnt_crc32_ok_all)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): dbg port 0x0 = 0x%x, EDCCA = %d\n\n", FalseAlmCnt->dbg_port0, FalseAlmCnt->edcca_flag)); -+} -+ -+//3============================================================ -+//3 CCK Packet Detect Threshold -+//3============================================================ -+ -+VOID -+odm_PauseCCKPacketDetection( -+ IN PVOID pDM_VOID, -+ IN PHYDM_PAUSE_TYPE PauseType, -+ IN PHYDM_PAUSE_LEVEL pause_level, -+ IN u1Byte CCKPDThreshold -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection()=========> level = %d\n", pause_level)); -+ -+ if ((pDM_DigTable->pause_cckpd_level == 0) && (!(pDM_Odm->SupportAbility & ODM_BB_CCK_PD) || !(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Return: SupportAbility ODM_BB_CCK_PD or ODM_BB_FA_CNT is disabled\n")); -+ return; -+ } -+ -+ if (pause_level > DM_DIG_MAX_PAUSE_TYPE) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, -+ ("odm_PauseCCKPacketDetection(): Return: Wrong pause level !!\n")); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_cckpd_level, CCKPDThreshold)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", -+ pDM_DigTable->pause_cckpd_value[7], pDM_DigTable->pause_cckpd_value[6], pDM_DigTable->pause_cckpd_value[5], pDM_DigTable->pause_cckpd_value[4], -+ pDM_DigTable->pause_cckpd_value[3], pDM_DigTable->pause_cckpd_value[2], pDM_DigTable->pause_cckpd_value[1], pDM_DigTable->pause_cckpd_value[0])); -+ -+ switch (PauseType) { -+ /* Pause CCK Packet Detection Threshold */ -+ case PHYDM_PAUSE: -+ { -+ /* Disable CCK PD */ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility & (~ODM_BB_CCK_PD)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Pause CCK packet detection threshold !!\n")); -+ -+ /* Backup original CCK PD threshold decided by CCK PD mechanism */ -+ if (pDM_DigTable->pause_cckpd_level == 0) { -+ pDM_DigTable->CCKPDBackup = pDM_DigTable->CurCCK_CCAThres; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, -+ ("odm_PauseCCKPacketDetection(): Backup CCKPD = 0x%x, new CCKPD = 0x%x\n", pDM_DigTable->CCKPDBackup, CCKPDThreshold)); -+ } -+ -+ /* Update pause level */ -+ pDM_DigTable->pause_cckpd_level = (pDM_DigTable->pause_cckpd_level | BIT(pause_level)); -+ -+ /* Record CCK PD threshold */ -+ pDM_DigTable->pause_cckpd_value[pause_level] = CCKPDThreshold; -+ -+ /* Write new CCK PD threshold */ -+ if (BIT(pause_level + 1) > pDM_DigTable->pause_cckpd_level) { -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, CCKPDThreshold); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): CCKPD of higher level = 0x%x\n", CCKPDThreshold)); -+ } -+ break; -+ } -+ /* Resume CCK Packet Detection Threshold */ -+ case PHYDM_RESUME: -+ { -+ /* check if the level is illegal or not */ -+ if ((pDM_DigTable->pause_cckpd_level & (BIT(pause_level))) != 0) { -+ pDM_DigTable->pause_cckpd_level = pDM_DigTable->pause_cckpd_level & (~(BIT(pause_level))); -+ pDM_DigTable->pause_cckpd_value[pause_level] = 0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Resume CCK PD !!\n")); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Wrong resume level !!\n")); -+ break; -+ } -+ -+ /* Resume DIG */ -+ if (pDM_DigTable->pause_cckpd_level == 0) { -+ /* Write backup IGI value */ -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, pDM_DigTable->CCKPDBackup); -+ /* pDM_DigTable->bIgnoreDIG = TRUE; */ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Write original CCKPD = 0x%x\n", pDM_DigTable->CCKPDBackup)); -+ -+ /* Enable DIG */ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility | ODM_BB_CCK_PD); -+ break; -+ } -+ -+ if (BIT(pause_level) > pDM_DigTable->pause_cckpd_level) { -+ s1Byte max_level; -+ -+ /* Calculate the maximum level now */ -+ for (max_level = (pause_level - 1); max_level >= 0; max_level--) { -+ if ((pDM_DigTable->pause_cckpd_level & BIT(max_level)) > 0) -+ break; -+ } -+ -+ /* write CCKPD of lower level */ -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, pDM_DigTable->pause_cckpd_value[max_level]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Write CCKPD (0x%x) of level (%d)\n", -+ pDM_DigTable->pause_cckpd_value[max_level], max_level)); -+ break; -+ } -+ break; -+ } -+ default: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Wrong type !!\n")); -+ break; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_cckpd_level, CCKPDThreshold)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", -+ pDM_DigTable->pause_cckpd_value[7], pDM_DigTable->pause_cckpd_value[6], pDM_DigTable->pause_cckpd_value[5], pDM_DigTable->pause_cckpd_value[4], -+ pDM_DigTable->pause_cckpd_value[3], pDM_DigTable->pause_cckpd_value[2], pDM_DigTable->pause_cckpd_value[1], pDM_DigTable->pause_cckpd_value[0])); -+} -+ -+ -+VOID -+odm_CCKPacketDetectionThresh( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+ u1Byte CurCCK_CCAThres = pDM_DigTable->CurCCK_CCAThres, RSSI_thd = 35; -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+//modify by Guo.Mingzhi 2011-12-29 -+ if (pDM_Odm->bDualMacSmartConcurrent == TRUE) -+// if (pDM_Odm->bDualMacSmartConcurrent == FALSE) -+ return; -+ if(pDM_Odm->bBtHsOperation) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() write 0xcd for BT HS mode!!\n")); -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, 0xcd); -+ return; -+ } -+#endif -+ -+ if((!(pDM_Odm->SupportAbility & ODM_BB_CCK_PD)) ||(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() return==========\n")); -+#ifdef MCR_WIRELESS_EXTEND -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, 0x43); -+#endif -+ return; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ if(pDM_Odm->ExtLNA) -+ return; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() ==========>\n")); -+ -+ if (pDM_DigTable->cckFaMa == 0xffffffff) -+ pDM_DigTable->cckFaMa = FalseAlmCnt->Cnt_Cck_fail; -+ else -+ pDM_DigTable->cckFaMa = ((pDM_DigTable->cckFaMa<<1) + pDM_DigTable->cckFaMa + FalseAlmCnt->Cnt_Cck_fail) >> 2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh(): CCK FA moving average = %d\n", pDM_DigTable->cckFaMa)); -+ -+ if (pDM_Odm->bLinked) { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ #if 0 /*for [PCIE-1596]*/ -+ if (pDM_Odm->RSSI_Min > (RSSI_thd + 14)) -+ CurCCK_CCAThres = 0xed; -+ else if (pDM_Odm->RSSI_Min > (RSSI_thd + 6)) -+ CurCCK_CCAThres = 0xdd; -+ else -+ #endif -+ if (pDM_Odm->RSSI_Min > RSSI_thd) -+ CurCCK_CCAThres = 0xcd; -+ else if (pDM_Odm->RSSI_Min > 20) { -+ if (pDM_DigTable->cckFaMa > ((DM_DIG_FA_TH1>>1) + (DM_DIG_FA_TH1>>3))) -+ CurCCK_CCAThres = 0xcd; -+ else if (pDM_DigTable->cckFaMa < (DM_DIG_FA_TH0>>1)) -+ CurCCK_CCAThres = 0x83; -+ } else if (pDM_Odm->RSSI_Min > 7) -+ CurCCK_CCAThres = 0x83; -+ else -+ CurCCK_CCAThres = 0x40; -+#else -+ if (pDM_DigTable->CurIGValue > (0x24 + 14)) -+ CurCCK_CCAThres = 0xed; -+ else if (pDM_DigTable->CurIGValue > (0x24 + 6)) -+ CurCCK_CCAThres = 0xdd; -+ else if (pDM_DigTable->CurIGValue > 0x24) -+ CurCCK_CCAThres = 0xcd; -+ else { -+ if (pDM_DigTable->cckFaMa > 0x400) -+ CurCCK_CCAThres = 0x83; -+ else if (pDM_DigTable->cckFaMa < 0x200) -+ CurCCK_CCAThres = 0x40; -+ } -+ -+#endif -+ } else { -+ if (pDM_DigTable->cckFaMa > 0x400) -+ CurCCK_CCAThres = 0x83; -+ else if (pDM_DigTable->cckFaMa < 0x200) -+ CurCCK_CCAThres = 0x40; -+ } -+ -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, CurCCK_CCAThres); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() CurCCK_CCAThres = 0x%x\n", CurCCK_CCAThres)); -+} -+ -+VOID -+ODM_Write_CCK_CCA_Thres( -+ IN PVOID pDM_VOID, -+ IN u1Byte CurCCK_CCAThres -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ if(pDM_DigTable->CurCCK_CCAThres!=CurCCK_CCAThres) //modify by Guo.Mingzhi 2012-01-03 -+ { -+ ODM_Write1Byte(pDM_Odm, ODM_REG(CCK_CCA,pDM_Odm), CurCCK_CCAThres); -+ pDM_DigTable->cckFaMa = 0xffffffff; -+ } -+ pDM_DigTable->PreCCK_CCAThres = pDM_DigTable->CurCCK_CCAThres; -+ pDM_DigTable->CurCCK_CCAThres = CurCCK_CCAThres; -+} -+ -+BOOLEAN -+phydm_DIG_GoUpCheck( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ u1Byte CurIGValue = pDM_DigTable->CurIGValue; -+ u1Byte max_DIG_cover_bond; -+ u1Byte current_IGI_MaxUp_resolution; -+ u1Byte rx_gain_range_max; -+ u1Byte i = 0; -+ -+ u4Byte total_NHM_cnt; -+ u4Byte DIG_cover_cnt; -+ u4Byte over_DIG_cover_cnt; -+ BOOLEAN ret = TRUE; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ max_DIG_cover_bond = DM_DIG_MAX_AP - priv->pshare->rf_ft_var.dig_upcheck_initial_value; -+ current_IGI_MaxUp_resolution = CurIGValue + 6; -+ rx_gain_range_max = pDM_DigTable->rx_gain_range_max; -+ -+ phydm_getNHMresult(pDM_Odm); -+ -+ total_NHM_cnt = CCX_INFO->NHM_result[0] + CCX_INFO->NHM_result[1]; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): *****Get NHM results*****\n")); -+ -+ if (total_NHM_cnt != 0) { -+ -+ /* CurIGValue < max_DIG_cover_bond - 6 */ -+ if (pDM_DigTable->DIG_GoUpCheck_Level == DIG_GOUPCHECK_LEVEL_0) { -+ DIG_cover_cnt = CCX_INFO->NHM_result[1]; -+ ret = ((priv->pshare->rf_ft_var.dig_level0_ratio_reciprocal * DIG_cover_cnt) >= total_NHM_cnt) ? TRUE : FALSE; -+ } -+ -+ /* (max_DIG_cover_bond - 6) <= CurIGValue < DM_DIG_MAX_AP */ -+ else if (pDM_DigTable->DIG_GoUpCheck_Level == DIG_GOUPCHECK_LEVEL_1) { -+ over_DIG_cover_cnt = CCX_INFO->NHM_result[1]; -+ ret = (priv->pshare->rf_ft_var.dig_level1_ratio_reciprocal * over_DIG_cover_cnt < total_NHM_cnt) ? TRUE : FALSE; -+ -+ if (!ret) { -+ /* update pDM_DigTable->rx_gain_range_max */ -+ pDM_DigTable->rx_gain_range_max = (rx_gain_range_max >= max_DIG_cover_bond - 6) ? (max_DIG_cover_bond - 6) : rx_gain_range_max; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): Noise power is beyond DIG can filter, lock rx_gain_range_max to 0x%x\n", -+ pDM_DigTable->rx_gain_range_max)); -+ } -+ } -+ -+ /* CurIGValue > DM_DIG_MAX_AP, foolproof */ -+ else if (pDM_DigTable->DIG_GoUpCheck_Level == DIG_GOUPCHECK_LEVEL_2) { -+ ret = TRUE; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): DIG_GoUpCheck_level = %d\n, current_IGI_MaxUp_resolution = 0x%x\n, max_DIG_cover_bond = 0x%x\n, rx_gain_range_max = 0x%x, ret = %d\n", -+ pDM_DigTable->DIG_GoUpCheck_Level, -+ current_IGI_MaxUp_resolution, -+ max_DIG_cover_bond, -+ pDM_DigTable->rx_gain_range_max, -+ ret)); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): NHM_result = %d, %d, %d, %d\n", -+ CCX_INFO->NHM_result[0], CCX_INFO->NHM_result[1], CCX_INFO->NHM_result[2], CCX_INFO->NHM_result[3])); -+ -+ } -+ else -+ ret = TRUE; -+ -+ for (i = 0 ; i <= 10 ; i ++) { -+ CCX_INFO->NHM_th[i] = 0xFF; -+ } -+ -+ if (CurIGValue < max_DIG_cover_bond - 6){ -+ CCX_INFO->NHM_th[0] = 2 * (CurIGValue - priv->pshare->rf_ft_var.dig_upcheck_initial_value); -+ pDM_DigTable->DIG_GoUpCheck_Level = DIG_GOUPCHECK_LEVEL_0; -+ } -+ else if (CurIGValue <= DM_DIG_MAX_AP) { -+ CCX_INFO->NHM_th[0] = 2 * max_DIG_cover_bond; -+ pDM_DigTable->DIG_GoUpCheck_Level = DIG_GOUPCHECK_LEVEL_1; -+ } -+ /* CurIGValue > DM_DIG_MAX_AP, foolproof */ -+ else { -+ pDM_DigTable->DIG_GoUpCheck_Level = DIG_GOUPCHECK_LEVEL_2; -+ ret = TRUE; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): *****Set NHM settings*****\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): DIG_GoUpCheck_level = %d\n", -+ pDM_DigTable->DIG_GoUpCheck_Level)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): NHM_th = 0x%x, 0x%x, 0x%x\n", -+ CCX_INFO->NHM_th[0], CCX_INFO->NHM_th[1], CCX_INFO->NHM_th[2])); -+ -+ CCX_INFO->NHM_inexclude_cca = NHM_EXCLUDE_CCA; -+ CCX_INFO->NHM_inexclude_txon = NHM_EXCLUDE_TXON; -+ CCX_INFO->NHM_period = 0xC350; -+ -+ phydm_NHMsetting(pDM_Odm, SET_NHM_SETTING); -+ phydm_NHMtrigger(pDM_Odm); -+#endif -+ -+ return ret; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+// <20130108, Kordan> E.g., With LNA used, we make the Rx power smaller to have a better EVM. (Asked by Willis) -+VOID -+odm_RFEControl( -+ IN PDM_ODM_T pDM_Odm, -+ IN u8Byte RSSIVal -+ ) -+{ -+ PADAPTER Adapter = (PADAPTER)pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ static u1Byte TRSW_HighPwr = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("===> odm_RFEControl, RSSI = %d, TRSW_HighPwr = 0x%X, pHalData->RFEType = %d\n", -+ RSSIVal, TRSW_HighPwr, pHalData->RFEType )); -+ -+ if (pHalData->RFEType == 3) { -+ -+ pDM_Odm->RSSI_TRSW = RSSIVal; -+ -+ if (pDM_Odm->RSSI_TRSW >= pDM_Odm->RSSI_TRSW_H) -+ { -+ TRSW_HighPwr = 1; // Switch to -+ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); // Set ANTSW=1/ANTSWB=0 for SW control -+ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); // Set ANTSW=1/ANTSWB=0 for SW control -+ -+ } -+ else if (pDM_Odm->RSSI_TRSW <= pDM_Odm->RSSI_TRSW_L) -+ { -+ TRSW_HighPwr = 0; // Switched back -+ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); // Set ANTSW=1/ANTSWB=0 for SW control -+ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x0); // Set ANTSW=1/ANTSWB=0 for SW control -+ -+ } -+ } -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("(pDM_Odm->RSSI_TRSW_H, pDM_Odm->RSSI_TRSW_L) = (%d, %d)\n", pDM_Odm->RSSI_TRSW_H, pDM_Odm->RSSI_TRSW_L)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("(RSSIVal, RSSIVal, pDM_Odm->RSSI_TRSW_iso) = (%d, %d, %d)\n", -+ RSSIVal, pDM_Odm->RSSI_TRSW_iso, pDM_Odm->RSSI_TRSW)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("<=== odm_RFEControl, RSSI = %d, TRSW_HighPwr = 0x%X\n", RSSIVal, TRSW_HighPwr)); -+} -+ -+VOID -+odm_MPT_DIGWorkItemCallback( -+ IN PVOID pContext -+ ) -+{ -+ PADAPTER Adapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ ODM_MPT_DIG(pDM_Odm); -+} -+ -+VOID -+odm_MPT_DIGCallback( -+ PRT_TIMER pTimer -+) -+{ -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ -+ #if DEV_BUS_TYPE==RT_PCI_INTERFACE -+ #if USE_WORKITEM -+ PlatformScheduleWorkItem(&pDM_Odm->MPT_DIGWorkitem); -+ #else -+ ODM_MPT_DIG(pDM_Odm); -+ #endif -+ #else -+ PlatformScheduleWorkItem(&pDM_Odm->MPT_DIGWorkitem); -+ #endif -+ -+} -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+VOID -+odm_MPT_DIGCallback( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if USE_WORKITEM -+ PlatformScheduleWorkItem(&pDM_Odm->MPT_DIGWorkitem); -+#else -+ ODM_MPT_DIG(pDM_Odm); -+#endif -+} -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE != ODM_CE) -+VOID -+odm_MPT_Write_DIG( -+ IN PVOID pDM_VOID, -+ IN u1Byte CurIGValue -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_A,pDM_Odm), CurIGValue); -+ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+ /* Set IGI value of CCK for new CCK AGC */ -+ if (pDM_Odm->cck_new_agc) { -+ if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) -+ ODM_SetBBReg(pDM_Odm, 0xa0c, 0x00003f00, (CurIGValue>>1)); -+ } -+ -+#endif -+ -+ if(pDM_Odm->RFType > ODM_1T1R) -+ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_B,pDM_Odm), CurIGValue); -+ -+ if((pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) && (pDM_Odm->RFType > ODM_2T2R)) -+ { -+ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_C,pDM_Odm), CurIGValue); -+ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_D,pDM_Odm), CurIGValue); -+ } -+ -+ pDM_DigTable->CurIGValue = CurIGValue; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("CurIGValue = 0x%x\n", CurIGValue)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("pDM_Odm->RFType = 0x%x\n", pDM_Odm->RFType)); -+} -+ -+VOID -+ODM_MPT_DIG( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -+ u1Byte CurrentIGI = pDM_DigTable->CurIGValue; -+ u1Byte DIG_Upper = 0x40, DIG_Lower = 0x20; -+ u4Byte RXOK_cal; -+ u4Byte RxPWDBAve_final; -+ u1Byte IGI_A = 0x20, IGI_B = 0x20; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ #if ODM_FIX_2G_DIG -+ IGI_A = 0x22; -+ IGI_B = 0x24; -+ #endif -+ -+#else -+ if (!(pDM_Odm->priv->pshare->rf_ft_var.mp_specific && pDM_Odm->priv->pshare->mp_dig_on)) -+ return; -+ -+ if (*pDM_Odm->pBandType == ODM_BAND_5G) -+ DIG_Lower = 0x22; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("===> ODM_MPT_DIG, pBandType = %d\n", *pDM_Odm->pBandType)); -+ -+#if (ODM_FIX_2G_DIG || (DM_ODM_SUPPORT_TYPE & ODM_AP)) -+ if (*pDM_Odm->pBandType == ODM_BAND_5G || (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B))) // for 5G or 8814 -+#else -+ if (1) // for both 2G/5G -+#endif -+ { -+ odm_FalseAlarmCounterStatistics(pDM_Odm); -+ -+ RXOK_cal = pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK + pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM; -+ RxPWDBAve_final = (RXOK_cal != 0)?pDM_Odm->RxPWDBAve/RXOK_cal:0; -+ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; -+ pDM_Odm->RxPWDBAve = 0; -+ pDM_Odm->MPDIG_2G = FALSE; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pDM_Odm->Times_2G = 0; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("RX OK = %d\n", RXOK_cal)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("RSSI = %d\n", RxPWDBAve_final)); -+ -+ if (RXOK_cal >= 70 && RxPWDBAve_final <= 40) -+ { -+ if (CurrentIGI > 0x24) -+ odm_MPT_Write_DIG(pDM_Odm, 0x24); -+ } -+ else -+ { -+ if(pFalseAlmCnt->Cnt_all > 1000){ -+ CurrentIGI = CurrentIGI + 8; -+ } -+ else if(pFalseAlmCnt->Cnt_all > 200){ -+ CurrentIGI = CurrentIGI + 4; -+ } -+ else if (pFalseAlmCnt->Cnt_all > 50){ -+ CurrentIGI = CurrentIGI + 2; -+ } -+ else if (pFalseAlmCnt->Cnt_all < 2){ -+ CurrentIGI = CurrentIGI - 2; -+ } -+ -+ if (CurrentIGI < DIG_Lower ){ -+ CurrentIGI = DIG_Lower; -+ } -+ -+ if(CurrentIGI > DIG_Upper){ -+ CurrentIGI = DIG_Upper; -+ } -+ -+ odm_MPT_Write_DIG(pDM_Odm, CurrentIGI); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("DIG = 0x%x, Cnt_all = %d, Cnt_Ofdm_fail = %d, Cnt_Cck_fail = %d\n", -+ CurrentIGI, pFalseAlmCnt->Cnt_all, pFalseAlmCnt->Cnt_Ofdm_fail, pFalseAlmCnt->Cnt_Cck_fail)); -+ } -+ } -+ else -+ { -+ if(pDM_Odm->MPDIG_2G == FALSE) -+ { -+ if((pDM_Odm->SupportPlatform & ODM_WIN) && !(pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B))) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("===> Fix IGI\n")); -+ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_A,pDM_Odm), IGI_A); -+ ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_B,pDM_Odm), IGI_B); -+ pDM_DigTable->CurIGValue = IGI_B; -+ } -+ else -+ odm_MPT_Write_DIG(pDM_Odm, IGI_A); -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pDM_Odm->Times_2G++; -+ -+ if (pDM_Odm->Times_2G == 3) -+#endif -+ { -+ pDM_Odm->MPDIG_2G = TRUE; -+ } -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ odm_RFEControl(pDM_Odm, RxPWDBAve_final); -+#endif -+ -+ ODM_SetTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer, 700); -+} -+#endif -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dig.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dig.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dig.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dig.h 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,370 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMDIG_H__ -+#define __PHYDMDIG_H__ -+ -+#define DIG_VERSION "1.24" /* 2016.06.01 Stanley. Modify IGI setting for 1R-CCA path-B */ -+ -+/* Pause DIG & CCKPD */ -+#define DM_DIG_MAX_PAUSE_TYPE 0x7 -+ -+typedef enum tag_DIG_GoUpCheck_Level { -+ -+ DIG_GOUPCHECK_LEVEL_0, -+ DIG_GOUPCHECK_LEVEL_1, -+ DIG_GOUPCHECK_LEVEL_2 -+ -+} DIG_GOUPCHECK_LEVEL; -+ -+typedef struct _Dynamic_Initial_Gain_Threshold_ -+{ -+ BOOLEAN bStopDIG; // for debug -+ BOOLEAN bIgnoreDIG; -+ BOOLEAN bPSDInProgress; -+ -+ u1Byte Dig_Enable_Flag; -+ u1Byte Dig_Ext_Port_Stage; -+ -+ int RssiLowThresh; -+ int RssiHighThresh; -+ -+ u4Byte FALowThresh; -+ u4Byte FAHighThresh; -+ -+ u1Byte CurSTAConnectState; -+ u1Byte PreSTAConnectState; -+ u1Byte CurMultiSTAConnectState; -+ -+ u1Byte PreIGValue; -+ u1Byte CurIGValue; -+ u1Byte BackupIGValue; //MP DIG -+ u1Byte BT30_CurIGI; -+ u1Byte IGIBackup; -+ -+ s1Byte BackoffVal; -+ s1Byte BackoffVal_range_max; -+ s1Byte BackoffVal_range_min; -+ u1Byte rx_gain_range_max; -+ u1Byte rx_gain_range_min; -+ u1Byte Rssi_val_min; -+ -+ u1Byte PreCCK_CCAThres; -+ u1Byte CurCCK_CCAThres; -+ u1Byte PreCCKPDState; -+ u1Byte CurCCKPDState; -+ u1Byte CCKPDBackup; -+ u1Byte pause_cckpd_level; -+ u1Byte pause_cckpd_value[DM_DIG_MAX_PAUSE_TYPE + 1]; -+ -+ u1Byte LargeFAHit; -+ u1Byte LargeFA_Timeout; /*if (LargeFAHit), monitor "LargeFA_Timeout" sec, if timeout, LargeFAHit=0*/ -+ u1Byte ForbiddenIGI; -+ u4Byte Recover_cnt; -+ -+ u1Byte DIG_Dynamic_MIN_0; -+ u1Byte DIG_Dynamic_MIN_1; -+ BOOLEAN bMediaConnect_0; -+ BOOLEAN bMediaConnect_1; -+ -+ u4Byte AntDiv_RSSI_max; -+ u4Byte RSSI_max; -+ -+ u1Byte *bP2PInProcess; -+ -+ u1Byte pause_dig_level; -+ u1Byte pause_dig_value[DM_DIG_MAX_PAUSE_TYPE + 1]; -+ -+ u4Byte cckFaMa; -+ DIG_GOUPCHECK_LEVEL DIG_GoUpCheck_Level; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ BOOLEAN bTpTarget; -+ BOOLEAN bNoiseEst; -+ u4Byte TpTrainTH_min; -+ u1Byte IGIOffset_A; -+ u1Byte IGIOffset_B; -+#endif -+ -+#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) -+ u1Byte rfGainIdx; -+ u1Byte agcTableIdx; -+ u1Byte bigJumpLmt[16]; -+ u1Byte enableAdjustBigJump:1; -+ u1Byte bigJumpStep1:3; -+ u1Byte bigJumpStep2:2; -+ u1Byte bigJumpStep3:2; -+#endif -+}DIG_T,*pDIG_T; -+ -+typedef struct _FALSE_ALARM_STATISTICS{ -+ u4Byte Cnt_Parity_Fail; -+ u4Byte Cnt_Rate_Illegal; -+ u4Byte Cnt_Crc8_fail; -+ u4Byte Cnt_Mcs_fail; -+ u4Byte Cnt_Ofdm_fail; -+ u4Byte Cnt_Ofdm_fail_pre; //For RTL8881A -+ u4Byte Cnt_Cck_fail; -+ u4Byte Cnt_all; -+ u4Byte Cnt_all_pre; -+ u4Byte Cnt_Fast_Fsync; -+ u4Byte Cnt_SB_Search_fail; -+ u4Byte Cnt_OFDM_CCA; -+ u4Byte Cnt_CCK_CCA; -+ u4Byte Cnt_CCA_all; -+ u4Byte Cnt_BW_USC; //Gary -+ u4Byte Cnt_BW_LSC; //Gary -+ u4Byte cnt_cck_crc32_error; -+ u4Byte cnt_cck_crc32_ok; -+ u4Byte cnt_ofdm_crc32_error; -+ u4Byte cnt_ofdm_crc32_ok; -+ u4Byte cnt_ht_crc32_error; -+ u4Byte cnt_ht_crc32_ok; -+ u4Byte cnt_vht_crc32_error; -+ u4Byte cnt_vht_crc32_ok; -+ u4Byte cnt_crc32_error_all; -+ u4Byte cnt_crc32_ok_all; -+ BOOLEAN cck_block_enable; -+ BOOLEAN ofdm_block_enable; -+ u4Byte dbg_port0; -+ BOOLEAN edcca_flag; -+}FALSE_ALARM_STATISTICS, *PFALSE_ALARM_STATISTICS; -+ -+typedef enum tag_Dynamic_Init_Gain_Operation_Type_Definition -+{ -+ DIG_TYPE_THRESH_HIGH = 0, -+ DIG_TYPE_THRESH_LOW = 1, -+ DIG_TYPE_BACKOFF = 2, -+ DIG_TYPE_RX_GAIN_MIN = 3, -+ DIG_TYPE_RX_GAIN_MAX = 4, -+ DIG_TYPE_ENABLE = 5, -+ DIG_TYPE_DISABLE = 6, -+ DIG_OP_TYPE_MAX -+}DM_DIG_OP_E; -+ -+/* -+typedef enum tag_CCK_Packet_Detection_Threshold_Type_Definition -+{ -+ CCK_PD_STAGE_LowRssi = 0, -+ CCK_PD_STAGE_HighRssi = 1, -+ CCK_PD_STAGE_MAX = 3, -+}DM_CCK_PDTH_E; -+ -+typedef enum tag_DIG_EXT_PORT_ALGO_Definition -+{ -+ DIG_EXT_PORT_STAGE_0 = 0, -+ DIG_EXT_PORT_STAGE_1 = 1, -+ DIG_EXT_PORT_STAGE_2 = 2, -+ DIG_EXT_PORT_STAGE_3 = 3, -+ DIG_EXT_PORT_STAGE_MAX = 4, -+}DM_DIG_EXT_PORT_ALG_E; -+ -+typedef enum tag_DIG_Connect_Definition -+{ -+ DIG_STA_DISCONNECT = 0, -+ DIG_STA_CONNECT = 1, -+ DIG_STA_BEFORE_CONNECT = 2, -+ DIG_MultiSTA_DISCONNECT = 3, -+ DIG_MultiSTA_CONNECT = 4, -+ DIG_CONNECT_MAX -+}DM_DIG_CONNECT_E; -+ -+ -+#define DM_MultiSTA_InitGainChangeNotify(Event) {DM_DigTable.CurMultiSTAConnectState = Event;} -+ -+#define DM_MultiSTA_InitGainChangeNotify_CONNECT(_ADAPTER) \ -+ DM_MultiSTA_InitGainChangeNotify(DIG_MultiSTA_CONNECT) -+ -+#define DM_MultiSTA_InitGainChangeNotify_DISCONNECT(_ADAPTER) \ -+ DM_MultiSTA_InitGainChangeNotify(DIG_MultiSTA_DISCONNECT) -+*/ -+ -+typedef enum tag_PHYDM_Pause_Type { -+ PHYDM_PAUSE = BIT0, -+ PHYDM_RESUME = BIT1 -+} PHYDM_PAUSE_TYPE; -+ -+typedef enum tag_PHYDM_Pause_Level { -+/* number of pause level can't exceed DM_DIG_MAX_PAUSE_TYPE */ -+ PHYDM_PAUSE_LEVEL_0 = 0, -+ PHYDM_PAUSE_LEVEL_1 = 1, -+ PHYDM_PAUSE_LEVEL_2 = 2, -+ PHYDM_PAUSE_LEVEL_3 = 3, -+ PHYDM_PAUSE_LEVEL_4 = 4, -+ PHYDM_PAUSE_LEVEL_5 = 5, -+ PHYDM_PAUSE_LEVEL_6 = 6, -+ PHYDM_PAUSE_LEVEL_7 = DM_DIG_MAX_PAUSE_TYPE /* maximum level */ -+} PHYDM_PAUSE_LEVEL; -+ -+#define DM_DIG_THRESH_HIGH 40 -+#define DM_DIG_THRESH_LOW 35 -+ -+#define DM_FALSEALARM_THRESH_LOW 400 -+#define DM_FALSEALARM_THRESH_HIGH 1000 -+ -+#define DM_DIG_MAX_NIC 0x3e -+#define DM_DIG_MIN_NIC 0x20 -+#define DM_DIG_MAX_OF_MIN_NIC 0x3e -+ -+#define DM_DIG_MAX_AP 0x3e -+#define DM_DIG_MIN_AP 0x20 -+#define DM_DIG_MAX_OF_MIN 0x2A //0x32 -+#define DM_DIG_MIN_AP_DFS 0x20 -+ -+#define DM_DIG_MAX_NIC_HP 0x46 -+#define DM_DIG_MIN_NIC_HP 0x2e -+ -+#define DM_DIG_MAX_AP_HP 0x42 -+#define DM_DIG_MIN_AP_HP 0x30 -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#define DM_DIG_MAX_AP_COVERAGR 0x26 -+#define DM_DIG_MIN_AP_COVERAGE 0x1c -+#define DM_DIG_MAX_OF_MIN_COVERAGE 0x22 -+ -+#define DM_DIG_TP_Target_TH0 500 -+#define DM_DIG_TP_Target_TH1 1000 -+#define DM_DIG_TP_Training_Period 10 -+#endif -+ -+//vivi 92c&92d has different definition, 20110504 -+//this is for 92c -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ #ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+ #define DM_DIG_FA_TH0 0x80//0x20 -+ #else -+ #define DM_DIG_FA_TH0 0x200//0x20 -+ #endif -+#else -+ #define DM_DIG_FA_TH0 0x200//0x20 -+#endif -+ -+#define DM_DIG_FA_TH1 0x300 -+#define DM_DIG_FA_TH2 0x400 -+//this is for 92d -+#define DM_DIG_FA_TH0_92D 0x100 -+#define DM_DIG_FA_TH1_92D 0x400 -+#define DM_DIG_FA_TH2_92D 0x600 -+ -+#define DM_DIG_BACKOFF_MAX 12 -+#define DM_DIG_BACKOFF_MIN -4 -+#define DM_DIG_BACKOFF_DEFAULT 10 -+ -+#define DM_DIG_FA_TH0_LPS 4 //-> 4 in lps -+#define DM_DIG_FA_TH1_LPS 15 //-> 15 lps -+#define DM_DIG_FA_TH2_LPS 30 //-> 30 lps -+#define RSSI_OFFSET_DIG 0x05 -+#define LARGE_FA_TIMEOUT 60 -+ -+ -+VOID -+ODM_ChangeDynamicInitGainThresh( -+ IN PVOID pDM_VOID, -+ IN u4Byte DM_Type, -+ IN u4Byte DM_Value -+ ); -+ -+VOID -+ODM_Write_DIG( -+ IN PVOID pDM_VOID, -+ IN u1Byte CurrentIGI -+ ); -+ -+VOID -+odm_PauseDIG( -+ IN PVOID pDM_VOID, -+ IN PHYDM_PAUSE_TYPE PauseType, -+ IN PHYDM_PAUSE_LEVEL pause_level, -+ IN u1Byte IGIValue -+ ); -+ -+VOID -+odm_DIGInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DIG( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DIGbyRSSI_LPS( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_FalseAlarmCounterStatistics( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_PauseCCKPacketDetection( -+ IN PVOID pDM_VOID, -+ IN PHYDM_PAUSE_TYPE PauseType, -+ IN PHYDM_PAUSE_LEVEL pause_level, -+ IN u1Byte CCKPDThreshold -+ ); -+ -+VOID -+odm_CCKPacketDetectionThresh( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+ODM_Write_CCK_CCA_Thres( -+ IN PVOID pDM_VOID, -+ IN u1Byte CurCCK_CCAThres -+ ); -+ -+BOOLEAN -+phydm_DIG_GoUpCheck( -+ IN PVOID pDM_VOID -+ ); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+odm_MPT_DIGCallback( -+ PRT_TIMER pTimer -+); -+ -+VOID -+odm_MPT_DIGWorkItemCallback( -+ IN PVOID pContext -+ ); -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+VOID -+odm_MPT_DIGCallback( -+ IN PVOID pDM_VOID -+); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE != ODM_CE) -+VOID -+ODM_MPT_DIG( -+ IN PVOID pDM_VOID -+); -+#endif -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.c 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,124 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (defined(CONFIG_BB_POWER_SAVING)) -+ -+VOID -+odm_DynamicBBPowerSavingInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; -+ -+ pDM_PSTable->PreCCAState = CCA_MAX; -+ pDM_PSTable->CurCCAState = CCA_MAX; -+ pDM_PSTable->PreRFState = RF_MAX; -+ pDM_PSTable->CurRFState = RF_MAX; -+ pDM_PSTable->Rssi_val_min = 0; -+ pDM_PSTable->initialize = 0; -+} -+ -+void -+ODM_RF_Saving( -+ IN PVOID pDM_VOID, -+ IN u1Byte bForceInNormal -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; -+ u1Byte Rssi_Up_bound = 30 ; -+ u1Byte Rssi_Low_bound = 25; -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if(pDM_Odm->PatchID == 40 ) //RT_CID_819x_FUNAI_TV -+ { -+ Rssi_Up_bound = 50 ; -+ Rssi_Low_bound = 45; -+ } -+#endif -+ if(pDM_PSTable->initialize == 0){ -+ -+ pDM_PSTable->Reg874 = (ODM_GetBBReg(pDM_Odm, 0x874, bMaskDWord)&0x1CC000)>>14; -+ pDM_PSTable->RegC70 = (ODM_GetBBReg(pDM_Odm, 0xc70, bMaskDWord)&BIT3)>>3; -+ pDM_PSTable->Reg85C = (ODM_GetBBReg(pDM_Odm, 0x85c, bMaskDWord)&0xFF000000)>>24; -+ pDM_PSTable->RegA74 = (ODM_GetBBReg(pDM_Odm, 0xa74, bMaskDWord)&0xF000)>>12; -+ //Reg818 = PHY_QueryBBReg(pAdapter, 0x818, bMaskDWord); -+ pDM_PSTable->initialize = 1; -+ } -+ -+ if(!bForceInNormal) -+ { -+ if(pDM_Odm->RSSI_Min != 0xFF) -+ { -+ if(pDM_PSTable->PreRFState == RF_Normal) -+ { -+ if(pDM_Odm->RSSI_Min >= Rssi_Up_bound) -+ pDM_PSTable->CurRFState = RF_Save; -+ else -+ pDM_PSTable->CurRFState = RF_Normal; -+ } -+ else{ -+ if(pDM_Odm->RSSI_Min <= Rssi_Low_bound) -+ pDM_PSTable->CurRFState = RF_Normal; -+ else -+ pDM_PSTable->CurRFState = RF_Save; -+ } -+ } -+ else -+ pDM_PSTable->CurRFState=RF_MAX; -+ } -+ else -+ { -+ pDM_PSTable->CurRFState = RF_Normal; -+ } -+ -+ if(pDM_PSTable->PreRFState != pDM_PSTable->CurRFState) -+ { -+ if(pDM_PSTable->CurRFState == RF_Save) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x874 , 0x1C0000, 0x2); //Reg874[20:18]=3'b010 -+ ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, 0); //RegC70[3]=1'b0 -+ ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, 0x63); //Reg85C[31:24]=0x63 -+ ODM_SetBBReg(pDM_Odm, 0x874, 0xC000, 0x2); //Reg874[15:14]=2'b10 -+ ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, 0x3); //RegA75[7:4]=0x3 -+ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x0); //Reg818[28]=1'b0 -+ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x1); //Reg818[28]=1'b1 -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, 0x874 , 0x1CC000, pDM_PSTable->Reg874); -+ ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, pDM_PSTable->RegC70); -+ ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, pDM_PSTable->Reg85C); -+ ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, pDM_PSTable->RegA74); -+ ODM_SetBBReg(pDM_Odm,0x818, BIT28, 0x0); -+ } -+ pDM_PSTable->PreRFState =pDM_PSTable->CurRFState; -+ } -+#endif -+} -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamicbbpowersaving.h 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,58 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMDYNAMICBBPOWERSAVING_H__ -+#define __PHYDMDYNAMICBBPOWERSAVING_H__ -+ -+#define DYNAMIC_BBPWRSAV_VERSION "1.1" -+ -+#if (defined(CONFIG_BB_POWER_SAVING)) -+ -+typedef struct _Dynamic_Power_Saving_ -+{ -+ u1Byte PreCCAState; -+ u1Byte CurCCAState; -+ -+ u1Byte PreRFState; -+ u1Byte CurRFState; -+ -+ int Rssi_val_min; -+ -+ u1Byte initialize; -+ u4Byte Reg874,RegC70,Reg85C,RegA74; -+ -+}PS_T,*pPS_T; -+ -+#define dm_RF_Saving ODM_RF_Saving -+ -+void ODM_RF_Saving( -+ IN PVOID pDM_VOID, -+ IN u1Byte bForceInNormal -+); -+ -+VOID -+odm_DynamicBBPowerSavingInit( -+ IN PVOID pDM_VOID -+ ); -+#else -+#define dm_RF_Saving(pDM_VOID, bForceInNormal) -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.c 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,542 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+VOID -+odm_DynamicTxPowerInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ /*if (!IS_HARDWARE_TYPE_8814A(Adapter)) {*/ -+ /* ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, */ -+ /* ("odm_DynamicTxPowerInit DynamicTxPowerEnable=%d\n", pMgntInfo->bDynamicTxPowerEnable));*/ -+ /* return;*/ -+ /*} else*/ -+ { -+ pMgntInfo->bDynamicTxPowerEnable = TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, -+ ("odm_DynamicTxPowerInit DynamicTxPowerEnable=%d\n", pMgntInfo->bDynamicTxPowerEnable)); -+ } -+ -+ #if DEV_BUS_TYPE==RT_USB_INTERFACE -+ if(RT_GetInterfaceSelection(Adapter) == INTF_SEL1_USB_High_Power) -+ { -+ odm_DynamicTxPowerSavePowerIndex(pDM_Odm); -+ pMgntInfo->bDynamicTxPowerEnable = TRUE; -+ } -+ else -+ #else -+ //so 92c pci do not need dynamic tx power? vivi check it later -+ pMgntInfo->bDynamicTxPowerEnable = FALSE; -+ #endif -+ -+ -+ pHalData->LastDTPLvl = TxHighPwrLevel_Normal; -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+ pDM_Odm->LastDTPLvl = TxHighPwrLevel_Normal; -+ pDM_Odm->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ pDM_Odm->tx_agc_ofdm_18_6 = ODM_GetBBReg(pDM_Odm, 0xC24, bMaskDWord); /*TXAGC {18M 12M 9M 6M}*/ -+ -+#endif -+ -+} -+ -+VOID -+odm_DynamicTxPowerSavePowerIndex( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ u1Byte index; -+ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ for(index = 0; index< 6; index++) -+ pHalData->PowerIndex_backup[index] = PlatformEFIORead1Byte(Adapter, Power_Index_REG[index]); -+ -+ -+#endif -+#endif -+} -+ -+VOID -+odm_DynamicTxPowerRestorePowerIndex( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ u1Byte index; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ for(index = 0; index< 6; index++) -+ PlatformEFIOWrite1Byte(Adapter, Power_Index_REG[index], pHalData->PowerIndex_backup[index]); -+ -+ -+#endif -+#endif -+} -+ -+VOID -+odm_DynamicTxPowerWritePowerIndex( -+ IN PVOID pDM_VOID, -+ IN u1Byte Value) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte index; -+ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; -+ -+ for(index = 0; index< 6; index++) -+ //PlatformEFIOWrite1Byte(Adapter, Power_Index_REG[index], Value); -+ ODM_Write1Byte(pDM_Odm, Power_Index_REG[index], Value); -+ -+} -+ -+VOID -+odm_DynamicTxPowerNIC_CE( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+#if (RTL8821A_SUPPORT == 1) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte val; -+ u1Byte rssi_tmp = pDM_Odm->RSSI_Min; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) -+ return; -+ -+ if (rssi_tmp >= TX_POWER_NEAR_FIELD_THRESH_LVL2) { -+ pDM_Odm->DynamicTxHighPowerLvl = TxHighPwrLevel_Level2; -+ /**/ -+ } else if (rssi_tmp >= TX_POWER_NEAR_FIELD_THRESH_LVL1) { -+ pDM_Odm->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1; -+ /**/ -+ } else if (rssi_tmp < (TX_POWER_NEAR_FIELD_THRESH_LVL1-5)) { -+ pDM_Odm->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ /**/ -+ } -+ -+ if (pDM_Odm->LastDTPLvl != pDM_Odm->DynamicTxHighPowerLvl) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("update_DTP_lv: ((%d)) -> ((%d))\n", pDM_Odm->LastDTPLvl, pDM_Odm->DynamicTxHighPowerLvl)); -+ -+ pDM_Odm->LastDTPLvl = pDM_Odm->DynamicTxHighPowerLvl; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8821)) { -+ -+ if (pDM_Odm->DynamicTxHighPowerLvl == TxHighPwrLevel_Level2) { -+ -+ ODM_SetMACReg(pDM_Odm, 0x6D8, BIT20|BIT19|BIT18, 1); /* Resp TXAGC offset = -3dB*/ -+ -+ val = pDM_Odm->tx_agc_ofdm_18_6 & 0xff; -+ if (val >= 0x20) -+ val -= 0x16; -+ -+ ODM_SetBBReg(pDM_Odm, 0xC24, 0xff, val); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("Set TX power: level 2\n")); -+ } else if (pDM_Odm->DynamicTxHighPowerLvl == TxHighPwrLevel_Level1) { -+ -+ ODM_SetMACReg(pDM_Odm, 0x6D8, BIT20|BIT19|BIT18, 1); /* Resp TXAGC offset = -3dB*/ -+ -+ val = pDM_Odm->tx_agc_ofdm_18_6 & 0xff; -+ if (val >= 0x20) -+ val -= 0x10; -+ -+ ODM_SetBBReg(pDM_Odm, 0xC24, 0xff, val); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("Set TX power: level 1\n")); -+ } else if (pDM_Odm->DynamicTxHighPowerLvl == TxHighPwrLevel_Normal) { -+ -+ ODM_SetMACReg(pDM_Odm, 0x6D8, BIT20|BIT19|BIT18, 0); /* Resp TXAGC offset = 0dB*/ -+ ODM_SetBBReg(pDM_Odm, 0xC24, bMaskDWord, pDM_Odm->tx_agc_ofdm_18_6); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("Set TX power: normal\n")); -+ } -+ } -+ } -+ -+#endif -+#endif -+} -+ -+ -+VOID -+odm_DynamicTxPower( -+ IN PVOID pDM_VOID -+ ) -+{ -+ // -+ // For AP/ADSL use prtl8192cd_priv -+ // For CE/NIC use PADAPTER -+ // -+ //PADAPTER pAdapter = pDM_Odm->Adapter; -+// prtl8192cd_priv priv = pDM_Odm->priv; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) -+ return; -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ odm_DynamicTxPowerNIC(pDM_Odm); -+ break; -+ case ODM_CE: -+ odm_DynamicTxPowerNIC_CE(pDM_Odm); -+ break; -+ case ODM_AP: -+ odm_DynamicTxPowerAP(pDM_Odm); -+ break; -+ default: -+ break; -+ } -+ -+ -+} -+ -+ -+VOID -+odm_DynamicTxPowerNIC( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) -+ return; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) { -+ odm_DynamicTxPower_8814A(pDM_Odm); -+ } else if (pDM_Odm->SupportICType & ODM_RTL8821) { -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(Adapter); -+ -+ if (pMgntInfo->RegRspPwr == 1) { -+ if (pDM_Odm->RSSI_Min > 60) -+ ODM_SetMACReg(pDM_Odm, ODM_REG_RESP_TX_11AC, BIT20|BIT19|BIT18, 1); /*Resp TXAGC offset = -3dB*/ -+ else if (pDM_Odm->RSSI_Min < 55) -+ ODM_SetMACReg(pDM_Odm, ODM_REG_RESP_TX_11AC, BIT20|BIT19|BIT18, 0); /*Resp TXAGC offset = 0dB*/ -+ } -+ } -+#endif -+} -+ -+VOID -+odm_DynamicTxPowerAP( -+ IN PVOID pDM_VOID -+ -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+//#if ((RTL8192C_SUPPORT==1) || (RTL8192D_SUPPORT==1) || (RTL8188E_SUPPORT==1) || (RTL8812E_SUPPORT==1)) -+ -+ -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ s4Byte i; -+ s2Byte pwr_thd = 63; -+ -+ if(!priv->pshare->rf_ft_var.tx_pwr_ctrl) -+ return; -+ -+#if ((RTL8812A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8814A_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8881A | ODM_RTL8814A)) -+ pwr_thd = TX_POWER_NEAR_FIELD_THRESH_LVL1; -+#endif -+ -+ /* -+ * Check if station is near by to use lower tx power -+ */ -+ -+ if ((priv->up_time % 3) == 0 ) { -+ int disable_pwr_ctrl = ((pDM_Odm->FalseAlmCnt.Cnt_all > 1000 ) || ((pDM_Odm->FalseAlmCnt.Cnt_all > 300 ) && ((RTL_R8(0xc50) & 0x7f) >= 0x32))) ? 1 : 0; -+ -+ for(i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pstat) ) { -+ if(disable_pwr_ctrl) -+ pstat->hp_level = 0; -+ else if ((pstat->hp_level == 0) && (pstat->rssi > pwr_thd)) -+ pstat->hp_level = 1; -+ else if ((pstat->hp_level == 1) && (pstat->rssi < (pwr_thd-8))) -+ pstat->hp_level = 0; -+ } -+ } -+ -+#if defined(CONFIG_WLAN_HAL_8192EE) -+ if (GET_CHIP_VER(priv) == VERSION_8192E) { -+ if( !disable_pwr_ctrl && (pDM_Odm->RSSI_Min != 0xff) ) { -+ if(pDM_Odm->RSSI_Min > pwr_thd) -+ RRSR_power_control_11n(priv, 1 ); -+ else if(pDM_Odm->RSSI_Min < (pwr_thd-8)) -+ RRSR_power_control_11n(priv, 0 ); -+ } else { -+ RRSR_power_control_11n(priv, 0 ); -+ } -+ } -+#endif -+ -+#ifdef CONFIG_WLAN_HAL_8814AE -+ if (GET_CHIP_VER(priv) == VERSION_8814A) { -+ if (!disable_pwr_ctrl && (pDM_Odm->RSSI_Min != 0xff)) { -+ if (pDM_Odm->RSSI_Min > pwr_thd) -+ RRSR_power_control_14(priv, 1); -+ else if (pDM_Odm->RSSI_Min < (pwr_thd-8)) -+ RRSR_power_control_14(priv, 0); -+ } else { -+ RRSR_power_control_14(priv, 0); -+ } -+ } -+#endif -+ -+ } -+//#endif -+ -+#endif -+} -+ -+VOID -+odm_DynamicTxPower_8821( -+ IN PVOID pDM_VOID, -+ IN pu1Byte pDesc, -+ IN u1Byte macId -+ ) -+{ -+#if (RTL8821A_SUPPORT == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PSTA_INFO_T pEntry; -+ u1Byte reg0xc56_byte; -+ u1Byte txpwr_offset = 0; -+ -+ pEntry = pDM_Odm->pODM_StaInfo[macId]; -+ -+ reg0xc56_byte = ODM_Read1Byte(pDM_Odm, 0xc56); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("reg0xc56_byte=%d\n", reg0xc56_byte)); -+ -+ if (pEntry[macId].rssi_stat.UndecoratedSmoothedPWDB > 85) { -+ -+ /* Avoid TXAGC error after TX power offset is applied. -+ For example: Reg0xc56=0x6, if txpwr_offset=3( reduce 11dB ) -+ Total power = 6-11= -5( overflow!! ), PA may be burned ! -+ so txpwr_offset should be adjusted by Reg0xc56*/ -+ -+ if (reg0xc56_byte < 7) -+ txpwr_offset = 1; -+ else if (reg0xc56_byte < 11) -+ txpwr_offset = 2; -+ else -+ txpwr_offset = 3; -+ -+ SET_TX_DESC_TX_POWER_OFFSET_8812(pDesc, txpwr_offset); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_DynamicTxPower_8821: RSSI=%d, txpwr_offset=%d\n", pEntry[macId].rssi_stat.UndecoratedSmoothedPWDB, txpwr_offset)); -+ -+ } else{ -+ SET_TX_DESC_TX_POWER_OFFSET_8812(pDesc, txpwr_offset); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_DynamicTxPower_8821: RSSI=%d, txpwr_offset=%d\n", pEntry[macId].rssi_stat.UndecoratedSmoothedPWDB, txpwr_offset)); -+ -+ } -+#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+#endif /*#if (RTL8821A_SUPPORT==1)*/ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+odm_DynamicTxPower_8814A( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ s4Byte UndecoratedSmoothedPWDB; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, -+ ("TxLevel=%d pMgntInfo->IOTAction=%x pMgntInfo->bDynamicTxPowerEnable=%d\n", -+ pHalData->DynamicTxHighPowerLvl, pMgntInfo->IOTAction, pMgntInfo->bDynamicTxPowerEnable)); -+ -+ /*STA not connected and AP not connected*/ -+ if ((!pMgntInfo->bMediaConnect) && (pHalData->EntryMinUndecoratedSmoothedPWDB == 0)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("Not connected to any reset power lvl\n")); -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ return; -+ } -+ -+ -+ if ((pMgntInfo->bDynamicTxPowerEnable != TRUE) || pMgntInfo->IOTAction & HT_IOT_ACT_DISABLE_HIGH_POWER) { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ } else { -+ if (pMgntInfo->bMediaConnect) { /*Default port*/ -+ if (ACTING_AS_AP(Adapter) || ACTING_AS_IBSS(Adapter)) { -+ UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("AP Client PWDB = 0x%x\n", UndecoratedSmoothedPWDB)); -+ } else { -+ UndecoratedSmoothedPWDB = pHalData->UndecoratedSmoothedPWDB; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("STA Default Port PWDB = 0x%x\n", UndecoratedSmoothedPWDB)); -+ } -+ } else {/*associated entry pwdb*/ -+ UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("AP Ext Port PWDB = 0x%x\n", UndecoratedSmoothedPWDB)); -+ } -+ -+ /*Should we separate as 2.4G/5G band?*/ -+ -+ if (UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL2) { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x0)\n")); -+ } else if ((UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL2-3)) && -+ (UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL1)) { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x10)\n")); -+ } else if (UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL1-5)) { -+ pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Normal\n")); -+ } -+ } -+ -+ -+ if (pHalData->DynamicTxHighPowerLvl != pHalData->LastDTPLvl) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_DynamicTxPower_8814A() Channel = %d\n" , pHalData->CurrentChannel)); -+ odm_SetTxPowerLevel8814(Adapter, pHalData->CurrentChannel, pHalData->DynamicTxHighPowerLvl); -+ } -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, -+ ("odm_DynamicTxPower_8814A() Channel = %d TXpower lvl=%d/%d\n" , -+ pHalData->CurrentChannel, pHalData->LastDTPLvl, pHalData->DynamicTxHighPowerLvl)); -+ -+ pHalData->LastDTPLvl = pHalData->DynamicTxHighPowerLvl; -+ -+} -+ -+ -+ -+/**/ -+/*For normal driver we always use the FW method to configure TX power index to reduce I/O transaction.*/ -+/**/ -+/**/ -+VOID -+odm_SetTxPowerLevel8814( -+ IN PADAPTER Adapter, -+ IN u1Byte Channel, -+ IN u1Byte PwrLvl -+ ) -+{ -+#if (DEV_BUS_TYPE == RT_USB_INTERFACE) -+ u4Byte i, j, k = 0; -+ u4Byte value[264] = {0}; -+ u4Byte path = 0, PowerIndex, txagc_table_wd = 0x00801000; -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ u1Byte jaguar2Rates[][4] = { {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}, -+ {MGN_6M, MGN_9M, MGN_12M, MGN_18M}, -+ {MGN_24M, MGN_36M, MGN_48M, MGN_54M}, -+ {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3}, -+ {MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}, -+ {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11}, -+ {MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}, -+ {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19}, -+ {MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23}, -+ {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3}, -+ {MGN_VHT1SS_MCS4, MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7}, -+ {MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9, MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1}, -+ {MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, MGN_VHT2SS_MCS5}, -+ {MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9}, -+ {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3}, -+ {MGN_VHT3SS_MCS4, MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7}, -+ {MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9, 0, 0} }; -+ -+ for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_D; ++path) { -+ -+ u1Byte usb_host = UsbModeQueryHubUsbType(Adapter); -+ u1Byte usb_rfset = UsbModeQueryRfSet(Adapter); -+ u1Byte usb_rf_type = RT_GetRFType(Adapter); -+ -+ for (i = 0; i <= 16; i++) { -+ for (j = 0; j <= 3; j++) { -+ if (jaguar2Rates[i][j] == 0) -+ continue; -+ -+ txagc_table_wd = 0x00801000; -+ PowerIndex = (u4Byte) PHY_GetTxPowerIndex(Adapter, (u1Byte)path, jaguar2Rates[i][j], pHalData->CurrentChannelBW, Channel); -+ -+ /*for Query bus type to recude tx power.*/ -+ if (usb_host != USB_MODE_U3 && usb_rfset == 1 && IS_HARDWARE_TYPE_8814AU(Adapter) && usb_rf_type == RF_3T3R) { -+ if (Channel <= 14) { -+ if (PowerIndex >= 16) -+ PowerIndex -= 16; -+ else -+ PowerIndex = 0; -+ } else -+ PowerIndex = 0; -+ } -+ -+ if (PwrLvl == TxHighPwrLevel_Level1) { -+ if (PowerIndex >= 0x10) -+ PowerIndex -= 0x10; -+ else -+ PowerIndex = 0; -+ } else if (PwrLvl == TxHighPwrLevel_Level2) { -+ PowerIndex = 0; -+ } -+ -+ txagc_table_wd |= (path << 8) | MRateToHwRate(jaguar2Rates[i][j]) | (PowerIndex << 24); -+ -+ PHY_SetTxPowerIndexShadow(Adapter, (u1Byte)PowerIndex, (u1Byte)path, jaguar2Rates[i][j]); -+ -+ value[k++] = txagc_table_wd; -+ } -+ } -+ } -+ -+ if (Adapter->MgntInfo.bScanInProgress == FALSE && Adapter->MgntInfo.RegFWOffload == 2) -+ HalDownloadTxPowerLevel8814(Adapter, value); -+#endif -+} -+#endif -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_dynamictxpower.h 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,110 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMDYNAMICTXPOWER_H__ -+#define __PHYDMDYNAMICTXPOWER_H__ -+ -+/*#define DYNAMIC_TXPWR_VERSION "1.0"*/ -+/*#define DYNAMIC_TXPWR_VERSION "1.3" */ /*2015.08.26, Add 8814 Dynamic TX power*/ -+#define DYNAMIC_TXPWR_VERSION "1.4" /*2015.11.06, Add CE 8821A Dynamic TX power*/ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 -+ #define TX_POWER_NEAR_FIELD_THRESH_LVL1 60 -+ #define TX_POWER_NEAR_FIELD_THRESH_AP 0x3F -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 -+ #define TX_POWER_NEAR_FIELD_THRESH_LVL1 67 -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 -+ #define TX_POWER_NEAR_FIELD_THRESH_LVL1 60 -+#endif -+ -+#define TxHighPwrLevel_Normal 0 -+#define TxHighPwrLevel_Level1 1 -+#define TxHighPwrLevel_Level2 2 -+ -+#define TxHighPwrLevel_BT1 3 -+#define TxHighPwrLevel_BT2 4 -+#define TxHighPwrLevel_15 5 -+#define TxHighPwrLevel_35 6 -+#define TxHighPwrLevel_50 7 -+#define TxHighPwrLevel_70 8 -+#define TxHighPwrLevel_100 9 -+ -+VOID -+odm_DynamicTxPowerInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DynamicTxPowerRestorePowerIndex( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DynamicTxPowerNIC( -+ IN PVOID pDM_VOID -+ ); -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+VOID -+odm_DynamicTxPowerSavePowerIndex( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DynamicTxPowerWritePowerIndex( -+ IN PVOID pDM_VOID, -+ IN u1Byte Value); -+ -+VOID -+odm_DynamicTxPower_8821( -+ IN PVOID pDM_VOID, -+ IN pu1Byte pDesc, -+ IN u1Byte macId -+ ); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+odm_DynamicTxPower_8814A( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+VOID -+odm_SetTxPowerLevel8814( -+ IN PADAPTER Adapter, -+ IN u1Byte Channel, -+ IN u1Byte PwrLvl -+ ); -+#endif -+#endif -+ -+VOID -+odm_DynamicTxPower( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_DynamicTxPowerAP( -+ IN PVOID pDM_VOID -+ ); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.c 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,766 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+VOID -+ODM_EdcaTurboInit( -+ IN PVOID pDM_VOID) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+#if (DM_ODM_SUPPORT_TYPE==ODM_WIN) -+ PADAPTER Adapter = NULL; -+ HAL_DATA_TYPE *pHalData = NULL; -+ -+ if(pDM_Odm->Adapter==NULL) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EdcaTurboInit fail!!!\n")); -+ return; -+ } -+ -+ Adapter=pDM_Odm->Adapter; -+ pHalData=GET_HAL_DATA(Adapter); -+ -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE; -+ pDM_Odm->DM_EDCA_Table.bIsCurRDLState = FALSE; -+ pHalData->bIsAnyNonBEPkts = FALSE; -+ -+#elif(DM_ODM_SUPPORT_TYPE==ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE; -+ pDM_Odm->DM_EDCA_Table.bIsCurRDLState = FALSE; -+ Adapter->recvpriv.bIsAnyNonBEPkts =FALSE; -+ -+#endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VO PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VO_PARAM))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VI PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VI_PARAM))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BE PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BE_PARAM))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BK PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BK_PARAM))); -+ -+ -+} // ODM_InitEdcaTurbo -+ -+VOID -+odm_EdcaTurboCheck( -+ IN PVOID pDM_VOID -+ ) -+{ -+ // -+ // For AP/ADSL use prtl8192cd_priv -+ // For CE/NIC use PADAPTER -+ // -+ -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("odm_EdcaTurboCheck========================>\n")); -+ -+ if(!(pDM_Odm->SupportAbility& ODM_MAC_EDCA_TURBO )) -+ return; -+ -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ -+#if(DM_ODM_SUPPORT_TYPE==ODM_WIN) -+ odm_EdcaTurboCheckMP(pDM_Odm); -+#endif -+ break; -+ -+ case ODM_CE: -+#if(DM_ODM_SUPPORT_TYPE==ODM_CE) -+ odm_EdcaTurboCheckCE(pDM_Odm); -+#endif -+ break; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("<========================odm_EdcaTurboCheck\n")); -+ -+} // odm_CheckEdcaTurbo -+ -+#if(DM_ODM_SUPPORT_TYPE==ODM_CE) -+ -+ -+VOID -+odm_EdcaTurboCheckCE( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ u32 EDCA_BE_UL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[pMgntInfo->IOTPeer]; -+ u32 EDCA_BE_DL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[pMgntInfo->IOTPeer]; -+ u32 ICType=pDM_Odm->SupportICType; -+ u32 IOTPeer=0; -+ u8 WirelessMode=0xFF; //invalid value -+ u32 trafficIndex; -+ u32 edca_param; -+ u64 cur_tx_bytes = 0; -+ u64 cur_rx_bytes = 0; -+ u8 bbtchange = _FALSE; -+ u8 bBiasOnRx = _FALSE; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct recv_priv *precvpriv = &(Adapter->recvpriv); -+ struct registry_priv *pregpriv = &Adapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &(Adapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if(pDM_Odm->bLinked != _TRUE) -+ { -+ precvpriv->bIsAnyNonBEPkts = _FALSE; -+ return; -+ } -+ -+ if ((pregpriv->wifi_spec == 1) )//|| (pmlmeinfo->HT_enable == 0)) -+ { -+ precvpriv->bIsAnyNonBEPkts = _FALSE; -+ return; -+ } -+ -+ if(pDM_Odm->pWirelessMode!=NULL) -+ WirelessMode=*(pDM_Odm->pWirelessMode); -+ -+ IOTPeer = pmlmeinfo->assoc_AP_vendor; -+ -+ if (IOTPeer >= HT_IOT_PEER_MAX) -+ { -+ precvpriv->bIsAnyNonBEPkts = _FALSE; -+ return; -+ } -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8188E) { -+ if((IOTPeer == HT_IOT_PEER_RALINK)||(IOTPeer == HT_IOT_PEER_ATHEROS)) -+ bBiasOnRx = _TRUE; -+ } -+ -+ // Check if the status needs to be changed. -+ if((bbtchange) || (!precvpriv->bIsAnyNonBEPkts) ) -+ { -+ cur_tx_bytes = pdvobjpriv->traffic_stat.cur_tx_bytes; -+ cur_rx_bytes = pdvobjpriv->traffic_stat.cur_rx_bytes; -+ -+ //traffic, TX or RX -+ if(bBiasOnRx) -+ { -+ if (cur_tx_bytes > (cur_rx_bytes << 2)) -+ { // Uplink TP is present. -+ trafficIndex = UP_LINK; -+ } -+ else -+ { // Balance TP is present. -+ trafficIndex = DOWN_LINK; -+ } -+ } -+ else -+ { -+ if (cur_rx_bytes > (cur_tx_bytes << 2)) -+ { // Downlink TP is present. -+ trafficIndex = DOWN_LINK; -+ } -+ else -+ { // Balance TP is present. -+ trafficIndex = UP_LINK; -+ } -+ } -+ -+ //if ((pDM_Odm->DM_EDCA_Table.prv_traffic_idx != trafficIndex) || (!pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA)) -+ { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) { -+ EDCA_BE_UL = 0x6ea42b; -+ EDCA_BE_DL = 0x6ea42b; -+ } -+ -+ //92D txop can't be set to 0x3e for cisco1250 -+ if ((IOTPeer == HT_IOT_PEER_CISCO) && (WirelessMode == ODM_WM_N24G)) -+ { -+ EDCA_BE_DL = edca_setting_DL[IOTPeer]; -+ EDCA_BE_UL = edca_setting_UL[IOTPeer]; -+ } -+ //merge from 92s_92c_merge temp brunch v2445 20120215 -+ else if((IOTPeer == HT_IOT_PEER_CISCO) &&((WirelessMode==ODM_WM_G)||(WirelessMode==(ODM_WM_B|ODM_WM_G))||(WirelessMode==ODM_WM_A)||(WirelessMode==ODM_WM_B))) -+ { -+ EDCA_BE_DL = edca_setting_DL_GMode[IOTPeer]; -+ } -+ else if((IOTPeer== HT_IOT_PEER_AIRGO )&& ((WirelessMode==ODM_WM_G)||(WirelessMode==ODM_WM_A))) -+ { -+ EDCA_BE_DL = 0xa630; -+ } -+ else if(IOTPeer == HT_IOT_PEER_MARVELL) -+ { -+ EDCA_BE_DL = edca_setting_DL[IOTPeer]; -+ EDCA_BE_UL = edca_setting_UL[IOTPeer]; -+ } -+ else if(IOTPeer == HT_IOT_PEER_ATHEROS) -+ { -+ // Set DL EDCA for Atheros peer to 0x3ea42b. Suggested by SD3 Wilson for ASUS TP issue. -+ EDCA_BE_DL = edca_setting_DL[IOTPeer]; -+ } -+ -+ if((ICType==ODM_RTL8812)||(ICType==ODM_RTL8821)||(ICType==ODM_RTL8192E)) //add 8812AU/8812AE -+ { -+ EDCA_BE_UL = 0x5ea42b; -+ EDCA_BE_DL = 0x5ea42b; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8812A: EDCA_BE_UL=0x%x EDCA_BE_DL =0x%x",EDCA_BE_UL,EDCA_BE_DL)); -+ } -+ -+ if (trafficIndex == DOWN_LINK) -+ edca_param = EDCA_BE_DL; -+ else -+ edca_param = EDCA_BE_UL; -+ -+ rtw_write32(Adapter, REG_EDCA_BE_PARAM, edca_param); -+ -+ pDM_Odm->DM_EDCA_Table.prv_traffic_idx = trafficIndex; -+ } -+ -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = _TRUE; -+ } -+ else -+ { -+ // -+ // Turn Off EDCA turbo here. -+ // Restore original EDCA according to the declaration of AP. -+ // -+ if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA) -+ { -+ rtw_write32(Adapter, REG_EDCA_BE_PARAM, pHalData->AcParam_BE); -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = _FALSE; -+ } -+ } -+ -+} -+ -+ -+#elif(DM_ODM_SUPPORT_TYPE==ODM_WIN) -+VOID -+odm_EdcaTurboCheckMP( -+ IN PVOID pDM_VOID -+ ) -+{ -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PADAPTER pDefaultAdapter = GetDefaultAdapter(Adapter); -+ PADAPTER pExtAdapter = GetFirstExtAdapter(Adapter);//NULL; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ PSTA_QOS pStaQos = Adapter->MgntInfo.pStaQos; -+ //[Win7 Count Tx/Rx statistic for Extension Port] odm_CheckEdcaTurbo's Adapter is always Default. 2009.08.20, by Bohn -+ u8Byte Ext_curTxOkCnt = 0; -+ u8Byte Ext_curRxOkCnt = 0; -+ //For future Win7 Enable Default Port to modify AMPDU size dynamically, 2009.08.20, Bohn. -+ u1Byte TwoPortStatus = (u1Byte)TWO_PORT_STATUS__WITHOUT_ANY_ASSOCIATE; -+ -+ // Keep past Tx/Rx packet count for RT-to-RT EDCA turbo. -+ u8Byte curTxOkCnt = 0; -+ u8Byte curRxOkCnt = 0; -+ u4Byte EDCA_BE_UL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[pMgntInfo->IOTPeer]; -+ u4Byte EDCA_BE_DL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[pMgntInfo->IOTPeer]; -+ u4Byte EDCA_BE = 0x5ea42b; -+ u1Byte IOTPeer=0; -+ BOOLEAN *pbIsCurRDLState=NULL; -+ BOOLEAN bLastIsCurRDLState=FALSE; -+ BOOLEAN bBiasOnRx=FALSE; -+ BOOLEAN bEdcaTurboOn=FALSE; -+ u1Byte TxRate = 0xFF; -+ u8Byte value64; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("odm_EdcaTurboCheckMP========================>")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BE PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BE_PARAM))); -+ -+////=============================== -+////list paramter for different platform -+////=============================== -+ bLastIsCurRDLState=pDM_Odm->DM_EDCA_Table.bIsCurRDLState; -+ pbIsCurRDLState=&(pDM_Odm->DM_EDCA_Table.bIsCurRDLState); -+ -+ //2012/09/14 MH Add -+ if (pMgntInfo->NumNonBePkt > pMgntInfo->RegEdcaThresh && !(Adapter->MgntInfo.bWiFiConfg & RT_WIFI_LOGO)) -+ pHalData->bIsAnyNonBEPkts = TRUE; -+ -+ pMgntInfo->NumNonBePkt = 0; -+ -+ // Caculate TX/RX TP: -+ curTxOkCnt = pDM_Odm->curTxOkCnt; -+ curRxOkCnt = pDM_Odm->curRxOkCnt; -+ -+ -+ if(pExtAdapter == NULL) -+ pExtAdapter = pDefaultAdapter; -+ -+ Ext_curTxOkCnt = pExtAdapter->TxStats.NumTxBytesUnicast - pMgntInfo->Ext_lastTxOkCnt; -+ Ext_curRxOkCnt = pExtAdapter->RxStats.NumRxBytesUnicast - pMgntInfo->Ext_lastRxOkCnt; -+ GetTwoPortSharedResource(Adapter,TWO_PORT_SHARED_OBJECT__STATUS,NULL,&TwoPortStatus); -+ //For future Win7 Enable Default Port to modify AMPDU size dynamically, 2009.08.20, Bohn. -+ if(TwoPortStatus == TWO_PORT_STATUS__EXTENSION_ONLY) -+ { -+ curTxOkCnt = Ext_curTxOkCnt ; -+ curRxOkCnt = Ext_curRxOkCnt ; -+ } -+ // -+ IOTPeer=pMgntInfo->IOTPeer; -+ bBiasOnRx=(pMgntInfo->IOTAction & HT_IOT_ACT_EDCA_BIAS_ON_RX)?TRUE:FALSE; -+ bEdcaTurboOn=((!pHalData->bIsAnyNonBEPkts))?TRUE:FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("bIsAnyNonBEPkts : 0x%lx \n",pHalData->bIsAnyNonBEPkts)); -+ -+ -+////=============================== -+////check if edca turbo is disabled -+////=============================== -+ if(odm_IsEdcaTurboDisable(pDM_Odm)) -+ { -+ pHalData->bIsAnyNonBEPkts = FALSE; -+ pMgntInfo->lastTxOkCnt = Adapter->TxStats.NumTxBytesUnicast; -+ pMgntInfo->lastRxOkCnt = Adapter->RxStats.NumRxBytesUnicast; -+ pMgntInfo->Ext_lastTxOkCnt = pExtAdapter->TxStats.NumTxBytesUnicast; -+ pMgntInfo->Ext_lastRxOkCnt = pExtAdapter->RxStats.NumRxBytesUnicast; -+ -+ } -+ -+////=============================== -+////remove iot case out -+////=============================== -+ ODM_EdcaParaSelByIot(pDM_Odm, &EDCA_BE_UL, &EDCA_BE_DL); -+ -+ -+////=============================== -+////Check if the status needs to be changed. -+////=============================== -+ if(bEdcaTurboOn) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("bEdcaTurboOn : 0x%x bBiasOnRx : 0x%x\n",bEdcaTurboOn,bBiasOnRx)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("curTxOkCnt : 0x%lx \n",curTxOkCnt)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("curRxOkCnt : 0x%lx \n",curRxOkCnt)); -+ if(bBiasOnRx) -+ odm_EdcaChooseTrafficIdx(pDM_Odm,curTxOkCnt, curRxOkCnt, TRUE, pbIsCurRDLState); -+ else -+ odm_EdcaChooseTrafficIdx(pDM_Odm,curTxOkCnt, curRxOkCnt, FALSE, pbIsCurRDLState); -+ -+//modify by Guo.Mingzhi 2011-12-29 -+ if( Adapter->AP_EDCA_PARAM[0] != EDCA_BE ) -+ EDCA_BE = Adapter->AP_EDCA_PARAM[0]; -+ else -+ EDCA_BE=((*pbIsCurRDLState)==TRUE)?EDCA_BE_DL:EDCA_BE_UL; -+ if(IS_HARDWARE_TYPE_8821U(Adapter)) -+ { -+ if(pMgntInfo->RegTxDutyEnable) -+ { -+ //2013.01.23 LukeLee: debug for 8811AU thermal issue (reduce Tx duty cycle) -+ if(!pMgntInfo->ForcedDataRate) //auto rate -+ { -+ if(pDM_Odm->TxRate != 0xFF) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+ } -+ else //force rate -+ { -+ TxRate = (u1Byte) pMgntInfo->ForcedDataRate; -+ } -+ -+ value64 = (curRxOkCnt<<2); -+ if(curTxOkCnt < value64) //Downlink -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ else //Uplink -+ { -+ /*DbgPrint("pRFCalibrateInfo->ThermalValue = 0x%X\n", pRFCalibrateInfo->ThermalValue);*/ -+ /*if(pRFCalibrateInfo->ThermalValue < pHalData->EEPROMThermalMeter)*/ -+ if((pDM_Odm->RFCalibrateInfo.ThermalValue < 0x2c) || (*pDM_Odm->pBandType == BAND_ON_2_4G)) -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ else -+ { -+ switch (TxRate) -+ { -+ case MGN_VHT1SS_MCS6: -+ case MGN_VHT1SS_MCS5: -+ case MGN_MCS6: -+ case MGN_MCS5: -+ case MGN_48M: -+ case MGN_54M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0x1ea42b); -+ break; -+ case MGN_VHT1SS_MCS4: -+ case MGN_MCS4: -+ case MGN_36M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa42b); -+ break; -+ case MGN_VHT1SS_MCS3: -+ case MGN_MCS3: -+ case MGN_24M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa47f); -+ break; -+ case MGN_VHT1SS_MCS2: -+ case MGN_MCS2: -+ case MGN_18M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa57f); -+ break; -+ case MGN_VHT1SS_MCS1: -+ case MGN_MCS1: -+ case MGN_9M: -+ case MGN_12M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa77f); -+ break; -+ case MGN_VHT1SS_MCS0: -+ case MGN_MCS0: -+ case MGN_6M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa87f); -+ break; -+ default: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ break; -+ } -+ } -+ } -+ } -+ else -+ { -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ } -+ -+ } -+ else if (IS_HARDWARE_TYPE_8812AU(Adapter)){ -+ if(pMgntInfo->RegTxDutyEnable) -+ { -+ //2013.07.26 Wilson: debug for 8812AU thermal issue (reduce Tx duty cycle) -+ // it;s the same issue as 8811AU -+ if(!pMgntInfo->ForcedDataRate) //auto rate -+ { -+ if(pDM_Odm->TxRate != 0xFF) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+ } -+ else //force rate -+ { -+ TxRate = (u1Byte) pMgntInfo->ForcedDataRate; -+ } -+ -+ value64 = (curRxOkCnt<<2); -+ if(curTxOkCnt < value64) //Downlink -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ else //Uplink -+ { -+ /*DbgPrint("pRFCalibrateInfo->ThermalValue = 0x%X\n", pRFCalibrateInfo->ThermalValue);*/ -+ /*if(pRFCalibrateInfo->ThermalValue < pHalData->EEPROMThermalMeter)*/ -+ if((pDM_Odm->RFCalibrateInfo.ThermalValue < 0x2c) || (*pDM_Odm->pBandType == BAND_ON_2_4G)) -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ else -+ { -+ switch (TxRate) -+ { -+ case MGN_VHT2SS_MCS9: -+ case MGN_VHT1SS_MCS9: -+ case MGN_VHT1SS_MCS8: -+ case MGN_MCS15: -+ case MGN_MCS7: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0x1ea44f); -+ case MGN_VHT2SS_MCS8: -+ case MGN_VHT1SS_MCS7: -+ case MGN_MCS14: -+ case MGN_MCS6: -+ case MGN_54M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa44f); -+ case MGN_VHT2SS_MCS7: -+ case MGN_VHT2SS_MCS6: -+ case MGN_VHT1SS_MCS6: -+ case MGN_VHT1SS_MCS5: -+ case MGN_MCS13: -+ case MGN_MCS5: -+ case MGN_48M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa630); -+ break; -+ case MGN_VHT2SS_MCS5: -+ case MGN_VHT2SS_MCS4: -+ case MGN_VHT1SS_MCS4: -+ case MGN_VHT1SS_MCS3: -+ case MGN_MCS12: -+ case MGN_MCS4: -+ case MGN_MCS3: -+ case MGN_36M: -+ case MGN_24M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa730); -+ break; -+ case MGN_VHT2SS_MCS3: -+ case MGN_VHT2SS_MCS2: -+ case MGN_VHT2SS_MCS1: -+ case MGN_VHT1SS_MCS2: -+ case MGN_VHT1SS_MCS1: -+ case MGN_MCS11: -+ case MGN_MCS10: -+ case MGN_MCS9: -+ case MGN_MCS2: -+ case MGN_MCS1: -+ case MGN_18M: -+ case MGN_12M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa830); -+ break; -+ case MGN_VHT2SS_MCS0: -+ case MGN_VHT1SS_MCS0: -+ case MGN_MCS0: -+ case MGN_MCS8: -+ case MGN_9M: -+ case MGN_6M: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa87f); -+ break; -+ default: -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ break; -+ } -+ } -+ } -+ } -+ else -+ { -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ } -+ } -+ else -+ ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EDCA Turbo on: EDCA_BE:0x%lx\n",EDCA_BE)); -+ -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = TRUE; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EDCA_BE_DL : 0x%lx EDCA_BE_UL : 0x%lx EDCA_BE : 0x%lx \n",EDCA_BE_DL,EDCA_BE_UL,EDCA_BE)); -+ -+ } -+ else -+ { -+ // Turn Off EDCA turbo here. -+ // Restore original EDCA according to the declaration of AP. -+ if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA) -+ { -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_AC_PARAM, GET_WMM_PARAM_ELE_SINGLE_AC_PARAM(pStaQos->WMMParamEle, AC0_BE) ); -+ -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Restore EDCA BE: 0x%lx \n",pDM_Odm->WMMEDCA_BE)); -+ -+ } -+ } -+ -+} -+ -+ -+//check if edca turbo is disabled -+BOOLEAN -+odm_IsEdcaTurboDisable( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ u4Byte IOTPeer=pMgntInfo->IOTPeer; -+ -+ if(pDM_Odm->bBtDisableEdcaTurbo) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("EdcaTurboDisable for BT!!\n")); -+ return TRUE; -+ } -+ -+ if((!(pDM_Odm->SupportAbility& ODM_MAC_EDCA_TURBO ))|| -+ (pDM_Odm->WIFITest & RT_WIFI_LOGO)|| -+ (IOTPeer>= HT_IOT_PEER_MAX)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("EdcaTurboDisable\n")); -+ return TRUE; -+ } -+ -+ -+ // 1. We do not turn on EDCA turbo mode for some AP that has IOT issue -+ // 2. User may disable EDCA Turbo mode with OID settings. -+ if(pMgntInfo->IOTAction & HT_IOT_ACT_DISABLE_EDCA_TURBO){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("IOTAction:EdcaTurboDisable\n")); -+ return TRUE; -+ } -+ -+ return FALSE; -+ -+ -+} -+ -+//add iot case here: for MP/CE -+VOID -+ODM_EdcaParaSelByIot( -+ IN PVOID pDM_VOID, -+ OUT u4Byte *EDCA_BE_UL, -+ OUT u4Byte *EDCA_BE_DL -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ u4Byte IOTPeer=0; -+ u4Byte ICType=pDM_Odm->SupportICType; -+ u1Byte WirelessMode=0xFF; //invalid value -+ u4Byte IOTPeerSubType = 0; -+ -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ u1Byte TwoPortStatus = (u1Byte)TWO_PORT_STATUS__WITHOUT_ANY_ASSOCIATE; -+ -+ if(pDM_Odm->pWirelessMode!=NULL) -+ WirelessMode=*(pDM_Odm->pWirelessMode); -+ -+/////////////////////////////////////////////////////////// -+////list paramter for different platform -+ -+ IOTPeer=pMgntInfo->IOTPeer; -+ IOTPeerSubType=pMgntInfo->IOTPeerSubtype; -+ GetTwoPortSharedResource(Adapter,TWO_PORT_SHARED_OBJECT__STATUS,NULL,&TwoPortStatus); -+ -+////============================ -+/// IOT case for MP -+////============================ -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) { -+ (*EDCA_BE_UL) = 0x6ea42b; -+ (*EDCA_BE_DL) = 0x6ea42b; -+ } -+ -+ if(TwoPortStatus == TWO_PORT_STATUS__EXTENSION_ONLY) -+ { -+ (*EDCA_BE_UL) = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[ExtAdapter->MgntInfo.IOTPeer]; -+ (*EDCA_BE_DL) = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[ExtAdapter->MgntInfo.IOTPeer]; -+ } -+ -+ #if (INTEL_PROXIMITY_SUPPORT == 1) -+ if(pMgntInfo->IntelClassModeInfo.bEnableCA == TRUE) -+ { -+ (*EDCA_BE_UL) = (*EDCA_BE_DL) = 0xa44f; -+ } -+ else -+ #endif -+ { -+ if((pMgntInfo->IOTAction & (HT_IOT_ACT_FORCED_ENABLE_BE_TXOP|HT_IOT_ACT_AMSDU_ENABLE))) -+ {// To check whether we shall force turn on TXOP configuration. -+ if(!((*EDCA_BE_UL) & 0xffff0000)) -+ (*EDCA_BE_UL) |= 0x005e0000; // Force TxOP limit to 0x005e for UL. -+ if(!((*EDCA_BE_DL) & 0xffff0000)) -+ (*EDCA_BE_DL) |= 0x005e0000; // Force TxOP limit to 0x005e for DL. -+ } -+ -+ //92D txop can't be set to 0x3e for cisco1250 -+ if ((IOTPeer == HT_IOT_PEER_CISCO) && (WirelessMode == ODM_WM_N24G)) -+ { -+ (*EDCA_BE_DL) = edca_setting_DL[IOTPeer]; -+ (*EDCA_BE_UL) = edca_setting_UL[IOTPeer]; -+ } -+ //merge from 92s_92c_merge temp brunch v2445 20120215 -+ else if((IOTPeer == HT_IOT_PEER_CISCO) &&((WirelessMode==ODM_WM_G)||(WirelessMode==(ODM_WM_B|ODM_WM_G))||(WirelessMode==ODM_WM_A)||(WirelessMode==ODM_WM_B))) -+ { -+ (*EDCA_BE_DL) = edca_setting_DL_GMode[IOTPeer]; -+ } -+ else if((IOTPeer== HT_IOT_PEER_AIRGO )&& ((WirelessMode==ODM_WM_G)||(WirelessMode==ODM_WM_A))) -+ { -+ (*EDCA_BE_DL) = 0xa630; -+ } -+ -+ else if(IOTPeer == HT_IOT_PEER_MARVELL) -+ { -+ (*EDCA_BE_DL) = edca_setting_DL[IOTPeer]; -+ (*EDCA_BE_UL) = edca_setting_UL[IOTPeer]; -+ } -+ else if(IOTPeer == HT_IOT_PEER_ATHEROS && IOTPeerSubType != HT_IOT_PEER_TPLINK_AC1750) -+ { -+ // Set DL EDCA for Atheros peer to 0x3ea42b. Suggested by SD3 Wilson for ASUS TP issue. -+ if(WirelessMode==ODM_WM_G) -+ (*EDCA_BE_DL) = edca_setting_DL_GMode[IOTPeer]; -+ else -+ (*EDCA_BE_DL) = edca_setting_DL[IOTPeer]; -+ -+ if(ICType == ODM_RTL8821) -+ (*EDCA_BE_DL) = 0x5ea630; -+ -+ } -+ } -+ -+ if((ICType==ODM_RTL8812)||(ICType==ODM_RTL8192E)) //add 8812AU/8812AE -+ { -+ (*EDCA_BE_UL) = 0x5ea42b; -+ (*EDCA_BE_DL) = 0x5ea42b; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8812A: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx\n",(*EDCA_BE_UL),(*EDCA_BE_DL))); -+ } -+ -+ if((ICType==ODM_RTL8814A) && (IOTPeer == HT_IOT_PEER_REALTEK)) /*8814AU and 8814AR*/ -+ { -+ (*EDCA_BE_UL) = 0x5ea42b; -+ (*EDCA_BE_DL) = 0xa42b; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8814A: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx\n",(*EDCA_BE_UL),(*EDCA_BE_DL))); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Special: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx, IOTPeer = %d\n",(*EDCA_BE_UL),(*EDCA_BE_DL), IOTPeer)); -+ -+} -+ -+ -+VOID -+odm_EdcaChooseTrafficIdx( -+ IN PVOID pDM_VOID, -+ IN u8Byte cur_tx_bytes, -+ IN u8Byte cur_rx_bytes, -+ IN BOOLEAN bBiasOnRx, -+ OUT BOOLEAN *pbIsCurRDLState -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if(bBiasOnRx) -+ { -+ -+ if(cur_tx_bytes>(cur_rx_bytes*4)) -+ { -+ *pbIsCurRDLState=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Uplink Traffic\n ")); -+ -+ } -+ else -+ { -+ *pbIsCurRDLState=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Balance Traffic\n")); -+ -+ } -+ } -+ else -+ { -+ if(cur_rx_bytes>(cur_tx_bytes*4)) -+ { -+ *pbIsCurRDLState=TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Downlink Traffic\n")); -+ -+ } -+ else -+ { -+ *pbIsCurRDLState=FALSE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Balance Traffic\n")); -+ } -+ } -+ -+ return ; -+} -+ -+#endif -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_edcaturbocheck.h 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,100 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMEDCATURBOCHECK_H__ -+#define __PHYDMEDCATURBOCHECK_H__ -+ -+/*#define EDCATURBO_VERSION "2.1"*/ -+#define EDCATURBO_VERSION "2.3" /*2015.07.29 by YuChen*/ -+ -+typedef struct _EDCA_TURBO_ -+{ -+ BOOLEAN bCurrentTurboEDCA; -+ BOOLEAN bIsCurRDLState; -+ -+ #if(DM_ODM_SUPPORT_TYPE == ODM_CE ) -+ u4Byte prv_traffic_idx; // edca turbo -+ #endif -+ -+}EDCA_T,*pEDCA_T; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+static u4Byte edca_setting_UL[HT_IOT_PEER_MAX] = -+// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU MARVELL 92U_AP SELF_AP(DownLink/Tx) -+{ 0x5e4322, 0xa44f, 0x5e4322, 0x5ea32b, 0x5ea422, 0x5ea322, 0x3ea430, 0x5ea42b, 0x5ea44f, 0x5e4322, 0x5e4322}; -+ -+ -+static u4Byte edca_setting_DL[HT_IOT_PEER_MAX] = -+// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU, MARVELL 92U_AP SELF_AP(UpLink/Rx) -+{ 0xa44f, 0x5ea44f, 0x5e4322, 0x5ea42b, 0xa44f, 0xa630, 0x5ea630, 0x5ea42b, 0xa44f, 0xa42b, 0xa42b}; -+ -+static u4Byte edca_setting_DL_GMode[HT_IOT_PEER_MAX] = -+// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU, MARVELL 92U_AP SELF_AP -+{ 0x4322, 0xa44f, 0x5e4322, 0xa42b, 0x5e4322, 0x4322, 0xa42b, 0x5ea42b, 0xa44f, 0x5e4322, 0x5ea42b}; -+ -+#endif -+ -+ -+ -+VOID -+odm_EdcaTurboCheck( -+ IN PVOID pDM_VOID -+ ); -+VOID -+ODM_EdcaTurboInit( -+ IN PVOID pDM_VOID -+); -+ -+#if(DM_ODM_SUPPORT_TYPE==ODM_WIN) -+VOID -+odm_EdcaTurboCheckMP( -+ IN PVOID pDM_VOID -+ ); -+ -+//check if edca turbo is disabled -+BOOLEAN -+odm_IsEdcaTurboDisable( -+ IN PVOID pDM_VOID -+); -+//choose edca paramter for special IOT case -+VOID -+ODM_EdcaParaSelByIot( -+ IN PVOID pDM_VOID, -+ OUT u4Byte *EDCA_BE_UL, -+ OUT u4Byte *EDCA_BE_DL -+ ); -+//check if it is UL or DL -+VOID -+odm_EdcaChooseTrafficIdx( -+ IN PVOID pDM_VOID, -+ IN u8Byte cur_tx_bytes, -+ IN u8Byte cur_rx_bytes, -+ IN BOOLEAN bBiasOnRx, -+ OUT BOOLEAN *pbIsCurRDLState -+ ); -+ -+#elif (DM_ODM_SUPPORT_TYPE==ODM_CE) -+VOID -+odm_EdcaTurboCheckCE( -+ IN PVOID pDM_VOID -+ ); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_features.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_features.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_features.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_features.h 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,142 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDM_FEATURES_H__ -+#define __PHYDM_FEATURES -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ /*Antenna Diversity*/ -+ #define CONFIG_PHYDM_ANTENNA_DIVERSITY -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ -+ #if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) -+ #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ #endif -+ -+ #if (RTL8821A_SUPPORT == 1) -+ /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ -+ #define CONFIG_FAT_PATCH -+ #endif -+ #endif -+ -+ #define SUPPORTABLITY_PHYDMLIZE 1 -+ #define RA_MASK_PHYDMLIZE_WIN 1 -+ /*#define CONFIG_PATH_DIVERSITY*/ -+ /*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+ #define CONFIG_ANT_DETECTION -+ /*#define CONFIG_RA_DBG_CMD*/ -+ #define CONFIG_RA_FW_DBG_CODE 1 -+ /*#define CONFIG_PHYDM_RX_SNIFFER_PARSING*/ -+ #define CONFIG_BB_POWER_SAVING -+ #define CONFIG_BB_TXBF_API -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ #define SUPPORTABLITY_PHYDMLIZE 0 -+ #define RA_MASK_PHYDMLIZE_AP 1 -+ -+ /* #define CONFIG_RA_DBG_CMD*/ -+ #define CONFIG_RA_FW_DBG_CODE 0 -+ -+ /*#define CONFIG_PATH_DIVERSITY*/ -+ /*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+ #define CONFIG_RA_DYNAMIC_RATE_ID -+ /*#define CONFIG_BB_POWER_SAVING*/ -+ #define CONFIG_BB_TXBF_API -+ -+ /* [ Configure Antenna Diversity ] */ -+ #if defined(CONFIG_RTL_8881A_ANT_SWITCH) || defined(CONFIG_SLOT_0_ANT_SWITCH) || defined(CONFIG_SLOT_1_ANT_SWITCH) -+ #define CONFIG_PHYDM_ANTENNA_DIVERSITY -+ #define ODM_EVM_ENHANCE_ANTDIV -+ -+ /*----------*/ -+ -+ #if (!defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A) && !defined(CONFIG_2G_CGCS_RX_DIVERSITY) && !defined(CONFIG_2G_CG_TRX_DIVERSITY) && !defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) -+ #define CONFIG_NO_2G_DIVERSITY -+ #endif -+ -+ #ifdef CONFIG_NO_5G_DIVERSITY_8881A -+ #define CONFIG_NO_5G_DIVERSITY -+ #elif defined(CONFIG_5G_CGCS_RX_DIVERSITY_8881A) -+ #define CONFIG_5G_CGCS_RX_DIVERSITY -+ #elif defined(CONFIG_5G_CG_TRX_DIVERSITY_8881A) -+ #define CONFIG_5G_CG_TRX_DIVERSITY -+ #elif defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A) -+ #define CONFIG_2G5G_CG_TRX_DIVERSITY -+ #endif -+ #if (!defined(CONFIG_NO_5G_DIVERSITY) && !defined(CONFIG_5G_CGCS_RX_DIVERSITY) && !defined(CONFIG_5G_CG_TRX_DIVERSITY) && !defined(CONFIG_2G5G_CG_TRX_DIVERSITY) && !defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) -+ #define CONFIG_NO_5G_DIVERSITY -+ #endif -+ /*----------*/ -+ #if (defined(CONFIG_NO_2G_DIVERSITY) && defined(CONFIG_NO_5G_DIVERSITY)) -+ #define CONFIG_NOT_SUPPORT_ANTDIV -+ #elif (!defined(CONFIG_NO_2G_DIVERSITY) && defined(CONFIG_NO_5G_DIVERSITY)) -+ #define CONFIG_2G_SUPPORT_ANTDIV -+ #elif (defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_NO_5G_DIVERSITY)) -+ #define CONFIG_5G_SUPPORT_ANTDIV -+ #elif ((!defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_NO_5G_DIVERSITY)) || defined(CONFIG_2G5G_CG_TRX_DIVERSITY)) -+ #define CONFIG_2G5G_SUPPORT_ANTDIV -+ #endif -+ /*----------*/ -+ #endif -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+ #define SUPPORTABLITY_PHYDMLIZE 0 -+ #define RA_MASK_PHYDMLIZE_CE 1 -+ -+ /*Antenna Diversity*/ -+ #ifdef CONFIG_ANTENNA_DIVERSITY -+ #define CONFIG_PHYDM_ANTENNA_DIVERSITY -+ -+ #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY -+ -+ #if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) -+ #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ #endif -+ -+ #if (RTL8821A_SUPPORT == 1) -+ /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ -+ #endif -+ #endif -+ #endif -+ -+ #ifdef CONFIG_DFS_MASTER -+ #define CONFIG_PHYDM_DFS_MASTER -+ #endif -+ -+ /*#define CONFIG_RA_DBG_CMD*/ -+ #define CONFIG_RA_FW_DBG_CODE 0 -+ /*#define CONFIG_ANT_DETECTION*/ -+ /*#define CONFIG_PATH_DIVERSITY*/ -+ /*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ -+ #define CONFIG_BB_POWER_SAVING -+ #define CONFIG_BB_TXBF_API -+ -+ #ifdef CONFIG_BT_COEXIST -+ #define BT_SUPPORT 1 -+ #endif -+ -+ -+#endif -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm.h 2018-02-11 21:44:27.154146193 +0200 -@@ -0,0 +1,1299 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __HALDMOUTSRC_H__ -+#define __HALDMOUTSRC_H__ -+ -+/*============================================================*/ -+/*include files*/ -+/*============================================================*/ -+#include "phydm_pre_define.h" -+#include "phydm_dig.h" -+#include "phydm_edcaturbocheck.h" -+#include "phydm_pathdiv.h" -+#include "phydm_antdiv.h" -+#include "phydm_antdect.h" -+#include "phydm_dynamicbbpowersaving.h" -+#include "phydm_rainfo.h" -+#include "phydm_dynamictxpower.h" -+#include "phydm_cfotracking.h" -+#include "phydm_acs.h" -+#include "phydm_adaptivity.h" -+#include "phydm_iqk.h" -+#include "phydm_dfs.h" -+#include "phydm_ccx.h" -+#include "txbf/phydm_hal_txbf_api.h" -+ -+#include "phydm_adc_sampling.h" -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+#include "phydm_beamforming.h" -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#include "halphyrf_ap.h" -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+#include "phydm_noisemonitor.h" -+#include "halphyrf_ce.h" -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+#include "halphyrf_win.h" -+#include "phydm_noisemonitor.h" -+#endif -+ -+/*============================================================*/ -+/*Definition */ -+/*============================================================*/ -+ -+/* Traffic load decision */ -+#define TRAFFIC_ULTRA_LOW 1 -+#define TRAFFIC_LOW 2 -+#define TRAFFIC_MID 3 -+#define TRAFFIC_HIGH 4 -+ -+#define NONE 0 -+ -+/*NBI API------------------------------------*/ -+#define NBI_ENABLE 1 -+#define NBI_DISABLE 2 -+ -+#define NBI_TABLE_SIZE_128 27 -+#define NBI_TABLE_SIZE_256 59 -+ -+#define NUM_START_CH_80M 7 -+#define NUM_START_CH_40M 14 -+ -+#define CH_OFFSET_40M 2 -+#define CH_OFFSET_80M 6 -+ -+/*CSI MASK API------------------------------------*/ -+#define CSI_MASK_ENABLE 1 -+#define CSI_MASK_DISABLE 2 -+ -+/*------------------------------------------------*/ -+ -+#define FFT_128_TYPE 1 -+#define FFT_256_TYPE 2 -+ -+#define SET_SUCCESS 1 -+#define SET_ERROR 2 -+#define SET_NO_NEED 3 -+ -+#define FREQ_POSITIVE 1 -+#define FREQ_NEGATIVE 2 -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#define PHYDM_WATCH_DOG_PERIOD 1 -+#else -+#define PHYDM_WATCH_DOG_PERIOD 2 -+#endif -+ -+/*============================================================*/ -+/*structure and define*/ -+/*============================================================*/ -+ -+/*2011/09/20 MH Add for AP/ADSLpseudo DM structuer requirement.*/ -+/*We need to remove to other position???*/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+typedef struct rtl8192cd_priv { -+ u1Byte temp; -+ -+} rtl8192cd_priv, *prtl8192cd_priv; -+#endif -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+typedef struct _ADAPTER { -+ u1Byte temp; -+ #ifdef AP_BUILD_WORKAROUND -+ HAL_DATA_TYPE* temp2; -+ prtl8192cd_priv priv; -+ #endif -+} ADAPTER, *PADAPTER; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+typedef struct _WLAN_STA { -+ u1Byte temp; -+} WLAN_STA, *PRT_WLAN_STA; -+ -+#endif -+ -+typedef struct _Dynamic_Primary_CCA { -+ u1Byte PriCCA_flag; -+ u1Byte intf_flag; -+ u1Byte intf_type; -+ u1Byte DupRTS_flag; -+ u1Byte Monitor_flag; -+ u1Byte CH_offset; -+ u1Byte MF_state; -+} Pri_CCA_T, *pPri_CCA_T; -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #ifdef ADSL_AP_BUILD_WORKAROUND -+ #define MAX_TOLERANCE 5 -+ #define IQK_DELAY_TIME 1 /*ms*/ -+ #endif -+#endif /*#if(DM_ODM_SUPPORT_TYPE & (ODM_AP))*/ -+ -+#define DM_Type_ByFW 0 -+#define DM_Type_ByDriver 1 -+ -+/*Declare for common info*/ -+ -+#define IQK_THRESHOLD 8 -+#define DPK_THRESHOLD 4 -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+__PACK typedef struct _ODM_Phy_Status_Info_ -+{ -+ u1Byte RxPWDBAll; -+ u1Byte SignalQuality; /* in 0-100 index. */ -+ u1Byte RxMIMOSignalStrength[4]; /* in 0~100 index */ -+ s1Byte RxMIMOSignalQuality[4]; /* EVM */ -+ s1Byte RxSNR[4]; /* per-path's SNR */ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+ u1Byte RxCount:2; /* RX path counter---*/ -+ u1Byte BandWidth:2; -+ u1Byte rxsc:4; /* sub-channel---*/ -+#else -+ u1Byte BandWidth; -+#endif -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+ u1Byte channel; /* channel number---*/ -+ BOOLEAN bMuPacket; /* is MU packet or not---*/ -+ BOOLEAN bBeamformed; /* BF packet---*/ -+#endif -+} __WLAN_ATTRIB_PACK__ ODM_PHY_INFO_T, *PODM_PHY_INFO_T; -+ -+typedef struct _ODM_Phy_Status_Info_Append_ { -+ u1Byte MAC_CRC32; -+ -+}ODM_PHY_INFO_Append_T,*PODM_PHY_INFO_Append_T; -+ -+#else -+ -+typedef struct _ODM_Phy_Status_Info_ { -+ // -+ // Be care, if you want to add any element please insert between -+ // RxPWDBAll & SignalStrength. -+ // -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ u4Byte RxPWDBAll; -+#else -+ u1Byte RxPWDBAll; -+#endif -+ u1Byte SignalQuality; /* in 0-100 index. */ -+ s1Byte RxMIMOSignalQuality[4]; /* per-path's EVM */ -+ u1Byte RxMIMOEVMdbm[4]; /* per-path's EVM dbm */ -+ u1Byte RxMIMOSignalStrength[4]; /* in 0~100 index */ -+ s2Byte Cfo_short[4]; /* per-path's Cfo_short */ -+ s2Byte Cfo_tail[4]; /* per-path's Cfo_tail */ -+ s1Byte RxPower; /* in dBm Translate from PWdB */ -+ s1Byte RecvSignalPower; /* Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. */ -+ u1Byte BTRxRSSIPercentage; -+ u1Byte SignalStrength; /* in 0-100 index. */ -+ s1Byte RxPwr[4]; /* per-path's pwdb */ -+ s1Byte RxSNR[4]; /* per-path's SNR */ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+ u1Byte RxCount:2; /* RX path counter---*/ -+ u1Byte BandWidth:2; -+ u1Byte rxsc:4; /* sub-channel---*/ -+#else -+ u1Byte BandWidth; -+#endif -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ u1Byte btCoexPwrAdjust; -+#endif -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+ u1Byte channel; /* channel number---*/ -+ BOOLEAN bMuPacket; /* is MU packet or not---*/ -+ BOOLEAN bBeamformed; /* BF packet---*/ -+#endif -+} ODM_PHY_INFO_T, *PODM_PHY_INFO_T; -+#endif -+ -+typedef struct _ODM_Per_Pkt_Info_ { -+ u1Byte DataRate; -+ u1Byte StationID; -+ BOOLEAN bPacketMatchBSSID; -+ BOOLEAN bPacketToSelf; -+ BOOLEAN bPacketBeacon; -+ BOOLEAN bToSelf; -+} ODM_PACKET_INFO_T, *PODM_PACKET_INFO_T; -+ -+ -+typedef struct _ODM_Phy_Dbg_Info_ { -+ /*ODM Write,debug info*/ -+ s1Byte RxSNRdB[4]; -+ u4Byte NumQryPhyStatus; -+ u4Byte NumQryPhyStatusCCK; -+ u4Byte NumQryPhyStatusOFDM; -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+ u4Byte NumQryMuPkt; -+ u4Byte NumQryBfPkt; -+ u4Byte NumQryMuVhtPkt[40]; -+ u4Byte NumQryVhtPkt[40]; -+ BOOLEAN bLdpcPkt; -+ BOOLEAN bStbcPkt; -+#endif -+ u1Byte NumQryBeaconPkt; -+ //Others -+ s4Byte RxEVM[4]; -+ -+} ODM_PHY_DBG_INFO_T; -+ -+ -+/*2011/20/20 MH For MP driver RT_WLAN_STA = STA_INFO_T*/ -+/*Please declare below ODM relative info in your STA info structure.*/ -+ -+#if 1 -+typedef struct _ODM_STA_INFO { -+ /*Driver Write*/ -+ BOOLEAN bUsed; /*record the sta status link or not?*/ -+ u1Byte IOTPeer; /*Enum value. HT_IOT_PEER_E*/ -+ -+ /*ODM Write*/ -+ /*PHY_STATUS_INFO*/ -+ u1Byte RSSI_Path[4]; -+ u1Byte RSSI_Ave; -+ u1Byte RXEVM[4]; -+ u1Byte RXSNR[4]; -+ -+} ODM_STA_INFO_T, *PODM_STA_INFO_T; -+#endif -+ -+typedef enum _ODM_Common_Info_Definition { -+ /*Fixed value*/ -+ /*-----------HOOK BEFORE REG INIT-----------*/ -+ ODM_CMNINFO_PLATFORM = 0, -+ ODM_CMNINFO_ABILITY, -+ ODM_CMNINFO_INTERFACE, -+ ODM_CMNINFO_MP_TEST_CHIP, -+ ODM_CMNINFO_IC_TYPE, -+ ODM_CMNINFO_CUT_VER, -+ ODM_CMNINFO_FAB_VER, -+ ODM_CMNINFO_RF_TYPE, -+ ODM_CMNINFO_RFE_TYPE, -+ ODM_CMNINFO_BOARD_TYPE, -+ ODM_CMNINFO_PACKAGE_TYPE, -+ ODM_CMNINFO_EXT_LNA, -+ ODM_CMNINFO_5G_EXT_LNA, -+ ODM_CMNINFO_EXT_PA, -+ ODM_CMNINFO_5G_EXT_PA, -+ ODM_CMNINFO_GPA, -+ ODM_CMNINFO_APA, -+ ODM_CMNINFO_GLNA, -+ ODM_CMNINFO_ALNA, -+ ODM_CMNINFO_EXT_TRSW, -+ ODM_CMNINFO_EXT_LNA_GAIN, -+ ODM_CMNINFO_PATCH_ID, -+ ODM_CMNINFO_BINHCT_TEST, -+ ODM_CMNINFO_BWIFI_TEST, -+ ODM_CMNINFO_SMART_CONCURRENT, -+ ODM_CMNINFO_CONFIG_BB_RF, -+ ODM_CMNINFO_DOMAIN_CODE_2G, -+ ODM_CMNINFO_DOMAIN_CODE_5G, -+ ODM_CMNINFO_IQKFWOFFLOAD, -+ ODM_CMNINFO_IQKPAOFF, -+ ODM_CMNINFO_HUBUSBMODE, -+ ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS, -+ ODM_CMNINFO_TX_TP, -+ ODM_CMNINFO_RX_TP, -+ ODM_CMNINFO_SOUNDING_SEQ, -+ ODM_CMNINFO_REGRFKFREEENABLE, -+ ODM_CMNINFO_RFKFREEENABLE, -+ ODM_CMNINFO_NORMAL_RX_PATH_CHANGE, -+ /*-----------HOOK BEFORE REG INIT-----------*/ -+ -+ /*Dynamic value:*/ -+ -+ /*--------- POINTER REFERENCE-----------*/ -+ ODM_CMNINFO_MAC_PHY_MODE, -+ ODM_CMNINFO_TX_UNI, -+ ODM_CMNINFO_RX_UNI, -+ ODM_CMNINFO_WM_MODE, -+ ODM_CMNINFO_BAND, -+ ODM_CMNINFO_SEC_CHNL_OFFSET, -+ ODM_CMNINFO_SEC_MODE, -+ ODM_CMNINFO_BW, -+ ODM_CMNINFO_CHNL, -+ ODM_CMNINFO_FORCED_RATE, -+ ODM_CMNINFO_ANT_DIV, -+ ODM_CMNINFO_ADAPTIVITY, -+ ODM_CMNINFO_DMSP_GET_VALUE, -+ ODM_CMNINFO_BUDDY_ADAPTOR, -+ ODM_CMNINFO_DMSP_IS_MASTER, -+ ODM_CMNINFO_SCAN, -+ ODM_CMNINFO_POWER_SAVING, -+ ODM_CMNINFO_ONE_PATH_CCA, -+ ODM_CMNINFO_DRV_STOP, -+ ODM_CMNINFO_PNP_IN, -+ ODM_CMNINFO_INIT_ON, -+ ODM_CMNINFO_ANT_TEST, -+ ODM_CMNINFO_NET_CLOSED, -+ ODM_CMNINFO_FORCED_IGI_LB, -+ ODM_CMNINFO_P2P_LINK, -+ ODM_CMNINFO_FCS_MODE, -+ ODM_CMNINFO_IS1ANTENNA, -+ ODM_CMNINFO_RFDEFAULTPATH, -+ ODM_CMNINFO_DFS_MASTER_ENABLE, -+ ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC, -+ ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA, -+ /*--------- POINTER REFERENCE-----------*/ -+ -+ /*------------CALL BY VALUE-------------*/ -+ ODM_CMNINFO_WIFI_DIRECT, -+ ODM_CMNINFO_WIFI_DISPLAY, -+ ODM_CMNINFO_LINK_IN_PROGRESS, -+ ODM_CMNINFO_LINK, -+ ODM_CMNINFO_STATION_STATE, -+ ODM_CMNINFO_RSSI_MIN, -+ ODM_CMNINFO_DBG_COMP, -+ ODM_CMNINFO_DBG_LEVEL, -+ ODM_CMNINFO_RA_THRESHOLD_HIGH, -+ ODM_CMNINFO_RA_THRESHOLD_LOW, -+ ODM_CMNINFO_RF_ANTENNA_TYPE, -+ ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH, -+ ODM_CMNINFO_BE_FIX_TX_ANT, -+ ODM_CMNINFO_BT_ENABLED, -+ ODM_CMNINFO_BT_HS_CONNECT_PROCESS, -+ ODM_CMNINFO_BT_HS_RSSI, -+ ODM_CMNINFO_BT_OPERATION, -+ ODM_CMNINFO_BT_LIMITED_DIG, -+ ODM_CMNINFO_BT_DIG, -+ ODM_CMNINFO_BT_BUSY, -+ ODM_CMNINFO_BT_DISABLE_EDCA, -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) /*for repeater mode add by YuChen 2014.06.23*/ -+#ifdef UNIVERSAL_REPEATER -+ ODM_CMNINFO_VXD_LINK, -+#endif -+#endif -+ ODM_CMNINFO_AP_TOTAL_NUM, -+ ODM_CMNINFO_POWER_TRAINING, -+ ODM_CMNINFO_DFS_REGION_DOMAIN, -+ /*------------CALL BY VALUE-------------*/ -+ -+ /*Dynamic ptr array hook itms.*/ -+ ODM_CMNINFO_STA_STATUS, -+ ODM_CMNINFO_MAX, -+ -+}ODM_CMNINFO_E; -+ -+ -+typedef enum _PHYDM_Info_query_type { -+ PHYDM_INFO_FA_OFDM, -+ PHYDM_INFO_FA_CCK, -+ PHYDM_INFO_FA_TOTAL, -+ PHYDM_INFO_CCA_OFDM, -+ PHYDM_INFO_CCA_CCK, -+ PHYDM_INFO_CCA_ALL, -+ PHYDM_INFO_CRC32_OK_VHT, -+ PHYDM_INFO_CRC32_OK_HT, -+ PHYDM_INFO_CRC32_OK_LEGACY, -+ PHYDM_INFO_CRC32_OK_CCK, -+ PHYDM_INFO_CRC32_ERROR_VHT, -+ PHYDM_INFO_CRC32_ERROR_HT, -+ PHYDM_INFO_CRC32_ERROR_LEGACY, -+ PHYDM_INFO_CRC32_ERROR_CCK, -+ PHYDM_INFO_EDCCA_FLAG, -+ PHYDM_INFO_OFDM_ENABLE, -+ PHYDM_INFO_CCK_ENABLE, -+ PHYDM_INFO_DBG_PORT_0 -+} PHYDM_INFO_QUERY_E; -+ -+typedef enum _PHYDM_API_Definition { -+ -+ PHYDM_API_NBI = 1, -+ PHYDM_API_CSI_MASK, -+ -+} PHYDM_API_E; -+ -+ -+/*2011/10/20 MH Define ODM support ability. ODM_CMNINFO_ABILITY*/ -+typedef enum _ODM_Support_Ability_Definition { -+ -+ /*BB ODM section BIT 0-19*/ -+ ODM_BB_DIG = BIT0, -+ ODM_BB_RA_MASK = BIT1, -+ ODM_BB_DYNAMIC_TXPWR = BIT2, -+ ODM_BB_FA_CNT = BIT3, -+ ODM_BB_RSSI_MONITOR = BIT4, -+ ODM_BB_CCK_PD = BIT5, -+ ODM_BB_ANT_DIV = BIT6, -+ ODM_BB_PWR_TRAIN = BIT8, -+ ODM_BB_RATE_ADAPTIVE = BIT9, -+ ODM_BB_PATH_DIV = BIT10, -+ ODM_BB_ADAPTIVITY = BIT13, -+ ODM_BB_CFO_TRACKING = BIT14, -+ ODM_BB_NHM_CNT = BIT15, -+ ODM_BB_PRIMARY_CCA = BIT16, -+ ODM_BB_TXBF = BIT17, -+ ODM_BB_DYNAMIC_ARFR = BIT18, -+ -+ /*MAC DM section BIT 20-23*/ -+ ODM_MAC_EDCA_TURBO = BIT20, -+ ODM_MAC_EARLY_MODE = BIT21, -+ -+ /*RF ODM section BIT 24-31*/ -+ ODM_RF_TX_PWR_TRACK = BIT24, -+ ODM_RF_RX_GAIN_TRACK = BIT25, -+ ODM_RF_CALIBRATION = BIT26, -+ -+}ODM_ABILITY_E; -+ -+ -+/*ODM_CMNINFO_ONE_PATH_CCA*/ -+typedef enum tag_CCA_Path { -+ ODM_CCA_2R = 0, -+ ODM_CCA_1R_A = 1, -+ ODM_CCA_1R_B = 2, -+} ODM_CCA_PATH_E; -+ -+typedef enum CCA_PATHDIV_EN { -+ CCA_PATHDIV_DISABLE = 0, -+ CCA_PATHDIV_ENABLE = 1, -+ -+} CCA_PATHDIV_EN_E; -+ -+ -+typedef enum _BASEBAND_CONFIG_PHY_REG_PG_VALUE_TYPE { -+ PHY_REG_PG_RELATIVE_VALUE = 0, -+ PHY_REG_PG_EXACT_VALUE = 1 -+} PHY_REG_PG_TYPE; -+ -+/*2011/09/22 MH Copy from SD4 defined structure. We use to support PHY DM integration.*/ -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#if (RT_PLATFORM != PLATFORM_LINUX) -+typedef -+#endif -+ -+struct DM_Out_Source_Dynamic_Mechanism_Structure -+#else/*for AP,ADSL,CE Team*/ -+typedef struct DM_Out_Source_Dynamic_Mechanism_Structure -+#endif -+{ -+ /*Add for different team use temporarily*/ -+ PADAPTER Adapter; /*For CE/NIC team*/ -+ prtl8192cd_priv priv; /*For AP/ADSL team*/ -+ /*WHen you use Adapter or priv pointer, you must make sure the pointer is ready.*/ -+ BOOLEAN odm_ready; -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ rtl8192cd_priv fake_priv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ // ADSL_AP_BUILD_WORKAROUND -+ ADAPTER fake_adapter; -+#endif -+ -+ PHY_REG_PG_TYPE PhyRegPgValueType; -+ u1Byte PhyRegPgVersion; -+ -+ u4Byte DebugComponents; -+ u4Byte fw_DebugComponents; -+ u4Byte DebugLevel; -+ -+ u4Byte NumQryPhyStatusAll; /*CCK + OFDM*/ -+ u4Byte LastNumQryPhyStatusAll; -+ u4Byte RxPWDBAve; -+ BOOLEAN MPDIG_2G; /*off MPDIG*/ -+ u1Byte Times_2G; -+ BOOLEAN bInitHwInfoByRfe; -+ -+/*------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ -+ BOOLEAN bCckHighPower; -+ u1Byte RFPathRxEnable; -+ u1Byte ControlChannel; -+/*------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ -+ -+ -+//1 COMMON INFORMATION -+ -+ /*Init Value*/ -+ /*-----------HOOK BEFORE REG INIT-----------*/ -+ /*ODM Platform info AP/ADSL/CE/MP = 1/2/3/4*/ -+ u1Byte SupportPlatform; -+ // ODM Platform info WIN/AP/CE = 1/2/3 -+ u1Byte Normalrxpath; -+ // ODM Support Ability DIG/RATR/TX_PWR_TRACK/ ¡K¡K = 1/2/3/¡K -+ u4Byte SupportAbility; -+ /*ODM PCIE/USB/SDIO = 1/2/3*/ -+ u1Byte SupportInterface; -+ /*ODM composite or independent. Bit oriented/ 92C+92D+ .... or any other type = 1/2/3/...*/ -+ u4Byte SupportICType; -+ /*Cut Version TestChip/A-cut/B-cut... = 0/1/2/3/...*/ -+ u1Byte CutVersion; -+ /*Fab Version TSMC/UMC = 0/1*/ -+ u1Byte FabVersion; -+ /*RF Type 4T4R/3T3R/2T2R/1T2R/1T1R/...*/ -+ u1Byte RFType; -+ u1Byte RFEType; -+ /*Board Type Normal/HighPower/MiniCard/SLIM/Combo/... = 0/1/2/3/4/...*/ -+ u1Byte BoardType; -+ u1Byte PackageType; -+ u2Byte TypeGLNA; -+ u2Byte TypeGPA; -+ u2Byte TypeALNA; -+ u2Byte TypeAPA; -+ /*with external LNA NO/Yes = 0/1*/ -+ u1Byte ExtLNA; /*2G*/ -+ u1Byte ExtLNA5G; /*5G*/ -+ /*with external PA NO/Yes = 0/1*/ -+ u1Byte ExtPA; /*2G*/ -+ u1Byte ExtPA5G; /*5G*/ -+ /*with external TRSW NO/Yes = 0/1*/ -+ u1Byte ExtTRSW; -+ u1Byte ExtLNAGain; /*2G*/ -+ u1Byte PatchID; /*Customer ID*/ -+ BOOLEAN bInHctTest; -+ u1Byte WIFITest; -+ -+ BOOLEAN bDualMacSmartConcurrent; -+ u4Byte BK_SupportAbility; -+ u1Byte AntDivType; -+ u1Byte with_extenal_ant_switch; -+ BOOLEAN ConfigBBRF; -+ u1Byte odm_Regulation2_4G; -+ u1Byte odm_Regulation5G; -+ u1Byte IQKFWOffload; -+ BOOLEAN cck_new_agc; -+ u1Byte phydm_period; -+ u4Byte phydm_sys_up_time; -+ u1Byte num_rf_path; -+ /*-----------HOOK BEFORE REG INIT-----------*/ -+ -+ /*Dynamic Value*/ -+ -+ /*--------- POINTER REFERENCE-----------*/ -+ -+ u1Byte u1Byte_temp; -+ BOOLEAN BOOLEAN_temp; -+ PADAPTER PADAPTER_temp; -+ -+ /*MAC PHY Mode SMSP/DMSP/DMDP = 0/1/2*/ -+ u1Byte *pMacPhyMode; -+ /*TX Unicast byte count*/ -+ u8Byte *pNumTxBytesUnicast; -+ /*RX Unicast byte count*/ -+ u8Byte *pNumRxBytesUnicast; -+ /*Wireless mode B/G/A/N = BIT0/BIT1/BIT2/BIT3*/ -+ u1Byte *pWirelessMode; -+ /*Frequence band 2.4G/5G = 0/1*/ -+ u1Byte *pBandType; -+ /*Secondary channel offset don't_care/below/above = 0/1/2*/ -+ u1Byte *pSecChOffset; -+ /*Security mode Open/WEP/AES/TKIP = 0/1/2/3*/ -+ u1Byte *pSecurity; -+ /*BW info 20M/40M/80M = 0/1/2*/ -+ u1Byte *pBandWidth; -+ /*Central channel location Ch1/Ch2/....*/ -+ u1Byte *pChannel; /*central channel number*/ -+ BOOLEAN DPK_Done; -+ /*Common info for 92D DMSP*/ -+ -+ BOOLEAN *pbGetValueFromOtherMac; -+ PADAPTER *pBuddyAdapter; -+ BOOLEAN *pbMasterOfDMSP; //MAC0: master, MAC1: slave -+ /*Common info for Status*/ -+ BOOLEAN *pbScanInProcess; -+ BOOLEAN *pbPowerSaving; -+ /*CCA Path 2-path/path-A/path-B = 0/1/2; using ODM_CCA_PATH_E.*/ -+ u1Byte *pOnePathCCA; -+ u1Byte *pAntennaTest; -+ BOOLEAN *pbNet_closed; -+ u1Byte *pu1ForcedIgiLb; -+ BOOLEAN *pIsFcsModeEnable; -+ /*--------- For 8723B IQK-----------*/ -+ BOOLEAN *pIs1Antenna; -+ u1Byte *pRFDefaultPath; -+ // 0:S1, 1:S0 -+ -+ /*--------- POINTER REFERENCE-----------*/ -+ pu2Byte pForcedDataRate; -+ pu1Byte p_enable_antdiv; -+ pu1Byte p_enable_adaptivity; -+ pu1Byte HubUsbMode; -+ BOOLEAN *pbFwDwRsvdPageInProgress; -+ u4Byte *pCurrentTxTP; -+ u4Byte *pCurrentRxTP; -+ u1Byte *pSoundingSeq; -+ /*------------CALL BY VALUE-------------*/ -+ BOOLEAN bLinkInProcess; -+ BOOLEAN bWIFI_Direct; -+ BOOLEAN bWIFI_Display; -+ BOOLEAN bLinked; -+ BOOLEAN bsta_state; -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) /*for repeater mode add by YuChen 2014.06.23*/ -+#ifdef UNIVERSAL_REPEATER -+ BOOLEAN VXD_bLinked; -+#endif -+#endif -+ u1Byte RSSI_Min; -+ u1Byte InterfaceIndex; /*Add for 92D dual MAC: 0--Mac0 1--Mac1*/ -+ BOOLEAN bIsMPChip; -+ BOOLEAN bOneEntryOnly; -+ BOOLEAN mp_mode; -+ u4Byte OneEntry_MACID; -+ u1Byte pre_number_linked_client; -+ u1Byte number_linked_client; -+ u1Byte pre_number_active_client; -+ u1Byte number_active_client; -+ /*Common info for BTDM*/ -+ BOOLEAN bBtEnabled; /*BT is enabled*/ -+ BOOLEAN bBtConnectProcess; /*BT HS is under connection progress.*/ -+ u1Byte btHsRssi; /*BT HS mode wifi rssi value.*/ -+ BOOLEAN bBtHsOperation; /*BT HS mode is under progress*/ -+ u1Byte btHsDigVal; /*use BT rssi to decide the DIG value*/ -+ BOOLEAN bBtDisableEdcaTurbo; /*Under some condition, don't enable the EDCA Turbo*/ -+ BOOLEAN bBtBusy; /*BT is busy.*/ -+ BOOLEAN bBtLimitedDig; /*BT is busy.*/ -+ BOOLEAN bDisablePhyApi; -+ /*------------CALL BY VALUE-------------*/ -+ u1Byte RSSI_A; -+ u1Byte RSSI_B; -+ u1Byte RSSI_C; -+ u1Byte RSSI_D; -+ u8Byte RSSI_TRSW; -+ u8Byte RSSI_TRSW_H; -+ u8Byte RSSI_TRSW_L; -+ u8Byte RSSI_TRSW_iso; -+ u1Byte TXAntStatus; -+ u1Byte RXAntStatus; -+ u1Byte cck_lna_idx; -+ u1Byte cck_vga_idx; -+ u1Byte curr_station_id; -+ u1Byte ofdm_agc_idx[4]; -+ -+ u1Byte RxRate; -+ BOOLEAN bNoisyState; -+ u1Byte TxRate; -+ u1Byte LinkedInterval; -+ u1Byte preChannel; -+ u4Byte TxagcOffsetValueA; -+ BOOLEAN IsTxagcOffsetPositiveA; -+ u4Byte TxagcOffsetValueB; -+ BOOLEAN IsTxagcOffsetPositiveB; -+ u4Byte tx_tp; -+ u4Byte rx_tp; -+ u4Byte total_tp; -+ u8Byte curTxOkCnt; -+ u8Byte curRxOkCnt; -+ u8Byte lastTxOkCnt; -+ u8Byte lastRxOkCnt; -+ u4Byte BbSwingOffsetA; -+ BOOLEAN IsBbSwingOffsetPositiveA; -+ u4Byte BbSwingOffsetB; -+ BOOLEAN IsBbSwingOffsetPositiveB; -+ u1Byte IGI_LowerBound; -+ u1Byte IGI_UpperBound; -+ u1Byte antdiv_rssi; -+ u1Byte fat_comb_a; -+ u1Byte fat_comb_b; -+ u1Byte antdiv_intvl; -+ u1Byte AntType; -+ u1Byte pre_AntType; -+ u1Byte antdiv_period; -+ u1Byte evm_antdiv_period; -+ u1Byte antdiv_select; -+ u1Byte path_select; -+ u1Byte antdiv_evm_en; -+ u1Byte bdc_holdstate; -+ u1Byte NdpaPeriod; -+ BOOLEAN H2C_RARpt_connect; -+ BOOLEAN cck_agc_report_type; -+ -+ u1Byte dm_dig_max_TH; -+ u1Byte dm_dig_min_TH; -+ u1Byte print_agc; -+ u1Byte TrafficLoad; -+ u1Byte pre_TrafficLoad; -+ -+ /*For Adaptivtiy*/ -+ u2Byte NHM_cnt_0; -+ u2Byte NHM_cnt_1; -+ s1Byte TH_L2H_default; -+ s1Byte TH_EDCCA_HL_diff_default; -+ s1Byte TH_L2H_ini; -+ s1Byte TH_EDCCA_HL_diff; -+ s1Byte TH_L2H_ini_mode2; -+ s1Byte TH_EDCCA_HL_diff_mode2; -+ BOOLEAN Carrier_Sense_enable; -+ u1Byte Adaptivity_IGI_upper; -+ BOOLEAN adaptivity_flag; -+ u1Byte DCbackoff; -+ BOOLEAN Adaptivity_enable; -+ u1Byte APTotalNum; -+ BOOLEAN EDCCA_enable; -+ ADAPTIVITY_STATISTICS Adaptivity; -+ /*For Adaptivtiy*/ -+ u1Byte LastUSBHub; -+ u1Byte TxBfDataRate; -+ -+ u1Byte nbi_set_result; -+ -+ u1Byte c2h_cmd_start; -+ u1Byte fw_debug_trace[60]; -+ u1Byte pre_c2h_seq; -+ BOOLEAN fw_buff_is_enpty; -+ u4Byte data_frame_num; -+ u4Byte ADCSmp_count; -+ u4Byte ADCSmp_dbg_port; -+ BOOLEAN ADCSmp_trigger_edge; -+ u1Byte ADCsmp_smp_rate; -+ u4Byte ADCsmp_time_unit; -+ -+ /*for noise detection*/ -+ BOOLEAN NoisyDecision; /*b_noisy*/ -+ BOOLEAN pre_b_noisy; -+ u4Byte NoisyDecision_Smooth; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ ODM_NOISE_MONITOR noise_level; -+#endif -+ /*Define STA info.*/ -+ /*_ODM_STA_INFO*/ -+ /*2012/01/12 MH For MP, we need to reduce one array pointer for default port.??*/ -+ PSTA_INFO_T pODM_StaInfo[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte platform2phydm_macid_table[ODM_ASSOCIATE_ENTRY_NUM]; -+ /* platform_macid_table[platform_macid] = phydm_macid */ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+ s4Byte AccumulatePWDB[ODM_ASSOCIATE_ENTRY_NUM]; -+#endif -+ -+#if (RATE_ADAPTIVE_SUPPORT == 1) -+ u2Byte CurrminRptTime; -+ ODM_RA_INFO_T RAInfo[ODM_ASSOCIATE_ENTRY_NUM]; -+ /*Use MacID as array index. STA MacID=0, VWiFi Client MacID={1, ODM_ASSOCIATE_ENTRY_NUM-1} //YJ,add,120119*/ -+#endif -+ -+ /*2012/02/14 MH Add to share 88E ra with other SW team.*/ -+ /*We need to colelct all support abilit to a proper area.*/ -+ -+ BOOLEAN RaSupport88E; -+ -+ ODM_PHY_DBG_INFO_T PhyDbgInfo; -+ -+ /*ODM Structure*/ -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ BDC_T DM_BdcTable; -+ #endif -+ -+ #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -+ SAT_T dm_sat_table; -+ #endif -+ -+#endif -+ FAT_T DM_FatTable; -+ DIG_T DM_DigTable; -+#if (defined(CONFIG_BB_POWER_SAVING)) -+ PS_T DM_PSTable; -+#endif -+ Pri_CCA_T DM_PriCCA; -+ RA_T DM_RA_Table; -+ FALSE_ALARM_STATISTICS FalseAlmCnt; -+ FALSE_ALARM_STATISTICS FlaseAlmCntBuddyAdapter; -+ SWAT_T DM_SWAT_Table; -+ CFO_TRACKING DM_CfoTrack; -+ ACS DM_ACS; -+ CCX_INFO DM_CCX_INFO; -+ -+ RT_ADCSMP adcsmp; -+ -+#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) -+ IQK_INFO IQK_info; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ /*Path Div Struct*/ -+ PATHDIV_PARA pathIQK; -+#endif -+#if(defined(CONFIG_PATH_DIVERSITY)) -+ PATHDIV_T DM_PathDiv; -+#endif -+ -+ EDCA_T DM_EDCA_Table; -+ u4Byte WMMEDCA_BE; -+ -+ BOOLEAN *pbDriverStopped; -+ BOOLEAN *pbDriverIsGoingToPnpSetPowerSleep; -+ BOOLEAN *pinit_adpt_in_progress; -+ -+ /*PSD*/ -+ BOOLEAN bUserAssignLevel; -+ u1Byte RSSI_BT; /*come from BT*/ -+ BOOLEAN bPSDinProcess; -+ BOOLEAN bPSDactive; -+ BOOLEAN bDMInitialGainEnable; -+ -+ /*MPT DIG*/ -+ RT_TIMER MPT_DIGTimer; -+ -+ /*for rate adaptive, in fact, 88c/92c fw will handle this*/ -+ u1Byte bUseRAMask; -+ -+ ODM_RATE_ADAPTIVE RateAdaptive; -+ #if (defined(CONFIG_ANT_DETECTION)) -+ ANT_DETECTED_INFO AntDetectedInfo; /* Antenna detected information for RSSI tool*/ -+ #endif -+ ODM_RF_CAL_T RFCalibrateInfo; -+ u4Byte nIQK_Cnt; -+ u4Byte nIQK_OK_Cnt; -+ u4Byte nIQK_Fail_Cnt; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ /*Power Training*/ -+ u1Byte ForcePowerTrainingState; -+ BOOLEAN bChangeState; -+ u4Byte PT_score; -+ u8Byte OFDM_RX_Cnt; -+ u8Byte CCK_RX_Cnt; -+#endif -+ BOOLEAN bDisablePowerTraining; -+ u1Byte DynamicTxHighPowerLvl; -+ u1Byte LastDTPLvl; -+ u4Byte tx_agc_ofdm_18_6; -+ u1Byte rx_pkt_type; -+ -+ /*ODM relative time.*/ -+ RT_TIMER PathDivSwitchTimer; -+ /*2011.09.27 add for Path Diversity*/ -+ RT_TIMER CCKPathDiversityTimer; -+ RT_TIMER FastAntTrainingTimer; -+ #ifdef ODM_EVM_ENHANCE_ANTDIV -+ RT_TIMER EVM_FastAntTrainingTimer; -+ #endif -+ RT_TIMER sbdcnt_timer; -+ -+ /*ODM relative workitem.*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#if USE_WORKITEM -+ RT_WORK_ITEM PathDivSwitchWorkitem; -+ RT_WORK_ITEM CCKPathDiversityWorkitem; -+ RT_WORK_ITEM FastAntTrainingWorkitem; -+ RT_WORK_ITEM MPT_DIGWorkitem; -+ RT_WORK_ITEM RaRptWorkitem; -+ RT_WORK_ITEM sbdcnt_workitem; -+#endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+#if (BEAMFORMING_SUPPORT == 1) -+ RT_BEAMFORMING_INFO BeamformingInfo; -+#endif -+#endif -+ -+#ifdef CONFIG_PHYDM_DFS_MASTER -+ u1Byte DFS_RegionDomain; -+ pu1Byte dfs_master_enabled; -+ -+ /*====== phydm_radar_detect_with_dbg_parm start ======*/ -+ u1Byte radar_detect_dbg_parm_en; -+ u4Byte radar_detect_reg_918; -+ u4Byte radar_detect_reg_91c; -+ u4Byte radar_detect_reg_920; -+ u4Byte radar_detect_reg_924; -+ /*====== phydm_radar_detect_with_dbg_parm end ======*/ -+#endif -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+#if (RT_PLATFORM != PLATFORM_LINUX) -+} DM_ODM_T, *PDM_ODM_T; /*DM_Dynamic_Mechanism_Structure*/ -+#else -+}; -+#endif -+ -+#else /*for AP,ADSL,CE Team*/ -+} DM_ODM_T, *PDM_ODM_T; /*DM_Dynamic_Mechanism_Structure*/ -+#endif -+ -+ -+typedef enum _PHYDM_STRUCTURE_TYPE{ -+ PHYDM_FALSEALMCNT, -+ PHYDM_CFOTRACK, -+ PHYDM_ADAPTIVITY, -+ PHYDM_ROMINFO, -+ -+}PHYDM_STRUCTURE_TYPE; -+ -+ -+ -+ typedef enum _ODM_RF_CONTENT{ -+ odm_radioa_txt = 0x1000, -+ odm_radiob_txt = 0x1001, -+ odm_radioc_txt = 0x1002, -+ odm_radiod_txt = 0x1003 -+} ODM_RF_CONTENT; -+ -+typedef enum _ODM_BB_Config_Type{ -+ CONFIG_BB_PHY_REG, -+ CONFIG_BB_AGC_TAB, -+ CONFIG_BB_AGC_TAB_2G, -+ CONFIG_BB_AGC_TAB_5G, -+ CONFIG_BB_PHY_REG_PG, -+ CONFIG_BB_PHY_REG_MP, -+ CONFIG_BB_AGC_TAB_DIFF, -+} ODM_BB_Config_Type, *PODM_BB_Config_Type; -+ -+typedef enum _ODM_RF_Config_Type { -+ CONFIG_RF_RADIO, -+ CONFIG_RF_TXPWR_LMT, -+} ODM_RF_Config_Type, *PODM_RF_Config_Type; -+ -+typedef enum _ODM_FW_Config_Type { -+ CONFIG_FW_NIC, -+ CONFIG_FW_NIC_2, -+ CONFIG_FW_AP, -+ CONFIG_FW_AP_2, -+ CONFIG_FW_MP, -+ CONFIG_FW_WoWLAN, -+ CONFIG_FW_WoWLAN_2, -+ CONFIG_FW_AP_WoWLAN, -+ CONFIG_FW_BT, -+} ODM_FW_Config_Type; -+ -+/*Status code*/ -+#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) -+typedef enum _RT_STATUS{ -+ RT_STATUS_SUCCESS, -+ RT_STATUS_FAILURE, -+ RT_STATUS_PENDING, -+ RT_STATUS_RESOURCE, -+ RT_STATUS_INVALID_CONTEXT, -+ RT_STATUS_INVALID_PARAMETER, -+ RT_STATUS_NOT_SUPPORT, -+ RT_STATUS_OS_API_FAILED, -+}RT_STATUS,*PRT_STATUS; -+#endif /*end of RT_STATUS definition*/ -+ -+#ifdef REMOVE_PACK -+#pragma pack() -+#endif -+ -+/*===========================================================*/ -+/*AGC RX High Power Mode*/ -+/*===========================================================*/ -+#define LNA_Low_Gain_1 0x64 -+#define LNA_Low_Gain_2 0x5A -+#define LNA_Low_Gain_3 0x58 -+ -+#define FA_RXHP_TH1 5000 -+#define FA_RXHP_TH2 1500 -+#define FA_RXHP_TH3 800 -+#define FA_RXHP_TH4 600 -+#define FA_RXHP_TH5 500 -+ -+typedef enum tag_1R_CCA_Type_Definition { -+ CCA_1R =0, -+ CCA_2R = 1, -+ CCA_MAX = 2, -+} DM_1R_CCA_E; -+ -+typedef enum tag_RF_Type_Definition { -+ RF_Save =0, -+ RF_Normal = 1, -+ RF_MAX = 2, -+} DM_RF_E; -+ -+/*check Sta pointer valid or not*/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+#define IS_STA_VALID(pSta) (pSta && pSta->expire_to) -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#define IS_STA_VALID(pSta) (pSta && pSta->bUsed) -+#else -+#define IS_STA_VALID(pSta) (pSta) -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_AP)) -+ -+BOOLEAN -+ODM_CheckPowerStatus( -+ IN PADAPTER Adapter -+ ); -+ -+#endif -+ -+u4Byte odm_ConvertTo_dB(u4Byte Value); -+ -+u4Byte odm_ConvertTo_linear(u4Byte Value); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ -+u4Byte -+GetPSDData( -+ PDM_ODM_T pDM_Odm, -+ unsigned int point, -+ u1Byte initial_gain_psd); -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+VOID -+ODM_DMWatchdog_LPS( -+ IN PDM_ODM_T pDM_Odm -+); -+#endif -+ -+ -+s4Byte -+ODM_PWdB_Conversion( -+ IN s4Byte X, -+ IN u4Byte TotalBit, -+ IN u4Byte DecimalBit -+ ); -+ -+s4Byte -+ODM_SignConversion( -+ IN s4Byte value, -+ IN u4Byte TotalBit -+ ); -+ -+VOID -+ODM_InitMpDriverStatus( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+void -+phydm_seq_sorting( -+ IN PVOID pDM_VOID, -+ IN OUT u4Byte *p_value, -+ IN OUT u4Byte *rank_idx, -+ IN OUT u4Byte *p_idx_out, -+ IN u1Byte seq_length -+); -+ -+VOID -+ODM_DMInit( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+VOID -+ODM_DMReset( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+phydm_support_ability_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ); -+ -+VOID -+phydm_config_trx_path( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ); -+ -+VOID -+ODM_DMWatchdog( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_CmnInfoInit( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_CMNINFO_E CmnInfo, -+ IN u4Byte Value -+ ); -+ -+VOID -+ODM_CmnInfoHook( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_CMNINFO_E CmnInfo, -+ IN PVOID pValue -+ ); -+ -+VOID -+ODM_CmnInfoPtrArrayHook( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_CMNINFO_E CmnInfo, -+ IN u2Byte Index, -+ IN PVOID pValue -+ ); -+ -+VOID -+ODM_CmnInfoUpdate( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte CmnInfo, -+ IN u8Byte Value -+ ); -+ -+u4Byte -+PHYDM_CmnInfoQuery( -+ IN PDM_ODM_T pDM_Odm, -+ IN PHYDM_INFO_QUERY_E info_type -+ ); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+VOID -+ODM_InitAllThreads( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_StopAllThreads( -+ IN PDM_ODM_T pDM_Odm -+ ); -+#endif -+ -+VOID -+ODM_InitAllTimers( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_CancelAllTimers( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_ReleaseAllTimers( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID ODM_InitAllWorkItems(IN PDM_ODM_T pDM_Odm ); -+VOID ODM_FreeAllWorkItems(IN PDM_ODM_T pDM_Odm ); -+ -+u8Byte -+PlatformDivision64( -+ IN u8Byte x, -+ IN u8Byte y -+); -+ -+#define DM_ChangeDynamicInitGainThresh ODM_ChangeDynamicInitGainThresh -+ -+typedef enum tag_DIG_Connect_Definition -+{ -+ DIG_STA_DISCONNECT = 0, -+ DIG_STA_CONNECT = 1, -+ DIG_STA_BEFORE_CONNECT = 2, -+ DIG_MultiSTA_DISCONNECT = 3, -+ DIG_MultiSTA_CONNECT = 4, -+ DIG_CONNECT_MAX -+} DM_DIG_CONNECT_E; -+ -+/*2012/01/12 MH Check afapter status. Temp fix BSOD.*/ -+ -+#define HAL_ADAPTER_STS_CHK(pDM_Odm)\ -+ if (pDM_Odm->Adapter == NULL)\ -+ {\ -+ return;\ -+ }\ -+ -+#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+ -+VOID -+ODM_AsocEntry_Init( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+ -+PVOID -+PhyDM_Get_Structure( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte Structure_Type -+); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ||(DM_ODM_SUPPORT_TYPE == ODM_CE) -+/*===========================================================*/ -+/* The following is for compile only*/ -+/*===========================================================*/ -+ -+#define IS_HARDWARE_TYPE_8723A(_Adapter) FALSE -+#define IS_HARDWARE_TYPE_8723AE(_Adapter) FALSE -+#define IS_HARDWARE_TYPE_8192C(_Adapter) FALSE -+#define IS_HARDWARE_TYPE_8192D(_Adapter) FALSE -+#define RF_T_METER_92D 0x42 -+ -+ -+#define GET_RX_STATUS_DESC_RX_MCS(__pRxStatusDesc) LE_BITS_TO_1BYTE(__pRxStatusDesc+12, 0, 6) -+ -+#define rConfig_ram64x16 0xb2c -+ -+#define TARGET_CHNL_NUM_2G_5G 59 -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+u1Byte GetRightChnlPlaceforIQK(u1Byte chnl); -+#endif -+ -+//=========================================================== -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+void odm_dtc(PDM_ODM_T pDM_Odm); -+#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ -+ -+ -+VOID phydm_NoisyDetection(IN PDM_ODM_T pDM_Odm ); -+ -+ -+#endif -+ -+VOID -+phydm_set_ext_switch( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+); -+ -+VOID -+phydm_api_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte function_map, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+); -+ -+u1Byte -+phydm_nbi_setting( -+ IN PVOID pDM_VOID, -+ IN u4Byte enable, -+ IN u4Byte channel, -+ IN u4Byte bw, -+ IN u4Byte f_interference, -+ IN u4Byte Second_ch -+); -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.c 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,3652 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#define READ_AND_CONFIG_MP(ic, txt) (ODM_ReadAndConfig_MP_##ic##txt(pDM_Odm)) -+#define READ_AND_CONFIG_TC(ic, txt) (ODM_ReadAndConfig_TC_##ic##txt(pDM_Odm)) -+ -+ -+#if (PHYDM_TESTCHIP_SUPPORT == 1) -+#define READ_AND_CONFIG(ic, txt) do {\ -+ if (pDM_Odm->bIsMPChip)\ -+ READ_AND_CONFIG_MP(ic,txt);\ -+ else\ -+ READ_AND_CONFIG_TC(ic,txt);\ -+ } while(0) -+#else -+ #define READ_AND_CONFIG READ_AND_CONFIG_MP -+#endif -+ -+ -+#define READ_FIRMWARE_MP(ic, txt) (ODM_ReadFirmware_MP_##ic##txt(pDM_Odm, pFirmware, pSize)) -+#define READ_FIRMWARE_TC(ic, txt) (ODM_ReadFirmware_TC_##ic##txt(pDM_Odm, pFirmware, pSize)) -+ -+#if (PHYDM_TESTCHIP_SUPPORT == 1) -+#define READ_FIRMWARE(ic, txt) do {\ -+ if (pDM_Odm->bIsMPChip)\ -+ READ_FIRMWARE_MP(ic,txt);\ -+ else\ -+ READ_FIRMWARE_TC(ic,txt);\ -+ } while(0) -+#else -+#define READ_FIRMWARE READ_FIRMWARE_MP -+#endif -+ -+#define GET_VERSION_MP(ic, txt) (ODM_GetVersion_MP_##ic##txt()) -+#define GET_VERSION_TC(ic, txt) (ODM_GetVersion_TC_##ic##txt()) -+ -+#if (PHYDM_TESTCHIP_SUPPORT == 1) -+#define GET_VERSION(ic, txt) (pDM_Odm->bIsMPChip?GET_VERSION_MP(ic,txt):GET_VERSION_TC(ic,txt)) -+#else -+#define GET_VERSION(ic, txt) GET_VERSION_MP(ic, txt) -+#endif -+ -+u1Byte -+odm_QueryRxPwrPercentage( -+ IN s1Byte AntPower -+ ) -+{ -+ if ((AntPower <= -100) || (AntPower >= 20)) -+ return 0; -+ else if (AntPower >= 0) -+ return 100; -+ else -+ return (100 + AntPower); -+} -+ -+ -+// -+// 2012/01/12 MH MOve some signal strength smooth method to MP HAL layer. -+// IF other SW team do not support the feature, remove this section.?? -+// -+s4Byte -+odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Lenovo( -+ IN OUT PDM_ODM_T pDM_Odm, -+ s4Byte CurrSig -+) -+{ -+ s4Byte RetSig = 0; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ //if(pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ { -+ // Step 1. Scale mapping. -+ // 20100611 Joseph: Re-tunning RSSI presentation for Lenovo. -+ // 20100426 Joseph: Modify Signal strength mapping. -+ // This modification makes the RSSI indication similar to Intel solution. -+ // 20100414 Joseph: Tunning RSSI for Lenovo according to RTL8191SE. -+ if (CurrSig >= 54 && CurrSig <= 100) -+ RetSig = 100; -+ else if (CurrSig >= 42 && CurrSig <= 53) -+ RetSig = 95; -+ else if (CurrSig >= 36 && CurrSig <= 41) -+ RetSig = 74 + ((CurrSig - 36) * 20) / 6; -+ else if (CurrSig >= 33 && CurrSig <= 35) -+ RetSig = 65 + ((CurrSig - 33) * 8) / 2; -+ else if (CurrSig >= 18 && CurrSig <= 32) -+ RetSig = 62 + ((CurrSig - 18) * 2) / 15; -+ else if (CurrSig >= 15 && CurrSig <= 17) -+ RetSig = 33 + ((CurrSig - 15) * 28) / 2; -+ else if (CurrSig >= 10 && CurrSig <= 14) -+ RetSig = 39; -+ else if (CurrSig >= 8 && CurrSig <= 9) -+ RetSig = 33; -+ else if (CurrSig <= 8) -+ RetSig = 19; -+ } -+#endif //ENDIF (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ return RetSig; -+} -+ -+s4Byte -+odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Netcore( -+ IN OUT PDM_ODM_T pDM_Odm, -+ s4Byte CurrSig -+) -+{ -+ s4Byte RetSig = 0; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ //if(pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ { -+ // Netcore request this modification because 2009.04.13 SU driver use it. -+ if (CurrSig >= 31 && CurrSig <= 100) -+ RetSig = 100; -+ else if (CurrSig >= 21 && CurrSig <= 30) -+ RetSig = 90 + ((CurrSig - 20) / 1); -+ else if (CurrSig >= 11 && CurrSig <= 20) -+ RetSig = 80 + ((CurrSig - 10) / 1); -+ else if (CurrSig >= 7 && CurrSig <= 10) -+ RetSig = 69 + (CurrSig - 7); -+ else if (CurrSig == 6) -+ RetSig = 54; -+ else if (CurrSig == 5) -+ RetSig = 45; -+ else if (CurrSig == 4) -+ RetSig = 36; -+ else if (CurrSig == 3) -+ RetSig = 27; -+ else if (CurrSig == 2) -+ RetSig = 18; -+ else if (CurrSig == 1) -+ RetSig = 9; -+ else -+ RetSig = CurrSig; -+ } -+#endif //ENDIF (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ return RetSig; -+} -+ -+ -+s4Byte -+odm_SignalScaleMapping_92CSeries( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN s4Byte CurrSig -+) -+{ -+ s4Byte RetSig = 0; -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ { -+ // Step 1. Scale mapping. -+ if(CurrSig >= 61 && CurrSig <= 100) -+ { -+ RetSig = 90 + ((CurrSig - 60) / 4); -+ } -+ else if(CurrSig >= 41 && CurrSig <= 60) -+ { -+ RetSig = 78 + ((CurrSig - 40) / 2); -+ } -+ else if(CurrSig >= 31 && CurrSig <= 40) -+ { -+ RetSig = 66 + (CurrSig - 30); -+ } -+ else if(CurrSig >= 21 && CurrSig <= 30) -+ { -+ RetSig = 54 + (CurrSig - 20); -+ } -+ else if(CurrSig >= 5 && CurrSig <= 20) -+ { -+ RetSig = 42 + (((CurrSig - 5) * 2) / 3); -+ } -+ else if(CurrSig == 4) -+ { -+ RetSig = 36; -+ } -+ else if(CurrSig == 3) -+ { -+ RetSig = 27; -+ } -+ else if(CurrSig == 2) -+ { -+ RetSig = 18; -+ } -+ else if(CurrSig == 1) -+ { -+ RetSig = 9; -+ } -+ else -+ { -+ RetSig = CurrSig; -+ } -+ } -+#endif -+ -+#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) ||(DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+ if((pDM_Odm->SupportInterface == ODM_ITRF_USB) || (pDM_Odm->SupportInterface == ODM_ITRF_SDIO)) -+ { -+ if(CurrSig >= 51 && CurrSig <= 100) -+ { -+ RetSig = 100; -+ } -+ else if(CurrSig >= 41 && CurrSig <= 50) -+ { -+ RetSig = 80 + ((CurrSig - 40)*2); -+ } -+ else if(CurrSig >= 31 && CurrSig <= 40) -+ { -+ RetSig = 66 + (CurrSig - 30); -+ } -+ else if(CurrSig >= 21 && CurrSig <= 30) -+ { -+ RetSig = 54 + (CurrSig - 20); -+ } -+ else if(CurrSig >= 10 && CurrSig <= 20) -+ { -+ RetSig = 42 + (((CurrSig - 10) * 2) / 3); -+ } -+ else if(CurrSig >= 5 && CurrSig <= 9) -+ { -+ RetSig = 22 + (((CurrSig - 5) * 3) / 2); -+ } -+ else if(CurrSig >= 1 && CurrSig <= 4) -+ { -+ RetSig = 6 + (((CurrSig - 1) * 3) / 2); -+ } -+ else -+ { -+ RetSig = CurrSig; -+ } -+ } -+ -+#endif -+ return RetSig; -+} -+s4Byte -+odm_SignalScaleMapping( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN s4Byte CurrSig -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if( (pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->SupportInterface != ODM_ITRF_PCIE) && //USB & SDIO -+ (pDM_Odm->PatchID==10))//pMgntInfo->CustomerID == RT_CID_819x_Netcore -+ { -+ return odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Netcore(pDM_Odm,CurrSig); -+ } -+ else if( (pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) && -+ (pDM_Odm->PatchID==19))//pMgntInfo->CustomerID == RT_CID_819x_Lenovo) -+ { -+ return odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Lenovo(pDM_Odm, CurrSig); -+ }else -+#endif -+ { -+#ifdef CONFIG_SIGNAL_SCALE_MAPPING -+ return odm_SignalScaleMapping_92CSeries(pDM_Odm,CurrSig); -+#else -+ return CurrSig; -+#endif -+ } -+ -+} -+ -+ -+ -+static u1Byte odm_SQ_process_patch_RT_CID_819x_Lenovo( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte isCCKrate, -+ IN u1Byte PWDB_ALL, -+ IN u1Byte path, -+ IN u1Byte RSSI -+) -+{ -+ u1Byte SQ = 0; -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ if(isCCKrate){ -+ -+ if (IS_HARDWARE_TYPE_8192E(pDM_Odm->Adapter)) { -+ -+ // -+ // Expected signal strength and bars indication at Lenovo lab. 2013.04.11 -+ // 802.11n, 802.11b, 802.11g only at channel 6 -+ // -+ // Attenuation (dB) OS Signal Bars RSSI by Xirrus (dBm) -+ // 50 5 -49 -+ // 55 5 -49 -+ // 60 5 -50 -+ // 65 5 -51 -+ // 70 5 -52 -+ // 75 5 -54 -+ // 80 5 -55 -+ // 85 4 -60 -+ // 90 3 -63 -+ // 95 3 -65 -+ // 100 2 -67 -+ // 102 2 -67 -+ // 104 1 -70 -+ // -+ -+ if(PWDB_ALL >= 50) -+ SQ = 100; -+ else if(PWDB_ALL >= 35 && PWDB_ALL < 50) -+ SQ = 80; -+ else if(PWDB_ALL >= 31 && PWDB_ALL < 35) -+ SQ = 60; -+ else if(PWDB_ALL >= 22 && PWDB_ALL < 31) -+ SQ = 40; -+ else if(PWDB_ALL >= 18 && PWDB_ALL < 22) -+ SQ = 20; -+ else -+ SQ = 10; -+ } else { -+ if (PWDB_ALL >= 50) -+ SQ = 100; -+ else if (PWDB_ALL >= 35 && PWDB_ALL < 50) -+ SQ = 80; -+ else if (PWDB_ALL >= 22 && PWDB_ALL < 35) -+ SQ = 60; -+ else if (PWDB_ALL >= 18 && PWDB_ALL < 22) -+ SQ = 40; -+ else -+ SQ = 10; -+ } -+ -+ } -+ else -+ {//OFDM rate -+ -+ if (IS_HARDWARE_TYPE_8192E(pDM_Odm->Adapter)) { -+ if(RSSI >= 45) -+ SQ = 100; -+ else if(RSSI >= 22 && RSSI < 45) -+ SQ = 80; -+ else if(RSSI >= 18 && RSSI < 22) -+ SQ = 40; -+ else -+ SQ = 20; -+ } else { -+ if(RSSI >= 45) -+ SQ = 100; -+ else if(RSSI >= 22 && RSSI < 45) -+ SQ = 80; -+ else if(RSSI >= 18 && RSSI < 22) -+ SQ = 40; -+ else -+ SQ = 20; -+ } -+ } -+ -+ RT_TRACE(COMP_DBG, DBG_TRACE, ("isCCKrate(%#d), PWDB_ALL(%#d), RSSI(%#d), SQ(%#d)\n", isCCKrate, PWDB_ALL, RSSI, SQ)); -+ -+#endif -+ return SQ; -+} -+ -+static u1Byte odm_SQ_process_patch_RT_CID_819x_Acer( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte isCCKrate, -+ IN u1Byte PWDB_ALL, -+ IN u1Byte path, -+ IN u1Byte RSSI -+) -+{ -+ u1Byte SQ = 0; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ if(isCCKrate){ -+ -+ RT_TRACE(COMP_DBG, DBG_WARNING, ("odm_SQ_process_patch_RT_Acer\n")); -+ -+#if OS_WIN_FROM_WIN8(OS_VERSION) -+ -+ if(PWDB_ALL >= 50) -+ SQ = 100; -+ else if(PWDB_ALL >= 35 && PWDB_ALL < 50) -+ SQ = 80; -+ else if(PWDB_ALL >= 30 && PWDB_ALL < 35) -+ SQ = 60; -+ else if(PWDB_ALL >= 25 && PWDB_ALL < 30) -+ SQ = 40; -+ else if(PWDB_ALL >= 20 && PWDB_ALL < 25) -+ SQ = 20; -+ else -+ SQ = 10; -+#else -+ if(PWDB_ALL >= 50) -+ SQ = 100; -+ else if(PWDB_ALL >= 35 && PWDB_ALL < 50) -+ SQ = 80; -+ else if(PWDB_ALL >= 30 && PWDB_ALL < 35) -+ SQ = 60; -+ else if(PWDB_ALL >= 25 && PWDB_ALL < 30) -+ SQ = 40; -+ else if(PWDB_ALL >= 20 && PWDB_ALL < 25) -+ SQ = 20; -+ else -+ SQ = 10; -+ -+ if(PWDB_ALL == 0)// Abnormal case, do not indicate the value above 20 on Win7 -+ SQ = 20; -+#endif -+ -+ -+ -+ } -+ else -+ {//OFDM rate -+ -+ if (IS_HARDWARE_TYPE_8192E(pDM_Odm->Adapter)) { -+ if(RSSI >= 45) -+ SQ = 100; -+ else if(RSSI >= 22 && RSSI < 45) -+ SQ = 80; -+ else if(RSSI >= 18 && RSSI < 22) -+ SQ = 40; -+ else -+ SQ = 20; -+ } -+ else -+ { -+ if(RSSI >= 35) -+ SQ = 100; -+ else if(RSSI >= 30 && RSSI < 35) -+ SQ = 80; -+ else if(RSSI >= 25 && RSSI < 30) -+ SQ = 40; -+ else -+ SQ = 20; -+ } -+ } -+ -+ RT_TRACE(COMP_DBG, DBG_LOUD, ("isCCKrate(%#d), PWDB_ALL(%#d), RSSI(%#d), SQ(%#d)\n", isCCKrate, PWDB_ALL, RSSI, SQ)); -+ -+#endif -+ return SQ; -+} -+ -+static u1Byte -+odm_EVMdbToPercentage( -+ IN s1Byte Value -+ ) -+{ -+ // -+ // -33dB~0dB to 0%~99% -+ // -+ s1Byte ret_val; -+ -+ ret_val = Value; -+ ret_val /= 2; -+ -+ /*DbgPrint("Value=%d\n", Value);*/ -+ /*ODM_RT_DISP(FRX, RX_PHY_SQ, ("EVMdbToPercentage92C Value=%d / %x\n", ret_val, ret_val));*/ -+#ifdef ODM_EVM_ENHANCE_ANTDIV -+ if (ret_val >= 0) -+ ret_val = 0; -+ -+ if (ret_val <= -40) -+ ret_val = -40; -+ -+ ret_val = 0 - ret_val; -+ ret_val *= 3; -+#else -+ if (ret_val >= 0) -+ ret_val = 0; -+ -+ if (ret_val <= -33) -+ ret_val = -33; -+ -+ ret_val = 0 - ret_val; -+ ret_val *= 3; -+ -+ if (ret_val == 99) -+ ret_val = 100; -+#endif -+ -+ return (u1Byte)ret_val; -+} -+ -+static u1Byte -+odm_EVMdbm_JaguarSeries( -+ IN s1Byte Value -+ ) -+{ -+ s1Byte ret_val = Value; -+ -+ // -33dB~0dB to 33dB ~ 0dB -+ if(ret_val == -128) -+ ret_val = 127; -+ else if (ret_val < 0) -+ ret_val = 0 - ret_val; -+ -+ ret_val = ret_val >> 1; -+ return (u1Byte)ret_val; -+} -+ -+static s2Byte -+odm_Cfo( -+ IN s1Byte Value -+) -+{ -+ s2Byte ret_val; -+ -+ if (Value < 0) -+ { -+ ret_val = 0 - Value; -+ ret_val = (ret_val << 1) + (ret_val >> 1) ; // *2.5~=312.5/2^7 -+ ret_val = ret_val | BIT12; // set bit12 as 1 for negative cfo -+ } -+ else -+ { -+ ret_val = Value; -+ ret_val = (ret_val << 1) + (ret_val>>1) ; // *2.5~=312.5/2^7 -+ } -+ return ret_val; -+} -+ -+u1Byte -+phydm_rate_to_num_ss( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN u1Byte DataRate -+) -+{ -+ u1Byte num_ss = 1; -+ -+ if (DataRate <= ODM_RATE54M) -+ num_ss = 1; -+ else if (DataRate <= ODM_RATEMCS31) -+ num_ss = ((DataRate - ODM_RATEMCS0) >> 3)+1; -+ else if (DataRate <= ODM_RATEVHTSS1MCS9) -+ num_ss = 1; -+ else if (DataRate <= ODM_RATEVHTSS2MCS9) -+ num_ss = 2; -+ else if (DataRate <= ODM_RATEVHTSS3MCS9) -+ num_ss = 3; -+ else if (DataRate <= ODM_RATEVHTSS4MCS9) -+ num_ss = 4; -+ -+ return num_ss; -+} -+ -+#if(ODM_IC_11N_SERIES_SUPPORT == 1) -+ -+#if (RTL8703B_SUPPORT == 1) -+s1Byte -+odm_CCKRSSI_8703B( -+ IN u2Byte LNA_idx, -+ IN u1Byte VGA_idx -+ ) -+{ -+ s1Byte rx_pwr_all = 0x00; -+ -+ switch (LNA_idx) { -+ case 0xf: -+ rx_pwr_all = -48 - (2 * VGA_idx); -+ break; -+ case 0xb: -+ rx_pwr_all = -42 - (2 * VGA_idx); /*TBD*/ -+ break; -+ case 0xa: -+ rx_pwr_all = -36 - (2 * VGA_idx); -+ break; -+ case 8: -+ rx_pwr_all = -32 - (2 * VGA_idx); -+ break; -+ case 7: -+ rx_pwr_all = -19 - (2 * VGA_idx); -+ break; -+ case 4: -+ rx_pwr_all = -6 - (2 * VGA_idx); -+ break; -+ case 0: -+ rx_pwr_all = -2 - (2 * VGA_idx); -+ break; -+ default: -+ /*rx_pwr_all = -53+(2*(31-VGA_idx));*/ -+ /*DbgPrint("wrong LNA index\n");*/ -+ break; -+ -+ } -+ return rx_pwr_all; -+} -+#endif -+ -+#if (RTL8195A_SUPPORT == 1) -+s1Byte -+odm_CCKRSSI_8195A( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN u2Byte LNA_idx, -+ IN u1Byte VGA_idx -+ ) -+{ -+ s1Byte rx_pwr_all = 0; -+ s1Byte lna_gain = 0; -+ s1Byte lna_gain_table_0[8] = {0, -8, -15, -22, -29, -36, -45, -54}; -+ s1Byte lna_gain_table_1[8] = {0, -8, -15, -22, -29, -36, -45, -54};/*use 8195A to calibrate this table. 2016.06.24, Dino*/ -+ -+ if (pDM_Odm->cck_agc_report_type == 0) -+ lna_gain = lna_gain_table_0[LNA_idx]; -+ else -+ lna_gain = lna_gain_table_1[LNA_idx]; -+ -+ rx_pwr_all = lna_gain - (2 * VGA_idx); -+ -+ return rx_pwr_all; -+} -+#endif -+ -+#if (RTL8192E_SUPPORT == 1) -+s1Byte -+odm_CCKRSSI_8192E( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN u2Byte LNA_idx, -+ IN u1Byte VGA_idx -+ ) -+{ -+ s1Byte rx_pwr_all = 0; -+ s1Byte lna_gain = 0; -+ s1Byte lna_gain_table_0[8] = {15, 9, -10, -21, -23, -27, -43, -44}; -+ s1Byte lna_gain_table_1[8] = {24, 18, 13, -4, -11, -18, -31, -36};/*use 8192EU to calibrate this table. 2015.12.15, Dino*/ -+ -+ if (pDM_Odm->cck_agc_report_type == 0) -+ lna_gain = lna_gain_table_0[LNA_idx]; -+ else -+ lna_gain = lna_gain_table_1[LNA_idx]; -+ -+ rx_pwr_all = lna_gain - (2 * VGA_idx); -+ -+ return rx_pwr_all; -+} -+#endif -+ -+#if (RTL8188E_SUPPORT == 1) -+s1Byte -+odm_CCKRSSI_8188E( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN u2Byte LNA_idx, -+ IN u1Byte VGA_idx -+ ) -+{ -+ s1Byte rx_pwr_all = 0; -+ s1Byte lna_gain = 0; -+ s1Byte lna_gain_table_0[8] = {17, -1, -13, -29, -32, -35, -38, -41};/*only use lna0/1/2/3/7*/ -+ s1Byte lna_gain_table_1[8] = {29, 20, 12, 3, -6, -15, -24, -33}; /*only use lna3 /7*/ -+ -+ if (pDM_Odm->CutVersion >= ODM_CUT_I) /*SMIC*/ -+ lna_gain = lna_gain_table_0[LNA_idx]; -+ else /*TSMC*/ -+ lna_gain = lna_gain_table_1[LNA_idx]; -+ -+ rx_pwr_all = lna_gain - (2 * VGA_idx); -+ -+ return rx_pwr_all; -+} -+#endif -+ -+VOID -+odm_RxPhyStatus92CSeries_Parsing( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ u1Byte i, Max_spatial_stream; -+ s1Byte rx_pwr[4], rx_pwr_all=0; -+ u1Byte EVM, PWDB_ALL = 0, PWDB_ALL_BT; -+ u1Byte RSSI, total_rssi=0; -+ BOOLEAN isCCKrate=FALSE; -+ u1Byte rf_rx_num = 0; -+ u1Byte cck_highpwr = 0; -+ u1Byte LNA_idx = 0; -+ u1Byte VGA_idx = 0; -+ u1Byte cck_agc_rpt; -+ u1Byte num_ss; -+ PPHY_STATUS_RPT_8192CD_T pPhyStaRpt = (PPHY_STATUS_RPT_8192CD_T)pPhyStatus; -+ -+ isCCKrate = (pPktinfo->DataRate <= ODM_RATE11M) ? TRUE : FALSE; -+ -+ if (pPktinfo->bToSelf) -+ pDM_Odm->curr_station_id = pPktinfo->StationID; -+ -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; -+ -+ -+ if(isCCKrate) -+ { -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; -+ cck_agc_rpt = pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a ; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8703B)) { -+ -+ #if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->cck_agc_report_type == 1) { /*4 bit LNA*/ -+ -+ u1Byte cck_agc_rpt_b = (pPhyStaRpt->cck_rpt_b_ofdm_cfosho_b & BIT7) ? 1 : 0; -+ -+ LNA_idx = (cck_agc_rpt_b << 3) | ((cck_agc_rpt & 0xE0) >> 5); -+ VGA_idx = (cck_agc_rpt & 0x1F); -+ -+ rx_pwr_all = odm_CCKRSSI_8703B(LNA_idx, VGA_idx); -+ } -+ #endif -+ } else { /*3 bit LNA*/ -+ -+ LNA_idx = ((cck_agc_rpt & 0xE0) >>5); -+ VGA_idx = (cck_agc_rpt & 0x1F); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8188E)) { -+ -+ #if (RTL8188E_SUPPORT == 1) -+ rx_pwr_all = odm_CCKRSSI_8188E(pDM_Odm, LNA_idx, VGA_idx); -+ /**/ -+ #endif -+ } -+ #if (RTL8192E_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { -+ -+ rx_pwr_all = odm_CCKRSSI_8192E(pDM_Odm, LNA_idx, VGA_idx); -+ /**/ -+ } -+ #endif -+ #if (RTL8723B_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType & (ODM_RTL8723B)) { -+ -+ rx_pwr_all = odm_CCKRSSI_8723B(LNA_idx,VGA_idx); -+ /**/ -+ } -+ #endif -+ #if (RTL8188F_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType & (ODM_RTL8188F)) { -+ -+ rx_pwr_all = odm_CCKRSSI_8188F(LNA_idx, VGA_idx); -+ /**/ -+ } -+ #endif -+ #if (RTL8195A_SUPPORT == 1) -+ else if (pDM_Odm->SupportICType & (ODM_RTL8195A)) { -+ -+ rx_pwr_all = odm_CCKRSSI_8195A(LNA_idx, VGA_idx); -+ /**/ -+ } -+ #endif -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ExtLNAGain (( %d )), LNA_idx: (( 0x%x )), VGA_idx: (( 0x%x )), rx_pwr_all: (( %d ))\n", -+ pDM_Odm->ExtLNAGain, LNA_idx, VGA_idx, rx_pwr_all)); -+ -+ if (pDM_Odm->BoardType & ODM_BOARD_EXT_LNA) -+ rx_pwr_all -= pDM_Odm->ExtLNAGain; -+ -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ -+ if (pPktinfo->bToSelf) { -+ pDM_Odm->cck_lna_idx = LNA_idx; -+ pDM_Odm->cck_vga_idx = VGA_idx; -+ } -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+#endif -+ // -+ // (3) Get Signal Quality (EVM) -+ // -+ //if(pPktinfo->bPacketMatchBSSID) -+ { -+ u1Byte SQ,SQ_rpt; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)){ -+ SQ = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,0,0); -+ }else if((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID==RT_CID_819x_Acer)) -+ { -+ SQ = odm_SQ_process_patch_RT_CID_819x_Acer(pDM_Odm,isCCKrate,PWDB_ALL,0,0); -+ }else -+#endif -+ if(pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest){ -+ SQ = 100; -+ } -+ else{ -+ SQ_rpt = pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all; -+ -+ if(SQ_rpt > 64) -+ SQ = 0; -+ else if (SQ_rpt < 20) -+ SQ = 100; -+ else -+ SQ = ((64-SQ_rpt) * 100) / 44; -+ -+ } -+ -+ //DbgPrint("cck SQ = %d\n", SQ); -+ pPhyInfo->SignalQuality = SQ; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; -+ } -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) { -+ if (i == 0) -+ pPhyInfo->RxMIMOSignalStrength[0] = PWDB_ALL; -+ else -+ pPhyInfo->RxMIMOSignalStrength[1] = 0; -+ } -+ } -+ else //2 is OFDM rate -+ { -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; -+ -+ // -+ // (1)Get RSSI for HT rate -+ // -+ -+ for(i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) -+ { -+ // 2008/01/30 MH we will judge RF RX path now. -+ if (pDM_Odm->RFPathRxEnable & BIT(i)) -+ rf_rx_num++; -+ //else -+ //continue; -+ -+ rx_pwr[i] = ((pPhyStaRpt->path_agc[i].gain& 0x3F)*2) - 110; -+ -+ if (pPktinfo->bToSelf) { -+ pDM_Odm->ofdm_agc_idx[i] = (pPhyStaRpt->path_agc[i].gain & 0x3F); -+ /**/ -+ } -+ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->RxPwr[i] = rx_pwr[i]; -+ #endif -+ -+ /* Translate DBM to percentage. */ -+ RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); -+ total_rssi += RSSI; -+ //RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR=%x RSSI=%d\n", i, rx_pwr[i], RSSI)); -+ -+ pPhyInfo->RxMIMOSignalStrength[i] =(u1Byte) RSSI; -+ -+ #if (DM_ODM_SUPPORT_TYPE & (/*ODM_WIN|*/ODM_CE|ODM_AP)) -+ //Get Rx snr value in DB -+ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = (s4Byte)(pPhyStaRpt->path_rxsnr[i]/2); -+ #endif -+ -+ /* Record Signal Strength for next packet */ -+ //if(pPktinfo->bPacketMatchBSSID) -+ { -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)) -+ { -+ if(i==ODM_RF_PATH_A) -+ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,i,RSSI); -+ -+ } -+ else if((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID==RT_CID_819x_Acer)) -+ { -+ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Acer(pDM_Odm,isCCKrate,PWDB_ALL,0,RSSI); -+ } -+#endif -+ } -+ } -+ -+ -+ // -+ // (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) -+ // -+ rx_pwr_all = (((pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all) >> 1 )& 0x7f) -110; -+ -+ PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ -+ -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ODM OFDM RSSI=%d\n",pPhyInfo->RxPWDBAll)); -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; -+ pPhyInfo->RxPower = rx_pwr_all; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+ #endif -+ -+ if((pDM_Odm->SupportPlatform == ODM_WIN) &&(pDM_Odm->PatchID==19)){ -+ //do nothing -+ }else if((pDM_Odm->SupportPlatform == ODM_WIN) &&(pDM_Odm->PatchID==25)){ -+ //do nothing -+ } -+ else{//pMgntInfo->CustomerID != RT_CID_819x_Lenovo -+ // -+ // (3)EVM of HT rate -+ // -+ if(pPktinfo->DataRate >=ODM_RATEMCS8 && pPktinfo->DataRate <=ODM_RATEMCS15) -+ Max_spatial_stream = 2; //both spatial stream make sense -+ else -+ Max_spatial_stream = 1; //only spatial stream 1 makes sense -+ -+ for(i=0; i>= 1" because the compilor of free build environment -+ // fill most significant bit to "zero" when doing shifting operation which may change a negative -+ // value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore. -+ EVM = odm_EVMdbToPercentage( (pPhyStaRpt->stream_rxevm[i] )); //dbm -+ -+ //GET_RX_STATUS_DESC_RX_MCS(pDesc), pDrvInfo->rxevm[i], "%", EVM)); -+ -+ //if(pPktinfo->bPacketMatchBSSID) -+ { -+ if(i==ODM_RF_PATH_A) // Fill value in RFD, Get the first spatial stream only -+ { -+ pPhyInfo->SignalQuality = (u1Byte)(EVM & 0xff); -+ } -+ pPhyInfo->RxMIMOSignalQuality[i] = (u1Byte)(EVM & 0xff); -+ } -+ } -+ } -+ -+ num_ss =phydm_rate_to_num_ss(pDM_Odm, pPktinfo->DataRate ); -+ ODM_ParsingCFO(pDM_Odm, pPktinfo, pPhyStaRpt->path_cfotail, num_ss); -+ -+ } -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ //UI BSS List signal strength(in percentage), make it good looking, from 0~100. -+ //It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp(). -+ if(isCCKrate) -+ { -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ // 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/ -+ pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, PWDB_ALL, TRUE, TRUE); -+#else -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));/*PWDB_ALL;*/ -+#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+ } -+ else -+ { -+ if (rf_rx_num != 0) -+ { -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ // 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/ -+ pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, (total_rssi /= rf_rx_num), TRUE, FALSE); -+ #else -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, total_rssi /= rf_rx_num)); -+ #endif -+ } -+ } -+#endif /*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE))*/ -+ -+ //DbgPrint("isCCKrate = %d, pPhyInfo->RxPWDBAll = %d, pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a = 0x%x\n", -+ //isCCKrate, pPhyInfo->RxPWDBAll, pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a); -+ -+ //For 92C/92D HW (Hybrid) Antenna Diversity -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ //For 88E HW Antenna Diversity -+ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->ant_sel; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->ant_sel_b; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antsel_rx_keep_2; -+#endif -+} -+#endif -+ -+#if ODM_IC_11AC_SERIES_SUPPORT -+ -+VOID -+odm_RxPhyBWJaguarSeries_Parsing( -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN PODM_PACKET_INFO_T pPktinfo, -+ IN PPHY_STATUS_RPT_8812_T pPhyStaRpt -+) -+{ -+ -+ if(pPktinfo->DataRate <= ODM_RATE54M) { -+ switch (pPhyStaRpt->r_RFMOD) { -+ case 1: -+ if (pPhyStaRpt->sub_chnl == 0) -+ pPhyInfo->BandWidth = 1; -+ else -+ pPhyInfo->BandWidth = 0; -+ break; -+ -+ case 2: -+ if (pPhyStaRpt->sub_chnl == 0) -+ pPhyInfo->BandWidth = 2; -+ else if (pPhyStaRpt->sub_chnl == 9 || pPhyStaRpt->sub_chnl == 10) -+ pPhyInfo->BandWidth = 1; -+ else -+ pPhyInfo->BandWidth = 0; -+ break; -+ -+ default: -+ case 0: -+ pPhyInfo->BandWidth = 0; -+ break; -+ } -+ } -+ -+} -+ -+VOID -+odm_RxPhyStatusJaguarSeries_Parsing( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo -+) -+{ -+ u1Byte i, Max_spatial_stream; -+ s1Byte rx_pwr[4], rx_pwr_all = 0; -+ u1Byte EVM, EVMdbm, PWDB_ALL = 0, PWDB_ALL_BT; -+ u1Byte RSSI, avg_rssi = 0, best_rssi = 0, second_rssi = 0; -+ u1Byte isCCKrate = 0; -+ u1Byte rf_rx_num = 0; -+ u1Byte cck_highpwr = 0; -+ u1Byte LNA_idx, VGA_idx; -+ PPHY_STATUS_RPT_8812_T pPhyStaRpt = (PPHY_STATUS_RPT_8812_T)pPhyStatus; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ u1Byte num_ss; -+ -+ odm_RxPhyBWJaguarSeries_Parsing(pPhyInfo, pPktinfo, pPhyStaRpt); -+ -+ if (pPktinfo->DataRate <= ODM_RATE11M) -+ isCCKrate = TRUE; -+ else -+ isCCKrate = FALSE; -+ -+ if (pPktinfo->bToSelf) -+ pDM_Odm->curr_station_id = pPktinfo->StationID; -+ else -+ pDM_Odm->curr_station_id = 0xff; -+ -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_C] = -1; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_D] = -1; -+ -+ if (isCCKrate) { -+ u1Byte cck_agc_rpt; -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; -+ -+ /*(1)Hardware does not provide RSSI for CCK*/ -+ /*(2)PWDB, Average PWDB calculated by hardware (for rate adaptive)*/ -+ -+ /*if(pHalData->eRFPowerState == eRfOn)*/ -+ cck_highpwr = pDM_Odm->bCckHighPower; -+ /*else*/ -+ /*cck_highpwr = FALSE;*/ -+ -+ cck_agc_rpt = pPhyStaRpt->cfosho[0] ; -+ LNA_idx = ((cck_agc_rpt & 0xE0) >> 5); -+ VGA_idx = (cck_agc_rpt & 0x1F); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ switch (LNA_idx) { -+ case 7: -+ if (VGA_idx <= 27) -+ rx_pwr_all = -100 + 2 * (27 - VGA_idx); /*VGA_idx = 27~2*/ -+ else -+ rx_pwr_all = -100; -+ break; -+ case 6: -+ rx_pwr_all = -48 + 2 * (2 - VGA_idx); /*VGA_idx = 2~0*/ -+ break; -+ case 5: -+ rx_pwr_all = -42 + 2 * (7 - VGA_idx); /*VGA_idx = 7~5*/ -+ break; -+ case 4: -+ rx_pwr_all = -36 + 2 * (7 - VGA_idx); /*VGA_idx = 7~4*/ -+ break; -+ case 3: -+ /*rx_pwr_all = -28 + 2*(7-VGA_idx); VGA_idx = 7~0*/ -+ rx_pwr_all = -24 + 2 * (7 - VGA_idx); /*VGA_idx = 7~0*/ -+ break; -+ case 2: -+ if (cck_highpwr) -+ rx_pwr_all = -12 + 2 * (5 - VGA_idx); /*VGA_idx = 5~0*/ -+ else -+ rx_pwr_all = -6 + 2 * (5 - VGA_idx); -+ break; -+ case 1: -+ rx_pwr_all = 8 - 2 * VGA_idx; -+ break; -+ case 0: -+ rx_pwr_all = 14 - 2 * VGA_idx; -+ break; -+ default: -+ /*DbgPrint("CCK Exception default\n");*/ -+ break; -+ } -+ rx_pwr_all += 6; -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ -+ if (cck_highpwr == FALSE) { -+ if (PWDB_ALL >= 80) -+ PWDB_ALL = ((PWDB_ALL - 80) << 1) + ((PWDB_ALL - 80) >> 1) + 80; -+ else if ((PWDB_ALL <= 78) && (PWDB_ALL >= 20)) -+ PWDB_ALL += 3; -+ if (PWDB_ALL > 100) -+ PWDB_ALL = 100; -+ } -+ } else if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8881A)) { -+ s1Byte Pout = -6; -+ -+ switch (LNA_idx) { -+ case 5: -+ rx_pwr_all = Pout - 32 - (2 * VGA_idx); -+ break; -+ case 4: -+ rx_pwr_all = Pout - 24 - (2 * VGA_idx); -+ break; -+ case 2: -+ rx_pwr_all = Pout - 11 - (2 * VGA_idx); -+ break; -+ case 1: -+ rx_pwr_all = Pout + 5 - (2 * VGA_idx); -+ break; -+ case 0: -+ rx_pwr_all = Pout + 21 - (2 * VGA_idx); -+ break; -+ } -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ } else if (pDM_Odm->SupportICType == ODM_RTL8814A || pDM_Odm->SupportICType == ODM_RTL8822B) { -+ s1Byte Pout = -6; -+ -+ switch (LNA_idx) { -+ /*CCK only use LNA: 2, 3, 5, 7*/ -+ case 7: -+ rx_pwr_all = Pout - 32 - (2 * VGA_idx); -+ break; -+ case 5: -+ rx_pwr_all = Pout - 22 - (2 * VGA_idx); -+ break; -+ case 3: -+ rx_pwr_all = Pout - 2 - (2 * VGA_idx); -+ break; -+ case 2: -+ rx_pwr_all = Pout + 5 - (2 * VGA_idx); -+ break; -+ /*case 6:*/ -+ /*rx_pwr_all = Pout -26 - (2*VGA_idx);*/ -+ /*break;*/ -+ /*case 4:*/ -+ /*rx_pwr_all = Pout - 8 - (2*VGA_idx);*/ -+ /*break;*/ -+ /*case 1:*/ -+ /*rx_pwr_all = Pout + 21 - (2*VGA_idx);*/ -+ /*break;*/ -+ /*case 0:*/ -+ /*rx_pwr_all = Pout + 10 - (2*VGA_idx);*/ -+/* // break;*/ -+ default: -+/* //DbgPrint("CCK Exception default\n");*/ -+ break; -+ } -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ } -+ -+ pDM_Odm->cck_lna_idx = LNA_idx; -+ pDM_Odm->cck_vga_idx = VGA_idx; -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+/* //if(pPktinfo->StationID == 0)*/ -+/* //{*/ -+/* // DbgPrint("CCK: LNA_idx = %d, VGA_idx = %d, pPhyInfo->RxPWDBAll = %d\n",*/ -+/* // LNA_idx, VGA_idx, pPhyInfo->RxPWDBAll);*/ -+/* //}*/ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+#endif -+ /*(3) Get Signal Quality (EVM)*/ -+ /*if (pPktinfo->bPacketMatchBSSID)*/ -+ { -+ u1Byte SQ, SQ_rpt; -+ -+ if ((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID == RT_CID_819x_Lenovo)) { -+ SQ = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm, isCCKrate, PWDB_ALL, 0, 0); -+ } else if (pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest) { -+ SQ = 100; -+ } else { -+ SQ_rpt = pPhyStaRpt->pwdb_all; -+ -+ if (SQ_rpt > 64) -+ SQ = 0; -+ else if (SQ_rpt < 20) -+ SQ = 100; -+ else -+ SQ = ((64 - SQ_rpt) * 100) / 44; -+ } -+ -+/* //DbgPrint("cck SQ = %d\n", SQ);*/ -+ pPhyInfo->SignalQuality = SQ; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; -+ } -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { -+ if (i == 0) -+ pPhyInfo->RxMIMOSignalStrength[0] = PWDB_ALL; -+ else -+ pPhyInfo->RxMIMOSignalStrength[i] = 0; -+ } -+ } else { -+ /*is OFDM rate*/ -+ pDM_FatTable->hw_antsw_occur = pPhyStaRpt->hw_antsw_occur; -+ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; -+ -+ /*(1)Get RSSI for OFDM rate*/ -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { -+ /*2008/01/30 MH we will judge RF RX path now.*/ -+/* //DbgPrint("pDM_Odm->RFPathRxEnable = %x\n", pDM_Odm->RFPathRxEnable);*/ -+ if (pDM_Odm->RFPathRxEnable & BIT(i)) -+ rf_rx_num++; -+/* //else*/ -+/* //continue;*/ -+ /*2012.05.25 LukeLee: Testchip AGC report is wrong, it should be restored back to old formula in MP chip*/ -+/* //if((pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) && (!pDM_Odm->bIsMPChip))*/ -+ if (i < ODM_RF_PATH_C) -+ rx_pwr[i] = (pPhyStaRpt->gain_trsw[i] & 0x7F) - 110; -+ else -+ rx_pwr[i] = (pPhyStaRpt->gain_trsw_cd[i - 2] & 0x7F) - 110; -+/* //else*/ -+ /*rx_pwr[i] = ((pPhyStaRpt->gain_trsw[i]& 0x3F)*2) - 110; OLD FORMULA*/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->RxPwr[i] = rx_pwr[i]; -+#endif -+ -+ /* Translate DBM to percentage. */ -+ RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); -+ -+ /*total_rssi += RSSI;*/ -+ /*Get the best two RSSI*/ -+ if (RSSI > best_rssi && RSSI > second_rssi) { -+ second_rssi = best_rssi; -+ best_rssi = RSSI; -+ } else if (RSSI > second_rssi && RSSI <= best_rssi) -+ second_rssi = RSSI; -+ -+ /*RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR=%x RSSI=%d\n", i, rx_pwr[i], RSSI));*/ -+ -+ pPhyInfo->RxMIMOSignalStrength[i] = (u1Byte) RSSI; -+ -+ -+ /*Get Rx snr value in DB*/ -+ if (i < ODM_RF_PATH_C) -+ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = pPhyStaRpt->rxsnr[i] / 2; -+ else if (pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B)) -+ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = pPhyStaRpt->csi_current[i - 2] / 2; -+ -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ /*(2) CFO_short & CFO_tail*/ -+ if (i < ODM_RF_PATH_C) { -+ pPhyInfo->Cfo_short[i] = odm_Cfo((pPhyStaRpt->cfosho[i])); -+ pPhyInfo->Cfo_tail[i] = odm_Cfo((pPhyStaRpt->cfotail[i])); -+ } -+#endif -+ /* Record Signal Strength for next packet */ -+ if (pPktinfo->bPacketMatchBSSID) { -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if ((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID == RT_CID_819x_Lenovo)) { -+ if (i == ODM_RF_PATH_A) -+ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm, isCCKrate, PWDB_ALL, i, RSSI); -+ -+ } -+#endif -+ } -+ } -+ -+ /*(3)PWDB, Average PWDB calculated by hardware (for rate adaptive)*/ -+ -+ /*2012.05.25 LukeLee: Testchip AGC report is wrong, it should be restored back to old formula in MP chip*/ -+ if ((pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) && (!pDM_Odm->bIsMPChip)) -+ rx_pwr_all = (pPhyStaRpt->pwdb_all & 0x7f) - 110; -+ else -+ rx_pwr_all = (((pPhyStaRpt->pwdb_all) >> 1) & 0x7f) - 110; /*OLD FORMULA*/ -+ -+ PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ODM OFDM RSSI=%d\n",pPhyInfo->RxPWDBAll));*/ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; -+ pPhyInfo->RxPower = rx_pwr_all; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+#endif -+ -+ if ((pDM_Odm->SupportPlatform == ODM_WIN) && (pDM_Odm->PatchID == 19)) { -+ /*do nothing*/ -+ } else { -+ /*pMgntInfo->CustomerID != RT_CID_819x_Lenovo*/ -+ -+ /*(4)EVM of OFDM rate*/ -+ -+ if ((pPktinfo->DataRate >= ODM_RATEMCS8) && -+ (pPktinfo->DataRate <= ODM_RATEMCS15)) -+ Max_spatial_stream = 2; -+ else if ((pPktinfo->DataRate >= ODM_RATEVHTSS2MCS0) && -+ (pPktinfo->DataRate <= ODM_RATEVHTSS2MCS9)) -+ Max_spatial_stream = 2; -+ else if ((pPktinfo->DataRate >= ODM_RATEMCS16) && -+ (pPktinfo->DataRate <= ODM_RATEMCS23)) -+ Max_spatial_stream = 3; -+ else if ((pPktinfo->DataRate >= ODM_RATEVHTSS3MCS0) && -+ (pPktinfo->DataRate <= ODM_RATEVHTSS3MCS9)) -+ Max_spatial_stream = 3; -+ else -+ Max_spatial_stream = 1; -+ -+ /*if (pPktinfo->bPacketMatchBSSID) */ -+ { -+ /*DbgPrint("pPktinfo->DataRate = %d\n", pPktinfo->DataRate);*/ -+ -+ for (i = 0; i < Max_spatial_stream; i++) { -+ /*Do not use shift operation like "rx_evmX >>= 1" because the compilor of free build environment*/ -+ /*fill most significant bit to "zero" when doing shifting operation which may change a negative*/ -+ /*value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore.*/ -+ -+ if (pPktinfo->DataRate >= ODM_RATE6M && pPktinfo->DataRate <= ODM_RATE54M) { -+ if (i == ODM_RF_PATH_A) { -+ EVM = odm_EVMdbToPercentage((pPhyStaRpt->sigevm)); /*dbm*/ -+ EVM += 20; -+ if (EVM > 100) -+ EVM = 100; -+ } -+ } else { -+ if (i < ODM_RF_PATH_C) { -+ if (pPhyStaRpt->rxevm[i] == -128) -+ pPhyStaRpt->rxevm[i] = -25; -+ EVM = odm_EVMdbToPercentage((pPhyStaRpt->rxevm[i])); /*dbm*/ -+ } else { -+ if (pPhyStaRpt->rxevm_cd[i - 2] == -128){ -+ pPhyStaRpt->rxevm_cd[i - 2] = -25; -+ } -+ EVM = odm_EVMdbToPercentage((pPhyStaRpt->rxevm_cd[i - 2])); /*dbm*/ -+ } -+ } -+ -+ if (i < ODM_RF_PATH_C) -+ EVMdbm = odm_EVMdbm_JaguarSeries(pPhyStaRpt->rxevm[i]); -+ else -+ EVMdbm = odm_EVMdbm_JaguarSeries(pPhyStaRpt->rxevm_cd[i - 2]); -+ /*RT_DISP(FRX, RX_PHY_SQ, ("RXRATE=%x RXEVM=%x EVM=%s%d\n",*/ -+ /*pPktinfo->DataRate, pPhyStaRpt->rxevm[i], "%", EVM));*/ -+ -+ { -+ if (i == ODM_RF_PATH_A) { -+ /*Fill value in RFD, Get the first spatial stream only*/ -+ pPhyInfo->SignalQuality = EVM; -+ } -+ pPhyInfo->RxMIMOSignalQuality[i] = EVM; -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ pPhyInfo->RxMIMOEVMdbm[i] = EVMdbm; -+#endif -+ } -+ } -+ } -+ } -+ -+ num_ss =phydm_rate_to_num_ss(pDM_Odm, pPktinfo->DataRate ); -+ ODM_ParsingCFO(pDM_Odm, pPktinfo, pPhyStaRpt->cfotail, num_ss); -+ -+ } -+/* //DbgPrint("isCCKrate= %d, pPhyInfo->SignalStrength=%d % PWDB_AL=%d rf_rx_num=%d\n", isCCKrate, pPhyInfo->SignalStrength, PWDB_ALL, rf_rx_num);*/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ /*UI BSS List signal strength(in percentage), make it good looking, from 0~100.*/ -+ /*It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp().*/ -+ if (isCCKrate) { -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ /*2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/*/ -+ pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, PWDB_ALL, FALSE, TRUE); -+#else -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));/*PWDB_ALL;*/ -+#endif -+ } else { -+ if (rf_rx_num != 0) { -+ /* 2015/01 Sean, use the best two RSSI only, suggested by Ynlin and ChenYu.*/ -+ if (rf_rx_num == 1) -+ avg_rssi = best_rssi; -+ else -+ avg_rssi = (best_rssi + second_rssi)/2; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ /* 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/*/ -+ pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, avg_rssi, FALSE, FALSE); -+#else -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, avg_rssi)); -+#endif -+ } -+ } -+#endif -+ pDM_Odm->RxPWDBAve = pDM_Odm->RxPWDBAve + pPhyInfo->RxPWDBAll; -+ -+ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->antidx_anta; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->antidx_antb; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antidx_antc; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_3 = pPhyStaRpt->antidx_antd; -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antidx_anta = ((%d)), MatchBSSID = ((%d))\n", pPktinfo->StationID, pPhyStaRpt->antidx_anta, pPktinfo->bPacketMatchBSSID));*/ -+ -+ -+/* DbgPrint("pPhyStaRpt->antidx_anta = %d, pPhyStaRpt->antidx_antb = %d\n",*/ -+/* pPhyStaRpt->antidx_anta, pPhyStaRpt->antidx_antb);*/ -+/* DbgPrint("----------------------------\n");*/ -+/* DbgPrint("pPktinfo->StationID=%d, pPktinfo->DataRate=0x%x\n",pPktinfo->StationID, pPktinfo->DataRate);*/ -+/* DbgPrint("pPhyStaRpt->r_RFMOD = %d\n", pPhyStaRpt->r_RFMOD);*/ -+/* DbgPrint("pPhyStaRpt->gain_trsw[0]=0x%x, pPhyStaRpt->gain_trsw[1]=0x%x\n",*/ -+/* pPhyStaRpt->gain_trsw[0],pPhyStaRpt->gain_trsw[1]);*/ -+/* DbgPrint("pPhyStaRpt->gain_trsw[2]=0x%x, pPhyStaRpt->gain_trsw[3]=0x%x\n",*/ -+/* pPhyStaRpt->gain_trsw_cd[0],pPhyStaRpt->gain_trsw_cd[1]);*/ -+/* DbgPrint("pPhyStaRpt->pwdb_all = 0x%x, pPhyInfo->RxPWDBAll = %d\n", pPhyStaRpt->pwdb_all, pPhyInfo->RxPWDBAll);*/ -+/* DbgPrint("pPhyStaRpt->cfotail[i] = 0x%x, pPhyStaRpt->CFO_tail[i] = 0x%x\n", pPhyStaRpt->cfotail[0], pPhyStaRpt->cfotail[1]);*/ -+/* DbgPrint("pPhyStaRpt->rxevm[0] = %d, pPhyStaRpt->rxevm[1] = %d\n", pPhyStaRpt->rxevm[0], pPhyStaRpt->rxevm[1]);*/ -+/* DbgPrint("pPhyStaRpt->rxevm[2] = %d, pPhyStaRpt->rxevm[3] = %d\n", pPhyStaRpt->rxevm_cd[0], pPhyStaRpt->rxevm_cd[1]);*/ -+/* DbgPrint("pPhyInfo->RxMIMOSignalStrength[0]=%d, pPhyInfo->RxMIMOSignalStrength[1]=%d, RxPWDBAll=%d\n",*/ -+/* pPhyInfo->RxMIMOSignalStrength[0], pPhyInfo->RxMIMOSignalStrength[1], pPhyInfo->RxPWDBAll);*/ -+/* DbgPrint("pPhyInfo->RxMIMOSignalStrength[2]=%d, pPhyInfo->RxMIMOSignalStrength[3]=%d\n",*/ -+/* pPhyInfo->RxMIMOSignalStrength[2], pPhyInfo->RxMIMOSignalStrength[3]);*/ -+/* DbgPrint("ppPhyInfo->RxMIMOSignalQuality[0]=%d, pPhyInfo->RxMIMOSignalQuality[1]=%d\n",*/ -+/* pPhyInfo->RxMIMOSignalQuality[0], pPhyInfo->RxMIMOSignalQuality[1]);*/ -+/* DbgPrint("ppPhyInfo->RxMIMOSignalQuality[2]=%d, pPhyInfo->RxMIMOSignalQuality[3]=%d\n",*/ -+/* pPhyInfo->RxMIMOSignalQuality[2], pPhyInfo->RxMIMOSignalQuality[3]);*/ -+ -+} -+ -+#endif -+ -+VOID -+phydm_reset_rssi_for_dm( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN u1Byte station_id -+ ) -+{ -+ PSTA_INFO_T pEntry; -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ #endif -+ -+ pEntry = pDM_Odm->pODM_StaInfo[station_id]; -+ -+ if (!IS_STA_VALID(pEntry)) { -+ /**/ -+ return; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("Reset RSSI for macid = (( %d ))\n", station_id)); -+ -+ -+ pEntry->rssi_stat.UndecoratedSmoothedCCK = -1; -+ pEntry->rssi_stat.UndecoratedSmoothedOFDM = -1; -+ pEntry->rssi_stat.UndecoratedSmoothedPWDB = -1; -+ pEntry->rssi_stat.OFDM_pkt = 0; -+ pEntry->rssi_stat.CCK_pkt = 0; -+ pEntry->rssi_stat.CCK_sum_power = 0; -+ pEntry->rssi_stat.bsend_rssi = RA_RSSI_STATE_INIT; -+ pEntry->rssi_stat.PacketMap = 0; -+ pEntry->rssi_stat.ValidBit = 0; -+ -+ /*in WIN Driver: sta_ID==0 -> pEntry==NULL -> default port HAL_Data*/ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ pEntry->bUsed = 0; -+ if (station_id == 0) { -+ -+ pHalData->UndecoratedSmoothedPWDB = -1; -+ /**/ -+ } -+ #endif -+ -+} -+ -+VOID -+odm_Init_RSSIForDM( -+ IN OUT PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+} -+ -+VOID -+odm_Process_RSSIForDM( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ -+ s4Byte UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK, UndecoratedSmoothedOFDM, RSSI_Ave, CCK_pkt; -+ u1Byte i, isCCKrate=0; -+ u1Byte RSSI_max, RSSI_min; -+ u4Byte Weighting=0; -+ u1Byte send_rssi_2_fw = 0; -+ PSTA_INFO_T pEntry; -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ #endif -+ -+ if (pPktinfo->StationID >= ODM_ASSOCIATE_ENTRY_NUM) -+ return; -+ -+ #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY -+ odm_S0S1_SwAntDivByCtrlFrame_ProcessRSSI(pDM_Odm, pPhyInfo, pPktinfo); -+ #endif -+ -+ // -+ // 2012/05/30 MH/Luke.Lee Add some description -+ // In windows driver: AP/IBSS mode STA -+ // -+ //if (pDM_Odm->SupportPlatform == ODM_WIN) -+ //{ -+ // pEntry = pDM_Odm->pODM_StaInfo[pDM_Odm->pAidMap[pPktinfo->StationID-1]]; -+ //} -+ //else -+ pEntry = pDM_Odm->pODM_StaInfo[pPktinfo->StationID]; -+ -+ if (!IS_STA_VALID(pEntry)) { -+ return; -+ /**/ -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ if ((pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) && -+ (pDM_FatTable->enable_ctrl_frame_antdiv) -+ ) -+ { -+ if (pPktinfo->bPacketMatchBSSID) -+ pDM_Odm->data_frame_num++; -+ -+ if ((pDM_FatTable->use_ctrl_frame_antdiv)) { -+ if (!pPktinfo->bToSelf)/*data frame + CTRL frame*/ -+ return; -+ } else { -+ if ((!pPktinfo->bPacketMatchBSSID))/*data frame only*/ -+ return; -+ } -+ } else -+#endif -+ { -+ if ((!pPktinfo->bPacketMatchBSSID))/*data frame only*/ -+ return; -+ } -+ -+ if(pPktinfo->bPacketBeacon) -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt++; -+ -+ isCCKrate = (pPktinfo->DataRate <= ODM_RATE11M )?TRUE :FALSE; -+ pDM_Odm->RxRate = pPktinfo->DataRate; -+ -+ //--------------Statistic for antenna/path diversity------------------ -+ if(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) -+ { -+ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ ODM_Process_RSSIForAntDiv(pDM_Odm,pPhyInfo,pPktinfo); -+ #endif -+ } -+ #if(defined(CONFIG_PATH_DIVERSITY)) -+ else if(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV) -+ { -+ phydm_process_rssi_for_path_div(pDM_Odm,pPhyInfo,pPktinfo); -+ } -+ #endif -+ //-----------------Smart Antenna Debug Message------------------// -+ -+ UndecoratedSmoothedCCK = pEntry->rssi_stat.UndecoratedSmoothedCCK; -+ UndecoratedSmoothedOFDM = pEntry->rssi_stat.UndecoratedSmoothedOFDM; -+ UndecoratedSmoothedPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon) -+ { -+ -+ if(!isCCKrate)//ofdm rate -+ { -+#if (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B)) { -+ u1Byte RX_count = 0; -+ u4Byte RSSI_linear = 0; -+ -+ if (pDM_Odm->RXAntStatus & ODM_RF_A) { -+ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ RX_count++; -+ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]); -+ } else -+ pDM_Odm->RSSI_A = 0; -+ -+ if (pDM_Odm->RXAntStatus & ODM_RF_B) { -+ pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ RX_count++; -+ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]); -+ } else -+ pDM_Odm->RSSI_B = 0; -+ -+ if (pDM_Odm->RXAntStatus & ODM_RF_C) { -+ pDM_Odm->RSSI_C = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_C]; -+ RX_count++; -+ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_C]); -+ } else -+ pDM_Odm->RSSI_C = 0; -+ -+ if (pDM_Odm->RXAntStatus & ODM_RF_D) { -+ pDM_Odm->RSSI_D = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_D]; -+ RX_count++; -+ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_D]); -+ } else -+ pDM_Odm->RSSI_D = 0; -+ -+ /* Calculate average RSSI */ -+ switch (RX_count) { -+ case 2: -+ RSSI_linear = (RSSI_linear >> 1); -+ break; -+ case 3: -+ RSSI_linear = ((RSSI_linear) + (RSSI_linear << 1) + (RSSI_linear << 3)) >> 5; /* RSSI_linear/3 ~ RSSI_linear*11/32 */ -+ break; -+ case 4: -+ RSSI_linear = (RSSI_linear >> 2); -+ break; -+ } -+ RSSI_Ave = odm_ConvertTo_dB(RSSI_linear); -+ } else -+#endif -+ { -+ if (pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B] == 0) { -+ RSSI_Ave = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_B = 0; -+ } else { -+ /*DbgPrint("pRfd->Status.RxMIMOSignalStrength[0] = %d, pRfd->Status.RxMIMOSignalStrength[1] = %d\n",*/ -+ /*pRfd->Status.RxMIMOSignalStrength[0], pRfd->Status.RxMIMOSignalStrength[1]);*/ -+ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ -+ if (pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A] > pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]) { -+ RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ } else { -+ RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ } -+ if ((RSSI_max - RSSI_min) < 3) -+ RSSI_Ave = RSSI_max; -+ else if ((RSSI_max - RSSI_min) < 6) -+ RSSI_Ave = RSSI_max - 1; -+ else if ((RSSI_max - RSSI_min) < 10) -+ RSSI_Ave = RSSI_max - 2; -+ else -+ RSSI_Ave = RSSI_max - 3; -+ } -+ } -+ -+ //1 Process OFDM RSSI -+ if(UndecoratedSmoothedOFDM <= 0) // initialize -+ { -+ UndecoratedSmoothedOFDM = pPhyInfo->RxPWDBAll; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("OFDM_INIT: (( %d ))\n", UndecoratedSmoothedOFDM)); -+ } -+ else -+ { -+ if(pPhyInfo->RxPWDBAll > (u4Byte)UndecoratedSmoothedOFDM) -+ { -+ UndecoratedSmoothedOFDM = -+ ( ((UndecoratedSmoothedOFDM)*(Rx_Smooth_Factor-1)) + -+ (RSSI_Ave)) /(Rx_Smooth_Factor); -+ UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM + 1; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("OFDM_1: (( %d ))\n", UndecoratedSmoothedOFDM)); -+ } -+ else -+ { -+ UndecoratedSmoothedOFDM = -+ ( ((UndecoratedSmoothedOFDM)*(Rx_Smooth_Factor-1)) + -+ (RSSI_Ave)) /(Rx_Smooth_Factor); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("OFDM_2: (( %d ))\n", UndecoratedSmoothedOFDM)); -+ } -+ } -+ if (pEntry->rssi_stat.OFDM_pkt != 64) { -+ i = 63; -+ pEntry->rssi_stat.OFDM_pkt -= (u1Byte)(((pEntry->rssi_stat.PacketMap>>i)&BIT0)-1); -+ } -+ pEntry->rssi_stat.PacketMap = (pEntry->rssi_stat.PacketMap<<1) | BIT0; -+ -+ } -+ else -+ { -+ RSSI_Ave = pPhyInfo->RxPWDBAll; -+ pDM_Odm->RSSI_A = (u1Byte) pPhyInfo->RxPWDBAll; -+ pDM_Odm->RSSI_B = 0xFF; -+ pDM_Odm->RSSI_C = 0xFF; -+ pDM_Odm->RSSI_D = 0xFF; -+ -+ if (pEntry->rssi_stat.CCK_pkt <= 63) -+ pEntry->rssi_stat.CCK_pkt++; -+ -+ //1 Process CCK RSSI -+ if(UndecoratedSmoothedCCK <= 0) // initialize -+ { -+ UndecoratedSmoothedCCK = pPhyInfo->RxPWDBAll; -+ pEntry->rssi_stat.CCK_sum_power = (u2Byte)pPhyInfo->RxPWDBAll ; /*reset*/ -+ pEntry->rssi_stat.CCK_pkt = 1; /*reset*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_INIT: (( %d ))\n", UndecoratedSmoothedCCK)); -+ } else if (pEntry->rssi_stat.CCK_pkt <= CCK_RSSI_INIT_COUNT) { -+ -+ pEntry->rssi_stat.CCK_sum_power = pEntry->rssi_stat.CCK_sum_power + (u2Byte)pPhyInfo->RxPWDBAll; -+ UndecoratedSmoothedCCK = pEntry->rssi_stat.CCK_sum_power/pEntry->rssi_stat.CCK_pkt; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_0: (( %d )), SumPow = (( %d )), CCK_pkt = (( %d ))\n", -+ UndecoratedSmoothedCCK, pEntry->rssi_stat.CCK_sum_power, pEntry->rssi_stat.CCK_pkt)); -+ } -+ else -+ { -+ if(pPhyInfo->RxPWDBAll > (u4Byte)UndecoratedSmoothedCCK) -+ { -+ UndecoratedSmoothedCCK = -+ ( ((UndecoratedSmoothedCCK)*(Rx_Smooth_Factor-1)) + -+ (pPhyInfo->RxPWDBAll)) /(Rx_Smooth_Factor); -+ UndecoratedSmoothedCCK = UndecoratedSmoothedCCK + 1; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_1: (( %d ))\n", UndecoratedSmoothedCCK)); -+ } -+ else -+ { -+ UndecoratedSmoothedCCK = -+ ( ((UndecoratedSmoothedCCK)*(Rx_Smooth_Factor-1)) + -+ (pPhyInfo->RxPWDBAll)) /(Rx_Smooth_Factor); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_2: (( %d ))\n", UndecoratedSmoothedCCK)); -+ } -+ } -+ i = 63; -+ pEntry->rssi_stat.OFDM_pkt -= (u1Byte)((pEntry->rssi_stat.PacketMap>>i)&BIT0); -+ pEntry->rssi_stat.PacketMap = pEntry->rssi_stat.PacketMap<<1; -+ } -+ -+ //if(pEntry) -+ { -+ //2011.07.28 LukeLee: modified to prevent unstable CCK RSSI -+ if (pEntry->rssi_stat.OFDM_pkt == 64) { /* speed up when all packets are OFDM*/ -+ UndecoratedSmoothedPWDB = UndecoratedSmoothedOFDM; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("PWDB_0[%d] = (( %d ))\n", pPktinfo->StationID, UndecoratedSmoothedCCK)); -+ } else { -+ if (pEntry->rssi_stat.ValidBit < 64) -+ pEntry->rssi_stat.ValidBit++; -+ -+ if (pEntry->rssi_stat.ValidBit == 64) { -+ Weighting = ((pEntry->rssi_stat.OFDM_pkt) > 4) ? 64 : (pEntry->rssi_stat.OFDM_pkt<<4); -+ UndecoratedSmoothedPWDB = (Weighting*UndecoratedSmoothedOFDM+(64-Weighting)*UndecoratedSmoothedCCK)>>6; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("PWDB_1[%d] = (( %d )), W = (( %d ))\n", pPktinfo->StationID, UndecoratedSmoothedCCK, Weighting)); -+ } else { -+ if (pEntry->rssi_stat.ValidBit != 0) -+ UndecoratedSmoothedPWDB = (pEntry->rssi_stat.OFDM_pkt*UndecoratedSmoothedOFDM+(pEntry->rssi_stat.ValidBit-pEntry->rssi_stat.OFDM_pkt)*UndecoratedSmoothedCCK)/pEntry->rssi_stat.ValidBit; -+ else -+ UndecoratedSmoothedPWDB = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("PWDB_2[%d] = (( %d )), OFDM_pkt = (( %d )), Valid_Bit = (( %d ))\n", pPktinfo->StationID, UndecoratedSmoothedCCK, pEntry->rssi_stat.OFDM_pkt, pEntry->rssi_stat.ValidBit)); -+ } -+ } -+ -+ -+ if ((pEntry->rssi_stat.OFDM_pkt >= 1 || pEntry->rssi_stat.CCK_pkt >= 5) && (pEntry->rssi_stat.bsend_rssi == RA_RSSI_STATE_INIT)) { -+ -+ send_rssi_2_fw = 1; -+ pEntry->rssi_stat.bsend_rssi = RA_RSSI_STATE_SEND; -+ } -+ -+ pEntry->rssi_stat.UndecoratedSmoothedCCK = UndecoratedSmoothedCCK; -+ pEntry->rssi_stat.UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM; -+ pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; -+ -+ -+ -+ if (send_rssi_2_fw) /* Trigger init rate by RSSI */ { -+ -+ if (pEntry->rssi_stat.OFDM_pkt != 0) -+ pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedOFDM; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("[Send to FW] PWDB = (( %d )), OFDM_pkt = (( %d )), CCK_pkt = (( %d ))\n", -+ UndecoratedSmoothedPWDB, pEntry->rssi_stat.OFDM_pkt, pEntry->rssi_stat.CCK_pkt)); -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ phydm_ra_rssi_rpt_wk(pDM_Odm); -+ #endif -+ } -+ -+ -+ /*in WIN Driver: sta_ID==0 -> pEntry==NULL -> default port HAL_Data*/ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+ if (pPktinfo->StationID == 0) { -+ /**/ -+ pHalData->UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; -+ } -+ #endif -+ -+ //DbgPrint("OFDM_pkt=%d, Weighting=%d\n", OFDM_pkt, Weighting); -+ //DbgPrint("UndecoratedSmoothedOFDM=%d, UndecoratedSmoothedPWDB=%d, UndecoratedSmoothedCCK=%d\n", -+ // UndecoratedSmoothedOFDM, UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK); -+ -+ } -+ -+ } -+} -+ -+ -+#if(ODM_IC_11N_SERIES_SUPPORT ==1) -+// -+// Endianness before calling this API -+// -+VOID -+ODM_PhyStatusQuery_92CSeries( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ odm_RxPhyStatus92CSeries_Parsing(pDM_Odm, pPhyInfo, pPhyStatus, pPktinfo); -+ odm_Process_RSSIForDM(pDM_Odm, pPhyInfo, pPktinfo); -+} -+#endif -+ -+ -+// -+// Endianness before calling this API -+// -+#if ODM_IC_11AC_SERIES_SUPPORT -+ -+VOID -+ODM_PhyStatusQuery_JaguarSeries( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ odm_RxPhyStatusJaguarSeries_Parsing(pDM_Odm, pPhyInfo, pPhyStatus, pPktinfo); -+ odm_Process_RSSIForDM(pDM_Odm, pPhyInfo, pPktinfo); -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ /*phydm_sbd_check(pDM_Odm);*/ -+ #endif -+} -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+phydm_normal_driver_rx_sniffer( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN pu1Byte pDesc, -+ IN PRT_RFD_STATUS pRtRfdStatus, -+ IN pu1Byte pDrvInfo, -+ IN u1Byte PHYStatus -+ ) -+{ -+ #if (defined(CONFIG_PHYDM_RX_SNIFFER_PARSING)) -+ u4Byte *pMsg; -+ u2Byte seq_num; -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ -+ if (pRtRfdStatus->PacketReportType != NORMAL_RX) -+ return; -+ -+ if (!pDM_Odm->bLinked) { -+ if (pRtRfdStatus->bHwError) -+ return; -+ } -+ -+ if (!(pDM_FatTable->FAT_State == FAT_TRAINING_STATE)) -+ return; -+ -+ if (PHYStatus == TRUE) { -+ -+ if ((pDM_Odm->rx_pkt_type == Type_BlockAck) || (pDM_Odm->rx_pkt_type == Type_RTS) || (pDM_Odm->rx_pkt_type == Type_CTS)) -+ seq_num = 0; -+ else -+ seq_num = pRtRfdStatus->Seq_Num; -+ -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, ("%04d , %01s , Rate=0x%02x , L=%04d , %s , %s", -+ seq_num, -+ /*pRtRfdStatus->MacID,*/ -+ ((pRtRfdStatus->bCRC) ? "C" : (pRtRfdStatus->bIsAMPDU) ? "A" : "_"), -+ pRtRfdStatus->DataRate, -+ pRtRfdStatus->Length, -+ ((pRtRfdStatus->BandWidth == 0) ? "20M":((pRtRfdStatus->BandWidth == 1) ? "40M" : "80M")), -+ ((pRtRfdStatus->bLDPC) ? "LDP" : "BCC") -+ )); -+ -+ if (pDM_Odm->rx_pkt_type == Type_Asoc_Req) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "AS_REQ")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_Asoc_Rsp) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "AS_RSP")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_Probe_Req) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "PR_REQ")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_Probe_Rsp) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "PR_RSP")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_Deauth) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "DEAUTH")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_Beacon) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "BEACON")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_BlockAckReq) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "BA_REQ")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_RTS) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__RTS_")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_CTS) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__CTS_")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_Ack) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__ACK_")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_BlockAck) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__BA__")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_Data) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "_DATA_")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_Data_Ack) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "Data_Ack")); -+ /**/ -+ } else if (pDM_Odm->rx_pkt_type == Type_QosData) { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "QoS_Data")); -+ /**/ -+ } else { -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [0x%x]", pDM_Odm->rx_pkt_type)); -+ /**/ -+ } -+ -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [RSSI=%d,%d,%d,%d ]", -+ pDM_Odm->RSSI_A, -+ pDM_Odm->RSSI_B, -+ pDM_Odm->RSSI_C, -+ pDM_Odm->RSSI_D -+ )); -+ -+ pMsg = (pu4Byte)pDrvInfo; -+ -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , P-STS[28:0]=%08x-%08x-%08x-%08x-%08x-%08x-%08x\n", -+ pMsg[6], pMsg[5], pMsg[4], pMsg[3], pMsg[2], pMsg[1], pMsg[1])); -+ } else { -+ -+ ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, ("%04d , %01s , Rate=0x%02x , L=%04d , %s , %s\n", -+ pRtRfdStatus->Seq_Num, -+ /*pRtRfdStatus->MacID,*/ -+ ((pRtRfdStatus->bCRC) ? "C" : (pRtRfdStatus->bIsAMPDU) ? "A" : "_"), -+ pRtRfdStatus->DataRate, -+ pRtRfdStatus->Length, -+ ((pRtRfdStatus->BandWidth == 0) ? "20M" : ((pRtRfdStatus->BandWidth == 1) ? "40M" : "80M")), -+ ((pRtRfdStatus->bLDPC) ? "LDP" : "BCC") -+ )); -+ } -+ -+ -+ #endif -+} -+#endif -+ -+VOID -+ODM_PhyStatusQuery( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) { -+ phydm_RxPhyStatusNewType(pDM_Odm, pPhyStatus, pPktinfo, pPhyInfo); -+ return; -+ } -+#endif -+ -+#if ODM_IC_11AC_SERIES_SUPPORT -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ ODM_PhyStatusQuery_JaguarSeries(pDM_Odm, pPhyInfo, pPhyStatus, pPktinfo); -+#endif -+ -+#if ODM_IC_11N_SERIES_SUPPORT -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES ) -+ ODM_PhyStatusQuery_92CSeries(pDM_Odm,pPhyInfo,pPhyStatus,pPktinfo); -+#endif -+} -+ -+// For future use. -+VOID -+ODM_MacStatusQuery( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN pu1Byte pMacStatus, -+ IN u1Byte MacID, -+ IN BOOLEAN bPacketMatchBSSID, -+ IN BOOLEAN bPacketToSelf, -+ IN BOOLEAN bPacketBeacon -+ ) -+{ -+ // 2011/10/19 Driver team will handle in the future. -+ -+} -+ -+ -+// -+// If you want to add a new IC, Please follow below template and generate a new one. -+// -+// -+ -+HAL_STATUS -+ODM_ConfigRFWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_Config_Type ConfigType, -+ IN ODM_RF_RADIO_PATH_E eRFPath -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigRFWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ -+//1 AP doesn't use PHYDM power tracking table in these ICs -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A){ -+ READ_AND_CONFIG_MP(8812A,_RadioA); -+ } -+ else if(eRFPath == ODM_RF_PATH_B){ -+ READ_AND_CONFIG_MP(8812A,_RadioB); -+ } -+ } -+ else if(ConfigType == CONFIG_RF_TXPWR_LMT) { -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) && (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ if ((pHalData->EEPROMSVID == 0x17AA && pHalData->EEPROMSMID == 0xA811) || -+ (pHalData->EEPROMSVID == 0x10EC && pHalData->EEPROMSMID == 0xA812) || -+ (pHalData->EEPROMSVID == 0x10EC && pHalData->EEPROMSMID == 0x8812)) -+ READ_AND_CONFIG_MP(8812A,_TXPWR_LMT_HM812A03); -+ else -+ #endif -+ READ_AND_CONFIG_MP(8812A,_TXPWR_LMT); -+ } -+ } -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A){ -+ READ_AND_CONFIG_MP(8821A,_RadioA); -+ } -+ } -+ else if(ConfigType == CONFIG_RF_TXPWR_LMT) { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { -+ if (pDM_Odm->ExtPA5G || pDM_Odm->ExtLNA5G) -+ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8811AU_FEM); -+ else -+ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8811AU_IPA); -+ } -+ else { -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (pMgntInfo->CustomerID == RT_CID_8821AE_ASUS_MB) -+ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8821A_SAR_8mm); -+ else if (pMgntInfo->CustomerID == RT_CID_ASUS_NB) -+ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8821A_SAR_5mm); -+ else -+ #endif -+ READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8821A); -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigRFWithHeaderFile\n")); -+ } -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8192E,_RadioA); -+ else if(eRFPath == ODM_RF_PATH_B) -+ READ_AND_CONFIG_MP(8192E,_RadioB); -+ } else if (ConfigType == CONFIG_RF_TXPWR_LMT) { -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) && (DEV_BUS_TYPE == RT_PCI_INTERFACE) /*Refine by Vincent Lan for 5mm SAR pwr limit*/ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if ((pHalData->EEPROMSVID == 0x11AD && pHalData->EEPROMSMID == 0x8192) || -+ (pHalData->EEPROMSVID == 0x11AD && pHalData->EEPROMSMID == 0x8193)) -+ READ_AND_CONFIG_MP(8192E, _TXPWR_LMT_8192E_SAR_5mm); -+ else -+#endif -+ READ_AND_CONFIG_MP(8192E, _TXPWR_LMT); -+ } -+ } -+#endif -+#if (RTL8723D_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ if (ConfigType == CONFIG_RF_RADIO) { -+ if (eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8723D, _RadioA); -+ } else if (ConfigType == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8723D, _TXPWR_LMT); -+ } -+#endif -+#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+//1 All platforms support -+#if (RTL8188E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8188E,_RadioA); -+ } -+ else if(ConfigType == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8188E,_TXPWR_LMT); -+ } -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+ if (ConfigType == CONFIG_RF_RADIO) -+ READ_AND_CONFIG_MP(8723B, _RadioA); -+ else if (ConfigType == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8723B, _TXPWR_LMT); -+ } -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8814A,_RadioA); -+ else if(eRFPath == ODM_RF_PATH_B) -+ READ_AND_CONFIG_MP(8814A,_RadioB); -+ else if(eRFPath == ODM_RF_PATH_C) -+ READ_AND_CONFIG_MP(8814A,_RadioC); -+ else if(eRFPath == ODM_RF_PATH_D) -+ READ_AND_CONFIG_MP(8814A,_RadioD); -+ } -+ else if(ConfigType == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8814A,_TXPWR_LMT); -+ } -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) { -+ if (ConfigType == CONFIG_RF_RADIO) { -+ if (eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8703B, _RadioA); -+ } -+ } -+#endif -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ if (ConfigType == CONFIG_RF_RADIO) { -+ if (eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8188F, _RadioA); -+ } else if (ConfigType == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG_MP(8188F, _TXPWR_LMT); -+ } -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) { -+ if (ConfigType == CONFIG_RF_RADIO) { -+ if (eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8822B, _RadioA); -+ else if (eRFPath == ODM_RF_PATH_B) -+ READ_AND_CONFIG_MP(8822B, _RadioB); -+ } else if(ConfigType == CONFIG_RF_TXPWR_LMT) -+ if (pDM_Odm->RFEType == 5) -+ READ_AND_CONFIG_MP(8822B, _TXPWR_LMT_type5); -+ else -+ READ_AND_CONFIG_MP(8822B, _TXPWR_LMT); -+ } -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8197F) { -+ if (ConfigType == CONFIG_RF_RADIO) { -+ if (eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG_MP(8197F, _RadioA); -+ else if (eRFPath == ODM_RF_PATH_B) -+ READ_AND_CONFIG_MP(8197F, _RadioB); -+ } -+ } -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) { -+ if (ConfigType == CONFIG_RF_RADIO) { -+ if (eRFPath == ODM_RF_PATH_A) -+ READ_AND_CONFIG(8821C, _RadioA); -+ } else if (ConfigType == CONFIG_RF_TXPWR_LMT) -+ READ_AND_CONFIG(8821C, _TXPWR_LMT); -+ } -+#endif -+ -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS -+ODM_ConfigRFWithTxPwrTrackHeaderFile( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigRFWithTxPwrTrackHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ -+ -+//1 AP doesn't use PHYDM power tracking table in these ICs -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if RTL8821A_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8821A,_TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8821A,_TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8821A,_TxPowerTrack_SDIO); -+ } -+#endif -+#if RTL8812A_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8812A,_TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { -+ if (pDM_Odm->RFEType == 3 && pDM_Odm->bIsMPChip) -+ READ_AND_CONFIG_MP(8812A,_TxPowerTrack_RFE3); -+ else -+ READ_AND_CONFIG_MP(8812A,_TxPowerTrack_USB); -+ } -+ -+ } -+#endif -+#if RTL8192E_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8192E,_TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8192E,_TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8192E,_TxPowerTrack_SDIO); -+ } -+#endif -+#if RTL8723D_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8723D, _TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8723D, _TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8723D, _TxPowerTrack_SDIO); -+ -+ READ_AND_CONFIG_MP(8723D, _TxXtalTrack); -+ } -+#endif -+#if RTL8188E_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ if (PHY_QueryMacReg(pDM_Odm->Adapter, 0xF0, 0xF000) >= 8) { /*if 0xF0[15:12] >= 8, SMIC*/ -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8188E, _TxPowerTrack_PCIE_ICUT); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8188E, _TxPowerTrack_USB_ICUT); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8188E, _TxPowerTrack_SDIO_ICUT); -+ } else { /*else 0xF0[15:12] < 8, TSMC*/ -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8188E, _TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8188E, _TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8188E, _TxPowerTrack_SDIO); -+ } -+ -+ } -+#endif -+#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+//1 All platforms support -+#if RTL8723B_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG_MP(8723B, _TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8723B, _TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8723B, _TxPowerTrack_SDIO); -+ } -+#endif -+#if RTL8814A_SUPPORT -+ if(pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ if(pDM_Odm->RFEType == 0) -+ READ_AND_CONFIG_MP(8814A,_TxPowerTrack_Type0); -+ else if(pDM_Odm->RFEType == 2) -+ READ_AND_CONFIG_MP(8814A,_TxPowerTrack_Type2); -+ else if (pDM_Odm->RFEType == 5) -+ READ_AND_CONFIG_MP(8814A, _TxPowerTrack_Type5); -+ else -+ READ_AND_CONFIG_MP(8814A,_TxPowerTrack); -+ -+ READ_AND_CONFIG_MP(8814A, _TxPowerTSSI); -+ } -+#endif -+#if RTL8703B_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8703B, _TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8703B, _TxPowerTrack_SDIO); -+ -+ READ_AND_CONFIG_MP(8703B, _TxXtalTrack); -+ } -+#endif -+ -+#if RTL8188F_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG_MP(8188F, _TxPowerTrack_USB); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) -+ READ_AND_CONFIG_MP(8188F, _TxPowerTrack_SDIO); -+ } -+#endif -+ -+#if RTL8822B_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) { -+ if (pDM_Odm->RFEType == 0) -+ READ_AND_CONFIG_MP(8822B, _TxPowerTrack_type0); -+ else if (pDM_Odm->RFEType == 1) -+ READ_AND_CONFIG_MP(8822B, _TxPowerTrack_type1); -+ else if ((pDM_Odm->RFEType == 3) || (pDM_Odm->RFEType == 5)) -+ READ_AND_CONFIG_MP(8822B, _TxPowerTrack_Type3_Type5); -+ else if (pDM_Odm->RFEType == 6) -+ READ_AND_CONFIG_MP(8822B, _TxPowerTrack_type6); -+ else if (pDM_Odm->RFEType == 7) -+ READ_AND_CONFIG_MP(8822B, _TxPowerTrack_type7); -+ else -+ READ_AND_CONFIG_MP(8822B, _TxPowerTrack); -+ } -+#endif -+ -+#if RTL8197F_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8197F) { -+ if (pDM_Odm->RFEType == 0) -+ READ_AND_CONFIG_MP(8197F, _TxPowerTrack_Type0); -+ else if (pDM_Odm->RFEType == 1) -+ READ_AND_CONFIG_MP(8197F, _TxPowerTrack_Type1); -+ else -+ READ_AND_CONFIG_MP(8197F, _TxPowerTrack); -+ } -+#endif -+ -+#if RTL8821C_SUPPORT -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ READ_AND_CONFIG(8821C, _TxPowerTrack); -+#endif -+ -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS -+ODM_ConfigBBWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_BB_Config_Type ConfigType -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+#endif -+ -+//1 AP doesn't use PHYDM initialization in these ICs -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if (RTL8812A_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ if (ConfigType == CONFIG_BB_PHY_REG) { -+ READ_AND_CONFIG_MP(8812A, _PHY_REG); -+ } else if (ConfigType == CONFIG_BB_AGC_TAB) { -+ READ_AND_CONFIG_MP(8812A, _AGC_TAB); -+ } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { -+ if (pDM_Odm->RFEType == 3 && pDM_Odm->bIsMPChip) -+ READ_AND_CONFIG_MP(8812A, _PHY_REG_PG_ASUS); -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ else if (pMgntInfo->CustomerID == RT_CID_WNC_NEC && pDM_Odm->bIsMPChip) -+ READ_AND_CONFIG_MP(8812A, _PHY_REG_PG_NEC); -+ #if RT_PLATFORM == PLATFORM_MACOSX -+ /*{1827}{1024} for BUFFALO power by rate table. Isaiah 2013-11-29*/ -+ else if (pMgntInfo->CustomerID == RT_CID_DNI_BUFFALO) -+ READ_AND_CONFIG_MP(8812A, _PHY_REG_PG_DNI); -+ /* TP-Link T4UH, Isaiah 2015-03-16*/ -+ else if (pMgntInfo->CustomerID == RT_CID_TPLINK_HPWR) { -+ DbgPrint("RT_CID_TPLINK_HPWR:: _PHY_REG_PG_TPLINK\n"); -+ READ_AND_CONFIG_MP(8812A, _PHY_REG_PG_TPLINK); -+ } -+ #endif -+ #endif -+ else -+ READ_AND_CONFIG_MP(8812A, _PHY_REG_PG); -+ } -+ else if(ConfigType == CONFIG_BB_PHY_REG_MP){ -+ READ_AND_CONFIG_MP(8812A,_PHY_REG_MP); -+ } -+ else if(ConfigType == CONFIG_BB_AGC_TAB_DIFF) -+ { -+ if ((36 <= *pDM_Odm->pChannel) && (*pDM_Odm->pChannel <= 64)) -+ AGC_DIFF_CONFIG_MP(8812A,LB); -+ else if (100 <= *pDM_Odm->pChannel) -+ AGC_DIFF_CONFIG_MP(8812A,HB); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8812AGCTABArray\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8812PHY_REGArray\n")); -+ } -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821) { -+ if (ConfigType == CONFIG_BB_PHY_REG) { -+ READ_AND_CONFIG_MP(8821A, _PHY_REG); -+ } else if (ConfigType == CONFIG_BB_AGC_TAB) { -+ READ_AND_CONFIG_MP(8821A, _AGC_TAB); -+ } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if ((pHalData->EEPROMSVID == 0x1043 && pHalData->EEPROMSMID == 0x207F)) -+ READ_AND_CONFIG_MP(8821A, _PHY_REG_PG_E202SA); -+ else -+ #endif -+ #if (RT_PLATFORM == PLATFORM_MACOSX) -+ /*{1827}{1022} for BUFFALO power by rate table. Isaiah 2013-10-18*/ -+ if (pMgntInfo->CustomerID == RT_CID_DNI_BUFFALO) { -+ /*{1024} for BUFFALO power by rate table. (JP/US)*/ -+ if (pMgntInfo->ChannelPlan == RT_CHANNEL_DOMAIN_US_2G_CANADA_5G) -+ READ_AND_CONFIG_MP(8821A, _PHY_REG_PG_DNI_US); -+ else -+ READ_AND_CONFIG_MP(8821A, _PHY_REG_PG_DNI_JP); -+ } else -+ #endif -+ #endif -+ READ_AND_CONFIG_MP(8821A,_PHY_REG_PG); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8821AGCTABArray\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8821PHY_REGArray\n")); -+ } -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG){ -+ READ_AND_CONFIG_MP(8192E,_PHY_REG); -+ }else if(ConfigType == CONFIG_BB_AGC_TAB){ -+ READ_AND_CONFIG_MP(8192E,_AGC_TAB); -+ }else if(ConfigType == CONFIG_BB_PHY_REG_PG){ -+ READ_AND_CONFIG_MP(8192E,_PHY_REG_PG); -+ } -+ } -+#endif -+#if (RTL8723D_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ if (ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8723D, _PHY_REG); -+ else if (ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8723D, _AGC_TAB); -+ else if (ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8723D, _PHY_REG_PG); -+ } -+#endif -+#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+ -+//1 All platforms support -+#if (RTL8188E_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8188E,_PHY_REG); -+ else if(ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8188E,_AGC_TAB); -+ else if(ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8188E,_PHY_REG_PG); -+ } -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+ if (ConfigType == CONFIG_BB_PHY_REG) { -+ READ_AND_CONFIG_MP(8723B, _PHY_REG); -+ } else if (ConfigType == CONFIG_BB_AGC_TAB) { -+ READ_AND_CONFIG_MP(8723B, _AGC_TAB); -+ } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { -+ READ_AND_CONFIG_MP(8723B, _PHY_REG_PG); -+ } -+ } -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ if(pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG){ -+ READ_AND_CONFIG_MP(8814A,_PHY_REG); -+ }else if(ConfigType == CONFIG_BB_AGC_TAB){ -+ READ_AND_CONFIG_MP(8814A,_AGC_TAB); -+ }else if(ConfigType == CONFIG_BB_PHY_REG_PG){ -+ READ_AND_CONFIG_MP(8814A,_PHY_REG_PG); -+ }else if(ConfigType == CONFIG_BB_PHY_REG_MP){ -+ READ_AND_CONFIG_MP(8814A,_PHY_REG_MP); -+ } -+ } -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) { -+ if (ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8703B, _PHY_REG); -+ else if (ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8703B, _AGC_TAB); -+ else if (ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8703B, _PHY_REG_PG); -+ } -+#endif -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ if (ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8188F, _PHY_REG); -+ else if (ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8188F, _AGC_TAB); -+ else if (ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8188F, _PHY_REG_PG); -+ } -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) { -+ if (ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG_MP(8822B, _PHY_REG); -+ else if (ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8822B, _AGC_TAB); -+ else if (ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8822B, _PHY_REG_PG); -+ /*else if (ConfigType == CONFIG_BB_PHY_REG_MP)*/ -+ /*READ_AND_CONFIG_MP(8822B, _PHY_REG_MP);*/ -+ } -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8197F) { -+ if (ConfigType == CONFIG_BB_PHY_REG) { -+ READ_AND_CONFIG_MP(8197F, _PHY_REG); -+ if (pDM_Odm->CutVersion == ODM_CUT_A) -+ phydm_phypara_a_cut(pDM_Odm); -+ } else if (ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG_MP(8197F, _AGC_TAB); -+/* else if(ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG_MP(8197F, _PHY_REG_PG); -+ else if(ConfigType == CONFIG_BB_PHY_REG_MP) -+ READ_AND_CONFIG_MP(8197F, _PHY_REG_MP); */ -+ } -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ { -+ if (ConfigType == CONFIG_BB_PHY_REG) { -+ READ_AND_CONFIG(8821C, _PHY_REG); -+ } else if (ConfigType == CONFIG_BB_AGC_TAB) { -+ READ_AND_CONFIG(8821C, _AGC_TAB); -+ /* According to RFEtype, choosing correct AGC table*/ -+ if (pDM_Odm->RFEType == 2 || pDM_Odm->RFEType == 4 || pDM_Odm->RFEType == 7) -+ AGC_DIFF_CONFIG_MP(8821C, BTG); -+ } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { -+ READ_AND_CONFIG(8821C, _PHY_REG_PG); -+ } -+ } -+#endif -+ -+#if (RTL8195A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8195A) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG) -+ READ_AND_CONFIG(8195A, _PHY_REG); -+ else if(ConfigType == CONFIG_BB_AGC_TAB) -+ READ_AND_CONFIG(8195A, _AGC_TAB); -+ else if(ConfigType == CONFIG_BB_PHY_REG_PG) -+ READ_AND_CONFIG(8195A, _PHY_REG_PG); -+ } -+#endif -+ -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS -+ODM_ConfigMACWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigMACWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ -+//1 AP doesn't use PHYDM initialization in these ICs -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812){ -+ READ_AND_CONFIG_MP(8812A, _MAC_REG); -+ } -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821){ -+ READ_AND_CONFIG_MP(8821A, _MAC_REG); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigMACwithHeaderFile\n")); -+ } -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8192E){ -+ READ_AND_CONFIG_MP(8192E, _MAC_REG); -+ } -+#endif -+#if (RTL8723D_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723D) -+ READ_AND_CONFIG_MP(8723D, _MAC_REG); -+#endif -+#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+//1 All platforms support -+#if (RTL8188E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E){ -+ READ_AND_CONFIG_MP(8188E, _MAC_REG); -+ } -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+ READ_AND_CONFIG_MP(8723B, _MAC_REG); -+ } -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A){ -+ READ_AND_CONFIG_MP(8814A, _MAC_REG); -+ } -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) -+ READ_AND_CONFIG_MP(8703B, _MAC_REG); -+#endif -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ READ_AND_CONFIG_MP(8188F, _MAC_REG); -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ READ_AND_CONFIG_MP(8822B, _MAC_REG); -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8197F) -+ READ_AND_CONFIG_MP(8197F, _MAC_REG); -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ READ_AND_CONFIG(8821C, _MAC_REG); -+#endif -+ -+#if (RTL8195A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8195A) -+ READ_AND_CONFIG_MP(8195A, _MAC_REG); -+#endif -+ -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS -+ODM_ConfigFWWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_FW_Config_Type ConfigType, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pSize -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+#if (RTL8188E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ #ifdef CONFIG_SFW_SUPPORTED -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8188E_T,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8188E_T,_FW_WoWLAN); -+ else if(ConfigType == CONFIG_FW_NIC_2) -+ READ_FIRMWARE_MP(8188E_S,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN_2) -+ READ_FIRMWARE_MP(8188E_S,_FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ if (ConfigType == CONFIG_FW_AP) -+ READ_FIRMWARE_MP(8188E_T,_FW_AP); -+ else if (ConfigType == CONFIG_FW_AP_2) -+ READ_FIRMWARE_MP(8188E_S,_FW_AP); -+ #endif //CONFIG_AP_WOWLAN -+ #else -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8188E_T,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8188E_T,_FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP) -+ READ_FIRMWARE_MP(8188E_T,_FW_AP); -+ #endif //CONFIG_AP_WOWLAN -+ #endif -+ } -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) -+ { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8723B,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8723B,_FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE(8723B,_FW_AP_WoWLAN); -+ #endif -+ -+ } -+#endif //#if (RTL8723B_SUPPORT == 1) -+#if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8812A,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8812A,_FW_WoWLAN); -+ else if (ConfigType == CONFIG_FW_BT) -+ READ_FIRMWARE_MP(8812A,_FW_NIC_BT); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE(8812A,_FW_AP); -+ #endif -+ } -+#endif -+#if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821){ -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8821A,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8821A,_FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE_MP(8821A , _FW_AP); -+ #endif /*CONFIG_AP_WOWLAN*/ -+ else if (ConfigType == CONFIG_FW_BT) -+ READ_FIRMWARE_MP(8821A,_FW_NIC_BT); -+ } -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8192E,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8192E,_FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE_MP(8192E,_FW_AP); -+ #endif -+ } -+#endif -+#if (RTL8723D_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723D) { -+ if (ConfigType == CONFIG_FW_NIC) { -+ READ_FIRMWARE_MP(8723D, _FW_NIC); -+ } else if (ConfigType == CONFIG_FW_WoWLAN) { -+ READ_FIRMWARE_MP(8723D, _FW_WoWLAN); -+ } -+ } -+#endif -+/*#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8814A, _FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8814A, _FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE_MP(8814A, _FW_AP); -+ #endif -+ } -+#endif */ -+ -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8814A,_FW_NIC); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE_MP(8814A,_FW_AP); -+ #endif -+ } -+#endif -+ -+#if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8703B, _FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8703B, _FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE(8703B, _FW_AP_WoWLAN); -+ #endif -+ } -+#endif -+ -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8188F, _FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8188F, _FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP) -+ READ_FIRMWARE_MP(8188F, _FW_AP); -+ #endif -+ } -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) { -+ -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8822B,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8822B, _FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE(8822B,_FW_AP); -+ #endif -+ } -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8197F) { -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8197F, _FW_NIC); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE(8197F , _FW_AP); -+ #endif -+ } -+#endif -+ -+#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN)) -+#if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C){ -+ if (ConfigType == CONFIG_FW_NIC) -+ READ_FIRMWARE_MP(8821C,_FW_NIC); -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ READ_FIRMWARE_MP(8821C,_FW_WoWLAN); -+ #ifdef CONFIG_AP_WOWLAN -+ else if (ConfigType == CONFIG_FW_AP_WoWLAN) -+ READ_FIRMWARE_MP(8821C , _FW_AP); -+ #endif /*CONFIG_AP_WOWLAN*/ -+ } -+#endif -+#endif -+ -+#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) -+ return HAL_STATUS_SUCCESS; -+} -+ -+u4Byte -+ODM_GetHWImgVersion( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte Version=0; -+ -+//1 AP doesn't use PHYDM initialization in these ICs -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#if (RTL8821A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821) -+ Version = GET_VERSION_MP(8821A,_MAC_REG); -+#endif -+#if (RTL8192E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8192E) -+ Version = GET_VERSION_MP(8192E,_MAC_REG); -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ Version = GET_VERSION_MP(8812A,_MAC_REG); -+#endif -+#if (RTL8723D_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723D) -+ Version = GET_VERSION_MP(8723D, _MAC_REG); -+#endif -+#endif //(DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+/*1 All platforms support*/ -+#if (RTL8188E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ Version = GET_VERSION_MP(8188E,_MAC_REG); -+#endif -+#if (RTL8723B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8723B) -+ Version = GET_VERSION_MP(8723B, _MAC_REG); -+#endif -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ Version = GET_VERSION_MP(8814A,_MAC_REG); -+#endif -+#if (RTL8703B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8703B) -+ Version = GET_VERSION_MP(8703B, _MAC_REG); -+#endif -+#if (RTL8188F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188F) -+ Version = GET_VERSION_MP(8188F, _MAC_REG); -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) -+ Version = GET_VERSION_MP(8822B, _MAC_REG); -+#endif -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8197F) -+ Version = GET_VERSION_MP(8197F, _MAC_REG); -+#endif -+ -+#if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ Version = GET_VERSION(8821C, _MAC_REG); -+#endif -+ -+ return Version; -+} -+ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+/* For 8822B only!! need to move to FW finally */ -+/*==============================================*/ -+ -+VOID -+phydm_ResetPhyInfo( -+ IN PDM_ODM_T pPhydm, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+ pPhyInfo->RxPWDBAll = 0; -+ pPhyInfo->SignalQuality = 0; -+ pPhyInfo->BandWidth = 0; -+ pPhyInfo->RxCount = 0; -+ ODM_Memory_Set(pPhydm, pPhyInfo->RxMIMOSignalQuality, 0 , 4); -+ ODM_Memory_Set(pPhydm, pPhyInfo->RxMIMOSignalStrength, 0, 4); -+ ODM_Memory_Set(pPhydm, pPhyInfo->RxSNR, 0, 4); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->RxPower = -110; -+ pPhyInfo->RecvSignalPower = -110; -+ pPhyInfo->BTRxRSSIPercentage = 0; -+ pPhyInfo->SignalStrength = 0; -+ pPhyInfo->btCoexPwrAdjust = 0; -+ pPhyInfo->channel = 0; -+ pPhyInfo->bMuPacket = 0; -+ pPhyInfo->bBeamformed = 0; -+ pPhyInfo->rxsc = 0; -+ ODM_Memory_Set(pPhydm, pPhyInfo->RxPwr, -110, 4); -+ ODM_Memory_Set(pPhydm, pPhyInfo->RxMIMOEVMdbm, 0, 4); -+ ODM_Memory_Set(pPhydm, pPhyInfo->Cfo_short, 0, 8); -+ ODM_Memory_Set(pPhydm, pPhyInfo->Cfo_tail, 0, 8); -+#endif -+} -+ -+VOID -+phydm_SetPerPathPhyInfo( -+ IN u1Byte RxPath, -+ IN s1Byte RxPwr, -+ IN s1Byte RxEVM, -+ IN s1Byte Cfo_tail, -+ IN s1Byte RxSNR, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+ u1Byte EVMdBm = 0; -+ u1Byte EVMPercentage = 0; -+ -+ /* SNR is S(8,1), EVM is S(8,1), CFO is S(8,7) */ -+ -+ if (RxEVM < 0) { -+ /* Calculate EVM in dBm */ -+ EVMdBm = ((u1Byte)(0 - RxEVM) >> 1); -+ -+ /* Calculate EVM in percentage */ -+ if (EVMdBm >= 33) -+ EVMPercentage = 100; -+ else -+ EVMPercentage = (EVMdBm << 1) + (EVMdBm); -+ } -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->RxPwr[RxPath] = RxPwr; -+ pPhyInfo->RxMIMOEVMdbm[RxPath] = EVMdBm; -+ -+ /* CFO = CFO_tail * 312.5 / 2^7 ~= CFO tail * 39/512 (kHz)*/ -+ pPhyInfo->Cfo_tail[RxPath] = Cfo_tail; -+ pPhyInfo->Cfo_tail[RxPath] = ((pPhyInfo->Cfo_tail[RxPath] << 5) + (pPhyInfo->Cfo_tail[RxPath] << 2) + -+ (pPhyInfo->Cfo_tail[RxPath] << 1) + (pPhyInfo->Cfo_tail[RxPath])) >> 9; -+#endif -+ -+ pPhyInfo->RxMIMOSignalStrength[RxPath] = odm_QueryRxPwrPercentage(RxPwr); -+ pPhyInfo->RxMIMOSignalQuality[RxPath] = EVMPercentage; -+ pPhyInfo->RxSNR[RxPath] = RxSNR >> 1; -+ -+/* -+ //if (pPktinfo->bPacketMatchBSSID) -+ { -+ DbgPrint("Path (%d)--------\n", RxPath); -+ DbgPrint("RxPwr = %d, Signal strength = %d\n", pPhyInfo->RxPwr[RxPath], pPhyInfo->RxMIMOSignalStrength[RxPath]); -+ DbgPrint("EVMdBm = %d, Signal quality = %d\n", pPhyInfo->RxMIMOEVMdbm[RxPath], pPhyInfo->RxMIMOSignalQuality[RxPath]); -+ DbgPrint("CFO = %d, SNR = %d\n", pPhyInfo->Cfo_tail[RxPath], pPhyInfo->RxSNR[RxPath]); -+ } -+*/ -+} -+ -+VOID -+phydm_SetCommonPhyInfo( -+ IN s1Byte RxPower, -+ IN u1Byte channel, -+ IN BOOLEAN bBeamformed, -+ IN BOOLEAN bMuPacket, -+ IN u1Byte bandwidth, -+ IN u1Byte signalQuality, -+ IN u1Byte rxsc, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ pPhyInfo->RxPower = RxPower; /* RSSI in dB */ -+ pPhyInfo->RecvSignalPower = RxPower; /* RSSI in dB */ -+ pPhyInfo->channel = channel; /* channel number */ -+ pPhyInfo->bBeamformed = bBeamformed; /* apply BF */ -+ pPhyInfo->bMuPacket = bMuPacket; /* MU packet */ -+ pPhyInfo->rxsc = rxsc; -+#endif -+ pPhyInfo->RxPWDBAll = odm_QueryRxPwrPercentage(RxPower); /* RSSI in percentage */ -+ pPhyInfo->SignalQuality = signalQuality; /* signal quality */ -+ pPhyInfo->BandWidth = bandwidth; /* bandwidth */ -+ -+/* -+ //if (pPktinfo->bPacketMatchBSSID) -+ { -+ DbgPrint("RxPWDBAll = %d, RxPower = %d, RecvSignalPower = %d\n", pPhyInfo->RxPWDBAll, pPhyInfo->RxPower, pPhyInfo->RecvSignalPower); -+ DbgPrint("SignalQuality = %d\n", pPhyInfo->SignalQuality); -+ DbgPrint("bBeamformed = %d, bMuPacket = %d, RxCount = %d\n", pPhyInfo->bBeamformed, pPhyInfo->bMuPacket, pPhyInfo->RxCount + 1); -+ DbgPrint("channel = %d, rxsc = %d, BandWidth = %d\n", channel, rxsc, bandwidth); -+ } -+*/ -+} -+ -+VOID -+phydm_GetRxPhyStatusType0( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+ /* Type 0 is used for cck packet */ -+ -+ PPHY_STATUS_RPT_JAGUAR2_TYPE0 pPhyStaRpt = (PPHY_STATUS_RPT_JAGUAR2_TYPE0)pPhyStatus; -+ u1Byte i, SQ = 0; -+ s1Byte RxPower = pPhyStaRpt->pwdb - 110; -+ -+ -+#if (RTL8723D_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8723D) -+ RxPower = pPhyStaRpt->pwdb - 97; -+#endif -+ -+ /* Calculate Signal Quality*/ -+ if (pPktinfo->bPacketMatchBSSID) { -+ if (pPhyStaRpt->signal_quality >= 64) -+ SQ = 0; -+ else if (pPhyStaRpt->signal_quality <= 20) -+ SQ = 100; -+ else { -+ /* mapping to 2~99% */ -+ SQ = 64 - pPhyStaRpt->signal_quality; -+ SQ = ((SQ << 3) + SQ) >> 2; -+ } -+ } -+ -+ /* Modify CCK PWDB if old AGC */ -+ if (pDM_Odm->cck_new_agc == FALSE) { -+ u1Byte LNA_idx, VGA_idx; -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ LNA_idx = pPhyStaRpt->lna_l; -+ else -+#endif -+ LNA_idx = ((pPhyStaRpt->lna_h << 3) | pPhyStaRpt->lna_l); -+ VGA_idx = pPhyStaRpt->vga; -+ -+#if (RTL8723D_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8723D) -+ RxPower = odm_CCKRSSI_8723D(LNA_idx, VGA_idx); -+#endif -+#if (RTL8822B_SUPPORT == 1) -+ /* Need to do !! */ -+ /*if (pDM_Odm->SupportICType & ODM_RTL8822B) */ -+ /*RxPower = odm_CCKRSSI_8822B(LNA_idx, VGA_idx);*/ -+#endif -+#if (RTL8197F_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8197F) -+ RxPower = odm_CCKRSSI_8197F(pDM_Odm, LNA_idx, VGA_idx); -+#endif -+ } -+ -+ /* Update CCK packet counter */ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; -+ -+ /*CCK no STBC and LDPC*/ -+ pDM_Odm->PhyDbgInfo.bLdpcPkt = FALSE; -+ pDM_Odm->PhyDbgInfo.bStbcPkt = FALSE; -+ -+ /* Update Common information */ -+ phydm_SetCommonPhyInfo(RxPower, pPhyStaRpt->channel, FALSE, -+ FALSE, ODM_BW20M, SQ, pPhyStaRpt->rxsc, pPhyInfo); -+ -+ /* Update CCK pwdb */ -+ phydm_SetPerPathPhyInfo(ODM_RF_PATH_A, RxPower, 0, 0, 0, pPhyInfo); /* Update per-path information */ -+ -+ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->antidx_a; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->antidx_b; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antidx_c; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_3 = pPhyStaRpt->antidx_d; -+/* -+ //if (pPktinfo->bPacketMatchBSSID) -+ { -+ DbgPrint("pwdb = 0x%x, MP gain index = 0x%x, TRSW = 0x%x\n", pPhyStaRpt->pwdb, pPhyStaRpt->gain, pPhyStaRpt->trsw); -+ DbgPrint("channel = %d, band = %d, rxsc = %d\n", pPhyStaRpt->channel, pPhyStaRpt->band, pPhyStaRpt->rxsc); -+ DbgPrint("agc_table = 0x%x, agc_rpt 0x%x, bb_power = 0x%x\n", pPhyStaRpt->agc_table, pPhyStaRpt->agc_rpt, pPhyStaRpt->bb_power); -+ DbgPrint("length = %d, SQ = %d\n", pPhyStaRpt->length, pPhyStaRpt->signal_quality); -+ DbgPrint("antidx a = 0x%x, b = 0x%x, c = 0x%x, d = 0x%x\n", pPhyStaRpt->antidx_a, pPhyStaRpt->antidx_b, pPhyStaRpt->antidx_c, pPhyStaRpt->antidx_d); -+ DbgPrint("rsvd_0 = 0x%x, rsvd_1 = 0x%x, rsvd_2 = 0x%x\n", pPhyStaRpt->rsvd_0, pPhyStaRpt->rsvd_1, pPhyStaRpt->rsvd_2); -+ DbgPrint("rsvd_3 = 0x%x, rsvd_4 = 0x%x, rsvd_5 = 0x%x\n", pPhyStaRpt->rsvd_3, pPhyStaRpt->rsvd_4, pPhyStaRpt->rsvd_5); -+ DbgPrint("rsvd_6 = 0x%x, rsvd_7 = 0x%x, rsvd_8 = 0x%x\n", pPhyStaRpt->rsvd_6, pPhyStaRpt->rsvd_7, pPhyStaRpt->rsvd_8); -+ } -+*/ -+} -+ -+VOID -+phydm_GetRxPhyStatusType1( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+ /* Type 1 is used for ofdm packet */ -+ -+ PPHY_STATUS_RPT_JAGUAR2_TYPE1 pPhyStaRpt = (PPHY_STATUS_RPT_JAGUAR2_TYPE1)pPhyStatus; -+ s1Byte rx_pwr_db = -120; -+ u1Byte i, rxsc, bw = ODM_BW20M, RxCount = 0; -+ BOOLEAN bMU; -+ u1Byte num_ss; -+ -+ /* Update OFDM packet counter */ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; -+ -+ /* Update per-path information */ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { -+ if (pDM_Odm->RXAntStatus & BIT(i)) { -+ s1Byte rx_path_pwr_db; -+ -+ /* RX path counter */ -+ RxCount++; -+ -+ /* Update per-path information (RSSI_dB RSSI_percentage EVM SNR CFO SQ) */ -+ /* EVM report is reported by stream, not path */ -+ rx_path_pwr_db = pPhyStaRpt->pwdb[i] - 110; /* per-path pwdb in dB domain */ -+ phydm_SetPerPathPhyInfo(i, rx_path_pwr_db, pPhyStaRpt->rxevm[RxCount - 1], -+ pPhyStaRpt->cfo_tail[i], pPhyStaRpt->rxsnr[i], pPhyInfo); -+ -+ /* search maximum pwdb */ -+ if (rx_path_pwr_db > rx_pwr_db) -+ rx_pwr_db = rx_path_pwr_db; -+ } -+ } -+ -+ /* mapping RX counter from 1~4 to 0~3 */ -+ if (RxCount > 0) -+ pPhyInfo->RxCount = RxCount - 1; -+ -+ /* Check if MU packet or not */ -+ if ((pPhyStaRpt->gid != 0) && (pPhyStaRpt->gid != 63)) { -+ bMU = TRUE; -+ pDM_Odm->PhyDbgInfo.NumQryMuPkt++; -+ } else -+ bMU = FALSE; -+ -+ /* Count BF packet */ -+ pDM_Odm->PhyDbgInfo.NumQryBfPkt = pDM_Odm->PhyDbgInfo.NumQryBfPkt + pPhyStaRpt->beamformed; -+ -+ /*STBC or LDPC pkt*/ -+ pDM_Odm->PhyDbgInfo.bLdpcPkt = pPhyStaRpt->ldpc; -+ pDM_Odm->PhyDbgInfo.bStbcPkt = pPhyStaRpt->stbc; -+ -+ /* Check sub-channel */ -+ if ((pPktinfo->DataRate > ODM_RATE11M) && (pPktinfo->DataRate < ODM_RATEMCS0)) -+ rxsc = pPhyStaRpt->l_rxsc; -+ else -+ rxsc = pPhyStaRpt->ht_rxsc; -+ -+ /* Check RX bandwidth */ -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) { -+ if ((rxsc >= 1) && (rxsc <= 8)) -+ bw = ODM_BW20M; -+ else if ((rxsc >= 9) && (rxsc <= 12)) -+ bw = ODM_BW40M; -+ else if (rxsc >= 13) -+ bw = ODM_BW80M; -+ else -+ bw = pPhyStaRpt->rf_mode; -+ } else if (pDM_Odm->SupportICType & (ODM_RTL8197F|ODM_RTL8723D)) { -+ if (pPhyStaRpt->rf_mode == 0) -+ bw = ODM_BW20M; -+ else if ((rxsc == 1) || (rxsc == 2)) -+ bw = ODM_BW20M; -+ else -+ bw = ODM_BW40M; -+ } -+ -+ /* Update packet information */ -+ phydm_SetCommonPhyInfo(rx_pwr_db, pPhyStaRpt->channel, (BOOLEAN)pPhyStaRpt->beamformed, -+ bMU, bw, odm_EVMdbToPercentage(pPhyStaRpt->rxevm[0]), rxsc, pPhyInfo); -+ -+ num_ss =phydm_rate_to_num_ss(pDM_Odm, pPktinfo->DataRate ); -+ -+ ODM_ParsingCFO(pDM_Odm, pPktinfo, pPhyStaRpt->cfo_tail, num_ss); -+ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->antidx_a; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->antidx_b; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antidx_c; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_3 = pPhyStaRpt->antidx_d; -+ -+ if (pPktinfo->bPacketMatchBSSID) { -+/* -+ DbgPrint("channel = %d, band = %d, l_rxsc = %d, ht_rxsc = %d, rf_mode = %d\n", pPhyStaRpt->channel, pPhyStaRpt->band, pPhyStaRpt->l_rxsc, pPhyStaRpt->ht_rxsc, pPhyStaRpt->rf_mode); -+ DbgPrint("Antidx A = %d, B = %d, C = %d, D = %d\n", pPhyStaRpt->antidx_a, pPhyStaRpt->antidx_b, pPhyStaRpt->antidx_c, pPhyStaRpt->antidx_d); -+ DbgPrint("pwdb A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->pwdb[0], pPhyStaRpt->pwdb[1], pPhyStaRpt->pwdb[2], pPhyStaRpt->pwdb[3]); -+ DbgPrint("EVM A: %d, B: %d, C: %d, D: %d\n", pPhyStaRpt->rxevm[0], pPhyStaRpt->rxevm[1], pPhyStaRpt->rxevm[2], pPhyStaRpt->rxevm[3]); -+ DbgPrint("SNR A: %d, B: %d, C: %d, D: %d\n", pPhyStaRpt->rxsnr[0], pPhyStaRpt->rxsnr[1], pPhyStaRpt->rxsnr[2], pPhyStaRpt->rxsnr[3]); -+ DbgPrint("CFO A: %d, B: %d, C: %d, D: %d\n", pPhyStaRpt->cfo_tail[0], pPhyStaRpt->cfo_tail[1], pPhyStaRpt->cfo_tail[2], pPhyStaRpt->cfo_tail[3]); -+ DbgPrint("paid = %d, gid = %d, length = %d\n", (pPhyStaRpt->paid + (pPhyStaRpt->paid_msb<<8)), pPhyStaRpt->gid, pPhyStaRpt->lsig_length); -+ DbgPrint("ldpc: %d, stbc: %d, bf: %d, gnt_bt: %d, antsw: %d\n", pPhyStaRpt->ldpc, pPhyStaRpt->stbc, pPhyStaRpt->beamformed, pPhyStaRpt->gnt_bt, pPhyStaRpt->hw_antsw_occu); -+ DbgPrint("NBI: %d, pos: %d\n", pPhyStaRpt->nb_intf_flag, (pPhyStaRpt->intf_pos + (pPhyStaRpt->intf_pos_msb<<8))); -+ DbgPrint("rsvd_0 = %d, rsvd_1 = %d, rsvd_2 = %d, rsvd_3 = %d, rsvd_4 = %d, rsvd_5 = %d\n", pPhyStaRpt->rsvd_0, pPhyStaRpt->rsvd_1, pPhyStaRpt->rsvd_2, pPhyStaRpt->rsvd_3, pPhyStaRpt->rsvd_4, pPhyStaRpt->rsvd_5); -+*/ -+ if ((pPhyStaRpt->gid != 0) && (pPhyStaRpt->gid != 63)) { -+ if (pPktinfo->DataRate >= ODM_RATEVHTSS1MCS0) -+ pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[pPktinfo->DataRate - 0x2C]++; -+ } else { -+ if (pPktinfo->DataRate >= ODM_RATEVHTSS1MCS0) -+ pDM_Odm->PhyDbgInfo.NumQryVhtPkt[pPktinfo->DataRate - 0x2C]++; -+ } -+ } -+/* -+ DbgPrint("phydm_GetRxPhyStatusType1 pPktinfo->bPacketMatchBSSID = %d\n", pPktinfo->bPacketMatchBSSID); -+ DbgPrint("pPktinfo->DataRate = 0x%x\n", pPktinfo->DataRate); -+*/ -+} -+ -+VOID -+phydm_GetRxPhyStatusType2( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+ PPHY_STATUS_RPT_JAGUAR2_TYPE2 pPhyStaRpt = (PPHY_STATUS_RPT_JAGUAR2_TYPE2)pPhyStatus; -+ s1Byte rx_pwr_db = -120; -+ u1Byte i, rxsc, bw = ODM_BW20M, RxCount = 0; -+ -+ /* Update OFDM packet counter */ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; -+ -+ /* Update per-path information */ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { -+ if (pDM_Odm->RXAntStatus & BIT(i)) { -+ s1Byte rx_path_pwr_db; -+ -+ /* RX path counter */ -+ RxCount++; -+ -+ /* Update per-path information (RSSI_dB RSSI_percentage EVM SNR CFO SQ) */ -+#if (RTL8197F_SUPPORT == 1) -+ if ((pDM_Odm->SupportICType & ODM_RTL8197F) && (pPhyStaRpt->pwdb[i] == 0x7f)) { /*for 97f workaround*/ -+ -+ if (i == ODM_RF_PATH_A) { -+ rx_path_pwr_db = (pPhyStaRpt->gain_a)<<1; -+ rx_path_pwr_db = rx_path_pwr_db - 110; -+ } else if (i == ODM_RF_PATH_B) { -+ rx_path_pwr_db = (pPhyStaRpt->gain_b)<<1; -+ rx_path_pwr_db = rx_path_pwr_db - 110; -+ } else -+ rx_path_pwr_db = 0; -+ } else -+#endif -+ rx_path_pwr_db = pPhyStaRpt->pwdb[i] - 110; /* per-path pwdb in dB domain */ -+ -+ phydm_SetPerPathPhyInfo(i, rx_path_pwr_db, 0, 0, 0, pPhyInfo); -+ -+ /* search maximum pwdb */ -+ if (rx_path_pwr_db > rx_pwr_db) -+ rx_pwr_db = rx_path_pwr_db; -+ } -+ } -+ -+ /* mapping RX counter from 1~4 to 0~3 */ -+ if (RxCount > 0) -+ pPhyInfo->RxCount = RxCount - 1; -+ -+ /* Check RX sub-channel */ -+ if ((pPktinfo->DataRate > ODM_RATE11M) && (pPktinfo->DataRate < ODM_RATEMCS0)) -+ rxsc = pPhyStaRpt->l_rxsc; -+ else -+ rxsc = pPhyStaRpt->ht_rxsc; -+ -+ /*STBC or LDPC pkt*/ -+ pDM_Odm->PhyDbgInfo.bLdpcPkt = pPhyStaRpt->ldpc; -+ pDM_Odm->PhyDbgInfo.bStbcPkt = pPhyStaRpt->stbc; -+ -+ /* Check RX bandwidth */ -+ /* the BW information of sc=0 is useless, because there is no information of RF mode*/ -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) { -+ if ((rxsc >= 1) && (rxsc <= 8)) -+ bw = ODM_BW20M; -+ else if ((rxsc >= 9) && (rxsc <= 12)) -+ bw = ODM_BW40M; -+ else if (rxsc >= 13) -+ bw = ODM_BW80M; -+ else -+ bw = ODM_BW20M; -+ } else if (pDM_Odm->SupportICType & (ODM_RTL8197F|ODM_RTL8723D)) { -+ if (rxsc == 3) -+ bw = ODM_BW40M; -+ else if ((rxsc == 1) || (rxsc == 2)) -+ bw = ODM_BW20M; -+ else -+ bw = ODM_BW20M; -+ } -+ -+ /* Update packet information */ -+ phydm_SetCommonPhyInfo(rx_pwr_db, pPhyStaRpt->channel, (BOOLEAN)pPhyStaRpt->beamformed, -+ FALSE, bw, 0, rxsc, pPhyInfo); -+ -+/* -+ //if (pPktinfo->bPacketMatchBSSID) -+ { -+ DbgPrint("channel = %d, band = %d, l_rxsc = %d, ht_rxsc = %d\n", pPhyStaRpt->channel, pPhyStaRpt->band, pPhyStaRpt->l_rxsc, pPhyStaRpt->ht_rxsc); -+ DbgPrint("pwdb A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->pwdb[0], pPhyStaRpt->pwdb[1], pPhyStaRpt->pwdb[2], pPhyStaRpt->pwdb[3]); -+ DbgPrint("Agc table A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->agc_table_a, pPhyStaRpt->agc_table_b, pPhyStaRpt->agc_table_c, pPhyStaRpt->agc_table_d); -+ DbgPrint("Gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->gain_a, pPhyStaRpt->gain_b, pPhyStaRpt->gain_c, pPhyStaRpt->gain_d); -+ DbgPrint("TRSW A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->trsw_a, pPhyStaRpt->trsw_b, pPhyStaRpt->trsw_c, pPhyStaRpt->trsw_d); -+ DbgPrint("AAGC step A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->aagc_step_a, pPhyStaRpt->aagc_step_b, pPhyStaRpt->aagc_step_c, pPhyStaRpt->aagc_step_d); -+ DbgPrint("HT AAGC gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->ht_aagc_gain[0], pPhyStaRpt->ht_aagc_gain[1], pPhyStaRpt->ht_aagc_gain[2], pPhyStaRpt->ht_aagc_gain[3]); -+ DbgPrint("DAGC gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->dagc_gain[0], pPhyStaRpt->dagc_gain[1], pPhyStaRpt->dagc_gain[2], pPhyStaRpt->dagc_gain[3]); -+ DbgPrint("ldpc: %d, stbc: %d, bf: %d, gnt_bt: %d, antsw: %d\n", pPhyStaRpt->ldpc, pPhyStaRpt->stbc, pPhyStaRpt->beamformed, pPhyStaRpt->gnt_bt, pPhyStaRpt->hw_antsw_occu); -+ DbgPrint("counter: %d, syn_count: %d\n", pPhyStaRpt->counter, pPhyStaRpt->syn_count); -+ DbgPrint("cnt_cca2agc_rdy: %d, cnt_pw2cca: %d, shift_l_map\n", pPhyStaRpt->cnt_cca2agc_rdy, pPhyStaRpt->cnt_pw2cca, pPhyStaRpt->shift_l_map); -+ DbgPrint("rsvd_0 = %d, rsvd_1 = %d, rsvd_2 = %d, rsvd_3 = %d, rsvd_4 = %d, rsvd_5 = %d\n", pPhyStaRpt->rsvd_0, pPhyStaRpt->rsvd_1, pPhyStaRpt->rsvd_2, pPhyStaRpt->rsvd_3, pPhyStaRpt->rsvd_4); -+ DbgPrint("rsvd_5 = %d, rsvd_6 = %d, rsvd_6 = %d\n", pPhyStaRpt->rsvd_5, pPhyStaRpt->rsvd_6, pPhyStaRpt->rsvd_7); -+ } -+*/ -+} -+ -+VOID -+phydm_GetRxPhyStatusType5( -+ IN pu1Byte pPhyStatus -+) -+{ -+/* -+ DbgPrint("DW0: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 3), *(pPhyStatus + 2), *(pPhyStatus + 1), *(pPhyStatus + 0)); -+ DbgPrint("DW1: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 7), *(pPhyStatus + 6), *(pPhyStatus + 5), *(pPhyStatus + 4)); -+ DbgPrint("DW2: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 11), *(pPhyStatus + 10), *(pPhyStatus + 9), *(pPhyStatus + 8)); -+ DbgPrint("DW3: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 15), *(pPhyStatus + 14), *(pPhyStatus + 13), *(pPhyStatus + 12)); -+ DbgPrint("DW4: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 19), *(pPhyStatus + 18), *(pPhyStatus + 17), *(pPhyStatus + 16)); -+ DbgPrint("DW5: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 23), *(pPhyStatus + 22), *(pPhyStatus + 21), *(pPhyStatus + 20)); -+ DbgPrint("DW6: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 27), *(pPhyStatus + 26), *(pPhyStatus + 25), *(pPhyStatus + 24)); -+*/ -+} -+ -+VOID -+phydm_Process_RSSIForDMNewType( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN PODM_PHY_INFO_T pPhyInfo, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ s4Byte UndecoratedSmoothedPWDB, AccumulatePWDB; -+ u4Byte RSSI_Ave; -+ u1Byte i; -+ PSTA_INFO_T pEntry; -+ u1Byte scaling_factor = 4; -+ -+ if (pPktinfo->StationID >= ODM_ASSOCIATE_ENTRY_NUM) -+ return; -+ -+ pEntry = pDM_Odm->pODM_StaInfo[pPktinfo->StationID]; -+ -+ if (!IS_STA_VALID(pEntry)) -+ return; -+ -+ if ((!pPktinfo->bPacketMatchBSSID))/*data frame only*/ -+ return; -+ -+ if (pPktinfo->bPacketBeacon) -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt++; -+ -+ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ if (pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) -+ ODM_Process_RSSIForAntDiv(pDM_Odm,pPhyInfo,pPktinfo); -+ #endif -+ -+ if (pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon) { -+ u4Byte RSSI_linear = 0; -+ -+ pDM_Odm->RxRate = pPktinfo->DataRate; -+ UndecoratedSmoothedPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; -+ AccumulatePWDB = pDM_Odm->AccumulatePWDB[pPktinfo->StationID]; -+ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ pDM_Odm->RSSI_C = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_C]; -+ pDM_Odm->RSSI_D = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_D]; -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { -+ if (pPhyInfo->RxMIMOSignalStrength[i] != 0) -+ RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[i]); -+ } -+ -+ switch (pPhyInfo->RxCount + 1) { -+ case 2: -+ RSSI_linear = (RSSI_linear >> 1); -+ break; -+ case 3: -+ RSSI_linear = ((RSSI_linear) + (RSSI_linear << 1) + (RSSI_linear << 3)) >> 5; /* RSSI_linear/3 ~ RSSI_linear*11/32 */ -+ break; -+ case 4: -+ RSSI_linear = (RSSI_linear >> 2); -+ break; -+ } -+ RSSI_Ave = odm_ConvertTo_dB(RSSI_linear); -+ -+ if (UndecoratedSmoothedPWDB <= 0) { -+ AccumulatePWDB = (pPhyInfo->RxPWDBAll << scaling_factor); -+ UndecoratedSmoothedPWDB = pPhyInfo->RxPWDBAll; -+ } else { -+ AccumulatePWDB = AccumulatePWDB - (AccumulatePWDB>>scaling_factor) + RSSI_Ave; -+ UndecoratedSmoothedPWDB = (AccumulatePWDB + (1<<(scaling_factor - 1)))>>scaling_factor; -+ } -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB == -1) -+ phydm_ra_rssi_rpt_wk(pDM_Odm); -+#endif -+ pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; -+ pDM_Odm->AccumulatePWDB[pPktinfo->StationID] = AccumulatePWDB; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ if (pPktinfo->StationID == 0) { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -+ -+ pHalData->UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; -+ } -+#endif -+ } -+} -+ -+VOID -+phydm_RxPhyStatusNewType( -+ IN PDM_ODM_T pPhydm, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo, -+ OUT PODM_PHY_INFO_T pPhyInfo -+) -+{ -+ u1Byte phy_status_type = (*pPhyStatus & 0xf); -+ -+ /*DbgPrint("phydm_RxPhyStatusNewType================> (page: %d)\n", phy_status_type);*/ -+ -+ /* Memory reset */ -+ phydm_ResetPhyInfo(pPhydm, pPhyInfo); -+ -+ /* Phy status parsing */ -+ switch (phy_status_type) { -+ case 0: -+ { -+ phydm_GetRxPhyStatusType0(pPhydm, pPhyStatus, pPktinfo, pPhyInfo); -+ break; -+ } -+ case 1: -+ { -+ phydm_GetRxPhyStatusType1(pPhydm, pPhyStatus, pPktinfo, pPhyInfo); -+ break; -+ } -+ case 2: -+ { -+ phydm_GetRxPhyStatusType2(pPhydm, pPhyStatus, pPktinfo, pPhyInfo); -+ break; -+ } -+/* -+ case 5: -+ { -+ phydm_GetRxPhyStatusType5(pPhyStatus); -+ return; -+ } -+*/ -+ default: -+ return; -+ } -+ -+ /* Update signal strength to UI, and pPhyInfo->RxPWDBAll is the maximum RSSI of all path */ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pPhyInfo->SignalStrength = SignalScaleProc(pPhydm->Adapter, pPhyInfo->RxPWDBAll, FALSE, FALSE); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pPhydm, pPhyInfo->RxPWDBAll)); -+#endif -+ -+ /* Calculate average RSSI and smoothed RSSI */ -+ phydm_Process_RSSIForDMNewType(pPhydm, pPhyInfo, pPktinfo); -+ -+} -+/*==============================================*/ -+#endif -+ -+u4Byte -+query_phydm_trx_capability( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte value32 = 0xFFFFFFFF; -+ -+ #if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ value32 = query_phydm_trx_capability_8821c(pDM_Odm); -+ #endif -+ -+ return value32; -+} -+ -+u4Byte -+query_phydm_stbc_capability( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte value32 = 0xFFFFFFFF; -+ -+ #if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ value32 = query_phydm_stbc_capability_8821c(pDM_Odm); -+ #endif -+ -+ return value32; -+} -+ -+u4Byte -+query_phydm_ldpc_capability( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte value32 = 0xFFFFFFFF; -+ -+ #if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ value32 = query_phydm_ldpc_capability_8821c(pDM_Odm); -+ #endif -+ -+ return value32; -+} -+ -+u4Byte -+query_phydm_txbf_parameters( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte value32 = 0xFFFFFFFF; -+ -+ #if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ value32 = query_phydm_txbf_parameters_8821c(pDM_Odm); -+ #endif -+ -+ return value32; -+} -+ -+u4Byte -+query_phydm_txbf_capability( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte value32 = 0xFFFFFFFF; -+ -+ #if (RTL8821C_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8821C) -+ value32 = query_phydm_txbf_capability_8821c(pDM_Odm); -+ #endif -+ -+ return value32; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_hwconfig.h 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,568 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __HALHWOUTSRC_H__ -+#define __HALHWOUTSRC_H__ -+ -+ -+/*--------------------------Define -------------------------------------------*/ -+#define CCK_RSSI_INIT_COUNT 5 -+ -+#define RA_RSSI_STATE_INIT 0 -+#define RA_RSSI_STATE_SEND 1 -+#define RA_RSSI_STATE_HOLD 2 -+ -+#define CFO_HW_RPT_2_MHZ(val) ((val<<1) + (val>>1)) -+/* ((X* 3125) / 10)>>7 = (X*10)>>2 = X*2.5 = X<<1 + X>>1 */ -+ -+#define AGC_DIFF_CONFIG_MP(ic, band) (ODM_ReadAndConfig_MP_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_MP_##ic##_AGC_TAB_DIFF_##band, \ -+ sizeof(Array_MP_##ic##_AGC_TAB_DIFF_##band)/sizeof(u4Byte))) -+#define AGC_DIFF_CONFIG_TC(ic, band) (ODM_ReadAndConfig_TC_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_TC_##ic##_AGC_TAB_DIFF_##band, \ -+ sizeof(Array_TC_##ic##_AGC_TAB_DIFF_##band)/sizeof(u4Byte))) -+ -+#define AGC_DIFF_CONFIG(ic, band) do {\ -+ if (pDM_Odm->bIsMPChip)\ -+ AGC_DIFF_CONFIG_MP(ic,band);\ -+ else\ -+ AGC_DIFF_CONFIG_TC(ic,band);\ -+ } while(0) -+ -+ -+//============================================================ -+// structure and define -+//============================================================ -+ -+__PACK typedef struct _Phy_Rx_AGC_Info -+{ -+ #if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte gain:7,trsw:1; -+ #else -+ u1Byte trsw:1,gain:7; -+ #endif -+} __WLAN_ATTRIB_PACK__ PHY_RX_AGC_INFO_T, *pPHY_RX_AGC_INFO_T; -+ -+__PACK typedef struct _Phy_Status_Rpt_8192cd { -+ PHY_RX_AGC_INFO_T path_agc[2]; -+ u1Byte ch_corr[2]; -+ u1Byte cck_sig_qual_ofdm_pwdb_all; -+ u1Byte cck_agc_rpt_ofdm_cfosho_a; -+ u1Byte cck_rpt_b_ofdm_cfosho_b; -+ u1Byte rsvd_1;/*ch_corr_msb;*/ -+ u1Byte noise_power_db_msb; -+ s1Byte path_cfotail[2]; -+ u1Byte pcts_mask[2]; -+ s1Byte stream_rxevm[2]; -+ u1Byte path_rxsnr[2]; -+ u1Byte noise_power_db_lsb; -+ u1Byte rsvd_2[3]; -+ u1Byte stream_csi[2]; -+ u1Byte stream_target_csi[2]; -+ s1Byte sig_evm; -+ u1Byte rsvd_3; -+ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte antsel_rx_keep_2: 1; /*ex_intf_flg:1;*/ -+ u1Byte sgi_en: 1; -+ u1Byte rxsc: 2; -+ u1Byte idle_long: 1; -+ u1Byte r_ant_train_en: 1; -+ u1Byte ant_sel_b: 1; -+ u1Byte ant_sel: 1; -+#else /*_BIG_ENDIAN_ */ -+ u1Byte ant_sel: 1; -+ u1Byte ant_sel_b: 1; -+ u1Byte r_ant_train_en: 1; -+ u1Byte idle_long: 1; -+ u1Byte rxsc: 2; -+ u1Byte sgi_en: 1; -+ u1Byte antsel_rx_keep_2: 1;/*ex_intf_flg:1;*/ -+#endif -+} __WLAN_ATTRIB_PACK__ PHY_STATUS_RPT_8192CD_T, *PPHY_STATUS_RPT_8192CD_T; -+ -+ -+typedef struct _Phy_Status_Rpt_8812 { -+/* DWORD 0*/ -+ u1Byte gain_trsw[2]; /*path-A and path-B {TRSW, gain[6:0] }*/ -+ u1Byte chl_num_LSB; /*channel number[7:0]*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte chl_num_MSB: 2; /*channel number[9:8]*/ -+ u1Byte sub_chnl: 4; /*sub-channel location[3:0]*/ -+ u1Byte r_RFMOD: 2; /*RF mode[1:0]*/ -+#else /*_BIG_ENDIAN_ */ -+ u1Byte r_RFMOD: 2; -+ u1Byte sub_chnl: 4; -+ u1Byte chl_num_MSB: 2; -+#endif -+ -+/* DWORD 1*/ -+ u1Byte pwdb_all; /*CCK signal quality / OFDM pwdb all*/ -+ s1Byte cfosho[2]; /*DW1 byte 1 DW1 byte2 CCK AGC report and CCK_BB_Power / OFDM Path-A and Path-B short CFO*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ /*this should be checked again because the definition of 8812 and 8814 is different*/ -+/* u1Byte r_cck_rx_enable_pathc:2; cck rx enable pathc[1:0]*/ -+/* u1Byte cck_rx_path:4; cck rx path[3:0]*/ -+ u1Byte resvd_0: 6; -+ u1Byte bt_RF_ch_MSB: 2; /*8812A:2'b0 8814A: bt rf channel keep[7:6]*/ -+#else /*_BIG_ENDIAN_*/ -+ u1Byte bt_RF_ch_MSB: 2; -+ u1Byte resvd_0: 6; -+#endif -+ -+/* DWORD 2*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte ant_div_sw_a: 1; /*8812A: ant_div_sw_a 8814A: 1'b0*/ -+ u1Byte ant_div_sw_b: 1; /*8812A: ant_div_sw_b 8814A: 1'b0*/ -+ u1Byte bt_RF_ch_LSB: 6; /*8812A: 6'b0 8814A: bt rf channel keep[5:0]*/ -+#else /*_BIG_ENDIAN_ */ -+ u1Byte bt_RF_ch_LSB: 6; -+ u1Byte ant_div_sw_b: 1; -+ u1Byte ant_div_sw_a: 1; -+#endif -+ s1Byte cfotail[2]; /*DW2 byte 1 DW2 byte 2 path-A and path-B CFO tail*/ -+ u1Byte PCTS_MSK_RPT_0; /*PCTS mask report[7:0]*/ -+ u1Byte PCTS_MSK_RPT_1; /*PCTS mask report[15:8]*/ -+ -+/* DWORD 3*/ -+ s1Byte rxevm[2]; /*DW3 byte 1 DW3 byte 2 stream 1 and stream 2 RX EVM*/ -+ s1Byte rxsnr[2]; /*DW3 byte 3 DW4 byte 0 path-A and path-B RX SNR*/ -+ -+/* DWORD 4*/ -+ u1Byte PCTS_MSK_RPT_2; /*PCTS mask report[23:16]*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte PCTS_MSK_RPT_3: 6; /*PCTS mask report[29:24]*/ -+ u1Byte pcts_rpt_valid: 1; /*pcts_rpt_valid*/ -+ u1Byte resvd_1: 1; /*1'b0*/ -+#else /*_BIG_ENDIAN_*/ -+ u1Byte resvd_1: 1; -+ u1Byte pcts_rpt_valid: 1; -+ u1Byte PCTS_MSK_RPT_3: 6; -+#endif -+ s1Byte rxevm_cd[2]; /*DW 4 byte 3 DW5 byte 0 8812A: 16'b0 8814A: stream 3 and stream 4 RX EVM*/ -+ -+/* DWORD 5*/ -+ u1Byte csi_current[2]; /*DW5 byte 1 DW5 byte 2 8812A: stream 1 and 2 CSI 8814A: path-C and path-D RX SNR*/ -+ u1Byte gain_trsw_cd[2]; /*DW5 byte 3 DW6 byte 0 path-C and path-D {TRSW, gain[6:0] }*/ -+ -+/* DWORD 6*/ -+ s1Byte sigevm; /*signal field EVM*/ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte antidx_antc: 3; /*8812A: 3'b0 8814A: antidx_antc[2:0]*/ -+ u1Byte antidx_antd: 3; /*8812A: 3'b0 8814A: antidx_antd[2:0]*/ -+ u1Byte dpdt_ctrl_keep: 1; /*8812A: 1'b0 8814A: dpdt_ctrl_keep*/ -+ u1Byte GNT_BT_keep: 1; /*8812A: 1'b0 8814A: GNT_BT_keep*/ -+#else /*_BIG_ENDIAN_*/ -+ u1Byte GNT_BT_keep: 1; -+ u1Byte dpdt_ctrl_keep: 1; -+ u1Byte antidx_antd: 3; -+ u1Byte antidx_antc: 3; -+#endif -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte antidx_anta: 3; /*antidx_anta[2:0]*/ -+ u1Byte antidx_antb: 3; /*antidx_antb[2:0]*/ -+ u1Byte hw_antsw_occur: 2; /*1'b0*/ -+#else /*_BIG_ENDIAN_*/ -+ u1Byte hw_antsw_occur: 2; -+ u1Byte antidx_antb: 3; -+ u1Byte antidx_anta: 3; -+#endif -+} PHY_STATUS_RPT_8812_T, *PPHY_STATUS_RPT_8812_T; -+ -+VOID -+phydm_reset_rssi_for_dm( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN u1Byte station_id -+); -+ -+VOID -+odm_Init_RSSIForDM( -+ IN OUT PDM_ODM_T pDM_Odm -+); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+phydm_normal_driver_rx_sniffer( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN pu1Byte pDesc, -+ IN PRT_RFD_STATUS pRtRfdStatus, -+ IN pu1Byte pDrvInfo, -+ IN u1Byte PHYStatus -+ ); -+#endif -+ -+VOID -+ODM_PhyStatusQuery( -+ IN OUT PDM_ODM_T pDM_Odm, -+ OUT PODM_PHY_INFO_T pPhyInfo, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo -+ ); -+ -+VOID -+ODM_MacStatusQuery( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN pu1Byte pMacStatus, -+ IN u1Byte MacID, -+ IN BOOLEAN bPacketMatchBSSID, -+ IN BOOLEAN bPacketToSelf, -+ IN BOOLEAN bPacketBeacon -+ ); -+ -+HAL_STATUS -+ODM_ConfigRFWithTxPwrTrackHeaderFile( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+HAL_STATUS -+ODM_ConfigRFWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_Config_Type ConfigType, -+ IN ODM_RF_RADIO_PATH_E eRFPath -+ ); -+ -+HAL_STATUS -+ODM_ConfigBBWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_BB_Config_Type ConfigType -+ ); -+ -+HAL_STATUS -+ODM_ConfigMACWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+HAL_STATUS -+ODM_ConfigFWWithHeaderFile( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_FW_Config_Type ConfigType, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pSize -+ ); -+ -+u4Byte -+ODM_GetHWImgVersion( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+s4Byte -+odm_SignalScaleMapping( -+ IN OUT PDM_ODM_T pDM_Odm, -+ IN s4Byte CurrSig -+ ); -+ -+#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -+/*For 8822B only!! need to move to FW finally */ -+/*==============================================*/ -+VOID -+phydm_RxPhyStatusNewType( -+ IN PDM_ODM_T pPhydm, -+ IN pu1Byte pPhyStatus, -+ IN PODM_PACKET_INFO_T pPktinfo, -+ OUT PODM_PHY_INFO_T pPhyInfo -+); -+ -+typedef struct _Phy_Status_Rpt_Jaguar2_Type0 { -+ /* DW0 */ -+ u1Byte page_num; -+ u1Byte pwdb; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte gain: 6; -+ u1Byte rsvd_0: 1; -+ u1Byte trsw: 1; -+#else -+ u1Byte trsw: 1; -+ u1Byte rsvd_0: 1; -+ u1Byte gain: 6; -+#endif -+ u1Byte rsvd_1; -+ -+ /* DW1 */ -+ u1Byte rsvd_2; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte rxsc: 4; -+ u1Byte agc_table: 4; -+#else -+ u1Byte agc_table: 4; -+ u1Byte rxsc: 4; -+#endif -+ u1Byte channel; -+ u1Byte band; -+ -+ /* DW2 */ -+ u2Byte length; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte antidx_a: 3; -+ u1Byte antidx_b: 3; -+ u1Byte rsvd_3: 2; -+ u1Byte antidx_c: 3; -+ u1Byte antidx_d: 3; -+ u1Byte rsvd_4:2; -+#else -+ u1Byte rsvd_3: 2; -+ u1Byte antidx_b: 3; -+ u1Byte antidx_a: 3; -+ u1Byte rsvd_4:2; -+ u1Byte antidx_d: 3; -+ u1Byte antidx_c: 3; -+#endif -+ -+ /* DW3 */ -+ u1Byte signal_quality; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte vga:5; -+ u1Byte lna_l:3; -+ u1Byte bb_power:6; -+ u1Byte rsvd_9:1; -+ u1Byte lna_h:1; -+#else -+ u1Byte lna_l:3; -+ u1Byte vga:5; -+ u1Byte lna_h:1; -+ u1Byte rsvd_9:1; -+ u1Byte bb_power:6; -+#endif -+ u1Byte rsvd_5; -+ -+ /* DW4 */ -+ u4Byte rsvd_6; -+ -+ /* DW5 */ -+ u4Byte rsvd_7; -+ -+ /* DW6 */ -+ u4Byte rsvd_8; -+} PHY_STATUS_RPT_JAGUAR2_TYPE0, *PPHY_STATUS_RPT_JAGUAR2_TYPE0; -+ -+typedef struct _Phy_Status_Rpt_Jaguar2_Type1 { -+ /* DW0 and DW1 */ -+ u1Byte page_num; -+ u1Byte pwdb[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte l_rxsc: 4; -+ u1Byte ht_rxsc: 4; -+#else -+ u1Byte ht_rxsc: 4; -+ u1Byte l_rxsc: 4; -+#endif -+ u1Byte channel; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte band: 2; -+ u1Byte rsvd_0: 1; -+ u1Byte hw_antsw_occu: 1; -+ u1Byte gnt_bt: 1; -+ u1Byte ldpc: 1; -+ u1Byte stbc: 1; -+ u1Byte beamformed: 1; -+#else -+ u1Byte beamformed: 1; -+ u1Byte stbc: 1; -+ u1Byte ldpc: 1; -+ u1Byte gnt_bt: 1; -+ u1Byte hw_antsw_occu: 1; -+ u1Byte rsvd_0: 1; -+ u1Byte band: 2; -+#endif -+ -+ /* DW2 */ -+ u2Byte lsig_length; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte antidx_a: 3; -+ u1Byte antidx_b: 3; -+ u1Byte rsvd_1: 2; -+ u1Byte antidx_c: 3; -+ u1Byte antidx_d: 3; -+ u1Byte rsvd_2: 2; -+#else -+ u1Byte rsvd_1: 2; -+ u1Byte antidx_b: 3; -+ u1Byte antidx_a: 3; -+ u1Byte rsvd_2: 2; -+ u1Byte antidx_d: 3; -+ u1Byte antidx_c: 3; -+#endif -+ -+ /* DW3 */ -+ u1Byte paid; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte paid_msb: 1; -+ u1Byte gid: 6; -+ u1Byte rsvd_3: 1; -+#else -+ u1Byte rsvd_3: 1; -+ u1Byte gid: 6; -+ u1Byte paid_msb: 1; -+#endif -+ u1Byte intf_pos; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte intf_pos_msb: 1; -+ u1Byte rsvd_4: 2; -+ u1Byte nb_intf_flag: 1; -+ u1Byte rf_mode: 2; -+ u1Byte rsvd_5: 2; -+#else -+ u1Byte rsvd_5: 2; -+ u1Byte rf_mode: 2; -+ u1Byte nb_intf_flag: 1; -+ u1Byte rsvd_4: 2; -+ u1Byte intf_pos_msb: 1; -+#endif -+ -+ /* DW4 */ -+ s1Byte rxevm[4]; /* s(8,1) */ -+ -+ /* DW5 */ -+ s1Byte cfo_tail[4]; /* s(8,7) */ -+ -+ /* DW6 */ -+ s1Byte rxsnr[4]; /* s(8,1) */ -+} PHY_STATUS_RPT_JAGUAR2_TYPE1, *PPHY_STATUS_RPT_JAGUAR2_TYPE1; -+ -+typedef struct _Phy_Status_Rpt_Jaguar2_Type2 { -+ /* DW0 ane DW1 */ -+ u1Byte page_num; -+ u1Byte pwdb[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte l_rxsc: 4; -+ u1Byte ht_rxsc: 4; -+#else -+ u1Byte ht_rxsc: 4; -+ u1Byte l_rxsc: 4; -+#endif -+ u1Byte channel; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte band: 2; -+ u1Byte rsvd_0: 1; -+ u1Byte hw_antsw_occu: 1; -+ u1Byte gnt_bt: 1; -+ u1Byte ldpc: 1; -+ u1Byte stbc: 1; -+ u1Byte beamformed: 1; -+#else -+ u1Byte beamformed: 1; -+ u1Byte stbc: 1; -+ u1Byte ldpc: 1; -+ u1Byte gnt_bt: 1; -+ u1Byte hw_antsw_occu: 1; -+ u1Byte rsvd_0: 1; -+ u1Byte band: 2; -+#endif -+ -+ /* DW2 */ -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte shift_l_map: 6; -+ u1Byte rsvd_1: 2; -+#else -+ u1Byte rsvd_1: 2; -+ u1Byte shift_l_map: 6; -+#endif -+ u1Byte cnt_pw2cca; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte agc_table_a: 4; -+ u1Byte agc_table_b: 4; -+ u1Byte agc_table_c: 4; -+ u1Byte agc_table_d: 4; -+#else -+ u1Byte agc_table_b: 4; -+ u1Byte agc_table_a: 4; -+ u1Byte agc_table_d: 4; -+ u1Byte agc_table_c: 4; -+#endif -+ -+ /* DW3 ~ DW6*/ -+ u1Byte cnt_cca2agc_rdy; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte gain_a: 6; -+ u1Byte rsvd_2: 1; -+ u1Byte trsw_a: 1; -+ u1Byte gain_b: 6; -+ u1Byte rsvd_3: 1; -+ u1Byte trsw_b: 1; -+ u1Byte gain_c: 6; -+ u1Byte rsvd_4: 1; -+ u1Byte trsw_c: 1; -+ u1Byte gain_d: 6; -+ u1Byte rsvd_5: 1; -+ u1Byte trsw_d: 1; -+ u1Byte aagc_step_a: 2; -+ u1Byte aagc_step_b: 2; -+ u1Byte aagc_step_c: 2; -+ u1Byte aagc_step_d: 2; -+#else -+ u1Byte trsw_a: 1; -+ u1Byte rsvd_2: 1; -+ u1Byte gain_a: 6; -+ u1Byte trsw_b: 1; -+ u1Byte rsvd_3: 1; -+ u1Byte gain_b: 6; -+ u1Byte trsw_c: 1; -+ u1Byte rsvd_4: 1; -+ u1Byte gain_c: 6; -+ u1Byte trsw_d: 1; -+ u1Byte rsvd_5: 1; -+ u1Byte gain_d: 6; -+ u1Byte aagc_step_d: 2; -+ u1Byte aagc_step_c: 2; -+ u1Byte aagc_step_b: 2; -+ u1Byte aagc_step_a: 2; -+#endif -+ u1Byte ht_aagc_gain[4]; -+ u1Byte dagc_gain[4]; -+#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) -+ u1Byte counter: 6; -+ u1Byte rsvd_6: 2; -+ u1Byte syn_count: 5; -+ u1Byte rsvd_7:3; -+#else -+ u1Byte rsvd_6: 2; -+ u1Byte counter: 6; -+ u1Byte rsvd_7:3; -+ u1Byte syn_count: 5; -+#endif -+} PHY_STATUS_RPT_JAGUAR2_TYPE2, *PPHY_STATUS_RPT_JAGUAR2_TYPE2; -+/*==============================================*/ -+#endif /*#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1)*/ -+ -+u4Byte -+query_phydm_trx_capability( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+u4Byte -+query_phydm_stbc_capability( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+u4Byte -+query_phydm_ldpc_capability( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+u4Byte -+query_phydm_txbf_parameters( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+u4Byte -+query_phydm_txbf_capability( -+ IN PDM_ODM_T pDM_Odm -+); -+ -+#endif /*#ifndef __HALHWOUTSRC_H__*/ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_interface.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_interface.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_interface.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_interface.c 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,958 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+// -+// ODM IO Relative API. -+// -+ -+u1Byte -+ODM_Read1Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ return RTL_R8(RegAddr); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return rtw_read8(Adapter,RegAddr); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return PlatformEFIORead1Byte(Adapter, RegAddr); -+#endif -+ -+} -+ -+ -+u2Byte -+ODM_Read2Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ return RTL_R16(RegAddr); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return rtw_read16(Adapter,RegAddr); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return PlatformEFIORead2Byte(Adapter, RegAddr); -+#endif -+ -+} -+ -+ -+u4Byte -+ODM_Read4Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ return RTL_R32(RegAddr); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return rtw_read32(Adapter,RegAddr); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return PlatformEFIORead4Byte(Adapter, RegAddr); -+#endif -+ -+} -+ -+ -+VOID -+ODM_Write1Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u1Byte Data -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ RTL_W8(RegAddr, Data); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ rtw_write8(Adapter,RegAddr, Data); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformEFIOWrite1Byte(Adapter, RegAddr, Data); -+#endif -+ -+} -+ -+ -+VOID -+ODM_Write2Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u2Byte Data -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ RTL_W16(RegAddr, Data); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ rtw_write16(Adapter,RegAddr, Data); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformEFIOWrite2Byte(Adapter, RegAddr, Data); -+#endif -+ -+} -+ -+ -+VOID -+ODM_Write4Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte Data -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ RTL_W32(RegAddr, Data); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ rtw_write32(Adapter,RegAddr, Data); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformEFIOWrite4Byte(Adapter, RegAddr, Data); -+#endif -+ -+} -+ -+ -+VOID -+ODM_SetMACReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ PHY_SetBBReg(pDM_Odm->priv, RegAddr, BitMask, Data); -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHY_SetBBReg(Adapter, RegAddr, BitMask, Data); -+#endif -+} -+ -+ -+u4Byte -+ODM_GetMACReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return PHY_QueryBBReg(pDM_Odm->priv, RegAddr, BitMask); -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ return PHY_QueryMacReg(pDM_Odm->Adapter, RegAddr, BitMask); -+#endif -+} -+ -+ -+VOID -+ODM_SetBBReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ PHY_SetBBReg(pDM_Odm->priv, RegAddr, BitMask, Data); -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHY_SetBBReg(Adapter, RegAddr, BitMask, Data); -+#endif -+} -+ -+ -+u4Byte -+ODM_GetBBReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return PHY_QueryBBReg(pDM_Odm->priv, RegAddr, BitMask); -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return PHY_QueryBBReg(Adapter, RegAddr, BitMask); -+#endif -+} -+ -+ -+VOID -+ODM_SetRFReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PHY_SetRFReg(pDM_Odm->priv, eRFPath, RegAddr, BitMask, Data); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHY_SetRFReg(Adapter, eRFPath, RegAddr, BitMask, Data); -+ ODM_delay_us(2); -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PHY_SetRFReg(pDM_Odm->Adapter, eRFPath, RegAddr, BitMask, Data); -+#endif -+} -+ -+u4Byte -+ODM_GetRFReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return PHY_QueryRFReg(pDM_Odm->priv, eRFPath, RegAddr, BitMask, 1); -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ return PHY_QueryRFReg(Adapter, eRFPath, RegAddr, BitMask); -+#endif -+} -+ -+ -+ -+ -+// -+// ODM Memory relative API. -+// -+VOID -+ODM_AllocateMemory( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PVOID *pPtr, -+ IN u4Byte length -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ *pPtr = kmalloc(length, GFP_ATOMIC); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) -+ *pPtr = rtw_zvmalloc(length); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformAllocateMemory(Adapter, pPtr, length); -+#endif -+} -+ -+// length could be ignored, used to detect memory leakage. -+VOID -+ODM_FreeMemory( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PVOID pPtr, -+ IN u4Byte length -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ kfree(pPtr); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) -+ rtw_vmfree(pPtr, length); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ //PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformFreeMemory(pPtr, length); -+#endif -+} -+ -+VOID -+ODM_MoveMemory( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PVOID pDest, -+ IN PVOID pSrc, -+ IN u4Byte Length -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ memcpy(pDest, pSrc, Length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) -+ _rtw_memcpy(pDest, pSrc, Length); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformMoveMemory(pDest, pSrc, Length); -+#endif -+} -+ -+void ODM_Memory_Set( -+ IN PDM_ODM_T pDM_Odm, -+ IN PVOID pbuf, -+ IN s1Byte value, -+ IN u4Byte length -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ memset(pbuf, value, length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) -+ _rtw_memset(pbuf,value, length); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformFillMemory(pbuf,length,value); -+#endif -+} -+s4Byte ODM_CompareMemory( -+ IN PDM_ODM_T pDM_Odm, -+ IN PVOID pBuf1, -+ IN PVOID pBuf2, -+ IN u4Byte length -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return memcmp(pBuf1,pBuf2,length); -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) -+ return _rtw_memcmp(pBuf1,pBuf2,length); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return PlatformCompareMemory(pBuf1,pBuf2,length); -+#endif -+} -+ -+ -+ -+// -+// ODM MISC relative API. -+// -+VOID -+ODM_AcquireSpinLock( -+ IN PDM_ODM_T pDM_Odm, -+ IN RT_SPINLOCK_TYPE type -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ rtw_odm_acquirespinlock(Adapter, type); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformAcquireSpinLock(Adapter, type); -+#endif -+} -+VOID -+ODM_ReleaseSpinLock( -+ IN PDM_ODM_T pDM_Odm, -+ IN RT_SPINLOCK_TYPE type -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ rtw_odm_releasespinlock(Adapter, type); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformReleaseSpinLock(Adapter, type); -+#endif -+} -+ -+// -+// Work item relative API. FOr MP driver only~! -+// -+VOID -+ODM_InitializeWorkItem( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_WORK_ITEM pRtWorkItem, -+ IN RT_WORKITEM_CALL_BACK RtWorkItemCallback, -+ IN PVOID pContext, -+ IN const char* szID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformInitializeWorkItem(Adapter, pRtWorkItem, RtWorkItemCallback, pContext, szID); -+#endif -+} -+ -+ -+VOID -+ODM_StartWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformStartWorkItem(pRtWorkItem); -+#endif -+} -+ -+ -+VOID -+ODM_StopWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformStopWorkItem(pRtWorkItem); -+#endif -+} -+ -+ -+VOID -+ODM_FreeWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformFreeWorkItem(pRtWorkItem); -+#endif -+} -+ -+ -+VOID -+ODM_ScheduleWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformScheduleWorkItem(pRtWorkItem); -+#endif -+} -+ -+ -+VOID -+ODM_IsWorkItemScheduled( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformIsWorkItemScheduled(pRtWorkItem); -+#endif -+} -+ -+ -+ -+// -+// ODM Timer relative API. -+// -+VOID -+ODM_StallExecution( -+ IN u4Byte usDelay -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_udelay_os(usDelay); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformStallExecution(usDelay); -+#endif -+} -+ -+VOID -+ODM_delay_ms(IN u4Byte ms) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ delay_ms(ms); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_mdelay_os(ms); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ delay_ms(ms); -+#endif -+} -+ -+VOID -+ODM_delay_us(IN u4Byte us) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ delay_us(us); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_udelay_os(us); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PlatformStallExecution(us); -+#endif -+} -+ -+VOID -+ODM_sleep_ms(IN u4Byte ms) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_msleep_os(ms); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#endif -+} -+ -+VOID -+ODM_sleep_us(IN u4Byte us) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_usleep_os(us); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+#endif -+} -+ -+VOID -+ODM_SetTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer, -+ IN u4Byte msDelay -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ mod_timer(pTimer, jiffies + RTL_MILISECONDS_TO_JIFFIES(msDelay)); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ _set_timer(pTimer,msDelay ); //ms -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformSetTimer(Adapter, pTimer, msDelay); -+#endif -+ -+} -+ -+VOID -+ODM_InitializeTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer, -+ IN RT_TIMER_CALL_BACK CallBackFunc, -+ IN PVOID pContext, -+ IN const char* szID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ init_timer(pTimer); -+ pTimer->function = CallBackFunc; -+ pTimer->data = (unsigned long)pDM_Odm; -+ /*mod_timer(pTimer, jiffies+RTL_MILISECONDS_TO_JIFFIES(10)); */ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ _init_timer(pTimer,Adapter->pnetdev,CallBackFunc,pDM_Odm); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformInitializeTimer(Adapter, pTimer, CallBackFunc,pContext,szID); -+#endif -+} -+ -+ -+VOID -+ODM_CancelTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ del_timer(pTimer); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ _cancel_timer_ex(pTimer); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PlatformCancelTimer(Adapter, pTimer); -+#endif -+} -+ -+ -+VOID -+ODM_ReleaseTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ // <20120301, Kordan> If the initilization fails, InitializeAdapterXxx will return regardless of InitHalDm. -+ // Hence, uninitialized timers cause BSOD when the driver releases resources since the init fail. -+ if (pTimer == 0) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_SERIOUS, ("=====>ODM_ReleaseTimer(), The timer is NULL! Please check it!\n")); -+ return; -+ } -+ -+ PlatformReleaseTimer(Adapter, pTimer); -+#endif -+} -+ -+ -+u1Byte -+phydm_trans_h2c_id( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte phydm_h2c_id -+) -+{ -+ u1Byte platform_h2c_id = phydm_h2c_id; -+ -+ switch (phydm_h2c_id) -+ { -+ //1 [0] -+ case ODM_H2C_RSSI_REPORT: -+ -+ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if(pDM_Odm->SupportICType == ODM_RTL8188E) -+ platform_h2c_id = H2C_88E_RSSI_REPORT; -+ else if(pDM_Odm->SupportICType == ODM_RTL8814A) -+ platform_h2c_id =H2C_8814A_RSSI_REPORT; -+ else -+ platform_h2c_id = H2C_RSSI_REPORT; -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ platform_h2c_id = H2C_RSSI_SETTING; -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) -+ platform_h2c_id = H2C_88XX_RSSI_REPORT; -+ else -+ #endif -+ #if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ platform_h2c_id = H2C_8812_RSSI_REPORT; -+ else -+ #endif -+ {} -+ #endif -+ -+ break; -+ -+ //1 [3] -+ case ODM_H2C_WIFI_CALIBRATION: -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ platform_h2c_id =H2C_WIFI_CALIBRATION; -+ -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ #if (RTL8723B_SUPPORT == 1) -+ platform_h2c_id = H2C_8723B_BT_WLAN_CALIBRATION; -+ #endif -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #endif -+ break; -+ -+ -+ //1 [4] -+ case ODM_H2C_IQ_CALIBRATION: -+ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ platform_h2c_id =H2C_IQ_CALIBRATION; -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ #if((RTL8812A_SUPPORT==1) ||(RTL8821A_SUPPORT==1)) -+ platform_h2c_id = H2C_8812_IQ_CALIBRATION; -+ #endif -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #endif -+ -+ break; -+ //1 [5] -+ case ODM_H2C_RA_PARA_ADJUST: -+ -+ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B)) -+ platform_h2c_id =H2C_8814A_RA_PARA_ADJUST; -+ else -+ platform_h2c_id = H2C_RA_PARA_ADJUST; -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ #if((RTL8812A_SUPPORT==1) ||(RTL8821A_SUPPORT==1)) -+ platform_h2c_id = H2C_8812_RA_PARA_ADJUST; -+ #elif ((RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1)) -+ platform_h2c_id = H2C_RA_PARA_ADJUST; -+ #elif(RTL8192E_SUPPORT==1) -+ platform_h2c_id =H2C_8192E_RA_PARA_ADJUST; -+ #elif(RTL8723B_SUPPORT==1) -+ platform_h2c_id =H2C_8723B_RA_PARA_ADJUST; -+ #endif -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) -+ platform_h2c_id = H2C_88XX_RA_PARA_ADJUST; -+ else -+ #endif -+ #if(RTL8812A_SUPPORT==1) -+ if(pDM_Odm->SupportICType == ODM_RTL8812) -+ platform_h2c_id = H2C_8812_RA_PARA_ADJUST; -+ else -+ #endif -+ {} -+ #endif -+ -+ break; -+ -+ -+ //1 [6] -+ case PHYDM_H2C_DYNAMIC_TX_PATH: -+ -+ #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if(pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ platform_h2c_id =H2C_8814A_DYNAMIC_TX_PATH; -+ } -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ #if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ platform_h2c_id = H2C_DYNAMIC_TX_PATH; -+ #endif -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #if(RTL8814A_SUPPORT==1) -+ if( pDM_Odm->SupportICType == ODM_RTL8814A) -+ { -+ platform_h2c_id = H2C_88XX_DYNAMIC_TX_PATH; -+ } -+ #endif -+ -+ #endif -+ -+ break; -+ -+ /* [7]*/ -+ case PHYDM_H2C_FW_TRACE_EN: -+ -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B)) -+ platform_h2c_id = H2C_8814A_FW_TRACE_EN; -+ else -+ platform_h2c_id = H2C_FW_TRACE_EN; -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ -+ platform_h2c_id = 0x49; -+ -+ #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ #if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) -+ platform_h2c_id = H2C_88XX_FW_TRACE_EN; -+ else -+ #endif -+ #if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ platform_h2c_id = H2C_8812_FW_TRACE_EN; -+ else -+ #endif -+ {} -+ -+ #endif -+ -+ break; -+ -+ case PHYDM_H2C_TXBF: -+ #if ((RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1)) -+ platform_h2c_id = 0x41; /*H2C_TxBF*/ -+ #endif -+ break; -+ -+ case PHYDM_H2C_MU: -+ #if (RTL8822B_SUPPORT == 1) -+ platform_h2c_id = 0x4a; /*H2C_MU*/ -+ #endif -+ break; -+ -+ default: -+ platform_h2c_id = phydm_h2c_id; -+ break; -+ } -+ -+ return platform_h2c_id; -+ -+} -+ -+/*ODM FW relative API.*/ -+ -+VOID -+ODM_FillH2CCmd( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte phydm_h2c_id, -+ IN u4Byte CmdLen, -+ IN pu1Byte pCmdBuffer -+) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ u1Byte platform_h2c_id; -+ -+ platform_h2c_id=phydm_trans_h2c_id(pDM_Odm, phydm_h2c_id); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] platform_h2c_id = ((0x%x))\n", platform_h2c_id)); -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+ if (!pDM_Odm->RaSupport88E) -+ FillH2CCmd88E(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); -+ } else if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ FillH2CCmd8814A(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); -+ else if (pDM_Odm->SupportICType == ODM_RTL8822B) -+#if (RTL8822B_SUPPORT == 1) -+ FillH2CCmd8822B(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); -+#endif -+ else -+ FillH2CCmd(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ rtw_hal_fill_h2c_cmd(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -+#if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) -+ GET_HAL_INTERFACE(pDM_Odm->priv)->FillH2CCmdHandler(pDM_Odm->priv, platform_h2c_id, CmdLen, pCmdBuffer); -+ else -+#endif -+#if (RTL8812A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ FillH2CCmd8812(pDM_Odm->priv, platform_h2c_id, CmdLen, pCmdBuffer); -+ else -+#endif -+ {} -+#endif -+} -+ -+u1Byte -+phydm_c2H_content_parsing( -+ IN PVOID pDM_VOID, -+ IN u1Byte c2hCmdId, -+ IN u1Byte c2hCmdLen, -+ IN pu1Byte tmpBuf -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ #endif -+ u1Byte Extend_c2hSubID = 0; -+ u1Byte find_c2h_cmd = TRUE; -+ -+ switch (c2hCmdId) { -+ case PHYDM_C2H_DBG: -+ phydm_fw_trace_handler(pDM_Odm, tmpBuf, c2hCmdLen); -+ break; -+ -+ case PHYDM_C2H_RA_RPT: -+ phydm_c2h_ra_report_handler(pDM_Odm, tmpBuf, c2hCmdLen); -+ break; -+ -+ case PHYDM_C2H_RA_PARA_RPT: -+ ODM_C2HRaParaReportHandler(pDM_Odm, tmpBuf, c2hCmdLen); -+ break; -+ -+ case PHYDM_C2H_DYNAMIC_TX_PATH_RPT: -+ if (pDM_Odm->SupportICType & (ODM_RTL8814A)) -+ phydm_c2h_dtp_handler(pDM_Odm, tmpBuf, c2hCmdLen); -+ break; -+ -+ case PHYDM_C2H_IQK_FINISH: -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) { -+ -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK Finish ==\n")); -+ PlatformAcquireSpinLock(Adapter, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; -+ PlatformReleaseSpinLock(Adapter, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime = 0; -+ pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime = ODM_GetProgressingTime(pDM_Odm, pDM_Odm->RFCalibrateInfo.IQK_StartTime); -+ } -+ -+ #endif -+ break; -+ -+ case PHYDM_C2H_DBG_CODE: -+ phydm_fw_trace_handler_code(pDM_Odm, tmpBuf, c2hCmdLen); -+ break; -+ -+ case PHYDM_C2H_EXTEND: -+ Extend_c2hSubID= tmpBuf[0]; -+ if (Extend_c2hSubID == PHYDM_EXTEND_C2H_DBG_PRINT) -+ phydm_fw_trace_handler_8051(pDM_Odm, tmpBuf, c2hCmdLen); -+ -+ break; -+ -+ default: -+ find_c2h_cmd = FALSE; -+ break; -+ } -+ -+ return find_c2h_cmd; -+ -+} -+ -+u8Byte -+ODM_GetCurrentTime( -+ IN PDM_ODM_T pDM_Odm -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return 0; -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ return (u8Byte)rtw_get_current_time(); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return PlatformGetCurrentTime(); -+#endif -+} -+ -+u8Byte -+ODM_GetProgressingTime( -+ IN PDM_ODM_T pDM_Odm, -+ IN u8Byte Start_Time -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ return 0; -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ return rtw_get_passing_time_ms((u4Byte)Start_Time); -+#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ return ((PlatformGetCurrentTime() - Start_Time)>>10); -+#endif -+} -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_interface.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_interface.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_interface.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_interface.h 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,426 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __ODM_INTERFACE_H__ -+#define __ODM_INTERFACE_H__ -+ -+#define INTERFACE_VERSION "1.1" /*2015.07.29 YuChen*/ -+ -+// -+// =========== Constant/Structure/Enum/... Define -+// -+ -+ -+ -+// -+// =========== Macro Define -+// -+ -+#define _reg_all(_name) ODM_##_name -+#define _reg_ic(_name, _ic) ODM_##_name##_ic -+#define _bit_all(_name) BIT_##_name -+#define _bit_ic(_name, _ic) BIT_##_name##_ic -+ -+// _cat: implemented by Token-Pasting Operator. -+#if 0 -+#define _cat(_name, _ic_type, _func) \ -+ ( \ -+ _func##_all(_name) \ -+ ) -+#endif -+ -+/*=================================== -+ -+#define ODM_REG_DIG_11N 0xC50 -+#define ODM_REG_DIG_11AC 0xDDD -+ -+ODM_REG(DIG,_pDM_Odm) -+=====================================*/ -+ -+#define _reg_11N(_name) ODM_REG_##_name##_11N -+#define _reg_11AC(_name) ODM_REG_##_name##_11AC -+#define _bit_11N(_name) ODM_BIT_##_name##_11N -+#define _bit_11AC(_name) ODM_BIT_##_name##_11AC -+ -+#ifdef __ECOS -+#define _rtk_cat(_name, _ic_type, _func) \ -+ ( \ -+ ((_ic_type) & ODM_IC_11N_SERIES)? _func##_11N(_name): \ -+ _func##_11AC(_name) \ -+ ) -+#else -+ -+#define _cat(_name, _ic_type, _func) \ -+ ( \ -+ ((_ic_type) & ODM_IC_11N_SERIES)? _func##_11N(_name): \ -+ _func##_11AC(_name) \ -+ ) -+#endif -+/* -+// only sample code -+//#define _cat(_name, _ic_type, _func) \ -+// ( \ -+// ((_ic_type) & ODM_RTL8188E)? _func##_ic(_name, _8188E): \ -+// _func##_ic(_name, _8195) \ -+// ) -+*/ -+ -+// _name: name of register or bit. -+// Example: "ODM_REG(R_A_AGC_CORE1, pDM_Odm)" -+// gets "ODM_R_A_AGC_CORE1" or "ODM_R_A_AGC_CORE1_8192C", depends on SupportICType. -+#ifdef __ECOS -+#define ODM_REG(_name, _pDM_Odm) _rtk_cat(_name, _pDM_Odm->SupportICType, _reg) -+#define ODM_BIT(_name, _pDM_Odm) _rtk_cat(_name, _pDM_Odm->SupportICType, _bit) -+#else -+#define ODM_REG(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _reg) -+#define ODM_BIT(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _bit) -+#endif -+typedef enum _PHYDM_H2C_CMD { -+ PHYDM_H2C_TXBF = 0x41, -+ ODM_H2C_RSSI_REPORT = 0x42, -+ ODM_H2C_IQ_CALIBRATION = 0x45, -+ ODM_H2C_RA_PARA_ADJUST = 0x47, -+ PHYDM_H2C_DYNAMIC_TX_PATH = 0x48, -+ PHYDM_H2C_FW_TRACE_EN = 0x49, -+ ODM_H2C_WIFI_CALIBRATION = 0x6d, -+ PHYDM_H2C_MU = 0x4a, -+ ODM_MAX_H2CCMD -+}PHYDM_H2C_CMD; -+ -+typedef enum _PHYDM_C2H_EVT { -+ PHYDM_C2H_DBG = 0, -+ PHYDM_C2H_LB = 1, -+ PHYDM_C2H_XBF = 2, -+ PHYDM_C2H_TX_REPORT = 3, -+ PHYDM_C2H_INFO = 9, -+ PHYDM_C2H_BT_MP = 11, -+ PHYDM_C2H_RA_RPT = 12, -+ PHYDM_C2H_RA_PARA_RPT=14, -+ PHYDM_C2H_DYNAMIC_TX_PATH_RPT = 15, -+ PHYDM_C2H_IQK_FINISH = 17, /*0x11*/ -+ PHYDM_C2H_DBG_CODE = 0xFE, -+ PHYDM_C2H_EXTEND = 0xFF, -+}PHYDM_C2H_EVT; -+ -+typedef enum _PHYDM_EXTEND_C2H_EVT { -+ PHYDM_EXTEND_C2H_DBG_PRINT = 0 -+ -+}PHYDM_EXTEND_C2H_EVT; -+ -+ -+// -+// 2012/02/17 MH For non-MP compile pass only. Linux does not support workitem. -+// Suggest HW team to use thread instead of workitem. Windows also support the feature. -+// -+#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) -+typedef void *PRT_WORK_ITEM ; -+typedef void RT_WORKITEM_HANDLE,*PRT_WORKITEM_HANDLE; -+typedef VOID (*RT_WORKITEM_CALL_BACK)(PVOID pContext); -+ -+#if 0 -+typedef struct tasklet_struct RT_WORKITEM_HANDLE, *PRT_WORKITEM_HANDLE; -+ -+typedef struct _RT_WORK_ITEM -+{ -+ -+ RT_WORKITEM_HANDLE Handle; // Platform-dependent handle for this workitem, e.g. Ndis Workitem object. -+ PVOID Adapter; // Pointer to Adapter object. -+ PVOID pContext; // Parameter to passed to CallBackFunc(). -+ RT_WORKITEM_CALL_BACK CallbackFunc; // Callback function of the workitem. -+ u1Byte RefCount; // 0: driver is going to unload, 1: No such workitem scheduled, 2: one workitem is schedueled. -+ PVOID pPlatformExt; // Pointer to platform-dependent extension. -+ BOOLEAN bFree; -+ char szID[36]; // An identity string of this workitem. -+}RT_WORK_ITEM, *PRT_WORK_ITEM; -+ -+#endif -+ -+ -+#endif -+ -+// -+// =========== Extern Variable ??? It should be forbidden. -+// -+ -+ -+// -+// =========== EXtern Function Prototype -+// -+ -+ -+u1Byte -+ODM_Read1Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr -+ ); -+ -+u2Byte -+ODM_Read2Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr -+ ); -+ -+u4Byte -+ODM_Read4Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr -+ ); -+ -+VOID -+ODM_Write1Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u1Byte Data -+ ); -+ -+VOID -+ODM_Write2Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u2Byte Data -+ ); -+ -+VOID -+ODM_Write4Byte( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte Data -+ ); -+ -+VOID -+ODM_SetMACReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ); -+ -+u4Byte -+ODM_GetMACReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ); -+ -+VOID -+ODM_SetBBReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ); -+ -+u4Byte -+ODM_GetBBReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ); -+ -+VOID -+ODM_SetRFReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask, -+ IN u4Byte Data -+ ); -+ -+u4Byte -+ODM_GetRFReg( -+ IN PDM_ODM_T pDM_Odm, -+ IN ODM_RF_RADIO_PATH_E eRFPath, -+ IN u4Byte RegAddr, -+ IN u4Byte BitMask -+ ); -+ -+ -+// -+// Memory Relative Function. -+// -+VOID -+ODM_AllocateMemory( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PVOID *pPtr, -+ IN u4Byte length -+ ); -+VOID -+ODM_FreeMemory( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PVOID pPtr, -+ IN u4Byte length -+ ); -+ -+VOID -+ODM_MoveMemory( -+ IN PDM_ODM_T pDM_Odm, -+ OUT PVOID pDest, -+ IN PVOID pSrc, -+ IN u4Byte Length -+ ); -+ -+s4Byte ODM_CompareMemory( -+ IN PDM_ODM_T pDM_Odm, -+ IN PVOID pBuf1, -+ IN PVOID pBuf2, -+ IN u4Byte length -+ ); -+ -+void ODM_Memory_Set -+ (IN PDM_ODM_T pDM_Odm, -+ IN PVOID pbuf, -+ IN s1Byte value, -+ IN u4Byte length); -+ -+// -+// ODM MISC-spin lock relative API. -+// -+VOID -+ODM_AcquireSpinLock( -+ IN PDM_ODM_T pDM_Odm, -+ IN RT_SPINLOCK_TYPE type -+ ); -+ -+VOID -+ODM_ReleaseSpinLock( -+ IN PDM_ODM_T pDM_Odm, -+ IN RT_SPINLOCK_TYPE type -+ ); -+ -+ -+// -+// ODM MISC-workitem relative API. -+// -+VOID -+ODM_InitializeWorkItem( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_WORK_ITEM pRtWorkItem, -+ IN RT_WORKITEM_CALL_BACK RtWorkItemCallback, -+ IN PVOID pContext, -+ IN const char* szID -+ ); -+ -+VOID -+ODM_StartWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+VOID -+ODM_StopWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+VOID -+ODM_FreeWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+VOID -+ODM_ScheduleWorkItem( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+VOID -+ODM_IsWorkItemScheduled( -+ IN PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+// -+// ODM Timer relative API. -+// -+VOID -+ODM_StallExecution( -+ IN u4Byte usDelay -+ ); -+ -+VOID -+ODM_delay_ms(IN u4Byte ms); -+ -+ -+ -+VOID -+ODM_delay_us(IN u4Byte us); -+ -+VOID -+ODM_sleep_ms(IN u4Byte ms); -+ -+VOID -+ODM_sleep_us(IN u4Byte us); -+ -+VOID -+ODM_SetTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer, -+ IN u4Byte msDelay -+ ); -+ -+VOID -+ODM_InitializeTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer, -+ IN RT_TIMER_CALL_BACK CallBackFunc, -+ IN PVOID pContext, -+ IN const char* szID -+ ); -+ -+VOID -+ODM_CancelTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer -+ ); -+ -+VOID -+ODM_ReleaseTimer( -+ IN PDM_ODM_T pDM_Odm, -+ IN PRT_TIMER pTimer -+ ); -+ -+// -+// ODM FW relative API. -+// -+VOID -+ODM_FillH2CCmd( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte ElementID, -+ IN u4Byte CmdLen, -+ IN pu1Byte pCmdBuffer -+); -+ -+u1Byte -+phydm_c2H_content_parsing( -+ IN PVOID pDM_VOID, -+ IN u1Byte c2hCmdId, -+ IN u1Byte c2hCmdLen, -+ IN pu1Byte tmpBuf -+); -+ -+u8Byte -+ODM_GetCurrentTime( -+ IN PDM_ODM_T pDM_Odm -+ ); -+u8Byte -+ODM_GetProgressingTime( -+ IN PDM_ODM_T pDM_Odm, -+ IN u8Byte Start_Time -+ ); -+ -+#endif // __ODM_INTERFACE_H__ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_iqk.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_iqk.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_iqk.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_iqk.h 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,61 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMIQK_H__ -+#define __PHYDMIQK_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOK_delay 1 -+#define WBIQK_delay 10 -+#define TX_IQK 0 -+#define RX_IQK 1 -+#define TXIQK 0 -+#define RXIQK1 1 -+#define RXIQK2 2 -+ -+#define NUM 4 -+/*---------------------------End Define Parameters-------------------------------*/ -+ -+typedef struct _IQK_INFORMATION { -+ BOOLEAN LOK_fail[NUM]; -+ BOOLEAN IQK_fail[2][NUM]; -+ u4Byte IQC_Matrix[2][NUM]; -+ u1Byte IQKtimes; -+ u4Byte RFReg18; -+ u4Byte lna_idx; -+ u1Byte rxiqk_step; -+ u1Byte tmp1bcc; -+ -+ u4Byte IQK_Channel[2]; -+ BOOLEAN IQK_fail_report[2][4][2]; /*channel/path/TRX(TX:0, RX:1)*/ -+ u4Byte IQK_CFIR_real[2][4][2][8]; /*channel / path / TRX(TX:0, RX:1) / CFIR_real*/ -+ u4Byte IQK_CFIR_imag[2][4][2][8]; /*channel / path / TRX(TX:0, RX:1) / CFIR_imag*/ -+ u1Byte retry_count[2][4][3]; /*channel / path / (TXK:0, RXK1:1, RXK2:2)*/ -+ u1Byte gs_retry_count[2][4][2]; /*channel / path / (GSRXK1:0, GSRXK2:1)*/ -+ u1Byte RXIQK_fail_code[2][4]; /*channel / path 0:SRXK1 fail, 1:RXK1 fail 2:RXK2 fail*/ -+ u4Byte LOK_IDAC[2][4]; /*channel / path*/ -+ u4Byte RXIQK_AGC[2][4]; /*channel / path*/ -+ u4Byte bypassIQK[2][4]; /*channel / 0xc94/0xe94*/ -+ u4Byte tmp_GNTWL; -+ BOOLEAN is_BTG; -+ -+} IQK_INFO, *PIQK_INFO; -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_kfree.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_kfree.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_kfree.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_kfree.c 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,191 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+/*============================================================*/ -+/*include files*/ -+/*============================================================*/ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+ -+/* Add for KFree Feature Requested by RF David.*/ -+/*This is a phydm API*/ -+ -+VOID -+phydm_SetKfreeToRF_8814A( -+ IN PVOID pDM_VOID, -+ IN u1Byte eRFPath, -+ IN u1Byte Data -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ BOOLEAN bOdd; -+ -+ if ((Data%2) != 0) { /*odd -> positive*/ -+ Data = Data - 1; -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT19, 1); -+ bOdd = TRUE; -+ } else { /*even -> negative*/ -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT19, 0); -+ bOdd = FALSE; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): RF_0x55[19]= %d\n", bOdd)); -+ switch (Data) { -+ case 0: -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 0); -+ pRFCalibrateInfo->KfreeOffset[eRFPath] = 0; -+ break; -+ case 2: -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 0); -+ pRFCalibrateInfo->KfreeOffset[eRFPath] = 0; -+ break; -+ case 4: -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 1); -+ pRFCalibrateInfo->KfreeOffset[eRFPath] = 1; -+ break; -+ case 6: -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 1); -+ pRFCalibrateInfo->KfreeOffset[eRFPath] = 1; -+ break; -+ case 8: -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 2); -+ pRFCalibrateInfo->KfreeOffset[eRFPath] = 2; -+ break; -+ case 10: -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 2); -+ pRFCalibrateInfo->KfreeOffset[eRFPath] = 2; -+ break; -+ case 12: -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 3); -+ pRFCalibrateInfo->KfreeOffset[eRFPath] = 3; -+ break; -+ case 14: -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 3); -+ pRFCalibrateInfo->KfreeOffset[eRFPath] = 3; -+ break; -+ case 16: -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 4); -+ pRFCalibrateInfo->KfreeOffset[eRFPath] = 4; -+ break; -+ case 18: -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 4); -+ pRFCalibrateInfo->KfreeOffset[eRFPath] = 4; -+ break; -+ case 20: -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); -+ ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 5); -+ pRFCalibrateInfo->KfreeOffset[eRFPath] = 5; -+ break; -+ -+ default: -+ break; -+ } -+ -+ if (bOdd == FALSE) { -+ /*that means Kfree offset is negative, we need to record it.*/ -+ pRFCalibrateInfo->KfreeOffset[eRFPath] = (-1)*pRFCalibrateInfo->KfreeOffset[eRFPath]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): KfreeOffset = %d\n", pRFCalibrateInfo->KfreeOffset[eRFPath])); -+ } else -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): KfreeOffset = %d\n", pRFCalibrateInfo->KfreeOffset[eRFPath])); -+ -+} -+ -+ -+VOID -+phydm_SetKfreeToRF( -+ IN PVOID pDM_VOID, -+ IN u1Byte eRFPath, -+ IN u1Byte Data -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ phydm_SetKfreeToRF_8814A(pDM_Odm, eRFPath, Data); -+} -+ -+VOID -+phydm_ConfigKFree( -+ IN PVOID pDM_VOID, -+ IN u1Byte channelToSW, -+ IN pu1Byte kfreeTable -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ u1Byte rfpath = 0, maxRFpath = 0; -+ u1Byte channelIdx = 0; -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ maxRFpath = 4; /*0~3*/ -+ else if (pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8192E | ODM_RTL8822B)) -+ maxRFpath = 2; /*0~1*/ -+ else -+ maxRFpath = 1; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("===>phy_ConfigKFree8814A()\n")); -+ -+ if (pRFCalibrateInfo->RegRfKFreeEnable == 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): RegRfKFreeEnable == 2, Disable\n")); -+ return; -+ } else if (pRFCalibrateInfo->RegRfKFreeEnable == 1 || pRFCalibrateInfo->RegRfKFreeEnable == 0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): RegRfKFreeEnable == TRUE\n")); -+ /*Make sure the targetval is defined*/ -+ if (((pRFCalibrateInfo->RegRfKFreeEnable == 1) && (kfreeTable[0] != 0xFF)) || (pRFCalibrateInfo->RfKFreeEnable == TRUE)) { -+ /*if kfreeTable[0] == 0xff, means no Kfree*/ -+ if (*pDM_Odm->pBandType == ODM_BAND_2_4G) { -+ if (channelToSW <= 14 && channelToSW >= 1) -+ channelIdx = PHYDM_2G; -+ } else if (*pDM_Odm->pBandType == ODM_BAND_5G) { -+ if (channelToSW >= 36 && channelToSW <= 48) -+ channelIdx = PHYDM_5GLB1; -+ if (channelToSW >= 52 && channelToSW <= 64) -+ channelIdx = PHYDM_5GLB2; -+ if (channelToSW >= 100 && channelToSW <= 120) -+ channelIdx = PHYDM_5GMB1; -+ if (channelToSW >= 124 && channelToSW <= 144) -+ channelIdx = PHYDM_5GMB2; -+ if (channelToSW >= 149 && channelToSW <= 177) -+ channelIdx = PHYDM_5GHB; -+ } -+ -+ for (rfpath = ODM_RF_PATH_A; rfpath < maxRFpath; rfpath++) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phydm_kfree(): PATH_%d: %#x\n", rfpath, kfreeTable[channelIdx*maxRFpath + rfpath])); -+ phydm_SetKfreeToRF(pDM_Odm, rfpath, kfreeTable[channelIdx*maxRFpath + rfpath]); -+ } -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): targetval not defined, Don't execute KFree Process.\n")); -+ return; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("<===phy_ConfigKFree8814A()\n")); -+} -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_kfree.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_kfree.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_kfree.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_kfree.h 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,45 @@ -+ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMKFREE_H__ -+#define __PHYDKFREE_H__ -+ -+#define KFREE_VERSION "1.0" -+ -+typedef enum tag_phydm_kfree_channeltosw { -+ PHYDM_2G = 0, -+ PHYDM_5GLB1 = 1, -+ PHYDM_5GLB2 = 2, -+ PHYDM_5GMB1 = 3, -+ PHYDM_5GMB2 = 4, -+ PHYDM_5GHB = 5, -+} PHYDM_KFREE_CHANNELTOSW; -+ -+ -+VOID -+phydm_ConfigKFree( -+ IN PVOID pDM_VOID, -+ IN u1Byte channelToSW, -+ IN pu1Byte kfreeTable -+); -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.c 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,305 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+#include "phydm_noisemonitor.h" -+ -+//================================================= -+// This function is for inband noise test utility only -+// To obtain the inband noise level(dbm), do the following. -+// 1. disable DIG and Power Saving -+// 2. Set initial gain = 0x1a -+// 3. Stop updating idle time pwer report (for driver read) -+// - 0x80c[25] -+// -+//================================================= -+ -+#define Valid_Min -35 -+#define Valid_Max 10 -+#define ValidCnt 5 -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -+ -+s2Byte odm_InbandNoise_Monitor_NSeries(PDM_ODM_T pDM_Odm,u8 bPauseDIG,u8 IGIValue,u32 max_time) -+{ -+ u4Byte tmp4b; -+ u1Byte max_rf_path=0,rf_path; -+ u1Byte reg_c50, reg_c58,valid_done=0; -+ struct noise_level noise_data; -+ u8Byte start = 0, func_start = 0, func_end = 0; -+ -+ func_start = ODM_GetCurrentTime(pDM_Odm); -+ pDM_Odm->noise_level.noise_all = 0; -+ -+ if((pDM_Odm->RFType == ODM_1T2R) ||(pDM_Odm->RFType == ODM_2T2R)) -+ max_rf_path = 2; -+ else -+ max_rf_path = 1; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("odm_DebugControlInbandNoise_Nseries() ==> \n")); -+ -+ ODM_Memory_Set(pDM_Odm,&noise_data,0,sizeof(struct noise_level)); -+ -+ // -+ // Step 1. Disable DIG && Set initial gain. -+ // -+ -+ if(bPauseDIG) -+ { -+ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, IGIValue); -+ } -+ // -+ // Step 2. Disable all power save for read registers -+ // -+ //dcmd_DebugControlPowerSave(pAdapter, PSDisable); -+ -+ // -+ // Step 3. Get noise power level -+ // -+ start = ODM_GetCurrentTime(pDM_Odm); -+ while(1) -+ { -+ -+ //Stop updating idle time pwer report (for driver read) -+ ODM_SetBBReg(pDM_Odm, rFPGA0_TxGainStage, BIT25, 1); -+ -+ //Read Noise Floor Report -+ tmp4b = ODM_GetBBReg(pDM_Odm, 0x8f8,bMaskDWord ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("Noise Floor Report (0x8f8) = 0x%08x\n", tmp4b)); -+ -+ //ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0, TestInitialGain); -+ //if(max_rf_path == 2) -+ // ODM_SetBBReg(pDM_Odm, rOFDM0_XBAGCCore1, bMaskByte0, TestInitialGain); -+ -+ //update idle time pwer report per 5us -+ ODM_SetBBReg(pDM_Odm, rFPGA0_TxGainStage, BIT25, 0); -+ -+ noise_data.value[ODM_RF_PATH_A] = (u1Byte)(tmp4b&0xff); -+ noise_data.value[ODM_RF_PATH_B] = (u1Byte)((tmp4b&0xff00)>>8); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("value_a = 0x%x(%d), value_b = 0x%x(%d)\n", -+ noise_data.value[ODM_RF_PATH_A], noise_data.value[ODM_RF_PATH_A], noise_data.value[ODM_RF_PATH_B], noise_data.value[ODM_RF_PATH_B])); -+ -+ for(rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) -+ { -+ noise_data.sval[rf_path] = (s1Byte)noise_data.value[rf_path]; -+ noise_data.sval[rf_path] /= 2; -+ } -+ -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("sval_a = %d, sval_b = %d\n", -+ noise_data.sval[ODM_RF_PATH_A], noise_data.sval[ODM_RF_PATH_B])); -+ //ODM_delay_ms(10); -+ //ODM_sleep_ms(10); -+ -+ for(rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) -+ { -+ if( (noise_data.valid_cnt[rf_path] < ValidCnt) && (noise_data.sval[rf_path] < Valid_Max && noise_data.sval[rf_path] >= Valid_Min)) -+ { -+ noise_data.valid_cnt[rf_path]++; -+ noise_data.sum[rf_path] += noise_data.sval[rf_path]; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("RF_Path:%d Valid sval = %d\n", rf_path,noise_data.sval[rf_path])); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("Sum of sval = %d, \n", noise_data.sum[rf_path])); -+ if(noise_data.valid_cnt[rf_path] == ValidCnt) -+ { -+ valid_done++; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("After divided, RF_Path:%d ,sum = %d \n", rf_path,noise_data.sum[rf_path])); -+ } -+ -+ } -+ -+ } -+ -+ //printk("####### valid_done:%d #############\n",valid_done); -+ if ((valid_done==max_rf_path) || (ODM_GetProgressingTime(pDM_Odm,start) > max_time)) -+ { -+ for(rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) -+ { -+ //printk("%s PATH_%d - sum = %d, valid_cnt = %d \n",__FUNCTION__,rf_path,noise_data.sum[rf_path], noise_data.valid_cnt[rf_path]); -+ if(noise_data.valid_cnt[rf_path]) -+ noise_data.sum[rf_path] /= noise_data.valid_cnt[rf_path]; -+ else -+ noise_data.sum[rf_path] = 0; -+ } -+ break; -+ } -+ } -+ reg_c50 = (u1Byte)ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0); -+ reg_c50 &= ~BIT7; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("0x%x = 0x%02x(%d)\n", rOFDM0_XAAGCCore1, reg_c50, reg_c50)); -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_A] = (u1Byte)(-110 + reg_c50 + noise_data.sum[ODM_RF_PATH_A]); -+ pDM_Odm->noise_level.noise_all += pDM_Odm->noise_level.noise[ODM_RF_PATH_A]; -+ -+ if(max_rf_path == 2){ -+ reg_c58 = (u1Byte)ODM_GetBBReg(pDM_Odm, rOFDM0_XBAGCCore1, bMaskByte0); -+ reg_c58 &= ~BIT7; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("0x%x = 0x%02x(%d)\n", rOFDM0_XBAGCCore1, reg_c58, reg_c58)); -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_B] = (u1Byte)(-110 + reg_c58 + noise_data.sum[ODM_RF_PATH_B]); -+ pDM_Odm->noise_level.noise_all += pDM_Odm->noise_level.noise[ODM_RF_PATH_B]; -+ } -+ pDM_Odm->noise_level.noise_all /= max_rf_path; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("noise_a = %d, noise_b = %d\n", -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_A], -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_B])); -+ -+ // -+ // Step 4. Recover the Dig -+ // -+ if(bPauseDIG) -+ { -+ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, IGIValue); -+ } -+ func_end = ODM_GetProgressingTime(pDM_Odm,func_start) ; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_DebugControlInbandNoise_Nseries() <==\n")); -+ return pDM_Odm->noise_level.noise_all; -+ -+} -+ -+s2Byte -+odm_InbandNoise_Monitor_ACSeries(PDM_ODM_T pDM_Odm, u8 bPauseDIG, u8 IGIValue, u32 max_time -+ ) -+{ -+ s4Byte rxi_buf_anta, rxq_buf_anta; /*rxi_buf_antb, rxq_buf_antb;*/ -+ s4Byte value32, pwdb_A = 0, sval, noise, sum; -+ BOOLEAN pd_flag; -+ u1Byte i, valid_cnt; -+ u8Byte start = 0, func_start = 0, func_end = 0; -+ -+ -+ if (!(pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8814A))) -+ return 0; -+ -+ func_start = ODM_GetCurrentTime(pDM_Odm); -+ pDM_Odm->noise_level.noise_all = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_InbandNoise_Monitor_ACSeries() ==>\n")); -+ -+ /* Step 1. Disable DIG && Set initial gain. */ -+ if (bPauseDIG) -+ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, IGIValue); -+ -+ /* Step 2. Disable all power save for read registers */ -+ /*dcmd_DebugControlPowerSave(pAdapter, PSDisable); */ -+ -+ /* Step 3. Get noise power level */ -+ start = ODM_GetCurrentTime(pDM_Odm); -+ -+ /* reset counters */ -+ sum = 0; -+ valid_cnt = 0; -+ -+ /* Step 3. Get noise power level */ -+ while (1) { -+ /*Set IGI=0x1C */ -+ ODM_Write_DIG(pDM_Odm, 0x1C); -+ /*stop CK320&CK88 */ -+ ODM_SetBBReg(pDM_Odm, 0x8B4, BIT6, 1); -+ /*Read Path-A */ -+ ODM_SetBBReg(pDM_Odm, 0x8FC, bMaskDWord, 0x200); /*set debug port*/ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xFA0, bMaskDWord); /*read debug port*/ -+ -+ rxi_buf_anta = (value32 & 0xFFC00) >> 10; /*rxi_buf_anta=RegFA0[19:10]*/ -+ rxq_buf_anta = value32 & 0x3FF; /*rxq_buf_anta=RegFA0[19:10]*/ -+ -+ pd_flag = (BOOLEAN) ((value32 & BIT31) >> 31); -+ -+ /*Not in packet detection period or Tx state */ -+ if ((!pd_flag) || (rxi_buf_anta != 0x200)) { -+ /*sign conversion*/ -+ rxi_buf_anta = ODM_SignConversion(rxi_buf_anta, 10); -+ rxq_buf_anta = ODM_SignConversion(rxq_buf_anta, 10); -+ -+ pwdb_A = ODM_PWdB_Conversion(rxi_buf_anta * rxi_buf_anta + rxq_buf_anta * rxq_buf_anta, 20, 18); /*S(10,9)*S(10,9)=S(20,18)*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("pwdb_A= %d dB, rxi_buf_anta= 0x%x, rxq_buf_anta= 0x%x\n", pwdb_A, rxi_buf_anta & 0x3FF, rxq_buf_anta & 0x3FF)); -+ } -+ /*Start CK320&CK88*/ -+ ODM_SetBBReg(pDM_Odm, 0x8B4, BIT6, 0); -+ /*BB Reset*/ -+ ODM_Write1Byte(pDM_Odm, 0x02, ODM_Read1Byte(pDM_Odm, 0x02) & (~BIT0)); -+ ODM_Write1Byte(pDM_Odm, 0x02, ODM_Read1Byte(pDM_Odm, 0x02) | BIT0); -+ /*PMAC Reset*/ -+ ODM_Write1Byte(pDM_Odm, 0xB03, ODM_Read1Byte(pDM_Odm, 0xB03) & (~BIT0)); -+ ODM_Write1Byte(pDM_Odm, 0xB03, ODM_Read1Byte(pDM_Odm, 0xB03) | BIT0); -+ /*CCK Reset*/ -+ if (ODM_Read1Byte(pDM_Odm, 0x80B) & BIT4) { -+ ODM_Write1Byte(pDM_Odm, 0x80B, ODM_Read1Byte(pDM_Odm, 0x80B) & (~BIT4)); -+ ODM_Write1Byte(pDM_Odm, 0x80B, ODM_Read1Byte(pDM_Odm, 0x80B) | BIT4); -+ } -+ -+ sval = pwdb_A; -+ -+ if (sval < 0 && sval >= -27) { -+ if (valid_cnt < ValidCnt) { -+ valid_cnt++; -+ sum += sval; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Valid sval = %d\n", sval)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Sum of sval = %d,\n", sum)); -+ if ((valid_cnt >= ValidCnt) || (ODM_GetProgressingTime(pDM_Odm, start) > max_time)) { -+ sum /= valid_cnt; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("After divided, sum = %d\n", sum)); -+ break; -+ } -+ } -+ } -+ } -+ -+ /*ADC backoff is 12dB,*/ -+ /*Ptarget=0x1C-110=-82dBm*/ -+ noise = sum + 12 + 0x1C - 110; -+ -+ /*Offset*/ -+ noise = noise - 3; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("noise = %d\n", noise)); -+ pDM_Odm->noise_level.noise_all = (s2Byte)noise; -+ -+ /* Step 4. Recover the Dig*/ -+ if (bPauseDIG) -+ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, IGIValue); -+ -+ func_end = ODM_GetProgressingTime(pDM_Odm, func_start); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_InbandNoise_Monitor_ACSeries() <==\n")); -+ -+ return pDM_Odm->noise_level.noise_all; -+} -+ -+ -+ -+s2Byte -+ODM_InbandNoise_Monitor(PVOID pDM_VOID, u8 bPauseDIG, u8 IGIValue, u32 max_time) -+{ -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ return odm_InbandNoise_Monitor_ACSeries(pDM_Odm, bPauseDIG, IGIValue, max_time); -+ else -+ return odm_InbandNoise_Monitor_NSeries(pDM_Odm, bPauseDIG, IGIValue, max_time); -+} -+ -+#endif -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_noisemonitor.h 2018-02-11 21:44:27.156146223 +0200 -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ *****************************************************************************/ -+#ifndef __ODMNOISEMONITOR_H__ -+#define __ODMNOISEMONITOR_H__ -+ -+#define ODM_MAX_CHANNEL_NUM 38//14+24 -+struct noise_level -+{ -+ //u1Byte value_a, value_b; -+ u1Byte value[MAX_RF_PATH]; -+ //s1Byte sval_a, sval_b; -+ s1Byte sval[MAX_RF_PATH]; -+ -+ //s4Byte noise_a=0, noise_b=0,sum_a=0, sum_b=0; -+ //s4Byte noise[ODM_RF_PATH_MAX]; -+ s4Byte sum[MAX_RF_PATH]; -+ //u1Byte valid_cnt_a=0, valid_cnt_b=0, -+ u1Byte valid[MAX_RF_PATH]; -+ u1Byte valid_cnt[MAX_RF_PATH]; -+ -+}; -+ -+ -+typedef struct _ODM_NOISE_MONITOR_ -+{ -+ s1Byte noise[MAX_RF_PATH]; -+ s2Byte noise_all; -+}ODM_NOISE_MONITOR; -+ -+s2Byte ODM_InbandNoise_Monitor(PVOID pDM_VOID,u8 bPauseDIG,u8 IGIValue,u32 max_time); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.c 2018-02-11 21:44:27.157146238 +0200 -@@ -0,0 +1,810 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if(defined(CONFIG_PATH_DIVERSITY)) -+#if RTL8814A_SUPPORT -+ -+VOID -+phydm_dtp_fix_tx_path( -+ IN PVOID pDM_VOID, -+ IN u1Byte path -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; -+ u1Byte i,num_enable_path=0; -+ -+ if(path==pDM_PathDiv->pre_tx_path) -+ { -+ return; -+ } -+ else -+ { -+ pDM_PathDiv->pre_tx_path=path; -+ } -+ -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT18|BIT19, 3); -+ -+ for(i=0; i<4; i++) -+ { -+ if(path&BIT(i)) -+ num_enable_path++; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Number of trun-on path : (( %d ))\n", num_enable_path)); -+ -+ if(num_enable_path == 1) -+ { -+ ODM_SetBBReg( pDM_Odm, 0x93c, 0xf00000, path); -+ -+ if(path==PHYDM_A)//1-1 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A ))\n")); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ } -+ else if(path==PHYDM_B)//1-2 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B ))\n")); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); -+ } -+ else if(path==PHYDM_C)//1-3 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( C ))\n")); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 0); -+ -+ } -+ else if(path==PHYDM_D)//1-4 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( D ))\n")); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 0); -+ } -+ -+ } -+ else if(num_enable_path == 2) -+ { -+ ODM_SetBBReg( pDM_Odm, 0x93c, 0xf00000, path); -+ ODM_SetBBReg( pDM_Odm, 0x940, 0xf0, path); -+ -+ if(path==PHYDM_AB)//2-1 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 1); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 1); -+ } -+ else if(path==PHYDM_AC)//2-2 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A C ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); -+ } -+ else if(path==PHYDM_AD)//2-3 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A D ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 1); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 1); -+ } -+ else if(path==PHYDM_BC)//2-4 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B C ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); -+ } -+ else if(path==PHYDM_BD)//2-5 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B D ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 1); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 1); -+ } -+ else if(path==PHYDM_CD)//2-6 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( C D ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 1); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 1); -+ } -+ -+ } -+ else if(num_enable_path == 3) -+ { -+ ODM_SetBBReg( pDM_Odm, 0x93c, 0xf00000, path); -+ ODM_SetBBReg( pDM_Odm, 0x940, 0xf0, path); -+ ODM_SetBBReg( pDM_Odm, 0x940, 0xf0000, path); -+ -+ if(path==PHYDM_ABC)//3-1 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B C))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 1); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 2); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 2); -+ //set for 3ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT21|BIT20, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT23|BIT22, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT25|BIT24, 2); -+ } -+ else if(path==PHYDM_ABD)//3-2 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B D ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 1); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 2); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 2); -+ //set for 3ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT21|BIT20, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT23|BIT22, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT27|BIT26, 2); -+ -+ } -+ else if(path==PHYDM_ACD)//3-3 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A C D ))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 2); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 2); -+ //set for 3ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT21|BIT20, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT25|BIT24, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT27|BIT26, 2); -+ } -+ else if(path==PHYDM_BCD)//3-4 -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B C D))\n")); -+ //set for 1ss -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); -+ ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 2); -+ //set for 2ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 2); -+ //set for 3ss -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT23|BIT22, 0); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT25|BIT24, 1); -+ ODM_SetBBReg( pDM_Odm, 0x940, BIT27|BIT26, 2); -+ } -+ } -+ else if(num_enable_path == 4) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path ((A B C D))\n")); -+ } -+ -+} -+ -+VOID -+phydm_find_default_path( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; -+ u4Byte rssi_avg_a=0, rssi_avg_b=0, rssi_avg_c=0, rssi_avg_d=0, rssi_avg_bcd=0; -+ u4Byte rssi_total_a=0, rssi_total_b=0, rssi_total_c=0, rssi_total_d=0; -+ -+ //2 Default Path Selection By RSSI -+ -+ rssi_avg_a = (pDM_PathDiv->path_a_cnt_all > 0)? (pDM_PathDiv->path_a_sum_all / pDM_PathDiv->path_a_cnt_all) :0 ; -+ rssi_avg_b = (pDM_PathDiv->path_b_cnt_all > 0)? (pDM_PathDiv->path_b_sum_all / pDM_PathDiv->path_b_cnt_all) :0 ; -+ rssi_avg_c = (pDM_PathDiv->path_c_cnt_all > 0)? (pDM_PathDiv->path_c_sum_all / pDM_PathDiv->path_c_cnt_all) :0 ; -+ rssi_avg_d = (pDM_PathDiv->path_d_cnt_all > 0)? (pDM_PathDiv->path_d_sum_all / pDM_PathDiv->path_d_cnt_all) :0 ; -+ -+ -+ pDM_PathDiv->path_a_sum_all = 0; -+ pDM_PathDiv->path_a_cnt_all = 0; -+ pDM_PathDiv->path_b_sum_all = 0; -+ pDM_PathDiv->path_b_cnt_all = 0; -+ pDM_PathDiv->path_c_sum_all = 0; -+ pDM_PathDiv->path_c_cnt_all = 0; -+ pDM_PathDiv->path_d_sum_all = 0; -+ pDM_PathDiv->path_d_cnt_all = 0; -+ -+ if(pDM_PathDiv->use_path_a_as_default_ant == 1) -+ { -+ rssi_avg_bcd=(rssi_avg_b+rssi_avg_c+rssi_avg_d)/3; -+ -+ if( (rssi_avg_a + ANT_DECT_RSSI_TH) > rssi_avg_bcd ) -+ { -+ pDM_PathDiv->is_pathA_exist=TRUE; -+ pDM_PathDiv->default_path=PATH_A; -+ } -+ else -+ { -+ pDM_PathDiv->is_pathA_exist=FALSE; -+ } -+ } -+ else -+ { -+ if( (rssi_avg_a >=rssi_avg_b) && (rssi_avg_a >=rssi_avg_c)&&(rssi_avg_a >=rssi_avg_d)) -+ pDM_PathDiv->default_path=PATH_A; -+ else if( (rssi_avg_b >=rssi_avg_c)&&(rssi_avg_b >=rssi_avg_d)) -+ pDM_PathDiv->default_path=PATH_B; -+ else if( rssi_avg_c >=rssi_avg_d) -+ pDM_PathDiv->default_path=PATH_C; -+ else -+ pDM_PathDiv->default_path=PATH_D; -+ } -+ -+ -+} -+ -+ -+VOID -+phydm_candidate_dtp_update( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; -+ -+ pDM_PathDiv->num_candidate=3; -+ -+ if(pDM_PathDiv->use_path_a_as_default_ant == 1) -+ { -+ if(pDM_PathDiv->num_tx_path==3) -+ { -+ if(pDM_PathDiv->is_pathA_exist) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_ABD; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_ACD; -+ } -+ else // use path BCD -+ { -+ pDM_PathDiv->num_candidate=1; -+ phydm_dtp_fix_tx_path(pDM_Odm, PHYDM_BCD); -+ return; -+ } -+ } -+ else if(pDM_PathDiv->num_tx_path==2) -+ { -+ if(pDM_PathDiv->is_pathA_exist) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_AB; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_AC; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_AD; -+ } -+ else -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_BC; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_BD; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_CD; -+ } -+ } -+ } -+ else -+ { -+ //2 3 TX Mode -+ if(pDM_PathDiv->num_tx_path==3)//choose 3 ant form 4 -+ { -+ if(pDM_PathDiv->default_path == PATH_A) //choose 2 ant form 3 -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_ABD; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_ACD; -+ } -+ else if(pDM_PathDiv->default_path==PATH_B) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_ABD; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_BCD; -+ } -+ else if(pDM_PathDiv->default_path == PATH_C) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_ACD; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_BCD; -+ } -+ else if(pDM_PathDiv->default_path == PATH_D) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_ABD; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_ACD; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_BCD; -+ } -+ } -+ -+ //2 2 TX Mode -+ else if(pDM_PathDiv->num_tx_path==2)//choose 2 ant form 4 -+ { -+ if(pDM_PathDiv->default_path == PATH_A) //choose 2 ant form 3 -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_AB; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_AC; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_AD; -+ } -+ else if(pDM_PathDiv->default_path==PATH_B) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_AB; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_BC; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_BD; -+ } -+ else if(pDM_PathDiv->default_path == PATH_C) -+ { -+ pDM_PathDiv->ant_candidate_1 = PHYDM_AC; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_BC; -+ pDM_PathDiv->ant_candidate_3 = PHYDM_CD; -+ } -+ else if(pDM_PathDiv->default_path == PATH_D) -+ { -+ pDM_PathDiv->ant_candidate_1= PHYDM_AD; -+ pDM_PathDiv->ant_candidate_2 = PHYDM_BD; -+ pDM_PathDiv->ant_candidate_3= PHYDM_CD; -+ } -+ } -+ } -+} -+ -+ -+VOID -+phydm_dynamic_tx_path( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; -+ -+ PSTA_INFO_T pEntry; -+ u4Byte i; -+ u1Byte num_client=0; -+ u1Byte H2C_Parameter[6] ={0}; -+ -+ -+ if(!pDM_Odm->bLinked) //bLinked==False -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("DTP_8814 [No Link!!!]\n")); -+ -+ if(pDM_PathDiv->bBecomeLinked == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" [Be disconnected]----->\n")); -+ pDM_PathDiv->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ return; -+ } -+ else -+ { -+ if(pDM_PathDiv->bBecomeLinked ==FALSE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" [Be Linked !!!]----->\n")); -+ pDM_PathDiv->bBecomeLinked = pDM_Odm->bLinked; -+ } -+ } -+ -+ //2 [Period CTRL] -+ if(pDM_PathDiv->dtp_period >=2) -+ { -+ pDM_PathDiv->dtp_period=0; -+ } -+ else -+ { -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Phydm_Dynamic_Tx_Path_8814A() Stay = (( %d ))\n",pDM_PathDiv->dtp_period)); -+ pDM_PathDiv->dtp_period++; -+ return; -+ } -+ -+ -+ //2 [Fix Path] -+ if (pDM_Odm->path_select != PHYDM_AUTO_PATH) -+ { -+ return; -+ } -+ -+ //2 [Check Bfer] -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #if (BEAMFORMING_SUPPORT == 1) -+ { -+ BEAMFORMING_CAP BeamformCap = (pDM_Odm->BeamformingInfo.BeamformCap); -+ -+ if( BeamformCap & BEAMFORMER_CAP ) // BFmer On && Div On -> Div Off -+ { -+ if( pDM_PathDiv->fix_path_bfer == 0) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("[ PathDiv : OFF ] BFmer ==1 \n")); -+ pDM_PathDiv->fix_path_bfer = 1 ; -+ } -+ return; -+ } -+ else // BFmer Off && Div Off -> Div On -+ { -+ if( pDM_PathDiv->fix_path_bfer == 1 ) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("[ PathDiv : ON ] BFmer ==0 \n")); -+ pDM_PathDiv->fix_path_bfer = 0; -+ } -+ } -+ } -+ #endif -+ #endif -+ -+ if(pDM_PathDiv->use_path_a_as_default_ant ==1) -+ { -+ phydm_find_default_path(pDM_Odm); -+ phydm_candidate_dtp_update(pDM_Odm); -+ } -+ else -+ { -+ if( pDM_PathDiv->dtp_state == PHYDM_DTP_INIT) -+ { -+ phydm_find_default_path(pDM_Odm); -+ phydm_candidate_dtp_update(pDM_Odm); -+ pDM_PathDiv->dtp_state = PHYDM_DTP_RUNNING_1; -+ } -+ -+ else if( pDM_PathDiv->dtp_state == PHYDM_DTP_RUNNING_1) -+ { -+ pDM_PathDiv->dtp_check_patha_counter++; -+ -+ if(pDM_PathDiv->dtp_check_patha_counter>=NUM_RESET_DTP_PERIOD) -+ { -+ pDM_PathDiv->dtp_check_patha_counter=0; -+ pDM_PathDiv->dtp_state = PHYDM_DTP_INIT; -+ } -+ //2 Search space update -+ else -+ { -+ // 1. find the worst candidate -+ -+ -+ // 2. repalce the worst candidate -+ } -+ } -+ } -+ -+ //2 Dynamic Path Selection H2C -+ -+ if(pDM_PathDiv->num_candidate == 1) -+ { -+ return; -+ } -+ else -+ { -+ H2C_Parameter[0] = pDM_PathDiv->num_candidate; -+ H2C_Parameter[1] = pDM_PathDiv->num_tx_path; -+ H2C_Parameter[2] = pDM_PathDiv->ant_candidate_1; -+ H2C_Parameter[3] = pDM_PathDiv->ant_candidate_2; -+ H2C_Parameter[4] = pDM_PathDiv->ant_candidate_3; -+ -+ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_DYNAMIC_TX_PATH, 6, H2C_Parameter); -+ } -+ -+} -+ -+ -+ -+VOID -+phydm_dynamic_tx_path_init( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ #if ((DM_ODM_SUPPORT_TYPE == ODM_WIN) && USB_SWITCH_SUPPORT) -+ USB_MODE_MECH *pUsbModeMech = &pAdapter->UsbModeMechanism; -+ #endif -+ u1Byte search_space_2[NUM_CHOOSE2_FROM4]= {PHYDM_AB, PHYDM_AC, PHYDM_AD, PHYDM_BC, PHYDM_BD, PHYDM_CD }; -+ u1Byte search_space_3[NUM_CHOOSE3_FROM4]= {PHYDM_BCD, PHYDM_ACD, PHYDM_ABD, PHYDM_ABC}; -+ -+ #if ((DM_ODM_SUPPORT_TYPE == ODM_WIN) && USB_SWITCH_SUPPORT) -+ pDM_PathDiv->is_u3_mode = (pUsbModeMech->CurUsbMode==USB_MODE_U3)? 1 : 0 ; -+ #else -+ pDM_PathDiv->is_u3_mode = 1; -+ #endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Dynamic TX Path Init 8814\n")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("is_u3_mode = (( %d ))\n", pDM_PathDiv->is_u3_mode)); -+ -+ memcpy(&(pDM_PathDiv->search_space_2[0]), &(search_space_2[0]), NUM_CHOOSE2_FROM4); -+ memcpy(&(pDM_PathDiv->search_space_3[0]), &(search_space_3[0]), NUM_CHOOSE3_FROM4); -+ -+ pDM_PathDiv->use_path_a_as_default_ant= 1; -+ pDM_PathDiv->dtp_state = PHYDM_DTP_INIT; -+ pDM_Odm->path_select = PHYDM_AUTO_PATH; -+ pDM_PathDiv->path_div_type = PHYDM_4R_PATH_DIV; -+ -+ -+ if(pDM_PathDiv->is_u3_mode ) -+ { -+ pDM_PathDiv->num_tx_path=3; -+ phydm_dtp_fix_tx_path(pDM_Odm, PHYDM_BCD);/* 3TX Set Init TX Path*/ -+ -+ } -+ else -+ { -+ pDM_PathDiv->num_tx_path=2; -+ phydm_dtp_fix_tx_path(pDM_Odm, PHYDM_BC);/* 2TX // Set Init TX Path*/ -+ } -+ -+} -+ -+ -+VOID -+phydm_process_rssi_for_path_div( -+ IN OUT PVOID pDM_VOID, -+ IN PVOID p_phy_info_void, -+ IN PVOID p_pkt_info_void -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_PHY_INFO_T pPhyInfo=(PODM_PHY_INFO_T)p_phy_info_void; -+ PODM_PACKET_INFO_T pPktinfo=(PODM_PACKET_INFO_T)p_pkt_info_void; -+ pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); -+ -+ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketMatchBSSID) -+ { -+ if(pPktinfo->DataRate > ODM_RATE11M) -+ { -+ if(pDM_PathDiv->path_div_type == PHYDM_4R_PATH_DIV) -+ { -+ #if RTL8814A_SUPPORT -+ if(pDM_Odm->SupportICType & ODM_RTL8814A) -+ { -+ pDM_PathDiv->path_a_sum_all+=pPhyInfo->RxMIMOSignalStrength[0]; -+ pDM_PathDiv->path_a_cnt_all++; -+ -+ pDM_PathDiv->path_b_sum_all+=pPhyInfo->RxMIMOSignalStrength[1]; -+ pDM_PathDiv->path_b_cnt_all++; -+ -+ pDM_PathDiv->path_c_sum_all+=pPhyInfo->RxMIMOSignalStrength[2]; -+ pDM_PathDiv->path_c_cnt_all++; -+ -+ pDM_PathDiv->path_d_sum_all+=pPhyInfo->RxMIMOSignalStrength[3]; -+ pDM_PathDiv->path_d_cnt_all++; -+ } -+ #endif -+ } -+ else -+ { -+ pDM_PathDiv->PathA_Sum[pPktinfo->StationID]+=pPhyInfo->RxMIMOSignalStrength[0]; -+ pDM_PathDiv->PathA_Cnt[pPktinfo->StationID]++; -+ -+ pDM_PathDiv->PathB_Sum[pPktinfo->StationID]+=pPhyInfo->RxMIMOSignalStrength[1]; -+ pDM_PathDiv->PathB_Cnt[pPktinfo->StationID]++; -+ } -+ } -+ } -+ -+ -+} -+ -+#endif //#if RTL8814A_SUPPORT -+ -+VOID -+odm_pathdiv_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ pDM_Odm->path_select = (dm_value[0] & 0xf); -+ PHYDM_SNPRINTF((output+used, out_len-used,"Path_select = (( 0x%x ))\n",pDM_Odm->path_select )); -+ -+ //2 [Fix Path] -+ if (pDM_Odm->path_select != PHYDM_AUTO_PATH) -+ { -+ PHYDM_SNPRINTF((output+used, out_len-used,"Trun on path [%s%s%s%s]\n", -+ ((pDM_Odm->path_select) & 0x1)?"A":"", -+ ((pDM_Odm->path_select) & 0x2)?"B":"", -+ ((pDM_Odm->path_select) & 0x4)?"C":"", -+ ((pDM_Odm->path_select) & 0x8)?"D":"" )); -+ -+ phydm_dtp_fix_tx_path( pDM_Odm, pDM_Odm->path_select ); -+ } -+ else -+ { -+ PHYDM_SNPRINTF((output+used, out_len-used,"%s\n","Auto Path")); -+ } -+} -+ -+#endif // #if(defined(CONFIG_PATH_DIVERSITY)) -+ -+VOID -+phydm_c2h_dtp_handler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+) -+{ -+#if(defined(CONFIG_PATH_DIVERSITY)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); -+ -+ u1Byte macid = CmdBuf[0]; -+ u1Byte target = CmdBuf[1]; -+ u1Byte nsc_1 = CmdBuf[2]; -+ u1Byte nsc_2 = CmdBuf[3]; -+ u1Byte nsc_3 = CmdBuf[4]; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Target_candidate = (( %d ))\n", target)); -+ /* -+ if( (nsc_1 >= nsc_2) && (nsc_1 >= nsc_3)) -+ { -+ phydm_dtp_fix_tx_path(pDM_Odm, pDM_PathDiv->ant_candidate_1); -+ } -+ else if( nsc_2 >= nsc_3) -+ { -+ phydm_dtp_fix_tx_path(pDM_Odm, pDM_PathDiv->ant_candidate_2); -+ } -+ else -+ { -+ phydm_dtp_fix_tx_path(pDM_Odm, pDM_PathDiv->ant_candidate_3); -+ } -+ */ -+#endif -+} -+ -+VOID -+odm_PathDiversity( -+ IN PVOID pDM_VOID -+) -+{ -+#if(defined(CONFIG_PATH_DIVERSITY)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ if(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Return: Not Support PathDiv\n")); -+ return; -+ } -+ -+ #if RTL8812A_SUPPORT -+ -+ if(pDM_Odm->SupportICType & ODM_RTL8812) -+ ODM_PathDiversity_8812A(pDM_Odm); -+ else -+ #endif -+ -+ #if RTL8814A_SUPPORT -+ if(pDM_Odm->SupportICType & ODM_RTL8814A) -+ phydm_dynamic_tx_path(pDM_Odm); -+ else -+ #endif -+ {} -+#endif -+} -+ -+VOID -+odm_PathDiversityInit( -+ IN PVOID pDM_VOID -+) -+{ -+#if(defined(CONFIG_PATH_DIVERSITY)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /*pDM_Odm->SupportAbility |= ODM_BB_PATH_DIV;*/ -+ -+ if(pDM_Odm->mp_mode == TRUE) -+ return; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Return: Not Support PathDiv\n")); -+ return; -+ } -+ -+#if RTL8812A_SUPPORT -+ if(pDM_Odm->SupportICType & ODM_RTL8812) -+ ODM_PathDiversityInit_8812A(pDM_Odm); -+ else -+ #endif -+ -+ #if RTL8814A_SUPPORT -+ if(pDM_Odm->SupportICType & ODM_RTL8814A) -+ phydm_dynamic_tx_path_init(pDM_Odm); -+ else -+ #endif -+ {} -+#endif -+} -+ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+// -+// 2011/12/02 MH Copy from MP oursrc for temporarily test. -+// -+ -+VOID -+odm_PathDivChkAntSwitchCallback( -+ PRT_TIMER pTimer -+) -+{ -+} -+ -+VOID -+odm_PathDivChkAntSwitchWorkitemCallback( -+ IN PVOID pContext -+ ) -+{ -+} -+ -+VOID -+odm_CCKTXPathDiversityCallback( -+ PRT_TIMER pTimer -+) -+{ -+} -+ -+VOID -+odm_CCKTXPathDiversityWorkItemCallback( -+ IN PVOID pContext -+ ) -+{ -+} -+u1Byte -+odm_SwAntDivSelectScanChnl( -+ IN PADAPTER Adapter -+ ) -+{ -+ return 0; -+} -+VOID -+odm_SwAntDivConstructScanChnl( -+ IN PADAPTER Adapter, -+ IN u1Byte ScanChnl -+ ) -+{ -+} -+ -+#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_pathdiv.h 2018-02-11 21:44:27.157146238 +0200 -@@ -0,0 +1,324 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMPATHDIV_H__ -+#define __PHYDMPATHDIV_H__ -+/*#define PATHDIV_VERSION "2.0" //2014.11.04*/ -+#define PATHDIV_VERSION "3.1" /*2015.07.29 by YuChen*/ -+ -+#if(defined(CONFIG_PATH_DIVERSITY)) -+#define USE_PATH_A_AS_DEFAULT_ANT //for 8814 dynamic TX path selection -+ -+#define NUM_RESET_DTP_PERIOD 5 -+#define ANT_DECT_RSSI_TH 3 -+ -+#define PATH_A 1 -+#define PATH_B 2 -+#define PATH_C 3 -+#define PATH_D 4 -+ -+#define PHYDM_AUTO_PATH 0 -+#define PHYDM_FIX_PATH 1 -+ -+#define NUM_CHOOSE2_FROM4 6 -+#define NUM_CHOOSE3_FROM4 4 -+ -+ -+#define PHYDM_A BIT0 -+#define PHYDM_B BIT1 -+#define PHYDM_C BIT2 -+#define PHYDM_D BIT3 -+#define PHYDM_AB (BIT0 | BIT1) // 0 -+#define PHYDM_AC (BIT0 | BIT2) // 1 -+#define PHYDM_AD (BIT0 | BIT3) // 2 -+#define PHYDM_BC (BIT1 | BIT2) // 3 -+#define PHYDM_BD (BIT1 | BIT3) // 4 -+#define PHYDM_CD (BIT2 | BIT3) // 5 -+ -+#define PHYDM_ABC (BIT0 | BIT1 | BIT2) /* 0*/ -+#define PHYDM_ABD (BIT0 | BIT1 | BIT3) /* 1*/ -+#define PHYDM_ACD (BIT0 | BIT2 | BIT3) /* 2*/ -+#define PHYDM_BCD (BIT1 | BIT2 | BIT3) /* 3*/ -+ -+#define PHYDM_ABCD (BIT0 | BIT1 | BIT2 | BIT3) -+ -+ -+typedef enum dtp_state -+{ -+ PHYDM_DTP_INIT=1, -+ PHYDM_DTP_RUNNING_1 -+ -+}PHYDM_DTP_STATE; -+ -+typedef enum path_div_type -+{ -+ PHYDM_2R_PATH_DIV = 1, -+ PHYDM_4R_PATH_DIV = 2 -+}PHYDM_PATH_DIV_TYPE; -+ -+VOID -+phydm_process_rssi_for_path_div( -+ IN OUT PVOID pDM_VOID, -+ IN PVOID p_phy_info_void, -+ IN PVOID p_pkt_info_void -+ ); -+ -+typedef struct _ODM_PATH_DIVERSITY_ -+{ -+ u1Byte RespTxPath; -+ u1Byte PathSel[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte PathA_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte PathB_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte PathA_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u2Byte PathB_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte path_div_type; -+ #if RTL8814A_SUPPORT -+ -+ u4Byte path_a_sum_all; -+ u4Byte path_b_sum_all; -+ u4Byte path_c_sum_all; -+ u4Byte path_d_sum_all; -+ -+ u4Byte path_a_cnt_all; -+ u4Byte path_b_cnt_all; -+ u4Byte path_c_cnt_all; -+ u4Byte path_d_cnt_all; -+ -+ u1Byte dtp_period; -+ BOOLEAN bBecomeLinked; -+ BOOLEAN is_u3_mode; -+ u1Byte num_tx_path; -+ u1Byte default_path; -+ u1Byte num_candidate; -+ u1Byte ant_candidate_1; -+ u1Byte ant_candidate_2; -+ u1Byte ant_candidate_3; -+ u1Byte dtp_state; -+ u1Byte dtp_check_patha_counter; -+ BOOLEAN fix_path_bfer; -+ u1Byte search_space_2[NUM_CHOOSE2_FROM4]; -+ u1Byte search_space_3[NUM_CHOOSE3_FROM4]; -+ -+ u1Byte pre_tx_path; -+ u1Byte use_path_a_as_default_ant; -+ BOOLEAN is_pathA_exist; -+ -+ #endif -+}PATHDIV_T, *pPATHDIV_T; -+ -+ -+#endif //#if(defined(CONFIG_PATH_DIVERSITY)) -+ -+VOID -+phydm_c2h_dtp_handler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+ ); -+ -+VOID -+odm_PathDiversityInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_PathDiversity( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_pathdiv_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+ ); -+ -+ -+ -+//1 [OLD IC]-------------------------------------------------------------------------------- -+ -+ -+ -+ -+ -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+//#define PATHDIV_ENABLE 1 -+#define dm_PathDiv_RSSI_Check ODM_PathDivChkPerPktRssi -+#define PathDivCheckBeforeLink8192C ODM_PathDiversityBeforeLink92C -+ -+ -+ -+ -+typedef struct _PathDiv_Parameter_define_ -+{ -+ u4Byte org_5g_RegE30; -+ u4Byte org_5g_RegC14; -+ u4Byte org_5g_RegCA0; -+ u4Byte swt_5g_RegE30; -+ u4Byte swt_5g_RegC14; -+ u4Byte swt_5g_RegCA0; -+ //for 2G IQK information -+ u4Byte org_2g_RegC80; -+ u4Byte org_2g_RegC4C; -+ u4Byte org_2g_RegC94; -+ u4Byte org_2g_RegC14; -+ u4Byte org_2g_RegCA0; -+ -+ u4Byte swt_2g_RegC80; -+ u4Byte swt_2g_RegC4C; -+ u4Byte swt_2g_RegC94; -+ u4Byte swt_2g_RegC14; -+ u4Byte swt_2g_RegCA0; -+}PATHDIV_PARA,*pPATHDIV_PARA; -+ -+VOID -+odm_PathDiversityInit_92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_2TPathDiversityInit_92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_1TPathDiversityInit_92C( -+ IN PADAPTER Adapter -+ ); -+ -+BOOLEAN -+odm_IsConnected_92C( -+ IN PADAPTER Adapter -+ ); -+ -+BOOLEAN -+ODM_PathDiversityBeforeLink92C( -+ //IN PADAPTER Adapter -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+odm_PathDiversityAfterLink_92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_SetRespPath_92C( -+ IN PADAPTER Adapter, -+ IN u1Byte DefaultRespPath -+ ); -+ -+VOID -+odm_OFDMTXPathDiversity_92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_CCKTXPathDiversity_92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_ResetPathDiversity_92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_CCKTXPathDiversityCallback( -+ PRT_TIMER pTimer -+ ); -+ -+VOID -+odm_CCKTXPathDiversityWorkItemCallback( -+ IN PVOID pContext -+ ); -+ -+VOID -+odm_PathDivChkAntSwitchCallback( -+ PRT_TIMER pTimer -+ ); -+ -+VOID -+odm_PathDivChkAntSwitchWorkitemCallback( -+ IN PVOID pContext -+ ); -+ -+ -+VOID -+odm_PathDivChkAntSwitch( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_CCKPathDiversityChkPerPktRssi( -+ PADAPTER Adapter, -+ BOOLEAN bIsDefPort, -+ BOOLEAN bMatchBSSID, -+ PRT_WLAN_STA pEntry, -+ PRT_RFD pRfd, -+ pu1Byte pDesc -+ ); -+ -+VOID -+ODM_PathDivChkPerPktRssi( -+ PADAPTER Adapter, -+ BOOLEAN bIsDefPort, -+ BOOLEAN bMatchBSSID, -+ PRT_WLAN_STA pEntry, -+ PRT_RFD pRfd -+ ); -+ -+VOID -+ODM_PathDivRestAfterLink( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+VOID -+ODM_FillTXPathInTXDESC( -+ IN PADAPTER Adapter, -+ IN PRT_TCB pTcb, -+ IN pu1Byte pDesc -+ ); -+ -+VOID -+odm_PathDivInit_92D( -+ IN PDM_ODM_T pDM_Odm -+ ); -+ -+u1Byte -+odm_SwAntDivSelectScanChnl( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_SwAntDivConstructScanChnl( -+ IN PADAPTER Adapter, -+ IN u1Byte ScanChnl -+ ); -+ -+ #endif //#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+ -+ #endif //#ifndef __ODMPATHDIV_H__ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.c 2018-02-11 21:44:27.157146238 +0200 -@@ -0,0 +1,1216 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if !defined(_OUTSRC_COEXIST) -+//============================================================ -+// Global var -+//============================================================ -+ -+ -+u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE_92D] = { -+ 0x0b40002d, // 0, -15.0dB -+ 0x0c000030, // 1, -14.5dB -+ 0x0cc00033, // 2, -14.0dB -+ 0x0d800036, // 3, -13.5dB -+ 0x0e400039, // 4, -13.0dB -+ 0x0f00003c, // 5, -12.5dB -+ 0x10000040, // 6, -12.0dB -+ 0x11000044, // 7, -11.5dB -+ 0x12000048, // 8, -11.0dB -+ 0x1300004c, // 9, -10.5dB -+ 0x14400051, // 10, -10.0dB -+ 0x15800056, // 11, -9.5dB -+ 0x16c0005b, // 12, -9.0dB -+ 0x18000060, // 13, -8.5dB -+ 0x19800066, // 14, -8.0dB -+ 0x1b00006c, // 15, -7.5dB -+ 0x1c800072, // 16, -7.0dB -+ 0x1e400079, // 17, -6.5dB -+ 0x20000080, // 18, -6.0dB -+ 0x22000088, // 19, -5.5dB -+ 0x24000090, // 20, -5.0dB -+ 0x26000098, // 21, -4.5dB -+ 0x288000a2, // 22, -4.0dB -+ 0x2ac000ab, // 23, -3.5dB -+ 0x2d4000b5, // 24, -3.0dB -+ 0x300000c0, // 25, -2.5dB -+ 0x32c000cb, // 26, -2.0dB -+ 0x35c000d7, // 27, -1.5dB -+ 0x390000e4, // 28, -1.0dB -+ 0x3c8000f2, // 29, -0.5dB -+ 0x40000100, // 30, +0dB -+ 0x43c0010f, // 31, +0.5dB -+ 0x47c0011f, // 32, +1.0dB -+ 0x4c000130, // 33, +1.5dB -+ 0x50800142, // 34, +2.0dB -+ 0x55400155, // 35, +2.5dB -+ 0x5a400169, // 36, +3.0dB -+ 0x5fc0017f, // 37, +3.5dB -+ 0x65400195, // 38, +4.0dB -+ 0x6b8001ae, // 39, +4.5dB -+ 0x71c001c7, // 40, +5.0dB -+ 0x788001e2, // 41, +5.5dB -+ 0x7f8001fe // 42, +6.0dB -+}; -+ -+u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB -+ {0x1c, 0x1a, 0x18, 0x12, 0x0e, 0x08, 0x04, 0x02}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB -+ {0x1c, 0x1a, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB -+}; -+ -+u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D] = { -+ 0x0b40002d, // 0, -15.0dB -+ 0x0c000030, // 1, -14.5dB -+ 0x0cc00033, // 2, -14.0dB -+ 0x0d800036, // 3, -13.5dB -+ 0x0e400039, // 4, -13.0dB -+ 0x0f00003c, // 5, -12.5dB -+ 0x10000040, // 6, -12.0dB -+ 0x11000044, // 7, -11.5dB -+ 0x12000048, // 8, -11.0dB -+ 0x1300004c, // 9, -10.5dB -+ 0x14400051, // 10, -10.0dB -+ 0x15800056, // 11, -9.5dB -+ 0x16c0005b, // 12, -9.0dB -+ 0x18000060, // 13, -8.5dB -+ 0x19800066, // 14, -8.0dB -+ 0x1b00006c, // 15, -7.5dB -+ 0x1c800072, // 16, -7.0dB -+ 0x1e400079, // 17, -6.5dB -+ 0x20000080, // 18, -6.0dB -+ 0x22000088, // 19, -5.5dB -+ 0x24000090, // 20, -5.0dB -+ 0x26000098, // 21, -4.5dB -+ 0x288000a2, // 22, -4.0dB -+ 0x2ac000ab, // 23, -3.5dB -+ 0x2d4000b5, // 24, -3.0dB -+ 0x300000c0, // 25, -2.5dB -+ 0x32c000cb, // 26, -2.0dB -+ 0x35c000d7, // 27, -1.5dB -+ 0x390000e4, // 28, -1.0dB -+ 0x3c8000f2, // 29, -0.5dB -+ 0x40000100, // 30, +0dB -+ 0x43c0010f, // 31, +0.5dB -+ 0x47c0011f, // 32, +1.0dB -+ 0x4c000130, // 33, +1.5dB -+ 0x50800142, // 34, +2.0dB -+ 0x55400155, // 35, +2.5dB -+ 0x5a400169, // 36, +3.0dB -+ 0x5fc0017f, // 37, +3.5dB -+ 0x65400195, // 38, +4.0dB -+ 0x6b8001ae, // 39, +4.5dB -+ 0x71c001c7, // 40, +5.0dB -+ 0x788001e2, // 41, +5.5dB -+ 0x7f8001fe // 42, +6.0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB -+ {0x1c, 0x1a, 0x18, 0x12, 0x0e, 0x08, 0x04, 0x02}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]= { -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB -+ {0x1c, 0x1a, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB -+}; -+ -+u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -+{0x16, 0x15, 0x13, 0x10, 0xD, 0x9, 0x6, 0x3, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 0 -16dB */ -+{0x18, 0x17, 0x15, 0x12, 0xE, 0xA, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 1 -15.5dB */ -+{0x1B, 0x1A, 0x18, 0x14, 0x10, 0xB, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 2 -15dB */ -+{0x1F, 0x1E, 0x1B, 0x17, 0x12, 0xD, 0x8, 0x5, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 3 -14.5dB */ -+{0x22, 0x21, 0x1E, 0x19, 0x14, 0xE, 0x9, 0x5, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 4 -14dB */ -+{0x26, 0x25, 0x22, 0x1C, 0x16, 0x10, 0xA, 0x6, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 5 -13.5dB */ -+{0x2B, 0x2A, 0x26, 0x20, 0x19, 0x12, 0xC, 0x7, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 6 -13dB */ -+{0x30, 0x2F, 0x2A, 0x24, 0x1C, 0x14, 0xD, 0x8, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 7 -12.5dB */ -+{0x36, 0x34, 0x2F, 0x28, 0x1F, 0x17, 0xF, 0x9, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 8 -12dB */ -+{0x3D, 0x3B, 0x35, 0x2D, 0x23, 0x19, 0x11, 0xA, 0x5, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 9 -11.5dB */ -+{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0xB, 0x5, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 10 -11dB */ -+{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0xC, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 11 -10.5dB */ -+{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0xE, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 12 -10dB */ -+{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0xF, 0x7, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 13 -9.5dB */ -+{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x8, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 14 -9dB */ -+{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x9, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 15 -8.5dB */ -+{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0xA, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 16 -8dB */ -+{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0xB, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 17 -7.5dB */ -+{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0xD, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 18 -7dB */ -+{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0xE, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 19 -6.5dB */ -+{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x5, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0} /* 20 -6dB */ -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16] = { -+{0x16, 0x15, 0x13, 0x10, 0xD, 0x9, 0x6, 0x3, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 0 -16dB */ -+{0x18, 0x17, 0x15, 0x12, 0xE, 0xA, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 1 -15.5dB */ -+{0x1B, 0x1A, 0x18, 0x14, 0x10, 0xB, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 2 -15dB */ -+{0x1F, 0x1E, 0x1B, 0x17, 0x12, 0xD, 0x8, 0x5, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 3 -14.5dB */ -+{0x22, 0x21, 0x1E, 0x19, 0x14, 0xE, 0x9, 0x5, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 4 -14dB */ -+{0x26, 0x25, 0x22, 0x1C, 0x16, 0x10, 0xA, 0x6, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 5 -13.5dB */ -+{0x2B, 0x2A, 0x26, 0x20, 0x19, 0x12, 0xC, 0x7, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 6 -13dB */ -+{0x30, 0x2F, 0x2A, 0x24, 0x1C, 0x14, 0xD, 0x8, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 7 -12.5dB */ -+{0x36, 0x34, 0x2F, 0x28, 0x1F, 0x17, 0xF, 0x9, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 8 -12dB */ -+{0x3D, 0x3B, 0x35, 0x2D, 0x23, 0x19, 0x11, 0xA, 0x5, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 9 -11.5dB */ -+{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0xB, 0x5, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 10 -11dB */ -+{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0xC, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 11 -10.5dB */ -+{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0xE, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 12 -10dB */ -+{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0xF, 0x7, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 13 -9.5dB */ -+{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x8, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 14 -9dB */ -+{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x9, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 15 -8.5dB */ -+{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0xA, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 16 -8dB */ -+{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0xB, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 17 -7.5dB */ -+{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0xD, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 18 -7dB */ -+{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0xE, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 19 -6.5dB */ -+{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x5, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0} /* 20 -6dB */ -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -+{0x44, 0x42, 0x3C, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -+{0x48, 0x46, 0x3F, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -+{0x4D, 0x4A, 0x43, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -+{0x51, 0x4F, 0x47, 0x2F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -+{0x56, 0x53, 0x4B, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -+{0x5B, 0x58, 0x50, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -+{0x60, 0x5D, 0x54, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -+{0x66, 0x63, 0x59, 0x3B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -+{0x6C, 0x69, 0x5F, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -+{0x73, 0x6F, 0x64, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -+{0x79, 0x76, 0x6A, 0x46, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -+{0x81, 0x7C, 0x71, 0x4A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -+{0x88, 0x84, 0x77, 0x4F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -+{0x90, 0x8C, 0x7E, 0x54, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -+{0x99, 0x94, 0x86, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -+{0xA2, 0x9D, 0x8E, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -+{0xAC, 0xA6, 0x96, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -+{0xB6, 0xB0, 0x9F, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -+{0xC1, 0xBA, 0xA8, 0x6F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -+{0xCC, 0xC5, 0xB2, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -+{0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -+}; -+ -+ -+ -+#if 0 -+u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E] = { -+ /* Index0 6 dB */ 0x7fc001ff, -+ /* Index1 5.7dB */ 0x7b4001ed, -+ /* Index2 5.4dB */ 0x774001dd, -+ /* Index3 5.1dB */ 0x734001cd, -+ /* Index4 4.8dB */ 0x6f4001bd, -+ /* Index5 4.5dB */ 0x6b8001ae, -+ /* Index6 4.2dB */ 0x67c0019f, -+ /* Index7 3.9dB */ 0x64400191, -+ /* Index8 3.6dB */ 0x60c00183, -+ /* Index9 3.3dB */ 0x5d800176, -+ /* Index10 3 dB */ 0x5a80016a, -+ /* Index11 2.7dB */ 0x5740015d, -+ /* Index12 2.4dB */ 0x54400151, -+ /* Index13 2.1dB */ 0x51800146, -+ /* Index14 1.8dB */ 0x4ec0013b, -+ /* Index15 1.5dB */ 0x4c000130, -+ /* Index16 1.2dB */ 0x49800126, -+ /* Index17 0.9dB */ 0x4700011c, -+ /* Index18 0.6dB */ 0x44800112, -+ /* Index19 0.3dB */ 0x42000108, -+ /* Index20 0 dB */ 0x40000100, // 20 This is OFDM base index -+ /* Index21 -0.3dB */ 0x3dc000f7, -+ /* Index22 -0.6dB */ 0x3bc000ef, -+ /* Index23 -0.9dB */ 0x39c000e7, -+ /* Index24 -1.2dB */ 0x37c000df, -+ /* Index25 -1.5dB */ 0x35c000d7, -+ /* Index26 -1.8dB */ 0x340000d0, -+ /* Index27 -2.1dB */ 0x324000c9, -+ /* Index28 -2.4dB */ 0x308000c2, -+ /* Index29 -2.7dB */ 0x2f0000bc, -+ /* Index30 -3 dB */ 0x2d4000b5, -+ /* Index31 -3.3dB */ 0x2bc000af, -+ /* Index32 -3.6dB */ 0x2a4000a9, -+ /* Index33 -3.9dB */ 0x28c000a3, -+ /* Index34 -4.2dB */ 0x2780009e, -+ /* Index35 -4.5dB */ 0x26000098, -+ /* Index36 -4.8dB */ 0x24c00093, -+ /* Index37 -5.1dB */ 0x2380008e, -+ /* Index38 -5.4dB */ 0x22400089, -+ /* Index39 -5.7dB */ 0x21400085, -+ /* Index40 -6 dB */ 0x20000080, -+ /* Index41 -6.3dB */ 0x1f00007c, -+ /* Index42 -6.6dB */ 0x1e000078, -+ /* Index43 -6.9dB */ 0x1d000074, -+ /* Index44 -7.2dB */ 0x1c000070, -+ /* Index45 -7.5dB */ 0x1b00006c, -+ /* Index46 -7.8dB */ 0x1a000068, -+ /* Index47 -8.1dB */ 0x19400065, -+ /* Index48 -8.4dB */ 0x18400061, -+ /* Index49 -8.7dB */ 0x1780005e, -+ /* Index50 -9 dB */ 0x16c0005b, -+ /* Index51 -9.3dB */ 0x16000058, -+ /* Index52 -9.6dB */ 0x15400055, -+ /* Index53 -9.9dB */ 0x14800052 -+}; -+u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8] = { -+ /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x1C , 0x12 , 0x08 , 0x04}, -+ /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x1B , 0x11 , 0x08 , 0x04}, -+ /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x1A , 0x11 , 0x07 , 0x04}, -+ /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x19 , 0x10 , 0x07 , 0x04}, -+ /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x18 , 0x10 , 0x07 , 0x03}, -+ /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x18 , 0x0F , 0x07 , 0x03}, -+ /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x17 , 0x0F , 0x06 , 0x03}, -+ /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x16 , 0x0E , 0x06 , 0x03}, -+ /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x15 , 0x0E , 0x06 , 0x03}, -+ /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x14 , 0x0D , 0x06 , 0x03}, -+ /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x14 , 0x0D , 0x06 , 0x03}, -+ /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x13 , 0x0C , 0x05 , 0x03}, -+ /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x12 , 0x0C , 0x05 , 0x03}, -+ /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x12 , 0x0B , 0x05 , 0x03}, -+ /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, -+ /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, -+ /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x10 , 0x0A , 0x05 , 0x02}, -+ /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x10 , 0x0A , 0x04 , 0x02}, -+ /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x0F , 0x0A , 0x04 , 0x02}, -+ /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x0E , 0x09 , 0x04 , 0x02}, -+ /* Index20 -6.0dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x0E , 0x09 , 0x04 , 0x02}, // 20 This is CCK base index -+ /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x0E , 0x09 , 0x04 , 0x02}, -+ /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x0D , 0x08 , 0x04 , 0x02}, -+ /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x0D , 0x08 , 0x04 , 0x02}, -+ /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x0C , 0x08 , 0x03 , 0x02}, -+ /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x0C , 0x08 , 0x03 , 0x02}, -+ /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, -+ /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, -+ /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x0B , 0x07 , 0x03 , 0x02}, -+ /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x0A , 0x07 , 0x03 , 0x01}, -+ /* Index30 -9.0dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, // 30 This is hp CCK base index -+ /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, -+ /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x09 , 0x06 , 0x03 , 0x01}, -+ /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x09 , 0x06 , 0x03 , 0x01}, -+ /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x09 , 0x06 , 0x02 , 0x01}, -+ /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, -+ /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, -+ /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x08 , 0x05 , 0x02 , 0x01}, -+ /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, -+ /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, -+ /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, -+ /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, -+ /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, -+ /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x05 , 0x03 , 0x02 , 0x01}, -+ /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x04 , 0x03 , 0x01 , 0x01} -+}; -+u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8] = { -+ /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index20 -6 dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index30 -9 dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00} -+}; -+#endif -+ -+#ifdef AP_BUILD_WORKAROUND -+ -+unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { -+ /* +6.0dB */ 0x7f8001fe, -+ /* +5.5dB */ 0x788001e2, -+ /* +5.0dB */ 0x71c001c7, -+ /* +4.5dB */ 0x6b8001ae, -+ /* +4.0dB */ 0x65400195, -+ /* +3.5dB */ 0x5fc0017f, -+ /* +3.0dB */ 0x5a400169, -+ /* +2.5dB */ 0x55400155, -+ /* +2.0dB */ 0x50800142, -+ /* +1.5dB */ 0x4c000130, -+ /* +1.0dB */ 0x47c0011f, -+ /* +0.5dB */ 0x43c0010f, -+ /* 0.0dB */ 0x40000100, -+ /* -0.5dB */ 0x3c8000f2, -+ /* -1.0dB */ 0x390000e4, -+ /* -1.5dB */ 0x35c000d7, -+ /* -2.0dB */ 0x32c000cb, -+ /* -2.5dB */ 0x300000c0, -+ /* -3.0dB */ 0x2d4000b5, -+ /* -3.5dB */ 0x2ac000ab, -+ /* -4.0dB */ 0x288000a2, -+ /* -4.5dB */ 0x26000098, -+ /* -5.0dB */ 0x24000090, -+ /* -5.5dB */ 0x22000088, -+ /* -6.0dB */ 0x20000080, -+ /* -6.5dB */ 0x1a00006c, -+ /* -7.0dB */ 0x1c800072, -+ /* -7.5dB */ 0x18000060, -+ /* -8.0dB */ 0x19800066, -+ /* -8.5dB */ 0x15800056, -+ /* -9.0dB */ 0x26c0005b, -+ /* -9.5dB */ 0x14400051, -+ /* -10.0dB */ 0x24400051, -+ /* -10.5dB */ 0x1300004c, -+ /* -11.0dB */ 0x12000048, -+ /* -11.5dB */ 0x11000044, -+ /* -12.0dB */ 0x10000040 -+}; -+#endif -+ -+#endif -+ -+ -+u1Byte DeltaSwingTableIdx_2GA_P_DEFAULT[DELTA_SWINGIDX_SIZE] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3 -+, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; -+u1Byte DeltaSwingTableIdx_2GA_N_DEFAULT[DELTA_SWINGIDX_SIZE] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4 -+, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; -+ -+ -+#ifdef CONFIG_WLAN_HAL_8192EE -+u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E] = { -+ /* Index0 6 dB */ 0x7fc001ff, -+ /* Index1 5.7dB */ 0x7b4001ed, -+ /* Index2 5.4dB */ 0x774001dd, -+ /* Index3 5.1dB */ 0x734001cd, -+ /* Index4 4.8dB */ 0x6f4001bd, -+ /* Index5 4.5dB */ 0x6b8001ae, -+ /* Index6 4.2dB */ 0x67c0019f, -+ /* Index7 3.9dB */ 0x64400191, -+ /* Index8 3.6dB */ 0x60c00183, -+ /* Index9 3.3dB */ 0x5d800176, -+ /* Index10 3 dB */ 0x5a80016a, -+ /* Index11 2.7dB */ 0x5740015d, -+ /* Index12 2.4dB */ 0x54400151, -+ /* Index13 2.1dB */ 0x51800146, -+ /* Index14 1.8dB */ 0x4ec0013b, -+ /* Index15 1.5dB */ 0x4c000130, -+ /* Index16 1.2dB */ 0x49800126, -+ /* Index17 0.9dB */ 0x4700011c, -+ /* Index18 0.6dB */ 0x44800112, -+ /* Index19 0.3dB */ 0x42000108, -+ /* Index20 0 dB */ 0x40000100, // 20 This is OFDM base index -+ /* Index21 -0.3dB */ 0x3dc000f7, -+ /* Index22 -0.6dB */ 0x3bc000ef, -+ /* Index23 -0.9dB */ 0x39c000e7, -+ /* Index24 -1.2dB */ 0x37c000df, -+ /* Index25 -1.5dB */ 0x35c000d7, -+ /* Index26 -1.8dB */ 0x340000d0, -+ /* Index27 -2.1dB */ 0x324000c9, -+ /* Index28 -2.4dB */ 0x308000c2, -+ /* Index29 -2.7dB */ 0x2f0000bc, -+ /* Index30 -3 dB */ 0x2d4000b5, -+ /* Index31 -3.3dB */ 0x2bc000af, -+ /* Index32 -3.6dB */ 0x2a4000a9, -+ /* Index33 -3.9dB */ 0x28c000a3, -+ /* Index34 -4.2dB */ 0x2780009e, -+ /* Index35 -4.5dB */ 0x26000098, -+ /* Index36 -4.8dB */ 0x24c00093, -+ /* Index37 -5.1dB */ 0x2380008e, -+ /* Index38 -5.4dB */ 0x22400089, -+ /* Index39 -5.7dB */ 0x21400085, -+ /* Index40 -6 dB */ 0x20000080, -+ /* Index41 -6.3dB */ 0x1f00007c, -+ /* Index42 -6.6dB */ 0x1e000078, -+ /* Index43 -6.9dB */ 0x1d000074, -+ /* Index44 -7.2dB */ 0x1c000070, -+ /* Index45 -7.5dB */ 0x1b00006c, -+ /* Index46 -7.8dB */ 0x1a000068, -+ /* Index47 -8.1dB */ 0x19400065, -+ /* Index48 -8.4dB */ 0x18400061, -+ /* Index49 -8.7dB */ 0x1780005e, -+ /* Index50 -9 dB */ 0x16c0005b, -+ /* Index51 -9.3dB */ 0x16000058, -+ /* Index52 -9.6dB */ 0x15400055, -+ /* Index53 -9.9dB */ 0x14800052 -+}; -+u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8] = { -+ /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x1C , 0x12 , 0x08 , 0x04}, -+ /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x1B , 0x11 , 0x08 , 0x04}, -+ /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x1A , 0x11 , 0x07 , 0x04}, -+ /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x19 , 0x10 , 0x07 , 0x04}, -+ /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x18 , 0x10 , 0x07 , 0x03}, -+ /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x18 , 0x0F , 0x07 , 0x03}, -+ /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x17 , 0x0F , 0x06 , 0x03}, -+ /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x16 , 0x0E , 0x06 , 0x03}, -+ /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x15 , 0x0E , 0x06 , 0x03}, -+ /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x14 , 0x0D , 0x06 , 0x03}, -+ /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x14 , 0x0D , 0x06 , 0x03}, -+ /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x13 , 0x0C , 0x05 , 0x03}, -+ /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x12 , 0x0C , 0x05 , 0x03}, -+ /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x12 , 0x0B , 0x05 , 0x03}, -+ /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, -+ /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, -+ /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x10 , 0x0A , 0x05 , 0x02}, -+ /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x10 , 0x0A , 0x04 , 0x02}, -+ /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x0F , 0x0A , 0x04 , 0x02}, -+ /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x0E , 0x09 , 0x04 , 0x02}, -+ /* Index20 -6.0dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x0E , 0x09 , 0x04 , 0x02}, // 20 This is CCK base index -+ /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x0E , 0x09 , 0x04 , 0x02}, -+ /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x0D , 0x08 , 0x04 , 0x02}, -+ /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x0D , 0x08 , 0x04 , 0x02}, -+ /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x0C , 0x08 , 0x03 , 0x02}, -+ /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x0C , 0x08 , 0x03 , 0x02}, -+ /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, -+ /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, -+ /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x0B , 0x07 , 0x03 , 0x02}, -+ /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x0A , 0x07 , 0x03 , 0x01}, -+ /* Index30 -9.0dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, // 30 This is hp CCK base index -+ /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, -+ /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x09 , 0x06 , 0x03 , 0x01}, -+ /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x09 , 0x06 , 0x03 , 0x01}, -+ /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x09 , 0x06 , 0x02 , 0x01}, -+ /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, -+ /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, -+ /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x08 , 0x05 , 0x02 , 0x01}, -+ /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, -+ /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, -+ /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, -+ /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, -+ /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, -+ /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x06 , 0x04 , 0x02 , 0x01}, -+ /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x05 , 0x03 , 0x02 , 0x01}, -+ /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, -+ /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x04 , 0x03 , 0x01 , 0x01} -+}; -+u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8] = { -+ /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index20 -6 dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index30 -9 dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, -+ /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00} -+}; -+#endif -+ -+#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1) -+u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = -+{ -+ 0x081, // 0, -12.0dB -+ 0x088, // 1, -11.5dB -+ 0x090, // 2, -11.0dB -+ 0x099, // 3, -10.5dB -+ 0x0A2, // 4, -10.0dB -+ 0x0AC, // 5, -9.5dB -+ 0x0B6, // 6, -9.0dB -+ 0x0C0, // 7, -8.5dB -+ 0x0CC, // 8, -8.0dB -+ 0x0D8, // 9, -7.5dB -+ 0x0E5, // 10, -7.0dB -+ 0x0F2, // 11, -6.5dB -+ 0x101, // 12, -6.0dB -+ 0x110, // 13, -5.5dB -+ 0x120, // 14, -5.0dB -+ 0x131, // 15, -4.5dB -+ 0x143, // 16, -4.0dB -+ 0x156, // 17, -3.5dB -+ 0x16A, // 18, -3.0dB -+ 0x180, // 19, -2.5dB -+ 0x197, // 20, -2.0dB -+ 0x1AF, // 21, -1.5dB -+ 0x1C8, // 22, -1.0dB -+ 0x1E3, // 23, -0.5dB -+ 0x200, // 24, +0 dB -+ 0x21E, // 25, +0.5dB -+ 0x23E, // 26, +1.0dB -+ 0x261, // 27, +1.5dB -+ 0x285, // 28, +2.0dB -+ 0x2AB, // 29, +2.5dB -+ 0x2D3, // 30, +3.0dB -+ 0x2FE, // 31, +3.5dB -+ 0x32B, // 32, +4.0dB -+ 0x35C, // 33, +4.5dB -+ 0x38E, // 34, +5.0dB -+ 0x3C4, // 35, +5.5dB -+ 0x3FE // 36, +6.0dB -+}; -+#elif(ODM_IC_11AC_SERIES_SUPPORT) -+u4Byte OFDMSwingTable_8812[OFDM_TABLE_SIZE_8812] = { -+ 0x3FE, // 0, (6dB) -+ 0x3C4, // 1, (5.5dB) -+ 0x38E, // 2, (5dB) -+ 0x35C, // 3, (4.5dB) -+ 0x32B, // 4, (4dB) -+ 0x2FE, // 5, (3.5dB) -+ 0x2D3, // 6, (3dB) -+ 0x2AB, // 7, (2.5dB) -+ 0x285, // 8, (2dB) -+ 0x261, // 9, (1.5dB -+ 0x23E, // 10, (1dB) -+ 0x21E, // 11, (0.5dB) -+ 0x200, // 12, (0dB) 8814 int PA 2G default -+ 0x1E3, // 13, (-0.5dB) -+ 0x1C8, // 14, (-1dB) -+ 0x1AF, // 15, (-1.5dB) -+ 0x197, // 16, (-2dB) -+ 0x180, // 17, (-2.5dB) -+ 0x16A, // 18, (-3dB) 8812 / 8814 int PA 5G / 8814 ext PA 2G5G default -+ 0x156, // 19, (-3.5dB) -+ 0x143, // 20, (-4dB) 8812 HP default -+ 0x131, // 21, (-4.5dB) -+ 0x120, // 22, (-5dB) -+ 0x110, // 23, (-5.5dB) -+ 0x101, // 24, (-6dB) -+ 0x0F2, // 25, (-6.5dB) -+ 0x0E5, // 26, (-7dB) -+ 0x0D8, // 27, (-7.5dB) -+ 0x0CC, // 28, (-8dB) -+ 0x0C0, // 29, (-8.5dB) -+ 0x0B6, // 30, (-9dB) -+ 0x0AC, // 31, (-9.5dB) -+ 0x0A2, // 32, (-10dB) -+ 0x099, // 33, (-10.5dB) -+ 0x090, // 34, (-11dB) -+ 0x088, // 35, (-11.5dB) -+ 0x081, // 36, (-12dB) -+ 0x079, // 37, (-12.5dB) -+ 0x072, // 38, (-13dB) -+ 0x06c, // 39, (-13.5dB) -+ 0x066, // 40, (-14dB) -+ 0x060, // 41, (-14.5dB) -+ 0x05B // 42, (-15dB) -+}; -+#endif -+ -+u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D] = { -+ 0x0CD, -+ 0x0D9, -+ 0x0E6, -+ 0x0F3, -+ 0x102, -+ 0x111, -+ 0x121, -+ 0x132, -+ 0x144, -+ 0x158, -+ 0x16C, -+ 0x182, -+ 0x198, -+ 0x1B1, -+ 0x1CA, -+ 0x1E5, -+ 0x202, -+ 0x221, -+ 0x241, -+ 0x263, -+ 0x287, -+ 0x2AE, -+ 0x2D6, -+ 0x301, -+ 0x32F, -+ 0x35F, -+ 0x392, -+ 0x3C9, -+ 0x402, -+ 0x43F, -+ 0x47F, -+ 0x4C3, -+ 0x50C, -+ 0x558, -+ 0x5A9, -+ 0x5FF, -+ 0x65A, -+ 0x6BA, -+ 0x720, -+ 0x78C, -+ 0x7FF, -+}; -+ -+ -+//#endif -+//3============================================================ -+//3 Tx Power Tracking -+//3============================================================ -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ if (!(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B | ODM_IC_11N_SERIES))) -+ return; -+#endif -+ -+ odm_TXPowerTrackingThermalMeterInit(pDM_Odm); -+} -+ -+ -+u1Byte -+getSwingIndex( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0, BBswingMask = 0; -+ u4Byte bbSwing = 0; -+ u4Byte swingTableSize = 0; -+ pu4Byte pSwingTable = 0; -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (GET_CHIP_VER(priv) == VERSION_8197F) { -+ bbSwing = PHY_QueryBBReg(priv, rOFDM0_XATxIQImbalance, bMaskOFDM_D); -+ pSwingTable = OFDMSwingTable_New; -+ swingTableSize = OFDM_TABLE_SIZE_92D; -+ BBswingMask = 22; -+ } -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (GET_CHIP_VER(priv) == VERSION_8822B) { -+ bbSwing = PHY_QueryBBReg(priv, rA_TxScale_Jaguar, 0xFFE00000); -+ pSwingTable = TxScalingTable_Jaguar; -+ swingTableSize = TXSCALE_TABLE_SIZE; -+ BBswingMask = 0; -+ } -+#endif -+ -+ for (i = 0; i < swingTableSize-1; i++) { -+ u4Byte tableValue = pSwingTable[i] >> BBswingMask; -+ -+ if (bbSwing == tableValue) -+ break; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("bbSwing=0x%x bbswing_index=%d\n", bbSwing, i)); -+ -+ -+ return i; -+} -+ -+ -+VOID -+odm_TXPowerTrackingThermalMeterInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ u1Byte p; -+ u1Byte defaultSwingIndex; -+#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) -+ if ((GET_CHIP_VER(priv) == VERSION_8197F) || (GET_CHIP_VER(priv) == VERSION_8822B)) -+ defaultSwingIndex = getSwingIndex(pDM_Odm); -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ pMgntInfo->bTXPowerTracking = TRUE; -+ pHalData->TXPowercount = 0; -+ pHalData->bTXPowerTrackingInit = FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pHalData->TxPowerTrackControl = TRUE; -+ ODM_RT_TRACE(pDM_Odm,COMP_POWER_TRACKING, DBG_LOUD, ("pMgntInfo->bTXPowerTracking = %d\n", pMgntInfo->bTXPowerTracking)); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #ifdef CONFIG_RTL8188E -+ { -+ pDM_Odm->RFCalibrateInfo.bTXPowerTracking = _TRUE; -+ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; -+ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = _FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; -+ -+ MSG_8192C("pDM_Odm TxPowerTrackControl = %d\n", pDM_Odm->RFCalibrateInfo.TxPowerTrackControl); -+ } -+ #else -+ { -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ -+ //if(IS_HARDWARE_TYPE_8192C(pHalData)) -+ { -+ pdmpriv->bTXPowerTracking = _TRUE; -+ pdmpriv->TXPowercount = 0; -+ pdmpriv->bTXPowerTrackingInit = _FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) //for mp driver, turn off txpwrtracking as default -+ pdmpriv->TxPowerTrackControl = _TRUE; -+ -+ } -+ MSG_8192C("pdmpriv->TxPowerTrackControl = %d\n", pdmpriv->TxPowerTrackControl); -+ -+ } -+ #endif//endif (CONFIG_RTL8188E==1) -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+ #ifdef RTL8188E_SUPPORT -+ { -+ pDM_Odm->RFCalibrateInfo.bTXPowerTracking = _TRUE; -+ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; -+ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = _FALSE; -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; -+ } -+ #endif -+#endif -+ -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = TRUE; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex = 0; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast = 0; -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset = 0; -+ pDM_Odm->RFCalibrateInfo.ThermalValue = 0; -+ pRFCalibrateInfo->DefaultOfdmIndex = 28; -+ -+#if (RTL8197F_SUPPORT == 1) -+ if (GET_CHIP_VER(priv) == VERSION_8197F) { -+ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= (OFDM_TABLE_SIZE_92D - 1)) ? 30 : defaultSwingIndex; -+ pRFCalibrateInfo->DefaultCckIndex = 28; -+ } -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (GET_CHIP_VER(priv) == VERSION_8822B) { -+ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= (TXSCALE_TABLE_SIZE - 1)) ? 24 : defaultSwingIndex; -+ pRFCalibrateInfo->DefaultCckIndex = 20; -+ } -+#endif -+ -+ -+#if RTL8188E_SUPPORT -+ pRFCalibrateInfo->DefaultCckIndex = 20; // -6 dB -+#elif RTL8192E_SUPPORT -+ pRFCalibrateInfo->DefaultCckIndex = 8; // -12 dB -+#endif -+ pRFCalibrateInfo->BbSwingIdxOfdmBase = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; -+ pDM_Odm->RFCalibrateInfo.CCK_index = pRFCalibrateInfo->DefaultCckIndex; -+ -+ for (p = 0; p < MAX_RF_PATH; p++) { -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->KfreeOffset[p] = 0; /* for 8814 kfree*/ -+ } -+ pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->DefaultCckIndex; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("pRFCalibrateInfo->DefaultOfdmIndex=%d pRFCalibrateInfo->DefaultCckIndex=%d\n", pRFCalibrateInfo->DefaultOfdmIndex , pRFCalibrateInfo->DefaultCckIndex)); -+ -+ -+} -+ -+ -+VOID -+ODM_TXPowerTrackingCheck( -+ IN PVOID pDM_VOID -+ ) -+{ -+ // -+ // For AP/ADSL use prtl8192cd_priv -+ // For CE/NIC use PADAPTER -+ // -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ -+ -+ if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ return; -+ -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ odm_TXPowerTrackingCheckMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_TXPowerTrackingCheckCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ odm_TXPowerTrackingCheckAP(pDM_Odm); -+ break; -+ -+ case ODM_ADSL: -+ /*odm_DIGAP(pDM_Odm);*/ -+ break; -+ } -+ -+} -+ -+VOID -+odm_TXPowerTrackingCheckCE( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ #if(RTL8188E_SUPPORT==1) -+ -+ //if(!pMgntInfo->bTXPowerTracking /*|| (!pdmpriv->TxPowerTrackControl && pdmpriv->bAPKdone)*/) -+ if(!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ { -+ return; -+ } -+ -+ if(!pDM_Odm->RFCalibrateInfo.TM_Trigger) //at least delay 1 sec -+ { -+ //pHalData->TxPowerCheckCnt++; //cosa add for debug -+ ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); -+ //DBG_8192C("Trigger 92C Thermal Meter!!\n"); -+ -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; -+ return; -+ -+ } -+ else -+ { -+ //DBG_8192C("Schedule TxPowerTracking direct call!!\n"); -+ odm_TXPowerTrackingCallback_ThermalMeter_8188E(Adapter); -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; -+ } -+ #endif -+ -+#endif -+} -+ -+VOID -+odm_TXPowerTrackingCheckMP( -+ IN PVOID pDM_VOID -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if (ODM_CheckPowerStatus(Adapter) == FALSE) -+ return; -+ -+ if(!Adapter->bSlaveOfDMSP || Adapter->DualMacSmartConcurrent == FALSE) -+ odm_TXPowerTrackingThermalMeterCheck(Adapter); -+#endif -+ -+} -+ -+ -+VOID -+odm_TXPowerTrackingCheckAP( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+#if ((RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType & (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8881A | ODM_RTL8814A | ODM_RTL8197F | ODM_RTL8822B)) -+ ODM_TXPowerTrackingCallback_ThermalMeter(pDM_Odm); -+ else -+#endif -+ { -+ } -+#endif -+ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+odm_TXPowerTrackingThermalMeterCheck( -+ IN PADAPTER Adapter -+ ) -+{ -+#ifndef AP_BUILD_WORKAROUND -+#if (HAL_CODE_BASE==RTL8192_C) -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ static u1Byte TM_Trigger = 0; -+ //u1Byte TxPowerCheckCnt = 5; //10 sec -+ -+ if(!pMgntInfo->bTXPowerTracking /*|| (!pHalData->TxPowerTrackControl && pHalData->bAPKdone)*/) -+ { -+ return; -+ } -+ -+ if(!TM_Trigger) //at least delay 1 sec -+ { -+ if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_8812(Adapter)) -+ PHY_SetRFReg(Adapter, RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03); -+ else -+ PHY_SetRFReg(Adapter, RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger 92C Thermal Meter!!\n")); -+ -+ TM_Trigger = 1; -+ return; -+ } -+ else -+ { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n")); -+ odm_TXPowerTrackingDirectCall(Adapter); //Using direct call is instead, added by Roger, 2009.06.18. -+ TM_Trigger = 0; -+ } -+#endif -+#endif -+} -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ap.h 2018-02-11 21:44:27.157146238 +0200 -@@ -0,0 +1,351 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMPOWERTRACKING_H__ -+#define __PHYDMPOWERTRACKING_H__ -+ -+#define POWRTRACKING_VERSION "1.1" -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#ifdef RTK_AC_SUPPORT -+#define ODM_IC_11AC_SERIES_SUPPORT 1 -+#else -+#define ODM_IC_11AC_SERIES_SUPPORT 0 -+#endif -+#else -+#define ODM_IC_11AC_SERIES_SUPPORT 1 -+#endif -+ -+#define DPK_DELTA_MAPPING_NUM 13 -+#define index_mapping_HP_NUM 15 -+#define DELTA_SWINGIDX_SIZE 30 -+#define DELTA_SWINTSSI_SIZE 61 -+#define BAND_NUM 3 -+#define MAX_RF_PATH 4 -+#define TXSCALE_TABLE_SIZE 37 -+#define CCK_TABLE_SIZE_8723D 41 -+ -+#define IQK_MAC_REG_NUM 4 -+#define IQK_ADDA_REG_NUM 16 -+#define IQK_BB_REG_NUM_MAX 10 -+ -+#define IQK_BB_REG_NUM 9 -+ -+#define HP_THERMAL_NUM 8 -+ -+#define AVG_THERMAL_NUM 8 -+#define IQK_Matrix_REG_NUM 8 -+//#define IQK_Matrix_Settings_NUM 1+24+21 -+#define IQK_Matrix_Settings_NUM (14+24+21) // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G -+ -+#if !defined(_OUTSRC_COEXIST) -+#define OFDM_TABLE_SIZE_92D 43 -+#define OFDM_TABLE_SIZE 37 -+#define CCK_TABLE_SIZE 33 -+#define CCK_TABLE_SIZE_88F 21 -+ -+ -+ -+//#define OFDM_TABLE_SIZE_92E 54 -+//#define CCK_TABLE_SIZE_92E 54 -+extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D]; -+extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; -+ -+ -+extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE_92D]; -+extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -+extern u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16]; -+extern u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -+ -+#endif -+ -+#define ODM_OFDM_TABLE_SIZE 37 -+#define ODM_CCK_TABLE_SIZE 33 -+// <20140613, YuChen> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. -+extern u1Byte DeltaSwingTableIdx_2GA_P_DEFAULT[DELTA_SWINGIDX_SIZE]; -+extern u1Byte DeltaSwingTableIdx_2GA_N_DEFAULT[DELTA_SWINGIDX_SIZE]; -+ -+static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; -+static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; -+ -+//extern u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E]; -+//extern u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8]; -+//extern u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8]; -+ -+#ifdef CONFIG_WLAN_HAL_8192EE -+#define OFDM_TABLE_SIZE_92E 54 -+#define CCK_TABLE_SIZE_92E 54 -+extern u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E]; -+extern u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8]; -+extern u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8]; -+#endif -+ -+#define OFDM_TABLE_SIZE_8812 43 -+#define AVG_THERMAL_NUM_8812 4 -+ -+#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1) -+extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; -+#elif(ODM_IC_11AC_SERIES_SUPPORT) -+extern unsigned int OFDMSwingTable_8812[OFDM_TABLE_SIZE_8812]; -+#endif -+ -+extern u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D]; -+ -+#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck -+ -+typedef struct _IQK_MATRIX_REGS_SETTING{ -+ BOOLEAN bIQKDone; -+ s4Byte Value[1][IQK_Matrix_REG_NUM]; -+}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; -+ -+typedef struct ODM_RF_Calibration_Structure -+{ -+ //for tx power tracking -+ -+ u4Byte RegA24; // for TempCCK -+ s4Byte RegE94; -+ s4Byte RegE9C; -+ s4Byte RegEB4; -+ s4Byte RegEBC; -+ -+ //u1Byte bTXPowerTracking; -+ u1Byte TXPowercount; -+ BOOLEAN bTXPowerTrackingInit; -+ BOOLEAN bTXPowerTracking; -+ u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default -+ u1Byte TM_Trigger; -+ u1Byte InternalPA5G[2]; //pathA / pathB -+ -+ u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 -+ u1Byte ThermalValue; -+ u1Byte ThermalValue_LCK; -+ u1Byte ThermalValue_IQK; -+ u1Byte ThermalValue_DPK; -+ u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; -+ u1Byte ThermalValue_AVG_index; -+ u1Byte ThermalValue_RxGain; -+ u1Byte ThermalValue_Crystal; -+ u1Byte ThermalValue_DPKstore; -+ u1Byte ThermalValue_DPKtrack; -+ BOOLEAN TxPowerTrackingInProgress; -+ BOOLEAN bDPKenable; -+ -+ BOOLEAN bReloadtxpowerindex; -+ u1Byte bRfPiEnable; -+ u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug -+ -+ u1Byte bCCKinCH14; -+ u1Byte CCK_index; -+ u1Byte OFDM_index[MAX_RF_PATH]; -+ s1Byte PowerIndexOffset; -+ s1Byte DeltaPowerIndex; -+ s1Byte DeltaPowerIndexLast; -+ BOOLEAN bTxPowerChanged; -+ -+ u1Byte ThermalValue_HP[HP_THERMAL_NUM]; -+ u1Byte ThermalValue_HP_index; -+ IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; -+ u1Byte Delta_LCK; -+ u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKC_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKC_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKD_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKD_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GC_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GC_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GD_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GD_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GC_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GC_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GD_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GD_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GCCKA[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GCCKB[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GCCKC[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GCCKD[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GA[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GB[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GC[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GD[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_5GA[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_5GB[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_5GC[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_5GD[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; -+ -+ u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; -+ u1Byte BbSwingIdxOfdmCurrent; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; -+#else -+ u1Byte BbSwingIdxOfdmBase; -+#endif -+ BOOLEAN BbSwingFlagOfdm; -+ u1Byte BbSwingIdxCck; -+ u1Byte BbSwingIdxCckCurrent; -+ u1Byte BbSwingIdxCckBase; -+ u1Byte DefaultOfdmIndex; -+ u1Byte DefaultCckIndex; -+ BOOLEAN BbSwingFlagCck; -+ -+ s1Byte Absolute_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Absolute_CCKSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_CCKSwingIdx; -+ s1Byte Modify_TxAGC_Value; /*Remnat compensate value at TxAGC */ -+ BOOLEAN Modify_TxAGC_Flag_PathA; -+ BOOLEAN Modify_TxAGC_Flag_PathB; -+ BOOLEAN Modify_TxAGC_Flag_PathC; -+ BOOLEAN Modify_TxAGC_Flag_PathD; -+ BOOLEAN Modify_TxAGC_Flag_PathA_CCK; -+ -+ s1Byte KfreeOffset[MAX_RF_PATH]; -+ -+ //--------------------------------------------------------------------// -+ -+ //for IQK -+ u4Byte RegC04; -+ u4Byte Reg874; -+ u4Byte RegC08; -+ u4Byte RegB68; -+ u4Byte RegB6C; -+ u4Byte Reg870; -+ u4Byte Reg860; -+ u4Byte Reg864; -+ -+ BOOLEAN bIQKInitialized; -+ BOOLEAN bLCKInProgress; -+ BOOLEAN bAntennaDetected; -+ BOOLEAN bNeedIQK; -+ BOOLEAN bIQKInProgress; -+ BOOLEAN bIQKPAoff; -+ u1Byte Delta_IQK; -+ u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; -+ u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte IQK_BB_backup_recover[9]; -+ u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; -+ u4Byte TxIQC_8723B[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ -+ u4Byte RxIQC_8723B[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ -+ u4Byte TxIQC_8703B[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u4Byte RxIQC_8703B[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ -+ u8Byte IQK_StartTime; -+ u8Byte IQK_TotalProgressingTime; -+ u8Byte IQK_ProgressingTime; -+ u4Byte LOK_Result; -+ u1Byte IQKstep; -+ u1Byte Kcount; -+ u1Byte retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ -+ BOOLEAN isMPmode; -+ -+ //for APK -+ u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a -+ u1Byte bAPKdone; -+ u1Byte bAPKThermalMeterIgnore; -+ u1Byte bDPdone; -+ u1Byte bDPPathAOK; -+ u1Byte bDPPathBOK; -+ -+ /*Add by Yuchen for Kfree Phydm*/ -+ u1Byte RegRfKFreeEnable; /*for registry*/ -+ u1Byte RfKFreeEnable; /*for efuse enable check*/ -+ u4Byte TxLOK[2]; -+}ODM_RF_CAL_T,*PODM_RF_CAL_T; -+ -+VOID -+odm_TXPowerTrackingCheckAP( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+ODM_TXPowerTrackingCheck( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+VOID -+odm_TXPowerTrackingThermalMeterInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingCheckMP( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+VOID -+odm_TXPowerTrackingCheckCE( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+VOID -+odm_TXPowerTrackingCallbackThermalMeter92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingCallbackRXGainThermalMeter92D( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingCallbackThermalMeter92D( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingDirectCall92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingThermalMeterCheck( -+ IN PADAPTER Adapter -+ ); -+ -+#endif -+ -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.c 2018-02-11 21:44:27.157146238 +0200 -@@ -0,0 +1,756 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+/*============================================================ */ -+/* include files */ -+/*============================================================ */ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+//============================================================ -+// Global var -+//============================================================ -+ -+u4Byte OFDMSwingTable[OFDM_TABLE_SIZE] = { -+ 0x7f8001fe, /* 0, +6.0dB */ -+ 0x788001e2, /* 1, +5.5dB */ -+ 0x71c001c7, /* 2, +5.0dB*/ -+ 0x6b8001ae, /* 3, +4.5dB*/ -+ 0x65400195, /* 4, +4.0dB*/ -+ 0x5fc0017f, /* 5, +3.5dB*/ -+ 0x5a400169, /* 6, +3.0dB*/ -+ 0x55400155, /* 7, +2.5dB*/ -+ 0x50800142, /* 8, +2.0dB*/ -+ 0x4c000130, /* 9, +1.5dB*/ -+ 0x47c0011f, /* 10, +1.0dB*/ -+ 0x43c0010f, /* 11, +0.5dB*/ -+ 0x40000100, /* 12, +0dB*/ -+ 0x3c8000f2, /* 13, -0.5dB*/ -+ 0x390000e4, /* 14, -1.0dB*/ -+ 0x35c000d7, /* 15, -1.5dB*/ -+ 0x32c000cb, /* 16, -2.0dB*/ -+ 0x300000c0, /* 17, -2.5dB*/ -+ 0x2d4000b5, /* 18, -3.0dB*/ -+ 0x2ac000ab, /* 19, -3.5dB*/ -+ 0x288000a2, /* 20, -4.0dB*/ -+ 0x26000098, /* 21, -4.5dB*/ -+ 0x24000090, /* 22, -5.0dB*/ -+ 0x22000088, /* 23, -5.5dB*/ -+ 0x20000080, /* 24, -6.0dB*/ -+ 0x1e400079, /* 25, -6.5dB*/ -+ 0x1c800072, /* 26, -7.0dB*/ -+ 0x1b00006c, /* 27. -7.5dB*/ -+ 0x19800066, /* 28, -8.0dB*/ -+ 0x18000060, /* 29, -8.5dB*/ -+ 0x16c0005b, /* 30, -9.0dB*/ -+ 0x15800056, /* 31, -9.5dB*/ -+ 0x14400051, /* 32, -10.0dB*/ -+ 0x1300004c, /* 33, -10.5dB*/ -+ 0x12000048, /* 34, -11.0dB*/ -+ 0x11000044, /* 35, -11.5dB*/ -+ 0x10000040, /* 36, -12.0dB*/ -+}; -+ -+u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, /* 0, +0dB */ -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 1, -0.5dB */ -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 2, -1.0dB*/ -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 3, -1.5dB*/ -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 4, -2.0dB */ -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 5, -2.5dB*/ -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 6, -3.0dB*/ -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 7, -3.5dB*/ -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 8, -4.0dB */ -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 9, -4.5dB*/ -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 10, -5.0dB */ -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 11, -5.5dB*/ -+ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /* 12, -6.0dB <== default */ -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 13, -6.5dB*/ -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 14, -7.0dB */ -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 15, -7.5dB*/ -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 17, -8.5dB*/ -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 18, -9.0dB */ -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 19, -9.5dB*/ -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 20, -10.0dB*/ -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 21, -10.5dB*/ -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 22, -11.0dB*/ -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 23, -11.5dB*/ -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 24, -12.0dB*/ -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 25, -12.5dB*/ -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 26, -13.0dB*/ -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 27, -13.5dB*/ -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 28, -14.0dB*/ -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 29, -14.5dB*/ -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 30, -15.0dB*/ -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 31, -15.5dB*/ -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} /* 32, -16.0dB*/ -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = { -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, /* 0, +0dB */ -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 1, -0.5dB */ -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 2, -1.0dB */ -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /* 3, -1.5dB*/ -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 4, -2.0dB */ -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /* 5, -2.5dB*/ -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 6, -3.0dB */ -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 7, -3.5dB */ -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 8, -4.0dB */ -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /* 9, -4.5dB*/ -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 10, -5.0dB */ -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 11, -5.5dB*/ -+ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 12, -6.0dB <== default*/ -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 13, -6.5dB */ -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 14, -7.0dB */ -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 15, -7.5dB*/ -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 17, -8.5dB*/ -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 18, -9.0dB */ -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 19, -9.5dB*/ -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 20, -10.0dB*/ -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 21, -10.5dB*/ -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 22, -11.0dB*/ -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 23, -11.5dB*/ -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 24, -12.0dB*/ -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 25, -12.5dB*/ -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 26, -13.0dB*/ -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 27, -13.5dB*/ -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 28, -14.0dB*/ -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 29, -14.5dB*/ -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 30, -15.0dB*/ -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 31, -15.5dB*/ -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} /* 32, -16.0dB*/ -+}; -+ -+ -+u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE] = { -+ 0x0b40002d, /* 0, -15.0dB */ -+ 0x0c000030, /* 1, -14.5dB*/ -+ 0x0cc00033, /* 2, -14.0dB*/ -+ 0x0d800036, /* 3, -13.5dB*/ -+ 0x0e400039, /* 4, -13.0dB */ -+ 0x0f00003c, /* 5, -12.5dB*/ -+ 0x10000040, /* 6, -12.0dB*/ -+ 0x11000044, /* 7, -11.5dB*/ -+ 0x12000048, /* 8, -11.0dB*/ -+ 0x1300004c, /* 9, -10.5dB*/ -+ 0x14400051, /* 10, -10.0dB*/ -+ 0x15800056, /* 11, -9.5dB*/ -+ 0x16c0005b, /* 12, -9.0dB*/ -+ 0x18000060, /* 13, -8.5dB*/ -+ 0x19800066, /* 14, -8.0dB*/ -+ 0x1b00006c, /* 15, -7.5dB*/ -+ 0x1c800072, /* 16, -7.0dB*/ -+ 0x1e400079, /* 17, -6.5dB*/ -+ 0x20000080, /* 18, -6.0dB*/ -+ 0x22000088, /* 19, -5.5dB*/ -+ 0x24000090, /* 20, -5.0dB*/ -+ 0x26000098, /* 21, -4.5dB*/ -+ 0x288000a2, /* 22, -4.0dB*/ -+ 0x2ac000ab, /* 23, -3.5dB*/ -+ 0x2d4000b5, /* 24, -3.0dB*/ -+ 0x300000c0, /* 25, -2.5dB*/ -+ 0x32c000cb, /* 26, -2.0dB*/ -+ 0x35c000d7, /* 27, -1.5dB*/ -+ 0x390000e4, /* 28, -1.0dB*/ -+ 0x3c8000f2, /* 29, -0.5dB*/ -+ 0x40000100, /* 30, +0dB*/ -+ 0x43c0010f, /* 31, +0.5dB*/ -+ 0x47c0011f, /* 32, +1.0dB*/ -+ 0x4c000130, /* 33, +1.5dB*/ -+ 0x50800142, /* 34, +2.0dB*/ -+ 0x55400155, /* 35, +2.5dB*/ -+ 0x5a400169, /* 36, +3.0dB*/ -+ 0x5fc0017f, /* 37, +3.5dB*/ -+ 0x65400195, /* 38, +4.0dB*/ -+ 0x6b8001ae, /* 39, +4.5dB*/ -+ 0x71c001c7, /* 40, +5.0dB*/ -+ 0x788001e2, /* 41, +5.5dB*/ -+ 0x7f8001fe /* 42, +6.0dB*/ -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -+{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -+{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -+{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -+{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -+{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -+{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -+{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -+{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -+{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -+{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -+{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -+{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -+{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -+{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -+{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -+{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -+{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -+{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -+{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -+{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -+{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16] = { -+{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -+{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -+{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -+{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -+{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -+{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -+{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -+{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -+{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -+{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -+{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -+{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -+{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -+{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -+{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -+{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -+{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -+{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -+{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -+{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -+{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -+{0x44, 0x42, 0x3C, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -+{0x48, 0x46, 0x3F, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -+{0x4D, 0x4A, 0x43, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -+{0x51, 0x4F, 0x47, 0x2F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -+{0x56, 0x53, 0x4B, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -+{0x5B, 0x58, 0x50, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -+{0x60, 0x5D, 0x54, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -+{0x66, 0x63, 0x59, 0x3B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -+{0x6C, 0x69, 0x5F, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -+{0x73, 0x6F, 0x64, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -+{0x79, 0x76, 0x6A, 0x46, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -+{0x81, 0x7C, 0x71, 0x4A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -+{0x88, 0x84, 0x77, 0x4F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -+{0x90, 0x8C, 0x7E, 0x54, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -+{0x99, 0x94, 0x86, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -+{0xA2, 0x9D, 0x8E, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -+{0xAC, 0xA6, 0x96, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -+{0xB6, 0xB0, 0x9F, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -+{0xC1, 0xBA, 0xA8, 0x6F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -+{0xCC, 0xC5, 0xB2, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -+{0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, /* 0, -16.0dB*/ -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 1, -15.5dB*/ -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 2, -15.0dB*/ -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 3, -14.5dB*/ -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 4, -14.0dB*/ -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 5, -13.5dB*/ -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 6, -13.0dB*/ -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 7, -12.5dB*/ -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 8, -12.0dB*/ -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 9, -11.5dB*/ -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 10, -11.0dB*/ -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 11, -10.5dB*/ -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 12, -10.0dB*/ -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 13, -9.5dB*/ -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 14, -9.0dB */ -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 15, -8.5dB*/ -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 17, -7.5dB*/ -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 18, -7.0dB */ -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 19, -6.5dB*/ -+ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /*20, -6.0dB */ -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 21, -5.5dB*/ -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 22, -5.0dB */ -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 23, -4.5dB*/ -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 24, -4.0dB */ -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 25, -3.5dB*/ -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 26, -3.0dB*/ -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 27, -2.5dB*/ -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 28, -2.0dB */ -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 29, -1.5dB*/ -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 30, -1.0dB*/ -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 31, -0.5dB*/ -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} /* 32, +0dB*/ -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, /* 0, -16.0dB*/ -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 1, -15.5dB*/ -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 2, -15.0dB*/ -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 3, -14.5dB*/ -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 4, -14.0dB*/ -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /*5, -13.5dB*/ -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 6, -13.0dB*/ -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 7, -12.5dB*/ -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 8, -12.0dB*/ -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 9, -11.5dB*/ -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 10, -11.0dB*/ -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /*11, -10.5dB*/ -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 12, -10.0dB*/ -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 13, -9.5dB*/ -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /*14, -9.0dB */ -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 15, -8.5dB*/ -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 17, -7.5dB*/ -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 18, -7.0dB */ -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 19, -6.5dB */ -+ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 20, -6.0dB */ -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 21, -5.5dB*/ -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 22, -5.0dB */ -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /*23, -4.5dB*/ -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 24, -4.0dB */ -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 25, -3.5dB */ -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 26, -3.0dB */ -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /*27, -2.5dB*/ -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 28, -2.0dB */ -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /*29, -1.5dB*/ -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 30, -1.0dB */ -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 31, -0.5dB */ -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} /* 32, +0dB */ -+}; -+u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D] = { -+ 0x0CD, /*0 , -20dB*/ -+ 0x0D9, -+ 0x0E6, -+ 0x0F3, -+ 0x102, -+ 0x111, -+ 0x121, -+ 0x132, -+ 0x144, -+ 0x158, -+ 0x16C, -+ 0x182, -+ 0x198, -+ 0x1B1, -+ 0x1CA, -+ 0x1E5, -+ 0x202, -+ 0x221, -+ 0x241, -+ 0x263, -+ 0x287, -+ 0x2AE, -+ 0x2D6, -+ 0x301, -+ 0x32F, -+ 0x35F, -+ 0x392, -+ 0x3C9, -+ 0x402, -+ 0x43F, -+ 0x47F, -+ 0x4C3, -+ 0x50C, -+ 0x558, -+ 0x5A9, -+ 0x5FF, -+ 0x65A, -+ 0x6BA, -+ 0x720, -+ 0x78C, -+ 0x7FF, -+}; -+ -+ -+u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = -+{ -+ 0x081, /* 0, -12.0dB*/ -+ 0x088, /* 1, -11.5dB*/ -+ 0x090, /* 2, -11.0dB*/ -+ 0x099, /* 3, -10.5dB*/ -+ 0x0A2, /* 4, -10.0dB*/ -+ 0x0AC, /* 5, -9.5dB*/ -+ 0x0B6, /* 6, -9.0dB*/ -+ 0x0C0, /*7, -8.5dB*/ -+ 0x0CC, /* 8, -8.0dB*/ -+ 0x0D8, /* 9, -7.5dB*/ -+ 0x0E5, /* 10, -7.0dB*/ -+ 0x0F2, /* 11, -6.5dB*/ -+ 0x101, /* 12, -6.0dB*/ -+ 0x110, /* 13, -5.5dB*/ -+ 0x120, /* 14, -5.0dB*/ -+ 0x131, /* 15, -4.5dB*/ -+ 0x143, /* 16, -4.0dB*/ -+ 0x156, /* 17, -3.5dB*/ -+ 0x16A, /* 18, -3.0dB*/ -+ 0x180, /* 19, -2.5dB*/ -+ 0x197, /* 20, -2.0dB*/ -+ 0x1AF, /* 21, -1.5dB*/ -+ 0x1C8, /* 22, -1.0dB*/ -+ 0x1E3, /* 23, -0.5dB*/ -+ 0x200, /* 24, +0 dB*/ -+ 0x21E, /* 25, +0.5dB*/ -+ 0x23E, /* 26, +1.0dB*/ -+ 0x261, /* 27, +1.5dB*/ -+ 0x285,/* 28, +2.0dB*/ -+ 0x2AB, /* 29, +2.5dB*/ -+ 0x2D3, /*30, +3.0dB*/ -+ 0x2FE, /* 31, +3.5dB*/ -+ 0x32B, /* 32, +4.0dB*/ -+ 0x35C, /* 33, +4.5dB*/ -+ 0x38E, /* 34, +5.0dB*/ -+ 0x3C4, /* 35, +5.5dB*/ -+ 0x3FE /* 36, +6.0dB */ -+}; -+ -+#ifdef AP_BUILD_WORKAROUND -+ -+unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { -+ /* +6.0dB */ 0x7f8001fe, -+ /* +5.5dB */ 0x788001e2, -+ /* +5.0dB */ 0x71c001c7, -+ /* +4.5dB */ 0x6b8001ae, -+ /* +4.0dB */ 0x65400195, -+ /* +3.5dB */ 0x5fc0017f, -+ /* +3.0dB */ 0x5a400169, -+ /* +2.5dB */ 0x55400155, -+ /* +2.0dB */ 0x50800142, -+ /* +1.5dB */ 0x4c000130, -+ /* +1.0dB */ 0x47c0011f, -+ /* +0.5dB */ 0x43c0010f, -+ /* 0.0dB */ 0x40000100, -+ /* -0.5dB */ 0x3c8000f2, -+ /* -1.0dB */ 0x390000e4, -+ /* -1.5dB */ 0x35c000d7, -+ /* -2.0dB */ 0x32c000cb, -+ /* -2.5dB */ 0x300000c0, -+ /* -3.0dB */ 0x2d4000b5, -+ /* -3.5dB */ 0x2ac000ab, -+ /* -4.0dB */ 0x288000a2, -+ /* -4.5dB */ 0x26000098, -+ /* -5.0dB */ 0x24000090, -+ /* -5.5dB */ 0x22000088, -+ /* -6.0dB */ 0x20000080, -+ /* -6.5dB */ 0x1a00006c, -+ /* -7.0dB */ 0x1c800072, -+ /* -7.5dB */ 0x18000060, -+ /* -8.0dB */ 0x19800066, -+ /* -8.5dB */ 0x15800056, -+ /* -9.0dB */ 0x26c0005b, -+ /* -9.5dB */ 0x14400051, -+ /* -10.0dB */ 0x24400051, -+ /* -10.5dB */ 0x1300004c, -+ /* -11.0dB */ 0x12000048, -+ /* -11.5dB */ 0x11000044, -+ /* -12.0dB */ 0x10000040 -+}; -+#endif -+ -+ -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ if (!(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_IC_11N_SERIES | ODM_RTL8822B))) -+ return; -+#endif -+ -+ odm_TXPowerTrackingThermalMeterInit(pDM_Odm); -+} -+ -+u1Byte -+getSwingIndex( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u1Byte i = 0; -+ u4Byte bbSwing; -+ u4Byte swingTableSize; -+ pu4Byte pSwingTable; -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B -+ || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8703B -+ ) { -+ bbSwing = PHY_QueryBBReg(Adapter, rOFDM0_XATxIQImbalance, 0xFFC00000); -+ -+ pSwingTable = OFDMSwingTable_New; -+ swingTableSize = OFDM_TABLE_SIZE; -+ } else { -+#if ((RTL8812A_SUPPORT==1)||(RTL8821A_SUPPORT==1)) -+ if (pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ bbSwing = PHY_GetTxBBSwing_8812A(Adapter, pHalData->CurrentBandType, ODM_RF_PATH_A); -+ pSwingTable = TxScalingTable_Jaguar; -+ swingTableSize = TXSCALE_TABLE_SIZE; -+ } -+ else -+#endif -+ { -+ bbSwing = 0; -+ pSwingTable = OFDMSwingTable; -+ swingTableSize = OFDM_TABLE_SIZE; -+ } -+ } -+ -+ for (i = 0; i < swingTableSize; ++i) { -+ u4Byte tableValue = pSwingTable[i]; -+ -+ if (tableValue >= 0x100000 ) -+ tableValue >>= 22; -+ if (bbSwing == tableValue) -+ break; -+ } -+ return i; -+} -+ -+VOID -+odm_TXPowerTrackingThermalMeterInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte defaultSwingIndex = getSwingIndex(pDM_Odm); -+ u1Byte p = 0; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pHalData->TxPowerTrackControl = TRUE; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ pRFCalibrateInfo->bTXPowerTracking = _TRUE; -+ pRFCalibrateInfo->TXPowercount = 0; -+ pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; -+ else -+ pRFCalibrateInfo->TxPowerTrackControl = _FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("pDM_Odm TxPowerTrackControl = %d\n", pRFCalibrateInfo->TxPowerTrackControl)); -+ -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ #ifdef RTL8188E_SUPPORT -+ { -+ pRFCalibrateInfo->bTXPowerTracking = _TRUE; -+ pRFCalibrateInfo->TXPowercount = 0; -+ pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; -+ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; -+ } -+ #endif -+#endif -+ -+ //pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = TRUE; -+ pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; -+ pRFCalibrateInfo->ThermalValue_IQK = pHalData->EEPROMThermalMeter; -+ pRFCalibrateInfo->ThermalValue_LCK = pHalData->EEPROMThermalMeter; -+ -+ if (pRFCalibrateInfo->DefaultBbSwingIndexFlag != TRUE) { -+ /*The index of "0 dB" in SwingTable.*/ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || -+ pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8703B) { -+ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= OFDM_TABLE_SIZE) ? 30 : defaultSwingIndex; -+ pRFCalibrateInfo->DefaultCckIndex = 20; -+ } else if (pDM_Odm->SupportICType == ODM_RTL8188F) { /*add by Mingzhi.Guo 2015-03-23*/ -+ pRFCalibrateInfo->DefaultOfdmIndex = 28; /*OFDM: -1dB*/ -+ pRFCalibrateInfo->DefaultCckIndex = 20; /*CCK:-6dB*/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8723D) { /*add by zhaohe 2015-10-27*/ -+ pRFCalibrateInfo->DefaultOfdmIndex = 28; /*OFDM: -1dB*/ -+ pRFCalibrateInfo->DefaultCckIndex = 28; /*CCK: -6dB*/ -+ } else { -+ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= TXSCALE_TABLE_SIZE) ? 24 : defaultSwingIndex; -+ pRFCalibrateInfo->DefaultCckIndex = 24; -+ } -+ pRFCalibrateInfo->DefaultBbSwingIndexFlag = TRUE; -+ } -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; -+ pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->DefaultCckIndex; -+ -+ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) -+ { -+ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->DeltaPowerIndex[p] = 0; -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ } -+ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM = 0; -+ pRFCalibrateInfo->Modify_TxAGC_Value_CCK = 0; -+ -+} -+ -+ -+VOID -+ODM_TXPowerTrackingCheck( -+ IN PVOID pDM_VOID -+ ) -+{ -+ /* 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ at the same time. In the stage2/3, we need to prive universal interface and merge all -+ HW dynamic mechanism. */ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ odm_TXPowerTrackingCheckMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_TXPowerTrackingCheckCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ odm_TXPowerTrackingCheckAP(pDM_Odm); -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+VOID -+odm_TXPowerTrackingCheckCE( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ return; -+ -+ if (!pDM_Odm->RFCalibrateInfo.TM_Trigger) { -+ -+ if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) -+ || IS_HARDWARE_TYPE_8723B(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter) -+ || IS_HARDWARE_TYPE_8703B(Adapter) || IS_HARDWARE_TYPE_8723D(Adapter) || IS_HARDWARE_TYPE_8822B(Adapter) -+ || IS_HARDWARE_TYPE_8821C(Adapter) -+ ) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_NEW, (BIT17 | BIT16), 0x03); -+ } else { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_OLD, bRFRegOffsetMask, 0x60); -+ } -+ -+ -+ -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; -+ return; -+ } -+ else -+ { -+ -+ ODM_TXPowerTrackingCallback_ThermalMeter(Adapter); -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; -+ } -+ -+#endif -+} -+ -+VOID -+odm_TXPowerTrackingCheckMP( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if (ODM_CheckPowerStatus(Adapter) == FALSE) -+ { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("===>ODM_CheckPowerStatus() return FALSE\n")); -+ return; -+ } -+ -+ odm_TXPowerTrackingThermalMeterCheck(Adapter); -+#endif -+ -+} -+ -+ -+VOID -+odm_TXPowerTrackingCheckAP( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ return; -+ -+#endif -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+odm_TXPowerTrackingThermalMeterCheck( -+ IN PADAPTER Adapter -+ ) -+{ -+#ifndef AP_BUILD_WORKAROUND -+ static u1Byte TM_Trigger = 0; -+ -+ if (!(GET_HAL_DATA(Adapter)->DM_OutSrc.SupportAbility & ODM_RF_TX_PWR_TRACK)) { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, -+ ("===>odm_TXPowerTrackingThermalMeterCheck(),pMgntInfo->bTXPowerTracking is FALSE, return!!\n")); -+ return; -+ } -+ -+ if (!TM_Trigger) { -+ if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) || -+ IS_HARDWARE_TYPE_8723B(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter) -+ || IS_HARDWARE_TYPE_8703B(Adapter) || IS_HARDWARE_TYPE_8723D(Adapter)) -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03); -+ else -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); -+ -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger Thermal Meter!!\n")); -+ -+ TM_Trigger = 1; -+ return; -+ } else { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n")); -+ odm_TXPowerTrackingDirectCall(Adapter); -+ TM_Trigger = 0; -+ } -+#endif -+} -+#endif -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_ce.h 2018-02-11 21:44:27.157146238 +0200 -@@ -0,0 +1,334 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMPOWERTRACKING_H__ -+#define __PHYDMPOWERTRACKING_H__ -+ -+#define POWRTRACKING_VERSION "1.1" -+ -+#define DPK_DELTA_MAPPING_NUM 13 -+#define index_mapping_HP_NUM 15 -+#define OFDM_TABLE_SIZE 43 -+#define CCK_TABLE_SIZE 33 -+#define CCK_TABLE_SIZE_88F 21 -+#define TXSCALE_TABLE_SIZE 37 -+#define CCK_TABLE_SIZE_8723D 41 -+ -+#define TXPWR_TRACK_TABLE_SIZE 30 -+#define DELTA_SWINGIDX_SIZE 30 -+#define DELTA_SWINTSSI_SIZE 61 -+#define BAND_NUM 4 -+ -+#define AVG_THERMAL_NUM 8 -+#define HP_THERMAL_NUM 8 -+#define IQK_MAC_REG_NUM 4 -+#define IQK_ADDA_REG_NUM 16 -+#define IQK_BB_REG_NUM_MAX 10 -+ -+#define IQK_BB_REG_NUM 9 -+ -+ -+ -+#define IQK_Matrix_REG_NUM 8 -+#define IQK_Matrix_Settings_NUM 14+24+21 // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G -+ -+extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE]; -+extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; -+ -+extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE]; -+extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -+extern u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16]; -+extern u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -+extern u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D]; -+ -+extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; -+ -+// <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. -+static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; -+static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; -+ -+#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck -+ -+typedef struct _IQK_MATRIX_REGS_SETTING{ -+ BOOLEAN bIQKDone; -+ s4Byte Value[3][IQK_Matrix_REG_NUM]; -+ BOOLEAN bBWIqkResultSaved[3]; -+}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; -+ -+typedef struct ODM_RF_Calibration_Structure -+{ -+ //for tx power tracking -+ -+ u4Byte RegA24; // for TempCCK -+ s4Byte RegE94; -+ s4Byte RegE9C; -+ s4Byte RegEB4; -+ s4Byte RegEBC; -+ -+ u1Byte TXPowercount; -+ BOOLEAN bTXPowerTrackingInit; -+ BOOLEAN bTXPowerTracking; -+ u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default -+ u1Byte TM_Trigger; -+ u1Byte InternalPA5G[2]; //pathA / pathB -+ -+ u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 -+ u1Byte ThermalValue; -+ u1Byte ThermalValue_LCK; -+ u1Byte ThermalValue_IQK; -+ u1Byte ThermalValue_DPK; -+ u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; -+ u1Byte ThermalValue_AVG_index; -+ u1Byte ThermalValue_RxGain; -+ u1Byte ThermalValue_Crystal; -+ u1Byte ThermalValue_DPKstore; -+ u1Byte ThermalValue_DPKtrack; -+ BOOLEAN TxPowerTrackingInProgress; -+ -+ BOOLEAN bReloadtxpowerindex; -+ u1Byte bRfPiEnable; -+ u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug -+ -+ -+ //------------------------- Tx power Tracking -------------------------// -+ u1Byte bCCKinCH14; -+ u1Byte CCK_index; -+ u1Byte OFDM_index[MAX_RF_PATH]; -+ s1Byte PowerIndexOffset[MAX_RF_PATH]; -+ s1Byte DeltaPowerIndex[MAX_RF_PATH]; -+ s1Byte DeltaPowerIndexLast[MAX_RF_PATH]; -+ BOOLEAN bTxPowerChanged; -+ s1Byte XtalOffset; -+ s1Byte XtalOffsetLast; -+ -+ u1Byte ThermalValue_HP[HP_THERMAL_NUM]; -+ u1Byte ThermalValue_HP_index; -+ IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; -+ u1Byte Delta_LCK; -+ s1Byte BBSwingDiff2G, BBSwingDiff5G; // Unit: dB -+ u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKC_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKC_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKD_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKD_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GC_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GC_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GD_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GD_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GC_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GC_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GD_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GD_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GCCKA[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GCCKB[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GCCKC[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GCCKD[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GA[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GB[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GC[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GD[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_5GA[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_5GB[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_5GC[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_5GD[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ s1Byte DeltaSwingTableXtal_P[DELTA_SWINGIDX_SIZE]; -+ s1Byte DeltaSwingTableXtal_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; -+ -+ u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; -+ u1Byte BbSwingIdxOfdmCurrent; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; -+#else -+ u1Byte BbSwingIdxOfdmBase; -+#endif -+ BOOLEAN DefaultBbSwingIndexFlag; -+ BOOLEAN BbSwingFlagOfdm; -+ u1Byte BbSwingIdxCck; -+ u1Byte BbSwingIdxCckCurrent; -+ u1Byte BbSwingIdxCckBase; -+ u1Byte DefaultOfdmIndex; -+ u1Byte DefaultCckIndex; -+ BOOLEAN BbSwingFlagCck; -+ -+ s1Byte Absolute_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Absolute_CCKSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_CCKSwingIdx; -+ s1Byte Modify_TxAGC_Value; /*Remnat compensate value at TxAGC */ -+ BOOLEAN Modify_TxAGC_Flag_PathA; -+ BOOLEAN Modify_TxAGC_Flag_PathB; -+ BOOLEAN Modify_TxAGC_Flag_PathC; -+ BOOLEAN Modify_TxAGC_Flag_PathD; -+ BOOLEAN Modify_TxAGC_Flag_PathA_CCK; -+ -+ s1Byte KfreeOffset[MAX_RF_PATH]; -+ -+ //--------------------------------------------------------------------// -+ -+ //for IQK -+ u4Byte RegC04; -+ u4Byte Reg874; -+ u4Byte RegC08; -+ u4Byte RegB68; -+ u4Byte RegB6C; -+ u4Byte Reg870; -+ u4Byte Reg860; -+ u4Byte Reg864; -+ -+ BOOLEAN bIQKInitialized; -+ BOOLEAN bLCKInProgress; -+ BOOLEAN bAntennaDetected; -+ BOOLEAN bNeedIQK; -+ BOOLEAN bIQKInProgress; -+ BOOLEAN bIQKPAoff; -+ u1Byte Delta_IQK; -+ u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; -+ u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte IQK_BB_backup_recover[9]; -+ u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; -+ u4Byte TxIQC_8723B[2][3][2]; // { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} -+ u4Byte RxIQC_8723B[2][2][2]; // { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} -+ u4Byte TxIQC_8703B[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u4Byte RxIQC_8703B[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ u4Byte TxIQC_8723D[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u4Byte RxIQC_8723D[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ -+ u1Byte IQKstep; -+ u1Byte Kcount; -+ u1Byte retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ -+ BOOLEAN isMPmode; -+ -+ -+ -+ // IQK time measurement -+ u8Byte IQK_StartTime; -+ u8Byte IQK_ProgressingTime; -+ u8Byte IQK_TotalProgressingTime; -+ -+ u4Byte LOK_Result; -+ -+ //for APK -+ u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a -+ u1Byte bAPKdone; -+ u1Byte bAPKThermalMeterIgnore; -+ -+ // DPK -+ BOOLEAN bDPKFail; -+ u1Byte bDPdone; -+ u1Byte bDPPathAOK; -+ u1Byte bDPPathBOK; -+ -+ u4Byte TxLOK[2]; -+ u4Byte DpkTxAGC; -+ s4Byte DpkGain; -+ u4Byte DpkThermal[4]; -+ s1Byte Modify_TxAGC_Value_OFDM; -+ s1Byte Modify_TxAGC_Value_CCK; -+ -+ /*Add by Yuchen for Kfree Phydm*/ -+ u1Byte RegRfKFreeEnable; /*for registry*/ -+ u1Byte RfKFreeEnable; /*for efuse enable check*/ -+ -+}ODM_RF_CAL_T,*PODM_RF_CAL_T; -+ -+ -+VOID -+ODM_TXPowerTrackingCheck( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingCheckAP( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingThermalMeterInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingCheckMP( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+VOID -+odm_TXPowerTrackingCheckCE( -+ IN PVOID pDM_VOID -+ ); -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+VOID -+odm_TXPowerTrackingCallbackThermalMeter92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingCallbackRXGainThermalMeter92D( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingCallbackThermalMeter92D( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingDirectCall92C( -+ IN PADAPTER Adapter -+ ); -+ -+VOID -+odm_TXPowerTrackingThermalMeterCheck( -+ IN PADAPTER Adapter -+ ); -+ -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.c 2018-02-11 21:44:27.157146238 +0200 -@@ -0,0 +1,784 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+//============================================================ -+// Global var -+//============================================================ -+ -+u4Byte OFDMSwingTable[OFDM_TABLE_SIZE] = { -+ 0x7f8001fe, // 0, +6.0dB -+ 0x788001e2, // 1, +5.5dB -+ 0x71c001c7, // 2, +5.0dB -+ 0x6b8001ae, // 3, +4.5dB -+ 0x65400195, // 4, +4.0dB -+ 0x5fc0017f, // 5, +3.5dB -+ 0x5a400169, // 6, +3.0dB -+ 0x55400155, // 7, +2.5dB -+ 0x50800142, // 8, +2.0dB -+ 0x4c000130, // 9, +1.5dB -+ 0x47c0011f, // 10, +1.0dB -+ 0x43c0010f, // 11, +0.5dB -+ 0x40000100, // 12, +0dB -+ 0x3c8000f2, // 13, -0.5dB -+ 0x390000e4, // 14, -1.0dB -+ 0x35c000d7, // 15, -1.5dB -+ 0x32c000cb, // 16, -2.0dB -+ 0x300000c0, // 17, -2.5dB -+ 0x2d4000b5, // 18, -3.0dB -+ 0x2ac000ab, // 19, -3.5dB -+ 0x288000a2, // 20, -4.0dB -+ 0x26000098, // 21, -4.5dB -+ 0x24000090, // 22, -5.0dB -+ 0x22000088, // 23, -5.5dB -+ 0x20000080, // 24, -6.0dB -+ 0x1e400079, // 25, -6.5dB -+ 0x1c800072, // 26, -7.0dB -+ 0x1b00006c, // 27. -7.5dB -+ 0x19800066, // 28, -8.0dB -+ 0x18000060, // 29, -8.5dB -+ 0x16c0005b, // 30, -9.0dB -+ 0x15800056, // 31, -9.5dB -+ 0x14400051, // 32, -10.0dB -+ 0x1300004c, // 33, -10.5dB -+ 0x12000048, // 34, -11.0dB -+ 0x11000044, // 35, -11.5dB -+ 0x10000040, // 36, -12.0dB -+}; -+ -+u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, // 0, +0dB -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 1, -0.5dB -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 2, -1.0dB -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 3, -1.5dB -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 4, -2.0dB -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 5, -2.5dB -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 6, -3.0dB -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 7, -3.5dB -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 8, -4.0dB -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 9, -4.5dB -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 10, -5.0dB -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 11, -5.5dB -+ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 12, -6.0dB <== default -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 13, -6.5dB -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 14, -7.0dB -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 15, -7.5dB -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 17, -8.5dB -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 18, -9.0dB -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 19, -9.5dB -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 20, -10.0dB -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 21, -10.5dB -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 22, -11.0dB -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 23, -11.5dB -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 24, -12.0dB -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 25, -12.5dB -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 26, -13.0dB -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 27, -13.5dB -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 28, -14.0dB -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 29, -14.5dB -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 30, -15.0dB -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 31, -15.5dB -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} // 32, -16.0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = { -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, // 0, +0dB -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 1, -0.5dB -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 2, -1.0dB -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 3, -1.5dB -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 4, -2.0dB -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 5, -2.5dB -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 6, -3.0dB -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 7, -3.5dB -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 8, -4.0dB -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 9, -4.5dB -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 10, -5.0dB -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 11, -5.5dB -+ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 12, -6.0dB <== default -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 13, -6.5dB -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 14, -7.0dB -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 15, -7.5dB -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 17, -8.5dB -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 18, -9.0dB -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 19, -9.5dB -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 20, -10.0dB -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 21, -10.5dB -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 22, -11.0dB -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 23, -11.5dB -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 24, -12.0dB -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 25, -12.5dB -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 26, -13.0dB -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 27, -13.5dB -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 28, -14.0dB -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 29, -14.5dB -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 30, -15.0dB -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 31, -15.5dB -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} // 32, -16.0dB -+}; -+ -+ -+u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE] = { -+ 0x0b40002d, // 0, -15.0dB -+ 0x0c000030, // 1, -14.5dB -+ 0x0cc00033, // 2, -14.0dB -+ 0x0d800036, // 3, -13.5dB -+ 0x0e400039, // 4, -13.0dB -+ 0x0f00003c, // 5, -12.5dB -+ 0x10000040, // 6, -12.0dB -+ 0x11000044, // 7, -11.5dB -+ 0x12000048, // 8, -11.0dB -+ 0x1300004c, // 9, -10.5dB -+ 0x14400051, // 10, -10.0dB -+ 0x15800056, // 11, -9.5dB -+ 0x16c0005b, // 12, -9.0dB -+ 0x18000060, // 13, -8.5dB -+ 0x19800066, // 14, -8.0dB -+ 0x1b00006c, // 15, -7.5dB -+ 0x1c800072, // 16, -7.0dB -+ 0x1e400079, // 17, -6.5dB -+ 0x20000080, // 18, -6.0dB -+ 0x22000088, // 19, -5.5dB -+ 0x24000090, // 20, -5.0dB -+ 0x26000098, // 21, -4.5dB -+ 0x288000a2, // 22, -4.0dB -+ 0x2ac000ab, // 23, -3.5dB -+ 0x2d4000b5, // 24, -3.0dB -+ 0x300000c0, // 25, -2.5dB -+ 0x32c000cb, // 26, -2.0dB -+ 0x35c000d7, // 27, -1.5dB -+ 0x390000e4, // 28, -1.0dB -+ 0x3c8000f2, // 29, -0.5dB -+ 0x40000100, // 30, +0dB -+ 0x43c0010f, // 31, +0.5dB -+ 0x47c0011f, // 32, +1.0dB -+ 0x4c000130, // 33, +1.5dB -+ 0x50800142, // 34, +2.0dB -+ 0x55400155, // 35, +2.5dB -+ 0x5a400169, // 36, +3.0dB -+ 0x5fc0017f, // 37, +3.5dB -+ 0x65400195, // 38, +4.0dB -+ 0x6b8001ae, // 39, +4.5dB -+ 0x71c001c7, // 40, +5.0dB -+ 0x788001e2, // 41, +5.5dB -+ 0x7f8001fe // 42, +6.0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -+{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -+{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -+{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -+{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -+{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -+{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -+{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -+{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -+{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -+{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -+{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -+{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -+{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -+{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -+{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -+{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -+{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -+{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -+{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -+{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -+{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16] = { -+{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -+{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -+{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -+{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -+{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -+{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -+{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -+{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -+{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -+{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -+{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -+{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -+{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -+{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -+{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -+{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -+{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -+{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -+{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -+{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -+{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -+{0x44, 0x42, 0x3C, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -+{0x48, 0x46, 0x3F, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -+{0x4D, 0x4A, 0x43, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -+{0x51, 0x4F, 0x47, 0x2F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -+{0x56, 0x53, 0x4B, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -+{0x5B, 0x58, 0x50, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -+{0x60, 0x5D, 0x54, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -+{0x66, 0x63, 0x59, 0x3B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -+{0x6C, 0x69, 0x5F, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -+{0x73, 0x6F, 0x64, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -+{0x79, 0x76, 0x6A, 0x46, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -+{0x81, 0x7C, 0x71, 0x4A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -+{0x88, 0x84, 0x77, 0x4F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -+{0x90, 0x8C, 0x7E, 0x54, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -+{0x99, 0x94, 0x86, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -+{0xA2, 0x9D, 0x8E, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -+{0xAC, 0xA6, 0x96, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -+{0xB6, 0xB0, 0x9F, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -+{0xC1, 0xBA, 0xA8, 0x6F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -+{0xCC, 0xC5, 0xB2, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -+{0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -+}; -+ -+ -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB -+ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB -+ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB -+}; -+u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D] = { -+ 0x0CD, -+ 0x0D9, -+ 0x0E6, -+ 0x0F3, -+ 0x102, -+ 0x111, -+ 0x121, -+ 0x132, -+ 0x144, -+ 0x158, -+ 0x16C, -+ 0x182, -+ 0x198, -+ 0x1B1, -+ 0x1CA, -+ 0x1E5, -+ 0x202, -+ 0x221, -+ 0x241, -+ 0x263, -+ 0x287, -+ 0x2AE, -+ 0x2D6, -+ 0x301, -+ 0x32F, -+ 0x35F, -+ 0x392, -+ 0x3C9, -+ 0x402, -+ 0x43F, -+ 0x47F, -+ 0x4C3, -+ 0x50C, -+ 0x558, -+ 0x5A9, -+ 0x5FF, -+ 0x65A, -+ 0x6BA, -+ 0x720, -+ 0x78C, -+ 0x7FF, -+}; -+ -+ -+u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = -+{ -+ 0x081, // 0, -12.0dB -+ 0x088, // 1, -11.5dB -+ 0x090, // 2, -11.0dB -+ 0x099, // 3, -10.5dB -+ 0x0A2, // 4, -10.0dB -+ 0x0AC, // 5, -9.5dB -+ 0x0B6, // 6, -9.0dB -+ 0x0C0, // 7, -8.5dB -+ 0x0CC, // 8, -8.0dB -+ 0x0D8, // 9, -7.5dB -+ 0x0E5, // 10, -7.0dB -+ 0x0F2, // 11, -6.5dB -+ 0x101, // 12, -6.0dB -+ 0x110, // 13, -5.5dB -+ 0x120, // 14, -5.0dB -+ 0x131, // 15, -4.5dB -+ 0x143, // 16, -4.0dB -+ 0x156, // 17, -3.5dB -+ 0x16A, // 18, -3.0dB -+ 0x180, // 19, -2.5dB -+ 0x197, // 20, -2.0dB -+ 0x1AF, // 21, -1.5dB -+ 0x1C8, // 22, -1.0dB -+ 0x1E3, // 23, -0.5dB -+ 0x200, // 24, +0 dB -+ 0x21E, // 25, +0.5dB -+ 0x23E, // 26, +1.0dB -+ 0x261, // 27, +1.5dB -+ 0x285, // 28, +2.0dB -+ 0x2AB, // 29, +2.5dB -+ 0x2D3, // 30, +3.0dB -+ 0x2FE, // 31, +3.5dB -+ 0x32B, // 32, +4.0dB -+ 0x35C, // 33, +4.5dB -+ 0x38E, // 34, +5.0dB -+ 0x3C4, // 35, +5.5dB -+ 0x3FE // 36, +6.0dB -+}; -+ -+ -+#ifdef AP_BUILD_WORKAROUND -+ -+unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { -+ /* +6.0dB */ 0x7f8001fe, -+ /* +5.5dB */ 0x788001e2, -+ /* +5.0dB */ 0x71c001c7, -+ /* +4.5dB */ 0x6b8001ae, -+ /* +4.0dB */ 0x65400195, -+ /* +3.5dB */ 0x5fc0017f, -+ /* +3.0dB */ 0x5a400169, -+ /* +2.5dB */ 0x55400155, -+ /* +2.0dB */ 0x50800142, -+ /* +1.5dB */ 0x4c000130, -+ /* +1.0dB */ 0x47c0011f, -+ /* +0.5dB */ 0x43c0010f, -+ /* 0.0dB */ 0x40000100, -+ /* -0.5dB */ 0x3c8000f2, -+ /* -1.0dB */ 0x390000e4, -+ /* -1.5dB */ 0x35c000d7, -+ /* -2.0dB */ 0x32c000cb, -+ /* -2.5dB */ 0x300000c0, -+ /* -3.0dB */ 0x2d4000b5, -+ /* -3.5dB */ 0x2ac000ab, -+ /* -4.0dB */ 0x288000a2, -+ /* -4.5dB */ 0x26000098, -+ /* -5.0dB */ 0x24000090, -+ /* -5.5dB */ 0x22000088, -+ /* -6.0dB */ 0x20000080, -+ /* -6.5dB */ 0x1a00006c, -+ /* -7.0dB */ 0x1c800072, -+ /* -7.5dB */ 0x18000060, -+ /* -8.0dB */ 0x19800066, -+ /* -8.5dB */ 0x15800056, -+ /* -9.0dB */ 0x26c0005b, -+ /* -9.5dB */ 0x14400051, -+ /* -10.0dB */ 0x24400051, -+ /* -10.5dB */ 0x1300004c, -+ /* -11.0dB */ 0x12000048, -+ /* -11.5dB */ 0x11000044, -+ /* -12.0dB */ 0x10000040 -+}; -+ -+#endif -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ if (!(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_IC_11N_SERIES | ODM_RTL8822B))) -+ return; -+#endif -+ -+ odm_TXPowerTrackingThermalMeterInit(pDM_Odm); -+} -+ -+u1Byte -+getSwingIndex( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u1Byte i = 0; -+ u4Byte bbSwing; -+ u4Byte swingTableSize; -+ pu4Byte pSwingTable; -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || -+ pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8703B) -+ { -+ bbSwing = PHY_QueryBBReg(Adapter, rOFDM0_XATxIQImbalance, 0xFFC00000); -+ -+ pSwingTable = OFDMSwingTable_New; -+ swingTableSize = OFDM_TABLE_SIZE; -+ } else { -+ bbSwing = PHY_GetTxBBSwing_8812A(Adapter, pHalData->CurrentBandType, ODM_RF_PATH_A); -+ pSwingTable = TxScalingTable_Jaguar; -+ swingTableSize = TXSCALE_TABLE_SIZE; -+ } -+ -+ for (i = 0; i < swingTableSize; ++i) { -+ u4Byte tableValue = pSwingTable[i]; -+ -+ if (tableValue >= 0x100000 ) -+ tableValue >>= 22; -+ if (bbSwing == tableValue) -+ break; -+ } -+ return i; -+} -+ -+VOID -+odm_TXPowerTrackingThermalMeterInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte defaultSwingIndex = getSwingIndex(pDM_Odm); -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u1Byte p = 0; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pRFCalibrateInfo->TxPowerTrackControl = TRUE; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #ifdef CONFIG_RTL8188E -+ { -+ pRFCalibrateInfo->bTXPowerTracking = _TRUE; -+ pRFCalibrateInfo->TXPowercount = 0; -+ pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; -+ -+ MSG_8192C("pDM_Odm TxPowerTrackControl = %d\n", pRFCalibrateInfo->TxPowerTrackControl); -+ } -+ #else -+ { -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ -+ pdmpriv->bTXPowerTracking = _TRUE; -+ pdmpriv->TXPowercount = 0; -+ pdmpriv->bTXPowerTrackingInit = _FALSE; -+ -+ if(pDM_Odm->mp_mode == FALSE) -+ pdmpriv->TxPowerTrackControl = _TRUE; -+ -+ MSG_8192C("pdmpriv->TxPowerTrackControl = %d\n", pdmpriv->TxPowerTrackControl); -+ -+ } -+ #endif -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ #ifdef RTL8188E_SUPPORT -+ { -+ pRFCalibrateInfo->bTXPowerTracking = _TRUE; -+ pRFCalibrateInfo->TXPowercount = 0; -+ pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; -+ pRFCalibrateInfo->TxPowerTrackControl = _TRUE; -+ } -+ #endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #if (MP_DRIVER == 1) -+ pRFCalibrateInfo->TxPowerTrackControl = FALSE; -+ #else -+ pRFCalibrateInfo->TxPowerTrackControl = TRUE; -+ #endif -+#else -+ pRFCalibrateInfo->TxPowerTrackControl = TRUE; -+#endif -+ -+ pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; -+ pRFCalibrateInfo->ThermalValue_IQK = pHalData->EEPROMThermalMeter; -+ pRFCalibrateInfo->ThermalValue_LCK = pHalData->EEPROMThermalMeter; -+ -+ if (pRFCalibrateInfo->DefaultBbSwingIndexFlag != TRUE) { -+ /*The index of "0 dB" in SwingTable.*/ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || -+ pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8703B) { -+ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= OFDM_TABLE_SIZE) ? 30 : defaultSwingIndex; -+ pRFCalibrateInfo->DefaultCckIndex = 20; -+ } else if (pDM_Odm->SupportICType == ODM_RTL8188F) { /*add by Mingzhi.Guo 2015-03-23*/ -+ pRFCalibrateInfo->DefaultOfdmIndex = 28; /*OFDM: -1dB*/ -+ pRFCalibrateInfo->DefaultCckIndex = 20; /*CCK:-6dB*/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8723D) { /*add by zhaohe 2015-10-27*/ -+ pRFCalibrateInfo->DefaultOfdmIndex = 28; /*OFDM: -1dB*/ -+ pRFCalibrateInfo->DefaultCckIndex = 28; /*CCK: -6dB*/ -+ } else { -+ pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= TXSCALE_TABLE_SIZE) ? 24 : defaultSwingIndex; -+ pRFCalibrateInfo->DefaultCckIndex = 24; -+ } -+ pRFCalibrateInfo->DefaultBbSwingIndexFlag = TRUE; -+ } -+ -+ pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; -+ pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->DefaultCckIndex; -+ -+ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) -+ { -+ pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; -+ pRFCalibrateInfo->DeltaPowerIndex[p] = 0; -+ pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; -+ pRFCalibrateInfo->PowerIndexOffset[p] = 0; -+ pRFCalibrateInfo->KfreeOffset[p] = 0; -+ } -+ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM = 0; -+ pRFCalibrateInfo->Modify_TxAGC_Value_CCK = 0; -+ -+} -+ -+ -+VOID -+ODM_TXPowerTrackingCheck( -+ IN PVOID pDM_VOID -+ ) -+{ -+ -+ /* 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism.*/ -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ odm_TXPowerTrackingCheckMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_TXPowerTrackingCheckCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ odm_TXPowerTrackingCheckAP(pDM_Odm); -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+VOID -+odm_TXPowerTrackingCheckCE( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ #if ((RTL8188F_SUPPORT == 1)) -+ rtl8192c_odm_CheckTXPowerTracking(Adapter); -+ #endif -+ -+ #if(RTL8188E_SUPPORT==1) -+ -+ if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) { -+ return; -+ } -+ -+ if (!pRFCalibrateInfo->TM_Trigger) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); -+ /*DBG_8192C("Trigger 92C Thermal Meter!!\n");*/ -+ -+ pRFCalibrateInfo->TM_Trigger = 1; -+ return; -+ -+ } else { -+ /*DBG_8192C("Schedule TxPowerTracking direct call!!\n");*/ -+ odm_TXPowerTrackingCallback_ThermalMeter_8188E(Adapter); -+ pRFCalibrateInfo->TM_Trigger = 0; -+ } -+ #endif -+#endif -+} -+ -+VOID -+odm_TXPowerTrackingCheckMP( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if (*pDM_Odm->pIsFcsModeEnable) -+ return; -+ -+ if (ODM_CheckPowerStatus(Adapter) == FALSE) -+ { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("===>ODM_CheckPowerStatus() return FALSE\n")); -+ return; -+ } -+ -+ if (IS_HARDWARE_TYPE_8821B(Adapter)) /* TODO: Don't Do PowerTracking*/ -+ return; -+ -+ odm_TXPowerTrackingThermalMeterCheck(Adapter); -+ -+ -+#endif -+ -+} -+ -+ -+VOID -+odm_TXPowerTrackingCheckAP( -+ IN PVOID pDM_VOID -+ ) -+{ -+return; -+ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+odm_TXPowerTrackingDirectCall( -+ IN PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ ODM_TXPowerTrackingCallback_ThermalMeter(Adapter); -+} -+ -+VOID -+odm_TXPowerTrackingThermalMeterCheck( -+ IN PADAPTER Adapter -+ ) -+{ -+#ifndef AP_BUILD_WORKAROUND -+ static u1Byte TM_Trigger = 0; -+ -+ if (!(GET_HAL_DATA(Adapter)->DM_OutSrc.SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, -+ ("===>odm_TXPowerTrackingThermalMeterCheck(),pMgntInfo->bTXPowerTracking is FALSE, return!!\n")); -+ return; -+ } -+ -+ if (!TM_Trigger) -+ { -+ if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) || -+ IS_HARDWARE_TYPE_8723B(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter) || IS_HARDWARE_TYPE_8703B(Adapter) -+ || IS_HARDWARE_TYPE_8822B(Adapter) || IS_HARDWARE_TYPE_8723D(Adapter) || IS_HARDWARE_TYPE_8821C(Adapter)) -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03); -+ else -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); -+ -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger Thermal Meter!!\n")); -+ -+ TM_Trigger = 1; -+ return; -+ } else { -+ RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n")); -+ odm_TXPowerTrackingDirectCall(Adapter); -+ TM_Trigger = 0; -+ } -+#endif -+} -+ -+#endif -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_powertracking_win.h 2018-02-11 21:44:27.157146238 +0200 -@@ -0,0 +1,299 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMPOWERTRACKING_H__ -+#define __PHYDMPOWERTRACKING_H__ -+ -+#define POWRTRACKING_VERSION "1.1" -+ -+#define DPK_DELTA_MAPPING_NUM 13 -+#define index_mapping_HP_NUM 15 -+#define TXSCALE_TABLE_SIZE 37 -+#define CCK_TABLE_SIZE_8723D 41 -+#define TXPWR_TRACK_TABLE_SIZE 30 -+#define DELTA_SWINGIDX_SIZE 30 -+#define DELTA_SWINTSSI_SIZE 61 -+#define BAND_NUM 3 -+#define MAX_RF_PATH 4 -+#define CCK_TABLE_SIZE_88F 21 -+ -+ -+#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck -+ -+#define IQK_Matrix_Settings_NUM 14+24+21 // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G -+#define AVG_THERMAL_NUM 8 -+#define HP_THERMAL_NUM 8 -+#define IQK_Matrix_REG_NUM 8 -+#define IQK_MAC_REG_NUM 4 -+#define IQK_ADDA_REG_NUM 16 -+ -+#define IQK_BB_REG_NUM 9 -+ -+ -+extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE]; -+extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; -+ -+extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE]; -+extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -+extern u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16]; -+extern u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -+extern u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D]; -+ -+extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; -+ -+// <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. -+static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; -+static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; -+ -+VOID -+ODM_TXPowerTrackingCheck( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingCheckAP( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingThermalMeterInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+odm_TXPowerTrackingCheckMP( -+ IN PVOID pDM_VOID -+ ); -+ -+ -+VOID -+odm_TXPowerTrackingCheckCE( -+ IN PVOID pDM_VOID -+ ); -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ -+ -+VOID -+odm_TXPowerTrackingThermalMeterCheck( -+ IN PADAPTER Adapter -+ ); -+ -+#endif -+ -+typedef struct _IQK_MATRIX_REGS_SETTING{ -+ BOOLEAN bIQKDone; -+ s4Byte Value[3][IQK_Matrix_REG_NUM]; -+ BOOLEAN bBWIqkResultSaved[3]; -+}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; -+ -+typedef struct ODM_RF_Calibration_Structure -+{ -+ //for tx power tracking -+ -+ u4Byte RegA24; // for TempCCK -+ s4Byte RegE94; -+ s4Byte RegE9C; -+ s4Byte RegEB4; -+ s4Byte RegEBC; -+ //u1Byte bTXPowerTracking; -+ u1Byte TXPowercount; -+ BOOLEAN bTXPowerTrackingInit; -+ BOOLEAN bTXPowerTracking; -+ u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default -+ u1Byte TM_Trigger; -+ u1Byte InternalPA5G[2]; //pathA / pathB -+ -+ u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 -+ u1Byte ThermalValue; -+ u1Byte ThermalValue_LCK; -+ u1Byte ThermalValue_IQK; -+ u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; -+ u1Byte ThermalValue_AVG_index; -+ u1Byte ThermalValue_RxGain; -+ -+ BOOLEAN bReloadtxpowerindex; -+ u1Byte bRfPiEnable; -+ u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug -+ -+ -+ //------------------------- Tx power Tracking -------------------------// -+ u1Byte bCCKinCH14; -+ u1Byte CCK_index; -+ u1Byte OFDM_index[MAX_RF_PATH]; -+ s1Byte PowerIndexOffset[MAX_RF_PATH]; -+ s1Byte DeltaPowerIndex[MAX_RF_PATH]; -+ s1Byte DeltaPowerIndexLast[MAX_RF_PATH]; -+ BOOLEAN bTxPowerChanged; -+ s1Byte XtalOffset; -+ s1Byte XtalOffsetLast; -+ -+ u1Byte ThermalValue_HP[HP_THERMAL_NUM]; -+ u1Byte ThermalValue_HP_index; -+ IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; -+ u1Byte Delta_LCK; -+ s1Byte BBSwingDiff2G, BBSwingDiff5G; // Unit: dB -+ u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKC_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKC_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKD_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKD_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GC_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GC_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GD_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GD_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GC_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GC_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GD_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GD_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GCCKA[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GCCKB[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GCCKC[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GCCKD[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GA[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GB[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GC[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_2GD[DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_5GA[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_5GB[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_5GC[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ u1Byte DeltaSwingTSSITable_5GD[BAND_NUM][DELTA_SWINTSSI_SIZE]; -+ s1Byte DeltaSwingTableXtal_P[DELTA_SWINGIDX_SIZE]; -+ s1Byte DeltaSwingTableXtal_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; -+ -+ u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; -+ u1Byte BbSwingIdxOfdmCurrent; -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; -+#else -+ u1Byte BbSwingIdxOfdmBase; -+#endif -+ BOOLEAN DefaultBbSwingIndexFlag; -+ BOOLEAN BbSwingFlagOfdm; -+ u1Byte BbSwingIdxCck; -+ u1Byte BbSwingIdxCckCurrent; -+ u1Byte BbSwingIdxCckBase; -+ u1Byte DefaultOfdmIndex; -+ u1Byte DefaultCckIndex; -+ BOOLEAN BbSwingFlagCck; -+ -+ s1Byte Absolute_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Absolute_CCKSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_CCKSwingIdx; -+ s1Byte Modify_TxAGC_Value; /*Remnat compensate value at TxAGC */ -+ BOOLEAN Modify_TxAGC_Flag_PathA; -+ BOOLEAN Modify_TxAGC_Flag_PathB; -+ BOOLEAN Modify_TxAGC_Flag_PathC; -+ BOOLEAN Modify_TxAGC_Flag_PathD; -+ BOOLEAN Modify_TxAGC_Flag_PathA_CCK; -+ -+ s1Byte KfreeOffset[MAX_RF_PATH]; -+ -+ //--------------------------------------------------------------------// -+ -+ //for IQK -+ u4Byte RegC04; -+ u4Byte Reg874; -+ u4Byte RegC08; -+ u4Byte RegB68; -+ u4Byte RegB6C; -+ u4Byte Reg870; -+ u4Byte Reg860; -+ u4Byte Reg864; -+ -+ BOOLEAN bIQKInitialized; -+ BOOLEAN bLCKInProgress; -+ BOOLEAN bAntennaDetected; -+ BOOLEAN bNeedIQK; -+ BOOLEAN bIQKInProgress; -+ BOOLEAN bIQKPAoff; -+ u1Byte Delta_IQK; -+ u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; -+ u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte IQK_BB_backup_recover[9]; -+ u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; -+ u4Byte TxIQC_8723B[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ -+ u4Byte RxIQC_8723B[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ -+ u4Byte TxIQC_8703B[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u4Byte RxIQC_8703B[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ u4Byte TxIQC_8723D[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ -+ u4Byte RxIQC_8723D[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ -+ -+ u8Byte IQK_StartTime; -+ u8Byte IQK_TotalProgressingTime; -+ u8Byte IQK_ProgressingTime; -+ u4Byte LOK_Result; -+ u1Byte IQKstep; -+ u1Byte Kcount; -+ u1Byte retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ -+ BOOLEAN isMPmode; -+ -+ //for APK -+ u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a -+ u1Byte bAPKdone; -+ u1Byte bAPKThermalMeterIgnore; -+ -+ // DPK -+ BOOLEAN bDPKFail; -+ u1Byte bDPdone; -+ u1Byte bDPPathAOK; -+ u1Byte bDPPathBOK; -+ -+ u4Byte TxLOK[2]; -+ u4Byte DpkTxAGC; -+ s4Byte DpkGain; -+ u4Byte DpkThermal[4]; -+ -+ s1Byte Modify_TxAGC_Value_OFDM; -+ s1Byte Modify_TxAGC_Value_CCK; -+ -+ /*Add by Yuchen for Kfree Phydm*/ -+ u1Byte RegRfKFreeEnable; /*for registry*/ -+ u1Byte RfKFreeEnable; /*for efuse enable check*/ -+ -+ HALMAC_PWR_TRACKING_OPTION HALMAC_PWR_TRACKING_INFO; -+}ODM_RF_CAL_T,*PODM_RF_CAL_T; -+ -+ -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_precomp.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_precomp.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_precomp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_precomp.h 2018-02-11 21:44:27.157146238 +0200 -@@ -0,0 +1,351 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_PRECOMP_H__ -+#define __ODM_PRECOMP_H__ -+ -+#include "phydm_types.h" -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#include "Precomp.h" // We need to include mp_precomp.h due to batch file setting. -+#else -+#define TEST_FALG___ 1 -+#endif -+ -+//2 Config Flags and Structs - defined by each ODM Type -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "../8192cd_cfg.h" -+ #include "../odm_inc.h" -+ -+ #include "../8192cd.h" -+ #include "../8192cd_util.h" -+ #ifdef _BIG_ENDIAN_ -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG -+ #else -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE -+ #endif -+ -+ #ifdef AP_BUILD_WORKAROUND -+ #include "../8192cd_headers.h" -+ #include "../8192cd_debug.h" -+ #endif -+ -+#elif (DM_ODM_SUPPORT_TYPE ==ODM_CE) -+ #define __PACK -+ #define __WLAN_ATTRIB_PACK__ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "mp_precomp.h" -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE -+ #define __PACK -+ #define __WLAN_ATTRIB_PACK__ -+#endif -+ -+//2 OutSrc Header Files -+ -+#include "phydm.h" -+#include "phydm_hwconfig.h" -+#include "phydm_debug.h" -+#include "phydm_regdefine11ac.h" -+#include "phydm_regdefine11n.h" -+#include "phydm_interface.h" -+#include "phydm_reg.h" -+ -+#include "phydm_adc_sampling.h" -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+VOID -+PHY_SetTxPowerLimit( -+ IN PDM_ODM_T pDM_Odm, -+ IN u8 *Regulation, -+ IN u8 *Band, -+ IN u8 *Bandwidth, -+ IN u8 *RateSection, -+ IN u8 *RfPath, -+ IN u8 *Channel, -+ IN u8 *PowerLimit -+); -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+#define RTL8703B_SUPPORT 0 -+#define RTL8188F_SUPPORT 0 -+#define RTL8723D_SUPPORT 0 -+#endif -+ -+#if RTL8188E_SUPPORT == 1 -+#define RTL8188E_T_SUPPORT 1 -+#ifdef CONFIG_SFW_SUPPORTED -+#define RTL8188E_S_SUPPORT 1 -+#else -+#define RTL8188E_S_SUPPORT 0 -+#endif -+#endif -+ -+#if (RTL8188E_SUPPORT==1) -+#include "rtl8188e/hal8188erateadaptive.h"//for RA,Power training -+#include "rtl8188e/halhwimg8188e_mac.h" -+#include "rtl8188e/halhwimg8188e_rf.h" -+#include "rtl8188e/halhwimg8188e_bb.h" -+#include "rtl8188e/halhwimg8188e_t_fw.h" -+#include "rtl8188e/halhwimg8188e_s_fw.h" -+#include "rtl8188e/phydm_regconfig8188e.h" -+#include "rtl8188e/phydm_rtl8188e.h" -+#include "rtl8188e/hal8188ereg.h" -+#include "rtl8188e/version_rtl8188e.h" -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8188e_hal.h" -+ #include "rtl8188e/halphyrf_8188e_ce.h" -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "rtl8188e/halphyrf_8188e_win.h" -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "rtl8188e/halphyrf_8188e_ap.h" -+#endif -+#endif //88E END -+ -+#if (RTL8192E_SUPPORT==1) -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "rtl8192e/halphyrf_8192e_win.h" /*FOR_8192E_IQK*/ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "rtl8192e/halphyrf_8192e_ap.h" /*FOR_8192E_IQK*/ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8192e/halphyrf_8192e_ce.h" /*FOR_8192E_IQK*/ -+ #endif -+ -+#include "rtl8192e/phydm_rtl8192e.h" //FOR_8192E_IQK -+#include "rtl8192e/version_rtl8192e.h" -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ #include "rtl8192e/halhwimg8192e_bb.h" -+ #include "rtl8192e/halhwimg8192e_mac.h" -+ #include "rtl8192e/halhwimg8192e_rf.h" -+ #include "rtl8192e/phydm_regconfig8192e.h" -+ #include "rtl8192e/halhwimg8192e_fw.h" -+ #include "rtl8192e/hal8192ereg.h" -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8192e_hal.h" -+#endif -+#endif //92E END -+ -+#if (RTL8812A_SUPPORT==1) -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "rtl8812a/halphyrf_8812a_win.h" -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "rtl8812a/halphyrf_8812a_ap.h" -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8812a/halphyrf_8812a_ce.h" -+ #endif -+ -+ //#include "rtl8812a/HalPhyRf_8812A.h" //FOR_8812_IQK -+ #if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ #include "rtl8812a/halhwimg8812a_bb.h" -+ #include "rtl8812a/halhwimg8812a_mac.h" -+ #include "rtl8812a/halhwimg8812a_rf.h" -+ #include "rtl8812a/phydm_regconfig8812a.h" -+ #include "rtl8812a/halhwimg8812a_fw.h" -+ #include "rtl8812a/phydm_rtl8812a.h" -+ #endif -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8812a_hal.h" -+ #endif -+ #include "rtl8812a/version_rtl8812a.h" -+ -+#endif //8812 END -+ -+#if (RTL8814A_SUPPORT==1) -+ -+#include "rtl8814a/halhwimg8814a_mac.h" -+#include "rtl8814a/halhwimg8814a_rf.h" -+#include "rtl8814a/halhwimg8814a_bb.h" -+#include "rtl8814a/version_rtl8814a.h" -+#include "rtl8814a/phydm_rtl8814a.h" -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ #include "rtl8814a/halhwimg8814a_fw.h" -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "rtl8814a/halphyrf_8814a_win.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8814a/halphyrf_8814a_ce.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ #include "rtl8814a/halphyrf_8814a_ap.h" -+#endif -+ #include "rtl8814a/phydm_regconfig8814a.h" -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8814a_hal.h" -+ #include "rtl8814a/phydm_iqk_8814a.h" -+#endif -+#endif //8814 END -+ -+#if (RTL8881A_SUPPORT==1)//FOR_8881_IQK -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#include "rtl8821a/phydm_iqk_8821a_win.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#include "rtl8821a/phydm_iqk_8821a_ce.h" -+#else -+#include "rtl8821a/phydm_iqk_8821a_ap.h" -+#endif -+//#include "rtl8881a/HalHWImg8881A_BB.h" -+//#include "rtl8881a/HalHWImg8881A_MAC.h" -+//#include "rtl8881a/HalHWImg8881A_RF.h" -+//#include "rtl8881a/odm_RegConfig8881A.h" -+#endif -+ -+#if (RTL8723B_SUPPORT==1) -+#include "rtl8723b/halhwimg8723b_mac.h" -+#include "rtl8723b/halhwimg8723b_rf.h" -+#include "rtl8723b/halhwimg8723b_bb.h" -+#include "rtl8723b/halhwimg8723b_fw.h" -+#include "rtl8723b/phydm_regconfig8723b.h" -+#include "rtl8723b/phydm_rtl8723b.h" -+#include "rtl8723b/hal8723breg.h" -+#include "rtl8723b/version_rtl8723b.h" -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "rtl8723b/halphyrf_8723b_win.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8723b/halphyrf_8723b_ce.h" -+ #include "rtl8723b/halhwimg8723b_mp.h" -+ #include "rtl8723b_hal.h" -+#else -+ #include "rtl8723b/halphyrf_8723b_ap.h" -+#endif -+#endif -+ -+#if (RTL8821A_SUPPORT==1) -+#include "rtl8821a/halhwimg8821a_mac.h" -+#include "rtl8821a/halhwimg8821a_rf.h" -+#include "rtl8821a/halhwimg8821a_bb.h" -+#include "rtl8821a/halhwimg8821a_fw.h" -+#include "rtl8821a/phydm_regconfig8821a.h" -+#include "rtl8821a/phydm_rtl8821a.h" -+#include "rtl8821a/version_rtl8821a.h" -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #include "rtl8821a/halphyrf_8821a_win.h" -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8821a/halphyrf_8821a_ce.h" -+ #include "rtl8821a/phydm_iqk_8821a_ce.h"/*for IQK*/ -+ #include "rtl8812a/halphyrf_8812a_ce.h"/*for IQK,LCK,Power-tracking*/ -+ #include "rtl8812a_hal.h" -+#else -+#endif -+#endif -+ -+#if (RTL8822B_SUPPORT==1) -+#include "rtl8822b/halhwimg8822b_mac.h" -+#include "rtl8822b/halhwimg8822b_rf.h" -+#include "rtl8822b/halhwimg8822b_bb.h" -+#include "rtl8822b/halhwimg8822b_fw.h" -+#include "rtl8822b/phydm_regconfig8822b.h" -+#include "rtl8822b/halphyrf_8822b.h" -+#include "rtl8822b/phydm_rtl8822b.h" -+#include "rtl8822b/phydm_hal_api8822b.h" -+#include "rtl8822b/version_rtl8822b.h" -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#include /* struct HAL_DATA_TYPE */ -+#include /* Rx_Smooth_Factor, reg definition and etc.*/ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#endif -+ -+#endif -+ -+#if (RTL8703B_SUPPORT==1) -+#include "rtl8703b/phydm_regconfig8703b.h" -+#include "rtl8703b/halhwimg8703b_mac.h" -+#include "rtl8703b/halhwimg8703b_rf.h" -+#include "rtl8703b/halhwimg8703b_bb.h" -+#include "rtl8703b/halhwimg8703b_fw.h" -+#include "rtl8703b/halphyrf_8703b.h" -+#include "rtl8703b/version_rtl8703b.h" -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#include "rtl8703b_hal.h" -+#endif -+#endif -+ -+#if (RTL8188F_SUPPORT == 1) -+#include "rtl8188f/halhwimg8188f_mac.h" -+#include "rtl8188f/halhwimg8188f_rf.h" -+#include "rtl8188f/halhwimg8188f_bb.h" -+#include "rtl8188f/halhwimg8188f_fw.h" -+#include "rtl8188f/hal8188freg.h" -+#include "rtl8188f/phydm_rtl8188f.h" -+#include "rtl8188f/phydm_regconfig8188f.h" -+#include "rtl8188f/halphyrf_8188f.h" /* for IQK,LCK,Power-tracking */ -+#include "rtl8188f/version_rtl8188f.h" -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#include "rtl8188f_hal.h" -+#endif -+#endif -+ -+#if (RTL8723D_SUPPORT==1) -+ #if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+ -+ #include "rtl8723d/halhwimg8723d_bb.h" -+ #include "rtl8723d/halhwimg8723d_mac.h" -+ #include "rtl8723d/halhwimg8723d_rf.h" -+ #include "rtl8723d/phydm_regconfig8723d.h" -+ #include "rtl8723d/halhwimg8723d_fw.h" -+ #include "rtl8723d/hal8723dreg.h" -+ #include "rtl8723d/phydm_rtl8723d.h" -+ #include "rtl8723d/halphyrf_8723d.h" -+ #include "rtl8723d/version_rtl8723d.h" -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8723d_hal.h" -+ #endif -+#endif //8723D End -+ -+#if (RTL8197F_SUPPORT == 1) -+#include "rtl8197f/halhwimg8197f_mac.h" -+#include "rtl8197f/halhwimg8197f_rf.h" -+#include "rtl8197f/halhwimg8197f_bb.h" -+#include "rtl8197f/phydm_hal_api8197f.h" -+#include "rtl8197f/version_rtl8197f.h" -+#include "rtl8197f/phydm_rtl8197f.h" -+#include "rtl8197f/phydm_regconfig8197f.h" -+#include "rtl8197f/halphyrf_8197f.h" -+#include "rtl8197f/phydm_iqk_8197f.h" -+#endif -+ -+#if (RTL8821C_SUPPORT==1) -+#include "rtl8821c/phydm_hal_api8821c.h" -+#include "rtl8821c/halhwimg8821c_testchip_mac.h" -+#include "rtl8821c/halhwimg8821c_testchip_rf.h" -+#include "rtl8821c/halhwimg8821c_testchip_bb.h" -+#include "rtl8821c/halhwimg8821c_mac.h" -+#include "rtl8821c/halhwimg8821c_rf.h" -+#include "rtl8821c/halhwimg8821c_bb.h" -+#include "rtl8821c/halhwimg8821c_fw.h" -+#include "rtl8821c/phydm_regconfig8821c.h" -+#include "rtl8821c/halphyrf_8821c.h" -+#include "rtl8821c/version_rtl8821c.h" -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include "rtl8821c_hal.h" -+#endif -+#endif -+ -+#endif // __ODM_PRECOMP_H__ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_pre_define.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_pre_define.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_pre_define.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_pre_define.h 2018-02-11 21:44:27.157146238 +0200 -@@ -0,0 +1,697 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __PHYDMPREDEFINE_H__ -+#define __PHYDMPREDEFINE_H__ -+ -+//1 ============================================================ -+//1 Definition -+//1 ============================================================ -+ -+#define PHYDM_CODE_BASE "PHYDM_010" -+#define PHYDM_RELEASE_DATE "00000000" -+ -+//Max path of IC -+#define MAX_PATH_NUM_8188E 1 -+#define MAX_PATH_NUM_8192E 2 -+#define MAX_PATH_NUM_8723B 1 -+#define MAX_PATH_NUM_8812A 2 -+#define MAX_PATH_NUM_8821A 1 -+#define MAX_PATH_NUM_8814A 4 -+#define MAX_PATH_NUM_8822B 2 -+#define MAX_PATH_NUM_8821B 2 -+#define MAX_PATH_NUM_8703B 1 -+#define MAX_PATH_NUM_8188F 1 -+#define MAX_PATH_NUM_8723D 1 -+#define MAX_PATH_NUM_8197F 2 -+#define MAX_PATH_NUM_8821C 1 -+ -+//Max RF path -+#define ODM_RF_PATH_MAX 2 -+#define ODM_RF_PATH_MAX_JAGUAR 4 -+ -+/*Bit define path*/ -+#define PHYDM_A BIT0 -+#define PHYDM_B BIT1 -+#define PHYDM_C BIT2 -+#define PHYDM_D BIT3 -+#define PHYDM_AB (BIT0 | BIT1) -+#define PHYDM_AC (BIT0 | BIT2) -+#define PHYDM_AD (BIT0 | BIT3) -+#define PHYDM_BC (BIT1 | BIT2) -+#define PHYDM_BD (BIT1 | BIT3) -+#define PHYDM_CD (BIT2 | BIT3) -+#define PHYDM_ABC (BIT0 | BIT1 | BIT2) -+#define PHYDM_ABD (BIT0 | BIT1 | BIT3) -+#define PHYDM_ACD (BIT0 | BIT2 | BIT3) -+#define PHYDM_BCD (BIT1 | BIT2 | BIT3) -+#define PHYDM_ABCD (BIT0 | BIT1 | BIT2 | BIT3) -+ -+//number of entry -+#if(DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ #define ASSOCIATE_ENTRY_NUM MACID_NUM_SW_LIMIT /* Max size of AsocEntry[].*/ -+ #define ODM_ASSOCIATE_ENTRY_NUM ASSOCIATE_ENTRY_NUM -+#elif(DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ #define ASSOCIATE_ENTRY_NUM NUM_STAT -+ #define ODM_ASSOCIATE_ENTRY_NUM (ASSOCIATE_ENTRY_NUM+1) -+#else -+ #define ODM_ASSOCIATE_ENTRY_NUM ((ASSOCIATE_ENTRY_NUM*3)+1) -+#endif -+ -+/* -----MGN rate--------------------------------- */ -+ -+enum ODM_MGN_RATE { -+ ODM_MGN_1M = 0x02, -+ ODM_MGN_2M = 0x04, -+ ODM_MGN_5_5M = 0x0B, -+ ODM_MGN_6M = 0x0C, -+ ODM_MGN_9M = 0x12, -+ ODM_MGN_11M = 0x16, -+ ODM_MGN_12M = 0x18, -+ ODM_MGN_18M = 0x24, -+ ODM_MGN_24M = 0x30, -+ ODM_MGN_36M = 0x48, -+ ODM_MGN_48M = 0x60, -+ ODM_MGN_54M = 0x6C, -+ ODM_MGN_MCS32 = 0x7F, -+ ODM_MGN_MCS0, -+ ODM_MGN_MCS1, -+ ODM_MGN_MCS2, -+ ODM_MGN_MCS3, -+ ODM_MGN_MCS4, -+ ODM_MGN_MCS5, -+ ODM_MGN_MCS6, -+ ODM_MGN_MCS7, -+ ODM_MGN_MCS8, -+ ODM_MGN_MCS9, -+ ODM_MGN_MCS10, -+ ODM_MGN_MCS11, -+ ODM_MGN_MCS12, -+ ODM_MGN_MCS13, -+ ODM_MGN_MCS14, -+ ODM_MGN_MCS15, -+ ODM_MGN_MCS16, -+ ODM_MGN_MCS17, -+ ODM_MGN_MCS18, -+ ODM_MGN_MCS19, -+ ODM_MGN_MCS20, -+ ODM_MGN_MCS21, -+ ODM_MGN_MCS22, -+ ODM_MGN_MCS23, -+ ODM_MGN_MCS24, -+ ODM_MGN_MCS25, -+ ODM_MGN_MCS26, -+ ODM_MGN_MCS27, -+ ODM_MGN_MCS28, -+ ODM_MGN_MCS29, -+ ODM_MGN_MCS30, -+ ODM_MGN_MCS31, -+ ODM_MGN_VHT1SS_MCS0, -+ ODM_MGN_VHT1SS_MCS1, -+ ODM_MGN_VHT1SS_MCS2, -+ ODM_MGN_VHT1SS_MCS3, -+ ODM_MGN_VHT1SS_MCS4, -+ ODM_MGN_VHT1SS_MCS5, -+ ODM_MGN_VHT1SS_MCS6, -+ ODM_MGN_VHT1SS_MCS7, -+ ODM_MGN_VHT1SS_MCS8, -+ ODM_MGN_VHT1SS_MCS9, -+ ODM_MGN_VHT2SS_MCS0, -+ ODM_MGN_VHT2SS_MCS1, -+ ODM_MGN_VHT2SS_MCS2, -+ ODM_MGN_VHT2SS_MCS3, -+ ODM_MGN_VHT2SS_MCS4, -+ ODM_MGN_VHT2SS_MCS5, -+ ODM_MGN_VHT2SS_MCS6, -+ ODM_MGN_VHT2SS_MCS7, -+ ODM_MGN_VHT2SS_MCS8, -+ ODM_MGN_VHT2SS_MCS9, -+ ODM_MGN_VHT3SS_MCS0, -+ ODM_MGN_VHT3SS_MCS1, -+ ODM_MGN_VHT3SS_MCS2, -+ ODM_MGN_VHT3SS_MCS3, -+ ODM_MGN_VHT3SS_MCS4, -+ ODM_MGN_VHT3SS_MCS5, -+ ODM_MGN_VHT3SS_MCS6, -+ ODM_MGN_VHT3SS_MCS7, -+ ODM_MGN_VHT3SS_MCS8, -+ ODM_MGN_VHT3SS_MCS9, -+ ODM_MGN_VHT4SS_MCS0, -+ ODM_MGN_VHT4SS_MCS1, -+ ODM_MGN_VHT4SS_MCS2, -+ ODM_MGN_VHT4SS_MCS3, -+ ODM_MGN_VHT4SS_MCS4, -+ ODM_MGN_VHT4SS_MCS5, -+ ODM_MGN_VHT4SS_MCS6, -+ ODM_MGN_VHT4SS_MCS7, -+ ODM_MGN_VHT4SS_MCS8, -+ ODM_MGN_VHT4SS_MCS9, -+ ODM_MGN_UNKNOWN -+}; -+ -+#define ODM_MGN_MCS0_SG 0xc0 -+#define ODM_MGN_MCS1_SG 0xc1 -+#define ODM_MGN_MCS2_SG 0xc2 -+#define ODM_MGN_MCS3_SG 0xc3 -+#define ODM_MGN_MCS4_SG 0xc4 -+#define ODM_MGN_MCS5_SG 0xc5 -+#define ODM_MGN_MCS6_SG 0xc6 -+#define ODM_MGN_MCS7_SG 0xc7 -+#define ODM_MGN_MCS8_SG 0xc8 -+#define ODM_MGN_MCS9_SG 0xc9 -+#define ODM_MGN_MCS10_SG 0xca -+#define ODM_MGN_MCS11_SG 0xcb -+#define ODM_MGN_MCS12_SG 0xcc -+#define ODM_MGN_MCS13_SG 0xcd -+#define ODM_MGN_MCS14_SG 0xce -+#define ODM_MGN_MCS15_SG 0xcf -+ -+/* -----DESC rate--------------------------------- */ -+ -+#define ODM_RATEMCS15_SG 0x1c -+#define ODM_RATEMCS32 0x20 -+ -+ -+// CCK Rates, TxHT = 0 -+#define ODM_RATE1M 0x00 -+#define ODM_RATE2M 0x01 -+#define ODM_RATE5_5M 0x02 -+#define ODM_RATE11M 0x03 -+// OFDM Rates, TxHT = 0 -+#define ODM_RATE6M 0x04 -+#define ODM_RATE9M 0x05 -+#define ODM_RATE12M 0x06 -+#define ODM_RATE18M 0x07 -+#define ODM_RATE24M 0x08 -+#define ODM_RATE36M 0x09 -+#define ODM_RATE48M 0x0A -+#define ODM_RATE54M 0x0B -+// MCS Rates, TxHT = 1 -+#define ODM_RATEMCS0 0x0C -+#define ODM_RATEMCS1 0x0D -+#define ODM_RATEMCS2 0x0E -+#define ODM_RATEMCS3 0x0F -+#define ODM_RATEMCS4 0x10 -+#define ODM_RATEMCS5 0x11 -+#define ODM_RATEMCS6 0x12 -+#define ODM_RATEMCS7 0x13 -+#define ODM_RATEMCS8 0x14 -+#define ODM_RATEMCS9 0x15 -+#define ODM_RATEMCS10 0x16 -+#define ODM_RATEMCS11 0x17 -+#define ODM_RATEMCS12 0x18 -+#define ODM_RATEMCS13 0x19 -+#define ODM_RATEMCS14 0x1A -+#define ODM_RATEMCS15 0x1B -+#define ODM_RATEMCS16 0x1C -+#define ODM_RATEMCS17 0x1D -+#define ODM_RATEMCS18 0x1E -+#define ODM_RATEMCS19 0x1F -+#define ODM_RATEMCS20 0x20 -+#define ODM_RATEMCS21 0x21 -+#define ODM_RATEMCS22 0x22 -+#define ODM_RATEMCS23 0x23 -+#define ODM_RATEMCS24 0x24 -+#define ODM_RATEMCS25 0x25 -+#define ODM_RATEMCS26 0x26 -+#define ODM_RATEMCS27 0x27 -+#define ODM_RATEMCS28 0x28 -+#define ODM_RATEMCS29 0x29 -+#define ODM_RATEMCS30 0x2A -+#define ODM_RATEMCS31 0x2B -+#define ODM_RATEVHTSS1MCS0 0x2C -+#define ODM_RATEVHTSS1MCS1 0x2D -+#define ODM_RATEVHTSS1MCS2 0x2E -+#define ODM_RATEVHTSS1MCS3 0x2F -+#define ODM_RATEVHTSS1MCS4 0x30 -+#define ODM_RATEVHTSS1MCS5 0x31 -+#define ODM_RATEVHTSS1MCS6 0x32 -+#define ODM_RATEVHTSS1MCS7 0x33 -+#define ODM_RATEVHTSS1MCS8 0x34 -+#define ODM_RATEVHTSS1MCS9 0x35 -+#define ODM_RATEVHTSS2MCS0 0x36 -+#define ODM_RATEVHTSS2MCS1 0x37 -+#define ODM_RATEVHTSS2MCS2 0x38 -+#define ODM_RATEVHTSS2MCS3 0x39 -+#define ODM_RATEVHTSS2MCS4 0x3A -+#define ODM_RATEVHTSS2MCS5 0x3B -+#define ODM_RATEVHTSS2MCS6 0x3C -+#define ODM_RATEVHTSS2MCS7 0x3D -+#define ODM_RATEVHTSS2MCS8 0x3E -+#define ODM_RATEVHTSS2MCS9 0x3F -+#define ODM_RATEVHTSS3MCS0 0x40 -+#define ODM_RATEVHTSS3MCS1 0x41 -+#define ODM_RATEVHTSS3MCS2 0x42 -+#define ODM_RATEVHTSS3MCS3 0x43 -+#define ODM_RATEVHTSS3MCS4 0x44 -+#define ODM_RATEVHTSS3MCS5 0x45 -+#define ODM_RATEVHTSS3MCS6 0x46 -+#define ODM_RATEVHTSS3MCS7 0x47 -+#define ODM_RATEVHTSS3MCS8 0x48 -+#define ODM_RATEVHTSS3MCS9 0x49 -+#define ODM_RATEVHTSS4MCS0 0x4A -+#define ODM_RATEVHTSS4MCS1 0x4B -+#define ODM_RATEVHTSS4MCS2 0x4C -+#define ODM_RATEVHTSS4MCS3 0x4D -+#define ODM_RATEVHTSS4MCS4 0x4E -+#define ODM_RATEVHTSS4MCS5 0x4F -+#define ODM_RATEVHTSS4MCS6 0x50 -+#define ODM_RATEVHTSS4MCS7 0x51 -+#define ODM_RATEVHTSS4MCS8 0x52 -+#define ODM_RATEVHTSS4MCS9 0x53 -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS4MCS9+1) -+#else -+ #if (RTL8192E_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) -+ #define ODM_NUM_RATE_IDX (ODM_RATEMCS15+1) -+ #elif (RTL8723B_SUPPORT == 1) || (RTL8188E_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) -+ #define ODM_NUM_RATE_IDX (ODM_RATEMCS7+1) -+ #elif (RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) -+ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS1MCS9+1) -+ #elif (RTL8812A_SUPPORT == 1) -+ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS2MCS9+1) -+ #elif(RTL8814A_SUPPORT == 1) -+ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS3MCS9+1) -+ #else -+ #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS4MCS9+1) -+ #endif -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define CONFIG_SFW_SUPPORTED -+#endif -+ -+//1 ============================================================ -+//1 enumeration -+//1 ============================================================ -+ -+ -+// ODM_CMNINFO_INTERFACE -+typedef enum tag_ODM_Support_Interface_Definition -+{ -+ ODM_ITRF_PCIE = 0x1, -+ ODM_ITRF_USB = 0x2, -+ ODM_ITRF_SDIO = 0x4, -+ ODM_ITRF_ALL = 0x7, -+}ODM_INTERFACE_E; -+ -+// ODM_CMNINFO_IC_TYPE -+typedef enum tag_ODM_Support_IC_Type_Definition -+{ -+ ODM_RTL8188E = BIT0, -+ ODM_RTL8812 = BIT1, -+ ODM_RTL8821 = BIT2, -+ ODM_RTL8192E = BIT3, -+ ODM_RTL8723B = BIT4, -+ ODM_RTL8814A = BIT5, -+ ODM_RTL8881A = BIT6, -+ ODM_RTL8822B = BIT7, -+ ODM_RTL8703B = BIT8, -+ ODM_RTL8195A = BIT9, -+ ODM_RTL8188F = BIT10, -+ ODM_RTL8723D = BIT11, -+ ODM_RTL8197F = BIT12, -+ ODM_RTL8821C = BIT13, -+ ODM_RTL8814B = BIT14, -+ ODM_RTL8198F = BIT15 -+}ODM_IC_TYPE_E; -+ -+ -+#define ODM_IC_1SS (ODM_RTL8188E | ODM_RTL8188F | ODM_RTL8723B | ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8881A | ODM_RTL8821 | ODM_RTL8821C | ODM_RTL8195A) -+#define ODM_IC_2SS (ODM_RTL8192E | ODM_RTL8197F | ODM_RTL8812 | ODM_RTL8822B) -+#define ODM_IC_3SS (ODM_RTL8814A) -+#define ODM_IC_4SS (ODM_RTL8814B | ODM_RTL8198F) -+ -+ -+#define ODM_IC_11N_SERIES (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8703B|ODM_RTL8188F|ODM_RTL8723D|ODM_RTL8197F) -+#define ODM_IC_11AC_SERIES (ODM_RTL8812|ODM_RTL8821|ODM_RTL8814A|ODM_RTL8881A|ODM_RTL8822B|ODM_RTL8821C) -+#define ODM_IC_11AC_1_SERIES (ODM_RTL8812|ODM_RTL8821|ODM_RTL8881A) -+#define ODM_IC_11AC_2_SERIES (ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8821C) -+#define ODM_IC_TXBF_SUPPORT (ODM_RTL8192E|ODM_RTL8812|ODM_RTL8821|ODM_RTL8814A|ODM_RTL8881A|ODM_RTL8822B|ODM_RTL8197F|ODM_RTL8821C) -+#define ODM_IC_11N_GAIN_IDX_EDCCA (ODM_RTL8195A|ODM_RTL8703B|ODM_RTL8188F|ODM_RTL8723D|ODM_RTL8197F) -+#define ODM_IC_11AC_GAIN_IDX_EDCCA (ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8821C) -+#define ODM_IC_PHY_STATUE_NEW_TYPE (ODM_RTL8197F|ODM_RTL8822B|ODM_RTL8723D|ODM_RTL8821C) -+ -+#define PHYDM_IC_8051_SERIES (ODM_RTL8881A|ODM_RTL8812|ODM_RTL8821|ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8703B|ODM_RTL8188F) -+#define PHYDM_IC_3081_SERIES (ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8197F|ODM_RTL8821C) -+ -+#define PHYDM_IC_SUPPORT_LA_MODE (ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8197F|ODM_RTL8821C) -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+#ifdef RTK_AC_SUPPORT -+#define ODM_IC_11AC_SERIES_SUPPORT 1 -+#else -+#define ODM_IC_11AC_SERIES_SUPPORT 0 -+#endif -+ -+#define ODM_IC_11N_SERIES_SUPPORT 1 -+#define ODM_CONFIG_BT_COEXIST 0 -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+#define ODM_IC_11AC_SERIES_SUPPORT 1 -+#define ODM_IC_11N_SERIES_SUPPORT 1 -+#define ODM_CONFIG_BT_COEXIST 1 -+ -+#else -+ -+#if ((RTL8188E_SUPPORT == 1) || \ -+(RTL8723B_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8195A_SUPPORT == 1) || (RTL8703B_SUPPORT == 1) || \ -+(RTL8188F_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) -+#define ODM_IC_11N_SERIES_SUPPORT 1 -+#define ODM_IC_11AC_SERIES_SUPPORT 0 -+#else -+#define ODM_IC_11N_SERIES_SUPPORT 0 -+#define ODM_IC_11AC_SERIES_SUPPORT 1 -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+#define ODM_CONFIG_BT_COEXIST 1 -+#else -+#define ODM_CONFIG_BT_COEXIST 0 -+#endif -+ -+#endif -+ -+#if ((RTL8814A_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) -+#define PHYDM_LA_MODE_SUPPORT 1 -+#else -+#define PHYDM_LA_MODE_SUPPORT 0 -+#endif -+ -+#if ((RTL8197F_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) -+#define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 1 -+#else -+#define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 0 -+#endif -+ -+//ODM_CMNINFO_CUT_VER -+typedef enum tag_ODM_Cut_Version_Definition -+{ -+ ODM_CUT_A = 0, -+ ODM_CUT_B = 1, -+ ODM_CUT_C = 2, -+ ODM_CUT_D = 3, -+ ODM_CUT_E = 4, -+ ODM_CUT_F = 5, -+ -+ ODM_CUT_I = 8, -+ ODM_CUT_J = 9, -+ ODM_CUT_K = 10, -+ ODM_CUT_TEST = 15, -+}ODM_CUT_VERSION_E; -+ -+// ODM_CMNINFO_FAB_VER -+typedef enum tag_ODM_Fab_Version_Definition -+{ -+ ODM_TSMC = 0, -+ ODM_UMC = 1, -+}ODM_FAB_E; -+ -+// ODM_CMNINFO_RF_TYPE -+// -+// For example 1T2R (A+AB = BIT0|BIT4|BIT5) -+// -+typedef enum tag_ODM_RF_Path_Bit_Definition -+{ -+ ODM_RF_A = BIT0, -+ ODM_RF_B = BIT1, -+ ODM_RF_C = BIT2, -+ ODM_RF_D = BIT3, -+}ODM_RF_PATH_E; -+ -+typedef enum tag_PHYDM_RF_TX_NUM { -+ ODM_1T = 1, -+ ODM_2T = 2, -+ ODM_3T = 3, -+ ODM_4T = 4, -+} ODM_RF_TX_NUM_E; -+ -+typedef enum tag_ODM_RF_Type_Definition { -+ ODM_1T1R, -+ ODM_1T2R, -+ ODM_2T2R, -+ ODM_2T2R_GREEN, -+ ODM_2T3R, -+ ODM_2T4R, -+ ODM_3T3R, -+ ODM_3T4R, -+ ODM_4T4R, -+ ODM_XTXR -+}ODM_RF_TYPE_E; -+ -+ -+typedef enum tag_ODM_MAC_PHY_Mode_Definition -+{ -+ ODM_SMSP = 0, -+ ODM_DMSP = 1, -+ ODM_DMDP = 2, -+}ODM_MAC_PHY_MODE_E; -+ -+ -+typedef enum tag_BT_Coexist_Definition -+{ -+ ODM_BT_BUSY = 1, -+ ODM_BT_ON = 2, -+ ODM_BT_OFF = 3, -+ ODM_BT_NONE = 4, -+}ODM_BT_COEXIST_E; -+ -+// ODM_CMNINFO_OP_MODE -+typedef enum tag_Operation_Mode_Definition -+{ -+ ODM_NO_LINK = BIT0, -+ ODM_LINK = BIT1, -+ ODM_SCAN = BIT2, -+ ODM_POWERSAVE = BIT3, -+ ODM_AP_MODE = BIT4, -+ ODM_CLIENT_MODE = BIT5, -+ ODM_AD_HOC = BIT6, -+ ODM_WIFI_DIRECT = BIT7, -+ ODM_WIFI_DISPLAY = BIT8, -+}ODM_OPERATION_MODE_E; -+ -+// ODM_CMNINFO_WM_MODE -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+typedef enum tag_Wireless_Mode_Definition -+{ -+ ODM_WM_UNKNOW = 0x0, -+ ODM_WM_B = BIT0, -+ ODM_WM_G = BIT1, -+ ODM_WM_A = BIT2, -+ ODM_WM_N24G = BIT3, -+ ODM_WM_N5G = BIT4, -+ ODM_WM_AUTO = BIT5, -+ ODM_WM_AC = BIT6, -+}ODM_WIRELESS_MODE_E; -+#else -+typedef enum tag_Wireless_Mode_Definition -+{ -+ ODM_WM_UNKNOWN = 0x00,/*0x0*/ -+ ODM_WM_A = BIT0, /* 0x1*/ -+ ODM_WM_B = BIT1, /* 0x2*/ -+ ODM_WM_G = BIT2,/* 0x4*/ -+ ODM_WM_AUTO = BIT3,/* 0x8*/ -+ ODM_WM_N24G = BIT4,/* 0x10*/ -+ ODM_WM_N5G = BIT5,/* 0x20*/ -+ ODM_WM_AC_5G = BIT6,/* 0x40*/ -+ ODM_WM_AC_24G = BIT7,/* 0x80*/ -+ ODM_WM_AC_ONLY = BIT8,/* 0x100*/ -+ ODM_WM_MAX = BIT11/* 0x800*/ -+ -+}ODM_WIRELESS_MODE_E; -+#endif -+ -+// ODM_CMNINFO_BAND -+typedef enum tag_Band_Type_Definition -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ ODM_BAND_2_4G = BIT0, -+ ODM_BAND_5G = BIT1, -+#else -+ ODM_BAND_2_4G = 0, -+ ODM_BAND_5G, -+ ODM_BAND_ON_BOTH, -+ ODM_BANDMAX -+#endif -+}ODM_BAND_TYPE_E; -+ -+ -+// ODM_CMNINFO_SEC_CHNL_OFFSET -+typedef enum tag_Secondary_Channel_Offset_Definition { -+ -+ PHYDM_DONT_CARE = 0, -+ PHYDM_BELOW = 1, -+ PHYDM_ABOVE = 2 -+} PHYDM_SEC_CHNL_OFFSET_E; -+ -+// ODM_CMNINFO_SEC_MODE -+typedef enum tag_Security_Definition -+{ -+ ODM_SEC_OPEN = 0, -+ ODM_SEC_WEP40 = 1, -+ ODM_SEC_TKIP = 2, -+ ODM_SEC_RESERVE = 3, -+ ODM_SEC_AESCCMP = 4, -+ ODM_SEC_WEP104 = 5, -+ ODM_WEP_WPA_MIXED = 6, // WEP + WPA -+ ODM_SEC_SMS4 = 7, -+}ODM_SECURITY_E; -+ -+// ODM_CMNINFO_BW -+typedef enum tag_Bandwidth_Definition -+{ -+ ODM_BW20M = 0, -+ ODM_BW40M = 1, -+ ODM_BW80M = 2, -+ ODM_BW160M = 3, -+ ODM_BW5M = 4, -+ ODM_BW10M = 5, -+ ODM_BW_MAX = 6 -+}ODM_BW_E; -+ -+// ODM_CMNINFO_CHNL -+ -+// ODM_CMNINFO_BOARD_TYPE -+typedef enum tag_Board_Definition -+{ -+ ODM_BOARD_DEFAULT = 0, // The DEFAULT case. -+ ODM_BOARD_MINICARD = BIT(0), // 0 = non-mini card, 1= mini card. -+ ODM_BOARD_SLIM = BIT(1), // 0 = non-slim card, 1 = slim card -+ ODM_BOARD_BT = BIT(2), // 0 = without BT card, 1 = with BT -+ ODM_BOARD_EXT_PA = BIT(3), // 0 = no 2G ext-PA, 1 = existing 2G ext-PA -+ ODM_BOARD_EXT_LNA = BIT(4), // 0 = no 2G ext-LNA, 1 = existing 2G ext-LNA -+ ODM_BOARD_EXT_TRSW = BIT(5), // 0 = no ext-TRSW, 1 = existing ext-TRSW -+ ODM_BOARD_EXT_PA_5G = BIT(6), // 0 = no 5G ext-PA, 1 = existing 5G ext-PA -+ ODM_BOARD_EXT_LNA_5G= BIT(7), // 0 = no 5G ext-LNA, 1 = existing 5G ext-LNA -+}ODM_BOARD_TYPE_E; -+ -+typedef enum tag_ODM_Package_Definition -+{ -+ ODM_PACKAGE_DEFAULT = 0, -+ ODM_PACKAGE_QFN68 = BIT(0), -+ ODM_PACKAGE_TFBGA90 = BIT(1), -+ ODM_PACKAGE_TFBGA79 = BIT(2), -+}ODM_Package_TYPE_E; -+ -+typedef enum tag_ODM_TYPE_GPA_Definition { -+ TYPE_GPA0 = 0x0000, -+ TYPE_GPA1 = 0x0055, -+ TYPE_GPA2 = 0x00AA, -+ TYPE_GPA3 = 0x00FF, -+ TYPE_GPA4 = 0x5500, -+ TYPE_GPA5 = 0x5555, -+ TYPE_GPA6 = 0x55AA, -+ TYPE_GPA7 = 0x55FF, -+ TYPE_GPA8 = 0xAA00, -+ TYPE_GPA9 = 0xAA55, -+ TYPE_GPA10 = 0xAAAA, -+ TYPE_GPA11 = 0xAAFF, -+ TYPE_GPA12 = 0xFF00, -+ TYPE_GPA13 = 0xFF55, -+ TYPE_GPA14 = 0xFFAA, -+ TYPE_GPA15 = 0xFFFF, -+}ODM_TYPE_GPA_E; -+ -+typedef enum tag_ODM_TYPE_APA_Definition { -+ TYPE_APA0 = 0x0000, -+ TYPE_APA1 = 0x0055, -+ TYPE_APA2 = 0x00AA, -+ TYPE_APA3 = 0x00FF, -+ TYPE_APA4 = 0x5500, -+ TYPE_APA5 = 0x5555, -+ TYPE_APA6 = 0x55AA, -+ TYPE_APA7 = 0x55FF, -+ TYPE_APA8 = 0xAA00, -+ TYPE_APA9 = 0xAA55, -+ TYPE_APA10 = 0xAAAA, -+ TYPE_APA11 = 0xAAFF, -+ TYPE_APA12 = 0xFF00, -+ TYPE_APA13 = 0xFF55, -+ TYPE_APA14 = 0xFFAA, -+ TYPE_APA15 = 0xFFFF, -+}ODM_TYPE_APA_E; -+ -+typedef enum tag_ODM_TYPE_GLNA_Definition { -+ TYPE_GLNA0 = 0x0000, -+ TYPE_GLNA1 = 0x0055, -+ TYPE_GLNA2 = 0x00AA, -+ TYPE_GLNA3 = 0x00FF, -+ TYPE_GLNA4 = 0x5500, -+ TYPE_GLNA5 = 0x5555, -+ TYPE_GLNA6 = 0x55AA, -+ TYPE_GLNA7 = 0x55FF, -+ TYPE_GLNA8 = 0xAA00, -+ TYPE_GLNA9 = 0xAA55, -+ TYPE_GLNA10 = 0xAAAA, -+ TYPE_GLNA11 = 0xAAFF, -+ TYPE_GLNA12 = 0xFF00, -+ TYPE_GLNA13 = 0xFF55, -+ TYPE_GLNA14 = 0xFFAA, -+ TYPE_GLNA15 = 0xFFFF, -+}ODM_TYPE_GLNA_E; -+ -+typedef enum tag_ODM_TYPE_ALNA_Definition { -+ TYPE_ALNA0 = 0x0000, -+ TYPE_ALNA1 = 0x0055, -+ TYPE_ALNA2 = 0x00AA, -+ TYPE_ALNA3 = 0x00FF, -+ TYPE_ALNA4 = 0x5500, -+ TYPE_ALNA5 = 0x5555, -+ TYPE_ALNA6 = 0x55AA, -+ TYPE_ALNA7 = 0x55FF, -+ TYPE_ALNA8 = 0xAA00, -+ TYPE_ALNA9 = 0xAA55, -+ TYPE_ALNA10 = 0xAAAA, -+ TYPE_ALNA11 = 0xAAFF, -+ TYPE_ALNA12 = 0xFF00, -+ TYPE_ALNA13 = 0xFF55, -+ TYPE_ALNA14 = 0xFFAA, -+ TYPE_ALNA15 = 0xFFFF, -+}ODM_TYPE_ALNA_E; -+ -+ -+typedef enum _ODM_RF_RADIO_PATH { -+ ODM_RF_PATH_A = 0, //Radio Path A -+ ODM_RF_PATH_B = 1, //Radio Path B -+ ODM_RF_PATH_C = 2, //Radio Path C -+ ODM_RF_PATH_D = 3, //Radio Path D -+ ODM_RF_PATH_AB, -+ ODM_RF_PATH_AC, -+ ODM_RF_PATH_AD, -+ ODM_RF_PATH_BC, -+ ODM_RF_PATH_BD, -+ ODM_RF_PATH_CD, -+ ODM_RF_PATH_ABC, -+ ODM_RF_PATH_ACD, -+ ODM_RF_PATH_BCD, -+ ODM_RF_PATH_ABCD, -+ // ODM_RF_PATH_MAX, //Max RF number 90 support -+} ODM_RF_RADIO_PATH_E, *PODM_RF_RADIO_PATH_E; -+ -+typedef enum _ODM_PARAMETER_INIT { -+ ODM_PRE_SETTING = 0, -+ ODM_POST_SETTING = 1, -+} ODM_PARAMETER_INIT_E; -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.c 2018-02-11 21:44:27.157146238 +0200 -@@ -0,0 +1,3420 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+VOID -+phydm_h2C_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte H2C_Parameter[H2C_MAX_LENGTH] = {0}; -+ u1Byte phydm_h2c_id = (u1Byte)dm_value[0]; -+ u1Byte i; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ PHYDM_SNPRINTF((output+used, out_len-used, "Phydm Send H2C_ID (( 0x%x))\n", phydm_h2c_id)); -+ for (i = 0; i < H2C_MAX_LENGTH; i++) { -+ -+ H2C_Parameter[i] = (u1Byte)dm_value[i+1]; -+ PHYDM_SNPRINTF((output+used, out_len-used, "H2C: Byte[%d] = ((0x%x))\n", i, H2C_Parameter[i])); -+ } -+ -+ ODM_FillH2CCmd(pDM_Odm, phydm_h2c_id, H2C_MAX_LENGTH, H2C_Parameter); -+ -+} -+ -+#if (defined(CONFIG_RA_DBG_CMD)) -+VOID -+odm_RA_ParaAdjust_Send_H2C( -+ IN PVOID pDM_VOID -+) -+{ -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte H2C_Parameter[6] = {0}; -+ -+ H2C_Parameter[0] = RA_FIRST_MACID; -+ -+ if (pRA_Table->RA_Para_feedback_req) { /*H2C_Parameter[5]=1 ; ask FW for all RA parameters*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] Ask FW for RA parameter\n")); -+ H2C_Parameter[5] |= BIT1; /*ask FW to report RA parameters*/ -+ H2C_Parameter[1] = pRA_Table->para_idx; /*pRA_Table->para_idx;*/ -+ pRA_Table->RA_Para_feedback_req = 0; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] Send H2C to FW for modifying RA parameter\n")); -+ -+ H2C_Parameter[1] = pRA_Table->para_idx; -+ H2C_Parameter[2] = pRA_Table->rate_idx; -+ /* [8 bit]*/ -+ if (pRA_Table->para_idx == RADBG_RTY_PENALTY || pRA_Table->para_idx == RADBG_RATE_UP_RTY_RATIO || pRA_Table->para_idx == RADBG_RATE_DOWN_RTY_RATIO) { -+ H2C_Parameter[3] = pRA_Table->value; -+ H2C_Parameter[4] = 0; -+ } -+ /* [16 bit]*/ -+ else { -+ H2C_Parameter[3] = (u1Byte)(((pRA_Table->value_16) & 0xf0) >> 4); /*byte1*/ -+ H2C_Parameter[4] = (u1Byte)((pRA_Table->value_16) & 0x0f); /*byte0*/ -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[1] = 0x%x\n", H2C_Parameter[1])); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[2] = 0x%x\n", H2C_Parameter[2])); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[3] = 0x%x\n", H2C_Parameter[3])); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[4] = 0x%x\n", H2C_Parameter[4])); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[5] = 0x%x\n", H2C_Parameter[5])); -+ -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RA_PARA_ADJUST, 6, H2C_Parameter); -+ -+} -+ -+ -+VOID -+odm_RA_ParaAdjust( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte rate_idx = pRA_Table->rate_idx; -+ u1Byte value = pRA_Table->value; -+ u1Byte Pre_value = 0xff; -+ -+ if (pRA_Table->para_idx == RADBG_RTY_PENALTY) { -+ Pre_value = pRA_Table->RTY_P[rate_idx]; -+ pRA_Table->RTY_P[rate_idx] = value; -+ pRA_Table->RTY_P_modify_note[rate_idx] = 1; -+ } else if (pRA_Table->para_idx == RADBG_N_HIGH) { -+ -+ } else if (pRA_Table->para_idx == RADBG_N_LOW) { -+ -+ } else if (pRA_Table->para_idx == RADBG_RATE_UP_RTY_RATIO) { -+ Pre_value = pRA_Table->RATE_UP_RTY_RATIO[rate_idx]; -+ pRA_Table->RATE_UP_RTY_RATIO[rate_idx] = value; -+ pRA_Table->RATE_UP_RTY_RATIO_modify_note[rate_idx] = 1; -+ } else if (pRA_Table->para_idx == RADBG_RATE_DOWN_RTY_RATIO) { -+ Pre_value = pRA_Table->RATE_DOWN_RTY_RATIO[rate_idx]; -+ pRA_Table->RATE_DOWN_RTY_RATIO[rate_idx] = value; -+ pRA_Table->RATE_DOWN_RTY_RATIO_modify_note[rate_idx] = 1; -+ } -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("Change RA Papa[%d], Rate[ %d ], ((%d)) -> ((%d))\n", pRA_Table->para_idx, rate_idx, Pre_value, value)); -+ odm_RA_ParaAdjust_Send_H2C(pDM_Odm); -+} -+ -+VOID -+phydm_ra_print_msg( -+ IN PVOID pDM_VOID, -+ IN u1Byte *value, -+ IN u1Byte *value_default, -+ IN u1Byte *modify_note -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u4Byte i; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate index| |Current-value| |Default-value| |Modify?|\n")); -+ for (i = 0 ; i <= (pRA_Table->rate_length); i++) { -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [ %d ] %20d %25d %20s\n", i, value[i], value_default[i], ((modify_note[i] == 1) ? "V" : " . "))); -+#else -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [ %d ] %10d %14d %14s\n", i, value[i], value_default[i], ((modify_note[i] == 1) ? "V" : " . "))); -+#endif -+ } -+ -+} -+ -+VOID -+odm_RA_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ pRA_Table->is_ra_dbg_init = FALSE; -+ -+ if (dm_value[0] == 100) { /*1 Print RA Parameters*/ -+ u1Byte default_pointer_value; -+ u1Byte *pvalue; -+ u1Byte *pvalue_default; -+ u1Byte *pmodify_note; -+ -+ pvalue = pvalue_default = pmodify_note = &default_pointer_value; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("\n------------------------------------------------------------------------------------\n")); -+ -+ if (dm_value[1] == RADBG_RTY_PENALTY) { /* [1]*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [1] RTY_PENALTY\n")); -+ pvalue = &(pRA_Table->RTY_P[0]); -+ pvalue_default = &(pRA_Table->RTY_P_default[0]); -+ pmodify_note = (u1Byte *)&(pRA_Table->RTY_P_modify_note[0]); -+ } else if (dm_value[1] == RADBG_N_HIGH) { /* [2]*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [2] N_HIGH\n")); -+ -+ } else if (dm_value[1] == RADBG_N_LOW) { /*[3]*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [3] N_LOW\n")); -+ -+ } else if (dm_value[1] == RADBG_RATE_UP_RTY_RATIO) { /* [8]*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [8] RATE_UP_RTY_RATIO\n")); -+ pvalue = &(pRA_Table->RATE_UP_RTY_RATIO[0]); -+ pvalue_default = &(pRA_Table->RATE_UP_RTY_RATIO_default[0]); -+ pmodify_note = (u1Byte *)&(pRA_Table->RATE_UP_RTY_RATIO_modify_note[0]); -+ } else if (dm_value[1] == RADBG_RATE_DOWN_RTY_RATIO) { /* [9]*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [9] RATE_DOWN_RTY_RATIO\n")); -+ pvalue = &(pRA_Table->RATE_DOWN_RTY_RATIO[0]); -+ pvalue_default = &(pRA_Table->RATE_DOWN_RTY_RATIO_default[0]); -+ pmodify_note = (u1Byte *)&(pRA_Table->RATE_DOWN_RTY_RATIO_modify_note[0]); -+ } -+ -+ phydm_ra_print_msg(pDM_Odm, pvalue, pvalue_default, pmodify_note); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("\n------------------------------------------------------------------------------------\n\n")); -+ -+ } else if (dm_value[0] == 101) { -+ pRA_Table->para_idx = (u1Byte)dm_value[1]; -+ -+ pRA_Table->RA_Para_feedback_req = 1; -+ odm_RA_ParaAdjust_Send_H2C(pDM_Odm); -+ } else { -+ pRA_Table->para_idx = (u1Byte)dm_value[0]; -+ pRA_Table->rate_idx = (u1Byte)dm_value[1]; -+ pRA_Table->value = (u1Byte)dm_value[2]; -+ -+ odm_RA_ParaAdjust(pDM_Odm); -+ } -+} -+ -+VOID -+odm_RA_ParaAdjust_init( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte i; -+ u1Byte ra_para_pool_u8[3] = { RADBG_RTY_PENALTY, RADBG_RATE_UP_RTY_RATIO, RADBG_RATE_DOWN_RTY_RATIO}; -+ u1Byte RateSize_HT_1ss = 20, RateSize_HT_2ss = 28, RateSize_HT_3ss = 36; /*4+8+8+8+8 =36*/ -+ u1Byte RateSize_VHT_1ss = 10, RateSize_VHT_2ss = 20, RateSize_VHT_3ss = 30; /*10 + 10 +10 =30*/ -+ /* -+ RTY_PENALTY = 1, //u8 -+ N_HIGH = 2, -+ N_LOW = 3, -+ RATE_UP_TABLE = 4, -+ RATE_DOWN_TABLE = 5, -+ TRYING_NECESSARY = 6, -+ DROPING_NECESSARY = 7, -+ RATE_UP_RTY_RATIO = 8, //u8 -+ RATE_DOWN_RTY_RATIO= 9, //u8 -+ ALL_PARA = 0xff -+ -+ */ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("odm_RA_ParaAdjust_init\n")); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8188F | ODM_RTL8195A | ODM_RTL8703B | ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8723D)) -+ pRA_Table->rate_length = RateSize_HT_1ss; -+ else if (pDM_Odm->SupportICType & (ODM_RTL8192E | ODM_RTL8197F)) -+ pRA_Table->rate_length = RateSize_HT_2ss; -+ else if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8881A | ODM_RTL8821C)) -+ pRA_Table->rate_length = RateSize_HT_1ss + RateSize_VHT_1ss; -+ else if (pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8822B)) -+ pRA_Table->rate_length = RateSize_HT_2ss + RateSize_VHT_2ss; -+ else if (pDM_Odm->SupportICType == ODM_RTL8814A) -+ pRA_Table->rate_length = RateSize_HT_3ss + RateSize_VHT_3ss; -+ else -+ pRA_Table->rate_length = RateSize_HT_1ss; -+ -+ pRA_Table->is_ra_dbg_init = TRUE; -+ for (i = 0; i < 3; i++) { -+ pRA_Table->RA_Para_feedback_req = 1; -+ pRA_Table->para_idx = ra_para_pool_u8[i]; -+ odm_RA_ParaAdjust_Send_H2C(pDM_Odm); -+ } -+} -+ -+#else -+ -+VOID -+phydm_RA_debug_PCR( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u4Byte used = *_used; -+ u4Byte out_len = *_out_len; -+ -+ if (dm_value[0] == 100) { -+ PHYDM_SNPRINTF((output+used, out_len-used, "[Get] PCR RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")), pRA_Table->RA_threshold_offset)); -+ /**/ -+ } else if (dm_value[0] == 0) { -+ pRA_Table->RA_offset_direction = 0; -+ pRA_Table->RA_threshold_offset = (u1Byte)dm_value[1]; -+ PHYDM_SNPRINTF((output+used, out_len-used, "[Set] PCR RA_threshold_offset = (( -%d ))\n", pRA_Table->RA_threshold_offset)); -+ } else if (dm_value[0] == 1) { -+ pRA_Table->RA_offset_direction = 1; -+ pRA_Table->RA_threshold_offset = (u1Byte)dm_value[1]; -+ PHYDM_SNPRINTF((output+used, out_len-used, "[Set] PCR RA_threshold_offset = (( +%d ))\n", pRA_Table->RA_threshold_offset)); -+ } else { -+ PHYDM_SNPRINTF((output+used, out_len-used, "[Set] Error\n")); -+ /**/ -+ } -+ -+} -+ -+#endif /*#if (defined(CONFIG_RA_DBG_CMD))*/ -+ -+VOID -+ODM_C2HRaParaReportHandler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ u1Byte para_idx = CmdBuf[0]; /*Retry Penalty, NH, NL*/ -+ u1Byte RateTypeStart = CmdBuf[1]; -+ u1Byte RateTypeLength = CmdLen - 2; -+ u1Byte i; -+ -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[ From FW C2H RA Para ] CmdBuf[0]= (( %d ))\n", CmdBuf[0])); -+ -+#if (defined(CONFIG_RA_DBG_CMD)) -+ if (para_idx == RADBG_RTY_PENALTY) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |RTY Penality Index|\n")); -+ -+ for (i = 0 ; i < (RateTypeLength) ; i++) { -+ if (pRA_Table->is_ra_dbg_init) -+ pRA_Table->RTY_P_default[RateTypeStart + i] = CmdBuf[2 + i]; -+ -+ pRA_Table->RTY_P[RateTypeStart + i] = CmdBuf[2 + i]; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d \n", (RateTypeStart + i), pRA_Table->RTY_P[RateTypeStart + i])); -+ } -+ -+ } else if (para_idx == RADBG_N_HIGH) { -+ /**/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |N-High|\n")); -+ -+ -+ } else if (para_idx == RADBG_N_LOW) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |N-Low|\n")); -+ /**/ -+ } -+ else if (para_idx == RADBG_RATE_UP_RTY_RATIO) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |Rate Up RTY Ratio|\n")); -+ -+ for (i = 0; i < (RateTypeLength); i++) { -+ if (pRA_Table->is_ra_dbg_init) -+ pRA_Table->RATE_UP_RTY_RATIO_default[RateTypeStart + i] = CmdBuf[2 + i]; -+ -+ pRA_Table->RATE_UP_RTY_RATIO[RateTypeStart + i] = CmdBuf[2 + i]; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d\n", (RateTypeStart + i), pRA_Table->RATE_UP_RTY_RATIO[RateTypeStart + i])); -+ } -+ } else if (para_idx == RADBG_RATE_DOWN_RTY_RATIO) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |Rate Down RTY Ratio|\n")); -+ -+ for (i = 0; i < (RateTypeLength); i++) { -+ if (pRA_Table->is_ra_dbg_init) -+ pRA_Table->RATE_DOWN_RTY_RATIO_default[RateTypeStart + i] = CmdBuf[2 + i]; -+ -+ pRA_Table->RATE_DOWN_RTY_RATIO[RateTypeStart + i] = CmdBuf[2 + i]; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d\n", (RateTypeStart + i), pRA_Table->RATE_DOWN_RTY_RATIO[RateTypeStart + i])); -+ } -+ } else -+#endif -+ if (para_idx == RADBG_DEBUG_MONITOR1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); -+ if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "RSSI =", CmdBuf[1])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "Rate =", CmdBuf[2] & 0x7f)); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "SGI =", (CmdBuf[2] & 0x80) >> 7)); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "BW =", CmdBuf[3])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "BW_max =", CmdBuf[4])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "multi_rate0 =", CmdBuf[5])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "multi_rate1 =", CmdBuf[6])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "DISRA =", CmdBuf[7])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "VHT_EN =", CmdBuf[8])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "SGI_support =", CmdBuf[9])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "try_ness =", CmdBuf[10])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "pre_rate =", CmdBuf[11])); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "RSSI =", CmdBuf[1])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %x\n", "BW =", CmdBuf[2])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "DISRA =", CmdBuf[3])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "VHT_EN =", CmdBuf[4])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Hightest Rate =", CmdBuf[5])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "Lowest Rate =", CmdBuf[6])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "SGI_support =", CmdBuf[7])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Rate_ID =", CmdBuf[8]));; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); -+ } else if (para_idx == RADBG_DEBUG_MONITOR2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); -+ if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "RateID =", CmdBuf[1])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "highest_rate =", CmdBuf[2])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "lowest_rate =", CmdBuf[3])); -+ -+ for (i = 4; i <= 11; i++) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("RAMASK = 0x%x\n", CmdBuf[i])); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %x%x %x%x %x%x %x%x\n", "RA Mask:", -+ CmdBuf[8], CmdBuf[7], CmdBuf[6], CmdBuf[5], CmdBuf[4], CmdBuf[3], CmdBuf[2], CmdBuf[1])); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); -+ } else if (para_idx == RADBG_DEBUG_MONITOR3) { -+ -+ for (i = 0; i < (CmdLen - 1); i++) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("content[%d] = %d\n", i, CmdBuf[1 + i])); -+ } else if (para_idx == RADBG_DEBUG_MONITOR4) -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s {%d.%d}\n", "RA Version =", CmdBuf[1], CmdBuf[2])); -+ else if (para_idx == RADBG_DEBUG_MONITOR5) { -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "Current rate =", CmdBuf[1])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Retry ratio =", CmdBuf[2])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Rate down ratio =", CmdBuf[3])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "highest rate =", CmdBuf[4])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s {0x%x 0x%x}\n", "Muti-try =", CmdBuf[5], CmdBuf[6])); -+ ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x%x%x%x%x\n", "RA mask =", CmdBuf[11], CmdBuf[10], CmdBuf[9], CmdBuf[8], CmdBuf[7])); -+ } -+} -+ -+VOID -+phydm_ra_dynamic_retry_count( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ PSTA_INFO_T pEntry; -+ u1Byte i, retry_offset; -+ u4Byte ma_rx_tp; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_ARFR)) { -+ return; -+ } -+ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("pDM_Odm->pre_b_noisy = %d\n", pDM_Odm->pre_b_noisy ));*/ -+ if (pDM_Odm->pre_b_noisy != pDM_Odm->NoisyDecision) { -+ -+ if (pDM_Odm->NoisyDecision) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("->Noisy Env. RA fallback value\n")); -+ ODM_SetMACReg(pDM_Odm, 0x430, bMaskDWord, 0x0); -+ ODM_SetMACReg(pDM_Odm, 0x434, bMaskDWord, 0x04030201); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("->Clean Env. RA fallback value\n")); -+ ODM_SetMACReg(pDM_Odm, 0x430, bMaskDWord, 0x01000000); -+ ODM_SetMACReg(pDM_Odm, 0x434, bMaskDWord, 0x06050402); -+ } -+ pDM_Odm->pre_b_noisy = pDM_Odm->NoisyDecision; -+ } -+} -+ -+#if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) -+ -+VOID -+phydm_retry_limit_table_bound( -+ IN PVOID pDM_VOID, -+ IN u1Byte *retry_limit, -+ IN u1Byte offset -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ if (*retry_limit > offset) { -+ -+ *retry_limit -= offset; -+ -+ if (*retry_limit < pRA_Table->retrylimit_low) -+ *retry_limit = pRA_Table->retrylimit_low; -+ else if (*retry_limit > pRA_Table->retrylimit_high) -+ *retry_limit = pRA_Table->retrylimit_high; -+ } else -+ *retry_limit = pRA_Table->retrylimit_low; -+} -+ -+VOID -+phydm_reset_retry_limit_table( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte i; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) /*support all IC platform*/ -+ -+ #else -+ #if ((RTL8192E_SUPPORT == 1) || (RTL8723B_SUPPORT == 1) || (RTL8188E_SUPPORT == 1)) -+ u1Byte per_rate_retrylimit_table_20M[ODM_RATEMCS15+1] = { -+ 1, 1, 2, 4, /*CCK*/ -+ 2, 2, 4, 6, 8, 12, 16, 18, /*OFDM*/ -+ 2, 4, 6, 8, 12, 18, 20, 22, /*20M HT-1SS*/ -+ 2, 4, 6, 8, 12, 18, 20, 22 /*20M HT-2SS*/ -+ }; -+ u1Byte per_rate_retrylimit_table_40M[ODM_RATEMCS15+1] = { -+ 1, 1, 2, 4, /*CCK*/ -+ 2, 2, 4, 6, 8, 12, 16, 18, /*OFDM*/ -+ 4, 8, 12, 16, 24, 32, 32, 32, /*40M HT-1SS*/ -+ 4, 8, 12, 16, 24, 32, 32, 32 /*40M HT-2SS*/ -+ }; -+ -+ #elif (RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) -+ -+ #elif (RTL8812A_SUPPORT == 1) -+ -+ #elif(RTL8814A_SUPPORT == 1) -+ -+ #else -+ -+ #endif -+ #endif -+ -+ memcpy(&(pRA_Table->per_rate_retrylimit_20M[0]), &(per_rate_retrylimit_table_20M[0]), ODM_NUM_RATE_IDX); -+ memcpy(&(pRA_Table->per_rate_retrylimit_40M[0]), &(per_rate_retrylimit_table_40M[0]), ODM_NUM_RATE_IDX); -+ -+ for (i = 0; i < ODM_NUM_RATE_IDX; i++) { -+ phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_20M[i]), 0); -+ phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_40M[i]), 0); -+ } -+} -+ -+VOID -+phydm_ra_dynamic_retry_limit_init( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ pRA_Table->retry_descend_num = RA_RETRY_DESCEND_NUM; -+ pRA_Table->retrylimit_low = RA_RETRY_LIMIT_LOW; -+ pRA_Table->retrylimit_high = RA_RETRY_LIMIT_HIGH; -+ -+ phydm_reset_retry_limit_table(pDM_Odm); -+ -+} -+ -+#endif -+ -+VOID -+phydm_ra_dynamic_retry_limit( -+ IN PVOID pDM_VOID -+) -+{ -+#if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ PSTA_INFO_T pEntry; -+ u1Byte i, retry_offset; -+ u4Byte ma_rx_tp; -+ -+ -+ if (pDM_Odm->pre_number_active_client == pDM_Odm->number_active_client) { -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" pre_number_active_client == number_active_client\n")); -+ return; -+ -+ } else { -+ if (pDM_Odm->number_active_client == 1) { -+ phydm_reset_retry_limit_table(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("one client only->reset to default value\n")); -+ } else { -+ -+ retry_offset = pDM_Odm->number_active_client * pRA_Table->retry_descend_num; -+ -+ for (i = 0; i < ODM_NUM_RATE_IDX; i++) { -+ -+ phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_20M[i]), retry_offset); -+ phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_40M[i]), retry_offset); -+ } -+ } -+ } -+#endif -+} -+ -+#if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) -+VOID -+phydm_ra_dynamic_rate_id_on_assoc( -+ IN PVOID pDM_VOID, -+ IN u1Byte wireless_mode, -+ IN u1Byte init_rate_id -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] rf_mode = ((0x%x)), wireless_mode = ((0x%x)), init_rate_id = ((0x%x))\n", pDM_Odm->RFType, wireless_mode, init_rate_id)); -+ -+ if ((pDM_Odm->RFType == ODM_2T2R) | (pDM_Odm->RFType == ODM_2T2R_GREEN) | (pDM_Odm->RFType == ODM_2T3R) | (pDM_Odm->RFType == ODM_2T4R)) { -+ -+ if ((pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8192E)) && -+ (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G)) -+ ){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] set N-2SS ARFR5 table\n")); -+ ODM_SetMACReg(pDM_Odm, 0x4a4, bMaskDWord, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ -+ ODM_SetMACReg(pDM_Odm, 0x4a8, bMaskDWord, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ -+ } else if ((pDM_Odm->SupportICType & (ODM_RTL8812)) && -+ (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY)) -+ ){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] set AC-2SS ARFR0 table\n")); -+ ODM_SetMACReg(pDM_Odm, 0x444, bMaskDWord, 0x0fff); /*AC-2SS, ARFR0, rate_id = 0x9*/ -+ ODM_SetMACReg(pDM_Odm, 0x448, bMaskDWord, 0xff01f000); /*AC-2SS, ARFR0, rate_id = 0x9*/ -+ } -+ } -+ -+} -+ -+VOID -+phydm_ra_dynamic_rate_id_init( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8192E)) { -+ -+ ODM_SetMACReg(pDM_Odm, 0x4a4, bMaskDWord, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ -+ ODM_SetMACReg(pDM_Odm, 0x4a8, bMaskDWord, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ -+ -+ ODM_SetMACReg(pDM_Odm, 0x444, bMaskDWord, 0x0fff); /*AC-2SS, ARFR0, rate_id = 0x9*/ -+ ODM_SetMACReg(pDM_Odm, 0x448, bMaskDWord, 0xff01f000); /*AC-2SS, ARFR0, rate_id = 0x9*/ -+ } -+} -+ -+VOID -+phydm_update_rate_id( -+ IN PVOID pDM_VOID, -+ IN u1Byte rate, -+ IN u1Byte platform_macid -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte current_tx_ss; -+ u1Byte rate_idx = rate & 0x7f; /*remove bit7 SGI*/ -+ u1Byte wireless_mode; -+ u1Byte phydm_macid; -+ PSTA_INFO_T pEntry; -+ -+ -+#if 0 -+ if (rate_idx >= ODM_RATEVHTSS2MCS0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( VHT2SS-MCS%d ))\n", platform_macid, (rate_idx-ODM_RATEVHTSS2MCS0))); -+ /*dummy for SD4 check patch*/ -+ } else if (rate_idx >= ODM_RATEVHTSS1MCS0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( VHT1SS-MCS%d ))\n", platform_macid, (rate_idx-ODM_RATEVHTSS1MCS0))); -+ /*dummy for SD4 check patch*/ -+ } else if (rate_idx >= ODM_RATEMCS0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( HT-MCS%d ))\n", platform_macid, (rate_idx-ODM_RATEMCS0))); -+ /*dummy for SD4 check patch*/ -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( HT-MCS%d ))\n", platform_macid, rate_idx)); -+ /*dummy for SD4 check patch*/ -+ } -+#endif -+ -+ phydm_macid = pDM_Odm->platform2phydm_macid_table[platform_macid]; -+ pEntry = pDM_Odm->pODM_StaInfo[phydm_macid]; -+ -+ if (IS_STA_VALID(pEntry)) { -+ wireless_mode = pEntry->WirelessMode; -+ -+ if ((pDM_Odm->RFType == ODM_2T2R) | (pDM_Odm->RFType == ODM_2T2R_GREEN) | (pDM_Odm->RFType == ODM_2T3R) | (pDM_Odm->RFType == ODM_2T4R)) { -+ -+ pEntry->ratr_idx = pEntry->ratr_idx_init; -+ if (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G)) { /*N mode*/ -+ if (rate_idx >= ODM_RATEMCS8 && rate_idx <= ODM_RATEMCS15) { /*2SS mode*/ -+ -+ pEntry->ratr_idx = ARFR_5_RATE_ID; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("ARFR_5\n")); -+ } -+ } else if (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY)) {/*AC mode*/ -+ if (rate_idx >= ODM_RATEVHTSS2MCS0 && rate_idx <= ODM_RATEVHTSS2MCS9) {/*2SS mode*/ -+ -+ pEntry->ratr_idx = ARFR_0_RATE_ID; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("ARFR_0\n")); -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("UPdate_RateID[%d]: (( 0x%x ))\n", platform_macid, pEntry->ratr_idx)); -+ } -+ } -+ -+} -+#endif -+ -+VOID -+phydm_print_rate( -+ IN PVOID pDM_VOID, -+ IN u1Byte rate, -+ IN u4Byte dbg_component -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte legacy_table[12] = {1, 2, 5, 11, 6, 9, 12, 18, 24, 36, 48, 54}; -+ u1Byte rate_idx = rate & 0x7f; /*remove bit7 SGI*/ -+ u1Byte vht_en = (rate_idx >= ODM_RATEVHTSS1MCS0) ? 1 : 0; -+ u1Byte b_sgi = (rate & 0x80)>>7; -+ -+ ODM_RT_TRACE_F(pDM_Odm, dbg_component, ODM_DBG_LOUD, ("( %s%s%s%s%d%s%s)\n", -+ ((rate_idx >= ODM_RATEVHTSS1MCS0) && (rate_idx <= ODM_RATEVHTSS1MCS9)) ? "VHT 1ss " : "", -+ ((rate_idx >= ODM_RATEVHTSS2MCS0) && (rate_idx <= ODM_RATEVHTSS2MCS9)) ? "VHT 2ss " : "", -+ ((rate_idx >= ODM_RATEVHTSS3MCS0) && (rate_idx <= ODM_RATEVHTSS3MCS9)) ? "VHT 3ss " : "", -+ (rate_idx >= ODM_RATEMCS0) ? "MCS " : "", -+ (vht_en) ? ((rate_idx - ODM_RATEVHTSS1MCS0)%10) : ((rate_idx >= ODM_RATEMCS0) ? (rate_idx - ODM_RATEMCS0) : ((rate_idx <= ODM_RATE54M)?legacy_table[rate_idx]:0)), -+ (b_sgi) ? "-S" : " ", -+ (rate_idx >= ODM_RATEMCS0) ? "" : "M")); -+} -+ -+VOID -+phydm_c2h_ra_report_handler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte legacy_table[12] = {1,2,5,11,6,9,12,18,24,36,48,54}; -+ u1Byte macid = CmdBuf[1]; -+ u1Byte rate = CmdBuf[0]; -+ u1Byte rate_idx = rate & 0x7f; /*remove bit7 SGI*/ -+ u1Byte pre_rate = pRA_Table->link_tx_rate[macid]; -+ u1Byte rate_order; -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ GET_HAL_DATA(Adapter)->CurrentRARate = HwRateToMRate(rate_idx); -+ #endif -+ -+ -+ if (CmdLen >= 4) { -+ if (CmdBuf[3] == 0) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("TX Init-Rate Update[%d]:", macid)); -+ /**/ -+ } else if (CmdBuf[3] == 0xff) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("FW Level: Fix rate[%d]:", macid)); -+ /**/ -+ } else if (CmdBuf[3] == 1) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Try Success[%d]:", macid)); -+ /**/ -+ } else if (CmdBuf[3] == 2) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Try Fail & Try Again[%d]:", macid)); -+ /**/ -+ } else if (CmdBuf[3] == 3) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate Back[%d]:", macid)); -+ /**/ -+ } else if (CmdBuf[3] == 4) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("start rate by RSSI[%d]:", macid)); -+ /**/ -+ } else if (CmdBuf[3] == 5) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Try rate[%d]:", macid)); -+ /**/ -+ } -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Tx Rate Update[%d]:", macid)); -+ /**/ -+ } -+ -+ /*phydm_print_rate(pDM_Odm, pre_rate_idx, ODM_COMP_RATE_ADAPTIVE);*/ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, (">\n",macid );*/ -+ phydm_print_rate(pDM_Odm, rate, ODM_COMP_RATE_ADAPTIVE); -+ -+ pRA_Table->link_tx_rate[macid] = rate; -+ -+ /*trigger power training*/ -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ -+ rate_order = phydm_rate_order_compute(pDM_Odm, rate_idx); -+ -+ if ((pDM_Odm->bOneEntryOnly) || -+ ((rate_order > pRA_Table->highest_client_tx_order) && (pRA_Table->power_tracking_flag == 1)) -+ ) { -+ phydm_update_pwr_track(pDM_Odm, rate_idx); -+ pRA_Table->power_tracking_flag = 0; -+ } -+ -+ #endif -+ -+ /*trigger dynamic rate ID*/ -+ #if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8192E)) -+ phydm_update_rate_id(pDM_Odm, rate, macid); -+ #endif -+ -+} -+ -+VOID -+odm_RSSIMonitorInit( -+ IN PVOID pDM_VOID -+) -+{ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ pRA_Table->PT_collision_pre = TRUE; /*used in ODM_DynamicARFBSelect(WIN only)*/ -+ -+ pHalData->UndecoratedSmoothedPWDB = -1; -+ pHalData->ra_rpt_linked = FALSE; -+ #endif -+ -+ pRA_Table->firstconnect = FALSE; -+ -+ -+#endif -+} -+ -+VOID -+ODM_RAPostActionOnAssoc( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+/* -+ pDM_Odm->H2C_RARpt_connect = 1; -+ odm_RSSIMonitorCheck(pDM_Odm); -+ pDM_Odm->H2C_RARpt_connect = 0; -+*/ -+} -+ -+VOID -+phydm_initRaInfo( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+#if (RTL8822B_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8822B) { -+ u4Byte ret_value; -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, 0x4c8, bMaskByte2); -+ ODM_SetBBReg(pDM_Odm, 0x4cc, bMaskByte3, (ret_value - 1)); -+ } -+#endif -+} -+ -+VOID -+phydm_modify_RA_PCR_threshold( -+ IN PVOID pDM_VOID, -+ IN u1Byte RA_offset_direction, -+ IN u1Byte RA_threshold_offset -+ -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ pRA_Table->RA_offset_direction = RA_offset_direction; -+ pRA_Table->RA_threshold_offset = RA_threshold_offset; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Set RA_threshold_offset = (( %s%d ))\n", ((RA_threshold_offset == 0) ? " " : ((RA_offset_direction) ? "+" : "-")), RA_threshold_offset)); -+} -+ -+VOID -+odm_RSSIMonitorCheckMP( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte H2C_Parameter[H2C_0X42_LENGTH] = {0}; -+ u4Byte i; -+ BOOLEAN bExtRAInfo = TRUE; -+ u1Byte cmdlen = H2C_0X42_LENGTH; -+ u1Byte TxBF_EN = 0, stbc_en = 0; -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PSTA_INFO_T pEntry = NULL; -+ s4Byte tmpEntryMaxPWDB = 0, tmpEntryMinPWDB = 0xff; -+ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -+ PMGNT_INFO pDefaultMgntInfo = &Adapter->MgntInfo; -+ u8Byte curTxOkCnt = 0, curRxOkCnt = 0; -+#if (BEAMFORMING_SUPPORT == 1) -+#ifndef BEAMFORMING_VERSION_1 -+ BEAMFORMING_CAP Beamform_cap = BEAMFORMING_CAP_NONE; -+#endif -+#endif -+ PADAPTER pLoopAdapter = GetDefaultAdapter(Adapter); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+ bExtRAInfo = FALSE; -+ cmdlen = 3; -+ } -+ -+ while (pLoopAdapter) { -+ -+ if (pLoopAdapter != NULL) { -+ pMgntInfo = &pLoopAdapter->MgntInfo; -+ curTxOkCnt = pLoopAdapter->TxStats.NumTxBytesUnicast - pMgntInfo->lastTxOkCnt; -+ curRxOkCnt = pLoopAdapter->RxStats.NumRxBytesUnicast - pMgntInfo->lastRxOkCnt; -+ pMgntInfo->lastTxOkCnt = curTxOkCnt; -+ pMgntInfo->lastRxOkCnt = curRxOkCnt; -+ } -+ -+ for (i = 0; i < ASSOCIATE_ENTRY_NUM; i++) { -+ -+ if (IsAPModeExist(pLoopAdapter)) { -+ if (GetFirstExtAdapter(pLoopAdapter) != NULL && -+ GetFirstExtAdapter(pLoopAdapter) == pLoopAdapter) -+ pEntry = AsocEntry_EnumStation(pLoopAdapter, i); -+ else if (GetFirstGOPort(pLoopAdapter) != NULL && -+ IsFirstGoAdapter(pLoopAdapter)) -+ pEntry = AsocEntry_EnumStation(pLoopAdapter, i); -+ } else { -+ if (GetDefaultAdapter(pLoopAdapter) == pLoopAdapter) -+ pEntry = AsocEntry_EnumStation(pLoopAdapter, i); -+ } -+ -+ if (pEntry != NULL) { -+ if (pEntry->bAssociated) { -+ -+ RT_DISP_ADDR(FDM, DM_PWDB, ("pEntry->MacAddr ="), pEntry->MacAddr); -+ RT_DISP(FDM, DM_PWDB, ("pEntry->rssi = 0x%x(%d)\n", -+ pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); -+ -+ //2 BF_en -+#if (BEAMFORMING_SUPPORT == 1) -+#ifndef BEAMFORMING_VERSION_1 -+ Beamform_cap = phydm_Beamforming_GetEntryBeamCapByMacId(pDM_Odm, pEntry->AssociatedMacId); -+ if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) -+ TxBF_EN = 1; -+#else -+ if(Beamform_GetSupportBeamformerCap(GetDefaultAdapter(Adapter), pEntry)) -+ TxBF_EN = 1; -+#endif -+#endif -+ //2 STBC_en -+ if ((IS_WIRELESS_MODE_AC(Adapter) && TEST_FLAG(pEntry->VHTInfo.STBC, STBC_VHT_ENABLE_TX)) || -+ TEST_FLAG(pEntry->HTInfo.STBC, STBC_HT_ENABLE_TX)) -+ stbc_en = 1; -+ -+ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB) -+ tmpEntryMinPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; -+ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB) -+ tmpEntryMaxPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ H2C_Parameter[4] = (pRA_Table->RA_threshold_offset & 0x7f) | (pRA_Table->RA_offset_direction<<7); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")),pRA_Table->RA_threshold_offset)); -+ -+ if (bExtRAInfo) { -+ if (curRxOkCnt > (curTxOkCnt * 6)) -+ H2C_Parameter[3] |= RAINFO_BE_RX_STATE; -+ -+ if (TxBF_EN) -+ H2C_Parameter[3] |= RAINFO_BF_STATE; -+ else { -+ if (stbc_en) -+ H2C_Parameter[3] |= RAINFO_STBC_STATE; -+ } -+ -+ if (pDM_Odm->NoisyDecision) -+ H2C_Parameter[3] |= RAINFO_NOISY_STATE; -+ else -+ H2C_Parameter[3] &= (~RAINFO_NOISY_STATE); -+ #if 1 -+ if (pDM_Odm->H2C_RARpt_connect) { -+ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("H2C_RARpt_connect = (( %d ))\n", pDM_Odm->H2C_RARpt_connect)); -+ } -+ #else -+ -+ if (pEntry->rssi_stat.ra_rpt_linked == FALSE) { -+ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; -+ pEntry->rssi_stat.ra_rpt_linked = TRUE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("RA First Link, RSSI[%d] = ((%d))\n", -+ pEntry->AssociatedMacId, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); -+ } -+ #endif -+ } -+ -+ H2C_Parameter[2] = (u1Byte)(pEntry->rssi_stat.UndecoratedSmoothedPWDB & 0xFF); -+ //H2C_Parameter[1] = 0x20; // fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1 -+ H2C_Parameter[0] = (pEntry->AssociatedMacId); -+ -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); -+ } -+ } else -+ break; -+ } -+ -+ pLoopAdapter = GetNextExtAdapter(pLoopAdapter); -+ } -+ -+ -+ /*Default port*/ -+ if (tmpEntryMaxPWDB != 0) { // If associated entry is found -+ pHalData->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB; -+ RT_DISP(FDM, DM_PWDB, ("EntryMaxPWDB = 0x%x(%d)\n", tmpEntryMaxPWDB, tmpEntryMaxPWDB)); -+ } else -+ pHalData->EntryMaxUndecoratedSmoothedPWDB = 0; -+ -+ if (tmpEntryMinPWDB != 0xff) { // If associated entry is found -+ pHalData->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB; -+ RT_DISP(FDM, DM_PWDB, ("EntryMinPWDB = 0x%x(%d)\n", tmpEntryMinPWDB, tmpEntryMinPWDB)); -+ -+ } else -+ pHalData->EntryMinUndecoratedSmoothedPWDB = 0; -+ -+ /* Default porti sent RSSI to FW */ -+ if (pHalData->bUseRAMask) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("1 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n", -+ WIN_DEFAULT_PORT_MACID, pHalData->UndecoratedSmoothedPWDB, pHalData->ra_rpt_linked)); -+ if (pHalData->UndecoratedSmoothedPWDB > 0) { -+ -+ PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pDefaultMgntInfo); -+ PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pDefaultMgntInfo); -+ -+ /* BF_en*/ -+ #if (BEAMFORMING_SUPPORT == 1) -+ #ifndef BEAMFORMING_VERSION_1 -+ Beamform_cap = phydm_Beamforming_GetEntryBeamCapByMacId(pDM_Odm, pDefaultMgntInfo->mMacId); -+ -+ if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) -+ TxBF_EN = 1; -+ #else -+ if(Beamform_GetSupportBeamformerCap(GetDefaultAdapter(Adapter), NULL)) -+ TxBF_EN = 1; -+ #endif -+ #endif -+ -+ /* STBC_en*/ -+ if ((IS_WIRELESS_MODE_AC(Adapter) && TEST_FLAG(pVHTInfo->VhtCurStbc, STBC_VHT_ENABLE_TX)) || -+ TEST_FLAG(pHTInfo->HtCurStbc, STBC_HT_ENABLE_TX)) -+ stbc_en = 1; -+ -+ H2C_Parameter[4] = (pRA_Table->RA_threshold_offset & 0x7f) | (pRA_Table->RA_offset_direction<<7); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")), pRA_Table->RA_threshold_offset)); -+ -+ if (bExtRAInfo) { -+ if (TxBF_EN) -+ H2C_Parameter[3] |= RAINFO_BF_STATE; -+ else { -+ if (stbc_en) -+ H2C_Parameter[3] |= RAINFO_STBC_STATE; -+ } -+ -+ #if 1 -+ if (pDM_Odm->H2C_RARpt_connect) { -+ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("H2C_RARpt_connect = (( %d ))\n", pDM_Odm->H2C_RARpt_connect)); -+ } -+ #else -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("2 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n", -+ WIN_DEFAULT_PORT_MACID, pHalData->UndecoratedSmoothedPWDB, pHalData->ra_rpt_linked)); -+ -+ if (pHalData->ra_rpt_linked == FALSE) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("3 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n", -+ WIN_DEFAULT_PORT_MACID, pHalData->UndecoratedSmoothedPWDB, pHalData->ra_rpt_linked)); -+ -+ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; -+ pHalData->ra_rpt_linked = TRUE; -+ -+ -+ } -+ #endif -+ -+ if (pDM_Odm->NoisyDecision == 1) { -+ H2C_Parameter[3] |= RAINFO_NOISY_STATE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, ("[RSSIMonitorCheckMP] Send H2C to FW\n")); -+ } else -+ H2C_Parameter[3] &= (~RAINFO_NOISY_STATE); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, ("[RSSIMonitorCheckMP] H2C_Parameter=%x\n", H2C_Parameter[3])); -+ } -+ -+ H2C_Parameter[2] = (u1Byte)(pHalData->UndecoratedSmoothedPWDB & 0xFF); -+ /*H2C_Parameter[1] = 0x20;*/ /* fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1*/ -+ H2C_Parameter[0] = WIN_DEFAULT_PORT_MACID; /* fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1*/ -+ -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); -+ } -+ -+ // BT 3.0 HS mode Rssi -+ if (pDM_Odm->bBtHsOperation) { -+ H2C_Parameter[2] = pDM_Odm->btHsRssi; -+ //H2C_Parameter[1] = 0x0; -+ H2C_Parameter[0] = WIN_BT_PORT_MACID; -+ -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); -+ } -+ } else -+ PlatformEFIOWrite1Byte(Adapter, 0x4fe, (u1Byte)pHalData->UndecoratedSmoothedPWDB); -+ -+ if ((pDM_Odm->SupportICType == ODM_RTL8812) || (pDM_Odm->SupportICType == ODM_RTL8192E)) -+ odm_RSSIDumpToRegister(pDM_Odm); -+ -+ -+ { -+ PADAPTER pLoopAdapter = GetDefaultAdapter(Adapter); -+ BOOLEAN default_pointer_value, *pbLink_temp = &default_pointer_value; -+ s4Byte GlobalRSSI_min = 0xFF, LocalRSSI_Min; -+ BOOLEAN bLink = FALSE; -+ -+ while (pLoopAdapter) { -+ LocalRSSI_Min = phydm_FindMinimumRSSI(pDM_Odm, pLoopAdapter, pbLink_temp); -+ //DbgPrint("pHalData->bLinked=%d, LocalRSSI_Min=%d\n", pHalData->bLinked, LocalRSSI_Min); -+ -+ if (*pbLink_temp) -+ bLink = TRUE; -+ -+ if ((LocalRSSI_Min < GlobalRSSI_min) && (*pbLink_temp)) -+ GlobalRSSI_min = LocalRSSI_Min; -+ -+ pLoopAdapter = GetNextExtAdapter(pLoopAdapter); -+ } -+ -+ pHalData->bLinked = bLink; -+ ODM_CmnInfoUpdate(&pHalData->DM_OutSrc , ODM_CMNINFO_LINK, (u8Byte)bLink); -+ -+ if (bLink) -+ ODM_CmnInfoUpdate(&pHalData->DM_OutSrc, ODM_CMNINFO_RSSI_MIN, (u8Byte)GlobalRSSI_min); -+ else -+ ODM_CmnInfoUpdate(&pHalData->DM_OutSrc, ODM_CMNINFO_RSSI_MIN, 0); -+ -+ } -+ -+#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+/*H2C_RSSI_REPORT*/ -+s8 phydm_rssi_report(PDM_ODM_T pDM_Odm, u8 mac_id) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 H2C_Parameter[H2C_0X42_LENGTH] = {0}; -+ u8 UL_DL_STATE = 0, STBC_TX = 0, TxBF_EN = 0; -+ u8 cmdlen = H2C_0X42_LENGTH, first_connect = _FALSE; -+ u64 curTxOkCnt = 0, curRxOkCnt = 0; -+ PSTA_INFO_T pEntry = pDM_Odm->pODM_StaInfo[mac_id]; -+ -+ if (!IS_STA_VALID(pEntry)) -+ return _FAIL; -+ -+ if (mac_id != pEntry->mac_id) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s mac_id:%u:%u invalid\n", __func__, mac_id, pEntry->mac_id)); -+ rtw_warn_on(1); -+ return _FAIL; -+ } -+ -+ if (IS_MCAST(pEntry->hwaddr)) /*if(psta->mac_id ==1)*/ -+ return _FAIL; -+ -+ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB == (-1)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s mac_id:%u, mac:"MAC_FMT", rssi == -1\n", __func__, pEntry->mac_id, MAC_ARG(pEntry->hwaddr))); -+ return _FAIL; -+ } -+ -+ curTxOkCnt = pdvobjpriv->traffic_stat.cur_tx_bytes; -+ curRxOkCnt = pdvobjpriv->traffic_stat.cur_rx_bytes; -+ if (curRxOkCnt > (curTxOkCnt * 6)) -+ UL_DL_STATE = 1; -+ else -+ UL_DL_STATE = 0; -+ -+ #ifdef CONFIG_BEAMFORMING -+ { -+ #if (BEAMFORMING_SUPPORT == 1) -+ BEAMFORMING_CAP Beamform_cap = phydm_Beamforming_GetEntryBeamCapByMacId(pDM_Odm, pEntry->mac_id); -+ #else/*for drv beamforming*/ -+ BEAMFORMING_CAP Beamform_cap = beamforming_get_entry_beam_cap_by_mac_id(&Adapter->mlmepriv, pEntry->mac_id); -+ #endif -+ -+ if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) -+ TxBF_EN = 1; -+ else -+ TxBF_EN = 0; -+ } -+ #endif /*#ifdef CONFIG_BEAMFORMING*/ -+ -+ if (TxBF_EN) -+ STBC_TX = 0; -+ else { -+ #ifdef CONFIG_80211AC_VHT -+ if (IsSupportedVHT(pEntry->wireless_mode)) -+ STBC_TX = TEST_FLAG(pEntry->vhtpriv.stbc_cap, STBC_VHT_ENABLE_TX); -+ else -+ #endif -+ #ifdef CONFIG_80211N_HT -+ STBC_TX = TEST_FLAG(pEntry->htpriv.stbc_cap, STBC_HT_ENABLE_TX); -+ #endif -+ } -+ -+ H2C_Parameter[0] = (u8)(pEntry->mac_id & 0xFF); -+ H2C_Parameter[2] = pEntry->rssi_stat.UndecoratedSmoothedPWDB & 0x7F; -+ -+ if (UL_DL_STATE) -+ H2C_Parameter[3] |= RAINFO_BE_RX_STATE; -+ -+ if (TxBF_EN) -+ H2C_Parameter[3] |= RAINFO_BF_STATE; -+ if (STBC_TX) -+ H2C_Parameter[3] |= RAINFO_STBC_STATE; -+ if (pDM_Odm->NoisyDecision) -+ H2C_Parameter[3] |= RAINFO_NOISY_STATE; -+ -+ if ((pEntry->ra_rpt_linked == _FALSE) && (pEntry->rssi_stat.bsend_rssi == RA_RSSI_STATE_SEND)) { -+ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; -+ pEntry->ra_rpt_linked = _TRUE; -+ pEntry->rssi_stat.bsend_rssi = RA_RSSI_STATE_HOLD; -+ first_connect = _TRUE; -+ } -+ -+ H2C_Parameter[4] = (pRA_Table->RA_threshold_offset & 0x7f) | (pRA_Table->RA_offset_direction<<7); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")), pRA_Table->RA_threshold_offset)); -+ -+ #if 1 -+ if (first_connect) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s mac_id:%u, mac:"MAC_FMT", rssi:%d\n", __func__, -+ pEntry->mac_id, MAC_ARG(pEntry->hwaddr), pEntry->rssi_stat.UndecoratedSmoothedPWDB)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s RAINFO - TP:%s, TxBF:%s, STBC:%s, Noisy:%s, Firstcont:%s\n", __func__, -+ (UL_DL_STATE) ? "DL" : "UL", (TxBF_EN) ? "EN" : "DIS", (STBC_TX) ? "EN" : "DIS", -+ (pDM_Odm->NoisyDecision) ? "True" : "False", (first_connect) ? "True" : "False")); -+ } -+ #endif -+ -+ if (pHalData->fw_ractrl == _TRUE) { -+ #if (RTL8188E_SUPPORT == 1) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ cmdlen = 3; -+ #endif -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); -+ } else { -+ #if ((RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1)) -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ ODM_RA_SetRSSI_8188E(pDM_Odm, (u8)(pEntry->mac_id & 0xFF), pEntry->rssi_stat.UndecoratedSmoothedPWDB & 0x7F); -+ #endif -+ } -+ return _SUCCESS; -+} -+ -+void phydm_ra_rssi_rpt_wk_hdl(PVOID pContext) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pContext; -+ int i; -+ u8 mac_id = 0xFF; -+ PSTA_INFO_T pEntry = NULL; -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ pEntry = pDM_Odm->pODM_StaInfo[i]; -+ if (IS_STA_VALID(pEntry)) { -+ if (IS_MCAST(pEntry->hwaddr)) /*if(psta->mac_id ==1)*/ -+ continue; -+ if (pEntry->ra_rpt_linked == _FALSE) { -+ mac_id = i; -+ break; -+ } -+ } -+ } -+ if (mac_id != 0xFF) -+ phydm_rssi_report(pDM_Odm, mac_id); -+} -+void phydm_ra_rssi_rpt_wk(PVOID pContext) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pContext; -+ -+ rtw_run_in_thread_cmd(pDM_Odm->Adapter, phydm_ra_rssi_rpt_wk_hdl, pDM_Odm); -+} -+#endif -+ -+VOID -+odm_RSSIMonitorCheckCE( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PSTA_INFO_T pEntry; -+ int i; -+ int tmpEntryMaxPWDB = 0, tmpEntryMinPWDB = 0xff; -+ u8 sta_cnt = 0; -+ -+ if (pDM_Odm->bLinked != _TRUE) -+ return; -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ pEntry = pDM_Odm->pODM_StaInfo[i]; -+ if (IS_STA_VALID(pEntry)) { -+ if (IS_MCAST(pEntry->hwaddr)) /*if(psta->mac_id ==1)*/ -+ continue; -+ -+ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB == (-1)) -+ continue; -+ -+ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB) -+ tmpEntryMinPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB) -+ tmpEntryMaxPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ if (phydm_rssi_report(pDM_Odm, i)) -+ sta_cnt++; -+ } -+ } -+ -+ if (tmpEntryMaxPWDB != 0) // If associated entry is found -+ pHalData->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB; -+ else -+ pHalData->EntryMaxUndecoratedSmoothedPWDB = 0; -+ -+ if (tmpEntryMinPWDB != 0xff) // If associated entry is found -+ pHalData->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB; -+ else -+ pHalData->EntryMinUndecoratedSmoothedPWDB = 0; -+ -+ FindMinimumRSSI(Adapter);//get pdmpriv->MinUndecoratedPWDBForDM -+ -+ pDM_Odm->RSSI_Min = pHalData->MinUndecoratedPWDBForDM; -+ //ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); -+#endif//if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+} -+ -+ -+VOID -+odm_RSSIMonitorCheckAP( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+#if (RTL8812A_SUPPORT || RTL8881A_SUPPORT || RTL8192E_SUPPORT || RTL8814A_SUPPORT || RTL8197F_SUPPORT) -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u1Byte H2C_Parameter[H2C_0X42_LENGTH] = {0}; -+ u4Byte i; -+ BOOLEAN bExtRAInfo = TRUE; -+ u1Byte cmdlen = H2C_0X42_LENGTH; -+ u1Byte TxBF_EN = 0, stbc_en = 0; -+ -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ PSTA_INFO_T pstat; -+ BOOLEAN act_bfer = FALSE; -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ u1Byte Idx=0xff; -+#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -+ pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; -+ pDM_BdcTable->num_Txbfee_Client = 0; -+ pDM_BdcTable->num_Txbfer_Client = 0; -+#endif -+#endif -+ if (!pDM_Odm->H2C_RARpt_connect && (priv->up_time % 2)) -+ return; -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+ bExtRAInfo = FALSE; -+ cmdlen = 3; -+ } -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ pstat = pDM_Odm->pODM_StaInfo[i]; -+ -+ if (IS_STA_VALID(pstat)) { -+ if (pstat->sta_in_firmware != 1) -+ continue; -+ -+ //2 BF_en -+ #if (BEAMFORMING_SUPPORT == 1) -+ BEAMFORMING_CAP Beamform_cap = Beamforming_GetEntryBeamCapByMacId(priv, pstat->aid); -+ PRT_BEAMFORMING_ENTRY pEntry = Beamforming_GetEntryByMacId(priv, pstat->aid, &Idx); -+ -+ if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { -+ -+ if (pEntry->Sounding_En) -+ TxBF_EN = 1; -+ else -+ TxBF_EN = 0; -+ -+ act_bfer = TRUE; -+ } -+ -+ #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) /*BDC*/ -+ if (act_bfer == TRUE) { -+ pDM_BdcTable->w_BFee_Client[i] = 1; //AP act as BFer -+ pDM_BdcTable->num_Txbfee_Client++; -+ } else { -+ pDM_BdcTable->w_BFee_Client[i] = 0; //AP act as BFer -+ } -+ -+ if ((Beamform_cap & BEAMFORMEE_CAP_HT_EXPLICIT) || (Beamform_cap & BEAMFORMEE_CAP_VHT_SU)) { -+ pDM_BdcTable->w_BFer_Client[i] = 1; //AP act as BFee -+ pDM_BdcTable->num_Txbfer_Client++; -+ } else { -+ pDM_BdcTable->w_BFer_Client[i] = 0; //AP act as BFer -+ } -+ #endif -+ #endif -+ -+ //2 STBC_en -+ if ((priv->pmib->dot11nConfigEntry.dot11nSTBC) && -+ ((pstat->ht_cap_buf.ht_cap_info & cpu_to_le16(_HTCAP_RX_STBC_CAP_)) -+ #ifdef RTK_AC_SUPPORT -+ || (pstat->vht_cap_buf.vht_cap_info & cpu_to_le32(_VHTCAP_RX_STBC_CAP_)) -+ #endif -+ )) -+ stbc_en = 1; -+ -+ //2 RAINFO -+ -+ H2C_Parameter[4] = (pRA_Table->RA_threshold_offset & 0x7f) | (pRA_Table->RA_offset_direction<<7); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")), pRA_Table->RA_threshold_offset)); -+ -+ if (bExtRAInfo) { -+ if ((pstat->rx_avarage) > ((pstat->tx_avarage) * 6)) -+ H2C_Parameter[3] |= RAINFO_BE_RX_STATE; -+ -+ if (TxBF_EN) -+ H2C_Parameter[3] |= RAINFO_BF_STATE; -+ else { -+ if (stbc_en) -+ H2C_Parameter[3] |= RAINFO_STBC_STATE; -+ } -+ -+ if (pDM_Odm->NoisyDecision) -+ H2C_Parameter[3] |= RAINFO_NOISY_STATE; -+ else -+ H2C_Parameter[3] &= (~RAINFO_NOISY_STATE); -+ -+ if (pstat->H2C_rssi_rpt) { -+ H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[RA Init] set Init rate by RSSI, STA %d\n", pstat->aid)); -+ } -+ -+ /*ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[RAINFO] H2C_Para[3] = %x\n",H2C_Parameter[3]));*/ -+ } -+ -+ H2C_Parameter[2] = (u1Byte)(pstat->rssi & 0xFF); -+ H2C_Parameter[0] = REMAP_AID(pstat); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("H2C_Parameter[3]=%d\n", H2C_Parameter[3])); -+ -+ //ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[RSSI] H2C_Para[2] = %x, \n",H2C_Parameter[2])); -+ //ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[MACID] H2C_Para[0] = %x, \n",H2C_Parameter[0])); -+ -+ ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); -+ -+ } -+ } -+ -+#endif -+#endif -+ -+} -+ -+VOID -+odm_RSSIMonitorCheck( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)) -+ return; -+ -+ switch (pDM_Odm->SupportPlatform) { -+ case ODM_WIN: -+ odm_RSSIMonitorCheckMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_RSSIMonitorCheckCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ odm_RSSIMonitorCheckAP(pDM_Odm); -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+VOID -+odm_RateAdaptiveMaskInit( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_RATE_ADAPTIVE pOdmRA = &pDM_Odm->RateAdaptive; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMGNT_INFO pMgntInfo = &pDM_Odm->Adapter->MgntInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -+ -+ pMgntInfo->Ratr_State = DM_RATR_STA_INIT; -+ -+ if (pMgntInfo->DM_Type == DM_Type_ByDriver) -+ pHalData->bUseRAMask = TRUE; -+ else -+ pHalData->bUseRAMask = FALSE; -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ pOdmRA->Type = DM_Type_ByDriver; -+ if (pOdmRA->Type == DM_Type_ByDriver) -+ pDM_Odm->bUseRAMask = _TRUE; -+ else -+ pDM_Odm->bUseRAMask = _FALSE; -+#endif -+ -+ pOdmRA->RATRState = DM_RATR_STA_INIT; -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ pOdmRA->LdpcThres = 50; -+ else -+ pOdmRA->LdpcThres = 35; -+ -+ pOdmRA->RtsThres = 35; -+ -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ pOdmRA->LdpcThres = 35; -+ pOdmRA->bUseLdpc = FALSE; -+ -+#else -+ pOdmRA->UltraLowRSSIThresh = 9; -+ -+#endif -+ -+ pOdmRA->HighRSSIThresh = 50; -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && \ -+ ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+ pOdmRA->LowRSSIThresh = 23; -+#else -+ pOdmRA->LowRSSIThresh = 20; -+#endif -+} -+/*----------------------------------------------------------------------------- -+ * Function: odm_RefreshRateAdaptiveMask() -+ * -+ * Overview: Update rate table mask according to rssi -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 05/27/2009 hpfan Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+VOID -+odm_RefreshRateAdaptiveMask( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (!pDM_Odm->bLinked) -+ return; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_RA_MASK)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("odm_RefreshRateAdaptiveMask(): Return cos not supported\n")); -+ return; -+ } -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ switch (pDM_Odm->SupportPlatform) { -+ case ODM_WIN: -+ odm_RefreshRateAdaptiveMaskMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_RefreshRateAdaptiveMaskCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ odm_RefreshRateAdaptiveMaskAPADSL(pDM_Odm); -+ break; -+ } -+ -+} -+ -+u1Byte -+phydm_trans_platform_bw( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW -+) -+{ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (BW == CHANNEL_WIDTH_20) -+ BW = PHYDM_BW_20; -+ -+ else if (BW == CHANNEL_WIDTH_40) -+ BW = PHYDM_BW_40; -+ -+ else if (BW == CHANNEL_WIDTH_80) -+ BW = PHYDM_BW_80; -+ -+ else if (BW == CHANNEL_WIDTH_160) -+ BW = PHYDM_BW_160; -+ -+ else if (BW == CHANNEL_WIDTH_80_80) -+ BW = PHYDM_BW_80_80; -+ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ if (BW == HT_CHANNEL_WIDTH_20) -+ BW = PHYDM_BW_20; -+ -+ else if (BW == HT_CHANNEL_WIDTH_20_40) -+ BW = PHYDM_BW_40; -+ -+ else if (BW == HT_CHANNEL_WIDTH_80) -+ BW = PHYDM_BW_80; -+ -+ else if (BW == HT_CHANNEL_WIDTH_160) -+ BW = PHYDM_BW_160; -+ -+ else if (BW == HT_CHANNEL_WIDTH_10) -+ BW = PHYDM_BW_10; -+ -+ else if (BW == HT_CHANNEL_WIDTH_5) -+ BW = PHYDM_BW_5; -+ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+ if (BW == CHANNEL_WIDTH_20) -+ BW = PHYDM_BW_20; -+ -+ else if (BW == CHANNEL_WIDTH_40) -+ BW = PHYDM_BW_40; -+ -+ else if (BW == CHANNEL_WIDTH_80) -+ BW = PHYDM_BW_80; -+ -+ else if (BW == CHANNEL_WIDTH_160) -+ BW = PHYDM_BW_160; -+ -+ else if (BW == CHANNEL_WIDTH_80_80) -+ BW = PHYDM_BW_80_80; -+ #endif -+ -+ return BW; -+ -+} -+ -+u1Byte -+phydm_trans_platform_rf_type( -+ IN PVOID pDM_VOID, -+ IN u1Byte RfType -+) -+{ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (RfType == RF_1T2R) -+ RfType = PHYDM_RF_1T2R; -+ -+ else if (RfType == RF_2T4R) -+ RfType = PHYDM_RF_2T4R; -+ -+ else if (RfType == RF_2T2R) -+ RfType = PHYDM_RF_2T2R; -+ -+ else if (RfType == RF_1T1R) -+ RfType = PHYDM_RF_1T1R; -+ -+ else if (RfType == RF_2T2R_GREEN) -+ RfType = PHYDM_RF_2T2R_GREEN; -+ -+ else if (RfType == RF_3T3R) -+ RfType = PHYDM_RF_3T3R; -+ -+ else if (RfType == RF_4T4R) -+ RfType = PHYDM_RF_4T4R; -+ -+ else if (RfType == RF_2T3R) -+ RfType = PHYDM_RF_1T2R; -+ -+ else if (RfType == RF_3T4R) -+ RfType = PHYDM_RF_3T4R; -+ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ if (RfType == MIMO_1T2R) -+ RfType = PHYDM_RF_1T2R; -+ -+ else if (RfType == MIMO_2T4R) -+ RfType = PHYDM_RF_2T4R; -+ -+ else if (RfType == MIMO_2T2R) -+ RfType = PHYDM_RF_2T2R; -+ -+ else if (RfType == MIMO_1T1R) -+ RfType = PHYDM_RF_1T1R; -+ -+ else if (RfType == MIMO_3T3R) -+ RfType = PHYDM_RF_3T3R; -+ -+ else if (RfType == MIMO_4T4R) -+ RfType = PHYDM_RF_4T4R; -+ -+ else if (RfType == MIMO_2T3R) -+ RfType = PHYDM_RF_1T2R; -+ -+ else if (RfType == MIMO_3T4R) -+ RfType = PHYDM_RF_3T4R; -+ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+ if (RfType == RF_1T2R) -+ RfType = PHYDM_RF_1T2R; -+ -+ else if (RfType == RF_2T4R) -+ RfType = PHYDM_RF_2T4R; -+ -+ else if (RfType == RF_2T2R) -+ RfType = PHYDM_RF_2T2R; -+ -+ else if (RfType == RF_1T1R) -+ RfType = PHYDM_RF_1T1R; -+ -+ else if (RfType == RF_2T2R_GREEN) -+ RfType = PHYDM_RF_2T2R_GREEN; -+ -+ else if (RfType == RF_3T3R) -+ RfType = PHYDM_RF_3T3R; -+ -+ else if (RfType == RF_4T4R) -+ RfType = PHYDM_RF_4T4R; -+ -+ else if (RfType == RF_2T3R) -+ RfType = PHYDM_RF_1T2R; -+ -+ else if (RfType == RF_3T4R) -+ RfType = PHYDM_RF_3T4R; -+ -+ #endif -+ -+ return RfType; -+ -+} -+ -+u4Byte -+phydm_trans_platform_wireless_mode( -+ IN PVOID pDM_VOID, -+ IN u4Byte wireless_mode -+) -+{ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+ if (wireless_mode == WIRELESS_11A) -+ wireless_mode = PHYDM_WIRELESS_MODE_A; -+ -+ else if (wireless_mode == WIRELESS_11B) -+ wireless_mode = PHYDM_WIRELESS_MODE_B; -+ -+ else if ((wireless_mode == WIRELESS_11G) || (wireless_mode == WIRELESS_11BG)) -+ wireless_mode = PHYDM_WIRELESS_MODE_G; -+ -+ else if (wireless_mode == WIRELESS_AUTO) -+ wireless_mode = PHYDM_WIRELESS_MODE_AUTO; -+ -+ else if ((wireless_mode == WIRELESS_11_24N) || (wireless_mode == WIRELESS_11G_24N) || (wireless_mode == WIRELESS_11B_24N) || -+ (wireless_mode == WIRELESS_11BG_24N) || (wireless_mode == WIRELESS_MODE_24G) || (wireless_mode == WIRELESS_11ABGN) || (wireless_mode == WIRELESS_11AGN)) -+ wireless_mode = PHYDM_WIRELESS_MODE_N_24G; -+ -+ else if ((wireless_mode == WIRELESS_11_5N) || (wireless_mode == WIRELESS_11A_5N)) -+ wireless_mode = PHYDM_WIRELESS_MODE_N_5G; -+ -+ else if ((wireless_mode == WIRELESS_11AC) || (wireless_mode == WIRELESS_11_5AC) || (wireless_mode == WIRELESS_MODE_5G)) -+ wireless_mode = PHYDM_WIRELESS_MODE_AC_5G; -+ -+ else if (wireless_mode == WIRELESS_11_24AC) -+ wireless_mode = PHYDM_WIRELESS_MODE_AC_24G; -+ -+ else if (wireless_mode == WIRELESS_11AC) -+ wireless_mode = PHYDM_WIRELESS_MODE_AC_ONLY; -+ -+ else if (wireless_mode == WIRELESS_MODE_MAX) -+ wireless_mode = PHYDM_WIRELESS_MODE_MAX; -+ else -+ wireless_mode = PHYDM_WIRELESS_MODE_UNKNOWN; -+ #endif -+ -+ return wireless_mode; -+ -+} -+ -+u1Byte -+phydm_vht_en_mapping( -+ IN PVOID pDM_VOID, -+ IN u4Byte WirelessMode -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte vht_en_out = 0; -+ -+ if ((WirelessMode == PHYDM_WIRELESS_MODE_AC_5G) || -+ (WirelessMode == PHYDM_WIRELESS_MODE_AC_24G) || -+ (WirelessMode == PHYDM_WIRELESS_MODE_AC_ONLY) -+ ) { -+ vht_en_out = 1; -+ /**/ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("WirelessMode= (( 0x%x )), VHT_EN= (( %d ))\n", WirelessMode, vht_en_out)); -+ return vht_en_out; -+} -+ -+u1Byte -+phydm_rate_id_mapping( -+ IN PVOID pDM_VOID, -+ IN u4Byte WirelessMode, -+ IN u1Byte RfType, -+ IN u1Byte bw -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte rate_id_idx = 0; -+ u1Byte phydm_BW; -+ u1Byte phydm_RfType; -+ -+ phydm_BW = phydm_trans_platform_bw(pDM_Odm, bw); -+ phydm_RfType = phydm_trans_platform_rf_type(pDM_Odm, RfType); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ WirelessMode = phydm_trans_platform_wireless_mode(pDM_Odm, WirelessMode); -+ #endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("wirelessMode= (( 0x%x )), RfType = (( 0x%x )), BW = (( 0x%x ))\n", -+ WirelessMode, phydm_RfType, phydm_BW)); -+ -+ -+ switch (WirelessMode) { -+ -+ case PHYDM_WIRELESS_MODE_N_24G: -+ { -+ -+ if (phydm_BW == PHYDM_BW_40) { -+ -+ if (phydm_RfType == PHYDM_RF_1T1R) -+ rate_id_idx = PHYDM_BGN_40M_1SS; -+ else if (phydm_RfType == PHYDM_RF_2T2R) -+ rate_id_idx = PHYDM_BGN_40M_2SS; -+ else -+ rate_id_idx = PHYDM_ARFR5_N_3SS; -+ -+ } else { -+ -+ if (phydm_RfType == PHYDM_RF_1T1R) -+ rate_id_idx = PHYDM_BGN_20M_1SS; -+ else if (phydm_RfType == PHYDM_RF_2T2R) -+ rate_id_idx = PHYDM_BGN_20M_2SS; -+ else -+ rate_id_idx = PHYDM_ARFR5_N_3SS; -+ } -+ } -+ break; -+ -+ case PHYDM_WIRELESS_MODE_N_5G: -+ { -+ if (phydm_RfType == PHYDM_RF_1T1R) -+ rate_id_idx = PHYDM_GN_N1SS; -+ else if (phydm_RfType == PHYDM_RF_2T2R) -+ rate_id_idx = PHYDM_GN_N2SS; -+ else -+ rate_id_idx = PHYDM_ARFR5_N_3SS; -+ } -+ -+ break; -+ -+ case PHYDM_WIRELESS_MODE_G: -+ rate_id_idx = PHYDM_BG; -+ break; -+ -+ case PHYDM_WIRELESS_MODE_A: -+ rate_id_idx = PHYDM_G; -+ break; -+ -+ case PHYDM_WIRELESS_MODE_B: -+ rate_id_idx = PHYDM_B_20M; -+ break; -+ -+ -+ case PHYDM_WIRELESS_MODE_AC_5G: -+ case PHYDM_WIRELESS_MODE_AC_ONLY: -+ { -+ if (phydm_RfType == PHYDM_RF_1T1R) -+ rate_id_idx = PHYDM_ARFR1_AC_1SS; -+ else if (phydm_RfType == PHYDM_RF_2T2R) -+ rate_id_idx = PHYDM_ARFR0_AC_2SS; -+ else -+ rate_id_idx = PHYDM_ARFR4_AC_3SS; -+ } -+ break; -+ -+ case PHYDM_WIRELESS_MODE_AC_24G: -+ { -+ /*Becareful to set "Lowest rate" while using PHYDM_ARFR4_AC_3SS in 2.4G/5G*/ -+ if (phydm_BW >= PHYDM_BW_80) { -+ if (phydm_RfType == PHYDM_RF_1T1R) -+ rate_id_idx = PHYDM_ARFR1_AC_1SS; -+ else if (phydm_RfType == PHYDM_RF_2T2R) -+ rate_id_idx = PHYDM_ARFR0_AC_2SS; -+ else -+ rate_id_idx = PHYDM_ARFR4_AC_3SS; -+ } else { -+ -+ if (phydm_RfType == PHYDM_RF_1T1R) -+ rate_id_idx = PHYDM_ARFR2_AC_2G_1SS; -+ else if (phydm_RfType == PHYDM_RF_2T2R) -+ rate_id_idx = PHYDM_ARFR3_AC_2G_2SS; -+ else -+ rate_id_idx = PHYDM_ARFR4_AC_3SS; -+ } -+ } -+ break; -+ -+ default: -+ rate_id_idx = 0; -+ break; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA Rate ID = (( 0x%d ))\n", rate_id_idx)); -+ -+ return rate_id_idx; -+} -+ -+VOID -+phydm_UpdateHalRAMask( -+ IN PVOID pDM_VOID, -+ IN u4Byte wirelessMode, -+ IN u1Byte RfType, -+ IN u1Byte BW, -+ IN u1Byte MimoPs_enable, -+ IN u1Byte disable_cck_rate, -+ IN u4Byte *ratr_bitmap_msb_in, -+ IN u4Byte *ratr_bitmap_lsb_in, -+ IN u1Byte tx_rate_level -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte mask_rate_threshold; -+ u1Byte phydm_RfType; -+ u1Byte phydm_BW; -+ u4Byte ratr_bitmap = *ratr_bitmap_lsb_in, ratr_bitmap_msb = *ratr_bitmap_msb_in; -+ /*PODM_RATE_ADAPTIVE pRA = &(pDM_Odm->RateAdaptive);*/ -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ wirelessMode = phydm_trans_platform_wireless_mode(pDM_Odm, wirelessMode); -+ #endif -+ -+ phydm_RfType = phydm_trans_platform_rf_type(pDM_Odm, RfType); -+ phydm_BW = phydm_trans_platform_bw(pDM_Odm, BW); -+ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("phydm_RfType = (( %x )), RfType = (( %x ))\n", phydm_RfType, RfType));*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Platfoem original RA Mask = (( 0x %x | %x ))\n", ratr_bitmap_msb, ratr_bitmap)); -+ -+ switch (wirelessMode) { -+ -+ case PHYDM_WIRELESS_MODE_B: -+ { -+ ratr_bitmap &= 0x0000000f; -+ } -+ break; -+ -+ case PHYDM_WIRELESS_MODE_G: -+ { -+ ratr_bitmap &= 0x00000ff5; -+ } -+ break; -+ -+ case PHYDM_WIRELESS_MODE_A: -+ { -+ ratr_bitmap &= 0x00000ff0; -+ } -+ break; -+ -+ case PHYDM_WIRELESS_MODE_N_24G: -+ case PHYDM_WIRELESS_MODE_N_5G: -+ { -+ if (MimoPs_enable) -+ phydm_RfType = PHYDM_RF_1T1R; -+ -+ if (phydm_RfType == PHYDM_RF_1T1R) { -+ -+ if (phydm_BW == PHYDM_BW_40) -+ ratr_bitmap &= 0x000ff015; -+ else -+ ratr_bitmap &= 0x000ff005; -+ } else if (phydm_RfType == PHYDM_RF_2T2R || phydm_RfType == PHYDM_RF_2T4R || phydm_RfType == PHYDM_RF_2T3R) { -+ -+ if (phydm_BW == PHYDM_BW_40) -+ ratr_bitmap &= 0x0ffff015; -+ else -+ ratr_bitmap &= 0x0ffff005; -+ } else { /*3T*/ -+ -+ ratr_bitmap &= 0xfffff015; -+ ratr_bitmap_msb &= 0xf; -+ } -+ } -+ break; -+ -+ case PHYDM_WIRELESS_MODE_AC_24G: -+ { -+ if (phydm_RfType == PHYDM_RF_1T1R) -+ ratr_bitmap &= 0x003ff015; -+ else if (phydm_RfType == PHYDM_RF_2T2R || phydm_RfType == PHYDM_RF_2T4R || phydm_RfType == PHYDM_RF_2T3R) -+ ratr_bitmap &= 0xfffff015; -+ else {/*3T*/ -+ -+ ratr_bitmap &= 0xfffff010; -+ ratr_bitmap_msb &= 0x3ff; -+ } -+ -+ if (phydm_BW == PHYDM_BW_20) {/* AC 20MHz doesn't support MCS9 */ -+ ratr_bitmap &= 0x7fdfffff; -+ ratr_bitmap_msb &= 0x1ff; -+ } -+ } -+ break; -+ -+ case PHYDM_WIRELESS_MODE_AC_5G: -+ { -+ if (phydm_RfType == PHYDM_RF_1T1R) -+ ratr_bitmap &= 0x003ff010; -+ else if (phydm_RfType == PHYDM_RF_2T2R || phydm_RfType == PHYDM_RF_2T4R || phydm_RfType == PHYDM_RF_2T3R) -+ ratr_bitmap &= 0xfffff010; -+ else {/*3T*/ -+ -+ ratr_bitmap &= 0xfffff010; -+ ratr_bitmap_msb &= 0x3ff; -+ } -+ -+ if (phydm_BW == PHYDM_BW_20) {/* AC 20MHz doesn't support MCS9 */ -+ ratr_bitmap &= 0x7fdfffff; -+ ratr_bitmap_msb &= 0x1ff; -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ if (wirelessMode != PHYDM_WIRELESS_MODE_B) { -+ -+ if (tx_rate_level == 0) -+ ratr_bitmap &= 0xffffffff; -+ else if (tx_rate_level == 1) -+ ratr_bitmap &= 0xfffffff0; -+ else if (tx_rate_level == 2) -+ ratr_bitmap &= 0xffffefe0; -+ else if (tx_rate_level == 3) -+ ratr_bitmap &= 0xffffcfc0; -+ else if (tx_rate_level == 4) -+ ratr_bitmap &= 0xffff8f80; -+ else if (tx_rate_level >= 5) -+ ratr_bitmap &= 0xffff0f00; -+ -+ } -+ -+ if (disable_cck_rate) -+ ratr_bitmap &= 0xfffffff0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("wirelessMode= (( 0x%x )), RfType = (( 0x%x )), BW = (( 0x%x )), MimoPs_en = (( %d )), tx_rate_level= (( 0x%d ))\n", -+ wirelessMode, phydm_RfType, phydm_BW, MimoPs_enable, tx_rate_level)); -+ -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("111 Phydm modified RA Mask = (( 0x %x | %x ))\n", ratr_bitmap_msb, ratr_bitmap));*/ -+ -+ *ratr_bitmap_lsb_in = ratr_bitmap; -+ *ratr_bitmap_msb_in = ratr_bitmap_msb; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Phydm modified RA Mask = (( 0x %x | %x ))\n", *ratr_bitmap_msb_in, *ratr_bitmap_lsb_in)); -+ -+} -+ -+u1Byte -+phydm_RA_level_decision( -+ IN PVOID pDM_VOID, -+ IN u4Byte rssi, -+ IN u1Byte Ratr_State -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte ra_lowest_rate; -+ u1Byte ra_rate_floor_table[RA_FLOOR_TABLE_SIZE] = {20, 34, 38, 42, 46, 50, 100}; /*MCS0 ~ MCS4 , VHT1SS MCS0 ~ MCS4 , G 6M~24M*/ -+ u1Byte new_Ratr_State = 0; -+ u1Byte i; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("curr RA level = ((%d)), Rate_floor_table ori [ %d , %d, %d , %d, %d, %d]\n", Ratr_State, -+ ra_rate_floor_table[0], ra_rate_floor_table[1], ra_rate_floor_table[2], ra_rate_floor_table[3], ra_rate_floor_table[4], ra_rate_floor_table[5])); -+ -+ for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { -+ -+ if (i >= (Ratr_State)) -+ ra_rate_floor_table[i] += RA_FLOOR_UP_GAP; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI = ((%d)), Rate_floor_table_mod [ %d , %d, %d , %d, %d, %d]\n", -+ rssi, ra_rate_floor_table[0], ra_rate_floor_table[1], ra_rate_floor_table[2], ra_rate_floor_table[3], ra_rate_floor_table[4], ra_rate_floor_table[5])); -+ -+ for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { -+ -+ if (rssi < ra_rate_floor_table[i]) { -+ new_Ratr_State = i; -+ break; -+ } -+ } -+ -+ -+ -+ return new_Ratr_State; -+ -+} -+ -+VOID -+odm_RefreshRateAdaptiveMaskMP( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ PADAPTER pTargetAdapter = NULL; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(pAdapter); -+ u4Byte i; -+ PSTA_INFO_T pEntry; -+ u1Byte Ratr_State_new; -+ -+ if (pAdapter->bDriverStopped) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_RefreshRateAdaptiveMask(): driver is going to unload\n")); -+ return; -+ } -+ -+ if (!pHalData->bUseRAMask) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_RefreshRateAdaptiveMask(): driver does not control rate adaptive mask\n")); -+ return; -+ } -+ -+ // if default port is connected, update RA table for default port (infrastructure mode only) -+ if (pMgntInfo->mAssoc && (!ACTING_AS_AP(pAdapter))) { -+ odm_RefreshLdpcRtsMP(pAdapter, pDM_Odm, pMgntInfo->mMacId, pMgntInfo->IOTPeer, pHalData->UndecoratedSmoothedPWDB); -+ /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Infrasture Mode\n"));*/ -+ -+ #if RA_MASK_PHYDMLIZE_WIN -+ Ratr_State_new = phydm_RA_level_decision(pDM_Odm, pHalData->UndecoratedSmoothedPWDB, pMgntInfo->Ratr_State); -+ -+ if (pMgntInfo->Ratr_State != Ratr_State_new) { -+ -+ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pMgntInfo->Bssid); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n\n", -+ pMgntInfo->Ratr_State, Ratr_State_new, pHalData->UndecoratedSmoothedPWDB)); -+ -+ pMgntInfo->Ratr_State = Ratr_State_new; -+ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, Ratr_State_new); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", Ratr_State_new)); -+ /**/ -+ } -+ -+ #else -+ if (ODM_RAStateCheck(pDM_Odm, pHalData->UndecoratedSmoothedPWDB, pMgntInfo->bSetTXPowerTrainingByOid, &pMgntInfo->Ratr_State)) { -+ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr : "), pMgntInfo->Bssid); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pHalData->UndecoratedSmoothedPWDB, pMgntInfo->Ratr_State)); -+ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, pMgntInfo->Ratr_State); -+ } else if (pDM_Odm->bChangeState) { -+ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr : "), pMgntInfo->Bssid); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training State, bDisablePowerTraining = %d\n", pDM_Odm->bDisablePowerTraining)); -+ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, pMgntInfo->Ratr_State); -+ } -+ #endif -+ } -+ -+ // -+ // The following part configure AP/VWifi/IBSS rate adaptive mask. -+ // -+ -+ if (pMgntInfo->mIbss) // Target: AP/IBSS peer. -+ pTargetAdapter = GetDefaultAdapter(pAdapter); -+ else -+ pTargetAdapter = GetFirstAPAdapter(pAdapter); -+ -+ // if extension port (softap) is started, updaet RA table for more than one clients associate -+ if (pTargetAdapter != NULL) { -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ -+ pEntry = AsocEntry_EnumStation(pTargetAdapter, i); -+ -+ if (IS_STA_VALID(pEntry)) { -+ -+ odm_RefreshLdpcRtsMP(pAdapter, pDM_Odm, pEntry->AssociatedMacId, pEntry->IOTPeer, pEntry->rssi_stat.UndecoratedSmoothedPWDB); -+ -+ #if RA_MASK_PHYDMLIZE_WIN -+ Ratr_State_new = phydm_RA_level_decision(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->Ratr_State); -+ -+ if (pEntry->Ratr_State != Ratr_State_new) { -+ -+ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pEntry->MacAddr); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", -+ pEntry->Ratr_State, Ratr_State_new, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); -+ -+ pEntry->Ratr_State = Ratr_State_new; -+ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pEntry->AssociatedMacId, NULL, Ratr_State_new); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", Ratr_State_new)); -+ /**/ -+ } -+ -+ -+ #else -+ -+ if (ODM_RAStateCheck(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, pMgntInfo->bSetTXPowerTrainingByOid, &pEntry->Ratr_State)) { -+ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), pEntry->MacAddr); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->Ratr_State)); -+ pAdapter->HalFunc.UpdateHalRAMaskHandler(pTargetAdapter, pEntry->AssociatedMacId, pEntry, pEntry->Ratr_State); -+ } else if (pDM_Odm->bChangeState) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training State, bDisablePowerTraining = %d\n", pDM_Odm->bDisablePowerTraining)); -+ pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, pMgntInfo->Ratr_State); -+ } -+ #endif -+ -+ } -+ } -+ } -+ -+ #if RA_MASK_PHYDMLIZE_WIN -+ -+ #else -+ if (pMgntInfo->bSetTXPowerTrainingByOid) -+ pMgntInfo->bSetTXPowerTrainingByOid = FALSE; -+ #endif -+#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+} -+ -+ -+VOID -+odm_RefreshRateAdaptiveMaskCE( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; -+ u4Byte i; -+ PSTA_INFO_T pEntry; -+ u1Byte Ratr_State_new; -+ -+ if (RTW_CANNOT_RUN(pAdapter)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_RefreshRateAdaptiveMask(): driver is going to unload\n")); -+ return; -+ } -+ -+ if (!pDM_Odm->bUseRAMask) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_RefreshRateAdaptiveMask(): driver does not control rate adaptive mask\n")); -+ return; -+ } -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ -+ pEntry = pDM_Odm->pODM_StaInfo[i]; -+ -+ if (IS_STA_VALID(pEntry)) { -+ -+ if (IS_MCAST(pEntry->hwaddr)) -+ continue; -+ -+ #if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -+ if ((pDM_Odm->SupportICType == ODM_RTL8812) || (pDM_Odm->SupportICType == ODM_RTL8821)) { -+ if (pEntry->rssi_stat.UndecoratedSmoothedPWDB < pRA->LdpcThres) { -+ pRA->bUseLdpc = TRUE; -+ pRA->bLowerRtsRate = TRUE; -+ if ((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->CutVersion == ODM_CUT_A)) -+ Set_RA_LDPC_8812(pEntry, TRUE); -+ //DbgPrint("RSSI=%d, bUseLdpc = TRUE\n", pHalData->UndecoratedSmoothedPWDB); -+ } else if (pEntry->rssi_stat.UndecoratedSmoothedPWDB > (pRA->LdpcThres - 5)) { -+ pRA->bUseLdpc = FALSE; -+ pRA->bLowerRtsRate = FALSE; -+ if ((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->CutVersion == ODM_CUT_A)) -+ Set_RA_LDPC_8812(pEntry, FALSE); -+ //DbgPrint("RSSI=%d, bUseLdpc = FALSE\n", pHalData->UndecoratedSmoothedPWDB); -+ } -+ } -+ #endif -+ -+ #if RA_MASK_PHYDMLIZE_CE -+ Ratr_State_new = phydm_RA_level_decision(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->rssi_level); -+ -+ if (pEntry->rssi_level != Ratr_State_new) { -+ -+ /*ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pstat->hwaddr);*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", -+ pEntry->rssi_level, Ratr_State_new, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); -+ -+ pEntry->rssi_level = Ratr_State_new; -+ rtw_hal_update_ra_mask(pEntry, pEntry->rssi_level); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", Ratr_State_new)); -+ /**/ -+ } -+ #else -+ if (TRUE == ODM_RAStateCheck(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, FALSE , &pEntry->rssi_level)) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->rssi_level)); -+ //printk("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi_stat.UndecoratedSmoothedPWDB, pstat->rssi_level); -+ rtw_hal_update_ra_mask(pEntry, pEntry->rssi_level); -+ } else if (pDM_Odm->bChangeState) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training State, bDisablePowerTraining = %d\n", pDM_Odm->bDisablePowerTraining)); -+ rtw_hal_update_ra_mask(pEntry, pEntry->rssi_level); -+ } -+ #endif -+ -+ } -+ } -+ -+#endif -+} -+ -+VOID -+odm_RefreshRateAdaptiveMaskAPADSL( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ struct rtl8192cd_priv *priv = pDM_Odm->priv; -+ struct aid_obj *aidarray; -+ u4Byte i; -+ PSTA_INFO_T pEntry; -+ u1Byte Ratr_State_new; -+ -+ if (priv->up_time % 2) -+ return; -+ -+ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { -+ pEntry = pDM_Odm->pODM_StaInfo[i]; -+ -+ if (IS_STA_VALID(pEntry)) { -+ -+ #if defined(UNIVERSAL_REPEATER) || defined(MBSSID) -+ aidarray = container_of(pEntry, struct aid_obj, station); -+ priv = aidarray->priv; -+ #endif -+ -+ if (!priv->pmib->dot11StationConfigEntry.autoRate) -+ continue; -+ -+#if RA_MASK_PHYDMLIZE_AP -+ Ratr_State_new = phydm_RA_level_decision(pDM_Odm, (u4Byte)pEntry->rssi, pEntry->rssi_level); -+ -+ if (pEntry->rssi_level != Ratr_State_new) { -+ -+ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pEntry->hwaddr); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", pEntry->rssi_level, Ratr_State_new, pEntry->rssi)); -+ -+ pEntry->rssi_level = Ratr_State_new; -+ phydm_gen_ramask_h2c_AP(pDM_Odm, priv, pEntry, pEntry->rssi_level); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", Ratr_State_new)); -+ /**/ -+ } -+ -+#else -+ if (ODM_RAStateCheck(pDM_Odm, (s4Byte)pEntry->rssi, FALSE, &pEntry->rssi_level)) { -+ ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), pEntry->hwaddr); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pEntry->rssi, pEntry->rssi_level)); -+ -+ #ifdef CONFIG_WLAN_HAL -+ if (IS_HAL_CHIP(priv)) { -+ #ifdef WDS -+ /*if(!(pstat->state & WIFI_WDS))*/ /*if WDS donot setting*/ -+ #endif -+ GET_HAL_INTERFACE(priv)->UpdateHalRAMaskHandler(priv, pEntry, pEntry->rssi_level); -+ } else -+ #endif -+ -+ #ifdef CONFIG_RTL_8812_SUPPORT -+ if (GET_CHIP_VER(priv) == VERSION_8812E) -+ UpdateHalRAMask8812(priv, pEntry, 3); -+ else -+ #endif -+ { -+ #ifdef CONFIG_RTL_88E_SUPPORT -+ if (GET_CHIP_VER(priv) == VERSION_8188E) { -+ #ifdef TXREPORT -+ add_RATid(priv, pEntry); -+ #endif -+ } -+ #endif -+ -+ -+ } -+ } -+#endif /*#ifdef RA_MASK_PHYDMLIZE*/ -+ -+ } -+ } -+#endif /*#if (DM_ODM_SUPPORT_TYPE & ODM_AP)*/ -+} -+ -+VOID -+odm_RefreshBasicRateMask( -+ IN PVOID pDM_VOID -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ static u1Byte Stage = 0; -+ u1Byte CurStage = 0; -+ OCTET_STRING osRateSet; -+ PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(Adapter); -+ u1Byte RateSet[5] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M, MGN_6M}; -+ -+ if (pDM_Odm->SupportICType != ODM_RTL8812 && pDM_Odm->SupportICType != ODM_RTL8821) -+ return; -+ -+ if (pDM_Odm->bLinked == FALSE) // unlink Default port information -+ CurStage = 0; -+ else if (pDM_Odm->RSSI_Min < 40) // link RSSI < 40% -+ CurStage = 1; -+ else if (pDM_Odm->RSSI_Min > 45) // link RSSI > 45% -+ CurStage = 3; -+ else -+ CurStage = 2; // link 25% <= RSSI <= 30% -+ -+ if (CurStage != Stage) { -+ if (CurStage == 1) { -+ FillOctetString(osRateSet, RateSet, 5); -+ FilterSupportRate(pMgntInfo->mBrates, &osRateSet, FALSE); -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_BASIC_RATE, (pu1Byte)&osRateSet); -+ } else if (CurStage == 3 && (Stage == 1 || Stage == 2)) -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_BASIC_RATE, (pu1Byte)(&pMgntInfo->mBrates)); -+ } -+ -+ Stage = CurStage; -+#endif -+} -+ -+u1Byte -+phydm_rate_order_compute( -+ IN PVOID pDM_VOID, -+ IN u1Byte rate_idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte rate_order = 0; -+ -+ if (rate_idx >= ODM_RATEVHTSS4MCS0) { -+ -+ rate_idx -= ODM_RATEVHTSS4MCS0; -+ /**/ -+ } else if (rate_idx >= ODM_RATEVHTSS3MCS0) { -+ -+ rate_idx -= ODM_RATEVHTSS3MCS0; -+ /**/ -+ } else if (rate_idx >= ODM_RATEVHTSS2MCS0) { -+ -+ rate_idx -= ODM_RATEVHTSS2MCS0; -+ /**/ -+ } else if (rate_idx >= ODM_RATEVHTSS1MCS0) { -+ -+ rate_idx -= ODM_RATEVHTSS1MCS0; -+ /**/ -+ } else if (rate_idx >= ODM_RATEMCS24) { -+ -+ rate_idx -= ODM_RATEMCS24; -+ /**/ -+ } else if (rate_idx >= ODM_RATEMCS16) { -+ -+ rate_idx -= ODM_RATEMCS16; -+ /**/ -+ } else if (rate_idx >= ODM_RATEMCS8) { -+ -+ rate_idx -= ODM_RATEMCS8; -+ /**/ -+ } -+ rate_order = rate_idx; -+ -+ return rate_order; -+ -+} -+ -+VOID -+phydm_ra_common_info_update( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ u2Byte macid; -+ u1Byte rate_order_tmp; -+ u1Byte cnt = 0; -+ -+ pRA_Table->highest_client_tx_order = 0; -+ pRA_Table->power_tracking_flag = 1; -+ -+ if (pDM_Odm->number_linked_client != 0) { -+ for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { -+ -+ rate_order_tmp = phydm_rate_order_compute(pDM_Odm, ((pRA_Table->link_tx_rate[macid]) & 0x7f)); -+ -+ if (rate_order_tmp >= (pRA_Table->highest_client_tx_order)) { -+ pRA_Table->highest_client_tx_order = rate_order_tmp; -+ pRA_Table->highest_client_tx_rate_order = macid; -+ } -+ -+ cnt++; -+ -+ if (cnt == pDM_Odm->number_linked_client) -+ break; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("MACID[%d], Highest Tx order Update for power traking: %d\n", (pRA_Table->highest_client_tx_rate_order), (pRA_Table->highest_client_tx_order))); -+ } -+} -+ -+VOID -+phydm_ra_info_watchdog( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ phydm_ra_common_info_update(pDM_Odm); -+ phydm_ra_dynamic_retry_limit(pDM_Odm); -+ phydm_ra_dynamic_retry_count(pDM_Odm); -+ odm_RefreshRateAdaptiveMask(pDM_Odm); -+ odm_RefreshBasicRateMask(pDM_Odm); -+} -+ -+VOID -+phydm_ra_info_init( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ pRA_Table->highest_client_tx_rate_order = 0; -+ pRA_Table->highest_client_tx_order = 0; -+ pRA_Table->RA_threshold_offset = 0; -+ pRA_Table->RA_offset_direction = 0; -+ -+ #if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) -+ phydm_ra_dynamic_retry_limit_init(pDM_Odm); -+ #endif -+ -+ #if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) -+ phydm_ra_dynamic_rate_id_init(pDM_Odm); -+ #endif -+ #if (defined(CONFIG_RA_DBG_CMD)) -+ odm_RA_ParaAdjust_init(pDM_Odm); -+ #endif -+ -+} -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+u1Byte -+odm_Find_RTS_Rate( -+ IN PVOID pDM_VOID, -+ IN u1Byte Tx_Rate, -+ IN BOOLEAN bErpProtect -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte RTS_Ini_Rate = ODM_RATE6M; -+ -+ if (bErpProtect) /* use CCK rate as RTS*/ -+ RTS_Ini_Rate = ODM_RATE1M; -+ else { -+ switch (Tx_Rate) { -+ case ODM_RATEVHTSS3MCS9: -+ case ODM_RATEVHTSS3MCS8: -+ case ODM_RATEVHTSS3MCS7: -+ case ODM_RATEVHTSS3MCS6: -+ case ODM_RATEVHTSS3MCS5: -+ case ODM_RATEVHTSS3MCS4: -+ case ODM_RATEVHTSS3MCS3: -+ case ODM_RATEVHTSS2MCS9: -+ case ODM_RATEVHTSS2MCS8: -+ case ODM_RATEVHTSS2MCS7: -+ case ODM_RATEVHTSS2MCS6: -+ case ODM_RATEVHTSS2MCS5: -+ case ODM_RATEVHTSS2MCS4: -+ case ODM_RATEVHTSS2MCS3: -+ case ODM_RATEVHTSS1MCS9: -+ case ODM_RATEVHTSS1MCS8: -+ case ODM_RATEVHTSS1MCS7: -+ case ODM_RATEVHTSS1MCS6: -+ case ODM_RATEVHTSS1MCS5: -+ case ODM_RATEVHTSS1MCS4: -+ case ODM_RATEVHTSS1MCS3: -+ case ODM_RATEMCS15: -+ case ODM_RATEMCS14: -+ case ODM_RATEMCS13: -+ case ODM_RATEMCS12: -+ case ODM_RATEMCS11: -+ case ODM_RATEMCS7: -+ case ODM_RATEMCS6: -+ case ODM_RATEMCS5: -+ case ODM_RATEMCS4: -+ case ODM_RATEMCS3: -+ case ODM_RATE54M: -+ case ODM_RATE48M: -+ case ODM_RATE36M: -+ case ODM_RATE24M: -+ RTS_Ini_Rate = ODM_RATE24M; -+ break; -+ case ODM_RATEVHTSS3MCS2: -+ case ODM_RATEVHTSS3MCS1: -+ case ODM_RATEVHTSS2MCS2: -+ case ODM_RATEVHTSS2MCS1: -+ case ODM_RATEVHTSS1MCS2: -+ case ODM_RATEVHTSS1MCS1: -+ case ODM_RATEMCS10: -+ case ODM_RATEMCS9: -+ case ODM_RATEMCS2: -+ case ODM_RATEMCS1: -+ case ODM_RATE18M: -+ case ODM_RATE12M: -+ RTS_Ini_Rate = ODM_RATE12M; -+ break; -+ case ODM_RATEVHTSS3MCS0: -+ case ODM_RATEVHTSS2MCS0: -+ case ODM_RATEVHTSS1MCS0: -+ case ODM_RATEMCS8: -+ case ODM_RATEMCS0: -+ case ODM_RATE9M: -+ case ODM_RATE6M: -+ RTS_Ini_Rate = ODM_RATE6M; -+ break; -+ case ODM_RATE11M: -+ case ODM_RATE5_5M: -+ case ODM_RATE2M: -+ case ODM_RATE1M: -+ RTS_Ini_Rate = ODM_RATE1M; -+ break; -+ default: -+ RTS_Ini_Rate = ODM_RATE6M; -+ break; -+ } -+ } -+ -+ if (*pDM_Odm->pBandType == 1) { -+ if (RTS_Ini_Rate < ODM_RATE6M) -+ RTS_Ini_Rate = ODM_RATE6M; -+ } -+ return RTS_Ini_Rate; -+ -+} -+ -+VOID -+odm_Set_RA_DM_ARFB_by_Noisy( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if 0 -+ -+ /*DbgPrint("DM_ARFB ====>\n");*/ -+ if (pDM_Odm->bNoisyState) { -+ ODM_Write4Byte(pDM_Odm, 0x430, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0x434, 0x05040200); -+ /*DbgPrint("DM_ARFB ====> Noisy State\n");*/ -+ } else { -+ ODM_Write4Byte(pDM_Odm, 0x430, 0x02010000); -+ ODM_Write4Byte(pDM_Odm, 0x434, 0x07050403); -+ /*DbgPrint("DM_ARFB ====> Clean State\n");*/ -+ } -+#endif -+} -+ -+VOID -+ODM_UpdateNoisyState( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN bNoisyStateFromC2H -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ /*DbgPrint("Get C2H Command! NoisyState=0x%x\n ", bNoisyStateFromC2H);*/ -+ if (pDM_Odm->SupportICType == ODM_RTL8821 || pDM_Odm->SupportICType == ODM_RTL8812 || -+ pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723D) -+ pDM_Odm->bNoisyState = bNoisyStateFromC2H; -+ odm_Set_RA_DM_ARFB_by_Noisy(pDM_Odm); -+}; -+ -+VOID -+phydm_update_pwr_track( -+ IN PVOID pDM_VOID, -+ IN u1Byte Rate -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte pathIdx = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Pwr Track Get Rate=0x%x\n", Rate)); -+ -+ pDM_Odm->TxRate = Rate; -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ #if USE_WORKITEM -+ PlatformScheduleWorkItem(&pDM_Odm->RaRptWorkitem); -+ #else -+ if (pDM_Odm->SupportICType == ODM_RTL8821) { -+ #if (RTL8821A_SUPPORT == 1) -+ ODM_TxPwrTrackSetPwr8821A(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); -+ #endif -+ } else if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ for (pathIdx = ODM_RF_PATH_A; pathIdx < MAX_PATH_NUM_8812A; pathIdx++) { -+ #if (RTL8812A_SUPPORT == 1) -+ ODM_TxPwrTrackSetPwr8812A(pDM_Odm, MIX_MODE, pathIdx, 0); -+ #endif -+ } -+ } else if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+ #if (RTL8723B_SUPPORT == 1) -+ ODM_TxPwrTrackSetPwr_8723B(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); -+ #endif -+ } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { -+ for (pathIdx = ODM_RF_PATH_A; pathIdx < MAX_PATH_NUM_8192E; pathIdx++) { -+ #if (RTL8192E_SUPPORT == 1) -+ ODM_TxPwrTrackSetPwr92E(pDM_Odm, MIX_MODE, pathIdx, 0); -+ #endif -+ } -+ } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+ #if (RTL8188E_SUPPORT == 1) -+ ODM_TxPwrTrackSetPwr88E(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); -+ #endif -+ } -+ #endif -+ #else -+ PlatformScheduleWorkItem(&pDM_Odm->RaRptWorkitem); -+ #endif -+ #endif -+ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+s4Byte -+phydm_FindMinimumRSSI( -+IN PDM_ODM_T pDM_Odm, -+IN PADAPTER pAdapter, -+IN OUT BOOLEAN *pbLink_temp -+ -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ BOOLEAN act_as_ap = ACTING_AS_AP(pAdapter); -+ -+ /* 1.Determine the minimum RSSI */ -+ if ((!pMgntInfo->bMediaConnect) || -+ (act_as_ap && (pHalData->EntryMinUndecoratedSmoothedPWDB == 0))) {/* We should check AP mode and Entry info.into consideration, revised by Roger, 2013.10.18*/ -+ -+ pHalData->MinUndecoratedPWDBForDM = 0; -+ *pbLink_temp = FALSE; -+ -+ } else -+ *pbLink_temp = TRUE; -+ -+ -+ if (pMgntInfo->bMediaConnect) { /* Default port*/ -+ -+ if (act_as_ap || pMgntInfo->mIbss) { -+ pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ /**/ -+ } else { -+ pHalData->MinUndecoratedPWDBForDM = pHalData->UndecoratedSmoothedPWDB; -+ /**/ -+ } -+ } else { /* associated entry pwdb*/ -+ pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ /**/ -+ } -+ -+ return pHalData->MinUndecoratedPWDBForDM; -+} -+ -+VOID -+ODM_UpdateInitRateWorkItemCallback( -+ IN PVOID pContext -+) -+{ -+ PADAPTER Adapter = (PADAPTER)pContext; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ u1Byte p = 0; -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8821) { -+ ODM_TxPwrTrackSetPwr8821A(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ for (p = ODM_RF_PATH_A; p < MAX_PATH_NUM_8812A; p++) { /*DOn't know how to include &c*/ -+ -+ ODM_TxPwrTrackSetPwr8812A(pDM_Odm, MIX_MODE, p, 0); -+ /**/ -+ } -+ } else if (pDM_Odm->SupportICType == ODM_RTL8723B) { -+ ODM_TxPwrTrackSetPwr_8723B(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); -+ /**/ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { -+ for (p = ODM_RF_PATH_A; p < MAX_PATH_NUM_8192E; p++) { /*DOn't know how to include &c*/ -+ ODM_TxPwrTrackSetPwr92E(pDM_Odm, MIX_MODE, p, 0); -+ /**/ -+ } -+ } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+ ODM_TxPwrTrackSetPwr88E(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); -+ /**/ -+ } -+} -+ -+VOID -+odm_RSSIDumpToRegister( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ PlatformEFIOWrite1Byte(Adapter, rA_RSSIDump_Jaguar, Adapter->RxStats.RxRSSIPercentage[0]); -+ PlatformEFIOWrite1Byte(Adapter, rB_RSSIDump_Jaguar, Adapter->RxStats.RxRSSIPercentage[1]); -+ -+ /* Rx EVM*/ -+ PlatformEFIOWrite1Byte(Adapter, rS1_RXevmDump_Jaguar, Adapter->RxStats.RxEVMdbm[0]); -+ PlatformEFIOWrite1Byte(Adapter, rS2_RXevmDump_Jaguar, Adapter->RxStats.RxEVMdbm[1]); -+ -+ /* Rx SNR*/ -+ PlatformEFIOWrite1Byte(Adapter, rA_RXsnrDump_Jaguar, (u1Byte)(Adapter->RxStats.RxSNRdB[0])); -+ PlatformEFIOWrite1Byte(Adapter, rB_RXsnrDump_Jaguar, (u1Byte)(Adapter->RxStats.RxSNRdB[1])); -+ -+ /* Rx Cfo_Short*/ -+ PlatformEFIOWrite2Byte(Adapter, rA_CfoShortDump_Jaguar, Adapter->RxStats.RxCfoShort[0]); -+ PlatformEFIOWrite2Byte(Adapter, rB_CfoShortDump_Jaguar, Adapter->RxStats.RxCfoShort[1]); -+ -+ /* Rx Cfo_Tail*/ -+ PlatformEFIOWrite2Byte(Adapter, rA_CfoLongDump_Jaguar, Adapter->RxStats.RxCfoTail[0]); -+ PlatformEFIOWrite2Byte(Adapter, rB_CfoLongDump_Jaguar, Adapter->RxStats.RxCfoTail[1]); -+ } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { -+ PlatformEFIOWrite1Byte(Adapter, rA_RSSIDump_92E, Adapter->RxStats.RxRSSIPercentage[0]); -+ PlatformEFIOWrite1Byte(Adapter, rB_RSSIDump_92E, Adapter->RxStats.RxRSSIPercentage[1]); -+ /* Rx EVM*/ -+ PlatformEFIOWrite1Byte(Adapter, rS1_RXevmDump_92E, Adapter->RxStats.RxEVMdbm[0]); -+ PlatformEFIOWrite1Byte(Adapter, rS2_RXevmDump_92E, Adapter->RxStats.RxEVMdbm[1]); -+ /* Rx SNR*/ -+ PlatformEFIOWrite1Byte(Adapter, rA_RXsnrDump_92E, (u1Byte)(Adapter->RxStats.RxSNRdB[0])); -+ PlatformEFIOWrite1Byte(Adapter, rB_RXsnrDump_92E, (u1Byte)(Adapter->RxStats.RxSNRdB[1])); -+ /* Rx Cfo_Short*/ -+ PlatformEFIOWrite2Byte(Adapter, rA_CfoShortDump_92E, Adapter->RxStats.RxCfoShort[0]); -+ PlatformEFIOWrite2Byte(Adapter, rB_CfoShortDump_92E, Adapter->RxStats.RxCfoShort[1]); -+ /* Rx Cfo_Tail*/ -+ PlatformEFIOWrite2Byte(Adapter, rA_CfoLongDump_92E, Adapter->RxStats.RxCfoTail[0]); -+ PlatformEFIOWrite2Byte(Adapter, rB_CfoLongDump_92E, Adapter->RxStats.RxCfoTail[1]); -+ } -+} -+ -+VOID -+odm_RefreshLdpcRtsMP( -+ IN PADAPTER pAdapter, -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte mMacId, -+ IN u1Byte IOTPeer, -+ IN s4Byte UndecoratedSmoothedPWDB -+) -+{ -+ BOOLEAN bCtlLdpc = FALSE; -+ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; -+ -+ if (pDM_Odm->SupportICType != ODM_RTL8821 && pDM_Odm->SupportICType != ODM_RTL8812) -+ return; -+ -+ if ((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->CutVersion == ODM_CUT_A)) -+ bCtlLdpc = TRUE; -+ else if (pDM_Odm->SupportICType == ODM_RTL8812 && -+ IOTPeer == HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP) -+ bCtlLdpc = TRUE; -+ -+ if (bCtlLdpc) { -+ if (UndecoratedSmoothedPWDB < (pRA->LdpcThres - 5)) -+ MgntSet_TX_LDPC(pAdapter, mMacId, TRUE); -+ else if (UndecoratedSmoothedPWDB > pRA->LdpcThres) -+ MgntSet_TX_LDPC(pAdapter, mMacId, FALSE); -+ } -+ -+ if (UndecoratedSmoothedPWDB < (pRA->RtsThres - 5)) -+ pRA->bLowerRtsRate = TRUE; -+ else if (UndecoratedSmoothedPWDB > pRA->RtsThres) -+ pRA->bLowerRtsRate = FALSE; -+} -+ -+#if 0 -+VOID -+ODM_DynamicARFBSelect( -+ IN PVOID pDM_VOID, -+ IN u1Byte rate, -+ IN BOOLEAN Collision_State -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; -+ -+ if (pDM_Odm->SupportICType != ODM_RTL8192E) -+ return; -+ -+ if (Collision_State == pRA_Table->PT_collision_pre) -+ return; -+ -+ if (rate >= DESC_RATEMCS8 && rate <= DESC_RATEMCS12) { -+ if (Collision_State == 1) { -+ if (rate == DESC_RATEMCS12) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07060501); -+ } else if (rate == DESC_RATEMCS11) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07070605); -+ } else if (rate == DESC_RATEMCS10) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08080706); -+ } else if (rate == DESC_RATEMCS9) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08080707); -+ } else { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09090808); -+ } -+ } else { /* Collision_State == 0*/ -+ if (rate == DESC_RATEMCS12) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x05010000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09080706); -+ } else if (rate == DESC_RATEMCS11) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x06050000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09080807); -+ } else if (rate == DESC_RATEMCS10) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x07060000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x0a090908); -+ } else if (rate == DESC_RATEMCS9) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x07070000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x0a090808); -+ } else { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x08080000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x0b0a0909); -+ } -+ } -+ } else { /* MCS13~MCS15, 1SS, G-mode*/ -+ if (Collision_State == 1) { -+ if (rate == DESC_RATEMCS15) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x05040302); -+ } else if (rate == DESC_RATEMCS14) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x06050302); -+ } else if (rate == DESC_RATEMCS13) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07060502); -+ } else { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x06050402); -+ } -+ } else { // Collision_State == 0 -+ if (rate == DESC_RATEMCS15) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x03020000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07060504); -+ } else if (rate == DESC_RATEMCS14) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x03020000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08070605); -+ } else if (rate == DESC_RATEMCS13) { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x05020000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09080706); -+ } else { -+ -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x04020000); -+ ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08070605); -+ } -+ } -+ } -+ pRA_Table->PT_collision_pre = Collision_State; -+} -+#endif -+ -+VOID -+ODM_RateAdaptiveStateApInit( -+ IN PVOID PADAPTER_VOID, -+ IN PRT_WLAN_STA pEntry -+) -+{ -+ PADAPTER Adapter = (PADAPTER)PADAPTER_VOID; -+ pEntry->Ratr_State = DM_RATR_STA_INIT; -+} -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+ -+static void -+FindMinimumRSSI( -+ IN PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ /*Determine the minimum RSSI*/ -+ -+ if ((pDM_Odm->bLinked != _TRUE) && -+ (pHalData->EntryMinUndecoratedSmoothedPWDB == 0)) { -+ pHalData->MinUndecoratedPWDBForDM = 0; -+ /*ODM_RT_TRACE(pDM_Odm,COMP_BB_POWERSAVING, DBG_LOUD, ("Not connected to any\n"));*/ -+ } else -+ pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ -+ /*DBG_8192C("%s=>MinUndecoratedPWDBForDM(%d)\n",__FUNCTION__,pdmpriv->MinUndecoratedPWDBForDM);*/ -+ /*ODM_RT_TRACE(pDM_Odm,COMP_DIG, DBG_LOUD, ("MinUndecoratedPWDBForDM =%d\n",pHalData->MinUndecoratedPWDBForDM));*/ -+} -+ -+u8Byte -+PhyDM_Get_Rate_Bitmap_Ex( -+ IN PVOID pDM_VOID, -+ IN u4Byte macid, -+ IN u8Byte ra_mask, -+ IN u1Byte rssi_level, -+ OUT u8Byte *dm_RA_Mask, -+ OUT u1Byte *dm_RteID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PSTA_INFO_T pEntry; -+ u8Byte rate_bitmap = 0; -+ u1Byte WirelessMode; -+ -+ pEntry = pDM_Odm->pODM_StaInfo[macid]; -+ if (!IS_STA_VALID(pEntry)) -+ return ra_mask; -+ WirelessMode = pEntry->wireless_mode; -+ switch (WirelessMode) { -+ case ODM_WM_B: -+ if (ra_mask & 0x000000000000000c) /* 11M or 5.5M enable */ -+ rate_bitmap = 0x000000000000000d; -+ else -+ rate_bitmap = 0x000000000000000f; -+ break; -+ -+ case (ODM_WM_G): -+ case (ODM_WM_A): -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x0000000000000f00; -+ else -+ rate_bitmap = 0x0000000000000ff0; -+ break; -+ -+ case (ODM_WM_B|ODM_WM_G): -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x0000000000000f00; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x0000000000000ff0; -+ else -+ rate_bitmap = 0x0000000000000ff5; -+ break; -+ -+ case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G): -+ case (ODM_WM_B|ODM_WM_N24G): -+ case (ODM_WM_G|ODM_WM_N24G): -+ case (ODM_WM_A|ODM_WM_N5G): { -+ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x00000000000f0000; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x00000000000ff000; -+ else { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x00000000000ff015; -+ else -+ rate_bitmap = 0x00000000000ff005; -+ } -+ } else if (pDM_Odm->RFType == ODM_2T2R || pDM_Odm->RFType == ODM_2T3R || pDM_Odm->RFType == ODM_2T4R) { -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x000000000f8f0000; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x000000000f8ff000; -+ else { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x000000000f8ff015; -+ else -+ rate_bitmap = 0x000000000f8ff005; -+ } -+ } else { -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x0000000f0f0f0000; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x0000000fcfcfe000; -+ else { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x0000000ffffff015; -+ else -+ rate_bitmap = 0x0000000ffffff005; -+ } -+ } -+ } -+ break; -+ -+ case (ODM_WM_AC|ODM_WM_G): -+ if (rssi_level == 1) -+ rate_bitmap = 0x00000000fc3f0000; -+ else if (rssi_level == 2) -+ rate_bitmap = 0x00000000fffff000; -+ else -+ rate_bitmap = 0x00000000ffffffff; -+ break; -+ -+ case (ODM_WM_AC|ODM_WM_A): -+ -+ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { -+ if (rssi_level == 1) /* add by Gary for ac-series */ -+ rate_bitmap = 0x00000000003f8000; -+ else if (rssi_level == 2) -+ rate_bitmap = 0x00000000003fe000; -+ else -+ rate_bitmap = 0x00000000003ff010; -+ } else if (pDM_Odm->RFType == ODM_2T2R || pDM_Odm->RFType == ODM_2T3R || pDM_Odm->RFType == ODM_2T4R) { -+ if (rssi_level == 1) /* add by Gary for ac-series */ -+ rate_bitmap = 0x00000000fe3f8000; /* VHT 2SS MCS3~9 */ -+ else if (rssi_level == 2) -+ rate_bitmap = 0x00000000fffff000; /* VHT 2SS MCS0~9 */ -+ else -+ rate_bitmap = 0x00000000fffff010; /* All */ -+ } else { -+ if (rssi_level == 1) /* add by Gary for ac-series */ -+ rate_bitmap = 0x000003f8fe3f8000ULL; /* VHT 3SS MCS3~9 */ -+ else if (rssi_level == 2) -+ rate_bitmap = 0x000003fffffff000ULL; /* VHT3SS MCS0~9 */ -+ else -+ rate_bitmap = 0x000003fffffff010ULL; /* All */ -+ } -+ break; -+ -+ default: -+ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) -+ rate_bitmap = 0x00000000000fffff; -+ else if (pDM_Odm->RFType == ODM_2T2R || pDM_Odm->RFType == ODM_2T3R || pDM_Odm->RFType == ODM_2T4R) -+ rate_bitmap = 0x000000000fffffff; -+ else -+ rate_bitmap = 0x0000003fffffffffULL; -+ break; -+ -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%016llx\n", rssi_level, WirelessMode, rate_bitmap)); -+ -+ return (ra_mask & rate_bitmap); -+} -+ -+ -+u4Byte -+ODM_Get_Rate_Bitmap( -+ IN PVOID pDM_VOID, -+ IN u4Byte macid, -+ IN u4Byte ra_mask, -+ IN u1Byte rssi_level -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PSTA_INFO_T pEntry; -+ u4Byte rate_bitmap = 0; -+ u1Byte WirelessMode; -+ //u1Byte WirelessMode =*(pDM_Odm->pWirelessMode); -+ -+ -+ pEntry = pDM_Odm->pODM_StaInfo[macid]; -+ if (!IS_STA_VALID(pEntry)) -+ return ra_mask; -+ -+ WirelessMode = pEntry->wireless_mode; -+ -+ switch (WirelessMode) { -+ case ODM_WM_B: -+ if (ra_mask & 0x0000000c) //11M or 5.5M enable -+ rate_bitmap = 0x0000000d; -+ else -+ rate_bitmap = 0x0000000f; -+ break; -+ -+ case (ODM_WM_G): -+ case (ODM_WM_A): -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x00000f00; -+ else -+ rate_bitmap = 0x00000ff0; -+ break; -+ -+ case (ODM_WM_B|ODM_WM_G): -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x00000f00; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x00000ff0; -+ else -+ rate_bitmap = 0x00000ff5; -+ break; -+ -+ case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G) : -+ case (ODM_WM_B|ODM_WM_N24G) : -+ case (ODM_WM_G|ODM_WM_N24G) : -+ case (ODM_WM_A|ODM_WM_N5G) : { -+ if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x000f0000; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x000ff000; -+ else { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x000ff015; -+ else -+ rate_bitmap = 0x000ff005; -+ } -+ } else { -+ if (rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x0f8f0000; -+ else if (rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x0f8ff000; -+ else { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x0f8ff015; -+ else -+ rate_bitmap = 0x0f8ff005; -+ } -+ } -+ } -+ break; -+ -+ case (ODM_WM_AC|ODM_WM_G): -+ if (rssi_level == 1) -+ rate_bitmap = 0xfc3f0000; -+ else if (rssi_level == 2) -+ rate_bitmap = 0xfffff000; -+ else -+ rate_bitmap = 0xffffffff; -+ break; -+ -+ case (ODM_WM_AC|ODM_WM_A): -+ -+ if (pDM_Odm->RFType == RF_1T1R) { -+ if (rssi_level == 1) // add by Gary for ac-series -+ rate_bitmap = 0x003f8000; -+ else if (rssi_level == 2) -+ rate_bitmap = 0x003ff000; -+ else -+ rate_bitmap = 0x003ff010; -+ } else { -+ if (rssi_level == 1) // add by Gary for ac-series -+ rate_bitmap = 0xfe3f8000; // VHT 2SS MCS3~9 -+ else if (rssi_level == 2) -+ rate_bitmap = 0xfffff000; // VHT 2SS MCS0~9 -+ else -+ rate_bitmap = 0xfffff010; // All -+ } -+ break; -+ -+ default: -+ if (pDM_Odm->RFType == RF_1T2R) -+ rate_bitmap = 0x000fffff; -+ else -+ rate_bitmap = 0x0fffffff; -+ break; -+ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x\n", __func__, rssi_level, WirelessMode, rate_bitmap)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x\n", rssi_level, WirelessMode, rate_bitmap)); -+ -+ return (ra_mask & rate_bitmap); -+ -+} -+ -+#endif //#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+VOID -+phydm_gen_ramask_h2c_AP( -+ IN PVOID pDM_VOID, -+ IN struct rtl8192cd_priv *priv, -+ IN PSTA_INFO_T *pEntry, -+ IN u1Byte rssi_level -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8192E | ODM_RTL8881A)) { -+ -+ #ifdef CONFIG_WLAN_HAL -+ GET_HAL_INTERFACE(priv)->UpdateHalRAMaskHandler(priv, pEntry, rssi_level); -+ #endif -+ -+ } else if (pDM_Odm->SupportICType == ODM_RTL8812) { -+ -+ #if (RTL8812A_SUPPORT == 1) -+ UpdateHalRAMask8812(priv, pEntry, rssi_level); -+ /**/ -+ #endif -+ } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { -+ -+ #if (RTL8188E_SUPPORT == 1) -+ #ifdef TXREPORT -+ add_RATid(priv, pEntry); -+ /**/ -+ #endif -+ #endif -+ } -+} -+ -+ -+#endif /*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN| ODM_CE))*/ -+ -+ -+/* RA_MASK_PHYDMLIZE, will delete it later*/ -+ -+#if (RA_MASK_PHYDMLIZE_CE || RA_MASK_PHYDMLIZE_AP || RA_MASK_PHYDMLIZE_WIN) -+ -+BOOLEAN -+ODM_RAStateCheck( -+ IN PVOID pDM_VOID, -+ IN s4Byte RSSI, -+ IN BOOLEAN bForceUpdate, -+ OUT pu1Byte pRATRState -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; -+ const u1Byte GoUpGap = 5; -+ u1Byte HighRSSIThreshForRA = pRA->HighRSSIThresh; -+ u1Byte LowRSSIThreshForRA = pRA->LowRSSIThresh; -+ u1Byte RATRState; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI= (( %d )), Current_RSSI_level = (( %d ))\n", RSSI, *pRATRState)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[Ori RA RSSI Thresh] High= (( %d )), Low = (( %d ))\n", HighRSSIThreshForRA, LowRSSIThreshForRA)); -+ /* Threshold Adjustment:*/ -+ /* when RSSI state trends to go up one or two levels, make sure RSSI is high enough.*/ -+ /* Here GoUpGap is added to solve the boundary's level alternation issue.*/ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ u1Byte UltraLowRSSIThreshForRA = pRA->UltraLowRSSIThresh; -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8881A) -+ LowRSSIThreshForRA = 30; /* for LDPC / BCC switch*/ -+#endif -+ -+ switch (*pRATRState) { -+ case DM_RATR_STA_INIT: -+ case DM_RATR_STA_HIGH: -+ break; -+ -+ case DM_RATR_STA_MIDDLE: -+ HighRSSIThreshForRA += GoUpGap; -+ break; -+ -+ case DM_RATR_STA_LOW: -+ HighRSSIThreshForRA += GoUpGap; -+ LowRSSIThreshForRA += GoUpGap; -+ break; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ case DM_RATR_STA_ULTRA_LOW: -+ HighRSSIThreshForRA += GoUpGap; -+ LowRSSIThreshForRA += GoUpGap; -+ UltraLowRSSIThreshForRA += GoUpGap; -+ break; -+#endif -+ -+ default: -+ ODM_RT_ASSERT(pDM_Odm, FALSE, ("wrong rssi level setting %d !", *pRATRState)); -+ break; -+ } -+ -+ /* Decide RATRState by RSSI.*/ -+ if (RSSI > HighRSSIThreshForRA) -+ RATRState = DM_RATR_STA_HIGH; -+ else if (RSSI > LowRSSIThreshForRA) -+ RATRState = DM_RATR_STA_MIDDLE; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ else if (RSSI > UltraLowRSSIThreshForRA) -+ RATRState = DM_RATR_STA_LOW; -+ else -+ RATRState = DM_RATR_STA_ULTRA_LOW; -+#else -+ else -+ RATRState = DM_RATR_STA_LOW; -+#endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[Mod RA RSSI Thresh] High= (( %d )), Low = (( %d ))\n", HighRSSIThreshForRA, LowRSSIThreshForRA)); -+ /*printk("==>%s,RATRState:0x%02x ,RSSI:%d\n",__FUNCTION__,RATRState,RSSI);*/ -+ -+ if (*pRATRState != RATRState || bForceUpdate) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[RSSI Level Update] %d -> %d\n", *pRATRState, RATRState)); -+ *pRATRState = RATRState; -+ return TRUE; -+ } -+ -+ return FALSE; -+} -+ -+#endif -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_rainfo.h 2018-02-11 21:44:27.158146254 +0200 -@@ -0,0 +1,583 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __PHYDMRAINFO_H__ -+#define __PHYDMRAINFO_H__ -+ -+/*#define RAINFO_VERSION "2.0" //2014.11.04*/ -+/*#define RAINFO_VERSION "3.0" //2015.01.13 Dino*/ -+/*#define RAINFO_VERSION "3.1" //2015.01.14 Dino*/ -+/*#define RAINFO_VERSION "3.3" 2015.07.29 YuChen*/ -+/*#define RAINFO_VERSION "3.4"*/ /*2015.12.15 Stanley*/ -+/*#define RAINFO_VERSION "4.0"*/ /*2016.03.24 Dino, Add more RA mask state and Phydm-lize partial ra mask function */ -+/*#define RAINFO_VERSION "4.1"*/ /*2016.04.20 Dino, Add new function to adjust PCR RA threshold */ -+#define RAINFO_VERSION "4.2" /*2016.05.17 Dino, Add H2C debug cmd */ -+ -+#define H2C_0X42_LENGTH 5 -+#define H2C_MAX_LENGTH 7 -+ -+#define RA_FLOOR_UP_GAP 3 -+#define RA_FLOOR_TABLE_SIZE 7 -+ -+#define ACTIVE_TP_THRESHOLD 150 -+#define RA_RETRY_DESCEND_NUM 2 -+#define RA_RETRY_LIMIT_LOW 4 -+#define RA_RETRY_LIMIT_HIGH 32 -+ -+#define RAINFO_BE_RX_STATE BIT0 // 1:RX //ULDL -+#define RAINFO_STBC_STATE BIT1 -+//#define RAINFO_LDPC_STATE BIT2 -+#define RAINFO_NOISY_STATE BIT2 // set by Noisy_Detection -+#define RAINFO_SHURTCUT_STATE BIT3 -+#define RAINFO_SHURTCUT_FLAG BIT4 -+#define RAINFO_INIT_RSSI_RATE_STATE BIT5 -+#define RAINFO_BF_STATE BIT6 -+#define RAINFO_BE_TX_STATE BIT7 // 1:TX -+ -+#define RA_MASK_CCK 0xf -+#define RA_MASK_OFDM 0xff0 -+#define RA_MASK_HT1SS 0xff000 -+#define RA_MASK_HT2SS 0xff00000 -+/*#define RA_MASK_MCS3SS */ -+#define RA_MASK_HT4SS 0xff0 -+#define RA_MASK_VHT1SS 0x3ff000 -+#define RA_MASK_VHT2SS 0xffc00000 -+ -+#if(DM_ODM_SUPPORT_TYPE == ODM_AP) -+#define RA_FIRST_MACID 1 -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define RA_FIRST_MACID 0 -+#define WIN_DEFAULT_PORT_MACID 0 -+#define WIN_BT_PORT_MACID 2 -+#else /*if (DM_ODM_SUPPORT_TYPE == ODM_CE)*/ -+#define RA_FIRST_MACID 0 -+#endif -+ -+#define AP_InitRateAdaptiveState ODM_RateAdaptiveStateApInit -+ -+#if (RA_MASK_PHYDMLIZE_CE || RA_MASK_PHYDMLIZE_AP || RA_MASK_PHYDMLIZE_WIN) -+#define DM_RATR_STA_INIT 0 -+#define DM_RATR_STA_HIGH 1 -+#define DM_RATR_STA_MIDDLE 2 -+#define DM_RATR_STA_LOW 3 -+#define DM_RATR_STA_ULTRA_LOW 4 -+#endif -+ -+typedef enum _phydm_arfr_num { -+ ARFR_0_RATE_ID = 0x9, -+ ARFR_1_RATE_ID = 0xa, -+ ARFR_2_RATE_ID = 0xb, -+ ARFR_3_RATE_ID = 0xc, -+ ARFR_4_RATE_ID = 0xd, -+ ARFR_5_RATE_ID = 0xe -+} PHYDM_RA_ARFR_NUM_E; -+ -+typedef enum _Phydm_ra_dbg_para { -+ RADBG_PCR_TH_OFFSET = 0, -+ RADBG_RTY_PENALTY = 1, -+ RADBG_N_HIGH = 2, -+ RADBG_N_LOW = 3, -+ RADBG_TRATE_UP_TABLE = 4, -+ RADBG_TRATE_DOWN_TABLE = 5, -+ RADBG_TRYING_NECESSARY = 6, -+ RADBG_TDROPING_NECESSARY = 7, -+ RADBG_RATE_UP_RTY_RATIO = 8, -+ RADBG_RATE_DOWN_RTY_RATIO = 9, //u8 -+ -+ RADBG_DEBUG_MONITOR1 = 0xc, -+ RADBG_DEBUG_MONITOR2 = 0xd, -+ RADBG_DEBUG_MONITOR3 = 0xe, -+ RADBG_DEBUG_MONITOR4 = 0xf, -+ RADBG_DEBUG_MONITOR5 = 0x10, -+ NUM_RA_PARA -+} PHYDM_RA_DBG_PARA_E; -+ -+typedef enum PHYDM_WIRELESS_MODE { -+ -+ PHYDM_WIRELESS_MODE_UNKNOWN = 0x00, -+ PHYDM_WIRELESS_MODE_A = 0x01, -+ PHYDM_WIRELESS_MODE_B = 0x02, -+ PHYDM_WIRELESS_MODE_G = 0x04, -+ PHYDM_WIRELESS_MODE_AUTO = 0x08, -+ PHYDM_WIRELESS_MODE_N_24G = 0x10, -+ PHYDM_WIRELESS_MODE_N_5G = 0x20, -+ PHYDM_WIRELESS_MODE_AC_5G = 0x40, -+ PHYDM_WIRELESS_MODE_AC_24G = 0x80, -+ PHYDM_WIRELESS_MODE_AC_ONLY = 0x100, -+ PHYDM_WIRELESS_MODE_MAX = 0x800, -+ PHYDM_WIRELESS_MODE_ALL = 0xFFFF -+} PHYDM_WIRELESS_MODE_E; -+ -+typedef enum PHYDM_RATEID_IDX_ { -+ -+ PHYDM_BGN_40M_2SS = 0, -+ PHYDM_BGN_40M_1SS = 1, -+ PHYDM_BGN_20M_2SS = 2, -+ PHYDM_BGN_20M_1SS = 3, -+ PHYDM_GN_N2SS = 4, -+ PHYDM_GN_N1SS = 5, -+ PHYDM_BG = 6, -+ PHYDM_G = 7, -+ PHYDM_B_20M = 8, -+ PHYDM_ARFR0_AC_2SS = 9, -+ PHYDM_ARFR1_AC_1SS = 10, -+ PHYDM_ARFR2_AC_2G_1SS = 11, -+ PHYDM_ARFR3_AC_2G_2SS = 12, -+ PHYDM_ARFR4_AC_3SS = 13, -+ PHYDM_ARFR5_N_3SS = 14 -+} PHYDM_RATEID_IDX_E; -+ -+typedef enum _PHYDM_RF_TYPE_DEFINITION { -+ PHYDM_RF_1T1R = 0, -+ PHYDM_RF_1T2R, -+ PHYDM_RF_2T2R, -+ PHYDM_RF_2T2R_GREEN, -+ PHYDM_RF_2T3R, -+ PHYDM_RF_2T4R, -+ PHYDM_RF_3T3R, -+ PHYDM_RF_3T4R, -+ PHYDM_RF_4T4R, -+ PHYDM_RF_MAX_TYPE -+} PHYDM_RF_TYPE_DEF_E; -+ -+typedef enum _PHYDM_BW { -+ PHYDM_BW_20 = 0, -+ PHYDM_BW_40, -+ PHYDM_BW_80, -+ PHYDM_BW_80_80, -+ PHYDM_BW_160, -+ PHYDM_BW_10, -+ PHYDM_BW_5 -+} PHYDM_BW_E; -+ -+ -+#if (RATE_ADAPTIVE_SUPPORT == 1)//88E RA -+typedef struct _ODM_RA_Info_ { -+ u1Byte RateID; -+ u4Byte RateMask; -+ u4Byte RAUseRate; -+ u1Byte RateSGI; -+ u1Byte RssiStaRA; -+ u1Byte PreRssiStaRA; -+ u1Byte SGIEnable; -+ u1Byte DecisionRate; -+ u1Byte PreRate; -+ u1Byte HighestRate; -+ u1Byte LowestRate; -+ u4Byte NscUp; -+ u4Byte NscDown; -+ u2Byte RTY[5]; -+ u4Byte TOTAL; -+ u2Byte DROP; -+ u1Byte Active; -+ u2Byte RptTime; -+ u1Byte RAWaitingCounter; -+ u1Byte RAPendingCounter; -+ u1Byte RADropAfterDown; -+#if 1 //POWER_TRAINING_ACTIVE == 1 // For compile pass only~! -+ u1Byte PTActive; // on or off -+ u1Byte PTTryState; // 0 trying state, 1 for decision state -+ u1Byte PTStage; // 0~6 -+ u1Byte PTStopCount; //Stop PT counter -+ u1Byte PTPreRate; // if rate change do PT -+ u1Byte PTPreRssi; // if RSSI change 5% do PT -+ u1Byte PTModeSS; // decide whitch rate should do PT -+ u1Byte RAstage; // StageRA, decide how many times RA will be done between PT -+ u1Byte PTSmoothFactor; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+ u1Byte RateDownCounter; -+ u1Byte RateUpCounter; -+ u1Byte RateDirection; -+ u1Byte BoundingType; -+ u1Byte BoundingCounter; -+ u1Byte BoundingLearningTime; -+ u1Byte RateDownStartTime; -+#endif -+} ODM_RA_INFO_T, *PODM_RA_INFO_T; -+#endif -+ -+ -+typedef struct _Rate_Adaptive_Table_ { -+ u1Byte firstconnect; -+#if(DM_ODM_SUPPORT_TYPE==ODM_WIN) -+ BOOLEAN PT_collision_pre; -+#endif -+ -+#if (defined(CONFIG_RA_DBG_CMD)) -+ BOOLEAN is_ra_dbg_init; -+ -+ u1Byte RTY_P[ODM_NUM_RATE_IDX]; -+ u1Byte RTY_P_default[ODM_NUM_RATE_IDX]; -+ BOOLEAN RTY_P_modify_note[ODM_NUM_RATE_IDX]; -+ -+ u1Byte RATE_UP_RTY_RATIO[ODM_NUM_RATE_IDX]; -+ u1Byte RATE_UP_RTY_RATIO_default[ODM_NUM_RATE_IDX]; -+ BOOLEAN RATE_UP_RTY_RATIO_modify_note[ODM_NUM_RATE_IDX]; -+ -+ u1Byte RATE_DOWN_RTY_RATIO[ODM_NUM_RATE_IDX]; -+ u1Byte RATE_DOWN_RTY_RATIO_default[ODM_NUM_RATE_IDX]; -+ BOOLEAN RATE_DOWN_RTY_RATIO_modify_note[ODM_NUM_RATE_IDX]; -+ -+ BOOLEAN RA_Para_feedback_req; -+ -+ u1Byte para_idx; -+ u1Byte rate_idx; -+ u1Byte value; -+ u2Byte value_16; -+ u1Byte rate_length; -+#endif -+ u1Byte link_tx_rate[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte highest_client_tx_order; -+ u2Byte highest_client_tx_rate_order; -+ u1Byte power_tracking_flag; -+ u1Byte RA_threshold_offset; -+ u1Byte RA_offset_direction; -+ -+ #if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) -+ u1Byte per_rate_retrylimit_20M[ODM_NUM_RATE_IDX]; -+ u1Byte per_rate_retrylimit_40M[ODM_NUM_RATE_IDX]; -+ u1Byte retry_descend_num; -+ u1Byte retrylimit_low; -+ u1Byte retrylimit_high; -+ #endif -+ -+ -+} RA_T, *pRA_T; -+ -+typedef struct _ODM_RATE_ADAPTIVE { -+ u1Byte Type; // DM_Type_ByFW/DM_Type_ByDriver -+ u1Byte HighRSSIThresh; // if RSSI > HighRSSIThresh => RATRState is DM_RATR_STA_HIGH -+ u1Byte LowRSSIThresh; // if RSSI <= LowRSSIThresh => RATRState is DM_RATR_STA_LOW -+ u1Byte RATRState; // Current RSSI level, DM_RATR_STA_HIGH/DM_RATR_STA_MIDDLE/DM_RATR_STA_LOW -+ -+#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ u1Byte LdpcThres; // if RSSI > LdpcThres => switch from LPDC to BCC -+ BOOLEAN bLowerRtsRate; -+#endif -+ -+#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ u1Byte RtsThres; -+#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) -+ BOOLEAN bUseLdpc; -+#else -+ u1Byte UltraLowRSSIThresh; -+ u4Byte LastRATR; // RATR Register Content -+#endif -+ -+} ODM_RATE_ADAPTIVE, *PODM_RATE_ADAPTIVE; -+ -+VOID -+phydm_h2C_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+); -+ -+#if (defined(CONFIG_RA_DBG_CMD)) -+ -+VOID -+odm_RA_debug( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value -+); -+ -+VOID -+odm_RA_ParaAdjust_init( -+ IN PVOID pDM_VOID -+); -+ -+#else -+ -+VOID -+phydm_RA_debug_PCR( -+ IN PVOID pDM_VOID, -+ IN u4Byte *const dm_value, -+ IN u4Byte *_used, -+ OUT char *output, -+ IN u4Byte *_out_len -+); -+ -+#endif -+ -+VOID -+ODM_C2HRaParaReportHandler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+); -+ -+VOID -+odm_RA_ParaAdjust( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_ra_dynamic_retry_count( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_ra_dynamic_retry_limit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_ra_dynamic_rate_id_on_assoc( -+ IN PVOID pDM_VOID, -+ IN u1Byte wireless_mode, -+ IN u1Byte init_rate_id -+); -+ -+VOID -+phydm_print_rate( -+ IN PVOID pDM_VOID, -+ IN u1Byte rate, -+ IN u4Byte dbg_component -+); -+ -+VOID -+phydm_c2h_ra_report_handler( -+ IN PVOID pDM_VOID, -+ IN pu1Byte CmdBuf, -+ IN u1Byte CmdLen -+); -+ -+u1Byte -+phydm_rate_order_compute( -+ IN PVOID pDM_VOID, -+ IN u1Byte rate_idx -+ ); -+ -+VOID -+phydm_ra_info_watchdog( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_ra_info_init( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RSSIMonitorInit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_modify_RA_PCR_threshold( -+ IN PVOID pDM_VOID, -+ IN u1Byte RA_offset_direction, -+ IN u1Byte RA_threshold_offset -+); -+ -+VOID -+odm_RSSIMonitorCheck( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+phydm_initRaInfo( -+ IN PVOID pDM_VOID -+); -+ -+u1Byte -+phydm_vht_en_mapping( -+ IN PVOID pDM_VOID, -+ IN u4Byte WirelessMode -+); -+ -+u1Byte -+phydm_rate_id_mapping( -+ IN PVOID pDM_VOID, -+ IN u4Byte WirelessMode, -+ IN u1Byte RfType, -+ IN u1Byte bw -+); -+ -+VOID -+phydm_UpdateHalRAMask( -+ IN PVOID pDM_VOID, -+ IN u4Byte wirelessMode, -+ IN u1Byte RfType, -+ IN u1Byte BW, -+ IN u1Byte MimoPs_enable, -+ IN u1Byte disable_cck_rate, -+ IN u4Byte *ratr_bitmap_msb_in, -+ IN u4Byte *ratr_bitmap_in, -+ IN u1Byte tx_rate_level -+); -+ -+VOID -+odm_RateAdaptiveMaskInit( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RefreshRateAdaptiveMask( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RefreshRateAdaptiveMaskMP( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RefreshRateAdaptiveMaskCE( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RefreshRateAdaptiveMaskAPADSL( -+ IN PVOID pDM_VOID -+); -+ -+u1Byte -+phydm_RA_level_decision( -+ IN PVOID pDM_VOID, -+ IN u4Byte rssi, -+ IN u1Byte Ratr_State -+); -+ -+BOOLEAN -+ODM_RAStateCheck( -+ IN PVOID pDM_VOID, -+ IN s4Byte RSSI, -+ IN BOOLEAN bForceUpdate, -+ OUT pu1Byte pRATRState -+); -+ -+VOID -+odm_RefreshBasicRateMask( -+ IN PVOID pDM_VOID -+); -+VOID -+ODM_RAPostActionOnAssoc( -+ IN PVOID pDM_Odm -+); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ -+u1Byte -+odm_Find_RTS_Rate( -+ IN PVOID pDM_VOID, -+ IN u1Byte Tx_Rate, -+ IN BOOLEAN bErpProtect -+); -+ -+VOID -+ODM_UpdateNoisyState( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN bNoisyStateFromC2H -+); -+ -+VOID -+phydm_update_pwr_track( -+ IN PVOID pDM_VOID, -+ IN u1Byte Rate -+); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+s4Byte -+phydm_FindMinimumRSSI( -+IN PDM_ODM_T pDM_Odm, -+IN PADAPTER pAdapter, -+IN OUT BOOLEAN *pbLink_temp -+); -+ -+VOID -+ODM_UpdateInitRateWorkItemCallback( -+ IN PVOID pContext -+); -+ -+VOID -+odm_RSSIDumpToRegister( -+ IN PVOID pDM_VOID -+); -+ -+VOID -+odm_RefreshLdpcRtsMP( -+ IN PADAPTER pAdapter, -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte mMacId, -+ IN u1Byte IOTPeer, -+ IN s4Byte UndecoratedSmoothedPWDB -+); -+ -+#if 0 -+VOID -+ODM_DynamicARFBSelect( -+ IN PVOID pDM_VOID, -+ IN u1Byte rate, -+ IN BOOLEAN Collision_State -+); -+#endif -+ -+VOID -+ODM_RateAdaptiveStateApInit( -+ IN PVOID PADAPTER_VOID, -+ IN PRT_WLAN_STA pEntry -+); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+static void -+FindMinimumRSSI( -+ IN PADAPTER pAdapter -+); -+ -+u8Byte -+PhyDM_Get_Rate_Bitmap_Ex( -+ IN PVOID pDM_VOID, -+ IN u4Byte macid, -+ IN u8Byte ra_mask, -+ IN u1Byte rssi_level, -+ OUT u8Byte *dm_RA_Mask, -+ OUT u1Byte *dm_RteID -+); -+u4Byte -+ODM_Get_Rate_Bitmap( -+ IN PVOID pDM_VOID, -+ IN u4Byte macid, -+ IN u4Byte ra_mask, -+ IN u1Byte rssi_level -+); -+ -+void phydm_ra_rssi_rpt_wk(PVOID pContext); -+#endif/*#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)*/ -+ -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+ -+VOID -+phydm_gen_ramask_h2c_AP( -+ IN PVOID pDM_VOID, -+ IN struct rtl8192cd_priv *priv, -+ IN PSTA_INFO_T *pEntry, -+ IN u1Byte rssi_level -+); -+ -+#endif/*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN| ODM_CE))*/ -+ -+#endif /*#ifndef __ODMRAINFO_H__*/ -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11ac.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11ac.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11ac.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11ac.h 2018-02-11 21:44:27.158146254 +0200 -@@ -0,0 +1,94 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_REGDEFINE11AC_H__ -+#define __ODM_REGDEFINE11AC_H__ -+ -+//2 RF REG LIST -+ -+ -+ -+//2 BB REG LIST -+//PAGE 8 -+#define ODM_REG_CCK_RPT_FORMAT_11AC 0x804 -+#define ODM_REG_BB_RX_PATH_11AC 0x808 -+#define ODM_REG_BB_TX_PATH_11AC 0x80c -+#define ODM_REG_BB_ATC_11AC 0x860 -+#define ODM_REG_EDCCA_POWER_CAL 0x8dc -+#define ODM_REG_DBG_RPT_11AC 0x8fc -+//PAGE 9 -+#define ODM_REG_EDCCA_DOWN_OPT 0x900 -+#define ODM_REG_ACBB_EDCCA_ENHANCE 0x944 -+#define ODM_ADC_TRIGGER_Jaguar2 0x95C /*ADC sample mode*/ -+#define ODM_REG_OFDM_FA_RST_11AC 0x9A4 -+#define ODM_REG_CCX_PERIOD_11AC 0x990 -+#define ODM_REG_NHM_TH9_TH10_11AC 0x994 -+#define ODM_REG_CLM_11AC 0x994 -+#define ODM_REG_NHM_TH3_TO_TH0_11AC 0x998 -+#define ODM_REG_NHM_TH7_TO_TH4_11AC 0x99c -+#define ODM_REG_NHM_TH8_11AC 0x9a0 -+#define ODM_REG_NHM_9E8_11AC 0x9e8 -+#define ODM_REG_CSI_CONTENT_VALUE 0x9b4 -+//PAGE A -+#define ODM_REG_CCK_CCA_11AC 0xA0A -+#define ODM_REG_CCK_FA_RST_11AC 0xA2C -+#define ODM_REG_CCK_FA_11AC 0xA5C -+//PAGE B -+#define ODM_REG_RST_RPT_11AC 0xB58 -+//PAGE C -+#define ODM_REG_TRMUX_11AC 0xC08 -+#define ODM_REG_IGI_A_11AC 0xC50 -+//PAGE E -+#define ODM_REG_IGI_B_11AC 0xE50 -+#define ODM_REG_TRMUX_11AC_B 0xE08 -+//PAGE F -+#define ODM_REG_CCK_CRC32_CNT_11AC 0xF04 -+#define ODM_REG_CCK_CCA_CNT_11AC 0xF08 -+#define ODM_REG_VHT_CRC32_CNT_11AC 0xF0c -+#define ODM_REG_HT_CRC32_CNT_11AC 0xF10 -+#define ODM_REG_OFDM_CRC32_CNT_11AC 0xF14 -+#define ODM_REG_OFDM_FA_11AC 0xF48 -+#define ODM_REG_RPT_11AC 0xfa0 -+#define ODM_REG_CLM_RESULT_11AC 0xfa4 -+#define ODM_REG_NHM_CNT_11AC 0xfa8 -+#define ODM_REG_NHM_DUR_READY_11AC 0xfb4 -+ -+#define ODM_REG_NHM_CNT7_TO_CNT4_11AC 0xfac -+#define ODM_REG_NHM_CNT11_TO_CNT8_11AC 0xfb0 -+#define ODM_REG_OFDM_FA_TYPE2_11AC 0xFD0 -+//PAGE 18 -+#define ODM_REG_IGI_C_11AC 0x1850 -+//PAGE 1A -+#define ODM_REG_IGI_D_11AC 0x1A50 -+ -+//2 MAC REG LIST -+#define ODM_REG_RESP_TX_11AC 0x6D8 -+ -+ -+ -+//DIG Related -+#define ODM_BIT_IGI_11AC 0xFFFFFFFF -+#define ODM_BIT_CCK_RPT_FORMAT_11AC BIT16 -+#define ODM_BIT_BB_RX_PATH_11AC 0xF -+#define ODM_BIT_BB_TX_PATH_11AC 0xF -+#define ODM_BIT_BB_ATC_11AC BIT14 -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11n.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11n.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11n.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_regdefine11n.h 2018-02-11 21:44:27.158146254 +0200 -@@ -0,0 +1,213 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_REGDEFINE11N_H__ -+#define __ODM_REGDEFINE11N_H__ -+ -+ -+//2 RF REG LIST -+#define ODM_REG_RF_MODE_11N 0x00 -+#define ODM_REG_RF_0B_11N 0x0B -+#define ODM_REG_CHNBW_11N 0x18 -+#define ODM_REG_T_METER_11N 0x24 -+#define ODM_REG_RF_25_11N 0x25 -+#define ODM_REG_RF_26_11N 0x26 -+#define ODM_REG_RF_27_11N 0x27 -+#define ODM_REG_RF_2B_11N 0x2B -+#define ODM_REG_RF_2C_11N 0x2C -+#define ODM_REG_RXRF_A3_11N 0x3C -+#define ODM_REG_T_METER_92D_11N 0x42 -+#define ODM_REG_T_METER_88E_11N 0x42 -+ -+ -+ -+//2 BB REG LIST -+//PAGE 8 -+#define ODM_REG_BB_CTRL_11N 0x800 -+#define ODM_REG_RF_PIN_11N 0x804 -+#define ODM_REG_PSD_CTRL_11N 0x808 -+#define ODM_REG_TX_ANT_CTRL_11N 0x80C -+#define ODM_REG_BB_PWR_SAV5_11N 0x818 -+#define ODM_REG_CCK_RPT_FORMAT_11N 0x824 -+#define ODM_REG_CCK_RPT_FORMAT_11N_B 0x82C -+#define ODM_REG_RX_DEFUALT_A_11N 0x858 -+#define ODM_REG_RX_DEFUALT_B_11N 0x85A -+#define ODM_REG_BB_PWR_SAV3_11N 0x85C -+#define ODM_REG_ANTSEL_CTRL_11N 0x860 -+#define ODM_REG_RX_ANT_CTRL_11N 0x864 -+#define ODM_REG_PIN_CTRL_11N 0x870 -+#define ODM_REG_BB_PWR_SAV1_11N 0x874 -+#define ODM_REG_ANTSEL_PATH_11N 0x878 -+#define ODM_REG_BB_3WIRE_11N 0x88C -+#define ODM_REG_SC_CNT_11N 0x8C4 -+#define ODM_REG_PSD_DATA_11N 0x8B4 -+#define ODM_REG_CCX_PERIOD_11N 0x894 -+#define ODM_REG_NHM_TH9_TH10_11N 0x890 -+#define ODM_REG_CLM_11N 0x890 -+#define ODM_REG_NHM_TH3_TO_TH0_11N 0x898 -+#define ODM_REG_NHM_TH7_TO_TH4_11N 0x89c -+#define ODM_REG_NHM_TH8_11N 0xe28 -+#define ODM_REG_CLM_READY_11N 0x8b4 -+#define ODM_REG_CLM_RESULT_11N 0x8d0 -+#define ODM_REG_NHM_CNT_11N 0x8d8 -+ -+// For ACS, Jeffery, 2014-12-26 -+#define ODM_REG_NHM_CNT7_TO_CNT4_11N 0x8dc -+#define ODM_REG_NHM_CNT9_TO_CNT8_11N 0x8d0 -+#define ODM_REG_NHM_CNT10_TO_CNT11_11N 0x8d4 -+ -+//PAGE 9 -+#define ODM_REG_BB_CTRL_PAGE9_11N 0x900 -+#define ODM_REG_DBG_RPT_11N 0x908 -+#define ODM_REG_BB_TX_PATH_11N 0x90c -+#define ODM_REG_ANT_MAPPING1_11N 0x914 -+#define ODM_REG_ANT_MAPPING2_11N 0x918 -+#define ODM_REG_EDCCA_DOWN_OPT_11N 0x948 -+#define ODM_REG_RX_DFIR_MOD_97F 0x948 -+ -+//PAGE A -+#define ODM_REG_CCK_ANTDIV_PARA1_11N 0xA00 -+#define ODM_REG_CCK_ANT_SEL_11N 0xA04 -+#define ODM_REG_CCK_CCA_11N 0xA0A -+#define ODM_REG_CCK_ANTDIV_PARA2_11N 0xA0C -+#define ODM_REG_CCK_ANTDIV_PARA3_11N 0xA10 -+#define ODM_REG_CCK_ANTDIV_PARA4_11N 0xA14 -+#define ODM_REG_CCK_FILTER_PARA1_11N 0xA22 -+#define ODM_REG_CCK_FILTER_PARA2_11N 0xA23 -+#define ODM_REG_CCK_FILTER_PARA3_11N 0xA24 -+#define ODM_REG_CCK_FILTER_PARA4_11N 0xA25 -+#define ODM_REG_CCK_FILTER_PARA5_11N 0xA26 -+#define ODM_REG_CCK_FILTER_PARA6_11N 0xA27 -+#define ODM_REG_CCK_FILTER_PARA7_11N 0xA28 -+#define ODM_REG_CCK_FILTER_PARA8_11N 0xA29 -+#define ODM_REG_CCK_FA_RST_11N 0xA2C -+#define ODM_REG_CCK_FA_MSB_11N 0xA58 -+#define ODM_REG_CCK_FA_LSB_11N 0xA5C -+#define ODM_REG_CCK_CCA_CNT_11N 0xA60 -+#define ODM_REG_BB_PWR_SAV4_11N 0xA74 -+//PAGE B -+#define ODM_REG_LNA_SWITCH_11N 0xB2C -+#define ODM_REG_PATH_SWITCH_11N 0xB30 -+#define ODM_REG_RSSI_CTRL_11N 0xB38 -+#define ODM_REG_CONFIG_ANTA_11N 0xB68 -+#define ODM_REG_RSSI_BT_11N 0xB9C -+#define ODM_REG_RXCK_RFMOD 0xBB0 -+#define ODM_REG_EDCCA_DCNF_97F 0xBC0 -+ -+//PAGE C -+#define ODM_REG_OFDM_FA_HOLDC_11N 0xC00 -+#define ODM_REG_BB_RX_PATH_11N 0xC04 -+#define ODM_REG_TRMUX_11N 0xC08 -+#define ODM_REG_OFDM_FA_RSTC_11N 0xC0C -+#define ODM_REG_DOWNSAM_FACTOR_11N 0xC10 -+#define ODM_REG_RXIQI_MATRIX_11N 0xC14 -+#define ODM_REG_TXIQK_MATRIX_LSB1_11N 0xC4C -+#define ODM_REG_IGI_A_11N 0xC50 -+#define ODM_REG_ANTDIV_PARA2_11N 0xC54 -+#define ODM_REG_IGI_B_11N 0xC58 -+#define ODM_REG_ANTDIV_PARA3_11N 0xC5C -+#define ODM_REG_L1SBD_PD_CH_11N 0XC6C -+#define ODM_REG_BB_PWR_SAV2_11N 0xC70 -+#define ODM_REG_BB_AGC_SET_2_11N 0xc74 -+#define ODM_REG_RX_OFF_11N 0xC7C -+#define ODM_REG_TXIQK_MATRIXA_11N 0xC80 -+#define ODM_REG_TXIQK_MATRIXB_11N 0xC88 -+#define ODM_REG_TXIQK_MATRIXA_LSB2_11N 0xC94 -+#define ODM_REG_TXIQK_MATRIXB_LSB2_11N 0xC9C -+#define ODM_REG_RXIQK_MATRIX_LSB_11N 0xCA0 -+#define ODM_REG_ANTDIV_PARA1_11N 0xCA4 -+#define ODM_REG_SMALL_BANDWIDTH_11N 0xCE4 -+#define ODM_REG_OFDM_FA_TYPE1_11N 0xCF0 -+//PAGE D -+#define ODM_REG_OFDM_FA_RSTD_11N 0xD00 -+#define ODM_REG_BB_RX_ANT_11N 0xD04 -+#define ODM_REG_BB_ATC_11N 0xD2C -+#define ODM_REG_OFDM_FA_TYPE2_11N 0xDA0 -+#define ODM_REG_OFDM_FA_TYPE3_11N 0xDA4 -+#define ODM_REG_OFDM_FA_TYPE4_11N 0xDA8 -+#define ODM_REG_RPT_11N 0xDF4 -+//PAGE E -+#define ODM_REG_TXAGC_A_6_18_11N 0xE00 -+#define ODM_REG_TXAGC_A_24_54_11N 0xE04 -+#define ODM_REG_TXAGC_A_1_MCS32_11N 0xE08 -+#define ODM_REG_TXAGC_A_MCS0_3_11N 0xE10 -+#define ODM_REG_TXAGC_A_MCS4_7_11N 0xE14 -+#define ODM_REG_TXAGC_A_MCS8_11_11N 0xE18 -+#define ODM_REG_TXAGC_A_MCS12_15_11N 0xE1C -+#define ODM_REG_EDCCA_DCNF_11N 0xE24 -+#define ODM_REG_TAP_UPD_97F 0xE24 -+#define ODM_REG_FPGA0_IQK_11N 0xE28 -+#define ODM_REG_PAGE_B1_97F 0xE28 -+#define ODM_REG_TXIQK_TONE_A_11N 0xE30 -+#define ODM_REG_RXIQK_TONE_A_11N 0xE34 -+#define ODM_REG_TXIQK_PI_A_11N 0xE38 -+#define ODM_REG_RXIQK_PI_A_11N 0xE3C -+#define ODM_REG_TXIQK_11N 0xE40 -+#define ODM_REG_RXIQK_11N 0xE44 -+#define ODM_REG_IQK_AGC_PTS_11N 0xE48 -+#define ODM_REG_IQK_AGC_RSP_11N 0xE4C -+#define ODM_REG_BLUETOOTH_11N 0xE6C -+#define ODM_REG_RX_WAIT_CCA_11N 0xE70 -+#define ODM_REG_TX_CCK_RFON_11N 0xE74 -+#define ODM_REG_TX_CCK_BBON_11N 0xE78 -+#define ODM_REG_OFDM_RFON_11N 0xE7C -+#define ODM_REG_OFDM_BBON_11N 0xE80 -+#define ODM_REG_TX2RX_11N 0xE84 -+#define ODM_REG_TX2TX_11N 0xE88 -+#define ODM_REG_RX_CCK_11N 0xE8C -+#define ODM_REG_RX_OFDM_11N 0xED0 -+#define ODM_REG_RX_WAIT_RIFS_11N 0xED4 -+#define ODM_REG_RX2RX_11N 0xED8 -+#define ODM_REG_STANDBY_11N 0xEDC -+#define ODM_REG_SLEEP_11N 0xEE0 -+#define ODM_REG_PMPD_ANAEN_11N 0xEEC -+/* PAGE F */ -+#define ODM_REG_PAGE_F_RST_11N 0xF14 -+#define ODM_REG_IGI_C_11N 0xF84 -+#define ODM_REG_IGI_D_11N 0xF88 -+#define ODM_REG_CCK_CRC32_ERROR_CNT_11N 0xF84 -+#define ODM_REG_CCK_CRC32_OK_CNT_11N 0xF88 -+#define ODM_REG_HT_CRC32_CNT_11N 0xF90 -+#define ODM_REG_OFDM_CRC32_CNT_11N 0xF94 -+ -+//2 MAC REG LIST -+#define ODM_REG_BB_RST_11N 0x02 -+#define ODM_REG_ANTSEL_PIN_11N 0x4C -+#define ODM_REG_EARLY_MODE_11N 0x4D0 -+#define ODM_REG_RSSI_MONITOR_11N 0x4FE -+#define ODM_REG_EDCA_VO_11N 0x500 -+#define ODM_REG_EDCA_VI_11N 0x504 -+#define ODM_REG_EDCA_BE_11N 0x508 -+#define ODM_REG_EDCA_BK_11N 0x50C -+#define ODM_REG_TXPAUSE_11N 0x522 -+#define ODM_REG_RESP_TX_11N 0x6D8 -+#define ODM_REG_ANT_TRAIN_PARA1_11N 0x7b0 -+#define ODM_REG_ANT_TRAIN_PARA2_11N 0x7b4 -+ -+ -+//DIG Related -+#define ODM_BIT_IGI_11N 0x0000007F -+#define ODM_BIT_CCK_RPT_FORMAT_11N BIT9 -+#define ODM_BIT_BB_RX_PATH_11N 0xF -+#define ODM_BIT_BB_TX_PATH_11N 0xF -+#define ODM_BIT_BB_ATC_11N BIT11 -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_reg.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_reg.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_reg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_reg.h 2018-02-11 21:44:27.158146254 +0200 -@@ -0,0 +1,215 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+//============================================================ -+// File Name: odm_reg.h -+// -+// Description: -+// -+// This file is for general register definition. -+// -+// -+//============================================================ -+#ifndef __HAL_ODM_REG_H__ -+#define __HAL_ODM_REG_H__ -+ -+// -+// Register Definition -+// -+ -+//MAC REG -+#define ODM_BB_RESET 0x002 -+#define ODM_DUMMY 0x4fe -+#define RF_T_METER_OLD 0x24 -+#define RF_T_METER_NEW 0x42 -+ -+#define ODM_EDCA_VO_PARAM 0x500 -+#define ODM_EDCA_VI_PARAM 0x504 -+#define ODM_EDCA_BE_PARAM 0x508 -+#define ODM_EDCA_BK_PARAM 0x50C -+#define ODM_TXPAUSE 0x522 -+ -+/* LTE_COEX */ -+#define REG_LTECOEX_CTRL 0x07C0 -+#define REG_LTECOEX_WRITE_DATA 0x07C4 -+#define REG_LTECOEX_READ_DATA 0x07C8 -+#define REG_LTECOEX_PATH_CONTROL 0x70 -+ -+//BB REG -+#define ODM_FPGA_PHY0_PAGE8 0x800 -+#define ODM_PSD_SETTING 0x808 -+#define ODM_AFE_SETTING 0x818 -+#define ODM_TXAGC_B_6_18 0x830 -+#define ODM_TXAGC_B_24_54 0x834 -+#define ODM_TXAGC_B_MCS32_5 0x838 -+#define ODM_TXAGC_B_MCS0_MCS3 0x83c -+#define ODM_TXAGC_B_MCS4_MCS7 0x848 -+#define ODM_TXAGC_B_MCS8_MCS11 0x84c -+#define ODM_ANALOG_REGISTER 0x85c -+#define ODM_RF_INTERFACE_OUTPUT 0x860 -+#define ODM_TXAGC_B_MCS12_MCS15 0x868 -+#define ODM_TXAGC_B_11_A_2_11 0x86c -+#define ODM_AD_DA_LSB_MASK 0x874 -+#define ODM_ENABLE_3_WIRE 0x88c -+#define ODM_PSD_REPORT 0x8b4 -+#define ODM_R_ANT_SELECT 0x90c -+#define ODM_CCK_ANT_SELECT 0xa07 -+#define ODM_CCK_PD_THRESH 0xa0a -+#define ODM_CCK_RF_REG1 0xa11 -+#define ODM_CCK_MATCH_FILTER 0xa20 -+#define ODM_CCK_RAKE_MAC 0xa2e -+#define ODM_CCK_CNT_RESET 0xa2d -+#define ODM_CCK_TX_DIVERSITY 0xa2f -+#define ODM_CCK_FA_CNT_MSB 0xa5b -+#define ODM_CCK_FA_CNT_LSB 0xa5c -+#define ODM_CCK_NEW_FUNCTION 0xa75 -+#define ODM_OFDM_PHY0_PAGE_C 0xc00 -+#define ODM_OFDM_RX_ANT 0xc04 -+#define ODM_R_A_RXIQI 0xc14 -+#define ODM_R_A_AGC_CORE1 0xc50 -+#define ODM_R_A_AGC_CORE2 0xc54 -+#define ODM_R_B_AGC_CORE1 0xc58 -+#define ODM_R_AGC_PAR 0xc70 -+#define ODM_R_HTSTF_AGC_PAR 0xc7c -+#define ODM_TX_PWR_TRAINING_A 0xc90 -+#define ODM_TX_PWR_TRAINING_B 0xc98 -+#define ODM_OFDM_FA_CNT1 0xcf0 -+#define ODM_OFDM_PHY0_PAGE_D 0xd00 -+#define ODM_OFDM_FA_CNT2 0xda0 -+#define ODM_OFDM_FA_CNT3 0xda4 -+#define ODM_OFDM_FA_CNT4 0xda8 -+#define ODM_TXAGC_A_6_18 0xe00 -+#define ODM_TXAGC_A_24_54 0xe04 -+#define ODM_TXAGC_A_1_MCS32 0xe08 -+#define ODM_TXAGC_A_MCS0_MCS3 0xe10 -+#define ODM_TXAGC_A_MCS4_MCS7 0xe14 -+#define ODM_TXAGC_A_MCS8_MCS11 0xe18 -+#define ODM_TXAGC_A_MCS12_MCS15 0xe1c -+ -+//RF REG -+#define ODM_GAIN_SETTING 0x00 -+#define ODM_CHANNEL 0x18 -+#define ODM_RF_T_METER 0x24 -+#define ODM_RF_T_METER_92D 0x42 -+#define ODM_RF_T_METER_88E 0x42 -+#define ODM_RF_T_METER_92E 0x42 -+#define ODM_RF_T_METER_8812 0x42 -+#define rRF_TxGainOffset 0x55 -+ -+//Ant Detect Reg -+#define ODM_DPDT 0x300 -+ -+//PSD Init -+#define ODM_PSDREG 0x808 -+ -+//92D Path Div -+#define PATHDIV_REG 0xB30 -+#define PATHDIV_TRI 0xBA0 -+ -+ -+// -+// Bitmap Definition -+// -+#if(DM_ODM_SUPPORT_TYPE & (ODM_AP)) -+// TX AGC -+#define rTxAGC_A_CCK11_CCK1_JAguar 0xc20 -+#define rTxAGC_A_Ofdm18_Ofdm6_JAguar 0xc24 -+#define rTxAGC_A_Ofdm54_Ofdm24_JAguar 0xc28 -+#define rTxAGC_A_MCS3_MCS0_JAguar 0xc2c -+#define rTxAGC_A_MCS7_MCS4_JAguar 0xc30 -+#define rTxAGC_A_MCS11_MCS8_JAguar 0xc34 -+#define rTxAGC_A_MCS15_MCS12_JAguar 0xc38 -+#define rTxAGC_A_Nss1Index3_Nss1Index0_JAguar 0xc3c -+#define rTxAGC_A_Nss1Index7_Nss1Index4_JAguar 0xc40 -+#define rTxAGC_A_Nss2Index1_Nss1Index8_JAguar 0xc44 -+#define rTxAGC_A_Nss2Index5_Nss2Index2_JAguar 0xc48 -+#define rTxAGC_A_Nss2Index9_Nss2Index6_JAguar 0xc4c -+#if defined(CONFIG_WLAN_HAL_8814AE) -+#define rTxAGC_A_MCS19_MCS16_JAguar 0xcd8 -+#define rTxAGC_A_MCS23_MCS20_JAguar 0xcdc -+#define rTxAGC_A_Nss3Index3_Nss3Index0_JAguar 0xce0 -+#define rTxAGC_A_Nss3Index7_Nss3Index4_JAguar 0xce4 -+#define rTxAGC_A_Nss3Index9_Nss3Index8_JAguar 0xce8 -+#endif -+#define rTxAGC_B_CCK11_CCK1_JAguar 0xe20 -+#define rTxAGC_B_Ofdm18_Ofdm6_JAguar 0xe24 -+#define rTxAGC_B_Ofdm54_Ofdm24_JAguar 0xe28 -+#define rTxAGC_B_MCS3_MCS0_JAguar 0xe2c -+#define rTxAGC_B_MCS7_MCS4_JAguar 0xe30 -+#define rTxAGC_B_MCS11_MCS8_JAguar 0xe34 -+#define rTxAGC_B_MCS15_MCS12_JAguar 0xe38 -+#define rTxAGC_B_Nss1Index3_Nss1Index0_JAguar 0xe3c -+#define rTxAGC_B_Nss1Index7_Nss1Index4_JAguar 0xe40 -+#define rTxAGC_B_Nss2Index1_Nss1Index8_JAguar 0xe44 -+#define rTxAGC_B_Nss2Index5_Nss2Index2_JAguar 0xe48 -+#define rTxAGC_B_Nss2Index9_Nss2Index6_JAguar 0xe4c -+#if defined(CONFIG_WLAN_HAL_8814AE) -+#define rTxAGC_B_MCS19_MCS16_JAguar 0xed8 -+#define rTxAGC_B_MCS23_MCS20_JAguar 0xedc -+#define rTxAGC_B_Nss3Index3_Nss3Index0_JAguar 0xee0 -+#define rTxAGC_B_Nss3Index7_Nss3Index4_JAguar 0xee4 -+#define rTxAGC_B_Nss3Index9_Nss3Index8_JAguar 0xee8 -+#define rTxAGC_C_CCK11_CCK1_JAguar 0x1820 -+#define rTxAGC_C_Ofdm18_Ofdm6_JAguar 0x1824 -+#define rTxAGC_C_Ofdm54_Ofdm24_JAguar 0x1828 -+#define rTxAGC_C_MCS3_MCS0_JAguar 0x182c -+#define rTxAGC_C_MCS7_MCS4_JAguar 0x1830 -+#define rTxAGC_C_MCS11_MCS8_JAguar 0x1834 -+#define rTxAGC_C_MCS15_MCS12_JAguar 0x1838 -+#define rTxAGC_C_Nss1Index3_Nss1Index0_JAguar 0x183c -+#define rTxAGC_C_Nss1Index7_Nss1Index4_JAguar 0x1840 -+#define rTxAGC_C_Nss2Index1_Nss1Index8_JAguar 0x1844 -+#define rTxAGC_C_Nss2Index5_Nss2Index2_JAguar 0x1848 -+#define rTxAGC_C_Nss2Index9_Nss2Index6_JAguar 0x184c -+#define rTxAGC_C_MCS19_MCS16_JAguar 0x18d8 -+#define rTxAGC_C_MCS23_MCS20_JAguar 0x18dc -+#define rTxAGC_C_Nss3Index3_Nss3Index0_JAguar 0x18e0 -+#define rTxAGC_C_Nss3Index7_Nss3Index4_JAguar 0x18e4 -+#define rTxAGC_C_Nss3Index9_Nss3Index8_JAguar 0x18e8 -+#define rTxAGC_D_CCK11_CCK1_JAguar 0x1a20 -+#define rTxAGC_D_Ofdm18_Ofdm6_JAguar 0x1a24 -+#define rTxAGC_D_Ofdm54_Ofdm24_JAguar 0x1a28 -+#define rTxAGC_D_MCS3_MCS0_JAguar 0x1a2c -+#define rTxAGC_D_MCS7_MCS4_JAguar 0x1a30 -+#define rTxAGC_D_MCS11_MCS8_JAguar 0x1a34 -+#define rTxAGC_D_MCS15_MCS12_JAguar 0x1a38 -+#define rTxAGC_D_Nss1Index3_Nss1Index0_JAguar 0x1a3c -+#define rTxAGC_D_Nss1Index7_Nss1Index4_JAguar 0x1a40 -+#define rTxAGC_D_Nss2Index1_Nss1Index8_JAguar 0x1a44 -+#define rTxAGC_D_Nss2Index5_Nss2Index2_JAguar 0x1a48 -+#define rTxAGC_D_Nss2Index9_Nss2Index6_JAguar 0x1a4c -+#define rTxAGC_D_MCS19_MCS16_JAguar 0x1ad8 -+#define rTxAGC_D_MCS23_MCS20_JAguar 0x1adc -+#define rTxAGC_D_Nss3Index3_Nss3Index0_JAguar 0x1ae0 -+#define rTxAGC_D_Nss3Index7_Nss3Index4_JAguar 0x1ae4 -+#define rTxAGC_D_Nss3Index9_Nss3Index8_JAguar 0x1ae8 -+#endif -+ -+#define bTxAGC_byte0_Jaguar 0xff -+#define bTxAGC_byte1_Jaguar 0xff00 -+#define bTxAGC_byte2_Jaguar 0xff0000 -+#define bTxAGC_byte3_Jaguar 0xff000000 -+#endif -+ -+#define BIT_FA_RESET BIT0 -+ -+ -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_types.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_types.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/phydm_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/phydm_types.h 2018-02-11 21:44:27.158146254 +0200 -@@ -0,0 +1,261 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __ODM_TYPES_H__ -+#define __ODM_TYPES_H__ -+ -+ -+/*Define Different SW team support*/ -+#define ODM_AP 0x01 /*BIT0*/ -+#define ODM_CE 0x04 /*BIT2*/ -+#define ODM_WIN 0x08 /*BIT3*/ -+#define ODM_ADSL 0x10 /*BIT4*/ -+#define ODM_IOT 0x20 /*BIT5*/ -+ -+/*Deifne HW endian support*/ -+#define ODM_ENDIAN_BIG 0 -+#define ODM_ENDIAN_LITTLE 1 -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define GET_PDM_ODM(__pAdapter) ((PDM_ODM_T)(&((GET_HAL_DATA(__pAdapter))->DM_OutSrc))) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#define GET_PDM_ODM(__pAdapter) ((PDM_ODM_T)(&((GET_HAL_DATA(__pAdapter))->odmpriv))) -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) -+#define RT_PCI_INTERFACE 1 -+#define RT_USB_INTERFACE 2 -+#define RT_SDIO_INTERFACE 3 -+#endif -+ -+typedef enum _HAL_STATUS{ -+ HAL_STATUS_SUCCESS, -+ HAL_STATUS_FAILURE, -+ /*RT_STATUS_PENDING, -+ RT_STATUS_RESOURCE, -+ RT_STATUS_INVALID_CONTEXT, -+ RT_STATUS_INVALID_PARAMETER, -+ RT_STATUS_NOT_SUPPORT, -+ RT_STATUS_OS_API_FAILED,*/ -+}HAL_STATUS,*PHAL_STATUS; -+ -+#if( DM_ODM_SUPPORT_TYPE == ODM_AP) -+#define MP_DRIVER 0 -+#endif -+#if(DM_ODM_SUPPORT_TYPE != ODM_WIN) -+ -+#define VISTA_USB_RX_REVISE 0 -+ -+// -+// Declare for ODM spin lock defintion temporarily fro compile pass. -+// -+typedef enum _RT_SPINLOCK_TYPE{ -+ RT_TX_SPINLOCK = 1, -+ RT_RX_SPINLOCK = 2, -+ RT_RM_SPINLOCK = 3, -+ RT_CAM_SPINLOCK = 4, -+ RT_SCAN_SPINLOCK = 5, -+ RT_LOG_SPINLOCK = 7, -+ RT_BW_SPINLOCK = 8, -+ RT_CHNLOP_SPINLOCK = 9, -+ RT_RF_OPERATE_SPINLOCK = 10, -+ RT_INITIAL_SPINLOCK = 11, -+ RT_RF_STATE_SPINLOCK = 12, // For RF state. Added by Bruce, 2007-10-30. -+#if VISTA_USB_RX_REVISE -+ RT_USBRX_CONTEXT_SPINLOCK = 13, -+ RT_USBRX_POSTPROC_SPINLOCK = 14, // protect data of Adapter->IndicateW/ IndicateR -+#endif -+ //Shall we define Ndis 6.2 SpinLock Here ? -+ RT_PORT_SPINLOCK=16, -+ RT_VNIC_SPINLOCK=17, -+ RT_HVL_SPINLOCK=18, -+ RT_H2C_SPINLOCK = 20, // For H2C cmd. Added by tynli. 2009.11.09. -+ -+ RT_BTData_SPINLOCK=25, -+ -+ RT_WAPI_OPTION_SPINLOCK=26, -+ RT_WAPI_RX_SPINLOCK=27, -+ -+ // add for 92D CCK control issue -+ RT_CCK_PAGEA_SPINLOCK = 28, -+ RT_BUFFER_SPINLOCK = 29, -+ RT_CHANNEL_AND_BANDWIDTH_SPINLOCK = 30, -+ RT_GEN_TEMP_BUF_SPINLOCK = 31, -+ RT_AWB_SPINLOCK = 32, -+ RT_FW_PS_SPINLOCK = 33, -+ RT_HW_TIMER_SPIN_LOCK = 34, -+ RT_MPT_WI_SPINLOCK = 35, -+ RT_P2P_SPIN_LOCK = 36, // Protect P2P context -+ RT_DBG_SPIN_LOCK = 37, -+ RT_IQK_SPINLOCK = 38, -+ RT_PENDED_OID_SPINLOCK = 39, -+ RT_CHNLLIST_SPINLOCK = 40, -+ RT_INDIC_SPINLOCK = 41, //protect indication -+ RT_RFD_SPINLOCK = 42, -+ RT_SYNC_IO_CNT_SPINLOCK = 43, -+ RT_LAST_SPINLOCK, -+}RT_SPINLOCK_TYPE; -+ -+#endif -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ #define STA_INFO_T RT_WLAN_STA -+ #define PSTA_INFO_T PRT_WLAN_STA -+ #define __func__ __FUNCTION__ -+ #define PHYDM_TESTCHIP_SUPPORT TESTCHIP_SUPPORT -+ #define bMaskH3Bytes 0xffffff00 -+ #define SUCCESS 0 -+ #define FAIL (-1) -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ -+ // To let ADSL/AP project compile ok; it should be removed after all conflict are solved. Added by Annie, 2011-10-07. -+ #define ADSL_AP_BUILD_WORKAROUND -+ #define AP_BUILD_WORKAROUND -+ -+ #ifdef AP_BUILD_WORKAROUND -+ #include "../typedef.h" -+ #else -+ typedef void VOID,*PVOID; -+ typedef unsigned char BOOLEAN,*PBOOLEAN; -+ typedef unsigned char u1Byte,*pu1Byte; -+ typedef unsigned short u2Byte,*pu2Byte; -+ typedef unsigned int u4Byte,*pu4Byte; -+ typedef unsigned long long u8Byte,*pu8Byte; -+#if 1 -+/* In ARM platform, system would use the type -- "char" as "unsigned char" -+ * And we only use s1Byte/ps1Byte as INT8 now, so changes the type of s1Byte.*/ -+ typedef signed char s1Byte,*ps1Byte; -+#else -+ typedef char s1Byte,*ps1Byte; -+#endif -+ typedef short s2Byte,*ps2Byte; -+ typedef long s4Byte,*ps4Byte; -+ typedef long long s8Byte,*ps8Byte; -+ #endif -+ -+ typedef struct rtl8192cd_priv *prtl8192cd_priv; -+ typedef struct stat_info STA_INFO_T,*PSTA_INFO_T; -+ typedef struct timer_list RT_TIMER, *PRT_TIMER; -+ typedef void * RT_TIMER_CALL_BACK; -+ -+#ifdef CONFIG_PCI_HCI -+ #define DEV_BUS_TYPE RT_PCI_INTERFACE -+#endif -+ -+ #define _TRUE 1 -+ #define _FALSE 0 -+ -+ #if (defined(TESTCHIP_SUPPORT)) -+ #define PHYDM_TESTCHIP_SUPPORT 1 -+ #else -+ #define PHYDM_TESTCHIP_SUPPORT 0 -+ #endif -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ #include -+#if 0 -+ typedef u8 u1Byte, *pu1Byte; -+ typedef u16 u2Byte,*pu2Byte; -+ typedef u32 u4Byte,*pu4Byte; -+ typedef u64 u8Byte,*pu8Byte; -+ typedef s8 s1Byte,*ps1Byte; -+ typedef s16 s2Byte,*ps2Byte; -+ typedef s32 s4Byte,*ps4Byte; -+ typedef s64 s8Byte,*ps8Byte; -+#else -+ #define u1Byte u8 -+ #define pu1Byte u8* -+ -+ #define u2Byte u16 -+ #define pu2Byte u16* -+ -+ #define u4Byte u32 -+ #define pu4Byte u32* -+ -+ #define u8Byte u64 -+ #define pu8Byte u64* -+ -+ #define s1Byte s8 -+ #define ps1Byte s8* -+ -+ #define s2Byte s16 -+ #define ps2Byte s16* -+ -+ #define s4Byte s32 -+ #define ps4Byte s32* -+ -+ #define s8Byte s64 -+ #define ps8Byte s64* -+ -+#endif -+ #ifdef CONFIG_USB_HCI -+ #define DEV_BUS_TYPE RT_USB_INTERFACE -+ #elif defined(CONFIG_PCI_HCI) -+ #define DEV_BUS_TYPE RT_PCI_INTERFACE -+ #elif defined(CONFIG_SDIO_HCI) -+ #define DEV_BUS_TYPE RT_SDIO_INTERFACE -+ #elif defined(CONFIG_GSPI_HCI) -+ #define DEV_BUS_TYPE RT_SDIO_INTERFACE -+ #endif -+ -+ -+ #if defined(CONFIG_LITTLE_ENDIAN) -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE -+ #elif defined (CONFIG_BIG_ENDIAN) -+ #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG -+ #endif -+ -+ typedef struct timer_list RT_TIMER, *PRT_TIMER; -+ typedef void * RT_TIMER_CALL_BACK; -+ #define STA_INFO_T struct sta_info -+ #define PSTA_INFO_T struct sta_info * -+ -+ -+ -+ #define TRUE _TRUE -+ #define FALSE _FALSE -+ -+ -+ #define SET_TX_DESC_ANTSEL_A_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 1, __Value) -+ #define SET_TX_DESC_ANTSEL_B_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 25, 1, __Value) -+ #define SET_TX_DESC_ANTSEL_C_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 29, 1, __Value) -+ -+ //define useless flag to avoid compile warning -+ #define USE_WORKITEM 0 -+ #define FOR_BRAZIL_PRETEST 0 -+ #define FPGA_TWO_MAC_VERIFICATION 0 -+ #define RTL8881A_SUPPORT 0 -+ -+ #if (defined(TESTCHIP_SUPPORT)) -+ #define PHYDM_TESTCHIP_SUPPORT 1 -+ #else -+ #define PHYDM_TESTCHIP_SUPPORT 0 -+ #endif -+#endif -+ -+#define READ_NEXT_PAIR(v1, v2, i) do { if (i+2 >= ArrayLen) break; i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+#define COND_ELSE 2 -+#define COND_ENDIF 3 -+ -+#include "phydm_features.h" -+ -+#endif // __ODM_TYPES_H__ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtchnlplan.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtchnlplan.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtchnlplan.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtchnlplan.c 2018-02-11 21:44:27.158146254 +0200 -@@ -0,0 +1,481 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+/****************************************************************************** -+ -+ History: -+ Data Who Remark (Internal History) -+ -+ 05/14/2012 MH Collect RTK inernal infromation and generate channel plan draft. -+ -+******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+#include "rtchnlplan.h" -+ -+ -+ -+// -+// Channel Plan Domain Code -+// -+ -+/* -+ Channel Plan Contents -+ Domain Code EEPROM Countries in Specific Domain -+ 2G RD 5G RD Bit[6:0] 2G 5G -+ Case Old Define 00h~1Fh Old Define Old Define -+ 1 2G_WORLD 5G_NULL 20h Worldwird 13 NA -+ 2 2G_ETSI1 5G_NULL 21h Europe 2G NA -+ 3 2G_FCC1 5G_NULL 22h US 2G NA -+ 4 2G_MKK1 5G_NULL 23h Japan 2G NA -+ 5 2G_ETSI2 5G_NULL 24h France 2G NA -+ 6 2G_FCC1 5G_FCC1 25h US 2G US 5G ¤K¤j°ê»{ÃÒ -+ 7 2G_WORLD 5G_ETSI1 26h Worldwird 13 Europe ¤K¤j°ê»{ÃÒ -+ 8 2G_MKK1 5G_MKK1 27h Japan 2G Japan 5G ¤K¤j°ê»{ÃÒ -+ 9 2G_WORLD 5G_KCC1 28h Worldwird 13 Korea ¤K¤j°ê»{ÃÒ -+ 10 2G_WORLD 5G_FCC2 29h Worldwird 13 US o/w DFS Channels -+ 11 2G_WORLD 5G_FCC3 30h Worldwird 13 India, Mexico -+ 12 2G_WORLD 5G_FCC4 31h Worldwird 13 Venezuela -+ 13 2G_WORLD 5G_FCC5 32h Worldwird 13 China -+ 14 2G_WORLD 5G_FCC6 33h Worldwird 13 Israel -+ 15 2G_FCC1 5G_FCC7 34h US 2G US/Canada ¤K¤j°ê»{ÃÒ -+ 16 2G_WORLD 5G_ETSI2 35h Worldwird 13 Australia, New Zealand ¤K¤j°ê»{ÃÒ -+ 17 2G_WORLD 5G_ETSI3 36h Worldwird 13 Russia -+ 18 2G_MKK1 5G_MKK2 37h Japan 2G Japan (W52, W53) -+ 19 2G_MKK1 5G_MKK3 38h Japan 2G Japan (W56) -+ 20 2G_FCC1 5G_NCC1 39h US 2G Taiwan ¤K¤j°ê»{ÃÒ -+ -+ NA 2G_WORLD 5G_FCC1 7F FCC FCC DFS Channels Realtek Define -+ -+ -+ -+ -+ -+ 2.4G Regulatory Domains -+ Case 2G RD Regulation Channels Frequencyes Note Countries in Specific Domain -+ 1 2G_WORLD ETSI 1~13 2412~2472 Passive scan CH 12, 13 Worldwird 13 -+ 2 2G_ETSI1 ETSI 1~13 2412~2472 Europe -+ 3 2G_FCC1 FCC 1~11 2412~2462 US -+ 4 2G_MKK1 MKK 1~13, 14 2412~2472, 2484 Japan -+ 5 2G_ETSI2 ETSI 10~13 2457~2472 France -+ -+ -+ -+ -+ 5G Regulatory Domains -+ Case 5G RD Regulation Channels Frequencyes Note Countries in Specific Domain -+ 1 5G_NULL NA NA NA Do not support 5GHz -+ 2 5G_ETSI1 ETSI "36~48, 52~64, -+ 100~140" "5180~5240, 5260~5230 -+ 5500~5700" Band1, Ban2, Band3 Europe -+ 3 5G_ETSI2 ETSI "36~48, 52~64, -+ 100~140, 149~165" "5180~5240, 5260~5230 -+ 5500~5700, 5745~5825" Band1, Ban2, Band3, Band4 Australia, New Zealand -+ 4 5G_ETSI3 ETSI "36~48, 52~64, -+ 100~132, 149~165" -+ "5180~5240, 5260~5230 -+ 5500~5660, 5745~5825" Band1, Ban2, Band3(except CH 136, 140), Band4" Russia -+ 5 5G_FCC1 FCC "36~48, 52~64, -+ 100~140, 149~165" -+ "5180~5240, 5260~5230 -+ 5500~5700, 5745~5825" Band1(5150~5250MHz), -+ Band2(5250~5350MHz), -+ Band3(5470~5725MHz), -+ Band4(5725~5850MHz)" US -+ 6 5G_FCC2 FCC 36~48, 149~165 5180~5240, 5745~5825 Band1, Band4 FCC o/w DFS Channels -+ 7 5G_FCC3 FCC "36~48, 52~64, -+ 149~165" "5180~5240, 5260~5230 -+ 5745~5825" Band1, Ban2, Band4 India, Mexico -+ 8 5G_FCC4 FCC "36~48, 52~64, -+ 149~161" "5180~5240, 5260~5230 -+ 5745~5805" Band1, Ban2, -+ Band4(except CH 165)" Venezuela -+ 9 5G_FCC5 FCC 149~165 5745~5825 Band4 China -+ 10 5G_FCC6 FCC 36~48, 52~64 5180~5240, 5260~5230 Band1, Band2 Israel -+ 11 5G_FCC7 -+ 5G_IC1 FCC -+ IC" "36~48, 52~64, -+ 100~116, 136, 140, -+ 149~165" "5180~5240, 5260~5230 -+ 5500~5580, 5680, 5700, -+ 5745~5825" "Band1, Band2, -+ Band3(except 5600~5650MHz), -+ Band4" "US -+ Canada" -+ 12 5G_KCC1 KCC "36~48, 52~64, -+ 100~124, 149~165" "5180~5240, 5260~5230 -+ 5500~5620, 5745~5825" "Band1, Ban2, -+ Band3(5470~5650MHz), -+ Band4" Korea -+ 13 5G_MKK1 MKK "36~48, 52~64, -+ 100~140" "5180~5240, 5260~5230 -+ 5500~5700" W52, W53, W56 Japan -+ 14 5G_MKK2 MKK 36~48, 52~64 5180~5240, 5260~5230 W52, W53 Japan (W52, W53) -+ 15 5G_MKK3 MKK 100~140 5500~5700 W56 Japan (W56) -+ 16 5G_NCC1 NCC "56~64, -+ 100~116, 136, 140, -+ 149~165" "5260~5320 -+ 5500~5580, 5680, 5700, -+ 5745~5825" "Band2(except CH 52), -+ Band3(except 5600~5650MHz), -+ Band4" Taiwan -+ -+ -+*/ -+ -+// -+// 2.4G CHannel -+// -+/* -+ -+ 2.4G Band Regulatory Domains RTL8192D -+ Channel Number Channel Frequency US Canada Europe Spain France Japan Japan 20M 40M -+ (MHz) (FCC) (IC) (ETSI) (MPHPT) -+ 1 2412 v v v v v -+ 2 2417 v v v v v -+ 3 2422 v v v v v v -+ 4 2427 v v v v v v -+ 5 2432 v v v v v v -+ 6 2437 v v v v v v -+ 7 2442 v v v v v v -+ 8 2447 v v v v v v -+ 9 2452 v v v v v v -+ 10 2457 v v v v v v v v -+ 11 2462 v v v v v v v v -+ 12 2467 v v v v v -+ 13 2472 v v v v -+ 14 2484 v v -+ -+ -+*/ -+ -+ -+// -+// 5G Operating Channel -+// -+/* -+ -+ 5G Band RTL8192D RTL8195 (Jaguar) Jaguar 2 Regulatory Domains -+ Channel Number Channel Frequency Global Global Global "US -+(FCC 15.407)" "Canada -+(FCC, except 5.6~5.65GHz)" Argentina, Australia, New Zealand, Brazil, S. Africa (FCC/ETSI) "Europe -+(CE 301 893)" China India, Mexico, Singapore Israel, Turkey "Japan -+(MIC Item 19-3, 19-3-2)" Korea Russia, Ukraine "Taiwan -+(NCC)" Venezuela -+ (MHz) (20MHz) (20MHz) (40MHz) (80MHz) (160MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) -+"Band 1 -+5.15GHz -+~ -+5.25GHz" 36 5180 v v v v v Indoor Indoor v Indoor v Indoor Indoor v v v -+ 40 5200 v v v Indoor Indoor v Indoor v Indoor Indoor v v v -+ 44 5220 v v v v Indoor Indoor v Indoor v Indoor Indoor v v v -+ 48 5240 v v v Indoor Indoor v Indoor v Indoor Indoor v v v -+"Band 2 -+5.25GHz -+~ -+5.35GHz -+(DFS)" 52 5260 v v v v v v v v Indoor v Indoor Indoor v v v -+ 56 5280 v v v v v v Indoor v Indoor Indoor v v Indoor v -+ 60 5300 v v v v v v v Indoor v Indoor Indoor v v Indoor v -+ 64 5320 v v v v v v Indoor v Indoor Indoor v v Indoor v -+ -+"Band 3 -+5.47GHz -+~ -+5.725GHz -+(DFS)" 100 5500 v v v v v v v v v v v v v -+ 104 5520 v v v v v v v v v v v -+ 108 5540 v v v v v v v v v v v v -+ 112 5560 v v v v v v v v v v v -+ 116 5580 v v v v v v v v v v v v v -+ 120 5600 v v v Indoor v Indoor v v v -+ 124 5620 v v v v Indoor v Indoor v v v -+ 128 5640 v v v Indoor v Indoor v v -+ 132 5660 v v v E v Indoor v Indoor v v -+ 136 5680 v v v v v v v v v -+ 140 5700 v v E v v v v v v v -+ 144 5720 E E E -+"Band 4 -+5.725GHz -+~ -+5.85GHz -+(~5.9GHz)" 149 5745 v v v v v v v v v v v v v v -+ 153 5765 v v v v v v v v v v v v -+ 157 5785 v v v v v v v v v v v v v -+ 161 5805 v v v v v v v v v v v v -+ 165 5825 v v P P v v v v v v v v v -+ 169 5845 P P P -+ 173 5865 P P P P -+ 177 5885 P P P -+Channel Count 28 28 14 7 0 28 24 20 24 19 5 13 8 19 20 22 15 12 -+ E: FCC accepted the ask for CH144 from Accord. PS: 160MHz ¥Î 80MHz+80MHz¹ê²{¡H Argentina Belgium (¤ñ§Q®É) India Israel Russia -+ P: Customer's requirement from James. Australia The Netherlands (²üÄõ) Mexico Turkey Ukraine -+ New Zealand UK (­^°ê) Singapore -+ Brazil Switzerland (·ç¤h) -+ -+ -+*/ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+ -+// define Maximum Power v.s each band for each region -+// ISRAEL -+// Format: -+// RT_CHANNEL_DOMAIN_Region ={{{Chnl_Start, Chnl_end, Pwr_dB_Max}, {Chn2_Start, Chn2_end, Pwr_dB_Max}, {Chn3_Start, Chn3_end, Pwr_dB_Max}, {Chn4_Start, Chn4_end, Pwr_dB_Max}, {Chn5_Start, Chn5_end, Pwr_dB_Max}}, Limit_Num} */ -+// RT_CHANNEL_DOMAIN_FCC ={{{01,11,30}, {36,48,17}, {52,64,24}, {100,140,24}, {149,165,30}}, 5} -+// "NR" is non-release channle. -+// Issue--- Israel--Russia--New Zealand -+// DOMAIN_01= (2G_WORLD, 5G_NULL) -+// DOMAIN_02= (2G_ETSI1, 5G_NULL) -+// DOMAIN_03= (2G_FCC1, 5G_NULL) -+// DOMAIN_04= (2G_MKK1, 5G_NULL) -+// DOMAIN_05= (2G_ETSI2, 5G_NULL) -+// DOMAIN_06= (2G_FCC1, 5G_FCC1) -+// DOMAIN_07= (2G_WORLD, 5G_ETSI1) -+// DOMAIN_08= (2G_MKK1, 5G_MKK1) -+// DOMAIN_09= (2G_WORLD, 5G_KCC1) -+// DOMAIN_10= (2G_WORLD, 5G_FCC2) -+// DOMAIN_11= (2G_WORLD, 5G_FCC3)----india -+// DOMAIN_12= (2G_WORLD, 5G_FCC4)----Venezuela -+// DOMAIN_13= (2G_WORLD, 5G_FCC5)----China -+// DOMAIN_14= (2G_WORLD, 5G_FCC6)----Israel -+// DOMAIN_15= (2G_FCC1, 5G_FCC7)-----Canada -+// DOMAIN_16= (2G_WORLD, 5G_ETSI2)---Australia -+// DOMAIN_17= (2G_WORLD, 5G_ETSI3)---Russia -+// DOMAIN_18= (2G_MKK1, 5G_MKK2)-----Japan -+// DOMAIN_19= (2G_MKK1, 5G_MKK3)-----Japan -+// DOMAIN_20= (2G_FCC1, 5G_NCC1)-----Taiwan -+// DOMAIN_21= (2G_FCC1, 5G_NCC1)-----Taiwan -+ -+ -+static RT_CHANNEL_PLAN_MAXPWR ChnlPlanPwrMax_2G[] = { -+ -+ // 2G_WORLD, -+ {{1, 13, 20}, 1}, -+ -+ // 2G_ETSI1 -+ {{1, 13, 20}, 1}, -+ -+ /* RT_CHANNEL_DOMAIN_ETSI */ -+ {{{1, 11, 17}, {40, 56, 17}, {60, 128, 17}, {0, 0, 0}, {149, 165, 17}}, 4}, -+ -+ // RT_CHANNEL_DOMAIN_MKK -+ {{{1, 11, 17}, {0, 0, 0}, {0, 0, 0}, {0, 0, 0}, {0, 0, 0}}, 1}, -+ -+ // Add new channel plan mex power table. -+ // ...... -+ }; -+ -+ -+/* -+//===========================================1:(2G_WORLD, 5G_NULL) -+ -+RT_CHANNEL_PLAN_MAXPWR RT_DOMAIN_01 ={{{01,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} -+ -+//===========================================2:(2G_ETSI1, 5G_NULL) -+ -+RT_DOMAIN_02 ={{{01,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} -+ -+//===========================================3:(2G_FCC1, 5G_NULL) -+ -+RT_DOMAIN_03 ={{{01,11,30}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} -+ -+//===========================================4:(2G_MKK1, 5G_NULL) -+ -+RT_DOMAIN_04 ={{{01,14,23}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} -+ -+//===========================================5:(2G_ETSI2, 5G_NULL) -+ -+RT_DOMAIN_05 ={{{10,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} -+ -+//===========================================6:(2G_FCC1, 5G_FCC1) -+ -+RT_DOMAIN_06 ={{{01,13,30}, {36,48,17}, {52,64,24}, {100,140,24}, {149,165,30}}, 5} -+ -+//===========================================7:(2G_WORLD, 5G_ETSI1) -+ -+RT_DOMAIN_07 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,140,30}, {NR,NR,0}}, 4} -+ -+//===========================================8:(2G_MKK1, 5G_MKK1) -+ -+RT_DOMAIN_08 ={{{01,14,23}, {36,48,23}, {52,64,23}, {100,140,23}, {NR,NR,0}}, 4} -+ -+//===========================================9:(2G_WORLD, 5G_KCC1) -+ -+RT_DOMAIN_09 ={{{01,13,20}, {36,48,17}, {52,64,23}, {100,124,23}, {149,165,23}}, 5} -+ -+//===========================================10:(2G_WORLD, 5G_FCC2) -+ -+RT_DOMAIN_10 ={{{01,13,20}, {36,48,17}, {NR,NR,0}, {NR,NR,0}, {149,165,30}}, 3} -+ -+//===========================================11:(2G_WORLD, 5G_FCC3) -+RT_DOMAIN_11 ={{{01,13,20}, {36,48,23}, {52,64,23}, {NR,NR,0}, {149,165,23}}, 4} -+ -+//===========================================12:(2G_WORLD, 5G_FCC4) -+RT_DOMAIN_12 ={{{01,13,20}, {36,48,24}, {52,64,24}, {NR,NR,0}, {149,161,27}}, 4} -+ -+//===========================================13:(2G_WORLD, 5G_FCC5) -+RT_DOMAIN_13 ={{{01,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {149,165,27}}, 2} -+ -+//===========================================14:(2G_WORLD, 5G_FCC6) -+RT_DOMAIN_14 ={{{01,13,20}, {36,48,17}, {52,64,17}, {NR,NR,0}, {NR,NR,0}}, 3} -+ -+//===========================================15:(2G_FCC1, 5G_FCC7) -+RT_DOMAIN_15 ={{{01,11,30}, {36,48,23}, {52,64,24}, {100,140,24}, {149,165,30}}, 5} -+ -+//===========================================16:(2G_WORLD, 5G_ETSI2) -+RT_DOMAIN_16 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,140,30}, {149,165,30}}, 5} -+ -+//===========================================17:(2G_WORLD, 5G_ETSI3) -+RT_DOMAIN_17 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,132,30}, {149,165,20}}, 5} -+ -+//===========================================18:(2G_MKK1, 5G_MKK2) -+RT_DOMAIN_18 ={{{01,14,23}, {36,48,23}, {52,64,23}, {NR,NR,0}, {NR,NR,0}}, 3} -+ -+//===========================================19:(2G_MKK1, 5G_MKK3) -+RT_DOMAIN_19 ={{{01,14,23}, {NR,NR,0}, {NR,NR,0}, {100,140,23}, {NR,NR,0}}, 2} -+ -+//===========================================20:(2G_FCC1, 5G_NCC1) -+RT_DOMAIN_20 ={{{01,11,30}, {NR,NR,0}, {56,64,23}, {100,140,24}, {149,165,30}}, 4} -+ -+//===========================================21:(2G_FCC1, 5G_NCC2) -+RT_DOMAIN_21 ={{{01,11,30}, {NR,NR,0}, {56,64,23}, {NR,NR,0}, {149,165,30}}, 3} -+ -+//===========================================22:(2G_WORLD, 5G_FCC3) -+RT_DOMAIN_22 ={{{01,13,24}, {36,48,20}, {52,64,24}, {NR,NR,0}, {149,165,30}}, 4} -+ -+//===========================================23:(2G_WORLD, 5G_ETSI2) -+RT_DOMAIN_23 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,140,30}, {149,165,30}}, 5} -+ -+*/ -+ -+// -+// Counter & Realtek Channel plan transfer table. -+// -+RT_CHNL_CTRY_TBL RtCtryChnlTbl[] = -+{ -+ -+ { -+ RT_CTRY_AL, // "Albaniaªüº¸¤Ú¥§¨È" -+ "AL", -+ RT_2G_WORLD, -+ RT_5G_WORLD, -+ RT_CHANNEL_DOMAIN_UNDEFINED // 2G/5G world. -+ }, -+#if 0 -+ { -+ RT_CTRY_BB, // "Barbados¤Ú¤Ú¦h´µ" -+ "BB", -+ RT_2G_WORLD, -+ RT_5G_NULL, -+ RT_CHANNEL_DOMAIN_EFUSE_0x20 // 2G world. 5G_NULL -+ }, -+ -+ { -+ RT_CTRY_DE, // "Germany¼w°ê" -+ "DE", -+ RT_2G_WORLD, -+ RT_5G_ETSI1, -+ RT_CHANNEL_DOMAIN_EFUSE_0x26 -+ }, -+ -+ { -+ RT_CTRY_US, // "Germany¼w°ê" -+ "US", -+ RT_2G_FCC1, -+ RT_5G_FCC7, -+ RT_CHANNEL_DOMAIN_EFUSE_0x34 -+ }, -+ -+ { -+ RT_CTRY_JP, // "Germany¼w°ê" -+ "JP", -+ RT_2G_MKK1, -+ RT_5G_MKK1, -+ RT_CHANNEL_DOMAIN_EFUSE_0x34 -+ }, -+ -+ { -+ RT_CTRY_TW, // "Germany¼w°ê" -+ "TW", -+ RT_2G_FCC1, -+ RT_5G_NCC1, -+ RT_CHANNEL_DOMAIN_EFUSE_0x39 -+ }, -+#endif -+ -+}; // RtCtryChnlTbl -+ -+// -+// Realtek Defined Channel plan. -+// -+#if 0 -+ -+static RT_CHANNEL_PLAN_NEW RtChnlPlan[] = -+{ -+ // Channel Plan 0x20. -+ { -+ &RtCtryChnlTbl[1], // RT_CHNL_CTRY_TBL Country & channel plan transfer table. -+ RT_CHANNEL_DOMAIN_EFUSE_0x20, // RT_CHANNEL_DOMAIN RT Channel Plan Define -+ RT_2G_WORLD, // RT_REGULATION_2G -+ RT_5G_NULL, // RT_REGULATION_5G -+ RT_WORLD, // RT_REGULATION_CMN RT Regulatory domain definition. -+ RT_SREQ_NA, // RT Channel plan special & customerize requirement. -+ -+ CHNL_RT_2G_WORLD, -+ CHNL_RT_2G_WORLD_SCAN_TYPE, -+ &ChnlPlanPwrMax_2G[0], -+ -+ CHNL_RT_5G_NULL, -+ CHNL_RT_5G_NULL_SCAN_TYPE, -+ -+ -+ }, -+ -+ // Channel Plan 0x26. -+ { -+ &RtCtryChnlTbl[1], // RT_CHNL_CTRY_TBL Country & channel plan transfer table. -+ RT_CHANNEL_DOMAIN_EFUSE_0x26, // RT_CHANNEL_DOMAIN RT Channel Plan Define -+ RT_2G_WORLD, // RT_REGULATION_2G -+ RT_5G_ETSI1, // RT_REGULATION_5G -+ RT_WORLD, // RT_REGULATION_CMN RT Regulatory domain definition. -+ RT_SREQ_NA, // RT Channel plan special & customerize requirement. -+ -+ CHNL_RT_2G_WORLD, // 2G workd cannel -+ CHNL_RT_2G_WORLD_SCAN_TYPE, -+ &ChnlPlanPwrMax_2G[1], -+ -+ CHNL_RT_5G_ETSI1, -+ CHNL_RT_5G_ETSI1_SCAN_TYPE, -+ -+ } -+ -+ -+}; -+#endif -+ -+ -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtchnlplan.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtchnlplan.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtchnlplan.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtchnlplan.h 2018-02-11 21:44:27.158146254 +0200 -@@ -0,0 +1,699 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __RT_CHANNELPLAN_H__ -+#define __RT_CHANNELPLAN_H__ -+ -+typedef enum _RT_CHANNEL_DOMAIN_NEW -+{ -+ -+ //===== Add new channel plan above this line ===============// -+ -+ // For new architecture we define different 2G/5G CH area for all country. -+ // 2.4 G only -+ RT_CHANNEL_DOMAIN_2G_WORLD_5G_NULL = 0x20, -+ RT_CHANNEL_DOMAIN_2G_ETSI1_5G_NULL = 0x21, -+ RT_CHANNEL_DOMAIN_2G_FCC1_5G_NULL = 0x22, -+ RT_CHANNEL_DOMAIN_2G_MKK1_5G_NULL = 0x23, -+ RT_CHANNEL_DOMAIN_2G_ETSI2_5G_NULL = 0x24, -+ // 2.4 G + 5G type 1 -+ RT_CHANNEL_DOMAIN_2G_FCC1_5G_FCC1 = 0x25, -+ RT_CHANNEL_DOMAIN_2G_WORLD_5G_ETSI1 = 0x26, -+ //RT_CHANNEL_DOMAIN_2G_WORLD_5G_ETSI1 = 0x27, -+ // ..... -+ -+ RT_CHANNEL_DOMAIN_MAX_NEW, -+ -+}RT_CHANNEL_DOMAIN_NEW, *PRT_CHANNEL_DOMAIN_NEW; -+ -+ -+#if 0 -+#define DOMAIN_CODE_2G_WORLD \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -+#define DOMAIN_CODE_2G_ETSI1 \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -+#define DOMAIN_CODE_2G_ETSI2 \ -+ {1,2,3,4,5,6,7,8,9,10,11}, 11 -+#define DOMAIN_CODE_2G_FCC1 \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13,14}, 14 -+#define DOMAIN_CODE_2G_MKK1 \ -+ {10,11,12,13}, 4 -+ -+#define DOMAIN_CODE_5G_ETSI1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -+#define DOMAIN_CODE_5G_ETSI2 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -+#define DOMAIN_CODE_5G_ETSI3 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165}, 22 -+#define DOMAIN_CODE_5G_FCC1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -+#define DOMAIN_CODE_5G_FCC2 \ -+ {36,40,44,48,149,153,157,161,165}, 9 -+#define DOMAIN_CODE_5G_FCC3 \ -+ {36,40,44,48,52,56,60,64,149,153,157,161,165}, 13 -+#define DOMAIN_CODE_5G_FCC4 \ -+ {36,40,44,48,52,56,60,64,149,153,157,161}, 12 -+#define DOMAIN_CODE_5G_FCC5 \ -+ {149,153,157,161,165}, 5 -+#define DOMAIN_CODE_5G_FCC6 \ -+ {36,40,44,48,52,56,60,64}, 8 -+#define DOMAIN_CODE_5G_FCC7 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -+#define DOMAIN_CODE_5G_IC1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -+#define DOMAIN_CODE_5G_KCC1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165}, 20 -+#define DOMAIN_CODE_5G_MKK1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -+#define DOMAIN_CODE_5G_MKK2 \ -+ {36,40,44,48,52,56,60,64}, 8 -+#define DOMAIN_CODE_5G_MKK3 \ -+ {100,104,108,112,116,120,124,128,132,136,140}, 11 -+#define DOMAIN_CODE_5G_NCC1 \ -+ {56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 24 -+#define DOMAIN_CODE_5G_NCC2 \ -+ {56,60,64,149,153,157,161,165}, 8 -+#define UNDEFINED \ -+ {0}, 0 -+#endif -+ -+// -+// -+// -+/* -+ -+Countries "Country Abbreviation" Domain Code SKU's Ch# of 20MHz -+ 2G 5G Ch# of 40MHz -+"Albaniaªüº¸¤Ú¥§¨È" AL Local Test -+ -+"Algeriaªüº¸¤Î§Q¨È" DZ CE TCF -+ -+"Antigua & Barbuda¦w´£¥Ê®q&¤Ú¥¬¹F" AG 2G_WORLD FCC TCF -+ -+"Argentinaªü®Ú§Ê" AR 2G_WORLD Local Test -+ -+"Armenia¨È¬ü¥§¨È" AM 2G_WORLD ETSI -+ -+"Arubaªü¾|¤Ú®q" AW 2G_WORLD FCC TCF -+ -+"Australia¿D¬w" AU 2G_WORLD 5G_ETSI2 -+ -+"Austria¶ø¦a§Q" AT 2G_WORLD 5G_ETSI1 CE -+ -+"Azerbaijanªü¶ë«ô¾Ê" AZ 2G_WORLD CE TCF -+ -+"Bahamas¤Ú«¢°¨" BS 2G_WORLD -+ -+"Barbados¤Ú¤Ú¦h´µ" BB 2G_WORLD FCC TCF -+ -+"Belgium¤ñ§Q®É" BE 2G_WORLD 5G_ETSI1 CE -+ -+"Bermuda¦Ê¼}¹F" BM 2G_WORLD FCC TCF -+ -+"Brazil¤Ú¦è" BR 2G_WORLD Local Test -+ -+"Bulgaria«O¥[§Q¨È" BG 2G_WORLD 5G_ETSI1 CE -+ -+"Canada¥[®³¤j" CA 2G_FCC1 5G_FCC7 IC / FCC IC / FCC -+ -+"Cayman Islands¶}°Ò¸s®q" KY 2G_WORLD 5G_ETSI1 CE -+ -+"Chile´¼§Q" CL 2G_WORLD FCC TCF -+ -+"China¤¤°ê" CN 2G_WORLD 5G_FCC5 «H³¡?¡i2002¡j353? -+ -+"Columbia­ô­Û¤ñ¨È" CO 2G_WORLD Voluntary -+ -+"Costa Rica­ô´µ¹F¾¤¥[" CR 2G_WORLD FCC TCF -+ -+"Cyprus¶ë®ú¸ô´µ" CY 2G_WORLD 5G_ETSI1 CE -+ -+"Czech ±¶§J" CZ 2G_WORLD 5G_ETSI1 CE -+ -+"Denmark¤¦³Á" DK 2G_WORLD 5G_ETSI1 CE -+ -+"Dominican Republic¦h©ú¥§¥[¦@©M°ê" DO 2G_WORLD FCC TCF -+ -+"Egypt®J¤Î" EG 2G_WORLD CE T CF -+ -+"El SalvadorÂĺ¸¥Ë¦h" SV 2G_WORLD Voluntary -+ -+"Estonia·R¨F¥§¨È" EE 2G_WORLD 5G_ETSI1 CE -+ -+"FinlandªâÄõ" FI 2G_WORLD 5G_ETSI1 CE -+ -+"Franceªk°ê" FR 5G_E TSI1 CE -+ -+"Germany¼w°ê" DE 2G_WORLD 5G_ETSI1 CE -+ -+"Greece §Æþ" GR 2G_WORLD 5G_ETSI1 CE -+ -+"GuamÃö®q" GU 2G_WORLD -+ -+"Guatemala¥Ê¦a°¨©Ô" GT 2G_WORLD -+ -+"Haiti®ü¦a" HT 2G_WORLD FCC TCF -+ -+"Honduras§»³£©Ô´µ" HN 2G_WORLD FCC TCF -+ -+"Hungary¦I¤ú§Q" HU 2G_WORLD 5G_ETSI1 CE -+ -+"Iceland¦B®q" IS 2G_WORLD 5G_ETSI1 CE -+ -+"India¦L«×" IN 2G_WORLD 5G_FCC3 FCC/CE TCF -+ -+"Ireland·Rº¸Äõ" IE 2G_WORLD 5G_ETSI1 CE -+ -+"Israel¥H¦â¦C" IL 5G_F CC6 CE TCF -+ -+"Italy¸q¤j§Q" IT 2G_WORLD 5G_ETSI1 CE -+ -+"Japan¤é¥»" JP 2G_MKK1 5G_MKK1 MKK MKK -+ -+"KoreaÁú°ê" KR 2G_WORLD 5G_KCC1 KCC KCC -+ -+"Latvia©Ô²æºû¨È" LV 2G_WORLD 5G_ETSI1 CE -+ -+"Lithuania¥ß³³©{" LT 2G_WORLD 5G_ETSI1 CE -+ -+"Luxembourg¿c´Ë³ù" LU 2G_WORLD 5G_ETSI1 CE -+ -+"Malaysia°¨¨Ó¦è¨È" MY 2G_WORLD Local Test -+ -+"Malta°¨º¸¥L" MT 2G_WORLD 5G_ETSI1 CE -+ -+"Mexico¾¥¦è­ô" MX 2G_WORLD 5G_FCC3 Local Test -+ -+"Morocco¼¯¬¥­ô" MA CE TCF -+ -+"Netherlands²üÄõ" NL 2G_WORLD 5G_ETSI1 CE -+ -+"New Zealand¯Ã¦èÄõ" NZ 2G_WORLD 5G_ETSI2 -+ -+"Norway®¿«Â" NO 2G_WORLD 5G_ETSI1 CE -+ -+"Panama¤Ú®³°¨ " PA 2G_FCC1 Voluntary -+ -+"Philippinesµá«ß»«" PH 2G_WORLD FCC TCF -+ -+"PolandªiÄõ" PL 2G_WORLD 5G_ETSI1 CE -+ -+"Portugal¸²µå¤ú" PT 2G_WORLD 5G_ETSI1 CE -+ -+"Romaniaù°¨¥§¨È" RO 2G_WORLD 5G_ETSI1 CE -+ -+"Russia«Xù´µ" RU 2G_WORLD 5G_ETSI3 CE TCF -+ -+"Saudi Arabia¨F¦aªü©Ô§B" SA 2G_WORLD CE TCF -+ -+"Singapore·s¥[©Y" SG 2G_WORLD -+ -+"Slovakia´µ¬¥¥ï§J" SK 2G_WORLD 5G_ETSI1 CE -+ -+"Slovenia´µ¬¥ºû¥§¨È" SI 2G_WORLD 5G_ETSI1 CE -+ -+"South Africa«n«D" ZA 2G_WORLD CE TCF -+ -+"Spain¦è¯Z¤ú" ES 5G_ETSI1 CE -+ -+"Sweden·ç¨å" SE 2G_WORLD 5G_ETSI1 CE -+ -+"Switzerland·ç¤h" CH 2G_WORLD 5G_ETSI1 CE -+ -+"Taiwan»OÆW" TW 2G_FCC1 5G_NCC1 NCC -+ -+"Thailand®õ°ê" TH 2G_WORLD FCC/CE TCF -+ -+"Turkey¤g¦Õ¨ä" TR 2G_WORLD -+ -+"Ukraine¯Q§JÄõ" UA 2G_WORLD Local Test -+ -+"United Kingdom­^°ê" GB 2G_WORLD 5G_ETSI1 CE ETSI -+ -+"United States¬ü°ê" US 2G_FCC1 5G_FCC7 FCC FCC -+ -+"Venezuela©e¤º·ç©Ô" VE 2G_WORLD 5G_FCC4 FCC TCF -+ -+"Vietnam¶V«n" VN 2G_WORLD FCC/CE TCF -+ -+ -+ -+*/ -+ -+// Counter abbervation. -+typedef enum _RT_COUNTRY_DEFINE_NUM -+{ -+ RT_CTRY_AL, // "Albaniaªüº¸¤Ú¥§¨È" -+ RT_CTRY_DZ, // "Algeriaªüº¸¤Î§Q¨È" -+ RT_CTRY_AG, // "Antigua & Barbuda¦w´£¥Ê®q&¤Ú¥¬¹F" -+ RT_CTRY_AR, // "Argentinaªü®Ú§Ê" -+ RT_CTRY_AM, // "Armenia¨È¬ü¥§¨È" -+ RT_CTRY_AW, // "Arubaªü¾|¤Ú®q" -+ RT_CTRY_AU, // "Australia¿D¬w" -+ RT_CTRY_AT, // "Austria¶ø¦a§Q" -+ RT_CTRY_AZ, // "Azerbaijanªü¶ë«ô¾Ê" -+ RT_CTRY_BS, // "Bahamas¤Ú«¢°¨" -+ RT_CTRY_BB, // "Barbados¤Ú¤Ú¦h´µ" -+ RT_CTRY_BE, // "Belgium¤ñ§Q®É" -+ RT_CTRY_BM, // "Bermuda¦Ê¼}¹F" -+ RT_CTRY_BR, // "Brazil¤Ú¦è" -+ RT_CTRY_BG, // "Bulgaria«O¥[§Q¨È" -+ RT_CTRY_CA, // "Canada¥[®³¤j" -+ RT_CTRY_KY, // "Cayman Islands¶}°Ò¸s®q" -+ RT_CTRY_CL, // "Chile´¼§Q" -+ RT_CTRY_CN, // "China¤¤°ê" -+ RT_CTRY_CO, // "Columbia­ô­Û¤ñ¨È" -+ RT_CTRY_CR, // "Costa Rica­ô´µ¹F¾¤¥[" -+ RT_CTRY_CY, // "Cyprus¶ë®ú¸ô´µ" -+ RT_CTRY_CZ, // "Czech ±¶§J" -+ RT_CTRY_DK, // "Denmark¤¦³Á" -+ RT_CTRY_DO, // "Dominican Republic¦h©ú¥§¥[¦@©M°ê" -+ RT_CTRY_CE, // "Egypt®J¤Î" EG 2G_WORLD -+ RT_CTRY_SV, // "El SalvadorÂĺ¸¥Ë¦h" -+ RT_CTRY_EE, // "Estonia·R¨F¥§¨È" -+ RT_CTRY_FI, // "FinlandªâÄõ" -+ RT_CTRY_FR, // "Franceªk°ê" -+ RT_CTRY_DE, // "Germany¼w°ê" -+ RT_CTRY_GR, // "Greece §Æþ" -+ RT_CTRY_GU, // "GuamÃö®q" -+ RT_CTRY_GT, // "Guatemala¥Ê¦a°¨©Ô" -+ RT_CTRY_HT, // "Haiti®ü¦a" -+ RT_CTRY_HN, // "Honduras§»³£©Ô´µ" -+ RT_CTRY_HU, // "Hungary¦I¤ú§Q" -+ RT_CTRY_IS, // "Iceland¦B®q" -+ RT_CTRY_IN, // "India¦L«×" -+ RT_CTRY_IE, // "Ireland·Rº¸Äõ" -+ RT_CTRY_IL, // "Israel¥H¦â¦C" -+ RT_CTRY_IT, // "Italy¸q¤j§Q" -+ RT_CTRY_JP, // "Japan¤é¥»" -+ RT_CTRY_KR, // "KoreaÁú°ê" -+ RT_CTRY_LV, // "Latvia©Ô²æºû¨È" -+ RT_CTRY_LT, // "Lithuania¥ß³³©{" -+ RT_CTRY_LU, // "Luxembourg¿c´Ë³ù" -+ RT_CTRY_MY, // "Malaysia°¨¨Ó¦è¨È" -+ RT_CTRY_MT, // "Malta°¨º¸¥L" -+ RT_CTRY_MX, // "Mexico¾¥¦è­ô" -+ RT_CTRY_MA, // "Morocco¼¯¬¥­ô" -+ RT_CTRY_NL, // "Netherlands²üÄõ" -+ RT_CTRY_NZ, // "New Zealand¯Ã¦èÄõ" -+ RT_CTRY_NO, // "Norway®¿«Â" -+ RT_CTRY_PA, // "Panama¤Ú®³°¨ " -+ RT_CTRY_PH, // "Philippinesµá«ß»«" -+ RT_CTRY_PL, // "PolandªiÄõ" -+ RT_CTRY_PT, // "Portugal¸²µå¤ú" -+ RT_CTRY_RO, // "Romaniaù°¨¥§¨È" -+ RT_CTRY_RU, // "Russia«Xù´µ" -+ RT_CTRY_SA, // "Saudi Arabia¨F¦aªü©Ô§B" -+ RT_CTRY_SG, // "Singapore·s¥[©Y" -+ RT_CTRY_SK, // "Slovakia´µ¬¥¥ï§J" -+ RT_CTRY_SI, // "Slovenia´µ¬¥ºû¥§¨È" -+ RT_CTRY_ZA, // "South Africa«n«D" -+ RT_CTRY_ES, // "Spain¦è¯Z¤ú" -+ RT_CTRY_SE, // "Sweden·ç¨å" -+ RT_CTRY_CH, // "Switzerland·ç¤h" -+ RT_CTRY_TW, // "Taiwan»OÆW" -+ RT_CTRY_TH, // "Thailand®õ°ê" -+ RT_CTRY_TR, // "Turkey¤g¦Õ¨ä" -+ RT_CTRY_UA, // "Ukraine¯Q§JÄõ" -+ RT_CTRY_GB, // "United Kingdom­^°ê" -+ RT_CTRY_US, // "United States¬ü°ê" -+ RT_CTRY_VE, // "Venezuela©e¤º·ç©Ô" -+ RT_CTRY_VN, // "Vietnam¶V«n" -+ RT_CTRY_MAX, // -+ -+}RT_COUNTRY_NAME, *PRT_COUNTRY_NAME; -+ -+// Scan type including active and passive scan. -+typedef enum _RT_SCAN_TYPE_NEW -+{ -+ SCAN_NULL, -+ SCAN_ACT, -+ SCAN_PAS, -+ SCAN_BOTH, -+}RT_SCAN_TYPE_NEW, *PRT_SCAN_TYPE_NEW; -+ -+ -+// Power table sample. -+ -+typedef struct _RT_CHNL_PLAN_LIMIT -+{ -+ u2Byte Chnl_Start; -+ u2Byte Chnl_end; -+ -+ u2Byte Freq_Start; -+ u2Byte Freq_end; -+}RT_CHNL_PLAN_LIMIT, *PRT_CHNL_PLAN_LIMIT; -+ -+ -+// -+// 2.4G Regulatory Domains -+// -+typedef enum _RT_REGULATION_DOMAIN_2G -+{ -+ RT_2G_NULL, -+ RT_2G_WORLD, -+ RT_2G_ETSI1, -+ RT_2G_FCC1, -+ RT_2G_MKK1, -+ RT_2G_ETSI2 -+ -+}RT_REGULATION_2G, *PRT_REGULATION_2G; -+ -+ -+//typedef struct _RT_CHANNEL_BEHAVIOR -+//{ -+// u1Byte Chnl; -+// RT_SCAN_TYPE_NEW -+// -+//}RT_CHANNEL_BEHAVIOR, *PRT_CHANNEL_BEHAVIOR; -+ -+//typedef struct _RT_CHANNEL_PLAN_TYPE -+//{ -+// RT_CHANNEL_BEHAVIOR -+// u1Byte Chnl_num; -+//}RT_CHNL_PLAN_TYPE, *PRT_CHNL_PLAN_TYPE; -+ -+// -+// 2.4G Channel Number -+// Channel definition & number -+// -+#define CHNL_RT_2G_NULL \ -+ {0}, 0 -+#define CHNL_RT_2G_WORLD \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -+#define CHNL_RT_2G_WORLD_TEST \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -+ -+#define CHNL_RT_2G_EFSI1 \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -+#define CHNL_RT_2G_FCC1 \ -+ {1,2,3,4,5,6,7,8,9,10,11}, 11 -+#define CHNL_RT_2G_MKK1 \ -+ {1,2,3,4,5,6,7,8,9,10,11,12,13,14}, 14 -+#define CHNL_RT_2G_ETSI2 \ -+ {10,11,12,13}, 4 -+ -+// -+// 2.4G Channel Active or passive scan. -+// -+#define CHNL_RT_2G_NULL_SCAN_TYPE \ -+ {SCAN_NULL} -+#define CHNL_RT_2G_WORLD_SCAN_TYPE \ -+ {1,1,1,1,1,1,1,1,1,1,1,0,0} -+#define CHNL_RT_2G_EFSI1_SCAN_TYPE \ -+ {1,1,1,1,1,1,1,1,1,1,1,1,1} -+#define CHNL_RT_2G_FCC1_SCAN_TYPE \ -+ {1,1,1,1,1,1,1,1,1,1,1} -+#define CHNL_RT_2G_MKK1_SCAN_TYPE \ -+ {1,1,1,1,1,1,1,1,1,1,1,1,1,1} -+#define CHNL_RT_2G_ETSI2_SCAN_TYPE \ -+ {1,1,1,1} -+ -+ -+// -+// 2.4G Band & Frequency Section -+// Freqency start & end / band number -+// -+#define FREQ_RT_2G_NULL \ -+ {0}, 0 -+ // Passive scan CH 12, 13 -+#define FREQ_RT_2G_WORLD \ -+ {2412, 2472}, 1 -+#define FREQ_RT_2G_EFSI1 \ -+ {2412, 2472}, 1 -+#define FREQ_RT_2G_FCC1 \ -+ {2412, 2462}, 1 -+#define FREQ_RT_2G_MKK1 \ -+ {2412, 2484}, 1 -+#define FREQ_RT_2G_ETSI2 \ -+ {2457, 2472}, 1 -+ -+ -+// -+// 5G Regulatory Domains -+// -+typedef enum _RT_REGULATION_DOMAIN_5G -+{ -+ RT_5G_NULL, -+ RT_5G_WORLD, -+ RT_5G_ETSI1, -+ RT_5G_ETSI2, -+ RT_5G_ETSI3, -+ RT_5G_FCC1, -+ RT_5G_FCC2, -+ RT_5G_FCC3, -+ RT_5G_FCC4, -+ RT_5G_FCC5, -+ RT_5G_FCC6, -+ RT_5G_FCC7, -+ RT_5G_IC1, -+ RT_5G_KCC1, -+ RT_5G_MKK1, -+ RT_5G_MKK2, -+ RT_5G_MKK3, -+ RT_5G_NCC1, -+ -+}RT_REGULATION_5G, *PRT_REGULATION_5G; -+ -+// -+// 5G Channel Number -+// -+#define CHNL_RT_5G_NULL \ -+ {0}, 0 -+#define CHNL_RT_5G_WORLD \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -+#define CHNL_RT_5G_ETSI1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -+#define CHNL_RT_5G_ETSI2 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165}, 22 -+#define CHNL_RT_5G_ETSI3 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -+#define CHNL_RT_5G_FCC1 \ -+ {36,40,44,48,149,153,157,161,165}, 9 -+#define CHNL_RT_5G_FCC2 \ -+ {36,40,44,48,52,56,60,64,149,153,157,161,165}, 13 -+#define CHNL_RT_5G_FCC3 \ -+ {36,40,44,48,52,56,60,64,149,153,157,161}, 12 -+#define CHNL_RT_5G_FCC4 \ -+ {149,153,157,161,165}, 5 -+#define CHNL_RT_5G_FCC5 \ -+ {36,40,44,48,52,56,60,64}, 8 -+#define CHNL_RT_5G_FCC6 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -+#define CHNL_RT_5G_FCC7 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -+#define CHNL_RT_5G_IC1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165}, 20 -+#define CHNL_RT_5G_KCC1 \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -+#define CHNL_RT_5G_MKK1 \ -+ {36,40,44,48,52,56,60,64}, 8 -+#define CHNL_RT_5G_MKK2 \ -+ {100,104,108,112,116,120,124,128,132,136,140}, 11 -+#define CHNL_RT_5G_MKK3 \ -+ {56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 24 -+#define CHNL_RT_5G_NCC1 \ -+ {56,60,64,149,153,157,161,165}, 8 -+ -+// -+// 5G Channel Active or passive scan. -+// -+#define CHNL_RT_5G_NULL_SCAN_TYPE \ -+ {SCAN_NULL} -+#define CHNL_RT_5G_WORLD_SCAN_TYPE \ -+ {1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1} -+#define CHNL_RT_5G_ETSI1_SCAN_TYPE \ -+ {1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1} -+#define CHNL_RT_5G_ETSI2_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165}, 22 -+#define CHNL_RT_5G_ETSI3_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -+#define CHNL_RT_5G_FCC1_SCAN_TYPE \ -+ {36,40,44,48,149,153,157,161,165}, 9 -+#define CHNL_RT_5G_FCC2_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,149,153,157,161,165}, 13 -+#define CHNL_RT_5G_FCC3_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,149,153,157,161}, 12 -+#define CHNL_RT_5G_FCC4_SCAN_TYPE \ -+ {149,153,157,161,165}, 5 -+#define CHNL_RT_5G_FCC5_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64}, 8 -+#define CHNL_RT_5G_FCC6_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -+#define CHNL_RT_5G_FCC7_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -+#define CHNL_RT_5G_IC1_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165}, 20 -+#define CHNL_RT_5G_KCC1_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -+#define CHNL_RT_5G_MKK1_SCAN_TYPE \ -+ {36,40,44,48,52,56,60,64}, 8 -+#define CHNL_RT_5G_MKK2_SCAN_TYPE \ -+ {100,104,108,112,116,120,124,128,132,136,140}, 11 -+#define CHNL_RT_5G_MKK3_SCAN_TYPE \ -+ {56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 24 -+#define CHNL_RT_5G_NCC1_SCAN_TYPE \ -+ {56,60,64,149,153,157,161,165}, 8 -+ -+// -+// Global Regulation -+// -+typedef enum _RT_REGULATION_COMMON -+{ -+ RT_WORLD, -+ RT_FCC, -+ RT_MKK, -+ RT_ETSI, -+ RT_IC, -+ RT_CE, -+ RT_NCC, -+ -+}RT_REGULATION_CMN, *PRT_REGULATION_CMN; -+ -+ -+ -+// -+// Special requirement for different regulation domain. -+// For internal test or customerize special request. -+// -+typedef enum _RT_CHNLPLAN_SREQ -+{ -+ RT_SREQ_NA = 0x0, -+ RT_SREQ_2G_ADHOC_11N = 0x00000001, -+ RT_SREQ_2G_ADHOC_11B = 0x00000002, -+ RT_SREQ_2G_ALL_PASS = 0x00000004, -+ RT_SREQ_2G_ALL_ACT = 0x00000008, -+ RT_SREQ_5G_ADHOC_11N = 0x00000010, -+ RT_SREQ_5G_ADHOC_11AC = 0x00000020, -+ RT_SREQ_5G_ALL_PASS = 0x00000040, -+ RT_SREQ_5G_ALL_ACT = 0x00000080, -+ RT_SREQ_C1_PLAN = 0x00000100, -+ RT_SREQ_C2_PLAN = 0x00000200, -+ RT_SREQ_C3_PLAN = 0x00000400, -+ RT_SREQ_C4_PLAN = 0x00000800, -+ RT_SREQ_NFC_ON = 0x00001000, -+ RT_SREQ_MASK = 0x0000FFFF, /* Requirements bit mask */ -+ -+}RT_CHNLPLAN_SREQ, *PRT_CHNLPLAN_SREQ; -+ -+ -+// -+// RT_COUNTRY_NAME & RT_REGULATION_2G & RT_REGULATION_5G transfer table -+// -+// -+typedef struct _RT_CHANNEL_PLAN_COUNTRY_TRANSFER_TABLE -+{ -+ // -+ // Define countery domain and corresponding -+ // -+ RT_COUNTRY_NAME Country_Enum; -+ char Country_Name[3]; -+ -+ //char Domain_Name[12]; -+ RT_REGULATION_2G Domain_2G; -+ -+ RT_REGULATION_5G Domain_5G; -+ -+ RT_CHANNEL_DOMAIN RtChDomain; -+ //u1Byte Country_Area; -+ -+}RT_CHNL_CTRY_TBL, *PRT_CHNL_CTRY_TBL; -+ -+ -+#define RT_MAX_CHNL_NUM_2G 13 -+#define RT_MAX_CHNL_NUM_5G 44 -+ -+// Power table sample. -+ -+typedef struct _RT_CHNL_PLAN_PWR_LIMIT -+{ -+ u2Byte Chnl_Start; -+ u2Byte Chnl_end; -+ u1Byte dB_Max; -+ u2Byte mW_Max; -+}RT_CHNL_PWR_LIMIT, *PRT_CHNL_PWR_LIMIT; -+ -+ -+#define RT_MAX_BAND_NUM 5 -+ -+typedef struct _RT_CHANNEL_PLAN_MAXPWR -+{ -+// STRING_T -+ RT_CHNL_PWR_LIMIT Chnl[RT_MAX_BAND_NUM]; -+ u1Byte Band_Useful_Num; -+ -+ -+}RT_CHANNEL_PLAN_MAXPWR, *PRT_CHANNEL_PLAN_MAXPWR; -+ -+ -+// -+// Power By Rate Table. -+// -+ -+ -+ -+typedef struct _RT_CHANNEL_PLAN_NEW -+{ -+ // -+ // Define countery domain and corresponding -+ // -+ //char Country_Name[36]; -+ //u1Byte Country_Enum; -+ -+ //char Domain_Name[12]; -+ -+ -+ PRT_CHNL_CTRY_TBL pCtryTransfer; -+ -+ RT_CHANNEL_DOMAIN RtChDomain; -+ -+ RT_REGULATION_2G Domain_2G; -+ -+ RT_REGULATION_5G Domain_5G; -+ -+ RT_REGULATION_CMN Regulator; -+ -+ RT_CHNLPLAN_SREQ ChnlSreq; -+ -+ //RT_CHNL_PLAN_LIMIT RtChnl; -+ -+ u1Byte Chnl2G[MAX_CHANNEL_NUM]; // CHNL_RT_2G_WORLD -+ u1Byte Len2G; -+ u1Byte Chnl2GScanTp[MAX_CHANNEL_NUM]; // CHNL_RT_2G_WORLD_SCAN_TYPE -+ //u1Byte Freq2G[2]; // FREQ_RT_2G_WORLD -+ -+ u1Byte Chnl5G[MAX_CHANNEL_NUM]; -+ u1Byte Len5G; -+ u1Byte Chnl5GScanTp[MAX_CHANNEL_NUM]; -+ //u1Byte Freq2G[2]; // FREQ_RT_2G_WORLD -+ -+ RT_CHANNEL_PLAN_MAXPWR ChnlMaxPwr; -+ -+ -+}RT_CHANNEL_PLAN_NEW, *PRT_CHANNEL_PLAN_NEW; -+ -+ -+#endif // __RT_CHANNELPLAN_H__ -+ -+ -+ -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/hal8723dreg.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/hal8723dreg.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/hal8723dreg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/hal8723dreg.h 2018-02-11 21:44:27.158146254 +0200 -@@ -0,0 +1,932 @@ -+/***************************************************************************** -+ * Copyright(c) 2009, RealTEK Technology Inc. All Right Reserved. -+ * -+ * Module: __INC_HAL8723DREG_H -+ * -+ * -+ * Note: 1. Define Mac register address and corresponding bit mask map -+ * -+ * -+ * Export: Constants, macro, functions(API), global variables(None). -+ * -+ * Abbrev: -+ * -+ * History: -+ * Data Who Remark -+ * -+ *****************************************************************************/ -+#ifndef __INC_HAL8723DREG_H -+#define __INC_HAL8723DREG_H -+ -+ -+ -+//============================================================ -+// -+//============================================================ -+ -+//----------------------------------------------------- -+// -+// 0x0000h ~ 0x00FFh System Configuration -+// -+//----------------------------------------------------- -+#define REG_SYS_ISO_CTRL_8723D 0x0000 // 2 Byte -+#define REG_SYS_FUNC_EN_8723D 0x0002 // 2 Byte -+#define REG_SYS_PW_CTRL_8723D 0x0004 // 4 Byte -+#define REG_SYS_CLKR_8723D 0x0008 // 2 Byte -+#define REG_SYS_EEPROM_CTRL_8723D 0x000A // 2 Byte -+#define REG_EE_VPD_8723D 0x000C // 2 Byte -+#define REG_SYS_SWR_CTRL1_8723D 0x0010 // 1 Byte -+#define REG_SYS_SWR_CTRL2_8723D 0x0014 // 1 Byte -+#define REG_SYS_SWR_CTRL3_8723D 0x0018 // 4 Byte -+#define REG_RSV_CTRL_8723D 0x001C // 3 Byte -+#define REG_RF_CTRL_8723D 0x001F // 1 Byte -+#define REG_AFE_CTRL1_8723D 0x0024 // 4 Byte -+#define REG_AFE_CTRL2_8723D 0x0028 // 4 Byte -+#define REG_AFE_CTRL3_8723D 0x002c // 4 Byte -+#define REG_EFUSE_CTRL_8723D 0x0030 -+#define REG_LDO_EFUSE_CTRL_8723D 0x0034 -+#define REG_PWR_DATA_8723D 0x0038 -+#define REG_CAL_TIMER_8723D 0x003C -+#define REG_ACLK_MON_8723D 0x003E -+#define REG_GPIO_MUXCFG_8723D 0x0040 -+#define REG_GPIO_IO_SEL_8723D 0x0042 -+#define REG_MAC_PINMUX_CFG_8723D 0x0043 // ?????? -+#define REG_GPIO_PIN_CTRL_8723D 0x0044 -+#define REG_GPIO_INTM_8723D 0x0048 -+#define BIT_REG_LED_CFG_8723D 0x004C -+#define REG_LEDCFG2_8723D 0x004E // ?????? -+#define REG_FSIMR_8723D 0x0050 -+#define REG_FSISR_8723D 0x0054 -+#define REG_HSIMR_8723D 0x0058 -+#define REG_HSISR_8723D 0x005c -+#define REG_GPIO_EXT_CTRL_8723D 0x0060 -+#define REG_MULTI_FUNC_CTRL_8723D 0x0068 -+#define REG_GPIO_STATUS_8723D 0x006C -+#define REG_SDIO_CTRL_8723D 0x0070 -+#define REG_HCI_OPT_CTRL_8723D 0x0074 -+#define REG_AFE_CTRL4_8723D 0x0078 -+#define REG_LDO_SWR_CTRL_8723D 0x007C -+#define REG_8051FW_CTRL_8723D 0x0080 -+#define REG_FW_DBG_STATUS_8723D 0x0088 -+#define REG_FW_DBG_CTRL_8723D 0x008F -+#define REG_WLLPS_CTRL_8723D 0x0090 -+#define REG_HIMR0_8723D 0x00B0 -+#define REG_HISR0_8723D 0x00B4 -+#define REG_HIMR1_8723D 0x00B8 -+#define REG_HISR1_8723D 0x00BC -+#define REG_PMC_DBG_CTRL2_8723D 0x00CC -+#define REG_EFUSE_BURN_GNT_8723D 0x00CF -+#define REG_XTAL_AAC_8723D 0x00EC -+#define REG_SYS_CFG1_8723D 0x00F0 -+#define REG_SYS_CFG2_8723D 0x00FC -+#define REG_ROM_VERSION 0x00FD -+ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+#define REG_CR_8723D 0x0100 -+#define REG_PBP_8723D 0x0104 // ?????? -+#define REG_PKT_BUFF_ACCESS_CTRL_8723D 0x0106 // ?????? -+#define REG_TRXDMA_CTRL_8723D 0x010C -+#define REG_TRXFF_BNDY_8723D 0x0114 -+#define REG_RXFF_PTR_8723D 0x011C -+#define REG_CPWM_8723D 0x012C -+#define REG_FWIMR_8723D 0x0130 -+#define REG_FWISR_8723D 0x0134 -+#define REG_FTIMR_8723D 0x0138 -+#define REG_PKTBUF_DBG_CTRL_8723D 0x0140 -+#define REG_RXPKTBUF_CTRL_8723D 0x0142 // ?????? -+#define REG_PKTBUF_DBG_DATA_L_8723D 0x0144 -+#define REG_PKTBUF_DBG_DATA_H_8723D 0x0148 -+ -+#define REG_TC0_CTRL_8723D 0x0150 -+#define REG_TC1_CTRL_8723D 0x0154 -+#define REG_TC2_CTRL_8723D 0x0158 -+#define REG_TC3_CTRL_8723D 0x015C -+#define REG_TC4_CTRL_8723D 0x0160 -+#define REG_TCUNIT_BASE_8723D 0x0164 -+#define REG_RSVD3_8723D 0x0168 // ????? -+ -+#define REG_C2HEVT_MSG_NORMAL_8723D 0x01A0 // ?????? -+#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 // ?????? -+#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 // ?????? -+#define REG_C2HEVT_CMD_LEN_88XX 0x01AE // ?????? -+#define REG_C2HEVT_CLEAR_8723D 0x01AF // ?????? -+#define REG_MCUTST_1_8723D 0x01C0 -+#define REG_MCUTST_2_8723D 0x01C4 -+#define REG_MCUTST_WOWLAN_8723D 0x01C7 // ?????? -+#define REG_FMETHR_8723D 0x01C8 -+#define REG_HMETFR_8723D 0x01CC -+#define REG_HMEBOX_0_8723D 0x01D0 -+#define REG_HMEBOX_1_8723D 0x01D4 -+#define REG_HMEBOX_2_8723D 0x01D8 -+#define REG_HMEBOX_3_8723D 0x01DC -+#define REG_LLT_INIT_8723D 0x01E0 -+#define REG_HMEBOX_EXT0_8723D 0x01F0 // ?????? -+#define REG_HMEBOX_EXT1_8723D 0x01F4 // ?????? -+#define REG_HMEBOX_EXT2_8723D 0x01F8 // ?????? -+#define REG_HMEBOX_EXT3_8723D 0x01FC // ?????? -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_RQPN_8723D 0x0200 -+#define REG_FIFOPAGE_8723D 0x0204 -+#define REG_TDECTRL_8723D 0x0208 -+#define REG_TXDMA_OFFSET_CHK_8723D 0x020C -+#define REG_TXDMA_STATUS_8723D 0x0210 -+#define REG_RQPN_NPQ_8723D 0x0214 -+#define REG_AUTO_LLT_8723D 0x0224 -+#define REG_DWBCN1_CTRL_8723D 0x0228 -+ -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_RXDMA_AGG_PG_TH_8723D 0x0280 -+#define REG_RXPKT_NUM_8723D 0x0284 // The number of packets in RXPKTBUF. -+#define REG_RXDMA_CONTROL_8723D 0x0286 // ?????? Control the RX DMA. -+#define REG_RXDMA_STATUS_8723D 0x0288 -+#define REG_RXDMA_PRO_8723D 0x0290 // ?????? -+#define REG_EARLY_MODE_CONTROL_8723D 0x02BC // ?????? -+#define REG_RSVD5_8723D 0x02F0 // ?????? -+ -+ -+//----------------------------------------------------- -+// -+// 0x0300h ~ 0x03FFh PCIe -+// -+//----------------------------------------------------- -+#define REG_PCIE_CTRL_REG_8723D 0x0300 -+#define REG_INT_MIG_8723D 0x0304 // Interrupt Migration -+#define REG_BCNQ_TXBD_DESA_8723D 0x0308 // TX Beacon Descriptor Address -+#define REG_MGQ_TXBD_DESA_8723D 0x0310 // TX Manage Queue Descriptor Address -+#define REG_VOQ_TXBD_DESA_8723D 0x0318 // TX VO Queue Descriptor Address -+#define REG_VIQ_TXBD_DESA_8723D 0x0320 // TX VI Queue Descriptor Address -+#define REG_BEQ_TXBD_DESA_8723D 0x0328 // TX BE Queue Descriptor Address -+#define REG_BKQ_TXBD_DESA_8723D 0x0330 // TX BK Queue Descriptor Address -+#define REG_RXQ_RXBD_DESA_8723D 0x0338 // RX Queue Descriptor Address -+#define REG_HI0Q_TXBD_DESA_8723D 0x0340 -+#define REG_HI1Q_TXBD_DESA_8723D 0x0348 -+#define REG_HI2Q_TXBD_DESA_8723D 0x0350 -+#define REG_HI3Q_TXBD_DESA_8723D 0x0358 -+#define REG_HI4Q_TXBD_DESA_8723D 0x0360 -+#define REG_HI5Q_TXBD_DESA_8723D 0x0368 -+#define REG_HI6Q_TXBD_DESA_8723D 0x0370 -+#define REG_HI7Q_TXBD_DESA_8723D 0x0378 -+#define REG_MGQ_TXBD_NUM_8723D 0x0380 -+#define REG_RX_RXBD_NUM_8723D 0x0382 -+#define REG_VOQ_TXBD_NUM_8723D 0x0384 -+#define REG_VIQ_TXBD_NUM_8723D 0x0386 -+#define REG_BEQ_TXBD_NUM_8723D 0x0388 -+#define REG_BKQ_TXBD_NUM_8723D 0x038A -+#define REG_HI0Q_TXBD_NUM_8723D 0x038C -+#define REG_HI1Q_TXBD_NUM_8723D 0x038E -+#define REG_HI2Q_TXBD_NUM_8723D 0x0390 -+#define REG_HI3Q_TXBD_NUM_8723D 0x0392 -+#define REG_HI4Q_TXBD_NUM_8723D 0x0394 -+#define REG_HI5Q_TXBD_NUM_8723D 0x0396 -+#define REG_HI6Q_TXBD_NUM_8723D 0x0398 -+#define REG_HI7Q_TXBD_NUM_8723D 0x039A -+#define REG_TSFTIMER_HCI_8723D 0x039C -+ -+//Read Write Point -+#define REG_VOQ_TXBD_IDX_8723D 0x03A0 -+#define REG_VIQ_TXBD_IDX_8723D 0x03A4 -+#define REG_BEQ_TXBD_IDX_8723D 0x03A8 -+#define REG_BKQ_TXBD_IDX_8723D 0x03AC -+#define REG_MGQ_TXBD_IDX_8723D 0x03B0 -+#define REG_RXQ_TXBD_IDX_8723D 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8723D 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8723D 0x03BC -+#define REG_HI2Q_TXBD_IDX_8723D 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8723D 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8723D 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8723D 0x03CC -+#define REG_HI6Q_TXBD_IDX_8723D 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8723D 0x03D4 -+ -+#define REG_PCIE_HCPWM_8723DE 0x03D8 // ?????? -+#define REG_PCIE_HRPWM_8723DE 0x03DC //PCIe RPWM // ?????? -+#define REG_DBI_WDATA_V1_8723D 0x03E8 -+#define REG_DBI_RDATA_V1_8723D 0x03EC -+#define REG_DBI_FLAG_V1_8723D 0x03F0 -+#define REG_MDIO_V1_8723D 0x03F4 -+#define REG_PCIE_MIX_CFG_8723D 0x03F8 -+#define REG_HCI_MIX_CFG_8723D 0x03FC -+ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+#define REG_TXPKT_EMPTY_8723D 0x041A -+#define REG_PTCL_POLL_MGN_8723D 0x041F -+#define REG_FWHW_TXQ_CTRL_8723D 0x0420 -+#define REG_HWSEQ_CTRL_8723D 0x0423 -+#define REG_BCNQ_BDNY_8723D 0x0424 -+#define REG_MGQ_BDNY_8723D 0x0425 -+#define REG_LIFETIME_EN_8723D 0x0426 -+#define REG_FW_FREE_TAIL_8723D 0x0427 -+#define REG_SPEC_SIFS_8723D 0x0428 -+#define REG_RETRY_LIMIT_8723D 0x042A -+#define REG_TXBF_CTRL_8723D 0x042C -+#define REG_DARFRC_8723D 0x0430 -+#define REG_RARFRC_8723D 0x0438 -+#define REG_RRSR_8723D 0x0440 -+#define REG_ARFR0_8723D 0x0444 -+#define REG_ARFR1_8723D 0x044C -+#define REG_CCK_CHECK_8723D 0x0454 -+#define REG_BCNQ2_BDNY_8723D 0x0455 -+#define REG_AMPDU_MAX_TIME_8723D 0x0456 -+#define REG_BCNQ1_BDNY_8723D 0x0457 -+#define REG_AMPDU_MAX_LENGTH_8723D 0x0458 -+#define REG_WMAC_LBK_BUF_HD_8723D 0x045D -+#define REG_NDPA_OPT_CTRL_8723D 0x045F -+#define REG_FAST_EDCA_CTRL_8723D 0x0460 -+#define REG_RD_RESP_PKT_TH_8723D 0x0463 -+#define REG_DATA_SC_8723D 0x0483 -+#define REG_TXRPT_START_OFFSET 0x04AC -+#define REG_POWER_STAGE1_8723D 0x04B4 -+#define REG_PTCL_SDF_STATUS_8723D 0x04BB -+#define REG_SW_AMPDU_BURST_MODE_CTRL_8723D 0x04BC -+#define REG_EVTQ_BNDY_8723D 0x04BF -+#define REG_PKT_LIFE_TIME_8723D 0x04C0 -+#define REG_PKT_BE_BK_LIFE_TIME_8723D 0x04C2 // ?????? -+ -+#define REG_STBC_SETTING_8723D 0x04C4 -+#define REG_HT_SINGLE_AMPDU_8723D 0x04C7 -+#define REG_PROT_MODE_CTRL_8723D 0x04C8 -+#define REG_MAX_AGGR_NUM_8723D 0x04CA -+#define REG_RTS_MAX_AGGR_NUM_8723D 0x04CB -+#define REG_BAR_MODE_CTRL_8723D 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8723D 0x04CF -+#define REG_MACID_SLEEP2_8723D 0x04D0 -+#define REG_PTCL_HWSSN0_8723D 0x04D8 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8723D 0x045D // ?????? -+ -+ -+/************* 0x1480~0x14A7 is for NAN ***************/ -+//Own Master Rank, 8Bytes -+#define REG_NAN_INTERFACE_ADDR_8723D 0x2480 // 6 bytes -+#define REG_NAN_RANDOM_FACTOR_8723D 0x2486 // 1 byte -+#define REG_NAN_MASTER_PREF_8723D 0x2487 // 1 byte -+ -+//0x5dc[25:24] NAN role -+ -+//Current Anchor Master Record -+#define REG_NAN_CAMR_L_8723D 0x2488 // 4 bytes -+#define REG_NAN_CAMR_H_8723D 0x248C // 4 byte -+//#define REG_HOP_CNT_8723D 0x05DC -+#define REG_NAN_CAMR_AMBTT_8723D 0x2490 // 4 bytes -+ -+//Last Anchor Master Record -+#define REG_NAN_LAMR_L_8723D 0x2494 // 4 bytes -+#define REG_NAN_LAMR_H_8723D 0x2498 // 4 byte -+#define REG_NAN_LAMR_AMBTT_8723D 0x249C // 4 bytes -+ -+//TSF Synced:bit 0 -+//Anchor Master: bit 7 -+#define REG_NAN_STATUS_8723D 0x24A0 //BIT0 -+/***************************************************/ -+ -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+// gogogo -+#define REG_EDCA_VO_PARAM_8723D 0x0500 -+#define REG_EDCA_VI_PARAM_8723D 0x0504 -+#define REG_EDCA_BE_PARAM_8723D 0x0508 -+#define REG_EDCA_BK_PARAM_8723D 0x050C -+#define REG_BCNTCFG_8723D 0x0510 -+#define REG_PIFS_8723D 0x0512 -+#define REG_RDG_PIFS_8723D 0x0513 -+#define REG_SIFS_CTX_8723D 0x0514 -+#define REG_SIFS_TRX_8723D 0x0516 -+#define REG_AGGR_BREAK_TIME_8723D 0x051A -+#define REG_SLOT_8723D 0x051B -+#define REG_TX_PTCL_CTRL_8723D 0x0520 -+#define REG_TXPAUSE_8723D 0x0522 -+#define REG_DIS_TXREQ_CLR_8723D 0x0523 -+#define REG_RD_CTRL_8723D 0x0524 -+// -+// Format for offset 540h-542h: -+// [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. -+// [7:4]: Reserved. -+// [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. -+// [23:20]: Reserved -+// Description: -+// | -+// |<--Setup--|--Hold------------>| -+// --------------|---------------------- -+// | -+// TBTT -+// Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. -+// Described by Designer Tim and Bruce, 2011-01-14. -+// -+#define REG_TBTT_PROHIBIT_8723D 0x0540 -+#define REG_RD_NAV_NXT_8723D 0x0544 -+#define REG_NAV_PROT_LEN_8723D 0x0546 -+#define REG_BCN_CTRL_8723D 0x0550 -+#define REG_EDCA_BCNCTRL1_IOREG_8723D 0x0551 -+#define REG_MBID_NUM_8723D 0x0552 -+#define REG_DUAL_TSF_RST_8723D 0x0553 -+#define REG_BCN_INTERVAL_8723D 0x0554 -+#define REG_DRVERLYINT_8723D 0x0558 -+#define REG_BCNDMATIM_8723D 0x0559 -+#define REG_ATIMWND_8723D 0x055A -+#define REG_USTIME_TSF_8723D 0x055C -+#define REG_BCN_MAX_ERR_8723D 0x055D -+#define REG_RXTSF_OFFSET_CCK_8723D 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8723D 0x055F -+#define REG_TSFTR_8723D 0x0560 -+#define REG_CTWND_8723D 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8723D 0x0577 // ?????? -+#define REG_TSFTR2_8723D 0x0578 -+#define REG_PSTIMER_8723D 0x0580 -+#define REG_TIMER0_8723D 0x0584 -+#define REG_TIMER1_8723D 0x0588 -+#define REG_SCH_MULTI_BCN_8723D 0x05B2 -+#define REG_SCH_CURRENT_BCN_8723D 0x05B3 -+#define REG_ACMHWCTRL_8723D 0x05C0 -+#define REG_SCH_SDFX_EARLY_8723D 0x05CF -+#define REG_SCH_PORT2_EARLY_8723D 0x05D0 -+#define REG_SCH_TSFT_DIFF_8723D 0x05D2 -+#define REG_EDCA_BCNCTRL2_IOREG_8723D 0x05D4 -+#define REG_EDCA_DRVERLYINT1_IOREG_8723D 0x05D4 -+#define REG_EDCA_BCNSPACE3_IOREG_8723D 0x05D8 -+#define REG_EDCA_BCNSPACE4_IOREG_8723D 0x05DA -+#define REG_HOP_CNT_8723D 0x05DC -+#define REG_SCH_M_DW_8723D 0x05DD -+#define REG_SCH_M_SLOT_8723D 0x05DE -+#define REG_SCH_EARLY_DWEND_8723D 0x05DF -+#define REG_SCH_TXCMD_8723D 0x05F8 -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+// gogogo -+#define REG_MAC_CR_8723D 0x0600 -+#define REG_TCR_8723D 0x0604 -+#define REG_RCR_8723D 0x0608 -+#define REG_RX_PKT_LIMIT_8723D 0x060C -+#define REG_RX_DLK_TIME_8723D 0x060D -+#define REG_RX_DRVINFO_SZ_8723D 0x060F -+ -+#define REG_MACID_8723D 0x0610 -+#define REG_BSSID_8723D 0x0618 -+#define REG_MAR_8723D 0x0620 -+#define REG_MBIDCAMCFG_8723D 0x0628 -+ -+#define REG_USTIME_EDCA_8723D 0x0638 -+#define REG_MAC_SPEC_SIFS_8723D 0x063A -+#define REG_RESP_SIFP_CCK_8723D 0x063C -+#define REG_RESP_SIFS_OFDM_8723D 0x063E -+#define REG_ACKTO_8723D 0x0640 -+#define REG_CTS2TO_8723D 0x0641 -+#define REG_EIFS_8723D 0x0642 -+ -+#define REG_NAV_UPPER_8723D 0x0652 // ?????? -+#define REG_TRXPTCL_CTL_8723D 0x0668 -+ -+// Security -+#define REG_CAMCMD_8723D 0x0670 -+#define REG_CAMWRITE_8723D 0x0674 -+#define REG_CAMREAD_8723D 0x0678 -+#define REG_CAMDBG_8723D 0x067C -+#define REG_SECCFG_8723D 0x0680 -+ -+// Power -+#define REG_WOW_CTRL_8723D 0x0690 -+#define REG_PS_RX_INFO_8723D 0x0692 -+#define REG_UAPSD_TID_8723D 0x0693 -+#define REG_WKFMCAM_NUM_8723D 0x0698 -+#define REG_RXFLTMAP0_8723D 0x06A0 -+#define REG_RXFLTMAP1_8723D 0x06A2 -+#define REG_RXFLTMAP2_8723D 0x06A4 -+#define REG_BCN_PSR_RPT_8723D 0x06A8 -+#define REG_BT_COEX_TABLE_8723D 0x06C0 -+#define REG_ASSOCIATED_BFMER0_INFO_8723D 0x06E4 -+#define REG_ASSOCIATED_BFMER1_INFO_8723D 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8723D 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8723D 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8723D 0x06FC -+ -+// Hardware Port 2 -+#define REG_MACID1_8723D 0x0700 -+#define REG_BSSID1_8723D 0x0708 -+#define REG_ASSOCIATED_BFMEE_SEL_8723D 0x0714 -+#define REG_SND_PTCL_CTRL_8723D 0x0718 -+ -+#define REG_LTR_CTRL_BASIC_8723D 0x07A4 -+#define REG_LTR_IDLE_LATENCY_V1_8723D 0x0798 -+#define REG_LTR_ACTIVE_LATENCY_V1_8723D 0x079C -+ -+ -+//----------------------------------------------------- -+// -+// Redifine 8192C register definition for compatibility -+// -+//----------------------------------------------------- -+ -+// TODO: use these definition when using REG_xxx naming rule. -+// NOTE: DO NOT Remove these definition. Use later. -+#define EFUSE_CTRL_8723D REG_EFUSE_CTRL_8723D // E-Fuse Control. -+#define EFUSE_TEST_8723D REG_LDO_EFUSE_CTRL_8723D // E-Fuse Test. -+#define MSR_8723D (REG_CR_8723D + 2) // Media Status register -+#define ISR_8723D REG_HISR0_8723D -+#define TSFR_8723D REG_TSFTR_8723D // Timing Sync Function Timer Register. -+ -+// Redifine MACID register, to compatible prior ICs. -+#define IDR0_8723D REG_MACID_8723D // MAC ID Register, Offset 0x0050-0x0053 -+#define IDR4_8723D (REG_MACID_8723D + 4) // MAC ID Register, Offset 0x0054-0x0055 -+ -+ -+// -+// 9. Security Control Registers (Offset: ) -+// -+#define RWCAM_8723D REG_CAMCMD_8723D //IN 8190 Data Sheet is called CAMcmd -+#define WCAMI_8723D REG_CAMWRITE_8723D // Software write CAM input content -+#define RCAMO_8723D REG_CAMREAD_8723D // Software read/write CAM config -+#define CAMDBG_8723D REG_CAMDBG_8723D -+#define SECR_8723D REG_SECCFG_8723D //Security Configuration Register -+ -+ -+//---------------------------------------------------------------------------- -+// 8195 IMR/ISR bits (offset 0xB0, 8bits) -+//---------------------------------------------------------------------------- -+#define IMR_DISABLED_8723D 0 -+// IMR DW0(0x00B0-00B3) Bit 0-31 -+#define IMR_TIMER2_8723D BIT31 // Timeout interrupt 2 -+#define IMR_TIMER1_8723D BIT30 // Timeout interrupt 1 -+#define IMR_PSTIMEOUT_8723D BIT29 // Power Save Time Out Interrupt -+#define IMR_GTINT4_8723D BIT28 // When GTIMER4 expires, this bit is set to 1 -+#define IMR_GTINT3_8723D BIT27 // When GTIMER3 expires, this bit is set to 1 -+#define IMR_TXBCN0ERR_8723D BIT26 // Transmit Beacon0 Error -+#define IMR_TXBCN0OK_8723D BIT25 // Transmit Beacon0 OK -+#define IMR_TSF_BIT32_TOGGLE_8723D BIT24 // TSF Timer BIT32 toggle indication interrupt -+#define IMR_BCNDMAINT0_8723D BIT20 // Beacon DMA Interrupt 0 -+#define IMR_BCNDERR0_8723D BIT16 // Beacon Queue DMA OK0 -+#define IMR_HSISR_IND_ON_INT_8723D BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) -+#define IMR_BCNDMAINT_E_8723D BIT14 // Beacon DMA Interrupt Extension for Win7 -+#define IMR_ATIMEND_8723D BIT12 // CTWidnow End or ATIM Window End -+#define IMR_C2HCMD_8723D BIT10 // CPU to Host Command INT Status, Write 1 clear -+#define IMR_CPWM2_8723D BIT9 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_CPWM_8723D BIT8 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_HIGHDOK_8723D BIT7 // High Queue DMA OK -+#define IMR_MGNTDOK_8723D BIT6 // Management Queue DMA OK -+#define IMR_BKDOK_8723D BIT5 // AC_BK DMA OK -+#define IMR_BEDOK_8723D BIT4 // AC_BE DMA OK -+#define IMR_VIDOK_8723D BIT3 // AC_VI DMA OK -+#define IMR_VODOK_8723D BIT2 // AC_VO DMA OK -+#define IMR_RDU_8723D BIT1 // Rx Descriptor Unavailable -+#define IMR_ROK_8723D BIT0 // Receive DMA OK -+ -+// IMR DW1(0x00B4-00B7) Bit 0-31 -+#define IMR_BCNDMAINT7_8723D BIT27 // Beacon DMA Interrupt 7 -+#define IMR_BCNDMAINT6_8723D BIT26 // Beacon DMA Interrupt 6 -+#define IMR_BCNDMAINT5_8723D BIT25 // Beacon DMA Interrupt 5 -+#define IMR_BCNDMAINT4_8723D BIT24 // Beacon DMA Interrupt 4 -+#define IMR_BCNDMAINT3_8723D BIT23 // Beacon DMA Interrupt 3 -+#define IMR_BCNDMAINT2_8723D BIT22 // Beacon DMA Interrupt 2 -+#define IMR_BCNDMAINT1_8723D BIT21 // Beacon DMA Interrupt 1 -+#define IMR_BCNDOK7_8723D BIT20 // Beacon Queue DMA OK Interrup 7 -+#define IMR_BCNDOK6_8723D BIT19 // Beacon Queue DMA OK Interrup 6 -+#define IMR_BCNDOK5_8723D BIT18 // Beacon Queue DMA OK Interrup 5 -+#define IMR_BCNDOK4_8723D BIT17 // Beacon Queue DMA OK Interrup 4 -+#define IMR_BCNDOK3_8723D BIT16 // Beacon Queue DMA OK Interrup 3 -+#define IMR_BCNDOK2_8723D BIT15 // Beacon Queue DMA OK Interrup 2 -+#define IMR_BCNDOK1_8723D BIT14 // Beacon Queue DMA OK Interrup 1 -+#define IMR_ATIMEND_E_8723D BIT13 // ATIM Window End Extension for Win7 -+#define IMR_TXERR_8723D BIT11 // Tx Error Flag Interrupt Status, write 1 clear. -+#define IMR_RXERR_8723D BIT10 // Rx Error Flag INT Status, Write 1 clear -+#define IMR_TXFOVW_8723D BIT9 // Transmit FIFO Overflow -+#define IMR_RXFOVW_8723D BIT8 // Receive FIFO Overflow -+ -+ -+ -+#define IMR_MCUERR_8723D BIT28 // Beacon DMA Interrupt 7 -+ -+ -+/*=================================================================== -+===================================================================== -+Here the register defines are for 92C. When the define is as same with 92C, -+we will use the 92C's define for the consistency -+So the following defines for 92C is not entire!!!!!! -+===================================================================== -+=====================================================================*/ -+/* -+Based on Datasheet V33---090401 -+Register Summary -+Current IOREG MAP -+0x0000h ~ 0x00FFh System Configuration (256 Bytes) -+0x0100h ~ 0x01FFh MACTOP General Configuration (256 Bytes) -+0x0200h ~ 0x027Fh TXDMA Configuration (128 Bytes) -+0x0280h ~ 0x02FFh RXDMA Configuration (128 Bytes) -+0x0300h ~ 0x03FFh PCIE EMAC Reserved Region (256 Bytes) -+0x0400h ~ 0x04FFh Protocol Configuration (256 Bytes) -+0x0500h ~ 0x05FFh EDCA Configuration (256 Bytes) -+0x0600h ~ 0x07FFh WMAC Configuration (512 Bytes) -+0x2000h ~ 0x3FFFh 8051 FW Download Region (8196 Bytes) -+*/ -+//---------------------------------------------------------------------------- -+// 8195 (TXPAUSE) transmission pause (Offset 0x522, 8 bits) -+//---------------------------------------------------------------------------- -+/* -+#define StopBecon BIT6 -+#define StopHigh BIT5 -+#define StopMgt BIT4 -+#define StopVO BIT3 -+#define StopVI BIT2 -+#define StopBE BIT1 -+#define StopBK BIT0 -+*/ -+ -+ -+ -+//============================================================================ -+// 8192C Regsiter Bit and Content definition -+//============================================================================ -+//----------------------------------------------------- -+// -+// 0x0000h ~ 0x00FFh System Configuration -+// -+//----------------------------------------------------- -+/* -+//2 SYS_ISO_CTRL -+#define ISO_MD2PP BIT(0) -+#define ISO_UA2USB BIT(1) -+#define ISO_UD2CORE BIT(2) -+#define ISO_PA2PCIE BIT(3) -+#define ISO_PD2CORE BIT(4) -+#define ISO_IP2MAC BIT(5) -+#define ISO_DIOP BIT(6) -+#define ISO_DIOE BIT(7) -+#define ISO_EB2CORE BIT(8) -+#define ISO_DIOR BIT(9) -+#define PWC_EV12V BIT(15) -+ -+ -+//2 SYS_FUNC_EN -+#define FEN_BBRSTB BIT(0) -+#define FEN_BB_GLB_RSTn BIT(1) -+#define FEN_USBA BIT(2) -+#define FEN_UPLL BIT(3) -+#define FEN_USBD BIT(4) -+#define FEN_DIO_PCIE BIT(5) -+#define FEN_PCIEA BIT(6) -+#define FEN_PPLL BIT(7) -+#define FEN_PCIED BIT(8) -+#define FEN_DIOE BIT(9) -+#define FEN_CPUEN BIT(10) -+#define FEN_DCORE BIT(11) -+#define FEN_ELDR BIT(12) -+#define FEN_DIO_RF BIT(13) -+#define FEN_HWPDN BIT(14) -+#define FEN_MREGEN BIT(15) -+ -+//2 APS_FSMCO -+#define PFM_LDALL BIT(0) -+#define PFM_ALDN BIT(1) -+#define PFM_LDKP BIT(2) -+#define PFM_WOWL BIT(3) -+#define EnPDN BIT(4) -+#define PDN_PL BIT(5) -+#define APFM_ONMAC BIT(8) -+#define APFM_OFF BIT(9) -+#define APFM_RSM BIT(10) -+#define AFSM_HSUS BIT(11) -+#define AFSM_PCIE BIT(12) -+#define APDM_MAC BIT(13) -+#define APDM_HOST BIT(14) -+#define APDM_HPDN BIT(15) -+#define RDY_MACON BIT(16) -+#define SUS_HOST BIT(17) -+#define ROP_ALD BIT(20) -+#define ROP_PWR BIT(21) -+#define ROP_SPS BIT(22) -+#define SOP_MRST BIT(25) -+#define SOP_FUSE BIT(26) -+#define SOP_ABG BIT(27) -+#define SOP_AMB BIT(28) -+#define SOP_RCK BIT(29) -+#define SOP_A8M BIT(30) -+#define XOP_BTCK BIT(31) -+ -+//2 SYS_CLKR -+#define ANAD16V_EN BIT(0) -+#define ANA8M BIT(1) -+#define MACSLP BIT(4) -+#define LOADER_CLK_EN BIT(5) -+ -+ -+//2 9346CR -+ -+#define BOOT_FROM_EEPROM BIT(4) -+#define EEPROM_EN BIT(5) -+ -+ -+//2 RF_CTRL -+#define RF_EN BIT(0) -+#define RF_RSTB BIT(1) -+#define RF_SDMRSTB BIT(2) -+ -+//2 LDOV12D_CTRL -+#define LDV12_EN BIT(0) -+#define LDV12_SDBY BIT(1) -+#define LPLDO_HSM BIT(2) -+#define LPLDO_LSM_DIS BIT(3) -+#define _LDV12_VADJ(x) (((x) & 0xF) << 4) -+ -+ -+//2 EFUSE_TEST (For RTL8723 partially) -+#define EF_TRPT BIT(7) -+#define EF_CELL_SEL (BIT(8)|BIT(9)) // 00: Wifi Efuse, 01: BT Efuse0, 10: BT Efuse1, 11: BT Efuse2 -+#define LDOE25_EN BIT(31) -+#define EFUSE_SEL(x) (((x) & 0x3) << 8) -+#define EFUSE_SEL_MASK 0x300 -+#define EFUSE_WIFI_SEL_0 0x0 -+#define EFUSE_BT_SEL_0 0x1 -+#define EFUSE_BT_SEL_1 0x2 -+#define EFUSE_BT_SEL_2 0x3 -+ -+ -+//2 8051FWDL -+//2 MCUFWDL -+#define MCUFWDL_EN BIT(0) -+#define MCUFWDL_RDY BIT(1) -+#define FWDL_ChkSum_rpt BIT(2) -+#define MACINI_RDY BIT(3) -+#define BBINI_RDY BIT(4) -+#define RFINI_RDY BIT(5) -+#define WINTINI_RDY BIT(6) -+#define RAM_DL_SEL BIT(7) -+#define ROM_DLEN BIT(19) -+#define CPRST BIT(23) -+ -+ -+ -+//2 REG_SYS_CFG -+#define XCLK_VLD BIT(0) -+#define ACLK_VLD BIT(1) -+#define UCLK_VLD BIT(2) -+#define PCLK_VLD BIT(3) -+#define PCIRSTB BIT(4) -+#define V15_VLD BIT(5) -+#define TRP_B15V_EN BIT(7) -+#define SIC_IDLE BIT(8) -+#define BD_MAC2 BIT(9) -+#define BD_MAC1 BIT(10) -+#define IC_MACPHY_MODE BIT(11) -+#define CHIP_VER (BIT(12)|BIT(13)|BIT(14)|BIT(15)) -+#define BT_FUNC BIT(16) -+#define VENDOR_ID BIT(19) -+#define PAD_HWPD_IDN BIT(22) -+#define TRP_VAUX_EN BIT(23) // RTL ID -+#define TRP_BT_EN BIT(24) -+#define BD_PKG_SEL BIT(25) -+#define BD_HCI_SEL BIT(26) -+#define TYPE_ID BIT(27) -+ -+#define CHIP_VER_RTL_MASK 0xF000 //Bit 12 ~ 15 -+#define CHIP_VER_RTL_SHIFT 12 -+ -+*/ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+/* -+ -+//2 Function Enable Registers -+//2 CR 0x0100-0x0103 -+ -+ -+#define HCI_TXDMA_EN BIT(0) -+#define HCI_RXDMA_EN BIT(1) -+#define TXDMA_EN BIT(2) -+#define RXDMA_EN BIT(3) -+#define PROTOCOL_EN BIT(4) -+#define SCHEDULE_EN BIT(5) -+#define MACTXEN BIT(6) -+#define MACRXEN BIT(7) -+#define ENSWBCN BIT(8) -+#define ENSEC BIT(9) -+#define CALTMR_EN BIT(10) // 32k CAL TMR enable -+ -+// Network type -+#define _NETTYPE(x) (((x) & 0x3) << 16) -+#define MASK_NETTYPE 0x30000 -+#define NT_NO_LINK 0x0 -+#define NT_LINK_AD_HOC 0x1 -+#define NT_LINK_AP 0x2 -+#define NT_AS_AP 0x3 -+ -+ -+//2 PBP - Page Size Register 0x0104 -+#define GET_RX_PAGE_SIZE(value) ((value) & 0xF) -+#define GET_TX_PAGE_SIZE(value) (((value) & 0xF0) >> 4) -+#define _PSRX_MASK 0xF -+#define _PSTX_MASK 0xF0 -+#define _PSRX(x) (x) -+#define _PSTX(x) ((x) << 4) -+ -+#define PBP_64 0x0 -+#define PBP_128 0x1 -+#define PBP_256 0x2 -+#define PBP_512 0x3 -+#define PBP_1024 0x4 -+ -+ -+//2 TX/RXDMA 0x010C -+#define RXDMA_ARBBW_EN BIT(0) -+#define RXSHFT_EN BIT(1) -+#define RXDMA_AGG_EN BIT(2) -+#define QS_VO_QUEUE BIT(8) -+#define QS_VI_QUEUE BIT(9) -+#define QS_BE_QUEUE BIT(10) -+#define QS_BK_QUEUE BIT(11) -+#define QS_MANAGER_QUEUE BIT(12) -+#define QS_HIGH_QUEUE BIT(13) -+ -+#define HQSEL_VOQ BIT(0) -+#define HQSEL_VIQ BIT(1) -+#define HQSEL_BEQ BIT(2) -+#define HQSEL_BKQ BIT(3) -+#define HQSEL_MGTQ BIT(4) -+#define HQSEL_HIQ BIT(5) -+ -+// For normal driver, 0x10C -+#define _TXDMA_HIQ_MAP(x) (((x)&0x3) << 14) -+#define _TXDMA_MGQ_MAP(x) (((x)&0x3) << 12) -+#define _TXDMA_BKQ_MAP(x) (((x)&0x3) << 10) -+#define _TXDMA_BEQ_MAP(x) (((x)&0x3) << 8 ) -+#define _TXDMA_VIQ_MAP(x) (((x)&0x3) << 6 ) -+#define _TXDMA_VOQ_MAP(x) (((x)&0x3) << 4 ) -+ -+#define QUEUE_LOW 1 -+#define QUEUE_NORMAL 2 -+#define QUEUE_HIGH 3 -+ -+ -+//2 REG_C2HEVT_CLEAR 0x01AF -+#define C2H_EVT_HOST_CLOSE 0x00 // Set by driver and notify FW that the driver has read the C2H command message -+#define C2H_EVT_FW_CLOSE 0xFF // Set by FW indicating that FW had set the C2H command message and it's not yet read by driver. -+ -+ -+ -+//2 LLT_INIT 0x01E0 -+#define _LLT_NO_ACTIVE 0x0 -+#define _LLT_WRITE_ACCESS 0x1 -+#define _LLT_READ_ACCESS 0x2 -+ -+#define _LLT_INIT_DATA(x) ((x) & 0xFF) -+#define _LLT_INIT_ADDR(x) (((x) & 0xFF) << 8) -+#define _LLT_OP(x) (((x) & 0x3) << 30) -+#define _LLT_OP_VALUE(x) (((x) >> 30) & 0x3) -+ -+*/ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+/* -+//2 TDECTL 0x0208 -+#define BLK_DESC_NUM_SHIFT 4 -+#define BLK_DESC_NUM_MASK 0xF -+ -+ -+//2 TXDMA_OFFSET_CHK 0x020C -+#define DROP_DATA_EN BIT(9) -+*/ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x028Bh RX DMA Configuration -+// -+//----------------------------------------------------- -+/* -+//2 REG_RXDMA_CONTROL, 0x0286h -+ -+// Write only. When this bit is set, RXDMA will decrease RX PKT counter by one. Before -+// this bit is polled, FW shall update RXFF_RD_PTR first. This register is write pulse and auto clear. -+#define RXPKT_RELEASE_POLL BIT(0) -+// Read only. When RXMA finishes on-going DMA operation, RXMDA will report idle state in -+// this bit. FW can start releasing packets after RXDMA entering idle mode. -+#define RXDMA_IDLE BIT(1) -+// When this bit is set, RXDMA will enter this mode after on-going RXDMA packet to host -+// completed, and stop DMA packet to host. RXDMA will then report Default: 0; -+#define RW_RELEASE_EN BIT(2) -+*/ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+/* -+//2 FWHW_TXQ_CTRL 0x0420 -+#define EN_AMPDU_RTY_NEW BIT(7) -+ -+ -+//2 REG_LIFECTRL_CTRL 0x0426 -+#define HAL92C_EN_PKT_LIFE_TIME_BK BIT3 -+#define HAL92C_EN_PKT_LIFE_TIME_BE BIT2 -+#define HAL92C_EN_PKT_LIFE_TIME_VI BIT1 -+#define HAL92C_EN_PKT_LIFE_TIME_VO BIT0 -+ -+#define HAL92C_MSDU_LIFE_TIME_UNIT 128 // in us, said by Tim. -+ -+ -+//2 SPEC SIFS 0x0428 -+#define _SPEC_SIFS_CCK(x) ((x) & 0xFF) -+#define _SPEC_SIFS_OFDM(x) (((x) & 0xFF) << 8) -+ -+//2 RL 0x042A -+#define RETRY_LIMIT_SHORT_SHIFT 8 -+#define RETRY_LIMIT_LONG_SHIFT 0 -+ -+#define _LRL(x) ((x) & 0x3F) -+#define _SRL(x) (((x) & 0x3F) << 8) -+*/ -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+/* -+//2 EDCA setting 0x050C -+#define AC_PARAM_TXOP_LIMIT_OFFSET 16 -+#define AC_PARAM_ECW_MAX_OFFSET 12 -+#define AC_PARAM_ECW_MIN_OFFSET 8 -+#define AC_PARAM_AIFS_OFFSET 0 -+ -+ -+//2 BCN_CTRL 0x0550 -+#define EN_TXBCN_RPT BIT(2) -+#define EN_BCN_FUNCTION BIT(3) -+ -+//2 TxPause 0x0522 -+#define STOP_BCNQ BIT(6) -+*/ -+ -+ -+//2 ACMHWCTRL 0x05C0 -+#define AcmHw_HwEn_8723D BIT(0) -+#define AcmHw_VoqEn_8723D BIT(1) -+#define AcmHw_ViqEn_8723D BIT(2) -+#define AcmHw_BeqEn_8723D BIT(3) -+#define AcmHw_VoqStatus_8723D BIT(5) -+#define AcmHw_ViqStatus_8723D BIT(6) -+#define AcmHw_BeqStatus_8723D BIT(7) -+ -+ -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+/* -+ -+//2 TCR 0x0604 -+#define DIS_GCLK BIT(1) -+#define PAD_SEL BIT(2) -+#define PWR_ST BIT(6) -+#define PWRBIT_OW_EN BIT(7) -+#define ACRC BIT(8) -+#define CFENDFORM BIT(9) -+#define ICV BIT(10) -+*/ -+ -+//---------------------------------------------------------------------------- -+// 8195 (RCR) Receive Configuration Register (Offset 0x608, 32 bits) -+//---------------------------------------------------------------------------- -+/* -+#define RCR_APPFCS BIT31 // WMAC append FCS after pauload -+#define RCR_APP_MIC BIT30 // MACRX will retain the MIC at the bottom of the packet. -+#define RCR_APP_ICV BIT29 // MACRX will retain the ICV at the bottom of the packet. -+#define RCR_APP_PHYST_RXFF BIT28 // HY Status is appended before RX packet in RXFF -+#define RCR_APP_BA_SSN BIT27 // SSN of previous TXBA is appended as after original RXDESC as the 4-th DW of RXDESC. -+#define RCR_RSVD_BIT26 BIT26 // Reserved -+*/ -+#define RCR_TCPOFLD_EN BIT25 // Enable TCP checksum offload -+/*#define RCR_ENMBID BIT24 // Enable Multiple BssId. Only response ACK to the packets whose DID(A1) matching to the addresses in the MBSSID CAM Entries. -+#define RCR_LSIGEN BIT23 // Enable LSIG TXOP Protection function. Search KEYCAM for each rx packet to check if LSIGEN bit is set. -+#define RCR_MFBEN BIT22 // Enable immediate MCS Feedback function. When Rx packet with MRQ = 1'b1, then search KEYCAM to find sender's MCS Feedback function and send response. -+*/ -+ -+ -+#endif // #ifndef __INC_HAL8723DREG_H -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.c 2018-02-11 21:44:27.158146254 +0200 -@@ -0,0 +1,923 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.26*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8723D_SUPPORT == 1) -+static BOOLEAN -+CheckPositive( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2, -+ IN const u4Byte Condition3, -+ IN const u4Byte Condition4 -+) -+{ -+ u1Byte _BoardType = ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA*/ -+ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA*/ -+ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA*/ -+ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ -+ ((pDM_Odm->BoardType & BIT2) >> 2) << 4 | /* _BT*/ -+ ((pDM_Odm->BoardType & BIT1) >> 1) << 5; /* _NGFF*/ -+ -+ u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; -+ -+ u1Byte cut_version_for_para = (pDM_Odm->CutVersion == ODM_CUT_A) ? 15 : pDM_Odm->CutVersion; -+ u1Byte pkg_type_for_para = (pDM_Odm->PackageType == 0) ? 15 : pDM_Odm->PackageType; -+ -+ u4Byte driver1 = cut_version_for_para << 24 | -+ (pDM_Odm->SupportInterface & 0xF0) << 16 | -+ pDM_Odm->SupportPlatform << 16 | -+ pkg_type_for_para << 12 | -+ (pDM_Odm->SupportInterface & 0x0F) << 8 | -+ _BoardType; -+ -+ u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | -+ (pDM_Odm->TypeGPA & 0xFF) << 8 | -+ (pDM_Odm->TypeALNA & 0xFF) << 16 | -+ (pDM_Odm->TypeAPA & 0xFF) << 24; -+ -+u4Byte driver3 = 0; -+ -+ u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | -+ (pDM_Odm->TypeGPA & 0xFF00) | -+ (pDM_Odm->TypeALNA & 0xFF00) << 8 | -+ (pDM_Odm->TypeAPA & 0xFF00) << 16; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Platform, Interface) = (0x%X, 0x%X)\n", pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Board, Package) = (0x%X, 0x%X)\n", pDM_Odm->BoardType, pDM_Odm->PackageType)); -+ -+ -+ /*============== Value Defined Check ===============*/ -+ /*QFN Type [15:12] and Cut Version [27:24] need to do value check*/ -+ -+ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return FALSE; -+ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return FALSE; -+ -+ /*=============== Bit Defined Check ================*/ -+ /* We don't care [31:28] */ -+ -+ cond1 &= 0x00FF0FFF; -+ driver1 &= 0x00FF0FFF; -+ -+ if ((cond1 & driver1) == cond1) { -+ u4Byte bitMask = 0; -+ -+ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE*/ -+ return TRUE; -+ -+ if ((cond1 & BIT0) != 0) /*GLNA*/ -+ bitMask |= 0x000000FF; -+ if ((cond1 & BIT1) != 0) /*GPA*/ -+ bitMask |= 0x0000FF00; -+ if ((cond1 & BIT2) != 0) /*ALNA*/ -+ bitMask |= 0x00FF0000; -+ if ((cond1 & BIT3) != 0) /*APA*/ -+ bitMask |= 0xFF000000; -+ -+ if (((cond2 & bitMask) == (driver2 & bitMask)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ -+ return TRUE; -+ else -+ return FALSE; -+ } else -+ return FALSE; -+} -+static BOOLEAN -+CheckNegative( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2 -+) -+{ -+ return TRUE; -+} -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8723D_AGC_TAB[] = { -+ 0xC78, 0xFE000101, -+ 0xC78, 0xFD010101, -+ 0xC78, 0xFC020101, -+ 0xC78, 0xFB030101, -+ 0xC78, 0xFA040101, -+ 0xC78, 0xF9050101, -+ 0xC78, 0xF8060101, -+ 0xC78, 0xF7070101, -+ 0xC78, 0xF6080101, -+ 0xC78, 0xF5090101, -+ 0xC78, 0xF40A0101, -+ 0xC78, 0xF30B0101, -+ 0xC78, 0xF20C0101, -+ 0xC78, 0xF10D0101, -+ 0xC78, 0xF00E0101, -+ 0xC78, 0xEF0F0101, -+ 0xC78, 0xEE100101, -+ 0xC78, 0xED110101, -+ 0xC78, 0xEC120101, -+ 0xC78, 0xEB130101, -+ 0xC78, 0xEA140101, -+ 0xC78, 0xE9150101, -+ 0xC78, 0xE8160101, -+ 0xC78, 0xE7170101, -+ 0xC78, 0xE6180101, -+ 0xC78, 0xE5190101, -+ 0xC78, 0xE41A0101, -+ 0xC78, 0xE31B0101, -+ 0xC78, 0xE21C0101, -+ 0xC78, 0xE11D0101, -+ 0xC78, 0xE01E0101, -+ 0xC78, 0x861F0101, -+ 0xC78, 0x85200101, -+ 0xC78, 0x84210101, -+ 0xC78, 0x83220101, -+ 0xC78, 0x82230101, -+ 0xC78, 0x81240101, -+ 0xC78, 0x80250101, -+ 0xC78, 0x44260101, -+ 0xC78, 0x43270101, -+ 0xC78, 0x42280101, -+ 0xC78, 0x41290101, -+ 0xC78, 0x402A0101, -+ 0xC78, 0x022B0101, -+ 0xC78, 0x012C0101, -+ 0xC78, 0x002D0101, -+ 0xC78, 0xC52E0001, -+ 0xC78, 0xC42F0001, -+ 0xC78, 0xC3300001, -+ 0xC78, 0xC2310001, -+ 0xC78, 0xC1320001, -+ 0xC78, 0xC0330001, -+ 0xC78, 0x04340001, -+ 0xC78, 0x03350001, -+ 0xC78, 0x02360001, -+ 0xC78, 0x01370001, -+ 0xC78, 0x00380001, -+ 0xC78, 0x00390001, -+ 0xC78, 0x003A0001, -+ 0xC78, 0x003B0001, -+ 0xC78, 0x003C0001, -+ 0xC78, 0x003D0001, -+ 0xC78, 0x003E0001, -+ 0xC78, 0x003F0001, -+ 0xC78, 0x6F002001, -+ 0xC78, 0x6F012001, -+ 0xC78, 0x6F022001, -+ 0xC78, 0x6F032001, -+ 0xC78, 0x6F042001, -+ 0xC78, 0x6F052001, -+ 0xC78, 0x6F062001, -+ 0xC78, 0x6F072001, -+ 0xC78, 0x6F082001, -+ 0xC78, 0x6F092001, -+ 0xC78, 0x6F0A2001, -+ 0xC78, 0x6F0B2001, -+ 0xC78, 0x6F0C2001, -+ 0xC78, 0x6F0D2001, -+ 0xC78, 0x6F0E2001, -+ 0xC78, 0x6F0F2001, -+ 0xC78, 0x6F102001, -+ 0xC78, 0x6F112001, -+ 0xC78, 0x6F122001, -+ 0xC78, 0x6F132001, -+ 0xC78, 0x6F142001, -+ 0xC78, 0x6F152001, -+ 0xC78, 0x6F162001, -+ 0xC78, 0x6F172001, -+ 0xC78, 0x6F182001, -+ 0xC78, 0x6F192001, -+ 0xC78, 0x6F1A2001, -+ 0xC78, 0x6F1B2001, -+ 0xC78, 0x6F1C2001, -+ 0xC78, 0x6F1D2001, -+ 0xC78, 0x6F1E2001, -+ 0xC78, 0x6F1F2001, -+ 0xC78, 0x6F202001, -+ 0xC78, 0x6F212001, -+ 0xC78, 0x6F222001, -+ 0xC78, 0x6F232001, -+ 0xC78, 0x6E242001, -+ 0xC78, 0x6D252001, -+ 0xC78, 0x6C262001, -+ 0xC78, 0x6B272001, -+ 0xC78, 0x6A282001, -+ 0xC78, 0x69292001, -+ 0xC78, 0x4B2A2001, -+ 0xC78, 0x4A2B2001, -+ 0xC78, 0x492C2001, -+ 0xC78, 0x482D2001, -+ 0xC78, 0x472E2001, -+ 0xC78, 0x462F2001, -+ 0xC78, 0x45302001, -+ 0xC78, 0x44312001, -+ 0xC78, 0x43322001, -+ 0xC78, 0x42332001, -+ 0xC78, 0x41342001, -+ 0xC78, 0x40352001, -+ 0xC78, 0x02362001, -+ 0xC78, 0x01372001, -+ 0xC78, 0x00382001, -+ 0xC78, 0x00392001, -+ 0xC78, 0x003A2001, -+ 0xC78, 0x003B2001, -+ 0xC78, 0x003C2001, -+ 0xC78, 0x003D2001, -+ 0xC78, 0x003E2001, -+ 0xC78, 0x003F2001, -+ 0xC78, 0x7F003101, -+ 0xC78, 0x7F013101, -+ 0xC78, 0x7F023101, -+ 0xC78, 0x7F033101, -+ 0xC78, 0x7F043101, -+ 0xC78, 0x7F053101, -+ 0xC78, 0x7F063101, -+ 0xC78, 0x7F073101, -+ 0xC78, 0x7E083101, -+ 0xC78, 0x7D093101, -+ 0xC78, 0x7C0A3101, -+ 0xC78, 0x7B0B3101, -+ 0xC78, 0x7A0C3101, -+ 0xC78, 0x790D3101, -+ 0xC78, 0x780E3101, -+ 0xC78, 0x770F3101, -+ 0xC78, 0x76103101, -+ 0xC78, 0x75113101, -+ 0xC78, 0x74123101, -+ 0xC78, 0x73133101, -+ 0xC78, 0x72143101, -+ 0xC78, 0x71153101, -+ 0xC78, 0x70163101, -+ 0xC78, 0x6F173101, -+ 0xC78, 0x6E183101, -+ 0xC78, 0x6D193101, -+ 0xC78, 0x6C1A3101, -+ 0xC78, 0x6B1B3101, -+ 0xC78, 0x6A1C3101, -+ 0xC78, 0x691D3101, -+ 0xC78, 0x681E3101, -+ 0xC78, 0x4B1F3101, -+ 0xC78, 0x4A203101, -+ 0xC78, 0x49213101, -+ 0xC78, 0x48223101, -+ 0xC78, 0x47233101, -+ 0xC78, 0x46243101, -+ 0xC78, 0x45253101, -+ 0xC78, 0x44263101, -+ 0xC78, 0x43273101, -+ 0xC78, 0x42283101, -+ 0xC78, 0x41293101, -+ 0xC78, 0x402A3101, -+ 0xC78, 0x022B3101, -+ 0xC78, 0x012C3101, -+ 0xC78, 0x002D3101, -+ 0xC78, 0x002E3101, -+ 0xC78, 0x002F3101, -+ 0xC78, 0x00303101, -+ 0xC78, 0x00313101, -+ 0xC78, 0x00323101, -+ 0xC78, 0x00333101, -+ 0xC78, 0x00343101, -+ 0xC78, 0x00353101, -+ 0xC78, 0x00363101, -+ 0xC78, 0x00373101, -+ 0xC78, 0x00383101, -+ 0xC78, 0x00393101, -+ 0xC78, 0x003A3101, -+ 0xC78, 0x003B3101, -+ 0xC78, 0x003C3101, -+ 0xC78, 0x003D3101, -+ 0xC78, 0x003E3101, -+ 0xC78, 0x003F3101, -+ 0xC78, 0xFE403101, -+ 0xC78, 0xFD413101, -+ 0xC78, 0xFC423101, -+ 0xC78, 0xFB433101, -+ 0xC78, 0xFA443101, -+ 0xC78, 0xF9453101, -+ 0xC78, 0xF8463101, -+ 0xC78, 0xF7473101, -+ 0xC78, 0xF6483101, -+ 0xC78, 0xF5493101, -+ 0xC78, 0xF44A3101, -+ 0xC78, 0xF34B3101, -+ 0xC78, 0xF24C3101, -+ 0xC78, 0xF14D3101, -+ 0xC78, 0xF04E3101, -+ 0xC78, 0xEF4F3101, -+ 0xC78, 0xEE503101, -+ 0xC78, 0xED513101, -+ 0xC78, 0xEC523101, -+ 0xC78, 0xEB533101, -+ 0xC78, 0xEA543101, -+ 0xC78, 0xE9553101, -+ 0xC78, 0xE8563101, -+ 0xC78, 0xE7573101, -+ 0xC78, 0xE6583101, -+ 0xC78, 0xE5593101, -+ 0xC78, 0xE45A3101, -+ 0xC78, 0xE35B3101, -+ 0xC78, 0xE25C3101, -+ 0xC78, 0xE15D3101, -+ 0xC78, 0xE05E3101, -+ 0xC78, 0x865F3101, -+ 0xC78, 0x85603101, -+ 0xC78, 0x84613101, -+ 0xC78, 0x83623101, -+ 0xC78, 0x82633101, -+ 0xC78, 0x81643101, -+ 0xC78, 0x80653101, -+ 0xC78, 0x80663101, -+ 0xC78, 0x80673101, -+ 0xC78, 0x80683101, -+ 0xC78, 0x80693101, -+ 0xC78, 0x806A3101, -+ 0xC78, 0x806B3101, -+ 0xC78, 0x806C3101, -+ 0xC78, 0x806D3101, -+ 0xC78, 0x806E3101, -+ 0xC78, 0x806F3101, -+ 0xC78, 0x80703101, -+ 0xC78, 0x80713101, -+ 0xC78, 0x80723101, -+ 0xC78, 0x80733101, -+ 0xC78, 0x80743101, -+ 0xC78, 0x80753101, -+ 0xC78, 0x80763101, -+ 0xC78, 0x80773101, -+ 0xC78, 0x80783101, -+ 0xC78, 0x80793101, -+ 0xC78, 0x807A3101, -+ 0xC78, 0x807B3101, -+ 0xC78, 0x807C3101, -+ 0xC78, 0x807D3101, -+ 0xC78, 0x807E3101, -+ 0xC78, 0x807F3101, -+ 0xC78, 0xEF402001, -+ 0xC78, 0xEF412001, -+ 0xC78, 0xEF422001, -+ 0xC78, 0xEF432001, -+ 0xC78, 0xEF442001, -+ 0xC78, 0xEF452001, -+ 0xC78, 0xEF462001, -+ 0xC78, 0xEF472001, -+ 0xC78, 0xEF482001, -+ 0xC78, 0xEF492001, -+ 0xC78, 0xEF4A2001, -+ 0xC78, 0xEF4B2001, -+ 0xC78, 0xEF4C2001, -+ 0xC78, 0xEF4D2001, -+ 0xC78, 0xEF4E2001, -+ 0xC78, 0xEF4F2001, -+ 0xC78, 0xEF502001, -+ 0xC78, 0xEF512001, -+ 0xC78, 0xEF522001, -+ 0xC78, 0xEF532001, -+ 0xC78, 0xEF542001, -+ 0xC78, 0xEF552001, -+ 0xC78, 0xEF562001, -+ 0xC78, 0xEF572001, -+ 0xC78, 0xEF582001, -+ 0xC78, 0xEF592001, -+ 0xC78, 0xEF5A2001, -+ 0xC78, 0xEF5B2001, -+ 0xC78, 0xEF5C2001, -+ 0xC78, 0xEF5D2001, -+ 0xC78, 0xEF5E2001, -+ 0xC78, 0xEF5F2001, -+ 0xC78, 0xEF602001, -+ 0xC78, 0xEE612001, -+ 0xC78, 0xED622001, -+ 0xC78, 0xEC632001, -+ 0xC78, 0xEB642001, -+ 0xC78, 0xEA652001, -+ 0xC78, 0xE9662001, -+ 0xC78, 0xE8672001, -+ 0xC78, 0xCB682001, -+ 0xC78, 0xCA692001, -+ 0xC78, 0xC96A2001, -+ 0xC78, 0xC86B2001, -+ 0xC78, 0xC76C2001, -+ 0xC78, 0xC66D2001, -+ 0xC78, 0xC56E2001, -+ 0xC78, 0xC46F2001, -+ 0xC78, 0xC3702001, -+ 0xC78, 0xC2712001, -+ 0xC78, 0xC1722001, -+ 0xC78, 0xC0732001, -+ 0xC78, 0x82742001, -+ 0xC78, 0x81752001, -+ 0xC78, 0x80762001, -+ 0xC78, 0x80772001, -+ 0xC78, 0x80782001, -+ 0xC78, 0x80792001, -+ 0xC78, 0x807A2001, -+ 0xC78, 0x807B2001, -+ 0xC78, 0x807C2001, -+ 0xC78, 0x807D2001, -+ 0xC78, 0x807E2001, -+ 0xC78, 0x807F2001, -+ 0xC78, 0xFA001101, -+ 0xC78, 0xF9011101, -+ 0xC78, 0xF8021101, -+ 0xC78, 0xF7031101, -+ 0xC78, 0xF6041101, -+ 0xC78, 0xF5051101, -+ 0xC78, 0xF4061101, -+ 0xC78, 0xD7071101, -+ 0xC78, 0xD6081101, -+ 0xC78, 0xD5091101, -+ 0xC78, 0xD40A1101, -+ 0xC78, 0x970B1101, -+ 0xC78, 0x960C1101, -+ 0xC78, 0x950D1101, -+ 0xC78, 0x940E1101, -+ 0xC78, 0x930F1101, -+ 0xC78, 0x92101101, -+ 0xC78, 0x91111101, -+ 0xC78, 0x90121101, -+ 0xC78, 0x8F131101, -+ 0xC78, 0x8E141101, -+ 0xC78, 0x8D151101, -+ 0xC78, 0x8C161101, -+ 0xC78, 0x8B171101, -+ 0xC78, 0x8A181101, -+ 0xC78, 0x89191101, -+ 0xC78, 0x881A1101, -+ 0xC78, 0x871B1101, -+ 0xC78, 0x861C1101, -+ 0xC78, 0x851D1101, -+ 0xC78, 0x841E1101, -+ 0xC78, 0x831F1101, -+ 0xC78, 0x82201101, -+ 0xC78, 0x81211101, -+ 0xC78, 0x80221101, -+ 0xC78, 0x43231101, -+ 0xC78, 0x42241101, -+ 0xC78, 0x41251101, -+ 0xC78, 0x04261101, -+ 0xC78, 0x03271101, -+ 0xC78, 0x02281101, -+ 0xC78, 0x01291101, -+ 0xC78, 0x002A1101, -+ 0xC78, 0xC42B1001, -+ 0xC78, 0xC32C1001, -+ 0xC78, 0xC22D1001, -+ 0xC78, 0xC12E1001, -+ 0xC78, 0xC02F1001, -+ 0xC78, 0x85301001, -+ 0xC78, 0x84311001, -+ 0xC78, 0x83321001, -+ 0xC78, 0x82331001, -+ 0xC78, 0x81341001, -+ 0xC78, 0x80351001, -+ 0xC78, 0x05361001, -+ 0xC78, 0x04371001, -+ 0xC78, 0x03381001, -+ 0xC78, 0x02391001, -+ 0xC78, 0x013A1001, -+ 0xC78, 0x003B1001, -+ 0xC78, 0x003C1001, -+ 0xC78, 0x003D1001, -+ 0xC78, 0x003E1001, -+ 0xC78, 0x003F1001, -+ 0xC50, 0x69553422, -+ 0xC50, 0x69553420, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8723D_AGC_TAB( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8723D_AGC_TAB)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8723D_AGC_TAB; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_AGC_TAB\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigBB_AGC_8723D(pDM_Odm, v1, bMaskDWord, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8723D_AGC_TAB(void) -+{ -+ return 31; -+} -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8723D_PHY_REG[] = { -+ 0x800, 0x80046C00, -+ 0x804, 0x00000003, -+ 0x808, 0x0000FC00, -+ 0x80C, 0x0000000A, -+ 0x810, 0x10001331, -+ 0x814, 0x020C3D10, -+ 0x818, 0x00200385, -+ 0x81C, 0x00000000, -+ 0x820, 0x01000100, -+ 0x824, 0x00390204, -+ 0x828, 0x00000000, -+ 0x82C, 0x00000000, -+ 0x830, 0x00000000, -+ 0x834, 0x00000000, -+ 0x838, 0x00000000, -+ 0x83C, 0x00000000, -+ 0x840, 0x00010000, -+ 0x844, 0x00000000, -+ 0x848, 0x00000000, -+ 0x84C, 0x00000000, -+ 0x850, 0x00000000, -+ 0x854, 0x00000000, -+ 0x858, 0x569A11A9, -+ 0x85C, 0x01000014, -+ 0x860, 0x66F60110, -+ 0x864, 0x461F0641, -+ 0x868, 0x00000000, -+ 0x86C, 0x27272700, -+ 0x870, 0x07000460, -+ 0x874, 0x25004000, -+ 0x878, 0x00000808, -+ 0x87C, 0x004F0201, -+ 0x880, 0xB2002E12, -+ 0x884, 0x00000007, -+ 0x888, 0x00000000, -+ 0x88C, 0xCCC000C0, -+ 0x890, 0x00000800, -+ 0x894, 0xFFFFFFFE, -+ 0x898, 0x40302010, -+ 0x89C, 0x00706050, -+ 0x900, 0x00000000, -+ 0x904, 0x00000023, -+ 0x908, 0x00000000, -+ 0x90C, 0x81121111, -+ 0x910, 0x00000402, -+ 0x914, 0x00000300, -+ 0x920, 0x18C6318C, -+ 0x924, 0x0000018C, -+ 0x948, 0x99000000, -+ 0x94C, 0x00000010, -+ 0x950, 0x00003800, -+ 0x954, 0x5A380000, -+ 0x958, 0x4BC6D87A, -+ 0x95C, 0x04EB9B79, -+ 0x96C, 0x00000003, -+ 0x970, 0x00000000, -+ 0x974, 0x00000000, -+ 0x978, 0x00000000, -+ 0x97C, 0x13000000, -+ 0x980, 0x00000000, -+ 0xA00, 0x00D047C8, -+ 0xA04, 0x80FF800C, -+ 0xA08, 0x8C838300, -+ 0xA0C, 0x2E20100F, -+ 0xA10, 0x9500BB78, -+ 0xA14, 0x1114D028, -+ 0xA18, 0x00881117, -+ 0xA1C, 0x89140F00, -+ 0xA20, 0xE82C0001, -+ 0xA24, 0x64B80C1C, -+ 0xA28, 0x00008810, -+ 0xA2C, 0x00D30000, -+ 0xA70, 0x101FBF00, -+ 0xA74, 0x00000007, -+ 0xA78, 0x00008900, -+ 0xA7C, 0x225B0606, -+ 0xA80, 0x2180FA74, -+ 0xA84, 0x00200000, -+ 0xA88, 0x040C0000, -+ 0xA8C, 0x12345678, -+ 0xA90, 0xABCDEF00, -+ 0xA94, 0x001B1B89, -+ 0xA98, 0x00000000, -+ 0xA9C, 0x00020000, -+ 0xAA0, 0x00000000, -+ 0xAA4, 0x0000000C, -+ 0xAA8, 0xCA100008, -+ 0xAAC, 0x01235667, -+ 0xAB0, 0x00000000, -+ 0xAB4, 0x20201402, -+ 0xB2C, 0x00000000, -+ 0xC00, 0x48071D40, -+ 0xC04, 0x03A05611, -+ 0xC08, 0x000000E4, -+ 0xC0C, 0x6C6C6C6C, -+ 0xC10, 0x28800000, -+ 0xC14, 0x40000100, -+ 0xC18, 0x08800000, -+ 0xC1C, 0x40000100, -+ 0xC20, 0x00000000, -+ 0xC24, 0x00000000, -+ 0xC28, 0x00000000, -+ 0xC2C, 0x00000000, -+ 0xC30, 0x69E9AC48, -+ 0xC34, 0x31000040, -+ 0xC38, 0x21688080, -+ 0xC3C, 0x000016D4, -+ 0xC40, 0x1F78403F, -+ 0xC44, 0x00010036, -+ 0xC48, 0xEC020107, -+ 0xC4C, 0x007F037F, -+ 0xC50, 0x69553420, -+ 0xC54, 0x43BC0094, -+ 0xC58, 0x00015969, -+ 0xC5C, 0x00310492, -+ 0xC60, 0x00280A00, -+ 0xC64, 0x7112848B, -+ 0xC68, 0x47C074FF, -+ 0xC6C, 0x00000036, -+ 0xC70, 0x2C7F000D, -+ 0xC74, 0x020600DB, -+ 0xC78, 0x0000001F, -+ 0xC7C, 0x00B91612, -+ 0xC80, 0x390000E4, -+ 0xC84, 0x11F60000, -+ 0xC88, 0x40000100, -+ 0xC8C, 0x20200000, -+ 0xC90, 0x00091521, -+ 0xC94, 0x00000000, -+ 0xC98, 0x00121820, -+ 0xC9C, 0x00007F7F, -+ 0xCA0, 0x00012000, -+ 0xCA4, 0xA00000A0, -+ 0xCA8, 0x85E7C606, -+ 0xCAC, 0x00000060, -+ 0xCB0, 0x00000000, -+ 0xCB4, 0x00000000, -+ 0xCB8, 0x00000000, -+ 0xCBC, 0x28000000, -+ 0xCC0, 0x0010A3D0, -+ 0xCC4, 0x00000F7D, -+ 0xCC8, 0x000442D6, -+ 0xCCC, 0x00000000, -+ 0xCD0, 0x000001C8, -+ 0xCD4, 0x001C8000, -+ 0xCD8, 0x00000100, -+ 0xCDC, 0x40100000, -+ 0xCE0, 0x00222220, -+ 0xCE4, 0x20000000, -+ 0xCE8, 0x37644302, -+ 0xCEC, 0x2F97D40C, -+ 0xD00, 0x00030740, -+ 0xD04, 0x40020401, -+ 0xD08, 0x0000907F, -+ 0xD0C, 0x20010201, -+ 0xD10, 0xA0633333, -+ 0xD14, 0x3333BC53, -+ 0xD18, 0x7A8F5B6F, -+ 0xD2C, 0xCC979975, -+ 0xD30, 0x00000000, -+ 0xD34, 0x80608000, -+ 0xD38, 0x88000000, -+ 0xD3C, 0xC0127343, -+ 0xD40, 0x00000000, -+ 0xD44, 0x00000000, -+ 0xD48, 0x00000000, -+ 0xD4C, 0x00000000, -+ 0xD50, 0x00000038, -+ 0xD54, 0x00000000, -+ 0xD58, 0x00000282, -+ 0xD5C, 0x30032064, -+ 0xD60, 0x4653DE68, -+ 0xD64, 0x04518A3C, -+ 0xD68, 0x00002101, -+ 0xE00, 0x2D2D2D2D, -+ 0xE04, 0x2D2D2D2D, -+ 0xE08, 0x0390272D, -+ 0xE10, 0x2D2D2D2D, -+ 0xE14, 0x2D2D2D2D, -+ 0xE18, 0x2D2D2D2D, -+ 0xE1C, 0x2D2D2D2D, -+ 0xE28, 0x00000000, -+ 0xE30, 0x1000DC1F, -+ 0xE34, 0x10008C1F, -+ 0xE38, 0x02140102, -+ 0xE3C, 0x681604C2, -+ 0xE40, 0x01007C00, -+ 0xE44, 0x01004800, -+ 0xE48, 0xFB000000, -+ 0xE4C, 0x000028D1, -+ 0xE50, 0x1000DC1F, -+ 0xE54, 0x10008C1F, -+ 0xE58, 0x02140102, -+ 0xE5C, 0x28160D05, -+ 0xE60, 0x00000008, -+ 0xE68, 0x001B25A4, -+ 0xE6C, 0x01C00014, -+ 0xE70, 0x01C00016, -+ 0xE74, 0x02000014, -+ 0xE78, 0x02000014, -+ 0xE7C, 0x02000014, -+ 0xE80, 0x02000014, -+ 0xE84, 0x01C00014, -+ 0xE88, 0x02000014, -+ 0xE8C, 0x01C00014, -+ 0xED0, 0x01C00014, -+ 0xED4, 0x01C00014, -+ 0xED8, 0x01C00014, -+ 0xEDC, 0x00000014, -+ 0xEE0, 0x00000014, -+ 0xEE8, 0x21555448, -+ 0xEEC, 0x03C00014, -+ 0xF14, 0x00000003, -+ 0xF00, 0x00100300, -+ 0xF08, 0x0000800B, -+ 0xF0C, 0x0000F007, -+ 0xF10, 0x0000A487, -+ 0xF1C, 0x80000064, -+ 0xF38, 0x00030155, -+ 0xF3C, 0x0000003A, -+ 0xF4C, 0x13000000, -+ 0xF50, 0x00000000, -+ 0xF18, 0x00000000, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8723D_PHY_REG( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8723D_PHY_REG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8723D_PHY_REG; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_PHY_REG\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigBB_PHY_8723D(pDM_Odm, v1, bMaskDWord, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8723D_PHY_REG(void) -+{ -+ return 31; -+} -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8723D_PHY_REG_PG[] = { -+ 0, 0, 0, 0x00000e08, 0x0000ff00, 0x00003200, -+ 0, 0, 0, 0x0000086c, 0xffffff00, 0x32323200, -+ 0, 0, 0, 0x00000e00, 0xffffffff, 0x32343434, -+ 0, 0, 0, 0x00000e04, 0xffffffff, 0x28303032, -+ 0, 0, 0, 0x00000e10, 0xffffffff, 0x30323234, -+ 0, 0, 0, 0x00000e14, 0xffffffff, 0x26282830 -+}; -+ -+void -+ODM_ReadAndConfig_MP_8723D_PHY_REG_PG( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8723D_PHY_REG_PG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8723D_PHY_REG_PG; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrByRate, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrByRate = ArrayLen/6; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_PHY_REG_PG\n")); -+ -+ pDM_Odm->PhyRegPgVersion = 1; -+ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ -+ for (i = 0; i < ArrayLen; i += 6) { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ u4Byte v3 = Array[i+2]; -+ u4Byte v4 = Array[i+3]; -+ u4Byte v5 = Array[i+4]; -+ u4Byte v6 = Array[i+5]; -+ -+ odm_ConfigBB_PHY_REG_PG_8723D(pDM_Odm, v1, v2, v3, v4, v5, v6); -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf((char *)pHalData->BufOfLinesPwrByRate[i/6], 100, "%s, %s, %s, 0x%X, 0x%08X, 0x%08X,", -+ (v1 == 0?"2.4G":" 5G"), (v2 == 0?"A":"B"), (v3 == 0?"1Tx":"2Tx"), v4, v5, v6); -+#endif -+ } -+} -+ -+ -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_bb.h 2018-02-11 21:44:27.158146254 +0200 -@@ -0,0 +1,59 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.26*/ -+#if (RTL8723D_SUPPORT == 1) -+#ifndef __INC_MP_BB_HW_IMG_8723D_H -+#define __INC_MP_BB_HW_IMG_8723D_H -+ -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723D_AGC_TAB(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8723D_AGC_TAB(void); -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723D_PHY_REG(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8723D_PHY_REG(void); -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723D_PHY_REG_PG(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8723D_PHY_REG_PG(void); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.c 2018-02-11 21:44:27.161146299 +0200 -@@ -0,0 +1,4840 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.16*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#ifdef LOAD_FW_HEADER_FROM_DRIVER -+#include "../../rtl8723d/hal8723d_fw.h" -+#endif -+ -+ -+#if (RTL8723D_SUPPORT == 1) -+#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) -+ -+ -+#ifndef LOAD_FW_HEADER_FROM_DRIVER -+u8 array_mp_8723d_fw_ap[] = { -+0xD1, 0x23, 0x20, 0x00, 0x10, 0x00, 0x00, 0x00, 0x05, 0x16, 0x18, 0x17, 0xA0, 0x52, 0x02, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x02, 0x85, 0xAD, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xA5, 0x97, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xBE, 0x67, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xBA, 0x86, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xBA, 0xD6, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xBE, 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, -+0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, -+0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, -+0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, -+0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, -+0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, -+0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, -+0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, -+0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, -+0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, -+0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, -+0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, -+0x30, 0x04, 0x04, 0x04, 0x05, 0x08, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x06, 0x0B, 0x0D, -+0x0E, 0x0F, 0x11, 0x12, 0x14, 0x00, 0x04, 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x23, 0x00, -+0x2D, 0x00, 0x50, 0x00, 0x91, 0x00, 0xC3, 0x01, 0x27, 0x01, 0x31, 0x01, 0x5E, 0x00, 0xC8, 0x00, -+0xF0, 0x00, 0xDC, 0x01, 0x5E, 0x01, 0x68, 0x01, 0x9A, 0x01, 0xCC, 0x01, 0xEA, 0x02, 0x02, 0x04, -+0x08, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C, 0x14, 0x28, 0x32, 0x50, 0x78, 0xA0, 0xC8, -+0xE6, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x02, 0x04, 0x06, -+0x07, 0x07, 0x08, 0x08, 0x08, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, -+0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, -+0x02, 0x03, 0x03, 0x04, 0x05, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x03, 0x03, 0x03, -+0x02, 0x03, 0x03, 0x03, 0x03, 0x03, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, -+0x02, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x86, 0xC0, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x86, 0xC0, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x83, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, -+0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0x02, 0x85, 0xEB, -+0x02, 0x83, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, -+0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, -+0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, -+0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x86, 0xA9, 0xE4, 0x7E, -+0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, -+0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, -+0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, -+0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, -+0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, -+0xFF, 0xEE, 0x9A, 0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, -+0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, -+0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, -+0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, -+0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, -+0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, -+0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x41, 0x96, 0x84, 0x00, 0x44, 0x96, 0x43, -+0x41, 0x4E, 0x59, 0x00, 0x44, 0x96, 0x3F, 0x61, 0x6E, 0x79, 0x00, 0x41, 0x96, 0x86, 0x00, 0x00, -+0x9B, 0xD7, 0xB6, 0x2A, 0x96, 0x8F, 0x90, 0x96, 0x81, 0xEF, 0xF0, 0x7F, 0x02, 0xB1, 0x27, 0x90, -+0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x96, 0x81, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, 0x22, -+0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x86, 0xB4, -+0xF1, 0x3C, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB5, 0xF1, 0x35, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, -+0x12, 0x8F, 0xBF, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB7, 0x12, 0xA1, 0x04, 0xFF, 0xED, 0x2F, 0x90, -+0x86, 0xB8, 0xF1, 0x2D, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB9, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, -+0x1F, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x86, 0xBA, 0xF0, 0x22, 0x4E, 0xFF, 0xF0, 0x90, 0x00, -+0x05, 0x02, 0x02, 0x1F, 0x4F, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x02, 0x1F, 0xF0, 0x90, 0x00, 0x01, -+0x02, 0x02, 0x1F, 0x12, 0x02, 0x06, 0x90, 0x93, 0x25, 0xF1, 0x3C, 0x90, 0x93, 0x26, 0xF1, 0x35, -+0x90, 0x93, 0x27, 0xF0, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x80, 0xFE, 0x90, 0x93, 0x56, 0xE0, -+0x54, 0x7F, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x40, 0xFF, 0xEE, 0x54, 0xBF, 0x4F, 0xFF, 0xF0, 0x12, -+0x02, 0x06, 0xFE, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0x93, 0x56, 0xF0, 0xEE, -+0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0x54, 0x0F, 0xFE, 0xEF, -+0x54, 0xF0, 0x4E, 0x90, 0x93, 0x56, 0xF1, 0x3C, 0xFF, 0x54, 0x7F, 0x90, 0x93, 0x58, 0xF0, 0xEF, -+0x12, 0x8F, 0xC8, 0xFF, 0x90, 0x93, 0x57, 0xE0, 0x54, 0xFE, 0xF1, 0x34, 0x90, 0x93, 0x59, 0x12, -+0x8F, 0xBF, 0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x93, 0x57, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0x12, -+0xBB, 0xFD, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -+0x7A, 0xED, 0xF0, 0x90, 0x96, 0x79, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x44, 0x7F, 0x47, 0x12, -+0x88, 0x73, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, 0x12, 0x7B, 0x2E, -+0x7F, 0x46, 0x12, 0x88, 0x73, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x46, 0x11, -+0x81, 0x60, 0x0D, 0x7F, 0x45, 0x11, 0x73, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x80, 0x0C, -+0x7F, 0x45, 0x11, 0x73, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x45, 0x80, -+0x4A, 0x90, 0x96, 0x79, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0x11, 0x73, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x12, 0x7B, 0x2E, 0x7F, 0x62, 0x11, 0x73, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0x11, 0x81, 0x60, 0x10, 0x7F, 0x61, 0x11, 0x73, -+0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x0F, 0x7F, 0x61, 0x11, 0x73, -+0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x12, 0x7B, 0x41, 0x90, 0x96, 0x79, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, -+0x22, 0x12, 0x7B, 0x2E, 0x90, 0x96, 0x7A, 0xE0, 0x22, 0x90, 0x93, 0x30, 0xE0, 0x20, 0xE0, 0x02, -+0x21, 0x55, 0xE4, 0x90, 0x94, 0xA2, 0xF0, 0x90, 0x94, 0xA2, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x40, -+0x02, 0x21, 0x55, 0x12, 0xB3, 0xED, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -+0x90, 0x93, 0x31, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x02, 0x21, 0x4D, 0x12, 0x02, 0x06, 0xFF, 0x30, -+0xE0, 0x1A, 0x90, 0x93, 0x32, 0xE0, 0xFE, 0x90, 0x94, 0xA2, 0xE0, 0xFD, 0x74, 0x01, 0xA8, 0x05, -+0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, 0x32, 0xF0, 0xEF, 0xC3, 0x13, 0x30, -+0xE0, 0x15, 0x90, 0x93, 0x33, 0xE0, 0xFF, 0x90, 0x94, 0xA2, 0x11, 0x79, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x33, 0xF0, 0x12, 0x87, 0x3D, 0xFF, 0x90, 0x94, 0xA2, 0xE0, 0xFE, -+0x24, 0x34, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0x87, 0x35, 0xFF, 0x74, 0x39, -+0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF1, 0xBF, 0xFF, 0x74, 0x3E, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0xA1, 0x04, 0xFF, 0x74, 0x43, 0x2E, 0xF5, 0x82, -+0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x31, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x06, -+0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x31, 0xF0, 0x22, 0x90, 0x94, 0xA2, -+0xE0, 0x04, 0xF0, 0x01, 0x97, 0x22, 0x90, 0x94, 0x9F, 0x12, 0x86, 0x7A, 0x90, 0x94, 0x9E, 0xEF, -+0xF0, 0x12, 0x86, 0x83, 0x89, 0xDA, 0x00, 0x89, 0xDF, 0x01, 0x89, 0xE3, 0x08, 0x89, 0xE8, 0x09, -+0x89, 0xED, 0x0A, 0x89, 0xF2, 0x12, 0x89, 0xF7, 0x13, 0x89, 0xFC, 0x14, 0x8A, 0x01, 0x20, 0x8A, -+0x06, 0x25, 0x8A, 0x0B, 0x26, 0x8A, 0x10, 0x29, 0x8A, 0x15, 0x2A, 0x8A, 0x19, 0x40, 0x8A, 0x20, -+0x42, 0x8A, 0x2B, 0x43, 0x8A, 0x30, 0x44, 0x8A, 0xA2, 0x47, 0x8A, 0xA2, 0x49, 0x8A, 0x35, 0x60, -+0x8A, 0x39, 0x61, 0x8A, 0x3E, 0x62, 0x8A, 0x43, 0x63, 0x8A, 0x48, 0x64, 0x8A, 0x4D, 0x65, 0x8A, -+0x52, 0x66, 0x8A, 0x57, 0x67, 0x8A, 0x5C, 0x68, 0x8A, 0x61, 0x69, 0x8A, 0x66, 0x6B, 0x8A, 0x6B, -+0x6C, 0x8A, 0x70, 0x6D, 0x8A, 0x75, 0x6E, 0x8A, 0x7A, 0x6F, 0x8A, 0x7F, 0x70, 0x8A, 0x84, 0xC2, -+0x8A, 0x89, 0xC3, 0x8A, 0x8E, 0xC4, 0x00, 0x00, 0x8A, 0x93, 0x51, 0xA3, 0x02, 0x86, 0xE0, 0x51, -+0xA3, 0x41, 0xA9, 0x51, 0xA3, 0x02, 0x90, 0x02, 0x51, 0xA3, 0x02, 0x97, 0xFB, 0x51, 0xA3, 0x02, -+0x98, 0x16, 0x51, 0xA3, 0x02, 0x98, 0x25, 0x51, 0xA3, 0x02, 0x87, 0x55, 0x51, 0xA3, 0x02, 0x9F, -+0xF3, 0x51, 0xA3, 0x02, 0xA0, 0x02, 0x51, 0xA3, 0x02, 0xAF, 0xF1, 0x51, 0xA3, 0x02, 0xB7, 0xEF, -+0x51, 0xA3, 0x02, 0xB8, 0xEF, 0x51, 0xA3, 0x01, 0x89, 0x51, 0xA3, 0x90, 0x8A, 0xA5, 0x80, 0x05, -+0x51, 0xA3, 0x90, 0x8A, 0xB5, 0x12, 0x9F, 0xE9, 0x02, 0x04, 0x7E, 0x51, 0xA3, 0x02, 0x25, 0xEC, -+0x51, 0xA3, 0x02, 0x5B, 0xF3, 0x51, 0xA3, 0x61, 0x74, 0x51, 0xA3, 0x02, 0x77, 0x4F, 0x51, 0xA3, -+0x02, 0x7C, 0x60, 0x51, 0xA3, 0x02, 0x7A, 0xC6, 0x51, 0xA3, 0x02, 0x5D, 0x36, 0x51, 0xA3, 0x02, -+0x7B, 0xE9, 0x51, 0xA3, 0x02, 0x70, 0x33, 0x51, 0xA3, 0x02, 0x48, 0xC9, 0x51, 0xA3, 0x02, 0x79, -+0xF3, 0x51, 0xA3, 0x02, 0x3F, 0xD4, 0x51, 0xA3, 0x02, 0x51, 0x7B, 0x51, 0xA3, 0x02, 0x79, 0x30, -+0x51, 0xA3, 0x02, 0x57, 0xF2, 0x51, 0xA3, 0x02, 0x74, 0x8D, 0x51, 0xA3, 0x02, 0x78, 0x9A, 0x51, -+0xA3, 0x02, 0x5E, 0x0B, 0x51, 0xA3, 0x02, 0xB9, 0x05, 0x51, 0xA3, 0x02, 0xB9, 0x0D, 0x51, 0xA3, -+0x02, 0x87, 0x43, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x94, 0x9E, 0xE0, 0x90, 0x01, -+0xC2, 0xF0, 0x22, 0x90, 0x94, 0x9F, 0x02, 0x86, 0x71, 0xF1, 0xF5, 0x90, 0x93, 0x4B, 0xE0, 0x70, -+0x12, 0x71, 0x6E, 0x12, 0x02, 0x06, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x06, 0x90, 0x93, 0x51, -+0x74, 0x01, 0xF0, 0x90, 0x93, 0x4D, 0xE0, 0x70, 0x12, 0x71, 0x6E, 0x12, 0x02, 0x06, 0xC4, 0x54, -+0x0F, 0xFF, 0xBF, 0x05, 0x06, 0x90, 0x93, 0x52, 0x74, 0x01, 0xF0, 0x71, 0x6E, 0x12, 0x87, 0x3D, -+0xFF, 0x90, 0x94, 0xA6, 0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, 0x0B, 0x71, 0x6E, 0x12, -+0x87, 0x36, 0x90, 0x94, 0xA7, 0xF0, 0x80, 0x05, 0x90, 0x94, 0xA7, 0xEF, 0xF0, 0x90, 0x94, 0xA6, -+0xE0, 0x90, 0x94, 0xA5, 0xF0, 0x90, 0x94, 0xA7, 0xE0, 0xFE, 0x90, 0x94, 0xA5, 0xE0, 0xFF, 0xD3, -+0x9E, 0x50, 0x38, 0x71, 0x6E, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x94, -+0xA5, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x90, 0x94, 0xA5, 0x70, 0x07, 0xE0, 0xFF, 0x12, 0xAF, -+0xD0, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0xAF, 0xCC, 0x90, 0x93, 0x52, 0xE0, 0x60, 0x08, 0x90, 0x94, -+0xA5, 0xE0, 0xFF, 0x12, 0xAF, 0xD0, 0x12, 0xAE, 0x7E, 0x80, 0xBA, 0x90, 0x05, 0x5E, 0xE4, 0xF0, -+0x90, 0x94, 0xA6, 0xE0, 0x70, 0x17, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x10, 0xB1, 0xD7, 0x90, -+0x8A, 0xED, 0xB1, 0xDA, 0x12, 0xBD, 0x69, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x94, -+0xA2, 0x02, 0x86, 0x71, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0xF5, 0x71, 0x6E, 0x12, -+0x98, 0x0A, 0x7A, 0x88, 0x79, 0x9D, 0x12, 0x69, 0xF5, 0x71, 0x6E, 0x12, 0x02, 0x06, 0x20, 0xE0, -+0x02, 0xA1, 0x05, 0x90, 0x05, 0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, 0x13, 0x90, 0x88, -+0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x15, 0x12, 0x87, 0x3D, 0x90, -+0x88, 0x9E, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0x12, 0x87, 0x35, 0x90, 0x88, 0x9F, 0xF0, 0x80, -+0x4B, 0x12, 0x87, 0x3D, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x15, 0xEF, 0xC3, 0x94, 0x03, 0x50, 0x07, -+0x90, 0x88, 0x9E, 0x74, 0x03, 0x80, 0x0D, 0x12, 0x87, 0x3D, 0x90, 0x88, 0x9E, 0x80, 0x05, 0x90, -+0x88, 0x9E, 0x74, 0x2A, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0x12, 0x87, 0x36, 0xFF, 0xC3, -+0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, 0x74, 0x03, 0xF0, -+0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, 0x97, 0xDD, 0x30, -+0xE0, 0x3D, 0x90, 0x88, 0x9E, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, 0xF0, 0xE0, 0xC3, -+0x13, 0xA3, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA8, 0xF0, 0x90, -+0x88, 0x9E, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0xC3, 0x13, 0x90, -+0x88, 0xAA, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, 0x7C, 0x05, 0xE4, -+0x90, 0x88, 0xDD, 0xF0, 0x71, 0x6E, 0xF1, 0xC0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x37, -+0x90, 0x88, 0x9D, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x06, 0xE0, 0xF1, 0xCA, 0x30, 0xE0, 0x28, 0x12, -+0xD2, 0x7C, 0x30, 0xE0, 0x08, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x80, 0x0B, 0x90, 0x88, 0xDF, -+0xE0, 0x60, 0x05, 0x75, 0x61, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x61, 0x90, 0x8A, 0xF3, 0xB1, 0xC8, -+0x7D, 0x02, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -+0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0xB1, -+0xC8, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0xD2, 0x95, 0x74, 0x11, 0xF0, 0x90, 0x05, -+0x58, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x01, -+0xF0, 0x80, 0x2B, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x04, 0xF0, -+0x80, 0x1C, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x02, 0xF0, 0x80, -+0x0D, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, 0xF0, 0xE4, 0x90, -+0x88, 0xA5, 0xF0, 0x80, 0x65, 0x71, 0x6E, 0xF1, 0xC0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, -+0x05, 0x75, 0x62, 0x02, 0x80, 0x0E, 0x12, 0xD2, 0x7C, 0x30, 0xE0, 0x05, 0x75, 0x62, 0x01, 0x80, -+0x03, 0xE4, 0xF5, 0x62, 0x90, 0x8A, 0xF1, 0xB1, 0xDA, 0x90, 0x89, 0x04, 0xE0, 0x30, 0xE0, 0x04, -+0x7D, 0xAC, 0x80, 0x02, 0x7D, 0x2C, 0x7F, 0x40, 0x12, 0x7B, 0x2E, 0x71, 0x6E, 0xF1, 0xC0, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, -+0x90, 0x8A, 0xF3, 0xB1, 0xC8, 0xAD, 0x62, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0xB1, -+0xC8, 0x12, 0x9F, 0x30, 0x12, 0xD2, 0x95, 0x74, 0x43, 0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, -+0xF0, 0xE4, 0x90, 0x88, 0xAF, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xF1, 0xCA, 0x30, 0xE0, 0x09, 0x90, -+0x88, 0xD0, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x11, 0x90, 0x8A, 0x97, 0xB1, 0xC8, 0x7F, 0x01, 0x12, -+0x04, 0x7E, 0x90, 0x88, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, 0xB1, 0xC8, 0x7F, 0x03, -+0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, -+0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x79, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, -+0x22, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x86, 0x0C, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, -+0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x85, 0xED, 0xF0, -+0x90, 0x88, 0x31, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xE1, 0x55, 0xEE, -+0xF1, 0xCA, 0x30, 0xE0, 0x02, 0xE1, 0x55, 0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0xE1, -+0x55, 0xEF, 0x70, 0x02, 0xC1, 0xB1, 0x24, 0xFE, 0x70, 0x02, 0xC1, 0xF6, 0x24, 0xFE, 0x60, 0x4F, -+0x24, 0xFC, 0x70, 0x02, 0xE1, 0x3B, 0x24, 0xFC, 0x60, 0x02, 0xE1, 0x4B, 0xEE, 0xB4, 0x0E, 0x03, -+0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, -+0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x11, 0x90, -+0x96, 0x85, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x67, 0x80, 0x80, 0x05, 0x90, 0x8A, 0xED, 0xB1, 0xDA, -+0x90, 0x88, 0x39, 0xE0, 0x64, 0x08, 0x60, 0x02, 0xE1, 0x4B, 0x12, 0x7B, 0xCC, 0xE1, 0x4B, 0x90, -+0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, -+0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0xDA, -+0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xE1, 0x4B, -+0x90, 0x86, 0x00, 0xB1, 0xDA, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xE1, 0x4B, 0x12, 0x68, 0xC2, 0xE1, -+0x4B, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0xDA, 0xBF, 0x01, 0x03, -+0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, -+0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0xDA, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, -+0x88, 0x39, 0xE0, 0x64, 0x04, 0x70, 0x64, 0x90, 0x86, 0x02, 0xB1, 0xDA, 0xEF, 0x64, 0x01, 0x70, -+0x5A, 0x12, 0x73, 0x5A, 0x80, 0x55, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, -+0xB1, 0xDA, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, -+0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0xDA, 0xBF, 0x01, -+0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, -+0x88, 0x39, 0xE0, 0xB4, 0x04, 0x15, 0x12, 0x7A, 0x49, 0x80, 0x10, 0x90, 0x88, 0x39, 0xE0, 0xB4, -+0x0C, 0x09, 0x12, 0xCD, 0x4B, 0x30, 0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, 0x88, 0x39, 0x12, 0xD2, -+0x4E, 0x90, 0x01, 0xBB, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, -+0x5D, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x1D, 0x12, 0xD2, 0x58, 0x12, 0xA2, 0x78, 0x90, 0x8A, 0xF9, -+0xB1, 0xC8, 0xB1, 0xD1, 0x12, 0xB8, 0xB6, 0x30, 0xE0, 0x07, 0x90, 0x8A, 0x89, 0xB1, 0xC8, 0xF1, -+0xFB, 0x02, 0xB8, 0xBD, 0x90, 0x93, 0x29, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x30, 0xE4, 0x90, -+0x92, 0x20, 0xF0, 0x90, 0x93, 0x2C, 0x12, 0xA2, 0x78, 0x90, 0x93, 0x29, 0xE0, 0x54, 0xEF, 0xF0, -+0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0xB1, 0xC8, 0x7D, 0x04, 0x7F, 0x01, 0x02, -+0x04, 0x7E, 0x90, 0x8A, 0xF9, 0xB1, 0xC8, 0x7D, 0x31, 0x12, 0xCD, 0x42, 0xB1, 0xDA, 0x22, 0xF0, -+0x90, 0x00, 0x03, 0x02, 0x02, 0x1F, 0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, -+0x22, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, 0x1C, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x8A, 0xF9, -+0xB1, 0xC8, 0xB1, 0xD1, 0x12, 0xB8, 0xB6, 0x30, 0xE0, 0x07, 0x90, 0x8A, 0x89, 0xB1, 0xC8, 0xF1, -+0xFB, 0x12, 0xB8, 0xBD, 0x22, 0x90, 0x94, 0xA2, 0x02, 0x86, 0x7A, 0x7D, 0x0C, 0x7F, 0x01, 0x02, -+0x04, 0x7E, 0x12, 0x8F, 0xF5, 0x12, 0x02, 0x06, 0x30, 0xE0, 0x14, 0x12, 0xB5, 0xE0, 0x90, 0x86, -+0xB3, 0xE0, 0x64, 0x01, 0x70, 0x27, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x1E, 0x90, -+0x93, 0x25, 0xE0, 0x60, 0x16, 0x7D, 0x10, 0xE4, 0xFF, 0x12, 0x7C, 0x3B, 0x90, 0x01, 0x3C, 0xE0, -+0x30, 0xE4, 0x03, 0x74, 0x10, 0xF0, 0x90, 0x01, 0x63, 0xE4, 0xF0, 0x11, 0xB2, 0x12, 0x8B, 0x6E, -+0x12, 0x87, 0x3D, 0x90, 0x93, 0x04, 0x12, 0x87, 0x35, 0x90, 0x93, 0x05, 0xF0, 0x90, 0x93, 0x04, -+0xE0, 0x54, 0x01, 0x90, 0x93, 0x11, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x02, 0x90, 0x93, 0x12, -+0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x04, 0x90, 0x93, 0x13, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, -+0x08, 0x90, 0x93, 0x14, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x10, 0x90, 0x93, 0x15, 0xF0, 0x90, -+0x93, 0x05, 0xE0, 0x54, 0x01, 0x90, 0x93, 0x16, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x02, 0x90, -+0x93, 0x17, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x04, 0x90, 0x93, 0x18, 0xF0, 0x90, 0x93, 0x05, -+0xE0, 0x54, 0x08, 0x90, 0x93, 0x19, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x10, 0x90, 0x93, 0x1A, -+0xF0, 0x22, 0xC2, 0xAF, 0xF1, 0xF3, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0xE4, 0x90, 0x93, -+0x0F, 0xF0, 0xA3, 0xF0, 0xD2, 0xAF, 0x22, 0x90, 0x93, 0x20, 0xE0, 0x90, 0x95, 0x86, 0xF0, 0x90, -+0x93, 0x21, 0xE0, 0x90, 0x95, 0x87, 0xF0, 0x90, 0x93, 0x22, 0xE0, 0x90, 0x95, 0x88, 0xF0, 0x90, -+0x93, 0x23, 0xE0, 0x90, 0x95, 0x89, 0xF0, 0x90, 0x93, 0x24, 0xE0, 0x90, 0x95, 0x8A, 0xF0, 0x90, -+0x93, 0x11, 0xE0, 0x90, 0x95, 0x8B, 0xF0, 0x90, 0x93, 0x12, 0xE0, 0x90, 0x95, 0x8C, 0xF0, 0x90, -+0x93, 0x13, 0xE0, 0x90, 0x95, 0x8D, 0xF0, 0x90, 0x93, 0x14, 0xE0, 0x90, 0x95, 0x8E, 0xF0, 0x90, -+0x93, 0x15, 0xE0, 0x90, 0x95, 0x8F, 0xF0, 0x90, 0x93, 0x16, 0xE0, 0x90, 0x95, 0x90, 0xF0, 0x90, -+0x93, 0x17, 0xE0, 0x90, 0x95, 0x91, 0xF0, 0x90, 0x93, 0x18, 0xE0, 0x90, 0x95, 0x92, 0xF0, 0x90, -+0x93, 0x19, 0xE0, 0x90, 0x95, 0x93, 0xF0, 0x90, 0x93, 0x1A, 0xE0, 0x90, 0x95, 0x94, 0xF0, 0xF1, -+0xCB, 0xD1, 0x51, 0x90, 0x95, 0x2E, 0xF0, 0xB1, 0xD1, 0x50, 0x09, 0xD1, 0x0F, 0x74, 0x01, 0xF0, -+0xB1, 0xCA, 0x80, 0xF3, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x12, 0xB6, 0x17, 0x90, -+0x95, 0x23, 0xF0, 0xA3, 0xF1, 0xAA, 0xB1, 0xD1, 0x50, 0x4C, 0xB1, 0xF9, 0x90, 0x95, 0x2E, 0xE0, -+0xFE, 0x24, 0x95, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xD1, 0x31, 0xE0, 0x24, 0x4D, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x30, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xD1, 0x31, -+0xE0, 0x24, 0x4E, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xEE, 0x12, 0xD2, 0x36, 0x12, 0x86, -+0x7A, 0xD1, 0x35, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0xEE, 0x12, 0xD2, 0x28, 0x12, -+0x86, 0x7A, 0xB1, 0xCA, 0x80, 0xB0, 0x90, 0x02, 0x87, 0xE0, 0x70, 0x02, 0xA1, 0x96, 0x90, 0x93, -+0x03, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0x96, 0xE4, 0x90, 0x95, 0x9F, 0xD1, 0x51, 0x90, 0x95, 0x23, -+0xE0, 0xFF, 0xA3, 0xE0, 0xA3, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x25, 0xE0, 0xFC, 0xA3, -+0xE0, 0xFD, 0xEC, 0x90, 0xFD, 0x11, 0xF0, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -+0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, -+0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0x90, 0x95, 0x27, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x02, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, -+0x90, 0x95, 0x2A, 0xF0, 0xFC, 0x74, 0x07, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, -+0x54, 0xC0, 0x90, 0x95, 0x2C, 0xF0, 0xEC, 0x24, 0x18, 0x90, 0x95, 0x29, 0xF0, 0xFD, 0x90, 0x95, -+0x25, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0xEF, 0x54, 0xFC, 0x90, 0x95, -+0x2B, 0xF0, 0x90, 0x95, 0x2A, 0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0x90, 0x95, 0x27, 0x8F, 0xF0, -+0x12, 0x02, 0xE7, 0x90, 0x95, 0x27, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0xCE, 0x68, 0x90, 0x95, -+0x23, 0xEE, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x88, 0x27, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, -+0x95, 0x23, 0x12, 0xC6, 0xDE, 0x40, 0x1B, 0x90, 0x88, 0x28, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x88, -+0x27, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xED, 0x9F, 0xFF, 0xEC, 0x9E, 0x90, 0x95, 0x23, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x95, 0x2B, 0xE0, 0x24, 0xC0, 0x60, 0x02, 0x81, 0x9A, 0xB1, 0xDE, 0x24, 0x18, -+0xFD, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0xEF, 0x60, 0x02, 0x81, 0x8F, 0xB1, 0xDE, 0x24, 0x19, 0xFD, -+0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0x90, 0x95, 0x44, 0xF1, 0xBA, 0x90, 0x95, 0x44, 0xE0, 0xFF, 0xD1, -+0x08, 0x9F, 0x50, 0x17, 0xB1, 0xDE, 0x24, 0x1A, 0xF1, 0xB2, 0xB1, 0xBE, 0x90, 0x95, 0x2D, 0xE0, -+0x24, 0x45, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xD1, 0x1A, 0x80, 0xDF, 0x90, 0x95, 0x44, 0xE0, 0x70, -+0x02, 0x61, 0xBC, 0xE4, 0x90, 0x95, 0x2E, 0xF0, 0xB1, 0xD1, 0x40, 0x02, 0x61, 0xA4, 0xB1, 0xF9, -+0x90, 0x95, 0x2E, 0xE0, 0xFF, 0x24, 0x30, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFE, -+0x90, 0x95, 0x44, 0xE0, 0xFD, 0xEE, 0x6D, 0x70, 0x21, 0xEF, 0x12, 0xD2, 0x36, 0x12, 0x86, 0x71, -+0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xD1, 0x25, 0x90, 0x95, 0xAA, 0xED, 0xF0, 0xD0, 0x01, 0xD0, -+0x02, 0xD0, 0x03, 0xD1, 0x5B, 0xEF, 0x60, 0x02, 0x80, 0x4D, 0x90, 0x95, 0x44, 0xE0, 0x64, 0x03, -+0x70, 0x54, 0xD1, 0x25, 0x90, 0x95, 0xAA, 0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x43, 0xD1, 0x5B, -+0xEF, 0x70, 0x11, 0xD1, 0x25, 0x90, 0x95, 0xAA, 0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x3F, 0xD1, -+0x5B, 0xEF, 0x60, 0x2A, 0x90, 0x95, 0x2E, 0xE0, 0xFF, 0x24, 0x90, 0xF5, 0x82, 0xE4, 0x34, 0x95, -+0xF5, 0x83, 0xE0, 0x60, 0x02, 0x80, 0x0B, 0x90, 0x95, 0x2E, 0xE0, 0xFF, 0x24, 0x8B, 0xF1, 0xD4, -+0x60, 0x05, 0x74, 0x9F, 0x2F, 0x80, 0x15, 0xB1, 0xEB, 0x74, 0x01, 0xF0, 0x80, 0x12, 0x90, 0x95, -+0x2E, 0xE0, 0x24, 0x9F, 0x80, 0x06, 0x90, 0x95, 0x2E, 0xE0, 0x24, 0x9F, 0xB1, 0xF1, 0xE4, 0xF0, -+0xB1, 0xCA, 0x41, 0xF8, 0x90, 0x95, 0x9F, 0xE0, 0x70, 0x4F, 0xA3, 0xE0, 0x70, 0x4B, 0xA3, 0xE0, -+0x70, 0x47, 0xA3, 0xE0, 0x70, 0x43, 0xA3, 0xE0, 0x70, 0x3F, 0x81, 0x8F, 0xE4, 0x90, 0x95, 0x2E, -+0xF0, 0xB1, 0xD1, 0x50, 0x1C, 0x74, 0x8B, 0x2E, 0xF1, 0xD4, 0x60, 0x09, 0x74, 0x9F, 0x2E, 0xB1, -+0xF1, 0xE4, 0xF0, 0x80, 0x08, 0x74, 0x9F, 0x2E, 0xB1, 0xF1, 0x74, 0x01, 0xF0, 0xB1, 0xCA, 0x80, -+0xE0, 0x90, 0x95, 0x9F, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0xA3, 0xE0, 0x70, 0x0A, 0xA3, -+0xE0, 0x70, 0x06, 0xA3, 0xE0, 0x70, 0x02, 0x81, 0x8F, 0xE4, 0x90, 0x95, 0x2E, 0xF0, 0xB1, 0xD1, -+0x40, 0x02, 0x81, 0x8F, 0xB1, 0xF9, 0xB1, 0xEB, 0xE0, 0x70, 0x02, 0x81, 0x8B, 0x90, 0x93, 0x29, -+0xE0, 0x30, 0xE0, 0x06, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x71, 0xE4, 0xFF, 0xFE, 0x90, 0x04, 0x1D, -+0xE0, 0x60, 0x10, 0xD3, 0xEF, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x50, 0x07, 0x0F, 0xBF, 0x00, 0x01, -+0x0E, 0x80, 0xEA, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x52, 0x90, 0x95, 0x2E, 0xE0, 0x24, 0x86, 0xF5, -+0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x06, 0xF0, 0x7B, 0x08, -+0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x95, 0x27, 0xEE, 0xF0, 0xA3, 0xF1, 0xBA, 0xD1, 0x08, 0x94, -+0x06, 0x50, 0x1E, 0xB1, 0xDE, 0x24, 0x0A, 0xF1, 0xB2, 0xB1, 0xBE, 0x90, 0x95, 0x27, 0xA3, 0xE0, -+0xFE, 0x90, 0x95, 0x2D, 0xE0, 0x2E, 0x24, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xD1, 0x1A, 0x80, -+0xDC, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x90, 0x06, 0x35, 0xF0, 0xB1, 0xCA, 0x61, 0xFE, 0x12, -+0xCE, 0x52, 0x90, 0x06, 0x36, 0x74, 0xDD, 0xF0, 0x21, 0xB6, 0x90, 0x95, 0x2C, 0xE0, 0x60, 0x02, -+0xA1, 0x91, 0xB1, 0xDE, 0x24, 0x16, 0xFD, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0x90, 0x06, 0x34, 0xEF, -+0xF0, 0xB1, 0xDE, 0x24, 0x17, 0xFD, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0x90, 0x06, 0x37, 0xF1, 0xAA, -+0xB1, 0xD1, 0x50, 0x3C, 0xB1, 0xF9, 0xE4, 0x90, 0x95, 0x2D, 0xF0, 0xD1, 0x08, 0x94, 0x06, 0x50, -+0x2B, 0xB1, 0xDE, 0x24, 0x04, 0x2D, 0xFD, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0x90, 0x95, 0x2E, 0xE0, -+0xFE, 0x12, 0xD2, 0x28, 0x12, 0x86, 0x71, 0x90, 0x95, 0x2D, 0xE0, 0xF5, 0x82, 0xD1, 0x89, 0x6F, -+0x60, 0x06, 0xD1, 0x0F, 0xE4, 0xF0, 0x80, 0x04, 0xD1, 0x1E, 0x80, 0xCF, 0xB1, 0xCA, 0x80, 0xC0, -+0x90, 0x95, 0x9A, 0xE0, 0x64, 0x01, 0x60, 0x17, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x11, 0xA3, 0xE0, -+0x64, 0x01, 0x60, 0x0B, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x05, 0xA3, 0xE0, 0xB4, 0x01, 0x06, 0x90, -+0x95, 0x2F, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x2F, 0xE0, 0x64, 0x01, 0x70, 0x4F, 0x11, 0xB2, 0x12, -+0xBD, 0x71, 0x12, 0xBB, 0x83, 0x90, 0x93, 0x25, 0xE0, 0x70, 0x02, 0x21, 0xB6, 0x90, 0x01, 0x3C, -+0xE0, 0x30, 0xE4, 0x03, 0x74, 0x10, 0xF0, 0x7D, 0x10, 0xE4, 0xFF, 0x12, 0x7C, 0x05, 0x90, 0x93, -+0x26, 0xE0, 0x60, 0x08, 0xF5, 0x4D, 0xE4, 0xF5, 0x4E, 0xFB, 0x80, 0x15, 0x90, 0x93, 0x27, 0xE0, -+0x60, 0x08, 0xFB, 0xE4, 0xF5, 0x4D, 0xF5, 0x4E, 0x80, 0x07, 0x75, 0x4D, 0x20, 0xE4, 0xF5, 0x4E, -+0xFB, 0x7D, 0x01, 0x7F, 0x60, 0x7E, 0x01, 0x12, 0x72, 0xB7, 0x21, 0xB6, 0xF1, 0xCB, 0xD1, 0x51, -+0x90, 0x95, 0x2E, 0xF0, 0xB1, 0xD1, 0x50, 0x09, 0xD1, 0x0F, 0x74, 0x01, 0xF0, 0xB1, 0xCA, 0x80, -+0xF3, 0x12, 0xCE, 0x52, 0x21, 0xB6, 0x22, 0x90, 0x86, 0xB6, 0xE0, 0xFF, 0x90, 0x96, 0x65, 0xE0, -+0xFB, 0x90, 0x92, 0x13, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x96, 0x66, 0xEE, -+0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x96, 0x64, 0xE0, 0xFF, 0x90, 0x8A, 0x95, 0xE0, 0xFA, -+0xA3, 0xE0, 0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, 0x90, 0x95, 0x2E, 0xE0, 0x04, 0xF0, -+0x22, 0x90, 0x93, 0x0E, 0xE0, 0xFF, 0x90, 0x95, 0x2E, 0xE0, 0xFE, 0xC3, 0x9F, 0x22, 0x90, 0x95, -+0x25, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x29, 0xE0, 0x22, 0x90, 0x95, 0x2E, 0xE0, 0x24, -+0x9F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0x74, 0x86, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -+0x95, 0xF5, 0x83, 0xE0, 0xFF, 0x02, 0x7B, 0x07, 0x90, 0x95, 0x2D, 0xE0, 0xFD, 0xC3, 0x22, 0x74, -+0x9A, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x95, -+0x2D, 0xE0, 0x04, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x45, 0x90, 0x95, 0xA7, 0x02, 0x86, -+0x7A, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x95, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, -+0x90, 0x96, 0x17, 0xE0, 0xFF, 0x90, 0x95, 0x35, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, -+0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x95, 0xA4, 0x12, 0x86, -+0x7A, 0xE4, 0xFF, 0x90, 0x95, 0xAA, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x14, 0x90, 0x95, 0xA7, -+0xD1, 0x84, 0xFE, 0x90, 0x95, 0xA4, 0xD1, 0x84, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, 0x80, -+0xE2, 0x7F, 0x01, 0x22, 0x12, 0x86, 0x71, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, 0x02, 0x1F, 0xE4, -+0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x85, 0x4E, 0x90, 0x95, 0x22, 0xEF, 0xF0, 0x60, 0xF0, 0x90, -+0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0F, -+0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x35, 0xBE, 0x12, 0xC0, 0x91, 0xD1, -+0xFE, 0x30, 0xE1, 0x09, 0x54, 0xFD, 0xF0, 0x90, 0x86, 0x08, 0x12, 0x8D, 0xDA, 0xD1, 0xFE, 0x30, -+0xE2, 0x09, 0x54, 0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x12, 0x8D, 0xDA, 0xD1, 0xFE, 0xFF, 0x30, 0xE5, -+0x0B, 0x54, 0xDF, 0xF0, 0x12, 0xB6, 0xF0, 0xBF, 0x01, 0x02, 0x11, 0xC7, 0xD1, 0xFE, 0x30, 0xE6, -+0x09, 0x54, 0xBF, 0xF0, 0x90, 0x8A, 0x7D, 0x12, 0x8D, 0xDA, 0xD2, 0xAF, 0x80, 0xA1, 0xD2, 0xAF, -+0xC2, 0xAF, 0x90, 0x86, 0xAF, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -+0x64, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, 0xE0, -+0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x3D, -+0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0x68, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x7D, 0x26, -+0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xFD, 0x12, 0x8D, 0xDA, 0xEF, 0x64, 0x01, 0x70, 0x02, -+0x80, 0x05, 0xF1, 0xDD, 0x30, 0xE0, 0x06, 0xB1, 0x97, 0xF1, 0xE7, 0xF1, 0x9E, 0x90, 0x96, 0x68, -+0xE0, 0x12, 0xCD, 0x09, 0x7D, 0x27, 0x12, 0x04, 0x7E, 0xF1, 0xC2, 0x80, 0x08, 0xF1, 0xC2, 0xF1, -+0x9E, 0xB1, 0x97, 0xF1, 0xE7, 0xF1, 0x9E, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x13, 0xF1, 0xDD, -+0x30, 0xE0, 0x0E, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x6F, 0x12, 0xCD, 0x09, 0x7D, 0x28, 0x12, 0x04, -+0x7E, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFC, -+0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x02, 0x04, 0x7E, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0x2E, -+0xF0, 0x22, 0xFC, 0xED, 0x2C, 0xFD, 0x90, 0x8A, 0xE9, 0x22, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0x2D, -+0xF0, 0x22, 0x90, 0x96, 0x64, 0xE0, 0xFF, 0x90, 0x8A, 0xC7, 0x22, 0xE4, 0x90, 0x95, 0x2F, 0xF0, -+0x90, 0x95, 0x9A, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x88, 0xA1, -+0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x96, 0x66, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, -+0x8A, 0x9B, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x12, 0x8F, 0xF5, 0x12, 0x8B, -+0x6E, 0x11, 0x0A, 0x7A, 0x93, 0x79, 0x1B, 0x02, 0x69, 0xF5, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, -+0x75, 0x48, 0x05, 0x7B, 0x01, 0x22, 0x12, 0x8F, 0xF5, 0x12, 0x8B, 0x6E, 0x11, 0x0A, 0x7A, 0x93, -+0x79, 0x20, 0x02, 0x69, 0xF5, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0x28, 0xF0, 0xBF, 0x01, 0x07, -+0x11, 0x38, 0xE4, 0x90, 0x93, 0x28, 0xF0, 0x22, 0x11, 0xCF, 0x71, 0xC9, 0xBF, 0x01, 0x06, 0x90, -+0x94, 0xA2, 0xE0, 0xA3, 0xF0, 0x11, 0xCF, 0x71, 0xC2, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xA2, 0xE0, -+0x90, 0x94, 0xA4, 0xF0, 0x11, 0xCF, 0x71, 0xD0, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xA2, 0xE0, 0x90, -+0x94, 0xA5, 0xF0, 0x11, 0xCF, 0x11, 0xD6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xA2, 0xE0, 0x90, 0x94, -+0xA6, 0xF0, 0x11, 0xCF, 0x71, 0xBB, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xA2, 0xE0, 0x90, 0x94, 0xA7, -+0xF0, 0x90, 0x94, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x94, -+0xAB, 0xF0, 0x90, 0x94, 0xA7, 0xE0, 0x90, 0x94, 0xAC, 0xF0, 0x90, 0x94, 0xAD, 0x74, 0x12, 0xF0, -+0x90, 0x94, 0xCF, 0x74, 0x05, 0xF0, 0x90, 0x94, 0xAF, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, -+0xF0, 0x90, 0x94, 0xAB, 0xE0, 0x90, 0x94, 0xB2, 0xF0, 0x90, 0x94, 0xAC, 0xE0, 0x90, 0x94, 0xB3, -+0xF0, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xAD, 0x12, 0x8D, 0xB6, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x7B, -+0x01, 0x7A, 0x94, 0x79, 0xA2, 0x22, 0x7F, 0xF3, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x90, 0x94, 0xA2, -+0xEF, 0xF0, 0x71, 0x13, 0x71, 0xD0, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, 0xEB, -+0xF0, 0x71, 0x13, 0x71, 0xC9, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, 0xEC, 0xF0, -+0x71, 0x13, 0x71, 0xC2, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, 0xED, 0xF0, 0x71, -+0x13, 0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, -+0x94, 0xEE, 0xF0, 0x71, 0x13, 0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, -+0x94, 0xE9, 0xE0, 0x90, 0x94, 0xEF, 0xF0, 0x71, 0x13, 0x71, 0xB4, 0xBF, 0x01, 0x08, 0x90, 0x94, -+0xE9, 0xE0, 0x90, 0x94, 0xF0, 0xF0, 0x71, 0x13, 0x71, 0x1A, 0x70, 0x52, 0x90, 0x94, 0xE9, 0xE0, -+0x90, 0x94, 0xF1, 0xF0, 0x54, 0x07, 0x60, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x54, 0xE0, 0x70, 0x3E, -+0x7B, 0x01, 0x7A, 0x94, 0x79, 0xEA, 0x7F, 0xFA, 0x71, 0x1C, 0x70, 0x32, 0x90, 0x94, 0xE9, 0xE0, -+0xFC, 0x54, 0x07, 0x70, 0x12, 0x90, 0x94, 0xF1, 0xE0, 0xFE, 0x90, 0x94, 0xEA, 0xE0, 0x54, 0x07, -+0xFD, 0xEE, 0x4D, 0x90, 0x94, 0xF1, 0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x94, 0xF1, 0xE0, -+0xFF, 0x90, 0x94, 0xEA, 0xE0, 0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x94, 0xF1, 0xF0, 0x71, 0x13, -+0x7F, 0xFD, 0x71, 0x1C, 0x70, 0x46, 0x90, 0x94, 0xE9, 0xE0, 0xFE, 0x54, 0xCC, 0x90, 0x94, 0xF2, -+0xF0, 0xEE, 0x54, 0x0C, 0xFF, 0x60, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x54, 0xC0, 0x70, 0x2D, 0xEF, -+0x70, 0x11, 0x90, 0x94, 0xF2, 0xE0, 0xFF, 0x90, 0x94, 0xE9, 0xE0, 0x54, 0x03, 0xF1, 0xCF, 0x90, -+0x94, 0xF2, 0xF0, 0x90, 0x94, 0xE9, 0xE0, 0xFF, 0x54, 0xC0, 0x70, 0x10, 0x90, 0x94, 0xF2, 0xE0, -+0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0xEE, 0x4F, 0xF0, 0x71, 0x13, 0x7F, 0xF0, -+0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, 0xF3, 0xF0, -+0x71, 0x13, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, -+0x90, 0x94, 0xF4, 0xF0, 0x71, 0x13, 0x71, 0xBB, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, -+0x94, 0xF5, 0xF0, 0x71, 0x13, 0x11, 0xD6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, -+0xF6, 0xF0, 0x71, 0x13, 0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, -+0xE9, 0xE0, 0x90, 0x94, 0xF7, 0xF0, 0x90, 0x94, 0xA3, 0x74, 0x19, 0xF0, 0x90, 0x94, 0xC5, 0x74, -+0x08, 0xF0, 0x90, 0x94, 0xEB, 0xE0, 0x90, 0x94, 0xA5, 0xF0, 0x90, 0x94, 0xEC, 0xE0, 0x90, 0x94, -+0xA6, 0xF0, 0x90, 0x94, 0xED, 0xE0, 0x90, 0x94, 0xA7, 0xF0, 0x90, 0x94, 0xEE, 0xE0, 0x90, 0x94, -+0xA8, 0xF0, 0x90, 0x94, 0xEF, 0xE0, 0x90, 0x94, 0xA9, 0xF0, 0x90, 0x94, 0xF0, 0xE0, 0x90, 0x94, -+0xAA, 0xF0, 0x90, 0x94, 0xF1, 0xE0, 0x90, 0x94, 0xAB, 0xF0, 0x90, 0x94, 0xF2, 0xE0, 0x90, 0x94, -+0xAC, 0xF0, 0x90, 0x94, 0xC6, 0x74, 0x1A, 0xF0, 0x90, 0x94, 0xE8, 0x74, 0x05, 0xF0, 0x90, 0x94, -+0xF3, 0xE0, 0x90, 0x94, 0xC8, 0xF0, 0x90, 0x94, 0xF4, 0xE0, 0x90, 0x94, 0xC9, 0xF0, 0x90, 0x94, -+0xF5, 0xE0, 0x90, 0x94, 0xCA, 0xF0, 0x90, 0x94, 0xF6, 0xE0, 0x90, 0x94, 0xCB, 0xF0, 0x90, 0x94, -+0xF7, 0xE0, 0x90, 0x94, 0xCC, 0xF0, 0x90, 0x94, 0xA2, 0xE0, 0xB4, 0x01, 0x1C, 0x7B, 0x01, 0x7A, -+0x94, 0x79, 0xA3, 0x90, 0x8A, 0x77, 0xF1, 0xE9, 0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x94, 0x79, -+0xC6, 0x12, 0x8D, 0xB6, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, 0x94, 0x75, -+0x47, 0xA3, 0x75, 0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x69, 0xF5, 0x75, 0x45, -+0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0xC8, 0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xAA, -+0x02, 0x69, 0xF5, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xE9, 0x22, 0x7F, 0xFB, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xEF, 0x64, 0x01, 0x22, 0x7E, 0x00, 0x7F, 0x0B, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, -+0x4B, 0x12, 0x04, 0x80, 0x71, 0xAD, 0x71, 0xB4, 0xBF, 0x01, 0x1C, 0x90, 0x94, 0x9E, 0xE0, 0xFE, -+0x54, 0x01, 0x90, 0x93, 0x4B, 0xF0, 0xEE, 0x54, 0x04, 0x90, 0x93, 0x4D, 0xF0, 0x90, 0x94, 0x9E, -+0xE0, 0x54, 0x08, 0x90, 0x93, 0x4C, 0xF0, 0x71, 0xAD, 0x71, 0x1A, 0x70, 0x35, 0x90, 0x94, 0x9E, -+0xE0, 0x54, 0x07, 0x70, 0x15, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0x9F, 0x7F, 0xFA, 0x7E, 0x01, 0x12, -+0x5F, 0xA6, 0xBF, 0x01, 0x0F, 0x90, 0x94, 0x9F, 0x80, 0x03, 0x90, 0x94, 0x9E, 0xE0, 0x54, 0x07, -+0x90, 0x93, 0x4F, 0xF0, 0x90, 0x94, 0x9E, 0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, -+0x4E, 0xF0, 0x71, 0xAD, 0x7F, 0xFD, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x94, -+0x9E, 0xE0, 0x54, 0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x93, 0x50, 0xF0, 0x22, 0x7B, 0x01, 0x7A, -+0x94, 0x79, 0x9E, 0x22, 0x7F, 0xF9, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF2, 0x7E, 0x01, 0x02, -+0x5F, 0xA6, 0x7F, 0xF6, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF5, 0x7E, 0x01, 0x02, 0x5F, 0xA6, -+0x7F, 0xF4, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, -+0x12, 0x7B, 0x2E, 0x12, 0xB9, 0x90, 0x12, 0xC8, 0x7B, 0x12, 0x7B, 0x79, 0x12, 0xC8, 0x88, 0x12, -+0xB9, 0x23, 0x7F, 0x01, 0x12, 0x84, 0x15, 0x90, 0x93, 0x48, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x84, -+0x15, 0x90, 0x93, 0x48, 0xE0, 0x04, 0xF0, 0x91, 0x4B, 0x91, 0x97, 0x90, 0x00, 0x80, 0xE0, 0x44, -+0x40, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, 0x01, 0xA0, -+0xE0, 0xB4, 0xFD, 0x04, 0xE4, 0xFF, 0x11, 0xDD, 0xB1, 0x63, 0x90, 0x00, 0x81, 0xE0, 0x44, 0x04, -+0xFD, 0x7F, 0x81, 0x12, 0x7B, 0x2E, 0xF1, 0xDF, 0x71, 0x25, 0x90, 0x00, 0xAA, 0xE0, 0x44, 0x02, -+0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, 0xE4, 0xFF, 0x02, 0x84, 0x9E, 0x12, 0x7B, 0x1B, 0x90, 0x86, -+0xB3, 0xEF, 0xF0, 0x91, 0x65, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, -+0x80, 0xF0, 0x02, 0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, 0x75, 0xE0, 0x12, 0xB9, 0x2F, 0x12, 0xB9, -+0x68, 0xE4, 0xF5, 0x21, 0xF5, 0x22, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, 0x21, 0x7F, 0x50, 0x12, -+0x7B, 0x2E, 0xAD, 0x22, 0x7F, 0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, 0x52, 0x12, 0x7B, 0x2E, -+0xAD, 0x24, 0x7F, 0x53, 0x02, 0x7B, 0x2E, 0xF1, 0x2A, 0x12, 0x7B, 0xDB, 0x90, 0x8A, 0xC5, 0x12, -+0x8D, 0xDA, 0xB1, 0xB4, 0xD1, 0x31, 0x91, 0xBB, 0x12, 0xCE, 0x8B, 0x90, 0x8A, 0x73, 0x12, 0x8D, -+0xDA, 0x12, 0xC8, 0x5E, 0x90, 0x93, 0x49, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x93, 0x29, 0xE0, 0x54, -+0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x44, 0x08, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xFF, -+0x64, 0x02, 0x70, 0x29, 0xB1, 0x5C, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x2F, 0xB1, 0x5A, -+0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x2D, 0xB1, 0x5A, 0x30, 0xE2, 0x02, 0x7E, 0x01, 0x90, -+0x93, 0x2E, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x90, 0x02, 0xFB, 0xF0, 0x22, 0xEF, 0x64, 0x01, -+0x70, 0x1D, 0xB1, 0x53, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2F, 0xB1, 0x51, 0x30, 0xE1, -+0x02, 0x7F, 0x01, 0x90, 0x93, 0x2D, 0xB1, 0x51, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, 0x23, 0x90, -+0x86, 0xB3, 0xE0, 0x64, 0x03, 0x70, 0x20, 0xB1, 0x4A, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, -+0x2F, 0xB1, 0x48, 0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2D, 0xB1, 0x48, 0x30, 0xE2, 0x02, -+0x7F, 0x01, 0x90, 0x93, 0x2E, 0xEF, 0xF0, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, -+0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x70, 0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, -+0x7E, 0x00, 0x22, 0xE4, 0x90, 0x94, 0x9E, 0xF0, 0xA3, 0xF0, 0x12, 0xC8, 0xA8, 0xEF, 0x64, 0x01, -+0x60, 0x3B, 0xC3, 0x90, 0x94, 0x9F, 0xE0, 0x94, 0x88, 0x90, 0x94, 0x9E, 0xE0, 0x94, 0x13, 0x40, -+0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1D, -+0x90, 0x94, 0x9E, 0xF1, 0xC0, 0xF1, 0xC8, 0xD3, 0x90, 0x94, 0x9F, 0xE0, 0x94, 0x32, 0x90, 0x94, -+0x9E, 0xE0, 0x94, 0x00, 0x40, 0xC4, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xBD, 0x90, 0x01, 0xC7, -+0x74, 0xFE, 0xF0, 0x22, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, 0x90, 0x89, 0x2E, 0x12, 0x86, 0x7A, -+0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x80, 0x90, 0x89, 0x31, 0x12, 0x86, 0x7A, 0x7A, 0x80, 0x79, 0xBF, -+0x90, 0x89, 0x34, 0x12, 0x86, 0x7A, 0x7A, 0x81, 0x79, 0x61, 0x90, 0x89, 0x3A, 0x12, 0x86, 0x7A, -+0x7A, 0x81, 0x79, 0x75, 0x90, 0x89, 0x3D, 0x12, 0x86, 0x7A, 0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, -+0x40, 0x12, 0x86, 0x7A, 0xF1, 0xD7, 0x12, 0x86, 0x7A, 0x7A, 0x81, 0x79, 0xD9, 0x90, 0x89, 0x49, -+0x12, 0x86, 0x7A, 0x7A, 0x82, 0x79, 0x01, 0x90, 0x89, 0x4C, 0x12, 0x86, 0x7A, 0xE4, 0x90, 0x96, -+0x17, 0xF0, 0x90, 0x94, 0x9E, 0xF0, 0x90, 0x94, 0x9E, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x10, -+0x74, 0x28, 0x2F, 0x12, 0xC6, 0x87, 0xE4, 0xF0, 0x90, 0x94, 0x9E, 0xE0, 0x04, 0xF0, 0x80, 0xE6, -+0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x31, 0x12, 0x04, 0x80, -+0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x50, -+0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF1, 0x14, 0xFF, 0xF1, 0x1C, 0x12, 0xD0, -+0x29, 0x90, 0x8A, 0x89, 0x12, 0x8D, 0xC8, 0xF1, 0x30, 0x90, 0x8A, 0x89, 0x12, 0x8D, 0xC8, 0x7D, -+0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0x12, 0x8D, 0xC8, 0x12, 0x8F, 0xFB, 0x90, -+0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, 0x11, 0xEF, -+0xB4, 0x03, 0x08, 0x90, 0x88, 0x41, 0x74, 0x14, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0x41, 0xF0, -+0x7F, 0x79, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, 0x12, 0x7B, -+0x41, 0xEF, 0x30, 0xE2, 0x06, 0x90, 0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, 0x02, -+0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0xF1, -+0x14, 0xF1, 0x1C, 0x7E, 0x00, 0x7F, 0x18, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x30, 0x12, -+0x04, 0x80, 0x90, 0x8A, 0xA3, 0x12, 0x8D, 0xC8, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x7E, 0x00, 0x7F, -+0x02, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, -+0x54, 0x7F, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, -+0x88, 0x9C, 0xF0, 0x22, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, 0x22, 0x33, 0x33, 0x33, 0x54, -+0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x22, 0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, -+0xE4, 0xFD, 0xFF, 0x02, 0x04, 0x7E, 0xF1, 0x7C, 0x90, 0x95, 0xD0, 0xEF, 0xF0, 0x90, 0x8A, 0x89, -+0x30, 0xE0, 0x13, 0x12, 0x8D, 0xC8, 0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x33, -+0xE0, 0x44, 0x04, 0xF0, 0x80, 0x05, 0x12, 0x8D, 0xC8, 0xF1, 0x30, 0x90, 0x95, 0xD0, 0xE0, 0x30, -+0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, -+0x74, 0x80, 0xF0, 0x12, 0xCD, 0x55, 0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, 0x90, 0x95, 0xD2, -+0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, 0x90, 0x95, 0xD1, 0xEF, 0xF0, 0x7F, 0x83, 0x12, -+0x7B, 0x41, 0xAE, 0x07, 0x90, 0x95, 0xD1, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x95, -+0xD3, 0xE0, 0x94, 0x64, 0x90, 0x95, 0xD2, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, -+0x44, 0x40, 0xF0, 0x90, 0x95, 0xD1, 0xE0, 0xFF, 0x22, 0x90, 0x95, 0xD2, 0xF1, 0xC0, 0x80, 0xC3, -+0xE4, 0x75, 0xF0, 0x01, 0x02, 0x02, 0xE7, 0xF0, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x25, -+0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0x22, 0x7A, 0x81, 0x79, 0xB1, 0x90, 0x89, 0x46, 0x22, 0x90, -+0x01, 0xE4, 0x74, 0x10, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, -+0x8E, 0x83, 0x22, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x5B, 0xE0, 0x54, 0xFE, 0x4F, -+0xF0, 0x22, 0x12, 0x8F, 0xF5, 0x12, 0x8B, 0x6E, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x7F, 0x90, 0x88, -+0x36, 0xF0, 0xEF, 0x12, 0x8F, 0xCA, 0xA3, 0x12, 0x87, 0x3C, 0xFD, 0x54, 0xF0, 0xC4, 0x54, 0x0F, -+0xFF, 0x90, 0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, 0x12, 0x8F, 0xBF, 0xFC, 0x54, 0x01, 0x25, 0xE0, -+0xFF, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, 0xC3, 0x13, 0xFF, 0x90, -+0x88, 0x33, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xA3, 0xE0, -+0x54, 0x0F, 0x12, 0x87, 0x34, 0x90, 0x88, 0x35, 0x31, 0x04, 0xFD, 0x90, 0x8A, 0x89, 0x12, 0x8D, -+0xC8, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x8B, 0x6E, 0x12, 0x87, 0x2E, 0xFF, 0x54, 0x01, 0xFE, -+0x90, 0x88, 0x9B, 0x12, 0xB8, 0xE0, 0x12, 0x87, 0x2C, 0x12, 0xB8, 0xD6, 0x90, 0x88, 0x9B, 0x12, -+0xB8, 0xCD, 0x12, 0x87, 0x2B, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x90, 0x88, -+0x9B, 0xF0, 0xEE, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x12, 0x87, 0x2B, 0x54, 0x40, 0xFE, 0xEF, -+0x54, 0xBF, 0x4E, 0x90, 0x88, 0x9B, 0xF0, 0x12, 0xBD, 0x61, 0x20, 0xE0, 0x2F, 0xEF, 0xC3, 0x13, -+0x20, 0xE0, 0x0B, 0x75, 0x62, 0x01, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x0B, 0x80, 0x0E, 0xE4, 0xF5, -+0x62, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, 0xE4, 0xF5, 0x61, 0x80, 0x03, 0x75, 0x61, 0x01, 0x90, -+0x8A, 0xF3, 0x12, 0x8D, 0xC8, 0xAD, 0x62, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x12, 0x8B, 0x6E, 0x12, -+0x5C, 0x5F, 0x90, 0x88, 0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFB, 0xF0, -+0x12, 0xBD, 0x57, 0xF0, 0x90, 0x88, 0x36, 0x12, 0xD2, 0x4E, 0x90, 0x01, 0xBB, 0x31, 0x0B, 0x90, -+0x01, 0xBE, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, 0x1F, 0xF0, 0x90, 0x88, 0x34, 0xE0, -+0x54, 0x0F, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x17, 0x90, 0x88, 0x36, 0xE0, 0x60, -+0x11, 0x31, 0x0C, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x31, 0x83, 0x02, 0x04, 0x7A, 0x12, -+0x73, 0x8F, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xB1, 0x6E, 0x90, 0x88, 0x9D, -+0xE0, 0x20, 0xE0, 0x3E, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, 0x8A, 0xD7, 0x12, -+0x8D, 0xDA, 0x31, 0x0C, 0x60, 0x1E, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0xC8, 0xE4, 0xFD, 0x7F, 0x0C, -+0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x12, 0x9F, 0x30, 0x90, 0x8B, 0x01, 0x31, -+0x83, 0x02, 0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0xC8, -+0x51, 0x87, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x22, 0x31, 0x9C, 0xF1, 0xDA, 0x7F, -+0x01, 0x12, 0xD1, 0x76, 0x90, 0x8B, 0x07, 0x31, 0x83, 0x02, 0x04, 0x7A, 0xE4, 0x90, 0x95, 0xD0, -+0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x34, 0x91, 0xDB, 0x70, 0x30, 0x12, 0xD2, 0x8D, 0xF0, 0x12, -+0xD1, 0xF2, 0x90, 0x95, 0xD0, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x88, 0x3D, 0xF0, 0x04, 0x60, 0x1B, -+0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0xC8, 0x51, 0x87, 0x91, -+0xD3, 0x31, 0xDC, 0x51, 0x79, 0x90, 0x8A, 0xD7, 0x12, 0x8D, 0xDA, 0x22, 0xE4, 0x90, 0x92, 0x20, -+0xF0, 0x90, 0x88, 0x3E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xE4, 0xF5, 0x7B, 0x90, 0x88, -+0x36, 0xE0, 0x60, 0x7A, 0x91, 0xDB, 0x70, 0x76, 0x12, 0xD1, 0xF2, 0x12, 0xD2, 0x85, 0x60, 0x22, -+0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, -+0x06, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xA3, 0xF0, -+0x80, 0x00, 0x75, 0x7B, 0x01, 0xE5, 0x7B, 0x60, 0x45, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, -+0x90, 0x8A, 0xB9, 0x12, 0x8D, 0xC8, 0x51, 0x87, 0x91, 0xD3, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x04, -+0x64, 0x01, 0x70, 0x0F, 0x31, 0xDC, 0xFF, 0xA3, 0xE0, 0x2F, 0x51, 0x79, 0x31, 0xE1, 0xFF, 0xA3, -+0xE0, 0x80, 0x0B, 0x31, 0xDC, 0x51, 0x8E, 0x2F, 0x51, 0x79, 0x31, 0xE1, 0x51, 0x8E, 0x2F, 0x33, -+0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4F, 0xF0, 0x90, 0x8A, 0xD7, 0x12, 0x8D, 0xDA, 0x22, 0xF0, -+0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, -+0x7F, 0x54, 0x7E, 0x01, 0x02, 0x66, 0x33, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xFF, 0xA3, -+0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, 0xE4, 0xF5, 0x7B, 0x90, 0x06, 0xA9, 0xE0, 0xF5, -+0x7B, 0x54, 0xC0, 0x70, 0x17, 0x51, 0xFE, 0x54, 0xFD, 0xF0, 0xB1, 0x6B, 0x90, 0x88, 0x39, 0xE0, -+0x60, 0x4B, 0xF1, 0xD3, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE5, 0x7B, 0x30, 0xE6, -+0x21, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x1B, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0x31, -+0x0B, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, 0x8D, 0xDA, 0x80, 0x07, 0x12, 0x73, 0x8F, -+0x80, 0x02, 0x51, 0xFE, 0xE5, 0x7B, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0D, 0xE0, 0x44, 0x02, 0x51, -+0x6F, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x88, -+0x3A, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0x8F, -+0x80, 0x03, 0x90, 0x8A, 0x87, 0x12, 0x8D, 0xDA, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x04, 0xA3, -+0xE0, 0x04, 0xF0, 0x90, 0x88, 0xE7, 0xE0, 0x64, 0x08, 0x70, 0x20, 0x90, 0x88, 0xE6, 0xE0, 0x30, -+0xE0, 0x14, 0x12, 0xB3, 0xF5, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, 0xE0, 0x54, 0xFE, -+0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, 0x12, 0x97, 0xDD, 0x30, 0xE0, -+0x13, 0x90, 0x88, 0xE8, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, -+0x90, 0x88, 0xE8, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0x61, 0xEA, 0x90, 0x88, 0x4D, 0xE0, -+0x04, 0xF0, 0x90, 0x05, 0x61, 0x91, 0x37, 0x12, 0xD2, 0x1A, 0x90, 0x05, 0x60, 0x91, 0x37, 0x12, -+0x86, 0x58, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x91, 0x37, 0x78, -+0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x58, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x91, 0x36, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x58, 0x90, 0x88, 0x81, 0x12, 0x04, 0x31, 0x90, -+0x88, 0x32, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0C, 0x12, 0xCD, 0x55, 0x74, 0x05, -+0xF0, 0x12, 0x6E, 0x2F, 0x12, 0xD1, 0x6E, 0x90, 0x88, 0x32, 0x31, 0xE4, 0x30, 0xE0, 0x0B, 0x90, -+0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x04, 0xF1, 0xB6, 0xF1, 0xE1, 0x12, 0xC9, 0x23, 0xBF, 0x03, 0x14, -+0x90, 0x93, 0x49, 0xE0, 0xB4, 0x01, 0x0D, 0x90, 0x01, 0xB8, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x21, -+0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0xC8, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, -+0x93, 0x29, 0xE0, 0x30, 0xE0, 0x08, 0x12, 0xD2, 0x58, 0x51, 0x78, 0x12, 0xB8, 0xBD, 0x90, 0x86, -+0xB3, 0xE0, 0xB4, 0x01, 0x10, 0xF1, 0xBD, 0x20, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, -+0xE0, 0x03, 0x12, 0xD1, 0xB6, 0x22, 0xA3, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, 0x08, -+0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, 0x6E, 0x12, 0xCD, 0xB1, 0x12, 0xCD, 0xAA, 0x90, 0x07, -+0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, 0x2F, 0x91, 0xCB, 0xE0, 0xFE, 0x74, 0x69, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x04, 0xE8, 0x90, -+0x96, 0x6A, 0x91, 0x37, 0x12, 0xD2, 0x1A, 0x90, 0x96, 0x69, 0x91, 0x37, 0x12, 0x86, 0x58, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0x6B, 0x91, 0x37, 0x78, 0x10, 0x12, 0x03, -+0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x58, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0x91, 0x36, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -+0x01, 0xD0, 0x00, 0x12, 0x86, 0x58, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x07, -+0xF5, 0x83, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, -+0xEF, 0x64, 0x01, 0x22, 0x91, 0xDB, 0x70, 0x0A, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x04, 0xF1, 0xC8, -+0x51, 0x6F, 0x22, 0x90, 0x88, 0x32, 0xF1, 0xC0, 0x30, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x13, 0x54, -+0x03, 0x30, 0xE0, 0x02, 0xF1, 0xB6, 0x90, 0x88, 0x31, 0x12, 0xCD, 0x4E, 0x30, 0xE0, 0x0B, 0xEF, -+0x12, 0xD2, 0x44, 0xF0, 0x54, 0x07, 0x70, 0x4A, 0x80, 0x46, 0x90, 0x88, 0x3F, 0xE0, 0x04, 0xF0, -+0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEF, 0xF0, 0x12, 0xD0, 0x84, 0x40, 0x34, 0x91, 0xDB, 0x70, 0x32, -+0x31, 0x0C, 0x70, 0x08, 0x90, 0x8A, 0xF5, 0x12, 0x8D, 0xDA, 0x80, 0x27, 0x90, 0x8A, 0xF5, 0x12, -+0x8D, 0xDA, 0x90, 0x88, 0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x09, 0xB1, 0x63, -+0xE4, 0x90, 0x88, 0x40, 0xF0, 0x80, 0x03, 0x12, 0x73, 0x8F, 0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x22, -+0xB1, 0x6B, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x88, 0x38, 0xE0, 0xFF, -+0x90, 0x8A, 0xB9, 0x12, 0xCD, 0x0D, 0x7D, 0x01, 0x02, 0x04, 0x7E, 0x91, 0xDB, 0x70, 0x17, 0x90, -+0x88, 0x36, 0xE0, 0x60, 0x11, 0xF1, 0xC8, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x12, 0xD2, 0x44, 0xF0, -+0x54, 0x07, 0x70, 0x02, 0xB1, 0x6B, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, -+0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x97, 0xF0, 0x74, 0xA5, 0xA3, 0xF0, 0x12, 0x64, -+0x7F, 0xE5, 0x30, 0x30, 0xE1, 0x03, 0x12, 0xBE, 0xA4, 0xE5, 0x2D, 0x30, 0xE1, 0x02, 0xF1, 0xF0, -+0xE5, 0x2D, 0x30, 0xE3, 0x03, 0x12, 0xC8, 0xB4, 0xE5, 0x2D, 0x30, 0xE4, 0x03, 0x12, 0xC8, 0xC7, -+0xE5, 0x2D, 0x30, 0xE5, 0x03, 0x12, 0xC8, 0xD8, 0xE5, 0x2F, 0x30, 0xE0, 0x02, 0xD1, 0x77, 0xE5, -+0x2F, 0x30, 0xE1, 0x02, 0x71, 0x06, 0xE5, 0x2F, 0x30, 0xE2, 0x03, 0x12, 0xBE, 0x98, 0xE5, 0x2F, -+0x30, 0xE3, 0x02, 0x91, 0xE4, 0xE5, 0x2F, 0x30, 0xE4, 0x02, 0xB1, 0x7B, 0xE5, 0x2F, 0x30, 0xE5, -+0x02, 0x31, 0x13, 0xE5, 0x2F, 0x30, 0xE6, 0x02, 0xD1, 0x60, 0xE5, 0x2F, 0x30, 0xE7, 0x03, 0x12, -+0xC9, 0x14, 0xE5, 0x30, 0x30, 0xE0, 0x03, 0x12, 0xC9, 0x2B, 0xE5, 0x30, 0x30, 0xE4, 0x03, 0x12, -+0xC9, 0x3B, 0xE5, 0x30, 0x30, 0xE5, 0x03, 0x12, 0xC9, 0x40, 0x74, 0x97, 0x04, 0x90, 0x01, 0xC4, -+0xF0, 0x74, 0xA5, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, -+0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x0E, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x08, 0x51, 0xFE, -+0x54, 0x07, 0x70, 0x02, 0xB1, 0x6B, 0x22, 0x31, 0xEB, 0xE4, 0xFF, 0x12, 0xD1, 0x76, 0x90, 0x93, -+0x03, 0xE0, 0x30, 0xE0, 0x03, 0x12, 0xCE, 0xAC, 0x90, 0x8B, 0x07, 0x12, 0x8D, 0xDA, 0x02, 0x8F, -+0xD1, 0x91, 0xDB, 0x60, 0x02, 0xE1, 0xB5, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0xE1, 0xB5, 0x90, -+0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x32, 0x90, 0x06, 0xA9, 0xE0, 0x54, 0xC0, 0x70, 0x2A, 0x90, 0x88, -+0x9C, 0xE0, 0x70, 0x24, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x70, 0x1D, 0xE0, 0x54, 0x07, 0x64, 0x07, -+0x70, 0x16, 0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, 0x70, 0x0E, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, -+0x07, 0xF1, 0xD3, 0x54, 0xFE, 0x12, 0xB1, 0x76, 0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, -+0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, -+0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, 0x90, 0x07, 0xF1, 0xE0, 0x90, 0x94, 0x9C, 0xF0, -+0x90, 0x07, 0xF0, 0xE0, 0x90, 0x94, 0x9D, 0xF0, 0xF1, 0xC8, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, -+0xEC, 0xF0, 0x12, 0xD2, 0x6A, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x02, 0x51, 0x98, 0x12, 0xD2, 0x6A, -+0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, 0x3D, 0xF0, 0x90, 0x06, 0xAA, 0xE0, -+0x90, 0x88, 0x3C, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xFE, 0xFF, 0x80, -+0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x12, 0xCA, 0xCE, 0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x90, 0x88, -+0x32, 0xF1, 0xC0, 0x30, 0xE0, 0x5C, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x23, 0xF1, -+0xE8, 0x6F, 0x70, 0x4E, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0xD2, 0x8D, 0x12, 0xD2, -+0x61, 0x7F, 0x03, 0x12, 0x7C, 0x05, 0xF1, 0xE1, 0xF1, 0xB6, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, -+0x80, 0x30, 0x12, 0xD2, 0x85, 0x64, 0x01, 0x70, 0x29, 0xF1, 0xE8, 0xFE, 0x6F, 0x60, 0x23, 0x90, -+0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x1A, 0x12, 0xCD, 0x4B, 0x30, 0xE0, 0x14, 0xEF, 0x54, -+0xBF, 0x12, 0xD2, 0x61, 0x7F, 0x03, 0x12, 0x7C, 0x3B, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x7C, 0x74, -+0xF1, 0xDA, 0x12, 0xB8, 0xC5, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x90, 0x93, 0x29, -+0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, -+0x74, 0x02, 0x22, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, -+0x74, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, -+0xE4, 0xFF, 0x90, 0x95, 0xAB, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x95, -+0xCF, 0xF0, 0xE0, 0xFE, 0x6F, 0x60, 0x74, 0x90, 0x95, 0xAC, 0x74, 0x03, 0xF0, 0x90, 0x95, 0xCE, -+0x74, 0x08, 0xF0, 0xEE, 0x04, 0x54, 0x0F, 0xFF, 0xE4, 0xFE, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, -+0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2E, 0x11, 0x7C, 0xE0, 0xFD, 0x74, -+0xAE, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x08, 0xDA, -+0x7B, 0x01, 0x7A, 0x95, 0x79, 0xAC, 0x90, 0x8A, 0x77, 0x12, 0x9F, 0xE9, 0x12, 0x04, 0x7E, 0x90, -+0x95, 0xCF, 0xE0, 0x04, 0x54, 0x0F, 0xFF, 0xF0, 0xBF, 0x0F, 0x02, 0xE4, 0xF0, 0x90, 0x95, 0xCF, -+0xE0, 0x90, 0x04, 0x7F, 0xF0, 0x90, 0x95, 0xAB, 0xE0, 0x70, 0x05, 0x90, 0x8A, 0xE5, 0x80, 0x03, -+0x90, 0x8A, 0x79, 0x12, 0x8D, 0xC8, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xF5, 0x82, 0xE4, 0x35, -+0x83, 0xF5, 0x83, 0x22, 0x90, 0x94, 0x9E, 0x12, 0x86, 0x7A, 0x71, 0x4F, 0x12, 0x02, 0x06, 0x54, -+0x7F, 0xFD, 0x12, 0x87, 0x3D, 0xFE, 0x54, 0x1F, 0x90, 0x94, 0xA2, 0x12, 0x8F, 0xC6, 0x90, 0x94, -+0xA1, 0x12, 0x87, 0x35, 0xFE, 0x54, 0x03, 0xFC, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0x94, -+0xA4, 0x12, 0x87, 0x35, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0x94, 0xA3, 0x12, -+0x8F, 0xC6, 0xFF, 0x12, 0x87, 0x36, 0xFB, 0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0x94, -+0xA6, 0xF0, 0xFA, 0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEF, 0x54, 0x01, 0xC4, -+0x33, 0x33, 0x33, 0x54, 0x80, 0x31, 0xDB, 0x54, 0x7F, 0x4F, 0xF0, 0x90, 0x94, 0xA3, 0xE0, 0x54, -+0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0x31, 0xDB, 0x54, 0xBF, 0x4F, 0xF0, 0xEA, 0x60, 0x02, 0x21, -+0xDA, 0x90, 0x94, 0xA2, 0xE0, 0x54, 0x1F, 0xFF, 0x75, 0xF0, 0x12, 0xED, 0x71, 0x5A, 0x54, 0xE0, -+0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x31, 0xDB, 0x54, 0xFC, 0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x25, 0xE0, -+0x25, 0xE0, 0x31, 0xDB, 0x54, 0xF3, 0x4F, 0xF0, 0x90, 0x94, 0xA1, 0xE0, 0x54, 0x01, 0xC4, 0x33, -+0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x12, 0xED, 0x71, 0x5A, 0x54, 0xDF, 0x4F, 0xF0, 0x90, 0x94, 0xA4, -+0xE0, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0x31, 0xDB, 0x54, 0xCF, 0x4F, 0xD1, 0x9F, 0xE0, 0x54, 0xFB, -+0xD1, 0x9F, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0x94, 0xA7, 0xE0, 0x12, 0x9F, 0xCF, 0xD0, -+0x82, 0xD0, 0x83, 0xF0, 0x90, 0x93, 0x51, 0xE0, 0x60, 0x30, 0x71, 0x4F, 0xE9, 0x24, 0x03, 0xF9, -+0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x54, 0x1F, 0x12, 0x02, 0x4C, 0x90, 0x94, 0xA5, 0x74, 0x01, -+0xF0, 0x90, 0x94, 0xA5, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x0F, 0xEF, 0x71, 0x49, 0x8F, 0x82, -+0x8E, 0x83, 0xE4, 0x12, 0x02, 0x5E, 0xD1, 0x7E, 0x80, 0xE7, 0x90, 0x93, 0x4F, 0xE0, 0x54, 0x07, -+0xFF, 0xBF, 0x05, 0x0A, 0xEC, 0xB4, 0x01, 0x06, 0x90, 0x93, 0x54, 0x74, 0x01, 0xF0, 0xE4, 0x90, -+0x94, 0xA5, 0xF0, 0x90, 0x94, 0xA5, 0xE0, 0xFC, 0x71, 0x49, 0x8F, 0x82, 0x8E, 0x83, 0x12, 0x02, -+0x1F, 0xFF, 0xED, 0xF1, 0x4C, 0xE5, 0x82, 0x2C, 0x11, 0x7C, 0xEF, 0xF0, 0xD1, 0x7E, 0xE0, 0xB4, -+0x04, 0xE1, 0xAF, 0x05, 0x90, 0x8A, 0xFF, 0x12, 0x97, 0x9E, 0x22, 0xFF, 0x75, 0xF0, 0x12, 0xED, -+0x90, 0x89, 0x52, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, -+0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE6, 0x02, 0x61, 0x10, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x96, -+0x6D, 0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x96, 0x6E, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, -+0x90, 0x96, 0x6F, 0xF0, 0x90, 0x96, 0x6E, 0xE0, 0x24, 0xFC, 0x60, 0x0F, 0x24, 0x03, 0x60, 0x02, -+0x61, 0x05, 0x90, 0x96, 0x6D, 0xE0, 0xFF, 0x71, 0x62, 0x61, 0x05, 0x90, 0x96, 0x6D, 0xE0, 0x24, -+0xD6, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x71, 0x42, 0x75, -+0xF0, 0x12, 0x31, 0xE0, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x42, 0x75, 0xF0, -+0x12, 0x31, 0xE0, 0x12, 0x8F, 0xCA, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x42, 0x75, 0xF0, 0x12, 0x31, -+0xE0, 0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x42, 0xD1, 0x94, 0xFB, 0xE4, 0xFD, 0x0F, -+0x71, 0x42, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x50, 0x12, 0x04, 0x6E, 0x71, 0x3F, 0x75, 0xF0, 0x12, -+0x71, 0x5A, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0x71, 0x42, 0x75, 0xF0, 0x12, 0x71, -+0x5A, 0x54, 0x1F, 0x71, 0x40, 0xF1, 0x4C, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x42, 0x75, 0xF0, -+0x08, 0xA4, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, -+0x02, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, -+0xE4, 0x34, 0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x82, -+0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x42, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x05, 0xF5, -+0x82, 0xE4, 0x34, 0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, -+0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, -+0xE0, 0xFB, 0x0D, 0x71, 0x15, 0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, 0xF1, 0x28, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, -+0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, -+0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xF5, 0x83, 0xE0, -+0xFB, 0x0D, 0x71, 0x15, 0x90, 0x96, 0x6D, 0xE0, 0x22, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, -+0x94, 0x9E, 0x02, 0x86, 0x71, 0x75, 0xF0, 0x12, 0xE5, 0x72, 0x90, 0x89, 0x51, 0x12, 0x04, 0x6E, -+0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x77, 0xEF, 0xF0, 0x7F, 0x8F, -+0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, 0x3B, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, 0x01, 0x70, -+0x31, 0x90, 0x96, 0x78, 0xF0, 0x90, 0x96, 0x78, 0xE0, 0xFD, 0x90, 0x96, 0x77, 0xE0, 0x71, 0xC6, -+0xE5, 0x82, 0x2D, 0x11, 0x7C, 0xE0, 0xFB, 0xE4, 0xFF, 0x71, 0x15, 0x90, 0x96, 0x78, 0xE0, 0x04, -+0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xDE, 0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, -+0xF1, 0x28, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, -+0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x61, 0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, -+0xF5, 0x83, 0x22, 0x8D, 0x61, 0xEF, 0x30, 0xE6, 0x1E, 0x71, 0xC4, 0xB1, 0x77, 0xE0, 0x54, 0x03, -+0x90, 0x92, 0x80, 0xF0, 0xE4, 0xFB, 0xAF, 0x61, 0x12, 0x75, 0x80, 0x71, 0xB7, 0xE0, 0x90, 0x92, -+0x5E, 0xF0, 0xA3, 0x74, 0x01, 0x80, 0x4D, 0xB1, 0x94, 0x04, 0xF0, 0xB1, 0x94, 0x64, 0x02, 0x70, -+0x1B, 0x74, 0x18, 0x25, 0x61, 0xB1, 0x6F, 0xE0, 0xFD, 0xF4, 0x60, 0x02, 0x80, 0x04, 0x71, 0xC4, -+0xE0, 0xFD, 0xB1, 0x79, 0xD1, 0xAB, 0x71, 0xC4, 0xD1, 0x8B, 0x80, 0x28, 0xB1, 0x94, 0xD3, 0x94, -+0x03, 0x40, 0x17, 0x90, 0x8A, 0xB3, 0x12, 0x8D, 0xC8, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x71, 0xB7, -+0xE0, 0x90, 0x92, 0x5E, 0xF0, 0xA3, 0x74, 0x03, 0x80, 0x0A, 0x71, 0xC4, 0xB1, 0x77, 0xD1, 0xAB, -+0x71, 0xC4, 0xD1, 0x8B, 0xF0, 0xAB, 0x61, 0xE4, 0xFD, 0xFF, 0x02, 0x6F, 0x75, 0x8F, 0x72, 0x8D, -+0x73, 0xEF, 0x71, 0xC6, 0xE0, 0xF5, 0x74, 0x54, 0x7F, 0xF5, 0x75, 0xE5, 0x74, 0x54, 0x80, 0xF5, -+0x77, 0x75, 0xF0, 0x12, 0xEF, 0xD1, 0x97, 0xF5, 0x79, 0x75, 0xF0, 0x12, 0xEF, 0x31, 0xE0, 0xC4, -+0x54, 0x03, 0xF5, 0x7A, 0xB1, 0x6B, 0x74, 0xFF, 0xF0, 0xF1, 0x5A, 0xF0, 0xE5, 0x74, 0x45, 0x77, -+0xFF, 0xD1, 0x72, 0xEF, 0xF0, 0xE5, 0x72, 0xB1, 0x7B, 0xE0, 0x54, 0x03, 0xF5, 0x78, 0x74, 0x46, -+0x25, 0x72, 0xF1, 0x2F, 0xE5, 0x78, 0xF0, 0xE5, 0x75, 0x65, 0x79, 0x70, 0x40, 0x71, 0x55, 0xC4, -+0x13, 0x54, 0x07, 0x30, 0xE0, 0x0C, 0xE5, 0x77, 0x70, 0x08, 0xE5, 0x75, 0x44, 0x80, 0xF5, 0x74, -+0xA1, 0x41, 0xF1, 0x5A, 0xF0, 0xE5, 0x72, 0xF1, 0x40, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x95, 0x37, -+0xCF, 0xB1, 0x89, 0xE5, 0x72, 0xF0, 0xE4, 0x90, 0x95, 0x39, 0x12, 0x96, 0x53, 0x7B, 0x01, 0xFA, -+0x7D, 0x02, 0x7F, 0x04, 0xD1, 0xBF, 0x7D, 0x07, 0xAF, 0x72, 0x02, 0xC0, 0x40, 0xE5, 0x75, 0xC3, -+0x95, 0x79, 0x50, 0x56, 0xAB, 0x72, 0xAD, 0x79, 0xAF, 0x75, 0x12, 0x72, 0x7F, 0x8F, 0x76, 0x85, -+0x76, 0x74, 0x71, 0x55, 0xC4, 0x13, 0x54, 0x01, 0xFF, 0x90, 0x95, 0x39, 0xB1, 0x88, 0xE5, 0x76, -+0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x75, 0xF0, 0xE5, 0x77, 0x12, 0x8F, 0xCA, 0x12, 0xC6, 0xBC, -+0xE4, 0xFB, 0xFA, 0xD1, 0x85, 0xE5, 0x75, 0xC3, 0x94, 0x0C, 0x40, 0x25, 0x71, 0x55, 0xC4, 0x13, -+0x54, 0x07, 0x30, 0xE0, 0x1C, 0xE5, 0x73, 0x60, 0x18, 0xE5, 0x77, 0x70, 0x14, 0xE5, 0x75, 0x44, -+0x80, 0xF5, 0x74, 0xB1, 0x6B, 0xE5, 0x76, 0xF0, 0x80, 0x07, 0xD1, 0x72, 0xE5, 0x79, 0xF0, 0xF5, -+0x74, 0xB1, 0x8D, 0xE5, 0x74, 0xF0, 0xB1, 0x6B, 0xE0, 0xFF, 0xF1, 0xD4, 0xEF, 0xF0, 0xA3, 0xE4, -+0xF0, 0xA3, 0xE5, 0x78, 0xF1, 0x37, 0x7B, 0x01, 0x7A, 0x00, 0xD1, 0x85, 0x90, 0x92, 0x80, 0xE5, -+0x78, 0xF0, 0xAB, 0x73, 0xAD, 0x74, 0xAF, 0x72, 0x02, 0x75, 0x80, 0x74, 0x18, 0x25, 0x72, 0xF5, -+0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0xE0, 0xFD, 0xE5, 0x61, 0xC4, 0x54, 0xF0, 0x24, 0x05, -+0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x35, -+0xE4, 0xF0, 0xA3, 0x22, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, -+0x22, 0x7D, 0x01, 0xAF, 0x64, 0xAC, 0x05, 0x90, 0x95, 0x2F, 0xEF, 0xF0, 0xFD, 0xE0, 0xFF, 0x71, -+0xC6, 0xE0, 0xF5, 0x72, 0x54, 0x7F, 0xF5, 0x74, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x50, 0x12, -+0x04, 0x6E, 0xE0, 0xF9, 0x90, 0x95, 0x2F, 0xE0, 0xD1, 0x94, 0xFE, 0xEF, 0xB1, 0x7B, 0xE0, 0x54, -+0x03, 0xF5, 0x73, 0xE5, 0x74, 0x90, 0x81, 0x9D, 0x93, 0xFB, 0xED, 0xF1, 0x40, 0xE4, 0xF0, 0xA3, -+0xEB, 0xF0, 0x31, 0xDC, 0xC4, 0x54, 0x03, 0x90, 0x95, 0x30, 0xF0, 0x74, 0xC6, 0x2D, 0xD1, 0x76, -+0xE5, 0x74, 0xF0, 0x74, 0x46, 0x2D, 0xF1, 0x2F, 0xE5, 0x73, 0xF0, 0xE5, 0x74, 0xD3, 0x9E, 0x40, -+0x06, 0x8E, 0x74, 0xAF, 0x06, 0x8F, 0x72, 0x8C, 0x75, 0xE4, 0xFF, 0xEF, 0xC3, 0x95, 0x75, 0x50, -+0x30, 0xE5, 0x72, 0x30, 0xE7, 0x09, 0x85, 0x74, 0x72, 0x1C, 0xEC, 0x70, 0x21, 0x80, 0x22, 0xE5, -+0x74, 0xD3, 0x99, 0x40, 0x15, 0xAD, 0x01, 0x90, 0x95, 0x2F, 0xE0, 0xFB, 0x90, 0x95, 0x34, 0xEC, -+0xF0, 0xAF, 0x74, 0x12, 0xC7, 0xB8, 0x8F, 0x72, 0x80, 0x07, 0x89, 0x72, 0x80, 0x03, 0x0F, 0x80, -+0xCA, 0x90, 0x95, 0x2F, 0xE0, 0xFF, 0xB1, 0x8D, 0xEF, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x72, -+0xF1, 0x37, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0xFA, 0x7D, 0x05, 0x7F, 0x08, 0xD1, 0xBF, -+0x90, 0x95, 0x2F, 0xE0, 0xFF, 0x90, 0x92, 0x80, 0xE5, 0x73, 0xF0, 0xE4, 0xFB, 0xAD, 0x72, 0x02, -+0x75, 0x80, 0x74, 0xC6, 0x25, 0x72, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x90, 0x94, -+0xA5, 0xE0, 0x04, 0xF0, 0x22, 0x7D, 0x05, 0x7F, 0x04, 0x80, 0x34, 0xE0, 0x90, 0x92, 0x5E, 0xF0, -+0xA3, 0x74, 0x02, 0x22, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x4F, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xF0, -+0x74, 0xC6, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xE0, 0x54, 0x03, 0x90, 0x92, -+0x80, 0xF0, 0x7B, 0x01, 0xAF, 0x61, 0x02, 0x75, 0x80, 0x7A, 0x00, 0x7D, 0x03, 0x7F, 0x01, 0x90, -+0x01, 0xC6, 0xE0, 0x64, 0x80, 0x70, 0x60, 0x90, 0x95, 0x3F, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xEB, -+0xA3, 0xF0, 0xEA, 0xA3, 0xF0, 0x90, 0x95, 0x35, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0x43, 0xF0, -+0xEC, 0xA3, 0xF0, 0x90, 0x95, 0x37, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0x45, 0xF0, 0xEC, 0xA3, -+0xF0, 0x90, 0x95, 0x39, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0x47, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, -+0x95, 0x3B, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0x49, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0x95, 0x3D, -+0x74, 0xFE, 0xF0, 0x90, 0x95, 0x5F, 0x74, 0x0C, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x3D, 0x12, -+0x8D, 0xB6, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xE4, 0xFD, 0x7F, 0x8D, 0x02, 0x7B, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x73, 0xF0, 0x22, -+0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x08, 0xA4, -+0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0xE5, 0x75, 0x25, 0xE0, 0x24, 0x75, -+0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE5, 0x72, -+0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x73, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, -+0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x7D, 0x44, 0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xFD, 0x12, -+0x8D, 0xDA, 0x90, 0x96, 0x74, 0xE0, 0x90, 0x96, 0x73, 0xB4, 0x01, 0x09, 0xE0, 0xB1, 0x7B, 0xE0, -+0x44, 0x04, 0xF0, 0x80, 0x07, 0xE0, 0xB1, 0x7B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8A, 0xF9, 0x12, -+0x8D, 0xC8, 0x12, 0x9F, 0x30, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x21, 0xE8, 0xE4, 0xFD, 0x80, 0xB0, -+0x7D, 0x01, 0x80, 0xAC, 0x90, 0x95, 0x37, 0xE4, 0xF0, 0xA3, 0x22, 0x7D, 0x05, 0x7F, 0x01, 0xC1, -+0xBF, 0x7A, 0x00, 0x7D, 0x01, 0x7F, 0x01, 0xC1, 0xBF, 0x7A, 0x00, 0xE4, 0xFD, 0x7F, 0x01, 0xC1, -+0xBF, 0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, 0xF0, 0x60, 0x34, 0xA3, 0xE0, 0x20, 0xE0, 0x2F, 0x90, -+0x8A, 0xB9, 0x12, 0x8D, 0xC8, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x11, 0x2F, 0x30, 0xE0, -+0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, -+0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, 0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, 0x90, -+0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x62, -+0xEC, 0x90, 0x96, 0x49, 0x12, 0x04, 0x31, 0x90, 0x96, 0x49, 0x31, 0x50, 0x11, 0xB6, 0x90, 0x01, -+0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, -+0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0xA1, 0xE4, 0x30, 0xE0, 0x05, -+0x7F, 0x03, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xB8, 0xE0, 0x20, 0xE0, 0x33, 0x11, 0x2F, 0x30, 0xE0, -+0x2E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0x96, 0x47, 0xF0, 0x80, 0x06, 0x90, 0x96, -+0x47, 0x74, 0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x96, 0x48, 0x30, 0xE0, 0x05, 0x74, -+0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0x96, 0x47, 0x31, 0x59, 0x12, 0x95, 0xBE, 0x31, -+0x6E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x02, 0x70, 0xAD, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x62, 0xEC, 0x90, 0x96, 0x4F, 0x12, 0x04, 0x31, 0x90, 0x96, 0x4F, -+0x31, 0x50, 0x11, 0xB6, 0x90, 0x8A, 0xFD, 0x12, 0x8D, 0xDA, 0x12, 0xA7, 0xD3, 0x54, 0xFE, 0x31, -+0x76, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0x90, 0x01, 0x01, -+0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0xA1, -+0xE4, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x11, 0x2F, 0x30, 0xE0, 0x35, 0x90, 0x88, -+0xDF, 0xE0, 0x60, 0x08, 0x90, 0x96, 0x4D, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x96, 0x4D, -+0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0x96, 0x4E, 0xF0, 0x80, 0x06, -+0x90, 0x96, 0x4E, 0x74, 0x02, 0xF0, 0x90, 0x96, 0x4D, 0x31, 0x59, 0x12, 0x95, 0xBE, 0x7F, 0x01, -+0x12, 0x71, 0x9A, 0x90, 0x88, 0x9A, 0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x12, 0x04, 0xB8, 0x90, 0x92, 0x18, 0x02, 0x04, 0x31, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, -+0xF3, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, 0x70, 0xED, 0x44, 0x80, 0xFD, 0x22, 0x7F, 0x02, -+0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE4, 0x90, 0x94, 0xFB, -+0xF0, 0xD1, 0xA4, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, -+0x2E, 0xE4, 0xFF, 0x91, 0x65, 0x90, 0x93, 0x30, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x75, 0x12, 0xA7, -+0xD3, 0x44, 0x02, 0x31, 0x76, 0xE4, 0x90, 0x94, 0xFC, 0xF0, 0x90, 0x94, 0xFC, 0xE0, 0xFF, 0xC3, -+0x94, 0x05, 0x50, 0x2D, 0x71, 0xED, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -+0x90, 0x93, 0x33, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x10, 0x90, 0x94, 0xFC, 0x91, 0x25, 0xF0, 0x90, -+0x94, 0xFC, 0x91, 0x44, 0x44, 0x40, 0x12, 0x9F, 0xC7, 0x90, 0x94, 0xFC, 0xE0, 0x04, 0xF0, 0x80, -+0xC9, 0x90, 0x07, 0xC7, 0xE4, 0xF0, 0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, 0x77, 0xF0, -+0x90, 0x07, 0xC4, 0xE4, 0xF0, 0x90, 0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xB1, -+0xCF, 0x90, 0x02, 0x26, 0xE0, 0x44, 0x01, 0xF0, 0xE0, 0x90, 0x94, 0xFD, 0xF0, 0x90, 0x94, 0xFD, -+0xE0, 0x30, 0xE0, 0x19, 0x90, 0x94, 0xFB, 0xE0, 0x04, 0xF0, 0xB1, 0xC0, 0x90, 0x02, 0x26, 0xE0, -+0x90, 0x94, 0xFD, 0xF0, 0x90, 0x94, 0xFB, 0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xE0, 0x90, 0x02, 0x03, -+0x74, 0x80, 0xF0, 0x90, 0x04, 0x24, 0xE0, 0x90, 0x94, 0xFE, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x44, -+0x10, 0xF0, 0x90, 0x02, 0x00, 0xE0, 0x90, 0x94, 0xFD, 0xF0, 0x90, 0x02, 0x01, 0x51, 0x84, 0x90, -+0x02, 0x02, 0x51, 0x84, 0x90, 0x02, 0x14, 0x51, 0x84, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, 0x24, -+0xB1, 0xD7, 0x90, 0x94, 0xFE, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, 0xFF, 0xF0, -+0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x71, 0xF5, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x32, 0xE0, -+0x54, 0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x94, 0xFD, 0xE0, 0x2F, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x51, 0x9D, 0x31, 0x7C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0x63, 0x14, -+0x90, 0x88, 0x32, 0xE0, 0x44, 0x10, 0xF0, 0x71, 0xF5, 0x7D, 0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, -+0x41, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, -+0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, -+0x90, 0x93, 0x30, 0xE0, 0x30, 0xE0, 0x6A, 0x90, 0xFD, 0x09, 0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, -+0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, 0x94, 0xFB, 0xF0, 0x90, 0x94, 0xFB, 0xE0, -+0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2D, 0x71, 0xED, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0xFF, 0x90, 0x93, 0x32, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x10, 0x90, 0x94, 0xFB, 0x91, 0x25, -+0xF0, 0x90, 0x94, 0xFB, 0x91, 0x44, 0x44, 0x20, 0x12, 0x9F, 0xC7, 0x90, 0x94, 0xFB, 0xE0, 0x04, -+0xF0, 0x80, 0xC9, 0x71, 0xCF, 0x54, 0xFE, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x71, 0xCF, 0x44, -+0x08, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x12, 0xA7, 0xD3, 0x54, 0xFD, 0xFD, 0x7F, 0x02, 0x80, -+0x07, 0x71, 0xCF, 0x44, 0x01, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x08, 0x12, 0x7B, 0x41, -+0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0x7F, 0x01, 0x91, 0x65, 0x90, 0x00, 0x90, -+0xE0, 0x44, 0x01, 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x7F, -+0x92, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x24, 0x6F, 0xF5, 0x82, 0xE4, -+0x34, 0x8D, 0xF5, 0x83, 0xE0, 0xFD, 0x7C, 0x00, 0xE5, 0x64, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, -+0x00, 0xA8, 0x07, 0x08, 0x22, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x90, -+0x88, 0xE0, 0xE0, 0xFB, 0x90, 0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, 0xF0, 0x22, 0x90, 0x88, 0x39, -+0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, 0x91, 0xB8, 0xBF, 0x01, 0x08, 0x51, 0x8D, 0x90, 0x01, -+0xE5, 0xE0, 0x04, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x43, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, -+0x90, 0x01, 0xB1, 0x22, 0xE0, 0xFF, 0x24, 0x34, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, -+0x90, 0x01, 0xB2, 0xF0, 0x74, 0x39, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, -+0x01, 0xB3, 0xF0, 0xE0, 0x22, 0x90, 0x96, 0x70, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, -+0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x96, 0x70, 0xE0, 0x6F, 0x60, -+0x36, 0xC3, 0x90, 0x96, 0x72, 0xE0, 0x94, 0x88, 0x90, 0x96, 0x71, 0xE0, 0x94, 0x13, 0x40, 0x08, -+0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x96, 0x71, 0x12, 0x9F, 0xC0, 0x12, 0x9F, -+0xC8, 0xD3, 0x90, 0x96, 0x72, 0xE0, 0x94, 0x32, 0x90, 0x96, 0x71, 0xE0, 0x94, 0x00, 0x40, 0xBF, -+0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB8, 0x22, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, -+0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x63, 0x01, 0x80, 0x2E, 0x90, 0x02, 0x96, -+0xE0, 0x60, 0x05, 0x75, 0x63, 0x10, 0x80, 0x23, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, -+0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x63, 0x04, 0x80, 0x0E, 0x90, 0x88, 0xE6, -+0xE0, 0x30, 0xE0, 0x05, 0x75, 0x63, 0x20, 0x80, 0x02, 0xA1, 0xC7, 0x90, 0x01, 0xB9, 0x74, 0x08, -+0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x63, 0xF0, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x93, 0x51, 0xE0, 0x60, 0x24, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xB1, 0xB6, -+0x12, 0x04, 0xB8, 0xEF, 0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, -+0xB1, 0xB6, 0x31, 0x50, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, 0x93, 0x4C, 0xE0, 0x70, -+0x29, 0x90, 0x07, 0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, 0x94, 0xFF, 0x74, 0x22, 0xF0, -+0x90, 0x95, 0x21, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x01, 0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x94, -+0x79, 0xFF, 0x12, 0x8D, 0xB6, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x93, 0x54, 0xE0, 0xFF, 0x70, -+0x0A, 0x90, 0x93, 0x51, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, -+0xF0, 0xF0, 0x90, 0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, -+0xEF, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, 0x90, 0x93, 0x51, 0xE0, 0x60, 0x06, 0x90, -+0x01, 0xC4, 0x74, 0x01, 0xF0, 0x90, 0x93, 0x52, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x94, 0xFB, 0x12, 0x04, 0x31, 0x90, 0x94, 0xFB, 0x22, -+0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x74, -+0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x22, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x54, 0xEF, 0xF0, 0x22, -+0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xD1, 0x17, 0x90, 0x88, 0x27, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x93, 0x03, 0xE0, 0x44, 0x01, 0xF0, 0x7D, -+0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x90, 0x05, 0x52, 0xE0, 0x54, 0x07, 0x04, 0x90, 0x93, 0x0E, -+0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0x80, 0xC0, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, -+0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x02, 0x91, 0x0D, 0x22, 0xE4, 0x90, 0x94, 0xF8, 0xF0, 0xA3, -+0xF0, 0xA3, 0xF0, 0x90, 0x94, 0xF8, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x93, 0x54, 0xE0, 0x70, 0x18, -+0x90, 0x93, 0x51, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x94, 0xF8, 0xE0, 0x24, 0x2A, -+0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB6, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, -+0x9F, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, -+0x6F, 0x60, 0x03, 0x12, 0xA5, 0x6B, 0xC2, 0xAF, 0xF1, 0x24, 0xBF, 0x01, 0x02, 0xD1, 0x20, 0xD2, -+0xAF, 0xB1, 0x0A, 0x12, 0xAF, 0xCA, 0x12, 0x83, 0x4D, 0x80, 0xA8, 0x90, 0x01, 0x9A, 0xE0, 0x54, -+0xC0, 0x44, 0x0B, 0xF0, 0xB1, 0xC0, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, -+0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC4, 0x74, 0xA4, 0xF0, 0x74, 0xB6, 0xA3, 0xF0, 0x7F, 0x90, -+0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0xA4, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB6, -+0xA3, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, 0x90, 0x88, 0xBD, -+0xE0, 0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xBE, 0x31, 0x59, 0x12, 0x95, 0xBE, 0x90, 0x88, 0x36, -+0xE0, 0x70, 0x0C, 0x12, 0x8D, 0xD7, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x12, 0x9F, 0x30, 0x22, -+0xE4, 0x90, 0x96, 0x7F, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x23, 0xC3, 0x90, -+0x96, 0x80, 0xE0, 0x94, 0xD0, 0x90, 0x96, 0x7F, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, -+0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x96, 0x7F, 0x12, 0x9F, 0xC0, 0xB1, 0xC0, 0x80, -+0xD6, 0x7F, 0x01, 0x22, 0x7D, 0x02, 0x90, 0x01, 0xC4, 0x74, 0x24, 0xF0, 0x74, 0xB7, 0xA3, 0xF0, -+0x90, 0x93, 0x48, 0xE0, 0xFF, 0xED, 0xC3, 0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, 0x81, 0xF8, -+0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0D, -+0x80, 0xDE, 0x74, 0x24, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB7, 0xA3, 0xF0, 0x7F, 0x01, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, 0xF1, 0xA4, 0xE4, 0xFB, 0x90, -+0x96, 0x5B, 0x12, 0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, 0xF8, 0x12, 0x03, 0xEB, 0x74, -+0xC4, 0x2B, 0x12, 0xA4, 0xCB, 0xEF, 0xF0, 0x0B, 0xEB, 0xB4, 0x04, 0xE3, 0x90, 0x07, 0xC2, 0xB1, -+0xCF, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x54, 0xFC, 0x90, 0x07, 0xC0, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x7B, 0xF1, 0x9D, 0x7A, 0x00, 0x90, 0x96, 0x7C, 0xE0, 0x54, 0x03, -+0xFB, 0x70, 0x0B, 0x90, 0x07, 0xC4, 0x12, 0xD2, 0x73, 0x74, 0x03, 0xF0, 0x80, 0x0F, 0xEB, 0x64, -+0x02, 0x4A, 0x70, 0x16, 0x90, 0x07, 0xC6, 0x12, 0xD2, 0x73, 0x74, 0x0C, 0xF0, 0x90, 0x07, 0xC3, -+0x74, 0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, -+0x8F, 0xF5, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x29, 0x12, 0xB8, 0xE0, 0xFF, -+0xF0, 0x12, 0x02, 0x06, 0x11, 0xD6, 0x90, 0x93, 0x29, 0x11, 0xCD, 0x4E, 0xF0, 0x90, 0x05, 0x52, -+0xE0, 0x54, 0x07, 0x90, 0x94, 0xA2, 0x60, 0x16, 0x12, 0x86, 0x71, 0x12, 0x87, 0x3D, 0xFD, 0x90, -+0x05, 0x56, 0xE0, 0xC3, 0x9D, 0x90, 0x93, 0x2B, 0xF0, 0xA3, 0xED, 0xF0, 0x80, 0x26, 0x12, 0x86, -+0x71, 0x12, 0x87, 0x3D, 0xFB, 0xFF, 0x90, 0x05, 0x54, 0xE0, 0xC3, 0x9F, 0xFF, 0xE4, 0x94, 0x00, -+0xFE, 0x7C, 0x00, 0x7D, 0x05, 0x12, 0x02, 0x92, 0x90, 0x93, 0x2B, 0xEF, 0xF0, 0xEB, 0x75, 0xF0, -+0x05, 0x84, 0xA3, 0xF0, 0x12, 0x8B, 0x6E, 0x12, 0x02, 0x06, 0x20, 0xE0, 0x13, 0x12, 0x8D, 0xD7, -+0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x12, 0x9F, 0x30, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x80, 0x0B, -+0x90, 0x8A, 0x89, 0x12, 0x8D, 0xC8, 0x12, 0x8F, 0xFB, 0x11, 0xBD, 0x12, 0xA7, 0xBD, 0x20, 0xE0, -+0x04, 0xEF, 0x44, 0x20, 0xF0, 0x11, 0xB6, 0x30, 0xE0, 0x14, 0x90, 0x88, 0x36, 0x74, 0x01, 0xF0, -+0xE4, 0x90, 0x88, 0x38, 0xF0, 0x11, 0xC5, 0x90, 0x05, 0x58, 0x74, 0x05, 0xF0, 0x22, 0xE4, 0x90, -+0x88, 0x36, 0xF0, 0x90, 0x88, 0x38, 0x74, 0x0C, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFE, 0xF0, -+0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x93, 0x29, 0xE0, 0xC3, 0x13, 0x22, 0x90, 0x93, 0x29, -+0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xF0, 0xEE, 0x54, -+0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x22, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x22, -+0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0x22, 0x12, -+0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x30, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x04, -+0xE4, 0x12, 0x96, 0x54, 0x22, 0x12, 0x02, 0x06, 0x90, 0x93, 0x49, 0xF0, 0x22, 0x12, 0x02, 0x06, -+0xFF, 0x90, 0x93, 0x4A, 0xF0, 0xBF, 0x01, 0x0A, 0x7F, 0x01, 0x12, 0x98, 0xDD, 0xE4, 0x90, 0x93, -+0x4A, 0xF0, 0x22, 0xE4, 0x90, 0x86, 0xAF, 0x12, 0x96, 0x53, 0x90, 0x93, 0x01, 0xF0, 0x22, 0x75, -+0x29, 0x12, 0xE4, 0xF5, 0x2A, 0x75, 0x2B, 0x87, 0x75, 0x2C, 0x33, 0xF5, 0x31, 0xF5, 0x32, 0xF5, -+0x33, 0xF5, 0x34, 0x90, 0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, -+0xF0, 0xA3, 0xE5, 0x2C, 0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, -+0xE5, 0x33, 0xF0, 0xA3, 0xE5, 0x34, 0xF0, 0x22, 0x75, 0x39, 0x06, 0x43, 0x39, 0x10, 0x75, 0x3A, -+0x01, 0x75, 0x3B, 0x03, 0x75, 0x3C, 0x62, 0x43, 0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, 0x01, 0x38, -+0xE5, 0x39, 0xF0, 0xA3, 0xE5, 0x3A, 0xF0, 0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, 0xF0, 0x22, -+0x90, 0x8A, 0x79, 0x74, 0x86, 0xF0, 0xA3, 0x74, 0xC6, 0xF0, 0x90, 0x8A, 0xE5, 0x74, 0xBA, 0xF0, -+0xA3, 0x74, 0x77, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0x89, 0xF0, 0xA3, 0x74, 0x56, 0xF0, 0x90, 0x8A, -+0xB9, 0x74, 0x8D, 0xF0, 0xA3, 0x74, 0xE4, 0xF0, 0x90, 0x8A, 0xFB, 0x74, 0xAB, 0xF0, 0xA3, 0x74, -+0xD3, 0xF0, 0x90, 0x8A, 0xA5, 0x74, 0xA8, 0xF0, 0xA3, 0x74, 0x84, 0xF0, 0x90, 0x8A, 0xC3, 0x74, -+0xBF, 0xF0, 0xA3, 0x74, 0x96, 0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xC9, 0xF0, 0xA3, 0x74, 0xB1, 0xF0, -+0x90, 0x8A, 0x85, 0x74, 0xC9, 0xF0, 0xA3, 0x74, 0xBD, 0xF0, 0x90, 0x86, 0x04, 0x74, 0xCD, 0xF0, -+0xA3, 0x74, 0x66, 0xF0, 0x90, 0x8A, 0xA9, 0x74, 0xB6, 0xF0, 0xA3, 0x74, 0xC3, 0xF0, 0x90, 0x86, -+0x0C, 0x74, 0xB0, 0xF0, 0xA3, 0x74, 0x37, 0xF0, 0x90, 0x8A, 0xEF, 0x74, 0xB0, 0xF0, 0xA3, 0x74, -+0xBD, 0xF0, 0x90, 0x86, 0x00, 0x74, 0xCE, 0xF0, 0xA3, 0x74, 0xFA, 0xF0, 0x90, 0x86, 0x02, 0x74, -+0xCF, 0xF0, 0xA3, 0x74, 0x6B, 0xF0, 0x90, 0x8A, 0xFD, 0x74, 0xBF, 0xF0, 0xA3, 0x74, 0xC7, 0xF0, -+0x90, 0x8A, 0xF9, 0x74, 0xC0, 0xF0, 0xA3, 0x74, 0x26, 0xF0, 0x90, 0x8A, 0xDB, 0x74, 0xC8, 0xF0, -+0xA3, 0x74, 0x2B, 0xF0, 0x90, 0x8A, 0xAF, 0x74, 0x97, 0xF0, 0xA3, 0x74, 0x07, 0xF0, 0x90, 0x8A, -+0xD3, 0x74, 0xD0, 0xF0, 0xA3, 0x74, 0x90, 0xF0, 0x90, 0x8A, 0xF5, 0x74, 0xD0, 0xF0, 0xA3, 0x74, -+0x3F, 0xF0, 0x90, 0x8A, 0xA3, 0x74, 0xCD, 0xF0, 0xA3, 0x74, 0x16, 0xF0, 0x90, 0x86, 0x06, 0x74, -+0xBE, 0xF0, 0xA3, 0x74, 0xAE, 0xF0, 0x22, 0x8F, 0x0D, 0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, -+0xAF, 0xE0, 0x45, 0x0D, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -+0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x86, 0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, -+0x74, 0x86, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, -+0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, -+0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -+0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xD6, 0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0x12, 0x75, 0x50, -+0xE5, 0x3D, 0x30, 0xE1, 0x02, 0xB1, 0x85, 0xE5, 0x3D, 0x30, 0xE2, 0x02, 0x71, 0xBD, 0xE5, 0x3D, -+0x30, 0xE4, 0x02, 0x71, 0x7E, 0xE5, 0x3E, 0x30, 0xE0, 0x03, 0x12, 0x9F, 0x36, 0xE5, 0x3F, 0x30, -+0xE2, 0x09, 0xB1, 0xCF, 0x90, 0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x40, 0x30, 0xE1, 0x0B, -+0x90, 0x8A, 0xE5, 0x12, 0x8D, 0xC8, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, 0x40, 0x30, 0xE4, 0x03, -+0x12, 0xA1, 0x8B, 0xE5, 0x40, 0x30, 0xE5, 0x02, 0x91, 0xC1, 0xE5, 0x40, 0x30, 0xE6, 0x02, 0x91, -+0xFC, 0xE5, 0x40, 0x30, 0xE7, 0x02, 0xB1, 0xAF, 0x74, 0xD6, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -+0xBA, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -+0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x12, 0x34, -+0x78, 0xB1, 0x71, 0x90, 0x96, 0x83, 0xEF, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x02, 0x12, 0x90, -+0x96, 0x83, 0xE0, 0xFF, 0x64, 0x01, 0x60, 0x24, 0x90, 0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, -+0x19, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x7F, 0x64, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, 0x06, -+0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x96, 0x83, 0xE0, 0xFF, 0x91, 0x0E, 0x22, 0x90, 0x88, 0x36, -+0xE0, 0x60, 0x14, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x08, 0x90, 0x8B, 0x01, 0x12, 0x8D, 0xDA, -+0x80, 0x05, 0xB1, 0x69, 0x12, 0xA5, 0x6B, 0x90, 0x93, 0x56, 0xE0, 0xFF, 0x12, 0x8F, 0xCA, 0x30, -+0xE0, 0x1A, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, 0xB1, 0x91, 0x90, 0x93, 0x57, 0xE0, 0x30, -+0xE0, 0x0A, 0x71, 0xFD, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0x87, 0xC7, 0x22, 0x90, 0x93, 0x56, -+0xE0, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x7D, 0x00, 0x22, 0xAD, 0x07, -+0x90, 0x93, 0x58, 0xE0, 0x75, 0xF0, 0x20, 0xA4, 0xFF, 0x90, 0x96, 0x53, 0xB1, 0x7E, 0x90, 0x93, -+0x59, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0xAE, 0xF0, 0x90, 0x96, 0x55, 0xF0, 0xEE, 0xA3, 0xF0, 0x91, -+0xA2, 0x90, 0x96, 0x57, 0xF0, 0xEE, 0xA3, 0xF0, 0xED, 0x64, 0x01, 0x60, 0x64, 0x90, 0x93, 0x56, -+0xE0, 0xFE, 0x12, 0x8F, 0xCA, 0x30, 0xE0, 0x59, 0xEE, 0x91, 0x02, 0x20, 0xE0, 0x02, 0x7D, 0x01, -+0x91, 0xAA, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFD, 0x91, 0xAA, 0xC4, -+0x13, 0x54, 0x07, 0x30, 0xE0, 0x24, 0xA3, 0xE0, 0x30, 0xE0, 0x0F, 0x90, 0x96, 0x58, 0xE0, 0x90, -+0x92, 0x20, 0xF0, 0x90, 0x96, 0x57, 0x91, 0xB2, 0x80, 0x10, 0x91, 0xA2, 0xFF, 0x12, 0x7C, 0x6A, -+0x71, 0xFD, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0x87, 0xC7, 0x90, 0x93, 0x56, 0xE0, 0xC4, 0x54, -+0x0F, 0x30, 0xE0, 0x0D, 0x90, 0x96, 0x56, 0xE0, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x96, 0x55, 0x91, -+0xB2, 0x22, 0x90, 0x96, 0x53, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x12, 0x87, 0xC7, 0x90, 0x93, 0x56, -+0xE0, 0x22, 0xE0, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x02, 0x66, -+0x33, 0x90, 0x88, 0x31, 0xB1, 0x61, 0x30, 0xE0, 0x32, 0xEF, 0x54, 0xBF, 0xB1, 0x4D, 0x30, 0xE0, -+0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFE, 0xB1, 0x56, 0x74, 0x04, 0xF0, 0x90, -+0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8D, -+0xC8, 0x7D, 0x01, 0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x12, 0xA5, 0x6B, 0x22, 0x90, 0x88, 0x31, 0xE0, -+0xFF, 0x12, 0x8F, 0xCA, 0x30, 0xE0, 0x1E, 0xEF, 0x54, 0x7F, 0xB1, 0x4D, 0x30, 0xE1, 0x06, 0xE0, -+0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, 0x54, 0xFD, 0xB1, 0x56, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, -+0x60, 0x03, 0x12, 0xA5, 0x6B, 0x12, 0x97, 0xDD, 0x30, 0xE0, 0x21, 0x90, 0x88, 0xA4, 0xE0, 0xFF, -+0xC3, 0x13, 0x30, 0xE0, 0x17, 0xEF, 0x54, 0xFD, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, -+0x30, 0xE1, 0x05, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0xF0, 0x90, 0x04, -+0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, -+0x22, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, -+0x22, 0x90, 0x01, 0xC7, 0x74, 0x66, 0xF0, 0xE4, 0xFF, 0x22, 0xFF, 0x90, 0x95, 0x35, 0xE5, 0xF0, -+0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0xA4, 0xF3, 0x02, 0x8F, -+0x5A, 0xE4, 0x90, 0x95, 0xD2, 0xF0, 0x90, 0x95, 0xD0, 0x74, 0x14, 0xF0, 0x90, 0x95, 0xF2, 0x74, -+0x01, 0xF0, 0xFB, 0x7A, 0x95, 0x79, 0xD0, 0x12, 0x8D, 0xB6, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x90, -+0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, 0x12, 0x8D, -+0xDA, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x8D, 0xDA, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, -+0xE0, 0xB4, 0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, 0x23, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, 0x97, 0x9E, 0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, -+0xB4, 0x02, 0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE7, 0x12, 0x8D, 0xDA, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, -+0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, -+0xC4, 0x74, 0x11, 0xF0, 0x74, 0xBE, 0xA3, 0xF0, 0x90, 0x8A, 0x9D, 0x12, 0x8D, 0xDA, 0x53, 0x91, -+0xBF, 0x74, 0x11, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBE, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, -+0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, -+0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -+0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x67, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0xBE, 0xFF, -+0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, -+0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x03, -+0x12, 0xA6, 0x91, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0xA1, 0x33, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x94, 0x9F, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x94, 0x9E, -+0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0xF1, 0x87, 0xE0, 0x90, 0x94, 0xA1, 0xF0, 0x12, 0x7B, 0x07, 0x7C, -+0x00, 0xAD, 0x07, 0x90, 0x94, 0x9E, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x94, 0x9F, 0xE0, 0x60, -+0x05, 0xF1, 0x7B, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0xF1, 0x7B, 0x54, 0xC0, 0xF0, 0x90, 0x94, 0xA1, 0xE0, 0xFF, -+0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, -+0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, -+0x04, 0xF0, 0xAF, 0x05, 0xF1, 0x72, 0xF5, 0x83, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x94, 0xA0, 0xE0, -+0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0xF1, 0x72, 0xF5, 0x83, 0xEE, 0xF0, -+0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x74, 0x0D, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, 0x7F, 0xF5, 0x82, -+0xE4, 0x34, 0x84, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0x87, 0xE0, -+0x90, 0x96, 0x82, 0xF0, 0xED, 0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, -+0x67, 0xE0, 0x44, 0x80, 0xF0, 0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, 0x67, 0xE0, 0x54, -+0x7F, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x96, 0x75, 0xF0, 0xA3, 0xF0, 0x90, 0x05, -+0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, -+0x7F, 0x01, 0x22, 0x12, 0x97, 0xDD, 0x30, 0xE0, 0x15, 0xD3, 0x90, 0x96, 0x76, 0xE0, 0x94, 0x03, -+0x90, 0x96, 0x75, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x80, 0x13, 0x7F, 0x01, 0x80, 0x1B, 0xD3, 0x90, -+0x96, 0x76, 0xE0, 0x94, 0xE8, 0x90, 0x96, 0x75, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, -+0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, 0x96, -+0x75, 0x12, 0x9F, 0xC0, 0x80, 0xA8, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x93, 0x01, 0xED, 0xF0, -+0x22, 0x90, 0x05, 0x22, 0xED, 0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, 0x7D, 0x07, 0xAF, 0x64, -+0xED, 0x30, 0xE0, 0x26, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, 0xD1, 0x8F, 0xEF, 0x90, 0x89, -+0x59, 0xD1, 0x8F, 0xEF, 0x90, 0x89, 0x5B, 0xD1, 0x8F, 0xEF, 0x90, 0x89, 0x5D, 0xD1, 0x8F, 0xEF, -+0x90, 0x89, 0x5F, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, 0x30, 0xE1, 0x0A, 0x75, 0xF0, -+0x12, 0xEF, 0xD1, 0xD6, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, 0x30, 0xE2, 0x08, 0x75, 0xF0, 0x12, 0xEF, -+0xD1, 0xCB, 0xE4, 0xF0, 0xF1, 0x3C, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0xF1, 0x3C, 0xEE, 0xF0, -+0x22, 0x90, 0x04, 0x85, 0xE0, 0xF5, 0x6D, 0x90, 0x96, 0x17, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x64, -+0x90, 0x88, 0x2B, 0xE0, 0xFF, 0xE5, 0x64, 0xC3, 0x9F, 0x40, 0x02, 0xC1, 0x54, 0xE5, 0x64, 0x12, -+0xAB, 0xC6, 0xE0, 0xF5, 0x6F, 0xF1, 0xA1, 0xE0, 0x65, 0x6F, 0x60, 0x15, 0x90, 0x92, 0x5E, 0xE5, -+0x6F, 0xF0, 0xE4, 0xA3, 0xF0, 0xAB, 0x64, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0xF1, 0xA1, 0xE5, 0x6F, -+0xF0, 0x90, 0x04, 0xA0, 0xE0, 0x64, 0x01, 0x70, 0x50, 0xA3, 0xE0, 0x65, 0x64, 0x70, 0x4A, 0xA3, -+0xE0, 0xF5, 0x65, 0xA3, 0xE0, 0x90, 0x95, 0x2E, 0xF0, 0xE5, 0x64, 0x12, 0xAB, 0xC6, 0xE0, 0x65, -+0x65, 0x70, 0x02, 0xC1, 0x50, 0xE5, 0x64, 0x12, 0xAB, 0xC6, 0xE5, 0x65, 0xF0, 0xE5, 0x64, 0x12, -+0xAD, 0x7B, 0xE0, 0x54, 0xFC, 0xFF, 0x90, 0x95, 0x2E, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0xE5, 0x64, -+0x12, 0xAD, 0x7B, 0xEF, 0xF0, 0x90, 0x92, 0x5E, 0xE5, 0x65, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xAB, -+0x64, 0xE4, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0xC1, 0x50, 0xAF, 0x64, 0x12, 0x78, 0x4A, 0x75, 0xF0, -+0x12, 0xE5, 0x64, 0x12, 0xA9, 0xE0, 0x12, 0x8F, 0xCA, 0xFD, 0xF1, 0x21, 0xED, 0xF0, 0x90, 0x95, -+0x37, 0x12, 0xAD, 0x88, 0xE5, 0x64, 0xF0, 0x12, 0xB3, 0xD6, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0xFF, 0x90, 0x95, 0x3B, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x7B, 0x02, 0x12, 0xAF, 0xE9, 0xD1, 0xD1, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD1, 0xC6, -+0xE0, 0xFD, 0xE5, 0x64, 0xC4, 0x54, 0xF0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -+0xE0, 0x54, 0x80, 0xFB, 0xF1, 0x21, 0xEB, 0xF0, 0x12, 0xAF, 0xD4, 0xED, 0xF0, 0x90, 0x95, 0x35, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x96, 0x16, 0xD1, 0xBB, 0x7B, 0x03, 0x12, 0xAF, 0xE9, 0xAF, -+0x64, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x02, 0xC1, 0x50, 0x75, 0xF0, 0x12, 0xE5, 0x64, 0x12, 0xA9, -+0xE0, 0x12, 0x8F, 0xCA, 0x30, 0xE0, 0x02, 0xC1, 0x50, 0xE5, 0x64, 0x12, 0xB3, 0xD6, 0x80, 0x05, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x60, 0x02, -+0xC1, 0x50, 0xD1, 0xD1, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x70, 0x07, 0xD1, 0xC6, 0xE0, 0x70, 0x02, -+0xC1, 0x50, 0xE5, 0x64, 0x75, 0xF0, 0x12, 0xA4, 0x24, 0x57, 0xF9, 0x74, 0x89, 0x35, 0xF0, 0xFA, -+0x7B, 0x01, 0x90, 0x95, 0x23, 0x12, 0x86, 0x7A, 0xF1, 0x28, 0x12, 0x03, 0x13, 0x2F, 0xFF, 0xD1, -+0xA7, 0x2F, 0xFF, 0xF1, 0x15, 0x2F, 0xFF, 0xD1, 0xEE, 0x2F, 0xF5, 0x6E, 0xD1, 0xD1, 0xE0, 0xF5, -+0x6A, 0xA3, 0xE0, 0xF5, 0x6B, 0xD1, 0xC6, 0xE0, 0xFF, 0x90, 0x95, 0x26, 0xE4, 0xF0, 0xA3, 0xEF, -+0xF0, 0xE5, 0x64, 0x12, 0xAB, 0xC6, 0xE0, 0xF5, 0x65, 0x54, 0x80, 0xF5, 0x67, 0xE5, 0x65, 0x54, -+0x7F, 0xF5, 0x66, 0x90, 0x96, 0x16, 0xE0, 0x60, 0x11, 0x75, 0x70, 0x0A, 0xD1, 0xAD, 0xE4, 0x93, -+0xC3, 0x13, 0x74, 0x01, 0x93, 0x13, 0xF5, 0x71, 0x80, 0x0D, 0x7B, 0xFF, 0x12, 0x9F, 0xD7, 0x12, -+0x86, 0x7A, 0xE4, 0xF5, 0x70, 0xF5, 0x71, 0xF1, 0x1B, 0x12, 0x03, 0x13, 0x12, 0xBD, 0x7A, 0xF1, -+0x28, 0x90, 0x95, 0x37, 0x12, 0xBD, 0x7E, 0xD1, 0xA7, 0xFF, 0x90, 0x95, 0x39, 0x12, 0xBD, 0x7E, -+0xF1, 0x15, 0xFF, 0x90, 0x95, 0x3B, 0x12, 0xBD, 0x7E, 0x7B, 0x01, 0x12, 0xAF, 0xE1, 0xD1, 0xE8, -+0x12, 0xBD, 0x7A, 0x90, 0x95, 0x26, 0xE0, 0xFF, 0xA3, 0xE0, 0xF1, 0x8C, 0xA3, 0xF1, 0x84, 0xA3, -+0xE4, 0xF0, 0xA3, 0xE5, 0x65, 0xF0, 0x7B, 0x02, 0x12, 0xAF, 0xE1, 0x75, 0xF0, 0x12, 0xE5, 0x64, -+0x12, 0xAE, 0x97, 0xFF, 0xE5, 0x66, 0xD3, 0x9F, 0x40, 0x08, 0x8F, 0x66, 0xE5, 0x66, 0x45, 0x67, -+0xF5, 0x65, 0x74, 0x76, 0x25, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, 0xC3, 0x94, -+0x05, 0x40, 0x02, 0x81, 0xED, 0xE5, 0x66, 0x90, 0x81, 0x61, 0x93, 0xF5, 0x6C, 0xFD, 0xAF, 0x66, -+0x12, 0x60, 0x6F, 0x8F, 0x6C, 0xE5, 0x67, 0x60, 0x04, 0x05, 0x6C, 0x05, 0x6C, 0x90, 0x04, 0x8C, -+0xE0, 0x64, 0x01, 0x70, 0x28, 0xE5, 0x66, 0xC3, 0x94, 0x0C, 0x40, 0x21, 0x74, 0x84, 0x25, 0x66, -+0xF5, 0x82, 0xE4, 0x34, 0x04, 0xF5, 0x83, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xEF, 0x30, 0xE7, 0x06, -+0xE5, 0x6C, 0x2E, 0xFF, 0x80, 0x05, 0xC3, 0xE5, 0x6C, 0x9E, 0xFF, 0x8F, 0x6C, 0xE5, 0x6C, 0xD3, -+0x94, 0x1A, 0xAF, 0x6C, 0x40, 0x02, 0x7F, 0x1A, 0x8F, 0x6C, 0x12, 0x96, 0x45, 0x7B, 0x03, 0xFA, -+0x12, 0xAF, 0xE3, 0xE5, 0x65, 0x90, 0x81, 0xD9, 0x93, 0xFF, 0xD3, 0x90, 0x95, 0x27, 0xE0, 0x9F, -+0x90, 0x95, 0x26, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x80, 0x64, 0xC3, 0xE5, 0x6B, 0x94, 0x0A, 0xE5, -+0x6A, 0x94, 0x00, 0x40, 0x02, 0x81, 0x0F, 0xD1, 0x83, 0xE0, 0xC3, 0x94, 0x01, 0x40, 0x05, 0xD1, -+0x83, 0xE0, 0x14, 0xF0, 0xD1, 0xE8, 0xFF, 0x90, 0x95, 0x27, 0xE0, 0x2F, 0xFF, 0x90, 0x95, 0x26, -+0xE0, 0xD1, 0xF4, 0xD1, 0xA6, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0xFC, 0xE5, 0x6A, 0xC3, 0x13, 0xFE, -+0xE5, 0x6B, 0x13, 0xFF, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x28, 0xE5, 0x64, 0x94, 0x05, 0x50, -+0x05, 0xD1, 0x83, 0x74, 0x03, 0xF0, 0x90, 0x95, 0x35, 0xF1, 0x84, 0xE5, 0x6A, 0xC3, 0x13, 0xA3, -+0xF0, 0xE5, 0x6B, 0x13, 0xA3, 0xD1, 0x55, 0xD1, 0xBB, 0x7B, 0x01, 0x12, 0xAE, 0xB9, 0x12, 0xAD, -+0xA1, 0x81, 0xED, 0xF1, 0x1B, 0x12, 0x03, 0x13, 0x65, 0x6E, 0x70, 0x02, 0xE5, 0xF0, 0x70, 0x52, -+0x90, 0x95, 0x35, 0xF0, 0xA3, 0xE5, 0x6E, 0xF0, 0xC3, 0x13, 0xFF, 0xA3, 0xE4, 0xF0, 0xA3, 0xEF, -+0xD1, 0x55, 0xD1, 0xBB, 0x7B, 0x02, 0x12, 0xAE, 0xB9, 0xE5, 0x64, 0xC3, 0x94, 0x05, 0x50, 0x0F, -+0xD1, 0x83, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x07, 0x12, 0x96, 0x40, 0x7B, 0x03, 0x80, 0x0C, 0xE5, -+0x6E, 0xC3, 0x94, 0x03, 0x50, 0x11, 0x12, 0x96, 0x40, 0x7B, 0x04, 0xFA, 0x12, 0xAE, 0xBB, 0x7D, -+0x06, 0xAF, 0x64, 0x11, 0x40, 0xC1, 0x50, 0xE4, 0xFD, 0xAF, 0x64, 0x12, 0xAC, 0x4D, 0x11, 0x3C, -+0x81, 0xED, 0x12, 0x96, 0x40, 0x7B, 0x08, 0xFA, 0x12, 0xAE, 0xBB, 0xF1, 0x5D, 0x81, 0xED, 0xD1, -+0x83, 0xE4, 0xF0, 0x90, 0x91, 0x6C, 0x74, 0x02, 0xF0, 0xAB, 0x6C, 0xAD, 0x64, 0xAF, 0x6B, 0xAE, -+0x6A, 0x12, 0x41, 0x9C, 0x8E, 0x68, 0x8F, 0x69, 0xD1, 0xAD, 0xC3, 0x74, 0x01, 0x93, 0x95, 0x71, -+0xFF, 0xE4, 0x93, 0x94, 0x00, 0xFE, 0xD3, 0xE5, 0x69, 0x9F, 0xE5, 0x68, 0x9E, 0x40, 0x34, 0xD1, -+0x9A, 0xE4, 0xF0, 0x7D, 0x01, 0xAF, 0x64, 0x12, 0xAC, 0x4D, 0xD1, 0xAD, 0xC3, 0x74, 0x01, 0x93, -+0x95, 0x71, 0xFE, 0xE4, 0x93, 0x94, 0x00, 0x90, 0x95, 0x37, 0xF0, 0xA3, 0xCE, 0xF0, 0x90, 0x95, -+0x35, 0xE5, 0x68, 0xF0, 0xA3, 0xE5, 0x69, 0xF0, 0xE4, 0x90, 0x95, 0x39, 0x12, 0x96, 0x53, 0x7B, -+0x01, 0x80, 0x20, 0xF1, 0x0D, 0xC3, 0xE5, 0x69, 0x9F, 0xE5, 0x68, 0x94, 0x00, 0x50, 0x1A, 0xD1, -+0x9A, 0xE4, 0xF0, 0x12, 0xAD, 0xA1, 0xF1, 0x03, 0x12, 0xAF, 0xD4, 0xEF, 0xF0, 0xE4, 0x12, 0x96, -+0x52, 0x7B, 0x02, 0xFA, 0x12, 0xAF, 0xDB, 0x80, 0x54, 0x11, 0x3C, 0xD1, 0xAD, 0xE4, 0x93, 0xFF, -+0x74, 0x01, 0x93, 0xF1, 0x8C, 0xF1, 0x03, 0xF1, 0x21, 0xEF, 0xF0, 0xD1, 0x9A, 0xD1, 0xBB, 0x7B, -+0x03, 0x7A, 0x00, 0x12, 0xAF, 0xDB, 0xD1, 0x9A, 0xE0, 0x04, 0xF0, 0xE5, 0x66, 0x90, 0x81, 0xED, -+0x93, 0x25, 0x70, 0xFF, 0xE4, 0x33, 0xFE, 0xD1, 0x9A, 0xE0, 0xC3, 0x9F, 0xEE, 0xF1, 0xB1, 0x40, -+0x1C, 0xD1, 0x9A, 0xE4, 0xF1, 0x0C, 0xD1, 0xAD, 0x74, 0x01, 0x93, 0x2F, 0xFF, 0xE4, 0x93, 0x34, -+0x00, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x64, 0x12, 0xAF, 0x70, 0xF0, 0x75, 0xF0, 0x12, -+0xE5, 0x64, 0x90, 0x89, 0x56, 0x12, 0x04, 0x6E, 0xE0, 0x64, 0x01, 0x60, 0x02, 0xC1, 0x3A, 0xF1, -+0x1B, 0xF1, 0x28, 0xAE, 0xF0, 0x12, 0x03, 0x13, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xD1, 0xA6, 0x2F, -+0xFF, 0xEE, 0xD1, 0xF4, 0xFE, 0x90, 0x00, 0x08, 0xD1, 0xFA, 0x90, 0x95, 0x28, 0xF0, 0xA3, 0xEF, -+0xF0, 0x12, 0x03, 0x13, 0xFF, 0xC3, 0x90, 0x95, 0x29, 0xE0, 0x9F, 0xFE, 0x90, 0x95, 0x28, 0xE0, -+0x95, 0xF0, 0x90, 0x95, 0x2A, 0xF0, 0xA3, 0xCE, 0xF0, 0xF1, 0x15, 0xFD, 0xAC, 0xF0, 0x25, 0xE0, -+0xFF, 0xEC, 0x33, 0xFE, 0xEF, 0x2D, 0xFD, 0xEE, 0x3C, 0xFC, 0xD1, 0xA7, 0x25, 0xE0, 0xFF, 0xE5, -+0xF0, 0x33, 0xFE, 0x90, 0x00, 0x02, 0xD1, 0xFA, 0xCF, 0x2D, 0xFD, 0xEF, 0x3C, 0xFC, 0xD1, 0xE8, -+0xAE, 0xF0, 0x78, 0x02, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x2D, 0xFF, 0xEC, 0x3E, 0x90, -+0x95, 0x2C, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x26, 0xF1, 0x4A, 0xF1, 0x64, 0xD1, 0xDC, 0x50, -+0x07, 0x90, 0x95, 0x26, 0xF1, 0x30, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x64, 0x25, 0xE0, -+0xF1, 0x64, 0x12, 0xAF, 0x79, 0xF0, 0x90, 0x95, 0x28, 0xF1, 0x4A, 0xF1, 0x6C, 0xD1, 0xDC, 0x50, -+0x07, 0x90, 0x95, 0x28, 0xF1, 0x30, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x64, 0x25, 0xE0, -+0xF1, 0x6C, 0x12, 0xAF, 0x79, 0xF0, 0x90, 0x95, 0x2C, 0xF1, 0x4A, 0xF1, 0x74, 0xD1, 0xDC, 0x50, -+0x07, 0x90, 0x95, 0x2C, 0xF1, 0x30, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x64, 0x25, 0xE0, -+0xF1, 0x74, 0x12, 0xAF, 0x79, 0xF0, 0xC3, 0x74, 0xFF, 0x95, 0x6B, 0xFF, 0x74, 0xFF, 0x95, 0x6A, -+0xFE, 0xF1, 0x95, 0xD1, 0xDC, 0x50, 0x0A, 0xE5, 0x6B, 0x2D, 0xFF, 0xE5, 0x6A, 0x3C, 0xFE, 0x80, -+0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xF1, 0x95, 0x12, 0xAF, 0x79, 0xF0, 0xF1, 0x7C, 0xFB, 0xC3, 0x74, -+0xFF, 0x9B, 0xFF, 0x74, 0xFF, 0x9E, 0xFE, 0x74, 0xFF, 0x94, 0x00, 0xFD, 0x74, 0xFF, 0x94, 0x00, -+0xFC, 0x90, 0x8D, 0x71, 0x12, 0x86, 0x65, 0xD3, 0x12, 0x03, 0xDA, 0x50, 0x11, 0xF1, 0x7C, 0xFF, -+0xE4, 0xFC, 0xFD, 0x90, 0x8D, 0x71, 0x12, 0x86, 0x65, 0x12, 0x86, 0x30, 0x80, 0x06, 0x74, 0xFF, -+0xFF, 0xFE, 0xFD, 0xFC, 0x90, 0x8D, 0x71, 0x12, 0x04, 0x31, 0xF1, 0x5D, 0xE4, 0x90, 0x95, 0x35, -+0xF0, 0x12, 0x96, 0x4E, 0xA3, 0xF0, 0x7B, 0x01, 0xFA, 0x7D, 0xFF, 0x7F, 0x01, 0x12, 0xAE, 0xBF, -+0x05, 0x64, 0x01, 0xA0, 0x22, 0xF0, 0x90, 0x95, 0x23, 0x12, 0x86, 0x71, 0x90, 0x00, 0x06, 0x12, -+0x03, 0x3E, 0xFF, 0xAE, 0xF0, 0x90, 0x00, 0x08, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, -+0xFE, 0x90, 0x00, 0x04, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x90, 0x95, 0x39, 0xF0, -+0xA3, 0xEF, 0xF0, 0x74, 0x28, 0x25, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0x12, -+0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, 0x22, 0x74, 0xA6, 0x25, 0x64, 0xF5, 0x82, -+0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xFE, 0x90, 0x00, 0x04, 0x02, 0x03, 0x3E, 0xE5, 0x66, 0x25, -+0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x90, 0x95, 0x3B, -+0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x75, 0xF0, 0x12, 0xE5, 0x64, 0x90, 0x89, 0x55, 0x02, 0x04, -+0x6E, 0x75, 0xF0, 0x12, 0xE5, 0x64, 0x90, 0x89, 0x53, 0x02, 0x04, 0x6E, 0xF5, 0x83, 0xE0, 0xFC, -+0xA3, 0xE0, 0xFD, 0xD3, 0x9F, 0xEC, 0x9E, 0x22, 0x90, 0x95, 0x23, 0x12, 0x86, 0x71, 0x90, 0x00, -+0x08, 0x02, 0x03, 0x3E, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xEE, -+0x35, 0xF0, 0x22, 0x90, 0x95, 0x35, 0xE5, 0x68, 0xF0, 0xA3, 0xE5, 0x69, 0xF0, 0xE5, 0x66, 0x90, -+0x81, 0x9D, 0x93, 0xFF, 0x22, 0x90, 0x00, 0x06, 0x02, 0x03, 0x3E, 0x90, 0x95, 0x23, 0x02, 0x86, -+0x71, 0x90, 0x95, 0x39, 0xE4, 0xF0, 0xA3, 0x22, 0x90, 0x00, 0x02, 0x12, 0x03, 0x3E, 0xFF, 0x22, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xED, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0x22, 0xEF, 0xC4, 0x54, 0xF0, -+0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, -+0x74, 0xFF, 0x9F, 0xFF, 0x74, 0xFF, 0x9E, 0xFE, 0xE5, 0x64, 0x25, 0xE0, 0x22, 0x7D, 0x01, 0xAF, -+0x64, 0x02, 0x61, 0xF7, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, 0x24, 0x26, 0xF5, 0x82, -+0xE4, 0x34, 0x8E, 0x22, 0x24, 0x56, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, 0x90, 0x95, 0x2A, 0xE0, -+0xFE, 0xA3, 0xE0, 0x22, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, 0x6B, 0xF0, 0x22, 0x90, 0x95, 0x37, 0xCF, -+0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xE5, 0x64, 0x25, 0xE0, 0x24, 0x86, 0xF5, 0x82, 0xE4, 0x34, 0x8E, -+0x22, 0x74, 0xB6, 0x25, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xE0, 0xD3, 0x9D, -+0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0xE4, 0xF5, 0x77, 0xEF, 0x14, 0xF5, 0x76, 0xED, -+0xFF, 0xE5, 0x76, 0xF5, 0x82, 0x33, 0x95, 0xE0, 0xF5, 0x83, 0xC3, 0xE5, 0x82, 0x9F, 0x74, 0x80, -+0xF8, 0x65, 0x83, 0x98, 0x40, 0x52, 0xE5, 0x76, 0x78, 0x03, 0xA2, 0xE7, 0x13, 0xD8, 0xFB, 0xFF, -+0x33, 0x95, 0xE0, 0xFE, 0xEB, 0x12, 0xAF, 0x4C, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE5, 0x83, 0x3E, -+0xF5, 0x83, 0xE0, 0xF5, 0x82, 0x75, 0x83, 0x00, 0xE5, 0x76, 0x12, 0xB3, 0xEA, 0x80, 0x05, 0xC3, -+0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x60, -+0x13, 0x85, 0x76, 0x78, 0x05, 0x77, 0x90, 0x95, 0x34, 0xE0, 0x65, 0x77, 0x60, 0x0A, 0xE5, 0x78, -+0xD3, 0x9D, 0x40, 0x04, 0x15, 0x76, 0x80, 0x97, 0xAF, 0x78, 0x22, 0xEF, 0x64, 0x13, 0x60, 0x04, -+0xEF, 0xB4, 0x0B, 0x05, 0x90, 0x88, 0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, 0x60, 0x04, 0xEF, 0xB4, -+0x0A, 0x05, 0x90, 0x88, 0xE4, 0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, 0xEF, 0xB4, 0x09, 0x05, -+0x90, 0x88, 0xE5, 0x80, 0x03, 0x90, 0x88, 0xE2, 0xE0, 0xF5, 0x61, 0xAF, 0x61, 0x22, 0x90, 0x93, -+0x56, 0xE0, 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, -+0x93, 0x58, 0xF0, 0x90, 0x93, 0x56, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, -+0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x8C, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, -+0x74, 0x71, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, 0x54, 0xF0, 0x44, 0x07, 0xF0, -+0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, 0xE4, -+0x02, 0x7F, 0x01, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x8D, -+0xC8, 0x7F, 0x20, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x8A, 0x75, 0x12, 0x8D, 0xDA, 0x90, 0x8A, 0xE5, -+0x12, 0x8D, 0xC8, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x95, 0xAB, 0xF0, -+0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, -+0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, -+0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x7B, -+0x2E, 0x80, 0xFE, 0x22, 0xE4, 0xF5, 0x7B, 0xF5, 0x7C, 0xF5, 0x7D, 0x31, 0x23, 0xBF, 0x03, 0x02, -+0x31, 0x33, 0x22, 0x90, 0x01, 0x02, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0x31, 0x23, 0xBF, 0x03, 0x02, -+0x31, 0x33, 0x22, 0x90, 0x05, 0x21, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0xE4, 0xFF, 0x02, 0x35, 0xBE, -+0x90, 0x8A, 0xDF, 0x12, 0xA1, 0x83, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x96, 0x2D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, 0x90, 0x96, 0x37, 0x12, 0x04, -+0x31, 0x90, 0x96, 0x2F, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x96, 0x37, 0x12, 0x86, 0x65, -+0x12, 0x86, 0x4B, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0x2F, 0x12, 0x04, -+0xB8, 0x90, 0x96, 0x33, 0x12, 0x86, 0x65, 0x12, 0x86, 0x4B, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0x86, 0x58, 0x90, 0x96, 0x3B, 0x12, 0x04, 0x31, 0x90, 0x96, 0x3B, 0x12, 0xB1, -+0x50, 0x90, 0x96, 0x2D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x96, 0x5F, -+0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, 0x70, 0x51, 0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEE, -+0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, 0x96, 0x60, 0x12, 0x04, 0x31, 0xE4, 0x7F, 0x80, 0x51, -+0xA3, 0x70, 0x05, 0x90, 0x88, 0xBE, 0x80, 0x1B, 0xE4, 0xFF, 0xFE, 0x51, 0xA5, 0x70, 0x0A, 0x90, -+0x88, 0xBE, 0x04, 0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x56, 0xE4, 0xFF, 0x51, 0xA3, 0x70, 0x09, 0x90, -+0x88, 0xBE, 0x04, 0xF0, 0xA3, 0xF0, 0x80, 0x47, 0xE4, 0x7F, 0x80, 0xFE, 0x51, 0xA5, 0x70, 0x3F, -+0x90, 0x88, 0xBE, 0xF0, 0xA3, 0x04, 0xF0, 0x80, 0x36, 0x7F, 0x2C, 0x7E, 0x09, 0x12, 0x70, 0x70, -+0xEF, 0x54, 0x02, 0x51, 0xB8, 0x60, 0x08, 0x90, 0x88, 0xBE, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, -+0x90, 0x88, 0xBE, 0xF0, 0x7F, 0x30, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x01, 0x51, 0xB8, -+0x60, 0x07, 0xE4, 0x90, 0x88, 0xBF, 0xF0, 0x80, 0x06, 0x90, 0x88, 0xBF, 0x74, 0x01, 0xF0, 0x90, -+0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x7D, 0x11, 0xB1, 0x42, -+0x12, 0x8D, 0xDA, 0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x88, 0xDF, 0xE0, 0xFF, -+0x90, 0x8A, 0xF3, 0xB1, 0x0D, 0xE4, 0xFD, 0x12, 0x04, 0x7E, 0x90, 0x96, 0x5F, 0xE0, 0xFD, 0x70, -+0x02, 0x80, 0x1C, 0xED, 0xB4, 0x01, 0x06, 0x51, 0xB1, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x96, 0x5F, -+0xE0, 0xFD, 0xB4, 0x02, 0x06, 0x51, 0xB1, 0x44, 0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, 0x51, -+0xB1, 0xF0, 0x22, 0x7E, 0x02, 0xFD, 0xFC, 0x90, 0x96, 0x60, 0x12, 0x86, 0x65, 0xC3, 0x02, 0x03, -+0xDA, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, 0xFE, 0xFD, 0xFC, 0x90, 0x96, 0x60, -+0x12, 0x04, 0x31, 0x90, 0x96, 0x60, 0x12, 0x04, 0xB8, 0xEC, 0x4D, 0x4E, 0x4F, 0x22, 0x90, 0x88, -+0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x94, 0x9D, 0xE0, 0x24, 0x46, 0xFF, 0x90, -+0x94, 0x9C, 0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, 0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, -+0x86, 0x3D, 0x90, 0x88, 0x85, 0x91, 0xDC, 0xEF, 0x24, 0x46, 0xFF, 0xE4, 0x3E, 0xFE, 0xE4, 0x3D, -+0xFD, 0xE4, 0x3C, 0xFC, 0x90, 0x88, 0x89, 0x91, 0xDC, 0x90, 0x88, 0x85, 0x51, 0xAA, 0x50, 0x02, -+0x61, 0xC4, 0x90, 0x88, 0x89, 0x12, 0x86, 0x65, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, 0x86, -+0x3D, 0x90, 0x95, 0xAF, 0x12, 0x04, 0x31, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x2C, 0x12, 0x9F, -+0x15, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, -+0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, -+0x00, 0xFA, 0x91, 0xE5, 0xEB, 0x2F, 0xFF, 0xEA, 0x80, 0x1D, 0x90, 0x88, 0x33, 0xB1, 0x4E, 0x30, -+0xE0, 0x02, 0x81, 0xC1, 0x91, 0xE5, 0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, 0xCD, -+0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, 0xED, 0x3E, 0x90, 0x95, 0xAB, 0xF0, 0xA3, 0xEF, 0xF0, 0xC3, -+0x90, 0x95, 0xAC, 0xE0, 0x94, 0xA0, 0x90, 0x95, 0xAB, 0xE0, 0x94, 0x00, 0x50, 0x36, 0xA3, 0xE0, -+0xFB, 0x24, 0x5C, 0x91, 0xD4, 0xE0, 0x04, 0xF0, 0x90, 0x95, 0xAF, 0x12, 0x04, 0xB8, 0xEF, 0x54, -+0x7F, 0xFF, 0x74, 0xFC, 0x2B, 0x91, 0xC9, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x95, -+0xAB, 0xA3, 0xE0, 0x91, 0xC7, 0xEF, 0xF0, 0x90, 0x88, 0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, 0x7F, -+0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, 0xE0, 0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, -+0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x81, 0xC1, 0xE4, 0xFF, 0xFE, 0x91, 0xD1, 0xE0, 0x2F, -+0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, 0x40, 0x07, 0x90, 0x95, 0xAD, 0xEE, 0xF0, -+0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE5, 0x91, 0xF0, 0x40, 0x02, 0x80, 0x15, 0x90, 0x95, 0xAD, -+0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, 0x50, 0x13, 0x91, 0xD1, 0xE0, 0x2F, 0xFF, 0x91, 0xF0, -+0x40, 0x07, 0x90, 0x95, 0xAE, 0xEE, 0xF0, 0x80, 0x03, 0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, 0xE0, -+0xFF, 0x91, 0xC2, 0xE0, 0xFD, 0xEF, 0xC3, 0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, -+0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x95, 0xAE, 0xE0, 0x80, 0x18, 0x91, 0xC2, 0xE0, 0xFD, 0xC3, -+0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, 0xF0, 0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, 0x95, -+0xAE, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, -+0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, 0xF0, 0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, 0xF0, -+0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, 0x50, 0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, 0x51, -+0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, 0x88, -+0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, 0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, -+0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0xB1, 0x55, -+0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, 0x8A, 0xA3, 0x12, 0x8D, 0xC8, 0xE4, 0xFF, 0x12, 0x04, -+0x7E, 0x22, 0x90, 0x95, 0xAD, 0xE0, 0xFE, 0x24, 0xFC, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0x22, 0x74, 0x5C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0x12, 0x04, 0x31, 0x90, -+0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, 0x95, 0xAF, 0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, 0xEB, -+0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, 0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, -+0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, 0x22, 0xFF, 0x90, 0x8A, 0xF9, 0xE0, 0xFC, 0xA3, -+0xE0, 0xF5, 0x82, 0x8C, 0x83, 0x22, 0xE4, 0xFE, 0x91, 0xD1, 0xE4, 0xF0, 0x74, 0xFC, 0x2E, 0x91, -+0xC9, 0x74, 0xFF, 0xF0, 0x0E, 0xEE, 0xB4, 0xA0, 0xEF, 0xE4, 0x90, 0x88, 0x4D, 0xF0, 0x90, 0x88, -+0x4C, 0xF0, 0x90, 0x88, 0x50, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, 0xF0, 0xE4, 0xA3, -+0xF0, 0x22, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x22, 0x90, 0x88, 0x32, 0xE0, 0xFF, -+0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, -+0xE0, 0xFB, 0x90, 0x92, 0x98, 0x22, 0x90, 0x94, 0x9E, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, -+0xFF, 0x7F, 0xFF, 0x80, 0x20, 0xB1, 0xB1, 0xB1, 0xAA, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, -+0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0x12, 0xA4, 0xCB, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, 0x12, 0xA4, -+0xCB, 0x12, 0xB6, 0x17, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, -+0x22, 0x90, 0x07, 0xC0, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, 0x12, 0xB7, 0xA2, 0xB1, 0xAA, 0x90, 0x07, 0xC3, 0xE0, 0x30, -+0xE5, 0xF9, 0xED, 0x54, 0x03, 0x24, 0xC8, 0x12, 0xA4, 0xCB, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x7D, 0x12, 0xB7, 0x9D, 0xD1, 0x48, -+0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x01, 0xF0, 0x80, 0x37, 0xEF, -+0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, 0x07, 0xC5, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x02, 0xF0, -+0x80, 0x24, 0xD1, 0x48, 0x64, 0x02, 0x70, 0x0D, 0x90, 0x07, 0xC6, 0xED, 0xF0, 0x90, 0x07, 0xC2, -+0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, 0x64, 0x03, 0x4E, 0x70, 0x0B, 0x90, 0x07, 0xC7, 0xED, 0xF0, -+0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, -+0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7E, 0x00, 0x90, 0x96, 0x7E, 0xE0, 0x54, 0x03, -+0xFF, 0x22, 0x90, 0x95, 0x23, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, -+0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x7D, 0x07, 0xEF, 0x5D, 0xC3, 0x60, 0x0B, 0xD1, -+0x7F, 0x5F, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x04, 0xD1, 0x7F, 0x5F, 0xFF, 0x22, 0x74, -+0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x22, 0x12, 0x97, 0xF3, 0xE4, 0xA3, -+0xF0, 0xA3, 0xF0, 0x90, 0x93, 0x0A, 0x12, 0x96, 0x53, 0x90, 0x93, 0x25, 0xF0, 0xA3, 0xF0, 0xA3, -+0xF0, 0x22, 0x90, 0x04, 0x24, 0xEF, 0xF0, 0x90, 0x04, 0x57, 0xF0, 0x22, 0x90, 0x93, 0x0E, 0xE0, -+0xFD, 0x7C, 0x00, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x02, 0x92, 0xED, 0x4C, 0x70, 0x05, -+0x90, 0x93, 0x1B, 0x80, 0x2A, 0xED, 0x64, 0x01, 0x4C, 0x70, 0x05, 0x90, 0x93, 0x1C, 0x80, 0x1F, -+0xED, 0x64, 0x02, 0x4C, 0x70, 0x05, 0x90, 0x93, 0x1D, 0x80, 0x14, 0xED, 0x64, 0x03, 0x4C, 0x70, -+0x05, 0x90, 0x93, 0x1E, 0x80, 0x09, 0xED, 0x64, 0x04, 0x4C, 0x70, 0x0D, 0x90, 0x93, 0x1F, 0xE0, -+0xFF, 0xD1, 0xA2, 0x90, 0x93, 0x0F, 0x12, 0x9F, 0xC0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, 0x07, -+0x30, 0xE0, 0x12, 0x75, 0x0E, 0x10, 0x80, 0x40, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, -+0x75, 0x0E, 0x01, 0x80, 0x33, 0x90, 0x88, 0x31, 0x12, 0xA1, 0xE4, 0x30, 0xE0, 0x05, 0x75, 0x0E, -+0x02, 0x80, 0x25, 0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x0E, 0x08, 0x80, -+0x17, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, 0x0B, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x05, 0x75, 0x0E, -+0x11, 0x80, 0x05, 0x12, 0xB5, 0xC7, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, -+0xB8, 0xE5, 0x0E, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x1F, 0x90, 0x88, 0xAF, 0xE0, 0x60, 0x06, 0x75, -+0x0F, 0x40, 0x02, 0xD0, 0x16, 0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x2D, -+0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, 0x55, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, -+0x75, 0x0F, 0x01, 0x80, 0x71, 0x90, 0x88, 0x3A, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x0F, -+0x02, 0x80, 0x63, 0x90, 0x88, 0x38, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x0F, 0x04, -+0x80, 0x54, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x0F, 0x08, 0x80, 0x4B, 0x90, 0x88, 0x3A, 0xE0, 0x30, -+0xE4, 0x05, 0x75, 0x0F, 0x10, 0x80, 0x3F, 0x90, 0x88, 0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, -+0xE0, 0x05, 0x75, 0x0F, 0x20, 0x80, 0x2F, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x80, -+0x80, 0x24, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, 0x05, 0x75, 0x0F, 0x11, 0x80, 0x18, 0x90, 0x06, -+0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, 0x0F, 0x12, 0x80, -+0x05, 0x12, 0xB5, 0xC7, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, -+0x0F, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, -+0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x11, -+0x84, 0x40, 0x40, 0x90, 0x88, 0x50, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, 0x90, 0x88, -+0x50, 0xE0, 0xD3, 0x9F, 0x50, 0x2D, 0x90, 0x88, 0x48, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3F, 0x12, -+0xA2, 0x90, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, -+0xF0, 0xFB, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, 0xF0, -+0x12, 0x6E, 0x2F, 0x22, 0x90, 0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, 0x3F, 0xE0, 0xD3, 0x9F, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xBF, 0x87, 0xE0, 0x90, 0x94, 0x9E, 0xF0, 0x90, -+0x88, 0x32, 0xE0, 0x12, 0x8F, 0xCA, 0x30, 0xE0, 0x02, 0x21, 0x59, 0x90, 0x88, 0x31, 0xE0, 0x30, -+0xE0, 0x1D, 0x12, 0x9F, 0x15, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, -+0x53, 0xE0, 0x24, 0x03, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, -+0x88, 0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, 0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, -+0x88, 0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, 0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, -+0xF0, 0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, 0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, -+0x3E, 0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, -+0x88, 0x4B, 0x31, 0x65, 0x90, 0x88, 0x4E, 0x12, 0xC7, 0xAD, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, -+0x90, 0x88, 0x4E, 0x31, 0x65, 0x90, 0x88, 0x3E, 0x12, 0xC7, 0xAD, 0x40, 0x04, 0xEF, 0x24, 0x50, -+0xF0, 0x90, 0x88, 0x4E, 0x12, 0xA1, 0xE4, 0xFF, 0x7E, 0x00, 0x90, 0x88, 0x42, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x05, 0xB1, -+0xE0, 0x54, 0xF8, 0x4F, 0xF0, 0x31, 0x6E, 0x80, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x01, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, 0x33, 0xFC, 0x22, 0x90, 0x88, -+0x33, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, -+0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x2B, 0x90, 0x95, 0xF3, 0x74, 0x1E, 0xF0, 0x90, 0x96, 0x15, 0x74, -+0x01, 0xF0, 0x90, 0x95, 0xF5, 0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xF3, 0x90, 0x8A, 0x77, -+0x12, 0x9F, 0xE9, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0xC8, 0x7F, 0x04, 0x12, 0x04, -+0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, 0x34, 0xC4, 0x13, 0x54, -+0x07, 0x30, 0xE0, 0x2D, 0x90, 0x96, 0x86, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0xC8, 0x40, 0x21, -+0x90, 0x93, 0x29, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0x96, 0x86, 0xF0, 0x90, 0x93, 0x29, 0xE0, -+0x13, 0x30, 0xE0, 0x0D, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x88, 0x41, 0x74, 0xD0, -+0xF0, 0x22, 0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, -+0x8A, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, -+0x8C, 0xF0, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, -+0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x77, 0xF5, 0x82, -+0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, -+0x95, 0xF5, 0x83, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, 0x22, 0xE0, 0x90, -+0x01, 0xBA, 0xF0, 0x90, 0x88, 0x38, 0xE0, 0x22, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x93, 0x2B, -+0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xFF, 0xC4, -+0x54, 0x0F, 0x22, 0xED, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0x07, 0xC2, 0x22, 0x12, 0x02, 0x06, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x88, 0x3C, -+0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0x00, 0x82, 0xDC, -+ -+}; -+u4Byte ArrayLength_MP_8723D_FW_AP = 21184; -+ -+#endif -+ -+void -+ODM_ReadFirmware_MP_8723D_FW_AP( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)array_mp_8723d_fw_ap; -+#else -+ ODM_MoveMemory(pDM_Odm, pFirmware, array_mp_8723d_fw_ap, array_length_mp_8723d_fw_ap); -+#endif -+ *pFirmwareSize = array_length_mp_8723d_fw_ap; -+} -+ -+ -+#endif /* #if (defined(CONFIG_AP_WOWLAN)||(DM_ODM_SUPPORT_TYPE & (ODM_AP)) */ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ -+#ifndef LOAD_FW_HEADER_FROM_DRIVER -+u8 array_mp_8723d_fw_nic[] = { -+0xD1, 0x23, 0x10, 0x00, 0x10, 0x00, 0x00, 0x00, 0x05, 0x16, 0x18, 0x16, 0x12, 0x64, 0x02, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x02, 0x86, 0x75, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xBC, 0x29, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xC8, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xC6, 0x90, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xC6, 0xE0, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xC7, 0xD1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, -+0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, -+0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, -+0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, -+0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, -+0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, -+0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, -+0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, -+0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, -+0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, -+0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, -+0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, -+0x30, 0x04, 0x04, 0x04, 0x05, 0x08, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x06, 0x0B, 0x0D, -+0x0E, 0x0F, 0x11, 0x12, 0x14, 0x00, 0x04, 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x23, 0x00, -+0x2D, 0x00, 0x50, 0x00, 0x91, 0x00, 0xC3, 0x01, 0x27, 0x01, 0x31, 0x01, 0x5E, 0x00, 0xC8, 0x00, -+0xF0, 0x00, 0xDC, 0x01, 0x5E, 0x01, 0x68, 0x01, 0x9A, 0x01, 0xCC, 0x01, 0xEA, 0x02, 0x02, 0x04, -+0x08, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C, 0x14, 0x28, 0x32, 0x50, 0x78, 0xA0, 0xC8, -+0xE6, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x02, 0x04, 0x06, -+0x07, 0x07, 0x08, 0x08, 0x08, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, -+0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, -+0x02, 0x03, 0x03, 0x04, 0x05, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x03, 0x03, 0x03, -+0x02, 0x03, 0x03, 0x03, 0x03, 0x03, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, -+0x02, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x8B, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x8A, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x8B, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x8A, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x8A, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x86, 0xF8, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x8A, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x8A, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x8A, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x86, 0xF8, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x8A, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, 0x2E, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x8A, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x8A, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x83, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, -+0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xEF, 0x2B, 0xFF, -+0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, -+0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xE8, 0x8F, 0xF0, 0xA4, 0xCC, 0x8B, 0xF0, 0xA4, -+0x2C, 0xFC, 0xE9, 0x8E, 0xF0, 0xA4, 0x2C, 0xFC, 0x8A, 0xF0, 0xED, 0xA4, 0x2C, 0xFC, 0xEA, 0x8E, -+0xF0, 0xA4, 0xCD, 0xA8, 0xF0, 0x8B, 0xF0, 0xA4, 0x2D, 0xCC, 0x38, 0x25, 0xF0, 0xFD, 0xE9, 0x8F, -+0xF0, 0xA4, 0x2C, 0xCD, 0x35, 0xF0, 0xFC, 0xEB, 0x8E, 0xF0, 0xA4, 0xFE, 0xA9, 0xF0, 0xEB, 0x8F, -+0xF0, 0xA4, 0xCF, 0xC5, 0xF0, 0x2E, 0xCD, 0x39, 0xFE, 0xE4, 0x3C, 0xFC, 0xEA, 0xA4, 0x2D, 0xCE, -+0x35, 0xF0, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, -+0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, -+0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE0, 0xFB, 0xA3, -+0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, -+0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, -+0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, -+0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x02, 0x86, 0xB3, 0x02, 0x83, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, -+0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, -+0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, -+0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, -+0x20, 0x40, 0x80, 0x90, 0x86, 0xFE, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, -+0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, -+0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, -+0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, -+0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0xC1, 0x5D, 0xC5, 0x66, 0x8A, 0x51, 0x41, 0x96, -+0xFD, 0x00, 0x00, 0x90, 0x96, 0xFB, 0xEF, 0xF0, 0x7F, 0x02, 0xB1, 0x27, 0x90, 0x86, 0xAF, 0xE0, -+0xFF, 0x90, 0x96, 0xFB, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, 0x22, 0x90, 0x02, 0x09, -+0xE0, 0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x86, 0xB4, 0xF1, 0xA0, 0xFF, -+0xED, 0x2F, 0x90, 0x86, 0xB5, 0xF1, 0x6B, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, 0x12, 0xB8, 0x9D, -+0xED, 0x2F, 0x90, 0x86, 0xB7, 0xF1, 0x98, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB8, 0xF1, 0x64, 0xFF, -+0xED, 0x2F, 0x90, 0x86, 0xB9, 0x12, 0x9F, 0xEE, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x86, 0xBA, -+0xF0, 0x22, 0x4E, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, 0x02, 0x1F, 0xF0, 0x90, 0x00, 0x02, 0x02, -+0x02, 0x1F, 0x12, 0xA0, 0xC2, 0x90, 0x93, 0x60, 0xF1, 0xA0, 0x90, 0x93, 0x61, 0xF1, 0x6B, 0x90, -+0x93, 0x7B, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, 0x90, 0x93, 0x7C, 0xF1, 0x98, 0x90, 0x93, -+0x96, 0xF1, 0x64, 0x90, 0x93, 0x97, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, 0x1F, 0x4F, -+0xF0, 0x90, 0x00, 0x01, 0x02, 0x02, 0x1F, 0x12, 0x9F, 0xE1, 0x12, 0x02, 0x06, 0xFF, 0xF1, 0xA1, -+0xFE, 0x54, 0x03, 0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, 0xFB, 0xC0, 0x03, 0xF1, 0xF5, 0xF1, 0x6C, -+0x12, 0xE2, 0xB7, 0xD0, 0x03, 0x12, 0x8F, 0x42, 0xF1, 0xF5, 0xF1, 0xA1, 0xFE, 0x54, 0x03, 0x12, -+0x8B, 0x8E, 0x90, 0x95, 0x36, 0x74, 0x10, 0xF0, 0x90, 0x95, 0x58, 0x74, 0x07, 0xF1, 0xF4, 0x12, -+0x02, 0x06, 0x90, 0x95, 0x38, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x36, 0x12, 0x90, 0x2E, 0x7F, -+0x04, 0x02, 0x04, 0x7E, 0xF0, 0x90, 0x95, 0x33, 0xC1, 0x3D, 0x12, 0x9F, 0xE1, 0x90, 0x93, 0xE1, -+0xE0, 0x70, 0x13, 0x12, 0x87, 0xF5, 0x12, 0x02, 0x06, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x06, -+0x90, 0x93, 0xE7, 0x74, 0x01, 0xF0, 0x90, 0x93, 0xE3, 0xE0, 0x70, 0x13, 0x12, 0x87, 0xF5, 0x12, -+0x02, 0x06, 0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x06, 0x90, 0x93, 0xE8, 0x74, 0x01, 0xF0, 0x12, -+0x87, 0xF5, 0x12, 0x87, 0xA1, 0xFF, 0x90, 0x95, 0x37, 0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, -+0xE0, 0x0C, 0x12, 0x87, 0xF5, 0x12, 0x87, 0x6C, 0x90, 0x95, 0x38, 0xF0, 0x80, 0x05, 0x90, 0x95, -+0x38, 0xEF, 0xF0, 0x90, 0x95, 0x37, 0xE0, 0x90, 0x95, 0x36, 0xF0, 0x90, 0x95, 0x38, 0xE0, 0xFE, -+0x90, 0x95, 0x36, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x37, 0x12, 0x87, 0xF5, 0x12, 0x02, 0x06, 0x54, -+0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x95, 0x36, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x90, 0x95, -+0x36, 0x70, 0x06, 0xE0, 0xFF, 0xF1, 0xE5, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0xB8, 0xBC, 0x90, 0x93, -+0xE8, 0xE0, 0x60, 0x07, 0x90, 0x95, 0x36, 0xE0, 0xFF, 0xF1, 0xE5, 0x12, 0xE3, 0x7B, 0x80, 0xBB, -+0x90, 0x05, 0x5E, 0xE4, 0xF0, 0x90, 0x95, 0x37, 0xE0, 0x70, 0x1A, 0xFF, 0x12, 0x78, 0x4A, 0xEF, -+0x70, 0x13, 0x90, 0x86, 0x0C, 0x11, 0xD0, 0x90, 0x8A, 0xED, 0x11, 0xD0, 0x12, 0xE3, 0xD6, 0x54, -+0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x7D, 0xFF, 0x7F, 0xFF, 0x12, 0x9A, 0x2E, 0x90, 0x8A, 0xFD, -+0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x96, 0xFF, 0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x30, 0xE0, 0x02, 0x41, 0x4C, 0xEE, 0x12, 0xA9, 0xA5, 0x30, 0xE0, 0x02, 0x41, 0x4C, 0x90, 0x88, -+0x39, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x41, 0x4C, 0xEF, 0x70, 0x02, 0x21, 0xA8, 0x24, 0xFE, 0x70, -+0x02, 0x21, 0xED, 0x24, 0xFE, 0x60, 0x4F, 0x24, 0xFC, 0x70, 0x02, 0x41, 0x32, 0x24, 0xFC, 0x60, -+0x02, 0x41, 0x45, 0xEE, 0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, -+0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, -+0x88, 0x39, 0xE0, 0xB4, 0x04, 0x11, 0x90, 0x96, 0xFF, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x67, 0x80, -+0x80, 0x05, 0x90, 0x8A, 0xED, 0x11, 0xD0, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x41, -+0x45, 0x12, 0x7B, 0xCC, 0x41, 0x45, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, -+0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, -+0x0E, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xD0, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, -+0xE0, 0x64, 0x0C, 0x60, 0x02, 0x41, 0x45, 0x90, 0x86, 0x00, 0x11, 0xD0, 0xEF, 0x64, 0x01, 0x60, -+0x02, 0x41, 0x45, 0x12, 0x68, 0xC2, 0x41, 0x45, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, -+0x86, 0x00, 0x11, 0xD0, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, -+0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xD0, -+0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, 0x70, 0x67, 0x90, 0x86, -+0x02, 0x11, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x5D, 0x12, 0x73, 0x5A, 0x80, 0x58, 0x90, 0x88, 0x39, -+0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xD0, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, -+0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, -+0x90, 0x86, 0x00, 0x11, 0xD0, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, -+0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x18, 0x12, 0x7A, 0x49, -+0x80, 0x13, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0x88, 0x32, 0x12, 0x9F, 0xE7, 0x30, -+0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, 0x88, 0x39, 0x12, 0xE3, 0x2C, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x85, 0x4E, 0x90, 0x95, 0xB3, 0xEF, 0xF0, 0x60, -+0xF0, 0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, -+0xE0, 0x0F, 0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x35, 0xBE, 0x12, 0xD5, -+0x7A, 0x51, 0xAC, 0x30, 0xE1, 0x08, 0x54, 0xFD, 0xF0, 0x90, 0x86, 0x08, 0x11, 0xD0, 0x51, 0xAC, -+0x30, 0xE2, 0x08, 0x54, 0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x11, 0xD0, 0x51, 0xAC, 0x30, 0xE6, 0x08, -+0x54, 0xBF, 0xF0, 0x90, 0x8A, 0x7D, 0x11, 0xD0, 0xD2, 0xAF, 0x80, 0xB5, 0xD2, 0xAF, 0xC2, 0xAF, -+0x90, 0x86, 0xAF, 0xE0, 0x22, 0x11, 0xCD, 0xEF, 0x70, 0x02, 0xFF, 0x22, 0xF1, 0x18, 0x90, 0x93, -+0xAC, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, 0xEF, 0x54, 0xF1, 0xFF, 0xEE, 0x04, -+0x54, 0x07, 0x25, 0xE0, 0x4F, 0xF0, 0xA3, 0xE0, 0xFF, 0x12, 0xE3, 0x71, 0xB5, 0x07, 0x04, 0xEE, -+0x54, 0xF1, 0xF0, 0xF1, 0x18, 0xF5, 0x7F, 0xE4, 0x90, 0x93, 0x5A, 0xF0, 0xE5, 0x7F, 0x75, 0xF0, -+0x1B, 0xA4, 0x24, 0x5F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x30, 0xE0, 0x28, 0x71, -+0x82, 0xE0, 0x24, 0xAF, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFF, 0xE5, 0x7F, 0xF1, -+0x34, 0xEF, 0x71, 0x81, 0xE0, 0x04, 0x71, 0x81, 0xE0, 0xFF, 0x90, 0x93, 0xAE, 0xE0, 0xFE, 0xEF, -+0xB5, 0x06, 0x04, 0x71, 0x82, 0xE4, 0xF0, 0xE5, 0x7F, 0xF1, 0x34, 0xE0, 0xFC, 0x90, 0x93, 0xAC, -+0xE0, 0xF1, 0x34, 0xE0, 0x6C, 0x60, 0x13, 0xE5, 0x7F, 0x12, 0x9B, 0x7C, 0x12, 0xE2, 0xAA, 0xAF, -+0x04, 0xF1, 0x42, 0xE5, 0x7F, 0x12, 0x9B, 0x7C, 0x71, 0x8E, 0xE5, 0x7F, 0xF1, 0xD6, 0x54, 0x07, -+0xFF, 0x60, 0x03, 0xBF, 0x02, 0x10, 0xE5, 0x7F, 0x12, 0x98, 0x24, 0xE0, 0xFF, 0x7E, 0x00, 0x7B, -+0x04, 0xE4, 0xFD, 0x12, 0x9A, 0x39, 0xAD, 0x7F, 0x7F, 0x01, 0x12, 0x9A, 0xDE, 0x90, 0x93, 0xAD, -+0xE0, 0xC3, 0x13, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x05, 0xE4, 0xFF, 0x12, 0x9F, 0xF5, 0x7F, 0x01, -+0x22, 0xF0, 0x74, 0xD2, 0x25, 0x7F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0xFF, 0xEE, -+0x13, 0x13, 0x54, 0x07, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xF5, 0xED, -+0xF0, 0xE4, 0xA3, 0xF0, 0xEF, 0x14, 0x60, 0x02, 0x81, 0x79, 0x90, 0x06, 0x03, 0xE0, 0x54, 0xFB, -+0xF0, 0x90, 0x96, 0xF5, 0xE0, 0xFB, 0xC4, 0x33, 0x54, 0xE0, 0xFE, 0x90, 0x04, 0x42, 0xE0, 0x54, -+0x9F, 0x4E, 0xFE, 0xF0, 0xE4, 0xFD, 0x12, 0xDE, 0x54, 0x90, 0x96, 0xF6, 0xEF, 0xF0, 0x90, 0x04, -+0x83, 0xF0, 0x90, 0x96, 0xA1, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xA5, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0xB1, 0x45, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, -+0x96, 0xA5, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, 0xB1, 0x49, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x00, 0x10, 0x90, 0x96, 0xF5, 0xB1, 0x68, 0xEF, 0x54, 0x03, 0xFF, 0xE4, -+0x78, 0x01, 0x12, 0x03, 0xEB, 0x78, 0x04, 0xF1, 0x21, 0x7F, 0x00, 0x7E, 0x0A, 0xB1, 0x49, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0xF5, 0xB1, 0x68, 0xEF, 0x54, 0x03, 0xFF, 0xE4, -+0x78, 0x0A, 0xF1, 0x21, 0x7F, 0x00, 0x7E, 0x0D, 0xB1, 0x49, 0x12, 0x04, 0x3D, 0x0C, 0x00, 0x00, -+0x00, 0x90, 0x96, 0xF6, 0xB1, 0x68, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, 0x1A, 0xF1, 0x21, 0x7F, -+0x18, 0xB1, 0x47, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0xA5, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x00, 0x00, 0xF1, 0x2A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0x93, -+0x12, 0x04, 0x3D, 0x00, 0x00, 0x04, 0x00, 0x80, 0x58, 0x90, 0x06, 0x03, 0xE0, 0x44, 0x04, 0xF0, -+0x90, 0x96, 0xA1, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xA5, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x00, 0x00, 0xB1, 0x45, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xA5, -+0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x09, 0xB1, 0x49, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0xA5, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0xF1, 0x2A, -+0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0x93, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, -+0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0xDD, 0xCA, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x9F, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, -+0x70, 0x90, 0x96, 0xA9, 0x12, 0x04, 0x31, 0x90, 0x96, 0xA1, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, -+0x90, 0x96, 0xA9, 0xF1, 0xBA, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0xA1, -+0x12, 0x04, 0xB8, 0x90, 0x96, 0xA5, 0xF1, 0xBA, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0x12, 0x86, 0x24, 0x90, 0x96, 0xAD, 0x12, 0x04, 0x31, 0x90, 0x96, 0xAD, 0x12, 0x04, 0xB8, 0x90, -+0x92, 0x18, 0x12, 0x04, 0x31, 0x90, 0x96, 0x9F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x00, 0x7E, 0x08, 0x91, 0xDF, 0x90, 0x96, 0xA1, 0x22, 0x90, -+0x05, 0x61, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, 0x04, 0xA9, -+0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x05, 0x60, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0x90, -+0x93, 0x58, 0xE0, 0x20, 0xE0, 0x02, 0xE1, 0x17, 0x90, 0x93, 0xDA, 0xE0, 0x04, 0xF0, 0xF1, 0x18, -+0x04, 0xFF, 0x90, 0x96, 0x1B, 0xF0, 0x90, 0x93, 0x59, 0xE0, 0xB5, 0x07, 0x05, 0xE4, 0x90, 0x96, -+0x1B, 0xF0, 0x90, 0x93, 0xD8, 0xE0, 0xFF, 0x60, 0x1A, 0x90, 0x96, 0x1B, 0xF1, 0xC3, 0xE0, 0xC3, -+0x9F, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, -+0x12, 0x66, 0x33, 0x90, 0x96, 0x1B, 0xE0, 0xFF, 0xF1, 0xD6, 0x54, 0x07, 0xFE, 0x64, 0x02, 0x60, -+0x03, 0xEE, 0x70, 0x11, 0xEF, 0xF1, 0xC4, 0xE0, 0x24, 0xFC, 0xFF, 0xE4, 0x90, 0x92, 0x20, 0xF0, -+0xA3, 0xEF, 0x12, 0xA6, 0x13, 0x90, 0x93, 0x58, 0xE0, 0xF1, 0xD2, 0x54, 0x07, 0xFF, 0x14, 0x60, -+0x0F, 0x14, 0x60, 0x07, 0x14, 0x60, 0x09, 0x24, 0x03, 0x70, 0x0B, 0x12, 0x9B, 0x8E, 0x80, 0x03, -+0x12, 0x9A, 0x23, 0x12, 0x98, 0x32, 0x90, 0x93, 0xD7, 0xE0, 0xFF, 0x90, 0x93, 0xDA, 0xE0, 0xD3, -+0x9F, 0x40, 0x02, 0xE1, 0x17, 0xB1, 0x4F, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x05, 0x62, 0xB1, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, -+0xB1, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -+0x86, 0x24, 0x90, 0x96, 0x1C, 0x12, 0x04, 0x31, 0x90, 0x05, 0x65, 0xB1, 0x68, 0x12, 0xCF, 0xCA, -+0x90, 0x05, 0x64, 0xB1, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0x05, 0x66, 0xB1, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0xB1, 0x68, -+0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, -+0x90, 0x96, 0x20, 0x12, 0x04, 0x31, 0x90, 0x96, 0x1B, 0xF1, 0xC3, 0xB1, 0x68, 0x12, 0xE3, 0x82, -+0x90, 0x96, 0x1C, 0x12, 0x86, 0x31, 0x12, 0x85, 0xAD, 0x90, 0x96, 0x24, 0x12, 0x04, 0x31, 0x90, -+0x96, 0x1C, 0x12, 0x04, 0xB8, 0x90, 0x96, 0x24, 0x12, 0xCF, 0xD8, 0x50, 0x0C, 0x90, 0x96, 0x20, -+0x12, 0xCC, 0xA6, 0x90, 0x96, 0x20, 0x12, 0x04, 0x31, 0x90, 0x96, 0x20, 0x12, 0xCF, 0xC2, 0x90, -+0x05, 0x8B, 0xEF, 0xF0, 0x90, 0x96, 0x20, 0x12, 0xCF, 0xAE, 0x90, 0x05, 0x8A, 0xEF, 0xF0, 0x90, -+0x96, 0x20, 0x12, 0xCF, 0xA6, 0x90, 0x05, 0x89, 0xEF, 0xF0, 0x90, 0x96, 0x20, 0x12, 0xE3, 0x8A, -+0x90, 0x96, 0x24, 0x12, 0xCF, 0xC2, 0x90, 0x05, 0x87, 0xEF, 0xF0, 0x90, 0x96, 0x24, 0x12, 0xCF, -+0xAE, 0x90, 0x05, 0x86, 0xEF, 0xF0, 0x90, 0x96, 0x24, 0x12, 0xCF, 0xA6, 0x90, 0x05, 0x85, 0xEF, -+0xF0, 0x90, 0x96, 0x24, 0x12, 0xE2, 0xD4, 0x22, 0x90, 0x93, 0x58, 0xE0, 0xC3, 0x13, 0x54, 0x07, -+0x22, 0x12, 0x03, 0xFE, 0x90, 0x96, 0xA5, 0x02, 0x04, 0x31, 0x7F, 0x84, 0x7E, 0x08, 0x91, 0xDF, -+0x90, 0x96, 0x8F, 0x22, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5B, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -+0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xE1, 0xEF, 0xF0, 0xED, 0x64, -+0x01, 0x70, 0x31, 0xEB, 0xB4, 0x01, 0x07, 0xE0, 0x24, 0x02, 0xF5, 0x0E, 0x80, 0x08, 0x90, 0x96, -+0xE1, 0xE0, 0x24, 0xFE, 0xF5, 0x0E, 0x90, 0x96, 0x8F, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, -+0xAF, 0x0E, 0xE4, 0xFC, 0xFD, 0xFE, 0x12, 0xDE, 0x42, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, -+0xAF, 0x0E, 0x80, 0x1E, 0x90, 0x96, 0x8F, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x96, -+0xE1, 0xB1, 0x68, 0x12, 0xDE, 0x42, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x96, 0xE1, -+0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x96, 0x93, 0x12, 0x04, 0x31, 0x7D, 0x18, 0x7C, 0x00, -+0x7F, 0x01, 0x12, 0xDD, 0xCA, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x86, 0x31, 0x02, 0x86, 0x17, -+0x90, 0x96, 0x2A, 0xE0, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5D, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -+0x83, 0x22, 0xC3, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5E, 0xF5, 0x82, 0xE4, 0x34, -+0x93, 0xF5, 0x83, 0xE0, 0x22, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -+0xEF, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x44, 0x7F, 0x6F, -+0x12, 0x04, 0x7E, 0x12, 0x88, 0xCD, 0x90, 0x96, 0xF0, 0xE0, 0x90, 0x96, 0xEF, 0xB4, 0x01, 0x0A, -+0xE0, 0x12, 0xAE, 0x93, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x08, 0xE0, 0x12, 0xAE, 0x93, 0xE0, 0x54, -+0xFB, 0xF0, 0x90, 0x8A, 0xF9, 0x11, 0x40, 0xF1, 0x91, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8A, -+0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x79, -+0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x90, 0x95, 0x33, 0xEF, 0xF0, 0x51, 0x85, -+0x12, 0xE3, 0xFA, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, 0x7C, 0xF0, 0x51, 0x85, -+0x12, 0xE3, 0xF3, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, 0x7D, 0xF0, 0x51, 0x85, -+0x12, 0xE3, 0xEC, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, 0x7E, 0xF0, 0x51, 0x85, -+0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, -+0x7F, 0xF0, 0x51, 0x85, 0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, -+0x7A, 0xE0, 0x90, 0x95, 0x80, 0xF0, 0x51, 0x85, 0x12, 0xC3, 0x5A, 0xBF, 0x01, 0x08, 0x90, 0x95, -+0x7A, 0xE0, 0x90, 0x95, 0x81, 0xF0, 0x51, 0x85, 0x7F, 0xFB, 0xF1, 0x97, 0x70, 0x52, 0x90, 0x95, -+0x7A, 0xE0, 0x90, 0x95, 0x82, 0xF0, 0x54, 0x07, 0x60, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x54, 0xE0, -+0x70, 0x3E, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x7B, 0x7F, 0xFA, 0xF1, 0x97, 0x70, 0x32, 0x90, 0x95, -+0x7A, 0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, 0x90, 0x95, 0x82, 0xE0, 0xFE, 0x90, 0x95, 0x7B, 0xE0, -+0x54, 0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x95, 0x82, 0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x95, -+0x82, 0xE0, 0xFF, 0x90, 0x95, 0x7B, 0xE0, 0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x95, 0x82, 0xF0, -+0x51, 0x85, 0x7F, 0xFD, 0xF1, 0x97, 0x70, 0x47, 0x90, 0x95, 0x7A, 0xE0, 0xFE, 0x54, 0xCC, 0x90, -+0x95, 0x83, 0xF0, 0xEE, 0x54, 0x0C, 0xFF, 0x60, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x54, 0xC0, 0x70, -+0x2E, 0xEF, 0x70, 0x12, 0x90, 0x95, 0x83, 0xE0, 0xFF, 0x90, 0x95, 0x7A, 0xE0, 0x54, 0x03, 0x12, -+0xE3, 0xBE, 0x90, 0x95, 0x83, 0xF0, 0x90, 0x95, 0x7A, 0xE0, 0xFF, 0x54, 0xC0, 0x70, 0x10, 0x90, -+0x95, 0x83, 0xE0, 0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0xEE, 0x4F, 0xF0, 0x51, -+0x85, 0x7F, 0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, -+0x95, 0x84, 0xF0, 0x51, 0x85, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, -+0x95, 0x7A, 0xE0, 0x90, 0x95, 0x85, 0xF0, 0x51, 0x85, 0x12, 0xE3, 0xE5, 0xBF, 0x01, 0x08, 0x90, -+0x95, 0x7A, 0xE0, 0x90, 0x95, 0x86, 0xF0, 0x51, 0x85, 0x12, 0xE3, 0xDE, 0xBF, 0x01, 0x08, 0x90, -+0x95, 0x7A, 0xE0, 0x90, 0x95, 0x87, 0xF0, 0x51, 0x85, 0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -+0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, 0x88, 0xF0, 0x90, 0x95, 0x34, 0x74, 0x19, -+0xF0, 0x90, 0x95, 0x56, 0x74, 0x08, 0xF0, 0x90, 0x95, 0x7C, 0xE0, 0x90, 0x95, 0x36, 0xF0, 0x90, -+0x95, 0x7D, 0xE0, 0x90, 0x95, 0x37, 0xF0, 0x90, 0x95, 0x7E, 0xE0, 0x90, 0x95, 0x38, 0xF0, 0x90, -+0x95, 0x7F, 0xE0, 0x90, 0x95, 0x39, 0xF0, 0x90, 0x95, 0x80, 0xE0, 0x90, 0x95, 0x3A, 0xF0, 0x90, -+0x95, 0x81, 0xE0, 0x90, 0x95, 0x3B, 0xF0, 0x90, 0x95, 0x82, 0xE0, 0x90, 0x95, 0x3C, 0xF0, 0x90, -+0x95, 0x83, 0xE0, 0x90, 0x95, 0x3D, 0xF0, 0x90, 0x95, 0x57, 0x74, 0x1A, 0xF0, 0x90, 0x95, 0x79, -+0x74, 0x05, 0xF0, 0x90, 0x95, 0x84, 0xE0, 0x90, 0x95, 0x59, 0xF0, 0x90, 0x95, 0x85, 0xE0, 0x90, -+0x95, 0x5A, 0xF0, 0x90, 0x95, 0x86, 0xE0, 0x90, 0x95, 0x5B, 0xF0, 0x90, 0x95, 0x87, 0xE0, 0x90, -+0x95, 0x5C, 0xF0, 0x90, 0x95, 0x88, 0xE0, 0x90, 0x95, 0x5D, 0xF0, 0x90, 0x95, 0x33, 0xE0, 0xB4, -+0x01, 0x19, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x34, 0x12, 0xB9, 0x53, 0x12, 0x04, 0x7E, 0x7B, 0x01, -+0x7A, 0x95, 0x79, 0x57, 0x11, 0x2E, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, -+0x95, 0x75, 0x47, 0x34, 0x75, 0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x69, 0xF5, -+0x75, 0x45, 0x01, 0x75, 0x46, 0x95, 0x75, 0x47, 0x59, 0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, -+0x79, 0xAA, 0x02, 0x69, 0xF5, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x7A, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x12, 0x9F, 0xE1, 0x12, 0x87, 0xF5, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, -+0x48, 0x05, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9D, 0x12, 0x69, 0xF5, 0x12, 0x87, 0xF5, 0x12, 0x02, -+0x06, 0x20, 0xE0, 0x02, 0x81, 0x22, 0x90, 0x05, 0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, -+0x13, 0x90, 0x88, 0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x15, 0x12, -+0x87, 0xA1, 0x90, 0x88, 0x9E, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0x12, 0x87, 0x6B, 0x90, 0x88, -+0x9F, 0xF0, 0x80, 0x4B, 0x12, 0x87, 0xA1, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x15, 0xEF, 0xC3, 0x94, -+0x03, 0x50, 0x07, 0x90, 0x88, 0x9E, 0x74, 0x03, 0x80, 0x0D, 0x12, 0x87, 0xA1, 0x90, 0x88, 0x9E, -+0x80, 0x05, 0x90, 0x88, 0x9E, 0x74, 0x2A, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0x12, 0x87, -+0x6C, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, -+0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, -+0x9C, 0xD1, 0x54, 0x03, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, -+0x88, 0xA6, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, -+0x90, 0x88, 0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, -+0x9F, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, -+0x02, 0x12, 0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0x12, 0x87, 0xF4, 0x12, 0xE3, 0x46, 0x20, 0xE0, -+0x37, 0x90, 0x88, 0x9D, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x06, 0x12, 0xA9, 0xA4, 0x30, 0xE0, 0x28, -+0x12, 0xE3, 0xA5, 0x30, 0xE0, 0x08, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x80, 0x0B, 0x90, 0x88, -+0xDF, 0xE0, 0x60, 0x05, 0x75, 0x61, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x61, 0x90, 0x8A, 0xF3, 0x11, -+0x40, 0x7D, 0x02, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, -+0xE0, 0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, -+0x11, 0x40, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0xE4, 0x01, 0x74, 0x11, 0xF0, 0xF1, -+0xED, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, -+0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, -+0x88, 0xA5, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, -+0xA5, 0xE0, 0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, 0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, -+0x80, 0x67, 0x12, 0x87, 0xF5, 0x12, 0xE3, 0x46, 0x30, 0xE0, 0x05, 0x75, 0x62, 0x02, 0x80, 0x0E, -+0x12, 0xE3, 0xA5, 0x30, 0xE0, 0x05, 0x75, 0x62, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x62, 0x90, 0x8A, -+0xF1, 0x12, 0x88, 0xD0, 0x90, 0x89, 0x04, 0xE0, 0x30, 0xE0, 0x04, 0x7D, 0xAC, 0x80, 0x02, 0x7D, -+0x2C, 0x7F, 0x40, 0x12, 0x7B, 0x2E, 0x12, 0x87, 0xF5, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, -+0x90, 0x8A, 0xF3, 0x11, 0x40, 0xAD, 0x62, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x11, -+0x40, 0xF1, 0x91, 0x12, 0xE4, 0x01, 0x74, 0x43, 0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, 0xF0, -+0xE4, 0x90, 0x88, 0xAF, 0xF0, 0x90, 0x88, 0xA0, 0x12, 0xA9, 0xA4, 0x30, 0xE0, 0x09, 0x90, 0x88, -+0xD0, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x11, 0x90, 0x8A, 0x97, 0x11, 0x40, 0x7F, 0x01, 0x12, 0x04, -+0x7E, 0x90, 0x88, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, 0x11, 0x40, 0x7F, 0x03, 0x12, -+0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8B, 0x61, 0x8A, 0x62, -+0x89, 0x63, 0x90, 0x05, 0x27, 0xE0, 0xF5, 0x64, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, 0x48, -+0x01, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x2C, 0x12, 0x69, 0xF5, 0x12, 0x9D, 0xEE, 0xFF, 0xC3, 0x13, -+0x20, 0xE0, 0x02, 0xA1, 0x91, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x73, 0x12, 0xE4, 0x09, 0x75, -+0x64, 0x21, 0x12, 0xE3, 0xAE, 0x30, 0xE0, 0x05, 0x12, 0xE2, 0xE3, 0x80, 0x0D, 0xE4, 0x90, 0x88, -+0x2D, 0xF0, 0xA3, 0xF0, 0x7D, 0x40, 0xFF, 0x12, 0x7C, 0x7E, 0x90, 0x88, 0x2C, 0x12, 0xE2, 0xCC, -+0x30, 0xE0, 0x03, 0x43, 0x64, 0x12, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x14, -+0x12, 0xE3, 0x6A, 0x54, 0x07, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x80, 0x12, 0xE3, 0x6A, 0x13, 0x54, -+0x03, 0x20, 0xE0, 0x03, 0x43, 0x64, 0x40, 0xD1, 0x4D, 0x90, 0x88, 0x2F, 0xE0, 0x70, 0x05, 0x7F, -+0x01, 0x12, 0xB9, 0xDC, 0x12, 0xD2, 0xAB, 0x30, 0xE0, 0x04, 0x7F, 0x04, 0x80, 0x0C, 0x12, 0xA7, -+0x8F, 0xEF, 0x60, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x12, 0xB9, 0xDC, 0xC1, 0x08, 0xD1, -+0x4A, 0x90, 0x88, 0x2F, 0xE0, 0x64, 0x04, 0x60, 0x02, 0xC1, 0x45, 0xFF, 0x12, 0xB9, 0xDC, 0xC1, -+0x45, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x78, 0x12, 0xE4, 0x09, 0x43, 0x64, 0x31, 0x12, 0xE3, -+0xAE, 0x30, 0xE0, 0x05, 0x12, 0xE2, 0xE3, 0x80, 0x07, 0x7D, 0x40, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, -+0x90, 0x88, 0x2C, 0x12, 0xE2, 0xCC, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x02, 0xEF, 0xC4, 0x54, 0x0F, -+0x30, 0xE0, 0x03, 0x43, 0x64, 0x04, 0xD1, 0x4D, 0x12, 0xD2, 0xAB, 0x30, 0xE0, 0x0F, 0xF1, 0xC8, -+0x60, 0x36, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0xE4, 0xFD, 0x7F, 0x02, 0x80, 0x1E, 0xF1, 0xF6, 0xF1, -+0xC8, 0x70, 0x1D, 0x12, 0x7B, 0xAD, 0x12, 0xA7, 0x8F, 0xBF, 0x01, 0x07, 0x12, 0x9C, 0xC0, 0x7D, -+0x01, 0x80, 0x08, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x80, 0x08, -+0x90, 0x88, 0x39, 0xE0, 0x90, 0x88, 0x30, 0xF0, 0x90, 0x05, 0x40, 0x74, 0x22, 0xF0, 0x80, 0x35, -+0xD1, 0x4A, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, 0x0B, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0x7D, 0x01, -+0x7F, 0x04, 0x80, 0x10, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x08, 0x0C, 0x90, 0x8A, 0xB9, 0x11, 0x40, -+0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x12, 0xE0, 0xDB, 0x12, 0x9C, 0xC0, 0x7D, 0x01, 0x12, -+0x04, 0x7E, 0x12, 0xC3, 0x9E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0x64, 0x01, 0x90, 0x05, 0x27, -+0xE5, 0x64, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x31, -+0x12, 0x04, 0x80, 0x12, 0xC3, 0x82, 0x12, 0x04, 0x80, 0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, 0x90, -+0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, 0xA3, -+0x74, 0x02, 0x12, 0xCA, 0x57, 0xFF, 0x12, 0xE3, 0x10, 0x12, 0xE2, 0x01, 0x90, 0x8A, 0x89, 0x11, -+0x40, 0xF1, 0x91, 0x90, 0x8A, 0x89, 0x11, 0x40, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, -+0x8A, 0x89, 0x11, 0x40, 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x86, 0xB3, 0xE0, 0xFF, -+0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, 0x11, 0xEF, 0xB4, 0x03, 0x08, 0x90, -+0x88, 0x41, 0x74, 0x14, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0x41, 0xF0, 0x7F, 0x79, 0x12, 0x7B, -+0x41, 0xEF, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE2, -+0x06, 0x90, 0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, -+0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0x12, 0xCA, 0x57, 0x12, 0xE3, -+0x10, 0x7E, 0x00, 0x7F, 0x18, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x3F, 0x12, 0x04, 0x80, -+0x90, 0x8A, 0xA3, 0x11, 0x40, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0xF1, 0xED, 0x7E, 0x00, 0xFF, 0x7D, -+0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, -+0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, 0x9C, -+0xF0, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xB1, 0x57, 0x90, 0x88, 0x9D, 0xE0, -+0x20, 0xE0, 0x3D, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x35, 0x90, 0x8A, 0xD7, 0x12, 0x88, -+0xD0, 0x12, 0xA6, 0xFF, 0x60, 0x18, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0x12, 0xD0, 0xC0, 0x90, 0x8A, -+0xF9, 0x11, 0x40, 0xF1, 0x91, 0x90, 0x8B, 0x01, 0x12, 0xBD, 0x11, 0x02, 0x04, 0x7A, 0x90, 0x88, -+0x39, 0xE0, 0x70, 0x0C, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0x7D, 0x01, 0x7F, 0x04, 0x12, 0x04, 0x7E, -+0x22, 0xE4, 0xFD, 0xFF, 0x02, 0x04, 0x7E, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xEF, 0x64, 0x01, 0x22, -+0x90, 0x8A, 0xF9, 0x11, 0x40, 0xF1, 0x91, 0x90, 0x88, 0x2F, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x8A, -+0xF9, 0x11, 0x40, 0xF1, 0x91, 0xF1, 0xF6, 0x80, 0xEE, 0x90, 0x86, 0x0C, 0x12, 0x88, 0xD0, 0x90, -+0x8A, 0xF9, 0x11, 0x40, 0xF1, 0x91, 0x80, 0xDF, 0x90, 0x88, 0x30, 0xE0, 0x64, 0x02, 0x22, 0x12, -+0xD2, 0xAB, 0x30, 0xE0, 0x10, 0xF1, 0xC8, 0x60, 0x0C, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0x7D, 0x01, -+0x7F, 0x02, 0x12, 0x04, 0x7E, 0xF1, 0xC8, 0x60, 0x03, 0x12, 0xD0, 0xA4, 0x22, 0x90, 0x05, 0x58, -+0x74, 0x02, 0xF0, 0x22, 0x80, 0xB1, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0xF1, 0xE1, -+0x90, 0x04, 0x24, 0xE0, 0xFF, 0xE4, 0xFE, 0x12, 0x87, 0xF5, 0x8E, 0x82, 0x12, 0xBF, 0xF7, 0x2F, -+0xFD, 0xEE, 0x11, 0x24, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x03, 0xEC, 0x22, 0x90, 0x93, 0x58, 0xE0, -+0xC3, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -+0x83, 0x22, 0xE4, 0x90, 0x96, 0x2B, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFF, 0x20, 0xE0, 0x02, 0x21, -+0xA7, 0x12, 0x8F, 0xD2, 0x54, 0x07, 0x90, 0x96, 0x28, 0xF0, 0x60, 0x07, 0xE0, 0x64, 0x02, 0x60, -+0x02, 0x21, 0x3B, 0x90, 0x93, 0x5A, 0xE0, 0x70, 0x2A, 0x71, 0x63, 0x7B, 0x4E, 0x51, 0x2A, 0x11, -+0x1C, 0xE0, 0xFF, 0x7E, 0x00, 0x7B, 0x04, 0x7D, 0x01, 0x51, 0x39, 0xBF, 0x01, 0x0C, 0x31, 0xA8, -+0x44, 0x01, 0xF0, 0x90, 0x93, 0x5A, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x96, 0x29, 0xE0, 0xFD, 0x7B, -+0x4F, 0x21, 0x12, 0x90, 0x93, 0x5A, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x21, 0x2B, 0x12, 0x8F, 0x18, -+0xFF, 0x12, 0x8F, 0xD6, 0xFE, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, 0x21, 0x29, 0xEF, 0x31, 0xB0, -+0xFF, 0x30, 0xE0, 0x08, 0x90, 0x96, 0x2B, 0x74, 0x01, 0xF0, 0x80, 0x12, 0xEF, 0xC3, 0x13, 0x20, -+0xE0, 0x0C, 0x90, 0x96, 0x2B, 0x74, 0x01, 0xF0, 0x71, 0x63, 0x7B, 0x50, 0x51, 0x2A, 0x90, 0x96, -+0x2B, 0xE0, 0x60, 0x67, 0x90, 0x93, 0xDF, 0xE0, 0xFF, 0x90, 0x93, 0xDE, 0xE0, 0x6F, 0x60, 0x46, -+0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x01, 0x40, 0x08, 0x90, 0x96, 0x2C, 0x74, 0x04, 0xF0, 0x80, -+0x05, 0xE4, 0x90, 0x96, 0x2C, 0xF0, 0x11, 0x1C, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x96, 0x2C, 0xE0, -+0xFB, 0x7D, 0x01, 0x51, 0x39, 0xBF, 0x01, 0x13, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0xA3, 0x74, 0x03, -+0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x02, 0x66, 0x33, 0x90, 0x96, 0x29, 0xE0, 0xFD, -+0x7B, 0x51, 0xE4, 0xFF, 0x41, 0x2E, 0xE4, 0x90, 0x93, 0xDE, 0xF0, 0x51, 0x23, 0x90, 0x93, 0x58, -+0xE0, 0xFF, 0x31, 0xAC, 0x54, 0xFB, 0xF0, 0x80, 0x02, 0x51, 0x23, 0x90, 0x93, 0x5A, 0xE0, 0x64, -+0x05, 0x70, 0x74, 0x12, 0x8A, 0xB5, 0xEF, 0x70, 0x6E, 0x80, 0x68, 0x90, 0x96, 0x28, 0xE0, 0xFF, -+0x64, 0x03, 0x60, 0x05, 0xEF, 0x64, 0x01, 0x70, 0x5E, 0x90, 0x93, 0x5A, 0xE0, 0x64, 0x05, 0x70, -+0x56, 0x90, 0x96, 0x28, 0xE0, 0x64, 0x01, 0x70, 0x3C, 0x12, 0x8F, 0xC0, 0xE0, 0xD3, 0x94, 0x1F, -+0x90, 0x93, 0x58, 0xE0, 0x40, 0x0F, 0x11, 0x21, 0xE0, 0xFF, 0x90, 0x8A, 0xBF, 0x91, 0xC8, 0x7D, -+0x00, 0x7C, 0x7C, 0x80, 0x1D, 0x11, 0x20, 0xE0, 0xFB, 0x12, 0x8F, 0xC0, 0xE0, 0x7D, 0x00, 0x25, -+0xE0, 0x25, 0xE0, 0xFC, 0xAF, 0x03, 0x90, 0x8A, 0xBF, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, -+0x8A, 0x83, 0x12, 0x04, 0x7E, 0x12, 0x8F, 0x18, 0xFD, 0x7F, 0x02, 0x51, 0xDE, 0x12, 0x8A, 0xB5, -+0xEF, 0x70, 0x04, 0x7F, 0x06, 0xF1, 0xF5, 0x22, 0x90, 0x93, 0x58, 0xE0, 0xC3, 0x13, 0x54, 0x07, -+0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x22, 0xE4, -+0x90, 0x96, 0x1B, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0x30, 0xE0, 0x57, 0xC3, 0x13, 0x54, 0x07, 0xFF, -+0x31, 0xB0, 0xFE, 0x30, 0xE0, 0x4C, 0xEF, 0x71, 0x6C, 0xEE, 0x54, 0xFE, 0xF0, 0xEF, 0x31, 0xB0, -+0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0F, 0x12, 0xE3, 0x71, 0x71, 0x6C, 0xEF, 0x54, 0xFB, -+0xF0, 0x90, 0x96, 0x1B, 0x74, 0x01, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x1C, 0x51, 0x23, -+0x31, 0xA8, 0x44, 0x02, 0xF0, 0xE4, 0x90, 0x93, 0xDE, 0xF0, 0x12, 0x8F, 0x18, 0xFD, 0x7F, 0x02, -+0x51, 0xDE, 0x90, 0x96, 0x1B, 0xE0, 0x60, 0x0A, 0x01, 0x32, 0x31, 0xA8, 0x54, 0xFD, 0xF0, 0xE4, -+0x71, 0x5D, 0x22, 0x90, 0x93, 0x5A, 0x74, 0x05, 0xF0, 0x22, 0x7D, 0x6F, 0x7F, 0xFF, 0x90, 0x05, -+0x22, 0xED, 0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x96, 0xBE, 0xEE, 0xF0, 0xA3, 0x12, 0xE3, 0x93, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x29, 0x90, -+0x05, 0x22, 0xE0, 0x90, 0x96, 0xC4, 0xF0, 0x7B, 0x14, 0x12, 0x88, 0xC6, 0xEF, 0x64, 0x01, 0x70, -+0x06, 0x71, 0xA0, 0x71, 0xF4, 0x80, 0x04, 0x7F, 0x00, 0x80, 0x13, 0x90, 0x96, 0xC4, 0xE0, 0xFD, -+0x7B, 0x15, 0xE4, 0xFF, 0x51, 0x2E, 0x80, 0x04, 0x71, 0xA0, 0x71, 0xF4, 0xF1, 0x0C, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x8F, 0x65, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x95, 0x33, 0xF0, 0x7B, 0x17, 0x12, -+0x88, 0xC6, 0xEF, 0x64, 0x01, 0x70, 0x39, 0xE5, 0x65, 0x12, 0x8F, 0x34, 0xE0, 0xFC, 0x71, 0x7A, -+0x12, 0xE2, 0xAA, 0xAF, 0x04, 0x12, 0x8F, 0x42, 0x71, 0x7A, 0x12, 0x8B, 0x8E, 0xE5, 0x65, 0x12, -+0x8F, 0xD6, 0x54, 0x07, 0xFF, 0x60, 0x03, 0xBF, 0x02, 0x0D, 0xE5, 0x65, 0x11, 0x24, 0xE0, 0xFF, -+0x7E, 0x00, 0xE4, 0xFB, 0xFD, 0x51, 0x39, 0xAD, 0x65, 0x7F, 0x01, 0x51, 0xDE, 0x7F, 0x01, 0x22, -+0x90, 0x95, 0x33, 0xE0, 0xFD, 0x7B, 0x49, 0xE4, 0xFF, 0x51, 0x2E, 0x7F, 0x00, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x2E, 0xED, 0xF0, 0x90, 0x96, 0x2D, 0xEF, 0xF0, 0x64, -+0x02, 0x70, 0x24, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0x2F, 0xF0, 0x7B, 0x4A, 0x7D, 0x6F, 0x12, -+0x88, 0xC8, 0xBF, 0x01, 0x07, 0x90, 0x04, 0xD4, 0x74, 0xFF, 0x80, 0x47, 0x90, 0x96, 0x2F, 0xE0, -+0xFD, 0x7B, 0x46, 0x51, 0xD7, 0x80, 0x41, 0x90, 0x96, 0x2D, 0xE0, 0x64, 0x01, 0x70, 0x30, 0x71, -+0x5D, 0x90, 0x96, 0x2E, 0xE0, 0xFF, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x60, 0xF5, 0x82, 0xE4, 0x34, -+0x93, 0xF5, 0x83, 0xE0, 0xF4, 0x90, 0x04, 0xD4, 0xF0, 0xEF, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x61, -+0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xF4, 0x90, 0x04, 0xD5, 0xF0, 0x80, 0x07, 0x90, -+0x04, 0xD4, 0xE4, 0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFB, 0xFD, 0x7F, -+0xFF, 0x41, 0x2E, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0x29, 0xF0, 0x22, 0x75, 0xF0, 0x1B, 0xA4, -+0x24, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0xE5, 0x65, 0x75, 0xF0, 0x1B, 0xA4, -+0x24, 0x5C, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFE, 0x54, 0x03, 0x22, 0x31, 0xA8, -+0x20, 0xE0, 0x07, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0x41, 0x23, 0x31, 0xA8, 0x44, 0x04, 0xF0, 0x22, -+0x90, 0x96, 0xBE, 0xA3, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x03, 0xF0, 0x7B, 0x06, 0x7D, 0x01, -+0x12, 0x66, 0xDB, 0x90, 0x96, 0xC2, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x96, 0xC1, -+0xE0, 0xFF, 0x74, 0x10, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x96, -+0xC0, 0x22, 0x90, 0x86, 0xB6, 0xE0, 0xFF, 0x90, 0x96, 0xDD, 0xE0, 0xFB, 0x90, 0x92, 0x13, 0x74, -+0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x96, 0xDE, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, -+0xFD, 0x90, 0x96, 0xDC, 0xE0, 0xFF, 0x90, 0x8A, 0x95, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, -+0x8A, 0x83, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xDC, 0xEF, -+0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, -+0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x4F, 0x90, 0x05, -+0x22, 0xE0, 0x90, 0x96, 0xE0, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x26, 0x7F, 0xFF, -+0x12, 0x04, 0x7E, 0x12, 0x88, 0xCD, 0xEF, 0x64, 0x01, 0x70, 0x0B, 0x71, 0xD2, 0x90, 0x93, 0x58, -+0xE0, 0x20, 0xE0, 0x16, 0x80, 0x10, 0x91, 0xD1, 0x54, 0x03, 0x30, 0xE0, 0x0D, 0x71, 0xD2, 0x90, -+0x93, 0x58, 0xE0, 0x20, 0xE0, 0x04, 0x91, 0xE2, 0x91, 0xB4, 0x90, 0x96, 0xE0, 0xE0, 0xFF, 0x90, -+0x8A, 0xF9, 0x91, 0xC8, 0x7D, 0x27, 0x12, 0x04, 0x7E, 0x91, 0xD9, 0x80, 0x0F, 0x91, 0xD9, 0x91, -+0xB4, 0x71, 0xD2, 0x90, 0x93, 0x58, 0xE0, 0x20, 0xE0, 0x04, 0x91, 0xE2, 0x91, 0xB4, 0x90, 0x88, -+0x9D, 0xE0, 0x30, 0xE0, 0x18, 0x91, 0xD1, 0x54, 0x03, 0x30, 0xE0, 0x11, 0x90, 0x05, 0x22, 0xE0, -+0x54, 0x6F, 0xFF, 0x90, 0x8A, 0xF9, 0x91, 0xC8, 0x7D, 0x28, 0x12, 0x04, 0x7E, 0xF1, 0x0C, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x02, 0x04, 0x7E, -+0x90, 0x88, 0x38, 0xE0, 0xFF, 0x90, 0x8A, 0xB9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, 0x8C, 0x83, -+0x22, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x13, 0x22, 0x90, 0x96, 0xDC, 0xE0, 0xFF, 0x90, 0x8A, -+0xC7, 0x22, 0x90, 0x96, 0xDE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x9B, 0x22, 0x12, 0xA0, -+0xC2, 0xFF, 0x54, 0x0F, 0xF5, 0x64, 0xEF, 0xC4, 0x54, 0x0F, 0x64, 0x0F, 0x70, 0x3F, 0x90, 0x93, -+0x58, 0xE0, 0x54, 0xFE, 0xFF, 0xF0, 0xE5, 0x64, 0x54, 0x07, 0x25, 0xE0, 0xFE, 0xEF, 0x54, 0xF1, -+0x4E, 0x12, 0x87, 0x98, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, 0xDF, 0x20, 0xE0, 0x05, 0x74, 0x06, -+0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x7D, 0x20, 0xE4, 0xFF, 0x12, 0x7C, 0x3B, 0xAF, 0x64, 0x51, -+0x83, 0xBF, 0x01, 0x05, 0xE4, 0xFD, 0xFF, 0x51, 0xDE, 0x7F, 0x02, 0xA1, 0xEB, 0xE5, 0x64, 0x75, -+0xF0, 0x1B, 0xA4, 0x24, 0x5B, 0xF9, 0x74, 0x93, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xC0, 0x02, 0xC0, -+0x01, 0xE5, 0x63, 0x24, 0x01, 0xF9, 0xE4, 0x35, 0x62, 0x85, 0x61, 0x45, 0xF5, 0x46, 0x89, 0x47, -+0x75, 0x48, 0x04, 0xD0, 0x01, 0xD0, 0x02, 0x12, 0x69, 0xF5, 0xE5, 0x64, 0x12, 0x8F, 0xD6, 0x54, -+0xF7, 0xF0, 0xB1, 0xEE, 0xC4, 0x54, 0x0F, 0x14, 0x65, 0x64, 0x70, 0x71, 0x90, 0x88, 0x36, 0xE0, -+0x70, 0x07, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x05, 0x80, 0x5E, 0xB1, 0xEE, 0xC4, -+0x54, 0x0F, 0x90, 0x93, 0x59, 0xF1, 0xEE, 0xFC, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFE, 0x90, 0x93, -+0x58, 0xE0, 0x54, 0x0F, 0x4E, 0xF0, 0xEC, 0x54, 0x60, 0xC4, 0x54, 0x0F, 0xFF, 0x90, 0x93, 0xAD, -+0xE0, 0x54, 0xF9, 0x4F, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0x54, 0xF1, 0xF0, 0x12, 0x97, 0xED, 0x90, -+0x93, 0xD5, 0xE0, 0x90, 0x93, 0xD9, 0x30, 0xE0, 0x0B, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xC1, 0x44, -+0x02, 0xF0, 0x80, 0x07, 0xE0, 0x44, 0x01, 0xF0, 0x54, 0xC1, 0xF0, 0x90, 0x93, 0xD9, 0xE0, 0x54, -+0xBF, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x03, 0xF1, 0xF5, 0x22, 0xAB, 0x61, -+0xAA, 0x62, 0xA9, 0x63, 0x02, 0x02, 0x06, 0x90, 0x96, 0xD7, 0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, -+0x70, 0x53, 0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEE, 0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, -+0x90, 0x96, 0xD8, 0x12, 0x04, 0x31, 0xE4, 0x7F, 0x80, 0x7E, 0x02, 0xD1, 0xE5, 0x70, 0x05, 0x90, -+0x88, 0xBE, 0x80, 0x1C, 0xE4, 0xFF, 0xD1, 0xE4, 0x70, 0x0A, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xE4, -+0xA3, 0xF0, 0x80, 0x5B, 0xE4, 0xFF, 0x7E, 0x02, 0xD1, 0xE5, 0x70, 0x09, 0x90, 0x88, 0xBE, 0x04, -+0xF0, 0xA3, 0xF0, 0x80, 0x4A, 0xE4, 0x7F, 0x80, 0xD1, 0xE4, 0x70, 0x43, 0x90, 0x88, 0xBE, 0xF0, -+0xA3, 0x04, 0xF0, 0x80, 0x3A, 0x7F, 0x2C, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x02, 0xD1, -+0xF8, 0x4E, 0x4F, 0x60, 0x08, 0x90, 0x88, 0xBE, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, -+0xBE, 0xF0, 0x7F, 0x30, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x01, 0xD1, 0xF8, 0x4E, 0x4F, -+0x60, 0x07, 0xE4, 0x90, 0x88, 0xBF, 0xF0, 0x80, 0x06, 0x90, 0x88, 0xBF, 0x74, 0x01, 0xF0, 0x90, -+0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x11, 0x12, 0xBB, -+0x64, 0x12, 0x88, 0xD0, 0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x88, 0xDF, 0xE0, -+0xFF, 0x90, 0x8A, 0xF3, 0x91, 0xC8, 0xE4, 0xFD, 0x12, 0x04, 0x7E, 0x90, 0x96, 0xD7, 0xE0, 0xFD, -+0x70, 0x02, 0x80, 0x1C, 0xED, 0xB4, 0x01, 0x06, 0xD1, 0xF1, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x96, -+0xD7, 0xE0, 0xFD, 0xB4, 0x02, 0x06, 0xD1, 0xF1, 0x44, 0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, -+0xD1, 0xF1, 0xF0, 0x22, 0xFE, 0xFD, 0xFC, 0x90, 0x96, 0xD8, 0x12, 0x86, 0x31, 0xC3, 0x02, 0x03, -+0xDA, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, 0xFE, 0xFD, 0xFC, 0x90, 0x96, 0xD8, -+0x12, 0x04, 0x31, 0x90, 0x96, 0xD8, 0x12, 0x04, 0xB8, 0xEC, 0x4D, 0x22, 0x90, 0x04, 0x1F, 0x74, -+0x20, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x02, 0xF1, 0x78, 0x01, 0x32, 0x90, -+0x88, 0x2C, 0xE0, 0x90, 0x88, 0x38, 0x30, 0xE0, 0x04, 0xE0, 0xFF, 0x80, 0x07, 0x91, 0xC3, 0x7D, -+0x01, 0x02, 0x04, 0x7E, 0xAE, 0x07, 0x12, 0xA7, 0x8F, 0xBF, 0x01, 0x15, 0x12, 0xE3, 0x6A, 0x13, -+0x54, 0x03, 0x20, 0xE0, 0x0C, 0xAF, 0x06, 0x91, 0xC5, 0x7D, 0x01, 0x12, 0x04, 0x7E, 0x7F, 0x01, -+0x22, 0x7F, 0x00, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x14, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, -+0x08, 0x90, 0x8B, 0x01, 0x12, 0x88, 0xD0, 0x80, 0x05, 0x12, 0xE3, 0xD6, 0xF1, 0x1F, 0x90, 0x93, -+0x5A, 0xE0, 0xB4, 0x01, 0x02, 0x11, 0x32, 0x22, 0x12, 0xE2, 0xC9, 0x30, 0xE0, 0x0C, 0xEF, 0xC4, -+0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x03, 0x12, 0xE3, 0xB7, 0x90, 0x88, 0x31, 0xF1, 0xE7, 0x30, -+0xE0, 0x09, 0x12, 0xD0, 0x3D, 0x54, 0x07, 0x70, 0x3F, 0x80, 0x3B, 0x12, 0xE2, 0x5C, 0x40, 0x36, -+0x12, 0xA7, 0x68, 0x70, 0x33, 0x12, 0xA6, 0xFF, 0x70, 0x08, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xD0, -+0x80, 0x27, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xD0, 0x90, 0x88, 0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, -+0x94, 0x02, 0x40, 0x09, 0xF1, 0xD9, 0xE4, 0x90, 0x88, 0x40, 0xF0, 0x80, 0x03, 0x12, 0x73, 0x8F, -+0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x22, 0xF1, 0x1F, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, 0xF0, -+0x22, 0x90, 0x95, 0x33, 0x02, 0x86, 0x46, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0xF0, 0x90, -+0x00, 0x06, 0x02, 0x02, 0x1F, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0x90, 0x05, -+0x63, 0xE0, 0xFE, 0x90, 0x05, 0x62, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x96, -+0x50, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFE, 0x90, 0x05, 0x60, 0xE0, 0x24, 0x00, -+0xFF, 0xEA, 0x3E, 0xFE, 0xED, 0xB4, 0x08, 0x0A, 0x90, 0x05, 0x58, 0xE0, 0xFC, 0x2F, 0xFF, 0xEA, -+0x3E, 0xFE, 0x90, 0x96, 0x2D, 0x74, 0x17, 0xF0, 0x90, 0x96, 0x4F, 0x74, 0x06, 0xF0, 0x90, 0x96, -+0x2F, 0xED, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFD, 0xC3, 0x13, 0x54, 0x07, 0x12, 0x8F, 0x34, 0xE0, -+0x90, 0x96, 0x30, 0xF0, 0xA3, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x90, 0x96, 0x50, 0xE0, 0xFE, 0xA3, -+0xE0, 0x90, 0x96, 0x33, 0xF0, 0xEE, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0x96, 0x79, 0x2D, 0x12, 0x90, -+0x2E, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x11, 0xC2, 0xFF, 0x54, 0x01, -+0xFE, 0x90, 0x93, 0xD5, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xEE, 0x54, -+0x01, 0x12, 0x87, 0x9F, 0x90, 0x93, 0xD6, 0x12, 0x87, 0x6B, 0x90, 0x93, 0xD7, 0xF0, 0xE4, 0xA3, -+0xF0, 0x90, 0x93, 0xD7, 0xE0, 0xFF, 0xB4, 0x64, 0x05, 0x74, 0x01, 0xF0, 0x80, 0x0A, 0xEF, 0xB4, -+0x96, 0x06, 0x90, 0x93, 0xD7, 0x74, 0x03, 0xF0, 0x90, 0x93, 0xD7, 0xE0, 0x04, 0x90, 0x93, 0xDA, -+0xF0, 0x22, 0x8B, 0x61, 0x8A, 0x62, 0x89, 0x63, 0x02, 0x02, 0x06, 0x90, 0x95, 0x30, 0x12, 0x86, -+0x46, 0x90, 0x95, 0x2F, 0xEF, 0xF0, 0x12, 0x86, 0x4F, 0xA1, 0x4F, 0x00, 0xA1, 0x58, 0x01, 0xA1, -+0x61, 0x10, 0xA1, 0x6A, 0x12, 0xA1, 0x72, 0x14, 0xA2, 0x9D, 0x15, 0xA1, 0x7B, 0x16, 0xA1, 0x84, -+0x18, 0xA1, 0x8D, 0x19, 0xA1, 0x95, 0x1B, 0xA1, 0x9E, 0x1C, 0xA1, 0xA7, 0x20, 0xA1, 0xB0, 0x24, -+0xA1, 0xB9, 0x25, 0xA1, 0xC2, 0x27, 0xA1, 0xCA, 0x29, 0xA1, 0xD2, 0x2A, 0xA1, 0xDB, 0x40, 0xA1, -+0xE6, 0x42, 0xA2, 0x9D, 0x47, 0xA2, 0x9D, 0x49, 0xA1, 0xF5, 0x60, 0xA1, 0xFE, 0x61, 0xA2, 0x07, -+0x62, 0xA2, 0x10, 0x63, 0xA2, 0x19, 0x64, 0xA2, 0x22, 0x65, 0xA2, 0x2B, 0x66, 0xA2, 0x34, 0x67, -+0xA2, 0x3D, 0x68, 0xA2, 0x46, 0x69, 0xA2, 0x4F, 0x6B, 0xA2, 0x58, 0x6C, 0xA2, 0x61, 0x6D, 0xA2, -+0x6A, 0x6E, 0xA2, 0x73, 0x6F, 0xA2, 0x7C, 0x70, 0xA2, 0x85, 0xC3, 0x00, 0x00, 0xA2, 0x8E, 0x90, -+0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x87, 0x1D, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x87, -+0xFA, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x97, 0xFE, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, -+0x41, 0x9E, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xA8, 0x86, 0x90, 0x95, 0x30, 0x12, 0x86, -+0x3D, 0x02, 0x87, 0x72, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x9C, 0xEE, 0x90, 0x95, 0x30, -+0x12, 0x86, 0x3D, 0x01, 0x7B, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xA8, 0x15, 0x90, 0x95, -+0x30, 0x12, 0x86, 0x3D, 0x02, 0x87, 0xA7, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xA8, 0x95, -+0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x94, 0xD5, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, -+0xAF, 0xF5, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x61, 0x7F, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, -+0x61, 0x4F, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xB7, 0xC9, 0x90, 0x95, 0x30, 0x12, 0x86, -+0x3D, 0x90, 0x8A, 0xA5, 0x80, 0x09, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x90, 0x8A, 0xB5, 0x12, -+0xB9, 0x56, 0x02, 0x04, 0x7E, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x92, 0x8C, 0x90, 0x95, -+0x30, 0x12, 0x86, 0x3D, 0x02, 0x77, 0x4F, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x7C, 0x60, -+0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x7A, 0xC6, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, -+0x5D, 0x36, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x7B, 0xE9, 0x90, 0x95, 0x30, 0x12, 0x86, -+0x3D, 0x02, 0x70, 0x33, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x48, 0xC9, 0x90, 0x95, 0x30, -+0x12, 0x86, 0x3D, 0x02, 0x79, 0xF3, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x3F, 0xD4, 0x90, -+0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x51, 0x7B, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x79, -+0x30, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x57, 0xF2, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, -+0x02, 0x74, 0x8D, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x78, 0x9A, 0x90, 0x95, 0x30, 0x12, -+0x86, 0x3D, 0x02, 0x5E, 0x0B, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xB8, 0xA6, 0x90, 0x01, -+0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x95, 0x2F, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x12, 0x02, -+0x06, 0xFF, 0x90, 0x93, 0x3A, 0xF0, 0xBF, 0x01, 0x07, 0x51, 0xB1, 0xE4, 0x90, 0x93, 0x3A, 0xF0, -+0x22, 0x71, 0x48, 0x12, 0xE3, 0xF3, 0xBF, 0x01, 0x06, 0x90, 0x95, 0x33, 0xE0, 0xA3, 0xF0, 0x71, -+0x48, 0x12, 0xE3, 0xEC, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x33, 0xE0, 0x90, 0x95, 0x35, 0xF0, 0x71, -+0x48, 0x12, 0xE3, 0xFA, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x33, 0xE0, 0x90, 0x95, 0x36, 0xF0, 0x71, -+0x48, 0x12, 0xE3, 0xDE, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x33, 0xE0, 0x90, 0x95, 0x37, 0xF0, 0x71, -+0x48, 0x12, 0xE3, 0xE5, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x33, 0xE0, 0x90, 0x95, 0x38, 0xF0, 0x90, -+0x95, 0x34, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x95, 0x3C, 0xF0, -+0x90, 0x95, 0x38, 0xE0, 0x90, 0x95, 0x3D, 0xF0, 0x90, 0x95, 0x3E, 0x74, 0x12, 0xF0, 0x90, 0x95, -+0x60, 0x74, 0x05, 0xF0, 0x90, 0x95, 0x40, 0x12, 0xE3, 0x93, 0x90, 0x95, 0x3C, 0xE0, 0x90, 0x95, -+0x43, 0xF0, 0x90, 0x95, 0x3D, 0xE0, 0x90, 0x95, 0x44, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x3E, -+0x12, 0x90, 0x2E, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x33, 0x22, 0x12, -+0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x3F, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x03, -+0xE4, 0x71, 0x78, 0x22, 0x90, 0x96, 0x76, 0xE0, 0xFF, 0x90, 0x95, 0xC2, 0xE4, 0xF0, 0xA3, 0xEF, -+0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, -+0xA8, 0x7E, 0x90, 0x93, 0x3B, 0x12, 0xE3, 0x1E, 0x12, 0x87, 0x9F, 0x90, 0x93, 0x3C, 0x12, 0x87, -+0x6B, 0x90, 0x93, 0x3D, 0xF0, 0xF1, 0xDC, 0x90, 0x93, 0x3B, 0xE0, 0x54, 0x01, 0xFF, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x71, 0xEA, 0x60, 0x09, 0x71, 0xE3, -+0x12, 0x7C, 0x05, 0xF1, 0xD3, 0x80, 0x07, 0x71, 0xE3, 0x12, 0x7C, 0x3B, 0xF1, 0x9B, 0x12, 0x79, -+0xD4, 0x80, 0x17, 0x71, 0xEA, 0x60, 0x07, 0x71, 0xE3, 0x12, 0x7C, 0x05, 0x80, 0x05, 0x71, 0xE3, -+0x12, 0x7C, 0x3B, 0xF1, 0x71, 0xF1, 0x78, 0x12, 0x7B, 0xCC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, -+0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x90, 0x93, 0x3D, 0xE0, 0x90, 0x01, -+0x3F, 0x22, 0xF1, 0x68, 0x60, 0x02, 0xA1, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0xA1, 0x22, -+0x90, 0x88, 0x2C, 0xE0, 0x20, 0xE0, 0x38, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x31, 0x90, 0x06, -+0xA9, 0xE0, 0x54, 0xC0, 0x70, 0x29, 0x90, 0x88, 0x9C, 0xE0, 0x70, 0x23, 0x90, 0x04, 0x1A, 0xE0, -+0xF4, 0x70, 0x1C, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x70, 0x15, 0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, -+0x70, 0x0D, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x06, 0x12, 0xB4, 0x68, 0x12, 0xB1, 0x5F, 0x90, -+0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, 0x90, -+0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, 0x90, -+0x07, 0xF1, 0xE0, 0x90, 0x95, 0x2D, 0xF0, 0x90, 0x07, 0xF0, 0xE0, 0x90, 0x95, 0x2E, 0xF0, 0x90, -+0x01, 0x57, 0x12, 0xD0, 0x16, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEC, 0xF0, 0xB1, 0x3E, 0x24, -+0xFD, 0x50, 0x02, 0x80, 0x0D, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x04, 0xD1, 0x84, 0x80, 0x02, -+0xD1, 0x1E, 0xB1, 0x3E, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, 0x3D, 0xF0, -+0x90, 0x06, 0xAA, 0xE0, 0x90, 0x88, 0x3C, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, -+0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x12, 0xCA, 0x5F, 0xE4, 0x90, 0x88, -+0x3F, 0xF0, 0x12, 0xE2, 0xC9, 0x30, 0xE0, 0x58, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, -+0x20, 0xB1, 0x36, 0x6F, 0x70, 0x4A, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0xF1, 0x7F, 0x71, -+0xDF, 0x12, 0x7C, 0x05, 0xF1, 0xA2, 0x12, 0xE3, 0xB7, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0x80, -+0x2F, 0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x24, 0xB1, 0x36, 0xFE, 0x6F, -+0x60, 0x1E, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x15, 0x90, 0x88, 0x32, 0x12, 0x9F, -+0xE7, 0x30, 0xE0, 0x0C, 0xEF, 0x54, 0xBF, 0x71, 0xDF, 0x12, 0x7C, 0x3B, 0xF1, 0x78, 0xF1, 0x71, -+0xB1, 0x2E, 0x90, 0x88, 0x2C, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x02, 0xB1, 0x2E, 0x22, 0x90, 0x88, -+0x32, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x88, -+0x34, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x22, 0xE4, 0xF5, 0x7E, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, -+0xA1, 0xE9, 0xF1, 0x68, 0x60, 0x02, 0xA1, 0xE9, 0xF1, 0xED, 0xB1, 0x3E, 0x60, 0x22, 0x24, 0xFE, -+0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, -+0x88, 0x3F, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xA3, 0xF0, 0x80, 0x00, -+0x75, 0x7E, 0x01, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x11, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, -+0x03, 0xE4, 0xF5, 0x7E, 0xF1, 0x8F, 0xEF, 0x70, 0x02, 0xF5, 0x7E, 0xE5, 0x7E, 0x60, 0x4A, 0x90, -+0x88, 0x39, 0xE0, 0x20, 0xE2, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0x7D, 0x01, 0x7F, 0x04, -+0x12, 0x04, 0x7E, 0xF1, 0x87, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x0F, 0xB1, -+0xEA, 0xFF, 0xA3, 0xE0, 0x2F, 0xD1, 0x10, 0xB1, 0xEF, 0xFF, 0xA3, 0xE0, 0x80, 0x0B, 0xB1, 0xEA, -+0xB1, 0xF9, 0x2F, 0xD1, 0x10, 0xB1, 0xEF, 0xB1, 0xF9, 0x2F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, -+0x88, 0x4F, 0xF0, 0x90, 0x8A, 0xD7, 0x12, 0x88, 0xD0, 0x22, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, -+0x88, 0x3E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xFF, 0xA3, 0xE0, 0x75, 0xF0, 0x03, 0xA4, -+0x24, 0xFE, 0x22, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, -+0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x02, 0x66, 0x33, 0xE4, 0xF5, -+0x7E, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x7E, 0x54, 0xC0, 0x70, 0x18, 0xD1, 0x7C, 0x54, 0xFD, 0xF0, -+0x12, 0x9F, 0x1F, 0x90, 0x88, 0x39, 0xE0, 0x60, 0x42, 0x7F, 0x02, 0x12, 0xB7, 0x47, 0x7F, 0x02, -+0x02, 0x7B, 0x2E, 0xE5, 0x7E, 0x30, 0xE6, 0x1B, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x15, -+0xD1, 0xF8, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, 0x88, 0xD0, 0x80, 0x07, 0x12, 0x73, -+0x8F, 0x80, 0x02, 0xD1, 0x7C, 0xE5, 0x7E, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0A, 0xD1, 0x03, 0x90, -+0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x88, 0x3A, 0xE0, -+0x54, 0xFE, 0xF0, 0x22, 0x90, 0x06, 0xA9, 0xF1, 0xE6, 0xFD, 0x54, 0xC0, 0x70, 0x04, 0xD1, 0x7C, -+0x80, 0x62, 0xED, 0x30, 0xE6, 0x47, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x02, 0x70, 0x2C, 0x90, 0x88, -+0x31, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x09, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x20, -+0xD1, 0xFF, 0x64, 0x01, 0x70, 0x29, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x8A, 0x71, -+0x12, 0x90, 0x40, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x80, 0x15, 0xD1, 0xF8, 0x64, 0x02, 0x60, 0x08, -+0x90, 0x8A, 0xE1, 0x12, 0x88, 0xD0, 0x80, 0x07, 0x12, 0x73, 0x8F, 0x80, 0x02, 0xD1, 0x7C, 0x90, -+0x95, 0xED, 0xE0, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0A, 0xD1, 0x03, 0x90, 0x88, 0x31, 0xE0, 0x44, -+0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0xF0, 0x90, -+0x88, 0x34, 0xE0, 0x54, 0x0F, 0x22, 0xE4, 0x90, 0x96, 0x1B, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, -+0x56, 0xF1, 0x68, 0x70, 0x52, 0xF1, 0x7F, 0xF0, 0xF1, 0xED, 0x90, 0x96, 0x1B, 0x74, 0x01, 0xF0, -+0xE4, 0x90, 0x88, 0x3D, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x15, 0x90, 0x88, 0x30, 0xE0, -+0xB4, 0x02, 0x05, 0xE4, 0x90, 0x96, 0x1B, 0xF0, 0xF1, 0x8F, 0xEF, 0x70, 0x04, 0x90, 0x96, 0x1B, -+0xF0, 0x90, 0x96, 0x1B, 0xE0, 0x60, 0x20, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x0D, 0x90, 0x8A, -+0xB9, 0x12, 0x90, 0x40, 0x7D, 0x01, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xF1, 0x87, 0xB1, 0xEA, 0xD1, -+0x10, 0x90, 0x8A, 0xD7, 0x12, 0x88, 0xD0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x64, 0x01, -+0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x90, -+0x88, 0x3C, 0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, -+0x05, 0x43, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x12, -+0x7C, 0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0xF1, 0x06, 0xF1, 0x71, 0x7F, 0x01, 0x12, -+0xB9, 0x60, 0x90, 0x8B, 0x07, 0x12, 0x88, 0xD0, 0x90, 0x93, 0x3B, 0xE0, 0x30, 0xE0, 0x13, 0xF1, -+0xD3, 0x90, 0x93, 0x3E, 0xE0, 0x60, 0x05, 0x14, 0xF0, 0x02, 0x79, 0xD4, 0xF1, 0xDC, 0xE4, 0xFF, -+0x71, 0x9E, 0x22, 0x90, 0x93, 0x3D, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x90, 0x93, 0x3C, 0xE0, -+0x14, 0x90, 0x93, 0x3E, 0xF0, 0x22, 0xE0, 0x90, 0x95, 0xED, 0xF0, 0xE0, 0x22, 0x90, 0x05, 0x63, -+0xE0, 0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, 0x90, 0x05, 0x61, -+0xE0, 0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, 0x90, 0x88, 0x32, -+0xE0, 0x44, 0x80, 0xF0, 0x22, 0x11, 0x7E, 0x90, 0x93, 0x03, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x30, -+0xE0, 0x27, 0xEF, 0x54, 0x04, 0x25, 0xE0, 0xFE, 0xE0, 0x54, 0xF7, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, -+0x02, 0x25, 0xE0, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x90, 0x04, 0x57, 0xE0, 0x90, 0x93, 0x05, -+0xF0, 0x90, 0x04, 0x55, 0xE0, 0x90, 0x93, 0x04, 0xF0, 0x90, 0x93, 0x03, 0xE0, 0x54, 0x01, 0xFF, -+0xEF, 0x90, 0x07, 0xDC, 0x60, 0x25, 0xE4, 0xF0, 0xF0, 0x90, 0x07, 0xDE, 0xF0, 0xA3, 0x04, 0xF0, -+0x90, 0x07, 0xDD, 0x74, 0x03, 0xF0, 0x90, 0x07, 0xE3, 0xE0, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0xA3, -+0x74, 0x10, 0xF0, 0x90, 0x07, 0xDC, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xE4, 0xF0, 0x22, 0x12, 0x02, -+0x06, 0xFF, 0x54, 0x01, 0xFE, 0x22, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0xEC, 0xE0, -+0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x9F, 0xE1, 0x12, 0x87, 0xF5, 0x12, 0x02, 0x06, 0xFF, 0x54, -+0x7F, 0x90, 0x88, 0x36, 0xF0, 0xEF, 0x31, 0xA5, 0xA3, 0x12, 0x87, 0xA0, 0xFD, 0x54, 0xF0, 0xC4, -+0x54, 0x0F, 0xFF, 0x90, 0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x02, -+0x1F, 0xFC, 0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, -+0x54, 0x04, 0xC3, 0x13, 0xFF, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, -+0xC4, 0x54, 0xF0, 0xFF, 0xA3, 0xE0, 0x54, 0x0F, 0x4F, 0x12, 0x87, 0x6B, 0x90, 0x88, 0x35, 0x12, -+0x87, 0x98, 0xFD, 0x90, 0x8A, 0x89, 0x12, 0x90, 0x40, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x87, -+0xF5, 0x12, 0x87, 0x65, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x88, 0x9B, 0x12, 0xE3, 0x1E, 0x4F, 0x12, -+0x87, 0x63, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x31, 0x9C, 0x54, 0x08, 0xFE, 0xEF, 0x54, -+0xF7, 0x12, 0x87, 0x62, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x31, 0x9C, 0x54, 0x20, 0xFE, -+0xEF, 0x54, 0xDF, 0x12, 0x87, 0x62, 0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, 0x88, 0x9B, -+0xF0, 0x12, 0xD2, 0xAE, 0x20, 0xE0, 0x2F, 0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x0B, 0x75, 0x62, 0x01, -+0x90, 0x88, 0xDF, 0xE0, 0x60, 0x0B, 0x80, 0x0E, 0xE4, 0xF5, 0x62, 0x90, 0x88, 0xDF, 0xE0, 0x60, -+0x05, 0xE4, 0xF5, 0x61, 0x80, 0x03, 0x75, 0x61, 0x01, 0x90, 0x8A, 0xF3, 0x12, 0x90, 0x40, 0xAD, -+0x62, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x12, 0x87, 0xF5, 0x12, 0x5C, 0x5F, 0x90, 0x88, 0x36, 0xE0, -+0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xD3, 0x1E, 0xF0, 0x90, 0x88, -+0x36, 0x12, 0xE3, 0x2C, 0x12, 0xA6, 0xFE, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x4D, 0xFF, 0x90, 0x88, -+0x9B, 0xF0, 0xEE, 0x22, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0xF1, 0x80, 0x20, 0xE6, 0x02, 0x41, 0xC7, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x96, -+0xE9, 0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x96, 0xEA, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, -+0x90, 0x96, 0xEB, 0xF0, 0x90, 0x96, 0xEA, 0xE0, 0x24, 0xFC, 0x60, 0x0F, 0x24, 0x03, 0x60, 0x02, -+0x41, 0xC0, 0x90, 0x96, 0xE9, 0xE0, 0xFF, 0xF1, 0x87, 0x41, 0xC0, 0x90, 0x96, 0xE9, 0xE0, 0x24, -+0xD6, 0x12, 0xDC, 0x81, 0xFB, 0xE4, 0xFD, 0xFF, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x71, 0x05, 0x13, -+0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x71, 0x05, 0x31, 0xA5, -+0xFB, 0x0D, 0xE4, 0xFF, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x71, 0x05, 0xC4, 0x54, 0x03, 0xFB, 0x0D, -+0xE4, 0xFF, 0x51, 0xF9, 0xF1, 0xD5, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x90, -+0x89, 0x50, 0x12, 0x04, 0x6E, 0x51, 0xF6, 0x75, 0xF0, 0x12, 0x91, 0x74, 0xC4, 0x13, 0x54, 0x01, -+0xFB, 0x0D, 0x7F, 0x01, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x91, 0x74, 0x54, 0x1F, 0x51, 0xF7, 0x12, -+0xB7, 0x70, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xF9, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x01, 0xF5, -+0x82, 0xE4, 0x34, 0x82, 0x51, 0xF4, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x02, 0xF5, 0x82, 0xE4, 0x34, -+0x82, 0x51, 0xF4, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x51, 0xF4, -+0x75, 0xF0, 0x08, 0xA4, 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, -+0xFD, 0x0F, 0x51, 0xF9, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x51, -+0xF4, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x51, 0xF4, 0x75, 0xF0, -+0x08, 0xA4, 0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x51, 0xCC, -+0xF1, 0x80, 0x30, 0xE0, 0x02, 0xF1, 0xEE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, -+0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, -+0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, -+0x83, 0xEB, 0xF0, 0x22, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x51, 0xCC, 0x90, 0x96, 0xE9, 0xE0, 0x22, -+0xFF, 0x75, 0xF0, 0x12, 0xED, 0x90, 0x89, 0x52, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0x90, 0x95, 0x2F, -+0x12, 0x86, 0x46, 0xB1, 0xBF, 0x12, 0x02, 0x06, 0x54, 0x7F, 0xFD, 0x12, 0x87, 0xA1, 0xFE, 0x54, -+0x1F, 0x90, 0x95, 0x33, 0xF0, 0xEE, 0x54, 0x80, 0x31, 0xA5, 0x90, 0x95, 0x32, 0x12, 0x87, 0x6B, -+0xFE, 0x54, 0x03, 0xFC, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0x95, 0x35, 0x12, 0x87, 0x6B, -+0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0x95, 0x34, 0xF0, 0xEE, 0x54, 0x80, 0x31, -+0xA5, 0xFF, 0x12, 0x87, 0x6C, 0xFB, 0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0x95, 0x37, -+0xF0, 0xFA, 0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEF, 0x54, 0x01, 0xC4, 0x33, -+0x33, 0x33, 0x54, 0x80, 0x71, 0x00, 0x54, 0x7F, 0x4F, 0xF0, 0x90, 0x95, 0x34, 0xE0, 0x54, 0x01, -+0xC4, 0x33, 0x33, 0x54, 0xC0, 0x71, 0x00, 0x54, 0xBF, 0x4F, 0xF0, 0xEA, 0x60, 0x02, 0x81, 0x6E, -+0x90, 0x95, 0x33, 0xE0, 0x54, 0x1F, 0x91, 0x6F, 0x54, 0xE0, 0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x71, -+0x00, 0x54, 0xFC, 0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0x71, 0x00, 0x54, 0xF3, -+0x4F, 0xF0, 0x90, 0x95, 0x32, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0x91, 0x6F, 0x54, 0xDF, -+0x4F, 0xF0, 0x90, 0x95, 0x35, 0xE0, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0x71, 0x00, 0x54, 0xCF, 0x4F, -+0x12, 0xE3, 0x52, 0xE0, 0x54, 0xFB, 0x12, 0xE3, 0x52, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, -+0x95, 0x38, 0xE0, 0x12, 0xE3, 0xBE, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0x93, 0xE7, 0xE0, 0x60, -+0x37, 0xB1, 0xBF, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x54, 0x1F, 0x12, -+0x02, 0x4C, 0x90, 0x95, 0x36, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x36, 0xE0, 0xFF, 0xC3, 0x94, 0x04, -+0x50, 0x16, 0xEF, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0xB1, 0xBF, 0x8F, 0x82, 0x8E, 0x83, 0xE4, -+0x12, 0x02, 0x5E, 0x12, 0xE3, 0x7B, 0x80, 0xE0, 0x90, 0x93, 0xE5, 0xE0, 0x54, 0x07, 0xFF, 0xBF, -+0x05, 0x0A, 0xEC, 0xB4, 0x01, 0x06, 0x90, 0x93, 0xEA, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x95, 0x36, -+0xF0, 0x90, 0x95, 0x36, 0xE0, 0xFC, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x95, 0x2F, 0x12, -+0xC1, 0x37, 0xFF, 0xED, 0x12, 0xB7, 0x70, 0xE5, 0x82, 0x2C, 0x12, 0xB9, 0x4B, 0xEF, 0xF0, 0x12, -+0xE3, 0x7B, 0xE0, 0xB4, 0x04, 0xDB, 0xAF, 0x05, 0x90, 0x8A, 0xFF, 0x12, 0x9C, 0xB4, 0x22, 0xFF, -+0x75, 0xF0, 0x12, 0xED, 0x90, 0x89, 0x51, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0x8F, 0x75, 0x8D, 0x76, -+0xEF, 0xD1, 0x00, 0xE0, 0xF5, 0x77, 0x54, 0x7F, 0xF5, 0x78, 0xE5, 0x77, 0x54, 0x80, 0xF5, 0x7A, -+0x75, 0xF0, 0x12, 0xEF, 0xF1, 0xD8, 0xF5, 0x7C, 0x75, 0xF0, 0x12, 0xEF, 0x71, 0x05, 0xC4, 0x54, -+0x03, 0xF5, 0x7D, 0xB1, 0xD0, 0x74, 0xFF, 0xF0, 0xE5, 0x78, 0x12, 0xDC, 0x5F, 0xB1, 0xDC, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0xE5, 0x77, 0x45, 0x7A, 0xFF, 0xF1, 0xE0, 0xEF, 0xF0, 0xE5, 0x75, 0xD1, -+0x93, 0xE0, 0x54, 0x03, 0xF5, 0x7B, 0x74, 0x46, 0x25, 0x75, 0x12, 0xE3, 0xCE, 0xE5, 0x7B, 0xF0, -+0xE5, 0x78, 0x65, 0x7C, 0x70, 0x4D, 0x75, 0xF0, 0x12, 0xE5, 0x75, 0x91, 0x74, 0xC4, 0x13, 0x54, -+0x07, 0x30, 0xE0, 0x0C, 0xE5, 0x7A, 0x70, 0x08, 0xE5, 0x78, 0x44, 0x80, 0xF5, 0x77, 0xA1, 0x92, -+0xE5, 0x78, 0x12, 0xDC, 0x5F, 0xB1, 0xDC, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xB1, 0xE3, 0xE0, 0xFF, -+0xA3, 0xE0, 0x90, 0x95, 0xC4, 0xCF, 0xB1, 0xC5, 0xE5, 0x75, 0xF0, 0xE4, 0x90, 0x95, 0xC6, 0x12, -+0xA3, 0x77, 0x7B, 0x01, 0xFA, 0x7D, 0x02, 0x7F, 0x04, 0x12, 0xD4, 0x4F, 0x7D, 0x07, 0xAF, 0x75, -+0x02, 0xD4, 0xFD, 0xE5, 0x78, 0xC3, 0x95, 0x7C, 0x50, 0x61, 0xAB, 0x75, 0xAD, 0x7C, 0xAF, 0x78, -+0x12, 0x72, 0x7F, 0x8F, 0x79, 0x85, 0x79, 0x77, 0x75, 0xF0, 0x12, 0xE5, 0x75, 0x91, 0x74, 0xC4, -+0x13, 0x54, 0x01, 0xFF, 0x90, 0x95, 0xC6, 0xE4, 0xB1, 0xC5, 0xE5, 0x79, 0xF0, 0xA3, 0xE4, 0xF0, -+0xA3, 0xE5, 0x78, 0xF0, 0xE5, 0x7A, 0x31, 0xA5, 0x12, 0xDC, 0xC4, 0xE4, 0xFB, 0xFA, 0x12, 0xD4, -+0xB8, 0xE5, 0x78, 0xC3, 0x94, 0x0C, 0x40, 0x2A, 0x75, 0xF0, 0x12, 0xE5, 0x75, 0x91, 0x74, 0xC4, -+0x13, 0x54, 0x07, 0x30, 0xE0, 0x1C, 0xE5, 0x76, 0x60, 0x18, 0xE5, 0x7A, 0x70, 0x14, 0xE5, 0x78, -+0x44, 0x80, 0xF5, 0x77, 0xB1, 0xD0, 0xE5, 0x79, 0xF0, 0x80, 0x07, 0xF1, 0xE0, 0xE5, 0x7C, 0xF0, -+0xF5, 0x77, 0xB1, 0xC9, 0xE5, 0x77, 0xF0, 0xB1, 0xD0, 0xE0, 0xFF, 0x12, 0xDD, 0x19, 0xEF, 0xF0, -+0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x7B, 0x12, 0xE3, 0x9C, 0x7B, 0x01, 0x7A, 0x00, 0x12, 0xD4, 0xB8, -+0x90, 0x92, 0x80, 0xE5, 0x7B, 0xF0, 0xAB, 0x76, 0xAD, 0x77, 0xAF, 0x75, 0x02, 0x75, 0x80, 0x90, -+0x95, 0x2F, 0x02, 0x86, 0x3D, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0xC2, 0xE4, 0xF0, 0xA3, 0x22, -+0x74, 0x77, 0x25, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0xE4, 0x93, 0xFE, 0x74, -+0x01, 0x93, 0xFF, 0xE5, 0x75, 0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, -+0x22, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x61, -+0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0x8D, 0x61, 0xEF, -+0x30, 0xE6, 0x1A, 0xB1, 0xFE, 0xD1, 0x8F, 0xE0, 0x54, 0x03, 0x90, 0x92, 0x80, 0xF0, 0xE4, 0xFB, -+0xAF, 0x61, 0x12, 0x75, 0x80, 0xB1, 0xF1, 0xD1, 0x88, 0x74, 0x01, 0x80, 0x52, 0xF1, 0x74, 0xE0, -+0x04, 0xF0, 0xF1, 0x74, 0xE0, 0x64, 0x02, 0x70, 0x1E, 0x74, 0x77, 0x25, 0x61, 0xB1, 0xD4, 0xE0, -+0xFD, 0xF4, 0x60, 0x02, 0x80, 0x04, 0xB1, 0xFE, 0xE0, 0xFD, 0xD1, 0x91, 0x12, 0xE2, 0xF3, 0xB1, -+0xFE, 0xD1, 0x88, 0x74, 0x02, 0x80, 0x28, 0xF1, 0x74, 0xE0, 0xD3, 0x94, 0x03, 0x40, 0x13, 0x90, -+0x8A, 0xB3, 0x12, 0x90, 0x40, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0xB1, 0xF1, 0xD1, 0x88, 0x74, 0x03, -+0x80, 0x0D, 0xB1, 0xFE, 0xD1, 0x8F, 0x12, 0xE2, 0xF3, 0xB1, 0xFE, 0xD1, 0x88, 0x74, 0x02, 0xF0, -+0xAB, 0x61, 0xE4, 0xFD, 0xFF, 0x02, 0x6F, 0x75, 0xE0, 0x90, 0x92, 0x5E, 0xF0, 0xA3, 0x22, 0xE0, -+0xFD, 0xE5, 0x61, 0xC4, 0x54, 0xF0, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, -+0x7D, 0x01, 0xAF, 0x67, 0xAC, 0x05, 0x90, 0x95, 0xBC, 0xEF, 0xF0, 0xFD, 0xE0, 0xFF, 0xD1, 0x00, -+0xE0, 0xF5, 0x75, 0x54, 0x7F, 0xF5, 0x77, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x50, 0x12, 0x04, -+0x6E, 0xE0, 0xF9, 0x90, 0x95, 0xBC, 0xE0, 0xF1, 0xD5, 0xFE, 0xEF, 0xD1, 0x93, 0xE0, 0x54, 0x03, -+0xF5, 0x76, 0xE5, 0x77, 0x90, 0x81, 0x9D, 0x93, 0xFB, 0xED, 0xB1, 0xE5, 0xE4, 0xF0, 0xA3, 0xEB, -+0xF0, 0x71, 0x01, 0xC4, 0x54, 0x03, 0x90, 0x95, 0xBD, 0xF0, 0x74, 0xC6, 0x2D, 0xF1, 0xE4, 0xE5, -+0x77, 0xF0, 0x74, 0x46, 0x2D, 0x12, 0xE3, 0xCE, 0xE5, 0x76, 0xF0, 0xE5, 0x77, 0xD3, 0x9E, 0x40, -+0x06, 0x8E, 0x77, 0xAF, 0x06, 0x8F, 0x75, 0x8C, 0x78, 0xE4, 0xFF, 0xEF, 0xC3, 0x95, 0x78, 0x50, -+0x30, 0xE5, 0x75, 0x30, 0xE7, 0x09, 0x85, 0x77, 0x75, 0x1C, 0xEC, 0x70, 0x21, 0x80, 0x22, 0xE5, -+0x77, 0xD3, 0x99, 0x40, 0x15, 0xAD, 0x01, 0x90, 0x95, 0xBC, 0xE0, 0xFB, 0x90, 0x95, 0xC1, 0xEC, -+0xF0, 0xAF, 0x77, 0x12, 0xB5, 0x93, 0x8F, 0x75, 0x80, 0x07, 0x89, 0x75, 0x80, 0x03, 0x0F, 0x80, -+0xCA, 0x90, 0x95, 0xBC, 0xE0, 0xFF, 0xB1, 0xC9, 0xEF, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x75, -+0x12, 0xE3, 0x9C, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0xFA, 0x7D, 0x05, 0x7F, 0x08, 0x12, -+0xD4, 0x4F, 0x90, 0x95, 0xBC, 0xE0, 0xFF, 0x90, 0x92, 0x80, 0xE5, 0x76, 0xF0, 0xE4, 0xFB, 0xAD, -+0x75, 0x02, 0x75, 0x80, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, -+0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -+0xF3, 0xEF, 0xF0, 0xF1, 0x80, 0x30, 0xE6, 0x38, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, 0x01, -+0x70, 0x2E, 0x90, 0x96, 0xF4, 0xF0, 0x90, 0x96, 0xF4, 0xE0, 0xFD, 0x90, 0x96, 0xF3, 0xE0, 0xD1, -+0x00, 0xE5, 0x82, 0x2D, 0x12, 0xB9, 0x4B, 0xE0, 0xFB, 0xE4, 0xFF, 0x51, 0xCC, 0x90, 0x96, 0xF4, -+0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xDD, 0xF1, 0x80, 0x30, 0xE0, 0x02, 0xF1, 0xEE, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x4F, 0x12, 0x04, 0x6E, 0xE0, 0x22, -+0x74, 0xC6, 0x25, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x21, 0xAC, 0xE4, 0xFD, -+0x7F, 0x8D, 0x02, 0x7B, 0x2E, 0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, 0xF0, 0x60, 0x34, 0xA3, 0xE0, -+0x20, 0xE0, 0x2F, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, -+0x11, 0x33, 0x30, 0xE0, 0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x14, 0x90, 0x88, -+0x9B, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, 0x7F, 0x09, 0x12, -+0x71, 0x9A, 0x22, 0x90, 0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x31, 0x4A, 0x90, 0x96, 0xC7, 0x12, 0x04, 0x31, 0x90, 0x96, 0xC7, 0x51, 0x7D, 0x90, -+0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, -+0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0xA5, 0xF2, 0x30, 0xE0, -+0x05, 0x7F, 0x03, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xB8, 0xE0, 0x20, 0xE0, 0x33, 0x11, 0x33, 0x30, -+0xE0, 0x2E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0x96, 0xC5, 0xF0, 0x80, 0x06, 0x90, -+0x96, 0xC5, 0x74, 0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x96, 0xC6, 0x30, 0xE0, 0x05, -+0x74, 0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0x96, 0xC5, 0x11, 0xB7, 0x12, 0x9B, 0xF9, -+0x31, 0x57, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, 0xF3, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x4A, 0x90, 0x96, 0xCD, 0x12, 0x04, 0x31, 0x90, -+0x96, 0xCD, 0x51, 0x7D, 0x12, 0x88, 0xCD, 0x91, 0x68, 0x31, 0x5F, 0x90, 0x01, 0x00, 0x74, 0x3F, -+0xF0, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0x90, 0x01, 0x01, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, -+0x53, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0xA5, 0xF2, 0x30, 0xE0, 0x05, 0x7F, 0x01, -+0x12, 0x71, 0x9A, 0x11, 0x33, 0x30, 0xE0, 0x35, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x90, 0x96, -+0xCB, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x96, 0xCB, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, -+0x30, 0xE0, 0x07, 0xE4, 0x90, 0x96, 0xCC, 0xF0, 0x80, 0x06, 0x90, 0x96, 0xCC, 0x74, 0x02, 0xF0, -+0x90, 0x96, 0xCB, 0x11, 0xB7, 0x12, 0x9B, 0xF9, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x90, 0x88, 0x9A, -+0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, -+0x70, 0xED, 0x44, 0x80, 0xFD, 0xEC, 0x22, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, -+0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE4, 0x90, 0x95, 0x8C, 0xF0, 0xF1, 0xAA, 0x7F, 0x08, 0x12, 0x7B, -+0x41, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0xE4, 0xFF, 0x91, 0x0B, 0x90, 0x93, -+0x3F, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x65, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x02, 0x31, -+0x5F, 0xE4, 0x90, 0x95, 0x8D, 0xF0, 0x90, 0x95, 0x8D, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2C, -+0x51, 0xCC, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x42, 0xE0, -+0xFD, 0xEF, 0x5D, 0x60, 0x0F, 0x90, 0x95, 0x8D, 0x91, 0x89, 0x90, 0x95, 0x8D, 0x91, 0xA9, 0x44, -+0x40, 0xF0, 0x91, 0x61, 0x90, 0x95, 0x8D, 0xE0, 0x04, 0xF0, 0x80, 0xCA, 0x90, 0x07, 0xC7, 0xE4, -+0xF0, 0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, 0x77, 0xF0, 0x90, 0x07, 0xC4, 0xE4, 0xF0, -+0x90, 0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xF1, 0x4F, 0x90, 0x02, 0x26, 0xE0, -+0x44, 0x01, 0xF0, 0xE0, 0x90, 0x95, 0x8E, 0xF0, 0x90, 0x95, 0x8E, 0xE0, 0x30, 0xE0, 0x18, 0x90, -+0x95, 0x8C, 0xE0, 0x04, 0xF1, 0x3F, 0x90, 0x02, 0x26, 0xE0, 0x90, 0x95, 0x8E, 0xF0, 0x90, 0x95, -+0x8C, 0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xE1, 0x90, 0x02, 0x03, 0x74, 0x80, 0xF0, 0x90, 0x04, 0x24, -+0xE0, 0x90, 0x95, 0x8F, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x02, 0x00, 0xE0, -+0x90, 0x95, 0x8E, 0xF0, 0x90, 0x02, 0x01, 0x51, 0x74, 0x90, 0x02, 0x02, 0x51, 0x74, 0x90, 0x02, -+0x14, 0x51, 0x74, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x54, -+0xEF, 0xF0, 0x90, 0x95, 0x8F, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, 0xFF, 0xF0, -+0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x91, 0x71, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x32, 0xE0, -+0x54, 0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x95, 0x8E, 0xE0, 0x2F, 0xF0, 0x22, 0x12, 0x04, 0xB8, -+0x90, 0x92, 0x18, 0x12, 0x04, 0x31, 0x7F, 0x30, 0x7E, 0x08, 0x02, 0x70, 0xAD, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x51, 0xD4, 0x31, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x39, -+0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, 0xB1, 0x38, 0xBF, 0x01, 0x08, 0x51, 0x8D, 0x90, 0x01, -+0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, -+0x8D, 0xF5, 0x83, 0xE0, 0xFD, 0x7C, 0x00, 0xE5, 0x67, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, -+0xA8, 0x07, 0x08, 0x22, 0x75, 0x66, 0x14, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x10, 0xF0, 0x91, 0x71, -+0x7D, 0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x41, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, -+0x88, 0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, -+0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x93, 0x3F, 0xE0, 0x30, 0xE0, 0x70, 0x90, 0xFD, -+0x09, 0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, 0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, -+0x95, 0x8C, 0xF0, 0x90, 0x95, 0x8C, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2C, 0x51, 0xCC, 0x80, -+0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x41, 0xE0, 0xFD, 0xEF, 0x5D, -+0x60, 0x0F, 0x90, 0x95, 0x8C, 0x91, 0x89, 0x90, 0x95, 0x8C, 0x91, 0xA9, 0x44, 0x20, 0xF0, 0x91, -+0x61, 0x90, 0x95, 0x8C, 0xE0, 0x04, 0xF0, 0x80, 0xCA, 0x7F, 0x92, 0x91, 0x6A, 0xFD, 0x7F, 0x92, -+0x12, 0x7B, 0x2E, 0x7F, 0x92, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x08, 0xFD, 0x7F, 0x92, 0x12, 0x7B, -+0x2E, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFD, 0xFD, 0x7F, 0x02, 0x80, 0x06, 0x7F, 0x92, -+0xF1, 0x47, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x10, 0xFD, -+0x7F, 0x08, 0x12, 0x7B, 0x2E, 0x7F, 0x01, 0x91, 0x0B, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xF0, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, 0x96, 0xEC, 0xEF, 0xF0, -+0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, -+0x90, 0x96, 0xEC, 0xE0, 0x6F, 0x60, 0x32, 0xC3, 0x90, 0x96, 0xEE, 0xE0, 0x94, 0x88, 0x90, 0x96, -+0xED, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x96, -+0xED, 0x91, 0x5A, 0xD3, 0x90, 0x96, 0xEE, 0xE0, 0x94, 0x32, 0x90, 0x96, 0xED, 0xE0, 0x94, 0x00, -+0x40, 0xC3, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xBC, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x02, -+0xE7, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFE, -+0x22, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x90, 0x88, 0xE0, 0xE0, 0xFB, -+0x90, 0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x4D, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x52, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB1, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x43, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB2, 0xF0, 0x74, 0x48, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB3, 0xF0, 0xE0, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, -+0x18, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x0E, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xF1, 0x63, -+0xBF, 0x01, 0x06, 0x80, 0x02, 0x80, 0x00, 0x51, 0x9D, 0x22, 0xE4, 0x90, 0x95, 0x2F, 0xF0, 0xA3, -+0xF0, 0xF1, 0x57, 0xEF, 0x64, 0x01, 0x60, 0x39, 0xC3, 0x90, 0x95, 0x30, 0xE0, 0x94, 0x88, 0x90, -+0x95, 0x2F, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, -+0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1B, 0x90, 0x95, 0x2F, 0x91, 0x5A, 0xD3, 0x90, 0x95, 0x30, 0xE0, -+0x94, 0x32, 0x90, 0x95, 0x2F, 0xE0, 0x94, 0x00, 0x40, 0xC7, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, -+0xC0, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0x90, 0x93, 0x3B, 0xE0, 0xC3, 0x13, 0x20, 0xE0, -+0x35, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, -+0x05, 0x75, 0x66, 0x01, 0x80, 0x2E, 0x90, 0x02, 0x96, 0xE0, 0x60, 0x05, 0x75, 0x66, 0x10, 0x80, -+0x23, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, -+0x05, 0x75, 0x66, 0x04, 0x80, 0x0E, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x66, 0x20, -+0x80, 0x02, 0xE1, 0x37, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x66, 0xF0, -+0x7F, 0x00, 0x22, 0xE4, 0xF5, 0x7A, 0xEF, 0x14, 0xF5, 0x79, 0xED, 0xFF, 0xE5, 0x79, 0xF5, 0x82, -+0x33, 0x95, 0xE0, 0xF5, 0x83, 0xC3, 0xE5, 0x82, 0x9F, 0x74, 0x80, 0xF8, 0x65, 0x83, 0x98, 0x40, -+0x50, 0xE5, 0x79, 0x78, 0x03, 0xA2, 0xE7, 0x13, 0xD8, 0xFB, 0xFF, 0x33, 0x95, 0xE0, 0xFE, 0xEB, -+0xF1, 0x70, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE5, 0x83, 0x3E, 0xF5, 0x83, 0xE0, 0xF5, 0x82, 0x75, -+0x83, 0x00, 0xE5, 0x79, 0x51, 0xC9, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -+0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x60, 0x13, 0x85, 0x79, 0x7B, 0x05, 0x7A, 0x90, -+0x95, 0xC1, 0xE0, 0x65, 0x7A, 0x60, 0x0A, 0xE5, 0x7B, 0xD3, 0x9D, 0x40, 0x04, 0x15, 0x79, 0x80, -+0x99, 0xAF, 0x7B, 0x22, 0xE4, 0x90, 0x95, 0xEE, 0xF0, 0xF1, 0x7E, 0xD1, 0xBB, 0xF1, 0x0A, 0xD1, -+0xD6, 0x90, 0x07, 0xE3, 0x12, 0xA7, 0xE6, 0x60, 0x59, 0xE4, 0x90, 0x95, 0xEF, 0xF0, 0x90, 0x96, -+0x11, 0x74, 0x08, 0xF0, 0x90, 0x05, 0x68, 0xE0, 0x90, 0x95, 0xF1, 0xF0, 0x90, 0x05, 0x69, 0xE0, -+0x90, 0x95, 0xF2, 0xF0, 0x90, 0x05, 0x6A, 0xE0, 0x90, 0x95, 0xF3, 0xF0, 0x90, 0x05, 0x6B, 0xE0, -+0x90, 0x95, 0xF4, 0xF0, 0x90, 0x05, 0x78, 0xE0, 0x90, 0x95, 0xF5, 0xF0, 0x90, 0x05, 0x79, 0xE0, -+0x90, 0x95, 0xF6, 0xF0, 0x90, 0x05, 0x7A, 0xE0, 0x90, 0x95, 0xF7, 0xF0, 0x90, 0x05, 0x7B, 0xE0, -+0x90, 0x95, 0xF8, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xEF, 0x12, 0x90, 0x2E, 0x7F, 0x04, 0x12, -+0x04, 0x7E, 0x90, 0x95, 0xED, 0xE0, 0xFD, 0x60, 0x41, 0xA3, 0xE0, 0x51, 0xCB, 0x80, 0x05, 0xC3, -+0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x60, 0xE7, 0x90, 0x95, 0xEE, 0xE0, 0xFB, -+0x74, 0x01, 0xA8, 0x03, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFE, 0xF4, 0xFD, 0x90, 0x95, -+0xED, 0xE0, 0x5D, 0xF0, 0x90, 0x07, 0xE3, 0xE0, 0x4E, 0xF0, 0xAF, 0x03, 0x12, 0xBF, 0xFD, 0x12, -+0xBE, 0x94, 0x90, 0x95, 0xEE, 0xE0, 0x04, 0xF0, 0x80, 0xB8, 0x22, 0xE4, 0xFF, 0x74, 0x80, 0xD1, -+0xFF, 0x74, 0x2D, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xD1, 0xCF, 0xB4, 0x08, 0xEF, 0x22, 0xF5, -+0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0x22, 0xE4, 0xFF, 0x74, 0x94, 0xD1, 0xFF, 0x74, 0x13, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x93, 0xD1, 0xCF, 0xB4, 0x08, 0xEF, 0xE4, 0xFF, 0x74, 0x9C, 0xD1, 0xFF, 0x74, -+0x1C, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xD1, 0xCF, 0xB4, 0x04, 0xEF, 0x22, 0x74, 0x90, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x24, 0xF5, 0x83, 0xE0, 0xFE, 0x22, 0xE4, 0xFF, 0x74, 0x88, 0xD1, 0xFF, -+0x74, 0x06, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xD1, 0xCF, 0xB4, 0x08, 0xEF, 0x90, 0x05, 0xDC, -+0xE0, 0x90, 0x93, 0x0E, 0xF0, 0xE4, 0xFF, 0xD1, 0xFD, 0x74, 0x0F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x93, 0xD1, 0xCF, 0xB4, 0x04, 0xF1, 0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0xF0, -+0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, 0x22, 0x74, -+0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, -+0x7F, 0x01, 0x22, 0x90, 0x88, 0x2F, 0xE0, 0x64, 0x02, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, -+0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0x90, 0x24, -+0xA0, 0xE0, 0x90, 0x93, 0x03, 0x30, 0xE7, 0x05, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0xE0, 0x54, 0xFD, -+0xF0, 0x22, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, 0xF1, 0x3F, 0x90, 0x01, 0x98, 0xE0, -+0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC4, 0x74, 0xAA, 0xF0, -+0x74, 0xB7, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0xAA, 0x04, -+0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB7, 0xA3, 0xF0, 0x22, 0x90, 0x93, 0x3F, 0xE0, 0x20, 0xE0, 0x03, -+0x02, 0xB8, 0x9C, 0xE4, 0x90, 0x95, 0x33, 0xF0, 0x90, 0x95, 0x33, 0xE0, 0xFF, 0xC3, 0x94, 0x05, -+0x40, 0x03, 0x02, 0xB8, 0x9C, 0x51, 0xCC, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xFF, 0x90, 0x93, 0x40, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x03, 0x02, 0xB8, 0x93, 0x12, 0x02, 0x06, -+0xFF, 0x30, 0xE0, 0x1A, 0x90, 0x93, 0x41, 0xE0, 0xFE, 0x90, 0x95, 0x33, 0xE0, 0xFD, 0x74, 0x01, -+0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, 0x41, 0xF0, 0xEF, 0xC3, -+0x13, 0x30, 0xE0, 0x1A, 0x90, 0x93, 0x42, 0xE0, 0xFF, 0x90, 0x95, 0x33, 0xE0, 0xFE, 0x74, 0x01, -+0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x42, 0xF0, 0x12, 0x87, -+0xA1, 0xFF, 0x90, 0x95, 0x33, 0xE0, 0xFE, 0x24, 0x43, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0xEF, 0x12, 0x87, 0x6B, 0xFF, 0x74, 0x48, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, -+0x11, 0x9D, 0x74, 0x4D, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0x87, 0x98, -+0xFF, 0x74, 0x52, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x40, -+0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, -+0x40, 0xF0, 0x22, 0x90, 0x95, 0x33, 0xE0, 0x04, 0xF0, 0x02, 0xB7, 0xD8, 0x22, 0xF0, 0x90, 0x00, -+0x03, 0x12, 0x02, 0x1F, 0xFF, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0xE0, 0xF0, 0xBF, 0x01, -+0x0A, 0x7F, 0x01, 0x12, 0x90, 0x49, 0xE4, 0x90, 0x93, 0xE0, 0xF0, 0x22, 0xE4, 0xFD, 0x02, 0x8F, -+0xE7, 0x90, 0x95, 0xED, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x96, 0x11, -+0xF0, 0xE0, 0xFE, 0x6F, 0x60, 0x70, 0x90, 0x95, 0xEE, 0x74, 0x03, 0xF0, 0x90, 0x96, 0x10, 0x74, -+0x08, 0xF0, 0xEE, 0x04, 0x54, 0x0F, 0xFF, 0xE4, 0xFE, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, -+0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2E, 0x31, 0x4B, 0xE0, 0xFD, 0x74, 0xF0, -+0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x08, 0xDA, 0x7B, -+0x01, 0x7A, 0x95, 0x79, 0xEE, 0x31, 0x53, 0x12, 0x04, 0x7E, 0x90, 0x96, 0x11, 0xE0, 0x04, 0x54, -+0x0F, 0xFF, 0xF0, 0xBF, 0x0F, 0x02, 0xE4, 0xF0, 0x90, 0x96, 0x11, 0xE0, 0x90, 0x04, 0x7F, 0xF0, -+0x90, 0x95, 0xED, 0xE0, 0x70, 0x05, 0x90, 0x8A, 0xE5, 0x80, 0x03, 0x90, 0x8A, 0x79, 0x12, 0x90, -+0x40, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xE4, 0xFF, 0x01, 0xC1, 0xF5, 0x82, 0xE4, 0x35, 0x83, -+0xF5, 0x83, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x27, -+0x90, 0x96, 0x52, 0x74, 0x1E, 0xF0, 0x90, 0x96, 0x74, 0x74, 0x01, 0xF0, 0x90, 0x96, 0x54, 0xEF, -+0xF0, 0x7B, 0x01, 0x7A, 0x96, 0x79, 0x52, 0x31, 0x53, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, -+0x90, 0x40, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x2C, 0xE0, -+0x30, 0xE0, 0x10, 0xA3, 0x74, 0x01, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, -+0x02, 0x31, 0xC2, 0x12, 0xA5, 0x47, 0xE4, 0xFF, 0x31, 0x60, 0x90, 0x8B, 0x07, 0xB1, 0x11, 0x02, -+0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xA7, 0x8F, 0xBF, 0x01, 0x04, 0x7F, -+0x01, 0x80, 0x02, 0x7F, 0x02, 0x31, 0xDC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x2F, 0xE0, 0x90, 0x96, 0xFE, 0xF0, 0x6F, 0x70, 0x02, 0x41, 0xE6, -+0xEF, 0x14, 0x60, 0x42, 0x14, 0x60, 0x70, 0x14, 0x70, 0x02, 0x41, 0x92, 0x14, 0x70, 0x02, 0x41, -+0xBD, 0x24, 0x04, 0x60, 0x02, 0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x04, 0x04, 0x71, 0x3A, -+0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x02, 0x04, 0x71, 0x4A, 0x41, 0xE6, 0x90, 0x96, 0xFE, -+0xE0, 0xB4, 0x03, 0x04, 0x71, 0x4F, 0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0x64, 0x01, 0x60, 0x02, -+0x41, 0xE6, 0x71, 0x3D, 0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x04, 0x05, 0x12, 0x97, 0xAE, -+0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x02, 0x05, 0x12, 0x97, 0xB9, 0x41, 0xE6, 0x90, 0x96, -+0xFE, 0xE0, 0xB4, 0x03, 0x05, 0x12, 0x97, 0xA0, 0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0x60, 0x02, -+0x41, 0xE6, 0x12, 0x97, 0xF4, 0x80, 0x7F, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x04, 0x04, 0x71, 0x11, -+0x80, 0x74, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x01, 0x04, 0x51, 0xFD, 0x80, 0x69, 0x90, 0x96, 0xFE, -+0xE0, 0xB4, 0x03, 0x04, 0x71, 0x5C, 0x80, 0x5E, 0x90, 0x96, 0xFE, 0xE0, 0x70, 0x58, 0x51, 0xFA, -+0x80, 0x54, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x04, 0x04, 0x71, 0x8B, 0x80, 0x49, 0x90, 0x96, 0xFE, -+0xE0, 0xB4, 0x01, 0x04, 0x71, 0x26, 0x80, 0x3E, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x02, 0x04, 0x71, -+0x54, 0x80, 0x33, 0x90, 0x96, 0xFE, 0xE0, 0x70, 0x2D, 0x71, 0x23, 0x80, 0x29, 0x90, 0x96, 0xFE, -+0xE0, 0xB4, 0x03, 0x04, 0x71, 0x6D, 0x80, 0x1E, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x01, 0x04, 0x51, -+0xEE, 0x80, 0x13, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x02, 0x04, 0x71, 0x9D, 0x80, 0x08, 0x90, 0x96, -+0xFE, 0xE0, 0x70, 0x02, 0x51, 0xEB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x97, 0xF4, 0x90, 0x8A, -+0xF9, 0x12, 0x90, 0x40, 0x7D, 0x1F, 0x71, 0x79, 0xF0, 0x22, 0x12, 0x97, 0xF4, 0x90, 0x8A, 0xF9, -+0x12, 0x90, 0x40, 0x7D, 0x20, 0x71, 0x64, 0x12, 0x88, 0xD0, 0x90, 0x88, 0x2F, 0x74, 0x02, 0xF0, -+0x22, 0x12, 0x97, 0xF6, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x23, 0x71, 0x64, 0x12, 0x88, -+0xD0, 0x80, 0xE7, 0x12, 0x97, 0xF4, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x21, 0x7F, 0xFF, -+0x12, 0x04, 0x7E, 0x90, 0x88, 0x2F, 0x74, 0x03, 0xF0, 0x22, 0x12, 0x97, 0xAE, 0x90, 0x05, 0x27, -+0xE0, 0x54, 0xBF, 0xF0, 0xE4, 0x90, 0x88, 0x2F, 0xF0, 0x22, 0x12, 0x97, 0xB9, 0x80, 0xEE, 0x12, -+0x97, 0xA0, 0x80, 0xE9, 0x90, 0x86, 0x0C, 0x12, 0x88, 0xD0, 0x80, 0xD7, 0x90, 0x8A, 0xEF, 0x12, -+0x88, 0xD0, 0x80, 0xA6, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x22, 0x90, 0x8A, 0xF9, -+0x12, 0x90, 0x40, 0x7D, 0x25, 0x71, 0x79, 0xF0, 0x22, 0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x90, 0x05, -+0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0x88, 0x2F, 0x74, 0x04, 0x22, 0x90, 0x8A, 0xF9, 0x12, 0x90, -+0x40, 0x7D, 0x22, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x12, 0x97, 0xF6, 0x80, 0x96, 0x90, 0x86, 0x0C, -+0x12, 0x88, 0xD0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x24, 0x71, 0x79, 0xF0, 0x22, 0x90, -+0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x4A, 0x90, 0x88, 0x30, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, -+0x7E, 0x01, 0x90, 0x88, 0x2F, 0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, -+0x30, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x21, 0xC2, 0x91, 0x02, 0x90, 0x88, 0x30, 0xE0, 0xB4, -+0x0C, 0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0x7F, 0x08, 0x80, 0x10, 0x90, 0x88, -+0x30, 0xE0, 0xB4, 0x04, 0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0xFF, 0x12, 0x04, -+0x7E, 0x22, 0x90, 0x01, 0x57, 0xE0, 0x60, 0x20, 0x12, 0xD0, 0x16, 0xF0, 0x90, 0x88, 0x31, 0x12, -+0x9F, 0xE7, 0x30, 0xE0, 0x03, 0x02, 0xD0, 0x3D, 0x12, 0xE2, 0x5C, 0x40, 0x0B, 0xE4, 0xFF, 0x12, -+0x78, 0x4A, 0xBF, 0x01, 0x03, 0x12, 0x9F, 0xD9, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, -+0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x29, 0xF0, 0x74, 0xBC, 0xA3, 0xF0, -+0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, 0xE1, 0x03, 0x12, 0xD0, 0x84, 0xE5, 0x2D, 0x30, 0xE1, 0x02, -+0x31, 0x47, 0xE5, 0x2D, 0x30, 0xE4, 0x03, 0x12, 0xDD, 0x6D, 0xE5, 0x2D, 0x30, 0xE5, 0x03, 0x12, -+0xDD, 0x7E, 0xE5, 0x2D, 0x30, 0xE6, 0x03, 0x12, 0xC8, 0x58, 0xE5, 0x2F, 0x30, 0xE0, 0x02, 0x31, -+0x9C, 0xE5, 0x2F, 0x30, 0xE1, 0x03, 0x12, 0xC8, 0x65, 0xE5, 0x2F, 0x30, 0xE2, 0x03, 0x12, 0xCF, -+0xDF, 0xE5, 0x2F, 0x30, 0xE3, 0x03, 0x12, 0xD0, 0x02, 0xE5, 0x2F, 0x30, 0xE4, 0x03, 0x12, 0xD0, -+0x1E, 0xE5, 0x2F, 0x30, 0xE5, 0x03, 0x12, 0xD0, 0x49, 0xE5, 0x2F, 0x30, 0xE6, 0x03, 0x12, 0xD0, -+0x6B, 0xE5, 0x30, 0x30, 0xE4, 0x02, 0xF1, 0xDB, 0xE5, 0x30, 0x30, 0xE5, 0x02, 0xB1, 0x09, 0xE5, -+0x36, 0x30, 0xE0, 0x03, 0x12, 0xB6, 0x04, 0xE5, 0x36, 0x30, 0xE6, 0x02, 0xB1, 0x5B, 0xE5, 0x36, -+0x30, 0xE7, 0x02, 0xB1, 0x19, 0xE5, 0x37, 0x30, 0xE2, 0x02, 0xB1, 0x25, 0xE5, 0x37, 0x30, 0xE3, -+0x02, 0xB1, 0x31, 0x74, 0x29, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBC, 0xA3, 0xF0, 0xD0, 0x07, -+0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, -+0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x8A, 0xDF, 0xB1, 0x11, 0x02, 0x04, -+0x7A, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, -+0x7F, 0x01, 0xB1, 0x3D, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x02, 0xB1, 0x3D, -+0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0xB1, 0x3D, 0x22, 0x90, 0x95, 0xEF, -+0xEF, 0xF0, 0x90, 0x95, 0xED, 0x74, 0x18, 0xF0, 0x90, 0x96, 0x0F, 0x74, 0x01, 0xF0, 0xFB, 0x7A, -+0x95, 0x79, 0xED, 0x12, 0x90, 0x2E, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x90, 0x93, 0x03, 0xE0, 0x30, -+0xE0, 0x1E, 0xE4, 0xFF, 0xB1, 0x3D, 0xE4, 0xFF, 0xB1, 0x81, 0x7F, 0x01, 0xB1, 0x81, 0x90, 0x93, -+0x03, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, 0x04, 0x1F, 0xE0, 0x44, 0x80, 0xF0, -+0x22, 0xEF, 0x70, 0x05, 0x90, 0x93, 0x05, 0x80, 0x03, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x12, 0x7B, -+0x07, 0x90, 0x95, 0xED, 0xEF, 0xF0, 0x90, 0x95, 0xED, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, -+0xD1, 0x34, 0xE4, 0xFF, 0x74, 0x08, 0x2F, 0xF1, 0x84, 0xE0, 0xFE, 0xD1, 0x27, 0x8F, 0x82, 0x75, -+0x83, 0x00, 0xD1, 0x2D, 0xB4, 0x06, 0xED, 0x90, 0x95, 0xED, 0xE0, 0x24, 0x52, 0xF9, 0xE4, 0x34, -+0xFC, 0xD1, 0x34, 0x12, 0x02, 0x06, 0x70, 0x5E, 0xD1, 0x27, 0x12, 0x87, 0xA1, 0x64, 0x02, 0x70, -+0x55, 0x90, 0x24, 0x87, 0xE0, 0x90, 0x00, 0x03, 0x12, 0x02, 0x5E, 0x90, 0x24, 0x86, 0xE0, 0x90, -+0x00, 0x04, 0x12, 0x02, 0x5E, 0xD1, 0x27, 0x12, 0x87, 0x65, 0x64, 0x01, 0x70, 0x38, 0x12, 0x9F, -+0xEF, 0x64, 0x0D, 0x70, 0x31, 0xFF, 0x74, 0x88, 0x12, 0xB6, 0xFF, 0xEF, 0x24, 0x08, 0xD1, 0x3B, -+0xD1, 0x50, 0xD1, 0x2D, 0xB4, 0x08, 0xEF, 0x90, 0x05, 0xDC, 0xE0, 0xFF, 0xD1, 0x27, 0x90, 0x00, -+0x10, 0xEF, 0x12, 0x02, 0x5E, 0xE4, 0xFF, 0x12, 0xB6, 0xFD, 0xEF, 0x24, 0x11, 0xD1, 0x3B, 0xD1, -+0x50, 0xD1, 0x2D, 0xB4, 0x04, 0xF1, 0x22, 0x90, 0x95, 0xEE, 0x02, 0x86, 0x3D, 0xEE, 0x12, 0x02, -+0x5E, 0x0F, 0xEF, 0x22, 0xFA, 0x7B, 0x01, 0xA3, 0x02, 0x86, 0x46, 0xFD, 0xE4, 0x33, 0xFC, 0x90, -+0x95, 0xEE, 0x22, 0x7E, 0x00, 0xC3, 0x74, 0x07, 0x9F, 0xFD, 0xE4, 0x9E, 0xFC, 0x90, 0x96, 0x16, -+0x12, 0x86, 0x3D, 0x8D, 0x82, 0x8C, 0x83, 0x22, 0xF1, 0x8C, 0x90, 0x96, 0x19, 0xF0, 0x90, 0x96, -+0x19, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x29, 0xD1, 0x43, 0xF1, 0x7C, 0x12, 0xC1, 0x2F, 0xC3, -+0x9D, 0x50, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x96, 0x19, 0xE0, 0xFF, 0xD1, 0x43, 0xF1, 0x7C, 0x12, -+0xC1, 0x2F, 0xD3, 0x9D, 0x40, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x96, 0x19, 0xE0, 0x04, 0xF0, 0x80, -+0xCD, 0x7F, 0x00, 0x22, 0xE4, 0x90, 0x96, 0x12, 0xF0, 0x90, 0x93, 0x03, 0xE0, 0xFF, 0xC3, 0x13, -+0x20, 0xE0, 0x78, 0xF1, 0x62, 0xF1, 0x57, 0xD1, 0x58, 0xEF, 0x60, 0x0D, 0x7B, 0x01, 0x7A, 0x93, -+0x79, 0x13, 0xF1, 0x57, 0xF1, 0x69, 0xEF, 0x60, 0x5A, 0xF1, 0x62, 0xF1, 0x57, 0xD1, 0x58, 0xEF, -+0x60, 0x18, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x13, 0xF1, 0x57, 0xF1, 0x69, 0xEF, 0x60, 0x0B, 0x7B, -+0x01, 0x7A, 0x93, 0x79, 0x1C, 0x12, 0xE3, 0x01, 0x70, 0x39, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x20, -+0x90, 0x96, 0x16, 0x12, 0x86, 0x46, 0x7A, 0x93, 0x79, 0x06, 0xD1, 0x58, 0xEF, 0x60, 0x10, 0xF1, -+0x51, 0xD1, 0x58, 0xEF, 0x60, 0x09, 0xF1, 0x62, 0xF1, 0x57, 0xF1, 0x94, 0xEF, 0x70, 0x14, 0xF1, -+0x62, 0xF1, 0x57, 0xF1, 0x69, 0xEF, 0x60, 0x26, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x0F, 0x12, 0xE3, -+0x01, 0x60, 0x1B, 0x90, 0x96, 0x12, 0x74, 0x01, 0xF0, 0x80, 0x13, 0xF1, 0x51, 0xD1, 0x58, 0xEF, -+0x60, 0x0C, 0xF1, 0x51, 0xF1, 0x94, 0xEF, 0x70, 0x05, 0x90, 0x96, 0x12, 0x04, 0xF0, 0x90, 0x96, -+0x12, 0xE0, 0xFF, 0x90, 0x05, 0x18, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x90, 0x05, 0xB3, 0x60, 0x0C, -+0xE0, 0x44, 0x80, 0xF0, 0x90, 0x24, 0xA0, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xE0, 0x44, 0x20, 0xF0, -+0x22, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x2D, 0x90, 0x96, 0x16, 0x12, 0x86, 0x46, 0x7A, 0x93, 0x79, -+0x20, 0x22, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x06, 0x22, 0xF1, 0x8C, 0xFF, 0xF1, 0xE0, 0x6E, 0x60, -+0x03, 0x7F, 0x00, 0x22, 0x0F, 0xEF, 0xB4, 0x08, 0xF3, 0x7F, 0x01, 0x22, 0x12, 0x02, 0x1F, 0xFD, -+0xC3, 0x74, 0x07, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0x22, 0x90, 0x96, 0x13, 0x12, -+0x86, 0x46, 0xE4, 0x22, 0xF1, 0x8C, 0xFF, 0xF1, 0xE0, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, -+0xEF, 0xB4, 0x06, 0xF3, 0x7F, 0x01, 0x22, 0xF1, 0x8C, 0x90, 0x96, 0x19, 0xF0, 0x90, 0x96, 0x19, -+0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x21, 0x12, 0xC1, 0x14, 0xC3, 0x9D, 0x50, 0x03, 0x7F, 0x00, -+0x22, 0x90, 0x96, 0x19, 0xE0, 0xFF, 0x12, 0xC1, 0x14, 0xD3, 0x9D, 0x40, 0x03, 0x7F, 0x01, 0x22, -+0x90, 0x96, 0x19, 0xE0, 0x04, 0xF0, 0x80, 0xD5, 0x7F, 0x00, 0x22, 0xE4, 0xFF, 0x02, 0x35, 0xBE, -+0x90, 0x96, 0x16, 0x12, 0x86, 0x3D, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x12, 0x02, 0x1F, 0xFE, 0x90, -+0x96, 0x13, 0x12, 0x86, 0x3D, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, 0x02, 0x1F, 0xE4, 0x90, 0x96, -+0x16, 0xF0, 0xEF, 0x75, 0xF0, 0x40, 0xA4, 0x24, 0x80, 0xF9, 0x74, 0x82, 0x35, 0xF0, 0xFA, 0x7B, -+0x01, 0x90, 0x96, 0x12, 0x12, 0x86, 0x46, 0x12, 0x02, 0x06, 0x90, 0x96, 0x15, 0xF0, 0xA3, 0x74, -+0x1C, 0xF0, 0x90, 0x96, 0x15, 0xE0, 0xFF, 0xA3, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x21, 0x08, -+0x90, 0x96, 0x12, 0x12, 0x86, 0x3D, 0x8E, 0x82, 0x12, 0xBF, 0xF7, 0x90, 0x96, 0x17, 0xF0, 0xEE, -+0xFD, 0x7C, 0x00, 0xF5, 0x82, 0x8C, 0x83, 0xA3, 0xA3, 0x12, 0x02, 0x1F, 0xFE, 0x8D, 0x82, 0x8C, -+0x83, 0xA3, 0x12, 0x02, 0x1F, 0xFD, 0xED, 0xFF, 0x90, 0x96, 0x18, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0x90, 0x96, 0x17, 0xE0, 0x64, 0x01, 0x60, 0x0E, 0xA3, 0xA3, 0xE0, 0x24, 0x03, 0xFF, 0x90, 0x96, -+0x16, 0xE0, 0x2F, 0xF0, 0x80, 0xAC, 0xE4, 0x90, 0x96, 0x1A, 0xF0, 0x90, 0x96, 0x1A, 0xE0, 0xFF, -+0xC3, 0x94, 0x08, 0x50, 0x1A, 0x90, 0x96, 0x16, 0xE0, 0x24, 0x03, 0x31, 0x41, 0x31, 0x37, 0xFF, -+0x90, 0x96, 0x1A, 0xE0, 0x24, 0x20, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x31, 0x09, 0x80, 0xDC, 0x90, -+0x96, 0x16, 0xE0, 0x24, 0x0B, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x96, 0x12, 0x31, 0x37, 0x90, 0x93, -+0x28, 0xF0, 0x70, 0x2B, 0x90, 0x96, 0x1A, 0xF0, 0x90, 0x96, 0x1A, 0xE0, 0xFF, 0x24, 0x10, 0xFD, -+0xE4, 0x33, 0xFC, 0x90, 0x96, 0x12, 0x12, 0xBE, 0x50, 0x12, 0x02, 0x1F, 0xFE, 0x74, 0x29, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEE, 0x31, 0x0C, 0xE0, 0xB4, 0x04, 0xDA, 0x22, 0xE4, -+0x90, 0x96, 0x1A, 0xF0, 0x90, 0x96, 0x1A, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x1A, 0x90, 0x96, -+0x16, 0xE0, 0x24, 0x0C, 0x31, 0x41, 0x31, 0x37, 0xFF, 0x90, 0x96, 0x1A, 0xE0, 0x24, 0x29, 0xF5, -+0x82, 0xE4, 0x34, 0x93, 0x31, 0x09, 0x80, 0xDC, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x96, 0x1A, -+0xE0, 0x04, 0xF0, 0x22, 0x7E, 0x00, 0xC3, 0x74, 0x03, 0x9F, 0xFD, 0xE4, 0x9E, 0xFC, 0x90, 0x96, -+0x16, 0x12, 0x86, 0x3D, 0x8D, 0x82, 0x8C, 0x83, 0x12, 0x02, 0x1F, 0xFD, 0xC3, 0x74, 0x03, 0x9F, -+0xFF, 0xE4, 0x9E, 0xFE, 0x90, 0x96, 0x13, 0x12, 0x86, 0x3D, 0x8F, 0x82, 0x8E, 0x83, 0x02, 0x02, -+0x1F, 0xFD, 0xE4, 0x33, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0x90, 0x96, 0x12, -+0x22, 0xE4, 0x90, 0x86, 0xAF, 0x12, 0xA3, 0x77, 0x90, 0x93, 0x01, 0xF0, 0x22, 0x90, 0x00, 0x80, -+0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x91, 0x43, 0x71, 0x75, 0x12, 0x7B, 0x79, -+0x71, 0xBD, 0x31, 0x51, 0x7F, 0x01, 0x12, 0x84, 0x15, 0x90, 0x93, 0x57, 0x74, 0x02, 0xF0, 0xFF, -+0x12, 0x84, 0x15, 0x90, 0x93, 0x57, 0xE0, 0x04, 0xF0, 0x51, 0x61, 0x51, 0xAB, 0x90, 0x00, 0x80, -+0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, -+0x01, 0xA0, 0xE0, 0xB4, 0xFD, 0x05, 0xE4, 0xFF, 0x12, 0x90, 0x49, 0x12, 0xB4, 0xEA, 0x90, 0x00, -+0x81, 0xE0, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x12, 0x7B, 0x2E, 0x71, 0x61, 0x31, 0xCF, 0x90, 0x00, -+0xAA, 0xE0, 0x44, 0x02, 0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, 0xE4, 0xFF, 0x02, 0x84, 0x9E, 0x7E, -+0x00, 0x7F, 0x0B, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xE1, 0x12, 0x04, 0x80, 0x51, 0x5A, -+0x71, 0x5A, 0xBF, 0x01, 0x1C, 0x90, 0x95, 0x2F, 0xE0, 0xFE, 0x54, 0x01, 0x90, 0x93, 0xE1, 0xF0, -+0xEE, 0x54, 0x04, 0x90, 0x93, 0xE3, 0xF0, 0x90, 0x95, 0x2F, 0xE0, 0x54, 0x08, 0x90, 0x93, 0xE2, -+0xF0, 0x51, 0x5A, 0x7F, 0xFB, 0x12, 0x97, 0x97, 0x70, 0x35, 0x90, 0x95, 0x2F, 0xE0, 0x54, 0x07, -+0x70, 0x15, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x30, 0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -+0x01, 0x0F, 0x90, 0x95, 0x30, 0x80, 0x03, 0x90, 0x95, 0x2F, 0xE0, 0x54, 0x07, 0x90, 0x93, 0xE5, -+0xF0, 0x90, 0x95, 0x2F, 0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, 0xE4, 0xF0, 0x51, -+0x5A, 0x7F, 0xFD, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x95, 0x2F, 0xE0, 0x54, -+0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x93, 0xE6, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x2F, -+0x22, 0x12, 0x7B, 0x1B, 0x90, 0x86, 0xB3, 0xEF, 0xF0, 0x51, 0x7B, 0x90, 0x01, 0x64, 0x74, 0x01, -+0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, 0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, 0x75, -+0xE0, 0x91, 0x08, 0x71, 0xDD, 0xE4, 0xF5, 0x21, 0xF5, 0x22, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, -+0x21, 0x7F, 0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, 0x7F, 0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, -+0x52, 0x12, 0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, 0x02, 0x7B, 0x2E, 0x71, 0x54, 0x12, 0x7B, 0xDB, -+0x90, 0x8A, 0xC5, 0x12, 0x88, 0xD0, 0x51, 0xCF, 0x71, 0x9E, 0x12, 0x96, 0x54, 0x51, 0xCA, 0x71, -+0x8F, 0x90, 0x8A, 0x73, 0x12, 0xBD, 0x11, 0x02, 0x04, 0x7A, 0x71, 0x82, 0x02, 0x04, 0x80, 0x7B, -+0x00, 0x7A, 0x00, 0x79, 0x00, 0x90, 0x89, 0x2E, 0x12, 0x86, 0x46, 0x7B, 0xFF, 0x7A, 0x80, 0x79, -+0x80, 0x90, 0x89, 0x31, 0x12, 0x86, 0x46, 0x7A, 0x80, 0x79, 0xBF, 0x90, 0x89, 0x34, 0x12, 0x86, -+0x46, 0x7A, 0x81, 0x79, 0x61, 0x90, 0x89, 0x3A, 0x12, 0x86, 0x46, 0x7A, 0x81, 0x79, 0x75, 0x90, -+0x89, 0x3D, 0x12, 0x86, 0x46, 0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, 0x40, 0x12, 0x86, 0x46, 0x71, -+0x6B, 0x7A, 0x81, 0x79, 0xD9, 0x90, 0x89, 0x49, 0x12, 0x86, 0x46, 0x7A, 0x82, 0x79, 0x01, 0x90, -+0x89, 0x4C, 0x12, 0x86, 0x46, 0xE4, 0x90, 0x96, 0x76, 0xF0, 0x90, 0x95, 0x2F, 0xF0, 0x90, 0x95, -+0x2F, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x0F, 0x74, 0x87, 0x2F, 0x71, 0x4C, 0xE4, 0xF0, 0x90, -+0x95, 0x2F, 0xE0, 0x04, 0xF0, 0x80, 0xE7, 0x22, 0x74, 0x87, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, -+0x96, 0xF5, 0x83, 0x22, 0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, 0x7F, 0xF9, 0x7E, 0x01, 0x02, 0x5F, -+0xA6, 0x90, 0x01, 0xE4, 0x74, 0x10, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x7A, 0x81, 0x79, 0xB1, 0x90, -+0x89, 0x46, 0x02, 0x86, 0x46, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, -+0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x3B, 0x22, 0x7E, -+0x00, 0x7F, 0x88, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x58, 0x02, 0x04, 0x80, 0x7E, 0x00, -+0x7F, 0x01, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x2C, 0x12, 0x04, 0x80, 0x90, 0x88, 0x2C, -+0xE0, 0x54, 0xFD, 0xF0, 0xE4, 0x12, 0xA3, 0x78, 0xA3, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0x01, 0x8C, -+0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, -+0x54, 0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x75, 0x39, 0x06, -+0x43, 0x39, 0x10, 0x75, 0x3A, 0x01, 0x43, 0x3A, 0x10, 0x75, 0x3B, 0x03, 0x75, 0x3C, 0x62, 0x43, -+0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, 0x01, 0x38, 0xE5, 0x39, 0xF0, 0xA3, 0xE5, 0x3A, 0xF0, 0xA3, -+0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, 0xF0, 0x22, 0x75, 0x29, 0x12, 0xE4, 0xF5, 0x2A, 0x75, 0x2B, -+0x07, 0x75, 0x2C, 0x32, 0xF5, 0x31, 0x75, 0x32, 0xC1, 0x75, 0x33, 0x0C, 0xF5, 0x34, 0x90, 0x01, -+0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, 0xE5, 0x2C, 0xF0, -+0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, 0xF0, 0xA3, 0xE5, -+0x34, 0xF0, 0x22, 0x90, 0x8A, 0x79, 0x74, 0x87, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE5, -+0x74, 0xC6, 0xF0, 0xA3, 0x74, 0x81, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0xCB, -+0xF0, 0x90, 0x8A, 0xB9, 0x74, 0x88, 0xF0, 0xA3, 0x74, 0xDA, 0xF0, 0x90, 0x8A, 0xFB, 0x74, 0xAE, -+0xF0, 0xA3, 0x74, 0x0D, 0xF0, 0x90, 0x8A, 0xA5, 0x74, 0xAB, 0xF0, 0xA3, 0x74, 0x0D, 0xF0, 0x90, -+0x8A, 0xC3, 0x74, 0xD4, 0xF0, 0xA3, 0x74, 0x0E, 0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xDE, 0xF0, 0xA3, -+0x74, 0x7C, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0x9D, 0xF0, 0xA3, 0x74, 0xF7, 0xF0, 0x90, 0x86, 0x04, -+0x74, 0xDE, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x90, 0x8A, 0xA9, 0x74, 0xDE, 0xF0, 0xA3, 0x74, 0x88, -+0xF0, 0x90, 0x86, 0x0C, 0x74, 0xB0, 0xF0, 0xA3, 0x74, 0x3B, 0xF0, 0x90, 0x8A, 0xEF, 0x74, 0xB0, -+0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x90, 0x86, 0x00, 0x74, 0xE0, 0xF0, 0xA3, 0x74, 0xE5, 0xF0, 0x90, -+0x86, 0x02, 0x74, 0xE1, 0xF0, 0xA3, 0x74, 0x44, 0xF0, 0x90, 0x8A, 0xFD, 0x74, 0xD1, 0xF0, 0xA3, -+0x74, 0x59, 0xF0, 0x90, 0x8A, 0xF9, 0x74, 0xD4, 0xF0, 0xA3, 0x74, 0x3E, 0xF0, 0x90, 0x8A, 0xDB, -+0x74, 0xDD, 0xF0, 0xA3, 0x74, 0x3A, 0xF0, 0x90, 0x8A, 0xAF, 0x74, 0x9C, 0xF0, 0xA3, 0x74, 0x05, -+0xF0, 0x90, 0x8A, 0xD3, 0x74, 0xC9, 0xF0, 0xA3, 0x74, 0x72, 0xF0, 0x90, 0x8A, 0xF5, 0x74, 0xE2, -+0xF0, 0xA3, 0x74, 0x17, 0xF0, 0x90, 0x8A, 0xA3, 0x74, 0xE2, 0xF0, 0xA3, 0x74, 0x75, 0xF0, 0x90, -+0x86, 0x06, 0x74, 0xD3, 0xF0, 0xA3, 0x74, 0x28, 0xF0, 0x22, 0x7D, 0x02, 0x90, 0x01, 0xC4, 0x74, -+0x2A, 0xF0, 0x74, 0xC5, 0xA3, 0xF0, 0x90, 0x93, 0x57, 0xE0, 0xFF, 0xED, 0xC3, 0x9F, 0x50, 0x18, -+0xED, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, -+0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0D, 0x80, 0xDE, 0x74, 0x2A, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -+0xC5, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x95, 0x89, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, -+0x95, 0x89, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x93, 0xEA, 0xE0, 0x70, 0x18, 0x90, 0x93, 0xE7, 0xE0, -+0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x95, 0x89, 0xE0, 0x24, 0x66, 0x90, 0x01, 0xC4, 0xF0, -+0x74, 0xC5, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, 0x88, 0x36, -+0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, 0x6F, 0x60, 0x03, 0x12, -+0x9F, 0x1F, 0xC2, 0xAF, 0xB1, 0x2A, 0xBF, 0x01, 0x03, 0x12, 0xB4, 0xCA, 0xD2, 0xAF, 0xB1, 0xC8, -+0x12, 0xAF, 0xEC, 0x12, 0x83, 0x4D, 0x80, 0xA7, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x93, 0xE7, 0xE0, 0x60, 0x25, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xD1, 0x75, 0xEF, 0x44, -+0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0xD1, 0x75, 0x90, 0x92, 0x18, -+0x12, 0x04, 0x31, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, 0x93, 0xE2, 0xE0, 0x70, 0x29, -+0x90, 0x07, 0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, 0x95, 0x90, 0x74, 0x22, 0xF0, 0x90, -+0x95, 0xB2, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x92, 0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x90, 0x12, 0x90, 0x2E, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x93, 0xEA, 0xE0, 0xFF, 0x70, 0x0A, -+0x90, 0x93, 0xE7, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, -+0xF0, 0x90, 0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, -+0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, 0x90, 0x93, 0xE7, 0xE0, 0x60, 0x06, 0x90, 0x01, -+0xC4, 0x74, 0x01, 0xF0, 0x90, 0x93, 0xE8, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, 0x8C, 0x12, 0x04, 0x31, 0x90, 0x95, 0x8C, 0x02, 0x04, -+0xB8, 0x8F, 0x0D, 0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x0D, 0xF0, 0x22, -+0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, -+0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, -+0x74, 0x90, 0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, 0x74, 0x90, 0x04, 0x90, 0x01, 0xC4, -+0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, -+0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, -+0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, -+0x74, 0xE0, 0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0x12, 0x75, 0x50, 0xE5, 0x3D, 0x30, 0xE1, 0x03, 0x12, -+0x9F, 0x15, 0xE5, 0x3D, 0x30, 0xE2, 0x03, 0x12, 0x9F, 0x54, 0xE5, 0x3D, 0x30, 0xE4, 0x02, 0xF1, -+0xB4, 0xE5, 0x3D, 0x30, 0xE5, 0x02, 0xF1, 0xB7, 0xE5, 0x3E, 0x30, 0xE0, 0x03, 0x12, 0xD0, 0xC7, -+0xE5, 0x3E, 0x30, 0xE4, 0x02, 0xF1, 0xBA, 0xE5, 0x3F, 0x30, 0xE1, 0x03, 0x12, 0xBB, 0xAF, 0xE5, -+0x3F, 0x30, 0xE0, 0x03, 0x12, 0xD1, 0xB9, 0xE5, 0x3F, 0x30, 0xE4, 0x02, 0xF1, 0xB3, 0xE5, 0x3F, -+0x30, 0xE2, 0x0A, 0x12, 0xD2, 0x0E, 0x90, 0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x40, 0x30, -+0xE1, 0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x90, 0x40, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, 0x40, 0x30, -+0xE4, 0x03, 0x12, 0xA7, 0xA9, 0xE5, 0x40, 0x30, 0xE5, 0x03, 0x12, 0xD2, 0x70, 0xE5, 0x40, 0x30, -+0xE6, 0x03, 0x12, 0xD2, 0xB6, 0xE5, 0x40, 0x30, 0xE7, 0x03, 0x12, 0xD2, 0x50, 0x74, 0xE0, 0x04, -+0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, -+0xD0, 0xE0, 0x32, 0x22, 0x02, 0x34, 0x78, 0x02, 0x8D, 0x6F, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, -+0x0F, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, 0x04, 0x1F, 0xE0, 0x44, 0x40, 0xF0, -+0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, -+0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, -+0xC4, 0x74, 0xD1, 0xF0, 0x74, 0xC7, 0xA3, 0xF0, 0x90, 0x8A, 0x9D, 0x12, 0x88, 0xD0, 0x53, 0x91, -+0xBF, 0x74, 0xD1, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC7, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, -+0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, -+0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -+0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x27, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0xC8, 0xFF, -+0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, -+0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x05, 0xE4, -+0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0x8F, 0x80, -+0x03, 0x90, 0x8A, 0x87, 0x12, 0x88, 0xD0, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x04, 0xA3, 0xE0, -+0x04, 0xF0, 0x90, 0x88, 0xE7, 0xE0, 0x64, 0x08, 0x70, 0x20, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, -+0x14, 0x12, 0xB4, 0x71, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, 0xE0, 0x54, 0xFE, 0xF0, -+0xE4, 0xA3, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, 0x12, 0x9C, 0xD1, 0x54, 0x03, 0x30, -+0xE0, 0x13, 0x90, 0x88, 0xE8, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, -+0xF0, 0x90, 0x88, 0xE8, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x88, 0x2E, 0x74, -+0x01, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x75, 0x90, 0x88, 0x4D, 0xE0, 0x04, 0xF0, 0x12, 0x8D, -+0x4F, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, -+0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -+0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x8D, 0x68, 0x78, 0x18, -+0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0x90, 0x88, -+0x81, 0x12, 0x04, 0x31, 0x90, 0x88, 0x32, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0A, -+0x91, 0x92, 0x74, 0x05, 0xF0, 0x12, 0x6E, 0x2F, 0x31, 0x6A, 0x90, 0x88, 0x32, 0x12, 0xA5, 0xF2, -+0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0xA7, 0x9B, 0x90, 0x8A, 0xE5, -+0x12, 0x90, 0x40, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x93, 0x3B, 0xE0, 0x30, 0xE0, 0x0A, 0x90, -+0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0xA7, 0x9B, 0x22, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFE, -+0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xD3, 0xFE, 0x90, 0x95, 0x2F, 0xF0, -+0x90, 0x88, 0x32, 0x12, 0xA9, 0xA4, 0x30, 0xE0, 0x02, 0x41, 0x38, 0x90, 0x88, 0x31, 0xE0, 0x30, -+0xE0, 0x1C, 0x51, 0x58, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, 0x53, -+0xE0, 0x24, 0x03, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, -+0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, 0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, 0x88, -+0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, 0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, 0xF0, -+0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, 0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, -+0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, 0x88, -+0x4B, 0x51, 0x44, 0x90, 0x88, 0x4E, 0x51, 0x4D, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, -+0x88, 0x4E, 0x51, 0x44, 0x90, 0x88, 0x3E, 0x51, 0x4D, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, -+0x90, 0x88, 0x4E, 0x12, 0xA5, 0xF2, 0xFF, 0x7E, 0x00, 0x90, 0x88, 0x42, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x05, 0xB1, 0xE0, -+0x54, 0xF8, 0x4F, 0xF0, 0x31, 0x6A, 0x80, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x01, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, 0x33, 0xFC, 0x22, 0xE0, 0xD3, 0x9D, -+0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x22, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, 0x22, 0x90, -+0x88, 0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x95, 0x2E, 0xE0, 0x24, 0x46, 0xFF, -+0x90, 0x95, 0x2D, 0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, 0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, -+0x12, 0x85, 0xBA, 0x90, 0x88, 0x85, 0x91, 0x66, 0xEF, 0x24, 0x46, 0x91, 0xAC, 0x90, 0x88, 0x89, -+0x91, 0x66, 0x90, 0x88, 0x85, 0x12, 0x9E, 0xEA, 0x50, 0x02, 0x61, 0x4D, 0x90, 0x88, 0x89, 0x12, -+0x86, 0x31, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, 0x85, 0xBA, 0x90, 0x95, 0xF1, 0x12, 0x04, -+0x31, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x2B, 0x51, 0x58, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, -+0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, -+0x4E, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, 0x00, 0xFA, 0x91, 0x6F, 0xEB, 0x2F, 0xFF, -+0xEA, 0x80, 0x1E, 0x90, 0x88, 0x33, 0x12, 0x9F, 0xE7, 0x30, 0xE0, 0x02, 0x81, 0x4A, 0x91, 0x6F, -+0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, 0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, -+0xED, 0x3E, 0x90, 0x95, 0xED, 0xF0, 0xA3, 0xEF, 0xF0, 0xC3, 0x90, 0x95, 0xEE, 0xE0, 0x94, 0xA0, -+0x90, 0x95, 0xED, 0xE0, 0x94, 0x00, 0x50, 0x35, 0xA3, 0xE0, 0xFB, 0x24, 0xED, 0x91, 0x5D, 0x04, -+0xF0, 0x90, 0x95, 0xF1, 0x12, 0x04, 0xB8, 0xEF, 0x54, 0x7F, 0xFF, 0x74, 0x8D, 0x2B, 0x91, 0x52, -+0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x95, 0xED, 0xA3, 0xE0, 0x91, 0x50, 0xEF, 0xF0, -+0x90, 0x88, 0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, 0x7F, 0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, -+0xE0, 0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, -+0x81, 0x4A, 0xE4, 0xFF, 0xFE, 0x91, 0x5A, 0x2F, 0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, -+0x9D, 0x40, 0x07, 0x90, 0x95, 0xEF, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE6, 0x91, -+0x7A, 0x9C, 0x40, 0x02, 0x80, 0x15, 0x90, 0x95, 0xEF, 0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, -+0x50, 0x13, 0x91, 0x5A, 0x2F, 0xFF, 0x91, 0x7A, 0x9C, 0x40, 0x07, 0x90, 0x95, 0xF0, 0xEE, 0xF0, -+0x80, 0x03, 0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, 0xE0, 0xFF, 0x91, 0x4B, 0xE0, 0xFD, 0xEF, 0xC3, -+0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x95, -+0xF0, 0xE0, 0x80, 0x18, 0x91, 0x4B, 0xE0, 0xFD, 0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, -+0xF0, 0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, 0x95, 0xF0, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, -+0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, -+0xF0, 0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, -+0x50, 0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, -+0x88, 0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, 0x88, 0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, -+0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, -+0x90, 0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0x91, 0x92, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, -+0x8A, 0xA3, 0x12, 0x90, 0x40, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x95, 0xEF, 0xE0, 0xFE, -+0x24, 0x8D, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0x74, 0xED, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0xF5, 0x83, 0xE0, 0x22, 0x12, 0x04, 0x31, 0x90, 0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, -+0x95, 0xF1, 0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, 0xEB, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, -+0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, -+0xE4, 0x22, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, 0xE0, 0xFB, 0x90, -+0x92, 0x98, 0x22, 0x90, 0x96, 0xB5, 0x12, 0x04, 0xB8, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, -+0xE4, 0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, 0x90, 0x93, 0x58, 0xE0, 0xFF, 0x20, 0xE0, 0x02, 0xE1, -+0xA5, 0x90, 0x93, 0xD9, 0xE0, 0xFE, 0x20, 0xE0, 0x02, 0xC1, 0x1E, 0x90, 0x93, 0xD7, 0xE0, 0xFD, -+0x90, 0x93, 0xDA, 0xE0, 0xD3, 0x9D, 0x50, 0x02, 0xC1, 0x1E, 0x90, 0x05, 0x58, 0xE0, 0x90, 0x96, -+0xBD, 0xF0, 0xEF, 0x12, 0x8F, 0xD3, 0x54, 0x07, 0xFF, 0x64, 0x02, 0x60, 0x03, 0xEF, 0x70, 0x24, -+0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x1B, 0x90, 0x93, 0xD9, 0xE0, 0x44, 0x40, 0xF0, -+0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x96, 0xBD, 0xE0, 0xFF, 0x90, 0x93, 0xD6, 0xE0, 0x2F, 0x24, -+0xFD, 0x12, 0xA6, 0x10, 0x12, 0x8D, 0x4F, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0xA3, 0x12, 0x8D, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0x12, 0x86, 0x24, 0x90, 0x96, 0xB1, 0x12, 0x04, 0x31, 0x90, 0x05, 0x65, 0x12, 0x8D, 0x68, -+0xF1, 0xCA, 0x90, 0x05, 0x64, 0x12, 0x8D, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x05, 0x66, 0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0xA3, 0x12, 0x8D, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0xF1, 0xB6, 0x90, 0x93, 0xD6, 0xE0, 0xFB, 0xE4, 0xFA, 0xF9, 0xF8, 0x90, 0x96, 0xBD, -+0x12, 0x8D, 0x68, 0x12, 0x85, 0xAD, 0xE4, 0xFB, 0x7A, 0x04, 0x12, 0x85, 0xC8, 0x90, 0x96, 0xB1, -+0x12, 0x86, 0x31, 0x12, 0x85, 0xAD, 0x90, 0x96, 0xB9, 0x12, 0xE3, 0x39, 0xF1, 0xD8, 0x50, 0x04, -+0x91, 0xA3, 0xF1, 0xB9, 0xF1, 0xBF, 0x90, 0x05, 0x8B, 0xEF, 0xF0, 0x90, 0x96, 0xB5, 0xF1, 0xAE, -+0x90, 0x05, 0x8A, 0xEF, 0xF0, 0x90, 0x96, 0xB5, 0xF1, 0xA6, 0x90, 0x05, 0x89, 0xEF, 0xF0, 0x90, -+0x96, 0xB5, 0x12, 0xE3, 0x8A, 0x90, 0x96, 0xB9, 0xF1, 0xC2, 0x90, 0x05, 0x87, 0xEF, 0xF0, 0x90, -+0x96, 0xB9, 0xF1, 0xAE, 0x90, 0x05, 0x86, 0xEF, 0xF0, 0x90, 0x96, 0xB9, 0xF1, 0xA6, 0x90, 0x05, -+0x85, 0xEF, 0xF0, 0x90, 0x96, 0xB9, 0x12, 0xE2, 0xD4, 0xE4, 0x90, 0x93, 0xDA, 0xF0, 0x90, 0x93, -+0xD5, 0xE0, 0x20, 0xE0, 0x02, 0xE1, 0xA5, 0x90, 0x93, 0xD9, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, 0x54, -+0x1F, 0x70, 0x02, 0xE1, 0xA5, 0xEF, 0x54, 0xC1, 0xFF, 0xEE, 0x14, 0x54, 0x1F, 0x25, 0xE0, 0x4F, -+0xF0, 0xE0, 0xC3, 0x13, 0x54, 0x1F, 0x60, 0x02, 0xE1, 0xA5, 0x90, 0x05, 0x22, 0xE0, 0x44, 0x40, -+0xF0, 0x90, 0x05, 0x50, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0x05, 0x69, 0x12, 0x8D, 0x68, 0xF1, 0xCA, -+0x90, 0x05, 0x68, 0x12, 0x8D, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0x05, 0x6A, 0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, -+0x12, 0x8D, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0x12, 0x86, 0x24, 0x90, 0x96, 0xB1, 0x12, 0xE3, 0x39, 0x12, 0x04, 0x31, 0x90, 0x05, 0x6D, 0x12, -+0x8D, 0x68, 0xF1, 0xCA, 0x90, 0x05, 0x6C, 0x12, 0x8D, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x6E, 0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0xA3, 0x12, 0x8D, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0xF1, 0xB6, 0x90, 0x96, 0xB1, 0x12, 0x86, 0x31, 0xC0, 0x00, 0xC0, 0x01, -+0xC0, 0x02, 0xC0, 0x03, 0x90, 0x93, 0xD5, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xFF, 0xE4, 0xFC, 0xFD, -+0xFE, 0x12, 0xE3, 0x82, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xAD, 0x90, -+0x96, 0xB1, 0x12, 0x04, 0x31, 0x90, 0x96, 0xB9, 0x12, 0x04, 0xB8, 0x90, 0x96, 0xB1, 0x12, 0x9E, -+0xEA, 0x50, 0x04, 0x91, 0xA3, 0xF1, 0xB9, 0xF1, 0xBF, 0x90, 0x05, 0x67, 0xEF, 0xF0, 0x90, 0x96, -+0xB5, 0xF1, 0xAE, 0x90, 0x05, 0x66, 0xEF, 0xF0, 0x90, 0x96, 0xB5, 0xF1, 0xA6, 0x90, 0x05, 0x65, -+0xEF, 0xF0, 0x90, 0x96, 0xB5, 0x12, 0x04, 0xB8, 0x90, 0x05, 0x64, 0xEF, 0xF0, 0x90, 0x96, 0xB1, -+0xF1, 0xC2, 0x90, 0x05, 0x63, 0xEF, 0xF0, 0x90, 0x96, 0xB1, 0xF1, 0xAE, 0x90, 0x05, 0x62, 0xEF, -+0xF0, 0x90, 0x96, 0xB1, 0xF1, 0xA6, 0x90, 0x05, 0x61, 0xEF, 0xF0, 0x90, 0x96, 0xB1, 0x12, 0x04, -+0xB8, 0x90, 0x05, 0x60, 0xEF, 0xF0, 0x90, 0x05, 0x50, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x05, 0x22, -+0xE0, 0x54, 0xBF, 0xF0, 0x7F, 0x08, 0x12, 0x9F, 0xF5, 0x90, 0x93, 0xD9, 0xE0, 0x54, 0xC1, 0x44, -+0x28, 0xF0, 0x44, 0x01, 0xF0, 0x22, 0x12, 0x04, 0xB8, 0x78, 0x08, 0x02, 0x03, 0xEB, 0x12, 0x04, -+0xB8, 0x78, 0x10, 0x02, 0x03, 0xEB, 0x12, 0x86, 0x24, 0x90, 0x96, 0xB5, 0x02, 0x04, 0x31, 0x90, -+0x96, 0xB5, 0x12, 0x04, 0xB8, 0x78, 0x18, 0x02, 0x03, 0xEB, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, -+0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, 0x12, 0x86, 0x31, 0xD3, 0x02, 0x03, 0xDA, 0x90, -+0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x05, 0x12, 0x97, 0xC8, 0x60, 0x15, 0x90, 0x88, 0x36, 0xE0, -+0x70, 0x04, 0xEF, 0x30, 0xE0, 0x0B, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x03, 0x12, 0xA3, -+0xF2, 0x22, 0x12, 0xA7, 0x68, 0x70, 0x0E, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x08, 0x90, 0x01, 0x57, -+0x11, 0x16, 0x12, 0xA6, 0x06, 0x22, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0x12, 0xA7, -+0x68, 0x70, 0x19, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x13, 0x90, 0x01, 0x57, 0x11, 0x16, 0xF0, 0x90, -+0x88, 0x31, 0xE0, 0x11, 0x3E, 0x54, 0x07, 0x70, 0x03, 0x12, 0x9F, 0x1F, 0x22, 0xEF, 0x54, 0xFB, -+0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, -+0x19, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x13, 0x12, 0xA6, 0xFF, 0x64, 0x02, 0x60, 0x09, 0x90, 0x8A, -+0xE1, 0x12, 0xBD, 0x11, 0x02, 0x04, 0x7A, 0x12, 0x73, 0x8F, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, -+0xBF, 0x01, 0x10, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0A, 0x12, 0xA6, 0x7C, 0x54, 0x07, 0x70, 0x03, -+0x12, 0x9F, 0x1F, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x07, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, -+0x12, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x08, 0x12, 0xA7, 0x8F, 0xBF, 0x01, 0x05, 0x80, 0x04, -+0x12, 0x97, 0x42, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x02, 0x60, 0x13, 0x12, 0xA6, 0xFF, 0x60, -+0x0E, 0x12, 0x7A, 0x65, 0xEF, 0x70, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0x11, 0xC0, 0x22, -+0xE4, 0xFD, 0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x31, 0x0E, 0x90, 0x96, 0x1B, 0xEF, 0xF0, 0x90, 0x8A, -+0x89, 0x30, 0xE0, 0x13, 0x12, 0x90, 0x40, 0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, -+0x33, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x06, 0x12, 0x90, 0x40, 0x12, 0x97, 0x91, 0x90, 0x96, 0x1B, -+0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, -+0x01, 0x2F, 0x74, 0x80, 0xF0, 0x12, 0xCC, 0x92, 0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, 0x90, -+0x96, 0x1D, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, 0x90, 0x96, 0x1C, 0xEF, 0xF0, 0x7F, -+0x83, 0x12, 0x7B, 0x41, 0xAE, 0x07, 0x90, 0x96, 0x1C, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, -+0x90, 0x96, 0x1E, 0xE0, 0x94, 0x64, 0x90, 0x96, 0x1D, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, -+0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x96, 0x1C, 0xE0, 0xFF, 0x22, 0x90, 0x96, 0x1D, 0x31, 0x52, -+0x80, 0xC3, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x02, 0xE7, 0xE4, 0x90, 0x96, 0xF1, 0xF0, 0xA3, 0xF0, -+0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, -+0x70, 0x03, 0x7F, 0x01, 0x22, 0x12, 0x9C, 0xD1, 0x54, 0x03, 0x30, 0xE0, 0x15, 0xD3, 0x90, 0x96, -+0xF2, 0xE0, 0x94, 0x03, 0x90, 0x96, 0xF1, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x80, 0x13, 0x7F, 0x01, -+0x80, 0x1B, 0xD3, 0x90, 0x96, 0xF2, 0xE0, 0x94, 0xE8, 0x90, 0x96, 0xF1, 0xE0, 0x94, 0x03, 0x40, -+0x0A, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, -+0x7C, 0x6A, 0x90, 0x96, 0xF1, 0x31, 0x52, 0x80, 0xA7, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, -+0x4C, 0x90, 0x88, 0x30, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0x88, 0x2F, 0xE0, -+0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x32, 0xEF, 0xC3, 0x13, 0x30, 0xE0, -+0x03, 0x02, 0xB9, 0xC2, 0x12, 0x97, 0xCF, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x08, 0x0C, 0x90, 0x8A, -+0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0x7F, 0x0C, 0x80, 0x10, 0x90, 0x88, 0x30, 0xE0, 0x70, 0x0D, -+0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, 0xE0, -+0xB4, 0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, 0x23, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, 0x9C, 0xB4, 0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, 0xB4, -+0x02, 0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE7, 0x12, 0x88, 0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, 0x12, -+0x88, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x88, 0xD0, 0x22, -+0x90, 0x88, 0x31, 0x51, 0xAE, 0x30, 0xE0, 0x32, 0xEF, 0x54, 0xBF, 0x71, 0x14, 0x30, 0xE0, 0x06, -+0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFE, 0x71, 0x1D, 0x74, 0x04, 0xF0, 0x90, 0x88, -+0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, -+0x7D, 0x01, 0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x12, 0x9F, 0x1F, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0xFF, -+0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0x12, 0xA9, 0xA5, 0x30, 0xE0, -+0x1E, 0xEF, 0x54, 0x7F, 0x71, 0x14, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, -+0x54, 0xFD, 0x71, 0x1D, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0x9F, 0x1F, 0x90, -+0x88, 0xA1, 0x51, 0xAE, 0x30, 0xE0, 0x22, 0x90, 0x88, 0xA4, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, -+0x18, 0xEF, 0x54, 0xFD, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, 0x30, 0xE1, 0x06, 0xE0, -+0x44, 0x04, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x03, -+0x12, 0x99, 0xBF, 0x22, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, 0xF0, 0x90, 0x01, -+0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x95, 0x30, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x95, 0x2F, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x71, -+0xFE, 0x90, 0x95, 0x32, 0xF0, 0x12, 0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x95, 0x2F, 0xE0, -+0x90, 0x04, 0x25, 0xF0, 0x90, 0x95, 0x30, 0xE0, 0x60, 0x05, 0x71, 0xF2, 0x44, 0x80, 0xF0, 0xAF, -+0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x71, -+0xF2, 0x54, 0xC0, 0xF0, 0x90, 0x95, 0x32, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, -+0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x04, 0xF0, 0xAF, 0x05, 0x71, 0xE7, 0xE0, -+0x54, 0x01, 0xFE, 0x90, 0x95, 0x31, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, -+0xFE, 0x71, 0xE7, 0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, -+0xFF, 0xF0, 0x74, 0x29, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, -+0x74, 0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, 0x04, -+0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x86, -+0xAD, 0xA3, 0xE0, 0x24, 0x7F, 0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x71, 0xFE, 0x90, 0x96, 0xFC, 0xF0, 0xED, 0x90, 0x00, 0x73, 0x70, -+0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, 0x80, 0x0B, 0xE0, 0x54, -+0xFB, 0xF0, 0x90, 0x00, 0x67, 0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, -+0x22, 0xEF, 0xF0, 0x90, 0x93, 0x01, 0xED, 0xF0, 0x22, 0x7A, 0x00, 0x7D, 0x03, 0x7F, 0x01, 0x90, -+0x01, 0xC6, 0xE0, 0x64, 0x80, 0x70, 0x60, 0x90, 0x95, 0xCC, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xEB, -+0xA3, 0xF0, 0xEA, 0xA3, 0xF0, 0x90, 0x95, 0xC2, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0xD0, 0xF0, -+0xEC, 0xA3, 0xF0, 0x90, 0x95, 0xC4, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0xD2, 0xF0, 0xEC, 0xA3, -+0xF0, 0x90, 0x95, 0xC6, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0xD4, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, -+0x95, 0xC8, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0xD6, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0x95, 0xCA, -+0x74, 0xFE, 0xF0, 0x90, 0x95, 0xEC, 0x74, 0x0C, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xCA, 0x12, -+0x90, 0x2E, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0x7D, 0x05, 0x7F, 0x04, 0x80, 0x91, 0x7D, 0x05, -+0x7F, 0x01, 0x80, 0x8B, 0x7A, 0x00, 0x7D, 0x01, 0x7F, 0x01, 0x80, 0x83, 0x7A, 0x00, 0xE4, 0xFD, -+0x7F, 0x01, 0x81, 0x4F, 0xE6, 0xFD, 0xAF, 0x67, 0xEF, 0x91, 0xEC, 0xE0, 0x54, 0xF8, 0xF5, 0x75, -+0xED, 0x42, 0x75, 0xEF, 0x91, 0xEC, 0xE5, 0x75, 0xF0, 0x22, 0xE5, 0x67, 0xC4, 0x54, 0xF0, 0x24, -+0x01, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0x7D, 0x07, 0xAF, 0x67, 0xED, 0x30, 0xE0, -+0x22, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, 0xB1, 0x4A, 0x90, 0x89, 0x59, 0xB1, 0x4A, 0x90, -+0x89, 0x5B, 0xB1, 0x4A, 0x90, 0x89, 0x5D, 0xB1, 0x4A, 0x90, 0x89, 0x5F, 0x12, 0x04, 0x6E, 0xE4, -+0xF0, 0xA3, 0xF0, 0xED, 0x30, 0xE1, 0x0A, 0x75, 0xF0, 0x12, 0xEF, 0xB1, 0x74, 0xE4, 0xF0, 0xA3, -+0xF0, 0xED, 0x30, 0xE2, 0x08, 0x75, 0xF0, 0x12, 0xEF, 0xB1, 0x69, 0xE4, 0xF0, 0xB1, 0x56, 0xE0, -+0x54, 0xBF, 0x44, 0x80, 0xFE, 0xB1, 0x56, 0xEE, 0xF0, 0x22, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, -+0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x22, 0xEF, 0xC4, 0x54, 0xF0, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, -+0x81, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0x90, 0x89, 0x55, 0x02, 0x04, 0x6E, 0x75, -+0xF0, 0x12, 0xE5, 0x67, 0x90, 0x89, 0x53, 0x02, 0x04, 0x6E, 0x90, 0x04, 0x85, 0xE0, 0xF5, 0x70, -+0x90, 0x96, 0x76, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x67, 0x90, 0x88, 0x2B, 0xE0, 0xFF, 0xE5, 0x67, -+0xC3, 0x9F, 0x40, 0x03, 0x02, 0xDC, 0x1F, 0xE5, 0x67, 0x12, 0xAE, 0x00, 0xE0, 0xF5, 0x72, 0x12, -+0xE3, 0x5E, 0xE0, 0x65, 0x72, 0x60, 0x16, 0x90, 0x92, 0x5E, 0xE5, 0x72, 0xF0, 0xE4, 0xA3, 0xF0, -+0xAB, 0x67, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0x12, 0xE3, 0x5E, 0xE5, 0x72, 0xF0, 0x90, 0x04, 0xA0, -+0xE0, 0x64, 0x01, 0x70, 0x52, 0xA3, 0xE0, 0x65, 0x67, 0x70, 0x4C, 0xA3, 0xE0, 0xF5, 0x68, 0xA3, -+0xE0, 0x90, 0x95, 0xB9, 0xF0, 0xE5, 0x67, 0x12, 0xAE, 0x00, 0xE0, 0x65, 0x68, 0x70, 0x03, 0x02, -+0xDC, 0x1A, 0xE5, 0x67, 0x12, 0xAE, 0x00, 0xE5, 0x68, 0xF0, 0xE5, 0x67, 0x12, 0xAE, 0x93, 0xE0, -+0x54, 0xFC, 0xFF, 0x90, 0x95, 0xB9, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0xE5, 0x67, 0x12, 0xAE, 0x93, -+0xEF, 0xF0, 0x90, 0x92, 0x5E, 0xE5, 0x68, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xAB, 0x67, 0xE4, 0xFD, -+0xFF, 0x12, 0x6F, 0x75, 0x02, 0xDC, 0x1A, 0xAF, 0x67, 0x12, 0x78, 0x4A, 0x75, 0xF0, 0x12, 0xE5, -+0x67, 0x12, 0xAB, 0x05, 0x12, 0xA9, 0xA5, 0xFD, 0x12, 0xDD, 0x12, 0xED, 0xF0, 0x90, 0x95, 0xC4, -+0xE4, 0x12, 0xAD, 0xC5, 0xE5, 0x67, 0xF0, 0x12, 0xB2, 0xB5, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0xFF, 0x90, 0x95, 0xC8, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x7B, 0x02, 0x91, 0xCC, 0xB1, 0x6F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xB1, 0x64, 0xE0, -+0xFD, 0x91, 0xEA, 0xE0, 0x54, 0x80, 0xFB, 0x12, 0xDD, 0x12, 0xEB, 0xF0, 0x12, 0xDD, 0x19, 0xED, -+0xF0, 0x90, 0x95, 0xC2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x96, 0x75, 0x12, 0xDC, 0xC3, 0x7B, -+0x03, 0x91, 0xCC, 0xAF, 0x67, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x03, 0x02, 0xDC, 0x1A, 0x75, 0xF0, -+0x12, 0xE5, 0x67, 0x12, 0xAB, 0x05, 0x12, 0xA9, 0xA5, 0x30, 0xE0, 0x03, 0x02, 0xDC, 0x1A, 0xE5, -+0x67, 0x12, 0xB2, 0xB5, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, -+0xFE, 0xEF, 0x5D, 0x4E, 0x60, 0x03, 0x02, 0xDC, 0x1A, 0xB1, 0x6F, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, -+0x70, 0x08, 0xB1, 0x64, 0xE0, 0x70, 0x03, 0x02, 0xDC, 0x1A, 0xE5, 0x67, 0x75, 0xF0, 0x12, 0xA4, -+0x24, 0x57, 0xF9, 0x74, 0x89, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x90, 0x95, 0xB4, 0x12, 0x86, 0x46, -+0x12, 0xE3, 0xC6, 0x12, 0x03, 0x13, 0x2F, 0xFF, 0x12, 0xDD, 0x00, 0x2F, 0xFF, 0x12, 0xDD, 0x06, -+0x2F, 0xFF, 0x12, 0xDD, 0x0C, 0x2F, 0xF5, 0x71, 0xB1, 0x6F, 0xE0, 0xF5, 0x6D, 0xA3, 0xE0, 0xF5, -+0x6E, 0xB1, 0x64, 0xE0, 0xFF, 0x90, 0x95, 0xB7, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xE5, 0x67, 0x12, -+0xAE, 0x00, 0xE0, 0xF5, 0x68, 0x54, 0x80, 0xF5, 0x6A, 0xE5, 0x68, 0x54, 0x7F, 0xF5, 0x69, 0x90, -+0x96, 0x75, 0xE0, 0x60, 0x12, 0x75, 0x73, 0x0A, 0x12, 0xDC, 0x5D, 0xE4, 0x93, 0xC3, 0x13, 0x74, -+0x01, 0x93, 0x13, 0xF5, 0x74, 0x80, 0x0A, 0x7B, 0xFF, 0x12, 0xC3, 0x6B, 0xE4, 0xF5, 0x73, 0xF5, -+0x74, 0x12, 0xDD, 0x28, 0x12, 0xE2, 0xBE, 0x12, 0xE3, 0xC6, 0x90, 0x95, 0xC4, 0x12, 0xE2, 0xC2, -+0x12, 0xDD, 0x00, 0xFF, 0x90, 0x95, 0xC6, 0x12, 0xE2, 0xC2, 0x12, 0xDD, 0x06, 0xFF, 0x90, 0x95, -+0xC8, 0x12, 0xE2, 0xC2, 0x7B, 0x01, 0x91, 0xC4, 0x90, 0x95, 0xB4, 0x12, 0x86, 0x3D, 0x12, 0xDD, -+0x0C, 0x12, 0xE2, 0xBE, 0x90, 0x95, 0xB7, 0xE0, 0xFF, 0xA3, 0xE0, 0x12, 0xDD, 0x31, 0xA3, 0x12, -+0xDD, 0x20, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x7B, 0x02, 0x91, 0xC4, 0x75, 0xF0, 0x12, -+0xE5, 0x67, 0x12, 0xAF, 0xD8, 0xFF, 0xE5, 0x69, 0xD3, 0x9F, 0x40, 0x08, 0x8F, 0x69, 0xE5, 0x69, -+0x45, 0x6A, 0xF5, 0x68, 0x12, 0xDC, 0x51, 0xE0, 0xC3, 0x94, 0x05, 0x40, 0x03, 0x02, 0xD9, 0xFA, -+0xE5, 0x69, 0x90, 0x81, 0x61, 0x93, 0xF5, 0x6F, 0xFD, 0xAF, 0x69, 0x12, 0x60, 0x6F, 0x8F, 0x6F, -+0xE5, 0x6A, 0x60, 0x04, 0x05, 0x6F, 0x05, 0x6F, 0x90, 0x04, 0x8C, 0xE0, 0x64, 0x01, 0x70, 0x28, -+0xE5, 0x69, 0xC3, 0x94, 0x0C, 0x40, 0x21, 0x74, 0x84, 0x25, 0x69, 0xF5, 0x82, 0xE4, 0x34, 0x04, -+0xF5, 0x83, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xEF, 0x30, 0xE7, 0x06, 0xE5, 0x6F, 0x2E, 0xFF, 0x80, -+0x05, 0xC3, 0xE5, 0x6F, 0x9E, 0xFF, 0x8F, 0x6F, 0xE5, 0x6F, 0xD3, 0x94, 0x1A, 0xAF, 0x6F, 0x40, -+0x02, 0x7F, 0x1A, 0x8F, 0x6F, 0x12, 0xA3, 0x69, 0x7B, 0x03, 0xFA, 0x12, 0xD4, 0xC6, 0xE5, 0x68, -+0x90, 0x81, 0xD9, 0x93, 0xFF, 0xD3, 0x90, 0x95, 0xB8, 0xE0, 0x9F, 0x90, 0x95, 0xB7, 0xE0, 0x94, -+0x00, 0x40, 0x02, 0x80, 0x74, 0xC3, 0xE5, 0x6E, 0x94, 0x0A, 0xE5, 0x6D, 0x94, 0x00, 0x40, 0x02, -+0x21, 0x08, 0x12, 0xC3, 0x48, 0xE0, 0xC3, 0x94, 0x01, 0x40, 0x06, 0x12, 0xC3, 0x48, 0xE0, 0x14, -+0xF0, 0x90, 0x95, 0xB4, 0x12, 0x86, 0x3D, 0xB1, 0x0C, 0xFF, 0x90, 0x95, 0xB8, 0xE0, 0x2F, 0xFF, -+0x90, 0x95, 0xB7, 0xE0, 0x35, 0xF0, 0xFE, 0xB1, 0x06, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0xB1, -+0x00, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0xFC, 0xE5, 0x6D, 0xC3, 0x13, 0xFE, 0xE5, 0x6E, 0x13, 0xFF, -+0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x27, 0xE5, 0x67, 0x94, 0x05, 0x50, 0x06, 0x12, 0xC3, 0x48, -+0x74, 0x03, 0xF0, 0x90, 0x95, 0xC2, 0xB1, 0x20, 0xE5, 0x6D, 0xC3, 0x13, 0xA3, 0xF0, 0xE5, 0x6E, -+0x13, 0xA3, 0x91, 0x8A, 0x7B, 0x01, 0x12, 0xD4, 0x49, 0x12, 0xAE, 0xA0, 0x61, 0xEB, 0xB1, 0x28, -+0x65, 0x71, 0x70, 0x02, 0xE5, 0xF0, 0x70, 0x53, 0x90, 0x95, 0xC2, 0xF0, 0xA3, 0xE5, 0x71, 0xF0, -+0xC3, 0x13, 0xFF, 0xA3, 0xE4, 0xF0, 0xA3, 0xEF, 0x91, 0x8A, 0x7B, 0x02, 0x12, 0xD4, 0x49, 0xE5, -+0x67, 0xC3, 0x94, 0x05, 0x50, 0x10, 0x12, 0xC3, 0x48, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x07, 0x12, -+0xA3, 0x64, 0x7B, 0x03, 0x80, 0x0C, 0xE5, 0x71, 0xC3, 0x94, 0x03, 0x50, 0x12, 0x12, 0xA3, 0x64, -+0x7B, 0x04, 0xFA, 0x12, 0xD4, 0x4B, 0x7D, 0x06, 0xAF, 0x67, 0x12, 0xD4, 0xFD, 0x81, 0x1A, 0xE4, -+0xFD, 0xAF, 0x67, 0x12, 0xAC, 0x7C, 0x12, 0xD4, 0xF9, 0x61, 0xEB, 0x12, 0xA3, 0x64, 0x7B, 0x08, -+0xFA, 0x12, 0xD4, 0x4B, 0x91, 0xCE, 0x61, 0xEB, 0x12, 0xC3, 0x48, 0xE4, 0xF0, 0x90, 0x91, 0x6C, -+0x74, 0x02, 0xF0, 0xAB, 0x6F, 0xAD, 0x67, 0xAF, 0x6E, 0xAE, 0x6D, 0x12, 0x41, 0x9C, 0x8E, 0x6B, -+0x8F, 0x6C, 0x91, 0x5D, 0xC3, 0x74, 0x01, 0x93, 0x95, 0x74, 0xFF, 0xE4, 0x93, 0x94, 0x00, 0xFE, -+0xD3, 0xE5, 0x6C, 0x9F, 0xE5, 0x6B, 0x9E, 0x40, 0x34, 0x91, 0x20, 0xE4, 0xF0, 0x7D, 0x01, 0xAF, -+0x67, 0x12, 0xAC, 0x7C, 0x91, 0x5D, 0xC3, 0x74, 0x01, 0x93, 0x95, 0x74, 0xFE, 0xE4, 0x93, 0x94, -+0x00, 0x90, 0x95, 0xC4, 0xF0, 0xA3, 0xCE, 0xF0, 0x90, 0x95, 0xC2, 0xE5, 0x6B, 0xF0, 0xA3, 0xE5, -+0x6C, 0xF0, 0xE4, 0x90, 0x95, 0xC6, 0x12, 0xA3, 0x77, 0x7B, 0x01, 0x80, 0x1F, 0x91, 0x75, 0xC3, -+0xE5, 0x6C, 0x9F, 0xE5, 0x6B, 0x94, 0x00, 0x50, 0x19, 0x91, 0x20, 0xE4, 0xF0, 0x12, 0xAE, 0xA0, -+0x91, 0x6B, 0xB1, 0x19, 0xEF, 0xF0, 0xE4, 0x12, 0xA3, 0x76, 0x7B, 0x02, 0xFA, 0x12, 0xD4, 0xBE, -+0x61, 0xEB, 0x12, 0xD4, 0xF9, 0x91, 0x5D, 0xE4, 0x93, 0xFF, 0x74, 0x01, 0x93, 0xB1, 0x31, 0x91, -+0x6B, 0xB1, 0x12, 0xEF, 0xF0, 0x74, 0xA6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0x91, 0xC1, -+0x7B, 0x03, 0x7A, 0x00, 0x12, 0xD4, 0xBE, 0x91, 0x20, 0xE0, 0x04, 0xF0, 0xE5, 0x69, 0x90, 0x81, -+0xED, 0x93, 0x25, 0x73, 0xFF, 0xE4, 0x33, 0xFE, 0x91, 0x20, 0xE0, 0xC3, 0x9F, 0xEE, 0x64, 0x80, -+0xF8, 0x74, 0x80, 0x98, 0x50, 0x02, 0x61, 0xEB, 0x91, 0x20, 0xE4, 0x91, 0x74, 0x91, 0x5D, 0x74, -+0x01, 0x93, 0x2F, 0xFF, 0xE4, 0x93, 0x34, 0x00, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x67, -+0x12, 0xAD, 0xE5, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x61, 0xEB, 0x91, 0x51, 0xE0, 0x64, 0x05, 0x60, -+0x02, 0x41, 0xBA, 0x90, 0x04, 0xA0, 0xE0, 0x64, 0x02, 0x70, 0x10, 0x91, 0x38, 0xE4, 0xF0, 0x90, -+0x04, 0xA1, 0xE0, 0x78, 0x88, 0xF6, 0x12, 0xD4, 0xD4, 0x61, 0xFF, 0xAD, 0x69, 0xAF, 0x67, 0x12, -+0x72, 0xEE, 0x91, 0xF4, 0xEF, 0xF0, 0x12, 0xD4, 0xEA, 0xE0, 0x54, 0x07, 0x78, 0x88, 0xF6, 0x91, -+0x7D, 0xFF, 0xC3, 0x94, 0x30, 0x40, 0x1C, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0x12, 0xAB, 0x05, 0xFE, -+0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x0B, 0x91, 0xF4, 0xE0, 0x60, 0x06, 0x90, 0x96, 0x75, -+0xE0, 0x60, 0x0A, 0xE4, 0x78, 0x88, 0xF6, 0x91, 0x38, 0xE4, 0xF0, 0x80, 0x56, 0x91, 0xE8, 0xE0, -+0xFE, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEF, 0x12, 0xCA, 0x4E, 0x98, 0x50, 0x1D, 0x91, 0x7D, -+0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEE, 0x12, 0xCA, 0x4E, 0x98, 0x50, 0x0E, 0x91, 0xDC, 0xE0, -+0xB5, 0x69, 0x08, 0x91, 0x45, 0xE0, 0xC3, 0x94, 0x0A, 0x40, 0x23, 0x78, 0x88, 0xE6, 0xFF, 0x70, -+0x04, 0x76, 0x01, 0x80, 0x0C, 0xEF, 0x78, 0x88, 0xB4, 0x01, 0x04, 0x76, 0x03, 0x80, 0x02, 0x76, -+0x05, 0x91, 0x45, 0xE4, 0xF0, 0x91, 0x7D, 0xFF, 0x91, 0xE8, 0xEF, 0xF0, 0x80, 0x05, 0x91, 0x38, -+0xE0, 0x04, 0xF0, 0x91, 0xDC, 0xE5, 0x69, 0xF0, 0x61, 0xE6, 0x91, 0x51, 0xE0, 0x64, 0x06, 0x60, -+0x02, 0x61, 0xEB, 0xF5, 0x6B, 0xF5, 0x6C, 0x12, 0xD4, 0xEA, 0xE0, 0x54, 0x07, 0x78, 0x88, 0xF6, -+0xD3, 0xE5, 0x6E, 0x94, 0xE8, 0xE5, 0x6D, 0x94, 0x03, 0x40, 0x06, 0x78, 0x86, 0x76, 0x05, 0x80, -+0x15, 0xD3, 0xE5, 0x6E, 0x94, 0xFA, 0xE5, 0x6D, 0x94, 0x00, 0x40, 0x06, 0x78, 0x86, 0x76, 0x02, -+0x80, 0x04, 0xE4, 0x78, 0x86, 0xF6, 0xE5, 0x6E, 0xAE, 0x6D, 0x78, 0x86, 0x86, 0x00, 0x08, 0x80, -+0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x82, 0x06, 0xE4, 0x91, 0xD5, 0x90, -+0x95, 0xBA, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x78, 0x87, 0xF6, 0x90, 0x95, 0xB4, 0x12, 0x86, -+0x3D, 0x78, 0x87, 0xE6, 0xFD, 0x75, 0xF0, 0x02, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x03, -+0x3E, 0xAE, 0xF0, 0x78, 0x86, 0x86, 0x00, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, -+0xF9, 0xFF, 0xED, 0x90, 0x82, 0x01, 0x91, 0xD5, 0xEF, 0x25, 0x6C, 0xF5, 0x6C, 0xEE, 0x35, 0x6B, -+0xF5, 0x6B, 0xC3, 0x90, 0x95, 0xBB, 0xE0, 0x95, 0x6C, 0x90, 0x95, 0xBA, 0xE0, 0x95, 0x6B, 0x40, -+0x07, 0x78, 0x87, 0x06, 0xE6, 0xB4, 0x05, 0xB3, 0x78, 0x87, 0xE6, 0xC3, 0x13, 0xF6, 0xFD, 0x08, -+0xE6, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x08, 0xF6, 0xD3, 0x9D, 0x40, -+0x07, 0xE6, 0x79, 0x87, 0x97, 0xF6, 0x80, 0x04, 0xE4, 0x78, 0x89, 0xF6, 0x91, 0x2C, 0xE0, 0xC3, -+0x13, 0xFF, 0x78, 0x89, 0xE6, 0xC4, 0x33, 0x54, 0xE0, 0x2F, 0xFF, 0x91, 0x2C, 0xEF, 0xF0, 0x91, -+0x2C, 0xE0, 0xC3, 0x94, 0xC0, 0x40, 0x05, 0x91, 0x2C, 0x74, 0xC0, 0xF0, 0x91, 0x2C, 0xE0, 0x24, -+0x1F, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x06, 0xCE, 0xA2, 0xE7, 0x13, 0xCE, 0x13, 0xD8, 0xF8, -+0x78, 0x89, 0xF6, 0xE6, 0x25, 0xE0, 0xF6, 0x70, 0x03, 0xFF, 0x80, 0x05, 0x78, 0x89, 0xE6, 0x14, -+0xFF, 0x78, 0x88, 0xA6, 0x07, 0xD3, 0x90, 0x95, 0xB8, 0xE0, 0x94, 0x03, 0x90, 0x95, 0xB7, 0xE0, -+0x94, 0x00, 0x40, 0x02, 0xE4, 0xF6, 0x78, 0x88, 0x12, 0xD4, 0xD4, 0x91, 0x51, 0xE0, 0xFF, 0xD3, -+0x94, 0x05, 0x50, 0x05, 0xEF, 0x04, 0xFF, 0x80, 0x02, 0x7F, 0x00, 0x91, 0x51, 0xEF, 0xF0, 0xE4, -+0xF5, 0x6B, 0xF5, 0x6C, 0x91, 0xCE, 0xE4, 0x90, 0x95, 0xC2, 0xF0, 0x12, 0xA3, 0x72, 0xA3, 0xF0, -+0x7B, 0x01, 0xFA, 0x7D, 0xFF, 0x7F, 0x01, 0x12, 0xD4, 0x4F, 0x05, 0x67, 0x02, 0xD5, 0x89, 0x22, -+0x74, 0xA6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0x4F, 0x25, 0x67, -+0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0x76, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, -+0x8E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0xF6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, -+0x22, 0x74, 0x76, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0xE5, 0x69, 0x25, -+0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0x90, 0x95, 0xC2, 0xE5, 0x6B, -+0xF0, 0xA3, 0xE5, 0x6C, 0xF0, 0xE5, 0x69, 0x90, 0x81, 0x9D, 0x93, 0xFF, 0x22, 0x74, 0xD6, 0x25, -+0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xE0, 0x22, 0xF0, 0x90, 0x95, 0xB4, 0x12, 0x86, -+0x3D, 0x90, 0x00, 0x06, 0x12, 0x03, 0x3E, 0xFF, 0xAE, 0xF0, 0x90, 0x00, 0x08, 0x12, 0x03, 0x3E, -+0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, 0x90, 0x00, 0x04, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xEE, 0x35, -+0xF0, 0x90, 0x95, 0xC6, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x87, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, -+0x96, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x95, 0xC8, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x7D, 0x01, -+0xAF, 0x67, 0x02, 0x61, 0xF7, 0x93, 0xFD, 0x7C, 0x00, 0x02, 0x02, 0x80, 0x74, 0xA6, 0x25, 0x67, -+0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x74, 0x5F, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, -+0x8D, 0xF5, 0x83, 0x22, 0x74, 0xE6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, -+0x90, 0x00, 0x04, 0x02, 0x03, 0x3E, 0x90, 0x00, 0x06, 0x02, 0x03, 0x3E, 0x90, 0x00, 0x08, 0x02, -+0x03, 0x3E, 0x90, 0x95, 0xC6, 0xE4, 0xF0, 0xA3, 0x22, 0x90, 0x95, 0xC4, 0xE4, 0xF0, 0xA3, 0x22, -+0xE5, 0x6D, 0xF0, 0xA3, 0xE5, 0x6E, 0xF0, 0x22, 0x90, 0x95, 0xB4, 0x12, 0x86, 0x3D, 0x02, 0x03, -+0x13, 0x90, 0x95, 0xC4, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xEF, 0x64, 0x13, 0x60, 0x04, 0xEF, -+0xB4, 0x0B, 0x05, 0x90, 0x88, 0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, 0x60, 0x04, 0xEF, 0xB4, 0x0A, -+0x05, 0x90, 0x88, 0xE4, 0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, 0xEF, 0xB4, 0x09, 0x05, 0x90, -+0x88, 0xE5, 0x80, 0x03, 0x90, 0x88, 0xE2, 0xE0, 0xF5, 0x61, 0xAF, 0x61, 0x22, 0x90, 0x8A, 0x75, -+0x12, 0x88, 0xD0, 0x90, 0x8A, 0xE5, 0x12, 0x90, 0x40, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x01, -+0xCF, 0x12, 0xA7, 0xE6, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, -+0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, -+0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, -+0x03, 0x12, 0x7B, 0x2E, 0x80, 0xFE, 0x22, 0x90, 0x93, 0x58, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x93, -+0xD8, 0xE0, 0x60, 0x05, 0x7F, 0x07, 0x12, 0x9F, 0xF5, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x96, 0x8D, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x96, 0x8C, 0xEF, 0xF0, 0xA3, 0xA3, -+0xE0, 0xFD, 0x12, 0x7B, 0xBD, 0x90, 0x96, 0x97, 0x12, 0x04, 0x31, 0x90, 0x96, 0x8F, 0x12, 0x04, -+0xB8, 0x12, 0x03, 0xCD, 0x90, 0x96, 0x97, 0x12, 0x8F, 0xBA, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x96, 0x8F, 0x12, 0x04, 0xB8, 0x90, 0x96, 0x93, 0x12, 0x8F, 0xBA, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0x90, 0x96, 0x9B, 0x12, 0x04, 0x31, 0x90, -+0x96, 0x8D, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x96, 0x9B, 0x12, 0x04, 0xB8, 0x90, 0x8B, 0x9F, -+0x12, 0x04, 0x31, 0x90, 0x96, 0x8C, 0xE0, 0xFF, 0xD0, 0x05, 0x12, 0x79, 0x53, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x96, 0x93, 0x12, 0x04, 0x31, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0xB1, 0xCA, -+0x90, 0x96, 0x8F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFE, 0xFD, 0xEF, 0xB4, -+0x01, 0x0D, 0xEB, 0xB4, 0x02, 0x03, 0x0D, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7D, 0x02, 0xAF, -+0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4D, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, -+0xE1, 0xF0, 0x90, 0x88, 0xBD, 0xE0, 0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xBE, 0x12, 0xB0, 0xB7, -+0x12, 0x9B, 0xF9, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x16, 0x90, 0x93, 0x3B, 0xE0, 0x20, 0xE0, 0x0F, -+0x90, 0x86, 0x0C, 0x12, 0x88, 0xD0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x12, 0x97, 0x91, 0x22, -+0x90, 0x95, 0x2F, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xEF, -+0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, 0x08, 0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, 0x6F, -+0xF1, 0x5B, 0xF1, 0x54, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, 0x2F, -+0x12, 0xBF, 0x84, 0xE0, 0xFE, 0x74, 0xE5, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0x12, 0xB6, 0xCF, -+0xB4, 0x04, 0xEA, 0x90, 0x96, 0xE6, 0x12, 0x8D, 0x68, 0x12, 0xCF, 0xCA, 0x90, 0x96, 0xE5, 0x12, -+0x8D, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0xE7, -+0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x8D, 0x68, 0x78, -+0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, 0x22, 0x90, 0x07, 0xC0, 0xEF, 0xF0, -+0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, -+0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, 0xFF, 0x7F, 0xFF, 0x80, 0x25, 0xF1, 0x5B, 0xF1, -+0x54, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0x12, 0xBF, -+0x84, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, 0x12, 0xBF, 0x84, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, -+0x3E, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, -+0xAC, 0x06, 0xEF, 0xF1, 0xCD, 0xF1, 0x54, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, 0x54, -+0x03, 0x24, 0xC8, 0x12, 0xBF, 0x84, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x54, 0xFC, 0x90, -+0x07, 0xC0, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, -+0xFC, 0xFF, 0xF1, 0xCF, 0xE4, 0xFB, 0x90, 0x96, 0xD3, 0x12, 0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, -+0xA4, 0xF9, 0xF8, 0x12, 0x03, 0xEB, 0x74, 0xC4, 0x2B, 0x12, 0xBF, 0x84, 0xEF, 0xF0, 0x0B, 0xEB, -+0xB4, 0x04, 0xE3, 0x90, 0x07, 0xC2, 0x12, 0xB7, 0x4F, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xF7, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xDF, 0xCD, 0x7A, 0x00, 0x90, 0x96, 0xF8, 0xE0, 0x54, 0x03, 0xFB, -+0x70, 0x0A, 0x90, 0x07, 0xC4, 0x11, 0x5C, 0x74, 0x03, 0xF0, 0x80, 0x0E, 0xEB, 0x64, 0x02, 0x4A, -+0x70, 0x15, 0x90, 0x07, 0xC6, 0x11, 0x5C, 0x74, 0x0C, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, -+0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xED, 0xF0, 0xEC, 0xA3, -+0xF0, 0x90, 0x07, 0xC2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xF9, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xDF, 0xCD, 0x11, 0xD1, 0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, 0xF0, -+0x90, 0x07, 0xC2, 0x74, 0x01, 0xF0, 0x80, 0x37, 0xEF, 0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, 0x07, -+0xC5, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x02, 0xF0, 0x80, 0x24, 0x11, 0xD1, 0x64, 0x02, 0x70, -+0x0D, 0x90, 0x07, 0xC6, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, 0x64, -+0x03, 0x4E, 0x70, 0x0B, 0x90, 0x07, 0xC7, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, 0x90, -+0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x7E, 0x00, 0x90, 0x96, 0xFA, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0x12, 0x7A, 0x65, 0xEF, 0x70, -+0x03, 0x12, 0x97, 0x42, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, -+0x30, 0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x12, 0x75, 0x0F, -+0x10, 0x80, 0x2E, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x0F, 0x01, 0x80, 0x21, -+0x90, 0x88, 0x31, 0x12, 0xA5, 0xF2, 0x30, 0xE0, 0x05, 0x75, 0x0F, 0x02, 0x80, 0x13, 0x90, 0x88, -+0x38, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x0F, 0x08, 0x80, 0x05, 0x12, 0xB7, 0x37, 0x80, -+0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x0F, 0xF0, 0x7F, 0x00, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, -+0xE0, 0x1E, 0x90, 0x88, 0xAF, 0xE0, 0x60, 0x05, 0x75, 0x10, 0x40, 0x21, 0xEE, 0x90, 0x88, 0x38, -+0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, 0x55, -+0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x10, 0x01, 0x80, 0x71, 0x90, 0x88, 0x3A, -+0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x10, 0x02, 0x80, 0x63, 0x90, 0x88, 0x38, 0xE0, 0xFE, -+0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x10, 0x04, 0x80, 0x54, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x10, -+0x08, 0x80, 0x4B, 0x90, 0x88, 0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x10, 0x10, 0x80, 0x3F, 0x90, -+0x88, 0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x10, 0x20, 0x80, 0x2F, 0x90, -+0x88, 0x9C, 0xE0, 0x60, 0x05, 0x75, 0x10, 0x80, 0x80, 0x24, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, -+0x05, 0x75, 0x10, 0x11, 0x80, 0x18, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, -+0xFF, 0xBF, 0x80, 0x05, 0x75, 0x10, 0x12, 0x80, 0x05, 0x12, 0xB7, 0x37, 0x80, 0x0E, 0x90, 0x01, -+0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x10, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, -+0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x51, 0x69, 0x40, 0x40, 0x90, 0x88, 0x50, 0xE0, 0x04, -+0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, 0x90, 0x88, 0x50, 0xE0, 0xD3, 0x9F, 0x50, 0x2D, 0x90, 0x88, -+0x48, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3F, 0x12, 0xA5, 0xFB, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, -+0x90, 0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, 0xF0, 0xFB, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, -+0xE0, 0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x22, 0x90, 0x88, 0x3F, 0xE0, -+0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, -+0x3F, 0xE0, 0xD3, 0x9F, 0x22, 0xE4, 0xFE, 0x74, 0xED, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -+0x83, 0xE4, 0xF0, 0x74, 0x8D, 0x2E, 0x12, 0xCC, 0x52, 0x74, 0xFF, 0xF0, 0x0E, 0xEE, 0xB4, 0xA0, -+0xE6, 0xE4, 0x90, 0x88, 0x4D, 0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, 0xF0, 0xEF, 0xB4, -+0x01, 0x07, 0xA3, 0x74, 0xA0, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, -+0xFB, 0x90, 0x93, 0x58, 0xE0, 0xFE, 0xC4, 0x54, 0x0F, 0x90, 0x96, 0xE4, 0xF0, 0x22, 0xFF, 0x90, -+0x95, 0xC2, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, -+0x13, 0x54, 0x1F, 0x22, 0x12, 0x04, 0xB8, 0x90, 0x05, 0x84, 0xEF, 0xF0, 0x7D, 0x20, 0xE4, 0xFF, -+0x02, 0x7C, 0x05, 0x90, 0x01, 0x34, 0x74, 0x40, 0xF0, 0xFD, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x43, -+0x64, 0x08, 0x22, 0xE0, 0x54, 0x03, 0x90, 0x92, 0x80, 0xF0, 0x7B, 0x01, 0xAF, 0x61, 0x02, 0x75, -+0x80, 0x90, 0x96, 0x16, 0x12, 0x86, 0x46, 0x7A, 0x93, 0x79, 0x29, 0x12, 0xBF, 0xA7, 0xEF, 0x22, -+0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x22, 0xE0, 0x54, -+0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x22, 0xE0, 0x90, 0x01, 0xBA, -+0xF0, 0x90, 0x88, 0x38, 0xE0, 0x90, 0x01, 0xBB, 0x22, 0x12, 0x04, 0x31, 0x90, 0x96, 0xB1, 0x12, -+0x04, 0xB8, 0x90, 0x96, 0xB9, 0x22, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, 0xC4, 0x13, 0x13, 0x54, -+0x03, 0x22, 0xF0, 0x74, 0xC6, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xB6, -+0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0xC4, 0x13, -+0x22, 0x90, 0x93, 0x58, 0xE0, 0xFE, 0xC3, 0x13, 0x54, 0x07, 0x22, 0x90, 0x95, 0x36, 0xE0, 0x04, -+0xF0, 0x22, 0xFB, 0x7A, 0x04, 0xF9, 0xF8, 0x02, 0x85, 0xC8, 0x12, 0x04, 0xB8, 0x90, 0x05, 0x88, -+0xEF, 0xF0, 0x22, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x22, 0xF0, 0xA3, 0xE4, 0xF0, -+0xA3, 0xE5, 0x76, 0xF0, 0x22, 0x12, 0x02, 0x06, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x88, -+0x2C, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x25, 0xE0, -+0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0x22, 0x90, 0x00, 0x02, 0x12, 0x03, 0x3E, 0xFF, 0x22, 0xF5, 0x82, -+0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x7F, 0xF3, -+0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF2, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF6, 0x7E, 0x01, -+0x02, 0x5F, 0xA6, 0x7F, 0xF5, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF4, 0x7E, 0x01, 0x02, 0x5F, -+0xA6, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0x7D, 0x03, 0x7F, 0x02, 0x02, 0x7C, 0x05, -+0xFC, 0x2A, -+}; -+u32 array_length_mp_8723d_fw_nic = 25650; -+ -+ -+#endif -+ -+void -+ODM_ReadFirmware_MP_8723D_FW_NIC( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)array_mp_8723d_fw_nic; -+#else -+ ODM_MoveMemory(pDM_Odm, pFirmware, array_mp_8723d_fw_nic, array_length_mp_8723d_fw_nic); -+#endif -+ *pFirmwareSize = array_length_mp_8723d_fw_nic; -+} -+ -+#ifndef LOAD_FW_HEADER_FROM_DRIVER -+u8 array_mp_8723d_fw_wowlan[] = { -+0xD1, 0x23, 0x30, 0x00, 0x10, 0x00, 0x00, 0x00, 0x05, 0x16, 0x18, 0x17, 0x4A, 0x70, 0x02, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x02, 0x87, 0xD0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xBA, 0x0E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xC8, 0x4C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xB9, 0x82, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xBF, 0xE7, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xC7, 0xF6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, -+0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x88, 0x60, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x88, 0x60, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x83, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, -+0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xEF, 0x2B, 0xFF, -+0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, -+0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, -+0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, -+0xFC, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE0, 0xFB, -+0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, -+0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, -+0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, -+0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xE3, 0xF5, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, 0xDF, -+0xF5, 0x80, 0x67, 0xE3, 0xF5, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, 0x5A, -+0x87, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x52, 0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, 0xE2, -+0x08, 0xB5, 0xF0, 0x46, 0xDF, 0xF6, 0x80, 0x42, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE0, -+0xA3, 0xB5, 0xF0, 0x36, 0xDF, 0xF6, 0x80, 0x32, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE4, -+0x93, 0xA3, 0xB5, 0xF0, 0x25, 0xDF, 0xF5, 0x80, 0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, -+0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x14, 0xDF, 0xF5, 0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, -+0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x02, 0xDF, 0xF4, 0x02, 0x87, 0x55, 0x80, 0x87, 0x80, -+0xE9, 0x80, 0x90, 0x80, 0xD4, 0x80, 0x3E, 0x80, 0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, 0x80, -+0xB7, 0x80, 0x8D, 0x80, 0xA3, 0x80, 0x51, 0x80, 0x74, 0x80, 0x3C, 0x02, 0x87, 0x61, 0x89, 0x82, -+0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, -+0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, 0xDF, -+0xE3, 0xDE, 0xE1, 0x80, 0x70, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, -+0xB5, 0xF0, 0x62, 0xDF, 0xF4, 0x80, 0x5E, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE6, -+0x08, 0xB5, 0xF0, 0x51, 0xDF, 0xF5, 0x80, 0x4D, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, -+0xE2, 0x08, 0xB5, 0xF0, 0x40, 0xDF, 0xF5, 0x80, 0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, -+0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x2E, 0xDF, 0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, 0x89, -+0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, -+0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, 0xDF, -+0xE4, 0xDE, 0xE2, 0x80, 0x00, 0x7F, 0xFF, 0xB5, 0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, 0x01, -+0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, -+0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xD5, -+0xDF, 0xE5, 0xDE, 0xE3, 0x80, 0xCF, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, -+0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, -+0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xAF, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, 0x60, -+0x01, 0x0E, 0x4E, 0x60, 0xAB, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, 0xEB, -+0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x8E, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x86, 0x9D, 0x73, -+0x02, 0x88, 0x0E, 0x02, 0x83, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, -+0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, -+0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, -+0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x88, -+0x53, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, -+0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, -+0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, -+0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, -+0xE7, 0x80, 0xBE, 0x41, 0x9A, 0x49, 0x00, 0x41, 0x99, 0x07, 0x00, 0x41, 0x98, 0x86, 0x00, 0x00, -+0x93, 0xB0, 0xB0, 0xEE, 0xAF, 0x59, 0x90, 0x9A, 0x46, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x85, 0x27, -+0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x9A, 0x46, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, -+0x22, 0x12, 0xE5, 0x6B, 0x2E, 0x90, 0x86, 0xB4, 0xD1, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB5, -+0xF1, 0x1A, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, 0xF0, 0xF1, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x86, -+0xB7, 0xF0, 0xF1, 0xE2, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB8, 0xD1, 0x1B, 0xFF, 0xED, 0x2F, 0x90, -+0x86, 0xB9, 0x12, 0xE5, 0xB4, 0x90, 0x86, 0xBA, 0xF0, 0x22, 0x90, 0x97, 0x2F, 0x12, 0x85, 0xF7, -+0x90, 0x97, 0x2E, 0xEF, 0xF0, 0x12, 0x86, 0x00, 0x89, 0x35, 0x00, 0x89, 0x39, 0x01, 0x89, 0x3D, -+0x03, 0x89, 0x42, 0x04, 0x89, 0x47, 0x12, 0x89, 0x4C, 0x14, 0x89, 0x51, 0x20, 0x89, 0x55, 0x25, -+0x89, 0x5A, 0x27, 0x89, 0x5F, 0x29, 0x89, 0x64, 0x2A, 0x89, 0x69, 0x60, 0x89, 0x6D, 0x61, 0x89, -+0x72, 0x62, 0x89, 0x77, 0x63, 0x89, 0x7C, 0x64, 0x89, 0x81, 0x65, 0x89, 0x86, 0x66, 0x89, 0x8B, -+0x67, 0x89, 0x90, 0x68, 0x89, 0x95, 0x69, 0x89, 0x9A, 0x6B, 0x89, 0x9F, 0x6C, 0x89, 0xA4, 0x6D, -+0x89, 0xA9, 0x6E, 0x89, 0xAE, 0x6F, 0x89, 0xB3, 0x70, 0x89, 0xBD, 0x80, 0x89, 0xB8, 0x81, 0x89, -+0xC1, 0x82, 0x89, 0xC6, 0x83, 0x89, 0xCB, 0x84, 0x89, 0xD5, 0x86, 0x89, 0xD0, 0x88, 0x89, 0xDA, -+0xC3, 0x00, 0x00, 0x89, 0xDF, 0x31, 0xEF, 0x01, 0x81, 0x31, 0xEF, 0x21, 0xF5, 0x31, 0xEF, 0x02, -+0xE0, 0x29, 0x31, 0xEF, 0x02, 0x95, 0xF2, 0x31, 0xEF, 0x02, 0x90, 0x01, 0x31, 0xEF, 0x02, 0x97, -+0xEA, 0x31, 0xEF, 0xA1, 0x1B, 0x31, 0xEF, 0x02, 0x97, 0xF9, 0x31, 0xEF, 0x02, 0x9F, 0xF1, 0x31, -+0xEF, 0x02, 0xAF, 0xF1, 0x31, 0xEF, 0x02, 0xA7, 0xFB, 0x31, 0xEF, 0x41, 0xC3, 0x31, 0xEF, 0x02, -+0x77, 0x4F, 0x31, 0xEF, 0x02, 0x7C, 0x60, 0x31, 0xEF, 0x02, 0x7A, 0xC6, 0x31, 0xEF, 0x02, 0x5D, -+0x36, 0x31, 0xEF, 0x02, 0x7B, 0xE9, 0x31, 0xEF, 0x02, 0x70, 0x33, 0x31, 0xEF, 0x02, 0x48, 0xC9, -+0x31, 0xEF, 0x02, 0x79, 0xF3, 0x31, 0xEF, 0x02, 0x3F, 0xD4, 0x31, 0xEF, 0x02, 0x51, 0x7B, 0x31, -+0xEF, 0x02, 0x79, 0x30, 0x31, 0xEF, 0x02, 0x57, 0xF2, 0x31, 0xEF, 0x02, 0x74, 0x8D, 0x31, 0xEF, -+0x02, 0x78, 0x9A, 0x31, 0xEF, 0x02, 0x5E, 0x0B, 0x31, 0xEF, 0x02, 0xA6, 0x0B, 0x31, 0xEF, 0xC1, -+0x36, 0x31, 0xEF, 0x02, 0xE5, 0x19, 0x31, 0xEF, 0x02, 0xE5, 0x2F, 0x31, 0xEF, 0x02, 0xE5, 0x78, -+0x31, 0xEF, 0x02, 0xE5, 0xC1, 0x31, 0xEF, 0x02, 0xD4, 0x06, 0x31, 0xEF, 0x02, 0xB0, 0x07, 0x90, -+0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x97, 0x2E, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, -+0x97, 0x2F, 0x02, 0x85, 0xEE, 0x90, 0x97, 0x32, 0x12, 0x85, 0xF7, 0x90, 0x95, 0xD9, 0xE0, 0x70, -+0x0D, 0x51, 0xBD, 0xF1, 0xF9, 0x30, 0xE0, 0x06, 0x90, 0x95, 0xDF, 0x74, 0x01, 0xF0, 0x90, 0x95, -+0xDB, 0xE0, 0x70, 0x12, 0x51, 0xBD, 0x12, 0x02, 0x06, 0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x06, -+0x90, 0x95, 0xE0, 0x74, 0x01, 0xF0, 0x51, 0xBD, 0xD1, 0x14, 0xFF, 0x90, 0x97, 0x36, 0xF0, 0x12, -+0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x51, 0xBD, 0xF1, 0x1B, 0x90, 0x97, 0x37, 0xF0, 0x80, -+0x05, 0x90, 0x97, 0x37, 0xEF, 0xF0, 0x90, 0x97, 0x36, 0xE0, 0x90, 0x97, 0x35, 0xF0, 0x90, 0x97, -+0x37, 0xE0, 0xFE, 0x90, 0x97, 0x35, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x3B, 0x51, 0xBD, 0x12, 0x02, -+0x06, 0x54, 0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x97, 0x35, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, -+0x90, 0x97, 0x35, 0x70, 0x07, 0xE0, 0xFF, 0x12, 0x96, 0xC7, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0x97, -+0x82, 0x90, 0x95, 0xE0, 0xE0, 0x60, 0x08, 0x90, 0x97, 0x35, 0xE0, 0xFF, 0x12, 0x96, 0xC7, 0x90, -+0x97, 0x35, 0xE0, 0x04, 0xF0, 0x80, 0xB7, 0x90, 0x05, 0x5E, 0xE4, 0xF0, 0x90, 0x97, 0x36, 0xE0, -+0x70, 0x1A, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x13, 0x90, 0x86, 0x0C, 0xD1, 0x2C, 0x90, 0x8A, -+0xED, 0xD1, 0x2C, 0x12, 0xBF, 0xC3, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x97, 0x32, -+0x02, 0x85, 0xEE, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xC3, 0x9D, 0x75, 0x48, 0x05, -+0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9D, 0x12, 0x69, 0xF5, 0x51, 0xBD, 0x12, 0x02, 0x06, 0x20, 0xE0, -+0x02, 0x81, 0x4E, 0x90, 0x05, 0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, 0x13, 0x90, 0x88, -+0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x13, 0xD1, 0x14, 0x90, 0x88, -+0x9E, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF1, 0x1A, 0x90, 0x88, 0x9F, 0xF0, 0x80, 0x48, 0xD1, -+0x14, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x14, 0xEF, 0xC3, 0x94, 0x03, 0x50, 0x07, 0x90, 0x88, 0x9E, -+0x74, 0x03, 0x80, 0x0C, 0xD1, 0x14, 0x90, 0x88, 0x9E, 0x80, 0x05, 0x90, 0x88, 0x9E, 0x74, 0x2A, -+0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0xF1, 0x1B, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, -+0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, -+0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, 0xC1, 0x8B, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, -+0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, -+0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, -+0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, -+0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, 0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0xF0, 0x51, -+0xBD, 0xF1, 0x13, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x35, 0x90, 0x88, 0x9D, 0xE0, 0xC3, -+0x13, 0x20, 0xE0, 0x05, 0xF1, 0xDA, 0x30, 0xE0, 0x27, 0xF1, 0xF0, 0x30, 0xE0, 0x08, 0x90, 0x88, -+0xDF, 0xE0, 0x60, 0x08, 0x80, 0x0B, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, 0x75, 0x0D, 0x01, 0x80, -+0x03, 0xE4, 0xF5, 0x0D, 0x90, 0x8A, 0xF3, 0xB1, 0x12, 0x7D, 0x02, 0xAF, 0x0D, 0x12, 0x04, 0x7E, -+0x90, 0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, -+0x54, 0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0xB1, 0x12, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, -+0x7E, 0x12, 0xF0, 0x40, 0x74, 0x11, 0xF0, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xA5, -+0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, 0x90, 0x88, 0xA5, 0xE0, -+0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, 0x88, 0xA5, 0xE0, 0xB4, -+0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x07, -+0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, 0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, 0x80, 0x67, 0x51, 0xBD, -+0xF1, 0x13, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x02, 0x80, 0x0D, 0xF1, -+0xF0, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x0E, 0x90, 0x8A, 0xF1, 0xD1, -+0x2C, 0x90, 0x89, 0x04, 0xE0, 0x30, 0xE0, 0x04, 0x7D, 0xAC, 0x80, 0x02, 0x7D, 0x2C, 0x7F, 0x40, -+0x12, 0x7B, 0x2E, 0x51, 0xBD, 0xF1, 0x13, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, -+0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x90, 0x8A, 0xF3, 0xB1, 0x12, 0xAD, 0x0E, 0x7F, -+0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0xB1, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x12, -+0xF0, 0x40, 0x74, 0x43, 0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0x88, 0xAF, -+0xF0, 0x90, 0x88, 0xA0, 0xF1, 0xDA, 0x30, 0xE0, 0x09, 0x90, 0x88, 0xD0, 0xE0, 0x44, 0x02, 0xF0, -+0x80, 0x11, 0x90, 0x8A, 0x97, 0xB1, 0x12, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x88, 0xD0, 0xE0, -+0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, 0xB1, 0x12, 0x7F, 0x03, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, -+0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, -+0x8A, 0x79, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x12, 0xEF, 0xFA, 0xFF, 0x54, -+0x7F, 0x90, 0x88, 0x36, 0xF0, 0xEF, 0xF1, 0xDB, 0xA3, 0xD1, 0x13, 0xFD, 0x54, 0xF0, 0xC4, 0x54, -+0x0F, 0xFF, 0x90, 0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, 0xF0, 0xF1, 0x13, 0xFC, 0x54, 0x01, 0x25, -+0xE0, 0xFF, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, 0xC3, 0x13, 0xFF, -+0x90, 0x88, 0x33, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xA3, -+0xE0, 0x54, 0x0F, 0xF1, 0x19, 0x90, 0x88, 0x35, 0xF0, 0xF1, 0xE2, 0xFD, 0x90, 0x8A, 0x89, 0xB1, -+0x12, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x99, 0x07, 0xE0, 0x60, 0x08, 0x12, 0xEF, 0xD8, 0xB1, -+0x12, 0x12, 0xBF, 0xA4, 0x51, 0xBD, 0xD1, 0x1C, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x88, 0x9B, 0x12, -+0xD7, 0xBD, 0xD1, 0x1A, 0xFE, 0x12, 0xEF, 0xC6, 0x90, 0x88, 0x9B, 0x12, 0xD7, 0xA9, 0xD1, 0x1A, -+0xFE, 0x12, 0xEF, 0xCF, 0x90, 0x88, 0x9B, 0xF0, 0xEE, 0x12, 0xF0, 0x30, 0xD1, 0x1A, 0x54, 0x40, -+0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, 0x88, 0x9B, 0xF0, 0x12, 0x97, 0xA2, 0x20, 0xE0, 0x2E, 0xEF, -+0xC3, 0x13, 0x20, 0xE0, 0x0B, 0x75, 0x0E, 0x01, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x0B, 0x80, 0x0E, -+0xE4, 0xF5, 0x0E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, 0xE4, 0xF5, 0x0D, 0x80, 0x03, 0x75, 0x0D, -+0x01, 0x90, 0x8A, 0xF3, 0xB1, 0x12, 0xAD, 0x0E, 0xAF, 0x0D, 0x12, 0x04, 0x7E, 0x51, 0xBD, 0x12, -+0x5C, 0x5F, 0x90, 0x88, 0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFB, 0xF0, -+0x12, 0xD0, 0x4B, 0xF0, 0x90, 0x88, 0x36, 0x12, 0xEE, 0x59, 0x12, 0xBC, 0x46, 0x90, 0x01, 0xBE, -+0xF0, 0x22, 0x4E, 0xF0, 0x90, 0x00, 0x01, 0x02, 0x02, 0x1F, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, -+0x02, 0x1F, 0x7D, 0xFF, 0x7F, 0xFF, 0x12, 0xC4, 0xCF, 0x90, 0x8A, 0xFD, 0xE0, 0xFE, 0xA3, 0xE0, -+0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xEF, 0xFA, -+0x20, 0xE0, 0x05, 0x12, 0xE0, 0x8D, 0xE1, 0x0E, 0x51, 0xBD, 0x12, 0x97, 0x9A, 0x90, 0x93, 0x27, -+0x12, 0xD7, 0xBD, 0x12, 0xA7, 0x17, 0x12, 0xEF, 0xC6, 0x90, 0x93, 0x27, 0xF0, 0xEE, 0x54, 0x08, -+0xFE, 0xEF, 0x54, 0xF7, 0x12, 0xA7, 0x16, 0x12, 0xEF, 0xCF, 0x90, 0x93, 0x27, 0x12, 0xA7, 0x0E, -+0x12, 0xF0, 0x03, 0x90, 0x93, 0x27, 0x12, 0xF0, 0x0C, 0xD1, 0x12, 0x54, 0x80, 0xFF, 0x90, 0x93, -+0x28, 0xE0, 0x54, 0x7F, 0x4F, 0xF0, 0xF1, 0xF9, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, -+0x04, 0xF0, 0x51, 0xBD, 0xF1, 0xF0, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, -+0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x02, 0x08, 0x90, 0x93, 0x28, 0xF1, 0xDA, 0x20, 0xE0, 0x41, 0xD1, -+0x14, 0x54, 0x7F, 0xFF, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x80, 0xF1, 0x19, 0x90, 0x93, 0x29, 0xF0, -+0xF1, 0x13, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x2A, 0x12, 0xE0, 0x49, 0x54, 0xFE, 0xFF, 0xEE, -+0x54, 0x01, 0x4F, 0xF0, 0xF1, 0xE2, 0x54, 0x04, 0xFF, 0x90, 0x93, 0x2B, 0xE0, 0x54, 0xFB, 0x4F, -+0xF0, 0x12, 0xAA, 0x33, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0xA8, 0xDB, -+0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x01, 0x17, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x95, -+0x5F, 0x74, 0x05, 0xF0, 0x12, 0x97, 0xC2, 0x7A, 0x94, 0x79, 0x3E, 0x12, 0x04, 0x80, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0x00, 0x03, 0x02, 0x02, 0x1F, 0x4F, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x02, -+0x1F, 0x12, 0x02, 0x06, 0x90, 0x06, 0x74, 0xD1, 0x13, 0x90, 0x06, 0x75, 0xF1, 0x1A, 0x90, 0x06, -+0x76, 0xF0, 0xF1, 0x13, 0x90, 0x06, 0x77, 0xF0, 0x90, 0x06, 0x70, 0xEF, 0xF0, 0xA3, 0xE4, 0xF0, -+0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, 0x98, -+0x70, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x85, 0xF7, 0x90, 0x98, 0x72, 0x12, 0xC3, 0xA6, -+0x12, 0xEF, 0x17, 0x24, 0x02, 0x12, 0xEF, 0x54, 0x24, 0x04, 0x12, 0xEF, 0x0E, 0x24, 0x03, 0x12, -+0xEF, 0x54, 0x24, 0x08, 0x12, 0xEF, 0x0E, 0x24, 0x04, 0x12, 0xEF, 0x54, 0x24, 0x0C, 0x12, 0xEF, -+0x0E, 0x24, 0x05, 0xF1, 0xE8, 0x7A, 0x98, 0x79, 0x76, 0xF1, 0x21, 0x90, 0x98, 0x71, 0xE0, 0xFD, -+0xB4, 0x02, 0x08, 0x90, 0x98, 0x70, 0xE0, 0x44, 0x48, 0x80, 0x0A, 0xED, 0xB4, 0x04, 0x0A, 0x90, -+0x98, 0x70, 0xE0, 0x44, 0x50, 0x90, 0x98, 0x76, 0xF0, 0x90, 0x98, 0x77, 0x74, 0x80, 0xF0, 0xA3, -+0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0x12, 0xEF, 0x23, 0xF1, 0xE8, 0x7A, 0x98, 0x79, 0x76, 0xF1, 0x21, -+0x90, 0x98, 0x76, 0x74, 0xFF, 0x12, 0x94, 0x38, 0x12, 0xEF, 0x23, 0x04, 0xF1, 0xE8, 0x7A, 0x98, -+0x79, 0x76, 0xF1, 0x21, 0x90, 0x06, 0x72, 0xE4, 0xF0, 0x22, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, -+0x01, 0x22, 0x90, 0x00, 0x04, 0x02, 0x02, 0x1F, 0xFF, 0x90, 0x98, 0x75, 0xF0, 0x7B, 0x01, 0x22, -+0x12, 0x02, 0x06, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x12, 0x02, 0x06, 0x13, 0x13, 0x54, 0x3F, -+0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0x03, 0xF0, 0xBF, 0x01, 0x07, 0x11, 0x14, 0xE4, 0x90, -+0x93, 0x03, 0xF0, 0x22, 0x11, 0xA6, 0x71, 0xA2, 0xBF, 0x01, 0x06, 0x90, 0x97, 0x32, 0xE0, 0xA3, -+0xF0, 0x11, 0xA6, 0x71, 0x9B, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x32, 0xE0, 0x90, 0x97, 0x34, 0xF0, -+0x11, 0xA6, 0x71, 0xA9, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x32, 0xE0, 0x90, 0x97, 0x35, 0xF0, 0x11, -+0xA6, 0x11, 0xAD, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x32, 0xE0, 0x90, 0x97, 0x36, 0xF0, 0x11, 0xA6, -+0x71, 0x94, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x32, 0xE0, 0x90, 0x97, 0x37, 0xF0, 0x90, 0x97, 0x33, -+0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x97, 0x3B, 0xF0, 0x90, 0x97, -+0x37, 0xE0, 0x90, 0x97, 0x3C, 0xF0, 0x90, 0x97, 0x3D, 0x74, 0x12, 0xF0, 0x90, 0x97, 0x5F, 0x74, -+0x05, 0xF0, 0x90, 0x97, 0x3F, 0xEF, 0xF1, 0xBA, 0x90, 0x97, 0x3B, 0xE0, 0x90, 0x97, 0x42, 0xF0, -+0x90, 0x97, 0x3C, 0xE0, 0x90, 0x97, 0x43, 0xF0, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x3D, 0x12, 0x8D, -+0x00, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x32, 0x22, 0x7F, 0xF3, 0x7E, -+0x01, 0x02, 0x5F, 0xA6, 0x90, 0x97, 0x32, 0xEF, 0xF0, 0x51, 0xEC, 0x71, 0xA9, 0xBF, 0x01, 0x08, -+0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x7B, 0xF0, 0x51, 0xEC, 0x71, 0xA2, 0xBF, 0x01, 0x08, 0x90, -+0x97, 0x79, 0xE0, 0x90, 0x97, 0x7C, 0xF0, 0x51, 0xEC, 0x71, 0x9B, 0xBF, 0x01, 0x08, 0x90, 0x97, -+0x79, 0xE0, 0x90, 0x97, 0x7D, 0xF0, 0x51, 0xEC, 0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -+0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x7E, 0xF0, 0x51, 0xEC, 0x7F, 0xF8, 0x7E, 0x01, -+0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x7F, 0xF0, 0x51, 0xEC, -+0x71, 0x8D, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x80, 0xF0, 0x51, 0xEC, 0x51, -+0xF3, 0x64, 0x01, 0x70, 0x54, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x81, 0xF0, 0x54, 0x07, 0x60, -+0x08, 0x90, 0x97, 0x79, 0xE0, 0x54, 0xE0, 0x70, 0x40, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x7A, 0x7F, -+0xFA, 0x51, 0xF5, 0x64, 0x01, 0x70, 0x32, 0x90, 0x97, 0x79, 0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, -+0x90, 0x97, 0x81, 0xE0, 0xFE, 0x90, 0x97, 0x7A, 0xE0, 0x54, 0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x97, -+0x81, 0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x97, 0x81, 0xE0, 0xFF, 0x90, 0x97, 0x7A, 0xE0, -+0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x97, 0x81, 0xF0, 0x51, 0xEC, 0x7F, 0xFD, 0x51, 0xF5, 0x64, -+0x01, 0x70, 0x4B, 0x90, 0x97, 0x79, 0xE0, 0xFE, 0x54, 0xCC, 0x90, 0x97, 0x82, 0xF0, 0xEE, 0x54, -+0x0C, 0xFF, 0x60, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x54, 0xC0, 0x70, 0x32, 0xEF, 0x70, 0x16, 0x90, -+0x97, 0x82, 0xE0, 0xFF, 0x90, 0x97, 0x79, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, -+0x4E, 0x90, 0x97, 0x82, 0xF0, 0x90, 0x97, 0x79, 0xE0, 0xFF, 0x54, 0xC0, 0x70, 0x10, 0x90, 0x97, -+0x82, 0xE0, 0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0xEE, 0x4F, 0xF0, 0x51, 0xEC, -+0x7F, 0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, -+0x83, 0xF0, 0x51, 0xEC, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x97, -+0x79, 0xE0, 0x90, 0x97, 0x84, 0xF0, 0x51, 0xEC, 0x71, 0x94, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, -+0xE0, 0x90, 0x97, 0x85, 0xF0, 0x51, 0xEC, 0x11, 0xAD, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, -+0x90, 0x97, 0x86, 0xF0, 0x51, 0xEC, 0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, -+0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x87, 0xF0, 0x90, 0x97, 0x33, 0x74, 0x19, 0xF0, 0x90, 0x97, -+0x55, 0x74, 0x08, 0xF0, 0x90, 0x97, 0x7B, 0xE0, 0x90, 0x97, 0x35, 0xF0, 0x90, 0x97, 0x7C, 0xE0, -+0x90, 0x97, 0x36, 0xF0, 0x90, 0x97, 0x7D, 0xE0, 0x90, 0x97, 0x37, 0xF0, 0x90, 0x97, 0x7E, 0xE0, -+0x90, 0x97, 0x38, 0xF0, 0x90, 0x97, 0x7F, 0xE0, 0x90, 0x97, 0x39, 0xF0, 0x90, 0x97, 0x80, 0xE0, -+0x90, 0x97, 0x3A, 0xF0, 0x90, 0x97, 0x81, 0xE0, 0x90, 0x97, 0x3B, 0xF0, 0x90, 0x97, 0x82, 0xE0, -+0x90, 0x97, 0x3C, 0xF0, 0x90, 0x97, 0x56, 0x74, 0x1A, 0xF0, 0x90, 0x97, 0x78, 0x74, 0x05, 0xF0, -+0x90, 0x97, 0x83, 0xE0, 0x90, 0x97, 0x58, 0xF0, 0x90, 0x97, 0x84, 0xE0, 0x90, 0x97, 0x59, 0xF0, -+0x90, 0x97, 0x85, 0xE0, 0x90, 0x97, 0x5A, 0xF0, 0x90, 0x97, 0x86, 0xE0, 0x90, 0x97, 0x5B, 0xF0, -+0x90, 0x97, 0x87, 0xE0, 0x90, 0x97, 0x5C, 0xF0, 0x90, 0x97, 0x32, 0xE0, 0xB4, 0x01, 0x17, 0x7B, -+0x01, 0x7A, 0x97, 0x79, 0x33, 0x12, 0xEF, 0xA7, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x56, 0x12, 0x8D, -+0x00, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, 0x97, 0x75, 0x47, 0x33, 0x75, -+0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0xF1, 0x8C, 0x75, 0x46, 0x97, 0x75, 0x47, 0x58, -+0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xAA, 0x02, 0x69, 0xF5, 0x7B, 0x01, 0x7A, 0x97, -+0x79, 0x79, 0x22, 0x7F, 0xFB, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xEF, 0x22, 0x7E, 0x00, 0x7F, 0x0B, -+0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xD9, 0x12, 0x04, 0x80, 0x71, 0x86, 0x71, 0x8D, 0xBF, -+0x01, 0x1C, 0x90, 0x97, 0x2E, 0xE0, 0xFE, 0x54, 0x01, 0x90, 0x95, 0xD9, 0xF0, 0xEE, 0x54, 0x04, -+0x90, 0x95, 0xDB, 0xF0, 0x90, 0x97, 0x2E, 0xE0, 0x54, 0x08, 0x90, 0x95, 0xDA, 0xF0, 0x71, 0x86, -+0x51, 0xF3, 0x64, 0x01, 0x70, 0x35, 0x90, 0x97, 0x2E, 0xE0, 0x54, 0x07, 0x70, 0x15, 0x7B, 0x01, -+0x7A, 0x97, 0x79, 0x2F, 0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0F, 0x90, 0x97, -+0x2F, 0x80, 0x03, 0x90, 0x97, 0x2E, 0xE0, 0x54, 0x07, 0x90, 0x95, 0xDD, 0xF0, 0x90, 0x97, 0x2E, -+0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x95, 0xDC, 0xF0, 0x71, 0x86, 0x7F, 0xFD, 0x7E, -+0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x97, 0x2E, 0xE0, 0x54, 0x0C, 0x13, 0x13, 0x54, -+0x3F, 0x90, 0x95, 0xDE, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x2E, 0x22, 0x7F, 0xF9, 0x7E, -+0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF2, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF6, 0x7E, 0x01, 0x02, -+0x5F, 0xA6, 0x7F, 0xF5, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF4, 0x7E, 0x01, 0x02, 0x5F, 0xA6, -+0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x12, 0xB8, 0xAA, 0x12, -+0xD8, 0x54, 0x12, 0x7B, 0x79, 0x12, 0xD8, 0x61, 0x91, 0x2D, 0x7F, 0x01, 0x12, 0x84, 0x15, 0x90, -+0x95, 0xCB, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x84, 0x15, 0x90, 0x95, 0xCB, 0xE0, 0x04, 0xF0, 0xB1, -+0x98, 0xB1, 0x10, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x75, -+0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, 0x01, 0xA0, 0xE0, 0xB4, 0xFD, 0x04, 0xE4, 0xFF, 0x11, 0xB4, -+0x12, 0xD8, 0xA7, 0xB1, 0x80, 0x90, 0x00, 0x81, 0xE0, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x12, 0x7B, -+0x2E, 0xF1, 0xCB, 0x51, 0xFC, 0x90, 0x00, 0xAA, 0xE0, 0x44, 0x02, 0xF0, 0xA3, 0xE0, 0x44, 0x80, -+0xF0, 0x90, 0x97, 0x2D, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x02, 0x84, 0x9E, 0xE4, 0x90, 0x86, -+0xAF, 0x91, 0x38, 0x90, 0x93, 0x01, 0xF0, 0x22, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, -+0xF1, 0xB2, 0xE4, 0x90, 0x95, 0xC5, 0x91, 0x38, 0x90, 0x95, 0x63, 0x91, 0x38, 0xA3, 0x91, 0x38, -+0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x95, 0x75, 0xF0, 0xA3, 0xF0, 0x90, 0x95, 0xB7, 0xF0, 0xA3, 0xF0, -+0x22, 0x7E, 0x00, 0x7F, 0x25, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x24, 0x12, 0x04, 0x80, -+0x90, 0x06, 0x90, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0xE0, 0x7A, 0x91, 0x40, 0x90, 0x86, 0xB3, 0xE0, -+0xFF, 0x64, 0x02, 0x70, 0x29, 0xB1, 0x09, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x43, 0xB1, -+0x07, 0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x41, 0xB1, 0x07, 0x30, 0xE2, 0x02, 0x7E, 0x01, -+0x90, 0x93, 0x42, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x90, 0x02, 0xFB, 0xF0, 0x22, 0xEF, 0x64, -+0x01, 0x70, 0x1D, 0xB1, 0x00, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x43, 0x91, 0xFE, 0x30, -+0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x41, 0x91, 0xFE, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, 0x1F, -+0xF1, 0x93, 0x70, 0x20, 0x91, 0xF7, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x43, 0x91, 0xF5, -+0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x41, 0x91, 0xF5, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x90, -+0x93, 0x42, 0xEF, 0xF0, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, 0x22, 0xEF, 0xF0, -+0x90, 0xFD, 0x70, 0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x22, -+0xF1, 0x86, 0x12, 0x7B, 0xDB, 0x12, 0xA4, 0xFA, 0xB1, 0x43, 0x91, 0x61, 0xB1, 0x55, 0xB1, 0x6C, -+0x90, 0x8A, 0x73, 0x12, 0x8E, 0x2C, 0x90, 0x95, 0xE4, 0xE0, 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, -+0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, 0x95, 0xE6, 0xF0, 0x90, 0x95, 0xE4, 0xE0, 0x54, -+0xEF, 0xF0, 0x22, 0xF1, 0xDF, 0x79, 0x08, 0x02, 0x04, 0x80, 0x90, 0x93, 0x24, 0xF1, 0xA2, 0x30, -+0xE0, 0x02, 0x91, 0x40, 0x22, 0x90, 0x95, 0xCC, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0x54, -+0xFB, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xF1, 0xC2, 0x7A, 0x95, -+0x79, 0xD0, 0x12, 0x04, 0x80, 0x90, 0x95, 0xD1, 0x74, 0x08, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x12, 0xBF, 0x48, 0xE4, 0xF0, 0x0F, 0xEF, -+0xB4, 0x08, 0xF6, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x7B, 0x1B, 0x90, 0x86, 0xB3, 0xEF, 0xF0, -+0xB1, 0xB2, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, -+0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, 0x75, 0xE0, 0x12, 0xB8, 0x0D, 0x12, 0xB8, 0x46, 0xE4, 0xF5, -+0x21, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x03, 0x05, 0x75, 0x22, 0x08, 0x80, 0x03, 0xE4, 0xF5, 0x22, -+0xE4, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, 0x21, 0x7F, 0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, 0x7F, -+0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, 0x52, 0x12, 0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, 0x02, -+0x7B, 0x2E, 0x90, 0x97, 0x32, 0x12, 0x85, 0xF7, 0xB1, 0x6C, 0x12, 0x8A, 0xBD, 0xF1, 0x9A, 0xD1, -+0x39, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x2F, 0x12, 0x8E, 0x14, 0x90, 0x95, 0xD1, 0x12, -+0x8F, 0x1A, 0x90, 0x95, 0xD2, 0xF0, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x04, 0xFE, 0x90, 0x95, 0xD0, -+0xE0, 0x54, 0xFB, 0x4E, 0xF0, 0x12, 0x8F, 0x13, 0x90, 0x95, 0xD3, 0xF0, 0xEF, 0x54, 0x08, 0xFF, -+0x90, 0x95, 0xD0, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x22, 0x90, 0x95, 0xD0, 0xE0, 0x54, 0xFE, 0x22, -+0x90, 0x95, 0xD0, 0xE0, 0x30, 0xE0, 0x77, 0x90, 0x95, 0xD4, 0xE0, 0x04, 0xF0, 0x90, 0x95, 0xD7, -+0xE0, 0x64, 0x01, 0x70, 0x30, 0x90, 0x95, 0xD0, 0xF1, 0xD8, 0x30, 0xE0, 0x28, 0x90, 0x95, 0xD6, -+0xE0, 0x70, 0x22, 0x90, 0x95, 0xD3, 0xE0, 0xFE, 0xA3, 0xE0, 0xC3, 0x9E, 0x40, 0x17, 0xEF, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0xD1, 0xBF, 0xD1, 0x39, 0xF0, 0x80, 0x07, 0x12, 0xAA, -+0x79, 0xD1, 0x39, 0xF0, 0x22, 0x90, 0x95, 0xD4, 0xE0, 0xFF, 0x90, 0x95, 0xD1, 0xE0, 0xD3, 0x9F, -+0x50, 0x2C, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x16, 0x90, 0x95, 0xD6, 0xE0, 0x70, 0x10, 0x90, -+0x8A, 0xAF, 0x12, 0x8D, 0x12, 0xF1, 0x72, 0x90, 0x95, 0xCF, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, -+0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0x95, 0xD4, 0xF0, 0x90, 0x95, 0xD6, 0xF0, 0x22, 0xE4, -+0xFD, 0xFF, 0x12, 0x6E, 0x71, 0xE4, 0xFF, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x9A, 0x36, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0x12, 0x7D, 0x44, -+0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x12, 0x8E, 0x29, 0x90, 0x9A, 0x37, 0xE0, 0x90, 0x9A, 0x36, 0xB4, -+0x01, 0x07, 0xF1, 0x0F, 0x44, 0x04, 0xF0, 0x80, 0x05, 0xF1, 0x0F, 0x54, 0xFB, 0xF0, 0x90, 0x8A, -+0xF9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, -+0xC4, 0x54, 0xF0, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x95, -+0xD0, 0xE0, 0xFD, 0x30, 0xE0, 0x4B, 0x90, 0x95, 0xD5, 0xE0, 0xFC, 0x60, 0x44, 0xF1, 0xAA, 0x80, -+0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, -+0x60, 0x0B, 0xE4, 0x90, 0x95, 0xD5, 0xF0, 0x90, 0x95, 0xD7, 0x04, 0xF0, 0x22, 0x90, 0x95, 0xD2, -+0xE0, 0xD3, 0x9C, 0x50, 0x14, 0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0xD1, 0xBF, -+0x80, 0x03, 0x12, 0xAA, 0x79, 0xD1, 0x39, 0xF0, 0x22, 0x90, 0x8A, 0xAF, 0x12, 0x8D, 0x12, 0xF1, -+0x72, 0x22, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x95, 0xD5, 0xE0, 0x04, 0xF0, 0x22, -+0xA1, 0x4A, 0xE4, 0xFD, 0xC1, 0xC9, 0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, 0x12, 0x69, 0xF5, 0x75, -+0x45, 0x01, 0x22, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x01, -+0xFE, 0x22, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, -+0x08, 0x22, 0x90, 0x93, 0x24, 0xE0, 0x54, 0xBF, 0xF0, 0x22, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, -+0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x08, 0x7D, 0x00, 0x7B, 0x01, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x10, -+0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x7E, -+0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x22, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, -+0x90, 0x95, 0xE9, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, 0xF0, -+0x60, 0x34, 0xA3, 0xE0, 0x20, 0xE0, 0x2F, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0x7F, -+0x04, 0x12, 0x04, 0x7E, 0x11, 0x37, 0x30, 0xE0, 0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, -+0xE0, 0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, -+0x02, 0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, 0x90, 0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xD1, 0xBB, 0xEC, 0x90, 0x99, 0xF9, 0x12, 0x04, 0x31, -+0x90, 0x99, 0xF9, 0x12, 0xD1, 0x0B, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, 0xAD, 0x90, 0x01, 0x01, -+0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, -+0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x12, 0xD1, 0xD5, 0xF0, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, -+0x88, 0x9B, 0x11, 0xE0, 0x30, 0xE0, 0x05, 0x7F, 0x03, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xB8, 0xE0, -+0x20, 0xE0, 0x33, 0x11, 0x37, 0x30, 0xE0, 0x2E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x07, 0xE4, 0x90, -+0x99, 0xF7, 0xF0, 0x80, 0x06, 0x90, 0x99, 0xF7, 0x74, 0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, -+0x90, 0x99, 0xF8, 0x30, 0xE0, 0x05, 0x74, 0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0x99, -+0xF7, 0x12, 0xD1, 0xB2, 0x51, 0x4F, 0x12, 0xD1, 0xC7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x2F, 0x90, -+0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x66, 0x33, 0x90, 0x88, 0x3E, -+0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xE4, 0xF5, 0x10, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, -+0x21, 0x75, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x7C, 0x12, 0xEF, 0x2C, 0x12, 0xF0, 0x38, 0x60, -+0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, -+0x60, 0x06, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xA3, -+0xF0, 0x80, 0x00, 0x75, 0x10, 0x01, 0xE5, 0x10, 0x60, 0x4B, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, -+0x09, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0x12, 0xBE, 0xAD, 0x12, 0xBF, 0xB3, 0x90, 0x88, 0x3F, -+0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x11, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x11, 0xDD, 0xFF, 0xA3, -+0xE0, 0x11, 0xCE, 0xFF, 0xA3, 0xE0, 0x80, 0x0D, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x11, 0xDD, 0xF1, -+0x5D, 0x11, 0xCE, 0xF1, 0x5D, 0x2F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4F, 0xF0, 0x90, -+0x8A, 0xD7, 0x12, 0x8E, 0x2C, 0x22, 0x90, 0x97, 0xB5, 0xED, 0xF0, 0xA3, 0xEB, 0xF1, 0x53, 0xE4, -+0x90, 0x97, 0xB8, 0xF0, 0x51, 0x7B, 0xEF, 0x54, 0x0C, 0x64, 0x08, 0x60, 0x02, 0x41, 0x19, 0x51, -+0x1F, 0xA3, 0xE0, 0x24, 0x06, 0xFD, 0x90, 0x8A, 0xE9, 0x51, 0x4F, 0xEF, 0x64, 0x88, 0x70, 0x79, -+0x51, 0x1F, 0xA3, 0xE0, 0x24, 0x07, 0xFD, 0x90, 0x8A, 0xE9, 0x51, 0x4F, 0xEF, 0x64, 0x8E, 0x70, -+0x68, 0x90, 0x97, 0xB8, 0x04, 0xF0, 0x51, 0x1F, 0xF1, 0x67, 0x2D, 0x04, 0xFD, 0x90, 0x8A, 0xE9, -+0x51, 0x4F, 0xEF, 0x64, 0x03, 0x70, 0x52, 0x51, 0x1F, 0xF1, 0x67, 0x2D, 0x24, 0x06, 0xFD, 0x90, -+0x8A, 0xE9, 0x51, 0x4F, 0xEF, 0x30, 0xE3, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x01, 0x80, 0x38, 0x90, -+0x93, 0x24, 0x11, 0xE0, 0x30, 0xE0, 0x22, 0x90, 0x95, 0xB9, 0xE0, 0x64, 0x02, 0x70, 0x11, 0x90, -+0x93, 0x25, 0x11, 0xE0, 0x30, 0xE0, 0x02, 0x80, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x02, 0x80, 0x17, -+0x51, 0x1F, 0xA3, 0xE0, 0xFD, 0x51, 0x8B, 0x80, 0x10, 0x90, 0x93, 0x27, 0x12, 0xC1, 0x8E, 0x30, -+0xE0, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x02, 0xF1, 0x4A, 0x90, 0x97, 0xB8, 0xE0, 0xFF, 0x22, 0x90, -+0x97, 0xB3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x86, 0xB6, 0xE0, 0xFF, 0x90, 0x9A, 0x20, -+0xE0, 0xFB, 0x90, 0x92, 0x13, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x9A, 0x21, -+0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x9A, 0x1F, 0xE0, 0xFF, 0x90, 0x8A, 0x95, 0xE0, -+0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, 0x90, 0x97, 0xB5, 0xE0, 0xFD, -+0x90, 0x97, 0xB4, 0xE0, 0x2D, 0xFD, 0x90, 0x97, 0xB3, 0xE0, 0x34, 0x00, 0xCD, 0x24, 0x10, 0xCD, -+0x34, 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0x90, 0x8A, 0xE9, 0xE0, 0xFC, -+0xA3, 0xE0, 0xF5, 0x82, 0x8C, 0x83, 0xE4, 0xFD, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xEF, 0x44, 0x08, 0xF0, 0xED, 0x2F, 0xFF, 0xE4, 0x3E, -+0xFE, 0x7C, 0x00, 0xEF, 0x24, 0x08, 0xFF, 0xEC, 0x3E, 0x90, 0x97, 0xBC, 0xF0, 0xA3, 0xEF, 0xF0, -+0x7E, 0x00, 0x7F, 0xE3, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0x35, 0x12, 0x04, 0x80, 0x90, -+0x97, 0xBD, 0xE0, 0x24, 0x01, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x36, 0xEF, 0xF0, 0x90, 0x97, -+0xBD, 0xE0, 0x24, 0x04, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x39, 0xEF, 0xF0, 0x90, 0x97, 0xBD, -+0xE0, 0x24, 0x05, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x3A, 0xEF, 0xF0, 0x90, 0x97, 0xBD, 0xE0, -+0x24, 0x06, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x3B, 0xEF, 0xF0, 0x90, 0x97, 0xBD, 0xE0, 0x24, -+0x07, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x3C, 0xEF, 0xF0, 0x90, 0x97, 0xBD, 0xE0, 0x24, 0x08, -+0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x3D, 0xEF, 0xF0, 0xE4, 0x90, 0x97, 0xBB, 0xF0, 0xF1, 0x3C, -+0x94, 0x08, 0x50, 0x1C, 0x90, 0x97, 0xBD, 0xE0, 0x24, 0x09, 0xFD, 0x90, 0x97, 0xBC, 0xE0, 0x51, -+0x70, 0x90, 0x97, 0xBB, 0xE0, 0x24, 0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x44, 0x80, 0xDE, -+0xE4, 0x90, 0x97, 0xBB, 0xF0, 0xF1, 0x3C, 0x94, 0x02, 0x50, 0x1C, 0x90, 0x97, 0xBD, 0xE0, 0x24, -+0x61, 0xFD, 0x90, 0x97, 0xBC, 0xE0, 0x51, 0x70, 0x90, 0x97, 0xBB, 0xE0, 0x24, 0x96, 0xF5, 0x82, -+0xE4, 0x34, 0x94, 0xB1, 0x44, 0x80, 0xDE, 0xE4, 0x90, 0x97, 0xBB, 0xF0, 0xF1, 0x3C, 0x94, 0x10, -+0x50, 0x1C, 0x90, 0x97, 0xBD, 0xE0, 0x24, 0x31, 0xFD, 0x90, 0x97, 0xBC, 0xE0, 0x51, 0x70, 0x90, -+0x97, 0xBB, 0xE0, 0x24, 0x66, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x44, 0x80, 0xDE, 0xE4, 0x90, -+0x97, 0xBB, 0xF0, 0x90, 0x94, 0x97, 0xE0, 0xFF, 0x90, 0x97, 0xBB, 0xE0, 0xFE, 0xC3, 0x9F, 0x50, -+0x1F, 0x90, 0x97, 0xBD, 0xE0, 0x24, 0x63, 0xFD, 0x91, 0x06, 0xFC, 0xEE, 0x7E, 0x00, 0x2D, 0x51, -+0x77, 0x90, 0x97, 0xBB, 0xE0, 0x24, 0x98, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x44, 0x80, 0xD3, -+0x90, 0x94, 0x3A, 0x12, 0xE7, 0xB1, 0x90, 0x97, 0xB9, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x30, 0xE3, -+0x0D, 0x7F, 0x01, 0x12, 0xAA, 0x81, 0x90, 0x01, 0xC7, 0x74, 0x03, 0xF0, 0x80, 0x20, 0x7E, 0x00, -+0x90, 0x97, 0xBA, 0xE0, 0x54, 0x07, 0xFF, 0x64, 0x01, 0x60, 0x05, 0xEF, 0x64, 0x02, 0x70, 0x0E, -+0xE4, 0xFD, 0x12, 0xCE, 0x5F, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xF7, 0x44, 0x10, 0xF0, 0x7F, 0x00, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFF, 0x90, 0x97, 0xBC, 0xE0, 0x34, 0x00, 0x22, 0xF1, 0x54, 0xA3, -+0xED, 0xF0, 0xF1, 0xE8, 0x7A, 0x80, 0x79, 0x80, 0xF1, 0xB7, 0x78, 0xC2, 0x7C, 0x97, 0x7D, 0x01, -+0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x86, 0xF1, 0xB0, 0x78, 0xC6, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, -+0x7A, 0x80, 0x79, 0x8A, 0xF1, 0xB0, 0xE4, 0x90, 0x97, 0xCB, 0xF0, 0xB1, 0x5A, 0xCF, 0x24, 0x06, -+0xCF, 0x34, 0x00, 0x51, 0x7A, 0xEF, 0x64, 0x08, 0x60, 0x02, 0xA1, 0x3E, 0xB1, 0x5A, 0xCF, 0x24, -+0x07, 0xCF, 0x34, 0x00, 0x51, 0x7A, 0xEF, 0x64, 0x06, 0x60, 0x02, 0xA1, 0x3E, 0x90, 0x97, 0xCB, -+0x04, 0xF0, 0xE4, 0x90, 0x97, 0xCA, 0xF0, 0x12, 0xF0, 0x1E, 0x50, 0x16, 0x90, 0x97, 0xB4, 0xE0, -+0x24, 0x0A, 0xFD, 0x90, 0x97, 0xB3, 0xE0, 0x51, 0x70, 0x90, 0x97, 0xCA, 0xF1, 0xDF, 0xB1, 0x4F, -+0x80, 0xE5, 0x78, 0xB6, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x34, 0x12, 0xF0, -+0x27, 0x60, 0x02, 0xA1, 0x3E, 0x90, 0x97, 0xCA, 0xF0, 0x12, 0xF0, 0x15, 0x50, 0x18, 0xF1, 0x30, -+0xB1, 0x65, 0xCD, 0x24, 0x20, 0x51, 0x6F, 0x90, 0x97, 0xCA, 0xE0, 0x24, 0xC6, 0xF5, 0x82, 0xE4, -+0x34, 0x97, 0xB1, 0x4F, 0x80, 0xE3, 0x78, 0xC6, 0x7C, 0x97, 0x12, 0xE4, 0xC8, 0xEF, 0x70, 0x75, -+0x90, 0x06, 0x30, 0xE0, 0x44, 0x01, 0x54, 0xDF, 0xF0, 0x90, 0x93, 0x26, 0xE0, 0x30, 0xE0, 0x02, -+0x80, 0x0F, 0x90, 0x95, 0xB9, 0xE0, 0xB4, 0x02, 0x11, 0x90, 0x93, 0x25, 0x11, 0xE0, 0x20, 0xE0, -+0x09, 0x90, 0x01, 0xC7, 0x74, 0x09, 0xF1, 0x4A, 0x80, 0x54, 0xE4, 0x90, 0x97, 0xCA, 0xF0, 0x12, -+0xF0, 0x1E, 0x50, 0x0B, 0x51, 0x5B, 0x90, 0x97, 0xCA, 0xF1, 0xCD, 0xB1, 0x4F, 0x80, 0xF0, 0xE4, -+0x90, 0x97, 0xCA, 0xF0, 0x12, 0xF0, 0x15, 0x50, 0x18, 0xF1, 0x30, 0xB1, 0x65, 0xCD, 0x24, 0x16, -+0x51, 0x6F, 0x90, 0x97, 0xCA, 0xE0, 0x24, 0xC2, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xB1, 0x4F, 0x80, -+0xE3, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xBC, 0x12, 0xCF, 0xC2, 0xA3, 0xF0, 0x7A, 0x97, 0x79, 0xC2, -+0x12, 0xC3, 0xB0, 0x80, 0x09, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x21, 0x54, 0xEF, 0xF0, 0x90, 0x97, -+0xCB, 0xE0, 0xFF, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xBB, 0xE0, 0x04, 0xF0, 0x22, 0xF5, -+0x83, 0xEF, 0xF0, 0x90, 0x97, 0xCA, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x97, 0xB5, 0xE0, 0xFF, 0x90, -+0x97, 0xB4, 0xE0, 0x2F, 0xFF, 0x90, 0x97, 0xB3, 0xE0, 0x34, 0x00, 0x22, 0xF1, 0x54, 0xA3, 0xED, -+0xF0, 0x78, 0xB6, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x94, 0xF1, 0xB7, 0xF1, -+0xE8, 0x7A, 0x80, 0x79, 0x9A, 0xF1, 0xBE, 0x78, 0xCC, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, -+0x80, 0x79, 0xAA, 0xF1, 0xBE, 0xE4, 0x90, 0x97, 0xDF, 0xF0, 0x51, 0x1F, 0xA3, 0xE0, 0xFD, 0xF1, -+0x7C, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xE1, 0x2A, 0xB1, 0x5A, 0xCF, 0x24, 0x0E, 0xCF, 0x34, 0x00, -+0x51, 0x7A, 0xEF, 0x64, 0x3A, 0x60, 0x02, 0xE1, 0x2A, 0xB1, 0x5A, 0xCF, 0x24, 0x30, 0xCF, 0x34, -+0x00, 0x51, 0x7A, 0xEF, 0x64, 0x87, 0x60, 0x02, 0xE1, 0x2A, 0x90, 0x97, 0xDF, 0x04, 0xF0, 0xE4, -+0x90, 0x97, 0xDC, 0xF0, 0xF1, 0x43, 0x94, 0x10, 0x50, 0x18, 0xF1, 0x30, 0xB1, 0x65, 0xCD, 0x24, -+0x38, 0x51, 0x6F, 0x90, 0x97, 0xDC, 0xE0, 0x24, 0xCC, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF1, 0x71, -+0x80, 0xE2, 0xE4, 0x90, 0x97, 0xDD, 0xF0, 0x90, 0x97, 0xDD, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, -+0x02, 0xE1, 0x2A, 0x75, 0xF0, 0x38, 0xEF, 0xF1, 0xC5, 0x20, 0xE0, 0x02, 0xE1, 0x2A, 0xE4, 0x90, -+0x97, 0xDE, 0xF0, 0xF1, 0xD6, 0x90, 0x93, 0x5E, 0x12, 0x04, 0x6E, 0xE0, 0xFE, 0x90, 0x97, 0xDE, -+0xE0, 0xC3, 0x9E, 0x40, 0x02, 0xE1, 0x22, 0xEF, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x75, 0xF9, 0x74, -+0x93, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xE0, 0x75, 0xF0, 0x10, 0xA4, 0x29, 0xF9, 0xEA, 0x35, 0xF0, -+0xFA, 0x78, 0xCC, 0x7C, 0x97, 0x12, 0xEF, 0xE4, 0x60, 0x02, 0xE1, 0x13, 0x90, 0x06, 0x33, 0xE0, -+0x44, 0x01, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x97, 0xDC, 0xF0, 0xF1, 0x43, 0x94, 0x06, 0x50, 0x12, -+0xF1, 0x30, 0xB1, 0x65, 0xCD, 0x24, 0x4A, 0x51, 0x6F, 0x90, 0x97, 0xDC, 0xF1, 0xDF, 0xF1, 0x71, -+0x80, 0xE8, 0xE4, 0x90, 0x97, 0xDC, 0xF0, 0xF1, 0x43, 0x94, 0x10, 0x50, 0x0B, 0x51, 0x5B, 0x90, -+0x97, 0xDC, 0xF1, 0xCD, 0xF1, 0x71, 0x80, 0xEF, 0xF1, 0xD6, 0xF1, 0xC5, 0xFE, 0xC3, 0x13, 0x30, -+0xE0, 0x2C, 0xEF, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x65, 0xF9, 0x74, 0x93, 0x35, 0xF0, 0xFA, 0x7B, -+0x01, 0x78, 0xBC, 0x7C, 0x97, 0x12, 0xEF, 0xE4, 0x70, 0x70, 0x90, 0x95, 0xB9, 0xE0, 0xB4, 0x02, -+0x0B, 0x90, 0x93, 0x25, 0x12, 0xA6, 0x03, 0x20, 0xE0, 0x1D, 0x80, 0x12, 0x80, 0x19, 0x90, 0x95, -+0xB9, 0xE0, 0xB4, 0x02, 0x12, 0x90, 0x93, 0x25, 0x12, 0xA6, 0x03, 0x20, 0xE0, 0x09, 0x90, 0x01, -+0xC7, 0x74, 0x0A, 0xF1, 0x4A, 0x80, 0x53, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xB6, 0x90, 0x97, 0xE3, -+0x12, 0x85, 0xF7, 0x7A, 0x97, 0x79, 0xCC, 0x90, 0x97, 0xE6, 0x12, 0x85, 0xF7, 0x90, 0x97, 0xDD, -+0xE0, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x5F, 0xF9, 0x74, 0x93, 0x35, 0xF0, 0xFA, 0x90, 0x97, 0xE9, -+0x12, 0x85, 0xF7, 0xE4, 0x90, 0x97, 0xEC, 0xF0, 0xA3, 0xF0, 0x7A, 0x97, 0x79, 0xBC, 0x12, 0xC2, -+0x04, 0x80, 0x07, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x05, 0xF0, 0x90, 0x97, 0xDE, 0xE0, 0x04, 0xF0, -+0xC1, 0x13, 0x90, 0x97, 0xDD, 0xE0, 0x04, 0xF0, 0xA1, 0xF7, 0x90, 0x97, 0xDF, 0xE0, 0xFF, 0x22, -+0x90, 0x97, 0xB5, 0xE0, 0xFD, 0x90, 0x97, 0xB4, 0xE0, 0x2D, 0xFD, 0x22, 0x90, 0x97, 0xBB, 0xE0, -+0xFF, 0xC3, 0x22, 0x90, 0x97, 0xDC, 0xE0, 0xFF, 0xC3, 0x22, 0xF0, 0x90, 0x93, 0x2D, 0xE0, 0x44, -+0x01, 0xF0, 0x22, 0xF0, 0x90, 0x97, 0xB3, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xFF, 0xA3, 0xE0, -+0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, 0x90, 0x97, 0xB6, 0xE0, 0xFD, 0x90, 0x97, 0xB5, 0xE0, -+0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xDC, 0xE0, 0x04, 0xF0, 0x22, 0x12, 0xCF, 0xA1, 0xED, -+0xF0, 0x2F, 0xFF, 0xE4, 0x3E, 0xCF, 0x24, 0x06, 0xCF, 0x34, 0x00, 0x51, 0x7A, 0xEF, 0x64, 0x86, -+0x70, 0x1B, 0x90, 0x97, 0xE2, 0xE0, 0xFF, 0x90, 0x97, 0xE1, 0xE0, 0x2F, 0x12, 0xE9, 0xF4, 0xCF, -+0x24, 0x07, 0xCF, 0x34, 0x00, 0x51, 0x7A, 0xBF, 0xDD, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, -+0x7E, 0x00, 0x7F, 0x04, 0x02, 0x01, 0xE0, 0x7E, 0x00, 0x7F, 0x06, 0x02, 0x01, 0xE0, 0x7E, 0x00, -+0x7F, 0x10, 0x02, 0x01, 0xE0, 0x90, 0x93, 0x5D, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xE0, 0x24, 0xBC, -+0xF5, 0x82, 0xE4, 0x34, 0x97, 0x22, 0x90, 0x97, 0xDD, 0xE0, 0xFF, 0x75, 0xF0, 0x38, 0x22, 0xE0, -+0x24, 0xB6, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0x22, 0x78, 0xBC, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, -+0x22, 0x12, 0x97, 0x9A, 0x90, 0x93, 0x08, 0x12, 0xD7, 0xBD, 0x12, 0x8E, 0x13, 0x90, 0x93, 0x09, -+0x12, 0x8F, 0x1A, 0x90, 0x93, 0x0A, 0xF0, 0x12, 0xBF, 0xDD, 0x90, 0x93, 0x08, 0xE0, 0x54, 0x01, -+0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x1A, 0x11, 0x5E, 0x60, -+0x0A, 0x11, 0x57, 0x12, 0x7C, 0x05, 0x12, 0xBF, 0xCB, 0x80, 0x07, 0x11, 0x57, 0x12, 0x7C, 0x3B, -+0xF1, 0xED, 0x12, 0x79, 0xD4, 0x80, 0x17, 0x11, 0x5E, 0x60, 0x07, 0x11, 0x57, 0x12, 0x7C, 0x05, -+0x80, 0x05, 0x11, 0x57, 0x12, 0x7C, 0x3B, 0x91, 0xE4, 0x91, 0xEB, 0x12, 0x7B, 0xCC, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x90, 0x93, -+0x0A, 0xE0, 0x90, 0x01, 0x3F, 0x22, 0xF1, 0xE6, 0x64, 0x01, 0x60, 0x02, 0x21, 0x83, 0x90, 0x88, -+0x36, 0xE0, 0x70, 0x02, 0x21, 0x83, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x33, 0x90, 0x06, 0xA9, -+0xE0, 0x54, 0xC0, 0x70, 0x2B, 0x90, 0x88, 0x9C, 0xE0, 0x70, 0x25, 0x90, 0x04, 0x1A, 0xE0, 0xF4, -+0x70, 0x1E, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x70, 0x17, 0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, 0x70, -+0x0F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x08, 0x12, 0xB4, 0x41, 0x54, 0xFE, 0x12, 0xD1, 0xCF, -+0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, -+0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, -+0x90, 0x07, 0xF1, 0xE0, 0x90, 0x97, 0x2B, 0xF0, 0x90, 0x07, 0xF0, 0xE0, 0x90, 0x97, 0x2C, 0xF0, -+0x12, 0xBB, 0x8F, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEC, 0xF0, 0x31, 0x8C, 0x24, 0xFD, 0x50, -+0x02, 0x80, 0x03, 0x12, 0xBA, 0xFA, 0x31, 0x8C, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, -+0x90, 0x88, 0x3D, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x88, 0x3C, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, -+0x08, 0x90, 0x88, 0x3C, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x31, 0x95, -+0xE4, 0x90, 0x88, 0x3F, 0xF0, 0xD1, 0x00, 0x30, 0xE0, 0x52, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x20, 0xE0, 0x21, 0x31, 0x84, 0x6F, 0x70, 0x44, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0x12, -+0xBF, 0xAB, 0x11, 0x53, 0x12, 0x7C, 0x05, 0xF1, 0xF4, 0x12, 0xBF, 0x9D, 0x90, 0x88, 0x3D, 0xE0, -+0x14, 0xF0, 0x80, 0x28, 0x12, 0xF0, 0x38, 0x64, 0x01, 0x70, 0x21, 0x31, 0x84, 0xFE, 0x6F, 0x60, -+0x1B, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x12, 0x12, 0x97, 0xD5, 0x30, 0xE0, 0x0C, -+0xEF, 0x54, 0xBF, 0x11, 0x53, 0x12, 0x7C, 0x3B, 0x91, 0xEB, 0x91, 0xE4, 0x90, 0x88, 0x32, 0xE0, -+0x44, 0x04, 0xF0, 0x22, 0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x88, 0x34, 0xE0, -+0xFF, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x97, 0x2C, 0xE0, 0x24, 0x46, 0xFF, 0x90, 0x97, 0x2B, 0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, -+0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x85, 0xBA, 0x90, 0x88, 0x85, 0x71, 0xA4, 0xEF, 0x24, -+0x46, 0xFF, 0xE4, 0x3E, 0xFE, 0xE4, 0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x90, 0x88, 0x89, 0x71, 0xA4, -+0x90, 0x88, 0x85, 0x71, 0xBF, 0x50, 0x02, 0x41, 0x8B, 0x90, 0x88, 0x89, 0x12, 0x85, 0xE2, 0x90, -+0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, 0x85, 0xBA, 0x90, 0x98, 0x7E, 0x12, 0x04, 0x31, 0x90, 0x88, -+0x31, 0xE0, 0x30, 0xE0, 0x2B, 0x91, 0xF3, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x03, 0xC3, 0x33, -+0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, 0x4E, 0xE0, 0xFD, -+0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, 0x00, 0xFA, 0x71, 0xAD, 0xEB, 0x2F, 0xFF, 0xEA, 0x80, 0x1E, -+0x90, 0x88, 0x33, 0x12, 0x97, 0xD8, 0x30, 0xE0, 0x02, 0x61, 0x89, 0x71, 0xAD, 0x90, 0x88, 0x4E, -+0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, 0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, 0xED, 0x3E, 0x90, -+0x98, 0x7A, 0xF0, 0xA3, 0xEF, 0xF0, 0xC3, 0x90, 0x98, 0x7B, 0xE0, 0x94, 0xA0, 0x90, 0x98, 0x7A, -+0xE0, 0x94, 0x00, 0x50, 0x36, 0xA3, 0xE0, 0xFB, 0x24, 0xEB, 0x71, 0x9C, 0xE0, 0x04, 0xF0, 0x90, -+0x98, 0x7E, 0x12, 0x04, 0xB8, 0xEF, 0x54, 0x7F, 0xFF, 0x74, 0x8B, 0x2B, 0x71, 0x91, 0xE0, 0xFE, -+0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x98, 0x7A, 0xA3, 0xE0, 0x71, 0x8F, 0xEF, 0xF0, 0x90, 0x88, -+0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, 0x7F, 0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, 0xE0, 0xFF, -+0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x61, 0x89, -+0xE4, 0xFF, 0xFE, 0x71, 0x99, 0xE0, 0x2F, 0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, -+0x40, 0x07, 0x90, 0x98, 0x7C, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE5, 0x91, 0xCB, -+0x40, 0x02, 0x80, 0x15, 0x90, 0x98, 0x7C, 0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, 0x50, 0x13, -+0x71, 0x99, 0xE0, 0x2F, 0xFF, 0x91, 0xCB, 0x40, 0x07, 0x90, 0x98, 0x7D, 0xEE, 0xF0, 0x80, 0x03, -+0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, 0xE0, 0xFF, 0x71, 0x8A, 0xE0, 0xFD, 0xEF, 0xC3, 0x9D, 0x40, -+0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x98, 0x7D, 0xE0, -+0x80, 0x18, 0x71, 0x8A, 0xE0, 0xFD, 0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, 0xF0, 0xEE, -+0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, 0x98, 0x7D, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, 0x90, 0x88, -+0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, 0xF0, 0xE4, -+0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, 0x50, 0x9F, -+0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4F, -+0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, 0x88, 0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, 0x4F, 0xE0, -+0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, 0x90, 0x88, -+0x4F, 0xE0, 0x24, 0x10, 0xF0, 0x12, 0xCF, 0xCE, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, 0x8A, -+0xA3, 0x12, 0x8D, 0x12, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x98, 0x7C, 0xE0, 0xFE, 0x24, -+0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0x74, 0xEB, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -+0x95, 0xF5, 0x83, 0x22, 0x12, 0x04, 0x31, 0x90, 0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, 0x98, 0x7E, -+0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, 0xEB, 0x7E, 0x02, 0xFD, 0xFC, 0x90, 0x9A, 0x1B, 0x12, -+0x85, 0xE2, 0xC3, 0x02, 0x03, 0xDA, 0x90, 0x9A, 0x1A, 0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, 0x70, -+0x51, 0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEE, 0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, -+0x9A, 0x1B, 0x12, 0x04, 0x31, 0xE4, 0x7F, 0x80, 0x71, 0xB8, 0x70, 0x05, 0x90, 0x88, 0xBE, 0x80, -+0x1B, 0xE4, 0xFF, 0xFE, 0x71, 0xBA, 0x70, 0x0A, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xE4, 0xA3, 0xF0, -+0x80, 0x56, 0xE4, 0xFF, 0x71, 0xB8, 0x70, 0x09, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xA3, 0xF0, 0x80, -+0x47, 0xE4, 0x7F, 0x80, 0xFE, 0x71, 0xBA, 0x70, 0x3F, 0x90, 0x88, 0xBE, 0xF0, 0xA3, 0x04, 0xF0, -+0x80, 0x36, 0x7F, 0x2C, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x02, 0x91, 0xB5, 0x60, 0x08, -+0x90, 0x88, 0xBE, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xBE, 0xF0, 0x7F, 0x30, 0x7E, -+0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x01, 0x91, 0xB5, 0x60, 0x07, 0xE4, 0x90, 0x88, 0xBF, 0xF0, -+0x80, 0x06, 0x90, 0x88, 0xBF, 0x74, 0x01, 0xF0, 0x90, 0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, 0x90, -+0x8A, 0xF9, 0x12, 0x8D, 0x12, 0x7D, 0x11, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x12, -+0x8E, 0x2C, 0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x88, 0xDF, 0xE0, 0xFF, 0x90, -+0x8A, 0xF3, 0x12, 0x9A, 0x7E, 0x90, 0x9A, 0x1A, 0xE0, 0xFD, 0x70, 0x02, 0x80, 0x1C, 0xED, 0xB4, -+0x01, 0x06, 0x91, 0xAE, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x9A, 0x1A, 0xE0, 0xFD, 0xB4, 0x02, 0x06, -+0x91, 0xAE, 0x44, 0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, 0x91, 0xAE, 0xF0, 0x22, 0x90, 0x88, -+0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, 0xFE, 0xFD, 0xFC, 0x90, 0x9A, 0x1B, 0x12, 0x04, 0x31, -+0x90, 0x9A, 0x1B, 0x12, 0x04, 0xB8, 0xEC, 0x4D, 0x4E, 0x4F, 0x22, 0x90, 0x88, 0x91, 0xE0, 0xFD, -+0xC3, 0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, -+0x9D, 0xE4, 0x9C, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x7D, 0x01, 0x7F, 0x02, 0x02, -+0x7C, 0x74, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, -+0x7B, 0x01, 0x7A, 0x88, 0x79, 0x31, 0x12, 0x04, 0x80, 0x12, 0x97, 0xDF, 0x79, 0x08, 0x12, 0x04, -+0x80, 0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, -+0x50, 0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0x91, 0xF2, 0xFF, 0xB1, 0xF2, 0x12, -+0xEE, 0x67, 0x90, 0x8A, 0x89, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, -+0x89, 0x12, 0x8D, 0x12, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0x12, 0x8D, -+0x12, 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x01, 0x08, -+0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, 0x11, 0xEF, 0xB4, 0x03, 0x08, 0x90, 0x88, 0x41, 0x74, -+0x14, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0x41, 0xF0, 0x7F, 0x79, 0x12, 0x7B, 0x41, 0xEF, 0x54, -+0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE2, 0x06, 0x90, 0x88, -+0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, -+0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0x91, 0xF2, 0xB1, 0xF2, 0x7E, 0x00, 0x7F, 0x18, -+0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x0C, 0x12, 0x04, 0x80, 0x90, 0x8A, 0xA3, 0x12, 0x8D, -+0x12, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, 0x7D, -+0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, -+0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, 0x9C, -+0xF0, 0x22, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x22, -+0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x12, 0x97, 0x9A, 0x90, 0x93, 0x24, 0x12, 0xD7, 0xBD, 0xF1, 0x17, 0x12, 0xEF, 0xC6, -+0x90, 0x93, 0x24, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0xF1, 0x16, 0x12, 0xEF, 0xCF, -+0x90, 0x93, 0x24, 0xF1, 0x0E, 0x12, 0xF0, 0x03, 0x90, 0x93, 0x24, 0x12, 0xF0, 0x0C, 0x4E, 0x12, -+0x8F, 0x1A, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x26, 0xE0, 0x54, 0xFE, 0x12, 0x8E, 0x12, 0xFE, -+0x54, 0x01, 0xFD, 0x90, 0x93, 0x25, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEE, 0x54, 0x04, 0xFE, -+0xED, 0x54, 0xFB, 0x4E, 0xFE, 0x12, 0x8E, 0x13, 0xFD, 0x54, 0x08, 0xFC, 0xEE, 0x54, 0xF7, 0x4C, -+0xFE, 0x90, 0x93, 0x25, 0xF0, 0xED, 0x54, 0x10, 0xFD, 0xEE, 0x54, 0xEF, 0x4D, 0xF0, 0xEF, 0x54, -+0x10, 0xFF, 0xA3, 0xE0, 0x54, 0xEF, 0x4F, 0xFF, 0x12, 0x8F, 0x1A, 0x12, 0xF0, 0x30, 0x90, 0x93, -+0x26, 0x12, 0x8E, 0x13, 0x54, 0x02, 0xFF, 0x90, 0x93, 0x25, 0xE0, 0x54, 0xFD, 0x4F, 0x12, 0xD7, -+0xB3, 0x12, 0xCE, 0x56, 0x12, 0xD7, 0x75, 0x90, 0x93, 0x24, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, -+0x12, 0xE3, 0xEE, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x12, 0xE4, 0x0B, 0x90, -+0x93, 0x25, 0x12, 0x98, 0xE0, 0x30, 0xE0, 0x1E, 0x90, 0x93, 0x24, 0xD1, 0x03, 0x20, 0xE0, 0x0E, -+0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x01, -+0x80, 0x0E, 0x7F, 0x00, 0x80, 0x0A, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFF, -+0x12, 0xE5, 0xD4, 0x90, 0x93, 0x24, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, 0xF1, 0x1E, 0x90, -+0x93, 0x24, 0xE0, 0x54, 0x01, 0xFF, 0x12, 0xD6, 0x8F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0xEE, -+0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0xFE, 0x22, 0xEF, 0x60, -+0x05, 0x12, 0xD2, 0xF9, 0xF1, 0x27, 0x22, 0x90, 0x95, 0xC6, 0xF1, 0xDB, 0xE0, 0xFE, 0x24, 0x28, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0x12, 0xCF, 0x99, 0xE0, -+0xFD, 0x90, 0x97, 0x32, 0xE0, 0x24, 0x2C, 0x12, 0xE3, 0x45, 0x90, 0x97, 0x32, 0xE0, 0x2F, 0x24, -+0x30, 0xA3, 0xF0, 0xE0, 0xFD, 0x24, 0x04, 0x12, 0xCF, 0xBA, 0xE0, 0xFE, 0x74, 0x05, 0x2D, 0x12, -+0xCE, 0x4F, 0x90, 0x95, 0x6D, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x97, 0x33, 0xE0, 0x24, 0x0C, 0xF9, -+0xE4, 0x34, 0xFC, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x6F, 0x12, -+0x69, 0xF5, 0x90, 0x97, 0x33, 0xE0, 0x24, 0x14, 0xF0, 0xE0, 0xFD, 0x24, 0x01, 0x12, 0xC6, 0xAD, -+0xE0, 0xFE, 0x74, 0x00, 0x2D, 0x12, 0xC6, 0xF8, 0x12, 0xCE, 0x56, 0x90, 0x95, 0x73, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x95, 0xC7, 0xF1, 0xDB, 0x90, 0x95, 0x69, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x4E, -+0x60, 0x11, 0x90, 0x97, 0x32, 0x12, 0xC7, 0x80, 0x8F, 0x48, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x77, -+0x12, 0x69, 0xF5, 0x90, 0x95, 0xC8, 0xF1, 0xDB, 0x12, 0xC7, 0x81, 0x90, 0x95, 0x6B, 0xA3, 0xE0, -+0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x97, 0x02, 0x69, 0xF5, 0xE0, 0xFF, 0x12, 0x7B, 0x07, -+0x90, 0x97, 0x32, 0xEF, 0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x22, 0x7D, 0x02, 0x7F, -+0x02, 0x12, 0x7C, 0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x90, 0x93, 0x0C, 0xE0, 0x20, -+0xE0, 0x02, 0x01, 0xCA, 0xE4, 0x90, 0x97, 0x32, 0xF0, 0x90, 0x97, 0x32, 0xE0, 0xFF, 0xC3, 0x94, -+0x05, 0x40, 0x02, 0x01, 0xCA, 0x12, 0x97, 0xAA, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0xFF, 0x90, 0x93, 0x0D, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x02, 0x01, 0xC2, 0x12, 0x02, 0x06, -+0xFF, 0x30, 0xE0, 0x1A, 0x90, 0x93, 0x0E, 0xE0, 0xFE, 0x90, 0x97, 0x32, 0xE0, 0xFD, 0x74, 0x01, -+0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, 0x0E, 0xF0, 0xEF, 0xC3, -+0x13, 0x30, 0xE0, 0x15, 0x90, 0x93, 0x0F, 0xE0, 0xFF, 0x90, 0x97, 0x32, 0x11, 0xD3, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x0F, 0xF0, 0x12, 0x8E, 0x14, 0xFF, 0x90, 0x97, 0x32, -+0xE0, 0xFE, 0x24, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0x8F, 0x1A, 0xFF, -+0x74, 0x15, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x12, 0x8F, 0x13, 0xFF, -+0x74, 0x1A, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x12, 0x8F, 0xE2, 0xFF, -+0x74, 0x1F, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x0D, 0xE0, -+0xFF, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x0D, -+0xF0, 0x22, 0x90, 0x97, 0x32, 0xE0, 0x04, 0xF0, 0x01, 0x09, 0x22, 0x7F, 0x61, 0x12, 0x7B, 0x41, -+0x90, 0x9A, 0x3C, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x9A, 0x3D, 0xED, 0xF0, 0x90, 0x9A, 0x3C, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, -+0x42, 0x7F, 0x47, 0x11, 0xCD, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, -+0x12, 0x7B, 0x2E, 0x7F, 0x46, 0x11, 0xCD, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, -+0x46, 0x51, 0x71, 0x60, 0x0D, 0x7F, 0x45, 0x11, 0xCD, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, -+0x80, 0x0C, 0x7F, 0x45, 0x11, 0xCD, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, -+0x45, 0x80, 0x46, 0x90, 0x9A, 0x3C, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0x11, 0xCD, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x12, 0x7B, 0x2E, 0x7F, 0x62, 0x11, 0xCD, -+0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0x51, 0x71, 0x60, 0x0E, 0x11, 0xCB, -+0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x0D, 0x11, 0xCB, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xAD, 0x07, 0x90, 0x93, 0x29, 0xE0, 0x75, 0xF0, 0x40, 0xA4, 0xFF, 0x90, 0x9A, 0x15, 0xE5, -+0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x93, 0x2A, 0xE0, 0xC3, 0x13, 0x54, 0x7F, -+0x90, 0x9A, 0x18, 0xF0, 0x90, 0x93, 0x2B, 0xE0, 0x13, 0x13, 0x54, 0x01, 0x90, 0x9A, 0x19, 0xF0, -+0xED, 0x64, 0x01, 0x70, 0x6E, 0xE0, 0x70, 0x15, 0x90, 0x9A, 0x15, 0xE0, 0x70, 0x02, 0xA3, 0xE0, -+0x60, 0x0B, 0x90, 0x9A, 0x15, 0x74, 0xFF, 0x75, 0xF0, 0xD0, 0x12, 0x02, 0xE7, 0x51, 0x33, 0x54, -+0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x11, 0xDB, 0x51, 0x33, 0x54, 0x01, 0xFD, 0x11, -+0xDB, 0x90, 0x93, 0x2A, 0xE0, 0x30, 0xE0, 0x3B, 0x51, 0x24, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, -+0x02, 0x7D, 0x01, 0x11, 0xDB, 0xE4, 0x90, 0x9A, 0x17, 0xF0, 0x90, 0x9A, 0x18, 0xE0, 0xFF, 0x90, -+0x9A, 0x17, 0xE0, 0xC3, 0x9F, 0x50, 0x1C, 0x51, 0x24, 0x54, 0x01, 0xFD, 0x11, 0xDB, 0x51, 0x24, -+0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x11, 0xDB, 0x90, 0x9A, 0x17, 0xE0, 0x04, -+0xF0, 0x80, 0xD7, 0x22, 0x90, 0x9A, 0x15, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x9A, 0x19, 0xE0, -+0xFD, 0x51, 0x42, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x7F, 0xFF, 0x90, 0x93, 0x27, 0xE0, 0xFE, 0xC4, -+0x13, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x11, 0x8F, 0x12, 0xBD, 0x01, 0x15, -+0xE5, 0x12, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xEE, 0x54, 0x1F, 0xFE, -+0x12, 0x7A, 0xAE, 0x80, 0x07, 0xAF, 0x12, 0xAE, 0x11, 0x12, 0x7C, 0x6A, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x12, 0x7B, 0x2E, 0x90, 0x9A, 0x3D, 0xE0, 0x22, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0x7F, -+0x01, 0x90, 0x9A, 0x48, 0xEF, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x02, 0x70, 0x22, 0x90, 0x9A, -+0x48, 0xE0, 0xFD, 0x64, 0x01, 0x70, 0x66, 0x12, 0x9F, 0x4B, 0x90, 0x93, 0x28, 0x12, 0x8F, 0xDA, -+0x30, 0xE0, 0x09, 0x90, 0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, 0x51, 0xAF, 0x05, 0x80, 0x4B, -+0x12, 0x97, 0x93, 0x70, 0x32, 0x90, 0x97, 0x2D, 0xE0, 0xFF, 0x30, 0xE0, 0x2A, 0x90, 0x00, 0xD4, -+0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x00, 0xC6, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x00, 0x01, 0xE0, 0x44, -+0x30, 0xF0, 0x90, 0x00, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x00, 0xCC, 0xE0, 0x54, 0xFB, 0xF0, -+0xEF, 0x54, 0xFE, 0x90, 0x97, 0x2D, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0xF1, 0xEA, 0x90, -+0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x9A, 0x48, 0xE0, 0xFF, 0x31, 0x81, 0x12, 0x96, 0x39, -+0xF0, 0x02, 0x97, 0xB2, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x99, 0x84, 0xF0, -+0xA3, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0x12, 0x95, 0x65, 0x90, 0x99, 0x8C, 0xF0, 0xA3, 0xF0, -+0xA3, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0x04, 0xF0, 0x74, 0xAB, 0xA3, 0x12, 0xD6, 0x15, 0x12, 0xCE, -+0x56, 0x90, 0x99, 0x7B, 0x12, 0xD7, 0xA0, 0x90, 0x99, 0x83, 0xF0, 0x90, 0x93, 0x24, 0xE0, 0x20, -+0xE0, 0x02, 0xC1, 0x1F, 0xE4, 0x90, 0x99, 0x82, 0xF0, 0x90, 0x99, 0x83, 0xE0, 0xFF, 0x90, 0x99, -+0x82, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0xC1, 0x1F, 0xF1, 0xD8, 0xEC, 0xFF, 0x90, 0xFD, 0x11, 0xF0, -+0x90, 0x99, 0x8C, 0xEF, 0xF0, 0x12, 0xD5, 0x69, 0x54, 0x3F, 0xFE, 0x90, 0x99, 0x7D, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x99, 0x88, 0xEE, 0x12, 0xEF, 0x8B, 0x30, 0xE0, 0x0A, 0xC3, 0x13, 0x20, 0xE0, -+0x05, 0x12, 0xD7, 0xDB, 0x80, 0x02, 0x7E, 0x00, 0xEF, 0x24, 0x18, 0x2E, 0xFF, 0x90, 0x99, 0x8D, -+0xF0, 0x90, 0x99, 0x7C, 0xE0, 0x2F, 0xFF, 0x90, 0x99, 0x7B, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x99, -+0x7F, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x9A, 0x7B, 0xC0, 0x07, 0x90, 0x99, 0x7F, 0xD1, 0x3B, 0x7D, -+0x01, 0x12, 0x04, 0x7E, 0xC0, 0x07, 0x90, 0x99, 0x7F, 0xD1, 0x3B, 0x7D, 0x04, 0x12, 0x04, 0x7E, -+0xAB, 0x07, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0xE3, 0x4E, 0x90, 0x99, 0x84, 0xEF, 0xF0, 0xD1, 0x2F, -+0x12, 0x9A, 0x7B, 0xEF, 0x54, 0xFC, 0x90, 0x99, 0x81, 0xF0, 0x90, 0x99, 0x8D, 0xE0, 0xFF, 0x90, -+0x99, 0x7D, 0xE4, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0xF1, 0xE1, 0x12, 0xD6, 0x1F, 0x90, 0x99, 0x7D, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0x7B, 0xD1, 0x3B, 0x7D, 0x0F, 0x12, 0x04, 0x7E, 0x7D, -+0x01, 0x12, 0xE4, 0xD7, 0xEF, 0x60, 0x12, 0x12, 0x9F, 0x4B, 0x90, 0x99, 0x7B, 0xD1, 0x3B, 0x7D, -+0x10, 0x12, 0x04, 0x7E, 0x90, 0x95, 0x61, 0xEF, 0xF0, 0xF1, 0xE1, 0x90, 0x99, 0x7B, 0x12, 0xD7, -+0xCC, 0xF1, 0xD8, 0xD3, 0x9F, 0xEC, 0x9E, 0x40, 0x0F, 0x12, 0xEF, 0xB6, 0xED, 0x9F, 0xFF, 0xEC, -+0x9E, 0x90, 0x99, 0x7B, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0x07, 0xE0, 0x60, 0x3F, 0x90, 0x99, -+0x81, 0xE0, 0x24, 0xB0, 0x60, 0x18, 0x24, 0xD0, 0x60, 0x02, 0xA1, 0xB9, 0xF1, 0xD0, 0x20, 0xE0, -+0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x02, 0xA1, 0xB9, 0x80, 0x10, 0xF1, 0xD0, -+0x20, 0xE0, 0x0B, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x02, 0xA1, 0xB9, 0xD1, 0x2F, -+0x90, 0x99, 0x88, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x12, 0xE8, 0x28, 0xA1, 0xB9, 0x90, 0x99, 0x81, -+0xE0, 0x24, 0xF8, 0x60, 0x3A, 0x24, 0x80, 0x60, 0x36, 0x24, 0xC8, 0x60, 0x06, 0x24, 0x20, 0x60, -+0x02, 0xA1, 0xB9, 0x90, 0x93, 0x27, 0xE0, 0xFF, 0x12, 0x8F, 0xDB, 0x20, 0xE0, 0x02, 0xA1, 0xB9, -+0x90, 0x93, 0x3A, 0xE0, 0x04, 0xF0, 0xD1, 0x2F, 0xF1, 0x0B, 0xEF, 0x70, 0x02, 0xA1, 0xB9, 0x90, -+0x99, 0x81, 0xE0, 0xFF, 0x12, 0xE0, 0xCF, 0x90, 0x93, 0x3B, 0xE0, 0x04, 0xF0, 0xA1, 0xB9, 0x90, -+0x93, 0x24, 0x12, 0xC1, 0x8E, 0x30, 0xE0, 0x5F, 0x90, 0x99, 0x84, 0xE0, 0xFF, 0x90, 0x99, 0x80, -+0xE0, 0x2F, 0xFF, 0x90, 0x99, 0x7F, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, 0xFE, -+0x90, 0x99, 0x8A, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x9A, 0x7B, 0xEF, 0x64, 0x45, 0x70, 0x38, 0xD1, -+0xFB, 0x12, 0xEA, 0xCE, 0xEF, 0x64, 0x01, 0x70, 0x2E, 0xD1, 0xFB, 0x12, 0xEB, 0x0D, 0xEF, 0x64, -+0x01, 0x70, 0x24, 0x90, 0x99, 0x8E, 0x04, 0xD1, 0xFA, 0xA3, 0xE0, 0xFD, 0x12, 0xEA, 0x26, 0xEF, -+0x70, 0x0D, 0x90, 0x99, 0x8C, 0xE0, 0xFD, 0x90, 0xFD, 0x11, 0xD1, 0xFA, 0x12, 0xEA, 0x7F, 0x90, -+0x99, 0x8C, 0xE0, 0x90, 0xFD, 0x11, 0xF0, 0xD1, 0x2F, 0xF1, 0x0B, 0xEF, 0x60, 0x1C, 0xD1, 0x2F, -+0x90, 0x99, 0x84, 0xE0, 0xFD, 0x90, 0x99, 0x87, 0xE0, 0xFB, 0x90, 0x99, 0x8C, 0xE0, 0x90, 0x97, -+0xB7, 0xF0, 0x12, 0x99, 0x76, 0xEF, 0x60, 0x02, 0xF1, 0x04, 0x90, 0x93, 0x24, 0xE0, 0xC3, 0x13, -+0x30, 0xE0, 0x0F, 0xD1, 0x2F, 0x90, 0x99, 0x84, 0xE0, 0xFD, 0x12, 0x9C, 0x0D, 0xEF, 0x60, 0x02, -+0xF1, 0x04, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0F, 0xD1, 0x2F, 0x90, -+0x99, 0x84, 0xE0, 0xFD, 0x12, 0x9D, 0x6C, 0xEF, 0x60, 0x02, 0xF1, 0x04, 0x90, 0x93, 0x24, 0x12, -+0x8F, 0xDA, 0x30, 0xE0, 0x1C, 0x90, 0x99, 0x8E, 0xE0, 0x70, 0x16, 0xD1, 0x2F, 0x90, 0x99, 0x84, -+0xE0, 0xFD, 0x12, 0xE4, 0xA1, 0xEF, 0x60, 0x09, 0x12, 0x9F, 0x4B, 0x90, 0x01, 0xC7, 0x74, 0x22, -+0xF0, 0xD1, 0x2F, 0x90, 0x99, 0x84, 0xE0, 0xFD, 0xD1, 0x4C, 0xEF, 0x60, 0x0C, 0x90, 0x93, 0x2D, -+0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, 0x04, -+0x7F, 0x01, 0x51, 0x81, 0x12, 0xE0, 0xB8, 0xEF, 0x64, 0x01, 0x70, 0x37, 0x90, 0x93, 0x3C, 0xE0, -+0x04, 0xF0, 0x12, 0xE0, 0x64, 0xAD, 0x07, 0xEF, 0x64, 0x01, 0x60, 0x1F, 0x12, 0x9F, 0x4B, 0xED, -+0xB4, 0x02, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x42, 0xF0, 0x80, 0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, -+0x01, 0xC7, 0x74, 0x43, 0xF0, 0x7F, 0x01, 0x51, 0x81, 0x80, 0x24, 0x90, 0x99, 0x7B, 0x12, 0xE0, -+0x51, 0x80, 0x14, 0x90, 0x93, 0x26, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x11, 0x90, 0x93, -+0x24, 0xE0, 0x54, 0xFE, 0xF0, 0x80, 0x08, 0x90, 0x99, 0x82, 0xE0, 0x04, 0xF0, 0x61, 0x49, 0x74, -+0x04, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xAB, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0x99, 0x7F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x97, 0xB8, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x90, 0x8A, 0xE9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, 0x8C, 0x83, 0x22, 0x90, 0x97, 0xB5, 0xED, -+0x12, 0x9F, 0x53, 0xF1, 0x0B, 0xEF, 0x70, 0x02, 0xC1, 0xF7, 0x12, 0x9A, 0x1F, 0x12, 0xE4, 0xB8, -+0x70, 0x02, 0xC1, 0xF7, 0x12, 0x9D, 0x5A, 0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, 0x90, 0x97, 0xB8, -+0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x93, 0x25, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x33, 0xD1, 0x38, -+0x7D, 0x09, 0x12, 0x04, 0x7E, 0xEF, 0x64, 0x06, 0x70, 0x27, 0xD1, 0x38, 0x7D, 0x14, 0x12, 0x04, -+0x7E, 0xEF, 0x70, 0x1D, 0xD1, 0x38, 0x7D, 0x15, 0x12, 0x04, 0x7E, 0xEF, 0x64, 0x50, 0x70, 0x11, -+0xD1, 0x38, 0x7D, 0x21, 0x12, 0x04, 0x7E, 0xEF, 0x20, 0xE0, 0x03, 0x30, 0xE2, 0x03, 0x7F, 0x01, -+0x22, 0x90, 0x93, 0x25, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x3B, 0xD1, 0x38, 0x7D, 0x09, -+0x12, 0x04, 0x7E, 0xEF, 0x64, 0x11, 0x70, 0x2F, 0x90, 0x97, 0xB9, 0xE0, 0x24, 0x14, 0xFF, 0x90, -+0x97, 0xB8, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x97, 0xB6, 0xF0, 0xA3, 0xEF, 0xF0, 0xD1, 0x40, 0x7D, -+0x02, 0x12, 0x04, 0x7E, 0xEF, 0x70, 0x10, 0x90, 0x97, 0xB6, 0xD1, 0x3B, 0x7D, 0x03, 0x12, 0x04, -+0x7E, 0xBF, 0x89, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0xF0, 0x90, 0x99, 0x8A, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x99, 0x8E, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x97, 0xBA, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x97, 0xC2, 0xF0, 0x90, 0x97, 0xC2, 0xE0, 0xFD, 0xC3, 0x94, 0x06, -+0x50, 0x21, 0x90, 0x97, 0xBB, 0xE0, 0x24, 0x04, 0x12, 0xE4, 0xBF, 0x90, 0x8A, 0xE9, 0x12, 0x9A, -+0x4F, 0x90, 0x97, 0xC2, 0x12, 0x9F, 0xCD, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xC2, 0xE0, 0x04, -+0xF0, 0x80, 0xD5, 0x78, 0x2E, 0x7C, 0x93, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xBC, 0x12, -+0xF0, 0x27, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, -+0x85, 0x4E, 0x90, 0x97, 0xB2, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, -+0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE1, 0x0D, 0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFD, -+0xF0, 0x90, 0x86, 0x08, 0x12, 0x8E, 0x2C, 0xF1, 0xC8, 0xE0, 0x30, 0xE2, 0x09, 0x54, 0xFB, 0xF0, -+0x90, 0x86, 0x0A, 0x12, 0x8E, 0x2C, 0xF1, 0xC8, 0xE0, 0xFF, 0x30, 0xE4, 0x0B, 0x54, 0xEF, 0xF0, -+0x12, 0xCF, 0x30, 0xBF, 0x01, 0x02, 0x71, 0x04, 0xF1, 0xC8, 0xE0, 0x30, 0xE6, 0x09, 0x54, 0xBF, -+0xF0, 0x90, 0x8A, 0x7D, 0x12, 0x8E, 0x2C, 0xF1, 0xC8, 0xE0, 0xFF, 0x30, 0xE7, 0x06, 0x54, 0x7F, -+0xF0, 0x12, 0xBE, 0x11, 0xD2, 0xAF, 0x80, 0xA1, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x86, 0xAF, 0x22, -+0x90, 0x93, 0x04, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0x90, 0x99, 0x7B, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, -+0x22, 0x90, 0x99, 0x7D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x7F, 0x64, 0x7E, 0x00, 0x02, 0x7C, -+0x6A, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x0C, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, -+0xE0, 0x04, 0xE4, 0x12, 0x94, 0x39, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x95, 0xD8, 0xF0, 0xBF, -+0x01, 0x0A, 0x7F, 0x01, 0x12, 0x90, 0xB4, 0xE4, 0x90, 0x95, 0xD8, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, 0x29, 0x90, 0x00, 0x8C, -+0xE0, 0x90, 0x9A, 0x30, 0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x9A, 0x31, 0xEF, 0xF0, 0x90, -+0x00, 0x8E, 0xE0, 0x90, 0x9A, 0x32, 0xF0, 0x90, 0x9A, 0x31, 0xE0, 0x7F, 0x8F, 0x12, 0x7B, 0x41, -+0xEF, 0x30, 0xE0, 0x02, 0x11, 0x5B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFD, 0x7F, 0x8D, 0x02, -+0x7B, 0x2E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x3A, 0xEF, 0xF0, 0x7F, 0x8F, -+0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, 0x4A, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, 0x01, 0x70, -+0x40, 0x90, 0x9A, 0x3B, 0xF0, 0x90, 0x9A, 0x3B, 0xE0, 0xFD, 0x90, 0x9A, 0x3A, 0xE0, 0xC4, 0x54, -+0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE5, 0x82, 0x2D, 0xF5, 0x82, 0xE4, -+0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x11, 0xC6, 0x90, 0x9A, 0x3B, 0xE0, 0x04, 0xF0, -+0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCF, 0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, 0x11, -+0x5B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, -+0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, -+0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xE4, 0x90, -+0x97, 0x88, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x97, 0x88, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x95, -+0xE2, 0xE0, 0x70, 0x18, 0x90, 0x95, 0xDF, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x97, -+0x88, 0xE0, 0x24, 0xEE, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB0, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, -+0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, -+0x90, 0x88, 0x38, 0xE0, 0x6F, 0x60, 0x03, 0x12, 0xBB, 0x62, 0xC2, 0xAF, 0x12, 0xB8, 0x6E, 0xBF, -+0x01, 0x16, 0x90, 0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x03, 0x07, 0x90, 0x97, 0x2D, 0xE0, 0x20, 0xE0, -+0x05, 0xEF, 0x64, 0x03, 0x60, 0x02, 0x31, 0x64, 0xD2, 0xAF, 0x12, 0xD0, 0x55, 0x11, 0x1D, 0x12, -+0x83, 0x4D, 0x80, 0x93, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x02, 0x31, 0x6E, 0x22, 0x90, 0x88, -+0x39, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0E, 0x12, 0xEB, 0xAA, 0xBF, 0x01, 0x08, 0x31, 0x87, -+0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x51, 0xB2, -+0x31, 0x97, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x97, 0x8B, 0xF0, 0x12, 0xDB, 0xCA, 0x7F, -+0x08, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0xE4, 0xFF, 0x71, -+0xEB, 0x90, 0x93, 0x0C, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x9A, 0x91, 0x41, 0x44, 0x02, 0x12, 0xD1, -+0xCF, 0xE4, 0x90, 0x97, 0x8C, 0xF0, 0x90, 0x97, 0x8C, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2E, -+0x12, 0x97, 0xAA, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x0F, -+0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x10, 0x90, 0x97, 0x8C, 0xF1, 0xED, 0x90, 0x97, 0x8C, 0x12, 0xEF, -+0x6A, 0x44, 0x40, 0xF0, 0x91, 0x3A, 0x90, 0x97, 0x8C, 0xE0, 0x04, 0xF0, 0x80, 0xC8, 0x90, 0x07, -+0xC7, 0xE4, 0xF0, 0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, 0x77, 0xF0, 0x90, 0x07, 0xC4, -+0xE4, 0xF0, 0x90, 0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x12, 0xDF, 0x77, 0x90, -+0x02, 0x26, 0xE0, 0x44, 0x01, 0xF0, 0xE0, 0x90, 0x97, 0x8D, 0xF0, 0x90, 0x97, 0x8D, 0xE0, 0x30, -+0xE0, 0x1A, 0x90, 0x97, 0x8B, 0xE0, 0x04, 0xF0, 0x12, 0xCF, 0x63, 0x90, 0x02, 0x26, 0xE0, 0x90, -+0x97, 0x8D, 0xF0, 0x90, 0x97, 0x8B, 0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xDF, 0x90, 0x02, 0x03, 0x74, -+0x80, 0xF0, 0x90, 0x04, 0x24, 0xE0, 0x90, 0x97, 0x8E, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x44, 0x10, -+0xF0, 0x90, 0x02, 0x00, 0xE0, 0x90, 0x97, 0x8D, 0xF0, 0x90, 0x02, 0x01, 0x51, 0xA9, 0x90, 0x02, -+0x02, 0x51, 0xA9, 0x90, 0x02, 0x14, 0x51, 0xA9, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, 0x24, 0xF0, -+0x90, 0x04, 0x22, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x97, 0x8E, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, -+0xFD, 0x09, 0x74, 0xFF, 0xF0, 0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x91, 0x48, 0xE4, 0xFD, 0x12, 0x76, -+0xF7, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x97, 0x8D, 0xE0, 0x2F, -+0xF0, 0x22, 0x75, 0x0F, 0x14, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x10, 0xF0, 0x91, 0x48, 0x7D, 0x01, -+0x12, 0x76, 0xF7, 0x90, 0x88, 0x41, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x37, -+0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, -+0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x93, 0x0C, 0xE0, 0x30, 0xE0, 0x6A, 0x90, 0xFD, 0x09, 0xE4, -+0xF0, 0x90, 0xFD, 0x08, 0xF0, 0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, 0x97, 0x8B, -+0xF0, 0x90, 0x97, 0x8B, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2E, 0x12, 0x97, 0xAA, 0x80, 0x05, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x0E, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, -+0x10, 0x90, 0x97, 0x8B, 0xF1, 0xED, 0x90, 0x97, 0x8B, 0x12, 0xEF, 0x6A, 0x44, 0x20, 0xF0, 0x91, -+0x3A, 0x90, 0x97, 0x8B, 0xE0, 0x04, 0xF0, 0x80, 0xC8, 0x71, 0xE4, 0x54, 0xFE, 0xFD, 0x7F, 0x92, -+0x12, 0x7B, 0x2E, 0x71, 0xE4, 0x44, 0x08, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x91, 0x41, 0x54, -+0xFD, 0xFD, 0x7F, 0x02, 0x80, 0x07, 0x71, 0xE4, 0x44, 0x01, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, -+0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0x7F, 0x01, -+0x71, 0xEB, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, 0x7E, -+0x00, 0x02, 0x7C, 0x6A, 0x7F, 0x92, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x90, 0x9A, 0x33, 0xEF, 0x12, -+0x95, 0x65, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x9A, 0x33, -+0xE0, 0x6F, 0x60, 0x35, 0xC3, 0x90, 0x9A, 0x35, 0xE0, 0x94, 0x88, 0x90, 0x9A, 0x34, 0xE0, 0x94, -+0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x9A, 0x34, 0x12, 0xC9, -+0x1C, 0x91, 0x3A, 0xD3, 0x90, 0x9A, 0x35, 0xE0, 0x94, 0x32, 0x90, 0x9A, 0x34, 0xE0, 0x94, 0x00, -+0x40, 0xC0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB9, 0x22, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, -+0x6A, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, -+0x01, 0xFF, 0x90, 0x88, 0xE0, 0xE0, 0xFB, 0x90, 0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, 0xF0, 0x22, -+0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0x8F, 0x80, 0x03, 0x90, 0x8A, 0x87, 0x12, -+0x8E, 0x2C, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x04, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0xE7, -+0xE0, 0x64, 0x08, 0x70, 0x1F, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x13, 0x91, 0x48, 0xE4, 0xFD, -+0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x05, 0xE4, -+0x90, 0x88, 0xE7, 0xF0, 0x90, 0x88, 0xA1, 0x12, 0x97, 0xA2, 0x30, 0xE0, 0x13, 0x90, 0x88, 0xE8, -+0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, 0x90, 0x88, 0xE8, 0xF0, -+0x90, 0x88, 0x36, 0xE0, 0x60, 0x7C, 0x90, 0x88, 0x4D, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x61, 0xB1, -+0xAF, 0x12, 0xDE, 0x64, 0x90, 0x05, 0x60, 0xB1, 0xAF, 0x12, 0x85, 0xD5, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0xB1, 0xAF, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xD5, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0xA3, 0xB1, 0xAF, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0x12, 0x85, 0xD5, 0x90, 0x88, 0x81, 0x12, 0x04, 0x31, 0x90, 0x88, 0x32, 0xE0, 0x54, 0x7F, -+0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0C, 0x12, 0xCF, 0xCE, 0x74, 0x05, 0xF0, 0x12, 0x6E, 0x2F, 0x12, -+0xDD, 0x0D, 0x12, 0xA6, 0x00, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, -+0xA7, 0xED, 0x12, 0x96, 0x40, 0x12, 0xDF, 0xEA, 0xE4, 0x90, 0x95, 0xCF, 0xF0, 0x12, 0xEE, 0xFC, -+0x90, 0x93, 0x24, 0x12, 0xC1, 0x8E, 0x30, 0xE0, 0x52, 0x90, 0x95, 0x63, 0xE0, 0xFE, 0xA3, 0xE0, -+0xFF, 0x7C, 0x00, 0x7D, 0x64, 0x12, 0x02, 0x92, 0x90, 0x95, 0xB7, 0xE0, 0x6E, 0x70, 0x03, 0xA3, -+0xE0, 0x6F, 0x60, 0x0A, 0x90, 0x95, 0xB7, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x02, 0xE7, 0x90, 0x95, -+0x67, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x75, 0xE0, 0xB5, 0x06, 0x14, 0xA3, 0xE0, 0xB5, -+0x07, 0x0F, 0xEF, 0x4E, 0x60, 0x0B, 0x90, 0x01, 0xC7, 0x74, 0x31, 0xF0, 0x7F, 0x01, 0x02, 0xAA, -+0x81, 0x12, 0xCE, 0x9F, 0xE4, 0x90, 0x95, 0xB7, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x9A, 0x3E, 0xE0, -+0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x3E, -+0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0xEF, 0x14, 0x60, 0x02, 0xC1, 0x9B, 0x90, 0x06, 0x03, 0xE0, 0x54, -+0xFB, 0xF0, 0x90, 0x9A, 0x3E, 0xE0, 0xFB, 0xC4, 0x33, 0x54, 0xE0, 0xFE, 0x90, 0x04, 0x42, 0xE0, -+0x54, 0x9F, 0x4E, 0xFE, 0xF0, 0xE4, 0xFD, 0x12, 0xDB, 0xA2, 0x90, 0x9A, 0x3F, 0xEF, 0xF0, 0x90, -+0x04, 0x83, 0xF0, 0x90, 0x99, 0xA4, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x99, 0xA8, -+0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x08, 0xF1, 0x0A, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x00, 0x01, 0x90, 0x99, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, -+0x7E, 0x09, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x10, 0xB1, 0xAC, 0xEF, 0x54, 0x03, -+0xFF, 0xE4, 0x78, 0x01, 0x12, 0x03, 0xEB, 0x78, 0x04, 0xF1, 0xE4, 0x7F, 0x00, 0x7E, 0x0A, 0xF1, -+0x0A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0xB1, 0xAC, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, -+0x0A, 0xF1, 0xE4, 0x7F, 0x00, 0x7E, 0x0D, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x0C, 0x00, 0x00, 0x00, -+0x90, 0x9A, 0x3F, 0xB1, 0xAF, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, 0x1A, 0xF1, 0xE4, 0x7F, 0x18, -+0x7E, 0x08, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x99, 0xA8, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x00, 0x00, 0x12, 0xEF, 0xEF, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, -+0x99, 0x96, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x04, 0x00, 0x80, 0x5D, 0x90, 0x06, 0x03, 0xE0, 0x44, -+0x04, 0xF0, 0x90, 0x99, 0xA4, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x99, 0xA8, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x08, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, -+0x00, 0x00, 0x01, 0x90, 0x99, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, -+0x09, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x99, 0xA8, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x0C, 0x00, 0x12, 0xEF, 0xEF, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x99, -+0x96, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0xD9, -+0x64, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x50, 0x7E, 0x0C, 0xF1, 0x14, 0x90, 0x99, 0xA4, 0x22, -+0x7F, 0x58, 0x7E, 0x0C, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x99, 0xA2, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, 0x90, 0x99, 0xAC, 0x12, 0x04, 0x31, 0x90, 0x99, 0xA4, 0x12, -+0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x99, 0xAC, 0x12, 0x85, 0xE2, 0x12, 0x85, 0xC8, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x99, 0xA4, 0x12, 0x04, 0xB8, 0x90, 0x99, 0xA8, 0x12, -+0x85, 0xE2, 0x12, 0x85, 0xC8, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xD5, -+0x90, 0x99, 0xB0, 0x12, 0x04, 0x31, 0x90, 0x99, 0xB0, 0x12, 0xD1, 0x0B, 0x90, 0x99, 0xA2, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0x04, 0x12, -+0x97, 0xD8, 0x30, 0xE0, 0x08, 0x12, 0xD7, 0x5C, 0xE4, 0x90, 0x98, 0xA3, 0xF0, 0x90, 0x99, 0xA4, -+0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x98, 0x89, 0xB1, 0xAF, 0xF1, 0xE7, 0xF1, 0x06, -+0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x98, 0x8A, 0xB1, 0xAF, 0xF1, 0xE7, 0xF1, 0x10, -+0x90, 0x98, 0x9F, 0xE0, 0x90, 0x06, 0x08, 0xF0, 0x90, 0x98, 0xA1, 0xA3, 0xE0, 0x90, 0x06, 0xA0, -+0xF0, 0xA3, 0xE4, 0xF0, 0x90, 0x98, 0x8D, 0xE0, 0xFF, 0x60, 0x05, 0xA3, 0xE0, 0xFD, 0xB1, 0xB6, -+0x90, 0x98, 0x8C, 0xE0, 0xFF, 0x60, 0x0C, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0x12, 0xDB, 0x29, -+0x12, 0xD9, 0xE2, 0x22, 0x12, 0x03, 0xFE, 0x90, 0x99, 0xA8, 0x02, 0x04, 0x31, 0xE0, 0xFF, 0x24, -+0x1A, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x1F, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB1, 0xF0, 0x22, 0x75, 0x29, 0x10, -+0xE4, 0xF5, 0x2A, 0x75, 0x2B, 0x07, 0x75, 0x2C, 0x02, 0xF5, 0x31, 0xF5, 0x32, 0xF5, 0x33, 0xF5, -+0x34, 0x90, 0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, -+0xE5, 0x2C, 0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, -+0xF0, 0xA3, 0xE5, 0x34, 0xF0, 0x22, 0x75, 0x39, 0x07, 0x43, 0x39, 0x10, 0x75, 0x3A, 0x01, 0x75, -+0x3B, 0x03, 0x75, 0x3C, 0x62, 0x43, 0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, 0x01, 0x38, 0xE5, 0x39, -+0xF0, 0xA3, 0xE5, 0x3A, 0xF0, 0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, 0xF0, 0x22, 0x7D, 0x02, -+0x90, 0x01, 0xC4, 0x74, 0x6E, 0xF0, 0x74, 0xB8, 0xA3, 0xF0, 0x90, 0x95, 0xCB, 0xE0, 0xFF, 0xED, -+0xC3, 0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, -+0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0D, 0x80, 0xDE, 0x74, 0x6E, 0x04, 0x90, -+0x01, 0xC4, 0xF0, 0x74, 0xB8, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x8A, 0x79, 0x74, 0x88, 0xF0, -+0xA3, 0x74, 0x66, 0xF0, 0x90, 0x8A, 0xE5, 0x74, 0xB9, 0xF0, 0xA3, 0x74, 0x73, 0xF0, 0x90, 0x8B, -+0x03, 0x74, 0x88, 0xF0, 0xA3, 0x74, 0xBA, 0xF0, 0x90, 0x8A, 0xB9, 0x74, 0xEC, 0xF0, 0xA3, 0x74, -+0xDF, 0xF0, 0x90, 0x8A, 0xC3, 0x74, 0xDB, 0xF0, 0xA3, 0x74, 0xE9, 0xF0, 0x90, 0x8A, 0xF3, 0x74, -+0xDD, 0xF0, 0xA3, 0x74, 0x15, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0xA3, 0xF0, 0xA3, 0x74, 0xC6, 0xF0, -+0x90, 0x86, 0x04, 0x74, 0xDD, 0xF0, 0xA3, 0x74, 0x21, 0xF0, 0x90, 0x8A, 0xA9, 0x74, 0xD1, 0xF0, -+0xA3, 0x74, 0xE7, 0xF0, 0x90, 0x86, 0x0C, 0x74, 0x98, 0xF0, 0xA3, 0x74, 0x3F, 0xF0, 0x90, 0x8A, -+0xEF, 0x74, 0xD1, 0xF0, 0xA3, 0x74, 0x14, 0xF0, 0x90, 0x86, 0x00, 0x74, 0xEB, 0xF0, 0xA3, 0x74, -+0x44, 0xF0, 0x90, 0x86, 0x02, 0x74, 0xEC, 0xF0, 0xA3, 0x74, 0x23, 0xF0, 0x90, 0x8A, 0xFD, 0x74, -+0xD7, 0xF0, 0xA3, 0x74, 0xEA, 0xF0, 0x90, 0x8A, 0xF9, 0x74, 0xD8, 0xF0, 0xA3, 0x74, 0x49, 0xF0, -+0x90, 0x8A, 0xAF, 0x74, 0xC0, 0xF0, 0xA3, 0x74, 0xE8, 0xF0, 0x90, 0x8A, 0xD3, 0x74, 0xDC, 0xF0, -+0xA3, 0x74, 0x29, 0xF0, 0x90, 0x8A, 0xF5, 0x74, 0xEE, 0xF0, 0xA3, 0x74, 0x7D, 0xF0, 0x90, 0x8A, -+0xA3, 0x74, 0xEE, 0xF0, 0xA3, 0x74, 0xCE, 0xF0, 0x90, 0x86, 0x06, 0x74, 0xD2, 0xF0, 0xA3, 0x74, -+0x21, 0xF0, 0x22, 0x8F, 0x13, 0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x13, -+0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -+0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x01, 0xC4, 0x74, 0x82, 0xF0, 0x74, 0xB9, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, 0x12, 0x97, 0x93, 0x70, -+0x37, 0x90, 0x97, 0x2D, 0xE0, 0xFF, 0x20, 0xE0, 0x2F, 0xE5, 0x26, 0x30, 0xE3, 0x2A, 0x90, 0x00, -+0xCC, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, 0xD4, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x00, 0xC6, 0xE0, -+0x44, 0x02, 0xF0, 0x90, 0x00, 0x01, 0xE0, 0x54, 0xCF, 0xF0, 0x90, 0x00, 0x23, 0xE0, 0x54, 0x7F, -+0xF0, 0xEF, 0x44, 0x01, 0x90, 0x97, 0x2D, 0xF0, 0x74, 0x82, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -+0xB9, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -+0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, -+0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, -+0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x0E, -+0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, 0xE1, 0x02, 0x51, 0xB0, 0xE5, -+0x2D, 0x30, 0xE3, 0x03, 0x12, 0xD8, 0xF9, 0xE5, 0x2D, 0x30, 0xE4, 0x03, 0x12, 0xD9, 0x0C, 0xE5, -+0x2D, 0x30, 0xE5, 0x03, 0x12, 0xD9, 0x1D, 0xE5, 0x2F, 0x30, 0xE0, 0x02, 0x51, 0xB9, 0xE5, 0x2F, -+0x30, 0xE1, 0x03, 0x12, 0xB4, 0x60, 0xE5, 0x2F, 0x30, 0xE2, 0x03, 0x12, 0xC8, 0x7D, 0xE5, 0x2F, -+0x30, 0xE3, 0x02, 0x51, 0xC9, 0xE5, 0x2F, 0x30, 0xE4, 0x02, 0x71, 0x72, 0xE5, 0x2F, 0x30, 0xE5, -+0x02, 0x71, 0xD4, 0xE5, 0x2F, 0x30, 0xE6, 0x02, 0x51, 0xDB, 0x74, 0x0E, 0x04, 0x90, 0x01, 0xC4, -+0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, -+0x90, 0x88, 0x36, 0xE0, 0x60, 0x02, 0x71, 0xF5, 0x22, 0x12, 0x98, 0xE7, 0xE4, 0xFF, 0x91, 0xCF, -+0x90, 0x8B, 0x07, 0x71, 0xCD, 0xF9, 0x02, 0x04, 0x7A, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x0A, -+0x90, 0x88, 0x36, 0xE0, 0x60, 0x04, 0x71, 0x8F, 0x71, 0x9A, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, -+0xBF, 0x01, 0x0E, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x08, 0x51, 0xF2, 0x54, 0x07, 0x70, 0x02, 0x71, -+0x62, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xE4, 0xF5, 0x10, 0x90, 0x06, 0xA9, -+0xE0, 0xF5, 0x10, 0x54, 0xC0, 0x70, 0x18, 0x51, 0xF2, 0x54, 0xFD, 0xF0, 0x71, 0x62, 0x90, 0x88, -+0x39, 0xE0, 0x60, 0x4D, 0x12, 0xB4, 0x41, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE5, -+0x10, 0x30, 0xE6, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x1C, 0x90, 0x88, 0x3A, 0xE0, -+0x44, 0x01, 0xF0, 0x91, 0x46, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, 0x8E, 0x2C, 0x80, -+0x07, 0x12, 0x73, 0x8F, 0x80, 0x02, 0x51, 0xF2, 0xE5, 0x10, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0D, -+0xE0, 0x44, 0x02, 0x71, 0x9A, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, -+0xF0, 0x22, 0x90, 0x88, 0x38, 0xE0, 0xFF, 0x90, 0x8A, 0xB9, 0x12, 0xAE, 0x43, 0x7D, 0x01, 0x02, -+0x04, 0x7E, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x15, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x71, -+0x8F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x91, 0xC4, 0x54, 0x07, 0x70, 0x02, 0x71, 0x62, 0x22, 0x90, -+0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, -+0x90, 0x88, 0x94, 0xE0, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x02, -+0x66, 0x33, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x11, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x06, 0x71, -+0xCA, 0xF9, 0x02, 0x04, 0x7A, 0xF1, 0xC3, 0x71, 0x62, 0x22, 0x90, 0x8B, 0x01, 0xE0, 0xFE, 0xA3, -+0xE0, 0xAA, 0x06, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x18, 0x90, 0x88, 0x36, 0xE0, -+0x60, 0x12, 0x91, 0x46, 0x64, 0x02, 0x60, 0x09, 0x90, 0x8A, 0xE1, 0x71, 0xCD, 0xF9, 0x02, 0x04, -+0x7A, 0x12, 0x73, 0x8F, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xD1, 0xC7, 0x90, -+0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x3F, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x37, 0x90, 0x8A, -+0xD7, 0x12, 0x8E, 0x2C, 0x91, 0x46, 0x60, 0x1F, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, -+0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, -+0x7E, 0x71, 0xCA, 0xF9, 0x02, 0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x08, 0x90, 0x8A, 0xB9, -+0x12, 0x8D, 0x12, 0xD1, 0xAD, 0x22, 0x90, 0x88, 0x34, 0xE0, 0x54, 0x0F, 0x22, 0x12, 0xA6, 0x00, -+0x30, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xF1, 0x9D, 0x90, 0x88, -+0x31, 0x12, 0x97, 0xD8, 0x30, 0xE0, 0x09, 0xEF, 0x91, 0xC4, 0x54, 0x07, 0x70, 0x4D, 0x80, 0x49, -+0x90, 0x88, 0x3F, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEF, 0xF0, 0x12, 0xEE, 0xC2, -+0x40, 0x37, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x32, 0x91, 0x46, 0x70, 0x08, 0x90, 0x8A, 0xF5, -+0x12, 0x8E, 0x2C, 0x80, 0x27, 0x90, 0x8A, 0xF5, 0x12, 0x8E, 0x2C, 0x90, 0x88, 0x40, 0xE0, 0x04, -+0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x09, 0x91, 0xBC, 0xE4, 0x90, 0x88, 0x40, 0xF0, 0x80, 0x03, -+0x12, 0x73, 0x8F, 0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x22, 0x71, 0x62, 0x22, 0x90, 0x88, 0x32, 0xE0, -+0x54, 0xFB, 0xF0, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x25, 0x90, -+0x99, 0x58, 0x74, 0x1E, 0xF0, 0x90, 0x99, 0x7A, 0x74, 0x01, 0xF0, 0x90, 0x99, 0x5A, 0xEF, 0xF0, -+0x7B, 0x01, 0x7A, 0x99, 0x79, 0x58, 0x12, 0xEF, 0xA7, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0x12, 0x7F, -+0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xB1, 0x50, 0x12, 0xA4, 0xE4, 0x7F, 0x01, -+0x91, 0xCF, 0x90, 0x8B, 0x07, 0x12, 0x8E, 0x2C, 0x90, 0x93, 0x08, 0xE0, 0x30, 0xE0, 0x30, 0xF1, -+0xCB, 0x90, 0x93, 0x0B, 0xE0, 0x60, 0x05, 0x14, 0xF0, 0x02, 0x79, 0xD4, 0xF1, 0xDD, 0xE4, 0xFF, -+0x12, 0xA0, 0x11, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x20, 0xE0, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0x30, 0xE0, 0x0C, 0x90, 0x9A, 0x04, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0xB1, 0x98, 0x22, -+0xE4, 0x90, 0x98, 0x82, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x3C, 0x12, 0xA7, 0xE6, 0x64, 0x01, -+0x70, 0x35, 0xF1, 0xAB, 0xF0, 0x12, 0xEF, 0x2C, 0x90, 0x98, 0x82, 0x74, 0x01, 0xF0, 0xE4, 0x90, -+0x88, 0x3D, 0xF0, 0x04, 0x60, 0x21, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, 0x90, 0x8A, 0xB9, -+0x12, 0x8D, 0x12, 0xD1, 0xAD, 0xF1, 0xB3, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x12, 0x98, 0xDD, 0x71, -+0xA4, 0x90, 0x8A, 0xD7, 0x12, 0x8E, 0x2C, 0x22, 0xE4, 0x90, 0x9A, 0x08, 0xF0, 0x7F, 0x03, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x03, 0xEF, 0xF0, 0xF1, 0x57, 0x90, 0x9A, 0x03, -+0xE0, 0xFF, 0xF1, 0x49, 0x74, 0x01, 0xF0, 0x90, 0x9A, 0x08, 0xE0, 0xFE, 0xEF, 0xD1, 0xB4, 0xEE, -+0xF0, 0x90, 0x9A, 0x03, 0xE0, 0xD1, 0x03, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0xB1, 0xF8, -+0x78, 0x10, 0x12, 0x03, 0xEB, 0xAB, 0x07, 0xB1, 0xF8, 0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, 0x92, -+0x20, 0xEF, 0xF0, 0xB1, 0xF8, 0x90, 0x92, 0x21, 0xEF, 0xF0, 0x7D, 0x01, 0x7F, 0x50, 0x7E, 0x01, -+0x12, 0x66, 0x33, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9A, 0x04, 0x02, 0x04, 0xB8, 0x90, 0x97, -+0xB3, 0xE0, 0xFB, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x08, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, -+0x22, 0xE4, 0x90, 0x97, 0xB3, 0xF0, 0x90, 0x97, 0xB3, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x40, 0x02, -+0xC1, 0xA5, 0xF1, 0x48, 0xE0, 0x64, 0x01, 0x70, 0x74, 0x90, 0x97, 0xB3, 0xE0, 0xD1, 0x03, 0x12, -+0x04, 0xB8, 0xE4, 0x7B, 0x01, 0xD1, 0xA6, 0x70, 0x3A, 0x90, 0x97, 0xB3, 0xE0, 0xFB, 0xD1, 0xB4, -+0xE0, 0x60, 0x21, 0x14, 0x70, 0x57, 0xEB, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x0C, 0xF5, 0x82, 0xE4, -+0x34, 0x99, 0xF5, 0x83, 0x12, 0x04, 0xB8, 0xEB, 0xD1, 0x03, 0x12, 0x04, 0x31, 0x90, 0x97, 0xB3, -+0xE0, 0xFF, 0x80, 0x0B, 0xB1, 0xFE, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0xAF, 0x03, 0xD1, -+0xC2, 0x80, 0x2A, 0x90, 0x97, 0xB3, 0xE0, 0xD1, 0x03, 0x12, 0x04, 0xB8, 0xE4, 0xFB, 0xD1, 0xA6, -+0x50, 0x1B, 0xB1, 0xFE, 0x12, 0x04, 0xB8, 0xEF, 0x24, 0xFF, 0xFF, 0xEE, 0x34, 0xFF, 0xFE, 0xED, -+0x34, 0xFF, 0xFD, 0xEC, 0x34, 0xFF, 0xFC, 0xEB, 0xD1, 0x03, 0x12, 0x04, 0x31, 0x90, 0x97, 0xB3, -+0xE0, 0x04, 0xF0, 0xC1, 0x16, 0x22, 0xFA, 0xF9, 0xF8, 0xC3, 0x02, 0x03, 0xDA, 0x7D, 0x01, 0x7F, -+0x04, 0x02, 0x04, 0x7E, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, -+0x83, 0x22, 0xEF, 0x24, 0xFC, 0x60, 0x05, 0x04, 0x70, 0x05, 0x80, 0x04, 0x12, 0xDA, 0x63, 0x22, -+0xE4, 0x90, 0x97, 0xB4, 0xF0, 0x90, 0x99, 0x07, 0x04, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x04, -+0xF0, 0x12, 0xE7, 0xB9, 0xE4, 0x90, 0x98, 0x88, 0xF0, 0xFF, 0xF1, 0x67, 0x12, 0xA7, 0xE6, 0x64, -+0x01, 0x70, 0x47, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x04, 0x7E, -+0x7F, 0x05, 0x7E, 0x00, 0x12, 0x7A, 0xAE, 0x12, 0xEF, 0xD8, 0x12, 0x8D, 0x12, 0xF1, 0xA4, 0x90, -+0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x23, 0x90, 0x97, 0xB4, 0xE0, 0x04, 0xF0, 0x7F, 0x01, 0x7E, -+0x00, 0x12, 0x7A, 0xAE, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x04, -+0x7E, 0x90, 0x97, 0xB4, 0xE0, 0xD3, 0x94, 0x0A, 0x40, 0xD5, 0x90, 0x9A, 0x04, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x00, 0x0A, 0xF1, 0xBB, 0xA1, 0x9F, 0xEF, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x11, 0xF5, -+0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, 0x90, 0x01, 0x53, 0xE4, 0xF0, 0xFF, 0xF1, 0x48, 0xE4, -+0xF0, 0x0F, 0xEF, 0xB4, 0x08, 0xF7, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, -+0xD9, 0xEF, 0xF0, 0x90, 0x93, 0x06, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x74, 0x10, 0x2F, 0xFF, 0x90, -+0x97, 0xD9, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x2F, 0xFF, 0x12, 0xC7, 0x81, 0x75, 0x48, 0x04, 0x7B, -+0x01, 0x7A, 0x98, 0x79, 0x9B, 0x12, 0x69, 0xF5, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x02, 0x7F, -+0x02, 0x02, 0x7C, 0x7E, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x88, 0x3C, 0xE0, 0x90, -+0x05, 0x73, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xE4, 0x90, 0x9A, 0x08, 0xF0, -+0x7F, 0x04, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x90, 0x93, 0x0A, 0xE0, 0x90, -+0x05, 0x73, 0xF0, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x02, 0x91, 0x4D, 0x22, 0x90, 0x93, 0x09, -+0xE0, 0x14, 0x90, 0x93, 0x0B, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, -+0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xE7, 0xF0, 0x74, 0xBF, 0xA3, 0xF0, 0x12, 0x75, -+0x50, 0xE5, 0x3D, 0x30, 0xE0, 0x03, 0x12, 0xD9, 0x59, 0xE5, 0x3D, 0x30, 0xE1, 0x03, 0x12, 0xBF, -+0xD4, 0xE5, 0x3D, 0x30, 0xE2, 0x03, 0x12, 0xBB, 0xB2, 0xE5, 0x3D, 0x30, 0xE4, 0x02, 0xF1, 0xE7, -+0xE5, 0x3E, 0x30, 0xE0, 0x03, 0x12, 0xC8, 0x8F, 0xE5, 0x3F, 0x30, 0xE2, 0x09, 0x11, 0x9B, 0x90, -+0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x40, 0x30, 0xE1, 0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x8D, -+0x12, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, 0x40, 0x30, 0xE4, 0x03, 0x12, 0xBD, 0x09, 0xE5, 0x40, -+0x30, 0xE5, 0x03, 0x12, 0xCF, 0xFF, 0xE5, 0x40, 0x30, 0xE6, 0x02, 0x31, 0xA1, 0xE5, 0x40, 0x30, -+0xE7, 0x03, 0x12, 0xCF, 0xDF, 0x74, 0xE7, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBF, 0xA3, 0xF0, -+0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x2E, 0x90, 0x88, 0xF7, 0xE0, 0xB4, 0x01, 0x17, -+0xA3, 0xE0, 0xB4, 0x01, 0x22, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x90, 0x8A, 0x7F, 0x11, 0xDC, 0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, 0xB4, 0x02, 0x09, 0x74, 0x03, -+0xF0, 0x90, 0x8A, 0xE7, 0x12, 0x8E, 0x2C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, -+0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x9A, 0x1F, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, -+0xE0, 0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, -+0x3F, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x9A, 0x23, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0x12, 0x7D, -+0x26, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x12, 0x8E, 0x29, 0xEF, 0x64, 0x01, 0x70, 0x02, 0x80, 0x05, -+0x31, 0x8B, 0x30, 0xE0, 0x07, 0x12, 0x9A, 0x28, 0x31, 0x95, 0x11, 0xDC, 0x90, 0x9A, 0x23, 0xE0, -+0xFF, 0x90, 0x8A, 0xF9, 0x12, 0xAE, 0x43, 0x7D, 0x27, 0x12, 0x04, 0x7E, 0x31, 0x82, 0x80, 0x09, -+0x31, 0x82, 0x11, 0xDC, 0x12, 0x9A, 0x28, 0x31, 0x95, 0x11, 0xDC, 0x90, 0x88, 0x9D, 0xE0, 0x30, -+0xE0, 0x17, 0x31, 0x8B, 0x30, 0xE0, 0x12, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x6F, 0xFF, 0x90, 0x8A, -+0xF9, 0x12, 0xAE, 0x43, 0x7D, 0x28, 0x12, 0x04, 0x7E, 0x31, 0xFD, 0x7F, 0x01, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x9A, 0x1F, 0xE0, 0xFF, 0x90, 0x8A, 0xC7, 0x22, 0x90, 0x88, 0xA1, 0xE0, 0xC4, -+0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x9A, 0x21, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x9B, -+0x22, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0x12, 0x8F, 0xDB, 0x30, 0xE0, 0x21, 0xEF, 0x54, 0x7F, 0x12, -+0xD0, 0x42, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFD, 0xF0, 0x12, -+0xD0, 0x4B, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0xBB, 0x62, 0x31, 0x8B, 0x30, -+0xE0, 0x22, 0x90, 0x88, 0xA4, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x18, 0xEF, 0x54, 0xFD, 0xF0, -+0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x04, -+0xE0, 0x54, 0xFB, 0xF0, 0x7F, 0x01, 0x02, 0x97, 0x1E, 0xE4, 0xFF, 0x91, 0xCF, 0x90, 0x04, 0x1F, -+0x74, 0x20, 0xF0, 0x22, 0x90, 0x97, 0xE0, 0x12, 0x85, 0xF7, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x97, -+0xF1, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0C, 0x7B, 0x39, 0x12, 0x8E, 0x22, 0xEF, 0x64, 0x01, -+0x70, 0x16, 0x80, 0x00, 0x90, 0x95, 0xBD, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x11, 0xF1, 0xCC, -+0x90, 0x97, 0xEE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x97, 0xEE, 0x12, 0xE3, 0x28, 0x90, 0x97, -+0xF0, 0xEF, 0xF0, 0x90, 0x97, 0xEE, 0xF1, 0xEA, 0x90, 0x97, 0xEC, 0xE0, 0xFD, 0x12, 0xE1, 0x20, -+0x90, 0x97, 0xED, 0xE0, 0x60, 0x02, 0x41, 0xE8, 0x91, 0xDA, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, -+0x90, 0x97, 0xE3, 0x71, 0xA6, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x71, 0x92, -+0xD1, 0xE2, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x97, 0xE0, 0x71, 0xA6, -+0x75, 0x48, 0x10, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x71, 0x92, 0xE0, 0x2F, 0x91, 0xDD, 0xC0, -+0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x97, 0xE6, 0x71, 0xA6, 0x75, 0x48, 0x10, 0xD0, 0x01, 0xD0, -+0x02, 0xD0, 0x03, 0x71, 0x92, 0xE0, 0x2F, 0x24, 0x60, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, -+0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x97, 0xE6, 0x71, 0xA6, 0x75, 0x48, 0x10, 0xD0, 0x01, -+0xD0, 0x02, 0xD0, 0x03, 0x71, 0x92, 0xE0, 0x2F, 0x24, 0x72, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, -+0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x97, 0xE9, 0x71, 0xA6, 0x75, 0x48, 0x06, 0xD0, -+0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x97, 0xE6, 0x12, 0x85, 0xEE, 0x90, 0x98, -+0x1D, 0x12, 0x85, 0xF7, 0x90, 0x98, 0x20, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x20, 0x90, 0x98, -+0x24, 0x74, 0x3A, 0xF0, 0x90, 0x97, 0xE0, 0x12, 0x85, 0xEE, 0xF1, 0x8F, 0x71, 0x95, 0xD1, 0xC4, -+0xF1, 0x87, 0x75, 0x48, 0x28, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xF2, 0x71, 0x92, 0xD1, 0xC4, 0xFA, -+0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0xCD, 0x75, 0x48, 0x28, 0xD0, -+0x03, 0x12, 0x69, 0xF5, 0x90, 0x97, 0xF0, 0xE0, 0xFF, 0x90, 0x97, 0xEF, 0xE0, 0x2F, 0xFF, 0x90, -+0x97, 0xEE, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, 0xFD, 0xE4, 0x3F, 0xFC, 0x90, 0x95, 0xBD, 0xE0, -+0xFB, 0x7F, 0x3A, 0x91, 0xE7, 0x71, 0x95, 0xD1, 0xC4, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x45, -+0x75, 0x46, 0x97, 0x75, 0x47, 0xF2, 0x75, 0x48, 0x28, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x95, -+0xB9, 0xE0, 0xB4, 0x02, 0x0D, 0x90, 0x95, 0xBD, 0xE0, 0xFF, 0x90, 0x97, 0xF0, 0xE0, 0xFD, 0x12, -+0xCC, 0xBA, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x97, 0xF1, 0xE0, 0xFD, 0x7B, 0x3A, -+0x21, 0xF9, 0x12, 0x69, 0xF5, 0x90, 0x97, 0xEE, 0xA3, 0xE0, 0xFF, 0xA3, 0x22, 0x90, 0x97, 0x32, -+0x12, 0x85, 0xF7, 0x90, 0x97, 0x32, 0x12, 0x85, 0xEE, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x99, 0xB4, 0x12, 0x85, 0xF7, 0x78, 0xC0, 0x7C, -+0x99, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x8E, 0x12, 0x9F, 0xB7, 0x90, 0x05, 0x22, 0xE0, -+0x90, 0x99, 0xBF, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0C, 0x7B, 0x33, 0x12, 0x8E, 0x22, 0xEF, -+0x64, 0x01, 0x70, 0x16, 0x80, 0x00, 0x90, 0x95, 0xBC, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x10, -+0xF1, 0xCC, 0x90, 0x99, 0xBC, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0xBC, 0x12, 0xE3, 0x28, -+0x90, 0x99, 0xBE, 0xEF, 0xF0, 0x90, 0x99, 0xBC, 0xF1, 0xEA, 0x90, 0x99, 0xBA, 0xE0, 0xFD, 0x12, -+0xE1, 0x20, 0x90, 0x99, 0xBB, 0xE0, 0x70, 0x49, 0x91, 0xDA, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, -+0x90, 0x99, 0xB7, 0x71, 0xA6, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0xE3, -+0xDB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x99, 0xB7, 0x71, 0xA6, 0x75, -+0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0xD1, 0xD8, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, -+0x02, 0xC0, 0x01, 0x90, 0x99, 0xB4, 0x71, 0xA6, 0x75, 0x48, 0x04, 0xD0, 0x01, 0xD0, 0x02, 0x80, -+0x40, 0x90, 0x99, 0xBB, 0xE0, 0x64, 0x01, 0x70, 0x3D, 0x91, 0xDA, 0xC0, 0x03, 0x8B, 0x45, 0x75, -+0x46, 0x93, 0x75, 0x47, 0x49, 0x75, 0x48, 0x06, 0xD0, 0x03, 0x12, 0xE3, 0xDB, 0xFA, 0x7B, 0x01, -+0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0x53, 0x75, 0x48, 0x06, 0xD0, 0x03, 0xD1, -+0xD8, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0x59, 0x75, 0x48, -+0x04, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x95, 0xB9, 0xE0, 0xB4, 0x02, 0x0D, 0x90, 0x95, 0xBC, -+0xE0, 0xFF, 0x90, 0x99, 0xBE, 0xE0, 0xFD, 0x12, 0xCC, 0xBA, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x10, -+0xF0, 0x90, 0x99, 0xBF, 0xE0, 0xFD, 0x7B, 0x34, 0x31, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0x05, 0x22, 0xED, 0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, 0xA3, 0xA3, 0xE0, 0x24, 0x38, 0xF9, -+0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x99, -+0xD5, 0xEC, 0x12, 0x97, 0xBA, 0xAA, 0x07, 0x90, 0x99, 0xDC, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, -+0x00, 0xF1, 0xDC, 0xEA, 0x24, 0xEF, 0x60, 0x34, 0x24, 0xD7, 0x70, 0x02, 0xC1, 0x41, 0x24, 0x3A, -+0x60, 0x02, 0xC1, 0x75, 0xD1, 0xB5, 0x24, 0x0A, 0xD1, 0xEB, 0xE4, 0xD1, 0xA9, 0xE4, 0xF0, 0xFE, -+0x74, 0x00, 0x2F, 0xF1, 0xD4, 0x7D, 0x14, 0xD1, 0x90, 0x12, 0xCF, 0x6A, 0xD1, 0x9B, 0x90, 0x90, -+0xBE, 0x12, 0x04, 0x31, 0x7D, 0x14, 0x7C, 0x00, 0xE4, 0xFF, 0xC1, 0x3C, 0x90, 0x99, 0xD5, 0xE4, -+0x75, 0xF0, 0x14, 0x12, 0x02, 0xE7, 0x90, 0x99, 0xD5, 0xA3, 0xE0, 0xFB, 0xFF, 0x24, 0x06, 0xFC, -+0xE4, 0x33, 0x90, 0x99, 0xE0, 0xF0, 0xA3, 0xCC, 0xF0, 0x90, 0x99, 0xE0, 0xA3, 0xE0, 0xD1, 0xF5, -+0xE4, 0xD1, 0xA9, 0xE4, 0x12, 0xCF, 0xB6, 0xE0, 0xFE, 0xA9, 0x03, 0x74, 0x05, 0x29, 0x12, 0xCE, -+0x4F, 0xFE, 0x90, 0x99, 0xDA, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0xD5, 0xE0, 0xFC, 0xA3, 0xE0, -+0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xD3, 0xEF, 0x94, 0x00, 0xEE, 0x94, 0x01, 0x90, 0x99, 0xD5, 0x40, -+0x69, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xE9, 0x7C, 0x00, 0x24, 0x00, 0xF9, 0xEC, 0x34, 0xFC, 0xFA, -+0x7B, 0x01, 0xC3, 0xE4, 0x9F, 0xFD, 0x74, 0x01, 0x9E, 0xFC, 0xD1, 0x92, 0x90, 0x99, 0xD7, 0xE0, -+0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xD1, 0xD2, -+0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0x7B, 0x01, 0x7A, 0xFC, 0x79, 0x00, 0x90, 0x99, -+0xD5, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0xE4, 0x9F, 0xFF, 0x74, 0x01, 0x9E, 0xFE, 0xD1, 0xBC, -+0xC3, 0x9F, 0xFD, 0xEC, 0x9E, 0xFC, 0x12, 0x45, 0xC2, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0x12, 0x85, 0xAD, 0xD1, 0x95, 0xF1, 0xDC, 0x80, 0x0D, 0xA3, 0xE0, 0x7E, 0x00, 0x24, 0x00, -+0xF1, 0xD4, 0xD1, 0xBC, 0xFD, 0xD1, 0x92, 0x90, 0x99, 0xD5, 0x74, 0xFF, 0x75, 0xF0, 0xEC, 0x12, -+0x02, 0xE7, 0xD1, 0xB5, 0x7E, 0x00, 0x24, 0x0C, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, -+0x02, 0xC0, 0x01, 0x74, 0x10, 0x2F, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0xD1, 0x9B, 0x90, 0x90, 0xBE, -+0x12, 0x04, 0x31, 0xD1, 0xBC, 0xFD, 0xD0, 0x01, 0xD0, 0x02, 0x7F, 0x11, 0x12, 0x3C, 0xD9, 0x80, -+0x2C, 0xD1, 0xB5, 0x24, 0x2A, 0xD1, 0xEB, 0xE4, 0xD1, 0xA9, 0xE4, 0xF0, 0x12, 0xCF, 0xAB, 0x7D, -+0x48, 0xD1, 0x90, 0xD1, 0xA1, 0xD1, 0xCD, 0x12, 0x85, 0xAD, 0xE4, 0xFD, 0xFC, 0xD1, 0x95, 0xD1, -+0xA1, 0xD1, 0xCD, 0x12, 0x85, 0xAD, 0xD1, 0x95, 0xD1, 0xA1, 0x12, 0x03, 0xCD, 0x90, 0x99, 0xD8, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0xD8, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0xFF, 0x90, -+0x99, 0xE0, 0xA3, 0xE0, 0xD1, 0xF5, 0xEF, 0xD1, 0xA9, 0xED, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x7C, 0x00, 0x12, 0x45, 0xC2, 0x90, 0x99, 0xDC, 0x02, 0x04, 0x31, 0x90, 0x90, 0xBB, 0x12, 0x85, -+0xF7, 0x90, 0x99, 0xDC, 0x02, 0x04, 0xB8, 0x74, 0x03, 0xF0, 0x74, 0x01, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x99, 0xD5, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x99, 0xDA, 0xE0, -+0xFC, 0xA3, 0xE0, 0x22, 0xE0, 0x2F, 0x24, 0x30, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0x78, 0x10, 0x12, -+0x03, 0xEB, 0x90, 0x99, 0xDC, 0x02, 0x85, 0xE2, 0x12, 0x69, 0xF5, 0x90, 0x99, 0xBC, 0xA3, 0xE0, -+0xFF, 0xA3, 0xE0, 0x2F, 0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0xFD, 0xE4, 0x33, 0x90, 0x99, -+0xE0, 0xF0, 0xA3, 0xED, 0xF0, 0xFE, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x07, 0x12, 0xD7, 0x8E, 0xD1, 0xF8, 0xE0, -+0x90, 0x98, 0xA4, 0xF0, 0x74, 0x01, 0x2F, 0xD1, 0xAD, 0xE0, 0x90, 0x98, 0xC5, 0x12, 0xD3, 0xF9, -+0x90, 0x98, 0xE6, 0xF0, 0xEF, 0x24, 0x20, 0x90, 0x97, 0x32, 0xF0, 0xF1, 0x81, 0x90, 0x98, 0xA4, -+0xE0, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0xA5, 0x12, 0x69, 0xF5, 0x90, 0x98, 0xA4, 0xF1, -+0x78, 0x90, 0x98, 0xC5, 0xE0, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0xC6, 0x12, 0x69, 0xF5, -+0x90, 0x98, 0xC5, 0xF1, 0x78, 0x90, 0x98, 0xE6, 0xE0, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x98, 0x79, -+0xE7, 0x12, 0x69, 0xF5, 0xE4, 0xFF, 0x90, 0x98, 0xA4, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x03, -+0x0F, 0x80, 0xF3, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x90, 0x97, 0x32, 0xE0, 0x2F, 0xF0, -+0xE0, 0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x45, 0x01, 0xF5, 0x46, 0x89, 0x47, 0x22, 0x90, -+0x98, 0x1A, 0x12, 0x85, 0xF7, 0x90, 0x98, 0x1D, 0x71, 0xA6, 0x75, 0x48, 0x10, 0x7B, 0x01, 0x7A, -+0x93, 0x79, 0xCD, 0x12, 0x69, 0xF5, 0x90, 0x98, 0x1A, 0x71, 0xA6, 0x75, 0x48, 0x10, 0x7B, 0x01, -+0x7A, 0x93, 0x79, 0xDD, 0x12, 0x69, 0xF5, 0x90, 0x98, 0x20, 0x12, 0x04, 0xB8, 0x90, 0x93, 0xED, -+0x12, 0x04, 0x31, 0x90, 0x98, 0x24, 0xE0, 0x90, 0x93, 0xF4, 0xF0, 0x22, 0xF0, 0x7B, 0x18, 0x7D, -+0x01, 0x02, 0x66, 0xDB, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0x90, 0x99, 0xD7, 0xE0, -+0xC3, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0x22, 0x02, 0x34, 0x78, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, -+0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -+0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xF6, 0xF0, 0x74, 0xC7, 0xA3, 0xF0, 0x90, 0x8A, 0x9D, -+0x12, 0x8E, 0x2C, 0x53, 0x91, 0xBF, 0x74, 0xF6, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC7, 0xA3, -+0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, -+0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x4C, 0x90, 0x01, 0xC4, -+0xED, 0xF0, 0x74, 0xC8, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, -+0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x95, 0xD6, -+0xE0, 0x04, 0xF0, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x03, 0x12, 0xA0, 0x66, 0x22, 0x11, -+0xD8, 0x90, 0x98, 0x82, 0xEF, 0xF0, 0x90, 0x8A, 0x89, 0x30, 0xE0, 0x13, 0x12, 0x8D, 0x12, 0x7D, -+0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x09, 0x12, -+0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x98, 0x82, 0xE0, 0x30, 0xE6, 0x11, 0x90, -+0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, -+0xF1, 0xCE, 0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, 0x90, 0x98, 0x84, 0xF0, 0xA3, 0xF0, 0x7F, -+0x83, 0x12, 0x7B, 0x41, 0x90, 0x98, 0x83, 0xEF, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, 0xAE, 0x07, -+0x90, 0x98, 0x83, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x98, 0x85, 0xE0, 0x94, 0x64, -+0x90, 0x98, 0x84, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, -+0x98, 0x83, 0xE0, 0xFF, 0x22, 0x90, 0x98, 0x84, 0x31, 0x1C, 0x80, 0xC3, 0xE4, 0x75, 0xF0, 0x01, -+0x02, 0x02, 0xE7, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, 0xC1, 0xF1, 0xA4, 0xED, -+0xF0, 0x90, 0x97, 0xD9, 0x74, 0x18, 0xF0, 0x7E, 0x00, 0x7F, 0x80, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -+0x97, 0x79, 0xE1, 0x12, 0x04, 0x80, 0x90, 0x01, 0xC4, 0x74, 0x23, 0xF0, 0x74, 0xC9, 0xA3, 0xF0, -+0x90, 0x95, 0xBE, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, 0x97, 0xD8, 0xEF, 0xF0, 0xF9, 0xE0, 0xFE, -+0x24, 0x29, 0xF1, 0x99, 0x74, 0x41, 0xF0, 0xEE, 0x24, 0x28, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x97, -+0xD9, 0xE0, 0x7A, 0x00, 0x2D, 0xFE, 0xEA, 0x3C, 0x90, 0x97, 0xDD, 0xF0, 0xA3, 0xCE, 0xF0, 0x74, -+0x28, 0x29, 0x12, 0xC7, 0xEE, 0x90, 0x97, 0xC3, 0xE0, 0xFD, 0x12, 0xE1, 0x20, 0x91, 0x17, 0x90, -+0x97, 0xDD, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x97, 0xDB, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x97, -+0xE1, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0x74, 0x5F, 0xF0, 0x90, -+0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x04, 0x12, 0x02, 0xE7, 0x90, 0x94, 0x39, 0xE0, 0xFF, 0x7E, 0x02, -+0xB4, 0xFE, 0x02, 0x7E, 0xFE, 0x90, 0x97, 0xDD, 0xA3, 0xE0, 0xFD, 0x12, 0xC6, 0xF6, 0xEE, 0xF0, -+0x74, 0x00, 0x2D, 0x12, 0xC6, 0xF8, 0xE0, 0x90, 0x97, 0xE5, 0xF0, 0x90, 0x97, 0xDD, 0x31, 0x1C, -+0x90, 0x95, 0x2E, 0xE0, 0x90, 0x97, 0xC1, 0xB4, 0x01, 0x0B, 0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, -+0x44, 0x10, 0xFD, 0x80, 0x09, 0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, 0x44, 0x20, 0xFD, 0x90, 0x97, -+0xDF, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x97, 0xC1, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, -+0x90, 0x97, 0xDD, 0x70, 0x17, 0xA3, 0xE0, 0x12, 0xC6, 0xF5, 0x12, 0xC6, 0xA7, 0x74, 0x01, 0xF0, -+0x90, 0x97, 0xE6, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0x80, 0x13, 0xA3, 0xE0, 0x12, 0xC6, -+0xF5, 0x12, 0xC6, 0xA7, 0x74, 0x02, 0xF0, 0x90, 0x97, 0xE6, 0x04, 0xF0, 0xA3, 0x14, 0xF0, 0x91, -+0x4C, 0xEF, 0x64, 0xFE, 0x90, 0x97, 0xDD, 0x70, 0x1E, 0xA3, 0xE0, 0x24, 0x00, 0xF1, 0xAE, 0xC0, -+0x03, 0x8B, 0x45, 0x91, 0x56, 0xD0, 0x03, 0x12, 0x97, 0x8C, 0x91, 0x56, 0x7B, 0x01, 0x7A, 0x97, -+0x79, 0xE8, 0x12, 0x69, 0xF5, 0x80, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x24, 0x00, 0xF5, 0x82, -+0x74, 0xFC, 0x3E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2F, 0xF5, 0x82, 0x74, 0xFC, 0x3E, 0xF5, -+0x83, 0xE4, 0xF0, 0x90, 0x97, 0xE8, 0xF0, 0xA3, 0xF0, 0x91, 0x4C, 0xE4, 0x90, 0x97, 0xDA, 0xF0, -+0x91, 0x60, 0xFE, 0x90, 0x97, 0xDD, 0xA3, 0xE0, 0xFD, 0xEF, 0x2D, 0x12, 0xC6, 0xF6, 0xEE, 0xF0, -+0x91, 0x60, 0xFE, 0x74, 0xEA, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xEE, 0x91, 0x0F, -+0xE0, 0xB4, 0x08, 0xDC, 0x91, 0x21, 0x90, 0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x20, 0x12, 0x02, 0xE7, -+0x90, 0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x02, 0xE7, 0x91, 0x17, 0xE4, 0x90, 0x98, 0x64, -+0xF0, 0xE4, 0x90, 0x97, 0xDA, 0xF0, 0x91, 0x43, 0x50, 0x0C, 0x91, 0x90, 0xF0, 0xE0, 0x12, 0xC6, -+0xF6, 0xE4, 0x91, 0x0F, 0x80, 0xF0, 0x12, 0xAF, 0xEA, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xFB, 0xF0, -+0x90, 0x95, 0xBF, 0x91, 0xB1, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xB1, 0xEB, -+0xED, 0xFF, 0x90, 0x95, 0xBE, 0xB1, 0xF5, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, -+0x97, 0xD9, 0xE0, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x3E, 0xCF, 0x24, 0x38, 0xCF, 0x34, 0x00, 0xFE, -+0x90, 0x92, 0x06, 0x74, 0x10, 0xF0, 0x7B, 0x63, 0xE4, 0xFD, 0x12, 0x71, 0xD4, 0x90, 0x97, 0xC1, -+0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xE1, 0x70, 0x15, 0x90, -+0x91, 0xA0, 0x91, 0x3B, 0x90, 0x91, 0xA3, 0x12, 0x85, 0xF7, 0x90, 0x91, 0xA6, 0x91, 0x33, 0x12, -+0x6F, 0x34, 0x80, 0x13, 0x90, 0x91, 0x96, 0x91, 0x3B, 0x90, 0x91, 0x99, 0x12, 0x85, 0xF7, 0x90, -+0x91, 0x9C, 0x91, 0x33, 0x12, 0x6E, 0xF3, 0x90, 0x98, 0x64, 0xE0, 0x04, 0xF0, 0x90, 0x06, 0x31, -+0xE0, 0x30, 0xE2, 0x06, 0x91, 0x2B, 0x50, 0x02, 0x41, 0xD1, 0x91, 0x2B, 0x40, 0x0A, 0x90, 0x06, -+0x35, 0xE0, 0x44, 0x20, 0x90, 0x06, 0x34, 0xF0, 0xE4, 0x90, 0x97, 0xDA, 0xF0, 0x91, 0x43, 0x50, -+0x1E, 0x91, 0x90, 0xF0, 0x90, 0x97, 0xDA, 0xE0, 0x24, 0xC4, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, -+0x83, 0xE0, 0xFF, 0x90, 0x97, 0xD8, 0xE0, 0x12, 0xC6, 0xF6, 0xEF, 0x91, 0x0F, 0x80, 0xDE, 0x90, -+0x97, 0xC1, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x0E, 0x90, 0x95, 0xBE, 0xE0, 0xFF, -+0x90, 0x97, 0xD9, 0xE0, 0x24, 0x08, 0xFD, 0x91, 0xBA, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x20, 0x90, -+0x05, 0x22, 0xE0, 0x90, 0x98, 0x63, 0xF0, 0x7B, 0x1D, 0x12, 0x8E, 0x22, 0xBF, 0x01, 0x02, 0x91, -+0x70, 0x90, 0x98, 0x63, 0xE0, 0xFD, 0x7B, 0x1E, 0xE4, 0xFF, 0x12, 0xC4, 0xCF, 0x80, 0x02, 0x91, -+0x70, 0x12, 0xC1, 0xFD, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x74, -+0x23, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC9, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, -+0x90, 0x97, 0xDA, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x02, -+0xE7, 0x90, 0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x08, 0x02, 0x02, 0xE7, 0x90, 0x98, 0x64, 0xE0, 0xC3, -+0x94, 0x0A, 0x22, 0x74, 0x10, 0xF0, 0x7A, 0x93, 0x79, 0xF5, 0x22, 0x12, 0x85, 0xF7, 0x7A, 0x97, -+0x79, 0xC4, 0x22, 0x90, 0x97, 0xDA, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x22, 0x90, 0x97, 0xDD, 0xE4, -+0x75, 0xF0, 0x02, 0x02, 0x02, 0xE7, 0x75, 0x46, 0x94, 0x75, 0x47, 0x3C, 0x75, 0x48, 0x02, 0x22, -+0x90, 0x97, 0xDA, 0xE0, 0xFF, 0x24, 0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0x22, -+0x90, 0x95, 0xBE, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x08, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x12, -+0x66, 0xDB, 0x90, 0x97, 0xD8, 0xEF, 0xF0, 0x90, 0x95, 0xBE, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x22, -+0x90, 0x97, 0xDE, 0xE0, 0x2F, 0xFF, 0x90, 0x97, 0xDD, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x98, 0x61, -+0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0xBE, 0xE0, 0xFD, 0x12, 0x7B, 0x8B, 0x90, 0x97, 0xD8, 0xEF, -+0x22, 0xE0, 0xFD, 0x75, 0xF0, 0x80, 0xA4, 0xAE, 0xF0, 0x22, 0x90, 0x99, 0xC7, 0xED, 0xF0, 0x90, -+0x99, 0xC6, 0xEF, 0xF0, 0x12, 0x7B, 0x07, 0x90, 0x99, 0xD4, 0xEF, 0xF0, 0xE0, 0xFD, 0x24, 0x01, -+0x12, 0xC6, 0xAD, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0x12, 0xC6, 0xF8, 0xD1, 0x56, 0x54, 0x3F, 0x90, -+0x99, 0xD1, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x99, 0xD0, 0xF0, 0xD1, 0x19, 0x50, 0x0C, 0xD1, -+0x22, 0xF0, 0xE0, 0x12, 0xC6, 0xF6, 0xE4, 0xD1, 0x01, 0x80, 0xF0, 0x90, 0x99, 0xD2, 0xE0, 0x24, -+0xF8, 0xFB, 0x90, 0x99, 0xD1, 0xE0, 0x34, 0xFF, 0xFA, 0x90, 0x99, 0xC7, 0xE0, 0xFF, 0x90, 0x91, -+0xDC, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0x7D, 0x0A, 0x7C, 0x00, 0x7F, 0x10, -+0x7E, 0x00, 0x12, 0x6D, 0xED, 0x90, 0x95, 0xBF, 0xE0, 0xFF, 0x90, 0x99, 0xC6, 0xE0, 0xFD, 0xD3, -+0x9F, 0x40, 0x38, 0x90, 0x95, 0xBF, 0xE0, 0xFC, 0x91, 0xB3, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, -+0x13, 0xD8, 0xF9, 0xB1, 0xEB, 0xEC, 0xFF, 0xC3, 0xED, 0xB1, 0xF7, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -+0xD8, 0xF9, 0x24, 0x28, 0xFF, 0xE4, 0x3E, 0xFE, 0xD1, 0x11, 0xFD, 0x90, 0x99, 0xC7, 0xE0, 0xFC, -+0xC3, 0xED, 0x9C, 0xD1, 0x09, 0x7D, 0x38, 0x7C, 0x00, 0x80, 0x35, 0x90, 0x99, 0xC6, 0x91, 0xB1, -+0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xB1, 0xEB, 0xED, 0xFF, 0x90, 0x95, 0xBF, -+0xB1, 0xF5, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x38, 0xFD, 0xE4, 0x3E, 0xFC, 0xD1, -+0x11, 0xFF, 0x90, 0x99, 0xC7, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, 0xD1, 0x09, 0x7F, 0x28, 0x7E, 0x00, -+0x12, 0x71, 0xD4, 0xF1, 0x6A, 0x90, 0x91, 0x45, 0x12, 0x85, 0xF7, 0x0B, 0x7A, 0x99, 0x79, 0xC8, -+0x90, 0x91, 0x48, 0x12, 0x85, 0xF7, 0x90, 0x91, 0x4B, 0x74, 0x08, 0xF0, 0x7A, 0x94, 0x79, 0x2D, -+0x12, 0x4E, 0xA5, 0xE4, 0x90, 0x99, 0xD0, 0xF0, 0xD1, 0x19, 0x50, 0x1E, 0xD1, 0x22, 0xF0, 0x90, -+0x99, 0xD0, 0xE0, 0x24, 0xC8, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x99, -+0xD3, 0xE0, 0x12, 0xC6, 0xF6, 0xEF, 0xD1, 0x01, 0x80, 0xDE, 0x22, 0xFF, 0x90, 0x92, 0x07, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xE0, 0xC3, 0x9F, 0xFF, 0xE4, 0x94, 0x00, 0xFE, 0xEF, 0x78, 0x07, -+0x22, 0xF0, 0x90, 0x99, 0xD0, 0xE0, 0x04, 0xF0, 0x22, 0xFB, 0x90, 0x92, 0x06, 0x74, 0x08, 0xF0, -+0x22, 0x90, 0x99, 0xD1, 0xA3, 0xE0, 0x24, 0xF8, 0x22, 0x90, 0x99, 0xD0, 0xE0, 0xFF, 0xC3, 0x94, -+0x08, 0x22, 0x90, 0x99, 0xD4, 0xE0, 0xFD, 0x90, 0x99, 0xD2, 0xE0, 0x2D, 0xFD, 0x90, 0x99, 0xD1, -+0xE0, 0x34, 0x00, 0xCD, 0x24, 0x20, 0xCD, 0x34, 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, -+0x3C, 0xFE, 0x90, 0x99, 0xC6, 0xE0, 0xFD, 0x12, 0x7B, 0x8B, 0x90, 0x99, 0xD3, 0xEF, 0x22, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0x90, -+0x97, 0xC0, 0xED, 0xF0, 0x90, 0x97, 0xBE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xE6, 0x15, 0x90, -+0x97, 0xBE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x21, 0x23, 0xAD, 0x07, 0x90, 0x95, -+0x6D, 0x31, 0x1C, 0x90, 0x95, 0x6D, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x04, 0x2E, 0xF1, 0xBA, 0xEF, -+0xF0, 0x90, 0x95, 0x6D, 0xA3, 0xE0, 0xFF, 0x74, 0x05, 0x2E, 0xF1, 0x91, 0xEF, 0xF0, 0x22, 0xE4, -+0x90, 0x98, 0x7D, 0xF0, 0xA3, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0x76, 0x9B, -+0xEF, 0x64, 0x01, 0x70, 0x71, 0x90, 0x95, 0xC6, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x0D, 0xF0, -+0x7B, 0x08, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x98, 0x7A, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -+0x98, 0x7A, 0x12, 0xE3, 0x28, 0x90, 0x98, 0x7C, 0xEF, 0xF0, 0x90, 0x98, 0x7A, 0x12, 0xC7, 0xEA, -+0xE4, 0xFD, 0x12, 0xE1, 0x20, 0x90, 0x98, 0x7C, 0xE0, 0xFF, 0x90, 0x98, 0x7B, 0xE0, 0x2F, 0xFF, -+0x90, 0x98, 0x7A, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, 0xCF, 0x34, 0x00, 0xFE, 0x90, 0x98, 0x7D, -+0xF0, 0xA3, 0xEF, 0xF0, 0xD1, 0x7C, 0xF1, 0x27, 0x90, 0x95, 0xC6, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, -+0xC4, 0xE7, 0xF1, 0x27, 0x90, 0x95, 0xC2, 0xE0, 0xFB, 0x7F, 0x11, 0x12, 0xC4, 0xE7, 0x12, 0xC1, -+0xFD, 0x90, 0x95, 0x75, 0x31, 0x1C, 0x22, 0x90, 0x98, 0x7D, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x22, -+0xE4, 0x90, 0x9A, 0x44, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x22, 0xC3, 0x90, -+0x9A, 0x45, 0xE0, 0x94, 0xD0, 0x90, 0x9A, 0x44, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, -+0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x9A, 0x44, 0x31, 0x1C, 0xF1, 0x63, 0x80, 0xD7, -+0x7F, 0x01, 0x22, 0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, -+0x22, 0x90, 0x95, 0xCC, 0x12, 0x97, 0xD8, 0x30, 0xE0, 0x0A, 0xF1, 0x6A, 0xF1, 0xC2, 0xA3, 0x04, -+0xF0, 0x02, 0xC3, 0xB0, 0x90, 0x8A, 0xAF, 0x12, 0x8D, 0x12, 0x7D, 0x08, 0xE4, 0xFF, 0x02, 0x04, -+0x7E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0x22, 0x90, 0x97, 0xE0, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0x22, 0x74, 0x00, 0x2F, 0xF9, 0xE4, -+0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xF0, 0x74, 0x04, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0x22, 0x90, 0x99, 0xB7, 0x12, 0x85, 0xF7, 0xE4, 0x90, 0x99, 0xBA, 0xF0, 0x22, 0x90, 0x88, -+0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, 0xE0, 0xFB, 0x90, 0x92, 0x98, 0x22, 0x90, -+0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, 0x12, 0x8E, -+0x2C, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x8E, 0x2C, 0x22, 0x90, -+0x88, 0x31, 0x12, 0x97, 0xA2, 0x30, 0xE0, 0x35, 0xEF, 0x54, 0xBF, 0x11, 0x42, 0x30, 0xE0, 0x06, -+0xE0, 0x44, 0x01, 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFE, 0xF0, 0x11, 0x4B, 0x74, 0x04, 0xF0, 0x90, -+0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0F, 0x90, 0x8A, 0xB9, 0x12, 0x8D, -+0x12, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x80, 0x03, 0x12, 0xBB, 0x62, 0xE4, 0xFF, 0x02, -+0x97, 0x1E, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, -+0xF0, 0x90, 0x01, 0xB8, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0xDF, 0xE0, -+0x60, 0x24, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0x70, 0x31, 0x01, 0x12, 0x04, 0xB8, 0xEF, 0x44, -+0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0x31, 0x01, 0x31, 0x0B, 0x7F, -+0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, 0x95, 0xDA, 0xE0, 0x70, 0x29, 0x90, 0x07, 0xCC, 0xE0, -+0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, 0x97, 0x8F, 0x74, 0x22, 0xF0, 0x90, 0x97, 0xB1, 0x74, 0x01, -+0xF0, 0x90, 0x97, 0x91, 0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x8F, 0x12, 0x8D, 0x00, -+0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x95, 0xE2, 0xE0, 0xFF, 0x70, 0x0A, 0x90, 0x95, 0xDF, 0xE0, -+0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, 0xF0, 0x90, 0x01, 0xC5, -+0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, 0x60, 0x06, 0x90, 0x01, -+0xC4, 0x74, 0x07, 0xF0, 0x90, 0x95, 0xDF, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x01, 0xF0, -+0x90, 0x95, 0xE0, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0x97, 0x8B, 0x12, 0x04, 0x31, 0x90, 0x97, 0x8B, 0x22, 0x12, 0x04, 0xB8, 0x90, 0x92, -+0x18, 0x02, 0x04, 0x31, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0xBB, 0xEC, 0x90, 0x99, -+0xFF, 0x12, 0x04, 0x31, 0x90, 0x99, 0xFF, 0x31, 0x0B, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, 0xAD, -+0x31, 0xD5, 0xF0, 0x7D, 0x01, 0x12, 0x76, 0xF7, 0x12, 0x8E, 0x29, 0x12, 0xB4, 0x41, 0x54, 0xFE, -+0x31, 0xCF, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0x90, 0x01, -+0x01, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x88, 0x9B, 0x12, -+0x98, 0xE0, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x12, 0x98, 0x37, 0x30, 0xE0, 0x35, -+0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x90, 0x99, 0xFD, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, -+0x99, 0xFD, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0x99, 0xFE, 0xF0, -+0x80, 0x06, 0x90, 0x99, 0xFE, 0x74, 0x02, 0xF0, 0x90, 0x99, 0xFD, 0x31, 0xB2, 0x12, 0x9A, 0x4F, -+0x7F, 0x01, 0x12, 0x71, 0x9A, 0x90, 0x88, 0x9A, 0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, 0xF3, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, -+0x70, 0x70, 0xED, 0x44, 0x80, 0xFD, 0x22, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, -+0x7F, 0x02, 0x02, 0x7B, 0x2E, 0x90, 0x93, 0x42, 0xE0, 0xFF, 0x90, 0x93, 0x41, 0xE0, 0xFB, 0x90, -+0x93, 0x43, 0xE0, 0x90, 0x92, 0x90, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, -+0xF0, 0x90, 0x88, 0xBD, 0xE0, 0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xBE, 0x31, 0xB2, 0x12, 0x9A, -+0x4F, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x19, 0x90, 0x93, 0x08, 0xE0, 0x20, 0xE0, 0x12, 0x90, 0x86, -+0x0C, 0x12, 0x8E, 0x2C, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, 0x2F, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, -+0x90, 0x97, 0x2E, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xDC, 0x19, 0x90, 0x97, 0x31, 0xF0, 0x51, -+0xF1, 0x90, 0x97, 0x2E, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x97, 0x2F, 0xE0, 0x60, 0x05, 0x51, -+0xE3, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x54, 0xC0, 0xF0, 0x51, 0xE3, 0x54, 0xC0, 0xF0, 0x90, 0x97, 0x31, 0xE0, 0xFF, 0xAE, 0x05, -+0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, 0xE0, -+0xD3, 0x94, 0x03, 0x74, 0x10, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x04, 0xF0, -+0xAF, 0x05, 0x51, 0xD8, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x97, 0x30, 0xE0, 0x25, 0xE0, 0x25, 0xE0, -+0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0x51, 0xD8, 0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2F, 0x12, 0xCF, 0x99, 0xE0, 0x54, 0xF7, -+0xF0, 0x74, 0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, -+0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xE0, -+0xFF, 0x12, 0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, 0x22, 0xE4, 0xFD, 0xFC, 0x90, 0x95, 0xC5, 0x51, -+0xEF, 0xAB, 0x05, 0x74, 0x01, 0x2B, 0x12, 0xC6, 0xAD, 0xE0, 0xFE, 0x74, 0x00, 0x2B, 0x12, 0xC6, -+0xF8, 0xB1, 0x7F, 0x90, 0x95, 0x63, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x03, 0x2B, 0x71, 0xF0, 0xFE, -+0x74, 0x02, 0x2B, 0x71, 0xFD, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x65, 0xF0, 0xA3, 0xEF, -+0xF0, 0x74, 0x05, 0x2B, 0x12, 0xCF, 0x91, 0xE0, 0xFE, 0x74, 0x04, 0x2B, 0x12, 0xCF, 0xBA, 0xE0, -+0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x67, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x07, 0x2B, 0x71, -+0xE7, 0xFE, 0x74, 0x06, 0x2B, 0x71, 0xDE, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x69, 0xF0, -+0xA3, 0xEF, 0xF0, 0x74, 0x09, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFE, 0x74, -+0x08, 0x2B, 0x71, 0x81, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x95, 0x6B, 0xF0, 0xA3, 0xEF, 0xF0, -+0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x93, 0x06, 0xF1, 0x8E, 0x12, -+0xC6, 0xF8, 0xE0, 0x90, 0x98, 0x8B, 0xF0, 0x74, 0x01, 0x2F, 0x12, 0xC6, 0xAD, 0xE0, 0x90, 0x98, -+0x8C, 0x71, 0xF9, 0x90, 0x98, 0x8D, 0xF0, 0x74, 0x03, 0x2F, 0x71, 0xF0, 0x90, 0x98, 0x8E, 0x12, -+0xCF, 0xB6, 0xE0, 0x90, 0x98, 0x8F, 0xF0, 0x74, 0x05, 0x2F, 0x12, 0xCF, 0x91, 0xE0, 0x90, 0x98, -+0x90, 0xF0, 0x74, 0x06, 0x2F, 0x71, 0xDE, 0x90, 0x98, 0x91, 0xF0, 0x74, 0x07, 0x2F, 0x71, 0xE7, -+0x90, 0x98, 0x92, 0xF0, 0x74, 0x08, 0x2F, 0x71, 0x81, 0x90, 0x98, 0x93, 0xF0, 0x22, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF0, 0x74, 0x02, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x02, 0x09, -+0xE0, 0xFD, 0x12, 0x97, 0x9A, 0x90, 0x93, 0x04, 0xF1, 0xBD, 0x12, 0xA7, 0x17, 0x54, 0x04, 0xFC, -+0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0x93, 0x04, 0xF1, 0xA9, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0x54, -+0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0x90, 0x93, 0x04, 0x12, 0x8E, 0x13, 0xFF, 0xED, 0x2F, 0x90, -+0x93, 0x05, 0x12, 0x8F, 0x1A, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0x06, 0xF0, 0x12, 0x8F, 0x13, 0xFF, -+0xAE, 0x05, 0xED, 0x2F, 0x90, 0x93, 0x07, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x20, 0xE0, 0x08, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x09, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x40, 0xF0, 0x71, -+0x8A, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x30, 0xE0, 0x39, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x01, 0xF0, -+0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF1, 0x97, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x08, -+0x91, 0xC7, 0x90, 0x98, 0xA3, 0x74, 0x01, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x12, -+0xAF, 0xD0, 0x20, 0xE0, 0x0D, 0x90, 0x9A, 0x04, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x27, 0x10, 0x12, -+0xBD, 0x98, 0x12, 0xAF, 0xD0, 0x30, 0xE0, 0x0A, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x02, 0xF0, 0x12, -+0xC7, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE4, -+0xFD, 0xFC, 0x90, 0x01, 0x1D, 0xE0, 0xFE, 0x90, 0x01, 0x1C, 0xB1, 0x7F, 0x90, 0x9A, 0x2C, 0xF0, -+0xA3, 0xEF, 0xD1, 0x15, 0xE0, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x9A, 0x2E, 0xF0, 0xA3, 0xEF, -+0xF0, 0xB1, 0x60, 0x90, 0x9A, 0x2C, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xB5, 0x07, 0x06, 0xEA, 0xB5, -+0x06, 0x02, 0x80, 0x40, 0xB1, 0x60, 0xD3, 0xEB, 0x9F, 0xEA, 0x9E, 0x40, 0x0E, 0x90, 0x9A, 0x2D, -+0xE0, 0x9F, 0xFD, 0x90, 0x9A, 0x2C, 0xE0, 0x9E, 0xFC, 0x80, 0x29, 0xB1, 0x60, 0xC3, 0x90, 0x9A, -+0x2D, 0xE0, 0x9F, 0x90, 0x9A, 0x2C, 0xE0, 0x9E, 0x50, 0x1A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, -+0x90, 0x9A, 0x2F, 0xE0, 0x9F, 0xFF, 0x90, 0x9A, 0x2E, 0xE0, 0x9E, 0xFE, 0xC3, 0xE4, 0x9F, 0xFD, -+0x74, 0x40, 0x9E, 0xFC, 0xD3, 0xED, 0x94, 0x00, 0xEC, 0x94, 0x38, 0x40, 0x02, 0xE1, 0x5C, 0xC3, -+0xEC, 0x94, 0x08, 0x50, 0x0A, 0xED, 0x94, 0x00, 0xEC, 0x94, 0x00, 0x40, 0x02, 0x91, 0xC7, 0x22, -+0x90, 0x9A, 0x2E, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, -+0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, -+0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x22, 0xD1, 0x16, 0x12, 0xCE, 0x56, 0x90, 0x97, 0x32, -+0xF1, 0xA0, 0xF9, 0x90, 0x93, 0x24, 0xE0, 0x30, 0xE0, 0x7A, 0xEC, 0xC3, 0x99, 0x50, 0x75, 0x90, -+0x97, 0x32, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, 0xAD, 0x07, -+0xB1, 0x69, 0x54, 0x3F, 0x90, 0x97, 0x34, 0x12, 0xEF, 0x8B, 0x30, 0xE0, 0x09, 0xC3, 0x13, 0x20, -+0xE0, 0x04, 0xF1, 0xDB, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0xFB, 0xEF, 0x24, 0x18, 0xFF, 0xE4, 0x33, -+0xCF, 0x2B, 0xCF, 0x34, 0x00, 0x90, 0x97, 0x34, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x97, 0x34, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD1, 0x1F, 0x90, 0x97, 0x34, 0xEE, 0xF1, 0x7D, 0xF1, 0xCC, 0xD3, -+0x90, 0x97, 0x33, 0xE0, 0x9F, 0x90, 0x97, 0x32, 0xE0, 0x9E, 0x40, 0x0F, 0x12, 0xEF, 0xB6, 0x90, -+0x97, 0x33, 0xE0, 0x9F, 0xF0, 0x90, 0x97, 0x32, 0xE0, 0x9E, 0xF0, 0x90, 0x97, 0x32, 0x12, 0xE0, -+0x51, 0x0C, 0x80, 0x86, 0x22, 0xF0, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x22, 0x7D, -+0x07, 0xEF, 0x5D, 0xC3, 0x60, 0x0B, 0xD1, 0x36, 0x5F, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, -+0x04, 0xD1, 0x36, 0x5F, 0xFF, 0x22, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, -+0xED, 0x22, 0x12, 0xE0, 0x64, 0xAD, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x42, 0xF0, 0x74, 0xD6, 0xA3, -+0xF0, 0xED, 0x64, 0x01, 0x60, 0x1E, 0x12, 0x9F, 0x4B, 0xED, 0xB4, 0x02, 0x08, 0x90, 0x01, 0xC7, -+0x74, 0x40, 0xF0, 0x80, 0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x41, 0xF0, 0x7F, -+0x01, 0x02, 0xAA, 0x81, 0xB1, 0x88, 0x90, 0x02, 0x87, 0xE0, 0x70, 0xF8, 0x90, 0x06, 0x90, 0xE0, -+0x44, 0x02, 0xF0, 0x74, 0x42, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xD6, 0xA3, 0xF0, 0x22, 0xEF, -+0x70, 0x02, 0xE1, 0x42, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE6, 0x1D, 0x90, 0x95, 0xEA, 0xE0, 0x54, -+0xFE, 0xF0, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE5, 0x07, 0x90, 0x01, 0x0C, 0xE0, 0x30, 0xE1, 0x45, -+0x90, 0x01, 0xC7, 0x74, 0x44, 0xF0, 0x80, 0xFE, 0x90, 0x95, 0xEA, 0xE0, 0x44, 0x01, 0xF0, 0x90, -+0x06, 0x0F, 0xE0, 0x30, 0xE5, 0x10, 0x90, 0x01, 0x0C, 0xE0, 0x20, 0xE1, 0x09, 0x90, 0x95, 0xEA, -+0xE0, 0x54, 0xFD, 0xF0, 0x80, 0x1F, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE5, 0x10, 0x90, 0x01, 0x0C, -+0xE0, 0x30, 0xE1, 0x09, 0x90, 0x95, 0xEA, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xC7, -+0x74, 0x44, 0xF0, 0x80, 0xFE, 0x90, 0x95, 0xBB, 0xE0, 0xFF, 0x60, 0x02, 0xF1, 0x64, 0x90, 0x01, -+0xC7, 0xE4, 0xF1, 0xB3, 0x12, 0xCE, 0x56, 0xF1, 0x75, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF0, -+0x7B, 0x35, 0x7D, 0xFF, 0x7F, 0xFF, 0x12, 0xC4, 0xCF, 0x90, 0x8A, 0xEF, 0x12, 0x8E, 0x2C, 0x91, -+0xC7, 0xD1, 0x42, 0xF1, 0x5B, 0x90, 0x86, 0x0C, 0x12, 0x8E, 0x2C, 0xE4, 0xFB, 0xFD, 0x7F, 0xFF, -+0x12, 0xC4, 0xCF, 0x12, 0xDD, 0xB9, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, 0xFF, 0x02, -+0x7C, 0x74, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0x90, 0x06, 0x90, 0xE0, 0x54, 0xF0, 0xF0, -+0xF1, 0x5C, 0x12, 0xE0, 0x8D, 0x12, 0x97, 0x80, 0x02, 0x94, 0x61, 0x22, 0x90, 0x02, 0x86, 0xE0, -+0x54, 0xFB, 0xF0, 0x22, 0xF1, 0x85, 0x12, 0xC7, 0x83, 0x75, 0x48, 0x08, 0x7B, 0x01, 0x7A, 0x95, -+0x79, 0x2F, 0x02, 0x69, 0xF5, 0x90, 0x88, 0x27, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0x97, 0x32, 0x22, 0x12, 0x7B, 0x07, 0x7E, 0x00, 0x74, 0x00, 0x2F, 0x22, 0xE0, 0xFF, -+0x12, 0x7B, 0x07, 0x74, 0x00, 0x2F, 0x22, 0xF0, 0x90, 0x06, 0x08, 0xE0, 0x54, 0x7F, 0xF0, 0x22, -+0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x87, 0xE0, 0x22, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, -+0xF7, 0x4E, 0x22, 0xF0, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0x22, 0xE0, 0x54, 0xFE, -+0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0x22, 0xEE, 0x8F, 0xF0, 0x12, -+0x02, 0xE7, 0x90, 0x88, 0x27, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x74, 0x03, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x03, 0xFE, 0x22, 0xE4, 0x90, 0x9A, 0x38, 0xF0, 0xA3, -+0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, -+0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0x12, 0xC1, 0x8B, 0x30, 0xE0, 0x15, 0xD3, 0x90, 0x9A, 0x39, -+0xE0, 0x94, 0x03, 0x90, 0x9A, 0x38, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x80, 0x13, 0x7F, 0x01, 0x80, -+0x1B, 0xD3, 0x90, 0x9A, 0x39, 0xE0, 0x94, 0xE8, 0x90, 0x9A, 0x38, 0xE0, 0x94, 0x03, 0x40, 0x0A, -+0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x7C, -+0x6A, 0x90, 0x9A, 0x38, 0x12, 0xC9, 0x1C, 0x80, 0xA8, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x93, -+0x01, 0xED, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, -+0x22, 0x90, 0x01, 0x8C, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, 0xA3, 0x74, 0x02, 0xF0, -+0x90, 0x01, 0x95, 0xE0, 0x54, 0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, -+0x22, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, 0xF0, 0x12, 0xCF, 0x63, 0x90, 0x01, 0x98, -+0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, -+0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x97, 0x2E, 0xF0, 0xA3, 0xF0, 0x11, 0x9B, -+0xEF, 0x64, 0x01, 0x60, 0x3D, 0xC3, 0x90, 0x97, 0x2F, 0xE0, 0x94, 0x88, 0x90, 0x97, 0x2E, 0xE0, -+0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, -+0xF0, 0x80, 0x1F, 0x90, 0x97, 0x2E, 0x12, 0xC9, 0x1C, 0x12, 0xB4, 0x3A, 0xD3, 0x90, 0x97, 0x2F, -+0xE0, 0x94, 0x32, 0x90, 0x97, 0x2E, 0xE0, 0x94, 0x00, 0x40, 0xC3, 0x90, 0x01, 0xC6, 0xE0, 0x30, -+0xE3, 0xBC, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0x90, 0x93, 0x24, 0xE0, 0x30, 0xE0, 0x0B, -+0x90, 0x8A, 0xE5, 0x12, 0x8D, 0x12, 0x7F, 0x10, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x8A, 0x75, 0x12, -+0x8E, 0x2C, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0x12, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x01, 0xCF, -+0xE0, 0x90, 0x98, 0x7A, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, -+0xF0, 0xEF, 0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, -+0x20, 0xF0, 0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, -+0xFD, 0x7F, 0x03, 0x12, 0x7B, 0x2E, 0x80, 0xFE, 0x22, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0x12, 0x7F, -+0x80, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x99, 0x90, 0xEC, 0xF0, -+0xA3, 0xED, 0xF0, 0x90, 0x99, 0x8F, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x7B, 0xBD, 0x90, -+0x99, 0x9A, 0x12, 0x04, 0x31, 0x90, 0x99, 0x92, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x99, -+0x9A, 0x12, 0x85, 0xE2, 0x12, 0x85, 0xC8, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x99, 0x92, 0x12, 0x04, 0xB8, 0x90, 0x99, 0x96, 0x12, 0x85, 0xE2, 0x12, 0x85, 0xC8, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xD5, 0x90, 0x99, 0x9E, 0x12, 0x04, 0x31, 0x90, -+0x99, 0x90, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x99, 0x9E, 0x12, 0x04, 0xB8, 0x90, 0x8B, 0x9F, -+0x12, 0x04, 0x31, 0x90, 0x99, 0x8F, 0xE0, 0xFF, 0xD0, 0x05, 0x12, 0x79, 0x53, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x24, 0xEF, 0xF0, 0xED, 0x64, -+0x01, 0x70, 0x2E, 0xEB, 0xB4, 0x01, 0x07, 0xE0, 0x24, 0x02, 0xF5, 0x14, 0x80, 0x08, 0x90, 0x9A, -+0x24, 0xE0, 0x24, 0xFE, 0xF5, 0x14, 0x90, 0x99, 0x92, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, -+0xAF, 0x14, 0x51, 0x54, 0x51, 0x4C, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x14, 0x80, -+0x20, 0x90, 0x99, 0x92, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x9A, 0x24, 0x12, 0xB5, -+0xAF, 0x51, 0x58, 0x51, 0x4C, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x9A, 0x24, 0xE0, -+0xFF, 0x51, 0x54, 0x7F, 0x01, 0x31, 0x64, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFF, 0x31, 0x64, -+0x90, 0x99, 0x92, 0x22, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x99, 0x96, 0x12, 0x04, 0x31, 0x7D, 0x18, -+0x7C, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x98, 0x9B, 0xE0, 0xFF, 0x71, -+0x41, 0xEF, 0x60, 0x68, 0x90, 0x98, 0x9C, 0xE0, 0xFB, 0xD3, 0x94, 0x00, 0x40, 0x1A, 0x90, 0x99, -+0xA4, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x0F, 0xAF, 0x03, 0xE4, 0xFC, 0xFD, 0xFE, 0x12, 0xB7, -+0xE7, 0x7F, 0x08, 0x7E, 0x0E, 0x12, 0xB7, 0x14, 0x90, 0x98, 0x9B, 0xE0, 0xFF, 0x90, 0x06, 0x33, -+0xF0, 0x71, 0x29, 0xE4, 0xFB, 0xFD, 0x31, 0xE2, 0x90, 0x98, 0x9E, 0xE0, 0x60, 0x07, 0x90, 0x93, -+0x05, 0xE0, 0xFF, 0x71, 0x6C, 0x90, 0x98, 0x9D, 0xE0, 0x90, 0x97, 0xB4, 0xF0, 0x90, 0x98, 0x88, -+0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x12, 0xBF, 0x67, 0x90, 0x97, 0xB4, 0x12, 0xB5, 0xAF, 0x90, 0x9A, -+0x04, 0x12, 0x04, 0x31, 0x12, 0xBF, 0xBB, 0x12, 0xBD, 0x9F, 0x80, 0x48, 0xE4, 0x90, 0x98, 0x88, -+0xF0, 0x90, 0x99, 0x07, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xB7, 0x7C, 0xE4, -+0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x13, 0x90, 0x98, 0xA0, 0xE0, 0xFD, 0x90, 0x8A, 0x89, 0x12, -+0x8D, 0x12, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x7B, 0xAD, 0x90, 0x97, 0xB6, 0x74, 0x07, 0xF0, -+0x90, 0x97, 0xD8, 0xF0, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xB6, 0x12, 0x8D, 0x00, 0x7F, 0x04, 0x12, -+0x04, 0x7E, 0x71, 0x32, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x98, 0x93, 0xE0, 0x90, 0x9A, 0x27, -+0xF0, 0x22, 0x90, 0x93, 0x04, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0xA0, 0x11, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x98, 0x8B, 0xE0, 0xFE, 0x90, 0x98, 0x88, -+0xE0, 0xC3, 0x9E, 0x40, 0x04, 0x7F, 0x00, 0x80, 0x0E, 0xEF, 0x60, 0x05, 0xD3, 0x94, 0x0E, 0x40, -+0x04, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x97, 0xD9, 0xEF, 0xF0, 0x12, 0x76, 0x9B, 0xBF, 0x01, 0x1F, 0x90, 0x06, -+0x32, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x97, 0xD9, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x07, 0x12, -+0xC7, 0xCC, 0x90, 0x97, 0xDA, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xC1, 0xFD, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFE, 0xFD, 0xEF, 0xB4, 0x01, 0x0D, -+0xEB, 0xB4, 0x02, 0x03, 0x0D, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7D, 0x02, 0xAF, 0x06, 0xEF, -+0xC4, 0x54, 0xF0, 0x4D, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0xC4, 0x74, 0xCA, 0xF0, -+0x74, 0xDB, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0xCA, 0x04, -+0x90, 0x01, 0xC4, 0xF0, 0x74, 0xDB, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x91, 0x19, 0x90, 0x9A, 0x47, 0xF0, 0xED, 0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, 0xF0, -+0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, 0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, 0x67, -+0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, 0x7F, -+0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x91, 0x19, 0x90, 0x97, 0x2E, 0xF0, 0x90, 0x88, 0x32, 0x12, 0x8F, 0xDA, 0x30, 0xE0, 0x02, 0x81, -+0xED, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x1D, 0x12, 0xA4, 0xF3, 0x33, 0x33, 0x33, 0x54, 0xF8, -+0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x03, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, -+0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, 0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, -+0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, 0x88, 0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, -+0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, 0xF0, 0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, -+0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, 0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, -+0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, 0x88, 0x4B, 0x91, 0xF9, 0x90, 0x88, 0x4E, 0xB1, 0x02, 0x40, -+0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, 0x91, 0xF9, 0x90, 0x88, 0x3E, 0xB1, 0x02, 0x40, -+0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, 0x12, 0x98, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x88, -+0x42, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, -+0xFF, 0x90, 0x05, 0xB1, 0xE0, 0x54, 0xF8, 0x4F, 0xF0, 0xB1, 0x0D, 0x80, 0x07, 0x90, 0x88, 0x33, -+0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, 0x33, -+0xFC, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0x90, 0x88, 0x33, -+0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0x97, 0x2E, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, -+0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, 0x08, 0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, -+0x6C, 0xD1, 0x5B, 0xB1, 0xE8, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, -+0x2F, 0xB1, 0xEF, 0xE0, 0xFE, 0x74, 0x28, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xB1, 0xB2, 0xB4, -+0x04, 0xEC, 0x90, 0x9A, 0x29, 0x12, 0xB5, 0xAF, 0xD1, 0x64, 0x90, 0x9A, 0x28, 0x12, 0xB5, 0xAF, -+0x12, 0x85, 0xD5, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x9A, 0x2A, 0x12, 0xB5, -+0xAF, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, -+0xD5, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0xB5, 0xAF, 0x78, 0x18, 0x12, -+0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xD5, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0x22, 0xE4, 0xFF, 0x74, 0x18, 0xB1, 0xDD, 0x74, -+0x34, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x10, 0xB1, 0xDD, 0x74, -+0x2E, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xB1, 0xB2, 0xB4, 0x06, 0xDF, 0x22, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x22, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, 0x22, 0xF5, -+0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, -+0xAC, 0x06, 0xEF, 0xD1, 0x77, 0xB1, 0xE8, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, 0x54, -+0x03, 0x24, 0xC8, 0xB1, 0xEF, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, -+0xFF, 0x7F, 0xFF, 0x80, 0x21, 0xD1, 0x5B, 0xB1, 0xE8, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, -+0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0xB1, 0xEF, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0x07, 0x12, 0xCE, 0x54, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, 0xC0, 0xEF, 0xF0, -+0xEE, 0xA3, 0xF0, 0x22, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, -+0x07, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x54, 0xFC, 0x90, 0x07, 0xC0, 0xF0, 0xEE, 0xA3, 0xF0, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, 0xD1, 0x79, 0xE4, 0xFB, -+0x90, 0x9A, 0x0B, 0x12, 0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, 0xF8, 0x12, 0x03, 0xEB, -+0x74, 0xC4, 0x2B, 0xB1, 0xEF, 0xEF, 0xF0, 0x0B, 0xEB, 0xB4, 0x04, 0xE4, 0x90, 0x07, 0xC2, 0xF1, -+0x77, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x40, 0xD1, 0x72, 0x7A, 0x00, 0x90, 0x9A, 0x41, 0xE0, 0x54, -+0x03, 0xFB, 0x70, 0x0A, 0x90, 0x07, 0xC4, 0xD1, 0xFE, 0x74, 0x03, 0xF0, 0x80, 0x0E, 0xEB, 0x64, -+0x02, 0x4A, 0x70, 0x15, 0x90, 0x07, 0xC6, 0xD1, 0xFE, 0x74, 0x0C, 0xF0, 0x90, 0x07, 0xC3, 0x74, -+0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xED, 0xF0, -+0xEC, 0xA3, 0xF0, 0x90, 0x07, 0xC2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, -+0x42, 0xD1, 0x72, 0xF1, 0x6D, 0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, -+0x01, 0xF0, 0x80, 0x37, 0xEF, 0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, 0x07, 0xC5, 0xED, 0xF0, 0x90, -+0x07, 0xC2, 0x74, 0x02, 0xF0, 0x80, 0x24, 0xF1, 0x6D, 0x64, 0x02, 0x70, 0x0D, 0x90, 0x07, 0xC6, -+0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, 0x64, 0x03, 0x4E, 0x70, 0x0B, -+0x90, 0x07, 0xC7, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, -+0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7E, 0x00, 0x90, -+0x9A, 0x43, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0x74, 0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x22, 0x90, -+0x97, 0x35, 0xEF, 0xF0, 0xE4, 0xFF, 0x74, 0x2F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -+0xE0, 0xFE, 0x74, 0x84, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x04, 0xB1, 0xB2, 0xB4, 0x08, 0xE7, 0x90, -+0x95, 0x5F, 0xE0, 0x90, 0x04, 0x8C, 0xF0, 0x90, 0x95, 0x61, 0xE0, 0x90, 0x04, 0x8D, 0xF0, 0x75, -+0x45, 0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0x3E, 0x75, 0x48, 0x08, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x37, 0x12, 0x69, 0xF5, 0x90, 0x95, 0xCA, 0xE0, 0x60, 0x1F, 0x90, 0x97, 0x35, 0xE0, 0xFF, 0x12, -+0x7B, 0x07, 0x7E, 0x00, 0x12, 0xCF, 0xAB, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x95, 0x75, 0x47, -+0x2F, 0x75, 0x48, 0x34, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x22, 0x90, 0x95, 0xCC, 0xE0, 0x30, 0xE0, -+0x37, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x30, 0x90, 0x9A, 0x49, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, -+0x0A, 0x0B, 0x90, 0x95, 0xCE, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x9A, 0x49, 0xF0, 0x90, 0x95, 0xCE, -+0xE0, 0xFF, 0x90, 0x95, 0xCD, 0xE0, 0xD3, 0x9F, 0x50, 0x0E, 0x90, 0x95, 0xCF, 0xE0, 0x70, 0x08, -+0xE4, 0x90, 0x95, 0xCE, 0xF0, 0x12, 0xCF, 0x71, 0x22, 0x12, 0x97, 0x9A, 0x90, 0x95, 0xCC, 0x11, -+0x49, 0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, -+0x07, 0x12, 0x8E, 0x14, 0x90, 0x95, 0xCD, 0xF0, 0x22, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, -+0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, -+0x44, 0x01, 0xF0, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE2, 0x03, 0x7F, 0x04, 0x22, 0x90, 0x02, -+0x86, 0xE0, 0x7F, 0x01, 0x20, 0xE1, 0x02, 0x7F, 0x02, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0xE4, 0xFD, 0x7F, 0x8F, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x11, 0x7A, 0x90, -+0x95, 0xCA, 0xE0, 0xFF, 0x12, 0xDF, 0x7F, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x90, 0x86, 0xB3, -+0xE0, 0xFF, 0xB4, 0x01, 0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, -+0x90, 0xFE, 0x10, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, 0x0D, 0x90, -+0x93, 0x27, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, 0x01, 0x22, 0xEF, -+0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, 0x74, 0x04, 0xF0, 0x80, 0x03, 0x74, 0x08, 0xF0, 0x02, 0x9F, -+0x4B, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x20, 0xE0, 0x05, 0x90, 0x95, 0xB9, 0x80, -+0x03, 0x90, 0x95, 0xBA, 0xE0, 0x90, 0x95, 0x60, 0xF0, 0x90, 0x95, 0x60, 0xE0, 0x14, 0x60, 0x13, -+0x14, 0x60, 0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, 0x60, 0x09, 0x14, 0x60, 0x06, 0x24, 0x06, 0xE4, -+0xFE, 0x80, 0x06, 0x7E, 0x04, 0x80, 0x02, 0x7E, 0x08, 0xAF, 0x06, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0x9A, 0x12, 0xED, 0xF0, 0x90, 0x9A, 0x0F, 0x12, 0x85, 0xF7, 0xE4, 0x90, 0x9A, 0x13, 0xF0, -+0xA3, 0xF0, 0x12, 0x02, 0x06, 0xFF, 0x12, 0x8E, 0x14, 0xFD, 0x12, 0x8F, 0xE2, 0xFB, 0x71, 0x4E, -+0x90, 0x9A, 0x13, 0xEF, 0xF0, 0x90, 0x9A, 0x0F, 0x12, 0x85, 0xEE, 0x12, 0x8F, 0xE2, 0xFF, 0x11, -+0xE1, 0x90, 0x9A, 0x14, 0xEF, 0xF0, 0x90, 0x95, 0x60, 0xE0, 0x24, 0xFE, 0x60, 0x14, 0x24, 0xFE, -+0x60, 0x10, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, 0x40, 0x51, 0xB8, 0x51, 0xC4, -+0x80, 0x0C, 0x51, 0xB8, 0x90, 0x95, 0x60, 0xE0, 0x90, 0x99, 0xE6, 0xF0, 0x31, 0xAD, 0x90, 0x9A, -+0x14, 0xE0, 0xFF, 0x90, 0x9A, 0x0F, 0x12, 0x85, 0xEE, 0x90, 0x9A, 0x13, 0xE0, 0x7C, 0x00, 0x29, -+0xF9, 0xEC, 0x3A, 0xFA, 0xC3, 0xE9, 0x9F, 0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x45, 0x01, 0x75, -+0x46, 0x95, 0x75, 0x47, 0x2F, 0xA3, 0xE0, 0xF5, 0x48, 0x12, 0x69, 0xF5, 0x22, 0x90, 0x99, 0xE2, -+0x12, 0x85, 0xF7, 0x90, 0x99, 0xE6, 0xE0, 0xFE, 0x64, 0x04, 0x70, 0x0D, 0x51, 0x9F, 0x12, 0x02, -+0x06, 0x90, 0x99, 0xE7, 0x12, 0x8E, 0x13, 0x80, 0x11, 0xEE, 0x64, 0x02, 0x70, 0x35, 0x51, 0x9F, -+0x12, 0x8F, 0x1B, 0x90, 0x99, 0xE7, 0xF0, 0x12, 0x02, 0x06, 0x90, 0x99, 0xE8, 0xF0, 0x12, 0x8F, -+0xE2, 0x90, 0x99, 0xE9, 0x12, 0x8E, 0x1B, 0x90, 0x99, 0xEA, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, -+0x1F, 0x90, 0x99, 0xEB, 0xF0, 0x90, 0x00, 0x07, 0x12, 0x02, 0x1F, 0x90, 0x99, 0xEC, 0xF0, 0x12, -+0x8F, 0x13, 0xFF, 0xED, 0x70, 0x19, 0xFE, 0x51, 0xA5, 0xE0, 0xB4, 0xFF, 0x06, 0x51, 0xA5, 0xE4, -+0xF0, 0x80, 0x07, 0x51, 0xA5, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x06, 0xE8, 0x90, -+0x99, 0xE6, 0xE0, 0xFE, 0xB4, 0x04, 0x18, 0xA3, 0xE0, 0xFD, 0x51, 0x9F, 0xED, 0x51, 0xB0, 0xFD, -+0x51, 0x9F, 0x90, 0x00, 0x01, 0xED, 0x12, 0x02, 0x5E, 0x90, 0x00, 0x02, 0xE4, 0x80, 0x20, 0xEE, -+0xB4, 0x02, 0x1F, 0x90, 0x99, 0xE8, 0x51, 0x9D, 0xEE, 0x51, 0xB0, 0x44, 0x20, 0x54, 0x7F, 0x51, -+0x9E, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x02, 0x5E, 0x90, 0x99, 0xE7, 0xE0, 0x90, 0x00, 0x02, 0x12, -+0x02, 0x5E, 0x51, 0x9F, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x44, 0x20, -+0x12, 0x02, 0x4C, 0x90, 0x99, 0xE9, 0x51, 0x9D, 0x90, 0x00, 0x04, 0xEE, 0x12, 0x02, 0x5E, 0x90, -+0x99, 0xEA, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x02, 0x5E, 0x90, 0x99, 0xEB, 0xE0, 0x90, 0x00, 0x06, -+0x12, 0x02, 0x5E, 0x90, 0x99, 0xEC, 0xE0, 0x90, 0x00, 0x07, 0x02, 0x02, 0x5E, 0xE0, 0xFE, 0x90, -+0x99, 0xE2, 0x02, 0x85, 0xEE, 0x74, 0xE7, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, -+0x12, 0x02, 0x4C, 0x90, 0x99, 0xE8, 0xE0, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x2F, 0x90, 0x9A, -+0x12, 0xE0, 0xFD, 0x22, 0x90, 0x99, 0xF2, 0xED, 0xF0, 0x90, 0x99, 0xEF, 0x12, 0x85, 0xF7, 0x12, -+0x8F, 0x13, 0x90, 0x99, 0xF6, 0xF0, 0x90, 0x99, 0xEF, 0x12, 0xC3, 0xA6, 0x75, 0x48, 0x03, 0x7B, -+0x01, 0x7A, 0x99, 0x79, 0xF3, 0x12, 0x69, 0xF5, 0x90, 0x99, 0xF2, 0xE0, 0x70, 0x2E, 0xFF, 0x71, -+0x1D, 0xE0, 0xB4, 0xFF, 0x06, 0x71, 0x1D, 0xE4, 0xF0, 0x80, 0x07, 0x71, 0x1D, 0xE0, 0x04, 0xF0, -+0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x03, 0xE8, 0x75, 0x45, 0x01, 0x75, 0x46, 0x99, 0x75, 0x47, 0xF3, -+0x75, 0x48, 0x03, 0x90, 0x99, 0xEF, 0x12, 0x85, 0xEE, 0x12, 0x69, 0xF5, 0x22, 0x74, 0xF3, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, 0xA3, 0xE0, 0xFE, 0x24, 0x28, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0xFD, 0x74, 0x2C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFE, -+0xEF, 0x30, 0xE7, 0x04, 0x7C, 0x02, 0x80, 0x02, 0xE4, 0xFC, 0xED, 0x30, 0xE6, 0x08, 0xAF, 0x03, -+0x11, 0xE1, 0xAE, 0x07, 0x80, 0x02, 0xE4, 0xFE, 0xEC, 0x24, 0x18, 0x2E, 0xFF, 0x22, 0x12, 0x7B, -+0x07, 0x90, 0x97, 0x32, 0xE4, 0x12, 0xD7, 0x7D, 0x71, 0x28, 0x90, 0x97, 0x34, 0xEF, 0xF0, 0x90, -+0x97, 0x32, 0xA3, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x06, -+0x7B, 0x01, 0x7A, 0x93, 0x79, 0x49, 0x71, 0xD4, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, 0x24, 0x3E, -+0xF9, 0xE4, 0x34, 0xFC, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x4F, -+0x71, 0xD4, 0x71, 0xE1, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x06, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x53, -+0x71, 0xD4, 0x12, 0xC6, 0xDE, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x93, 0x79, -+0x59, 0x02, 0x69, 0xF5, 0x12, 0x69, 0xF5, 0x90, 0x97, 0x32, 0x22, 0x12, 0x69, 0xF5, 0x90, 0x99, -+0xBC, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, 0x24, 0x42, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0xEF, 0x60, -+0x07, 0x90, 0x95, 0xBC, 0xE0, 0xFF, 0x71, 0x6E, 0x22, 0x12, 0xD7, 0x85, 0x12, 0xC7, 0x83, 0x75, -+0x48, 0x70, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x5D, 0x02, 0x69, 0xF5, 0xEF, 0x60, 0x07, 0x90, 0x95, -+0xC1, 0xE0, 0xFF, 0x71, 0xF9, 0x22, 0x90, 0x97, 0xBA, 0x12, 0xCF, 0xA4, 0xED, 0xF0, 0x78, 0xBE, -+0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0xBA, 0x12, 0x9F, 0xB0, 0x90, 0x97, 0xBC, -+0xE0, 0xFF, 0x90, 0x97, 0xBB, 0xE0, 0x2F, 0x91, 0xBF, 0x90, 0x97, 0xC2, 0xF0, 0xA3, 0xEF, 0xF0, -+0x24, 0x06, 0xFF, 0xE4, 0x3E, 0x12, 0x9A, 0x7A, 0xEF, 0x64, 0x08, 0x70, 0x53, 0x90, 0x97, 0xC3, -+0xE0, 0x24, 0x07, 0xFF, 0x90, 0x97, 0xC2, 0xE0, 0x34, 0x00, 0x12, 0x9A, 0x7A, 0xEF, 0x70, 0x40, -+0x90, 0x97, 0xBD, 0xF0, 0x90, 0x97, 0xBD, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x25, 0x90, 0x97, -+0xC3, 0xE0, 0x24, 0x18, 0xFD, 0x90, 0x97, 0xC2, 0xE0, 0x12, 0x9A, 0x70, 0x90, 0x97, 0xBD, 0xE0, -+0x24, 0xBE, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xBD, 0xE0, 0x04, -+0xF0, 0x80, 0xD1, 0x78, 0xBE, 0x7C, 0x97, 0x91, 0xC8, 0xEF, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, -+0x22, 0x90, 0x97, 0xB5, 0xED, 0x12, 0x9F, 0x53, 0x12, 0xAF, 0x0B, 0xEF, 0x60, 0x09, 0x12, 0x9A, -+0x1F, 0x91, 0xB8, 0x60, 0x02, 0x7F, 0x01, 0x22, 0xA3, 0xE0, 0xFD, 0x91, 0x16, 0xEF, 0x22, 0xFF, -+0x90, 0x97, 0xBA, 0xE0, 0x34, 0x00, 0xFE, 0x22, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x4F, -+0x7E, 0x00, 0x7F, 0x04, 0x02, 0x87, 0xAC, 0xE4, 0xFE, 0xED, 0x30, 0xE1, 0x11, 0x90, 0x01, 0x3F, -+0xE0, 0x30, 0xE2, 0x0A, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x23, 0xF0, 0x0E, 0xED, 0x30, -+0xE0, 0x24, 0xEF, 0x30, 0xE6, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x22, 0xF0, 0x7E, 0x01, 0xEF, 0x30, -+0xE7, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x21, 0xF0, 0x7E, 0x01, 0xEF, 0x30, 0xE5, 0x08, 0x90, 0x01, -+0xC7, 0x74, 0x23, 0xF0, 0x7E, 0x01, 0xAF, 0x06, 0x22, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x97, 0x32, -+0xF0, 0x12, 0x02, 0x06, 0x90, 0x95, 0xB9, 0x12, 0x8E, 0x13, 0x90, 0x95, 0xBA, 0xF0, 0x22, 0xB1, -+0x6B, 0x2E, 0x90, 0x95, 0xBB, 0x12, 0x8E, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xBC, 0x12, 0x8F, -+0x1A, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xBD, 0xF0, 0x12, 0x8F, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x95, -+0xBE, 0xF0, 0x12, 0x8F, 0xE2, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xBF, 0x12, 0x8E, 0x1B, 0xFF, 0xED, -+0x2F, 0x90, 0x95, 0xC0, 0xB1, 0xB4, 0x90, 0x95, 0xC1, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, -+0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, 0x22, 0xB1, 0x6B, 0x2E, 0x90, 0x95, 0xC2, 0x12, 0x8E, -+0x13, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xC3, 0x12, 0x8F, 0x1A, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xC4, -+0xF0, 0x12, 0x8F, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xC5, 0xF0, 0x12, 0x8F, 0xE2, 0xFF, 0xED, -+0x2F, 0x90, 0x95, 0xC6, 0x12, 0x8E, 0x1B, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xC7, 0xB1, 0xB4, 0x90, -+0x95, 0xC8, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, 0x1F, 0xFF, 0xAE, 0x05, 0xED, 0x2F, -+0x22, 0xB1, 0x6B, 0x2E, 0x90, 0x95, 0xC9, 0x12, 0x8E, 0x13, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, -+0x95, 0xCA, 0xF0, 0x22, 0xE4, 0xFD, 0xFC, 0xEF, 0x60, 0x3A, 0x90, 0x95, 0xBF, 0x12, 0xD2, 0xEF, -+0x12, 0xCF, 0xAB, 0x12, 0xC3, 0x9D, 0x75, 0x48, 0x40, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xF5, 0x12, -+0x69, 0xF5, 0xE4, 0xFD, 0x7F, 0x03, 0x12, 0x54, 0x1E, 0x90, 0x95, 0xC0, 0xE0, 0x12, 0xCC, 0xB3, -+0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x77, 0xA4, 0x7D, 0x01, 0x7F, -+0x03, 0x12, 0x54, 0x1E, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, 0xC1, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0xBA, 0xE0, 0xFF, 0xB4, 0x02, 0x07, 0xF1, 0x82, 0x74, 0x08, -+0xF0, 0x80, 0x09, 0xEF, 0xB4, 0x04, 0x05, 0xF1, 0x82, 0x74, 0x10, 0xF0, 0x90, 0x97, 0xC1, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x64, 0x02, 0x4E, 0x60, 0x08, 0xEF, 0x64, 0x01, 0x4E, 0x60, 0x02, 0xE1, -+0x75, 0x90, 0x94, 0x36, 0xE0, 0xFF, 0x64, 0xFE, 0x70, 0x02, 0xE1, 0x75, 0xEF, 0x64, 0x02, 0x60, -+0x07, 0xEF, 0x64, 0x03, 0x60, 0x02, 0xE1, 0x75, 0x90, 0x94, 0x96, 0xF1, 0xB1, 0x90, 0x98, 0x4E, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, 0x28, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x97, 0x79, -+0xE4, 0x12, 0x04, 0x80, 0x7E, 0x00, 0x7F, 0x40, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0x0C, -+0x12, 0x04, 0x80, 0x90, 0x97, 0xC1, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x4D, 0x75, -+0x45, 0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0x66, 0x75, 0x48, 0x10, 0x7B, 0x01, 0x7A, 0x98, 0x79, -+0x50, 0x12, 0x97, 0x8C, 0x75, 0x46, 0x94, 0x75, 0x47, 0x05, 0x75, 0x48, 0x10, 0x7B, 0x01, 0x7A, -+0x98, 0x79, 0x60, 0x12, 0x69, 0xF5, 0xF1, 0x93, 0x74, 0x20, 0xF1, 0x9D, 0x90, 0x8F, 0x3A, 0xF1, -+0x7A, 0x90, 0x8F, 0x3D, 0xF1, 0x8A, 0x90, 0x8F, 0x40, 0xF0, 0x7A, 0x98, 0x79, 0x50, 0x12, 0x4C, -+0x23, 0x75, 0x45, 0x01, 0x75, 0x46, 0x98, 0x75, 0x47, 0x0C, 0x80, 0x24, 0xF1, 0x93, 0x74, 0x10, -+0xF1, 0x9D, 0x90, 0x91, 0x8C, 0xF1, 0x7A, 0x90, 0x91, 0x8F, 0xF1, 0x8A, 0x90, 0x91, 0x92, 0xF0, -+0x7A, 0x94, 0x79, 0x05, 0x12, 0x61, 0x34, 0x75, 0x45, 0x01, 0x75, 0x46, 0x98, 0x75, 0x47, 0x14, -+0x75, 0x48, 0x28, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xE4, 0x12, 0x69, 0xF5, 0x75, 0x45, 0x01, 0x75, -+0x46, 0x97, 0x75, 0x47, 0xEC, 0x75, 0x48, 0x20, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xC3, 0x12, 0x69, -+0xF5, 0x90, 0x97, 0xEA, 0xE0, 0x54, 0x03, 0x90, 0x97, 0xE3, 0xF0, 0xC3, 0x94, 0x04, 0x50, 0x1C, -+0xE0, 0x90, 0x95, 0x5F, 0xF0, 0x75, 0x45, 0x01, 0x75, 0x46, 0x97, 0x75, 0x47, 0xC3, 0x75, 0x48, -+0x20, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x3F, 0x12, 0x69, 0xF5, 0x80, 0x06, 0x90, 0x95, 0x5F, 0x74, -+0x05, 0xF0, 0x90, 0x97, 0xE3, 0xE0, 0xFF, 0x90, 0x95, 0xBA, 0xE0, 0xFD, 0x7B, 0x01, 0x7A, 0x97, -+0x79, 0xC3, 0x12, 0x8F, 0x4E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x85, 0xF7, 0x7A, 0x98, 0x79, -+0x0C, 0x22, 0x90, 0x98, 0x4C, 0x74, 0x80, 0xF0, 0xA3, 0x22, 0x12, 0x85, 0xF7, 0x90, 0x98, 0x4E, -+0xA3, 0xE0, 0x22, 0x90, 0x98, 0x4E, 0xA3, 0xE0, 0xFB, 0x90, 0x92, 0x06, 0x22, 0xF0, 0xE4, 0xA3, -+0xF0, 0xA3, 0xF0, 0xFD, 0xFC, 0xFF, 0xFE, 0x12, 0x71, 0xD4, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0x98, -+0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFD, 0xED, 0xFF, 0x22, 0x7F, 0x50, 0x7E, 0x0C, 0x12, 0x70, 0x70, -+0x90, 0x98, 0x89, 0xEF, 0xF0, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x70, 0x70, 0x90, 0x98, 0x8A, 0xEF, -+0xF0, 0x90, 0x99, 0xA4, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x99, 0xA8, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x00, 0x17, 0x12, 0xB7, 0x06, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, -+0x99, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x17, 0x12, 0xB7, 0x10, 0x90, 0x06, 0x08, 0xE0, -+0x90, 0x98, 0x9F, 0xF0, 0x90, 0x06, 0xA1, 0xE0, 0xFE, 0x90, 0x06, 0xA0, 0x12, 0xCE, 0x56, 0x90, -+0x98, 0xA1, 0xF0, 0xA3, 0xEF, 0x12, 0xD7, 0x97, 0x90, 0x06, 0xA0, 0x74, 0x20, 0xF0, 0xA3, 0x74, -+0x01, 0xF0, 0xE4, 0xFD, 0xFF, 0x02, 0xB5, 0xB6, 0x12, 0x9F, 0x54, 0x90, 0x98, 0x86, 0xE0, 0x64, -+0x01, 0xF0, 0xE0, 0x24, 0x28, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xE8, 0xA3, 0xF0, 0x12, 0x9A, 0x1F, -+0x90, 0x97, 0xB7, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x97, 0xB5, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0xE4, 0x90, 0x97, 0xDB, 0xF0, 0xEF, 0x24, 0x24, 0xFF, 0xE4, 0x3E, 0xFE, 0xC0, 0x06, 0x51, 0x05, -+0xF0, 0xD0, 0x06, 0xE4, 0xFB, 0xFA, 0x31, 0xE9, 0xF0, 0x4E, 0x60, 0x51, 0xE0, 0x24, 0x01, 0xFF, -+0x90, 0x97, 0xDC, 0xE0, 0x34, 0x00, 0x12, 0x9A, 0x7A, 0x90, 0x97, 0xBA, 0xEF, 0xF0, 0xE4, 0x90, -+0x97, 0xB9, 0xF0, 0x90, 0x97, 0xBA, 0xE0, 0xFF, 0x90, 0x97, 0xB9, 0xE0, 0xFE, 0xC3, 0x9F, 0x50, -+0x2C, 0x90, 0x97, 0xDD, 0xE0, 0x24, 0x02, 0xFD, 0x90, 0x97, 0xDC, 0xE0, 0x34, 0x00, 0xFC, 0xEE, -+0x7E, 0x00, 0x2D, 0x12, 0x9A, 0x77, 0x90, 0x97, 0xB9, 0xE0, 0x24, 0xBB, 0xF5, 0x82, 0xE4, 0x34, -+0x97, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xB9, 0xE0, 0x04, 0xF0, 0x80, 0xC6, 0x90, 0x97, 0xB6, -+0xE0, 0x24, 0x24, 0xFF, 0x90, 0x97, 0xB5, 0xE0, 0x34, 0x00, 0xFE, 0xC0, 0x06, 0x51, 0x05, 0xF0, -+0xD0, 0x06, 0x7B, 0x03, 0x7A, 0x00, 0xE4, 0x31, 0xE9, 0xF0, 0xE4, 0x90, 0x97, 0xB9, 0xF0, 0x90, -+0x97, 0xB9, 0xE0, 0xFF, 0xC3, 0x94, 0x03, 0x50, 0x70, 0xA3, 0xE0, 0xFE, 0x60, 0x63, 0xEF, 0x75, -+0xF0, 0x21, 0xA4, 0x24, 0xA4, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, 0x6F, -+0x70, 0x4F, 0x90, 0x04, 0xFC, 0xE0, 0x04, 0xF0, 0x90, 0x97, 0xBA, 0xE0, 0xFF, 0x7E, 0x00, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x97, 0xB9, 0xE0, 0x75, 0xF0, 0x21, 0xA4, 0x24, 0xA5, 0xF9, 0x74, 0x98, -+0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x78, 0xBB, 0x7C, 0x97, 0x7D, 0x01, 0xD0, 0x07, 0xD0, 0x06, 0x12, -+0x87, 0xAC, 0xEF, 0x70, 0x1C, 0x90, 0x01, 0xC7, 0x74, 0x24, 0xF0, 0x7F, 0x01, 0x12, 0xAA, 0x81, -+0x12, 0xAF, 0xD0, 0x30, 0xE0, 0x03, 0x12, 0xBF, 0x57, 0x12, 0x95, 0x43, 0xE4, 0xFF, 0x12, 0xA0, -+0x11, 0x90, 0x97, 0xB9, 0xE0, 0x04, 0xF0, 0x80, 0x86, 0x22, 0x12, 0xCF, 0xA1, 0xED, 0xF0, 0xA3, -+0xEA, 0xF0, 0xA3, 0xEB, 0xF0, 0xC3, 0x90, 0x97, 0xE6, 0xE0, 0x94, 0x01, 0x90, 0x97, 0xE5, 0xE0, -+0x94, 0x00, 0x50, 0x02, 0x80, 0x6F, 0xE4, 0x90, 0x97, 0xE9, 0xF0, 0xA3, 0xF0, 0x31, 0xFC, 0x12, -+0x9A, 0x7B, 0x90, 0x97, 0xE3, 0xE0, 0x70, 0x03, 0xA3, 0xE0, 0x6F, 0x70, 0x17, 0x90, 0x97, 0xE1, -+0xE0, 0x24, 0x02, 0x31, 0xF4, 0xFE, 0x90, 0x97, 0xE2, 0xE0, 0xFD, 0x51, 0x19, 0xBF, 0x01, 0x02, -+0x80, 0x5A, 0x80, 0x00, 0x90, 0x97, 0xE1, 0xE0, 0x24, 0x01, 0x31, 0xF4, 0x12, 0x9A, 0x7A, 0x7E, -+0x00, 0x90, 0x97, 0xE7, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x24, 0x02, 0xFF, 0xEE, 0x33, 0xFE, 0x90, -+0x97, 0xE0, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x97, 0xE9, 0xEE, 0x8F, 0xF0, 0x12, 0x02, 0xE7, -+0x90, 0x97, 0xE5, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x90, 0x97, 0xEA, 0xE0, 0x9F, 0x90, 0x97, -+0xE9, 0xE0, 0x9E, 0x40, 0x98, 0xE4, 0xFE, 0xFF, 0x22, 0xFD, 0x31, 0x5A, 0x90, 0x97, 0xDC, 0xEE, -+0xF0, 0xA3, 0xEF, 0x22, 0xFF, 0x90, 0x97, 0xE0, 0xE0, 0x34, 0x00, 0x22, 0x90, 0x97, 0xE0, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x97, 0xB8, 0xE0, 0x24, 0xDC, 0xFE, 0x90, 0x97, 0xB7, 0xE0, -+0x34, 0xFF, 0x90, 0x97, 0xE5, 0xF0, 0xA3, 0xCE, 0x22, 0xED, 0x14, 0x60, 0x06, 0x04, 0x70, 0x03, -+0x7F, 0x01, 0x22, 0x7F, 0x01, 0x22, 0x12, 0x9F, 0x54, 0xA3, 0xED, 0xF0, 0x90, 0x95, 0x69, 0xE0, -+0x70, 0x02, 0xA3, 0xE0, 0x60, 0x2D, 0xE4, 0x90, 0x97, 0xB6, 0xF0, 0x51, 0xC5, 0x50, 0x27, 0x12, -+0x9A, 0x1F, 0x51, 0x77, 0x12, 0x9A, 0x4F, 0x90, 0x97, 0xB6, 0xE0, 0x24, 0x77, 0xF5, 0x82, 0xE4, -+0x34, 0x95, 0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x97, 0xB6, 0xE0, 0x04, -+0xF0, 0x80, 0xD8, 0x7F, 0x00, 0x22, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0xE4, 0x90, 0x95, -+0x75, 0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0xED, 0x24, 0x1C, 0xFD, 0x90, 0x8A, 0xE9, 0x22, 0x12, -+0x9F, 0x54, 0xA3, 0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0x51, 0xC5, 0x50, 0x21, 0x12, 0x9A, 0x1F, 0x51, -+0x77, 0x12, 0x9A, 0x4F, 0x90, 0x97, 0xB6, 0xE0, 0x24, 0x97, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, -+0x83, 0xE0, 0xB5, 0x07, 0x1D, 0x90, 0x97, 0xB6, 0xE0, 0x04, 0xF0, 0x80, 0xDB, 0x90, 0x06, 0x32, -+0xE0, 0x44, 0x80, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x30, 0xF0, 0x7F, 0x01, 0x12, 0xAA, 0x81, 0x7F, -+0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x97, 0xB6, 0xE0, 0xFD, 0xC3, 0x94, 0x02, 0x22, 0x12, 0x9F, -+0x54, 0xE4, 0xA3, 0xF0, 0x90, 0x97, 0xB5, 0xE0, 0xFD, 0xC3, 0x94, 0x04, 0x50, 0x2C, 0x90, 0x97, -+0xB4, 0xE0, 0x24, 0x10, 0x12, 0x9D, 0x64, 0xFE, 0x90, 0x8A, 0xE9, 0x12, 0x9A, 0x4F, 0x90, 0x97, -+0xB5, 0xE0, 0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, -+0x00, 0x22, 0x90, 0x97, 0xB5, 0xE0, 0x04, 0xF0, 0x80, 0xCA, 0x7F, 0x01, 0x22, 0x12, 0x9F, 0x54, -+0x24, 0x16, 0xFF, 0xE4, 0x3E, 0x12, 0x9A, 0x7A, 0x90, 0x95, 0x73, 0xA3, 0xE0, 0xB5, 0x07, 0x1E, -+0x90, 0x97, 0xB4, 0xE0, 0x24, 0x16, 0x12, 0x9D, 0x64, 0xFE, 0x12, 0xAE, 0x40, 0x7D, 0x01, 0x12, -+0x04, 0x7E, 0xEF, 0xFD, 0x90, 0x95, 0x73, 0xE0, 0x6D, 0x70, 0x01, 0xE4, 0x60, 0x03, 0x7F, 0x00, -+0x22, 0x7F, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, -+0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x12, 0x75, 0x15, 0x10, -+0x80, 0x2D, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x15, 0x01, 0x80, 0x20, 0x90, -+0x88, 0x31, 0x12, 0x98, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x15, 0x02, 0x80, 0x12, 0x90, 0x88, 0x38, -+0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x15, 0x08, 0x80, 0x04, 0x71, 0xA2, 0x80, 0x0E, 0x90, -+0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x15, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x93, 0x08, 0xE0, 0xC3, 0x13, -+0x20, 0xE0, 0x48, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, -+0x3F, 0x60, 0x05, 0x75, 0x0F, 0x01, 0x80, 0x4C, 0x90, 0x93, 0x24, 0xE0, 0x30, 0xE0, 0x0B, 0x90, -+0x02, 0x82, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x02, 0x80, 0x3A, 0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, -+0x05, 0x75, 0x0F, 0x08, 0x80, 0x2E, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, -+0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x0F, 0x04, 0x80, 0x19, 0x90, 0x88, 0xE6, 0xE0, 0x30, -+0xE0, 0x05, 0x75, 0x0F, 0x20, 0x80, 0x0D, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x40, -+0x80, 0x02, 0x80, 0x8E, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x0F, 0xF0, -+0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, -+0x1E, 0x90, 0x88, 0xAF, 0xE0, 0x60, 0x05, 0x75, 0x16, 0x40, 0x81, 0xCC, 0x90, 0x88, 0x38, 0xE0, -+0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, 0x55, 0x12, -+0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x16, 0x01, 0x80, 0x70, 0x90, 0x88, 0x3A, 0xE0, -+0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x16, 0x02, 0x80, 0x62, 0x90, 0x88, 0x38, 0xE0, 0xFE, 0xE4, -+0xC3, 0x9E, 0x50, 0x05, 0x75, 0x16, 0x04, 0x80, 0x53, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x16, 0x08, -+0x80, 0x4A, 0x90, 0x88, 0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x16, 0x10, 0x80, 0x3E, 0x90, 0x88, -+0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x16, 0x20, 0x80, 0x2E, 0x90, 0x88, -+0x9C, 0xE0, 0x60, 0x05, 0x75, 0x16, 0x80, 0x80, 0x23, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, 0x05, -+0x75, 0x16, 0x11, 0x80, 0x17, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, 0xFF, -+0xBF, 0x80, 0x05, 0x75, 0x16, 0x12, 0x80, 0x04, 0x71, 0xA2, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, -+0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x16, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x4A, 0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, -+0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xC1, 0x54, 0xEE, 0x12, 0x8F, 0xDB, 0x30, 0xE0, -+0x02, 0xC1, 0x54, 0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0xC1, 0x54, 0xEF, 0x70, 0x02, -+0xA1, 0xB0, 0x24, 0xFE, 0x70, 0x02, 0xA1, 0xF8, 0x24, 0xFE, 0x60, 0x50, 0x24, 0xFC, 0x70, 0x02, -+0xC1, 0x3F, 0x24, 0xFC, 0x60, 0x02, 0xC1, 0x4F, 0xEE, 0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, 0x90, -+0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, -+0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x12, 0x90, 0x9A, 0x4A, 0xE0, 0xFF, -+0x60, 0x05, 0x12, 0x67, 0x80, 0x80, 0x06, 0x90, 0x8A, 0xED, 0x12, 0x8E, 0x2C, 0x90, 0x88, 0x39, -+0xE0, 0x64, 0x08, 0x60, 0x02, 0xC1, 0x4F, 0x12, 0x7B, 0xCC, 0xC1, 0x4F, 0x90, 0x88, 0x39, 0xE0, -+0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, -+0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0C, 0x90, 0x86, 0x00, 0x12, 0x8E, 0x2C, 0xBF, 0x01, -+0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xC1, 0x4F, 0x90, 0x86, -+0x00, 0x12, 0x8E, 0x2C, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xC1, 0x4F, 0x12, 0x68, 0xC2, 0xC1, 0x4F, -+0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0C, 0x90, 0x86, 0x00, 0x12, 0x8E, 0x2C, 0xBF, 0x01, 0x03, -+0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, -+0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0x86, 0x00, 0x12, 0x8E, 0x2C, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, -+0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, 0x70, 0x67, 0x90, 0x86, 0x02, 0x12, 0x8E, 0x2C, 0xEF, 0x64, -+0x01, 0x70, 0x5C, 0x12, 0x73, 0x5A, 0x80, 0x57, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0C, 0x90, -+0x86, 0x00, 0x12, 0x8E, 0x2C, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, -+0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0x86, 0x00, 0x12, -+0x8E, 0x2C, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, -+0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x15, 0x12, 0x7A, 0x49, 0x80, 0x10, 0x90, -+0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x09, 0x12, 0x97, 0xD5, 0x30, 0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, -+0x88, 0x39, 0xD1, 0x59, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x88, -+0x38, 0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, 0xF0, 0xA3, -+0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0xD1, 0xC2, 0x40, -+0x40, 0x90, 0x88, 0x50, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, 0x90, 0x88, 0x50, 0xE0, -+0xD3, 0x9F, 0x50, 0x2D, 0x90, 0x88, 0x48, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3F, 0x12, 0x9F, 0x5F, -+0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, 0xF0, 0xFB, -+0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, 0xF0, 0x12, 0x6E, -+0x2F, 0x22, 0x90, 0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, 0x3F, 0xE0, 0xD3, 0x9F, 0x22, 0xE4, 0xFE, -+0x12, 0xA3, 0x99, 0xE4, 0xF0, 0x74, 0x8B, 0x2E, 0x12, 0xA3, 0x91, 0x74, 0xFF, 0xF0, 0x0E, 0xEE, -+0xB4, 0xA0, 0xED, 0xE4, 0x90, 0x88, 0x4D, 0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, 0xF0, -+0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x90, 0x93, 0x08, 0xE0, -+0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0xA7, 0xED, 0x22, 0xF9, 0xE4, -+0x3A, 0x8B, 0x45, 0xF5, 0x46, 0x89, 0x47, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0x76, -+0x12, 0x69, 0xF5, 0x90, 0x98, 0x70, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x22, 0x90, 0x05, 0x63, 0xE0, -+0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, 0x90, 0x05, 0x61, 0xE0, -+0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, 0x90, 0x88, 0x32, 0xE0, -+0x44, 0x80, 0xF0, 0x22, 0xFF, 0x90, 0x98, 0x75, 0xF0, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0x76, 0x12, -+0x8F, 0x21, 0x90, 0x98, 0x72, 0x12, 0x85, 0xEE, 0xE9, 0x22, 0xE0, 0xFF, 0x24, 0x10, 0xF5, 0x82, -+0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB2, 0xF0, 0x74, 0x15, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB3, 0xF0, 0xE0, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, -+0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, -+0xF8, 0xFF, 0x90, 0x95, 0xEA, 0xE0, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, -+0x82, 0x8E, 0x83, 0x02, 0x04, 0x7E, 0x90, 0x88, 0x28, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x88, 0x27, -+0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x22, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x22, 0x54, -+0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x22, 0x90, 0x88, 0x38, 0xE0, 0x90, 0x98, 0xA0, 0xF0, -+0x90, 0x8A, 0x89, 0x22, 0x7D, 0x01, 0x7E, 0x00, 0x7F, 0x10, 0x12, 0x87, 0xAC, 0xEF, 0x22, 0x7F, -+0x84, 0x7E, 0x08, 0x12, 0xB7, 0x14, 0x90, 0x99, 0x92, 0x22, 0x90, 0x97, 0x32, 0x12, 0x85, 0xF7, -+0x02, 0x02, 0x06, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, 0x4D, 0xFF, 0x22, 0xF0, 0xEE, 0x54, 0x80, -+0xFE, 0xEF, 0x54, 0x7F, 0x22, 0x90, 0x97, 0xCA, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x22, 0x90, 0x97, -+0xCA, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x22, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x87, 0xAC, 0xEF, 0x22, -+0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x22, -+0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0x2C, 0xC0, -+}; -+u32 array_length_mp_8723d_fw_wowlan = 28778; -+ -+#endif -+ -+void -+ODM_ReadFirmware_MP_8723D_FW_WoWLAN( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)array_mp_8723d_fw_wowlan; -+#else -+ ODM_MoveMemory(pDM_Odm, pFirmware, array_mp_8723d_fw_wowlan, array_length_mp_8723d_fw_wowlan); -+#endif -+ *pFirmwareSize = array_length_mp_8723d_fw_wowlan; -+} -+ -+ -+ -+#endif /* end of (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP)))*/ -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_fw.h 2018-02-11 21:44:27.161146299 +0200 -@@ -0,0 +1,62 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.16*/ -+#if (RTL8723D_SUPPORT == 1) -+#ifndef __INC_MP_FW_HW_IMG_8723D_H -+#define __INC_MP_FW_HW_IMG_8723D_H -+ -+ -+/****************************************************************************** -+* FW_AP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8723D_FW_AP( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_NIC.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8723D_FW_NIC( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_WoWLAN.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8723D_FW_WoWLAN( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.c 2018-02-11 21:44:27.161146299 +0200 -@@ -0,0 +1,301 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.26*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8723D_SUPPORT == 1) -+static BOOLEAN -+CheckPositive( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2, -+ IN const u4Byte Condition3, -+ IN const u4Byte Condition4 -+) -+{ -+ u1Byte _BoardType = ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA*/ -+ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA*/ -+ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA*/ -+ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ -+ ((pDM_Odm->BoardType & BIT2) >> 2) << 4 | /* _BT*/ -+ ((pDM_Odm->BoardType & BIT1) >> 1) << 5; /* _NGFF*/ -+ -+ u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; -+ -+ u1Byte cut_version_for_para = (pDM_Odm->CutVersion == ODM_CUT_A) ? 15 : pDM_Odm->CutVersion; -+ u1Byte pkg_type_for_para = (pDM_Odm->PackageType == 0) ? 15 : pDM_Odm->PackageType; -+ -+ u4Byte driver1 = cut_version_for_para << 24 | -+ (pDM_Odm->SupportInterface & 0xF0) << 16 | -+ pDM_Odm->SupportPlatform << 16 | -+ pkg_type_for_para << 12 | -+ (pDM_Odm->SupportInterface & 0x0F) << 8 | -+ _BoardType; -+ -+ u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | -+ (pDM_Odm->TypeGPA & 0xFF) << 8 | -+ (pDM_Odm->TypeALNA & 0xFF) << 16 | -+ (pDM_Odm->TypeAPA & 0xFF) << 24; -+ -+u4Byte driver3 = 0; -+ -+ u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | -+ (pDM_Odm->TypeGPA & 0xFF00) | -+ (pDM_Odm->TypeALNA & 0xFF00) << 8 | -+ (pDM_Odm->TypeAPA & 0xFF00) << 16; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Platform, Interface) = (0x%X, 0x%X)\n", pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Board, Package) = (0x%X, 0x%X)\n", pDM_Odm->BoardType, pDM_Odm->PackageType)); -+ -+ -+ /*============== Value Defined Check ===============*/ -+ /*QFN Type [15:12] and Cut Version [27:24] need to do value check*/ -+ -+ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return FALSE; -+ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return FALSE; -+ -+ /*=============== Bit Defined Check ================*/ -+ /* We don't care [31:28] */ -+ -+ cond1 &= 0x00FF0FFF; -+ driver1 &= 0x00FF0FFF; -+ -+ if ((cond1 & driver1) == cond1) { -+ u4Byte bitMask = 0; -+ -+ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE*/ -+ return TRUE; -+ -+ if ((cond1 & BIT0) != 0) /*GLNA*/ -+ bitMask |= 0x000000FF; -+ if ((cond1 & BIT1) != 0) /*GPA*/ -+ bitMask |= 0x0000FF00; -+ if ((cond1 & BIT2) != 0) /*ALNA*/ -+ bitMask |= 0x00FF0000; -+ if ((cond1 & BIT3) != 0) /*APA*/ -+ bitMask |= 0xFF000000; -+ -+ if (((cond2 & bitMask) == (driver2 & bitMask)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ -+ return TRUE; -+ else -+ return FALSE; -+ } else -+ return FALSE; -+} -+static BOOLEAN -+CheckNegative( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2 -+) -+{ -+ return TRUE; -+} -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8723D_MAC_REG[] = { -+ 0x020, 0x00000013, -+ 0x02F, 0x00000010, -+ 0x077, 0x00000007, -+ 0x421, 0x0000000F, -+ 0x428, 0x0000000A, -+ 0x429, 0x00000010, -+ 0x430, 0x00000000, -+ 0x431, 0x00000000, -+ 0x432, 0x00000000, -+ 0x433, 0x00000001, -+ 0x434, 0x00000004, -+ 0x435, 0x00000005, -+ 0x436, 0x00000007, -+ 0x437, 0x00000008, -+ 0x43C, 0x00000004, -+ 0x43D, 0x00000005, -+ 0x43E, 0x00000007, -+ 0x43F, 0x00000008, -+ 0x440, 0x0000005D, -+ 0x441, 0x00000001, -+ 0x442, 0x00000000, -+ 0x444, 0x00000010, -+ 0x445, 0x00000000, -+ 0x446, 0x00000000, -+ 0x447, 0x00000000, -+ 0x448, 0x00000000, -+ 0x449, 0x000000F0, -+ 0x44A, 0x0000000F, -+ 0x44B, 0x0000003E, -+ 0x44C, 0x00000010, -+ 0x44D, 0x00000000, -+ 0x44E, 0x00000000, -+ 0x44F, 0x00000000, -+ 0x450, 0x00000000, -+ 0x451, 0x000000F0, -+ 0x452, 0x0000000F, -+ 0x453, 0x00000000, -+ 0x456, 0x0000005E, -+ 0x460, 0x00000066, -+ 0x461, 0x00000066, -+ 0x4C8, 0x000000FF, -+ 0x4C9, 0x00000008, -+ 0x4CC, 0x000000FF, -+ 0x4CD, 0x000000FF, -+ 0x4CE, 0x00000001, -+ 0x500, 0x00000026, -+ 0x501, 0x000000A2, -+ 0x502, 0x0000002F, -+ 0x503, 0x00000000, -+ 0x504, 0x00000028, -+ 0x505, 0x000000A3, -+ 0x506, 0x0000005E, -+ 0x507, 0x00000000, -+ 0x508, 0x0000002B, -+ 0x509, 0x000000A4, -+ 0x50A, 0x0000005E, -+ 0x50B, 0x00000000, -+ 0x50C, 0x0000004F, -+ 0x50D, 0x000000A4, -+ 0x50E, 0x00000000, -+ 0x50F, 0x00000000, -+ 0x512, 0x0000001C, -+ 0x514, 0x0000000A, -+ 0x516, 0x0000000A, -+ 0x525, 0x0000004F, -+ 0x550, 0x00000010, -+ 0x551, 0x00000010, -+ 0x559, 0x00000002, -+ 0x55C, 0x00000028, -+ 0x55D, 0x000000FF, -+ 0x605, 0x00000030, -+ 0x608, 0x0000000E, -+ 0x609, 0x0000002A, -+ 0x620, 0x000000FF, -+ 0x621, 0x000000FF, -+ 0x622, 0x000000FF, -+ 0x623, 0x000000FF, -+ 0x624, 0x000000FF, -+ 0x625, 0x000000FF, -+ 0x626, 0x000000FF, -+ 0x627, 0x000000FF, -+ 0x638, 0x00000028, -+ 0x63C, 0x0000000A, -+ 0x63D, 0x0000000A, -+ 0x63E, 0x0000000C, -+ 0x63F, 0x0000000C, -+ 0x640, 0x00000040, -+ 0x642, 0x00000040, -+ 0x643, 0x00000000, -+ 0x652, 0x000000C8, -+ 0x66A, 0x000000B0, -+ 0x66E, 0x00000005, -+ 0x700, 0x00000021, -+ 0x701, 0x00000043, -+ 0x702, 0x00000065, -+ 0x703, 0x00000087, -+ 0x708, 0x00000021, -+ 0x709, 0x00000043, -+ 0x70A, 0x00000065, -+ 0x70B, 0x00000087, -+ 0x765, 0x00000018, -+ 0x76E, 0x00000004, -+ 0x7C0, 0x00000038, -+ 0x7C2, 0x0000000F, -+ 0x7C3, 0x000000C0, -+ 0x073, 0x00000004, -+ 0x7C4, 0x00000077, -+ 0x07C, 0x00000003, -+ 0x016, 0x000000B3, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8723D_MAC_REG( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8723D_MAC_REG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8723D_MAC_REG; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_MAC_REG\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigMAC_8723D(pDM_Odm, v1, (u1Byte)v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8723D_MAC_REG(void) -+{ -+ return 31; -+} -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_mac.h 2018-02-11 21:44:27.161146299 +0200 -@@ -0,0 +1,39 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.26*/ -+#if (RTL8723D_SUPPORT == 1) -+#ifndef __INC_MP_MAC_HW_IMG_8723D_H -+#define __INC_MP_MAC_HW_IMG_8723D_H -+ -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723D_MAC_REG(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8723D_MAC_REG(void); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.c 2018-02-11 21:44:27.161146299 +0200 -@@ -0,0 +1,1199 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.26*/ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8723D_SUPPORT == 1) -+static BOOLEAN -+CheckPositive( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2, -+ IN const u4Byte Condition3, -+ IN const u4Byte Condition4 -+) -+{ -+ u1Byte _BoardType = ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA*/ -+ ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA*/ -+ ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA*/ -+ ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */ -+ ((pDM_Odm->BoardType & BIT2) >> 2) << 4 | /* _BT*/ -+ ((pDM_Odm->BoardType & BIT1) >> 1) << 5; /* _NGFF*/ -+ -+ u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; -+ -+ u1Byte cut_version_for_para = (pDM_Odm->CutVersion == ODM_CUT_A) ? 15 : pDM_Odm->CutVersion; -+ u1Byte pkg_type_for_para = (pDM_Odm->PackageType == 0) ? 15 : pDM_Odm->PackageType; -+ -+ u4Byte driver1 = cut_version_for_para << 24 | -+ (pDM_Odm->SupportInterface & 0xF0) << 16 | -+ pDM_Odm->SupportPlatform << 16 | -+ pkg_type_for_para << 12 | -+ (pDM_Odm->SupportInterface & 0x0F) << 8 | -+ _BoardType; -+ -+ u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | -+ (pDM_Odm->TypeGPA & 0xFF) << 8 | -+ (pDM_Odm->TypeALNA & 0xFF) << 16 | -+ (pDM_Odm->TypeAPA & 0xFF) << 24; -+ -+u4Byte driver3 = 0; -+ -+ u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | -+ (pDM_Odm->TypeGPA & 0xFF00) | -+ (pDM_Odm->TypeALNA & 0xFF00) << 8 | -+ (pDM_Odm->TypeAPA & 0xFF00) << 16; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Platform, Interface) = (0x%X, 0x%X)\n", pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, -+ (" (Board, Package) = (0x%X, 0x%X)\n", pDM_Odm->BoardType, pDM_Odm->PackageType)); -+ -+ -+ /*============== Value Defined Check ===============*/ -+ /*QFN Type [15:12] and Cut Version [27:24] need to do value check*/ -+ -+ if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000))) -+ return FALSE; -+ if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000))) -+ return FALSE; -+ -+ /*=============== Bit Defined Check ================*/ -+ /* We don't care [31:28] */ -+ -+ cond1 &= 0x00FF0FFF; -+ driver1 &= 0x00FF0FFF; -+ -+ if ((cond1 & driver1) == cond1) { -+ u4Byte bitMask = 0; -+ -+ if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE*/ -+ return TRUE; -+ -+ if ((cond1 & BIT0) != 0) /*GLNA*/ -+ bitMask |= 0x000000FF; -+ if ((cond1 & BIT1) != 0) /*GPA*/ -+ bitMask |= 0x0000FF00; -+ if ((cond1 & BIT2) != 0) /*ALNA*/ -+ bitMask |= 0x00FF0000; -+ if ((cond1 & BIT3) != 0) /*APA*/ -+ bitMask |= 0xFF000000; -+ -+ if (((cond2 & bitMask) == (driver2 & bitMask)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ -+ return TRUE; -+ else -+ return FALSE; -+ } else -+ return FALSE; -+} -+static BOOLEAN -+CheckNegative( -+ IN PDM_ODM_T pDM_Odm, -+ IN const u4Byte Condition1, -+ IN const u4Byte Condition2 -+) -+{ -+ return TRUE; -+} -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8723D_RadioA[] = { -+ 0x050, 0x00019000, -+ 0x000, 0x00010000, -+ 0x0B1, 0x00054573, -+ 0x0B4, 0x000508AB, -+ 0x0B7, 0x00014787, -+ 0x0B8, 0x000064CB, -+ 0x01B, 0x00073A40, -+ 0x051, 0x00038CAF, -+ 0x052, 0x000FCCA3, -+ 0x053, 0x00090F38, -+ 0x054, 0x00011083, -+ 0x057, 0x000D0000, -+ 0x08D, 0x00000A1A, -+ 0x082, 0x00082AAC, -+ 0x08E, 0x00076940, -+ 0x08F, 0x00088400, -+ 0x061, 0x00038CAF, -+ 0x062, 0x000FCCA3, -+ 0x063, 0x00090F38, -+ 0x064, 0x00011083, -+ 0x067, 0x000D0000, -+ 0x092, 0x00082AAC, -+ 0x0EF, 0x00000400, -+ 0x030, 0x000008CA, -+ 0x030, 0x000018CF, -+ 0x030, 0x000028CA, -+ 0x030, 0x000038CA, -+ 0x0EF, 0x00000000, -+ 0x0EE, 0x00000400, -+ 0x030, 0x000008CA, -+ 0x030, 0x000018CF, -+ 0x030, 0x000028CA, -+ 0x030, 0x000038CA, -+ 0x0EE, 0x00000000, -+ 0x0EF, 0x00000100, -+ 0x033, 0x00000000, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000003, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000004, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000005, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000006, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000007, -+ 0x03F, 0x0000CCA3, -+ 0x0EF, 0x00000000, -+ 0x0EE, 0x00000100, -+ 0x033, 0x00000000, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000001, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000002, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000003, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000004, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000005, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000006, -+ 0x03F, 0x0000CCA3, -+ 0x033, 0x00000007, -+ 0x03F, 0x0000CCA3, -+ 0x0EE, 0x00000000, -+ 0x0EF, 0x00000800, -+ 0x030, 0x0000002D, -+ 0x030, 0x0000122C, -+ 0x030, 0x0000222F, -+ 0x030, 0x0000326C, -+ 0x030, 0x0000466B, -+ 0x030, 0x0000566E, -+ 0x030, 0x000066EB, -+ 0x030, 0x000077EC, -+ 0x030, 0x000087EF, -+ 0x030, 0x000097F2, -+ 0x030, 0x0000A7F5, -+ 0x0EF, 0x00000000, -+ 0x0EE, 0x00000800, -+ 0x030, 0x00000001, -+ 0x030, 0x00001011, -+ 0x030, 0x00002011, -+ 0x030, 0x00003013, -+ 0x030, 0x00004033, -+ 0x030, 0x00005033, -+ 0x030, 0x00006037, -+ 0x030, 0x0000703F, -+ 0x030, 0x0000803F, -+ 0x030, 0x0000903F, -+ 0x030, 0x0000A03F, -+ 0x0EE, 0x00000000, -+ 0x082, 0x00083B8C, -+ 0x0ED, 0x00000008, -+ 0x030, 0x000030F6, -+ 0x030, 0x00002004, -+ 0x030, 0x000010F6, -+ 0x030, 0x000000F6, -+ 0x0ED, 0x00000000, -+ 0x092, 0x00083B8C, -+ 0x0EC, 0x00000008, -+ 0x030, 0x000030F6, -+ 0x030, 0x00002004, -+ 0x030, 0x000010F6, -+ 0x030, 0x000000F6, -+ 0x0EC, 0x00000000, -+ 0x0EF, 0x00010000, -+ 0x030, 0x0001C11C, -+ 0x030, 0x000181F4, -+ 0x030, 0x00014108, -+ 0x030, 0x000101E4, -+ 0x030, 0x0000C11C, -+ 0x030, 0x000081F4, -+ 0x030, 0x00004108, -+ 0x030, 0x000001E4, -+ 0x0EF, 0x00000000, -+ 0x0EE, 0x00010000, -+ 0x030, 0x0001C11C, -+ 0x030, 0x000181F4, -+ 0x030, 0x00014108, -+ 0x030, 0x000101E4, -+ 0x030, 0x0000C11C, -+ 0x030, 0x000081F4, -+ 0x030, 0x00004108, -+ 0x030, 0x000001E4, -+ 0x0EE, 0x00000000, -+ 0x0EF, 0x00080000, -+ 0x033, 0x00000007, -+ 0x03E, 0x0000005F, -+ 0x03F, 0x000B3FDB, -+ 0x033, 0x00000004, -+ 0x03E, 0x0000005D, -+ 0x03F, 0x000BFFE0, -+ 0x033, 0x00000005, -+ 0x03E, 0x0000005D, -+ 0x03F, 0x000FBFCE, -+ 0x033, 0x00000006, -+ 0x03E, 0x0000005F, -+ 0x03F, 0x000A7FFB, -+ 0x0EF, 0x00000000, -+ 0x0EE, 0x00000002, -+ 0x030, 0x00000001, -+ 0x030, 0x00002001, -+ 0x030, 0x00004001, -+ 0x030, 0x00007001, -+ 0x030, 0x00006001, -+ 0x030, 0x00020001, -+ 0x030, 0x00022001, -+ 0x030, 0x00024001, -+ 0x030, 0x00027001, -+ 0x030, 0x00026001, -+ 0x030, 0x00034001, -+ 0x030, 0x00037001, -+ 0x030, 0x00036001, -+ 0x030, 0x00008000, -+ 0x030, 0x0000A000, -+ 0x030, 0x0000C000, -+ 0x030, 0x0000E000, -+ 0x030, 0x0001C000, -+ 0x030, 0x0001E000, -+ 0x0EE, 0x00000000, -+ 0x0EE, 0x00020000, -+ 0x0EF, 0x00020000, -+ 0x030, 0x00000F75, -+ 0x030, 0x00002F55, -+ 0x030, 0x00003F75, -+ 0x0EE, 0x00000000, -+ 0x0EF, 0x00000000, -+ 0x018, 0x00008401, -+ 0xFFE, 0x00000000, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8723D_RadioA( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+ u1Byte cCond; -+ BOOLEAN bMatched = TRUE, bSkipped = FALSE; -+ u4Byte ArrayLen = sizeof(Array_MP_8723D_RadioA)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8723D_RadioA; -+ -+ u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_RadioA\n")); -+ -+ while ((i + 1) < ArrayLen) { -+ v1 = Array[i]; -+ v2 = Array[i + 1]; -+ -+ if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ -+ if (v1 & BIT31) {/* positive condition*/ -+ cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); -+ if (cCond == COND_ENDIF) {/*end*/ -+ bMatched = TRUE; -+ bSkipped = FALSE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); -+ } else if (cCond == COND_ELSE) { /*else*/ -+ bMatched = bSkipped?FALSE:TRUE; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); -+ } else {/*if , else if*/ -+ pre_v1 = v1; -+ pre_v2 = v2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); -+ } -+ } else if (v1 & BIT30) { /*negative condition*/ -+ if (bSkipped == FALSE) { -+ if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { -+ bMatched = TRUE; -+ bSkipped = TRUE; -+ } else { -+ bMatched = FALSE; -+ bSkipped = FALSE; -+ } -+ } else -+ bMatched = FALSE; -+ } -+ } else { -+ if (bMatched) -+ odm_ConfigRF_RadioA_8723D(pDM_Odm, v1, v2); -+ } -+ i = i + 2; -+ } -+} -+ -+u4Byte -+ODM_GetVersion_MP_8723D_RadioA(void) -+{ -+ return 31; -+} -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8723D[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8723D[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8723D[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8723D[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; -+#endif -+ -+void -+ODM_ReadAndConfig_MP_8723D_TxPowerTrack_PCIE( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8723D\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE*3); -+#endif -+} -+ -+/****************************************************************************** -+* TxPowerTrack_SDIO.TXT -+******************************************************************************/ -+ -+#if DEV_BUS_TYPE == RT_SDIO_INTERFACE -+u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_SDIO_8723D[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_SDIO_8723D[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_SDIO_8723D[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_SDIO_8723D[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_SDIO_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_SDIO_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; -+#endif -+ -+void -+ODM_ReadAndConfig_MP_8723D_TxPowerTrack_SDIO( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if DEV_BUS_TYPE == RT_SDIO_INTERFACE -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8723D\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE*3); -+#endif -+} -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8723D[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8723D[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8723D[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -+ {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8723D[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -+}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -+u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; -+#endif -+ -+void -+ODM_ReadAndConfig_MP_8723D_TxPowerTrack_USB( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8723D\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE*3); -+#endif -+} -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+const char *Array_MP_8723D_TXPWR_LMT[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "30", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "30", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "30", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "30", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "30", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "30", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "30", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "30", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "30", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "30", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "30", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "30", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "17", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "30", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "30", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "30", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "26", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "28", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "30", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "28", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "26", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "24", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "14", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "31", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "31", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "24", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "30", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "30", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "30", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "30", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "30", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "30", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "30", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "26", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "24", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "23", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "13", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "31", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "31", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "28", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "28", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "28", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "28", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "28", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "30", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "30", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "24", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "22", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "20", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "30", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "30", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "30", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "26", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "26", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "26", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "26", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "26", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "26", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "26", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "26", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "26", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "26", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "26", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "26", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "26", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "26", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "26", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "26", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "26", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "26", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "26", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "26", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "26", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "26", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "26", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "26", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "26", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "26", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "26", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "26", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "26", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "26", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "26", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "114", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "114", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "32", -+ "MKK", "5G", "20M", "HT", "1T", "36", "32", -+ "FCC", "5G", "20M", "HT", "1T", "40", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "32", -+ "MKK", "5G", "20M", "HT", "1T", "40", "32", -+ "FCC", "5G", "20M", "HT", "1T", "44", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "32", -+ "MKK", "5G", "20M", "HT", "1T", "44", "32", -+ "FCC", "5G", "20M", "HT", "1T", "48", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "32", -+ "MKK", "5G", "20M", "HT", "1T", "48", "32", -+ "FCC", "5G", "20M", "HT", "1T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "32", -+ "MKK", "5G", "20M", "HT", "1T", "52", "32", -+ "FCC", "5G", "20M", "HT", "1T", "56", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "32", -+ "MKK", "5G", "20M", "HT", "1T", "56", "32", -+ "FCC", "5G", "20M", "HT", "1T", "60", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "32", -+ "MKK", "5G", "20M", "HT", "1T", "60", "32", -+ "FCC", "5G", "20M", "HT", "1T", "64", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "32", -+ "MKK", "5G", "20M", "HT", "1T", "64", "32", -+ "FCC", "5G", "20M", "HT", "1T", "100", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "32", -+ "MKK", "5G", "20M", "HT", "1T", "100", "32", -+ "FCC", "5G", "20M", "HT", "1T", "114", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "114", "32", -+ "MKK", "5G", "20M", "HT", "1T", "114", "32", -+ "FCC", "5G", "20M", "HT", "1T", "108", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "32", -+ "MKK", "5G", "20M", "HT", "1T", "108", "32", -+ "FCC", "5G", "20M", "HT", "1T", "112", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "32", -+ "MKK", "5G", "20M", "HT", "1T", "112", "32", -+ "FCC", "5G", "20M", "HT", "1T", "116", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "32", -+ "MKK", "5G", "20M", "HT", "1T", "116", "32", -+ "FCC", "5G", "20M", "HT", "1T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "32", -+ "MKK", "5G", "20M", "HT", "1T", "120", "32", -+ "FCC", "5G", "20M", "HT", "1T", "124", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "32", -+ "MKK", "5G", "20M", "HT", "1T", "124", "32", -+ "FCC", "5G", "20M", "HT", "1T", "128", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "32", -+ "MKK", "5G", "20M", "HT", "1T", "128", "32", -+ "FCC", "5G", "20M", "HT", "1T", "132", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "32", -+ "MKK", "5G", "20M", "HT", "1T", "132", "32", -+ "FCC", "5G", "20M", "HT", "1T", "136", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "32", -+ "MKK", "5G", "20M", "HT", "1T", "136", "32", -+ "FCC", "5G", "20M", "HT", "1T", "140", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "32", -+ "MKK", "5G", "20M", "HT", "1T", "140", "32", -+ "FCC", "5G", "20M", "HT", "1T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "32", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "32", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "32", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "32", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "32", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "30", -+ "MKK", "5G", "20M", "HT", "2T", "36", "30", -+ "FCC", "5G", "20M", "HT", "2T", "40", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "30", -+ "MKK", "5G", "20M", "HT", "2T", "40", "30", -+ "FCC", "5G", "20M", "HT", "2T", "44", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "30", -+ "MKK", "5G", "20M", "HT", "2T", "44", "30", -+ "FCC", "5G", "20M", "HT", "2T", "48", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "30", -+ "MKK", "5G", "20M", "HT", "2T", "48", "30", -+ "FCC", "5G", "20M", "HT", "2T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "30", -+ "MKK", "5G", "20M", "HT", "2T", "52", "30", -+ "FCC", "5G", "20M", "HT", "2T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "30", -+ "MKK", "5G", "20M", "HT", "2T", "56", "30", -+ "FCC", "5G", "20M", "HT", "2T", "60", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "30", -+ "MKK", "5G", "20M", "HT", "2T", "60", "30", -+ "FCC", "5G", "20M", "HT", "2T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "30", -+ "MKK", "5G", "20M", "HT", "2T", "64", "30", -+ "FCC", "5G", "20M", "HT", "2T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "30", -+ "MKK", "5G", "20M", "HT", "2T", "100", "30", -+ "FCC", "5G", "20M", "HT", "2T", "114", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "114", "30", -+ "MKK", "5G", "20M", "HT", "2T", "114", "30", -+ "FCC", "5G", "20M", "HT", "2T", "108", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "30", -+ "MKK", "5G", "20M", "HT", "2T", "108", "30", -+ "FCC", "5G", "20M", "HT", "2T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "30", -+ "MKK", "5G", "20M", "HT", "2T", "112", "30", -+ "FCC", "5G", "20M", "HT", "2T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "30", -+ "MKK", "5G", "20M", "HT", "2T", "116", "30", -+ "FCC", "5G", "20M", "HT", "2T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "30", -+ "MKK", "5G", "20M", "HT", "2T", "120", "30", -+ "FCC", "5G", "20M", "HT", "2T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "30", -+ "MKK", "5G", "20M", "HT", "2T", "124", "30", -+ "FCC", "5G", "20M", "HT", "2T", "128", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "30", -+ "MKK", "5G", "20M", "HT", "2T", "128", "30", -+ "FCC", "5G", "20M", "HT", "2T", "132", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "30", -+ "MKK", "5G", "20M", "HT", "2T", "132", "30", -+ "FCC", "5G", "20M", "HT", "2T", "136", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "30", -+ "MKK", "5G", "20M", "HT", "2T", "136", "30", -+ "FCC", "5G", "20M", "HT", "2T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "30", -+ "MKK", "5G", "20M", "HT", "2T", "140", "30", -+ "FCC", "5G", "20M", "HT", "2T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "30", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "30", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "30", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "30", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "30", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "32", -+ "MKK", "5G", "40M", "HT", "1T", "38", "32", -+ "FCC", "5G", "40M", "HT", "1T", "46", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "32", -+ "MKK", "5G", "40M", "HT", "1T", "46", "32", -+ "FCC", "5G", "40M", "HT", "1T", "54", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "32", -+ "MKK", "5G", "40M", "HT", "1T", "54", "32", -+ "FCC", "5G", "40M", "HT", "1T", "62", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "32", -+ "MKK", "5G", "40M", "HT", "1T", "62", "32", -+ "FCC", "5G", "40M", "HT", "1T", "102", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "32", -+ "MKK", "5G", "40M", "HT", "1T", "102", "32", -+ "FCC", "5G", "40M", "HT", "1T", "110", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "32", -+ "MKK", "5G", "40M", "HT", "1T", "110", "32", -+ "FCC", "5G", "40M", "HT", "1T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "32", -+ "MKK", "5G", "40M", "HT", "1T", "118", "32", -+ "FCC", "5G", "40M", "HT", "1T", "126", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "32", -+ "MKK", "5G", "40M", "HT", "1T", "126", "32", -+ "FCC", "5G", "40M", "HT", "1T", "134", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "32", -+ "MKK", "5G", "40M", "HT", "1T", "134", "32", -+ "FCC", "5G", "40M", "HT", "1T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "32", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "32", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "30", -+ "MKK", "5G", "40M", "HT", "2T", "38", "30", -+ "FCC", "5G", "40M", "HT", "2T", "46", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "30", -+ "MKK", "5G", "40M", "HT", "2T", "46", "30", -+ "FCC", "5G", "40M", "HT", "2T", "54", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "30", -+ "MKK", "5G", "40M", "HT", "2T", "54", "30", -+ "FCC", "5G", "40M", "HT", "2T", "62", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "30", -+ "MKK", "5G", "40M", "HT", "2T", "62", "30", -+ "FCC", "5G", "40M", "HT", "2T", "102", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "30", -+ "MKK", "5G", "40M", "HT", "2T", "102", "30", -+ "FCC", "5G", "40M", "HT", "2T", "110", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "30", -+ "MKK", "5G", "40M", "HT", "2T", "110", "30", -+ "FCC", "5G", "40M", "HT", "2T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "30", -+ "MKK", "5G", "40M", "HT", "2T", "118", "30", -+ "FCC", "5G", "40M", "HT", "2T", "126", "32", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "30", -+ "MKK", "5G", "40M", "HT", "2T", "126", "30", -+ "FCC", "5G", "40M", "HT", "2T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "30", -+ "MKK", "5G", "40M", "HT", "2T", "134", "30", -+ "FCC", "5G", "40M", "HT", "2T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "30", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "30", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "28", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "32", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+void -+ODM_ReadAndConfig_MP_8723D_TXPWR_LMT( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u4Byte i = 0; -+#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+ u4Byte ArrayLen = sizeof(Array_MP_8723D_TXPWR_LMT)/sizeof(u1Byte); -+ pu1Byte Array = (pu1Byte)Array_MP_8723D_TXPWR_LMT; -+#else -+ u4Byte ArrayLen = sizeof(Array_MP_8723D_TXPWR_LMT)/sizeof(pu1Byte); -+ pu1Byte *Array = (pu1Byte *)Array_MP_8723D_TXPWR_LMT; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ PlatformZeroMemory(pHalData->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); -+ pHalData->nLinesReadPwrLmt = ArrayLen/7; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_TXPWR_LMT\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7) { -+#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) -+ u1Byte regulation = Array[i]; -+ u1Byte band = Array[i+1]; -+ u1Byte bandwidth = Array[i+2]; -+ u1Byte rate = Array[i+3]; -+ u1Byte rfPath = Array[i+4]; -+ u1Byte chnl = Array[i+5]; -+ u1Byte val = Array[i+6]; -+#else -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+#endif -+ -+ odm_ConfigBB_TXPWR_LMT_8723D(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ rsprintf((char *)pHalData->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", -+ regulation, band, bandwidth, rate, rfPath, chnl, val); -+#endif -+ } -+ -+} -+ -+/****************************************************************************** -+* TxXtalTrack.TXT -+******************************************************************************/ -+ -+s1Byte gDeltaSwingTableXtal_MP_N_TxXtalTrack_8723D[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; -+s1Byte gDeltaSwingTableXtal_MP_P_TxXtalTrack_8723D[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -10, -12, -14, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16}; -+ -+void -+ODM_ReadAndConfig_MP_8723D_TxXtalTrack( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8723D\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableXtal_P, gDeltaSwingTableXtal_MP_P_TxXtalTrack_8723D, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableXtal_N, gDeltaSwingTableXtal_MP_N_TxXtalTrack_8723D, DELTA_SWINGIDX_SIZE); -+} -+ -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halhwimg8723d_rf.h 2018-02-11 21:44:27.161146299 +0200 -@@ -0,0 +1,89 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+/*Image2HeaderVersion: 2.26*/ -+#if (RTL8723D_SUPPORT == 1) -+#ifndef __INC_MP_RF_HW_IMG_8723D_H -+#define __INC_MP_RF_HW_IMG_8723D_H -+ -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723D_RadioA(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8723D_RadioA(void); -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723D_TxPowerTrack_PCIE(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8723D_TxPowerTrack_PCIE(void); -+ -+/****************************************************************************** -+* TxPowerTrack_SDIO.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723D_TxPowerTrack_SDIO(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8723D_TxPowerTrack_SDIO(void); -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723D_TxPowerTrack_USB(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8723D_TxPowerTrack_USB(void); -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723D_TXPWR_LMT(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8723D_TXPWR_LMT(void); -+ -+/****************************************************************************** -+* TxXtalTrack.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8723D_TxXtalTrack(/* TC: Test Chip, MP: MP Chip*/ -+ IN PDM_ODM_T pDM_Odm -+); -+u4Byte ODM_GetVersion_MP_8723D_TxXtalTrack(void); -+ -+#endif -+#endif /* end of HWIMG_SUPPORT*/ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.c 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,4101 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "Mp_Precomp.h" -+#include "../phydm_precomp.h" -+ -+ -+#if (RTL8723D_SUPPORT == 1) -+ -+/*---------------------------Define Local Constant---------------------------*/ -+/*IQK*/ -+#define IQK_DELAY_TIME_8723D 10 -+ -+/* 2010/04/25 MH Define the max tx power tracking tx agc power.*/ -+#define ODM_TXPWRTRACK_MAX_IDX_8723D 6 -+ -+#define PATH_S1 0 -+#define IDX_0xC94 0 -+#define IDX_0xC80 1 -+#define IDX_0xC4C 2 -+ -+#define IDX_0xC14 0 -+#define IDX_0xCA0 1 -+ -+ -+#define PATH_S0 1 -+#define IDX_0xCD0 0 -+#define IDX_0xCD4 1 -+ -+#define IDX_0xCD8 0 -+#define IDX_0xCDC 1 -+ -+#define KEY 0 -+#define VAL 1 -+ -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+ -+/* Tx Power Tracking*/ -+ -+ -+void setIqkMatrix_8723D( -+ PDM_ODM_T pDM_Odm, -+ u1Byte OFDM_index, -+ u1Byte RFPath, -+ s4Byte IqkResult_X, -+ s4Byte IqkResult_Y -+ ) -+ { -+ s4Byte ele_A = 0, ele_D = 0, ele_C = 0, value32, tmp; -+ s4Byte ele_A_ext = 0, ele_C_ext = 0, ele_D_ext = 0; -+ -+ if (OFDM_index >= OFDM_TABLE_SIZE) -+ OFDM_index = OFDM_TABLE_SIZE-1; -+ else if (OFDM_index < 0) -+ OFDM_index = 0; -+ -+ if ((IqkResult_X != 0) && (*(pDM_Odm->pBandType) == ODM_BAND_2_4G)) { -+ -+ /* new element D */ -+ ele_D = (OFDMSwingTable_New[OFDM_index] & 0xFFC00000)>>22; -+ ele_D_ext = (((IqkResult_X * ele_D)>>7)&0x01); -+ /* new element A */ -+ if ((IqkResult_X & 0x00000200) != 0) /* consider minus */ -+ IqkResult_X = IqkResult_X | 0xFFFFFC00; -+ ele_A = ((IqkResult_X * ele_D)>>8)&0x000003FF; -+ ele_A_ext = ((IqkResult_X * ele_D)>>7) & 0x1; -+ /* new element C */ -+ if ((IqkResult_Y & 0x00000200) != 0) -+ IqkResult_Y = IqkResult_Y | 0xFFFFFC00; -+ ele_C = ((IqkResult_Y * ele_D)>>8)&0x000003FF; -+ ele_C_ext = ((IqkResult_Y * ele_D)>>7) & 0x1; -+ -+ switch (RFPath) { -+ case ODM_RF_PATH_A: -+ /* write new elements A, C, D to regC80, regC94, reg0xc4c, and element B is always 0 */ -+ /* write 0xc80 */ -+ value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord, value32); -+ /* write 0xc94 */ -+ value32 = (ele_C & 0x000003C0) >> 6; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, bMaskH4Bits, value32); -+ /* write 0xc4c */ -+ value32 = (ele_D_ext << 28) | (ele_A_ext << 31) | (ele_C_ext << 29); -+ value32 = (ODM_GetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskDWord)&(~(BIT31|BIT29|BIT28))) | value32; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskDWord, value32); -+ break; -+ -+ case ODM_RF_PATH_B: -+ /*wirte new elements A, C, D to regCd0 and regCd4, element B is always 0*/ -+ value32 = ele_D; -+ ODM_SetBBReg(pDM_Odm, 0xCd4, 0x007FE000, value32); -+ -+ value32 = ele_C; -+ ODM_SetBBReg(pDM_Odm, 0xCd4, 0x000007FE, value32); -+ -+ value32 = ele_A; -+ ODM_SetBBReg(pDM_Odm, 0xCd0, 0x000007FE, value32); -+ -+ ODM_SetBBReg(pDM_Odm, 0xCd4, BIT12, ele_D_ext); -+ ODM_SetBBReg(pDM_Odm, 0xCd0, BIT0, ele_A_ext); -+ ODM_SetBBReg(pDM_Odm, 0xCd4, BIT0, ele_C_ext); -+ break; -+ default: -+ break; -+ } -+ } else { -+ switch (RFPath) { -+ case ODM_RF_PATH_A: -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord, OFDMSwingTable_New[OFDM_index]); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, bMaskH4Bits, 0x00); -+ value32 = ODM_GetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskDWord)&(~(BIT31|BIT29|BIT28)); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskDWord, value32); -+ break; -+ -+ case ODM_RF_PATH_B: -+ /*image S1:c80 to S0:Cd0 and Cd4*/ -+ ODM_SetBBReg(pDM_Odm, 0xcd0, 0x000007FE, OFDMSwingTable_New[OFDM_index]&0x000003FF); -+ ODM_SetBBReg(pDM_Odm, 0xcd0, 0x0007E000, (OFDMSwingTable_New[OFDM_index]&0x0000FC00)>>10); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x0000007E, (OFDMSwingTable_New[OFDM_index]&0x003F0000)>>16); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x007FE000, (OFDMSwingTable_New[OFDM_index]&0xFFC00000)>>22); -+ -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x00000780, 0x00); -+ -+ ODM_SetBBReg(pDM_Odm, 0xcd4, BIT12, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, BIT0, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd0, BIT0, 0x0); -+ break; -+ default: -+ break; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("TxPwrTracking path %c: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x ele_A_ext = 0x%x ele_C_ext = 0x%x ele_D_ext = 0x%x\n", -+ (RFPath == ODM_RF_PATH_A ? 'A' : 'B'), (u4Byte)IqkResult_X, (u4Byte)IqkResult_Y, (u4Byte)ele_A, (u4Byte)ele_C, (u4Byte)ele_D, (u4Byte)ele_A_ext, (u4Byte)ele_C_ext, (u4Byte)ele_D_ext)); -+ } -+ -+VOID -+setCCKFilterCoefficient_8723D( -+ PDM_ODM_T pDM_Odm, -+ u1Byte CCKSwingIndex -+) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ ODM_SetBBReg(pDM_Odm, 0xab4, 0x000007FF, CCKSwingTable_Ch1_Ch14_8723D[CCKSwingIndex]); -+} -+ -+void DoIQK_8723D( -+ PVOID pDM_VOID, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ) -+{ -+ u4Byte bIsBtEnable = 0; -+ -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PADAPTER Adapter = pDM_Odm->Adapter; -+#endif -+ -+ -+ if (pDM_Odm->mp_mode == FALSE) -+ bIsBtEnable = ODM_GetMACReg(pDM_Odm, 0xa8, bMaskDWord) & BIT17; -+ -+ if (bIsBtEnable) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Skip IQK because BT is enable\n")); -+ return; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Do IQK because BT is disable\n")); -+ } -+ -+ ODM_ResetIQKResult(pDM_Odm); -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PHY_IQCalibrate_8723D(pDM_Odm, FALSE); -+#else -+ PHY_IQCalibrate_8723D(Adapter, FALSE); -+#endif -+ -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: ODM_TxPwrTrackSetPwr_8723D() -+ * -+ * Overview: 8723D change all channel tx power accordign to flag. -+ * OFDM & CCK are all different. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 04/23/2012 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+VOID -+ODM_TxPwrTrackSetPwr_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PVOID pDM_VOID, -+#else -+ IN PDM_ODM_T pDM_VOID, -+#endif -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ) -+{ -+ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ u1Byte PwrTrackingLimit_OFDM = 30; -+ u1Byte PwrTrackingLimit_CCK = 40; -+ u1Byte TxRate = 0xFF; -+ u1Byte Final_OFDM_Swing_Index = 0; -+ u1Byte Final_CCK_Swing_Index = 0; -+ u1Byte i = 0; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+#if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+#else -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ if (!pMgntInfo->ForcedDataRate) { -+ if (pDM_Odm->TxRate != 0xFF) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+ } else { -+ TxRate = (u1Byte) pMgntInfo->ForcedDataRate; -+ } -+#endif -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ if (pDM_Odm->mp_mode == TRUE) { /*CE MP*/ -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ } else { /*CE normal*/ -+ u2Byte rate = *(pDM_Odm->pForcedDataRate); -+ -+ if (!rate) { /*auto rate*/ -+ if (pDM_Odm->TxRate != 0xFF) -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ if (pDM_Odm->number_linked_client != 0) -+ TxRate = HwRateToMRate(pDM_Odm->TxRate); -+#endif -+ } else { /*force rate*/ -+ TxRate = (u1Byte)rate; -+ } -+ } -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8723DA\n")); -+ -+ if (TxRate != 0xFF) { -+ /*CCK*/ -+ if (((TxRate >= MGN_1M) && (TxRate <= MGN_5_5M)) || TxRate == MGN_11M) -+ PwrTrackingLimit_CCK = 40; -+ /*OFDM*/ -+ else if ((TxRate >= MGN_6M) && (TxRate <= MGN_48M)) -+ PwrTrackingLimit_OFDM = 36; -+ else if (TxRate == MGN_54M) -+ PwrTrackingLimit_OFDM = 34; -+ -+ /* HT*/ -+ else if ((TxRate >= MGN_MCS0) && (TxRate <= MGN_MCS2)) -+ PwrTrackingLimit_OFDM = 38; -+ else if ((TxRate >= MGN_MCS3) && (TxRate <= MGN_MCS4)) -+ PwrTrackingLimit_OFDM = 36; -+ else if ((TxRate >= MGN_MCS5) && (TxRate <= MGN_MCS7)) -+ PwrTrackingLimit_OFDM = 34; -+ -+ else if ((TxRate >= MGN_MCS8) && (TxRate <= MGN_MCS10)) -+ PwrTrackingLimit_OFDM = 38; -+ else if ((TxRate >= MGN_MCS11) && (TxRate <= MGN_MCS12)) -+ PwrTrackingLimit_OFDM = 36; -+ else if ((TxRate >= MGN_MCS13) && (TxRate <= MGN_MCS15)) -+ PwrTrackingLimit_OFDM = 34; -+ -+ else -+ PwrTrackingLimit_OFDM = pRFCalibrateInfo->DefaultOfdmIndex; /*Default OFDM index = 30 */ -+ } -+ -+ if (Method == TXAGC) { -+ u1Byte rf = 0; -+ u4Byte pwr = 0, TxAGC = 0; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("odm_TxPwrTrackSetPwr_8723D CH=%d\n", *(pDM_Odm->pChannel))); -+ -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; //Remnant index equal to aboslute compensate value. -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE )) -+ -+#if (MP_DRIVER != 1) -+ /*PHY_SetTxPowerLevelByPath8723D(Adapter, pHalData->CurrentChannel, RFPath); //Using new set power function -+ //PHY_SetTxPowerLevel8723D(pDM_Odm->Adapter, *pDM_Odm->pChannel);*/ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = TRUE; -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK = TRUE; -+ if (RFPath == ODM_RF_PATH_A) { -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK ); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM ); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7 ); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS8_MCS15 ); -+ } else { -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, CCK ); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM ); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7 ); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS8_MCS15 ); -+ } -+#else -+ -+ if (RFPath == ODM_RF_PATH_A) { -+ /*CCK Path S1*/ -+ pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); -+ pwr += pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_A]; -+ PHY_SetBBReg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pwr); -+ TxAGC = (pwr<<16)|(pwr<<8)|(pwr); -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, 0x00ffffff, TxAGC); -+ RT_DISP(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr_8723D: CCK Tx-rf(A) Power = 0x%x\n", TxAGC)); -+ -+ /*OFDM Path S1*/ -+ pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); -+ pwr += (pRFCalibrateInfo->BbSwingIdxOfdm[ODM_RF_PATH_A] - pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_A]); -+ TxAGC = ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs11_Mcs08, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs15_Mcs12, bMaskDWord, TxAGC); -+ RT_DISP(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr_8723D: OFDM Tx-rf(A) Power = 0x%x\n", TxAGC)); -+ } else if (RFPath == ODM_RF_PATH_B) { -+ -+ pwr = PHY_QueryBBReg(Adapter, rTxAGC_B_Rate18_06, 0xFF); -+ pwr += pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_B]; -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK1_55_Mcs32, bMaskByte3, pwr); -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, 0xff000000, pwr); -+ RT_DISP(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr_8723D: CCK Tx-rf(B) Power = 0x%x\n", pwr)); -+ -+ -+ pwr = PHY_QueryBBReg(Adapter, rTxAGC_B_Rate18_06, 0xFF); -+ pwr += (pRFCalibrateInfo->BbSwingIdxOfdm[ODM_RF_PATH_B] - pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_B]); -+ TxAGC = ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); -+ PHY_SetBBReg(Adapter, rTxAGC_B_Rate18_06, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_B_Rate54_24, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_B_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_B_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_B_Mcs11_Mcs08, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_B_Mcs15_Mcs12, bMaskDWord, TxAGC); -+ RT_DISP(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr_8723D: OFDM Tx-rf(B) Power = 0x%x\n", TxAGC)); -+ } -+#endif -+ -+#endif -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ /*PHY_RF6052SetCCKTxPower(pDM_Odm->priv, *(pDM_Odm->pChannel)); -+ //PHY_RF6052SetOFDMTxPower(pDM_Odm->priv, *(pDM_Odm->pChannel));*/ -+#endif -+ -+ } else if (Method == BBSWING) { -+ Final_OFDM_Swing_Index = pRFCalibrateInfo->DefaultOfdmIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; -+ Final_CCK_Swing_Index = pRFCalibrateInfo->DefaultCckIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ (" pRFCalibrateInfo->DefaultOfdmIndex=%d, pRFCalibrateInfo->DefaultCCKIndex=%d, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]=%d, pRFCalibrateInfo->Remnant_CCKSwingIdx=%d RF_Path = %d\n", -+ pRFCalibrateInfo->DefaultOfdmIndex, pRFCalibrateInfo->DefaultCckIndex, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath], pRFCalibrateInfo->Remnant_CCKSwingIdx, RFPath)); -+ -+ /* Adjust BB swing by OFDM IQ matrix */ -+ if (Final_OFDM_Swing_Index >= PwrTrackingLimit_OFDM) -+ Final_OFDM_Swing_Index = PwrTrackingLimit_OFDM; -+ else if (Final_OFDM_Swing_Index < 0) -+ Final_OFDM_Swing_Index = 0; -+ -+ if (Final_CCK_Swing_Index >= CCK_TABLE_SIZE_8723D) -+ Final_CCK_Swing_Index = CCK_TABLE_SIZE_8723D-1; -+ else if (pRFCalibrateInfo->BbSwingIdxCck < 0) -+ Final_CCK_Swing_Index = 0; -+ -+ setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_A, -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); -+ -+ setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_B, -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); -+ -+ setCCKFilterCoefficient_8723D(pDM_Odm, Final_CCK_Swing_Index); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; -+ -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Final_CCK_Swing_Index=%d\n", Final_CCK_Swing_Index)); -+ -+ } else if (Method == MIX_MODE) { -+ #if (MP_DRIVER == 1) -+ u4Byte TxAGC = 0; /*add by Mingzhi.Guo 2015-04-10*/ -+ s4Byte pwr = 0; -+ #endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("pDM_Odm->DefaultOfdmIndex=%d, pDM_Odm->DefaultCCKIndex=%d, pDM_Odm->Absolute_OFDMSwingIdx[RFPath]=%d, RF_Path = %d\n", -+ pRFCalibrateInfo->DefaultOfdmIndex, pRFCalibrateInfo->DefaultCckIndex, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath], RFPath)); -+ -+ Final_OFDM_Swing_Index = pRFCalibrateInfo->DefaultOfdmIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; -+ -+ if (RFPath == ODM_RF_PATH_A) { -+ Final_CCK_Swing_Index = pRFCalibrateInfo->DefaultCckIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; /*CCK Follow Path-A and lower CCK index means higher power.*/ -+ -+ if (Final_OFDM_Swing_Index > PwrTrackingLimit_OFDM) { -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit_OFDM; -+ -+ setIqkMatrix_8723D(pDM_Odm, PwrTrackingLimit_OFDM, ODM_RF_PATH_A, -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); -+ setIqkMatrix_8723D(pDM_Odm, PwrTrackingLimit_OFDM, ODM_RF_PATH_B, -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; -+ -+ /*Set TxAGC Page C{};*/ -+ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM);*/ -+ /* PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit_OFDM, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } else if (Final_OFDM_Swing_Index < 0) { -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index ; -+ -+ setIqkMatrix_8723D(pDM_Odm, 0, ODM_RF_PATH_A, -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); -+ setIqkMatrix_8723D(pDM_Odm, 0, ODM_RF_PATH_B, -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; -+ -+ /*Set TxAGC Page C{};*/ -+ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM);*/ -+ /* PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } else { -+ setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_A, -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); -+ setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_B, -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); -+ -+ if (pRFCalibrateInfo->Modify_TxAGC_Flag_PathA) { -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = 0; -+ -+ /*Set TxAGC Page C{};*/ -+ /* PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM ); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7 ); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS8_MCS15 );*/ -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A pDM_Odm->Modify_TxAGC_Flag = FALSE \n")); -+ } -+ } -+#if (MP_DRIVER == 1) -+ if ((pDM_Odm->mp_mode) == 1) { -+ pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); -+ pwr += (pRFCalibrateInfo->Remnant_OFDMSwingIdx[ODM_RF_PATH_A] - pRFCalibrateInfo->Modify_TxAGC_Value_OFDM); -+ -+ if (pwr > 0x3F) -+ pwr = 0x3F; -+ else if (pwr < 0) -+ pwr = 0; -+ -+ TxAGC |= ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ODM_TxPwrTrackSetPwr8188F: OFDM Tx-rf(A) Power = 0x%x\n", TxAGC)); -+ -+ } else -+#endif -+ { -+ -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7); -+ } -+ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM = pRFCalibrateInfo->Remnant_OFDMSwingIdx[ODM_RF_PATH_A] ; -+ -+ if (Final_CCK_Swing_Index > PwrTrackingLimit_CCK) { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx = Final_CCK_Swing_Index - PwrTrackingLimit_CCK; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Over Limit , PwrTrackingLimit_CCK = %d , pDM_Odm->Remnant_CCKSwingIdx = %d \n", PwrTrackingLimit_CCK, pRFCalibrateInfo->Remnant_CCKSwingIdx)); -+ -+ /* Adjust BB swing by CCK filter coefficient*/ -+ ODM_SetBBReg(pDM_Odm, 0xab4, 0x000007FF, CCKSwingTable_Ch1_Ch14_8723D[PwrTrackingLimit_CCK]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK = TRUE; -+ -+ /*Set TxAGC Page C{};*/ -+ /* PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, CCK);*/ -+ -+ } else if (Final_CCK_Swing_Index < 0) { -+ pRFCalibrateInfo->Remnant_CCKSwingIdx = Final_CCK_Swing_Index; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Under Limit , PwrTrackingLimit_CCK = %d , pDM_Odm->Remnant_CCKSwingIdx = %d \n", 0, pRFCalibrateInfo->Remnant_CCKSwingIdx)); -+ -+ ODM_SetBBReg(pDM_Odm, 0xab4, 0x000007FF, CCKSwingTable_Ch1_Ch14_8723D[0]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK = TRUE; -+ -+ -+ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, CCK);*/ -+ -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Compensate with BBSwing , Final_CCK_Swing_Index = %d \n", Final_CCK_Swing_Index)); -+ -+ ODM_SetBBReg(pDM_Odm, 0xab4, 0x000007FF, CCKSwingTable_Ch1_Ch14_8723D[Final_CCK_Swing_Index]); -+ -+ /* if (pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK) {*/ -+ pRFCalibrateInfo->Remnant_CCKSwingIdx = 0; -+ -+ -+ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK ); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, CCK );*/ -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A pDM_Odm->Modify_TxAGC_Flag_CCK = FALSE \n")); -+ } -+#if (MP_DRIVER == 1) -+ if ((pDM_Odm->mp_mode) == 1) { -+ pwr = PHY_QueryBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte1); -+ pwr += pRFCalibrateInfo->Remnant_CCKSwingIdx-pRFCalibrateInfo->Modify_TxAGC_Value_CCK; -+ -+ if (pwr > 0x3F) -+ pwr = 0x3F; -+ else if (pwr < 0) -+ pwr = 0; -+ -+ PHY_SetBBReg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pwr); -+ TxAGC = (pwr<<16)|(pwr<<8)|(pwr); -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, 0xffffff00, TxAGC); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ODM_TxPwrTrackSetPwr8723D: CCK Tx-rf(A) Power = 0x%x\n", TxAGC)); -+ } else -+#endif -+ -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Value_CCK = pRFCalibrateInfo->Remnant_CCKSwingIdx; -+ } -+#if 0 -+ if (RFPath == ODM_RF_PATH_B) { -+ if (Final_OFDM_Swing_Index > PwrTrackingLimit_OFDM) { -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit_OFDM; -+ -+ setIqkMatrix_8723D(pDM_Odm, PwrTrackingLimit_OFDM, ODM_RF_PATH_B, -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; -+ -+ -+ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit_OFDM, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } else if (Final_OFDM_Swing_Index < 0) { -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index ; -+ -+ setIqkMatrix_8723D(pDM_Odm, 0, ODM_RF_PATH_B, -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; -+ -+ -+ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); -+ } else { -+ setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_B, -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], -+ pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); -+ -+ if (pRFCalibrateInfo->Modify_TxAGC_Flag_PathB) { -+ pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = 0; -+ -+ /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ -+ -+ pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B pDM_Odm->Modify_TxAGC_Flag = FALSE \n")); -+ } -+ } -+#if (MP_DRIVER == 1) -+ if ((pDM_Odm->mp_mode) == 1) { -+ pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); -+ pwr += (pRFCalibrateInfo->Remnant_OFDMSwingIdx[ODM_RF_PATH_B] - pRFCalibrateInfo->Modify_TxAGC_Value_OFDM); -+ -+ if (pwr > 0x3F) -+ pwr = 0x3F; -+ else if (pwr < 0) -+ pwr = 0; -+ -+ TxAGC |= ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ODM_TxPwrTrackSetPwr8723D: OFDM Tx-rf(A) Power = 0x%x\n", TxAGC)); -+ -+ } else -+#endif -+ { -+ -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM); -+ PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7); -+ } -+ pRFCalibrateInfo->Modify_TxAGC_Value_OFDM = pRFCalibrateInfo->Remnant_OFDMSwingIdx[ODM_RF_PATH_B] ; -+ } -+#endif -+} else { -+ return; -+ } -+} -+ -+VOID -+GetDeltaSwingTable_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PVOID pDM_VOID, -+#else -+ IN PDM_ODM_T pDM_Odm, -+#endif -+ OUT pu1Byte *TemperatureUP_A, -+ OUT pu1Byte *TemperatureDOWN_A, -+ OUT pu1Byte *TemperatureUP_B, -+ OUT pu1Byte *TemperatureDOWN_B -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u1Byte TxRate = 0xFF; -+ u1Byte channel = pHalData->CurrentChannel; -+ -+ if (pDM_Odm->mp_mode == TRUE) { -+ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ #if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ #endif -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ #endif -+ #endif -+ } else { -+ u2Byte rate = *(pDM_Odm->pForcedDataRate); -+ -+ if (!rate) { /*auto rate*/ -+ if (rate != 0xFF) { -+ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -+ TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -+ #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ if (pDM_Odm->number_linked_client != 0) -+ TxRate = HwRateToMRate(pDM_Odm->TxRate); -+ #endif -+ } -+ } else { /*force rate*/ -+ TxRate = (u1Byte)rate; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Power Tracking TxRate=0x%X\n", TxRate)); -+ -+ if ( 1 <= channel && channel <= 14) { -+ if (IS_CCK_RATE(TxRate)) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N; -+ } else { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N; -+ } -+ } else { -+ *TemperatureUP_A = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_A = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ *TemperatureUP_B = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_B = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ } -+ -+ return; -+} -+ -+VOID -+GetDeltaSwingXtalTable_8723D( -+ PVOID pDM_VOID, -+ ps1Byte *TemperatureUP_Xtal, -+ ps1Byte *TemperatureDOWN_Xtal -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ *TemperatureUP_Xtal = pRFCalibrateInfo->DeltaSwingTableXtal_P; -+ *TemperatureDOWN_Xtal = pRFCalibrateInfo->DeltaSwingTableXtal_N; -+} -+ -+ -+ -+VOID -+ODM_TxXtalTrackSetXtal_8723D( -+ PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ s1Byte CrystalCap; -+ -+ -+ CrystalCap = pHalData->CrystalCap & 0x3F; -+ CrystalCap = CrystalCap + pRFCalibrateInfo->XtalOffset; -+ -+ if (CrystalCap < 0) -+ CrystalCap = 0; -+ else if (CrystalCap > 63) -+ CrystalCap = 63; -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("CrystalCap(%d)= pHalData->CrystalCap(%d) + pRFCalibrateInfo->XtalOffset(%d)\n", CrystalCap, pHalData->CrystalCap, pRFCalibrateInfo->XtalOffset)); -+ -+ ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCap | (CrystalCap << 6))); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("CrystalCap(0x2c) 0x%X\n", ODM_GetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0xFFF000))); -+ -+} -+ -+void ConfigureTxpowerTrack_8723D( -+ PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ pConfig->SwingTableSize_CCK = CCK_TABLE_SIZE_8723D; -+ pConfig->SwingTableSize_OFDM = OFDM_TABLE_SIZE; -+ pConfig->Threshold_IQK = IQK_THRESHOLD; -+ pConfig->AverageThermalNum = AVG_THERMAL_NUM_8723D; -+ pConfig->RfPathCount = MAX_PATH_NUM_8723D; -+ pConfig->ThermalRegAddr = RF_T_METER_88E; -+ -+ pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr_8723D; -+ pConfig->DoIQK = DoIQK_8723D; -+ pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8723D; -+ pConfig->GetDeltaSwingTable = GetDeltaSwingTable_8723D; -+ pConfig->GetDeltaSwingXtalTable = GetDeltaSwingXtalTable_8723D; -+ pConfig->ODM_TxXtalTrackSetXtal = ODM_TxXtalTrackSetXtal_8723D; -+} -+ -+ -+#define MAX_TOLERANCE 5 -+#define IQK_DELAY_TIME 1 -+ -+u1Byte -+phy_PathS1_IQK_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN configPathS0 -+ ) -+{ -+ u4Byte regEAC, regE94, regE9C, tmp, Path_SEL_BB/*, regEA4*/; -+ u1Byte result = 0x00, Ktime; -+ u4Byte originalPath, originalGNT; -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Path S1 TXIQK!!\n")); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S1 TXIQK = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); -+ /*save RF path*/ -+ Path_SEL_BB = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x1e6@S1 TXIQK = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6)));*/ -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x99000000); -+ -+ /*IQK setting*/ -+ /*leave IQK mode*/ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ /* --- \A7\EF\BCgTXIQK mode table ---//*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00004); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005d); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xBFFE0); -+ -+ /*path-A IQK setting*/ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x08008c0c); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x8214019f); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28160200); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ /*LO calibration setting*/ -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x00462911); -+ -+ /*PA, PAD setting*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x56, 0x600, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x56, 0x1E0, 0x3); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8d, 0x1F, 0xf); -+ -+ /*LOK setting added for 8723D*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x10, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x54, 0x1, 0x1); -+#if 1 -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask, 0xe0d); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask, 0x60d); -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S1 TXIQK = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S1 TXIQK = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); -+ -+ /*enter IQK mode*/ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+ -+#if 1 -+ /*backup Path & GNT value */ -+ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); -+ ODM_delay_ms(1); -+ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); -+ -+ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -+#endif -+ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); -+ ODM_delay_ms(1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S1 TXIQK = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S1 TXIQK = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); -+ -+ /*One shot, Path S1 LOK & IQK*/ -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xfa000000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ /* delay x ms */ -+ /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ -+ -+ Ktime = 0; -+ while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { -+ ODM_delay_ms(1); -+ Ktime++; -+ } -+ -+#if 1 -+ /*Restore GNT_WL/GNT_BT and Path owner*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -+#endif -+ -+ -+ /*reload RF path*/ -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); -+ -+ /*leave IQK mode*/ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ /*PA/PAD controlled by 0x0*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); -+ -+ /* Check failed*/ -+ regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); -+ regE94 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); -+ regE9C = ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac = 0x%x\n", regEAC)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94 = 0x%x, 0xe9c = 0x%x\n", regE94, regE9C)); -+ /*monitor image power before & after IQK*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90(before IQK)= 0x%x, 0xe98(afer IQK) = 0x%x\n", -+ ODM_GetBBReg(pDM_Odm, 0xe90, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xe98, bMaskDWord))); -+ -+ if (!(regEAC & BIT28) && -+ (((regE94 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C & 0x03FF0000)>>16) != 0x42)) -+ -+ result |= 0x01; -+ else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S1 TXIQK FAIL\n")); -+ -+ -+ return result; -+ -+ } -+ -+u1Byte -+phy_PathS1_RxIQK_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN configPathS0 -+ ) -+{ -+ u4Byte regEAC, regE94, regE9C, regEA4, u4tmp, tmp, Path_SEL_BB; -+ u1Byte result = 0x00, Ktime; -+ u4Byte originalPath, originalGNT; -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ -+ Path_SEL_BB = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Path S1 RXIQK Step1!!\n")); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S1 RXIQK1 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x99000000); -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S1 RXIQK1 = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6))); */ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ -+ /*IQK setting*/ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ /*path-A IQK setting*/ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x18008c1c); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82160000); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28160000); -+ -+ /*LO calibration setting*/ -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a911); -+ -+ /*modify RXIQK mode table*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00006); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xa7ffb); -+ -+ /*---------PA/PAD=0----------*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x56, 0x600, 0x0); -+#if 1 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask, 0xe0d); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask, 0x60d); -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1@ Path S1 RXIQK1 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2@ Path S1 RXIQK1 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); -+ -+ /*enter IQK mode*/ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+ -+#if 1 -+ /*backup Path & GNT value */ -+ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); -+ ODM_delay_ms(1); -+ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); -+ -+ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -+#endif -+ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); -+ ODM_delay_ms(1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S1 RXIQK1 = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S1 RXIQK1 = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); -+ -+ /*One shot, Path S1 LOK & IQK*/ -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ /*delay x ms*/ -+ /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ -+ -+ Ktime = 0; -+ while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { -+ ODM_delay_ms(1); -+ Ktime++; -+ } -+ -+ -+ regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); -+ regE94 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); -+ regE9C = ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac = 0x%x\n", regEAC)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94 = 0x%x, 0xe9c = 0x%x\n", regE94, regE9C)); -+ /*monitor image power before & after IQK*/ -+ ODM_RT_TRACE(pDM_Odm , ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90(before IQK)= 0x%x, 0xe98(afer IQK) = 0x%x\n", -+ ODM_GetBBReg(pDM_Odm, 0xe90, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xe98, bMaskDWord))); -+ -+ -+ tmp = (regE9C & 0x03FF0000)>>16; -+ if ((tmp & 0x200) > 0) -+ tmp = 0x400 - tmp; -+ -+ if (!(regEAC & BIT28) && -+ (((regE94 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C & 0x03FF0000)>>16) != 0x42)) -+ -+ result |= 0x01; -+ else { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S1 RXIQK STEP1 FAIL\n")); -+#if 1 -+ /*Restore GNT_WL/GNT_BT and Path owner*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -+#endif -+ /*reload RF path*/ -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); -+ return result; -+ } -+ -+ u4tmp = 0x80007C00 | (regE94&0x3FF0000) | ((regE9C&0x3FF0000) >> 16); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, u4tmp); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe40 = 0x%x u4tmp = 0x%x\n", ODM_GetBBReg(pDM_Odm, rTx_IQK, bMaskDWord), u4tmp)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Path S1 RXIQK STEP2!!\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S1 RXIQK2 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S1 RXIQK2 = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6))); */ -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x38008c1c); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x18008c1c); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82170000); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28171400); -+ -+ /*LO calibration setting*/ -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a8d1); -+ -+ -+ /*modify RXIQK mode table*/ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00007); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xb3fdb); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S1 RXIQK2 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S1 RXIQK2 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); -+ -+ /*enter IQK mode*/ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+ -+#if 1 -+ /*backup Path & GNT value */ -+ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); -+ ODM_delay_ms(1); -+ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); -+ -+ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -+#endif -+ -+ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); -+ ODM_delay_ms(1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S1 RXIQK2 = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S1 RXIQK2 = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); -+ -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ -+ /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ -+ -+ Ktime = 0; -+ while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { -+ ODM_delay_ms(1); -+ Ktime++; -+ } -+ -+#if 1 -+ /*Restore GNT_WL/GNT_BT and Path owner*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -+#endif -+ -+ -+ /*reload RF path*/ -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); -+ -+ /*leave IQK mode*/ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ /* PA/PAD controlled by 0x0*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); -+ -+ regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); -+ regEA4 = ODM_GetBBReg(pDM_Odm, rRx_Power_Before_IQK_A_2, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac = 0x%x\n", regEAC)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea4 = 0x%x, 0xeac = 0x%x\n", regEA4, regEAC)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea0(before IQK)= 0x%x, 0xea8(afer IQK) = 0x%x\n", -+ ODM_GetBBReg(pDM_Odm, 0xea0, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xea8, bMaskDWord))); -+ -+ -+ tmp = (regEAC & 0x03FF0000)>>16; -+ if ((tmp & 0x200) > 0) -+ tmp = 0x400 - tmp; -+ -+ if (!(regEAC & BIT27) && /*if Tx is OK, check whether Rx is OK*/ -+ (((regEA4 & 0x03FF0000)>>16) != 0x132) && -+ (((regEAC & 0x03FF0000)>>16) != 0x36) && -+ (((regEA4 & 0x03FF0000)>>16) < 0x11a) && -+ (((regEA4 & 0x03FF0000)>>16) > 0xe6) && -+ (tmp < 0x1a)) -+ result |= 0x02; -+ else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S1 RXIQK STEP2 FAIL\n")); -+ -+ -+ return result; -+} -+ -+ -+u1Byte -+phy_PathS0_IQK_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER pAdapter -+#endif -+ ) -+{ -+ u4Byte regEA4, regEAC, regE94, regE9C, regE94_S0, regE9C_S0, regEA4_S0, regEAC_S0, tmp, Path_SEL_BB; -+ u1Byte result = 0x00, Ktime; -+ u4Byte originalPath, originalGNT; -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 TXIQK!\n")); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S0 TXIQK = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); -+ Path_SEL_BB = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); -+ -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x99000280); /*10 od 0x948 0x1 [7] ; WL:S1 to S0;BT:S0 to S1;*/ -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S0 TXIQK = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6)));*/ -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ /*modify TXIQK mode table*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xee, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00004); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005d); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xBFFE0); -+ -+ /*path-A IQK setting*/ -+ ODM_SetBBReg(pDM_Odm, 0xe30, bMaskDWord, 0x08008c0c); -+ ODM_SetBBReg(pDM_Odm, 0xe34, bMaskDWord, 0x38008c1c); -+ ODM_SetBBReg(pDM_Odm, 0xe38, bMaskDWord, 0x8214018a); -+ ODM_SetBBReg(pDM_Odm, 0xe3c, bMaskDWord, 0x28160200); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ /*LO calibration setting*/ -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x00462911); -+ -+ /*PA, PAD setting*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x66, 0x600, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x66, 0x1E0, 0x3); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8d, 0x1F, 0xf); -+ -+ /*LOK setting added for 8723D*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xee, 0x10, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x64, 0x1, 0x1); -+ -+#if 1 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask, 0xe6d); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask, 0x66d); -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S0 TXIQK = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S0 TXIQK = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); -+ -+ -+ /*enter IQK mode*/ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+ -+#if 1 -+ /*backup Path & GNT value */ -+ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); -+ ODM_delay_ms(1); -+ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); -+ -+ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -+#endif -+ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); -+ ODM_delay_ms(1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S0 TXIQK = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S0 TXIQK = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); -+ -+ /*One shot, Path S1 LOK & IQK*/ -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ /*delay x ms*/ -+ /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ -+ -+ Ktime = 0; -+ while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { -+ ODM_delay_ms(1); -+ Ktime++; -+ } -+ -+#if 1 -+ /*Restore GNT_WL/GNT_BT and Path owner*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -+#endif -+ -+ -+ /*reload RF path*/ -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); -+ -+ /*leave IQK mode*/ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ /*PA/PAD controlled by 0x0*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); -+ -+ /* Check failed*/ -+ regEAC_S0 = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); -+ regE94_S0 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); -+ regE9C_S0 = ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac_s0 = 0x%x\n", regEAC_S0)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94_s0 = 0x%x, 0xe9c_s0 = 0x%x\n", regE94_S0, regE9C_S0)); -+ /*monitor image power before & after IQK*/ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90_s0(before IQK)= 0x%x, 0xe98_s0(afer IQK) = 0x%x\n", -+ ODM_GetBBReg(pDM_Odm, 0xe90, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xe98, bMaskDWord))); -+ -+ if (!(regEAC_S0 & BIT28) && -+ (((regE94_S0 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C_S0 & 0x03FF0000)>>16) != 0x42)) -+ -+ result |= 0x01; -+ else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S0 TXIQK FAIL\n")); -+ -+ return result; -+} -+ -+ -+ -+u1Byte -+phy_PathS0_RxIQK_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN configPathS0 -+ ) -+{ -+ u4Byte regE94, regE9C, regEA4, regEAC, regE94_S0, regE9C_S0, regEA4_S0, regEAC_S0, tmp, u4tmp, Path_SEL_BB; -+ u1Byte result = 0x00, Ktime; -+ u4Byte originalPath, originalGNT; -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ -+ Path_SEL_BB = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 RxIQK Step1!!\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S0 RXIQK1 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x99000280); -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S0 RXIQK1 = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6)));*/ -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x18008c1c); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82160000); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28160000); -+ -+ -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a911); -+ -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xee, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00006); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xa7ffb); -+ -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x66, 0x600, 0x0); -+ -+#if 1 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask, 0xe6d); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask, 0x66d); -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S0 RXIQK1 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S0 RXIQK1 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+ -+#if 1 -+ /*backup Path & GNT value */ -+ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); -+ ODM_delay_ms(1); -+ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); -+ -+ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -+#endif -+ -+ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); -+ ODM_delay_ms(1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S0 RXIQK1 = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S0 RXIQK1 = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); -+ -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ -+ /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ -+ -+ Ktime = 0; -+ while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { -+ ODM_delay_ms(1); -+ Ktime++; -+ } -+ -+ regEAC_S0 = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); -+ regE94_S0 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); -+ regE9C_S0 = ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac_s0 = 0x%x\n", regEAC_S0)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94_s0 = 0x%x, 0xe9c_s0 = 0x%x\n", regE94_S0, regE9C_S0)); -+ /*monitor image power before & after IQK*/ -+ ODM_RT_TRACE(pDM_Odm , ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90_s0(before IQK)= 0x%x, 0xe98_s0(afer IQK) = 0x%x\n", -+ ODM_GetBBReg(pDM_Odm, 0xe90, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xe98, bMaskDWord))); -+ -+ -+ tmp = (regE9C_S0 & 0x03FF0000)>>16; -+ if ((tmp & 0x200) > 0) -+ tmp = 0x400 - tmp; -+ -+ if (!(regEAC_S0 & BIT28) && -+ (((regE94_S0 & 0x03FF0000)>>16) != 0x142) && -+ (((regE9C_S0 & 0x03FF0000)>>16) != 0x42)) -+ -+ result |= 0x01; -+ else { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S0 RXIQK STEP1 FAIL\n")); -+#if 1 -+ /*Restore GNT_WL/GNT_BT and Path owner*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -+#endif -+ -+ /*reload RF path*/ -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); -+ return result; -+ } -+ -+ u4tmp = 0x80007C00 | (regE94_S0&0x3FF0000) | ((regE9C_S0&0x3FF0000) >> 16); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, u4tmp); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe40_s0 = 0x%x u4tmp = 0x%x\n", ODM_GetBBReg(pDM_Odm, rTx_IQK, bMaskDWord), u4tmp)); -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Path S0 RXIQK STEP2!!\n\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S0 RXIQK2 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S0 RXIQK2 = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6)));*/ -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x38008c1c); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x18008c1c); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); -+ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82170000); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28171400); -+ -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a8d1); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xee, 0x80000, 0x1); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00007); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xb3fdb); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S0 RXIQK2 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S0 RXIQK2 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); -+ /*enter IQK mode*/ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+ -+#if 1 -+ /*backup Path & GNT value */ -+ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); -+ ODM_delay_ms(1); -+ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); -+ -+ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -+#endif -+ -+ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); -+ ODM_delay_ms(1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S0 RXIQK2 = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S0 RXIQK2 = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); -+ -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ -+ -+ /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ -+ Ktime = 0; -+ while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { -+ ODM_delay_ms(1); -+ Ktime++; -+ } -+ -+#if 1 -+ /*Restore GNT_WL/GNT_BT and Path owner*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -+#endif -+ -+ /*reload RF path*/ -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); -+ -+ /*leave IQK mode*/ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); -+ -+ regEAC_S0 = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); -+ regEA4_S0 = ODM_GetBBReg(pDM_Odm, rRx_Power_Before_IQK_A_2, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac_s0 = 0x%x\n", regEAC_S0)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea4_s0 = 0x%x, 0xeac_s0 = 0x%x\n", regEA4_S0, regEAC_S0)); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea0_s0(before IQK)= 0x%x, 0xea8_s0(afer IQK) = 0x%x\n", -+ ODM_GetBBReg(pDM_Odm, 0xea0, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xea8, bMaskDWord))); -+ -+ -+ tmp = (regEAC_S0 & 0x03FF0000)>>16; -+ if ((tmp & 0x200) > 0) -+ tmp = 0x400 - tmp; -+ -+ if (!(regEAC_S0 & BIT27) && /*if Tx is OK, check whether Rx is OK*/ -+ (((regEA4_S0 & 0x03FF0000)>>16) != 0x132) && -+ (((regEAC_S0 & 0x03FF0000)>>16) != 0x36) && -+ (((regEA4_S0 & 0x03FF0000)>>16) < 0x11a) && -+ (((regEA4_S0 & 0x03FF0000)>>16) > 0xe6) && -+ (tmp < 0x1a)) -+ result |= 0x02; -+ else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S0 RXIQK STEP2 FAIL\n")); -+ -+ -+ return result; -+} -+ -+ -+VOID -+_PHY_PathS1FillIQKMatrix_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bIQKOK, -+ IN s4Byte result[][8], -+ IN u1Byte final_candidate, -+ IN BOOLEAN bTxOnly -+ ) -+ { -+ u4Byte Oldval_1, X, TX1_A, reg; -+ s4Byte Y, TX1_C; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+#endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 IQ Calibration %s !\n", (bIQKOK) ? "Success" : "Failed")); -+ -+ if (final_candidate == 0xFF) -+ return; -+ -+ else if (bIQKOK) { -+ Oldval_1 = (ODM_GetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord) >> 22) & 0x3FF; -+ -+ X = result[final_candidate][0]; -+ -+ if ((X & 0x00000200) != 0) -+ X = X | 0xFFFFFC00; -+ TX1_A = (X * Oldval_1) >> 8; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX1_A = 0x%x, Oldval_1 0x%x\n", X, TX1_A, Oldval_1)); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, 0x3FF, TX1_A); -+ -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT(31), ((X * Oldval_1 >> 7) & 0x1)); -+ -+ Y = result[final_candidate][1]; -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ -+ TX1_C = (Y * Oldval_1) >> 8; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C)); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, 0xF0000000, ((TX1_C & 0x3C0) >> 6)); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, 0x003F0000, (TX1_C & 0x3F)); -+ -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT(29), ((Y * Oldval_1 >> 7) & 0x1)); -+ -+ if (bTxOnly) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_PHY_PathS1FillIQKMatrix_8723D only Tx OK\n")); -+ return; -+ } -+ reg = result[final_candidate][2]; -+#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -+ if (RTL_ABS(reg , 0x100) >= 16) -+ reg = 0x100; -+#endif -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XARxIQImbalance, 0x3FF, reg); -+ -+ reg = result[final_candidate][3] & 0x3F; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XARxIQImbalance, 0xFC00, reg); -+ -+ reg = (result[final_candidate][3] >> 6) & 0xF; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_RxIQExtAnta, 0xF0000000, reg); -+/* -+10 os 7201 10 -+10 id ea4 [25:16] p -+10 os 7202 10 -+10 od c14 VarFromTmp [9:0] p -+ -+10 os 7201 11 -+10 id eac [25:22] p -+10 os 7202 11 -+10 od ca0 VarFromTmp [31:28] p -+ -+10 os 7201 12 -+10 id eac [21:16] p -+10 os 7202 12 -+10 od c14 VarFromTmp [15:10] p -+*/ -+ } -+ } -+ -+VOID -+_PHY_PathS0FillIQKMatrix_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bIQKOK, -+ IN s4Byte result[][8], -+ IN u1Byte final_candidate, -+ IN BOOLEAN bTxOnly -+ ) -+{ -+ u4Byte Oldval_0, X, TX0_A, reg; -+ s4Byte Y, TX0_C; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 IQ Calibration %s !\n", (bIQKOK)?"Success":"Failed")); -+ -+ if (final_candidate == 0xFF) -+ return; -+ -+ else if (bIQKOK) { -+ Oldval_0 = (ODM_GetBBReg(pDM_Odm, 0xcd4, bMaskDWord) >> 13) & 0x3FF; -+ -+ X = result[final_candidate][4]; -+ if ((X & 0x00000200) != 0) -+ X = X | 0xFFFFFC00; -+ TX0_A = (X * Oldval_0) >> 8; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX0_A = 0x%x, Oldval_0 0x%x\n", X, TX0_A, Oldval_0)); -+ ODM_SetBBReg(pDM_Odm, 0xcd0, 0x7FE, TX0_A); -+ -+ ODM_SetBBReg(pDM_Odm, 0xcd0, BIT(0), ((X * Oldval_0>>7) & 0x1)); -+ -+ Y = result[final_candidate][5]; -+ if ((Y & 0x00000200) != 0) -+ Y = Y | 0xFFFFFC00; -+ -+ TX0_C = (Y * Oldval_0) >> 8; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX0_C = 0x%x\n", Y, TX0_C)); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x7FE, (TX0_C & 0x3FF)); -+ -+ ODM_SetBBReg(pDM_Odm, 0xcd4, BIT(0), ((Y * Oldval_0>>7) & 0x1)); -+ -+ if (bTxOnly) -+ return; -+ -+ reg = result[final_candidate][6]; -+ ODM_SetBBReg(pDM_Odm, 0xcd8, 0x3FF, reg); -+ -+ reg = result[final_candidate][7]; -+ ODM_SetBBReg(pDM_Odm, 0xcd8, 0x003FF000, reg); -+/* -+10 os 7201 10 -+10 id ea4 [25:16] p -+10 os 7202 10 -+10 od cd8 VarFromTmp [9:0] p -+ -+10 os 7201 11 -+10 id eac [25:16] p -+10 os 7202 11 -+10 od cd8 VarFromTmp [21:12] p -+ RegE94_S1 = result[i][0]; -+ RegE9C_S1 = result[i][1]; -+ RegEA4_S1 = result[i][2]; -+ RegEAC_S1 = result[i][3]; -+ RegE94_S0 = result[i][4]; -+ RegE9C_S0 = result[i][5]; -+ RegEA4_S0 = result[i][6]; -+ RegEAC_S0 = result[i][7]; -+*/ -+ } -+} -+// 2011/07/26 MH Add an API for testing IQK fail case. -+// -+// MP Already declare in odm.c -+#if !(DM_ODM_SUPPORT_TYPE & ODM_WIN) -+BOOLEAN -+ODM_CheckPowerStatus( -+ IN PADAPTER Adapter) -+{ -+/* -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ RT_RF_POWER_STATE rtState; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ -+ // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. -+ if (pMgntInfo->init_adpt_in_progress == TRUE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter")); -+ return TRUE; -+ } -+ -+ // -+ // 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. -+ // -+ Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState)); -+ if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n", -+ Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState)); -+ return FALSE; -+ } -+*/ -+ return TRUE; -+} -+#endif -+ -+VOID -+_PHY_SaveADDARegisters_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte ADDAReg, -+ IN pu4Byte ADDABackup, -+ IN u4Byte RegisterNum -+ ) -+{ -+ u4Byte i; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+ -+ if (ODM_CheckPowerStatus(pAdapter) == FALSE) -+ return; -+#endif -+ -+ -+ for (i = 0 ; i < RegisterNum ; i++) { -+ ADDABackup[i] = ODM_GetBBReg(pDM_Odm, ADDAReg[i], bMaskDWord); -+ } -+} -+ -+ -+VOID -+_PHY_SaveMACRegisters_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte MACReg, -+ IN pu4Byte MACBackup -+ ) -+{ -+ u4Byte i; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ -+ for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) { -+ MACBackup[i] = ODM_Read1Byte(pDM_Odm, MACReg[i]); -+ } -+ MACBackup[i] = ODM_Read4Byte(pDM_Odm, MACReg[i]); -+ -+} -+ -+ -+VOID -+_PHY_ReloadADDARegisters_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte ADDAReg, -+ IN pu4Byte ADDABackup, -+ IN u4Byte RegiesterNum -+ ) -+{ -+ u4Byte i; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Reload ADDA power saving parameters !\n")); -+ for (i = 0 ; i < RegiesterNum; i++) { -+ ODM_SetBBReg(pDM_Odm, ADDAReg[i], bMaskDWord, ADDABackup[i]); -+ } -+} -+ -+VOID -+_PHY_ReloadMACRegisters_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte MACReg, -+ IN pu4Byte MACBackup -+ ) -+{ -+ u4Byte i; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Reload MAC parameters !\n")); -+ for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) { -+ ODM_Write1Byte(pDM_Odm, MACReg[i], (u1Byte)MACBackup[i]); -+ } -+ ODM_Write4Byte(pDM_Odm, MACReg[i], MACBackup[i]); -+} -+ -+ -+VOID -+_PHY_PathADDAOn_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte ADDAReg, -+ IN BOOLEAN isPathAOn, -+ IN BOOLEAN is2T -+ ) -+{ -+ u4Byte pathOn; -+ u4Byte i; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ -+ -+ pathOn = isPathAOn ? 0x03c00016 : 0x03c00016; -+ -+ if (FALSE == is2T) { -+ pathOn = 0x03c00016; -+ ODM_SetBBReg(pDM_Odm, ADDAReg[0], bMaskDWord, 0x03c00016); -+ } else { -+ ODM_SetBBReg(pDM_Odm, ADDAReg[0], bMaskDWord, pathOn); -+ } -+ -+ for (i = 1 ; i < IQK_ADDA_REG_NUM ; i++) { -+ ODM_SetBBReg(pDM_Odm,ADDAReg[i], bMaskDWord, pathOn); -+ } -+ -+} -+ -+VOID -+_PHY_MACSettingCalibration_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte MACReg, -+ IN pu4Byte MACBackup -+ ) -+{ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ -+/* -+ ODM_Write1Byte(pDM_Odm, MACReg[i], 0x3F); -+ -+ for(i = 1 ; i < (IQK_MAC_REG_NUM - 1); i++){ -+ ODM_Write1Byte(pDM_Odm, MACReg[i], (u1Byte)(MACBackup[i]&(~BIT3))); -+ } -+ ODM_Write1Byte(pDM_Odm, MACReg[i], (u1Byte)(MACBackup[i]&(~BIT5))); -+*/ -+ -+ /*ODM_SetBBReg(pDM_Odm, 0x522, bMaskByte0, 0x7f);*/ -+ /*ODM_SetBBReg(pDM_Odm, 0x550, bMaskByte0, 0x15);*/ -+ /*ODM_SetBBReg(pDM_Odm, 0x551, bMaskByte0, 0x00);*/ -+ -+ ODM_SetBBReg(pDM_Odm, 0x520, 0x00ff0000, 0xff); -+ -+ -+ -+} -+ -+VOID -+_PHY_PathAStandBy_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER pAdapter -+#endif -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-S1 standby mode!\n")); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+/* ODM_SetBBReg(pDM_Odm, 0x840, bMaskDWord, 0x00010000);*/ -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)0x0, 0x0, bRFRegOffsetMask, 0x10000); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+} -+ -+VOID -+_PHY_PathBStandBy_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER pAdapter -+#endif -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-S0 standby mode!\n")); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)0x1, 0x0, bRFRegOffsetMask, 0x10000); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+} -+ -+ -+VOID -+_PHY_PIModeSwitch_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN PIMode -+ ) -+{ -+ u4Byte mode; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ -+ -+ mode = PIMode ? 0x01000100 : 0x01000000; -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_HSSIParameter1, bMaskDWord, mode); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_HSSIParameter1, bMaskDWord, mode); -+} -+ -+BOOLEAN -+phy_SimularityCompare_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN s4Byte result[][8], -+ IN u1Byte c1, -+ IN u1Byte c2 -+ ) -+{ -+ u4Byte i, j, diff, SimularityBitMap, bound = 0; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ u1Byte final_candidate[2] = {0xFF, 0xFF}; -+ BOOLEAN bResult = TRUE; -+/*#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+// BOOLEAN is2T = IS_92C_SERIAL( pHalData->VersionID); -+//#else*/ -+ BOOLEAN is2T = TRUE; -+/*#endif*/ -+ -+ s4Byte tmp1 = 0,tmp2 = 0; -+ -+ if (is2T) -+ bound = 8; -+ else -+ bound = 4; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> IQK:phy_SimularityCompare_8723D c1 %d c2 %d!!!\n", c1, c2)); -+ -+ -+ SimularityBitMap = 0; -+ -+ for (i = 0; i < bound; i++) { -+ -+ if ((i == 1) || (i == 3) || (i == 5) || (i == 7)) { -+ if ((result[c1][i] & 0x00000200) != 0) -+ tmp1 = result[c1][i] | 0xFFFFFC00; -+ else -+ tmp1 = result[c1][i]; -+ -+ if ((result[c2][i] & 0x00000200) != 0) -+ tmp2 = result[c2][i] | 0xFFFFFC00; -+ else -+ tmp2 = result[c2][i]; -+ } else { -+ tmp1 = result[c1][i]; -+ tmp2 = result[c2][i]; -+ } -+ -+ diff = (tmp1 > tmp2) ? (tmp1 - tmp2) : (tmp2 - tmp1); -+ -+ if (diff > MAX_TOLERANCE) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:differnece overflow %d index %d compare1 0x%x compare2 0x%x!!!\n", diff, i, result[c1][i], result[c2][i])); -+ -+ if ((i == 2 || i == 6) && !SimularityBitMap) { -+ if (result[c1][i]+result[c1][i+1] == 0) -+ final_candidate[(i/4)] = c2; -+ else if (result[c2][i]+result[c2][i+1] == 0) -+ final_candidate[(i/4)] = c1; -+ else -+ SimularityBitMap = SimularityBitMap|(1<odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ u4Byte i; -+ u1Byte PathS1_OK, PathS0_OK; -+ u1Byte tmp0xc50 = (u1Byte)ODM_GetBBReg(pDM_Odm, 0xC50, bMaskByte0); -+ u1Byte tmp0xc58 = (u1Byte)ODM_GetBBReg(pDM_Odm, 0xC58, bMaskByte0); -+ u4Byte ADDA_REG[IQK_ADDA_REG_NUM] = { -+ rFPGA0_XCD_SwitchControl, rBlue_Tooth, -+ rRx_Wait_CCA, rTx_CCK_RFON, -+ rTx_CCK_BBON, rTx_OFDM_RFON, -+ rTx_OFDM_BBON, rTx_To_Rx, -+ rTx_To_Tx, rRx_CCK, -+ rRx_OFDM, rRx_Wait_RIFS, -+ rRx_TO_Rx, rStandby, -+ rSleep, rPMPD_ANAEN }; -+ u4Byte IQK_MAC_REG[IQK_MAC_REG_NUM] = { -+ REG_TXPAUSE, REG_BCN_CTRL, -+ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; -+ -+ -+ u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { -+ rOFDM0_TRxPathEnable, rOFDM0_TRMuxPar, -+ rFPGA0_XCD_RFInterfaceSW, rConfig_AntA, rConfig_AntB, -+ rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, -+ rFPGA0_XB_RFInterfaceOE, rCCK0_AFESetting -+ }; -+ u4Byte cnt_IQKFail = 0; -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+ u4Byte retryCount = 2; -+#else -+#if MP_DRIVER -+ const u4Byte retryCount = 9; -+#else -+ const u4Byte retryCount = 2; -+#endif -+#endif -+ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -+#ifdef MP_TEST -+ if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) -+ retryCount = 9; -+#endif -+#endif -+ -+ -+ if (t == 0) { -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_SaveADDARegisters_8723D(pAdapter, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); -+ _PHY_SaveMACRegisters_8723D(pAdapter, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); -+ _PHY_SaveADDARegisters_8723D(pAdapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); -+#else -+ _PHY_SaveADDARegisters_8723D(pDM_Odm, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); -+ _PHY_SaveMACRegisters_8723D(pDM_Odm, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); -+ _PHY_SaveADDARegisters_8723D(pDM_Odm, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); -+#endif -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQ Calibration for 1T1R_S0/S1 for %d times\n", t)); -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ _PHY_PathADDAOn_8723D(pAdapter, ADDA_REG, TRUE, is2T); -+#else -+ _PHY_PathADDAOn_8723D(pDM_Odm, ADDA_REG, TRUE, is2T); -+#endif -+ -+ -+/* -+ if(t==0) -+ { -+ pDM_Odm->RFCalibrateInfo.bRfPiEnable = (u1Byte)ODM_GetBBReg(pDM_Odm, rFPGA0_XA_HSSIParameter1, BIT(8)); -+ } -+ -+ if(!pDM_Odm->RFCalibrateInfo.bRfPiEnable){ -+ // Switch BB to PI mode to do IQ Calibration. -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_PIModeSwitch_8723D(pAdapter, TRUE); -+#else -+ _PHY_PIModeSwitch_8723D(pDM_Odm, TRUE); -+#endif -+ } -+*/ -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_MACSettingCalibration_8723D(pAdapter, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); -+#else -+ _PHY_MACSettingCalibration_8723D(pDM_Odm, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); -+#endif -+ -+ /*BB setting*/ -+ /*ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 0x00);*/ -+ ODM_SetBBReg(pDM_Odm, rCCK0_AFESetting, 0x0f000000, 0xf); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_TRxPathEnable, bMaskDWord, 0x03a05611); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, 0x000800e4); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x25204200); -+ -+ /*IQ calibration setting*/ -+ /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK setting!\n")); */ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); -+ -+if (is2T) { -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_PathBStandBy_8723D(pAdapter); -+ -+ -+ _PHY_PathADDAOn_8723D(pAdapter, ADDA_REG, FALSE, is2T); -+#else -+ _PHY_PathBStandBy_8723D(pDM_Odm); -+ -+ -+ _PHY_PathADDAOn_8723D(pDM_Odm, ADDA_REG, FALSE, is2T); -+#endif -+ } -+ -+ -+#if 1 -+ for (i = 0 ; i < retryCount ; i++) { -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PathS1_OK = phy_PathS1_IQK_8723D(pAdapter, is2T); -+#else -+ PathS1_OK = phy_PathS1_IQK_8723D(pDM_Odm, is2T); -+#endif -+ -+ if (PathS1_OK == 0x01) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 Tx IQK Success!!\n")); -+ result[t][0] = (ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ result[t][1] = (ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ break; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 Tx IQK Fail!!\n")); -+ result[t][0] = 0x100; -+ result[t][1] = 0x0; -+ cnt_IQKFail++; -+ } -+#if 0 -+ else if (i == (retryCount-1) && PathS1_OK == 0x01) -+ { -+ RT_DISP(FINIT, INIT_IQK, ("Path S1 IQK Only Tx Success!!\n")); -+ -+ result[t][0] = (ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ result[t][1] = (ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; -+ } -+#endif -+ } -+#endif -+ -+ -+#if 1 -+ for (i = 0 ; i < retryCount ; i++) { -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PathS1_OK = phy_PathS1_RxIQK_8723D(pAdapter, is2T); -+#else -+ PathS1_OK = phy_PathS1_RxIQK_8723D(pDM_Odm, is2T); -+#endif -+ if (PathS1_OK == 0x03) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 Rx IQK Success!!\n")); -+ result[t][2] = (ODM_GetBBReg(pDM_Odm, rRx_Power_Before_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; -+ result[t][3] = (ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; -+ break; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 Rx IQK Fail!!\n")); -+ result[t][2] = 0x100; -+ result[t][3] = 0x0; -+ cnt_IQKFail++; -+ } -+ } -+ -+ if (0x00 == PathS1_OK) { -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 IQK failed!!\n")); -+ } -+ -+#endif -+ -+ if (is2T) { -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_PathAStandBy_8723D(pAdapter); -+ -+ -+ _PHY_PathADDAOn_8723D(pAdapter, ADDA_REG, FALSE, is2T); -+#else -+ _PHY_PathAStandBy_8723D(pDM_Odm); -+ -+ -+ _PHY_PathADDAOn_8723D(pDM_Odm, ADDA_REG, FALSE, is2T); -+#endif -+ -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); -+ -+ -+#if 1 -+ for (i = 0 ; i < retryCount ; i++) { -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PathS0_OK = phy_PathS0_IQK_8723D(pAdapter); -+#else -+ PathS0_OK = phy_PathS0_IQK_8723D(pDM_Odm); -+#endif -+ -+ if (PathS0_OK == 0x01) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 Tx IQK Success!!\n")); -+ result[t][4] = (ODM_GetBBReg(pDM_Odm, 0xe94, bMaskDWord)&0x3FF0000)>>16; -+ result[t][5] = (ODM_GetBBReg(pDM_Odm, 0xe9c, bMaskDWord)&0x3FF0000)>>16; -+ break; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 Tx IQK Fail!!\n")); -+ result[t][4] = 0x100; -+ result[t][5] = 0x0; -+ cnt_IQKFail++; -+ } -+#if 0 -+ else if (i == (retryCount-1) && PathS1_OK == 0x01) -+ { -+ RT_DISP(FINIT, INIT_IQK, ("Path S0 IQK Only Tx Success!!\n")); -+ -+ result[t][0] = (ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_B, bMaskDWord)&0x3FF0000)>>16; -+ result[t][1] = (ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_B, bMaskDWord)&0x3FF0000)>>16; -+ } -+#endif -+ } -+#endif -+ -+ -+#if 1 -+ -+for (i = 0 ; i < retryCount ; i++) { -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PathS0_OK = phy_PathS0_RxIQK_8723D(pAdapter, is2T); -+#else -+ PathS0_OK = phy_PathS0_RxIQK_8723D(pDM_Odm, is2T); -+#endif -+ if (PathS0_OK == 0x03) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 Rx IQK Success!!\n")); -+/* result[t][0] = (ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16;*/ -+/* result[t][1] = (ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16;*/ -+ result[t][6] = (ODM_GetBBReg(pDM_Odm, 0xea4, bMaskDWord)&0x3FF0000)>>16; -+ result[t][7] = (ODM_GetBBReg(pDM_Odm, 0xeac, bMaskDWord)&0x3FF0000)>>16; -+ break; -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 Rx IQK Fail!!\n")); -+ result[t][6] = 0x100; -+ result[t][7] = 0x0; -+ cnt_IQKFail++; -+ } -+ } -+ -+ -+ -+ if (0x00 == PathS0_OK) -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 IQK failed!!\n")); -+ -+#endif -+ } -+ -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Back to BB mode, load original value!\n")); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ -+ if (t != 0) { -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ -+ _PHY_ReloadADDARegisters_8723D(pAdapter, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); -+ -+ /* Reload MAC parameters*/ -+ _PHY_ReloadMACRegisters_8723D(pAdapter, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); -+ -+ _PHY_ReloadADDARegisters_8723D(pAdapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); -+#else -+ -+ _PHY_ReloadADDARegisters_8723D(pDM_Odm, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); -+ -+ /* Reload MAC parameters*/ -+ _PHY_ReloadMACRegisters_8723D(pDM_Odm, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); -+ -+ _PHY_ReloadADDARegisters_8723D(pDM_Odm, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); -+#endif -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0xc50, bMaskByte0, 0x50); -+ ODM_SetBBReg(pDM_Odm, 0xc50, bMaskByte0, tmp0xc50); -+ if (is2T) { -+ ODM_SetBBReg(pDM_Odm, 0xc58, bMaskByte0, 0x50); -+ ODM_SetBBReg(pDM_Odm, 0xc58, bMaskByte0, tmp0xc58); -+ } -+ -+ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ -+ -+ } -+ -+ pDM_Odm->nIQK_Cnt++; -+ -+ if (cnt_IQKFail == 0) -+ pDM_Odm->nIQK_OK_Cnt++; -+ else -+ pDM_Odm->nIQK_Fail_Cnt = pDM_Odm->nIQK_Fail_Cnt + cnt_IQKFail; -+ -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_IQCalibrate_8723D() <==\n")); -+ -+} -+ -+ -+VOID -+phy_LCCalibrate_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PVOID pDM_VOID, -+#else -+ IN PDM_ODM_T pDM_Odm, -+#endif -+ IN BOOLEAN is2T -+ ) -+{ -+ u1Byte tmpReg; -+ u4Byte RF_Amode=0, RF_Bmode=0, LC_Cal, cnt; -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+#endif -+ -+ -+ tmpReg = ODM_Read1Byte(pDM_Odm, 0xd03); -+ -+ if ((tmpReg & 0x70) != 0) -+ ODM_Write1Byte(pDM_Odm, 0xd03, tmpReg & 0x8F); -+ else -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF); -+ -+ /*backup RF0x18*/ -+ -+ LC_Cal = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); -+ -+ -+ /*Start LCK*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal | 0x08000); -+ -+ for (cnt = 0; cnt < 100; cnt++) { -+ if (ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, 0x8000) != 0x1) -+ break; -+ ODM_delay_ms(10); -+ } -+ -+ /* Recover channel number*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal); -+ -+ /*Restore original situation*/ -+ if ((tmpReg & 0x70) != 0) -+ ODM_Write1Byte(pDM_Odm, 0xd03, tmpReg); -+ else -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x00); -+} -+ -+ -+#define APK_BB_REG_NUM 8 -+#define APK_CURVE_REG_NUM 4 -+#define PATH_NUM 2 -+ -+VOID -+phy_APCalibrate_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN s1Byte delta, -+ IN BOOLEAN is2T -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ u4Byte regD[PATH_NUM]; -+ u4Byte tmpReg, index, offset, apkbound; -+ u1Byte path, i, pathbound = PATH_NUM; -+ u4Byte BB_backup[APK_BB_REG_NUM]; -+ u4Byte BB_REG[APK_BB_REG_NUM] = { -+ rFPGA1_TxBlock, rOFDM0_TRxPathEnable, -+ rFPGA0_RFMOD, rOFDM0_TRMuxPar, -+ rFPGA0_XCD_RFInterfaceSW, rFPGA0_XAB_RFInterfaceSW, -+ rFPGA0_XA_RFInterfaceOE, rFPGA0_XB_RFInterfaceOE }; -+ u4Byte BB_AP_MODE[APK_BB_REG_NUM] = { -+ 0x00000020, 0x00a05430, 0x02040000, -+ 0x000800e4, 0x00204000 }; -+ u4Byte BB_normal_AP_MODE[APK_BB_REG_NUM] = { -+ 0x00000020, 0x00a05430, 0x02040000, -+ 0x000800e4, 0x22204000 }; -+ -+ u4Byte AFE_backup[IQK_ADDA_REG_NUM]; -+ u4Byte AFE_REG[IQK_ADDA_REG_NUM] = { -+ rFPGA0_XCD_SwitchControl, rBlue_Tooth, -+ rRx_Wait_CCA, rTx_CCK_RFON, -+ rTx_CCK_BBON, rTx_OFDM_RFON, -+ rTx_OFDM_BBON, rTx_To_Rx, -+ rTx_To_Tx, rRx_CCK, -+ rRx_OFDM, rRx_Wait_RIFS, -+ rRx_TO_Rx, rStandby, -+ rSleep, rPMPD_ANAEN }; -+ -+ u4Byte MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte MAC_REG[IQK_MAC_REG_NUM] = { -+ REG_TXPAUSE, REG_BCN_CTRL, -+ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; -+ -+ u4Byte APK_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c}, -+ {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e} -+ }; -+ -+ u4Byte APK_normal_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x0852c, 0x0a52c, 0x3a52c, 0x5a52c, 0x5a52c}, -+ {0x0852c, 0x0a52c, 0x5a52c, 0x5a52c, 0x5a52c} -+ }; -+ -+ u4Byte APK_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d}, -+ {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050} -+ }; -+ -+ u4Byte APK_normal_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { -+ {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a}, -+ {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a} -+ }; -+ -+ u4Byte AFE_on_off[PATH_NUM] = { -+ 0x04db25a4, 0x0b1b25a4}; -+ -+ u4Byte APK_offset[PATH_NUM] = { -+ rConfig_AntA, rConfig_AntB}; -+ -+ u4Byte APK_normal_offset[PATH_NUM] = { -+ rConfig_Pmpd_AntA, rConfig_Pmpd_AntB}; -+ -+ u4Byte APK_value[PATH_NUM] = { -+ 0x92fc0000, 0x12fc0000}; -+ -+ u4Byte APK_normal_value[PATH_NUM] = { -+ 0x92680000, 0x12680000}; -+ -+ s1Byte APK_delta_mapping[APK_BB_REG_NUM][13] = { -+ {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-6, -4, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-1, -1, -1, -1, -1, -1, 0, 1, 2, 3, 4, 5, 6}, -+ {-11, -9, -7, -5, -3, -1, 0, 0, 0, 0, 0, 0, 0} -+ }; -+ -+ u4Byte APK_normal_setting_value_1[13] = { -+ 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28, -+ 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3, -+ 0x12680000, 0x00880000, 0x00880000 -+ }; -+ -+ u4Byte APK_normal_setting_value_2[16] = { -+ 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3, -+ 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025, -+ 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008, -+ 0x00050006 -+ }; -+ -+ u4Byte APK_result[PATH_NUM][APK_BB_REG_NUM]; -+/* u4Byte AP_curve[PATH_NUM][APK_CURVE_REG_NUM];*/ -+ -+ s4Byte BB_offset, delta_V, delta_offset; -+ -+#if MP_DRIVER == 1 -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+#else -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+#endif -+ pMptCtx->APK_bound[0] = 45; -+ pMptCtx->APK_bound[1] = 52; -+ -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>phy_APCalibrate_8723D() delta %d\n", delta)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("AP Calibration for %s\n", (is2T ? "2T2R" : "1T1R"))); -+ if (!is2T) -+ pathbound = 1; -+ -+ -+ -+/* Temporarily do not allow normal driver to do the following settings because these offset -+// and value will cause RF internal PA to be unpredictably disabled by HW, such that RF Tx signal -+// will disappear after disable/enable card many times on 88CU. RF SD and DD have not find the -+// root cause, so we remove these actions temporarily. Added by tynli and SD3 Allen. 2010.05.31.*/ -+#if MP_DRIVER != 1 -+ return; -+#endif -+ -+ for (index = 0; index < PATH_NUM; index++) { -+ APK_offset[index] = APK_normal_offset[index]; -+ APK_value[index] = APK_normal_value[index]; -+ AFE_on_off[index] = 0x6fdb25a4; -+ } -+ -+ for (index = 0; index < APK_BB_REG_NUM; index++) { -+ for (path = 0; path < pathbound; path++) { -+ APK_RF_init_value[path][index] = APK_normal_RF_init_value[path][index]; -+ APK_RF_value_0[path][index] = APK_normal_RF_value_0[path][index]; -+ } -+ BB_AP_MODE[index] = BB_normal_AP_MODE[index]; -+ } -+ -+ apkbound = 6; -+ -+ -+ for (index = 0; index < APK_BB_REG_NUM ; index++) { -+ if (index == 0) -+ continue; -+ BB_backup[index] = ODM_GetBBReg(pDM_Odm, BB_REG[index], bMaskDWord); -+ } -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_SaveMACRegisters_8723D(pAdapter, MAC_REG, MAC_backup); -+ -+ -+ _PHY_SaveADDARegisters_8723D(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+#else -+ _PHY_SaveMACRegisters_8723D(pDM_Odm, MAC_REG, MAC_backup); -+ -+ -+ _PHY_SaveADDARegisters_8723D(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+#endif -+ -+ for (path = 0; path < pathbound; path++) { -+ -+ -+ if (path == ODM_RF_PATH_A) { -+ -+ offset = rPdp_AntA; -+ for (index = 0; index < 11; index++) { -+ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); -+ -+ offset = rConfig_AntA; -+ for (; index < 13; index++) { -+ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); -+ -+ -+ offset = rPdp_AntA; -+ for (index = 0; index < 16; index++) { -+ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_2[index]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ } else if (path == ODM_RF_PATH_B) { -+ -+ offset = rPdp_AntB; -+ for (index = 0; index < 10; index++) { -+ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x12680000); -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); -+#else -+ PHY_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); -+#endif -+ -+ offset = rConfig_AntA; -+ index = 11; -+ for (; index < 13; index++) { -+ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); -+ -+ -+ offset = 0xb60; -+ for (index = 0; index < 16; index++) { -+ ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_2[index]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); -+ -+ offset += 0x04; -+ } -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ } -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ regD[path] = PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bMaskDWord); -+#else -+ regD[path] = ODM_GetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord); -+#endif -+ -+ -+ for (index = 0; index < IQK_ADDA_REG_NUM ; index++) -+ ODM_SetBBReg(pDM_Odm, AFE_REG[index], bMaskDWord, AFE_on_off[path]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xe70 %x\n", ODM_GetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord))); -+ -+ -+ if (path == 0) { -+ for (index = 0; index < APK_BB_REG_NUM ; index++) { -+ -+ if (index == 0) -+ continue; -+ else if (index < 5) -+ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_AP_MODE[index]); -+ else if (BB_REG[index] == 0x870) -+ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_backup[index]|BIT10|BIT26); -+ else -+ ODM_SetBBReg(pDM_Odm, BB_REG[index], BIT10, 0x0); -+ } -+ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ } else { -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x01008c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x01008c00); -+ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x800 %x\n", ODM_GetBBReg(pDM_Odm, 0x800, bMaskDWord))); -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_MACSettingCalibration_8723D(pAdapter, MAC_REG, MAC_backup); -+#else -+ _PHY_MACSettingCalibration_8723D(pDM_Odm, MAC_REG, MAC_backup); -+#endif -+ -+ if (path == ODM_RF_PATH_A) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bMaskDWord, 0x10000); -+ } else { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bMaskDWord, 0x10000); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE1, bMaskDWord, 0x1000f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE2, bMaskDWord, 0x20103); -+ } -+ -+ delta_offset = ((delta+14)/2); -+ if (delta_offset < 0) -+ delta_offset = 0; -+ else if (delta_offset > 12) -+ delta_offset = 12; -+ -+ -+ for (index = 0; index < APK_BB_REG_NUM; index++) { -+ if (index != 1) -+ continue; -+ -+ tmpReg = APK_RF_init_value[path][index]; -+#if 1 -+ if (!pDM_Odm->RFCalibrateInfo.bAPKThermalMeterIgnore) { -+ BB_offset = (tmpReg & 0xF0000) >> 16; -+ -+ if (!(tmpReg & BIT15)) { -+ BB_offset = -BB_offset; -+ } -+ -+ delta_V = APK_delta_mapping[index][delta_offset]; -+ -+ BB_offset += delta_V; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() APK index %d tmpReg 0x%x delta_V %d delta_offset %d\n", index, tmpReg, delta_V, delta_offset)); -+ -+ if (BB_offset < 0) { -+ tmpReg = tmpReg & (~BIT15); -+ BB_offset = -BB_offset; -+ } else { -+ tmpReg = tmpReg | BIT15; -+ } -+ tmpReg = (tmpReg & 0xFFF0FFFF) | (BB_offset << 16); -+ } -+#endif -+ -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, RF_IPA_A, bMaskDWord, 0x8992e); -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xc %x\n", PHY_QueryRFReg(pAdapter, path, RF_IPA_A, bMaskDWord))); -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, RF_AC, bMaskDWord, APK_RF_value_0[path][index]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x0 %x\n", PHY_QueryRFReg(pAdapter, path, RF_AC, bMaskDWord))); -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, RF_TXBIAS_A, bMaskDWord, tmpReg); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xd %x\n", PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bMaskDWord))); -+#else -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xc %x\n", ODM_GetRFReg(pDM_Odm, path, RF_IPA_A, bMaskDWord))); -+ ODM_SetRFReg(pDM_Odm, path, RF_AC, bMaskDWord, APK_RF_value_0[path][index]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x0 %x\n", ODM_GetRFReg(pDM_Odm, path, RF_AC, bMaskDWord))); -+ ODM_SetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord, tmpReg); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xd %x\n", ODM_GetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord))); -+#endif -+ -+ -+ i = 0; -+ do -+ { -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x800000); -+ { -+ ODM_SetBBReg(pDM_Odm, APK_offset[path], bMaskDWord, APK_value[0]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", APK_offset[path], ODM_GetBBReg(pDM_Odm, APK_offset[path], bMaskDWord))); -+ ODM_delay_ms(3); -+ ODM_SetBBReg(pDM_Odm, APK_offset[path], bMaskDWord, APK_value[1]); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", APK_offset[path], ODM_GetBBReg(pDM_Odm, APK_offset[path], bMaskDWord))); -+ -+ ODM_delay_ms(20); -+ } -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ -+ if (path == ODM_RF_PATH_A) -+ tmpReg = ODM_GetBBReg(pDM_Odm, rAPK, 0x03E00000); -+ else -+ tmpReg = ODM_GetBBReg(pDM_Odm, rAPK, 0xF8000000); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xbd8[25:21] %x\n", tmpReg)); -+ -+ -+ i++; -+ } -+ while(tmpReg > apkbound && i < 4); -+ -+ APK_result[path][index] = tmpReg; -+ } -+ } -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_ReloadMACRegisters_8723D(pAdapter, MAC_REG, MAC_backup); -+#else -+ _PHY_ReloadMACRegisters_8723D(pDM_Odm, MAC_REG, MAC_backup); -+#endif -+ -+ -+ for (index = 0; index < APK_BB_REG_NUM ; index++) { -+ -+ if (index == 0) -+ continue; -+ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_backup[index]); -+ } -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_ReloadADDARegisters_8723D(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+#else -+ _PHY_ReloadADDARegisters_8723D(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+#endif -+ -+ -+ for (path = 0; path < pathbound; path++) -+ { -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, 0xd, bMaskDWord, regD[path]); -+ if (path == ODM_RF_PATH_B) { -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE1, bMaskDWord, 0x1000f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE2, bMaskDWord, 0x20101); -+ } -+ -+ -+ if (APK_result[path][1] > 6) -+ APK_result[path][1] = 6; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("apk path %d result %d 0x%x \t", path, 1, APK_result[path][1])); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\n")); -+ -+ -+ for (path = 0; path < pathbound; path++) { -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, 0x3, bMaskDWord, -+ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (APK_result[path][1] << 5) | APK_result[path][1])); -+ if (path == ODM_RF_PATH_A) -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, 0x4, bMaskDWord, -+ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x00 << 5) | 0x05)); -+ else -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, 0x4, bMaskDWord, -+ ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x02 << 5) | 0x05)); -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ if (!IS_HARDWARE_TYPE_8723A(pAdapter)) -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, RF_BS_PA_APSET_G9_G11, bMaskDWord, -+ ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) | 0x08)); -+#endif -+ } -+ -+ pDM_Odm->RFCalibrateInfo.bAPKdone = TRUE; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==phy_APCalibrate_8723D()\n")); -+} -+ -+ -+ -+#define DP_BB_REG_NUM 7 -+#define DP_RF_REG_NUM 1 -+#define DP_RETRY_LIMIT 10 -+#define DP_PATH_NUM 2 -+#define DP_DPK_NUM 3 -+#define DP_DPK_VALUE_NUM 2 -+ -+ -+ -+ -+ -+VOID -+PHY_IQCalibrate_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bReCovery -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #else -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ -+ #if (MP_DRIVER == 1) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+ #else -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ #endif -+ #endif -+#endif -+ -+ -+ u1Byte u1bTmp; -+ u2Byte count = 0; -+ s4Byte result[4][8]; -+ u1Byte i, final_candidate, Indexforchannel; -+ BOOLEAN bPathS1_OK, bPathS0_OK; -+ s4Byte RegE94_S1, RegE9C_S1, RegEA4_S1, RegEAC_S1, RegE94_S0, RegE9C_S0, RegEA4_S0, RegEAC_S0, RegTmp = 0; -+ s4Byte RegC80, RegC94, RegC14, RegCA0, RegCd0, RegCd4, RegCd8; -+ BOOLEAN is12simular, is13simular, is23simular; -+ BOOLEAN bSingleTone = FALSE, bCarrierSuppression = FALSE, bContinousTx = FALSE; -+ u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { -+ rOFDM0_XARxIQImbalance, rOFDM0_XBRxIQImbalance, -+ rOFDM0_ECCAThreshold, rOFDM0_AGCRSSITable, -+ rOFDM0_XATxIQImbalance, rOFDM0_XBTxIQImbalance, -+ rOFDM0_XCTxAFE, rOFDM0_XDTxAFE, -+ rOFDM0_RxIQExtAnta}; -+ u4Byte Path_SEL_BB_phyIQK; -+ u4Byte originalPath, originalGNT, oriPathCtrl; -+#if 1 -+ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("================ IQK Start ===================\n")); -+ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE) ) -+ if (ODM_CheckPowerStatus(pAdapter) == FALSE) -+ return; -+#else -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+#ifdef MP_TEST -+ if (priv->pshare->rf_ft_var.mp_specific) { -+ if ((OPMODE & WIFI_MP_CTX_PACKET) || (OPMODE & WIFI_MP_CTX_ST)) -+ return; -+ } -+#endif -+ -+ if (priv->pshare->IQK_88E_done) -+ bReCovery= 1; -+ priv->pshare->IQK_88E_done = 1; -+ -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) { -+ return; -+ } -+#endif -+ -+ -+#if MP_DRIVER == 1 -+ -+/*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -+ /* Add to determine IQK ON/OFF in certain case, Suggested by Cheng.*/ -+ /* if (!pHalData->IQK_MP_Switch) -+ return;*/ -+/*#endif*/ -+ -+ bSingleTone = pMptCtx->bSingleTone; -+ bCarrierSuppression = pMptCtx->bCarrierSuppression; -+ bContinousTx = pMptCtx->bStartContTx; -+#endif -+ -+ /* 20120213 Turn on when continuous Tx to pass lab testing. (required by Edlu)*/ -+ if (bSingleTone || bCarrierSuppression || bContinousTx) -+ return; -+ -+ -+ -+#if DISABLE_BB_RF -+ return; -+#endif -+ -+ if (pDM_Odm->RFCalibrateInfo.bIQKInProgress) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("=====>PHY_IQCalibrate_8723D\n")); -+ -+ -+ Path_SEL_BB_phyIQK = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) -+ if (bReCovery) -+#else -+ if (bReCovery && (!pAdapter->bInHctTest)) -+#endif -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("PHY_IQCalibrate_8723D: Return due to bReCovery!\n")); -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_ReloadADDARegisters_8723D(pAdapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, 9); -+#else -+ _PHY_ReloadADDARegisters_8723D(pDM_Odm, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, 9); -+#endif -+ return; -+ } -+ -+ /*Check & wait if BT is doing IQK*/ -+ -+ if (pDM_Odm->mp_mode == FALSE) { -+#if MP_DRIVER != 1 -+ SetFwWiFiCalibrationCmd_8723D(pAdapter, 1); -+ -+ -+ count = 0; -+ u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e6); -+ while (u1bTmp != 0x1 && count < 1000) { -+ PlatformStallExecution(10); -+ u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e6); -+ count++; -+ } -+ if (count >= 1000) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]Polling 0x1e6 to 1 for WiFi calibration H2C cmd FAIL! count(%d)", count)); -+ } -+ -+ -+ u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e7); -+ while ((!(u1bTmp&BIT0)) && count < 6000) { -+ PlatformStallExecution(50); -+ u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e7); -+ count++; -+ } -+#endif -+ } -+ -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Start!!!\n")); -+ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = TRUE; -+ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ -+ for (i = 0; i < 8; i++) { -+ result[0][i] = 0; -+ result[1][i] = 0; -+ result[2][i] = 0; -+ result[3][i] = 0; -+ } -+ -+ final_candidate = 0xff; -+ bPathS1_OK = FALSE; -+ bPathS0_OK = FALSE; -+ is12simular = FALSE; -+ is23simular = FALSE; -+ is13simular = FALSE; -+ -+for (i = 0; i < 3; i++) { -+ -+#if 1 -+ /*set path control to WL*/ -+ oriPathCtrl = ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3); /*save 0x67*/ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]original 0x67 = 0x%x\n", oriPathCtrl)); -+ ODM_SetMACReg(pDM_Odm, 0x64, BIT31, 0x1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]set 0x67 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); -+ -+ /*backup Path & GNT value */ -+ originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); -+ ODM_delay_ms(1); -+ originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); -+ -+ /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -+#endif -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ phy_IQCalibrate_8723D(pAdapter, result, i, TRUE); -+#else -+ phy_IQCalibrate_8723D(pDM_Odm, result, i, TRUE); -+#endif -+ -+#if 1 -+ /*Restore GNT_WL/GNT_BT and Path owner*/ -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); -+ ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); -+ ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -+ -+ /*Restore path control owner*/ -+ ODM_SetMACReg(pDM_Odm, 0x64, bMaskByte3, oriPathCtrl); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]restore 0x67 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); -+#endif -+ -+ if (i == 1) { -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ is12simular = phy_SimularityCompare_8723D(pAdapter, result, 0, 1); -+#else -+ is12simular = phy_SimularityCompare_8723D(pDM_Odm, result, 0, 1); -+#endif -+ -+ if (is12simular) { -+ final_candidate = 0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is12simular final_candidate is %x\n",final_candidate)); -+ break; -+ } -+ } -+ -+ if (i == 2) { -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ is13simular = phy_SimularityCompare_8723D(pAdapter, result, 0, 2); -+#else -+ is13simular = phy_SimularityCompare_8723D(pDM_Odm, result, 0, 2); -+#endif -+ -+ if (is13simular) { -+ final_candidate = 0; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is13simular final_candidate is %x\n",final_candidate)); -+ -+ break; -+ } -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ is23simular = phy_SimularityCompare_8723D(pAdapter, result, 1, 2); -+#else -+ is23simular = phy_SimularityCompare_8723D(pDM_Odm, result, 1, 2); -+#endif -+ -+ if (is23simular) { -+ final_candidate = 1; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is23simular final_candidate is %x\n",final_candidate)); -+ } else { -+ for (i = 0; i < 8; i++) -+ RegTmp += result[3][i]; -+ -+ if (RegTmp != 0) -+ final_candidate = 3; -+ else -+ final_candidate = 0xFF; -+ -+ } -+ } -+ } -+ -+ -+ -+ for (i = 0; i < 4; i++) { -+ RegE94_S1 = result[i][0]; -+ RegE9C_S1 = result[i][1]; -+ RegEA4_S1 = result[i][2]; -+ RegEAC_S1 = result[i][3]; -+ RegE94_S0 = result[i][4]; -+ RegE9C_S0 = result[i][5]; -+ RegEA4_S0 = result[i][6]; -+ RegEAC_S0 = result[i][7]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] RegE94_S1=%x RegE9C_S1=%x RegEA4_S1=%x RegEAC_S1=%x RegE94_S0=%x RegE9C_S0=%x RegEA4_S0=%x RegEAC_S0=%x\n ", RegE94_S1, RegE9C_S1, RegEA4_S1, RegEAC_S1, RegE94_S0, RegE9C_S0, RegEA4_S0, RegEAC_S0)); -+ } -+ -+ if (final_candidate != 0xff) { -+ pDM_Odm->RFCalibrateInfo.RegE94 = RegE94_S1 = result[final_candidate][0]; -+ pDM_Odm->RFCalibrateInfo.RegE9C = RegE9C_S1 = result[final_candidate][1]; -+ RegEA4_S1 = result[final_candidate][2]; -+ RegEAC_S1 = result[final_candidate][3]; -+ pDM_Odm->RFCalibrateInfo.RegEB4 = RegE94_S0 = result[final_candidate][4]; -+ pDM_Odm->RFCalibrateInfo.RegEBC = RegE9C_S0 = result[final_candidate][5]; -+ RegEA4_S0 = result[final_candidate][6]; -+ RegEAC_S0 = result[final_candidate][7]; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] final_candidate is %x\n", final_candidate)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] TX1_X=%x TX1_Y=%x RX1_X=%x RX1_Y=%x TX0_X=%x TX0_Y=%x RX0_X=%x RX0_Y=%x\n ", RegE94_S1, RegE9C_S1, RegEA4_S1, RegEAC_S1, RegE94_S0, RegE9C_S0, RegEA4_S0, RegEAC_S0)); -+ bPathS1_OK = bPathS0_OK = TRUE; -+ } else { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] FAIL use default value\n")); -+ -+ pDM_Odm->RFCalibrateInfo.RegE94 = pDM_Odm->RFCalibrateInfo.RegEB4 = 0x100; -+ pDM_Odm->RFCalibrateInfo.RegE9C = pDM_Odm->RFCalibrateInfo.RegEBC = 0x0; -+ } -+ -+ -+ if (RegE94_S1 != 0) -+ _PHY_PathS1FillIQKMatrix_8723D(pAdapter, bPathS1_OK, result, final_candidate, (RegEA4_S1 == 0)); -+ if (RegE94_S0 != 0) -+ _PHY_PathS0FillIQKMatrix_8723D(pAdapter, bPathS0_OK, result, final_candidate, (RegEA4_S0 == 0)); -+ -+ -+ RegC80 = ODM_GetBBReg(pDM_Odm, 0xc80, bMaskDWord); -+ RegC94 = ODM_GetBBReg(pDM_Odm, 0xc94, bMaskDWord); -+ RegC14 = ODM_GetBBReg(pDM_Odm, 0xc14, bMaskDWord); -+ RegCA0 = ODM_GetBBReg(pDM_Odm, 0xca0, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xc80 = 0x%x 0xc94 = 0x%x 0xc14 = 0x%x 0xca0 = 0x%x\n", RegC80, RegC94, RegC14, RegCA0)); -+ -+ -+ RegCd0 = ODM_GetBBReg(pDM_Odm, 0xcd0, bMaskDWord); -+ RegCd4 = ODM_GetBBReg(pDM_Odm, 0xcd4, bMaskDWord); -+ RegCd8 = ODM_GetBBReg(pDM_Odm, 0xcd8, bMaskDWord); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xcd0 = 0x%x 0xcd4 = 0x%x 0xcd8 = 0x%x\n", RegCd0, RegCd4, RegCd8)); -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ Indexforchannel = ODM_GetRightChnlPlaceforIQK(pHalData->CurrentChannel); -+#else -+ Indexforchannel = 0; -+#endif -+ -+ -+ if (final_candidate < 4) { -+ for (i = 0; i < IQK_Matrix_REG_NUM; i++) -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[Indexforchannel].Value[0][i] = result[final_candidate][i]; -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[Indexforchannel].bIQKDone = TRUE; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\nIQK OK Indexforchannel %d.\n", Indexforchannel)); -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ _PHY_SaveADDARegisters_8723D(pAdapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, 9); -+#else -+ _PHY_SaveADDARegisters_8723D(pDM_Odm, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, IQK_BB_REG_NUM); -+#endif -+ -+ if (pDM_Odm->mp_mode == FALSE) { -+#if MP_DRIVER != 1 -+ SetFwWiFiCalibrationCmd_8723D(pAdapter, 0); -+ -+ -+ count = 0; -+ u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e6); -+ while (u1bTmp != 0 && count < 1000) { -+ PlatformStallExecution(10); -+ u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e6); -+ count++; -+ } -+ -+ if (count >= 1000) { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]Polling 0x1e6 to 0 for WiFi calibration H2C cmd FAIL! count(%d)", count)); -+ } -+#endif -+ } -+ -+ ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; -+ ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB_phyIQK); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK finished\n")); -+#endif -+ -+} -+ -+ -+VOID -+PHY_LCCalibrate_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PVOID pDM_VOID -+#else -+ IN PDM_ODM_T pDM_Odm -+#endif -+ ) -+{ -+ BOOLEAN bSingleTone = FALSE, bCarrierSuppression = FALSE; -+ u4Byte timeout = 2000, timecount = 0; -+ -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ #if (MP_DRIVER == 1) -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -+ #else -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ #endif -+ #endif -+#endif -+ -+#if MP_DRIVER == 1 -+ bSingleTone = pMptCtx->bSingleTone; -+ bCarrierSuppression = pMptCtx->bCarrierSuppression; -+#endif -+ -+ -+#if DISABLE_BB_RF -+ return; -+#endif -+ -+ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) { -+ return; -+ } -+#endif -+ -+ if (bSingleTone || bCarrierSuppression) -+ return; -+ -+ while(*(pDM_Odm->pbScanInProcess) && timecount < timeout) -+ { -+ ODM_delay_ms(50); -+ timecount += 50; -+ } -+ -+ pDM_Odm->RFCalibrateInfo.bLCKInProgress = TRUE; -+ -+ phy_LCCalibrate_8723D(pDM_Odm, FALSE); -+ -+ pDM_Odm->RFCalibrateInfo.bLCKInProgress = FALSE; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK:Finish!!!interface %d\n", pDM_Odm->InterfaceIndex)); -+ -+} -+ -+VOID -+PHY_APCalibrate_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN s1Byte delta -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+#if DISABLE_BB_RF -+ return; -+#endif -+ -+ return; -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) { -+ return; -+ } -+#endif -+ -+#if FOR_BRAZIL_PRETEST != 1 -+ if (pDM_Odm->RFCalibrateInfo.bAPKdone) -+#endif -+ return; -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ phy_APCalibrate_8723D(pAdapter, delta, FALSE); -+#else -+ phy_APCalibrate_8723D(pDM_Odm, delta, FALSE); -+#endif -+ } -+VOID phy_SetRFPathSwitch_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bMain, -+ IN BOOLEAN is2T -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+ -+ if (bMain) { -+ ODM_SetMACReg(pDM_Odm, 0x7C4, bMaskLWord, 0x7700); -+ } else { -+ ODM_SetMACReg(pDM_Odm, 0x7C4, bMaskLWord, 0xDD00); -+ } -+ -+ ODM_SetMACReg(pDM_Odm, 0x7C0, bMaskDWord, 0xC00F0038); -+ ODM_SetMACReg(pDM_Odm, 0x70, BIT26, 1); -+ ODM_SetMACReg(pDM_Odm, 0x64, BIT31, 1); -+} -+ -+VOID PHY_SetRFPathSwitch_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bMain -+ ) -+{ -+HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+#endif -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#endif -+ -+#if DISABLE_BB_RF -+ return; -+#endif -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ phy_SetRFPathSwitch_8723D(pAdapter, bMain, TRUE); -+#endif -+ -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ -+VOID -+phy_DigitalPredistortion_8723D( -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PADAPTER pAdapter, -+#else -+ IN PDM_ODM_T pDM_Odm, -+#endif -+ IN BOOLEAN is2T -+ ) -+{ -+#if (RT_PLATFORM == PLATFORM_WINDOWS) -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ -+ u4Byte tmpReg, tmpReg2, index, i; -+ u1Byte path, pathbound = PATH_NUM; -+ u4Byte AFE_backup[IQK_ADDA_REG_NUM]; -+ u4Byte AFE_REG[IQK_ADDA_REG_NUM] = { -+ rFPGA0_XCD_SwitchControl, rBlue_Tooth, -+ rRx_Wait_CCA, rTx_CCK_RFON, -+ rTx_CCK_BBON, rTx_OFDM_RFON, -+ rTx_OFDM_BBON, rTx_To_Rx, -+ rTx_To_Tx, rRx_CCK, -+ rRx_OFDM, rRx_Wait_RIFS, -+ rRx_TO_Rx, rStandby, -+ rSleep, rPMPD_ANAEN }; -+ -+ u4Byte BB_backup[DP_BB_REG_NUM]; -+ u4Byte BB_REG[DP_BB_REG_NUM] = { -+ rOFDM0_TRxPathEnable, rFPGA0_RFMOD, -+ rOFDM0_TRMuxPar, rFPGA0_XCD_RFInterfaceSW, -+ rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, -+ rFPGA0_XB_RFInterfaceOE}; -+ u4Byte BB_settings[DP_BB_REG_NUM] = { -+ 0x00a05430, 0x02040000, 0x000800e4, 0x22208000, -+ 0x0, 0x0, 0x0}; -+ -+ u4Byte RF_backup[DP_PATH_NUM][DP_RF_REG_NUM]; -+ u4Byte RF_REG[DP_RF_REG_NUM] = { -+ RF_TXBIAS_A}; -+ -+ u4Byte MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte MAC_REG[IQK_MAC_REG_NUM] = { -+ REG_TXPAUSE, REG_BCN_CTRL, -+ REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; -+ -+ u4Byte Tx_AGC[DP_DPK_NUM][DP_DPK_VALUE_NUM] = { -+ {0x1e1e1e1e, 0x03901e1e}, -+ {0x18181818, 0x03901818}, -+ {0x0e0e0e0e, 0x03900e0e} -+ }; -+ -+ u4Byte AFE_on_off[PATH_NUM] = { -+ 0x04db25a4, 0x0b1b25a4}; -+ -+ u1Byte RetryCount = 0; -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>phy_DigitalPredistortion_8723D()\n")); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_DigitalPredistortion_8723D for %s\n", (is2T ? "2T2R" : "1T1R"))); -+ -+ -+ for (index = 0; index < DP_BB_REG_NUM; index++) -+ BB_backup[index] = ODM_GetBBReg(pDM_Odm, BB_REG[index], bMaskDWord); -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_SaveMACRegisters_8723D(pAdapter, BB_REG, MAC_backup); -+#else -+ _PHY_SaveMACRegisters_8723D(pDM_Odm, BB_REG, MAC_backup); -+#endif -+ -+ -+ for (path = 0; path < DP_PATH_NUM; path++) { -+ for (index = 0; index < DP_RF_REG_NUM; index++) -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ RF_backup[path][index] = PHY_QueryRFReg(pAdapter, path, RF_REG[index], bMaskDWord); -+#else -+ RF_backup[path][index] = ODM_GetRFReg(pAdapter, path, RF_REG[index], bMaskDWord); -+#endif -+ } -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_SaveADDARegisters_8723D(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+#else -+ _PHY_SaveADDARegisters_8723D(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+#endif -+ -+ -+ for (index = 0; index < IQK_ADDA_REG_NUM ; index++) -+ ODM_SetBBReg(pDM_Odm, AFE_REG[index], bMaskDWord, 0x6fdb25a4); -+ -+ -+ for (index = 0; index < DP_BB_REG_NUM; index++) { -+ if (index < 4) -+ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_settings[index]); -+ else if (index == 4) -+ ODM_SetBBReg(pDM_Odm,BB_REG[index], bMaskDWord, BB_backup[index]|BIT10|BIT26); -+ else -+ ODM_SetBBReg(pDM_Odm, BB_REG[index], BIT10, 0x00); -+ } -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_MACSettingCalibration_8723D(pAdapter, MAC_REG, MAC_backup); -+#else -+ _PHY_MACSettingCalibration_8723D(pDM_Odm, MAC_REG, MAC_backup); -+#endif -+ -+ -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x01008c00); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x01008c00); -+ -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bMaskDWord, 0x10000); -+ -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); -+ ODM_SetBBReg(pDM_Odm, 0xbc0, bMaskDWord, 0x0005361f); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ -+ -+ for (i = 0; i < 3; i++) { -+ -+ for (index = 0; index < 3; index++) -+ ODM_SetBBReg(pDM_Odm, 0xe00+index*4, bMaskDWord, Tx_AGC[i][0]); -+ ODM_SetBBReg(pDM_Odm,0xe00+index*4, bMaskDWord, Tx_AGC[i][1]); -+ for (index = 0; index < 4; index++) -+ ODM_SetBBReg(pDM_Odm, 0xe10+index*4, bMaskDWord, Tx_AGC[i][0]); -+ -+ -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x02097098); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0xf76d9f84); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x0004ab87); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00880000); -+ -+ -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x80047788); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x00047788); -+ ODM_delay_ms(50); -+ } -+ -+ -+ for (index = 0; index < 3; index++) -+ ODM_SetBBReg(pDM_Odm, 0xe00+index*4, bMaskDWord, 0x34343434); -+ ODM_SetBBReg(pDM_Odm, 0xe08+index*4, bMaskDWord, 0x03903434); -+ for (index = 0; index < 4; index++) -+ ODM_SetBBReg(pDM_Odm, 0xe10+index*4, bMaskDWord, 0x34343434); -+ -+ -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x02017098); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0xf76d9f84); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x0004ab87); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00880000); -+ -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0c, bMaskDWord, 0x8992b); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0d, bMaskDWord, 0x0e52c); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bMaskDWord, 0x5205a ); -+ -+ -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x800477c0); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x000477c0); -+ ODM_delay_ms(50); -+ -+ while(RetryCount < DP_RETRY_LIMIT && !pDM_Odm->RFCalibrateInfo.bDPPathAOK) -+ { -+ -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x0c297018); -+ tmpReg = ODM_GetBBReg(pDM_Odm, 0xbe0, bMaskDWord); -+ ODM_delay_ms(10); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x0c29701f); -+ tmpReg2 = ODM_GetBBReg(pDM_Odm, 0xbe8, bMaskDWord); -+ ODM_delay_ms(10); -+ -+ tmpReg = (tmpReg & bMaskHWord) >> 16; -+ tmpReg2 = (tmpReg2 & bMaskHWord) >> 16; -+ if (tmpReg < 0xf0 || tmpReg > 0x105 || tmpReg2 > 0xff) { -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x02017098); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x800000); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x800477c0); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x000477c0); -+ ODM_delay_ms(50); -+ RetryCount++; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 DPK RetryCount %d 0xbe0[31:16] %x 0xbe8[31:16] %x\n", RetryCount, tmpReg, tmpReg2)); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 DPK Success\n")); -+ pDM_Odm->RFCalibrateInfo.bDPPathAOK = TRUE; -+ break; -+ } -+ } -+ RetryCount = 0; -+ -+ -+ if (pDM_Odm->RFCalibrateInfo.bDPPathAOK) { -+ -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x01017098); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0x776d9f84); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x0004ab87); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00880000); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); -+ -+ for (i = rPdp_AntA; i <= 0xb3c; i += 4) { -+ ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x40004000); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 ofsset = 0x%x\n", i)); -+ } -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0xb40, bMaskDWord, 0x40404040); -+ ODM_SetBBReg(pDM_Odm, 0xb44, bMaskDWord, 0x28324040); -+ ODM_SetBBReg(pDM_Odm, 0xb48, bMaskDWord, 0x10141920); -+ -+ for (i = 0xb4c; i <= 0xb5c; i += 4) { -+ ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x0c0c0c0c); -+ } -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0xbc0, bMaskDWord, 0x0005361f); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ } else { -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0x00000000); -+ } -+ -+ -+ if (is2T) { -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bMaskDWord, 0x10000); -+ -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); -+ ODM_SetBBReg(pDM_Odm, 0xbc4, bMaskDWord, 0x0005361f); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ -+ -+ for (i = 0; i < 3; i++) { -+ -+ for(index = 0; index < 4; index++) -+ ODM_SetBBReg(pDM_Odm, 0x830+index*4, bMaskDWord, Tx_AGC[i][0]); -+ for(index = 0; index < 2; index++) -+ ODM_SetBBReg(pDM_Odm, 0x848+index*4, bMaskDWord, Tx_AGC[i][0]); -+ for(index = 0; index < 2; index++) -+ ODM_SetBBReg(pDM_Odm, 0x868+index*4, bMaskDWord, Tx_AGC[i][0]); -+ -+ -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x02097098); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0xf76d9f84); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x0004ab87); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntB, bMaskDWord, 0x00880000); -+ -+ -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x80047788); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x00047788); -+ ODM_delay_ms(50); -+ } -+ -+ -+ for (index = 0; index < 4; index++) -+ ODM_SetBBReg(pDM_Odm, 0x830+index*4, bMaskDWord, 0x34343434); -+ for (index = 0; index < 2; index++) -+ ODM_SetBBReg(pDM_Odm, 0x848+index*4, bMaskDWord, 0x34343434); -+ for (index = 0; index < 2; index++) -+ ODM_SetBBReg(pDM_Odm, 0x868+index*4, bMaskDWord, 0x34343434); -+ -+ -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x02017098); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0xf76d9f84); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x0004ab87); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntB, bMaskDWord, 0x00880000); -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0x840, bMaskDWord, 0x0101000f); -+ ODM_SetBBReg(pDM_Odm, 0x840, bMaskDWord, 0x01120103); -+ -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x0c, bMaskDWord, 0x8992b); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x0d, bMaskDWord, 0x0e52c); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bMaskDWord, 0x5205a); -+ -+ -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x800477c0); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x000477c0); -+ ODM_delay_ms(50); -+ -+ while(RetryCount < DP_RETRY_LIMIT && !pDM_Odm->RFCalibrateInfo.bDPPathBOK) -+ { -+ -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x0c297018); -+ tmpReg = ODM_GetBBReg(pDM_Odm, 0xbf0, bMaskDWord); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x0c29701f); -+ tmpReg2 = ODM_GetBBReg(pDM_Odm, 0xbf8, bMaskDWord); -+ -+ tmpReg = (tmpReg & bMaskHWord) >> 16; -+ tmpReg2 = (tmpReg2 & bMaskHWord) >> 16; -+ -+ if (tmpReg < 0xf0 || tmpReg > 0x105 || tmpReg2 > 0xff) { -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x02017098); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x800000); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x800477c0); -+ ODM_delay_ms(1); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x000477c0); -+ ODM_delay_ms(50); -+ RetryCount++; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK RetryCount %d 0xbf0[31:16] %x, 0xbf8[31:16] %x\n", RetryCount , tmpReg, tmpReg2)); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK Success\n")); -+ pDM_Odm->RFCalibrateInfo.bDPPathBOK = TRUE; -+ break; -+ } -+ } -+ -+ -+ if (pDM_Odm->RFCalibrateInfo.bDPPathBOK) { -+ -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x01017098); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0x776d9f84); -+ ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x0004ab87); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntB, bMaskDWord, 0x00880000); -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); -+ for (i = 0xb60; i <= 0xb9c; i += 4) { -+ ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x40004000); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B ofsset = 0x%x\n", i)); -+ } -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0xba0, bMaskDWord, 0x40404040); -+ ODM_SetBBReg(pDM_Odm, 0xba4, bMaskDWord, 0x28324050); -+ ODM_SetBBReg(pDM_Odm, 0xba8, bMaskDWord, 0x0c141920); -+ -+ for (i = 0xbac; i <= 0xbbc; i += 4) { -+ ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x0c0c0c0c); -+ } -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0xbc4, bMaskDWord, 0x0005361f); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -+ -+ } else { -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0x00000000); -+ } -+ } -+ -+ -+ for (index = 0; index < DP_BB_REG_NUM; index++) -+ ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_backup[index]); -+ -+ -+ for (path = 0; path < DP_PATH_NUM; path++) { -+ for (i = 0 ; i < DP_RF_REG_NUM ; i++) { -+ ODM_SetRFReg(pDM_Odm, path, RF_REG[i], bMaskDWord, RF_backup[path][i]); -+ } -+ } -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE1, bMaskDWord, 0x1000f); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE2, bMaskDWord, 0x20101); -+ -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ _PHY_ReloadADDARegisters_8723D(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+ -+ -+ _PHY_ReloadMACRegisters_8723D(pAdapter, MAC_REG, MAC_backup); -+#else -+ _PHY_ReloadADDARegisters_8723D(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -+ -+ -+ _PHY_ReloadMACRegisters_8723D(pDM_Odm, MAC_REG, MAC_backup); -+#endif -+ -+ pDM_Odm->RFCalibrateInfo.bDPdone = TRUE; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==phy_DigitalPredistortion_8723D()\n")); -+#endif -+} -+ -+VOID -+PHY_DigitalPredistortion_8723D( -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PADAPTER pAdapter -+#else -+ IN PDM_ODM_T pDM_Odm -+#endif -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+#if DISABLE_BB_RF -+ return; -+#endif -+ -+ return; -+ -+ if (pDM_Odm->RFCalibrateInfo.bDPdone) -+ return; -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ -+ if (IS_92C_SERIAL(pHalData->VersionID)) { -+ phy_DigitalPredistortion_8723D(pAdapter, TRUE); -+ } -+ else -+#endif -+ { -+ -+ phy_DigitalPredistortion_8723D(pAdapter, FALSE); -+ } -+} -+ -+ -+ -+ -+ -+BOOLEAN phy_QueryRFPathSwitch_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN is2T -+ ) -+{ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ #if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ #endif -+ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ #endif -+#endif -+ -+ -+ if (ODM_GetBBReg(pDM_Odm, 0x7C4, bMaskLWord) == 0x7700) -+ return TRUE; -+ else -+ return FALSE; -+ -+} -+ -+ -+ -+ -+BOOLEAN PHY_QueryRFPathSwitch_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm -+#else -+ IN PADAPTER pAdapter -+#endif -+ ) -+{ -+ -+#if DISABLE_BB_RF -+ return TRUE; -+#endif -+ -+#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -+ return phy_QueryRFPathSwitch_8723D(pAdapter, FALSE); -+#else -+ return phy_QueryRFPathSwitch_8723D(pDM_Odm, FALSE); -+#endif -+ -+} -+#endif -+ -+ -+ -+#else -+ -+VOID -+PHY_IQCalibrate_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN BOOLEAN bReCovery -+ ){} -+VOID -+PHY_LCCalibrate_8723D( -+ IN PDM_ODM_T pDM_Odm -+ ){} -+ -+VOID -+ODM_TxPwrTrackSetPwr_8723D( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ){} -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/halphyrf_8723d.h 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,153 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PHY_RF_8723D_H__ -+#define __HAL_PHY_RF_8723D_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define IQK_DELAY_TIME_8723D 10 //ms -+#define index_mapping_NUM_8723D 15 -+#define AVG_THERMAL_NUM_8723D 4 -+#define RF_T_METER_8723D 0x42 -+ -+void ConfigureTxpowerTrack_8723D( -+ PTXPWRTRACK_CFG pConfig -+ ); -+ -+VOID -+GetDeltaSwingTable_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PVOID pDM_VOID, -+#else -+ IN PDM_ODM_T pDM_Odm, -+#endif -+ OUT pu1Byte *TemperatureUP_A, -+ OUT pu1Byte *TemperatureDOWN_A, -+ OUT pu1Byte *TemperatureUP_B, -+ OUT pu1Byte *TemperatureDOWN_B -+ ); -+ -+VOID -+setCCKFilterCoefficient_8723D( -+ PDM_ODM_T pDM_Odm, -+ u1Byte CCKSwingIndex -+); -+ -+void DoIQK_8723D( -+ PVOID pDM_VOID, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ); -+ -+VOID -+ODM_TxPwrTrackSetPwr_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PVOID pDM_VOID, -+#else -+ IN PDM_ODM_T pDM_Odm, -+#endif -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ); -+ -+VOID -+ODM_TxXtalTrackSetXtal_8723D( -+ PVOID pDM_VOID -+); -+ -+//1 7. IQK -+ -+void -+PHY_IQCalibrate_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER Adapter, -+#endif -+ IN BOOLEAN bReCovery); -+ -+ -+// -+// LC calibrate -+// -+void -+PHY_LCCalibrate_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -+ PVOID pDM_VOID -+#else -+ IN PDM_ODM_T pDM_Odm -+#endif -+); -+ -+// -+// AP calibrate -+// -+void -+PHY_APCalibrate_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN s1Byte delta); -+void -+PHY_DigitalPredistortion_8723D( IN PADAPTER pAdapter); -+ -+ -+VOID -+_PHY_SaveADDARegisters_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte ADDAReg, -+ IN pu4Byte ADDABackup, -+ IN u4Byte RegisterNum -+ ); -+ -+VOID -+_PHY_PathADDAOn_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte ADDAReg, -+ IN BOOLEAN isPathAOn, -+ IN BOOLEAN is2T -+ ); -+ -+VOID -+_PHY_MACSettingCalibration_8723D( -+#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -+ IN PDM_ODM_T pDM_Odm, -+#else -+ IN PADAPTER pAdapter, -+#endif -+ IN pu4Byte MACReg, -+ IN pu4Byte MACBackup -+ ); -+ -+ -+#endif // #ifndef __HAL_PHY_RF_8723D_H__ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.c 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,189 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "Mp_Precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8723D_SUPPORT == 1) -+ -+void -+odm_ConfigRFReg_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data, -+ IN ODM_RF_RADIO_PATH_E RF_PATH, -+ IN u4Byte RegAddr -+ ) -+{ -+ if(Addr == 0xfe || Addr == 0xffe) -+ { -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ } -+ else -+ { -+ ODM_SetRFReg(pDM_Odm, RF_PATH, RegAddr, bRFRegOffsetMask, Data); -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ } -+} -+ -+ -+void -+odm_ConfigRF_RadioA_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data -+ ) -+{ -+ u4Byte content = 0x1000; // RF_Content: radioa_txt -+ u4Byte maskforPhySet= (u4Byte)(content&0xE000); -+ -+ odm_ConfigRFReg_8723D(pDM_Odm, Addr, Data, ODM_RF_PATH_A, Addr|maskforPhySet); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioA] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigRF_RadioB_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data -+ ) -+{ -+ u4Byte content = 0x1001; // RF_Content: radiob_txt -+ u4Byte maskforPhySet= (u4Byte)(content&0xE000); -+ -+ odm_ConfigRFReg_8723D(pDM_Odm, Addr, Data, ODM_RF_PATH_B, Addr|maskforPhySet); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioB] %08X %08X\n", Addr, Data)); -+ -+} -+ -+void -+odm_ConfigMAC_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u1Byte Data -+ ) -+{ -+ ODM_Write1Byte(pDM_Odm, Addr, Data); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigMACWithHeaderFile: [MAC_REG] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_AGC_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ) -+{ -+ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [AGC_TAB] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_PHY_REG_PG_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Band, -+ IN u4Byte RfPath, -+ IN u4Byte TxNum, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ) -+{ -+ if (Addr == 0xfe || Addr == 0xffe) -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ else -+ { -+#if !(DM_ODM_SUPPORT_TYPE&ODM_AP) -+ PHY_StoreTxPowerByRate(pDM_Odm->Adapter, Band, RfPath, TxNum, Addr, Bitmask, Data); -+#endif -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X %08X\n", Addr, Bitmask, Data)); -+} -+ -+void -+odm_ConfigBB_PHY_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ) -+{ -+/*DbgPrint("odm_ConfigBB_PHY_8723D(), Addr = 0x%x, data = 0x%x\n", Addr, Data);*/ -+ if (Addr == 0xfe) -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ else if (Addr == 0xfd) -+ ODM_delay_ms(5); -+ else if (Addr == 0xfc) -+ ODM_delay_ms(1); -+ else if (Addr == 0xfb) -+ ODM_delay_us(50); -+ else if (Addr == 0xfa) -+ ODM_delay_us(5); -+ else if (Addr == 0xf9) -+ ODM_delay_us(1); -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); -+ } -+ -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_TXPWR_LMT_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte Regulation, -+ IN pu1Byte Band, -+ IN pu1Byte Bandwidth, -+ IN pu1Byte RateSection, -+ IN pu1Byte RfPath, -+ IN pu1Byte Channel, -+ IN pu1Byte PowerLimit -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -+ PHY_SetTxPowerLimit(pDM_Odm, Regulation, Band, -+ Bandwidth, RateSection, RfPath, Channel, PowerLimit); -+#endif -+} -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_regconfig8723d.h 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,98 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_ODM_REGCONFIG_H_8723D -+#define __INC_ODM_REGCONFIG_H_8723D -+ -+#if (RTL8723D_SUPPORT == 1) -+ -+void -+odm_ConfigRFReg_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data, -+ IN ODM_RF_RADIO_PATH_E RF_PATH, -+ IN u4Byte RegAddr -+ ); -+ -+void -+odm_ConfigRF_RadioA_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigRF_RadioB_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigMAC_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u1Byte Data -+ ); -+ -+void -+odm_ConfigBB_AGC_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_PHY_REG_PG_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Band, -+ IN u4Byte RfPath, -+ IN u4Byte TxNum, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_PHY_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Addr, -+ IN u4Byte Bitmask, -+ IN u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_TXPWR_LMT_8723D( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte Regulation, -+ IN pu1Byte Band, -+ IN pu1Byte Bandwidth, -+ IN pu1Byte RateSection, -+ IN pu1Byte RfPath, -+ IN pu1Byte Channel, -+ IN pu1Byte PowerLimit -+ ); -+ -+ -+#endif -+#endif // end of SUPPORT -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.c 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,68 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+/*============================================================ -+ include files -+============================================================*/ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (RTL8723D_SUPPORT == 1) -+ -+s1Byte -+odm_CCKRSSI_8723D( -+ IN u1Byte LNA_idx, -+ IN u1Byte VGA_idx -+ ) -+{ -+ s1Byte rx_pwr_all = 0x00; -+ -+ switch (LNA_idx) { -+ -+ case 0xf: -+ rx_pwr_all = -46 - (2 * VGA_idx); -+ break; -+ case 0xa: -+ rx_pwr_all = -20 - (2 * VGA_idx); -+ break; -+ case 7: -+ rx_pwr_all = -10 - (2 * VGA_idx); -+ break; -+ case 4: -+ rx_pwr_all = 4 - (2 * VGA_idx); -+ break; -+ default: -+ break; -+ } -+ -+ return rx_pwr_all; -+ -+} -+ -+#endif -+ -+ -+ -+ -+ -+ -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/phydm_rtl8723d.h 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,33 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __ODM_RTL8723D_H__ -+#define __ODM_RTL8723D_H__ -+ -+#if (RTL8723D_SUPPORT == 1) -+ -+s1Byte -+odm_CCKRSSI_8723D( -+ IN u1Byte LNA_idx, -+ IN u1Byte VGA_idx -+ ); -+ -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/version_rtl8723d.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/version_rtl8723d.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/rtl8723d/version_rtl8723d.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/rtl8723d/version_rtl8723d.h 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,5 @@ -+/*RTL8723D PHY Parameters*/ -+#define SVN_COMMIT_VERSION_8723D 22597 -+#define RELEASE_DATE_8723D 20161209 -+#define COMMIT_BY_8723D "BB_Jessica" -+#define RELEASE_VERSION_8723D 31 -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.c 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,536 @@ -+//============================================================ -+// Description: -+// -+// This file is for TXBF mechanism -+// -+//============================================================ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+/*Beamforming halcomtxbf API create by YuChen 2015/05*/ -+ -+VOID -+halComTxbf_beamformInit( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ HalTxbf8822B_Init(pDM_Odm); -+} -+ -+/*Only used for MU BFer Entry when get GID management frame (self is as MU STA)*/ -+VOID -+halComTxbf_ConfigGtab( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ HalTxbf8822B_ConfigGtab(pDM_Odm); -+} -+ -+VOID -+phydm_beamformSetSoundingEnter( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_EnterWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_EnterWorkItem)); -+#else -+ halComTxbf_EnterWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetSoundingLeave( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_LeaveWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_LeaveWorkItem)); -+#else -+ halComTxbf_LeaveWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetSoundingRate( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_RateWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_RateWorkItem)); -+#else -+ halComTxbf_RateWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetSoundingStatus( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_StatusWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_StatusWorkItem)); -+#else -+ halComTxbf_StatusWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetSoundingFwNdpa( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (*pDM_Odm->pbFwDwRsvdPageInProgress) -+ ODM_SetTimer(pDM_Odm, &(pTxbfInfo->Txbf_FwNdpaTimer), 5); -+ else -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_FwNdpaWorkItem)); -+#else -+ halComTxbf_FwNdpaWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetSoundingClk( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_ClkWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_ClkWorkItem)); -+#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) -+ PADAPTER padapter = pDM_Odm->Adapter; -+ -+ rtw_run_in_thread_cmd(padapter, halComTxbf_ClkWorkItemCallback, padapter); -+#else -+ halComTxbf_ClkWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetResetTxPath( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_ResetTxPathWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_ResetTxPathWorkItem)); -+#else -+ halComTxbf_ResetTxPathWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+phydm_beamformSetGetTxRate( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_GetTxRateWorkItem)) == FALSE) -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_GetTxRateWorkItem)); -+#else -+ halComTxbf_GetTxRateWorkItemCallback(pDM_Odm); -+#endif -+} -+ -+VOID -+halComTxbf_EnterWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ u1Byte Idx = pTxbfInfo->TXBFIdx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) -+ HalTxbfJaguar_Enter(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8192E) -+ HalTxbf8192E_Enter(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_Enter(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ HalTxbf8822B_Enter(pDM_Odm, Idx); -+} -+ -+VOID -+halComTxbf_LeaveWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ u1Byte Idx = pTxbfInfo->TXBFIdx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) -+ HalTxbfJaguar_Leave(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8192E) -+ HalTxbf8192E_Leave(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_Leave(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ HalTxbf8822B_Leave(pDM_Odm, Idx); -+} -+ -+ -+VOID -+halComTxbf_FwNdpaWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ u1Byte Idx = pTxbfInfo->NdpaIdx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) -+ HalTxbfJaguar_FwTxBF(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8192E) -+ HalTxbf8192E_FwTxBF(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_FwTxBF(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ HalTxbf8822B_FwTxBF(pDM_Odm, Idx); -+} -+ -+VOID -+halComTxbf_ClkWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8812) -+ HalTxbfJaguar_Clk_8812A(pDM_Odm); -+} -+ -+ -+ -+VOID -+halComTxbf_RateWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ u1Byte BW = pTxbfInfo->BW; -+ u1Byte Rate = pTxbfInfo->Rate; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8812) -+ HalTxbf8812A_setNDPArate(pDM_Odm, BW, Rate); -+ else if (pDM_Odm->SupportICType & ODM_RTL8192E) -+ HalTxbf8192E_setNDPArate(pDM_Odm, BW, Rate); -+ else if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_setNDPArate(pDM_Odm, BW, Rate); -+ -+} -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+halComTxbf_FwNdpaTimerCallback( -+ IN PRT_TIMER pTimer -+ ) -+{ -+ -+ PADAPTER Adapter = (PADAPTER)pTimer->Adapter; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (*pDM_Odm->pbFwDwRsvdPageInProgress) -+ ODM_SetTimer(pDM_Odm, &(pTxbfInfo->Txbf_FwNdpaTimer), 5); -+ else -+ PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_FwNdpaWorkItem)); -+} -+#endif -+ -+ -+VOID -+halComTxbf_StatusWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ u1Byte Idx = pTxbfInfo->TXBFIdx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) -+ HalTxbfJaguar_Status(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8192E) -+ HalTxbf8192E_Status(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_Status(pDM_Odm, Idx); -+ else if (pDM_Odm->SupportICType & ODM_RTL8822B) -+ HalTxbf8822B_Status(pDM_Odm, Idx); -+} -+ -+VOID -+halComTxbf_ResetTxPathWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ u1Byte Idx = pTxbfInfo->TXBFIdx; -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_ResetTxPath(pDM_Odm, Idx); -+ -+} -+ -+VOID -+halComTxbf_GetTxRateWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ) -+{ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+#else -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#endif -+ -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ HalTxbf8814A_GetTxRate(pDM_Odm); -+} -+ -+ -+BOOLEAN -+HalComTxbf_Set( -+ IN PVOID pDM_VOID, -+ IN u1Byte setType, -+ IN PVOID pInBuf -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ pu1Byte pU1Tmp=(pu1Byte)pInBuf; -+ PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] setType = 0x%X\n", __func__, setType)); -+ -+ switch(setType){ -+ case TXBF_SET_SOUNDING_ENTER: -+ pTxbfInfo->TXBFIdx = *pU1Tmp; -+ phydm_beamformSetSoundingEnter(pDM_Odm); -+ break; -+ -+ case TXBF_SET_SOUNDING_LEAVE: -+ pTxbfInfo->TXBFIdx = *pU1Tmp; -+ phydm_beamformSetSoundingLeave(pDM_Odm); -+ break; -+ -+ case TXBF_SET_SOUNDING_RATE: -+ pTxbfInfo->BW = pU1Tmp[0]; -+ pTxbfInfo->Rate = pU1Tmp[1]; -+ phydm_beamformSetSoundingRate(pDM_Odm); -+ break; -+ -+ case TXBF_SET_SOUNDING_STATUS: -+ pTxbfInfo->TXBFIdx = *pU1Tmp; -+ phydm_beamformSetSoundingStatus(pDM_Odm); -+ break; -+ -+ case TXBF_SET_SOUNDING_FW_NDPA: -+ pTxbfInfo->NdpaIdx = *pU1Tmp; -+ phydm_beamformSetSoundingFwNdpa(pDM_Odm); -+ break; -+ -+ case TXBF_SET_SOUNDING_CLK: -+ phydm_beamformSetSoundingClk(pDM_Odm); -+ break; -+ -+ case TXBF_SET_TX_PATH_RESET: -+ pTxbfInfo->TXBFIdx = *pU1Tmp; -+ phydm_beamformSetResetTxPath(pDM_Odm); -+ break; -+ -+ case TXBF_SET_GET_TX_RATE: -+ phydm_beamformSetGetTxRate(pDM_Odm); -+ break; -+ -+ } -+ -+ return TRUE; -+} -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+BOOLEAN -+HalComTxbf_Get( -+ IN PADAPTER Adapter, -+ IN u1Byte getType, -+ OUT PVOID pOutBuf -+ ) -+{ -+ PHAL_DATA_TYPE pHalData=GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ PBOOLEAN pBoolean=(PBOOLEAN)pOutBuf; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (getType == TXBF_GET_EXPLICIT_BEAMFORMEE) { -+ if (IS_HARDWARE_TYPE_OLDER_THAN_8812A(Adapter)) -+ *pBoolean = FALSE; -+ else if (/*IS_HARDWARE_TYPE_8822B(Adapter) ||*/ -+ IS_HARDWARE_TYPE_8821B(Adapter) || -+ IS_HARDWARE_TYPE_8192E(Adapter) || -+ IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) -+ *pBoolean = TRUE; -+ else -+ *pBoolean = FALSE; -+ } else if (getType == TXBF_GET_EXPLICIT_BEAMFORMER) { -+ if (IS_HARDWARE_TYPE_OLDER_THAN_8812A(Adapter)) -+ *pBoolean = FALSE; -+ else if (/*IS_HARDWARE_TYPE_8822B(Adapter) ||*/ -+ IS_HARDWARE_TYPE_8821B(Adapter) || -+ IS_HARDWARE_TYPE_8192E(Adapter) || -+ IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) { -+ if(pHalData->RF_Type == RF_2T2R || pHalData->RF_Type == RF_3T3R) -+ *pBoolean = TRUE; -+ else -+ *pBoolean = FALSE; -+ } else -+ *pBoolean = FALSE; -+ } else if (getType == TXBF_GET_MU_MIMO_STA) { -+#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) -+ if (IS_HARDWARE_TYPE_8822B(Adapter) || IS_HARDWARE_TYPE_8821C(Adapter)) -+ *pBoolean = TRUE; -+ else -+#endif -+ *pBoolean = FALSE; -+ -+ -+ } else if (getType == TXBF_GET_MU_MIMO_AP) { -+#if (RTL8822B_SUPPORT == 1) -+ if (IS_HARDWARE_TYPE_8822B(Adapter)) -+ *pBoolean = TRUE; -+ else -+#endif -+ *pBoolean = FALSE; -+ } -+ -+ return TRUE; -+} -+#endif -+ -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/halcomtxbf.h 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,180 @@ -+#ifndef __HAL_COM_TXBF_H__ -+#define __HAL_COM_TXBF_H__ -+ -+/* -+typedef BOOLEAN -+(*TXBF_GET)( -+ IN PVOID pAdapter, -+ IN u1Byte getType, -+ OUT PVOID pOutBuf -+ ); -+ -+typedef BOOLEAN -+(*TXBF_SET)( -+ IN PVOID pAdapter, -+ IN u1Byte setType, -+ OUT PVOID pInBuf -+ ); -+*/ -+ -+typedef enum _TXBF_SET_TYPE{ -+ TXBF_SET_SOUNDING_ENTER, -+ TXBF_SET_SOUNDING_LEAVE, -+ TXBF_SET_SOUNDING_RATE, -+ TXBF_SET_SOUNDING_STATUS, -+ TXBF_SET_SOUNDING_FW_NDPA, -+ TXBF_SET_SOUNDING_CLK, -+ TXBF_SET_TX_PATH_RESET, -+ TXBF_SET_GET_TX_RATE -+}TXBF_SET_TYPE,*PTXBF_SET_TYPE; -+ -+ -+typedef enum _TXBF_GET_TYPE{ -+ TXBF_GET_EXPLICIT_BEAMFORMEE, -+ TXBF_GET_EXPLICIT_BEAMFORMER, -+ TXBF_GET_MU_MIMO_STA, -+ TXBF_GET_MU_MIMO_AP -+}TXBF_GET_TYPE,*PTXBF_GET_TYPE; -+ -+ -+ -+//2 HAL TXBF related -+typedef struct _HAL_TXBF_INFO { -+ u1Byte TXBFIdx; -+ u1Byte NdpaIdx; -+ u1Byte BW; -+ u1Byte Rate; -+ -+ RT_TIMER Txbf_FwNdpaTimer; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_WORK_ITEM Txbf_EnterWorkItem; -+ RT_WORK_ITEM Txbf_LeaveWorkItem; -+ RT_WORK_ITEM Txbf_FwNdpaWorkItem; -+ RT_WORK_ITEM Txbf_ClkWorkItem; -+ RT_WORK_ITEM Txbf_StatusWorkItem; -+ RT_WORK_ITEM Txbf_RateWorkItem; -+ RT_WORK_ITEM Txbf_ResetTxPathWorkItem; -+ RT_WORK_ITEM Txbf_GetTxRateWorkItem; -+#endif -+ -+} HAL_TXBF_INFO, *PHAL_TXBF_INFO; -+ -+#if (BEAMFORMING_SUPPORT == 1) -+ -+VOID -+halComTxbf_beamformInit( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+halComTxbf_ConfigGtab( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+halComTxbf_EnterWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_LeaveWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_FwNdpaWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_ClkWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_ResetTxPathWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_GetTxRateWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_RateWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+VOID -+halComTxbf_FwNdpaTimerCallback( -+ IN PRT_TIMER pTimer -+ ); -+ -+VOID -+halComTxbf_StatusWorkItemCallback( -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN PADAPTER Adapter -+#else -+ IN PVOID pDM_VOID -+#endif -+ ); -+ -+BOOLEAN -+HalComTxbf_Set( -+ IN PVOID pDM_VOID, -+ IN u1Byte setType, -+ IN PVOID pInBuf -+ ); -+ -+BOOLEAN -+HalComTxbf_Get( -+ IN PADAPTER Adapter, -+ IN u1Byte getType, -+ OUT PVOID pOutBuf -+ ); -+ -+#else -+#define halComTxbf_beamformInit(pDM_VOID) NULL -+#define halComTxbf_ConfigGtab(pDM_VOID) NULL -+#define halComTxbf_EnterWorkItemCallback(_Adapter) NULL -+#define halComTxbf_LeaveWorkItemCallback(_Adapter) NULL -+#define halComTxbf_FwNdpaWorkItemCallback(_Adapter) NULL -+#define halComTxbf_ClkWorkItemCallback(_Adapter) NULL -+#define halComTxbf_RateWorkItemCallback(_Adapter) NULL -+#define halComTxbf_FwNdpaTimerCallback(_Adapter) NULL -+#define halComTxbf_StatusWorkItemCallback(_Adapter) NULL -+#define HalComTxbf_Get(_Adapter, _getType, _pOutBuf) -+ -+#endif -+ -+#endif // #ifndef __HAL_COM_TXBF_H__ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.c 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,392 @@ -+//============================================================ -+// Description: -+// -+// This file is for 8192E TXBF mechanism -+// -+//============================================================ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (RTL8192E_SUPPORT == 1) -+ -+VOID -+HalTxbf8192E_setNDPArate( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW, -+ IN u1Byte Rate -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8192E, (Rate << 2 | BW)); -+ -+} -+ -+VOID -+halTxbf8192E_RfMode( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamInfo -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ BOOLEAN bSelfBeamformer = FALSE; -+ BOOLEAN bSelfBeamformee = FALSE; -+ BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pDM_Odm->RFType == ODM_1T1R) -+ return; -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); /*RF Mode table write enable*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WE_LUT, 0x80000, 0x1); /*RF Mode table write enable*/ -+ -+ if (pBeamInfo->beamformee_su_cnt > 0) { -+ /*Path_A*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode 0x30=0x18000*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0x77fc2); /*Enable TXIQGEN in RX mode*/ -+ /*Path_B*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0x77fc2); /*Enable TXIQGEN in RX mode*/ -+ } else { -+ /*Path_A*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0x77f82); /*Disable TXIQGEN in RX mode*/ -+ /*Path_B*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0x77f82); /*Disable TXIQGEN in RX mode*/ -+ } -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x0); /*RF Mode table write disable*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WE_LUT, 0x80000, 0x0); /*RF Mode table write disable*/ -+ -+ if (pBeamInfo->beamformee_su_cnt > 0) { -+ ODM_SetBBReg(pDM_Odm, rFPGA1_TxInfo, bMaskDWord, 0x83321333); -+ ODM_SetBBReg(pDM_Odm, rCCK0_AFESetting, bMaskByte3, 0xc1); -+ } else -+ ODM_SetBBReg(pDM_Odm, rFPGA1_TxInfo, bMaskDWord, 0x81121313); -+} -+ -+ -+ -+VOID -+halTxbf8192E_FwTxBFCmd( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx, Period0 = 0, Period1 = 0; -+ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u1Byte u1TxBFParm[3] = {0}; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ if (pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (Idx == 0) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) -+ PageNum0 = 0xFE; -+ else -+ PageNum0 = 0xFF; //stop sounding -+ Period0 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } else if (Idx == 1) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) -+ PageNum1 = 0xFE; -+ else -+ PageNum1 = 0xFF; //stop sounding -+ Period1 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } -+ } -+ } -+ -+ u1TxBFParm[0] = PageNum0; -+ u1TxBFParm[1] = PageNum1; -+ u1TxBFParm[2] = (Period1 << 4) | Period0; -+ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_TXBF, 3, u1TxBFParm); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, -+ ("[%s] PageNum0 = %d Period0 = %d, PageNum1 = %d Period1 %d\n", __func__, PageNum0, Period0, PageNum1, Period1)); -+} -+ -+ -+VOID -+halTxbf8192E_DownloadNDPA( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte u1bTmp = 0, tmpReg422 = 0, Head_Page; -+ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; -+ BOOLEAN bSendBeacon = FALSE; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ u1Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; -+ /*default reseved 1 page for the IC type which is undefined.*/ -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *pDM_Odm->pbFwDwRsvdPageInProgress = TRUE; -+#endif -+ if (Idx == 0) -+ Head_Page = 0xFE; -+ else -+ Head_Page = 0xFE; -+ -+ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu1Byte)&TxPageBndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8192E+1); -+ ODM_Write1Byte(pDM_Odm, REG_CR_8192E+1, (u1bTmp | BIT0)); -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmpReg422 = ODM_Read1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8192E+2); -+ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8192E+2, tmpReg422 & (~BIT6)); -+ -+ if (tmpReg422 & BIT6) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_WARNING, ("%s There is an Adapter is sending beacon.\n", __func__)); -+ bSendBeacon = TRUE; -+ } -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xFE/0xFD NDPA Head for TXDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+1, Head_Page); -+ -+ do { -+ /*Clear beacon valid check bit.*/ -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2); -+ ODM_Write1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2, (BcnValidReg | BIT0)); -+ -+ // download NDPA rsvd page. -+ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); -+ -+#if(DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_MGQ_TXBD_NUM_8192E+3); -+ count = 0; -+ while ((count < 20) && (u1bTmp & BIT4)) { -+ count++; -+ ODM_delay_us(10); -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_MGQ_TXBD_NUM_8192E+3); -+ } -+ ODM_Write1Byte(pDM_Odm, REG_MGQ_TXBD_NUM_8192E+3, u1bTmp | BIT4); -+#endif -+ -+ /*check rsvd page download OK.*/ -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2); -+ count = 0; -+ while (!(BcnValidReg & BIT0) && count < 20) { -+ count++; -+ ODM_delay_us(10); -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2); -+ } -+ DLBcnCount++; -+ } while (!(BcnValidReg & BIT0) && DLBcnCount < 5); -+ -+ if (!(BcnValidReg & BIT0)) -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_WARNING, ("%s Download RSVD page failed!\n", __func__)); -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xF9 Beacon Head for TXDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+1, TxPageBndy); -+ -+ /*To make sure that if there exists an adapter which would like to send beacon.*/ -+ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ -+ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause*/ -+ /*the beacon cannot be sent by HW.*/ -+ /*2010.06.23. Added by tynli.*/ -+ if (bSendBeacon) -+ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8192E+2, tmpReg422); -+ -+ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ -+ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8192E+1); -+ ODM_Write1Byte(pDM_Odm, REG_CR_8192E+1, (u1bTmp & (~BIT0))); -+ -+ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *pDM_Odm->pbFwDwRsvdPageInProgress = FALSE; -+#endif -+} -+ -+ -+VOID -+HalTxbf8192E_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte BFerBFeeIdx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; -+ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); -+ u4Byte CSI_Param; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ u2Byte STAid = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ halTxbf8192E_RfMode(pDM_Odm, pBeamformingInfo); -+ -+ if (pDM_Odm->RFType == ODM_2T2R) -+ ODM_Write4Byte(pDM_Odm, 0xd80, 0x00000000); /*Nc =2*/ -+ -+ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { -+ BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; -+ -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8192E, 0xCB); -+ -+ /*MAC address/Partial AID of Beamformer*/ -+ if (BFerIdx == 0) { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8192E+i), BeamformerEntry.MacAddr[i]); -+ } else { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER1_INFO_8192E+i), BeamformerEntry.MacAddr[i]); -+ } -+ -+ /*CSI report parameters of Beamformer Default use Nc = 2*/ -+ CSI_Param = 0x03090309; -+ -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8192E, CSI_Param); -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8192E, CSI_Param); -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8192E, CSI_Param); -+ -+ /*Timeout value for MAC to leave NDP_RX_standby_state (60 us, Test chip) (80 us, MP chip)*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8192E+3, 0x50); -+ -+ } -+ -+ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ STAid = BeamformeeEntry.MacId; -+ else -+ STAid = BeamformeeEntry.P_AID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s], STAid=0x%X\n", __func__, STAid)); -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (BFeeIdx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E, STAid); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8192E+3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8192E+3) | BIT4 | BIT6 | BIT7); -+ } else -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E+2, STAid | BIT12 | BIT14 | BIT15); -+ -+ /*CSI report parameters of Beamformee*/ -+ if (BFeeIdx == 0) { -+ /*Get BIT24 & BIT25*/ -+ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+3) & 0x3; -+ -+ ODM_Write1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+3, tmp | 0x60); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E, STAid | BIT9); -+ } else { -+ /*Set BIT25*/ -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2, STAid | 0xE200); -+ } -+ phydm_Beamforming_Notify(pDM_Odm); -+ -+ } -+} -+ -+ -+VOID -+HalTxbf8192E_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ halTxbf8192E_RfMode(pDM_Odm, pBeamInfo); -+ -+ /* Clear P_AID of Beamformee -+ * Clear MAC addresss of Beamformer -+ * Clear Associated Bfmee Sel -+ */ -+ if (pBeamInfo->BeamformCap == BEAMFORMING_CAP_NONE) -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8192E, 0xC8); -+ -+ if (Idx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E, 0); -+ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8192E, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8192E+4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E, 0); -+ } else { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E+2, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8192E+2) & 0xF000); -+ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8192E, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8192E+4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2, ODM_Read2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2) & 0x60); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Idx %d\n", __func__, Idx)); -+} -+ -+ -+VOID -+HalTxbf8192E_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte BeamCtrlVal; -+ u4Byte BeamCtrlReg; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformEntry = pBeamInfo->BeamformeeEntry[Idx]; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ BeamCtrlVal = BeamformEntry.MacId; -+ else -+ BeamCtrlVal = BeamformEntry.P_AID; -+ -+ if (Idx == 0) -+ BeamCtrlReg = REG_TXBF_CTRL_8192E; -+ else { -+ BeamCtrlReg = REG_TXBF_CTRL_8192E+2; -+ BeamCtrlVal |= BIT12 | BIT14 | BIT15; -+ } -+ -+ if ((BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) && (pBeamInfo->applyVmatrix == TRUE)) { -+ if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) -+ BeamCtrlVal |= BIT9; -+ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) -+ BeamCtrlVal |= BIT10; -+ } else -+ BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); -+ -+ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Idx %d BeamCtrlReg %x BeamCtrlVal %x\n", __func__, Idx, BeamCtrlReg, BeamCtrlVal)); -+} -+ -+ -+VOID -+HalTxbf8192E_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ halTxbf8192E_DownloadNDPA(pDM_Odm, Idx); -+ -+ halTxbf8192E_FwTxBFCmd(pDM_Odm); -+} -+ -+#endif /* #if (RTL8192E_SUPPORT == 1)*/ -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8192e.h 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,61 @@ -+#ifndef __HAL_TXBF_8192E_H__ -+#define __HAL_TXBF_8192E_H__ -+ -+#if (RTL8192E_SUPPORT == 1) -+#if (BEAMFORMING_SUPPORT == 1) -+ -+VOID -+HalTxbf8192E_setNDPArate( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW, -+ IN u1Byte Rate -+); -+ -+VOID -+HalTxbf8192E_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8192E_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8192E_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8192E_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+#else -+ -+#define HalTxbf8192E_setNDPArate(pDM_VOID, BW, Rate) -+#define HalTxbf8192E_Enter(pDM_VOID, Idx) -+#define HalTxbf8192E_Leave(pDM_VOID, Idx) -+#define HalTxbf8192E_Status(pDM_VOID, Idx) -+#define HalTxbf8192E_FwTxBF(pDM_VOID, Idx) -+ -+#endif -+ -+#else -+ -+#define HalTxbf8192E_setNDPArate(pDM_VOID, BW, Rate) -+#define HalTxbf8192E_Enter(pDM_VOID, Idx) -+#define HalTxbf8192E_Leave(pDM_VOID, Idx) -+#define HalTxbf8192E_Status(pDM_VOID, Idx) -+#define HalTxbf8192E_FwTxBF(pDM_VOID, Idx) -+ -+#endif -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.c 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,677 @@ -+//============================================================ -+// Description: -+// -+// This file is for 8814A TXBF mechanism -+// -+//============================================================ -+ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (RTL8814A_SUPPORT == 1) -+ -+VOID -+HalTxbf8814A_setNDPArate( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW, -+ IN u1Byte Rate -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8814A, BW); -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_RATE_8814A, (u1Byte) Rate); -+ -+} -+ -+#define PHYDM_MEMORY_MAP_BUF_READ 0x8000 -+#define PHYDM_CTRL_INFO_PAGE 0x660 -+ -+VOID -+phydm_DataRate_8814A( -+ IN PDM_ODM_T pDM_Odm, -+ IN u1Byte macId, -+ OUT pu4Byte data, -+ IN u1Byte dataLen -+ ) -+{ -+ u1Byte i = 0; -+ u2Byte XReadDataAddr = 0; -+ -+ ODM_Write2Byte(pDM_Odm, REG_PKTBUF_DBG_CTRL_8814A, PHYDM_CTRL_INFO_PAGE); -+ XReadDataAddr = PHYDM_MEMORY_MAP_BUF_READ + macId*32; /*Ctrl Info: 32Bytes for each macid(n)*/ -+ -+ if ((XReadDataAddr < PHYDM_MEMORY_MAP_BUF_READ) || (XReadDataAddr > 0x8FFF)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("XReadDataAddr(0x%x) is not correct!\n", XReadDataAddr)); -+ return; -+ } -+ -+ /* Read data */ -+ for (i = 0; i < dataLen; i++) -+ *(data+i) = ODM_Read2Byte(pDM_Odm, XReadDataAddr+i); -+ -+} -+ -+VOID -+HalTxbf8814A_GetTxRate( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pEntry; -+ u4Byte TxRptData = 0; -+ u1Byte DataRate = 0xFF; -+ -+ pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); -+ -+ phydm_DataRate_8814A(pDM_Odm, (u1Byte)pEntry->MacId, &TxRptData, 1); -+ DataRate = (u1Byte)TxRptData; -+ DataRate &= bMask7bits; /*Bit7 indicates SGI*/ -+ -+ pDM_Odm->TxBfDataRate = DataRate; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] pDM_Odm->TxBfDataRate = 0x%x\n", __func__, pDM_Odm->TxBfDataRate)); -+} -+ -+VOID -+HalTxbf8814A_ResetTxPath( -+ IN PVOID pDM_VOID, -+ IN u1Byte idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ u1Byte Nr_index = 0, txSS = 0; -+ -+ if (idx < BEAMFORMEE_ENTRY_NUM) -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; -+ else -+ return; -+ -+ if ((pDM_Odm->LastUSBHub) != (*pDM_Odm->HubUsbMode)) { -+ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), BeamformeeEntry.CompSteeringNumofBFer); -+ -+ if (*pDM_Odm->HubUsbMode == 2) { -+ if (pDM_Odm->RFType == ODM_4T4R) -+ txSS = 0xf; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ txSS = 0xe; -+ else -+ txSS = 0x6; -+ } else if (*pDM_Odm->HubUsbMode == 1) /*USB 2.0 always 2Tx*/ -+ txSS = 0x6; -+ else -+ txSS = 0x6; -+ -+ if (txSS == 0xf) { -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x93f); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskDWord, 0x93f93f0); -+ } else if (txSS == 0xe) { -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x93e); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskDWord, 0x93e93e0); -+ } else if (txSS == 0x6) { -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x936); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskLWord, 0x9360); -+ } -+ -+ if (idx == 0) { -+ switch (Nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ -+ break; -+ -+ default: /*Nr>3, same as Case 3*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ -+ break; -+ } -+ } else { -+ switch (Nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ -+ break; -+ -+ default: /*Nr>3, same as Case 3*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ -+ break; -+ } -+ } -+ -+ pDM_Odm->LastUSBHub = *pDM_Odm->HubUsbMode; -+ } else -+ return; -+#endif -+} -+ -+ -+u1Byte -+halTxbf8814A_GetNtx( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Ntx = 0, txSS = 3; -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ txSS = *pDM_Odm->HubUsbMode; -+#endif -+ if (txSS == 3 || txSS == 2) { -+ if (pDM_Odm->RFType == ODM_4T4R) -+ Ntx = 3; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ Ntx = 2; -+ else -+ Ntx = 1; -+ } else if (txSS == 1) /*USB 2.0 always 2Tx*/ -+ Ntx = 1; -+ else -+ Ntx = 1; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Ntx = %d\n", __func__, Ntx)); -+ return Ntx; -+} -+ -+u1Byte -+halTxbf8814A_GetNrx( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Nrx = 0; -+ -+ if (pDM_Odm->RFType == ODM_4T4R) -+ Nrx = 3; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ Nrx = 2; -+ else if (pDM_Odm->RFType == ODM_2T2R) -+ Nrx = 1; -+ else if (pDM_Odm->RFType == ODM_2T3R) -+ Nrx = 2; -+ else if (pDM_Odm->RFType == ODM_2T4R) -+ Nrx = 3; -+ else if (pDM_Odm->RFType == ODM_1T1R) -+ Nrx = 0; -+ else if (pDM_Odm->RFType == ODM_1T2R) -+ Nrx = 1; -+ else -+ Nrx = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Nrx = %d\n", __func__, Nrx)); -+ return Nrx; -+} -+ -+VOID -+halTxbf8814A_RfMode( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamformingInfo, -+ IN u1Byte idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i, Nr_index = 0; -+ u1Byte txSS = 3; /*default use 3 Tx*/ -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ -+ if (idx < BEAMFORMEE_ENTRY_NUM) -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; -+ else -+ return; -+ -+ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), BeamformeeEntry.CompSteeringNumofBFer); -+ -+ if (pDM_Odm->RFType == ODM_1T1R) -+ return; -+ -+ for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) { -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_WeLut_Jaguar, 0x80000, 0x1); -+ /*RF Mode table write enable*/ -+ } -+ -+ if (pBeamformingInfo->beamformee_su_cnt > 0) { -+ for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) { -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableAddr, 0xfffff, 0x18000); -+ /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableData0, 0xfffff, 0xBE77F); -+ /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableData1, 0xfffff, 0x226BF); -+ /*Enable TXIQGEN in RX mode*/ -+ } -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); -+ /*Enable TXIQGEN in RX mode*/ -+ } -+ -+ for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) { -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_WeLut_Jaguar, 0x80000, 0x0); -+ /*RF Mode table write disable*/ -+ } -+ -+ if (pBeamformingInfo->beamformee_su_cnt > 0) { -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ pDM_Odm->LastUSBHub = *pDM_Odm->HubUsbMode; -+ txSS = *pDM_Odm->HubUsbMode; -+#endif -+ if (txSS == 3 || txSS == 2) { -+ if (pDM_Odm->RFType == ODM_4T4R) -+ txSS = 0xf; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ txSS = 0xe; -+ else -+ txSS = 0x6; -+ } else if (txSS == 1) /*USB 2.0 always 2Tx*/ -+ txSS = 0x6; -+ else -+ txSS = 0x6; -+ -+ if (txSS == 0xf) { -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x93f); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskDWord, 0x93f93f0); -+ } else if (txSS == 0xe) { -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x93e); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskDWord, 0x93e93e0); -+ } else if (txSS == 0x6) { -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x936); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskLWord, 0x9360); -+ } -+ -+ /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, BIT28 | BIT29, 0x2); /*enable BB TxBF ant mapping register*/ -+ -+ if (idx == 0) { -+ switch (Nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ -+ break; -+ -+ default: /*Nr>3, same as Case 3*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ -+ -+ break; -+ } -+ } else { -+ switch (Nr_index) { -+ case 0: -+ break; -+ -+ case 1: /*Nsts = 2 BC*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ -+ break; -+ -+ case 2: /*Nsts = 3 BCD*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ -+ break; -+ -+ default: /*Nr>3, same as Case 3*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ -+ break; -+ } -+ } -+ } -+ -+ if ((pBeamformingInfo->beamformee_su_cnt == 0) && (pBeamformingInfo->beamformer_su_cnt == 0)) { -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x932); /*set TxPath selection for 8814a BFer bug refine*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskDWord, 0x93e9360); -+ } -+} -+#if 0 -+VOID -+halTxbf8814A_DownloadNDPA( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte u1bTmp = 0, tmpReg422 = 0; -+ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; -+ u2Byte Head_Page = 0x7FE; -+ BOOLEAN bSendBeacon = FALSE; -+ u2Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8814A; /*default reseved 1 page for the IC type which is undefined.*/ -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *pDM_Odm->pbFwDwRsvdPageInProgress = TRUE; -+#endif -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu2Byte)&TxPageBndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8814A + 1); -+ ODM_Write1Byte(pDM_Odm, REG_CR_8814A + 1, (u1bTmp | BIT0)); -+ -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmpReg422 = ODM_Read1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8814A + 2); -+ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8814A + 2, tmpReg422 & (~BIT6)); -+ -+ if (tmpReg422 & BIT6) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: There is an Adapter is sending beacon.\n", __func__)); -+ bSendBeacon = TRUE; -+ } -+ -+ /*0x204[11:0] Beacon Head for TXDMA*/ -+ ODM_Write2Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A, Head_Page); -+ -+ do { -+ /*Clear beacon valid check bit.*/ -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A + 1); -+ ODM_Write1Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A + 1, (BcnValidReg | BIT7)); -+ -+ /*download NDPA rsvd page.*/ -+ if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) -+ Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); -+ else -+ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); -+ -+ /*check rsvd page download OK.*/ -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A + 1); -+ count = 0; -+ while (!(BcnValidReg & BIT7) && count < 20) { -+ count++; -+ ODM_delay_ms(10); -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A + 2); -+ } -+ DLBcnCount++; -+ } while (!(BcnValidReg & BIT7) && DLBcnCount < 5); -+ -+ if (!(BcnValidReg & BIT7)) -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Download RSVD page failed!\n", __func__)); -+ -+ /*0x204[11:0] Beacon Head for TXDMA*/ -+ ODM_Write2Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A, TxPageBndy); -+ -+ /*To make sure that if there exists an adapter which would like to send beacon.*/ -+ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ -+ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ -+ /*the beacon cannot be sent by HW.*/ -+ /*2010.06.23. Added by tynli.*/ -+ if (bSendBeacon) -+ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8814A + 2, tmpReg422); -+ -+ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ -+ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8814A + 1); -+ ODM_Write1Byte(pDM_Odm, REG_CR_8814A + 1, (u1bTmp & (~BIT0))); -+ -+ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *pDM_Odm->pbFwDwRsvdPageInProgress = FALSE; -+#endif -+} -+ -+VOID -+halTxbf8814A_FwTxBFCmd( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx, Period = 0; -+ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u1Byte u1TxBFParm[3] = {0}; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) { -+ PageNum0 = 0xFE; -+ PageNum1 = 0x07; -+ Period = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } else if (PageNum0 == 0xFF) { -+ PageNum0 = 0xFF; /*stop sounding*/ -+ PageNum1 = 0x0F; -+ } -+ } -+ } -+ -+ u1TxBFParm[0] = PageNum0; -+ u1TxBFParm[1] = PageNum1; -+ u1TxBFParm[2] = Period; -+ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_TXBF, 3, u1TxBFParm); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, -+ ("[%s] PageNum0 = %d, PageNum1 = %d Period = %d\n", __func__, PageNum0, PageNum1, Period)); -+} -+#endif -+VOID -+HalTxbf8814A_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte BFerBFeeIdx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; -+ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ u2Byte STAid = 0, CSI_Param = 0; -+ u1Byte Nc_index = 0, Nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BFerIdx=%d, BFeeIdx=%d\n", __func__, BFerIdx, BFeeIdx)); -+ ODM_SetMACReg(pDM_Odm, REG_SND_PTCL_CTRL_8814A, bMaskByte1 | bMaskByte2, 0x0202); -+ -+ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { -+ BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A, 0xDB); -+ -+ /*MAC address/Partial AID of Beamformer*/ -+ if (BFerIdx == 0) { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8814A + i), BeamformerEntry.MacAddr[i]); -+ } else { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER1_INFO_8814A + i), BeamformerEntry.MacAddr[i]); -+ } -+ -+ /*CSI report parameters of Beamformer*/ -+ Nc_index = halTxbf8814A_GetNrx(pDM_Odm); /*for 8814A Nrx = 3(4 Ant), min=0(1 Ant)*/ -+ Nr_index = BeamformerEntry.NumofSoundingDim; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so Nr_index don't care*/ -+ -+ grouping = 0; -+ -+ /*for ac = 1, for n = 3*/ -+ if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) -+ codebookinfo = 1; -+ else if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_HT_EXPLICIT) -+ codebookinfo = 3; -+ -+ coefficientsize = 3; -+ -+ CSI_Param = (u2Byte)((coefficientsize << 10) | (codebookinfo << 8) | (grouping << 6) | (Nr_index << 3) | (Nc_index)); -+ -+ if (BFerIdx == 0) -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A, CSI_Param); -+ else -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A + 2, CSI_Param); -+ /*ndp_rx_standby_timer, 8814 need > 0x56, suggest from Dvaid*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A + 3, 0x40); -+ -+ } -+ -+ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; -+ -+ halTxbf8814A_RfMode(pDM_Odm, pBeamformingInfo, BFeeIdx); -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ STAid = BeamformeeEntry.MacId; -+ else -+ STAid = BeamformeeEntry.P_AID; -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (BFeeIdx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A, STAid); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3) | BIT4 | BIT6 | BIT7); -+ } else -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 2, STAid | BIT14 | BIT15 | BIT12); -+ -+ /*CSI report parameters of Beamformee*/ -+ if (BFeeIdx == 0) { -+ /*Get BIT24 & BIT25*/ -+ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3) & 0x3; -+ -+ ODM_Write1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3, tmp | 0x60); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A, STAid | BIT9); -+ } else -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, STAid | 0xE200); /*Set BIT25*/ -+ -+ phydm_Beamforming_Notify(pDM_Odm); -+ } -+ -+} -+ -+ -+VOID -+HalTxbf8814A_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ -+ if (Idx < BEAMFORMER_ENTRY_NUM) { -+ BeamformerEntry = pBeamformingInfo->BeamformerEntry[Idx]; -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[Idx]; -+ } else -+ return; -+ -+ /*Clear P_AID of Beamformee*/ -+ /*Clear MAC address of Beamformer*/ -+ /*Clear Associated Bfmee Sel*/ -+ -+ if (BeamformerEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A, 0xD8); -+ if (Idx == 0) { -+ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8814A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8814A + 4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A, 0); -+ } else { -+ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8814A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8814A + 4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A + 2, 0); -+ } -+ } -+ -+ if (BeamformeeEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ halTxbf8814A_RfMode(pDM_Odm, pBeamformingInfo, Idx); -+ if (Idx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A, 0x0); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3) | BIT4 | BIT6 | BIT7); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A, 0); -+ } else { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 2, 0x0 | BIT14 | BIT15 | BIT12); -+ -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, ODM_Read2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2) & 0x60); -+ } -+ } -+} -+ -+VOID -+HalTxbf8814A_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte BeamCtrlVal, tmpVal; -+ u4Byte BeamCtrlReg; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformEntry; -+ -+ if (Idx < BEAMFORMEE_ENTRY_NUM) -+ BeamformEntry = pBeamformingInfo->BeamformeeEntry[Idx]; -+ else -+ return; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ BeamCtrlVal = BeamformEntry.MacId; -+ else -+ BeamCtrlVal = BeamformEntry.P_AID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, BeamformEntry.BeamformEntryState = %d", __func__, BeamformEntry.BeamformEntryState)); -+ -+ if (Idx == 0) -+ BeamCtrlReg = REG_TXBF_CTRL_8814A; -+ else { -+ BeamCtrlReg = REG_TXBF_CTRL_8814A + 2; -+ BeamCtrlVal |= BIT12 | BIT14 | BIT15; -+ } -+ -+ if ((BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) && (pBeamformingInfo->applyVmatrix == TRUE)) { -+ if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) -+ BeamCtrlVal |= BIT9; -+ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) -+ BeamCtrlVal |= (BIT9 | BIT10); -+ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_80) -+ BeamCtrlVal |= (BIT9 | BIT10 | BIT11); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, Don't apply Vmatrix", __func__)); -+ BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); -+ } -+ -+ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); -+ /*disable NDP packet use beamforming */ -+ tmpVal = ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8814A); -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A, tmpVal | BIT15); -+ -+} -+ -+ -+ -+ -+ -+VOID -+HalTxbf8814A_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+#if 0 -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ halTxbf8814A_DownloadNDPA(pDM_Odm, Idx); -+ -+ halTxbf8814A_FwTxBFCmd(pDM_Odm); -+#endif -+} -+ -+#endif /* (RTL8814A_SUPPORT == 1)*/ -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8814a.h 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,83 @@ -+#ifndef __HAL_TXBF_8814A_H__ -+#define __HAL_TXBF_8814A_H__ -+ -+#if (RTL8814A_SUPPORT == 1) -+#if (BEAMFORMING_SUPPORT == 1) -+ -+VOID -+HalTxbf8814A_setNDPArate( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW, -+ IN u1Byte Rate -+); -+ -+u1Byte -+halTxbf8814A_GetNtx( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+HalTxbf8814A_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8814A_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8814A_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+VOID -+HalTxbf8814A_ResetTxPath( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8814A_GetTxRate( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+HalTxbf8814A_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+#else -+ -+#define HalTxbf8814A_setNDPArate(pDM_VOID, BW, Rate) -+#define halTxbf8814A_GetNtx(pDM_VOID) 0 -+#define HalTxbf8814A_Enter(pDM_VOID, Idx) -+#define HalTxbf8814A_Leave(pDM_VOID, Idx) -+#define HalTxbf8814A_Status(pDM_VOID, Idx) -+#define HalTxbf8814A_ResetTxPath(pDM_VOID, Idx) -+#define HalTxbf8814A_GetTxRate(pDM_VOID) -+#define HalTxbf8814A_FwTxBF(pDM_VOID, Idx) -+ -+#endif -+ -+#else -+ -+#define HalTxbf8814A_setNDPArate(pDM_VOID, BW, Rate) -+#define halTxbf8814A_GetNtx(pDM_VOID) 0 -+#define HalTxbf8814A_Enter(pDM_VOID, Idx) -+#define HalTxbf8814A_Leave(pDM_VOID, Idx) -+#define HalTxbf8814A_Status(pDM_VOID, Idx) -+#define HalTxbf8814A_ResetTxPath(pDM_VOID, Idx) -+#define HalTxbf8814A_GetTxRate(pDM_VOID) -+#define HalTxbf8814A_FwTxBF(pDM_VOID, Idx) -+#endif -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.c 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,1098 @@ -+/*============================================================*/ -+/* Description: */ -+/* */ -+/* This file is for 8814A TXBF mechanism */ -+/* */ -+/*============================================================*/ -+ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (RTL8822B_SUPPORT == 1) -+#if (BEAMFORMING_SUPPORT == 1) -+ -+u1Byte -+halTxbf8822B_GetNtx( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Ntx = 0; -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { -+ if (*pDM_Odm->HubUsbMode == 2) {/*USB3.0*/ -+ if (pDM_Odm->RFType == ODM_4T4R) -+ Ntx = 3; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ Ntx = 2; -+ else -+ Ntx = 1; -+ } else if (*pDM_Odm->HubUsbMode == 1) /*USB 2.0 always 2Tx*/ -+ Ntx = 1; -+ else -+ Ntx = 1; -+ } else -+#endif -+ { -+ if (pDM_Odm->RFType == ODM_4T4R) -+ Ntx = 3; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ Ntx = 2; -+ else -+ Ntx = 1; -+ } -+ -+ return Ntx; -+ -+} -+ -+u1Byte -+halTxbf8822B_GetNrx( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Nrx = 0; -+ -+ if (pDM_Odm->RFType == ODM_4T4R) -+ Nrx = 3; -+ else if (pDM_Odm->RFType == ODM_3T3R) -+ Nrx = 2; -+ else if (pDM_Odm->RFType == ODM_2T2R) -+ Nrx = 1; -+ else if (pDM_Odm->RFType == ODM_2T3R) -+ Nrx = 2; -+ else if (pDM_Odm->RFType == ODM_2T4R) -+ Nrx = 3; -+ else if (pDM_Odm->RFType == ODM_1T1R) -+ Nrx = 0; -+ else if (pDM_Odm->RFType == ODM_1T2R) -+ Nrx = 1; -+ else -+ Nrx = 0; -+ -+ return Nrx; -+ -+} -+ -+/***************SU & MU BFee Entry********************/ -+VOID -+halTxbf8822B_RfMode( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamformingInfo, -+ IN u1Byte idx -+ ) -+{ -+#if 0 -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i, Nr_index = 0; -+ BOOLEAN bSelfBeamformer = FALSE; -+ BOOLEAN bSelfBeamformee = FALSE; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ -+ if (idx < BEAMFORMEE_ENTRY_NUM) -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; -+ else -+ return; -+ -+ if (pDM_Odm->RFType == ODM_1T1R) -+ return; -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_WeLut_Jaguar, 0x80000, 0x1); -+ /*RF Mode table write enable*/ -+ } -+ -+ if ((pBeamformingInfo->beamformee_su_cnt > 0) || (pBeamformingInfo->beamformee_mu_cnt > 0)) { -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableAddr, 0xfffff, 0x18000); -+ /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableData0, 0xfffff, 0xBE77F); -+ /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableData1, 0xfffff, 0x226BF); -+ /*Enable TXIQGEN in RX mode*/ -+ } -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); -+ /*Enable TXIQGEN in RX mode*/ -+ } -+ -+ for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_WeLut_Jaguar, 0x80000, 0x0); -+ /*RF Mode table write disable*/ -+ } -+ -+ if (pBeamformingInfo->beamformee_su_cnt > 0) { -+ -+ /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT28|BIT29, 0x2); /*enable BB TxBF ant mapping register*/ -+ -+ if (idx == 0) { -+ /*Nsts = 2 AB*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8822B, 0xffff, 0x0433); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); -+ /*ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x430);*/ -+ -+ } else {/*IDX =1*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); -+ /*ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x430;*/ -+ } -+ } else { -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*1SS by path-A*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8822B, bMaskLWord, 0x430); /*2SS by path-A,B*/ -+ } -+ -+ if (pBeamformingInfo->beamformee_mu_cnt > 0) { -+ /*MU STAs share the common setting*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT31, 1); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); -+ } -+#endif -+} -+#if 0 -+VOID -+halTxbf8822B_DownloadNDPA( -+ IN PADAPTER Adapter, -+ IN u1Byte Idx -+ ) -+{ -+ u1Byte u1bTmp = 0, tmpReg422 = 0; -+ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; -+ u2Byte Head_Page = 0x7FE; -+ BOOLEAN bSendBeacon = FALSE; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u2Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8814A; /*default reseved 1 page for the IC type which is undefined.*/ -+ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry+Idx; -+ -+ pHalData->bFwDwRsvdPageInProgress = TRUE; -+ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu2Byte)&TxPageBndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR_8814A+1); -+ PlatformEFIOWrite1Byte(Adapter, REG_CR_8814A+1, (u1bTmp|BIT0)); -+ -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmpReg422 = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A+2); -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A+2, tmpReg422&(~BIT6)); -+ -+ if (tmpReg422 & BIT6) { -+ RT_TRACE(COMP_INIT, DBG_LOUD, ("SetBeamformDownloadNDPA_8814A(): There is an Adapter is sending beacon.\n")); -+ bSendBeacon = TRUE; -+ } -+ -+ /*0x204[11:0] Beacon Head for TXDMA*/ -+ PlatformEFIOWrite2Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A, Head_Page); -+ -+ do { -+ /*Clear beacon valid check bit.*/ -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A+1); -+ PlatformEFIOWrite1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A+1, (BcnValidReg|BIT7)); -+ -+ /*download NDPA rsvd page.*/ -+ if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) -+ Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); -+ else -+ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); -+ -+ /*check rsvd page download OK.*/ -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A + 1); -+ count = 0; -+ while (!(BcnValidReg & BIT7) && count < 20) { -+ count++; -+ delay_us(10); -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A+2); -+ } -+ DLBcnCount++; -+ } while (!(BcnValidReg & BIT7) && DLBcnCount < 5); -+ -+ if (!(BcnValidReg & BIT0)) -+ RT_DISP(FBEAM, FBEAM_ERROR, ("%s Download RSVD page failed!\n", __func__)); -+ -+ /*0x204[11:0] Beacon Head for TXDMA*/ -+ PlatformEFIOWrite2Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A, TxPageBndy); -+ -+ /*To make sure that if there exists an adapter which would like to send beacon.*/ -+ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ -+ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ -+ /*the beacon cannot be sent by HW.*/ -+ /*2010.06.23. Added by tynli.*/ -+ if (bSendBeacon) -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A+2, tmpReg422); -+ -+ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ -+ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR_8814A+1); -+ PlatformEFIOWrite1Byte(Adapter, REG_CR_8814A+1, (u1bTmp&(~BIT0))); -+ -+ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+ -+ pHalData->bFwDwRsvdPageInProgress = FALSE; -+} -+ -+VOID -+halTxbf8822B_FwTxBFCmd( -+ IN PADAPTER Adapter -+ ) -+{ -+ u1Byte Idx, Period = 0; -+ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u1Byte u1TxBFParm[3] = {0}; -+ -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); -+ -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) { -+ PageNum0 = 0xFE; -+ PageNum1 = 0x07; -+ Period = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } else if (PageNum0 == 0xFF) { -+ PageNum0 = 0xFF; /*stop sounding*/ -+ PageNum1 = 0x0F; -+ } -+ } -+ } -+ -+ u1TxBFParm[0] = PageNum0; -+ u1TxBFParm[1] = PageNum1; -+ u1TxBFParm[2] = Period; -+ FillH2CCmd(Adapter, PHYDM_H2C_TXBF, 3, u1TxBFParm); -+ -+ RT_DISP(FBEAM, FBEAM_FUN, ("@%s End, PageNum0 = 0x%x, PageNum1 = 0x%x Period = %d", __func__, PageNum0, PageNum1, Period)); -+} -+#endif -+ -+VOID -+HalTxbf8822B_Init( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte u1bTmp; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ ODM_SetBBReg(pDM_Odm, 0x14c0 , BIT16, 1); /*Enable P1 aggr new packet according to P0 transfer time*/ -+ ODM_SetBBReg(pDM_Odm, 0x14c0 , BIT15|BIT14|BIT13|BIT12, 10); /*MU Retry Limit*/ -+ ODM_SetBBReg(pDM_Odm, 0x14c0 , BIT7, 0); /*Disable Tx MU-MIMO until sounding done*/ -+ ODM_SetBBReg(pDM_Odm, 0x14c0 , 0x3F, 0); /* Clear validity of MU STAs */ -+ ODM_Write1Byte(pDM_Odm, 0x167c , 0x70); /*MU-MIMO Option as default value*/ -+ ODM_Write2Byte(pDM_Odm, 0x1680 , 0); /*MU-MIMO Control as default value*/ -+ -+ /* Set MU NDPA rate & BW source */ -+ /* 0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, 0x42C); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B, (u1bTmp|BIT6)); -+ /* 0x45F[7:0] = 0x10 (Rate=OFDM_6M, BW20) */ -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8822B, 0x10); -+ -+ /*Temp Settings*/ -+ ODM_SetBBReg(pDM_Odm, 0x6DC , 0x3F000000, 4); /*STA2's CSI rate is fixed at 6M*/ -+ ODM_SetBBReg(pDM_Odm, 0x1C94 , bMaskDWord, 0xAFFFAFFF); /*Grouping bitmap parameters*/ -+ -+ /* Init HW variable */ -+ pBeamformingInfo->RegMUTxCtrl = ODM_Read4Byte(pDM_Odm, 0x14c0); -+ -+ if (pDM_Odm->RFType == ODM_2T2R) { /*2T2R*/ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: RFType is 2T2R\n", __func__)); -+ config_phydm_trx_mode_8822b(pDM_Odm, (ODM_RF_PATH_E)3, (ODM_RF_PATH_E)3, TRUE);/*Tx2path*/ -+ } -+ -+#if (OMNIPEEK_SNIFFER_ENABLED == 1) -+ /* Config HW to receive packet on the user position from registry for sniffer mode. */ -+ /* ODM_SetBBReg(pDM_Odm, 0xB00 , BIT9, 1);*/ /* For A-cut only. RegB00[9] = 1 (enable PMAC Rx) */ -+ ODM_SetBBReg(pDM_Odm, 0xB54 , BIT30, 1); /* RegB54[30] = 1 (force user position) */ -+ ODM_SetBBReg(pDM_Odm, 0xB54 , (BIT29|BIT28), Adapter->MgntInfo.SniffUserPosition); /* RegB54[29:28] = user position (0~3) */ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Set Adapter->MgntInfo.SniffUserPosition=%#X\n", Adapter->MgntInfo.SniffUserPosition)); -+#endif -+} -+ -+VOID -+HalTxbf8822B_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte BFerBFeeIdx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0)>>4; -+ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); -+ u2Byte CSI_Param = 0; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamformeeEntry; -+ PRT_BEAMFORMER_ENTRY pBeamformerEntry; -+ u2Byte value16, STAid = 0; -+ u1Byte Nc_index = 0, Nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0; -+ u4Byte gid_valid, user_position_l, user_position_h; -+ u4Byte mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; -+ u1Byte u1bTmp; -+ u4Byte u4bTmp; -+ -+ RT_DISP(FBEAM, FBEAM_FUN, ("%s: BFerBFeeIdx=%d, BFerIdx=%d, BFeeIdx=%d\n", __func__, BFerBFeeIdx, BFerIdx, BFeeIdx)); -+ -+ /*************SU BFer Entry Init*************/ -+ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { -+ pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[BFerIdx]; -+ pBeamformerEntry->is_mu_ap = FALSE; -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xDB); -+ -+ -+ for (i = 0; i < MAX_BEAMFORMER_SU; i++) { -+ if ((pBeamformingInfo->beamformer_su_reg_maping & BIT(i)) == 0) { -+ pBeamformingInfo->beamformer_su_reg_maping |= BIT(i); -+ pBeamformerEntry->su_reg_index = i; -+ break; -+ } -+ } -+ -+ /*MAC address/Partial AID of Beamformer*/ -+ if (pBeamformerEntry->su_reg_index == 0) { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8822B+i), pBeamformerEntry->MacAddr[i]); -+ } else { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER1_INFO_8822B+i), pBeamformerEntry->MacAddr[i]); -+ } -+ -+ /*CSI report parameters of Beamformer*/ -+ Nc_index = halTxbf8822B_GetNrx(pDM_Odm); /*for 8814A Nrx = 3(4 Ant), min=0(1 Ant)*/ -+ Nr_index = pBeamformerEntry->NumofSoundingDim; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so Nr_index don't care*/ -+ -+ grouping = 0; -+ -+ /*for ac = 1, for n = 3*/ -+ if (pBeamformerEntry->BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) -+ codebookinfo = 1; -+ else if (pBeamformerEntry->BeamformEntryCap & BEAMFORMEE_CAP_HT_EXPLICIT) -+ codebookinfo = 3; -+ -+ coefficientsize = 3; -+ -+ CSI_Param = (u2Byte)((coefficientsize<<10)|(codebookinfo<<8)|(grouping<<6)|(Nr_index<<3)|(Nc_index)); -+ -+ if (BFerIdx == 0) -+ ODM_Write2Byte(pDM_Odm, REG_TX_CSI_RPT_PARAM_BW20_8822B, CSI_Param); -+ else -+ ODM_Write2Byte(pDM_Odm, REG_TX_CSI_RPT_PARAM_BW20_8822B+2, CSI_Param); -+ /*ndp_rx_standby_timer, 8814 need > 0x56, suggest from Dvaid*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B+3, 0x70); -+ -+ } -+ -+ /*************SU BFee Entry Init*************/ -+ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { -+ pBeamformeeEntry = &pBeamformingInfo->BeamformeeEntry[BFeeIdx]; -+ pBeamformeeEntry->is_mu_sta = FALSE; -+ halTxbf8822B_RfMode(pDM_Odm, pBeamformingInfo, BFeeIdx); -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ STAid = pBeamformeeEntry->MacId; -+ else -+ STAid = pBeamformeeEntry->P_AID; -+ -+ for (i = 0; i < MAX_BEAMFORMEE_SU; i++) { -+ if ((pBeamformingInfo->beamformee_su_reg_maping & BIT(i)) == 0) { -+ pBeamformingInfo->beamformee_su_reg_maping |= BIT(i); -+ pBeamformeeEntry->su_reg_index = i; -+ break; -+ } -+ } -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (pBeamformeeEntry->su_reg_index == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B, STAid); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3)|BIT4|BIT6|BIT7); -+ } else { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B+2, STAid | BIT14 | BIT15 | BIT12); -+ } -+ -+ /*CSI report parameters of Beamformee*/ -+ if (pBeamformeeEntry->su_reg_index == 0) { -+ /*Get BIT24 & BIT25*/ -+ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+3) & 0x3; -+ -+ ODM_Write1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B + 3, tmp | 0x60); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B, STAid | BIT9); -+ } else -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+2, STAid | 0xE200); /*Set BIT25*/ -+ -+ phydm_Beamforming_Notify(pDM_Odm); -+ } -+ -+ /*************MU BFer Entry Init*************/ -+ if ((pBeamformingInfo->beamformer_mu_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { -+ pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[BFerIdx]; -+ pBeamformingInfo->mu_ap_index = BFerIdx; -+ pBeamformerEntry->is_mu_ap = TRUE; -+ for (i = 0; i < 8; i++) -+ pBeamformerEntry->gid_valid[i] = 0; -+ for (i = 0; i < 16; i++) -+ pBeamformerEntry->user_position[i] = 0; -+ -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xDB); -+ -+ /* MAC address */ -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8822B+i), pBeamformerEntry->MacAddr[i]); -+ -+ /* Set partial AID */ -+ ODM_Write2Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8822B+6), pBeamformerEntry->P_AID); -+ -+ /* Fill our AID to 0x1680[11:0] and [13:12] = 2b'00, BF report segment select to 3895 bytes*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, 0x1680); -+ u1bTmp = (pBeamformerEntry->AID)&0xFFF; -+ ODM_Write1Byte(pDM_Odm, 0x1680, u1bTmp); -+ -+ /* Set 80us for leaving ndp_rx_standby_state */ -+ ODM_Write1Byte(pDM_Odm, 0x71B, 0x50); -+ -+ /* Set 0x6A0[14] = 1 to accept action_no_ack */ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1); -+ u1bTmp |= 0x40; -+ ODM_Write1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1, u1bTmp); -+ /* Set 0x6A2[5:4] = 1 to NDPA and BF report poll */ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_RXFLTMAP1_8822B); -+ u1bTmp |= 0x30; -+ ODM_Write1Byte(pDM_Odm, REG_RXFLTMAP1_8822B, u1bTmp); -+ -+ /*CSI report parameters of Beamformer*/ -+ Nc_index = halTxbf8822B_GetNrx(pDM_Odm); /* Depend on RF type */ -+ Nr_index = 1; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so Nr_index don't care*/ -+ grouping = 0; /*no grouping*/ -+ codebookinfo = 1; /*7 bit for psi, 9 bit for phi*/ -+ coefficientsize = 0; /*This is nothing really matter*/ -+ CSI_Param = (u2Byte)((coefficientsize<<10)|(codebookinfo<<8)|(grouping<<6)|(Nr_index<<3)|(Nc_index)); -+ ODM_Write2Byte(pDM_Odm, 0x6F4, CSI_Param); -+ -+ /*for B-Cut*/ -+ ODM_SetBBReg(pDM_Odm, 0x6A0 , BIT20, 0); -+ ODM_SetBBReg(pDM_Odm, 0x688 , BIT20, 0); -+ -+ } -+ -+ /*************MU BFee Entry Init*************/ -+ if ((pBeamformingInfo->beamformee_mu_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { -+ pBeamformeeEntry = &pBeamformingInfo->BeamformeeEntry[BFeeIdx]; -+ pBeamformeeEntry->is_mu_sta = TRUE; -+ for (i = 0; i < MAX_BEAMFORMEE_MU; i++) { -+ if ((pBeamformingInfo->beamformee_mu_reg_maping & BIT(i)) == 0) { -+ pBeamformingInfo->beamformee_mu_reg_maping |= BIT(i); -+ pBeamformeeEntry->mu_reg_index = i; -+ break; -+ } -+ } -+ -+ if (pBeamformeeEntry->mu_reg_index == 0xFF) { -+ /* There is no valid bit in beamformee_mu_reg_maping */ -+ RT_DISP(FBEAM, FBEAM_FUN, ("%s: ERROR! There is no valid bit in beamformee_mu_reg_maping!\n", __func__)); -+ return; -+ } -+ -+ /*User position table*/ -+ switch (pBeamformeeEntry->mu_reg_index) { -+ case 0: -+ gid_valid = 0x7fe; -+ user_position_l = 0x111110; -+ user_position_h = 0x0; -+ break; -+ case 1: -+ gid_valid = 0x7f806; -+ user_position_l = 0x11000004; -+ user_position_h = 0x11; -+ break; -+ case 2: -+ gid_valid = 0x1f81818; -+ user_position_l = 0x400040; -+ user_position_h = 0x11100; -+ break; -+ case 3: -+ gid_valid = 0x1e186060; -+ user_position_l = 0x4000400; -+ user_position_h = 0x1100040; -+ break; -+ case 4: -+ gid_valid = 0x66618180; -+ user_position_l = 0x40004000; -+ user_position_h = 0x10040400; -+ break; -+ case 5: -+ gid_valid = 0x79860600; -+ user_position_l = 0x40000; -+ user_position_h = 0x4404004; -+ break; -+ } -+ -+ for (i = 0; i < 8; i++) { -+ if (i < 4) { -+ pBeamformeeEntry->gid_valid[i] = (u1Byte)(gid_valid & 0xFF); -+ gid_valid = (gid_valid >> 8); -+ } else -+ pBeamformeeEntry->gid_valid[i] = 0; -+ } -+ for (i = 0; i < 16; i++) { -+ if (i < 4) -+ pBeamformeeEntry->user_position[i] = (u1Byte)((user_position_l >>(i*8)) & 0xFF); -+ else if (i < 8) -+ pBeamformeeEntry->user_position[i] = (u1Byte)((user_position_h >>((i-4)*8)) & 0xFF); -+ else -+ pBeamformeeEntry->user_position[i] = 0; -+ } -+ -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xDB); -+ -+ /*select MU STA table*/ -+ pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); -+ pBeamformingInfo->RegMUTxCtrl |= (pBeamformeeEntry->mu_reg_index << 8)&(BIT8|BIT9|BIT10); -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ -+ ODM_SetBBReg(pDM_Odm, 0x14c4 , bMaskDWord, 0); /*Reset gid_valid table*/ -+ ODM_SetBBReg(pDM_Odm, 0x14c8 , bMaskDWord, user_position_l); -+ ODM_SetBBReg(pDM_Odm, 0x14cc , bMaskDWord, user_position_h); -+ -+ /*set validity of MU STAs*/ -+ pBeamformingInfo->RegMUTxCtrl &= 0xFFFFFFC0; -+ pBeamformingInfo->RegMUTxCtrl |= pBeamformingInfo->beamformee_mu_reg_maping&0x3F; -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, RegMUTxCtrl = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", -+ __func__, pBeamformingInfo->RegMUTxCtrl, user_position_l, user_position_h)); -+ -+ value16 = ODM_Read2Byte(pDM_Odm, mu_reg[pBeamformeeEntry->mu_reg_index]); -+ value16 &= 0xFE00; /*Clear PAID*/ -+ value16 |= BIT9; /*Enable MU BFee*/ -+ value16 |= pBeamformeeEntry->P_AID; -+ ODM_Write2Byte(pDM_Odm, mu_reg[pBeamformeeEntry->mu_reg_index] , value16); -+ -+ /* 0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3); -+ u1bTmp |= 0xD0; /* Set bit 28, 30, 31 to 3b'111*/ -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3, u1bTmp); -+ /* Set NDPA to 6M*/ -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_RATE_8822B, 0x4); -+ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8822B); -+ u1bTmp &= 0xFC; /* Clear bit 0, 1*/ -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8822B, u1bTmp); -+ -+ u4bTmp = ODM_Read4Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B); -+ u4bTmp = ((u4bTmp & 0xFF0000FF) | 0x020200); /* Set [23:8] to 0x0202*/ -+ ODM_Write4Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, u4bTmp); -+ -+ /* Set 0x6A0[14] = 1 to accept action_no_ack */ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1); -+ u1bTmp |= 0x40; -+ ODM_Write1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1, u1bTmp); -+ /* End of MAC registers setting */ -+ -+ halTxbf8822B_RfMode(pDM_Odm, pBeamformingInfo, BFeeIdx); -+#if (SUPPORT_MU_BF == 1) -+ /*Special for plugfest*/ -+ delay_ms(50); /* wait for 4-way handshake ending*/ -+ SendSWVHTGIDMgntFrame(pDM_Odm, pBeamformeeEntry->MacAddr, BFeeIdx); -+#endif -+ -+ phydm_Beamforming_Notify(pDM_Odm); -+#if 1 -+ { -+ u4Byte ctrl_info_offset, index; -+ /*Set Ctrl Info*/ -+ ODM_Write2Byte(pDM_Odm, 0x140, 0x660); -+ ctrl_info_offset = 0x8000 + 32 * pBeamformeeEntry->MacId; -+ /*Reset Ctrl Info*/ -+ for (index = 0; index < 8; index++) -+ ODM_Write4Byte(pDM_Odm, ctrl_info_offset + index*4, 0); -+ -+ ODM_Write4Byte(pDM_Odm, ctrl_info_offset, (pBeamformeeEntry->mu_reg_index + 1) << 16); -+ ODM_Write1Byte(pDM_Odm, 0x81, 0x80); /*RPTBUF ready*/ -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, MacId = %d, ctrl_info_offset = 0x%x, mu_reg_index = %x\n", -+ __func__, pBeamformeeEntry->MacId, ctrl_info_offset, pBeamformeeEntry->mu_reg_index)); -+ } -+#endif -+ } -+ -+} -+ -+ -+VOID -+HalTxbf8822B_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMER_ENTRY pBeamformerEntry; -+ PRT_BEAMFORMEE_ENTRY pBeamformeeEntry; -+ u4Byte mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; -+ -+ if (Idx < BEAMFORMER_ENTRY_NUM) { -+ pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[Idx]; -+ pBeamformeeEntry = &pBeamformingInfo->BeamformeeEntry[Idx]; -+ } else -+ return; -+ -+ /*Clear P_AID of Beamformee*/ -+ /*Clear MAC address of Beamformer*/ -+ /*Clear Associated Bfmee Sel*/ -+ -+ if (pBeamformerEntry->BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xD8); -+ if (pBeamformerEntry->is_mu_ap == 0) { /*SU BFer */ -+ if (pBeamformerEntry->su_reg_index == 0) { -+ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8822B, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8822B+4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_TX_CSI_RPT_PARAM_BW20_8822B, 0); -+ } else { -+ ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8822B, 0); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8822B+4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_TX_CSI_RPT_PARAM_BW20_8822B+2, 0); -+ } -+ pBeamformingInfo->beamformer_su_reg_maping &= ~(BIT(pBeamformerEntry->su_reg_index)); -+ pBeamformerEntry->su_reg_index = 0xFF; -+ } else { /*MU BFer */ -+ /*set validity of MU STA0 and MU STA1*/ -+ pBeamformingInfo->RegMUTxCtrl &= 0xFFFFFFC0; -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ -+ ODM_Memory_Set(pDM_Odm, pBeamformerEntry->gid_valid, 0, 8); -+ ODM_Memory_Set(pDM_Odm, pBeamformerEntry->user_position, 0, 16); -+ pBeamformerEntry->is_mu_ap = FALSE; -+ } -+ } -+ -+ if (pBeamformeeEntry->BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ halTxbf8822B_RfMode(pDM_Odm, pBeamformingInfo, Idx); -+ if (pBeamformeeEntry->is_mu_sta == 0) { /*SU BFee*/ -+ if (pBeamformeeEntry->su_reg_index == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B, 0x0); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3)|BIT4|BIT6|BIT7); -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B, 0); -+ } else { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B+2, 0x0 | BIT14 | BIT15 | BIT12); -+ -+ ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+2, -+ ODM_Read2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+2) & 0x60); -+ } -+ pBeamformingInfo->beamformee_su_reg_maping &= ~(BIT(pBeamformeeEntry->su_reg_index)); -+ pBeamformeeEntry->su_reg_index = 0xFF; -+ } else { /*MU BFee */ -+ /*Disable sending NDPA & BF-rpt-poll to this BFee*/ -+ ODM_Write2Byte(pDM_Odm, mu_reg[pBeamformeeEntry->mu_reg_index] , 0); -+ /*set validity of MU STA*/ -+ pBeamformingInfo->RegMUTxCtrl &= ~(BIT(pBeamformeeEntry->mu_reg_index)); -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ -+ -+ pBeamformeeEntry->is_mu_sta = FALSE; -+ pBeamformingInfo->beamformee_mu_reg_maping &= ~(BIT(pBeamformeeEntry->mu_reg_index)); -+ pBeamformeeEntry->mu_reg_index = 0xFF; -+ } -+ } -+} -+ -+ -+/***********SU & MU BFee Entry Only when souding done****************/ -+VOID -+HalTxbf8822B_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte BeamCtrlVal, tmpVal; -+ u4Byte BeamCtrlReg; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry; -+ BOOLEAN is_mu_sounding = pBeamformingInfo->is_mu_sounding, is_bitmap_ready = FALSE; -+ u16 bitmap; -+ u8 idx, gid, i; -+ u8 id1, id0; -+ u32 gid_valid[6] = {0}; -+ u32 user_position_lsb[6] = {0}; -+ u32 user_position_msb[6] = {0}; -+ u32 value32; -+ BOOLEAN is_sounding_success[6] = {FALSE}; -+ -+ if (Idx < BEAMFORMEE_ENTRY_NUM) -+ pBeamformEntry = &pBeamformingInfo->BeamformeeEntry[Idx]; -+ else -+ return; -+ -+ /*SU sounding done */ -+ if (is_mu_sounding == FALSE) { -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ BeamCtrlVal = pBeamformEntry->MacId; -+ else -+ BeamCtrlVal = pBeamformEntry->P_AID; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, BeamformEntry.BeamformEntryState = %d", __func__, pBeamformEntry->BeamformEntryState)); -+ -+ if (pBeamformEntry->su_reg_index == 0) { -+ BeamCtrlReg = REG_TXBF_CTRL_8822B; -+ } else { -+ BeamCtrlReg = REG_TXBF_CTRL_8822B+2; -+ BeamCtrlVal |= BIT12|BIT14|BIT15; -+ } -+ -+ if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (pBeamformEntry->SoundBW == CHANNEL_WIDTH_20) -+ BeamCtrlVal |= BIT9; -+ else if (pBeamformEntry->SoundBW == CHANNEL_WIDTH_40) -+ BeamCtrlVal |= (BIT9|BIT10); -+ else if (pBeamformEntry->SoundBW == CHANNEL_WIDTH_80) -+ BeamCtrlVal |= (BIT9|BIT10|BIT11); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, Don't apply Vmatrix", __func__)); -+ BeamCtrlVal &= ~(BIT9|BIT10|BIT11); -+ } -+ -+ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); -+ /*disable NDP packet use beamforming */ -+ tmpVal = ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8822B); -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B, tmpVal|BIT15); -+ } else { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, MU Sounding Done\n", __func__)); -+ /*MU sounding done */ -+ if (1){//(pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, BEAMFORMING_ENTRY_STATE_PROGRESSED\n", __func__)); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0x1684, bMaskDWord); -+ is_sounding_success[0] = (value32 & BIT10)?1:0; -+ is_sounding_success[1] = (value32 & BIT26)?1:0; -+ value32 = ODM_GetBBReg(pDM_Odm, 0x1688, bMaskDWord); -+ is_sounding_success[2] = (value32 & BIT10)?1:0; -+ is_sounding_success[3] = (value32 & BIT26)?1:0; -+ value32 = ODM_GetBBReg(pDM_Odm, 0x168C, bMaskDWord); -+ is_sounding_success[4] = (value32 & BIT10)?1:0; -+ is_sounding_success[5] = (value32 & BIT26)?1:0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, is_sounding_success STA1:%d, STA2:%d, STA3:%d, STA4:%d, STA5:%d, STA6:%d\n", -+ __func__, is_sounding_success[0], is_sounding_success[1] , is_sounding_success[2] , is_sounding_success[3] , is_sounding_success[4] , is_sounding_success[5] )); -+ -+ value32 = ODM_GetBBReg(pDM_Odm, 0xF4C, 0xFFFF0000); -+ //ODM_SetBBReg(pDM_Odm, 0x19E0, bMaskHWord, 0xFFFF);/*Let MAC ignore bitmap*/ -+ -+ is_bitmap_ready = (BOOLEAN)((value32 & BIT15) >> 15); -+ bitmap = (u16)(value32 & 0x3FFF); -+ -+ for (idx = 0; idx < 15; idx++) { -+ if (idx < 5) {/*bit0~4*/ -+ id0 = 0; -+ id1 = (u8)(idx + 1); -+ } else if (idx < 9) { /*bit5~8*/ -+ id0 = 1; -+ id1 = (u8)(idx - 3); -+ } else if (idx < 12) { /*bit9~11*/ -+ id0 = 2; -+ id1 = (u8)(idx - 6); -+ } else if (idx < 14) { /*bit12~13*/ -+ id0 = 3; -+ id1 = (u8)(idx - 8); -+ } else { /*bit14*/ -+ id0 = 4; -+ id1 = (u8)(idx - 9); -+ } -+ if (bitmap & BIT(idx)) { -+ /*Pair 1*/ -+ gid = (idx << 1) + 1; -+ gid_valid[id0] |= (BIT(gid)); -+ gid_valid[id1] |= (BIT(gid)); -+ /*Pair 2*/ -+ gid += 1; -+ gid_valid[id0] |= (BIT(gid)); -+ gid_valid[id1] |= (BIT(gid)); -+ } else { -+ /*Pair 1*/ -+ gid = (idx << 1) + 1; -+ gid_valid[id0] &= ~(BIT(gid)); -+ gid_valid[id1] &= ~(BIT(gid)); -+ /*Pair 2*/ -+ gid += 1; -+ gid_valid[id0] &= ~(BIT(gid)); -+ gid_valid[id1] &= ~(BIT(gid)); -+ } -+ } -+ -+ for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { -+ pBeamformEntry = &pBeamformingInfo->BeamformeeEntry[i]; -+ if ((pBeamformEntry->is_mu_sta) && (pBeamformEntry->mu_reg_index < 6)) { -+ value32 = gid_valid[pBeamformEntry->mu_reg_index]; -+ for (idx = 0; idx < 4; idx++) { -+ pBeamformEntry->gid_valid[idx] = (u8)(value32 & 0xFF); -+ value32 = (value32 >> 8); -+ } -+ } -+ } -+ -+ for (idx = 0; idx < 6; idx++) { -+ pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); -+ pBeamformingInfo->RegMUTxCtrl |= ((idx<<8)&(BIT8|BIT9|BIT10)); -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ ODM_SetMACReg(pDM_Odm, 0x14C4, bMaskDWord, gid_valid[idx]); /*set MU STA gid valid table*/ -+ } -+ -+ /*Enable TxMU PPDU*/ -+ if (pBeamformingInfo->dbg_disable_mu_tx == FALSE) -+ pBeamformingInfo->RegMUTxCtrl |= BIT7; -+ else -+ pBeamformingInfo->RegMUTxCtrl &= ~BIT7; -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ } -+ } -+} -+ -+/*Only used for MU BFer Entry when get GID management frame (self is as MU STA)*/ -+VOID -+HalTxbf8822B_ConfigGtab( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMER_ENTRY pBeamformerEntry = NULL; -+ u4Byte gid_valid = 0, user_position_l = 0, user_position_h = 0, i; -+ -+ if (pBeamformingInfo->mu_ap_index < BEAMFORMER_ENTRY_NUM) -+ pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[pBeamformingInfo->mu_ap_index]; -+ else -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s==>\n", __func__)); -+ -+ /*For GID 0~31*/ -+ for (i = 0; i < 4; i++) -+ gid_valid |= (pBeamformerEntry->gid_valid[i] << (i<<3)); -+ for (i = 0; i < 8; i++) { -+ if (i < 4) -+ user_position_l |= (pBeamformerEntry->user_position[i] << (i << 3)); -+ else -+ user_position_h |= (pBeamformerEntry->user_position[i] << ((i - 4)<<3)); -+ } -+ /*select MU STA0 table*/ -+ pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ ODM_SetBBReg(pDM_Odm, 0x14c4, bMaskDWord, gid_valid); -+ ODM_SetBBReg(pDM_Odm, 0x14c8, bMaskDWord, user_position_l); -+ ODM_SetBBReg(pDM_Odm, 0x14cc, bMaskDWord, user_position_h); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: STA0: gid_valid = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", -+ __func__, gid_valid, user_position_l, user_position_h)); -+ -+ gid_valid = 0; -+ user_position_l = 0; -+ user_position_h = 0; -+ -+ /*For GID 32~64*/ -+ for (i = 4; i < 8; i++) -+ gid_valid |= (pBeamformerEntry->gid_valid[i] << ((i - 4)<<3)); -+ for (i = 8; i < 16; i++) { -+ if (i < 4) -+ user_position_l |= (pBeamformerEntry->user_position[i] << ((i - 8) << 3)); -+ else -+ user_position_h |= (pBeamformerEntry->user_position[i] << ((i - 12) << 3)); -+ } -+ /*select MU STA1 table*/ -+ pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); -+ pBeamformingInfo->RegMUTxCtrl |= BIT8; -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ ODM_SetBBReg(pDM_Odm, 0x14c4, bMaskDWord, gid_valid); -+ ODM_SetBBReg(pDM_Odm, 0x14c8, bMaskDWord, user_position_l); -+ ODM_SetBBReg(pDM_Odm, 0x14cc, bMaskDWord, user_position_h); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: STA1: gid_valid = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", -+ __func__, gid_valid, user_position_l, user_position_h)); -+ -+ /* Set validity of MU STA0 and MU STA1*/ -+ pBeamformingInfo->RegMUTxCtrl &= 0xFFFFFFC0; -+ pBeamformingInfo->RegMUTxCtrl |= 0x3; /* STA0, STA1*/ -+ ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); -+ -+} -+ -+ -+ -+#if 0 -+/*This function translate the bitmap to GTAB*/ -+VOID -+haltxbf8822b_gtab_translation( -+ IN PDM_ODM_T pDM_Odm -+) -+{ -+ u8 idx, gid; -+ u8 id1, id0; -+ u32 gid_valid[6] = {0}; -+ u32 user_position_lsb[6] = {0}; -+ u32 user_position_msb[6] = {0}; -+ -+ for (idx = 0; idx < 15; idx++) { -+ if (idx < 5) {/*bit0~4*/ -+ id0 = 0; -+ id1 = (u8)(idx + 1); -+ } else if (idx < 9) { /*bit5~8*/ -+ id0 = 1; -+ id1 = (u8)(idx - 3); -+ } else if (idx < 12) { /*bit9~11*/ -+ id0 = 2; -+ id1 = (u8)(idx - 6); -+ } else if (idx < 14) { /*bit12~13*/ -+ id0 = 3; -+ id1 = (u8)(idx - 8); -+ } else { /*bit14*/ -+ id0 = 4; -+ id1 = (u8)(idx - 9); -+ } -+ -+ /*Pair 1*/ -+ gid = (idx << 1) + 1; -+ gid_valid[id0] |= (1 << gid); -+ gid_valid[id1] |= (1 << gid); -+ if (gid < 16) { -+ /*user_position_lsb[id0] |= (0 << (gid << 1));*/ -+ user_position_lsb[id1] |= (1 << (gid << 1)); -+ } else { -+ /*user_position_msb[id0] |= (0 << ((gid - 16) << 1));*/ -+ user_position_msb[id1] |= (1 << ((gid - 16) << 1)); -+ } -+ -+ /*Pair 2*/ -+ gid += 1; -+ gid_valid[id0] |= (1 << gid); -+ gid_valid[id1] |= (1 << gid); -+ if (gid < 16) { -+ user_position_lsb[id0] |= (1 << (gid << 1)); -+ /*user_position_lsb[id1] |= (0 << (gid << 1));*/ -+ } else { -+ user_position_msb[id0] |= (1 << ((gid - 16) << 1)); -+ /*user_position_msb[id1] |= (0 << ((gid - 16) << 1));*/ -+ } -+ -+ } -+ -+ -+ for (idx = 0; idx < 6; idx++) { -+ /*DbgPrint("gid_valid[%d] = 0x%x\n", idx, gid_valid[idx]); -+ DbgPrint("user_position[%d] = 0x%x %x\n", idx, user_position_msb[idx], user_position_lsb[idx]);*/ -+ } -+} -+#endif -+ -+VOID -+HalTxbf8822B_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ) -+{ -+#if 0 -+ PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry+Idx; -+ -+ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ halTxbf8822B_DownloadNDPA(Adapter, Idx); -+ -+ halTxbf8822B_FwTxBFCmd(Adapter); -+#endif -+} -+ -+#endif -+ -+#if (defined(CONFIG_BB_TXBF_API)) -+/*this function is only used for BFer*/ -+VOID -+phydm_8822btxbf_rfmode( -+ IN PVOID pDM_VOID, -+ IN u1Byte SUBFeeCnt, -+ IN u1Byte MUBFeeCnt -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i, Nr_index = 0; -+ -+ if (pDM_Odm->RFType == ODM_1T1R) -+ return; -+ -+ if ((SUBFeeCnt > 0) || (MUBFeeCnt > 0)) { -+ for (i = ODM_RF_PATH_A; i <= ODM_RF_PATH_B; i++) { -+ ODM_SetRFReg(pDM_Odm, i, 0xEF, BIT19, 0x1); /*RF Mode table write enable*/ -+ ODM_SetRFReg(pDM_Odm, i, 0x33, 0xF, 3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, i, 0x3E, 0xfffff, 0x00036); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, i, 0x3F, 0xfffff, 0x5AFCE); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, i, 0xEF, BIT19, 0x0); /*RF Mode table write disable*/ -+ } -+ } -+ -+ if (SUBFeeCnt > 0 || MUBFeeCnt > 0) { -+ /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT28|BIT29, 0x2); /*enable BB TxBF ant mapping register*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT31, 1); /*ignore user since 8822B only 2Tx*/ -+ -+ /*Nsts = 2 AB*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); -+ -+ } else { -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT28|BIT29, 0x0); /*enable BB TxBF ant mapping register*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT31, 0); /*ignore user since 8822B only 2Tx*/ -+ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*1SS by path-A*/ -+ ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8822B, bMaskLWord, 0x430); /*2SS by path-A,B*/ -+ } -+ -+} -+ -+ -+/*this function is for BFer bug workaround*/ -+VOID -+phydm_8822b_sutxbfer_workaroud( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN EnableSUBfer, -+ IN u1Byte Nc, -+ IN u1Byte Nr, -+ IN u1Byte Ng, -+ IN u1Byte CB, -+ IN u1Byte BW, -+ IN BOOLEAN isVHT -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (EnableSUBfer) { -+ ODM_SetBBReg(pDM_Odm, 0x19f8, BIT22|BIT21|BIT20, 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x19f8, BIT25|BIT24|BIT23, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x19f8, BIT16, 0x1); -+ -+ if (isVHT) -+ ODM_SetBBReg(pDM_Odm, 0x19f0, BIT5|BIT4|BIT3|BIT2|BIT1|BIT0, 0x1f); -+ else -+ ODM_SetBBReg(pDM_Odm, 0x19f0, BIT5|BIT4|BIT3|BIT2|BIT1|BIT0, 0x22); -+ -+ ODM_SetBBReg(pDM_Odm, 0x19f0, BIT7|BIT6, Nc); -+ ODM_SetBBReg(pDM_Odm, 0x19f0, BIT9|BIT8, Nr); -+ ODM_SetBBReg(pDM_Odm, 0x19f0, BIT11|BIT10, Ng); -+ ODM_SetBBReg(pDM_Odm, 0x19f0, BIT13|BIT12, CB); -+ -+ ODM_SetBBReg(pDM_Odm, 0xb58, BIT3|BIT2, BW); -+ ODM_SetBBReg(pDM_Odm, 0xb58, BIT7|BIT6|BIT5|BIT4, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xb58, BIT9|BIT8, BW); -+ ODM_SetBBReg(pDM_Odm, 0xb58, BIT13|BIT12|BIT11|BIT10, 0x0); -+ } else -+ ODM_SetBBReg(pDM_Odm, 0x19f8, BIT16, 0x0); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] EnableSUBfer = %d, isVHT = %d\n", __func__, EnableSUBfer, isVHT)); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] Nc = %d, Nr = %d, Ng = %d, CB = %d, BW = %d\n", __func__, Nc, Nr, Ng, CB, BW)); -+ -+ -+} -+#endif -+#endif /* (RTL8822B_SUPPORT == 1)*/ -+ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbf8822b.h 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,87 @@ -+#ifndef __HAL_TXBF_8822B_H__ -+#define __HAL_TXBF_8822B_H__ -+ -+#if (RTL8822B_SUPPORT == 1) -+#if (BEAMFORMING_SUPPORT == 1) -+ -+VOID -+HalTxbf8822B_Init( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+HalTxbf8822B_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8822B_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbf8822B_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+VOID -+HalTxbf8822B_ConfigGtab( -+ IN PVOID pDM_VOID -+ ); -+ -+VOID -+HalTxbf8822B_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+#else -+#define HalTxbf8822B_Init(pDM_VOID) -+#define HalTxbf8822B_Enter(pDM_VOID, Idx) -+#define HalTxbf8822B_Leave(pDM_VOID, Idx) -+#define HalTxbf8822B_Status(pDM_VOID, Idx) -+#define HalTxbf8822B_FwTxBF(pDM_VOID, Idx) -+#define HalTxbf8822B_ConfigGtab(pDM_VOID) -+ -+#endif -+ -+#if (defined(CONFIG_BB_TXBF_API)) -+VOID -+phydm_8822btxbf_rfmode( -+ IN PVOID pDM_VOID, -+ IN u1Byte SUBFeeCnt, -+ IN u1Byte MUBFeeCnt -+ ); -+ -+VOID -+phydm_8822b_sutxbfer_workaroud( -+ IN PVOID pDM_VOID, -+ IN BOOLEAN EnableSUBfer, -+ IN u1Byte Nc, -+ IN u1Byte Nr, -+ IN u1Byte Ng, -+ IN u1Byte CB, -+ IN u1Byte BW, -+ IN BOOLEAN isVHT -+ ); -+ -+#else -+#define phydm_8822btxbf_rfmode(pDM_VOID, SUBFeeCnt, MUBFeeCnt) -+#define phydm_8822b_sutxbfer_workaroud(pDM_VOID, EnableSUBfer, Nc, Nr, Ng, CB, BW, isVHT) -+#endif -+ -+#else -+#define HalTxbf8822B_Init(pDM_VOID) -+#define HalTxbf8822B_Enter(pDM_VOID, Idx) -+#define HalTxbf8822B_Leave(pDM_VOID, Idx) -+#define HalTxbf8822B_Status(pDM_VOID, Idx) -+#define HalTxbf8822B_FwTxBF(pDM_VOID, Idx) -+#define HalTxbf8822B_ConfigGtab(pDM_VOID) -+ -+#endif -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.c 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,1502 @@ -+//============================================================ -+// Description: -+// -+// This file is for TXBF interface mechanism -+// -+//============================================================ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+Beamforming_GidPAid( -+ PADAPTER Adapter, -+ PRT_TCB pTcb -+) -+{ -+ u1Byte Idx = 0; -+ u1Byte RA[6] ={0}; -+ pu1Byte pHeader = GET_FRAME_OF_FIRST_FRAG(Adapter, pTcb); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ -+ if (Adapter->HardwareType < HARDWARE_TYPE_RTL8192EE) -+ return; -+ else if (IS_WIRELESS_MODE_N(Adapter) == FALSE) -+ return; -+ -+#if (SUPPORT_MU_BF == 1) -+ if (pTcb->TxBFPktType == RT_BF_PKT_TYPE_BROADCAST_NDPA) { /* MU NDPA */ -+#else -+ if (0) { -+#endif -+ /* Fill G_ID and P_AID */ -+ pTcb->G_ID = 63; -+ if (pBeamInfo->FirstMUBFeeIndex < BEAMFORMEE_ENTRY_NUM) { -+ pTcb->P_AID = pBeamInfo->BeamformeeEntry[pBeamInfo->FirstMUBFeeIndex].P_AID; -+ RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, pTcb->G_ID, pTcb->P_AID)); -+ } -+ } else { -+ GET_80211_HDR_ADDRESS1(pHeader, &RA); -+ -+ // VHT SU PPDU carrying one or more group addressed MPDUs or -+ // Transmitting a VHT NDP intended for multiple recipients -+ if (MacAddr_isBcst(RA) || MacAddr_isMulticast(RA) || pTcb->macId == MAC_ID_STATIC_FOR_BROADCAST_MULTICAST) { -+ pTcb->G_ID = 63; -+ pTcb->P_AID = 0; -+ } else if (ACTING_AS_AP(Adapter)) { -+ u2Byte AID = (u2Byte) (MacIdGetOwnerAssociatedClientAID(Adapter, pTcb->macId) & 0x1ff); /*AID[0:8]*/ -+ -+ /*RT_DISP(FBEAM, FBEAM_FUN, ("@%s pTcb->macId=0x%X, AID=0x%X\n", __func__, pTcb->macId, AID));*/ -+ pTcb->G_ID = 63; -+ -+ if (AID == 0) /*A PPDU sent by an AP to a non associated STA*/ -+ pTcb->P_AID = 0; -+ else { /*Sent by an AP and addressed to a STA associated with that AP*/ -+ u2Byte BSSID = 0; -+ GET_80211_HDR_ADDRESS2(pHeader, &RA); -+ BSSID = ((RA[5] & 0xf0) >> 4) ^ (RA[5] & 0xf); /*BSSID[44:47] xor BSSID[40:43]*/ -+ pTcb->P_AID = (AID + BSSID *32) & 0x1ff; /*(dec(A) + dec(B)*32) mod 512*/ -+ } -+ } else if (ACTING_AS_IBSS(Adapter)) { -+ pTcb->G_ID = 63; -+ /*P_AID for infrasturcture mode; MACID for ad-hoc mode. */ -+ pTcb->P_AID = pTcb->macId; -+ } else if (MgntLinkStatusQuery(Adapter)) { /*Addressed to AP*/ -+ pTcb->G_ID = 0; -+ GET_80211_HDR_ADDRESS1(pHeader, &RA); -+ pTcb->P_AID = RA[5]; /*RA[39:47]*/ -+ pTcb->P_AID = (pTcb->P_AID << 1) | (RA[4] >> 7 ); -+ } else { -+ pTcb->G_ID = 63; -+ pTcb->P_AID = 0; -+ } -+ /*RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, pTcb->G_ID, pTcb->P_AID));*/ -+ } -+} -+ -+ -+RT_STATUS -+Beamforming_GetReportFrame( -+ IN PADAPTER Adapter, -+ IN PRT_RFD pRfd, -+ IN POCTET_STRING pPduOS -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; -+ pu1Byte pMIMOCtrlField, pCSIReport, pCSIMatrix; -+ u1Byte Idx, Nc, Nr, CH_W; -+ u2Byte CSIMatrixLen = 0; -+ -+ ACT_PKT_TYPE pktType = ACT_PKT_TYPE_UNKNOWN; -+ -+ //Memory comparison to see if CSI report is the same with previous one -+ pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, Frame_Addr2(*pPduOS), &Idx); -+ -+ if (pBeamformEntry == NULL) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Beamforming_GetReportFrame: Cannot find entry by addr\n")); -+ return RT_STATUS_FAILURE; -+ } -+ -+ pktType = PacketGetActionFrameType(pPduOS); -+ -+ //-@ Modified by David -+ if (pktType == ACT_PKT_VHT_COMPRESSED_BEAMFORMING) { -+ pMIMOCtrlField = pPduOS->Octet + 26; -+ Nc = ((*pMIMOCtrlField) & 0x7) + 1; -+ Nr = (((*pMIMOCtrlField) & 0x38) >> 3) + 1; -+ CH_W = (((*pMIMOCtrlField) & 0xC0) >> 6); -+ pCSIMatrix = pMIMOCtrlField + 3 + Nc; //24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(Nc=2) -+ CSIMatrixLen = pPduOS->Length - 26 -3 -Nc; -+ } else if (pktType == ACT_PKT_HT_COMPRESSED_BEAMFORMING) { -+ pMIMOCtrlField = pPduOS->Octet + 26; -+ Nc = ((*pMIMOCtrlField) & 0x3) + 1; -+ Nr = (((*pMIMOCtrlField) & 0xC) >> 2) + 1; -+ CH_W = (((*pMIMOCtrlField) & 0x10) >> 4); -+ pCSIMatrix = pMIMOCtrlField + 6 + Nr; //24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(Nc=2) -+ CSIMatrixLen = pPduOS->Length - 26 -6 -Nr; -+ } else -+ return RT_STATUS_SUCCESS; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx=%d, pkt type=%d, Nc=%d, Nr=%d, CH_W=%d\n", __func__, Idx, pktType, Nc, Nr, CH_W)); -+ -+ return RT_STATUS_SUCCESS; -+} -+ -+ -+VOID -+ConstructHTNDPAPacket( -+ PADAPTER Adapter, -+ pu1Byte RA, -+ pu1Byte Buffer, -+ pu4Byte pLength, -+ CHANNEL_WIDTH BW -+ ) -+{ -+ u2Byte Duration= 0; -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ OCTET_STRING pNDPAFrame,ActionContent; -+ u1Byte ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; -+ -+ PlatformZeroMemory(Buffer, 32); -+ -+ SET_80211_HDR_FRAME_CONTROL(Buffer,0); -+ -+ SET_80211_HDR_ORDER(Buffer, 1); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(Buffer,Type_Action_No_Ack); -+ -+ SET_80211_HDR_ADDRESS1(Buffer, RA); -+ SET_80211_HDR_ADDRESS2(Buffer, Adapter->CurrentAddress); -+ SET_80211_HDR_ADDRESS3(Buffer, pMgntInfo->Bssid); -+ -+ Duration = 2*aSifsTime + 40; -+ -+ if (BW == CHANNEL_WIDTH_40) -+ Duration+= 87; -+ else -+ Duration+= 180; -+ -+ SET_80211_HDR_DURATION(Buffer, Duration); -+ -+ //HT control field -+ SET_HT_CTRL_CSI_STEERING(Buffer+sMacHdrLng, 3); -+ SET_HT_CTRL_NDP_ANNOUNCEMENT(Buffer+sMacHdrLng, 1); -+ -+ FillOctetString(pNDPAFrame, Buffer, sMacHdrLng+sHTCLng); -+ -+ FillOctetString(ActionContent, ActionHdr, 4); -+ PacketAppendData(&pNDPAFrame, ActionContent); -+ -+ *pLength = 32; -+} -+ -+ -+ -+ -+BOOLEAN -+SendFWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u4Byte BufLen; -+ pu1Byte BufAddr; -+ u1Byte DescLen = 0, Idx = 0, NDPTxRate; -+ PADAPTER pDefAdapter = GetDefaultAdapter(Adapter); -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pBeamformEntry == NULL) -+ return FALSE; -+ -+ NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetFWBuffer(pDefAdapter, &pTcb, &pBuf)) { -+#if(DEV_BUS_TYPE != RT_PCI_INTERFACE) -+ DescLen = Adapter->HWDescHeadLength - pHalData->USBALLDummyLength; -+#endif -+ BufAddr = pBuf->Buffer.VirtualAddress + DescLen; -+ -+ ConstructHTNDPAPacket( -+ Adapter, -+ RA, -+ BufAddr, -+ &BufLen, -+ BW -+ ); -+ -+ pTcb->PacketLength = BufLen + DescLen; -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; -+ -+ pTcb->BWOfPacket = BW; -+ -+ if(ACTING_AS_IBSS(Adapter) || ACTING_AS_AP(Adapter)) -+ pTcb->G_ID = 63; -+ -+ pTcb->P_AID = pBeamformEntry->P_AID; -+ pTcb->DataRate = NDPTxRate; /*rate of NDP decide by Nr*/ -+ -+ Adapter->HalFunc.CmdSendPacketHandler(Adapter, pTcb, pBuf, pTcb->PacketLength, DESC_PACKET_TYPE_NORMAL, FALSE); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+ -+BOOLEAN -+SendSWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u1Byte Idx = 0, NDPTxRate = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { -+ ConstructHTNDPAPacket( -+ Adapter, -+ RA, -+ pBuf->Buffer.VirtualAddress, -+ &pTcb->PacketLength, -+ BW -+ ); -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; -+ -+ pTcb->BWOfPacket = BW; -+ -+ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+ -+ -+VOID -+ConstructVHTNDPAPacket( -+ IN PDM_ODM_T pDM_Odm, -+ pu1Byte RA, -+ u2Byte AID, -+ pu1Byte Buffer, -+ pu4Byte pLength, -+ CHANNEL_WIDTH BW -+ ) -+{ -+ u2Byte Duration= 0; -+ u1Byte Sequence = 0; -+ pu1Byte pNDPAFrame = Buffer; -+ RT_NDPA_STA_INFO STAInfo; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ u1Byte Idx = 0; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ // Frame control. -+ SET_80211_HDR_FRAME_CONTROL(pNDPAFrame, 0); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(pNDPAFrame, Type_NDPA); -+ -+ SET_80211_HDR_ADDRESS1(pNDPAFrame, RA); -+ SET_80211_HDR_ADDRESS2(pNDPAFrame, pBeamformEntry->MyMacAddr); -+ -+ Duration = 2*aSifsTime + 44; -+ -+ if (BW == CHANNEL_WIDTH_80) -+ Duration += 40; -+ else if(BW == CHANNEL_WIDTH_40) -+ Duration+= 87; -+ else -+ Duration+= 180; -+ -+ SET_80211_HDR_DURATION(pNDPAFrame, Duration); -+ -+ Sequence = *(pDM_Odm->pSoundingSeq) << 2; -+ ODM_MoveMemory(pDM_Odm, pNDPAFrame+16, &Sequence, 1); -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS) || phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP) == FALSE) -+ AID = 0; -+ -+ STAInfo.AID = AID; -+ STAInfo.FeedbackType = 0; -+ STAInfo.NcIndex = 0; -+ -+ ODM_MoveMemory(pDM_Odm, pNDPAFrame+17, (pu1Byte)&STAInfo, 2); -+ -+ *pLength = 19; -+} -+ -+ -+BOOLEAN -+SendFWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u4Byte BufLen; -+ pu1Byte BufAddr; -+ u1Byte DescLen = 0, Idx = 0, NDPTxRate = 0; -+ PADAPTER pDefAdapter = GetDefaultAdapter(Adapter); -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry =phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pBeamformEntry == NULL) -+ return FALSE; -+ -+ NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetFWBuffer(pDefAdapter, &pTcb, &pBuf)) { -+#if(DEV_BUS_TYPE != RT_PCI_INTERFACE) -+ DescLen = Adapter->HWDescHeadLength - pHalData->USBALLDummyLength; -+#endif -+ BufAddr = pBuf->Buffer.VirtualAddress + DescLen; -+ -+ ConstructVHTNDPAPacket( -+ pDM_Odm, -+ RA, -+ AID, -+ BufAddr, -+ &BufLen, -+ BW -+ ); -+ -+ pTcb->PacketLength = BufLen + DescLen; -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; -+ -+ pTcb->BWOfPacket = BW; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS) || phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) -+ pTcb->G_ID = 63; -+ -+ pTcb->P_AID = pBeamformEntry->P_AID; -+ pTcb->DataRate = NDPTxRate; /*decide by Nr*/ -+ -+ Adapter->HalFunc.CmdSendPacketHandler(Adapter, pTcb, pBuf, pTcb->PacketLength, DESC_PACKET_TYPE_NORMAL, FALSE); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End, ret=%d\n", __func__, ret)); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+ -+ -+BOOLEAN -+SendSWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u1Byte Idx = 0, NDPTxRate = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { -+ ConstructVHTNDPAPacket( -+ pDM_Odm, -+ RA, -+ AID, -+ pBuf->Buffer.VirtualAddress, -+ &pTcb->PacketLength, -+ BW -+ ); -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; -+ pTcb->BWOfPacket = BW; -+ -+ /*rate of NDP decide by Nr*/ -+ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+#ifdef SUPPORT_MU_BF -+#if (SUPPORT_MU_BF == 1) -+/* -+// Description: On VHT GID management frame by an MU beamformee. -+// -+// 2015.05.20. Created by tynli. -+*/ -+RT_STATUS -+Beamforming_GetVHTGIDMgntFrame( -+ IN PADAPTER Adapter, -+ IN PRT_RFD pRfd, -+ IN POCTET_STRING pPduOS -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -+ RT_STATUS rtStatus = RT_STATUS_SUCCESS; -+ pu1Byte pBuffer = NULL; -+ pu1Byte pRaddr = NULL; -+ u1Byte MemStatus[8] = {0}, UserPos[16] = {0}; -+ u1Byte idx; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMER_ENTRY pBeamformEntry = &pBeamInfo->BeamformerEntry[pBeamInfo->mu_ap_index]; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] On VHT GID mgnt frame!\n", __func__)); -+ -+ /* Check length*/ -+ if (pPduOS->Length < (FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY+16)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Beamforming_GetVHTGIDMgntFrame(): Invalid length (%d)\n", pPduOS->Length)); -+ return RT_STATUS_INVALID_LENGTH; -+ } -+ -+ /* Check RA*/ -+ pRaddr = (pu1Byte)(pPduOS->Octet)+4; -+ if (!eqMacAddr(pRaddr, Adapter->CurrentAddress)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Beamforming_GetVHTGIDMgntFrame(): Drop because of RA error.\n")); -+ return RT_STATUS_PKT_DROP; -+ } -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "On VHT GID Mgnt Frame ==>:\n", pPduOS->Octet, pPduOS->Length); -+ -+ /*Parsing Membership Status Array*/ -+ pBuffer = pPduOS->Octet + FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY; -+ for (idx = 0; idx < 8; idx++) { -+ MemStatus[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(pBuffer+idx); -+ pBeamformEntry->gid_valid[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(pBuffer+idx); -+ } -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "MemStatus: ", MemStatus, 8); -+ -+ /* Parsing User Position Array*/ -+ pBuffer = pPduOS->Octet + FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY; -+ for (idx = 0; idx < 16; idx++) { -+ UserPos[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(pBuffer+idx); -+ pBeamformEntry->user_position[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(pBuffer+idx); -+ } -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "UserPos: ", UserPos, 16); -+ -+ /* Group ID detail printed*/ -+ { -+ u1Byte i, j; -+ u1Byte tmpVal; -+ u2Byte tmpVal2; -+ -+ for (i = 0; i < 8; i++) { -+ tmpVal = MemStatus[i]; -+ tmpVal2 = ((UserPos[i*2 + 1] << 8) & 0xFF00) + (UserPos[i * 2] & 0xFF); -+ for (j = 0; j < 8; j++) { -+ if ((tmpVal >> j) & BIT0) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Use Group ID (%d), User Position (%d)\n", -+ (i*8+j), (tmpVal2 >> 2 * j)&0x3)); -+ } -+ } -+ } -+ } -+ -+ /* Indicate GID frame to IHV service. */ -+ { -+ u1Byte Indibuffer[24] = {0}; -+ u1Byte Indioffset = 0; -+ -+ PlatformMoveMemory(Indibuffer + Indioffset, pBeamformEntry->gid_valid, 8); -+ Indioffset += 8; -+ PlatformMoveMemory(Indibuffer + Indioffset, pBeamformEntry->user_position, 16); -+ Indioffset += 16; -+ -+ PlatformIndicateCustomStatus( -+ Adapter, -+ RT_CUSTOM_EVENT_VHT_RECV_GID_MGNT_FRAME, -+ RT_CUSTOM_INDI_TARGET_IHV, -+ Indibuffer, -+ Indioffset); -+ } -+ -+ /* Config HW GID table */ -+ halComTxbf_ConfigGtab(pDM_Odm); -+ -+ return rtStatus; -+} -+ -+/* -+// Description: Construct VHT Group ID (GID) management frame. -+// -+// 2015.05.20. Created by tynli. -+*/ -+VOID -+ConstructVHTGIDMgntFrame( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte RA, -+ IN PRT_BEAMFORMEE_ENTRY pBeamformEntry, -+ OUT pu1Byte Buffer, -+ OUT pu4Byte pLength -+ -+) -+{ -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ OCTET_STRING osFTMFrame, tmp; -+ -+ FillOctetString(osFTMFrame, Buffer, 0); -+ *pLength = 0; -+ -+ ConstructMaFrameHdr( -+ Adapter, -+ RA, -+ ACT_CAT_VHT, -+ ACT_VHT_GROUPID_MANAGEMENT, -+ &osFTMFrame); -+ -+ /* Membership Status Array*/ -+ FillOctetString(tmp, pBeamformEntry->gid_valid, 8); -+ PacketAppendData(&osFTMFrame, tmp); -+ -+ /* User Position Array*/ -+ FillOctetString(tmp, pBeamformEntry->user_position, 16); -+ PacketAppendData(&osFTMFrame, tmp); -+ -+ *pLength = osFTMFrame.Length; -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "ConstructVHTGIDMgntFrame():\n", Buffer, *pLength); -+} -+ -+BOOLEAN -+SendSWVHTGIDMgntFrame( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u1Byte Idx -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u1Byte DataRate = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = &pBeamInfo->BeamformeeEntry[Idx]; -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { -+ ConstructVHTGIDMgntFrame( -+ pDM_Odm, -+ RA, -+ pBeamformEntry, -+ pBuf->Buffer.VirtualAddress, -+ &pTcb->PacketLength -+ ); -+ -+ pTcb->BWOfPacket = CHANNEL_WIDTH_20; -+ DataRate = MGN_6M; -+ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, DataRate); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+ -+/* -+// Description: Construct VHT beamforming report poll. -+// -+// 2015.05.20. Created by tynli. -+*/ -+VOID -+ConstructVHTBFReportPoll( -+ IN PDM_ODM_T pDM_Odm, -+ IN pu1Byte RA, -+ OUT pu1Byte Buffer, -+ OUT pu4Byte pLength -+) -+{ -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ pu1Byte pBFRptPoll = Buffer; -+ -+ /* Frame control*/ -+ SET_80211_HDR_FRAME_CONTROL(pBFRptPoll, 0); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(pBFRptPoll, Type_Beamforming_Report_Poll); -+ -+ /* Duration*/ -+ SET_80211_HDR_DURATION(pBFRptPoll, 100); -+ -+ /* RA*/ -+ SET_VHT_BF_REPORT_POLL_RA(pBFRptPoll, RA); -+ -+ /* TA*/ -+ SET_VHT_BF_REPORT_POLL_TA(pBFRptPoll, Adapter->CurrentAddress); -+ -+ /* Feedback Segment Retransmission Bitmap*/ -+ SET_VHT_BF_REPORT_POLL_FEEDBACK_SEG_RETRAN_BITMAP(pBFRptPoll, 0xFF); -+ -+ *pLength = 17; -+ -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "ConstructVHTBFReportPoll():\n", Buffer, *pLength); -+ -+} -+ -+BOOLEAN -+SendSWVHTBFReportPoll( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN BOOLEAN bFinalPoll -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u1Byte Idx = 0, DataRate = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { -+ ConstructVHTBFReportPoll( -+ pDM_Odm, -+ RA, -+ pBuf->Buffer.VirtualAddress, -+ &pTcb->PacketLength -+ ); -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; /* need?*/ -+ pTcb->BWOfPacket = CHANNEL_WIDTH_20; -+ -+ if (bFinalPoll) -+ pTcb->TxBFPktType = RT_BF_PKT_TYPE_FINAL_BF_REPORT_POLL; -+ else -+ pTcb->TxBFPktType = RT_BF_PKT_TYPE_BF_REPORT_POLL; -+ -+ DataRate = MGN_6M; /* Legacy OFDM rate*/ -+ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, DataRate); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "SendSWVHTBFReportPoll():\n", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+ -+} -+ -+ -+/* -+// Description: Construct VHT MU NDPA packet. -+// We should combine this function with ConstructVHTNDPAPacket() in the future. -+// -+// 2015.05.21. Created by tynli. -+*/ -+VOID -+ConstructVHTMUNDPAPacket( -+ IN PDM_ODM_T pDM_Odm, -+ IN CHANNEL_WIDTH BW, -+ OUT pu1Byte Buffer, -+ OUT pu4Byte pLength -+ ) -+{ -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ u2Byte Duration = 0; -+ u1Byte Sequence = 0; -+ pu1Byte pNDPAFrame = Buffer; -+ RT_NDPA_STA_INFO STAInfo; -+ u1Byte idx; -+ u1Byte DestAddr[6] = {0}; -+ PRT_BEAMFORMEE_ENTRY pEntry = NULL; -+ -+ /* Fill the first MU BFee entry (STA1) MAC addr to destination address then -+ HW will change A1 to broadcast addr. 2015.05.28. Suggested by SD1 Chunchu. */ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ pEntry = &(pBeamInfo->BeamformeeEntry[idx]); -+ if (pEntry->is_mu_sta) { -+ cpMacAddr(DestAddr, pEntry->MacAddr); -+ break; -+ } -+ } -+ if (pEntry == NULL) -+ return; -+ -+ /* Frame control.*/ -+ SET_80211_HDR_FRAME_CONTROL(pNDPAFrame, 0); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(pNDPAFrame, Type_NDPA); -+ -+ SET_80211_HDR_ADDRESS1(pNDPAFrame, DestAddr); -+ SET_80211_HDR_ADDRESS2(pNDPAFrame, pEntry->MyMacAddr); -+ -+ /*--------------------------------------------*/ -+ /* Need to modify "Duration" to MU consideration. */ -+ Duration = 2*aSifsTime + 44; -+ -+ if (BW == CHANNEL_WIDTH_80) -+ Duration += 40; -+ else if(BW == CHANNEL_WIDTH_40) -+ Duration+= 87; -+ else -+ Duration+= 180; -+ /*--------------------------------------------*/ -+ -+ SET_80211_HDR_DURATION(pNDPAFrame, Duration); -+ -+ Sequence = *(pDM_Odm->pSoundingSeq) << 2; -+ ODM_MoveMemory(pDM_Odm, pNDPAFrame + 16, &Sequence, 1); -+ -+ *pLength = 17; -+ -+ /* Construct STA info. for multiple STAs*/ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ pEntry = &(pBeamInfo->BeamformeeEntry[idx]); -+ if (pEntry->is_mu_sta) { -+ STAInfo.AID = pEntry->AID; -+ STAInfo.FeedbackType = 1; /* 1'b1: MU*/ -+ STAInfo.NcIndex = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get BeamformeeEntry idx(%d), AID =%d\n", __func__, idx, pEntry->AID)); -+ -+ ODM_MoveMemory(pDM_Odm, pNDPAFrame+(*pLength), (pu1Byte)&STAInfo, 2); -+ *pLength += 2; -+ } -+ } -+ -+} -+ -+BOOLEAN -+SendSWVHTMUNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u1Byte NDPTxRate = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ -+ NDPTxRate = MGN_VHT2SS_MCS0; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { -+ ConstructVHTMUNDPAPacket( -+ pDM_Odm, -+ BW, -+ pBuf->Buffer.VirtualAddress, -+ &pTcb->PacketLength -+ ); -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; -+ pTcb->BWOfPacket = BW; -+ pTcb->TxBFPktType = RT_BF_PKT_TYPE_BROADCAST_NDPA; -+ -+ /*rate of NDP decide by Nr*/ -+ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+ -+VOID -+DBG_ConstructVHTMUNDPAPacket( -+ IN PDM_ODM_T pDM_Odm, -+ IN CHANNEL_WIDTH BW, -+ OUT pu1Byte Buffer, -+ OUT pu4Byte pLength -+ ) -+{ -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ u2Byte Duration = 0; -+ u1Byte Sequence = 0; -+ pu1Byte pNDPAFrame = Buffer; -+ RT_NDPA_STA_INFO STAInfo; -+ u1Byte idx; -+ u1Byte DestAddr[6] = {0}; -+ PRT_BEAMFORMEE_ENTRY pEntry = NULL; -+ -+ BOOLEAN is_STA1 = FALSE; -+ -+ -+ /* Fill the first MU BFee entry (STA1) MAC addr to destination address then -+ HW will change A1 to broadcast addr. 2015.05.28. Suggested by SD1 Chunchu. */ -+ for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { -+ pEntry = &(pBeamInfo->BeamformeeEntry[idx]); -+ if (pEntry->is_mu_sta) { -+ if (is_STA1 == FALSE) { -+ is_STA1 = TRUE; -+ continue; -+ } else { -+ cpMacAddr(DestAddr, pEntry->MacAddr); -+ break; -+ } -+ } -+ } -+ -+ /* Frame control.*/ -+ SET_80211_HDR_FRAME_CONTROL(pNDPAFrame, 0); -+ SET_80211_HDR_TYPE_AND_SUBTYPE(pNDPAFrame, Type_NDPA); -+ -+ SET_80211_HDR_ADDRESS1(pNDPAFrame, DestAddr); -+ SET_80211_HDR_ADDRESS2(pNDPAFrame, pDM_Odm->CurrentAddress); -+ -+ /*--------------------------------------------*/ -+ /* Need to modify "Duration" to MU consideration. */ -+ Duration = 2*aSifsTime + 44; -+ -+ if (BW == CHANNEL_WIDTH_80) -+ Duration += 40; -+ else if (BW == CHANNEL_WIDTH_40) -+ Duration += 87; -+ else -+ Duration += 180; -+ /*--------------------------------------------*/ -+ -+ SET_80211_HDR_DURATION(pNDPAFrame, Duration); -+ -+ Sequence = *(pDM_Odm->pSoundingSeq) << 2; -+ ODM_MoveMemory(pDM_Odm, pNDPAFrame + 16, &Sequence, 1); -+ -+ *pLength = 17; -+ -+ /*STA2's STA Info*/ -+ STAInfo.AID = pEntry->AID; -+ STAInfo.FeedbackType = 1; /* 1'b1: MU */ -+ STAInfo.NcIndex = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get BeamformeeEntry idx(%d), AID =%d\n", __func__, idx, pEntry->AID)); -+ -+ ODM_MoveMemory(pDM_Odm, pNDPAFrame+(*pLength), (pu1Byte)&STAInfo, 2); -+ *pLength += 2; -+ -+} -+ -+BOOLEAN -+DBG_SendSWVHTMUNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_TCB pTcb; -+ PRT_TX_LOCAL_BUFFER pBuf; -+ BOOLEAN ret = TRUE; -+ u1Byte NDPTxRate = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PADAPTER Adapter = pBeamInfo->SourceAdapter; -+ -+ NDPTxRate = MGN_VHT2SS_MCS0; -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { -+ DBG_ConstructVHTMUNDPAPacket( -+ pDM_Odm, -+ BW, -+ pBuf->Buffer.VirtualAddress, -+ &pTcb->PacketLength -+ ); -+ -+ pTcb->bTxEnableSwCalcDur = TRUE; -+ pTcb->BWOfPacket = BW; -+ pTcb->TxBFPktType = RT_BF_PKT_TYPE_UNICAST_NDPA; -+ -+ /*rate of NDP decide by Nr*/ -+ MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); -+ } else -+ ret = FALSE; -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (ret) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); -+ -+ return ret; -+} -+ -+ -+#endif /*#if (SUPPORT_MU_BF == 1)*/ -+#endif /*#ifdef SUPPORT_MU_BF*/ -+ -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+u4Byte -+Beamforming_GetReportFrame( -+ IN PVOID pDM_VOID, -+ union recv_frame *precv_frame -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u4Byte ret = _SUCCESS; -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; -+ pu1Byte pframe = precv_frame->u.hdr.rx_data; -+ u4Byte frame_len = precv_frame->u.hdr.len; -+ pu1Byte TA; -+ u1Byte Idx, offset; -+ -+ -+ /*Memory comparison to see if CSI report is the same with previous one*/ -+ TA = GetAddr2Ptr(pframe); -+ pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, TA, &Idx); -+ if(pBeamformEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) -+ offset = 31; /*24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ -+ else if(pBeamformEntry->BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT) -+ offset = 34; /*24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ -+ else -+ return ret; -+ -+ -+ return ret; -+} -+ -+ -+BOOLEAN -+SendFWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u1Byte ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; -+ u1Byte *pframe; -+ u2Byte *fctrl; -+ u2Byte duration = 0; -+ u1Byte aSifsTime = 0, NDPTxRate = 0, Idx = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); -+ return _FALSE; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ -+ pattrib->qsel = QSLT_BEACON; -+ NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ pattrib->rate = NDPTxRate; -+ pattrib->bwmode = BW; -+ pattrib->order = 1; -+ pattrib->subtype = WIFI_ACTION_NOACK; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetOrderBit(pframe); -+ SetFrameSubType(pframe, WIFI_ACTION_NOACK); -+ -+ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ if( pmlmeext->cur_wireless_mode == WIRELESS_11B) -+ aSifsTime = 10; -+ else -+ aSifsTime = 16; -+ -+ duration = 2*aSifsTime + 40; -+ -+ if(BW == CHANNEL_WIDTH_40) -+ duration+= 87; -+ else -+ duration+= 180; -+ -+ SetDuration(pframe, duration); -+ -+ //HT control field -+ SET_HT_CTRL_CSI_STEERING(pframe+24, 3); -+ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe+24, 1); -+ -+ _rtw_memcpy(pframe+28, ActionHdr, 4); -+ -+ pattrib->pktlen = 32; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+ -+BOOLEAN -+SendSWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u1Byte ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; -+ pu1Byte pframe; -+ pu2Byte fctrl; -+ u2Byte duration = 0; -+ u1Byte aSifsTime = 0, NDPTxRate = 0, Idx = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); -+ return _FALSE; -+ } -+ -+ /*update attribute*/ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ pattrib->qsel = QSLT_MGNT; -+ pattrib->rate = NDPTxRate; -+ pattrib->bwmode = BW; -+ pattrib->order = 1; -+ pattrib->subtype = WIFI_ACTION_NOACK; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetOrderBit(pframe); -+ SetFrameSubType(pframe, WIFI_ACTION_NOACK); -+ -+ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ if (pmlmeext->cur_wireless_mode == WIRELESS_11B) -+ aSifsTime = 10; -+ else -+ aSifsTime = 16; -+ -+ duration = 2*aSifsTime + 40; -+ -+ if (BW == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ SetDuration(pframe, duration); -+ -+ /*HT control field*/ -+ SET_HT_CTRL_CSI_STEERING(pframe+24, 3); -+ SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe+24, 1); -+ -+ _rtw_memcpy(pframe+28, ActionHdr, 4); -+ -+ pattrib->pktlen = 32; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+ -+BOOLEAN -+SendFWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ pu1Byte pframe; -+ pu2Byte fctrl; -+ u2Byte duration = 0; -+ u1Byte sequence = 0, aSifsTime = 0, NDPTxRate= 0, Idx = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ RT_NDPA_STA_INFO sta_info; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); -+ return _FALSE; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ _rtw_memcpy(pattrib->ra, RA, ETH_ALEN); -+ update_mgntframe_attrib(Adapter, pattrib); -+ -+ pattrib->qsel = QSLT_BEACON; -+ NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ pattrib->rate = NDPTxRate; -+ pattrib->bwmode = BW; -+ pattrib->subtype = WIFI_NDPA; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetFrameSubType(pframe, WIFI_NDPA); -+ -+ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); -+ -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ duration = 2*aSifsTime + 44; -+ -+ if(BW == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if(BW == CHANNEL_WIDTH_40) -+ duration+= 87; -+ else -+ duration+= 180; -+ -+ SetDuration(pframe, duration); -+ -+ sequence = pBeamInfo->SoundingSequence<< 2; -+ if (pBeamInfo->SoundingSequence >= 0x3f) -+ pBeamInfo->SoundingSequence = 0; -+ else -+ pBeamInfo->SoundingSequence++; -+ -+ _rtw_memcpy(pframe+16, &sequence,1); -+ -+ if (((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ AID = 0; -+ -+ sta_info.AID = AID; -+ sta_info.FeedbackType = 0; -+ sta_info.NcIndex= 0; -+ -+ _rtw_memcpy(pframe+17, (u8 *)&sta_info, 2); -+ -+ pattrib->pktlen = 19; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ -+ return _TRUE; -+} -+ -+ -+ -+BOOLEAN -+SendSWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ RT_NDPA_STA_INFO ndpa_sta_info; -+ u1Byte NDPTxRate = 0, sequence = 0, aSifsTime = 0, Idx = 0; -+ pu1Byte pframe; -+ pu2Byte fctrl; -+ u2Byte duration = 0; -+ PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); -+ PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); -+ -+ NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); -+ return _FALSE; -+ } -+ -+ /*update attribute*/ -+ pattrib = &pmgntframe->attrib; -+ _rtw_memcpy(pattrib->ra, RA, ETH_ALEN); -+ update_mgntframe_attrib(Adapter, pattrib); -+ pattrib->qsel = QSLT_MGNT; -+ pattrib->rate = NDPTxRate; -+ pattrib->bwmode = BW; -+ pattrib->subtype = WIFI_NDPA; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ -+ SetFrameSubType(pframe, WIFI_NDPA); -+ -+ _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); -+ -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ duration = 2*aSifsTime + 44; -+ -+ if (BW == CHANNEL_WIDTH_80) -+ duration += 40; -+ else if (BW == CHANNEL_WIDTH_40) -+ duration += 87; -+ else -+ duration += 180; -+ -+ SetDuration(pframe, duration); -+ -+ sequence = pBeamInfo->SoundingSequence << 2; -+ if (pBeamInfo->SoundingSequence >= 0x3f) -+ pBeamInfo->SoundingSequence = 0; -+ else -+ pBeamInfo->SoundingSequence++; -+ -+ _rtw_memcpy(pframe+16, &sequence, 1); -+ if (((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ AID = 0; -+ -+ ndpa_sta_info.AID = AID; -+ ndpa_sta_info.FeedbackType = 0; -+ ndpa_sta_info.NcIndex = 0; -+ -+ _rtw_memcpy(pframe+17, (u8 *)&ndpa_sta_info, 2); -+ -+ pattrib->pktlen = 19; -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(Adapter, pmgntframe); -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] [%d]\n", __func__, __LINE__)); -+ -+ return _TRUE; -+} -+ -+ -+#endif -+ -+ -+VOID -+Beamforming_GetNDPAFrame( -+ IN PVOID pDM_VOID, -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN OCTET_STRING pduOS -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ union recv_frame *precv_frame -+#endif -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ pu1Byte TA ; -+ u1Byte Idx, Sequence; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ pu1Byte pNDPAFrame = pduOS.Octet; -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ pu1Byte pNDPAFrame = precv_frame->u.hdr.rx_data; -+#endif -+ PRT_BEAMFORMER_ENTRY pBeamformerEntry = NULL; /*Modified By Jeffery @2014-10-29*/ -+ -+ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_DISP_DATA(FBEAM, FBEAM_DATA, "Beamforming_GetNDPAFrame\n", pduOS.Octet, pduOS.Length); -+ if (IsCtrlNDPA(pNDPAFrame) == FALSE) -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ if (GetFrameSubType(pNDPAFrame) != WIFI_NDPA) -+#endif -+ return; -+ else if (!(pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821))) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] not 8812 or 8821A, return\n", __func__)); -+ return; -+ } -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ TA = Frame_Addr2(pduOS); -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ TA = GetAddr2Ptr(pNDPAFrame); -+#endif -+ /*Remove signaling TA. */ -+ TA[0] = TA[0] & 0xFE; -+ -+ pBeamformerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, TA, &Idx); // Modified By Jeffery @2014-10-29 -+ -+ /*Break options for Clock Reset*/ -+ if (pBeamformerEntry == NULL) -+ return; -+ else if (!(pBeamformerEntry->BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU)) -+ return; -+ /*LogSuccess: As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is NO LONGER needed !2015-04-10, Jeffery*/ -+ /*ClockResetTimes: While BFer entry always doesn't receive our CSI, clock will reset again and again.So ClockResetTimes is limited to 5 times.2015-04-13, Jeffery*/ -+ else if ((pBeamformerEntry->LogSuccess == 1) || (pBeamformerEntry->ClockResetTimes == 5)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] LogSeq=%d, PreLogSeq=%d, LogRetryCnt=%d, LogSuccess=%d, ClockResetTimes=%d, clock reset is no longer needed.\n", -+ __func__, pBeamformerEntry->LogSeq, pBeamformerEntry->PreLogSeq, pBeamformerEntry->LogRetryCnt, pBeamformerEntry->LogSuccess, pBeamformerEntry->ClockResetTimes)); -+ -+ return; -+ } -+ -+ Sequence = (pNDPAFrame[16]) >> 2; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start, Sequence=%d, LogSeq=%d, PreLogSeq=%d, LogRetryCnt=%d, ClockResetTimes=%d, LogSuccess=%d\n", -+ __func__, Sequence, pBeamformerEntry->LogSeq, pBeamformerEntry->PreLogSeq, pBeamformerEntry->LogRetryCnt, pBeamformerEntry->ClockResetTimes, pBeamformerEntry->LogSuccess)); -+ -+ if ((pBeamformerEntry->LogSeq != 0) && (pBeamformerEntry->PreLogSeq != 0)) { -+ /*Success condition*/ -+ if ((pBeamformerEntry->LogSeq != Sequence) && (pBeamformerEntry->PreLogSeq != pBeamformerEntry->LogSeq)) { -+ /* break option for clcok reset, 2015-03-30, Jeffery */ -+ pBeamformerEntry->LogRetryCnt = 0; -+ /*As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is no longer needed.*/ -+ /*That is, LogSuccess is NOT needed to be reset to zero, 2015-04-13, Jeffery*/ -+ pBeamformerEntry->LogSuccess = 1; -+ -+ } else {/*Fail condition*/ -+ -+ if (pBeamformerEntry->LogRetryCnt == 5) { -+ pBeamformerEntry->ClockResetTimes++; -+ pBeamformerEntry->LogRetryCnt = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Clock Reset!!! ClockResetTimes=%d\n", -+ __func__, pBeamformerEntry->ClockResetTimes)); -+ HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_CLK, NULL); -+ -+ } else -+ pBeamformerEntry->LogRetryCnt++; -+ } -+ } -+ -+ /*Update LogSeq & PreLogSeq*/ -+ pBeamformerEntry->PreLogSeq = pBeamformerEntry->LogSeq; -+ pBeamformerEntry->LogSeq = Sequence; -+ -+} -+ -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfinterface.h 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,162 @@ -+#ifndef __HAL_TXBF_INTERFACE_H__ -+#define __HAL_TXBF_INTERFACE_H__ -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+VOID -+Beamforming_GidPAid( -+ PADAPTER Adapter, -+ PRT_TCB pTcb -+ ); -+ -+RT_STATUS -+Beamforming_GetReportFrame( -+ IN PADAPTER Adapter, -+ IN PRT_RFD pRfd, -+ IN POCTET_STRING pPduOS -+ ); -+ -+VOID -+Beamforming_GetNDPAFrame( -+ IN PVOID pDM_VOID, -+ IN OCTET_STRING pduOS -+ ); -+ -+BOOLEAN -+SendFWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+BOOLEAN -+SendFWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+BOOLEAN -+SendSWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+BOOLEAN -+SendSWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+#if (SUPPORT_MU_BF == 1) -+RT_STATUS -+Beamforming_GetVHTGIDMgntFrame( -+ IN PADAPTER Adapter, -+ IN PRT_RFD pRfd, -+ IN POCTET_STRING pPduOS -+ ); -+ -+BOOLEAN -+SendSWVHTGIDMgntFrame( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u1Byte Idx -+ ); -+ -+BOOLEAN -+SendSWVHTBFReportPoll( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN BOOLEAN bFinalPoll -+ ); -+ -+BOOLEAN -+SendSWVHTMUNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN CHANNEL_WIDTH BW -+ ); -+#else -+#define Beamforming_GetVHTGIDMgntFrame(Adapter, pRfd, pPduOS) RT_STATUS_FAILURE -+#define SendSWVHTGIDMgntFrame(pDM_VOID, RA) -+#define SendSWVHTBFReportPoll(pDM_VOID, RA, bFinalPoll) -+#define SendSWVHTMUNDPAPacket(pDM_VOID, BW) -+#endif -+ -+ -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ -+u4Byte -+Beamforming_GetReportFrame( -+ IN PVOID pDM_VOID, -+ union recv_frame *precv_frame -+ ); -+ -+BOOLEAN -+SendFWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+BOOLEAN -+SendSWHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+BOOLEAN -+SendFWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+BOOLEAN -+SendSWVHTNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN pu1Byte RA, -+ IN u2Byte AID, -+ IN CHANNEL_WIDTH BW -+ ); -+#endif -+ -+VOID -+Beamforming_GetNDPAFrame( -+ IN PVOID pDM_VOID, -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ IN OCTET_STRING pduOS -+#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -+ union recv_frame *precv_frame -+#endif -+); -+ -+BOOLEAN -+DBG_SendSWVHTMUNDPAPacket( -+ IN PVOID pDM_VOID, -+ IN CHANNEL_WIDTH BW -+ ); -+ -+#else -+#define Beamforming_GetNDPAFrame(pDM_Odm, _PduOS) -+#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -+#define Beamforming_GetReportFrame(Adapter, precv_frame) RT_STATUS_FAILURE -+#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+#define Beamforming_GetReportFrame(Adapter, pRfd, pPduOS) RT_STATUS_FAILURE -+#define Beamforming_GetVHTGIDMgntFrame(Adapter, pRfd, pPduOS) RT_STATUS_FAILURE -+#endif -+#define SendFWHTNDPAPacket(pDM_VOID, RA, BW) -+#define SendSWHTNDPAPacket(pDM_VOID, RA, BW) -+#define SendFWVHTNDPAPacket(pDM_VOID, RA, AID, BW) -+#define SendSWVHTNDPAPacket(pDM_VOID, RA, AID, BW) -+#define SendSWVHTGIDMgntFrame(pDM_VOID, RA, idx) -+#define SendSWVHTBFReportPoll(pDM_VOID, RA, bFinalPoll) -+#define SendSWVHTMUNDPAPacket(pDM_VOID, BW) -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.c 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,527 @@ -+//============================================================ -+// Description: -+// -+// This file is for 8812/8821/8811 TXBF mechanism -+// -+//============================================================ -+#include "mp_precomp.h" -+#include "../phydm_precomp.h" -+ -+#if (BEAMFORMING_SUPPORT == 1) -+#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -+VOID -+HalTxbf8812A_setNDPArate( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW, -+ IN u1Byte Rate -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8812A, (Rate << 2 | BW)); -+ -+} -+ -+VOID -+halTxbfJaguar_RfMode( -+ IN PVOID pDM_VOID, -+ IN PRT_BEAMFORMING_INFO pBeamInfo -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ if (pDM_Odm->RFType == ODM_1T1R) -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] set TxIQGen\n", __func__)); -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000, 0x1); /*RF Mode table write enable*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000, 0x1); /*RF Mode table write enable*/ -+ -+ if (pBeamInfo->beamformee_su_cnt > 0) { -+ // Paath_A -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ -+ // Path_B -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ -+ } else { -+ // Paath_A -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ -+ // Path_B -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ -+ } -+ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000, 0x0); /*RF Mode table write disable*/ -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000, 0x0); /*RF Mode table write disable*/ -+ -+ if (pBeamInfo->beamformee_su_cnt > 0) -+ ODM_SetBBReg(pDM_Odm, rTxPath_Jaguar, bMaskByte1, 0x33); -+ else -+ ODM_SetBBReg(pDM_Odm, rTxPath_Jaguar, bMaskByte1, 0x11); -+} -+ -+ -+VOID -+halTxbfJaguar_DownloadNDPA( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte u1bTmp = 0, tmpReg422 = 0, Head_Page; -+ u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; -+ BOOLEAN bSendBeacon = FALSE; -+ u1Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; /*default reseved 1 page for the IC type which is undefined.*/ -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *pDM_Odm->pbFwDwRsvdPageInProgress = TRUE; -+#endif -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (Idx == 0) -+ Head_Page = 0xFE; -+ else -+ Head_Page = 0xFE; -+ -+ Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu1Byte)&TxPageBndy); -+ -+ /*Set REG_CR bit 8. DMA beacon by SW.*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8812A + 1); -+ ODM_Write1Byte(pDM_Odm, REG_CR_8812A + 1, (u1bTmp | BIT0)); -+ -+ -+ /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ -+ tmpReg422 = ODM_Read1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8812A + 2); -+ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8812A + 2, tmpReg422 & (~BIT6)); -+ -+ if (tmpReg422 & BIT6) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("SetBeamformDownloadNDPA_8812(): There is an Adapter is sending beacon.\n")); -+ bSendBeacon = TRUE; -+ } -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 1, Head_Page); -+ -+ do { -+ /*Clear beacon valid check bit.*/ -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); -+ ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 2, (BcnValidReg | BIT0)); -+ -+ /*download NDPA rsvd page.*/ -+ if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) -+ Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); -+ else -+ Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); -+ -+ /*check rsvd page download OK.*/ -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); -+ count = 0; -+ while (!(BcnValidReg & BIT0) && count < 20) { -+ count++; -+ ODM_delay_ms(10); -+ BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); -+ } -+ DLBcnCount++; -+ } while (!(BcnValidReg & BIT0) && DLBcnCount < 5); -+ -+ if (!(BcnValidReg & BIT0)) -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Download RSVD page failed!\n", __func__)); -+ -+ /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 1, TxPageBndy); -+ -+ /*To make sure that if there exists an adapter which would like to send beacon.*/ -+ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ -+ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause*/ -+ /*the beacon cannot be sent by HW.*/ -+ /*2010.06.23. Added by tynli.*/ -+ if (bSendBeacon) -+ ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8812A + 2, tmpReg422); -+ -+ /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ -+ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ -+ u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8812A + 1); -+ ODM_Write1Byte(pDM_Odm, REG_CR_8812A + 1, (u1bTmp & (~BIT0))); -+ -+ pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ *pDM_Odm->pbFwDwRsvdPageInProgress = FALSE; -+#endif -+} -+ -+ -+VOID -+halTxbfJaguar_FwTxBFCmd( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Idx, Period0 = 0, Period1 = 0; -+ u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; -+ u1Byte u1TxBFParm[3] = {0}; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { -+ /*Modified by David*/ -+ if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { -+ if (Idx == 0) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) -+ PageNum0 = 0xFE; -+ else -+ PageNum0 = 0xFF; /*stop sounding*/ -+ Period0 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } else if (Idx == 1) { -+ if (pBeamInfo->BeamformeeEntry[Idx].bSound) -+ PageNum1 = 0xFE; -+ else -+ PageNum1 = 0xFF; /*stop sounding*/ -+ Period1 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); -+ } -+ } -+ } -+ -+ u1TxBFParm[0] = PageNum0; -+ u1TxBFParm[1] = PageNum1; -+ u1TxBFParm[2] = (Period1 << 4) | Period0; -+ ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_TXBF, 3, u1TxBFParm); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, -+ ("[%s] PageNum0 = %d Period0 = %d, PageNum1 = %d Period1 %d\n", __func__, PageNum0, Period0, PageNum1, Period1)); -+} -+ -+ -+VOID -+HalTxbfJaguar_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte BFerBFeeIdx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte i = 0; -+ u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; -+ u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); -+ u4Byte CSI_Param; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ u2Byte STAid = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Start!\n", __func__)); -+ -+ halTxbfJaguar_RfMode(pDM_Odm, pBeamformingInfo); -+ -+ if (pDM_Odm->RFType == ODM_2T2R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CSI_CONTENT_VALUE, bMaskDWord, 0x00000000); /*Nc =2*/ -+ else -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CSI_CONTENT_VALUE, bMaskDWord, 0x01081008); /*Nc =1*/ -+ -+ if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { -+ BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; -+ -+ /*Sounding protocol control*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xCB); -+ -+ /*MAC address/Partial AID of Beamformer*/ -+ if (BFerIdx == 0) { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_BFMER0_INFO_8812A + i), BeamformerEntry.MacAddr[i]); -+ /*CSI report use legacy ofdm so don't need to fill P_AID. */ -+ /*PlatformEFIOWrite2Byte(Adapter, REG_BFMER0_INFO_8812A+6, BeamformEntry.P_AID); */ -+ } else { -+ for (i = 0; i < 6 ; i++) -+ ODM_Write1Byte(pDM_Odm, (REG_BFMER1_INFO_8812A + i), BeamformerEntry.MacAddr[i]); -+ /*CSI report use legacy ofdm so don't need to fill P_AID.*/ -+ /*PlatformEFIOWrite2Byte(Adapter, REG_BFMER1_INFO_8812A+6, BeamformEntry.P_AID);*/ -+ } -+ -+ /*CSI report parameters of Beamformee*/ -+ if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) { -+ if (pDM_Odm->RFType == ODM_2T2R) -+ CSI_Param = 0x01090109; -+ else -+ CSI_Param = 0x01080108; -+ } else { -+ if (pDM_Odm->RFType == ODM_2T2R) -+ CSI_Param = 0x03090309; -+ else -+ CSI_Param = 0x03080308; -+ } -+ -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8812A, CSI_Param); -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8812A, CSI_Param); -+ ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8812A, CSI_Param); -+ -+ /*Timeout value for MAC to leave NDP_RX_standby_state (60 us, Test chip) (80 us, MP chip)*/ -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A + 3, 0x50); -+ } -+ -+ -+ if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ STAid = BeamformeeEntry.MacId; -+ else -+ STAid = BeamformeeEntry.P_AID; -+ -+ /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ -+ if (BFeeIdx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A, STAid); -+ ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 3) | BIT4 | BIT6 | BIT7); -+ } else -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 2, STAid | BIT12 | BIT14 | BIT15); -+ -+ /*CSI report parameters of Beamformee*/ -+ if (BFeeIdx == 0) { -+ /*Get BIT24 & BIT25*/ -+ u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 3) & 0x3; -+ -+ ODM_Write1Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 3, tmp | 0x60); -+ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A, STAid | BIT9); -+ } else { -+ /*Set BIT25*/ -+ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2, STAid | 0xE200); -+ } -+ phydm_Beamforming_Notify(pDM_Odm); -+ } -+} -+ -+ -+VOID -+HalTxbfJaguar_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMER_ENTRY BeamformerEntry; -+ RT_BEAMFORMEE_ENTRY BeamformeeEntry; -+ -+ if (Idx < BEAMFORMER_ENTRY_NUM) { -+ BeamformerEntry = pBeamformingInfo->BeamformerEntry[Idx]; -+ BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[Idx]; -+ } else -+ return; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Start!, IDx = %d\n", __func__, Idx)); -+ -+ /*Clear P_AID of Beamformee*/ -+ /*Clear MAC address of Beamformer*/ -+ /*Clear Associated Bfmee Sel*/ -+ -+ if (BeamformerEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xC8); -+ if (Idx == 0) { -+ ODM_Write4Byte(pDM_Odm, REG_BFMER0_INFO_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_BFMER0_INFO_8812A + 4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8812A, 0); -+ } else { -+ ODM_Write4Byte(pDM_Odm, REG_BFMER1_INFO_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_BFMER1_INFO_8812A + 4, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8812A, 0); -+ ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8812A, 0); -+ } -+ } -+ -+ if (BeamformeeEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { -+ halTxbfJaguar_RfMode(pDM_Odm, pBeamformingInfo); -+ if (Idx == 0) { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A, 0x0); -+ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A, 0); -+ } else { -+ ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 2, ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 2) & 0xF000); -+ ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2, ODM_Read2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2) & 0x60); -+ } -+ } -+ -+} -+ -+ -+VOID -+HalTxbfJaguar_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte BeamCtrlVal; -+ u4Byte BeamCtrlReg; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ RT_BEAMFORMEE_ENTRY BeamformEntry = pBeamInfo->BeamformeeEntry[Idx]; -+ -+ if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) -+ BeamCtrlVal = BeamformEntry.MacId; -+ else -+ BeamCtrlVal = BeamformEntry.P_AID; -+ -+ if (Idx == 0) -+ BeamCtrlReg = REG_TXBF_CTRL_8812A; -+ else { -+ BeamCtrlReg = REG_TXBF_CTRL_8812A + 2; -+ BeamCtrlVal |= BIT12 | BIT14 | BIT15; -+ } -+ -+ if ((BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) && (pBeamInfo->applyVmatrix == TRUE)) { -+ if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) -+ BeamCtrlVal |= BIT9; -+ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) -+ BeamCtrlVal |= (BIT9 | BIT10); -+ else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_80) -+ BeamCtrlVal |= (BIT9 | BIT10 | BIT11); -+ } else -+ BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BeamCtrlVal = 0x%x!\n", __func__, BeamCtrlVal)); -+ -+ ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); -+} -+ -+ -+ -+VOID -+HalTxbfJaguar_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) -+ halTxbfJaguar_DownloadNDPA(pDM_Odm, Idx); -+ -+ halTxbfJaguar_FwTxBFCmd(pDM_Odm); -+} -+ -+ -+VOID -+HalTxbfJaguar_Patch( -+ IN PVOID pDM_VOID, -+ IN u1Byte Operation -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (pBeamInfo->BeamformCap == BEAMFORMING_CAP_NONE) -+ return; -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ if (Operation == SCAN_OPT_BACKUP_BAND0) -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xC8); -+ else if (Operation == SCAN_OPT_RESTORE) -+ ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xCB); -+#endif -+} -+ -+VOID -+HalTxbfJaguar_Clk_8812A( -+ IN PVOID pDM_VOID -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u2Byte u2btmp; -+ u1Byte Count = 0, u1btmp; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -+ -+ if (*(pDM_Odm->pbScanInProcess)) { -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] return by Scan\n", __func__)); -+ return; -+ } -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ /*Stop PCIe TxDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_PCIE_CTRL_REG_8812A + 1, 0xFE); -+#endif -+ -+ /*Stop Usb TxDMA*/ -+#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -+ RT_DISABLE_FUNC(Adapter, DF_TX_BIT); -+ PlatformReturnAllPendingTxPackets(Adapter); -+#else -+ rtw_write_port_cancel(Adapter); -+#endif -+ -+ /*Wait TXFF empty*/ -+ for (Count = 0; Count < 100; Count++) { -+ u2btmp = ODM_Read2Byte(pDM_Odm, REG_TXPKT_EMPTY_8812A); -+ u2btmp = u2btmp & 0xfff; -+ if (u2btmp != 0xfff) { -+ ODM_delay_ms(10); -+ continue; -+ } else -+ break; -+ } -+ -+ /*TX pause*/ -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE_8812A, 0xFF); -+ -+ /*Wait TX State Machine OK*/ -+ for (Count = 0; Count < 100; Count++) { -+ if (ODM_Read4Byte(pDM_Odm, REG_SCH_TXCMD_8812A) != 0) -+ continue; -+ else -+ break; -+ } -+ -+ -+ /*Stop RX DMA path*/ -+ u1btmp = ODM_Read1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A); -+ ODM_Write1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A, u1btmp | BIT2); -+ -+ for (Count = 0; Count < 100; Count++) { -+ u1btmp = ODM_Read1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A); -+ if (u1btmp & BIT1) -+ break; -+ else -+ ODM_delay_ms(10); -+ } -+ -+ /*Disable clock*/ -+ ODM_Write1Byte(pDM_Odm, REG_SYS_CLKR_8812A + 1, 0xf0); -+ /*Disable 320M*/ -+ ODM_Write1Byte(pDM_Odm, REG_AFE_PLL_CTRL_8812A + 3, 0x8); -+ /*Enable 320M*/ -+ ODM_Write1Byte(pDM_Odm, REG_AFE_PLL_CTRL_8812A + 3, 0xa); -+ /*Enable clock*/ -+ ODM_Write1Byte(pDM_Odm, REG_SYS_CLKR_8812A + 1, 0xfc); -+ -+ -+ /*Release Tx pause*/ -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE_8812A, 0); -+ -+ /*Enable RX DMA path*/ -+ u1btmp = ODM_Read1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A); -+ ODM_Write1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A, u1btmp & (~BIT2)); -+#if DEV_BUS_TYPE == RT_PCI_INTERFACE -+ /*Enable PCIe TxDMA*/ -+ ODM_Write1Byte(pDM_Odm, REG_PCIE_CTRL_REG_8812A + 1, 0); -+#endif -+ /*Start Usb TxDMA*/ -+ RT_ENABLE_FUNC(Adapter, DF_TX_BIT); -+} -+ -+#endif -+ -+ -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/haltxbfjaguar.h 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,75 @@ -+#ifndef __HAL_TXBF_JAGUAR_H__ -+#define __HAL_TXBF_JAGUAR_H__ -+#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -+#if (BEAMFORMING_SUPPORT == 1) -+ -+VOID -+HalTxbf8812A_setNDPArate( -+ IN PVOID pDM_VOID, -+ IN u1Byte BW, -+ IN u1Byte Rate -+); -+ -+ -+VOID -+HalTxbfJaguar_Enter( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbfJaguar_Leave( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbfJaguar_Status( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbfJaguar_FwTxBF( -+ IN PVOID pDM_VOID, -+ IN u1Byte Idx -+ ); -+ -+ -+VOID -+HalTxbfJaguar_Patch( -+ IN PVOID pDM_VOID, -+ IN u1Byte Operation -+ ); -+ -+ -+VOID -+HalTxbfJaguar_Clk_8812A( -+ IN PVOID pDM_VOID -+ ); -+#else -+ -+#define HalTxbf8812A_setNDPArate(pDM_VOID, BW, Rate) -+#define HalTxbfJaguar_Enter(pDM_VOID, Idx) -+#define HalTxbfJaguar_Leave(pDM_VOID, Idx) -+#define HalTxbfJaguar_Status(pDM_VOID, Idx) -+#define HalTxbfJaguar_FwTxBF(pDM_VOID, Idx) -+#define HalTxbfJaguar_Patch(pDM_VOID, Operation) -+#define HalTxbfJaguar_Clk_8812A(pDM_VOID) -+#endif -+#else -+ -+#define HalTxbf8812A_setNDPArate(pDM_VOID, BW, Rate) -+#define HalTxbfJaguar_Enter(pDM_VOID, Idx) -+#define HalTxbfJaguar_Leave(pDM_VOID, Idx) -+#define HalTxbfJaguar_Status(pDM_VOID, Idx) -+#define HalTxbfJaguar_FwTxBF(pDM_VOID, Idx) -+#define HalTxbfJaguar_Patch(pDM_VOID, Operation) -+#define HalTxbfJaguar_Clk_8812A(pDM_VOID) -+#endif -+ -+#endif // #ifndef __HAL_TXBF_JAGUAR_H__ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.c 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,180 @@ -+#include "mp_precomp.h" -+#include "phydm_precomp.h" -+ -+#if (defined(CONFIG_BB_TXBF_API)) -+#if (RTL8822B_SUPPORT == 1) -+/*Add by YuChen for 8822B MU-MIMO API*/ -+ -+/*this function is only used for BFer*/ -+u1Byte -+phydm_get_ndpa_rate( -+ IN PVOID pDM_VOID -+ ) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte NDPARate = ODM_RATE6M; -+ -+ if (pDM_Odm->RSSI_Min >= 30) /*link RSSI > 30%*/ -+ NDPARate = ODM_RATE24M; -+ else if (pDM_Odm->RSSI_Min <= 25) -+ NDPARate = ODM_RATE6M; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] NDPARate = 0x%x\n", __func__, NDPARate)); -+ -+ return NDPARate; -+ -+} -+ -+/*this function is only used for BFer*/ -+u1Byte -+phydm_get_beamforming_sounding_info( -+ IN PVOID pDM_VOID, -+ IN pu2Byte Troughput, -+ IN u1Byte Total_BFee_Num, -+ IN pu1Byte TxRate -+ ) -+{ -+ u1Byte idx = 0; -+ u1Byte soundingdecision = 0xff; -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ -+ for (idx = 0; idx < Total_BFee_Num; idx++) { -+ if (((TxRate[idx] >= ODM_RATEVHTSS3MCS7) && (TxRate[idx] <= ODM_RATEVHTSS3MCS9))) -+ soundingdecision = soundingdecision & ~(1<= 500) -+ snding_score = 100; -+ else if (Throughput >= 450) -+ snding_score = 90; -+ else if (Throughput >= 400) -+ snding_score = 80; -+ else if (Throughput >= 350) -+ snding_score = 70; -+ else if (Throughput >= 300) -+ snding_score = 60; -+ else if (Throughput >= 250) -+ snding_score = 50; -+ else if (Throughput >= 200) -+ snding_score = 40; -+ else if (Throughput >= 150) -+ snding_score = 30; -+ else if (Throughput >= 100) -+ snding_score = 20; -+ else if (Throughput >= 50) -+ snding_score = 10; -+ else -+ snding_score = 0; -+ -+ ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] snding_score = 0x%d\n", __func__, snding_score)); -+ -+ return snding_score; -+ -+} -+ -+ -+#endif -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+u1Byte -+Beamforming_GetHTNDPTxRate( -+ IN PVOID pDM_VOID, -+ u1Byte CompSteeringNumofBFer -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Nr_index = 0; -+ u1Byte NDPTxRate; -+ /*Find Nr*/ -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), CompSteeringNumofBFer); -+ else -+#endif -+ Nr_index = TxBF_Nr(1, CompSteeringNumofBFer); -+ -+ switch (Nr_index) { -+ case 1: -+ NDPTxRate = ODM_MGN_MCS8; -+ break; -+ -+ case 2: -+ NDPTxRate = ODM_MGN_MCS16; -+ break; -+ -+ case 3: -+ NDPTxRate = ODM_MGN_MCS24; -+ break; -+ -+ default: -+ NDPTxRate = ODM_MGN_MCS8; -+ break; -+ } -+ -+return NDPTxRate; -+ -+} -+ -+u1Byte -+Beamforming_GetVHTNDPTxRate( -+ IN PVOID pDM_VOID, -+ u1Byte CompSteeringNumofBFer -+) -+{ -+ PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -+ u1Byte Nr_index = 0; -+ u1Byte NDPTxRate; -+ /*Find Nr*/ -+#if (RTL8814A_SUPPORT == 1) -+ if (pDM_Odm->SupportICType & ODM_RTL8814A) -+ Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), CompSteeringNumofBFer); -+ else -+#endif -+ Nr_index = TxBF_Nr(1, CompSteeringNumofBFer); -+ -+ switch (Nr_index) { -+ case 1: -+ NDPTxRate = ODM_MGN_VHT2SS_MCS0; -+ break; -+ -+ case 2: -+ NDPTxRate = ODM_MGN_VHT3SS_MCS0; -+ break; -+ -+ case 3: -+ NDPTxRate = ODM_MGN_VHT4SS_MCS0; -+ break; -+ -+ default: -+ NDPTxRate = ODM_MGN_VHT2SS_MCS0; -+ break; -+ } -+ -+return NDPTxRate; -+ -+} -+#endif -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/phydm/txbf/phydm_hal_txbf_api.h 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,70 @@ -+/********************************************************************************/ -+/**/ -+/*Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.*/ -+/**/ -+/*This program is free software; you can redistribute it and/or modify it*/ -+/*under the terms of version 2 of the GNU General Public License as*/ -+/*published by the Free Software Foundation.*/ -+/**/ -+/*This program is distributed in the hope that it will be useful, but WITHOUT*/ -+/*ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or*/ -+/*FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for*/ -+/*more details.*/ -+/*You should have received a copy of the GNU General Public License along with*/ -+/*this program; if not, write to the Free Software Foundation, Inc.,*/ -+/*51 Franklin Street, Fifth Floor, Boston, MA 02110, USA*/ -+/**/ -+/**/ -+/********************************************************************************/ -+#ifndef __PHYDM_HAL_TXBF_API_H__ -+#define __PHYDM_HAL_TXBF_API_H__ -+ -+#if (defined(CONFIG_BB_TXBF_API)) -+ -+#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -+#define TxBF_Nr(a, b) ((a > b) ? (b) : (a)) -+ -+u1Byte -+Beamforming_GetHTNDPTxRate( -+ IN PVOID pDM_VOID, -+ u1Byte CompSteeringNumofBFer -+); -+ -+u1Byte -+Beamforming_GetVHTNDPTxRate( -+ IN PVOID pDM_VOID, -+ u1Byte CompSteeringNumofBFer -+); -+ -+#endif -+ -+#if (RTL8822B_SUPPORT == 1) -+u1Byte -+phydm_get_beamforming_sounding_info( -+ IN PVOID pDM_VOID, -+ IN pu2Byte Troughput, -+ IN u1Byte Total_BFee_Num, -+ IN pu1Byte TxRate -+ ); -+ -+u1Byte -+phydm_get_ndpa_rate( -+ IN PVOID pDM_VOID -+ ); -+ -+u1Byte -+phydm_get_mu_bfee_snding_decision( -+ IN PVOID pDM_VOID, -+ IN u2Byte Throughput -+ ); -+ -+#else -+#define phydm_get_beamforming_sounding_info(pDM_VOID, Troughput, Total_BFee_Num, TxRate) -+#define phydm_get_ndpa_rate(pDM_VOID) -+#define phydm_get_mu_bfee_snding_decision(pDM_VOID, Troughput) -+ -+#endif -+ -+#endif -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.c 2018-02-11 21:44:27.163146330 +0200 -@@ -0,0 +1,10314 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2016 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+#ifdef CONFIG_RTL8723D -+ -+#include "drv_types.h" -+ -+#ifdef LOAD_FW_HEADER_FROM_DRIVER -+ -+#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) -+ -+u1Byte array_mp_8723d_fw_ap[] = { -+0xD1, 0x23, 0x20, 0x00, 0x1D, 0x00, 0x02, 0x00, -+0x04, 0x14, 0x11, 0x14, 0xCC, 0x5B, 0x02, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x02, 0x85, 0xA9, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xC4, 0xBA, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xC8, 0x41, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xBC, 0x36, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xBC, 0x8D, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xC7, 0xEB, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, -+0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, -+0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, -+0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, -+0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, -+0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, -+0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, -+0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, -+0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, -+0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, -+0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, -+0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, -+0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, -+0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, -+0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, -+0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, -+0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, -+0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, -+0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, -+0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, -+0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, -+0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, -+0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, -+0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, -+0x30, 0x02, 0x02, 0x03, 0x04, 0x04, 0x08, 0x09, -+0x09, 0x0C, 0x0E, 0x10, 0x12, 0x02, 0x09, 0x0B, -+0x0E, 0x0D, 0x0F, 0x10, 0x12, 0x00, 0x04, 0x00, -+0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x23, 0x00, -+0x2D, 0x00, 0x50, 0x00, 0x91, 0x00, 0xC3, 0x01, -+0x27, 0x01, 0x31, 0x01, 0x5E, 0x00, 0x8C, 0x00, -+0xC8, 0x00, 0xDC, 0x01, 0x5E, 0x01, 0x68, 0x01, -+0x9A, 0x01, 0xCC, 0x01, 0xEA, 0x02, 0x02, 0x04, -+0x08, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, -+0x6C, 0x14, 0x28, 0x32, 0x50, 0x78, 0xA0, 0xC8, -+0xE6, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x02, -+0x02, 0x03, 0x03, 0x04, 0x04, 0x02, 0x04, 0x06, -+0x07, 0x07, 0x08, 0x08, 0x08, 0x01, 0x01, 0x01, -+0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, -+0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, -+0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, -+0x02, 0x03, 0x03, 0x04, 0x05, 0x01, 0x02, 0x03, -+0x04, 0x05, 0x06, 0x07, 0x08, 0x03, 0x03, 0x03, -+0x02, 0x03, 0x03, 0x03, 0x03, 0x03, 0x02, 0x02, -+0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, -+0x02, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, -+0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, -+0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x8B, 0xF8, 0xE6, 0xBC, 0x02, 0x02, -+0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, -+0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, -+0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, -+0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, -+0x20, 0x05, 0x0C, 0x74, 0x8A, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, -+0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x8B, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, -+0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, -+0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x8A, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, -+0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, -+0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, -+0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x8A, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, -+0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, -+0x76, 0x30, 0x90, 0x86, 0xBC, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, -+0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, -+0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, -+0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, -+0x8A, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, -+0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, -+0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x8A, 0x2E, -+0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, -+0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, -+0x24, 0x8A, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x86, 0xBC, 0x93, 0xF6, 0x08, 0xEF, -+0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, -+0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, -+0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x8A, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, -+0x2E, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, -+0x8A, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, -+0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, -+0x8B, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x8A, 0x2F, 0xF8, 0xA6, 0x01, 0x08, -+0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, -+0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, -+0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, -+0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, -+0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, -+0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, -+0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, -+0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, -+0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x83, 0x4D, 0x7F, -+0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, -+0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, -+0x22, 0x02, 0x85, 0xE7, 0x02, 0x83, 0xDD, 0xE4, -+0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, -+0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, -+0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, -+0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, -+0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, -+0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, -+0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, -+0x86, 0xA5, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, -+0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, -+0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, -+0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, -+0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, -+0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, -+0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, -+0xDE, 0xE7, 0x80, 0xBE, 0xEF, 0x2B, 0xFF, 0xEE, -+0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, -+0x22, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, 0xFE, -+0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xEF, -+0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, -+0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, -+0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, -+0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, -+0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE0, 0xFB, 0xA3, -+0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, -+0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, -+0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, -+0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, -+0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, -+0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, -+0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x41, 0x96, 0xD1, -+0x00, 0x44, 0x96, 0x89, 0x41, 0x4E, 0x59, 0x00, -+0x44, 0x96, 0x85, 0x61, 0x6E, 0x79, 0x00, 0x41, -+0x96, 0xD4, 0x00, 0x00, 0xBA, 0xAD, 0xC1, 0xEA, -+0x8E, 0x36, 0x90, 0x96, 0xCC, 0xEF, 0xF0, 0x7F, -+0x02, 0xB1, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0xFF, -+0x90, 0x96, 0xCC, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, -+0x86, 0xAF, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, -+0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, -+0x2E, 0x90, 0x86, 0xB4, 0xF1, 0xDE, 0xFF, 0xED, -+0x2F, 0x90, 0x86, 0xB5, 0xF1, 0xE6, 0xFF, 0xED, -+0x2F, 0x90, 0x86, 0xB6, 0xF1, 0xF0, 0xFF, 0xED, -+0x2F, 0x90, 0x86, 0xB7, 0xF1, 0xFA, 0xFF, 0xED, -+0x2F, 0x90, 0x86, 0xB8, 0xF1, 0x23, 0xFF, 0xED, -+0x2F, 0x90, 0x86, 0xB9, 0x12, 0x9F, 0xBF, 0xFF, -+0xAE, 0x05, 0xED, 0x2F, 0x90, 0x86, 0xBA, 0xF0, -+0x22, 0x4E, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, -+0x02, 0x1F, 0x12, 0x88, 0xCA, 0x12, 0x02, 0x06, -+0xFF, 0x54, 0x7F, 0x90, 0x88, 0x36, 0xF0, 0xEF, -+0x12, 0xA1, 0xDD, 0xA3, 0xF1, 0xDE, 0xFD, 0x54, -+0xF0, 0xC4, 0x54, 0x0F, 0xFF, 0x90, 0x88, 0x34, -+0xE0, 0x54, 0xF0, 0x4F, 0xF1, 0xF0, 0xFC, 0x54, -+0x01, 0x25, 0xE0, 0xFF, 0x90, 0x88, 0x31, 0xE0, -+0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, 0xC3, -+0x13, 0xFF, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFD, -+0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, 0xF0, -+0xFF, 0xA3, 0xE0, 0x54, 0x0F, 0xF1, 0xE5, 0x90, -+0x88, 0x35, 0xF1, 0xFA, 0xFD, 0x90, 0x8A, 0x89, -+0x12, 0x8C, 0xE5, 0x7F, 0x02, 0x12, 0x04, 0x7E, -+0x12, 0x88, 0xD0, 0xF1, 0x24, 0xFF, 0x54, 0x01, -+0xFE, 0x90, 0x88, 0x9B, 0x12, 0xDB, 0x2C, 0xF1, -+0x22, 0xFE, 0x12, 0xDB, 0x8C, 0x90, 0x88, 0x9B, -+0x12, 0xDB, 0xB0, 0xF1, 0x21, 0x12, 0xDB, 0x82, -+0x90, 0x88, 0x9B, 0x12, 0xDB, 0xA7, 0xF1, 0x21, -+0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, -+0x88, 0x9B, 0xF0, 0x12, 0x5C, 0x5F, 0x90, 0x88, -+0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, -+0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xBE, 0x36, 0xF0, -+0x90, 0x88, 0x36, 0x12, 0xDB, 0x45, 0x12, 0xAF, -+0xCE, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0xF0, 0x90, -+0x00, 0x01, 0x02, 0x02, 0x1F, 0x4F, 0xF0, 0x90, -+0x00, 0x02, 0x02, 0x02, 0x1F, 0xF5, 0x83, 0xEF, -+0xF0, 0x90, 0x00, 0x03, 0x02, 0x02, 0x1F, 0xF5, -+0x83, 0xEF, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, -+0x1F, 0x90, 0x94, 0xBD, 0x12, 0x86, 0x76, 0x90, -+0x93, 0x4C, 0xE0, 0x70, 0x12, 0x11, 0xD0, 0x12, -+0x02, 0x06, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, -+0x06, 0x90, 0x93, 0x52, 0x74, 0x01, 0xF0, 0x90, -+0x93, 0x4E, 0xE0, 0x70, 0x12, 0x11, 0xD0, 0x12, -+0x02, 0x06, 0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x05, -+0x06, 0x90, 0x93, 0x53, 0x74, 0x01, 0xF0, 0x11, -+0xD0, 0x12, 0x87, 0xDF, 0xFF, 0x90, 0x94, 0xC1, -+0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, -+0x0B, 0x11, 0xD0, 0x12, 0x87, 0xE7, 0x90, 0x94, -+0xC2, 0xF0, 0x80, 0x05, 0x90, 0x94, 0xC2, 0xEF, -+0xF0, 0x90, 0x94, 0xC1, 0xE0, 0x90, 0x94, 0xC0, -+0xF0, 0x90, 0x94, 0xC2, 0xE0, 0xFE, 0x90, 0x94, -+0xC0, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x38, 0x11, -+0xD0, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFD, 0x12, -+0x6E, 0x71, 0x90, 0x94, 0xC0, 0xE0, 0xFF, 0x12, -+0x78, 0x4A, 0xEF, 0x90, 0x94, 0xC0, 0x70, 0x06, -+0xE0, 0xFF, 0xF1, 0x5C, 0x80, 0x04, 0xE0, 0xFF, -+0xF1, 0xE4, 0x90, 0x93, 0x53, 0xE0, 0x60, 0x07, -+0x90, 0x94, 0xC0, 0xE0, 0xFF, 0xF1, 0x5C, 0x90, -+0x94, 0xC0, 0xE0, 0x04, 0xF0, 0x80, 0xBA, 0x90, -+0x05, 0x5E, 0xE4, 0xF0, 0x90, 0x94, 0xC1, 0xE0, -+0x70, 0x17, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, -+0x10, 0x11, 0xDC, 0x90, 0x8A, 0xED, 0x11, 0xDF, -+0x12, 0xBE, 0x40, 0x54, 0xBF, 0xF0, 0x54, 0x7F, -+0xF0, 0x22, 0x90, 0x94, 0xBD, 0x12, 0x86, 0x76, -+0x90, 0x94, 0xBD, 0x02, 0x86, 0x6D, 0xE4, 0xFD, -+0xFF, 0x12, 0x04, 0x7E, 0x90, 0x86, 0x0C, 0xE0, -+0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x02, 0x04, -+0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x96, 0xD2, 0xED, 0xF0, 0x90, 0x88, 0x31, -+0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, -+0xE0, 0x02, 0x41, 0x58, 0xEE, 0x12, 0xA1, 0xDD, -+0x30, 0xE0, 0x02, 0x41, 0x58, 0x90, 0x88, 0x39, -+0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x41, 0x58, 0xEF, -+0x70, 0x02, 0x21, 0xB7, 0x24, 0xFE, 0x70, 0x02, -+0x21, 0xFC, 0x24, 0xFE, 0x60, 0x4F, 0x24, 0xFC, -+0x70, 0x02, 0x41, 0x41, 0x24, 0xFC, 0x60, 0x02, -+0x41, 0x51, 0xEE, 0xB4, 0x0E, 0x03, 0x12, 0x71, -+0x5F, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, -+0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, -+0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, -+0x39, 0xE0, 0xB4, 0x04, 0x11, 0x90, 0x96, 0xD2, -+0xE0, 0xFF, 0x60, 0x05, 0x12, 0x67, 0x80, 0x80, -+0x05, 0x90, 0x8A, 0xED, 0x11, 0xDF, 0x90, 0x88, -+0x39, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x41, 0x51, -+0x12, 0x7B, 0xCC, 0x41, 0x51, 0x90, 0x88, 0x39, -+0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, -+0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, -+0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, -+0x0B, 0x90, 0x86, 0x00, 0x11, 0xDF, 0xBF, 0x01, -+0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, -+0x64, 0x0C, 0x60, 0x02, 0x41, 0x51, 0x90, 0x86, -+0x00, 0x11, 0xDF, 0xEF, 0x64, 0x01, 0x60, 0x02, -+0x41, 0x51, 0x12, 0x68, 0xC2, 0x41, 0x51, 0x90, -+0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, -+0x00, 0x11, 0xDF, 0xBF, 0x01, 0x03, 0x12, 0x71, -+0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, -+0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, -+0x0C, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xDF, 0xBF, -+0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, -+0xE0, 0x64, 0x04, 0x70, 0x64, 0x90, 0x86, 0x02, -+0x11, 0xDF, 0xEF, 0x64, 0x01, 0x70, 0x5A, 0x12, -+0x73, 0x5A, 0x80, 0x55, 0x90, 0x88, 0x39, 0xE0, -+0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xDF, -+0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, -+0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, -+0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, -+0x86, 0x00, 0x11, 0xDF, 0xBF, 0x01, 0x03, 0x12, -+0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, -+0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, -+0xE0, 0xB4, 0x04, 0x15, 0x12, 0x7A, 0x49, 0x80, -+0x10, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x09, -+0x12, 0xB5, 0x8D, 0x30, 0xE0, 0x03, 0x12, 0x79, -+0xD4, 0x90, 0x88, 0x39, 0x12, 0xDB, 0x45, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xC1, 0x9B, 0xFF, -+0x54, 0x01, 0xFE, 0x90, 0x88, 0x9D, 0x12, 0xDB, -+0x2C, 0xF0, 0xFC, 0x12, 0x02, 0x06, 0xFD, 0x54, -+0x04, 0x13, 0x13, 0x54, 0x3F, 0xFF, 0x90, 0x94, -+0xA1, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0xED, 0x54, -+0x08, 0xFF, 0xEC, 0x54, 0xF7, 0x4F, 0xFF, 0x90, -+0x88, 0x9D, 0xF0, 0x12, 0x02, 0x06, 0x12, 0xDB, -+0x82, 0x90, 0x88, 0x9D, 0x12, 0xDB, 0xA7, 0x4E, -+0x12, 0xA7, 0xE7, 0x54, 0x40, 0xFD, 0xEF, 0x54, -+0xBF, 0x4D, 0xFF, 0x90, 0x88, 0x9D, 0xF0, 0xEE, -+0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, 0x4E, 0xF0, -+0x11, 0xD0, 0xE9, 0x24, 0x01, 0xF9, 0xE4, 0x3A, -+0x8B, 0x45, 0xF5, 0x46, 0x89, 0x47, 0x75, 0x48, -+0x04, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9E, 0x12, -+0x69, 0xF5, 0x11, 0xD0, 0x12, 0x02, 0x06, 0x20, -+0xE0, 0x02, 0x81, 0x41, 0x90, 0x05, 0x54, 0xE0, -+0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, 0x13, 0x90, -+0x88, 0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xC4, -+0x54, 0x0F, 0x30, 0xE0, 0x15, 0x12, 0x87, 0xDF, -+0x90, 0x88, 0x9E, 0xF0, 0x24, 0x0A, 0x90, 0x88, -+0xCF, 0x12, 0x87, 0xE6, 0x90, 0x88, 0x9F, 0xF0, -+0x80, 0x4B, 0x12, 0x87, 0xDF, 0xFF, 0xC3, 0x94, -+0x2A, 0x50, 0x15, 0xEF, 0xC3, 0x94, 0x03, 0x50, -+0x07, 0x90, 0x88, 0x9E, 0x74, 0x03, 0x80, 0x0D, -+0x12, 0x87, 0xDF, 0x90, 0x88, 0x9E, 0x80, 0x05, -+0x90, 0x88, 0x9E, 0x74, 0x2A, 0xF0, 0x24, 0x0A, -+0x90, 0x88, 0xCF, 0xF0, 0x12, 0x87, 0xE7, 0xFF, -+0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, 0x94, -+0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, 0x74, 0x03, -+0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, 0x90, -+0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, 0x9F, 0x88, -+0x54, 0x03, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, -+0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, -+0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, -+0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, -+0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, -+0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, -+0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, -+0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, -+0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0xF0, 0x90, -+0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -+0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, -+0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0x91, -+0xE5, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, 0x7E, -+0x12, 0xDB, 0xC1, 0x74, 0x11, 0xF0, 0x90, 0x94, -+0xA1, 0xE0, 0x30, 0xE0, 0x33, 0x90, 0x94, 0xAA, -+0x74, 0x01, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x06, -+0xC7, 0xE0, 0xFE, 0x90, 0x06, 0xC6, 0x12, 0x91, -+0xFD, 0xFE, 0xE4, 0xFD, 0x78, 0x10, 0x12, 0x9D, -+0xA0, 0x90, 0x06, 0xC5, 0xE0, 0xFE, 0x90, 0x06, -+0xC4, 0x12, 0x91, 0xFD, 0xFE, 0xE4, 0xFD, 0x12, -+0x86, 0x54, 0x90, 0x94, 0xA6, 0x12, 0x04, 0x31, -+0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, -+0x88, 0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, 0x90, -+0x88, 0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, -+0xB0, 0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, 0x88, -+0xA5, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, -+0x74, 0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, 0xA5, -+0xE0, 0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, -+0x05, 0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, 0x80, -+0x45, 0x90, 0x8A, 0xF1, 0x11, 0xDF, 0x90, 0x89, -+0x04, 0xE0, 0x90, 0x00, 0x40, 0x30, 0xE0, 0x07, -+0xE0, 0x54, 0x0F, 0x44, 0xA0, 0x80, 0x05, 0xE0, -+0x54, 0x0F, 0x44, 0x20, 0xFD, 0x7F, 0x40, 0x12, -+0x7B, 0x2E, 0x11, 0xD0, 0x12, 0x87, 0xF1, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, -+0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, -+0xE4, 0xFB, 0xFD, 0x7F, 0xFF, 0x12, 0xA8, 0x5B, -+0x12, 0xDB, 0xC1, 0x74, 0x43, 0xF0, 0x90, 0x88, -+0xA3, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0x88, -+0xAF, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0x12, 0xA1, -+0xDD, 0x30, 0xE0, 0x09, 0x90, 0x88, 0xD0, 0xE0, -+0x44, 0x02, 0xF0, 0x80, 0x11, 0x90, 0x8A, 0x97, -+0x91, 0xE5, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, -+0x88, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8A, -+0xD9, 0x91, 0xE5, 0x7F, 0x03, 0x12, 0x04, 0x7E, -+0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, -+0x88, 0xA1, 0xE0, 0x54, 0xBF, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x12, -+0x04, 0x7E, 0x90, 0x8A, 0x79, 0xE0, 0xFE, 0xA3, -+0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x90, 0x93, -+0x29, 0xE0, 0x30, 0xE0, 0x59, 0xC4, 0x54, 0x0F, -+0x20, 0xE0, 0x1A, 0x12, 0xDB, 0x9E, 0xF1, 0x8F, -+0x90, 0x8A, 0xF9, 0x91, 0xE5, 0x11, 0xD6, 0xF1, -+0xEE, 0x30, 0xE0, 0x07, 0x90, 0x8A, 0x89, 0x91, -+0xE5, 0xF1, 0x60, 0xE1, 0xF5, 0x90, 0x93, 0x29, -+0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x2F, 0xE4, -+0x90, 0x92, 0x20, 0xF0, 0x90, 0x93, 0x2C, 0xF1, -+0x8F, 0x90, 0x93, 0x29, 0xE0, 0x54, 0xEF, 0xF0, -+0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0C, 0x90, 0x8A, -+0x89, 0x91, 0xE5, 0x7D, 0x04, 0x7F, 0x01, 0x02, -+0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x91, 0xE5, 0x7D, -+0x31, 0x12, 0xDB, 0x95, 0x11, 0xDF, 0x22, 0x7E, -+0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -+0x88, 0x79, 0x31, 0x12, 0x04, 0x80, 0x90, 0x88, -+0x35, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, -+0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x50, 0xD1, 0xAC, -+0xFE, 0xE4, 0x33, 0x90, 0x88, 0x42, 0xF0, 0xA3, -+0xCE, 0xD1, 0xAC, 0xFF, 0xF1, 0x67, 0x12, 0xD8, -+0xD7, 0x90, 0x8A, 0x89, 0x91, 0xE5, 0xF1, 0xE8, -+0x90, 0x8A, 0x89, 0x91, 0xE5, 0x7D, 0x0C, 0x7F, -+0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0x91, -+0xE5, 0xF1, 0x60, 0x90, 0x86, 0xB3, 0xE0, 0xFF, -+0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, 0x74, 0xDD, -+0xF0, 0x80, 0x18, 0xEF, 0xB4, 0x03, 0x0F, 0x90, -+0x88, 0x41, 0x74, 0xF4, 0xF0, 0x90, 0x00, 0x92, -+0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x05, 0xE4, 0x90, -+0x88, 0x41, 0xF0, 0x7F, 0x79, 0x12, 0x7B, 0x41, -+0xEF, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, -+0x28, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE2, 0x06, -+0x90, 0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, -+0x93, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, -+0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, -+0x74, 0x07, 0xD1, 0xAC, 0xF1, 0x67, 0x7E, 0x00, -+0x7F, 0x18, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, -+0x79, 0x31, 0x12, 0x04, 0x80, 0x90, 0x8A, 0xA3, -+0x91, 0xE5, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x7E, -+0x00, 0x7F, 0x02, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -+0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, -+0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x0A, -+0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, -+0xF0, 0x90, 0x88, 0x9C, 0xF0, 0x22, 0xE4, 0xFB, -+0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x85, 0x4E, 0x90, -+0x95, 0x3F, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x86, -+0xAF, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, -+0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0F, 0x90, -+0x86, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, -+0x12, 0xC5, 0x83, 0x12, 0xCB, 0x5A, 0xD1, 0xA3, -+0x30, 0xE1, 0x08, 0x54, 0xFD, 0xF0, 0x90, 0x86, -+0x08, 0x11, 0xDF, 0xD1, 0xA3, 0x30, 0xE2, 0x08, -+0x54, 0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x11, 0xDF, -+0xD1, 0xA3, 0xFF, 0x30, 0xE5, 0x0C, 0x54, 0xDF, -+0xF0, 0x12, 0xAB, 0x23, 0xBF, 0x01, 0x03, 0x12, -+0x92, 0x06, 0xD1, 0xA3, 0x30, 0xE6, 0x08, 0x54, -+0xBF, 0xF0, 0x90, 0x8A, 0x7D, 0x11, 0xDF, 0xD2, -+0xAF, 0x80, 0xA3, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, -+0x86, 0xAF, 0xE0, 0x22, 0xF0, 0x90, 0x88, 0x53, -+0xE0, 0x24, 0x04, 0x22, 0x90, 0x93, 0x29, 0xE0, -+0x30, 0xE0, 0x1A, 0x90, 0x01, 0x57, 0xE4, 0xF0, -+0x90, 0x8A, 0xF9, 0x91, 0xE5, 0x11, 0xD6, 0xF1, -+0xEE, 0x30, 0xE0, 0x07, 0x90, 0x8A, 0x89, 0x91, -+0xE5, 0xF1, 0x60, 0xF1, 0xF5, 0x22, 0x12, 0xD8, -+0x97, 0x12, 0x7B, 0xDB, 0x90, 0x8A, 0xC5, 0x11, -+0xDF, 0x12, 0xAE, 0x94, 0xB1, 0x4F, 0x12, 0xD6, -+0x67, 0x12, 0xD8, 0xBF, 0x90, 0x8A, 0x73, 0x11, -+0xDF, 0x90, 0x00, 0x6A, 0xE0, 0x30, 0xE2, 0x14, -+0x90, 0x92, 0x20, 0x74, 0x01, 0xF0, 0xA3, 0x74, -+0xF4, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x68, 0x7E, -+0x01, 0x12, 0x66, 0x33, 0x12, 0xD3, 0x71, 0x90, -+0x93, 0x4A, 0x74, 0x01, 0xF0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xC0, -+0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8A, 0xF9, -+0x91, 0xE5, 0x7D, 0x44, 0x7F, 0x6F, 0x12, 0x04, -+0x7E, 0x90, 0x8A, 0xFD, 0x11, 0xDF, 0x90, 0x96, -+0xC1, 0xE0, 0x90, 0x96, 0xC0, 0xB4, 0x01, 0x09, -+0xE0, 0xF1, 0x79, 0xE0, 0x44, 0x04, 0xF0, 0x80, -+0x07, 0xE0, 0xF1, 0x79, 0xE0, 0x54, 0xFB, 0xF0, -+0x90, 0x8A, 0xF9, 0x91, 0xE5, 0xF1, 0xE8, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x01, 0x80, 0xB6, -+0x7D, 0x0C, 0x7F, 0x01, 0x02, 0x04, 0x7E, 0x33, -+0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, -+0xA3, 0x74, 0x50, 0xF0, 0x22, 0xE0, 0xFD, 0xE5, -+0x0E, 0xC4, 0x54, 0xF0, 0x24, 0x05, 0xF5, 0x82, -+0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xF0, 0xE4, -+0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, -+0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, -+0x54, 0x7E, 0x01, 0x02, 0x66, 0x33, 0x90, 0x88, -+0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xB6, 0x81, -+0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x34, 0x90, -+0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x2C, 0x12, -+0xAF, 0xCF, 0x60, 0x15, 0x90, 0x8A, 0xB9, 0x91, -+0xE5, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x04, 0x7E, -+0x90, 0x8B, 0x01, 0x12, 0xB7, 0xE4, 0x02, 0x04, -+0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x0C, 0x90, -+0x8A, 0xB9, 0x91, 0xE5, 0x7D, 0x01, 0x7F, 0x04, -+0x12, 0x04, 0x7E, 0x22, 0xE4, 0xFD, 0xE1, 0x16, -+0xE4, 0xFD, 0xFF, 0x02, 0x04, 0x7E, 0x90, 0x93, -+0x29, 0xE0, 0xC3, 0x13, 0x22, 0x90, 0x93, 0x29, -+0xE0, 0x44, 0x10, 0xF0, 0x22, 0x12, 0xC1, 0x9B, -+0x30, 0xE0, 0x13, 0x11, 0xA9, 0x90, 0x86, 0xB3, -+0xE0, 0x64, 0x01, 0x70, 0x27, 0x90, 0xFE, 0x10, -+0xE0, 0x44, 0x04, 0xF0, 0x80, 0x1E, 0x90, 0x93, -+0x25, 0xE0, 0x60, 0x16, 0x7D, 0x10, 0xE4, 0xFF, -+0x12, 0x7C, 0x3B, 0x90, 0x01, 0x3C, 0xE0, 0x30, -+0xE4, 0x03, 0x74, 0x10, 0xF0, 0x90, 0x01, 0x63, -+0xE4, 0xF0, 0xF1, 0xDD, 0x12, 0x88, 0xD0, 0x12, -+0x87, 0xDF, 0x90, 0x93, 0x04, 0x12, 0x87, 0xE6, -+0x90, 0x93, 0x05, 0xF0, 0x90, 0x93, 0x04, 0xE0, -+0x54, 0x01, 0x90, 0x93, 0x11, 0xF0, 0x90, 0x93, -+0x04, 0xE0, 0x54, 0x02, 0x90, 0x93, 0x12, 0xF0, -+0x90, 0x93, 0x04, 0xE0, 0x54, 0x04, 0x90, 0x93, -+0x13, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x08, -+0x90, 0x93, 0x14, 0xF0, 0x90, 0x93, 0x04, 0xE0, -+0x54, 0x10, 0x90, 0x93, 0x15, 0xF0, 0x90, 0x93, -+0x05, 0xE0, 0x54, 0x01, 0x90, 0x93, 0x16, 0xF0, -+0x90, 0x93, 0x05, 0xE0, 0x54, 0x02, 0x90, 0x93, -+0x17, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x04, -+0x90, 0x93, 0x18, 0xF0, 0x90, 0x93, 0x05, 0xE0, -+0x54, 0x08, 0x90, 0x93, 0x19, 0xF0, 0x90, 0x93, -+0x05, 0xE0, 0x54, 0x10, 0x90, 0x93, 0x1A, 0xF0, -+0x22, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, -+0x16, 0x31, 0xFD, 0x90, 0x88, 0x27, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, -+0xF0, 0x90, 0x93, 0x03, 0xE0, 0x44, 0x01, 0xF0, -+0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x90, -+0x05, 0x52, 0xE0, 0x54, 0x07, 0x04, 0x90, 0x93, -+0x0E, 0x12, 0xAD, 0x9C, 0x90, 0x04, 0x22, 0xE0, -+0x54, 0xEF, 0xF0, 0x22, 0xE4, 0x90, 0x95, 0x18, -+0xF0, 0x12, 0xD4, 0xC1, 0x7F, 0x08, 0x12, 0x7B, -+0x41, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, -+0x7B, 0x2E, 0xE4, 0xFF, 0x12, 0xAB, 0xBD, 0x90, -+0x93, 0x31, 0xE0, 0x20, 0xE0, 0x02, 0x21, 0xE3, -+0xF1, 0xF5, 0x44, 0x02, 0x12, 0xB6, 0x89, 0xE4, -+0x90, 0x95, 0x19, 0xF0, 0x90, 0x95, 0x19, 0xE0, -+0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2F, 0x12, 0xAD, -+0xC1, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -+0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x34, 0xE0, 0xFD, -+0xEF, 0x5D, 0x60, 0x11, 0x90, 0x95, 0x19, 0x12, -+0xDB, 0x0C, 0x90, 0x95, 0x19, 0x12, 0xDA, 0xEB, -+0x44, 0x40, 0x12, 0xAD, 0x44, 0x90, 0x95, 0x19, -+0xE0, 0x04, 0xF0, 0x80, 0xC7, 0x90, 0x07, 0xC7, -+0xE4, 0xF0, 0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, -+0xC5, 0x74, 0x77, 0xF0, 0x90, 0x07, 0xC4, 0xE4, -+0xF0, 0x90, 0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, -+0xE4, 0xF0, 0xA3, 0x12, 0xD8, 0x1E, 0x90, 0x02, -+0x26, 0xE0, 0x44, 0x01, 0xF0, 0xE0, 0x90, 0x95, -+0x1A, 0xF0, 0x90, 0x95, 0x1A, 0xE0, 0x30, 0xE0, -+0x19, 0x90, 0x95, 0x18, 0xE0, 0x04, 0x12, 0xAD, -+0xA3, 0x90, 0x02, 0x26, 0xE0, 0x90, 0x95, 0x1A, -+0xF0, 0x90, 0x95, 0x18, 0xE0, 0xD3, 0x94, 0xFA, -+0x40, 0xE0, 0x90, 0x02, 0x03, 0x74, 0x80, 0xF0, -+0x90, 0x04, 0x24, 0xE0, 0x90, 0x95, 0x1B, 0xF0, -+0x90, 0x04, 0x22, 0xE0, 0x44, 0x10, 0xF0, 0x90, -+0x02, 0x00, 0xE0, 0x90, 0x95, 0x1A, 0xF0, 0x90, -+0x02, 0x01, 0x31, 0xF4, 0x90, 0x02, 0x02, 0x31, -+0xF4, 0x90, 0x02, 0x14, 0x31, 0xF4, 0xE0, 0x04, -+0xF0, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x11, 0xDC, -+0x90, 0x95, 0x1B, 0xE0, 0x90, 0x04, 0x24, 0xF0, -+0x90, 0xFD, 0x09, 0x74, 0xFF, 0xF0, 0x90, 0xFD, -+0x08, 0xE4, 0xF0, 0x12, 0xAF, 0xD6, 0xF0, 0xE4, -+0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x32, 0xE0, -+0x54, 0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x95, -+0x1A, 0xE0, 0x2F, 0xF0, 0x22, 0xE0, 0x7C, 0x00, -+0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0x90, 0x93, -+0x20, 0xE0, 0x90, 0x95, 0xA3, 0xF0, 0x90, 0x93, -+0x21, 0xE0, 0x90, 0x95, 0xA4, 0xF0, 0x90, 0x93, -+0x22, 0xE0, 0x90, 0x95, 0xA5, 0xF0, 0x90, 0x93, -+0x23, 0xE0, 0x90, 0x95, 0xA6, 0xF0, 0x90, 0x93, -+0x24, 0xE0, 0x90, 0x95, 0xA7, 0xF0, 0x90, 0x93, -+0x11, 0xE0, 0x90, 0x95, 0xA8, 0xF0, 0x90, 0x93, -+0x12, 0xE0, 0x90, 0x95, 0xA9, 0xF0, 0x90, 0x93, -+0x13, 0xE0, 0x90, 0x95, 0xAA, 0xF0, 0x90, 0x93, -+0x14, 0xE0, 0x90, 0x95, 0xAB, 0xF0, 0x90, 0x93, -+0x15, 0xE0, 0x90, 0x95, 0xAC, 0xF0, 0x90, 0x93, -+0x16, 0xE0, 0x90, 0x95, 0xAD, 0xF0, 0x90, 0x93, -+0x17, 0xE0, 0x90, 0x95, 0xAE, 0xF0, 0x90, 0x93, -+0x18, 0xE0, 0x90, 0x95, 0xAF, 0xF0, 0x90, 0x93, -+0x19, 0xE0, 0x90, 0x95, 0xB0, 0xF0, 0x90, 0x93, -+0x1A, 0xE0, 0x90, 0x95, 0xB1, 0xF0, 0xF1, 0x33, -+0x90, 0x95, 0x4B, 0xF0, 0xD1, 0xC6, 0x50, 0x09, -+0xF1, 0x02, 0x74, 0x01, 0xF0, 0xD1, 0xBF, 0x80, -+0xF3, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, -+0x1E, 0x31, 0xFD, 0x90, 0x95, 0x40, 0xF0, 0xA3, -+0xF1, 0x81, 0xD1, 0xC6, 0x50, 0x48, 0xD1, 0xE0, -+0xF1, 0x79, 0xFE, 0x24, 0xB2, 0xF5, 0x82, 0xE4, -+0x34, 0x95, 0xF1, 0x24, 0xE0, 0x24, 0x4D, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, -+0x74, 0x4D, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, -+0xF1, 0x24, 0xE0, 0x24, 0x4E, 0xF9, 0xE4, 0x34, -+0xFC, 0xFA, 0x7B, 0x01, 0xEE, 0xF1, 0xA8, 0x12, -+0x86, 0x76, 0xF1, 0x28, 0xE0, 0x24, 0x38, 0xF9, -+0xE4, 0x34, 0xFC, 0xFA, 0xEE, 0xF1, 0x9A, 0x12, -+0x86, 0x76, 0xD1, 0xBF, 0x80, 0xB4, 0x90, 0x02, -+0x87, 0xE0, 0x70, 0x02, 0xC1, 0xAB, 0x90, 0x93, -+0x03, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0xAB, 0xE4, -+0x90, 0x95, 0xBC, 0xF1, 0x3B, 0x90, 0x95, 0x40, -+0xE0, 0xFF, 0xA3, 0xE0, 0xA3, 0xCF, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x95, 0x42, 0xE0, 0xFC, 0xA3, -+0xE0, 0xFD, 0xEC, 0x90, 0xFD, 0x11, 0xF0, 0x74, -+0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -+0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, -+0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0x90, -+0x95, 0x44, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x02, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, -+0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, -+0x90, 0x95, 0x47, 0xF0, 0xFC, 0x74, 0x07, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, -+0x54, 0xC0, 0x90, 0x95, 0x49, 0xF0, 0xEC, 0x24, -+0x18, 0x90, 0x95, 0x46, 0xF0, 0xFD, 0x90, 0x95, -+0x42, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD1, 0xB0, -+0xEF, 0x54, 0xFC, 0x90, 0x95, 0x48, 0xF0, 0x90, -+0x95, 0x47, 0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, -+0x90, 0x95, 0x44, 0x8F, 0xF0, 0x12, 0x02, 0xE7, -+0x90, 0x95, 0x44, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x12, 0xD8, 0x9D, 0x90, 0x95, 0x40, 0xEE, 0x8F, -+0xF0, 0x12, 0x02, 0xE7, 0x90, 0x88, 0x27, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x40, 0x12, -+0xD2, 0x31, 0x9E, 0x40, 0x1B, 0x90, 0x88, 0x28, -+0xE0, 0x24, 0x01, 0xFF, 0x90, 0x88, 0x27, 0xE0, -+0x34, 0x00, 0xFE, 0xC3, 0xED, 0x9F, 0xFF, 0xEC, -+0x9E, 0x90, 0x95, 0x40, 0xF0, 0xA3, 0xEF, 0xF0, -+0x90, 0x95, 0x48, 0xE0, 0x24, 0xC0, 0x60, 0x02, -+0xA1, 0xBA, 0xD1, 0xD3, 0x24, 0x18, 0xD1, 0xAF, -+0xEF, 0x60, 0x02, 0xA1, 0xB0, 0xD1, 0xD3, 0x24, -+0x19, 0xD1, 0xAF, 0x90, 0x95, 0x61, 0xF1, 0x89, -+0x90, 0x95, 0x61, 0xE0, 0xFF, 0xD1, 0xFB, 0x9F, -+0x50, 0x15, 0xD1, 0xD3, 0x24, 0x1A, 0xD1, 0xAC, -+0x90, 0x95, 0x4A, 0xE0, 0x24, 0x62, 0xF5, 0x82, -+0xE4, 0x34, 0x95, 0xF1, 0x0D, 0x80, 0xE1, 0x90, -+0x95, 0x61, 0xE0, 0x70, 0x02, 0x81, 0xE5, 0xE4, -+0x90, 0x95, 0x4B, 0xF0, 0xD1, 0xC6, 0x40, 0x02, -+0x81, 0xCD, 0xD1, 0xE0, 0xF1, 0x79, 0xFF, 0x24, -+0x4D, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -+0xE0, 0xFE, 0x90, 0x95, 0x61, 0xE0, 0xFD, 0xEE, -+0x6D, 0x70, 0x20, 0xEF, 0xF1, 0xA8, 0x12, 0x86, -+0x6D, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xF1, -+0x18, 0x90, 0x95, 0xC7, 0xED, 0xF0, 0xD0, 0x01, -+0xD0, 0x02, 0xD0, 0x03, 0xF1, 0x45, 0xEF, 0x60, -+0x02, 0x80, 0x4D, 0x90, 0x95, 0x61, 0xE0, 0x64, -+0x03, 0x70, 0x54, 0xF1, 0x18, 0x90, 0x95, 0xC7, -+0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x89, 0xF1, -+0x45, 0xEF, 0x70, 0x11, 0xF1, 0x18, 0x90, 0x95, -+0xC7, 0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x85, -+0xF1, 0x45, 0xEF, 0x60, 0x2A, 0x90, 0x95, 0x4B, -+0xE0, 0xFF, 0x24, 0xAD, 0xF5, 0x82, 0xE4, 0x34, -+0x95, 0xF5, 0x83, 0xE0, 0x60, 0x02, 0x80, 0x0B, -+0x90, 0x95, 0x4B, 0xE0, 0xFF, 0x24, 0xA8, 0xF1, -+0x91, 0x60, 0x05, 0x74, 0xBC, 0x2F, 0x80, 0x15, -+0xD1, 0xED, 0x74, 0x01, 0xF0, 0x80, 0x12, 0x90, -+0x95, 0x4B, 0xE0, 0x24, 0xBC, 0x80, 0x06, 0x90, -+0x95, 0x4B, 0xE0, 0x24, 0xBC, 0xD1, 0xF3, 0xE4, -+0xF0, 0xD1, 0xBF, 0x81, 0x24, 0x90, 0x95, 0xBC, -+0xE0, 0x70, 0x4F, 0xA3, 0xE0, 0x70, 0x4B, 0xA3, -+0xE0, 0x70, 0x47, 0xA3, 0xE0, 0x70, 0x43, 0xA3, -+0xE0, 0x70, 0x3F, 0xA1, 0xB0, 0xE4, 0x90, 0x95, -+0x4B, 0xF0, 0xD1, 0xC6, 0x50, 0x1C, 0x74, 0xA8, -+0x2E, 0xF1, 0x91, 0x60, 0x09, 0x74, 0xBC, 0x2E, -+0xD1, 0xF3, 0xE4, 0xF0, 0x80, 0x08, 0x74, 0xBC, -+0x2E, 0xD1, 0xF3, 0x74, 0x01, 0xF0, 0xD1, 0xBF, -+0x80, 0xE0, 0x90, 0x95, 0xBC, 0xE0, 0x70, 0x12, -+0xA3, 0xE0, 0x70, 0x0E, 0xA3, 0xE0, 0x70, 0x0A, -+0xA3, 0xE0, 0x70, 0x06, 0xA3, 0xE0, 0x70, 0x02, -+0xA1, 0xB0, 0xE4, 0x90, 0x95, 0x4B, 0xF0, 0xD1, -+0xC6, 0x40, 0x02, 0xA1, 0xB0, 0xD1, 0xE0, 0x12, -+0x7B, 0x07, 0xD1, 0xED, 0xE0, 0x60, 0x75, 0x90, -+0x93, 0x29, 0xE0, 0x30, 0xE0, 0x06, 0xC4, 0x54, -+0x0F, 0x30, 0xE0, 0x68, 0xE4, 0xFF, 0xFE, 0x90, -+0x04, 0x1D, 0xE0, 0x60, 0x10, 0xD3, 0xEF, 0x94, -+0xE8, 0xEE, 0x94, 0x03, 0x50, 0x07, 0x0F, 0xBF, -+0x00, 0x01, 0x0E, 0x80, 0xEA, 0x90, 0x04, 0x1D, -+0xE0, 0x70, 0x49, 0x90, 0x95, 0x4B, 0xE0, 0x24, -+0xA3, 0xD1, 0xE3, 0x90, 0x92, 0x13, 0x74, 0x06, -+0xF0, 0x7B, 0x08, 0x7D, 0x01, 0x12, 0x66, 0xDB, -+0x90, 0x95, 0x44, 0xEE, 0xF0, 0xA3, 0xF1, 0x89, -+0xD1, 0xFB, 0x94, 0x06, 0x50, 0x1C, 0xD1, 0xD3, -+0x24, 0x0A, 0xD1, 0xAC, 0x90, 0x95, 0x44, 0xA3, -+0xE0, 0xFE, 0x90, 0x95, 0x4A, 0xE0, 0x2E, 0x24, -+0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF1, 0x0D, -+0x80, 0xDE, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, -+0x90, 0x06, 0x35, 0xF0, 0xD1, 0xBF, 0xA1, 0x27, -+0xF1, 0xC7, 0x90, 0x06, 0x36, 0x74, 0xDD, 0xF0, -+0x41, 0xEE, 0x90, 0x95, 0x49, 0xE0, 0x60, 0x02, -+0xC1, 0xA7, 0xD1, 0xD3, 0x24, 0x16, 0xD1, 0xAF, -+0x90, 0x06, 0x34, 0xEF, 0xF0, 0xD1, 0xD3, 0x24, -+0x17, 0xD1, 0xAF, 0x90, 0x06, 0x37, 0xF1, 0x81, -+0xD1, 0xC6, 0x50, 0x3A, 0xD1, 0xE0, 0x12, 0x7B, -+0x07, 0xE4, 0x90, 0x95, 0x4A, 0xF0, 0xD1, 0xFB, -+0x94, 0x06, 0x50, 0x26, 0xD1, 0xD3, 0x24, 0x04, -+0x2D, 0xD1, 0xAF, 0x90, 0x95, 0x4B, 0xE0, 0xFE, -+0xF1, 0x9A, 0x12, 0x86, 0x6D, 0x90, 0x95, 0x4A, -+0xE0, 0xF5, 0x82, 0xF1, 0x73, 0x6F, 0x60, 0x06, -+0xF1, 0x02, 0xE4, 0xF0, 0x80, 0x04, 0xF1, 0x11, -+0x80, 0xD4, 0xD1, 0xBF, 0x80, 0xC2, 0x90, 0x95, -+0xB7, 0xE0, 0x64, 0x01, 0x60, 0x17, 0xA3, 0xE0, -+0x64, 0x01, 0x60, 0x11, 0xA3, 0xE0, 0x64, 0x01, -+0x60, 0x0B, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x05, -+0xA3, 0xE0, 0xB4, 0x01, 0x06, 0x90, 0x95, 0x4C, -+0x74, 0x01, 0xF0, 0x90, 0x95, 0x4C, 0xE0, 0x64, -+0x01, 0x70, 0x51, 0xF1, 0xDD, 0x12, 0xBE, 0x48, -+0x12, 0xBD, 0x41, 0x90, 0x93, 0x25, 0xE0, 0x70, -+0x02, 0x41, 0xEE, 0x90, 0x01, 0x3C, 0xE0, 0x30, -+0xE4, 0x03, 0x74, 0x10, 0xF0, 0x7D, 0x10, 0xE4, -+0xFF, 0x12, 0x7C, 0x05, 0x90, 0x93, 0x26, 0xE0, -+0x60, 0x07, 0xF5, 0x4D, 0xE4, 0xF5, 0x4E, 0x80, -+0x17, 0x90, 0x93, 0x27, 0xE0, 0x60, 0x08, 0xFB, -+0xE4, 0xF5, 0x4D, 0xF5, 0x4E, 0x80, 0x0A, 0x75, -+0x4D, 0x20, 0xE4, 0xF5, 0x4E, 0xFB, 0x80, 0x01, -+0xFB, 0x7D, 0x01, 0x7F, 0x60, 0x7E, 0x01, 0x12, -+0x72, 0xB7, 0x41, 0xEE, 0xF1, 0x33, 0x90, 0x95, -+0x4B, 0xF0, 0xD1, 0xC6, 0x50, 0x09, 0xF1, 0x02, -+0x74, 0x01, 0xF0, 0xD1, 0xBF, 0x80, 0xF3, 0xF1, -+0xC7, 0x41, 0xEE, 0x22, 0xFC, 0xED, 0x2C, 0xFD, -+0x90, 0x8A, 0xE9, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, -+0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, 0x90, -+0x95, 0x4B, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x93, -+0x0E, 0xE0, 0xFF, 0x90, 0x95, 0x4B, 0xE0, 0xFE, -+0xC3, 0x9F, 0x22, 0x90, 0x95, 0x42, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x46, 0xE0, 0x22, -+0x74, 0xA3, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, -+0xF5, 0x83, 0xE0, 0xFF, 0x22, 0x90, 0x95, 0x4B, -+0xE0, 0x24, 0xBC, 0xF5, 0x82, 0xE4, 0x34, 0x95, -+0xF5, 0x83, 0x22, 0x90, 0x95, 0x4A, 0xE0, 0xFD, -+0xC3, 0x22, 0x74, 0xB7, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0x95, 0xF5, 0x83, 0x22, 0xF5, 0x83, 0xEF, -+0xF0, 0x90, 0x95, 0x4A, 0xE0, 0x04, 0xF0, 0x22, -+0x7B, 0x01, 0x7A, 0x95, 0x79, 0x62, 0x90, 0x95, -+0xC4, 0x02, 0x86, 0x76, 0xF5, 0x83, 0xEF, 0xF0, -+0x74, 0xB2, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, -+0xF5, 0x83, 0x22, 0xE4, 0x90, 0x95, 0x4C, 0xF0, -+0x90, 0x95, 0xB7, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, -+0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x95, 0xC1, -+0x12, 0x86, 0x76, 0xE4, 0xFF, 0x90, 0x95, 0xC7, -+0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x14, 0x90, -+0x95, 0xC4, 0xF1, 0x6E, 0xFE, 0x90, 0x95, 0xC1, -+0xF1, 0x6E, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, -+0x0F, 0x80, 0xE2, 0x7F, 0x01, 0x22, 0x12, 0x86, -+0x6D, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, 0x02, -+0x1F, 0x12, 0x7B, 0x07, 0x90, 0x95, 0x4B, 0xE0, -+0x22, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0x4B, 0xF0, -+0x22, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0x4A, 0xF0, -+0x22, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -+0xE0, 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x94, -+0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, -+0x75, 0xF0, 0x03, 0xA4, 0x24, 0x52, 0xF5, 0x82, -+0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xAC, 0x0A, -+0x11, 0xE4, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0x95, 0x40, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, -+0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, -+0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x93, 0x03, -+0xE0, 0xFE, 0xEE, 0x54, 0xFE, 0xF0, 0x7D, 0x08, -+0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0xE4, 0x90, 0x93, -+0x0F, 0xF0, 0xA3, 0xF0, 0x22, 0x7F, 0x02, 0x12, -+0x7B, 0x41, 0xEF, 0x22, 0x12, 0x88, 0xCA, 0x11, -+0x08, 0x7A, 0x93, 0x79, 0x1B, 0x02, 0x69, 0xF5, -+0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, 0x48, -+0x05, 0x7B, 0x01, 0x22, 0x12, 0x88, 0xCA, 0x11, -+0x08, 0x7A, 0x93, 0x79, 0x20, 0x02, 0x69, 0xF5, -+0x90, 0x96, 0xA4, 0x12, 0x86, 0x76, 0x90, 0x96, -+0xA3, 0xEF, 0xF0, 0x12, 0x86, 0x7F, 0x98, 0xB3, -+0x00, 0x98, 0xBC, 0x01, 0x98, 0xC5, 0x06, 0x98, -+0xD9, 0x08, 0x98, 0xE2, 0x09, 0x98, 0xEB, 0x0A, -+0x98, 0xF3, 0x12, 0x98, 0xFB, 0x13, 0x99, 0x03, -+0x14, 0x99, 0x0C, 0x1E, 0x99, 0x15, 0x20, 0x99, -+0x1E, 0x25, 0x99, 0x27, 0x26, 0x99, 0x30, 0x29, -+0x99, 0x39, 0x2A, 0x99, 0x42, 0x40, 0x99, 0x4D, -+0x42, 0x99, 0x5B, 0x43, 0x99, 0x64, 0x44, 0x9A, -+0x2D, 0x47, 0x99, 0x6D, 0x49, 0x99, 0x75, 0x60, -+0x99, 0x7E, 0x61, 0x99, 0x87, 0x62, 0x99, 0x90, -+0x63, 0x99, 0x99, 0x64, 0x99, 0xA2, 0x65, 0x99, -+0xAB, 0x66, 0x99, 0xB4, 0x67, 0x99, 0xBD, 0x68, -+0x99, 0xC6, 0x69, 0x99, 0xCE, 0x6B, 0x99, 0xD7, -+0x6C, 0x99, 0xE0, 0x6D, 0x99, 0xE9, 0x6E, 0x99, -+0xF2, 0x6F, 0x99, 0xFB, 0x70, 0x9A, 0x04, 0xC2, -+0x9A, 0x0C, 0xC3, 0x9A, 0x15, 0xC4, 0x98, 0xCD, -+0xC6, 0x98, 0xCD, 0xC7, 0x98, 0xCD, 0xC8, 0x00, -+0x00, 0x9A, 0x1E, 0x90, 0x96, 0xA4, 0x12, 0x86, -+0x6D, 0x02, 0x86, 0xDC, 0x90, 0x96, 0xA4, 0x12, -+0x86, 0x6D, 0x02, 0x88, 0x01, 0x90, 0x96, 0xA4, -+0x12, 0x86, 0x6D, 0xA1, 0xAC, 0x90, 0x96, 0xA3, -+0xE0, 0xFF, 0xA3, 0x12, 0x86, 0x6D, 0x02, 0xC0, -+0x6A, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, -+0x8F, 0xFD, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, -+0x02, 0x97, 0xFC, 0x90, 0x96, 0xA4, 0x12, 0x86, -+0x6D, 0x01, 0x14, 0x90, 0x96, 0xA4, 0x12, 0x86, -+0x6D, 0xE1, 0x90, 0x90, 0x96, 0xA4, 0x12, 0x86, -+0x6D, 0xE1, 0xF7, 0x90, 0x96, 0xA4, 0x12, 0x86, -+0x6D, 0x02, 0xA7, 0xF6, 0x90, 0x96, 0xA4, 0x12, -+0x86, 0x6D, 0x02, 0xA8, 0x05, 0x90, 0x96, 0xA4, -+0x12, 0x86, 0x6D, 0x02, 0x87, 0x2A, 0x90, 0x96, -+0xA4, 0x12, 0x86, 0x6D, 0x02, 0xAF, 0xED, 0x90, -+0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, 0xB0, 0x30, -+0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, 0xB7, -+0xF4, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, -+0xAD, 0xC9, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, -+0x90, 0x8A, 0xA5, 0x80, 0x09, 0x90, 0x96, 0xA4, -+0x12, 0x86, 0x6D, 0x90, 0x8A, 0xB5, 0xF1, 0x7E, -+0x02, 0x04, 0x7E, 0x90, 0x96, 0xA4, 0x12, 0x86, -+0x6D, 0x02, 0x25, 0xEC, 0x90, 0x96, 0xA4, 0x12, -+0x86, 0x6D, 0x02, 0x5B, 0xF3, 0x90, 0x96, 0xA4, -+0x12, 0x86, 0x6D, 0xE1, 0xCE, 0x90, 0x96, 0xA4, -+0x12, 0x86, 0x6D, 0x02, 0x8A, 0x5D, 0x90, 0x96, -+0xA4, 0x12, 0x86, 0x6D, 0x02, 0x77, 0x4F, 0x90, -+0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, 0x7C, 0x60, -+0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, 0x7A, -+0xC6, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, -+0x5D, 0x36, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, -+0x02, 0x7B, 0xE9, 0x90, 0x96, 0xA4, 0x12, 0x86, -+0x6D, 0x02, 0x70, 0x33, 0x90, 0x96, 0xA4, 0x12, -+0x86, 0x6D, 0x02, 0x48, 0xC9, 0x90, 0x96, 0xA4, -+0x12, 0x86, 0x6D, 0x02, 0x79, 0xF3, 0x90, 0x96, -+0xA4, 0x12, 0x86, 0x6D, 0x80, 0x60, 0x90, 0x96, -+0xA4, 0x12, 0x86, 0x6D, 0x02, 0x51, 0x7B, 0x90, -+0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, 0x79, 0x30, -+0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, 0x57, -+0xF2, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, 0x02, -+0x74, 0x8D, 0x90, 0x96, 0xA4, 0x12, 0x86, 0x6D, -+0x02, 0x78, 0x9A, 0x90, 0x96, 0xA4, 0x12, 0x86, -+0x6D, 0x02, 0x5E, 0x0B, 0x90, 0x96, 0xA4, 0x12, -+0x86, 0x6D, 0xE1, 0xC6, 0x90, 0x96, 0xA4, 0x12, -+0x86, 0x6D, 0x02, 0xB8, 0x0A, 0x90, 0x96, 0xA4, -+0x12, 0x86, 0x6D, 0x02, 0xBF, 0xCE, 0x90, 0x01, -+0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x96, 0xA3, -+0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x12, 0x02, -+0x06, 0xFF, 0x12, 0x87, 0xDF, 0x90, 0x94, 0xBF, -+0x12, 0x87, 0xE6, 0x90, 0x94, 0xC0, 0x12, 0x87, -+0xF0, 0x90, 0x94, 0xC1, 0x12, 0x87, 0xFA, 0x90, -+0x94, 0xC2, 0x12, 0x87, 0x23, 0x90, 0x94, 0xC3, -+0xF1, 0xBF, 0x90, 0x94, 0xC4, 0xF0, 0xEF, 0x12, -+0x86, 0x7F, 0x9A, 0x76, 0x00, 0x9A, 0x82, 0x01, -+0x9A, 0x89, 0x02, 0x9A, 0x90, 0x03, 0x9A, 0x97, -+0x04, 0x9A, 0x9E, 0x05, 0x9A, 0xA7, 0x06, 0x9A, -+0xD0, 0x07, 0x00, 0x00, 0x9B, 0x29, 0x90, 0x94, -+0xBD, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x29, 0xF0, -+0x61, 0x2E, 0xB1, 0x19, 0x74, 0x2A, 0xF0, 0x61, -+0x2E, 0x91, 0x7F, 0x74, 0x31, 0xF0, 0x61, 0x2E, -+0x91, 0x7F, 0x74, 0x32, 0xF0, 0x61, 0x2E, 0xB1, -+0x19, 0x74, 0x33, 0xF0, 0x61, 0x2E, 0xB1, 0x12, -+0x90, 0x8A, 0x83, 0xF1, 0x7E, 0x61, 0x45, 0x90, -+0x94, 0xBF, 0xE0, 0x90, 0x88, 0xE1, 0xF0, 0x90, -+0x94, 0xC0, 0xE0, 0x90, 0x88, 0xE2, 0xF0, 0x90, -+0x94, 0xC1, 0xE0, 0x90, 0x88, 0xE3, 0xF0, 0x90, -+0x94, 0xC2, 0xE0, 0x90, 0x88, 0xE4, 0xF0, 0x90, -+0x94, 0xC3, 0xE0, 0x90, 0x88, 0xE5, 0xF0, 0x22, -+0x90, 0x94, 0xBF, 0xE0, 0x90, 0x94, 0xAC, 0xF0, -+0x90, 0x94, 0xC2, 0x71, 0x49, 0x78, 0x10, 0x12, -+0x03, 0xFE, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x71, 0x48, 0x78, 0x18, 0x12, 0x03, -+0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0x94, 0xC1, 0x71, -+0x49, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, -+0x54, 0xB1, 0xA3, 0x90, 0x94, 0xC0, 0x71, 0x49, -+0x12, 0x86, 0x54, 0x90, 0x94, 0xA2, 0x02, 0x04, -+0x31, 0x91, 0x7F, 0x74, 0xFF, 0xF0, 0x90, 0x94, -+0xBE, 0xE0, 0xFF, 0x90, 0x94, 0xBD, 0xE0, 0xFD, -+0xB1, 0x12, 0x90, 0x8A, 0xCF, 0xE0, 0xF8, 0xA3, -+0xE0, 0xF5, 0x82, 0x88, 0x83, 0x02, 0x04, 0x7E, -+0xA3, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, -+0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, -+0x8A, 0x8F, 0x80, 0x03, 0x90, 0x8A, 0x87, 0x12, -+0x88, 0xDF, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, -+0x04, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0xE7, -+0xE0, 0x64, 0x08, 0x70, 0x21, 0x90, 0x88, 0xE6, -+0xE0, 0x30, 0xE0, 0x15, 0x12, 0xAF, 0xD6, 0xF0, -+0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, -+0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0x80, -+0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, 0xF1, 0x88, -+0x54, 0x03, 0x30, 0xE0, 0x13, 0x90, 0x88, 0xE8, -+0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, -+0x04, 0x9C, 0xE4, 0xF0, 0x90, 0x88, 0xE8, 0xF0, -+0x90, 0x88, 0x36, 0xE0, 0x60, 0x7C, 0x90, 0x88, -+0x4D, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x61, 0x71, -+0x49, 0xB1, 0x9E, 0x90, 0x05, 0x60, 0x71, 0x49, -+0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x71, 0x49, -+0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x54, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0x71, 0x48, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -+0x86, 0x54, 0x90, 0x88, 0x81, 0x12, 0x04, 0x31, -+0x90, 0x88, 0x32, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, -+0xE0, 0x30, 0xE0, 0x0B, 0x12, 0xB6, 0x1A, 0x74, -+0x05, 0xF0, 0x12, 0x6E, 0x2F, 0xF1, 0xDE, 0x90, -+0x88, 0x32, 0xB1, 0x24, 0x30, 0xE0, 0x0B, 0x90, -+0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x04, 0xF1, 0xA3, -+0xF1, 0xB1, 0xF1, 0xD6, 0xBF, 0x03, 0x14, 0x90, -+0x93, 0x4A, 0xE0, 0xB4, 0x01, 0x0D, 0x90, 0x01, -+0xB8, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x21, 0xE0, -+0x44, 0x80, 0xF0, 0x90, 0x8A, 0xE5, 0x12, 0x8C, -+0xE5, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x93, -+0x29, 0xE0, 0x30, 0xE0, 0x09, 0x12, 0xDB, 0x9E, -+0x12, 0x8F, 0x8F, 0x12, 0x8F, 0xF5, 0x90, 0x86, -+0xB3, 0xE0, 0xB4, 0x01, 0x11, 0x12, 0xB5, 0x97, -+0x20, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x54, 0x07, -+0x30, 0xE0, 0x03, 0x12, 0xDA, 0x63, 0x22, 0x90, -+0x94, 0xBD, 0x74, 0x01, 0xF0, 0xA3, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, -+0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, -+0x08, 0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, -+0x6C, 0x12, 0xD7, 0x56, 0xF1, 0xAA, 0x90, 0x07, -+0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, -+0xC8, 0x2F, 0x12, 0xD7, 0x4D, 0xFE, 0x74, 0xB3, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, -+0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x04, 0xE8, 0x90, -+0x96, 0xB4, 0x71, 0x49, 0xB1, 0x9E, 0x90, 0x96, -+0xB3, 0x71, 0x49, 0x12, 0x86, 0x54, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, -+0xB5, 0x71, 0x49, 0x78, 0x10, 0x12, 0x03, 0xFE, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x71, 0x48, 0x78, 0x18, 0x12, -+0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0x86, 0x54, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xBF, -+0x22, 0x90, 0x94, 0xBD, 0x74, 0x06, 0xF0, 0xA3, -+0x22, 0x90, 0x88, 0x3E, 0xE0, 0x13, 0x13, 0x13, -+0x54, 0x1F, 0x22, 0xE4, 0xF5, 0x7A, 0x90, 0x88, -+0x36, 0xE0, 0x60, 0x5F, 0xF1, 0xEE, 0x70, 0x5B, -+0x12, 0xDA, 0xB8, 0xF0, 0x75, 0x7A, 0x01, 0xE5, -+0x7A, 0x60, 0x50, 0x90, 0x88, 0x39, 0xE0, 0x20, -+0xE2, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8C, 0xE5, -+0x7D, 0x01, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xF1, -+0xE6, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x04, 0x64, -+0x01, 0x70, 0x15, 0xE4, 0x90, 0x92, 0x20, 0xF0, -+0xB1, 0x21, 0xFF, 0xA3, 0xE0, 0x2F, 0x12, 0x8F, -+0x90, 0xB1, 0x21, 0xFF, 0xA3, 0xE0, 0x80, 0x11, -+0xE4, 0x90, 0x92, 0x20, 0xF0, 0xB1, 0x21, 0xB1, -+0x94, 0x2F, 0x12, 0x8F, 0x90, 0xB1, 0x21, 0xB1, -+0x94, 0x2F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, -+0x88, 0x4F, 0xF0, 0x22, 0xFF, 0xA3, 0xE0, 0x75, -+0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, 0x78, 0x08, -+0x12, 0x03, 0xFE, 0xA8, 0x04, 0xA9, 0x05, 0xAA, -+0x06, 0xAB, 0x07, 0x22, 0x12, 0x02, 0x06, 0x64, -+0x01, 0x60, 0x02, 0xC1, 0x3C, 0x90, 0x95, 0x04, -+0xF0, 0x90, 0x95, 0x04, 0xE0, 0xFF, 0xC3, 0x94, -+0x10, 0x50, 0x28, 0xEF, 0x12, 0xC1, 0xA4, 0x7A, -+0x95, 0x79, 0x03, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -+0x12, 0x90, 0x95, 0x03, 0xE0, 0xFF, 0xA3, 0xE0, -+0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, -+0x83, 0xEF, 0xF0, 0x90, 0x95, 0x04, 0xE0, 0x04, -+0xF0, 0x80, 0xCE, 0x75, 0x45, 0x01, 0x75, 0x46, -+0x95, 0x75, 0x47, 0x05, 0x75, 0x48, 0x08, 0xB1, -+0x12, 0x12, 0x69, 0xF5, 0x90, 0x94, 0xBD, 0x74, -+0x24, 0xF0, 0x90, 0x94, 0xDF, 0x74, 0x08, 0xF0, -+0x75, 0x45, 0x01, 0x75, 0x46, 0x95, 0x75, 0x47, -+0x0D, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x94, 0x79, -+0xE2, 0x12, 0x69, 0xF5, 0x90, 0x94, 0xE0, 0x74, -+0x25, 0xF0, 0x90, 0x95, 0x02, 0x74, 0x08, 0xD1, -+0x3D, 0xF1, 0x7B, 0x12, 0x04, 0x7E, 0x7B, 0x01, -+0x7A, 0x94, 0x79, 0xE0, 0x12, 0x8C, 0xD3, 0x7F, -+0x04, 0x12, 0x04, 0x7E, 0x22, 0xF0, 0x7B, 0x01, -+0x7A, 0x94, 0x79, 0xBD, 0x22, 0xD1, 0x3E, 0x7F, -+0xEF, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -+0x06, 0x90, 0x94, 0xBD, 0xE0, 0xA3, 0xF0, 0xD1, -+0x3E, 0x7F, 0xEE, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -+0xBF, 0x01, 0x08, 0x90, 0x94, 0xBD, 0xE0, 0x90, -+0x94, 0xBF, 0xF0, 0xD1, 0x3E, 0x7F, 0xED, 0x7E, -+0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, -+0x94, 0xBD, 0xE0, 0x90, 0x94, 0xC0, 0xF0, 0xD1, -+0x3E, 0x7F, 0xEC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -+0xBF, 0x01, 0x08, 0x90, 0x94, 0xBD, 0xE0, 0x90, -+0x94, 0xC1, 0xF0, 0xD1, 0x3E, 0x7F, 0xEB, 0x7E, -+0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, -+0x94, 0xBD, 0xE0, 0x90, 0x94, 0xC2, 0xF0, 0x90, -+0x94, 0xBE, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, -+0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x94, 0xC6, 0xF0, -+0x90, 0x94, 0xC2, 0xE0, 0x90, 0x94, 0xC7, 0xF0, -+0x90, 0x94, 0xC8, 0x74, 0x12, 0xF0, 0x90, 0x94, -+0xEA, 0x74, 0x05, 0xF0, 0x90, 0x94, 0xCA, 0x12, -+0xCA, 0x72, 0x90, 0x94, 0xC6, 0xE0, 0x90, 0x94, -+0xCD, 0xF0, 0x90, 0x94, 0xC7, 0xE0, 0x90, 0x94, -+0xCE, 0xF0, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xC8, -+0x12, 0x8C, 0xD3, 0x7F, 0x04, 0x02, 0x04, 0x7E, -+0x7E, 0x00, 0x7F, 0x0B, 0x7D, 0x00, 0x7B, 0x01, -+0x7A, 0x93, 0x79, 0x4C, 0x12, 0x04, 0x80, 0xD1, -+0x3E, 0xF1, 0xB8, 0xBF, 0x01, 0x1C, 0x90, 0x94, -+0xBD, 0xE0, 0xFE, 0x54, 0x01, 0x90, 0x93, 0x4C, -+0xF0, 0xEE, 0x54, 0x04, 0x90, 0x93, 0x4E, 0xF0, -+0x90, 0x94, 0xBD, 0xE0, 0x54, 0x08, 0x90, 0x93, -+0x4D, 0xF0, 0xD1, 0x3E, 0x7F, 0xFB, 0x12, 0xBA, -+0xA4, 0x70, 0x35, 0x90, 0x94, 0xBD, 0xE0, 0x54, -+0x07, 0x70, 0x15, 0x7B, 0x01, 0x7A, 0x94, 0x79, -+0xBE, 0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -+0xBF, 0x01, 0x0F, 0x90, 0x94, 0xBE, 0x80, 0x03, -+0x90, 0x94, 0xBD, 0xE0, 0x54, 0x07, 0x90, 0x93, -+0x50, 0xF0, 0x90, 0x94, 0xBD, 0xE0, 0x54, 0xE0, -+0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, 0x4F, 0xF0, -+0xD1, 0x3E, 0x7F, 0xFD, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x94, 0xBD, 0xE0, -+0x54, 0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x93, -+0x51, 0xF0, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x22, -+0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x13, 0x22, -+0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0x28, 0xF0, -+0xBF, 0x01, 0x07, 0xD1, 0x45, 0xE4, 0x90, 0x93, -+0x28, 0xF0, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, -+0x7C, 0x7E, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, -+0x22, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, -+0x7F, 0xF9, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0xF0, -+0x90, 0x00, 0x06, 0x02, 0x02, 0x1F, 0x12, 0x02, -+0x06, 0x90, 0x93, 0x4A, 0xF0, 0x22, 0x12, 0x02, -+0x06, 0x90, 0x96, 0x13, 0xF0, 0x22, 0x90, 0x01, -+0x02, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0x90, 0x88, -+0x33, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x88, -+0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xE4, 0xFF, -+0x12, 0x78, 0x4A, 0xEF, 0x64, 0x01, 0x22, 0x12, -+0x02, 0x06, 0xFF, 0x54, 0x80, 0xFE, 0x90, 0x93, -+0x57, 0xE0, 0x54, 0x7F, 0x4E, 0xFE, 0xF0, 0xEF, -+0x54, 0x40, 0xFF, 0xEE, 0x54, 0xBF, 0x4F, 0xF1, -+0xE7, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, -+0xFF, 0x90, 0x93, 0x57, 0xF0, 0xEE, 0x54, 0x10, -+0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x12, -+0x02, 0x06, 0x54, 0x0F, 0xFE, 0xEF, 0x54, 0xF0, -+0x4E, 0x90, 0x93, 0x57, 0x12, 0x87, 0xDE, 0xFF, -+0x54, 0x7F, 0x90, 0x93, 0x59, 0xF0, 0xEF, 0x31, -+0xDB, 0xFF, 0x90, 0x93, 0x58, 0xE0, 0x54, 0xFE, -+0x12, 0x87, 0xE5, 0x90, 0x93, 0x5A, 0x12, 0x87, -+0xF0, 0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x93, -+0x58, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0x31, 0xB8, -+0x20, 0xE0, 0x02, 0x7D, 0x01, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xC5, 0xED, -+0xF0, 0x90, 0x96, 0xC4, 0xEF, 0xF0, 0xD3, 0x94, -+0x07, 0x50, 0x42, 0x7F, 0x47, 0x31, 0x0D, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, -+0x7F, 0x47, 0x12, 0x7B, 0x2E, 0x7F, 0x46, 0x31, -+0x0D, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, -+0xFD, 0x7F, 0x46, 0x31, 0xD1, 0x60, 0x0D, 0x7F, -+0x45, 0x31, 0x0D, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0x4F, 0x80, 0x0C, 0x7F, 0x45, 0x31, 0x0D, -+0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, -+0xFD, 0x7F, 0x45, 0x80, 0x46, 0x90, 0x96, 0xC4, -+0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0x31, 0x0D, -+0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, -+0xFD, 0x7F, 0x63, 0x12, 0x7B, 0x2E, 0x7F, 0x62, -+0x31, 0x0D, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -+0x4F, 0xFD, 0x7F, 0x62, 0x31, 0xD1, 0x60, 0x0E, -+0x31, 0x0B, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -+0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x0D, 0x31, 0x0B, -+0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, -+0xFD, 0x7F, 0x61, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x7F, 0x61, 0x12, 0x7B, 0x41, -+0x90, 0x96, 0xC4, 0xE0, 0xFE, 0x74, 0x01, 0xA8, -+0x06, 0x08, 0x22, 0xAD, 0x07, 0x90, 0x93, 0x59, -+0xE0, 0x75, 0xF0, 0x20, 0xA4, 0xFF, 0x90, 0x96, -+0x8D, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -+0x93, 0x5A, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0xAE, -+0xF0, 0x90, 0x96, 0x8F, 0xF0, 0xEE, 0xA3, 0xF0, -+0x31, 0xC9, 0x90, 0x96, 0x91, 0xF0, 0xEE, 0xA3, -+0xF0, 0xED, 0x64, 0x01, 0x60, 0x62, 0x90, 0x93, -+0x57, 0xE0, 0xFE, 0x31, 0xDD, 0x30, 0xE0, 0x58, -+0xEE, 0x31, 0xBD, 0x20, 0xE0, 0x02, 0x7D, 0x01, -+0x31, 0xB1, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, 0xC4, -+0x13, 0x13, 0x54, 0x01, 0xFD, 0x31, 0xB1, 0xC4, -+0x13, 0x54, 0x07, 0x30, 0xE0, 0x23, 0xA3, 0xE0, -+0x30, 0xE0, 0x0F, 0x90, 0x96, 0x92, 0xE0, 0x90, -+0x92, 0x20, 0xF0, 0x90, 0x96, 0x91, 0xD1, 0xB7, -+0x80, 0x0F, 0x31, 0xC9, 0xFF, 0x12, 0x7C, 0x6A, -+0x31, 0xB8, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x11, -+0x65, 0x90, 0x93, 0x57, 0xE0, 0xC4, 0x54, 0x0F, -+0x30, 0xE0, 0x0D, 0x90, 0x96, 0x90, 0xE0, 0x90, -+0x92, 0x20, 0xF0, 0x90, 0x96, 0x8F, 0xD1, 0xB7, -+0x22, 0x11, 0x65, 0x90, 0x93, 0x57, 0xE0, 0x22, -+0x90, 0x93, 0x57, 0xE0, 0xFE, 0x54, 0x0F, 0xFF, -+0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x7D, 0x00, -+0x22, 0x90, 0x96, 0x8D, 0xE0, 0xFE, 0xA3, 0xE0, -+0x22, 0x12, 0x7B, 0x2E, 0x90, 0x96, 0xC5, 0xE0, -+0x22, 0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, -+0x13, 0x54, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x91, 0xD3, 0x20, 0xE6, 0x02, -+0x41, 0xFA, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x96, -+0xBA, 0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, -+0x96, 0xBB, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, -+0x90, 0x96, 0xBC, 0xF0, 0x90, 0x96, 0xBB, 0xE0, -+0x24, 0xFC, 0x60, 0x0F, 0x24, 0x03, 0x60, 0x02, -+0x41, 0xF3, 0x90, 0x96, 0xBA, 0xE0, 0xFF, 0x91, -+0xDA, 0x41, 0xF3, 0x90, 0x96, 0xBA, 0xE0, 0x24, -+0xD6, 0x12, 0xCB, 0x49, 0xFB, 0xE4, 0xFD, 0xFF, -+0x71, 0x2C, 0x75, 0xF0, 0x12, 0x71, 0x38, 0x13, -+0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, -+0x2C, 0x75, 0xF0, 0x12, 0x71, 0x38, 0x31, 0xDD, -+0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x2C, 0x75, 0xF0, -+0x12, 0x71, 0x38, 0xC4, 0x54, 0x03, 0xFB, 0x0D, -+0xE4, 0xFF, 0x71, 0x2C, 0x75, 0xF0, 0x12, 0xF1, -+0x80, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x2C, 0xF1, -+0xA7, 0x71, 0x29, 0x75, 0xF0, 0x12, 0x91, 0xA6, -+0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, -+0x71, 0x2C, 0x75, 0xF0, 0x12, 0x91, 0xA6, 0x54, -+0x1F, 0x71, 0x2A, 0xF1, 0xB0, 0xE0, 0xFB, 0xE4, -+0xFD, 0x0F, 0x71, 0x2C, 0x75, 0xF0, 0x08, 0xA4, -+0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, -+0x27, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x02, 0xF5, -+0x82, 0xE4, 0x34, 0x82, 0x71, 0x27, 0x75, 0xF0, -+0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, -+0x82, 0x71, 0x27, 0x75, 0xF0, 0x08, 0xA4, 0x24, -+0x04, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, -+0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x2C, 0x75, -+0xF0, 0x08, 0xA4, 0x24, 0x05, 0xF5, 0x82, 0xE4, -+0x34, 0x82, 0x71, 0x27, 0x75, 0xF0, 0x08, 0xA4, -+0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, -+0x27, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x07, 0xF5, -+0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFB, -+0x0D, 0x51, 0xFF, 0x91, 0xD3, 0x30, 0xE0, 0x02, -+0xF1, 0x88, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, -+0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, -+0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, -+0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, -+0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xF5, -+0x83, 0xE0, 0xFB, 0x0D, 0x51, 0xFF, 0x90, 0x96, -+0xBA, 0xE0, 0x22, 0xFF, 0x75, 0xF0, 0x12, 0xED, -+0x90, 0x89, 0x52, 0x12, 0x04, 0x6E, 0xE0, 0x22, -+0x90, 0x96, 0x7B, 0x12, 0x86, 0x76, 0x91, 0x9B, -+0x12, 0x02, 0x06, 0x54, 0x7F, 0xFD, 0x12, 0x87, -+0xDF, 0xFE, 0x54, 0x1F, 0x90, 0x96, 0x7F, 0x31, -+0xD9, 0x90, 0x96, 0x7E, 0x12, 0x87, 0xE6, 0xFE, -+0x54, 0x03, 0xFC, 0xEE, 0x54, 0x30, 0xC4, 0x54, -+0x0F, 0x90, 0x96, 0x81, 0x12, 0x87, 0xE6, 0xFE, -+0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, -+0x96, 0x80, 0x31, 0xD9, 0xFF, 0x12, 0x87, 0xE7, -+0xFB, 0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0x90, 0x96, 0x83, 0xF0, 0xFA, 0xEB, 0x54, 0x04, -+0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEF, 0x54, -+0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0x71, -+0x33, 0x54, 0x7F, 0x4F, 0xF0, 0x90, 0x96, 0x80, -+0xE0, 0xF1, 0x97, 0x71, 0x33, 0x54, 0xBF, 0x4F, -+0xF0, 0xEA, 0x60, 0x02, 0x81, 0x94, 0x90, 0x96, -+0x7F, 0xE0, 0x54, 0x1F, 0x91, 0xA1, 0x54, 0xE0, -+0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x71, 0x33, 0x54, -+0xFC, 0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x25, 0xE0, -+0x25, 0xE0, 0x71, 0x33, 0x54, 0xF3, 0x4F, 0xF0, -+0x90, 0x96, 0x7E, 0xE0, 0x54, 0x01, 0xC4, 0x33, -+0x54, 0xE0, 0x91, 0xA1, 0x54, 0xDF, 0x4F, 0xF0, -+0x90, 0x96, 0x81, 0xE0, 0x54, 0x03, 0xC4, 0x54, -+0xF0, 0x71, 0x33, 0x54, 0xCF, 0x4F, 0xF0, 0x74, -+0xC6, 0x2D, 0xD1, 0x95, 0xE0, 0x54, 0xFB, 0xF0, -+0x74, 0xC6, 0x2D, 0xD1, 0x95, 0xC0, 0x83, 0xC0, -+0x82, 0xE0, 0xFF, 0x90, 0x96, 0x84, 0xE0, 0xF1, -+0xEE, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0x93, -+0x52, 0xE0, 0x60, 0x34, 0x91, 0x9B, 0xE9, 0x24, -+0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, -+0x54, 0x1F, 0x12, 0x02, 0x4C, 0x90, 0x96, 0x82, -+0x74, 0x01, 0xF0, 0x90, 0x96, 0x82, 0xE0, 0xFF, -+0xC3, 0x94, 0x04, 0x50, 0x13, 0xEF, 0x91, 0x95, -+0x8F, 0x82, 0x8E, 0x83, 0xE4, 0x12, 0x02, 0x5E, -+0x90, 0x96, 0x82, 0xE0, 0x04, 0xF0, 0x80, 0xE3, -+0x90, 0x93, 0x50, 0xE0, 0x54, 0x07, 0xFF, 0xBF, -+0x05, 0x0A, 0xEC, 0xB4, 0x01, 0x06, 0x90, 0x93, -+0x55, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x96, 0x82, -+0xF0, 0x90, 0x96, 0x82, 0xE0, 0xFC, 0x91, 0x95, -+0x8F, 0x82, 0x8E, 0x83, 0x12, 0x02, 0x1F, 0xFF, -+0xED, 0xF1, 0xB0, 0xE5, 0x82, 0x2C, 0xF1, 0x8F, -+0xEF, 0xF0, 0x90, 0x96, 0x82, 0xE0, 0x04, 0xF0, -+0xE0, 0xB4, 0x04, 0xDD, 0xAF, 0x05, 0x90, 0x8A, -+0xFF, 0x12, 0xA9, 0xA7, 0x22, 0x24, 0x03, 0xFF, -+0xE4, 0x33, 0xFE, 0x90, 0x96, 0x7B, 0x02, 0x86, -+0x6D, 0xFF, 0x75, 0xF0, 0x12, 0xED, 0x90, 0x89, -+0x51, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0x90, 0x93, -+0x57, 0xE0, 0xFF, 0x31, 0xDD, 0x30, 0xE0, 0x1A, -+0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x12, -+0xD3, 0x8E, 0x90, 0x93, 0x58, 0xE0, 0x30, 0xE0, -+0x09, 0x31, 0xB8, 0x20, 0xE0, 0x02, 0x7D, 0x01, -+0x11, 0x65, 0x22, 0x7F, 0x8F, 0x12, 0x7B, 0x41, -+0xEF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x96, 0xC2, 0xEF, 0xF0, 0x91, 0xD3, -+0x30, 0xE6, 0x37, 0x7F, 0x8D, 0x12, 0x7B, 0x41, -+0xEF, 0x64, 0x01, 0x70, 0x2D, 0x90, 0x96, 0xC3, -+0xF0, 0x90, 0x96, 0xC3, 0xE0, 0xFD, 0x90, 0x96, -+0xC2, 0xE0, 0xB1, 0x36, 0xE5, 0x82, 0x2D, 0xF1, -+0x8F, 0xE0, 0xFB, 0xE4, 0xFF, 0x51, 0xFF, 0x90, -+0x96, 0xC3, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, -+0x10, 0x40, 0xDE, 0x91, 0xD3, 0x30, 0xE0, 0x02, -+0xF1, 0x88, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, -+0xB6, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x8E, -+0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x0E, 0xC4, 0x54, -+0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, -+0xF5, 0x83, 0x22, 0x8D, 0x0E, 0xEF, 0x30, 0xE6, -+0x1B, 0xB1, 0x34, 0x12, 0x8F, 0x75, 0xE0, 0x54, -+0x03, 0x90, 0x92, 0x80, 0xF0, 0xE4, 0xFB, 0xAF, -+0x0E, 0x12, 0x75, 0x80, 0xB1, 0x27, 0xB1, 0xBC, -+0x74, 0x01, 0x80, 0x4F, 0xB1, 0xC3, 0x04, 0xF0, -+0xB1, 0xC3, 0x64, 0x02, 0x70, 0x1E, 0x74, 0x25, -+0x25, 0x0E, 0xD1, 0x8D, 0xE0, 0xFD, 0xF4, 0x60, -+0x02, 0x80, 0x04, 0xB1, 0x34, 0xE0, 0xFD, 0x12, -+0x8F, 0x77, 0xD1, 0xA9, 0xB1, 0x34, 0xB1, 0xBC, -+0x74, 0x02, 0x80, 0x27, 0xB1, 0xC3, 0xD3, 0x94, -+0x03, 0x40, 0x13, 0x90, 0x8A, 0xB3, 0x12, 0x8C, -+0xE5, 0xAF, 0x0E, 0x12, 0x04, 0x7E, 0xB1, 0x27, -+0xB1, 0xBC, 0x74, 0x03, 0x80, 0x0D, 0xB1, 0x34, -+0x12, 0x8F, 0x75, 0xD1, 0xA9, 0xB1, 0x34, 0xB1, -+0xBC, 0x74, 0x02, 0xF0, 0xAB, 0x0E, 0xE4, 0xFD, -+0xFF, 0x02, 0x6F, 0x75, 0xE0, 0x90, 0x92, 0x5E, -+0xF0, 0xA3, 0x22, 0x74, 0xB6, 0x25, 0x0E, 0xF5, -+0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, 0x22, -+0x8F, 0x73, 0x8D, 0x74, 0xEF, 0xB1, 0x36, 0xE0, -+0xFD, 0x54, 0x7F, 0xF5, 0x75, 0xED, 0x54, 0x80, -+0xF5, 0x76, 0xF1, 0x7C, 0xF5, 0x78, 0x75, 0xF0, -+0x12, 0xEF, 0x71, 0x38, 0xC4, 0x54, 0x03, 0xF5, -+0x79, 0xD1, 0x89, 0x74, 0xFF, 0xF0, 0xF1, 0xBE, -+0xE5, 0x76, 0x4D, 0xFF, 0xD1, 0x9D, 0xEF, 0xF0, -+0xE5, 0x73, 0x12, 0x8F, 0x79, 0xE0, 0x54, 0x03, -+0xF5, 0x77, 0x74, 0x46, 0x25, 0x73, 0xF1, 0x9F, -+0xE5, 0x77, 0xF0, 0xE5, 0x75, 0x65, 0x78, 0x70, -+0x22, 0x75, 0xF0, 0x12, 0xE5, 0x73, 0x91, 0xA6, -+0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0B, 0xE5, -+0x76, 0x70, 0x07, 0xE5, 0x75, 0x44, 0x80, 0xFD, -+0x80, 0x4A, 0xF1, 0xBE, 0x7D, 0x07, 0xAF, 0x73, -+0x02, 0xCA, 0x8B, 0xE5, 0x75, 0xC3, 0x95, 0x78, -+0x50, 0x34, 0xAB, 0x73, 0xAD, 0x78, 0xAF, 0x75, -+0x12, 0x72, 0x7F, 0xAD, 0x07, 0xE5, 0x75, 0xC3, -+0x94, 0x0C, 0x40, 0x28, 0x75, 0xF0, 0x12, 0xE5, -+0x73, 0x91, 0xA6, 0xFE, 0xC4, 0x13, 0x54, 0x07, -+0x30, 0xE0, 0x19, 0xE5, 0x74, 0x60, 0x15, 0xE5, -+0x76, 0x70, 0x11, 0xE5, 0x75, 0x44, 0x80, 0xFD, -+0xD1, 0x89, 0xEF, 0xF0, 0x80, 0x06, 0xD1, 0x9D, -+0xE5, 0x78, 0xF0, 0xFD, 0x90, 0x92, 0x80, 0xE5, -+0x77, 0xF0, 0xAB, 0x74, 0xAF, 0x73, 0x02, 0x75, -+0x80, 0x74, 0x25, 0x25, 0x73, 0xF5, 0x82, 0xE4, -+0x34, 0x96, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, -+0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xC6, 0x25, -+0x73, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, -+0x22, 0xE0, 0x54, 0x03, 0x90, 0x92, 0x80, 0xF0, -+0x7B, 0x01, 0xAF, 0x0E, 0x02, 0x75, 0x80, 0xE0, -+0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, -+0x58, 0x7E, 0x01, 0x02, 0x66, 0x33, 0xAA, 0x07, -+0xA9, 0x05, 0xEA, 0xB1, 0x36, 0xE0, 0xF5, 0x73, -+0x54, 0x7F, 0xF5, 0x75, 0x75, 0xF0, 0x12, 0xEA, -+0xF1, 0xAA, 0xE0, 0x90, 0x95, 0x4F, 0xF0, 0x75, -+0xF0, 0x12, 0xEA, 0xF1, 0x80, 0xFF, 0xEA, 0x12, -+0x8F, 0x79, 0xE0, 0x54, 0x03, 0xF5, 0x74, 0xE5, -+0x75, 0x90, 0x81, 0x9D, 0x93, 0xFD, 0xEA, 0x25, -+0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -+0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xED, 0xF0, 0x75, -+0xF0, 0x12, 0xEA, 0x71, 0x38, 0xFE, 0xC4, 0x54, -+0x03, 0x90, 0x95, 0x4E, 0xF0, 0x74, 0xC6, 0x2A, -+0xD1, 0xA1, 0xE5, 0x75, 0xF0, 0x74, 0x46, 0x2A, -+0xF1, 0x9F, 0xE5, 0x74, 0xF0, 0xE5, 0x75, 0xD3, -+0x9F, 0x40, 0x04, 0x8F, 0x75, 0x8F, 0x73, 0x89, -+0x76, 0xE4, 0xFF, 0xEF, 0xC3, 0x95, 0x76, 0x50, -+0x34, 0xE5, 0x73, 0x30, 0xE7, 0x09, 0x85, 0x75, -+0x73, 0x19, 0xE9, 0x70, 0x25, 0x80, 0x26, 0x90, -+0x95, 0x4F, 0xE0, 0xFD, 0xE5, 0x75, 0xD3, 0x9D, -+0x40, 0x10, 0xAB, 0x02, 0x90, 0x95, 0x53, 0xE9, -+0xF0, 0xAF, 0x75, 0x12, 0xD2, 0xCB, 0x8F, 0x73, -+0x80, 0x0B, 0x90, 0x95, 0x4F, 0xE0, 0xF5, 0x73, -+0x80, 0x03, 0x0F, 0x80, 0xC6, 0xAF, 0x02, 0x90, -+0x92, 0x80, 0xE5, 0x74, 0xF0, 0xE4, 0xFB, 0xAD, -+0x73, 0x02, 0x75, 0x80, 0x75, 0xF0, 0x12, 0xEF, -+0x90, 0x89, 0x4F, 0x12, 0x04, 0x6E, 0xE0, 0x22, -+0xE4, 0xFD, 0x7F, 0x8D, 0x02, 0x7B, 0x2E, 0xF5, -+0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x22, 0x54, -+0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0x22, 0xF5, -+0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x75, -+0xF0, 0x12, 0x90, 0x89, 0x50, 0x02, 0x04, 0x6E, -+0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, -+0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0xE5, 0x75, -+0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, -+0x81, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, -+0x93, 0xFF, 0xE5, 0x73, 0x25, 0xE0, 0x24, 0x75, -+0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x21, 0xE4, 0xFF, -+0xF0, 0x12, 0x02, 0x06, 0xFE, 0x22, 0x25, 0xE0, -+0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0x22, 0x12, 0x02, -+0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x5C, 0xE0, -+0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x02, 0x06, -+0x90, 0x94, 0xE0, 0x12, 0x87, 0xDE, 0x90, 0x94, -+0xE1, 0xF0, 0x60, 0x0D, 0x11, 0x4F, 0x51, 0xF2, -+0x90, 0x94, 0xE1, 0x11, 0x4F, 0x7B, 0x57, 0x11, -+0x5B, 0x90, 0x94, 0xBD, 0x74, 0x20, 0xF0, 0x90, -+0x94, 0xDF, 0x74, 0x03, 0xF0, 0x90, 0x05, 0x22, -+0xE0, 0x90, 0x94, 0xBF, 0xF0, 0x90, 0x93, 0x5D, -+0xE0, 0x90, 0x94, 0xC0, 0xF0, 0x90, 0x93, 0x5E, -+0xE0, 0x90, 0x94, 0xC1, 0x12, 0x9E, 0x3D, 0x12, -+0x8C, 0xD3, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xE0, -+0xFF, 0x90, 0x94, 0xE0, 0xE0, 0xFD, 0x22, 0x7D, -+0xFF, 0xE4, 0xFF, 0xEB, 0xB4, 0x57, 0x04, 0x11, -+0xF7, 0x80, 0x0E, 0xEF, 0x70, 0x07, 0x90, 0x93, -+0x5D, 0xE0, 0x4D, 0x80, 0x04, 0x71, 0x0A, 0x11, -+0xF7, 0x90, 0x05, 0x22, 0xF0, 0x90, 0x93, 0x01, -+0xEB, 0xF0, 0x22, 0xE4, 0x90, 0x96, 0xB7, 0xF0, -+0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, -+0xB9, 0xF0, 0x7B, 0x47, 0x11, 0x57, 0x90, 0x05, -+0xF8, 0xE0, 0x70, 0x1A, 0xA3, 0xE0, 0x70, 0x16, -+0xA3, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, -+0x90, 0x96, 0xB9, 0xE0, 0xFD, 0x7B, 0x48, 0xE4, -+0xFF, 0x11, 0x5B, 0x7F, 0x01, 0x22, 0x12, 0x9F, -+0x88, 0x54, 0x03, 0x30, 0xE0, 0x19, 0xD3, 0x90, -+0x96, 0xB8, 0xE0, 0x94, 0x03, 0x90, 0x96, 0xB7, -+0xE0, 0x94, 0x00, 0x40, 0x06, 0x31, 0x02, 0x7B, -+0x5A, 0x80, 0x17, 0x7F, 0x01, 0x80, 0x1C, 0xD3, -+0x90, 0x96, 0xB8, 0xE0, 0x94, 0xE8, 0x90, 0x96, -+0xB7, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x31, 0x02, -+0x7B, 0x5B, 0xE4, 0xFF, 0x11, 0x5B, 0x7F, 0x00, -+0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x7C, 0x6A, -+0x90, 0x96, 0xB7, 0x71, 0x1C, 0x80, 0x97, 0x90, -+0x93, 0x5E, 0xE0, 0xFF, 0x90, 0x93, 0x5D, 0xE0, -+0x4F, 0x22, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, -+0xF0, 0x90, 0x96, 0xB9, 0xE0, 0xFD, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -+0x9E, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, -+0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, 0xE0, -+0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, -+0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x34, -+0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0xA2, 0xF0, -+0x7B, 0x26, 0x11, 0x57, 0x90, 0x8A, 0xFD, 0x12, -+0x88, 0xDF, 0xEF, 0x64, 0x01, 0x70, 0x02, 0x80, -+0x08, 0x12, 0x9F, 0x88, 0x54, 0x03, 0x30, 0xE0, -+0x04, 0x31, 0xB3, 0xEE, 0xF0, 0x90, 0x96, 0xA2, -+0xE0, 0xFD, 0x7B, 0x27, 0xE4, 0xFF, 0x11, 0x5B, -+0x31, 0x9F, 0x80, 0x06, 0x31, 0x9F, 0x31, 0xB3, -+0xEE, 0xF0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, -+0x19, 0x12, 0x9F, 0x88, 0x54, 0x03, 0x30, 0xE0, -+0x11, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x6F, 0xFF, -+0x90, 0x8A, 0xF9, 0xB1, 0xAB, 0x7D, 0x28, 0x12, -+0x04, 0x7E, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, -+0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0x96, 0x9E, 0xE0, 0xFF, 0x90, 0x8A, 0xC7, 0xE0, -+0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, -+0x02, 0x04, 0x7E, 0x90, 0x86, 0xB6, 0xE0, 0xFF, -+0x90, 0x96, 0x9F, 0xE0, 0xFB, 0x90, 0x92, 0x13, -+0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, 0xDB, -+0x90, 0x96, 0xA0, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, -+0xF0, 0xFD, 0x90, 0x96, 0x9E, 0xE0, 0xFF, 0x90, -+0x8A, 0x95, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF5, -+0x82, 0x8A, 0x83, 0x12, 0x04, 0x7E, 0x90, 0x96, -+0xA0, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, -+0x9B, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, -+0x8C, 0x83, 0x12, 0x04, 0x7E, 0x90, 0x96, 0xA0, -+0xA3, 0xE0, 0xFF, 0x24, 0x12, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0x01, 0xFE, -+0x90, 0x96, 0x9F, 0xE0, 0x25, 0xE0, 0x25, 0xE0, -+0x44, 0x02, 0x4E, 0xFE, 0x74, 0x12, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -+0xA8, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x96, -+0xA7, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0xF1, 0x29, -+0xE0, 0x90, 0x96, 0xAA, 0xF0, 0x12, 0x7B, 0x07, -+0x7C, 0x00, 0xAD, 0x07, 0x90, 0x96, 0xA7, 0xE0, -+0x90, 0x04, 0x25, 0xF0, 0x90, 0x96, 0xA8, 0xE0, -+0x60, 0x05, 0x51, 0xE6, 0x44, 0x80, 0xF0, 0xAF, -+0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x51, -+0xE6, 0x54, 0xC0, 0xF0, 0x90, 0x96, 0xAA, 0xE0, -+0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, -+0x00, 0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, -+0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0x74, 0x04, 0xF0, 0xAF, 0x05, 0x51, 0x1C, 0xE0, -+0x54, 0x01, 0xFE, 0x90, 0x96, 0xA9, 0xE0, 0x25, -+0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, -+0x51, 0x1B, 0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, -+0xF0, 0x74, 0x29, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x74, -+0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, 0x04, 0xAF, -+0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x21, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x22, 0xEF, 0xB4, 0xFF, 0x06, 0x90, 0x93, -+0x5D, 0xED, 0xF0, 0x22, 0xEF, 0xF4, 0xFE, 0x90, -+0x93, 0x5D, 0xE0, 0x5E, 0xFE, 0xED, 0x5F, 0x4E, -+0xF0, 0x22, 0xEF, 0xB4, 0xFF, 0x06, 0x90, 0x93, -+0x5E, 0xED, 0xF0, 0x22, 0xEF, 0xF4, 0xFE, 0x90, -+0x93, 0x5E, 0x80, 0xE6, 0xE4, 0x75, 0xF0, 0x01, -+0x02, 0x02, 0xE7, 0xE4, 0x90, 0x96, 0xCA, 0xF0, -+0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, -+0x22, 0xC3, 0x90, 0x96, 0xCB, 0xE0, 0x94, 0xD0, -+0x90, 0x96, 0xCA, 0xE0, 0x94, 0x07, 0x40, 0x0A, -+0x90, 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, -+0x00, 0x22, 0x90, 0x96, 0xCA, 0x71, 0x1C, 0xB1, -+0xA4, 0x80, 0xD7, 0x7F, 0x01, 0x22, 0x90, 0x93, -+0x0E, 0xE0, 0xFD, 0x7C, 0x00, 0xA3, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0x12, 0x02, 0x92, 0xED, 0x4C, -+0x70, 0x05, 0x90, 0x93, 0x1B, 0x80, 0x2A, 0xED, -+0x64, 0x01, 0x4C, 0x70, 0x05, 0x90, 0x93, 0x1C, -+0x80, 0x1F, 0xED, 0x64, 0x02, 0x4C, 0x70, 0x05, -+0x90, 0x93, 0x1D, 0x80, 0x14, 0xED, 0x64, 0x03, -+0x4C, 0x70, 0x05, 0x90, 0x93, 0x1E, 0x80, 0x09, -+0xED, 0x64, 0x04, 0x4C, 0x70, 0x0C, 0x90, 0x93, -+0x1F, 0xE0, 0xFF, 0xB1, 0xB4, 0x90, 0x93, 0x0F, -+0x71, 0x1C, 0x22, 0x12, 0x9D, 0x2B, 0xE4, 0xFF, -+0x12, 0xDA, 0x26, 0x90, 0x93, 0x03, 0xE0, 0x30, -+0xE0, 0x02, 0x71, 0x56, 0x90, 0x8B, 0x07, 0x12, -+0x88, 0xDF, 0x02, 0x8E, 0xB4, 0x90, 0x96, 0xBD, -+0xEF, 0xB1, 0x9C, 0x90, 0x01, 0x09, 0xE0, 0x7F, -+0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x96, -+0xBD, 0xE0, 0x6F, 0x60, 0x34, 0xC3, 0x90, 0x96, -+0xBF, 0xE0, 0x94, 0x88, 0x90, 0x96, 0xBE, 0xE0, -+0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, -+0x44, 0x10, 0xF0, 0x22, 0x90, 0x96, 0xBE, 0x71, -+0x1C, 0xB1, 0x45, 0xD3, 0x90, 0x96, 0xBF, 0xE0, -+0x94, 0x32, 0x90, 0x96, 0xBE, 0xE0, 0x94, 0x00, -+0x40, 0xC1, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, -+0xBA, 0x22, 0x75, 0x64, 0x14, 0x90, 0x88, 0x32, -+0xE0, 0x44, 0x10, 0xF0, 0xF1, 0xD6, 0xF0, 0x7D, -+0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x41, 0xE0, -+0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, 0x88, -+0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, -+0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, -+0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x93, -+0x31, 0xE0, 0x30, 0xE0, 0x6A, 0x90, 0xFD, 0x09, -+0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, 0x90, 0x0E, -+0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, 0x95, -+0x18, 0xF0, 0x90, 0x95, 0x18, 0xE0, 0xFF, 0xC3, -+0x94, 0x05, 0x50, 0x2D, 0xB1, 0xC1, 0x80, 0x05, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -+0x90, 0x93, 0x33, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, -+0x10, 0x90, 0x95, 0x18, 0x12, 0xDB, 0x0C, 0x90, -+0x95, 0x18, 0x12, 0xDA, 0xEB, 0x44, 0x20, 0xB1, -+0x44, 0x90, 0x95, 0x18, 0xE0, 0x04, 0xF0, 0x80, -+0xC9, 0xB1, 0x3D, 0x54, 0xFE, 0xFD, 0x7F, 0x92, -+0x12, 0x7B, 0x2E, 0xB1, 0x3D, 0x44, 0x08, 0xFD, -+0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x12, 0x97, 0xF5, -+0x54, 0xFD, 0xFD, 0x7F, 0x02, 0x80, 0x07, 0xB1, -+0x3D, 0x44, 0x01, 0xFD, 0x7F, 0x92, 0x12, 0x7B, -+0x2E, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, 0x44, -+0x10, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0x7F, -+0x01, 0x71, 0xBD, 0x90, 0x00, 0x90, 0xE0, 0x44, -+0x01, 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, -+0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x7F, 0x92, 0x12, -+0x7B, 0x41, 0xEF, 0x22, 0xF0, 0x7F, 0x14, 0x7E, -+0x00, 0x02, 0x7C, 0x6A, 0xE4, 0x90, 0x94, 0xBD, -+0xF0, 0xA3, 0xF0, 0xF1, 0x1D, 0xEF, 0x64, 0x01, -+0x60, 0x3B, 0xC3, 0x90, 0x94, 0xBE, 0xE0, 0x94, -+0x88, 0x90, 0x94, 0xBD, 0xE0, 0x94, 0x13, 0x40, -+0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, -+0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1D, -+0x90, 0x94, 0xBD, 0x71, 0x1C, 0xB1, 0x45, 0xD3, -+0x90, 0x94, 0xBE, 0xE0, 0x94, 0x32, 0x90, 0x94, -+0xBD, 0xE0, 0x94, 0x00, 0x40, 0xC5, 0x90, 0x01, -+0xC6, 0xE0, 0x30, 0xE3, 0xBE, 0x90, 0x01, 0xC7, -+0x74, 0xFE, 0xF0, 0x22, 0xF0, 0xE4, 0xA3, 0xF0, -+0xA3, 0xF0, 0x22, 0xF0, 0x7F, 0x0A, 0x7E, 0x00, -+0x02, 0x7C, 0x6A, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, -+0x82, 0x8C, 0x83, 0x22, 0x90, 0x04, 0x24, 0xEF, -+0xF0, 0x90, 0x04, 0x57, 0xF0, 0x22, 0x54, 0x07, -+0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, -+0x22, 0x90, 0x93, 0x31, 0xE0, 0x20, 0xE0, 0x02, -+0xC1, 0x8A, 0xE4, 0x90, 0x94, 0xBD, 0xF0, 0xD1, -+0x8B, 0x40, 0x02, 0xC1, 0x8A, 0xB1, 0xC1, 0x80, -+0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xFF, 0x90, 0x93, 0x32, 0xE0, 0xFD, 0xEF, 0x5D, -+0x60, 0x02, 0xC1, 0x82, 0x12, 0x02, 0x06, 0xFF, -+0x30, 0xE0, 0x1A, 0x90, 0x93, 0x33, 0xE0, 0xFE, -+0x90, 0x94, 0xBD, 0xE0, 0xFD, 0x74, 0x01, 0xA8, -+0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -+0x4E, 0x90, 0x93, 0x33, 0xF0, 0xEF, 0xC3, 0x13, -+0x30, 0xE0, 0x16, 0x90, 0x93, 0x34, 0xE0, 0xFF, -+0x90, 0x94, 0xBD, 0x12, 0xA1, 0x13, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x34, -+0xF0, 0x12, 0x87, 0xDF, 0xFF, 0x90, 0x94, 0xBD, -+0xE0, 0xFE, 0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, -+0x93, 0xF5, 0x83, 0xEF, 0x12, 0x87, 0xE6, 0xFF, -+0x74, 0x3A, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, -+0x12, 0x87, 0xED, 0xFF, 0x74, 0x3F, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0x93, 0x12, 0x87, 0xF7, 0xFF, -+0x74, 0x44, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, -+0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x32, 0xE0, -+0xFF, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x32, -+0xF0, 0x22, 0x90, 0x94, 0xBD, 0xE0, 0x04, 0xF0, -+0xA1, 0xD7, 0x22, 0x90, 0x94, 0xBD, 0xE0, 0xFF, -+0xC3, 0x94, 0x05, 0x22, 0x7B, 0x00, 0x7A, 0x00, -+0x79, 0x00, 0x90, 0x89, 0x2E, 0x12, 0x86, 0x76, -+0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x80, 0x90, 0x89, -+0x31, 0x12, 0x86, 0x76, 0x7A, 0x80, 0x79, 0xBF, -+0x90, 0x89, 0x34, 0x12, 0x86, 0x76, 0x7A, 0x81, -+0x79, 0x61, 0x90, 0x89, 0x3A, 0x12, 0x86, 0x76, -+0x7A, 0x81, 0x79, 0x75, 0x90, 0x89, 0x3D, 0x12, -+0x86, 0x76, 0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, -+0x40, 0x12, 0x86, 0x76, 0xF1, 0x13, 0x7A, 0x81, -+0x79, 0xD9, 0x90, 0x89, 0x49, 0x12, 0x86, 0x76, -+0x7A, 0x82, 0x79, 0x01, 0x90, 0x89, 0x4C, 0x12, -+0x86, 0x76, 0xE4, 0x90, 0x96, 0x24, 0xF0, 0x90, -+0x96, 0x13, 0xF0, 0x90, 0x94, 0xBD, 0xF0, 0xD1, -+0x8B, 0x50, 0x0F, 0x74, 0x35, 0x2F, 0xF1, 0x0B, -+0xE4, 0xF0, 0x90, 0x94, 0xBD, 0xE0, 0x04, 0xF0, -+0x80, 0xED, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x96, -+0xF5, 0x83, 0x22, 0x7A, 0x81, 0x79, 0xB1, 0x90, -+0x89, 0x46, 0x02, 0x86, 0x76, 0x90, 0x01, 0x95, -+0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, -+0x22, 0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, 0x7F, -+0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, 0x22, -+0x90, 0x88, 0x38, 0xE0, 0xFF, 0x90, 0x8A, 0xB9, -+0xB1, 0xAB, 0x7D, 0x01, 0x02, 0x04, 0x7E, 0xE4, -+0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x0E, 0x90, -+0x88, 0x36, 0xE0, 0x60, 0x08, 0xF1, 0x5E, 0x54, -+0x07, 0x70, 0x02, 0xF1, 0x38, 0x22, 0x90, 0x88, -+0x3A, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xE4, 0xF5, -+0x7A, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x7A, 0x54, -+0xC0, 0x70, 0x18, 0xF1, 0x5E, 0x54, 0xFD, 0xF0, -+0xF1, 0x38, 0x90, 0x88, 0x39, 0xE0, 0x60, 0x4D, -+0x12, 0x97, 0xF5, 0x44, 0x01, 0xFD, 0x7F, 0x02, -+0x02, 0x7B, 0x2E, 0xE5, 0x7A, 0x30, 0xE6, 0x21, -+0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x1B, -+0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0xF1, 0xCE, -+0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, -+0x88, 0xDF, 0x80, 0x07, 0x12, 0x73, 0x8F, 0x80, -+0x02, 0xF1, 0x5E, 0xE5, 0x7A, 0x90, 0x88, 0x3A, -+0x30, 0xE7, 0x0E, 0xE0, 0x44, 0x02, 0x12, 0x8F, -+0x86, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, -+0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xF0, 0x90, -+0x88, 0x34, 0xE0, 0x54, 0x0F, 0x22, 0x90, 0x88, -+0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, -+0x90, 0x88, 0xE0, 0xE0, 0xFB, 0x90, 0x88, 0xDF, -+0xE0, 0x90, 0x92, 0x90, 0x22, 0x12, 0x02, 0x06, -+0x90, 0x88, 0x9C, 0xF0, 0x60, 0x39, 0xA3, 0xE0, -+0x20, 0xE0, 0x34, 0x90, 0x8A, 0xB9, 0x12, 0x8C, -+0xE5, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, -+0x90, 0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x30, -+0xE0, 0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0x20, 0xE0, 0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, -+0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, -+0x80, 0x02, 0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, -+0x12, 0xC1, 0x9B, 0xFF, 0x54, 0x01, 0xFE, 0x90, -+0x93, 0x29, 0x12, 0xDB, 0x2C, 0x12, 0xA7, 0xE7, -+0x12, 0xDB, 0x8C, 0x90, 0x93, 0x29, 0x12, 0xDB, -+0xB0, 0x4E, 0xF0, 0x90, 0x05, 0x52, 0xE0, 0x54, -+0x07, 0x90, 0x94, 0xBD, 0x60, 0x16, 0x12, 0x86, -+0x6D, 0x12, 0x87, 0xDF, 0xFD, 0x90, 0x05, 0x56, -+0xE0, 0xC3, 0x9D, 0x90, 0x93, 0x2B, 0xF0, 0xA3, -+0xED, 0xF0, 0x80, 0x26, 0x12, 0x86, 0x6D, 0x12, -+0x87, 0xDF, 0xFB, 0xFF, 0x90, 0x05, 0x54, 0xE0, -+0xC3, 0x9F, 0xFF, 0xE4, 0x94, 0x00, 0xFE, 0x7C, -+0x00, 0x7D, 0x05, 0x12, 0x02, 0x92, 0x90, 0x93, -+0x2B, 0xEF, 0xF0, 0xEB, 0x75, 0xF0, 0x05, 0x84, -+0xA3, 0xF0, 0x12, 0x88, 0xD0, 0x12, 0x02, 0x06, -+0x20, 0xE0, 0x13, 0x12, 0x88, 0xDC, 0x90, 0x8A, -+0xF9, 0x12, 0x8C, 0xE5, 0x12, 0x8F, 0xE8, 0x90, -+0x01, 0x57, 0xE4, 0xF0, 0x80, 0x0C, 0x90, 0x8A, -+0x89, 0x12, 0x8C, 0xE5, 0x12, 0x8F, 0x60, 0x12, -+0x8F, 0xF5, 0xB1, 0x97, 0x20, 0xE0, 0x04, 0xEF, -+0x44, 0x20, 0xF0, 0x12, 0x8F, 0xEE, 0x30, 0xE0, -+0x15, 0x90, 0x88, 0x36, 0x74, 0x01, 0xF0, 0xE4, -+0x90, 0x88, 0x38, 0xF0, 0x11, 0xF6, 0xD1, 0x1A, -+0x74, 0x06, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, 0x90, -+0x88, 0x36, 0xF0, 0x90, 0x88, 0x38, 0x74, 0x0C, -+0xF0, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFE, 0xF0, -+0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x88, -+0x32, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x12, 0x9F, -+0xEE, 0x60, 0x02, 0x41, 0x32, 0x90, 0x88, 0x36, -+0xE0, 0x70, 0x02, 0x41, 0x32, 0x90, 0x88, 0x9D, -+0xE0, 0x20, 0xE0, 0x32, 0x90, 0x06, 0xA9, 0xE0, -+0x54, 0xC0, 0x70, 0x2A, 0x90, 0x88, 0x9C, 0xE0, -+0x70, 0x24, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x70, -+0x1D, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x70, 0x16, -+0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, 0x70, 0x0E, -+0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x07, 0x12, -+0x97, 0xF5, 0x54, 0xFE, 0xD1, 0x89, 0x90, 0x05, -+0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, 0x90, 0x05, -+0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, 0x90, 0x05, -+0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, 0x90, 0x05, -+0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, 0x90, 0x07, -+0xF1, 0xE0, 0x90, 0x94, 0x9F, 0xF0, 0x90, 0x07, -+0xF0, 0xE0, 0x90, 0x94, 0xA0, 0xF0, 0x12, 0xC7, -+0x43, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEC, -+0xF0, 0x51, 0x3B, 0x24, 0xFD, 0x50, 0x02, 0x80, -+0x03, 0x12, 0xAF, 0x66, 0x51, 0x3B, 0x64, 0x01, -+0x70, 0x30, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, -+0x3D, 0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x30, 0xE5, -+0x05, 0xA3, 0xE0, 0xFF, 0x80, 0x05, 0x90, 0x88, -+0x3C, 0xE0, 0xFF, 0x90, 0x88, 0x3C, 0xEF, 0xF0, -+0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, -+0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, -+0xEF, 0xF0, 0x51, 0x4F, 0xE4, 0x90, 0x88, 0x3F, -+0xF0, 0xA3, 0xF0, 0x90, 0x88, 0x32, 0xB1, 0x9A, -+0x30, 0xE0, 0x5D, 0xEF, 0xC4, 0x13, 0x13, 0x54, -+0x03, 0x20, 0xE0, 0x24, 0x51, 0x33, 0x6F, 0x70, -+0x4F, 0xEF, 0x60, 0x4C, 0x90, 0x88, 0x32, 0xE0, -+0x44, 0x40, 0xF0, 0xF1, 0xDC, 0x51, 0x44, 0x12, -+0x7C, 0x05, 0x12, 0x9F, 0xB1, 0x12, 0x9F, 0xA3, -+0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0x80, 0x30, -+0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x64, -+0x01, 0x70, 0x25, 0x51, 0x33, 0xFE, 0x6F, 0x60, -+0x1F, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, -+0x60, 0x16, 0xB1, 0x8D, 0x30, 0xE0, 0x11, 0xEF, -+0x54, 0xBF, 0x51, 0x44, 0x12, 0x7C, 0x3B, 0x7D, -+0x01, 0x7F, 0x02, 0x12, 0x7C, 0x74, 0xF1, 0x7C, -+0x11, 0xF6, 0x22, 0x90, 0x88, 0x3C, 0xE0, 0xFF, -+0xA3, 0xE0, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xFF, -+0xC4, 0x54, 0x0F, 0x22, 0xF0, 0x90, 0x01, 0x3F, -+0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x90, -+0x88, 0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0x94, 0xA0, 0xE0, 0x24, 0x46, 0xFF, -+0x90, 0x94, 0x9F, 0xE0, 0x34, 0x00, 0xAB, 0x07, -+0xFA, 0xE4, 0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, -+0x12, 0x86, 0x39, 0x90, 0x88, 0x85, 0x91, 0x5D, -+0xEF, 0x24, 0x46, 0xFF, 0xE4, 0x3E, 0xFE, 0xE4, -+0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x90, 0x88, 0x89, -+0x91, 0x5D, 0x90, 0x88, 0x85, 0x91, 0x78, 0x50, -+0x02, 0x61, 0x45, 0x90, 0x88, 0x89, 0x12, 0x86, -+0x61, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, -+0x86, 0x39, 0x90, 0x95, 0xCE, 0x12, 0x04, 0x31, -+0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x2C, 0x12, -+0x8E, 0xAD, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, -+0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0x24, 0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, -+0x4E, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, -+0x94, 0x00, 0xFA, 0x91, 0x66, 0xEB, 0x2F, 0xFF, -+0xEA, 0x80, 0x1D, 0x90, 0x88, 0x33, 0xB1, 0x90, -+0x30, 0xE0, 0x02, 0x81, 0x42, 0x91, 0x66, 0x90, -+0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, -+0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, 0xED, -+0x3E, 0x90, 0x95, 0xCA, 0xF0, 0xA3, 0xEF, 0xF0, -+0xC3, 0x90, 0x95, 0xCB, 0xE0, 0x94, 0xA0, 0x90, -+0x95, 0xCA, 0xE0, 0x94, 0x00, 0x50, 0x36, 0xA3, -+0xE0, 0xFB, 0x24, 0x5F, 0x91, 0x55, 0xE0, 0x04, -+0xF0, 0x90, 0x95, 0xCE, 0x12, 0x04, 0xB8, 0xEF, -+0x54, 0x7F, 0xFF, 0x74, 0xFF, 0x2B, 0x91, 0x4A, -+0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, -+0x95, 0xCA, 0xA3, 0xE0, 0x91, 0x48, 0xEF, 0xF0, -+0x90, 0x88, 0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, -+0x7F, 0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, -+0xE0, 0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, -+0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, -+0x81, 0x42, 0xE4, 0xFF, 0xFE, 0x91, 0x52, 0xE0, -+0x2F, 0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, -+0xD3, 0x9D, 0x40, 0x07, 0x90, 0x95, 0xCC, 0xEE, -+0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE5, -+0xB1, 0x74, 0x40, 0x02, 0x80, 0x15, 0x90, 0x95, -+0xCC, 0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, -+0x50, 0x13, 0x91, 0x52, 0xE0, 0x2F, 0xFF, 0xB1, -+0x74, 0x40, 0x07, 0x90, 0x95, 0xCD, 0xEE, 0xF0, -+0x80, 0x03, 0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, -+0xE0, 0xFF, 0x91, 0x43, 0xE0, 0xFD, 0xEF, 0xC3, -+0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, -+0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x95, -+0xCD, 0xE0, 0x80, 0x18, 0x91, 0x43, 0xE0, 0xFD, -+0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, -+0xF0, 0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, -+0x95, 0xCD, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, -+0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, -+0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, -+0xF0, 0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, -+0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, -+0x50, 0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, -+0x51, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, -+0x88, 0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, -+0x88, 0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, -+0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, -+0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, -+0x90, 0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0xD1, -+0x1A, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, -+0x8A, 0xA3, 0x12, 0x8C, 0xE5, 0xE4, 0xFF, 0x12, -+0x04, 0x7E, 0x22, 0x90, 0x95, 0xCC, 0xE0, 0xFE, -+0x24, 0xFF, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -+0x83, 0x22, 0x74, 0x5F, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0xF5, 0x83, 0x22, 0x12, 0x04, 0x31, -+0x90, 0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, 0x95, -+0xCE, 0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, -+0xEB, 0x7E, 0x02, 0xFD, 0xFC, 0x90, 0x96, 0x9A, -+0x12, 0x86, 0x61, 0xC3, 0x02, 0x03, 0xDA, 0x90, -+0x96, 0x99, 0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, -+0x70, 0x51, 0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, -+0x70, 0xEE, 0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, -+0x90, 0x96, 0x9A, 0x12, 0x04, 0x31, 0xE4, 0x7F, -+0x80, 0x91, 0x71, 0x70, 0x05, 0x90, 0x88, 0xBE, -+0x80, 0x1B, 0xE4, 0xFF, 0xFE, 0x91, 0x73, 0x70, -+0x0A, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xE4, 0xA3, -+0xF0, 0x80, 0x56, 0xE4, 0xFF, 0x91, 0x71, 0x70, -+0x09, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xA3, 0xF0, -+0x80, 0x47, 0xE4, 0x7F, 0x80, 0xFE, 0x91, 0x73, -+0x70, 0x3F, 0x90, 0x88, 0xBE, 0xF0, 0xA3, 0x04, -+0xF0, 0x80, 0x36, 0x7F, 0x2C, 0x7E, 0x09, 0x12, -+0x70, 0x70, 0xEF, 0x54, 0x02, 0xB1, 0x5E, 0x60, -+0x08, 0x90, 0x88, 0xBE, 0x74, 0x01, 0xF0, 0x80, -+0x05, 0xE4, 0x90, 0x88, 0xBE, 0xF0, 0x7F, 0x30, -+0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x01, -+0xB1, 0x5E, 0x60, 0x07, 0xE4, 0x90, 0x88, 0xBF, -+0xF0, 0x80, 0x06, 0x90, 0x88, 0xBF, 0x74, 0x01, -+0xF0, 0x90, 0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, -+0x90, 0x8A, 0xF9, 0x12, 0x8C, 0xE5, 0x7D, 0x11, -+0x12, 0xDB, 0x95, 0x12, 0x88, 0xDF, 0x90, 0x07, -+0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x96, -+0x99, 0xE0, 0xFD, 0x70, 0x02, 0x80, 0x1C, 0xED, -+0xB4, 0x01, 0x06, 0xB1, 0x57, 0x44, 0x20, 0xF0, -+0x22, 0x90, 0x96, 0x99, 0xE0, 0xFD, 0xB4, 0x02, -+0x06, 0xB1, 0x57, 0x44, 0x60, 0xF0, 0x22, 0xED, -+0xB4, 0x03, 0x03, 0xB1, 0x57, 0xF0, 0x22, 0x90, -+0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, -+0xFE, 0xFD, 0xFC, 0x90, 0x96, 0x9A, 0x12, 0x04, -+0x31, 0x90, 0x96, 0x9A, 0x12, 0x04, 0xB8, 0xEC, -+0x4D, 0x4E, 0x4F, 0x22, 0x90, 0x88, 0x91, 0xE0, -+0xFD, 0xC3, 0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, -+0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0xFC, 0xEF, -+0xD3, 0x9D, 0xE4, 0x9C, 0x22, 0x90, 0x88, 0x32, -+0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, -+0x93, 0x29, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, -+0x1F, 0x22, 0x90, 0x88, 0x32, 0xB1, 0x9A, 0x30, -+0xE0, 0x0C, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x30, 0xE0, 0x03, 0x12, 0x9F, 0xA3, 0x90, 0x88, -+0x31, 0xB1, 0x90, 0x30, 0xE0, 0x08, 0xEF, 0x12, -+0xC7, 0x6F, 0x70, 0x4D, 0x80, 0x48, 0x90, 0x88, -+0x3F, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, -+0x54, 0xEF, 0xF0, 0x12, 0xD9, 0x33, 0x40, 0x36, -+0x12, 0x9F, 0xEE, 0x70, 0x34, 0x12, 0xAF, 0xCF, -+0x70, 0x08, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xDF, -+0x80, 0x28, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xDF, -+0x90, 0x88, 0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, -+0x94, 0x02, 0x40, 0x09, 0xD1, 0x12, 0xE4, 0x90, -+0x88, 0x40, 0xF0, 0x80, 0x03, 0x12, 0x73, 0x8F, -+0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x22, 0x12, 0xAF, -+0x38, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, -+0xF0, 0x22, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, -+0xE0, 0xFD, 0x90, 0x88, 0x4F, 0xE0, 0xFB, 0x90, -+0x92, 0x98, 0x22, 0xE4, 0xFE, 0x91, 0x52, 0xE4, -+0xF0, 0x74, 0xFF, 0x2E, 0x91, 0x4A, 0x74, 0xFF, -+0xF0, 0x0E, 0xEE, 0xB4, 0xA0, 0xEF, 0xE4, 0x90, -+0x88, 0x4D, 0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, -+0x88, 0x50, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, -+0x74, 0xA0, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x7F, -+0x02, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFE, 0xFD, -+0x7F, 0x02, 0x12, 0x7B, 0x2E, 0x7F, 0x02, 0x12, -+0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, -+0x12, 0x7B, 0x2E, 0x7F, 0x02, 0x12, 0x7B, 0x41, -+0xEF, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x7B, -+0x2E, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, -+0x01, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0x6F, -+0x90, 0x96, 0xAB, 0x12, 0x04, 0x31, 0x90, 0x96, -+0xAB, 0xF1, 0x66, 0xF1, 0x5F, 0x90, 0x01, 0x01, -+0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, -+0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, -+0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0xD1, 0x81, -+0xD1, 0x57, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, -+0xD4, 0x7C, 0x90, 0x95, 0xEF, 0xEF, 0xF0, 0x90, -+0x8A, 0x89, 0x30, 0xE0, 0x13, 0x12, 0x8C, 0xE5, -+0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, -+0x88, 0x33, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x06, -+0x12, 0x8C, 0xE5, 0x12, 0x8F, 0xE8, 0x90, 0x95, -+0xEF, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, -+0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, -+0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0xD1, 0x1A, -+0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0x6F, 0x90, -+0x96, 0xAF, 0x12, 0x04, 0x31, 0x90, 0x96, 0xAF, -+0xF1, 0x66, 0xF1, 0x5F, 0x90, 0x8A, 0xFD, 0x12, -+0x88, 0xDF, 0x90, 0x06, 0xB7, 0x74, 0x11, 0xF0, -+0x7F, 0x03, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, -+0x06, 0xB4, 0xE0, 0x54, 0x0F, 0x70, 0xF1, 0xD1, -+0x57, 0x12, 0x97, 0xF5, 0x54, 0xFE, 0xD1, 0x89, -+0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, -+0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, -+0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, -+0x30, 0x7E, 0x08, 0x02, 0x70, 0xAD, 0x12, 0x04, -+0xB8, 0x90, 0x92, 0x18, 0x02, 0x04, 0x31, 0x7F, -+0x30, 0x7E, 0x08, 0x12, 0x70, 0x70, 0xED, 0x44, -+0x80, 0xFD, 0xEC, 0x22, 0x7D, 0x02, 0x7F, 0x02, -+0x02, 0x7C, 0x74, 0xF1, 0x94, 0xF1, 0x7C, 0x7F, -+0x01, 0x12, 0xDA, 0x26, 0x90, 0x8B, 0x07, 0xF1, -+0xE4, 0x02, 0x04, 0x7A, 0xE4, 0x90, 0x95, 0xEF, -+0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x3C, 0x12, -+0x9F, 0xEE, 0x70, 0x37, 0xF1, 0xDC, 0xF0, 0x12, -+0xDA, 0xB8, 0xF0, 0x90, 0x95, 0xEF, 0x74, 0x01, -+0xF0, 0xE4, 0x90, 0x88, 0x3D, 0xF0, 0x04, 0x60, -+0x22, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x0D, -+0x90, 0x8A, 0xB9, 0x12, 0x8C, 0xE5, 0x7D, 0x01, -+0x7F, 0x04, 0x12, 0x04, 0x7E, 0x12, 0x9F, 0xE6, -+0xE4, 0x90, 0x92, 0x20, 0xF0, 0x12, 0x9D, 0x21, -+0x12, 0x8F, 0x90, 0x22, 0x90, 0x88, 0x3C, 0xE0, -+0x90, 0x05, 0x73, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, -+0xAA, 0x06, 0xF9, 0x22, 0x90, 0x8A, 0xDF, 0xF1, -+0xE4, 0x02, 0x04, 0x7A, 0x12, 0x02, 0x06, 0x54, -+0x01, 0xFF, 0x90, 0x93, 0x31, 0xE0, 0x54, 0xFE, -+0x4F, 0xF0, 0x30, 0xE0, 0x04, 0xE4, 0x12, 0x97, -+0x3E, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, -+0x4B, 0xF0, 0xBF, 0x01, 0x09, 0x7F, 0x01, 0x11, -+0x1F, 0xE4, 0x90, 0x93, 0x4B, 0xF0, 0x22, 0x90, -+0x94, 0xBD, 0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0x95, -+0x79, 0x04, 0x7F, 0xF4, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x04, 0xE0, -+0x90, 0x95, 0x06, 0xF0, 0x7B, 0x01, 0x7A, 0x95, -+0x79, 0x04, 0x7F, 0xF5, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x04, 0xE0, -+0x90, 0x95, 0x07, 0xF0, 0x7B, 0x01, 0x7A, 0x95, -+0x79, 0x04, 0x7F, 0xF6, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x04, 0xE0, -+0x90, 0x95, 0x08, 0xF0, 0x7B, 0x01, 0x7A, 0x95, -+0x79, 0x04, 0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x04, 0xE0, -+0x90, 0x95, 0x09, 0xF0, 0x7B, 0x01, 0x7A, 0x95, -+0x79, 0x04, 0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x04, 0xE0, -+0x90, 0x95, 0x0A, 0xF0, 0x7B, 0x01, 0x7A, 0x95, -+0x79, 0x04, 0x12, 0x9F, 0xB8, 0xBF, 0x01, 0x08, -+0x90, 0x95, 0x04, 0xE0, 0x90, 0x95, 0x0B, 0xF0, -+0x7B, 0x01, 0x7A, 0x95, 0x79, 0x04, 0x7F, 0xFB, -+0x51, 0xA4, 0x70, 0x52, 0x90, 0x95, 0x04, 0xE0, -+0x90, 0x95, 0x0C, 0xF0, 0x54, 0x07, 0x60, 0x08, -+0x90, 0x95, 0x04, 0xE0, 0x54, 0xE0, 0x70, 0x3E, -+0x7B, 0x01, 0x7A, 0x95, 0x79, 0x05, 0x7F, 0xFA, -+0x51, 0xA4, 0x70, 0x32, 0x90, 0x95, 0x04, 0xE0, -+0xFC, 0x54, 0x07, 0x70, 0x12, 0x90, 0x95, 0x0C, -+0xE0, 0xFE, 0x90, 0x95, 0x05, 0xE0, 0x54, 0x07, -+0xFD, 0xEE, 0x4D, 0x90, 0x95, 0x0C, 0xF0, 0xEC, -+0x54, 0xE0, 0x70, 0x12, 0x90, 0x95, 0x0C, 0xE0, -+0xFF, 0x90, 0x95, 0x05, 0xE0, 0x54, 0xE0, 0xFE, -+0xEF, 0x4E, 0x90, 0x95, 0x0C, 0xF0, 0x7B, 0x01, -+0x7A, 0x95, 0x79, 0x04, 0x7F, 0xFD, 0x51, 0xA4, -+0x70, 0x47, 0x90, 0x95, 0x04, 0xE0, 0xFE, 0x54, -+0xCC, 0x90, 0x95, 0x0D, 0xF0, 0xEE, 0x54, 0x0C, -+0xFF, 0x60, 0x08, 0x90, 0x95, 0x04, 0xE0, 0x54, -+0xC0, 0x70, 0x2E, 0xEF, 0x70, 0x12, 0x90, 0x95, -+0x0D, 0xE0, 0xFF, 0x90, 0x95, 0x04, 0xE0, 0x54, -+0x03, 0x12, 0xA7, 0xEE, 0x90, 0x95, 0x0D, 0xF0, -+0x90, 0x95, 0x04, 0xE0, 0xFF, 0x54, 0xC0, 0x70, -+0x10, 0x90, 0x95, 0x0D, 0xE0, 0xFE, 0xEF, 0x54, -+0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0xEE, 0x4F, -+0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x04, 0x7F, -+0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -+0x08, 0x90, 0x95, 0x04, 0xE0, 0x90, 0x95, 0x0E, -+0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x04, 0x7F, -+0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -+0x08, 0x90, 0x95, 0x04, 0xE0, 0x90, 0x95, 0x0F, -+0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x04, 0x7F, -+0xF2, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -+0x08, 0x90, 0x95, 0x04, 0xE0, 0x90, 0x95, 0x10, -+0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x04, 0x7F, -+0xF3, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -+0x08, 0x90, 0x95, 0x04, 0xE0, 0x90, 0x95, 0x11, -+0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x04, 0x7F, -+0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -+0x08, 0x90, 0x95, 0x04, 0xE0, 0x90, 0x95, 0x12, -+0xF0, 0x90, 0x94, 0xBE, 0x74, 0x19, 0xF0, 0x90, -+0x94, 0xE0, 0x74, 0x08, 0xF0, 0x90, 0x95, 0x06, -+0xE0, 0x90, 0x94, 0xC0, 0xF0, 0x90, 0x95, 0x07, -+0xE0, 0x90, 0x94, 0xC1, 0xF0, 0x90, 0x95, 0x08, -+0xE0, 0x90, 0x94, 0xC2, 0xF0, 0x90, 0x95, 0x09, -+0xE0, 0x90, 0x94, 0xC3, 0xF0, 0x90, 0x95, 0x0A, -+0xE0, 0x90, 0x94, 0xC4, 0xF0, 0x90, 0x95, 0x0B, -+0xE0, 0x90, 0x94, 0xC5, 0xF0, 0x90, 0x95, 0x0C, -+0xE0, 0x90, 0x94, 0xC6, 0xF0, 0x90, 0x95, 0x0D, -+0xE0, 0x90, 0x94, 0xC7, 0xF0, 0x90, 0x94, 0xE1, -+0x74, 0x1A, 0xF0, 0x90, 0x95, 0x03, 0x74, 0x05, -+0xF0, 0x90, 0x95, 0x0E, 0xE0, 0x90, 0x94, 0xE3, -+0xF0, 0x90, 0x95, 0x0F, 0xE0, 0x90, 0x94, 0xE4, -+0xF0, 0x90, 0x95, 0x10, 0xE0, 0x90, 0x94, 0xE5, -+0xF0, 0x90, 0x95, 0x11, 0xE0, 0x90, 0x94, 0xE6, -+0xF0, 0x90, 0x95, 0x12, 0xE0, 0x90, 0x94, 0xE7, -+0xF0, 0x90, 0x94, 0xBD, 0xE0, 0xB4, 0x01, 0x1A, -+0x7B, 0x01, 0x7A, 0x94, 0x79, 0xBE, 0x12, 0x9F, -+0x7B, 0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x94, -+0x79, 0xE1, 0x12, 0x8C, 0xD3, 0x7F, 0x04, 0x02, -+0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, 0x94, -+0x75, 0x47, 0xBE, 0x75, 0x48, 0x0A, 0x7B, 0x01, -+0x7A, 0x01, 0x79, 0xA0, 0x12, 0x69, 0xF5, 0x75, -+0x45, 0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0xE3, -+0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, 0x79, -+0xAA, 0x02, 0x69, 0xF5, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xEF, 0x64, 0x01, 0x22, 0x90, 0x00, 0x80, -+0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x7B, -+0x2E, 0xD1, 0xBF, 0x71, 0x76, 0x12, 0x7B, 0x79, -+0x71, 0x95, 0x71, 0x83, 0x7F, 0x01, 0x12, 0x84, -+0x15, 0x90, 0x93, 0x49, 0x74, 0x02, 0xF0, 0xFF, -+0x12, 0x84, 0x15, 0x90, 0x93, 0x49, 0xE0, 0x04, -+0xF0, 0x71, 0x20, 0x12, 0x8E, 0xD6, 0x90, 0x00, -+0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, -+0x7B, 0x2E, 0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, -+0x90, 0x01, 0xA0, 0xE0, 0xB4, 0xFD, 0x04, 0xE4, -+0xFF, 0x11, 0x1F, 0x12, 0xAD, 0x4C, 0x90, 0x00, -+0x81, 0xE0, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x12, -+0x7B, 0x2E, 0x71, 0x6B, 0x12, 0x9E, 0xF0, 0x90, -+0x00, 0xAA, 0xE0, 0x44, 0x02, 0xF0, 0xA3, 0xE0, -+0x44, 0x80, 0xF0, 0xE4, 0xFF, 0x02, 0x84, 0x9E, -+0x12, 0x7B, 0x1B, 0x90, 0x86, 0xB3, 0xEF, 0xF0, -+0x71, 0x3A, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, -+0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, -+0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, 0x75, 0xE0, -+0x71, 0xFD, 0x71, 0xD2, 0x75, 0x21, 0x80, 0xE4, -+0xF5, 0x22, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, -+0x21, 0x7F, 0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, -+0x7F, 0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, -+0x52, 0x12, 0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, -+0x02, 0x7B, 0x2E, 0x90, 0x01, 0xE4, 0x74, 0x1D, -+0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x01, -+0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, -+0xE4, 0xF0, 0x22, 0xE4, 0x90, 0x86, 0xAF, 0x12, -+0x97, 0x3D, 0x90, 0x93, 0x01, 0xF0, 0x90, 0x93, -+0x5D, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0x8C, -+0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, -+0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, -+0x54, 0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, -+0xE0, 0x44, 0x04, 0xF0, 0x22, 0x80, 0xDE, 0x90, -+0x00, 0xAB, 0xE0, 0xFE, 0x90, 0x00, 0xAA, 0x12, -+0x91, 0xFD, 0x54, 0x7F, 0x90, 0x95, 0xC8, 0xF0, -+0xA3, 0xEF, 0xF0, 0xE0, 0x30, 0xE1, 0x02, 0x71, -+0x95, 0x22, 0x75, 0x39, 0x06, 0x43, 0x39, 0x10, -+0x75, 0x3A, 0x01, 0x43, 0x3A, 0x08, 0x75, 0x3B, -+0x03, 0x75, 0x3C, 0x62, 0x43, 0x3C, 0x80, 0x43, -+0x3B, 0x04, 0x90, 0x01, 0x38, 0xE5, 0x39, 0xF0, -+0xA3, 0xE5, 0x3A, 0xF0, 0xA3, 0xE5, 0x3B, 0xF0, -+0xA3, 0xE5, 0x3C, 0xF0, 0x22, 0x75, 0x29, 0x12, -+0xE4, 0xF5, 0x2A, 0x75, 0x2B, 0x87, 0x75, 0x2C, -+0x33, 0xF5, 0x31, 0xF5, 0x32, 0xF5, 0x33, 0xF5, -+0x34, 0x90, 0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, -+0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, -+0xE5, 0x2C, 0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, -+0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, -+0xF0, 0xA3, 0xE5, 0x34, 0xF0, 0x22, 0xC0, 0xE0, -+0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -+0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, -+0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x36, -+0xF0, 0x74, 0xBC, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, -+0xE5, 0x25, 0x30, 0xE7, 0x02, 0x71, 0xB7, 0x74, -+0x36, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBC, -+0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, -+0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, -+0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, -+0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -+0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, -+0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x8D, 0xF0, -+0x74, 0xBC, 0xA3, 0xF0, 0x12, 0x75, 0x50, 0xE5, -+0x3D, 0x30, 0xE1, 0x02, 0xD1, 0x51, 0xE5, 0x3D, -+0x30, 0xE2, 0x02, 0xB1, 0x7C, 0xE5, 0x3D, 0x30, -+0xE4, 0x02, 0xB1, 0x3C, 0xE5, 0x3E, 0x30, 0xE0, -+0x03, 0x12, 0xB6, 0xC7, 0xE5, 0x3E, 0x30, 0xE3, -+0x02, 0x71, 0xB5, 0xE5, 0x3F, 0x30, 0xE2, 0x09, -+0xD1, 0x7D, 0x90, 0x07, 0x8F, 0xE0, 0x44, 0x10, -+0xF0, 0xE5, 0x40, 0x30, 0xE1, 0x0B, 0x90, 0x8A, -+0xE5, 0x12, 0x8C, 0xE5, 0x7F, 0x04, 0x12, 0x04, -+0x7E, 0xE5, 0x40, 0x30, 0xE4, 0x03, 0x12, 0xB7, -+0x83, 0xE5, 0x40, 0x30, 0xE5, 0x02, 0xB1, 0x99, -+0xE5, 0x40, 0x30, 0xE6, 0x02, 0xB1, 0xD9, 0xE5, -+0x40, 0x30, 0xE7, 0x02, 0xD1, 0x5D, 0x74, 0x8D, -+0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBC, 0xA3, -+0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, -+0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, -+0xF0, 0xD0, 0xE0, 0x32, 0x12, 0x34, 0x78, 0xD1, -+0x48, 0x90, 0x96, 0xD0, 0xEF, 0xF0, 0x90, 0x86, -+0xB3, 0xE0, 0xB4, 0x02, 0x12, 0x90, 0x96, 0xD0, -+0xE0, 0xFF, 0x64, 0x01, 0x60, 0x25, 0x90, 0x01, -+0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, 0x19, 0x90, -+0x01, 0x00, 0x74, 0xFF, 0xF0, 0x7F, 0x64, 0x7E, -+0x00, 0x12, 0x7C, 0x6A, 0x90, 0x06, 0x90, 0xE0, -+0x44, 0x01, 0xF0, 0x90, 0x96, 0xD0, 0xE0, 0xFF, -+0x12, 0xA1, 0x1B, 0x22, 0x90, 0x88, 0x36, 0xE0, -+0x60, 0x14, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, -+0x08, 0x90, 0x8B, 0x01, 0x12, 0x88, 0xDF, 0x80, -+0x05, 0xD1, 0x40, 0x12, 0xAF, 0x38, 0x02, 0xA4, -+0xAE, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0xC4, 0x13, -+0x13, 0x54, 0x03, 0x30, 0xE0, 0x32, 0xEF, 0x54, -+0xBF, 0xD1, 0x2C, 0x30, 0xE0, 0x06, 0xE0, 0x44, -+0x01, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFE, 0xD1, -+0x35, 0x74, 0x04, 0xF0, 0x90, 0x88, 0xA3, 0xE0, -+0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0D, -+0x90, 0x8A, 0xB9, 0x12, 0x8C, 0xE5, 0x7D, 0x01, -+0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x12, 0xAF, 0x38, -+0x22, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0x12, 0xA1, -+0xDD, 0x30, 0xE0, 0x1E, 0xEF, 0x54, 0x7F, 0xD1, -+0x2C, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, -+0x80, 0x07, 0xE0, 0x54, 0xFD, 0xD1, 0x35, 0x04, -+0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, -+0xAF, 0x38, 0x12, 0x9F, 0x88, 0x54, 0x03, 0x30, -+0xE0, 0x21, 0x90, 0x88, 0xA4, 0xE0, 0xFF, 0xC3, -+0x13, 0x30, 0xE0, 0x17, 0xEF, 0x54, 0xFD, 0xF0, -+0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, 0x30, -+0xE1, 0x05, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, -+0x54, 0xFB, 0xF0, 0x22, 0xF0, 0x90, 0x04, 0xE0, -+0xE0, 0x90, 0x88, 0x32, 0x22, 0xF0, 0x90, 0x01, -+0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, -+0x90, 0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, -+0x90, 0x01, 0xC7, 0x74, 0x66, 0xF0, 0xE4, 0xFF, -+0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, -+0xB5, 0xA2, 0x02, 0x8C, 0xEE, 0x90, 0x88, 0xB8, -+0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, -+0x03, 0x90, 0x8A, 0x99, 0x12, 0x88, 0xDF, 0x90, -+0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, -+0xE7, 0x12, 0x88, 0xDF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, -+0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, 0xE0, 0xB4, -+0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, 0x23, 0x74, -+0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, 0xA9, 0xA7, -+0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, 0xB4, 0x02, -+0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE7, 0x12, -+0x88, 0xDF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0x8A, 0x79, 0x74, 0x86, 0xF0, 0xA3, 0x74, 0xC2, -+0xF0, 0x90, 0x8A, 0xE5, 0x74, 0xC4, 0xF0, 0xA3, -+0x74, 0xAB, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0x98, -+0xF0, 0xA3, 0x74, 0x20, 0xF0, 0x90, 0x8A, 0xB9, -+0x74, 0x88, 0xF0, 0xA3, 0x74, 0xE9, 0xF0, 0x90, -+0x8A, 0xD5, 0x74, 0xC8, 0xF0, 0xA3, 0x74, 0xFB, -+0xF0, 0x90, 0x8A, 0xFB, 0x74, 0xA5, 0xF0, 0xA3, -+0x74, 0x43, 0xF0, 0x90, 0x8A, 0xA5, 0x74, 0xA3, -+0xF0, 0xA3, 0x74, 0x40, 0xF0, 0x90, 0x8A, 0xB5, -+0x74, 0xCA, 0xF0, 0xA3, 0x74, 0xFC, 0xF0, 0x90, -+0x8A, 0xC3, 0x74, 0xD4, 0xF0, 0xA3, 0x74, 0xE0, -+0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xD5, 0xF0, 0xA3, -+0x74, 0x12, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0xB4, -+0xF0, 0xA3, 0x74, 0x7F, 0xF0, 0x90, 0x86, 0x04, -+0x74, 0xD7, 0xF0, 0xA3, 0x74, 0x06, 0xF0, 0x90, -+0x8A, 0xA9, 0x74, 0xD5, 0xF0, 0xA3, 0x74, 0x1E, -+0xF0, 0x90, 0x8B, 0x07, 0x74, 0xD5, 0xF0, 0xA3, -+0x74, 0x43, 0xF0, 0x90, 0x8A, 0xAD, 0x74, 0xD5, -+0xF0, 0xA3, 0x74, 0xED, 0xF0, 0x90, 0x86, 0x0C, -+0x74, 0xB6, 0xF0, 0xA3, 0x74, 0x8F, 0xF0, 0x90, -+0x8A, 0xEF, 0x74, 0xB7, 0xF0, 0xA3, 0x74, 0x0E, -+0xF0, 0x90, 0x86, 0x00, 0x74, 0xC3, 0xF0, 0xA3, -+0x74, 0x7F, 0xF0, 0x90, 0x86, 0x02, 0x74, 0xC3, -+0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0x90, 0x8A, 0xFD, -+0x74, 0xA8, 0xF0, 0xA3, 0x74, 0x7B, 0xF0, 0x90, -+0x8A, 0xF9, 0x74, 0xC8, 0xF0, 0xA3, 0x74, 0x94, -+0xF0, 0x90, 0x8A, 0xDB, 0x74, 0xD3, 0xF0, 0xA3, -+0x74, 0x3E, 0xF0, 0x90, 0x8A, 0xAF, 0x74, 0xA9, -+0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0x90, 0x8A, 0xD3, -+0x74, 0xD9, 0xF0, 0xA3, 0x74, 0x3F, 0xF0, 0x90, -+0x8A, 0xF5, 0x74, 0xD8, 0xF0, 0xA3, 0x74, 0xED, -+0xF0, 0x90, 0x8A, 0xA3, 0x74, 0xB6, 0xF0, 0xA3, -+0x74, 0x2B, 0xF0, 0x90, 0x86, 0x06, 0x74, 0xAA, -+0xF0, 0xA3, 0x74, 0x27, 0xF0, 0x22, 0x12, 0x02, -+0x06, 0x90, 0x93, 0x25, 0x12, 0x87, 0xDE, 0x90, -+0x93, 0x26, 0x12, 0x87, 0xE6, 0x90, 0x93, 0x27, -+0xF0, 0x22, 0x90, 0x95, 0xCA, 0xEF, 0xF0, 0x90, -+0x04, 0x7E, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x95, -+0xEE, 0xF0, 0xE0, 0xFE, 0x6F, 0x60, 0x72, 0x90, -+0x95, 0xCB, 0x74, 0x03, 0xF0, 0x90, 0x95, 0xED, -+0x74, 0x08, 0xF0, 0xEE, 0x04, 0x54, 0x0F, 0xFF, -+0xE4, 0xFE, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, -+0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, -+0xE5, 0x82, 0x2E, 0x12, 0xA7, 0x8F, 0xE0, 0xFD, -+0x74, 0xCD, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, -+0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x08, -+0xD9, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xCB, 0x12, -+0x9F, 0x7B, 0x12, 0x04, 0x7E, 0x90, 0x95, 0xEE, -+0xE0, 0x04, 0x54, 0x0F, 0xFF, 0xF0, 0xBF, 0x0F, -+0x02, 0xE4, 0xF0, 0x90, 0x95, 0xEE, 0xE0, 0x90, -+0x04, 0x7F, 0xF0, 0x90, 0x95, 0xCA, 0xE0, 0x70, -+0x05, 0x90, 0x8A, 0xE5, 0x80, 0x03, 0x90, 0x8A, -+0x79, 0x12, 0x8C, 0xE5, 0x7F, 0x04, 0x12, 0x04, -+0x7E, 0x22, 0x31, 0x9B, 0x64, 0x01, 0x60, 0x02, -+0x01, 0xF7, 0xEF, 0x24, 0x39, 0x60, 0x12, 0x14, -+0x60, 0x19, 0x24, 0x02, 0x70, 0x1F, 0xE4, 0x90, -+0x94, 0xC3, 0xF0, 0xA3, 0x74, 0x06, 0xF0, 0x80, -+0x14, 0x90, 0x94, 0xC3, 0x74, 0x06, 0xF0, 0xA3, -+0xF0, 0x80, 0x0A, 0x90, 0x94, 0xC3, 0x74, 0x0C, -+0xF0, 0xA3, 0x74, 0x04, 0xF0, 0x31, 0x0B, 0x11, -+0xF8, 0x40, 0x1B, 0x90, 0x94, 0xC1, 0xE0, 0x31, -+0xA4, 0x7A, 0x94, 0x79, 0xC0, 0x12, 0x5F, 0xA6, -+0xBF, 0x01, 0x07, 0x90, 0x94, 0xC0, 0xE0, 0xF4, -+0x70, 0x3D, 0x31, 0x00, 0x80, 0xE1, 0x31, 0x0B, -+0x11, 0xF8, 0x40, 0x33, 0x90, 0x94, 0xC1, 0xE0, -+0xFD, 0x7C, 0x00, 0x24, 0xA8, 0xFF, 0xEC, 0x34, -+0x01, 0xFE, 0xED, 0x24, 0x01, 0xFD, 0xEC, 0x33, -+0xFC, 0x90, 0x94, 0xC3, 0xE0, 0xFB, 0xC3, 0xED, -+0x9B, 0xFD, 0xEC, 0x94, 0x00, 0xFC, 0x12, 0x88, -+0xD0, 0x8D, 0x82, 0x8C, 0x83, 0x12, 0x02, 0x1F, -+0xFD, 0x31, 0x1C, 0x31, 0x00, 0x80, 0xC9, 0x22, -+0x90, 0x94, 0xC2, 0xE0, 0xD3, 0x94, 0x00, 0x22, -+0x90, 0x94, 0xC1, 0xE0, 0x04, 0xF0, 0xA3, 0xE0, -+0x14, 0xF0, 0x22, 0x90, 0x94, 0xC3, 0xE0, 0x90, -+0x94, 0xC1, 0xF0, 0x90, 0x94, 0xC4, 0xE0, 0x90, -+0x94, 0xC2, 0xF0, 0x22, 0x8E, 0x61, 0x8F, 0x62, -+0x8D, 0x63, 0xE4, 0x90, 0x94, 0xC5, 0xF0, 0x90, -+0x00, 0x37, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x37, -+0x12, 0x7B, 0x2E, 0x7D, 0x69, 0x7F, 0xCF, 0x12, -+0x7B, 0x2E, 0xE5, 0x62, 0xFD, 0x7F, 0x31, 0x12, -+0x7B, 0x2E, 0xE5, 0x61, 0x54, 0x03, 0xFF, 0x90, -+0x00, 0x32, 0xE0, 0x54, 0xFC, 0x4F, 0xFD, 0x7F, -+0x32, 0x12, 0x7B, 0x2E, 0xAD, 0x63, 0x7F, 0x30, -+0x12, 0x7B, 0x2E, 0x90, 0x00, 0x33, 0xE0, 0x44, -+0x80, 0xFD, 0x7F, 0x33, 0x12, 0x7B, 0x2E, 0x90, -+0x00, 0x33, 0xE0, 0x30, 0xE7, 0x09, 0x31, 0x93, -+0x50, 0x05, 0xE0, 0x04, 0xF0, 0x80, 0xF0, 0xE4, -+0xFD, 0x7F, 0xCF, 0x12, 0x7B, 0x2E, 0x90, 0x00, -+0x37, 0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x37, 0x12, -+0x7B, 0x2E, 0x31, 0x93, 0x7F, 0x00, 0x50, 0x02, -+0x7F, 0x01, 0x22, 0x90, 0x94, 0xC5, 0xE0, 0xC3, -+0x94, 0x64, 0x22, 0x90, 0x94, 0xBD, 0x12, 0x86, -+0x76, 0x02, 0x02, 0x06, 0x24, 0xA8, 0xFF, 0xE4, -+0x34, 0x01, 0xFE, 0x7B, 0x01, 0x22, 0x7D, 0x02, -+0x90, 0x01, 0xC4, 0x74, 0xAE, 0xF0, 0x74, 0xC1, -+0xA3, 0xF0, 0x90, 0x93, 0x49, 0xE0, 0xFF, 0xED, -+0xC3, 0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, -+0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, -+0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, -+0x22, 0x0D, 0x80, 0xDE, 0x74, 0xAE, 0x04, 0x90, -+0x01, 0xC4, 0xF0, 0x74, 0xC1, 0xA3, 0xF0, 0x7F, -+0x01, 0x22, 0xE4, 0x90, 0x95, 0x15, 0xF0, 0xA3, -+0xF0, 0xA3, 0xF0, 0x90, 0x95, 0x15, 0xE0, 0x64, -+0x01, 0xF0, 0x90, 0x93, 0x55, 0xE0, 0x70, 0x18, -+0x90, 0x93, 0x52, 0xE0, 0x70, 0x12, 0xA3, 0xE0, -+0x70, 0x0E, 0x90, 0x95, 0x15, 0xE0, 0x24, 0xEA, -+0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC1, 0xA3, 0xF0, -+0x12, 0x7C, 0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, -+0x9F, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, -+0x88, 0x39, 0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, -+0x6F, 0x60, 0x03, 0x12, 0xAF, 0x38, 0xC2, 0xAF, -+0x31, 0xAE, 0xBF, 0x01, 0x02, 0x51, 0x4B, 0xD2, -+0xAF, 0x51, 0xC0, 0x12, 0xA7, 0xE5, 0x12, 0x83, -+0x4D, 0x80, 0xA8, 0x90, 0x88, 0x31, 0xE0, 0x30, -+0xE0, 0x02, 0x51, 0x55, 0x22, 0x90, 0x88, 0x39, -+0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0E, 0x51, -+0x6E, 0xBF, 0x01, 0x09, 0x12, 0x97, 0xB6, 0x90, -+0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x02, -+0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, -+0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x64, -+0x01, 0x80, 0x2E, 0x90, 0x02, 0x96, 0xE0, 0x60, -+0x05, 0x75, 0x64, 0x10, 0x80, 0x23, 0x90, 0x02, -+0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, -+0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x64, -+0x04, 0x80, 0x0E, 0x90, 0x88, 0xE6, 0xE0, 0x30, -+0xE0, 0x05, 0x75, 0x64, 0x20, 0x80, 0x02, 0x61, -+0x77, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, -+0x01, 0xB8, 0xE5, 0x64, 0xF0, 0x7F, 0x00, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x93, 0x52, 0xE0, 0x60, 0x25, 0x7F, 0x54, 0x7E, -+0x09, 0x12, 0x70, 0x70, 0x71, 0x6D, 0x12, 0x04, -+0xB8, 0xEF, 0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, -+0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0x71, 0x6D, -+0x12, 0xB7, 0x66, 0x7F, 0x54, 0x7E, 0x09, 0x12, -+0x70, 0xAD, 0x90, 0x93, 0x4D, 0xE0, 0x70, 0x29, -+0x90, 0x07, 0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, -+0xF0, 0x90, 0x95, 0x1C, 0x74, 0x22, 0xF0, 0x90, -+0x95, 0x3E, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x1E, -+0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x1C, 0x12, 0x8C, 0xD3, 0x7F, 0x04, 0x12, 0x04, -+0x7E, 0x90, 0x93, 0x55, 0xE0, 0xFF, 0x70, 0x0A, -+0x90, 0x93, 0x52, 0xE0, 0x70, 0x04, 0xA3, 0xE0, -+0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, -+0xF0, 0x90, 0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, -+0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, -+0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, -+0x90, 0x93, 0x52, 0xE0, 0x60, 0x06, 0x90, 0x01, -+0xC4, 0x74, 0x01, 0xF0, 0x90, 0x93, 0x53, 0xE0, -+0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, 0x18, -+0x12, 0x04, 0x31, 0x90, 0x95, 0x18, 0x22, 0x90, -+0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, -+0x9D, 0xE0, 0x30, 0xE0, 0x10, 0x90, 0x88, 0xA3, -+0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x12, -+0x75, 0x10, 0x10, 0x80, 0x3F, 0x12, 0x7A, 0x65, -+0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x10, 0x01, -+0x80, 0x32, 0x90, 0x88, 0x31, 0x12, 0x9D, 0x24, -+0x30, 0xE0, 0x05, 0x75, 0x10, 0x02, 0x80, 0x24, -+0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x04, 0x40, -+0x05, 0x75, 0x10, 0x08, 0x80, 0x16, 0x90, 0x93, -+0x29, 0xE0, 0x30, 0xE0, 0x0B, 0xC4, 0x54, 0x0F, -+0x30, 0xE0, 0x05, 0x75, 0x10, 0x11, 0x80, 0x04, -+0x71, 0x77, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, -+0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x10, 0xF0, -+0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, -+0x9D, 0xE0, 0x30, 0xE0, 0x1E, 0x90, 0x88, 0xAF, -+0xE0, 0x60, 0x05, 0x75, 0x11, 0x40, 0x81, 0x98, -+0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x00, 0x40, -+0x02, 0x80, 0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, -+0x7B, 0x80, 0x55, 0x12, 0x7A, 0x65, 0xEF, 0x64, -+0x01, 0x60, 0x05, 0x75, 0x11, 0x01, 0x80, 0x70, -+0x90, 0x88, 0x3A, 0xE0, 0xFF, 0x54, 0x03, 0x60, -+0x05, 0x75, 0x11, 0x02, 0x80, 0x62, 0x90, 0x88, -+0x38, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, -+0x75, 0x11, 0x04, 0x80, 0x53, 0xEF, 0x30, 0xE2, -+0x05, 0x75, 0x11, 0x08, 0x80, 0x4A, 0x90, 0x88, -+0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x11, 0x10, -+0x80, 0x3E, 0x90, 0x88, 0x32, 0xE0, 0x13, 0x13, -+0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x11, 0x20, -+0x80, 0x2E, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x05, -+0x75, 0x11, 0x80, 0x80, 0x23, 0x90, 0x06, 0x62, -+0xE0, 0x30, 0xE1, 0x05, 0x75, 0x11, 0x11, 0x80, -+0x17, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, -+0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, -+0x11, 0x12, 0x80, 0x04, 0x71, 0x77, 0x80, 0x0E, -+0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, -+0xB8, 0xE5, 0x11, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x8F, 0x0D, 0x7F, 0x02, 0x12, -+0x85, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x0D, -+0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, -+0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -+0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x01, 0xC4, 0x74, 0xBA, 0xF0, 0x74, 0xC4, 0xA3, -+0xF0, 0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, 0xE1, -+0x02, 0xF1, 0x59, 0xE5, 0x2D, 0x30, 0xE1, 0x02, -+0xF1, 0x4E, 0xE5, 0x2D, 0x30, 0xE3, 0x03, 0x12, -+0xD3, 0xC5, 0xE5, 0x2D, 0x30, 0xE4, 0x02, 0xF1, -+0x7C, 0xE5, 0x2D, 0x30, 0xE5, 0x03, 0x12, 0xD3, -+0xD8, 0xE5, 0x2F, 0x30, 0xE0, 0x03, 0x12, 0xAB, -+0xA3, 0xE5, 0x2F, 0x30, 0xE1, 0x03, 0x12, 0x9B, -+0x50, 0xE5, 0x2F, 0x30, 0xE2, 0x02, 0xF1, 0x63, -+0xE5, 0x2F, 0x30, 0xE3, 0x02, 0xF1, 0x0A, 0xE5, -+0x2F, 0x30, 0xE4, 0x02, 0xF1, 0x22, 0xE5, 0x2F, -+0x30, 0xE5, 0x03, 0x12, 0xC8, 0x72, 0xE5, 0x2F, -+0x30, 0xE6, 0x03, 0x12, 0xAF, 0x47, 0xE5, 0x2F, -+0x30, 0xE7, 0x02, 0xD1, 0xF2, 0xE5, 0x30, 0x30, -+0xE0, 0x02, 0xD1, 0xE9, 0xE5, 0x30, 0x30, 0xE4, -+0x02, 0xB1, 0x81, 0xE5, 0x30, 0x30, 0xE5, 0x03, -+0x12, 0xB7, 0xEC, 0x74, 0xBA, 0x04, 0x90, 0x01, -+0xC4, 0xF0, 0x74, 0xC4, 0xA3, 0xF0, 0xD0, 0x07, -+0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, -+0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, -+0x32, 0xE4, 0xFF, 0x90, 0x95, 0xCA, 0xEF, 0xF0, -+0x90, 0x88, 0x2B, 0xE0, 0x90, 0x95, 0xDC, 0xF0, -+0xE4, 0x90, 0x95, 0xCB, 0xF0, 0x90, 0x95, 0xDC, -+0xE0, 0xFE, 0x90, 0x95, 0xCB, 0xE0, 0xFF, 0xC3, -+0x9E, 0x50, 0x2B, 0xE0, 0xFE, 0xD1, 0xBA, 0xE4, -+0xF0, 0xEE, 0xF1, 0xDE, 0xE0, 0x30, 0xE7, 0x0A, -+0x75, 0xF0, 0x12, 0xEF, 0xD1, 0xC4, 0xE4, 0xF0, -+0x80, 0x0C, 0x12, 0x7C, 0x8F, 0x90, 0x95, 0xCB, -+0xE0, 0xD1, 0xBA, 0x74, 0x01, 0xF0, 0x90, 0x95, -+0xCB, 0xE0, 0x04, 0xF0, 0x80, 0xC7, 0x7F, 0x0C, -+0x7E, 0x00, 0x12, 0x7C, 0x6A, 0xE4, 0x90, 0x95, -+0xCB, 0xF0, 0x90, 0x95, 0xDC, 0xE0, 0xFF, 0x90, -+0x95, 0xCB, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, -+0xC1, 0xB9, 0x74, 0xCC, 0x2E, 0xD1, 0xBC, 0xE0, -+0x70, 0x02, 0xC1, 0xB1, 0xEE, 0xC4, 0x54, 0xF0, -+0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, -+0x83, 0xE0, 0xFD, 0xEE, 0xC4, 0x54, 0xF0, 0x24, -+0x07, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -+0xD1, 0xCA, 0xFC, 0x75, 0xF0, 0x12, 0xF1, 0x53, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xEC, 0xC4, 0x54, -+0xF0, 0x24, 0x0A, 0xF5, 0x82, 0xE4, 0x34, 0x81, -+0xF5, 0x83, 0xE0, 0xFD, 0xEC, 0xD1, 0xDC, 0xD1, -+0xCA, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x57, 0x12, -+0x04, 0x6E, 0xEE, 0x8F, 0xF0, 0x12, 0x02, 0xE7, -+0x7F, 0x01, 0x90, 0x95, 0xCB, 0xE0, 0xFE, 0xD1, -+0xDC, 0xE5, 0x82, 0x2F, 0x12, 0xA7, 0x8F, 0xE0, -+0xFD, 0x75, 0xF0, 0x12, 0xEE, 0x90, 0x89, 0x57, -+0x12, 0x04, 0x6E, 0x75, 0xF0, 0x02, 0xEF, 0x12, -+0x04, 0x6E, 0xE4, 0x8D, 0xF0, 0x12, 0x02, 0xE7, -+0x0F, 0xEF, 0xB4, 0x05, 0xD5, 0xD1, 0xD3, 0x24, -+0x09, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -+0xE0, 0xFE, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, -+0x55, 0x12, 0x04, 0x6E, 0xEE, 0xF0, 0xD1, 0xD3, -+0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, -+0x83, 0xE0, 0xFE, 0xF1, 0x95, 0xF5, 0x83, 0xEE, -+0xF0, 0x90, 0x95, 0xCB, 0xE0, 0xFF, 0x90, 0x95, -+0xCA, 0xE0, 0xFD, 0xF1, 0xA2, 0x90, 0x95, 0xCB, -+0xE0, 0x75, 0xF0, 0x12, 0xD1, 0xC4, 0x74, 0x01, -+0xF0, 0x90, 0x95, 0xCB, 0xE0, 0x04, 0xF0, 0xA1, -+0xDA, 0x22, 0x24, 0xCC, 0xF5, 0x82, 0xE4, 0x34, -+0x95, 0xF5, 0x83, 0x22, 0x90, 0x89, 0x56, 0x02, -+0x04, 0x6E, 0xE0, 0xFE, 0xED, 0xFF, 0x90, 0x95, -+0xCB, 0xE0, 0x22, 0x90, 0x95, 0xCB, 0xE0, 0xFF, -+0xC4, 0x54, 0xF0, 0x22, 0xC4, 0x54, 0xF0, 0x24, -+0x0B, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -+0x22, 0x12, 0x9F, 0xD6, 0xBF, 0x03, 0x02, 0xF1, -+0x02, 0x22, 0xE4, 0xF5, 0x7A, 0xF5, 0x7B, 0xF5, -+0x7C, 0x12, 0x9F, 0xD6, 0xBF, 0x03, 0x02, 0xF1, -+0x02, 0x22, 0x90, 0x05, 0x21, 0xE0, 0x54, 0x7F, -+0xF0, 0x22, 0x12, 0x9F, 0xEE, 0x70, 0x12, 0x90, -+0x88, 0x36, 0xE0, 0x60, 0x0C, 0x90, 0x88, 0x3A, -+0xE0, 0x20, 0xE4, 0x05, 0xF1, 0x43, 0x12, 0x8F, -+0x86, 0x22, 0x12, 0x9F, 0xEE, 0x70, 0x1B, 0x90, -+0x88, 0x36, 0xE0, 0x60, 0x15, 0x90, 0x88, 0x3A, -+0xE0, 0x20, 0xE4, 0x0E, 0xF1, 0x43, 0xF0, 0x90, -+0x88, 0x31, 0xE0, 0xF1, 0x6F, 0x70, 0x03, 0x12, -+0xAF, 0x38, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, -+0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0xE4, 0xFF, -+0x02, 0xBF, 0xE2, 0x90, 0x89, 0x53, 0x02, 0x04, -+0x6E, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, -+0x8F, 0x9E, 0x22, 0x90, 0x88, 0x39, 0xE0, 0x64, -+0x02, 0x60, 0x03, 0x12, 0xB0, 0xFE, 0x22, 0x54, -+0xFB, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, -+0xF0, 0x54, 0x07, 0x22, 0x90, 0x8A, 0x75, 0x12, -+0x88, 0xDF, 0x90, 0x8A, 0xE5, 0x12, 0x8C, 0xE5, -+0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x89, 0x55, -+0x12, 0x04, 0x6E, 0xE4, 0xF0, 0x74, 0xAD, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x94, 0x22, 0x7D, 0x01, -+0xAF, 0x65, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0xED, 0x60, 0x15, 0x12, 0xCA, 0xBF, 0x90, -+0x89, 0x5F, 0x12, 0xCA, 0xF0, 0x90, 0x89, 0x53, -+0x12, 0xCA, 0xF0, 0xF1, 0x8D, 0xF5, 0x83, 0xE4, -+0xF0, 0xF1, 0xCA, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xEF, 0xC4, 0x54, 0xF0, 0x24, 0x03, -+0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, -+0x54, 0xBF, 0x44, 0x80, 0xFE, 0xEF, 0xC4, 0x54, -+0xF0, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x81, -+0xF5, 0x83, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, -+0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, -+0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0x01, 0xC4, 0x74, 0xEB, 0xF0, 0x74, 0xC7, -+0xA3, 0xF0, 0x90, 0x8A, 0x9D, 0x12, 0x88, 0xDF, -+0x53, 0x91, 0xBF, 0x74, 0xEB, 0x04, 0x90, 0x01, -+0xC4, 0xF0, 0x74, 0xC7, 0xA3, 0xF0, 0xD0, 0x07, -+0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, -+0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, -+0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, -+0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, -+0x7D, 0x41, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, -+0xC8, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, -+0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, -+0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, -+0xE0, 0x32, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, -+0x01, 0x19, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x13, -+0x12, 0xAF, 0xCF, 0x64, 0x02, 0x60, 0x09, 0x90, -+0x8A, 0xE1, 0x12, 0xB7, 0xE4, 0x02, 0x04, 0x7A, -+0x12, 0x73, 0x8F, 0x22, 0x90, 0x96, 0xCD, 0xED, -+0xF0, 0x64, 0x01, 0x60, 0x27, 0xE0, 0xFE, 0x64, -+0x02, 0x60, 0x21, 0xEE, 0x64, 0x29, 0x60, 0x1C, -+0xEE, 0x64, 0x2A, 0x60, 0x17, 0xEE, 0x64, 0x36, -+0x60, 0x12, 0xEE, 0xB4, 0x37, 0x02, 0x80, 0x0C, -+0xAD, 0x07, 0x7F, 0xFF, 0x12, 0xAB, 0x0A, 0x90, -+0x93, 0x5E, 0xE0, 0xFF, 0x90, 0x93, 0x5D, 0xE0, -+0x4F, 0x90, 0x05, 0x22, 0xF0, 0x90, 0x96, 0xCD, -+0xE0, 0x90, 0x93, 0x01, 0xF0, 0x22, 0xE6, 0xFD, -+0xAF, 0x65, 0xEF, 0x11, 0xEE, 0xE0, 0x54, 0xF8, -+0xF5, 0x73, 0xED, 0x42, 0x73, 0xEF, 0x11, 0xEE, -+0xE5, 0x73, 0xF0, 0x22, 0xE5, 0x65, 0xC4, 0x54, -+0xF0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x81, -+0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x96, 0x6F, 0x51, 0x72, 0x12, -+0xAF, 0x29, 0xE0, 0x90, 0x96, 0x7A, 0xF0, 0xE4, -+0x90, 0x96, 0x77, 0xF0, 0x90, 0x96, 0x6F, 0x12, -+0xB5, 0x9A, 0x90, 0x96, 0x72, 0xF0, 0xEF, 0x54, -+0x07, 0x90, 0x96, 0x74, 0xF0, 0x90, 0x96, 0x6F, -+0xE0, 0x11, 0xEE, 0xE0, 0x90, 0x96, 0x75, 0xF0, -+0x12, 0xA7, 0x7C, 0x54, 0x7F, 0x90, 0x96, 0x78, -+0xF0, 0x90, 0x96, 0x6F, 0xE0, 0x12, 0xA7, 0xA7, -+0xE0, 0x90, 0x96, 0x79, 0xF0, 0xED, 0x54, 0x7F, -+0x90, 0x96, 0x73, 0xF0, 0xEB, 0x70, 0x21, 0x90, -+0x89, 0x3D, 0x51, 0x5F, 0xFF, 0x51, 0x7B, 0xFD, -+0x90, 0x89, 0x40, 0x12, 0x97, 0x6E, 0x2D, 0xFF, -+0xE4, 0x35, 0xF0, 0xC3, 0x13, 0xFE, 0xEF, 0x13, -+0xFF, 0x90, 0x96, 0x6F, 0xE0, 0x12, 0xA7, 0xD4, -+0x90, 0x96, 0x78, 0xE0, 0xFF, 0x90, 0x96, 0x73, -+0xE0, 0xFE, 0xD3, 0x9F, 0x40, 0x0C, 0x90, 0x96, -+0x70, 0xE0, 0x54, 0x80, 0xFD, 0xEF, 0x4D, 0xF0, -+0x80, 0x0F, 0x90, 0x96, 0x79, 0xE0, 0xFF, 0xEE, -+0xC3, 0x9F, 0x50, 0x05, 0x90, 0x96, 0x70, 0xEF, -+0xF0, 0x90, 0x96, 0x70, 0xE0, 0xFE, 0x54, 0x7F, -+0x90, 0x96, 0x73, 0xF0, 0xEE, 0x54, 0x80, 0x90, -+0x96, 0x76, 0xF0, 0x90, 0x96, 0x71, 0xE0, 0x70, -+0x25, 0xA3, 0x51, 0x67, 0xC0, 0x83, 0xC0, 0x82, -+0xE0, 0xFF, 0x90, 0x96, 0x74, 0x12, 0xA1, 0x13, -+0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, -+0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0x96, 0x75, -+0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x42, 0x90, 0x96, -+0x72, 0x51, 0x67, 0xC0, 0x83, 0xC0, 0x82, 0xE0, -+0xFF, 0x90, 0x96, 0x74, 0x12, 0xA1, 0x13, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, -+0xD0, 0x83, 0xF0, 0x90, 0x96, 0x6F, 0xE0, 0x11, -+0xEE, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x96, 0x75, -+0xF0, 0x90, 0x89, 0x46, 0x51, 0x5F, 0xF5, 0x82, -+0x12, 0x97, 0x73, 0x33, 0x33, 0x33, 0x54, 0xF8, -+0x4F, 0x90, 0x96, 0x75, 0xF0, 0x44, 0x80, 0xF0, -+0x90, 0x96, 0x70, 0x51, 0x57, 0x12, 0xA5, 0x36, -+0xEF, 0xF0, 0xEE, 0x70, 0x05, 0x90, 0x01, 0xC8, -+0xEF, 0xF0, 0x90, 0x96, 0x75, 0x51, 0x57, 0x11, -+0xEE, 0xEF, 0xF0, 0xEE, 0x12, 0x8F, 0x79, 0xE0, -+0x54, 0xFC, 0xFF, 0x90, 0x96, 0x7A, 0xE0, 0x54, -+0x03, 0x4F, 0xFE, 0x90, 0x96, 0x6F, 0xE0, 0xFF, -+0x12, 0x8F, 0x79, 0xEE, 0xF0, 0x7D, 0x01, 0x12, -+0xC7, 0xA2, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, -+0xFF, 0x90, 0x96, 0x6F, 0xE0, 0xFE, 0x22, 0x12, -+0x86, 0x6D, 0x90, 0x96, 0x73, 0xE0, 0x22, 0xE0, -+0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, -+0x83, 0x22, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, -+0xEB, 0xF0, 0x22, 0x75, 0xF0, 0x02, 0xA4, 0xF5, -+0x82, 0x85, 0xF0, 0x83, 0x02, 0x03, 0x3E, 0x7D, -+0x07, 0xAF, 0x65, 0xED, 0x30, 0xE0, 0x0C, 0x51, -+0xBF, 0x90, 0x89, 0x5F, 0x12, 0x04, 0x6E, 0xE4, -+0xF0, 0xA3, 0xF0, 0xED, 0x30, 0xE1, 0x0B, 0x75, -+0xF0, 0x12, 0xEF, 0x12, 0xC7, 0x53, 0xE4, 0xF0, -+0xA3, 0xF0, 0xED, 0x30, 0xE2, 0x0B, 0x75, 0xF0, -+0x12, 0xEF, 0x12, 0xC7, 0x8D, 0xF5, 0x83, 0xE4, -+0xF0, 0x12, 0xC7, 0xCA, 0xEE, 0xF0, 0x22, 0x75, -+0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, 0x12, 0x04, -+0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, -+0xEF, 0x90, 0x89, 0x59, 0x12, 0x04, 0x6E, 0xE4, -+0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x90, -+0x89, 0x5B, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, -+0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x5D, -+0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, -+0xF0, 0x12, 0xEF, 0x22, 0x12, 0x02, 0x06, 0xFE, -+0x12, 0x87, 0xE7, 0xFF, 0x74, 0xD6, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0x8D, 0x12, 0x87, 0xED, 0xFF, -+0x74, 0xC6, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -+0x12, 0x87, 0xF7, 0xFF, 0x74, 0x14, 0x2E, 0x71, -+0x52, 0xEF, 0xF0, 0x74, 0xC6, 0x2E, 0x12, 0xA6, -+0x95, 0xE0, 0x30, 0xE5, 0x17, 0x75, 0xF0, 0x12, -+0xEE, 0x12, 0xA3, 0x38, 0x13, 0x13, 0x54, 0x03, -+0xFB, 0xAF, 0x06, 0x74, 0xD6, 0x2E, 0x71, 0x49, -+0xFD, 0x12, 0x6B, 0xFD, 0x22, 0x74, 0xD6, 0x25, -+0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, -+0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, -+0x83, 0x22, 0x90, 0x04, 0x85, 0xE0, 0xF5, 0x6E, -+0x90, 0x96, 0x24, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, -+0x65, 0x90, 0x88, 0x2B, 0xE0, 0xFF, 0xE5, 0x65, -+0xC3, 0x9F, 0x40, 0x03, 0x02, 0xD2, 0x22, 0xE5, -+0x65, 0x12, 0xA5, 0x36, 0xE0, 0xF5, 0x70, 0x12, -+0xDB, 0x76, 0xE0, 0x65, 0x70, 0x60, 0x16, 0x90, -+0x92, 0x5E, 0xE5, 0x70, 0xF0, 0xE4, 0xA3, 0xF0, -+0xAB, 0x65, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0x12, -+0xDB, 0x76, 0xE5, 0x70, 0xF0, 0x90, 0x04, 0xA0, -+0xE0, 0x64, 0x01, 0x70, 0x52, 0xA3, 0xE0, 0x65, -+0x65, 0x70, 0x4C, 0xA3, 0xE0, 0xF5, 0x66, 0xA3, -+0xE0, 0x90, 0x95, 0x4B, 0xF0, 0xE5, 0x65, 0x12, -+0xA5, 0x36, 0xE0, 0x65, 0x66, 0x70, 0x03, 0x02, -+0xD2, 0x1D, 0xE5, 0x65, 0x12, 0xA5, 0x36, 0xE5, -+0x66, 0xF0, 0xE5, 0x65, 0x12, 0x8F, 0x79, 0xE0, -+0x54, 0xFC, 0xFF, 0x90, 0x95, 0x4B, 0xE0, 0x54, -+0x03, 0x4F, 0xFF, 0xE5, 0x65, 0x12, 0x8F, 0x79, -+0xEF, 0xF0, 0x90, 0x92, 0x5E, 0xE5, 0x66, 0xF0, -+0xA3, 0x74, 0xFF, 0xF0, 0xAB, 0x65, 0xE4, 0xFD, -+0xFF, 0x12, 0x6F, 0x75, 0x02, 0xD2, 0x1D, 0x74, -+0xAD, 0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x94, -+0xF5, 0x83, 0xE0, 0xFB, 0x7A, 0x00, 0x75, 0xF0, -+0x12, 0xE5, 0x65, 0x90, 0x89, 0x55, 0x12, 0x04, -+0x6E, 0xE0, 0xC3, 0x9B, 0xFE, 0xE4, 0x9A, 0x90, -+0x95, 0x43, 0xF0, 0xA3, 0xCE, 0xF0, 0x75, 0xF0, -+0x12, 0xE5, 0x65, 0x12, 0xC7, 0x53, 0xE0, 0xFE, -+0xA3, 0xE0, 0xC3, 0x9B, 0xF5, 0x6C, 0xEE, 0x9A, -+0xF5, 0x6B, 0xAF, 0x65, 0x12, 0x78, 0x4A, 0xEF, -+0x70, 0x03, 0x02, 0xD2, 0x1D, 0x75, 0xF0, 0x12, -+0xE5, 0x65, 0x12, 0xA3, 0x38, 0x12, 0xA1, 0xDD, -+0x30, 0xE0, 0x03, 0x02, 0xD2, 0x1D, 0xE5, 0x65, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0x51, 0x68, 0xE0, -+0xFD, 0x7C, 0x00, 0xE5, 0x65, 0x12, 0xAD, 0xBE, -+0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, -+0x60, 0x03, 0x02, 0xD2, 0x1D, 0xE5, 0x6C, 0x45, -+0x6B, 0x70, 0x0D, 0x90, 0x95, 0x43, 0xE0, 0x70, -+0x02, 0xA3, 0xE0, 0x70, 0x03, 0x02, 0xD2, 0x1D, -+0xE5, 0x65, 0x75, 0xF0, 0x12, 0xA4, 0x24, 0x57, -+0xF9, 0x74, 0x89, 0x35, 0xF0, 0xFA, 0x7B, 0x01, -+0x90, 0x95, 0x40, 0x12, 0x86, 0x76, 0x12, 0xD2, -+0xB7, 0x12, 0x03, 0x13, 0x2F, 0xFF, 0x12, 0xD2, -+0x4A, 0x2F, 0xFF, 0x90, 0x00, 0x06, 0x12, 0x03, -+0x3E, 0x2F, 0xFF, 0x12, 0xD2, 0xC5, 0x2F, 0xF5, -+0x6F, 0xE5, 0x65, 0x12, 0xA5, 0x36, 0xE0, 0xF5, -+0x66, 0x54, 0x80, 0xF5, 0x68, 0xE5, 0x66, 0x54, -+0x7F, 0xF5, 0x67, 0x90, 0x96, 0x12, 0xE0, 0x60, -+0x16, 0x75, 0x71, 0x0A, 0x12, 0xDB, 0x3B, 0x34, -+0x81, 0xF5, 0x83, 0xE4, 0x93, 0xC3, 0x13, 0x74, -+0x01, 0x93, 0x13, 0xF5, 0x72, 0x80, 0x0A, 0x7B, -+0xFF, 0x12, 0xAF, 0x13, 0xE4, 0xF5, 0x71, 0xF5, -+0x72, 0x75, 0xF0, 0x12, 0xE5, 0x65, 0x12, 0xA7, -+0x80, 0xFF, 0xE5, 0x67, 0xD3, 0x9F, 0x40, 0x08, -+0x8F, 0x67, 0xE5, 0x67, 0x45, 0x68, 0xF5, 0x66, -+0x12, 0xD2, 0x5B, 0xE0, 0xC3, 0x94, 0x05, 0x40, -+0x02, 0xC1, 0xC6, 0xE5, 0x67, 0x90, 0x81, 0x61, -+0x93, 0xF5, 0x6D, 0xFD, 0xAF, 0x67, 0x12, 0x60, -+0x6F, 0x8F, 0x6D, 0xE5, 0x68, 0x60, 0x04, 0x05, -+0x6D, 0x05, 0x6D, 0xE5, 0x67, 0xC3, 0x94, 0x0C, -+0x40, 0x1C, 0x74, 0x14, 0x25, 0x65, 0x71, 0x52, -+0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xEF, 0x30, 0xE7, -+0x06, 0xE5, 0x6D, 0x2E, 0xFF, 0x80, 0x05, 0xC3, -+0xE5, 0x6D, 0x9E, 0xFF, 0x8F, 0x6D, 0xE5, 0x6D, -+0xD3, 0x94, 0x1A, 0xAF, 0x6D, 0x40, 0x02, 0x7F, -+0x1A, 0x8F, 0x6D, 0xE5, 0x66, 0x90, 0x81, 0xD9, -+0x93, 0xFF, 0xD3, 0x90, 0x95, 0x44, 0xE0, 0x9F, -+0x90, 0x95, 0x43, 0xE0, 0x94, 0x00, 0x40, 0x02, -+0xC1, 0x73, 0xC3, 0xE5, 0x6C, 0x94, 0x0A, 0xE5, -+0x6B, 0x94, 0x00, 0x40, 0x02, 0xC1, 0x18, 0x74, -+0x35, 0x25, 0x65, 0x12, 0xAF, 0x0B, 0xE0, 0xC3, -+0x94, 0x01, 0x40, 0x0A, 0x74, 0x35, 0x25, 0x65, -+0x12, 0xAF, 0x0B, 0xE0, 0x14, 0xF0, 0x12, 0xD2, -+0xBF, 0xFF, 0x90, 0x95, 0x44, 0xE0, 0x2F, 0xFF, -+0x90, 0x95, 0x43, 0xE0, 0x12, 0xD2, 0x3A, 0x12, -+0xD2, 0x49, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0xFC, -+0xE5, 0x6B, 0xC3, 0x13, 0xFE, 0xE5, 0x6C, 0x13, -+0xFF, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x12, -+0xE5, 0x65, 0x94, 0x05, 0x50, 0x0A, 0x74, 0x35, -+0x25, 0x65, 0x12, 0xAF, 0x0B, 0x74, 0x03, 0xF0, -+0xC1, 0x73, 0x12, 0xD2, 0x78, 0x12, 0x03, 0x13, -+0x65, 0x6F, 0x70, 0x02, 0xE5, 0xF0, 0x70, 0x32, -+0xE5, 0x65, 0xC3, 0x94, 0x05, 0x50, 0x0F, 0x74, -+0x35, 0x25, 0x65, 0x12, 0xAF, 0x0B, 0xE0, 0xD3, -+0x94, 0x00, 0x40, 0x02, 0x80, 0x07, 0xE5, 0x6F, -+0xC3, 0x94, 0x03, 0x50, 0x09, 0x7D, 0x06, 0xAF, -+0x65, 0x51, 0x8B, 0x02, 0xD2, 0x1D, 0xE4, 0xFD, -+0xAF, 0x65, 0x12, 0xA5, 0xD0, 0x51, 0x87, 0x02, -+0xD0, 0xB6, 0x12, 0xC7, 0x9E, 0x02, 0xD0, 0xB6, -+0x74, 0x35, 0x25, 0x65, 0x12, 0xAF, 0x0B, 0xE4, -+0xF0, 0x90, 0x91, 0x6C, 0x74, 0x02, 0xF0, 0xAB, -+0x6D, 0xAD, 0x65, 0xAF, 0x6C, 0xAE, 0x6B, 0x12, -+0x41, 0x9C, 0x8E, 0x69, 0x8F, 0x6A, 0x12, 0xDB, -+0x3B, 0x34, 0x81, 0xF5, 0x83, 0xC3, 0x74, 0x01, -+0x93, 0x95, 0x72, 0xFF, 0xE4, 0x93, 0x94, 0x00, -+0xFE, 0xD3, 0xE5, 0x6A, 0x9F, 0xE5, 0x69, 0x9E, -+0x40, 0x0F, 0x12, 0xDA, 0xDF, 0xE4, 0xF0, 0x7D, -+0x01, 0xAF, 0x65, 0x12, 0xA5, 0xD0, 0x02, 0xD0, -+0xB6, 0x12, 0xDB, 0xB9, 0xC3, 0xE5, 0x6A, 0x9F, -+0xE5, 0x69, 0x94, 0x00, 0x50, 0x0F, 0x12, 0xDA, -+0xDF, 0xE4, 0xF0, 0x7D, 0x01, 0xAF, 0x65, 0x12, -+0xA6, 0xC6, 0x02, 0xD0, 0xB6, 0x51, 0x87, 0x12, -+0xDA, 0xDF, 0xE0, 0x04, 0xF0, 0xE5, 0x67, 0x90, -+0x81, 0xED, 0x93, 0x25, 0x71, 0xFF, 0xE4, 0x33, -+0xFE, 0x12, 0xDA, 0xDF, 0xE0, 0xC3, 0x9F, 0xEE, -+0x12, 0xDA, 0x1F, 0x50, 0x03, 0x02, 0xD0, 0xB6, -+0x12, 0xDA, 0xDF, 0xE4, 0xF0, 0x12, 0xDB, 0xB9, -+0x12, 0xDB, 0x3B, 0x34, 0x81, 0xF5, 0x83, 0x74, -+0x01, 0x93, 0x2F, 0xFF, 0xE4, 0x93, 0x34, 0x00, -+0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x65, -+0x12, 0xA7, 0xD4, 0x02, 0xD0, 0xB6, 0x12, 0xD2, -+0x5B, 0xE0, 0x64, 0x05, 0x60, 0x02, 0xE1, 0x90, -+0x90, 0x04, 0xA0, 0xE0, 0x64, 0x02, 0x70, 0x11, -+0x12, 0xDA, 0x9F, 0xE4, 0xF0, 0x90, 0x04, 0xA1, -+0xE0, 0x78, 0x88, 0xF6, 0x11, 0xD6, 0x02, 0xD0, -+0xCA, 0xAD, 0x67, 0xAF, 0x65, 0x12, 0x72, 0xEE, -+0x12, 0xDB, 0x6A, 0xEF, 0xF0, 0x11, 0xEC, 0xE0, -+0x54, 0x07, 0x78, 0x88, 0xF6, 0x71, 0x45, 0xFF, -+0xC3, 0x94, 0x30, 0x40, 0x1D, 0x75, 0xF0, 0x12, -+0xE5, 0x65, 0x12, 0xA3, 0x38, 0xFE, 0xC4, 0x13, -+0x13, 0x54, 0x03, 0x20, 0xE0, 0x0C, 0x12, 0xDB, -+0x6A, 0xE0, 0x60, 0x06, 0x90, 0x96, 0x12, 0xE0, -+0x60, 0x0B, 0xE4, 0x78, 0x88, 0xF6, 0x12, 0xDA, -+0x9F, 0xE4, 0xF0, 0x80, 0x5A, 0x12, 0xDB, 0x5E, -+0xE0, 0xFE, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, -+0xEF, 0x12, 0xDA, 0x1C, 0x50, 0x1E, 0x71, 0x45, -+0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEE, 0x12, -+0xDA, 0x1C, 0x50, 0x10, 0x12, 0xDB, 0x52, 0xE0, -+0xB5, 0x67, 0x09, 0x12, 0xDA, 0xAC, 0xE0, 0xC3, -+0x94, 0x0A, 0x40, 0x25, 0x78, 0x88, 0xE6, 0xFF, -+0x70, 0x04, 0x76, 0x01, 0x80, 0x0C, 0xEF, 0x78, -+0x88, 0xB4, 0x01, 0x04, 0x76, 0x03, 0x80, 0x02, -+0x76, 0x05, 0x12, 0xDA, 0xAC, 0xE4, 0xF0, 0x71, -+0x45, 0xFF, 0x12, 0xDB, 0x5E, 0xEF, 0xF0, 0x80, -+0x06, 0x12, 0xDA, 0x9F, 0xE0, 0x04, 0xF0, 0x12, -+0xDB, 0x52, 0xE5, 0x67, 0xF0, 0x02, 0xD0, 0xB1, -+0x12, 0xD2, 0x5B, 0xE0, 0x64, 0x06, 0x60, 0x03, -+0x02, 0xD0, 0xB6, 0xF5, 0x69, 0xF5, 0x6A, 0x11, -+0xEC, 0xE0, 0x54, 0x07, 0x78, 0x88, 0xF6, 0xD3, -+0xE5, 0x6C, 0x94, 0xE8, 0xE5, 0x6B, 0x94, 0x03, -+0x40, 0x06, 0x78, 0x86, 0x76, 0x05, 0x80, 0x15, -+0xD3, 0xE5, 0x6C, 0x94, 0xFA, 0xE5, 0x6B, 0x94, -+0x00, 0x40, 0x06, 0x78, 0x86, 0x76, 0x02, 0x80, -+0x04, 0xE4, 0x78, 0x86, 0xF6, 0xE5, 0x6C, 0xAE, -+0x6B, 0x78, 0x86, 0x86, 0x00, 0x08, 0x80, 0x05, -+0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, -+0x90, 0x82, 0x06, 0xE4, 0x12, 0xD2, 0xB0, 0x90, -+0x95, 0x4C, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, -+0x78, 0x87, 0xF6, 0x12, 0xD2, 0x78, 0x78, 0x87, -+0xE6, 0xFD, 0x51, 0x7B, 0xAE, 0xF0, 0x78, 0x86, -+0x86, 0x00, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, -+0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xED, 0x90, 0x82, -+0x01, 0x51, 0xB0, 0xEF, 0x25, 0x6A, 0xF5, 0x6A, -+0xEE, 0x35, 0x69, 0xF5, 0x69, 0xC3, 0x90, 0x95, -+0x4D, 0xE0, 0x95, 0x6A, 0x90, 0x95, 0x4C, 0xE0, -+0x95, 0x69, 0x40, 0x07, 0x78, 0x87, 0x06, 0xE6, -+0xB4, 0x05, 0xC0, 0x78, 0x87, 0xE6, 0xC3, 0x13, -+0xF6, 0xFD, 0x08, 0xE6, 0x24, 0x01, 0xFF, 0xE4, -+0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x08, 0xF6, -+0xD3, 0x9D, 0x40, 0x07, 0xE6, 0x79, 0x87, 0x97, -+0xF6, 0x80, 0x04, 0xE4, 0x78, 0x89, 0xF6, 0x51, -+0x23, 0xE0, 0xC3, 0x13, 0xFF, 0x78, 0x89, 0xE6, -+0xC4, 0x33, 0x54, 0xE0, 0x2F, 0xFF, 0x51, 0x23, -+0xEF, 0xF0, 0x51, 0x23, 0xE0, 0xC3, 0x94, 0xC0, -+0x40, 0x05, 0x51, 0x23, 0x74, 0xC0, 0xF0, 0x51, -+0x23, 0xE0, 0x24, 0x1F, 0xFF, 0xE4, 0x33, 0xFE, -+0xEF, 0x78, 0x06, 0xCE, 0xA2, 0xE7, 0x13, 0xCE, -+0x13, 0xD8, 0xF8, 0x78, 0x89, 0xF6, 0xE6, 0x25, -+0xE0, 0xF6, 0x70, 0x03, 0xFF, 0x80, 0x05, 0x78, -+0x89, 0xE6, 0x14, 0xFF, 0x78, 0x88, 0xA6, 0x07, -+0xD3, 0x90, 0x95, 0x44, 0xE0, 0x94, 0x03, 0x90, -+0x95, 0x43, 0xE0, 0x94, 0x00, 0x40, 0x02, 0xE4, -+0xF6, 0x78, 0x88, 0x12, 0xC8, 0xD6, 0x51, 0x5B, -+0xE0, 0xFF, 0xD3, 0x94, 0x05, 0x50, 0x05, 0xEF, -+0x04, 0xFF, 0x80, 0x02, 0x7F, 0x00, 0x51, 0x5B, -+0xEF, 0xF0, 0xE4, 0xF5, 0x69, 0xF5, 0x6A, 0x75, -+0xF0, 0x12, 0xE5, 0x65, 0x12, 0xC6, 0xC4, 0xE0, -+0x64, 0x01, 0x60, 0x02, 0x41, 0x1A, 0x51, 0x78, -+0x51, 0xB7, 0xAE, 0xF0, 0x12, 0x03, 0x13, 0x2F, -+0xFF, 0xE5, 0xF0, 0x3E, 0x51, 0x49, 0x2F, 0xFF, -+0xEE, 0x51, 0x3A, 0xFE, 0x90, 0x00, 0x08, 0x51, -+0x40, 0x90, 0x95, 0x45, 0xF0, 0xA3, 0xEF, 0xF0, -+0x12, 0x03, 0x13, 0xFF, 0xC3, 0x90, 0x95, 0x46, -+0xE0, 0x9F, 0xFE, 0x90, 0x95, 0x45, 0xE0, 0x95, -+0xF0, 0x90, 0x95, 0x47, 0xF0, 0xA3, 0xCE, 0xF0, -+0x90, 0x00, 0x06, 0x12, 0x03, 0x3E, 0xFD, 0xAC, -+0xF0, 0x25, 0xE0, 0xFF, 0xEC, 0x33, 0xFE, 0xEF, -+0x2D, 0xFD, 0xEE, 0x3C, 0xFC, 0x51, 0x4A, 0x25, -+0xE0, 0xFF, 0xE5, 0xF0, 0x33, 0xFE, 0x90, 0x00, -+0x02, 0x51, 0x40, 0xCF, 0x2D, 0xFD, 0xEF, 0x3C, -+0xFC, 0x51, 0xBF, 0xAE, 0xF0, 0x78, 0x02, 0xC3, -+0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x2D, 0xFF, -+0xEC, 0x3E, 0x90, 0x95, 0x49, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0x95, 0x43, 0x51, 0x67, 0x51, 0x86, -+0x51, 0x2F, 0x9E, 0x50, 0x08, 0x90, 0x95, 0x43, -+0x51, 0x50, 0xFE, 0x80, 0x04, 0x7E, 0xFF, 0x7F, -+0xFF, 0xE5, 0x65, 0x51, 0x86, 0x12, 0xA7, 0xDD, -+0x90, 0x95, 0x45, 0x51, 0x67, 0x51, 0x90, 0x51, -+0x2F, 0x9E, 0x50, 0x08, 0x90, 0x95, 0x45, 0x51, -+0x50, 0xFE, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, -+0xE5, 0x65, 0x51, 0x90, 0x12, 0xA7, 0xDD, 0x90, -+0x95, 0x49, 0x51, 0x67, 0x51, 0x9A, 0x51, 0x2F, -+0x9E, 0x50, 0x08, 0x90, 0x95, 0x49, 0x51, 0x50, -+0xFE, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xE5, -+0x65, 0x51, 0x9A, 0x12, 0xA7, 0xDD, 0xC3, 0x74, -+0xFF, 0x95, 0x6C, 0xFF, 0x74, 0xFF, 0x95, 0x6B, -+0xFE, 0x51, 0xA4, 0x51, 0x2F, 0x9E, 0x50, 0x0A, -+0xE5, 0x6C, 0x2D, 0xFF, 0xE5, 0x6B, 0x3C, 0xFE, -+0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0x51, 0xA4, -+0x12, 0xA7, 0xDD, 0x51, 0x7E, 0xFB, 0xC3, 0x74, -+0xFF, 0x9B, 0xFF, 0x74, 0xFF, 0x9E, 0xFE, 0x74, -+0xFF, 0x94, 0x00, 0xFD, 0x74, 0xFF, 0x94, 0x00, -+0xFC, 0x90, 0x8D, 0x71, 0x12, 0x86, 0x61, 0xD3, -+0x12, 0x03, 0xDA, 0x50, 0x11, 0x51, 0x7E, 0xFF, -+0xE4, 0xFC, 0xFD, 0x90, 0x8D, 0x71, 0x12, 0x86, -+0x61, 0x12, 0x86, 0x2C, 0x80, 0x06, 0x74, 0xFF, -+0xFF, 0xFE, 0xFD, 0xFC, 0x90, 0x8D, 0x71, 0x12, -+0x04, 0x31, 0x12, 0xC7, 0x9E, 0x05, 0x65, 0x02, -+0xCB, 0x69, 0x22, 0x74, 0x4F, 0x25, 0x65, 0xF5, -+0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xF5, -+0x83, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x9F, -+0xEC, 0x22, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, -+0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, -+0x22, 0xFE, 0x90, 0x00, 0x04, 0x02, 0x03, 0x3E, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xED, 0x2F, 0xFF, -+0xEC, 0x3E, 0x22, 0x74, 0x76, 0x25, 0x65, 0xF5, -+0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, -+0xFF, 0x74, 0xFF, 0x9E, 0xFE, 0xE5, 0x65, 0x22, -+0x90, 0x95, 0x40, 0x02, 0x86, 0x6D, 0x90, 0x95, -+0x47, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x25, 0xE0, -+0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, -+0x25, 0xE0, 0x24, 0x26, 0xF5, 0x82, 0xE4, 0x34, -+0x8E, 0x22, 0x25, 0xE0, 0x24, 0x56, 0xF5, 0x82, -+0xE4, 0x34, 0x8E, 0x22, 0xE5, 0x65, 0x25, 0xE0, -+0x24, 0x86, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, -+0x93, 0xFD, 0x7C, 0x00, 0x02, 0x02, 0x80, 0x90, -+0x00, 0x02, 0x12, 0x03, 0x3E, 0xFF, 0x22, 0x90, -+0x95, 0x40, 0x12, 0x86, 0x6D, 0x90, 0x00, 0x08, -+0x02, 0x03, 0x3E, 0xE4, 0xF5, 0x78, 0xEF, 0x14, -+0xF5, 0x77, 0xED, 0xFF, 0xE5, 0x77, 0xF5, 0x82, -+0x33, 0x95, 0xE0, 0xF5, 0x83, 0xC3, 0xE5, 0x82, -+0x9F, 0x74, 0x80, 0xF8, 0x65, 0x83, 0x98, 0x40, -+0x52, 0xE5, 0x77, 0x78, 0x03, 0xA2, 0xE7, 0x13, -+0xD8, 0xFB, 0xFF, 0x33, 0x95, 0xE0, 0xFE, 0xEB, -+0x12, 0xA7, 0xB0, 0xE5, 0x82, 0x2F, 0xF5, 0x82, -+0xE5, 0x83, 0x3E, 0xF5, 0x83, 0xE0, 0xF5, 0x82, -+0x75, 0x83, 0x00, 0xE5, 0x77, 0x12, 0xAD, 0xBE, -+0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, -+0x82, 0x4E, 0x60, 0x13, 0x85, 0x77, 0x79, 0x05, -+0x78, 0x90, 0x95, 0x53, 0xE0, 0x65, 0x78, 0x60, -+0x0A, 0xE5, 0x79, 0xD3, 0x9D, 0x40, 0x04, 0x15, -+0x77, 0x80, 0x97, 0xAF, 0x79, 0x22, 0xEF, 0x64, -+0x13, 0x60, 0x04, 0xEF, 0xB4, 0x0B, 0x05, 0x90, -+0x88, 0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, 0x60, -+0x04, 0xEF, 0xB4, 0x0A, 0x05, 0x90, 0x88, 0xE4, -+0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, 0xEF, -+0xB4, 0x09, 0x05, 0x90, 0x88, 0xE5, 0x80, 0x03, -+0x90, 0x88, 0xE2, 0xE0, 0xF5, 0x0F, 0xAF, 0x0F, -+0x22, 0x90, 0x93, 0x57, 0xE0, 0x54, 0x7F, 0xF0, -+0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, -+0xF0, 0xE4, 0x90, 0x93, 0x59, 0xF0, 0x90, 0x93, -+0x57, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE4, 0x90, -+0x95, 0xF1, 0xF0, 0x90, 0x95, 0xEF, 0x74, 0x14, -+0xF0, 0x90, 0x96, 0x11, 0x74, 0x01, 0xF0, 0xFB, -+0x7A, 0x95, 0x79, 0xEF, 0x12, 0x8C, 0xD3, 0x7F, -+0x04, 0x02, 0x04, 0x7E, 0x90, 0x01, 0x9A, 0xE0, -+0x54, 0xC0, 0x44, 0x0B, 0x12, 0xAD, 0xA3, 0x90, -+0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, -+0x40, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x93, 0x03, -+0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x8A, 0xE5, 0x12, -+0x8C, 0xE5, 0x7F, 0x20, 0x12, 0x04, 0x7E, 0x22, -+0x90, 0x01, 0xCF, 0xE0, 0x90, 0x95, 0xCA, 0xF0, -+0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, -+0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, -+0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, -+0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, -+0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, 0x03, -+0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x7B, -+0x2E, 0x80, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x5D, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, 0x90, 0x96, -+0x67, 0x12, 0x04, 0x31, 0x90, 0x96, 0x5F, 0x12, -+0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x96, 0x67, -+0x12, 0x86, 0x61, 0x12, 0x86, 0x47, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, -+0x5F, 0x12, 0x04, 0xB8, 0x90, 0x96, 0x63, 0x12, -+0x86, 0x61, 0x12, 0x86, 0x47, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x54, -+0x90, 0x96, 0x6B, 0x12, 0x04, 0x31, 0x90, 0x96, -+0x6B, 0x12, 0xB7, 0x66, 0x90, 0x96, 0x5D, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x95, 0xF1, -+0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, -+0x90, 0x95, 0xF0, 0xEF, 0xF0, 0x7F, 0x83, 0x12, -+0x7B, 0x41, 0xAE, 0x07, 0x90, 0x95, 0xF0, 0xE0, -+0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x95, -+0xF2, 0xE0, 0x94, 0x64, 0x90, 0x95, 0xF1, 0xE0, -+0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, -+0x44, 0x40, 0xF0, 0x90, 0x95, 0xF0, 0xE0, 0xFF, -+0x22, 0x90, 0x95, 0xF1, 0x12, 0xAB, 0x1C, 0x80, -+0xC2, 0x90, 0x01, 0xC4, 0x74, 0xC1, 0xF0, 0x74, -+0xD4, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, 0x41, -+0xEF, 0x20, 0xE0, 0xF7, 0x74, 0xC1, 0x04, 0x90, -+0x01, 0xC4, 0xF0, 0x74, 0xD4, 0xA3, 0xF0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, -+0xAF, 0x29, 0xE0, 0x90, 0x96, 0xCE, 0xF0, 0xED, -+0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, -+0xF0, 0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, -+0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, -+0x67, 0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, -+0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, -+0x90, 0x88, 0xBD, 0xE0, 0xFF, 0x12, 0x71, 0x9A, -+0x90, 0x88, 0x36, 0xE0, 0x70, 0x0C, 0x12, 0x88, -+0xDC, 0x90, 0x8A, 0xF9, 0x12, 0x8C, 0xE5, 0x12, -+0x8F, 0xE8, 0x22, 0x90, 0x88, 0x9D, 0xE0, 0x30, -+0xE0, 0x5E, 0x90, 0x94, 0xA1, 0xE0, 0x30, 0xE0, -+0x3D, 0x90, 0x94, 0xAC, 0xE0, 0xFF, 0x90, 0x94, -+0xAB, 0xE0, 0xC3, 0x9F, 0x40, 0x24, 0xB1, 0xAB, -+0x90, 0x06, 0xC4, 0xB1, 0xA9, 0x78, 0x08, 0x12, -+0x03, 0xEB, 0x90, 0x06, 0xC5, 0xB1, 0xA9, 0x78, -+0x10, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC6, 0xB1, -+0xA9, 0xB1, 0xB1, 0xE4, 0x90, 0x94, 0xAB, 0xF0, -+0x80, 0x1B, 0xB1, 0xBC, 0xB1, 0xB1, 0x90, 0x94, -+0xAB, 0xE0, 0x04, 0xF0, 0x80, 0x0F, 0x90, 0x94, -+0xAA, 0xE0, 0x60, 0x09, 0xB1, 0xBC, 0xB1, 0xB1, -+0xE4, 0x90, 0x94, 0xAA, 0xF0, 0x90, 0x8A, 0xBB, -+0x12, 0x8C, 0xE5, 0xE4, 0xFF, 0x12, 0x04, 0x7E, -+0x22, 0xEF, 0xF0, 0x90, 0x94, 0xA2, 0x02, 0x04, -+0xB8, 0x78, 0x18, 0x12, 0x03, 0xEB, 0x90, 0x06, -+0xC7, 0xEF, 0xF0, 0x22, 0x90, 0x94, 0xA6, 0x12, -+0x04, 0xB8, 0x90, 0x06, 0xC4, 0xEF, 0xF0, 0x90, -+0x94, 0xA6, 0x12, 0x04, 0xB8, 0x78, 0x08, 0x12, -+0x03, 0xEB, 0x90, 0x06, 0xC5, 0xEF, 0xF0, 0x90, -+0x94, 0xA6, 0x12, 0x04, 0xB8, 0x78, 0x10, 0x12, -+0x03, 0xEB, 0x90, 0x06, 0xC6, 0xEF, 0xF0, 0x90, -+0x94, 0xA6, 0x02, 0x04, 0xB8, 0x7E, 0x00, 0x7F, -+0x33, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, -+0x9D, 0x12, 0x04, 0x80, 0x90, 0x88, 0x9E, 0x74, -+0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0x7E, 0x00, -+0x7F, 0x0C, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x94, -+0x79, 0xA1, 0x12, 0x04, 0x80, 0x90, 0x86, 0xB3, -+0xE0, 0xFC, 0x64, 0x02, 0x70, 0x15, 0xD1, 0xFF, -+0x30, 0xE2, 0x02, 0x7E, 0x01, 0xEE, 0x12, 0xA7, -+0x97, 0xFE, 0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, -+0x4E, 0xF0, 0x22, 0xEC, 0x64, 0x01, 0x70, 0x09, -+0xD1, 0xF6, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, -+0x0F, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x70, -+0x14, 0xD1, 0x60, 0x30, 0xE2, 0x02, 0x7F, 0x01, -+0xEF, 0x12, 0xA7, 0x97, 0xFF, 0x90, 0x88, 0xA0, -+0xE0, 0x54, 0xBF, 0x4F, 0xF0, 0x22, 0xEF, 0xF0, -+0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, 0x22, 0x90, -+0x93, 0x29, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, -+0xF0, 0x54, 0xEF, 0xF0, 0x44, 0x08, 0xF0, 0x90, -+0x86, 0xB3, 0xE0, 0xFF, 0x64, 0x02, 0x70, 0x29, -+0xD1, 0xFF, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, -+0x93, 0x2F, 0xD1, 0xFD, 0x30, 0xE1, 0x02, 0x7E, -+0x01, 0x90, 0x93, 0x2D, 0xD1, 0xFD, 0x30, 0xE2, -+0x02, 0x7E, 0x01, 0x90, 0x93, 0x2E, 0xEE, 0xF0, -+0x90, 0xFD, 0x80, 0xE0, 0x90, 0x02, 0xFB, 0xF0, -+0x22, 0xEF, 0x64, 0x01, 0x70, 0x1D, 0xD1, 0xF6, -+0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2F, -+0xD1, 0xF4, 0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, -+0x93, 0x2D, 0xD1, 0xF4, 0x30, 0xE2, 0x02, 0x7F, -+0x01, 0x80, 0x23, 0x90, 0x86, 0xB3, 0xE0, 0x64, -+0x03, 0x70, 0x20, 0xD1, 0x60, 0x30, 0xE0, 0x02, -+0x7F, 0x01, 0x90, 0x93, 0x2F, 0xD1, 0x5E, 0x30, -+0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2D, 0xD1, -+0x5E, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x90, 0x93, -+0x2E, 0xEF, 0xF0, 0x22, 0xEF, 0xF0, 0x90, 0xFD, -+0x70, 0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, -+0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x22, 0x90, 0x96, -+0xCF, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, -+0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, -+0xFF, 0x7F, 0xFF, 0x80, 0x23, 0xF1, 0x56, 0x12, -+0x9F, 0xAA, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, -+0xF9, 0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0xF1, -+0x4D, 0xFE, 0x74, 0xC8, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0x07, 0xF5, 0x83, 0x12, 0x91, 0xFD, 0xFE, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF5, 0x82, 0xE4, -+0x34, 0x07, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x07, -+0xC0, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, -+0xAC, 0x06, 0xEF, 0xF1, 0x89, 0x12, 0x9F, 0xAA, -+0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, -+0x54, 0x03, 0x24, 0xC8, 0xF1, 0x4D, 0xFF, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0x54, 0xFC, 0x90, 0x07, 0xC0, 0xF0, 0xEE, -+0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x96, 0xC6, 0xF1, 0x84, 0x7A, -+0x00, 0x90, 0x96, 0xC7, 0xE0, 0x54, 0x03, 0xFB, -+0x70, 0x0A, 0x90, 0x07, 0xC4, 0xF1, 0xD4, 0x74, -+0x03, 0xF0, 0x80, 0x0E, 0xEB, 0x64, 0x02, 0x4A, -+0x70, 0x15, 0x90, 0x07, 0xC6, 0xF1, 0xD4, 0x74, -+0x0C, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, -+0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xED, 0xF0, 0xEC, 0xA3, -+0xF0, 0x90, 0x07, 0xC2, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, -+0xF1, 0x8B, 0xE4, 0xFB, 0x90, 0x96, 0x95, 0x12, -+0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, -+0xF8, 0x12, 0x03, 0xEB, 0x74, 0xC4, 0x2B, 0xF5, -+0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0xEF, 0xF0, -+0x0B, 0xEB, 0xB4, 0x04, 0xDF, 0x90, 0x07, 0xC2, -+0x11, 0x1E, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, -+0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x0F, -+0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xC8, -+0x12, 0xD7, 0x84, 0x11, 0x8D, 0x70, 0x0D, 0x90, -+0x07, 0xC4, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, -+0x01, 0xF0, 0x80, 0x37, 0xEF, 0x64, 0x01, 0x4E, -+0x70, 0x0D, 0x90, 0x07, 0xC5, 0xED, 0xF0, 0x90, -+0x07, 0xC2, 0x74, 0x02, 0xF0, 0x80, 0x24, 0x11, -+0x8D, 0x64, 0x02, 0x70, 0x0D, 0x90, 0x07, 0xC6, -+0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x04, 0xF0, -+0x80, 0x11, 0xEF, 0x64, 0x03, 0x4E, 0x70, 0x0B, -+0x90, 0x07, 0xC7, 0xED, 0xF0, 0x90, 0x07, 0xC2, -+0x74, 0x08, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, -+0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7E, 0x00, 0x90, -+0x96, 0xC9, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0xE4, -+0xFD, 0xFF, 0x02, 0x6E, 0x71, 0x7D, 0x07, 0xEF, -+0x5D, 0xC3, 0x60, 0x0A, 0x11, 0xB2, 0x24, 0x08, -+0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x03, 0x11, 0xB2, -+0xFF, 0x22, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, -+0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, 0x22, 0x90, -+0x93, 0x03, 0xE0, 0x54, 0xFE, 0x12, 0xAD, 0x9C, -+0x90, 0x93, 0x0A, 0x12, 0x97, 0x3D, 0x90, 0x93, -+0x25, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, -+0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, 0xF0, 0xA3, -+0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, -+0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x31, 0x33, 0x40, -+0x41, 0x90, 0x88, 0x50, 0xE0, 0x04, 0xF0, 0x90, -+0x88, 0x92, 0xE0, 0xFF, 0x90, 0x88, 0x50, 0xE0, -+0xD3, 0x9F, 0x50, 0x2E, 0x90, 0x88, 0x48, 0xE0, -+0x24, 0x08, 0xF0, 0x90, 0x88, 0x3F, 0x12, 0x9D, -+0x96, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, -+0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, 0xF0, -+0xFB, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, -+0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, 0xF0, 0x12, -+0x6E, 0x2F, 0x22, 0x90, 0x88, 0x93, 0xE0, 0xFF, -+0x90, 0x88, 0x3F, 0xE0, 0xD3, 0x9F, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xAF, -+0x29, 0xE0, 0x90, 0x96, 0xD3, 0xF0, 0x90, 0x88, -+0x32, 0xE0, 0x12, 0xA1, 0xDD, 0x30, 0xE0, 0x02, -+0x41, 0x06, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, -+0x1C, 0x12, 0x8E, 0xAD, 0x33, 0x33, 0x33, 0x54, -+0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, 0x53, -+0xE0, 0x04, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, -+0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, 0x4B, -+0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, -+0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, 0x88, 0x4A, -+0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, -+0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, 0xF0, 0x90, -+0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, -+0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, 0xF0, -+0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, -+0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, 0x88, 0x4B, -+0x51, 0x12, 0x90, 0x88, 0x4E, 0x51, 0x1B, 0x40, -+0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, -+0x51, 0x12, 0x90, 0x88, 0x3E, 0x51, 0x1B, 0x40, -+0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, -+0x12, 0x9D, 0x24, 0xFF, 0x7E, 0x00, 0x90, 0x88, -+0x42, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, -+0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, -+0xFF, 0x90, 0x05, 0xB1, 0xE0, 0x54, 0xF8, 0x4F, -+0xF0, 0x12, 0x9F, 0xDE, 0x80, 0x07, 0x90, 0x88, -+0x33, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, -+0x33, 0xFC, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, -+0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, -+0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x28, 0x90, 0x96, -+0x3A, 0x74, 0x1E, 0xF0, 0x90, 0x96, 0x5C, 0x74, -+0x01, 0xF0, 0x90, 0x96, 0x3C, 0xEF, 0xF0, 0x7B, -+0x01, 0x7A, 0x96, 0x79, 0x3A, 0x12, 0x9F, 0x7B, -+0x12, 0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, 0x8C, -+0xE5, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0x93, 0x29, 0xE0, 0x30, -+0xE0, 0x34, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, -+0x2D, 0x90, 0x96, 0xD4, 0xE0, 0x04, 0xF0, 0xE0, -+0xD3, 0x94, 0xC8, 0x40, 0x21, 0x90, 0x93, 0x29, -+0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0x96, 0xD4, -+0xF0, 0x90, 0x93, 0x29, 0xE0, 0x13, 0x30, 0xE0, -+0x0D, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x01, 0xF0, -+0x90, 0x88, 0x41, 0x74, 0xD0, 0xF0, 0x22, 0x74, -+0x76, 0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8E, -+0xF5, 0x83, 0xE4, 0xF0, 0x74, 0xF6, 0x25, 0x65, -+0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, -+0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x89, 0xF0, -+0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, -+0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x8B, 0xF0, -+0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, -+0x90, 0x88, 0x32, 0xE0, 0x44, 0x80, 0x22, 0x74, -+0xA6, 0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -+0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x24, 0x35, 0xF5, -+0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, -+0x01, 0xB2, 0xF0, 0x74, 0x3A, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, -+0xB3, 0xF0, 0xE0, 0x22, 0xE0, 0xFF, 0x24, 0x3F, -+0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, -+0x90, 0x01, 0xB0, 0xF0, 0x74, 0x44, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, -+0x01, 0xB1, 0xF0, 0x22, 0xE0, 0x54, 0xFE, 0x4E, -+0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, -+0xFD, 0x4F, 0x22, 0xE5, 0x67, 0x25, 0xE0, 0x24, -+0x75, 0xF5, 0x82, 0xE4, 0x22, 0xE0, 0x90, 0x01, -+0xBA, 0xF0, 0x90, 0x88, 0x38, 0xE0, 0x90, 0x01, -+0xBB, 0x22, 0x74, 0xA6, 0x25, 0x65, 0xF5, 0x82, -+0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x74, 0x5F, -+0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, -+0x83, 0x22, 0x74, 0xE6, 0x25, 0x65, 0xF5, 0x82, -+0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xB6, -+0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, -+0x83, 0x22, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, -+0xEF, 0x4D, 0xFF, 0x22, 0x54, 0x04, 0xFD, 0xEF, -+0x54, 0xFB, 0x4D, 0xFF, 0x22, 0x7F, 0xFF, 0x12, -+0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x22, 0xE4, 0x90, -+0x92, 0x20, 0xF0, 0x90, 0x93, 0x2B, 0x22, 0xF0, -+0xEE, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x22, -+0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, -+0x22, 0xE5, 0x67, 0x90, 0x81, 0x9D, 0x93, 0xFF, -+0x22, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, -+0x22, 0x00, 0x35, 0x55 -+}; -+ -+u4Byte array_length_mp_8723d_fw_ap = 23532; -+ -+#endif /*defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))*/ -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+ -+u1Byte array_mp_8723d_fw_nic[] = { -+0xD1, 0x23, 0x10, 0x00, 0x1D, 0x00, 0x02, 0x00, -+0x04, 0x14, 0x11, 0x13, 0x62, 0x67, 0x02, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x02, 0x86, 0x71, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xD3, 0x69, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xDB, 0x56, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xDA, 0x8D, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xBC, 0x9A, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xDB, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, -+0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, -+0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, -+0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, -+0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, -+0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, -+0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, -+0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, -+0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, -+0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, -+0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, -+0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, -+0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, -+0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, -+0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, -+0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, -+0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, -+0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, -+0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, -+0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, -+0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, -+0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, -+0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, -+0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, -+0x30, 0x02, 0x02, 0x03, 0x04, 0x04, 0x08, 0x09, -+0x09, 0x0C, 0x0E, 0x10, 0x12, 0x02, 0x09, 0x0B, -+0x0E, 0x0D, 0x0F, 0x10, 0x12, 0x00, 0x04, 0x00, -+0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x23, 0x00, -+0x2D, 0x00, 0x50, 0x00, 0x91, 0x00, 0xC3, 0x01, -+0x27, 0x01, 0x31, 0x01, 0x5E, 0x00, 0x8C, 0x00, -+0xC8, 0x00, 0xDC, 0x01, 0x5E, 0x01, 0x68, 0x01, -+0x9A, 0x01, 0xCC, 0x01, 0xEA, 0x02, 0x02, 0x04, -+0x08, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, -+0x6C, 0x14, 0x28, 0x32, 0x50, 0x78, 0xA0, 0xC8, -+0xE6, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x02, -+0x02, 0x03, 0x03, 0x04, 0x04, 0x02, 0x04, 0x06, -+0x07, 0x07, 0x08, 0x08, 0x08, 0x01, 0x01, 0x01, -+0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, -+0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, -+0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, -+0x02, 0x03, 0x03, 0x04, 0x05, 0x01, 0x02, 0x03, -+0x04, 0x05, 0x06, 0x07, 0x08, 0x03, 0x03, 0x03, -+0x02, 0x03, 0x03, 0x03, 0x03, 0x03, 0x02, 0x02, -+0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, -+0x02, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, -+0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, -+0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x8B, 0xF8, 0xE6, 0xBC, 0x02, 0x02, -+0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, -+0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, -+0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, -+0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, -+0x20, 0x05, 0x0C, 0x74, 0x8A, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, -+0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x8B, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, -+0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, -+0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x8A, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, -+0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, -+0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, -+0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x8A, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, -+0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, -+0x76, 0x30, 0x90, 0x86, 0xF4, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, -+0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, -+0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, -+0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, -+0x8A, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, -+0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, -+0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x8A, 0x2E, -+0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, -+0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, -+0x24, 0x8A, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x86, 0xF4, 0x93, 0xF6, 0x08, 0xEF, -+0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, -+0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, -+0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x8A, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, -+0x2E, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, -+0x8A, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, -+0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, -+0x8B, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x8A, 0x2F, 0xF8, 0xA6, 0x01, 0x08, -+0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, -+0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, -+0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, -+0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, -+0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, -+0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, -+0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, -+0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, -+0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x83, 0x4D, 0x7F, -+0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, -+0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, -+0x22, 0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, -+0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, -+0x9B, 0xFF, 0xEE, 0x9A, 0xFE, 0xED, 0x99, 0xFD, -+0xEC, 0x98, 0xFC, 0x22, 0xE8, 0x8F, 0xF0, 0xA4, -+0xCC, 0x8B, 0xF0, 0xA4, 0x2C, 0xFC, 0xE9, 0x8E, -+0xF0, 0xA4, 0x2C, 0xFC, 0x8A, 0xF0, 0xED, 0xA4, -+0x2C, 0xFC, 0xEA, 0x8E, 0xF0, 0xA4, 0xCD, 0xA8, -+0xF0, 0x8B, 0xF0, 0xA4, 0x2D, 0xCC, 0x38, 0x25, -+0xF0, 0xFD, 0xE9, 0x8F, 0xF0, 0xA4, 0x2C, 0xCD, -+0x35, 0xF0, 0xFC, 0xEB, 0x8E, 0xF0, 0xA4, 0xFE, -+0xA9, 0xF0, 0xEB, 0x8F, 0xF0, 0xA4, 0xCF, 0xC5, -+0xF0, 0x2E, 0xCD, 0x39, 0xFE, 0xE4, 0x3C, 0xFC, -+0xEA, 0xA4, 0x2D, 0xCE, 0x35, 0xF0, 0xFD, 0xE4, -+0x3C, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, -+0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, -+0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, -+0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xF8, 0xA3, -+0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, -+0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, -+0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, -+0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, -+0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, -+0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, -+0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, -+0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, -+0xDF, 0x02, 0x86, 0xAF, 0x02, 0x83, 0xDD, 0xE4, -+0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, -+0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, -+0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, -+0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, -+0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, -+0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, -+0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, -+0x86, 0xFA, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, -+0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, -+0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, -+0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, -+0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, -+0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, -+0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, -+0xDE, 0xE7, 0x80, 0xBE, 0xC4, 0x79, 0xD8, 0x56, -+0xD2, 0xFF, 0x41, 0x97, 0x16, 0x00, 0x00, 0x90, -+0x97, 0x12, 0xEF, 0xF0, 0x7F, 0x02, 0xB1, 0x27, -+0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x97, 0x12, -+0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, -+0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x02, -+0x06, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x86, -+0xB4, 0xF0, 0xF1, 0xAE, 0xFF, 0xED, 0x2F, 0x90, -+0x86, 0xB5, 0xF0, 0xF1, 0xB9, 0xFF, 0xED, 0x2F, -+0x90, 0x86, 0xB6, 0xF1, 0xA2, 0xFF, 0xED, 0x2F, -+0x90, 0x86, 0xB7, 0xF1, 0x72, 0xFF, 0xED, 0x2F, -+0x90, 0x86, 0xB8, 0xF1, 0x61, 0xFF, 0xED, 0x2F, -+0x90, 0x86, 0xB9, 0xF1, 0x68, 0xFF, 0xAE, 0x05, -+0xED, 0x2F, 0x90, 0x86, 0xBA, 0xF0, 0x22, 0x4E, -+0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, 0x02, 0x1F, -+0xF0, 0x90, 0x00, 0x06, 0x02, 0x02, 0x1F, 0xF5, -+0x83, 0xEF, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, -+0x1F, 0x12, 0xB7, 0xDD, 0x12, 0x02, 0x06, 0x90, -+0x93, 0x60, 0xF0, 0xF1, 0xAE, 0x90, 0x93, 0x61, -+0xF0, 0xF1, 0xB9, 0x90, 0x93, 0x7B, 0xF1, 0xA2, -+0x90, 0x93, 0x7C, 0xF1, 0x72, 0x90, 0x93, 0x96, -+0xF1, 0x61, 0x90, 0x93, 0x97, 0xF0, 0x22, 0xF5, -+0x83, 0xEF, 0xF0, 0x90, 0x00, 0x03, 0x02, 0x02, -+0x1F, 0x90, 0x95, 0x53, 0xD1, 0x39, 0x90, 0x00, -+0x01, 0x02, 0x02, 0x1F, 0x90, 0x95, 0x53, 0xD1, -+0x39, 0x90, 0x00, 0x02, 0x02, 0x02, 0x1F, 0x12, -+0xB9, 0x1A, 0x90, 0x93, 0x3B, 0x12, 0xC8, 0xC5, -+0x4F, 0xF0, 0xF1, 0xAE, 0x90, 0x93, 0x3C, 0xF0, -+0xF1, 0xB9, 0x90, 0x93, 0x3D, 0xF0, 0x12, 0xBF, -+0x89, 0x90, 0x93, 0x3B, 0xE0, 0x54, 0x01, 0xFF, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, -+0x64, 0x01, 0x70, 0x1D, 0x12, 0xE7, 0x18, 0x60, -+0x0B, 0x12, 0x88, 0x2A, 0x12, 0x7C, 0x05, 0x12, -+0xBF, 0x77, 0x80, 0x08, 0x12, 0x88, 0x2A, 0x12, -+0x7C, 0x3B, 0xF1, 0xFC, 0x12, 0x79, 0xD4, 0x80, -+0x18, 0x12, 0xE7, 0x18, 0x60, 0x07, 0x11, 0x2A, -+0x12, 0x7C, 0x05, 0x80, 0x05, 0x11, 0x2A, 0x12, -+0x7C, 0x3B, 0xF1, 0xC2, 0xF1, 0xC9, 0x12, 0x7B, -+0xCC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, -+0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, -+0x22, 0x12, 0xB6, 0xC9, 0x60, 0x02, 0x21, 0x74, -+0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0x21, 0x74, -+0x90, 0x88, 0x2C, 0xE0, 0x20, 0xE0, 0x39, 0x90, -+0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x32, 0x90, 0x06, -+0xA9, 0xE0, 0x54, 0xC0, 0x70, 0x2A, 0x90, 0x88, -+0x9C, 0xE0, 0x70, 0x24, 0x90, 0x04, 0x1A, 0xE0, -+0xF4, 0x70, 0x1D, 0xE0, 0x54, 0x07, 0x64, 0x07, -+0x70, 0x16, 0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, -+0x70, 0x0E, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, -+0x07, 0xF1, 0xEE, 0x54, 0xFE, 0x12, 0xCD, 0x98, -+0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, -+0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, -+0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, -+0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, -+0x90, 0x07, 0xF1, 0xE0, 0x90, 0x95, 0x35, 0xF0, -+0x90, 0x07, 0xF0, 0xE0, 0x90, 0x95, 0x36, 0xF0, -+0x12, 0xBF, 0x93, 0xF0, 0x90, 0x88, 0x3A, 0xE0, -+0x54, 0xEC, 0xF0, 0x31, 0x90, 0x24, 0xFD, 0x50, -+0x02, 0x80, 0x0F, 0x90, 0x88, 0x2C, 0xE0, 0x30, -+0xE0, 0x05, 0x12, 0xD5, 0x0A, 0x80, 0x03, 0x12, -+0xD4, 0xAD, 0x31, 0x90, 0x64, 0x01, 0x70, 0x30, -+0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, 0x3D, 0xF0, -+0x90, 0x06, 0xA9, 0xE0, 0x30, 0xE5, 0x05, 0xA3, -+0xE0, 0xFF, 0x80, 0x05, 0x90, 0x88, 0x3C, 0xE0, -+0xFF, 0x90, 0x88, 0x3C, 0xEF, 0xF0, 0xA3, 0xE0, -+0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xFE, -+0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, -+0x31, 0x99, 0xE4, 0x90, 0x88, 0x3F, 0xF0, 0xA3, -+0xF0, 0x12, 0xB3, 0xBB, 0x30, 0xE0, 0x5B, 0xEF, -+0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x24, -+0x31, 0x88, 0x6F, 0x70, 0x4D, 0xEF, 0x60, 0x4A, -+0x90, 0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0x12, -+0xE7, 0x20, 0x11, 0x26, 0x12, 0x7C, 0x05, 0x12, -+0x90, 0x03, 0xF1, 0xF5, 0x90, 0x88, 0x3D, 0xE0, -+0x14, 0xF0, 0x80, 0x2E, 0x90, 0x88, 0x34, 0xE0, -+0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x23, 0x31, -+0x88, 0xFE, 0x6F, 0x60, 0x1D, 0x90, 0x05, 0x73, -+0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x14, 0x90, 0x88, -+0x32, 0xF1, 0xDC, 0x30, 0xE0, 0x0C, 0xEF, 0x54, -+0xBF, 0x11, 0x26, 0x12, 0x7C, 0x3B, 0xF1, 0xC9, -+0xF1, 0xC2, 0x31, 0x80, 0x90, 0x88, 0x2C, 0xE0, -+0xC3, 0x13, 0x20, 0xE0, 0x02, 0x31, 0x80, 0x22, -+0x90, 0x88, 0x32, 0xE0, 0x44, 0x04, 0xF0, 0x22, -+0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, -+0x90, 0x88, 0x34, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, -+0x22, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x95, 0x36, 0xE0, 0x24, -+0x46, 0xFF, 0x90, 0x95, 0x35, 0xE0, 0x34, 0x00, -+0xAB, 0x07, 0xFA, 0xE4, 0xF9, 0xF8, 0xD0, 0x07, -+0xD0, 0x06, 0x12, 0x85, 0xB6, 0x90, 0x88, 0x85, -+0xF1, 0xD0, 0xEF, 0x24, 0x46, 0xF1, 0xE3, 0x90, -+0x88, 0x89, 0xF1, 0xD0, 0x90, 0x88, 0x85, 0x12, -+0xE2, 0x50, 0x50, 0x02, 0x41, 0x89, 0x90, 0x88, -+0x89, 0x12, 0x86, 0x2D, 0x90, 0x88, 0x85, 0x12, -+0x04, 0xB8, 0x12, 0x85, 0xB6, 0xF1, 0x9E, 0x90, -+0x88, 0x31, 0xE0, 0x30, 0xE0, 0x31, 0x12, 0x97, -+0x4A, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x03, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, -+0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, 0x4E, -+0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, -+0x00, 0xFA, 0x71, 0x9D, 0x78, 0x07, 0x12, 0x03, -+0xEB, 0xEB, 0x2F, 0xFF, 0xEA, 0x80, 0x22, 0x90, -+0x88, 0x33, 0xF1, 0xDC, 0x30, 0xE0, 0x02, 0x61, -+0x8B, 0x71, 0x9D, 0x78, 0x07, 0x12, 0x03, 0xEB, -+0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, -+0x9D, 0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, -+0xED, 0x3E, 0x90, 0x95, 0xEB, 0xF0, 0xA3, 0xEF, -+0xF0, 0xC3, 0x90, 0x95, 0xEC, 0xE0, 0x94, 0xA0, -+0x90, 0x95, 0xEB, 0xE0, 0x94, 0x00, 0x50, 0x31, -+0xA3, 0xE0, 0xFB, 0x24, 0xF5, 0xF1, 0xB0, 0xE0, -+0x04, 0x71, 0x9C, 0xEF, 0x54, 0x7F, 0xFF, 0x74, -+0x95, 0x2B, 0x71, 0x93, 0xE0, 0xFE, 0xEF, 0xC3, -+0x9E, 0x50, 0x09, 0x90, 0x95, 0xEB, 0xA3, 0xE0, -+0x71, 0x91, 0xEF, 0xF0, 0x90, 0x88, 0x4C, 0xE0, -+0x04, 0xF0, 0xE0, 0xFD, 0x7F, 0xFE, 0x12, 0x7B, -+0x2E, 0x90, 0x88, 0x4C, 0xE0, 0xFF, 0xD3, 0x90, -+0x88, 0x90, 0xE0, 0x9F, 0x90, 0x88, 0x8F, 0xE0, -+0x94, 0x00, 0x40, 0x02, 0x61, 0x8B, 0xE4, 0xFF, -+0xFE, 0xF1, 0xAD, 0xE0, 0x2F, 0xFF, 0x90, 0x88, -+0x91, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, 0x40, 0x07, -+0x90, 0x95, 0xED, 0xEE, 0xF0, 0x80, 0x05, 0x0E, -+0xEE, 0xB4, 0xA0, 0xE5, 0x12, 0xE6, 0x79, 0x9C, -+0x40, 0x02, 0x80, 0x17, 0x90, 0x95, 0xED, 0xE0, -+0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, 0x50, 0x15, -+0xF1, 0xAD, 0xE0, 0x2F, 0xFF, 0x12, 0xE6, 0x79, -+0x9C, 0x40, 0x07, 0x90, 0x95, 0xEE, 0xEE, 0xF0, -+0x80, 0x03, 0x0E, 0x80, 0xE5, 0x90, 0x05, 0x5E, -+0xE0, 0xFF, 0x71, 0x8C, 0xE0, 0xFD, 0xEF, 0xC3, -+0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, -+0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x95, -+0xEE, 0xE0, 0x80, 0x18, 0x71, 0x8C, 0xE0, 0xFD, -+0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, -+0xF0, 0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, -+0x95, 0xEE, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, -+0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, -+0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, -+0xF0, 0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, -+0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, -+0x50, 0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, -+0x51, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, -+0x88, 0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, -+0x88, 0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, -+0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, -+0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, -+0x90, 0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0x12, -+0xBC, 0x89, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, -+0x90, 0x8A, 0xA3, 0x12, 0x96, 0x47, 0xE4, 0xFF, -+0x12, 0x04, 0x7E, 0x22, 0x90, 0x95, 0xED, 0xE0, -+0xFE, 0x24, 0x95, 0xF5, 0x82, 0xE4, 0x34, 0x94, -+0xF5, 0x83, 0x22, 0xEF, 0xF0, 0x90, 0x95, 0xEF, -+0x02, 0x04, 0xB8, 0x90, 0x93, 0x58, 0xE0, 0x20, -+0xE0, 0x02, 0xA1, 0xD0, 0xC3, 0x13, 0x54, 0x07, -+0x60, 0x02, 0xA1, 0xD0, 0x90, 0x93, 0xD9, 0xE0, -+0x30, 0xE0, 0x5C, 0x12, 0xDF, 0xB2, 0x40, 0x57, -+0x90, 0x93, 0xE0, 0xE0, 0x30, 0xE0, 0x23, 0x54, -+0xFE, 0xF0, 0x90, 0x93, 0xE2, 0xE0, 0x90, 0x93, -+0xD6, 0xF0, 0x90, 0x93, 0xE5, 0xE0, 0x90, 0x93, -+0xD7, 0xF0, 0x90, 0x93, 0xE3, 0xE0, 0x90, 0x93, -+0x5D, 0xF0, 0x90, 0x93, 0xE4, 0xE0, 0x90, 0x93, -+0x78, 0xF0, 0x90, 0x05, 0x58, 0xE0, 0x90, 0x95, -+0xF7, 0x12, 0xA7, 0xC9, 0x54, 0x07, 0xFF, 0x64, -+0x02, 0x60, 0x03, 0xEF, 0x70, 0x08, 0x12, 0xE6, -+0x9E, 0x24, 0xFD, 0x12, 0xB4, 0xB0, 0x12, 0xE6, -+0x9E, 0x90, 0x92, 0x21, 0x12, 0xDF, 0xA9, 0x12, -+0x66, 0x33, 0xE4, 0x90, 0x93, 0xDA, 0xF0, 0x90, -+0x93, 0xD5, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0xD0, -+0x90, 0x93, 0xD9, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, -+0x54, 0x1F, 0x70, 0x02, 0xA1, 0xD0, 0xEF, 0x54, -+0xC1, 0xFF, 0xEE, 0x14, 0x54, 0x1F, 0xFE, 0x25, -+0xE0, 0x4F, 0xF0, 0xE0, 0xC3, 0x13, 0x54, 0x1F, -+0x60, 0x02, 0xA1, 0xD0, 0x90, 0x93, 0xE1, 0xE0, -+0x30, 0xE0, 0x17, 0x54, 0xFE, 0xF0, 0x90, 0x93, -+0xE0, 0xE0, 0x44, 0x01, 0xF0, 0xA3, 0xE0, 0x54, -+0xFE, 0xFF, 0x90, 0x93, 0xD5, 0xE0, 0x54, 0x01, -+0x4F, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x44, 0x40, -+0xFD, 0x7B, 0x58, 0x7F, 0x40, 0x12, 0x97, 0x56, -+0x90, 0x05, 0x50, 0xE0, 0x54, 0xF7, 0xF0, 0x90, -+0x05, 0x69, 0xB1, 0xD4, 0x12, 0xC7, 0xA2, 0x90, -+0x05, 0x68, 0xB1, 0xD4, 0x12, 0x86, 0x20, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x05, 0x6A, 0xB1, 0xD4, 0x78, 0x10, 0x12, 0x03, -+0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0xA3, 0xB1, 0xD4, 0x78, -+0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0x90, -+0x95, 0xEB, 0x12, 0x04, 0x31, 0xF1, 0x92, 0x90, -+0x95, 0xF3, 0x12, 0x04, 0x31, 0x90, 0x05, 0x6D, -+0xB1, 0xD4, 0x12, 0xC7, 0xA2, 0x90, 0x05, 0x6C, -+0xB1, 0xD4, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x6E, -+0xB1, 0xD4, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -+0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0xA3, 0xB1, 0xD4, 0x78, 0x18, 0x12, -+0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0x86, 0x20, 0xF1, 0x9E, 0x90, -+0x95, 0xEB, 0x12, 0x86, 0x2D, 0xC0, 0x00, 0xC0, -+0x01, 0xC0, 0x02, 0xC0, 0x03, 0x90, 0x93, 0xD5, -+0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xFF, 0xE4, 0xFC, -+0xFD, 0xFE, 0xFB, 0x7A, 0x04, 0xF9, 0xF8, 0x12, -+0x85, 0xC4, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0x85, 0xA9, 0x90, 0x95, 0xEB, -+0x12, 0x04, 0x31, 0x90, 0x95, 0xF3, 0x12, 0x04, -+0xB8, 0x90, 0x95, 0xEB, 0x12, 0xE2, 0x50, 0x50, -+0x09, 0x71, 0x9D, 0xEF, 0x24, 0x01, 0xF1, 0xE3, -+0xF1, 0x9E, 0x71, 0x9D, 0x78, 0x18, 0x12, 0x03, -+0xEB, 0x90, 0x05, 0x67, 0x71, 0x9B, 0x78, 0x10, -+0x12, 0x03, 0xEB, 0x90, 0x05, 0x66, 0x71, 0x9B, -+0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, 0x05, 0x65, -+0x71, 0x9B, 0x90, 0x05, 0x64, 0xF1, 0x90, 0x78, -+0x18, 0x12, 0x03, 0xEB, 0x90, 0x05, 0x63, 0xF1, -+0x90, 0x78, 0x10, 0x12, 0x03, 0xEB, 0x90, 0x05, -+0x62, 0xF1, 0x90, 0x78, 0x08, 0x12, 0x03, 0xEB, -+0x90, 0x05, 0x61, 0xF1, 0x90, 0x90, 0x05, 0x60, -+0xEF, 0xF0, 0x90, 0x05, 0x50, 0xE0, 0x44, 0x08, -+0xF0, 0x90, 0x05, 0x22, 0xE0, 0x54, 0xBF, 0xFD, -+0x7B, 0x59, 0x7F, 0x40, 0x12, 0x97, 0x56, 0x7F, -+0x08, 0x12, 0xA7, 0xF3, 0x90, 0x93, 0xD9, 0xE0, -+0x54, 0xC1, 0x44, 0x28, 0xF0, 0x44, 0x01, 0xF0, -+0x22, 0x90, 0x97, 0x0C, 0xE0, 0xFF, 0xE4, 0xFC, -+0xFD, 0xFE, 0x22, 0xFF, 0xEE, 0x13, 0x13, 0x54, -+0x07, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x97, 0x0C, 0xED, 0xF0, 0xE4, 0xA3, -+0xF0, 0xEF, 0x14, 0x60, 0x02, 0xC1, 0xC0, 0x90, -+0x06, 0x03, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x97, -+0x0C, 0xE0, 0xFB, 0xC4, 0x33, 0x54, 0xE0, 0xFE, -+0x90, 0x04, 0x42, 0xE0, 0x54, 0x9F, 0x4E, 0xFE, -+0xF0, 0xE4, 0xFD, 0x12, 0xDF, 0xE8, 0x90, 0x97, -+0x0D, 0xEF, 0xF0, 0x90, 0x04, 0x83, 0xF0, 0x90, -+0x96, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, -+0x01, 0x90, 0x96, 0xAC, 0x12, 0x04, 0x3D, 0x00, -+0x00, 0x00, 0x01, 0xF1, 0x86, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xAC, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, -+0x7E, 0x09, 0xF1, 0x8A, 0x12, 0x04, 0x3D, 0x00, -+0x00, 0x00, 0x10, 0xB1, 0xD1, 0xEF, 0x54, 0x03, -+0xFF, 0xE4, 0x78, 0x01, 0x12, 0x03, 0xEB, 0x78, -+0x04, 0xF1, 0xA4, 0x7F, 0x00, 0x7E, 0x0A, 0xF1, -+0x8A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, -+0xB1, 0xD1, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, -+0x0A, 0xF1, 0xA4, 0x7F, 0x00, 0x7E, 0x0D, 0xF1, -+0x8A, 0x12, 0x04, 0x3D, 0x0C, 0x00, 0x00, 0x00, -+0x90, 0x97, 0x0D, 0xB1, 0xD4, 0xEF, 0x54, 0x03, -+0xFF, 0xE4, 0x78, 0x1A, 0xF1, 0xA4, 0x7F, 0x18, -+0xF1, 0x88, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, -+0x00, 0x90, 0x96, 0xAC, 0x12, 0x04, 0x3D, 0x00, -+0x00, 0x00, 0x00, 0xF1, 0xB8, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0x9A, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x04, 0x00, 0x80, 0x58, -+0x90, 0x06, 0x03, 0xE0, 0x44, 0x04, 0xF0, 0x90, -+0x96, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, -+0x01, 0x90, 0x96, 0xAC, 0x12, 0x04, 0x3D, 0x00, -+0x00, 0x00, 0x00, 0xF1, 0x86, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xAC, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, -+0x7E, 0x09, 0xF1, 0x8A, 0x12, 0x04, 0x3D, 0x00, -+0x00, 0x0C, 0x00, 0x90, 0x96, 0xAC, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x0C, 0x00, 0xF1, 0xB8, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, -+0x9A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, -+0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0xB9, -+0xE2, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xA6, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, -+0x90, 0x96, 0xB0, 0x12, 0x04, 0x31, 0x90, 0x96, -+0xA8, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, -+0x96, 0xB0, 0xF1, 0x98, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0xA8, 0x12, -+0x04, 0xB8, 0x90, 0x96, 0xAC, 0xF1, 0x98, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -+0x86, 0x20, 0x90, 0x96, 0xB4, 0x12, 0x04, 0x31, -+0x90, 0x96, 0xB4, 0x12, 0xCE, 0x7B, 0x90, 0x96, -+0xA6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, -+0xAD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x00, -+0x7E, 0x08, 0xF1, 0x26, 0x90, 0x96, 0xA8, 0x22, -+0xEF, 0xF0, 0x90, 0x95, 0xEB, 0x02, 0x04, 0xB8, -+0x12, 0x86, 0x2D, 0x02, 0x86, 0x13, 0x90, 0x95, -+0xEF, 0x02, 0x04, 0x31, 0x12, 0x03, 0xFE, 0x90, -+0x96, 0xAC, 0x02, 0x04, 0x31, 0x74, 0xF5, 0x2E, -+0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, -+0x7F, 0x84, 0x7E, 0x08, 0xF1, 0x26, 0x90, 0x96, -+0x96, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, -+0x74, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x74, -+0x12, 0x04, 0x31, 0x90, 0x88, 0x89, 0x02, 0x04, -+0xB8, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0x13, 0x13, -+0x54, 0x3F, 0x22, 0xFF, 0xE4, 0x3E, 0xFE, 0xE4, -+0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, 0x7F, 0x02, -+0x12, 0x7B, 0x41, 0xEF, 0x22, 0x7D, 0x02, 0x7F, -+0x02, 0x02, 0x7C, 0x7E, 0x7D, 0x02, 0x7F, 0x02, -+0x12, 0x7C, 0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, -+0x7C, 0x7E, 0x12, 0xAF, 0x9A, 0x90, 0x93, 0xE7, -+0xE0, 0x70, 0x0F, 0x71, 0xC7, 0x13, 0x13, 0x54, -+0x3F, 0x30, 0xE0, 0x06, 0x90, 0x93, 0xED, 0x74, -+0x01, 0xF0, 0x90, 0x93, 0xE9, 0xE0, 0x70, 0x0F, -+0x71, 0xC7, 0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x05, -+0x06, 0x90, 0x93, 0xEE, 0x74, 0x01, 0xF0, 0x12, -+0x87, 0xA9, 0xFF, 0x90, 0x95, 0x57, 0xF0, 0x12, -+0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, 0x09, 0x12, -+0x87, 0xB4, 0x90, 0x95, 0x58, 0xF0, 0x80, 0x05, -+0x90, 0x95, 0x58, 0xEF, 0xF0, 0x90, 0x95, 0x57, -+0xE0, 0x90, 0x95, 0x56, 0xF0, 0x90, 0x95, 0x58, -+0xE0, 0xFE, 0x90, 0x95, 0x56, 0xE0, 0xFF, 0xD3, -+0x9E, 0x50, 0x36, 0x71, 0xC7, 0x54, 0x01, 0xFD, -+0x12, 0x6E, 0x71, 0x90, 0x95, 0x56, 0xE0, 0xFF, -+0x12, 0x78, 0x4A, 0xEF, 0x90, 0x95, 0x56, 0x70, -+0x06, 0xE0, 0xFF, 0xF1, 0xF1, 0x80, 0x05, 0xE0, -+0xFF, 0x12, 0xCF, 0xF2, 0x90, 0x93, 0xEE, 0xE0, -+0x60, 0x07, 0x90, 0x95, 0x56, 0xE0, 0xFF, 0xF1, -+0xF1, 0x90, 0x95, 0x56, 0xE0, 0x04, 0xF0, 0x80, -+0xBC, 0x90, 0x05, 0x5E, 0xE4, 0xF0, 0x90, 0x95, -+0x57, 0xE0, 0x70, 0x1A, 0xFF, 0x12, 0x78, 0x4A, -+0xEF, 0x70, 0x13, 0x90, 0x86, 0x0C, 0x51, 0x46, -+0x90, 0x8A, 0xED, 0x51, 0x46, 0x12, 0xBF, 0x6F, -+0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x90, -+0x96, 0xE6, 0x12, 0x86, 0x42, 0x90, 0x96, 0xE5, -+0xEF, 0xF0, 0x12, 0x86, 0x4B, 0x91, 0x57, 0x00, -+0x91, 0x5C, 0x01, 0x91, 0x60, 0x06, 0x91, 0x71, -+0x10, 0x91, 0x76, 0x12, 0x91, 0x7B, 0x14, 0x91, -+0x80, 0x16, 0x91, 0x85, 0x18, 0x91, 0x8A, 0x19, -+0x91, 0x8F, 0x1B, 0x91, 0x94, 0x1C, 0x91, 0x99, -+0x1E, 0x91, 0x9E, 0x20, 0x91, 0xA3, 0x24, 0x91, -+0xA8, 0x25, 0x91, 0xAD, 0x27, 0x91, 0xB2, 0x29, -+0x91, 0xB7, 0x2A, 0x91, 0xBC, 0x40, 0x91, 0xC3, -+0x42, 0x92, 0x36, 0x47, 0x91, 0xCE, 0x49, 0x91, -+0xD3, 0x60, 0x91, 0xD7, 0x61, 0x91, 0xDC, 0x62, -+0x91, 0xE1, 0x63, 0x91, 0xE6, 0x64, 0x91, 0xEB, -+0x65, 0x91, 0xF0, 0x66, 0x91, 0xF5, 0x67, 0x91, -+0xFA, 0x68, 0x91, 0xFF, 0x69, 0x92, 0x04, 0x6B, -+0x92, 0x09, 0x6C, 0x92, 0x0E, 0x6D, 0x92, 0x13, -+0x6E, 0x92, 0x18, 0x6F, 0x92, 0x1D, 0x70, 0x92, -+0x22, 0xC3, 0x91, 0x65, 0xC6, 0x91, 0x65, 0xC7, -+0x91, 0x65, 0xC8, 0x00, 0x00, 0x92, 0x27, 0x51, -+0x37, 0x02, 0x87, 0x19, 0x51, 0x37, 0x01, 0x0A, -+0x51, 0x37, 0x02, 0xC5, 0x99, 0x90, 0x96, 0xE5, -+0xE0, 0xFF, 0xA3, 0x12, 0x86, 0x39, 0x02, 0xD6, -+0x7F, 0x51, 0x37, 0x02, 0xA8, 0x79, 0x51, 0x37, -+0x02, 0xC0, 0x2D, 0x51, 0x37, 0x02, 0xC7, 0xD0, -+0x51, 0x37, 0x02, 0x87, 0x79, 0x51, 0x37, 0x02, -+0xAF, 0xF0, 0x51, 0x37, 0x02, 0xB8, 0x0B, 0x51, -+0x37, 0x02, 0xB8, 0xB1, 0x51, 0x37, 0x02, 0xB9, -+0x22, 0x51, 0x37, 0x02, 0xC4, 0x0D, 0x51, 0x37, -+0x02, 0xC7, 0xDF, 0x51, 0x37, 0x02, 0xB0, 0xF8, -+0x51, 0x37, 0x02, 0xC8, 0xD3, 0x51, 0x37, 0x02, -+0x87, 0xBF, 0x51, 0x37, 0x02, 0xCF, 0xC7, 0x51, -+0x37, 0x02, 0xC9, 0x16, 0x51, 0x37, 0x90, 0x8A, -+0xA5, 0x80, 0x05, 0x51, 0x37, 0x90, 0x8A, 0xB5, -+0x12, 0xBF, 0xC4, 0x02, 0x04, 0x7E, 0x51, 0x37, -+0x02, 0xDE, 0x64, 0x51, 0x37, 0x61, 0xD0, 0x51, -+0x37, 0x02, 0x77, 0x4F, 0x51, 0x37, 0x02, 0x7C, -+0x60, 0x51, 0x37, 0x02, 0x7A, 0xC6, 0x51, 0x37, -+0x02, 0x5D, 0x36, 0x51, 0x37, 0x02, 0x7B, 0xE9, -+0x51, 0x37, 0x02, 0x70, 0x33, 0x51, 0x37, 0x02, -+0x48, 0xC9, 0x51, 0x37, 0x02, 0x79, 0xF3, 0x51, -+0x37, 0x02, 0xC6, 0x32, 0x51, 0x37, 0x02, 0x51, -+0x7B, 0x51, 0x37, 0x02, 0x79, 0x30, 0x51, 0x37, -+0x02, 0x57, 0xF2, 0x51, 0x37, 0x02, 0x74, 0x8D, -+0x51, 0x37, 0x02, 0x78, 0x9A, 0x51, 0x37, 0x02, -+0x5E, 0x0B, 0x51, 0x37, 0x02, 0xCF, 0xDC, 0x90, -+0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x96, -+0xE5, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, -+0x96, 0xE6, 0x02, 0x86, 0x39, 0x7D, 0xFF, 0xE4, -+0xFF, 0xF1, 0x56, 0x90, 0x8A, 0xFD, 0xE0, 0xFE, -+0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x97, 0x18, 0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, -+0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, -+0x02, 0x61, 0xC2, 0xEE, 0x12, 0xA3, 0x5C, 0x30, -+0xE0, 0x02, 0x61, 0xC2, 0x90, 0x88, 0x39, 0xE0, -+0xFE, 0x6F, 0x70, 0x02, 0x61, 0xC2, 0xEF, 0x70, -+0x02, 0x61, 0x1E, 0x24, 0xFE, 0x70, 0x02, 0x61, -+0x63, 0x24, 0xFE, 0x60, 0x4F, 0x24, 0xFC, 0x70, -+0x02, 0x61, 0xA8, 0x24, 0xFC, 0x60, 0x02, 0x61, -+0xBB, 0xEE, 0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, -+0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, -+0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, -+0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, -+0xE0, 0xB4, 0x04, 0x11, 0x90, 0x97, 0x18, 0xE0, -+0xFF, 0x60, 0x05, 0x12, 0x67, 0x80, 0x80, 0x05, -+0x90, 0x8A, 0xED, 0x51, 0x46, 0x90, 0x88, 0x39, -+0xE0, 0x64, 0x08, 0x60, 0x02, 0x61, 0xBB, 0x12, -+0x7B, 0xCC, 0x61, 0xBB, 0x90, 0x88, 0x39, 0xE0, -+0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, -+0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, -+0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, -+0x90, 0x86, 0x00, 0x51, 0x46, 0xBF, 0x01, 0x03, -+0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, -+0x0C, 0x60, 0x02, 0x61, 0xBB, 0x90, 0x86, 0x00, -+0x51, 0x46, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x61, -+0xBB, 0x12, 0x68, 0xC2, 0x61, 0xBB, 0x90, 0x88, -+0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, -+0x51, 0x46, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, -+0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, -+0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, -+0x0B, 0x90, 0x86, 0x00, 0x51, 0x46, 0xBF, 0x01, -+0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, -+0x64, 0x04, 0x70, 0x67, 0x90, 0x86, 0x02, 0x51, -+0x46, 0xEF, 0x64, 0x01, 0x70, 0x5D, 0x12, 0x73, -+0x5A, 0x80, 0x58, 0x90, 0x88, 0x39, 0xE0, 0xB4, -+0x0E, 0x0B, 0x90, 0x86, 0x00, 0x51, 0x46, 0xBF, -+0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, -+0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, -+0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, -+0x00, 0x51, 0x46, 0xBF, 0x01, 0x03, 0x12, 0x68, -+0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, -+0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, -+0xB4, 0x04, 0x18, 0x12, 0x7A, 0x49, 0x80, 0x13, -+0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, -+0x88, 0x32, 0x12, 0x8F, 0xDC, 0x30, 0xE0, 0x03, -+0x12, 0x79, 0xD4, 0x90, 0x88, 0x39, 0x12, 0xC8, -+0xB8, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0x95, 0x53, 0x12, 0x86, 0x39, 0x02, 0x02, 0x06, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, -+0xAF, 0x3F, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x88, -+0x9D, 0x12, 0xC8, 0xC5, 0x4F, 0xF0, 0xFC, 0x12, -+0x02, 0x06, 0xFD, 0x54, 0x04, 0x13, 0x13, 0x54, -+0x3F, 0xFF, 0x90, 0x95, 0x37, 0xE0, 0x54, 0xFE, -+0x4F, 0xF0, 0xED, 0x54, 0x08, 0xFF, 0xEC, 0x54, -+0xF7, 0x4F, 0xFF, 0x90, 0x88, 0x9D, 0xF0, 0x12, -+0x02, 0x06, 0x12, 0xC8, 0xAE, 0x90, 0x88, 0x9D, -+0x12, 0xC8, 0xA5, 0x4E, 0xFF, 0xF0, 0x12, 0x02, -+0x06, 0xFE, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, -+0x4D, 0xFF, 0x90, 0x88, 0x9D, 0xF0, 0xEE, 0x54, -+0x80, 0xFE, 0xEF, 0x54, 0x7F, 0x4E, 0xF0, 0x12, -+0xA8, 0x96, 0xE9, 0x24, 0x01, 0xF9, 0xE4, 0x3A, -+0x8B, 0x45, 0x12, 0xE7, 0x57, 0x7B, 0x01, 0x7A, -+0x88, 0x79, 0x9E, 0x12, 0x69, 0xF5, 0x71, 0xC7, -+0x20, 0xE0, 0x02, 0xA1, 0xA9, 0x90, 0x05, 0x54, -+0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, 0x13, -+0x90, 0x88, 0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, -+0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x12, 0x12, 0x87, -+0xAE, 0x90, 0x88, 0x9E, 0x12, 0xE7, 0x4F, 0x12, -+0x87, 0xB9, 0x90, 0x88, 0x9F, 0xF0, 0x80, 0x47, -+0x12, 0x87, 0xAE, 0xFF, 0xC3, 0x94, 0x2A, 0x50, -+0x15, 0xEF, 0xC3, 0x94, 0x03, 0x50, 0x07, 0x90, -+0x88, 0x9E, 0x74, 0x03, 0x80, 0x0D, 0x12, 0x87, -+0xAE, 0x90, 0x88, 0x9E, 0x80, 0x05, 0x90, 0x88, -+0x9E, 0x74, 0x2A, 0x12, 0xE7, 0x4F, 0x12, 0x87, -+0xB9, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, -+0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, -+0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, -+0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, -+0xB4, 0x11, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, -+0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, -+0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, -+0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, -+0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, -+0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, -+0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, -+0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, -+0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0xF0, 0x90, -+0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -+0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, -+0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0xD1, -+0x47, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, 0x7E, -+0x12, 0xE7, 0x47, 0x74, 0x11, 0xF0, 0x90, 0x95, -+0x37, 0xE0, 0x30, 0xE0, 0x33, 0x90, 0x95, 0x40, -+0x74, 0x01, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x06, -+0xC7, 0xE0, 0xFE, 0x90, 0x06, 0xC6, 0x12, 0xAF, -+0xD5, 0xFE, 0xE4, 0xFD, 0x78, 0x10, 0x12, 0xC7, -+0xA4, 0x90, 0x06, 0xC5, 0xE0, 0xFE, 0x90, 0x06, -+0xC4, 0x12, 0xAF, 0xD5, 0xFE, 0xE4, 0xFD, 0x12, -+0x86, 0x20, 0x90, 0x95, 0x3C, 0x12, 0x04, 0x31, -+0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, -+0x88, 0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, 0x90, -+0x88, 0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, -+0xB0, 0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, 0x88, -+0xA5, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, -+0x74, 0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, 0xA5, -+0xE0, 0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, -+0x05, 0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, 0x80, -+0x40, 0x90, 0x8A, 0xF1, 0x51, 0x46, 0x90, 0x89, -+0x04, 0xE0, 0x90, 0x00, 0x40, 0x30, 0xE0, 0x07, -+0xE0, 0x54, 0x0F, 0x44, 0xA0, 0x80, 0x05, 0xE0, -+0x54, 0x0F, 0x44, 0x20, 0xFD, 0x7F, 0x40, 0x12, -+0x7B, 0x2E, 0x12, 0xA8, 0x96, 0x12, 0x87, 0xA3, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, -+0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, -+0x9A, 0xF1, 0x51, 0x12, 0xE7, 0x47, 0x74, 0x43, -+0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, 0xF0, -+0xE4, 0x90, 0x88, 0xAF, 0xF0, 0x90, 0x88, 0xA0, -+0x12, 0xA3, 0x5B, 0x30, 0xE0, 0x09, 0x90, 0x88, -+0xD0, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x11, 0x90, -+0x8A, 0x97, 0xD1, 0x47, 0x7F, 0x01, 0x12, 0x04, -+0x7E, 0x90, 0x88, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, -+0x90, 0x8A, 0xD9, 0xD1, 0x47, 0x7F, 0x03, 0x12, -+0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, -+0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8A, 0x77, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, -+0x83, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x79, 0xE0, -+0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, -+0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, -+0x7A, 0x88, 0x79, 0x31, 0x12, 0x04, 0x80, 0x12, -+0xE6, 0x3A, 0x12, 0x04, 0x80, 0x90, 0x88, 0x35, -+0x74, 0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, 0xF0, -+0xA3, 0xF0, 0xA3, 0x74, 0x50, 0xF1, 0x49, 0xFE, -+0xE4, 0x33, 0x90, 0x88, 0x42, 0xF0, 0xA3, 0xCE, -+0xF1, 0x49, 0xFF, 0x12, 0xE6, 0xBC, 0x12, 0xE5, -+0x92, 0x90, 0x8A, 0x89, 0xD1, 0x47, 0xF1, 0xEB, -+0x90, 0x8A, 0x89, 0xD1, 0x47, 0x7D, 0x0C, 0x7F, -+0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0xD1, -+0x47, 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x04, 0x7E, -+0x90, 0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x01, 0x08, -+0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, 0x18, -+0xEF, 0xB4, 0x03, 0x0F, 0x90, 0x88, 0x41, 0x74, -+0xF4, 0xF0, 0x90, 0x00, 0x92, 0xE0, 0x54, 0x7F, -+0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0x41, 0xF0, -+0x7F, 0x79, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0x03, -+0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, 0x12, 0x7B, -+0x41, 0xEF, 0x30, 0xE2, 0x06, 0x90, 0x88, 0x53, -+0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, 0x02, -+0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, -+0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0xF1, -+0x49, 0x12, 0xE6, 0xBC, 0x7E, 0x00, 0x7F, 0x18, -+0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x3F, -+0x12, 0x04, 0x80, 0x90, 0x8A, 0xA3, 0xD1, 0x47, -+0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x05, 0x58, -+0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, 0x7D, 0x00, -+0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, 0x12, 0x04, -+0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, -+0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x90, -+0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, 0x9C, 0xF0, -+0x22, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, -+0x22, 0xE4, 0xFB, 0xFD, 0x7F, 0xFF, 0xEB, 0xB4, -+0x57, 0x04, 0xF1, 0xB1, 0x80, 0x0F, 0xEF, 0x70, -+0x07, 0x90, 0x93, 0xF3, 0xE0, 0x4D, 0x80, 0x05, -+0x12, 0xC7, 0xBE, 0xF1, 0xB1, 0x90, 0x05, 0x22, -+0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, 0x12, -+0xE4, 0x38, 0x12, 0x7B, 0xDB, 0x90, 0x8A, 0xC5, -+0x51, 0x46, 0x12, 0xC9, 0xE2, 0x12, 0xE4, 0x3E, -+0xD1, 0x50, 0x12, 0xE6, 0x35, 0x12, 0xDE, 0xF1, -+0x90, 0x8A, 0x73, 0x51, 0x46, 0x90, 0x00, 0x6A, -+0xE0, 0x30, 0xE2, 0x14, 0x90, 0x92, 0x20, 0x74, -+0x01, 0xF0, 0xA3, 0x74, 0xF4, 0xF0, 0xE4, 0xFB, -+0xFD, 0x7F, 0x68, 0x7E, 0x01, 0x12, 0x66, 0x33, -+0x22, 0x90, 0x93, 0xF4, 0xE0, 0xFF, 0x90, 0x93, -+0xF3, 0xE0, 0x4F, 0x22, 0x90, 0x8A, 0xF9, 0xD1, -+0x47, 0x7D, 0x20, 0x12, 0xE2, 0x74, 0x51, 0x46, -+0x90, 0x88, 0x2F, 0x74, 0x02, 0xF0, 0x22, 0x90, -+0x86, 0x0C, 0x51, 0x46, 0x90, 0x8A, 0xF9, 0xD1, -+0x47, 0xF1, 0xEB, 0x90, 0x88, 0x2F, 0x74, 0x01, -+0xF0, 0x22, 0x90, 0x8A, 0xF9, 0xD1, 0x47, 0xF1, -+0xEB, 0x80, 0xF0, 0xE4, 0xFD, 0xFF, 0x02, 0x04, -+0x7E, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x97, 0x06, 0xEF, 0xF0, 0xA3, -+0xED, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x96, 0x47, -+0x7D, 0x44, 0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x12, -+0x92, 0x43, 0x90, 0x97, 0x07, 0xE0, 0x90, 0x97, -+0x06, 0xB4, 0x01, 0x09, 0xE0, 0x11, 0x3C, 0xE0, -+0x44, 0x04, 0xF0, 0x80, 0x07, 0xE0, 0x11, 0x3C, -+0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8A, 0xF9, 0x12, -+0x96, 0x47, 0x12, 0x97, 0xEB, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xE5, 0x0E, 0xC4, 0x54, 0xF0, 0x24, -+0x05, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -+0x22, 0x8D, 0x0E, 0xEF, 0x30, 0xE6, 0x1C, 0x11, -+0xD6, 0xE0, 0xFD, 0x11, 0x3A, 0xE0, 0x54, 0x03, -+0x90, 0x92, 0x80, 0xF0, 0xE4, 0xFB, 0xAF, 0x0E, -+0x12, 0x75, 0x80, 0x11, 0xC9, 0xD1, 0x4E, 0x74, -+0x01, 0x80, 0x55, 0x12, 0xE6, 0x91, 0x04, 0xF0, -+0x12, 0xE6, 0x91, 0x64, 0x02, 0x70, 0x1F, 0x74, -+0x5B, 0x25, 0x0E, 0x12, 0xA1, 0x86, 0xE0, 0xFD, -+0xF4, 0x60, 0x02, 0x80, 0x04, 0x11, 0xD6, 0xE0, -+0xFD, 0x11, 0x3A, 0x12, 0xE6, 0xAE, 0x11, 0xD6, -+0xD1, 0x4E, 0x74, 0x02, 0x80, 0x2A, 0x12, 0xE6, -+0x91, 0xD3, 0x94, 0x03, 0x40, 0x13, 0x90, 0x8A, -+0xB3, 0x12, 0x96, 0x47, 0xAF, 0x0E, 0x12, 0x04, -+0x7E, 0x11, 0xC9, 0xD1, 0x4E, 0x74, 0x03, 0x80, -+0x0F, 0x11, 0xD6, 0xE0, 0xFD, 0x11, 0x3A, 0x12, -+0xE6, 0xAE, 0x11, 0xD6, 0xD1, 0x4E, 0x74, 0x02, -+0xF0, 0xAB, 0x0E, 0xE4, 0xFD, 0xFF, 0x02, 0x6F, -+0x75, 0x74, 0xB6, 0x25, 0x0E, 0xF5, 0x82, 0xE4, -+0x34, 0x8E, 0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x0E, -+0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, -+0x34, 0x81, 0xF5, 0x83, 0x22, 0x90, 0x04, 0x85, -+0xE0, 0xF5, 0x70, 0x90, 0x96, 0x5A, 0xE0, 0x04, -+0xF0, 0xE4, 0xF5, 0x67, 0x90, 0x88, 0x2B, 0xE0, -+0xFF, 0xE5, 0x67, 0xC3, 0x9F, 0x40, 0x02, 0xC1, -+0x4D, 0xE5, 0x67, 0x11, 0xD8, 0xE0, 0xF5, 0x72, -+0x12, 0xE6, 0xFA, 0xE0, 0x65, 0x72, 0x60, 0x16, -+0x90, 0x92, 0x5E, 0xE5, 0x72, 0xF0, 0xE4, 0xA3, -+0xF0, 0xAB, 0x67, 0xFD, 0xFF, 0x12, 0x6F, 0x75, -+0x12, 0xE6, 0xFA, 0xE5, 0x72, 0xF0, 0x90, 0x04, -+0xA0, 0xE0, 0x64, 0x01, 0x70, 0x4C, 0xA3, 0xE0, -+0x65, 0x67, 0x70, 0x46, 0xA3, 0xE0, 0xF5, 0x68, -+0xA3, 0xE0, 0x90, 0x95, 0xDB, 0xF0, 0xE5, 0x67, -+0x11, 0xD8, 0xE0, 0x65, 0x68, 0x70, 0x02, 0xC1, -+0x49, 0xE5, 0x67, 0x11, 0xD8, 0xE5, 0x68, 0xF0, -+0xE5, 0x67, 0x11, 0x3C, 0xE0, 0x54, 0xFC, 0xFF, -+0x90, 0x95, 0xDB, 0xE0, 0x54, 0x03, 0x4F, 0xFF, -+0xE5, 0x67, 0x11, 0x3C, 0xEF, 0xF0, 0x90, 0x92, -+0x5E, 0xE5, 0x68, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, -+0xAB, 0x67, 0xE4, 0xFD, 0xFF, 0x12, 0x6F, 0x75, -+0xC1, 0x49, 0x74, 0x43, 0x25, 0x67, 0x12, 0xD2, -+0x59, 0xE0, 0xFB, 0x7A, 0x00, 0x75, 0xF0, 0x12, -+0xE5, 0x67, 0x90, 0x89, 0x55, 0x12, 0x04, 0x6E, -+0xE0, 0xC3, 0x9B, 0xFE, 0xE4, 0x9A, 0x90, 0x95, -+0xD9, 0xF0, 0xA3, 0xCE, 0xF0, 0x75, 0xF0, 0x12, -+0xE5, 0x67, 0x12, 0xD5, 0xB2, 0xE0, 0xFE, 0xA3, -+0xE0, 0xC3, 0x9B, 0xF5, 0x6E, 0xEE, 0x9A, 0xF5, -+0x6D, 0xAF, 0x67, 0x12, 0x78, 0x4A, 0xEF, 0x70, -+0x02, 0xC1, 0x49, 0x75, 0xF0, 0x12, 0xE5, 0x67, -+0xD1, 0xA1, 0x12, 0xA3, 0x5C, 0x30, 0xE0, 0x02, -+0xC1, 0x49, 0xE5, 0x67, 0x13, 0x13, 0x13, 0x54, -+0x1F, 0x12, 0xAF, 0x19, 0xE0, 0xFD, 0x7C, 0x00, -+0xE5, 0x67, 0x12, 0xCA, 0x68, 0x80, 0x05, 0xC3, -+0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, -+0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x60, 0x02, 0xC1, -+0x49, 0xE5, 0x6E, 0x45, 0x6D, 0x70, 0x0C, 0x90, -+0x95, 0xD9, 0xE0, 0x70, 0x02, 0xA3, 0xE0, 0x70, -+0x02, 0xC1, 0x49, 0xE5, 0x67, 0x75, 0xF0, 0x12, -+0xA4, 0x24, 0x57, 0xF9, 0x74, 0x89, 0x35, 0xF0, -+0xFA, 0x7B, 0x01, 0x90, 0x95, 0xD6, 0x12, 0x86, -+0x42, 0x90, 0x00, 0x02, 0x12, 0x03, 0x3E, 0xFF, -+0x12, 0x03, 0x13, 0x2F, 0xFF, 0x12, 0xE7, 0x3F, -+0xFF, 0x12, 0xE7, 0x0F, 0x90, 0x00, 0x08, 0x12, -+0x03, 0x3E, 0x2F, 0xF5, 0x71, 0xE5, 0x67, 0x11, -+0xD8, 0xE0, 0xF5, 0x68, 0x54, 0x80, 0xF5, 0x6A, -+0xE5, 0x68, 0x54, 0x7F, 0xF5, 0x69, 0x90, 0x96, -+0x48, 0xE0, 0x60, 0x15, 0x75, 0x73, 0x0A, 0xF1, -+0xE9, 0x34, 0x81, 0xF5, 0x83, 0xE4, 0x93, 0xC3, -+0x13, 0x74, 0x01, 0x93, 0x13, 0xF5, 0x74, 0x80, -+0x0A, 0x7B, 0xFF, 0x12, 0xCA, 0x5E, 0xE4, 0xF5, -+0x73, 0xF5, 0x74, 0x75, 0xF0, 0x12, 0xE5, 0x67, -+0xF1, 0xF9, 0xFF, 0xE5, 0x69, 0xD3, 0x9F, 0x40, -+0x08, 0x8F, 0x69, 0xE5, 0x69, 0x45, 0x6A, 0xF5, -+0x68, 0xD1, 0x5F, 0xE0, 0xC3, 0x94, 0x05, 0x40, -+0x02, 0x81, 0x32, 0xE5, 0x69, 0x90, 0x81, 0x61, -+0x93, 0xF5, 0x6F, 0xFD, 0xAF, 0x69, 0x12, 0x60, -+0x6F, 0x8F, 0x6F, 0xE5, 0x6A, 0x60, 0x04, 0x05, -+0x6F, 0x05, 0x6F, 0xE5, 0x69, 0xC3, 0x94, 0x0C, -+0x40, 0x1D, 0x74, 0x4A, 0x25, 0x67, 0x12, 0xDE, -+0xB6, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xEF, 0x30, -+0xE7, 0x06, 0xE5, 0x6F, 0x2E, 0xFF, 0x80, 0x05, -+0xC3, 0xE5, 0x6F, 0x9E, 0xFF, 0x8F, 0x6F, 0xE5, -+0x6F, 0xD3, 0x94, 0x1A, 0xAF, 0x6F, 0x40, 0x02, -+0x7F, 0x1A, 0x8F, 0x6F, 0xE5, 0x68, 0x90, 0x81, -+0xD9, 0x93, 0xFF, 0xD3, 0x90, 0x95, 0xDA, 0xE0, -+0x9F, 0x90, 0x95, 0xD9, 0xE0, 0x94, 0x00, 0x40, -+0x02, 0x61, 0xE2, 0xC3, 0xE5, 0x6E, 0x94, 0x0A, -+0xE5, 0x6D, 0x94, 0x00, 0x40, 0x02, 0x61, 0x8E, -+0xD1, 0x55, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0x01, -+0x40, 0x07, 0xD1, 0x55, 0xF5, 0x83, 0xE0, 0x14, -+0xF0, 0xF1, 0xE3, 0x90, 0x00, 0x08, 0x12, 0x03, -+0x3E, 0xFF, 0x90, 0x95, 0xDA, 0xE0, 0x2F, 0xFF, -+0x90, 0x95, 0xD9, 0xE0, 0x35, 0xF0, 0xFE, 0x12, -+0xE7, 0x0F, 0xEE, 0x35, 0xF0, 0xFE, 0x12, 0xE7, -+0x3F, 0xFD, 0xEE, 0x35, 0xF0, 0xFC, 0xE5, 0x6D, -+0xC3, 0x13, 0xFE, 0xE5, 0x6E, 0x13, 0xFF, 0xD3, -+0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x0F, 0xE5, 0x67, -+0x94, 0x05, 0x50, 0x07, 0xD1, 0x55, 0xF5, 0x83, -+0x74, 0x03, 0xF0, 0x61, 0xE2, 0xF1, 0xE3, 0x12, -+0x03, 0x13, 0x65, 0x71, 0x70, 0x02, 0xE5, 0xF0, -+0x70, 0x2F, 0xE5, 0x67, 0xC3, 0x94, 0x05, 0x50, -+0x0C, 0xD1, 0x55, 0xF5, 0x83, 0xE0, 0xD3, 0x94, -+0x00, 0x40, 0x02, 0x80, 0x07, 0xE5, 0x71, 0xC3, -+0x94, 0x03, 0x50, 0x09, 0x7D, 0x06, 0xAF, 0x67, -+0x12, 0xA1, 0xC6, 0xC1, 0x49, 0xE4, 0xFD, 0xAF, -+0x67, 0x12, 0xA0, 0xC7, 0x12, 0xA1, 0xC2, 0xC1, -+0x2D, 0x12, 0xD1, 0xEA, 0xC1, 0x2D, 0xD1, 0x55, -+0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x91, 0x6C, 0x74, -+0x02, 0xF0, 0xAB, 0x6F, 0xAD, 0x67, 0xAF, 0x6E, -+0xAE, 0x6D, 0x12, 0x41, 0x9C, 0x8E, 0x6B, 0x8F, -+0x6C, 0xF1, 0xE9, 0x34, 0x81, 0xF5, 0x83, 0xC3, -+0x74, 0x01, 0x93, 0x95, 0x74, 0xFF, 0xE4, 0x93, -+0x94, 0x00, 0xFE, 0xD3, 0xE5, 0x6C, 0x9F, 0xE5, -+0x6B, 0x9E, 0x40, 0x0D, 0xD1, 0x77, 0xE4, 0xF0, -+0x7D, 0x01, 0xAF, 0x67, 0x12, 0xA0, 0xC7, 0xC1, -+0x2D, 0x12, 0xE7, 0x37, 0xC3, 0xE5, 0x6C, 0x9F, -+0xE5, 0x6B, 0x94, 0x00, 0x50, 0x0D, 0xD1, 0x77, -+0xE4, 0xF0, 0x7D, 0x01, 0xAF, 0x67, 0x12, 0xA0, -+0x01, 0xC1, 0x2D, 0x12, 0xA1, 0xC2, 0xD1, 0x77, -+0xE0, 0x04, 0xF0, 0xE5, 0x69, 0x90, 0x81, 0xED, -+0x93, 0x25, 0x73, 0xFF, 0xE4, 0x33, 0xFE, 0xD1, -+0x77, 0xE0, 0xC3, 0x9F, 0xEE, 0x64, 0x80, 0xF8, -+0x74, 0x80, 0x98, 0x50, 0x02, 0xC1, 0x2D, 0xD1, -+0x77, 0xE4, 0xF0, 0x12, 0xE7, 0x37, 0xF1, 0xE9, -+0x34, 0x81, 0xF5, 0x83, 0x74, 0x01, 0x93, 0x2F, -+0xFF, 0xE4, 0x93, 0x34, 0x00, 0xC3, 0x13, 0xFE, -+0xEF, 0x13, 0xFF, 0xE5, 0x67, 0x12, 0xA1, 0xB1, -+0xC1, 0x2D, 0xD1, 0x5F, 0xE0, 0x64, 0x05, 0x60, -+0x02, 0xA1, 0x05, 0x90, 0x04, 0xA0, 0xE0, 0x64, -+0x02, 0x70, 0x10, 0xD1, 0x83, 0xE4, 0xF0, 0x90, -+0x04, 0xA1, 0xE0, 0x78, 0x88, 0xF6, 0x12, 0xAF, -+0x48, 0xC1, 0x41, 0xAD, 0x69, 0xAF, 0x67, 0x12, -+0x72, 0xEE, 0x12, 0xE6, 0xEE, 0xEF, 0xF0, 0xE5, -+0x67, 0x12, 0xAE, 0xFB, 0xE0, 0x54, 0x07, 0x78, -+0x88, 0xF6, 0x74, 0xD6, 0x25, 0x67, 0xF1, 0xDA, -+0xFF, 0xC3, 0x94, 0x30, 0x40, 0x1C, 0x75, 0xF0, -+0x12, 0xE5, 0x67, 0xD1, 0xA1, 0xFE, 0xC4, 0x13, -+0x13, 0x54, 0x03, 0x20, 0xE0, 0x0C, 0x12, 0xE6, -+0xEE, 0xE0, 0x60, 0x06, 0x90, 0x96, 0x48, 0xE0, -+0x60, 0x0A, 0xE4, 0x78, 0x88, 0xF6, 0xD1, 0x83, -+0xE4, 0xF0, 0x80, 0x61, 0x12, 0xE6, 0xE2, 0xE0, -+0xFE, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEF, -+0x12, 0xDD, 0xE0, 0x98, 0x50, 0x22, 0x74, 0xD6, -+0x25, 0x67, 0xF1, 0xDA, 0x24, 0x05, 0xFD, 0xE4, -+0x33, 0xFC, 0xEE, 0x12, 0xDD, 0xE0, 0x98, 0x50, -+0x0F, 0x12, 0xE6, 0xD6, 0xE0, 0xB5, 0x69, 0x08, -+0xD1, 0x90, 0xE0, 0xC3, 0x94, 0x0A, 0x40, 0x28, -+0x78, 0x88, 0xE6, 0xFF, 0x70, 0x04, 0x76, 0x01, -+0x80, 0x0C, 0xEF, 0x78, 0x88, 0xB4, 0x01, 0x04, -+0x76, 0x03, 0x80, 0x02, 0x76, 0x05, 0xD1, 0x90, -+0xE4, 0xF0, 0x74, 0xD6, 0x25, 0x67, 0xF1, 0xDA, -+0xFF, 0x12, 0xE6, 0xE2, 0xEF, 0xF0, 0x80, 0x05, -+0xD1, 0x83, 0xE0, 0x04, 0xF0, 0x12, 0xE6, 0xD6, -+0xE5, 0x69, 0xF0, 0xC1, 0x28, 0xD1, 0x5F, 0xE0, -+0x64, 0x06, 0x60, 0x02, 0xC1, 0x2D, 0xF5, 0x6B, -+0xF5, 0x6C, 0xE5, 0x67, 0x12, 0xAE, 0xFB, 0xE0, -+0x54, 0x07, 0x78, 0x88, 0xF6, 0xD3, 0xE5, 0x6E, -+0x94, 0xE8, 0xE5, 0x6D, 0x94, 0x03, 0x40, 0x06, -+0x78, 0x86, 0x76, 0x05, 0x80, 0x15, 0xD3, 0xE5, -+0x6E, 0x94, 0xFA, 0xE5, 0x6D, 0x94, 0x00, 0x40, -+0x06, 0x78, 0x86, 0x76, 0x02, 0x80, 0x04, 0xE4, -+0x78, 0x86, 0xF6, 0xE5, 0x6E, 0xAE, 0x6D, 0x78, -+0x86, 0x86, 0x00, 0x08, 0x80, 0x05, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x82, -+0x06, 0xE4, 0x12, 0xE7, 0x30, 0x90, 0x95, 0xDC, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x78, 0x87, -+0xF6, 0xF1, 0xE3, 0x78, 0x87, 0xE6, 0xFD, 0x12, -+0xE6, 0xCA, 0xAE, 0xF0, 0x78, 0x86, 0x86, 0x00, -+0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, -+0xD8, 0xF9, 0xFF, 0xED, 0x90, 0x82, 0x01, 0x12, -+0xE7, 0x30, 0xEF, 0x25, 0x6C, 0xF5, 0x6C, 0xEE, -+0x35, 0x6B, 0xF5, 0x6B, 0xC3, 0x90, 0x95, 0xDD, -+0xE0, 0x95, 0x6C, 0x90, 0x95, 0xDC, 0xE0, 0x95, -+0x6B, 0x40, 0x07, 0x78, 0x87, 0x06, 0xE6, 0xB4, -+0x05, 0xBF, 0x78, 0x87, 0xE6, 0xC3, 0x13, 0xF6, -+0xFD, 0x08, 0xE6, 0x24, 0x01, 0xFF, 0xE4, 0x33, -+0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x08, 0xF6, 0xD3, -+0x9D, 0x40, 0x07, 0xE6, 0x79, 0x87, 0x97, 0xF6, -+0x80, 0x04, 0xE4, 0x78, 0x89, 0xF6, 0xD1, 0x6B, -+0xE0, 0xC3, 0x13, 0xFF, 0x78, 0x89, 0xE6, 0xC4, -+0x33, 0x54, 0xE0, 0x2F, 0xFF, 0xD1, 0x6B, 0xEF, -+0xF0, 0xD1, 0x6B, 0xE0, 0xC3, 0x94, 0xC0, 0x40, -+0x05, 0xD1, 0x6B, 0x74, 0xC0, 0xF0, 0xD1, 0x6B, -+0xE0, 0x24, 0x1F, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, -+0x78, 0x06, 0xCE, 0xA2, 0xE7, 0x13, 0xCE, 0x13, -+0xD8, 0xF8, 0x78, 0x89, 0xF6, 0xE6, 0x25, 0xE0, -+0xF6, 0x70, 0x03, 0xFF, 0x80, 0x05, 0x78, 0x89, -+0xE6, 0x14, 0xFF, 0x78, 0x88, 0xA6, 0x07, 0xD3, -+0x90, 0x95, 0xDA, 0xE0, 0x94, 0x03, 0x90, 0x95, -+0xD9, 0xE0, 0x94, 0x00, 0x40, 0x02, 0xE4, 0xF6, -+0x78, 0x88, 0x12, 0xAF, 0x48, 0xD1, 0x5F, 0xE0, -+0xFF, 0xD3, 0x94, 0x05, 0x50, 0x05, 0xEF, 0x04, -+0xFF, 0x80, 0x02, 0x7F, 0x00, 0xD1, 0x5F, 0xEF, -+0xF0, 0xE4, 0xF5, 0x6B, 0xF5, 0x6C, 0x12, 0xD1, -+0xEA, 0x05, 0x67, 0x01, 0xF4, 0x22, 0xE0, 0x90, -+0x92, 0x5E, 0xF0, 0xA3, 0x22, 0x74, 0x6B, 0x25, -+0x67, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0x22, 0x74, -+0x76, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8E, -+0xF5, 0x83, 0x22, 0x74, 0x4F, 0x25, 0x67, 0xF5, -+0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, -+0xA6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -+0xF5, 0x83, 0x22, 0x74, 0x76, 0x25, 0x67, 0xF5, -+0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE4, 0xF0, -+0x74, 0xF6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, -+0x8D, 0xF5, 0x83, 0x22, 0xFF, 0x75, 0xF0, 0x12, -+0xED, 0x90, 0x89, 0x52, 0x12, 0x04, 0x6E, 0xE0, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x12, 0xD2, 0xF8, 0x20, 0xE6, 0x02, 0xE1, 0xC8, -+0x90, 0x00, 0x8C, 0xE0, 0x90, 0x97, 0x00, 0xF0, -+0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x97, 0x01, -+0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0x97, -+0x02, 0xF0, 0x90, 0x97, 0x01, 0xE0, 0x24, 0xFC, -+0x60, 0x10, 0x24, 0x03, 0x60, 0x02, 0xE1, 0xBF, -+0x90, 0x97, 0x00, 0xE0, 0xFF, 0x12, 0xD2, 0x82, -+0xE1, 0xBF, 0x90, 0x97, 0x00, 0xE0, 0x24, 0xD6, -+0xF1, 0xDA, 0xFB, 0xE4, 0xFD, 0xFF, 0xF1, 0xD2, -+0x75, 0xF0, 0x12, 0xD1, 0xA1, 0x13, 0x13, 0x54, -+0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0xF1, 0xD2, 0x75, -+0xF0, 0x12, 0xD1, 0xA1, 0x12, 0xA3, 0x5C, 0xFB, -+0x0D, 0xE4, 0xFF, 0xF1, 0xD2, 0x75, 0xF0, 0x12, -+0xD1, 0xA1, 0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, -+0xFF, 0xF1, 0xD2, 0x75, 0xF0, 0x12, 0xF1, 0xF9, -+0xFB, 0xE4, 0xFD, 0x0F, 0xF1, 0xD2, 0x12, 0xAF, -+0xE7, 0xF1, 0xCF, 0x75, 0xF0, 0x12, 0x12, 0xA1, -+0x93, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, -+0x01, 0xF1, 0xD2, 0x75, 0xF0, 0x12, 0x12, 0xA1, -+0x93, 0x54, 0x1F, 0xF1, 0xD0, 0x12, 0xCF, 0x82, -+0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xF1, 0xD2, 0x75, -+0xF0, 0x08, 0xA4, 0x24, 0x01, 0xF5, 0x82, 0xE4, -+0x34, 0x82, 0xF1, 0xCD, 0x75, 0xF0, 0x08, 0xA4, -+0x24, 0x02, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF1, -+0xCD, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0xF5, -+0x82, 0xE4, 0x34, 0x82, 0xF1, 0xCD, 0x75, 0xF0, -+0x08, 0xA4, 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, -+0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, -+0xF1, 0xD2, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x05, -+0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF1, 0xCD, 0x75, -+0xF0, 0x08, 0xA4, 0x24, 0x06, 0xF5, 0x82, 0xE4, -+0x34, 0x82, 0xF1, 0xCD, 0x75, 0xF0, 0x08, 0xA4, -+0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, -+0x83, 0xE0, 0xFB, 0x0D, 0x12, 0xD2, 0xD0, 0x12, -+0xD2, 0xF8, 0x30, 0xE0, 0x03, 0x12, 0xD5, 0xB8, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF5, 0x83, 0xE0, -+0xFB, 0x0D, 0x12, 0xD2, 0xD0, 0x90, 0x97, 0x00, -+0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, -+0x83, 0xE0, 0x22, 0x90, 0x95, 0xD6, 0x02, 0x86, -+0x39, 0xE5, 0x69, 0x25, 0xE0, 0x24, 0x75, 0xF5, -+0x82, 0xE4, 0x22, 0xC1, 0xA9, 0x75, 0xF0, 0x12, -+0xEF, 0x90, 0x89, 0x4F, 0x12, 0x04, 0x6E, 0xE0, -+0x22, 0xAA, 0x07, 0xA9, 0x05, 0xEA, 0x12, 0x98, -+0xD8, 0xE0, 0xF5, 0x75, 0x54, 0x7F, 0xF5, 0x77, -+0x75, 0xF0, 0x12, 0xEA, 0x12, 0xAF, 0xEA, 0xE0, -+0x90, 0x95, 0xDF, 0xF0, 0x75, 0xF0, 0x12, 0xEA, -+0x12, 0x9F, 0xF9, 0xFF, 0xEA, 0x12, 0x98, 0x3C, -+0xE0, 0x54, 0x03, 0xF5, 0x76, 0xE5, 0x77, 0x90, -+0x81, 0x9D, 0x93, 0xFD, 0xEA, 0x25, 0xE0, 0x24, -+0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, -+0xE4, 0xF0, 0xA3, 0xED, 0xF0, 0x75, 0xF0, 0x12, -+0xEA, 0x12, 0x9E, 0xA1, 0xFE, 0xC4, 0x54, 0x03, -+0x90, 0x95, 0xDE, 0xF0, 0x74, 0xC6, 0x2A, 0x11, -+0xBF, 0xE5, 0x77, 0xF0, 0x74, 0x46, 0x2A, 0x71, -+0x81, 0xE5, 0x76, 0xF0, 0xE5, 0x77, 0xD3, 0x9F, -+0x40, 0x04, 0x8F, 0x77, 0x8F, 0x75, 0x89, 0x78, -+0xE4, 0xFF, 0xEF, 0xC3, 0x95, 0x78, 0x50, 0x34, -+0xE5, 0x75, 0x30, 0xE7, 0x09, 0x85, 0x77, 0x75, -+0x19, 0xE9, 0x70, 0x25, 0x80, 0x26, 0x90, 0x95, -+0xDF, 0xE0, 0xFD, 0xE5, 0x77, 0xD3, 0x9D, 0x40, -+0x10, 0xAB, 0x02, 0x90, 0x95, 0xE3, 0xE9, 0xF0, -+0xAF, 0x77, 0x12, 0xCE, 0xEC, 0x8F, 0x75, 0x80, -+0x0B, 0x90, 0x95, 0xDF, 0xE0, 0xF5, 0x75, 0x80, -+0x03, 0x0F, 0x80, 0xC6, 0xAF, 0x02, 0x90, 0x92, -+0x80, 0xE5, 0x76, 0xF0, 0xE4, 0xFB, 0xAD, 0x75, -+0x02, 0x75, 0x80, 0x74, 0xC6, 0x25, 0x75, 0xF5, -+0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x8F, -+0x75, 0x8D, 0x76, 0xEF, 0x12, 0x98, 0xD8, 0xE0, -+0xFD, 0x54, 0x7F, 0xF5, 0x77, 0xED, 0x54, 0x80, -+0xF5, 0x78, 0x12, 0x9F, 0xF5, 0xF5, 0x7A, 0x75, -+0xF0, 0x12, 0xEF, 0x12, 0x9E, 0xA1, 0xC4, 0x54, -+0x03, 0xF5, 0x7B, 0x31, 0x82, 0x74, 0xFF, 0xF0, -+0x31, 0x9B, 0xE5, 0x78, 0x4D, 0xFF, 0x11, 0xBB, -+0xEF, 0xF0, 0xE5, 0x75, 0x12, 0x98, 0x3C, 0xE0, -+0x54, 0x03, 0xF5, 0x79, 0x74, 0x46, 0x25, 0x75, -+0x71, 0x81, 0xE5, 0x79, 0xF0, 0xE5, 0x77, 0x65, -+0x7A, 0x70, 0x21, 0x75, 0xF0, 0x12, 0xE5, 0x75, -+0x31, 0x93, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, -+0x0B, 0xE5, 0x78, 0x70, 0x07, 0xE5, 0x77, 0x44, -+0x80, 0xFD, 0x80, 0x49, 0x31, 0x9B, 0x7D, 0x07, -+0xAF, 0x75, 0x21, 0xC6, 0xE5, 0x77, 0xC3, 0x95, -+0x7A, 0x50, 0x34, 0xAB, 0x75, 0xAD, 0x7A, 0xAF, -+0x77, 0x12, 0x72, 0x7F, 0xAD, 0x07, 0xE5, 0x77, -+0xC3, 0x94, 0x0C, 0x40, 0x28, 0x75, 0xF0, 0x12, -+0xE5, 0x75, 0x31, 0x93, 0xFE, 0xC4, 0x13, 0x54, -+0x07, 0x30, 0xE0, 0x19, 0xE5, 0x76, 0x60, 0x15, -+0xE5, 0x78, 0x70, 0x11, 0xE5, 0x77, 0x44, 0x80, -+0xFD, 0x31, 0x82, 0xEF, 0xF0, 0x80, 0x06, 0x11, -+0xBB, 0xE5, 0x7A, 0xF0, 0xFD, 0x90, 0x92, 0x80, -+0xE5, 0x79, 0xF0, 0xAB, 0x76, 0xAF, 0x75, 0x02, -+0x75, 0x80, 0x74, 0x5B, 0x25, 0x75, 0xF5, 0x82, -+0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0xFF, 0x75, -+0xF0, 0x12, 0xED, 0x90, 0x89, 0x51, 0x12, 0x04, -+0x6E, 0xE0, 0x22, 0xE5, 0x77, 0x25, 0xE0, 0x24, -+0x75, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -+0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE5, -+0x75, 0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, -+0x34, 0x8D, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0x22, 0x7D, 0x07, 0xAF, 0x67, 0xED, 0x30, -+0xE0, 0x0D, 0x12, 0xD2, 0x11, 0x90, 0x89, 0x5F, -+0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, -+0x30, 0xE1, 0x0B, 0x75, 0xF0, 0x12, 0xEF, 0x12, -+0xD5, 0xB2, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, 0x30, -+0xE2, 0x09, 0x75, 0xF0, 0x12, 0xEF, 0x12, 0xD2, -+0x4E, 0xE4, 0xF0, 0x12, 0xD2, 0x61, 0xEE, 0xF0, -+0x22, 0x90, 0x96, 0xC4, 0x12, 0x86, 0x42, 0x90, -+0x96, 0xC4, 0x12, 0x93, 0xCA, 0x54, 0x7F, 0xFD, -+0x12, 0x87, 0xAE, 0xFE, 0x54, 0x1F, 0x90, 0x96, -+0xC8, 0xF0, 0xEE, 0x54, 0x80, 0x71, 0x5C, 0x90, -+0x96, 0xC7, 0xF0, 0x12, 0x87, 0xB9, 0xFE, 0x54, -+0x03, 0xFC, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, -+0x90, 0x96, 0xCA, 0xF0, 0x12, 0x87, 0xB9, 0xFE, -+0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, -+0x96, 0xC9, 0xF0, 0xEE, 0x54, 0x80, 0x71, 0x5C, -+0xFF, 0x12, 0x87, 0xB9, 0xFB, 0x54, 0x08, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x90, 0x96, 0xCC, 0xF0, -+0xFA, 0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, -+0xA3, 0xF0, 0xEF, 0x54, 0x01, 0xC4, 0x33, 0x33, -+0x33, 0x54, 0x80, 0x12, 0x9E, 0x9C, 0x54, 0x7F, -+0x4F, 0xF0, 0x90, 0x96, 0xC9, 0xE0, 0x71, 0x79, -+0x12, 0x9E, 0x9C, 0x54, 0xBF, 0x4F, 0xF0, 0xEA, -+0x60, 0x02, 0x61, 0x5A, 0x90, 0x96, 0xC8, 0xE0, -+0x54, 0x1F, 0x31, 0x8E, 0x54, 0xE0, 0x4F, 0xF0, -+0xEC, 0x54, 0x03, 0x12, 0x9E, 0x9C, 0x54, 0xFC, -+0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x25, 0xE0, 0x25, -+0xE0, 0x12, 0x9E, 0x9C, 0x54, 0xF3, 0x4F, 0xF0, -+0x90, 0x96, 0xC7, 0xE0, 0x54, 0x01, 0xC4, 0x33, -+0x54, 0xE0, 0x31, 0x8E, 0x54, 0xDF, 0x4F, 0xF0, -+0x90, 0x96, 0xCA, 0xE0, 0x54, 0x03, 0xC4, 0x54, -+0xF0, 0x12, 0x9E, 0x9C, 0x54, 0xCF, 0x4F, 0x71, -+0x6D, 0xE0, 0x54, 0xFB, 0x71, 0x6D, 0xC0, 0x83, -+0xC0, 0x82, 0xE0, 0xFF, 0x90, 0x96, 0xCD, 0xE0, -+0x12, 0xC7, 0x6C, 0xD0, 0x82, 0xD0, 0x83, 0xF0, -+0x90, 0x93, 0xED, 0xE0, 0x60, 0x3B, 0x90, 0x96, -+0xC4, 0x12, 0x86, 0x39, 0xE9, 0x24, 0x03, 0xF9, -+0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x54, 0x1F, -+0x12, 0x02, 0x4C, 0x90, 0x96, 0xCB, 0x74, 0x01, -+0xF0, 0x90, 0x96, 0xCB, 0xE0, 0xFF, 0xC3, 0x94, -+0x04, 0x50, 0x16, 0xEF, 0x71, 0x63, 0x12, 0x86, -+0x39, 0x8F, 0x82, 0x8E, 0x83, 0xE4, 0x12, 0x02, -+0x5E, 0x90, 0x96, 0xCB, 0xE0, 0x04, 0xF0, 0x80, -+0xE0, 0x90, 0x93, 0xEB, 0xE0, 0x54, 0x07, 0xFF, -+0xBF, 0x05, 0x0A, 0xEC, 0xB4, 0x01, 0x06, 0x90, -+0x93, 0xF0, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x96, -+0xCB, 0xF0, 0x90, 0x96, 0xCB, 0xE0, 0xFC, 0x71, -+0x63, 0x12, 0xAA, 0x3F, 0xFF, 0xED, 0x12, 0xCF, -+0x82, 0xE5, 0x82, 0x2C, 0x12, 0xD0, 0x83, 0xEF, -+0xF0, 0x90, 0x96, 0xCB, 0xE0, 0x04, 0xF0, 0xE0, -+0xB4, 0x04, 0xDF, 0xAF, 0x05, 0x90, 0x8A, 0xFF, -+0x71, 0x91, 0x22, 0xE0, 0xC4, 0x13, 0x13, 0x13, -+0x54, 0x01, 0x22, 0x24, 0x03, 0xFF, 0xE4, 0x33, -+0xFE, 0x90, 0x96, 0xC4, 0x22, 0xF0, 0x74, 0xC6, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, -+0x22, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, -+0x22, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, -+0x22, 0x90, 0x96, 0xE0, 0xE0, 0xFF, 0x90, 0x8A, -+0xC7, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, -+0x8C, 0x83, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xE0, 0xEF, -+0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, -+0x04, 0xF0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, -+0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, -+0x90, 0x04, 0x1D, 0xE0, 0x60, 0x41, 0x90, 0x05, -+0x22, 0xE0, 0x90, 0x96, 0xE4, 0xF0, 0x7B, 0x26, -+0x12, 0x92, 0x3D, 0xEF, 0x64, 0x01, 0x70, 0x0B, -+0x91, 0x3D, 0x90, 0x93, 0x58, 0xE0, 0x20, 0xE0, -+0x16, 0x80, 0x0F, 0x12, 0xB4, 0x11, 0x30, 0xE0, -+0x0E, 0x91, 0x3D, 0x90, 0x93, 0x58, 0xE0, 0x20, -+0xE0, 0x05, 0x12, 0xDC, 0xB4, 0xEE, 0xF0, 0x90, -+0x96, 0xE4, 0xE0, 0xFD, 0x7B, 0x27, 0xE4, 0xFF, -+0x12, 0x97, 0x56, 0x71, 0x89, 0x80, 0x10, 0x71, -+0x89, 0x91, 0x3D, 0x90, 0x93, 0x58, 0xE0, 0x20, -+0xE0, 0x05, 0x12, 0xDC, 0xB4, 0xEE, 0xF0, 0x90, -+0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x18, 0x12, 0xB4, -+0x11, 0x30, 0xE0, 0x12, 0x90, 0x05, 0x22, 0xE0, -+0x54, 0x6F, 0xFF, 0x90, 0x8A, 0xF9, 0x12, 0xB3, -+0xEA, 0x7D, 0x28, 0x12, 0x04, 0x7E, 0xF1, 0xE8, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x86, 0xB6, -+0xE0, 0xFF, 0x90, 0x96, 0xE1, 0xE0, 0xFB, 0x90, -+0x92, 0x13, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, -+0x66, 0xDB, 0x90, 0x96, 0xE2, 0xEE, 0xF0, 0xFC, -+0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x96, 0xE0, 0xE0, -+0xFF, 0x90, 0x8A, 0x95, 0xE0, 0xFA, 0xA3, 0xE0, -+0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x96, 0xCE, 0xEE, 0xF0, 0xA3, 0x12, 0xAF, 0xDE, -+0x90, 0x04, 0x1D, 0xE0, 0x60, 0x2B, 0x90, 0x05, -+0x22, 0xE0, 0x90, 0x96, 0xD4, 0xF0, 0x7B, 0x14, -+0x12, 0x92, 0x3D, 0xEF, 0x64, 0x01, 0x70, 0x07, -+0x12, 0xE6, 0x47, 0x91, 0x5F, 0x80, 0x04, 0x7F, -+0x00, 0x80, 0x15, 0x90, 0x96, 0xD4, 0xE0, 0xFD, -+0x7B, 0x15, 0xE4, 0xFF, 0x12, 0x97, 0x56, 0x80, -+0x05, 0x12, 0xE6, 0x47, 0x91, 0x5F, 0xF1, 0xE8, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x92, 0x43, -+0xEF, 0x70, 0x02, 0xFF, 0x22, 0xF1, 0x93, 0x90, -+0x93, 0xAC, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFF, -+0xC3, 0x13, 0xFE, 0xEF, 0x54, 0xF1, 0xFF, 0xEE, -+0x04, 0x54, 0x07, 0x25, 0xE0, 0x4F, 0xF0, 0xA3, -+0xE0, 0xFF, 0x90, 0x93, 0x58, 0xE0, 0xFE, 0xC3, -+0x13, 0x54, 0x07, 0xB5, 0x07, 0x04, 0xEE, 0x54, -+0xF1, 0xF0, 0xF1, 0x93, 0xF5, 0x7D, 0xE4, 0x90, -+0x93, 0x5A, 0xF0, 0xE5, 0x7D, 0x75, 0xF0, 0x1B, -+0xA4, 0x24, 0x5F, 0xF5, 0x82, 0xE4, 0x34, 0x93, -+0xF5, 0x83, 0xE0, 0x30, 0xE0, 0x26, 0xB1, 0x8A, -+0xE0, 0x24, 0xAF, 0xF5, 0x82, 0xE4, 0x34, 0x93, -+0xF5, 0x83, 0xE0, 0xFF, 0xF1, 0xB9, 0xEF, 0xB1, -+0x89, 0xE0, 0x04, 0xB1, 0x89, 0xE0, 0xFF, 0x90, -+0x93, 0xAE, 0xE0, 0xFE, 0xEF, 0xB5, 0x06, 0x04, -+0xB1, 0x8A, 0xE4, 0xF0, 0xF1, 0xB9, 0xE0, 0xFC, -+0x90, 0x93, 0xAC, 0xE0, 0xF1, 0xBB, 0xE0, 0x6C, -+0x60, 0x13, 0xE5, 0x7D, 0x12, 0xBA, 0xC8, 0x12, -+0xBB, 0xE9, 0x12, 0xB9, 0x6C, 0xE5, 0x7D, 0x12, -+0xBA, 0xC8, 0x12, 0x8D, 0xDB, 0xE5, 0x7D, 0xF1, -+0xD2, 0x54, 0x07, 0xFF, 0x60, 0x03, 0xBF, 0x02, -+0x0E, 0xE5, 0x7D, 0xF1, 0xA4, 0xE0, 0xFF, 0x7E, -+0x00, 0x7B, 0x04, 0xE4, 0xFD, 0x91, 0x70, 0xAD, -+0x7D, 0x7F, 0x01, 0x12, 0xBB, 0x62, 0x90, 0x93, -+0xAD, 0xE0, 0xC3, 0x13, 0x54, 0x03, 0xFF, 0xBF, -+0x02, 0x04, 0xE4, 0xFF, 0xF1, 0xF3, 0x7F, 0x01, -+0x22, 0xF0, 0x74, 0xD2, 0x25, 0x7D, 0xF5, 0x82, -+0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0xE4, 0x90, -+0x96, 0x21, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFF, -+0x20, 0xE0, 0x02, 0xE1, 0x15, 0xF1, 0xCE, 0x54, -+0x07, 0x90, 0x96, 0x1E, 0xF0, 0x60, 0x07, 0xE0, -+0x64, 0x02, 0x60, 0x02, 0xC1, 0xA5, 0x90, 0x93, -+0x5A, 0xE0, 0x70, 0x30, 0x12, 0xE7, 0x06, 0x7B, -+0x4E, 0xF1, 0xE1, 0xF1, 0x9C, 0xE0, 0xFF, 0x7E, -+0x00, 0x7B, 0x04, 0x7D, 0x01, 0x91, 0x70, 0xBF, -+0x01, 0x11, 0x90, 0x93, 0x58, 0xE0, 0xF1, 0x16, -+0xE0, 0x44, 0x01, 0xF0, 0x90, 0x93, 0x5A, 0x74, -+0x01, 0xF0, 0x22, 0x90, 0x96, 0x1F, 0xE0, 0xFD, -+0x7B, 0x4F, 0xC1, 0x7B, 0x90, 0x93, 0x5A, 0xE0, -+0x64, 0x01, 0x60, 0x02, 0xC1, 0x96, 0x90, 0x01, -+0xA2, 0xE0, 0x04, 0xF1, 0x92, 0xFF, 0xF1, 0xD2, -+0xFE, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, 0xC1, -+0x94, 0xEF, 0xF1, 0x1A, 0xE0, 0xFF, 0x30, 0xE0, -+0x08, 0x90, 0x96, 0x21, 0x74, 0x01, 0xF0, 0x80, -+0x13, 0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x0D, 0x90, -+0x96, 0x21, 0x74, 0x01, 0xF0, 0x12, 0xE7, 0x06, -+0x7B, 0x50, 0xF1, 0xE1, 0x90, 0x96, 0x21, 0xE0, -+0x60, 0x64, 0x90, 0x93, 0xDF, 0xE0, 0xFF, 0x90, -+0x93, 0xDE, 0xE0, 0x6F, 0x60, 0x42, 0xE0, 0x04, -+0xF0, 0xE0, 0xD3, 0x94, 0x01, 0x40, 0x08, 0x90, -+0x96, 0x22, 0x74, 0x04, 0xF0, 0x80, 0x05, 0xE4, -+0x90, 0x96, 0x22, 0xF0, 0xF1, 0x9C, 0xE0, 0xFF, -+0x7E, 0x00, 0x90, 0x96, 0x22, 0xE0, 0xFB, 0x7D, -+0x01, 0x91, 0x70, 0xBF, 0x01, 0x0E, 0xE4, 0x90, -+0x92, 0x20, 0xF0, 0xA3, 0x74, 0x03, 0x12, 0xDF, -+0xA9, 0x02, 0x66, 0x33, 0x90, 0x96, 0x1F, 0xE0, -+0xFD, 0x7B, 0x51, 0xE4, 0xFF, 0x02, 0x97, 0x56, -+0xE4, 0x90, 0x93, 0xDE, 0xF0, 0xF1, 0xB2, 0x90, -+0x93, 0x58, 0xE0, 0xFF, 0xF1, 0x16, 0xE0, 0x54, -+0xFB, 0xF0, 0x80, 0x02, 0xF1, 0xB2, 0x90, 0x93, -+0x5A, 0xE0, 0x64, 0x05, 0x70, 0x77, 0x91, 0xBD, -+0xEF, 0x70, 0x72, 0x80, 0x6C, 0x90, 0x96, 0x1E, -+0xE0, 0xFF, 0x64, 0x03, 0x60, 0x05, 0xEF, 0x64, -+0x01, 0x70, 0x62, 0x90, 0x93, 0x5A, 0xE0, 0x64, -+0x05, 0x70, 0x5A, 0x90, 0x96, 0x1E, 0xE0, 0x64, -+0x01, 0x70, 0x41, 0x90, 0x96, 0x20, 0x12, 0xDF, -+0x8F, 0xD3, 0x94, 0x1F, 0x90, 0x93, 0x58, 0xE0, -+0x40, 0x10, 0xF1, 0xA1, 0xE0, 0xFF, 0x90, 0x8A, -+0xBF, 0x12, 0xB3, 0xEA, 0x7D, 0x00, 0x7C, 0x7C, -+0x80, 0x1F, 0xF1, 0xA0, 0xE0, 0xFB, 0x90, 0x96, -+0x20, 0x12, 0xDF, 0x8F, 0x7D, 0x00, 0x25, 0xE0, -+0x25, 0xE0, 0xFC, 0xAF, 0x03, 0x90, 0x8A, 0xBF, -+0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, 0x8A, -+0x83, 0x12, 0x04, 0x7E, 0xF1, 0x93, 0xFD, 0x7F, -+0x02, 0x12, 0xBB, 0x62, 0x91, 0xBD, 0xEF, 0x70, -+0x04, 0x7F, 0x06, 0xF1, 0xF3, 0x22, 0xC3, 0x13, -+0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x62, -+0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, -+0xE4, 0x90, 0x96, 0x1D, 0xF0, 0x90, 0x93, 0x58, -+0xE0, 0x30, 0xE0, 0x5D, 0xC3, 0x13, 0x54, 0x07, -+0xFF, 0xF1, 0x1A, 0xE0, 0xFE, 0x30, 0xE0, 0x51, -+0xEF, 0xF1, 0x1A, 0xEE, 0x54, 0xFE, 0xF0, 0xEF, -+0xF1, 0x1A, 0x12, 0x8F, 0xDC, 0x30, 0xE0, 0x0D, -+0x90, 0x93, 0x58, 0xE0, 0xFE, 0xF1, 0x16, 0xEF, -+0x54, 0xFB, 0x12, 0xE7, 0x28, 0x90, 0x04, 0xE0, -+0xE0, 0x30, 0xE1, 0x20, 0xF1, 0xB2, 0x90, 0x93, -+0x58, 0xE0, 0xF1, 0x16, 0xE0, 0x44, 0x02, 0xF0, -+0xE4, 0x90, 0x93, 0xDE, 0xF1, 0x92, 0xFD, 0x7F, -+0x02, 0x12, 0xBB, 0x62, 0x90, 0x96, 0x1D, 0xE0, -+0x60, 0x0F, 0xA1, 0x96, 0x90, 0x93, 0x58, 0xE0, -+0xF1, 0x16, 0xE0, 0x54, 0xFD, 0xF0, 0x12, 0x97, -+0x51, 0x22, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xC3, -+0x13, 0x54, 0x07, 0x22, 0x90, 0x93, 0x58, 0xE0, -+0xC3, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, -+0x24, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -+0x83, 0x22, 0x90, 0x93, 0x5A, 0x74, 0x05, 0xF0, -+0x22, 0xE5, 0x7D, 0x75, 0xF0, 0x1B, 0xA4, 0x24, -+0x5B, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0x22, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xC3, 0x13, -+0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5E, -+0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, -+0x22, 0x7D, 0x6F, 0xE4, 0xFF, 0x02, 0x97, 0x56, -+0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, -+0x22, 0x80, 0xBF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0xAD, 0x07, 0x90, 0x05, 0x63, 0xE0, -+0xFE, 0x90, 0x05, 0x62, 0xE0, 0x7A, 0x00, 0x24, -+0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x96, 0x46, 0xF0, -+0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFE, -+0x90, 0x05, 0x60, 0xE0, 0x24, 0x00, 0xFF, 0xEA, -+0x3E, 0xFE, 0xED, 0xB4, 0x08, 0x0A, 0x90, 0x05, -+0x58, 0xE0, 0xFC, 0x2F, 0xFF, 0xEA, 0x3E, 0xFE, -+0x90, 0x96, 0x23, 0x74, 0x17, 0xF0, 0x90, 0x96, -+0x45, 0x74, 0x06, 0xF0, 0x90, 0x96, 0x25, 0xED, -+0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFD, 0xC3, 0x13, -+0x54, 0x07, 0x12, 0xA7, 0xBB, 0xE0, 0x90, 0x96, -+0x26, 0xF0, 0xA3, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, -+0x90, 0x96, 0x46, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, -+0x96, 0x29, 0xF0, 0xEE, 0xA3, 0xF0, 0x7B, 0x01, -+0x7A, 0x96, 0x79, 0x23, 0x12, 0x96, 0x35, 0x7F, -+0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xF1, 0x9A, 0x90, 0x04, 0x24, 0xE0, 0xFF, -+0xE4, 0xFE, 0x11, 0x96, 0x8E, 0x82, 0x11, 0xB3, -+0x2F, 0xFD, 0xEE, 0x12, 0xA7, 0xA4, 0xED, 0xF0, -+0x0E, 0xEE, 0xB4, 0x03, 0xED, 0x22, 0x90, 0x95, -+0x53, 0x02, 0x86, 0x39, 0x90, 0x96, 0x14, 0x12, -+0x86, 0x39, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x12, -+0x02, 0x1F, 0xFE, 0x90, 0x96, 0x11, 0x12, 0x86, -+0x39, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, 0x02, -+0x1F, 0x71, 0x4F, 0xFF, 0x11, 0x9C, 0x6E, 0x60, -+0x03, 0x7F, 0x00, 0x22, 0x0F, 0xEF, 0xB4, 0x08, -+0xF3, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x96, 0x10, -+0xF0, 0x90, 0x93, 0x03, 0xE0, 0xFF, 0xC3, 0x13, -+0x20, 0xE0, 0x70, 0x31, 0x85, 0x31, 0x96, 0xEF, -+0x60, 0x0D, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x13, -+0x31, 0x8B, 0x11, 0xB9, 0xEF, 0x60, 0x54, 0x31, -+0x85, 0x31, 0x96, 0xEF, 0x60, 0x17, 0x7B, 0x01, -+0x7A, 0x93, 0x79, 0x13, 0x31, 0x8B, 0x11, 0xB9, -+0xEF, 0x60, 0x0A, 0x7B, 0x01, 0x7A, 0x93, 0x79, -+0x1C, 0x71, 0x62, 0x70, 0x36, 0x7B, 0x01, 0x7A, -+0x93, 0x79, 0x20, 0x90, 0x96, 0x14, 0x12, 0x86, -+0x42, 0x7A, 0x93, 0x79, 0x06, 0x31, 0x96, 0xEF, -+0x60, 0x10, 0x31, 0xD0, 0x31, 0x8B, 0x31, 0x96, -+0xEF, 0x60, 0x07, 0x31, 0x85, 0x31, 0xD7, 0xEF, -+0x70, 0x11, 0x31, 0x85, 0x11, 0xB9, 0xEF, 0x60, -+0x29, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x0F, 0x71, -+0x62, 0x60, 0x1F, 0x90, 0x96, 0x10, 0x74, 0x01, -+0xF0, 0x80, 0x17, 0x31, 0xD0, 0x31, 0x8B, 0x31, -+0x96, 0xEF, 0x60, 0x0E, 0x31, 0xD0, 0x31, 0x8B, -+0x31, 0xD7, 0xEF, 0x70, 0x05, 0x90, 0x96, 0x10, -+0x04, 0xF0, 0x90, 0x96, 0x10, 0xE0, 0xFF, 0x90, -+0x05, 0x18, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x90, -+0x05, 0xB3, 0x60, 0x0C, 0xE0, 0x44, 0x80, 0xF0, -+0x90, 0x24, 0xA0, 0xE0, 0x44, 0x01, 0xF0, 0x22, -+0xE0, 0x44, 0x20, 0xF0, 0x22, 0x7B, 0x01, 0x7A, -+0x93, 0x79, 0x06, 0x90, 0x96, 0x14, 0x12, 0x86, -+0x42, 0x7A, 0x93, 0x79, 0x20, 0x22, 0x71, 0x4F, -+0x90, 0x96, 0x17, 0xF0, 0x90, 0x96, 0x17, 0xE0, -+0xFF, 0xC3, 0x94, 0x08, 0x50, 0x27, 0x71, 0x70, -+0x91, 0x3D, 0x51, 0x37, 0xC3, 0x9D, 0x50, 0x03, -+0x7F, 0x00, 0x22, 0x90, 0x96, 0x17, 0xE0, 0xFF, -+0x71, 0x70, 0x91, 0x3D, 0x51, 0x37, 0xD3, 0x9D, -+0x40, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x96, 0x17, -+0xE0, 0x04, 0xF0, 0x80, 0xCF, 0x7F, 0x00, 0x22, -+0x7B, 0x01, 0x7A, 0x93, 0x79, 0x2D, 0x22, 0x71, -+0x4F, 0xFF, 0x11, 0x9C, 0x6E, 0x60, 0x03, 0x7F, -+0x00, 0x22, 0x0F, 0xEF, 0xB4, 0x06, 0xF3, 0x7F, -+0x01, 0x22, 0x71, 0x4F, 0x90, 0x96, 0x17, 0xF0, -+0x90, 0x96, 0x17, 0xE0, 0xFF, 0xC3, 0x94, 0x04, -+0x50, 0x1F, 0x51, 0x1C, 0xC3, 0x9D, 0x50, 0x03, -+0x7F, 0x00, 0x22, 0x90, 0x96, 0x17, 0xE0, 0xFF, -+0x51, 0x1C, 0xD3, 0x9D, 0x40, 0x03, 0x7F, 0x01, -+0x22, 0x90, 0x96, 0x17, 0xE0, 0x04, 0xF0, 0x80, -+0xD7, 0x7F, 0x00, 0x22, 0x7E, 0x00, 0xC3, 0x74, -+0x03, 0x9F, 0xFD, 0xE4, 0x9E, 0xFC, 0x90, 0x96, -+0x14, 0x12, 0x86, 0x39, 0x8D, 0x82, 0x8C, 0x83, -+0x12, 0x02, 0x1F, 0xFD, 0xC3, 0x74, 0x03, 0x9F, -+0xFF, 0xE4, 0x9E, 0xFE, 0x90, 0x96, 0x11, 0x12, -+0x86, 0x39, 0x8F, 0x82, 0x8E, 0x83, 0x02, 0x02, -+0x1F, 0xE4, 0x90, 0x96, 0x14, 0xF0, 0xEF, 0x75, -+0xF0, 0x40, 0xA4, 0x24, 0x80, 0xF9, 0x74, 0x82, -+0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x90, 0x96, 0x10, -+0xF1, 0x42, 0x90, 0x96, 0x13, 0xF0, 0xA3, 0x74, -+0x1C, 0xF0, 0x90, 0x96, 0x13, 0xE0, 0xFF, 0xA3, -+0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x61, 0x4E, -+0x90, 0x96, 0x10, 0x12, 0x86, 0x39, 0x8E, 0x82, -+0x11, 0xB3, 0x90, 0x96, 0x15, 0xF0, 0xEE, 0xFD, -+0x7C, 0x00, 0xF5, 0x82, 0x8C, 0x83, 0xA3, 0xA3, -+0x12, 0x02, 0x1F, 0xFE, 0x8D, 0x82, 0x8C, 0x83, -+0xA3, 0x12, 0x02, 0x1F, 0xFD, 0xED, 0xFF, 0x90, -+0x96, 0x16, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -+0x96, 0x15, 0xE0, 0x64, 0x01, 0x60, 0x0E, 0xA3, -+0xA3, 0xE0, 0x24, 0x03, 0xFF, 0x90, 0x96, 0x14, -+0xE0, 0x2F, 0xF0, 0x80, 0xAD, 0xE4, 0x90, 0x96, -+0x18, 0xF0, 0x90, 0x96, 0x18, 0xE0, 0xFF, 0xC3, -+0x94, 0x08, 0x50, 0x1A, 0x90, 0x96, 0x14, 0xE0, -+0x24, 0x03, 0x91, 0x5A, 0x51, 0x3F, 0xFF, 0x90, -+0x96, 0x18, 0xE0, 0x24, 0x20, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0x71, 0x57, 0x80, 0xDC, 0x90, 0x96, -+0x14, 0xE0, 0x24, 0x0B, 0xFF, 0xE4, 0x33, 0xFE, -+0x90, 0x96, 0x10, 0x51, 0x3F, 0x90, 0x93, 0x28, -+0xF0, 0x70, 0x2A, 0x90, 0x96, 0x18, 0xF0, 0x90, -+0x96, 0x18, 0xE0, 0xFF, 0x24, 0x10, 0xFD, 0xE4, -+0x33, 0xFC, 0x90, 0x96, 0x10, 0x71, 0x7D, 0x12, -+0x02, 0x1F, 0xFE, 0x74, 0x29, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEE, 0x71, 0x5A, -+0xE0, 0xB4, 0x04, 0xDB, 0x22, 0xE4, 0x90, 0x96, -+0x18, 0xF0, 0x90, 0x96, 0x18, 0xE0, 0xFF, 0xC3, -+0x94, 0x04, 0x50, 0x1A, 0x90, 0x96, 0x14, 0xE0, -+0x24, 0x0C, 0x91, 0x5A, 0x51, 0x3F, 0xFF, 0x90, -+0x96, 0x18, 0xE0, 0x24, 0x29, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0x71, 0x57, 0x80, 0xDC, 0x22, 0x90, -+0x96, 0x11, 0x12, 0x86, 0x42, 0xE4, 0x22, 0xF5, -+0x83, 0xEF, 0xF0, 0x90, 0x96, 0x18, 0xE0, 0x04, -+0xF0, 0x22, 0x90, 0x96, 0x14, 0x12, 0x86, 0x42, -+0x7A, 0x93, 0x79, 0x29, 0x31, 0xEA, 0xEF, 0x22, -+0x7E, 0x00, 0xC3, 0x74, 0x07, 0x9F, 0xFD, 0xE4, -+0x9E, 0xFC, 0x90, 0x96, 0x14, 0x12, 0x86, 0x39, -+0x8D, 0x82, 0x8C, 0x83, 0x22, 0xEF, 0x70, 0x05, -+0x90, 0x93, 0x05, 0x80, 0x03, 0x90, 0x93, 0x04, -+0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, 0x95, 0xEB, -+0xEF, 0xF0, 0x90, 0x95, 0xEB, 0xE0, 0x24, 0x38, -+0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xA3, -+0x12, 0x86, 0x42, 0xE4, 0xFF, 0x74, 0x08, 0x2F, -+0xF1, 0x37, 0xE0, 0xFE, 0x91, 0x30, 0x8F, 0x82, -+0x75, 0x83, 0x00, 0x91, 0x36, 0xB4, 0x06, 0xED, -+0x90, 0x95, 0xEB, 0xE0, 0x24, 0x52, 0xF9, 0xE4, -+0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xA3, 0xF1, 0x42, -+0x70, 0x5D, 0x90, 0x95, 0xEC, 0x12, 0x87, 0xAC, -+0x64, 0x02, 0x70, 0x53, 0x90, 0x24, 0x87, 0xE0, -+0x90, 0x00, 0x03, 0x12, 0x02, 0x5E, 0x90, 0x24, -+0x86, 0xE0, 0x90, 0x00, 0x04, 0x12, 0x02, 0x5E, -+0x91, 0x30, 0x12, 0x87, 0x62, 0x64, 0x01, 0x70, -+0x36, 0x12, 0x87, 0x69, 0x64, 0x0D, 0x70, 0x2F, -+0xFF, 0x74, 0x88, 0x91, 0x4F, 0xEF, 0x24, 0x08, -+0x91, 0x45, 0x71, 0x7D, 0x91, 0x36, 0xB4, 0x08, -+0xF0, 0x90, 0x05, 0xDC, 0xE0, 0xFF, 0x91, 0x30, -+0x90, 0x00, 0x10, 0xEF, 0x12, 0x02, 0x5E, 0xE4, -+0xFF, 0x91, 0x4D, 0xEF, 0x24, 0x11, 0x91, 0x45, -+0x71, 0x7D, 0x91, 0x36, 0xB4, 0x04, 0xF2, 0x22, -+0x90, 0x95, 0xEC, 0x02, 0x86, 0x39, 0xEE, 0x12, -+0x02, 0x5E, 0x0F, 0xEF, 0x22, 0x12, 0x02, 0x1F, -+0xFD, 0xC3, 0x74, 0x07, 0x22, 0xFD, 0xE4, 0x33, -+0xFC, 0x90, 0x95, 0xEC, 0x22, 0x74, 0x90, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x24, 0xF5, 0x83, 0xE0, -+0xFE, 0x22, 0xFD, 0xE4, 0x33, 0xFC, 0x7E, 0x00, -+0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0x90, 0x96, -+0x10, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, -+0x1F, 0xE4, 0xFF, 0x12, 0xD4, 0x6F, 0xE4, 0xFF, -+0x71, 0x85, 0x7F, 0x01, 0x71, 0x85, 0x90, 0x93, -+0x03, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, -+0x07, 0x90, 0x04, 0x1F, 0xE0, 0x44, 0x80, 0xF0, -+0x22, 0xE4, 0xFF, 0x74, 0x94, 0x91, 0x4F, 0x74, -+0x13, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xB1, -+0x97, 0xB4, 0x08, 0xEF, 0xE4, 0xFF, 0x74, 0x9C, -+0x91, 0x4F, 0x74, 0x1C, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0xB1, 0x97, 0xB4, 0x04, 0xEF, 0x22, -+0xE4, 0x90, 0x95, 0xEC, 0xF0, 0x12, 0xE4, 0x24, -+0xB1, 0x9E, 0xB1, 0x6A, 0x91, 0x91, 0x90, 0x07, -+0xE3, 0xF1, 0xA0, 0x60, 0x59, 0xE4, 0x90, 0x95, -+0xED, 0xF0, 0x90, 0x96, 0x0F, 0x74, 0x08, 0xF0, -+0x90, 0x05, 0x68, 0xE0, 0x90, 0x95, 0xEF, 0xF0, -+0x90, 0x05, 0x69, 0xE0, 0x90, 0x95, 0xF0, 0xF0, -+0x90, 0x05, 0x6A, 0xE0, 0x90, 0x95, 0xF1, 0xF0, -+0x90, 0x05, 0x6B, 0xE0, 0x90, 0x95, 0xF2, 0xF0, -+0x90, 0x05, 0x78, 0xE0, 0x90, 0x95, 0xF3, 0xF0, -+0x90, 0x05, 0x79, 0xE0, 0x90, 0x95, 0xF4, 0xF0, -+0x90, 0x05, 0x7A, 0xE0, 0x90, 0x95, 0xF5, 0xF0, -+0x90, 0x05, 0x7B, 0xE0, 0x90, 0x95, 0xF6, 0xF0, -+0x7B, 0x01, 0x7A, 0x95, 0x79, 0xED, 0x12, 0x96, -+0x35, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x95, -+0xEB, 0xE0, 0xFD, 0x60, 0x3C, 0xA3, 0xE0, 0x12, -+0xCA, 0x6A, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x60, 0xE6, -+0x90, 0x95, 0xEC, 0xE0, 0xFB, 0x74, 0x01, 0xA8, -+0x03, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -+0xFE, 0xF4, 0xFD, 0x90, 0x95, 0xEB, 0xE0, 0x5D, -+0xF0, 0x90, 0x07, 0xE3, 0xE0, 0x4E, 0xF0, 0xAF, -+0x03, 0x51, 0x49, 0x11, 0xCC, 0xF1, 0x30, 0x80, -+0xBD, 0x22, 0xE4, 0xFF, 0x74, 0x88, 0x91, 0x4F, -+0x74, 0x06, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, -+0xB1, 0x97, 0xB4, 0x08, 0xEF, 0x90, 0x05, 0xDC, -+0xE0, 0x90, 0x93, 0x0E, 0xF0, 0xE4, 0xFF, 0x91, -+0x4D, 0x74, 0x0F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x93, 0xB1, 0x97, 0xB4, 0x04, 0xF1, 0x22, 0xF5, -+0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0x22, 0xE4, 0xFF, -+0x74, 0x80, 0x91, 0x4F, 0x74, 0x2D, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x93, 0xB1, 0x97, 0xB4, 0x08, -+0xEF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x96, 0xB8, 0xF1, 0xDE, 0x12, 0xDC, -+0xF5, 0xE0, 0x90, 0x96, 0xC3, 0xF0, 0xE4, 0x90, -+0x96, 0xC0, 0xF0, 0x90, 0x96, 0xB8, 0x12, 0xB3, -+0xBE, 0x90, 0x96, 0xBB, 0xF0, 0xEF, 0x54, 0x07, -+0x90, 0x96, 0xBD, 0xD1, 0xF6, 0xE0, 0x90, 0x96, -+0xBE, 0xF0, 0x12, 0x9F, 0xF5, 0x54, 0x7F, 0x90, -+0x96, 0xC1, 0xF0, 0x90, 0x96, 0xB8, 0xE0, 0xF1, -+0xE7, 0xE0, 0x90, 0x96, 0xC2, 0xF0, 0xED, 0x54, -+0x7F, 0x90, 0x96, 0xBC, 0xF0, 0xEB, 0x70, 0x21, -+0x90, 0x89, 0x3D, 0xF1, 0x10, 0xFF, 0x12, 0xE6, -+0xCA, 0xFD, 0x90, 0x89, 0x40, 0x11, 0xAE, 0x2D, -+0xFF, 0xE4, 0x35, 0xF0, 0xC3, 0x13, 0xFE, 0xEF, -+0x13, 0xFF, 0x90, 0x96, 0xB8, 0xE0, 0x12, 0xA1, -+0xB1, 0x90, 0x96, 0xC1, 0xE0, 0xFF, 0x90, 0x96, -+0xBC, 0xE0, 0xFE, 0xD3, 0x9F, 0x40, 0x0C, 0x90, -+0x96, 0xB9, 0xE0, 0x54, 0x80, 0xFD, 0xEF, 0x4D, -+0xF0, 0x80, 0x0F, 0x90, 0x96, 0xC2, 0xE0, 0xFF, -+0xEE, 0xC3, 0x9F, 0x50, 0x05, 0x90, 0x96, 0xB9, -+0xEF, 0xF0, 0x90, 0x96, 0xB9, 0xE0, 0xFE, 0x54, -+0x7F, 0x90, 0x96, 0xBC, 0xF0, 0xEE, 0x54, 0x80, -+0x90, 0x96, 0xBF, 0xF0, 0x90, 0x96, 0xBA, 0xE0, -+0x70, 0x1F, 0xA3, 0xF1, 0x18, 0xC0, 0x83, 0xC0, -+0x82, 0xF1, 0x23, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0xF4, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, -+0x90, 0x96, 0xBE, 0xE0, 0x54, 0x7F, 0xF0, 0x80, -+0x36, 0x90, 0x96, 0xBB, 0xF1, 0x18, 0xC0, 0x83, -+0xC0, 0x82, 0xF1, 0x23, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0x4F, 0xD0, 0x82, 0xD0, 0x83, 0xD1, -+0xF6, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x96, 0xBE, -+0xF0, 0x90, 0x89, 0x46, 0xF1, 0x10, 0xF5, 0x82, -+0x11, 0xB3, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x4F, -+0x90, 0x96, 0xBE, 0xF0, 0x44, 0x80, 0xF0, 0x90, -+0x96, 0xB9, 0xF1, 0x08, 0x12, 0x98, 0xD8, 0xEF, -+0xF0, 0xEE, 0x70, 0x05, 0x90, 0x01, 0xC8, 0xEF, -+0xF0, 0x90, 0x96, 0xBE, 0xF1, 0x08, 0xD1, 0xFB, -+0xEF, 0xF0, 0xEE, 0x12, 0x98, 0x3C, 0xE0, 0x54, -+0xFC, 0xFF, 0x90, 0x96, 0xC3, 0xE0, 0x54, 0x03, -+0x4F, 0xFE, 0x90, 0x96, 0xB8, 0xE0, 0xFF, 0x12, -+0x98, 0x3C, 0xEE, 0xF0, 0x7D, 0x01, 0x12, 0xD1, -+0xEE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, -+0x96, 0xB8, 0xE0, 0xC4, 0x54, 0xF0, 0x24, 0x01, -+0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, -+0xE0, 0xFF, 0x90, 0x96, 0xB8, 0xE0, 0xFE, 0x22, -+0x12, 0x86, 0x39, 0x90, 0x96, 0xBC, 0xE0, 0x22, -+0xE0, 0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -+0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x90, 0x96, 0xBD, -+0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, -+0x90, 0x95, 0xEC, 0xE0, 0x04, 0xF0, 0x22, 0xF5, -+0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0x22, 0x90, -+0x95, 0x53, 0x12, 0x86, 0x42, 0x02, 0x02, 0x06, -+0xE6, 0xFD, 0xAF, 0x67, 0xEF, 0xD1, 0xFB, 0xE0, -+0x54, 0xF8, 0xF5, 0x75, 0xED, 0x42, 0x75, 0xEF, -+0xD1, 0xFB, 0xE5, 0x75, 0xF0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, -+0x06, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, -+0x06, 0x7E, 0xFF, 0x7F, 0xFF, 0x80, 0x1E, 0x12, -+0xE3, 0x12, 0xF1, 0xA7, 0x90, 0x07, 0xC3, 0xE0, -+0x30, 0xE5, 0xF9, 0xED, 0x54, 0x03, 0xFD, 0x24, -+0xC9, 0xF1, 0x37, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, -+0xF1, 0x37, 0xF1, 0xD5, 0xFE, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x95, 0x53, 0x02, 0x86, 0x42, -+0xE0, 0x90, 0x95, 0xEB, 0xF0, 0xE0, 0x22, 0x90, -+0x07, 0xC0, 0x74, 0x80, 0xF0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, -+0x06, 0xEF, 0x12, 0xE3, 0x5F, 0xF0, 0xF1, 0xA7, -+0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, -+0x54, 0x03, 0x24, 0xC8, 0xF1, 0x37, 0xE0, 0xFF, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0x7C, 0x00, -+0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0xEF, 0xF0, -+0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x22, 0x75, -+0xF0, 0x12, 0x90, 0x89, 0x50, 0x02, 0x04, 0x6E, -+0x12, 0xB7, 0xDD, 0x12, 0x02, 0x06, 0xFF, 0x54, -+0x0F, 0xF5, 0x64, 0xEF, 0xC4, 0x54, 0x0F, 0x64, -+0x0F, 0x70, 0x41, 0x90, 0x93, 0x58, 0xE0, 0x54, -+0xFE, 0xFF, 0xF0, 0xE5, 0x64, 0x54, 0x07, 0x25, -+0xE0, 0xFE, 0xEF, 0x54, 0xF1, 0x4E, 0x12, 0x87, -+0x72, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, 0xDF, -+0x20, 0xE0, 0x05, 0x74, 0x06, 0xF0, 0x80, 0x03, -+0x74, 0x01, 0xF0, 0x7D, 0x20, 0xE4, 0xFF, 0x12, -+0x7C, 0x3B, 0xAF, 0x64, 0x12, 0xBA, 0x6C, 0xBF, -+0x01, 0x06, 0xE4, 0xFD, 0xFF, 0x12, 0xBB, 0x62, -+0x7F, 0x02, 0x01, 0xEA, 0xE5, 0x64, 0x75, 0xF0, -+0x1B, 0xA4, 0x24, 0x5B, 0xF9, 0x74, 0x93, 0x35, -+0xF0, 0xFA, 0x7B, 0x01, 0xC0, 0x02, 0xC0, 0x01, -+0xE5, 0x63, 0x24, 0x01, 0xF9, 0xE4, 0x35, 0x62, -+0x85, 0x61, 0x45, 0x12, 0xE7, 0x57, 0xD0, 0x01, -+0xD0, 0x02, 0x12, 0x69, 0xF5, 0xE5, 0x64, 0x12, -+0xA7, 0xD2, 0x54, 0xF7, 0x11, 0xEE, 0xC4, 0x54, -+0x0F, 0x14, 0x65, 0x64, 0x70, 0x6F, 0x90, 0x88, -+0x36, 0xE0, 0x70, 0x07, 0x90, 0x88, 0x2C, 0xE0, -+0x30, 0xE0, 0x04, 0x7F, 0x05, 0x80, 0x5B, 0x11, -+0xEF, 0xC4, 0x54, 0x0F, 0x90, 0x93, 0x59, 0x12, -+0x87, 0x68, 0xFC, 0x54, 0x0F, 0xC4, 0x54, 0xF0, -+0xFE, 0x90, 0x93, 0x58, 0xE0, 0x54, 0x0F, 0x4E, -+0xF0, 0xEC, 0x54, 0x60, 0xC4, 0x54, 0x0F, 0xFF, -+0x90, 0x93, 0xAD, 0xE0, 0x54, 0xF9, 0x4F, 0xF0, -+0x90, 0x93, 0x58, 0xE0, 0x54, 0xF1, 0xF0, 0x90, -+0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0x93, 0xD5, -+0xE0, 0x90, 0x93, 0xD9, 0x30, 0xE0, 0x0B, 0xE0, -+0x54, 0xFE, 0xF0, 0x54, 0xC1, 0x44, 0x02, 0xF0, -+0x80, 0x07, 0xE0, 0x44, 0x01, 0xF0, 0x54, 0xC1, -+0xF0, 0x90, 0x93, 0x58, 0xE0, 0x44, 0x01, 0xF0, -+0x7F, 0x03, 0x12, 0xA7, 0xF3, 0x22, 0xF0, 0xAB, -+0x61, 0xAA, 0x62, 0xA9, 0x63, 0x02, 0x02, 0x06, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, -+0xDD, 0x90, 0x05, 0x27, 0xE0, 0xF5, 0x64, 0x8B, -+0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, 0x48, 0x01, -+0x7B, 0x01, 0x7A, 0x88, 0x79, 0x2C, 0x12, 0x69, -+0xF5, 0x11, 0xEF, 0xFF, 0xC3, 0x13, 0x20, 0xE0, -+0x02, 0x21, 0xAB, 0x90, 0x88, 0x2C, 0xE0, 0x30, -+0xE0, 0x70, 0x71, 0x83, 0x75, 0x64, 0x21, 0x71, -+0xB2, 0x30, 0xE0, 0x04, 0x71, 0xD2, 0x80, 0x0D, -+0xE4, 0x90, 0x88, 0x2D, 0xF0, 0xA3, 0xF0, 0x7D, -+0x40, 0xFF, 0x12, 0x7C, 0x7E, 0x90, 0x88, 0x2C, -+0x71, 0xBE, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x12, -+0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x43, -+0x64, 0x14, 0x90, 0x88, 0x2C, 0xE0, 0xC4, 0x13, -+0x54, 0x07, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x80, -+0x90, 0x88, 0x2C, 0x91, 0x14, 0x20, 0xE0, 0x03, -+0x43, 0x64, 0x40, 0x51, 0x65, 0x90, 0x88, 0x2F, -+0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, 0x6C, 0x90, -+0x88, 0x2C, 0x71, 0x8A, 0x30, 0xE0, 0x04, 0x7F, -+0x04, 0x80, 0x0B, 0x71, 0xC6, 0xEF, 0x60, 0x04, -+0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x51, 0x6C, -+0x41, 0x20, 0x51, 0x62, 0x90, 0x88, 0x2F, 0xE0, -+0x64, 0x04, 0x60, 0x02, 0x41, 0x5D, 0xFF, 0x51, -+0x6C, 0x41, 0x5D, 0x90, 0x88, 0x2C, 0xE0, 0x30, -+0xE0, 0x76, 0x71, 0x83, 0x43, 0x64, 0x31, 0x71, -+0xB2, 0x30, 0xE0, 0x04, 0x71, 0xD2, 0x80, 0x07, -+0x7D, 0x40, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0x90, -+0x88, 0x2C, 0x71, 0xBE, 0x30, 0xE0, 0x03, 0x43, -+0x64, 0x02, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -+0x03, 0x43, 0x64, 0x04, 0x51, 0x65, 0x90, 0x88, -+0x2C, 0x71, 0x8A, 0x30, 0xE0, 0x10, 0x71, 0x7C, -+0x60, 0x36, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, -+0xE4, 0xFD, 0x7F, 0x02, 0x80, 0x1D, 0xD1, 0x8D, -+0x71, 0x7C, 0x70, 0x1C, 0x12, 0x7B, 0xAD, 0x71, -+0xC6, 0xBF, 0x01, 0x06, 0x71, 0xE2, 0x7D, 0x01, -+0x80, 0x09, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, -+0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x80, 0x08, -+0x90, 0x88, 0x39, 0xE0, 0x90, 0x88, 0x30, 0xF0, -+0x90, 0x05, 0x40, 0x74, 0x22, 0xF0, 0x80, 0x35, -+0x51, 0x62, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, -+0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, 0x7D, -+0x01, 0x7F, 0x04, 0x80, 0x11, 0x90, 0x88, 0x30, -+0xE0, 0xB4, 0x08, 0x0D, 0x90, 0x8A, 0xB9, 0x12, -+0x96, 0x47, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, -+0x7E, 0xF1, 0xCA, 0x71, 0xE2, 0x7D, 0x01, 0x12, -+0x04, 0x7E, 0x12, 0xE4, 0x3E, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x75, 0x64, 0x01, 0x90, 0x05, 0x27, -+0xE5, 0x64, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x2F, 0xE0, 0x90, -+0x97, 0x17, 0xF0, 0x6F, 0x70, 0x02, 0x61, 0x77, -+0xEF, 0x14, 0x60, 0x42, 0x14, 0x60, 0x6E, 0x14, -+0x70, 0x02, 0x61, 0x22, 0x14, 0x70, 0x02, 0x61, -+0x4D, 0x24, 0x04, 0x60, 0x02, 0x61, 0x77, 0x90, -+0x97, 0x17, 0xE0, 0xB4, 0x04, 0x04, 0xD1, 0x70, -+0x61, 0x77, 0x90, 0x97, 0x17, 0xE0, 0xB4, 0x02, -+0x04, 0xD1, 0xA8, 0x61, 0x77, 0x90, 0x97, 0x17, -+0xE0, 0xB4, 0x03, 0x04, 0xD1, 0xAD, 0x61, 0x77, -+0x90, 0x97, 0x17, 0xE0, 0x64, 0x01, 0x60, 0x02, -+0x61, 0x77, 0xD1, 0x72, 0x61, 0x77, 0x90, 0x97, -+0x17, 0xE0, 0xB4, 0x04, 0x04, 0xD1, 0x7F, 0x61, -+0x77, 0x90, 0x97, 0x17, 0xE0, 0xB4, 0x02, 0x05, -+0x12, 0x97, 0xCF, 0x61, 0x77, 0x90, 0x97, 0x17, -+0xE0, 0xB4, 0x03, 0x05, 0x12, 0x97, 0xE2, 0x61, -+0x77, 0x90, 0x97, 0x17, 0xE0, 0x60, 0x02, 0x61, -+0x77, 0xD1, 0x41, 0x61, 0x77, 0x90, 0x97, 0x17, -+0xE0, 0xB4, 0x04, 0x04, 0xD1, 0x95, 0x80, 0x77, -+0x90, 0x97, 0x17, 0xE0, 0xB4, 0x01, 0x05, 0x12, -+0x97, 0xBC, 0x80, 0x6B, 0x90, 0x97, 0x17, 0xE0, -+0xB4, 0x03, 0x05, 0x12, 0xE4, 0x6D, 0x80, 0x5F, -+0x90, 0x97, 0x17, 0xE0, 0x70, 0x59, 0xD1, 0x6B, -+0x80, 0x55, 0x90, 0x97, 0x17, 0xE0, 0xB4, 0x04, -+0x04, 0xD1, 0x5A, 0x80, 0x4A, 0x90, 0x97, 0x17, -+0xE0, 0xB4, 0x01, 0x04, 0xD1, 0x46, 0x80, 0x3F, -+0x90, 0x97, 0x17, 0xE0, 0xB4, 0x02, 0x04, 0xD1, -+0xC1, 0x80, 0x34, 0x90, 0x97, 0x17, 0xE0, 0x70, -+0x2E, 0xD1, 0x44, 0x80, 0x2A, 0x90, 0x97, 0x17, -+0xE0, 0xB4, 0x03, 0x04, 0xF1, 0xD3, 0x80, 0x1F, -+0x90, 0x97, 0x17, 0xE0, 0xB4, 0x01, 0x04, 0xD1, -+0x26, 0x80, 0x14, 0x90, 0x97, 0x17, 0xE0, 0xB4, -+0x02, 0x05, 0x12, 0xE4, 0x5C, 0x80, 0x08, 0x90, -+0x97, 0x17, 0xE0, 0x70, 0x02, 0xD1, 0x24, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x30, 0xE0, -+0x64, 0x02, 0x22, 0x7D, 0x03, 0x7F, 0x02, 0x02, -+0x7C, 0x05, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, -+0x03, 0x22, 0x90, 0x88, 0x2C, 0x71, 0x8A, 0x30, -+0xE0, 0x11, 0x71, 0x7C, 0x60, 0x0D, 0x90, 0x8A, -+0xB9, 0x12, 0x96, 0x47, 0x7D, 0x01, 0x7F, 0x02, -+0x12, 0x04, 0x7E, 0x71, 0x7C, 0x60, 0x02, 0xF1, -+0x6B, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0x13, 0x13, -+0x54, 0x3F, 0x22, 0x90, 0x88, 0x32, 0xE0, 0xFF, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x05, -+0x43, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, -+0x01, 0x22, 0x90, 0x01, 0x34, 0x74, 0x40, 0xF0, -+0xFD, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x43, 0x64, -+0x08, 0x22, 0x90, 0x88, 0x38, 0xE0, 0xFF, 0x90, -+0x8A, 0xB9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, -+0x8C, 0x83, 0x22, 0xAE, 0x07, 0x71, 0xC6, 0xBF, -+0x01, 0x14, 0x90, 0x88, 0x2C, 0x91, 0x14, 0x20, -+0xE0, 0x0C, 0xAF, 0x06, 0x71, 0xE7, 0x7D, 0x01, -+0x12, 0x04, 0x7E, 0x7F, 0x01, 0x22, 0x7F, 0x00, -+0x22, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x13, -+0x54, 0x03, 0x22, 0xE4, 0xF5, 0x7C, 0x90, 0x88, -+0x36, 0xE0, 0x60, 0x65, 0xD1, 0xC9, 0x70, 0x61, -+0xF1, 0xE4, 0xF0, 0x75, 0x7C, 0x01, 0x90, 0x88, -+0x2C, 0xE0, 0x30, 0xE0, 0x11, 0x90, 0x88, 0x30, -+0xE0, 0xB4, 0x02, 0x03, 0xE4, 0xF5, 0x7C, 0x71, -+0xC6, 0xEF, 0x70, 0x02, 0xF5, 0x7C, 0xE5, 0x7C, -+0x60, 0x3F, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, -+0x08, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, 0xD1, -+0xB2, 0xD1, 0xB9, 0x90, 0x88, 0x3F, 0xE0, 0x60, -+0x04, 0x64, 0x01, 0x70, 0x0F, 0x91, 0x8A, 0xFF, -+0xA3, 0xE0, 0x2F, 0x91, 0xB0, 0x91, 0x8F, 0xFF, -+0xA3, 0xE0, 0x80, 0x0B, 0x91, 0x8A, 0x91, 0x99, -+0x2F, 0x91, 0xB0, 0x91, 0x8F, 0x91, 0x99, 0x2F, -+0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4F, -+0xF0, 0x22, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, -+0x88, 0x3E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0x22, 0xFF, 0xA3, 0xE0, 0x75, 0xF0, 0x03, 0xA4, -+0x24, 0xFE, 0x22, 0xE0, 0x44, 0x02, 0xF0, 0xE4, -+0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, -+0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, -+0x54, 0x7E, 0x01, 0x02, 0x66, 0x33, 0xE4, 0x90, -+0x96, 0x1D, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, -+0x49, 0xD1, 0xC9, 0x70, 0x45, 0x12, 0xE7, 0x20, -+0xF0, 0xF1, 0xE4, 0x12, 0xE7, 0x28, 0xE4, 0x90, -+0x88, 0x3D, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0x30, -+0xE0, 0x15, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, -+0x05, 0xE4, 0x90, 0x96, 0x1D, 0xF0, 0x71, 0xC6, -+0xEF, 0x70, 0x04, 0x90, 0x96, 0x1D, 0xF0, 0x90, -+0x96, 0x1D, 0xE0, 0x60, 0x15, 0x90, 0x88, 0x39, -+0xE0, 0x20, 0xE2, 0x08, 0x90, 0x8A, 0xB9, 0x12, -+0x96, 0x47, 0xD1, 0xB2, 0xD1, 0xB9, 0x91, 0x8A, -+0x91, 0xB0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, -+0xE0, 0x05, 0x90, 0x8A, 0x8F, 0x80, 0x03, 0x90, -+0x8A, 0x87, 0x12, 0x92, 0x46, 0x90, 0x88, 0xE6, -+0xE0, 0x30, 0xE0, 0x04, 0xA3, 0xE0, 0x04, 0xF0, -+0x90, 0x88, 0xE7, 0xE0, 0x64, 0x08, 0x70, 0x20, -+0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x14, 0x12, -+0xCC, 0xD8, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, -+0x88, 0xE6, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, -+0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, -+0x91, 0x11, 0x30, 0xE0, 0x13, 0x90, 0x88, 0xE8, -+0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, -+0x04, 0x9C, 0xE4, 0xF0, 0x90, 0x88, 0xE8, 0xF0, -+0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x06, 0x90, -+0x88, 0x2E, 0x74, 0x01, 0xF0, 0x90, 0x88, 0x36, -+0xE0, 0x70, 0x02, 0xC1, 0x07, 0x90, 0x88, 0x4D, -+0xE0, 0x04, 0xF0, 0x90, 0x05, 0x61, 0x12, 0x8D, -+0xD4, 0x12, 0xC7, 0xA2, 0x90, 0x05, 0x60, 0x12, -+0x8D, 0xD4, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, -+0x12, 0x8D, 0xD4, 0x78, 0x10, 0x12, 0x03, 0xFE, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0xA3, 0x12, 0x8D, 0xD4, 0x78, -+0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0x90, -+0x88, 0x81, 0x12, 0x04, 0x31, 0x90, 0x88, 0x32, -+0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, -+0x0C, 0x12, 0xBC, 0x89, 0x74, 0x05, 0xF0, 0x12, -+0x6E, 0x2F, 0x12, 0xDD, 0xE9, 0x90, 0x88, 0x32, -+0x91, 0x92, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, -+0xE0, 0x30, 0xE4, 0x03, 0x12, 0x8F, 0xFC, 0x90, -+0x8A, 0xE5, 0x12, 0x96, 0x47, 0x7F, 0x01, 0x12, -+0x04, 0x7E, 0x90, 0x93, 0x3B, 0xE0, 0x30, 0xE0, -+0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, -+0x12, 0x8F, 0xFC, 0x22, 0xD1, 0x41, 0x90, 0x8A, -+0xF9, 0x12, 0x96, 0x47, 0x7D, 0x1F, 0x7F, 0x6F, -+0x12, 0x04, 0x7E, 0x90, 0x05, 0x27, 0xE0, 0x54, -+0xBF, 0xF0, 0x90, 0x88, 0x2F, 0x74, 0x04, 0xF0, -+0x22, 0x02, 0x97, 0xDB, 0xD1, 0x41, 0x90, 0x8A, -+0xF9, 0x12, 0x96, 0x47, 0x7D, 0x21, 0x7F, 0xFF, -+0x12, 0x04, 0x7E, 0x90, 0x88, 0x2F, 0x74, 0x03, -+0xF0, 0x22, 0x90, 0x8A, 0xF9, 0x12, 0x96, 0x47, -+0x7D, 0x22, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0xD1, -+0x8D, 0x80, 0xE8, 0xD1, 0x41, 0x02, 0x97, 0xBC, -+0xD1, 0x7F, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, -+0xF0, 0xE4, 0x90, 0x88, 0x2F, 0xF0, 0x22, 0x90, -+0x8A, 0xF9, 0x12, 0x96, 0x47, 0x12, 0x97, 0xEB, -+0xD1, 0x8D, 0x02, 0x97, 0xDB, 0x90, 0x05, 0x27, -+0xE0, 0x44, 0x40, 0xF0, 0x22, 0xD1, 0x8D, 0x90, -+0x8A, 0xF9, 0x12, 0x96, 0x47, 0x7D, 0x23, 0x12, -+0xE2, 0x74, 0x12, 0x92, 0x46, 0x02, 0x97, 0xC8, -+0x12, 0x97, 0xCF, 0x80, 0xC5, 0x12, 0x97, 0xE2, -+0x80, 0xC0, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x04, -+0x7E, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, -+0x22, 0x90, 0x86, 0x0C, 0x12, 0x92, 0x46, 0x80, -+0x8A, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x64, -+0x01, 0x22, 0xD1, 0xC9, 0x70, 0x12, 0x90, 0x88, -+0x36, 0xE0, 0x60, 0x0C, 0x90, 0x88, 0x3A, 0xE0, -+0x20, 0xE4, 0x05, 0x12, 0xBF, 0x93, 0x91, 0xA6, -+0x22, 0x71, 0xBB, 0x30, 0xE0, 0x0C, 0xEF, 0xC4, -+0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x03, 0x12, -+0x8F, 0xF5, 0x12, 0x8F, 0xD9, 0x30, 0xE0, 0x09, -+0x12, 0xBF, 0xB5, 0x54, 0x07, 0x70, 0x3E, 0x80, -+0x3A, 0x12, 0xE5, 0xEF, 0x9F, 0x40, 0x34, 0xD1, -+0xC9, 0x70, 0x32, 0xF1, 0x64, 0x70, 0x08, 0x90, -+0x8A, 0xF5, 0x12, 0x92, 0x46, 0x80, 0x27, 0x90, -+0x8A, 0xF5, 0x12, 0x92, 0x46, 0x90, 0x88, 0x40, -+0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, -+0x09, 0xF1, 0x46, 0xE4, 0x90, 0x88, 0x40, 0xF0, -+0x80, 0x03, 0x12, 0x73, 0x8F, 0xE4, 0x90, 0x88, -+0x3F, 0xF0, 0x22, 0xF1, 0x4E, 0x22, 0x90, 0x88, -+0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x88, -+0x2C, 0xE0, 0x90, 0x88, 0x38, 0x30, 0xE0, 0x04, -+0xE0, 0xFF, 0x61, 0xF3, 0x71, 0xE5, 0x7D, 0x01, -+0x02, 0x04, 0x7E, 0xF0, 0x90, 0x88, 0x34, 0xE0, -+0x54, 0x0F, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x64, -+0x02, 0x60, 0x12, 0xF1, 0x64, 0x60, 0x0E, 0x12, -+0x7A, 0x65, 0xEF, 0x70, 0x08, 0x90, 0x8A, 0xB9, -+0x12, 0x96, 0x47, 0xF1, 0xC3, 0x22, 0x90, 0x88, -+0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xCD, 0x90, -+0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x2B, 0x90, -+0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x23, 0xF1, -+0x64, 0x60, 0x11, 0x90, 0x8A, 0xB9, 0x12, 0x96, -+0x47, 0xF1, 0xC3, 0x90, 0x8B, 0x01, 0x12, 0xD5, -+0xAA, 0x02, 0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, -+0x70, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, -+0xD1, 0xB2, 0x22, 0xE4, 0xFD, 0x7F, 0x0C, 0x02, -+0x04, 0x7E, 0x12, 0x7A, 0x65, 0xEF, 0x70, 0x02, -+0xF1, 0x86, 0x22, 0x90, 0x8A, 0xF9, 0x12, 0x96, -+0x47, 0x7D, 0x25, 0xC1, 0x2E, 0x8B, 0x61, 0x8A, -+0x62, 0x89, 0x63, 0x22, 0x90, 0x05, 0x63, 0xE0, -+0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, 0x62, 0xE0, -+0x90, 0x88, 0x8A, 0xF0, 0x90, 0x05, 0x61, 0xE0, -+0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, 0x60, 0xE0, -+0x90, 0x88, 0x8C, 0xF0, 0x90, 0x88, 0x32, 0xE0, -+0x44, 0x80, 0x22, 0x12, 0xB7, 0xDD, 0x90, 0x93, -+0xE0, 0xE0, 0x54, 0xFE, 0x12, 0x87, 0x61, 0xFC, -+0x30, 0xE0, 0x45, 0x90, 0x93, 0xE1, 0xE0, 0x44, -+0x01, 0xFE, 0xF0, 0x12, 0x02, 0x06, 0x54, 0xFE, -+0xFD, 0xEE, 0x54, 0x01, 0x4D, 0x90, 0x93, 0xE1, -+0xF0, 0x12, 0x87, 0xAE, 0x90, 0x93, 0xE2, 0xF0, -+0xEC, 0xC3, 0x13, 0x54, 0x7F, 0xFF, 0xA3, 0xF0, -+0x12, 0x87, 0xB9, 0xFE, 0xC3, 0x9F, 0x90, 0x93, -+0xE4, 0xF0, 0xA3, 0xEE, 0xF0, 0xBE, 0x64, 0x04, -+0x74, 0x01, 0xF0, 0x22, 0x90, 0x93, 0xE5, 0xE0, -+0x64, 0x96, 0x70, 0x54, 0x74, 0x03, 0xF0, 0x22, -+0x90, 0x93, 0xE1, 0xE0, 0x54, 0xFE, 0x12, 0xB0, -+0xEE, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0xD5, -+0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, -+0xFE, 0xFF, 0xEE, 0x54, 0x01, 0x4F, 0xF0, 0x12, -+0x87, 0xAE, 0x90, 0x93, 0xD6, 0xF0, 0x12, 0x87, -+0xB9, 0x90, 0x93, 0xD7, 0xF0, 0xE4, 0xA3, 0xF0, -+0x90, 0x93, 0xD7, 0xE0, 0xFF, 0xB4, 0x64, 0x05, -+0x74, 0x01, 0xF0, 0x80, 0x0A, 0xEF, 0xB4, 0x96, -+0x06, 0x90, 0x93, 0xD7, 0x74, 0x03, 0xF0, 0x90, -+0x93, 0xD7, 0xE0, 0x04, 0x90, 0x93, 0xDA, 0xF0, -+0x22, 0x31, 0x1A, 0x90, 0x93, 0x03, 0xE0, 0x54, -+0xFE, 0x4E, 0xF0, 0x30, 0xE0, 0x27, 0xEF, 0x54, -+0x04, 0x25, 0xE0, 0xFE, 0xE0, 0x54, 0xF7, 0x4E, -+0xFE, 0xF0, 0xEF, 0x54, 0x02, 0x25, 0xE0, 0xFF, -+0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x90, 0x04, 0x57, -+0xE0, 0x90, 0x93, 0x05, 0xF0, 0x90, 0x04, 0x55, -+0xE0, 0x90, 0x93, 0x04, 0xF0, 0x90, 0x93, 0x03, -+0xE0, 0x54, 0x01, 0xFF, 0xEF, 0x90, 0x07, 0xDC, -+0x60, 0x25, 0xE4, 0xF0, 0xF0, 0x90, 0x07, 0xDE, -+0xF0, 0xA3, 0x04, 0xF0, 0x90, 0x07, 0xDD, 0x74, -+0x03, 0xF0, 0x90, 0x07, 0xE3, 0xE0, 0xF0, 0xA3, -+0x74, 0x50, 0xF0, 0xA3, 0x74, 0x10, 0xF0, 0x90, -+0x07, 0xDC, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xE4, -+0xF0, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x01, -+0xFE, 0x22, 0x12, 0xAF, 0x3F, 0xFF, 0x12, 0x87, -+0xAE, 0xFE, 0x54, 0x03, 0xFD, 0xEE, 0x13, 0x13, -+0x54, 0x07, 0xFB, 0xC0, 0x03, 0x12, 0x87, 0xB4, -+0x54, 0x0F, 0x90, 0x96, 0xF8, 0xF0, 0xD0, 0x03, -+0x31, 0x6C, 0x12, 0x87, 0xA9, 0xFE, 0x54, 0x03, -+0x12, 0x8D, 0xDB, 0x90, 0x95, 0x56, 0x74, 0x10, -+0xF0, 0x90, 0x95, 0x78, 0x74, 0x07, 0xF0, 0x12, -+0x93, 0xC7, 0x90, 0x95, 0x58, 0xF0, 0x7B, 0x01, -+0x7A, 0x95, 0x79, 0x56, 0x12, 0x96, 0x35, 0x7F, -+0x04, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xF5, 0xEF, 0xF0, -+0xED, 0x64, 0x01, 0x70, 0x30, 0xEB, 0xB4, 0x01, -+0x07, 0xE0, 0x24, 0x02, 0xF5, 0x10, 0x80, 0x08, -+0x90, 0x96, 0xF5, 0xE0, 0x24, 0xFE, 0xF5, 0x10, -+0x90, 0x96, 0x96, 0x12, 0x04, 0x3D, 0x00, 0x00, -+0x00, 0xFF, 0xAF, 0x10, 0xE4, 0xFC, 0xFD, 0xFE, -+0x51, 0x5A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, -+0xFF, 0xAF, 0x10, 0x80, 0x1E, 0x90, 0x96, 0x96, -+0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, -+0x96, 0xF5, 0x12, 0x8D, 0xD4, 0x51, 0x5A, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x96, -+0xF5, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, -+0x96, 0x9A, 0x12, 0x04, 0x31, 0x7D, 0x18, 0x7C, -+0x00, 0x7F, 0x01, 0x31, 0xE2, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x96, 0x94, 0xEC, 0xF0, 0xA3, 0xED, -+0xF0, 0x90, 0x96, 0x93, 0xEF, 0xF0, 0xA3, 0xA3, -+0xE0, 0xFD, 0x12, 0x7B, 0xBD, 0x90, 0x96, 0x9E, -+0x12, 0x04, 0x31, 0x90, 0x96, 0x96, 0x12, 0x04, -+0xB8, 0x12, 0x03, 0xCD, 0x90, 0x96, 0x9E, 0x12, -+0x8F, 0x98, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x96, 0x96, 0x12, 0x04, 0xB8, -+0x90, 0x96, 0x9A, 0x12, 0x8F, 0x98, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, -+0x20, 0x90, 0x96, 0xA2, 0x12, 0x04, 0x31, 0x90, -+0x96, 0x94, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, -+0x96, 0xA2, 0x12, 0x04, 0xB8, 0x90, 0x8B, 0x9F, -+0x12, 0x04, 0x31, 0x90, 0x96, 0x93, 0xE0, 0xFF, -+0xD0, 0x05, 0x12, 0x79, 0x53, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x96, 0x9A, 0x12, 0x04, 0x31, -+0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x31, 0xE2, -+0x90, 0x96, 0x96, 0x22, 0x8F, 0x65, 0x90, 0x05, -+0x22, 0xE0, 0x90, 0x95, 0x53, 0xF0, 0x7B, 0x17, -+0x12, 0x92, 0x3D, 0xEF, 0x64, 0x01, 0x70, 0x37, -+0xE5, 0x65, 0x12, 0xA7, 0xBB, 0xE0, 0xFC, 0x51, -+0xC6, 0x71, 0xE9, 0x31, 0x6C, 0x51, 0xC6, 0x12, -+0x8D, 0xDB, 0xE5, 0x65, 0x12, 0xA7, 0xD2, 0x54, -+0x07, 0xFF, 0x60, 0x03, 0xBF, 0x02, 0x0F, 0xE5, -+0x65, 0x12, 0xA7, 0xA4, 0xE0, 0xFF, 0x7E, 0x00, -+0xE4, 0xFB, 0xFD, 0x12, 0xA4, 0x70, 0xAD, 0x65, -+0x7F, 0x01, 0x71, 0x62, 0x7F, 0x01, 0x22, 0x90, -+0x95, 0x53, 0xE0, 0xFD, 0x7B, 0x49, 0xE4, 0xFF, -+0x12, 0x97, 0x56, 0x7F, 0x00, 0x22, 0xE5, 0x65, -+0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5C, 0xF5, 0x82, -+0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFE, 0x54, -+0x03, 0x22, 0xE4, 0x90, 0x96, 0xFD, 0xF0, 0xA3, -+0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0xFF, -+0xF0, 0x7B, 0x47, 0x7D, 0xFF, 0xE4, 0xFF, 0x12, -+0x97, 0x56, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x1B, -+0xA3, 0xE0, 0x70, 0x17, 0xA3, 0xE0, 0x70, 0x13, -+0xA3, 0xE0, 0x70, 0x0F, 0x90, 0x96, 0xFF, 0xE0, -+0xFD, 0x7B, 0x48, 0xE4, 0xFF, 0x12, 0x97, 0x56, -+0x7F, 0x01, 0x22, 0x12, 0xB4, 0x11, 0x30, 0xE0, -+0x19, 0xD3, 0x90, 0x96, 0xFE, 0xE0, 0x94, 0x03, -+0x90, 0x96, 0xFD, 0xE0, 0x94, 0x00, 0x40, 0x06, -+0x71, 0x55, 0x7B, 0x5A, 0x80, 0x17, 0x7F, 0x01, -+0x80, 0x17, 0xD3, 0x90, 0x96, 0xFE, 0xE0, 0x94, -+0xE8, 0x90, 0x96, 0xFD, 0xE0, 0x94, 0x03, 0x40, -+0x06, 0x71, 0x55, 0x7B, 0x5B, 0x41, 0xBE, 0x7F, -+0x32, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, 0x96, -+0xFD, 0x71, 0xE2, 0x80, 0x9D, 0x90, 0x01, 0xC0, -+0xE0, 0x44, 0x20, 0xF0, 0x90, 0x96, 0xFF, 0xE0, -+0xFD, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x96, 0x24, 0xED, 0xF0, 0x90, 0x96, -+0x23, 0xEF, 0xF0, 0x64, 0x02, 0x70, 0x24, 0x90, -+0x05, 0x22, 0xE0, 0x90, 0x96, 0x25, 0xF0, 0x7B, -+0x4A, 0x7D, 0x6F, 0x12, 0x92, 0x3F, 0xBF, 0x01, -+0x07, 0x90, 0x04, 0xD4, 0x74, 0xFF, 0x80, 0x48, -+0x90, 0x96, 0x25, 0xE0, 0xFD, 0x7B, 0x46, 0x51, -+0xBE, 0x80, 0x42, 0x90, 0x96, 0x23, 0xE0, 0x64, -+0x01, 0x70, 0x31, 0x12, 0x97, 0x52, 0x90, 0x96, -+0x24, 0xE0, 0xFF, 0x75, 0xF0, 0x1B, 0xA4, 0x24, -+0x60, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0xE0, 0xF4, 0x90, 0x04, 0xD4, 0xF0, 0xEF, 0x75, -+0xF0, 0x1B, 0xA4, 0x24, 0x61, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0xF5, 0x83, 0xE0, 0xF4, 0x90, 0x04, -+0xD5, 0xF0, 0x80, 0x07, 0x90, 0x04, 0xD4, 0xE4, -+0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x02, -+0xE7, 0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, 0xFB, -+0x90, 0x93, 0x58, 0xE0, 0xFE, 0xC4, 0x54, 0x0F, -+0x90, 0x96, 0xF8, 0xF0, 0xAF, 0x04, 0x22, 0xE4, -+0x90, 0x96, 0x1F, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, -+0x12, 0x7B, 0x41, 0x90, 0x96, 0x1E, 0xEF, 0xF0, -+0x7F, 0x83, 0x12, 0x7B, 0x41, 0xAE, 0x07, 0x90, -+0x96, 0x1E, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, -+0xC3, 0x90, 0x96, 0x20, 0xE0, 0x94, 0x64, 0x90, -+0x96, 0x1F, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, -+0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x96, -+0x1E, 0xE0, 0xFF, 0x22, 0x90, 0x96, 0x1F, 0x71, -+0xE2, 0x80, 0xC3, 0x71, 0xFF, 0x90, 0x96, 0x1D, -+0xEF, 0xF0, 0x90, 0x8A, 0x89, 0x30, 0xE0, 0x13, -+0x12, 0x96, 0x47, 0x7D, 0x01, 0xE4, 0xFF, 0x12, -+0x04, 0x7E, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x04, -+0xF0, 0x80, 0x06, 0x12, 0x96, 0x47, 0x12, 0x97, -+0xEB, 0x90, 0x96, 0x1D, 0xE0, 0x30, 0xE6, 0x11, -+0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, -+0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, -+0xF0, 0x91, 0x89, 0x74, 0x02, 0xF0, 0x02, 0x6E, -+0x2F, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, -+0xFD, 0x90, 0x88, 0x4F, 0xE0, 0xFB, 0x90, 0x92, -+0x98, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, -+0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -+0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x01, 0xC4, 0x74, 0x9A, 0xF0, 0x74, 0xBC, 0xA3, -+0xF0, 0x12, 0x75, 0x50, 0xE5, 0x3D, 0x30, 0xE0, -+0x03, 0x12, 0xDF, 0xBE, 0xE5, 0x3D, 0x30, 0xE1, -+0x02, 0xF1, 0xA9, 0xE5, 0x3D, 0x30, 0xE2, 0x02, -+0xB1, 0xC1, 0xE5, 0x3D, 0x30, 0xE4, 0x02, 0xF1, -+0x6C, 0xE5, 0x3D, 0x30, 0xE5, 0x02, 0xF1, 0x6A, -+0xE5, 0x3E, 0x30, 0xE0, 0x02, 0x91, 0x43, 0xE5, -+0x3E, 0x30, 0xE3, 0x02, 0xB1, 0x75, 0xE5, 0x3E, -+0x30, 0xE4, 0x03, 0x12, 0xDF, 0xD1, 0xE5, 0x3F, -+0x30, 0xE1, 0x02, 0xD1, 0xF4, 0xE5, 0x3F, 0x30, -+0xE0, 0x02, 0xD1, 0x85, 0xE5, 0x3F, 0x30, 0xE4, -+0x02, 0xF1, 0x6B, 0xE5, 0x3F, 0x30, 0xE2, 0x0A, -+0x12, 0xDB, 0x87, 0x90, 0x07, 0x8F, 0xE0, 0x44, -+0x10, 0xF0, 0xE5, 0x40, 0x30, 0xE1, 0x0B, 0x90, -+0x8A, 0xE5, 0x12, 0x96, 0x47, 0x7F, 0x04, 0x12, -+0x04, 0x7E, 0xE5, 0x40, 0x30, 0xE4, 0x02, 0xB1, -+0x95, 0xE5, 0x40, 0x30, 0xE5, 0x02, 0xD1, 0x49, -+0xE5, 0x40, 0x30, 0xE6, 0x02, 0xF1, 0xCE, 0xE5, -+0x40, 0x30, 0xE7, 0x03, 0x12, 0xDB, 0xC9, 0x74, -+0x9A, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBC, -+0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, -+0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, -+0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x01, 0x8C, -+0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, -+0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, -+0x54, 0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, -+0xE0, 0x44, 0x04, 0xF0, 0x22, 0x12, 0xB4, 0xBE, -+0x12, 0x8F, 0xC2, 0x7F, 0x01, 0xB1, 0xE6, 0x90, -+0x8B, 0x07, 0x12, 0x92, 0x46, 0x90, 0x93, 0x3B, -+0xE0, 0x30, 0xE0, 0x14, 0xF1, 0x77, 0x90, 0x93, -+0x3E, 0xE0, 0x60, 0x05, 0x14, 0xF0, 0x02, 0x79, -+0xD4, 0xF1, 0x89, 0xE4, 0xFF, 0x12, 0x87, 0xE0, -+0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x14, 0x90, -+0x06, 0x92, 0xE0, 0x30, 0xE1, 0x08, 0x90, 0x8B, -+0x01, 0x12, 0x92, 0x46, 0x80, 0x05, 0xF1, 0x6F, -+0x12, 0xB7, 0x4E, 0x90, 0x93, 0x5A, 0xE0, 0xB4, -+0x01, 0x03, 0x12, 0xA5, 0x96, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, -+0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x27, 0x90, 0x96, -+0x70, 0x74, 0x1E, 0xF0, 0x90, 0x96, 0x92, 0x74, -+0x01, 0xF0, 0x90, 0x96, 0x72, 0xEF, 0xF0, 0x7B, -+0x01, 0x7A, 0x96, 0x79, 0x70, 0xF1, 0xC1, 0x12, -+0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, 0x96, 0x47, -+0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, -+0x10, 0xA3, 0x74, 0x01, 0xF0, 0x90, 0x88, 0x2C, -+0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0xD1, -+0xD9, 0x12, 0xB4, 0x1B, 0xE4, 0xFF, 0xB1, 0xE6, -+0x90, 0x8B, 0x07, 0x12, 0x92, 0x46, 0x02, 0x8B, -+0xA3, 0x90, 0x88, 0x31, 0x12, 0xB3, 0x8A, 0x30, -+0xE0, 0x32, 0xEF, 0x54, 0xBF, 0xF1, 0x80, 0x30, -+0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, -+0xE0, 0x54, 0xFE, 0xF1, 0x9E, 0x74, 0x04, 0xF0, -+0x90, 0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, -+0x07, 0x30, 0xE0, 0x0D, 0x90, 0x8A, 0xB9, 0x12, -+0x96, 0x47, 0x7D, 0x01, 0x7F, 0x0C, 0x02, 0x04, -+0x7E, 0x12, 0xB7, 0x4E, 0x22, 0x90, 0x88, 0x2C, -+0xE0, 0xFF, 0x30, 0xE0, 0x4B, 0x90, 0x88, 0x30, -+0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, -+0x90, 0x88, 0x2F, 0xE0, 0x7D, 0x00, 0xB4, 0x04, -+0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x31, 0xEF, -+0xC3, 0x13, 0x30, 0xE0, 0x02, 0x80, 0x2A, 0x12, -+0xB3, 0x92, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x08, -+0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, 0xE4, -+0xFD, 0x7F, 0x0C, 0x80, 0x10, 0x90, 0x88, 0x30, -+0xE0, 0x70, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x96, -+0x47, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x12, 0xB3, 0xC6, 0xBF, 0x01, 0x04, 0x7F, 0x01, -+0x80, 0x02, 0x7F, 0x02, 0x12, 0xB2, 0x6C, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x2C, 0xE0, -+0xFF, 0x30, 0xE0, 0x4A, 0x90, 0x88, 0x30, 0xE0, -+0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, -+0x88, 0x2F, 0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, -+0x7D, 0x01, 0xED, 0x4E, 0x70, 0x30, 0xEF, 0xC3, -+0x13, 0x30, 0xE0, 0x02, 0x80, 0xBB, 0xF1, 0x47, -+0x90, 0x88, 0x30, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, -+0x8A, 0xB9, 0x12, 0x96, 0x47, 0xE4, 0xFD, 0x7F, -+0x08, 0x80, 0x10, 0x90, 0x88, 0x30, 0xE0, 0xB4, -+0x04, 0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, -+0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x22, 0x90, -+0x01, 0x57, 0xE0, 0x60, 0x1C, 0xF1, 0x96, 0xF0, -+0x12, 0x8F, 0xD9, 0x30, 0xE0, 0x02, 0x80, 0x5D, -+0x12, 0xE5, 0xEF, 0x9F, 0x40, 0x0B, 0xE4, 0xFF, -+0x12, 0x78, 0x4A, 0xBF, 0x01, 0x03, 0x12, 0xB7, -+0x46, 0x22, 0x22, 0x22, 0x02, 0x34, 0x78, 0x90, -+0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x90, -+0x93, 0x3D, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, -+0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0x32, -+0x22, 0x90, 0x93, 0x3C, 0xE0, 0x14, 0x90, 0x93, -+0x3E, 0xF0, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, -+0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0xF0, 0x90, -+0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, -+0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, -+0xB6, 0xE9, 0x02, 0xA5, 0x96, 0xEF, 0x54, 0xFB, -+0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, 0xF0, -+0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, -+0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x90, 0x88, -+0x31, 0xE0, 0xFF, 0x12, 0xA3, 0x5C, 0x30, 0xE0, -+0x1E, 0xEF, 0x54, 0x7F, 0xF1, 0x80, 0x30, 0xE1, -+0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, -+0x54, 0xFD, 0xF1, 0x9E, 0x04, 0xF0, 0x90, 0x88, -+0x36, 0xE0, 0x60, 0x03, 0x12, 0xB7, 0x4E, 0x90, -+0x88, 0xA1, 0x12, 0xB3, 0x8A, 0x30, 0xE0, 0x22, -+0x90, 0x88, 0xA4, 0xE0, 0xFF, 0xC3, 0x13, 0x30, -+0xE0, 0x18, 0xEF, 0x54, 0xFD, 0xF0, 0x90, 0x04, -+0xE0, 0xE0, 0x90, 0x88, 0xA4, 0x30, 0xE1, 0x06, -+0xE0, 0x44, 0x04, 0xF0, 0x80, 0x04, 0xE0, 0x54, -+0xFB, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, -+0x03, 0x12, 0xA7, 0x28, 0x22, 0x12, 0x02, 0x06, -+0xFF, 0x90, 0x93, 0x3A, 0xF0, 0xBF, 0x01, 0x07, -+0x11, 0x40, 0xE4, 0x90, 0x93, 0x3A, 0xF0, 0x22, -+0x11, 0xEB, 0x7F, 0xEF, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xBF, 0x01, 0x06, 0x90, 0x95, 0x53, 0xE0, -+0xA3, 0xF0, 0x11, 0xEB, 0x7F, 0xEE, 0x7E, 0x01, -+0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, -+0x53, 0xE0, 0x90, 0x95, 0x55, 0xF0, 0x11, 0xEB, -+0x7F, 0xED, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -+0x01, 0x08, 0x90, 0x95, 0x53, 0xE0, 0x90, 0x95, -+0x56, 0xF0, 0x11, 0xEB, 0x7F, 0xEC, 0x7E, 0x01, -+0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, -+0x53, 0xE0, 0x90, 0x95, 0x57, 0xF0, 0x11, 0xEB, -+0x7F, 0xEB, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -+0x01, 0x08, 0x90, 0x95, 0x53, 0xE0, 0x90, 0x95, -+0x58, 0xF0, 0x90, 0x95, 0x54, 0xE0, 0xFF, 0xA3, -+0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, -+0x95, 0x5C, 0xF0, 0x90, 0x95, 0x58, 0xE0, 0x90, -+0x95, 0x5D, 0xF0, 0x90, 0x95, 0x5E, 0x74, 0x12, -+0xF0, 0x90, 0x95, 0x80, 0x74, 0x05, 0xF0, 0x90, -+0x95, 0x60, 0x12, 0xAF, 0xDE, 0x90, 0x95, 0x5C, -+0xE0, 0x90, 0x95, 0x63, 0xF0, 0x90, 0x95, 0x5D, -+0xE0, 0x90, 0x95, 0x64, 0xF0, 0x7B, 0x01, 0x7A, -+0x95, 0x79, 0x5E, 0x12, 0x96, 0x35, 0x7F, 0x04, -+0x02, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x53, 0x22, 0x7E, 0x00, 0x7F, 0x0B, 0x7D, 0x00, -+0x7B, 0x01, 0x7A, 0x93, 0x79, 0xE7, 0x12, 0x04, -+0x80, 0x11, 0xEB, 0x91, 0x06, 0xBF, 0x01, 0x1C, -+0x90, 0x95, 0x53, 0xE0, 0xFE, 0x54, 0x01, 0x90, -+0x93, 0xE7, 0xF0, 0xEE, 0x54, 0x04, 0x90, 0x93, -+0xE9, 0xF0, 0x90, 0x95, 0x53, 0xE0, 0x54, 0x08, -+0x90, 0x93, 0xE8, 0xF0, 0x11, 0xEB, 0x31, 0x7A, -+0x70, 0x35, 0x90, 0x95, 0x53, 0xE0, 0x54, 0x07, -+0x70, 0x15, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x54, -+0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -+0x01, 0x0F, 0x90, 0x95, 0x54, 0x80, 0x03, 0x90, -+0x95, 0x53, 0xE0, 0x54, 0x07, 0x90, 0x93, 0xEB, -+0xF0, 0x90, 0x95, 0x53, 0xE0, 0x54, 0xE0, 0xC4, -+0x13, 0x54, 0x07, 0x90, 0x93, 0xEA, 0xF0, 0x11, -+0xEB, 0x7F, 0xFD, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -+0xBF, 0x01, 0x0E, 0x90, 0x95, 0x53, 0xE0, 0x54, -+0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x93, 0xEC, -+0xF0, 0x22, 0x7F, 0xFB, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xEF, 0x64, 0x01, 0x22, 0x90, 0x95, 0x53, -+0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, -+0x7F, 0xF4, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -+0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, 0x95, -+0x9C, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, -+0x7F, 0xF5, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -+0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, 0x95, -+0x9D, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, -+0x7F, 0xF6, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -+0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, 0x95, -+0x9E, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, -+0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -+0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, 0x95, -+0x9F, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, -+0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -+0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, 0x95, -+0xA0, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, -+0x91, 0x06, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x9A, -+0xE0, 0x90, 0x95, 0xA1, 0xF0, 0x7B, 0x01, 0x7A, -+0x95, 0x79, 0x9A, 0x31, 0x7A, 0x70, 0x52, 0x90, -+0x95, 0x9A, 0xE0, 0x90, 0x95, 0xA2, 0xF0, 0x54, -+0x07, 0x60, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x54, -+0xE0, 0x70, 0x3E, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x9B, 0x7F, 0xFA, 0x31, 0x7C, 0x70, 0x32, 0x90, -+0x95, 0x9A, 0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, -+0x90, 0x95, 0xA2, 0xE0, 0xFE, 0x90, 0x95, 0x9B, -+0xE0, 0x54, 0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x95, -+0xA2, 0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, -+0x95, 0xA2, 0xE0, 0xFF, 0x90, 0x95, 0x9B, 0xE0, -+0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x95, 0xA2, -+0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9A, 0x7F, -+0xFD, 0x31, 0x7C, 0x70, 0x46, 0x90, 0x95, 0x9A, -+0xE0, 0xFE, 0x54, 0xCC, 0x90, 0x95, 0xA3, 0xF0, -+0xEE, 0x54, 0x0C, 0xFF, 0x60, 0x08, 0x90, 0x95, -+0x9A, 0xE0, 0x54, 0xC0, 0x70, 0x2D, 0xEF, 0x70, -+0x11, 0x90, 0x95, 0xA3, 0xE0, 0xFF, 0x90, 0x95, -+0x9A, 0xE0, 0x54, 0x03, 0xF1, 0x6C, 0x90, 0x95, -+0xA3, 0xF0, 0x90, 0x95, 0x9A, 0xE0, 0xFF, 0x54, -+0xC0, 0x70, 0x10, 0x90, 0x95, 0xA3, 0xE0, 0xFE, -+0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, -+0xEE, 0x4F, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x9A, 0x7F, 0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -+0xBF, 0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, -+0x95, 0xA4, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x9A, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -+0xBF, 0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, -+0x95, 0xA5, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x9A, 0x7F, 0xF2, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -+0xBF, 0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, -+0x95, 0xA6, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x9A, 0x7F, 0xF3, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -+0xBF, 0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, -+0x95, 0xA7, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x9A, 0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -+0xBF, 0x01, 0x08, 0x90, 0x95, 0x9A, 0xE0, 0x90, -+0x95, 0xA8, 0xF0, 0x90, 0x95, 0x54, 0x74, 0x19, -+0xF0, 0x90, 0x95, 0x76, 0x74, 0x08, 0xF0, 0x90, -+0x95, 0x9C, 0xE0, 0x90, 0x95, 0x56, 0xF0, 0x90, -+0x95, 0x9D, 0xE0, 0x90, 0x95, 0x57, 0xF0, 0x90, -+0x95, 0x9E, 0xE0, 0x90, 0x95, 0x58, 0xF0, 0x90, -+0x95, 0x9F, 0xE0, 0x90, 0x95, 0x59, 0xF0, 0x90, -+0x95, 0xA0, 0xE0, 0x90, 0x95, 0x5A, 0xF0, 0x90, -+0x95, 0xA1, 0xE0, 0x90, 0x95, 0x5B, 0xF0, 0x90, -+0x95, 0xA2, 0xE0, 0x90, 0x95, 0x5C, 0xF0, 0x90, -+0x95, 0xA3, 0xE0, 0x90, 0x95, 0x5D, 0xF0, 0x90, -+0x95, 0x77, 0x74, 0x1A, 0xF0, 0x90, 0x95, 0x99, -+0x74, 0x05, 0xF0, 0x90, 0x95, 0xA4, 0xE0, 0x90, -+0x95, 0x79, 0xF0, 0x90, 0x95, 0xA5, 0xE0, 0x90, -+0x95, 0x7A, 0xF0, 0x90, 0x95, 0xA6, 0xE0, 0x90, -+0x95, 0x7B, 0xF0, 0x90, 0x95, 0xA7, 0xE0, 0x90, -+0x95, 0x7C, 0xF0, 0x90, 0x95, 0xA8, 0xE0, 0x90, -+0x95, 0x7D, 0xF0, 0x90, 0x95, 0x53, 0xE0, 0xB4, -+0x01, 0x1A, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x54, -+0x12, 0xBF, 0xC1, 0x12, 0x04, 0x7E, 0x7B, 0x01, -+0x7A, 0x95, 0x79, 0x77, 0x12, 0x96, 0x35, 0x7F, -+0x04, 0x02, 0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, -+0x46, 0x95, 0x75, 0x47, 0x54, 0x75, 0x48, 0x0A, -+0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x69, -+0xF5, 0x75, 0x45, 0x01, 0x75, 0x46, 0x95, 0x75, -+0x47, 0x79, 0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, -+0x01, 0x79, 0xAA, 0x02, 0x69, 0xF5, 0x7F, 0xF9, -+0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x12, 0x02, 0x06, -+0x90, 0x95, 0x76, 0xF0, 0x12, 0x87, 0xAE, 0x90, -+0x95, 0x77, 0xF0, 0x60, 0x0E, 0x91, 0x59, 0x91, -+0x61, 0x90, 0x95, 0x77, 0x91, 0x59, 0x7B, 0x57, -+0x12, 0x97, 0x56, 0x90, 0x95, 0x53, 0x74, 0x20, -+0xF0, 0x90, 0x95, 0x75, 0x74, 0x03, 0xF0, 0x90, -+0x05, 0x22, 0xE0, 0x90, 0x95, 0x55, 0xF0, 0x90, -+0x93, 0xF3, 0xE0, 0x90, 0x95, 0x56, 0xF0, 0x90, -+0x93, 0xF4, 0xE0, 0x90, 0x95, 0x57, 0xF0, 0x11, -+0xEB, 0x12, 0x96, 0x35, 0x7F, 0x04, 0x02, 0x04, -+0x7E, 0xE0, 0xFF, 0x90, 0x95, 0x76, 0xE0, 0xFD, -+0x22, 0xEF, 0xB4, 0xFF, 0x06, 0x90, 0x93, 0xF3, -+0xED, 0xF0, 0x22, 0xEF, 0xF4, 0xFE, 0x90, 0x93, -+0xF3, 0xE0, 0x5E, 0xFE, 0xED, 0x5F, 0x4E, 0xF0, -+0x22, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, -+0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x12, 0xD9, 0x6F, -+0xF1, 0x95, 0x12, 0x7B, 0x79, 0x12, 0xBD, 0x75, -+0x91, 0xEC, 0x7F, 0x01, 0x12, 0x84, 0x15, 0x90, -+0x93, 0x57, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x84, -+0x15, 0x90, 0x93, 0x57, 0xE0, 0x04, 0xF0, 0x91, -+0xFE, 0x12, 0x97, 0x77, 0x90, 0x00, 0x80, 0xE0, -+0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, -+0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, 0x01, -+0xA0, 0xE0, 0xB4, 0xFD, 0x04, 0xE4, 0xFF, 0x31, -+0x85, 0xB1, 0x4B, 0x90, 0x00, 0x81, 0xE0, 0x44, -+0x04, 0xFD, 0x7F, 0x81, 0x12, 0x7B, 0x2E, 0xF1, -+0x7E, 0x11, 0xF2, 0x90, 0x00, 0xAA, 0xE0, 0x44, -+0x02, 0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, 0xE4, -+0xFF, 0x02, 0x84, 0x9E, 0xE4, 0x90, 0x86, 0xAF, -+0xF0, 0xF1, 0x65, 0x90, 0x93, 0x01, 0xF0, 0x90, -+0x93, 0xF3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x7B, -+0x1B, 0x90, 0x86, 0xB3, 0xEF, 0xF0, 0xB1, 0x18, -+0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, -+0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, 0x67, 0xD2, -+0x12, 0x76, 0x6D, 0x12, 0x75, 0xE0, 0x12, 0xD7, -+0xB1, 0x12, 0xD7, 0xEC, 0x75, 0x21, 0x80, 0xE4, -+0xF5, 0x22, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, -+0x21, 0x7F, 0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, -+0x7F, 0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, -+0x52, 0x12, 0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, -+0x02, 0x7B, 0x2E, 0xE4, 0x90, 0x95, 0x53, 0xF0, -+0xA3, 0xF0, 0xF1, 0x89, 0xEF, 0x64, 0x01, 0x60, -+0x39, 0xC3, 0x90, 0x95, 0x54, 0xE0, 0x94, 0x88, -+0x90, 0x95, 0x53, 0xE0, 0x94, 0x13, 0x40, 0x0F, -+0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, -+0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1B, 0x90, -+0x95, 0x53, 0xF1, 0xB0, 0xD3, 0x90, 0x95, 0x54, -+0xE0, 0x94, 0x32, 0x90, 0x95, 0x53, 0xE0, 0x94, -+0x00, 0x40, 0xC7, 0x90, 0x01, 0xC6, 0xE0, 0x30, -+0xE3, 0xC0, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, -+0x22, 0x12, 0x02, 0x06, 0x64, 0x01, 0x60, 0x02, -+0xC1, 0x2A, 0x90, 0x95, 0x9A, 0xF0, 0x90, 0x95, -+0x9A, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x50, 0x27, -+0xEF, 0xF1, 0x74, 0x7A, 0x95, 0x79, 0x99, 0x12, -+0x5F, 0xA6, 0xBF, 0x01, 0x12, 0x90, 0x95, 0x99, -+0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0x9B, 0xF5, 0x82, -+0xE4, 0x34, 0x95, 0xF5, 0x83, 0xEF, 0xF0, 0x90, -+0x95, 0x9A, 0xE0, 0x04, 0xF0, 0x80, 0xCF, 0x75, -+0x45, 0x01, 0x75, 0x46, 0x95, 0x75, 0x47, 0x9B, -+0x75, 0x48, 0x08, 0xD1, 0x2B, 0x12, 0x69, 0xF5, -+0x90, 0x95, 0x53, 0x74, 0x24, 0xF0, 0x90, 0x95, -+0x75, 0x74, 0x08, 0xF0, 0x75, 0x45, 0x01, 0x75, -+0x46, 0x95, 0x75, 0x47, 0xA3, 0xF5, 0x48, 0x7B, -+0x01, 0x7A, 0x95, 0x79, 0x78, 0x12, 0x69, 0xF5, -+0x90, 0x95, 0x76, 0x74, 0x25, 0xF0, 0x90, 0x95, -+0x98, 0x74, 0x08, 0xF0, 0x11, 0xEB, 0x12, 0xBF, -+0xC1, 0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x95, -+0x79, 0x76, 0x12, 0x96, 0x35, 0x7F, 0x04, 0x12, -+0x04, 0x7E, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x55, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x12, 0x87, -+0xAE, 0x90, 0x95, 0x55, 0xF0, 0x12, 0x87, 0xB9, -+0x90, 0x95, 0x56, 0x12, 0x87, 0xA2, 0x90, 0x95, -+0x57, 0x12, 0x87, 0x72, 0x90, 0x95, 0x58, 0x12, -+0x87, 0x61, 0x90, 0x95, 0x59, 0x12, 0x87, 0x68, -+0x90, 0x95, 0x5A, 0xF0, 0xEF, 0x12, 0x86, 0x4B, -+0xC6, 0x7C, 0x00, 0xC6, 0x88, 0x01, 0xC6, 0x8F, -+0x02, 0xC6, 0x96, 0x03, 0xC6, 0x9D, 0x04, 0xC6, -+0xA4, 0x05, 0xC6, 0xAE, 0x06, 0xC6, 0xD7, 0x07, -+0x00, 0x00, 0xC7, 0x35, 0x90, 0x95, 0x53, 0x74, -+0x02, 0xF0, 0xA3, 0x74, 0x29, 0xF0, 0xE1, 0x3A, -+0xF1, 0x5C, 0x74, 0x2A, 0xF0, 0xE1, 0x3A, 0xF1, -+0x54, 0x74, 0x31, 0xF0, 0xE1, 0x3A, 0xF1, 0x54, -+0x74, 0x32, 0xF0, 0xE1, 0x3A, 0xF1, 0x5C, 0x74, -+0x33, 0xF0, 0xE1, 0x3A, 0xD1, 0x2B, 0x90, 0x8A, -+0x83, 0x12, 0xBF, 0xC4, 0xE1, 0x51, 0x90, 0x95, -+0x55, 0xE0, 0x90, 0x88, 0xE1, 0xF0, 0x90, 0x95, -+0x56, 0xE0, 0x90, 0x88, 0xE2, 0xF0, 0x90, 0x95, -+0x57, 0xE0, 0x90, 0x88, 0xE3, 0xF0, 0x90, 0x95, -+0x58, 0xE0, 0x90, 0x88, 0xE4, 0xF0, 0x90, 0x95, -+0x59, 0xE0, 0x90, 0x88, 0xE5, 0xF0, 0x22, 0x90, -+0x95, 0x55, 0xE0, 0x90, 0x95, 0x42, 0xF0, 0x90, -+0x95, 0x58, 0x12, 0x8D, 0xD4, 0x78, 0x10, 0x12, -+0x03, 0xFE, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0xA3, 0x12, 0x8D, 0xD4, 0x78, 0x18, -+0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -+0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x95, -+0x57, 0x12, 0x8D, 0xD4, 0x78, 0x08, 0x12, 0x03, -+0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0x12, 0x86, 0x20, 0xF1, 0xA7, 0x90, 0x95, -+0x56, 0x12, 0x8D, 0xD4, 0x12, 0x86, 0x20, 0x90, -+0x95, 0x38, 0x02, 0x04, 0x31, 0xF1, 0x54, 0x74, -+0xFF, 0xF0, 0x90, 0x95, 0x54, 0xE0, 0xFF, 0x90, -+0x95, 0x53, 0xE0, 0xFD, 0xD1, 0x2B, 0x90, 0x8A, -+0xCF, 0xE0, 0xF8, 0xA3, 0xE0, 0xF5, 0x82, 0x88, -+0x83, 0x02, 0x04, 0x7E, 0x90, 0x95, 0x53, 0x74, -+0x01, 0xF0, 0xA3, 0x22, 0x90, 0x95, 0x53, 0x74, -+0x06, 0xF0, 0xA3, 0x22, 0xE4, 0xA3, 0xF0, 0xA3, -+0xF0, 0xA3, 0xF0, 0x22, 0x25, 0xE0, 0x25, 0xE0, -+0xFE, 0xEF, 0x4E, 0x22, 0x24, 0xA8, 0xFF, 0xE4, -+0x34, 0x01, 0xFE, 0x7B, 0x01, 0x22, 0x90, 0x01, -+0xE4, 0x74, 0x1D, 0xF0, 0xA3, 0x74, 0x02, 0xF0, -+0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, -+0xE4, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x94, -+0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, -+0xF0, 0x22, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, -+0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, -+0xE4, 0x75, 0xF0, 0x01, 0x12, 0x02, 0xE7, 0x7F, -+0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0xEF, 0xB4, -+0xFF, 0x06, 0x90, 0x93, 0xF4, 0xED, 0xF0, 0x22, -+0xEF, 0xF4, 0xFE, 0x90, 0x93, 0xF4, 0x81, 0x71, -+0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, -+0xF2, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, -+0xAF, 0x9A, 0x12, 0x93, 0xC7, 0xFF, 0x54, 0x7F, -+0x90, 0x88, 0x36, 0xF0, 0xEF, 0x12, 0xA3, 0x5C, -+0xA3, 0xF0, 0x12, 0x87, 0xAE, 0xFD, 0x54, 0xF0, -+0xC4, 0x54, 0x0F, 0xFF, 0x90, 0x88, 0x34, 0xE0, -+0x54, 0xF0, 0x4F, 0x12, 0x87, 0xA2, 0xFC, 0x54, -+0x01, 0x25, 0xE0, 0xFF, 0x90, 0x88, 0x31, 0xE0, -+0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, 0xC3, -+0x13, 0xFF, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFD, -+0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, 0xF0, -+0xFF, 0xA3, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x12, -+0x87, 0xB9, 0x90, 0x88, 0x35, 0x12, 0x87, 0x72, -+0xFD, 0x90, 0x8A, 0x89, 0x12, 0x96, 0x47, 0x7F, -+0x02, 0x12, 0x04, 0x7E, 0x12, 0xA8, 0x96, 0x12, -+0x87, 0x62, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x88, -+0x9B, 0x11, 0xC5, 0x4F, 0x12, 0x87, 0x60, 0xFE, -+0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, -+0x90, 0x88, 0x9B, 0xF0, 0xEE, 0x54, 0x08, 0xFE, -+0xEF, 0x54, 0xF7, 0x12, 0x87, 0x5F, 0x11, 0xAE, -+0x90, 0x88, 0x9B, 0x11, 0xA5, 0x12, 0x87, 0x5F, -+0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, -+0x88, 0x9B, 0xF0, 0x12, 0x5C, 0x5F, 0x90, 0x88, -+0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, -+0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xBF, 0x9F, 0xF0, -+0x90, 0x88, 0x36, 0x11, 0xB8, 0x12, 0xB7, 0x63, -+0x90, 0x01, 0xBE, 0xF0, 0x22, 0xF0, 0xEE, 0x54, -+0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x22, 0xFE, 0x54, -+0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x22, -+0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x88, 0x38, -+0xE0, 0x90, 0x01, 0xBB, 0x22, 0xE0, 0x54, 0xFE, -+0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, -+0x54, 0xFD, 0x22, 0x12, 0x02, 0x06, 0x90, 0x88, -+0x9C, 0xF0, 0x60, 0x39, 0xA3, 0xE0, 0x20, 0xE0, -+0x34, 0x90, 0x8A, 0xB9, 0x12, 0x96, 0x47, 0xE4, -+0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x88, -+0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x1D, -+0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, -+0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, 0x54, -+0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, -+0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, 0x90, 0x93, -+0x3F, 0xE0, 0x20, 0xE0, 0x02, 0x21, 0xD8, 0xE4, -+0x90, 0x95, 0x53, 0xF0, 0x31, 0xD9, 0x40, 0x02, -+0x21, 0xD8, 0x51, 0x6B, 0x80, 0x05, 0xC3, 0x33, -+0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, -+0x40, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x02, 0x21, -+0xD0, 0x12, 0x02, 0x06, 0xFF, 0x30, 0xE0, 0x1A, -+0x90, 0x93, 0x41, 0xE0, 0xFE, 0x90, 0x95, 0x53, -+0xE0, 0xFD, 0x74, 0x01, 0xA8, 0x05, 0x08, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, -+0x41, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x16, -+0x90, 0x93, 0x42, 0xE0, 0xFF, 0x90, 0x95, 0x53, -+0x12, 0xAF, 0x28, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0x4F, 0x90, 0x93, 0x42, 0xF0, 0x12, 0x87, -+0xAE, 0xFF, 0x90, 0x95, 0x53, 0xE0, 0xFE, 0x24, -+0x43, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0xEF, 0xF0, 0x12, 0x87, 0xB9, 0xFF, 0x74, 0x48, -+0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x12, 0x87, -+0x9F, 0xFF, 0x74, 0x4D, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0x12, 0x87, 0x6F, 0xFF, 0x74, 0x52, -+0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0xEF, 0xF0, 0x90, 0x93, 0x40, 0xE0, 0xFF, 0x74, -+0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x40, 0xF0, 0x22, -+0x90, 0x95, 0x53, 0xE0, 0x04, 0xF0, 0x21, 0x24, -+0x22, 0x90, 0x95, 0x53, 0xE0, 0xFF, 0xC3, 0x94, -+0x05, 0x22, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, -+0x90, 0x89, 0x2E, 0x12, 0x86, 0x42, 0x7B, 0xFF, -+0x7A, 0x80, 0x79, 0x80, 0x90, 0x89, 0x31, 0x12, -+0x86, 0x42, 0x7A, 0x80, 0x79, 0xBF, 0x90, 0x89, -+0x34, 0x12, 0x86, 0x42, 0x7A, 0x81, 0x79, 0x61, -+0x90, 0x89, 0x3A, 0x12, 0x86, 0x42, 0x7A, 0x81, -+0x79, 0x75, 0x90, 0x89, 0x3D, 0x12, 0x86, 0x42, -+0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, 0x40, 0x12, -+0x86, 0x42, 0x51, 0x5E, 0x7A, 0x81, 0x79, 0xD9, -+0x90, 0x89, 0x49, 0x12, 0x86, 0x42, 0x7A, 0x82, -+0x79, 0x01, 0x90, 0x89, 0x4C, 0x12, 0x86, 0x42, -+0xE4, 0x90, 0x96, 0x5A, 0xF0, 0x90, 0x96, 0x49, -+0xF0, 0x90, 0x95, 0x53, 0xF0, 0x31, 0xD9, 0x50, -+0x14, 0x74, 0x6B, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x96, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x95, 0x53, -+0xE0, 0x04, 0xF0, 0x80, 0xE8, 0x22, 0x7A, 0x81, -+0x79, 0xB1, 0x90, 0x89, 0x46, 0x02, 0x86, 0x42, -+0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, -+0x07, 0x08, 0x22, 0xE4, 0x90, 0x95, 0xAE, 0xF0, -+0xF1, 0xA8, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, -+0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, -+0xE4, 0xFF, 0xB1, 0xD6, 0x90, 0x93, 0x3F, 0xE0, -+0x20, 0xE0, 0x02, 0x61, 0x74, 0x12, 0x8F, 0xEE, -+0x44, 0x02, 0xB1, 0x98, 0xE4, 0x90, 0x95, 0xAF, -+0xF0, 0x90, 0x95, 0xAF, 0xE0, 0xFF, 0xC3, 0x94, -+0x05, 0x50, 0x30, 0x51, 0x6B, 0x80, 0x05, 0xC3, -+0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, -+0x93, 0x42, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x13, -+0x90, 0x95, 0xAF, 0xB1, 0x27, 0xF0, 0x90, 0x95, -+0xAF, 0xB1, 0x08, 0xF0, 0xE0, 0x44, 0x40, 0xF0, -+0x12, 0xC7, 0xB7, 0x90, 0x95, 0xAF, 0xE0, 0x04, -+0xF0, 0x80, 0xC6, 0x90, 0x07, 0xC7, 0xE4, 0xF0, -+0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, -+0x77, 0xF0, 0x90, 0x07, 0xC4, 0xE4, 0xF0, 0x90, -+0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, -+0xA3, 0xF1, 0x6D, 0x90, 0x02, 0x26, 0xE0, 0x44, -+0x01, 0xF0, 0xE0, 0x90, 0x95, 0xB0, 0xF0, 0x90, -+0x95, 0xB0, 0xE0, 0x30, 0xE0, 0x18, 0x90, 0x95, -+0xAE, 0xE0, 0x04, 0xF1, 0x65, 0x90, 0x02, 0x26, -+0xE0, 0x90, 0x95, 0xB0, 0xF0, 0x90, 0x95, 0xAE, -+0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xE1, 0x90, 0x02, -+0x03, 0x74, 0x80, 0xF0, 0x90, 0x04, 0x24, 0xE0, -+0x90, 0x95, 0xB1, 0xF0, 0x90, 0x04, 0x22, 0xE0, -+0x44, 0x10, 0xF0, 0x90, 0x02, 0x00, 0xE0, 0x90, -+0x95, 0xB0, 0xF0, 0x90, 0x02, 0x01, 0x71, 0x83, -+0x90, 0x02, 0x02, 0x71, 0x83, 0x90, 0x02, 0x14, -+0x71, 0x83, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, -+0x24, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x54, 0xEF, -+0xF0, 0x90, 0x95, 0xB1, 0xE0, 0x90, 0x04, 0x24, -+0xF0, 0x90, 0xFD, 0x09, 0x74, 0xFF, 0xF0, 0x90, -+0xFD, 0x08, 0xE4, 0xF0, 0x91, 0xD8, 0xE4, 0xFD, -+0x12, 0x76, 0xF7, 0x90, 0x88, 0x32, 0xE0, 0x54, -+0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x95, 0xB0, -+0xE0, 0x2F, 0xF0, 0x22, 0x75, 0x66, 0x14, 0x90, -+0x88, 0x32, 0xE0, 0x44, 0x10, 0xF0, 0x91, 0xD8, -+0x7D, 0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x41, -+0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, -+0x88, 0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, -+0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, -+0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, -+0x93, 0x3F, 0xE0, 0x30, 0xE0, 0x6D, 0x90, 0xFD, -+0x09, 0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, 0x90, -+0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, -+0x95, 0xAE, 0xF0, 0x90, 0x95, 0xAE, 0xE0, 0xFF, -+0xC3, 0x94, 0x05, 0x50, 0x30, 0x51, 0x6B, 0x80, -+0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xFF, 0x90, 0x93, 0x41, 0xE0, 0xFD, 0xEF, 0x5D, -+0x60, 0x13, 0x90, 0x95, 0xAE, 0xB1, 0x27, 0xF0, -+0x90, 0x95, 0xAE, 0xB1, 0x08, 0xF0, 0xE0, 0x44, -+0x20, 0xF0, 0x12, 0xC7, 0xB7, 0x90, 0x95, 0xAE, -+0xE0, 0x04, 0xF0, 0x80, 0xC6, 0x91, 0xC1, 0x54, -+0xFE, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x91, -+0xC1, 0x44, 0x08, 0xFD, 0x7F, 0x92, 0x12, 0x7B, -+0x2E, 0x12, 0x8F, 0xEE, 0x54, 0xFD, 0xFD, 0x7F, -+0x02, 0x80, 0x07, 0x91, 0xC1, 0x44, 0x01, 0xFD, -+0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x08, 0x12, -+0x7B, 0x41, 0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, -+0x12, 0x7B, 0x2E, 0x7F, 0x01, 0xB1, 0xD6, 0x90, -+0x00, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, -+0x6A, 0x7F, 0x92, 0x12, 0x7B, 0x41, 0xEF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x71, -+0x8C, 0x51, 0x73, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, -+0x01, 0xFF, 0x90, 0x88, 0xE0, 0xE0, 0xFB, 0x90, -+0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, 0xF0, 0x22, -+0x90, 0x88, 0x39, 0xE0, 0xFF, 0x60, 0x03, 0xB4, -+0x08, 0x0D, 0xD1, 0x91, 0xBF, 0x01, 0x08, 0x91, -+0xC8, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, -+0xE0, 0xFF, 0x24, 0x43, 0xF5, 0x82, 0xE4, 0x34, -+0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB2, 0xF0, -+0x74, 0x48, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, -+0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB3, 0x22, 0xE0, -+0xFF, 0x24, 0x4D, 0xF5, 0x82, 0xE4, 0x34, 0x93, -+0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, -+0x52, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -+0x83, 0xE0, 0x90, 0x01, 0xB1, 0x22, 0x90, 0x88, -+0x31, 0xE0, 0x30, 0xE0, 0x18, 0x90, 0x88, 0x2C, -+0xE0, 0xFF, 0x30, 0xE0, 0x0E, 0xC3, 0x13, 0x30, -+0xE0, 0x07, 0xF1, 0x75, 0xBF, 0x01, 0x06, 0x80, -+0x02, 0x80, 0x00, 0x91, 0xF0, 0x22, 0x7F, 0x02, -+0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, -+0x02, 0x12, 0x7B, 0x2E, 0x7F, 0x02, 0x12, 0x7B, -+0x41, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x12, -+0x7B, 0x2E, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, -+0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x7B, 0x2E, -+0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, -+0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD1, 0x84, 0x90, -+0x96, 0xED, 0x12, 0x04, 0x31, 0x90, 0x96, 0xED, -+0xD1, 0x7B, 0xD1, 0x74, 0x90, 0x01, 0x01, 0xE0, -+0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, -+0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, -+0x06, 0xB4, 0x74, 0x86, 0xF0, 0xB1, 0x90, 0xB1, -+0x66, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x97, -+0x03, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, -+0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, -+0x02, 0x7F, 0x01, 0x90, 0x97, 0x03, 0xE0, 0x6F, -+0x60, 0x33, 0xC3, 0x90, 0x97, 0x05, 0xE0, 0x94, -+0x88, 0x90, 0x97, 0x04, 0xE0, 0x94, 0x13, 0x40, -+0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, -+0x22, 0x90, 0x97, 0x04, 0x12, 0xC7, 0xB0, 0xD3, -+0x90, 0x97, 0x05, 0xE0, 0x94, 0x32, 0x90, 0x97, -+0x04, 0xE0, 0x94, 0x00, 0x40, 0xC2, 0x90, 0x01, -+0xC6, 0xE0, 0x30, 0xE0, 0xBB, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD1, 0x84, 0x90, -+0x96, 0xF1, 0x12, 0x04, 0x31, 0x90, 0x96, 0xF1, -+0xD1, 0x7B, 0xD1, 0x74, 0x12, 0x92, 0x43, 0x90, -+0x06, 0xB7, 0x74, 0x11, 0xF0, 0x7F, 0x03, 0x7E, -+0x00, 0x12, 0x7C, 0x6A, 0x90, 0x06, 0xB4, 0xE0, -+0x54, 0x0F, 0x70, 0xF1, 0xB1, 0x66, 0x12, 0x8F, -+0xEE, 0x54, 0xFE, 0xB1, 0x98, 0x90, 0x01, 0x00, -+0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, -+0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x30, 0x7E, 0x08, -+0x02, 0x70, 0xAD, 0x12, 0x04, 0xB8, 0x90, 0x92, -+0x18, 0x02, 0x04, 0x31, 0x7F, 0x30, 0x7E, 0x08, -+0x12, 0x70, 0x70, 0xED, 0x44, 0x80, 0xFD, 0xEC, -+0x22, 0x90, 0x93, 0x3B, 0xE0, 0xC3, 0x13, 0x20, -+0xE0, 0x35, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, -+0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, -+0x60, 0x05, 0x75, 0x66, 0x01, 0x80, 0x2E, 0x90, -+0x02, 0x96, 0xE0, 0x60, 0x05, 0x75, 0x66, 0x10, -+0x80, 0x23, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, -+0x02, 0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, -+0xE3, 0x05, 0x75, 0x66, 0x04, 0x80, 0x0E, 0x90, -+0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x66, -+0x20, 0x80, 0x02, 0xE1, 0x5D, 0x90, 0x01, 0xB9, -+0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x66, -+0xF0, 0x7F, 0x00, 0x22, 0xE4, 0xF5, 0x7A, 0xEF, -+0x14, 0xF5, 0x79, 0xED, 0xFF, 0xE5, 0x79, 0xF5, -+0x82, 0x33, 0x95, 0xE0, 0xF5, 0x83, 0xC3, 0xE5, -+0x82, 0x9F, 0x74, 0x80, 0xF8, 0x65, 0x83, 0x98, -+0x40, 0x50, 0xE5, 0x79, 0x78, 0x03, 0xA2, 0xE7, -+0x13, 0xD8, 0xFB, 0xFF, 0x33, 0x95, 0xE0, 0xFE, -+0xEB, 0xF1, 0x82, 0xE5, 0x82, 0x2F, 0xF5, 0x82, -+0xE5, 0x83, 0x3E, 0xF5, 0x83, 0xE0, 0xF5, 0x82, -+0x75, 0x83, 0x00, 0xE5, 0x79, 0x51, 0x68, 0x80, -+0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, -+0x4E, 0x60, 0x13, 0x85, 0x79, 0x7B, 0x05, 0x7A, -+0x90, 0x95, 0xE3, 0xE0, 0x65, 0x7A, 0x60, 0x0A, -+0xE5, 0x7B, 0xD3, 0x9D, 0x40, 0x04, 0x15, 0x79, -+0x80, 0x99, 0xAF, 0x7B, 0x22, 0x90, 0x01, 0xB8, -+0xE4, 0xF0, 0x7F, 0x01, 0x22, 0xF0, 0x7F, 0x0A, -+0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x74, 0x0F, 0xF0, -+0xA3, 0x74, 0xC0, 0xF0, 0x22, 0x90, 0x88, 0x2F, -+0xE0, 0x64, 0x02, 0x7F, 0x01, 0x60, 0x02, 0x7F, -+0x00, 0x22, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, -+0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, -+0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, -+0xF1, 0x65, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xC0, -+0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, -+0x90, 0x01, 0xC4, 0x74, 0xA8, 0xF0, 0x74, 0xCF, -+0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, 0x41, 0xEF, -+0x20, 0xE0, 0xF7, 0x74, 0xA8, 0x04, 0x90, 0x01, -+0xC4, 0xF0, 0x74, 0xCF, 0xA3, 0xF0, 0x22, 0x12, -+0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x3F, -+0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x03, -+0x12, 0xC7, 0x64, 0x22, 0x12, 0x02, 0x06, 0xFF, -+0x90, 0x93, 0xE6, 0xF0, 0xBF, 0x01, 0x0A, 0x7F, -+0x01, 0x12, 0xC1, 0x85, 0xE4, 0x90, 0x93, 0xE6, -+0xF0, 0x22, 0xE4, 0xFD, 0x02, 0x97, 0xF3, 0x90, -+0x95, 0xEB, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, -+0xFF, 0xA3, 0xE0, 0x90, 0x96, 0x0F, 0xF0, 0xE0, -+0xFE, 0x6F, 0x60, 0x71, 0x90, 0x95, 0xEC, 0x74, -+0x03, 0xF0, 0x90, 0x96, 0x0E, 0x74, 0x08, 0xF0, -+0xEE, 0x04, 0x54, 0x0F, 0xFF, 0xE4, 0xFE, 0xEF, -+0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, -+0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2E, -+0x11, 0x83, 0xE0, 0xFD, 0x74, 0xEE, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xED, 0xF0, -+0x0E, 0xEE, 0xB4, 0x08, 0xDA, 0x7B, 0x01, 0x7A, -+0x95, 0x79, 0xEC, 0x12, 0xBF, 0xC1, 0x12, 0x04, -+0x7E, 0x90, 0x96, 0x0F, 0xE0, 0x04, 0x54, 0x0F, -+0xFF, 0xF0, 0xBF, 0x0F, 0x02, 0xE4, 0xF0, 0x90, -+0x96, 0x0F, 0xE0, 0x90, 0x04, 0x7F, 0xF0, 0x90, -+0x95, 0xEB, 0xE0, 0x70, 0x05, 0x90, 0x8A, 0xE5, -+0x80, 0x03, 0x90, 0x8A, 0x79, 0x12, 0x96, 0x47, -+0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xE4, 0xFF, -+0x02, 0xCF, 0xF7, 0xF5, 0x82, 0xE4, 0x35, 0x83, -+0xF5, 0x83, 0x22, 0x90, 0x95, 0xEB, 0xEF, 0xF0, -+0x90, 0x88, 0x2B, 0xE0, 0x90, 0x95, 0xFD, 0xF0, -+0xE4, 0x90, 0x95, 0xEC, 0xF0, 0x90, 0x95, 0xFD, -+0xE0, 0xFE, 0x90, 0x95, 0xEC, 0xE0, 0xFF, 0xC3, -+0x9E, 0x50, 0x2C, 0xE0, 0xFE, 0x31, 0xC1, 0xE4, -+0xF0, 0xEE, 0x51, 0x75, 0xE0, 0x30, 0xE7, 0x0E, -+0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x56, 0x12, -+0x04, 0x6E, 0xE4, 0xF0, 0x80, 0x0C, 0x12, 0x7C, -+0x8F, 0x90, 0x95, 0xEC, 0xE0, 0x31, 0xC1, 0x74, -+0x01, 0xF0, 0x12, 0xAF, 0x30, 0x80, 0xC6, 0x7F, -+0x0C, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0xE4, 0x90, -+0x95, 0xEC, 0xF0, 0x90, 0x95, 0xFD, 0xE0, 0xFF, -+0x90, 0x95, 0xEC, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, -+0x02, 0x21, 0xC0, 0x74, 0xED, 0x2E, 0x31, 0xC3, -+0xE0, 0x70, 0x02, 0x21, 0xBB, 0xEE, 0xC4, 0x54, -+0xF0, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x81, -+0xF5, 0x83, 0xE0, 0xFD, 0xEE, 0xC4, 0x54, 0xF0, -+0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, -+0x83, 0x31, 0xCB, 0xFC, 0x75, 0xF0, 0x12, 0xB1, -+0xB2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xEC, 0xC4, -+0x54, 0xF0, 0x24, 0x0A, 0xF5, 0x82, 0xE4, 0x34, -+0x81, 0xF5, 0x83, 0xE0, 0xFD, 0xEC, 0x31, 0xDD, -+0x31, 0xCB, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x57, -+0x12, 0x04, 0x6E, 0xEE, 0x8F, 0xF0, 0x12, 0x02, -+0xE7, 0x7F, 0x01, 0x90, 0x95, 0xEC, 0xE0, 0xFE, -+0x31, 0xDD, 0xE5, 0x82, 0x2F, 0x11, 0x83, 0xE0, -+0xFD, 0x75, 0xF0, 0x12, 0xEE, 0x90, 0x89, 0x57, -+0x12, 0x04, 0x6E, 0x75, 0xF0, 0x02, 0xEF, 0x12, -+0x04, 0x6E, 0xE4, 0x8D, 0xF0, 0x12, 0x02, 0xE7, -+0x0F, 0xEF, 0xB4, 0x05, 0xD6, 0x31, 0xD4, 0x24, -+0x09, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -+0xE0, 0xFE, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, -+0x55, 0x12, 0x04, 0x6E, 0xEE, 0xF0, 0x31, 0xD4, -+0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, -+0x83, 0xE0, 0xFE, 0x51, 0x56, 0xEE, 0xF0, 0x90, -+0x95, 0xEC, 0xE0, 0xFF, 0x90, 0x95, 0xEB, 0xE0, -+0xFD, 0x31, 0xEE, 0x90, 0x95, 0xEC, 0xE0, 0x75, -+0xF0, 0x12, 0x90, 0x89, 0x56, 0x12, 0x04, 0x6E, -+0x74, 0x01, 0xF0, 0x12, 0xAF, 0x30, 0x01, 0xE3, -+0x22, 0x24, 0xED, 0xF5, 0x82, 0xE4, 0x34, 0x95, -+0xF5, 0x83, 0x22, 0xE0, 0xFE, 0xED, 0xFF, 0x90, -+0x95, 0xEC, 0xE0, 0x22, 0x90, 0x95, 0xEC, 0xE0, -+0xFF, 0xC4, 0x54, 0xF0, 0x22, 0xC4, 0x54, 0xF0, -+0x24, 0x0B, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, -+0x83, 0x22, 0x7D, 0x01, 0xAF, 0x67, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x10, -+0x51, 0x11, 0x90, 0x89, 0x5F, 0x51, 0x42, 0x90, -+0x89, 0x53, 0x51, 0x42, 0x51, 0x4E, 0xE4, 0xF0, -+0x51, 0x61, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, -+0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, -+0xF0, 0x12, 0xEF, 0x90, 0x89, 0x59, 0x12, 0x04, -+0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, -+0xEF, 0x90, 0x89, 0x5B, 0x12, 0x04, 0x6E, 0xE4, -+0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x90, -+0x89, 0x5D, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, -+0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x22, 0x90, 0x89, -+0x55, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0x74, 0x43, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -+0x22, 0xEF, 0xC4, 0x54, 0xF0, 0x24, 0x03, 0xF5, -+0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, 0x54, -+0xBF, 0x44, 0x80, 0xFE, 0xEF, 0xC4, 0x54, 0xF0, -+0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, -+0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x97, 0x08, 0xEF, 0xF0, 0x51, 0xF8, -+0x30, 0xE6, 0x38, 0x7F, 0x8D, 0x12, 0x7B, 0x41, -+0xEF, 0x64, 0x01, 0x70, 0x2E, 0x90, 0x97, 0x09, -+0xF0, 0x90, 0x97, 0x09, 0xE0, 0xFD, 0x90, 0x97, -+0x08, 0xE0, 0x12, 0x98, 0xD8, 0xE5, 0x82, 0x2D, -+0x11, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x51, 0xD0, -+0x90, 0x97, 0x09, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, -+0x94, 0x10, 0x40, 0xDD, 0x51, 0xF8, 0x30, 0xE0, -+0x02, 0xB1, 0xB8, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, -+0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, -+0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, -+0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, -+0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0xE4, -+0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x85, 0x4E, -+0x90, 0x95, 0xD5, 0xEF, 0xF0, 0x60, 0xF0, 0x90, -+0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, -+0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0E, -+0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, -+0xFF, 0x11, 0x8B, 0x12, 0x98, 0xE5, 0x71, 0x5C, -+0x30, 0xE1, 0x09, 0x54, 0xFD, 0xF0, 0x90, 0x86, -+0x08, 0x12, 0x92, 0x46, 0x71, 0x5C, 0x30, 0xE2, -+0x09, 0x54, 0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x12, -+0x92, 0x46, 0x71, 0x5C, 0x30, 0xE6, 0x09, 0x54, -+0xBF, 0xF0, 0x90, 0x8A, 0x7D, 0x12, 0x92, 0x46, -+0xD2, 0xAF, 0x80, 0xB3, 0xD2, 0xAF, 0xC2, 0xAF, -+0x90, 0x86, 0xAF, 0xE0, 0x22, 0xE4, 0xFF, 0x01, -+0x8B, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, -+0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, -+0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, -+0xC4, 0x74, 0x69, 0xF0, 0x74, 0xD3, 0xA3, 0xF0, -+0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, 0xE1, 0x02, -+0xB1, 0xDD, 0xE5, 0x2D, 0x30, 0xE1, 0x02, 0x11, -+0x7E, 0xE5, 0x2D, 0x30, 0xE4, 0x02, 0xB1, 0xCC, -+0xE5, 0x2D, 0x30, 0xE5, 0x02, 0xD1, 0x46, 0xE5, -+0x2D, 0x30, 0xE6, 0x02, 0xB1, 0xBF, 0xE5, 0x2F, -+0x30, 0xE0, 0x03, 0x12, 0xBE, 0x22, 0xE5, 0x2F, -+0x30, 0xE1, 0x03, 0x12, 0xB5, 0x13, 0xE5, 0x2F, -+0x30, 0xE2, 0x02, 0xB1, 0xFE, 0xE5, 0x2F, 0x30, -+0xE3, 0x03, 0x12, 0xB6, 0xD2, 0xE5, 0x2F, 0x30, -+0xE4, 0x02, 0xD1, 0x21, 0xE5, 0x2F, 0x30, 0xE5, -+0x02, 0xB1, 0x89, 0xE5, 0x2F, 0x30, 0xE6, 0x02, -+0x91, 0x8D, 0xE5, 0x30, 0x30, 0xE4, 0x02, 0x71, -+0x65, 0xE5, 0x30, 0x30, 0xE5, 0x02, 0x91, 0x43, -+0xE5, 0x36, 0x30, 0xE0, 0x03, 0x12, 0xAC, 0xB8, -+0xE5, 0x36, 0x30, 0xE6, 0x03, 0x12, 0xAC, 0x6A, -+0xE5, 0x36, 0x30, 0xE7, 0x02, 0x91, 0x4B, 0xE5, -+0x37, 0x30, 0xE2, 0x02, 0x91, 0x57, 0xE5, 0x37, -+0x30, 0xE3, 0x02, 0x91, 0x63, 0x74, 0x69, 0x04, -+0x90, 0x01, 0xC4, 0xF0, 0x74, 0xD3, 0xA3, 0xF0, -+0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, -+0xD0, 0xE0, 0x32, 0x90, 0x8A, 0xDF, 0xB1, 0xAA, -+0x02, 0x04, 0x7A, 0x90, 0x93, 0x03, 0xE0, 0x30, -+0xE0, 0x04, 0x7F, 0x01, 0x91, 0x6F, 0x22, 0x90, -+0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x02, -+0x91, 0x6F, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, -+0xE0, 0x04, 0x7F, 0x03, 0x91, 0x6F, 0x22, 0x90, -+0x95, 0xED, 0xEF, 0xF0, 0x90, 0x95, 0xEB, 0x74, -+0x18, 0xF0, 0x90, 0x96, 0x0D, 0x74, 0x01, 0xF0, -+0xFB, 0x7A, 0x95, 0x79, 0xEB, 0x12, 0x96, 0x35, -+0x7F, 0x04, 0x02, 0x04, 0x7E, 0xE4, 0xFF, 0x12, -+0x78, 0x4A, 0xBF, 0x01, 0x0F, 0x90, 0x88, 0x36, -+0xE0, 0x60, 0x09, 0x91, 0xA5, 0x54, 0x07, 0x70, -+0x03, 0x12, 0xB7, 0x4E, 0x22, 0x90, 0x88, 0x3A, -+0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xE4, 0xF5, 0x7C, -+0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x7C, 0x54, 0xC0, -+0x70, 0x19, 0x91, 0xA5, 0x54, 0xFD, 0xF0, 0x12, -+0xB7, 0x4E, 0x90, 0x88, 0x39, 0xE0, 0x60, 0x41, -+0x12, 0x8F, 0xEE, 0x44, 0x01, 0xFD, 0x7F, 0x02, -+0x02, 0x7B, 0x2E, 0xE5, 0x7C, 0x30, 0xE6, 0x1E, -+0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x18, -+0xB1, 0x7A, 0x12, 0xB7, 0x63, 0x64, 0x02, 0x60, -+0x08, 0x90, 0x8A, 0xE1, 0x12, 0x92, 0x46, 0x80, -+0x07, 0x12, 0x73, 0x8F, 0x80, 0x02, 0x91, 0xA5, -+0xE5, 0x7C, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x05, -+0x12, 0xB4, 0xA3, 0x80, 0x7C, 0xE0, 0x54, 0xFD, -+0xF0, 0x22, 0x90, 0x06, 0xA9, 0x12, 0xAF, 0xA0, -+0xFD, 0x54, 0xC0, 0x70, 0x04, 0x91, 0xA5, 0x80, -+0x5D, 0xED, 0x30, 0xE6, 0x47, 0x90, 0x88, 0x36, -+0xE0, 0x64, 0x02, 0x70, 0x29, 0x90, 0x88, 0x31, -+0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x05, 0xB1, 0x7A, -+0xF0, 0x80, 0x24, 0x12, 0xB7, 0x64, 0x64, 0x01, -+0x70, 0x2C, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x04, -+0xF0, 0x90, 0x8A, 0x71, 0x12, 0x96, 0x47, 0x7F, -+0x01, 0x12, 0x04, 0x7E, 0x80, 0x18, 0xB1, 0x7A, -+0x12, 0xB7, 0x63, 0x64, 0x02, 0x60, 0x08, 0x90, -+0x8A, 0xE1, 0x12, 0x92, 0x46, 0x80, 0x07, 0x12, -+0x73, 0x8F, 0x80, 0x02, 0x91, 0xA5, 0x90, 0x95, -+0xEB, 0xE0, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x05, -+0x12, 0xB4, 0xA3, 0x80, 0x0C, 0xE0, 0x54, 0xFD, -+0xF0, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, -+0x22, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, -+0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, -+0x18, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x12, 0x12, -+0xB7, 0x64, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, -+0xE1, 0xB1, 0xAA, 0x02, 0x04, 0x7A, 0x12, 0x73, -+0x8F, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, -+0xF9, 0x22, 0x90, 0x89, 0x53, 0x02, 0x04, 0x6E, -+0xE4, 0xFD, 0x7F, 0x8D, 0x02, 0x7B, 0x2E, 0x90, -+0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x05, 0xE4, 0xA3, -+0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x8A, 0x75, 0x12, -+0x92, 0x46, 0x90, 0x8A, 0xE5, 0x12, 0x96, 0x47, -+0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x88, 0x36, -+0xE0, 0x70, 0x07, 0x90, 0x88, 0x2C, 0xE0, 0x30, -+0xE0, 0x13, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, -+0x09, 0x12, 0xB3, 0xC6, 0xBF, 0x01, 0x06, 0x02, -+0xB7, 0x6B, 0x12, 0xB7, 0x86, 0x22, 0x90, 0x88, -+0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x05, 0x12, 0xB3, -+0x7C, 0x60, 0x15, 0x90, 0x88, 0x36, 0xE0, 0x70, -+0x04, 0xEF, 0x30, 0xE0, 0x0B, 0x90, 0x88, 0x39, -+0xE0, 0x64, 0x02, 0x60, 0x03, 0x12, 0x88, 0x31, -+0x22, 0x12, 0xB6, 0xC9, 0x70, 0x1F, 0x90, 0x88, -+0x36, 0xE0, 0x60, 0x19, 0x90, 0x88, 0x3A, 0xE0, -+0x20, 0xE4, 0x12, 0x12, 0xBF, 0x93, 0xF0, 0x90, -+0x88, 0x31, 0xE0, 0x12, 0xBF, 0xB6, 0x54, 0x07, -+0x70, 0x03, 0x12, 0xB7, 0x4E, 0x22, 0x90, 0x01, -+0xCF, 0x12, 0xAF, 0xA0, 0xFF, 0x30, 0xE0, 0x07, -+0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, -+0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, -+0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, -+0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, -+0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, -+0x03, 0x12, 0x7B, 0x2E, 0x80, 0xFE, 0x22, 0x12, -+0xAF, 0x3F, 0x64, 0x01, 0x60, 0x02, 0xE1, 0x0D, -+0xEF, 0x24, 0x39, 0x60, 0x12, 0x14, 0x60, 0x19, -+0x24, 0x02, 0x70, 0x1F, 0xE4, 0x90, 0x95, 0x59, -+0xF0, 0xA3, 0x74, 0x06, 0xF0, 0x80, 0x14, 0x90, -+0x95, 0x59, 0x74, 0x06, 0xF0, 0xA3, 0xF0, 0x80, -+0x0A, 0x90, 0x95, 0x59, 0x74, 0x0C, 0xF0, 0xA3, -+0x74, 0x04, 0xF0, 0xF1, 0x21, 0xF1, 0x0E, 0x40, -+0x1C, 0x90, 0x95, 0x57, 0xE0, 0x12, 0xC7, 0x74, -+0x7A, 0x95, 0x79, 0x56, 0x12, 0x5F, 0xA6, 0xBF, -+0x01, 0x07, 0x90, 0x95, 0x56, 0xE0, 0xF4, 0x70, -+0x3C, 0xF1, 0x16, 0x80, 0xE0, 0xF1, 0x21, 0xF1, -+0x0E, 0x40, 0x32, 0x90, 0x95, 0x57, 0xE0, 0xFD, -+0x7C, 0x00, 0x24, 0xA8, 0xFF, 0xEC, 0x34, 0x01, -+0xFE, 0xED, 0x24, 0x01, 0xFD, 0xEC, 0x33, 0xFC, -+0x90, 0x95, 0x59, 0xE0, 0xFB, 0xC3, 0xED, 0x9B, -+0xFD, 0xEC, 0x94, 0x00, 0xFC, 0x90, 0x95, 0x53, -+0x12, 0xAB, 0x7D, 0x12, 0x02, 0x1F, 0xFD, 0xF1, -+0x32, 0xF1, 0x16, 0x80, 0xCA, 0x22, 0x90, 0x95, -+0x58, 0xE0, 0xD3, 0x94, 0x00, 0x22, 0x90, 0x95, -+0x57, 0xE0, 0x04, 0xF0, 0xA3, 0xE0, 0x14, 0xF0, -+0x22, 0x90, 0x95, 0x59, 0xE0, 0x90, 0x95, 0x57, -+0xF0, 0x90, 0x95, 0x5A, 0xE0, 0x90, 0x95, 0x58, -+0xF0, 0x22, 0x8E, 0x61, 0x8F, 0x62, 0x8D, 0x63, -+0xE4, 0x90, 0x95, 0x5B, 0xF0, 0x90, 0x00, 0x37, -+0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x37, 0x12, 0x7B, -+0x2E, 0x7D, 0x69, 0x7F, 0xCF, 0x12, 0x7B, 0x2E, -+0xE5, 0x62, 0xFD, 0x7F, 0x31, 0x12, 0x7B, 0x2E, -+0xE5, 0x61, 0x54, 0x03, 0xFF, 0x90, 0x00, 0x32, -+0xE0, 0x54, 0xFC, 0x4F, 0xFD, 0x7F, 0x32, 0x12, -+0x7B, 0x2E, 0xAD, 0x63, 0x7F, 0x30, 0x12, 0x7B, -+0x2E, 0x90, 0x00, 0x33, 0xE0, 0x44, 0x80, 0xFD, -+0x7F, 0x33, 0x12, 0x7B, 0x2E, 0x90, 0x00, 0x33, -+0xE0, 0x30, 0xE7, 0x09, 0xF1, 0xA9, 0x50, 0x05, -+0xE0, 0x04, 0xF0, 0x80, 0xF0, 0xE4, 0xFD, 0x7F, -+0xCF, 0x12, 0x7B, 0x2E, 0x90, 0x00, 0x37, 0xE0, -+0x54, 0x7F, 0xFD, 0x7F, 0x37, 0x12, 0x7B, 0x2E, -+0xF1, 0xA9, 0x7F, 0x00, 0x50, 0x02, 0x7F, 0x01, -+0x22, 0x90, 0x95, 0x5B, 0xE0, 0xC3, 0x94, 0x64, -+0x22, 0x75, 0x29, 0x12, 0xE4, 0xF5, 0x2A, 0x75, -+0x2B, 0x07, 0x75, 0x2C, 0x32, 0xF5, 0x31, 0x75, -+0x32, 0xC1, 0x75, 0x33, 0x0C, 0xF5, 0x34, 0x90, -+0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, -+0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, 0xE5, 0x2C, -+0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, -+0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, 0xF0, 0xA3, -+0xE5, 0x34, 0xF0, 0x22, 0x75, 0x39, 0x06, 0x43, -+0x39, 0x10, 0x75, 0x3A, 0x01, 0x43, 0x3A, 0x08, -+0x43, 0x3A, 0x10, 0x75, 0x3B, 0x03, 0x75, 0x3C, -+0x62, 0x43, 0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, -+0x01, 0x38, 0xE5, 0x39, 0xF0, 0xA3, 0xE5, 0x3A, -+0xF0, 0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, -+0xF0, 0x22, 0x7D, 0x02, 0x90, 0x01, 0xC4, 0x74, -+0x1A, 0xF0, 0x74, 0xD8, 0xA3, 0xF0, 0x90, 0x93, -+0x57, 0xE0, 0xFF, 0xED, 0xC3, 0x9F, 0x50, 0x18, -+0xED, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, -+0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, -+0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0D, 0x80, 0xDE, -+0x74, 0x1A, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -+0xD8, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0xE4, 0x90, -+0x95, 0xAB, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, -+0x95, 0xAB, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x93, -+0xF0, 0xE0, 0x70, 0x18, 0x90, 0x93, 0xED, 0xE0, -+0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x95, -+0xAB, 0xE0, 0x24, 0x56, 0x90, 0x01, 0xC4, 0xF0, -+0x74, 0xD8, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, -+0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, 0x88, 0x36, -+0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, -+0x90, 0x88, 0x38, 0xE0, 0x6F, 0x60, 0x03, 0x12, -+0xB7, 0x4E, 0xC2, 0xAF, 0x11, 0x1A, 0xBF, 0x01, -+0x03, 0x12, 0xCD, 0x46, 0xD2, 0xAF, 0x11, 0xB8, -+0x12, 0x9F, 0xF3, 0x12, 0x83, 0x4D, 0x80, 0xA7, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x93, 0xED, 0xE0, 0x60, 0x25, 0x7F, 0x54, 0x7E, -+0x09, 0x12, 0x70, 0x70, 0x31, 0x65, 0x12, 0x04, -+0xB8, 0xEF, 0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, -+0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0x31, 0x65, -+0x12, 0xCE, 0x7B, 0x7F, 0x54, 0x7E, 0x09, 0x12, -+0x70, 0xAD, 0x90, 0x93, 0xE8, 0xE0, 0x70, 0x29, -+0x90, 0x07, 0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, -+0xF0, 0x90, 0x95, 0xB2, 0x74, 0x22, 0xF0, 0x90, -+0x95, 0xD4, 0x74, 0x01, 0xF0, 0x90, 0x95, 0xB4, -+0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0xB2, 0x12, 0x96, 0x35, 0x7F, 0x04, 0x12, 0x04, -+0x7E, 0x90, 0x93, 0xF0, 0xE0, 0xFF, 0x70, 0x0A, -+0x90, 0x93, 0xED, 0xE0, 0x70, 0x04, 0xA3, 0xE0, -+0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, -+0xF0, 0x90, 0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, -+0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, -+0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, -+0x90, 0x93, 0xED, 0xE0, 0x60, 0x06, 0x90, 0x01, -+0xC4, 0x74, 0x01, 0xF0, 0x90, 0x93, 0xEE, 0xE0, -+0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, 0xAE, -+0x12, 0x04, 0x31, 0x90, 0x95, 0xAE, 0x22, 0x90, -+0x8A, 0x79, 0x74, 0x86, 0xF0, 0xA3, 0x74, 0xFF, -+0xF0, 0x90, 0x8A, 0xE5, 0x74, 0xDA, 0xF0, 0xA3, -+0x74, 0x7E, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0x90, -+0xF0, 0xA3, 0x74, 0xC7, 0xF0, 0x90, 0x8A, 0xB9, -+0x74, 0x92, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x90, -+0x8A, 0xD5, 0x74, 0xAD, 0xF0, 0xA3, 0x74, 0xB2, -+0xF0, 0x90, 0x8A, 0xFB, 0x74, 0x98, 0xF0, 0xA3, -+0x74, 0x49, 0xF0, 0x90, 0x8A, 0xA5, 0x74, 0xA1, -+0xF0, 0xA3, 0x74, 0xF9, 0xF0, 0x90, 0x8A, 0xB5, -+0x74, 0xDE, 0xF0, 0xA3, 0x74, 0x6C, 0xF0, 0x90, -+0x8A, 0xC3, 0x74, 0xDD, 0xF0, 0xA3, 0x74, 0xF1, -+0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xE0, 0xF0, 0xA3, -+0x74, 0x10, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0xE1, -+0xF0, 0xA3, 0x74, 0x72, 0xF0, 0x90, 0x86, 0x04, -+0x74, 0xE2, 0xF0, 0xA3, 0x74, 0x7D, 0xF0, 0x90, -+0x8A, 0xA9, 0x74, 0xE0, 0xF0, 0xA3, 0x74, 0x1C, -+0xF0, 0x90, 0x8B, 0x07, 0x74, 0xE0, 0xF0, 0xA3, -+0x74, 0x4B, 0xF0, 0x90, 0x8A, 0xAD, 0x74, 0xE0, -+0xF0, 0xA3, 0x74, 0xF5, 0xF0, 0x90, 0x86, 0x0C, -+0x74, 0xCD, 0xF0, 0xA3, 0x74, 0x9E, 0xF0, 0x90, -+0x8A, 0xEF, 0x74, 0xCE, 0xF0, 0xA3, 0x74, 0x26, -+0xF0, 0x90, 0x86, 0x00, 0x74, 0xE4, 0xF0, 0xA3, -+0x74, 0x76, 0xF0, 0x90, 0x86, 0x02, 0x74, 0xE4, -+0xF0, 0xA3, 0x74, 0xD5, 0xF0, 0x90, 0x8A, 0xFD, -+0x74, 0xBA, 0xF0, 0xA3, 0x74, 0xDA, 0xF0, 0x90, -+0x8A, 0xF9, 0x74, 0xDE, 0xF0, 0xA3, 0x74, 0x22, -+0xF0, 0x90, 0x8A, 0xDB, 0x74, 0xDE, 0xF0, 0xA3, -+0x74, 0xBE, 0xF0, 0x90, 0x8A, 0xAF, 0x74, 0xA3, -+0xF0, 0xA3, 0x74, 0x9D, 0xF0, 0x90, 0x8A, 0xD3, -+0x74, 0xDD, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0x90, -+0x8A, 0xF5, 0x74, 0xE5, 0xF0, 0xA3, 0x74, 0xA8, -+0xF0, 0x90, 0x8A, 0xA3, 0x74, 0xE6, 0xF0, 0xA3, -+0x74, 0x07, 0xF0, 0x90, 0x86, 0x06, 0x74, 0xDB, -+0xF0, 0xA3, 0x74, 0xE9, 0xF0, 0x22, 0x8F, 0x0D, -+0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, 0xAF, -+0xE0, 0x45, 0x0D, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, -+0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -+0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, -+0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x8D, 0xF0, -+0x74, 0xDA, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, 0xE5, -+0x25, 0x30, 0xE7, 0x02, 0x51, 0xE4, 0x74, 0x8D, -+0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xDA, 0xA3, -+0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, -+0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, -+0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x00, 0xAB, 0xE0, -+0xFE, 0x90, 0x00, 0xAA, 0x12, 0xAF, 0xD5, 0x54, -+0x7F, 0x90, 0x95, 0xE9, 0xF0, 0xA3, 0xEF, 0xF0, -+0xE0, 0x30, 0xE1, 0x03, 0x12, 0xBD, 0x75, 0x22, -+0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, -+0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, -+0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, -+0x74, 0x00, 0xF0, 0x74, 0xDB, 0xA3, 0xF0, 0x90, -+0x8A, 0x9D, 0x12, 0x92, 0x46, 0x53, 0x91, 0xBF, -+0x74, 0x00, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -+0xDB, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, -+0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -+0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, -+0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, -+0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, -+0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x56, 0x90, -+0x01, 0xC4, 0xED, 0xF0, 0x74, 0xDB, 0xFF, 0xA3, -+0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, -+0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, -+0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, -+0xF0, 0xE0, 0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, -+0xE0, 0xB4, 0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, -+0x23, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, -+0xA3, 0x91, 0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, -+0xB4, 0x02, 0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, -+0xE7, 0x12, 0x92, 0x46, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, -+0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, -+0x12, 0x92, 0x46, 0x90, 0x88, 0xF0, 0xE0, 0x30, -+0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x92, 0x46, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x96, 0xEA, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, -+0x90, 0x96, 0xE9, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, -+0x91, 0xF5, 0xE0, 0x90, 0x96, 0xEC, 0xF0, 0x12, -+0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x96, -+0xE9, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x96, -+0xEA, 0xE0, 0x60, 0x05, 0x91, 0xA8, 0x44, 0x80, -+0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, -+0xF0, 0x91, 0xA8, 0x54, 0xC0, 0xF0, 0x90, 0x96, -+0xEC, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, -+0xF0, 0x90, 0x00, 0x8B, 0xE0, 0xD3, 0x94, 0x03, -+0x74, 0x10, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0x74, 0x04, 0xF0, 0xAF, 0x05, 0x91, -+0xEA, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x96, 0xEB, -+0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, -+0x02, 0x4B, 0x91, 0xE9, 0xEE, 0xF0, 0x74, 0x11, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, -+0xF0, 0x74, 0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, -+0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x22, 0x90, 0x96, 0xE2, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x9B, 0xE0, -+0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, -+0x12, 0x04, 0x7E, 0x90, 0x96, 0xE2, 0xA3, 0xE0, -+0xFF, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x96, -+0xE1, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x44, 0x02, -+0x4E, 0xFE, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x86, 0xAD, -+0xA3, 0xE0, 0x24, 0x7F, 0xF5, 0x82, 0xE4, 0x34, -+0x84, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x91, 0xF5, 0xE0, 0x90, 0x97, -+0x19, 0xF0, 0x90, 0x88, 0x32, 0x12, 0xA3, 0x5B, -+0x30, 0xE0, 0x02, 0xA1, 0xCA, 0x90, 0x88, 0x31, -+0xE0, 0x30, 0xE0, 0x1C, 0x12, 0x97, 0x4A, 0x33, -+0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4B, 0xF0, -+0x90, 0x88, 0x53, 0xE0, 0x04, 0x33, 0x33, 0x33, -+0x54, 0xF8, 0x90, 0x88, 0x4A, 0xF0, 0x80, 0x10, -+0x90, 0x88, 0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, -+0x4A, 0x74, 0x08, 0xF0, 0x74, 0x10, 0x2B, 0xFB, -+0x90, 0x88, 0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, -+0xE0, 0xD3, 0x9E, 0x50, 0x0E, 0x90, 0x88, 0x3E, -+0xEB, 0xF0, 0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, -+0x2F, 0x80, 0x11, 0xC3, 0xED, 0x9E, 0x2B, 0x90, -+0x88, 0x3E, 0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, -+0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4E, 0xF0, -+0x90, 0x88, 0x4B, 0xB1, 0xD6, 0x90, 0x88, 0x4E, -+0xB1, 0xDF, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x50, -+0xF0, 0x90, 0x88, 0x4E, 0xB1, 0xD6, 0x90, 0x88, -+0x3E, 0xB1, 0xDF, 0x98, 0x40, 0x04, 0xEF, 0x24, -+0x50, 0xF0, 0x90, 0x88, 0x4E, 0x12, 0xB4, 0x92, -+0xFF, 0x7E, 0x00, 0x90, 0x88, 0x42, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, -+0x88, 0x4E, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x05, -+0xB1, 0xE0, 0x54, 0xF8, 0x4F, 0xF0, 0xB1, 0xE9, -+0x80, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x01, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, -+0x24, 0x50, 0xFD, 0xE4, 0x33, 0xFC, 0x22, 0xE0, -+0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, -+0x22, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFE, 0xF0, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x91, 0xF5, 0xE0, 0x90, 0x97, 0x14, 0xF0, 0xED, -+0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, -+0xF0, 0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, -+0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, -+0x67, 0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x97, 0x13, 0xED, 0xF0, 0x64, -+0x01, 0x60, 0x27, 0xE0, 0xFE, 0x64, 0x02, 0x60, -+0x21, 0xEE, 0x64, 0x29, 0x60, 0x1C, 0xEE, 0x64, -+0x2A, 0x60, 0x17, 0xEE, 0x64, 0x36, 0x60, 0x12, -+0xEE, 0xB4, 0x37, 0x02, 0x80, 0x0C, 0xAD, 0x07, -+0x7F, 0xFF, 0x12, 0xC7, 0xBE, 0x90, 0x93, 0xF4, -+0xE0, 0xFF, 0x90, 0x93, 0xF3, 0xE0, 0x4F, 0x90, -+0x05, 0x22, 0xF0, 0x90, 0x97, 0x13, 0xE0, 0x90, -+0x93, 0x01, 0xF0, 0x22, 0x12, 0x02, 0x06, 0x90, -+0x96, 0x49, 0xF0, 0x22, 0x12, 0x02, 0x06, 0xFE, -+0x12, 0x87, 0xB9, 0xFF, 0x74, 0xD6, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0x8D, 0x12, 0x87, 0x9F, 0xFF, -+0x74, 0xC6, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -+0x12, 0x87, 0x6F, 0xFF, 0x74, 0x4A, 0x2E, 0xD1, -+0xB6, 0xEF, 0xF0, 0x74, 0xC6, 0x2E, 0x12, 0xA3, -+0x71, 0xE0, 0x30, 0xE5, 0x18, 0x75, 0xF0, 0x12, -+0xEE, 0x12, 0x9E, 0xA1, 0x13, 0x13, 0x54, 0x03, -+0xFB, 0xAF, 0x06, 0x74, 0xD6, 0x2E, 0x12, 0x9F, -+0xDA, 0xFD, 0x12, 0x6B, 0xFD, 0x22, 0xF5, 0x82, -+0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0xEF, 0x64, -+0x13, 0x60, 0x04, 0xEF, 0xB4, 0x0B, 0x05, 0x90, -+0x88, 0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, 0x60, -+0x04, 0xEF, 0xB4, 0x0A, 0x05, 0x90, 0x88, 0xE4, -+0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, 0xEF, -+0xB4, 0x09, 0x05, 0x90, 0x88, 0xE5, 0x80, 0x03, -+0x90, 0x88, 0xE2, 0xE0, 0xF5, 0x0F, 0xAF, 0x0F, -+0x22, 0x7E, 0x00, 0x7F, 0x8E, 0x7D, 0x00, 0x7B, -+0x01, 0x7A, 0x93, 0x79, 0x58, 0x02, 0x04, 0x80, -+0x90, 0x93, 0x58, 0xE0, 0x20, 0xE0, 0x02, 0xE1, -+0x8B, 0x90, 0x93, 0xDA, 0xE0, 0x04, 0x12, 0xA7, -+0x92, 0x04, 0xFF, 0x90, 0x97, 0x0A, 0xF0, 0x90, -+0x93, 0x59, 0xE0, 0xB5, 0x07, 0x05, 0xE4, 0x90, -+0x97, 0x0A, 0xF0, 0x90, 0x93, 0xD8, 0xE0, 0xFF, -+0x60, 0x0F, 0xF1, 0x8C, 0xC3, 0x9F, 0xF1, 0x9F, -+0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x66, -+0x33, 0x90, 0x97, 0x0A, 0xE0, 0x12, 0xA7, 0xD2, -+0x54, 0x07, 0x90, 0x97, 0x0B, 0x12, 0xA7, 0xC9, -+0x54, 0x07, 0xFF, 0x14, 0x60, 0x0F, 0x14, 0x60, -+0x07, 0x14, 0x60, 0x09, 0x24, 0x03, 0x70, 0x0B, -+0x12, 0xA7, 0xF1, 0x80, 0x03, 0x12, 0xA7, 0xB2, -+0x12, 0xA5, 0x96, 0xF1, 0xB2, 0x50, 0x24, 0x90, -+0x97, 0x0B, 0xE0, 0xFF, 0x64, 0x02, 0x60, 0x03, -+0xEF, 0x70, 0x0F, 0xF1, 0x8C, 0x24, 0xFC, 0xFF, -+0xE4, 0x90, 0x92, 0x20, 0xF0, 0xA3, 0xEF, 0x12, -+0xB4, 0xB3, 0xF1, 0x8C, 0xF1, 0x9F, 0xF1, 0xAB, -+0x12, 0x66, 0x33, 0x22, 0x90, 0x97, 0x0A, 0xE0, -+0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5D, 0xF5, 0x82, -+0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x22, 0x90, -+0x92, 0x21, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, -+0x22, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, -+0x01, 0x22, 0x90, 0x93, 0xD7, 0xE0, 0xFF, 0x90, -+0x93, 0xDA, 0xE0, 0xD3, 0x9F, 0x22, 0x90, 0x93, -+0x58, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x93, 0xD8, -+0xE0, 0x60, 0x05, 0x7F, 0x07, 0x12, 0xA7, 0xF3, -+0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x0F, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, -+0x90, 0x04, 0x1F, 0xE0, 0x44, 0x40, 0xF0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, -+0xFE, 0xFD, 0xEF, 0xB4, 0x01, 0x0D, 0xEB, 0xB4, -+0x02, 0x03, 0x0D, 0x80, 0x06, 0xEB, 0xB4, 0x01, -+0x02, 0x7D, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, -+0xF0, 0x4D, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0xB8, 0xE0, -+0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, 0x90, 0x88, -+0xBD, 0xE0, 0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, -+0x36, 0xE0, 0x70, 0x16, 0x90, 0x93, 0x3B, 0xE0, -+0x20, 0xE0, 0x0F, 0x90, 0x86, 0x0C, 0x12, 0x92, -+0x46, 0x90, 0x8A, 0xF9, 0x12, 0x96, 0x47, 0x12, -+0x97, 0xEB, 0x22, 0x90, 0x88, 0x9D, 0xE0, 0x30, -+0xE0, 0x5E, 0x90, 0x95, 0x37, 0xE0, 0x30, 0xE0, -+0x3D, 0x90, 0x95, 0x42, 0xE0, 0xFF, 0x90, 0x95, -+0x41, 0xE0, 0xC3, 0x9F, 0x40, 0x24, 0x11, 0xB3, -+0x90, 0x06, 0xC4, 0x11, 0xB1, 0x78, 0x08, 0x12, -+0x03, 0xEB, 0x90, 0x06, 0xC5, 0x11, 0xB1, 0x78, -+0x10, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC6, 0x11, -+0xB1, 0x11, 0xB9, 0xE4, 0x90, 0x95, 0x41, 0xF0, -+0x80, 0x1B, 0x11, 0xC4, 0x11, 0xB9, 0x90, 0x95, -+0x41, 0xE0, 0x04, 0xF0, 0x80, 0x0F, 0x90, 0x95, -+0x40, 0xE0, 0x60, 0x09, 0x11, 0xC4, 0x11, 0xB9, -+0xE4, 0x90, 0x95, 0x40, 0xF0, 0x90, 0x8A, 0xBB, -+0x12, 0x96, 0x47, 0xE4, 0xFF, 0x12, 0x04, 0x7E, -+0x22, 0xEF, 0xF0, 0x90, 0x95, 0x38, 0x02, 0x04, -+0xB8, 0x78, 0x18, 0x12, 0x03, 0xEB, 0x90, 0x06, -+0xC7, 0xEF, 0xF0, 0x22, 0x90, 0x95, 0x3C, 0x12, -+0x04, 0xB8, 0x90, 0x06, 0xC4, 0xEF, 0xF0, 0x90, -+0x95, 0x3C, 0x12, 0x04, 0xB8, 0x78, 0x08, 0x12, -+0x03, 0xEB, 0x90, 0x06, 0xC5, 0xEF, 0xF0, 0x90, -+0x95, 0x3C, 0x12, 0x04, 0xB8, 0x78, 0x10, 0x12, -+0x03, 0xEB, 0x90, 0x06, 0xC6, 0xEF, 0xF0, 0x90, -+0x95, 0x3C, 0x02, 0x04, 0xB8, 0x7E, 0x00, 0x7F, -+0x33, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, -+0x9D, 0x12, 0x04, 0x80, 0x90, 0x88, 0x9E, 0x74, -+0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0x7E, 0x00, -+0x7F, 0x0C, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x95, -+0x79, 0x37, 0x12, 0x04, 0x80, 0x90, 0x86, 0xB3, -+0xE0, 0xFC, 0x64, 0x02, 0x70, 0x19, 0x90, 0xFD, -+0x80, 0xE0, 0x7E, 0x00, 0x30, 0xE2, 0x02, 0x7E, -+0x01, 0xEE, 0x12, 0xA3, 0x79, 0xFE, 0x90, 0x88, -+0xA0, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, 0x22, 0xEC, -+0x64, 0x01, 0x70, 0x0D, 0x90, 0xFD, 0x70, 0xE0, -+0x7F, 0x00, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, -+0x13, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x70, -+0x18, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, 0x30, -+0xE2, 0x02, 0x7F, 0x01, 0xEF, 0x12, 0xA3, 0x79, -+0xFF, 0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, 0x4F, -+0xF0, 0x22, 0x90, 0x96, 0xDB, 0xEF, 0xF0, 0x90, -+0x88, 0xE0, 0xE0, 0x70, 0x51, 0x7F, 0x48, 0x7E, -+0x09, 0x12, 0x70, 0x70, 0xEE, 0x54, 0x0F, 0xFE, -+0xE4, 0xFD, 0xFC, 0x90, 0x96, 0xDC, 0x12, 0x04, -+0x31, 0xE4, 0x7F, 0x80, 0x51, 0x49, 0x70, 0x05, -+0x90, 0x88, 0xBE, 0x80, 0x1B, 0xE4, 0xFF, 0xFE, -+0x51, 0x4B, 0x70, 0x0A, 0x90, 0x88, 0xBE, 0x04, -+0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x56, 0xE4, 0xFF, -+0x51, 0x49, 0x70, 0x09, 0x90, 0x88, 0xBE, 0x04, -+0xF0, 0xA3, 0xF0, 0x80, 0x47, 0xE4, 0x7F, 0x80, -+0xFE, 0x51, 0x4B, 0x70, 0x3F, 0x90, 0x88, 0xBE, -+0xF0, 0xA3, 0x04, 0xF0, 0x80, 0x36, 0x7F, 0x2C, -+0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x02, -+0x51, 0x5E, 0x60, 0x08, 0x90, 0x88, 0xBE, 0x74, -+0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xBE, -+0xF0, 0x7F, 0x30, 0x7E, 0x09, 0x12, 0x70, 0x70, -+0xEF, 0x54, 0x01, 0x51, 0x5E, 0x60, 0x07, 0xE4, -+0x90, 0x88, 0xBF, 0xF0, 0x80, 0x06, 0x90, 0x88, -+0xBF, 0x74, 0x01, 0xF0, 0x90, 0x88, 0xB8, 0xE0, -+0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x96, -+0x47, 0x7D, 0x11, 0x51, 0x74, 0x12, 0x92, 0x46, -+0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, -+0x90, 0x96, 0xDB, 0xE0, 0xFD, 0x70, 0x02, 0x80, -+0x1C, 0xED, 0xB4, 0x01, 0x06, 0x51, 0x57, 0x44, -+0x20, 0xF0, 0x22, 0x90, 0x96, 0xDB, 0xE0, 0xFD, -+0xB4, 0x02, 0x06, 0x51, 0x57, 0x44, 0x60, 0xF0, -+0x22, 0xED, 0xB4, 0x03, 0x03, 0x51, 0x57, 0xF0, -+0x22, 0x7E, 0x02, 0xFD, 0xFC, 0x90, 0x96, 0xDC, -+0x12, 0x86, 0x2D, 0xC3, 0x02, 0x03, 0xDA, 0x90, -+0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, -+0xFE, 0xFD, 0xFC, 0x90, 0x96, 0xDC, 0x12, 0x04, -+0x31, 0x90, 0x96, 0xDC, 0x12, 0x04, 0xB8, 0xEC, -+0x4D, 0x4E, 0x4F, 0x22, 0x7F, 0xFF, 0x12, 0x04, -+0x7E, 0x90, 0x8A, 0xEF, 0x22, 0x90, 0x97, 0x15, -+0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0xAD, 0x07, 0xEF, 0x54, 0xFC, 0xFF, -+0xED, 0x54, 0x03, 0x60, 0x08, 0x74, 0xFF, 0xFF, -+0xFE, 0xFD, 0xFC, 0x80, 0x70, 0x71, 0x12, 0x12, -+0xAF, 0xA7, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, -+0xF9, 0xE4, 0xFF, 0x74, 0xC8, 0x2F, 0x12, 0xAF, -+0x37, 0xE0, 0xFE, 0x74, 0xF9, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0x96, 0x12, 0xAD, 0x97, 0xB4, 0x04, -+0xEA, 0x90, 0x96, 0xFA, 0x12, 0x8D, 0xD4, 0x12, -+0xC7, 0xA2, 0x90, 0x96, 0xF9, 0x12, 0x8D, 0xD4, -+0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x96, 0xFB, 0x12, 0x8D, -+0xD4, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, -+0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0xA3, 0x12, 0x8D, 0xD4, 0x78, 0x18, 0x12, -+0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0x86, 0x20, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x07, 0xC0, 0xEF, 0xF0, 0xEE, -+0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, 0x71, 0x61, -+0xF0, 0xE4, 0xFB, 0x90, 0x96, 0xD7, 0x12, 0x04, -+0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, 0xF8, -+0x12, 0x03, 0xEB, 0x74, 0xC4, 0x2B, 0x12, 0xAF, -+0x37, 0xEF, 0xF0, 0x0B, 0xEB, 0xB4, 0x04, 0xE3, -+0x90, 0x07, 0xC2, 0x12, 0xCF, 0x6D, 0x90, 0x07, -+0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x54, -+0xFC, 0x90, 0x07, 0xC0, 0xF0, 0xEE, 0xA3, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x97, 0x0E, 0x71, 0x5A, 0xF0, 0x7A, 0x00, 0x90, -+0x97, 0x0F, 0xE0, 0x54, 0x03, 0xFB, 0x70, 0x0A, -+0x90, 0x07, 0xC4, 0x71, 0xAA, 0x74, 0x03, 0xF0, -+0x80, 0x0E, 0xEB, 0x64, 0x02, 0x4A, 0x70, 0x15, -+0x90, 0x07, 0xC6, 0x71, 0xAA, 0x74, 0x0C, 0xF0, -+0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, -+0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xED, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, -+0x07, 0xC2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x97, 0x10, 0x71, 0x5A, 0xF0, -+0x91, 0x1A, 0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, -+0xF0, 0x90, 0x07, 0xC2, 0x74, 0x01, 0xF0, 0x80, -+0x37, 0xEF, 0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, -+0x07, 0xC5, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, -+0x02, 0xF0, 0x80, 0x24, 0x91, 0x1A, 0x64, 0x02, -+0x70, 0x0D, 0x90, 0x07, 0xC6, 0xED, 0xF0, 0x90, -+0x07, 0xC2, 0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, -+0x64, 0x03, 0x4E, 0x70, 0x0B, 0x90, 0x07, 0xC7, -+0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, -+0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, -+0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x7E, 0x00, 0x90, 0x97, 0x11, 0xE0, -+0x54, 0x03, 0xFF, 0x22, 0x90, 0x24, 0xA0, 0xE0, -+0x90, 0x93, 0x03, 0x30, 0xE7, 0x05, 0xE0, 0x44, -+0x02, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, -+0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, 0x7E, 0x00, -+0x7F, 0x01, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, -+0x79, 0x2C, 0x12, 0x04, 0x80, 0x90, 0x88, 0x2C, -+0xE0, 0x54, 0xFD, 0xF0, 0x12, 0xC7, 0x64, 0xA3, -+0x74, 0x0C, 0xF0, 0x22, 0x90, 0x86, 0x0C, 0x12, -+0x92, 0x46, 0x90, 0x8A, 0xF9, 0x12, 0x96, 0x47, -+0x7D, 0x24, 0x02, 0xB6, 0x2E, 0x90, 0x8A, 0xEF, -+0x12, 0x92, 0x46, 0x02, 0x97, 0xC8, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, -+0xE0, 0x30, 0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, -+0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x12, 0x75, -+0x11, 0x10, 0x80, 0x2E, 0x12, 0x7A, 0x65, 0xEF, -+0x64, 0x01, 0x60, 0x05, 0x75, 0x11, 0x01, 0x80, -+0x21, 0x90, 0x88, 0x31, 0x12, 0xB4, 0x92, 0x30, -+0xE0, 0x05, 0x75, 0x11, 0x02, 0x80, 0x13, 0x90, -+0x88, 0x38, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, -+0x75, 0x11, 0x08, 0x80, 0x05, 0x12, 0xCF, 0x5D, -+0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, -+0x90, 0x01, 0xB8, 0xE5, 0x11, 0xF0, 0x7F, 0x00, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, -+0x30, 0xE0, 0x1E, 0x90, 0x88, 0xAF, 0xE0, 0x60, -+0x05, 0x75, 0x12, 0x40, 0xA1, 0x7F, 0x90, 0x88, -+0x38, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, -+0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, -+0x55, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, -+0x05, 0x75, 0x12, 0x01, 0x80, 0x71, 0x90, 0x88, -+0x3A, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, -+0x12, 0x02, 0x80, 0x63, 0x90, 0x88, 0x38, 0xE0, -+0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x12, -+0x04, 0x80, 0x54, 0xEF, 0x30, 0xE2, 0x05, 0x75, -+0x12, 0x08, 0x80, 0x4B, 0x90, 0x88, 0x3A, 0xE0, -+0x30, 0xE4, 0x05, 0x75, 0x12, 0x10, 0x80, 0x3F, -+0x90, 0x88, 0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, -+0x20, 0xE0, 0x05, 0x75, 0x12, 0x20, 0x80, 0x2F, -+0x90, 0x88, 0x9C, 0xE0, 0x60, 0x05, 0x75, 0x12, -+0x80, 0x80, 0x24, 0x90, 0x06, 0x62, 0xE0, 0x30, -+0xE1, 0x05, 0x75, 0x12, 0x11, 0x80, 0x18, 0x90, -+0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, -+0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, 0x12, 0x12, -+0x80, 0x05, 0x12, 0xCF, 0x5D, 0x80, 0x0E, 0x90, -+0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, -+0xE5, 0x12, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, -+0xA3, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, -+0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, -+0xB1, 0xFC, 0x9F, 0x40, 0x41, 0x90, 0x88, 0x50, -+0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, -+0x90, 0x88, 0x50, 0xE0, 0xD3, 0x9F, 0x50, 0x2E, -+0x90, 0x88, 0x48, 0xE0, 0x24, 0x08, 0xF0, 0x90, -+0x88, 0x3F, 0x12, 0xB4, 0x9B, 0x33, 0x33, 0x33, -+0x54, 0xF8, 0xFF, 0x90, 0x88, 0x3E, 0xE0, 0x2F, -+0x90, 0x88, 0x4F, 0xF0, 0xFB, 0x90, 0x88, 0x48, -+0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x92, 0x98, -+0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x22, 0x90, -+0x88, 0x3F, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, -+0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x88, 0x93, 0xE0, -+0xFF, 0x90, 0x88, 0x3F, 0xE0, 0xD3, 0x22, 0xE4, -+0xFE, 0x12, 0x8F, 0xAD, 0xE4, 0xF0, 0x74, 0x95, -+0x2E, 0x12, 0x8B, 0x93, 0x74, 0xFF, 0xF0, 0x0E, -+0xEE, 0xB4, 0xA0, 0xED, 0xE4, 0x90, 0x88, 0x4D, -+0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, -+0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, -+0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xD1, 0x3A, 0x02, -+0x04, 0x80, 0x7E, 0x00, 0x7F, 0x04, 0x7D, 0x00, -+0x7B, 0x01, 0x7A, 0x93, 0x79, 0x3B, 0x22, 0x90, -+0x96, 0xCE, 0xA3, 0xE0, 0xFF, 0x90, 0x92, 0x13, -+0x74, 0x03, 0xF0, 0x7B, 0x06, 0x7D, 0x01, 0x12, -+0x66, 0xDB, 0x90, 0x96, 0xD2, 0xEE, 0xF0, 0xFC, -+0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x96, 0xD1, 0xE0, -+0xFF, 0x74, 0x10, 0x2D, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x96, 0xD0, -+0x22, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, 0x90, -+0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, -+0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, -+0x22, 0x74, 0xB6, 0x25, 0x0E, 0xF5, 0x82, 0xE4, -+0x34, 0x8E, 0xF5, 0x83, 0xE0, 0x22, 0xE4, 0x90, -+0x92, 0x20, 0xF0, 0x90, 0x95, 0xF7, 0xE0, 0xFF, -+0x90, 0x93, 0xD6, 0xE0, 0x2F, 0x22, 0xE0, 0x54, -+0x03, 0x90, 0x92, 0x80, 0xF0, 0x7B, 0x01, 0xAF, -+0x0E, 0x02, 0x75, 0x80, 0x33, 0x33, 0x33, 0x54, -+0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, 0x74, 0x50, -+0xF0, 0x22, 0x75, 0xF0, 0x02, 0xA4, 0xF5, 0x82, -+0x85, 0xF0, 0x83, 0x02, 0x03, 0x3E, 0x74, 0xA6, -+0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, -+0x83, 0x22, 0x74, 0x5F, 0x25, 0x67, 0xF5, 0x82, -+0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xE6, -+0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, -+0x83, 0x22, 0x74, 0xB6, 0x25, 0x67, 0xF5, 0x82, -+0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x90, 0x05, -+0x22, 0xE0, 0x90, 0x96, 0x1F, 0xF0, 0x22, 0x90, -+0x00, 0x06, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0x22, -+0x90, 0x93, 0x3D, 0xE0, 0x90, 0x01, 0x3F, 0x22, -+0x90, 0x88, 0x3C, 0xE0, 0x90, 0x05, 0x73, 0x22, -+0xF0, 0x90, 0x96, 0x1D, 0x74, 0x01, 0xF0, 0x22, -+0x93, 0xFD, 0x7C, 0x00, 0x02, 0x02, 0x80, 0xE5, -+0x69, 0x90, 0x81, 0x9D, 0x93, 0xFF, 0x22, 0x90, -+0x00, 0x04, 0x12, 0x03, 0x3E, 0x2F, 0x22, 0x90, -+0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0xF0, -+0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0x22, 0xF5, -+0x46, 0x89, 0x47, 0x75, 0x48, 0x04, 0x22, 0x00, -+0xB3, 0xE5 -+}; -+ -+u4Byte array_length_mp_8723d_fw_nic = 26498; -+ -+u1Byte array_mp_8723d_fw_wowlan[] = { -+0xD1, 0x23, 0x30, 0x00, 0x1D, 0x00, 0x02, 0x00, -+0x04, 0x14, 0x11, 0x14, 0x16, 0x7D, 0x02, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x02, 0x88, 0xE9, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xDA, 0x0B, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xE5, 0x4A, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xD9, 0x2A, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xDF, 0xD2, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0xE4, 0xF4, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, -+0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, -+0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, -+0xFF, 0xEE, 0x9A, 0xFE, 0xED, 0x99, 0xFD, 0xEC, -+0x98, 0xFC, 0x22, 0xE8, 0x8F, 0xF0, 0xA4, 0xCC, -+0x8B, 0xF0, 0xA4, 0x2C, 0xFC, 0xE9, 0x8E, 0xF0, -+0xA4, 0x2C, 0xFC, 0x8A, 0xF0, 0xED, 0xA4, 0x2C, -+0xFC, 0xEA, 0x8E, 0xF0, 0xA4, 0xCD, 0xA8, 0xF0, -+0x8B, 0xF0, 0xA4, 0x2D, 0xCC, 0x38, 0x25, 0xF0, -+0xFD, 0xE9, 0x8F, 0xF0, 0xA4, 0x2C, 0xCD, 0x35, -+0xF0, 0xFC, 0xEB, 0x8E, 0xF0, 0xA4, 0xFE, 0xA9, -+0xF0, 0xEB, 0x8F, 0xF0, 0xA4, 0xCF, 0xC5, 0xF0, -+0x2E, 0xCD, 0x39, 0xFE, 0xE4, 0x3C, 0xFC, 0xEA, -+0xA4, 0x2D, 0xCE, 0x35, 0xF0, 0xFD, 0xE4, 0x3C, -+0xFC, 0x22, 0x75, 0xF0, 0x08, 0x75, 0x82, 0x00, -+0xEF, 0x2F, 0xFF, 0xEE, 0x33, 0xFE, 0xCD, 0x33, -+0xCD, 0xCC, 0x33, 0xCC, 0xC5, 0x82, 0x33, 0xC5, -+0x82, 0x9B, 0xED, 0x9A, 0xEC, 0x99, 0xE5, 0x82, -+0x98, 0x40, 0x0C, 0xF5, 0x82, 0xEE, 0x9B, 0xFE, -+0xED, 0x9A, 0xFD, 0xEC, 0x99, 0xFC, 0x0F, 0xD5, -+0xF0, 0xD6, 0xE4, 0xCE, 0xFB, 0xE4, 0xCD, 0xFA, -+0xE4, 0xCC, 0xF9, 0xA8, 0x82, 0x22, 0xB8, 0x00, -+0xC1, 0xB9, 0x00, 0x59, 0xBA, 0x00, 0x2D, 0xEC, -+0x8B, 0xF0, 0x84, 0xCF, 0xCE, 0xCD, 0xFC, 0xE5, -+0xF0, 0xCB, 0xF9, 0x78, 0x18, 0xEF, 0x2F, 0xFF, -+0xEE, 0x33, 0xFE, 0xED, 0x33, 0xFD, 0xEC, 0x33, -+0xFC, 0xEB, 0x33, 0xFB, 0x10, 0xD7, 0x03, 0x99, -+0x40, 0x04, 0xEB, 0x99, 0xFB, 0x0F, 0xD8, 0xE5, -+0xE4, 0xF9, 0xFA, 0x22, 0x78, 0x18, 0xEF, 0x2F, -+0xFF, 0xEE, 0x33, 0xFE, 0xED, 0x33, 0xFD, 0xEC, -+0x33, 0xFC, 0xC9, 0x33, 0xC9, 0x10, 0xD7, 0x05, -+0x9B, 0xE9, 0x9A, 0x40, 0x07, 0xEC, 0x9B, 0xFC, -+0xE9, 0x9A, 0xF9, 0x0F, 0xD8, 0xE0, 0xE4, 0xC9, -+0xFA, 0xE4, 0xCC, 0xFB, 0x22, 0x75, 0xF0, 0x10, -+0xEF, 0x2F, 0xFF, 0xEE, 0x33, 0xFE, 0xED, 0x33, -+0xFD, 0xCC, 0x33, 0xCC, 0xC8, 0x33, 0xC8, 0x10, -+0xD7, 0x07, 0x9B, 0xEC, 0x9A, 0xE8, 0x99, 0x40, -+0x0A, 0xED, 0x9B, 0xFD, 0xEC, 0x9A, 0xFC, 0xE8, -+0x99, 0xF8, 0x0F, 0xD5, 0xF0, 0xDA, 0xE4, 0xCD, -+0xFB, 0xE4, 0xCC, 0xFA, 0xE4, 0xC8, 0xF9, 0x22, -+0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, -+0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, -+0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, -+0xFC, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, -+0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE0, 0xFB, -+0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, -+0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, -+0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, -+0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, -+0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, -+0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, -+0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xE3, 0xF5, -+0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, 0xDF, -+0xF5, 0x80, 0x67, 0xE3, 0xF5, 0xF0, 0x09, 0xE6, -+0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, 0x5A, -+0x87, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x52, -+0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, 0xE2, -+0x08, 0xB5, 0xF0, 0x46, 0xDF, 0xF6, 0x80, 0x42, -+0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE0, -+0xA3, 0xB5, 0xF0, 0x36, 0xDF, 0xF6, 0x80, 0x32, -+0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE4, -+0x93, 0xA3, 0xB5, 0xF0, 0x25, 0xDF, 0xF5, 0x80, -+0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, -+0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x14, 0xDF, 0xF5, -+0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, -+0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x02, -+0xDF, 0xF4, 0x02, 0x85, 0xC5, 0x80, 0x87, 0x80, -+0xE9, 0x80, 0x90, 0x80, 0xD4, 0x80, 0x3E, 0x80, -+0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, 0x80, -+0xB7, 0x80, 0x8D, 0x80, 0xA3, 0x80, 0x51, 0x80, -+0x74, 0x80, 0x3C, 0x02, 0x85, 0xD1, 0x89, 0x82, -+0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, -+0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, -+0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, 0xDF, -+0xE3, 0xDE, 0xE1, 0x80, 0x70, 0x89, 0x82, 0x8A, -+0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, -+0xB5, 0xF0, 0x62, 0xDF, 0xF4, 0x80, 0x5E, 0x89, -+0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE6, -+0x08, 0xB5, 0xF0, 0x51, 0xDF, 0xF5, 0x80, 0x4D, -+0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, -+0xE2, 0x08, 0xB5, 0xF0, 0x40, 0xDF, 0xF5, 0x80, -+0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, -+0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x2E, 0xDF, -+0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, 0x89, -+0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, -+0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, -+0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, 0xDF, -+0xE4, 0xDE, 0xE2, 0x80, 0x00, 0x7F, 0xFF, 0xB5, -+0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, 0x01, -+0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, -+0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, -+0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, -+0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xD5, -+0xDF, 0xE5, 0xDE, 0xE3, 0x80, 0xCF, 0x89, 0x82, -+0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, -+0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, -+0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, -+0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xAF, 0xDF, 0xE4, -+0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, 0x60, -+0x01, 0x0E, 0x4E, 0x60, 0xAB, 0xED, 0x24, 0x02, -+0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, 0xEB, -+0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x8E, 0x23, -+0x23, 0x45, 0x82, 0x23, 0x90, 0x85, 0x0D, 0x73, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x86, 0x44, -+0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, -+0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, -+0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, -+0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, -+0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, -+0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, -+0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, -+0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, -+0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, -+0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, -+0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, -+0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, -+0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, -+0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, -+0x76, 0x30, 0x90, 0x89, 0x80, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, -+0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, -+0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, -+0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, -+0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, -+0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, -+0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, -+0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, -+0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, -+0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x89, 0x80, 0x93, 0xF6, 0x08, 0xEF, -+0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, -+0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, -+0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x86, 0x8D, 0x50, -+0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, -+0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, -+0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, -+0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, -+0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, -+0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, -+0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, -+0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, -+0xE2, 0x01, 0x0F, 0x02, 0x86, 0x8C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, -+0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, -+0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, -+0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, -+0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x86, 0x8D, 0x7F, -+0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, -+0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, -+0x22, 0x02, 0x89, 0x27, 0x02, 0x87, 0x1D, 0xE4, -+0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, -+0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, -+0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, -+0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, -+0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, -+0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, -+0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, -+0x89, 0x6C, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, -+0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, -+0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, -+0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, -+0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, -+0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, -+0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, -+0xDE, 0xE7, 0x80, 0xBE, 0x41, 0x9C, 0xAC, 0x00, -+0x41, 0x9B, 0x63, 0x00, 0x41, 0x9A, 0xE2, 0x00, -+0x44, 0x9C, 0x8C, 0x00, 0x50, 0xF2, 0x01, 0x00, -+0xD4, 0x4D, 0xD1, 0x28, 0x8D, 0x95, 0x90, 0x9C, -+0xA7, 0xEF, 0xF0, 0x7F, 0x02, 0x11, 0x67, 0x90, -+0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x9C, 0xA7, 0xE0, -+0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, 0x22, -+0x12, 0xF7, 0x3E, 0x90, 0x86, 0xB4, 0xD1, 0xFE, -+0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB5, 0xF1, 0xED, -+0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, 0xF0, 0xF1, -+0xF4, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB7, 0x12, -+0x97, 0x30, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB8, -+0x12, 0x96, 0x2D, 0xFF, 0xED, 0x2F, 0x90, 0x86, -+0xB9, 0x12, 0xF7, 0x31, 0x90, 0x86, 0xBA, 0xF0, -+0x22, 0x90, 0x9C, 0x71, 0x12, 0x84, 0x67, 0x90, -+0x9C, 0x70, 0xEF, 0xF0, 0x12, 0x84, 0x70, 0x8A, -+0x63, 0x00, 0x8A, 0x67, 0x01, 0x8A, 0x6B, 0x03, -+0x8A, 0x70, 0x04, 0x8A, 0x75, 0x06, 0x8A, 0x86, -+0x12, 0x8A, 0x8B, 0x14, 0x8A, 0x90, 0x1E, 0x8A, -+0x95, 0x20, 0x8A, 0x9A, 0x25, 0x8A, 0x9F, 0x27, -+0x8A, 0xA4, 0x29, 0x8A, 0xA9, 0x2A, 0x8A, 0xAE, -+0x60, 0x8A, 0xB3, 0x61, 0x8A, 0xB8, 0x62, 0x8A, -+0xBD, 0x63, 0x8A, 0xC2, 0x64, 0x8A, 0xC7, 0x65, -+0x8A, 0xCC, 0x66, 0x8A, 0xD1, 0x67, 0x8A, 0xD6, -+0x68, 0x8A, 0xDB, 0x69, 0x8A, 0xE0, 0x6B, 0x8A, -+0xE5, 0x6C, 0x8A, 0xEA, 0x6D, 0x8A, 0xEF, 0x6E, -+0x8A, 0xF4, 0x6F, 0x8A, 0xF9, 0x70, 0x8B, 0x03, -+0x80, 0x8A, 0xFE, 0x81, 0x8B, 0x07, 0x82, 0x8B, -+0x0C, 0x83, 0x8B, 0x11, 0x84, 0x8B, 0x1B, 0x86, -+0x8B, 0x16, 0x88, 0x8B, 0x20, 0xC3, 0x8A, 0x7A, -+0xC6, 0x8A, 0x7A, 0xC7, 0x8A, 0x7A, 0xC8, 0x00, -+0x00, 0x8B, 0x25, 0x71, 0x35, 0x21, 0xA0, 0x71, -+0x35, 0x61, 0x3B, 0x71, 0x35, 0x02, 0xF2, 0x24, -+0x71, 0x35, 0x02, 0xF7, 0x98, 0x71, 0x35, 0x02, -+0xC1, 0x2A, 0x90, 0x9C, 0x70, 0xE0, 0xFF, 0xA3, -+0x12, 0x84, 0x5E, 0x02, 0xC1, 0xD6, 0x71, 0x35, -+0x02, 0x90, 0x00, 0x71, 0x35, 0x02, 0x97, 0xF9, -+0x71, 0x35, 0x02, 0x98, 0x08, 0x71, 0x35, 0x02, -+0x95, 0x5B, 0x71, 0x35, 0x02, 0xA0, 0x03, 0x71, -+0x35, 0x02, 0xA0, 0x46, 0x71, 0x35, 0x02, 0xB0, -+0x16, 0x71, 0x35, 0x02, 0xA8, 0x03, 0x71, 0x35, -+0x02, 0xB7, 0xFD, 0x71, 0x35, 0x02, 0x77, 0x4F, -+0x71, 0x35, 0x02, 0x7C, 0x60, 0x71, 0x35, 0x02, -+0x7A, 0xC6, 0x71, 0x35, 0x02, 0x5D, 0x36, 0x71, -+0x35, 0x02, 0x7B, 0xE9, 0x71, 0x35, 0x02, 0x70, -+0x33, 0x71, 0x35, 0x02, 0x48, 0xC9, 0x71, 0x35, -+0x02, 0x79, 0xF3, 0x71, 0x35, 0x02, 0xBF, 0xF3, -+0x71, 0x35, 0x02, 0x51, 0x7B, 0x71, 0x35, 0x02, -+0x79, 0x30, 0x71, 0x35, 0x02, 0x57, 0xF2, 0x71, -+0x35, 0x02, 0x74, 0x8D, 0x71, 0x35, 0x02, 0x78, -+0x9A, 0x71, 0x35, 0x02, 0x5E, 0x0B, 0x71, 0x35, -+0x02, 0xF4, 0xD1, 0x71, 0x35, 0xC1, 0x09, 0x71, -+0x35, 0x02, 0xF6, 0xE9, 0x71, 0x35, 0x02, 0xF6, -+0xF7, 0x71, 0x35, 0x02, 0xF7, 0x4C, 0x71, 0x35, -+0x02, 0xF7, 0x86, 0x71, 0x35, 0x02, 0xCD, 0x7F, -+0x71, 0x35, 0x02, 0xC8, 0x18, 0x90, 0x01, 0xC0, -+0xE0, 0x44, 0x01, 0xF0, 0x90, 0x9C, 0x70, 0xE0, -+0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, 0x9C, 0x71, -+0x02, 0x84, 0x5E, 0xF1, 0xFA, 0x90, 0x98, 0x25, -+0xE0, 0x70, 0x12, 0x91, 0x04, 0x12, 0x02, 0x06, -+0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x06, 0x90, -+0x98, 0x2B, 0x74, 0x01, 0xF0, 0x90, 0x98, 0x27, -+0xE0, 0x70, 0x12, 0x91, 0x04, 0x12, 0x02, 0x06, -+0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x06, 0x90, -+0x98, 0x2C, 0x74, 0x01, 0xF0, 0x91, 0x04, 0xD1, -+0xFF, 0xFF, 0x90, 0x99, 0x8C, 0xF0, 0x12, 0x02, -+0x06, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x91, 0x04, -+0xF1, 0xEE, 0x90, 0x99, 0x8D, 0xF0, 0x80, 0x05, -+0x90, 0x99, 0x8D, 0xEF, 0xF0, 0x90, 0x99, 0x8C, -+0xE0, 0x90, 0x99, 0x8B, 0xF0, 0x90, 0x99, 0x8D, -+0xE0, 0xFE, 0x90, 0x99, 0x8B, 0xE0, 0xFF, 0xD3, -+0x9E, 0x50, 0x3B, 0x91, 0x04, 0x12, 0x02, 0x06, -+0x54, 0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x99, -+0x8B, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x90, -+0x99, 0x8B, 0x70, 0x07, 0xE0, 0xFF, 0x12, 0xC8, -+0x3B, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0xC8, 0x2E, -+0x90, 0x98, 0x2C, 0xE0, 0x60, 0x08, 0x90, 0x99, -+0x8B, 0xE0, 0xFF, 0x12, 0xC8, 0x3B, 0x90, 0x99, -+0x8B, 0xE0, 0x04, 0xF0, 0x80, 0xB7, 0x90, 0x05, -+0x5E, 0xE4, 0xF0, 0x90, 0x99, 0x8C, 0xE0, 0x70, -+0x1A, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x13, -+0x90, 0x86, 0x0C, 0x91, 0x14, 0x90, 0x8A, 0xED, -+0x91, 0x14, 0x12, 0xDB, 0x46, 0x54, 0xBF, 0xF0, -+0x54, 0x7F, 0xF0, 0x22, 0x90, 0x99, 0x88, 0x02, -+0x84, 0x5E, 0x7D, 0xFF, 0xE4, 0xFF, 0x12, 0x98, -+0x60, 0x90, 0x8A, 0xFD, 0xE0, 0xFE, 0xA3, 0xE0, -+0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0xAD, -+0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, 0xC4, -+0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xA1, -+0x90, 0xEE, 0x12, 0xBF, 0xE4, 0x30, 0xE0, 0x02, -+0xA1, 0x90, 0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, -+0x70, 0x02, 0xA1, 0x90, 0xEF, 0x70, 0x02, 0x81, -+0xEC, 0x24, 0xFE, 0x70, 0x02, 0xA1, 0x31, 0x24, -+0xFE, 0x60, 0x4F, 0x24, 0xFC, 0x70, 0x02, 0xA1, -+0x76, 0x24, 0xFC, 0x60, 0x02, 0xA1, 0x86, 0xEE, -+0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, -+0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, -+0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, -+0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, -+0x04, 0x11, 0x90, 0x9C, 0xAD, 0xE0, 0xFF, 0x60, -+0x05, 0x12, 0x67, 0x80, 0x80, 0x05, 0x90, 0x8A, -+0xED, 0x91, 0x14, 0x90, 0x88, 0x39, 0xE0, 0x64, -+0x08, 0x60, 0x02, 0xA1, 0x86, 0x12, 0x7B, 0xCC, -+0xA1, 0x86, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, -+0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, -+0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, -+0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, -+0x00, 0x91, 0x14, 0xBF, 0x01, 0x03, 0x12, 0x71, -+0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, -+0x02, 0xA1, 0x86, 0x90, 0x86, 0x00, 0x91, 0x14, -+0xEF, 0x64, 0x01, 0x60, 0x02, 0xA1, 0x86, 0x12, -+0x68, 0xC2, 0xA1, 0x86, 0x90, 0x88, 0x39, 0xE0, -+0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0x91, 0x14, -+0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, -+0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, -+0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, -+0x86, 0x00, 0x91, 0x14, 0xBF, 0x01, 0x03, 0x12, -+0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, -+0x70, 0x64, 0x90, 0x86, 0x02, 0x91, 0x14, 0xEF, -+0x64, 0x01, 0x70, 0x5A, 0x12, 0x73, 0x5A, 0x80, -+0x55, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, -+0x90, 0x86, 0x00, 0x91, 0x14, 0xBF, 0x01, 0x03, -+0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, -+0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, -+0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0x91, -+0x14, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, -+0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, -+0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, -+0x15, 0x12, 0x7A, 0x49, 0x80, 0x10, 0x90, 0x88, -+0x39, 0xE0, 0xB4, 0x0C, 0x09, 0x12, 0xCF, 0xBE, -+0x30, 0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, 0x88, -+0x39, 0x12, 0xFC, 0x96, 0x90, 0x01, 0xBB, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFB, 0xFA, -+0xFD, 0x7F, 0x01, 0x11, 0x8E, 0x90, 0x9A, 0x0A, -+0xEF, 0xF0, 0x60, 0xF1, 0x90, 0x86, 0xAF, 0xE0, -+0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE6, 0xC2, -+0xAF, 0xEF, 0x30, 0xE1, 0x0C, 0x90, 0x86, 0xAF, -+0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x86, 0x08, 0x91, -+0x14, 0xD1, 0x01, 0xE0, 0x30, 0xE2, 0x08, 0x54, -+0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x91, 0x14, 0xD1, -+0x01, 0xE0, 0xFF, 0x30, 0xE4, 0x0C, 0x54, 0xEF, -+0xF0, 0x12, 0xD6, 0x92, 0xBF, 0x01, 0x03, 0x12, -+0xC9, 0xA5, 0xD1, 0x01, 0xE0, 0x30, 0xE6, 0x08, -+0x54, 0xBF, 0xF0, 0x90, 0x8A, 0x7D, 0x91, 0x14, -+0xD1, 0x01, 0xE0, 0xFF, 0x30, 0xE7, 0x06, 0x54, -+0x7F, 0xF0, 0x12, 0xB4, 0x20, 0xD2, 0xAF, 0x80, -+0xA3, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x86, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0xF1, 0xFA, 0x12, 0x02, 0x06, 0x20, 0xE0, 0x05, -+0x12, 0xF2, 0x5C, 0xC1, 0xF8, 0x91, 0x04, 0x12, -+0xBF, 0xEB, 0x90, 0x93, 0x27, 0x12, 0xCF, 0xDD, -+0xF1, 0x0E, 0x12, 0xF5, 0xF3, 0x90, 0x93, 0x27, -+0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, -+0xF1, 0x0D, 0x12, 0xF6, 0x07, 0x90, 0x93, 0x27, -+0xF1, 0x05, 0x12, 0xBF, 0xCE, 0x4D, 0xFF, 0x90, -+0x93, 0x27, 0x12, 0xF6, 0x10, 0xD1, 0xFE, 0x54, -+0x80, 0xFF, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x7F, -+0x4F, 0x12, 0x97, 0x30, 0xFF, 0x54, 0x02, 0xFE, -+0x90, 0x93, 0x2B, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, -+0x12, 0x02, 0x06, 0xFE, 0x13, 0x13, 0x54, 0x3F, -+0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, -+0x04, 0xF0, 0xEE, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, -+0x08, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x02, -+0x09, 0x90, 0x93, 0x28, 0x12, 0xBF, 0xE3, 0x20, -+0xE0, 0x40, 0x91, 0x04, 0xD1, 0xFF, 0x54, 0x7F, -+0xFE, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x80, 0x4E, -+0xF1, 0xED, 0x90, 0x93, 0x29, 0xF0, 0xF1, 0xF4, -+0xFE, 0x54, 0x01, 0xFD, 0x90, 0x93, 0x2A, 0x12, -+0xF5, 0xEB, 0x54, 0xFE, 0xFE, 0xED, 0x54, 0x01, -+0x4E, 0xF0, 0xEF, 0x54, 0x04, 0xFF, 0xA3, 0xE0, -+0x54, 0xFB, 0x4F, 0xF0, 0xF1, 0x22, 0x54, 0x07, -+0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, -+0xA8, 0xE1, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x01, -+0x07, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, -+0x90, 0x95, 0x5F, 0x74, 0x05, 0xF0, 0x12, 0xD7, -+0x6B, 0x7A, 0x94, 0x79, 0x3E, 0x12, 0x04, 0x80, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFE, 0xF0, 0x90, -+0x00, 0x01, 0x02, 0x02, 0x1F, 0xF0, 0xEE, 0x54, -+0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, 0xF0, -+0x12, 0x02, 0x06, 0xFE, 0x22, 0x90, 0x9A, 0xDC, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, -+0xF1, 0xCE, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x7F, -+0xFF, 0x90, 0x93, 0x27, 0xE0, 0xFE, 0xC4, 0x13, -+0x22, 0x90, 0x9A, 0xDC, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0x9A, 0xDF, 0xEB, 0xF0, 0x90, 0x9A, -+0xDE, 0xED, 0xF0, 0x60, 0x14, 0x12, 0xFC, 0xC5, -+0x78, 0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0xF0, 0xEE, 0x90, 0x9A, 0xDC, 0xF0, 0x80, -+0x1A, 0x12, 0xFC, 0xC5, 0x78, 0x06, 0xC3, 0x33, -+0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xF0, 0xEE, 0x90, -+0x9A, 0xDC, 0xF0, 0x74, 0xFF, 0x75, 0xF0, 0xD0, -+0x12, 0x02, 0xE7, 0xF1, 0x22, 0x54, 0x07, 0x7D, -+0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0xA8, -+0xE1, 0xF1, 0x22, 0x54, 0x01, 0xFD, 0x12, 0xA8, -+0xE1, 0x90, 0x9A, 0xE0, 0xE0, 0x60, 0x3E, 0xF1, -+0x15, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, -+0x7D, 0x01, 0x12, 0xA8, 0xE1, 0xE4, 0x90, 0x9A, -+0xE1, 0xF0, 0x90, 0x9A, 0xDF, 0xE0, 0xFF, 0x90, -+0x9A, 0xE1, 0xE0, 0xC3, 0x9F, 0x50, 0x1E, 0xF1, -+0x15, 0x54, 0x01, 0xFD, 0x12, 0xA8, 0xE1, 0xF1, -+0x15, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, -+0x7D, 0x01, 0x12, 0xA8, 0xE1, 0x90, 0x9A, 0xE1, -+0xE0, 0x04, 0xF0, 0x80, 0xD5, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x12, 0x8F, -+0x13, 0xBD, 0x01, 0x05, 0x12, 0x7A, 0xAE, 0x80, -+0x07, 0xAF, 0x13, 0xAE, 0x12, 0x12, 0x7C, 0x6A, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x00, -+0x02, 0x02, 0x02, 0x1F, 0x90, 0x00, 0x03, 0x02, -+0x02, 0x1F, 0x90, 0x99, 0x88, 0x02, 0x84, 0x67, -+0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0x03, 0xF0, -+0xBF, 0x01, 0x07, 0x11, 0x13, 0xE4, 0x90, 0x93, -+0x03, 0xF0, 0x22, 0x11, 0xBF, 0x7F, 0xEF, 0x7E, -+0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x06, 0x90, -+0x99, 0x88, 0xE0, 0xA3, 0xF0, 0x11, 0xBF, 0x7F, -+0xEE, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -+0x08, 0x90, 0x99, 0x88, 0xE0, 0x90, 0x99, 0x8A, -+0xF0, 0x11, 0xBF, 0x7F, 0xED, 0x7E, 0x01, 0x12, -+0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0x88, -+0xE0, 0x90, 0x99, 0x8B, 0xF0, 0x11, 0xBF, 0x7F, -+0xEC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -+0x08, 0x90, 0x99, 0x88, 0xE0, 0x90, 0x99, 0x8C, -+0xF0, 0x11, 0xBF, 0x7F, 0xEB, 0x7E, 0x01, 0x12, -+0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0x88, -+0xE0, 0x90, 0x99, 0x8D, 0xF0, 0x90, 0x99, 0x89, -+0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, -+0xA3, 0xE0, 0x90, 0x99, 0x91, 0xF0, 0x90, 0x99, -+0x8D, 0xE0, 0x90, 0x99, 0x92, 0xF0, 0x90, 0x99, -+0x93, 0x74, 0x12, 0xF0, 0x90, 0x99, 0xB5, 0x74, -+0x05, 0xF0, 0x90, 0x99, 0x95, 0xEF, 0x12, 0xFC, -+0xF4, 0x90, 0x99, 0x91, 0xE0, 0x90, 0x99, 0x98, -+0xF0, 0x90, 0x99, 0x92, 0xE0, 0x90, 0x99, 0x99, -+0xF0, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0x93, 0x31, -+0x50, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xF0, 0x7B, -+0x01, 0x7A, 0x99, 0x79, 0x88, 0x22, 0x7E, 0x00, -+0x7F, 0x0B, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x98, -+0x79, 0x25, 0x12, 0x04, 0x80, 0x11, 0xBF, 0xF1, -+0xDE, 0xBF, 0x01, 0x1C, 0x90, 0x99, 0x88, 0xE0, -+0xFE, 0x54, 0x01, 0x90, 0x98, 0x25, 0xF0, 0xEE, -+0x54, 0x04, 0x90, 0x98, 0x27, 0xF0, 0x90, 0x99, -+0x88, 0xE0, 0x54, 0x08, 0x90, 0x98, 0x26, 0xF0, -+0x11, 0xBF, 0x91, 0xC3, 0x64, 0x01, 0x70, 0x35, -+0x90, 0x99, 0x88, 0xE0, 0x54, 0x07, 0x70, 0x15, -+0x7B, 0x01, 0x7A, 0x99, 0x79, 0x89, 0x7F, 0xFA, -+0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0F, -+0x90, 0x99, 0x89, 0x80, 0x03, 0x90, 0x99, 0x88, -+0xE0, 0x54, 0x07, 0x90, 0x98, 0x29, 0xF0, 0x90, -+0x99, 0x88, 0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, -+0x07, 0x90, 0x98, 0x28, 0xF0, 0x11, 0xBF, 0x7F, -+0xFD, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -+0x0E, 0x90, 0x99, 0x88, 0xE0, 0x54, 0x0C, 0x13, -+0x13, 0x54, 0x3F, 0x90, 0x98, 0x2A, 0xF0, 0x22, -+0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0xF5, 0x82, 0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, -+0x8A, 0x79, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, -+0x8E, 0x83, 0x22, 0x90, 0x99, 0x88, 0xEF, 0xF0, -+0x71, 0xBF, 0x7F, 0xF4, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xCF, 0xE0, -+0x90, 0x99, 0xD1, 0xF0, 0x71, 0xBF, 0x7F, 0xF5, -+0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, -+0x90, 0x99, 0xCF, 0xE0, 0x90, 0x99, 0xD2, 0xF0, -+0x71, 0xBF, 0x7F, 0xF6, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xCF, 0xE0, -+0x90, 0x99, 0xD3, 0xF0, 0x71, 0xBF, 0x7F, 0xF7, -+0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, -+0x90, 0x99, 0xCF, 0xE0, 0x90, 0x99, 0xD4, 0xF0, -+0x71, 0xBF, 0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xCF, 0xE0, -+0x90, 0x99, 0xD5, 0xF0, 0x71, 0xBF, 0xF1, 0xDE, -+0xBF, 0x01, 0x08, 0x90, 0x99, 0xCF, 0xE0, 0x90, -+0x99, 0xD6, 0xF0, 0x71, 0xBF, 0x91, 0xC3, 0x64, -+0x01, 0x70, 0x54, 0x90, 0x99, 0xCF, 0xE0, 0x90, -+0x99, 0xD7, 0xF0, 0x54, 0x07, 0x60, 0x08, 0x90, -+0x99, 0xCF, 0xE0, 0x54, 0xE0, 0x70, 0x40, 0x7B, -+0x01, 0x7A, 0x99, 0x79, 0xD0, 0x7F, 0xFA, 0x91, -+0xC5, 0x64, 0x01, 0x70, 0x32, 0x90, 0x99, 0xCF, -+0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, 0x90, 0x99, -+0xD7, 0xE0, 0xFE, 0x90, 0x99, 0xD0, 0xE0, 0x54, -+0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x99, 0xD7, 0xF0, -+0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x99, 0xD7, -+0xE0, 0xFF, 0x90, 0x99, 0xD0, 0xE0, 0x54, 0xE0, -+0xFE, 0xEF, 0x4E, 0x90, 0x99, 0xD7, 0xF0, 0x71, -+0xBF, 0x7F, 0xFD, 0x91, 0xC5, 0x64, 0x01, 0x70, -+0x4B, 0x90, 0x99, 0xCF, 0xE0, 0xFE, 0x54, 0xCC, -+0x90, 0x99, 0xD8, 0xF0, 0xEE, 0x54, 0x0C, 0xFF, -+0x60, 0x08, 0x90, 0x99, 0xCF, 0xE0, 0x54, 0xC0, -+0x70, 0x32, 0xEF, 0x70, 0x16, 0x90, 0x99, 0xD8, -+0xE0, 0xFF, 0x90, 0x99, 0xCF, 0xE0, 0x54, 0x03, -+0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, -+0x99, 0xD8, 0xF0, 0x90, 0x99, 0xCF, 0xE0, 0xFF, -+0x54, 0xC0, 0x70, 0x10, 0x90, 0x99, 0xD8, 0xE0, -+0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, -+0xFF, 0xEE, 0x4F, 0xF0, 0x71, 0xBF, 0x7F, 0xF0, -+0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, -+0x90, 0x99, 0xCF, 0xE0, 0x90, 0x99, 0xD9, 0xF0, -+0x71, 0xBF, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xCF, 0xE0, -+0x90, 0x99, 0xDA, 0xF0, 0x71, 0xBF, 0x7F, 0xF2, -+0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, -+0x90, 0x99, 0xCF, 0xE0, 0x90, 0x99, 0xDB, 0xF0, -+0x71, 0xBF, 0x7F, 0xF3, 0x7E, 0x01, 0x12, 0x5F, -+0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xCF, 0xE0, -+0x90, 0x99, 0xDC, 0xF0, 0x71, 0xBF, 0x7F, 0xFC, -+0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, -+0x90, 0x99, 0xCF, 0xE0, 0x90, 0x99, 0xDD, 0xF0, -+0x90, 0x99, 0x89, 0x74, 0x19, 0xF0, 0x90, 0x99, -+0xAB, 0x74, 0x08, 0xF0, 0x90, 0x99, 0xD1, 0xE0, -+0x90, 0x99, 0x8B, 0xF0, 0x90, 0x99, 0xD2, 0xE0, -+0x90, 0x99, 0x8C, 0xF0, 0x90, 0x99, 0xD3, 0xE0, -+0x90, 0x99, 0x8D, 0xF0, 0x90, 0x99, 0xD4, 0xE0, -+0x90, 0x99, 0x8E, 0xF0, 0x90, 0x99, 0xD5, 0xE0, -+0x90, 0x99, 0x8F, 0xF0, 0x90, 0x99, 0xD6, 0xE0, -+0x90, 0x99, 0x90, 0xF0, 0x90, 0x99, 0xD7, 0xE0, -+0x90, 0x99, 0x91, 0xF0, 0x90, 0x99, 0xD8, 0xE0, -+0x90, 0x99, 0x92, 0xF0, 0x90, 0x99, 0xAC, 0x74, -+0x1A, 0xF0, 0x90, 0x99, 0xCE, 0x74, 0x05, 0xF0, -+0x90, 0x99, 0xD9, 0xE0, 0x90, 0x99, 0xAE, 0xF0, -+0x90, 0x99, 0xDA, 0xE0, 0x90, 0x99, 0xAF, 0xF0, -+0x90, 0x99, 0xDB, 0xE0, 0x90, 0x99, 0xB0, 0xF0, -+0x90, 0x99, 0xDC, 0xE0, 0x90, 0x99, 0xB1, 0xF0, -+0x90, 0x99, 0xDD, 0xE0, 0x90, 0x99, 0xB2, 0xF0, -+0x90, 0x99, 0x88, 0xE0, 0xB4, 0x01, 0x19, 0x7B, -+0x01, 0x7A, 0x99, 0x79, 0x89, 0x12, 0xC1, 0xB8, -+0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x99, 0x79, -+0xAC, 0x31, 0x50, 0x7F, 0x04, 0x02, 0x04, 0x7E, -+0x75, 0x45, 0x01, 0x75, 0x46, 0x99, 0x75, 0x47, -+0x89, 0x75, 0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, -+0x79, 0xA0, 0x12, 0xF9, 0x7B, 0x75, 0x46, 0x99, -+0x75, 0x47, 0xAE, 0x75, 0x48, 0x05, 0x7B, 0x01, -+0x7A, 0x01, 0x79, 0xAA, 0x02, 0x69, 0xF5, 0x7B, -+0x01, 0x7A, 0x99, 0x79, 0xCF, 0x22, 0x7E, 0x00, -+0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, -+0x79, 0x31, 0x12, 0x04, 0x80, 0x12, 0xFC, 0x61, -+0x79, 0x08, 0x12, 0x04, 0x80, 0x90, 0x88, 0x35, -+0x74, 0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, 0xF0, -+0xA3, 0xF0, 0xA3, 0x74, 0x50, 0x91, 0xCC, 0xFE, -+0xE4, 0x33, 0x90, 0x88, 0x42, 0xF0, 0xA3, 0xCE, -+0x91, 0xCC, 0xFF, 0xF1, 0x3F, 0x12, 0xFA, 0xF4, -+0x90, 0x8A, 0x89, 0x31, 0x62, 0xE4, 0xFD, 0xFF, -+0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0x31, 0x62, -+0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, -+0x8A, 0x89, 0x31, 0x62, 0x7D, 0x0C, 0x7F, 0x01, -+0x12, 0x04, 0x7E, 0x90, 0x86, 0xB3, 0xE0, 0xFF, -+0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, 0x74, 0xD4, -+0xF0, 0x80, 0x18, 0xEF, 0xB4, 0x03, 0x0F, 0x90, -+0x88, 0x41, 0x74, 0xF4, 0xF0, 0x90, 0x00, 0x92, -+0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x05, 0xE4, 0x90, -+0x88, 0x41, 0xF0, 0x7F, 0x79, 0x12, 0x7B, 0x41, -+0xEF, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, -+0x28, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE2, 0x06, -+0x90, 0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, -+0x93, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, -+0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, -+0x74, 0x07, 0x91, 0xCC, 0xF1, 0x3F, 0x7E, 0x00, -+0x7F, 0x18, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, -+0x79, 0x0C, 0x12, 0x04, 0x80, 0x90, 0x8A, 0xA3, -+0x31, 0x62, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, -+0x05, 0x58, 0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, -+0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, -+0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, -+0x7F, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, -+0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, -+0x9C, 0xF0, 0x22, 0x7F, 0xFB, 0x7E, 0x01, 0x12, -+0x5F, 0xA6, 0xEF, 0x22, 0xF0, 0x90, 0x88, 0x53, -+0xE0, 0x24, 0x04, 0x22, 0xE4, 0x90, 0x9A, 0x0C, -+0xF0, 0x90, 0x9B, 0x63, 0x04, 0xF0, 0x90, 0x06, -+0x32, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x98, 0x01, -+0x12, 0x04, 0xB8, 0xEF, 0x24, 0x01, 0x12, 0xE3, -+0xAD, 0x90, 0x98, 0x01, 0x12, 0x04, 0x31, 0x12, -+0xF9, 0x8A, 0xE4, 0x90, 0x9A, 0xE4, 0xF0, 0xFF, -+0x12, 0xED, 0x15, 0x12, 0xC7, 0x81, 0x70, 0x43, -+0x90, 0x8A, 0xB9, 0x31, 0x62, 0x7D, 0x01, 0x7F, -+0x02, 0x12, 0x04, 0x7E, 0x7F, 0x05, 0x7E, 0x00, -+0x12, 0x7A, 0xAE, 0xF1, 0xED, 0x31, 0x62, 0xF1, -+0xD7, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, -+0x22, 0x90, 0x9A, 0x0C, 0xE0, 0x04, 0xF0, 0x7F, -+0x01, 0x7E, 0x00, 0x12, 0x7A, 0xAE, 0x90, 0x8A, -+0xB9, 0x31, 0x62, 0x7D, 0x01, 0x7F, 0x02, 0x12, -+0x04, 0x7E, 0x90, 0x9A, 0x0C, 0xE0, 0xD3, 0x94, -+0x0A, 0x40, 0xD6, 0x90, 0x9C, 0x55, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x00, 0x0A, 0x12, 0xEB, 0xC3, -+0x02, 0xB3, 0xAE, 0x12, 0x8F, 0xFA, 0x12, 0x02, -+0x06, 0xFF, 0x54, 0x7F, 0x90, 0x88, 0x36, 0xF0, -+0xEF, 0x12, 0xBF, 0xE4, 0xA3, 0x12, 0x8E, 0xFE, -+0xFD, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFF, 0x90, -+0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, 0xF0, 0x12, -+0x8F, 0xF4, 0xFC, 0x54, 0x01, 0x25, 0xE0, 0xFF, -+0x90, 0x88, 0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, -+0xEC, 0x54, 0x04, 0xC3, 0x13, 0xFF, 0x90, 0x88, -+0x33, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, -+0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xA3, 0xE0, 0x54, -+0x0F, 0x4F, 0x12, 0x8F, 0xED, 0x90, 0x88, 0x35, -+0xF1, 0x30, 0xFD, 0x90, 0x8A, 0x89, 0x31, 0x62, -+0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x9B, 0x63, -+0xE0, 0x60, 0x06, 0xF1, 0xED, 0x31, 0x62, 0xF1, -+0xD7, 0x12, 0x8C, 0x04, 0xD1, 0x2E, 0xFF, 0x54, -+0x01, 0xFE, 0x90, 0x88, 0x9B, 0x12, 0xCF, 0xDD, -+0xD1, 0x2C, 0xFE, 0x12, 0xF5, 0xF3, 0x90, 0x88, -+0x9B, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, -+0xF7, 0xD1, 0x2B, 0x12, 0xF6, 0x06, 0x90, 0x88, -+0x9B, 0xF0, 0xEE, 0x54, 0x20, 0xFE, 0xEF, 0x54, -+0xDF, 0xD1, 0x2B, 0x54, 0x40, 0xFE, 0xEF, 0x54, -+0xBF, 0x4E, 0x90, 0x88, 0x9B, 0xF0, 0x12, 0x5C, -+0x5F, 0x90, 0x88, 0x36, 0xE0, 0xB4, 0x01, 0x07, -+0x90, 0x88, 0x33, 0xE0, 0x54, 0xFB, 0xF0, 0x12, -+0xCF, 0xD3, 0xF0, 0x90, 0x88, 0x36, 0x12, 0xFC, -+0x96, 0x90, 0x01, 0xBB, 0xF1, 0xE5, 0x90, 0x01, -+0xBE, 0xF0, 0x22, 0x4E, 0xFF, 0xF0, 0x90, 0x00, -+0x05, 0x02, 0x02, 0x1F, 0x90, 0x9C, 0x3F, 0x12, -+0x84, 0x67, 0x90, 0x9C, 0x43, 0xE0, 0xFE, 0x64, -+0x04, 0x70, 0x0D, 0xF1, 0x1F, 0x12, 0x02, 0x06, -+0x90, 0x9C, 0x44, 0x12, 0x8E, 0xFE, 0x80, 0x11, -+0xEE, 0x64, 0x02, 0x70, 0x2E, 0xF1, 0x1F, 0x12, -+0x8F, 0xEE, 0x90, 0x9C, 0x44, 0xF0, 0x12, 0x02, -+0x06, 0x90, 0x9C, 0x45, 0xF1, 0x30, 0x90, 0x9C, -+0x46, 0xD1, 0x2D, 0x90, 0x9C, 0x47, 0x12, 0xC1, -+0xC5, 0x90, 0x9C, 0x48, 0xF0, 0x90, 0x00, 0x07, -+0x12, 0x02, 0x1F, 0x90, 0x9C, 0x49, 0xF0, 0x12, -+0x8F, 0xF4, 0xFF, 0xED, 0x70, 0x19, 0xFE, 0xF1, -+0x25, 0xE0, 0xB4, 0xFF, 0x06, 0xF1, 0x25, 0xE4, -+0xF0, 0x80, 0x07, 0xF1, 0x25, 0xE0, 0x04, 0xF0, -+0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x06, 0xE8, 0x90, -+0x9C, 0x43, 0xE0, 0xFE, 0xB4, 0x04, 0x18, 0xA3, -+0xE0, 0xFD, 0xF1, 0x1F, 0xED, 0xF1, 0x37, 0xFD, -+0xF1, 0x1F, 0x90, 0x00, 0x01, 0xED, 0x12, 0x02, -+0x5E, 0x90, 0x00, 0x02, 0xE4, 0x80, 0x20, 0xEE, -+0xB4, 0x02, 0x1F, 0x90, 0x9C, 0x45, 0xF1, 0x1D, -+0xEE, 0xF1, 0x37, 0x44, 0x20, 0x54, 0x7F, 0xF1, -+0x1E, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x02, 0x5E, -+0x90, 0x9C, 0x44, 0xE0, 0x90, 0x00, 0x02, 0x12, -+0x02, 0x5E, 0xF1, 0x1F, 0xE9, 0x24, 0x03, 0xF9, -+0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x44, 0x20, -+0x12, 0x02, 0x4C, 0x90, 0x9C, 0x46, 0xF1, 0x1D, -+0x90, 0x00, 0x04, 0xEE, 0x12, 0x02, 0x5E, 0x90, -+0x9C, 0x47, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x02, -+0x5E, 0x90, 0x9C, 0x48, 0xE0, 0x90, 0x00, 0x06, -+0x12, 0x02, 0x5E, 0x90, 0x9C, 0x49, 0xE0, 0x90, -+0x00, 0x07, 0x02, 0x02, 0x5E, 0xE0, 0xFE, 0x90, -+0x9C, 0x3F, 0x02, 0x84, 0x5E, 0x74, 0x44, 0x2E, -+0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x22, -+0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, 0x1F, 0x12, -+0x02, 0x4C, 0x90, 0x9C, 0x45, 0xE0, 0x22, 0x33, -+0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, -+0xA3, 0x74, 0x50, 0xF0, 0x22, 0x90, 0x88, 0x39, -+0xE0, 0xB4, 0x04, 0x08, 0x12, 0xAC, 0x13, 0x44, -+0x01, 0x12, 0xAC, 0xC9, 0x90, 0x88, 0x9D, 0xE0, -+0x20, 0xE0, 0x2D, 0x90, 0x88, 0x36, 0xE0, 0x64, -+0x01, 0x70, 0x25, 0xF1, 0xE6, 0x60, 0x13, 0x90, -+0x8A, 0xB9, 0x31, 0x62, 0xE4, 0xFD, 0x7F, 0x0C, -+0x12, 0x04, 0x7E, 0x12, 0xDA, 0xF5, 0xF9, 0x02, -+0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x08, -+0x90, 0x8A, 0xB9, 0x31, 0x62, 0x12, 0xC7, 0x69, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x9C, 0x99, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, -+0x90, 0x8A, 0xF9, 0x31, 0x62, 0x7D, 0x44, 0x7F, -+0x6F, 0x12, 0x04, 0x7E, 0x12, 0x8C, 0x11, 0x90, -+0x9C, 0x9A, 0xE0, 0x90, 0x9C, 0x99, 0xB4, 0x01, -+0x08, 0x12, 0xFC, 0x46, 0x44, 0x04, 0xF0, 0x80, -+0x06, 0x12, 0xFC, 0x46, 0x54, 0xFB, 0xF0, 0x90, -+0x8A, 0xF9, 0x31, 0x62, 0xE4, 0xFD, 0xFF, 0x12, -+0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, -+0x02, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x7F, 0xF9, -+0x7E, 0x01, 0x02, 0x5F, 0xA6, 0xF0, 0x90, 0x88, -+0x34, 0xE0, 0x54, 0x0F, 0x22, 0x90, 0x88, 0x38, -+0xE0, 0x90, 0x9A, 0xFC, 0xF0, 0x90, 0x8A, 0x89, -+0x22, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, -+0x98, 0x35, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, -+0x12, 0x02, 0x06, 0x90, 0x99, 0xAB, 0x12, 0x8E, -+0xFE, 0x90, 0x99, 0xAC, 0xF0, 0x60, 0x0E, 0x11, -+0x53, 0x12, 0xCF, 0xEC, 0x90, 0x99, 0xAC, 0x11, -+0x53, 0x7B, 0x57, 0x11, 0x60, 0x90, 0x99, 0x88, -+0x74, 0x20, 0xF0, 0x90, 0x99, 0xAA, 0x74, 0x03, -+0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x99, 0x8A, -+0xF0, 0x90, 0x98, 0x36, 0xE0, 0x90, 0x99, 0x8B, -+0xF0, 0x90, 0x98, 0x37, 0xE0, 0x90, 0x99, 0x8C, -+0x12, 0x90, 0xBE, 0x12, 0x91, 0x50, 0x7F, 0x04, -+0x02, 0x04, 0x7E, 0xE0, 0xFF, 0x90, 0x99, 0xAB, -+0xE0, 0xFD, 0x22, 0xE4, 0xFB, 0xFD, 0x7F, 0xFF, -+0xEB, 0xB4, 0x57, 0x05, 0x12, 0xFC, 0x81, 0x80, -+0x10, 0xEF, 0x70, 0x07, 0x90, 0x98, 0x36, 0xE0, -+0x4D, 0x80, 0x06, 0x12, 0xD0, 0x04, 0x12, 0xFC, -+0x81, 0x90, 0x05, 0x22, 0xF0, 0x90, 0x93, 0x01, -+0xEB, 0xF0, 0x22, 0x90, 0x9A, 0x38, 0x12, 0x84, -+0x67, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x9A, 0x49, -+0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0C, 0x7B, -+0x39, 0x12, 0x8C, 0x0A, 0xEF, 0x64, 0x01, 0x70, -+0x1C, 0x80, 0x00, 0x90, 0x98, 0x09, 0xE0, 0xFF, -+0x90, 0x92, 0x13, 0x74, 0x11, 0xF0, 0x7B, 0x18, -+0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x9A, 0x46, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x9A, 0x46, -+0x12, 0xCE, 0xC1, 0x90, 0x9A, 0x48, 0xEF, 0xF0, -+0x90, 0x9A, 0x46, 0xF1, 0xF9, 0x7B, 0x01, 0x90, -+0x9A, 0x44, 0xE0, 0xFD, 0x12, 0xF3, 0x9C, 0x90, -+0x9A, 0x45, 0xE0, 0x60, 0x02, 0x21, 0x66, 0xF1, -+0xCC, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, -+0x9A, 0x3B, 0x71, 0x5F, 0x75, 0x48, 0x06, 0xD0, -+0x01, 0xD0, 0x02, 0xD0, 0x03, 0x51, 0x15, 0xF1, -+0xE8, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, -+0x9A, 0x38, 0x71, 0x5F, 0x75, 0x48, 0x10, 0xD0, -+0x01, 0xD0, 0x02, 0xD0, 0x03, 0x51, 0x15, 0xF1, -+0xCF, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, -+0x9A, 0x3E, 0x71, 0x5F, 0x75, 0x48, 0x10, 0xD0, -+0x01, 0xD0, 0x02, 0xD0, 0x03, 0x51, 0x15, 0x24, -+0x60, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, -+0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x9A, -+0x3E, 0x71, 0x5F, 0x75, 0x48, 0x10, 0xD0, 0x01, -+0xD0, 0x02, 0xD0, 0x03, 0x51, 0x15, 0x24, 0x72, -+0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, -+0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x9A, 0x41, -+0x71, 0x5F, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, -+0x02, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x9A, -+0x3E, 0x12, 0x84, 0x5E, 0x90, 0x9A, 0x75, 0x12, -+0x84, 0x67, 0x90, 0x9A, 0x78, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x00, 0x20, 0x90, 0x9A, 0x7C, 0x74, -+0x3A, 0xF0, 0x90, 0x9A, 0x38, 0x12, 0x84, 0x5E, -+0x12, 0xF6, 0x68, 0x51, 0x18, 0xF1, 0xD9, 0x12, -+0xB7, 0x68, 0x75, 0x48, 0x28, 0x7B, 0x01, 0x7A, -+0x9A, 0x79, 0x4A, 0x51, 0x15, 0xF1, 0xD9, 0xFA, -+0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, -+0x93, 0x75, 0x47, 0xCD, 0x75, 0x48, 0x28, 0xD0, -+0x03, 0x12, 0x69, 0xF5, 0x90, 0x9A, 0x48, 0xE0, -+0xFF, 0x90, 0x9A, 0x47, 0xE0, 0x2F, 0xFF, 0x90, -+0x9A, 0x46, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, -+0xFD, 0xE4, 0x3F, 0xFC, 0x90, 0x98, 0x09, 0xE0, -+0xFB, 0x7F, 0x3A, 0x12, 0xB4, 0xD7, 0x51, 0x18, -+0xF1, 0xD9, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, -+0x45, 0x75, 0x46, 0x9A, 0x75, 0x47, 0x4A, 0x75, -+0x48, 0x28, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, -+0x98, 0x05, 0xE0, 0xB4, 0x02, 0x0C, 0x90, 0x98, -+0x09, 0xE0, 0xFF, 0x90, 0x9A, 0x48, 0xE0, 0xFD, -+0xD1, 0x92, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x02, -+0xF0, 0x90, 0x9A, 0x49, 0xE0, 0xFD, 0x7B, 0x3A, -+0x12, 0xFC, 0x76, 0xF0, 0x22, 0x12, 0x69, 0xF5, -+0x90, 0x9A, 0x46, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, -+0x2F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x9C, 0x11, 0x12, 0x84, 0x67, 0x78, -+0x1D, 0x7C, 0x9C, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, -+0x80, 0x79, 0x8E, 0x12, 0xDF, 0x44, 0x90, 0x05, -+0x22, 0xE0, 0x90, 0x9C, 0x1C, 0xF0, 0x90, 0x04, -+0x1D, 0xE0, 0x60, 0x0C, 0x7B, 0x33, 0x12, 0x8C, -+0x0A, 0xEF, 0x64, 0x01, 0x70, 0x1C, 0x80, 0x00, -+0x90, 0x98, 0x08, 0xE0, 0xFF, 0x90, 0x92, 0x13, -+0x74, 0x10, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x12, -+0x66, 0xDB, 0x90, 0x9C, 0x19, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x9C, 0x19, 0x12, 0xCE, 0xC1, -+0x90, 0x9C, 0x1B, 0xEF, 0xF0, 0x90, 0x9C, 0x19, -+0xF1, 0xF9, 0x7B, 0x01, 0x90, 0x9C, 0x17, 0xE0, -+0xFD, 0x12, 0xF3, 0x9C, 0x90, 0x9C, 0x18, 0xE0, -+0x70, 0x4F, 0xF1, 0xCC, 0xC0, 0x03, 0xC0, 0x02, -+0xC0, 0x01, 0x71, 0x5C, 0x75, 0x48, 0x06, 0xD0, -+0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x69, 0xF5, -+0x90, 0x9C, 0x19, 0x51, 0x1B, 0xF1, 0xF2, 0xFA, -+0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, -+0x71, 0x5C, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, -+0x02, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x9C, -+0x19, 0x51, 0x1B, 0xF1, 0xE8, 0xC0, 0x03, 0xC0, -+0x02, 0xC0, 0x01, 0x90, 0x9C, 0x11, 0x71, 0x5F, -+0x75, 0x48, 0x04, 0xD0, 0x01, 0xD0, 0x02, 0x80, -+0x4C, 0x90, 0x9C, 0x18, 0xE0, 0x64, 0x01, 0x70, -+0x49, 0xF1, 0xCC, 0xC0, 0x03, 0x8B, 0x45, 0x75, -+0x46, 0x93, 0x75, 0x47, 0x49, 0x75, 0x48, 0x06, -+0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x9C, 0x19, -+0x51, 0x1B, 0xF1, 0xF2, 0xFA, 0x7B, 0x01, 0xC0, -+0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, -+0x53, 0x75, 0x48, 0x06, 0xD0, 0x03, 0x12, 0x69, -+0xF5, 0x90, 0x9C, 0x19, 0x51, 0x1B, 0xF1, 0xE8, -+0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, -+0x47, 0x59, 0x75, 0x48, 0x04, 0xD0, 0x03, 0x12, -+0x69, 0xF5, 0x90, 0x98, 0x05, 0xE0, 0xB4, 0x02, -+0x0C, 0x90, 0x98, 0x08, 0xE0, 0xFF, 0x90, 0x9C, -+0x1B, 0xE0, 0xFD, 0xD1, 0x92, 0x90, 0x06, 0x30, -+0xE0, 0x44, 0x10, 0xF0, 0x90, 0x9C, 0x1C, 0xE0, -+0xFD, 0x7B, 0x34, 0x12, 0xFC, 0x76, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9C, 0x14, 0x12, -+0x84, 0x5E, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x9A, 0x19, 0x12, 0xA7, 0xFA, 0x90, 0x9A, -+0x31, 0x74, 0x18, 0xF0, 0x7E, 0x00, 0x7F, 0x80, -+0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x39, -+0x12, 0x04, 0x80, 0x90, 0x01, 0xC4, 0x74, 0x69, -+0xF0, 0x74, 0x9B, 0xA3, 0xF0, 0x90, 0x98, 0x0A, -+0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, 0x9A, 0x30, -+0xEF, 0xF0, 0xF9, 0xE0, 0xFE, 0x24, 0x29, 0x12, -+0xE6, 0x3E, 0x74, 0x41, 0xF0, 0xEE, 0x24, 0x28, -+0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x9A, 0x31, 0xE0, -+0x7A, 0x00, 0x2D, 0xFE, 0xEA, 0x3C, 0x90, 0x9A, -+0x35, 0xF0, 0xA3, 0xCE, 0xF0, 0x74, 0x28, 0x29, -+0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x90, -+0x9A, 0x1B, 0xE0, 0xFD, 0x12, 0xF3, 0x9C, 0x12, -+0xFB, 0x9E, 0x90, 0x9A, 0x35, 0xE0, 0xFF, 0xA3, -+0xE0, 0x90, 0x9A, 0x33, 0xCF, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0x9A, 0x39, 0x74, 0x01, 0xF0, 0xA3, -+0x74, 0x03, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0x74, -+0x5F, 0xF0, 0x90, 0x9A, 0x35, 0xE4, 0x75, 0xF0, -+0x04, 0x12, 0x02, 0xE7, 0x90, 0x94, 0x39, 0xE0, -+0xFF, 0x7E, 0x02, 0xB4, 0xFE, 0x02, 0x7E, 0xFE, -+0x90, 0x9A, 0x35, 0xA3, 0xE0, 0xFD, 0xD1, 0x88, -+0xEE, 0xF0, 0x74, 0x00, 0x2D, 0xD1, 0x8A, 0xE0, -+0x90, 0x9A, 0x3D, 0xF0, 0x90, 0x9A, 0x35, 0x12, -+0xD5, 0xCD, 0x90, 0x95, 0x2E, 0xE0, 0x90, 0x9A, -+0x19, 0xB4, 0x01, 0x0B, 0xE0, 0x44, 0x03, 0xFC, -+0xA3, 0xE0, 0x44, 0x10, 0xFD, 0x80, 0x09, 0xE0, -+0x44, 0x03, 0xFC, 0xA3, 0xE0, 0x44, 0x20, 0xFD, -+0x90, 0x9A, 0x37, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, -+0x90, 0x9A, 0x19, 0xE0, 0x70, 0x04, 0xA3, 0xE0, -+0x64, 0x01, 0x90, 0x9A, 0x35, 0x70, 0x17, 0xA3, -+0xE0, 0xFE, 0xD1, 0x88, 0x12, 0xB6, 0x96, 0x74, -+0x01, 0xF0, 0x90, 0x9A, 0x3E, 0x74, 0x03, 0xF0, -+0xA3, 0x74, 0x01, 0xF0, 0x80, 0x13, 0xA3, 0xE0, -+0xFE, 0xD1, 0x88, 0x12, 0xB6, 0x96, 0x74, 0x02, -+0xF0, 0x90, 0x9A, 0x3E, 0x04, 0xF0, 0xA3, 0x14, -+0xF0, 0x12, 0xFC, 0x6C, 0xEF, 0x64, 0xFE, 0x90, -+0x9A, 0x35, 0x70, 0x21, 0xA3, 0xE0, 0x24, 0x00, -+0x12, 0xF3, 0x2C, 0xC0, 0x03, 0x8B, 0x45, 0x12, -+0xFC, 0xA0, 0xD0, 0x03, 0x12, 0xF9, 0x7B, 0x12, -+0xFC, 0xA0, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x40, -+0x12, 0x69, 0xF5, 0x80, 0x22, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x24, 0x00, 0xF5, 0x82, 0x74, 0xFC, -+0x3E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2F, -+0xF5, 0x82, 0x74, 0xFC, 0x3E, 0xF5, 0x83, 0xE4, -+0xF0, 0x90, 0x9A, 0x40, 0xF0, 0xA3, 0xF0, 0x12, -+0xFC, 0x6C, 0xE4, 0x90, 0x9A, 0x32, 0xF0, 0x12, -+0xFC, 0x1A, 0x90, 0x9A, 0x35, 0xA3, 0xE0, 0xFD, -+0xEF, 0x2D, 0xD1, 0x88, 0xEE, 0xF0, 0x12, 0xFC, -+0x1A, 0x74, 0x42, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x9A, 0xF5, 0x83, 0xEE, 0xF1, 0xE0, 0xE0, 0xB4, -+0x08, 0xDD, 0x12, 0xFB, 0xA8, 0x90, 0x9A, 0x35, -+0x12, 0xBF, 0xDC, 0x90, 0x9A, 0x35, 0x12, 0xBF, -+0xD5, 0x12, 0xFB, 0x9E, 0xE4, 0x90, 0x9A, 0xBC, -+0xF0, 0xE4, 0x90, 0x9A, 0x32, 0xF0, 0x12, 0xFC, -+0xB3, 0x50, 0x11, 0x12, 0xFB, 0xFC, 0xA3, 0x12, -+0xFB, 0xC7, 0x12, 0xFC, 0x8C, 0xD1, 0x87, 0xE4, -+0xF1, 0xE0, 0x80, 0xEA, 0x12, 0xCF, 0x71, 0x90, -+0x06, 0x31, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x98, -+0x0B, 0xE0, 0xFD, 0x12, 0xE6, 0x8D, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0x12, 0xFC, 0x3C, -+0xED, 0xFF, 0x90, 0x98, 0x0A, 0x12, 0xFC, 0x0E, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -+0x90, 0x9A, 0x31, 0xE0, 0x7C, 0x00, 0x2F, 0xFF, -+0xEC, 0x3E, 0xCF, 0x24, 0x38, 0xCF, 0x34, 0x00, -+0xFE, 0x90, 0x92, 0x06, 0x74, 0x10, 0xF0, 0x7B, -+0x63, 0xE4, 0xFD, 0x12, 0x71, 0xD4, 0x90, 0x9A, -+0x19, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, -+0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x39, 0x70, 0x17, -+0x90, 0x91, 0xA0, 0x12, 0xFC, 0xEC, 0x90, 0x91, -+0xA3, 0x12, 0x84, 0x67, 0x90, 0x91, 0xA6, 0x12, -+0xFC, 0xE4, 0x12, 0x6F, 0x34, 0x80, 0x15, 0x90, -+0x91, 0x96, 0x12, 0xFC, 0xEC, 0x90, 0x91, 0x99, -+0x12, 0x84, 0x67, 0x90, 0x91, 0x9C, 0x12, 0xFC, -+0xE4, 0x12, 0x6E, 0xF3, 0x90, 0x9A, 0xBC, 0xE0, -+0x04, 0xF0, 0x90, 0x06, 0x31, 0xE0, 0x30, 0xE2, -+0x07, 0x12, 0xFC, 0xDC, 0x50, 0x02, 0xA1, 0x19, -+0x12, 0xFC, 0xDC, 0x40, 0x0A, 0x90, 0x06, 0x35, -+0xE0, 0x44, 0x20, 0x90, 0x06, 0x34, 0xF0, 0xE4, -+0x90, 0x9A, 0x32, 0xF0, 0x12, 0xFC, 0xB3, 0x50, -+0x23, 0x12, 0xFB, 0xFC, 0xA3, 0x12, 0xFB, 0xC7, -+0x12, 0xFC, 0x8C, 0x90, 0x9A, 0x32, 0xE0, 0x24, -+0x1C, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, -+0xE0, 0xFF, 0x90, 0x9A, 0x30, 0xD1, 0x87, 0xEF, -+0xF1, 0xE0, 0x80, 0xD8, 0x90, 0x9A, 0x19, 0xE0, -+0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x0E, -+0x90, 0x98, 0x0A, 0xE0, 0xFF, 0x90, 0x9A, 0x31, -+0xE0, 0x24, 0x08, 0xFD, 0xD1, 0x92, 0x90, 0x04, -+0x1D, 0xE0, 0x60, 0x24, 0x90, 0x05, 0x22, 0xE0, -+0x90, 0x9A, 0xBB, 0xF0, 0x7B, 0x1D, 0x12, 0x8C, -+0x0A, 0xBF, 0x01, 0x07, 0x12, 0xFB, 0xB2, 0x90, -+0x04, 0x25, 0xF0, 0x90, 0x9A, 0xBB, 0xE0, 0xFD, -+0x7B, 0x1E, 0xE4, 0xFF, 0x11, 0x60, 0x80, 0x07, -+0x12, 0xFB, 0xB2, 0x90, 0x04, 0x25, 0xF0, 0x90, -+0x04, 0x1F, 0x74, 0x20, 0xF0, 0x90, 0x88, 0x39, -+0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, -+0x74, 0x69, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -+0x9B, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x12, 0x83, 0x00, 0xA8, 0x04, 0xA9, 0x05, 0xAA, -+0x06, 0xAB, 0x07, 0x90, 0x99, 0x88, 0xA3, 0xE0, -+0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0x22, 0x90, 0x9C, 0x24, 0xED, 0xF0, 0x90, -+0x9C, 0x23, 0xEF, 0xF0, 0x12, 0x7B, 0x07, 0x90, -+0x9C, 0x31, 0xEF, 0xF0, 0xE0, 0xFD, 0x24, 0x01, -+0x12, 0xB6, 0x9C, 0xE0, 0xFE, 0x74, 0x00, 0x2D, -+0xD1, 0x8A, 0x12, 0xBA, 0x6E, 0x54, 0x3F, 0x90, -+0x9C, 0x2E, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, -+0x9C, 0x2D, 0xF0, 0x12, 0xFC, 0xBC, 0x50, 0x0B, -+0x12, 0xFB, 0x70, 0xD1, 0x87, 0xE4, 0x12, 0xFC, -+0xFC, 0x80, 0xF0, 0x90, 0x9C, 0x2F, 0xE0, 0x24, -+0xF8, 0xFB, 0x90, 0x9C, 0x2E, 0xE0, 0x34, 0xFF, -+0xFA, 0x90, 0x9C, 0x24, 0xE0, 0xFF, 0x90, 0x91, -+0xDC, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0x74, -+0x01, 0xF0, 0x7D, 0x0A, 0x7C, 0x00, 0x7F, 0x10, -+0x7E, 0x00, 0x12, 0x6D, 0xED, 0x90, 0x98, 0x0B, -+0xE0, 0xFF, 0x90, 0x9C, 0x23, 0xE0, 0xFD, 0xD3, -+0x9F, 0x40, 0x3B, 0x90, 0x98, 0x0B, 0xE0, 0xFC, -+0x12, 0xE6, 0x8D, 0xCE, 0xC3, 0x13, 0xCE, 0x13, -+0xD8, 0xF9, 0x12, 0xFC, 0x3C, 0xEC, 0xFF, 0xC3, -+0xED, 0x12, 0xFC, 0x10, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0x24, 0x28, 0xFF, 0xE4, 0x3E, -+0xFE, 0x12, 0xFD, 0x0C, 0xFD, 0x90, 0x9C, 0x24, -+0xE0, 0xFC, 0xC3, 0xED, 0x9C, 0x12, 0xFD, 0x04, -+0x7D, 0x38, 0x7C, 0x00, 0x80, 0x3A, 0x90, 0x9C, -+0x23, 0xE0, 0xFD, 0x12, 0xE6, 0x8D, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0x12, 0xFC, 0x3C, -+0xED, 0xFF, 0x90, 0x98, 0x0B, 0x12, 0xFC, 0x0E, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, -+0x38, 0xFD, 0xE4, 0x3E, 0xFC, 0x12, 0xFD, 0x0C, -+0xFF, 0x90, 0x9C, 0x24, 0xE0, 0xFE, 0xC3, 0xEF, -+0x9E, 0x12, 0xFD, 0x04, 0x7F, 0x28, 0x7E, 0x00, -+0x12, 0x71, 0xD4, 0x12, 0xB7, 0xE8, 0x90, 0x91, -+0x45, 0x12, 0x84, 0x67, 0x0B, 0x7A, 0x9C, 0x79, -+0x25, 0x90, 0x91, 0x48, 0x12, 0x84, 0x67, 0x90, -+0x91, 0x4B, 0x74, 0x08, 0xF0, 0x7A, 0x94, 0x79, -+0x2D, 0x12, 0x4E, 0xA5, 0xE4, 0x90, 0x9C, 0x2D, -+0xF0, 0x12, 0xFC, 0xBC, 0x50, 0x1D, 0x12, 0xFB, -+0x70, 0x90, 0x9C, 0x2D, 0xE0, 0x24, 0x25, 0xF5, -+0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFF, -+0x90, 0x9C, 0x30, 0xD1, 0x87, 0xEF, 0x12, 0xFC, -+0xFC, 0x80, 0xDE, 0x22, 0xA3, 0xA3, 0xE0, 0x24, -+0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, -+0x22, 0x24, 0x30, 0xF9, 0xE4, 0x34, 0xFC, 0x22, -+0xF0, 0x90, 0x9A, 0x32, 0xE0, 0x04, 0xF0, 0x22, -+0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, -+0x01, 0x22, 0x24, 0x42, 0xF9, 0xE4, 0x34, 0xFC, -+0x22, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, 0x34, -+0xFC, 0xFA, 0x22, 0x12, 0x02, 0x06, 0x90, 0x88, -+0x9C, 0xF0, 0x60, 0x39, 0xA3, 0xE0, 0x20, 0xE0, -+0x34, 0x90, 0x8A, 0xB9, 0x12, 0x91, 0x62, 0xE4, -+0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x88, -+0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x1D, -+0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, -+0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, 0x54, -+0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, -+0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, 0x12, 0xBF, -+0xEB, 0x90, 0x93, 0x08, 0x12, 0xCF, 0xDD, 0x12, -+0x8E, 0xFE, 0x90, 0x93, 0x09, 0x12, 0x8F, 0xED, -+0x90, 0x93, 0x0A, 0xF0, 0x12, 0xE1, 0x26, 0x90, -+0x93, 0x08, 0xE0, 0x54, 0x01, 0xFF, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0xDC, -+0xEF, 0xF0, 0x90, 0x93, 0x04, 0x12, 0xDB, 0xDB, -+0x30, 0xE0, 0x3C, 0x90, 0x95, 0xC1, 0x12, 0xDE, -+0x4A, 0x60, 0x10, 0x12, 0xDF, 0x6D, 0x40, 0x0B, -+0xE4, 0x7F, 0x0A, 0xFE, 0xFD, 0xFC, 0x90, 0x95, -+0xC5, 0x80, 0x09, 0xE4, 0x7F, 0x0A, 0xFE, 0xFD, -+0xFC, 0x90, 0x95, 0xBD, 0x12, 0x84, 0x52, 0x12, -+0x83, 0x1B, 0xC0, 0x07, 0x90, 0x93, 0x0A, 0xE0, -+0xFB, 0xE4, 0xFA, 0xF9, 0xF8, 0xD0, 0x07, 0x12, -+0x83, 0xA6, 0x90, 0x93, 0x0B, 0xEF, 0xF0, 0x90, -+0x9A, 0xDC, 0xE0, 0x64, 0x01, 0x70, 0x1B, 0xF1, -+0xC2, 0x60, 0x0A, 0x11, 0xFB, 0x12, 0x7C, 0x05, -+0x12, 0xE1, 0x1D, 0x80, 0x08, 0x11, 0xFB, 0x12, -+0x7C, 0x3B, 0x12, 0xFB, 0x62, 0x12, 0x79, 0xD4, -+0x80, 0x18, 0xF1, 0xC2, 0x60, 0x07, 0x11, 0xFB, -+0x12, 0x7C, 0x05, 0x80, 0x05, 0x11, 0xFB, 0x12, -+0x7C, 0x3B, 0xF1, 0xF0, 0x12, 0xFC, 0xCD, 0x12, -+0x7B, 0xCC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, -+0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, -+0x03, 0x22, 0x90, 0x9A, 0x0F, 0xEC, 0xF0, 0xA3, -+0xED, 0xF0, 0x90, 0x9A, 0x0D, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0xE4, 0x90, 0x9A, 0x33, 0xF0, 0xEF, -+0x24, 0x24, 0xFF, 0xE4, 0x3E, 0xFE, 0xC0, 0x06, -+0xB1, 0xB5, 0xD0, 0x06, 0xE4, 0xFB, 0xFA, 0xB1, -+0x6D, 0x4E, 0x60, 0x39, 0xE0, 0x24, 0x01, 0x91, -+0xD7, 0x71, 0x3F, 0x90, 0x9A, 0x12, 0xB1, 0x8A, -+0x90, 0x9A, 0x12, 0xB1, 0x95, 0xFE, 0xC3, 0x9F, -+0x50, 0x23, 0x90, 0x9A, 0x35, 0xE0, 0x24, 0x02, -+0xFD, 0x91, 0xD8, 0xFC, 0xEE, 0x7E, 0x00, 0x2D, -+0x71, 0x3C, 0x90, 0x9A, 0x11, 0xE0, 0x24, 0x13, -+0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEF, -+0xF0, 0xB1, 0x83, 0x80, 0xD3, 0xB1, 0xA7, 0xFE, -+0xC0, 0x06, 0xB1, 0xB5, 0xD0, 0x06, 0x7B, 0x03, -+0xB1, 0x6A, 0x90, 0x9A, 0x0E, 0xE0, 0x24, 0x22, -+0xB1, 0xAD, 0xFE, 0x90, 0x9A, 0x34, 0xF0, 0xA3, -+0xEF, 0xF0, 0x71, 0x40, 0xEF, 0x20, 0xE4, 0x02, -+0x41, 0x32, 0x90, 0x9A, 0x33, 0xE0, 0x04, 0xF0, -+0xB1, 0xA7, 0xFE, 0xC0, 0x06, 0xB1, 0xB5, 0xD0, -+0x06, 0x7B, 0x30, 0xB1, 0x6A, 0x4E, 0x60, 0x3F, -+0xE0, 0x24, 0x08, 0x91, 0xD7, 0x71, 0x3F, 0x90, -+0x9A, 0x37, 0xB1, 0x8A, 0xB1, 0x92, 0xC3, 0x9F, -+0x50, 0x2D, 0x90, 0x9A, 0x35, 0xE0, 0x24, 0x0D, -+0x91, 0xD7, 0x71, 0x3F, 0x90, 0x9A, 0x36, 0xEF, -+0xF0, 0xBF, 0x02, 0x09, 0x90, 0x9A, 0x33, 0xE0, -+0x24, 0x20, 0xF0, 0x80, 0x0E, 0x90, 0x9A, 0x36, -+0xE0, 0xB4, 0x04, 0x07, 0x90, 0x9A, 0x33, 0xE0, -+0x24, 0x40, 0xF0, 0xB1, 0x79, 0x80, 0xCD, 0xB1, -+0xA7, 0xFE, 0xC0, 0x06, 0xB1, 0xB5, 0xD0, 0x06, -+0x7B, 0xDD, 0x7A, 0x00, 0x7D, 0x01, 0xB1, 0x6E, -+0x4E, 0x60, 0x44, 0xE0, 0x24, 0x0C, 0x91, 0xD7, -+0x71, 0x3F, 0x90, 0x9A, 0x37, 0xB1, 0x8A, 0xB1, -+0x92, 0xC3, 0x9F, 0x50, 0x32, 0x90, 0x9A, 0x35, -+0xE0, 0x24, 0x11, 0x91, 0xD7, 0x71, 0x3F, 0x90, -+0x9A, 0x36, 0xEF, 0xF0, 0xBF, 0x02, 0x09, 0x90, -+0x9A, 0x33, 0xE0, 0x24, 0x02, 0xF0, 0x80, 0x0E, -+0x90, 0x9A, 0x36, 0xE0, 0xB4, 0x04, 0x07, 0x90, -+0x9A, 0x33, 0xE0, 0x24, 0x04, 0xF0, 0xB1, 0x79, -+0x80, 0xCD, 0xE4, 0x90, 0x9A, 0x33, 0xF0, 0x90, -+0x95, 0xB9, 0xE0, 0x90, 0x04, 0xFD, 0xB1, 0x8B, -+0x90, 0x95, 0xB9, 0xB1, 0x95, 0xFE, 0xC3, 0x9F, -+0x50, 0x64, 0x12, 0xFC, 0xAA, 0xF5, 0x83, 0xE0, -+0xFF, 0x90, 0x9A, 0x12, 0xE0, 0xFE, 0x6F, 0x70, -+0x51, 0x90, 0x04, 0xFC, 0xE0, 0x04, 0xF0, 0x90, -+0x9A, 0x11, 0xE0, 0x24, 0xD9, 0xF5, 0x82, 0xE4, -+0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x9A, -+0x33, 0xE0, 0xFD, 0x4F, 0x60, 0x04, 0xED, 0x5F, -+0x60, 0x30, 0xEE, 0xFF, 0x7E, 0x00, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x9A, 0x11, 0xE0, 0x75, 0xF0, -+0x20, 0xA4, 0x24, 0x01, 0xF9, 0x74, 0x96, 0x12, -+0xFC, 0x55, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x86, -+0x1C, 0xEF, 0x70, 0x0E, 0x90, 0x01, 0xC7, 0x74, -+0x55, 0xF0, 0x7F, 0x01, 0x12, 0xC9, 0x1D, 0x12, -+0xB2, 0x9E, 0xB1, 0x83, 0x80, 0x92, 0xE4, 0x90, -+0x9A, 0x11, 0xF0, 0x90, 0x9A, 0x11, 0xE0, 0xFF, -+0xC3, 0x94, 0x03, 0x50, 0x62, 0xA3, 0xE0, 0xFE, -+0x60, 0x59, 0xEF, 0x75, 0xF0, 0x21, 0xA4, 0x24, -+0x00, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, -+0xE0, 0xFF, 0xEE, 0x6F, 0x70, 0x45, 0x90, 0x04, -+0xFC, 0xE0, 0x04, 0xF0, 0x90, 0x9A, 0x12, 0xE0, -+0xFF, 0x7E, 0x00, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x9A, 0x11, 0xE0, 0x75, 0xF0, 0x21, 0xA4, 0x24, -+0x01, 0xF9, 0x74, 0x9B, 0x12, 0xFC, 0x55, 0xD0, -+0x07, 0xD0, 0x06, 0x12, 0x86, 0x1C, 0xEF, 0x70, -+0x1A, 0x90, 0x01, 0xC7, 0x74, 0x24, 0xF0, 0x7F, -+0x01, 0x12, 0xC9, 0x1D, 0x12, 0xCD, 0x07, 0x30, -+0xE0, 0x03, 0x12, 0xB3, 0x96, 0xF1, 0xB2, 0xE4, -+0xFF, 0x11, 0x66, 0xB1, 0x83, 0x80, 0x94, 0x22, -+0x90, 0x9A, 0x0D, 0xE0, 0xFD, 0x90, 0x9A, 0x0C, -+0xE0, 0x2D, 0xFD, 0x90, 0x9A, 0x0B, 0xE0, 0x34, -+0x00, 0xCD, 0x24, 0x10, 0xCD, 0x34, 0x00, 0xFC, -+0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, -+0x90, 0x8A, 0xE9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, -+0x82, 0x8C, 0x83, 0xE4, 0xFD, 0x02, 0x04, 0x7E, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x06, 0x31, 0xE0, 0x54, 0xEF, 0x44, 0x08, 0xF0, -+0xED, 0x2F, 0xFF, 0xE4, 0x3E, 0xFE, 0x7C, 0x00, -+0xEF, 0x24, 0x08, 0xFF, 0xEC, 0x3E, 0x90, 0x9A, -+0x14, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, -+0xE3, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x94, 0x79, -+0x35, 0x12, 0x04, 0x80, 0x90, 0x9A, 0x15, 0xE0, -+0x24, 0x01, 0xFF, 0x91, 0xD0, 0x71, 0x3F, 0x90, -+0x94, 0x36, 0xEF, 0xF0, 0x90, 0x9A, 0x15, 0xE0, -+0x24, 0x04, 0xFF, 0x91, 0xD0, 0x71, 0x3F, 0x90, -+0x94, 0x39, 0xEF, 0xF0, 0x90, 0x9A, 0x15, 0xE0, -+0x24, 0x05, 0xFF, 0x91, 0xD0, 0x71, 0x3F, 0x90, -+0x94, 0x3A, 0xEF, 0xF0, 0x90, 0x9A, 0x15, 0xE0, -+0x24, 0x06, 0xFF, 0x91, 0xD0, 0x71, 0x3F, 0x90, -+0x94, 0x3B, 0xEF, 0xF0, 0x90, 0x9A, 0x15, 0xE0, -+0x24, 0x07, 0xFF, 0x91, 0xD0, 0x71, 0x3F, 0x90, -+0x94, 0x3C, 0xEF, 0xF0, 0x90, 0x9A, 0x15, 0xE0, -+0x24, 0x08, 0xFF, 0x91, 0xD0, 0x71, 0x3F, 0x90, -+0x94, 0x3D, 0xEF, 0xF0, 0xE4, 0x90, 0x9A, 0x13, -+0xF0, 0xF1, 0x1F, 0x94, 0x08, 0x50, 0x1C, 0x90, -+0x9A, 0x15, 0xE0, 0x24, 0x09, 0xFD, 0x90, 0x9A, -+0x14, 0xE0, 0x71, 0x35, 0x90, 0x9A, 0x13, 0xE0, -+0x24, 0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, -+0x9C, 0x80, 0xDE, 0xE4, 0x90, 0x9A, 0x13, 0xF0, -+0xF1, 0x1F, 0x94, 0x02, 0x50, 0x1C, 0x90, 0x9A, -+0x15, 0xE0, 0x24, 0x61, 0xFD, 0x90, 0x9A, 0x14, -+0xE0, 0x71, 0x35, 0x90, 0x9A, 0x13, 0xE0, 0x24, -+0x96, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x9C, -+0x80, 0xDE, 0xE4, 0x90, 0x9A, 0x13, 0xF0, 0xF1, -+0x1F, 0x94, 0x10, 0x50, 0x1C, 0x90, 0x9A, 0x15, -+0xE0, 0x24, 0x31, 0xFD, 0x90, 0x9A, 0x14, 0xE0, -+0x71, 0x35, 0x90, 0x9A, 0x13, 0xE0, 0x24, 0x66, -+0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x9C, 0x80, -+0xDE, 0xE4, 0x90, 0x9A, 0x13, 0xF0, 0x90, 0x94, -+0x97, 0xE0, 0xFF, 0x90, 0x9A, 0x13, 0xE0, 0xFE, -+0xC3, 0x9F, 0x50, 0x1F, 0x90, 0x9A, 0x15, 0xE0, -+0x24, 0x63, 0xFD, 0x91, 0xD0, 0xFC, 0xEE, 0x7E, -+0x00, 0x2D, 0x71, 0x3C, 0x90, 0x9A, 0x13, 0xE0, -+0x24, 0x98, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, -+0x9C, 0x80, 0xD3, 0x90, 0x94, 0x3A, 0x12, 0xF9, -+0x82, 0x90, 0x9A, 0x11, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0x30, 0xE3, 0x0D, 0x90, 0x01, 0xC7, 0x74, -+0x03, 0xF0, 0x7F, 0x01, 0x12, 0xC9, 0x1D, 0x80, -+0x20, 0x7E, 0x00, 0x90, 0x9A, 0x12, 0xE0, 0x54, -+0x07, 0xFF, 0x64, 0x01, 0x60, 0x05, 0xEF, 0x64, -+0x02, 0x70, 0x0E, 0xE4, 0xFD, 0x12, 0xE6, 0xBB, -+0x90, 0x06, 0x31, 0xE0, 0x54, 0xF7, 0x44, 0x10, -+0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0x9A, 0x14, 0xE0, 0x34, 0x00, 0x22, 0xFF, -+0x90, 0x9A, 0x34, 0xE0, 0x34, 0x00, 0x22, 0xF1, -+0xF7, 0xA3, 0xEA, 0xF0, 0xA3, 0xEB, 0xF0, 0xC3, -+0x90, 0x9A, 0x3E, 0xE0, 0x94, 0x01, 0x90, 0x9A, -+0x3D, 0xE0, 0x94, 0x00, 0x50, 0x02, 0x80, 0x6E, -+0xE4, 0x90, 0x9A, 0x41, 0xF0, 0xA3, 0xF0, 0xF1, -+0xCA, 0x71, 0x40, 0x90, 0x9A, 0x3B, 0xE0, 0x70, -+0x03, 0xA3, 0xE0, 0x6F, 0x70, 0x18, 0x90, 0x9A, -+0x39, 0xE0, 0x24, 0x02, 0xF1, 0xBA, 0xFE, 0x90, -+0x9A, 0x3A, 0xE0, 0xFD, 0x12, 0xFA, 0x17, 0xBF, -+0x01, 0x02, 0xE1, 0xCA, 0x80, 0x00, 0x90, 0x9A, -+0x39, 0xE0, 0x24, 0x01, 0xF1, 0xBA, 0x71, 0x3F, -+0x7E, 0x00, 0x90, 0x9A, 0x3F, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x24, 0x02, 0xFF, 0xEE, 0x33, 0xFE, -+0x90, 0x9A, 0x38, 0x8F, 0xF0, 0x12, 0x02, 0xE7, -+0x90, 0x9A, 0x41, 0xEE, 0x8F, 0xF0, 0x12, 0x02, -+0xE7, 0x90, 0x9A, 0x3D, 0xE0, 0xFE, 0xA3, 0xE0, -+0xFF, 0xC3, 0x90, 0x9A, 0x42, 0xE0, 0x9F, 0x90, -+0x9A, 0x41, 0xE0, 0x9E, 0x40, 0x99, 0xE4, 0xFE, -+0xFF, 0x22, 0x7A, 0x00, 0xE4, 0xFD, 0x91, 0xDF, -+0x90, 0x9A, 0x34, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0x22, 0x90, 0x9A, 0x34, 0xE4, 0x75, 0xF0, 0x04, -+0x12, 0x02, 0xE7, 0x90, 0x9A, 0x11, 0xE0, 0x04, -+0xF0, 0x22, 0xEF, 0xF0, 0xE4, 0x90, 0x9A, 0x11, -+0xF0, 0x22, 0x90, 0x9A, 0x37, 0xE0, 0xFF, 0x90, -+0x9A, 0x11, 0xE0, 0x22, 0xF5, 0x83, 0xEF, 0xF0, -+0x90, 0x9A, 0x13, 0xE0, 0x04, 0xF0, 0x22, 0x90, -+0x9A, 0x0E, 0xE0, 0x24, 0x24, 0xFF, 0x90, 0x9A, -+0x0D, 0xE0, 0x34, 0x00, 0x22, 0x90, 0x9A, 0x10, -+0xE0, 0x24, 0xDC, 0xFE, 0x90, 0x9A, 0x0F, 0xE0, -+0x34, 0xFF, 0x90, 0x9A, 0x3D, 0xF0, 0xA3, 0xCE, -+0xF0, 0x22, 0x12, 0xC7, 0x92, 0xA3, 0xED, 0xF0, -+0x12, 0xDF, 0x5B, 0x7A, 0x80, 0x79, 0x80, 0x12, -+0xDF, 0x44, 0x78, 0x1A, 0x7C, 0x9A, 0x7D, 0x01, -+0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x86, 0xF1, 0x26, -+0x78, 0x1E, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, 0xFF, -+0x7A, 0x80, 0x79, 0x8A, 0xF1, 0x26, 0xE4, 0x90, -+0x9A, 0x23, 0xF0, 0xF1, 0xE5, 0xFF, 0xF1, 0x18, -+0xCF, 0x24, 0x06, 0xCF, 0x34, 0x00, 0x71, 0x3F, -+0xEF, 0x64, 0x08, 0x60, 0x02, 0xC1, 0xFC, 0xF1, -+0xE5, 0xFF, 0xF1, 0x18, 0xCF, 0x24, 0x07, 0xCF, -+0x34, 0x00, 0x71, 0x3F, 0xEF, 0x64, 0x06, 0x60, -+0x02, 0xC1, 0xFC, 0x90, 0x9A, 0x23, 0x04, 0xF0, -+0xE4, 0x90, 0x9A, 0x22, 0xF0, 0xF1, 0xDC, 0x50, -+0x17, 0x90, 0x9A, 0x0C, 0xE0, 0x24, 0x0A, 0xFD, -+0x90, 0x9A, 0x0B, 0xE0, 0x71, 0x35, 0x90, 0x9A, -+0x22, 0x12, 0xDF, 0x52, 0xF1, 0x02, 0x80, 0xE5, -+0x78, 0x0E, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, 0x01, -+0x7A, 0x93, 0x79, 0x34, 0x12, 0xCF, 0xAC, 0x60, -+0x02, 0xC1, 0xFC, 0x90, 0x9A, 0x22, 0xF0, 0xF1, -+0xD3, 0x50, 0x16, 0xF1, 0x0D, 0xCD, 0x24, 0x20, -+0x71, 0x34, 0x90, 0x9A, 0x22, 0xE0, 0x24, 0x1E, -+0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF1, 0x02, 0x80, -+0xE6, 0x78, 0x1E, 0x7C, 0x9A, 0x12, 0xFC, 0x2B, -+0x70, 0x71, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x01, -+0x54, 0xDF, 0xF0, 0x90, 0x93, 0x26, 0xE0, 0x30, -+0xE0, 0x02, 0x80, 0x0D, 0x90, 0x98, 0x05, 0xE0, -+0xB4, 0x02, 0x10, 0x12, 0xC6, 0x11, 0x20, 0xE0, -+0x0A, 0x90, 0x01, 0xC7, 0x74, 0x09, 0x12, 0xC7, -+0x78, 0x80, 0x51, 0xE4, 0x90, 0x9A, 0x22, 0xF0, -+0xF1, 0xDC, 0x50, 0x0C, 0x71, 0x20, 0x90, 0x9A, -+0x22, 0x12, 0xCF, 0x88, 0xF1, 0x02, 0x80, 0xF0, -+0xE4, 0x90, 0x9A, 0x22, 0xF0, 0xF1, 0xD3, 0x50, -+0x16, 0xF1, 0x0D, 0xCD, 0x24, 0x16, 0x71, 0x34, -+0x90, 0x9A, 0x22, 0xE0, 0x24, 0x1A, 0xF5, 0x82, -+0xE4, 0x34, 0x9A, 0xF1, 0x02, 0x80, 0xE6, 0x7B, -+0x01, 0x7A, 0x9A, 0x79, 0x14, 0x12, 0xF1, 0xDC, -+0xA3, 0xF0, 0x7A, 0x9A, 0x79, 0x1A, 0x12, 0x9A, -+0x22, 0x80, 0x09, 0x90, 0x06, 0x30, 0xE0, 0x44, -+0x21, 0x54, 0xEF, 0xF0, 0x90, 0x9A, 0x23, 0xE0, -+0xFF, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x9A, -+0x22, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x9A, 0x0D, -+0xE0, 0xFD, 0x90, 0x9A, 0x0C, 0xE0, 0x2D, 0xFD, -+0x90, 0x9A, 0x0B, 0xE0, 0x34, 0x00, 0x22, 0x90, -+0x9A, 0x13, 0xE0, 0xFF, 0xC3, 0x22, 0x7E, 0x00, -+0x7F, 0x04, 0x02, 0x01, 0xE0, 0x90, 0x9A, 0x12, -+0xF1, 0xFA, 0x78, 0x16, 0x7C, 0x9A, 0x7D, 0x01, -+0x7B, 0xFF, 0x7A, 0x80, 0x79, 0xBA, 0xF1, 0x26, -+0x90, 0x9A, 0x14, 0xE0, 0xFF, 0x90, 0x9A, 0x13, -+0xE0, 0x2F, 0x12, 0xCF, 0xA3, 0x90, 0x9A, 0x1A, -+0xF0, 0xA3, 0xEF, 0xF0, 0x24, 0x06, 0xFF, 0xE4, -+0x3E, 0x71, 0x3F, 0xEF, 0x64, 0x08, 0x70, 0x51, -+0x90, 0x9A, 0x1B, 0xE0, 0x24, 0x07, 0xFF, 0x90, -+0x9A, 0x1A, 0xE0, 0x34, 0x00, 0x71, 0x3F, 0xEF, -+0x70, 0x3F, 0x90, 0x9A, 0x15, 0xF0, 0x90, 0x9A, -+0x15, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x24, -+0x90, 0x9A, 0x1B, 0xE0, 0x24, 0x18, 0xFD, 0x90, -+0x9A, 0x1A, 0xE0, 0x71, 0x35, 0x90, 0x9A, 0x15, -+0xE0, 0x24, 0x16, 0xF5, 0x82, 0xE4, 0x34, 0x9A, -+0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x9A, 0x15, 0xE0, -+0x04, 0xF0, 0x80, 0xD2, 0x78, 0x16, 0x7C, 0x9A, -+0x12, 0xFC, 0x2B, 0x7F, 0x00, 0x70, 0x02, 0x7F, -+0x01, 0x22, 0x12, 0xFC, 0x61, 0x79, 0x08, 0x02, -+0x04, 0x80, 0xFF, 0x90, 0x9A, 0x38, 0xE0, 0x34, -+0x00, 0x22, 0x90, 0x93, 0x0A, 0xE0, 0x90, 0x01, -+0x3F, 0x22, 0x90, 0x9A, 0x38, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x22, 0x90, 0x9A, 0x22, 0xE0, 0xFF, -+0xC3, 0x94, 0x04, 0x22, 0x90, 0x9A, 0x22, 0xE0, -+0xFF, 0xC3, 0x94, 0x06, 0x22, 0x90, 0x9A, 0x0D, -+0xE0, 0xFF, 0x90, 0x9A, 0x0C, 0xE0, 0x2F, 0x22, -+0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x90, -+0x9A, 0x38, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, -+0xED, 0xF0, 0x22, 0x90, 0x93, 0x0C, 0xE0, 0x20, -+0xE0, 0x02, 0x01, 0xD0, 0xE4, 0x90, 0x99, 0x88, -+0xF0, 0x90, 0x99, 0x88, 0xE0, 0xFF, 0xC3, 0x94, -+0x05, 0x40, 0x02, 0x01, 0xD0, 0x31, 0x8F, 0x80, -+0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xFF, 0x90, 0x93, 0x0D, 0xE0, 0xFD, 0xEF, 0x5D, -+0x60, 0x02, 0x01, 0xC8, 0x12, 0x02, 0x06, 0xFF, -+0x30, 0xE0, 0x1A, 0x90, 0x93, 0x0E, 0xE0, 0xFE, -+0x90, 0x99, 0x88, 0xE0, 0xFD, 0x74, 0x01, 0xA8, -+0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -+0x4E, 0x90, 0x93, 0x0E, 0xF0, 0xEF, 0xC3, 0x13, -+0x30, 0xE0, 0x15, 0x90, 0x93, 0x0F, 0xE0, 0xFF, -+0x90, 0x99, 0x88, 0x11, 0xD9, 0x80, 0x02, 0xC3, -+0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x0F, 0xF0, -+0x12, 0x8E, 0xFF, 0xFF, 0x90, 0x99, 0x88, 0xE0, -+0xFE, 0x24, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, -+0xF5, 0x83, 0xEF, 0x12, 0x8F, 0xED, 0xFF, 0x74, -+0x15, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -+0x83, 0xEF, 0xF0, 0x12, 0x8F, 0xF4, 0xFF, 0x74, -+0x1A, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -+0x83, 0xEF, 0x12, 0x97, 0x30, 0xFF, 0x74, 0x1F, -+0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0xEF, 0xF0, 0x90, 0x93, 0x0D, 0xE0, 0xFF, 0x74, -+0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x0D, 0xF0, 0x22, -+0x90, 0x99, 0x88, 0xE0, 0x04, 0xF0, 0x01, 0x11, -+0x22, 0x7F, 0x61, 0x12, 0x7B, 0x41, 0x90, 0x9C, -+0x9D, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x9C, 0x9E, 0xED, 0xF0, 0x90, 0x9C, 0x9D, -+0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x42, 0x7F, -+0x47, 0x11, 0xD3, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, 0x12, 0x7B, -+0x2E, 0x7F, 0x46, 0x11, 0xD3, 0x80, 0x02, 0xC3, -+0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x46, 0x31, -+0x87, 0x60, 0x0D, 0x7F, 0x45, 0x11, 0xD3, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x80, 0x0C, -+0x7F, 0x45, 0x11, 0xD3, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x45, 0x80, -+0x46, 0x90, 0x9C, 0x9D, 0xE0, 0x24, 0xF8, 0xF0, -+0x7F, 0x63, 0x11, 0xD3, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x12, -+0x7B, 0x2E, 0x7F, 0x62, 0x11, 0xD3, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, -+0x31, 0x87, 0x60, 0x0E, 0x11, 0xD1, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, -+0x80, 0x0D, 0x11, 0xD1, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x12, -+0x7B, 0x2E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, -+0x7B, 0x2E, 0x90, 0x9C, 0x9E, 0xE0, 0x22, 0x74, -+0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x22, 0xE4, -+0x90, 0x99, 0xE3, 0xF0, 0x12, 0xED, 0x73, 0x7F, -+0x08, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xEF, 0xFD, -+0x7F, 0x08, 0x12, 0x7B, 0x2E, 0xE4, 0xFF, 0x91, -+0x1A, 0x90, 0x93, 0x0C, 0xE0, 0x20, 0xE0, 0x02, -+0x41, 0x97, 0x91, 0x13, 0x44, 0x02, 0x91, 0xC9, -+0xE4, 0x90, 0x99, 0xE4, 0xF0, 0x90, 0x99, 0xE4, -+0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2C, 0x31, -+0x8F, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -+0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x0F, 0xE0, 0xFD, -+0xEF, 0x5D, 0x60, 0x0F, 0x90, 0x99, 0xE4, 0xF1, -+0xF6, 0x90, 0x99, 0xE4, 0x12, 0xFB, 0xCE, 0x44, -+0x40, 0x91, 0x69, 0x90, 0x99, 0xE4, 0xE0, 0x04, -+0xF0, 0x80, 0xCA, 0x90, 0x07, 0xC7, 0xE4, 0xF0, -+0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, -+0x77, 0xF0, 0x90, 0x07, 0xC4, 0xE4, 0xF0, 0x90, -+0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, -+0xA3, 0x12, 0xF1, 0xB3, 0x90, 0x02, 0x26, 0xE0, -+0x44, 0x01, 0xF0, 0xE0, 0x90, 0x99, 0xE5, 0xF0, -+0x90, 0x99, 0xE5, 0xE0, 0x30, 0xE0, 0x1A, 0x90, -+0x99, 0xE3, 0xE0, 0x04, 0xF0, 0x12, 0xD7, 0x54, -+0x90, 0x02, 0x26, 0xE0, 0x90, 0x99, 0xE5, 0xF0, -+0x90, 0x99, 0xE3, 0xE0, 0xD3, 0x94, 0xFA, 0x40, -+0xDF, 0x90, 0x02, 0x03, 0x74, 0x80, 0xF0, 0x90, -+0x04, 0x24, 0xE0, 0x90, 0x99, 0xE6, 0xF0, 0x90, -+0x04, 0x22, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x02, -+0x00, 0xE0, 0x90, 0x99, 0xE5, 0xF0, 0x90, 0x02, -+0x01, 0x51, 0xA7, 0x90, 0x02, 0x02, 0x51, 0xA7, -+0x90, 0x02, 0x14, 0x51, 0xA7, 0xE0, 0x04, 0xF0, -+0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0x04, 0x22, -+0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x99, 0xE6, 0xE0, -+0x90, 0x04, 0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, -+0xFF, 0xF0, 0x90, 0xFD, 0x08, 0xE4, 0xF0, 0xF1, -+0xE3, 0xE0, 0x90, 0x92, 0x90, 0xD1, 0xC9, 0x90, -+0x88, 0x32, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE0, -+0xFF, 0x90, 0x99, 0xE5, 0xE0, 0x2F, 0xF0, 0x22, -+0x75, 0x10, 0x14, 0x90, 0x88, 0x32, 0xE0, 0x44, -+0x10, 0xF0, 0xF1, 0xE3, 0xE0, 0x90, 0x92, 0x90, -+0xF0, 0x7D, 0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, -+0x41, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, -+0x90, 0x88, 0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, -+0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, -+0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, -+0x90, 0x93, 0x0C, 0xE0, 0x30, 0xE0, 0x65, 0x90, -+0xFD, 0x09, 0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, -+0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, -+0x90, 0x99, 0xE3, 0xF0, 0x90, 0x99, 0xE3, 0xE0, -+0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2C, 0x31, 0x8F, -+0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0xFF, 0x90, 0x93, 0x0E, 0xE0, 0xFD, 0xEF, -+0x5D, 0x60, 0x0F, 0x90, 0x99, 0xE3, 0xF1, 0xF6, -+0x90, 0x99, 0xE3, 0x12, 0xFB, 0xCE, 0x44, 0x20, -+0x91, 0x69, 0x90, 0x99, 0xE3, 0xE0, 0x04, 0xF0, -+0x80, 0xCA, 0x71, 0xE2, 0x54, 0xFE, 0xFD, 0x7F, -+0x92, 0x12, 0x7B, 0x2E, 0x71, 0xE2, 0x44, 0x08, -+0xFD, 0x7F, 0x92, 0x91, 0x10, 0x54, 0xFD, 0xFD, -+0x7F, 0x02, 0x80, 0x07, 0x71, 0xE2, 0x44, 0x01, -+0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x08, -+0x12, 0x7B, 0x41, 0xEF, 0x44, 0x10, 0xFD, 0x7F, -+0x08, 0x12, 0x7B, 0x2E, 0x7F, 0x01, 0x91, 0x1A, -+0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, -+0x7C, 0x6A, 0x7F, 0x92, 0x12, 0x7B, 0x41, 0xEF, -+0x22, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, -+0x01, 0xFD, 0x7F, 0x02, 0x12, 0x7B, 0x2E, 0x7F, -+0x02, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFE, 0xFD, -+0x7F, 0x02, 0x12, 0x7B, 0x2E, 0x7F, 0x02, 0x12, -+0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, -+0x12, 0x7B, 0x2E, 0x7F, 0x02, 0x12, 0x7B, 0x41, -+0xEF, 0x22, 0x90, 0x9C, 0x96, 0xEF, 0x12, 0xCF, -+0x6A, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, -+0xE7, 0x02, 0x7F, 0x01, 0x90, 0x9C, 0x96, 0xE0, -+0x6F, 0x60, 0x35, 0xC3, 0x90, 0x9C, 0x98, 0xE0, -+0x94, 0x88, 0x90, 0x9C, 0x97, 0xE0, 0x94, 0x13, -+0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, -+0xF0, 0x22, 0x90, 0x9C, 0x97, 0x12, 0xD5, 0xCD, -+0x91, 0x6A, 0xD3, 0x90, 0x9C, 0x98, 0xE0, 0x94, -+0x32, 0x90, 0x9C, 0x97, 0xE0, 0x94, 0x00, 0x40, -+0xC0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB9, -+0x22, 0xF0, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, -+0x6A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0xD1, 0xDF, 0xEC, 0x90, 0x9C, 0x7C, 0x12, 0x04, -+0x31, 0x90, 0x9C, 0x7C, 0xD1, 0xD6, 0xD1, 0xCF, -+0xF1, 0xD1, 0xF0, 0x7D, 0x01, 0x12, 0x76, 0xF7, -+0x12, 0x8C, 0x11, 0x90, 0x06, 0xB7, 0x74, 0x11, -+0xF0, 0x7F, 0x03, 0x7E, 0x00, 0x12, 0x7C, 0x6A, -+0x90, 0x06, 0xB4, 0xE0, 0x54, 0x0F, 0x70, 0xF1, -+0x91, 0x13, 0x91, 0xC7, 0x71, 0xE9, 0x91, 0xC7, -+0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, -+0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, -+0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x54, -+0xFE, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD1, 0xDF, -+0xEC, 0x90, 0x9C, 0x78, 0x12, 0x04, 0x31, 0x90, -+0x9C, 0x78, 0xD1, 0xD6, 0xD1, 0xCF, 0x90, 0x01, -+0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, -+0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, -+0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0xF1, -+0xD1, 0xD1, 0xC9, 0x71, 0xE9, 0x54, 0xFE, 0x91, -+0x0D, 0x44, 0x01, 0x91, 0xC9, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x12, 0xC7, 0x81, 0x60, 0x02, 0xC1, -+0x47, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0xC1, -+0x47, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x2F, -+0x90, 0x06, 0xA9, 0xE0, 0x54, 0xC0, 0x70, 0x27, -+0x90, 0x88, 0x9C, 0xE0, 0x70, 0x21, 0x90, 0x04, -+0x1A, 0xE0, 0xF4, 0x70, 0x1A, 0xE0, 0x54, 0x07, -+0x64, 0x07, 0x70, 0x13, 0x90, 0x06, 0x62, 0xE0, -+0x54, 0x03, 0x70, 0x0B, 0x90, 0x88, 0x39, 0xE0, -+0xB4, 0x04, 0x04, 0x91, 0x13, 0x91, 0xC7, 0x90, -+0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, 0x90, -+0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, 0x90, -+0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, 0x90, -+0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, 0x90, -+0x07, 0xF1, 0xE0, 0x90, 0x99, 0x79, 0xF0, 0x90, -+0x07, 0xF0, 0xE0, 0x90, 0x99, 0x7A, 0xF0, 0x12, -+0xDB, 0x3B, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, -+0xEC, 0xF0, 0xD1, 0x50, 0x24, 0xFD, 0x50, 0x02, -+0x80, 0x02, 0xD1, 0x59, 0xD1, 0x50, 0x64, 0x01, -+0x70, 0x30, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, -+0x3D, 0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x30, 0xE5, -+0x05, 0xA3, 0xE0, 0xFF, 0x80, 0x05, 0x90, 0x88, -+0x3C, 0xE0, 0xFF, 0x90, 0x88, 0x3C, 0xEF, 0xF0, -+0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, -+0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, -+0xEF, 0xF0, 0x12, 0xE1, 0x4C, 0xE4, 0x90, 0x88, -+0x3F, 0xF0, 0xA3, 0xF0, 0x12, 0xDB, 0xD8, 0x30, -+0xE0, 0x5E, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x20, 0xE0, 0x26, 0xD1, 0x48, 0x6F, 0x70, 0x50, -+0xEF, 0x60, 0x4D, 0x90, 0x88, 0x32, 0xE0, 0x44, -+0x40, 0xF0, 0x12, 0xFC, 0xD4, 0x12, 0xA0, 0xF7, -+0x12, 0x7C, 0x05, 0x12, 0xFB, 0x69, 0x12, 0xDF, -+0x4B, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0x80, -+0x2F, 0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, -+0x64, 0x01, 0x70, 0x24, 0xD1, 0x48, 0xFE, 0x6F, -+0x60, 0x1E, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, -+0x6F, 0x60, 0x15, 0x12, 0xCF, 0xBE, 0x30, 0xE0, -+0x0F, 0xEF, 0x54, 0xBF, 0x12, 0xA0, 0xF7, 0x12, -+0x7C, 0x3B, 0x12, 0xFC, 0xCD, 0x12, 0xA7, 0xF0, -+0x90, 0x88, 0x32, 0xE0, 0x44, 0x04, 0xF0, 0x22, -+0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, -+0x90, 0x88, 0x34, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, -+0x22, 0xE4, 0xF5, 0x11, 0x90, 0x06, 0xA9, 0xE0, -+0xF5, 0x11, 0x54, 0xC0, 0x70, 0x17, 0xD1, 0xC1, -+0x54, 0xFD, 0xF0, 0xD1, 0xEB, 0x90, 0x88, 0x39, -+0xE0, 0x60, 0x4D, 0x91, 0x13, 0x44, 0x01, 0xFD, -+0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE5, 0x11, 0x30, -+0xE6, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, -+0x70, 0x1C, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, -+0x12, 0x97, 0xE5, 0x64, 0x02, 0x60, 0x08, 0x90, -+0x8A, 0xE1, 0x12, 0x8C, 0x14, 0x80, 0x07, 0x12, -+0x73, 0x8F, 0x80, 0x02, 0xD1, 0xC1, 0xE5, 0x11, -+0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0E, 0xE0, 0x44, -+0x02, 0x12, 0xC6, 0xAD, 0x90, 0x88, 0x31, 0xE0, -+0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, -+0x22, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFE, 0xF0, -+0x22, 0xF0, 0xE4, 0xFD, 0x02, 0x76, 0xF7, 0x7F, -+0x30, 0x7E, 0x08, 0x02, 0x70, 0xAD, 0x12, 0x04, -+0xB8, 0x90, 0x92, 0x18, 0x02, 0x04, 0x31, 0x7F, -+0x30, 0x7E, 0x08, 0x12, 0x70, 0x70, 0xED, 0x44, -+0x80, 0xFD, 0x22, 0x90, 0x88, 0x38, 0xE0, 0xFF, -+0x90, 0x8A, 0xB9, 0xF1, 0x05, 0x7D, 0x01, 0x02, -+0x04, 0x7E, 0x90, 0x9A, 0x10, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x90, 0x8A, 0xE9, 0xE0, 0xFC, 0xA3, -+0xE0, 0xF5, 0x82, 0x8C, 0x83, 0x22, 0x90, 0x9A, -+0x0D, 0xED, 0x12, 0xC7, 0x91, 0x12, 0xCD, 0x21, -+0xEF, 0x70, 0x02, 0xE1, 0xBE, 0x12, 0xC5, 0x83, -+0x12, 0xCF, 0x80, 0x70, 0x02, 0xE1, 0xBE, 0x12, -+0xA7, 0xE5, 0xFF, 0x12, 0xA7, 0x18, 0xCF, 0x24, -+0x08, 0xCF, 0x34, 0x00, 0x90, 0x9A, 0x10, 0xF0, -+0xA3, 0xEF, 0xF0, 0x90, 0x93, 0x25, 0xE0, 0xC4, -+0x54, 0x0F, 0x30, 0xE0, 0x33, 0xD1, 0xFA, 0x7D, -+0x09, 0x12, 0x04, 0x7E, 0xEF, 0x64, 0x06, 0x70, -+0x27, 0xD1, 0xFA, 0x7D, 0x14, 0x12, 0x04, 0x7E, -+0xEF, 0x70, 0x1D, 0xD1, 0xFA, 0x7D, 0x15, 0x12, -+0x04, 0x7E, 0xEF, 0x64, 0x50, 0x70, 0x11, 0xD1, -+0xFA, 0x7D, 0x21, 0x12, 0x04, 0x7E, 0xEF, 0x20, -+0xE0, 0x03, 0x30, 0xE2, 0x03, 0x7F, 0x01, 0x22, -+0x90, 0x93, 0x25, 0xE0, 0x13, 0x13, 0x54, 0x3F, -+0x30, 0xE0, 0x3B, 0xD1, 0xFA, 0x7D, 0x09, 0x12, -+0x04, 0x7E, 0xEF, 0x64, 0x11, 0x70, 0x2F, 0x90, -+0x9A, 0x11, 0xE0, 0x24, 0x14, 0xFF, 0x90, 0x9A, -+0x10, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x9A, 0x0E, -+0xF0, 0xA3, 0xEF, 0xF0, 0xF1, 0x02, 0x7D, 0x02, -+0x12, 0x04, 0x7E, 0xEF, 0x70, 0x10, 0x90, 0x9A, -+0x0E, 0xD1, 0xFD, 0x7D, 0x03, 0x12, 0x04, 0x7E, -+0xBF, 0x89, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x51, 0xB0, 0x31, 0x97, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0x93, 0x42, 0xE0, 0xFF, 0x90, 0x93, -+0x41, 0xE0, 0xFB, 0x90, 0x93, 0x43, 0xE0, 0x90, -+0x92, 0x90, 0x22, 0x90, 0x88, 0xA0, 0xE0, 0xC4, -+0x13, 0x13, 0x54, 0x01, 0xFF, 0x90, 0x88, 0xE0, -+0xE0, 0xFB, 0x90, 0x88, 0xDF, 0x22, 0xE0, 0xFF, -+0x24, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -+0x83, 0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x1F, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0xE0, 0x90, 0x01, 0xB1, 0xF0, 0x22, 0x12, 0x02, -+0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x0C, 0xE0, -+0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x03, 0xE4, -+0x11, 0x2C, 0x22, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, -+0xA3, 0xF0, 0x22, 0x12, 0xC9, 0x9D, 0xE4, 0x90, -+0x98, 0x11, 0x11, 0x2B, 0x90, 0x95, 0x63, 0x11, -+0x2B, 0xA3, 0x11, 0x2B, 0xA3, 0xF0, 0xA3, 0xF0, -+0x90, 0x95, 0x75, 0xF0, 0xA3, 0xF0, 0x90, 0x95, -+0xB7, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x9A, 0xC8, -+0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x84, -+0x67, 0x90, 0x9A, 0xCA, 0x12, 0x84, 0x5E, 0x8B, -+0x45, 0x8A, 0x46, 0x11, 0xD6, 0x24, 0x02, 0x11, -+0xED, 0x31, 0x28, 0x24, 0x04, 0x11, 0xCF, 0x24, -+0x03, 0x11, 0xED, 0x31, 0x28, 0x24, 0x08, 0x11, -+0xCF, 0x24, 0x04, 0x11, 0xED, 0x31, 0x28, 0x24, -+0x0C, 0x11, 0xCF, 0x24, 0x05, 0x11, 0xED, 0x90, -+0x9A, 0xC9, 0xE0, 0xFD, 0xB4, 0x02, 0x08, 0x90, -+0x9A, 0xC8, 0xE0, 0x44, 0x48, 0x80, 0x0A, 0xED, -+0xB4, 0x04, 0x0A, 0x90, 0x9A, 0xC8, 0xE0, 0x44, -+0x50, 0x90, 0x9A, 0xCE, 0xF0, 0x90, 0x9A, 0xCF, -+0x74, 0x80, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xA3, -+0xF0, 0x11, 0xE4, 0x11, 0xED, 0x90, 0x9A, 0xCE, -+0x74, 0xFF, 0x11, 0x2B, 0x11, 0xE4, 0x04, 0x11, -+0xED, 0x90, 0x06, 0x72, 0xE4, 0xF0, 0x22, 0xF9, -+0xE4, 0x3A, 0x8B, 0x45, 0xF5, 0x46, 0x89, 0x47, -+0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x9A, 0x79, -+0xCE, 0x12, 0x69, 0xF5, 0x90, 0x9A, 0xC8, 0xE0, -+0x75, 0xF0, 0x08, 0xA4, 0x22, 0xFF, 0x90, 0x9A, -+0xCD, 0xF0, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0xCE, -+0x12, 0x02, 0x06, 0x90, 0x06, 0x74, 0x12, 0x8E, -+0xFE, 0x90, 0x06, 0x75, 0x12, 0x8F, 0xED, 0x90, -+0x06, 0x76, 0xF0, 0x12, 0x8F, 0xF4, 0x90, 0x06, -+0x77, 0xF0, 0x90, 0x06, 0x70, 0xEF, 0xF0, 0xA3, -+0xE4, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x80, -+0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x02, 0x7C, 0x6A, -+0x90, 0x9A, 0xCA, 0x12, 0x84, 0x5E, 0xE9, 0x22, -+0x7E, 0x00, 0x7F, 0x25, 0x7D, 0x00, 0x7B, 0x01, -+0x7A, 0x93, 0x79, 0x24, 0x12, 0x04, 0x80, 0x90, -+0x06, 0x90, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0xF2, -+0x49, 0x11, 0x33, 0x90, 0x86, 0xB3, 0xE0, 0xFF, -+0x64, 0x02, 0x70, 0x2A, 0x51, 0x0F, 0x30, 0xE0, -+0x02, 0x7E, 0x01, 0x90, 0x93, 0x43, 0x51, 0x0D, -+0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x41, -+0x51, 0x0D, 0x30, 0xE2, 0x02, 0x7E, 0x01, 0x90, -+0x93, 0x42, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, -+0x90, 0x02, 0xFB, 0xF0, 0x80, 0x46, 0xEF, 0x64, -+0x01, 0x70, 0x1D, 0x51, 0x06, 0x30, 0xE0, 0x02, -+0x7F, 0x01, 0x90, 0x93, 0x43, 0x51, 0x04, 0x30, -+0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x41, 0x51, -+0x04, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, 0x1F, -+0x51, 0x89, 0x70, 0x20, 0x31, 0xFD, 0x30, 0xE0, -+0x02, 0x7F, 0x01, 0x90, 0x93, 0x43, 0x31, 0xFB, -+0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x41, -+0x31, 0xFB, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x90, -+0x93, 0x42, 0xEF, 0xF0, 0x90, 0x93, 0x24, 0xE0, -+0x54, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0xB9, 0xF0, -+0xA3, 0xF0, 0x90, 0x95, 0xC1, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x00, 0x00, 0x90, 0x95, 0xC5, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x90, 0x95, -+0xBD, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, -+0x90, 0x98, 0x01, 0x12, 0x04, 0x3D, 0x00, 0x00, -+0x00, 0x00, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, -+0xE0, 0x7F, 0x00, 0x22, 0xEF, 0xF0, 0x90, 0xFD, -+0x70, 0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, -+0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x22, 0x7E, 0x00, -+0x7F, 0x33, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, -+0x79, 0x9D, 0x12, 0x04, 0x80, 0x90, 0x88, 0x9E, -+0x74, 0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0x7E, -+0x00, 0x7F, 0x0C, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -+0x99, 0x79, 0x7C, 0x12, 0x04, 0x80, 0x90, 0x86, -+0xB3, 0xE0, 0xFC, 0x64, 0x02, 0x70, 0x14, 0x51, -+0x0F, 0x30, 0xE2, 0x02, 0x7E, 0x01, 0xEE, 0x51, -+0x81, 0xFE, 0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, -+0x4E, 0xF0, 0x22, 0xEC, 0x64, 0x01, 0x70, 0x09, -+0x51, 0x06, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, -+0x0B, 0x51, 0x89, 0x70, 0x13, 0x31, 0xFD, 0x30, -+0xE2, 0x02, 0x7F, 0x01, 0xEF, 0x51, 0x81, 0xFF, -+0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, 0x4F, 0xF0, -+0x22, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, -+0x22, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x22, -+0x90, 0x93, 0x24, 0x12, 0xC7, 0xE0, 0x30, 0xE0, -+0x02, 0x11, 0x33, 0x22, 0x51, 0x90, 0x90, 0x93, -+0x24, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -+0x04, 0x71, 0x96, 0x31, 0xC4, 0x22, 0xEF, 0x70, -+0x02, 0x61, 0x5E, 0x90, 0x06, 0x0F, 0xE0, 0x20, -+0xE6, 0x1D, 0x90, 0x98, 0x38, 0xE0, 0x54, 0xFE, -+0xF0, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE5, 0x07, -+0x90, 0x01, 0x0C, 0xE0, 0x30, 0xE1, 0x45, 0x90, -+0x01, 0xC7, 0x74, 0x44, 0xF0, 0x80, 0xFE, 0x90, -+0x98, 0x38, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x06, -+0x0F, 0xE0, 0x30, 0xE5, 0x10, 0x90, 0x01, 0x0C, -+0xE0, 0x20, 0xE1, 0x09, 0x90, 0x98, 0x38, 0xE0, -+0x54, 0xFD, 0xF0, 0x80, 0x1F, 0x90, 0x06, 0x0F, -+0xE0, 0x20, 0xE5, 0x10, 0x90, 0x01, 0x0C, 0xE0, -+0x30, 0xE1, 0x09, 0x90, 0x98, 0x38, 0xE0, 0x44, -+0x02, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xC7, 0x74, -+0x44, 0xF0, 0x80, 0xFE, 0x90, 0x98, 0x07, 0xE0, -+0xFF, 0x60, 0x03, 0x12, 0xF4, 0x9B, 0x90, 0x01, -+0xC7, 0xE4, 0x12, 0xBA, 0x65, 0x12, 0xF5, 0xE3, -+0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF0, 0x7B, -+0x35, 0x7D, 0xFF, 0x7F, 0xFF, 0x12, 0x98, 0x60, -+0x90, 0x8A, 0xEF, 0x12, 0x8C, 0x14, 0x12, 0xCF, -+0x78, 0x12, 0xCF, 0x08, 0x71, 0x76, 0x90, 0x86, -+0x0C, 0x12, 0x8C, 0x14, 0x12, 0x98, 0x5B, 0x12, -+0xF2, 0xF2, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, -+0xFD, 0xE4, 0xFF, 0x02, 0x7C, 0x74, 0x7D, 0x08, -+0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0x90, 0x06, 0x90, -+0xE0, 0x54, 0xF0, 0xF0, 0x12, 0xEB, 0x0F, 0x12, -+0xF2, 0x5C, 0x51, 0x9C, 0x21, 0x30, 0xF1, 0xE7, -+0x12, 0xEB, 0xB3, 0x30, 0xE0, 0x17, 0x90, 0x93, -+0x04, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x20, 0xE0, -+0x0C, 0x90, 0x9C, 0x55, 0x12, 0x04, 0x3D, 0x00, -+0x00, 0x00, 0x14, 0x71, 0xA7, 0x22, 0x90, 0x01, -+0x53, 0xE4, 0xF0, 0xFF, 0xEF, 0x91, 0xBE, 0xE4, -+0xF0, 0x0F, 0xEF, 0xB4, 0x08, 0xF6, 0x22, 0xE4, -+0x90, 0x9C, 0x59, 0xF0, 0x7F, 0x03, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x54, -+0xEF, 0xF0, 0x71, 0x96, 0x90, 0x9C, 0x54, 0xE0, -+0xFF, 0x91, 0xBE, 0x74, 0x01, 0xF0, 0x90, 0x9C, -+0x59, 0xE0, 0xFE, 0xEF, 0xF1, 0xEF, 0xEE, 0xF0, -+0x90, 0x9C, 0x54, 0xE0, 0x91, 0x12, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x9C, 0x55, -+0x91, 0xCF, 0xAB, 0x07, 0x90, 0x9C, 0x55, 0x12, -+0x04, 0xB8, 0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, -+0x92, 0x20, 0xEF, 0xF0, 0x90, 0x9C, 0x55, 0x12, -+0x04, 0xB8, 0x90, 0x92, 0x21, 0xEF, 0xF0, 0x7D, -+0x01, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x66, 0x33, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9A, 0x0B, -+0xE0, 0xFB, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x64, -+0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x22, -+0xE4, 0x90, 0x9A, 0x0B, 0xF0, 0x90, 0x9A, 0x0B, -+0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x40, 0x02, 0x81, -+0xB6, 0xEF, 0x91, 0xBE, 0xE0, 0x64, 0x01, 0x70, -+0x75, 0x90, 0x9A, 0x0B, 0xE0, 0x91, 0x12, 0x12, -+0x04, 0xB8, 0xE4, 0x7B, 0x01, 0x91, 0xB7, 0x70, -+0x3B, 0x90, 0x9A, 0x0B, 0xE0, 0xFB, 0xF1, 0xEF, -+0xE0, 0x60, 0x21, 0x14, 0x70, 0x58, 0xEB, 0x75, -+0xF0, 0x0A, 0xA4, 0x24, 0x68, 0xF5, 0x82, 0xE4, -+0x34, 0x9B, 0xF5, 0x83, 0x12, 0x04, 0xB8, 0xEB, -+0x91, 0x12, 0x12, 0x04, 0x31, 0x90, 0x9A, 0x0B, -+0xE0, 0xFF, 0x80, 0x0B, 0x91, 0x0D, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x00, 0x00, 0xAF, 0x03, 0x12, -+0xEB, 0xCB, 0x80, 0x2A, 0x90, 0x9A, 0x0B, 0xE0, -+0x91, 0x12, 0x12, 0x04, 0xB8, 0xE4, 0xFB, 0x91, -+0xB7, 0x50, 0x1B, 0x91, 0x0D, 0x12, 0x04, 0xB8, -+0xEF, 0x24, 0xFF, 0xFF, 0xEE, 0x34, 0xFF, 0xFE, -+0xED, 0x34, 0xFF, 0xFD, 0xEC, 0x34, 0xFF, 0xFC, -+0xEB, 0x91, 0x12, 0x12, 0x04, 0x31, 0x90, 0x9A, -+0x0B, 0xE0, 0x04, 0xF0, 0x81, 0x25, 0x22, 0xFA, -+0xF9, 0xF8, 0xC3, 0x02, 0x03, 0xDA, 0x75, 0xF0, -+0x0A, 0xA4, 0x24, 0x6D, 0xF5, 0x82, 0xE4, 0x34, -+0x9B, 0xF5, 0x83, 0x22, 0x90, 0x9C, 0x39, 0x12, -+0x04, 0xB8, 0x78, 0x10, 0x02, 0x03, 0xEB, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, -+0x32, 0xEC, 0x12, 0xFC, 0xF4, 0xAA, 0x07, 0x90, -+0x9C, 0x39, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, -+0x00, 0xD1, 0xCD, 0xEA, 0x24, 0xEF, 0x60, 0x36, -+0x24, 0xD7, 0x70, 0x02, 0xC1, 0x37, 0x24, 0x3A, -+0x60, 0x02, 0xC1, 0x6E, 0xD1, 0xAA, 0x24, 0x0A, -+0xD1, 0xD8, 0x12, 0x9E, 0x88, 0xE4, 0xD1, 0x98, -+0xE4, 0xF0, 0xFE, 0x74, 0x00, 0x2F, 0xD1, 0xC5, -+0x7D, 0x14, 0xD1, 0x8B, 0xF1, 0xE8, 0xD1, 0xB9, -+0x90, 0x90, 0xBE, 0x12, 0x04, 0x31, 0x7D, 0x14, -+0x7C, 0x00, 0xE4, 0xFF, 0xC1, 0x32, 0x90, 0x9C, -+0x32, 0xE4, 0x75, 0xF0, 0x14, 0x12, 0x02, 0xE7, -+0x90, 0x9C, 0x32, 0xA3, 0xE0, 0xFB, 0xFF, 0x24, -+0x06, 0xFC, 0xE4, 0x33, 0x90, 0x9C, 0x3D, 0xF0, -+0xA3, 0xCC, 0xF0, 0x90, 0x9C, 0x3D, 0xA3, 0xE0, -+0xFE, 0x12, 0x9E, 0x88, 0xE4, 0xD1, 0x98, 0xE4, -+0x12, 0xFB, 0xEF, 0xFE, 0xA9, 0x03, 0x74, 0x05, -+0x29, 0x12, 0xD7, 0x5B, 0x12, 0xBA, 0x6E, 0xFE, -+0x90, 0x9C, 0x37, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -+0x9C, 0x32, 0xE0, 0xFC, 0xA3, 0xE0, 0x2F, 0xFF, -+0xEC, 0x3E, 0xFE, 0xD3, 0xEF, 0x94, 0x00, 0xEE, -+0x94, 0x01, 0x90, 0x9C, 0x32, 0x40, 0x69, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0xE9, 0x7C, 0x00, 0x24, -+0x00, 0xF9, 0xEC, 0x34, 0xFC, 0xFA, 0x7B, 0x01, -+0xC3, 0xE4, 0x9F, 0xFD, 0x74, 0x01, 0x9E, 0xFC, -+0xD1, 0x8D, 0x90, 0x9C, 0x34, 0xE0, 0x24, 0x01, -+0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, -+0x90, 0xFD, 0x10, 0xF0, 0xD1, 0xA4, 0xC0, 0x00, -+0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0x7B, 0x01, -+0x7A, 0xFC, 0x79, 0x00, 0x90, 0x9C, 0x32, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0xE4, 0x9F, 0xFF, -+0x74, 0x01, 0x9E, 0xFE, 0xD1, 0xB1, 0xC3, 0x9F, -+0xFD, 0xEC, 0x9E, 0xFC, 0x12, 0x45, 0xC2, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -+0x83, 0x00, 0xD1, 0x90, 0xD1, 0xCD, 0x80, 0x0D, -+0xA3, 0xE0, 0x7E, 0x00, 0x24, 0x00, 0xD1, 0xC5, -+0xD1, 0xB1, 0xFD, 0xD1, 0x8D, 0x90, 0x9C, 0x32, -+0x74, 0xFF, 0x75, 0xF0, 0xEC, 0x12, 0x02, 0xE7, -+0xD1, 0xAA, 0x7E, 0x00, 0x24, 0x0C, 0xF9, 0xEE, -+0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x02, 0xC0, -+0x01, 0x74, 0x10, 0x2F, 0xF9, 0xEE, 0x34, 0xFC, -+0xFA, 0xD1, 0xB9, 0x90, 0x90, 0xBE, 0x12, 0x04, -+0x31, 0xD1, 0xB1, 0xFD, 0xD0, 0x01, 0xD0, 0x02, -+0x7F, 0x11, 0x12, 0x3C, 0xD9, 0x80, 0x2F, 0xD1, -+0xAA, 0x24, 0x2A, 0xD1, 0xD8, 0x12, 0x9E, 0x88, -+0xE4, 0xD1, 0x98, 0xE4, 0xF0, 0x12, 0xF3, 0x29, -+0x7D, 0x48, 0xD1, 0x8B, 0x91, 0xCC, 0xD1, 0xA4, -+0x12, 0x83, 0x00, 0xE4, 0xFD, 0xFC, 0xD1, 0x90, -+0x91, 0xCC, 0xD1, 0xA4, 0x12, 0x83, 0x00, 0xD1, -+0x90, 0xD1, 0xBF, 0x12, 0x03, 0xCD, 0x90, 0x9C, -+0x35, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x9C, -+0x35, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0xFF, -+0x90, 0x9C, 0x3D, 0xA3, 0xE0, 0xFE, 0x12, 0x9E, -+0x88, 0xEF, 0xD1, 0x98, 0xED, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x7C, 0x00, 0x12, 0x45, 0xC2, -+0x90, 0x9C, 0x39, 0x02, 0x04, 0x31, 0x74, 0x03, -+0xF0, 0x74, 0x01, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0x22, 0x90, 0x9C, 0x39, 0x02, -+0x84, 0x52, 0x90, 0x9C, 0x32, 0xA3, 0xE0, 0xFF, -+0x22, 0x90, 0x9C, 0x37, 0xE0, 0xFC, 0xA3, 0xE0, -+0x22, 0x90, 0x90, 0xBB, 0x12, 0x84, 0x67, 0x90, -+0x9C, 0x39, 0x02, 0x04, 0xB8, 0xF9, 0xEE, 0x34, -+0xFC, 0xFA, 0x7B, 0x01, 0x22, 0x90, 0x9C, 0x34, -+0xE0, 0xC3, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0x22, -+0xFD, 0xE4, 0x33, 0x90, 0x9C, 0x3D, 0xF0, 0xA3, -+0xED, 0xF0, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x07, 0x12, 0xE7, -+0xD9, 0x12, 0x9E, 0x8A, 0xE0, 0x90, 0x9B, 0x00, -+0xF0, 0x74, 0x01, 0x2F, 0xD1, 0x9C, 0xE0, 0x90, -+0x9B, 0x21, 0x12, 0xE7, 0xE2, 0x90, 0x9B, 0x42, -+0xF0, 0xEF, 0x24, 0x20, 0x90, 0x99, 0x88, 0xF0, -+0xF1, 0x62, 0x90, 0x9B, 0x00, 0xE0, 0xF5, 0x48, -+0x7B, 0x01, 0x7A, 0x9B, 0x79, 0x01, 0x12, 0x69, -+0xF5, 0x90, 0x9B, 0x00, 0xF1, 0xDE, 0xF1, 0x61, -+0x90, 0x9B, 0x21, 0xE0, 0xF5, 0x48, 0x7B, 0x01, -+0x7A, 0x9B, 0x79, 0x22, 0x12, 0x69, 0xF5, 0x90, -+0x9B, 0x21, 0xF1, 0xDE, 0xF1, 0x61, 0x90, 0x9B, -+0x42, 0xE0, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x9B, -+0x79, 0x43, 0x12, 0x69, 0xF5, 0xE4, 0xFF, 0x90, -+0x9B, 0x00, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, -+0x03, 0x0F, 0x80, 0xF3, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xE0, 0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, -+0x75, 0x45, 0x01, 0xF5, 0x46, 0x89, 0x47, 0x22, -+0x12, 0xBB, 0x33, 0xE4, 0x12, 0xEC, 0x85, 0x12, -+0xCE, 0xC1, 0x90, 0x99, 0x8A, 0xEF, 0xF0, 0x90, -+0x99, 0x88, 0xA3, 0xE0, 0x24, 0x38, 0xF9, 0xE4, -+0x34, 0xFC, 0xF1, 0x68, 0x75, 0x48, 0x06, 0x7B, -+0x01, 0x7A, 0x93, 0x79, 0x49, 0xF1, 0xD7, 0x12, -+0x9A, 0x1B, 0x24, 0x3E, 0xF9, 0xE4, 0x34, 0xFC, -+0xF1, 0x68, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, -+0x93, 0x79, 0x4F, 0xF1, 0xD7, 0x12, 0x9A, 0x1B, -+0x12, 0x9F, 0xF2, 0xF1, 0x68, 0x75, 0x48, 0x06, -+0x7B, 0x01, 0x7A, 0x93, 0x79, 0x53, 0xF1, 0xD7, -+0x12, 0x9A, 0x1B, 0x24, 0x48, 0xF9, 0xE4, 0x34, -+0xFC, 0xF1, 0x68, 0x75, 0x48, 0x04, 0x7B, 0x01, -+0x7A, 0x93, 0x79, 0x59, 0x02, 0x69, 0xF5, 0x12, -+0x69, 0xF5, 0x90, 0x99, 0x88, 0x22, 0xE0, 0xFF, -+0x90, 0x99, 0x88, 0xE0, 0x2F, 0xF0, 0x22, 0x22, -+0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, 0x22, 0x75, -+0xF0, 0x0A, 0xA4, 0x24, 0x6C, 0xF5, 0x82, 0xE4, -+0x34, 0x9B, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x8F, 0xFA, 0xF1, -+0xEB, 0x90, 0x88, 0x9D, 0x12, 0xCF, 0xDD, 0xF0, -+0xFC, 0x12, 0x02, 0x06, 0xFD, 0x54, 0x04, 0x13, -+0x13, 0x54, 0x3F, 0xFF, 0x90, 0x99, 0x7C, 0xE0, -+0x54, 0xFE, 0x4F, 0xF0, 0xED, 0x54, 0x08, 0xFF, -+0xEC, 0x54, 0xF7, 0x4F, 0xFF, 0x90, 0x88, 0x9D, -+0xF0, 0x12, 0x02, 0x06, 0x12, 0xF6, 0x06, 0x90, -+0x88, 0x9D, 0x12, 0x8F, 0x05, 0xF1, 0xCE, 0x4D, -+0xFF, 0x90, 0x88, 0x9D, 0x12, 0xF6, 0x10, 0xF0, -+0x12, 0x8C, 0x04, 0xE9, 0x24, 0x01, 0xF9, 0xE4, -+0x3A, 0x8B, 0x45, 0xF5, 0x46, 0x89, 0x47, 0x75, -+0x48, 0x04, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9E, -+0x12, 0x69, 0xF5, 0x12, 0x8C, 0x04, 0x12, 0x02, -+0x06, 0x20, 0xE0, 0x02, 0x21, 0xCF, 0x90, 0x05, -+0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, -+0x13, 0x90, 0x88, 0xAD, 0xF0, 0x90, 0x88, 0xA0, -+0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x15, 0x12, -+0x8E, 0xFF, 0x90, 0x88, 0x9E, 0xF0, 0x24, 0x0A, -+0x90, 0x88, 0xCF, 0x12, 0x8F, 0xED, 0x90, 0x88, -+0x9F, 0xF0, 0x80, 0x4B, 0x12, 0x8E, 0xFF, 0xFF, -+0xC3, 0x94, 0x2A, 0x50, 0x15, 0xEF, 0xC3, 0x94, -+0x03, 0x50, 0x07, 0x90, 0x88, 0x9E, 0x74, 0x03, -+0x80, 0x0D, 0x12, 0x8E, 0xFF, 0x90, 0x88, 0x9E, -+0x80, 0x05, 0x90, 0x88, 0x9E, 0x74, 0x2A, 0xF0, -+0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0x12, 0x8F, -+0xEE, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, -+0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, -+0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, -+0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, -+0xC4, 0x6A, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, -+0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, -+0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, -+0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, -+0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, -+0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, -+0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, -+0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, -+0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0xF0, 0x90, -+0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -+0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, -+0x07, 0x30, 0xE0, 0x0D, 0x90, 0x8A, 0x89, 0x12, -+0x91, 0x62, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, -+0x7E, 0x51, 0x5D, 0x74, 0x11, 0xF0, 0x90, 0x99, -+0x7C, 0xE0, 0x30, 0xE0, 0x31, 0x90, 0x99, 0x85, -+0x74, 0x01, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x06, -+0xC7, 0xE0, 0xFE, 0x90, 0x06, 0xC6, 0x51, 0x6E, -+0xFE, 0xE4, 0xFD, 0x78, 0x10, 0x12, 0xC3, 0x0D, -+0x90, 0x06, 0xC5, 0xE0, 0xFE, 0x90, 0x06, 0xC4, -+0x51, 0x6E, 0xFE, 0xE4, 0xFD, 0x12, 0x84, 0x45, -+0x90, 0x99, 0x81, 0x12, 0x04, 0x31, 0x90, 0x88, -+0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, 0xB0, -+0x74, 0x01, 0xF0, 0x80, 0x2B, 0x90, 0x88, 0xA5, -+0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, 0x74, -+0x04, 0xF0, 0x80, 0x1C, 0x90, 0x88, 0xA5, 0xE0, -+0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x02, -+0xF0, 0x80, 0x0D, 0x90, 0x88, 0xA5, 0xE0, 0xB4, -+0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, 0xF0, -+0xE4, 0x90, 0x88, 0xA5, 0xF0, 0x80, 0x41, 0x90, -+0x8A, 0xF1, 0x12, 0x8C, 0x14, 0x90, 0x89, 0x04, -+0xE0, 0x90, 0x00, 0x40, 0x30, 0xE0, 0x07, 0xE0, -+0x54, 0x0F, 0x44, 0xA0, 0x80, 0x05, 0xE0, 0x54, -+0x0F, 0x44, 0x20, 0xFD, 0x7F, 0x40, 0x12, 0x7B, -+0x2E, 0x12, 0x8C, 0x04, 0x12, 0x8F, 0xF4, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, -+0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, -+0x12, 0x98, 0x5B, 0x51, 0x5D, 0x74, 0x43, 0xF0, -+0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, -+0x90, 0x88, 0xAF, 0xF0, 0x90, 0x88, 0xA0, 0xF1, -+0xE3, 0x30, 0xE0, 0x09, 0x90, 0x88, 0xD0, 0xE0, -+0x44, 0x02, 0xF0, 0x80, 0x12, 0x90, 0x8A, 0x97, -+0x12, 0x91, 0x62, 0x7F, 0x01, 0x12, 0x04, 0x7E, -+0x90, 0x88, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x90, -+0x8A, 0xD9, 0x12, 0x91, 0x62, 0x7F, 0x03, 0x12, -+0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, -+0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, 0x00, -+0x74, 0x1C, 0xF0, 0xA3, 0x22, 0xF0, 0x90, 0x01, -+0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, -+0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0x90, -+0x98, 0x12, 0x71, 0x31, 0xEF, 0xF0, 0xE0, 0xFE, -+0x24, 0x28, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0x12, 0xE6, -+0x3E, 0xE0, 0xFD, 0x90, 0x99, 0x88, 0xE0, 0x24, -+0x2C, 0x12, 0xCE, 0xDE, 0x90, 0x99, 0x88, 0xE0, -+0x2F, 0x24, 0x30, 0xA3, 0xF0, 0xE0, 0xFD, 0x24, -+0x04, 0x12, 0xFB, 0xF3, 0xFE, 0x74, 0x05, 0x2D, -+0x12, 0xD7, 0x5B, 0x51, 0x6E, 0x90, 0x95, 0x6D, -+0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0x89, 0xE0, -+0x24, 0x0C, 0xF9, 0xE4, 0x34, 0xFC, 0x12, 0xB7, -+0x68, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x95, -+0x79, 0x6F, 0x12, 0x69, 0xF5, 0x90, 0x99, 0x89, -+0xE0, 0x24, 0x14, 0xF0, 0xE0, 0xFD, 0x24, 0x01, -+0x12, 0xB6, 0x9C, 0xE0, 0xFE, 0x74, 0x00, 0x2D, -+0x12, 0x9E, 0x8A, 0x51, 0x6E, 0x90, 0x95, 0x73, -+0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x98, 0x13, 0x71, -+0x31, 0xEF, 0xF0, 0x90, 0x95, 0x69, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0x4E, 0x60, 0x11, 0x90, 0x99, -+0x88, 0x12, 0xB7, 0x61, 0x8F, 0x48, 0x7B, 0x01, -+0x7A, 0x95, 0x79, 0x77, 0x12, 0x69, 0xF5, 0x90, -+0x98, 0x14, 0x71, 0x31, 0xEF, 0xF0, 0x12, 0xB7, -+0x62, 0x90, 0x95, 0x6B, 0xA3, 0xE0, 0xF5, 0x48, -+0x7B, 0x01, 0x7A, 0x95, 0x79, 0x97, 0x02, 0x69, -+0xF5, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, 0x99, -+0x88, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x12, 0xD7, 0x63, 0x90, 0x99, 0x8D, 0xF0, -+0x90, 0x02, 0x09, 0xE0, 0x90, 0x99, 0x8E, 0xF0, -+0x90, 0x98, 0x15, 0x12, 0xF3, 0x21, 0x90, 0x99, -+0x88, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x9E, -+0x88, 0xE0, 0x90, 0x95, 0xB9, 0xF0, 0x74, 0x01, -+0x2F, 0x12, 0xB6, 0x9C, 0xE0, 0x90, 0x95, 0xBA, -+0xF0, 0xF1, 0xC6, 0x12, 0x02, 0xE7, 0x90, 0x99, -+0x88, 0xA3, 0xE0, 0x24, 0x02, 0x12, 0xE7, 0xE6, -+0xFF, 0xE4, 0xFC, 0xFD, 0x78, 0x10, 0x12, 0x03, -+0xFE, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0xF1, 0xB9, 0xB1, 0xAA, 0x78, 0x18, 0x12, -+0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0x83, 0x00, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0xF1, 0xAC, 0xB1, -+0xAA, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x9E, -+0x78, 0xB1, 0xAC, 0x12, 0x83, 0x00, 0x90, 0x95, -+0xBD, 0xB1, 0x91, 0x78, 0x10, 0x12, 0x03, 0xFE, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0xF1, 0xB9, 0xB1, 0xAA, 0x78, 0x18, 0x12, 0x03, -+0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0x12, 0x83, 0x00, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0xF1, 0xAC, 0xB1, 0xAA, -+0x78, 0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x9E, 0x78, -+0xB1, 0xAC, 0x12, 0x83, 0x00, 0x90, 0x95, 0xC1, -+0xB1, 0x91, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xF1, -+0xB9, 0xB1, 0xAA, 0x78, 0x18, 0x12, 0x03, 0xFE, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0x12, 0x83, 0x00, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0xF1, 0xAC, 0xB1, 0xAA, 0x78, -+0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0x12, 0x9E, 0x78, 0xB1, -+0xAC, 0x12, 0x83, 0x00, 0x90, 0x95, 0xC5, 0x12, -+0x04, 0x31, 0xF1, 0xC6, 0xF1, 0x85, 0xF1, 0x97, -+0x12, 0x9E, 0x88, 0xE0, 0xFF, 0x12, 0xFC, 0xAA, -+0xB1, 0xB3, 0xE0, 0xB4, 0x10, 0xF0, 0xF1, 0x7E, -+0xF1, 0x97, 0x12, 0x9E, 0x88, 0xE0, 0xFF, 0x74, -+0xD9, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xB1, -+0xB3, 0xE0, 0xB4, 0x10, 0xEB, 0xF1, 0x7E, 0xF1, -+0x97, 0x12, 0x9E, 0x88, 0xE0, 0xFF, 0x74, 0xE9, -+0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xB1, 0xB3, -+0xE0, 0xB4, 0x10, 0xEB, 0x90, 0x99, 0x88, 0xF1, -+0xD5, 0x90, 0x98, 0x15, 0x71, 0x31, 0xE4, 0x12, -+0xEC, 0x85, 0xE4, 0x75, 0xF0, 0x40, 0xF1, 0x85, -+0x90, 0x99, 0x8A, 0xE0, 0xFF, 0xC3, 0x94, 0x08, -+0x50, 0x20, 0x90, 0x99, 0x88, 0xA3, 0xE0, 0xFE, -+0xEF, 0x2E, 0x12, 0x9E, 0x88, 0xE0, 0xFE, 0x90, -+0x99, 0x8E, 0xE0, 0xFD, 0xEE, 0x2D, 0xFE, 0x74, -+0xF9, 0x2F, 0x12, 0xEB, 0xBB, 0xEE, 0xB1, 0xB6, -+0x80, 0xD6, 0x90, 0x98, 0x15, 0xE0, 0x04, 0x90, -+0x99, 0x8C, 0xF0, 0xE4, 0x90, 0x99, 0x8B, 0xF0, -+0x90, 0x95, 0xB9, 0xE0, 0x13, 0x13, 0x54, 0x3F, -+0x24, 0x01, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x99, -+0x8B, 0xE0, 0xC3, 0x9F, 0xEE, 0x12, 0xEE, 0xAF, -+0x50, 0x78, 0xA3, 0x71, 0x31, 0xE4, 0xF0, 0xA3, -+0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x99, 0x8A, -+0xE0, 0xFD, 0xC3, 0x94, 0x04, 0x50, 0x55, 0xA3, -+0xE0, 0x75, 0xF0, 0x04, 0xA4, 0x7C, 0x00, 0x2D, -+0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x90, 0x95, 0xB9, -+0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0x74, 0x80, 0xF8, -+0x6E, 0x98, 0x50, 0x38, 0xEF, 0x78, 0x05, 0xC3, -+0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x01, -+0xF9, 0x74, 0x96, 0x3E, 0xFA, 0x7B, 0x01, 0xC0, -+0x03, 0xC0, 0x01, 0x90, 0x99, 0x88, 0xA3, 0xE0, -+0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, 0x8B, 0x45, -+0xF5, 0x46, 0x89, 0x47, 0x75, 0x48, 0x20, 0xD0, -+0x01, 0xD0, 0x03, 0x12, 0xB7, 0xD7, 0xF1, 0xDC, -+0xB1, 0xB7, 0x80, 0xA1, 0x90, 0x99, 0x8C, 0xE0, -+0x04, 0xF0, 0x90, 0x99, 0x8B, 0xE0, 0x04, 0xF0, -+0x81, 0xE8, 0xE4, 0x90, 0x99, 0x8A, 0xF0, 0xE4, -+0xFF, 0x0F, 0xEF, 0xB4, 0x20, 0xFB, 0xB1, 0xB7, -+0xE0, 0xB4, 0x10, 0xF3, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x12, 0x04, 0x31, 0x90, 0x99, 0x88, 0xE4, -+0x75, 0xF0, 0x04, 0x12, 0x02, 0xE7, 0x90, 0x99, -+0x88, 0xA3, 0xE0, 0x24, 0x02, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0xE4, 0xFC, -+0xFD, 0xFE, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, -+0x99, 0x8A, 0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x9F, -+0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0xEF, 0x14, 0x60, -+0x02, 0xC1, 0xA2, 0x90, 0x06, 0x03, 0xE0, 0x54, -+0xFB, 0xF0, 0x90, 0x9C, 0x9F, 0xE0, 0xFB, 0xC4, -+0x33, 0x54, 0xE0, 0xFE, 0x90, 0x04, 0x42, 0xE0, -+0x54, 0x9F, 0x4E, 0xFE, 0xF0, 0xE4, 0xFD, 0x12, -+0xED, 0x4B, 0x90, 0x9C, 0xA0, 0xEF, 0xF0, 0x90, -+0x04, 0x83, 0xF0, 0x90, 0x9C, 0x01, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x9C, 0x05, -+0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0xF1, -+0x08, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, -+0x90, 0x9C, 0x05, 0x12, 0x04, 0x3D, 0x00, 0x00, -+0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, 0xF1, 0x0C, -+0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x10, 0x90, -+0x9C, 0x9F, 0xB1, 0xAC, 0xEF, 0x54, 0x03, 0xFF, -+0xE4, 0x78, 0x01, 0x12, 0x03, 0xEB, 0x78, 0x04, -+0xF1, 0x8E, 0x7F, 0x00, 0x7E, 0x0A, 0xF1, 0x0C, -+0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, -+0x9C, 0x9F, 0xB1, 0xAC, 0xEF, 0x54, 0x03, 0xFF, -+0xE4, 0x78, 0x0A, 0xF1, 0x8E, 0x7F, 0x00, 0x7E, -+0x0D, 0xF1, 0x0C, 0x12, 0x04, 0x3D, 0x0C, 0x00, -+0x00, 0x00, 0x90, 0x9C, 0xA0, 0xB1, 0xAC, 0xEF, -+0x54, 0x03, 0xFF, 0xE4, 0x78, 0x1A, 0xF1, 0x8E, -+0x7F, 0x18, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, -+0x00, 0x0C, 0x00, 0x90, 0x9C, 0x05, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x00, 0x00, 0xF1, 0xA2, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x9B, -+0xF3, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x04, 0x00, -+0x80, 0x58, 0x90, 0x06, 0x03, 0xE0, 0x44, 0x04, -+0xF0, 0x90, 0x9C, 0x01, 0x12, 0x04, 0x3D, 0x00, -+0x00, 0x00, 0x01, 0x90, 0x9C, 0x05, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x00, 0x00, 0xF1, 0x08, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x9C, -+0x05, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, -+0x7F, 0x00, 0x7E, 0x09, 0xF1, 0x0C, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x9C, 0x05, -+0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0xF1, -+0xA2, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, -+0x90, 0x9B, 0xF3, 0x12, 0x04, 0x3D, 0x00, 0x00, -+0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, -+0x12, 0xE8, 0x55, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x7F, 0x00, 0x7E, 0x08, 0xF1, 0x16, 0x90, 0x9C, -+0x01, 0x22, 0x7F, 0x58, 0x7E, 0x0C, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9B, 0xFF, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, -+0x90, 0x9C, 0x09, 0x12, 0x04, 0x31, 0x90, 0x9C, -+0x01, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, -+0x9C, 0x09, 0x12, 0x84, 0x52, 0x12, 0x84, 0x38, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0x9C, 0x01, 0x12, 0x04, 0xB8, 0x90, 0x9C, -+0x05, 0x12, 0x84, 0x52, 0x12, 0x84, 0x38, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -+0x84, 0x45, 0x90, 0x9C, 0x0D, 0x12, 0x04, 0x31, -+0x90, 0x9C, 0x0D, 0x12, 0xAE, 0xD6, 0x90, 0x9B, -+0xFF, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, -+0xAD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x99, -+0x88, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x02, 0xE7, -+0xE4, 0x90, 0x99, 0x8A, 0xF0, 0x22, 0x12, 0x03, -+0xFE, 0x90, 0x9C, 0x05, 0x02, 0x04, 0x31, 0x90, -+0x99, 0x88, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFE, -+0x2F, 0x22, 0x7F, 0x84, 0x7E, 0x08, 0xF1, 0x16, -+0x90, 0x9B, 0xEF, 0x22, 0x90, 0x99, 0x88, 0xA3, -+0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0x22, 0x90, 0x99, 0x88, 0xA3, 0xE0, 0x24, 0x03, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0x22, 0x90, 0x99, -+0x88, 0xE4, 0x75, 0xF0, 0x04, 0x22, 0x54, 0x40, -+0xFD, 0xEF, 0x54, 0xBF, 0x22, 0xE4, 0x75, 0xF0, -+0x10, 0x02, 0x02, 0xE7, 0xE4, 0x75, 0xF0, 0x20, -+0x02, 0x02, 0xE7, 0xE0, 0xC4, 0x13, 0x13, 0x13, -+0x54, 0x01, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x54, -+0x01, 0xFE, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x12, -+0x8E, 0xFF, 0x90, 0x99, 0x8A, 0x12, 0x8F, 0xED, -+0x90, 0x99, 0x8B, 0xF0, 0x12, 0x8F, 0xF4, 0x90, -+0x99, 0x8C, 0x12, 0x97, 0x30, 0x90, 0x99, 0x8D, -+0x12, 0x96, 0x2D, 0x90, 0x99, 0x8E, 0x31, 0xC5, -+0x90, 0x99, 0x8F, 0xF0, 0xEF, 0x12, 0x84, 0x70, -+0xC0, 0x3C, 0x00, 0xC0, 0x48, 0x01, 0xC0, 0x4F, -+0x02, 0xC0, 0x56, 0x03, 0xC0, 0x5D, 0x04, 0xC0, -+0x64, 0x05, 0xC0, 0x6D, 0x06, 0xC0, 0x96, 0x07, -+0x00, 0x00, 0xC0, 0xF4, 0x90, 0x99, 0x88, 0x74, -+0x02, 0xF0, 0xA3, 0x74, 0x29, 0xF0, 0x01, 0xF9, -+0x31, 0x22, 0x74, 0x2A, 0xF0, 0x01, 0xF9, 0x31, -+0x13, 0x74, 0x31, 0xF0, 0x01, 0xF9, 0x31, 0x13, -+0x74, 0x32, 0xF0, 0x01, 0xF9, 0x31, 0x22, 0x74, -+0x33, 0xF0, 0x01, 0xF9, 0x31, 0x1B, 0x90, 0x8A, -+0x83, 0x31, 0xBB, 0x21, 0x10, 0x90, 0x99, 0x8A, -+0xE0, 0x90, 0x88, 0xE1, 0xF0, 0x90, 0x99, 0x8B, -+0xE0, 0x90, 0x88, 0xE2, 0xF0, 0x90, 0x99, 0x8C, -+0xE0, 0x90, 0x88, 0xE3, 0xF0, 0x90, 0x99, 0x8D, -+0xE0, 0x90, 0x88, 0xE4, 0xF0, 0x90, 0x99, 0x8E, -+0xE0, 0x90, 0x88, 0xE5, 0xF0, 0x22, 0x90, 0x99, -+0x8A, 0xE0, 0x90, 0x99, 0x87, 0xF0, 0x90, 0x99, -+0x8D, 0x12, 0xBD, 0xAC, 0x78, 0x10, 0x12, 0x03, -+0xFE, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0xA3, 0x12, 0xBD, 0xAC, 0x78, 0x18, 0x12, -+0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -+0xD0, 0x00, 0x12, 0x84, 0x45, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x99, 0x8C, -+0x12, 0xBD, 0xAC, 0x78, 0x08, 0x12, 0x03, 0xFE, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0x12, 0x84, 0x45, 0x71, 0x10, 0x90, 0x99, 0x8B, -+0x12, 0xBD, 0xAC, 0x12, 0x84, 0x45, 0x90, 0x99, -+0x7D, 0x02, 0x04, 0x31, 0x31, 0x13, 0x74, 0xFF, -+0xF0, 0x90, 0x99, 0x89, 0xE0, 0xFF, 0x90, 0x99, -+0x88, 0xE0, 0xFD, 0x31, 0x1B, 0x90, 0x8A, 0xCF, -+0xE0, 0xF8, 0xA3, 0xE0, 0xF5, 0x82, 0x88, 0x83, -+0x02, 0x04, 0x7E, 0x90, 0x99, 0x88, 0x74, 0x01, -+0xF0, 0xA3, 0x22, 0x7B, 0x01, 0x7A, 0x99, 0x79, -+0x8A, 0x22, 0x90, 0x99, 0x88, 0x74, 0x06, 0xF0, -+0xA3, 0x22, 0x12, 0x02, 0x06, 0x64, 0x01, 0x60, -+0x02, 0x21, 0xB7, 0x90, 0x99, 0xCF, 0xF0, 0x90, -+0x99, 0xCF, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x50, -+0x27, 0xEF, 0x31, 0xCC, 0x7A, 0x99, 0x79, 0xCE, -+0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x12, 0x90, 0x99, -+0xCE, 0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0xD0, 0xF5, -+0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xEF, 0xF0, -+0x90, 0x99, 0xCF, 0xE0, 0x04, 0xF0, 0x80, 0xCF, -+0x75, 0x45, 0x01, 0x75, 0x46, 0x99, 0x75, 0x47, -+0xD0, 0x75, 0x48, 0x08, 0x31, 0x1B, 0x12, 0xB7, -+0xD7, 0x74, 0x24, 0xF0, 0x90, 0x99, 0xAA, 0x74, -+0x08, 0xF0, 0x75, 0x45, 0x01, 0x75, 0x46, 0x99, -+0x75, 0x47, 0xD8, 0xF5, 0x48, 0x7B, 0x01, 0x7A, -+0x99, 0x79, 0xAD, 0x12, 0x69, 0xF5, 0x90, 0x99, -+0xAB, 0x74, 0x25, 0xF0, 0x90, 0x99, 0xCD, 0x74, -+0x08, 0x12, 0x90, 0xBE, 0x31, 0xB8, 0x12, 0x04, -+0x7E, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0xAB, 0x12, -+0x91, 0x50, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, -+0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0xF5, 0x82, 0x8E, 0x83, 0x22, 0xF0, 0x90, 0x00, -+0x06, 0x02, 0x02, 0x1F, 0x24, 0xA8, 0xFF, 0xE4, -+0x34, 0x01, 0xFE, 0x7B, 0x01, 0x22, 0x12, 0x8F, -+0xFA, 0x12, 0x02, 0x06, 0x64, 0x01, 0x60, 0x02, -+0x41, 0x67, 0xEF, 0x24, 0x39, 0x60, 0x12, 0x14, -+0x60, 0x19, 0x24, 0x02, 0x70, 0x1F, 0xE4, 0x90, -+0x99, 0x8E, 0xF0, 0xA3, 0x74, 0x06, 0xF0, 0x80, -+0x14, 0x90, 0x99, 0x8E, 0x74, 0x06, 0xF0, 0xA3, -+0xF0, 0x80, 0x0A, 0x90, 0x99, 0x8E, 0x74, 0x0C, -+0xF0, 0xA3, 0x74, 0x04, 0xF0, 0x51, 0x7B, 0x51, -+0x68, 0x40, 0x1B, 0x90, 0x99, 0x8C, 0xE0, 0x31, -+0xCC, 0x7A, 0x99, 0x79, 0x8B, 0x12, 0x5F, 0xA6, -+0xBF, 0x01, 0x07, 0x90, 0x99, 0x8B, 0xE0, 0xF4, -+0x70, 0x3D, 0x51, 0x70, 0x80, 0xE1, 0x51, 0x7B, -+0x51, 0x68, 0x40, 0x33, 0x90, 0x99, 0x8C, 0xE0, -+0xFD, 0x7C, 0x00, 0x24, 0xA8, 0xFF, 0xEC, 0x34, -+0x01, 0xFE, 0xED, 0x24, 0x01, 0xFD, 0xEC, 0x33, -+0xFC, 0x90, 0x99, 0x8E, 0xE0, 0xFB, 0xC3, 0xED, -+0x9B, 0xFD, 0xEC, 0x94, 0x00, 0xFC, 0x12, 0x8C, -+0x04, 0x8D, 0x82, 0x8C, 0x83, 0x12, 0x02, 0x1F, -+0xFD, 0x51, 0x8C, 0x51, 0x70, 0x80, 0xC9, 0x22, -+0x90, 0x99, 0x8D, 0xE0, 0xD3, 0x94, 0x00, 0x22, -+0x90, 0x99, 0x8C, 0xE0, 0x04, 0xF0, 0xA3, 0xE0, -+0x14, 0xF0, 0x22, 0x90, 0x99, 0x8E, 0xE0, 0x90, -+0x99, 0x8C, 0xF0, 0x90, 0x99, 0x8F, 0xE0, 0x90, -+0x99, 0x8D, 0xF0, 0x22, 0x8E, 0x0D, 0x8F, 0x0E, -+0x8D, 0x0F, 0xE4, 0x90, 0x99, 0x90, 0xF0, 0x90, -+0x00, 0x37, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x37, -+0x12, 0x7B, 0x2E, 0x7D, 0x69, 0x7F, 0xCF, 0x12, -+0x7B, 0x2E, 0xE5, 0x0E, 0xFD, 0x7F, 0x31, 0x12, -+0x7B, 0x2E, 0xE5, 0x0D, 0x54, 0x03, 0xFF, 0x90, -+0x00, 0x32, 0xE0, 0x54, 0xFC, 0x4F, 0xFD, 0x7F, -+0x32, 0x12, 0x7B, 0x2E, 0xAD, 0x0F, 0x7F, 0x30, -+0x12, 0x7B, 0x2E, 0x90, 0x00, 0x33, 0xE0, 0x44, -+0x80, 0xFD, 0x7F, 0x33, 0x12, 0x7B, 0x2E, 0x90, -+0x00, 0x33, 0xE0, 0x30, 0xE7, 0x09, 0x71, 0x03, -+0x50, 0x05, 0xE0, 0x04, 0xF0, 0x80, 0xF0, 0xE4, -+0xFD, 0x7F, 0xCF, 0x12, 0x7B, 0x2E, 0x90, 0x00, -+0x37, 0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x37, 0x12, -+0x7B, 0x2E, 0x71, 0x03, 0x7F, 0x00, 0x50, 0x02, -+0x7F, 0x01, 0x22, 0x90, 0x99, 0x90, 0xE0, 0xC3, -+0x94, 0x64, 0x22, 0x78, 0x08, 0x12, 0x03, 0xFE, -+0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, -+0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, -+0x90, 0x8A, 0x8F, 0x80, 0x03, 0x90, 0x8A, 0x87, -+0x12, 0x8C, 0x14, 0x90, 0x88, 0xE6, 0xE0, 0x30, -+0xE0, 0x04, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x88, -+0xE7, 0xE0, 0x64, 0x08, 0x70, 0x22, 0x90, 0x88, -+0xE6, 0xE0, 0x30, 0xE0, 0x16, 0x12, 0xAF, 0xE3, -+0xE0, 0x90, 0x92, 0x90, 0x12, 0xAE, 0xC9, 0x90, -+0x88, 0xE6, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, -+0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, -+0x90, 0x88, 0xA1, 0xF1, 0xE0, 0x30, 0xE0, 0x13, -+0x90, 0x88, 0xE8, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, -+0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, 0x90, -+0x88, 0xE8, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x70, -+0x02, 0x81, 0x01, 0x90, 0x88, 0x4D, 0xE0, 0x04, -+0xF0, 0x90, 0x05, 0x61, 0x12, 0xBD, 0xAC, 0x71, -+0x0B, 0x90, 0x05, 0x60, 0x12, 0xBD, 0xAC, 0x12, -+0x84, 0x45, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0xBD, 0xAC, -+0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x84, 0x45, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0xA3, 0x12, 0xBD, 0xAC, 0x78, 0x18, 0x12, 0x03, -+0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0x12, 0x84, 0x45, 0x90, 0x88, 0x81, 0x12, -+0x04, 0x31, 0x90, 0x88, 0x32, 0xE0, 0x54, 0x7F, -+0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0B, 0x12, 0xE1, -+0x3B, 0x74, 0x05, 0xF0, 0x12, 0x6E, 0x2F, 0xF1, -+0xE8, 0x12, 0xDB, 0xD8, 0x30, 0xE0, 0x0A, 0x90, -+0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0xFB, -+0x62, 0x12, 0xC8, 0x9D, 0x12, 0xF1, 0xE8, 0xE4, -+0x90, 0x98, 0x1B, 0xF0, 0x12, 0xFB, 0x51, 0x90, -+0x93, 0x24, 0x91, 0x6D, 0x30, 0xE0, 0x52, 0x90, -+0x95, 0x63, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7C, -+0x00, 0x7D, 0x64, 0x12, 0x02, 0x92, 0x90, 0x95, -+0xB7, 0xE0, 0x6E, 0x70, 0x03, 0xA3, 0xE0, 0x6F, -+0x60, 0x0A, 0x90, 0x95, 0xB7, 0xE4, 0x75, 0xF0, -+0x01, 0x02, 0x02, 0xE7, 0x90, 0x95, 0x67, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x75, 0xE0, -+0xB5, 0x06, 0x14, 0xA3, 0xE0, 0xB5, 0x07, 0x0F, -+0xEF, 0x4E, 0x60, 0x0B, 0x90, 0x01, 0xC7, 0x74, -+0x31, 0xF0, 0x7F, 0x01, 0x02, 0xC9, 0x1D, 0x12, -+0xD5, 0xFC, 0xE4, 0x90, 0x95, 0xB7, 0xF0, 0xA3, -+0xF0, 0x22, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, -+0x13, 0x54, 0x03, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x6B, 0xEF, 0xF0, -+0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, -+0xF0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x07, -+0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, -+0x04, 0x1D, 0xE0, 0x60, 0x31, 0x90, 0x05, 0x22, -+0xE0, 0x90, 0x9C, 0x6F, 0xF0, 0x7B, 0x26, 0x12, -+0x8C, 0x0A, 0xEF, 0x64, 0x01, 0x70, 0x02, 0x80, -+0x05, 0x91, 0x6A, 0x30, 0xE0, 0x08, 0xF1, 0x00, -+0xB1, 0x1C, 0xF1, 0x28, 0xEE, 0xF0, 0x90, 0x9C, -+0x6F, 0xE0, 0xFD, 0x7B, 0x27, 0xE4, 0xFF, 0x12, -+0x98, 0x60, 0xD1, 0x99, 0x80, 0x0A, 0xD1, 0x99, -+0xF1, 0x00, 0xB1, 0x1C, 0xF1, 0x28, 0xEE, 0xF0, -+0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x17, 0x91, -+0x6A, 0x30, 0xE0, 0x12, 0x90, 0x05, 0x22, 0xE0, -+0x54, 0x6F, 0xFF, 0x90, 0x8A, 0xF9, 0x12, 0xAF, -+0x05, 0x7D, 0x28, 0x12, 0x04, 0x7E, 0x90, 0x04, -+0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x04, 0xF0, 0x90, 0x9A, 0x0B, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x9A, 0x0E, -+0xE0, 0xFD, 0x90, 0x9A, 0x0D, 0xE0, 0x2D, 0x04, -+0xFD, 0x90, 0x8A, 0xE9, 0xE0, 0xFA, 0xA3, 0xE0, -+0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, -+0xF1, 0x8A, 0xE4, 0x90, 0x9A, 0x0F, 0xF0, 0xA3, -+0xF0, 0x12, 0xA3, 0x40, 0xEF, 0x54, 0x0C, 0x64, -+0x08, 0x70, 0x41, 0xB1, 0x83, 0xA3, 0xE0, 0x24, -+0x06, 0xB1, 0x18, 0xEF, 0x64, 0x88, 0x70, 0x34, -+0xB1, 0x83, 0xA3, 0xE0, 0x24, 0x07, 0xB1, 0x18, -+0xEF, 0x64, 0x8E, 0x70, 0x27, 0x90, 0x9A, 0x0F, -+0xB1, 0x03, 0xEF, 0x70, 0x1F, 0xB1, 0x83, 0xD1, -+0x7B, 0x24, 0x04, 0xB1, 0x18, 0xEF, 0x64, 0x01, -+0x70, 0x12, 0xB1, 0x83, 0xD1, 0x7B, 0x24, 0x08, -+0xB1, 0x18, 0xBF, 0x01, 0x07, 0x90, 0x01, 0xC7, -+0x74, 0x0B, 0xF1, 0x78, 0x90, 0x9A, 0x0F, 0xE0, -+0xFF, 0x22, 0xF0, 0x90, 0x9A, 0x0B, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0x22, 0xF1, 0x8A, 0xE4, 0x90, -+0x9A, 0x10, 0xF0, 0x12, 0xA3, 0x40, 0xEF, 0x54, -+0x0C, 0x64, 0x08, 0x70, 0x6E, 0xB1, 0x83, 0xA3, -+0xE0, 0x24, 0x06, 0xB1, 0x18, 0xEF, 0x64, 0x88, -+0x70, 0x61, 0xB1, 0x83, 0xA3, 0xE0, 0x24, 0x07, -+0xB1, 0x18, 0xEF, 0x64, 0x8E, 0x70, 0x54, 0x90, -+0x9A, 0x10, 0xB1, 0x03, 0xEF, 0x64, 0x03, 0x70, -+0x4A, 0xB1, 0x83, 0xD1, 0x7B, 0x24, 0x06, 0xB1, -+0x18, 0xEF, 0x30, 0xE3, 0x07, 0x90, 0x01, 0xC7, -+0x74, 0x01, 0x80, 0x35, 0x90, 0x93, 0x24, 0xD1, -+0x14, 0x30, 0xE0, 0x20, 0x90, 0x98, 0x05, 0xE0, -+0x64, 0x02, 0x70, 0x0E, 0xD1, 0x11, 0x30, 0xE0, -+0x02, 0x80, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x02, -+0x80, 0x17, 0xB1, 0x83, 0xA3, 0xE0, 0xFD, 0x12, -+0xA3, 0x50, 0x80, 0x0F, 0x90, 0x93, 0x27, 0x91, -+0x6D, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xC7, 0x74, -+0x02, 0xF1, 0x78, 0x90, 0x9A, 0x10, 0xE0, 0xFF, -+0x22, 0x90, 0x93, 0x25, 0xE0, 0x13, 0x13, 0x13, -+0x54, 0x1F, 0x22, 0xE4, 0xF5, 0x11, 0x90, 0x88, -+0x36, 0xE0, 0x60, 0x56, 0xF1, 0x81, 0x70, 0x52, -+0xF1, 0xF0, 0x75, 0x11, 0x01, 0xE5, 0x11, 0x60, -+0x49, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, -+0x90, 0x8A, 0xB9, 0x12, 0x91, 0x62, 0xF1, 0x69, -+0xF1, 0x70, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x04, -+0x64, 0x01, 0x70, 0x14, 0xD1, 0x86, 0xD1, 0x14, -+0xFF, 0xA3, 0xE0, 0x2F, 0xD1, 0xB7, 0x90, 0x88, -+0x3E, 0xD1, 0x14, 0xFF, 0xA3, 0xE0, 0x80, 0x10, -+0xD1, 0x86, 0xD1, 0x14, 0xD1, 0x8F, 0x2F, 0xD1, -+0xB7, 0x90, 0x88, 0x3E, 0xD1, 0x14, 0xD1, 0x8F, -+0x2F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, -+0x4F, 0xF0, 0x22, 0x90, 0x9A, 0x0E, 0xE0, 0xFD, -+0x90, 0x9A, 0x0D, 0xE0, 0x2D, 0x22, 0xE4, 0x90, -+0x92, 0x20, 0xF0, 0x90, 0x88, 0x3E, 0x22, 0xFF, -+0xA3, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, -+0x22, 0x90, 0x9C, 0x6B, 0xE0, 0xFF, 0x90, 0x8A, -+0xC7, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, -+0x8C, 0x83, 0x02, 0x04, 0x7E, 0xF0, 0xE4, 0x90, -+0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, 0x90, -+0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, -+0x7E, 0x01, 0x02, 0x66, 0x33, 0xE4, 0x90, 0x9A, -+0xDC, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x2F, -+0xF1, 0x81, 0x70, 0x2B, 0x12, 0xFC, 0xD4, 0xF0, -+0xF1, 0xF0, 0x90, 0x9A, 0xDC, 0x74, 0x01, 0xF0, -+0xE4, 0x90, 0x88, 0x3D, 0xF0, 0x04, 0x60, 0x17, -+0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, 0x90, -+0x8A, 0xB9, 0x12, 0x91, 0x62, 0xF1, 0x69, 0xF1, -+0x70, 0xD1, 0x86, 0xD1, 0x14, 0xD1, 0xB7, 0x22, -+0x90, 0x86, 0xB6, 0xE0, 0xFF, 0x90, 0x9C, 0x6C, -+0xE0, 0xFB, 0x90, 0x92, 0x13, 0x74, 0x0A, 0xF0, -+0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x9C, 0x6D, -+0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, -+0x9C, 0x6B, 0xE0, 0xFF, 0x90, 0x8A, 0x95, 0x22, -+0x90, 0x9C, 0x6D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x90, 0x8A, 0x9B, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, -+0xF5, 0x82, 0x8C, 0x83, 0x12, 0x04, 0x7E, 0x90, -+0x9C, 0x6D, 0xA3, 0xE0, 0xFF, 0x24, 0x12, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, -+0x01, 0xFE, 0x90, 0x9C, 0x6C, 0xE0, 0x25, 0xE0, -+0x25, 0xE0, 0x44, 0x02, 0x4E, 0xFE, 0x74, 0x12, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0x22, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x04, 0x7E, -+0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, -+0xF0, 0x90, 0x93, 0x2D, 0xE0, 0x44, 0x01, 0xF0, -+0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x64, -+0x01, 0x22, 0x90, 0x9A, 0x0D, 0xED, 0xF0, 0xA3, -+0xEB, 0xF0, 0x90, 0x9A, 0x0B, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x22, 0xF1, 0x92, 0xA3, 0xED, 0xF0, -+0xE4, 0xA3, 0xF0, 0x12, 0xFA, 0x76, 0x50, 0x20, -+0xB1, 0x83, 0xED, 0x24, 0x1C, 0xB1, 0x18, 0x90, -+0x9A, 0x0E, 0xE0, 0x24, 0x97, 0xF5, 0x82, 0xE4, -+0x34, 0x95, 0xF5, 0x83, 0xE0, 0xB5, 0x07, 0x1D, -+0x90, 0x9A, 0x0E, 0xE0, 0x04, 0xF0, 0x80, 0xDB, -+0x90, 0x06, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x90, -+0x01, 0xC7, 0x74, 0x30, 0xF0, 0x7F, 0x01, 0x12, -+0xC9, 0x1D, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, -+0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, -+0x90, 0x88, 0x33, 0xE0, 0x54, 0xFE, 0xF0, 0x22, -+0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x89, 0xF0, -+0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, -+0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x8B, 0xF0, -+0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, -+0x90, 0x88, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x22, -+0x12, 0x02, 0x06, 0xFF, 0x90, 0x98, 0x24, 0xF0, -+0xBF, 0x01, 0x0A, 0x7F, 0x01, 0x12, 0x91, 0x6B, -+0xE4, 0x90, 0x98, 0x24, 0xF0, 0x22, 0xE4, 0xFD, -+0x02, 0x97, 0x91, 0xE4, 0xFD, 0xFF, 0x12, 0x6E, -+0x71, 0xE4, 0xFF, 0x7D, 0x01, 0x02, 0x97, 0x91, -+0x90, 0x98, 0x1C, 0xE0, 0xFD, 0x30, 0xE0, 0x4D, -+0x90, 0x98, 0x21, 0xE0, 0xFC, 0x60, 0x46, 0x12, -+0xA9, 0x8F, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, 0xE0, -+0xFB, 0xEF, 0x5B, 0x60, 0x0B, 0xE4, 0x90, 0x98, -+0x21, 0xF0, 0x90, 0x98, 0x23, 0x04, 0xF0, 0x22, -+0x90, 0x98, 0x1E, 0xE0, 0xD3, 0x9C, 0x50, 0x15, -+0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, -+0x04, 0x11, 0x33, 0x80, 0x04, 0xD1, 0x46, 0x31, -+0x1D, 0x11, 0x96, 0xF0, 0x22, 0x90, 0x8A, 0xAF, -+0x12, 0x91, 0x62, 0xD1, 0x4F, 0x22, 0x90, 0x98, -+0x1C, 0xE0, 0x54, 0xFE, 0x22, 0x90, 0x98, 0x1C, -+0xE0, 0x30, 0xE0, 0x78, 0x90, 0x98, 0x20, 0xE0, -+0x04, 0xF0, 0x90, 0x98, 0x23, 0xE0, 0x64, 0x01, -+0x70, 0x31, 0x90, 0x98, 0x1C, 0xF1, 0xC1, 0x30, -+0xE0, 0x29, 0x90, 0x98, 0x22, 0xE0, 0x70, 0x23, -+0x90, 0x98, 0x1F, 0xE0, 0xFE, 0xA3, 0xE0, 0xC3, -+0x9E, 0x40, 0x18, 0xEF, 0x13, 0x13, 0x13, 0x54, -+0x1F, 0x30, 0xE0, 0x07, 0x11, 0x33, 0x11, 0x96, -+0xF0, 0x80, 0x08, 0xD1, 0x46, 0x31, 0x1D, 0x11, -+0x96, 0xF0, 0x22, 0x90, 0x98, 0x20, 0xE0, 0xFF, -+0x90, 0x98, 0x1D, 0xE0, 0xD3, 0x9F, 0x50, 0x2C, -+0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x16, 0x90, -+0x98, 0x22, 0xE0, 0x70, 0x10, 0x90, 0x8A, 0xAF, -+0x12, 0x91, 0x62, 0xD1, 0x4F, 0x90, 0x98, 0x1B, -+0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, -+0x74, 0x04, 0xF0, 0xE4, 0x90, 0x98, 0x20, 0xF0, -+0x90, 0x98, 0x22, 0xF0, 0x22, 0x90, 0x9C, 0xAB, -+0xEF, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x02, -+0x70, 0x22, 0x90, 0x9C, 0xAB, 0xE0, 0xFD, 0x64, -+0x01, 0x70, 0x67, 0x12, 0xC7, 0x79, 0x90, 0x93, -+0x28, 0x12, 0xBF, 0xE3, 0x30, 0xE0, 0x09, 0x90, -+0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, 0x52, -+0xAF, 0x05, 0x80, 0x4B, 0x12, 0xB2, 0x89, 0x70, -+0x32, 0x90, 0x99, 0x7B, 0xE0, 0xFF, 0x30, 0xE0, -+0x2A, 0x90, 0x00, 0xD4, 0xE0, 0x54, 0xEF, 0xF0, -+0x90, 0x00, 0xC6, 0xE0, 0x54, 0xFD, 0xF0, 0x90, -+0x00, 0x01, 0xE0, 0x44, 0x30, 0xF0, 0x90, 0x00, -+0x23, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x00, 0xCC, -+0xE0, 0x54, 0xFB, 0xF0, 0xEF, 0x54, 0xFE, 0x90, -+0x99, 0x7B, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, -+0xF0, 0xF1, 0x71, 0x90, 0x06, 0x90, 0xE0, 0x44, -+0x01, 0xF0, 0x90, 0x9C, 0xAB, 0xE0, 0xFF, 0x12, -+0xE7, 0xEF, 0x11, 0x96, 0xF0, 0x90, 0x93, 0x24, -+0xE0, 0x54, 0xBF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x9B, 0xE1, -+0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, -+0xF1, 0x6A, 0x90, 0x9B, 0xE9, 0xF0, 0xA3, 0xF0, -+0xA3, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0xA5, 0xF0, -+0x74, 0xC9, 0xA3, 0xF1, 0xC8, 0x12, 0xBA, 0x6E, -+0x90, 0x9B, 0xD7, 0xF1, 0x9A, 0x90, 0x9B, 0xE0, -+0xF0, 0x90, 0x93, 0x24, 0xE0, 0x20, 0xE0, 0x02, -+0x81, 0xD5, 0xE4, 0x90, 0x9B, 0xDF, 0xF0, 0x90, -+0x9B, 0xE0, 0xE0, 0xFF, 0x90, 0x9B, 0xDF, 0xE0, -+0xC3, 0x9F, 0x40, 0x02, 0x81, 0xD5, 0xB1, 0x0F, -+0xEC, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x9B, -+0xE9, 0xEF, 0xF0, 0x12, 0xEB, 0xD9, 0x54, 0x3F, -+0xFE, 0x90, 0x9B, 0xD9, 0xF0, 0xA3, 0xEF, 0xF0, -+0x90, 0x9B, 0xE5, 0xEE, 0x12, 0xEC, 0xCE, 0x30, -+0xE0, 0x0A, 0xC3, 0x13, 0x20, 0xE0, 0x05, 0x12, -+0xEC, 0x9C, 0x80, 0x02, 0x7E, 0x00, 0xEF, 0x24, -+0x18, 0x2E, 0xFF, 0x90, 0x9B, 0xEA, 0xF0, 0x90, -+0x9B, 0xD8, 0xE0, 0x2F, 0xFF, 0x90, 0x9B, 0xD7, -+0xE0, 0x34, 0x00, 0xFE, 0x90, 0x9B, 0xDB, 0xF0, -+0xA3, 0xEF, 0xF0, 0x12, 0xA3, 0x40, 0xC0, 0x07, -+0x90, 0x9B, 0xDB, 0x12, 0xAE, 0xFD, 0x7D, 0x01, -+0x12, 0x04, 0x7E, 0xC0, 0x07, 0x90, 0x9B, 0xDB, -+0x12, 0xAE, 0xFD, 0x7D, 0x04, 0x12, 0x04, 0x7E, -+0xAB, 0x07, 0xD0, 0x05, 0xD0, 0x07, 0xD1, 0xE7, -+0x90, 0x9B, 0xE1, 0xEF, 0x91, 0xF3, 0x12, 0xA3, -+0x40, 0xEF, 0x54, 0xFC, 0x90, 0x9B, 0xDD, 0xF0, -+0x90, 0x9B, 0xEA, 0xE0, 0xFF, 0x90, 0x9B, 0xD9, -+0xE4, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0xB1, 0x18, -+0xD1, 0x5D, 0x90, 0x9B, 0xD9, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x90, 0x9B, 0xD7, 0x12, 0xAE, 0xFD, -+0x7D, 0x0F, 0x12, 0x04, 0x7E, 0x90, 0x9B, 0xDE, -+0xEF, 0xF0, 0x90, 0x9B, 0x63, 0xE0, 0x60, 0x3F, -+0x90, 0x9B, 0xDD, 0xE0, 0x24, 0xB0, 0x60, 0x18, -+0x24, 0xD0, 0x60, 0x02, 0x81, 0x31, 0xB1, 0x07, -+0x20, 0xE0, 0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, -+0x1F, 0x20, 0xE0, 0x02, 0x81, 0x31, 0x80, 0x10, -+0xB1, 0x07, 0x20, 0xE0, 0x0B, 0xEF, 0x13, 0x13, -+0x13, 0x54, 0x1F, 0x20, 0xE0, 0x02, 0x81, 0x31, -+0x91, 0xF4, 0x90, 0x9B, 0xE5, 0xE0, 0xFC, 0xA3, -+0xE0, 0xFD, 0x12, 0xF9, 0xFD, 0x81, 0x31, 0x90, -+0x9B, 0xDD, 0xE0, 0x24, 0xF8, 0x60, 0x37, 0x24, -+0x80, 0x60, 0x33, 0x24, 0xC8, 0x60, 0x06, 0x24, -+0x20, 0x60, 0x02, 0x81, 0x31, 0x90, 0x93, 0x27, -+0x12, 0xBF, 0xE3, 0x20, 0xE0, 0x02, 0x81, 0x31, -+0x90, 0x93, 0x3A, 0xE0, 0x04, 0x91, 0xF3, 0xB1, -+0x21, 0xEF, 0x70, 0x02, 0x81, 0x31, 0x90, 0x9B, -+0xDD, 0xE0, 0xFF, 0x12, 0xF3, 0x4B, 0x90, 0x93, -+0x3B, 0xE0, 0x04, 0xF0, 0x81, 0x31, 0x90, 0x93, -+0x24, 0x12, 0xC4, 0x6D, 0x30, 0xE0, 0x5F, 0x90, -+0x9B, 0xE1, 0xE0, 0xFF, 0x90, 0x9B, 0xDC, 0xE0, -+0x2F, 0xFF, 0x90, 0x9B, 0xDB, 0xE0, 0x34, 0x00, -+0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, 0xFE, 0x90, -+0x9B, 0xE7, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xA3, -+0x40, 0xEF, 0x64, 0x45, 0x70, 0x38, 0x91, 0xFE, -+0x12, 0xFA, 0x7F, 0xEF, 0x64, 0x01, 0x70, 0x2E, -+0x91, 0xFE, 0x12, 0xFA, 0xBC, 0xEF, 0x64, 0x01, -+0x70, 0x24, 0x90, 0x9B, 0xEB, 0x04, 0x91, 0xFD, -+0xA3, 0xE0, 0xFD, 0x12, 0xFA, 0x24, 0xEF, 0x70, -+0x0D, 0x90, 0x9B, 0xE9, 0xE0, 0xFD, 0x90, 0xFD, -+0x11, 0x91, 0xFD, 0x12, 0xC7, 0x9B, 0x90, 0x9B, -+0xE9, 0xE0, 0x90, 0xFD, 0x11, 0xF0, 0x91, 0xF4, -+0xB1, 0x21, 0xEF, 0x60, 0x39, 0x91, 0xE5, 0x90, -+0x9B, 0xE4, 0xE0, 0xFB, 0x90, 0x9B, 0xE9, 0xE0, -+0x90, 0x9A, 0x0F, 0xF0, 0x12, 0xC5, 0x8C, 0xEF, -+0x60, 0x06, 0x90, 0x9B, 0xEB, 0x74, 0x01, 0xF0, -+0x90, 0x93, 0x25, 0xE0, 0xC4, 0x13, 0x54, 0x07, -+0x30, 0xE0, 0x13, 0x91, 0xE5, 0x90, 0x9B, 0xE4, -+0xE0, 0xFB, 0x12, 0xC5, 0x28, 0xEF, 0x60, 0x06, -+0x90, 0x9B, 0xEB, 0x74, 0x01, 0xF0, 0x90, 0x93, -+0x24, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0E, 0x91, -+0xE5, 0x12, 0xA5, 0xCA, 0xEF, 0x60, 0x06, 0x90, -+0x9B, 0xEB, 0x74, 0x01, 0xF0, 0x90, 0x93, 0x24, -+0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0E, -+0x91, 0xE5, 0x12, 0xDB, 0xE3, 0xEF, 0x60, 0x06, -+0x90, 0x9B, 0xEB, 0x74, 0x01, 0xF0, 0x90, 0x93, -+0x24, 0x12, 0xBF, 0xE3, 0x30, 0xE0, 0x16, 0x90, -+0x9B, 0xEB, 0xE0, 0x70, 0x10, 0x91, 0xE5, 0xB1, -+0x69, 0xEF, 0x60, 0x09, 0x12, 0xC7, 0x79, 0x90, -+0x01, 0xC7, 0x74, 0x22, 0xF0, 0x91, 0xE5, 0x12, -+0xAF, 0x0E, 0xEF, 0x60, 0x0C, 0x90, 0x93, 0x2D, -+0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xC7, 0xE4, -+0xF0, 0x90, 0x9B, 0xDE, 0xE0, 0xFF, 0x7D, 0x01, -+0x12, 0xF6, 0xA7, 0xEF, 0x60, 0x13, 0x12, 0xC7, -+0x79, 0x90, 0x9B, 0xD7, 0x12, 0xAE, 0xFD, 0x7D, -+0x10, 0x12, 0x04, 0x7E, 0x90, 0x95, 0x61, 0xEF, -+0xF0, 0xB1, 0x18, 0x90, 0x9B, 0xD7, 0x12, 0xEC, -+0x8D, 0xB1, 0x0F, 0xD3, 0x9F, 0xEC, 0x9E, 0x40, -+0x0F, 0x12, 0xEC, 0xAB, 0xED, 0x9F, 0xFF, 0xEC, -+0x9E, 0x90, 0x9B, 0xD7, 0xF0, 0xA3, 0xEF, 0xF0, -+0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, 0x04, 0x7F, -+0x01, 0x31, 0x1D, 0x12, 0xF3, 0x34, 0xEF, 0x64, -+0x01, 0x70, 0x36, 0x90, 0x93, 0x3C, 0xE0, 0x04, -+0xF0, 0xF1, 0x54, 0xAD, 0x07, 0xEF, 0x64, 0x01, -+0x60, 0x1F, 0x12, 0xC7, 0x79, 0xED, 0xB4, 0x02, -+0x08, 0x90, 0x01, 0xC7, 0x74, 0x42, 0xF0, 0x80, -+0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, 0xC7, -+0x74, 0x43, 0xF0, 0x7F, 0x01, 0x31, 0x1D, 0x80, -+0x24, 0x90, 0x9B, 0xD7, 0x12, 0xEC, 0xBB, 0x80, -+0x14, 0x90, 0x93, 0x26, 0xE0, 0xC4, 0x13, 0x54, -+0x07, 0x20, 0xE0, 0x11, 0x90, 0x93, 0x24, 0xE0, -+0x54, 0xFE, 0xF0, 0x80, 0x08, 0x90, 0x9B, 0xDF, -+0xE0, 0x04, 0xF0, 0x21, 0xE7, 0x74, 0xA5, 0x04, -+0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC9, 0xA3, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9B, 0xDB, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x9B, 0xE1, -+0xE0, 0xFD, 0x22, 0xF0, 0x90, 0x9B, 0xDB, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xF0, 0x90, 0x9B, -+0xE7, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, -+0x93, 0x04, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0x90, -+0x9B, 0xD7, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x22, -+0x90, 0x9B, 0xD9, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x22, 0x90, 0x9A, 0x12, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0xE4, 0x90, 0x9A, 0x1A, 0xF0, 0x90, 0x9A, -+0x1A, 0xE0, 0xFD, 0xC3, 0x94, 0x06, 0x50, 0x1C, -+0x90, 0x9A, 0x13, 0xE0, 0x24, 0x04, 0xF1, 0xA3, -+0x12, 0xC5, 0x19, 0x90, 0x9A, 0x1A, 0xF1, 0x88, -+0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x9A, 0x1A, 0xE0, -+0x04, 0xF0, 0x80, 0xDA, 0x78, 0x2E, 0x7C, 0x93, -+0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x14, -+0xF1, 0xAC, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, -+0x22, 0x90, 0x9A, 0x0D, 0xED, 0x12, 0xC7, 0x91, -+0xB1, 0x21, 0xEF, 0x60, 0x09, 0x12, 0xC5, 0x83, -+0xF1, 0x80, 0x60, 0x02, 0x7F, 0x01, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x02, -+0x09, 0xE0, 0xFD, 0x12, 0xBF, 0xEB, 0x90, 0x93, -+0x04, 0xF1, 0xDD, 0x12, 0x8F, 0x0E, 0x54, 0x04, -+0xFC, 0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0x93, -+0x04, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, -+0xF7, 0x4E, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0x54, -+0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0x90, 0x93, -+0x04, 0x12, 0x8E, 0xFE, 0xFF, 0xED, 0x2F, 0x90, -+0x93, 0x05, 0x12, 0x8F, 0xED, 0xFF, 0xED, 0x2F, -+0x90, 0x93, 0x06, 0xF0, 0x12, 0x8F, 0xF4, 0xFF, -+0xAE, 0x05, 0xED, 0x2F, 0x90, 0x93, 0x07, 0xF0, -+0x90, 0x93, 0x04, 0xE0, 0xFF, 0x20, 0xE0, 0x08, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0A, -+0x90, 0x06, 0x31, 0xE0, 0x44, 0x40, 0xF0, 0x12, -+0xE7, 0x73, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x30, -+0xE0, 0x38, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x01, -+0xF0, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF1, -+0x91, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, -+0x08, 0xF1, 0x78, 0x90, 0x9A, 0xFF, 0x74, 0x01, -+0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x74, -+0xB1, 0x07, 0x20, 0xE0, 0x0D, 0x90, 0x9C, 0x55, -+0x12, 0x04, 0x3D, 0x00, 0x00, 0x27, 0x10, 0x12, -+0xB3, 0xA7, 0xB1, 0x07, 0x30, 0xE0, 0x0A, 0x90, -+0x06, 0x32, 0xE0, 0x44, 0x02, 0xF0, 0x12, 0xB6, -+0xE4, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, -+0xC7, 0x74, 0x10, 0xF0, 0x7F, 0x01, 0x22, 0x7D, -+0x08, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x98, -+0x21, 0xE0, 0x04, 0xF0, 0x22, 0x7D, 0x07, 0xEF, -+0x5D, 0xC3, 0x60, 0x0B, 0xD1, 0x74, 0x5F, 0x24, -+0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x04, 0xD1, -+0x74, 0x5F, 0xFF, 0x22, 0x74, 0xFF, 0x9D, 0xFD, -+0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x22, -+0x90, 0x88, 0x31, 0x12, 0xC7, 0xE0, 0x30, 0xE0, -+0x34, 0xEF, 0x54, 0xBF, 0xF1, 0xB5, 0x30, 0xE0, -+0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, -+0x54, 0xFE, 0xF1, 0xD2, 0x74, 0x04, 0xF0, 0x90, -+0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, -+0x30, 0xE0, 0x0F, 0x90, 0x8A, 0xB9, 0x12, 0x91, -+0x62, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, 0x7E, -+0x80, 0x03, 0x12, 0xAE, 0xEB, 0xE4, 0xFF, 0x01, -+0x40, 0xA3, 0xE0, 0xFE, 0x24, 0x28, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, -+0x29, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0xFD, 0x74, 0x2C, 0x2E, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, -+0xFE, 0xEF, 0x30, 0xE7, 0x04, 0x7C, 0x02, 0x80, -+0x02, 0xE4, 0xFC, 0xED, 0x30, 0xE6, 0x09, 0xAF, -+0x03, 0x12, 0xF3, 0x5D, 0xAE, 0x07, 0x80, 0x02, -+0xE4, 0xFE, 0xEC, 0x24, 0x18, 0x2E, 0xFF, 0x22, -+0xF1, 0x54, 0xAD, 0x07, 0x90, 0x01, 0xC4, 0x74, -+0x08, 0xF0, 0x74, 0xCF, 0xA3, 0xF0, 0xED, 0x64, -+0x01, 0x60, 0x1D, 0x12, 0xC7, 0x79, 0xED, 0xB4, -+0x02, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x40, 0xF0, -+0x80, 0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, -+0xC7, 0x74, 0x41, 0xF0, 0x7F, 0x01, 0x21, 0x1D, -+0x12, 0xEB, 0xF8, 0x90, 0x02, 0x87, 0xE0, 0x70, -+0xF7, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, -+0x74, 0x08, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -+0xCF, 0xA3, 0xF0, 0x22, 0x90, 0x02, 0x86, 0xE0, -+0x20, 0xE2, 0x03, 0x7F, 0x04, 0x22, 0x90, 0x02, -+0x86, 0xE0, 0x7F, 0x01, 0x20, 0xE1, 0x02, 0x7F, -+0x02, 0x22, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, -+0x22, 0x7F, 0x64, 0x7E, 0x00, 0x02, 0x7C, 0x6A, -+0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0x22, -+0xA3, 0xE0, 0xFD, 0x12, 0xA7, 0x2D, 0xEF, 0x22, -+0xE0, 0x24, 0x14, 0xF5, 0x82, 0xE4, 0x34, 0x9A, -+0x22, 0xF0, 0x90, 0x06, 0x08, 0xE0, 0x54, 0x7F, -+0xF0, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, -+0x87, 0xE0, 0x22, 0xFF, 0x90, 0x9A, 0x12, 0xE0, -+0x34, 0x00, 0xFE, 0x22, 0x7E, 0x00, 0x7F, 0x06, -+0x12, 0x86, 0x1C, 0xEF, 0x22, 0xF0, 0x90, 0x04, -+0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, 0x90, 0x88, -+0x32, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, -+0xF0, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, -+0x1E, 0x22, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, -+0xF0, 0x90, 0x01, 0xB8, 0x22, 0xE0, 0x54, 0xFE, -+0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, -+0x54, 0xFD, 0x4F, 0x22, 0xEF, 0xB4, 0xFF, 0x06, -+0x90, 0x98, 0x36, 0xED, 0xF0, 0x22, 0xEF, 0xF4, -+0xFE, 0x90, 0x98, 0x36, 0xE0, 0x5E, 0xFE, 0xED, -+0x5F, 0x4E, 0xF0, 0x22, 0xEF, 0xB4, 0xFF, 0x06, -+0x90, 0x98, 0x37, 0xED, 0xF0, 0x22, 0xEF, 0xF4, -+0xFE, 0x90, 0x98, 0x37, 0x80, 0xE6, 0x90, 0x9C, -+0xA8, 0xED, 0xF0, 0x64, 0x01, 0x60, 0x26, 0xE0, -+0xFE, 0x64, 0x02, 0x60, 0x20, 0xEE, 0x64, 0x29, -+0x60, 0x1B, 0xEE, 0x64, 0x2A, 0x60, 0x16, 0xEE, -+0x64, 0x36, 0x60, 0x11, 0xEE, 0xB4, 0x37, 0x02, -+0x80, 0x0B, 0xAD, 0x07, 0x7F, 0xFF, 0x11, 0x04, -+0x90, 0x98, 0x37, 0xE0, 0xFF, 0x90, 0x98, 0x36, -+0xE0, 0x4F, 0x90, 0x05, 0x22, 0xF0, 0x90, 0x9C, -+0xA8, 0xE0, 0x90, 0x93, 0x01, 0xF0, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x8F, -+0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, 0x29, 0x90, -+0x00, 0x8C, 0xE0, 0x90, 0x9C, 0x93, 0xF0, 0x7F, -+0x8D, 0x12, 0x7B, 0x41, 0x90, 0x9C, 0x94, 0xEF, -+0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0x9C, 0x95, -+0xF0, 0x90, 0x9C, 0x94, 0xE0, 0x7F, 0x8F, 0x12, -+0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, 0x11, 0x95, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFD, 0x7F, -+0x8D, 0x02, 0x7B, 0x2E, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x9B, 0xEF, 0xF0, -+0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, -+0x4A, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, -+0x01, 0x70, 0x40, 0x90, 0x9C, 0x9C, 0xF0, 0x90, -+0x9C, 0x9C, 0xE0, 0xFD, 0x90, 0x9C, 0x9B, 0xE0, -+0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, -+0x34, 0x81, 0xF5, 0x83, 0xE5, 0x82, 0x2D, 0xF5, -+0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, -+0xE4, 0xFF, 0x31, 0x00, 0x90, 0x9C, 0x9C, 0xE0, -+0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCF, -+0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, -+0x02, 0x11, 0x95, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, -+0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, -+0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, -+0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, -+0xE4, 0x90, 0x99, 0xE0, 0xF0, 0xA3, 0xF0, 0xA3, -+0xF0, 0x90, 0x99, 0xE0, 0xE0, 0x64, 0x01, 0xF0, -+0x90, 0x98, 0x2E, 0xE0, 0x70, 0x18, 0x90, 0x98, -+0x2B, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, -+0x90, 0x99, 0xE0, 0xE0, 0x24, 0x28, 0x90, 0x01, -+0xC4, 0xF0, 0x74, 0xD1, 0xA3, 0xF0, 0x12, 0x7C, -+0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, -+0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, -+0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, 0x6F, 0x60, -+0x03, 0x12, 0xAE, 0xEB, 0xC2, 0xAF, 0x51, 0xE5, -+0xBF, 0x01, 0x16, 0x90, 0x86, 0xB3, 0xE0, 0xFF, -+0xB4, 0x03, 0x07, 0x90, 0x99, 0x7B, 0xE0, 0x20, -+0xE0, 0x05, 0xEF, 0x64, 0x03, 0x60, 0x02, 0x31, -+0x9C, 0xD2, 0xAF, 0x51, 0x26, 0x11, 0x57, 0x12, -+0x86, 0x8D, 0x80, 0x95, 0x90, 0x88, 0x31, 0xE0, -+0x30, 0xE0, 0x02, 0x31, 0xA6, 0x22, 0x90, 0x88, -+0x39, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0E, -+0x31, 0xBF, 0xBF, 0x01, 0x09, 0x12, 0xAF, 0xC1, -+0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, -+0x93, 0x08, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x36, -+0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, -+0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, -+0x75, 0x10, 0x01, 0x80, 0x3A, 0x90, 0x93, 0x2D, -+0xE0, 0x30, 0xE0, 0x05, 0x75, 0x10, 0x08, 0x80, -+0x2E, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, -+0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, -+0x05, 0x75, 0x10, 0x04, 0x80, 0x19, 0x90, 0x88, -+0xE6, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x10, 0x20, -+0x80, 0x0D, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x05, -+0x75, 0x10, 0x40, 0x80, 0x02, 0x41, 0xDD, 0x90, -+0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, -+0xE5, 0x10, 0xF0, 0x7F, 0x00, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x98, 0x2B, -+0xE0, 0x60, 0x25, 0x7F, 0x54, 0x7E, 0x09, 0x12, -+0x70, 0x70, 0x51, 0xD3, 0x12, 0x04, 0xB8, 0xEF, -+0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, -+0x44, 0x04, 0xFD, 0xEC, 0x51, 0xD3, 0x12, 0xAE, -+0xD6, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, -+0x90, 0x98, 0x26, 0xE0, 0x70, 0x29, 0x90, 0x07, -+0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, -+0x99, 0xE7, 0x74, 0x22, 0xF0, 0x90, 0x9A, 0x09, -+0x74, 0x01, 0xF0, 0x90, 0x99, 0xE9, 0x74, 0x03, -+0xF0, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0xE7, 0x12, -+0x91, 0x50, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, -+0x98, 0x2E, 0xE0, 0xFF, 0x70, 0x0A, 0x90, 0x98, -+0x2B, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, -+0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, 0xF0, 0x90, -+0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, -+0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, 0x60, 0x06, -+0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, 0x90, 0x98, -+0x2B, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, -+0x01, 0xF0, 0x90, 0x98, 0x2C, 0xE0, 0x60, 0x06, -+0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0x99, 0xE3, 0x12, 0x04, -+0x31, 0x90, 0x99, 0xE3, 0x22, 0x90, 0x01, 0xB8, -+0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x7D, 0x02, 0x90, -+0x01, 0xC4, 0x74, 0xE5, 0xF0, 0x74, 0xD2, 0xA3, -+0xF0, 0x90, 0x98, 0x17, 0xE0, 0xFF, 0xED, 0xC3, -+0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, 0x81, -+0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, -+0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, -+0x0D, 0x80, 0xDE, 0x74, 0xE5, 0x04, 0x90, 0x01, -+0xC4, 0xF0, 0x74, 0xD2, 0xA3, 0xF0, 0x7F, 0x01, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x10, 0x90, -+0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, -+0xE0, 0x12, 0x75, 0x16, 0x10, 0x80, 0x2D, 0x12, -+0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, -+0x16, 0x01, 0x80, 0x20, 0x90, 0x88, 0x31, 0x12, -+0xC6, 0x14, 0x30, 0xE0, 0x05, 0x75, 0x16, 0x02, -+0x80, 0x12, 0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, -+0x04, 0x40, 0x05, 0x75, 0x16, 0x08, 0x80, 0x04, -+0x51, 0xDD, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, -+0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x16, 0xF0, -+0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, -+0x9D, 0xE0, 0x30, 0xE0, 0x1E, 0x90, 0x88, 0xAF, -+0xE0, 0x60, 0x05, 0x75, 0x17, 0x40, 0x81, 0x28, -+0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x00, 0x40, -+0x02, 0x80, 0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, -+0x7B, 0x80, 0x55, 0x12, 0x7A, 0x65, 0xEF, 0x64, -+0x01, 0x60, 0x05, 0x75, 0x17, 0x01, 0x80, 0x70, -+0x90, 0x88, 0x3A, 0xE0, 0xFF, 0x54, 0x03, 0x60, -+0x05, 0x75, 0x17, 0x02, 0x80, 0x62, 0x90, 0x88, -+0x38, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, -+0x75, 0x17, 0x04, 0x80, 0x53, 0xEF, 0x30, 0xE2, -+0x05, 0x75, 0x17, 0x08, 0x80, 0x4A, 0x90, 0x88, -+0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x17, 0x10, -+0x80, 0x3E, 0x90, 0x88, 0x32, 0xE0, 0x13, 0x13, -+0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x17, 0x20, -+0x80, 0x2E, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x05, -+0x75, 0x17, 0x80, 0x80, 0x23, 0x90, 0x06, 0x62, -+0xE0, 0x30, 0xE1, 0x05, 0x75, 0x17, 0x11, 0x80, -+0x17, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, -+0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, -+0x17, 0x12, 0x80, 0x04, 0x51, 0xDD, 0x80, 0x0E, -+0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, -+0xB8, 0xE5, 0x17, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xE4, 0x90, 0x86, 0xAF, 0x12, -+0xB0, 0x2B, 0x90, 0x93, 0x01, 0xF0, 0x90, 0x98, -+0x36, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x00, 0x80, -+0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x7B, -+0x2E, 0x12, 0xD8, 0x3E, 0xF1, 0x8B, 0x12, 0x7B, -+0x79, 0x12, 0xD9, 0xEB, 0x91, 0x3B, 0x7F, 0x01, -+0x12, 0x87, 0x55, 0x90, 0x98, 0x17, 0x74, 0x02, -+0xF0, 0xFF, 0x12, 0x87, 0x55, 0x90, 0x98, 0x17, -+0xE0, 0x04, 0xF0, 0x91, 0xCA, 0xB1, 0x32, 0x90, -+0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, -+0x12, 0x7B, 0x2E, 0x75, 0x20, 0xFF, 0x12, 0x7C, -+0x97, 0x90, 0x01, 0xA0, 0xE0, 0xB4, 0xFD, 0x05, -+0xE4, 0xFF, 0x12, 0x91, 0x6B, 0xB1, 0x7B, 0xF1, -+0xAB, 0x90, 0x00, 0x81, 0xE0, 0x44, 0x04, 0xFD, -+0x7F, 0x81, 0x12, 0x7B, 0x2E, 0xF1, 0x74, 0x12, -+0x90, 0xC6, 0x90, 0x00, 0xAA, 0xE0, 0x44, 0x02, -+0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x99, -+0x7B, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x02, -+0x87, 0xDE, 0x12, 0x7B, 0x1B, 0x90, 0x86, 0xB3, -+0xEF, 0xF0, 0x91, 0xE4, 0x90, 0x01, 0x64, 0x74, -+0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, -+0xF0, 0x02, 0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, -+0x75, 0xE0, 0xF1, 0xDD, 0x12, 0xD8, 0x16, 0x75, -+0x21, 0x80, 0x90, 0x86, 0xB3, 0xE0, 0xFF, 0xB4, -+0x03, 0x05, 0x75, 0x22, 0x08, 0x80, 0x03, 0xE4, -+0xF5, 0x22, 0xEF, 0xB4, 0x01, 0x0A, 0x90, 0x00, -+0x75, 0xE0, 0x54, 0xFB, 0xF0, 0x75, 0x22, 0x04, -+0xE4, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, 0x21, -+0x7F, 0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, 0x7F, -+0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, 0x52, -+0x12, 0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, 0x02, -+0x7B, 0x2E, 0xB1, 0xC7, 0x12, 0x7B, 0xDB, 0x12, -+0x93, 0xC6, 0x12, 0xA7, 0xB2, 0x12, 0xB1, 0x30, -+0xF1, 0x98, 0xB1, 0x67, 0x90, 0x8A, 0x73, 0x12, -+0x8C, 0x14, 0x90, 0x98, 0x30, 0xE0, 0x54, 0x7F, -+0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, -+0xF0, 0xF0, 0xE4, 0x90, 0x98, 0x32, 0xF0, 0x90, -+0x98, 0x30, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xF1, -+0x6B, 0x7A, 0x98, 0x79, 0x1C, 0x12, 0x04, 0x80, -+0x90, 0x98, 0x1D, 0x74, 0x08, 0xF0, 0xA3, 0x74, -+0x03, 0xF0, 0x22, 0xF1, 0x63, 0xF1, 0x7F, 0xEF, -+0x64, 0x01, 0x60, 0x3C, 0xC3, 0x90, 0x99, 0x89, -+0xE0, 0x94, 0x88, 0x90, 0x99, 0x88, 0xE0, 0x94, -+0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, -+0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, -+0x80, 0x1E, 0x90, 0x99, 0x88, 0xB1, 0xCD, 0x12, -+0xAC, 0x6A, 0xD3, 0x90, 0x99, 0x89, 0xE0, 0x94, -+0x32, 0x90, 0x99, 0x88, 0xE0, 0x94, 0x00, 0x40, -+0xC4, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xBD, -+0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0xE4, -+0xFD, 0xFF, 0x02, 0x6E, 0x71, 0xE4, 0x75, 0xF0, -+0x01, 0x02, 0x02, 0xE7, 0xAD, 0x07, 0x90, 0x95, -+0x6D, 0xB1, 0xCD, 0x90, 0x95, 0x6D, 0xE0, 0xFF, -+0xAE, 0x05, 0x74, 0x04, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x95, -+0x6D, 0xA3, 0xE0, 0xFF, 0x74, 0x05, 0x2E, 0xF1, -+0x5B, 0xEF, 0xF0, 0x22, 0xE4, 0x90, 0x9A, 0xD7, -+0xF0, 0xA3, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, -+0x20, 0xF0, 0x12, 0x76, 0x9B, 0xEF, 0x64, 0x01, -+0x70, 0x76, 0x90, 0x98, 0x12, 0xE0, 0xFF, 0x90, -+0x92, 0x13, 0x74, 0x0D, 0xF0, 0x7B, 0x08, 0x7D, -+0x01, 0x12, 0x66, 0xDB, 0x90, 0x9A, 0xD4, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x9A, 0xD4, 0x12, -+0xCE, 0xC1, 0x90, 0x9A, 0xD6, 0xEF, 0xF0, 0x90, -+0x9A, 0xD4, 0x12, 0x9F, 0xF9, 0x7B, 0x01, 0xE4, -+0xFD, 0x12, 0xF3, 0x9C, 0x90, 0x9A, 0xD6, 0xE0, -+0xFF, 0x90, 0x9A, 0xD5, 0xE0, 0x2F, 0xFF, 0x90, -+0x9A, 0xD4, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, -+0xCF, 0x34, 0x00, 0xFE, 0x90, 0x9A, 0xD7, 0xF0, -+0xA3, 0xEF, 0xF0, 0xB1, 0xD4, 0xD1, 0x89, 0x90, -+0x98, 0x12, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0xB4, -+0xD7, 0xD1, 0x89, 0x90, 0x98, 0x0E, 0xE0, 0xFB, -+0x7F, 0x11, 0x12, 0xB4, 0xD7, 0x90, 0x04, 0x1F, -+0x74, 0x20, 0xF0, 0x90, 0x95, 0x75, 0xB1, 0xCD, -+0x22, 0x90, 0x9A, 0xD7, 0xE0, 0xFC, 0xA3, 0xE0, -+0xFD, 0x22, 0xE4, 0x90, 0x9C, 0xA5, 0xF0, 0xA3, -+0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x22, -+0xC3, 0x90, 0x9C, 0xA6, 0xE0, 0x94, 0xD0, 0x90, -+0x9C, 0xA5, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, -+0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, -+0x22, 0x90, 0x9C, 0xA5, 0xB1, 0xCD, 0xF1, 0x54, -+0x80, 0xD7, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x9C, -+0x90, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, -+0x90, 0x9C, 0x92, 0xF0, 0x7B, 0x47, 0x7D, 0xFF, -+0xE4, 0xFF, 0x12, 0x98, 0x60, 0x90, 0x05, 0xF8, -+0xE0, 0x70, 0x1B, 0xA3, 0xE0, 0x70, 0x17, 0xA3, -+0xE0, 0x70, 0x13, 0xA3, 0xE0, 0x70, 0x0F, 0x90, -+0x9C, 0x92, 0xE0, 0xFD, 0x7B, 0x48, 0xE4, 0xFF, -+0x12, 0x98, 0x60, 0x7F, 0x01, 0x22, 0x12, 0xC4, -+0x6A, 0x30, 0xE0, 0x1A, 0xD3, 0x90, 0x9C, 0x91, -+0xE0, 0x94, 0x03, 0x90, 0x9C, 0x90, 0xE0, 0x94, -+0x00, 0x40, 0x07, 0xF1, 0x48, 0xFD, 0x7B, 0x5A, -+0x80, 0x18, 0x7F, 0x01, 0x80, 0x1E, 0xD3, 0x90, -+0x9C, 0x91, 0xE0, 0x94, 0xE8, 0x90, 0x9C, 0x90, -+0xE0, 0x94, 0x03, 0x40, 0x0D, 0xF1, 0x48, 0xFD, -+0x7B, 0x5B, 0xE4, 0xFF, 0x12, 0x98, 0x60, 0x7F, -+0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x7C, -+0x6A, 0x90, 0x9C, 0x90, 0xB1, 0xCD, 0x80, 0x95, -+0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x90, -+0x9C, 0x92, 0xE0, 0x22, 0x7F, 0x0A, 0x7E, 0x00, -+0x02, 0x7C, 0x6A, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0x22, 0xE4, 0x90, 0x99, 0x88, 0xF0, -+0xA3, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x08, 0x7D, -+0x00, 0x7B, 0x01, 0x22, 0x90, 0x01, 0xE4, 0x74, -+0x1D, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x22, 0x90, -+0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, -+0x7F, 0x01, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, -+0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, -+0x90, 0x98, 0x18, 0xE0, 0x54, 0xFE, 0xF0, 0x54, -+0x7F, 0xF0, 0x54, 0xFB, 0xF0, 0xA3, 0x74, 0x0A, -+0x02, 0xCF, 0x6A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0xE4, 0xFF, 0xEF, 0x12, 0xB4, 0xBE, -+0xE4, 0xF0, 0x0F, 0xEF, 0xB4, 0x08, 0xF5, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0x9A, 0xE0, -+0x54, 0xC0, 0x44, 0x0B, 0xF0, 0xF1, 0x54, 0x90, -+0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, -+0x40, 0x02, 0x7F, 0x01, 0x22, 0x75, 0x29, 0x10, -+0xE4, 0xF5, 0x2A, 0x75, 0x2B, 0x07, 0x75, 0x2C, -+0x02, 0xF5, 0x31, 0xF5, 0x32, 0xF5, 0x33, 0xF5, -+0x34, 0x90, 0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, -+0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, -+0xE5, 0x2C, 0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, -+0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, -+0xF0, 0xA3, 0xE5, 0x34, 0xF0, 0x22, 0x75, 0x39, -+0x07, 0x43, 0x39, 0x10, 0x75, 0x3A, 0x01, 0x75, -+0x3B, 0x03, 0x75, 0x3C, 0x62, 0x43, 0x3C, 0x80, -+0x43, 0x3B, 0x04, 0x90, 0x01, 0x38, 0xE5, 0x39, -+0xF0, 0xA3, 0xE5, 0x3A, 0xF0, 0xA3, 0xE5, 0x3B, -+0xF0, 0xA3, 0xE5, 0x3C, 0xF0, 0x22, 0x90, 0x8A, -+0x79, 0x74, 0x89, 0xF0, 0xA3, 0x74, 0x86, 0xF0, -+0x90, 0x8A, 0xE5, 0x74, 0xD9, 0xF0, 0xA3, 0x74, -+0x1B, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0x89, 0xF0, -+0xA3, 0x74, 0xD9, 0xF0, 0x90, 0x8A, 0xB9, 0x74, -+0x8C, 0xF0, 0xA3, 0x74, 0x1E, 0xF0, 0x90, 0x8A, -+0xC3, 0x74, 0xED, 0xF0, 0xA3, 0x74, 0x92, 0xF0, -+0x90, 0x8A, 0xF3, 0x74, 0xEE, 0xF0, 0xA3, 0x74, -+0xB6, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0xDE, 0xF0, -+0xA3, 0x74, 0x52, 0xF0, 0x90, 0x86, 0x04, 0x74, -+0xEF, 0xF0, 0xA3, 0x74, 0x9F, 0xF0, 0x90, 0x8A, -+0xA9, 0x74, 0xEE, 0xF0, 0xA3, 0x74, 0xC2, 0xF0, -+0x90, 0x8B, 0x07, 0x74, 0xEE, 0xF0, 0xA3, 0x74, -+0xF4, 0xF0, 0x90, 0x8A, 0xAD, 0x74, 0xB2, 0xF0, -+0xA3, 0x74, 0x16, 0xF0, 0x90, 0x86, 0x0C, 0x74, -+0xAC, 0xF0, 0xA3, 0x74, 0xCF, 0xF0, 0x90, 0x8A, -+0xEF, 0x74, 0xAC, 0xF0, 0xA3, 0x74, 0x71, 0xF0, -+0x90, 0x86, 0x00, 0x74, 0xD3, 0xF0, 0xA3, 0x74, -+0x21, 0xF0, 0x90, 0x86, 0x02, 0x74, 0xD3, 0xF0, -+0xA3, 0x74, 0x7F, 0xF0, 0x90, 0x8A, 0xFD, 0x74, -+0xD6, 0xF0, 0xA3, 0x74, 0xC5, 0xF0, 0x90, 0x8A, -+0xF9, 0x74, 0xD0, 0xF0, 0xA3, 0x74, 0x16, 0xF0, -+0x90, 0x8A, 0xAF, 0x74, 0xC4, 0xF0, 0xA3, 0x74, -+0x74, 0xF0, 0x90, 0x8A, 0xD3, 0x74, 0xED, 0xF0, -+0xA3, 0x74, 0xD2, 0xF0, 0x90, 0x8A, 0xF5, 0x74, -+0xFB, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x90, 0x8A, -+0xA3, 0x74, 0xE3, 0xF0, 0xA3, 0x74, 0x81, 0xF0, -+0x90, 0x86, 0x06, 0x74, 0xE5, 0xF0, 0xA3, 0x74, -+0x7B, 0xF0, 0x22, 0x8F, 0x14, 0x7F, 0x02, 0x12, -+0x88, 0x67, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x14, -+0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, -+0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -+0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x01, 0xC4, 0x74, 0x2A, 0xF0, 0x74, 0xD9, 0xA3, -+0xF0, 0x12, 0x6C, 0xD6, 0xE5, 0x25, 0x30, 0xE7, -+0x02, 0x31, 0xD0, 0x90, 0x86, 0xB3, 0xE0, 0xFC, -+0x64, 0x03, 0x70, 0x37, 0x90, 0x99, 0x7B, 0xE0, -+0xFE, 0x20, 0xE0, 0x2F, 0xE5, 0x26, 0x30, 0xE3, -+0x2A, 0x90, 0x00, 0xCC, 0xE0, 0x44, 0x04, 0xF0, -+0x90, 0x00, 0xD4, 0xE0, 0x44, 0x10, 0xF0, 0x90, -+0x00, 0xC6, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x00, -+0x01, 0xE0, 0x54, 0xCF, 0xF0, 0x90, 0x00, 0x23, -+0xE0, 0x54, 0x7F, 0xF0, 0xEE, 0x44, 0x01, 0x90, -+0x99, 0x7B, 0xF0, 0xEC, 0xB4, 0x01, 0x0B, 0xE5, -+0x26, 0x30, 0xE2, 0x06, 0x90, 0x88, 0x41, 0x74, -+0xDD, 0xF0, 0x74, 0x2A, 0x04, 0x90, 0x01, 0xC4, -+0xF0, 0x74, 0xD9, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, -+0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, -+0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, -+0x90, 0x00, 0xAB, 0xE0, 0xFE, 0x90, 0x00, 0xAA, -+0x12, 0xBA, 0x6E, 0x54, 0x7F, 0x90, 0x9A, 0xD2, -+0xF0, 0xA3, 0xEF, 0xF0, 0xE0, 0x30, 0xE1, 0x02, -+0x31, 0xEB, 0x22, 0x90, 0x01, 0x8C, 0xE4, 0xF0, -+0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, 0xA3, 0x74, -+0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, 0x54, 0xF0, -+0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, 0xE0, 0x44, -+0x04, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, -+0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, -+0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0x01, 0xC4, 0x74, 0x0B, 0xF0, 0x74, 0xDA, -+0xA3, 0xF0, 0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, -+0xE1, 0x02, 0x71, 0x4E, 0xE5, 0x2D, 0x30, 0xE3, -+0x02, 0xF1, 0xA6, 0xE5, 0x2D, 0x30, 0xE4, 0x02, -+0xF1, 0x83, 0xE5, 0x2D, 0x30, 0xE5, 0x03, 0x12, -+0xE8, 0x19, 0xE5, 0x2F, 0x30, 0xE0, 0x02, 0x51, -+0xAA, 0xE5, 0x2F, 0x30, 0xE1, 0x03, 0x12, 0xC3, -+0x19, 0xE5, 0x2F, 0x30, 0xE2, 0x02, 0xF1, 0x94, -+0xE5, 0x2F, 0x30, 0xE3, 0x02, 0x51, 0xBB, 0xE5, -+0x2F, 0x30, 0xE4, 0x02, 0x71, 0x18, 0xE5, 0x2F, -+0x30, 0xE5, 0x02, 0x51, 0xD3, 0xE5, 0x2F, 0x30, -+0xE6, 0x02, 0xF1, 0xB9, 0x74, 0x0B, 0x04, 0x90, -+0x01, 0xC4, 0xF0, 0x74, 0xDA, 0xA3, 0xF0, 0xD0, -+0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, -+0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, -+0xE0, 0x32, 0x12, 0xC6, 0x1B, 0xE4, 0xFF, 0x12, -+0xE3, 0xD8, 0x90, 0x8B, 0x07, 0x51, 0xF8, 0xF9, -+0x02, 0x04, 0x7A, 0x12, 0xC7, 0x81, 0x70, 0x12, -+0x90, 0x88, 0x36, 0xE0, 0x60, 0x0C, 0x90, 0x88, -+0x3A, 0xE0, 0x20, 0xE4, 0x05, 0x71, 0x3B, 0x12, -+0xC6, 0xAD, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, -+0xBF, 0x01, 0x19, 0x90, 0x88, 0x36, 0xE0, 0x60, -+0x13, 0x12, 0x97, 0xE6, 0x64, 0x02, 0x60, 0x09, -+0x90, 0x8A, 0xE1, 0x51, 0xF8, 0xF9, 0x02, 0x04, -+0x7A, 0x12, 0x73, 0x8F, 0x22, 0x90, 0x8B, 0x01, -+0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0x22, 0x90, -+0x88, 0x36, 0xE0, 0x60, 0x12, 0x90, 0x06, 0x92, -+0xE0, 0x30, 0xE1, 0x06, 0x51, 0xF5, 0xF9, 0x02, -+0x04, 0x7A, 0x71, 0x46, 0x12, 0xAE, 0xEB, 0x22, -+0x12, 0xC7, 0x81, 0x70, 0x1D, 0x90, 0x88, 0x36, -+0xE0, 0x60, 0x17, 0x90, 0x88, 0x3A, 0xE0, 0x20, -+0xE4, 0x10, 0x71, 0x3B, 0xF0, 0x90, 0x88, 0x31, -+0xE0, 0x71, 0x58, 0x54, 0x07, 0x70, 0x03, 0x12, -+0xAE, 0xEB, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, -+0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0x90, 0x88, -+0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x90, 0x88, -+0x36, 0xE0, 0x60, 0x03, 0x12, 0x97, 0x4D, 0x22, -+0x54, 0xFB, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, -+0xFD, 0xF0, 0x22, 0x71, 0xD8, 0x30, 0xE0, 0x0B, -+0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, -+0x02, 0xF1, 0x4B, 0x90, 0x88, 0x31, 0x12, 0xCF, -+0xC1, 0x30, 0xE0, 0x09, 0xEF, 0x71, 0x58, 0x54, -+0x07, 0x70, 0x4C, 0x80, 0x47, 0x90, 0x88, 0x3F, -+0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, -+0xEF, 0xF0, 0xF1, 0x77, 0x40, 0x36, 0x12, 0xC7, -+0x81, 0x70, 0x34, 0x12, 0x97, 0xE6, 0x70, 0x08, -+0x90, 0x8A, 0xF5, 0x12, 0x8C, 0x14, 0x80, 0x28, -+0x90, 0x8A, 0xF5, 0x12, 0x8C, 0x14, 0x90, 0x88, -+0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, -+0x40, 0x09, 0x71, 0xD0, 0xE4, 0x90, 0x88, 0x40, -+0xF0, 0x80, 0x03, 0x12, 0x73, 0x8F, 0xE4, 0x90, -+0x88, 0x3F, 0xF0, 0x22, 0x12, 0xAE, 0xEB, 0x22, -+0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x22, -+0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, 0x13, -+0x54, 0x1F, 0x22, 0x12, 0xC7, 0x92, 0xA3, 0xED, -+0xF0, 0x78, 0x0E, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, -+0xFF, 0x7A, 0x80, 0x79, 0x94, 0xF1, 0x44, 0xF1, -+0x5B, 0x7A, 0x80, 0x79, 0x9A, 0xB1, 0xC6, 0x78, -+0x24, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, -+0x80, 0x79, 0xAA, 0xB1, 0xC6, 0xE4, 0x90, 0x9A, -+0x37, 0x12, 0xC5, 0x82, 0xA3, 0xE0, 0xFD, 0x12, -+0xF6, 0x34, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xA1, -+0xAE, 0x12, 0xA7, 0xE5, 0xFF, 0x12, 0xA7, 0x18, -+0xCF, 0x24, 0x0E, 0xCF, 0x34, 0x00, 0x12, 0xA3, -+0x3F, 0xEF, 0x64, 0x3A, 0x60, 0x02, 0xA1, 0xAE, -+0x12, 0xA7, 0xE5, 0xFF, 0x12, 0xA7, 0x18, 0xCF, -+0x24, 0x30, 0xCF, 0x34, 0x00, 0x12, 0xA3, 0x3F, -+0xEF, 0x64, 0x87, 0x60, 0x02, 0xA1, 0xAE, 0x90, -+0x9A, 0x37, 0x04, 0xF0, 0xE4, 0x90, 0x9A, 0x34, -+0xF0, 0xB1, 0xB4, 0x94, 0x10, 0x50, 0x18, 0x12, -+0xA7, 0x0D, 0xCD, 0x24, 0x38, 0x12, 0xA3, 0x34, -+0x90, 0x9A, 0x34, 0xE0, 0x24, 0x24, 0xF5, 0x82, -+0xE4, 0x34, 0x9A, 0xB1, 0xBB, 0x80, 0xE2, 0xE4, -+0x90, 0x9A, 0x35, 0xF0, 0x90, 0x9A, 0x35, 0xE0, -+0xFF, 0xC3, 0x94, 0x02, 0x40, 0x02, 0xA1, 0xAE, -+0x75, 0xF0, 0x38, 0xEF, 0xB1, 0xCD, 0x20, 0xE0, -+0x02, 0xA1, 0xAE, 0xE4, 0x90, 0x9A, 0x36, 0xF0, -+0xB1, 0xD5, 0x90, 0x93, 0x5E, 0x12, 0x04, 0x6E, -+0xE0, 0xFE, 0x90, 0x9A, 0x36, 0xE0, 0xC3, 0x9E, -+0x40, 0x02, 0xA1, 0xA6, 0xEF, 0x75, 0xF0, 0x38, -+0xA4, 0x24, 0x75, 0xF9, 0x74, 0x93, 0x35, 0xF0, -+0xFA, 0x7B, 0x01, 0xE0, 0x75, 0xF0, 0x10, 0xA4, -+0x29, 0xF9, 0xEA, 0x35, 0xF0, 0xFA, 0x78, 0x24, -+0x7C, 0x9A, 0xB1, 0xDE, 0x60, 0x02, 0xA1, 0x97, -+0x90, 0x06, 0x33, 0xE0, 0x44, 0x01, 0x54, 0xFB, -+0xF0, 0xE4, 0x90, 0x9A, 0x34, 0xF0, 0xB1, 0xB4, -+0x94, 0x06, 0x50, 0x12, 0x12, 0xA7, 0x0D, 0xCD, -+0x24, 0x4A, 0x12, 0xA3, 0x34, 0x90, 0x9A, 0x34, -+0xF1, 0x52, 0xB1, 0xBB, 0x80, 0xE8, 0xE4, 0x90, -+0x9A, 0x34, 0xF0, 0xB1, 0xB4, 0x94, 0x10, 0x50, -+0x0D, 0x12, 0xA3, 0x20, 0x90, 0x9A, 0x34, 0x12, -+0xCF, 0x88, 0xB1, 0xBB, 0x80, 0xED, 0xB1, 0xD5, -+0xB1, 0xCD, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x2A, -+0xEF, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x65, 0xF9, -+0x74, 0x93, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x78, -+0x14, 0x7C, 0x9A, 0xB1, 0xDE, 0x70, 0x6F, 0x90, -+0x98, 0x05, 0xE0, 0xB4, 0x02, 0x0A, 0x90, 0x93, -+0x25, 0x71, 0xDB, 0x20, 0xE0, 0x1D, 0x80, 0x11, -+0x80, 0x19, 0x90, 0x98, 0x05, 0xE0, 0xB4, 0x02, -+0x12, 0x90, 0x93, 0x25, 0x71, 0xDB, 0x20, 0xE0, -+0x0A, 0x90, 0x01, 0xC7, 0x74, 0x0A, 0x12, 0xC7, -+0x78, 0x80, 0x53, 0x7B, 0x01, 0x7A, 0x9A, 0x79, -+0x0E, 0x90, 0x9A, 0x3B, 0x12, 0x84, 0x67, 0x7A, -+0x9A, 0x79, 0x24, 0x90, 0x9A, 0x3E, 0x12, 0x84, -+0x67, 0x90, 0x9A, 0x35, 0xE0, 0x75, 0xF0, 0x38, -+0xA4, 0x24, 0x5F, 0xF9, 0x74, 0x93, 0x35, 0xF0, -+0xFA, 0x90, 0x9A, 0x41, 0x12, 0x84, 0x67, 0xE4, -+0x90, 0x9A, 0x44, 0xF0, 0xA3, 0xF0, 0x7A, 0x9A, -+0x79, 0x14, 0x12, 0x98, 0x83, 0x80, 0x07, 0x90, -+0x06, 0x33, 0xE0, 0x44, 0x05, 0xF0, 0x90, 0x9A, -+0x36, 0xE0, 0x04, 0xF0, 0x81, 0x98, 0x90, 0x9A, -+0x35, 0xE0, 0x04, 0xF0, 0x81, 0x7C, 0x90, 0x9A, -+0x37, 0xE0, 0xFF, 0x22, 0x90, 0x9A, 0x34, 0xE0, -+0xFF, 0xC3, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, -+0x9A, 0x34, 0xE0, 0x04, 0xF0, 0x22, 0x7E, 0x00, -+0x7F, 0x10, 0x02, 0x01, 0xE0, 0x90, 0x93, 0x5D, -+0x12, 0x04, 0x6E, 0xE0, 0x22, 0x90, 0x9A, 0x35, -+0xE0, 0xFF, 0x75, 0xF0, 0x38, 0x22, 0x7D, 0x01, -+0x7E, 0x00, 0x7F, 0x10, 0x12, 0x86, 0x1C, 0xEF, -+0x22, 0x90, 0x93, 0x04, 0x71, 0xDB, 0x30, 0xE0, -+0x34, 0xEF, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x28, -+0x90, 0x95, 0xC1, 0xD1, 0x4A, 0x60, 0x0B, 0xF1, -+0x6D, 0x40, 0x07, 0xD1, 0x34, 0x90, 0x95, 0xC5, -+0x80, 0x05, 0xD1, 0x34, 0x90, 0x95, 0xBD, 0x12, -+0x84, 0x52, 0x12, 0x83, 0x1B, 0x90, 0x9C, 0x55, -+0x12, 0x04, 0x31, 0x12, 0xB3, 0xA7, 0x80, 0x05, -+0x7F, 0x01, 0x12, 0xA0, 0x66, 0x90, 0x93, 0x04, -+0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x05, 0x7F, 0x01, -+0x12, 0xA0, 0x66, 0x22, 0xE4, 0x7F, 0xE8, 0x7E, -+0x03, 0xFD, 0xFC, 0x22, 0xFF, 0xE4, 0xFE, 0xFD, -+0xFC, 0x90, 0x9C, 0x67, 0x12, 0x04, 0x31, 0x90, -+0x9C, 0x67, 0x12, 0x04, 0xB8, 0xEC, 0x4D, 0x4E, -+0x4F, 0x22, 0x90, 0x9C, 0x66, 0xEF, 0xF0, 0x90, -+0x88, 0xE0, 0xE0, 0x70, 0x51, 0x7F, 0x48, 0x7E, -+0x09, 0x12, 0x70, 0x70, 0xEE, 0x54, 0x0F, 0xFE, -+0xE4, 0xFD, 0xFC, 0x90, 0x9C, 0x67, 0x12, 0x04, -+0x31, 0xE4, 0x7F, 0x80, 0xF1, 0x2F, 0x70, 0x05, -+0x90, 0x88, 0xBE, 0x80, 0x1B, 0xE4, 0xFF, 0xFE, -+0xF1, 0x31, 0x70, 0x0A, 0x90, 0x88, 0xBE, 0x04, -+0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x56, 0xE4, 0xFF, -+0xF1, 0x2F, 0x70, 0x09, 0x90, 0x88, 0xBE, 0x04, -+0xF0, 0xA3, 0xF0, 0x80, 0x47, 0xE4, 0x7F, 0x80, -+0xFE, 0xF1, 0x31, 0x70, 0x3F, 0x90, 0x88, 0xBE, -+0xF0, 0xA3, 0x04, 0xF0, 0x80, 0x36, 0x7F, 0x2C, -+0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x02, -+0xD1, 0x3C, 0x60, 0x08, 0x90, 0x88, 0xBE, 0x74, -+0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xBE, -+0xF0, 0x7F, 0x30, 0x7E, 0x09, 0x12, 0x70, 0x70, -+0xEF, 0x54, 0x01, 0xD1, 0x3C, 0x60, 0x07, 0xE4, -+0x90, 0x88, 0xBF, 0xF0, 0x80, 0x06, 0x90, 0x88, -+0xBF, 0x74, 0x01, 0xF0, 0x90, 0x88, 0xB8, 0xE0, -+0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x91, -+0x62, 0x7D, 0x11, 0x7F, 0xFF, 0x12, 0x04, 0x7E, -+0x90, 0x8A, 0xEF, 0x12, 0x8C, 0x14, 0x90, 0x07, -+0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x9C, -+0x66, 0xE0, 0xFD, 0x70, 0x02, 0x80, 0x1C, 0xED, -+0xB4, 0x01, 0x06, 0xF1, 0x3D, 0x44, 0x20, 0xF0, -+0x22, 0x90, 0x9C, 0x66, 0xE0, 0xFD, 0xB4, 0x02, -+0x06, 0xF1, 0x3D, 0x44, 0x60, 0xF0, 0x22, 0xED, -+0xB4, 0x03, 0x03, 0xF1, 0x3D, 0xF0, 0x22, 0x7E, -+0x02, 0xFD, 0xFC, 0x90, 0x9C, 0x67, 0x12, 0x84, -+0x52, 0xC3, 0x02, 0x03, 0xDA, 0x90, 0x88, 0xB8, -+0xE0, 0x54, 0x1F, 0x22, 0x7E, 0x00, 0x7F, 0x06, -+0x02, 0x01, 0xE0, 0x7D, 0x02, 0x7F, 0x02, 0x02, -+0x7C, 0x7E, 0xE0, 0x24, 0x0E, 0xF5, 0x82, 0xE4, -+0x34, 0x9A, 0x22, 0x78, 0x14, 0x7C, 0x9A, 0x7D, -+0x01, 0x7B, 0xFF, 0x22, 0x90, 0x88, 0x36, 0xE0, -+0x60, 0x02, 0x71, 0x63, 0x22, 0x90, 0x98, 0x01, -+0x12, 0x84, 0x52, 0xD3, 0x02, 0x03, 0xDA, 0x90, -+0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, 0x3F, 0xE0, -+0xD3, 0x9F, 0x22, 0x90, 0x8A, 0x75, 0x12, 0x8C, -+0x14, 0x90, 0x8A, 0xE5, 0x12, 0x91, 0x62, 0x7F, -+0x02, 0x02, 0x04, 0x7E, 0x90, 0x98, 0x22, 0xE0, -+0x04, 0xF0, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, -+0x60, 0x03, 0x12, 0xAD, 0x12, 0x22, 0x90, 0x93, -+0x24, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x8A, 0xE5, -+0x12, 0x91, 0x62, 0x7F, 0x10, 0x12, 0x04, 0x7E, -+0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, -+0x10, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0A, 0x12, -+0xAE, 0xC1, 0x54, 0x07, 0x70, 0x03, 0x12, 0xAE, -+0xEB, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, -+0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -+0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x01, 0xC4, 0x74, 0xD2, 0xF0, 0x74, 0xDF, 0xA3, -+0xF0, 0x12, 0x75, 0x50, 0xE5, 0x3D, 0x30, 0xE0, -+0x02, 0x31, 0x30, 0xE5, 0x3D, 0x30, 0xE1, 0x03, -+0x12, 0xDF, 0x64, 0xE5, 0x3D, 0x30, 0xE2, 0x03, -+0x12, 0xDA, 0xFF, 0xE5, 0x3D, 0x30, 0xE4, 0x02, -+0x31, 0x1A, 0xE5, 0x3E, 0x30, 0xE0, 0x02, 0x11, -+0xD1, 0xE5, 0x3F, 0x30, 0xE2, 0x09, 0x91, 0x15, -+0x90, 0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, -+0x40, 0x30, 0xE1, 0x0B, 0x90, 0x8A, 0xE5, 0x12, -+0x91, 0x62, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, -+0x40, 0x30, 0xE4, 0x02, 0x11, 0x82, 0xE5, 0x40, -+0x30, 0xE5, 0x03, 0x12, 0xCE, 0x80, 0xE5, 0x40, -+0x30, 0xE6, 0x02, 0x91, 0x9C, 0xE5, 0x40, 0x30, -+0xE7, 0x02, 0x71, 0xB8, 0x74, 0xD2, 0x04, 0x90, -+0x01, 0xC4, 0xF0, 0x74, 0xDF, 0xA3, 0xF0, 0xD0, -+0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, -+0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, -+0xE0, 0x32, 0x12, 0xC6, 0xC5, 0x12, 0xA7, 0xF0, -+0x7F, 0x01, 0x71, 0xD8, 0x90, 0x8B, 0x07, 0x12, -+0x8C, 0x14, 0x90, 0x93, 0x08, 0xE0, 0x30, 0xE0, -+0x37, 0x31, 0x1D, 0x90, 0x93, 0x0B, 0xE0, 0x60, -+0x0B, 0x14, 0xF0, 0x90, 0x9B, 0x63, 0xE0, 0x70, -+0x27, 0x02, 0x79, 0xD4, 0x31, 0x26, 0xE4, 0xFF, -+0x12, 0xA0, 0x66, 0x90, 0x93, 0x04, 0xE0, 0xFF, -+0x20, 0xE0, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0x30, 0xE0, 0x0D, 0x90, 0x9C, 0x55, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x00, 0x01, 0x12, 0xB3, 0xA7, -+0x22, 0x91, 0x57, 0x90, 0x9A, 0xDC, 0xEF, 0xF0, -+0x90, 0x8A, 0x89, 0x30, 0xE0, 0x13, 0x12, 0x91, -+0x62, 0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, -+0x90, 0x88, 0x33, 0xE0, 0x44, 0x04, 0xF0, 0x80, -+0x09, 0x12, 0x91, 0x62, 0xE4, 0xFD, 0xFF, 0x12, -+0x04, 0x7E, 0x90, 0x9A, 0xDC, 0xE0, 0x30, 0xE6, -+0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, -+0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, -+0x80, 0xF0, 0x31, 0x3B, 0x74, 0x02, 0xF0, 0x02, -+0x6E, 0x2F, 0x02, 0x34, 0x78, 0x90, 0x93, 0x0A, -+0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x90, 0x93, -+0x09, 0xE0, 0x14, 0x90, 0x93, 0x0B, 0xF0, 0x22, -+0x90, 0x8A, 0xE5, 0x12, 0x91, 0x62, 0x7F, 0x80, -+0x02, 0x04, 0x7E, 0x90, 0x88, 0x48, 0xE0, 0xFF, -+0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, 0xE0, 0xFB, -+0x90, 0x92, 0x98, 0x22, 0x90, 0x88, 0x85, 0x12, -+0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x99, -+0x7A, 0xE0, 0x24, 0x46, 0xFF, 0x90, 0x99, 0x79, -+0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, 0xF9, -+0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x83, 0x0D, -+0x90, 0x88, 0x85, 0x71, 0x54, 0xEF, 0x24, 0x46, -+0x71, 0xAD, 0x90, 0x88, 0x89, 0x71, 0x54, 0x90, -+0x88, 0x85, 0x12, 0xDF, 0x36, 0x50, 0x02, 0x41, -+0x3C, 0x90, 0x88, 0x89, 0x12, 0x84, 0x52, 0x90, -+0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, 0x83, 0x0D, -+0x90, 0x9A, 0xD8, 0x12, 0x04, 0x31, 0x90, 0x88, -+0x31, 0xE0, 0x30, 0xE0, 0x2C, 0x12, 0x94, 0xCD, -+0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x03, 0xC3, -+0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x50, -+0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, 0x4E, 0xE0, -+0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, 0x00, -+0xFA, 0x71, 0x5D, 0xEB, 0x2F, 0xFF, 0xEA, 0x80, -+0x1E, 0x90, 0x88, 0x33, 0x12, 0xCF, 0xC1, 0x30, -+0xE0, 0x02, 0x61, 0x39, 0x71, 0x5D, 0x90, 0x88, -+0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, 0xCD, -+0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, 0xED, 0x3E, -+0x90, 0x9A, 0xD4, 0xF0, 0xA3, 0xEF, 0xF0, 0xC3, -+0x90, 0x9A, 0xD5, 0xE0, 0x94, 0xA0, 0x90, 0x9A, -+0xD4, 0xE0, 0x94, 0x00, 0x50, 0x36, 0xA3, 0xE0, -+0xFB, 0x24, 0x39, 0x71, 0x4C, 0xE0, 0x04, 0xF0, -+0x90, 0x9A, 0xD8, 0x12, 0x04, 0xB8, 0xEF, 0x54, -+0x7F, 0xFF, 0x74, 0xD9, 0x2B, 0x71, 0x41, 0xE0, -+0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x9A, -+0xD4, 0xA3, 0xE0, 0x71, 0x3F, 0xEF, 0xF0, 0x90, -+0x88, 0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, 0x7F, -+0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, 0xE0, -+0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, -+0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x61, -+0x39, 0xE4, 0xFF, 0xFE, 0x71, 0x49, 0xE0, 0x2F, -+0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, -+0x9D, 0x40, 0x07, 0x90, 0x9A, 0xD6, 0xEE, 0xF0, -+0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE5, 0x71, -+0x68, 0x40, 0x02, 0x80, 0x15, 0x90, 0x9A, 0xD6, -+0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, 0x50, -+0x13, 0x71, 0x49, 0xE0, 0x2F, 0xFF, 0x71, 0x68, -+0x40, 0x07, 0x90, 0x9A, 0xD7, 0xEE, 0xF0, 0x80, -+0x03, 0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, 0xE0, -+0xFF, 0x71, 0x3A, 0xE0, 0xFD, 0xEF, 0xC3, 0x9D, -+0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, -+0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x9A, 0xD7, -+0xE0, 0x80, 0x18, 0x71, 0x3A, 0xE0, 0xFD, 0xC3, -+0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, 0xF0, -+0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, 0x9A, -+0xD7, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, 0x90, -+0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, -+0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, 0xF0, -+0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, 0xF0, -+0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, 0x50, -+0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, 0x51, -+0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, -+0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, 0x88, -+0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, 0x4F, -+0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, -+0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, 0x90, -+0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0x31, 0x3B, -+0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, 0x8A, -+0xA3, 0x12, 0x91, 0x62, 0xE4, 0xFF, 0x12, 0x04, -+0x7E, 0x22, 0x90, 0x9A, 0xD6, 0xE0, 0xFE, 0x24, -+0xD9, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, -+0x22, 0x74, 0x39, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -+0x98, 0xF5, 0x83, 0x22, 0x12, 0x04, 0x31, 0x90, -+0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, 0x9A, 0xD8, -+0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, 0xEB, -+0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, 0x90, 0x88, -+0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, -+0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, -+0x22, 0xE4, 0xFE, 0x71, 0x49, 0xE4, 0xF0, 0x74, -+0xD9, 0x2E, 0x71, 0x41, 0x74, 0xFF, 0xF0, 0x0E, -+0xEE, 0xB4, 0xA0, 0xEF, 0xE4, 0x90, 0x88, 0x4D, -+0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, -+0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, -+0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xFF, 0xE4, 0x3E, -+0xFE, 0xE4, 0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, -+0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, -+0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, 0x12, -+0x8C, 0x14, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, -+0x06, 0x90, 0x8A, 0xE7, 0x12, 0x8C, 0x14, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x88, 0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x28, -+0x90, 0x9B, 0xB4, 0x74, 0x1E, 0xF0, 0x90, 0x9B, -+0xD6, 0x74, 0x01, 0xF0, 0x90, 0x9B, 0xB6, 0xEF, -+0xF0, 0x7B, 0x01, 0x7A, 0x9B, 0x79, 0xB4, 0x12, -+0xC1, 0xB8, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xE5, -+0x12, 0x91, 0x62, 0x7F, 0x04, 0x12, 0x04, 0x7E, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, -+0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, 0xE0, 0xB4, -+0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, 0x23, 0x74, -+0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, 0xC6, 0xA1, -+0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, 0xB4, 0x02, -+0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE7, 0x12, -+0x8C, 0x14, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, -+0x90, 0x9A, 0xDE, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, -+0x12, 0x7B, 0x41, 0x90, 0x9A, 0xDD, 0xEF, 0xF0, -+0x7F, 0x83, 0x12, 0x7B, 0x41, 0xAE, 0x07, 0x90, -+0x9A, 0xDD, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, -+0xC3, 0x90, 0x9A, 0xDF, 0xE0, 0x94, 0x64, 0x90, -+0x9A, 0xDE, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, -+0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x9A, -+0xDD, 0xE0, 0xFF, 0x22, 0x90, 0x9A, 0xDE, 0x12, -+0xD5, 0xCD, 0x80, 0xC2, 0x90, 0x88, 0x31, 0xE0, -+0xFF, 0x12, 0xBF, 0xE4, 0x30, 0xE0, 0x20, 0xEF, -+0x54, 0x7F, 0x12, 0xCF, 0xB5, 0x30, 0xE1, 0x06, -+0xE0, 0x44, 0x02, 0xF0, 0x80, 0x08, 0xE0, 0x54, -+0xFD, 0x12, 0xCF, 0xD2, 0x04, 0xF0, 0x90, 0x88, -+0x36, 0xE0, 0x60, 0x03, 0x12, 0xAE, 0xEB, 0x12, -+0xC4, 0x6A, 0x30, 0xE0, 0x22, 0x90, 0x88, 0xA4, -+0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x18, 0xEF, -+0x54, 0xFD, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, -+0x88, 0xA4, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x04, -+0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFB, 0xF0, 0x7F, -+0x01, 0x02, 0xC8, 0x40, 0xC0, 0xE0, 0xC0, 0xF0, -+0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, -+0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, -+0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0x01, 0xC4, 0x74, 0xF4, 0xF0, 0x74, -+0xE4, 0xA3, 0xF0, 0x90, 0x8A, 0x9D, 0x12, 0x8C, -+0x14, 0x53, 0x91, 0xBF, 0x74, 0xF4, 0x04, 0x90, -+0x01, 0xC4, 0xF0, 0x74, 0xE4, 0xA3, 0xF0, 0xD0, -+0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, -+0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, -+0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, -+0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, -+0x07, 0x7D, 0x4A, 0x90, 0x01, 0xC4, 0xED, 0xF0, -+0x74, 0xE5, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, -+0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, -+0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, -+0xD0, 0xE0, 0x32, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x9C, 0x75, 0xED, 0xF0, 0xA3, -+0xEB, 0xF0, 0x90, 0x9C, 0x74, 0xEF, 0xF0, 0xE4, -+0xFD, 0xFC, 0x12, 0xED, 0xC2, 0x90, 0x9C, 0x77, -+0xF0, 0xD1, 0x48, 0x90, 0x9C, 0x74, 0xE0, 0x90, -+0x04, 0x25, 0xF0, 0x90, 0x9C, 0x75, 0xE0, 0x60, -+0x05, 0xD1, 0x32, 0x44, 0x80, 0xF0, 0xAF, 0x05, -+0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0xD1, 0x32, -+0x54, 0xC0, 0xF0, 0x90, 0x9C, 0x77, 0xE0, 0xFF, -+0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, -+0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, 0x2E, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, -+0x04, 0xF0, 0xAF, 0x05, 0x12, 0xC7, 0x5E, 0xE0, -+0x54, 0x01, 0xFE, 0x90, 0x9C, 0x76, 0xE0, 0x25, -+0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, -+0x12, 0xC7, 0x5D, 0xEE, 0xF0, 0x74, 0x11, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, -+0xFF, 0xF0, 0x74, 0x29, 0x2F, 0xD1, 0x3E, 0xE0, -+0x54, 0xF7, 0xF0, 0x74, 0x0D, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, -+0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xE0, 0xFF, -+0x12, 0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, 0x22, -+0xE4, 0xFD, 0xFC, 0xEF, 0x60, 0x2B, 0x90, 0x98, -+0x0B, 0xD1, 0x46, 0x12, 0xF3, 0x29, 0x12, 0x8F, -+0xFA, 0x90, 0x99, 0x88, 0x12, 0x9B, 0x5F, 0x75, -+0x48, 0x40, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xF5, -+0x12, 0x69, 0xF5, 0xD1, 0x82, 0xCE, 0xC3, 0x13, -+0xCE, 0x13, 0xD8, 0xF9, 0xD1, 0xB2, 0x12, 0x54, -+0x1E, 0x22, 0xE4, 0xFD, 0x7F, 0x03, 0x12, 0x54, -+0x1E, 0x90, 0x98, 0x0C, 0xE0, 0x75, 0xF0, 0x80, -+0xA4, 0xAE, 0xF0, 0x78, 0x03, 0x22, 0xE4, 0xFD, -+0x7F, 0x03, 0x12, 0x54, 0x1E, 0x90, 0x01, 0x85, -+0xE0, 0x54, 0xFE, 0xF0, 0xD1, 0x82, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xD1, 0xB2, 0x02, -+0x54, 0x1E, 0xFF, 0x12, 0x77, 0xA4, 0x7D, 0x01, -+0x7F, 0x03, 0x22, 0x90, 0x9A, 0x16, 0x12, 0xA7, -+0xFA, 0xD1, 0x96, 0xD1, 0xD0, 0x12, 0xF7, 0xDF, -+0xD1, 0xD0, 0xA3, 0xE0, 0xFD, 0x02, 0x9B, 0x69, -+0x90, 0x9A, 0x16, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x22, 0xE4, 0xFD, 0xFC, 0x90, 0x98, 0x11, 0xD1, -+0x46, 0xAB, 0x05, 0x74, 0x01, 0x2B, 0x12, 0xB6, -+0x9C, 0xE0, 0xFE, 0x74, 0x00, 0x2B, 0x12, 0x9E, -+0x8A, 0x12, 0xEB, 0xEF, 0x90, 0x95, 0x63, 0xF0, -+0xA3, 0xEF, 0xF0, 0x74, 0x03, 0x2B, 0xF1, 0x62, -+0xE0, 0xFE, 0x74, 0x02, 0x2B, 0xF1, 0xE6, 0x24, -+0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x65, 0xF0, -+0xA3, 0xEF, 0xF0, 0x74, 0x05, 0x2B, 0x12, 0xD7, -+0x5B, 0xE0, 0xFE, 0x74, 0x04, 0x2B, 0x12, 0xFB, -+0xF3, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, -+0x67, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x07, 0x2B, -+0xF1, 0xD0, 0xFE, 0x74, 0x06, 0x2B, 0xF1, 0xC7, -+0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x69, -+0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x09, 0x2B, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFE, -+0x74, 0x08, 0x2B, 0xF1, 0x6A, 0x24, 0x00, 0xFF, -+0xEC, 0x3E, 0x90, 0x95, 0x6B, 0xF0, 0xA3, 0xEF, -+0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x22, 0x90, 0x93, 0x06, 0xF1, 0xD9, -+0x12, 0x9E, 0x8A, 0xE0, 0x90, 0x9A, 0xE7, 0xF0, -+0x74, 0x01, 0x2F, 0x12, 0xB6, 0x9C, 0xE0, 0x90, -+0x9A, 0xE8, 0xF1, 0xE2, 0x90, 0x9A, 0xE9, 0xF0, -+0x74, 0x03, 0x2F, 0xF1, 0x62, 0xE0, 0x90, 0x9A, -+0xEA, 0x12, 0xFB, 0xEF, 0x90, 0x9A, 0xEB, 0xF0, -+0x74, 0x05, 0x2F, 0x12, 0xD7, 0x5B, 0xE0, 0x90, -+0x9A, 0xEC, 0xF0, 0x74, 0x06, 0x2F, 0xF1, 0xC7, -+0x90, 0x9A, 0xED, 0xF0, 0x74, 0x07, 0x2F, 0xF1, -+0xD0, 0x90, 0x9A, 0xEE, 0xF0, 0x74, 0x08, 0x2F, -+0xF1, 0x6A, 0x90, 0x9A, 0xEF, 0xF0, 0x22, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -+0x22, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x74, 0x00, -+0x2F, 0x22, 0xF0, 0x74, 0x02, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xEF, -+0x64, 0x01, 0x70, 0x24, 0x90, 0x93, 0x29, 0xE0, -+0xFF, 0x7E, 0x00, 0x90, 0x93, 0x2B, 0xE0, 0x13, -+0x13, 0x54, 0x01, 0xFD, 0x90, 0x93, 0x2A, 0xE0, -+0xFC, 0xC3, 0x13, 0x54, 0x7F, 0xFB, 0xEC, 0x54, -+0x01, 0x90, 0x9A, 0xE0, 0xF0, 0x12, 0x8F, 0x31, -+0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x9A, 0xD4, -+0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, -+0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, -+0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, -+0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, -+0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, -+0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, -+0x7B, 0x2E, 0x80, 0xFE, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9B, 0xED, 0xEC, -+0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x9B, 0xEC, 0xEF, -+0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x7B, 0xBD, -+0x90, 0x9B, 0xF7, 0x12, 0x04, 0x31, 0x90, 0x9B, -+0xEF, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, -+0x9B, 0xF7, 0x12, 0x84, 0x52, 0x12, 0x84, 0x38, -+0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0x9B, 0xEF, 0x12, 0x04, 0xB8, 0x90, 0x9B, -+0xF3, 0x12, 0x84, 0x52, 0x12, 0x84, 0x38, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -+0x84, 0x45, 0x90, 0x9B, 0xFB, 0x12, 0x04, 0x31, -+0x90, 0x9B, 0xED, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, -+0x90, 0x9B, 0xFB, 0x12, 0x04, 0xB8, 0x90, 0x8B, -+0x9F, 0x12, 0x04, 0x31, 0x90, 0x9B, 0xEC, 0xE0, -+0xFF, 0xD0, 0x05, 0x12, 0x79, 0x53, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x9C, 0x80, 0xEF, 0xF0, 0xED, -+0x64, 0x01, 0x70, 0x2E, 0xEB, 0xB4, 0x01, 0x07, -+0xE0, 0x24, 0x02, 0xF5, 0x15, 0x80, 0x08, 0x90, -+0x9C, 0x80, 0xE0, 0x24, 0xFE, 0xF5, 0x15, 0x90, -+0x9B, 0xEF, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, -+0xFF, 0xAF, 0x15, 0x31, 0x45, 0x31, 0x3D, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x15, -+0x80, 0x20, 0x90, 0x9B, 0xEF, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x00, 0xFF, 0x90, 0x9C, 0x80, 0x12, -+0xBD, 0xAC, 0x31, 0x49, 0x31, 0x3D, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x9C, 0x80, -+0xE0, 0xFF, 0x31, 0x45, 0x7F, 0x01, 0x11, 0x55, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFF, 0x11, -+0x55, 0x90, 0x9B, 0xEF, 0x22, 0xE4, 0xFC, 0xFD, -+0xFE, 0x90, 0x9B, 0xF3, 0x12, 0x04, 0x31, 0x7D, -+0x18, 0x7C, 0x00, 0x22, 0x90, 0x93, 0x04, 0x12, -+0xCF, 0xC1, 0x30, 0xE0, 0x07, 0x71, 0x0F, 0xE4, -+0x90, 0x9A, 0xFF, 0xF0, 0x90, 0x9C, 0x01, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x9A, -+0xE5, 0x12, 0xBD, 0xAC, 0x12, 0xBF, 0x91, 0x7F, -+0x50, 0x7E, 0x0C, 0x12, 0xBF, 0x0C, 0x12, 0x04, -+0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x9A, 0xE6, -+0x12, 0xBD, 0xAC, 0x12, 0xBF, 0x91, 0x12, 0xBF, -+0x12, 0x90, 0x9A, 0xFB, 0xE0, 0x90, 0x06, 0x08, -+0xF0, 0x90, 0x9A, 0xFD, 0xA3, 0xE0, 0x90, 0x06, -+0xA0, 0xF0, 0xA3, 0xE4, 0xF0, 0x90, 0x9A, 0xE9, -+0xE0, 0xFF, 0x60, 0x06, 0xA3, 0xE0, 0xFD, 0x12, -+0xBD, 0xBE, 0x90, 0x9A, 0xE8, 0xE0, 0xFF, 0x60, -+0x0A, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0x71, -+0x06, 0x11, 0xD3, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0xF7, 0xE0, 0xFF, -+0x91, 0xEA, 0xEF, 0x70, 0x02, 0x41, 0x7B, 0x90, -+0x9A, 0xF8, 0xE0, 0xFB, 0xD3, 0x94, 0x00, 0x40, -+0x1A, 0x90, 0x9C, 0x01, 0x12, 0x04, 0x3D, 0x00, -+0x00, 0x00, 0x0F, 0xAF, 0x03, 0xE4, 0xFC, 0xFD, -+0xFE, 0x12, 0xBF, 0x91, 0x7F, 0x08, 0x7E, 0x0E, -+0x12, 0xBF, 0x16, 0x90, 0x9A, 0xF7, 0xE0, 0xFF, -+0x90, 0x06, 0x33, 0xF0, 0x71, 0x06, 0xE4, 0xFB, -+0xFD, 0x11, 0xD3, 0x90, 0x9A, 0xFA, 0xE0, 0x60, -+0x07, 0x90, 0x93, 0x05, 0xE0, 0xFF, 0x51, 0xC8, -+0x71, 0xB3, 0x30, 0xE0, 0x39, 0x90, 0x95, 0xBA, -+0xE0, 0x60, 0x33, 0xE4, 0x90, 0x9A, 0x0D, 0xF0, -+0x90, 0x95, 0xBA, 0xE0, 0xFF, 0x90, 0x9A, 0x0D, -+0xE0, 0xC3, 0x9F, 0x50, 0x21, 0x7F, 0x03, 0x7E, -+0x00, 0x12, 0x7A, 0xAE, 0x90, 0x9A, 0x0D, 0xE0, -+0x24, 0xF9, 0x71, 0xBB, 0xE0, 0xFF, 0x51, 0xC8, -+0x90, 0x01, 0xA6, 0xE0, 0x04, 0xF0, 0x90, 0x9A, -+0x0D, 0xE0, 0x04, 0xF0, 0x80, 0xD2, 0x90, 0x9A, -+0xF9, 0xE0, 0x90, 0x9A, 0x0C, 0xF0, 0x90, 0x9A, -+0xE4, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0xB1, 0x15, -+0x90, 0x9A, 0x0C, 0x12, 0xBD, 0xAC, 0x90, 0x9C, -+0x55, 0x12, 0x04, 0x31, 0x71, 0xC3, 0x12, 0xB3, -+0xAE, 0x80, 0x48, 0xE4, 0x90, 0x9A, 0xE4, 0xF0, -+0x90, 0x9B, 0x63, 0xF0, 0x90, 0x06, 0x32, 0xE0, -+0x54, 0xFB, 0xF0, 0x31, 0x54, 0xE4, 0xFF, 0x12, -+0x78, 0x4A, 0xBF, 0x01, 0x13, 0x90, 0x9A, 0xFC, -+0xE0, 0xFD, 0x90, 0x8A, 0x89, 0x12, 0x91, 0x62, -+0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x7B, 0xAD, -+0x90, 0x9A, 0x0E, 0x74, 0x07, 0xF0, 0x90, 0x9A, -+0x30, 0xF0, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x0E, -+0x12, 0x91, 0x50, 0x7F, 0x04, 0x12, 0x04, 0x7E, -+0x12, 0xDD, 0xE9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x9A, 0x31, 0xEF, 0xF0, 0x12, 0x76, 0x9B, 0xBF, -+0x01, 0x27, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x08, -+0xF0, 0x90, 0x9A, 0x31, 0xE0, 0xFF, 0x90, 0x92, -+0x13, 0x74, 0x07, 0xF0, 0x7B, 0x18, 0x7D, 0x01, -+0x12, 0x66, 0xDB, 0x90, 0x9A, 0x32, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0x90, 0x04, 0x1F, 0x74, 0x20, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9A, -+0xEF, 0xE0, 0x90, 0x9C, 0x83, 0xF0, 0x22, 0x90, -+0x02, 0x86, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0xE4, -+0xFD, 0xFC, 0x90, 0x01, 0x1D, 0xE0, 0xFE, 0x90, -+0x01, 0x1C, 0x71, 0xEF, 0x90, 0x9C, 0x88, 0xF0, -+0xA3, 0xEF, 0x12, 0xCF, 0xC8, 0xE0, 0x24, 0x00, -+0xFF, 0xEA, 0x3E, 0x90, 0x9C, 0x8A, 0xF0, 0xA3, -+0xEF, 0xF0, 0x71, 0xAA, 0x90, 0x9C, 0x88, 0xE0, -+0xFA, 0xA3, 0xE0, 0xFB, 0xB5, 0x07, 0x06, 0xEA, -+0xB5, 0x06, 0x02, 0x80, 0x40, 0x71, 0xAA, 0xD3, -+0xEB, 0x9F, 0xEA, 0x9E, 0x40, 0x0E, 0x90, 0x9C, -+0x89, 0xE0, 0x9F, 0xFD, 0x90, 0x9C, 0x88, 0xE0, -+0x9E, 0xFC, 0x80, 0x29, 0x71, 0xAA, 0xC3, 0x90, -+0x9C, 0x89, 0xE0, 0x9F, 0x90, 0x9C, 0x88, 0xE0, -+0x9E, 0x50, 0x1A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0xC3, 0x90, 0x9C, 0x8B, 0xE0, 0x9F, 0xFF, 0x90, -+0x9C, 0x8A, 0xE0, 0x9E, 0xFE, 0xC3, 0xE4, 0x9F, -+0xFD, 0x74, 0x40, 0x9E, 0xFC, 0xD3, 0xED, 0x94, -+0x00, 0xEC, 0x94, 0x38, 0x40, 0x02, 0x61, 0x0F, -+0xC3, 0xEC, 0x94, 0x08, 0x50, 0x0B, 0xED, 0x94, -+0x00, 0xEC, 0x94, 0x00, 0x40, 0x03, 0x12, 0xCF, -+0x78, 0x22, 0x90, 0x9C, 0x8A, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x22, 0x90, 0x93, 0x24, 0xE0, 0xC4, -+0x54, 0x0F, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x95, -+0xF5, 0x83, 0x22, 0xE4, 0x90, 0x9C, 0x59, 0xF0, -+0x7F, 0x04, 0x22, 0xEF, 0x24, 0xFC, 0x60, 0x06, -+0x04, 0x70, 0x05, 0x02, 0x94, 0xD4, 0x31, 0xC4, -+0x22, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, -+0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, -+0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x22, -+0x12, 0xCF, 0xC9, 0x12, 0xBA, 0x6E, 0x90, 0x99, -+0x88, 0x12, 0xCF, 0x9A, 0xF9, 0x90, 0x93, 0x24, -+0xE0, 0x30, 0xE0, 0x78, 0xEC, 0xC3, 0x99, 0x50, -+0x73, 0x90, 0x99, 0x88, 0xE0, 0xFA, 0xA3, 0xE0, -+0xFB, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, -+0xAD, 0x07, 0x71, 0xD9, 0x54, 0x3F, 0x90, 0x99, -+0x8A, 0x91, 0xCE, 0x30, 0xE0, 0x09, 0xC3, 0x13, -+0x20, 0xE0, 0x04, 0x91, 0x9C, 0x80, 0x02, 0x7E, -+0x00, 0xEE, 0xFB, 0xEF, 0x24, 0x18, 0xFF, 0xE4, -+0x33, 0xCF, 0x2B, 0xCF, 0x34, 0x00, 0x90, 0x99, -+0x8A, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x99, -+0x8A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0xCE, -+0x5D, 0x90, 0x99, 0x8A, 0xEE, 0x91, 0x85, 0x91, -+0x8D, 0xD3, 0x90, 0x99, 0x89, 0xE0, 0x9F, 0x90, -+0x99, 0x88, 0xE0, 0x9E, 0x40, 0x0E, 0x91, 0xAB, -+0x90, 0x99, 0x89, 0xE0, 0x9F, 0xF0, 0x90, 0x99, -+0x88, 0xE0, 0x9E, 0xF0, 0x90, 0x99, 0x88, 0x91, -+0xBB, 0x0C, 0x80, 0x88, 0x22, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0x99, 0x88, 0x22, 0xEE, 0x8F, 0xF0, -+0x12, 0x02, 0xE7, 0x90, 0x88, 0x27, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0x22, 0x74, 0x03, 0x2D, 0xF5, -+0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, -+0x03, 0xFE, 0x22, 0x90, 0x88, 0x28, 0xE0, 0x24, -+0x01, 0xFF, 0x90, 0x88, 0x27, 0xE0, 0x34, 0x00, -+0xFE, 0xC3, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, -+0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xF0, 0xA3, -+0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, -+0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0x98, 0x38, -+0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x9A, 0xE7, 0xE0, 0xFE, 0x90, 0x9A, -+0xE4, 0xE0, 0xC3, 0x9E, 0x40, 0x04, 0x7F, 0x00, -+0x80, 0x0E, 0xEF, 0x60, 0x05, 0xD3, 0x94, 0x0E, -+0x40, 0x04, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x31, 0xEF, -+0xF0, 0x90, 0x93, 0x06, 0xE0, 0xFF, 0x12, 0x7B, -+0x07, 0x74, 0x10, 0x2F, 0xFF, 0x90, 0x9A, 0x31, -+0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x2F, 0xFF, 0x12, -+0xB7, 0x62, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, -+0x9A, 0x79, 0xF7, 0x12, 0x69, 0xF5, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0xE4, 0xFE, 0xFD, 0xEF, 0xB4, 0x01, -+0x0D, 0xEB, 0xB4, 0x02, 0x03, 0x0D, 0x80, 0x06, -+0xEB, 0xB4, 0x01, 0x02, 0x7D, 0x02, 0xAF, 0x06, -+0xEF, 0xC4, 0x54, 0xF0, 0x4D, 0xFF, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0x01, 0xC4, 0x74, 0x73, -+0xF0, 0x74, 0xED, 0xA3, 0xF0, 0x7F, 0x90, 0x12, -+0x7B, 0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0x73, -+0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xED, 0xA3, -+0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0xB1, 0xC2, 0x90, 0x9C, 0xA9, 0xF0, 0xED, -+0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, -+0xF0, 0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, -+0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, -+0x67, 0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, -+0x7F, 0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, -+0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0xB1, 0xC2, 0x90, 0x9C, 0xAE, 0xF0, 0x90, -+0x88, 0x32, 0x12, 0xBF, 0xE3, 0x30, 0xE0, 0x02, -+0xC1, 0x96, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, -+0x1C, 0x12, 0x94, 0xCD, 0x33, 0x33, 0x33, 0x54, -+0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, 0x53, -+0xE0, 0x04, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, -+0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, 0x4B, -+0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, -+0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, 0x88, 0x4A, -+0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, -+0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, 0xF0, 0x90, -+0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, -+0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, 0xF0, -+0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, -+0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, 0x88, 0x4B, -+0xD1, 0xA2, 0x90, 0x88, 0x4E, 0xD1, 0xAB, 0x40, -+0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, -+0xD1, 0xA2, 0x90, 0x88, 0x3E, 0xD1, 0xAB, 0x40, -+0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, -+0x12, 0xC6, 0x14, 0xFF, 0x7E, 0x00, 0x90, 0x88, -+0x42, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, -+0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, -+0xFF, 0x90, 0x05, 0xB1, 0xE0, 0x54, 0xF8, 0x4F, -+0xF0, 0x12, 0xC7, 0xE8, 0x80, 0x07, 0x90, 0x88, -+0x33, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, -+0x33, 0xFC, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, -+0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, -+0xF0, 0x54, 0xE1, 0xF0, 0x90, 0x88, 0xBD, 0xE0, -+0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0x36, 0xE0, -+0x70, 0x19, 0x90, 0x93, 0x08, 0xE0, 0x20, 0xE0, -+0x12, 0x90, 0x86, 0x0C, 0x12, 0x8C, 0x14, 0x90, -+0x8A, 0xF9, 0x12, 0x91, 0x62, 0xE4, 0xFD, 0xFF, -+0x12, 0x04, 0x7E, 0x22, 0x90, 0x88, 0x9D, 0xE0, -+0x30, 0xE0, 0x5F, 0x90, 0x99, 0x7C, 0xE0, 0x30, -+0xE0, 0x3E, 0x90, 0x99, 0x87, 0xE0, 0xFF, 0x90, -+0x99, 0x86, 0xE0, 0xC3, 0x9F, 0x40, 0x25, 0xF1, -+0x5D, 0x90, 0x06, 0xC4, 0xF1, 0x5B, 0x78, 0x08, -+0x12, 0x03, 0xEB, 0x90, 0x06, 0xC5, 0xEF, 0xF0, -+0x90, 0x99, 0x7D, 0x12, 0xB4, 0xCF, 0x90, 0x06, -+0xC6, 0xF1, 0x5B, 0xF1, 0x63, 0xE4, 0x90, 0x99, -+0x86, 0xF0, 0x80, 0x1B, 0xF1, 0x6E, 0xF1, 0x63, -+0x90, 0x99, 0x86, 0xE0, 0x04, 0xF0, 0x80, 0x0F, -+0x90, 0x99, 0x85, 0xE0, 0x60, 0x09, 0xF1, 0x6E, -+0xF1, 0x63, 0xE4, 0x90, 0x99, 0x85, 0xF0, 0x90, -+0x8A, 0xBB, 0x12, 0x91, 0x62, 0xE4, 0xFF, 0x12, -+0x04, 0x7E, 0x22, 0xEF, 0xF0, 0x90, 0x99, 0x7D, -+0x02, 0x04, 0xB8, 0x78, 0x18, 0x12, 0x03, 0xEB, -+0x90, 0x06, 0xC7, 0xEF, 0xF0, 0x22, 0x90, 0x99, -+0x81, 0x12, 0x04, 0xB8, 0x90, 0x06, 0xC4, 0xEF, -+0xF0, 0x90, 0x99, 0x81, 0x12, 0x04, 0xB8, 0x78, -+0x08, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC5, 0xEF, -+0xF0, 0x90, 0x99, 0x81, 0x12, 0x04, 0xB8, 0x78, -+0x10, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC6, 0xEF, -+0xF0, 0x90, 0x99, 0x81, 0x02, 0x04, 0xB8, 0x90, -+0x9C, 0xAA, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xEF, 0x54, -+0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, 0x08, 0x74, -+0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, 0x71, 0x12, -+0xF0, 0xA5, 0x12, 0xF0, 0x79, 0x90, 0x07, 0xC3, -+0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, -+0x2F, 0x12, 0xF0, 0x71, 0xE0, 0xFE, 0x74, 0x84, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0x12, 0xF2, -+0xEB, 0xB4, 0x04, 0xEA, 0x90, 0x9C, 0x85, 0x12, -+0xBD, 0xAC, 0x12, 0xC3, 0x0B, 0x90, 0x9C, 0x84, -+0x12, 0xBD, 0xAC, 0x12, 0x84, 0x45, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x9C, -+0x86, 0x12, 0xBD, 0xAC, 0x78, 0x10, 0x12, 0x03, -+0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0x12, 0x84, 0x45, 0xC0, 0x04, 0xC0, 0x05, -+0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0xBD, 0xAC, -+0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x84, 0x45, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, -+0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, -+0x7E, 0xFF, 0x7F, 0xFF, 0x80, 0x1E, 0x11, 0xA5, -+0x11, 0x79, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, -+0xF9, 0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0x11, -+0x71, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, 0x11, 0x71, -+0x12, 0xBA, 0x6E, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xF5, 0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, -+0x22, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, -+0x07, 0xAC, 0x06, 0xEF, 0x11, 0xB3, 0x11, 0x79, -+0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, -+0x54, 0x03, 0x24, 0xC8, 0x11, 0x71, 0xE0, 0xFF, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, 0xC0, -+0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0x54, 0xFC, 0x90, 0x07, 0xC0, -+0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, -+0x11, 0xB5, 0xE4, 0xFB, 0x90, 0x9C, 0x5C, 0x12, -+0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, -+0xF8, 0x12, 0x03, 0xEB, 0x74, 0xC4, 0x2B, 0x11, -+0x71, 0xEF, 0xF0, 0x0B, 0xEB, 0xB4, 0x04, 0xE4, -+0x90, 0x07, 0xC2, 0x31, 0xB3, 0x90, 0x07, 0xC3, -+0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x9C, 0xA1, 0x11, 0xAE, 0x7A, 0x00, 0x90, -+0x9C, 0xA2, 0xE0, 0x54, 0x03, 0xFB, 0x70, 0x0A, -+0x90, 0x07, 0xC4, 0x31, 0x3A, 0x74, 0x03, 0xF0, -+0x80, 0x0E, 0xEB, 0x64, 0x02, 0x4A, 0x70, 0x15, -+0x90, 0x07, 0xC6, 0x31, 0x3A, 0x74, 0x0C, 0xF0, -+0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, -+0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xED, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, -+0x07, 0xC2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x9C, 0xA3, 0x11, 0xAE, 0x31, -+0xA9, 0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, 0xF0, -+0x90, 0x07, 0xC2, 0x74, 0x01, 0xF0, 0x80, 0x37, -+0xEF, 0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, 0x07, -+0xC5, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x02, -+0xF0, 0x80, 0x24, 0x31, 0xA9, 0x64, 0x02, 0x70, -+0x0D, 0x90, 0x07, 0xC6, 0xED, 0xF0, 0x90, 0x07, -+0xC2, 0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, 0x64, -+0x03, 0x4E, 0x70, 0x0B, 0x90, 0x07, 0xC7, 0xED, -+0xF0, 0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, 0x90, -+0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, 0xC3, -+0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x7E, 0x00, 0x90, 0x9C, 0xA4, 0xE0, 0x54, -+0x03, 0xFF, 0x22, 0x74, 0x0F, 0xF0, 0xA3, 0x74, -+0xC0, 0xF0, 0x22, 0x90, 0x98, 0x18, 0x12, 0xCF, -+0xC1, 0x30, 0xE0, 0x0B, 0x12, 0xB7, 0xE8, 0x31, -+0xDC, 0xA3, 0x04, 0xF0, 0x02, 0x9A, 0x22, 0x90, -+0x8A, 0xAF, 0x12, 0x91, 0x62, 0x7D, 0x08, 0xE4, -+0xFF, 0x02, 0x04, 0x7E, 0x90, 0x9C, 0x14, 0x12, -+0x84, 0x67, 0xE4, 0x90, 0x9C, 0x17, 0xF0, 0x22, -+0x90, 0x98, 0x18, 0xE0, 0x30, 0xE0, 0x34, 0x12, -+0xC7, 0x81, 0x70, 0x2F, 0x90, 0x9C, 0xAC, 0xE0, -+0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0x98, -+0x1A, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x9C, 0xAC, -+0xF0, 0x90, 0x98, 0x1A, 0xE0, 0xFF, 0x90, 0x98, -+0x19, 0xE0, 0xD3, 0x9F, 0x50, 0x0D, 0x90, 0x98, -+0x1B, 0xE0, 0x70, 0x07, 0xE4, 0x90, 0x98, 0x1A, -+0xF0, 0x31, 0xBB, 0x22, 0x12, 0xBF, 0xEB, 0x90, -+0x98, 0x18, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, -+0xEF, 0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, -+0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, -+0x07, 0x12, 0x8E, 0xFF, 0x90, 0x98, 0x19, 0xF0, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0xE4, 0xFD, 0x7F, 0x8F, 0x12, 0x7B, 0x2E, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x51, 0x49, 0x90, 0x98, -+0x16, 0xE0, 0xFF, 0x51, 0x86, 0x90, 0x01, 0x3F, -+0x74, 0x04, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xFF, -+0xB4, 0x01, 0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, -+0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0x90, 0xFE, -+0x10, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x99, -+0x8B, 0xEF, 0xF0, 0xE4, 0xFF, 0x74, 0x2F, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, -+0xFE, 0x74, 0x84, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x04, 0x51, 0xEB, 0xB4, 0x08, 0xE7, 0x90, 0x95, -+0x5F, 0xE0, 0x90, 0x04, 0x8C, 0xF0, 0x90, 0x95, -+0x61, 0xE0, 0x90, 0x04, 0x8D, 0xF0, 0x75, 0x45, -+0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0x3E, 0x75, -+0x48, 0x08, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x37, -+0x12, 0x69, 0xF5, 0x90, 0x98, 0x16, 0xE0, 0x60, -+0x19, 0x90, 0x99, 0x8B, 0x71, 0x21, 0x71, 0x29, -+0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x95, 0x75, -+0x47, 0x2F, 0x75, 0x48, 0x34, 0xD0, 0x03, 0x12, -+0x69, 0xF5, 0x22, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, -+0xEF, 0x22, 0xE4, 0xFF, 0x74, 0x18, 0x71, 0x16, -+0x74, 0x34, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, -+0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x10, 0x71, 0x16, -+0x74, 0x2E, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, -+0x51, 0xEB, 0xB4, 0x06, 0xDF, 0x22, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, -+0x22, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x7E, 0x00, -+0x22, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFC, -+0xFA, 0x7B, 0x01, 0x22, 0x90, 0x93, 0x2D, 0xE0, -+0x30, 0xE0, 0x0D, 0x90, 0x93, 0x27, 0xE0, 0xC4, -+0x54, 0x0F, 0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, -+0x7F, 0x01, 0x22, 0xEF, 0x90, 0x01, 0xC7, 0xB4, -+0xA0, 0x05, 0x74, 0x04, 0xF0, 0x80, 0x03, 0x74, -+0x08, 0xF0, 0x02, 0xC7, 0x79, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x20, 0xE0, 0x05, -+0x90, 0x98, 0x05, 0x80, 0x03, 0x90, 0x98, 0x06, -+0xE0, 0x90, 0x95, 0x60, 0xF0, 0x90, 0x95, 0x60, -+0xE0, 0x14, 0x60, 0x13, 0x14, 0x60, 0x14, 0x24, -+0xFE, 0x60, 0x10, 0x14, 0x60, 0x09, 0x14, 0x60, -+0x06, 0x24, 0x06, 0xE4, 0xFE, 0x80, 0x06, 0x7E, -+0x04, 0x80, 0x02, 0x7E, 0x08, 0xAF, 0x06, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9C, 0x63, 0xED, -+0xF0, 0x90, 0x9C, 0x60, 0x12, 0x84, 0x67, 0xE4, -+0x90, 0x9C, 0x64, 0xF0, 0xA3, 0xF0, 0x12, 0x02, -+0x06, 0xFF, 0x12, 0x8E, 0xFF, 0xFD, 0x12, 0x97, -+0x31, 0xFB, 0x12, 0xCE, 0xE7, 0x90, 0x9C, 0x64, -+0xEF, 0xF0, 0x90, 0x9C, 0x60, 0x12, 0x84, 0x5E, -+0x12, 0x97, 0x31, 0xFF, 0x71, 0x5D, 0x90, 0x9C, -+0x65, 0xEF, 0xF0, 0x90, 0x95, 0x60, 0xE0, 0x24, -+0xFE, 0x60, 0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, -+0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, -+0x41, 0x91, 0x2B, 0x91, 0x37, 0x80, 0x0D, 0x91, -+0x2B, 0x90, 0x95, 0x60, 0xE0, 0x90, 0x9C, 0x43, -+0xF0, 0x12, 0x96, 0x34, 0x90, 0x9C, 0x65, 0xE0, -+0xFF, 0x90, 0x9C, 0x60, 0x12, 0x84, 0x5E, 0x90, -+0x9C, 0x64, 0xE0, 0x7C, 0x00, 0x29, 0xF9, 0xEC, -+0x3A, 0xFA, 0xC3, 0xE9, 0x9F, 0xF9, 0xEA, 0x94, -+0x00, 0xFA, 0x75, 0x45, 0x01, 0x75, 0x46, 0x95, -+0x75, 0x47, 0x2F, 0xA3, 0xE0, 0xF5, 0x48, 0x12, -+0x69, 0xF5, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x2F, 0x90, 0x9C, 0x63, 0xE0, 0xFD, 0x22, 0x90, -+0x9C, 0x4F, 0xED, 0xF0, 0x90, 0x9C, 0x4C, 0x12, -+0x84, 0x67, 0x12, 0x8F, 0xF4, 0x90, 0x9C, 0x53, -+0xF0, 0x90, 0x9C, 0x4C, 0x12, 0x9B, 0x5F, 0x75, -+0x48, 0x03, 0x7B, 0x01, 0x7A, 0x9C, 0x79, 0x50, -+0x12, 0x69, 0xF5, 0x90, 0x9C, 0x4F, 0xE0, 0x70, -+0x2E, 0xFF, 0x91, 0x90, 0xE0, 0xB4, 0xFF, 0x06, -+0x91, 0x90, 0xE4, 0xF0, 0x80, 0x07, 0x91, 0x90, -+0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, -+0x03, 0xE8, 0x75, 0x45, 0x01, 0x75, 0x46, 0x9C, -+0x75, 0x47, 0x50, 0x75, 0x48, 0x03, 0x90, 0x9C, -+0x4C, 0x12, 0x84, 0x5E, 0x12, 0x69, 0xF5, 0x22, -+0x74, 0x50, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, -+0xF5, 0x83, 0x22, 0x91, 0xAC, 0x12, 0xB7, 0x64, -+0x75, 0x48, 0x08, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x2F, 0x02, 0x69, 0xF5, 0x12, 0x7B, 0x07, 0x7E, -+0x00, 0x74, 0x00, 0x2F, 0x22, 0x91, 0xAC, 0x12, -+0xB7, 0x64, 0x75, 0x48, 0x70, 0x7B, 0x01, 0x7A, -+0x93, 0x79, 0x5D, 0x02, 0x69, 0xF5, 0xEF, 0x60, -+0x07, 0x90, 0x98, 0x0D, 0xE0, 0xFF, 0x91, 0xB5, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x12, 0xBF, 0xEB, 0x90, 0x93, 0x24, 0x12, 0xCF, -+0xDD, 0x12, 0x8F, 0x0E, 0xB1, 0xF3, 0x90, 0x93, -+0x24, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, -+0xF7, 0x12, 0x8F, 0x0D, 0xD1, 0x07, 0x90, 0x93, -+0x24, 0x12, 0x8F, 0x05, 0x12, 0xBF, 0xCE, 0x4D, -+0xFF, 0x90, 0x93, 0x24, 0xD1, 0x10, 0x12, 0x8F, -+0xED, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x26, -+0xE0, 0x54, 0xFE, 0x4E, 0x12, 0x8E, 0xFE, 0xFE, -+0x54, 0x01, 0xFD, 0x90, 0x93, 0x25, 0xB1, 0xEB, -+0x54, 0x04, 0xFE, 0xED, 0x54, 0xFB, 0x4E, 0x12, -+0x8E, 0xFD, 0xFD, 0x54, 0x08, 0xFC, 0xEE, 0x54, -+0xF7, 0x4C, 0xFE, 0x90, 0x93, 0x25, 0xF0, 0xED, -+0x54, 0x10, 0xFD, 0xEE, 0x54, 0xEF, 0x4D, 0x12, -+0x8E, 0xFD, 0xFD, 0x54, 0x20, 0xFC, 0xEE, 0x54, -+0xDF, 0x4C, 0x90, 0x93, 0x25, 0xF0, 0xEF, 0x54, -+0x10, 0xFF, 0xA3, 0xE0, 0x54, 0xEF, 0x4F, 0xFF, -+0x12, 0x8F, 0xED, 0x54, 0x20, 0xFE, 0xEF, 0x54, -+0xDF, 0x4E, 0x90, 0x93, 0x26, 0xF0, 0xED, 0x54, -+0x02, 0xFF, 0x90, 0x93, 0x25, 0xE0, 0x54, 0xFD, -+0x4F, 0x12, 0xBA, 0x65, 0xB1, 0xE3, 0x90, 0x93, -+0x24, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, 0xD1, -+0x1A, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x54, -+0x01, 0xFF, 0x91, 0xC6, 0x12, 0xC6, 0x11, 0x30, -+0xE0, 0x1F, 0x90, 0x93, 0x24, 0x12, 0xDB, 0xDB, -+0x20, 0xE0, 0x0E, 0xEF, 0xC3, 0x13, 0x20, 0xE0, -+0x08, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, -+0x04, 0x7F, 0x01, 0x80, 0x0E, 0x7F, 0x00, 0x80, -+0x0A, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x13, -+0x54, 0x01, 0xFF, 0x12, 0xE6, 0x50, 0x90, 0x93, -+0x24, 0xE0, 0xC4, 0x54, 0x01, 0xFF, 0xD1, 0x26, -+0x90, 0x93, 0x24, 0xE0, 0xC4, 0x13, 0x13, 0x54, -+0x01, 0xFF, 0xB1, 0xFC, 0x90, 0x93, 0x24, 0xE0, -+0x54, 0x01, 0xFF, 0x12, 0xB2, 0xAE, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0x88, 0x27, 0xF0, 0xA3, -+0xEF, 0xF0, 0x22, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, -+0xF0, 0xEE, 0x22, 0x54, 0x04, 0xFD, 0xEF, 0x54, -+0xFB, 0x4D, 0xFF, 0x22, 0xEF, 0x60, 0x06, 0x12, -+0xE6, 0xD9, 0x12, 0xBA, 0x77, 0x22, 0xFE, 0x54, -+0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x22, -+0xF0, 0xEE, 0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, -+0x4E, 0x22, 0xEF, 0x60, 0x08, 0x90, 0x98, 0x08, -+0xE0, 0xFF, 0x12, 0xB7, 0x70, 0x22, 0xEF, 0x60, -+0x0A, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x80, 0xF0, -+0x12, 0xBB, 0x3A, 0x22, 0x12, 0xA7, 0xF7, 0x2F, -+0xFF, 0xE4, 0x3E, 0xCF, 0x24, 0x06, 0xCF, 0x34, -+0x00, 0x12, 0xA3, 0x3F, 0xEF, 0x64, 0x86, 0x70, -+0x1C, 0x90, 0x9A, 0x3A, 0xE0, 0xFF, 0x90, 0x9A, -+0x39, 0xE0, 0x2F, 0x12, 0xA7, 0xBA, 0xCF, 0x24, -+0x07, 0xCF, 0x34, 0x00, 0x12, 0xA3, 0x3F, 0xBF, -+0xDD, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, -+0x90, 0x9A, 0x72, 0x12, 0x84, 0x67, 0x90, 0x9A, -+0x75, 0x12, 0x9B, 0x5F, 0x75, 0x48, 0x10, 0x7B, -+0x01, 0x7A, 0x93, 0x79, 0xCD, 0x12, 0x69, 0xF5, -+0x90, 0x9A, 0x72, 0x12, 0x9B, 0x5F, 0x75, 0x48, -+0x10, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xDD, 0x12, -+0x69, 0xF5, 0x90, 0x9A, 0x78, 0x12, 0x04, 0xB8, -+0x90, 0x93, 0xED, 0x12, 0x04, 0x31, 0x90, 0x9A, -+0x7C, 0xE0, 0x90, 0x93, 0xF4, 0xF0, 0x22, 0xE4, -+0xFE, 0xED, 0x30, 0xE1, 0x11, 0x90, 0x01, 0x3F, -+0xE0, 0x30, 0xE2, 0x0A, 0x74, 0x04, 0xF0, 0x90, -+0x01, 0xC7, 0x74, 0x23, 0xF0, 0x0E, 0xED, 0x30, -+0xE0, 0x24, 0xEF, 0x30, 0xE6, 0x08, 0x90, 0x01, -+0xC7, 0x74, 0x22, 0xF0, 0x7E, 0x01, 0xEF, 0x30, -+0xE7, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x21, 0xF0, -+0x7E, 0x01, 0xEF, 0x30, 0xE5, 0x08, 0x90, 0x01, -+0xC7, 0x74, 0x23, 0xF0, 0x7E, 0x01, 0xAF, 0x06, -+0x22, 0x12, 0x02, 0x06, 0x90, 0x98, 0x05, 0x12, -+0x8E, 0xFE, 0x90, 0x98, 0x06, 0xF0, 0x22, 0xF1, -+0x3E, 0x90, 0x98, 0x07, 0x12, 0x8E, 0xFE, 0xFF, -+0xED, 0x2F, 0x90, 0x98, 0x08, 0x12, 0x8F, 0xED, -+0xFF, 0xED, 0x2F, 0x90, 0x98, 0x09, 0xF0, 0x12, -+0x8F, 0xF4, 0xFF, 0xED, 0x2F, 0x90, 0x98, 0x0A, -+0x12, 0x97, 0x30, 0xFF, 0xED, 0x2F, 0x90, 0x98, -+0x0B, 0x12, 0x96, 0x2D, 0xFF, 0xED, 0x2F, 0x90, -+0x98, 0x0C, 0xF1, 0x31, 0x90, 0x98, 0x0D, 0xF0, -+0x22, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, 0x1F, -+0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x22, 0x90, 0x02, -+0x09, 0xE0, 0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, -+0x05, 0xED, 0x2E, 0x22, 0xF1, 0x3E, 0x90, 0x98, -+0x0E, 0x12, 0x8E, 0xFE, 0xFF, 0xED, 0x2F, 0x90, -+0x98, 0x0F, 0x12, 0x8F, 0xED, 0xFF, 0xED, 0x2F, -+0x90, 0x98, 0x10, 0xF0, 0x12, 0x8F, 0xF4, 0xFF, -+0xED, 0x2F, 0x90, 0x98, 0x11, 0x12, 0x97, 0x30, -+0xFF, 0xED, 0x2F, 0x90, 0x98, 0x12, 0x12, 0x96, -+0x2D, 0xFF, 0xED, 0x2F, 0x90, 0x98, 0x13, 0xF1, -+0x31, 0x90, 0x98, 0x14, 0xF0, 0x22, 0xF1, 0x3E, -+0x90, 0x98, 0x15, 0x12, 0x8E, 0xFE, 0xFF, 0xAE, -+0x05, 0xED, 0x2F, 0x90, 0x98, 0x16, 0xF0, 0x22, -+0x12, 0x8F, 0xFA, 0x12, 0xD5, 0x67, 0x12, 0x8C, -+0x04, 0x12, 0xBF, 0xEB, 0x12, 0xC8, 0x96, 0x4E, -+0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x2F, 0x12, -+0x8E, 0xFF, 0x90, 0x98, 0x1D, 0x12, 0x8F, 0xED, -+0x90, 0x98, 0x1E, 0xF0, 0x12, 0x02, 0x06, 0xFF, -+0x54, 0x04, 0xFE, 0x90, 0x98, 0x1C, 0xE0, 0x54, -+0xFB, 0x4E, 0xF0, 0x12, 0x8F, 0xF4, 0x90, 0x98, -+0x1F, 0xF0, 0xEF, 0x54, 0x08, 0xFF, 0x90, 0x98, -+0x1C, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, -+0x19, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x98, -+0x06, 0xE0, 0xFF, 0xB4, 0x02, 0x08, 0x12, 0xF9, -+0x4C, 0x74, 0x08, 0xF0, 0x80, 0x09, 0xEF, 0xB4, -+0x04, 0x05, 0x31, 0x4C, 0x74, 0x10, 0xF0, 0x90, -+0x9A, 0x19, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x64, -+0x02, 0x4E, 0x60, 0x08, 0xEF, 0x64, 0x01, 0x4E, -+0x60, 0x02, 0x21, 0x3F, 0x90, 0x94, 0x36, 0xE0, -+0xFF, 0x64, 0xFE, 0x70, 0x02, 0x21, 0x3F, 0xEF, -+0x64, 0x02, 0x60, 0x07, 0xEF, 0x64, 0x03, 0x60, -+0x02, 0x21, 0x3F, 0x90, 0x94, 0x96, 0x31, 0x82, -+0x90, 0x9A, 0xA6, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0x7E, 0x00, 0x7F, 0x28, 0x7D, 0x00, 0x7B, 0x01, -+0x7A, 0x9A, 0x79, 0x3C, 0x12, 0x04, 0x80, 0x7E, -+0x00, 0x7F, 0x40, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -+0x9A, 0x79, 0x64, 0x12, 0x04, 0x80, 0x90, 0x9A, -+0x19, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, -+0x70, 0x4C, 0x75, 0x45, 0x01, 0x75, 0x46, 0x94, -+0x75, 0x47, 0x66, 0x75, 0x48, 0x10, 0x7B, 0x01, -+0x7A, 0x9A, 0x79, 0xA8, 0x31, 0x7B, 0x75, 0x46, -+0x94, 0x75, 0x47, 0x05, 0x75, 0x48, 0x10, 0x7B, -+0x01, 0x7A, 0x9A, 0x79, 0xB8, 0x12, 0x69, 0xF5, -+0x31, 0x5D, 0x74, 0x20, 0x31, 0x67, 0x90, 0x8F, -+0x3A, 0x31, 0x44, 0x90, 0x8F, 0x3D, 0x31, 0x54, -+0x90, 0x8F, 0x40, 0xF0, 0x7A, 0x9A, 0x79, 0xA8, -+0x12, 0x4C, 0x23, 0x75, 0x45, 0x01, 0x75, 0x46, -+0x9A, 0x75, 0x47, 0x64, 0x80, 0x24, 0x31, 0x5D, -+0x74, 0x10, 0x31, 0x67, 0x90, 0x91, 0x8C, 0x31, -+0x44, 0x90, 0x91, 0x8F, 0x31, 0x54, 0x90, 0x91, -+0x92, 0xF0, 0x7A, 0x94, 0x79, 0x05, 0x12, 0x61, -+0x34, 0x75, 0x45, 0x01, 0x75, 0x46, 0x9A, 0x75, -+0x47, 0x6C, 0x75, 0x48, 0x28, 0x7B, 0x01, 0x7A, -+0x9A, 0x79, 0x3C, 0x12, 0x69, 0xF5, 0x75, 0x45, -+0x01, 0x75, 0x46, 0x9A, 0x75, 0x47, 0x44, 0x75, -+0x48, 0x20, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x1B, -+0x12, 0x69, 0xF5, 0x90, 0x9A, 0x42, 0xE0, 0x54, -+0x03, 0x90, 0x9A, 0x3B, 0xF0, 0xC3, 0x94, 0x04, -+0x50, 0x1C, 0xE0, 0x90, 0x95, 0x5F, 0xF0, 0x75, -+0x45, 0x01, 0x75, 0x46, 0x9A, 0x75, 0x47, 0x1B, -+0x75, 0x48, 0x20, 0x7B, 0x01, 0x7A, 0x95, 0x79, -+0x3F, 0x12, 0x69, 0xF5, 0x80, 0x06, 0x90, 0x95, -+0x5F, 0x74, 0x05, 0xF0, 0x90, 0x9A, 0x3B, 0xE0, -+0xFF, 0x90, 0x98, 0x06, 0xE0, 0xFD, 0x7B, 0x01, -+0x7A, 0x9A, 0x79, 0x1B, 0x12, 0xB0, 0x55, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x12, 0x84, 0x67, 0x7A, -+0x9A, 0x79, 0x64, 0x22, 0x90, 0x9A, 0xA4, 0x74, -+0x80, 0xF0, 0xA3, 0x22, 0x12, 0x84, 0x67, 0x90, -+0x9A, 0xA6, 0xA3, 0xE0, 0x22, 0x90, 0x9A, 0xA6, -+0xA3, 0xE0, 0xFB, 0x90, 0x92, 0x06, 0x22, 0xF0, -+0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0xFC, 0xFF, -+0xFE, 0x12, 0x71, 0xD4, 0x7B, 0x01, 0x7A, 0x94, -+0x79, 0x98, 0x22, 0x12, 0x69, 0xF5, 0x75, 0x45, -+0x01, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFD, 0xED, -+0xFF, 0x22, 0x7F, 0x50, 0x7E, 0x0C, 0x12, 0x70, -+0x70, 0x90, 0x9A, 0xE5, 0xEF, 0xF0, 0x7F, 0x58, -+0x7E, 0x0C, 0x12, 0x70, 0x70, 0x90, 0x9A, 0xE6, -+0xEF, 0xF0, 0x90, 0x9C, 0x01, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x00, 0x7F, 0x90, 0x9C, 0x05, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x00, 0x17, 0x7F, 0x50, -+0x7E, 0x0C, 0x12, 0xBF, 0x0C, 0x12, 0x04, 0x3D, -+0x00, 0x00, 0x00, 0x7F, 0x90, 0x9C, 0x05, 0x12, -+0x04, 0x3D, 0x00, 0x00, 0x00, 0x17, 0x12, 0xBF, -+0x12, 0x90, 0x06, 0x08, 0xE0, 0x90, 0x9A, 0xFB, -+0xF0, 0x90, 0x06, 0xA1, 0xE0, 0xFE, 0x90, 0x06, -+0xA0, 0x12, 0xBA, 0x6E, 0x90, 0x9A, 0xFD, 0xF0, -+0xA3, 0xEF, 0x12, 0xCF, 0x91, 0x90, 0x06, 0xA0, -+0x74, 0x20, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0xE4, -+0xFD, 0xFF, 0x02, 0xBD, 0xBE, 0x12, 0xC7, 0x92, -+0x90, 0x9A, 0xE2, 0xE0, 0x64, 0x01, 0xF0, 0xE0, -+0x24, 0xFD, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xF9, -+0xA3, 0x12, 0xC5, 0x82, 0x02, 0xA1, 0x02, 0xED, -+0x14, 0x60, 0x06, 0x04, 0x70, 0x03, 0x7F, 0x01, -+0x22, 0x7F, 0x01, 0x22, 0x12, 0xC7, 0x92, 0xA3, -+0xED, 0xF0, 0x90, 0x95, 0x69, 0xE0, 0x70, 0x02, -+0xA3, 0xE0, 0x60, 0x2E, 0xE4, 0x90, 0x9A, 0x0E, -+0xF0, 0x51, 0x76, 0x50, 0x28, 0x12, 0xC5, 0x83, -+0xED, 0x24, 0x1C, 0x12, 0xC5, 0x18, 0x90, 0x9A, -+0x0E, 0xE0, 0x24, 0x77, 0xF5, 0x82, 0xE4, 0x34, -+0x95, 0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, -+0x00, 0x22, 0x90, 0x9A, 0x0E, 0xE0, 0x04, 0xF0, -+0x80, 0xD7, 0x7F, 0x00, 0x22, 0x90, 0x06, 0x32, -+0xE0, 0x44, 0x40, 0xF0, 0xE4, 0x90, 0x95, 0x75, -+0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x9A, -+0x0E, 0xE0, 0xFD, 0xC3, 0x94, 0x02, 0x22, 0x12, -+0xC7, 0x92, 0xE4, 0xA3, 0xF0, 0x90, 0x9A, 0x0D, -+0xE0, 0xFD, 0xC3, 0x94, 0x04, 0x50, 0x2A, 0x90, -+0x9A, 0x0C, 0xE0, 0x24, 0x10, 0xFF, 0x12, 0xA7, -+0x18, 0xFE, 0x12, 0xC5, 0x19, 0x90, 0x9A, 0x0D, -+0xE0, 0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, 0x95, -+0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, 0x00, -+0x22, 0x90, 0x9A, 0x0D, 0xE0, 0x04, 0xF0, 0x80, -+0xCC, 0x7F, 0x01, 0x22, 0x12, 0xC7, 0x92, 0x24, -+0x16, 0xFF, 0xE4, 0x3E, 0x12, 0xA3, 0x3F, 0x90, -+0x95, 0x73, 0xA3, 0xE0, 0xB5, 0x07, 0x1F, 0x90, -+0x9A, 0x0C, 0xE0, 0x24, 0x16, 0xFF, 0x12, 0xA7, -+0x18, 0xFE, 0x12, 0xAF, 0x02, 0x7D, 0x01, 0x12, -+0x04, 0x7E, 0xEF, 0xFD, 0x90, 0x95, 0x73, 0xE0, -+0x6D, 0x70, 0x01, 0xE4, 0x60, 0x03, 0x7F, 0x00, -+0x22, 0x7F, 0x01, 0x22, 0x90, 0x88, 0x8D, 0x74, -+0x18, 0xF0, 0xA3, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, -+0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, -+0xF0, 0x22, 0x12, 0xDF, 0x77, 0x40, 0x41, 0x90, -+0x88, 0x50, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, -+0xE0, 0xFF, 0x90, 0x88, 0x50, 0xE0, 0xD3, 0x9F, -+0x50, 0x2E, 0x90, 0x88, 0x48, 0xE0, 0x24, 0x08, -+0xF0, 0x90, 0x88, 0x3F, 0x12, 0xC6, 0x91, 0x33, -+0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0x88, 0x3E, -+0xE0, 0x2F, 0x90, 0x88, 0x4F, 0xF0, 0xFB, 0x90, -+0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, -+0x92, 0x98, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, -+0x22, 0x90, 0x93, 0x08, 0xE0, 0x30, 0xE0, 0x09, -+0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x02, 0x71, -+0x62, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x12, 0x7C, -+0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, -+0x90, 0x9C, 0x31, 0xE0, 0xFD, 0x90, 0x9C, 0x2F, -+0xE0, 0x2D, 0xFD, 0x90, 0x9C, 0x2E, 0xE0, 0x34, -+0x00, 0xCD, 0x24, 0x20, 0xCD, 0x34, 0x00, 0xFC, -+0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, -+0x90, 0x9C, 0x23, 0xE0, 0xFD, 0x12, 0x7B, 0x8B, -+0x90, 0x9C, 0x30, 0xEF, 0xF0, 0x22, 0x90, 0x9A, -+0x35, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x02, 0xE7, -+0x90, 0x9A, 0x35, 0xE4, 0x75, 0xF0, 0x08, 0x02, -+0x02, 0xE7, 0x90, 0x98, 0x0A, 0xE0, 0xFF, 0x90, -+0x92, 0x13, 0x74, 0x08, 0xF0, 0x7B, 0x18, 0x7D, -+0x01, 0x12, 0x66, 0xDB, 0x90, 0x9A, 0x30, 0xEF, -+0xF0, 0x90, 0x98, 0x0A, 0xE0, 0x22, 0xE0, 0xFF, -+0x24, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -+0x83, 0xE0, 0x90, 0x01, 0xB2, 0xF0, 0x74, 0x15, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0xE0, 0x90, 0x01, 0xB3, 0xF0, 0xE0, 0x22, 0xF0, -+0x74, 0x04, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x22, 0x90, 0x9A, 0x36, 0xE0, -+0x2F, 0xFF, 0x90, 0x9A, 0x35, 0xE0, 0x34, 0x00, -+0xFE, 0x90, 0x9A, 0xB9, 0xF0, 0x22, 0xE0, 0xC3, -+0x9F, 0xFF, 0xE4, 0x94, 0x00, 0xFE, 0xEF, 0x78, -+0x07, 0x22, 0x90, 0x9A, 0x32, 0xE0, 0xFF, 0x24, -+0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, -+0xE0, 0xFE, 0x22, 0x7D, 0x01, 0x7B, 0x01, 0x7A, -+0x93, 0x79, 0x4F, 0x7E, 0x00, 0x7F, 0x04, 0x12, -+0x86, 0x1C, 0xEF, 0x22, 0xFF, 0x90, 0x92, 0x07, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xE0, 0xC4, -+0x54, 0xF0, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, -+0x81, 0xF5, 0x83, 0xE0, 0x22, 0x35, 0xF0, 0xFA, -+0x7B, 0x01, 0x78, 0x13, 0x7C, 0x9A, 0x7D, 0x01, -+0x22, 0x7E, 0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, -+0x01, 0x7A, 0x93, 0x22, 0x90, 0x9A, 0x35, 0xE4, -+0x75, 0xF0, 0x02, 0x02, 0x02, 0xE7, 0xE4, 0xFF, -+0x12, 0x98, 0x60, 0x90, 0x04, 0x1F, 0x74, 0x20, -+0x22, 0x90, 0x98, 0x37, 0xE0, 0xFF, 0x90, 0x98, -+0x36, 0xE0, 0x4F, 0x22, 0xFD, 0x12, 0x7B, 0x8B, -+0x90, 0x9A, 0x30, 0xEF, 0xF0, 0x22, 0xE0, 0x90, -+0x01, 0xBA, 0xF0, 0x90, 0x88, 0x38, 0xE0, 0x22, -+0x75, 0x46, 0x94, 0x75, 0x47, 0x3C, 0x75, 0x48, -+0x02, 0x22, 0x74, 0xC9, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0x95, 0x22, 0x90, 0x9A, 0x32, 0xE0, 0xFF, -+0xC3, 0x94, 0x10, 0x22, 0x90, 0x9C, 0x2D, 0xE0, -+0xFF, 0xC3, 0x94, 0x08, 0x22, 0x90, 0x9A, 0xDC, -+0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x7D, 0x01, 0x7F, -+0x02, 0x02, 0x7C, 0x74, 0x90, 0x88, 0x3C, 0xE0, -+0x90, 0x05, 0x73, 0x22, 0x90, 0x9A, 0xBC, 0xE0, -+0xC3, 0x94, 0x0A, 0x22, 0x74, 0x10, 0xF0, 0x7A, -+0x93, 0x79, 0xF5, 0x22, 0x12, 0x84, 0x67, 0x7A, -+0x9A, 0x79, 0x1C, 0x22, 0xF0, 0xA3, 0xED, 0xF0, -+0xA3, 0xEB, 0xF0, 0x22, 0xF0, 0x90, 0x9C, 0x2D, -+0xE0, 0x04, 0xF0, 0x22, 0xFB, 0x90, 0x92, 0x06, -+0x74, 0x08, 0xF0, 0x22, 0x90, 0x9C, 0x2E, 0xA3, -+0xE0, 0x24, 0xF8, 0x22, 0x27, 0xB4 -+}; -+ -+u4Byte array_length_mp_8723d_fw_wowlan = 32054; -+ -+#endif -+ -+#endif /* end of LOAD_FW_HEADER_FROM_DRIVER */ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.h linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.h ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/hal8723d_fw.h 2018-02-11 21:44:27.163146330 +0200 -@@ -0,0 +1,43 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2016 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* You should have received a copy of the GNU General Public License along with -+* this program; if not, write to the Free Software Foundation, Inc., -+* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+* -+* -+******************************************************************************/ -+ -+#ifdef CONFIG_RTL8723D -+ -+#ifndef _FW_HEADER_8723D_H -+#define _FW_HEADER_8723D_H -+ -+#ifdef LOAD_FW_HEADER_FROM_DRIVER -+#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) -+extern u8 array_mp_8723d_fw_ap[23862]; -+extern u32 array_length_mp_8723d_fw_ap; -+#endif -+ -+#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -+extern u8 array_mp_8723d_fw_nic[27506]; -+extern u32 array_length_mp_8723d_fw_nic; -+extern u8 array_mp_8723d_fw_wowlan[32334]; -+extern u32 array_length_mp_8723d_fw_wowlan; -+#endif -+#endif /* end of LOAD_FW_HEADER_FROM_DRIVER */ -+ -+#endif -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/Hal8723DPwrSeq.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/Hal8723DPwrSeq.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/Hal8723DPwrSeq.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/Hal8723DPwrSeq.c 2018-02-11 21:44:27.162146314 +0200 -@@ -0,0 +1,91 @@ -+ -+/*++ -+Copyright (c) Realtek Semiconductor Corp. All rights reserved. -+ -+Module Name: -+ Hal8821PwrSeq.c -+ -+Abstract: -+ This file includes all kinds of Power Action event for RTL8821A and corresponding hardware configurtions which are released from HW SD. -+ -+Major Change History: -+ When Who What -+ ---------- --------------- ------------------------------- -+ 2011-08-08 Roger Create. -+ -+--*/ -+ -+#include "Mp_Precomp.h" -+ -+#if WPP_SOFTWARE_TRACE -+ #include "Hal8723DPwrSeq.tmh" -+#endif -+ -+#include "Hal8723DPwrSeq.h" -+ -+ -+/* -+ drivers should parse below arrays and do the corresponding actions -+*/ -+/* 3 Power on Array */ -+WLAN_PWR_CFG rtl8723D_power_on_flow[RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS] = { -+ RTL8723D_TRANS_CARDEMU_TO_ACT -+ RTL8723D_TRANS_END -+}; -+ -+/* 3Radio off GPIO Array */ -+WLAN_PWR_CFG rtl8723D_radio_off_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_END_STEPS] = { -+ RTL8723D_TRANS_ACT_TO_CARDEMU -+ RTL8723D_TRANS_END -+}; -+ -+/* 3Card Disable Array */ -+WLAN_PWR_CFG rtl8723D_card_disable_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_CARDDIS_STEPS + RTL8723D_TRANS_END_STEPS] = { -+ RTL8723D_TRANS_ACT_TO_CARDEMU -+ RTL8723D_TRANS_CARDEMU_TO_CARDDIS -+ RTL8723D_TRANS_END -+}; -+ -+/* 3 Card Enable Array */ -+WLAN_PWR_CFG rtl8723D_card_enable_flow[RTL8723D_TRANS_CARDDIS_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS] = { -+ RTL8723D_TRANS_CARDDIS_TO_CARDEMU -+ RTL8723D_TRANS_CARDEMU_TO_ACT -+ RTL8723D_TRANS_END -+}; -+ -+/* 3Suspend Array */ -+WLAN_PWR_CFG rtl8723D_suspend_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_SUS_STEPS + RTL8723D_TRANS_END_STEPS] = { -+ RTL8723D_TRANS_ACT_TO_CARDEMU -+ RTL8723D_TRANS_CARDEMU_TO_SUS -+ RTL8723D_TRANS_END -+}; -+ -+/* 3 Resume Array */ -+WLAN_PWR_CFG rtl8723D_resume_flow[RTL8723D_TRANS_SUS_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS] = { -+ RTL8723D_TRANS_SUS_TO_CARDEMU -+ RTL8723D_TRANS_CARDEMU_TO_ACT -+ RTL8723D_TRANS_END -+}; -+ -+ -+ -+/* 3HWPDN Array */ -+WLAN_PWR_CFG rtl8723D_hwpdn_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723D_TRANS_END_STEPS] = { -+ RTL8723D_TRANS_ACT_TO_CARDEMU -+ RTL8723D_TRANS_CARDEMU_TO_PDN -+ RTL8723D_TRANS_END -+}; -+ -+/* 3 Enter LPS */ -+WLAN_PWR_CFG rtl8723D_enter_lps_flow[RTL8723D_TRANS_ACT_TO_LPS_STEPS + RTL8723D_TRANS_END_STEPS] = { -+ /* FW behavior */ -+ RTL8723D_TRANS_ACT_TO_LPS -+ RTL8723D_TRANS_END -+}; -+ -+/* 3 Leave LPS */ -+WLAN_PWR_CFG rtl8723D_leave_lps_flow[RTL8723D_TRANS_LPS_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS] = { -+ /* FW behavior */ -+ RTL8723D_TRANS_LPS_TO_ACT -+ RTL8723D_TRANS_END -+}; -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_halinit.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_halinit.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_halinit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_halinit.c 2018-02-11 21:44:27.163146330 +0200 -@@ -0,0 +1,2255 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _HCI_HAL_INIT_C_ -+ -+#include -+ -+ -+/* For Two MAC FPGA verify we must disable all MAC/BB/RF setting */ -+#define FPGA_UNKNOWN 0 -+#define FPGA_2MAC 1 -+#define FPGA_PHY 2 -+#define ASIC 3 -+#define BOARD_TYPE ASIC -+ -+#if BOARD_TYPE == FPGA_2MAC -+#else /* FPGA_PHY and ASIC */ -+ #define FPGA_RF_UNKNOWN 0 -+ #define FPGA_RF_8225 1 -+ #define FPGA_RF_0222D 2 -+ #define FPGA_RF FPGA_RF_0222D -+#endif -+ -+/* -+ * Description: -+ * ePHY Read operation on RTL8723DE -+ * -+ * Created by Roger, 2013.05.08. -+ */ -+static u2Byte hal_MDIORead_8723DE( -+ IN PADAPTER Adapter, -+ IN u1Byte Addr) -+{ -+ u2Byte ret = 0; -+ u1Byte tmpU1b = 0, count = 0; -+ -+ rtw_write8(Adapter, REG_PCIE_MIX_CFG_8723D, Addr | BIT(6)); -+ tmpU1b = rtw_read8(Adapter, REG_PCIE_MIX_CFG_8723D) & BIT(6); -+ count = 0; -+ while (tmpU1b && count < 20) { -+ rtw_udelay_os(10); -+ tmpU1b = rtw_read8(Adapter, REG_PCIE_MIX_CFG_8723D) & BIT(6); -+ count++; -+ } -+ if (0 == tmpU1b) { -+ /* */ -+ ret = rtw_read16(Adapter, REG_MDIO_V1_8723D + 2); -+ } -+ -+ return ret; -+} -+ -+/* -+ * Description: -+ * ePHY Write operation on RTL8723DE -+ * -+ * Created by Roger, 2013.05.08. -+ */ -+static VOID hal_MDIOWrite_8723DE( -+ IN PADAPTER Adapter, -+ IN u1Byte Addr, -+ IN u2Byte Data) -+{ -+ u1Byte tmpU1b = 0, count = 0; -+ -+ rtw_write16(Adapter, REG_MDIO_V1_8723D, Data); -+ rtw_write8(Adapter, REG_PCIE_MIX_CFG_8723D, Addr | BIT(5)); -+ tmpU1b = rtw_read8(Adapter, REG_PCIE_MIX_CFG_8723D) & BIT(5); -+ count = 0; -+ while (tmpU1b && count < 20) { -+ rtw_udelay_os(10); -+ tmpU1b = rtw_read8(Adapter, REG_PCIE_MIX_CFG_8723D) & BIT(5); -+ count++; -+ } -+} -+ -+/* ------------------------------------------------------------------- */ -+/* */ -+/* EEPROM Content Parsing */ -+/* */ -+/* ------------------------------------------------------------------- */ -+ -+static VOID -+Hal_ReadPROMContent_BT_8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ -+#if MP_DRIVER == 1 -+ if (Adapter->registrypriv.mp_mode == 1) -+ EFUSE_ShadowMapUpdate(Adapter, EFUSE_BT, _FALSE); -+#endif -+ -+} -+ -+static VOID -+hal_ReadIDs_8723DE( -+ IN PADAPTER Adapter, -+ IN u8 *PROMContent, -+ IN BOOLEAN AutoloadFail -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if (!AutoloadFail) { -+ /* VID, DID */ -+ pHalData->EEPROMVID = ReadLE2Byte(&PROMContent[EEPROM_VID_8723DE]); -+ pHalData->EEPROMDID = ReadLE2Byte(&PROMContent[EEPROM_DID_8723DE]); -+ pHalData->EEPROMSVID = ReadLE2Byte(&PROMContent[EEPROM_SVID_8723DE]); -+ pHalData->EEPROMSMID = ReadLE2Byte(&PROMContent[EEPROM_SMID_8723DE]); -+ -+ /* Customer ID, 0x00 and 0xff are reserved for Realtek. */ -+ pHalData->EEPROMCustomerID = *(u8 *)&PROMContent[EEPROM_CustomID_8723D]; -+ if (pHalData->EEPROMCustomerID == 0xFF) -+ pHalData->EEPROMCustomerID = EEPROM_Default_CustomerID_8188E; -+ pHalData->EEPROMSubCustomerID = EEPROM_Default_SubCustomerID; -+ } else { -+ pHalData->EEPROMVID = 0; -+ pHalData->EEPROMDID = 0; -+ pHalData->EEPROMSVID = 0; -+ pHalData->EEPROMSMID = 0; -+ -+ /* Customer ID, 0x00 and 0xff are reserved for Realtek. */ -+ pHalData->EEPROMCustomerID = EEPROM_Default_CustomerID; -+ pHalData->EEPROMSubCustomerID = EEPROM_Default_SubCustomerID; -+ } -+ -+ RTW_INFO("VID = 0x%04X, DID = 0x%04X\n", pHalData->EEPROMVID, pHalData->EEPROMDID); -+ RTW_INFO("SVID = 0x%04X, SMID = 0x%04X\n", pHalData->EEPROMSVID, pHalData->EEPROMSMID); -+} -+ -+static VOID -+Hal_ReadEfusePCIeCap8723DE( -+ IN PADAPTER Adapter, -+ IN u8 *PROMContent, -+ IN BOOLEAN AutoloadFail -+) -+{ -+ u8 AspmOscSupport = RT_PCI_ASPM_OSC_IGNORE; -+ u16 PCIeCap = 0; -+ -+ if (!AutoloadFail) { -+ PCIeCap = PROMContent[EEPROM_PCIE_DEV_CAP_01] | -+ (PROMContent[EEPROM_PCIE_DEV_CAP_02] << 8); -+ -+ RTW_INFO("Hal_ReadEfusePCIeCap8723DE(): PCIeCap = %#x\n", PCIeCap); -+ -+ /* */ -+ /* We shall take L0S/L1 accept latency into consideration for ASPM Configuration policy, 2013.03.27. */ -+ /* L1 accept Latency: 0x8d from PCI CFG space offset 0x75 */ -+ /* L0S accept Latency: 0x80 from PCI CFG space offset 0x74 */ -+ /* */ -+ if (PCIeCap == 0x8d80) -+ AspmOscSupport |= RT_PCI_ASPM_OSC_ENABLE; -+ else -+ AspmOscSupport |= RT_PCI_ASPM_OSC_DISABLE; -+ } -+ -+ rtw_hal_set_def_var(Adapter, HAL_DEF_PCI_ASPM_OSC, (u8 *)&AspmOscSupport); -+ RTW_INFO("Hal_ReadEfusePCIeCap8723DE(): AspmOscSupport = %d\n", AspmOscSupport); -+} -+ -+static VOID -+hal_CustomizedBehavior_8723DE( -+ PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct led_priv *pledpriv = &(Adapter->ledpriv); -+ -+ pledpriv->LedStrategy = SW_LED_MODE7; /* Default LED strategy. */ -+ pHalData->bLedOpenDrain = _TRUE;/* Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. */ -+ -+ switch (pHalData->CustomerID) { -+ case RT_CID_DEFAULT: -+ break; -+ -+ case RT_CID_CCX: -+ /* pMgntInfo->IndicateByDeauth = _TRUE; */ -+ break; -+ -+ case RT_CID_WHQL: -+ /* Adapter->bInHctTest = _TRUE; */ -+ break; -+ -+ default: -+ /* RTW_INFO("Unknown hardware Type\n"); */ -+ break; -+ } -+ RTW_INFO("hal_CustomizedBehavior_8723DE(): RT Customized ID: 0x%02X\n", pHalData->CustomerID); -+ -+#if 0 -+ if (Adapter->bInHctTest) { -+ pMgntInfo->PowerSaveControl.bInactivePs = FALSE; -+ pMgntInfo->PowerSaveControl.bIPSModeBackup = FALSE; -+ pMgntInfo->PowerSaveControl.bLeisurePs = FALSE; -+ pMgntInfo->PowerSaveControl.bLeisurePsModeBackup = FALSE; -+ pMgntInfo->keepAliveLevel = 0; -+ } -+#endif -+} -+ -+static VOID -+hal_CustomizeByCustomerID_8723DE( -+ IN PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ /* If the customer ID had been changed by registry, do not cover up by EEPROM. */ -+ if (pHalData->CustomerID == RT_CID_DEFAULT) { -+ switch (pHalData->EEPROMCustomerID) { -+ default: -+ pHalData->CustomerID = RT_CID_DEFAULT; -+ break; -+ -+ } -+ } -+ RTW_INFO("MGNT Customer ID: 0x%2x\n", pHalData->CustomerID); -+ -+ hal_CustomizedBehavior_8723DE(pAdapter); -+} -+ -+ -+static VOID -+InitAdapterVariablesByPROM_8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ /* RTW_INFO("InitAdapterVariablesByPROM_8723DE()!!\n"); */ -+ -+ Hal_InitPGData(Adapter, pHalData->efuse_eeprom_data); -+ Hal_EfuseParseIDCode(Adapter, pHalData->efuse_eeprom_data); -+ -+ Hal_EfuseParseEEPROMVer_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ hal_ReadIDs_8723DE(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ hal_config_macaddr(Adapter, pHalData->bautoload_fail_flag); -+ Hal_EfuseParseTxPowerInfo_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ Hal_ReadEfusePCIeCap8723DE(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ -+ /* */ -+ /* Read Bluetooth co-exist and initialize */ -+ /* */ -+ Hal_EfuseParseBTCoexistInfo_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ -+ Hal_EfuseParseChnlPlan_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ Hal_EfuseParseXtal_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ Hal_EfuseParsePackageType_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ Hal_EfuseParseThermalMeter_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ Hal_EfuseParseAntennaDiversity_8723D(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+ hal_CustomizeByCustomerID_8723DE(Adapter); -+ -+#ifdef CONFIG_RF_POWER_TRIM -+ Hal_ReadRFGainOffset(Adapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); -+#endif /* CONFIG_RF_GAIN_OFFSET */ -+ -+#ifdef CONFIG_RTW_MAC_HIDDEN_RPT -+ hal_read_mac_hidden_rpt(Adapter); -+#endif -+} -+ -+static VOID -+Hal_ReadPROMContent_8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ u8 eeValue; -+ -+ -+ eeValue = rtw_read8(Adapter, REG_9346CR); -+ /* To check system boot selection. */ -+ pHalData->EepromOrEfuse = (eeValue & BOOT_FROM_EEPROM) ? _TRUE : _FALSE; -+ pHalData->bautoload_fail_flag = (eeValue & EEPROM_EN) ? _FALSE : _TRUE; -+ -+ RTW_INFO("Boot from %s, Autoload %s !\n", (pHalData->EepromOrEfuse ? "EEPROM" : "EFUSE"), -+ (pHalData->bautoload_fail_flag ? "Fail" : "OK")); -+ -+ /* pHalData->EEType = IS_BOOT_FROM_EEPROM(Adapter) ? EEPROM_93C46 : EEPROM_BOOT_EFUSE; */ -+ -+ InitAdapterVariablesByPROM_8723DE(Adapter); -+} -+ -+static void ReadRFType8723DE(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+#if DISABLE_BB_RF -+ pHalData->rf_chip = RF_PSEUDO_11N; -+ pHalData->rf_type = RF_1T1R; -+#else -+ pHalData->rf_chip = RF_6052; -+ pHalData->rf_type = RF_1T1R; -+#endif -+} -+ -+static void ReadAdapterInfo8723DE(PADAPTER Adapter) -+{ -+ /* Read EEPROM size before call any EEPROM function */ -+ Adapter->EepromAddressSize = GetEEPROMSize8723D(Adapter); -+ -+ /* For debug test now!!!!! */ -+ PHY_RFShadowRefresh(Adapter); -+ -+ /* Read all content in Efuse/EEPROM. */ -+ Hal_ReadPROMContent_8723DE(Adapter); -+ -+ Hal_ReadPROMContent_BT_8723DE(Adapter); -+ -+ /* We need to define the RF type after all PROM value is recognized. */ -+ ReadRFType8723DE(Adapter); -+} -+ -+ -+void rtl8723de_interface_configure(PADAPTER Adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); -+ u16 val_16 = 0; -+ u8 ClkDelayCount = 4; /* default: 4, range: 0~15 */ -+ -+ /* /close ASPM for AMD defaultly */ -+ pdvobjpriv->const_amdpci_aspm = 0; -+ -+ /* / ASPM PS mode. */ -+ /* / 0 - Disable ASPM, 1 - Enable ASPM without Clock Req, */ -+ /* / 2 - Enable ASPM with Clock Req, 3- Alwyas Enable ASPM with Clock Req, */ -+ /* / 4- Always Enable ASPM without Clock Req. */ -+ /* / set default to rtl8188ee:3 RTL8192E:2 */ -+ pdvobjpriv->const_pci_aspm = 0; -+ -+ /* / Setting for PCI-E device */ -+ pdvobjpriv->const_devicepci_aspm_setting = 0x03; -+ -+ /* / Setting for PCI-E bridge */ -+ pdvobjpriv->const_hostpci_aspm_setting = 0x03; -+ -+ /* / In Hw/Sw Radio Off situation. */ -+ /* / 0 - Default, 1 - From ASPM setting without low Mac Pwr, */ -+ /* / 2 - From ASPM setting with low Mac Pwr, 3 - Bus D3 */ -+ /* / set default to RTL8192CE:0 RTL8192SE:2 */ -+ pdvobjpriv->const_hwsw_rfoff_d3 = 0; -+ -+ /* / This setting works for those device with backdoor ASPM setting such as EPHY setting. */ -+ /* / 0: Not support ASPM, 1: Support ASPM, 2: According to chipset. */ -+ pdvobjpriv->const_support_pciaspm = 1; -+ -+ pwrpriv->reg_rfoff = 0; -+ pwrpriv->rfoff_reason = 0; -+ -+ pHalData->bL1OffSupport = _FALSE; -+ -+ if(!IS_A_CUT(pHalData->VersionID) && !IS_B_CUT(pHalData->VersionID)) { -+ val_16 = hal_MDIORead_8723DE(Adapter, 0x9); -+ hal_MDIOWrite_8723DE(Adapter, 0x9, val_16 & (~BIT14)); -+ } -+ -+ /*test 0x8[15:12] = 2*/ -+ val_16 = hal_MDIORead_8723DE(Adapter, 0x8); -+ val_16 &= 0x0FFF; -+ val_16 |= (ClkDelayCount << 12); -+ /*val_16 |= 0x2000;*/ -+ /*val_16 &= 0x2fff;*/ -+ hal_MDIOWrite_8723DE(Adapter, 0x8, val_16); -+ -+} -+ -+VOID -+DisableInterrupt8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ -+ rtw_write32(Adapter, REG_HIMR0_8723D, IMR_DISABLED_8723D); -+ -+ rtw_write32(Adapter, REG_HIMR1_8723D, IMR_DISABLED_8723D); /* by tynli */ -+ -+ pdvobjpriv->irq_enabled = 0; -+} -+ -+VOID -+ClearInterrupt8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u32 tmp = 0; -+ -+ tmp = rtw_read32(Adapter, REG_HISR0_8723D); -+ rtw_write32(Adapter, REG_HISR0_8723D, tmp); -+ pHalData->IntArray[0] = 0; -+ -+ tmp = rtw_read32(Adapter, REG_HISR1_8723D); -+ rtw_write32(Adapter, REG_HISR1_8723D, tmp); -+ pHalData->IntArray[1] = 0; -+ -+ tmp = rtw_read32(Adapter, REG_HSISR_8723D); -+ rtw_write32(Adapter, REG_HSISR_8723D, tmp); -+ pHalData->SysIntArray[0] = 0; -+} -+ -+ -+VOID -+EnableInterrupt8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ -+ pdvobjpriv->irq_enabled = 1; -+ -+ rtw_write32(Adapter, REG_HIMR0_8723D, pHalData->IntrMask[0] & 0xFFFFFFFF); -+ -+ rtw_write32(Adapter, REG_HIMR1_8723D, pHalData->IntrMask[1] & 0xFFFFFFFF); -+ -+ rtw_write32(Adapter, REG_HSISR_8723D, pHalData->SysIntrMask[0] & 0xFFFFFFFF); -+} -+ -+BOOLEAN -+InterruptRecognized8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ BOOLEAN bRecognized = _FALSE; -+ -+ /* 2013.11.18 Glayrainx suggests that turn off IMR and */ -+ /* restore after cleaning ISR. */ -+ rtw_write32(Adapter, REG_HIMR0_8723D, 0); -+ rtw_write32(Adapter, REG_HIMR1_8723D, 0); -+ -+ pHalData->IntArray[0] = rtw_read32(Adapter, REG_HISR0_8723D); -+ pHalData->IntArray[0] &= pHalData->IntrMask[0]; -+ rtw_write32(Adapter, REG_HISR0_8723D, pHalData->IntArray[0]); -+ -+ /* For HISR extension. Added by tynli. 2009.10.07. */ -+ pHalData->IntArray[1] = rtw_read32(Adapter, REG_HISR1_8723D); -+ pHalData->IntArray[1] &= pHalData->IntrMask[1]; -+ rtw_write32(Adapter, REG_HISR1_8723D, pHalData->IntArray[1]); -+ -+ if (((pHalData->IntArray[0]) & pHalData->IntrMask[0]) != 0 || -+ ((pHalData->IntArray[1]) & pHalData->IntrMask[1]) != 0) -+ bRecognized = _TRUE; -+ -+ rtw_write32(Adapter, REG_HIMR0_8723D, pHalData->IntrMask[0] & 0xFFFFFFFF); -+ rtw_write32(Adapter, REG_HIMR1_8723D, pHalData->IntrMask[1] & 0xFFFFFFFF); -+ -+ return bRecognized; -+} -+ -+VOID -+UpdateInterruptMask8723DE( -+ IN PADAPTER Adapter, -+ IN u32 AddMSR, u32 AddMSR1, -+ IN u32 RemoveMSR, u32 RemoveMSR1 -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ DisableInterrupt8723DE(Adapter); -+ -+ if (AddMSR) -+ pHalData->IntrMask[0] |= AddMSR; -+ -+ if (AddMSR1) -+ pHalData->IntrMask[1] |= AddMSR1; -+ -+ if (RemoveMSR) -+ pHalData->IntrMask[0] &= (~RemoveMSR); -+ -+ if (RemoveMSR1) -+ pHalData->IntrMask[1] &= (~RemoveMSR1); -+ -+ EnableInterrupt8723DE(Adapter); -+} -+ -+static VOID -+HwConfigureRTL8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u32 regRRSR = 0; -+ -+ -+ /* 1 This part need to modified according to the rate set we filtered!! */ -+ /* */ -+ /* Set RRSR, RATR, and BW_OPMODE registers */ -+ /* */ -+ switch (pHalData->CurrentWirelessMode) { -+ case WIRELESS_MODE_B: -+ regRRSR = RATE_ALL_CCK; -+ break; -+ case WIRELESS_MODE_G: -+ regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; -+ break; -+ case WIRELESS_MODE_AUTO: -+ case WIRELESS_MODE_N_24G: -+ regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; -+ break; -+ default: -+ break; -+ } -+ -+ /* Init value for RRSR. */ -+ rtw_write32(Adapter, REG_RRSR, regRRSR); -+ -+ /* ARFB table 9 for 11ac 5G 2SS */ -+ rtw_write32(Adapter, REG_ARFR0_8723D, 0x00000010); -+ rtw_write32(Adapter, REG_ARFR0_8723D + 4, 0x3e0ff000); -+ -+ /* ARFB table 10 for 11ac 5G 1SS */ -+ rtw_write32(Adapter, REG_ARFR1_8723D, 0x00000010); -+ rtw_write32(Adapter, REG_ARFR1_8723D + 4, 0x000ff000); -+ -+ /* Set SLOT time Reg518 0x9 */ -+ rtw_write8(Adapter, REG_SLOT_8723D, 0x09); -+ -+ /* CF-End setting. */ -+ rtw_write16(Adapter, REG_FWHW_TXQ_CTRL_8723D, 0x1F00); -+ -+ /* Set retry limit */ -+ /* 3vivi, 20100928, especially for DTM, performance_ext, To avoid asoc too long to another AP more than 4.1 seconds. */ -+ /* 3we find retry 7 times maybe not enough, so we retry more than 7 times to pass DTM. */ -+ /* if(pMgntInfo->bPSPXlinkMode) */ -+ /* { */ -+ /* pHalData->ShortRetryLimit = 3; */ -+ /* pHalData->LongRetryLimit = 3; */ -+ /* Set retry limit */ -+ /* rtw_write16(Adapter, REG_RL, 0x0303); */ -+ /* } */ -+ /* else */ -+ rtw_write16(Adapter, REG_RL, 0x0707); -+ -+ /* BAR settings */ -+ rtw_write32(Adapter, REG_BAR_MODE_CTRL_8723D, 0x0201ffff); -+ -+ /* Set Data / Response auto rate fallack retry count */ -+ rtw_write32(Adapter, REG_DARFRC, 0x01000000); -+ rtw_write32(Adapter, REG_DARFRC + 4, 0x07060504); -+ rtw_write32(Adapter, REG_RARFRC, 0x01000000); -+ rtw_write32(Adapter, REG_RARFRC + 4, 0x07060504); -+ -+ /* Beacon related, for rate adaptive */ -+ rtw_write8(Adapter, REG_ATIMWND_8723D, 0x2); -+ -+ rtw_write8(Adapter, REG_BCN_MAX_ERR_8723D, 0xff); -+ -+ /* 20100211 Joseph: Change original setting of BCN_CTRL(0x550) from */ -+ /* 0x1e(0x2c for test chip) ro 0x1f(0x2d for test chip). Set BIT0 of this register disable ATIM */ -+ /* function. Since we do not use HIGH_QUEUE anymore, ATIM function is no longer used. */ -+ /* Also, enable ATIM function may invoke HW Tx stop operation. This may cause ping failed */ -+ /* sometimes in long run test. So just disable it now. */ -+ /* PlatformAtomicExchange((pu4Byte)(&pHalData->RegBcnCtrlVal), 0x1d); */ -+ pHalData->RegBcnCtrlVal = 0x1d; -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_write16(Adapter, REG_BCN_CTRL, 0x1818); /* For 2 PORT TSF SYNC */ -+#else -+ rtw_write8(Adapter, REG_BCN_CTRL, (u8)(pHalData->RegBcnCtrlVal)); -+#endif -+ -+ /* BCN_CTRL1 Reg551 0x10 */ -+ -+ /* TBTT prohibit hold time. Suggested by designer TimChen. */ -+ rtw_write8(Adapter, REG_TBTT_PROHIBIT + 1, 0xff); /* 8 ms */ -+ -+ /* 3 Note */ -+ rtw_write8(Adapter, REG_PIFS_8723D, 0); -+ rtw_write8(Adapter, REG_AGGR_BREAK_TIME_8723D, 0x16); -+ -+ rtw_write16(Adapter, REG_NAV_PROT_LEN_8723D, 0x0040); -+ rtw_write16(Adapter, REG_PROT_MODE_CTRL_8723D, 0x08ff); -+ -+ if (!Adapter->registrypriv.wifi_spec) { -+ /* For Rx TP. Suggested by SD1 Richard. Added by tynli. 2010.04.12. */ -+ rtw_write32(Adapter, REG_FAST_EDCA_CTRL, 0x03086666); -+ } else { -+ /* For WiFi WMM. suggested by timchen. Added by tynli. */ -+ rtw_write32(Adapter, REG_FAST_EDCA_CTRL, 0x0); -+ } -+ -+ /* ACKTO for IOT issue. */ -+ rtw_write8(Adapter, REG_ACKTO_8723D, 0x40); -+ -+ -+ /* Set Spec SIFS (used in NAV) */ -+ /* 92d all set these register 0x1010, check it later */ -+ rtw_write16(Adapter, REG_SPEC_SIFS_8723D, 0x100a); -+ rtw_write16(Adapter, REG_MAC_SPEC_SIFS_8723D, 0x100a); -+ -+ /* Set SIFS for CCK */ -+ rtw_write16(Adapter, REG_SIFS_CTX_8723D, 0x100a); -+ -+ /* Set SIFS for OFDM */ -+ rtw_write16(Adapter, REG_SIFS_TRX_8723D, 0x100a); -+ -+ -+ -+ /* 3 Note Data sheet don't define */ -+ rtw_write8(Adapter, 0x4C7, 0x80); -+ -+ rtw_write8(Adapter, REG_RX_PKT_LIMIT_8723D, 0x17); -+ -+ rtw_write8(Adapter, REG_MAX_AGGR_NUM_8723D, 0x0A); -+ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8723D, 0x1C); -+ -+ /* Set Multicast Address. 2009.01.07. by tynli. */ -+ rtw_write32(Adapter, REG_MAR_8723D, 0xffffffff); -+ rtw_write32(Adapter, REG_MAR_8723D + 4, 0xffffffff); -+ -+ /* end of win drv */ -+ -+#if 1 -+ -+ /* TXOP */ -+ rtw_write32(Adapter, REG_EDCA_BE_PARAM, 0x005EA42B); -+ rtw_write32(Adapter, REG_EDCA_BK_PARAM, 0x0000A44F); -+ rtw_write32(Adapter, REG_EDCA_VI_PARAM, 0x005EA324); -+ rtw_write32(Adapter, REG_EDCA_VO_PARAM, 0x002FA226); -+#endif -+ -+ /*rtw_write8(Adapter, REG_HT_SINGLE_AMPDU_8723D, 0x80);*/ -+ -+ /*#if (OMNIPEEK_SNIFFER_ENABLED == 1)*/ -+ /* For sniffer parsing legacy rate bandwidth information -+ PHY_SetBBReg(Adapter, 0x834, BIT(26), 0x0); */ -+ /*#endif*/ -+ -+#if (HAL_MAC_ENABLE == 0) -+ rtw_write32(Adapter, REG_MAR, 0xffffffff); -+ rtw_write32(Adapter, REG_MAR + 4, 0xffffffff); -+#endif -+} -+ -+static u32 _InitPowerOn_8723DE(PADAPTER Adapter) -+{ -+#ifdef CONFIG_BT_COEXIST -+ u8 value8; -+ u16 value16; -+ u32 value32; -+#endif -+ u32 status = _SUCCESS; -+ u8 tmpU1b; -+ u16 tmpU2b; -+ u8 bMacPwrCtrlOn = _FALSE; -+ u32 tmp4Byte; -+ -+ rtw_hal_get_hwreg(Adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if (bMacPwrCtrlOn == _TRUE) -+ return _SUCCESS; -+ -+ rtw_write8(Adapter, REG_RSV_CTRL, 0x0); -+ -+ tmp4Byte = rtw_read32(Adapter, REG_SYS_CFG); -+ -+ if (tmp4Byte & BIT(24)) /* LDO */ -+ rtw_write8(Adapter, 0x7C, 0xC3); -+ else /* SPS */ -+ rtw_write8(Adapter, 0x7C, 0x83); -+ -+ /* HW Power on sequence */ -+ if (!HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, rtl8723D_card_enable_flow)) -+ return _FAIL; -+ -+ /* Release MAC IO register reset */ -+ tmpU1b = rtw_read8(Adapter, REG_CR); -+ tmpU1b = 0xff; -+ rtw_write8(Adapter, REG_CR, tmpU1b); -+ rtw_mdelay_os(2); -+ -+ tmpU1b = 0x7f; -+ rtw_write8(Adapter, REG_HWSEQ_CTRL, tmpU1b); -+ rtw_mdelay_os(2); -+ -+ /* Add for wakeup online */ -+ tmpU1b = rtw_read8(Adapter, REG_SYS_CLKR); -+ rtw_write8(Adapter, REG_SYS_CLKR, (tmpU1b | BIT(3))); -+ tmpU1b = rtw_read8(Adapter, REG_GPIO_MUXCFG + 1); -+ rtw_write8(Adapter, REG_GPIO_MUXCFG + 1, (tmpU1b & ~BIT(4))); -+ -+ /* Release MAC IO register reset */ -+ /* 9. CR 0x100[7:0] = 0xFF; */ -+ /* 10. CR 0x101[1] = 0x01; */ /* Enable SEC block */ -+#if 0 -+ rtw_write16(Adapter, REG_CR, 0x00); -+ tmpU2b = rtw_read16(Adapter, REG_CR); -+ tmpU2b |= (HCI_TXDMA_EN | HCI_RXDMA_EN | TXDMA_EN | RXDMA_EN -+ | PROTOCOL_EN | SCHEDULE_EN | ENSEC | CALTMR_EN -+ | MACTXEN | MACRXEN); -+ rtw_write16(Adapter, REG_CR, tmpU2b); -+#else -+ rtw_write16(Adapter, REG_CR, 0x2ff); -+#endif -+ -+ bMacPwrCtrlOn = _TRUE; -+ rtw_hal_set_hwreg(Adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ -+ return status; -+} -+ -+static u8 -+_RQPN_Init_8723DE( -+ IN PADAPTER Adapter, -+ OUT u8 *pNPQRQPNVaule, -+ OUT u32 *pRQPNValue -+) -+{ -+ u8 i, numNQ = 0, numPubQ = 0, numHQ = 0, numLQ = 0; -+ /* u8* numPageArray; */ -+ -+ if (Adapter->registrypriv.wifi_spec) { -+ numHQ = WMM_NORMAL_PAGE_NUM_HPQ_8723D; /* 0x30 */ -+ numLQ = WMM_NORMAL_PAGE_NUM_LPQ_8723D; /* 0x20 */ -+ numNQ = WMM_NORMAL_PAGE_NUM_NPQ_8723D; /* 0x20 */ -+ } else { -+ numHQ = NORMAL_PAGE_NUM_HPQ_8723D; /* 0x0c */ -+ numLQ = NORMAL_PAGE_NUM_LPQ_8723D; /* 0x02 */ -+ numNQ = NORMAL_PAGE_NUM_NPQ_8723D; /* 0x02 */ -+ } -+ -+ numPubQ = TX_TOTAL_PAGE_NUMBER_8723D - numHQ - numLQ - numNQ; -+ -+ *pNPQRQPNVaule = _NPQ(numNQ); -+ *pRQPNValue = _HPQ(numHQ) | _LPQ(numLQ) | _PUBQ(numPubQ) | LD_RQPN; -+ -+ if (Adapter->registrypriv.wifi_spec) -+ return WMM_NORMAL_TX_PAGE_BOUNDARY_8723D; -+ else -+ return TX_PAGE_BOUNDARY_8723D; -+} -+ -+static s32 -+_LLTWrite_8723DE( -+ IN PADAPTER Adapter, -+ IN u32 address, -+ IN u32 data -+) -+{ -+ s32 status = _SUCCESS; -+ s32 count = 0; -+ u32 value = _LLT_INIT_ADDR(address) | _LLT_INIT_DATA(data) | _LLT_OP(_LLT_WRITE_ACCESS); -+ -+ rtw_write32(Adapter, REG_LLT_INIT, value); -+ -+ /* polling */ -+ do { -+ value = rtw_read32(Adapter, REG_LLT_INIT); -+ if (_LLT_NO_ACTIVE == _LLT_OP_VALUE(value)) -+ break; -+ -+ if (count > POLLING_LLT_THRESHOLD) { -+ status = _FAIL; -+ break; -+ } -+ } while (count++); -+ -+ return status; -+} -+ -+static s32 -+LLT_table_init_8723DE( -+ IN PADAPTER Adapter, -+ IN u8 txpktbuf_bndy, -+ IN u32 RQPN, -+ IN u8 RQPN_NPQ -+) -+{ -+ u16 i, maxPage = 255; -+ s32 status = _SUCCESS; -+ -+ /* 12. TXRKTBUG_PG_BNDY 0x114[31:0] = 0x27FF00F6 /TXRKTBUG_PG_BNDY */ -+ rtw_write8(Adapter, REG_TRXFF_BNDY, txpktbuf_bndy); -+ rtw_write16(Adapter, REG_TRXFF_BNDY + 2, RX_DMA_BOUNDARY_8723D); -+ -+ /* 13. 0x208[15:8] 0x209[7:0] = 0xF6 / Beacon Head for TXDMA */ -+ rtw_write8(Adapter, REG_DWBCN0_CTRL_8723D + 1, txpktbuf_bndy); -+ -+ /* 14. BCNQ_PGBNDY 0x424[7:0] = 0xF6 /BCNQ_PGBNDY */ -+ /* 2009/12/03 Why do we set so large boundary. confilct with document V11. */ -+ rtw_write8(Adapter, REG_BCNQ_BDNY, txpktbuf_bndy); -+ rtw_write8(Adapter, REG_MGQ_BDNY, txpktbuf_bndy); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_write8(Adapter, REG_BCNQ1_BDNY, txpktbuf_bndy + 8); -+ rtw_write8(Adapter, REG_DWBCN1_CTRL_8723D + 1, txpktbuf_bndy + 8); /* BCN1_HEAD */ -+ /* BIT1- BIT_SW_BCN_SEL_EN */ -+ rtw_write8(Adapter, REG_DWBCN1_CTRL_8723D + 2, rtw_read8(Adapter, REG_DWBCN1_CTRL_8723D + 2) | BIT(1)); -+#endif -+ -+ /* 15. WMAC_LBK_BF_HD 0x45D[7:0] = 0xF6 /WMAC_LBK_BF_HD */ -+ rtw_write8(Adapter, REG_WMAC_LBK_BF_HD, txpktbuf_bndy); -+ -+ /* 16. DRV_INFO_SZ = 0x04 */ -+ rtw_write8(Adapter, REG_RX_DRVINFO_SZ, 0x4); -+ -+ /* auto init LLT */ -+ if (rtl8723d_InitLLTTable(Adapter) == _FAIL) { -+ return _FAIL; -+ } -+ -+ /* Set reserved page for each queue */ -+ /* 11. RQPN 0x200[31:0] = 0x80BD1C1C / load RQPN */ -+ rtw_write32(Adapter, REG_RQPN, RQPN);/* 0x80cb1010);/ 0x80711010);/0x80cb1010); */ -+ -+ if (RQPN_NPQ != 0) -+ rtw_write8(Adapter, REG_RQPN_NPQ, RQPN_NPQ); -+ -+ return _SUCCESS; -+} -+ -+static u32 -+InitMAC_8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ u8 tmpU1b; -+ u16 tmpU2b; -+ struct recv_priv *precvpriv = &Adapter->recvpriv; -+ struct xmit_priv *pxmitpriv = &Adapter->xmitpriv; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ RTW_INFO("=======>InitMAC_8723D()\n"); -+ -+ if (rtw_hal_power_on(Adapter) == _FAIL) { -+ RTW_INFO("_InitPowerOn8723DE fail\n"); -+ return _FAIL; -+ } -+ -+ /* if(!pHalData->bMACFuncEnable) */ -+ { -+ /* System init */ -+ /* 18. LLT_table_init(Adapter); */ -+ u32 RQPN = 0x80EB0808; -+ u8 RQPN_NPQ = 0; -+ u8 TX_PAGE_BOUNDARY = -+ _RQPN_Init_8723DE(Adapter, &RQPN_NPQ, &RQPN); -+ -+ if (LLT_table_init_8723DE(Adapter, TX_PAGE_BOUNDARY, RQPN, RQPN_NPQ) == _FAIL) -+ return _FAIL; -+ } -+ -+ /* Enable Host Interrupt */ -+ rtw_write32(Adapter, REG_HISR0_8723D, 0xffffffff); -+ rtw_write32(Adapter, REG_HISR1_8723D, 0xffffffff); -+ -+ -+ tmpU2b = rtw_read16(Adapter, REG_TRXDMA_CTRL); -+ tmpU2b &= 0xf; -+ if (Adapter->registrypriv.wifi_spec) -+ tmpU2b |= 0xF9B1; -+ else -+ tmpU2b |= 0xF5B1; -+ rtw_write16(Adapter, REG_TRXDMA_CTRL, tmpU2b); -+ -+ -+ /* Reported Tx status from HW for rate adaptive. */ -+ /* 2009/12/03 MH This should be realtive to power on step 14. But in document V11 */ -+ /* still not contain the description.!!! */ -+ rtw_write8(Adapter, REG_FWHW_TXQ_CTRL + 1, 0x1F); -+ -+ /* Set RCR register */ -+ rtw_write32(Adapter, REG_RCR, pHalData->ReceiveConfig); -+ rtw_write16(Adapter, REG_RXFLTMAP0, 0xFFFF); -+ rtw_write16(Adapter, REG_RXFLTMAP1, 0x400); -+ rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); -+ /* Set TCR register */ -+ rtw_write32(Adapter, REG_TCR, pHalData->TransmitConfig); -+ -+ /* */ -+ /* Set TX/RX descriptor physical address(from OS API). */ -+ /* */ -+ rtw_write32(Adapter, REG_BCNQ_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[BCN_QUEUE_INX].dma & DMA_BIT_MASK(32)); -+ rtw_write32(Adapter, REG_MGQ_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[MGT_QUEUE_INX].dma & DMA_BIT_MASK(32)); -+ rtw_write32(Adapter, REG_VOQ_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[VO_QUEUE_INX].dma & DMA_BIT_MASK(32)); -+ rtw_write32(Adapter, REG_VIQ_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[VI_QUEUE_INX].dma & DMA_BIT_MASK(32)); -+ rtw_write32(Adapter, REG_BEQ_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[BE_QUEUE_INX].dma & DMA_BIT_MASK(32)); -+ rtw_write32(Adapter, REG_BKQ_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[BK_QUEUE_INX].dma & DMA_BIT_MASK(32)); -+ rtw_write32(Adapter, REG_HI0Q_TXBD_DESA_8723D, (u64)pxmitpriv->tx_ring[HIGH_QUEUE_INX].dma & DMA_BIT_MASK(32)); -+ rtw_write32(Adapter, REG_RXQ_RXBD_DESA_8723D, (u64)precvpriv->rx_ring[RX_MPDU_QUEUE].dma & DMA_BIT_MASK(32)); -+ -+#ifdef CONFIG_64BIT_DMA -+ /* 2009/10/28 MH For DMA 64 bits. We need to assign the high 32 bit address */ -+ /* for NIC HW to transmit data to correct path. */ -+ rtw_write32(Adapter, REG_BCNQ_TXBD_DESA_8723D + 4, -+ ((u64)pxmitpriv->tx_ring[BCN_QUEUE_INX].dma) >> 32); -+ rtw_write32(Adapter, REG_MGQ_TXBD_DESA_8723D + 4, -+ ((u64)pxmitpriv->tx_ring[MGT_QUEUE_INX].dma) >> 32); -+ rtw_write32(Adapter, REG_VOQ_TXBD_DESA_8723D + 4, -+ ((u64)pxmitpriv->tx_ring[VO_QUEUE_INX].dma) >> 32); -+ rtw_write32(Adapter, REG_VIQ_TXBD_DESA_8723D + 4, -+ ((u64)pxmitpriv->tx_ring[VI_QUEUE_INX].dma) >> 32); -+ rtw_write32(Adapter, REG_BEQ_TXBD_DESA_8723D + 4, -+ ((u64)pxmitpriv->tx_ring[BE_QUEUE_INX].dma) >> 32); -+ rtw_write32(Adapter, REG_BKQ_TXBD_DESA_8723D + 4, -+ ((u64)pxmitpriv->tx_ring[BK_QUEUE_INX].dma) >> 32); -+ rtw_write32(Adapter, REG_HI0Q_TXBD_DESA_8723D + 4, -+ ((u64)pxmitpriv->tx_ring[HIGH_QUEUE_INX].dma) >> 32); -+ rtw_write32(Adapter, REG_RXQ_RXBD_DESA_8723D + 4, -+ ((u64)precvpriv->rx_ring[RX_MPDU_QUEUE].dma) >> 32); -+ -+#if 1 -+ /* Don't check dma addr, just depends on PCI-host setting */ -+ if (Adapter->dvobj->bdma64) { -+ RTW_INFO("Enable DMA64 bit\n"); -+ -+ PlatformEnableDMA64(Adapter); -+ } -+#else -+ /* check dma addr, and it may fallback to 32bit mode */ -+ -+ /* 2009/10/28 MH If RX descriptor address is not equal to zero. We will enable */ -+ /* DMA 64 bit functuion. */ -+ /* Note: We never saw thd consition which the descripto address are divided into */ -+ /* 4G down and 4G upper separate area. */ -+ if (((u64)precvpriv->rx_ring[RX_MPDU_QUEUE].dma) >> 32 != 0) { -+ /* RTW_INFO("RX_DESC_HA=%08lx\n", ((u64)priv->rx_ring_dma[RX_MPDU_QUEUE])>>32); */ -+ RTW_INFO("Enable DMA64 bit\n"); -+ -+ /* Check if other descriptor address is zero and abnormally be in 4G lower area. */ -+ if (((u64)pxmitpriv->tx_ring[MGT_QUEUE_INX].dma) >> 32) { -+ /* */ -+ RTW_INFO("MGNT_QUEUE HA=0\n"); -+ } -+ -+ PlatformEnableDMA64(Adapter); -+ } else { -+ struct pci_dev *pdev = Adapter->dvobj->ppcidev; -+ -+ RTW_INFO("Enable DMA32 bit (fallback)\n"); -+ -+ if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32))) { -+ if (pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)) != 0) -+ RTW_INFO(KERN_ERR "Unable to obtain 32bit DMA for consistent allocations\n"); -+ } -+ } -+#endif -+#endif -+ -+ /* Reset the Read/Write point to 0 */ -+ rtw_write32(Adapter, REG_BD_RW_PTR_CLR_8723D, 0X3FFFFFFF); -+ -+ tmpU1b = rtw_read8(Adapter, REG_PCIE_CTRL_REG_8723D + 3); -+ rtw_write8(Adapter, REG_PCIE_CTRL_REG_8723D + 3, (tmpU1b | 0xF7)); -+ -+ /* 20100318 Joseph: Reset interrupt migration setting when initialization. Suggested by SD1. */ -+ rtw_write32(Adapter, REG_INT_MIG_8723D, 0); -+ pHalData->bInterruptMigration = _FALSE; -+ -+ /* 2009.10.19. Reset H2C protection register. by tynli. */ -+ rtw_write32(Adapter, REG_MCUTST_1_8723D, 0x0); -+ -+#if MP_DRIVER == 1 -+ if (Adapter->registrypriv.mp_mode == 1) { -+ rtw_write32(Adapter, REG_MACID, 0x87654321); -+ rtw_write32(Adapter, 0x0700, 0x87654321); -+ } -+#endif -+ -+ /* pic buffer descriptor mode: */ -+ /* ---- tx */ -+ rtw_write16(Adapter, REG_MGQ_TXBD_NUM_8723D, (pxmitpriv->txringcount[MGT_QUEUE_INX] & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+ rtw_write16(Adapter, REG_VOQ_TXBD_NUM_8723D, (pxmitpriv->txringcount[VO_QUEUE_INX] & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+ rtw_write16(Adapter, REG_VIQ_TXBD_NUM_8723D, (pxmitpriv->txringcount[VI_QUEUE_INX] & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+ rtw_write16(Adapter, REG_BEQ_TXBD_NUM_8723D, (pxmitpriv->txringcount[BE_QUEUE_INX] & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+ rtw_write16(Adapter, REG_BKQ_TXBD_NUM_8723D, (pxmitpriv->txringcount[BK_QUEUE_INX] & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+ rtw_write16(Adapter, REG_HI0Q_TXBD_NUM_8723D, (pxmitpriv->txringcount[HIGH_QUEUE_INX] & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+#if 0 -+ rtw_write16(Adapter, REG_HI1Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+ rtw_write16(Adapter, REG_HI2Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+ rtw_write16(Adapter, REG_HI3Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+ rtw_write16(Adapter, REG_HI4Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+ rtw_write16(Adapter, REG_HI5Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+ rtw_write16(Adapter, REG_HI6Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+ rtw_write16(Adapter, REG_HI7Q_TXBD_NUM_8723D, TX_BD_NUM | ((TX_BUFFER_SEG_NUM << 12) & 0x3000)); -+#endif -+ /* ---- rx. support 32 bits in linux */ -+#ifdef CONFIG_64BIT_DMA -+ rtw_write16(Adapter, REG_RX_RXBD_NUM_8723D, (precvpriv->rxringcount & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 13) & 0x6000) | 0x8000); /*using 64bit */ -+#else -+ rtw_write16(Adapter, REG_RX_RXBD_NUM_8723D, (precvpriv->rxringcount & 0x0FFF) | ((TX_BUFFER_SEG_NUM << 13) & 0x6000)); /*using 32bit */ -+#endif -+ -+ /* ---- reset read/write point */ -+ rtw_write32(Adapter, REG_BD_RW_PTR_CLR_8723D, 0XFFFFFFFF); /*Reset read/write point*/ -+ -+ pHalData->RxTag = 0; -+ /* Release Pcie Interface Tx DMA. */ -+#if defined(USING_RX_TAG) -+ rtw_write16(Adapter, REG_PCIE_CTRL_REG_8723D, 0x8000); -+#else -+ rtw_write16(Adapter, REG_PCIE_CTRL_REG_8723D, 0x0000); -+#endif -+ -+ RTW_INFO("InitMAC_8723D() <====\n"); -+ -+ return _SUCCESS; -+} -+ -+/* -+ * Description: -+ * PCI configuration space read operation on RTL8723DE -+ * -+ * Created by Roger, 2013.05.08. -+ */ -+u1Byte -+hal_DBIRead_8723DE( -+ IN PADAPTER Adapter, -+ IN u2Byte Addr -+) -+{ -+ u2Byte ReadAddr = Addr & 0xfffc; -+ u1Byte ret = 0, tmpU1b = 0, count = 0; -+ -+ rtw_write16(Adapter, REG_DBI_FLAG_V1_8723D, ReadAddr); -+ rtw_write8(Adapter, REG_DBI_FLAG_V1_8723D + 2, 0x2); -+ tmpU1b = rtw_read8(Adapter, REG_DBI_FLAG_V1_8723D + 2); -+ count = 0; -+ while (tmpU1b && count < 20) { -+ rtw_udelay_os(10); -+ tmpU1b = rtw_read8(Adapter, REG_DBI_FLAG_V1_8723D + 2); -+ count++; -+ } -+ if (0 == tmpU1b) { -+ ReadAddr = REG_DBI_RDATA_V1_8723D + Addr % 4; -+ ret = rtw_read8(Adapter, ReadAddr); -+ } -+ -+ return ret; -+} -+ -+/* -+ * Description: -+ * PCI configuration space write operation on RTL8723DE -+ * -+ * Created by Roger, 2013.05.08. -+ */ -+VOID -+hal_DBIWrite_8723DE( -+ IN PADAPTER Adapter, -+ IN u2Byte Addr, -+ IN u1Byte Data -+) -+{ -+ u1Byte tmpU1b = 0, count = 0; -+ u2Byte WriteAddr = 0, Remainder = Addr % 4; -+ -+ /* Write DBI 1Byte Data */ -+ WriteAddr = REG_DBI_WDATA_V1_8723D + Remainder; -+ rtw_write8(Adapter, WriteAddr, Data); -+ -+ /* Write DBI 2Byte Address & Write Enable */ -+ WriteAddr = (Addr & 0xfffc) | (BIT(0) << (Remainder + 12)); -+ rtw_write16(Adapter, REG_DBI_FLAG_V1_8723D, WriteAddr); -+ -+ /* Write DBI Write Flag */ -+ rtw_write8(Adapter, REG_DBI_FLAG_V1_8723D + 2, 0x1); -+ -+ tmpU1b = rtw_read8(Adapter, REG_DBI_FLAG_V1_8723D + 2); -+ count = 0; -+ while (tmpU1b && count < 20) { -+ rtw_udelay_os(10); -+ tmpU1b = rtw_read8(Adapter, REG_DBI_FLAG_V1_8723D + 2); -+ count++; -+ } -+} -+ -+VOID -+EnableAspmBackDoor_8723DE(IN PADAPTER Adapter) -+{ -+ -+ u1Byte tmp1byte = 0; -+ u2Byte tmp2byte = 0; -+ -+ -+ /* */ -+ /* Overwrite following ePHY parameter for some platform compatibility issue, */ -+ /* especially when CLKReq is enabled, 2012.11.09. */ -+ /* */ -+ tmp2byte = hal_MDIORead_8723DE(Adapter, 0x0b); -+ if (tmp2byte != 0x70) -+ hal_MDIOWrite_8723DE(Adapter, 0x0b, 0x70); -+ -+ /* Configuration Space offset 0x70f BIT7 is used to control L0S */ -+ tmp1byte = hal_DBIRead_8723DE(Adapter, 0x70f); -+ hal_DBIWrite_8723DE(Adapter, 0x70f, tmp1byte | BIT(7)); -+ -+ /* Configuration Space offset 0x719 Bit3 is for L1 BIT4 is for clock request */ -+ tmp1byte = hal_DBIRead_8723DE(Adapter, 0x719); -+ hal_DBIWrite_8723DE(Adapter, 0x719, tmp1byte | BIT(3) | BIT(4)); -+ -+} -+ -+VOID -+EnableL1Off_8723DE(IN PADAPTER Adapter) -+{ -+ u8 tmpU1b = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if (pHalData->bL1OffSupport == _FALSE) -+ return; -+ -+ hal_MDIOWrite_8723DE(Adapter, 0x1b, (hal_MDIORead_8723DE(Adapter, 0x1b) | BIT(4))); -+ -+ tmpU1b = hal_DBIRead_8723DE(Adapter, 0x718); -+ hal_DBIWrite_8723DE(Adapter, 0x718, tmpU1b | BIT(5)); -+ -+ tmpU1b = hal_DBIRead_8723DE(Adapter, 0x160); -+ hal_DBIWrite_8723DE(Adapter, 0x160, tmpU1b | 0xf); -+} -+ -+VOID -+SetPciLtr_8723DE( -+ IN PADAPTER Adapter -+ ) -+{ -+ u4Byte tmpU4b = 0; -+ -+ /* Add workaround for 11n Wifi spec, set LTR idle latency to 144us for throughput test -+ * by Hana, 2015/04/17 -+ */ -+ if (Adapter->registrypriv.wifi_spec == 1) { -+ PlatformEFIOWrite4Byte(Adapter, REG_LTR_IDLE_LATENCY_V1_8723D, 0x88908890); -+ } else { -+ /* LTR idle latency, 0x90 for 3ms */ -+ PlatformEFIOWrite4Byte(Adapter, REG_LTR_IDLE_LATENCY_V1_8723D, 0x883C883C); -+ } -+ -+ /* LTR active latency, 0x3c for 64us */ -+ PlatformEFIOWrite4Byte(Adapter, REG_LTR_ACTIVE_LATENCY_V1_8723D, 0x880B880B); -+ -+ /* for HP 8723DE device loss, suggest by Tim lin 20170322 */ -+ PlatformEFIOWrite4Byte(Adapter, REG_LTR_CTRL_BASIC_8723D, 0xCB004010); -+ PlatformEFIOWrite4Byte(Adapter, (REG_LTR_CTRL_BASIC_8723D + 4), 0x01233425); -+} -+ -+/* -+ * Description: Check if PCIe DMA Tx/Rx hang. -+ * The flow is provided by SD1 Alan. Added by tynli. 2013.05.03. -+ */ -+BOOLEAN -+CheckPcieDMAHang8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ u1Byte u1bTmp; -+ -+ /* write reg 0x350 Bit[26]=1. Enable debug port. */ -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_DBI_FLAG_V1_8723D + 3); -+ if (!(u1bTmp & BIT(2))) { -+ PlatformEFIOWrite1Byte(Adapter, REG_DBI_FLAG_V1_8723D + 3, (u1bTmp | BIT(2))); -+ rtw_mdelay_os(100); /* Suggested by DD Justin_tsai. */ -+ } -+ -+ /* read reg 0x350 Bit[25] if 1 : RX hang */ -+ /* read reg 0x350 Bit[24] if 1 : TX hang */ -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_DBI_FLAG_V1_8723D + 3); -+ if ((u1bTmp & BIT(0)) || (u1bTmp & BIT(1))) { -+ return TRUE; -+ } -+ -+ return FALSE; -+} -+ -+/* */ -+/* Description: Reset Pcie interface DMA. */ -+/* */ -+VOID -+ResetPcieInterfaceDMA8723DE( -+ IN PADAPTER Adapter, -+ IN BOOLEAN bInMACPowerOn -+) -+{ -+ u1Byte u1Tmp; -+ BOOLEAN bReleaseMACRxPause; -+ u1Byte BackUpPcieDMAPause; -+ -+ -+ /* Revise Note: Follow the document "PCIe RX DMA Hang Reset Flow_v03" released by SD1 Alan. */ -+ /* 2013.05.07, by tynli. */ -+ -+ /* 1. disable register write lock */ -+ /* write 0x1C bit[1:0] = 2'h0 */ -+ /* write 0xCC bit[2] = 1'b1 */ -+ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_RSV_CTRL_8723D); -+ u1Tmp &= ~(BIT(1) | BIT(0)); -+ PlatformEFIOWrite1Byte(Adapter, REG_RSV_CTRL_8723D, u1Tmp); -+ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_PMC_DBG_CTRL2_8723D); -+ u1Tmp |= BIT(2); -+ PlatformEFIOWrite1Byte(Adapter, REG_PMC_DBG_CTRL2_8723D, u1Tmp); -+ -+ /* 2. Check and pause TRX DMA */ -+ /* write 0x284 bit[18] = 1'b1 */ -+ /* write 0x301 = 0xFF */ -+ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_RXDMA_CONTROL_8723D); -+ if (u1Tmp & BIT(2)) { -+ /* Already pause before the function for another purpose. */ -+ bReleaseMACRxPause = FALSE; -+ } else { -+ PlatformEFIOWrite1Byte(Adapter, REG_RXDMA_CONTROL_8723D, (u1Tmp | BIT(2))); -+ bReleaseMACRxPause = TRUE; -+ } -+ -+ BackUpPcieDMAPause = PlatformEFIORead1Byte(Adapter, REG_PCIE_CTRL_REG_8723D + 1); -+ if (BackUpPcieDMAPause != 0xFF) -+ PlatformEFIOWrite1Byte(Adapter, REG_PCIE_CTRL_REG_8723D + 1, 0xFF); -+ -+ if (bInMACPowerOn) { -+ /* 3. reset TRX function */ -+ /* write 0x100 = 0x00 */ -+ PlatformEFIOWrite1Byte(Adapter, REG_CR, 0); -+ } -+ -+ /* 4. Reset PCIe DMA */ -+ /* write 0x003 bit[0] = 0 */ -+ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_SYS_FUNC_EN + 1); -+ u1Tmp &= ~(BIT(0)); -+ PlatformEFIOWrite1Byte(Adapter, REG_SYS_FUNC_EN + 1, u1Tmp); -+ -+ /* 5. Enable PCIe DMA */ -+ /* write 0x003 bit[0] = 1 */ -+ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_SYS_FUNC_EN + 1); -+ u1Tmp |= BIT(0); -+ PlatformEFIOWrite1Byte(Adapter, REG_SYS_FUNC_EN + 1, u1Tmp); -+ -+ if (bInMACPowerOn) { -+ /* 6. enable TRX function */ -+ /* write 0x100 = 0xFF */ -+ PlatformEFIOWrite1Byte(Adapter, REG_CR, 0xFF); -+ -+ /* We should init LLT & RQPN and prepare Tx/Rx descrptor address later */ -+ /* because MAC function is reset. */ -+ } -+ -+ /* 7. Restore PCIe autoload down bit */ -+ /* write 0xF8 bit[17] = 1'b1 */ -+ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_MAC_PHY_CTRL_NORMAL + 2); -+ u1Tmp |= BIT(1); -+ PlatformEFIOWrite1Byte(Adapter, REG_MAC_PHY_CTRL_NORMAL + 2, u1Tmp); -+ -+ /* In MAC power on state, BB and RF maybe in ON state, if we release TRx DMA here */ -+ /* it will cause packets to be started to Tx/Rx, so we release Tx/Rx DMA later. */ -+ if (!bInMACPowerOn) { -+ /* 8. release TRX DMA */ -+ /* write 0x284 bit[18] = 1'b0 */ -+ /* write 0x301 = 0x00 */ -+ if (bReleaseMACRxPause) { -+ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_RXDMA_CONTROL_8723D); -+ PlatformEFIOWrite1Byte(Adapter, REG_RXDMA_CONTROL_8723D, (u1Tmp & ~BIT(2))); -+ } -+ PlatformEFIOWrite1Byte(Adapter, REG_PCIE_CTRL_REG_8723D + 1, BackUpPcieDMAPause); -+ } -+ -+ /* 9. lock system register */ -+ /* write 0xCC bit[2] = 1'b0 */ -+ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_PMC_DBG_CTRL2_8723D); -+ u1Tmp &= ~(BIT(2)); -+ PlatformEFIOWrite1Byte(Adapter, REG_PMC_DBG_CTRL2_8723D, u1Tmp); -+ -+} -+VOID -+PHY_InitAntennaSelection8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ -+} -+ -+static VOID _InitBBRegBackup_8723DE(PADAPTER Adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ /* For Channel 1~11 (Default Value)*/ -+ pHalData->RegForRecover[0].offset = rCCK0_TxFilter2; -+ pHalData->RegForRecover[0].value = -+ PHY_QueryBBReg(Adapter, -+ pHalData->RegForRecover[0].offset, bMaskDWord); -+ -+ pHalData->RegForRecover[1].offset = rCCK0_DebugPort; -+ pHalData->RegForRecover[1].value = -+ PHY_QueryBBReg(Adapter, -+ pHalData->RegForRecover[1].offset, bMaskDWord); -+ -+ pHalData->RegForRecover[2].offset = 0xAAC; -+ pHalData->RegForRecover[2].value = -+ PHY_QueryBBReg(Adapter, -+ pHalData->RegForRecover[2].offset, bMaskDWord); -+#if 0 -+ /* For 20 MHz (Default Value)*/ -+ pHalData->RegForRecover[2].offset = rBBrx_DFIR; -+ pHalData->RegForRecover[2].value = PHY_QueryBBReg(Adapter, pHalData->RegForRecover[2].offset, bMaskDWord); -+ -+ pHalData->RegForRecover[3].offset = rOFDM0_XATxAFE; -+ pHalData->RegForRecover[3].value = PHY_QueryBBReg(Adapter, pHalData->RegForRecover[3].offset, bMaskDWord); -+ -+ pHalData->RegForRecover[4].offset = 0x1E; -+ pHalData->RegForRecover[4].value = PHY_QueryRFReg(Adapter, ODM_RF_PATH_A, pHalData->RegForRecover[4].offset, bRFRegOffsetMask); -+#endif -+} -+ -+/* Set CCK and OFDM Block "ON" */ -+static void _BBTurnOnBlock(PADAPTER padapter) -+{ -+#if (DISABLE_BB_RF) -+ return; -+#endif -+ -+ PHY_SetBBReg(padapter, rFPGA0_RFMOD, bCCKEn, 0x1); -+ PHY_SetBBReg(padapter, rFPGA0_RFMOD, bOFDMEn, 0x1); -+} -+ -+static u32 rtl8723de_hal_init(PADAPTER Adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); -+ u32 rtStatus = _SUCCESS; -+ u8 tmpU1b, u1bRegCR; -+ u32 u4Tmp; -+ u32 i; -+ BOOLEAN bSupportRemoteWakeUp; -+ u32 NavUpper = WiFiNavUpperUs; -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ -+ /* */ -+ /* No I/O if device has been surprise removed */ -+ /* */ -+ if (rtw_is_surprise_removed(Adapter)) { -+ RTW_INFO("rtl8723de_hal_init(): bSurpriseRemoved!\n"); -+ return _SUCCESS; -+ } -+ -+ Adapter->init_adpt_in_progress = _TRUE; -+ RTW_INFO("=======>rtl8723de_hal_init()\n"); -+ -+ u1bRegCR = rtw_read8(Adapter, REG_CR); -+ RTW_INFO(" power-on :REG_CR 0x100=0x%02x.\n", u1bRegCR); -+ if (/*(tmpU1b&BIT3) && */ (u1bRegCR != 0 && u1bRegCR != 0xEA)) { -+ /* pHalData->bMACFuncEnable = TRUE; */ -+ RTW_INFO(" MAC has already power on.\n"); -+ } else { -+ /* pHalData->bMACFuncEnable = FALSE; */ -+ /* Set FwPSState to ALL_ON mode to prevent from the I/O be return because of 32k */ -+ /* state which is set before sleep under wowlan mode. 2012.01.04. by tynli. */ -+ /* pHalData->FwPSState = FW_PS_STATE_ALL_ON_88E; */ -+ } -+ -+ if (CheckPcieDMAHang8723DE(Adapter)) { -+ /* ResetPcieInterfaceDMA8723DE(Adapter, pHalData->bMACFuncEnable); */ -+ ResetPcieInterfaceDMA8723DE(Adapter, (u1bRegCR != 0 && u1bRegCR != 0xEA)); -+ /* Release pHalData->bMACFuncEnable here because it will reset MAC in ResetPcieInterfaceDMA */ -+ /* function such that we need to allow LLT to be initialized in later flow. */ -+ /* pHalData->bMACFuncEnable = FALSE; */ -+ } -+ -+ /*if(pHalData->bMACFuncEnable == FALSE)*/ -+ { -+ u1Byte u1Tmp; -+ -+ u1Tmp = PlatformEFIORead1Byte(Adapter, REG_HCI_OPT_CTRL_8723D+1); -+ PlatformEFIOWrite1Byte(Adapter, REG_HCI_OPT_CTRL_8723D+1, (u1Tmp|BIT0));/*Disable USB Suspend Signal*/ -+ } -+ -+ /* */ -+ /* 1. MAC Initialize */ -+ /* */ -+ rtStatus = InitMAC_8723DE(Adapter); -+ rtw_write8(Adapter, REG_SECONDARY_CCA_CTRL_8723D, 0x03); -+ rtw_write8(Adapter, 0x976, 0); /* hpfan_todo: 2nd CCA related */ -+ if (rtStatus != _SUCCESS) { -+ RTW_INFO("Init MAC failed\n"); -+ return rtStatus; -+ } -+ -+ /* InitHalDm should be put ahead of FirmwareDownload. (HWConfig flow: FW->MAC->-BB->RF) */ -+ /*rtl8723d_InitHalDm(Adapter);*/ -+ -+#if 0 /* This statement is put on ex_halbtc8723d2ant_pre_load_firmware() */ -+ /* -+ To inform FW about: -+ bit0: "0" for no antenna inverse; "1" for antenna inverse -+ bit1: "0" for internal switch; "1" for external switch -+ bit2: "0" for one antenna; "1" for two antenna -+ */ -+ tmpU1b = 0; -+ if (pHalData->EEPROMBluetoothAntNum == Ant_x2) -+ tmpU1b |= BIT(2); /* two antenna case */ -+ -+ rtw_write8(Adapter, 0x3E0, tmpU1b); -+#endif -+ -+#if HAL_FW_ENABLE -+ if (Adapter->registrypriv.mp_mode == 0 -+ #if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTW_CUSTOMER_STR) -+ || Adapter->registrypriv.mp_customer_str -+ #endif -+ ) { -+ tmpU1b = rtw_read8(Adapter, REG_SYS_CFG); -+ rtw_write8(Adapter, REG_SYS_CFG, tmpU1b & 0x7F); -+ -+ rtStatus = rtl8723d_FirmwareDownload(Adapter, _FALSE); -+ -+ if (rtStatus != _SUCCESS) { -+ RTW_INFO("FwLoad failed\n"); -+ rtStatus = _SUCCESS; -+ Adapter->bFWReady = _FALSE; -+ pHalData->fw_ractrl = _FALSE; -+ } else { -+ RTW_INFO("FwLoad SUCCESSFULLY!!!\n"); -+ Adapter->bFWReady = _TRUE; -+ pHalData->fw_ractrl = _TRUE; -+ } -+ } -+#endif -+ -+ if (pHalData->AMPDUBurstMode) -+ rtw_write8(Adapter, REG_AMPDU_BURST_MODE_8723D, 0x7F); -+ -+ pHalData->CurrentChannel = 0;/* set 0 to trigger switch correct channel */ -+ -+ /* We should call the function before MAC/BB configuration. */ -+ PHY_InitAntennaSelection8723DE(Adapter); -+ -+ /* */ -+ /* 2. Initialize MAC/PHY Config by MACPHY_reg.txt */ -+ /* */ -+#if (HAL_MAC_ENABLE == 1) -+ RTW_INFO("8723D MAC Config Start!\n"); -+ rtStatus = PHY_MACConfig8723D(Adapter); -+ if (rtStatus != _SUCCESS) { -+ RTW_INFO("8723D MAC Config failed\n"); -+ return rtStatus; -+ } -+ RTW_INFO("8723D MAC Config Finished!\n"); -+ -+ /* without this statement, RCR doesn't take effect so that it will show 'validate_recv_ctrl_frame fail'. */ -+ /*rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR) & ~(RCR_ADF));*/ -+#endif /* #if (HAL_MAC_ENABLE == 1) */ -+ -+ /* */ -+ /* 3. Initialize BB After MAC Config PHY_reg.txt, AGC_Tab.txt */ -+ /* */ -+#if (HAL_BB_ENABLE == 1) -+ RTW_INFO("BB Config Start!\n"); -+ rtStatus = PHY_BBConfig8723D(Adapter); -+ if (rtStatus != _SUCCESS) { -+ RTW_INFO("BB Config failed\n"); -+ return rtStatus; -+ } -+ -+ if (Adapter->registrypriv.wifi_spec == 1) -+ ODM_SetBBReg(pDM_Odm, 0xc4c, bMaskDWord, 0x00fe0301); -+ -+ RTW_INFO("BB Config Finished!\n"); -+#endif /* #if (HAL_BB_ENABLE == 1) */ -+ -+ /* */ -+ /* 4. Initiailze RF RAIO_A.txt RF RAIO_B.txt */ -+ /* */ -+#if (HAL_RF_ENABLE == 1) -+ RTW_INFO("RF Config started!\n"); -+ rtStatus = PHY_RFConfig8723D(Adapter); -+ if (rtStatus != _SUCCESS) { -+ RTW_INFO("RF Config failed\n"); -+ return rtStatus; -+ } -+ -+ /*---- Set CCK and OFDM Block "ON"----*/ -+ PHY_SetBBReg(Adapter, rFPGA0_RFMOD, bCCKEn, 0x1); -+ PHY_SetBBReg(Adapter, rFPGA0_RFMOD, bOFDMEn, 0x1); -+ -+ RTW_INFO("RF Config Finished!\n"); -+ -+ pHalData->RfRegChnlVal[0] = PHY_QueryRFReg(Adapter, 0, RF_CHNLBW, bRFRegOffsetMask); -+ pHalData->RfRegChnlVal[1] = PHY_QueryRFReg(Adapter, 1, RF_CHNLBW, bRFRegOffsetMask); -+ /* Defalut BW should be 20MH at first for the value. because HAL bandwidh defalut = 20MH. */ -+ /* -+ pHalData->RfRegChnlVal[0] &= 0xFFF03FF; -+ pHalData->RfRegChnlVal[0] |= (BIT(10) | BIT(11)); -+ */ -+ -+#endif /* #if (HAL_RF_ENABLE == 1) */ -+ -+ _InitBBRegBackup_8723DE(Adapter); -+ -+ _InitMacAPLLSetting_8723D(Adapter); -+ -+ /* 3 Set Hardware(MAC default setting.) */ -+ HwConfigureRTL8723DE(Adapter); -+ -+ rtw_hal_set_chnl_bw(Adapter, Adapter->registrypriv.channel, -+ CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE, HAL_PRIME_CHNL_OFFSET_DONT_CARE); -+ -+ /* We should set pHalData->bMACFuncEnable to TRUE after LLT initialize and Fw download */ -+ /* and before GPIO detect. by tynli. 2011.05.27. */ -+ /* pHalData->bMACFuncEnable = _TRUE; */ -+ -+ _BBTurnOnBlock(Adapter); -+ -+ /* 3Security related */ -+ /* ----------------------------------------------------------------------------- */ -+ /* Set up security related. 070106, by rcnjko: */ -+ /* 1. Clear all H/W keys. */ -+ /* ----------------------------------------------------------------------------- */ -+ invalidate_cam_all(Adapter); -+ -+ /* Joseph debug: MAC_SEC_EN need to be set */ -+ rtw_write8(Adapter, REG_CR + 1, (rtw_read8(Adapter, REG_CR + 1) | BIT(1))); -+ -+ /* 2======================================================= */ -+ /* RF Power Save */ -+ /* 2======================================================= */ -+ /* Fix the bug that Hw/Sw radio off before S3/S4, the RF off action will not be executed */ -+ /* in MgntActSet_RF_State() after wake up, because the value of pHalData->eRFPowerState */ -+ /* is the same as eRfOff, we should change it to eRfOn after we config RF parameters. */ -+ /* Added by tynli. 2010.03.30. */ -+ pwrpriv->rf_pwrstate = rf_on; -+ -+ /* if(pPSC->bGpioRfSw) */ -+ if (0) { -+ tmpU1b = rtw_read8(Adapter, 0x60); -+ pwrpriv->rfoff_reason |= (tmpU1b & BIT(1)) ? 0 : RF_CHANGE_BY_HW; -+ } -+ -+ pwrpriv->rfoff_reason |= (pwrpriv->reg_rfoff) ? RF_CHANGE_BY_SW : 0; -+ -+ if (pwrpriv->rfoff_reason & RF_CHANGE_BY_HW) -+ pwrpriv->b_hw_radio_off = _TRUE; -+ -+ if (pwrpriv->rfoff_reason > RF_CHANGE_BY_PS) { -+ /* H/W or S/W RF OFF before sleep. */ -+ RTW_INFO("InitializeAdapter8188EE(): Turn off RF for RfOffReason(%d) ----------\n", pwrpriv->rfoff_reason); -+ /* MgntActSet_RF_State(Adapter, rf_off, pwrpriv->rfoff_reason, _TRUE); */ -+ } else { -+ pwrpriv->rf_pwrstate = rf_on; -+ pwrpriv->rfoff_reason = 0; -+ -+ RTW_INFO("InitializeAdapter8723DE(): Turn on ----------\n"); -+ -+ /* LED control */ -+ rtw_led_control(Adapter, LED_CTL_POWER_ON); -+ -+ } -+ -+ rtl8723d_InitAntenna_Selection(Adapter); -+ -+ /* Fix the bug that when the system enters S3/S4 then tirgger HW radio off, after system */ -+ /* wakes up, the scan OID will be set from upper layer, but we still in RF OFF state and scan */ -+ /* list is empty, such that the system might consider the NIC is in RF off state and will wait */ -+ /* for several seconds (during this time the scan OID will not be set from upper layer anymore) */ -+ /* even though we have already HW RF ON, so we tell the upper layer our RF state here. */ -+ /* Added by tynli. 2010.04.01. */ -+ /* DrvIFIndicateCurrentPhyStatus(Adapter); */ -+ -+ if (Adapter->registrypriv.hw_wps_pbc) { -+ tmpU1b = rtw_read8(Adapter, GPIO_IO_SEL); -+ tmpU1b &= ~(HAL_8192C_HW_GPIO_WPS_BIT); -+ rtw_write8(Adapter, GPIO_IO_SEL, tmpU1b); /* enable GPIO[2] as input mode */ -+ } -+ -+ /* */ -+ /* Execute TX power tracking later */ -+ /* */ -+ -+ EnableAspmBackDoor_8723DE(Adapter); -+ EnableL1Off_8723DE(Adapter); -+ SetPciLtr_8723DE(Adapter); -+ -+ /* Init BT hw config. */ -+ -+ rtl8723d_InitHalDm(Adapter); -+ -+ Adapter->init_adpt_in_progress = _FALSE; -+ -+#if defined(CONFIG_CONCURRENT_MODE) || defined(CONFIG_TX_MCAST2UNI) -+ -+#ifdef CONFIG_CHECK_AC_LIFETIME -+ /* Enable lifetime check for the four ACs */ -+ rtw_write8(Adapter, REG_LIFETIME_CTRL, rtw_read8(Adapter, REG_LIFETIME_CTRL) | 0x0f); -+#endif /* CONFIG_CHECK_AC_LIFETIME */ -+ -+#ifdef CONFIG_TX_MCAST2UNI -+ rtw_write16(Adapter, REG_PKT_VO_VI_LIFE_TIME, 0x0400); /* unit: 256us. 256ms */ -+ rtw_write16(Adapter, REG_PKT_BE_BK_LIFE_TIME, 0x0400); /* unit: 256us. 256ms */ -+#else /* CONFIG_TX_MCAST2UNI */ -+ rtw_write16(Adapter, REG_PKT_VO_VI_LIFE_TIME, 0x3000); /* unit: 256us. 3s */ -+ rtw_write16(Adapter, REG_PKT_BE_BK_LIFE_TIME, 0x3000); /* unit: 256us. 3s */ -+#endif /* CONFIG_TX_MCAST2UNI */ -+#endif /* CONFIG_CONCURRENT_MODE || CONFIG_TX_MCAST2UNI */ -+ -+ -+ /* enable tx DMA to drop the redundate data of packet */ -+ rtw_write16(Adapter, REG_TXDMA_OFFSET_CHK, (rtw_read16(Adapter, REG_TXDMA_OFFSET_CHK) | DROP_DATA_EN)); -+ -+ pHalData->RegBcnCtrlVal = rtw_read8(Adapter, REG_BCN_CTRL); -+ pHalData->RegTxPause = rtw_read8(Adapter, REG_TXPAUSE); -+ pHalData->RegFwHwTxQCtrl = rtw_read8(Adapter, REG_FWHW_TXQ_CTRL + 2); -+ pHalData->RegReg542 = rtw_read8(Adapter, REG_TBTT_PROHIBIT + 2); -+ -+ /* EnableInterrupt8188EE(Adapter); */ -+ -+#if (MP_DRIVER == 1) -+ if (Adapter->registrypriv.mp_mode == 1) { -+ Adapter->mppriv.channel = pHalData->CurrentChannel; -+ MPT_InitializeAdapter(Adapter, Adapter->mppriv.channel); -+ } else -+#endif -+ { -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(Adapter); -+ -+ pwrctrlpriv->rf_pwrstate = rf_on; -+ -+ if (pwrctrlpriv->rf_pwrstate == rf_on) { -+ struct pwrctrl_priv *pwrpriv; -+ u32 start_time; -+ u8 restore_iqk_rst; -+ u8 b2Ant; -+ u8 h2cCmdBuf; -+ -+ pwrpriv = adapter_to_pwrctl(Adapter); -+ -+ PHY_LCCalibrate_8723D(&pHalData->odmpriv); -+ -+ /* Inform WiFi FW that it is the beginning of IQK */ -+ h2cCmdBuf = 1; -+ FillH2CCmd8723D(Adapter, H2C_8723D_BT_WLAN_CALIBRATION, 1, &h2cCmdBuf); -+ -+ start_time = rtw_get_current_time(); -+ do { -+ if (rtw_read8(Adapter, 0x1e7) & 0x01) -+ break; -+ -+ rtw_msleep_os(50); -+ } while (rtw_get_passing_time_ms(start_time) <= 400); -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_IQKNotify(Adapter, _TRUE); -+#endif -+ restore_iqk_rst = (pwrpriv->bips_processing == _TRUE) ? _TRUE : _FALSE; -+ b2Ant = (pHalData->EEPROMBluetoothAntNum == Ant_x2) ? _TRUE : _FALSE; -+ pHalData->odmpriv.nIQK_Cnt = 0; -+ pHalData->odmpriv.nIQK_OK_Cnt = 0; -+ pHalData->odmpriv.nIQK_Fail_Cnt = 0; -+ PHY_IQCalibrate_8723D(Adapter, _FALSE);/*, restore_iqk_rst, b2Ant, pHalData->ant_path);*/ -+ pHalData->bIQKInitialized = _TRUE; -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_IQKNotify(Adapter, _FALSE); -+#endif -+ -+ /* Inform WiFi FW that it is the finish of IQK */ -+ h2cCmdBuf = 0; -+ FillH2CCmd8723D(Adapter, H2C_8723D_BT_WLAN_CALIBRATION, 1, &h2cCmdBuf); -+ -+ ODM_TXPowerTrackingCheck(&pHalData->odmpriv); -+ } -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ /* Init BT hw config. */ -+ rtw_btcoex_HAL_Initialize(Adapter, _FALSE); -+#else -+ rtw_btcoex_HAL_Initialize(Adapter, _TRUE); -+#endif -+ -+#if (defined(CONFIG_ANT_DETECTION)) -+ ODM_SingleDualAntennaDefaultSetting(pDM_Odm); -+#endif -+ -+ /* -+ tmpU1b = EFUSE_Read1Byte(Adapter, 0x1FA); -+ -+ if(!(tmpU1b & BIT(0))) -+ { -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_A, 0x15, 0x0F, 0x05); -+ RTW_INFO("PA BIAS path A\n"); -+ } -+ -+ if(!(tmpU1b & BIT(1)) && is2T2R) -+ { -+ PHY_SetRFReg(Adapter, ODM_RF_PATH_B, 0x15, 0x0F, 0x05); -+ RTW_INFO("PA BIAS path B\n"); -+ } -+ */ -+ -+ rtw_hal_set_hwreg(Adapter, HW_VAR_NAV_UPPER, ((u8 *)&NavUpper)); -+ -+ -+ PHY_SetBBReg(Adapter, rOFDM0_XAAGCCore1, bMaskByte0, 0x50); -+ PHY_SetBBReg(Adapter, rOFDM0_XAAGCCore1, bMaskByte0, 0x20); -+ -+ -+ /*{ -+ RTW_INFO("===== Start Dump Reg ====="); -+ for(i = 0 ; i <= 0xeff ; i+=4) -+ { -+ #if 1 -+ u32 tmp; -+ -+ if(i%16==0) -+ printk("\n%04x: ",i); -+ -+ tmp = rtw_read32(Adapter, i); -+ -+ printk("%02X %02X %02X %02X ", -+ ( tmp >> 0 ) & 0xFF, -+ ( tmp >> 8 ) & 0xFF, -+ ( tmp >> 16 ) & 0xFF, -+ ( tmp >> 24 ) & 0xFF -+ ); -+ #else -+ if(i%16==0) -+ RTW_INFO("\n%04x: ",i); -+ RTW_INFO("0x%08x ",rtw_read32(Adapter, i)); -+ #endif -+ } -+ RTW_INFO("\n ===== End Dump Reg =====\n"); -+ }*/ -+ -+ -+ return rtStatus; -+} -+ -+/* -+ * 2009/10/13 MH Acoording to documetn form Scott/Alfred.... -+ * This is based on version 8.1. -+ */ -+ -+ -+ -+ -+VOID -+hal_poweroff_8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ u8 u1bTmp; -+ u8 bMacPwrCtrlOn = _FALSE; -+ -+ rtw_hal_get_hwreg(Adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if (bMacPwrCtrlOn == _FALSE) -+ return; -+ -+ RTW_INFO("=====>%s\n", __func__); -+ -+ /* pHalData->bMACFuncEnable = _FALSE; */ -+ -+ /* Run LPS WL RFOFF flow */ -+ HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, rtl8723D_enter_lps_flow); -+ -+ -+ -+ /* 0x1F[7:0] = 0 / turn off RF */ -+ /* rtw_write8(Adapter, REG_RF_CTRL_8812, 0x00); */ -+ -+ /* ==== Reset digital sequence ====== */ -+ if ((rtw_read8(Adapter, REG_MCUFWDL) & RAM_DL_SEL) && Adapter->bFWReady) /* 8051 RAM code */ -+ rtl8723d_FirmwareSelfReset(Adapter); -+ -+ /* Reset MCU. Suggested by Filen. 2011.01.26. by tynli. */ -+ u1bTmp = rtw_read8(Adapter, REG_SYS_FUNC_EN + 1); -+ rtw_write8(Adapter, REG_SYS_FUNC_EN + 1, (u1bTmp & (~BIT(2)))); -+ -+ /* MCUFWDL 0x80[1:0]=0 / reset MCU ready status */ -+ rtw_write8(Adapter, REG_MCUFWDL, 0x00); -+ -+ /* HW card disable configuration. */ -+ HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, rtl8723D_card_disable_flow); -+ -+ /* Reset MCU IO Wrapper */ -+ u1bTmp = rtw_read8(Adapter, REG_RSV_CTRL + 1); -+ rtw_write8(Adapter, REG_RSV_CTRL + 1, (u1bTmp & (~BIT(0)))); -+ u1bTmp = rtw_read8(Adapter, REG_RSV_CTRL + 1); -+ rtw_write8(Adapter, REG_RSV_CTRL + 1, u1bTmp | BIT(0)); -+ -+ /* RSV_CTRL 0x1C[7:0] = 0x0E / lock ISO/CLK/Power control register */ -+ rtw_write8(Adapter, REG_RSV_CTRL, 0x0e); -+ -+ Adapter->bFWReady = _FALSE; -+ bMacPwrCtrlOn = _FALSE; -+ rtw_hal_set_hwreg(Adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+} -+ -+VOID -+PowerOffAdapter8723DE( -+ IN PADAPTER Adapter -+) -+{ -+ rtw_hal_power_off(Adapter); -+} -+ -+static u32 rtl8723de_hal_deinit(PADAPTER Adapter) -+{ -+ u8 u1bTmp = 0; -+ u32 count = 0; -+ u8 bSupportRemoteWakeUp = _FALSE; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); -+ -+ -+ RTW_INFO("====> %s()\n", __func__); -+ -+ if (Adapter->bHaltInProgress == _TRUE) { -+ RTW_INFO("====> Abort rtl8723de_hal_deinit()\n"); -+ return _FAIL; -+ } -+ -+ Adapter->bHaltInProgress = _TRUE; -+ -+ /* */ -+ /* No I/O if device has been surprise removed */ -+ /* */ -+ if (rtw_is_surprise_removed(Adapter)) { -+ Adapter->bHaltInProgress = _FALSE; -+ return _SUCCESS; -+ } -+ -+ RT_SET_PS_LEVEL(pwrpriv, RT_RF_OFF_LEVL_HALT_NIC); -+ -+ /* Without supporting WoWLAN or the driver is in awake (D0) state, we should */ -+ if (!bSupportRemoteWakeUp) {/* ||!pMgntInfo->bPwrSaveState) */ -+ /* 2009/10/13 MH For power off test. */ -+ PowerOffAdapter8723DE(Adapter); -+ } -+#if 0 -+ else { -+ s32 rtStatus = _SUCCESS; -+ -+ /* -------------------------------------------------------- */ -+ /* 3 <1> Prepare for configuring wowlan related infomations */ -+ /* -------------------------------------------------------- */ -+ -+ /* Clear Fw WoWLAN event. */ -+ rtw_write8(Adapter, REG_MCUTST_WOWLAN, 0x0); -+ -+#if (USE_SPECIFIC_FW_TO_SUPPORT_WOWLAN == 1) -+ SetFwRelatedForWoWLAN8812A(Adapter, _TRUE); -+#endif -+ -+ SetWoWLANCAMEntry8812(Adapter); -+ PlatformEFIOWrite1Byte(Adapter, REG_WKFMCAM_NUM_8812, pPSC->WoLPatternNum); -+ -+ /* Dynamically adjust Tx packet boundary for download reserved page packet. */ -+ rtStatus = DynamicRQPN8812AE(Adapter, 0xE0, 0x3, 0x80c20d0d); /* reserve 30 pages for rsvd page */ -+ if (rtStatus == RT_STATUS_SUCCESS) -+ pHalData->bReInitLLTTable = _TRUE; -+ -+ /* -------------------------------------------------------- */ -+ /* 3 <2> Set Fw releted H2C cmd. */ -+ /* -------------------------------------------------------- */ -+ -+ /* Set WoWLAN related security information. */ -+ SetFwGlobalInfoCmd_8812(Adapter); -+ -+ HalDownloadRSVDPage8812E(Adapter, _TRUE); -+ -+ -+ /* Just enable AOAC related functions when we connect to AP. */ -+ if (pMgntInfo->mAssoc && pMgntInfo->OpMode == RT_OP_MODE_INFRASTRUCTURE) { -+ /* Set Join Bss Rpt H2C cmd and download RSVD page. */ -+ /* Fw will check media status to send null packet and perform WoWLAN LPS. */ -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_AID, 0); -+ MacIdIndicateSpecificMediaStatus(Adapter, MAC_ID_STATIC_FOR_DEFAULT_PORT, RT_MEDIA_CONNECT); -+ -+ HalSetFWWoWlanMode8812(Adapter, _TRUE); -+ /* Enable Fw Keep alive mechanism. */ -+ HalSetFwKeepAliveCmd8812(Adapter, _TRUE); -+ -+ /* Enable disconnect decision control. */ -+ SetFwDisconnectDecisionCtrlCmd_8812(Adapter, _TRUE); -+ } -+ -+ /* -------------------------------------------------------- */ -+ /* 3 <3> Hw Configutations */ -+ /* -------------------------------------------------------- */ -+ -+ /* Wait until Rx DMA Finished before host sleep. FW Pause Rx DMA may happens when received packet doing dma. /YJ,add,111101 */ -+ rtw_write8(Adapter, REG_RXDMA_CONTROL_8812A, BIT(2)); -+ -+ u1bTmp = rtw_read8(Adapter, REG_RXDMA_CONTROL_8812A); -+ count = 0; -+ while (!(u1bTmp & BIT(1)) && (count++ < 100)) { -+ rtw_udelay_os(10); /* 10 us */ -+ u1bTmp = rtw_read8(Adapter, REG_RXDMA_CONTROL_8812A); -+ } -+ RTW_INFO("HaltAdapter8812E(): 222 Wait until Rx DMA Finished before host sleep. count=%d\n", count); -+ -+ rtw_write8(Adapter, REG_APS_FSMCO + 1, 0x0); -+ -+ PlatformClearPciPMEStatus(Adapter); -+ -+ /* tynli_test for normal chip wowlan. 2010.01.26. Suggested by Sd1 Isaac and designer Alfred. */ -+ rtw_write8(Adapter, REG_SYS_CLKR, (rtw_read8(Adapter, REG_SYS_CLKR) | BIT(3))); -+ -+ /* prevent 8051 to be reset by PERST# */ -+ rtw_write8(Adapter, REG_RSV_CTRL, 0x20); -+ rtw_write8(Adapter, REG_RSV_CTRL, 0x60); -+ } -+ -+ /* For wowlan+LPS+32k. */ -+ if (bSupportRemoteWakeUp && Adapter->bEnterPnpSleep) { -+ BOOLEAN bEnterFwLPS = TRUE; -+ u1Byte QueueID; -+ PRT_TCB pTcb; -+ -+ -+ /* Set the WoWLAN related function control enable. */ -+ /* It should be the last H2C cmd in the WoWLAN flow. 2012.02.10. by tynli. */ -+ SetFwRemoteWakeCtrlCmd_8723D(Adapter, 1); -+ -+ /* Stop Pcie Interface Tx DMA. */ -+ PlatformEFIOWrite1Byte(Adapter, REG_PCIE_CTRL_REG_8723D + 1, 0xff); -+ -+ /* Wait for TxDMA idle. */ -+ count = 0; -+ do { -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_PCIE_CTRL_REG_8723D); -+ PlatformSleepUs(10); /* 10 us */ -+ count++; -+ } while ((u1bTmp != 0) && (count < 100)); -+ -+ /* Set Fw to enter LPS mode. */ -+ if (pMgntInfo->mAssoc && -+ pMgntInfo->OpMode == RT_OP_MODE_INFRASTRUCTURE && -+ (pPSC->WoWLANLPSLevel > 0)) { -+ -+ Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_FW_LPS_ACTION, (pu1Byte)(&bEnterFwLPS)); -+ pPSC->bEnterLPSDuringSuspend = TRUE; -+ } -+ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ /* guangan, 2009/08/28, return TCB in busy queue to idle queue when resume from S3/S4. */ -+ for (QueueID = 0; QueueID < MAX_TX_QUEUE; QueueID++) { -+ /* 2004.08.11, revised by rcnjko. */ -+ while (!RTIsListEmpty(&Adapter->TcbBusyQueue[QueueID])) { -+ pTcb = (PRT_TCB)RTRemoveHeadList(&Adapter->TcbBusyQueue[QueueID]); -+ ReturnTCB(Adapter, pTcb, RT_STATUS_SUCCESS); -+ } -+ } -+ -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+ -+ if (pHalData->HwROFEnable) { -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_HSISR_8812 + 3); -+ PlatformEFIOWrite1Byte(Adapter, REG_HSISR_8812 + 3, u1bTmp | BIT(1)); -+ } -+ } -+#endif -+ -+ RTW_INFO("%s() <====\n", __func__); -+ -+ Adapter->bHaltInProgress = _FALSE; -+ -+ -+ return _SUCCESS; -+} -+ -+void SetHwReg8723DE(PADAPTER Adapter, u8 variable, u8 *val) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ -+ switch (variable) { -+ case HW_VAR_SET_RPWM: -+#ifdef CONFIG_LPS_LCLK -+ { -+ u8 ps_state = *((u8 *)val); -+ /* rpwm value only use BIT0(clock bit) ,BIT6(Ack bit), and BIT7(Toggle bit) for 88e. */ -+ /* BIT0 value - 1: 32k, 0:40MHz. */ -+ /* BIT6 value - 1: report cpwm value after success set, 0:do not report. */ -+ /* BIT7 value - Toggle bit change. */ -+ /* modify by Thomas. 2012/4/2. */ -+ ps_state = ps_state & 0xC1; -+ /* RTW_INFO("##### Change RPWM value to = %x for switch clk #####\n",ps_state); */ -+ rtw_write8(Adapter, REG_PCIE_HRPWM, ps_state); -+ } -+#endif -+ break; -+ case HW_VAR_AMPDU_MAX_TIME: { -+ u8 maxRate = *(u8 *)val; -+ -+ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8723D, 0x70); -+ } -+ break; -+ case HW_VAR_PCIE_STOP_TX_DMA: { -+ u16 tmp16; -+ -+ tmp16 = rtw_read16(Adapter, REG_PCIE_CTRL_REG_8723D); -+ tmp16 |= 0x7FFF; -+ rtw_write16(Adapter, REG_PCIE_CTRL_REG_8723D, tmp16); -+ } -+ break; -+ case HW_VAR_DM_IN_LPS: /* [NOTE] copy from 8723ds */ -+ rtl8723d_hal_dm_in_lps(Adapter); -+ break; -+#ifdef CONFIG_GPIO_WAKEUP -+ case HW_SET_GPIO_WL_CTRL: -+ RTW_INFO("%s: check GPIO pin mux first!!\n", __func__); -+ break; -+#endif -+ default: -+ SetHwReg8723D(Adapter, variable, val); -+ break; -+ } -+ -+} -+ -+void GetHwReg8723DE(PADAPTER Adapter, u8 variable, u8 *val) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ /* DM_ODM_T *podmpriv = &pHalData->odmpriv; */ -+ -+ switch (variable) { -+ default: -+ GetHwReg8723D(Adapter, variable, val); -+ break; -+ } -+ -+} -+ -+/* -+ * Description: -+ * Change default setting of specified variable. -+ */ -+u8 -+SetHalDefVar8723DE( -+ IN PADAPTER Adapter, -+ IN HAL_DEF_VARIABLE eVariable, -+ IN PVOID pValue -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 bResult = _SUCCESS; -+ -+ switch (eVariable) { -+ case HAL_DEF_PCI_SUUPORT_L1_BACKDOOR: -+ pHalData->bSupportBackDoor = *((PBOOLEAN)pValue); -+ break; -+ default: -+ SetHalDefVar8723D(Adapter, eVariable, pValue); -+ break; -+ } -+ -+ return bResult; -+} -+ -+/* -+ * Description: -+ * Query setting of specified variable. -+ */ -+u8 -+GetHalDefVar8723DE( -+ IN PADAPTER Adapter, -+ IN HAL_DEF_VARIABLE eVariable, -+ IN PVOID pValue -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 bResult = _SUCCESS; -+ -+ switch (eVariable) { -+ case HAL_DEF_PCI_SUUPORT_L1_BACKDOOR: -+ *((PBOOLEAN)pValue) = pHalData->bSupportBackDoor; -+ break; -+ -+ case HAL_DEF_PCI_AMD_L1_SUPPORT: -+ *((PBOOLEAN)pValue) = _TRUE;/* Support L1 patch on AMD platform in default, added by Roger, 2012.04.30. */ -+ break; -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ case HAL_DEF_IS_SUPPORT_ANT_DIV: -+ *((u8 *)pValue) = (pHalData->AntDivCfg == 0) ? _FALSE : _TRUE; -+ break; -+#endif -+ case HAL_DEF_DRVINFO_SZ: -+ *((u32 *)pValue) = DRVINFO_SZ; -+ break; -+ -+ default: -+ GetHalDefVar8723D(Adapter, eVariable, pValue); -+ break; -+ } -+ -+ return bResult; -+} -+ -+static void rtl8723de_init_default_value(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ rtl8723d_init_default_value(padapter); -+ -+ pHalData->CurrentWirelessMode = WIRELESS_MODE_AUTO; -+ pHalData->bDefaultAntenna = 1; -+ -+ /* */ -+ /* Set TCR-Transmit Control Register. The value is set in InitializeAdapter8190Pci() */ -+ /* */ -+ pHalData->TransmitConfig = CFENDFORM | BIT(12) | BIT(13); -+ -+ /* */ -+ /* Set RCR-Receive Control Register . The value is set in InitializeAdapter8190Pci(). */ -+ /* */ -+ pHalData->ReceiveConfig = ( -+ /*RCR_APPFCS |*/ -+ RCR_APP_MIC | -+ RCR_APP_ICV | -+ RCR_APP_PHYST_RXFF | -+ /*RCR_VHT_DACK |*/ -+ RCR_HTC_LOC_CTRL | -+ RCR_AMF | -+ /*RCR_ACF |*/ -+ RCR_ADF | /* Note: This bit controls the PS-Poll packet filter. */ -+ /*RCR_AICV |*/ -+ /*RCR_ACRC32 |*/ -+ RCR_CBSSID_BCN | -+ RCR_CBSSID_DATA | -+ RCR_AB | -+ RCR_AM | -+ RCR_APM | -+ 0); -+ -+ -+ /* */ -+ /* Set Interrupt Mask Register */ -+ /* */ -+ pHalData->IntrMaskDefault[0] = (u32)( -+ IMR_PSTIMEOUT_8723D | -+ /* IMR_GTINT4_8723D | */ -+ IMR_GTINT3_8723D | -+ IMR_TXBCN0ERR_8723D | -+ IMR_TXBCN0OK_8723D | -+ IMR_BCNDMAINT0_8723D | -+ IMR_HSISR_IND_ON_INT_8723D | -+ IMR_C2HCMD_8723D | -+ /* IMR_CPWM_8723D | */ -+ IMR_HIGHDOK_8723D | -+ IMR_MGNTDOK_8723D | -+ IMR_BKDOK_8723D | -+ IMR_BEDOK_8723D | -+ IMR_VIDOK_8723D | -+ IMR_VODOK_8723D | -+ IMR_RDU_8723D | -+ IMR_ROK_8723D | -+ 0); -+ pHalData->IntrMaskDefault[1] = (u32)( -+ IMR_RXFOVW_8723D | -+ IMR_TXFOVW_8723D | -+ 0); -+ -+ /* 2012/03/27 hpfan Add for win8 DTM DPC ISR test */ -+ pHalData->IntrMaskReg[0] = (u32)( -+ IMR_RDU_8723D | -+ IMR_PSTIMEOUT_8723D | -+ 0); -+ pHalData->IntrMaskReg[1] = (u32)( -+ IMR_C2HCMD_8723D | -+ 0); -+ -+ /* if (padapter->bUseThreadHandleInterrupt) */ -+ /* { */ -+ /* pHalData->IntrMask[0] = pHalData->IntrMaskReg[0]; */ -+ /* pHalData->IntrMask[1] = pHalData->IntrMaskReg[1]; */ -+ /* } */ -+ /* else */ -+ { -+ pHalData->IntrMask[0] = pHalData->IntrMaskDefault[0]; -+ pHalData->IntrMask[1] = pHalData->IntrMaskDefault[1]; -+ } -+ -+ -+ if (1) {/* IS_HARDWARE_TYPE_8723DE(padapter)) */ -+ -+ pHalData->SysIntrMask[0] = (u32)( -+ HSIMR_PDN_INT_EN | -+ HSIMR_RON_INT_EN | -+ 0); -+ } -+} -+ -+void rtl8723de_set_hal_ops(_adapter *padapter) -+{ -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ -+ -+ rtl8723d_set_hal_ops(pHalFunc); -+ -+ pHalFunc->hal_power_on = &_InitPowerOn_8723DE; -+ pHalFunc->hal_power_off = &hal_poweroff_8723DE; -+ pHalFunc->hal_init = &rtl8723de_hal_init; -+ pHalFunc->hal_deinit = &rtl8723de_hal_deinit; -+ -+ pHalFunc->inirp_init = &rtl8723de_init_desc_ring; -+ pHalFunc->inirp_deinit = &rtl8723de_free_desc_ring; -+ pHalFunc->irp_reset = &rtl8723de_reset_desc_ring; -+ -+ pHalFunc->init_xmit_priv = &rtl8723de_init_xmit_priv; -+ pHalFunc->free_xmit_priv = &rtl8723de_free_xmit_priv; -+ -+ pHalFunc->init_recv_priv = &rtl8723de_init_recv_priv; -+ pHalFunc->free_recv_priv = &rtl8723de_free_recv_priv; -+#ifdef CONFIG_SW_LED -+ pHalFunc->InitSwLeds = &rtl8723de_InitSwLeds; -+ pHalFunc->DeInitSwLeds = &rtl8723de_DeInitSwLeds; -+#else /* case of hw led or no led */ -+ pHalFunc->InitSwLeds = NULL; -+ pHalFunc->DeInitSwLeds = NULL; -+#endif/* CONFIG_SW_LED */ -+ -+ pHalFunc->init_default_value = &rtl8723de_init_default_value; -+ pHalFunc->intf_chip_configure = &rtl8723de_interface_configure; -+ pHalFunc->read_adapter_info = &ReadAdapterInfo8723DE; -+ -+ pHalFunc->enable_interrupt = &EnableInterrupt8723DE; -+ pHalFunc->disable_interrupt = &DisableInterrupt8723DE; -+ pHalFunc->interrupt_handler = &rtl8723de_interrupt; -+ -+ pHalFunc->SetHwRegHandler = &SetHwReg8723DE; -+ pHalFunc->GetHwRegHandler = &GetHwReg8723DE; -+ pHalFunc->GetHalDefVarHandler = &GetHalDefVar8723DE; -+ pHalFunc->SetHalDefVarHandler = &SetHalDefVar8723DE; -+ -+ pHalFunc->hal_xmit = &rtl8723de_hal_xmit; -+ pHalFunc->mgnt_xmit = &rtl8723de_mgnt_xmit; -+ pHalFunc->hal_xmitframe_enqueue = &rtl8723de_hal_xmitframe_enqueue; -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ pHalFunc->hostap_mgnt_xmit_entry = &rtl8723de_hostap_mgnt_xmit_entry; -+#endif -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+ pHalFunc->xmit_thread_handler = &rtl8723de_xmit_buf_handler; -+#endif -+ -+ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_ops_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_ops_linux.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_ops_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/pci_ops_linux.c 2018-02-11 21:44:27.163146330 +0200 -@@ -0,0 +1,954 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _HCI_OPS_OS_C_ -+ -+/*#include */ -+#include -+ -+static int rtl8723de_init_rx_ring(_adapter *padapter) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ struct net_device *dev = padapter->pnetdev; -+ dma_addr_t *mapping = NULL; -+ struct sk_buff *skb = NULL; -+ u8 *rx_bufdesc = NULL; -+ int i, rx_queue_idx; -+ -+ -+ /* rx_queue_idx 0:RX_MPDU_QUEUE */ -+ /* rx_queue_idx 1:RX_CMD_QUEUE */ -+ for (rx_queue_idx = 0; rx_queue_idx < 1/*RX_MAX_QUEUE*/; rx_queue_idx++) { -+ precvpriv->rx_ring[rx_queue_idx].buf_desc = -+ pci_alloc_consistent(pdev, -+ sizeof(*precvpriv->rx_ring[rx_queue_idx].buf_desc) * precvpriv->rxringcount, -+ &precvpriv->rx_ring[rx_queue_idx].dma); -+ -+ if (!precvpriv->rx_ring[rx_queue_idx].buf_desc -+ || (unsigned long)precvpriv->rx_ring[rx_queue_idx].buf_desc & 0xFF) { -+ RTW_INFO("Cannot allocate RX ring\n"); -+ return _FAIL; -+ } -+ -+ _rtw_memset(precvpriv->rx_ring[rx_queue_idx].buf_desc, 0, sizeof(*precvpriv->rx_ring[rx_queue_idx].buf_desc) * precvpriv->rxringcount); -+ precvpriv->rx_ring[rx_queue_idx].idx = 0; -+ -+ for (i = 0; i < precvpriv->rxringcount; i++) { -+ skb = rtw_skb_alloc(precvpriv->rxbuffersize); -+ -+ if (!skb) { -+ RTW_INFO("Cannot allocate skb for RX ring\n"); -+ return _FAIL; -+ } -+ -+ rx_bufdesc = (u8 *)(&precvpriv->rx_ring[rx_queue_idx].buf_desc[i]); -+ -+ precvpriv->rx_ring[rx_queue_idx].rx_buf[i] = skb; -+ -+ mapping = (dma_addr_t *)skb->cb; -+ -+ /* just set skb->cb to mapping addr for pci_unmap_single use */ -+ *mapping = pci_map_single(pdev, skb_tail_pointer(skb), -+ precvpriv->rxbuffersize, -+ PCI_DMA_FROMDEVICE); -+ -+ /* Reset FS, LS, Total len */ -+ SET_RX_BUFFER_DESC_LS_8723D(rx_bufdesc, 0); -+ SET_RX_BUFFER_DESC_FS_8723D(rx_bufdesc, 0); -+ SET_RX_BUFFER_DESC_TOTAL_LENGTH_8723D(rx_bufdesc, 0); -+ SET_RX_BUFFER_DESC_DATA_LENGTH_8723D(rx_bufdesc, precvpriv->rxbuffersize); -+ SET_RX_BUFFER_PHYSICAL_LOW_8723D(rx_bufdesc, ((*mapping) & DMA_BIT_MASK(32))); -+ SET_RX_BUFFER_PHYSICAL_HIGH_8723D(rx_bufdesc, ((*mapping) >> 32)); -+ } -+ } -+ -+ -+ return _SUCCESS; -+} -+ -+static void rtl8723de_free_rx_ring(_adapter *padapter) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ int i, rx_queue_idx; -+ -+ -+ /* rx_queue_idx 0:RX_MPDU_QUEUE */ -+ /* rx_queue_idx 1:RX_CMD_QUEUE */ -+ for (rx_queue_idx = 0; rx_queue_idx < 1/*RX_MAX_QUEUE*/; rx_queue_idx++) { -+ for (i = 0; i < precvpriv->rxringcount; i++) { -+ struct sk_buff *skb = precvpriv->rx_ring[rx_queue_idx].rx_buf[i]; -+ -+ if (!skb) -+ continue; -+ -+ pci_unmap_single(pdev, -+ *((dma_addr_t *) skb->cb), -+ precvpriv->rxbuffersize, -+ PCI_DMA_FROMDEVICE); -+ rtw_skb_free(skb); -+ } -+ -+ pci_free_consistent(pdev, -+ sizeof(*precvpriv->rx_ring[rx_queue_idx].buf_desc) * -+ precvpriv->rxringcount, -+ precvpriv->rx_ring[rx_queue_idx].buf_desc, -+ precvpriv->rx_ring[rx_queue_idx].dma); -+ precvpriv->rx_ring[rx_queue_idx].buf_desc = NULL; -+ } -+ -+} -+ -+ -+static int rtl8723de_init_tx_ring(_adapter *padapter, unsigned int prio, unsigned int entries) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ struct tx_buf_desc *ring; -+ dma_addr_t dma; -+ int i; -+ -+ -+ /* RTW_INFO("%s entries num:%d\n", __func__, entries); */ -+ ring = pci_alloc_consistent(pdev, sizeof(*ring) * entries, &dma); -+ if (!ring || (unsigned long)ring & 0xFF) { -+ RTW_INFO("Cannot allocate TX ring (prio = %d)\n", prio); -+ return _FAIL; -+ } -+ -+ _rtw_memset(ring, 0, sizeof(*ring) * entries); -+ pxmitpriv->tx_ring[prio].buf_desc = ring; -+ pxmitpriv->tx_ring[prio].dma = dma; -+ pxmitpriv->tx_ring[prio].idx = 0; -+ pxmitpriv->tx_ring[prio].entries = entries; -+ _rtw_init_queue(&pxmitpriv->tx_ring[prio].queue); -+ pxmitpriv->tx_ring[prio].qlen = 0; -+ pxmitpriv->tx_ring[prio].hw_rp_cache = 0; -+ -+ /* RTW_INFO("%s queue:%d, ring_addr:%p\n", __func__, prio, ring); */ -+ -+ -+ return _SUCCESS; -+} -+ -+static void rtl8723de_free_tx_ring(_adapter *padapter, unsigned int prio) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ struct rtw_tx_ring *ring = &pxmitpriv->tx_ring[prio]; -+ u8 *tx_bufdesc; -+ struct xmit_buf *pxmitbuf; -+ -+ -+ while (ring->qlen) { -+ tx_bufdesc = (u8 *)(&ring->buf_desc[ring->idx]); -+ -+ SET_TX_BUFF_DESC_OWN_8723D(tx_bufdesc, 0); -+ -+ if (prio != BCN_QUEUE_INX) -+ ring->idx = (ring->idx + 1) % ring->entries; -+ -+ pxmitbuf = rtl8723de_dequeue_xmitbuf(ring); -+ if (pxmitbuf) { -+ dma_addr_t mapping; -+ -+ mapping = GET_TX_BUFF_DESC_ADDR_LOW_0_8723D(tx_bufdesc); -+ mapping |= (dma_addr_t)GET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(tx_bufdesc) << 32; -+ -+ pci_unmap_single(pdev, mapping, pxmitbuf->len, PCI_DMA_TODEVICE); -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ } else -+ RTW_INFO("%s(): qlen(%d) is not zero, but have xmitbuf in pending queue\n", __func__, ring->qlen); -+ } -+ -+ pci_free_consistent(pdev, sizeof(*ring->buf_desc) * ring->entries, ring->buf_desc, ring->dma); -+ ring->buf_desc = NULL; -+ -+} -+ -+static void init_desc_ring_var(_adapter *padapter) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ u8 i = 0; -+ -+ for (i = 0; i < HW_QUEUE_ENTRY; i++) -+ pxmitpriv->txringcount[i] = TX_BD_NUM; -+ -+ /* we just alloc 2 desc for beacon queue, */ -+ /* because we just need first desc in hw beacon. */ -+ pxmitpriv->txringcount[BCN_QUEUE_INX] = 2; -+ -+ /* BE queue need more descriptor for performance consideration */ -+ /* or, No more tx desc will happen, and may cause mac80211 mem leakage. */ -+ /* if(!padapter->registrypriv.wifi_spec) */ -+ /* pxmitpriv->txringcount[BE_QUEUE_INX] = TXDESC_NUM_BE_QUEUE; */ -+#ifdef CONFIG_CONCURRENT_MODE -+ pxmitpriv->txringcount[BE_QUEUE_INX] *= 2; -+#endif -+ -+ pxmitpriv->txringcount[TXCMD_QUEUE_INX] = 2; -+ -+ precvpriv->rxbuffersize = MAX_RECVBUF_SZ; /* 2048;*/ /*1024; */ -+ precvpriv->rxringcount = PCI_MAX_RX_COUNT; /* 128; */ -+} -+ -+ -+u32 rtl8723de_init_desc_ring(_adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ int i, ret = _SUCCESS; -+ -+ -+ init_desc_ring_var(padapter); -+ -+ ret = rtl8723de_init_rx_ring(padapter); -+ if (ret == _FAIL) -+ return ret; -+ -+ /* general process for other queue */ -+ for (i = 0; i < PCI_MAX_TX_QUEUE_COUNT; i++) { -+ ret = rtl8723de_init_tx_ring(padapter, i, pxmitpriv->txringcount[i]); -+ if (ret == _FAIL) -+ goto err_free_rings; -+ } -+ -+ return ret; -+ -+err_free_rings: -+ -+ rtl8723de_free_rx_ring(padapter); -+ -+ for (i = 0; i < PCI_MAX_TX_QUEUE_COUNT; i++) -+ if (pxmitpriv->tx_ring[i].buf_desc) -+ rtl8723de_free_tx_ring(padapter, i); -+ -+ -+ return ret; -+} -+ -+u32 rtl8723de_free_desc_ring(_adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ u32 i; -+ -+ -+ /* free rx rings */ -+ rtl8723de_free_rx_ring(padapter); -+ -+ /* free tx rings */ -+ for (i = 0; i < PCI_MAX_TX_QUEUE_COUNT; i++) -+ rtl8723de_free_tx_ring(padapter, i); -+ -+ -+ return _SUCCESS; -+} -+ -+void rtl8723de_reset_desc_ring(_adapter *padapter) -+{ -+ _irqL irqL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct xmit_buf *pxmitbuf = NULL; -+ u8 *tx_bufdesc/*, *rx_bufdesc*/; -+ int i, rx_queue_idx; -+ -+ for (rx_queue_idx = 0; rx_queue_idx < 1; rx_queue_idx++) { -+ if (precvpriv->rx_ring[rx_queue_idx].buf_desc) { -+#if 0 -+ rx_bufdesc = NULL; -+ for (i = 0; i < precvpriv->rxringcount; i++) { -+ rx_bufdesc = (u8 *)(&precvpriv->rx_ring[rx_queue_idx].buf_desc[i]); -+ /*SET_RX_BUFFER_DESC_OWN_8723D(rx_bufdesc, 1);*/ -+ } -+#endif -+ precvpriv->rx_ring[rx_queue_idx].idx = 0; -+ } -+ } -+ -+ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ for (i = 0; i < PCI_MAX_TX_QUEUE_COUNT; i++) { -+ if (pxmitpriv->tx_ring[i].buf_desc) { -+ struct rtw_tx_ring *ring = &pxmitpriv->tx_ring[i]; -+ -+ while (ring->qlen) { -+ tx_bufdesc = (u8 *)(&ring->buf_desc[ring->idx]); -+ -+ SET_TX_BUFF_DESC_OWN_8723D(tx_bufdesc, 0); -+ -+ if (i != BCN_QUEUE_INX) -+ ring->idx = (ring->idx + 1) % ring->entries; -+ -+ pxmitbuf = rtl8723de_dequeue_xmitbuf(ring); -+ if (pxmitbuf) { -+ dma_addr_t mapping; -+ -+ mapping = GET_TX_BUFF_DESC_ADDR_LOW_0_8723D(tx_bufdesc); -+ mapping |= (dma_addr_t)GET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(tx_bufdesc) << 32; -+ -+ pci_unmap_single(pdvobjpriv->ppcidev, mapping, pxmitbuf->len, PCI_DMA_TODEVICE); -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ } else -+ RTW_INFO("%s(): qlen(%d) is not zero, but have xmitbuf in pending queue\n", __func__, ring->qlen); -+ } -+ ring->idx = 0; -+ ring->hw_rp_cache = 0; -+ } -+ } -+ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ -+ /* Reset read/write point */ -+ rtw_write32(padapter, REG_BD_RW_PTR_CLR_8723D, 0XFFFFFFFF); -+} -+ -+static void rtl8723de_xmit_beacon(PADAPTER Adapter) -+{ -+#if defined(CONFIG_AP_MODE) && defined(CONFIG_NATIVEAP_MLME) -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ /* send_beacon(Adapter); */ -+ if (pmlmepriv->update_bcn == _TRUE) { -+ WLAN_BSSID_EX *cur_network = &Adapter->mlmeextpriv.mlmext_info.network; -+ -+ /* prevent beacon IE length is 0! */ -+ if (cur_network->IELength < _FIXED_IE_LENGTH_) { -+ /* RTW_INFO( "%s:%d cur_network->IELength=%u\n", __FUNCTION__, __LINE__, cur_network->IELength ); */ -+ return; -+ } -+ -+ tx_beacon_hdl(Adapter, NULL); -+ } -+ } -+#endif -+} -+ -+void rtl8723de_prepare_bcn_tasklet(void *priv) -+{ -+ _adapter *padapter = (_adapter *)priv; -+ -+ rtl8723de_xmit_beacon(padapter); -+} -+ -+u8 check_tx_desc_resource(_adapter *padapter, int prio) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct rtw_tx_ring *ring; -+ -+ ring = &pxmitpriv->tx_ring[prio]; -+ -+ /* for now we reserve two free descriptor as a safety boundary */ -+ /* between the tail and the head */ -+ if ((ring->entries - ring->qlen) >= 3) -+ return _TRUE; -+ -+ /* RTW_INFO("do not have enough desc for Tx\n"); */ -+ return _FALSE; -+} -+ -+static u32 rtl8723de_check_txdesc_closed(PADAPTER Adapter, u32 queue_idx, -+ struct rtw_tx_ring *ring) -+{ -+ /* -+ * hw_rp_cache is used to reduce REG access. -+ */ -+ u32 tmp32; -+ -+ /* bcn queue should not enter this function */ -+ if (queue_idx == BCN_QUEUE_INX) -+ return _TRUE; -+ -+ /* qlen == 0 --> don't need to process */ -+ if (ring->qlen == 0) -+ return _FALSE; -+ -+ /* sw_rp == hw_rp_cache --> sync hw_rp */ -+ if (ring->idx == ring->hw_rp_cache) { -+ -+ tmp32 = rtw_read32(Adapter, get_txbufdesc_idx_hwaddr(queue_idx)); -+ -+ ring->hw_rp_cache = (tmp32 >> 16) & 0x0FFF; -+ } -+ -+ /* check if need to handle TXOK */ -+ if (ring->idx == ring->hw_rp_cache) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+static void rtl8723de_tx_isr(PADAPTER Adapter, int prio) -+{ -+ struct xmit_priv *pxmitpriv = &Adapter->xmitpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ struct rtw_tx_ring *ring = &pxmitpriv->tx_ring[prio]; -+ struct xmit_buf *pxmitbuf; -+ u8 *tx_bufdesc; -+ -+ while (ring->qlen) { -+ tx_bufdesc = (u8 *)&ring->buf_desc[ring->idx]; -+ -+ /* beacon packet will only use the first descriptor defautly, */ -+ /* and the OWN may not be cleared by the hardware */ -+ if (prio != BCN_QUEUE_INX) { -+ if (!rtl8723de_check_txdesc_closed(Adapter, prio, ring)) -+ break; -+ -+ ring->idx = (ring->idx + 1) % ring->entries; -+ } else if (prio == BCN_QUEUE_INX) -+ SET_TX_BUFF_DESC_OWN_8723D(tx_bufdesc, 0); -+ -+ pxmitbuf = rtl8723de_dequeue_xmitbuf(ring); -+ if (pxmitbuf) { -+ dma_addr_t mapping; -+ -+ mapping = GET_TX_BUFF_DESC_ADDR_LOW_0_8723D(tx_bufdesc); -+ mapping |= (dma_addr_t)GET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(tx_bufdesc) << 32; -+ -+ pci_unmap_single(pdvobjpriv->ppcidev, mapping, pxmitbuf->len, PCI_DMA_TODEVICE); -+ rtw_sctx_done(&pxmitbuf->sctx); -+ rtw_free_xmitbuf(&(pxmitbuf->padapter->xmitpriv), pxmitbuf); -+ } else -+ RTW_INFO("%s(): qlen(%d) is not zero, but have xmitbuf in pending queue\n", __func__, ring->qlen); -+ } -+ -+ if ((prio != BCN_QUEUE_INX) && check_tx_desc_resource(Adapter, prio) -+ && rtw_xmit_ac_blocked(Adapter) != _TRUE -+ ) -+ rtw_mi_xmit_tasklet_schedule(Adapter); -+} -+ -+ -+s32 rtl8723de_interrupt(PADAPTER Adapter) -+{ -+ _irqL irqL; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ struct xmit_priv *pxmitpriv = &Adapter->xmitpriv; -+ int ret = _SUCCESS; -+ -+ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ -+ /* read ISR: 4/8bytes */ -+ if (InterruptRecognized8723DE(Adapter) == _FALSE) { -+ ret = _FAIL; -+ goto done; -+ } -+ -+ /* <1> beacon related */ -+ if (pHalData->IntArray[0] & IMR_TXBCN0OK_8723D) { -+ /*Modify for MI temporary,this processor cannot apply to multi-ap*/ -+ PADAPTER bcn_adapter = rtw_mi_get_ap_adapter(Adapter); -+ if (bcn_adapter->xmitpriv.beaconDMAing) { -+ bcn_adapter->xmitpriv.beaconDMAing = _FAIL; -+ rtl8723de_tx_isr(Adapter, BCN_QUEUE_INX); -+ } -+ } -+ -+ if (pHalData->IntArray[0] & IMR_TXBCN0ERR_8723D) { -+ /*Modify for MI temporary,this processor cannot apply to multi-ap*/ -+ PADAPTER bcn_adapter = rtw_mi_get_ap_adapter(Adapter); -+ if (bcn_adapter->xmitpriv.beaconDMAing) { -+ bcn_adapter->xmitpriv.beaconDMAing = _FAIL; -+ rtl8723de_tx_isr(Adapter, BCN_QUEUE_INX); -+ } -+ } -+ -+ if (pHalData->IntArray[0] & IMR_BCNDERR0_8723D) { -+ /* Release resource and re-transmit beacon to HW */ -+ struct tasklet_struct *bcn_tasklet; -+ /*Modify for MI temporary,this processor cannot apply to multi-ap*/ -+ PADAPTER bcn_adapter = rtw_mi_get_ap_adapter(Adapter); -+ rtl8723de_tx_isr(Adapter, BCN_QUEUE_INX); -+ bcn_adapter->mlmepriv.update_bcn = _TRUE; -+ bcn_tasklet = &bcn_adapter->recvpriv.irq_prepare_beacon_tasklet; -+ tasklet_hi_schedule(bcn_tasklet); -+ } -+ -+ if (pHalData->IntArray[0] & IMR_BCNDMAINT0_8723D) { -+ struct tasklet_struct *bcn_tasklet; -+ /*Modify for MI temporary,this processor cannot apply to multi-ap*/ -+ PADAPTER bcn_adapter = rtw_mi_get_ap_adapter(Adapter); -+ -+ bcn_tasklet = &bcn_adapter->recvpriv.irq_prepare_beacon_tasklet; -+ tasklet_hi_schedule(bcn_tasklet); -+ } -+ -+ /* <2> Rx related */ -+ if ((pHalData->IntArray[0] & (IMR_ROK_8723D | IMR_RDU_8723D)) || (pHalData->IntArray[1] & IMR_RXFOVW_8723D)) { -+ pHalData->IntrMask[0] &= (~(IMR_ROK_8723D | IMR_RDU_8723D)); -+ pHalData->IntrMask[1] &= (~IMR_RXFOVW_8723D); -+ rtw_write32(Adapter, REG_HIMR0_8723D, pHalData->IntrMask[0]); -+ rtw_write32(Adapter, REG_HIMR1_8723D, pHalData->IntrMask[1]); -+ tasklet_hi_schedule(&Adapter->recvpriv.recv_tasklet); -+ } -+ -+ /* <3> Tx related */ -+ if (pHalData->IntArray[1] & IMR_TXFOVW_8723D) { -+ /* */ -+ /* RTW_INFO("IMR_TXFOVW!\n"); */ -+ } -+ -+ /* if (pisr_content->IntArray[0] & IMR_TX_MASK) { */ -+ /* tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); */ -+ /* } */ -+ -+ if (pHalData->IntArray[0] & IMR_MGNTDOK_8723D) { -+ /* RTW_INFO("Manage ok interrupt!\n"); */ -+ rtl8723de_tx_isr(Adapter, MGT_QUEUE_INX); -+ } -+ -+ if (pHalData->IntArray[0] & IMR_HIGHDOK_8723D) { -+ /* RTW_INFO("HIGH_QUEUE ok interrupt!\n"); */ -+ rtl8723de_tx_isr(Adapter, HIGH_QUEUE_INX); -+ } -+ -+ if (pHalData->IntArray[0] & IMR_BKDOK_8723D) { -+ /* RTW_INFO("BK Tx OK interrupt!\n"); */ -+ rtl8723de_tx_isr(Adapter, BK_QUEUE_INX); -+ } -+ -+ if (pHalData->IntArray[0] & IMR_BEDOK_8723D) { -+ /* RTW_INFO("BE TX OK interrupt!\n"); */ -+ rtl8723de_tx_isr(Adapter, BE_QUEUE_INX); -+ } -+ -+ if (pHalData->IntArray[0] & IMR_VIDOK_8723D) { -+ /* RTW_INFO("VI TX OK interrupt!\n"); */ -+ rtl8723de_tx_isr(Adapter, VI_QUEUE_INX); -+ } -+ -+ if (pHalData->IntArray[0] & IMR_VODOK_8723D) { -+ /* RTW_INFO("Vo TX OK interrupt!\n"); */ -+ rtl8723de_tx_isr(Adapter, VO_QUEUE_INX); -+ } -+ -+done: -+ -+ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ -+ return ret; -+} -+ -+/* -+ * Wait until rx data is ready -+ * return value: _SUCCESS if Rx packet is ready, _FAIL if not ready -+ */ -+ -+static u32 -+rtl8723de_wait_rxrdy( -+ _adapter *padapter, -+ u8 *rx_bufdesc, -+ u16 rx_queue_idx -+) -+{ -+ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ u8 first_seg, last_seg; -+#ifdef USING_RX_TAG -+ u16 rx_tag; -+#else -+ u16 total_len; -+#endif -+ u16 read_cnt = 0; -+ u16 status = _SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (rx_bufdesc == NULL) -+ return _FAIL; -+ -+#ifdef USING_RX_TAG -+ rx_tag = (u2Byte)GET_RX_BUFFER_DESC_RX_TAG_8723D(rx_bufdesc); -+#else -+ total_len = (u2Byte)GET_RX_BUFFER_DESC_TOTAL_LENGTH_8723D(rx_bufdesc); -+#endif -+ first_seg = (u1Byte)GET_RX_BUFFER_DESC_FS_8723D(rx_bufdesc); -+ last_seg = (u1Byte)GET_RX_BUFFER_DESC_LS_8723D(rx_bufdesc); -+ -+ /*buf_desc_debug("RX:%s enter: rx_buf_desc addr = %p, total_len=%d, first_seg=%d, last_seg=%d, read_cnt %d, index %d, address %p\n",\ -+ __FUNCTION__, (u8 *)&precvpriv->rx_ring[rx_queue_idx].desc[precvpriv->rx_ring[rx_queue_idx].idx], total_len, first_seg, last_seg, read_cnt, precvpriv->rx_ring[rx_queue_idx].idx, rx_bufdesc);*/ -+ -+#if defined(USING_RX_TAG) -+ while (rx_tag != pHalData->RxTag) { -+ -+ read_cnt++; -+ -+ rx_tag = (u2Byte)GET_RX_BUFFER_DESC_RX_TAG_8723D(rx_bufdesc); -+ -+ first_seg = (u1Byte)GET_RX_BUFFER_DESC_FS_8723D(rx_bufdesc); -+ -+ last_seg = (u1Byte)GET_RX_BUFFER_DESC_LS_8723D(rx_bufdesc); -+ -+ -+ if (read_cnt > 100) { -+ RTW_INFO("RX:%s(%d) Before sync RxTag:sw=%X,hw=%X\n", __func__, __LINE__, pHalData->RxTag, rx_tag); -+ break; -+ } -+ } -+ -+ pHalData->RxTag = (rx_tag + 1) & 0x1FFF; /* rx tag occpies 13 bits [28:16] */ -+#else -+ while (total_len == 0 && first_seg == 0 && last_seg == 0) { -+ -+ read_cnt++; -+ -+ total_len = (u2Byte)GET_RX_BUFFER_DESC_TOTAL_LENGTH_8723D(rx_bufdesc); -+ -+ first_seg = (u1Byte)GET_RX_BUFFER_DESC_FS_8723D(rx_bufdesc); -+ -+ last_seg = (u1Byte)GET_RX_BUFFER_DESC_LS_8723D(rx_bufdesc); -+ -+ if (read_cnt > 20) { -+ status = _FAIL; -+ break; -+ } -+ } -+#endif -+ -+ /* -+ buf_desc_debug("RX:%s exit total_len=%d, rx_tag = %d, first_seg=%d, last_seg=%d, read_cnt %d\n",\ -+ __FUNCTION__, total_len, pHalData->RxTag, first_seg, last_seg, read_cnt); -+ */ -+ -+ return status; -+} -+ -+/* -+ * Check the number of rxdec to be handled between -+ * "index of RX queue descriptor maintained by host (write pointer)" and -+ * "index of RX queue descriptor maintained by hardware (read pointer)" -+ */ -+static u16 rtl8723de_check_rxdesc_remain(_adapter *padapter, struct rtw_rx_ring *prxring) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ u16 desc_idx_hw_wp, desc_idx_host_rp; -+ u32 tmp_4bytes; -+ -+ int num_rxdesc_to_handle; -+ -+ tmp_4bytes = rtw_read32(padapter, REG_RXQ_TXBD_IDX_8723D); -+ desc_idx_hw_wp = (u16)((tmp_4bytes >> 16) & 0x7ff); -+ desc_idx_host_rp = (u16)(tmp_4bytes & 0x7ff); -+ -+ /* make sure driver does not handle packet if hardware pointer keeps in zero */ -+ /* in initial state */ -+ /*buf_desc_debug("RX:%s(%d) reg_value %x\n", __FUNCTION__, __LINE__, tmp_4bytes);*/ -+ -+ num_rxdesc_to_handle = desc_idx_hw_wp - desc_idx_host_rp; -+ -+ if (num_rxdesc_to_handle == 0) -+ return 0; /* No RX */ -+ -+ if (num_rxdesc_to_handle < 0) /* wrap-around case */ -+ num_rxdesc_to_handle += RX_BD_NUM; -+ -+ if (prxring->idx != desc_idx_host_rp) { -+ prxring->idx = desc_idx_host_rp; -+ RTW_INFO("RX: %s(%d) host_rp is inconsistent: sw=%X, hw=%X\n", -+ __func__, __LINE__, prxring->idx, desc_idx_host_rp); -+ } -+ -+ /* buf_desc_debug("RX:%s reg_value %x, last_desc_idx_hw = %x, current hw idx %x, current host idx %x, remain desc to handle = %d\n",\ -+ __FUNCTION__, tmp_4bytes, last_idx_hw, desc_idx_hw, desc_idx_host, num_rxdesc_to_handle); */ -+ -+ return (u16)num_rxdesc_to_handle; -+} -+ -+static void rtl8723de_rx_mpdu(_adapter *padapter) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ _queue *pfree_recv_queue = &precvpriv->free_recv_queue; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ union recv_frame *precvframe = NULL; -+ u8 *pphy_info = NULL; -+ struct rx_pkt_attrib *pattrib = NULL; -+ int rx_queue_idx = RX_MPDU_QUEUE; -+ u16 remaing_rxdesc = 0; -+ struct rtw_rx_ring *prxring; -+ -+ prxring = &precvpriv->rx_ring[rx_queue_idx]; -+ -+ remaing_rxdesc = rtl8723de_check_rxdesc_remain(padapter, prxring); -+ -+ /* RX NORMAL PKT */ -+ while (remaing_rxdesc) { -+ u8 *rx_bufdesc = (u8 *)&prxring->buf_desc[prxring->idx];/* rx descriptor */ -+ struct sk_buff *skb = prxring->rx_buf[prxring->idx];/* rx pkt */ -+ -+ if (rtl8723de_wait_rxrdy(padapter, rx_bufdesc, rx_queue_idx) != _SUCCESS) -+ RTW_INFO("RX:%s(%d) packet not ready\n", __func__, __LINE__); -+ -+ { -+ precvframe = rtw_alloc_recvframe(pfree_recv_queue); -+ if (precvframe == NULL) { -+ RTW_INFO("%s: precvframe==NULL\n", __func__); -+ goto done; -+ } -+ -+ _rtw_init_listhead(&precvframe->u.hdr.list); -+ precvframe->u.hdr.len = 0; -+ -+ pci_unmap_single(pdvobjpriv->ppcidev, -+ *((dma_addr_t *)skb->cb), -+ precvpriv->rxbuffersize, -+ PCI_DMA_FROMDEVICE); -+ -+ rtl8723d_query_rx_desc_status(precvframe, skb->data); -+ pattrib = &precvframe->u.hdr.attrib; -+ -+#ifdef CONFIG_RX_PACKET_APPEND_FCS -+ if (check_fwstate(&padapter->mlmepriv, WIFI_MONITOR_STATE) == _FALSE) -+ if ((pattrib->pkt_rpt_type == NORMAL_RX) && (pHalData->ReceiveConfig & RCR_APPFCS)) -+ pattrib->pkt_len -= IEEE80211_FCS_LEN; -+#endif -+ -+ if (rtw_os_alloc_recvframe(padapter, precvframe, -+ (skb->data + RXDESC_SIZE + pattrib->drvinfo_sz + pattrib->shift_sz), skb) == _FAIL) { -+ rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); -+ RTW_INFO("rtl8723de_rx_mpdu:can not allocate memory for skb copy\n"); -+ *((dma_addr_t *) skb->cb) = pci_map_single(pdvobjpriv->ppcidev, skb_tail_pointer(skb), precvpriv->rxbuffersize, PCI_DMA_FROMDEVICE); -+ goto done; -+ } -+ -+ recvframe_put(precvframe, pattrib->pkt_len); -+ -+ /* Normal rx packet */ -+ if (pattrib->pkt_rpt_type == NORMAL_RX) { -+ if (pattrib->physt) -+ pphy_info = (u8 *)(skb->data) + RXDESC_SIZE; -+#ifdef CONFIG_CONCURRENT_MODE -+ pre_recv_entry(precvframe, pphy_info); -+#endif -+ -+ if (pattrib->physt && pphy_info) -+ rx_query_phy_status(precvframe, pphy_info); -+ -+ rtw_recv_entry(precvframe); -+ } else { -+#ifdef CONFIG_FW_C2H_PKT -+ if (pattrib->pkt_rpt_type == C2H_PACKET) -+ rtw_hal_c2h_pkt_pre_hdl(padapter, precvframe->u.hdr.rx_data, pattrib->pkt_len); -+ else { -+ RTW_INFO("%s: [WARNNING] RX type(%d) not be handled!\n", -+ __func__, pattrib->pkt_rpt_type); -+ } -+#endif -+ rtw_free_recvframe(precvframe, pfree_recv_queue); -+ } -+ -+ *((dma_addr_t *) skb->cb) = pci_map_single(pdvobjpriv->ppcidev, skb_tail_pointer(skb), precvpriv->rxbuffersize, PCI_DMA_FROMDEVICE); -+ } -+done: -+ -+ SET_RX_BUFFER_PHYSICAL_LOW_8723D(rx_bufdesc, (*((dma_addr_t *)skb->cb) & DMA_BIT_MASK(32))); -+ SET_RX_BUFFER_PHYSICAL_HIGH_8723D(rx_bufdesc, (*((dma_addr_t *)skb->cb) >> 32)); -+ SET_RX_BUFFER_DESC_DATA_LENGTH_8723D(rx_bufdesc, precvpriv->rxbuffersize); -+ -+ prxring->idx = (prxring->idx + 1) % precvpriv->rxringcount; -+ rtw_write16(padapter, REG_RXQ_TXBD_IDX_8723D, prxring->idx); -+ -+ remaing_rxdesc--; -+ } -+ -+} -+ -+void rtl8723de_recv_tasklet(void *priv) -+{ -+ _irqL irqL; -+ _adapter *padapter = (_adapter *)priv; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ -+ rtl8723de_rx_mpdu(padapter); -+ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ pHalData->IntrMask[0] |= (IMR_ROK_8723D | IMR_RDU_8723D); -+ pHalData->IntrMask[1] |= IMR_RXFOVW_8723D; -+ rtw_write32(padapter, REG_HIMR0_8723D, pHalData->IntrMask[0]); -+ rtw_write32(padapter, REG_HIMR1_8723D, pHalData->IntrMask[1]); -+ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); -+} -+ -+static u8 pci_read8(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; -+ -+ /* printk("%s, addr=%08x, val=%02x\n", __func__, addr, readb((u8 *)pdvobjpriv->pci_mem_start + addr)); */ -+ return 0xff & readb((u8 *)pdvobjpriv->pci_mem_start + addr); -+} -+ -+static u16 pci_read16(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; -+ /* printk("%s, addr=%08x, val=%04x\n", __func__, addr, readw((u8 *)pdvobjpriv->pci_mem_start + addr)); */ -+ return readw((u8 *)pdvobjpriv->pci_mem_start + addr); -+} -+ -+static u32 pci_read32(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; -+ -+ /* printk("%s, addr=%08x, val=%08x\n", __func__, addr, readl((u8 *)pdvobjpriv->pci_mem_start + addr)); */ -+ return readl((u8 *)pdvobjpriv->pci_mem_start + addr); -+} -+ -+/* 2009.12.23. by tynli. Suggested by SD1 victorh. For ASPM hang on AMD and Nvidia. -+ * 20100212 Tynli: Do read IO operation after write for all PCI bridge suggested by SD1. -+ * Origianally this is only for INTEL. */ -+static int pci_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val) -+{ -+ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; -+ -+ writeb(val, (u8 *)pdvobjpriv->pci_mem_start + addr); -+ /* readb((u8 *)pdvobjpriv->pci_mem_start + addr); */ -+ return 1; -+} -+ -+static int pci_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val) -+{ -+ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; -+ -+ writew(val, (u8 *)pdvobjpriv->pci_mem_start + addr); -+ /* readw((u8 *)pdvobjpriv->pci_mem_start + addr); */ -+ return 2; -+} -+ -+static int pci_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val) -+{ -+ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; -+ -+ writel(val, (u8 *)pdvobjpriv->pci_mem_start + addr); -+ /* readl((u8 *)pdvobjpriv->pci_mem_start + addr); */ -+ return 4; -+} -+ -+ -+static void pci_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) -+{ -+ -+} -+ -+static void pci_write_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) -+{ -+ -+} -+ -+static u32 pci_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) -+{ -+ return 0; -+} -+ -+void rtl8723de_xmit_tasklet(void *priv) -+{ -+ /* _irqL irqL; */ -+ _adapter *padapter = (_adapter *)priv; -+ /* struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); */ -+ /* PRT_ISR_CONTENT pisr_content = &pdvobjpriv->isr_content; */ -+ -+#if 1 -+ /* try to deal with the pending packets */ -+ rtl8723de_xmitframe_resume(padapter); -+#else -+ _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ -+ if (pisr_content->IntArray[0] & IMR_BCNDERR0_88E) { -+ /* RTW_INFO("beacon interrupt!\n"); */ -+ rtl8188ee_tx_isr(padapter, BCN_QUEUE_INX); -+ } -+ -+ if (pisr_content->IntArray[0] & IMR_MGNTDOK) { -+ /* RTW_INFO("Manage ok interrupt!\n"); */ -+ rtl8188ee_tx_isr(padapter, MGT_QUEUE_INX); -+ } -+ -+ if (pisr_content->IntArray[0] & IMR_HIGHDOK) { -+ /* RTW_INFO("HIGH_QUEUE ok interrupt!\n"); */ -+ rtl8188ee_tx_isr(padapter, HIGH_QUEUE_INX); -+ } -+ -+ if (pisr_content->IntArray[0] & IMR_BKDOK) { -+ /* RTW_INFO("BK Tx OK interrupt!\n"); */ -+ rtl8188ee_tx_isr(padapter, BK_QUEUE_INX); -+ } -+ -+ if (pisr_content->IntArray[0] & IMR_BEDOK) { -+ /* RTW_INFO("BE TX OK interrupt!\n"); */ -+ rtl8188ee_tx_isr(padapter, BE_QUEUE_INX); -+ } -+ -+ if (pisr_content->IntArray[0] & IMR_VIDOK) { -+ /* RTW_INFO("VI TX OK interrupt!\n"); */ -+ rtl8188ee_tx_isr(padapter, VI_QUEUE_INX); -+ } -+ -+ if (pisr_content->IntArray[0] & IMR_VODOK) { -+ /* RTW_INFO("Vo TX OK interrupt!\n"); */ -+ rtl8188ee_tx_isr(padapter, VO_QUEUE_INX); -+ } -+ -+ _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); -+ -+ if (check_fwstate(&padapter->mlmepriv, _FW_UNDER_SURVEY) != _TRUE) { -+ /* try to deal with the pending packets */ -+ rtl8723de_xmitframe_resume(padapter); -+ } -+#endif -+ -+} -+ -+static u32 pci_write_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) -+{ -+ _adapter *padapter = (_adapter *)pintfhdl->padapter; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 7, 0)) -+ netif_trans_update(padapter->pnetdev); -+#else -+ padapter->pnetdev->trans_start = jiffies; -+#endif -+ -+ return 0; -+} -+ -+void rtl8723de_set_intf_ops(struct _io_ops *pops) -+{ -+ -+ _rtw_memset((u8 *)pops, 0, sizeof(struct _io_ops)); -+ -+ pops->_read8 = &pci_read8; -+ pops->_read16 = &pci_read16; -+ pops->_read32 = &pci_read32; -+ -+ pops->_read_mem = &pci_read_mem; -+ pops->_read_port = &pci_read_port; -+ -+ pops->_write8 = &pci_write8; -+ pops->_write16 = &pci_write16; -+ pops->_write32 = &pci_write32; -+ -+ pops->_write_mem = &pci_write_mem; -+ pops->_write_port = &pci_write_port; -+ -+ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_led.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_led.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_led.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_led.c 2018-02-11 21:44:27.163146330 +0200 -@@ -0,0 +1,110 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include "drv_types.h" -+#include -+ -+/* ================================================================================ -+ * Prototype of protected function. -+ * ================================================================================ */ -+ -+/* ================================================================================ -+ * LED_819xUsb routines. -+ * ================================================================================ */ -+ -+/* -+ * Description: -+ * Turn on LED according to LedPin specified. -+ */ -+VOID -+SwLedOn_8723DE( -+ IN PADAPTER Adapter, -+ IN PLED_PCIE pLed -+) -+{ -+ u16 LedReg = REG_LEDCFG0; -+ u8 LedCfg = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ -+ if (RTW_CANNOT_RUN(Adapter)) -+ return; -+ -+ pLed->bLedOn = _TRUE; -+} -+ -+ -+/* -+ * Description: -+ * Turn off LED according to LedPin specified. -+ */ -+VOID -+SwLedOff_8723DE( -+ IN PADAPTER Adapter, -+ IN PLED_PCIE pLed -+) -+{ -+ u16 LedReg = REG_LEDCFG0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ -+ if (RTW_CANNOT_RUN(Adapter)) -+ return; -+ -+ pLed->bLedOn = _FALSE; -+} -+ -+ -+/* -+ * Description: -+ * Initialize all LED_871x objects. -+ */ -+void -+rtl8723de_InitSwLeds( -+ _adapter *padapter -+) -+{ -+ struct led_priv *pledpriv = &(padapter->ledpriv); -+ -+ pledpriv->LedControlHandler = LedControlPCIE; -+ -+ pledpriv->SwLedOn = SwLedOn_8723DE; -+ pledpriv->SwLedOff = SwLedOff_8723DE; -+ -+ InitLed(padapter, &(pledpriv->SwLed0), LED_PIN_LED0); -+ -+ InitLed(padapter, &(pledpriv->SwLed1), LED_PIN_LED1); -+} -+ -+ -+/* -+ * Description: -+ * DeInitialize all LED_819xUsb objects. -+ */ -+void -+rtl8723de_DeInitSwLeds( -+ _adapter *padapter -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ -+ DeInitLed(&(ledpriv->SwLed0)); -+ DeInitLed(&(ledpriv->SwLed1)); -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_recv.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_recv.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_recv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_recv.c 2018-02-11 21:44:27.163146330 +0200 -@@ -0,0 +1,51 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTL8723DE_RECV_C_ -+ -+/*#include */ -+#include -+ -+ -+s32 rtl8723de_init_recv_priv(_adapter *padapter) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ s32 ret = _SUCCESS; -+ -+ -+#ifdef PLATFORM_LINUX -+ tasklet_init(&precvpriv->recv_tasklet, -+ (void(*)(unsigned long))rtl8723de_recv_tasklet, -+ (unsigned long)padapter); -+ -+ tasklet_init(&precvpriv->irq_prepare_beacon_tasklet, -+ (void(*)(unsigned long))rtl8723de_prepare_bcn_tasklet, -+ (unsigned long)padapter); -+#endif -+ -+ -+ return ret; -+} -+ -+void rtl8723de_free_recv_priv(_adapter *padapter) -+{ -+ /*struct recv_priv *precvpriv = &padapter->recvpriv;*/ -+ -+ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_xmit.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_xmit.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_xmit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/pci/rtl8723de_xmit.c 2018-02-11 21:44:27.163146330 +0200 -@@ -0,0 +1,770 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTL8723DE_XMIT_C_ -+ -+/*#include */ -+#include -+ -+static void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, u8 *ptxdesc) -+{ -+ u8 bDumpTxPkt; -+ u8 bDumpTxDesc = _FALSE; -+ -+ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DUMP_TXPKT, &(bDumpTxPkt)); -+ -+ if (bDumpTxPkt == 1) {/* dump txdesc for data frame */ -+ RTW_INFO("dump tx_desc for data frame\n"); -+ if ((frame_tag & 0x0f) == DATA_FRAMETAG) -+ bDumpTxDesc = _TRUE; -+ } else if (bDumpTxPkt == 2) {/* dump txdesc for mgnt frame */ -+ RTW_INFO("dump tx_desc for mgnt frame\n"); -+ if ((frame_tag & 0x0f) == MGNT_FRAMETAG) -+ bDumpTxDesc = _TRUE; -+ } else if (bDumpTxPkt == 3) {/* dump early info */ -+ } -+ -+ if (bDumpTxDesc) { -+ /* ptxdesc->txdw4 = cpu_to_le32(0x00001006);*/ /*RTS Rate=24M */ -+ /* ptxdesc->txdw6 = 0x6666f800; */ -+ RTW_INFO("=====================================\n"); -+ RTW_INFO("Offset00(0x%08x)\n", *((u32 *)(ptxdesc))); -+ RTW_INFO("Offset04(0x%08x)\n", *((u32 *)(ptxdesc + 4))); -+ RTW_INFO("Offset08(0x%08x)\n", *((u32 *)(ptxdesc + 8))); -+ RTW_INFO("Offset12(0x%08x)\n", *((u32 *)(ptxdesc + 12))); -+ RTW_INFO("Offset16(0x%08x)\n", *((u32 *)(ptxdesc + 16))); -+ RTW_INFO("Offset20(0x%08x)\n", *((u32 *)(ptxdesc + 20))); -+ RTW_INFO("Offset24(0x%08x)\n", *((u32 *)(ptxdesc + 24))); -+ RTW_INFO("Offset28(0x%08x)\n", *((u32 *)(ptxdesc + 28))); -+ RTW_INFO("Offset32(0x%08x)\n", *((u32 *)(ptxdesc + 32))); -+ RTW_INFO("Offset36(0x%08x)\n", *((u32 *)(ptxdesc + 36))); -+ RTW_INFO("=====================================\n"); -+ } -+ -+} -+ -+s32 rtl8723de_init_xmit_priv(_adapter *padapter) -+{ -+ s32 ret = _SUCCESS; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ -+ _rtw_spinlock_init(&pdvobjpriv->irq_th_lock); -+ -+#ifdef PLATFORM_LINUX -+ tasklet_init(&pxmitpriv->xmit_tasklet, -+ (void(*)(unsigned long))rtl8723de_xmit_tasklet, -+ (unsigned long)padapter); -+#endif -+ -+ return ret; -+} -+ -+void rtl8723de_free_xmit_priv(_adapter *padapter) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ -+ _rtw_spinlock_free(&pdvobjpriv->irq_th_lock); -+} -+ -+s32 rtl8723de_enqueue_xmitbuf(struct rtw_tx_ring *ring, struct xmit_buf *pxmitbuf) -+{ -+ _irqL irqL; -+ _queue *ppending_queue = &ring->queue; -+ -+ -+ /* RTW_INFO("+enqueue_xmitbuf\n"); */ -+ -+ if (pxmitbuf == NULL) -+ return _FAIL; -+ -+ /* _enter_critical(&ppending_queue->lock, &irqL); */ -+ -+ rtw_list_delete(&pxmitbuf->list); -+ -+ rtw_list_insert_tail(&(pxmitbuf->list), get_list_head(ppending_queue)); -+ -+ ring->qlen++; -+ -+ /* RTW_INFO("FREE, free_xmitbuf_cnt=%d\n", pxmitpriv->free_xmitbuf_cnt); */ -+ -+ /* _exit_critical(&ppending_queue->lock, &irqL); */ -+ -+ -+ return _SUCCESS; -+} -+ -+struct xmit_buf *rtl8723de_dequeue_xmitbuf(struct rtw_tx_ring *ring) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct xmit_buf *pxmitbuf = NULL; -+ _queue *ppending_queue = &ring->queue; -+ -+ -+ /* _enter_critical(&ppending_queue->lock, &irqL); */ -+ -+ if (_rtw_queue_empty(ppending_queue) == _TRUE) -+ pxmitbuf = NULL; -+ else { -+ -+ phead = get_list_head(ppending_queue); -+ -+ plist = get_next(phead); -+ -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ -+ rtw_list_delete(&(pxmitbuf->list)); -+ -+ ring->qlen--; -+ } -+ -+ /* _exit_critical(&ppending_queue->lock, &irqL); */ -+ -+ -+ return pxmitbuf; -+} -+ -+static u16 ffaddr2dma(u32 addr) -+{ -+ u16 dma_ctrl; -+ -+ switch (addr) { -+ case VO_QUEUE_INX: -+ dma_ctrl = BIT(3); -+ break; -+ case VI_QUEUE_INX: -+ dma_ctrl = BIT(2); -+ break; -+ case BE_QUEUE_INX: -+ dma_ctrl = BIT(1); -+ break; -+ case BK_QUEUE_INX: -+ dma_ctrl = BIT(0); -+ break; -+ case BCN_QUEUE_INX: -+ dma_ctrl = BIT(4); -+ break; -+ case MGT_QUEUE_INX: -+ dma_ctrl = BIT(6); -+ break; -+ case HIGH_QUEUE_INX: -+ dma_ctrl = BIT(7); -+ break; -+ default: -+ dma_ctrl = 0; -+ break; -+ } -+ -+ return dma_ctrl; -+} -+ -+/* -+ * Fill tx buffer desciptor. Map each buffer address in tx buffer descriptor segment -+ * Designed for tx buffer descriptor architecture -+ * Input *pmem: pointer to the Tx Buffer Descriptor -+ */ -+static void update_txbufdesc(struct xmit_frame *pxmitframe, u8 *pmem, s32 sz) -+{ -+ _adapter *padapter = pxmitframe->padapter; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ dma_addr_t mapping; -+ u32 i = 0; -+ u16 seg_num = 2 << TX_BUFFER_SEG_NUM; /* 0: 2 seg, 1: 4 seg, 2: 8 seg. */ -+ u16 page_size_length = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ mapping = pci_map_single(pdvobjpriv->ppcidev, pxmitframe->buf_addr , sz + TX_WIFI_INFO_SIZE, PCI_DMA_TODEVICE); -+ -+ /* Calculate page size. Total buffer length including TX_WIFI_INFO and PacketLen */ -+ page_size_length = (sz + TX_WIFI_INFO_SIZE - 1) / PAGE_SIZE_TX_8723D + 1; -+ -+ /* Reset all tx buffer desciprtor content */ -+ /* -- Reset first element */ -+ SET_TX_BUFF_DESC_LEN_0_8723D(pmem, 0); -+ SET_TX_BUFF_DESC_PSB_8723D(pmem, 0); -+ SET_TX_BUFF_DESC_OWN_8723D(pmem, 0); -+ /* -- Reset second and other element */ -+ for (i = 1 ; i < seg_num ; i++) { -+ SET_TXBUFFER_DESC_LEN_WITH_OFFSET(pmem, i, 0); -+ SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(pmem, i, 0); -+ SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(pmem, i, 0); -+ } -+ -+ /* Fill buffer length of the first buffer, */ -+ /* For 8723de, it is required that TX_WIFI_INFO is put in first segment, and the size */ -+ /* of the first segment cannot be larger than TX_WIFI_INFO_SIZE. */ -+ SET_TX_BUFF_DESC_LEN_0_8723D(pmem, TX_WIFI_INFO_SIZE); -+ SET_TX_BUFF_DESC_PSB_8723D(pmem, page_size_length); -+ SET_TX_BUFF_DESC_ADDR_LOW_0_8723D(pmem, (mapping & DMA_BIT_MASK(32))); -+ SET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(pmem, (mapping >> 32)); -+ -+ /* It is assumed that in linux implementation, packet is coalesced in only one buffer */ -+ /* Extension mode is not supported here */ -+ SET_TXBUFFER_DESC_LEN_WITH_OFFSET(pmem, 1, sz); -+ SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(pmem, 1, 0); /* don't using extendsion mode. */ -+ SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(pmem, 1, ((mapping + TX_WIFI_INFO_SIZE) & DMA_BIT_MASK(32))); -+ SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(pmem, 1, ((mapping + TX_WIFI_INFO_SIZE) >> 32)); -+ -+#if 0 -+ buf_desc_debug("TX:%s, tx_buf_desc = 0x%08x\n", __func__, (u32)pmem); -+ buf_desc_debug("TX:%s, Offset00(0x%08x)\n", __func__, *((u32 *)(pmem))); -+ buf_desc_debug("TX:%s, Offset04(0x%08x)\n", __func__, *((u32 *)(pmem + 4))); -+ buf_desc_debug("TX:%s, Offset08(0x%08x)\n", __func__, *((u32 *)(pmem + 8))); -+ buf_desc_debug("TX:%s, Offset12(0x%08x)\n", __func__, *((u32 *)(pmem + 12))); -+#endif -+} -+ -+static s32 update_txdesc(struct xmit_frame *pxmitframe) -+{ -+ _adapter *padapter = pxmitframe->padapter; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ u8 *ptxdesc = pxmitframe->buf_addr; -+ -+ _rtw_memset(ptxdesc, 0, TXDESC_SIZE); -+ -+ rtl8723d_update_txdesc(pxmitframe, ptxdesc); -+ -+ /* Don't set value before, because rtl8723d_update_txdesc() will clean ptxdesc. */ -+ -+ /* 4 offset 0 */ -+ /* SET_TX_DESC_FIRST_SEG_8723D(ptxdesc, 1); */ -+ /* SET_TX_DESC_LAST_SEG_8723D(ptxdesc, 1); */ -+ /* SET_TX_DESC_OWN_8723D(ptxdesc, 1); */ -+ -+ /* SET_TX_DESC_TX_BUFFER_SIZE_8723D(ptxdesc, sz); */ -+ /* SET_TX_DESC_TX_BUFFER_ADDRESS_8723D(ptxdesc, mapping); */ -+ -+ /* debug */ -+ _dbg_dump_tx_info(padapter, pxmitframe->frame_tag, ptxdesc); -+ -+ return 0; -+} -+ -+static u8 *get_txbufdesc(_adapter *padapter, u8 queue_index) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct rtw_tx_ring *ring; -+ u8 *pbufdesc; -+ int idx; -+ -+ ring = &pxmitpriv->tx_ring[queue_index]; -+ -+ if (queue_index != BCN_QUEUE_INX) -+ idx = (ring->idx + ring->qlen) % ring->entries; -+ else -+ idx = 0; -+ -+ pbufdesc = (u8 *)&ring->buf_desc[idx]; -+ -+ if ((queue_index != BCN_QUEUE_INX) && (ring->entries - ring->qlen == 1)) { -+ /* -+ * If we fall into this case, we may enlarge checking boundary in -+ * check_nic_enough_desc(). -+ */ -+ RTW_INFO("No more TX desc@%d, ring->idx = %d,idx = %d\n", queue_index, ring->idx, idx); -+ return NULL; -+ } -+ -+ return pbufdesc; -+} -+ -+u16 get_txbufdesc_idx_hwaddr(u16 ff_hwaddr) -+{ -+ u16 txbuf_desc_addr = REG_BEQ_TXBD_IDX_8723D; -+ -+ switch (ff_hwaddr) { -+ case BK_QUEUE_INX: -+ txbuf_desc_addr = REG_BKQ_TXBD_IDX_8723D; -+ break; -+ -+ case BE_QUEUE_INX: -+ txbuf_desc_addr = REG_BEQ_TXBD_IDX_8723D; -+ break; -+ -+ case VI_QUEUE_INX: -+ txbuf_desc_addr = REG_VIQ_TXBD_IDX_8723D; -+ break; -+ -+ case VO_QUEUE_INX: -+ txbuf_desc_addr = REG_VOQ_TXBD_IDX_8723D; -+ break; -+ -+ case BCN_QUEUE_INX: -+ txbuf_desc_addr = REG_BEQ_TXBD_IDX_8723D; /*need check*/ -+ break; -+ -+ case TXCMD_QUEUE_INX: -+ txbuf_desc_addr = REG_BEQ_TXBD_IDX_8723D; /*need check*/ -+ break; -+ -+ case MGT_QUEUE_INX: -+ txbuf_desc_addr = REG_MGQ_TXBD_IDX_8723D; -+ break; -+ -+ case HIGH_QUEUE_INX: -+ txbuf_desc_addr = REG_HI0Q_TXBD_IDX_8723D; -+ break; -+ -+ default: -+ break; -+ } -+ -+ return txbuf_desc_addr; -+} -+ -+/* -+ * Update Read/Write pointer -+ * Read pointer is h/w descriptor index -+ * Write pointer is host desciptor index: For tx side, if own bit is set in packet index n, -+ * host pointer (write pointer) point to index n + 1.) -+ */ -+void fill_txbufdesc_own(_adapter *padapter, u8 *txbufdesc, u16 queue_idx, struct rtw_tx_ring *ptxring) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ u16 host_wp; -+ -+ if (queue_idx == BCN_QUEUE_INX) { -+ /*Adapter->CurrentTXWritePoint[QueueIndex] = Adapter->CurrentTXReadPoint[QueueIndex] =0;*/ -+ -+ SET_TX_BUFF_DESC_OWN_8723D(txbufdesc, 1); -+ -+ /* kick start */ -+ rtw_write8(padapter, REG_RX_RXBD_NUM_8723D + 1, -+ rtw_read8(padapter, REG_RX_RXBD_NUM_8723D + 1) | BIT(4)); -+ -+ return; -+ } -+ -+ /* update h/w index -+ * for tx side, if own bit is set in packet index n, host pointer (write pointer) point to index n + 1. -+ */ -+ /* for current tx packet, enqueue has been ring->qlen++ before. -+ * so, host_wp = ring->idx + ring->qlen. -+ */ -+ host_wp = (ptxring->idx + ptxring->qlen) % ptxring->entries; -+ rtw_write16(padapter, get_txbufdesc_idx_hwaddr(queue_idx), host_wp); -+} -+ -+s32 rtw_dump_xframe(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ s32 ret = _SUCCESS; -+ s32 inner_ret = _SUCCESS; -+ _irqL irqL; -+ int t, sz, w_sz, pull = 0; -+ u32 ff_hwaddr; -+ struct xmit_buf *pxmitbuf = pxmitframe->pxmitbuf; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u8 *ptxbufdesc; -+ struct rtw_tx_ring *ptx_ring; -+ -+ _adapter *pri_adapter = GET_PRIMARY_ADAPTER(padapter); -+ struct dvobj_priv *pri_dvobjpriv = adapter_to_dvobj(pri_adapter); -+ -+ -+ if ((pxmitframe->frame_tag == DATA_FRAMETAG) && -+ (pxmitframe->attrib.ether_type != 0x0806) && -+ (pxmitframe->attrib.ether_type != 0x888e) && -+ (pxmitframe->attrib.dhcp_pkt != 1)) -+ -+ rtw_issue_addbareq_cmd(padapter, pxmitframe); -+ -+ /* mem_addr = pxmitframe->buf_addr; */ -+ -+ -+ for (t = 0; t < pattrib->nr_frags; t++) { -+ if (inner_ret != _SUCCESS && ret == _SUCCESS) -+ ret = _FAIL; -+ -+ if (t != (pattrib->nr_frags - 1)) { -+ -+ sz = pxmitpriv->frag_len; -+ sz = sz - 4 - (psecuritypriv->sw_encrypt ? 0 : pattrib->icv_len); -+ } else /* no frag */ -+ sz = pattrib->last_txcmdsz; -+ -+ ff_hwaddr = rtw_get_ff_hwaddr(pxmitframe); -+ -+ _enter_critical(&(pri_dvobjpriv->irq_th_lock), &irqL); -+ -+ ptxbufdesc = get_txbufdesc(pri_adapter, ff_hwaddr); -+ -+ ptx_ring = &(pri_adapter->xmitpriv.tx_ring[ff_hwaddr]); -+ -+ if (BCN_QUEUE_INX == ff_hwaddr) -+ padapter->xmitpriv.beaconDMAing = _TRUE; -+ -+ if (ptxbufdesc == NULL) { -+ _exit_critical(&pri_dvobjpriv->irq_th_lock, &irqL); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_TX_DESC_NA); -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ RTW_INFO("##### Tx buffer desc unavailable !#####\n"); -+ break; -+ } -+ update_txdesc(pxmitframe); -+ -+ /* update_txbufdesc() must be called after update_txdesc(). */ -+ /* It rely on update_txbufdesc() to map it into non cache memory */ -+ update_txbufdesc(pxmitframe, ptxbufdesc, sz); -+ -+ if (pxmitbuf->buf_tag != XMITBUF_CMD) -+ rtl8723de_enqueue_xmitbuf(ptx_ring, pxmitbuf); -+ -+ pxmitbuf->len = sz; -+ w_sz = sz; -+ -+ /* Set descriptor fields before! */ -+ wmb(); -+ -+ /*SET_TX_BUFF_DESC_OWN_8723D(ptxbufdesc, 1);*/ -+ fill_txbufdesc_own(pri_adapter, ptxbufdesc, -+ ff_hwaddr, ptx_ring); -+ -+ _exit_critical(&pri_dvobjpriv->irq_th_lock, &irqL); -+ -+ rtw_count_tx_stats(padapter, pxmitframe, sz); -+ /* RTW_INFO("rtw_write_port, w_sz=%d, sz=%d, txdesc_sz=%d, tid=%d\n", w_sz, sz, w_sz-sz, pattrib->priority); */ -+ -+ /* mem_addr += w_sz; */ -+ -+ /* mem_addr = (u8 *)RND4(((SIZE_PTR)(mem_addr))); */ -+ -+ } -+ -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ if (ret != _SUCCESS) -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_UNKNOWN); -+ -+ return ret; -+} -+ -+void rtl8723de_xmitframe_resume(_adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_frame *pxmitframe = NULL; -+ struct xmit_buf *pxmitbuf = NULL; -+ int res = _SUCCESS, xcnt = 0; -+ -+ -+ while (1) { -+ if (RTW_CANNOT_RUN(padapter)) { -+ RTW_INFO("rtl8188ee_xmitframe_resume => bDriverStopped or bSurpriseRemoved\n"); -+ break; -+ } -+ -+ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); -+ if (!pxmitbuf) -+ break; -+ -+ pxmitframe = rtw_dequeue_xframe(pxmitpriv, pxmitpriv->hwxmits, pxmitpriv->hwxmit_entry); -+ -+ if (pxmitframe) { -+ pxmitframe->pxmitbuf = pxmitbuf; -+ -+ pxmitframe->buf_addr = pxmitbuf->pbuf; -+ -+ pxmitbuf->priv_data = pxmitframe; -+ -+ if ((pxmitframe->frame_tag & 0x0f) == DATA_FRAMETAG) { -+ if (pxmitframe->attrib.priority <= 15) /* TID0~15 */ -+ res = rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe); -+ -+ rtw_os_xmit_complete(padapter, pxmitframe);/* always return ndis_packet after rtw_xmitframe_coalesce */ -+ } -+ -+ -+ if (res == _SUCCESS) -+ rtw_dump_xframe(padapter, pxmitframe); -+ else { -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ } -+ -+ xcnt++; -+ } else { -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ break; -+ } -+ } -+} -+ -+static u8 check_nic_enough_desc(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ u32 prio; -+ -+ switch (pattrib->qsel) { -+ case 0: -+ case 3: -+ prio = BE_QUEUE_INX; -+ break; -+ case 1: -+ case 2: -+ prio = BK_QUEUE_INX; -+ break; -+ case 4: -+ case 5: -+ prio = VI_QUEUE_INX; -+ break; -+ case 6: -+ case 7: -+ prio = VO_QUEUE_INX; -+ break; -+ default: -+ prio = BE_QUEUE_INX; -+ break; -+ } -+ -+ return check_tx_desc_resource(padapter, prio); -+} -+ -+static s32 xmitframe_direct(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ s32 res = _SUCCESS; -+ -+ res = rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe); -+ if (res == _SUCCESS) -+ rtw_dump_xframe(padapter, pxmitframe); -+ -+ return res; -+} -+ -+/* -+ * Return -+ * _TRUE dump packet directly -+ * _FALSE enqueue packet -+ */ -+static s32 pre_xmitframe(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ _irqL irqL; -+ s32 res; -+ struct xmit_buf *pxmitbuf = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ if ((rtw_txframes_sta_ac_pending(padapter, pattrib) > 0) || -+ (check_nic_enough_desc(padapter, pattrib) == _FALSE)) -+ goto enqueue; -+ -+ if (rtw_xmit_ac_blocked(padapter) == _TRUE) -+ goto enqueue; -+ -+ if (DEV_STA_LG_NUM(padapter->dvobj)) -+ goto enqueue; -+ -+ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); -+ if (pxmitbuf == NULL) -+ goto enqueue; -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ pxmitframe->pxmitbuf = pxmitbuf; -+ pxmitframe->buf_addr = pxmitbuf->pbuf; -+ pxmitbuf->priv_data = pxmitframe; -+ -+ if (xmitframe_direct(padapter, pxmitframe) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ } -+ -+ return _TRUE; -+ -+enqueue: -+ res = rtw_xmitframe_enqueue(padapter, pxmitframe); -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ if (res != _SUCCESS) { -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ /* Trick, make the statistics correct */ -+ pxmitpriv->tx_pkts--; -+ pxmitpriv->tx_drop++; -+ return _TRUE; -+ } -+ -+ return _FALSE; -+} -+ -+s32 rtl8723de_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ return rtw_dump_xframe(padapter, pmgntframe); -+} -+ -+/* -+ * Return -+ * _TRUE dump packet directly ok -+ * _FALSE temporary can't transmit packets to hardware -+ */ -+s32 rtl8723de_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ return pre_xmitframe(padapter, pxmitframe); -+} -+ -+s32 rtl8723de_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ s32 err; -+ -+ err = rtw_xmitframe_enqueue(padapter, pxmitframe); -+ -+ if (err != _SUCCESS) { -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ /* Trick, make the statistics correct */ -+ pxmitpriv->tx_pkts--; -+ pxmitpriv->tx_drop++; -+ } else { -+ if (check_nic_enough_desc(padapter, &pxmitframe->attrib) == _TRUE) { -+#ifdef PLATFORM_LINUX -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+#endif -+ } -+ } -+ -+ return err; -+} -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ -+static void rtl8723de_hostap_mgnt_xmit_cb(struct urb *urb) -+{ -+#ifdef PLATFORM_LINUX -+ struct sk_buff *skb = (struct sk_buff *)urb->context; -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ rtw_skb_free(skb); -+#endif -+} -+ -+s32 rtl8723de_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt) -+{ -+#ifdef PLATFORM_LINUX -+ u16 fc; -+ int rc, len, pipe; -+ unsigned int bmcst, tid, qsel; -+ struct sk_buff *skb, *pxmit_skb; -+ struct urb *urb; -+ unsigned char *pxmitbuf; -+ struct tx_desc *ptxdesc; -+ struct rtw_ieee80211_hdr *tx_hdr; -+ struct hostapd_priv *phostapdpriv = padapter->phostapdpriv; -+ struct net_device *pnetdev = padapter->pnetdev; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ skb = pkt; -+ -+ len = skb->len; -+ tx_hdr = (struct rtw_ieee80211_hdr *)(skb->data); -+ fc = le16_to_cpu(tx_hdr->frame_ctl); -+ bmcst = IS_MCAST(tx_hdr->addr1); -+ -+ if ((fc & RTW_IEEE80211_FCTL_FTYPE) != RTW_IEEE80211_FTYPE_MGMT) -+ goto _exit; -+ -+ pxmit_skb = rtw_skb_alloc(len + TXDESC_SIZE); -+ -+ if (!pxmit_skb) -+ goto _exit; -+ -+ pxmitbuf = pxmit_skb->data; -+ -+ urb = usb_alloc_urb(0, GFP_ATOMIC); -+ if (!urb) -+ goto _exit; -+ -+ /* ----- fill tx desc ----- */ -+ ptxdesc = (struct tx_desc *)pxmitbuf; -+ _rtw_memset(ptxdesc, 0, sizeof(*ptxdesc)); -+ -+ /* offset 0 */ -+ ptxdesc->txdw0 |= cpu_to_le32(len & 0x0000ffff); -+ ptxdesc->txdw0 |= cpu_to_le32(((TXDESC_SIZE + OFFSET_SZ) << OFFSET_SHT) & 0x00ff0000); /* default = 32 bytes for TX Desc */ -+ ptxdesc->txdw0 |= cpu_to_le32(OWN | FSG | LSG); -+ -+ if (bmcst) -+ ptxdesc->txdw0 |= cpu_to_le32(BIT(24)); -+ -+ /* offset 4 */ -+ ptxdesc->txdw1 |= cpu_to_le32(0x00);/* MAC_ID */ -+ -+ ptxdesc->txdw1 |= cpu_to_le32((0x12 << QSEL_SHT) & 0x00001f00); -+ -+ ptxdesc->txdw1 |= cpu_to_le32((0x06 << 16) & 0x000f0000);/* b mode */ -+ -+ /* offset 8 */ -+ -+ /* offset 12 */ -+ ptxdesc->txdw3 |= cpu_to_le32((le16_to_cpu(tx_hdr->seq_ctl) << 16) & 0xffff0000); -+ -+ /* offset 16 */ -+ ptxdesc->txdw4 |= cpu_to_le32(BIT(8));/* driver uses rate */ -+ -+ /* offset 20 */ -+ -+ rtl8188e_cal_txdesc_chksum(ptxdesc); -+ /* ----- end of fill tx desc ----- */ -+ -+ /* */ -+ skb_put(pxmit_skb, len + TXDESC_SIZE); -+ pxmitbuf = pxmitbuf + TXDESC_SIZE; -+ _rtw_memcpy(pxmitbuf, skb->data, len); -+ -+ /* RTW_INFO("mgnt_xmit, len=%x\n", pxmit_skb->len); */ -+ -+ -+ /* ----- prepare urb for submit ----- */ -+ -+ /* translate DMA FIFO addr to pipehandle */ -+ /* pipe = ffaddr2pipehdl(pdvobj, MGT_QUEUE_INX); */ -+ pipe = usb_sndbulkpipe(pdvobj->pusbdev, pHalData->Queue2EPNum[(u8)MGT_QUEUE_INX] & 0x0f); -+ -+ usb_fill_bulk_urb(urb, pdvobj->pusbdev, pipe, -+ pxmit_skb->data, pxmit_skb->len, rtl8723de_hostap_mgnt_xmit_cb, pxmit_skb); -+ -+ urb->transfer_flags |= URB_ZERO_PACKET; -+ usb_anchor_urb(urb, &phostapdpriv->anchored); -+ rc = usb_submit_urb(urb, GFP_ATOMIC); -+ if (rc < 0) { -+ usb_unanchor_urb(urb); -+ kfree_skb(skb); -+ } -+ usb_free_urb(urb); -+ -+ -+_exit: -+ -+ rtw_skb_free(skb); -+ -+#endif -+ -+ return 0; -+ -+} -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_cmd.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_cmd.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_cmd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_cmd.c 2018-02-11 21:44:27.163146330 +0200 -@@ -0,0 +1,1279 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTL8723D_CMD_C_ -+ -+#include -+#include "hal_com_h2c.h" -+ -+#define MAX_H2C_BOX_NUMS 4 -+#define MESSAGE_BOX_SIZE 4 -+ -+#define RTL8723D_MAX_CMD_LEN 7 -+#define RTL8723D_EX_MESSAGE_BOX_SIZE 4 -+ -+static u8 _is_fw_read_cmd_down(_adapter *padapter, u8 msgbox_num) -+{ -+ u8 read_down = _FALSE; -+ int retry_cnts = 100; -+ -+ u8 valid; -+ -+ /* RTW_INFO(" _is_fw_read_cmd_down ,reg_1cc(%x),msg_box(%d)...\n",rtw_read8(padapter,REG_HMETFR),msgbox_num); */ -+ -+ do { -+ valid = rtw_read8(padapter, REG_HMETFR) & BIT(msgbox_num); -+ if (0 == valid) -+ read_down = _TRUE; -+ else -+ rtw_msleep_os(1); -+ } while ((!read_down) && (retry_cnts--)); -+ -+ return read_down; -+ -+} -+ -+ -+/***************************************** -+* H2C Msg format : -+*| 31 - 8 |7-5 | 4 - 0 | -+*| h2c_msg |Class |CMD_ID | -+*| 31-0 | -+*| Ext msg | -+* -+******************************************/ -+s32 FillH2CCmd8723D(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) -+{ -+ u8 h2c_box_num; -+ u32 msgbox_addr; -+ u32 msgbox_ex_addr = 0; -+ PHAL_DATA_TYPE pHalData; -+ u32 h2c_cmd = 0; -+ u32 h2c_cmd_ex = 0; -+ s32 ret = _FAIL; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ -+ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ pHalData = GET_HAL_DATA(padapter); -+#ifdef DBG_CHECK_FW_PS_STATE -+#ifdef DBG_CHECK_FW_PS_STATE_H2C -+ if (rtw_fw_ps_state(padapter) == _FAIL) { -+ RTW_INFO("%s: h2c doesn't leave 32k ElementID=%02x\n", __FUNCTION__, ElementID); -+ pdbgpriv->dbg_h2c_leave32k_fail_cnt++; -+ } -+ -+ /* RTW_INFO("H2C ElementID=%02x , pHalData->LastHMEBoxNum=%02x\n", ElementID, pHalData->LastHMEBoxNum); */ -+#endif /* DBG_CHECK_FW_PS_STATE_H2C */ -+#endif /* DBG_CHECK_FW_PS_STATE */ -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->h2c_fwcmd_mutex), NULL); -+ -+ if (!pCmdBuffer) -+ goto exit; -+ if (CmdLen > RTL8723D_MAX_CMD_LEN) -+ goto exit; -+ if (rtw_is_surprise_removed(padapter)) -+ goto exit; -+ -+ /* pay attention to if race condition happened in H2C cmd setting. */ -+ do { -+ h2c_box_num = pHalData->LastHMEBoxNum; -+ -+ if (!_is_fw_read_cmd_down(padapter, h2c_box_num)) { -+ RTW_INFO(" fw read cmd failed...\n"); -+#ifdef DBG_CHECK_FW_PS_STATE -+ RTW_INFO("MAC_1C0=%08x, MAC_1C4=%08x, MAC_1C8=%08x, MAC_1CC=%08x\n", rtw_read32(padapter, 0x1c0), rtw_read32(padapter, 0x1c4) -+ , rtw_read32(padapter, 0x1c8), rtw_read32(padapter, 0x1cc)); -+#endif /* DBG_CHECK_FW_PS_STATE */ -+ /* RTW_INFO(" 0x1c0: 0x%8x\n", rtw_read32(padapter, 0x1c0)); */ -+ /* RTW_INFO(" 0x1c4: 0x%8x\n", rtw_read32(padapter, 0x1c4)); */ -+ goto exit; -+ } -+ -+ if (CmdLen <= 3) -+ _rtw_memcpy((u8 *)(&h2c_cmd) + 1, pCmdBuffer, CmdLen); -+ else { -+ _rtw_memcpy((u8 *)(&h2c_cmd) + 1, pCmdBuffer, 3); -+ _rtw_memcpy((u8 *)(&h2c_cmd_ex), pCmdBuffer + 3, CmdLen - 3); -+ /* *(u8*)(&h2c_cmd) |= BIT(7); */ -+ } -+ -+ *(u8 *)(&h2c_cmd) |= ElementID; -+ -+ if (CmdLen > 3) { -+ msgbox_ex_addr = REG_HMEBOX_EXT0_8723D + (h2c_box_num * RTL8723D_EX_MESSAGE_BOX_SIZE); -+ h2c_cmd_ex = le32_to_cpu(h2c_cmd_ex); -+ rtw_write32(padapter, msgbox_ex_addr, h2c_cmd_ex); -+ } -+ msgbox_addr = REG_HMEBOX_0 + (h2c_box_num * MESSAGE_BOX_SIZE); -+ h2c_cmd = le32_to_cpu(h2c_cmd); -+ rtw_write32(padapter, msgbox_addr, h2c_cmd); -+ -+ /* RTW_INFO("MSG_BOX:%d, CmdLen(%d), CmdID(0x%x), reg:0x%x =>h2c_cmd:0x%.8x, reg:0x%x =>h2c_cmd_ex:0x%.8x\n" */ -+ /* ,pHalData->LastHMEBoxNum , CmdLen, ElementID, msgbox_addr, h2c_cmd, msgbox_ex_addr, h2c_cmd_ex); */ -+ -+ pHalData->LastHMEBoxNum = (h2c_box_num + 1) % MAX_H2C_BOX_NUMS; -+ -+ } while (0); -+ -+ ret = _SUCCESS; -+ -+exit: -+ -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->h2c_fwcmd_mutex), NULL); -+ -+ -+ return ret; -+} -+ -+static void ConstructBeacon(_adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 rate_len, pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ /* pmlmeext->mgnt_seq++; */ -+ SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* timestamp will be inserted by hardware */ -+ pframe += 8; -+ pktlen += 8; -+ -+ /* beacon interval: 2 bytes */ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ /* capability info: 2 bytes */ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { -+ /* RTW_INFO("ie len=%d\n", cur_network->IELength); */ -+ pktlen += cur_network->IELength - sizeof(NDIS_802_11_FIXED_IEs); -+ _rtw_memcpy(pframe, cur_network->IEs + sizeof(NDIS_802_11_FIXED_IEs), pktlen); -+ -+ goto _ConstructBeacon; -+ } -+ -+ /* below for ad-hoc mode */ -+ -+ /* SSID */ -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen); -+ -+ /* supported rates... */ -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pktlen); -+ -+ /* DS parameter set */ -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen); -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { -+ u32 ATIMWindow; -+ /* IBSS Parameter Set... */ -+ /* ATIMWindow = cur->Configuration.ATIMWindow; */ -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen); -+ } -+ -+ -+ /* todo: ERP IE */ -+ -+ -+ /* EXTERNDED SUPPORTED RATE */ -+ if (rate_len > 8) -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); -+ -+ -+ /* todo:HT for adhoc */ -+ -+_ConstructBeacon: -+ -+ if ((pktlen + TXDESC_SIZE) > 512) { -+ RTW_INFO("beacon frame too large\n"); -+ return; -+ } -+ -+ *pLength = pktlen; -+ -+ /* RTW_INFO("%s bcn_sz=%d\n", __FUNCTION__, pktlen); */ -+ -+} -+ -+static void ConstructPSPoll(_adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ /* Frame control. */ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ SetPwrMgt(fctrl); -+ SetFrameSubType(pframe, WIFI_PSPOLL); -+ -+ /* AID. */ -+ SetDuration(pframe, (pmlmeinfo->aid | 0xc000)); -+ -+ /* BSSID. */ -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ /* TA. */ -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ *pLength = 16; -+} -+ -+static void ConstructNullFunctionData( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength, -+ u8 *StaAddr, -+ u8 bQoS, -+ u8 AC, -+ u8 bEosp, -+ u8 bForcePowerSave) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ if (bForcePowerSave) -+ SetPwrMgt(fctrl); -+ -+ switch (cur_network->network.InfrastructureMode) { -+ case Ndis802_11Infrastructure: -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, StaAddr, ETH_ALEN); -+ break; -+ case Ndis802_11APMode: -+ SetFrDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ break; -+ case Ndis802_11IBSS: -+ default: -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ break; -+ } -+ -+ SetSeqNum(pwlanhdr, 0); -+ -+ if (bQoS == _TRUE) { -+ struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; -+ -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe; -+ SetPriority(&pwlanqoshdr->qc, AC); -+ SetEOSP(&pwlanqoshdr->qc, bEosp); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ } else { -+ SetFrameSubType(pframe, WIFI_DATA_NULL); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ } -+ -+ *pLength = pktlen; -+} -+ -+/* To check if reserved page content is destroyed by beacon because beacon is too large. -+ * 2010.06.23. Added by tynli. */ -+VOID -+CheckFwRsvdPageContent( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u32 MaxBcnPageNum; -+ -+ if (pHalData->FwRsvdPageStartOffset != 0) { -+ /*MaxBcnPageNum = PageNum_128(pMgntInfo->MaxBeaconSize); -+ RT_ASSERT((MaxBcnPageNum <= pHalData->FwRsvdPageStartOffset), -+ ("CheckFwRsvdPageContent(): The reserved page content has been"\ -+ "destroyed by beacon!!! MaxBcnPageNum(%d) FwRsvdPageStartOffset(%d)\n!", -+ MaxBcnPageNum, pHalData->FwRsvdPageStartOffset));*/ -+ } -+} -+ -+/* -+ * Description: Get the reserved page number in Tx packet buffer. -+ * Retrun value: the page number. -+ * 2012.08.09, by tynli. -+ * */ -+u8 GetTxBufferRsvdPageNum8723D(_adapter *padapter, bool wowlan) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 RsvdPageNum = 0; -+ /* default reseved 1 page for the IC type which is undefined. */ -+ u8 TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8723D; -+ -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&TxPageBndy); -+ -+ RsvdPageNum = LAST_ENTRY_OF_TX_PKT_BUFFER_8723D - TxPageBndy + 1; -+ -+ return RsvdPageNum; -+} -+ -+static void rtl8723d_set_FwRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+ u8 u1H2CRsvdPageParm[H2C_RSVDPAGE_LOC_LEN] = {0}; -+ -+ RTW_INFO("8723DRsvdPageLoc: ProbeRsp=%d PsPoll=%d Null=%d QoSNull=%d BTNull=%d\n", -+ rsvdpageloc->LocProbeRsp, rsvdpageloc->LocPsPoll, -+ rsvdpageloc->LocNullData, rsvdpageloc->LocQosNull, -+ rsvdpageloc->LocBTQosNull); -+ -+ SET_8723D_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(u1H2CRsvdPageParm, rsvdpageloc->LocProbeRsp); -+ SET_8723D_H2CCMD_RSVDPAGE_LOC_PSPOLL(u1H2CRsvdPageParm, rsvdpageloc->LocPsPoll); -+ SET_8723D_H2CCMD_RSVDPAGE_LOC_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocNullData); -+ SET_8723D_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocQosNull); -+ SET_8723D_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocBTQosNull); -+ -+ RTW_DBG_DUMP("u1H2CRsvdPageParm:", -+ u1H2CRsvdPageParm, H2C_RSVDPAGE_LOC_LEN); -+ -+ FillH2CCmd8723D(padapter, H2C_8723D_RSVD_PAGE, H2C_RSVDPAGE_LOC_LEN, u1H2CRsvdPageParm); -+} -+ -+static void rtl8723d_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 res = 0, count = 0; -+#ifdef CONFIG_WOWLAN -+ u8 u1H2CAoacRsvdPageParm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; -+ -+ RTW_INFO("8723DAOACRsvdPageLoc: RWC=%d ArpRsp=%d NbrAdv=%d GtkRsp=%d GtkInfo=%d ProbeReq=%d NetworkList=%d\n", -+ rsvdpageloc->LocRemoteCtrlInfo, rsvdpageloc->LocArpRsp, -+ rsvdpageloc->LocNbrAdv, rsvdpageloc->LocGTKRsp, -+ rsvdpageloc->LocGTKInfo, rsvdpageloc->LocProbeReq, -+ rsvdpageloc->LocNetList); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocRemoteCtrlInfo); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocArpRsp); -+ /* SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(u1H2CAoacRsvdPageParm, rsvdpageloc->LocNbrAdv); */ -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKRsp); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKInfo); -+#ifdef CONFIG_GTK_OL -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKEXTMEM); -+#endif /* CONFIG_GTK_OL */ -+ RTW_DBG_DUMP("u1H2CAoacRsvdPageParm:", -+ u1H2CAoacRsvdPageParm, H2C_AOAC_RSVDPAGE_LOC_LEN); -+ -+ FillH2CCmd8723D(padapter, H2C_8723D_AOAC_RSVD_PAGE, H2C_AOAC_RSVDPAGE_LOC_LEN, u1H2CAoacRsvdPageParm); -+ } else { -+#ifdef CONFIG_PNO_SUPPORT -+ if (!pwrpriv->wowlan_in_resume) { -+ RTW_INFO("NLO_INFO=%d\n", rsvdpageloc->LocPNOInfo); -+ _rtw_memset(&u1H2CAoacRsvdPageParm, 0, sizeof(u1H2CAoacRsvdPageParm)); -+ SET_H2CCMD_AOAC_RSVDPAGE_LOC_NLO_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocPNOInfo); -+ FillH2CCmd8723D(padapter, H2C_AOAC_RSVDPAGE3, H2C_AOAC_RSVDPAGE_LOC_LEN, u1H2CAoacRsvdPageParm); -+ rtw_msleep_os(10); -+ } -+#endif -+ } -+ -+#endif /* CONFIG_WOWLAN */ -+} -+ -+static void rtl8723d_set_FwKeepAlive_cmd(PADAPTER padapter, u8 benable, u8 pkt_type) -+{ -+ u8 u1H2CKeepAliveParm[H2C_KEEP_ALIVE_CTRL_LEN] = {0}; -+ u8 adopt = 1; -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ u8 check_period = 10; -+#else -+ u8 check_period = 5; -+#endif -+ -+ RTW_INFO("%s(): benable = %d\n", __func__, benable); -+ SET_8723D_H2CCMD_KEEPALIVE_PARM_ENABLE(u1H2CKeepAliveParm, benable); -+ SET_8723D_H2CCMD_KEEPALIVE_PARM_ADOPT(u1H2CKeepAliveParm, adopt); -+ SET_8723D_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(u1H2CKeepAliveParm, pkt_type); -+ SET_8723D_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(u1H2CKeepAliveParm, check_period); -+ -+ RTW_DBG_DUMP("u1H2CKeepAliveParm:", -+ u1H2CKeepAliveParm, H2C_KEEP_ALIVE_CTRL_LEN); -+ -+ FillH2CCmd8723D(padapter, H2C_8723D_KEEP_ALIVE, H2C_KEEP_ALIVE_CTRL_LEN, u1H2CKeepAliveParm); -+} -+ -+static void rtl8723d_set_FwDisconDecision_cmd(PADAPTER padapter, u8 benable) -+{ -+ u8 u1H2CDisconDecisionParm[H2C_DISCON_DECISION_LEN] = {0}; -+ u8 adopt = 1, check_period = 10, trypkt_num = 0; -+ -+ RTW_INFO("%s(): benable = %d\n", __func__, benable); -+ SET_8723D_H2CCMD_DISCONDECISION_PARM_ENABLE(u1H2CDisconDecisionParm, benable); -+ SET_8723D_H2CCMD_DISCONDECISION_PARM_ADOPT(u1H2CDisconDecisionParm, adopt); -+ SET_8723D_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(u1H2CDisconDecisionParm, check_period); -+ SET_8723D_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(u1H2CDisconDecisionParm, trypkt_num); -+ -+ RTW_DBG_DUMP("u1H2CDisconDecisionParm:", -+ u1H2CDisconDecisionParm, H2C_DISCON_DECISION_LEN); -+ -+ FillH2CCmd8723D(padapter, H2C_8723D_DISCON_DECISION, H2C_DISCON_DECISION_LEN, u1H2CDisconDecisionParm); -+} -+ -+void rtl8723d_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 u1H2CMacIdConfigParm[H2C_MACID_CFG_LEN] = {0}; -+ -+ RTW_INFO("%s(): mac_id=%d raid=0x%x bw=%d mask=0x%x\n", __func__, mac_id, raid, bw, mask); -+ -+ -+ SET_8723D_H2CCMD_MACID_CFG_MACID(u1H2CMacIdConfigParm, mac_id); -+ SET_8723D_H2CCMD_MACID_CFG_RAID(u1H2CMacIdConfigParm, raid); -+ SET_8723D_H2CCMD_MACID_CFG_SGI_EN(u1H2CMacIdConfigParm, (sgi) ? 1 : 0); -+ SET_8723D_H2CCMD_MACID_CFG_BW(u1H2CMacIdConfigParm, bw); -+ -+ /* DisableTXPowerTraining */ -+ if (pHalData->bDisableTXPowerTraining) { -+ SET_8723D_H2CCMD_MACID_CFG_DISPT(u1H2CMacIdConfigParm, 1); -+ RTW_INFO("%s,Disable PWT by driver\n", __FUNCTION__); -+ } else { -+ PDM_ODM_T pDM_OutSrc = &pHalData->odmpriv; -+ -+ if (pDM_OutSrc->bDisablePowerTraining) { -+ SET_8723D_H2CCMD_MACID_CFG_DISPT(u1H2CMacIdConfigParm, 1); -+ RTW_INFO("%s,Disable PWT by DM\n", __FUNCTION__); -+ } -+ } -+ -+ SET_8723D_H2CCMD_MACID_CFG_RATE_MASK0(u1H2CMacIdConfigParm, (u8)(mask & 0x000000ff)); -+ SET_8723D_H2CCMD_MACID_CFG_RATE_MASK1(u1H2CMacIdConfigParm, (u8)((mask & 0x0000ff00) >> 8)); -+ SET_8723D_H2CCMD_MACID_CFG_RATE_MASK2(u1H2CMacIdConfigParm, (u8)((mask & 0x00ff0000) >> 16)); -+ SET_8723D_H2CCMD_MACID_CFG_RATE_MASK3(u1H2CMacIdConfigParm, (u8)((mask & 0xff000000) >> 24)); -+ -+ RTW_DBG_DUMP("u1H2CMacIdConfigParm:", -+ u1H2CMacIdConfigParm, H2C_MACID_CFG_LEN); -+ -+ FillH2CCmd8723D(padapter, H2C_8723D_MACID_CFG, H2C_MACID_CFG_LEN, u1H2CMacIdConfigParm); -+ -+} -+ -+void rtl8723d_set_FwRssiSetting_cmd(_adapter *padapter, u8 *param) -+{ -+ u8 u1H2CRssiSettingParm[H2C_RSSI_SETTING_LEN] = {0}; -+ u8 mac_id = *param; -+ u8 rssi = *(param + 2); -+ u8 uldl_state = 0; -+ -+ /* RTW_INFO("%s(): param=%.2x-%.2x-%.2x\n", __func__, *param, *(param+1), *(param+2)); */ -+ /* RTW_INFO("%s(): mac_id=%d rssi=%d\n", __func__, mac_id, rssi); */ -+ -+ SET_8723D_H2CCMD_RSSI_SETTING_MACID(u1H2CRssiSettingParm, mac_id); -+ SET_8723D_H2CCMD_RSSI_SETTING_RSSI(u1H2CRssiSettingParm, rssi); -+ SET_8723D_H2CCMD_RSSI_SETTING_ULDL_STATE(u1H2CRssiSettingParm, uldl_state); -+ -+ RTW_DBG_DUMP("u1H2CRssiSettingParm:", -+ u1H2CRssiSettingParm, H2C_RSSI_SETTING_LEN); -+ FillH2CCmd8723D(padapter, H2C_8723D_RSSI_SETTING, H2C_RSSI_SETTING_LEN, u1H2CRssiSettingParm); -+ -+} -+ -+void rtl8723d_set_FwAPReqRPT_cmd(PADAPTER padapter, u32 need_ack) -+{ -+ u8 u1H2CApReqRptParm[H2C_AP_REQ_TXRPT_LEN] = {0}; -+ u8 macid1 = 1, macid2 = 0; -+ -+ RTW_INFO("%s(): need_ack = %d\n", __func__, need_ack); -+ -+ SET_8723D_H2CCMD_APREQRPT_PARM_MACID1(u1H2CApReqRptParm, macid1); -+ SET_8723D_H2CCMD_APREQRPT_PARM_MACID2(u1H2CApReqRptParm, macid2); -+ -+ RTW_DBG_DUMP("u1H2CApReqRptParm:", -+ u1H2CApReqRptParm, H2C_AP_REQ_TXRPT_LEN); -+ -+ FillH2CCmd8723D(padapter, H2C_8723D_AP_REQ_TXRPT, H2C_AP_REQ_TXRPT_LEN, u1H2CApReqRptParm); -+} -+ -+void rtl8723d_set_FwPwrMode_cmd(PADAPTER padapter, u8 psmode) -+{ -+ int i; -+ u8 smart_ps = 0; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u8 u1H2CPwrModeParm[H2C_PWRMODE_LEN] = {0}; -+ u8 PowerState = 0, awake_intvl = 1, byte5 = 0, rlbm = 0; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *wdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P */ -+ -+ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ if (psmode == PS_MODE_DTIM) -+ psmode = PS_MODE_MAX; -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+ -+ -+ if (pwrpriv->dtim > 0) -+ RTW_INFO("%s(): FW LPS mode = %d, SmartPS=%d, dtim=%d\n", __func__, psmode, pwrpriv->smart_ps, pwrpriv->dtim); -+ else -+ RTW_INFO("%s(): FW LPS mode = %d, SmartPS=%d\n", __func__, psmode, pwrpriv->smart_ps); -+ -+ if (psmode == PS_MODE_MIN) { -+ rlbm = 0; -+ awake_intvl = 2; -+ smart_ps = pwrpriv->smart_ps; -+ } else if (psmode == PS_MODE_MAX) { -+ rlbm = 1; -+ awake_intvl = 2; -+ smart_ps = pwrpriv->smart_ps; -+ } else if (psmode == PS_MODE_DTIM) { /* For WOWLAN LPS, DTIM = (awake_intvl - 1) */ -+ if (pwrpriv->dtim > 0 && pwrpriv->dtim < 16) -+ awake_intvl = pwrpriv->dtim + 1; /* DTIM = (awake_intvl - 1) */ -+ else -+ awake_intvl = 4;/* DTIM=3 */ -+ -+ -+ rlbm = 2; -+ smart_ps = pwrpriv->smart_ps; -+ } else { -+ rlbm = 2; -+ awake_intvl = 4; -+ smart_ps = pwrpriv->smart_ps; -+ } -+ -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(wdinfo, P2P_STATE_NONE)) { -+ awake_intvl = 2; -+ rlbm = 1; -+ } -+#endif /* CONFIG_P2P */ -+ -+ if (padapter->registrypriv.wifi_spec == 1) { -+ awake_intvl = 2; -+ rlbm = 1; -+ } -+ -+ if (psmode > 0) { -+#ifdef CONFIG_BT_COEXIST -+ if (rtw_btcoex_IsBtControlLps(padapter) == _TRUE) { -+ PowerState = rtw_btcoex_RpwmVal(padapter); -+ byte5 = rtw_btcoex_LpsVal(padapter); -+ -+ if ((rlbm == 2) && (byte5 & BIT(4))) { -+ /* Keep awake interval to 1 to prevent from */ -+ /* decreasing coex performance */ -+ awake_intvl = 2; -+ rlbm = 2; -+ } -+ } else -+#endif /* CONFIG_BT_COEXIST */ -+ { -+ PowerState = 0x00;/* AllON(0x0C), RFON(0x04), RFOFF(0x00) */ -+ byte5 = 0x40; -+ } -+ } else { -+ PowerState = 0x0C;/* AllON(0x0C), RFON(0x04), RFOFF(0x00) */ -+ byte5 = 0x40; -+ } -+ -+ SET_8723D_H2CCMD_PWRMODE_PARM_MODE(u1H2CPwrModeParm, (psmode > 0) ? 1 : 0); -+ SET_8723D_H2CCMD_PWRMODE_PARM_SMART_PS(u1H2CPwrModeParm, smart_ps); -+ SET_8723D_H2CCMD_PWRMODE_PARM_RLBM(u1H2CPwrModeParm, rlbm); -+ SET_8723D_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(u1H2CPwrModeParm, awake_intvl); -+ SET_8723D_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(u1H2CPwrModeParm, padapter->registrypriv.uapsd_enable); -+ SET_8723D_H2CCMD_PWRMODE_PARM_PWR_STATE(u1H2CPwrModeParm, PowerState); -+ SET_8723D_H2CCMD_PWRMODE_PARM_BYTE5(u1H2CPwrModeParm, byte5); -+#ifdef CONFIG_LPS_LCLK -+ if (psmode != PS_MODE_ACTIVE) { -+ if (pmlmeext->adaptive_tsf_done == _FALSE && pmlmeext->bcn_cnt > 0) { -+ u8 ratio_20_delay, ratio_80_delay; -+ -+ /* byte 6 for adaptive_early_32k */ -+ /* [0:3] = DrvBcnEarly (ms) , [4:7] = DrvBcnTimeOut (ms) */ -+ /* 20% for DrvBcnEarly, 80% for DrvBcnTimeOut */ -+ ratio_20_delay = 0; -+ ratio_80_delay = 0; -+ pmlmeext->DrvBcnEarly = 0xff; -+ pmlmeext->DrvBcnTimeOut = 0xff; -+ -+ /* RTW_INFO("%s(): bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); */ -+ -+ for (i = 0; i < 9; i++) { -+ pmlmeext->bcn_delay_ratio[i] = (pmlmeext->bcn_delay_cnt[i] * 100) / pmlmeext->bcn_cnt; -+ -+ /* RTW_INFO("%s(): bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d] = %d\n", __func__, i, pmlmeext->bcn_delay_cnt[i] */ -+ /* ,i ,pmlmeext->bcn_delay_ratio[i]); */ -+ -+ ratio_20_delay += pmlmeext->bcn_delay_ratio[i]; -+ ratio_80_delay += pmlmeext->bcn_delay_ratio[i]; -+ -+ if (ratio_20_delay > 20 && pmlmeext->DrvBcnEarly == 0xff) { -+ pmlmeext->DrvBcnEarly = i; -+ /* RTW_INFO("%s(): DrvBcnEarly = %d\n", __func__, pmlmeext->DrvBcnEarly); */ -+ } -+ -+ if (ratio_80_delay > 80 && pmlmeext->DrvBcnTimeOut == 0xff) { -+ pmlmeext->DrvBcnTimeOut = i; -+ /* RTW_INFO("%s(): DrvBcnTimeOut = %d\n", __func__, pmlmeext->DrvBcnTimeOut); */ -+ } -+ -+ /* reset adaptive_early_32k cnt */ -+ pmlmeext->bcn_delay_cnt[i] = 0; -+ pmlmeext->bcn_delay_ratio[i] = 0; -+ -+ } -+ -+ pmlmeext->bcn_cnt = 0; -+ pmlmeext->adaptive_tsf_done = _TRUE; -+ -+ } else { -+ /* RTW_INFO("%s(): DrvBcnEarly = %d\n", __func__, pmlmeext->DrvBcnEarly); */ -+ /* RTW_INFO("%s(): DrvBcnTimeOut = %d\n", __func__, pmlmeext->DrvBcnTimeOut); */ -+ } -+ -+ /* offload to FW if fw version > v15.10 -+ pmlmeext->DrvBcnEarly=0; -+ pmlmeext->DrvBcnTimeOut=7; -+ -+ if((pmlmeext->DrvBcnEarly!=0Xff) && (pmlmeext->DrvBcnTimeOut!=0xff)) -+ u1H2CPwrModeParm[H2C_PWRMODE_LEN-1] = BIT(0) | ((pmlmeext->DrvBcnEarly<<1)&0x0E) |((pmlmeext->DrvBcnTimeOut<<4)&0xf0) ; -+ */ -+ -+ } -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_RecordPwrMode(padapter, u1H2CPwrModeParm, H2C_PWRMODE_LEN); -+#endif /* CONFIG_BT_COEXIST */ -+ -+ RTW_DBG_DUMP("u1H2CPwrModeParm:", -+ u1H2CPwrModeParm, H2C_PWRMODE_LEN); -+ -+ FillH2CCmd8723D(padapter, H2C_8723D_SET_PWR_MODE, H2C_PWRMODE_LEN, u1H2CPwrModeParm); -+} -+ -+void rtl8723d_set_FwPsTuneParam_cmd(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 u1H2CPsTuneParm[H2C_PSTUNEPARAM_LEN] = {0}; -+ u8 bcn_to_limit = 10; /* 10 * 100 * awakeinterval (ms) */ -+ u8 dtim_timeout = 5; /* ms //wait broadcast data timer */ -+ u8 ps_timeout = 20; /* ms //Keep awake when tx */ -+ u8 dtim_period = 3; -+ -+ /* RTW_INFO("%s(): FW LPS mode = %d\n", __func__, psmode); */ -+ -+ SET_8723D_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(u1H2CPsTuneParm, bcn_to_limit); -+ SET_8723D_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(u1H2CPsTuneParm, dtim_timeout); -+ SET_8723D_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(u1H2CPsTuneParm, ps_timeout); -+ SET_8723D_H2CCMD_PSTUNE_PARM_ADOPT(u1H2CPsTuneParm, 1); -+ SET_8723D_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(u1H2CPsTuneParm, dtim_period); -+ -+ RTW_DBG_DUMP("u1H2CPsTuneParm:", -+ u1H2CPsTuneParm, H2C_PSTUNEPARAM_LEN); -+ -+ FillH2CCmd8723D(padapter, H2C_8723D_PS_TUNING_PARA, H2C_PSTUNEPARAM_LEN, u1H2CPsTuneParm); -+} -+ -+void rtl8723d_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param) -+{ -+ u8 u1H2CBtMpOperParm[H2C_BTMP_OPER_LEN] = {0}; -+ -+ -+ RTW_INFO("%s: idx=%d ver=%d reqnum=%d param1=0x%02x param2=0x%02x\n", __FUNCTION__, idx, ver, reqnum, param[0], param[1]); -+ -+ SET_8723D_H2CCMD_BT_MPOPER_VER(u1H2CBtMpOperParm, ver); -+ SET_8723D_H2CCMD_BT_MPOPER_REQNUM(u1H2CBtMpOperParm, reqnum); -+ SET_8723D_H2CCMD_BT_MPOPER_IDX(u1H2CBtMpOperParm, idx); -+ SET_8723D_H2CCMD_BT_MPOPER_PARAM1(u1H2CBtMpOperParm, param[0]); -+ SET_8723D_H2CCMD_BT_MPOPER_PARAM2(u1H2CBtMpOperParm, param[1]); -+ SET_8723D_H2CCMD_BT_MPOPER_PARAM3(u1H2CBtMpOperParm, param[2]); -+ -+ RTW_DBG_DUMP("u1H2CBtMpOperParm:", -+ u1H2CBtMpOperParm, H2C_BTMP_OPER_LEN); -+ -+ FillH2CCmd8723D(padapter, H2C_8723D_BT_MP_OPER, H2C_BTMP_OPER_LEN, u1H2CBtMpOperParm); -+} -+ -+void rtl8723d_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 en) -+{ -+ /* u8 cmd_param; //BIT0:enable, BIT1:Ignore PS Condition.*/ -+ -+ u8 parm[H2C_INACTIVE_PS_LEN] = {0}; -+ -+ SET_H2CCMD_INACTIVE_PS_EN(parm, en); -+ -+ FillH2CCmd8723D(padapter, H2C_INACTIVE_PS_, H2C_INACTIVE_PS_LEN, parm); -+} -+ -+static s32 rtl8723d_set_FwLowPwrLps_cmd(PADAPTER padapter, u8 enable) -+{ -+ /* TODO */ -+ return _FALSE; -+} -+ -+ -+void rtl8723d_download_rsvd_page(PADAPTER padapter, u8 mstatus) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ BOOLEAN bcn_valid = _FALSE; -+ u8 DLBcnCount = 0; -+ u32 poll = 0; -+ u8 val8; -+ -+ -+ RTW_INFO("+" FUNC_ADPT_FMT ": hw_port=%d mstatus(%x)\n", -+ FUNC_ADPT_ARG(padapter), get_hw_port(padapter), mstatus); -+ -+ if (mstatus == RT_MEDIA_CONNECT) { -+ BOOLEAN bRecover = _FALSE; -+ u8 v8; -+ -+ /* We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. */ -+ /* Suggested by filen. Added by tynli. */ -+ rtw_write16(padapter, REG_BCN_PSR_RPT, (0xC000 | pmlmeinfo->aid)); -+ -+ /* set REG_CR bit 8 */ -+ v8 = rtw_read8(padapter, REG_CR + 1); -+ v8 |= BIT(0); /* ENSWBCN */ -+ rtw_write8(padapter, REG_CR + 1, v8); -+ -+ /* Disable Hw protection for a time which revserd for Hw sending beacon. */ -+ /* Fix download reserved page packet fail that access collision with the protection time. */ -+ /* 2010.05.11. Added by tynli. */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 &= ~EN_BCN_FUNCTION; -+ val8 |= DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */ -+ if (pHalData->RegFwHwTxQCtrl & BIT(6)) -+ bRecover = _TRUE; -+ -+ /* To tell Hw the packet is not a real beacon frame. */ -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl & ~BIT(6)); -+ pHalData->RegFwHwTxQCtrl &= ~BIT(6); -+ -+ /* Clear beacon valid check bit. */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ -+ DLBcnCount = 0; -+ poll = 0; -+ do { -+ /* download rsvd page. */ -+ rtw_hal_set_fw_rsvd_page(padapter, 0); -+ DLBcnCount++; -+ do { -+ rtw_yield_os(); -+ /* rtw_mdelay_os(10); */ -+ /* check rsvd page download OK. */ -+ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8 *)(&bcn_valid)); -+ poll++; -+ } while (!bcn_valid && (poll % 10) != 0 && !RTW_CANNOT_RUN(padapter)); -+ -+ } while (!bcn_valid && DLBcnCount <= 100 && !RTW_CANNOT_RUN(padapter)); -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ ; -+ else if (!bcn_valid) -+ RTW_INFO(ADPT_FMT": 1 DL RSVD page failed! DLBcnCount:%u, poll:%u\n", -+ ADPT_ARG(padapter) , DLBcnCount, poll); -+ else { -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ -+ pwrctl->fw_psmode_iface_id = padapter->iface_id; -+ RTW_INFO(ADPT_FMT": 1 DL RSVD page success! DLBcnCount:%u, poll:%u\n", -+ ADPT_ARG(padapter), DLBcnCount, poll); -+ } -+ -+ /* 2010.05.11. Added by tynli. */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 |= EN_BCN_FUNCTION; -+ val8 &= ~DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ /* To make sure that if there exists an adapter which would like to send beacon. */ -+ /* If exists, the origianl value of 0x422[6] will be 1, we should check this to */ -+ /* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ -+ /* the beacon cannot be sent by HW. */ -+ /* 2010.06.23. Added by tynli. */ -+ if (bRecover) { -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl | BIT(6)); -+ pHalData->RegFwHwTxQCtrl |= BIT(6); -+ } -+ -+ /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ -+#ifndef CONFIG_PCI_HCI -+ v8 = rtw_read8(padapter, REG_CR + 1); -+ v8 &= ~BIT(0); /* ~ENSWBCN */ -+ rtw_write8(padapter, REG_CR + 1, v8); -+#endif -+ } -+ -+} -+ -+void rtl8723d_set_rssi_cmd(_adapter *padapter, u8 *param) -+{ -+ rtl8723d_set_FwRssiSetting_cmd(padapter, param); -+} -+ -+void rtl8723d_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus) -+{ -+ struct sta_info *psta = NULL; -+ struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (mstatus == 1) -+ rtl8723d_download_rsvd_page(padapter, RT_MEDIA_CONNECT); -+} -+#if 0 -+void rtl8723d_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack) -+{ -+ rtl8723d_set_FwAPReqRPT_cmd(padapter, need_ack); -+} -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+static void ConstructBtNullFunctionData( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength, -+ u8 *StaAddr, -+ u8 bQoS, -+ u8 AC, -+ u8 bEosp, -+ u8 bForcePowerSave) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ u16 *fctrl; -+ u32 pktlen; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ u8 bssid[ETH_ALEN]; -+ -+ -+ RTW_INFO("+" FUNC_ADPT_FMT ": qos=%d eosp=%d ps=%d\n", -+ FUNC_ADPT_ARG(padapter), bQoS, bEosp, bForcePowerSave); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ if (NULL == StaAddr) { -+ _rtw_memcpy(bssid, adapter_mac_addr(padapter), ETH_ALEN); -+ StaAddr = bssid; -+ } -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *fctrl = 0; -+ if (bForcePowerSave) -+ SetPwrMgt(fctrl); -+ -+ SetFrDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ SetDuration(pwlanhdr, 0); -+ SetSeqNum(pwlanhdr, 0); -+ -+ if (bQoS == _TRUE) { -+ struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; -+ -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe; -+ SetPriority(&pwlanqoshdr->qc, AC); -+ SetEOSP(&pwlanqoshdr->qc, bEosp); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ } else { -+ SetFrameSubType(pframe, WIFI_DATA_NULL); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ } -+ -+ *pLength = pktlen; -+} -+ -+static void SetFwRsvdPagePkt_BTCoex(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ struct xmit_frame *pcmdframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ u32 BeaconLength = 0; -+ u32 BTQosNullLength = 0; -+ u8 *ReservedPagePacket; -+ u8 TxDescLen, TxDescOffset; -+ u8 TotalPageNum = 0, CurtPktPageNum = 0, RsvdPageNum = 0; -+ u16 BufIndex, PageSize; -+ u32 TotalPacketLen, MaxRsvdPageBufSize = 0; -+ RSVDPAGE_LOC RsvdPageLoc; -+ -+ -+ /* RTW_INFO("+" FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(padapter)); */ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pxmitpriv = &padapter->xmitpriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ TxDescLen = TXDESC_SIZE; -+ TxDescOffset = TXDESC_OFFSET; -+ PageSize = PAGE_SIZE_TX_8723D; -+ -+ RsvdPageNum = BCNQ_PAGE_NUM_8723D; -+ MaxRsvdPageBufSize = RsvdPageNum * PageSize; -+ -+ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); -+ if (pcmdframe == NULL) { -+ RTW_INFO("%s: alloc ReservedPagePacket fail!\n", __FUNCTION__); -+ return; -+ } -+ -+ ReservedPagePacket = pcmdframe->buf_addr; -+ _rtw_memset(&RsvdPageLoc, 0, sizeof(RSVDPAGE_LOC)); -+ -+ /* 3 (1) beacon */ -+ BufIndex = TxDescOffset; -+ ConstructBeacon(padapter, &ReservedPagePacket[BufIndex], &BeaconLength); -+ -+ /* When we count the first page size, we need to reserve description size for the RSVD */ -+ /* packet, it will be filled in front of the packet in TXPKTBUF. */ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + BeaconLength); -+ /* If we don't add 1 more page, the WOWLAN function has a problem. Baron thinks it's a bug of firmware */ -+ if (CurtPktPageNum == 1) -+ CurtPktPageNum += 1; -+ TotalPageNum += CurtPktPageNum; -+ -+ BufIndex += (CurtPktPageNum * PageSize); -+ -+ /* Jump to lastest page */ -+ if (BufIndex < (MaxRsvdPageBufSize - PageSize)) { -+ BufIndex = TxDescOffset + (MaxRsvdPageBufSize - PageSize); -+ TotalPageNum = BCNQ_PAGE_NUM_8723D - 1; -+ } -+ -+ /* 3 (6) BT Qos null data */ -+ RsvdPageLoc.LocBTQosNull = TotalPageNum; -+ ConstructBtNullFunctionData( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &BTQosNullLength, -+ NULL, -+ _TRUE, 0, 0, _FALSE); -+ rtl8723d_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex - TxDescLen], BTQosNullLength, _FALSE, _TRUE, _FALSE); -+ -+ CurtPktPageNum = (u8)PageNum_128(TxDescLen + BTQosNullLength); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ TotalPacketLen = BufIndex + BTQosNullLength; -+ if (TotalPacketLen > MaxRsvdPageBufSize) { -+ RTW_INFO(FUNC_ADPT_FMT ": ERROR: The rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n", -+ FUNC_ADPT_ARG(padapter), TotalPacketLen, MaxRsvdPageBufSize); -+ goto error; -+ } -+ -+ /* update attribute */ -+ pattrib = &pcmdframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->pktlen = pattrib->last_txcmdsz = TotalPacketLen - TxDescOffset; -+#ifdef CONFIG_PCI_HCI -+ dump_mgntframe(padapter, pcmdframe); -+#else -+ dump_mgntframe_and_wait(padapter, pcmdframe, 100); -+#endif -+ -+ /* RTW_INFO(FUNC_ADPT_FMT ": Set RSVD page location to Fw, TotalPacketLen(%d), TotalPageNum(%d)\n", -+ * FUNC_ADPT_ARG(padapter), TotalPacketLen, TotalPageNum); */ -+ rtl8723d_set_FwRsvdPage_cmd(padapter, &RsvdPageLoc); -+ rtl8723d_set_FwAoacRsvdPage_cmd(padapter, &RsvdPageLoc); -+ -+ return; -+ -+error: -+ rtw_free_xmitframe(pxmitpriv, pcmdframe); -+} -+ -+void rtl8723d_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ u8 bRecover = _FALSE; -+ u8 bcn_valid = _FALSE; -+ u8 DLBcnCount = 0; -+ u32 poll = 0; -+ u8 val8; -+ -+ -+ RTW_INFO("+" FUNC_ADPT_FMT ": hw_port=%d fw_state=0x%08X\n", -+ FUNC_ADPT_ARG(padapter), get_hw_port(padapter), get_fwstate(&padapter->mlmepriv)); -+ -+#ifdef CONFIG_RTW_DEBUG -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _FALSE) { -+ RTW_INFO(FUNC_ADPT_FMT ": [WARNING] not in AP mode!!\n", -+ FUNC_ADPT_ARG(padapter)); -+ } -+#endif /* CONFIG_RTW_DEBUG */ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ /* We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. */ -+ /* Suggested by filen. Added by tynli. */ -+ rtw_write16(padapter, REG_BCN_PSR_RPT, (0xC000 | pmlmeinfo->aid)); -+ -+ /* set REG_CR bit 8 */ -+ val8 = rtw_read8(padapter, REG_CR + 1); -+ val8 |= BIT(0); /* ENSWBCN */ -+ rtw_write8(padapter, REG_CR + 1, val8); -+ -+ /* Disable Hw protection for a time which revserd for Hw sending beacon. */ -+ /* Fix download reserved page packet fail that access collision with the protection time. */ -+ /* 2010.05.11. Added by tynli. */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 &= ~EN_BCN_FUNCTION; -+ val8 |= DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */ -+ if (pHalData->RegFwHwTxQCtrl & BIT(6)) -+ bRecover = _TRUE; -+ -+ /* To tell Hw the packet is not a real beacon frame. */ -+ pHalData->RegFwHwTxQCtrl &= ~BIT(6); -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl); -+ -+ /* Clear beacon valid check bit. */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ -+ DLBcnCount = 0; -+ poll = 0; -+ do { -+ SetFwRsvdPagePkt_BTCoex(padapter); -+ DLBcnCount++; -+ do { -+ rtw_yield_os(); -+ /* rtw_mdelay_os(10); */ -+ /* check rsvd page download OK. */ -+ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, &bcn_valid); -+ poll++; -+ } while (!bcn_valid && (poll % 10) != 0 && !RTW_CANNOT_RUN(padapter)); -+ } while (!bcn_valid && (DLBcnCount <= 100) && !RTW_CANNOT_RUN(padapter)); -+ -+ if (_TRUE == bcn_valid) { -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ -+ pwrctl->fw_psmode_iface_id = padapter->iface_id; -+ RTW_INFO(ADPT_FMT": DL RSVD page success! DLBcnCount:%d, poll:%d\n", -+ ADPT_ARG(padapter), DLBcnCount, poll); -+ } else { -+ RTW_INFO(ADPT_FMT": DL RSVD page fail! DLBcnCount:%d, poll:%d\n", -+ ADPT_ARG(padapter), DLBcnCount, poll); -+ RTW_INFO(ADPT_FMT": DL RSVD page fail! bSurpriseRemoved=%s\n", -+ ADPT_ARG(padapter), rtw_is_surprise_removed(padapter) ? "True" : "False"); -+ RTW_INFO(ADPT_FMT": DL RSVD page fail! bDriverStopped=%s\n", -+ ADPT_ARG(padapter), rtw_is_drv_stopped(padapter) ? "True" : "False"); -+ } -+ -+ /* 2010.05.11. Added by tynli. */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 |= EN_BCN_FUNCTION; -+ val8 &= ~DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ /* To make sure that if there exists an adapter which would like to send beacon. */ -+ /* If exists, the origianl value of 0x422[6] will be 1, we should check this to */ -+ /* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ -+ /* the beacon cannot be sent by HW. */ -+ /* 2010.06.23. Added by tynli. */ -+ if (bRecover) { -+ pHalData->RegFwHwTxQCtrl |= BIT(6); -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl); -+ } -+ -+ /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ -+#ifndef CONFIG_PCI_HCI -+ val8 = rtw_read8(padapter, REG_CR + 1); -+ val8 &= ~BIT(0); /* ~ENSWBCN */ -+ rtw_write8(padapter, REG_CR + 1, val8); -+#endif -+} -+#endif /* CONFIG_BT_COEXIST */ -+ -+#ifdef CONFIG_P2P -+void rtl8723d_set_p2p_ps_offload_cmd(_adapter *padapter, u8 p2p_ps_state) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct P2P_PS_Offload_t *p2p_ps_offload = (struct P2P_PS_Offload_t *)(&pHalData->p2p_ps_offload); -+ u8 i; -+ -+ -+#if 1 -+ switch (p2p_ps_state) { -+ case P2P_PS_DISABLE: -+ RTW_INFO("P2P_PS_DISABLE\n"); -+ _rtw_memset(p2p_ps_offload, 0 , 1); -+ break; -+ case P2P_PS_ENABLE: -+ RTW_INFO("P2P_PS_ENABLE\n"); -+ /* update CTWindow value. */ -+ if (pwdinfo->ctwindow > 0) { -+ p2p_ps_offload->CTWindow_En = 1; -+ rtw_write8(padapter, REG_P2P_CTWIN, pwdinfo->ctwindow); -+ } -+ -+ /* hw only support 2 set of NoA */ -+ for (i = 0 ; i < pwdinfo->noa_num ; i++) { -+ /* To control the register setting for which NOA */ -+ rtw_write8(padapter, REG_NOA_DESC_SEL, (i << 4)); -+ if (i == 0) -+ p2p_ps_offload->NoA0_En = 1; -+ else -+ p2p_ps_offload->NoA1_En = 1; -+ -+ /* config P2P NoA Descriptor Register */ -+ /* RTW_INFO("%s(): noa_duration = %x\n",__FUNCTION__,pwdinfo->noa_duration[i]); */ -+ rtw_write32(padapter, REG_NOA_DESC_DURATION, pwdinfo->noa_duration[i]); -+ -+ /* RTW_INFO("%s(): noa_interval = %x\n",__FUNCTION__,pwdinfo->noa_interval[i]); */ -+ rtw_write32(padapter, REG_NOA_DESC_INTERVAL, pwdinfo->noa_interval[i]); -+ -+ /* RTW_INFO("%s(): start_time = %x\n",__FUNCTION__,pwdinfo->noa_start_time[i]); */ -+ rtw_write32(padapter, REG_NOA_DESC_START, pwdinfo->noa_start_time[i]); -+ -+ /* RTW_INFO("%s(): noa_count = %x\n",__FUNCTION__,pwdinfo->noa_count[i]); */ -+ rtw_write8(padapter, REG_NOA_DESC_COUNT, pwdinfo->noa_count[i]); -+ } -+ -+ if ((pwdinfo->opp_ps == 1) || (pwdinfo->noa_num > 0)) { -+ /* rst p2p circuit */ -+ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(4)); -+ -+ p2p_ps_offload->Offload_En = 1; -+ -+ if (pwdinfo->role == P2P_ROLE_GO) { -+ p2p_ps_offload->role = 1; -+ p2p_ps_offload->AllStaSleep = 0; -+ } else -+ p2p_ps_offload->role = 0; -+ -+ p2p_ps_offload->discovery = 0; -+ } -+ break; -+ case P2P_PS_SCAN: -+ RTW_INFO("P2P_PS_SCAN\n"); -+ p2p_ps_offload->discovery = 1; -+ break; -+ case P2P_PS_SCAN_DONE: -+ RTW_INFO("P2P_PS_SCAN_DONE\n"); -+ p2p_ps_offload->discovery = 0; -+ pwdinfo->p2p_ps_state = P2P_PS_ENABLE; -+ break; -+ default: -+ break; -+ } -+ -+ FillH2CCmd8723D(padapter, H2C_8723D_P2P_PS_OFFLOAD, 1, (u8 *)p2p_ps_offload); -+#endif -+ -+ -+} -+#endif /* CONFIG_P2P */ -+ -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+/* -+ ask FW to Reset sync register at Beacon early interrupt -+*/ -+u8 rtl8723d_reset_tsf(_adapter *padapter, u8 reset_port) -+{ -+ u8 buf[2]; -+ u8 res = _SUCCESS; -+ -+ if (HW_PORT0 == reset_port) { -+ buf[0] = 0x1; -+ buf[1] = 0; -+ -+ } else { -+ buf[0] = 0x0; -+ buf[1] = 0x1; -+ } -+ FillH2CCmd8723D(padapter, H2C_8723D_RESET_TSF, 2, buf); -+ -+ return res; -+} -+#endif /* CONFIG_TSF_RESET_OFFLOAD */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_dm.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_dm.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_dm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_dm.c 2018-02-11 21:44:27.163146330 +0200 -@@ -0,0 +1,536 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for 92CE/92CU dynamic mechanism only -+ * -+ * -+ * ************************************************************ */ -+#define _RTL8723D_DM_C_ -+ -+/* ************************************************************ -+ * include files -+ * ************************************************************ */ -+#include -+ -+/* ************************************************************ -+ * Global var -+ * ************************************************************ */ -+ -+ -+static VOID -+dm_CheckProtection( -+ IN PADAPTER Adapter -+) -+{ -+#if 0 -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ u1Byte CurRate, RateThreshold; -+ -+ if (pMgntInfo->pHTInfo->bCurBW40MHz) -+ RateThreshold = MGN_MCS1; -+ else -+ RateThreshold = MGN_MCS3; -+ -+ if (Adapter->TxStats.CurrentInitTxRate <= RateThreshold) { -+ pMgntInfo->bDmDisableProtect = TRUE; -+ DbgPrint("Forced disable protect: %x\n", Adapter->TxStats.CurrentInitTxRate); -+ } else { -+ pMgntInfo->bDmDisableProtect = FALSE; -+ DbgPrint("Enable protect: %x\n", Adapter->TxStats.CurrentInitTxRate); -+ } -+#endif -+} -+ -+static VOID -+dm_CheckStatistics( -+ IN PADAPTER Adapter -+) -+{ -+#if 0 -+ if (!Adapter->MgntInfo.bMediaConnect) -+ return; -+ -+ /* 2008.12.10 tynli Add for getting Current_Tx_Rate_Reg flexibly. */ -+ rtw_hal_get_hwreg(Adapter, HW_VAR_INIT_TX_RATE, (pu1Byte)(&Adapter->TxStats.CurrentInitTxRate)); -+ -+ /* Calculate current Tx Rate(Successful transmited!!) */ -+ -+ /* Calculate current Rx Rate(Successful received!!) */ -+ -+ /* for tx tx retry count */ -+ rtw_hal_get_hwreg(Adapter, HW_VAR_RETRY_COUNT, (pu1Byte)(&Adapter->TxStats.NumTxRetryCount)); -+#endif -+} -+#ifdef CONFIG_SUPPORT_HW_WPS_PBC -+static void dm_CheckPbcGPIO(_adapter *padapter) -+{ -+ u8 tmp1byte; -+ u8 bPbcPressed = _FALSE; -+ -+ if (!padapter->registrypriv.hw_wps_pbc) -+ return; -+ -+#ifdef CONFIG_USB_HCI -+ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL); -+ tmp1byte |= (HAL_8192C_HW_GPIO_WPS_BIT); -+ rtw_write8(padapter, GPIO_IO_SEL, tmp1byte); /* enable GPIO[2] as output mode */ -+ -+ tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT); -+ rtw_write8(padapter, GPIO_IN, tmp1byte); /* reset the floating voltage level */ -+ -+ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL); -+ tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT); -+ rtw_write8(padapter, GPIO_IO_SEL, tmp1byte); /* enable GPIO[2] as input mode */ -+ -+ tmp1byte = rtw_read8(padapter, GPIO_IN); -+ -+ if (tmp1byte == 0xff) -+ return; -+ -+ if (tmp1byte & HAL_8192C_HW_GPIO_WPS_BIT) -+ bPbcPressed = _TRUE; -+#else -+ tmp1byte = rtw_read8(padapter, GPIO_IN); -+ -+ if (tmp1byte == 0xff || padapter->init_adpt_in_progress) -+ return; -+ -+ if ((tmp1byte & HAL_8192C_HW_GPIO_WPS_BIT) == 0) -+ bPbcPressed = _TRUE; -+#endif -+ -+ if (_TRUE == bPbcPressed) { -+ /* Here we only set bPbcPressed to true */ -+ /* After trigger PBC, the variable will be set to false */ -+ RTW_INFO("CheckPbcGPIO - PBC is pressed\n"); -+ rtw_request_wps_pbc_event(padapter); -+ } -+} -+#endif /* #ifdef CONFIG_SUPPORT_HW_WPS_PBC */ -+ -+ -+#ifdef CONFIG_PCI_HCI -+/* -+ * Description: -+ * Perform interrupt migration dynamically to reduce CPU utilization. -+ * -+ * Assumption: -+ * 1. Do not enable migration under WIFI test. -+ * -+ * Created by Roger, 2010.03.05. -+ * */ -+VOID -+dm_InterruptMigration( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ BOOLEAN bCurrentIntMt, bCurrentACIntDisable; -+ BOOLEAN IntMtToSet = _FALSE; -+ BOOLEAN ACIntToSet = _FALSE; -+ -+ -+ /* Retrieve current interrupt migration and Tx four ACs IMR settings first. */ -+ bCurrentIntMt = pHalData->bInterruptMigration; -+ bCurrentACIntDisable = pHalData->bDisableTxInt; -+ -+ /* */ -+ /* Currently we use busy traffic for reference instead of RxIntOK counts to prevent non-linear Rx statistics */ -+ /* when interrupt migration is set before. 2010.03.05. */ -+ /* */ -+ if (!Adapter->registrypriv.wifi_spec && -+ (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && -+ pmlmepriv->LinkDetectInfo.bHigherBusyTraffic) { -+ IntMtToSet = _TRUE; -+ -+ /* To check whether we should disable Tx interrupt or not. */ -+ if (pmlmepriv->LinkDetectInfo.bHigherBusyRxTraffic) -+ ACIntToSet = _TRUE; -+ } -+ -+ /* Update current settings. */ -+ if (bCurrentIntMt != IntMtToSet) { -+ RTW_INFO("%s(): Update interrupt migration(%d)\n", __FUNCTION__, IntMtToSet); -+ if (IntMtToSet) { -+ /* */ -+ /* Set interrupt migration timer and corresponging Tx/Rx counter. */ -+ /* timer 25ns*0xfa0=100us for 0xf packets. */ -+ /* 2010.03.05. */ -+ /* */ -+ rtw_write32(Adapter, REG_INT_MIG_8723D, 0xff000fa0);/* 0x306:Rx, 0x307:Tx */ -+ pHalData->bInterruptMigration = IntMtToSet; -+ } else { -+ /* Reset all interrupt migration settings. */ -+ rtw_write32(Adapter, REG_INT_MIG_8723D, 0); -+ pHalData->bInterruptMigration = IntMtToSet; -+ } -+ } -+ -+ /*if( bCurrentACIntDisable != ACIntToSet ){ -+ RTW_INFO("%s(): Update AC interrupt(%d)\n",__FUNCTION__,ACIntToSet); -+ if(ACIntToSet) -+ { -+ -+ -+ -+ -+ -+ UpdateInterruptMask8192CE( Adapter, 0, RT_AC_INT_MASKS ); -+ pHalData->bDisableTxInt = ACIntToSet; -+ } -+ else -+ { -+ UpdateInterruptMask8192CE( Adapter, RT_AC_INT_MASKS, 0 ); -+ pHalData->bDisableTxInt = ACIntToSet; -+ } -+ }*/ -+ -+} -+ -+#endif -+ -+/* -+ * Initialize GPIO setting registers -+ * */ -+static void -+dm_InitGPIOSetting( -+ IN PADAPTER Adapter -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ u8 tmp1byte; -+ -+ tmp1byte = rtw_read8(Adapter, REG_GPIO_MUXCFG); -+ tmp1byte &= (GPIOSEL_GPIO | ~GPIOSEL_ENBT); -+ -+ rtw_write8(Adapter, REG_GPIO_MUXCFG, tmp1byte); -+} -+/* ************************************************************ -+ * functions -+ * ************************************************************ */ -+static void Init_ODM_ComInfo_8723d(PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ u32 SupportAbility = 0; -+ u8 cut_ver, fab_ver; -+ -+ Init_ODM_ComInfo(Adapter); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PACKAGE_TYPE, pHalData->PackageType); -+ -+ fab_ver = ODM_TSMC; -+ cut_ver = GET_CVID_CUT_VERSION(pHalData->VersionID); -+ -+ RTW_INFO("%s(): fab_ver=%d cut_ver=%d\n", __func__, fab_ver, cut_ver); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_FAB_VER, fab_ver); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_CUT_VER, cut_ver); -+ -+#ifdef CONFIG_DISABLE_ODM -+ SupportAbility = 0; -+#else -+ SupportAbility = -+#if 1 -+ ODM_RF_CALIBRATION | -+ ODM_RF_TX_PWR_TRACK -+#else -+ 0 -+#endif -+ ; -+ if (pHalData->AntDivCfg) -+ SupportAbility |= ODM_BB_ANT_DIV; -+#endif -+ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, SupportAbility); -+} -+ -+static void Update_ODM_ComInfo_8723d(PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ u32 SupportAbility = 0; -+ -+ SupportAbility = 0 -+ | ODM_BB_DIG /* For BB */ -+ | ODM_BB_RA_MASK -+ | ODM_BB_FA_CNT -+ | ODM_BB_RSSI_MONITOR -+ | ODM_BB_CCK_PD -+ | ODM_BB_CFO_TRACKING -+ /* | ODM_BB_PWR_TRAIN */ -+ | ODM_BB_NHM_CNT -+ | ODM_RF_TX_PWR_TRACK /* For RF */ -+ | ODM_RF_CALIBRATION -+ | ODM_MAC_EDCA_TURBO /* For MAC */ -+ ; -+ -+ if (rtw_odm_adaptivity_needed(Adapter) == _TRUE) { -+ rtw_odm_adaptivity_config_msg(RTW_DBGDUMP, Adapter); -+ SupportAbility |= ODM_BB_ADAPTIVITY; -+ } -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ if (pHalData->AntDivCfg) -+ SupportAbility |= ODM_BB_ANT_DIV; -+#endif -+ -+#if (MP_DRIVER == 1) -+ if (Adapter->registrypriv.mp_mode == 1) { -+ SupportAbility = 0 -+ | ODM_RF_CALIBRATION -+ | ODM_RF_TX_PWR_TRACK -+ ; -+ } -+#endif/* (MP_DRIVER==1) */ -+ -+#ifdef CONFIG_DISABLE_ODM -+ SupportAbility = 0; -+#endif/* CONFIG_DISABLE_ODM */ -+ -+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, SupportAbility); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, -+ pHalData->TRxAntDivType); -+} -+ -+void -+rtl8723d_InitHalDm( -+ IN PADAPTER Adapter -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ u8 i; -+ -+#ifdef CONFIG_USB_HCI -+ dm_InitGPIOSetting(Adapter); -+#endif -+ -+ pHalData->DM_Type = DM_Type_ByDriver; -+ -+ Update_ODM_ComInfo_8723d(Adapter); -+ -+ ODM_DMInit(pDM_Odm); -+ -+} -+ -+VOID -+rtl8723d_HalDmWatchDog( -+ IN PADAPTER Adapter -+) -+{ -+ BOOLEAN bFwCurrentInPSMode = _FALSE; -+ BOOLEAN bFwPSAwake = _TRUE; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+#ifdef CONFIG_MP_INCLUDED -+ /* #if MP_DRIVER */ -+ if (Adapter->registrypriv.mp_mode == 1 && Adapter->mppriv.mp_dm == 0) /* for MP power tracking */ -+ return; -+ /* #endif */ -+#endif -+ -+ if (!rtw_is_hw_init_completed(Adapter)) -+ goto skip_dm; -+ -+#ifdef CONFIG_LPS -+ bFwCurrentInPSMode = adapter_to_pwrctl(Adapter)->bFwCurrentInPSMode; -+ rtw_hal_get_hwreg(Adapter, HW_VAR_FWLPS_RF_ON, (u8 *)(&bFwPSAwake)); -+#endif -+ -+#ifdef CONFIG_P2P -+ /* Fw is under p2p powersaving mode, driver should stop dynamic mechanism. */ -+ /* modifed by thomas. 2011.06.11. */ -+ if (Adapter->wdinfo.p2p_ps_mode) -+ bFwPSAwake = _FALSE; -+#endif /* CONFIG_P2P */ -+ -+ -+ if ((rtw_is_hw_init_completed(Adapter)) -+ && ((!bFwCurrentInPSMode) && bFwPSAwake)) { -+ /* */ -+ /* Calculate Tx/Rx statistics. */ -+ /* */ -+ dm_CheckStatistics(Adapter); -+ rtw_hal_check_rxfifo_full(Adapter); -+ /* */ -+ /* Dynamically switch RTS/CTS protection. */ -+ /* */ -+ /* dm_CheckProtection(Adapter); */ -+ -+#ifdef CONFIG_PCI_HCI -+ /* 20100630 Joseph: Disable Interrupt Migration mechanism temporarily because it degrades Rx throughput. */ -+ /* Tx Migration settings. */ -+ /* dm_InterruptMigration(Adapter); */ -+ -+ /* if(Adapter->HalFunc.TxCheckStuckHandler(Adapter)) */ -+ /* PlatformScheduleWorkItem(&(GET_HAL_DATA(Adapter)->HalResetWorkItem)); */ -+#endif -+ } -+ -+ /* ODM */ -+ if (rtw_is_hw_init_completed(Adapter)) { -+ u8 bLinked = _FALSE; -+ u8 bsta_state = _FALSE; -+ u8 bBtDisabled = _TRUE; -+ -+ if (rtw_mi_check_status(Adapter, MI_ASSOC)) { -+ bLinked = _TRUE; -+ if (rtw_mi_check_status(Adapter, MI_STA_LINKED)) -+ bsta_state = _TRUE; -+ } -+ -+ ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_LINK, bLinked); -+ ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_STATION_STATE, bsta_state); -+ -+ /* ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); */ -+ -+#ifdef CONFIG_BT_COEXIST -+ bBtDisabled = rtw_btcoex_IsBtDisabled(Adapter); -+#endif /* CONFIG_BT_COEXIST */ -+ ODM_CmnInfoUpdate(&pHalData->odmpriv, ODM_CMNINFO_BT_ENABLED, ((bBtDisabled == _TRUE) ? _FALSE : _TRUE)); -+ -+ ODM_DMWatchdog(&pHalData->odmpriv); -+ } -+ -+skip_dm: -+ -+ /* Check GPIO to determine current RF on/off and Pbc status. */ -+ /* Check Hardware Radio ON/OFF or not */ -+ /* if(Adapter->MgntInfo.PowerSaveControl.bGpioRfSw) */ -+ /* { */ -+ /* RTPRINT(FPWR, PWRHW, ("dm_CheckRfCtrlGPIO\n")); */ -+ /* dm_CheckRfCtrlGPIO(Adapter); */ -+ /* } */ -+#ifdef CONFIG_SUPPORT_HW_WPS_PBC -+ dm_CheckPbcGPIO(Adapter); -+#endif -+ return; -+} -+ -+void rtl8723d_hal_dm_in_lps(PADAPTER padapter) -+{ -+ u32 PWDB_rssi = 0; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ -+ RTW_INFO("%s, RSSI_Min=%d\n", __func__, pDM_Odm->RSSI_Min); -+ -+ /* update IGI */ -+ ODM_Write_DIG(pDM_Odm, pDM_Odm->RSSI_Min); -+ -+ -+ /* set rssi to fw */ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta && (psta->rssi_stat.UndecoratedSmoothedPWDB > 0)) { -+ PWDB_rssi = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB << 16)); -+ -+ rtl8723d_set_rssi_cmd(padapter, (u8 *)&PWDB_rssi); -+ } -+ -+} -+ -+void rtl8723d_HalDmWatchDog_in_LPS(IN PADAPTER Adapter) -+{ -+ u8 bLinked = _FALSE; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ struct sta_priv *pstapriv = &Adapter->stapriv; -+ struct sta_info *psta = NULL; -+ -+ if (!rtw_is_hw_init_completed(Adapter)) -+ goto skip_lps_dm; -+ -+ if (rtw_mi_check_status(Adapter, MI_ASSOC)) -+ bLinked = _TRUE; -+ -+ ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_LINK, bLinked); -+ -+ if (bLinked == _FALSE) -+ goto skip_lps_dm; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)) -+ goto skip_lps_dm; -+ -+ -+ /* ODM_DMWatchdog(&pHalData->odmpriv); */ -+ /* Do DIG by RSSI In LPS-32K */ -+ -+ /* .1 Find MIN-RSSI */ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) -+ goto skip_lps_dm; -+ -+ pHalData->EntryMinUndecoratedSmoothedPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ RTW_INFO("CurIGValue=%d, EntryMinUndecoratedSmoothedPWDB = %d\n", pDM_DigTable->CurIGValue, pHalData->EntryMinUndecoratedSmoothedPWDB); -+ -+ if (pHalData->EntryMinUndecoratedSmoothedPWDB <= 0) -+ goto skip_lps_dm; -+ -+ pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; -+ -+ pDM_Odm->RSSI_Min = pHalData->MinUndecoratedPWDBForDM; -+ -+ /* if(pDM_DigTable->CurIGValue != pDM_Odm->RSSI_Min) */ -+ if ((pDM_DigTable->CurIGValue > pDM_Odm->RSSI_Min + 5) || -+ (pDM_DigTable->CurIGValue < pDM_Odm->RSSI_Min - 5)) -+ -+ { -+#ifdef CONFIG_LPS -+ rtw_dm_in_lps_wk_cmd(Adapter); -+#endif /* CONFIG_LPS */ -+ } -+ -+ -+skip_lps_dm: -+ -+ return; -+ -+} -+ -+void rtl8723d_init_dm_priv(IN PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ -+ Init_ODM_ComInfo_8723d(Adapter); -+ ODM_InitAllTimers(podmpriv); -+ -+} -+ -+void rtl8723d_deinit_dm_priv(IN PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ -+ ODM_CancelAllTimers(podmpriv); -+ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_hal_init.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_hal_init.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_hal_init.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_hal_init.c 2018-02-11 21:44:27.164146345 +0200 -@@ -0,0 +1,6195 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _HAL_INIT_C_ -+ -+#include -+#include -+#include "hal_com_h2c.h" -+#include "hal8723d_fw.h" -+ -+#ifndef CONFIG_DLFW_TXPKT -+#define DL_FW_MAX 15 -+#else -+#define FW_DOWNLOAD_SIZE_8723D 8192 -+#endif -+ -+static VOID -+_FWDownloadEnable( -+ IN PADAPTER padapter, -+ IN BOOLEAN enable -+) -+{ -+ u8 tmp, count = 0; -+ -+ if (enable) { -+ /* 8051 enable */ -+ tmp = rtw_read8(padapter, REG_SYS_FUNC_EN + 1); -+ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, tmp | 0x04); -+ -+ tmp = rtw_read8(padapter, REG_MCUFWDL); -+ rtw_write8(padapter, REG_MCUFWDL, tmp | 0x01); -+ -+ do { -+ tmp = rtw_read8(padapter, REG_MCUFWDL); -+ if (tmp & 0x01) -+ break; -+ rtw_write8(padapter, REG_MCUFWDL, tmp | 0x01); -+ rtw_msleep_os(1); -+ } while (count++ < 100); -+ if (count > 0) -+ RTW_INFO("%s: !!!!!!!!Write 0x80 Fail!: count = %d\n", __func__, count); -+ -+ /* 8051 reset */ -+ tmp = rtw_read8(padapter, REG_MCUFWDL + 2); -+ rtw_write8(padapter, REG_MCUFWDL + 2, tmp & 0xf7); -+ } else { -+ /* MCU firmware download disable. */ -+ tmp = rtw_read8(padapter, REG_MCUFWDL); -+ rtw_write8(padapter, REG_MCUFWDL, tmp & 0xfe); -+ } -+} -+ -+static int -+_BlockWrite( -+ IN PADAPTER padapter, -+ IN PVOID buffer, -+ IN u32 buffSize -+) -+{ -+ int ret = _SUCCESS; -+ -+ u32 blockSize_p1 = 4; /* (Default) Phase #1 : PCI muse use 4-byte write to download FW */ -+ u32 blockSize_p2 = 8; /* Phase #2 : Use 8-byte, if Phase#1 use big size to write FW. */ -+ u32 blockSize_p3 = 1; /* Phase #3 : Use 1-byte, the remnant of FW image. */ -+ u32 blockCount_p1 = 0, blockCount_p2 = 0, blockCount_p3 = 0; -+ u32 remainSize_p1 = 0, remainSize_p2 = 0; -+ u8 *bufferPtr = (u8 *)buffer; -+ u32 i = 0, offset = 0; -+#ifdef CONFIG_PCI_HCI -+ u8 remainFW[4] = {0, 0, 0, 0}; -+ u8 *p = NULL; -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ blockSize_p1 = 254; -+#endif -+ -+ /* printk("====>%s %d\n", __func__, __LINE__); */ -+ -+ /* 3 Phase #1 */ -+ blockCount_p1 = buffSize / blockSize_p1; -+ remainSize_p1 = buffSize % blockSize_p1; -+ -+ -+ -+ for (i = 0; i < blockCount_p1; i++) { -+#ifdef CONFIG_USB_HCI -+ ret = rtw_writeN(padapter, (FW_8723D_START_ADDRESS + i * blockSize_p1), blockSize_p1, (bufferPtr + i * blockSize_p1)); -+#else -+ ret = rtw_write32(padapter, (FW_8723D_START_ADDRESS + i * blockSize_p1), le32_to_cpu(*((u32 *)(bufferPtr + i * blockSize_p1)))); -+#endif -+ if (ret == _FAIL) { -+ printk(KERN_ERR "====>%s %d i:%d\n", __func__, __LINE__, i); -+ goto exit; -+ } -+ } -+ -+#ifdef CONFIG_PCI_HCI -+ p = (u8 *)((u32 *)(bufferPtr + blockCount_p1 * blockSize_p1)); -+ if (remainSize_p1) { -+ switch (remainSize_p1) { -+ case 0: -+ break; -+ case 3: -+ remainFW[2] = *(p + 2); -+ case 2: -+ remainFW[1] = *(p + 1); -+ case 1: -+ remainFW[0] = *(p); -+ ret = rtw_write32(padapter, (FW_8723D_START_ADDRESS + blockCount_p1 * blockSize_p1), -+ le32_to_cpu(*(u32 *)remainFW)); -+ } -+ return ret; -+ } -+#endif -+ -+ /* 3 Phase #2 */ -+ if (remainSize_p1) { -+ offset = blockCount_p1 * blockSize_p1; -+ -+ blockCount_p2 = remainSize_p1 / blockSize_p2; -+ remainSize_p2 = remainSize_p1 % blockSize_p2; -+ -+ -+ -+#ifdef CONFIG_USB_HCI -+ for (i = 0; i < blockCount_p2; i++) { -+ ret = rtw_writeN(padapter, (FW_8723D_START_ADDRESS + offset + i * blockSize_p2), blockSize_p2, (bufferPtr + offset + i * blockSize_p2)); -+ -+ if (ret == _FAIL) -+ goto exit; -+ } -+#endif -+ } -+ -+ /* 3 Phase #3 */ -+ if (remainSize_p2) { -+ offset = (blockCount_p1 * blockSize_p1) + (blockCount_p2 * blockSize_p2); -+ -+ blockCount_p3 = remainSize_p2 / blockSize_p3; -+ -+ -+ for (i = 0 ; i < blockCount_p3 ; i++) { -+ ret = rtw_write8(padapter, (FW_8723D_START_ADDRESS + offset + i), *(bufferPtr + offset + i)); -+ -+ if (ret == _FAIL) { -+ printk(KERN_ERR "====>%s %d i:%d\n", __func__, __LINE__, i); -+ goto exit; -+ } -+ } -+ } -+exit: -+ return ret; -+} -+ -+static int -+_PageWrite( -+ IN PADAPTER padapter, -+ IN u32 page, -+ IN PVOID buffer, -+ IN u32 size -+) -+{ -+ u8 value8; -+ u8 u8Page = (u8)(page & 0x07); -+ -+ value8 = (rtw_read8(padapter, REG_MCUFWDL + 2) & 0xF8) | u8Page; -+ rtw_write8(padapter, REG_MCUFWDL + 2, value8); -+ -+ return _BlockWrite(padapter, buffer, size); -+} -+ -+static VOID -+_FillDummy( -+ u8 *pFwBuf, -+ u32 *pFwLen -+) -+{ -+ u32 FwLen = *pFwLen; -+ u8 remain = (u8)(FwLen % 4); -+ -+ remain = (remain == 0) ? 0 : (4 - remain); -+ -+ while (remain > 0) { -+ pFwBuf[FwLen] = 0; -+ FwLen++; -+ remain--; -+ } -+ -+ *pFwLen = FwLen; -+} -+ -+static int -+_WriteFW( -+ IN PADAPTER padapter, -+ IN PVOID buffer, -+ IN u32 size -+) -+{ -+ /* Since we need dynamic decide method of dwonload fw, so we call this function to get chip version. */ -+ int ret = _SUCCESS; -+ u32 pageNums, remainSize; -+ u32 page, offset; -+ u8 *bufferPtr = (u8 *)buffer; -+ -+#ifdef CONFIG_PCI_HCI -+ /* 20100120 Joseph: Add for 88CE normal chip. */ -+ /* Fill in zero to make firmware image to dword alignment. */ -+ _FillDummy(bufferPtr, &size); -+#endif -+ -+ pageNums = size / MAX_DLFW_PAGE_SIZE; -+ /* RT_ASSERT((pageNums <= 4), ("Page numbers should not greater then 4\n")); */ -+ remainSize = size % MAX_DLFW_PAGE_SIZE; -+ -+ for (page = 0; page < pageNums; page++) { -+ offset = page * MAX_DLFW_PAGE_SIZE; -+ ret = _PageWrite(padapter, page, bufferPtr + offset, MAX_DLFW_PAGE_SIZE); -+ -+ if (ret == _FAIL) { -+ printk(KERN_ERR "====>%s %d\n", __func__, __LINE__); -+ goto exit; -+ } -+ } -+ if (remainSize) { -+ offset = pageNums * MAX_DLFW_PAGE_SIZE; -+ page = pageNums; -+ ret = _PageWrite(padapter, page, bufferPtr + offset, remainSize); -+ -+ if (ret == _FAIL) { -+ printk(KERN_ERR "====>%s %d\n", __func__, __LINE__); -+ goto exit; -+ } -+ } -+ -+exit: -+ return ret; -+} -+ -+void _8051Reset8723(PADAPTER padapter) -+{ -+ u8 cpu_rst; -+ u8 io_rst; -+ -+#if 0 -+ io_rst = rtw_read8(padapter, REG_RSV_CTRL); -+ rtw_write8(padapter, REG_RSV_CTRL, io_rst & (~BIT(1))); -+#endif -+ -+ /* Reset 8051(WLMCU) IO wrapper */ -+ /* 0x1c[8] = 0 */ -+ /* Suggested by Isaac@SD1 and Gimmy@SD1, coding by Lucas@20130624 */ -+ io_rst = rtw_read8(padapter, REG_RSV_CTRL + 1); -+ io_rst &= ~BIT(0); -+ rtw_write8(padapter, REG_RSV_CTRL + 1, io_rst); -+ -+ cpu_rst = rtw_read8(padapter, REG_SYS_FUNC_EN + 1); -+ cpu_rst &= ~BIT(2); -+ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, cpu_rst); -+ -+#if 0 -+ io_rst = rtw_read8(padapter, REG_RSV_CTRL); -+ rtw_write8(padapter, REG_RSV_CTRL, io_rst & (~BIT(1))); -+#endif -+ -+ /* Enable 8051 IO wrapper */ -+ /* 0x1c[8] = 1 */ -+ io_rst = rtw_read8(padapter, REG_RSV_CTRL + 1); -+ io_rst |= BIT(0); -+ rtw_write8(padapter, REG_RSV_CTRL + 1, io_rst); -+ -+ cpu_rst = rtw_read8(padapter, REG_SYS_FUNC_EN + 1); -+ cpu_rst |= BIT(2); -+ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, cpu_rst); -+ -+ RTW_INFO("%s: Finish\n", __FUNCTION__); -+} -+ -+static s32 polling_fwdl_chksum(_adapter *adapter, u32 min_cnt, u32 timeout_ms) -+{ -+ s32 ret = _FAIL; -+ u32 value32; -+ u32 start = rtw_get_current_time(); -+ u32 cnt = 0; -+ -+ /* polling CheckSum report */ -+ do { -+ cnt++; -+ value32 = rtw_read32(adapter, REG_MCUFWDL); -+ if (value32 & FWDL_ChkSum_rpt || RTW_CANNOT_IO(adapter)) -+ break; -+ rtw_mdelay_os(5); -+ } while (rtw_get_passing_time_ms(start) < timeout_ms || cnt < min_cnt); -+ -+ if (!(value32 & FWDL_ChkSum_rpt)) -+ goto exit; -+ -+ if (rtw_fwdl_test_trigger_chksum_fail()) -+ goto exit; -+ -+ ret = _SUCCESS; -+ -+exit: -+ RTW_INFO("%s: Checksum report %s! (%u, %dms), REG_MCUFWDL:0x%08x\n", __FUNCTION__ -+ , (ret == _SUCCESS) ? "OK" : "Fail", cnt, rtw_get_passing_time_ms(start), value32); -+ -+ return ret; -+} -+ -+static s32 _FWFreeToGo(_adapter *adapter, u32 min_cnt, u32 timeout_ms) -+{ -+ s32 ret = _FAIL; -+ u32 value32; -+ u32 start = rtw_get_current_time(); -+ u32 cnt = 0; -+ u32 value_to_check = 0; -+ u32 value_expected = (MCUFWDL_RDY | FWDL_ChkSum_rpt | WINTINI_RDY | RAM_DL_SEL); -+ -+ value32 = rtw_read32(adapter, REG_MCUFWDL); -+ value32 |= MCUFWDL_RDY; -+ value32 &= ~WINTINI_RDY; -+ rtw_write32(adapter, REG_MCUFWDL, value32); -+ -+ _8051Reset8723(adapter); -+ -+ /* polling for FW ready */ -+ do { -+ cnt++; -+ value32 = rtw_read32(adapter, REG_MCUFWDL); -+ value_to_check = value32 & value_expected; -+ if ((value_to_check == value_expected) || RTW_CANNOT_IO(adapter)) -+ break; -+ rtw_yield_os(); -+ } while (rtw_get_passing_time_ms(start) < timeout_ms || cnt < min_cnt); -+ -+ if (value_to_check != value_expected) -+ goto exit; -+ -+ if (rtw_fwdl_test_trigger_wintint_rdy_fail()) -+ goto exit; -+ -+ ret = _SUCCESS; -+ -+exit: -+ RTW_INFO("%s: Polling FW ready %s! (%u, %dms), REG_MCUFWDL:0x%08x\n", __FUNCTION__ -+ , (ret == _SUCCESS) ? "OK" : "Fail", cnt, rtw_get_passing_time_ms(start), value32); -+ -+ return ret; -+} -+ -+#define IS_FW_81xxC(padapter) (((GET_HAL_DATA(padapter))->FirmwareSignature & 0xFFF0) == 0x88C0) -+ -+void rtl8723d_FirmwareSelfReset(PADAPTER padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 u1bTmp; -+ u8 Delay = 100; -+ -+ if (!(IS_FW_81xxC(padapter) && -+ ((pHalData->FirmwareVersion < 0x21) || -+ (pHalData->FirmwareVersion == 0x21 && -+ pHalData->FirmwareSubVersion < 0x01)))) { /* after 88C Fw v33.1 */ -+ /* 0x1cf=0x20. Inform 8051 to reset. 2009.12.25. tynli_test */ -+ rtw_write8(padapter, REG_HMETFR + 3, 0x20); -+ -+ u1bTmp = rtw_read8(padapter, REG_SYS_FUNC_EN + 1); -+ while (u1bTmp & BIT(2)) { -+ Delay--; -+ if (Delay == 0) -+ break; -+ rtw_udelay_os(50); -+ u1bTmp = rtw_read8(padapter, REG_SYS_FUNC_EN + 1); -+ } -+ -+ if (Delay == 0) { -+ /* force firmware reset */ -+ u1bTmp = rtw_read8(padapter, REG_SYS_FUNC_EN + 1); -+ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, u1bTmp & (~BIT(2))); -+ } -+ } -+} -+ -+#ifdef CONFIG_FILE_FWIMG -+ u8 FwBuffer[FW_8723D_SIZE]; -+#endif /* CONFIG_FILE_FWIMG */ -+ -+#ifdef CONFIG_MP_INCLUDED -+int _WriteBTFWtoTxPktBuf8723D( -+ IN PADAPTER Adapter, -+ IN PVOID buffer, -+ IN u4Byte FwBufLen, -+ IN u1Byte times -+) -+{ -+ int rtStatus = _SUCCESS; -+ /* u4Byte value32; */ -+ /* u1Byte numHQ, numLQ, numPubQ;//, txpktbuf_bndy; */ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ /* PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); */ -+ u1Byte BcnValidReg; -+ u1Byte count = 0, DLBcnCount = 0; -+ pu1Byte FwbufferPtr = (pu1Byte)buffer; -+ /* PRT_TCB pTcb, ptempTcb; */ -+ /* PRT_TX_LOCAL_BUFFER pBuf; */ -+ BOOLEAN bRecover = _FALSE; -+ pu1Byte ReservedPagePacket = NULL; -+ pu1Byte pGenBufReservedPagePacket = NULL; -+ u4Byte TotalPktLen, txpktbuf_bndy; -+ /* u1Byte tmpReg422; */ -+ /* u1Byte u1bTmp; */ -+ u8 *pframe; -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ u8 txdesc_offset = TXDESC_OFFSET; -+ u8 val8; -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ u8 u1bTmp; -+#endif -+ -+#if 1/* (DEV_BUS_TYPE == RT_PCI_INTERFACE) */ -+ TotalPktLen = FwBufLen; -+#else -+ TotalPktLen = FwBufLen + pHalData->HWDescHeadLength; -+#endif -+ -+ if ((TotalPktLen + TXDESC_OFFSET) > MAX_CMDBUF_SZ) { -+ RTW_INFO(" WARNING %s => Total packet len = %d > MAX_CMDBUF_SZ:%d\n" -+ , __FUNCTION__, (TotalPktLen + TXDESC_OFFSET), MAX_CMDBUF_SZ); -+ return _FAIL; -+ } -+ -+ pGenBufReservedPagePacket = rtw_zmalloc(TotalPktLen);/* GetGenTempBuffer (Adapter, TotalPktLen); */ -+ if (!pGenBufReservedPagePacket) -+ return _FAIL; -+ -+ ReservedPagePacket = (u1Byte *)pGenBufReservedPagePacket; -+ -+ _rtw_memset(ReservedPagePacket, 0, TotalPktLen); -+ -+#if 1/* (DEV_BUS_TYPE == RT_PCI_INTERFACE) */ -+ _rtw_memcpy(ReservedPagePacket, FwbufferPtr, FwBufLen); -+ -+#else -+ PlatformMoveMemory(ReservedPagePacket + Adapter->HWDescHeadLength , FwbufferPtr, FwBufLen); -+#endif -+ -+ /* --------------------------------------------------------- */ -+ /* 1. Pause BCN */ -+ /* --------------------------------------------------------- */ -+ /* Set REG_CR bit 8. DMA beacon by SW. */ -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR + 1); -+ PlatformEFIOWrite1Byte(Adapter, REG_CR + 1, (u1bTmp | BIT(0))); -+#else -+ /* Remove for temparaily because of the code on v2002 is not sync to MERGE_TMEP for USB/SDIO. */ -+ /* De not remove this part on MERGE_TEMP. by tynli. */ -+ /* pHalData->RegCR_1 |= (BIT0); */ -+ /* PlatformEFIOWrite1Byte(Adapter, REG_CR+1, pHalData->RegCR_1); */ -+#endif -+ -+ /* Disable Hw protection for a time which revserd for Hw sending beacon. */ -+ /* Fix download reserved page packet fail that access collision with the protection time. */ -+ /* 2010.05.11. Added by tynli. */ -+ val8 = rtw_read8(Adapter, REG_BCN_CTRL); -+ val8 &= ~EN_BCN_FUNCTION; -+ val8 |= DIS_TSF_UDT; -+ rtw_write8(Adapter, REG_BCN_CTRL, val8); -+ -+#if 0/* (DEV_BUS_TYPE == RT_PCI_INTERFACE) */ -+ tmpReg422 = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2); -+ if (tmpReg422 & BIT(6)) -+ bRecover = TRUE; -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, tmpReg422 & (~BIT(6))); -+#else -+ /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */ -+ if (pHalData->RegFwHwTxQCtrl & BIT(6)) -+ bRecover = _TRUE; -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, (pHalData->RegFwHwTxQCtrl & (~BIT(6)))); -+ pHalData->RegFwHwTxQCtrl &= (~BIT(6)); -+#endif -+ -+ /* --------------------------------------------------------- */ -+ /* 2. Adjust LLT table to an even boundary. */ -+ /* --------------------------------------------------------- */ -+#if 0/* (DEV_BUS_TYPE == RT_SDIO_INTERFACE) */ -+ txpktbuf_bndy = 10; /* rsvd page start address should be an even value. */ -+ rtStatus = InitLLTTable8723DS(Adapter, txpktbuf_bndy); -+ if (RT_STATUS_SUCCESS != rtStatus) { -+ RTW_INFO("_CheckWLANFwPatchBTFwReady_8723D(): Failed to init LLT!\n"); -+ return RT_STATUS_FAILURE; -+ } -+ -+ /* Init Tx boundary. */ -+ PlatformEFIOWrite1Byte(Adapter, REG_DWBCN0_CTRL_8723D + 1, (u1Byte)txpktbuf_bndy); -+#endif -+ -+ -+ /* --------------------------------------------------------- */ -+ /* 3. Write Fw to Tx packet buffer by reseverd page. */ -+ /* --------------------------------------------------------- */ -+ do { -+ /* download rsvd page. */ -+ /* Clear beacon valid check bit. */ -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_TDECTRL + 2); -+ PlatformEFIOWrite1Byte(Adapter, REG_TDECTRL + 2, BcnValidReg & (~BIT(0))); -+ -+ /* BT patch is big, we should set 0x209 < 0x40 suggested from Gimmy */ -+ -+ PlatformEFIOWrite1Byte(Adapter, REG_TDECTRL + 1, (0x90 - 0x20 * (times - 1))); -+ RTW_INFO("0x209:0x%x\n", PlatformEFIORead1Byte(Adapter, REG_TDECTRL + 1)); -+ -+#if 0 -+ /* Acquice TX spin lock before GetFwBuf and send the packet to prevent system deadlock. */ -+ /* Advertised by Roger. Added by tynli. 2010.02.22. */ -+ PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); -+ if (MgntGetFWBuffer(Adapter, &pTcb, &pBuf)) { -+ PlatformMoveMemory(pBuf->Buffer.VirtualAddress, ReservedPagePacket, TotalPktLen); -+ CmdSendPacket(Adapter, pTcb, pBuf, TotalPktLen, DESC_PACKET_TYPE_NORMAL, FALSE); -+ } else -+ dbgdump("SetFwRsvdPagePkt(): MgntGetFWBuffer FAIL!!!!!!!!.\n"); -+ PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); -+#else -+ /*--------------------------------------------------------- -+ tx reserved_page_packet -+ ----------------------------------------------------------*/ -+ pmgntframe = rtw_alloc_cmdxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ rtStatus = _FAIL; -+ goto exit; -+ } -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(Adapter, pattrib); -+ -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->pktlen = pattrib->last_txcmdsz = FwBufLen; -+ -+ /* _rtw_memset(pmgntframe->buf_addr, 0, TotalPktLen+txdesc_size); */ -+ /* pmgntframe->buf_addr = ReservedPagePacket ; */ -+ -+ _rtw_memcpy((u8 *)(pmgntframe->buf_addr + txdesc_offset), ReservedPagePacket, FwBufLen); -+ RTW_INFO("[%d]===>TotalPktLen + TXDESC_OFFSET TotalPacketLen:%d\n", DLBcnCount, (FwBufLen + txdesc_offset)); -+ -+#ifdef CONFIG_PCI_HCI -+ dump_mgntframe(Adapter, pmgntframe); -+#else -+ dump_mgntframe_and_wait(Adapter, pmgntframe, 100); -+#endif -+ -+#endif -+#if 1 -+ /* check rsvd page download OK. */ -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_TDECTRL + 2); -+ while (!(BcnValidReg & BIT(0)) && count < 200) { -+ count++; -+ /* PlatformSleepUs(10); */ -+ rtw_msleep_os(1); -+ BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_TDECTRL + 2); -+ } -+ DLBcnCount++; -+ /* RTW_INFO("##0x208:%08x,0x210=%08x\n",PlatformEFIORead4Byte(Adapter, REG_TDECTRL),PlatformEFIORead4Byte(Adapter, 0x210)); */ -+ -+ PlatformEFIOWrite1Byte(Adapter, REG_TDECTRL + 2, BcnValidReg); -+ -+ } while ((!(BcnValidReg & BIT(0))) && DLBcnCount < 5); -+ -+ -+#endif -+ if (DLBcnCount >= 5) { -+ RTW_INFO(" check rsvd page download OK DLBcnCount =%d\n", DLBcnCount); -+ rtStatus = _FAIL; -+ goto exit; -+ } -+ -+ if (!(BcnValidReg & BIT(0))) { -+ RTW_INFO("_WriteFWtoTxPktBuf(): 1 Download RSVD page failed!\n"); -+ rtStatus = _FAIL; -+ goto exit; -+ } -+ -+ /* --------------------------------------------------------- */ -+ /* 4. Set Tx boundary to the initial value */ -+ /* --------------------------------------------------------- */ -+ -+ -+ /* --------------------------------------------------------- */ -+ /* 5. Reset beacon setting to the initial value. */ -+ /* After _CheckWLANFwPatchBTFwReady(). */ -+ /* --------------------------------------------------------- */ -+ -+exit: -+ -+ if (pGenBufReservedPagePacket) { -+ RTW_INFO("_WriteBTFWtoTxPktBuf8723D => rtw_mfree pGenBufReservedPagePacket!\n"); -+ rtw_mfree((u8 *)pGenBufReservedPagePacket, TotalPktLen); -+ } -+ return rtStatus; -+} -+ -+ -+ -+/* -+ * Description: Determine the contents of H2C BT_FW_PATCH Command sent to FW. -+ * 2011.10.20 by tynli -+ * */ -+void -+SetFwBTFwPatchCmd( -+ IN PADAPTER Adapter, -+ IN u16 FwSize -+) -+{ -+ u8 u1BTFwPatchParm[H2C_BT_FW_PATCH_LEN] = {0}; -+ u8 addr0 = 0; -+ u8 addr1 = 0xa0; -+ u8 addr2 = 0x10; -+ u8 addr3 = 0x80; -+ -+ -+ SET_8723D_H2CCMD_BT_FW_PATCH_SIZE(u1BTFwPatchParm, FwSize); -+ SET_8723D_H2CCMD_BT_FW_PATCH_ADDR0(u1BTFwPatchParm, addr0); -+ SET_8723D_H2CCMD_BT_FW_PATCH_ADDR1(u1BTFwPatchParm, addr1); -+ SET_8723D_H2CCMD_BT_FW_PATCH_ADDR2(u1BTFwPatchParm, addr2); -+ SET_8723D_H2CCMD_BT_FW_PATCH_ADDR3(u1BTFwPatchParm, addr3); -+ -+ FillH2CCmd8723D(Adapter, H2C_8723D_BT_FW_PATCH, H2C_BT_FW_PATCH_LEN, u1BTFwPatchParm); -+ -+} -+ -+void -+SetFwBTPwrCmd( -+ IN PADAPTER Adapter, -+ IN u1Byte PwrIdx -+) -+{ -+ u1Byte u1BTPwrIdxParm[H2C_FORCE_BT_TXPWR_LEN] = {0}; -+ -+ SET_8723D_H2CCMD_BT_PWR_IDX(u1BTPwrIdxParm, PwrIdx); -+ -+ -+ FillH2CCmd8723D(Adapter, H2C_8723D_FORCE_BT_TXPWR, H2C_FORCE_BT_TXPWR_LEN, u1BTPwrIdxParm); -+} -+ -+/* -+ * Description: WLAN Fw will write BT Fw to BT XRAM and signal driver. -+ * -+ * 2011.10.20. by tynli. -+ * */ -+int -+_CheckWLANFwPatchBTFwReady( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u4Byte count = 0; -+ u1Byte u1bTmp; -+ int ret = _FAIL; -+ -+ /* --------------------------------------------------------- */ -+ /* Check if BT FW patch procedure is ready. */ -+ /* --------------------------------------------------------- */ -+ do { -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_HMEBOX_DBG_0_8723D); -+ if ((u1bTmp & BIT(6)) || (u1bTmp & BIT(7))) { -+ ret = _SUCCESS; -+ break; -+ } -+ -+ count++; -+ rtw_msleep_os(50); /* 50ms */ -+ } while (!((u1bTmp & BIT(6)) || (u1bTmp & BIT(7))) && count < 50); -+ -+ -+ -+ -+ /* --------------------------------------------------------- */ -+ /* Reset beacon setting to the initial value. */ -+ /* --------------------------------------------------------- */ -+#if 0/* (DEV_BUS_TYPE == RT_PCI_INTERFACE) */ -+ if (LLT_table_init(Adapter, FALSE, 0) == RT_STATUS_FAILURE) { -+ dbgdump("Init self define for BT Fw patch LLT table fail.\n"); -+ /* return RT_STATUS_FAILURE; */ -+ } -+#endif -+ u1bTmp = rtw_read8(Adapter, REG_BCN_CTRL); -+ u1bTmp |= EN_BCN_FUNCTION; -+ u1bTmp &= ~DIS_TSF_UDT; -+ rtw_write8(Adapter, REG_BCN_CTRL, u1bTmp); -+ -+ /* To make sure that if there exists an adapter which would like to send beacon. */ -+ /* If exists, the origianl value of 0x422[6] will be 1, we should check this to */ -+ /* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ -+ /* the beacon cannot be sent by HW. */ -+ /* 2010.06.23. Added by tynli. */ -+#if 0/* (DEV_BUS_TYPE == RT_PCI_INTERFACE) */ -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2); -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, (u1bTmp | BIT(6))); -+#else -+ PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, (pHalData->RegFwHwTxQCtrl | BIT(6))); -+ pHalData->RegFwHwTxQCtrl |= BIT(6); -+#endif -+ -+ /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ -+ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR + 1); -+ PlatformEFIOWrite1Byte(Adapter, REG_CR + 1, (u1bTmp & (~BIT(0)))); -+ -+ return ret; -+} -+ -+int ReservedPage_Compare(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware, u32 BTPatchSize) -+{ -+ u8 temp, ret, lastBTsz; -+ u32 u1bTmp = 0, address_start = 0, count = 0, i = 0; -+ u8 *myBTFwBuffer = NULL; -+ -+ myBTFwBuffer = rtw_zmalloc(BTPatchSize); -+ if (myBTFwBuffer == NULL) { -+ RTW_INFO("%s can't be executed due to the failed malloc.\n", __FUNCTION__); -+ Adapter->mppriv.bTxBufCkFail = _TRUE; -+ return _FALSE; -+ } -+ -+ temp = rtw_read8(Adapter, 0x209); -+ -+ address_start = (temp * 128) / 8; -+ -+ rtw_write32(Adapter, 0x140, 0x00000000); -+ rtw_write32(Adapter, 0x144, 0x00000000); -+ rtw_write32(Adapter, 0x148, 0x00000000); -+ -+ rtw_write8(Adapter, 0x106, 0x69); -+ -+ for (i = 0; i < (BTPatchSize / 8); i++) { -+ rtw_write32(Adapter, 0x140, address_start + 5 + i); -+ -+ /* polling until reg 0x140[23]=1; */ -+ do { -+ u1bTmp = rtw_read32(Adapter, 0x140); -+ if (u1bTmp & BIT(23)) { -+ ret = _SUCCESS; -+ break; -+ } -+ count++; -+ RTW_INFO("0x140=%x, wait for 10 ms (%d) times.\n", u1bTmp, count); -+ rtw_msleep_os(10); /* 10ms */ -+ } while (!(u1bTmp & BIT(23)) && count < 50); -+ -+ myBTFwBuffer[i * 8 + 0] = rtw_read8(Adapter, 0x144); -+ myBTFwBuffer[i * 8 + 1] = rtw_read8(Adapter, 0x145); -+ myBTFwBuffer[i * 8 + 2] = rtw_read8(Adapter, 0x146); -+ myBTFwBuffer[i * 8 + 3] = rtw_read8(Adapter, 0x147); -+ myBTFwBuffer[i * 8 + 4] = rtw_read8(Adapter, 0x148); -+ myBTFwBuffer[i * 8 + 5] = rtw_read8(Adapter, 0x149); -+ myBTFwBuffer[i * 8 + 6] = rtw_read8(Adapter, 0x14a); -+ myBTFwBuffer[i * 8 + 7] = rtw_read8(Adapter, 0x14b); -+ } -+ -+ rtw_write32(Adapter, 0x140, address_start + 5 + BTPatchSize / 8); -+ -+ lastBTsz = BTPatchSize % 8; -+ -+ /* polling until reg 0x140[23]=1; */ -+ u1bTmp = 0; -+ count = 0; -+ do { -+ u1bTmp = rtw_read32(Adapter, 0x140); -+ if (u1bTmp & BIT(23)) { -+ ret = _SUCCESS; -+ break; -+ } -+ count++; -+ RTW_INFO("0x140=%x, wait for 10 ms (%d) times.\n", u1bTmp, count); -+ rtw_msleep_os(10); /* 10ms */ -+ } while (!(u1bTmp & BIT(23)) && count < 50); -+ -+ for (i = 0; i < lastBTsz; i++) -+ myBTFwBuffer[(BTPatchSize / 8) * 8 + i] = rtw_read8(Adapter, (0x144 + i)); -+ -+ -+ for (i = 0; i < BTPatchSize; i++) { -+ if (myBTFwBuffer[i] != pFirmware->szFwBuffer[i]) { -+ RTW_INFO(" In direct myBTFwBuffer[%d]=%x , pFirmware->szFwBuffer=%x\n", i, myBTFwBuffer[i], pFirmware->szFwBuffer[i]); -+ Adapter->mppriv.bTxBufCkFail = _TRUE; -+ break; -+ } -+ } -+ -+ if (myBTFwBuffer != NULL) -+ rtw_mfree(myBTFwBuffer, BTPatchSize); -+ -+ return _TRUE; -+} -+ -+/* As the size of bt firmware is more than 16k which is too big for some platforms, we divide it -+ * into four parts to transfer. The last parameter of _WriteBTFWtoTxPktBuf8723D is used to indicate -+ * the location of every part. We call the first 4096 byte of bt firmware as part 1, the second 4096 -+ * part as part 2, the third 4096 part as part 3, the remain as part 4. First we transform the part -+ * 4 and set the register 0x209 to 0x90, then the 32 bytes description are added to the head of part -+ * 4, and those bytes are putted at the location 0x90. Second we transform the part 3 and set the -+ * register 0x209 to 0x70. The 32 bytes description and part 3(4196 bytes) are putted at the location -+ * 0x70. It can contain 4196 bytes between 0x70 and 0x90. So the last 32 bytes os part 3 will cover the -+ * 32 bytes description of part4. Using this method, we can put the whole bt firmware to 0x30 and only -+ * has 32 bytes descrption at the head of part 1. -+*/ -+s32 FirmwareDownloadBT(PADAPTER padapter, PRT_MP_FIRMWARE pFirmware) -+{ -+ s32 rtStatus; -+ u8 *pBTFirmwareBuf; -+ u32 BTFirmwareLen; -+ u8 download_time; -+ s8 i; -+ -+ -+ rtStatus = _SUCCESS; -+ pBTFirmwareBuf = NULL; -+ BTFirmwareLen = 0; -+ -+#if 0 -+ /* */ -+ /* Patch BT Fw. Download BT RAM code to Tx packet buffer. */ -+ /* */ -+ if (padapter->bBTFWReady) { -+ RTW_INFO("%s: BT Firmware is ready!!\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+#ifdef CONFIG_FILE_FWIMG -+ if (rtw_is_file_readable(rtw_fw_mp_bt_file_path) == _TRUE) { -+ RTW_INFO("%s: acquire MP BT FW from file:%s\n", __FUNCTION__, rtw_fw_mp_bt_file_path); -+ -+ rtStatus = rtw_retrieve_from_file(rtw_fw_mp_bt_file_path, FwBuffer, FW_8723D_SIZE); -+ BTFirmwareLen = rtStatus >= 0 ? rtStatus : 0; -+ pBTFirmwareBuf = FwBuffer; -+ } else -+#endif /* CONFIG_FILE_FWIMG */ -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ RTW_INFO("%s: Download MP BT FW from header\n", __FUNCTION__); -+ -+ pBTFirmwareBuf = (u8 *)Rtl8723DFwBTImgArray; -+ BTFirmwareLen = Rtl8723DFwBTImgArrayLength; -+ pFirmware->szFwBuffer = pBTFirmwareBuf; -+ pFirmware->ulFwLength = BTFirmwareLen; -+#endif /* CONFIG_EMBEDDED_FWIMG */ -+ } -+ -+ RTW_INFO("%s: MP BT Firmware size=%d\n", __FUNCTION__, BTFirmwareLen); -+ -+ /* for h2c cam here should be set to true */ -+ padapter->bFWReady = _TRUE; -+ -+ download_time = (BTFirmwareLen + 4095) / 4096; -+ RTW_INFO("%s: download_time is %d\n", __FUNCTION__, download_time); -+ -+ /* Download BT patch Fw. */ -+ for (i = (download_time - 1); i >= 0; i--) { -+ if (i == (download_time - 1)) { -+ rtStatus = _WriteBTFWtoTxPktBuf8723D(padapter, pBTFirmwareBuf + (4096 * i), (BTFirmwareLen - (4096 * i)), 1); -+ RTW_INFO("%s: start %d, len %d, time 1\n", __FUNCTION__, 4096 * i, BTFirmwareLen - (4096 * i)); -+ } else { -+ rtStatus = _WriteBTFWtoTxPktBuf8723D(padapter, pBTFirmwareBuf + (4096 * i), 4096, (download_time - i)); -+ RTW_INFO("%s: start %d, len 4096, time %d\n", __FUNCTION__, 4096 * i, download_time - i); -+ } -+ -+ if (rtStatus != _SUCCESS) { -+ RTW_INFO("%s: BT Firmware download to Tx packet buffer fail!\n", __FUNCTION__); -+ padapter->bBTFWReady = _FALSE; -+ return rtStatus; -+ } -+ } -+ -+ ReservedPage_Compare(padapter, pFirmware, BTFirmwareLen); -+ -+ padapter->bBTFWReady = _TRUE; -+ SetFwBTFwPatchCmd(padapter, (u16)BTFirmwareLen); -+ rtStatus = _CheckWLANFwPatchBTFwReady(padapter); -+ -+ RTW_INFO("<===%s: return %s!\n", __FUNCTION__, rtStatus == _SUCCESS ? "SUCCESS" : "FAIL"); -+#endif -+ -+ return rtStatus; -+} -+#endif /* CONFIG_MP_INCLUDED */ -+ -+#if defined(CONFIG_SDIO_HCI) && defined (FW_DOWNLOAD_SIZE_8723D) -+u8 send_fw_packet(PADAPTER padapter, u8 *pRam_code, u32 length) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct xmit_buf xmit_buf_tmp; -+ struct submit_ctx sctx_tmp; -+ u8 *pTx_data_buffer = NULL; -+ u8 *pTmp_buffer = NULL; -+ u8 bRet = 0, value8 = 0, res = _FAIL; -+ u32 modify_ram_size = 0; -+ u32 tmp_size = 0, tmp_value = 0; -+ u32 i = 0, counter = 0; -+ u32 dwDataLength = 0, writeLength = 0; -+ -+ /* Due to SDIO can not send 32K packet */ -+ if (FW_DOWNLOAD_SIZE_8723D == length) -+ length--; -+ -+ modify_ram_size = length << 2; -+ -+ pTx_data_buffer = rtw_zmalloc(modify_ram_size); -+ -+ if (NULL == pTx_data_buffer) { -+ RTW_INFO("Allocate buffer fail!!\n"); -+ return _FALSE; -+ } -+ -+ _rtw_memset(pTx_data_buffer, 0, modify_ram_size); -+ -+ /* Transfer to new format */ -+ tmp_size = length >> 1; -+ for (i = 0; i <= tmp_size; i++) { -+ *(pTx_data_buffer + i * 8) = *(pRam_code + i * 2); -+ *(pTx_data_buffer + i * 8 + 1) = *(pRam_code + i * 2 + 1); -+ } -+ -+ /* Gen TX_DESC */ -+ _rtw_memset(pTx_data_buffer, 0, TXDESC_SIZE); -+ pTmp_buffer = pTx_data_buffer; -+ SET_TX_DESC_QUEUE_SEL_8723D(pTmp_buffer, QSLT_BEACON); -+ SET_TX_DESC_PKT_SIZE_8723D(pTmp_buffer, modify_ram_size - TXDESC_SIZE); -+ SET_TX_DESC_OFFSET_8723D(pTmp_buffer, TXDESC_SIZE); -+ -+ /* Send packet */ -+ xmit_buf_tmp.pdata = pTx_data_buffer; -+ xmit_buf_tmp.len = modify_ram_size; -+ rtw_sctx_init(&sctx_tmp, 10); -+ xmit_buf_tmp.sctx = &sctx_tmp; -+ -+ res = rtw_write_port(padapter, -+ pdvobjpriv->Queue2Pipe[BCN_QUEUE_INX], -+ xmit_buf_tmp.len, -+ (u8 *)&xmit_buf_tmp); -+ if (res == _FAIL) { -+ RTW_INFO("rtw_write_port fail\n"); -+ return _FAIL; -+ } -+ -+ /* check if DMA is OK */ -+ counter = 100; -+ do { -+ if (0 == counter) { -+ RTW_INFO("DMA time out!!\n"); -+ return _FALSE; -+ } -+ value8 = rtw_read8(padapter, REG_DWBCN0_CTRL_8723D + 2); -+ counter--; -+ } while (0 == (value8 & BIT(0))); -+ -+ rtw_write8(padapter, REG_DWBCN0_CTRL_8723D + 2, value8); -+ -+ /* Modify ram code by IO method */ -+ tmp_value = rtw_read8(padapter, REG_MCUFWDL + 1); -+ /* Disable DMA */ -+ rtw_write8(padapter, REG_MCUFWDL + 1, (u8)tmp_value & ~(BIT(5))); -+ tmp_value = (tmp_value >> 6) << 1; -+ /* Set page start address */ -+ rtw_write8(padapter, REG_MCUFWDL + 2, -+ (rtw_read8(padapter, REG_MCUFWDL + 2) & 0xF8) | tmp_value); -+ tmp_size = TXDESC_SIZE >> 2; /* 10bytes */ -+ -+ _BlockWrite(padapter, pRam_code, tmp_size); -+ -+ if (pTmp_buffer != NULL) -+ rtw_mfree((u8 *)pTmp_buffer, modify_ram_size); -+ -+ return _TRUE; -+} -+#endif /* CONFIG_SDIO_HCI */ -+ -+/* -+ * Description: -+ * Download 8192C firmware code. -+ * -+ * */ -+s32 rtl8723d_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw) -+{ -+ s32 rtStatus = _SUCCESS; -+ u8 write_fw = 0; -+ u32 fwdl_start_time; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ u8 *FwImage; -+ u32 FwImageLen; -+ u8 *pFwImageFileName; -+#ifdef CONFIG_WOWLAN -+ u8 *FwImageWoWLAN; -+ u32 FwImageWoWLANLen; -+#endif -+ u8 *pucMappedFile = NULL; -+ PRT_FIRMWARE_8723D pFirmware = NULL; -+ PRT_8723D_FIRMWARE_HDR pFwHdr = NULL; -+ u8 *pFirmwareBuf; -+ u32 FirmwareLen; -+#ifdef CONFIG_FILE_FWIMG -+ u8 *fwfilepath; -+#endif /* CONFIG_FILE_FWIMG */ -+ u8 value8; -+ u16 value16; -+ u32 value32; -+ u8 dma_iram_sel; -+ u16 new_chk_sum = 0; -+ u32 send_pkt_size, pkt_size_tmp; -+ u32 mem_offset; -+ u32 counter; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ -+ pFirmware = (PRT_FIRMWARE_8723D)rtw_zmalloc(sizeof(RT_FIRMWARE_8723D)); -+ -+ if (!pFirmware) { -+ rtStatus = _FAIL; -+ goto exit; -+ } -+ -+ { -+ u8 tmp_ps = 0, tmp_rf = 0; -+ -+ tmp_ps = rtw_read8(padapter, 0xa3); -+ tmp_ps &= 0xf8; -+ tmp_ps |= 0x02; -+ /* 1. write 0xA3[:2:0] = 3b'010 */ -+ rtw_write8(padapter, 0xa3, tmp_ps); -+ /* 2. read power_state = 0xA0[1:0] */ -+ tmp_ps = rtw_read8(padapter, 0xa0); -+ tmp_ps &= 0x03; -+ if (tmp_ps != 0x01) { -+ RTW_INFO(FUNC_ADPT_FMT" tmp_ps=%x\n", -+ FUNC_ADPT_ARG(padapter), tmp_ps); -+ pdbgpriv->dbg_downloadfw_pwr_state_cnt++; -+ } -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_PreLoadFirmware(padapter); -+#endif /* CONFIG_BT_COEXIST */ -+ -+#ifdef CONFIG_FILE_FWIMG -+#ifdef CONFIG_WOWLAN -+ if (bUsedWoWLANFw) -+ fwfilepath = rtw_fw_wow_file_path; -+ else -+#endif /* CONFIG_WOWLAN */ -+ { -+ fwfilepath = rtw_fw_file_path; -+ } -+#endif /* CONFIG_FILE_FWIMG */ -+ -+#ifdef CONFIG_FILE_FWIMG -+ if (rtw_is_file_readable(fwfilepath) == _TRUE) { -+ RTW_INFO("%s acquire FW from file:%s\n", __FUNCTION__, fwfilepath); -+ pFirmware->eFWSource = FW_SOURCE_IMG_FILE; -+ } else -+#endif /* CONFIG_FILE_FWIMG */ -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ pFirmware->eFWSource = FW_SOURCE_HEADER_FILE; -+#else /* !CONFIG_EMBEDDED_FWIMG */ -+ pFirmware->eFWSource = FW_SOURCE_IMG_FILE; /* We should decided by Reg. */ -+#endif /* !CONFIG_EMBEDDED_FWIMG */ -+ } -+ -+ switch (pFirmware->eFWSource) { -+ case FW_SOURCE_IMG_FILE: -+#ifdef CONFIG_FILE_FWIMG -+ rtStatus = rtw_retrieve_from_file(fwfilepath, FwBuffer, FW_8723D_SIZE); -+ pFirmware->ulFwLength = rtStatus >= 0 ? rtStatus : 0; -+ pFirmware->szFwBuffer = FwBuffer; -+#endif /* CONFIG_FILE_FWIMG */ -+ break; -+ -+ case FW_SOURCE_HEADER_FILE: -+ if (bUsedWoWLANFw) { -+#ifdef CONFIG_WOWLAN -+ if (pwrpriv->wowlan_mode) { -+ pFirmware->szFwBuffer = array_mp_8723d_fw_wowlan; -+ pFirmware->ulFwLength = array_length_mp_8723d_fw_wowlan; -+ RTW_INFO(" ===> %s fw: %s, size: %d\n", -+ __func__, "WoWLAN", pFirmware->ulFwLength); -+ } -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_AP_WOWLAN -+ if (pwrpriv->wowlan_ap_mode) { -+ pFirmware->szFwBuffer = array_mp_8723d_fw_ap; -+ pFirmware->ulFwLength = array_length_mp_8723d_fw_ap; -+ RTW_INFO(" ===> %s fw: %s, size: %d\n", -+ __func__, "AP_WoWLAN", pFirmware->ulFwLength); -+ } -+#endif /* CONFIG_AP_WOWLAN */ -+ } else { -+ pFirmware->szFwBuffer = array_mp_8723d_fw_nic; -+ pFirmware->ulFwLength = array_length_mp_8723d_fw_nic; -+ RTW_INFO("%s fw: %s, size: %d\n", __func__, "FW_NIC", pFirmware->ulFwLength); -+ } -+ break; -+ } -+ -+ if (pFirmware->ulFwLength > FW_8723D_SIZE) { -+ rtStatus = _FAIL; -+ RTW_ERR("Firmware size:%u exceed %u\n", -+ pFirmware->ulFwLength, FW_8723D_SIZE); -+ goto exit; -+ } -+ -+ pFirmwareBuf = pFirmware->szFwBuffer; -+ FirmwareLen = pFirmware->ulFwLength; -+ -+ /* To Check Fw header. Added by tynli. 2009.12.04. */ -+ pFwHdr = (PRT_8723D_FIRMWARE_HDR)pFirmwareBuf; -+ -+ pHalData->FirmwareVersion = le16_to_cpu(pFwHdr->Version); -+ pHalData->FirmwareSubVersion = le16_to_cpu(pFwHdr->Subversion); -+ pHalData->FirmwareSignature = le16_to_cpu(pFwHdr->Signature); -+ -+ RTW_INFO("%s: fw_ver=%x fw_subver=%04x sig=0x%x, Month=%02x, Date=%02x, Hour=%02x, Minute=%02x\n", -+ __func__, pHalData->FirmwareVersion, -+ pHalData->FirmwareSubVersion, pHalData->FirmwareSignature -+ , pFwHdr->Month, pFwHdr->Date, pFwHdr->Hour, pFwHdr->Minute); -+ -+ if (IS_FW_HEADER_EXIST_8723D(pFwHdr)) { -+ RTW_INFO("%s(): Shift for fw header!\n", __FUNCTION__); -+ /* Shift 32 bytes for FW header */ -+ pFirmwareBuf = pFirmwareBuf + 32; -+ FirmwareLen = FirmwareLen - 32; -+ } -+ -+ fwdl_start_time = rtw_get_current_time(); -+ -+ /* To check if FW already exists before download FW */ -+ if (rtw_read8(padapter, REG_MCUFWDL) & RAM_DL_SEL) { -+ RTW_INFO("%s: FW exists before download FW\n", __func__); -+ rtw_write8(padapter, REG_MCUFWDL, 0x00); -+ _8051Reset8723(padapter); -+ } -+ -+#ifndef CONFIG_DLFW_TXPKT -+ RTW_INFO("%s by IO write!\n", __func__); -+ -+ _FWDownloadEnable(padapter, _TRUE); -+ -+ while (!RTW_CANNOT_IO(padapter) && -+ (write_fw++ < DL_FW_MAX || -+ rtw_get_passing_time_ms(fwdl_start_time) < 500)) { -+ /* reset FWDL chksum */ -+ rtw_write8(padapter, REG_MCUFWDL, -+ rtw_read8(padapter, REG_MCUFWDL) | FWDL_ChkSum_rpt); -+ -+ rtStatus = _WriteFW(padapter, pFirmwareBuf, FirmwareLen); -+ if (rtStatus != _SUCCESS) -+ continue; -+ -+ rtStatus = polling_fwdl_chksum(padapter, 2, 10); -+ if (rtStatus == _SUCCESS) { -+ RTW_INFO("%s: download FW count:%d\n", __func__, -+ write_fw); -+ break; -+ } else { -+ rtw_mdelay_os(10); -+ } -+ } -+#else -+ RTW_INFO("%s by Tx pkt write!\n", __func__); -+ -+ if ((rtw_read8(padapter, REG_MCUFWDL) & MCUFWDL_RDY) == 0) { -+ /* -+ * SDIO DMA condition: -+ * all queue must be 256 (0x100 = 0x20 + 0xE0) -+ */ -+ -+ value32 = 0x802000E0; -+ rtw_write32(padapter, REG_RQPN, value32); -+ -+ /* Set beacon boundary to TXFIFO header */ -+ rtw_write8(padapter, REG_BCNQ_BDNY, 0); -+ rtw_write16(padapter, REG_DWBCN0_CTRL_8723D + 1, BIT(8)); -+ -+ /* SDIO need read this register before send packet */ -+ rtw_read32(padapter, 0x10250020); -+ -+ _FWDownloadEnable(padapter, _TRUE); -+ -+ /* Get original check sum */ -+ new_chk_sum = *(pFirmwareBuf + FirmwareLen - 2) | -+ ((u16)*(pFirmwareBuf + FirmwareLen - 1) << 8); -+ -+ /* Send ram code flow */ -+ dma_iram_sel = 0; -+ mem_offset = 0; -+ pkt_size_tmp = FirmwareLen; -+ while (0 != pkt_size_tmp) { -+ if (pkt_size_tmp >= FW_DOWNLOAD_SIZE_8723D) { -+ send_pkt_size = FW_DOWNLOAD_SIZE_8723D; -+ /* Modify check sum value */ -+ new_chk_sum = (u16)(new_chk_sum ^ (((send_pkt_size - 1) << 2) - TXDESC_SIZE)); -+ } else { -+ send_pkt_size = pkt_size_tmp; -+ new_chk_sum = (u16)(new_chk_sum ^ ((send_pkt_size << 2) - TXDESC_SIZE)); -+ -+ } -+ -+ if (send_pkt_size == pkt_size_tmp) { -+ /* last partition packet, write new check sum to ram code file */ -+ *(pFirmwareBuf + FirmwareLen - 2) = new_chk_sum & 0xFF; -+ *(pFirmwareBuf + FirmwareLen - 1) = (new_chk_sum & 0xFF00) >> 8; -+ } -+ -+ /* IRAM select */ -+ rtw_write8(padapter, REG_MCUFWDL + 1, -+ (rtw_read8(padapter, REG_MCUFWDL + 1) & 0x3F) | (dma_iram_sel << 6)); -+ /* Enable DMA */ -+ rtw_write8(padapter, REG_MCUFWDL + 1, -+ rtw_read8(padapter, REG_MCUFWDL + 1) | BIT(5)); -+ -+ if (_FALSE == send_fw_packet(padapter, pFirmwareBuf + mem_offset, send_pkt_size)) { -+ RTW_INFO("%s: Send FW fail !\n", __FUNCTION__); -+ rtStatus = _FAIL; -+ goto DLFW_FAIL; -+ } -+ -+ dma_iram_sel++; -+ mem_offset += send_pkt_size; -+ pkt_size_tmp -= send_pkt_size; -+ } -+ } else { -+ RTW_INFO("%s: Download FW fail since MCUFWDL_RDY is not set!\n", __FUNCTION__); -+ rtStatus = _FAIL; -+ goto DLFW_FAIL; -+ } -+#endif -+ -+ _FWDownloadEnable(padapter, _FALSE); -+ -+ if (rtStatus == _SUCCESS) -+ rtStatus = _FWFreeToGo(padapter, 10, 200); -+ else -+ goto DLFW_FAIL; -+ -+ if (_SUCCESS != rtStatus) -+ goto DLFW_FAIL; -+ -+DLFW_FAIL: -+ if (rtStatus == _FAIL) { -+ /* Disable FWDL_EN */ -+ value8 = rtw_read8(padapter, REG_MCUFWDL); -+ value8 = (value8 & ~(BIT(0)) & ~(BIT(1))); -+ rtw_write8(padapter, REG_MCUFWDL, value8); -+ } -+ -+ RTW_INFO("%s %s. write_fw:%u, %dms\n" -+ , __FUNCTION__, (rtStatus == _SUCCESS) ? "success" : "fail" -+ , write_fw -+ , rtw_get_passing_time_ms(fwdl_start_time) -+ ); -+ -+exit: -+ if (pFirmware) -+ rtw_mfree((u8 *)pFirmware, sizeof(RT_FIRMWARE_8723D)); -+ -+ rtl8723d_InitializeFirmwareVars(padapter); -+ -+ RTW_INFO(" <=== %s()\n", __FUNCTION__); -+ -+ return rtStatus; -+} -+ -+void rtl8723d_InitializeFirmwareVars(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ /* Init Fw LPS related. */ -+ adapter_to_pwrctl(padapter)->bFwCurrentInPSMode = _FALSE; -+ -+ /* Init H2C cmd. */ -+ rtw_write8(padapter, REG_HMETFR, 0x0f); -+ -+ /* Init H2C counter. by tynli. 2009.12.09. */ -+ pHalData->LastHMEBoxNum = 0; -+ /* pHalData->H2CQueueHead = 0; -+ * pHalData->H2CQueueTail = 0; -+ * pHalData->H2CStopInsertQueue = _FALSE; */ -+} -+ -+/* *********************************************************** -+ * Efuse related code -+ * *********************************************************** */ -+static u8 -+hal_EfuseSwitchToBank( -+ PADAPTER padapter, -+ u8 bank, -+ u8 bPseudoTest) -+{ -+ u8 bRet = _FALSE; -+ u32 value32 = 0; -+#ifdef HAL_EFUSE_MEMORY -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+#endif -+ -+ -+ RTW_INFO("%s: Efuse switch bank to %d\n", __FUNCTION__, bank); -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ pEfuseHal->fakeEfuseBank = bank; -+#else -+ fakeEfuseBank = bank; -+#endif -+ bRet = _TRUE; -+ } else { -+ value32 = rtw_read32(padapter, EFUSE_TEST); -+ bRet = _TRUE; -+ switch (bank) { -+ case 0: -+ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_WIFI_SEL_0); -+ break; -+ case 1: -+ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_BT_SEL_0); -+ break; -+ case 2: -+ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_BT_SEL_1); -+ break; -+ case 3: -+ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_BT_SEL_2); -+ break; -+ default: -+ value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_WIFI_SEL_0); -+ bRet = _FALSE; -+ break; -+ } -+ rtw_write32(padapter, EFUSE_TEST, value32); -+ } -+ -+ return bRet; -+} -+ -+static void -+Hal_GetEfuseDefinition( -+ PADAPTER padapter, -+ u8 efuseType, -+ u8 type, -+ void *pOut, -+ u8 bPseudoTest) -+{ -+ switch (type) { -+ case TYPE_EFUSE_MAX_SECTION: { -+ u8 *pMax_section; -+ -+ pMax_section = (u8 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pMax_section = EFUSE_MAX_SECTION_8723D; -+ else -+ *pMax_section = EFUSE_BT_MAX_SECTION; -+ } -+ break; -+ -+ case TYPE_EFUSE_REAL_CONTENT_LEN: { -+ u16 *pu2Tmp; -+ -+ pu2Tmp = (u16 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pu2Tmp = EFUSE_REAL_CONTENT_LEN_8723D; -+ else -+ *pu2Tmp = EFUSE_BT_REAL_CONTENT_LEN; -+ } -+ break; -+ -+ case TYPE_AVAILABLE_EFUSE_BYTES_BANK: { -+ u16 *pu2Tmp; -+ -+ pu2Tmp = (u16 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pu2Tmp = (EFUSE_REAL_CONTENT_LEN_8723D - EFUSE_OOB_PROTECT_BYTES); -+ else -+ *pu2Tmp = (EFUSE_BT_REAL_BANK_CONTENT_LEN - EFUSE_PROTECT_BYTES_BANK); -+ } -+ break; -+ -+ case TYPE_AVAILABLE_EFUSE_BYTES_TOTAL: { -+ u16 *pu2Tmp; -+ -+ pu2Tmp = (u16 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pu2Tmp = (EFUSE_REAL_CONTENT_LEN_8723D - EFUSE_OOB_PROTECT_BYTES); -+ else -+ *pu2Tmp = (EFUSE_BT_REAL_CONTENT_LEN - (EFUSE_PROTECT_BYTES_BANK * 3)); -+ } -+ break; -+ -+ case TYPE_EFUSE_MAP_LEN: { -+ u16 *pu2Tmp; -+ -+ pu2Tmp = (u16 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pu2Tmp = EFUSE_MAP_LEN_8723D; -+ else -+ *pu2Tmp = EFUSE_BT_MAP_LEN; -+ } -+ break; -+ -+ case TYPE_EFUSE_PROTECT_BYTES_BANK: { -+ u8 *pu1Tmp; -+ -+ pu1Tmp = (u8 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pu1Tmp = EFUSE_OOB_PROTECT_BYTES; -+ else -+ *pu1Tmp = EFUSE_PROTECT_BYTES_BANK; -+ } -+ break; -+ -+ case TYPE_EFUSE_CONTENT_LEN_BANK: { -+ u16 *pu2Tmp; -+ -+ pu2Tmp = (u16 *)pOut; -+ -+ if (efuseType == EFUSE_WIFI) -+ *pu2Tmp = EFUSE_REAL_CONTENT_LEN_8723D; -+ else -+ *pu2Tmp = EFUSE_BT_REAL_BANK_CONTENT_LEN; -+ } -+ break; -+ -+ default: { -+ u8 *pu1Tmp; -+ -+ pu1Tmp = (u8 *)pOut; -+ *pu1Tmp = 0; -+ } -+ break; -+ } -+} -+ -+#define VOLTAGE_V25 0x03 -+#define LDOE25_SHIFT 28 -+ -+/* ***************************************************************** -+ * The following is for compile ok -+ * That should be merged with the original in the future -+ * ***************************************************************** */ -+#define EFUSE_ACCESS_ON_8723 0x69 /* For RTL8723 only. */ -+#define EFUSE_ACCESS_OFF_8723 0x00 /* For RTL8723 only. */ -+#define REG_EFUSE_ACCESS_8723 0x00CF /* Efuse access protection for RTL8723 */ -+ -+/* ***************************************************************** */ -+static void Hal_BT_EfusePowerSwitch( -+ PADAPTER padapter, -+ u8 bWrite, -+ u8 PwrState) -+{ -+ u8 tempval; -+ -+ if (PwrState == _TRUE) { -+ /* enable BT power cut */ -+ /* 0x6A[14] = 1 */ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval |= BIT(6); -+ rtw_write8(padapter, 0x6B, tempval); -+ -+ /* Attention!! Between 0x6A[14] and 0x6A[15] setting need 100us delay */ -+ /* So don't write 0x6A[14]=1 and 0x6A[15]=0 together! */ -+ rtw_usleep_os(100); -+ /* disable BT output isolation */ -+ /* 0x6A[15] = 0 */ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval &= ~BIT(7); -+ rtw_write8(padapter, 0x6B, tempval); -+ } else { -+ /* enable BT output isolation */ -+ /* 0x6A[15] = 1 */ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval |= BIT(7); -+ rtw_write8(padapter, 0x6B, tempval); -+ -+ /* Attention!! Between 0x6A[14] and 0x6A[15] setting need 100us delay */ -+ /* So don't write 0x6A[14]=1 and 0x6A[15]=0 together! */ -+ -+ /* disable BT power cut */ -+ /* 0x6A[14] = 1 */ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval &= ~BIT(6); -+ rtw_write8(padapter, 0x6B, tempval); -+ } -+ -+} -+static void -+Hal_EfusePowerSwitch( -+ PADAPTER padapter, -+ u8 bWrite, -+ u8 PwrState) -+{ -+ u8 tempval; -+ u16 tmpV16; -+ -+ -+ if (PwrState == _TRUE) { -+#ifdef CONFIG_SDIO_HCI -+ /* To avoid cannot access efuse regsiters after disable/enable several times during DTM test. */ -+ /* Suggested by SD1 IsaacHsu. 2013.07.08, added by tynli. */ -+ tempval = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HSUS_CTRL); -+ if (tempval & BIT(0)) { /* SDIO local register is suspend */ -+ u8 count = 0; -+ -+ -+ tempval &= ~BIT(0); -+ rtw_write8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HSUS_CTRL, tempval); -+ -+ /* check 0x86[1:0]=10'2h, wait power state to leave suspend */ -+ do { -+ tempval = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HSUS_CTRL); -+ tempval &= 0x3; -+ if (tempval == 0x02) -+ break; -+ -+ count++; -+ if (count >= 100) -+ break; -+ -+ rtw_mdelay_os(10); -+ } while (1); -+ -+ if (count >= 100) { -+ RTW_INFO(FUNC_ADPT_FMT ": Leave SDIO local register suspend fail! Local 0x86=%#X\n", -+ FUNC_ADPT_ARG(padapter), tempval); -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT ": Leave SDIO local register suspend OK! Local 0x86=%#X\n", -+ FUNC_ADPT_ARG(padapter), tempval); -+ } -+ } -+#endif /* CONFIG_SDIO_HCI */ -+ -+ rtw_write8(padapter, REG_EFUSE_ACCESS_8723, EFUSE_ACCESS_ON_8723); -+ -+ /* Reset: 0x0000h[28], default valid */ -+ tmpV16 = rtw_read16(padapter, REG_SYS_FUNC_EN); -+ if (!(tmpV16 & FEN_ELDR)) { -+ tmpV16 |= FEN_ELDR; -+ rtw_write16(padapter, REG_SYS_FUNC_EN, tmpV16); -+ } -+ -+ /* Clock: Gated(0x0008h[5]) 8M(0x0008h[1]) clock from ANA, default valid */ -+ tmpV16 = rtw_read16(padapter, REG_SYS_CLKR); -+ if ((!(tmpV16 & LOADER_CLK_EN)) || (!(tmpV16 & ANA8M))) { -+ tmpV16 |= (LOADER_CLK_EN | ANA8M); -+ rtw_write16(padapter, REG_SYS_CLKR, tmpV16); -+ } -+ -+ if (bWrite == _TRUE) { -+ /* Enable LDO 2.5V before read/write action */ -+ tempval = rtw_read8(padapter, EFUSE_TEST + 3); -+ tempval &= 0x0F; -+ tempval |= (VOLTAGE_V25 << 4); -+ rtw_write8(padapter, EFUSE_TEST + 3, (tempval | 0x80)); -+ -+ /* rtw_write8(padapter, REG_EFUSE_ACCESS, EFUSE_ACCESS_ON); */ -+ } -+ } else { -+ rtw_write8(padapter, REG_EFUSE_ACCESS, EFUSE_ACCESS_OFF); -+ -+ if (bWrite == _TRUE) { -+ /* Disable LDO 2.5V after read/write action */ -+ tempval = rtw_read8(padapter, EFUSE_TEST + 3); -+ rtw_write8(padapter, EFUSE_TEST + 3, (tempval & 0x7F)); -+ } -+ -+ } -+} -+ -+static void -+hal_ReadEFuse_WiFi( -+ PADAPTER padapter, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ u8 bPseudoTest) -+{ -+#ifdef HAL_EFUSE_MEMORY -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+#endif -+ u8 *efuseTbl = NULL; -+ u16 eFuse_Addr = 0; -+ u8 offset, wden; -+ u8 efuseHeader, efuseExtHdr, efuseData; -+ u16 i, total, used; -+ u8 efuse_usage = 0; -+ -+ /* RTW_INFO("YJ: ====>%s():_offset=%d _size_byte=%d bPseudoTest=%d\n", __func__, _offset, _size_byte, bPseudoTest); */ -+ /* */ -+ /* Do NOT excess total size of EFuse table. Added by Roger, 2008.11.10. */ -+ /* */ -+ if ((_offset + _size_byte) > EFUSE_MAX_MAP_LEN) { -+ RTW_INFO("%s: Invalid offset(%#x) with read bytes(%#x)!!\n", __FUNCTION__, _offset, _size_byte); -+ return; -+ } -+ -+ efuseTbl = (u8 *)rtw_malloc(EFUSE_MAX_MAP_LEN); -+ if (efuseTbl == NULL) { -+ RTW_INFO("%s: alloc efuseTbl fail!\n", __FUNCTION__); -+ return; -+ } -+ /* 0xff will be efuse default value instead of 0x00. */ -+ _rtw_memset(efuseTbl, 0xFF, EFUSE_MAX_MAP_LEN); -+ -+ -+#ifdef CONFIG_DEBUG -+ if (0) { -+ for (i = 0; i < 256; i++) -+ /* ReadEFuseByte(padapter, i, &efuseTbl[i], _FALSE); */ -+ efuse_OneByteRead(padapter, i, &efuseTbl[i], _FALSE); -+ RTW_INFO("Efuse Content:\n"); -+ for (i = 0; i < 256; i++) { -+ if (i % 16 == 0) -+ printk(KERN_ERR"\n"); -+ printk(KERN_ERR"%02X ", efuseTbl[i]); -+ } -+ printk(KERN_ERR"\n"); -+ } -+#endif -+ -+ -+ /* switch bank back to bank 0 for later BT and wifi use. */ -+ hal_EfuseSwitchToBank(padapter, 0, bPseudoTest); -+ -+ while (AVAILABLE_EFUSE_ADDR(eFuse_Addr)) { -+ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); */ -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); -+ if (efuseHeader == 0xFF) { -+ RTW_INFO("%s: data end at address=%#x\n", __FUNCTION__, eFuse_Addr - 1); -+ break; -+ } -+ /* RTW_INFO("%s: efuse[0x%X]=0x%02X\n", __FUNCTION__, eFuse_Addr-1, efuseHeader); */ -+ -+ /* Check PG header for section num. */ -+ if (EXT_HEADER(efuseHeader)) { /* extended header */ -+ offset = GET_HDR_OFFSET_2_0(efuseHeader); -+ /* RTW_INFO("%s: extended header offset=0x%X\n", __FUNCTION__, offset); */ -+ -+ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); */ -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); -+ /* RTW_INFO("%s: efuse[0x%X]=0x%02X\n", __FUNCTION__, eFuse_Addr-1, efuseExtHdr); */ -+ if (ALL_WORDS_DISABLED(efuseExtHdr)) -+ continue; -+ -+ offset |= ((efuseExtHdr & 0xF0) >> 1); -+ wden = (efuseExtHdr & 0x0F); -+ } else { -+ offset = ((efuseHeader >> 4) & 0x0f); -+ wden = (efuseHeader & 0x0f); -+ } -+ /* RTW_INFO("%s: Offset=%d Worden=0x%X\n", __FUNCTION__, offset, wden); */ -+ -+ if (offset < EFUSE_MAX_SECTION_8723D) { -+ u16 addr; -+ /* Get word enable value from PG header -+ * RTW_INFO("%s: Offset=%d Worden=0x%X\n", __FUNCTION__, offset, wden); */ -+ -+ addr = offset * PGPKT_DATA_SIZE; -+ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { -+ /* Check word enable condition in the section */ -+ if (!(wden & (0x01 << i))) { -+ efuseData = 0; -+ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseData, bPseudoTest); */ -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseData, bPseudoTest); -+ /* RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, eFuse_Addr-1, efuseData); */ -+ efuseTbl[addr] = efuseData; -+ -+ efuseData = 0; -+ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseData, bPseudoTest); */ -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseData, bPseudoTest); -+ /* RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, eFuse_Addr-1, efuseData); */ -+ efuseTbl[addr + 1] = efuseData; -+ } -+ addr += 2; -+ } -+ } else { -+ RTW_INFO(KERN_ERR "%s: offset(%d) is illegal!!\n", __FUNCTION__, offset); -+ eFuse_Addr += Efuse_CalculateWordCnts(wden) * 2; -+ } -+ } -+ -+ /* Copy from Efuse map to output pointer memory!!! */ -+ for (i = 0; i < _size_byte; i++) -+ pbuf[i] = efuseTbl[_offset + i]; -+ -+ /* Calculate Efuse utilization */ -+ total = 0; -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &total, bPseudoTest); -+ used = eFuse_Addr - 1; -+ if (total) -+ efuse_usage = (u8)((used * 100) / total); -+ else -+ efuse_usage = 100; -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ pEfuseHal->fakeEfuseUsedBytes = used; -+#else -+ fakeEfuseUsedBytes = used; -+#endif -+ } else { -+ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&used); -+ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_USAGE, (u8 *)&efuse_usage); -+ } -+ -+ if (efuseTbl) -+ rtw_mfree(efuseTbl, EFUSE_MAX_MAP_LEN); -+} -+ -+static VOID -+hal_ReadEFuse_BT( -+ PADAPTER padapter, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ u8 bPseudoTest -+) -+{ -+#ifdef HAL_EFUSE_MEMORY -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+#endif -+ u8 *efuseTbl; -+ u8 bank; -+ u16 eFuse_Addr; -+ u8 efuseHeader, efuseExtHdr, efuseData; -+ u8 offset, wden; -+ u16 i, total, used; -+ u8 efuse_usage; -+ -+ -+ /* */ -+ /* Do NOT excess total size of EFuse table. Added by Roger, 2008.11.10. */ -+ /* */ -+ if ((_offset + _size_byte) > EFUSE_BT_MAP_LEN) { -+ RTW_INFO("%s: Invalid offset(%#x) with read bytes(%#x)!!\n", __FUNCTION__, _offset, _size_byte); -+ return; -+ } -+ -+ efuseTbl = rtw_malloc(EFUSE_BT_MAP_LEN); -+ if (efuseTbl == NULL) { -+ RTW_INFO("%s: efuseTbl malloc fail!\n", __FUNCTION__); -+ return; -+ } -+ /* 0xff will be efuse default value instead of 0x00. */ -+ _rtw_memset(efuseTbl, 0xFF, EFUSE_BT_MAP_LEN); -+ -+ total = 0; -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_BANK, &total, bPseudoTest); -+ -+ for (bank = 1; bank < 3; bank++) { /* 8723d Max bake 0~2 */ -+ if (hal_EfuseSwitchToBank(padapter, bank, bPseudoTest) == _FALSE) { -+ RTW_INFO("%s: hal_EfuseSwitchToBank Fail!!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ eFuse_Addr = 0; -+ -+ while (AVAILABLE_EFUSE_ADDR(eFuse_Addr)) { -+ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); */ -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); -+ if (efuseHeader == 0xFF) -+ break; -+ RTW_INFO("%s: efuse[%#X]=0x%02x (header)\n", __FUNCTION__, (((bank - 1) * EFUSE_REAL_CONTENT_LEN_8723D) + eFuse_Addr - 1), efuseHeader); -+ -+ /* Check PG header for section num. */ -+ if (EXT_HEADER(efuseHeader)) { /* extended header */ -+ offset = GET_HDR_OFFSET_2_0(efuseHeader); -+ RTW_INFO("%s: extended header offset_2_0=0x%X\n", __FUNCTION__, offset); -+ -+ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); */ -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); -+ RTW_INFO("%s: efuse[%#X]=0x%02x (ext header)\n", __FUNCTION__, (((bank - 1) * EFUSE_REAL_CONTENT_LEN_8723D) + eFuse_Addr - 1), efuseExtHdr); -+ if (ALL_WORDS_DISABLED(efuseExtHdr)) -+ continue; -+ -+ offset |= ((efuseExtHdr & 0xF0) >> 1); -+ wden = (efuseExtHdr & 0x0F); -+ } else { -+ offset = ((efuseHeader >> 4) & 0x0f); -+ wden = (efuseHeader & 0x0f); -+ } -+ -+ if (offset < EFUSE_BT_MAX_SECTION) { -+ u16 addr; -+ -+ /* Get word enable value from PG header */ -+ RTW_INFO("%s: Offset=%d Worden=%#X\n", __FUNCTION__, offset, wden); -+ -+ addr = offset * PGPKT_DATA_SIZE; -+ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { -+ /* Check word enable condition in the section */ -+ if (!(wden & (0x01 << i))) { -+ efuseData = 0; -+ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseData, bPseudoTest); */ -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseData, bPseudoTest); -+ RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, eFuse_Addr - 1, efuseData); -+ efuseTbl[addr] = efuseData; -+ -+ efuseData = 0; -+ /* ReadEFuseByte(padapter, eFuse_Addr++, &efuseData, bPseudoTest); */ -+ efuse_OneByteRead(padapter, eFuse_Addr++, &efuseData, bPseudoTest); -+ RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, eFuse_Addr - 1, efuseData); -+ efuseTbl[addr + 1] = efuseData; -+ } -+ addr += 2; -+ } -+ } else { -+ RTW_INFO("%s: offset(%d) is illegal!!\n", __FUNCTION__, offset); -+ eFuse_Addr += Efuse_CalculateWordCnts(wden) * 2; -+ } -+ } -+ -+ if ((eFuse_Addr - 1) < total) { -+ RTW_INFO("%s: bank(%d) data end at %#x\n", __FUNCTION__, bank, eFuse_Addr - 1); -+ break; -+ } -+ } -+ -+ /* switch bank back to bank 0 for later BT and wifi use. */ -+ hal_EfuseSwitchToBank(padapter, 0, bPseudoTest); -+ -+ /* Copy from Efuse map to output pointer memory!!! */ -+ for (i = 0; i < _size_byte; i++) -+ pbuf[i] = efuseTbl[_offset + i]; -+ -+ /* */ -+ /* Calculate Efuse utilization. */ -+ /* */ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &total, bPseudoTest); -+ used = (EFUSE_BT_REAL_BANK_CONTENT_LEN * (bank - 1)) + eFuse_Addr - 1; -+ RTW_INFO("%s: bank(%d) data end at %#x ,used =%d\n", __FUNCTION__, bank, eFuse_Addr - 1, used); -+ efuse_usage = (u8)((used * 100) / total); -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ pEfuseHal->fakeBTEfuseUsedBytes = used; -+#else -+ fakeBTEfuseUsedBytes = used; -+#endif -+ } else { -+ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BT_BYTES, (u8 *)&used); -+ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BT_USAGE, (u8 *)&efuse_usage); -+ } -+ -+exit: -+ if (efuseTbl) -+ rtw_mfree(efuseTbl, EFUSE_BT_MAP_LEN); -+} -+ -+static void -+Hal_ReadEFuse( -+ PADAPTER padapter, -+ u8 efuseType, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ u8 bPseudoTest) -+{ -+ if (efuseType == EFUSE_WIFI) -+ hal_ReadEFuse_WiFi(padapter, _offset, _size_byte, pbuf, bPseudoTest); -+ else -+ hal_ReadEFuse_BT(padapter, _offset, _size_byte, pbuf, bPseudoTest); -+} -+ -+static u16 -+hal_EfuseGetCurrentSize_WiFi( -+ PADAPTER padapter, -+ u8 bPseudoTest) -+{ -+#ifdef HAL_EFUSE_MEMORY -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+#endif -+ u16 efuse_addr = 0; -+ u16 start_addr = 0; /* for debug */ -+ u8 hoffset = 0, hworden = 0; -+ u8 efuse_data, word_cnts = 0; -+ u32 count = 0; /* for debug */ -+ -+ -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ efuse_addr = (u16)pEfuseHal->fakeEfuseUsedBytes; -+#else -+ efuse_addr = (u16)fakeEfuseUsedBytes; -+#endif -+ } else -+ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&efuse_addr); -+ start_addr = efuse_addr; -+ RTW_INFO("%s: start_efuse_addr=0x%X\n", __FUNCTION__, efuse_addr); -+ -+ /* switch bank back to bank 0 for later BT and wifi use. */ -+ hal_EfuseSwitchToBank(padapter, 0, bPseudoTest); -+ -+#if 0 /* for debug test */ -+ efuse_OneByteRead(padapter, 0x1FF, &efuse_data, bPseudoTest); -+ RTW_INFO(FUNC_ADPT_FMT ": efuse raw 0x1FF=0x%02X\n", -+ FUNC_ADPT_ARG(padapter), efuse_data); -+ efuse_data = 0xFF; -+#endif /* for debug test */ -+ -+ count = 0; -+ while (AVAILABLE_EFUSE_ADDR(efuse_addr)) { -+#if 1 -+ if (efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest) == _FALSE) { -+ RTW_INFO(KERN_ERR "%s: efuse_OneByteRead Fail! addr=0x%X !!\n", __FUNCTION__, efuse_addr); -+ goto error; -+ } -+#else -+ ReadEFuseByte(padapter, efuse_addr, &efuse_data, bPseudoTest); -+#endif -+ -+ if (efuse_data == 0xFF) -+ break; -+ -+ if ((start_addr != 0) && (efuse_addr == start_addr)) { -+ count++; -+ RTW_INFO(FUNC_ADPT_FMT ": [WARNING] efuse raw 0x%X=0x%02X not 0xFF!!(%d times)\n", -+ FUNC_ADPT_ARG(padapter), efuse_addr, efuse_data, count); -+ -+ efuse_data = 0xFF; -+ if (count < 4) { -+ /* try again! */ -+ -+ if (count > 2) { -+ /* try again form address 0 */ -+ efuse_addr = 0; -+ start_addr = 0; -+ } -+ -+ continue; -+ } -+ -+ goto error; -+ } -+ -+ if (EXT_HEADER(efuse_data)) { -+ hoffset = GET_HDR_OFFSET_2_0(efuse_data); -+ efuse_addr++; -+ efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest); -+ if (ALL_WORDS_DISABLED(efuse_data)) -+ continue; -+ -+ hoffset |= ((efuse_data & 0xF0) >> 1); -+ hworden = efuse_data & 0x0F; -+ } else { -+ hoffset = (efuse_data >> 4) & 0x0F; -+ hworden = efuse_data & 0x0F; -+ } -+ -+ word_cnts = Efuse_CalculateWordCnts(hworden); -+ efuse_addr += (word_cnts * 2) + 1; -+ } -+ -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ pEfuseHal->fakeEfuseUsedBytes = efuse_addr; -+#else -+ fakeEfuseUsedBytes = efuse_addr; -+#endif -+ } else -+ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&efuse_addr); -+ -+ goto exit; -+ -+error: -+ /* report max size to prevent write efuse */ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &efuse_addr, bPseudoTest); -+ -+exit: -+ RTW_INFO("%s: CurrentSize=%d\n", __FUNCTION__, efuse_addr); -+ -+ return efuse_addr; -+} -+ -+static u16 -+hal_EfuseGetCurrentSize_BT( -+ PADAPTER padapter, -+ u8 bPseudoTest) -+{ -+#ifdef HAL_EFUSE_MEMORY -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+#endif -+ u16 btusedbytes; -+ u16 efuse_addr; -+ u8 bank, startBank; -+ u8 hoffset = 0, hworden = 0; -+ u8 efuse_data, word_cnts = 0; -+ u16 retU2 = 0; -+ u8 bContinual = _TRUE; -+ -+ -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ btusedbytes = pEfuseHal->fakeBTEfuseUsedBytes; -+#else -+ btusedbytes = fakeBTEfuseUsedBytes; -+#endif -+ } else { -+ btusedbytes = 0; -+ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BT_BYTES, (u8 *)&btusedbytes); -+ } -+ efuse_addr = (u16)((btusedbytes % EFUSE_BT_REAL_BANK_CONTENT_LEN)); -+ startBank = (u8)(1 + (btusedbytes / EFUSE_BT_REAL_BANK_CONTENT_LEN)); -+ -+ RTW_INFO("%s: start from bank=%d addr=0x%X\n", __FUNCTION__, startBank, efuse_addr); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_BANK, &retU2, bPseudoTest); -+ -+ for (bank = startBank; bank < 3; bank++) { -+ if (hal_EfuseSwitchToBank(padapter, bank, bPseudoTest) == _FALSE) { -+ RTW_INFO(KERN_ERR "%s: switch bank(%d) Fail!!\n", __FUNCTION__, bank); -+ /* bank = EFUSE_MAX_BANK; */ -+ break; -+ } -+ -+ /* only when bank is switched we have to reset the efuse_addr. */ -+ if (bank != startBank) -+ efuse_addr = 0; -+#if 1 -+ -+ while (AVAILABLE_EFUSE_ADDR(efuse_addr)) { -+ if (efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest) == _FALSE) { -+ RTW_INFO(KERN_ERR "%s: efuse_OneByteRead Fail! addr=0x%X !!\n", __FUNCTION__, efuse_addr); -+ /* bank = EFUSE_MAX_BANK; */ -+ break; -+ } -+ RTW_INFO("%s: efuse_OneByteRead ! addr=0x%X !efuse_data=0x%X! bank =%d\n", __FUNCTION__, efuse_addr, efuse_data, bank); -+ -+ if (efuse_data == 0xFF) -+ break; -+ -+ if (EXT_HEADER(efuse_data)) { -+ hoffset = GET_HDR_OFFSET_2_0(efuse_data); -+ efuse_addr++; -+ efuse_OneByteRead(padapter, efuse_addr, &efuse_data, bPseudoTest); -+ RTW_INFO("%s: efuse_OneByteRead EXT_HEADER ! addr=0x%X !efuse_data=0x%X! bank =%d\n", __FUNCTION__, efuse_addr, efuse_data, bank); -+ -+ if (ALL_WORDS_DISABLED(efuse_data)) { -+ efuse_addr++; -+ continue; -+ } -+ -+ /* hoffset = ((hoffset & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); */ -+ hoffset |= ((efuse_data & 0xF0) >> 1); -+ hworden = efuse_data & 0x0F; -+ } else { -+ hoffset = (efuse_data >> 4) & 0x0F; -+ hworden = efuse_data & 0x0F; -+ } -+ -+ RTW_INFO(FUNC_ADPT_FMT": Offset=%d Worden=%#X\n", -+ FUNC_ADPT_ARG(padapter), hoffset, hworden); -+ -+ word_cnts = Efuse_CalculateWordCnts(hworden); -+ /* read next header */ -+ efuse_addr += (word_cnts * 2) + 1; -+ } -+#else -+ while (bContinual && -+ efuse_OneByteRead(padapter, efuse_addr , &efuse_data, bPseudoTest) && -+ AVAILABLE_EFUSE_ADDR(efuse_addr)) { -+ if (efuse_data != 0xFF) { -+ if ((efuse_data & 0x1F) == 0x0F) { /* extended header */ -+ hoffset = efuse_data; -+ efuse_addr++; -+ efuse_OneByteRead(padapter, efuse_addr , &efuse_data, bPseudoTest); -+ if ((efuse_data & 0x0F) == 0x0F) { -+ efuse_addr++; -+ continue; -+ } else { -+ hoffset = ((hoffset & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); -+ hworden = efuse_data & 0x0F; -+ } -+ } else { -+ hoffset = (efuse_data >> 4) & 0x0F; -+ hworden = efuse_data & 0x0F; -+ } -+ word_cnts = Efuse_CalculateWordCnts(hworden); -+ /* read next header */ -+ efuse_addr = efuse_addr + (word_cnts * 2) + 1; -+ } else -+ bContinual = _FALSE; -+ } -+#endif -+ -+ -+ /* Check if we need to check next bank efuse */ -+ if (efuse_addr < retU2) -+ break;/* don't need to check next bank. */ -+ } -+#if 0 -+ retU2 = ((bank - 1) * EFUSE_BT_REAL_BANK_CONTENT_LEN) + efuse_addr; -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ pEfuseHal->fakeBTEfuseUsedBytes = retU2; -+#else -+ fakeBTEfuseUsedBytes = retU2; -+#endif -+ } else -+ rtw_hal_set_hwreg(padapter, HW_VAR_EFUSE_BT_BYTES, (u8 *)&retU2); -+#else -+ retU2 = ((bank - 1) * EFUSE_BT_REAL_BANK_CONTENT_LEN) + efuse_addr; -+ if (bPseudoTest) { -+ pEfuseHal->fakeBTEfuseUsedBytes = retU2; -+ /* RT_DISP(FEEPROM, EFUSE_PG, ("Hal_EfuseGetCurrentSize_BT92C(), already use %u bytes\n", pEfuseHal->fakeBTEfuseUsedBytes)); */ -+ } else { -+ pEfuseHal->BTEfuseUsedBytes = retU2; -+ /* RT_DISP(FEEPROM, EFUSE_PG, ("Hal_EfuseGetCurrentSize_BT92C(), already use %u bytes\n", pEfuseHal->BTEfuseUsedBytes)); */ -+ } -+#endif -+ -+ RTW_INFO("%s: CurrentSize=%d\n", __FUNCTION__, retU2); -+ return retU2; -+} -+ -+static u16 -+Hal_EfuseGetCurrentSize( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ u8 bPseudoTest) -+{ -+ u16 ret = 0; -+ -+ if (efuseType == EFUSE_WIFI) -+ ret = hal_EfuseGetCurrentSize_WiFi(pAdapter, bPseudoTest); -+ else -+ ret = hal_EfuseGetCurrentSize_BT(pAdapter, bPseudoTest); -+ -+ return ret; -+} -+ -+static u8 -+Hal_EfuseWordEnableDataWrite( -+ PADAPTER padapter, -+ u16 efuse_addr, -+ u8 word_en, -+ u8 *data, -+ u8 bPseudoTest) -+{ -+ u16 tmpaddr = 0; -+ u16 start_addr = efuse_addr; -+ u8 badworden = 0x0F; -+ u8 tmpdata[PGPKT_DATA_SIZE]; -+ -+ -+ /* RTW_INFO("%s: efuse_addr=%#x word_en=%#x\n", __FUNCTION__, efuse_addr, word_en); */ -+ _rtw_memset(tmpdata, 0xFF, PGPKT_DATA_SIZE); -+ -+ if (!(word_en & BIT(0))) { -+ tmpaddr = start_addr; -+ efuse_OneByteWrite(padapter, start_addr++, data[0], bPseudoTest); -+ efuse_OneByteWrite(padapter, start_addr++, data[1], bPseudoTest); -+ -+ efuse_OneByteRead(padapter, tmpaddr, &tmpdata[0], bPseudoTest); -+ efuse_OneByteRead(padapter, tmpaddr + 1, &tmpdata[1], bPseudoTest); -+ if ((data[0] != tmpdata[0]) || (data[1] != tmpdata[1])) -+ badworden &= (~BIT(0)); -+ } -+ if (!(word_en & BIT(1))) { -+ tmpaddr = start_addr; -+ efuse_OneByteWrite(padapter, start_addr++, data[2], bPseudoTest); -+ efuse_OneByteWrite(padapter, start_addr++, data[3], bPseudoTest); -+ -+ efuse_OneByteRead(padapter, tmpaddr, &tmpdata[2], bPseudoTest); -+ efuse_OneByteRead(padapter, tmpaddr + 1, &tmpdata[3], bPseudoTest); -+ if ((data[2] != tmpdata[2]) || (data[3] != tmpdata[3])) -+ badworden &= (~BIT(1)); -+ } -+ if (!(word_en & BIT(2))) { -+ tmpaddr = start_addr; -+ efuse_OneByteWrite(padapter, start_addr++, data[4], bPseudoTest); -+ efuse_OneByteWrite(padapter, start_addr++, data[5], bPseudoTest); -+ -+ efuse_OneByteRead(padapter, tmpaddr, &tmpdata[4], bPseudoTest); -+ efuse_OneByteRead(padapter, tmpaddr + 1, &tmpdata[5], bPseudoTest); -+ if ((data[4] != tmpdata[4]) || (data[5] != tmpdata[5])) -+ badworden &= (~BIT(2)); -+ } -+ if (!(word_en & BIT(3))) { -+ tmpaddr = start_addr; -+ efuse_OneByteWrite(padapter, start_addr++, data[6], bPseudoTest); -+ efuse_OneByteWrite(padapter, start_addr++, data[7], bPseudoTest); -+ -+ efuse_OneByteRead(padapter, tmpaddr, &tmpdata[6], bPseudoTest); -+ efuse_OneByteRead(padapter, tmpaddr + 1, &tmpdata[7], bPseudoTest); -+ if ((data[6] != tmpdata[6]) || (data[7] != tmpdata[7])) -+ badworden &= (~BIT(3)); -+ } -+ -+ return badworden; -+} -+ -+static s32 -+Hal_EfusePgPacketRead( -+ PADAPTER padapter, -+ u8 offset, -+ u8 *data, -+ u8 bPseudoTest) -+{ -+ u8 bDataEmpty = _TRUE; -+ u8 efuse_data, word_cnts = 0; -+ u16 efuse_addr = 0; -+ u8 hoffset = 0, hworden = 0; -+ u8 i; -+ u8 max_section = 0; -+ s32 ret; -+ -+ -+ if (data == NULL) -+ return _FALSE; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAX_SECTION, &max_section, bPseudoTest); -+ if (offset > max_section) { -+ RTW_INFO("%s: Packet offset(%d) is illegal(>%d)!\n", __FUNCTION__, offset, max_section); -+ return _FALSE; -+ } -+ -+ _rtw_memset(data, 0xFF, PGPKT_DATA_SIZE); -+ ret = _TRUE; -+ -+ /* */ -+ /* Efuse has been pre-programmed dummy 5Bytes at the end of Efuse by CP. */ -+ /* Skip dummy parts to prevent unexpected data read from Efuse. */ -+ /* By pass right now. 2009.02.19. */ -+ /* */ -+ while (AVAILABLE_EFUSE_ADDR(efuse_addr)) { -+ if (efuse_OneByteRead(padapter, efuse_addr++, &efuse_data, bPseudoTest) == _FALSE) { -+ ret = _FALSE; -+ break; -+ } -+ -+ if (efuse_data == 0xFF) -+ break; -+ -+ if (EXT_HEADER(efuse_data)) { -+ hoffset = GET_HDR_OFFSET_2_0(efuse_data); -+ efuse_OneByteRead(padapter, efuse_addr++, &efuse_data, bPseudoTest); -+ if (ALL_WORDS_DISABLED(efuse_data)) { -+ RTW_INFO("%s: Error!! All words disabled!\n", __FUNCTION__); -+ continue; -+ } -+ -+ hoffset |= ((efuse_data & 0xF0) >> 1); -+ hworden = efuse_data & 0x0F; -+ } else { -+ hoffset = (efuse_data >> 4) & 0x0F; -+ hworden = efuse_data & 0x0F; -+ } -+ -+ if (hoffset == offset) { -+ for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { -+ /* Check word enable condition in the section */ -+ if (!(hworden & (0x01 << i))) { -+ /* ReadEFuseByte(padapter, efuse_addr++, &efuse_data, bPseudoTest); */ -+ efuse_OneByteRead(padapter, efuse_addr++, &efuse_data, bPseudoTest); -+ /* RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, efuse_addr+tmpidx, efuse_data); */ -+ data[i * 2] = efuse_data; -+ -+ /* ReadEFuseByte(padapter, efuse_addr++, &efuse_data, bPseudoTest); */ -+ efuse_OneByteRead(padapter, efuse_addr++, &efuse_data, bPseudoTest); -+ /* RTW_INFO("%s: efuse[%#X]=0x%02X\n", __FUNCTION__, efuse_addr+tmpidx, efuse_data); */ -+ data[(i * 2) + 1] = efuse_data; -+ } -+ } -+ } else { -+ word_cnts = Efuse_CalculateWordCnts(hworden); -+ efuse_addr += word_cnts * 2; -+ } -+ } -+ -+ return ret; -+} -+ -+static u8 -+hal_EfusePgCheckAvailableAddr( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ u8 bPseudoTest) -+{ -+ u16 max_available = 0; -+ u16 current_size; -+ -+ -+ EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &max_available, bPseudoTest); -+ /* RTW_INFO("%s: max_available=%d\n", __FUNCTION__, max_available); */ -+ -+ current_size = Efuse_GetCurrentSize(pAdapter, efuseType, bPseudoTest); -+ if (current_size >= max_available) { -+ RTW_INFO("%s: Error!! current_size(%d)>max_available(%d)\n", __FUNCTION__, current_size, max_available); -+ return _FALSE; -+ } -+ return _TRUE; -+} -+ -+static void -+hal_EfuseConstructPGPkt( -+ u8 offset, -+ u8 word_en, -+ u8 *pData, -+ PPGPKT_STRUCT pTargetPkt) -+{ -+ _rtw_memset(pTargetPkt->data, 0xFF, PGPKT_DATA_SIZE); -+ pTargetPkt->offset = offset; -+ pTargetPkt->word_en = word_en; -+ efuse_WordEnableDataRead(word_en, pData, pTargetPkt->data); -+ pTargetPkt->word_cnts = Efuse_CalculateWordCnts(pTargetPkt->word_en); -+} -+ -+#if 0 -+static u8 -+wordEnMatched( -+ PPGPKT_STRUCT pTargetPkt, -+ PPGPKT_STRUCT pCurPkt, -+ u8 *pWden) -+{ -+ u8 match_word_en = 0x0F; /* default all words are disabled */ -+ u8 i; -+ -+ /* check if the same words are enabled both target and current PG packet */ -+ if (((pTargetPkt->word_en & BIT(0)) == 0) && -+ ((pCurPkt->word_en & BIT(0)) == 0)) { -+ match_word_en &= ~BIT(0); /* enable word 0 */ -+ } -+ if (((pTargetPkt->word_en & BIT(1)) == 0) && -+ ((pCurPkt->word_en & BIT(1)) == 0)) { -+ match_word_en &= ~BIT(1); /* enable word 1 */ -+ } -+ if (((pTargetPkt->word_en & BIT(2)) == 0) && -+ ((pCurPkt->word_en & BIT(2)) == 0)) { -+ match_word_en &= ~BIT(2); /* enable word 2 */ -+ } -+ if (((pTargetPkt->word_en & BIT(3)) == 0) && -+ ((pCurPkt->word_en & BIT(3)) == 0)) { -+ match_word_en &= ~BIT(3); /* enable word 3 */ -+ } -+ -+ *pWden = match_word_en; -+ -+ if (match_word_en != 0xf) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+static u8 -+hal_EfuseCheckIfDatafollowed( -+ PADAPTER pAdapter, -+ u8 word_cnts, -+ u16 startAddr, -+ u8 bPseudoTest) -+{ -+ u8 bRet = _FALSE; -+ u8 i, efuse_data; -+ -+ for (i = 0; i < (word_cnts * 2); i++) { -+ if (efuse_OneByteRead(pAdapter, (startAddr + i) , &efuse_data, bPseudoTest) == _FALSE) { -+ RTW_INFO("%s: efuse_OneByteRead FAIL!!\n", __FUNCTION__); -+ bRet = _TRUE; -+ break; -+ } -+ -+ if (efuse_data != 0xFF) { -+ bRet = _TRUE; -+ break; -+ } -+ } -+ -+ return bRet; -+} -+#endif -+ -+static u8 -+hal_EfusePartialWriteCheck( -+ PADAPTER padapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; -+ u8 bRet = _FALSE; -+ u16 startAddr = 0, efuse_max_available_len = 0, efuse_max = 0; -+ u8 efuse_data = 0; -+#if 0 -+ u8 i, cur_header = 0; -+ u8 new_wden = 0, matched_wden = 0, badworden = 0; -+ PGPKT_STRUCT curPkt; -+#endif -+ -+ -+ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &efuse_max_available_len, bPseudoTest); -+ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_CONTENT_LEN_BANK, &efuse_max, bPseudoTest); -+ -+ if (efuseType == EFUSE_WIFI) { -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ startAddr = (u16)pEfuseHal->fakeEfuseUsedBytes; -+#else -+ startAddr = (u16)fakeEfuseUsedBytes; -+#endif -+ } else -+ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BYTES, (u8 *)&startAddr); -+ } else { -+ if (bPseudoTest) { -+#ifdef HAL_EFUSE_MEMORY -+ startAddr = (u16)pEfuseHal->fakeBTEfuseUsedBytes; -+#else -+ startAddr = (u16)fakeBTEfuseUsedBytes; -+#endif -+ } else -+ rtw_hal_get_hwreg(padapter, HW_VAR_EFUSE_BT_BYTES, (u8 *)&startAddr); -+ } -+ startAddr %= efuse_max; -+ RTW_INFO("%s: startAddr=%#X\n", __FUNCTION__, startAddr); -+ -+ while (1) { -+ if (startAddr >= efuse_max_available_len) { -+ bRet = _FALSE; -+ RTW_INFO("%s: startAddr(%d) >= efuse_max_available_len(%d)\n", -+ __FUNCTION__, startAddr, efuse_max_available_len); -+ break; -+ } -+ -+ if (efuse_OneByteRead(padapter, startAddr, &efuse_data, bPseudoTest) && (efuse_data != 0xFF)) { -+#if 1 -+ bRet = _FALSE; -+ RTW_INFO("%s: Something Wrong! last bytes(%#X=0x%02X) is not 0xFF\n", -+ __FUNCTION__, startAddr, efuse_data); -+ break; -+#else -+ if (EXT_HEADER(efuse_data)) { -+ cur_header = efuse_data; -+ startAddr++; -+ efuse_OneByteRead(padapter, startAddr, &efuse_data, bPseudoTest); -+ if (ALL_WORDS_DISABLED(efuse_data)) { -+ RTW_INFO("%s: Error condition, all words disabled!", __FUNCTION__); -+ bRet = _FALSE; -+ break; -+ } /*else*/ -+ { -+ curPkt.offset = ((cur_header & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); -+ curPkt.word_en = efuse_data & 0x0F; -+ } -+ } else { -+ cur_header = efuse_data; -+ curPkt.offset = (cur_header >> 4) & 0x0F; -+ curPkt.word_en = cur_header & 0x0F; -+ } -+ -+ curPkt.word_cnts = Efuse_CalculateWordCnts(curPkt.word_en); -+ /* if same header is found but no data followed */ -+ /* write some part of data followed by the header. */ -+ if ((curPkt.offset == pTargetPkt->offset) && -+ (hal_EfuseCheckIfDatafollowed(padapter, curPkt.word_cnts, startAddr + 1, bPseudoTest) == _FALSE) && -+ wordEnMatched(pTargetPkt, &curPkt, &matched_wden) == _TRUE) { -+ RTW_INFO("%s: Need to partial write data by the previous wrote header\n", __FUNCTION__); -+ /* Here to write partial data */ -+ badworden = Efuse_WordEnableDataWrite(padapter, startAddr + 1, matched_wden, pTargetPkt->data, bPseudoTest); -+ if (badworden != 0x0F) { -+ u32 PgWriteSuccess = 0; -+ /* if write fail on some words, write these bad words again */ -+ if (efuseType == EFUSE_WIFI) -+ PgWriteSuccess = Efuse_PgPacketWrite(padapter, pTargetPkt->offset, badworden, pTargetPkt->data, bPseudoTest); -+ else -+ PgWriteSuccess = Efuse_PgPacketWrite_BT(padapter, pTargetPkt->offset, badworden, pTargetPkt->data, bPseudoTest); -+ -+ if (!PgWriteSuccess) { -+ bRet = _FALSE; /* write fail, return */ -+ break; -+ } -+ } -+ /* partial write ok, update the target packet for later use */ -+ for (i = 0; i < 4; i++) { -+ if ((matched_wden & (0x1 << i)) == 0) { /* this word has been written */ -+ pTargetPkt->word_en |= (0x1 << i); /* disable the word */ -+ } -+ } -+ pTargetPkt->word_cnts = Efuse_CalculateWordCnts(pTargetPkt->word_en); -+ } -+ /* read from next header */ -+ startAddr = startAddr + (curPkt.word_cnts * 2) + 1; -+#endif -+ } else { -+ /* not used header, 0xff */ -+ *pAddr = startAddr; -+ /* RTW_INFO("%s: Started from unused header offset=%d\n", __FUNCTION__, startAddr)); */ -+ bRet = _TRUE; -+ break; -+ } -+ } -+ -+ return bRet; -+} -+ -+static u8 -+hal_EfusePgPacketWrite1ByteHeader( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest) -+{ -+ u8 bRet = _FALSE; -+ u8 pg_header = 0, tmp_header = 0; -+ u16 efuse_addr = *pAddr; -+ u8 repeatcnt = 0; -+ -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ pg_header = ((pTargetPkt->offset << 4) & 0xf0) | pTargetPkt->word_en; -+ -+ do { -+ efuse_OneByteWrite(pAdapter, efuse_addr, pg_header, bPseudoTest); -+ efuse_OneByteRead(pAdapter, efuse_addr, &tmp_header, bPseudoTest); -+ if (tmp_header != 0xFF) -+ break; -+ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { -+ RTW_INFO("%s: Repeat over limit for pg_header!!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ } while (1); -+ -+ if (tmp_header != pg_header) { -+ RTW_INFO(KERN_ERR "%s: PG Header Fail!!(pg=0x%02X read=0x%02X)\n", __FUNCTION__, pg_header, tmp_header); -+ return _FALSE; -+ } -+ -+ *pAddr = efuse_addr; -+ -+ return _TRUE; -+} -+ -+static u8 -+hal_EfusePgPacketWrite2ByteHeader( -+ PADAPTER padapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest) -+{ -+ u16 efuse_addr, efuse_max_available_len = 0; -+ u8 pg_header = 0, tmp_header = 0; -+ u8 repeatcnt = 0; -+ -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_BANK, &efuse_max_available_len, bPseudoTest); -+ -+ efuse_addr = *pAddr; -+ if (efuse_addr >= efuse_max_available_len) { -+ RTW_INFO("%s: addr(%d) over available(%d)!!\n", __FUNCTION__, efuse_addr, efuse_max_available_len); -+ return _FALSE; -+ } -+ -+ pg_header = ((pTargetPkt->offset & 0x07) << 5) | 0x0F; -+ /* RTW_INFO("%s: pg_header=0x%x\n", __FUNCTION__, pg_header); */ -+ -+ do { -+ efuse_OneByteWrite(padapter, efuse_addr, pg_header, bPseudoTest); -+ efuse_OneByteRead(padapter, efuse_addr, &tmp_header, bPseudoTest); -+ if (tmp_header != 0xFF) -+ break; -+ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { -+ RTW_INFO("%s: Repeat over limit for pg_header!!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ } while (1); -+ -+ if (tmp_header != pg_header) { -+ RTW_INFO(KERN_ERR "%s: PG Header Fail!!(pg=0x%02X read=0x%02X)\n", __FUNCTION__, pg_header, tmp_header); -+ return _FALSE; -+ } -+ -+ /* to write ext_header */ -+ efuse_addr++; -+ pg_header = ((pTargetPkt->offset & 0x78) << 1) | pTargetPkt->word_en; -+ -+ do { -+ efuse_OneByteWrite(padapter, efuse_addr, pg_header, bPseudoTest); -+ efuse_OneByteRead(padapter, efuse_addr, &tmp_header, bPseudoTest); -+ if (tmp_header != 0xFF) -+ break; -+ if (repeatcnt++ > EFUSE_REPEAT_THRESHOLD_) { -+ RTW_INFO("%s: Repeat over limit for ext_header!!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ } while (1); -+ -+ if (tmp_header != pg_header) { /* offset PG fail */ -+ RTW_INFO(KERN_ERR "%s: PG EXT Header Fail!!(pg=0x%02X read=0x%02X)\n", __FUNCTION__, pg_header, tmp_header); -+ return _FALSE; -+ } -+ -+ *pAddr = efuse_addr; -+ -+ return _TRUE; -+} -+ -+static u8 -+hal_EfusePgPacketWriteHeader( -+ PADAPTER padapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest) -+{ -+ u8 bRet = _FALSE; -+ -+ if (pTargetPkt->offset >= EFUSE_MAX_SECTION_BASE) -+ bRet = hal_EfusePgPacketWrite2ByteHeader(padapter, efuseType, pAddr, pTargetPkt, bPseudoTest); -+ else -+ bRet = hal_EfusePgPacketWrite1ByteHeader(padapter, efuseType, pAddr, pTargetPkt, bPseudoTest); -+ -+ return bRet; -+} -+ -+static u8 -+hal_EfusePgPacketWriteData( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ u16 *pAddr, -+ PPGPKT_STRUCT pTargetPkt, -+ u8 bPseudoTest) -+{ -+ u16 efuse_addr; -+ u8 badworden; -+ -+ -+ efuse_addr = *pAddr; -+ badworden = Efuse_WordEnableDataWrite(pAdapter, efuse_addr + 1, pTargetPkt->word_en, pTargetPkt->data, bPseudoTest); -+ if (badworden != 0x0F) { -+ RTW_INFO("%s: Fail!!\n", __FUNCTION__); -+ return _FALSE; -+ } -+ -+ /* RTW_INFO("%s: ok\n", __FUNCTION__); */ -+ return _TRUE; -+} -+ -+static s32 -+Hal_EfusePgPacketWrite( -+ PADAPTER padapter, -+ u8 offset, -+ u8 word_en, -+ u8 *pData, -+ u8 bPseudoTest) -+{ -+ PGPKT_STRUCT targetPkt; -+ u16 startAddr = 0; -+ u8 efuseType = EFUSE_WIFI; -+ -+ if (!hal_EfusePgCheckAvailableAddr(padapter, efuseType, bPseudoTest)) -+ return _FALSE; -+ -+ hal_EfuseConstructPGPkt(offset, word_en, pData, &targetPkt); -+ -+ if (!hal_EfusePartialWriteCheck(padapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return _FALSE; -+ -+ if (!hal_EfusePgPacketWriteHeader(padapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return _FALSE; -+ -+ if (!hal_EfusePgPacketWriteData(padapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+static u8 -+Hal_EfusePgPacketWrite_BT( -+ PADAPTER pAdapter, -+ u8 offset, -+ u8 word_en, -+ u8 *pData, -+ u8 bPseudoTest) -+{ -+ PGPKT_STRUCT targetPkt; -+ u16 startAddr = 0; -+ u8 efuseType = EFUSE_BT; -+ -+ if (!hal_EfusePgCheckAvailableAddr(pAdapter, efuseType, bPseudoTest)) -+ return _FALSE; -+ -+ hal_EfuseConstructPGPkt(offset, word_en, pData, &targetPkt); -+ -+ if (!hal_EfusePartialWriteCheck(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return _FALSE; -+ -+ if (!hal_EfusePgPacketWriteHeader(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return _FALSE; -+ -+ if (!hal_EfusePgPacketWriteData(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) -+ return _FALSE; -+ -+ return _TRUE; -+} -+ -+ -+static void read_chip_version_8723d(PADAPTER padapter) -+{ -+ u32 value32; -+ HAL_DATA_TYPE *pHalData; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ value32 = rtw_read32(padapter, REG_SYS_CFG); -+ pHalData->VersionID.ICType = CHIP_8723D; -+ pHalData->VersionID.ChipType = ((value32 & RTL_ID) ? TEST_CHIP : NORMAL_CHIP); -+ pHalData->VersionID.RFType = RF_TYPE_1T1R; -+ pHalData->VersionID.VendorType = ((value32 & VENDOR_ID) ? CHIP_VENDOR_UMC : CHIP_VENDOR_TSMC); -+ pHalData->VersionID.CUTVersion = (value32 & CHIP_VER_RTL_MASK) >> CHIP_VER_RTL_SHIFT; /* IC version (CUT) */ -+ -+ /* For regulator mode. by tynli. 2011.01.14 */ -+ pHalData->RegulatorMode = ((value32 & SPS_SEL) ? RT_LDO_REGULATOR : RT_SWITCHING_REGULATOR); -+ -+ value32 = rtw_read32(padapter, REG_GPIO_OUTSTS); -+ pHalData->VersionID.ROMVer = ((value32 & RF_RL_ID) >> 20); /* ROM code version. */ -+ -+ /* For multi-function consideration. Added by Roger, 2010.10.06. */ -+ pHalData->MultiFunc = RT_MULTI_FUNC_NONE; -+ value32 = rtw_read32(padapter, REG_MULTI_FUNC_CTRL); -+ pHalData->MultiFunc |= ((value32 & WL_FUNC_EN) ? RT_MULTI_FUNC_WIFI : 0); -+ pHalData->MultiFunc |= ((value32 & BT_FUNC_EN) ? RT_MULTI_FUNC_BT : 0); -+ pHalData->MultiFunc |= ((value32 & GPS_FUNC_EN) ? RT_MULTI_FUNC_GPS : 0); -+ pHalData->PolarityCtl = ((value32 & WL_HWPDN_SL) ? RT_POLARITY_HIGH_ACT : RT_POLARITY_LOW_ACT); -+ -+ rtw_hal_config_rftype(padapter); -+ -+ /* -+ if( IS_B_CUT(pHalData->VersionID) || IS_C_CUT(pHalData->VersionID)) -+ { -+ RTW_INFO(" IS_B/C_CUT SWR up 1 level !!!!!!!!!!!!!!!!!\n"); -+ PHY_SetMacReg(padapter, 0x14, BIT(23)|BIT(22)|BIT(21)|BIT(20), 0x5); -+ }else if ( IS_D_CUT(pHalData->VersionID)) -+ { -+ RTW_INFO(" IS_D_CUT SKIP SWR !!!!!!!!!!!!!!!!!\n"); -+ } -+ */ -+ -+#if 1 -+ dump_chip_info(pHalData->VersionID); -+#endif -+ -+} -+ -+ -+void rtl8723d_InitBeaconParameters(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ u16 val16; -+ u8 val8; -+ -+ -+ val8 = DIS_TSF_UDT; -+ val16 = val8 | (val8 << 8); /* port0 and port1 */ -+#ifdef CONFIG_BT_COEXIST -+ /* Enable prot0 beacon function for PSTDMA */ -+ val16 |= EN_BCN_FUNCTION; -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ val16 |= (EN_BCN_FUNCTION << 8); -+#endif -+ rtw_write16(padapter, REG_BCN_CTRL, val16); -+ -+ /* TODO: Remove these magic number */ -+ rtw_write16(padapter, REG_TBTT_PROHIBIT, 0x6404);/* ms */ -+ /* Firmware will control REG_DRVERLYINT when power saving is enable, */ -+ /* so don't set this register on STA mode. */ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) == _FALSE) -+ rtw_write8(padapter, REG_DRVERLYINT, DRIVER_EARLY_INT_TIME_8723D); /* 5ms */ -+ rtw_write8(padapter, REG_BCNDMATIM, BCN_DMA_ATIME_INT_TIME_8723D); /* 2ms */ -+ -+ /* Suggested by designer timchen. Change beacon AIFS to the largest number */ -+ /* beacause test chip does not contension before sending beacon. by tynli. 2009.11.03 */ -+ rtw_write16(padapter, REG_BCNTCFG, 0x660F); -+ -+ pHalData->RegBcnCtrlVal = rtw_read8(padapter, REG_BCN_CTRL); -+ pHalData->RegTxPause = rtw_read8(padapter, REG_TXPAUSE); -+ pHalData->RegFwHwTxQCtrl = rtw_read8(padapter, REG_FWHW_TXQ_CTRL + 2); -+ pHalData->RegReg542 = rtw_read8(padapter, REG_TBTT_PROHIBIT + 2); -+ pHalData->RegCR_1 = rtw_read8(padapter, REG_CR + 1); -+} -+ -+void rtl8723d_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode) -+{ -+#ifdef CONFIG_ADHOC_WORKAROUND_SETTING -+ rtw_write8(padapter, REG_BCN_MAX_ERR, 0xFF); -+#else -+ /* rtw_write8(Adapter, REG_BCN_MAX_ERR, (InfraMode ? 0xFF : 0x10)); */ -+#endif -+} -+ -+void _InitBurstPktLen_8723DS(PADAPTER Adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ //rtw_write8(Adapter, 0x4c7, rtw_read8(Adapter, 0x4c7) | BIT(7)); /* enable single pkt ampdu */ -+ rtw_write8(Adapter, REG_RX_PKT_LIMIT_8723D, 0x18); /* for VHT packet length 11K */ -+ rtw_write16(Adapter, REG_MAX_AGGR_NUM_8723D, 0x0A0A); -+ rtw_write8(Adapter, REG_PIFS_8723D, 0x00); -+ rtw_write8(Adapter, REG_FWHW_TXQ_CTRL_8723D, rtw_read8(Adapter, REG_FWHW_TXQ_CTRL) & (~BIT(7))); -+ if (pHalData->AMPDUBurstMode) -+ rtw_write8(Adapter, REG_AMPDU_BURST_MODE_8723D, 0x5F); -+ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8723D, 0x1C); -+ -+ /* ARFB table 9 for 11ac 5G 2SS */ -+ rtw_write32(Adapter, REG_ARFR0_8723D, 0x00000010); -+ if (IS_NORMAL_CHIP(pHalData->VersionID)) -+ rtw_write32(Adapter, REG_ARFR0_8723D + 4, 0xfffff000); -+ else -+ rtw_write32(Adapter, REG_ARFR0_8723D + 4, 0x3e0ff000); -+ -+ /* ARFB table 10 for 11ac 5G 1SS */ -+ rtw_write32(Adapter, REG_ARFR1_8723D, 0x00000010); -+ rtw_write32(Adapter, REG_ARFR1_8723D + 4, 0x003ff000); -+} -+ -+void _InitLTECoex_8723DS(PADAPTER Adapter) -+{ -+ /* LTE COEX setting */ -+ rtw_write16(Adapter, REG_LTECOEX_WRITE_DATA, 0x7700); -+ rtw_write32(Adapter, REG_LTECOEX_CTRL, 0xc0020038); -+ rtw_write8(Adapter, 0x73, 0x04); -+} -+ -+void _InitMacAPLLSetting_8723D(PADAPTER Adapter) -+{ -+ u16 RegValue; -+ -+ RegValue = rtw_read16(Adapter, REG_AFE_CTRL_4_8723D); -+ RegValue |= BIT(4); -+ RegValue |= BIT(15); -+ rtw_write16(Adapter, REG_AFE_CTRL_4_8723D, RegValue); -+} -+ -+static void _BeaconFunctionEnable(PADAPTER padapter, u8 Enable, u8 Linked) -+{ -+ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); -+ rtw_write8(padapter, REG_RD_CTRL + 1, 0x6F); -+} -+ -+static void rtl8723d_SetBeaconRelatedRegisters(PADAPTER padapter) -+{ -+ u8 val8; -+ u32 value32; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ u32 bcn_ctrl_reg; -+ -+ /* reset TSF, enable update TSF, correcting TSF On Beacon */ -+ -+ /* REG_BCN_INTERVAL */ -+ /* REG_BCNDMATIM */ -+ /* REG_ATIMWND */ -+ /* REG_TBTT_PROHIBIT */ -+ /* REG_DRVERLYINT */ -+ /* REG_BCN_MAX_ERR */ -+ /* REG_BCNTCFG //(0x510) */ -+ /* REG_DUAL_TSF_RST */ -+ /* REG_BCN_CTRL //(0x550) */ -+ -+ -+ bcn_ctrl_reg = REG_BCN_CTRL; -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->hw_port == HW_PORT1) -+ bcn_ctrl_reg = REG_BCN_CTRL_1; -+#endif -+ -+ /* */ -+ /* ATIM window */ -+ /* */ -+ rtw_write16(padapter, REG_ATIMWND, 2); -+ -+ /* */ -+ /* Beacon interval (in unit of TU). */ -+ /* */ -+ rtw_write16(padapter, REG_BCN_INTERVAL, pmlmeinfo->bcn_interval); -+ -+ rtl8723d_InitBeaconParameters(padapter); -+ -+ rtw_write8(padapter, REG_SLOT, 0x09); -+ -+ /* */ -+ /* Reset TSF Timer to zero, added by Roger. 2008.06.24 */ -+ /* */ -+ value32 = rtw_read32(padapter, REG_TCR); -+ value32 &= ~TSFRST; -+ rtw_write32(padapter, REG_TCR, value32); -+ -+ value32 |= TSFRST; -+ rtw_write32(padapter, REG_TCR, value32); -+ -+ /* NOTE: Fix test chip's bug (about contention windows's randomness) */ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE | WIFI_AP_STATE) == _TRUE) { -+ rtw_write8(padapter, REG_RXTSF_OFFSET_CCK, 0x50); -+ rtw_write8(padapter, REG_RXTSF_OFFSET_OFDM, 0x50); -+ } -+ -+ _BeaconFunctionEnable(padapter, _TRUE, _TRUE); -+ -+ ResumeTxBeacon(padapter); -+ val8 = rtw_read8(padapter, bcn_ctrl_reg); -+ val8 |= DIS_BCNQ_SUB; -+ rtw_write8(padapter, bcn_ctrl_reg, val8); -+} -+ -+void hal_notch_filter_8723d(_adapter *adapter, bool enable) -+{ -+ if (enable) { -+ RTW_INFO("Enable notch filter\n"); -+ rtw_write8(adapter, rOFDM0_RxDSP + 1, rtw_read8(adapter, rOFDM0_RxDSP + 1) | BIT(1)); -+ } else { -+ RTW_INFO("Disable notch filter\n"); -+ rtw_write8(adapter, rOFDM0_RxDSP + 1, rtw_read8(adapter, rOFDM0_RxDSP + 1) & ~BIT(1)); -+ } -+} -+ -+u8 rtl8723d_MRateIdxToARFRId(PADAPTER padapter, u8 rate_idx) -+{ -+ u8 ret = 0; -+ RT_RF_TYPE_DEF_E rftype = (RT_RF_TYPE_DEF_E)GET_RF_TYPE(padapter); -+ -+ switch (rate_idx) { -+ -+ case RATR_INX_WIRELESS_NGB: -+ if (rftype == RF_1T1R) -+ ret = 1; -+ else -+ ret = 0; -+ break; -+ -+ case RATR_INX_WIRELESS_N: -+ case RATR_INX_WIRELESS_NG: -+ if (rftype == RF_1T1R) -+ ret = 5; -+ else -+ ret = 4; -+ break; -+ -+ case RATR_INX_WIRELESS_NB: -+ if (rftype == RF_1T1R) -+ ret = 3; -+ else -+ ret = 2; -+ break; -+ -+ case RATR_INX_WIRELESS_GB: -+ ret = 6; -+ break; -+ -+ case RATR_INX_WIRELESS_G: -+ ret = 7; -+ break; -+ -+ case RATR_INX_WIRELESS_B: -+ ret = 8; -+ break; -+ -+ case RATR_INX_WIRELESS_MC: -+ if (padapter->mlmeextpriv.cur_wireless_mode & WIRELESS_11BG_24N) -+ ret = 6; -+ else -+ ret = 7; -+ break; -+ case RATR_INX_WIRELESS_AC_N: -+ if (rftype == RF_1T1R) /* || padapter->MgntInfo.VHTHighestOperaRate <= MGN_VHT1SS_MCS9) */ -+ ret = 10; -+ else -+ ret = 9; -+ break; -+ -+ default: -+ ret = 0; -+ break; -+ } -+ -+ return ret; -+} -+ -+void UpdateHalRAMask8723D(PADAPTER padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level) -+{ -+ u32 mask, rate_bitmap = 0, ratr_bitmap_msb = 0; -+ u8 disable_cck_rate = FALSE, MimoPs_enable = FALSE; -+ u8 shortGIrate = _FALSE; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u8 bw; -+ -+ if (psta == NULL) { -+ RTW_PRINT(FUNC_ADPT_FMT" macid:%u, sta is NULL\n", -+ FUNC_ADPT_ARG(padapter), mac_id); -+ return; -+ } -+ -+ bw = rtw_get_tx_bw_mode(padapter, psta); -+ shortGIrate = query_ra_short_GI(psta, bw); -+ -+ mask = psta->ra_mask; -+ -+#if 1 -+ phydm_UpdateHalRAMask(&pHalData->odmpriv, psta->wireless_mode, pHalData->rf_type, bw, MimoPs_enable, disable_cck_rate, &ratr_bitmap_msb, &mask, rssi_level); -+#else -+ rate_bitmap = 0xffffffff; -+ rate_bitmap = ODM_Get_Rate_Bitmap(&pHalData->odmpriv, mac_id, mask, rssi_level); -+ mask &= rate_bitmap; -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ rate_bitmap = rtw_btcoex_GetRaMask(padapter); -+ mask &= ~rate_bitmap; -+#endif /* CONFIG_BT_COEXIST */ -+ -+#ifdef CONFIG_CMCC_TEST -+#ifdef CONFIG_BT_COEXIST -+ if (pmlmeext->cur_wireless_mode & WIRELESS_11G) { -+ if (mac_id == 0) { -+ RTW_INFO("CMCC_BT update raid entry, mask=0x%x\n", mask); -+ /* mask &=0xffffffc0; //disable CCK & <12M OFDM rate for 11G mode for CMCC */ -+ mask &= 0xffffff00; /* disable CCK & <24M OFDM rate for 11G mode for CMCC */ -+ RTW_INFO("CMCC_BT update raid entry, mask=0x%x\n", mask); -+ } -+ } -+#endif -+#endif -+ RTW_INFO("%s => mac_id:%d, networkType:0x%02x, mask:0x%08x\n\t ==> rssi_level:%d, rate_bitmap:0x%08x\n", -+ __FUNCTION__, mac_id, psta->wireless_mode, mask, rssi_level, rate_bitmap); -+ -+ if (pHalData->fw_ractrl == _TRUE) -+ rtl8723d_set_FwMacIdConfig_cmd(padapter, mac_id, psta->raid, bw, shortGIrate, mask); -+ -+ /* set correct initial date rate for each mac_id */ -+ pHalData->INIDATA_RATE[mac_id] = psta->init_rate; -+ RTW_INFO("%s(): mac_id=%d raid=0x%x bw=%d mask=0x%x init_rate=0x%x\n", __func__, mac_id, psta->raid, bw, mask, psta->init_rate); -+ -+ rtw_macid_ctl_set_bw(macid_ctl, mac_id, bw); -+ rtw_macid_ctl_set_rate_bmp0(macid_ctl, mac_id, mask); -+ rtw_update_tx_rate_bmp(adapter_to_dvobj(padapter)); -+} -+/* -+ * Description: In normal chip, we should send some packet to Hw which will be used by Fw -+ * in FW LPS mode. The function is to fill the Tx descriptor of this packets, then -+ * Fw can tell Hw to send these packet derectly. -+ * Added by tynli. 2009.10.15. -+ * -+ * type1:pspoll, type2:null */ -+void rtl8723d_fill_fake_txdesc( -+ PADAPTER padapter, -+ u8 *pDesc, -+ u32 BufferLen, -+ u8 IsPsPoll, -+ u8 IsBTQosNull, -+ u8 bDataFrame) -+{ -+ /* Clear all status */ -+ _rtw_memset(pDesc, 0, TXDESC_SIZE); -+ -+ SET_TX_DESC_OFFSET_8723D(pDesc, 0x28); /* Offset = 32 */ -+ -+ SET_TX_DESC_PKT_SIZE_8723D(pDesc, BufferLen); /* Buffer size + command header */ -+ SET_TX_DESC_QUEUE_SEL_8723D(pDesc, QSLT_MGNT); /* Fixed queue of Mgnt queue */ -+ -+ /* Set NAVUSEHDR to prevent Ps-poll AId filed to be changed to error vlaue by Hw. */ -+ if (_TRUE == IsPsPoll) -+ SET_TX_DESC_NAV_USE_HDR_8723D(pDesc, 1); -+ else { -+ SET_TX_DESC_HWSEQ_EN_8723D(pDesc, 1); /* Hw set sequence number */ -+ SET_TX_DESC_HWSEQ_SEL_8723D(pDesc, 0); -+ } -+ -+ if (_TRUE == IsBTQosNull) -+ SET_TX_DESC_BT_INT_8723D(pDesc, 1); -+ -+ SET_TX_DESC_USE_RATE_8723D(pDesc, 1); /* use data rate which is set by Sw */ -+ -+ SET_TX_DESC_TX_RATE_8723D(pDesc, DESC8723D_RATE1M); -+ -+ /* */ -+ /* Encrypt the data frame if under security mode excepct null data. Suggested by CCW. */ -+ /* */ -+ if (_TRUE == bDataFrame) { -+ u32 EncAlg; -+ -+ EncAlg = padapter->securitypriv.dot11PrivacyAlgrthm; -+ switch (EncAlg) { -+ case _NO_PRIVACY_: -+ SET_TX_DESC_SEC_TYPE_8723D(pDesc, 0x0); -+ break; -+ case _WEP40_: -+ case _WEP104_: -+ case _TKIP_: -+ SET_TX_DESC_SEC_TYPE_8723D(pDesc, 0x1); -+ break; -+ case _SMS4_: -+ SET_TX_DESC_SEC_TYPE_8723D(pDesc, 0x2); -+ break; -+ case _AES_: -+ SET_TX_DESC_SEC_TYPE_8723D(pDesc, 0x3); -+ break; -+ default: -+ SET_TX_DESC_SEC_TYPE_8723D(pDesc, 0x0); -+ break; -+ } -+ } -+ -+#if defined(CONFIG_USB_HCI) -+ /* -+ * USB interface drop packet if the checksum of descriptor isn't correct. -+ * Using this checksum can let hardware recovery from packet bulk out error (e.g. Cancel URC, Bulk out error.). -+ */ -+ rtl8723d_cal_txdesc_chksum((struct tx_desc *)pDesc); -+#endif -+} -+ -+void rtl8723d_InitAntenna_Selection(PADAPTER padapter) -+{ -+ rtw_write8(padapter, REG_LEDCFG2, 0x82); -+} -+ -+void rtl8723d_CheckAntenna_Selection(PADAPTER padapter) -+{ -+#if 0 -+ PHAL_DATA_TYPE pHalData; -+ u8 val; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ val = rtw_read8(padapter, REG_LEDCFG2); -+ /* Let 8051 take control antenna setting */ -+ if (!(val & BIT(7))) { -+ val |= BIT(7); /* DPDT_SEL_EN, 0x4C[23] */ -+ rtw_write8(padapter, REG_LEDCFG2, val); -+ } -+#endif -+} -+void rtl8723d_DeinitAntenna_Selection(PADAPTER padapter) -+{ -+#if 0 -+ PHAL_DATA_TYPE pHalData; -+ u8 val; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ val = rtw_read8(padapter, REG_LEDCFG2); -+ /* Let 8051 take control antenna setting */ -+ val &= ~BIT(7); /* DPDT_SEL_EN, clear 0x4C[23] */ -+ rtw_write8(padapter, REG_LEDCFG2, val); -+#endif -+} -+ -+void init_hal_spec_8723d(_adapter *adapter) -+{ -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+ hal_spec->ic_name = "rtl8723d"; -+ hal_spec->macid_num = MACID_NUM_8723D; -+ hal_spec->sec_cam_ent_num = SEC_CAM_ENT_NUM_8723D; -+ hal_spec->sec_cap = SEC_CAP_CHK_BMC; -+ hal_spec->rfpath_num_2g = 2; -+ hal_spec->rfpath_num_5g = 0; -+ hal_spec->max_tx_cnt = 1; -+ hal_spec->nss_num = NSS_NUM_8723D; -+ hal_spec->band_cap = BAND_CAP_8723D; -+ hal_spec->bw_cap = BW_CAP_8723D; -+ hal_spec->port_num = HW_PORT_NUM_8723D; -+ hal_spec->proto_cap = PROTO_CAP_8723D; -+ -+ hal_spec->wl_func = 0 -+ | WL_FUNC_P2P -+ | WL_FUNC_MIRACAST -+ | WL_FUNC_TDLS -+ ; -+} -+ -+void rtl8723d_init_default_value(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 i; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+#ifdef CONFIG_80211N_HT -+ padapter->registrypriv.wireless_mode = WIRELESS_11BG_24N; -+#else -+ padapter->registrypriv.wireless_mode = WIRELESS_11BG; -+#endif -+ -+ /* init default value */ -+ pHalData->fw_ractrl = _FALSE; -+ if (!adapter_to_pwrctl(padapter)->bkeepfwalive) -+ pHalData->LastHMEBoxNum = 0; -+ -+ /* init phydm default value */ -+ pHalData->bIQKInitialized = _FALSE; -+ pHalData->odmpriv.RFCalibrateInfo.TM_Trigger = 0;/* for IQK */ -+ pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP_index = 0; -+ for (i = 0; i < HP_THERMAL_NUM; i++) -+ pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP[i] = 0; -+ -+ /* init Efuse variables */ -+ pHalData->EfuseUsedBytes = 0; -+ pHalData->EfuseUsedPercentage = 0; -+#ifdef HAL_EFUSE_MEMORY -+ pHalData->EfuseHal.fakeEfuseBank = 0; -+ pHalData->EfuseHal.fakeEfuseUsedBytes = 0; -+ _rtw_memset(pHalData->EfuseHal.fakeEfuseContent, 0xFF, EFUSE_MAX_HW_SIZE); -+ _rtw_memset(pHalData->EfuseHal.fakeEfuseInitMap, 0xFF, EFUSE_MAX_MAP_LEN); -+ _rtw_memset(pHalData->EfuseHal.fakeEfuseModifiedMap, 0xFF, EFUSE_MAX_MAP_LEN); -+ pHalData->EfuseHal.BTEfuseUsedBytes = 0; -+ pHalData->EfuseHal.BTEfuseUsedPercentage = 0; -+ _rtw_memset(pHalData->EfuseHal.BTEfuseContent, 0xFF, EFUSE_MAX_BT_BANK * EFUSE_MAX_HW_SIZE); -+ _rtw_memset(pHalData->EfuseHal.BTEfuseInitMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); -+ _rtw_memset(pHalData->EfuseHal.BTEfuseModifiedMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); -+ pHalData->EfuseHal.fakeBTEfuseUsedBytes = 0; -+ _rtw_memset(pHalData->EfuseHal.fakeBTEfuseContent, 0xFF, EFUSE_MAX_BT_BANK * EFUSE_MAX_HW_SIZE); -+ _rtw_memset(pHalData->EfuseHal.fakeBTEfuseInitMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); -+ _rtw_memset(pHalData->EfuseHal.fakeBTEfuseModifiedMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); -+#endif -+ pHalData->need_restore = _FALSE; -+} -+ -+u8 GetEEPROMSize8723D(PADAPTER padapter) -+{ -+ u8 size = 0; -+ u32 cr; -+ -+ cr = rtw_read16(padapter, REG_9346CR); -+ /* 6: EEPROM used is 93C46, 4: boot from E-Fuse. */ -+ size = (cr & BOOT_FROM_EEPROM) ? 6 : 4; -+ -+ RTW_INFO("EEPROM type is %s\n", size == 4 ? "E-FUSE" : "93C46"); -+ -+ return size; -+} -+ -+/* ------------------------------------------------------------------------- -+ * -+ * LLT R/W/Init function -+ * -+ * ------------------------------------------------------------------------- */ -+s32 rtl8723d_InitLLTTable(PADAPTER padapter) -+{ -+ u32 start, passing_time; -+ u32 val32; -+ s32 ret; -+ -+ -+ ret = _FAIL; -+ -+ val32 = rtw_read32(padapter, REG_AUTO_LLT); -+ val32 |= BIT_AUTO_INIT_LLT; -+ rtw_write32(padapter, REG_AUTO_LLT, val32); -+ -+ start = rtw_get_current_time(); -+ -+ do { -+ val32 = rtw_read32(padapter, REG_AUTO_LLT); -+ if (!(val32 & BIT_AUTO_INIT_LLT)) { -+ ret = _SUCCESS; -+ break; -+ } -+ -+ passing_time = rtw_get_passing_time_ms(start); -+ if (passing_time > 1000) { -+ RTW_INFO("%s: FAIL!! REG_AUTO_LLT(0x%X)=%08x\n", -+ __FUNCTION__, REG_AUTO_LLT, val32); -+ break; -+ } -+ -+ rtw_usleep_os(2); -+ } while (1); -+ -+ return ret; -+} -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+void _DisableGPIO(PADAPTER padapter) -+{ -+ /*************************************** -+ j. GPIO_PIN_CTRL 0x44[31:0]=0x000 -+ k.Value = GPIO_PIN_CTRL[7:0] -+ l. GPIO_PIN_CTRL 0x44[31:0] = 0x00FF0000 | (value <<8); -+ m. GPIO_MUXCFG 0x42 [15:0] = 0x0780 -+ n. LEDCFG 0x4C[15:0] = 0x8080 -+ ***************************************/ -+ u8 value8; -+ u16 value16; -+ u32 value32; -+ u32 u4bTmp; -+ -+ -+ /* 1. Disable GPIO[7:0] */ -+ rtw_write16(padapter, REG_GPIO_PIN_CTRL + 2, 0x0000); -+ value32 = rtw_read32(padapter, REG_GPIO_PIN_CTRL) & 0xFFFF00FF; -+ u4bTmp = value32 & 0x000000FF; -+ value32 |= ((u4bTmp << 8) | 0x00FF0000); -+ rtw_write32(padapter, REG_GPIO_PIN_CTRL, value32); -+ -+ -+ /* 2. Disable GPIO[10:8] */ -+ rtw_write8(padapter, REG_MAC_PINMUX_CFG, 0x00); -+ value16 = rtw_read16(padapter, REG_GPIO_IO_SEL) & 0xFF0F; -+ value8 = (u8)(value16 & 0x000F); -+ value16 |= ((value8 << 4) | 0x0780); -+ rtw_write16(padapter, REG_GPIO_IO_SEL, value16); -+ -+ -+ /* 3. Disable LED0 & 1 */ -+ rtw_write16(padapter, REG_LEDCFG0, 0x8080); -+ -+} /* end of _DisableGPIO() */ -+ -+void _DisableRFAFEAndResetBB8723D(PADAPTER padapter) -+{ -+ /************************************** -+ a. TXPAUSE 0x522[7:0] = 0xFF -+ b. RF path 0 offset 0x00 = 0x00 -+ c. APSD_CTRL 0x600[7:0] = 0x40 -+ d. SYS_FUNC_EN 0x02[7:0] = 0x16 -+ e. SYS_FUNC_EN 0x02[7:0] = 0x14 -+ ***************************************/ -+ u8 eRFPath = 0, value8 = 0; -+ -+ rtw_write8(padapter, REG_TXPAUSE, 0xFF); -+ -+ PHY_SetRFReg(padapter, (RF_PATH)eRFPath, 0x0, bMaskByte0, 0x0); -+ -+ value8 |= APSDOFF; -+ rtw_write8(padapter, REG_APSD_CTRL, value8);/* 0x40 */ -+ -+ /* Set BB reset at first */ -+ value8 = 0; -+ value8 |= (FEN_USBD | FEN_USBA | FEN_BB_GLB_RSTn); -+ rtw_write8(padapter, REG_SYS_FUNC_EN, value8); /* 0x16 */ -+ -+ /* Set global reset. */ -+ value8 &= ~FEN_BB_GLB_RSTn; -+ rtw_write8(padapter, REG_SYS_FUNC_EN, value8); /* 0x14 */ -+ -+ /* 2010/08/12 MH We need to set BB/GLBAL reset to save power for SS mode. */ -+ -+} -+ -+void _DisableRFAFEAndResetBB(PADAPTER padapter) -+{ -+ _DisableRFAFEAndResetBB8723D(padapter); -+} -+ -+void _ResetDigitalProcedure1_8723D(PADAPTER padapter, BOOLEAN bWithoutHWSM) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (IS_FW_81xxC(padapter) && (pHalData->FirmwareVersion <= 0x20)) { -+#if 0 -+ /***************************** -+ f. SYS_FUNC_EN 0x03[7:0]=0x54 -+ g. MCUFWDL 0x80[7:0]=0 -+ ******************************/ -+ u32 value32 = 0; -+ -+ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, 0x54); -+ rtw_write8(padapter, REG_MCUFWDL, 0); -+#else -+ /***************************** -+ f. MCUFWDL 0x80[7:0]=0 -+ g. SYS_FUNC_EN 0x02[10]= 0 -+ h. SYS_FUNC_EN 0x02[15-12]= 5 -+ i. SYS_FUNC_EN 0x02[10]= 1 -+ ******************************/ -+ u16 valu16 = 0; -+ -+ rtw_write8(padapter, REG_MCUFWDL, 0); -+ -+ valu16 = rtw_read16(padapter, REG_SYS_FUNC_EN); -+ rtw_write16(padapter, REG_SYS_FUNC_EN, (valu16 & (~FEN_CPUEN)));/* reset MCU ,8051 */ -+ -+ valu16 = rtw_read16(padapter, REG_SYS_FUNC_EN) & 0x0FFF; -+ rtw_write16(padapter, REG_SYS_FUNC_EN, (valu16 | (FEN_HWPDN | FEN_ELDR))); /* reset MAC */ -+ -+ valu16 = rtw_read16(padapter, REG_SYS_FUNC_EN); -+ rtw_write16(padapter, REG_SYS_FUNC_EN, (valu16 | FEN_CPUEN));/* enable MCU ,8051 */ -+#endif -+ } else { -+ u8 retry_cnts = 0; -+ -+ /* 2010/08/12 MH For USB SS, we can not stop 8051 when we are trying to */ -+ /* enter IPS/HW&SW radio off. For S3/S4/S5/Disable, we can stop 8051 because */ -+ /* we will init FW when power on again. */ -+ /* if(!pDevice->RegUsbSS) */ -+ { /* If we want to SS mode, we can not reset 8051. */ -+ if (rtw_read8(padapter, REG_MCUFWDL) & BIT(1)) { -+ /* IF fw in RAM code, do reset */ -+ -+ -+ if (padapter->bFWReady) { -+ /* 2010/08/25 MH According to RD alfred's suggestion, we need to disable other */ -+ /* HRCV INT to influence 8051 reset. */ -+ rtw_write8(padapter, REG_FWIMR, 0x20); -+ /* 2011/02/15 MH According to Alex's suggestion, close mask to prevent incorrect FW write operation. */ -+ rtw_write8(padapter, REG_FTIMR, 0x00); -+ rtw_write8(padapter, REG_FSIMR, 0x00); -+ -+ rtw_write8(padapter, REG_HMETFR + 3, 0x20); /* 8051 reset by self */ -+ -+ while ((retry_cnts++ < 100) && (FEN_CPUEN & rtw_read16(padapter, REG_SYS_FUNC_EN))) { -+ rtw_udelay_os(50);/* us */ -+ /* 2010/08/25 For test only We keep on reset 5051 to prevent fail. */ -+ /* rtw_write8(padapter, REG_HMETFR+3, 0x20);//8051 reset by self */ -+ } -+ /* RT_ASSERT((retry_cnts < 100), ("8051 reset failed!\n")); */ -+ -+ if (retry_cnts >= 100) { -+ /* if 8051 reset fail we trigger GPIO 0 for LA */ -+ /* rtw_write32( padapter, */ -+ /* REG_GPIO_PIN_CTRL, */ -+ /* 0x00010100); */ -+ /* 2010/08/31 MH According to Filen's info, if 8051 reset fail, reset MAC directly. */ -+ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, 0x50); /* Reset MAC and Enable 8051 */ -+ rtw_mdelay_os(10); -+ } -+ -+ } -+ } -+ -+ rtw_write8(padapter, REG_SYS_FUNC_EN + 1, 0x54); /* Reset MAC and Enable 8051 */ -+ rtw_write8(padapter, REG_MCUFWDL, 0); -+ } -+ } -+ -+ /* if(pDevice->RegUsbSS) */ -+ /* bWithoutHWSM = TRUE; // Sugest by Filen and Issau. */ -+ -+ if (bWithoutHWSM) { -+ /* HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); */ -+ /***************************** -+ Without HW auto state machine -+ g. SYS_CLKR 0x08[15:0] = 0x30A3 -+ h. AFE_PLL_CTRL 0x28[7:0] = 0x80 -+ i. AFE_XTAL_CTRL 0x24[15:0] = 0x880F -+ j. SYS_ISO_CTRL 0x00[7:0] = 0xF9 -+ ******************************/ -+ /* rtw_write16(padapter, REG_SYS_CLKR, 0x30A3); */ -+ /* if(!pDevice->RegUsbSS) */ -+ /* 2011/01/26 MH SD4 Scott suggest to fix UNC-B cut bug. */ -+ rtw_write16(padapter, REG_SYS_CLKR, 0x70A3); /* modify to 0x70A3 by Scott. */ -+ rtw_write8(padapter, REG_AFE_PLL_CTRL, 0x80); -+ rtw_write16(padapter, REG_AFE_XTAL_CTRL, 0x880F); -+ /* if(!pDevice->RegUsbSS) */ -+ rtw_write8(padapter, REG_SYS_ISO_CTRL, 0xF9); -+ } else { -+ /* Disable all RF/BB power */ -+ rtw_write8(padapter, REG_RF_CTRL, 0x00); -+ } -+ -+} -+ -+void _ResetDigitalProcedure1(PADAPTER padapter, BOOLEAN bWithoutHWSM) -+{ -+ _ResetDigitalProcedure1_8723D(padapter, bWithoutHWSM); -+} -+ -+void _ResetDigitalProcedure2(PADAPTER padapter) -+{ -+ /* HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ ***************************** -+ k. SYS_FUNC_EN 0x03[7:0] = 0x44 -+ l. SYS_CLKR 0x08[15:0] = 0x3083 -+ m. SYS_ISO_CTRL 0x01[7:0] = 0x83 -+ ******************************/ -+ /* rtw_write8(padapter, REG_SYS_FUNC_EN+1, 0x44); //marked by Scott. */ -+ /* 2011/01/26 MH SD4 Scott suggest to fix UNC-B cut bug. */ -+ rtw_write16(padapter, REG_SYS_CLKR, 0x70a3); /* modify to 0x70a3 by Scott. */ -+ rtw_write8(padapter, REG_SYS_ISO_CTRL + 1, 0x82); /* modify to 0x82 by Scott. */ -+} -+ -+void _DisableAnalog(PADAPTER padapter, BOOLEAN bWithoutHWSM) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u16 value16 = 0; -+ u8 value8 = 0; -+ -+ -+ if (bWithoutHWSM) { -+ /***************************** -+ n. LDOA15_CTRL 0x20[7:0] = 0x04 -+ o. LDOV12D_CTRL 0x21[7:0] = 0x54 -+ r. When driver call disable, the ASIC will turn off remaining clock automatically -+ ******************************/ -+ -+ rtw_write8(padapter, REG_LDOA15_CTRL, 0x04); -+ /* rtw_write8(padapter, REG_LDOV12D_CTRL, 0x54); */ -+ -+ value8 = rtw_read8(padapter, REG_LDOV12D_CTRL); -+ value8 &= (~LDV12_EN); -+ rtw_write8(padapter, REG_LDOV12D_CTRL, value8); -+ } -+ -+ /***************************** -+ h. SPS0_CTRL 0x11[7:0] = 0x23 -+ i. APS_FSMCO 0x04[15:0] = 0x4802 -+ ******************************/ -+ value8 = 0x23; -+ -+ rtw_write8(padapter, REG_SPS0_CTRL, value8); -+ -+ if (bWithoutHWSM) { -+ /* value16 |= (APDM_HOST | AFSM_HSUS |PFM_ALDN); */ -+ /* 2010/08/31 According to Filen description, we need to use HW to shut down 8051 automatically. */ -+ /* Because suspend operation need the asistance of 8051 to wait for 3ms. */ -+ value16 |= (APDM_HOST | AFSM_HSUS | PFM_ALDN); -+ } else -+ value16 |= (APDM_HOST | AFSM_HSUS | PFM_ALDN); -+ -+ rtw_write16(padapter, REG_APS_FSMCO, value16);/* 0x4802 */ -+ -+ rtw_write8(padapter, REG_RSV_CTRL, 0x0e); -+ -+#if 0 -+ /* tynli_test for suspend mode. */ -+ if (!bWithoutHWSM) -+ rtw_write8(padapter, 0xfe10, 0x19); -+#endif -+ -+} -+ -+/* HW Auto state machine */ -+s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU) -+{ -+ int rtStatus = _SUCCESS; -+ -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ return rtStatus; -+ -+ /* ==== RF Off Sequence ==== */ -+ _DisableRFAFEAndResetBB(padapter); -+ -+ /* ==== Reset digital sequence ====== */ -+ _ResetDigitalProcedure1(padapter, _FALSE); -+ -+ /* ==== Pull GPIO PIN to balance level and LED control ====== */ -+ _DisableGPIO(padapter); -+ -+ /* ==== Disable analog sequence === */ -+ _DisableAnalog(padapter, _FALSE); -+ -+ -+ return rtStatus; -+} -+ -+/* without HW Auto state machine */ -+s32 CardDisableWithoutHWSM(PADAPTER padapter) -+{ -+ s32 rtStatus = _SUCCESS; -+ -+ -+ if (RTW_CANNOT_RUN(padapter)) -+ return rtStatus; -+ -+ -+ /* ==== RF Off Sequence ==== */ -+ _DisableRFAFEAndResetBB(padapter); -+ -+ /* ==== Reset digital sequence ====== */ -+ _ResetDigitalProcedure1(padapter, _TRUE); -+ -+ /* ==== Pull GPIO PIN to balance level and LED control ====== */ -+ _DisableGPIO(padapter); -+ -+ /* ==== Reset digital sequence ====== */ -+ _ResetDigitalProcedure2(padapter); -+ -+ /* ==== Disable analog sequence === */ -+ _DisableAnalog(padapter, _TRUE); -+ -+ return rtStatus; -+} -+#endif /* CONFIG_USB_HCI || CONFIG_SDIO_HCI || CONFIG_GSPI_HCI */ -+ -+void -+Hal_InitPGData( -+ PADAPTER padapter, -+ u8 *PROMContent) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u32 i; -+ u16 value16; -+ -+ if (_FALSE == pHalData->bautoload_fail_flag) { -+ /* autoload OK. -+ * if (IS_BOOT_FROM_EEPROM(padapter)) */ -+ if (_TRUE == pHalData->EepromOrEfuse) { -+ /* Read all Content from EEPROM or EFUSE. */ -+ for (i = 0; i < HWSET_MAX_SIZE_8723D; i += 2) { -+ /* value16 = EF2Byte(ReadEEprom(pAdapter, (u2Byte) (i>>1))); -+ * *((u16*)(&PROMContent[i])) = value16; */ -+ } -+ } else { -+ /* Read EFUSE real map to shadow. */ -+ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, _FALSE); -+ _rtw_memcpy((void *)PROMContent, (void *)pHalData->efuse_eeprom_data, HWSET_MAX_SIZE_8723D); -+ } -+ } else { -+ /* autoload fail */ -+ /* pHalData->AutoloadFailFlag = _TRUE; */ -+ /* update to default value 0xFF */ -+ if (_FALSE == pHalData->EepromOrEfuse) -+ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, _FALSE); -+ _rtw_memcpy((void *)PROMContent, (void *)pHalData->efuse_eeprom_data, HWSET_MAX_SIZE_8723D); -+ } -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ if (check_phy_efuse_tx_power_info_valid(padapter) == _FALSE) { -+ if (Hal_readPGDataFromConfigFile(padapter) != _SUCCESS) -+ RTW_ERR("invalid phy efuse and read from file fail, will use driver default!!\n"); -+ } -+#endif -+} -+ -+void -+Hal_EfuseParseIDCode( -+ IN PADAPTER padapter, -+ IN u8 *hwinfo -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u16 EEPROMId; -+ -+ -+ /* Checl 0x8129 again for making sure autoload status!! */ -+ EEPROMId = le16_to_cpu(*((u16 *)hwinfo)); -+ if (EEPROMId != RTL_EEPROM_ID) { -+ RTW_INFO("EEPROM ID(%#x) is invalid!!\n", EEPROMId); -+ pHalData->bautoload_fail_flag = _TRUE; -+ } else -+ pHalData->bautoload_fail_flag = _FALSE; -+ -+} -+ -+static void -+Hal_EEValueCheck( -+ IN u8 EEType, -+ IN PVOID pInValue, -+ OUT PVOID pOutValue -+) -+{ -+ switch (EEType) { -+ case EETYPE_TX_PWR: { -+ u8 *pIn, *pOut; -+ -+ pIn = (u8 *)pInValue; -+ pOut = (u8 *)pOutValue; -+ if (*pIn <= 63) -+ *pOut = *pIn; -+ else { -+ *pOut = EEPROM_Default_TxPowerLevel; -+ } -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+void -+Hal_EfuseParseTxPowerInfo_8723D( -+ IN PADAPTER padapter, -+ IN u8 *PROMContent, -+ IN BOOLEAN AutoLoadFail -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ TxPowerInfo24G pwrInfo24G; -+ -+ hal_load_txpwr_info(padapter, &pwrInfo24G, NULL, PROMContent); -+ -+ /* 2010/10/19 MH Add Regulator recognize for CU. */ -+ if (!AutoLoadFail) { -+ pHalData->EEPROMRegulatory = (PROMContent[EEPROM_RF_BOARD_OPTION_8723D] & 0x7); /* bit0~2 */ -+ if (PROMContent[EEPROM_RF_BOARD_OPTION_8723D] == 0xFF) -+ pHalData->EEPROMRegulatory = (EEPROM_DEFAULT_BOARD_OPTION & 0x7); /* bit0~2 */ -+ } else -+ pHalData->EEPROMRegulatory = 0; -+} -+ -+VOID -+Hal_EfuseParseBoardType_8723D( -+ IN PADAPTER Adapter, -+ IN u8 *PROMContent, -+ IN BOOLEAN AutoloadFail -+) -+{ -+ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if (!AutoloadFail) { -+ pHalData->InterfaceSel = (PROMContent[EEPROM_RF_BOARD_OPTION_8723D] & 0xE0) >> 5; -+ if (PROMContent[EEPROM_RF_BOARD_OPTION_8723D] == 0xFF) -+ pHalData->InterfaceSel = (EEPROM_DEFAULT_BOARD_OPTION & 0xE0) >> 5; -+ } else -+ pHalData->InterfaceSel = 0; -+ -+} -+ -+VOID -+Hal_EfuseParseBTCoexistInfo_8723D( -+ IN PADAPTER padapter, -+ IN u8 *hwinfo, -+ IN BOOLEAN AutoLoadFail -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ u8 tempval; -+ u32 tmpu4; -+ -+ if (!AutoLoadFail) { -+ tmpu4 = rtw_read32(padapter, REG_MULTI_FUNC_CTRL); -+ if (tmpu4 & BT_FUNC_EN) -+ pHalData->EEPROMBluetoothCoexist = _TRUE; -+ else -+ pHalData->EEPROMBluetoothCoexist = _FALSE; -+ -+ pHalData->EEPROMBluetoothType = BT_RTL8723D; -+ -+ tempval = hwinfo[EEPROM_RF_BT_SETTING_8723D]; -+ if (tempval != 0xFF) { -+ /* 0:Ant_x2, 1:Ant_x1 */ -+ pHalData->EEPROMBluetoothAntNum = tempval & BIT(0); -+ /* -+ * EFUSE_0xC3[6] == 0, Wi-Fi at BTGS1(Main, Ant2) - ODM_RF_PATH_A (default) -+ * EFUSE_0xC3[6] == 1, Wi-Fi at BTGS0( Aux, Ant1) - ODM_RF_PATH_B -+ */ -+ pHalData->ant_path = (tempval & BIT(6)) ? ODM_RF_PATH_B : ODM_RF_PATH_A; -+ } else { -+ pHalData->EEPROMBluetoothAntNum = Ant_x1; -+ pHalData->ant_path = ODM_RF_PATH_A; -+ } -+ } else { -+ if (padapter->registrypriv.mp_mode == 1) -+ pHalData->EEPROMBluetoothCoexist = _TRUE; -+ else -+ pHalData->EEPROMBluetoothCoexist = _FALSE; -+ -+ pHalData->EEPROMBluetoothType = BT_RTL8723D; -+ pHalData->EEPROMBluetoothAntNum = Ant_x1; -+ pHalData->ant_path = ODM_RF_PATH_A; -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ if (padapter->registrypriv.ant_num > 0) { -+ RTW_INFO("%s: Apply driver defined antenna number(%d) to replace origin(%d)\n" -+ , __func__ -+ , padapter->registrypriv.ant_num -+ , pHalData->EEPROMBluetoothAntNum == Ant_x2 ? 2 : 1); -+ -+ switch (padapter->registrypriv.ant_num) { -+ case 1: -+ pHalData->EEPROMBluetoothAntNum = Ant_x1; -+ break; -+ case 2: -+ pHalData->EEPROMBluetoothAntNum = Ant_x2; -+ break; -+ default: -+ RTW_INFO("%s: Discard invalid driver defined antenna number(%d)!\n" -+ , __func__, padapter->registrypriv.ant_num); -+ break; -+ } -+ } -+#endif /* CONFIG_BT_COEXIST */ -+ -+ RTW_INFO("%s: %s BT-coex, ant_num=%d\n" -+ , __func__ -+ , pHalData->EEPROMBluetoothCoexist == _TRUE ? "Enable" : "Disable" -+ , pHalData->EEPROMBluetoothAntNum == Ant_x2 ? 2 : 1); -+} -+ -+VOID -+Hal_EfuseParseEEPROMVer_8723D( -+ IN PADAPTER padapter, -+ IN u8 *hwinfo, -+ IN BOOLEAN AutoLoadFail -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (!AutoLoadFail) -+ pHalData->EEPROMVersion = hwinfo[EEPROM_VERSION_8723D]; -+ else -+ pHalData->EEPROMVersion = 1; -+} -+ -+ -+VOID -+Hal_EfuseParsePackageType_8723D( -+ IN PADAPTER pAdapter, -+ IN u8 *hwinfo, -+ IN BOOLEAN AutoLoadFail -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u1Byte package; -+ u8 efuseContent; -+ -+ Efuse_PowerSwitch(pAdapter, _FALSE, _TRUE); -+ efuse_OneByteRead(pAdapter, 0x1FB, &efuseContent, FALSE); -+ RTW_INFO("%s phy efuse read 0x1FB =%x\n", __func__, efuseContent); -+ Efuse_PowerSwitch(pAdapter, _FALSE, _FALSE); -+ -+ package = efuseContent & 0x7; -+ switch (package) { -+ case 0x4: -+ pHalData->PackageType = PACKAGE_TFBGA79; -+ break; -+ case 0x5: -+ pHalData->PackageType = PACKAGE_TFBGA90; -+ break; -+ case 0x6: -+ pHalData->PackageType = PACKAGE_QFN68; -+ break; -+ case 0x7: -+ pHalData->PackageType = PACKAGE_TFBGA80; -+ break; -+ -+ default: -+ pHalData->PackageType = PACKAGE_DEFAULT; -+ break; -+ } -+ -+ RTW_INFO("PackageType = 0x%X\n", pHalData->PackageType); -+ -+#if defined(CONFIG_SDIO_HCI) && defined(CONFIG_80211N_HT) -+ /* RTL8703AS: 0x1FB[5:4] 2b'10 */ -+ /* RTL8723DS: 0x1FB[5:4] 2b'11 */ -+ if ((efuseContent & 0x30) == 0x20) { -+ pAdapter->registrypriv.bw_mode &= 0xF0; -+ RTW_INFO("This is the case of 8703AS\n"); -+ } -+#endif -+} -+ -+VOID -+Hal_EfuseParseVoltage_8723D( -+ IN PADAPTER pAdapter, -+ IN u8 *hwinfo, -+ IN BOOLEAN AutoLoadFail -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ /* _rtw_memcpy(pHalData->adjuseVoltageVal, &hwinfo[EEPROM_Voltage_ADDR_8723D], 1); */ -+ RTW_INFO("%s hwinfo[EEPROM_Voltage_ADDR_8723D] =%02x\n", __func__, hwinfo[EEPROM_Voltage_ADDR_8723D]); -+ pHalData->adjuseVoltageVal = (hwinfo[EEPROM_Voltage_ADDR_8723D] & 0xf0) >> 4; -+ RTW_INFO("%s pHalData->adjuseVoltageVal =%x\n", __func__, pHalData->adjuseVoltageVal); -+} -+ -+VOID -+Hal_EfuseParseChnlPlan_8723D( -+ IN PADAPTER padapter, -+ IN u8 *hwinfo, -+ IN BOOLEAN AutoLoadFail -+) -+{ -+ padapter->mlmepriv.ChannelPlan = hal_com_config_channel_plan( -+ padapter -+ , hwinfo ? &hwinfo[EEPROM_COUNTRY_CODE_8723D] : NULL -+ , hwinfo ? hwinfo[EEPROM_ChannelPlan_8723D] : 0xFF -+ , padapter->registrypriv.alpha2 -+ , padapter->registrypriv.channel_plan -+ , RTW_CHPLAN_WORLD_NULL -+ , AutoLoadFail -+ ); -+} -+ -+VOID -+Hal_EfuseParseCustomerID_8723D( -+ IN PADAPTER padapter, -+ IN u8 *hwinfo, -+ IN BOOLEAN AutoLoadFail -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (!AutoLoadFail) -+ pHalData->EEPROMCustomerID = hwinfo[EEPROM_CustomID_8723D]; -+ else -+ pHalData->EEPROMCustomerID = 0; -+} -+ -+VOID -+Hal_EfuseParseAntennaDiversity_8723D( -+ IN PADAPTER pAdapter, -+ IN u8 *hwinfo, -+ IN BOOLEAN AutoLoadFail -+) -+{ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ struct registry_priv *registry_par = &pAdapter->registrypriv; -+ u8 get_efuse_div_type = 0; -+ -+ if (pHalData->EEPROMBluetoothAntNum == Ant_x1) -+ pHalData->AntDivCfg = 0; -+ else { -+ if (registry_par->antdiv_cfg == 2) /* 0:OFF , 1:ON, 2:By EFUSE */ -+ pHalData->AntDivCfg = -+ ((hwinfo[EEPROM_RF_BOARD_OPTION_8723D] & BIT3) >> 3); -+ else -+ pHalData->AntDivCfg = registry_par->antdiv_cfg; -+ } -+ -+ pHalData->TRxAntDivType = S0S1_TRX_HW_ANTDIV; /* it's the only diversity-type for 8723D*/ -+ pHalData->with_extenal_ant_switch = ((hwinfo[EEPROM_RF_BT_SETTING_8723D] & BIT7) >> 7); -+ -+ if (pHalData->AntDivCfg != 0) { -+ get_efuse_div_type = hwinfo[EEPROM_RFE_OPTION_8723D]; -+ if (get_efuse_div_type == 0x11) -+ pHalData->b_fix_tx_ant = NO_FIX_TX_ANT; -+ else if (get_efuse_div_type == 0x13) -+ pHalData->b_fix_tx_ant = FIX_TX_AT_MAIN;/* RX diversity only*/ -+ else -+ pHalData->AntDivCfg = FALSE; -+ } -+ RTW_INFO("%s: AntDivCfg=%d, AntDivType=%d\n", -+ __func__, pHalData->AntDivCfg, pHalData->TRxAntDivType); -+#endif -+} -+ -+VOID -+Hal_EfuseParseXtal_8723D( -+ IN PADAPTER pAdapter, -+ IN u8 *hwinfo, -+ IN BOOLEAN AutoLoadFail -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ if (!AutoLoadFail) { -+ pHalData->CrystalCap = hwinfo[EEPROM_XTAL_8723D]; -+ if (pHalData->CrystalCap == 0xFF) -+ pHalData->CrystalCap = EEPROM_Default_CrystalCap_8723D; /* what value should 8812 set? */ -+ } else -+ pHalData->CrystalCap = EEPROM_Default_CrystalCap_8723D; -+} -+ -+ -+void -+Hal_EfuseParseThermalMeter_8723D( -+ PADAPTER padapter, -+ u8 *PROMContent, -+ u8 AutoLoadFail -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ /* */ -+ /* ThermalMeter from EEPROM */ -+ /* */ -+ if (_FALSE == AutoLoadFail) -+ pHalData->EEPROMThermalMeter = PROMContent[EEPROM_THERMAL_METER_8723D]; -+ else -+ pHalData->EEPROMThermalMeter = EEPROM_Default_ThermalMeter_8723D; -+ -+ if ((pHalData->EEPROMThermalMeter == 0xff) || (_TRUE == AutoLoadFail)) { -+ pHalData->odmpriv.RFCalibrateInfo.bAPKThermalMeterIgnore = _TRUE; -+ pHalData->EEPROMThermalMeter = EEPROM_Default_ThermalMeter_8723D; -+ } -+ -+} -+ -+ -+void Hal_ReadRFGainOffset( -+ IN PADAPTER Adapter, -+ IN u8 *PROMContent, -+ IN BOOLEAN AutoloadFail) -+{ -+#ifdef CONFIG_RF_POWER_TRIM -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct kfree_data_t *kfree_data = &pHalData->kfree_data; -+ u8 pg_pwrtrim = 0xFF, pg_therm = 0xFF; -+ -+ efuse_OneByteRead(Adapter, -+ PPG_BB_GAIN_2G_TX_OFFSET_8723D, &pg_pwrtrim, _FALSE); -+ efuse_OneByteRead(Adapter, -+ PPG_THERMAL_OFFSET_8723D, &pg_therm, _FALSE); -+ -+ if (pg_pwrtrim != 0xFF) { -+ kfree_data->bb_gain[BB_GAIN_2G][PPG_8723D_S1] -+ = KFREE_BB_GAIN_2G_TX_OFFSET(pg_pwrtrim & PPG_BB_GAIN_2G_TX_OFFSET_MASK); -+ kfree_data->bb_gain[BB_GAIN_2G][PPG_8723D_S0] -+ = KFREE_BB_GAIN_2G_TXB_OFFSET(pg_pwrtrim & PPG_BB_GAIN_2G_TXB_OFFSET_MASK); -+ kfree_data->flag |= KFREE_FLAG_ON; -+ } -+ -+ if (pg_therm != 0xFF) { -+ kfree_data->thermal -+ = KFREE_THERMAL_OFFSET(pg_therm & PPG_THERMAL_OFFSET_MASK); -+ /* kfree_data->flag |= KFREE_FLAG_THERMAL_K_ON; */ /* Default disable thermel kfree by realsil Alan 20160428 */ -+ } -+ -+ if (kfree_data->flag & KFREE_FLAG_THERMAL_K_ON) -+ pHalData->EEPROMThermalMeter += kfree_data->thermal; -+ -+ RTW_INFO("kfree Pwr Trim flag:%u\n", kfree_data->flag); -+ if (kfree_data->flag & KFREE_FLAG_ON) { -+ RTW_INFO("bb_gain(S1):%d\n", kfree_data->bb_gain[BB_GAIN_2G][PPG_8723D_S1]); -+ RTW_INFO("bb_gain(S0):%d\n", kfree_data->bb_gain[BB_GAIN_2G][PPG_8723D_S0]); -+ } -+ if (kfree_data->flag & KFREE_FLAG_THERMAL_K_ON) -+ RTW_INFO("thermal:%d\n", kfree_data->thermal); -+#endif /*CONFIG_RF_POWER_TRIM */ -+} -+ -+u8 -+BWMapping_8723D( -+ IN PADAPTER Adapter, -+ IN struct pkt_attrib *pattrib -+) -+{ -+ u8 BWSettingOfDesc = 0; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ /* RTW_INFO("BWMapping pHalData->CurrentChannelBW %d, pattrib->bwmode %d\n",pHalData->CurrentChannelBW,pattrib->bwmode); */ -+ -+ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) { -+ if (pattrib->bwmode == CHANNEL_WIDTH_80) -+ BWSettingOfDesc = 2; -+ else if (pattrib->bwmode == CHANNEL_WIDTH_40) -+ BWSettingOfDesc = 1; -+ else -+ BWSettingOfDesc = 0; -+ } else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) { -+ if ((pattrib->bwmode == CHANNEL_WIDTH_40) || (pattrib->bwmode == CHANNEL_WIDTH_80)) -+ BWSettingOfDesc = 1; -+ else -+ BWSettingOfDesc = 0; -+ } else -+ BWSettingOfDesc = 0; -+ -+ /* if(pTcb->bBTTxPacket) */ -+ /* BWSettingOfDesc = 0; */ -+ -+ return BWSettingOfDesc; -+} -+ -+u8 SCMapping_8723D(PADAPTER Adapter, struct pkt_attrib *pattrib) -+{ -+ u8 SCSettingOfDesc = 0; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ /* RTW_INFO("SCMapping: pHalData->CurrentChannelBW %d, pHalData->nCur80MhzPrimeSC %d, pHalData->nCur40MhzPrimeSC %d\n",pHalData->CurrentChannelBW,pHalData->nCur80MhzPrimeSC,pHalData->nCur40MhzPrimeSC); */ -+ -+ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) { -+ if (pattrib->bwmode == CHANNEL_WIDTH_80) -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ else if (pattrib->bwmode == CHANNEL_WIDTH_40) { -+ if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOfDesc = VHT_DATA_SC_40_LOWER_OF_80MHZ; -+ else if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOfDesc = VHT_DATA_SC_40_UPPER_OF_80MHZ; -+ else -+ RTW_INFO("SCMapping: DONOT CARE Mode Setting\n"); -+ } else { -+ if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWEST_OF_80MHZ; -+ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPERST_OF_80MHZ; -+ else -+ RTW_INFO("SCMapping: DONOT CARE Mode Setting\n"); -+ } -+ } else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) { -+ /* RTW_INFO("SCMapping: HT Case: pHalData->CurrentChannelBW %d, pHalData->nCur40MhzPrimeSC %d\n",pHalData->CurrentChannelBW,pHalData->nCur40MhzPrimeSC); */ -+ -+ if (pattrib->bwmode == CHANNEL_WIDTH_40) -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ else if (pattrib->bwmode == CHANNEL_WIDTH_20) { -+ if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } -+ } else -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ -+ return SCSettingOfDesc; -+} -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ if ((pattrib->encrypt > 0) && (!pattrib->bswenc) -+ && (pattrib->bmc_camid != INVALID_SEC_MAC_CAM_ID)) { -+ -+ SET_TX_DESC_EN_DESC_ID_8723D(ptxdesc, 1); -+ SET_TX_DESC_MACID_8723D(ptxdesc, pattrib->bmc_camid); -+ } -+} -+#endif -+ -+static u8 fill_txdesc_sectype(struct pkt_attrib *pattrib) -+{ -+ u8 sectype = 0; -+ -+ if ((pattrib->encrypt > 0) && !pattrib->bswenc) { -+ switch (pattrib->encrypt) { -+ /* SEC_TYPE */ -+ case _WEP40_: -+ case _WEP104_: -+ case _TKIP_: -+ case _TKIP_WTMIC_: -+ sectype = 1; -+ break; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ sectype = 2; -+ break; -+#endif -+ case _AES_: -+ sectype = 3; -+ break; -+ -+ case _NO_PRIVACY_: -+ default: -+ break; -+ } -+ } -+ return sectype; -+} -+ -+static void fill_txdesc_vcs_8723d(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ /* RTW_INFO("cvs_mode=%d\n", pattrib->vcs_mode); */ -+ -+ if (pattrib->vcs_mode) { -+ switch (pattrib->vcs_mode) { -+ case RTS_CTS: -+ SET_TX_DESC_RTS_ENABLE_8723D(ptxdesc, 1); -+ SET_TX_DESC_HW_RTS_ENABLE_8723D(ptxdesc, 1); -+ break; -+ -+ case CTS_TO_SELF: -+ SET_TX_DESC_CTS2SELF_8723D(ptxdesc, 1); -+ break; -+ -+ case NONE_VCS: -+ default: -+ break; -+ } -+ -+ SET_TX_DESC_RTS_RATE_8723D(ptxdesc, 8); /* RTS Rate=24M */ -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8723D(ptxdesc, 0xF); -+ -+ if (padapter->mlmeextpriv.mlmext_info.preamble_mode == PREAMBLE_SHORT) -+ SET_TX_DESC_RTS_SHORT_8723D(ptxdesc, 1); -+ -+ /* Set RTS BW */ -+ if (pattrib->ht_en) -+ SET_TX_DESC_RTS_SC_8723D(ptxdesc, SCMapping_8723D(padapter, pattrib)); -+ } -+} -+ -+static void fill_txdesc_phy_8723d(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ /* RTW_INFO("bwmode=%d, ch_off=%d\n", pattrib->bwmode, pattrib->ch_offset); */ -+ -+ if (pattrib->ht_en) { -+ SET_TX_DESC_DATA_BW_8723D(ptxdesc, BWMapping_8723D(padapter, pattrib)); -+ SET_TX_DESC_DATA_SC_8723D(ptxdesc, SCMapping_8723D(padapter, pattrib)); -+ } -+} -+ -+static void rtl8723d_fill_default_txdesc( -+ struct xmit_frame *pxmitframe, -+ u8 *pbuf) -+{ -+ PADAPTER padapter; -+ HAL_DATA_TYPE *pHalData; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ struct pkt_attrib *pattrib; -+ s32 bmcst; -+ -+ _rtw_memset(pbuf, 0, TXDESC_SIZE); -+ -+ padapter = pxmitframe->padapter; -+ pHalData = GET_HAL_DATA(padapter); -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ pattrib = &pxmitframe->attrib; -+ bmcst = IS_MCAST(pattrib->ra); -+ -+ if (pHalData->rf_type == RF_1T1R) -+ SET_TX_DESC_PATH_A_EN_8723D(pbuf, 1); -+ -+ if (pxmitframe->frame_tag == DATA_FRAMETAG) { -+ u8 drv_userate = 0; -+ -+ SET_TX_DESC_MACID_8723D(pbuf, pattrib->mac_id); -+ SET_TX_DESC_RATE_ID_8723D(pbuf, pattrib->raid); -+ SET_TX_DESC_QUEUE_SEL_8723D(pbuf, pattrib->qsel); -+ SET_TX_DESC_SEQ_8723D(pbuf, pattrib->seqnum); -+ -+ SET_TX_DESC_SEC_TYPE_8723D(pbuf, fill_txdesc_sectype(pattrib)); -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (bmcst) -+ fill_txdesc_force_bmc_camid(pattrib, pbuf); -+#endif -+ fill_txdesc_vcs_8723d(padapter, pattrib, pbuf); -+ -+ if (pattrib->icmp_pkt == 1 && padapter->registrypriv.wifi_spec == 1) -+ drv_userate = 1; -+ -+ if ((pattrib->ether_type != 0x888e) && -+ (pattrib->ether_type != 0x0806) && -+ (pattrib->ether_type != 0x88B4) && -+ (pattrib->dhcp_pkt != 1) && -+ (drv_userate != 1) -+#ifdef CONFIG_AUTO_AP_MODE -+ && (pattrib->pctrl != _TRUE) -+#endif -+ ) { -+ /* Non EAP & ARP & DHCP type data packet */ -+ -+ if (pattrib->ampdu_en == _TRUE) { -+ SET_TX_DESC_AGG_ENABLE_8723D(pbuf, 1); -+ SET_TX_DESC_MAX_AGG_NUM_8723D(pbuf, 0x1F); -+ SET_TX_DESC_AMPDU_DENSITY_8723D(pbuf, pattrib->ampdu_spacing); -+ } else -+ SET_TX_DESC_BK_8723D(pbuf, 1); -+ -+ fill_txdesc_phy_8723d(padapter, pattrib, pbuf); -+ -+ SET_TX_DESC_DATA_RATE_FB_LIMIT_8723D(pbuf, 0x1F); -+ -+ if (pHalData->fw_ractrl == _FALSE) { -+ SET_TX_DESC_USE_RATE_8723D(pbuf, 1); -+ -+ if (pHalData->INIDATA_RATE[pattrib->mac_id] & BIT(7)) -+ SET_TX_DESC_DATA_SHORT_8723D(pbuf, 1); -+ -+ SET_TX_DESC_TX_RATE_8723D(pbuf, pHalData->INIDATA_RATE[pattrib->mac_id] & 0x7F); -+ } -+ -+ /* modify data rate by iwpriv */ -+ if (padapter->fix_rate != 0xFF) { -+ SET_TX_DESC_USE_RATE_8723D(pbuf, 1); -+ if (padapter->fix_rate & BIT(7)) -+ SET_TX_DESC_DATA_SHORT_8723D(pbuf, 1); -+ SET_TX_DESC_TX_RATE_8723D(pbuf, padapter->fix_rate & 0x7F); -+ if (!padapter->data_fb) -+ SET_TX_DESC_DISABLE_FB_8723D(pbuf, 1); -+ } -+ -+ if (pattrib->stbc) -+ SET_TX_DESC_DATA_STBC_8723D(pbuf, 1); -+ -+#ifdef CONFIG_CMCC_TEST -+ SET_TX_DESC_DATA_SHORT_8723D(pbuf, 1); /* use cck short premble */ -+#endif -+ } else { -+ /* EAP data packet and ARP packet. */ -+ /* Use the 1M data rate to send the EAP/ARP packet. */ -+ /* This will maybe make the handshake smooth. */ -+ -+ SET_TX_DESC_BK_8723D(pbuf, 1); -+ SET_TX_DESC_USE_RATE_8723D(pbuf, 1); -+ if (pmlmeinfo->preamble_mode == PREAMBLE_SHORT) -+ SET_TX_DESC_DATA_SHORT_8723D(pbuf, 1); -+ SET_TX_DESC_TX_RATE_8723D(pbuf, MRateToHwRate(pmlmeext->tx_rate)); -+ -+ RTW_INFO(FUNC_ADPT_FMT ": SP Packet(0x%04X) rate=0x%x\n", -+ FUNC_ADPT_ARG(padapter), pattrib->ether_type, MRateToHwRate(pmlmeext->tx_rate)); -+ } -+ -+#if defined(CONFIG_USB_TX_AGGREGATION) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ SET_TX_DESC_USB_TXAGG_NUM_8723D(pbuf, pxmitframe->agg_num); -+#endif -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_XMIT_ACK -+ /* CCX-TXRPT ack for xmit mgmt frames. */ -+ if (pxmitframe->ack_report) { -+#ifdef DBG_CCX -+ RTW_INFO("%s set spe_rpt\n", __func__); -+#endif -+ SET_TX_DESC_CCX_8723D(pbuf, 1); -+ SET_TX_DESC_SW_DEFINE_8723D(pbuf, (u8)(GET_PRIMARY_ADAPTER(padapter)->xmitpriv.seq_no)); -+ } -+#endif /* CONFIG_XMIT_ACK */ -+#endif -+ } else if (pxmitframe->frame_tag == MGNT_FRAMETAG) { -+ -+ SET_TX_DESC_MACID_8723D(pbuf, pattrib->mac_id); -+ SET_TX_DESC_QUEUE_SEL_8723D(pbuf, pattrib->qsel); -+ SET_TX_DESC_RATE_ID_8723D(pbuf, pattrib->raid); -+ SET_TX_DESC_SEQ_8723D(pbuf, pattrib->seqnum); -+ SET_TX_DESC_USE_RATE_8723D(pbuf, 1); -+ -+ SET_TX_DESC_MBSSID_8723D(pbuf, pattrib->mbssid & 0xF); -+ -+ SET_TX_DESC_RETRY_LIMIT_ENABLE_8723D(pbuf, 1); -+ if (pattrib->retry_ctrl == _TRUE) -+ SET_TX_DESC_DATA_RETRY_LIMIT_8723D(pbuf, 6); -+ else -+ SET_TX_DESC_DATA_RETRY_LIMIT_8723D(pbuf, 12); -+ -+ SET_TX_DESC_TX_RATE_8723D(pbuf, MRateToHwRate(pattrib->rate)); -+ -+#ifdef CONFIG_XMIT_ACK -+ /* CCX-TXRPT ack for xmit mgmt frames. */ -+ if (pxmitframe->ack_report) { -+#ifdef DBG_CCX -+ RTW_INFO("%s set spe_rpt\n", __FUNCTION__); -+#endif -+ SET_TX_DESC_CCX_8723D(pbuf, 1); -+ SET_TX_DESC_SW_DEFINE_8723D(pbuf, (u8)(GET_PRIMARY_ADAPTER(padapter)->xmitpriv.seq_no)); -+ } -+#endif /* CONFIG_XMIT_ACK */ -+ } else if (pxmitframe->frame_tag == TXAGG_FRAMETAG) { -+ } -+#ifdef CONFIG_MP_INCLUDED -+ else if (pxmitframe->frame_tag == MP_FRAMETAG) { -+ fill_txdesc_for_mp(padapter, pbuf); -+ } -+#endif -+ else { -+ -+ SET_TX_DESC_MACID_8723D(pbuf, pattrib->mac_id); -+ SET_TX_DESC_RATE_ID_8723D(pbuf, pattrib->raid); -+ SET_TX_DESC_QUEUE_SEL_8723D(pbuf, pattrib->qsel); -+ SET_TX_DESC_SEQ_8723D(pbuf, pattrib->seqnum); -+ SET_TX_DESC_USE_RATE_8723D(pbuf, 1); -+ SET_TX_DESC_TX_RATE_8723D(pbuf, MRateToHwRate(pmlmeext->tx_rate)); -+ } -+ -+ SET_TX_DESC_PKT_SIZE_8723D(pbuf, pattrib->last_txcmdsz); -+ -+ { -+ u8 pkt_offset, offset; -+ -+ pkt_offset = 0; -+ offset = TXDESC_SIZE; -+#ifdef CONFIG_USB_HCI -+ pkt_offset = pxmitframe->pkt_offset; -+ offset += (pxmitframe->pkt_offset >> 3); -+#endif /* CONFIG_USB_HCI */ -+ -+#ifdef CONFIG_TX_EARLY_MODE -+ if (pxmitframe->frame_tag == DATA_FRAMETAG) { -+ pkt_offset = 1; -+ offset += EARLY_MODE_INFO_SIZE; -+ } -+#endif /* CONFIG_TX_EARLY_MODE */ -+ -+ SET_TX_DESC_PKT_OFFSET_8723D(pbuf, pkt_offset); -+ SET_TX_DESC_OFFSET_8723D(pbuf, offset); -+ } -+ -+ if (bmcst) -+ SET_TX_DESC_BMC_8723D(pbuf, 1); -+ -+ /* 2009.11.05. tynli_test. Suggested by SD4 Filen for FW LPS. */ -+ /* (1) The sequence number of each non-Qos frame / broadcast / multicast / */ -+ /* mgnt frame should be controlled by Hw because Fw will also send null data */ -+ /* which we cannot control when Fw LPS enable. */ -+ /* --> default enable non-Qos data sequense number. 2010.06.23. by tynli. */ -+ /* (2) Enable HW SEQ control for beacon packet, because we use Hw beacon. */ -+ /* (3) Use HW Qos SEQ to control the seq num of Ext port non-Qos packets. */ -+ /* 2010.06.23. Added by tynli. */ -+ if (!pattrib->qos_en) -+ SET_TX_DESC_HWSEQ_EN_8723D(pbuf, 1); -+} -+ -+/* -+ * Description: -+ * -+ * Parameters: -+ * pxmitframe xmitframe -+ * pbuf where to fill tx desc -+ */ -+void rtl8723d_update_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf) -+{ -+ PADAPTER padapter = pxmitframe->padapter; -+ -+ rtl8723d_fill_default_txdesc(pxmitframe, pbuf); -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ ODM_SetTxAntByTxInfo(&GET_HAL_DATA(padapter)->odmpriv, pbuf, pxmitframe->attrib.mac_id); -+#endif /* CONFIG_ANTENNA_DIVERSITY */ -+ -+#if defined(CONFIG_USB_HCI) -+ rtl8723d_cal_txdesc_chksum((struct tx_desc *)pbuf); -+#endif -+} -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+int reset_tsf(PADAPTER Adapter, u8 reset_port) -+{ -+ u8 reset_cnt_before = 0, reset_cnt_after = 0, loop_cnt = 0; -+ u32 reg_reset_tsf_cnt = (HW_PORT0 == reset_port) ? -+ REG_FW_RESET_TSF_CNT_0 : REG_FW_RESET_TSF_CNT_1; -+ -+ rtw_mi_buddy_scan_abort(Adapter, _FALSE); /* site survey will cause reset_tsf fail */ -+ reset_cnt_after = reset_cnt_before = rtw_read8(Adapter, reg_reset_tsf_cnt); -+ rtl8723d_reset_tsf(Adapter, reset_port); -+ -+ while ((reset_cnt_after == reset_cnt_before) && (loop_cnt < 10)) { -+ rtw_msleep_os(100); -+ loop_cnt++; -+ reset_cnt_after = rtw_read8(Adapter, reg_reset_tsf_cnt); -+ } -+ -+ return (loop_cnt >= 10) ? _FAIL : _TRUE; -+} -+#endif /* CONFIG_TSF_RESET_OFFLOAD */ -+ -+static void hw_var_set_monitor(PADAPTER Adapter, u8 variable, u8 *val) -+{ -+ u32 value_rcr, rcr_bits; -+ u16 value_rxfltmap2; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ -+ if (*((u8 *)val) == _HW_STATE_MONITOR_) { -+ -+ /* Leave IPS */ -+ rtw_pm_set_ips(Adapter, IPS_NONE); -+ LeaveAllPowerSaveMode(Adapter); -+ -+ /* Receive all type */ -+ rcr_bits = RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_APWRMGT | RCR_ADF | RCR_ACF | RCR_AMF | RCR_APP_PHYST_RXFF; -+ -+ /* Append FCS */ -+ rcr_bits |= RCR_APPFCS; -+ -+#if 0 -+ /* -+ CRC and ICV packet will drop in recvbuf2recvframe() -+ We no turn on it. -+ */ -+ rcr_bits |= (RCR_ACRC32 | RCR_AICV); -+#endif -+ -+ /* Receive all data frames */ -+ value_rxfltmap2 = 0xFFFF; -+ -+ value_rcr = rcr_bits; -+ rtw_write32(Adapter, REG_RCR, value_rcr); -+ -+ rtw_write16(Adapter, REG_RXFLTMAP2, value_rxfltmap2); -+ -+#if 0 -+ /* tx pause */ -+ rtw_write8(padapter, REG_TXPAUSE, 0xFF); -+#endif -+ } else { -+ /* do nothing */ -+ } -+ -+} -+ -+static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) -+{ -+ u8 val8; -+ u8 mode = *((u8 *)val); -+ static u8 isMonitor = _FALSE; -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (isMonitor == _TRUE) { -+ /* reset RCR */ -+ rtw_write32(padapter, REG_RCR, pHalData->ReceiveConfig); -+ isMonitor = _FALSE; -+ } -+ -+ if (mode == _HW_STATE_MONITOR_) { -+ isMonitor = _TRUE; -+ /* set net_type */ -+ Set_MSR(padapter, _HW_STATE_NOLINK_); -+ -+ hw_var_set_monitor(padapter, variable, val); -+ return; -+ } -+ /* set mac addr to mac register */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, -+ adapter_mac_addr(padapter)); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->hw_port == HW_PORT1) { -+ /* disable Port1 TSF update */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL_1); -+ val8 |= DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL_1, val8); -+ -+ Set_MSR(padapter, mode); -+ -+ RTW_INFO("#### %s()-%d hw_port(%d) mode=%d ####\n", -+ __func__, __LINE__, padapter->hw_port, mode); -+ -+ if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { -+ if (!rtw_mi_check_status(padapter, MI_AP_MODE)) { -+ StopTxBeacon(padapter); -+#ifdef CONFIG_PCI_HCI -+ UpdateInterruptMask8723DE(padapter, 0, 0, RT_BCN_INT_MASKS, 0); -+#else /* !CONFIG_PCI_HCI */ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ rtw_write8(padapter, REG_DRVERLYINT, 0x05);/* restore early int time to 5ms */ -+ UpdateInterruptMask8723DU(padapter, _TRUE, 0, IMR_BCNDMAINT0_8723D); -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ -+ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8723DU(padapter, _TRUE , 0, (IMR_TXBCN0ERR_8723D | IMR_TXBCN0OK_8723D)); -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR */ -+ -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ -+#endif /* !CONFIG_PCI_HCI */ -+ } -+ -+ /* disable atim wnd */ -+ rtw_write8(padapter, REG_BCN_CTRL_1, DIS_TSF_UDT | DIS_ATIM | EN_BCN_FUNCTION); -+ } else if ((mode == _HW_STATE_ADHOC_) /*|| (mode == _HW_STATE_AP_)*/) { -+ ResumeTxBeacon(padapter); -+ rtw_write8(padapter, REG_BCN_CTRL_1, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); -+ } else if (mode == _HW_STATE_AP_) { -+#ifdef CONFIG_PCI_HCI -+ UpdateInterruptMask8723DE(padapter, RT_BCN_INT_MASKS, 0, 0, 0); -+#else /* !CONFIG_PCI_HCI */ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ UpdateInterruptMask8723DU(padapter, _TRUE, IMR_BCNDMAINT0_8723D, 0); -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ -+ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8723DU(padapter, _TRUE, (IMR_TXBCN0ERR_8723D | IMR_TXBCN0OK_8723D), 0); -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR */ -+ -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ -+#endif /* !CONFIG_PCI_HCI */ -+ -+ ResumeTxBeacon(padapter); -+ -+ rtw_write8(padapter, REG_BCN_CTRL_1, DIS_TSF_UDT | DIS_BCNQ_SUB); -+ -+ /* Set RCR */ -+ /* rtw_write32(padapter, REG_RCR, 0x70002a8e);//CBSSID_DATA must set to 0 */ -+ /* rtw_write32(padapter, REG_RCR, 0x7000228e);//CBSSID_DATA must set to 0 */ -+ if (padapter->registrypriv.wifi_spec) -+ /* for 11n Logo 4.2.31/4.2.32, disable BSSID BCN check for AP mode */ -+ rtw_write32(padapter, REG_RCR, (0x7000208e & ~(RCR_CBSSID_BCN))); -+ else -+ rtw_write32(padapter, REG_RCR, 0x7000208e);/* CBSSID_DATA must set to 0,reject ICV_ERR packet */ -+ /* enable to rx data frame*/ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); -+ /* enable to rx ps-poll */ -+ rtw_write16(padapter, REG_RXFLTMAP1, 0x0400); -+ -+ /* Beacon Control related register for first time */ -+ rtw_write8(padapter, REG_BCNDMATIM, 0x02); /* 2ms */ -+ -+ /* rtw_write8(padapter, REG_BCN_MAX_ERR, 0xFF); */ -+ rtw_write8(padapter, REG_ATIMWND_1, 0x0a); /* 10ms for port1 */ -+ rtw_write16(padapter, REG_BCNTCFG, 0x00); -+ rtw_write16(padapter, REG_TBTT_PROHIBIT, 0xff04); -+ rtw_write16(padapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ -+ -+ /* reset TSF2 */ -+ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(1)); -+ -+ /* enable BCN1 Function for if2 */ -+ /* don't enable update TSF1 for if2 (due to TSF update when beacon/probe rsp are received) */ -+ rtw_write8(padapter, REG_BCN_CTRL_1, (DIS_TSF_UDT | EN_BCN_FUNCTION | EN_TXBCN_RPT | DIS_BCNQ_SUB)); -+ -+ /* SW_BCN_SEL - Port1 */ -+ /* rtw_write8(Adapter, REG_DWBCN1_CTRL_8192E+2, rtw_read8(Adapter, REG_DWBCN1_CTRL_8192E+2)|BIT4); */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ -+ /* select BCN on port 1 */ -+ rtw_write8(padapter, REG_CCK_CHECK_8723D, -+ (rtw_read8(padapter, REG_CCK_CHECK_8723D) | BIT_BCN_PORT_SEL)); -+ -+ /* BCN1 TSF will sync to BCN0 TSF with offset(0x518) if if1_sta linked */ -+ /* rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1)|BIT(5)); */ -+ /* rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(3)); */ -+ -+ /* dis BCN0 ATIM WND if if1 is station */ -+ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) | DIS_ATIM); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+ /* Reset TSF for STA+AP concurrent mode */ -+ if (rtw_mi_buddy_check_fwstate(padapter, -+ (WIFI_STATION_STATE | WIFI_ASOC_STATE))) { -+ if (reset_tsf(padapter, HW_PORT1) == _FALSE) -+ RTW_INFO("ERROR! %s()-%d: Reset port1 TSF fail\n", -+ __FUNCTION__, __LINE__); -+ } -+#endif /* CONFIG_TSF_RESET_OFFLOAD */ -+ } -+ } else /* else for port0 */ -+#endif /* CONFIG_CONCURRENT_MODE */ -+ { -+#ifdef CONFIG_MI_WITH_MBSSID_CAM /*For Port0 - MBSS CAM*/ -+ hw_var_set_opmode_mbid(padapter, mode); -+#else -+ /* disable Port0 TSF update */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 |= DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ /* set net_type */ -+ Set_MSR(padapter, mode); -+ RTW_INFO("#### %s() -%d hw_port(0) mode = %d ####\n", -+ __func__, __LINE__, mode); -+ -+ if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { -+#ifdef CONFIG_CONCURRENT_MODE -+ if (!rtw_mi_check_status(padapter, MI_AP_MODE)) { -+#else -+ { -+#endif /* CONFIG_CONCURRENT_MODE */ -+ StopTxBeacon(padapter); -+#ifdef CONFIG_PCI_HCI -+ UpdateInterruptMask8723DE(padapter, 0, 0, RT_BCN_INT_MASKS, 0); -+#else /* !CONFIG_PCI_HCI */ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ rtw_write8(padapter, REG_DRVERLYINT, 0x05); /* restore early int time to 5ms */ -+ UpdateInterruptMask8812AU(padapter, _TRUE, 0, IMR_BCNDMAINT0_8723D); -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ -+ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8812AU(padapter, _TRUE , 0, (IMR_TXBCN0ERR_8723D | IMR_TXBCN0OK_8723D)); -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR */ -+ -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ -+#endif /* !CONFIG_PCI_HCI */ -+ } -+ -+ /* disable atim wnd */ -+ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_ATIM); -+ /* rtw_write8(padapter,REG_BCN_CTRL, 0x18); */ -+ } else if ((mode == _HW_STATE_ADHOC_) /*|| (mode == _HW_STATE_AP_)*/) { -+ ResumeTxBeacon(padapter); -+ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); -+ } else if (mode == _HW_STATE_AP_) { -+#ifdef CONFIG_PCI_HCI -+ UpdateInterruptMask8723DE(padapter, RT_BCN_INT_MASKS, 0, 0, 0); -+#else /* !CONFIG_PCI_HCI */ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ UpdateInterruptMask8723DU(padapter, _TRUE , IMR_BCNDMAINT0_8723D, 0); -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ -+ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8723DU(padapter, _TRUE , (IMR_TXBCN0ERR_8723D | IMR_TXBCN0OK_8723D), 0); -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR */ -+ -+#endif /* CONFIG_INTERRUPT_BASED_TXBCN */ -+#endif -+ -+ ResumeTxBeacon(padapter); -+ -+ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT | DIS_BCNQ_SUB); -+ -+ /* Set RCR */ -+ /* rtw_write32(padapter, REG_RCR, 0x70002a8e);//CBSSID_DATA must set to 0 */ -+ /* rtw_write32(padapter, REG_RCR, 0x7000228e);//CBSSID_DATA must set to 0 */ -+ if (padapter->registrypriv.wifi_spec) -+ /* for 11n Logo 4.2.31/4.2.32, disable BSSID BCN check for AP mode */ -+ rtw_write32(padapter, REG_RCR, (0x7000208e & ~(RCR_CBSSID_BCN))); -+ else -+ rtw_write32(padapter, REG_RCR, 0x7000208e);/* CBSSID_DATA must set to 0,reject ICV_ERR packet */ -+ /* enable to rx data frame */ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); -+ /* enable to rx ps-poll */ -+ rtw_write16(padapter, REG_RXFLTMAP1, 0x0400); -+ -+ /* Beacon Control related register for first time */ -+ rtw_write8(padapter, REG_BCNDMATIM, 0x02); /* 2ms */ -+ -+ /* rtw_write8(padapter, REG_BCN_MAX_ERR, 0xFF); */ -+ rtw_write8(padapter, REG_ATIMWND, 0x0a); /* 10ms */ -+ rtw_write16(padapter, REG_BCNTCFG, 0x00); -+ rtw_write16(padapter, REG_TBTT_PROHIBIT, 0xff04); -+ rtw_write16(padapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ -+ -+ /* reset TSF */ -+ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(0)); -+ -+ /* enable BCN0 Function for if1 */ -+ /* don't enable update TSF0 for if1 (due to TSF update when beacon/probe rsp are received) */ -+ rtw_write8(padapter, REG_BCN_CTRL, (DIS_TSF_UDT | EN_BCN_FUNCTION | EN_TXBCN_RPT | DIS_BCNQ_SUB)); -+ -+ /* SW_BCN_SEL - Port0 */ -+ /* rtw_write8(Adapter, REG_DWBCN1_CTRL_8192E+2, rtw_read8(Adapter, REG_DWBCN1_CTRL_8192E+2) & ~BIT4); */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ -+ /* select BCN on port 0 */ -+ rtw_write8(padapter, REG_CCK_CHECK_8723D, -+ (rtw_read8(padapter, REG_CCK_CHECK_8723D) & ~BIT_BCN_PORT_SEL)); -+ -+ /* dis BCN1 ATIM WND if if2 is station */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL_1); -+ val8 |= DIS_ATIM; -+ rtw_write8(padapter, REG_BCN_CTRL_1, val8); -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+ /* Reset TSF for STA+AP concurrent mode */ -+ if (rtw_mi_buddy_check_fwstate(padapter, -+ (WIFI_STATION_STATE | WIFI_ASOC_STATE))) { -+ if (reset_tsf(padapter, HW_PORT0) == _FALSE) -+ RTW_INFO("ERROR! %s()-%d: Reset port0 TSF fail\n", -+ __FUNCTION__, __LINE__); -+ } -+#endif /* CONFIG_TSF_RESET_OFFLOAD */ -+ } -+#endif /* !CONFIG_MI_WITH_MBSSID_CAM */ -+ } -+} -+ -+static void hw_var_set_bcn_func(PADAPTER padapter, u8 variable, u8 *val) -+{ -+ u32 bcn_ctrl_reg; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->hw_port == HW_PORT1) -+ bcn_ctrl_reg = REG_BCN_CTRL_1; -+ else -+#endif -+ { -+ bcn_ctrl_reg = REG_BCN_CTRL; -+ } -+ -+ if (*(u8 *)val) -+ rtw_write8(padapter, bcn_ctrl_reg, (EN_BCN_FUNCTION | EN_TXBCN_RPT)); -+ else { -+ u8 val8; -+ -+ val8 = rtw_read8(padapter, bcn_ctrl_reg); -+ val8 &= ~(EN_BCN_FUNCTION | EN_TXBCN_RPT); -+#ifdef CONFIG_BT_COEXIST -+ /* Always enable port0 beacon function for PSTDMA */ -+ if (REG_BCN_CTRL == bcn_ctrl_reg) -+ val8 |= EN_BCN_FUNCTION; -+#endif -+ rtw_write8(padapter, bcn_ctrl_reg, val8); -+ } -+} -+ -+static void hw_var_set_correct_tsf(PADAPTER padapter, u8 variable, u8 *val) -+{ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ /*do nothing*/ -+#else -+ u8 val8; -+ u64 tsf; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ tsf = pmlmeext->TSFValue - rtw_modular64(pmlmeext->TSFValue, (pmlmeinfo->bcn_interval * 1024)) - 1024; /* us */ -+ -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || -+ ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) -+ StopTxBeacon(padapter); -+ -+ rtw_hal_correct_tsf(padapter, padapter->hw_port, tsf); -+#ifdef CONFIG_CONCURRENT_MODE -+ /* Update buddy port's TSF if it is SoftAP for beacon TX issue!*/ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE -+ && rtw_mi_check_status(padapter, MI_AP_MODE)) { -+ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ int i; -+ _adapter *iface; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ if (iface == padapter) -+ continue; -+ -+ if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE -+ && check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { -+ rtw_hal_correct_tsf(iface, iface->hw_port, tsf); -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+ if (reset_tsf(iface, iface->hw_port) == _FALSE) -+ RTW_INFO("%s-[ERROR] "ADPT_FMT" Reset port%d TSF fail\n", __func__, ADPT_ARG(iface), iface->hw_port); -+#endif /* CONFIG_TSF_RESET_OFFLOAD*/ -+ } -+ } -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) -+ || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) -+ ResumeTxBeacon(padapter); -+#endif /*CONFIG_MI_WITH_MBSSID_CAM*/ -+} -+ -+static void hw_var_set_mlme_disconnect(PADAPTER padapter, u8 variable, u8 *val) -+{ -+ u8 val8; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) == _FALSE) { -+#else -+ { -+#endif -+ /* Set RCR to not to receive data frame when NO LINK state */ -+ /* rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) & ~RCR_ADF); */ -+ /* reject all data frames */ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0); -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->hw_port == HW_PORT1) { -+ /* reset TSF1 */ -+ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(1)); -+ -+ /* disable update TSF1 */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL_1); -+ val8 |= DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL_1, val8); -+ } else -+#endif -+ { -+ /* reset TSF */ -+ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(0)); -+ -+ /* disable update TSF */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 |= DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ } -+} -+ -+static void hw_var_set_mlme_sitesurvey(PADAPTER padapter, u8 variable, u8 *val) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ u32 value_rcr, rcr_clear_bit; -+ u16 value_rxfltmap2; -+ u8 val8; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ int i = 0; -+ _adapter *iface; -+#ifdef DBG_IFACE_STATUS -+ DBG_IFACE_STATUS_DUMP(padapter); -+#endif -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ rcr_clear_bit = (RCR_CBSSID_BCN | RCR_CBSSID_DATA); -+ -+ /* Receive all data frames */ -+ value_rxfltmap2 = 0xFFFF; -+#else /* CONFIG_FIND_BEST_CHANNEL */ -+ -+ rcr_clear_bit = RCR_CBSSID_BCN; -+ -+ /* config RCR to receive different BSSID & not to receive data frame */ -+ value_rxfltmap2 = 0; -+ -+#endif /* CONFIG_FIND_BEST_CHANNEL */ -+ -+ if (rtw_mi_check_fwstate(padapter, WIFI_AP_STATE)) -+ rcr_clear_bit = RCR_CBSSID_BCN; -+ -+#ifdef CONFIG_TDLS -+ /* TDLS will clear RCR_CBSSID_DATA bit for connection. */ -+ else if (padapter->tdlsinfo.link_established == _TRUE) -+ rcr_clear_bit = RCR_CBSSID_BCN; -+#endif /* CONFIG_TDLS */ -+ -+ value_rcr = rtw_read32(padapter, REG_RCR); -+ -+ if (*((u8 *)val)) {/* under sitesurvey */ -+ /* -+ * 1. configure REG_RXFLTMAP2 -+ * 2. disable TSF update & buddy TSF update to avoid updating wrong TSF due to clear RCR_CBSSID_BCN -+ * 3. config RCR to receive different BSSID BCN or probe rsp -+ */ -+ -+ rtw_write16(padapter, REG_RXFLTMAP2, value_rxfltmap2); -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ /*do nothing~~*/ -+#else -+ -+ /* disable update TSF */ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ -+ if (rtw_linked_check(iface) && -+ check_fwstate(&(iface->mlmepriv), WIFI_AP_STATE) != _TRUE) { -+ if (iface->hw_port == HW_PORT1) -+ rtw_write8(iface, REG_BCN_CTRL_1, rtw_read8(iface, REG_BCN_CTRL_1) | DIS_TSF_UDT); -+ else -+ rtw_write8(iface, REG_BCN_CTRL, rtw_read8(iface, REG_BCN_CTRL) | DIS_TSF_UDT); -+ -+ iface->mlmeextpriv.en_hw_update_tsf = _FALSE; -+ } -+ -+ } -+#endif -+ -+ value_rcr &= ~(rcr_clear_bit); -+ rtw_write32(padapter, REG_RCR, value_rcr); -+ -+ /* Save orignal RRSR setting. */ -+ pHalData->RegRRSR = rtw_read16(padapter, REG_RRSR); -+ -+ if (rtw_mi_check_status(padapter, MI_AP_MODE)) -+ StopTxBeacon(padapter); -+ } else {/* sitesurvey done */ -+ /* -+ * 1. enable rx data frame -+ * 2. config RCR not to receive different BSSID BCN or probe rsp -+ * 3. doesn't enable TSF update & buddy TSF right now to avoid HW conflict -+ *so, we enable TSF update when rx first BCN after sitesurvey done -+ */ -+ if (rtw_mi_check_fwstate(padapter, _FW_LINKED | WIFI_AP_STATE)) { -+ /*enable to rx data frame*/ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); -+ } -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ value_rcr &= ~(RCR_CBSSID_BCN | RCR_CBSSID_DATA); -+#else -+ value_rcr |= rcr_clear_bit; -+#endif -+ /* for 11n Logo 4.2.31/4.2.32, disable BSSID BCN check for AP mode */ -+ if (padapter->registrypriv.wifi_spec && MLME_IS_AP(padapter)) -+ value_rcr &= ~(RCR_CBSSID_BCN); -+ -+ rtw_write32(padapter, REG_RCR, value_rcr); -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ /*if ((rtw_mi_get_assoced_sta_num(Adapter) == 1) && (!rtw_mi_check_status(Adapter, MI_AP_MODE))) -+ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)&(~DIS_TSF_UDT));*/ -+#else -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (!iface) -+ continue; -+ if (rtw_linked_check(iface) && -+ check_fwstate(&(iface->mlmepriv), WIFI_AP_STATE) != _TRUE) { -+ /* enable HW TSF update when recive beacon*/ -+ /*if (iface->hw_port == HW_PORT1) -+ rtw_write8(iface, REG_BCN_CTRL_1, rtw_read8(iface, REG_BCN_CTRL_1)&(~(DIS_TSF_UDT))); -+ else -+ rtw_write8(iface, REG_BCN_CTRL, rtw_read8(iface, REG_BCN_CTRL)&(~(DIS_TSF_UDT))); -+ */ -+ iface->mlmeextpriv.en_hw_update_tsf = _TRUE; -+ } -+ } -+#endif -+ -+ /*Restore orignal RRSR setting.*/ -+ rtw_write16(padapter, REG_RRSR, pHalData->RegRRSR); -+#ifdef CONFIG_AP_MODE -+ if (rtw_mi_check_status(padapter, MI_AP_MODE)) { -+ ResumeTxBeacon(padapter); -+ rtw_mi_tx_beacon_hdl(padapter); -+ } -+#endif -+ } -+} -+ -+static void hw_var_set_mlme_join(PADAPTER padapter, u8 variable, u8 *val) -+{ -+ u8 val8; -+ u16 val16; -+ u32 val32; -+ u8 RetryLimit; -+ u8 type; -+ PHAL_DATA_TYPE pHalData; -+ struct mlme_priv *pmlmepriv; -+ -+ RetryLimit = 0x30; -+ type = *(u8 *)val; -+ pHalData = GET_HAL_DATA(padapter); -+ pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_CONCURRENT_MODE -+ if (type == 0) { -+ /* prepare to join */ -+ if (rtw_mi_check_status(padapter, MI_AP_MODE)) -+ StopTxBeacon(padapter); -+ -+ /* enable to rx data frame.Accept all data frame */ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ /* -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && (rtw_mi_get_assoced_sta_num(padapter) == 1)) -+ rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_CBSSID_DATA|RCR_CBSSID_BCN); -+ else if ((rtw_mi_get_ap_num(Adapter) == 1) && (rtw_mi_get_assoced_sta_num(Adapter) == 1)) -+ rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_CBSSID_BCN); -+ else*/ -+ rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) & (~(RCR_CBSSID_DATA | RCR_CBSSID_BCN))); -+#else -+ if (rtw_mi_check_status(padapter, MI_AP_MODE)) { -+ val32 = rtw_read32(padapter, REG_RCR); -+ val32 |= RCR_CBSSID_BCN; -+ rtw_write32(padapter, REG_RCR, val32); -+ } else { -+ val32 = rtw_read32(padapter, REG_RCR); -+ val32 |= RCR_CBSSID_DATA | RCR_CBSSID_BCN; -+ rtw_write32(padapter, REG_RCR, val32); -+ } -+#endif -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ RetryLimit = (pHalData->CustomerID == RT_CID_CCX) ? 7 : 48; -+ else /* Ad-hoc Mode */ -+ RetryLimit = 0x7; -+ } else if (type == 1) { -+ /* joinbss_event call back when join res < 0 */ -+ if (rtw_mi_check_status(padapter, MI_LINKED) == _FALSE) -+ rtw_write16(padapter, REG_RXFLTMAP2, 0x00); -+ -+ if (rtw_mi_check_status(padapter, MI_AP_MODE)) { -+ ResumeTxBeacon(padapter); -+ /* reset TSF 1/2 after ResumeTxBeacon */ -+ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(1) | BIT(0)); -+ } -+ } else if (type == 2) { -+ /* sta add event call back */ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ /*if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && (rtw_mi_get_assoced_sta_num(padapter) == 1)) -+ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)&(~DIS_TSF_UDT));*/ -+#else -+ /* enable update TSF */ -+ if (padapter->hw_port == HW_PORT1) { -+ val8 = rtw_read8(padapter, REG_BCN_CTRL_1); -+ val8 &= ~DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL_1, val8); -+ } else { -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 &= ~DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ } -+#endif -+ if (check_fwstate(pmlmepriv, -+ WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { -+ rtw_write8(padapter, 0x542 , 0x02); -+ RetryLimit = 0x7; -+ } -+ -+ if (rtw_mi_check_status(padapter, MI_AP_MODE)) { -+ ResumeTxBeacon(padapter); -+ -+ /* reset TSF 1/2 after ResumeTxBeacon */ -+ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(1) | BIT(0)); -+ } -+ } -+ -+ val16 = (RetryLimit << RETRY_LIMIT_SHORT_SHIFT) | (RetryLimit << RETRY_LIMIT_LONG_SHIFT); -+ rtw_write16(padapter, REG_RL, val16); -+#else /* !CONFIG_CONCURRENT_MODE */ -+ if (type == 0) { /* prepare to join */ -+ /* enable to rx data frame.Accept all data frame */ -+ /* rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_ADF); */ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); -+ -+ val32 = rtw_read32(padapter, REG_RCR); -+ if (padapter->in_cta_test) -+ val32 &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN);/* | RCR_ADF */ -+ else -+ val32 |= RCR_CBSSID_DATA | RCR_CBSSID_BCN; -+ rtw_write32(padapter, REG_RCR, val32); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ RetryLimit = (pHalData->CustomerID == RT_CID_CCX) ? 7 : 48; -+ else /* Ad-hoc Mode */ -+ RetryLimit = 0x7; -+ } else if (type == 1) /* joinbss_event call back when join res < 0 */ -+ rtw_write16(padapter, REG_RXFLTMAP2, 0x00); -+ else if (type == 2) { /* sta add event call back */ -+ /* enable update TSF */ -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 &= ~DIS_TSF_UDT; -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) -+ RetryLimit = 0x7; -+ } -+ -+ val16 = (RetryLimit << RETRY_LIMIT_SHORT_SHIFT) | (RetryLimit << RETRY_LIMIT_LONG_SHIFT); -+ rtw_write16(padapter, REG_RL, val16); -+#endif /* !CONFIG_CONCURRENT_MODE */ -+} -+ -+void CCX_FwC2HTxRpt_8723d(PADAPTER padapter, u8 *pdata, u8 len) -+{ -+ u8 seq_no; -+ -+#define GET_8723D_C2H_TX_RPT_LIFE_TIME_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 6, 1) -+#define GET_8723D_C2H_TX_RPT_RETRY_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 7, 1) -+ -+ /* RTW_INFO("%s, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n", __func__, */ -+ /**pdata, *(pdata+1), *(pdata+2), *(pdata+3), *(pdata+4), *(pdata+5), *(pdata+6), *(pdata+7)); */ -+ -+ seq_no = *(pdata + 6); -+ -+#ifdef CONFIG_XMIT_ACK -+ if (GET_8723D_C2H_TX_RPT_RETRY_OVER(pdata) | GET_8723D_C2H_TX_RPT_LIFE_TIME_OVER(pdata)) -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_CCX_PKT_FAIL); -+ /* -+ else if(seq_no != padapter->xmitpriv.seq_no) { -+ RTW_INFO("tx_seq_no=%d, rpt_seq_no=%d\n", padapter->xmitpriv.seq_no, seq_no); -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_CCX_PKT_FAIL); -+ } -+ */ -+ else -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_SUCCESS); -+#endif -+} -+ -+s32 c2h_handler_8723d(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) -+{ -+ s32 ret = _SUCCESS; -+ -+ switch (id) { -+ case C2H_CCX_TX_RPT: -+ CCX_FwC2HTxRpt_8723d(adapter, payload, plen); -+ break; -+ default: -+ ret = _FAIL; -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ u8 val8; -+ u16 val16; -+ u32 val32; -+ -+ -+ switch (variable) { -+ case HW_VAR_SET_OPMODE: -+ hw_var_set_opmode(padapter, variable, val); -+ break; -+ -+ case HW_VAR_BASIC_RATE: -+ { -+ struct mlme_ext_info *mlmext_info = &padapter->mlmeextpriv.mlmext_info; -+ u16 input_b = 0, masked = 0, ioted = 0, BrateCfg = 0; -+ u16 rrsr_2g_force_mask = RRSR_CCK_RATES; -+ u16 rrsr_2g_allow_mask = (RRSR_24M | RRSR_12M | RRSR_6M | RRSR_CCK_RATES); -+ -+ HalSetBrateCfg(padapter, val, &BrateCfg); -+ input_b = BrateCfg; -+ -+ /* apply force and allow mask */ -+ BrateCfg |= rrsr_2g_force_mask; -+ BrateCfg &= rrsr_2g_allow_mask; -+ masked = BrateCfg; -+ -+#ifdef CONFIG_CMCC_TEST -+ BrateCfg |= (RRSR_11M | RRSR_5_5M | RRSR_1M); /* use 11M to send ACK */ -+ BrateCfg |= (RRSR_24M | RRSR_18M | RRSR_12M); /* CMCC_OFDM_ACK 12/18/24M */ -+#endif -+ -+ /* IOT consideration */ -+ if (mlmext_info->assoc_AP_vendor == HT_IOT_PEER_CISCO) { -+ /* if peer is cisco and didn't use ofdm rate, we enable 6M ack */ -+ if ((BrateCfg & (RRSR_24M | RRSR_12M | RRSR_6M)) == 0) -+ BrateCfg |= RRSR_6M; -+ } -+ ioted = BrateCfg; -+ -+ pHalData->BasicRateSet = BrateCfg; -+ -+ RTW_INFO("HW_VAR_BASIC_RATE: %#x->%#x->%#x\n", input_b, masked, ioted); -+ -+ /* Set RRSR rate table. */ -+ rtw_write16(padapter, REG_RRSR, BrateCfg); -+ rtw_write8(padapter, REG_RRSR + 2, rtw_read8(padapter, REG_RRSR + 2) & 0xf0); -+ } -+ break; -+ -+ case HW_VAR_TXPAUSE: -+ rtw_write8(padapter, REG_TXPAUSE, *val); -+ break; -+ -+ case HW_VAR_BCN_FUNC: -+ hw_var_set_bcn_func(padapter, variable, val); -+ break; -+ -+ case HW_VAR_CORRECT_TSF: -+ hw_var_set_correct_tsf(padapter, variable, val); -+ break; -+ -+ case HW_VAR_CHECK_BSSID: -+ { -+ u32 val32; -+ val32 = rtw_read32(padapter, REG_RCR); -+ if (*val) -+ val32 |= RCR_CBSSID_DATA | RCR_CBSSID_BCN; -+ else -+ val32 &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN); -+ rtw_write32(padapter, REG_RCR, val32); -+ } -+ break; -+ -+ case HW_VAR_MLME_DISCONNECT: -+ hw_var_set_mlme_disconnect(padapter, variable, val); -+ break; -+ -+ case HW_VAR_MLME_SITESURVEY: -+ hw_var_set_mlme_sitesurvey(padapter, variable, val); -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_ScanNotify(padapter, *val ? _TRUE : _FALSE); -+#endif /* CONFIG_BT_COEXIST */ -+ break; -+ -+ case HW_VAR_MLME_JOIN: -+ hw_var_set_mlme_join(padapter, variable, val); -+ -+#ifdef CONFIG_BT_COEXIST -+ switch (*val) { -+ case 0: -+ /* prepare to join */ -+ rtw_btcoex_ConnectNotify(padapter, _TRUE); -+ break; -+ case 1: -+ case 2: -+ rtw_btcoex_ConnectNotify(padapter, _FALSE); -+ break; -+ } -+#endif /* CONFIG_BT_COEXIST */ -+ break; -+ -+ case HW_VAR_ON_RCR_AM: -+ val32 = rtw_read32(padapter, REG_RCR); -+ val32 |= RCR_AM; -+ rtw_write32(padapter, REG_RCR, val32); -+ RTW_INFO("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(padapter, REG_RCR)); -+ break; -+ -+ case HW_VAR_OFF_RCR_AM: -+ val32 = rtw_read32(padapter, REG_RCR); -+ val32 &= ~RCR_AM; -+ rtw_write32(padapter, REG_RCR, val32); -+ RTW_INFO("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(padapter, REG_RCR)); -+ break; -+ -+ case HW_VAR_BEACON_INTERVAL: -+ rtw_write16(padapter, REG_BCN_INTERVAL, *((u16 *)val)); -+ break; -+ -+ case HW_VAR_SLOT_TIME: -+ rtw_write8(padapter, REG_SLOT, *val); -+ break; -+ -+ case HW_VAR_RESP_SIFS: -+#if 0 -+ /* SIFS for OFDM Data ACK */ -+ rtw_write8(padapter, REG_SIFS_CTX + 1, val[0]); -+ /* SIFS for OFDM consecutive tx like CTS data! */ -+ rtw_write8(padapter, REG_SIFS_TRX + 1, val[1]); -+ -+ rtw_write8(padapter, REG_SPEC_SIFS + 1, val[0]); -+ rtw_write8(padapter, REG_MAC_SPEC_SIFS + 1, val[0]); -+ -+ /* 20100719 Joseph: Revise SIFS setting due to Hardware register definition change. */ -+ rtw_write8(padapter, REG_R2T_SIFS + 1, val[0]); -+ rtw_write8(padapter, REG_T2T_SIFS + 1, val[0]); -+ -+#else -+ /* SIFS_Timer = 0x0a0a0808; */ -+ /* RESP_SIFS for CCK */ -+ rtw_write8(padapter, REG_RESP_SIFS_CCK, val[0]); /* SIFS_T2T_CCK (0x08) */ -+ rtw_write8(padapter, REG_RESP_SIFS_CCK + 1, val[1]); /* SIFS_R2T_CCK(0x08) */ -+ /* RESP_SIFS for OFDM */ -+ rtw_write8(padapter, REG_RESP_SIFS_OFDM, val[2]); /* SIFS_T2T_OFDM (0x0a) */ -+ rtw_write8(padapter, REG_RESP_SIFS_OFDM + 1, val[3]); /* SIFS_R2T_OFDM(0x0a) */ -+#endif -+ break; -+ -+ case HW_VAR_ACK_PREAMBLE: { -+ u8 regTmp; -+ u8 bShortPreamble = *val; -+ -+ /* Joseph marked out for Netgear 3500 TKIP channel 7 issue.(Temporarily) */ -+ /* regTmp = (pHalData->nCur40MhzPrimeSC)<<5; */ -+ regTmp = 0; -+ if (bShortPreamble) -+ regTmp |= 0x80; -+ rtw_write8(padapter, REG_RRSR + 2, regTmp); -+ } -+ break; -+ -+ case HW_VAR_CAM_EMPTY_ENTRY: { -+ u8 ucIndex = *val; -+ u8 i; -+ u32 ulCommand = 0; -+ u32 ulContent = 0; -+ u32 ulEncAlgo = CAM_AES; -+ -+ for (i = 0; i < CAM_CONTENT_COUNT; i++) { -+ /* filled id in CAM config 2 byte */ -+ if (i == 0) { -+ ulContent |= (ucIndex & 0x03) | ((u16)(ulEncAlgo) << 2); -+ /* ulContent |= CAM_VALID; */ -+ } else -+ ulContent = 0; -+ /* polling bit, and No Write enable, and address */ -+ ulCommand = CAM_CONTENT_COUNT * ucIndex + i; -+ ulCommand = ulCommand | CAM_POLLINIG | CAM_WRITE; -+ /* write content 0 is equall to mark invalid */ -+ rtw_write32(padapter, WCAMI, ulContent); /* delay_ms(40); */ -+ rtw_write32(padapter, RWCAM, ulCommand); /* delay_ms(40); */ -+ } -+ } -+ break; -+ -+ case HW_VAR_CAM_INVALID_ALL: -+ rtw_write32(padapter, RWCAM, BIT(31) | BIT(30)); -+ break; -+ -+ case HW_VAR_AC_PARAM_VO: -+ rtw_write32(padapter, REG_EDCA_VO_PARAM, *((u32 *)val)); -+ break; -+ -+ case HW_VAR_AC_PARAM_VI: -+ rtw_write32(padapter, REG_EDCA_VI_PARAM, *((u32 *)val)); -+ break; -+ -+ case HW_VAR_AC_PARAM_BE: -+ pHalData->AcParam_BE = ((u32 *)(val))[0]; -+ rtw_write32(padapter, REG_EDCA_BE_PARAM, *((u32 *)val)); -+ break; -+ -+ case HW_VAR_AC_PARAM_BK: -+ rtw_write32(padapter, REG_EDCA_BK_PARAM, *((u32 *)val)); -+ break; -+ -+ case HW_VAR_ACM_CTRL: { -+ u8 ctrl = *((u8 *)val); -+ u8 hwctrl = 0; -+ -+ if (ctrl != 0) { -+ hwctrl |= AcmHw_HwEn; -+ -+ if (ctrl & BIT(1)) /* BE */ -+ hwctrl |= AcmHw_BeqEn; -+ -+ if (ctrl & BIT(2)) /* VI */ -+ hwctrl |= AcmHw_ViqEn; -+ -+ if (ctrl & BIT(3)) /* VO */ -+ hwctrl |= AcmHw_VoqEn; -+ } -+ -+ RTW_INFO("[HW_VAR_ACM_CTRL] Write 0x%02X\n", hwctrl); -+ rtw_write8(padapter, REG_ACMHWCTRL, hwctrl); -+ } -+ break; -+ -+ case HW_VAR_AMPDU_FACTOR: { -+#ifdef CONFIG_80211N_HT -+ u32 AMPDULen = (*((u8 *)val)); -+ -+ if (AMPDULen < HT_AGG_SIZE_32K) -+ AMPDULen = (0x2000 << (*((u8 *)val))) - 1; -+ else -+ AMPDULen = 0x7fff; -+ -+ rtw_write32(padapter, REG_AMPDU_MAX_LENGTH_8723D, AMPDULen); -+#endif /* CONFIG_80211N_HT */ -+ } -+ break; -+ -+#if 0 -+ case HW_VAR_RXDMA_AGG_PG_TH: -+ rtw_write8(padapter, REG_RXDMA_AGG_PG_TH, *val); -+ break; -+#endif -+ -+ case HW_VAR_H2C_FW_PWRMODE: { -+ u8 psmode = *val; -+ -+ /* Forece leave RF low power mode for 1T1R to prevent conficting setting in Fw power */ -+ /* saving sequence. 2010.06.07. Added by tynli. Suggested by SD3 yschang. */ -+ if (psmode != PS_MODE_ACTIVE) -+ ODM_RF_Saving(&pHalData->odmpriv, _TRUE); -+ -+ /* if (psmode != PS_MODE_ACTIVE) { */ -+ /*rtl8723d_set_lowpwr_lps_cmd(padapter, _TRUE); */ -+ /* } else { */ -+ /* rtl8723d_set_lowpwr_lps_cmd(padapter, _FALSE); */ -+ /* } */ -+ rtl8723d_set_FwPwrMode_cmd(padapter, psmode); -+ } -+ break; -+ case HW_VAR_H2C_PS_TUNE_PARAM: -+ rtl8723d_set_FwPsTuneParam_cmd(padapter); -+ break; -+ -+ case HW_VAR_H2C_FW_JOINBSSRPT: -+ rtl8723d_set_FwJoinBssRpt_cmd(padapter, *val); -+#ifdef CONFIG_LPS_POFF -+ rtl8723d_lps_poff_h2c_ctrl(padapter, *val); -+#endif -+ break; -+ -+#ifdef CONFIG_P2P -+ case HW_VAR_H2C_FW_P2P_PS_OFFLOAD: -+ rtl8723d_set_p2p_ps_offload_cmd(padapter, *val); -+ break; -+#endif /* CONFIG_P2P */ -+#ifdef CONFIG_LPS_POFF -+ case HW_VAR_LPS_POFF_INIT: -+ rtl8723d_lps_poff_init(padapter); -+ break; -+ case HW_VAR_LPS_POFF_DEINIT: -+ rtl8723d_lps_poff_deinit(padapter); -+ break; -+ case HW_VAR_LPS_POFF_SET_MODE: -+ rtl8723d_lps_poff_set_ps_mode(padapter, *val); -+ break; -+ case HW_VAR_LPS_POFF_WOW_EN: -+ rtl8723d_lps_poff_h2c_ctrl(padapter, *val); -+ break; -+#endif /*CONFIG_LPS_POFF*/ -+#ifdef CONFIG_TDLS -+ case HW_VAR_TDLS_WRCR: -+ rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) & (~RCR_CBSSID_DATA)); -+ break; -+ case HW_VAR_TDLS_RS_RCR: -+ rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) | (RCR_CBSSID_DATA)); -+ break; -+#endif /* CONFIG_TDLS */ -+ -+ case HW_VAR_EFUSE_USAGE: -+ pHalData->EfuseUsedPercentage = *val; -+ break; -+ -+ case HW_VAR_EFUSE_BYTES: -+ pHalData->EfuseUsedBytes = *((u16 *)val); -+ break; -+ -+ case HW_VAR_EFUSE_BT_USAGE: -+#ifdef HAL_EFUSE_MEMORY -+ pHalData->EfuseHal.BTEfuseUsedPercentage = *val; -+#endif -+ break; -+ -+ case HW_VAR_EFUSE_BT_BYTES: -+#ifdef HAL_EFUSE_MEMORY -+ pHalData->EfuseHal.BTEfuseUsedBytes = *((u16 *)val); -+#else -+ BTEfuseUsedBytes = *((u16 *)val); -+#endif -+ break; -+ -+ case HW_VAR_FIFO_CLEARN_UP: { -+#define RW_RELEASE_EN BIT(18) -+#define RXDMA_IDLE BIT(17) -+ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ u8 trycnt = 100; -+ -+ /* pause tx */ -+ rtw_write8(padapter, REG_TXPAUSE, 0xff); -+ -+ /* keep sn */ -+ padapter->xmitpriv.nqos_ssn = rtw_read16(padapter, REG_NQOS_SEQ); -+ -+ if (pwrpriv->bkeepfwalive != _TRUE) { -+ /* RX DMA stop */ -+ val32 = rtw_read32(padapter, REG_RXPKT_NUM); -+ val32 |= RW_RELEASE_EN; -+ rtw_write32(padapter, REG_RXPKT_NUM, val32); -+ do { -+ val32 = rtw_read32(padapter, REG_RXPKT_NUM); -+ val32 &= RXDMA_IDLE; -+ if (val32) -+ break; -+ -+ RTW_INFO("%s: [HW_VAR_FIFO_CLEARN_UP] val=%x times:%d\n", __FUNCTION__, val32, trycnt); -+ } while (--trycnt); -+ if (trycnt == 0) -+ RTW_INFO("[HW_VAR_FIFO_CLEARN_UP] Stop RX DMA failed......\n"); -+ -+ /* RQPN Load 0 */ -+ rtw_write16(padapter, REG_RQPN_NPQ, 0); -+ rtw_write32(padapter, REG_RQPN, 0x80000000); -+ rtw_mdelay_os(2); -+ } -+ } -+ break; -+ -+ case HW_VAR_RESTORE_HW_SEQ: -+ /* restore Sequence No. */ -+ rtw_write8(padapter, 0x4dc, padapter->xmitpriv.nqos_ssn); -+ break; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ case HW_VAR_CHECK_TXBUF: { -+ u32 i; -+ u8 RetryLimit = 0x01; -+ u32 reg_200, reg_204; -+ -+ val16 = RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT; -+ rtw_write16(padapter, REG_RL, val16); -+ -+ for (i = 0; i < 200; i++) { /* polling 200x10=2000 msec */ -+ reg_200 = rtw_read32(padapter, 0x200); -+ reg_204 = rtw_read32(padapter, 0x204); -+ if (reg_200 != reg_204) { -+ /* RTW_INFO("packet in tx packet buffer - 0x204=%x, 0x200=%x (%d)\n", rtw_read32(padapter, 0x204), rtw_read32(padapter, 0x200), i); */ -+ rtw_msleep_os(10); -+ } else { -+ RTW_INFO("[HW_VAR_CHECK_TXBUF] no packet in tx packet buffer (%d)\n", i); -+ break; -+ } -+ } -+ -+ if (reg_200 != reg_204) -+ RTW_INFO("packets in tx buffer - 0x204=%x, 0x200=%x\n", reg_204, reg_200); -+ -+ RetryLimit = 0x30; -+ val16 = RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT; -+ rtw_write16(padapter, REG_RL, val16); -+ } -+ break; -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ case HW_VAR_NAV_UPPER: { -+ u32 usNavUpper = *((u32 *)val); -+ -+ if (usNavUpper > HAL_NAV_UPPER_UNIT_8723D * 0xFF) { -+ break; -+ } -+ -+ /* The value of ((usNavUpper + HAL_NAV_UPPER_UNIT_8723D - 1) / HAL_NAV_UPPER_UNIT_8723D) */ -+ /* is getting the upper integer. */ -+ usNavUpper = (usNavUpper + HAL_NAV_UPPER_UNIT_8723D - 1) / HAL_NAV_UPPER_UNIT_8723D; -+ rtw_write8(padapter, REG_NAV_UPPER, (u8)usNavUpper); -+ } -+ break; -+ -+ case HW_VAR_BCN_VALID: -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->hw_port == HW_PORT1) { -+ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8723D + 2); -+ val8 |= BIT(0); -+ rtw_write8(padapter, REG_DWBCN1_CTRL_8723D + 2, val8); -+ } else -+#endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ /* BCN_VALID, BIT16 of REG_TDECTRL = BIT0 of REG_TDECTRL+2, write 1 to clear, Clear by sw */ -+ val8 = rtw_read8(padapter, REG_TDECTRL + 2); -+ val8 |= BIT(0); -+ rtw_write8(padapter, REG_TDECTRL + 2, val8); -+ } -+ break; -+ case HW_VAR_DL_BCN_SEL: -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->hw_port == HW_PORT1) { -+ /* SW_BCN_SEL - Port1 */ -+ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8723D + 2); -+ val8 |= BIT(4); -+ rtw_write8(padapter, REG_DWBCN1_CTRL_8723D + 2, val8); -+ } else -+#endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ /* SW_BCN_SEL - Port0 */ -+ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8723D + 2); -+ val8 &= ~BIT(4); -+ rtw_write8(padapter, REG_DWBCN1_CTRL_8723D + 2, val8); -+ } -+ break; -+ case HW_VAR_DO_IQK: -+ if (*val) -+ pHalData->bNeedIQK = _TRUE; -+ else -+ pHalData->bNeedIQK = _FALSE; -+ break; -+ -+ case HW_VAR_DL_RSVD_PAGE: -+#ifdef CONFIG_BT_COEXIST -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) -+ rtl8723d_download_BTCoex_AP_mode_rsvd_page(padapter); -+ else -+#endif /* CONFIG_BT_COEXIST */ -+ { -+ rtl8723d_download_rsvd_page(padapter, RT_MEDIA_CONNECT); -+ } -+ break; -+ -+ case HW_VAR_MACID_SLEEP: { -+ u32 reg_macid_sleep; -+ u8 bit_shift; -+ u8 id = *(u8 *)val; -+ -+ if (id < 32) { -+ reg_macid_sleep = REG_MACID_SLEEP; -+ bit_shift = id; -+ } else if (id < 64) { -+ reg_macid_sleep = REG_MACID_SLEEP_1; -+ bit_shift = id - 32; -+ } else if (id < 96) { -+ reg_macid_sleep = REG_MACID_SLEEP_2; -+ bit_shift = id - 64; -+ } else if (id < 128) { -+ reg_macid_sleep = REG_MACID_SLEEP_3; -+ bit_shift = id - 96; -+ } else { -+ rtw_warn_on(1); -+ break; -+ } -+ -+ val32 = rtw_read32(padapter, reg_macid_sleep); -+ RTW_INFO(FUNC_ADPT_FMT ": [HW_VAR_MACID_SLEEP] macid=%d, org reg_0x%03x=0x%08X\n", -+ FUNC_ADPT_ARG(padapter), id, reg_macid_sleep, val32); -+ -+ if (val32 & BIT(bit_shift)) -+ break; -+ -+ val32 |= BIT(bit_shift); -+ rtw_write32(padapter, reg_macid_sleep, val32); -+ } -+ break; -+ case HW_VAR_MACID_WAKEUP: { -+ u32 reg_macid_sleep; -+ u8 bit_shift; -+ u8 id = *(u8 *)val; -+ -+ if (id < 32) { -+ reg_macid_sleep = REG_MACID_SLEEP; -+ bit_shift = id; -+ } else if (id < 64) { -+ reg_macid_sleep = REG_MACID_SLEEP_1; -+ bit_shift = id - 32; -+ } else if (id < 96) { -+ reg_macid_sleep = REG_MACID_SLEEP_2; -+ bit_shift = id - 64; -+ } else if (id < 128) { -+ reg_macid_sleep = REG_MACID_SLEEP_3; -+ bit_shift = id - 96; -+ } else { -+ rtw_warn_on(1); -+ break; -+ } -+ -+ val32 = rtw_read32(padapter, reg_macid_sleep); -+ RTW_INFO(FUNC_ADPT_FMT ": [HW_VAR_MACID_WAKEUP] macid=%d, org reg_0x%03x=0x%08X\n", -+ FUNC_ADPT_ARG(padapter), id, reg_macid_sleep, val32); -+ -+ if (!(val32 & BIT(bit_shift))) -+ break; -+ -+ val32 &= ~BIT(bit_shift); -+ rtw_write32(padapter, reg_macid_sleep, val32); -+ } -+ break; -+ default: -+ SetHwReg(padapter, variable, val); -+ break; -+ } -+ -+} -+ -+struct qinfo_8723d { -+ u32 head:8; -+ u32 pkt_num:7; -+ u32 tail:8; -+ u32 ac:2; -+ u32 macid:7; -+}; -+ -+struct bcn_qinfo_8723d { -+ u16 head:8; -+ u16 pkt_num:8; -+}; -+ -+void dump_qinfo_8723d(void *sel, struct qinfo_8723d *info, const char *tag) -+{ -+ /* if (info->pkt_num) */ -+ RTW_PRINT_SEL(sel, "%shead:0x%02x, tail:0x%02x, pkt_num:%u, macid:%u, ac:%u\n" -+ , tag ? tag : "", info->head, info->tail, -+ info->pkt_num, info->macid, info->ac); -+} -+ -+void dump_bcn_qinfo_8723d(void *sel, struct bcn_qinfo_8723d *info, const char *tag) -+{ -+ /* if (info->pkt_num) */ -+ RTW_PRINT_SEL(sel, "%shead:0x%02x, pkt_num:%u\n" -+ , tag ? tag : "", info->head, info->pkt_num); -+} -+ -+void dump_mac_qinfo_8723d(void *sel, _adapter *adapter) -+{ -+ u32 q0_info; -+ u32 q1_info; -+ u32 q2_info; -+ u32 q3_info; -+ u32 q4_info; -+ u32 q5_info; -+ u32 q6_info; -+ u32 q7_info; -+ u32 mg_q_info; -+ u32 hi_q_info; -+ u16 bcn_q_info; -+ -+ q0_info = rtw_read32(adapter, REG_Q0_INFO); -+ q1_info = rtw_read32(adapter, REG_Q1_INFO); -+ q2_info = rtw_read32(adapter, REG_Q2_INFO); -+ q3_info = rtw_read32(adapter, REG_Q3_INFO); -+ q4_info = rtw_read32(adapter, REG_Q4_INFO); -+ q5_info = rtw_read32(adapter, REG_Q5_INFO); -+ q6_info = rtw_read32(adapter, REG_Q6_INFO); -+ q7_info = rtw_read32(adapter, REG_Q7_INFO); -+ mg_q_info = rtw_read32(adapter, REG_MGQ_INFO); -+ hi_q_info = rtw_read32(adapter, REG_HGQ_INFO); -+ bcn_q_info = rtw_read16(adapter, REG_BCNQ_INFO); -+ -+ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q0_info, "Q0 "); -+ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q1_info, "Q1 "); -+ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q2_info, "Q2 "); -+ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q3_info, "Q3 "); -+ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q4_info, "Q4 "); -+ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q5_info, "Q5 "); -+ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q6_info, "Q6 "); -+ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&q7_info, "Q7 "); -+ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&mg_q_info, "MG "); -+ dump_qinfo_8723d(sel, (struct qinfo_8723d *)&hi_q_info, "HI "); -+ dump_bcn_qinfo_8723d(sel, (struct bcn_qinfo_8723d *)&bcn_q_info, "BCN "); -+} -+ -+void GetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ u8 val8; -+ u16 val16; -+ u32 val32; -+ -+ switch (variable) { -+ case HW_VAR_TXPAUSE: -+ *val = rtw_read8(padapter, REG_TXPAUSE); -+ break; -+ -+ case HW_VAR_BCN_VALID: -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->hw_port == HW_PORT1) { -+ val8 = rtw_read8(padapter, REG_DWBCN1_CTRL_8723D + 2); -+ *val = (BIT(0) & val8) ? _TRUE : _FALSE; -+ } else -+#endif -+ { -+ /* BCN_VALID, BIT16 of REG_TDECTRL = BIT0 of REG_TDECTRL+2 */ -+ val8 = rtw_read8(padapter, REG_TDECTRL + 2); -+ *val = (BIT(0) & val8) ? _TRUE : _FALSE; -+ } -+ break; -+ -+ case HW_VAR_FWLPS_RF_ON: { -+ /* When we halt NIC, we should check if FW LPS is leave. */ -+ u32 valRCR; -+ -+ if (rtw_is_surprise_removed(padapter) || -+ (adapter_to_pwrctl(padapter)->rf_pwrstate == rf_off)) { -+ /* If it is in HW/SW Radio OFF or IPS state, we do not check Fw LPS Leave, */ -+ /* because Fw is unload. */ -+ *val = _TRUE; -+ } else { -+ valRCR = rtw_read32(padapter, REG_RCR); -+ valRCR &= 0x00070000; -+ if (valRCR) -+ *val = _FALSE; -+ else -+ *val = _TRUE; -+ } -+ } -+ break; -+ -+ case HW_VAR_EFUSE_USAGE: -+ *val = pHalData->EfuseUsedPercentage; -+ break; -+ -+ case HW_VAR_EFUSE_BYTES: -+ *((u16 *)val) = pHalData->EfuseUsedBytes; -+ break; -+ -+ case HW_VAR_EFUSE_BT_USAGE: -+#ifdef HAL_EFUSE_MEMORY -+ *val = pHalData->EfuseHal.BTEfuseUsedPercentage; -+#endif -+ break; -+ -+ case HW_VAR_EFUSE_BT_BYTES: -+#ifdef HAL_EFUSE_MEMORY -+ *((u16 *)val) = pHalData->EfuseHal.BTEfuseUsedBytes; -+#else -+ *((u16 *)val) = BTEfuseUsedBytes; -+#endif -+ break; -+ -+ case HW_VAR_CHK_HI_QUEUE_EMPTY: -+ val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); -+ *val = (val16 & BIT(10)) ? _TRUE : _FALSE; -+ break; -+#ifdef CONFIG_WOWLAN -+ case HW_VAR_RPWM_TOG: -+ *val = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1) & BIT(7); -+ break; -+ case HW_VAR_WAKEUP_REASON: -+ *val = rtw_read8(padapter, REG_WOWLAN_WAKE_REASON); -+ if (*val == 0xEA) -+ *val = 0; -+ break; -+ case HW_VAR_SYS_CLKR: -+ *val = rtw_read8(padapter, REG_SYS_CLKR); -+ break; -+#endif -+ case HW_VAR_DUMP_MAC_QUEUE_INFO: -+ dump_mac_qinfo_8723d(val, padapter); -+ break; -+ default: -+ GetHwReg(padapter, variable, val); -+ break; -+ } -+} -+ -+/* -+ * Description: -+ * Change default setting of specified variable. -+ */ -+u8 SetHalDefVar8723D(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 bResult; -+ -+ bResult = _SUCCESS; -+ -+ switch (variable) { -+ default: -+ bResult = SetHalDefVar(padapter, variable, pval); -+ break; -+ } -+ -+ return bResult; -+} -+ -+void hal_ra_info_dump(_adapter *padapter , void *sel) -+{ -+ int i; -+ u8 mac_id; -+ u32 cmd; -+ u32 ra_info1, ra_info2, bw_set; -+ u32 rate_mask1, rate_mask2; -+ u8 curr_tx_rate, curr_tx_sgi, hight_rate, lowest_rate; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ HAL_DATA_TYPE *HalData = GET_HAL_DATA(padapter); -+ -+ for (i = 0; i < macid_ctl->num; i++) { -+ -+ if (rtw_macid_is_used(macid_ctl, i) && !rtw_macid_is_bmc(macid_ctl, i)) { -+ -+ mac_id = (u8) i; -+ _RTW_PRINT_SEL(sel , "============ RA status check Mac_id:%d ===================\n", mac_id); -+ -+ cmd = 0x40000100 | mac_id; -+ rtw_write32(padapter, REG_HMEBOX_DBG_2_8723D, cmd); -+ rtw_msleep_os(10); -+ ra_info1 = rtw_read32(padapter, 0x2F0); -+ curr_tx_rate = ra_info1 & 0x7F; -+ curr_tx_sgi = (ra_info1 >> 7) & 0x01; -+ -+ _RTW_PRINT_SEL(sel , "[ ra_info1:0x%08x ] =>cur_tx_rate= %s,cur_sgi:%d\n", ra_info1, HDATA_RATE(curr_tx_rate), curr_tx_sgi); -+ _RTW_PRINT_SEL(sel , "[ ra_info1:0x%08x ] => PWRSTS = 0x%02x\n", ra_info1, (ra_info1 >> 8) & 0x07); -+ -+ cmd = 0x40000400 | mac_id; -+ rtw_write32(padapter, REG_HMEBOX_DBG_2_8723D, cmd); -+ rtw_msleep_os(10); -+ ra_info1 = rtw_read32(padapter, 0x2F0); -+ ra_info2 = rtw_read32(padapter, 0x2F4); -+ rate_mask1 = rtw_read32(padapter, 0x2F8); -+ rate_mask2 = rtw_read32(padapter, 0x2FC); -+ hight_rate = ra_info2 & 0xFF; -+ lowest_rate = (ra_info2 >> 8) & 0xFF; -+ bw_set = (ra_info1 >> 8) & 0xFF; -+ -+ _RTW_PRINT_SEL(sel , "[ ra_info1:0x%08x ] => VHT_EN=0x%02x, ", ra_info1, (ra_info1 >> 24) & 0xFF); -+ -+ -+ switch (bw_set) { -+ -+ case CHANNEL_WIDTH_20: -+ _RTW_PRINT_SEL(sel , "BW_setting=20M\n"); -+ break; -+ -+ case CHANNEL_WIDTH_40: -+ _RTW_PRINT_SEL(sel , "BW_setting=40M\n"); -+ break; -+ -+ case CHANNEL_WIDTH_80: -+ _RTW_PRINT_SEL(sel , "BW_setting=80M\n"); -+ break; -+ -+ case CHANNEL_WIDTH_160: -+ _RTW_PRINT_SEL(sel , "BW_setting=160M\n"); -+ break; -+ -+ default: -+ _RTW_PRINT_SEL(sel , "BW_setting=0x%02x\n", bw_set); -+ break; -+ -+ } -+ -+ _RTW_PRINT_SEL(sel , "[ ra_info1:0x%08x ] =>RSSI=%d, DISRA=0x%02x\n", -+ ra_info1, -+ ra_info1 & 0xFF, -+ (ra_info1 >> 16) & 0xFF); -+ -+ _RTW_PRINT_SEL(sel , "[ ra_info2:0x%08x ] =>hight_rate=%s, lowest_rate=%s, SGI=0x%02x, RateID=%d\n", -+ ra_info2, -+ HDATA_RATE(hight_rate), -+ HDATA_RATE(lowest_rate), -+ (ra_info2 >> 16) & 0xFF, -+ (ra_info2 >> 24) & 0xFF); -+ -+ _RTW_PRINT_SEL(sel , "rate_mask2=0x%08x, rate_mask1=0x%08x\n", rate_mask2, rate_mask1); -+ -+ } -+ } -+} -+ -+/* -+ * Description: -+ * Query setting of specified variable. -+ */ -+u8 GetHalDefVar8723D(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 bResult; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ bResult = _SUCCESS; -+ -+ switch (variable) { -+ case HAL_DEF_MAX_RECVBUF_SZ: -+ *((u32 *)pval) = MAX_RECVBUF_SZ; -+ break; -+ case HAL_DEF_RX_PACKET_OFFSET: -+#ifdef CONFIG_TRX_BD_ARCH -+ *((u32 *)pval) = RX_WIFI_INFO_SIZE + DRVINFO_SZ * 8; -+#else -+ *((u32 *)pval) = RXDESC_SIZE + DRVINFO_SZ * 8; -+#endif -+ break; -+ -+ case HW_VAR_MAX_RX_AMPDU_FACTOR: -+ /* Stanley@BB.SD3 suggests 16K can get stable performance */ -+ /* The experiment was done on SDIO interface */ -+ /* coding by Lucas@20130730 */ -+ *(HT_CAP_AMPDU_FACTOR *)pval = MAX_AMPDU_FACTOR_16K; -+ break; -+ case HW_VAR_BEST_AMPDU_DENSITY: -+ *((u32 *)pval) = AMPDU_DENSITY_VALUE_7; -+ break; -+ case HAL_DEF_TX_LDPC: -+ case HAL_DEF_RX_LDPC: -+ *((u8 *)pval) = _FALSE; -+ break; -+ case HAL_DEF_TX_STBC: -+ *((u8 *)pval) = 0; -+ break; -+ case HAL_DEF_RX_STBC: -+ *((u8 *)pval) = 1; -+ break; -+ case HAL_DEF_EXPLICIT_BEAMFORMER: -+ case HAL_DEF_EXPLICIT_BEAMFORMEE: -+ *((u8 *)pval) = _FALSE; -+ break; -+ -+ case HW_DEF_RA_INFO_DUMP: -+ hal_ra_info_dump(padapter, pval); -+ break; -+ -+ case HAL_DEF_TX_PAGE_BOUNDARY: -+ if (!padapter->registrypriv.wifi_spec) -+ *(u8 *)pval = TX_PAGE_BOUNDARY_8723D; -+ else -+ *(u8 *)pval = WMM_NORMAL_TX_PAGE_BOUNDARY_8723D; -+ break; -+ case HAL_DEF_MACID_SLEEP: -+ *(u8 *)pval = _TRUE; /* support macid sleep */ -+ break; -+ case HAL_DEF_TX_PAGE_SIZE: -+ *((u32 *)pval) = PAGE_SIZE_128; -+ break; -+ case HAL_DEF_RX_DMA_SZ_WOW: -+ *(u32 *)pval = RX_DMA_SIZE_8723D - RESV_FMWF; -+ break; -+ case HAL_DEF_RX_DMA_SZ: -+ *(u32 *)pval = RX_DMA_BOUNDARY_8723D + 1; -+ break; -+ case HAL_DEF_RX_PAGE_SIZE: -+ *((u32 *)pval) = 8; -+ break; -+ default: -+ bResult = GetHalDefVar(padapter, variable, pval); -+ break; -+ } -+ -+ return bResult; -+} -+ -+#ifdef CONFIG_WOWLAN -+void Hal_DetectWoWMode(PADAPTER pAdapter) -+{ -+ adapter_to_pwrctl(pAdapter)->bSupportRemoteWakeup = _TRUE; -+ RTW_INFO("%s\n", __func__); -+} -+#endif /* CONFIG_WOWLAN */ -+ -+void rtl8723d_start_thread(_adapter *padapter) -+{ -+#if (defined CONFIG_SDIO_HCI) || (defined CONFIG_GSPI_HCI) -+#ifndef CONFIG_SDIO_TX_TASKLET -+ struct xmit_priv *xmitpriv = &padapter->xmitpriv; -+ -+ xmitpriv->SdioXmitThread = kthread_run(rtl8723ds_xmit_thread, padapter, "RTWHALXT"); -+ if (IS_ERR(xmitpriv->SdioXmitThread)) -+ RTW_ERR("%s: start rtl8723ds_xmit_thread FAIL!!\n", __func__); -+#endif -+#endif -+} -+ -+void rtl8723d_stop_thread(_adapter *padapter) -+{ -+#if (defined CONFIG_SDIO_HCI) || (defined CONFIG_GSPI_HCI) -+#ifndef CONFIG_SDIO_TX_TASKLET -+ struct xmit_priv *xmitpriv = &padapter->xmitpriv; -+ -+ /* stop xmit_buf_thread */ -+ if (xmitpriv->SdioXmitThread) { -+ _rtw_up_sema(&xmitpriv->SdioXmitSema); -+ /*_rtw_down_sema(&xmitpriv->SdioXmitTerminateSema);*/ -+ rtw_wait_for_thread_stop(&xmitpriv->sdio_xmit_thread_comp); -+ xmitpriv->SdioXmitThread = 0; -+ } -+#endif -+#endif -+} -+ -+#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) -+void rtl8723ds_init_checkbthang_workqueue(_adapter *adapter) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) -+ adapter->priv_checkbt_wq = alloc_workqueue("sdio_wq", 0, 0); -+#else -+ adapter->priv_checkbt_wq = create_workqueue("sdio_wq"); -+#endif -+ INIT_DELAYED_WORK(&adapter->checkbt_work, (void *)check_bt_status_work); -+} -+ -+void rtl8723ds_free_checkbthang_workqueue(_adapter *adapter) -+{ -+ if (adapter->priv_checkbt_wq) { -+ cancel_delayed_work_sync(&adapter->checkbt_work); -+ flush_workqueue(adapter->priv_checkbt_wq); -+ destroy_workqueue(adapter->priv_checkbt_wq); -+ adapter->priv_checkbt_wq = NULL; -+ } -+} -+ -+void rtl8723ds_cancle_checkbthang_workqueue(_adapter *adapter) -+{ -+ if (adapter->priv_checkbt_wq) -+ cancel_delayed_work_sync(&adapter->checkbt_work); -+} -+ -+void rtl8723ds_hal_check_bt_hang(_adapter *adapter) -+{ -+ if (adapter->priv_checkbt_wq) -+ queue_delayed_work(adapter->priv_checkbt_wq, &(adapter->checkbt_work), 0); -+} -+#endif -+ -+void rtl8723d_set_hal_ops(struct hal_ops *pHalFunc) -+{ -+ pHalFunc->dm_init = &rtl8723d_init_dm_priv; -+ pHalFunc->dm_deinit = &rtl8723d_deinit_dm_priv; -+ pHalFunc->read_chip_version = read_chip_version_8723d; -+ pHalFunc->UpdateRAMaskHandler = &UpdateHalRAMask8723D; -+ pHalFunc->set_chnl_bw_handler = &PHY_SetSwChnlBWMode8723D; -+ pHalFunc->set_tx_power_level_handler = &PHY_SetTxPowerLevel8723D; -+ pHalFunc->get_tx_power_level_handler = &PHY_GetTxPowerLevel8723D; -+ pHalFunc->get_tx_power_index_handler = &PHY_GetTxPowerIndex_8723D; -+ pHalFunc->hal_dm_watchdog = &rtl8723d_HalDmWatchDog; -+#ifdef CONFIG_LPS_LCLK_WD_TIMER -+ pHalFunc->hal_dm_watchdog_in_lps = &rtl8723d_HalDmWatchDog_in_LPS; -+#endif -+ -+ pHalFunc->SetBeaconRelatedRegistersHandler = &rtl8723d_SetBeaconRelatedRegisters; -+ pHalFunc->run_thread = &rtl8723d_start_thread; -+ pHalFunc->cancel_thread = &rtl8723d_stop_thread; -+ pHalFunc->read_bbreg = &PHY_QueryBBReg_8723D; -+ pHalFunc->write_bbreg = &PHY_SetBBReg_8723D; -+ pHalFunc->read_rfreg = &PHY_QueryRFReg_8723D; -+ pHalFunc->write_rfreg = &PHY_SetRFReg_8723D; -+ -+ /* Efuse related function */ -+ pHalFunc->BTEfusePowerSwitch = &Hal_BT_EfusePowerSwitch; -+ pHalFunc->EfusePowerSwitch = &Hal_EfusePowerSwitch; -+ pHalFunc->ReadEFuse = &Hal_ReadEFuse; -+ pHalFunc->EFUSEGetEfuseDefinition = &Hal_GetEfuseDefinition; -+ pHalFunc->EfuseGetCurrentSize = &Hal_EfuseGetCurrentSize; -+ pHalFunc->Efuse_PgPacketRead = &Hal_EfusePgPacketRead; -+ pHalFunc->Efuse_PgPacketWrite = &Hal_EfusePgPacketWrite; -+ pHalFunc->Efuse_WordEnableDataWrite = &Hal_EfuseWordEnableDataWrite; -+ pHalFunc->Efuse_PgPacketWrite_BT = &Hal_EfusePgPacketWrite_BT; -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ pHalFunc->sreset_init_value = &sreset_init_value; -+ pHalFunc->sreset_reset_value = &sreset_reset_value; -+ pHalFunc->silentreset = &sreset_reset; -+ pHalFunc->sreset_xmit_status_check = &rtl8723d_sreset_xmit_status_check; -+ pHalFunc->sreset_linked_status_check = &rtl8723d_sreset_linked_status_check; -+ pHalFunc->sreset_get_wifi_status = &sreset_get_wifi_status; -+ pHalFunc->sreset_inprogress = &sreset_inprogress; -+#endif -+ pHalFunc->GetHalODMVarHandler = GetHalODMVar; -+ pHalFunc->SetHalODMVarHandler = SetHalODMVar; -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+ pHalFunc->xmit_thread_handler = &hal_xmit_handler; -+#endif -+ pHalFunc->hal_notch_filter = &hal_notch_filter_8723d; -+ pHalFunc->c2h_handler = c2h_handler_8723d; -+ pHalFunc->fill_h2c_cmd = &FillH2CCmd8723D; -+ pHalFunc->fill_fake_txdesc = &rtl8723d_fill_fake_txdesc; -+ pHalFunc->fw_dl = &rtl8723d_FirmwareDownload; -+ pHalFunc->hal_get_tx_buff_rsvd_page_num = &GetTxBufferRsvdPageNum8723D; -+} -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_lps_poff.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_lps_poff.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_lps_poff.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_lps_poff.c 2018-02-11 21:44:27.164146345 +0200 -@@ -0,0 +1,877 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#include -+ -+#ifdef CONFIG_LPS_POFF -+/**************************************************************************** -+ * Function: constuct Register Setting for HW to Backup Before LPS -+ * page 2/4/6/7/8~F and page 0x24(for NAN) -+*****************************************************************************/ -+static bool hal_construct_poff_static_file(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ lps_poff_info_t *lps_poff_info = NULL; -+ u8 *staticFile = NULL; -+ u8 *start_at = NULL; -+ u8 page_count = 0, page_offset = 0, round = 0; -+ /*There are 256 bytes in each register bank, and 64 dwords*/ -+ u8 total = 256 / 4; -+ u16 offset = 0, addr_value = 0; -+ -+ if (pwrpriv->plps_poff_info == NULL) { -+ RTW_INFO("%s: please alloc plps_poff_info first!!\n", __func__); -+ return _FALSE; -+ } -+ -+ lps_poff_info = pwrpriv->plps_poff_info; -+ -+ if (lps_poff_info->pStaticFile == NULL) { -+ RTW_INFO("%s: please alloc static configure file first!!\n", -+ __func__); -+ return _FALSE; -+ } -+ staticFile = lps_poff_info->pStaticFile + TXDESC_SIZE; -+ -+ for (page_count = 2 ; page_count < 16 ; page_count++) { -+ page_offset = 0; -+ if (page_count == 3 || page_count == 5) -+ continue; -+ -+ offset = (round << 9); -+ -+ for (page_offset = 0 ; page_offset < total ; page_offset++) { -+ start_at = staticFile + offset + (page_offset << 3); -+ addr_value = -+ ((page_count << 8) + (page_offset << 2)) >> 2; -+ -+ SET_HOIE_ENTRY_LOW_DATA(start_at, 0); -+ SET_HOIE_ENTRY_HIGH_DATA(start_at, 0); -+ SET_HOIE_ENTRY_MODE_SELECT(start_at, 0); -+ SET_HOIE_ENTRY_ADDRESS(start_at, addr_value); -+ SET_HOIE_ENTRY_BYTE_MASK(start_at, 0xF); -+ SET_HOIE_ENTRY_IO_LOCK(start_at, 0); -+ SET_HOIE_ENTRY_WR_EN(start_at, 1); -+ SET_HOIE_ENTRY_RD_EN(start_at, 1); -+ SET_HOIE_ENTRY_RAW_RW(start_at, 0); -+ SET_HOIE_ENTRY_RAW(start_at, 0); -+ SET_HOIE_ENTRY_IO_DELAY(start_at, 0); -+ } -+ -+ round++; -+ } -+ -+ /*construct page 24*/ -+ offset = (round << 9); -+ for (page_offset = 0 ; page_offset < total ; page_offset++) { -+ start_at = staticFile + offset + (page_offset << 3); -+ addr_value = ((0x24 << 8) + (page_offset << 2)) >> 2; -+ -+ SET_HOIE_ENTRY_LOW_DATA(start_at, 0); -+ SET_HOIE_ENTRY_HIGH_DATA(start_at, 0); -+ SET_HOIE_ENTRY_MODE_SELECT(start_at, 0); -+ SET_HOIE_ENTRY_ADDRESS(start_at, addr_value); -+ SET_HOIE_ENTRY_BYTE_MASK(start_at, 0xF); -+ SET_HOIE_ENTRY_IO_LOCK(start_at, 0); -+ SET_HOIE_ENTRY_WR_EN(start_at, 1); -+ SET_HOIE_ENTRY_RD_EN(start_at, 1); -+ SET_HOIE_ENTRY_RAW_RW(start_at, 0); -+ SET_HOIE_ENTRY_RAW(start_at, 0); -+ SET_HOIE_ENTRY_IO_DELAY(start_at, 0); -+ } -+ RTW_INFO("%s: (round << 9) + (PageOffset << 3) = %#08x\n", -+ __func__, offset + (page_offset << 3)); -+ -+ start_at = staticFile + offset + (page_offset << 3); -+ /* add last command: 00 00 00 00 00 40 30 00,suggested by DD */ -+ *(start_at) = 0; -+ *(start_at + 1) = 0; -+ *(start_at + 2) = 0; -+ *(start_at + 3) = 0; -+ *(start_at + 4) = 0; -+ *(start_at + 5) = 0x40; -+ *(start_at + 6) = 0x30; -+ *(start_at + 7) = 0; -+ -+ return _TRUE; -+} -+ -+/**************************************************************************** -+Function: send Location of configuration file and other info for FW -+*****************************************************************************/ -+static void rtl8723d_lps_poff_h2c_param(PADAPTER padapter, u8 tx_bndy, u16 len, -+ bool isDynamic) -+{ -+ u8 lps_poff_param[H2C_LPS_POFF_PARAM_LEN] = {0}; -+ u8 start_addr_l = 0, start_addr_h = 0; -+ u8 end_addr_l = 0, end_addr_h = 0; -+ u16 start_addr = 0, end_addr = 0; -+ -+ if (len < 8) -+ return; -+ /* -+ set start address, The parameter is entrys. every page has 16 entrys -+ The Tx Descriptor is 40Byte which locate 5 entries -+ */ -+ -+ start_addr = (tx_bndy << 4) + 5; -+ end_addr = start_addr + (len >> 3) - 1; -+ -+ RTW_INFO("%s: start_addr = %#02X, end_addr= %#02X\n", -+ __func__, start_addr, end_addr); -+ -+ start_addr_l = (u8)start_addr; -+ start_addr_h = (u8)(start_addr >> 8); -+ -+ end_addr_l = (u8)end_addr; -+ end_addr_h = (u8)(end_addr >> 8); -+ -+ /*construct H2C Cmd*/ -+ if (isDynamic) -+ SET_H2CCMD_LPS_POFF_PARAM_RDVLD(lps_poff_param, 0); -+ else -+ SET_H2CCMD_LPS_POFF_PARAM_RDVLD(lps_poff_param, 1); -+ -+ SET_H2CCMD_LPS_POFF_PARAM_WRVLD(lps_poff_param, 1); -+ SET_H2CCMD_LPS_POFF_PARAM_STARTADDL(lps_poff_param, start_addr_l); -+ SET_H2CCMD_LPS_POFF_PARAM_STARTADDH(lps_poff_param, start_addr_h); -+ SET_H2CCMD_LPS_POFF_PARAM_ENDADDL(lps_poff_param, end_addr_l); -+ SET_H2CCMD_LPS_POFF_PARAM_ENDADDH(lps_poff_param, end_addr_h); -+ -+ rtw_hal_fill_h2c_cmd(padapter, H2C_LPS_POFF_PARAM, -+ H2C_LPS_POFF_PARAM_LEN, lps_poff_param); -+} -+ -+/************************************************************************* -+Function: SET Location of Configuration File to FW -+**************************************************************************/ -+static void rtl8723d_lps_poff_set_param(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; -+ -+ u8 static_tx_bndy = 0; -+ u8 dynamic_tx_bndy = 0; -+ u16 static_len = 0, dynamic_len = 0; -+ -+ static_tx_bndy = plps_poff_info->tx_bndy_static; -+ dynamic_tx_bndy = plps_poff_info->tx_bndy_dynamic; -+ -+ dynamic_len = plps_poff_info->ConfLenForPTK + -+ plps_poff_info->ConfLenForGTK; -+ -+ if (ATOMIC_READ(&plps_poff_info->bSetPOFFParm) == _TRUE) -+ return; -+ -+ /* download static configuration */ -+ static_len = LPS_POFF_STATIC_FILE_LEN - TXDESC_SIZE; -+ rtl8723d_lps_poff_h2c_param(padapter, static_tx_bndy, -+ static_len, _FALSE); -+ -+ /* download dynamic configuration */ -+ /* the length must be add more 8 Byte due to hard bug */ -+ if (dynamic_len != 0) { -+ dynamic_len += 8; -+ rtl8723d_lps_poff_h2c_param(padapter, dynamic_tx_bndy, -+ dynamic_len, _TRUE); -+ } -+ -+ ATOMIC_SET(&plps_poff_info->bSetPOFFParm, _TRUE); -+} -+ -+ -+/**************************************************************************** -+Function: change tx boundary -+*****************************************************************************/ -+static void rtl8723d_lps_poff_set_tx_bndy(PADAPTER padapter, u8 tx_bndy) -+{ -+ u32 numHQ = 0x10; -+ u32 numLQ = 0x10; -+ u32 numPubQ = 0; -+ u8 numNQ = 0; -+ -+ u32 val32 = 0; -+ u8 val8 = 0; -+ -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ numHQ = 0x8; -+ numLQ = 0x8; -+#endif -+ numPubQ = tx_bndy - numHQ - numLQ - numNQ - 1; -+ val8 = _NPQ(numNQ); -+ val32 = _HPQ(numHQ) | _LPQ(numLQ) | _PUBQ(numPubQ) | LD_RQPN; -+ -+ rtw_write8(padapter, REG_RQPN_NPQ, val8); -+ rtw_write32(padapter, REG_RQPN, val32); -+} -+ -+/**************************************************************************** -+Function: change tx boundary flow -+*****************************************************************************/ -+static bool rtl8723d_lps_poff_tx_bndy_flow(PADAPTER padapter, bool enable) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct xmit_priv *pxmitpriv; -+ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; -+ u8 tx_bndy = 0, tx_bndy_new = 0, count = 0, queue_pending = _FALSE; -+ u8 val8 = 0; -+ u16 val16 = 0; -+ u32 val32 = 0; -+ -+ pxmitpriv = &padapter->xmitpriv; -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&tx_bndy); -+ -+ RTW_INFO("%s: tx_bndy: %#X, tx_bndy_static: %#X\n", -+ __func__, tx_bndy, plps_poff_info->tx_bndy_static); -+ -+ if (enable) -+ tx_bndy_new = plps_poff_info->tx_bndy_static + 1; -+ else -+ tx_bndy_new = tx_bndy; -+ -+ ATOMIC_SET(&plps_poff_info->bTxBoundInProgress, _TRUE); -+ -+ /* stop os layer TX*/ -+ rtw_mi_netif_stop_queue(padapter, _FALSE); -+ -+ val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); -+ -+ /* stop tx process and wait tx empty */ -+ while ((val16 & 0x05FF) != 0x05FF) { -+ rtw_mdelay_os(10); -+ val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); -+ -+ count++; -+ if (count >= 100) { -+ val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); -+ RTW_INFO("%s, txpkt_empty: %#04x\n", __func__, val16); -+ val8 = rtw_read8(padapter, REG_CPU_MGQ_INFORMATION); -+ RTW_INFO("%s, REG_CPU_MGQ_INFORMATION: %#02x\n", -+ __func__, val8); -+ RTW_INFO("%s, wait for tx empty timeout!!\n", __func__); -+ ATOMIC_SET(&plps_poff_info->bTxBoundInProgress, _FALSE); -+ rtw_mi_netif_wake_queue(padapter); -+ return _FALSE; -+ } -+ } -+ -+ /* change tx boundary*/ -+ rtl8723d_lps_poff_set_tx_bndy(padapter, tx_bndy_new); -+ -+ /* set free tail */ -+ val32 = rtw_read32(padapter, REG_FWHW_TXQ_CTRL); -+ val32 |= BIT20; -+ rtw_write32(padapter, REG_FWHW_TXQ_CTRL, val32); -+ rtw_write8(padapter, REG_BCNQ_BDNY, tx_bndy_new); -+ -+ RTW_INFO("%s: free tail = %#x after\n", __func__, -+ rtw_read8(padapter, REG_FW_FREE_TAIL_8723D)); -+ -+ /* set bcn head */ -+ val32 = rtw_read32(padapter, REG_FWHW_TXQ_CTRL); -+ val32 &= ~BIT20; -+ rtw_write32(padapter, REG_FWHW_TXQ_CTRL, val32); -+ rtw_write8(padapter, REG_BCNQ_BDNY, tx_bndy); -+ -+ /* reinit LLT */ -+ rtl8723d_InitLLTTable(padapter); -+ -+ /* clear 0x210 ??*/ -+ val32 = rtw_read32(padapter, REG_TXDMA_STATUS); -+ -+ if (val32 != 0) { -+ RTW_INFO("%s: REG_TXDMA_STATUS: %#08x\n", __func__, val32); -+ rtw_write32(padapter, REG_TXDMA_STATUS, val32); -+ } -+ -+ ATOMIC_SET(&plps_poff_info->bTxBoundInProgress, _FALSE); -+ -+ -+ /* restart tx */ -+ -+ rtw_mi_netif_wake_queue(padapter); -+ -+ return _TRUE; -+} -+ -+/**************************************************************************** -+Function: Append extra bytes for dynamic confiure file -+ Add one entry to fix hw bug, -+ list command: 00 00 00 00 00 40 30 00, suggested by DD -+*****************************************************************************/ -+static u8 rtl8723d_lps_poff_append_extra_info(PADAPTER padapter, u32 len) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; -+ u32 data_offset = len + plps_poff_info->ConfFileOffset; -+ -+ *(plps_poff_info->pDynamicFile + (data_offset)) = 0x00; -+ *(plps_poff_info->pDynamicFile + (data_offset + 1)) = 0x00; -+ *(plps_poff_info->pDynamicFile + (data_offset + 2)) = 0x00; -+ *(plps_poff_info->pDynamicFile + (data_offset + 3)) = 0x00; -+ *(plps_poff_info->pDynamicFile + (data_offset + 4)) = 0x00; -+ *(plps_poff_info->pDynamicFile + (data_offset + 5)) = 0x40; -+ *(plps_poff_info->pDynamicFile + (data_offset + 6)) = 0x30; -+ *(plps_poff_info->pDynamicFile + (data_offset + 7)) = 0x00; -+ return 8; -+} -+ -+/**************************************************************************** -+Function: xmit config file to write port. -+*****************************************************************************/ -+static void rtl8723d_lps_poff_send_config_frame(PADAPTER padapter, -+ u8 *pFile, u32 len) -+{ -+ struct xmit_frame *pcmdframe = NULL; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv; -+ int i = 0; -+ -+ pxmitpriv = &padapter->xmitpriv; -+ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); -+ -+ if (pcmdframe == NULL) -+ RTW_INFO("%s: alloc cmdframe fail\n", __func__); -+ -+ _rtw_memcpy(pcmdframe->buf_addr, pFile, len); -+ -+ pattrib = &pcmdframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->qsel = QSLT_BEACON; -+ pattrib->pktlen = len - TXDESC_OFFSET; -+ pattrib->last_txcmdsz = len - TXDESC_OFFSET; -+ -+ RTW_INFO("%s, len: %d, MAX_CMDBUF_SZ: %d\n", __func__, len, -+ MAX_CMDBUF_SZ); -+#ifdef CONFIG_PCI_HCI -+ dump_mgntframe(padapter, pcmdframe); -+#else -+ dump_mgntframe_and_wait(padapter, pcmdframe, 100); -+#endif -+ -+} -+ -+/**************************************************************************** -+Function: download config file flow -+*****************************************************************************/ -+static void rtl8723d_lps_poff_send_config_file(PADAPTER padapter, -+ u8 *pFile, u8 loc, u32 len) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ bool bRecover = _FALSE, bcn_valid = _FALSE; -+ u8 DLBcnCount = 0, val8 = 0, tx_bndy = 0; -+ u32 poll = 0; -+ -+ rtw_hal_get_def_var(padapter, -+ HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&tx_bndy); -+ -+ /* set 0x100[8]=1 for SW beacon */ -+ val8 = rtw_read8(padapter, REG_CR + 1); -+ val8 |= BIT(0); -+ rtw_write8(padapter, REG_CR + 1, val8); -+ -+ /*set 0x422[6]=0 to disable beacon DMA pass to MACTx*/ -+ -+ if (pHalData->RegFwHwTxQCtrl & BIT(6)) -+ bRecover = _TRUE; -+ -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, -+ pHalData->RegFwHwTxQCtrl & ~BIT(6)); -+ pHalData->RegFwHwTxQCtrl &= ~BIT(6); -+ -+ /* Clear beacon valid check bit. */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ -+ /* set 0x209[7:0] beacon queue head page to start download location */ -+ rtw_write8(padapter, REG_TDECTRL_8723D + 1, loc); -+ -+ DLBcnCount = 0; -+ poll = 0; -+ -+ do { -+ rtl8723d_lps_poff_send_config_frame(padapter, pFile, len); -+ DLBcnCount++; -+ do { -+ rtw_mdelay_os(10); -+ /*check rsvd page download OK.*/ -+ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, -+ (u8 *)(&bcn_valid)); -+ poll++; -+ } while (!bcn_valid && (poll % 10) != 0 -+ && !RTW_CANNOT_RUN(padapter)); -+ } while (!bcn_valid && DLBcnCount <= 100 && !RTW_CANNOT_RUN(padapter)); -+ -+ if (!bcn_valid) -+ RTW_INFO(ADPT_FMT": 1 DL RSVD page failed! DLBcnCount:%u, poll:%u\n", -+ ADPT_ARG(padapter), DLBcnCount, poll); -+ else -+ RTW_INFO(ADPT_FMT": 1 DL RSVD page success! DLBcnCount:%u, poll:%u\n", -+ ADPT_ARG(padapter), DLBcnCount, poll); -+ -+ /*restore bcn operation*/ -+ rtw_write8(padapter, REG_TDECTRL_8723D + 1, tx_bndy); -+ -+ /*restore 0x422[6]=1 for normal bcn*/ -+ if (bRecover) { -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, -+ pHalData->RegFwHwTxQCtrl | BIT(6)); -+ pHalData->RegFwHwTxQCtrl |= BIT(6); -+ } -+ -+ /*restore 0x100[8]=0 for SW beacon*/ -+ /* Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ -+#ifndef CONFIG_PCI_HCI -+ val8 = rtw_read8(padapter, REG_CR + 1); -+ val8 &= ~BIT(0); -+ rtw_write8(padapter, REG_CR + 1, val8); -+#endif -+} -+ -+/**************************************************************************** -+Function: Prepare Confiure File -+*****************************************************************************/ -+static void rtl8723d_lps_poff_dl_config_file(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; -+ u8 count = 0, append_len = 0; -+ u32 offset = 0, static_file_len = 0, dynamic_file_len = 0; -+ int i = 0, j = 0; -+ -+ offset = plps_poff_info->ConfFileOffset; -+ -+ static_file_len = LPS_POFF_STATIC_FILE_LEN - offset; -+ -+ dynamic_file_len = -+ plps_poff_info->ConfLenForPTK + plps_poff_info->ConfLenForGTK; -+ -+ RTW_INFO("%s: static_file_len: %d dynamic_file_len: %d, offset: %d\n", -+ __func__, static_file_len, dynamic_file_len, offset); -+ -+ /*static file*/ -+ rtl8723d_lps_poff_send_config_file(padapter, -+ plps_poff_info->pStaticFile + offset, -+ plps_poff_info->tx_bndy_static, -+ static_file_len); -+ -+ /*dynamic file*/ -+ if (dynamic_file_len != 0) { -+ dynamic_file_len += TXDESC_SIZE - offset; -+ -+ append_len = -+ rtl8723d_lps_poff_append_extra_info(padapter, -+ dynamic_file_len); -+ dynamic_file_len += append_len; -+ rtl8723d_lps_poff_send_config_file(padapter, -+ plps_poff_info->pDynamicFile + offset, -+ plps_poff_info->tx_bndy_dynamic, -+ dynamic_file_len); -+ } -+} -+ -+static u8 rtl8723d_lps_poff_set_dynamic_file(u8 *pFile, u32 type, u32 wdata) -+{ -+ SET_HOIE_ENTRY_LOW_DATA(pFile, (u16)wdata); -+ SET_HOIE_ENTRY_HIGH_DATA(pFile, (u16)(wdata >> 16)); -+ SET_HOIE_ENTRY_MODE_SELECT(pFile, 0); -+ SET_HOIE_ENTRY_ADDRESS(pFile, (type >> 2)); -+ SET_HOIE_ENTRY_BYTE_MASK(pFile, 0xF); -+ SET_HOIE_ENTRY_IO_LOCK(pFile, 0); -+ SET_HOIE_ENTRY_WR_EN(pFile, 1); -+ SET_HOIE_ENTRY_RD_EN(pFile, 0); -+ SET_HOIE_ENTRY_RAW_RW(pFile, 0); -+ SET_HOIE_ENTRY_RAW(pFile, 0); -+ SET_HOIE_ENTRY_IO_DELAY(pFile, 0); -+ -+ return 8; -+} -+ -+static void rtl8723d_lps_poff_dynamic_file(PADAPTER padapter, u8 index, u8 isGK) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; -+ u8 *ptkfile = NULL; -+ u8 ret = 0; -+ u32 tgt_cmd = 0, tgt_wdata = 0; -+ int i = 0, j = 0; -+ -+ for (i = 0 ; i < CAM_CONTENT_COUNT; i++) { -+ if (!isGK) -+ ptkfile = plps_poff_info->pDynamicFile + -+ plps_poff_info->ConfLenForPTK + TXDESC_SIZE; -+ else -+ ptkfile = plps_poff_info->pDynamicFile + -+ plps_poff_info->ConfLenForPTK + -+ plps_poff_info->ConfLenForGTK + TXDESC_SIZE; -+ -+ tgt_cmd = i + (CAM_CONTENT_COUNT * index); -+ tgt_cmd = tgt_cmd | CAM_POLLINIG | CAM_WRITE; -+ -+ switch (i) { -+ case 0: -+ tgt_wdata = dvobj->cam_cache[index].ctrl | -+ dvobj->cam_cache[index].mac[0] << 16 | -+ dvobj->cam_cache[index].mac[1] << 24; -+ break; -+ case 1: -+ tgt_wdata = dvobj->cam_cache[index].mac[2] | -+ dvobj->cam_cache[index].mac[3] << 8 | -+ dvobj->cam_cache[index].mac[4] << 16 | -+ dvobj->cam_cache[index].mac[5] << 24; -+ break; -+ default: -+ j = (i - 2) << 2; -+ tgt_wdata = -+ dvobj->cam_cache[index].key[j + 3] << 24 | -+ dvobj->cam_cache[index].key[j + 2] << 16 | -+ dvobj->cam_cache[index].key[j + 1] << 8 | -+ dvobj->cam_cache[index].key[j]; -+ break; -+ } -+ -+ ret = rtl8723d_lps_poff_set_dynamic_file(ptkfile, -+ WCAMI, tgt_wdata); -+ -+ if (!isGK) { -+ plps_poff_info->ConfLenForPTK += ret; -+ -+ ptkfile = plps_poff_info->pDynamicFile + -+ plps_poff_info->ConfLenForPTK + TXDESC_SIZE; -+ } else { -+ plps_poff_info->ConfLenForGTK += ret; -+ ptkfile = plps_poff_info->pDynamicFile + -+ plps_poff_info->ConfLenForPTK + -+ plps_poff_info->ConfLenForGTK + TXDESC_SIZE; -+ } -+ -+ ret = rtl8723d_lps_poff_set_dynamic_file(ptkfile, -+ RWCAM, tgt_cmd); -+ -+ if (!isGK) -+ plps_poff_info->ConfLenForPTK += ret; -+ else -+ plps_poff_info->ConfLenForGTK += ret; -+ -+#if 0 -+ RTW_INFO("%s: tgt_wdata: %#08x\n", __func__, tgt_wdata); -+#endif -+ } -+} -+ -+static void rtl8723d_lps_poff_sec_cam_opt(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int i = 0; -+ u8 isValid = 0, isGK = 0, index = 0, key_id = 0xff, gk_start = 0xff; -+ u16 val16 = 0, len = 0; -+ -+ /*Using cam cache to create config file for FW use.*/ -+ /*1- deail with pairwise key*/ -+ -+ for (i = 0 ; i < cam_ctl->num ; i++) { -+ -+ val16 = dvobj->cam_cache[i].ctrl; -+ isValid = (val16 >> 15) & 0x01; -+ isGK = (val16 >> 6) & 0x01; -+ -+ if (isValid && !isGK) { -+ rtl8723d_lps_poff_dynamic_file(padapter, i, _FALSE); -+ RTW_INFO("%s: id: %2u, kid: %3u, ctrl: %#04x, "MAC_FMT""KEY_FMT"\n", -+ __func__, i, (dvobj->cam_cache[i].ctrl) & 0x03, -+ dvobj->cam_cache[i].ctrl, -+ MAC_ARG(dvobj->cam_cache[i].mac), -+ KEY_ARG(dvobj->cam_cache[i].key)); -+ } else if (isGK) { -+ key_id = dvobj->cam_cache[i].ctrl & 0x03; -+ if (key_id == pmlmeinfo->key_index) -+ gk_start = i; -+ RTW_INFO("%s: GK_start at %d\n", __func__, gk_start); -+ RTW_INFO("%s: id: %2u, kid: %3u, ctrl: %#04x, "MAC_FMT""KEY_FMT"\n", -+ __func__, i, key_id, dvobj->cam_cache[i].ctrl, -+ MAC_ARG(dvobj->cam_cache[i].mac), -+ KEY_ARG(dvobj->cam_cache[i].key)); -+ } -+ } -+ -+ /*2- deail with group key*/ -+ rtl8723d_lps_poff_dynamic_file(padapter, gk_start, _TRUE); -+ -+ RTW_INFO("%s: ConfLenForPTK: %d, ConfLenForGTK: %d\n", __func__, -+ plps_poff_info->ConfLenForPTK, plps_poff_info->ConfLenForGTK); -+} -+ -+/**************************************************************************** -+Function: Prepare enter LPS partial off status. -+change tx boundary, download configuration file if necessary and send info to FW -+*****************************************************************************/ -+static bool rtl8723d_prepare_for_enter_poff(PADAPTER padapter, bool bEnterLPS) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; -+ bool ret = _FALSE; -+ u8 i = 0, cam_cache_num = 0; -+ -+ for (i = 0 ; i < cam_ctl->num; i++) { -+ if (dvobj->cam_cache[i].ctrl != 0) -+ cam_cache_num++; -+ } -+ -+ ret = rtl8723d_lps_poff_tx_bndy_flow(padapter, bEnterLPS); -+ -+ if (ret == _TRUE) { -+ if (cam_cache_num > 0) { -+ rtl8723d_lps_poff_sec_cam_opt(padapter); -+ } else { -+ plps_poff_info->ConfLenForPTK = 0; -+ plps_poff_info->ConfLenForGTK = 0; -+ } -+ rtl8723d_lps_poff_dl_config_file(padapter); -+ rtl8723d_lps_poff_set_param(padapter); -+ } -+ return ret; -+} -+ -+/************************************************************************* -+Function: SET H2C To Enable Partial Off -+**************************************************************************/ -+void rtl8723d_lps_poff_h2c_ctrl(PADAPTER padapter, u8 en) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; -+ u8 param = 0; -+ -+ if (pregistrypriv->wifi_spec == 1) -+ return; -+ -+ if (plps_poff_info->bEn == _FALSE) -+ return; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ if (en) { -+ RTW_INFO("%s: enable case\n", __func__); -+ SET_H2CCMD_LPS_POFF_CTRL_EN(¶m, 1); -+ } else { -+ RTW_INFO("%s: disable case\n", __func__); -+ ATOMIC_SET(&plps_poff_info->bSetPOFFParm, _FALSE); -+ SET_H2CCMD_LPS_POFF_CTRL_EN(¶m, 0); -+ } -+ rtw_hal_fill_h2c_cmd(padapter, H2C_LPS_POFF_CTRL, -+ H2C_LPS_POFF_CTRL_LEN, ¶m); -+ } -+} -+ -+/************************************************************************* -+Function: The operation to Enter or Leave FWLPS 32K when partial off enable -+**************************************************************************/ -+void rtl8723d_lps_poff_set_ps_mode(PADAPTER padapter, bool bEnterLPS) -+{ -+ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ bool res = _FALSE; -+ -+ if (pregistrypriv->wifi_spec == 1) -+ return; -+ -+ if (plps_poff_info->bEn) { -+ -+ plps_poff_info->ConfLenForPTK = 0; -+ plps_poff_info->ConfLenForGTK = 0; -+ -+ if (bEnterLPS) { -+ res = rtl8723d_prepare_for_enter_poff(padapter, -+ bEnterLPS); -+ ATOMIC_SET(&plps_poff_info->bEnterPOFF, res); -+ } else -+ rtl8723d_lps_poff_tx_bndy_flow(padapter, bEnterLPS); -+ } -+} -+ -+/************************************************************************* -+Function: Get LPS-POFF Enter Status -+**************************************************************************/ -+bool rtl8723d_lps_poff_get_status(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ if (pregistrypriv->wifi_spec == 1) { -+ RTW_INFO("%s: wifi_spec is enable\n", __func__); -+ return _FALSE; -+ } -+ -+ if (plps_poff_info->bEn == _FALSE) { -+ RTW_INFO("%s: POFF is disable\n", __func__); -+ return _FALSE; -+ } -+ -+ return ATOMIC_READ(&plps_poff_info->bEnterPOFF); -+} -+ -+/************************************************************************* -+Function: Get LPS-POFF change tx bndy status -+**************************************************************************/ -+bool rtl8723d_lps_poff_get_txbndy_status(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; -+ -+ return ATOMIC_READ(&plps_poff_info->bTxBoundInProgress); -+} -+ -+/************************************************************************* -+Function: Get LPS-POFF initial -+**************************************************************************/ -+void rtl8723d_lps_poff_init(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ lps_poff_info_t *lps_poff_info; -+ u8 tx_bndy = 0, page_size = 0, total_page = 0, page_num = 0; -+ u8 val = 0; -+ -+ if (pregistrypriv->wifi_spec == 1) -+ return; -+ -+ if (is_primary_adapter(padapter)) { -+ -+ rtw_hal_get_def_var(padapter, -+ HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&val); -+ tx_bndy = val; -+ -+ rtw_hal_get_def_var(padapter, -+ HAL_DEF_TX_PAGE_SIZE, (u8 *)&val); -+ page_size = val; -+ -+ total_page = PageNum(LPS_POFF_STATIC_FILE_LEN, page_size) + -+ PageNum(LPS_POFF_DYNAMIC_FILE_LEN, page_size); -+ -+ lps_poff_info = -+ (lps_poff_info_t *)rtw_zmalloc(sizeof(lps_poff_info_t)); -+ -+ if (lps_poff_info != NULL) { -+ pwrpriv->plps_poff_info = lps_poff_info; -+ -+ lps_poff_info->pStaticFile = -+ (u8 *)rtw_zmalloc(LPS_POFF_STATIC_FILE_LEN); -+ if (lps_poff_info->pStaticFile == NULL) { -+ RTW_INFO("%s: alloc pStaticFile fail\n", -+ __func__); -+ goto alloc_static_conf_file_fail; -+ } else { -+ pwrpriv->plps_poff_info->pStaticFile = -+ lps_poff_info->pStaticFile; -+ } -+ -+ lps_poff_info->pDynamicFile = -+ (u8 *)rtw_zmalloc(LPS_POFF_DYNAMIC_FILE_LEN); -+ if (lps_poff_info->pDynamicFile == NULL) { -+ RTW_INFO("%s: alloc pDynamicFile fail\n", -+ __func__); -+ goto alloc_dynamic_conf_file_fail; -+ } else { -+ pwrpriv->plps_poff_info->pDynamicFile = -+ lps_poff_info->pDynamicFile; -+ } -+ -+ pwrpriv->plps_poff_info->bEn = _TRUE; -+ ATOMIC_SET(&pwrpriv->plps_poff_info->bEnterPOFF, -+ _FALSE); -+ ATOMIC_SET(&pwrpriv->plps_poff_info->bSetPOFFParm, -+ _FALSE); -+ ATOMIC_SET(&pwrpriv->plps_poff_info->bTxBoundInProgress, -+ _FALSE); -+#ifdef CONFIG_PCI_HCI -+ pwrpriv->plps_poff_info->ConfFileOffset = 40; -+#else -+ pwrpriv->plps_poff_info->ConfFileOffset = 0; -+#endif -+ pwrpriv->plps_poff_info->tx_bndy_static = -+ tx_bndy - total_page; -+ page_num = PageNum(LPS_POFF_DYNAMIC_FILE_LEN, -+ page_size); -+ pwrpriv->plps_poff_info->tx_bndy_dynamic = -+ tx_bndy - page_num; -+ /* -+ construct static DLConfiguration File -+ */ -+ hal_construct_poff_static_file(padapter); -+ goto exit; -+ } else { -+ RTW_INFO("%s: alloc lps_poff_info fail\n", __func__); -+ goto exit; -+ } -+ } -+ -+alloc_dynamic_conf_file_fail: -+ rtw_mfree((u8 *)pwrpriv->plps_poff_info->pStaticFile, -+ LPS_POFF_STATIC_FILE_LEN); -+ pwrpriv->plps_poff_info->pStaticFile = NULL; -+alloc_static_conf_file_fail: -+ rtw_mfree((u8 *)pwrpriv->plps_poff_info, sizeof(lps_poff_info_t)); -+ pwrpriv->plps_poff_info = NULL; -+exit: -+ return; -+} -+ -+/************************************************************************* -+Function: Get LPS-POFF de-initial -+**************************************************************************/ -+void rtl8723d_lps_poff_deinit(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ lps_poff_info_t *plps_poff_info = pwrpriv->plps_poff_info; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ if (pregistrypriv->wifi_spec == 1) -+ return; -+ -+ if (is_primary_adapter(padapter)) { -+ if (plps_poff_info->pDynamicFile != NULL) { -+ rtw_mfree((u8 *)plps_poff_info->pDynamicFile, -+ LPS_POFF_DYNAMIC_FILE_LEN); -+ plps_poff_info->pDynamicFile = NULL; -+ } -+ if (plps_poff_info->pStaticFile != NULL) { -+ rtw_mfree((u8 *)plps_poff_info->pStaticFile, -+ LPS_POFF_STATIC_FILE_LEN); -+ plps_poff_info->pStaticFile = NULL; -+ } -+ if (plps_poff_info != NULL) { -+ rtw_mfree((u8 *)plps_poff_info, -+ sizeof(lps_poff_info_t)); -+ plps_poff_info = NULL; -+ } -+ } -+ -+} -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_phycfg.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_phycfg.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_phycfg.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_phycfg.c 2018-02-11 21:44:27.164146345 +0200 -@@ -0,0 +1,1317 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTL8723D_PHYCFG_C_ -+ -+#include -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+/* Channel switch:The size of command tables for switch channel*/ -+#define MAX_PRECMD_CNT 16 -+#define MAX_RFDEPENDCMD_CNT 16 -+#define MAX_POSTCMD_CNT 16 -+ -+#define MAX_DOZE_WAITING_TIMES_9x 64 -+ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+ -+/*------------------------Define global variable-----------------------------*/ -+ -+/*------------------------Define local variable------------------------------*/ -+ -+ -+/*--------------------Define export function prototype-----------------------*/ -+/* Please refer to header file -+ *--------------------Define export function prototype-----------------------*/ -+ -+/*----------------------------Function Body----------------------------------*/ -+/* -+ * 1. BB register R/W API -+ * */ -+ -+/** -+* Function: phy_CalculateBitShift -+* -+* OverView: Get shifted position of the BitMask -+* -+* Input: -+* u4Byte BitMask, -+* -+* Output: none -+* Return: u4Byte Return the shift bit bit position of the mask -+*/ -+static u32 -+phy_CalculateBitShift( -+ u32 BitMask -+) -+{ -+ u32 i; -+ -+ for (i = 0; i <= 31; i++) { -+ if (((BitMask >> i) & 0x1) == 1) -+ break; -+ } -+ -+ return i; -+} -+ -+ -+/** -+* Function: PHY_QueryBBReg -+* -+* OverView: Read "sepcific bits" from BB register -+* -+* Input: -+* PADAPTER Adapter, -+* u4Byte RegAddr, -+* u4Byte BitMask -+* -+* Output: None -+* Return: u4Byte Data -+* Note: This function is equal to "GetRegSetting" in PHY programming guide -+*/ -+u32 -+PHY_QueryBBReg_8723D( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask -+) -+{ -+ u32 ReturnValue = 0, OriginalValue, BitShift; -+ u16 BBWaitCounter = 0; -+ -+#if (DISABLE_BB_RF == 1) -+ return 0; -+#endif -+ -+ -+ OriginalValue = rtw_read32(Adapter, RegAddr); -+ BitShift = phy_CalculateBitShift(BitMask); -+ ReturnValue = (OriginalValue & BitMask) >> BitShift; -+ -+ return ReturnValue; -+ -+} -+ -+ -+/** -+* Function: PHY_SetBBReg -+* -+* OverView: Write "Specific bits" to BB register (page 8~) -+* -+* Input: -+* PADAPTER Adapter, -+* u4Byte RegAddr, -+* u4Byte BitMask -+* -+* u4Byte Data -+* -+* -+* Output: None -+* Return: None -+* Note: This function is equal to "PutRegSetting" in PHY programming guide -+*/ -+ -+VOID -+PHY_SetBBReg_8723D( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ /* u16 BBWaitCounter = 0; */ -+ u32 OriginalValue, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return; -+#endif -+ -+ -+ if (BitMask != bMaskDWord) { /* if not "double word" write */ -+ OriginalValue = rtw_read32(Adapter, RegAddr); -+ BitShift = phy_CalculateBitShift(BitMask); -+ Data = ((OriginalValue & (~BitMask)) | ((Data << BitShift) & BitMask)); -+ } -+ -+ rtw_write32(Adapter, RegAddr, Data); -+ -+} -+ -+ -+/* -+ * 2. RF register R/W API -+ * */ -+ -+/*----------------------------------------------------------------------------- -+ * Function: phy_FwRFSerialRead() -+ * -+ * Overview: We support firmware to execute RF-R/W. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 01/21/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+static u32 -+phy_FwRFSerialRead( -+ IN PADAPTER Adapter, -+ IN RF_PATH eRFPath, -+ IN u32 Offset) -+{ -+ u32 retValue = 0; -+ /* RT_ASSERT(FALSE,("deprecate!\n")); */ -+ return retValue; -+ -+} /* phy_FwRFSerialRead */ -+ -+ -+/*----------------------------------------------------------------------------- -+ * Function: phy_FwRFSerialWrite() -+ * -+ * Overview: We support firmware to execute RF-R/W. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 01/21/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+static VOID -+phy_FwRFSerialWrite( -+ IN PADAPTER Adapter, -+ IN RF_PATH eRFPath, -+ IN u32 Offset, -+ IN u32 Data) -+{ -+ /* RT_ASSERT(FALSE,("deprecate!\n")); */ -+} -+ -+static u32 -+phy_RFSerialRead_8723D( -+ IN PADAPTER Adapter, -+ IN RF_PATH eRFPath, -+ IN u32 Offset -+) -+{ -+ u32 retValue = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ BB_REGISTER_DEFINITION_T *pPhyReg = &pHalData->PHYRegDef[eRFPath]; -+ u32 NewOffset; -+ u32 tmplong, tmplong2; -+ u8 RfPiEnable = 0; -+ u4Byte MaskforPhySet = 0; -+ int i = 0; -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(Adapter)->rf_read_reg_mutex) , NULL); -+ /* */ -+ /* Make sure RF register offset is correct */ -+ /* */ -+ Offset &= 0xff; -+ -+ NewOffset = Offset; -+ -+ if (eRFPath == RF_PATH_A) { -+ tmplong2 = PHY_QueryBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord); -+ tmplong2 = (tmplong2 & (~bLSSIReadAddress)) | (NewOffset << 23) | bLSSIReadEdge; /* T65 RF */ -+ PHY_SetBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); -+ } else { -+ tmplong2 = PHY_QueryBBReg(Adapter, rFPGA0_XB_HSSIParameter2 | MaskforPhySet, bMaskDWord); -+ tmplong2 = (tmplong2 & (~bLSSIReadAddress)) | (NewOffset << 23) | bLSSIReadEdge; /* T65 RF */ -+ PHY_SetBBReg(Adapter, rFPGA0_XB_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); -+ } -+ -+ tmplong2 = PHY_QueryBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord); -+ PHY_SetBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); -+ PHY_SetBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 | bLSSIReadEdge); -+ -+ rtw_udelay_os(10); -+ -+ for (i = 0; i < 2; i++) -+ rtw_udelay_os(MAX_STALL_TIME); -+ rtw_udelay_os(10); -+ -+ if (eRFPath == RF_PATH_A) -+ RfPiEnable = (u1Byte)PHY_QueryBBReg(Adapter, rFPGA0_XA_HSSIParameter1 | MaskforPhySet, BIT(8)); -+ else if (eRFPath == RF_PATH_B) -+ RfPiEnable = (u1Byte)PHY_QueryBBReg(Adapter, rFPGA0_XB_HSSIParameter1 | MaskforPhySet, BIT(8)); -+ -+ if (RfPiEnable) { -+ /* Read from BBreg8b8, 12 bits for 8190, 20bits for T65 RF */ -+ retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBackPi | MaskforPhySet, bLSSIReadBackData); -+ -+ /* RT_DISP(FINIT, INIT_RF, ("Readback from RF-PI : 0x%x\n", retValue)); */ -+ } else { -+ /* Read from BBreg8a0, 12 bits for 8190, 20 bits for T65 RF */ -+ retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBack | MaskforPhySet, bLSSIReadBackData); -+ -+ /* RT_DISP(FINIT, INIT_RF,("Readback from RF-SI : 0x%x\n", retValue)); */ -+ } -+ _exit_critical_mutex(&(adapter_to_dvobj(Adapter)->rf_read_reg_mutex) , NULL); -+ return retValue; -+ -+} -+ -+/** -+* Function: phy_RFSerialWrite_8723D -+* -+* OverView: Write data to RF register (page 8~) -+* -+* Input: -+* PADAPTER Adapter, -+* RF_PATH eRFPath, -+* u4Byte Offset, -+* u4Byte Data -+* -+* -+* Output: None -+* Return: None -+* Note: Threre are three types of serial operations: -+* 1. Software serial write -+* 2. Hardware LSSI-Low Speed Serial Interface -+* 3. Hardware HSSI-High speed -+* serial write. Driver need to implement (1) and (2). -+* This function is equal to the combination of RF_ReadReg() and RFLSSIRead() -+ * -+ * Note: For RF8256 only -+ * The total count of RTL8256(Zebra4) register is around 36 bit it only employs -+ * 4-bit RF address. RTL8256 uses "register mode control bit" (Reg00[12], Reg00[10]) -+ * to access register address bigger than 0xf. See "Appendix-4 in PHY Configuration -+ * programming guide" for more details. -+ * Thus, we define a sub-finction for RTL8526 register address conversion -+ * =========================================================== -+ * Register Mode RegCTL[1] RegCTL[0] Note -+ * (Reg00[12]) (Reg00[10]) -+ * =========================================================== -+ * Reg_Mode0 0 x Reg 0 ~15(0x0 ~ 0xf) -+ * ------------------------------------------------------------------ -+ * Reg_Mode1 1 0 Reg 16 ~30(0x1 ~ 0xf) -+ * ------------------------------------------------------------------ -+ * Reg_Mode2 1 1 Reg 31 ~ 45(0x1 ~ 0xf) -+ * ------------------------------------------------------------------ -+ * -+ * 2008/09/02 MH Add 92S RF definition -+ * -+ * -+ * -+*/ -+static VOID -+phy_RFSerialWrite_8723D( -+ IN PADAPTER Adapter, -+ IN RF_PATH eRFPath, -+ IN u32 Offset, -+ IN u32 Data -+) -+{ -+ u32 DataAndAddr = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ BB_REGISTER_DEFINITION_T *pPhyReg = &pHalData->PHYRegDef[eRFPath]; -+ u32 NewOffset; -+ -+ Offset &= 0xff; -+ -+ /* */ -+ /* Shadow Update */ -+ /* */ -+ /* PHY_RFShadowWrite(Adapter, eRFPath, Offset, Data); */ -+ -+ /* */ -+ /* Switch page for 8256 RF IC */ -+ /* */ -+ NewOffset = Offset; -+ -+ /* */ -+ /* Put write addr in [5:0] and write data in [31:16] */ -+ /* */ -+ /* DataAndAddr = (Data<<16) | (NewOffset&0x3f); */ -+ DataAndAddr = ((NewOffset << 20) | (Data & 0x000fffff)) & 0x0fffffff; /* T65 RF */ -+ -+ /* */ -+ /* Write Operation */ -+ /* */ -+ PHY_SetBBReg(Adapter, pPhyReg->rf3wireOffset, bMaskDWord, DataAndAddr); -+ /* RTPRINT(FPHY, PHY_RFW, ("RFW-%d Addr[0x%lx]=0x%lx\n", eRFPath, pPhyReg->rf3wireOffset, DataAndAddr)); */ -+ -+} -+ -+ -+/** -+* Function: PHY_QueryRFReg -+* -+* OverView: Query "Specific bits" to RF register (page 8~) -+* -+* Input: -+* PADAPTER Adapter, -+* RF_PATH eRFPath, -+* u4Byte RegAddr, -+* u4Byte BitMask -+* -+* -+* Output: None -+* Return: u4Byte Readback value -+* Note: This function is equal to "GetRFRegSetting" in PHY programming guide -+*/ -+u32 -+PHY_QueryRFReg_8723D( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask -+) -+{ -+ u32 Original_Value, Readback_Value, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return 0; -+#endif -+ -+ Original_Value = phy_RFSerialRead_8723D(Adapter, eRFPath, RegAddr); -+ -+ BitShift = phy_CalculateBitShift(BitMask); -+ Readback_Value = (Original_Value & BitMask) >> BitShift; -+ -+ return Readback_Value; -+} -+ -+/** -+* Function: PHY_SetRFReg -+* -+* OverView: Write "Specific bits" to RF register (page 8~) -+* -+* Input: -+* PADAPTER Adapter, -+* RF_PATH eRFPath, -+* u4Byte RegAddr, -+* u4Byte BitMask -+* -+* u4Byte Data -+* -+* -+* Output: None -+* Return: None -+* Note: This function is equal to "PutRFRegSetting" in PHY programming guide -+*/ -+VOID -+PHY_SetRFReg_8723D( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+) -+{ -+ u32 Original_Value, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return; -+#endif -+ -+ /* RF data is 12 bits only */ -+ if (BitMask != bRFRegOffsetMask) { -+ Original_Value = phy_RFSerialRead_8723D(Adapter, eRFPath, RegAddr); -+ BitShift = phy_CalculateBitShift(BitMask); -+ Data = ((Original_Value & (~BitMask)) | (Data << BitShift)); -+ } -+ -+ phy_RFSerialWrite_8723D(Adapter, eRFPath, RegAddr, Data); -+} -+ -+ -+/* -+ * 3. Initial MAC/BB/RF config by reading MAC/BB/RF txt. -+ * */ -+ -+ -+/*----------------------------------------------------------------------------- -+ * Function: PHY_MACConfig8192C -+ * -+ * Overview: Condig MAC by header file or parameter file. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 08/12/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+s32 PHY_MACConfig8723D(PADAPTER Adapter) -+{ -+ int rtStatus = _SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ /* */ -+ /* Config MAC */ -+ /* */ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ rtStatus = phy_ConfigMACWithParaFile(Adapter, PHY_FILE_MAC_REG); -+ if (rtStatus == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ ODM_ConfigMACWithHeaderFile(&pHalData->odmpriv); -+ rtStatus = _SUCCESS; -+#endif/* CONFIG_EMBEDDED_FWIMG */ -+ } -+ -+ return rtStatus; -+} -+ -+/** -+* Function: phy_InitBBRFRegisterDefinition -+* -+* OverView: Initialize Register definition offset for Radio Path A/B/C/D -+* -+* Input: -+* PADAPTER Adapter, -+* -+* Output: None -+* Return: None -+* Note: The initialization value is constant and it should never be changes -+*/ -+static VOID -+phy_InitBBRFRegisterDefinition( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ /* RF Interface Sowrtware Control */ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfs = rFPGA0_XAB_RFInterfaceSW; /* 16 LSBs if read 32-bit from 0x870 */ -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfs = rFPGA0_XAB_RFInterfaceSW; /* 16 MSBs if read 32-bit from 0x870 (16-bit for 0x872) */ -+ -+ /* RF Interface Output (and Enable) */ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfo = rFPGA0_XA_RFInterfaceOE; /* 16 LSBs if read 32-bit from 0x860 */ -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfo = rFPGA0_XB_RFInterfaceOE; /* 16 LSBs if read 32-bit from 0x864 */ -+ -+ /* RF Interface (Output and) Enable */ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfe = rFPGA0_XA_RFInterfaceOE; /* 16 MSBs if read 32-bit from 0x860 (16-bit for 0x862) */ -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfe = rFPGA0_XB_RFInterfaceOE; /* 16 MSBs if read 32-bit from 0x864 (16-bit for 0x866) */ -+ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rf3wireOffset = rFPGA0_XA_LSSIParameter; /* LSSI Parameter */ -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rf3wireOffset = rFPGA0_XB_LSSIParameter; -+ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfHSSIPara2 = rFPGA0_XA_HSSIParameter2; /* wire control parameter2 */ -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfHSSIPara2 = rFPGA0_XB_HSSIParameter2; /* wire control parameter2 */ -+ -+ /* Tranceiver Readback LSSI/HSPI mode */ -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfLSSIReadBack = rFPGA0_XA_LSSIReadBack; -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfLSSIReadBack = rFPGA0_XB_LSSIReadBack; -+ pHalData->PHYRegDef[ODM_RF_PATH_A].rfLSSIReadBackPi = TransceiverA_HSPI_Readback; -+ pHalData->PHYRegDef[ODM_RF_PATH_B].rfLSSIReadBackPi = TransceiverB_HSPI_Readback; -+ -+} -+ -+static int -+phy_BB8723d_Config_ParaFile( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rtStatus = _SUCCESS; -+ -+ /* */ -+ /* 1. Read PHY_REG.TXT BB INIT!! */ -+ /* */ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (phy_ConfigBBWithParaFile(Adapter, PHY_FILE_PHY_REG, CONFIG_BB_PHY_REG) == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG)) -+ rtStatus = _FAIL; -+#endif -+ } -+ -+ if (rtStatus != _SUCCESS) { -+ RTW_INFO("%s():Write BB Reg Fail!!", __func__); -+ goto phy_BB8190_Config_ParaFile_Fail; -+ } -+ -+#if MP_DRIVER == 1 -+ if (Adapter->registrypriv.mp_mode == 1) { -+ /*20160504, Suggested by jessica_wang. To Fix CCK ACPR issue*/ -+ PHY_SetBBReg(Adapter, 0xCE0, BIT1|BIT0, 0);/*RXHP=low corner*/ -+ PHY_SetBBReg(Adapter, 0xC3C, 0xFF, 0xCC);/*make sure low rate sensitivity*/ -+ } -+#endif /* #if (MP_DRIVER == 1) */ -+ -+ /* */ -+ /* 2. Read BB AGC table Initialization */ -+ /* */ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (phy_ConfigBBWithParaFile(Adapter, PHY_FILE_AGC_TAB, CONFIG_BB_AGC_TAB) == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_AGC_TAB)) -+ rtStatus = _FAIL; -+#endif -+ } -+ -+ if (rtStatus != _SUCCESS) { -+ RTW_INFO("%s():AGC Table Fail\n", __func__); -+ goto phy_BB8190_Config_ParaFile_Fail; -+ } -+ -+phy_BB8190_Config_ParaFile_Fail: -+ -+ return rtStatus; -+} -+ -+ -+int -+PHY_BBConfig8723D( -+ IN PADAPTER Adapter -+) -+{ -+ int rtStatus = _SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u32 RegVal; -+ u8 TmpU1B = 0; -+ u8 value8; -+ -+ phy_InitBBRFRegisterDefinition(Adapter); -+ -+ /* Enable BB and RF */ -+ RegVal = rtw_read16(Adapter, REG_SYS_FUNC_EN); -+ rtw_write16(Adapter, REG_SYS_FUNC_EN, (u16)(RegVal | BIT(13) | BIT(0) | BIT(1))); -+ -+ rtw_write8(Adapter, REG_RF_CTRL, RF_EN | RF_RSTB | RF_SDMRSTB); -+ -+#if (DEV_BUS_TYPE == RT_USB_INTERFACE) -+ rtw_write8(Adapter, REG_SYS_FUNC_EN, FEN_USBA | FEN_USBD | FEN_BB_GLB_RSTn | FEN_BBRSTB); -+#else -+ rtw_write8(Adapter, REG_SYS_FUNC_EN, FEN_PPLL | FEN_PCIEA | FEN_DIO_PCIE | FEN_BB_GLB_RSTn | FEN_BBRSTB); -+#endif -+ -+#if DEV_BUS_TYPE == RT_USB_INTERFACE -+ /* To Fix MAC loopback mode fail. Suggested by SD4 Johnny. 2010.03.23. */ -+ PlatformEFIOWrite1Byte(Adapter, REG_LDOHCI12_CTRL, 0x0f); -+ PlatformEFIOWrite1Byte(Adapter, 0x15, 0xe9); -+#endif -+ -+ rtw_write8(Adapter, REG_AFE_XTAL_CTRL + 1, 0x80); -+ -+ /* -+ * Config BB and AGC -+ */ -+ rtStatus = phy_BB8723d_Config_ParaFile(Adapter); -+ -+ hal_set_crystal_cap(Adapter, pHalData->CrystalCap); -+ -+ return rtStatus; -+} -+#if 0 -+/* Block & Path enable */ -+#define rOFDMCCKEN_Jaguar 0x808 /* OFDM/CCK block enable */ -+#define bOFDMEN_Jaguar 0x20000000 -+#define bCCKEN_Jaguar 0x10000000 -+#define rRxPath_Jaguar 0x808 /* Rx antenna */ -+#define bRxPath_Jaguar 0xff -+#define rTxPath_Jaguar 0x80c /* Tx antenna */ -+#define bTxPath_Jaguar 0x0fffffff -+#define rCCK_RX_Jaguar 0xa04 /* for cck rx path selection */ -+#define bCCK_RX_Jaguar 0x0c000000 -+#define rVhtlen_Use_Lsig_Jaguar 0x8c3 /* Use LSIG for VHT length */ -+VOID -+PHY_BB8723D_Config_1T( -+ IN PADAPTER Adapter -+) -+{ -+ /* BB OFDM RX Path_A */ -+ PHY_SetBBReg(Adapter, rRxPath_Jaguar, bRxPath_Jaguar, 0x11); -+ /* BB OFDM TX Path_A */ -+ PHY_SetBBReg(Adapter, rTxPath_Jaguar, bMaskLWord, 0x1111); -+ /* BB CCK R/Rx Path_A */ -+ PHY_SetBBReg(Adapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); -+ /* MCS support */ -+ PHY_SetBBReg(Adapter, 0x8bc, 0xc0000060, 0x4); -+ /* RF Path_B HSSI OFF */ -+ PHY_SetBBReg(Adapter, 0xe00, 0xf, 0x4); -+ /* RF Path_B Power Down */ -+ PHY_SetBBReg(Adapter, 0xe90, bMaskDWord, 0); -+ /* ADDA Path_B OFF */ -+ PHY_SetBBReg(Adapter, 0xe60, bMaskDWord, 0); -+ PHY_SetBBReg(Adapter, 0xe64, bMaskDWord, 0); -+} -+#endif -+ -+int -+PHY_RFConfig8723D( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rtStatus = _SUCCESS; -+ -+ /* */ -+ /* RF config */ -+ /* */ -+ rtStatus = PHY_RF6052_Config8723D(Adapter); -+ /* 20151207 LCK done at RadioA table */ -+ /* PHY_BB8723D_Config_1T(Adapter); */ -+ -+ return rtStatus; -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: PHY_ConfigRFWithParaFile() -+ * -+ * Overview: This function read RF parameters from general file format, and do RF 3-wire -+ * -+ * Input: PADAPTER Adapter -+ * ps1Byte pFileName -+ * RF_PATH eRFPath -+ * -+ * Output: NONE -+ * -+ * Return: RT_STATUS_SUCCESS: configuration file exist -+ * -+ * Note: Delay may be required for RF configuration -+ *---------------------------------------------------------------------------*/ -+int -+PHY_ConfigRFWithParaFile_8723D( -+ IN PADAPTER Adapter, -+ IN u8 *pFileName, -+ RF_PATH eRFPath -+) -+{ -+ return _SUCCESS; -+} -+ -+/************************************************************************************************************** -+ * Description: -+ * The low-level interface to set TxAGC , called by both MP and Normal Driver. -+ * -+ * <20120830, Kordan> -+ **************************************************************************************************************/ -+ -+VOID -+PHY_SetTxPowerIndex_8723D( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+) -+{ -+ if (RFPath == ODM_RF_PATH_A || RFPath == ODM_RF_PATH_B) { -+ switch (Rate) { -+ case MGN_1M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, PowerIndex); -+ break; -+ case MGN_2M: -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte1, PowerIndex); -+ break; -+ case MGN_5_5M: -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte2, PowerIndex); -+ break; -+ case MGN_11M: -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte3, PowerIndex); -+ break; -+ -+ case MGN_6M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte0, PowerIndex); -+ break; -+ case MGN_9M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte1, PowerIndex); -+ break; -+ case MGN_12M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte2, PowerIndex); -+ break; -+ case MGN_18M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte3, PowerIndex); -+ break; -+ -+ case MGN_24M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte0, PowerIndex); -+ break; -+ case MGN_36M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte1, PowerIndex); -+ break; -+ case MGN_48M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte2, PowerIndex); -+ break; -+ case MGN_54M: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte3, PowerIndex); -+ break; -+ -+ case MGN_MCS0: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte0, PowerIndex); -+ break; -+ case MGN_MCS1: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte1, PowerIndex); -+ break; -+ case MGN_MCS2: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte2, PowerIndex); -+ break; -+ case MGN_MCS3: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte3, PowerIndex); -+ break; -+ -+ case MGN_MCS4: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte0, PowerIndex); -+ break; -+ case MGN_MCS5: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte1, PowerIndex); -+ break; -+ case MGN_MCS6: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte2, PowerIndex); -+ break; -+ case MGN_MCS7: -+ PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte3, PowerIndex); -+ break; -+ -+ default: -+ RTW_INFO("Invalid Rate!!\n"); -+ break; -+ } -+ } -+} -+ -+u8 -+phy_GetCurrentTxNum_8723D( -+ IN PADAPTER pAdapter -+) -+{ -+ return RF_TX_NUM_NONIMPLEMENT; -+} -+ -+u8 -+PHY_GetTxPowerIndex_8723D( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN u8 BandWidth, -+ IN u8 Channel, -+ struct txpwr_idx_comp *tic -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ u8 base_idx = 0, power_idx = 0; -+ s8 by_rate_diff = 0, limit = 0, tpt_offset = 0, extra_bias = 0; -+ BOOLEAN bIn24G = _FALSE; -+ -+ base_idx = PHY_GetTxPowerIndexBase(pAdapter, RFPath, Rate, BandWidth, Channel, &bIn24G); -+ -+ by_rate_diff = PHY_GetTxPowerByRate(pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, RF_1TX, Rate); -+ limit = PHY_GetTxPowerLimit(pAdapter, pAdapter->registrypriv.RegPwrTblSel, (u8)(!bIn24G), pHalData->CurrentChannelBW, RFPath, Rate, pHalData->CurrentChannel); -+ -+ tpt_offset = PHY_GetTxPowerTrackingOffset(pAdapter, RFPath, Rate); -+ -+ if (tic) { -+ tic->base = base_idx; -+ tic->by_rate = by_rate_diff; -+ tic->limit = limit; -+ tic->tpt = tpt_offset; -+ tic->ebias = extra_bias; -+ } -+ -+ by_rate_diff = by_rate_diff > limit ? limit : by_rate_diff; -+ power_idx = base_idx + by_rate_diff + tpt_offset + extra_bias; -+ -+ if (power_idx > MAX_POWER_INDEX) -+ power_idx = MAX_POWER_INDEX; -+ -+ return power_idx; -+} -+ -+VOID -+PHY_SetTxPowerLevel8723D( -+ IN PADAPTER Adapter, -+ IN u8 Channel -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ u8 cur_antenna; -+ u8 RFPath = ODM_RF_PATH_A; -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ rtw_hal_get_odm_var(Adapter, HAL_ODM_ANTDIV_SELECT, &cur_antenna, NULL); -+ -+ if (pHalData->AntDivCfg) /* antenna diversity Enable */ -+ RFPath = ((cur_antenna == MAIN_ANT) ? ODM_RF_PATH_A : ODM_RF_PATH_B); -+ else /* antenna diversity disable */ -+#endif -+ RFPath = pHalData->ant_path; -+ -+ -+ -+ PHY_SetTxPowerLevelByPath(Adapter, Channel, RFPath); -+ -+} -+ -+VOID -+PHY_GetTxPowerLevel8723D( -+ IN PADAPTER Adapter, -+ OUT s32 *powerlevel -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ s32 TxPwrDbm = 13; -+#if 0 -+ -+ if (pMgntInfo->ClientConfigPwrInDbm != UNSPECIFIED_PWR_DBM) -+ *powerlevel = pMgntInfo->ClientConfigPwrInDbm; -+ else -+ *powerlevel = TxPwrDbm; -+#endif -+} -+ -+ -+/* <20160217, Jessica> A workaround to eliminate the 2472MHz & 2484MHz spur of 8723D. */ -+VOID -+phy_SpurCalibration_8723D( -+ IN PADAPTER pAdapter, -+ IN u1Byte ToChannel, -+ IN u1Byte threshold -+) -+{ -+ u4Byte freq[2] = {0xFCCD, 0xFF9A}; /* {chnl 13, 14} */ -+ u1Byte idx = 0xFF; -+ u1Byte b_doNotch = FALSE; -+ u1Byte initial_gain; -+ -+ /* add for notch */ -+ u4Byte wlan_channel, CurrentChannel; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ /* check threshold */ -+ if (threshold <= 0x0) -+ threshold = 0x16; -+ -+ RTW_INFO("===>phy_SpurCalibration_8723D: Channel = %d\n", ToChannel); -+ -+ if (ToChannel == 13) -+ idx = 0; -+ else if (ToChannel == 14) -+ idx = 1; -+ -+ /* If current channel=13,14 */ -+ if (idx < 0xFF) { -+ initial_gain = (u1Byte)(ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0) & 0x7f); -+ odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, 0x30); -+ PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, bMaskDWord, 0xccf000c0); /* disable 3-wire */ -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_PSDFunction, bMaskDWord, freq[idx]); /* Setup PSD */ -+ PHY_SetBBReg(pAdapter, rFPGA0_PSDFunction, bMaskDWord, 0x400000 | freq[idx]); /* Start PSD */ -+ -+ rtw_msleep_os(30); -+ -+ if (PHY_QueryBBReg(pAdapter, rFPGA0_PSDReport, bMaskDWord) >= threshold) -+ b_doNotch = TRUE; -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_PSDFunction, bMaskDWord, freq[idx]); /* turn off PSD */ -+ PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, bMaskDWord, 0xccc000c0); /* enable 3-wire */ -+ odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, NONE); -+ } -+ -+ /* --- Notch Filter --- Asked by Rock */ -+ if (b_doNotch) { -+ CurrentChannel = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); -+ wlan_channel = CurrentChannel & 0x0f; /* Get center frequency */ -+ -+ switch (wlan_channel) { /* Set notch filter */ -+ case 13: -+ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0xB); -+ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(9), 0x1); /* enable notch filter */ -+ ODM_SetBBReg(pDM_Odm, 0xD40, bMaskDWord, 0x04000000); -+ ODM_SetBBReg(pDM_Odm, 0xD44, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, 0xD48, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, 0xD4C, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, 0xD2C, BIT(28), 0x1); /* enable CSI mask */ -+ break; -+ case 14: -+ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0x5); -+ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(9), 0x1); /* enable notch filter */ -+ ODM_SetBBReg(pDM_Odm, 0xD40, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, 0xD44, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, 0xD48, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, 0xD4C, bMaskDWord, 0x00080000); -+ ODM_SetBBReg(pDM_Odm, 0xD2C, BIT(28), 0x1); /* enable CSI mask */ -+ break; -+ default: -+ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(9), 0x0); /* disable notch filter */ -+ ODM_SetBBReg(pDM_Odm, 0xD2C, BIT(28), 0x0); /* disable CSI mask function */ -+ break; -+ } /* switch(wlan_channel) */ -+ return; -+ } -+ -+ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0x1f); -+ ODM_SetBBReg(pDM_Odm, 0xC40, BIT(9), 0x0); /* disable notch filter */ -+ ODM_SetBBReg(pDM_Odm, 0xD40, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, 0xD44, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, 0xD48, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, 0xD4C, bMaskDWord, 0x00000000); -+ ODM_SetBBReg(pDM_Odm, 0xD2C, BIT(28), 0x0); /* disable CSI mask */ -+} -+ -+VOID -+phy_SetRegBW_8723D( -+ IN PADAPTER Adapter, -+ CHANNEL_WIDTH CurrentBW -+) -+{ -+ u16 RegRfMod_BW, u2tmp = 0; -+ -+ RegRfMod_BW = rtw_read16(Adapter, REG_TRXPTCL_CTL_8723D); -+ -+ switch (CurrentBW) { -+ case CHANNEL_WIDTH_20: -+ rtw_write16(Adapter, REG_TRXPTCL_CTL_8723D, (RegRfMod_BW & 0xFE7F)); /* BIT 7 = 0, BIT 8 = 0 */ -+ break; -+ -+ case CHANNEL_WIDTH_40: -+ u2tmp = RegRfMod_BW | BIT(7); -+ rtw_write16(Adapter, REG_TRXPTCL_CTL_8723D, (u2tmp & 0xFEFF)); /* BIT 7 = 1, BIT 8 = 0 */ -+ break; -+ -+ case CHANNEL_WIDTH_80: -+ u2tmp = RegRfMod_BW | BIT(8); -+ rtw_write16(Adapter, REG_TRXPTCL_CTL_8723D, (u2tmp & 0xFF7F)); /* BIT 7 = 0, BIT 8 = 1 */ -+ break; -+ -+ default: -+ RTW_INFO("phy_PostSetBWMode8723D(): unknown Bandwidth: %#X\n", CurrentBW); -+ break; -+ } -+} -+ -+u8 -+phy_GetSecondaryChnl_8723D( -+ IN PADAPTER Adapter -+) -+{ -+ u8 SCSettingOf40 = 0, SCSettingOf20 = 0; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) { -+ if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOf40 = VHT_DATA_SC_40_LOWER_OF_80MHZ; -+ else if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOf40 = VHT_DATA_SC_40_UPPER_OF_80MHZ; -+ -+ -+ if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOf20 = VHT_DATA_SC_20_LOWEST_OF_80MHZ; -+ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOf20 = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOf20 = VHT_DATA_SC_20_UPPERST_OF_80MHZ; -+ -+ } else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) { -+ -+ if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOf20 = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ -+ } -+ -+ return (SCSettingOf40 << 4) | SCSettingOf20; -+} -+ -+void -+phy_PostSetBwMode8723D( -+ IN PADAPTER padapter -+) -+{ -+ u1Byte SubChnlNum = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ /* 2 Set Reg668 Reg440 BW */ -+ phy_SetRegBW_8723D(padapter, pHalData->CurrentChannelBW); -+ -+ /* 3 Set Reg483 */ -+ SubChnlNum = phy_GetSecondaryChnl_8723D(padapter); -+ rtw_write8(padapter, REG_DATA_SC_8723D, SubChnlNum); -+ -+ switch (pHalData->CurrentChannelBW) { -+ /* 20 MHz channel*/ -+ case CHANNEL_WIDTH_20: -+ /* -+ 0x800[0]=1'b0 -+ 0x900[0]=1'b0 -+ 0x954[19]=1'b1 -+ 0x954[27:24]= 10 -+ */ -+ PHY_SetBBReg(padapter, rFPGA0_RFMOD, bRFMOD, 0x0); -+ PHY_SetBBReg(padapter, rFPGA1_RFMOD, bRFMOD, 0x0); -+ PHY_SetBBReg(padapter, rBBrx_DFIR, BIT(19), 1); -+ PHY_SetBBReg(padapter, rBBrx_DFIR, -+ (BIT(27) | BIT(26) | BIT(25) | BIT(24)), 0xa); -+ break; -+ /* 40 MHz channel*/ -+ case CHANNEL_WIDTH_40: -+ /* -+ 0x800[0]=1'b1 -+ 0x900[0]=1'b1 -+ 0x954[19]=1'b0 -+ 0x954[23:20]=2'b11(For ACPR) -+ 0xa00[4]=1/0 -+ */ -+ PHY_SetBBReg(padapter, rFPGA0_RFMOD, bRFMOD, 0x1); -+ PHY_SetBBReg(padapter, rFPGA1_RFMOD, bRFMOD, 0x1); -+ PHY_SetBBReg(padapter, rBBrx_DFIR, BIT(19), 0); -+ PHY_SetBBReg(padapter, rCCK0_System, bCCKSideBand, -+ (pHalData->nCur40MhzPrimeSC >> 1)); -+ -+ break; -+ default: -+ break; -+ } -+ -+ /*3<3>Set RF related register */ -+ PHY_RF6052SetBandwidth8723D(padapter, pHalData->CurrentChannelBW); -+} -+ -+VOID -+phy_SwChnl8723D( -+ IN PADAPTER pAdapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 channelToSW = pHalData->CurrentChannel; -+ u8 i = 0; -+ -+ if (pHalData->rf_chip == RF_PSEUDO_11N) { -+ RTW_INFO("phy_SwChnl8723D: return for PSEUDO\n"); -+ return; -+ } -+ -+ pHalData->RfRegChnlVal[0] = -+ ((pHalData->RfRegChnlVal[0] & 0xfffff00) | channelToSW); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_CHNLBW, -+ 0x3FF, pHalData->RfRegChnlVal[0]); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_CHNLBW, -+ 0x3FF, pHalData->RfRegChnlVal[0]); -+ -+ phy_SpurCalibration_8723D(pAdapter, channelToSW, 0x16); -+ -+ /* 2.4G CCK TX DFIR */ -+ /* 2016.01.20 Suggest from RS BB mingzhi*/ -+ if (channelToSW >= 1 && channelToSW <= 13) { -+ if (pHalData->need_restore == _TRUE) { -+ for (i = 0 ; i < 3 ; i++) { -+ PHY_SetBBReg(pAdapter, -+ pHalData->RegForRecover[i].offset, -+ bMaskDWord, -+ pHalData->RegForRecover[i].value); -+ } -+ pHalData->need_restore = _FALSE; -+ } -+ } else if (channelToSW == 14) { -+ pHalData->need_restore = _TRUE; -+ PHY_SetBBReg(pAdapter, rCCK0_TxFilter2, bMaskDWord, 0x0000B81C); -+ PHY_SetBBReg(pAdapter, rCCK0_DebugPort, bMaskDWord, 0x00000000); -+ PHY_SetBBReg(pAdapter, 0xAAC, bMaskDWord, 0x00003667); -+ } -+ -+ RTW_INFO("===>phy_SwChnl8723D: Channel = %d\n", channelToSW); -+} -+ -+VOID -+phy_SwChnlAndSetBwMode8723D( -+ IN PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if (Adapter->bNotifyChannelChange) { -+ RTW_INFO("[%s] bSwChnl=%d, ch=%d, bSetChnlBW=%d, bw=%d\n", -+ __func__, -+ pHalData->bSwChnl, -+ pHalData->CurrentChannel, -+ pHalData->bSetChnlBW, -+ pHalData->CurrentChannelBW); -+ } -+ -+ if (RTW_CANNOT_RUN(Adapter)) -+ return; -+ -+ if (pHalData->bSwChnl) { -+ phy_SwChnl8723D(Adapter); -+ pHalData->bSwChnl = _FALSE; -+ } -+ -+ if (pHalData->bSetChnlBW) { -+ phy_PostSetBwMode8723D(Adapter); -+ pHalData->bSetChnlBW = _FALSE; -+ } -+ -+ PHY_SetTxPowerLevel8723D(Adapter, pHalData->CurrentChannel); -+} -+ -+VOID -+PHY_HandleSwChnlAndSetBW8723D( -+ IN PADAPTER Adapter, -+ IN BOOLEAN bSwitchChannel, -+ IN BOOLEAN bSetBandWidth, -+ IN u8 ChannelNum, -+ IN CHANNEL_WIDTH ChnlWidth, -+ IN EXTCHNL_OFFSET ExtChnlOffsetOf40MHz, -+ IN EXTCHNL_OFFSET ExtChnlOffsetOf80MHz, -+ IN u8 CenterFrequencyIndex1 -+) -+{ -+ /* static BOOLEAN bInitialzed = _FALSE; */ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ u8 tmpChannel = pHalData->CurrentChannel; -+ CHANNEL_WIDTH tmpBW = pHalData->CurrentChannelBW; -+ u8 tmpnCur40MhzPrimeSC = pHalData->nCur40MhzPrimeSC; -+ u8 tmpnCur80MhzPrimeSC = pHalData->nCur80MhzPrimeSC; -+ u8 tmpCenterFrequencyIndex1 = pHalData->CurrentCenterFrequencyIndex1; -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ -+ /* RTW_INFO("=> PHY_HandleSwChnlAndSetBW8812: bSwitchChannel %d, bSetBandWidth %d\n",bSwitchChannel,bSetBandWidth); */ -+ -+ /* check is swchnl or setbw */ -+ if (!bSwitchChannel && !bSetBandWidth) { -+ RTW_INFO("PHY_HandleSwChnlAndSetBW8812: not switch channel and not set bandwidth\n"); -+ return; -+ } -+ -+ /* skip change for channel or bandwidth is the same */ -+ if (bSwitchChannel) { -+ /* if(pHalData->CurrentChannel != ChannelNum) */ -+ { -+ if (HAL_IsLegalChannel(Adapter, ChannelNum)) -+ pHalData->bSwChnl = _TRUE; -+ } -+ } -+ -+ if (bSetBandWidth) { -+#if 0 -+ if (bInitialzed == _FALSE) { -+ bInitialzed = _TRUE; -+ pHalData->bSetChnlBW = _TRUE; -+ } else if ((pHalData->CurrentChannelBW != ChnlWidth) || (pHalData->nCur40MhzPrimeSC != ExtChnlOffsetOf40MHz) || (pHalData->CurrentCenterFrequencyIndex1 != CenterFrequencyIndex1)) -+ pHalData->bSetChnlBW = _TRUE; -+#else -+ pHalData->bSetChnlBW = _TRUE; -+#endif -+ } -+ -+ if (!pHalData->bSetChnlBW && !pHalData->bSwChnl) { -+ /* RTW_INFO("<= PHY_HandleSwChnlAndSetBW8812: bSwChnl %d, bSetChnlBW %d\n",pHalData->bSwChnl,pHalData->bSetChnlBW); */ -+ return; -+ } -+ -+ -+ if (pHalData->bSwChnl) { -+ pHalData->CurrentChannel = ChannelNum; -+ pHalData->CurrentCenterFrequencyIndex1 = ChannelNum; -+ } -+ -+ -+ if (pHalData->bSetChnlBW) { -+ pHalData->CurrentChannelBW = ChnlWidth; -+#if 0 -+ if (ExtChnlOffsetOf40MHz == EXTCHNL_OFFSET_LOWER) -+ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else if (ExtChnlOffsetOf40MHz == EXTCHNL_OFFSET_UPPER) -+ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else -+ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if (ExtChnlOffsetOf80MHz == EXTCHNL_OFFSET_LOWER) -+ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else if (ExtChnlOffsetOf80MHz == EXTCHNL_OFFSET_UPPER) -+ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else -+ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+#else -+ pHalData->nCur40MhzPrimeSC = ExtChnlOffsetOf40MHz; -+ pHalData->nCur80MhzPrimeSC = ExtChnlOffsetOf80MHz; -+#endif -+ -+ pHalData->CurrentCenterFrequencyIndex1 = CenterFrequencyIndex1; -+ } -+ -+ /* Switch workitem or set timer to do switch channel or setbandwidth operation */ -+ if (!RTW_CANNOT_RUN(Adapter)) -+ phy_SwChnlAndSetBwMode8723D(Adapter); -+ else { -+ if (pHalData->bSwChnl) { -+ pHalData->CurrentChannel = tmpChannel; -+ pHalData->CurrentCenterFrequencyIndex1 = tmpChannel; -+ } -+ if (pHalData->bSetChnlBW) { -+ pHalData->CurrentChannelBW = tmpBW; -+ pHalData->nCur40MhzPrimeSC = tmpnCur40MhzPrimeSC; -+ pHalData->nCur80MhzPrimeSC = tmpnCur80MhzPrimeSC; -+ pHalData->CurrentCenterFrequencyIndex1 = tmpCenterFrequencyIndex1; -+ } -+ } -+ -+ /* RTW_INFO("Channel %d ChannelBW %d ",pHalData->CurrentChannel, pHalData->CurrentChannelBW); */ -+ /* RTW_INFO("40MhzPrimeSC %d 80MhzPrimeSC %d ",pHalData->nCur40MhzPrimeSC, pHalData->nCur80MhzPrimeSC); */ -+ /* RTW_INFO("CenterFrequencyIndex1 %d\n",pHalData->CurrentCenterFrequencyIndex1); */ -+ -+ /* RTW_INFO("<= PHY_HandleSwChnlAndSetBW8812: bSwChnl %d, bSetChnlBW %d\n",pHalData->bSwChnl,pHalData->bSetChnlBW); */ -+ -+} -+ -+VOID -+PHY_SetSwChnlBWMode8723D( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+) -+{ -+ /* RTW_INFO("%s()===>\n",__FUNCTION__); */ -+ -+ PHY_HandleSwChnlAndSetBW8723D(Adapter, _TRUE, _TRUE, channel, Bandwidth, Offset40, Offset80, channel); -+ -+ /* RTW_INFO("<==%s()\n",__FUNCTION__); */ -+} -+ -+static VOID -+_PHY_DumpRFReg_8723D(IN PADAPTER pAdapter) -+{ -+ u32 rfRegValue, rfRegOffset; -+ -+ -+ for (rfRegOffset = 0x00; rfRegOffset <= 0x30; rfRegOffset++) { -+ rfRegValue = PHY_QueryRFReg_8723D(pAdapter, RF_PATH_A, rfRegOffset, bMaskDWord); -+ } -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rf6052.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rf6052.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rf6052.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rf6052.c 2018-02-11 21:44:27.164146345 +0200 -@@ -0,0 +1,253 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/****************************************************************************** -+ * -+ * -+ * Module: rtl8192c_rf6052.c ( Source C File) -+ * -+ * Note: Provide RF 6052 series relative API. -+ * -+ * Function: -+ * -+ * Export: -+ * -+ * Abbrev: -+ * -+ * History: -+ * Data Who Remark -+ * -+ * 09/25/2008 MHC Create initial version. -+ * 11/05/2008 MHC Add API for tw power setting. -+ * -+ * -+******************************************************************************/ -+ -+#include -+ -+/*---------------------------Define Local Constant---------------------------*/ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+ -+/*------------------------Define global variable-----------------------------*/ -+/*------------------------Define global variable-----------------------------*/ -+ -+ -+/*------------------------Define local variable------------------------------*/ -+/* 2008/11/20 MH For Debug only, RF -+ * static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG] = {0}; */ -+static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG]; -+/*------------------------Define local variable------------------------------*/ -+ -+/*----------------------------------------------------------------------------- -+ * Function: PHY_RF6052SetBandwidth() -+ * -+ * Overview: This function is called by SetBWModeCallback8190Pci() only -+ * -+ * Input: PADAPTER Adapter -+ * WIRELESS_BANDWIDTH_E Bandwidth -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Note: For RF type 0222D -+ *---------------------------------------------------------------------------*/ -+VOID -+PHY_RF6052SetBandwidth8723D( -+ IN PADAPTER padapter, -+ IN CHANNEL_WIDTH Bandwidth) /* 20M or 40M */ -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ switch (Bandwidth) { -+ case CHANNEL_WIDTH_20: -+ /* -+ RF_A_reg 0x18[11:10]=2'b11 -+ RF_A_reg 0x18[9:0] -+ */ -+ pHalData->RfRegChnlVal[0] = ((pHalData->RfRegChnlVal[0] & 0xfffff3ff) | BIT(10) | BIT(11)); -+ PHY_SetRFReg(padapter, ODM_RF_PATH_A, 0x18, bRFRegOffsetMask, pHalData->RfRegChnlVal[0]); /* RF TRX_BW */ -+ break; -+ case CHANNEL_WIDTH_40: -+ /* -+ RF_A_reg 0x18[11:10]=2'b01 -+ RF_A_reg 0x18[9:0] -+ */ -+ pHalData->RfRegChnlVal[0] = ((pHalData->RfRegChnlVal[0] & 0xfffff3ff) | BIT(10)); -+ PHY_SetRFReg(padapter, ODM_RF_PATH_A, 0x18, bRFRegOffsetMask, pHalData->RfRegChnlVal[0]); /* RF TRX_BW */ -+ break; -+ default: -+ break; -+ } -+} -+ -+static VOID -+phy_RF6052_Config_HardCode( -+ IN PADAPTER Adapter -+) -+{ -+ -+ /* Set Default Bandwidth to 20M */ -+ /* Adapter->HalFunc .SetBWModeHandler(Adapter, CHANNEL_WIDTH_20); */ -+ -+ /* TODO: Set Default Channel to channel one for RTL8225 */ -+ -+} -+ -+static int -+phy_RF6052_Config_ParaFile( -+ IN PADAPTER Adapter -+) -+{ -+ u32 u4RegValue = 0; -+ u8 eRFPath; -+ BB_REGISTER_DEFINITION_T *pPhyReg; -+ -+ int rtStatus = _SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ /* 3//----------------------------------------------------------------- */ -+ /* 3// <2> Initialize RF */ -+ /* 3//----------------------------------------------------------------- */ -+ /* for(eRFPath = RF_PATH_A; eRFPath NumTotalRFPath; eRFPath++) */ -+ for (eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) { -+ -+ pPhyReg = &pHalData->PHYRegDef[eRFPath]; -+ -+ /*----Store original RFENV control type----*/ -+ switch (eRFPath) { -+ case RF_PATH_A: -+ case RF_PATH_C: -+ u4RegValue = PHY_QueryBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV); -+ break; -+ case RF_PATH_B: -+ case RF_PATH_D: -+ u4RegValue = PHY_QueryBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV << 16); -+ break; -+ } -+ -+ /*----Set RF_ENV enable----*/ -+ PHY_SetBBReg(Adapter, pPhyReg->rfintfe, bRFSI_RFENV << 16, 0x1); -+ rtw_udelay_os(1);/* PlatformStallExecution(1); */ -+ -+ /*----Set RF_ENV output high----*/ -+ PHY_SetBBReg(Adapter, pPhyReg->rfintfo, bRFSI_RFENV, 0x1); -+ rtw_udelay_os(1);/* PlatformStallExecution(1); */ -+ -+ /* Set bit number of Address and Data for RF register */ -+ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, b3WireAddressLength, 0x0); /* Set 1 to 4 bits for 8255 */ -+ rtw_udelay_os(1);/* PlatformStallExecution(1); */ -+ -+ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, b3WireDataLength, 0x0); /* Set 0 to 12 bits for 8255 */ -+ rtw_udelay_os(1);/* PlatformStallExecution(1); */ -+ -+ /*----Initialize RF fom connfiguration file----*/ -+ switch (eRFPath) { -+ case RF_PATH_A: -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (PHY_ConfigRFWithParaFile(Adapter, PHY_FILE_RADIO_A, eRFPath) == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_FAILURE == ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv, CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) -+ rtStatus = _FAIL; -+#endif -+ } -+ break; -+ case RF_PATH_B: -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (PHY_ConfigRFWithParaFile(Adapter, PHY_FILE_RADIO_B, eRFPath) == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_FAILURE == ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv, CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) -+ rtStatus = _FAIL; -+#endif -+ } -+ break; -+ case RF_PATH_C: -+ break; -+ case RF_PATH_D: -+ break; -+ } -+ -+ /*----Restore RFENV control type----*/; -+ switch (eRFPath) { -+ case RF_PATH_A: -+ case RF_PATH_C: -+ PHY_SetBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV, u4RegValue); -+ break; -+ case RF_PATH_B: -+ case RF_PATH_D: -+ PHY_SetBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV << 16, u4RegValue); -+ break; -+ } -+ -+ if (rtStatus != _SUCCESS) { -+ goto phy_RF6052_Config_ParaFile_Fail; -+ } -+ -+ } -+ -+ /* 3 ----------------------------------------------------------------- */ -+ /* 3 Configuration of Tx Power Tracking */ -+ /* 3 ----------------------------------------------------------------- */ -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ if (PHY_ConfigRFWithTxPwrTrackParaFile(Adapter, PHY_FILE_TXPWR_TRACK) == _FAIL) -+#endif -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ ODM_ConfigRFWithTxPwrTrackHeaderFile(&pHalData->odmpriv); -+#endif -+ } -+ -+ return rtStatus; -+ -+phy_RF6052_Config_ParaFile_Fail: -+ return rtStatus; -+} -+ -+ -+int -+PHY_RF6052_Config8723D( -+ IN PADAPTER Adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rtStatus = _SUCCESS; -+ -+ /* */ -+ /* Initialize general global value */ -+ /* */ -+ /* TODO: Extend RF_PATH_C and RF_PATH_D in the future */ -+ if (pHalData->rf_type == RF_1T1R) -+ pHalData->NumTotalRFPath = 1; -+ else -+ pHalData->NumTotalRFPath = 2; -+ -+ /* */ -+ /* Config BB and RF */ -+ /* */ -+ rtStatus = phy_RF6052_Config_ParaFile(Adapter); -+ return rtStatus; -+ -+} -+ -+/* End of HalRf6052.c */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rxdesc.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rxdesc.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rxdesc.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_rxdesc.c 2018-02-11 21:44:27.164146345 +0200 -@@ -0,0 +1,62 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTL8723D_REDESC_C_ -+ -+#include -+ -+void rtl8723d_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc) -+{ -+ struct rx_pkt_attrib *pattrib; -+ -+ -+ pattrib = &precvframe->u.hdr.attrib; -+ _rtw_memset(pattrib, 0, sizeof(struct rx_pkt_attrib)); -+ -+ pattrib->pkt_len = (u16)GET_RX_STATUS_DESC_PKT_LEN_8723D(pdesc); -+ pattrib->pkt_rpt_type = GET_RX_STATUS_DESC_RPT_SEL_8723D(pdesc) ? C2H_PACKET : NORMAL_RX; -+ -+ if (pattrib->pkt_rpt_type == NORMAL_RX) { -+ /* Offset 0 */ -+ pattrib->crc_err = (u8)GET_RX_STATUS_DESC_CRC32_8723D(pdesc); -+ pattrib->icv_err = (u8)GET_RX_STATUS_DESC_ICV_8723D(pdesc); -+ pattrib->drvinfo_sz = (u8)GET_RX_STATUS_DESC_DRVINFO_SIZE_8723D(pdesc) << 3; -+ pattrib->encrypt = (u8)GET_RX_STATUS_DESC_SECURITY_8723D(pdesc); -+ pattrib->qos = (u8)GET_RX_STATUS_DESC_QOS_8723D(pdesc); -+ pattrib->shift_sz = (u8)GET_RX_STATUS_DESC_SHIFT_8723D(pdesc); -+ pattrib->physt = (u8)GET_RX_STATUS_DESC_PHY_STATUS_8723D(pdesc); -+ pattrib->bdecrypted = (u8)GET_RX_STATUS_DESC_SWDEC_8723D(pdesc) ? 0 : 1; -+ -+ /* Offset 4 */ -+ pattrib->priority = (u8)GET_RX_STATUS_DESC_TID_8723D(pdesc); -+ pattrib->amsdu = (u8)GET_RX_STATUS_DESC_AMSDU_8723D(pdesc); -+ pattrib->mdata = (u8)GET_RX_STATUS_DESC_MORE_DATA_8723D(pdesc); -+ pattrib->mfrag = (u8)GET_RX_STATUS_DESC_MORE_FRAG_8723D(pdesc); -+ -+ /* Offset 8 */ -+ pattrib->seq_num = (u16)GET_RX_STATUS_DESC_SEQ_8723D(pdesc); -+ pattrib->frag_num = (u8)GET_RX_STATUS_DESC_FRAG_8723D(pdesc); -+ -+ /* Offset 12 */ -+ pattrib->data_rate = (u8)GET_RX_STATUS_DESC_RX_RATE_8723D(pdesc); -+ -+ /* Offset 20 */ -+ /* pattrib->tsfl=(u8)GET_RX_STATUS_DESC_TSFL_8723D(pdesc); */ -+ } -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_sreset.c linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_sreset.c ---- linux-4.14.18/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_sreset.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/hal/rtl8723d/rtl8723d_sreset.c 2018-02-11 21:44:27.164146345 +0200 -@@ -0,0 +1,109 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RTL8723D_SRESET_C_ -+ -+#include -+ -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+void rtl8723d_sreset_xmit_status_check(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ unsigned long current_time; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ unsigned int diff_time; -+ u32 txdma_status; -+ -+ txdma_status = rtw_read32(padapter, REG_TXDMA_STATUS); -+ if (txdma_status != 0x00 && txdma_status != 0xeaeaeaea) { -+ RTW_INFO("%s REG_TXDMA_STATUS:0x%08x\n", __FUNCTION__, txdma_status); -+ rtw_hal_sreset_reset(padapter); -+ } -+ -+#ifdef CONFIG_USB_HCI -+ /* total xmit irp = 4 */ -+ /* DBG_8192C("==>%s free_xmitbuf_cnt(%d),txirp_cnt(%d)\n",__FUNCTION__,pxmitpriv->free_xmitbuf_cnt,pxmitpriv->txirp_cnt); */ -+ /* if(pxmitpriv->txirp_cnt == NR_XMITBUFF+1) */ -+ current_time = rtw_get_current_time(); -+ -+ if (0 == pxmitpriv->free_xmitbuf_cnt || 0 == pxmitpriv->free_xmit_extbuf_cnt) { -+ -+ diff_time = rtw_get_passing_time_ms(psrtpriv->last_tx_time); -+ -+ if (diff_time > 2000) { -+ if (psrtpriv->last_tx_complete_time == 0) -+ psrtpriv->last_tx_complete_time = current_time; -+ else { -+ diff_time = rtw_get_passing_time_ms(psrtpriv->last_tx_complete_time); -+ if (diff_time > 4000) { -+ u32 ability = 0; -+ -+ /* padapter->Wifi_Error_Status = WIFI_TX_HANG; */ -+ ability = rtw_phydm_ability_get(padapter); -+ -+ RTW_INFO("%s tx hang %s\n", __FUNCTION__, -+ (ability & ODM_BB_ADAPTIVITY) ? "ODM_BB_ADAPTIVITY" : ""); -+ -+ if (!(ability & ODM_BB_ADAPTIVITY)) -+ rtw_hal_sreset_reset(padapter); -+ } -+ } -+ } -+ } -+#endif /* #ifdef CONFIG_USB_HCI */ -+ -+ if (psrtpriv->dbg_trigger_point == SRESET_TGP_XMIT_STATUS) { -+ psrtpriv->dbg_trigger_point = SRESET_TGP_NULL; -+ rtw_hal_sreset_reset(padapter); -+ return; -+ } -+} -+ -+void rtl8723d_sreset_linked_status_check(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+#if 0 -+ u32 regc50, regc58, reg824, reg800; -+ -+ regc50 = rtw_read32(padapter, 0xc50); -+ regc58 = rtw_read32(padapter, 0xc58); -+ reg824 = rtw_read32(padapter, 0x824); -+ reg800 = rtw_read32(padapter, 0x800); -+ if (((regc50 & 0xFFFFFF00) != 0x69543400) || -+ ((regc58 & 0xFFFFFF00) != 0x69543400) || -+ (((reg824 & 0xFFFFFF00) != 0x00390000) && (((reg824 & 0xFFFFFF00) != 0x80390000))) || -+ (((reg800 & 0xFFFFFF00) != 0x03040000) && ((reg800 & 0xFFFFFF00) != 0x83040000))) { -+ DBG_8192C("%s regc50:0x%08x, regc58:0x%08x, reg824:0x%08x, reg800:0x%08x,\n", __FUNCTION__, -+ regc50, regc58, reg824, reg800); -+ rtw_hal_sreset_reset(padapter); -+ } -+#endif -+ -+ if (psrtpriv->dbg_trigger_point == SRESET_TGP_LINK_STATUS) { -+ psrtpriv->dbg_trigger_point = SRESET_TGP_NULL; -+ rtw_hal_sreset_reset(padapter); -+ return; -+ } -+} -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/autoconf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/autoconf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/autoconf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/autoconf.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,309 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define CONFIG_ODM_REFRESH_RAMASK -+#define CONFIG_PHY_SETTING_WITH_ODM -+ -+ -+/* -+ * Automatically generated C config: don't edit -+ */ -+ -+#define AUTOCONF_INCLUDED -+ -+#define RTL871X_MODULE_NAME "8723DE" -+#define DRV_NAME "rtl8723de" -+ -+#ifndef CONFIG_RTL8723D -+#define CONFIG_RTL8723D -+#endif -+#define CONFIG_PCI_HCI -+ -+/*#define CONFIG_GSPI_HCI config from Makefile*/ -+/*#define CONFIG_SDIO_HCI config from Makefile*/ -+#define PLATFORM_LINUX -+ -+#define CONFIG_EMBEDDED_FWIMG -+#ifdef CONFIG_EMBEDDED_FWIMG -+ #define LOAD_FW_HEADER_FROM_DRIVER -+#endif -+ -+/* -+ * Functions Config -+ */ -+#define CONFIG_XMIT_ACK -+#ifdef CONFIG_XMIT_ACK -+ #define CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+#endif -+#define CONFIG_80211N_HT -+#define CONFIG_RECV_REORDERING_CTRL -+ -+/*#define CONFIG_IOCTL_CFG80211*/ -+ -+#if defined(CONFIG_PLATFORM_SPRD) && !defined(ANDROID_2X) -+ #ifndef CONFIG_IOCTL_CFG80211 -+ #define CONFIG_IOCTL_CFG80211 1 -+ #endif -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ /* -+ * Indecate new sta asoc through cfg80211_new_sta -+ * If kernel version >= 3.2 or -+ * version < 3.2 but already apply cfg80211 patch, -+ * RTW_USE_CFG80211_STA_EVENT must be defiend! -+ */ -+ /*#define RTW_USE_CFG80211_STA_EVENT*/ -+ /*#define CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER*/ -+ /*#define CONFIG_DEBUG_CFG80211*/ -+ #define CONFIG_SET_SCAN_DENY_TIMER -+#endif -+ -+#define CONFIG_AP_MODE -+#ifdef CONFIG_AP_MODE -+ #define CONFIG_NATIVEAP_MLME -+ #ifndef CONFIG_NATIVEAP_MLME -+ #define CONFIG_HOSTAPD_MLME -+ #endif -+ /*#define CONFIG_FIND_BEST_CHANNEL*/ -+#endif -+ -+#define CONFIG_P2P -+#ifdef CONFIG_P2P -+ /* Added by Albert 20110812 */ -+ /* The CONFIG_WFD is for supporting the Wi-Fi display */ -+ #define CONFIG_WFD -+ -+ #define CONFIG_P2P_REMOVE_GROUP_INFO -+ -+ /*#define CONFIG_DBG_P2P*/ -+ #define CONFIG_P2P_PS -+ #define CONFIG_P2P_OP_CHK_SOCIAL_CH -+ #define CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT /* replace CONFIG_P2P_CHK_INVITE_CH_LIST flag */ -+ #define CONFIG_P2P_INVITE_IOT -+#endif -+ -+/* Added by Kurt 20110511 */ -+#ifdef CONFIG_TDLS -+ #define CONFIG_TDLS_DRIVER_SETUP -+/* #ifndef CONFIG_WFD -+ #define CONFIG_WFD -+ #endif -+*/ -+/* #define CONFIG_TDLS_AUTOSETUP */ -+ #define CONFIG_TDLS_AUTOCHECKALIVE -+ #define CONFIG_TDLS_CH_SW /* Enable "CONFIG_TDLS_CH_SW" by default, however limit it to only work in wifi logo test mode but not in normal mode currently */ -+#endif -+ -+#define CONFIG_LAYER2_ROAMING -+#define CONFIG_LAYER2_ROAMING_RESUME -+ -+/*#define CONFIG_80211D*/ -+ -+ -+ -+/* -+ * Hardware Related Config -+ */ -+/*#define CONFIG_BT_COEXIST*/ /* set from Makefile */ -+/*#define CONFIG_ANTENNA_DIVERSITY*/ -+/*#define SUPPORT_HW_RFOFF_DETECTED*/ -+ -+/*#define CONFIG_SW_LED*/ -+ -+ -+/* -+ * Interface Related Config -+ */ -+#ifdef ANDROID_2X -+#if defined(CONFIG_SDIO_HCI) -+#define CONFIG_SDIO_RX_COPY -+#define CONFIG_XMIT_THREAD_MODE -+#endif -+#endif -+ -+#define CONFIG_TRX_BD_ARCH /* PCI only */ -+#define USING_RX_TAG -+/*#define CONFIG_64BIT_DMA*/ /* Enable PCI 64bit DMA */ -+ -+/* -+ * Others -+ */ -+/*#define CONFIG_MAC_LOOPBACK_DRIVER*/ -+#define CONFIG_SKB_COPY /* for amsdu */ -+#define CONFIG_LONG_DELAY_ISSUE -+#define CONFIG_NEW_SIGNAL_STAT_PROCESS -+#define RTW_NOTCH_FILTER 0 /* 0:Disable, 1:Enable, */ -+/*#define CONFIG_PATCH_JOIN_WRONG_CHANNEL*/ -+ -+ -+/* -+ * Auto Config Section -+ */ -+#ifdef CONFIG_MAC_LOOPBACK_DRIVER -+#undef CONFIG_IOCTL_CFG80211 -+#undef CONFIG_AP_MODE -+#undef CONFIG_NATIVEAP_MLME -+#undef CONFIG_POWER_SAVING -+#undef CONFIG_BT_COEXIST -+#undef CONFIG_ANTENNA_DIVERSITY -+#undef SUPPORT_HW_RFOFF_DETECTED -+#endif -+ -+ -+/*#define CONFIG_CONCURRENT_MODE 1*/ -+#ifdef CONFIG_CONCURRENT_MODE -+ #define CONFIG_TSF_RESET_OFFLOAD 1 /* For 2 PORT TSF SYNC. */ -+ #define CONFIG_RUNTIME_PORT_SWITCH -+ /*#define DBG_RUNTIME_PORT_SWITCH*/ -+ #define CONFIG_SCAN_BACKOP -+ #if defined(CONFIG_IPS) -+ #undef CONFIG_IPS -+ #endif -+ #if defined(CONFIG_LPS) -+ #undef CONFIG_LPS -+ #undef CONFIG_LPS_LCLK -+ #endif -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ -+#ifdef CONFIG_MP_INCLUDED -+ #define MP_DRIVER 1 -+ #define CONFIG_MP_IWPRIV_SUPPORT -+ /* disable unnecessary functions for MP */ -+ /* #undef CONFIG_POWER_SAVING */ -+ /* #undef CONFIG_BT_COEXIST */ -+ /* #undef CONFIG_ANTENNA_DIVERSITY */ -+ /* #undef SUPPORT_HW_RFOFF_DETECTED */ -+#else /* !CONFIG_MP_INCLUDED */ -+ #define MP_DRIVER 0 -+ #undef CONFIG_MP_IWPRIV_SUPPORT -+#endif /* !CONFIG_MP_INCLUDED */ -+ -+ -+#ifdef CONFIG_POWER_SAVING -+ #define CONFIG_IPS -+ #define CONFIG_LPS -+ -+ #if defined(CONFIG_LPS) && (defined(CONFIG_GSPI_HCI) || defined(CONFIG_SDIO_HCI)) -+ #define CONFIG_LPS_LCLK -+ #endif -+ -+ #ifdef CONFIG_LPS_LCLK -+ #define CONFIG_LPS_RPWM_TIMER -+ #ifdef CONFIG_LPS_RPWM_TIMER -+ #define LPS_RPWM_WAIT_MS 30 -+ #endif -+ #endif -+#endif /* #ifdef CONFIG_POWER_SAVING */ -+ -+ -+#ifdef CONFIG_BT_COEXIST -+ /* for ODM and outsrc BT-Coex */ -+ #ifndef CONFIG_LPS -+ #define CONFIG_LPS /* download reserved page to FW */ -+ #endif -+#endif /* !CONFIG_BT_COEXIST */ -+ -+ -+ -+#define CONFIG_RF_POWER_TRIM -+ -+ -+#ifndef DISABLE_BB_RF -+#define DISABLE_BB_RF 0 -+#endif -+ -+#if DISABLE_BB_RF -+ #define HAL_MAC_ENABLE 0 -+ #define HAL_BB_ENABLE 0 -+ #define HAL_RF_ENABLE 0 -+#else -+ #define HAL_MAC_ENABLE 1 -+ #define HAL_BB_ENABLE 1 -+ #define HAL_RF_ENABLE 1 -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ #ifndef WAKEUP_GPIO_IDX -+ #define WAKEUP_GPIO_IDX 12 /* WIFI Chip Side */ -+ #endif /* !WAKEUP_GPIO_IDX */ -+#endif /* CONFIG_GPIO_WAKEUP */ -+ -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+#define CONFIG_HW_ANTENNA_DIVERSITY -+#endif -+ -+ -+/* -+ * Platform dependent -+ */ -+#ifdef CONFIG_PLATFORM_SPRD -+ -+/*#undef CONFIG_SDIO_RX_COPY*/ -+ -+#ifdef ANDROID_2X -+ -+/*#define CONFIG_SDIO_RX_COPY*/ -+ -+#else /* !ANDROID_2X */ -+ #undef CONFIG_WOWLAN -+ #undef CONFIG_WOWLAN_8723 -+/* #define CONFIG_SDIO_RX_COPY*/ -+/* #define CONFIG_LINKED_LCOK */ -+ #define CONFIG_AUTH_DIRECT_WITHOUT_BCN -+/* #define CONFIG_DISCONNECT_H2CWAY*/ -+/* #define CONFIG_DONT_CARE_TP */ -+ #define CONFIG_LOW_PWR_LPS -+/* #define CONFIG_CMCC_TEST*/ -+ -+ /* 1) LPS unit is only 102 ms, it's not */ -+ /* a good idear to retry it use timer, */ -+ /* 2) we must wait ACK, or lots of IO */ -+ /* is not allowed under 32k, because */ -+ /* this will cause hw hang */ -+ #undef CONFIG_LPS_RPWM_TIMER -+ #define CONFIG_WAIT_PS_ACK -+ #define CONFIG_SOFTAP_11N -+ #define CONFIG_CHECK_BT_HANG -+ -+/* #define CONFIG_8723DE_TEST */ -+#endif /* !ANDROID_2X */ -+ -+#endif /* CONFIG_PLATFORM_SPRD */ -+ -+#define CONFIG_ATTEMPT_TO_FIX_AP_BEACON_ERROR -+ -+/* -+ * Debug Related Config -+ */ -+#define CONFIG_DEBUG -+ -+#ifdef CONFIG_DEBUG -+#define DBG 1 /* for ODM & BTCOEX debug */ -+#else /* !CONFIG_DEBUG */ -+#define DBG 0 /* for ODM & BTCOEX debug */ -+#endif /* !CONFIG_DEBUG */ -+ -+#define CONFIG_PROC_DEBUG -+ -+#define DBG_CONFIG_ERROR_DETECT -+/*#define DBG_XMIT_BUF*/ -+/*#define DBG_XMIT_BUF_EXT*/ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/basic_types.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/basic_types.h ---- linux-4.14.18/3rdparty/rtl8723de/include/basic_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/basic_types.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,384 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __BASIC_TYPES_H__ -+#define __BASIC_TYPES_H__ -+ -+ -+#define SUCCESS 0 -+#define FAIL (-1) -+ -+#ifndef TRUE -+ #define _TRUE 1 -+#else -+ #define _TRUE TRUE -+#endif -+ -+#ifndef FALSE -+ #define _FALSE 0 -+#else -+ #define _FALSE FALSE -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+ typedef signed char s8; -+ typedef unsigned char u8; -+ -+ typedef signed short s16; -+ typedef unsigned short u16; -+ -+ typedef signed long s32; -+ typedef unsigned long u32; -+ -+ typedef unsigned int uint; -+ typedef signed int sint; -+ -+ -+ typedef signed long long s64; -+ typedef unsigned long long u64; -+ -+ #ifdef NDIS50_MINIPORT -+ -+ #define NDIS_MAJOR_VERSION 5 -+ #define NDIS_MINOR_VERSION 0 -+ -+ #endif -+ -+ #ifdef NDIS51_MINIPORT -+ -+ #define NDIS_MAJOR_VERSION 5 -+ #define NDIS_MINOR_VERSION 1 -+ -+ #endif -+ -+ typedef NDIS_PROC proc_t; -+ -+ typedef LONG atomic_t; -+ -+#endif -+ -+ -+#ifdef PLATFORM_LINUX -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #define IN -+ #define OUT -+ #define VOID void -+ #define NDIS_OID uint -+ #define NDIS_STATUS uint -+ -+ typedef signed int sint; -+ -+ #ifndef PVOID -+ typedef void *PVOID; -+ /* #define PVOID (void *) */ -+ #endif -+ -+ #define UCHAR u8 -+ #define USHORT u16 -+ #define UINT u32 -+ #define ULONG u32 -+ -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 19)) -+ typedef _Bool bool; -+ #endif -+ -+ typedef void (*proc_t)(void *); -+ -+ typedef __kernel_size_t SIZE_T; -+ typedef __kernel_ssize_t SSIZE_T; -+ #define FIELD_OFFSET(s, field) ((SSIZE_T)&((s *)(0))->field) -+ -+#endif -+ -+ -+#ifdef PLATFORM_FREEBSD -+ -+ typedef signed char s8; -+ typedef unsigned char u8; -+ -+ typedef signed short s16; -+ typedef unsigned short u16; -+ -+ typedef signed int s32; -+ typedef unsigned int u32; -+ -+ typedef unsigned int uint; -+ typedef signed int sint; -+ typedef long atomic_t; -+ -+ typedef signed long long s64; -+ typedef unsigned long long u64; -+ #define IN -+ #define OUT -+ #define VOID void -+ #define NDIS_OID uint -+ #define NDIS_STATUS uint -+ -+ #ifndef PVOID -+ typedef void *PVOID; -+ /* #define PVOID (void *) */ -+ #endif -+ typedef u32 dma_addr_t; -+ #define UCHAR u8 -+ #define USHORT u16 -+ #define UINT u32 -+ #define ULONG u32 -+ -+ typedef void (*proc_t)(void *); -+ -+ typedef unsigned int __kernel_size_t; -+ typedef int __kernel_ssize_t; -+ -+ typedef __kernel_size_t SIZE_T; -+ typedef __kernel_ssize_t SSIZE_T; -+ #define FIELD_OFFSET(s, field) ((SSIZE_T)&((s *)(0))->field) -+ -+#endif -+ -+#define MEM_ALIGNMENT_OFFSET (sizeof (SIZE_T)) -+#define MEM_ALIGNMENT_PADDING (sizeof(SIZE_T) - 1) -+ -+#define SIZE_PTR SIZE_T -+#define SSIZE_PTR SSIZE_T -+ -+/* -+* Continuous bits starting from least significant bit -+* Example: -+* BIT_LEN_MASK_32(0) => 0x00000000 -+* BIT_LEN_MASK_32(1) => 0x00000001 -+* BIT_LEN_MASK_32(2) => 0x00000003 -+* BIT_LEN_MASK_32(32) => 0xFFFFFFFF -+*/ -+#define BIT_LEN_MASK_32(__BitLen) ((u32)(0xFFFFFFFF >> (32 - (__BitLen)))) -+#define BIT_LEN_MASK_16(__BitLen) ((u16)(0xFFFF >> (16 - (__BitLen)))) -+#define BIT_LEN_MASK_8(__BitLen) ((u8)(0xFF >> (8 - (__BitLen)))) -+ -+/* -+* Continuous bits starting from least significant bit -+* Example: -+* BIT_OFFSET_LEN_MASK_32(0, 2) => 0x00000003 -+* BIT_OFFSET_LEN_MASK_32(16, 2) => 0x00030000 -+*/ -+#define BIT_OFFSET_LEN_MASK_32(__BitOffset, __BitLen) ((u32)(BIT_LEN_MASK_32(__BitLen) << (__BitOffset))) -+#define BIT_OFFSET_LEN_MASK_16(__BitOffset, __BitLen) ((u16)(BIT_LEN_MASK_16(__BitLen) << (__BitOffset))) -+#define BIT_OFFSET_LEN_MASK_8(__BitOffset, __BitLen) ((u8)(BIT_LEN_MASK_8(__BitLen) << (__BitOffset))) -+ -+/* -+* Convert LE data to host byte order -+*/ -+#define EF1Byte (u8) -+#define EF2Byte le16_to_cpu -+#define EF4Byte le32_to_cpu -+ -+/* -+* Read LE data from memory to host byte order -+*/ -+#define ReadLE4Byte(_ptr) le32_to_cpu(*((u32 *)(_ptr))) -+#define ReadLE2Byte(_ptr) le16_to_cpu(*((u16 *)(_ptr))) -+#define ReadLE1Byte(_ptr) (*((u8 *)(_ptr))) -+ -+/* -+* Read BE data from memory to host byte order -+*/ -+#define ReadBEE4Byte(_ptr) be32_to_cpu(*((u32 *)(_ptr))) -+#define ReadBE2Byte(_ptr) be16_to_cpu(*((u16 *)(_ptr))) -+#define ReadBE1Byte(_ptr) (*((u8 *)(_ptr))) -+ -+/* -+* Write host byte order data to memory in LE order -+*/ -+#define WriteLE4Byte(_ptr, _val) ((*((u32 *)(_ptr))) = cpu_to_le32(_val)) -+#define WriteLE2Byte(_ptr, _val) ((*((u16 *)(_ptr))) = cpu_to_le16(_val)) -+#define WriteLE1Byte(_ptr, _val) ((*((u8 *)(_ptr))) = ((u8)(_val))) -+ -+/* -+* Write host byte order data to memory in BE order -+*/ -+#define WriteBE4Byte(_ptr, _val) ((*((u32 *)(_ptr))) = cpu_to_be32(_val)) -+#define WriteBE2Byte(_ptr, _val) ((*((u16 *)(_ptr))) = cpu_to_be16(_val)) -+#define WriteBE1Byte(_ptr, _val) ((*((u8 *)(_ptr))) = ((u8)(_val))) -+ -+/* -+* Return 4-byte value in host byte ordering from 4-byte pointer in litten-endian system. -+*/ -+#define LE_P4BYTE_TO_HOST_4BYTE(__pStart) (le32_to_cpu(*((u32 *)(__pStart)))) -+#define LE_P2BYTE_TO_HOST_2BYTE(__pStart) (le16_to_cpu(*((u16 *)(__pStart)))) -+#define LE_P1BYTE_TO_HOST_1BYTE(__pStart) ((*((u8 *)(__pStart)))) -+ -+/* -+* Return 4-byte value in host byte ordering from 4-byte pointer in big-endian system. -+*/ -+#define BE_P4BYTE_TO_HOST_4BYTE(__pStart) (be32_to_cpu(*((u32 *)(__pStart)))) -+#define BE_P2BYTE_TO_HOST_2BYTE(__pStart) (be16_to_cpu(*((u16 *)(__pStart)))) -+#define BE_P1BYTE_TO_HOST_1BYTE(__pStart) ((*((u8 *)(__pStart)))) -+ -+/* -+* Translate subfield (continuous bits in little-endian) of 4-byte value in LE byte to -+* 4-byte value in host byte ordering. -+*/ -+#define LE_BITS_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ -+ ((LE_P4BYTE_TO_HOST_4BYTE(__pStart) >> (__BitOffset)) & BIT_LEN_MASK_32(__BitLen)) -+ -+#define LE_BITS_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ -+ ((LE_P2BYTE_TO_HOST_2BYTE(__pStart) >> (__BitOffset)) & BIT_LEN_MASK_16(__BitLen)) -+ -+#define LE_BITS_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ -+ ((LE_P1BYTE_TO_HOST_1BYTE(__pStart) >> (__BitOffset)) & BIT_LEN_MASK_8(__BitLen)) -+ -+/* -+* Translate subfield (continuous bits in big-endian) of 4-byte value in BE byte to -+* 4-byte value in host byte ordering. -+*/ -+#define BE_BITS_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ -+ ((BE_P4BYTE_TO_HOST_4BYTE(__pStart) >> (__BitOffset)) & BIT_LEN_MASK_32(__BitLen)) -+ -+#define BE_BITS_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ -+ ((BE_P2BYTE_TO_HOST_2BYTE(__pStart) >> (__BitOffset)) & BIT_LEN_MASK_16(__BitLen)) -+ -+#define BE_BITS_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ -+ ((BE_P1BYTE_TO_HOST_1BYTE(__pStart) >> (__BitOffset)) & BIT_LEN_MASK_8(__BitLen)) -+ -+/* -+* Mask subfield (continuous bits in little-endian) of 4-byte value in LE byte oredering -+* and return the result in 4-byte value in host byte ordering. -+*/ -+#define LE_BITS_CLEARED_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ -+ (LE_P4BYTE_TO_HOST_4BYTE(__pStart) & (~BIT_OFFSET_LEN_MASK_32(__BitOffset, __BitLen))) -+ -+#define LE_BITS_CLEARED_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ -+ (LE_P2BYTE_TO_HOST_2BYTE(__pStart) & (~BIT_OFFSET_LEN_MASK_16(__BitOffset, __BitLen))) -+ -+#define LE_BITS_CLEARED_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ -+ (LE_P1BYTE_TO_HOST_1BYTE(__pStart) & ((u8)(~BIT_OFFSET_LEN_MASK_8(__BitOffset, __BitLen)))) -+ -+/* -+* Mask subfield (continuous bits in big-endian) of 4-byte value in BE byte oredering -+* and return the result in 4-byte value in host byte ordering. -+*/ -+#define BE_BITS_CLEARED_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ -+ (BE_P4BYTE_TO_HOST_4BYTE(__pStart) & (~BIT_OFFSET_LEN_MASK_32(__BitOffset, __BitLen))) -+ -+#define BE_BITS_CLEARED_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ -+ (BE_P2BYTE_TO_HOST_2BYTE(__pStart) & (~BIT_OFFSET_LEN_MASK_16(__BitOffset, __BitLen))) -+ -+#define BE_BITS_CLEARED_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ -+ (BE_P1BYTE_TO_HOST_1BYTE(__pStart) & (~BIT_OFFSET_LEN_MASK_8(__BitOffset, __BitLen))) -+ -+/* -+* Set subfield of little-endian 4-byte value to specified value. -+*/ -+#define SET_BITS_TO_LE_4BYTE(__pStart, __BitOffset, __BitLen, __Value) \ -+ do { \ -+ if (__BitOffset == 0 && __BitLen == 32) \ -+ WriteLE4Byte(__pStart, __Value); \ -+ else { \ -+ WriteLE4Byte(__pStart, \ -+ LE_BITS_CLEARED_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ -+ | \ -+ ((((u32)__Value) & BIT_LEN_MASK_32(__BitLen)) << (__BitOffset)) \ -+ ); \ -+ } \ -+ } while (0) -+ -+#define SET_BITS_TO_LE_2BYTE(__pStart, __BitOffset, __BitLen, __Value) \ -+ do { \ -+ if (__BitOffset == 0 && __BitLen == 16) \ -+ WriteLE2Byte(__pStart, __Value); \ -+ else { \ -+ WriteLE2Byte(__pStart, \ -+ LE_BITS_CLEARED_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ -+ | \ -+ ((((u16)__Value) & BIT_LEN_MASK_16(__BitLen)) << (__BitOffset)) \ -+ ); \ -+ } \ -+ } while (0) -+ -+#define SET_BITS_TO_LE_1BYTE(__pStart, __BitOffset, __BitLen, __Value) \ -+ do { \ -+ if (__BitOffset == 0 && __BitLen == 8) \ -+ WriteLE1Byte(__pStart, __Value); \ -+ else { \ -+ WriteLE1Byte(__pStart, \ -+ LE_BITS_CLEARED_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ -+ | \ -+ ((((u8)__Value) & BIT_LEN_MASK_8(__BitLen)) << (__BitOffset)) \ -+ ); \ -+ } \ -+ } while (0) -+ -+/* -+* Set subfield of big-endian 4-byte value to specified value. -+*/ -+#define SET_BITS_TO_BE_4BYTE(__pStart, __BitOffset, __BitLen, __Value) \ -+ do { \ -+ if (__BitOffset == 0 && __BitLen == 32) \ -+ WriteBE4Byte(__pStart, __Value); \ -+ else { \ -+ WriteBE4Byte(__pStart, \ -+ BE_BITS_CLEARED_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ -+ | \ -+ ((((u32)__Value) & BIT_LEN_MASK_32(__BitLen)) << (__BitOffset)) \ -+ ); \ -+ } \ -+ } while (0) -+ -+#define SET_BITS_TO_BE_2BYTE(__pStart, __BitOffset, __BitLen, __Value) \ -+ do { \ -+ if (__BitOffset == 0 && __BitLen == 16) \ -+ WriteBE2Byte(__pStart, __Value); \ -+ else { \ -+ WriteBE2Byte(__pStart, \ -+ BE_BITS_CLEARED_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ -+ | \ -+ ((((u16)__Value) & BIT_LEN_MASK_16(__BitLen)) << (__BitOffset)) \ -+ ); \ -+ } \ -+ } while (0) -+ -+#define SET_BITS_TO_BE_1BYTE(__pStart, __BitOffset, __BitLen, __Value) \ -+ do { \ -+ if (__BitOffset == 0 && __BitLen == 8) \ -+ WriteBE1Byte(__pStart, __Value); \ -+ else { \ -+ WriteBE1Byte(__pStart, \ -+ BE_BITS_CLEARED_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ -+ | \ -+ ((((u8)__Value) & BIT_LEN_MASK_8(__BitLen)) << (__BitOffset)) \ -+ ); \ -+ } \ -+ } while (0) -+ -+/* Get the N-bytes aligment offset from the current length */ -+#define N_BYTE_ALIGMENT(__Value, __Aligment) ((__Aligment == 1) ? (__Value) : (((__Value + __Aligment - 1) / __Aligment) * __Aligment)) -+ -+typedef unsigned char BOOLEAN, *PBOOLEAN, boolean; -+ -+#define TEST_FLAG(__Flag, __testFlag) (((__Flag) & (__testFlag)) != 0) -+#define SET_FLAG(__Flag, __setFlag) ((__Flag) |= __setFlag) -+#define CLEAR_FLAG(__Flag, __clearFlag) ((__Flag) &= ~(__clearFlag)) -+#define CLEAR_FLAGS(__Flag) ((__Flag) = 0) -+#define TEST_FLAGS(__Flag, __testFlags) (((__Flag) & (__testFlags)) == (__testFlags)) -+ -+#endif /* __BASIC_TYPES_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/byteorder/big_endian.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/big_endian.h ---- linux-4.14.18/3rdparty/rtl8723de/include/byteorder/big_endian.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/big_endian.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,87 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _LINUX_BYTEORDER_BIG_ENDIAN_H -+#define _LINUX_BYTEORDER_BIG_ENDIAN_H -+ -+#ifndef __BIG_ENDIAN -+ #define __BIG_ENDIAN 4321 -+#endif -+#ifndef __BIG_ENDIAN_BITFIELD -+ #define __BIG_ENDIAN_BITFIELD -+#endif -+ -+#include -+ -+#define __constant_htonl(x) ((__u32)(x)) -+#define __constant_ntohl(x) ((__u32)(x)) -+#define __constant_htons(x) ((__u16)(x)) -+#define __constant_ntohs(x) ((__u16)(x)) -+#define __constant_cpu_to_le64(x) ___constant_swab64((x)) -+#define __constant_le64_to_cpu(x) ___constant_swab64((x)) -+#define __constant_cpu_to_le32(x) ___constant_swab32((x)) -+#define __constant_le32_to_cpu(x) ___constant_swab32((x)) -+#define __constant_cpu_to_le16(x) ___constant_swab16((x)) -+#define __constant_le16_to_cpu(x) ___constant_swab16((x)) -+#define __constant_cpu_to_be64(x) ((__u64)(x)) -+#define __constant_be64_to_cpu(x) ((__u64)(x)) -+#define __constant_cpu_to_be32(x) ((__u32)(x)) -+#define __constant_be32_to_cpu(x) ((__u32)(x)) -+#define __constant_cpu_to_be16(x) ((__u16)(x)) -+#define __constant_be16_to_cpu(x) ((__u16)(x)) -+#define __cpu_to_le64(x) __swab64((x)) -+#define __le64_to_cpu(x) __swab64((x)) -+#define __cpu_to_le32(x) __swab32((x)) -+#define __le32_to_cpu(x) __swab32((x)) -+#define __cpu_to_le16(x) __swab16((x)) -+#define __le16_to_cpu(x) __swab16((x)) -+#define __cpu_to_be64(x) ((__u64)(x)) -+#define __be64_to_cpu(x) ((__u64)(x)) -+#define __cpu_to_be32(x) ((__u32)(x)) -+#define __be32_to_cpu(x) ((__u32)(x)) -+#define __cpu_to_be16(x) ((__u16)(x)) -+#define __be16_to_cpu(x) ((__u16)(x)) -+#define __cpu_to_le64p(x) __swab64p((x)) -+#define __le64_to_cpup(x) __swab64p((x)) -+#define __cpu_to_le32p(x) __swab32p((x)) -+#define __le32_to_cpup(x) __swab32p((x)) -+#define __cpu_to_le16p(x) __swab16p((x)) -+#define __le16_to_cpup(x) __swab16p((x)) -+#define __cpu_to_be64p(x) (*(__u64 *)(x)) -+#define __be64_to_cpup(x) (*(__u64 *)(x)) -+#define __cpu_to_be32p(x) (*(__u32 *)(x)) -+#define __be32_to_cpup(x) (*(__u32 *)(x)) -+#define __cpu_to_be16p(x) (*(__u16 *)(x)) -+#define __be16_to_cpup(x) (*(__u16 *)(x)) -+#define __cpu_to_le64s(x) __swab64s((x)) -+#define __le64_to_cpus(x) __swab64s((x)) -+#define __cpu_to_le32s(x) __swab32s((x)) -+#define __le32_to_cpus(x) __swab32s((x)) -+#define __cpu_to_le16s(x) __swab16s((x)) -+#define __le16_to_cpus(x) __swab16s((x)) -+#define __cpu_to_be64s(x) do {} while (0) -+#define __be64_to_cpus(x) do {} while (0) -+#define __cpu_to_be32s(x) do {} while (0) -+#define __be32_to_cpus(x) do {} while (0) -+#define __cpu_to_be16s(x) do {} while (0) -+#define __be16_to_cpus(x) do {} while (0) -+ -+#include -+ -+#endif /* _LINUX_BYTEORDER_BIG_ENDIAN_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/byteorder/generic.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/generic.h ---- linux-4.14.18/3rdparty/rtl8723de/include/byteorder/generic.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/generic.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,212 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _LINUX_BYTEORDER_GENERIC_H -+#define _LINUX_BYTEORDER_GENERIC_H -+ -+/* -+ * linux/byteorder_generic.h -+ * Generic Byte-reordering support -+ * -+ * Francois-Rene Rideau 19970707 -+ * gathered all the good ideas from all asm-foo/byteorder.h into one file, -+ * cleaned them up. -+ * I hope it is compliant with non-GCC compilers. -+ * I decided to put __BYTEORDER_HAS_U64__ in byteorder.h, -+ * because I wasn't sure it would be ok to put it in types.h -+ * Upgraded it to 2.1.43 -+ * Francois-Rene Rideau 19971012 -+ * Upgraded it to 2.1.57 -+ * to please Linus T., replaced huge #ifdef's between little/big endian -+ * by nestedly #include'd files. -+ * Francois-Rene Rideau 19971205 -+ * Made it to 2.1.71; now a facelift: -+ * Put files under include/linux/byteorder/ -+ * Split swab from generic support. -+ * -+ * TODO: -+ * = Regular kernel maintainers could also replace all these manual -+ * byteswap macros that remain, disseminated among drivers, -+ * after some grep or the sources... -+ * = Linus might want to rename all these macros and files to fit his taste, -+ * to fit his personal naming scheme. -+ * = it seems that a few drivers would also appreciate -+ * nybble swapping support... -+ * = every architecture could add their byteswap macro in asm/byteorder.h -+ * see how some architectures already do (i386, alpha, ppc, etc) -+ * = cpu_to_beXX and beXX_to_cpu might some day need to be well -+ * distinguished throughout the kernel. This is not the case currently, -+ * since little endian, big endian, and pdp endian machines needn't it. -+ * But this might be the case for, say, a port of Linux to 20/21 bit -+ * architectures (and F21 Linux addict around?). -+ */ -+ -+/* -+ * The following macros are to be defined by : -+ * -+ * Conversion of long and short int between network and host format -+ * ntohl(__u32 x) -+ * ntohs(__u16 x) -+ * htonl(__u32 x) -+ * htons(__u16 x) -+ * It seems that some programs (which? where? or perhaps a standard? POSIX?) -+ * might like the above to be functions, not macros (why?). -+ * if that's true, then detect them, and take measures. -+ * Anyway, the measure is: define only ___ntohl as a macro instead, -+ * and in a separate file, have -+ * unsigned long inline ntohl(x){return ___ntohl(x);} -+ * -+ * The same for constant arguments -+ * __constant_ntohl(__u32 x) -+ * __constant_ntohs(__u16 x) -+ * __constant_htonl(__u32 x) -+ * __constant_htons(__u16 x) -+ * -+ * Conversion of XX-bit integers (16- 32- or 64-) -+ * between native CPU format and little/big endian format -+ * 64-bit stuff only defined for proper architectures -+ * cpu_to_[bl]eXX(__uXX x) -+ * [bl]eXX_to_cpu(__uXX x) -+ * -+ * The same, but takes a pointer to the value to convert -+ * cpu_to_[bl]eXXp(__uXX x) -+ * [bl]eXX_to_cpup(__uXX x) -+ * -+ * The same, but change in situ -+ * cpu_to_[bl]eXXs(__uXX x) -+ * [bl]eXX_to_cpus(__uXX x) -+ * -+ * See asm-foo/byteorder.h for examples of how to provide -+ * architecture-optimized versions -+ * -+ */ -+ -+ -+#if defined(PLATFORM_LINUX) || defined(PLATFORM_WINDOWS) || defined(PLATFORM_MPIXEL) || defined(PLATFORM_FREEBSD) -+ /* -+ * inside the kernel, we can use nicknames; -+ * outside of it, we must avoid POSIX namespace pollution... -+ */ -+ #define cpu_to_le64 __cpu_to_le64 -+ #define le64_to_cpu __le64_to_cpu -+ #define cpu_to_le32 __cpu_to_le32 -+ #define le32_to_cpu __le32_to_cpu -+ #define cpu_to_le16 __cpu_to_le16 -+ #define le16_to_cpu __le16_to_cpu -+ #define cpu_to_be64 __cpu_to_be64 -+ #define be64_to_cpu __be64_to_cpu -+ #define cpu_to_be32 __cpu_to_be32 -+ #define be32_to_cpu __be32_to_cpu -+ #define cpu_to_be16 __cpu_to_be16 -+ #define be16_to_cpu __be16_to_cpu -+ #define cpu_to_le64p __cpu_to_le64p -+ #define le64_to_cpup __le64_to_cpup -+ #define cpu_to_le32p __cpu_to_le32p -+ #define le32_to_cpup __le32_to_cpup -+ #define cpu_to_le16p __cpu_to_le16p -+ #define le16_to_cpup __le16_to_cpup -+ #define cpu_to_be64p __cpu_to_be64p -+ #define be64_to_cpup __be64_to_cpup -+ #define cpu_to_be32p __cpu_to_be32p -+ #define be32_to_cpup __be32_to_cpup -+ #define cpu_to_be16p __cpu_to_be16p -+ #define be16_to_cpup __be16_to_cpup -+ #define cpu_to_le64s __cpu_to_le64s -+ #define le64_to_cpus __le64_to_cpus -+ #define cpu_to_le32s __cpu_to_le32s -+ #define le32_to_cpus __le32_to_cpus -+ #define cpu_to_le16s __cpu_to_le16s -+ #define le16_to_cpus __le16_to_cpus -+ #define cpu_to_be64s __cpu_to_be64s -+ #define be64_to_cpus __be64_to_cpus -+ #define cpu_to_be32s __cpu_to_be32s -+ #define be32_to_cpus __be32_to_cpus -+ #define cpu_to_be16s __cpu_to_be16s -+ #define be16_to_cpus __be16_to_cpus -+#endif -+ -+ -+/* -+ * Handle ntohl and suches. These have various compatibility -+ * issues - like we want to give the prototype even though we -+ * also have a macro for them in case some strange program -+ * wants to take the address of the thing or something.. -+ * -+ * Note that these used to return a "long" in libc5, even though -+ * long is often 64-bit these days.. Thus the casts. -+ * -+ * They have to be macros in order to do the constant folding -+ * correctly - if the argument passed into a inline function -+ * it is no longer constant according to gcc.. -+ */ -+ -+#undef ntohl -+#undef ntohs -+#undef htonl -+#undef htons -+ -+/* -+ * Do the prototypes. Somebody might want to take the -+ * address or some such sick thing.. -+ */ -+#if defined(PLATFORM_LINUX) || (defined(__GLIBC__) && __GLIBC__ >= 2) -+ extern __u32 ntohl(__u32); -+ extern __u32 htonl(__u32); -+#else /* defined(PLATFORM_LINUX) || (defined (__GLIBC__) && __GLIBC__ >= 2) */ -+ #ifndef PLATFORM_FREEBSD -+ extern unsigned long int ntohl(unsigned long int); -+ extern unsigned long int htonl(unsigned long int); -+ #endif -+#endif -+#ifndef PLATFORM_FREEBSD -+ extern unsigned short int ntohs(unsigned short int); -+ extern unsigned short int htons(unsigned short int); -+#endif -+ -+#if defined(__GNUC__) && (__GNUC__ >= 2) && defined(__OPTIMIZE__) || defined(PLATFORM_MPIXEL) -+ -+ #define ___htonl(x) __cpu_to_be32(x) -+ #define ___htons(x) __cpu_to_be16(x) -+ #define ___ntohl(x) __be32_to_cpu(x) -+ #define ___ntohs(x) __be16_to_cpu(x) -+ -+ #if defined(PLATFORM_LINUX) || (defined(__GLIBC__) && __GLIBC__ >= 2) -+ #define htonl(x) ___htonl(x) -+ #define ntohl(x) ___ntohl(x) -+ #else -+ #define htonl(x) ((unsigned long)___htonl(x)) -+ #define ntohl(x) ((unsigned long)___ntohl(x)) -+ #endif -+ #define htons(x) ___htons(x) -+ #define ntohs(x) ___ntohs(x) -+ -+#endif /* OPTIMIZE */ -+ -+ -+#if defined(PLATFORM_WINDOWS) -+ -+ #define htonl(x) __cpu_to_be32(x) -+ #define ntohl(x) __be32_to_cpu(x) -+ #define htons(x) __cpu_to_be16(x) -+ #define ntohs(x) __be16_to_cpu(x) -+ -+ -+#endif -+ -+#endif /* _LINUX_BYTEORDER_GENERIC_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/byteorder/little_endian.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/little_endian.h ---- linux-4.14.18/3rdparty/rtl8723de/include/byteorder/little_endian.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/little_endian.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,89 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _LINUX_BYTEORDER_LITTLE_ENDIAN_H -+#define _LINUX_BYTEORDER_LITTLE_ENDIAN_H -+ -+#ifndef __LITTLE_ENDIAN -+ #define __LITTLE_ENDIAN 1234 -+#endif -+#ifndef __LITTLE_ENDIAN_BITFIELD -+ #define __LITTLE_ENDIAN_BITFIELD -+#endif -+ -+#include -+ -+#ifndef __constant_htonl -+ #define __constant_htonl(x) ___constant_swab32((x)) -+ #define __constant_ntohl(x) ___constant_swab32((x)) -+ #define __constant_htons(x) ___constant_swab16((x)) -+ #define __constant_ntohs(x) ___constant_swab16((x)) -+ #define __constant_cpu_to_le64(x) ((__u64)(x)) -+ #define __constant_le64_to_cpu(x) ((__u64)(x)) -+ #define __constant_cpu_to_le32(x) ((__u32)(x)) -+ #define __constant_le32_to_cpu(x) ((__u32)(x)) -+ #define __constant_cpu_to_le16(x) ((__u16)(x)) -+ #define __constant_le16_to_cpu(x) ((__u16)(x)) -+ #define __constant_cpu_to_be64(x) ___constant_swab64((x)) -+ #define __constant_be64_to_cpu(x) ___constant_swab64((x)) -+ #define __constant_cpu_to_be32(x) ___constant_swab32((x)) -+ #define __constant_be32_to_cpu(x) ___constant_swab32((x)) -+ #define __constant_cpu_to_be16(x) ___constant_swab16((x)) -+ #define __constant_be16_to_cpu(x) ___constant_swab16((x)) -+ #define __cpu_to_le64(x) ((__u64)(x)) -+ #define __le64_to_cpu(x) ((__u64)(x)) -+ #define __cpu_to_le32(x) ((__u32)(x)) -+ #define __le32_to_cpu(x) ((__u32)(x)) -+ #define __cpu_to_le16(x) ((__u16)(x)) -+ #define __le16_to_cpu(x) ((__u16)(x)) -+ #define __cpu_to_be64(x) __swab64((x)) -+ #define __be64_to_cpu(x) __swab64((x)) -+ #define __cpu_to_be32(x) __swab32((x)) -+ #define __be32_to_cpu(x) __swab32((x)) -+ #define __cpu_to_be16(x) __swab16((x)) -+ #define __be16_to_cpu(x) __swab16((x)) -+ #define __cpu_to_le64p(x) (*(__u64 *)(x)) -+ #define __le64_to_cpup(x) (*(__u64 *)(x)) -+ #define __cpu_to_le32p(x) (*(__u32 *)(x)) -+ #define __le32_to_cpup(x) (*(__u32 *)(x)) -+ #define __cpu_to_le16p(x) (*(__u16 *)(x)) -+ #define __le16_to_cpup(x) (*(__u16 *)(x)) -+ #define __cpu_to_be64p(x) __swab64p((x)) -+ #define __be64_to_cpup(x) __swab64p((x)) -+ #define __cpu_to_be32p(x) __swab32p((x)) -+ #define __be32_to_cpup(x) __swab32p((x)) -+ #define __cpu_to_be16p(x) __swab16p((x)) -+ #define __be16_to_cpup(x) __swab16p((x)) -+ #define __cpu_to_le64s(x) do {} while (0) -+ #define __le64_to_cpus(x) do {} while (0) -+ #define __cpu_to_le32s(x) do {} while (0) -+ #define __le32_to_cpus(x) do {} while (0) -+ #define __cpu_to_le16s(x) do {} while (0) -+ #define __le16_to_cpus(x) do {} while (0) -+ #define __cpu_to_be64s(x) __swab64s((x)) -+ #define __be64_to_cpus(x) __swab64s((x)) -+ #define __cpu_to_be32s(x) __swab32s((x)) -+ #define __be32_to_cpus(x) __swab32s((x)) -+ #define __cpu_to_be16s(x) __swab16s((x)) -+ #define __be16_to_cpus(x) __swab16s((x)) -+#endif /* __constant_htonl */ -+ -+#include -+ -+#endif /* _LINUX_BYTEORDER_LITTLE_ENDIAN_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/byteorder/swabb.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/swabb.h ---- linux-4.14.18/3rdparty/rtl8723de/include/byteorder/swabb.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/swabb.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,156 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _LINUX_BYTEORDER_SWABB_H -+#define _LINUX_BYTEORDER_SWABB_H -+ -+/* -+ * linux/byteorder/swabb.h -+ * SWAp Bytes Bizarrely -+ * swaHHXX[ps]?(foo) -+ * -+ * Support for obNUXIous pdp-endian and other bizarre architectures. -+ * Will Linux ever run on such ancient beasts? if not, this file -+ * will be but a programming pearl. Still, it's a reminder that we -+ * shouldn't be making too many assumptions when trying to be portable. -+ * -+ */ -+ -+/* -+ * Meaning of the names I chose (vaxlinux people feel free to correct them): -+ * swahw32 swap 16-bit half-words in a 32-bit word -+ * swahb32 swap 8-bit halves of each 16-bit half-word in a 32-bit word -+ * -+ * No 64-bit support yet. I don't know NUXI conventions for long longs. -+ * I guarantee it will be a mess when it's there, though :-> -+ * It will be even worse if there are conflicting 64-bit conventions. -+ * Hopefully, no one ever used 64-bit objects on NUXI machines. -+ * -+ */ -+ -+#define ___swahw32(x) \ -+ ({ \ -+ __u32 __x = (x); \ -+ ((__u32)(\ -+ (((__u32)(__x) & (__u32)0x0000ffffUL) << 16) | \ -+ (((__u32)(__x) & (__u32)0xffff0000UL) >> 16))); \ -+ }) -+#define ___swahb32(x) \ -+ ({ \ -+ __u32 __x = (x); \ -+ ((__u32)(\ -+ (((__u32)(__x) & (__u32)0x00ff00ffUL) << 8) | \ -+ (((__u32)(__x) & (__u32)0xff00ff00UL) >> 8))); \ -+ }) -+ -+#define ___constant_swahw32(x) \ -+ ((__u32)(\ -+ (((__u32)(x) & (__u32)0x0000ffffUL) << 16) | \ -+ (((__u32)(x) & (__u32)0xffff0000UL) >> 16))) -+#define ___constant_swahb32(x) \ -+ ((__u32)(\ -+ (((__u32)(x) & (__u32)0x00ff00ffUL) << 8) | \ -+ (((__u32)(x) & (__u32)0xff00ff00UL) >> 8))) -+ -+/* -+ * provide defaults when no architecture-specific optimization is detected -+ */ -+#ifndef __arch__swahw32 -+ #define __arch__swahw32(x) ___swahw32(x) -+#endif -+#ifndef __arch__swahb32 -+ #define __arch__swahb32(x) ___swahb32(x) -+#endif -+ -+#ifndef __arch__swahw32p -+ #define __arch__swahw32p(x) __swahw32(*(x)) -+#endif -+#ifndef __arch__swahb32p -+ #define __arch__swahb32p(x) __swahb32(*(x)) -+#endif -+ -+#ifndef __arch__swahw32s -+ #define __arch__swahw32s(x) do { *(x) = __swahw32p((x)); } while (0) -+#endif -+#ifndef __arch__swahb32s -+ #define __arch__swahb32s(x) do { *(x) = __swahb32p((x)); } while (0) -+#endif -+ -+ -+/* -+ * Allow constant folding -+ */ -+#if defined(__GNUC__) && (__GNUC__ >= 2) && defined(__OPTIMIZE__) -+# define __swahw32(x) \ -+ (__builtin_constant_p((__u32)(x)) ? \ -+ ___swahw32((x)) : \ -+ __fswahw32((x))) -+# define __swahb32(x) \ -+ (__builtin_constant_p((__u32)(x)) ? \ -+ ___swahb32((x)) : \ -+ __fswahb32((x))) -+#else -+# define __swahw32(x) __fswahw32(x) -+# define __swahb32(x) __fswahb32(x) -+#endif /* OPTIMIZE */ -+ -+ -+__inline static__ __const__ __u32 __fswahw32(__u32 x) -+{ -+ return __arch__swahw32(x); -+} -+__inline static__ __u32 __swahw32p(__u32 *x) -+{ -+ return __arch__swahw32p(x); -+} -+__inline static__ void __swahw32s(__u32 *addr) -+{ -+ __arch__swahw32s(addr); -+} -+ -+ -+__inline static__ __const__ __u32 __fswahb32(__u32 x) -+{ -+ return __arch__swahb32(x); -+} -+__inline static__ __u32 __swahb32p(__u32 *x) -+{ -+ return __arch__swahb32p(x); -+} -+__inline static__ void __swahb32s(__u32 *addr) -+{ -+ __arch__swahb32s(addr); -+} -+ -+#ifdef __BYTEORDER_HAS_U64__ -+ /* -+ * Not supported yet -+ */ -+#endif /* __BYTEORDER_HAS_U64__ */ -+ -+#if defined(PLATFORM_LINUX) -+ #define swahw32 __swahw32 -+ #define swahb32 __swahb32 -+ #define swahw32p __swahw32p -+ #define swahb32p __swahb32p -+ #define swahw32s __swahw32s -+ #define swahb32s __swahb32s -+#endif -+ -+#endif /* _LINUX_BYTEORDER_SWABB_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/byteorder/swab.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/swab.h ---- linux-4.14.18/3rdparty/rtl8723de/include/byteorder/swab.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/byteorder/swab.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,141 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _LINUX_BYTEORDER_SWAB_H -+#define _LINUX_BYTEORDER_SWAB_H -+ -+#if !defined(CONFIG_PLATFORM_MSTAR) -+#ifndef __u16 -+ typedef unsigned short __u16; -+#endif -+ -+#ifndef __u32 -+ typedef unsigned int __u32; -+#endif -+ -+#ifndef __u8 -+ typedef unsigned char __u8; -+#endif -+ -+#ifndef __u64 -+ typedef unsigned long long __u64; -+#endif -+ -+ -+__inline static __u16 ___swab16(__u16 x) -+{ -+ __u16 __x = x; -+ return -+ (__u16)( -+ (((__u16)(__x)&(__u16)0x00ffU) << 8) | -+ (((__u16)(__x)&(__u16)0xff00U) >> 8)); -+ -+} -+ -+__inline static __u32 ___swab32(__u32 x) -+{ -+ __u32 __x = (x); -+ return (__u32)( -+ (((__u32)(__x)&(__u32)0x000000ffUL) << 24) | -+ (((__u32)(__x)&(__u32)0x0000ff00UL) << 8) | -+ (((__u32)(__x)&(__u32)0x00ff0000UL) >> 8) | -+ (((__u32)(__x)&(__u32)0xff000000UL) >> 24)); -+} -+ -+__inline static __u64 ___swab64(__u64 x) -+{ -+ __u64 __x = (x); -+ -+ return -+ (__u64)(\ -+ (__u64)(((__u64)(__x)&(__u64)0x00000000000000ffULL) << 56) | \ -+ (__u64)(((__u64)(__x)&(__u64)0x000000000000ff00ULL) << 40) | \ -+ (__u64)(((__u64)(__x)&(__u64)0x0000000000ff0000ULL) << 24) | \ -+ (__u64)(((__u64)(__x)&(__u64)0x00000000ff000000ULL) << 8) | \ -+ (__u64)(((__u64)(__x)&(__u64)0x000000ff00000000ULL) >> 8) | \ -+ (__u64)(((__u64)(__x)&(__u64)0x0000ff0000000000ULL) >> 24) | \ -+ (__u64)(((__u64)(__x)&(__u64)0x00ff000000000000ULL) >> 40) | \ -+ (__u64)(((__u64)(__x)&(__u64)0xff00000000000000ULL) >> 56)); -+ \ -+} -+#endif /* CONFIG_PLATFORM_MSTAR */ -+ -+#ifndef __arch__swab16 -+__inline static __u16 __arch__swab16(__u16 x) -+{ -+ return ___swab16(x); -+} -+ -+#endif -+ -+#ifndef __arch__swab32 -+__inline static __u32 __arch__swab32(__u32 x) -+{ -+ __u32 __tmp = (x) ; -+ return ___swab32(__tmp); -+} -+#endif -+ -+#ifndef __arch__swab64 -+ -+__inline static __u64 __arch__swab64(__u64 x) -+{ -+ __u64 __tmp = (x) ; -+ return ___swab64(__tmp); -+} -+ -+ -+#endif -+ -+#ifndef __swab16 -+ #define __swab16(x) __fswab16(x) -+ #define __swab32(x) __fswab32(x) -+ #define __swab64(x) __fswab64(x) -+#endif /* __swab16 */ -+ -+#ifdef PLATFORM_FREEBSD -+ __inline static __u16 __fswab16(__u16 x) -+#else -+ __inline static const __u16 __fswab16(__u16 x) -+#endif /* PLATFORM_FREEBSD */ -+{ -+ return __arch__swab16(x); -+} -+#ifdef PLATFORM_FREEBSD -+ __inline static __u32 __fswab32(__u32 x) -+#else -+ __inline static const __u32 __fswab32(__u32 x) -+#endif /* PLATFORM_FREEBSD */ -+{ -+ return __arch__swab32(x); -+} -+ -+#if defined(PLATFORM_LINUX) || defined(PLATFORM_WINDOWS) -+ #define swab16 __swab16 -+ #define swab32 __swab32 -+ #define swab64 __swab64 -+ #define swab16p __swab16p -+ #define swab32p __swab32p -+ #define swab64p __swab64p -+ #define swab16s __swab16s -+ #define swab32s __swab32s -+ #define swab64s __swab64s -+#endif -+ -+#endif /* _LINUX_BYTEORDER_SWAB_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/circ_buf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/circ_buf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/circ_buf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/circ_buf.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __CIRC_BUF_H_ -+#define __CIRC_BUF_H_ 1 -+ -+#define CIRC_CNT(head,tail,size) (((head) - (tail)) & ((size)-1)) -+ -+#define CIRC_SPACE(head,tail,size) CIRC_CNT((tail),((head)+1),(size)) -+ -+#endif //_CIRC_BUF_H_ -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/cmd_osdep.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/cmd_osdep.h ---- linux-4.14.18/3rdparty/rtl8723de/include/cmd_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/cmd_osdep.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __CMD_OSDEP_H_ -+#define __CMD_OSDEP_H_ -+ -+ -+extern sint _rtw_init_cmd_priv(struct cmd_priv *pcmdpriv); -+extern sint _rtw_init_evt_priv(struct evt_priv *pevtpriv); -+extern void _rtw_free_evt_priv(struct evt_priv *pevtpriv); -+extern void _rtw_free_cmd_priv(struct cmd_priv *pcmdpriv); -+extern sint _rtw_enqueue_cmd(_queue *queue, struct cmd_obj *obj, bool to_head); -+extern struct cmd_obj *_rtw_dequeue_cmd(_queue *queue); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/custom_gpio.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/custom_gpio.h ---- linux-4.14.18/3rdparty/rtl8723de/include/custom_gpio.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/custom_gpio.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,32 @@ -+#ifndef __CUSTOM_GPIO_H__ -+#define __CUSTOM_GPIO_H___ -+ -+#include -+#include -+ -+#ifdef PLATFORM_OS_XP -+ #include -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ #include -+#endif -+ -+#ifdef PLATFORM_LINUX -+ #include -+#endif -+ -+typedef enum cust_gpio_modes { -+ WLAN_PWDN_ON, -+ WLAN_PWDN_OFF, -+ WLAN_POWER_ON, -+ WLAN_POWER_OFF, -+ WLAN_BT_PWDN_ON, -+ WLAN_BT_PWDN_OFF -+} cust_gpio_modes_t; -+ -+extern int rtw_wifi_gpio_init(void); -+extern int rtw_wifi_gpio_deinit(void); -+extern void rtw_wifi_gpio_wlan_ctrl(int onoff); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_conf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_conf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/drv_conf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_conf.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,322 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __DRV_CONF_H__ -+#define __DRV_CONF_H__ -+#include "autoconf.h" -+#include "hal_ic_cfg.h" -+ -+#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+ -+ #error "Shall be Linux or Windows, but not both!\n" -+ -+#endif -+ -+#if defined(CONFIG_MCC_MODE) && (!defined(CONFIG_CONCURRENT_MODE)) -+ -+ #error "Enable CONCURRENT_MODE before enable MCC MODE\n" -+ -+#endif -+ -+#if defined(CONFIG_MCC_MODE) && defined(CONFIG_BT_COEXIST) -+ -+ #error "Disable BT COEXIST before enable MCC MODE\n" -+ -+#endif -+ -+#if defined(CONFIG_MCC_MODE) && defined(CONFIG_TDLS) -+ -+ #error "Disable TDLS before enable MCC MODE\n" -+ -+#endif -+ -+#if defined(CONFIG_RTW_80211R) && !defined(CONFIG_LAYER2_ROAMING) -+ -+ #error "Enable CONFIG_LAYER2_ROAMING before enable CONFIG_RTW_80211R\n" -+ -+#endif -+ -+/* Older Android kernel doesn't has CONFIG_ANDROID defined, -+ * add this to force CONFIG_ANDROID defined */ -+#ifdef CONFIG_PLATFORM_ANDROID -+ #ifndef CONFIG_ANDROID -+ #define CONFIG_ANDROID -+ #endif -+#endif -+ -+#ifdef CONFIG_ANDROID -+ /* Some Android build will restart the UI while non-printable ascii is passed -+ * between java and c/c++ layer (JNI). We force CONFIG_VALIDATE_SSID -+ * for Android here. If you are sure there is no risk on your system about this, -+ * mask this macro define to support non-printable ascii ssid. -+ * #define CONFIG_VALIDATE_SSID */ -+ -+ /* Android expect dbm as the rx signal strength unit */ -+ #define CONFIG_SIGNAL_DISPLAY_DBM -+#endif -+ -+/* -+#if defined(CONFIG_HAS_EARLYSUSPEND) && defined(CONFIG_RESUME_IN_WORKQUEUE) -+ #warning "You have CONFIG_HAS_EARLYSUSPEND enabled in your system, we disable CONFIG_RESUME_IN_WORKQUEUE automatically" -+ #undef CONFIG_RESUME_IN_WORKQUEUE -+#endif -+ -+#if defined(CONFIG_ANDROID_POWER) && defined(CONFIG_RESUME_IN_WORKQUEUE) -+ #warning "You have CONFIG_ANDROID_POWER enabled in your system, we disable CONFIG_RESUME_IN_WORKQUEUE automatically" -+ #undef CONFIG_RESUME_IN_WORKQUEUE -+#endif -+*/ -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE /* this can be removed, because there is no case for this... */ -+ #if !defined(CONFIG_WAKELOCK) && !defined(CONFIG_ANDROID_POWER) -+ #error "enable CONFIG_RESUME_IN_WORKQUEUE without CONFIG_WAKELOCK or CONFIG_ANDROID_POWER will suffer from the danger of wifi's unfunctionality..." -+ #error "If you still want to enable CONFIG_RESUME_IN_WORKQUEUE in this case, mask this preprossor checking and GOOD LUCK..." -+ #endif -+#endif -+ -+/* About USB VENDOR REQ */ -+#if defined(CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC) && !defined(CONFIG_USB_VENDOR_REQ_MUTEX) -+ #warning "define CONFIG_USB_VENDOR_REQ_MUTEX for CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC automatically" -+ #define CONFIG_USB_VENDOR_REQ_MUTEX -+#endif -+#if defined(CONFIG_VENDOR_REQ_RETRY) && !defined(CONFIG_USB_VENDOR_REQ_MUTEX) -+ #warning "define CONFIG_USB_VENDOR_REQ_MUTEX for CONFIG_VENDOR_REQ_RETRY automatically" -+ #define CONFIG_USB_VENDOR_REQ_MUTEX -+#endif -+ -+#if !defined(CONFIG_AP_MODE) && defined(CONFIG_DFS_MASTER) -+ #warning "undef CONFIG_DFS_MASTER because CONFIG_AP_MODE is not defined" -+ #undef CONFIG_DFS_MASTER -+#endif -+ -+#define RTW_SCAN_SPARSE_MIRACAST 1 -+#define RTW_SCAN_SPARSE_BG 0 -+#define RTW_SCAN_SPARSE_ROAMING_ACTIVE 1 -+ -+#ifndef CONFIG_RTW_HIQ_FILTER -+ #define CONFIG_RTW_HIQ_FILTER 1 -+#endif -+ -+#ifndef CONFIG_RTW_FORCE_IGI_LB -+ #define CONFIG_RTW_FORCE_IGI_LB 0 -+#endif -+ -+#ifndef CONFIG_RTW_ADAPTIVITY_EN -+ #define CONFIG_RTW_ADAPTIVITY_EN 0 -+#endif -+ -+#ifndef CONFIG_RTW_ADAPTIVITY_MODE -+ #define CONFIG_RTW_ADAPTIVITY_MODE 0 -+#endif -+ -+#ifndef CONFIG_RTW_ADAPTIVITY_DML -+ #define CONFIG_RTW_ADAPTIVITY_DML 0 -+#endif -+ -+#ifndef CONFIG_RTW_ADAPTIVITY_DC_BACKOFF -+ #define CONFIG_RTW_ADAPTIVITY_DC_BACKOFF 2 -+#endif -+ -+#ifndef CONFIG_RTW_ADAPTIVITY_TH_L2H_INI -+ #define CONFIG_RTW_ADAPTIVITY_TH_L2H_INI 0 -+#endif -+ -+#ifndef CONFIG_RTW_ADAPTIVITY_TH_EDCCA_HL_DIFF -+ #define CONFIG_RTW_ADAPTIVITY_TH_EDCCA_HL_DIFF 0 -+#endif -+ -+#ifndef CONFIG_RTW_EXCL_CHS -+ #define CONFIG_RTW_EXCL_CHS {0} -+#endif -+ -+#ifndef CONFIG_RTW_DFS_REGION_DOMAIN -+ #define CONFIG_RTW_DFS_REGION_DOMAIN 0 -+#endif -+ -+#ifndef CONFIG_TXPWR_BY_RATE_EN -+#define CONFIG_TXPWR_BY_RATE_EN 2 /* by efuse */ -+#endif -+#ifndef CONFIG_TXPWR_LIMIT_EN -+#define CONFIG_TXPWR_LIMIT_EN 2 /* by efuse */ -+#endif -+ -+/* compatible with old fashion configuration */ -+#if defined(CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY) -+ #undef CONFIG_TXPWR_BY_RATE_EN -+ #undef CONFIG_TXPWR_LIMIT_EN -+ #define CONFIG_TXPWR_BY_RATE_EN 1 -+ #define CONFIG_TXPWR_LIMIT_EN 1 -+#elif defined(CONFIG_CALIBRATE_TX_POWER_TO_MAX) -+ #undef CONFIG_TXPWR_BY_RATE_EN -+ #undef CONFIG_TXPWR_LIMIT_EN -+ #define CONFIG_TXPWR_BY_RATE_EN 1 -+ #define CONFIG_TXPWR_LIMIT_EN 0 -+#endif -+ -+#ifndef RTW_DEF_MODULE_REGULATORY_CERT -+ #define RTW_DEF_MODULE_REGULATORY_CERT 0 -+#endif -+ -+#if RTW_DEF_MODULE_REGULATORY_CERT -+ /* force enable TX power by rate and TX power limit */ -+ #undef CONFIG_TXPWR_BY_RATE_EN -+ #undef CONFIG_TXPWR_LIMIT_EN -+ #define CONFIG_TXPWR_BY_RATE_EN 1 -+ #define CONFIG_TXPWR_LIMIT_EN 1 -+#endif -+ -+#ifndef CONFIG_RTW_TARGET_TX_PWR_2G_A -+ #define CONFIG_RTW_TARGET_TX_PWR_2G_A {-1, -1, -1, -1, -1, -1, -1, -1, -1, -1} -+#endif -+ -+#ifndef CONFIG_RTW_TARGET_TX_PWR_2G_B -+ #define CONFIG_RTW_TARGET_TX_PWR_2G_B {-1, -1, -1, -1, -1, -1, -1, -1, -1, -1} -+#endif -+ -+#ifndef CONFIG_RTW_TARGET_TX_PWR_2G_C -+ #define CONFIG_RTW_TARGET_TX_PWR_2G_C {-1, -1, -1, -1, -1, -1, -1, -1, -1, -1} -+#endif -+ -+#ifndef CONFIG_RTW_TARGET_TX_PWR_2G_D -+ #define CONFIG_RTW_TARGET_TX_PWR_2G_D {-1, -1, -1, -1, -1, -1, -1, -1, -1, -1} -+#endif -+ -+#ifndef CONFIG_RTW_TARGET_TX_PWR_5G_A -+ #define CONFIG_RTW_TARGET_TX_PWR_5G_A {-1, -1, -1, -1, -1, -1, -1, -1, -1} -+#endif -+ -+#ifndef CONFIG_RTW_TARGET_TX_PWR_5G_B -+ #define CONFIG_RTW_TARGET_TX_PWR_5G_B {-1, -1, -1, -1, -1, -1, -1, -1, -1} -+#endif -+ -+#ifndef CONFIG_RTW_TARGET_TX_PWR_5G_C -+ #define CONFIG_RTW_TARGET_TX_PWR_5G_C {-1, -1, -1, -1, -1, -1, -1, -1, -1} -+#endif -+ -+#ifndef CONFIG_RTW_TARGET_TX_PWR_5G_D -+ #define CONFIG_RTW_TARGET_TX_PWR_5G_D {-1, -1, -1, -1, -1, -1, -1, -1, -1} -+#endif -+ -+#ifndef CONFIG_RTW_AMPLIFIER_TYPE_2G -+ #define CONFIG_RTW_AMPLIFIER_TYPE_2G 0 -+#endif -+ -+#ifndef CONFIG_RTW_AMPLIFIER_TYPE_5G -+ #define CONFIG_RTW_AMPLIFIER_TYPE_5G 0 -+#endif -+ -+#ifndef CONFIG_RTW_RFE_TYPE -+ #define CONFIG_RTW_RFE_TYPE 64 -+#endif -+ -+#ifndef CONFIG_RTW_GLNA_TYPE -+ #define CONFIG_RTW_GLNA_TYPE 0 -+#endif -+ -+#ifndef CONFIG_RTW_PLL_REF_CLK_SEL -+ #define CONFIG_RTW_PLL_REF_CLK_SEL 0x0F -+#endif -+ -+#ifndef CONFIG_IFACE_NUMBER -+ #ifdef CONFIG_CONCURRENT_MODE -+ #define CONFIG_IFACE_NUMBER 2 -+ #else -+ #define CONFIG_IFACE_NUMBER 1 -+ #endif -+#endif -+ -+#ifndef CONFIG_CONCURRENT_MODE -+ #if (CONFIG_IFACE_NUMBER > 1) -+ #error "CONFIG_IFACE_NUMBER over 1,but CONFIG_CONCURRENT_MODE not defined" -+ #endif -+#endif -+ -+#if (CONFIG_IFACE_NUMBER == 0) -+ #error "CONFIG_IFACE_NUMBER cound not equel to 0 !!" -+#endif -+ -+#if (CONFIG_IFACE_NUMBER > 3) -+ #error "Not support over 3 interfaces yet !!" -+#endif -+ -+#if (CONFIG_IFACE_NUMBER > 8) /*IFACE_ID_MAX*/ -+ #error "HW count not support over 8 interfaces !!" -+#endif -+ -+#if (CONFIG_IFACE_NUMBER > 2) -+ #define CONFIG_MI_WITH_MBSSID_CAM -+ -+ #ifdef CONFIG_MI_WITH_MBSSID_CAM -+ #define CONFIG_MBSSID_CAM -+ #if defined(CONFIG_RUNTIME_PORT_SWITCH) -+ #undef CONFIG_RUNTIME_PORT_SWITCH -+ #endif -+ #endif -+ -+ #ifdef CONFIG_AP_MODE -+ #define CONFIG_SWTIMER_BASED_TXBCN -+ /*#define CONFIG_FW_BASED_BCN*/ -+ #endif -+#endif -+ -+#define MACID_NUM_SW_LIMIT 32 -+#define SEC_CAM_ENT_NUM_SW_LIMIT 32 -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) -+ #define CONFIG_IEEE80211_BAND_5GHZ -+#endif -+ -+#ifndef RTW_DEF_MODULE_REGULATORY_CERT -+ #define RTW_DEF_MODULE_REGULATORY_CERT 0 -+#endif -+ -+#if RTW_DEF_MODULE_REGULATORY_CERT -+ /* force enable TX power by rate and TX power limit */ -+ #ifndef CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY -+ #define CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY -+ #endif -+#endif -+ -+/* -+ Mark CONFIG_DEAUTH_BEFORE_CONNECT by Arvin 2015/07/20 -+ If the failure of Wi-Fi connection is due to some irregular disconnection behavior (like unplug dongle, -+ power down etc.) in last time, we can unmark this flag to avoid some unpredictable response from AP. -+*/ -+/*#define CONFIG_DEAUTH_BEFORE_CONNECT */ -+ -+/*#define CONFIG_WEXT_DONT_JOIN_BYSSID */ -+/* #include */ -+ -+ -+/*#define CONFIG_DOSCAN_IN_BUSYTRAFFIC */ -+ -+/*Don't release SDIO irq in suspend/resume procedure*/ -+#ifdef CONFIG_SDIO_HCI -+#define CONFIG_RTW_SDIO_KEEP_IRQ -+#endif -+ -+/* -+ * Add by Lucas@2016/02/15 -+ * For RX Aggregation -+ */ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_RX_AGGREGATION) -+ #define RTW_RX_AGGREGATION -+#endif /* CONFIG_SDIO_HCI || CONFIG_USB_RX_AGGREGATION */ -+ -+#endif /* __DRV_CONF_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types_ce.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_ce.h ---- linux-4.14.18/3rdparty/rtl8723de/include/drv_types_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_ce.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,91 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __DRV_TYPES_CE_H__ -+#define __DRV_TYPES_CE_H__ -+ -+#include -+#include -+ -+#include -+ -+#define MAX_ACTIVE_REG_PATH 256 -+ -+#define MAX_MCAST_LIST_NUM 32 -+ -+ -+ -+/* for ioctl */ -+#define MAKE_DRIVER_VERSION(_MainVer, _MinorVer) ((((u32)(_MainVer))<<16)+_MinorVer) -+ -+#define NIC_HEADER_SIZE 14 /* !< can be moved to typedef.h */ -+#define NIC_MAX_PACKET_SIZE 1514 /* !< can be moved to typedef.h */ -+#define NIC_MAX_SEND_PACKETS 10 /* max number of send packets the MiniportSendPackets function can accept, can be moved to typedef.h */ -+#define NIC_VENDOR_DRIVER_VERSION MAKE_DRIVER_VERSION(0, 001) /* !< can be moved to typedef.h */ -+#define NIC_MAX_PACKET_SIZE 1514 /* !< can be moved to typedef.h */ -+ -+typedef struct _MP_REG_ENTRY { -+ -+ NDIS_STRING RegName; /* variable name text */ -+ BOOLEAN bRequired; /* 1->required, 0->optional */ -+ -+ u8 Type; /* NdisParameterInteger/NdisParameterHexInteger/NdisParameterStringle/NdisParameterMultiString */ -+ uint FieldOffset; /* offset to MP_ADAPTER field */ -+ uint FieldSize; /* size (in bytes) of the field */ -+ -+#ifdef UNDER_AMD64 -+ u64 Default; -+#else -+ u32 Default; /* default value to use */ -+#endif -+ -+ u32 Min; /* minimum value allowed */ -+ u32 Max; /* maximum value allowed */ -+} MP_REG_ENTRY, *PMP_REG_ENTRY; -+ -+#ifdef CONFIG_USB_HCI -+typedef struct _USB_EXTENSION { -+ LPCUSB_FUNCS _lpUsbFuncs; -+ USB_HANDLE _hDevice; -+ PVOID pAdapter; -+ -+#if 0 -+ USB_ENDPOINT_DESCRIPTOR _endpACLIn; -+ USB_ENDPOINT_DESCRIPTOR _endpACLOutHigh; -+ USB_ENDPOINT_DESCRIPTOR _endpACLOutNormal; -+ -+ USB_PIPE pPipeIn; -+ USB_PIPE pPipeOutNormal; -+ USB_PIPE pPipeOutHigh; -+#endif -+ -+} USB_EXTENSION, *PUSB_EXTENSION; -+#endif -+ -+ -+typedef struct _OCTET_STRING { -+ u8 *Octet; -+ u16 Length; -+} OCTET_STRING, *POCTET_STRING; -+ -+ -+ -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types_gspi.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_gspi.h ---- linux-4.14.18/3rdparty/rtl8723de/include/drv_types_gspi.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_gspi.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,54 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __DRV_TYPES_GSPI_H__ -+#define __DRV_TYPES_GSPI_H__ -+ -+/* SPI Header Files */ -+#ifdef PLATFORM_LINUX -+ #include -+ #include -+ #include -+ /* #include */ -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+#endif -+ -+ -+typedef struct gspi_data { -+ u8 func_number; -+ -+ u8 tx_block_mode; -+ u8 rx_block_mode; -+ u32 block_transfer_len; -+ -+#ifdef PLATFORM_LINUX -+ struct spi_device *func; -+ -+ struct workqueue_struct *priv_wq; -+ struct delayed_work irq_work; -+#endif -+} GSPI_DATA, *PGSPI_DATA; -+ -+#endif /* #ifndef __DRV_TYPES_GSPI_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types.h ---- linux-4.14.18/3rdparty/rtl8723de/include/drv_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,1584 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/*------------------------------------------------------------------------------- -+ -+ For type defines and data structure defines -+ -+--------------------------------------------------------------------------------*/ -+ -+ -+#ifndef __DRV_TYPES_H__ -+#define __DRV_TYPES_H__ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ #include -+ #include -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ #include -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ #include -+#endif -+ -+#ifdef PLATFORM_LINUX -+ #include -+#endif -+ -+enum _NIC_VERSION { -+ -+ RTL8711_NIC, -+ RTL8712_NIC, -+ RTL8713_NIC, -+ RTL8716_NIC -+ -+}; -+ -+typedef struct _ADAPTER _adapter, ADAPTER, *PADAPTER; -+ -+#include -+#include -+ -+#ifdef CONFIG_80211N_HT -+ #include -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ #include -+#endif -+ -+#ifdef CONFIG_INTEL_WIDI -+ #include -+#endif -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#ifdef CONFIG_BEAMFORMING -+ #include -+#endif -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "../hal/hal_dm.h" -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ #include -+#endif -+ -+#include -+ -+#ifdef CONFIG_TDLS -+ #include -+#endif /* CONFIG_TDLS */ -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ #include -+#endif /* CONFIG_WAPI_SUPPORT */ -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ #include -+#endif /* CONFIG_DRVEXT_MODULE */ -+ -+#ifdef CONFIG_MP_INCLUDED -+ #include -+#endif /* CONFIG_MP_INCLUDED */ -+ -+#ifdef CONFIG_BR_EXT -+ #include -+#endif /* CONFIG_BR_EXT */ -+ -+#ifdef CONFIG_IOL -+ #include -+#endif /* CONFIG_IOL */ -+ -+#include -+#include -+#include -+#include -+ -+#include -+ -+#ifdef CONFIG_BT_COEXIST -+ #include -+#endif /* CONFIG_BT_COEXIST */ -+ -+#ifdef CONFIG_MCC_MODE -+ #include -+#endif /*CONFIG_MCC_MODE */ -+ -+#define SPEC_DEV_ID_NONE BIT(0) -+#define SPEC_DEV_ID_DISABLE_HT BIT(1) -+#define SPEC_DEV_ID_ENABLE_PS BIT(2) -+#define SPEC_DEV_ID_RF_CONFIG_1T1R BIT(3) -+#define SPEC_DEV_ID_RF_CONFIG_2T2R BIT(4) -+#define SPEC_DEV_ID_ASSIGN_IFNAME BIT(5) -+ -+struct specific_device_id { -+ -+ u32 flags; -+ -+ u16 idVendor; -+ u16 idProduct; -+ -+}; -+ -+struct registry_priv { -+ u8 chip_version; -+ u8 rfintfs; -+ u8 lbkmode; -+ u8 hci; -+ NDIS_802_11_SSID ssid; -+ u8 network_mode; /* infra, ad-hoc, auto */ -+ u8 channel;/* ad-hoc support requirement */ -+ u8 wireless_mode;/* A, B, G, auto */ -+ u8 scan_mode;/* active, passive */ -+ u8 radio_enable; -+ u8 preamble;/* long, short, auto */ -+ u8 vrtl_carrier_sense;/* Enable, Disable, Auto */ -+ u8 vcs_type;/* RTS/CTS, CTS-to-self */ -+ u16 rts_thresh; -+ u16 frag_thresh; -+ u8 adhoc_tx_pwr; -+ u8 soft_ap; -+ u8 power_mgnt; -+ u8 ips_mode; -+ u8 smart_ps; -+ u8 usb_rxagg_mode; -+ u8 long_retry_lmt; -+ u8 short_retry_lmt; -+ u16 busy_thresh; -+ u8 ack_policy; -+ u8 mp_mode; -+#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTW_CUSTOMER_STR) -+ u8 mp_customer_str; -+#endif -+ u8 mp_dm; -+ u8 software_encrypt; -+ u8 software_decrypt; -+#ifdef CONFIG_TX_EARLY_MODE -+ u8 early_mode; -+#endif -+ u8 acm_method; -+ /* UAPSD */ -+ u8 wmm_enable; -+ u8 uapsd_enable; -+ u8 uapsd_max_sp; -+ u8 uapsd_acbk_en; -+ u8 uapsd_acbe_en; -+ u8 uapsd_acvi_en; -+ u8 uapsd_acvo_en; -+ -+ WLAN_BSSID_EX dev_network; -+ -+ u8 tx_bw_mode; -+ -+#ifdef CONFIG_80211N_HT -+ u8 ht_enable; -+ /* 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz */ -+ /* 2.4G use bit 0 ~ 3, 5G use bit 4 ~ 7 */ -+ /* 0x21 means enable 2.4G 40MHz & 5G 80MHz */ -+ u8 bw_mode; -+ u8 ampdu_enable;/* for tx */ -+ u8 rx_stbc; -+ u8 ampdu_amsdu;/* A-MPDU Supports A-MSDU is permitted */ -+ /* Short GI support Bit Map */ -+ /* BIT0 - 20MHz, 1: support, 0: non-support */ -+ /* BIT1 - 40MHz, 1: support, 0: non-support */ -+ /* BIT2 - 80MHz, 1: support, 0: non-support */ -+ /* BIT3 - 160MHz, 1: support, 0: non-support */ -+ u8 short_gi; -+ /* BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx */ -+ u8 ldpc_cap; -+ /* BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx */ -+ u8 stbc_cap; -+ /* -+ * BIT0: Enable VHT SU Beamformer -+ * BIT1: Enable VHT SU Beamformee -+ * BIT2: Enable VHT MU Beamformer, depend on VHT SU Beamformer -+ * BIT3: Enable VHT MU Beamformee, depend on VHT SU Beamformee -+ * BIT4: Enable HT Beamformer -+ * BIT5: Enable HT Beamformee -+ */ -+ u8 beamform_cap; -+ u8 beamformer_rf_num; -+ u8 beamformee_rf_num; -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_80211AC_VHT -+ u8 vht_enable; /* 0:disable, 1:enable, 2:auto */ -+ u8 ampdu_factor; -+ u8 vht_rate_sel; -+#endif /* CONFIG_80211AC_VHT */ -+ -+ u8 lowrate_two_xmit; -+ -+ u8 rf_config ; -+ u8 low_power ; -+ -+ u8 wifi_spec;/* !turbo_mode */ -+ u8 special_rf_path; /* 0: 2T2R ,1: only turn on path A 1T1R */ -+ char alpha2[2]; -+ u8 channel_plan; -+ u8 excl_chs[MAX_CHANNEL_NUM]; -+ u8 full_ch_in_p2p_handshake; /* 0: reply only softap channel, 1: reply full channel list*/ -+ -+#ifdef CONFIG_BT_COEXIST -+ u8 btcoex; -+ u8 bt_iso; -+ u8 bt_sco; -+ u8 bt_ampdu; -+ u8 ant_num; -+#endif -+ BOOLEAN bAcceptAddbaReq; -+ -+ u8 antdiv_cfg; -+ u8 antdiv_type; -+ u8 drv_ant_band_switch; -+ -+ u8 switch_usb_mode; -+ -+ u8 usbss_enable;/* 0:disable,1:enable */ -+ u8 hwpdn_mode;/* 0:disable,1:enable,2:decide by EFUSE config */ -+ u8 hwpwrp_detect;/* 0:disable,1:enable */ -+ -+ u8 hw_wps_pbc;/* 0:disable,1:enable */ -+ -+#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+ char adaptor_info_caching_file_path[PATH_LENGTH_MAX]; -+#endif -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ u8 max_roaming_times; /* the max number driver will try to roaming */ -+#endif -+ -+#ifdef CONFIG_IOL -+ u8 fw_iol; /* enable iol without other concern */ -+#endif -+ -+#ifdef CONFIG_80211D -+ u8 enable80211d; -+#endif -+ -+ u8 ifname[16]; -+ u8 if2name[16]; -+ -+ u8 notch_filter; -+ -+#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+ u8 force_ant;/* 0 normal,1 main,2 aux */ -+ u8 force_igi;/* 0 normal */ -+#endif -+ -+ u8 force_igi_lb; -+ -+ /* for pll reference clock selction */ -+ u8 pll_ref_clk_sel; -+ -+ /* define for tx power adjust */ -+ u8 RegEnableTxPowerLimit; -+ u8 RegEnableTxPowerByRate; -+ u8 RegPowerBase; -+ u8 RegPwrTblSel; -+ -+ u8 target_tx_pwr_valid; -+ s8 target_tx_pwr_2g[RF_PATH_MAX][RATE_SECTION_NUM]; -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ s8 target_tx_pwr_5g[RF_PATH_MAX][RATE_SECTION_NUM - 1]; -+#endif -+ -+ s8 TxBBSwing_2G; -+ s8 TxBBSwing_5G; -+ u8 AmplifierType_2G; -+ u8 AmplifierType_5G; -+ u8 bEn_RFE; -+ u8 RFE_Type; -+ u8 PowerTracking_Type; -+ u8 GLNA_Type; -+ u8 check_fw_ps; -+ u8 RegPwrTrimEnable; -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ u8 load_phy_file; -+ u8 RegDecryptCustomFile; -+#endif -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 virtual_iface_num; -+#endif -+ u8 qos_opt_enable; -+ -+ u8 hiq_filter; -+ u8 adaptivity_en; -+ u8 adaptivity_mode; -+ u8 adaptivity_dml; -+ u8 adaptivity_dc_backoff; -+ s8 adaptivity_th_l2h_ini; -+ s8 adaptivity_th_edcca_hl_diff; -+ -+ u8 boffefusemask; -+ BOOLEAN bFileMaskEfuse; -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ u8 acs_mode; -+ u8 acs_auto_scan; -+#endif -+ u32 reg_rxgain_offset_2g; -+ u32 reg_rxgain_offset_5gl; -+ u32 reg_rxgain_offset_5gm; -+ u32 reg_rxgain_offset_5gh; -+ -+#ifdef CONFIG_DFS_MASTER -+ u8 dfs_region_domain; -+#endif -+ -+#ifdef CONFIG_MCC_MODE -+ u8 en_mcc; -+ u32 rtw_mcc_single_tx_cri; -+ u32 rtw_mcc_ap_bw20_target_tx_tp; -+ u32 rtw_mcc_ap_bw40_target_tx_tp; -+ u32 rtw_mcc_ap_bw80_target_tx_tp; -+ u32 rtw_mcc_sta_bw20_target_tx_tp; -+ u32 rtw_mcc_sta_bw40_target_tx_tp; -+ u32 rtw_mcc_sta_bw80_target_tx_tp; -+#endif /* CONFIG_MCC_MODE */ -+ -+#ifdef CONFIG_RTW_NAPI -+ u8 en_napi; -+#ifdef CONFIG_RTW_GRO -+ u8 en_gro; -+#endif /* CONFIG_RTW_GRO */ -+#endif /* CONFIG_RTW_NAPI */ -+ -+ bool default_patterns_en; -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+ u8 trx_share_mode; -+#endif -+ u8 check_hw_status; -+}; -+ -+/* For registry parameters */ -+#define RGTRY_OFT(field) ((ULONG)FIELD_OFFSET(struct registry_priv, field)) -+#define RGTRY_SZ(field) sizeof(((struct registry_priv *) 0)->field) -+ -+#define GetRegAmplifierType2G(_Adapter) (_Adapter->registrypriv.AmplifierType_2G) -+#define GetRegAmplifierType5G(_Adapter) (_Adapter->registrypriv.AmplifierType_5G) -+ -+#define GetRegTxBBSwing_2G(_Adapter) (_Adapter->registrypriv.TxBBSwing_2G) -+#define GetRegTxBBSwing_5G(_Adapter) (_Adapter->registrypriv.TxBBSwing_5G) -+ -+#define GetRegbENRFEType(_Adapter) (_Adapter->registrypriv.bEn_RFE) -+#define GetRegRFEType(_Adapter) (_Adapter->registrypriv.RFE_Type) -+#define GetRegGLNAType(_Adapter) (_Adapter->registrypriv.GLNA_Type) -+#define GetRegPowerTrackingType(_Adapter) (_Adapter->registrypriv.PowerTracking_Type) -+ -+#define BSSID_OFT(field) ((ULONG)FIELD_OFFSET(WLAN_BSSID_EX, field)) -+#define BSSID_SZ(field) sizeof(((PWLAN_BSSID_EX) 0)->field) -+ -+#ifdef CONFIG_80211N_HT -+#define BW_MODE_2G(bw_mode) ((bw_mode) & 0x0F) -+#define BW_MODE_5G(bw_mode) ((bw_mode) >> 4) -+#define REGSTY_BW_2G(regsty) BW_MODE_2G((regsty)->bw_mode) -+#define REGSTY_BW_5G(regsty) BW_MODE_5G((regsty)->bw_mode) -+#define REGSTY_IS_BW_2G_SUPPORT(regsty, bw) (REGSTY_BW_2G((regsty)) >= (bw)) -+#define REGSTY_IS_BW_5G_SUPPORT(regsty, bw) (REGSTY_BW_5G((regsty)) >= (bw)) -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+#define REGSTY_IS_11AC_ENABLE(regsty) ((regsty)->vht_enable != 0) -+#define REGSTY_IS_11AC_AUTO(regsty) ((regsty)->vht_enable == 2) -+#endif -+ -+typedef struct rtw_if_operations { -+ int __must_check(*read)(struct dvobj_priv *d, int addr, void *buf, -+ size_t len, bool fixed); -+ int __must_check(*write)(struct dvobj_priv *d, int addr, void *buf, -+ size_t len, bool fixed); -+} RTW_IF_OPS, *PRTW_IF_OPS; -+ -+#ifdef CONFIG_SDIO_HCI -+ #include -+ #define INTF_DATA SDIO_DATA -+ #define INTF_OPS PRTW_IF_OPS -+#elif defined(CONFIG_GSPI_HCI) -+ #include -+ #define INTF_DATA GSPI_DATA -+#elif defined(CONFIG_PCI_HCI) -+ #include -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ #define is_primary_adapter(adapter) (adapter->adapter_type == PRIMARY_ADAPTER) -+ #define is_vir_adapter(adapter) (adapter->adapter_type == MAX_ADAPTER) -+ #define get_hw_port(adapter) (adapter->hw_port) -+#else -+ #define is_primary_adapter(adapter) (1) -+ #define is_vir_adapter(adapter) (0) -+ #define get_hw_port(adapter) (HW_PORT0) -+#endif -+#define GET_PRIMARY_ADAPTER(padapter) (((_adapter *)padapter)->dvobj->padapters[IFACE_ID0]) -+#define GET_IFACE_NUMS(padapter) (((_adapter *)padapter)->dvobj->iface_nums) -+#define GET_ADAPTER(padapter, iface_id) (((_adapter *)padapter)->dvobj->padapters[iface_id]) -+ -+#define GetDefaultAdapter(padapter) padapter -+ -+enum _IFACE_ID { -+ IFACE_ID0, /*PRIMARY_ADAPTER*/ -+ IFACE_ID1, -+ IFACE_ID2, -+ IFACE_ID3, -+ IFACE_ID4, -+ IFACE_ID5, -+ IFACE_ID6, -+ IFACE_ID7, -+ IFACE_ID_MAX, -+}; -+ -+#define VIF_START_ID 1 -+ -+#ifdef CONFIG_DBG_COUNTER -+ -+struct rx_logs { -+ u32 intf_rx; -+ u32 intf_rx_err_recvframe; -+ u32 intf_rx_err_skb; -+ u32 intf_rx_report; -+ u32 core_rx; -+ u32 core_rx_pre; -+ u32 core_rx_pre_ver_err; -+ u32 core_rx_pre_mgmt; -+ u32 core_rx_pre_mgmt_err_80211w; -+ u32 core_rx_pre_mgmt_err; -+ u32 core_rx_pre_ctrl; -+ u32 core_rx_pre_ctrl_err; -+ u32 core_rx_pre_data; -+ u32 core_rx_pre_data_wapi_seq_err; -+ u32 core_rx_pre_data_wapi_key_err; -+ u32 core_rx_pre_data_handled; -+ u32 core_rx_pre_data_err; -+ u32 core_rx_pre_data_unknown; -+ u32 core_rx_pre_unknown; -+ u32 core_rx_enqueue; -+ u32 core_rx_dequeue; -+ u32 core_rx_post; -+ u32 core_rx_post_decrypt; -+ u32 core_rx_post_decrypt_wep; -+ u32 core_rx_post_decrypt_tkip; -+ u32 core_rx_post_decrypt_aes; -+ u32 core_rx_post_decrypt_wapi; -+ u32 core_rx_post_decrypt_hw; -+ u32 core_rx_post_decrypt_unknown; -+ u32 core_rx_post_decrypt_err; -+ u32 core_rx_post_defrag_err; -+ u32 core_rx_post_portctrl_err; -+ u32 core_rx_post_indicate; -+ u32 core_rx_post_indicate_in_oder; -+ u32 core_rx_post_indicate_reoder; -+ u32 core_rx_post_indicate_err; -+ u32 os_indicate; -+ u32 os_indicate_ap_mcast; -+ u32 os_indicate_ap_forward; -+ u32 os_indicate_ap_self; -+ u32 os_indicate_err; -+ u32 os_netif_ok; -+ u32 os_netif_err; -+}; -+ -+struct tx_logs { -+ u32 os_tx; -+ u32 os_tx_err_up; -+ u32 os_tx_err_xmit; -+ u32 os_tx_m2u; -+ u32 os_tx_m2u_ignore_fw_linked; -+ u32 os_tx_m2u_ignore_self; -+ u32 os_tx_m2u_entry; -+ u32 os_tx_m2u_entry_err_xmit; -+ u32 os_tx_m2u_entry_err_skb; -+ u32 os_tx_m2u_stop; -+ u32 core_tx; -+ u32 core_tx_err_pxmitframe; -+ u32 core_tx_err_brtx; -+ u32 core_tx_upd_attrib; -+ u32 core_tx_upd_attrib_adhoc; -+ u32 core_tx_upd_attrib_sta; -+ u32 core_tx_upd_attrib_ap; -+ u32 core_tx_upd_attrib_unknown; -+ u32 core_tx_upd_attrib_dhcp; -+ u32 core_tx_upd_attrib_icmp; -+ u32 core_tx_upd_attrib_active; -+ u32 core_tx_upd_attrib_err_ucast_sta; -+ u32 core_tx_upd_attrib_err_ucast_ap_link; -+ u32 core_tx_upd_attrib_err_sta; -+ u32 core_tx_upd_attrib_err_link; -+ u32 core_tx_upd_attrib_err_sec; -+ u32 core_tx_ap_enqueue_warn_fwstate; -+ u32 core_tx_ap_enqueue_warn_sta; -+ u32 core_tx_ap_enqueue_warn_nosta; -+ u32 core_tx_ap_enqueue_warn_link; -+ u32 core_tx_ap_enqueue_warn_trigger; -+ u32 core_tx_ap_enqueue_mcast; -+ u32 core_tx_ap_enqueue_ucast; -+ u32 core_tx_ap_enqueue; -+ u32 intf_tx; -+ u32 intf_tx_pending_ac; -+ u32 intf_tx_pending_fw_under_survey; -+ u32 intf_tx_pending_fw_under_linking; -+ u32 intf_tx_pending_xmitbuf; -+ u32 intf_tx_enqueue; -+ u32 core_tx_enqueue; -+ u32 core_tx_enqueue_class; -+ u32 core_tx_enqueue_class_err_sta; -+ u32 core_tx_enqueue_class_err_nosta; -+ u32 core_tx_enqueue_class_err_fwlink; -+ u32 intf_tx_direct; -+ u32 intf_tx_direct_err_coalesce; -+ u32 intf_tx_dequeue; -+ u32 intf_tx_dequeue_err_coalesce; -+ u32 intf_tx_dump_xframe; -+ u32 intf_tx_dump_xframe_err_txdesc; -+ u32 intf_tx_dump_xframe_err_port; -+}; -+ -+struct int_logs { -+ u32 all; -+ u32 err; -+ u32 tbdok; -+ u32 tbder; -+ u32 bcnderr; -+ u32 bcndma; -+ u32 bcndma_e; -+ u32 rx; -+ u32 rx_rdu; -+ u32 rx_fovw; -+ u32 txfovw; -+ u32 mgntok; -+ u32 highdok; -+ u32 bkdok; -+ u32 bedok; -+ u32 vidok; -+ u32 vodok; -+}; -+ -+#endif /* CONFIG_DBG_COUNTER */ -+ -+struct debug_priv { -+ u32 dbg_sdio_free_irq_error_cnt; -+ u32 dbg_sdio_alloc_irq_error_cnt; -+ u32 dbg_sdio_free_irq_cnt; -+ u32 dbg_sdio_alloc_irq_cnt; -+ u32 dbg_sdio_deinit_error_cnt; -+ u32 dbg_sdio_init_error_cnt; -+ u32 dbg_suspend_error_cnt; -+ u32 dbg_suspend_cnt; -+ u32 dbg_resume_cnt; -+ u32 dbg_resume_error_cnt; -+ u32 dbg_deinit_fail_cnt; -+ u32 dbg_carddisable_cnt; -+ u32 dbg_carddisable_error_cnt; -+ u32 dbg_ps_insuspend_cnt; -+ u32 dbg_dev_unload_inIPS_cnt; -+ u32 dbg_wow_leave_ps_fail_cnt; -+ u32 dbg_scan_pwr_state_cnt; -+ u32 dbg_downloadfw_pwr_state_cnt; -+ u32 dbg_fw_read_ps_state_fail_cnt; -+ u32 dbg_leave_ips_fail_cnt; -+ u32 dbg_leave_lps_fail_cnt; -+ u32 dbg_h2c_leave32k_fail_cnt; -+ u32 dbg_diswow_dload_fw_fail_cnt; -+ u32 dbg_enwow_dload_fw_fail_cnt; -+ u32 dbg_ips_drvopen_fail_cnt; -+ u32 dbg_poll_fail_cnt; -+ u32 dbg_rpwm_toogle_cnt; -+ u32 dbg_rpwm_timeout_fail_cnt; -+ u32 dbg_sreset_cnt; -+ u64 dbg_rx_fifo_last_overflow; -+ u64 dbg_rx_fifo_curr_overflow; -+ u64 dbg_rx_fifo_diff_overflow; -+ u64 dbg_rx_ampdu_drop_count; -+ u64 dbg_rx_ampdu_forced_indicate_count; -+ u64 dbg_rx_ampdu_loss_count; -+ u64 dbg_rx_dup_mgt_frame_drop_count; -+ u64 dbg_rx_ampdu_window_shift_cnt; -+ u64 dbg_rx_conflic_mac_addr_cnt; -+}; -+ -+struct rtw_traffic_statistics { -+ /* tx statistics */ -+ u64 tx_bytes; -+ u64 tx_pkts; -+ u64 tx_drop; -+ u64 cur_tx_bytes; -+ u64 last_tx_bytes; -+ u32 cur_tx_tp; /* Tx throughput in MBps. */ -+ -+ /* rx statistics */ -+ u64 rx_bytes; -+ u64 rx_pkts; -+ u64 rx_drop; -+ u64 cur_rx_bytes; -+ u64 last_rx_bytes; -+ u32 cur_rx_tp; /* Rx throughput in MBps. */ -+}; -+ -+#define SEC_CAP_CHK_BMC BIT0 -+ -+#define SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH BIT0 -+ -+struct sec_cam_bmp { -+ u32 m0; -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 32) -+ u32 m1; -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 64) -+ u32 m2; -+#endif -+#if (SEC_CAM_ENT_NUM_SW_LIMIT > 96) -+ u32 m3; -+#endif -+}; -+ -+struct cam_ctl_t { -+ _lock lock; -+ -+ u8 sec_cap; -+ u32 flags; -+ -+ u8 num; -+ struct sec_cam_bmp used; -+ -+ _mutex sec_cam_access_mutex; -+}; -+ -+struct sec_cam_ent { -+ u16 ctrl; -+ u8 mac[ETH_ALEN]; -+ u8 key[16]; -+}; -+ -+#define KEY_FMT "%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" -+#define KEY_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5], \ -+ ((u8 *)(x))[6], ((u8 *)(x))[7], ((u8 *)(x))[8], ((u8 *)(x))[9], ((u8 *)(x))[10], ((u8 *)(x))[11], \ -+ ((u8 *)(x))[12], ((u8 *)(x))[13], ((u8 *)(x))[14], ((u8 *)(x))[15] -+ -+struct macid_bmp { -+ u32 m0; -+#if (MACID_NUM_SW_LIMIT > 32) -+ u32 m1; -+#endif -+#if (MACID_NUM_SW_LIMIT > 64) -+ u32 m2; -+#endif -+#if (MACID_NUM_SW_LIMIT > 96) -+ u32 m3; -+#endif -+}; -+ -+struct macid_ctl_t { -+ _lock lock; -+ u8 num; -+ struct macid_bmp used; -+ struct macid_bmp bmc; -+ struct macid_bmp if_g[CONFIG_IFACE_NUMBER]; -+ u8 iface_bmc[CONFIG_IFACE_NUMBER];/*for bc-sta of AP or Adhoc mode*/ -+ struct macid_bmp ch_g[2]; /* 2 ch concurrency */ -+ u8 h2c_msr[MACID_NUM_SW_LIMIT]; -+ u8 bw[MACID_NUM_SW_LIMIT]; -+ u8 vht_en[MACID_NUM_SW_LIMIT]; -+ u32 rate_bmp0[MACID_NUM_SW_LIMIT]; -+ u32 rate_bmp1[MACID_NUM_SW_LIMIT]; -+ struct sta_info *sta[MACID_NUM_SW_LIMIT]; -+}; -+ -+/* used for rf_ctl_t.rate_bmp_cck_ofdm */ -+#define RATE_BMP_CCK 0x000F -+#define RATE_BMP_OFDM 0xFFF0 -+#define RATE_BMP_HAS_CCK(_bmp_cck_ofdm) (_bmp_cck_ofdm & RATE_BMP_CCK) -+#define RATE_BMP_HAS_OFDM(_bmp_cck_ofdm) (_bmp_cck_ofdm & RATE_BMP_OFDM) -+#define RATE_BMP_GET_CCK(_bmp_cck_ofdm) (_bmp_cck_ofdm & RATE_BMP_CCK) -+#define RATE_BMP_GET_OFDM(_bmp_cck_ofdm) ((_bmp_cck_ofdm & RATE_BMP_OFDM) >> 4) -+ -+/* used for rf_ctl_t.rate_bmp_ht_by_bw */ -+#define RATE_BMP_HT_1SS 0x000000FF -+#define RATE_BMP_HT_2SS 0x0000FF00 -+#define RATE_BMP_HT_3SS 0x00FF0000 -+#define RATE_BMP_HT_4SS 0xFF000000 -+#define RATE_BMP_HAS_HT_1SS(_bmp_ht) (_bmp_ht & RATE_BMP_HT_1SS) -+#define RATE_BMP_HAS_HT_2SS(_bmp_ht) (_bmp_ht & RATE_BMP_HT_2SS) -+#define RATE_BMP_HAS_HT_3SS(_bmp_ht) (_bmp_ht & RATE_BMP_HT_3SS) -+#define RATE_BMP_HAS_HT_4SS(_bmp_ht) (_bmp_ht & RATE_BMP_HT_4SS) -+#define RATE_BMP_GET_HT_1SS(_bmp_ht) (_bmp_ht & RATE_BMP_HT_1SS) -+#define RATE_BMP_GET_HT_2SS(_bmp_ht) ((_bmp_ht & RATE_BMP_HT_2SS) >> 8) -+#define RATE_BMP_GET_HT_3SS(_bmp_ht) ((_bmp_ht & RATE_BMP_HT_3SS) >> 16) -+#define RATE_BMP_GET_HT_4SS(_bmp_ht) ((_bmp_ht & RATE_BMP_HT_4SS) >> 24) -+ -+/* used for rf_ctl_t.rate_bmp_vht_by_bw */ -+#define RATE_BMP_VHT_1SS 0x000003FF -+#define RATE_BMP_VHT_2SS 0x000FFC00 -+#define RATE_BMP_VHT_3SS 0x3FF00000 -+#define RATE_BMP_HAS_VHT_1SS(_bmp_vht) (_bmp_vht & RATE_BMP_VHT_1SS) -+#define RATE_BMP_HAS_VHT_2SS(_bmp_vht) (_bmp_vht & RATE_BMP_VHT_2SS) -+#define RATE_BMP_HAS_VHT_3SS(_bmp_vht) (_bmp_vht & RATE_BMP_VHT_3SS) -+#define RATE_BMP_GET_VHT_1SS(_bmp_vht) (_bmp_vht & RATE_BMP_VHT_1SS) -+#define RATE_BMP_GET_VHT_2SS(_bmp_vht) ((_bmp_vht & RATE_BMP_VHT_2SS) >> 10) -+#define RATE_BMP_GET_VHT_3SS(_bmp_vht) ((_bmp_vht & RATE_BMP_VHT_3SS) >> 20) -+ -+struct rf_ctl_t { -+ /* used for debug or by tx power limit */ -+ u16 rate_bmp_cck_ofdm; /* 20MHz */ -+ u32 rate_bmp_ht_by_bw[2]; /* 20MHz, 40MHz. 4SS supported */ -+ u32 rate_bmp_vht_by_bw[4]; /* 20MHz, 40MHz, 80MHz, 160MHz. up to 3SS supported */ -+ -+ /* used by tx power limit */ -+ u8 highest_ht_rate_bw_bmp; -+ u8 highest_vht_rate_bw_bmp; -+ -+#ifdef CONFIG_DFS_MASTER -+ bool radar_detect_by_others; -+ u8 dfs_master_enabled; -+ bool radar_detected; -+ -+ u8 radar_detect_ch; -+ u8 radar_detect_bw; -+ u8 radar_detect_offset; -+ -+ u32 cac_start_time; -+ u32 cac_end_time; -+ -+ u8 dfs_ch_sel_d_flags; -+ -+ u8 dbg_dfs_master_fake_radar_detect_cnt; -+ u8 dbg_dfs_master_radar_detect_trigger_non; -+ u8 dbg_dfs_master_choose_dfs_ch_first; -+#endif -+}; -+ -+#define RTW_CAC_STOPPED 0 -+#define IS_CAC_STOPPED(rfctl) ((rfctl)->cac_end_time == RTW_CAC_STOPPED) -+#define IS_CH_WAITING(rfctl) (!IS_CAC_STOPPED(rfctl) && time_after((unsigned long)(rfctl)->cac_end_time, (unsigned long)rtw_get_current_time())) -+#define IS_UNDER_CAC(rfctl) (IS_CH_WAITING(rfctl) && time_after((unsigned long)rtw_get_current_time(), (unsigned long)(rfctl)->cac_start_time)) -+ -+#ifdef CONFIG_MBSSID_CAM -+#define TOTAL_MBID_CAM_NUM 8 -+#define INVALID_CAM_ID 0xFF -+struct mbid_cam_ctl_t { -+ _lock lock; -+ u8 bitmap; -+ ATOMIC_T mbid_entry_num; -+}; -+struct mbid_cam_cache { -+ u8 iface_id; -+ /*u8 role;*/ /*WIFI_STATION_STATE or WIFI_AP_STATE*/ -+ u8 mac_addr[ETH_ALEN]; -+}; -+#endif /*CONFIG_MBSSID_CAM*/ -+ -+#ifdef RTW_HALMAC -+struct halmac_indicator { -+ struct submit_ctx *sctx; -+ u8 *buffer; -+ u32 buf_size; -+ u32 ret_size; -+ u32 status; -+}; -+ -+struct halmacpriv { -+ /* flags */ -+ /* -+ * send_general_info -+ * 0: no need to call halmac_send_general_info() -+ * 1: need to call halmac_send_general_info() -+ */ -+ u8 send_general_info; -+ -+ /* For asynchronous functions */ -+ struct halmac_indicator *indicator; -+ -+#ifdef CONFIG_SDIO_HCI -+ /* Store hardware tx queue page number setting */ -+ u16 txpage[HW_QUEUE_ENTRY]; -+#endif /* CONFIG_SDIO_HCI */ -+}; -+#endif /* RTW_HALMAC */ -+ -+struct dvobj_priv { -+ /*-------- below is common data --------*/ -+ u8 chip_type; -+ u8 HardwareType; -+ u8 interface_type;/*USB,SDIO,SPI,PCI*/ -+ -+ ATOMIC_T bSurpriseRemoved; -+ ATOMIC_T bDriverStopped; -+ -+ s32 processing_dev_remove; -+ -+ struct debug_priv drv_dbg; -+ -+ _mutex hw_init_mutex; -+ _mutex h2c_fwcmd_mutex; -+ -+#ifdef CONFIG_RTW_CUSTOMER_STR -+ _mutex customer_str_mutex; -+ struct submit_ctx *customer_str_sctx; -+ u8 customer_str[RTW_CUSTOMER_STR_LEN]; -+#endif -+ -+ _mutex setch_mutex; -+ _mutex setbw_mutex; -+ _mutex rf_read_reg_mutex; -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ _mutex sd_indirect_access_mutex; -+#endif -+ -+ unsigned char oper_channel; /* saved channel info when call set_channel_bw */ -+ unsigned char oper_bwmode; -+ unsigned char oper_ch_offset;/* PRIME_CHNL_OFFSET */ -+ u32 on_oper_ch_time; -+ -+ _adapter *padapters[CONFIG_IFACE_NUMBER];/*IFACE_ID_MAX*/ -+ u8 iface_nums; /* total number of ifaces used runtime */ -+ struct mi_state iface_state; -+ -+#ifdef CONFIG_AP_MODE -+ u8 nr_ap_if; /* total interface s number of ap/go mode. */ -+ u32 inter_bcn_space; /* unit:ms */ -+ _queue ap_if_q; -+#endif -+ -+ struct macid_ctl_t macid_ctl; -+ -+ struct cam_ctl_t cam_ctl; -+ struct sec_cam_ent cam_cache[SEC_CAM_ENT_NUM_SW_LIMIT]; -+ -+#ifdef CONFIG_MBSSID_CAM -+ struct mbid_cam_ctl_t mbid_cam_ctl; -+ struct mbid_cam_cache mbid_cam_cache[TOTAL_MBID_CAM_NUM]; -+#endif -+ -+ struct rf_ctl_t rf_ctl; -+ -+ /* For 92D, DMDP have 2 interface. */ -+ u8 InterfaceNumber; -+ u8 NumInterfaces; -+ -+ /* In /Out Pipe information */ -+ int RtInPipe[2]; -+ int RtOutPipe[4]; -+ u8 Queue2Pipe[HW_QUEUE_ENTRY];/* for out pipe mapping */ -+ -+ u8 irq_alloc; -+ ATOMIC_T continual_io_error; -+ -+ ATOMIC_T disable_func; -+ -+ struct pwrctrl_priv pwrctl_priv; -+ -+ struct rtw_traffic_statistics traffic_stat; -+ -+#ifdef PLATFORM_LINUX -+ _thread_hdl_ rtnl_lock_holder; -+ -+ #if defined(CONFIG_IOCTL_CFG80211) && defined(RTW_SINGLE_WIPHY) -+ struct wiphy *wiphy; -+ #endif -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+ _timer txbcn_timer; -+#endif -+ _timer dynamic_chk_timer; /* dynamic/periodic check timer */ -+ -+#ifdef RTW_HALMAC -+ void *halmac; -+ struct halmacpriv hmpriv; -+#endif /* RTW_HALMAC */ -+ -+ /*-------- below is for SDIO INTERFACE --------*/ -+ -+#ifdef INTF_DATA -+ INTF_DATA intf_data; -+#endif -+#ifdef INTF_OPS -+ INTF_OPS intf_ops; -+#endif -+ -+ /*-------- below is for USB INTERFACE --------*/ -+ -+#ifdef CONFIG_USB_HCI -+ -+ u8 usb_speed; /* 1.1, 2.0 or 3.0 */ -+ u8 nr_endpoint; -+ u8 RtNumInPipes; -+ u8 RtNumOutPipes; -+ int ep_num[6]; /* endpoint number */ -+ -+ int RegUsbSS; -+ -+ _sema usb_suspend_sema; -+ -+#ifdef CONFIG_USB_VENDOR_REQ_MUTEX -+ _mutex usb_vendor_req_mutex; -+#endif -+ -+#ifdef CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC -+ u8 *usb_alloc_vendor_req_buf; -+ u8 *usb_vendor_req_buf; -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ /* related device objects */ -+ PDEVICE_OBJECT pphysdevobj;/* pPhysDevObj; */ -+ PDEVICE_OBJECT pfuncdevobj;/* pFuncDevObj; */ -+ PDEVICE_OBJECT pnextdevobj;/* pNextDevObj; */ -+ -+ u8 nextdevstacksz;/* unsigned char NextDeviceStackSize; */ /* = (CHAR)CEdevice->pUsbDevObj->StackSize + 1; */ -+ -+ /* urb for control diescriptor request */ -+ -+#ifdef PLATFORM_OS_XP -+ struct _URB_CONTROL_DESCRIPTOR_REQUEST descriptor_urb; -+ PUSB_CONFIGURATION_DESCRIPTOR pconfig_descriptor;/* UsbConfigurationDescriptor; */ -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ WCHAR active_path[MAX_ACTIVE_REG_PATH]; /* adapter regpath */ -+ USB_EXTENSION usb_extension; -+ -+ _nic_hdl pipehdls_r8192c[0x10]; -+#endif -+ -+ u32 config_descriptor_len;/* ULONG UsbConfigurationDescriptorLength; */ -+#endif/* PLATFORM_WINDOWS */ -+ -+#ifdef PLATFORM_LINUX -+ struct usb_interface *pusbintf; -+ struct usb_device *pusbdev; -+#endif/* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ struct usb_interface *pusbintf; -+ struct usb_device *pusbdev; -+#endif/* PLATFORM_FREEBSD */ -+ -+#endif/* CONFIG_USB_HCI */ -+ -+ /*-------- below is for PCIE INTERFACE --------*/ -+ -+#ifdef CONFIG_PCI_HCI -+ -+#ifdef PLATFORM_LINUX -+ struct pci_dev *ppcidev; -+ -+ /* PCI MEM map */ -+ unsigned long pci_mem_end; /* shared mem end */ -+ unsigned long pci_mem_start; /* shared mem start */ -+ -+ /* PCI IO map */ -+ unsigned long pci_base_addr; /* device I/O address */ -+ -+#ifdef RTK_129X_PLATFORM -+ /* PCI MASK addr */ -+ unsigned long mask_addr; -+ -+ /* PCI TRANSLATE addr */ -+ unsigned long tran_addr; -+ -+ _lock io_reg_lock; -+#endif -+ -+ /* PciBridge */ -+ struct pci_priv pcipriv; -+ -+ unsigned int irq; /* get from pci_dev.irq, store to net_device.irq */ -+ u16 irqline; -+ u8 irq_enabled; -+ RT_ISR_CONTENT isr_content; -+ _lock irq_th_lock; -+ -+ /* ASPM */ -+ u8 const_pci_aspm; -+ u8 const_amdpci_aspm; -+ u8 const_hwsw_rfoff_d3; -+ u8 const_support_pciaspm; -+ /* pci-e bridge */ -+ u8 const_hostpci_aspm_setting; -+ /* pci-e device */ -+ u8 const_devicepci_aspm_setting; -+ u8 b_support_aspm; /* If it supports ASPM, Offset[560h] = 0x40, otherwise Offset[560h] = 0x00. */ -+ u8 b_support_backdoor; -+ u8 bdma64; -+#endif/* PLATFORM_LINUX */ -+ -+#endif/* CONFIG_PCI_HCI */ -+ -+#ifdef CONFIG_MCC_MODE -+ struct mcc_obj_priv mcc_objpriv; -+#endif /*CONFIG_MCC_MODE */ -+}; -+ -+#define DEV_STA_NUM(_dvobj) MSTATE_STA_NUM(&((_dvobj)->iface_state)) -+#define DEV_STA_LD_NUM(_dvobj) MSTATE_STA_LD_NUM(&((_dvobj)->iface_state)) -+#define DEV_STA_LG_NUM(_dvobj) MSTATE_STA_LG_NUM(&((_dvobj)->iface_state)) -+#define DEV_AP_NUM(_dvobj) MSTATE_AP_NUM(&((_dvobj)->iface_state)) -+#define DEV_AP_LD_NUM(_dvobj) MSTATE_AP_LD_NUM(&((_dvobj)->iface_state)) -+#define DEV_ADHOC_NUM(_dvobj) MSTATE_ADHOC_NUM(&((_dvobj)->iface_state)) -+#define DEV_ADHOC_LD_NUM(_dvobj) MSTATE_ADHOC_LD_NUM(&((_dvobj)->iface_state)) -+#define DEV_WPS_NUM(_dvobj) MSTATE_WPS_NUM(&((_dvobj)->iface_state)) -+#define DEV_ROCH_NUM(_dvobj) MSTATE_ROCH_NUM(&((_dvobj)->iface_state)) -+#define DEV_MGMT_TX_NUM(_dvobj) MSTATE_MGMT_TX_NUM(&((_dvobj)->iface_state)) -+#define DEV_U_CH(_dvobj) MSTATE_U_CH(&((_dvobj)->iface_state)) -+#define DEV_U_BW(_dvobj) MSTATE_U_BW(&((_dvobj)->iface_state)) -+#define DEV_U_OFFSET(_dvobj) MSTATE_U_OFFSET(&((_dvobj)->iface_state)) -+ -+#define dvobj_to_pwrctl(dvobj) (&(dvobj->pwrctl_priv)) -+#define pwrctl_to_dvobj(pwrctl) container_of(pwrctl, struct dvobj_priv, pwrctl_priv) -+#define dvobj_to_macidctl(dvobj) (&(dvobj->macid_ctl)) -+#define dvobj_to_sec_camctl(dvobj) (&(dvobj->cam_ctl)) -+#define dvobj_to_regsty(dvobj) (&(dvobj->padapters[IFACE_ID0]->registrypriv)) -+#if defined(CONFIG_IOCTL_CFG80211) && defined(RTW_SINGLE_WIPHY) -+#define dvobj_to_wiphy(dvobj) ((dvobj)->wiphy) -+#endif -+#define dvobj_to_rfctl(dvobj) (&(dvobj->rf_ctl)) -+#define rfctl_to_dvobj(rfctl) container_of((rfctl), struct dvobj_priv, rf_ctl) -+ -+static inline void dev_set_surprise_removed(struct dvobj_priv *dvobj) -+{ -+ ATOMIC_SET(&dvobj->bSurpriseRemoved, _TRUE); -+} -+static inline void dev_clr_surprise_removed(struct dvobj_priv *dvobj) -+{ -+ ATOMIC_SET(&dvobj->bSurpriseRemoved, _FALSE); -+} -+static inline void dev_set_drv_stopped(struct dvobj_priv *dvobj) -+{ -+ ATOMIC_SET(&dvobj->bDriverStopped, _TRUE); -+} -+static inline void dev_clr_drv_stopped(struct dvobj_priv *dvobj) -+{ -+ ATOMIC_SET(&dvobj->bDriverStopped, _FALSE); -+} -+#define dev_is_surprise_removed(dvobj) (ATOMIC_READ(&dvobj->bSurpriseRemoved) == _TRUE) -+#define dev_is_drv_stopped(dvobj) (ATOMIC_READ(&dvobj->bDriverStopped) == _TRUE) -+ -+#ifdef PLATFORM_LINUX -+static struct device *dvobj_to_dev(struct dvobj_priv *dvobj) -+{ -+ /* todo: get interface type from dvobj and the return the dev accordingly */ -+#ifdef RTW_DVOBJ_CHIP_HW_TYPE -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ return &dvobj->pusbintf->dev; -+#endif -+#ifdef CONFIG_SDIO_HCI -+ return &dvobj->intf_data.func->dev; -+#endif -+#ifdef CONFIG_GSPI_HCI -+ return &dvobj->intf_data.func->dev; -+#endif -+#ifdef CONFIG_PCI_HCI -+ return &dvobj->ppcidev->dev; -+#endif -+} -+#endif -+ -+_adapter *dvobj_get_port0_adapter(struct dvobj_priv *dvobj); -+_adapter *dvobj_get_unregisterd_adapter(struct dvobj_priv *dvobj); -+_adapter *dvobj_get_adapter_by_addr(struct dvobj_priv *dvobj, u8 *addr); -+#define dvobj_get_primary_adapter(dvobj) ((dvobj)->padapters[IFACE_ID0]) -+ -+enum _hw_port { -+ HW_PORT0, -+ HW_PORT1, -+ HW_PORT2, -+ HW_PORT3, -+ HW_PORT4, -+ MAX_HW_PORT, -+}; -+ -+enum _ADAPTER_TYPE { -+ PRIMARY_ADAPTER, -+ VIRTUAL_ADAPTER, -+ MAX_ADAPTER = 0xFF, -+}; -+ -+typedef enum _DRIVER_STATE { -+ DRIVER_NORMAL = 0, -+ DRIVER_DISAPPEAR = 1, -+ DRIVER_REPLACE_DONGLE = 2, -+} DRIVER_STATE; -+ -+#ifdef CONFIG_RTW_NAPI -+enum _NAPI_STATE { -+ NAPI_DISABLE = 0, -+ NAPI_ENABLE = 1, -+}; -+#endif -+ -+#ifdef CONFIG_INTEL_PROXIM -+struct proxim { -+ bool proxim_support; -+ bool proxim_on; -+ -+ void *proximity_priv; -+ int (*proxim_rx)(_adapter *padapter, -+ union recv_frame *precv_frame); -+ u8(*proxim_get_var)(_adapter *padapter, u8 type); -+}; -+#endif /* CONFIG_INTEL_PROXIM */ -+ -+#ifdef CONFIG_MAC_LOOPBACK_DRIVER -+typedef struct loopbackdata { -+ _sema sema; -+ _thread_hdl_ lbkthread; -+ u8 bstop; -+ u32 cnt; -+ u16 size; -+ u16 txsize; -+ u8 txbuf[0x8000]; -+ u16 rxsize; -+ u8 rxbuf[0x8000]; -+ u8 msg[100]; -+ -+} LOOPBACKDATA, *PLOOPBACKDATA; -+#endif -+ -+#ifdef CONFIG_80211N_HT -+#define ADAPTER_TX_BW_2G(adapter) BW_MODE_2G((adapter)->driver_tx_bw_mode) -+#define ADAPTER_TX_BW_5G(adapter) BW_MODE_5G((adapter)->driver_tx_bw_mode) -+#else -+#define ADAPTER_TX_BW_2G(adapter) 0x0 -+#define ADAPTER_TX_BW_5G(adapter) 0x0 -+#endif /* CONFIG_80211N_HT */ -+ -+struct _ADAPTER { -+ int DriverState;/* for disable driver using module, use dongle to replace module. */ -+ int pid[3];/* process id from UI, 0:wps, 1:hostapd, 2:dhcpcd */ -+ int bDongle;/* build-in module or external dongle */ -+ -+ _list list; -+ -+ struct dvobj_priv *dvobj; -+ struct mlme_priv mlmepriv; -+ struct mlme_ext_priv mlmeextpriv; -+ struct cmd_priv cmdpriv; -+ struct evt_priv evtpriv; -+ /* struct io_queue *pio_queue; */ -+ struct io_priv iopriv; -+ struct xmit_priv xmitpriv; -+ struct recv_priv recvpriv; -+ struct sta_priv stapriv; -+ struct security_priv securitypriv; -+ _lock security_key_mutex; /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ struct registry_priv registrypriv; -+ -+ struct led_priv ledpriv; -+ -+#ifdef CONFIG_RTW_NAPI -+ struct napi_struct napi; -+ u8 napi_state; -+#endif -+ -+#ifdef CONFIG_MP_INCLUDED -+ struct mp_priv mppriv; -+#endif -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ struct drvext_priv drvextpriv; -+#endif -+ -+#ifdef CONFIG_AP_MODE -+ struct hostapd_priv *phostapdpriv; -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+#ifdef CONFIG_P2P -+ struct cfg80211_wifidirect_info cfg80211_wdinfo; -+#endif /* CONFIG_P2P */ -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ u32 setband; -+ ATOMIC_T bandskip; -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info wdinfo; -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_TDLS -+ struct tdls_info tdlsinfo; -+#endif /* CONFIG_TDLS */ -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ u8 WapiSupport; -+ RT_WAPI_T wapiInfo; -+#endif -+ -+ -+#ifdef CONFIG_WFD -+ struct wifi_display_info wfd_info; -+#endif /* CONFIG_WFD */ -+ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ struct bt_coex_info coex_info; -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ -+ ERROR_CODE LastError; /* <20130613, Kordan> Only the functions associated with MP records the error code by now. */ -+ -+ PVOID HalData; -+ u32 hal_data_sz; -+ struct hal_ops HalFunc; -+ -+ u32 IsrContent; -+ u32 ImrContent; -+ -+ u8 EepromAddressSize; -+ u8 bDriverIsGoingToUnload; -+ u8 init_adpt_in_progress; -+ u8 bHaltInProgress; -+#ifdef CONFIG_GPIO_API -+ u8 pre_gpio_pin; -+ struct gpio_int_priv { -+ u8 interrupt_mode; -+ u8 interrupt_enable_mask; -+ void (*callback[8])(u8 level); -+ } gpiointpriv; -+#endif -+ _thread_hdl_ cmdThread; -+ _thread_hdl_ evtThread; -+ _thread_hdl_ xmitThread; -+ _thread_hdl_ recvThread; -+ -+ u8 registered; -+#ifndef PLATFORM_LINUX -+ NDIS_STATUS(*dvobj_init)(struct dvobj_priv *dvobj); -+ void (*dvobj_deinit)(struct dvobj_priv *dvobj); -+#endif -+ -+ u32(*intf_init)(struct dvobj_priv *dvobj); -+ void (*intf_deinit)(struct dvobj_priv *dvobj); -+ int (*intf_alloc_irq)(struct dvobj_priv *dvobj); -+ void (*intf_free_irq)(struct dvobj_priv *dvobj); -+ -+ -+ void (*intf_start)(_adapter *adapter); -+ void (*intf_stop)(_adapter *adapter); -+ -+#ifdef PLATFORM_WINDOWS -+ _nic_hdl hndis_adapter;/* hNdisAdapter(NDISMiniportAdapterHandle); */ -+ _nic_hdl hndis_config;/* hNdisConfiguration; */ -+ NDIS_STRING fw_img; -+ -+ u32 NdisPacketFilter; -+ u8 MCList[MAX_MCAST_LIST_NUM][6]; -+ u32 MCAddrCount; -+#endif /* end of PLATFORM_WINDOWS */ -+ -+ -+#ifdef PLATFORM_LINUX -+ _nic_hdl pnetdev; -+ char old_ifname[IFNAMSIZ]; -+ -+ /* used by rtw_rereg_nd_name related function */ -+ struct rereg_nd_name_data { -+ _nic_hdl old_pnetdev; -+ char old_ifname[IFNAMSIZ]; -+ u8 old_ips_mode; -+ u8 old_bRegUseLed; -+ } rereg_nd_name_priv; -+ -+ u8 ndev_unregistering; -+ int bup; -+ struct net_device_stats stats; -+ struct iw_statistics iwstats; -+ struct proc_dir_entry *dir_dev;/* for proc directory */ -+ struct proc_dir_entry *dir_odm; -+ -+#ifdef CONFIG_MCC_MODE -+ struct proc_dir_entry *dir_mcc; -+#endif /* CONFIG_MCC_MODE */ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct wireless_dev *rtw_wdev; -+ struct rtw_wdev_priv wdev_data; -+ -+#if !defined(RTW_SINGLE_WIPHY) -+ struct wiphy *wiphy; -+#endif -+ -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ _nic_hdl pifp; -+ int bup; -+ _lock glock; -+#endif /* PLATFORM_FREEBSD */ -+ u8 mac_addr[ETH_ALEN]; -+ int net_closed; -+ -+ u8 netif_up; -+ -+ u8 bFWReady; -+ u8 bBTFWReady; -+ u8 bLinkInfoDump; -+ u8 bRxRSSIDisplay; -+ /* Added by Albert 2012/10/26 */ -+ /* The driver will show up the desired channel number when this flag is 1. */ -+ u8 bNotifyChannelChange; -+#ifdef CONFIG_P2P -+ /* Added by Albert 2012/12/06 */ -+ /* The driver will show the current P2P status when the upper application reads it. */ -+ u8 bShowGetP2PState; -+#endif -+#ifdef CONFIG_AUTOSUSPEND -+ u8 bDisableAutosuspend; -+#endif -+ -+ u8 isprimary; /* is primary adapter or not */ -+ /* notes: -+ ** if isprimary is true, the adapter_type value is 0, iface_id is IFACE_ID0 for PRIMARY_ADAPTER -+ ** if isprimary is false, the adapter_type value is 1, iface_id is IFACE_ID1 for VIRTUAL_ADAPTER -+ ** refer to iface_id if iface_nums>2 and isprimary is false and the adapter_type value is 0xff.*/ -+ u8 adapter_type;/*be used in Multi-interface to recognize whether is PRIMARY_ADAPTER or not(PRIMARY_ADAPTER/VIRTUAL_ADAPTER) .*/ -+ u8 hw_port; /*interface port type, it depends on HW port */ -+ -+ -+ /*extend to support multi interface*/ -+ /*IFACE_ID0 is equals to PRIMARY_ADAPTER -+ IFACE_ID1 is equals to VIRTUAL_ADAPTER*/ -+ u8 iface_id; -+ -+#ifdef CONFIG_BR_EXT -+ _lock br_ext_lock; -+ /* unsigned int macclone_completed; */ -+ struct nat25_network_db_entry *nethash[NAT25_HASH_SIZE]; -+ int pppoe_connection_in_progress; -+ unsigned char pppoe_addr[MACADDRLEN]; -+ unsigned char scdb_mac[MACADDRLEN]; -+ unsigned char scdb_ip[4]; -+ struct nat25_network_db_entry *scdb_entry; -+ unsigned char br_mac[MACADDRLEN]; -+ unsigned char br_ip[4]; -+ -+ struct br_ext_info ethBrExtInfo; -+#endif /* CONFIG_BR_EXT */ -+ -+#ifdef CONFIG_INTEL_PROXIM -+ /* intel Proximity, should be alloc mem -+ * in intel Proximity module and can only -+ * be used in intel Proximity mode */ -+ struct proxim proximity; -+#endif /* CONFIG_INTEL_PROXIM */ -+ -+#ifdef CONFIG_MAC_LOOPBACK_DRIVER -+ PLOOPBACKDATA ploopback; -+#endif -+ -+ /* for debug purpose */ -+ u8 fix_rate; -+ u8 fix_bw; -+ u8 data_fb; /* data rate fallback, valid only when fix_rate is not 0xff */ -+ -+ u8 driver_tx_bw_mode; -+ -+ u8 driver_vcs_en; /* Enable=1, Disable=0 driver control vrtl_carrier_sense for tx */ -+ u8 driver_vcs_type;/* force 0:disable VCS, 1:RTS-CTS, 2:CTS-to-self when vcs_en=1. */ -+ u8 driver_ampdu_spacing;/* driver control AMPDU Density for peer sta's rx */ -+ u8 driver_rx_ampdu_factor;/* 0xff: disable drv ctrl, 0:8k, 1:16k, 2:32k, 3:64k; */ -+ u8 driver_rx_ampdu_spacing; /* driver control Rx AMPDU Density */ -+ u8 fix_rx_ampdu_accept; -+ u8 fix_rx_ampdu_size; /* 0~127, TODO:consider each sta and each TID */ -+ unsigned char in_cta_test; -+#ifdef DBG_RX_COUNTER_DUMP -+ u8 dump_rx_cnt_mode;/*BIT0:drv,BIT1:mac,BIT2:phy*/ -+ u32 drv_rx_cnt_ok; -+ u32 drv_rx_cnt_crcerror; -+ u32 drv_rx_cnt_drop; -+#endif -+ -+#ifdef CONFIG_DBG_COUNTER -+ struct rx_logs rx_logs; -+ struct tx_logs tx_logs; -+ struct int_logs int_logs; -+#endif -+ -+#ifdef CONFIG_MCC_MODE -+ struct mcc_adapter_priv mcc_adapterpriv; -+#endif /* CONFIG_MCC_MODE */ -+}; -+ -+#define adapter_to_dvobj(adapter) ((adapter)->dvobj) -+#define adapter_to_regsty(adapter) dvobj_to_regsty(adapter_to_dvobj((adapter))) -+#define adapter_to_pwrctl(adapter) dvobj_to_pwrctl(adapter_to_dvobj((adapter))) -+#define adapter_wdev_data(adapter) (&((adapter)->wdev_data)) -+#if defined(RTW_SINGLE_WIPHY) -+#define adapter_to_wiphy(adapter) dvobj_to_wiphy(adapter_to_dvobj(adapter)) -+#else -+#define adapter_to_wiphy(adapter) ((adapter)->wiphy) -+#endif -+ -+#define adapter_to_rfctl(adapter) dvobj_to_rfctl(adapter_to_dvobj((adapter))) -+ -+#define adapter_mac_addr(adapter) (adapter->mac_addr) -+ -+#define mlme_to_adapter(mlme) container_of((mlme), struct _ADAPTER, mlmepriv) -+#define tdls_info_to_adapter(tdls) container_of((tdls), struct _ADAPTER, tdlsinfo) -+ -+#define rtw_get_chip_type(adapter) (((PADAPTER)adapter)->dvobj->chip_type) -+#define rtw_get_hw_type(adapter) (((PADAPTER)adapter)->dvobj->HardwareType) -+#define rtw_get_intf_type(adapter) (((PADAPTER)adapter)->dvobj->interface_type) -+ -+#define rtw_get_mi_nums(adapter) (((PADAPTER)adapter)->dvobj->iface_nums) -+ -+static inline void rtw_set_surprise_removed(_adapter *padapter) -+{ -+ dev_set_surprise_removed(adapter_to_dvobj(padapter)); -+} -+static inline void rtw_clr_surprise_removed(_adapter *padapter) -+{ -+ dev_clr_surprise_removed(adapter_to_dvobj(padapter)); -+} -+static inline void rtw_set_drv_stopped(_adapter *padapter) -+{ -+ dev_set_drv_stopped(adapter_to_dvobj(padapter)); -+} -+static inline void rtw_clr_drv_stopped(_adapter *padapter) -+{ -+ dev_clr_drv_stopped(adapter_to_dvobj(padapter)); -+} -+#define rtw_is_surprise_removed(padapter) (dev_is_surprise_removed(adapter_to_dvobj(padapter))) -+#define rtw_is_drv_stopped(padapter) (dev_is_drv_stopped(adapter_to_dvobj(padapter))) -+ -+/* -+ * Function disabled. -+ * */ -+#define DF_TX_BIT BIT0 /*write_port_cancel*/ -+#define DF_RX_BIT BIT1 /*read_port_cancel*/ -+#define DF_IO_BIT BIT2 -+ -+/* #define RTW_DISABLE_FUNC(padapter, func) (ATOMIC_ADD(&adapter_to_dvobj(padapter)->disable_func, (func))) */ -+/* #define RTW_ENABLE_FUNC(padapter, func) (ATOMIC_SUB(&adapter_to_dvobj(padapter)->disable_func, (func))) */ -+__inline static void RTW_DISABLE_FUNC(_adapter *padapter, int func_bit) -+{ -+ int df = ATOMIC_READ(&adapter_to_dvobj(padapter)->disable_func); -+ df |= func_bit; -+ ATOMIC_SET(&adapter_to_dvobj(padapter)->disable_func, df); -+} -+ -+__inline static void RTW_ENABLE_FUNC(_adapter *padapter, int func_bit) -+{ -+ int df = ATOMIC_READ(&adapter_to_dvobj(padapter)->disable_func); -+ df &= ~(func_bit); -+ ATOMIC_SET(&adapter_to_dvobj(padapter)->disable_func, df); -+} -+ -+#define RTW_CANNOT_RUN(padapter) \ -+ (rtw_is_surprise_removed(padapter) || \ -+ rtw_is_drv_stopped(padapter)) -+ -+#define RTW_IS_FUNC_DISABLED(padapter, func_bit) (ATOMIC_READ(&adapter_to_dvobj(padapter)->disable_func) & (func_bit)) -+ -+#define RTW_CANNOT_IO(padapter) \ -+ (rtw_is_surprise_removed(padapter) || \ -+ RTW_IS_FUNC_DISABLED((padapter), DF_IO_BIT)) -+ -+#define RTW_CANNOT_RX(padapter) \ -+ (RTW_CANNOT_RUN(padapter) || \ -+ RTW_IS_FUNC_DISABLED((padapter), DF_RX_BIT)) -+ -+#define RTW_CANNOT_TX(padapter) \ -+ (RTW_CANNOT_RUN(padapter) || \ -+ RTW_IS_FUNC_DISABLED((padapter), DF_TX_BIT)) -+ -+#ifdef CONFIG_PNO_SUPPORT -+int rtw_parse_ssid_list_tlv(char **list_str, pno_ssid_t *ssid, int max, int *bytes_left); -+int rtw_dev_pno_set(struct net_device *net, pno_ssid_t *ssid, int num, -+ int pno_time, int pno_repeat, int pno_freq_expo_max); -+#ifdef CONFIG_PNO_SET_DEBUG -+ void rtw_dev_pno_debug(struct net_device *net); -+#endif /* CONFIG_PNO_SET_DEBUG */ -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+int rtw_suspend_free_assoc_resource(_adapter *padapter); -+#ifdef CONFIG_WOWLAN -+ int rtw_suspend_wow(_adapter *padapter); -+ int rtw_resume_process_wow(_adapter *padapter); -+#endif -+ -+/* HCI Related header file */ -+#ifdef CONFIG_USB_HCI -+ #include -+ #include -+ #include -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+ #include -+ #include -+ #include -+#endif -+ -+#ifdef CONFIG_GSPI_HCI -+ #include -+ #include -+ #include -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ #include -+ #include -+ #include -+#endif -+ -+#endif /* __DRV_TYPES_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types_linux.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_linux.h ---- linux-4.14.18/3rdparty/rtl8723de/include/drv_types_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_linux.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __DRV_TYPES_LINUX_H__ -+#define __DRV_TYPES_LINUX_H__ -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types_pci.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_pci.h ---- linux-4.14.18/3rdparty/rtl8723de/include/drv_types_pci.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_pci.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,271 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __DRV_TYPES_PCI_H__ -+#define __DRV_TYPES_PCI_H__ -+ -+ -+#ifdef PLATFORM_LINUX -+ #include -+#endif -+ -+ -+#define INTEL_VENDOR_ID 0x8086 -+#define SIS_VENDOR_ID 0x1039 -+#define ATI_VENDOR_ID 0x1002 -+#define ATI_DEVICE_ID 0x7914 -+#define AMD_VENDOR_ID 0x1022 -+ -+#define PCI_MAX_BRIDGE_NUMBER 255 -+#define PCI_MAX_DEVICES 32 -+#define PCI_MAX_FUNCTION 8 -+ -+#define PCI_CONF_ADDRESS 0x0CF8 /* PCI Configuration Space Address */ -+#define PCI_CONF_DATA 0x0CFC /* PCI Configuration Space Data */ -+ -+#define PCI_CLASS_BRIDGE_DEV 0x06 -+#define PCI_SUBCLASS_BR_PCI_TO_PCI 0x04 -+ -+#define PCI_CAPABILITY_ID_PCI_EXPRESS 0x10 -+ -+#define U1DONTCARE 0xFF -+#define U2DONTCARE 0xFFFF -+#define U4DONTCARE 0xFFFFFFFF -+ -+#define PCI_VENDER_ID_REALTEK 0x10ec -+ -+#define HAL_HW_PCI_8180_DEVICE_ID 0x8180 -+#define HAL_HW_PCI_8185_DEVICE_ID 0x8185 /* 8185 or 8185b */ -+#define HAL_HW_PCI_8188_DEVICE_ID 0x8188 /* 8185b */ -+#define HAL_HW_PCI_8198_DEVICE_ID 0x8198 /* 8185b */ -+#define HAL_HW_PCI_8190_DEVICE_ID 0x8190 /* 8190 */ -+#define HAL_HW_PCI_8723E_DEVICE_ID 0x8723 /* 8723E */ -+#define HAL_HW_PCI_8192_DEVICE_ID 0x8192 /* 8192 PCI-E */ -+#define HAL_HW_PCI_8192SE_DEVICE_ID 0x8192 /* 8192 SE */ -+#define HAL_HW_PCI_8174_DEVICE_ID 0x8174 /* 8192 SE */ -+#define HAL_HW_PCI_8173_DEVICE_ID 0x8173 /* 8191 SE Crab */ -+#define HAL_HW_PCI_8172_DEVICE_ID 0x8172 /* 8191 SE RE */ -+#define HAL_HW_PCI_8171_DEVICE_ID 0x8171 /* 8191 SE Unicron */ -+#define HAL_HW_PCI_0045_DEVICE_ID 0x0045 /* 8190 PCI for Ceraga */ -+#define HAL_HW_PCI_0046_DEVICE_ID 0x0046 /* 8190 Cardbus for Ceraga */ -+#define HAL_HW_PCI_0044_DEVICE_ID 0x0044 /* 8192e PCIE for Ceraga */ -+#define HAL_HW_PCI_0047_DEVICE_ID 0x0047 /* 8192e Express Card for Ceraga */ -+#define HAL_HW_PCI_700F_DEVICE_ID 0x700F -+#define HAL_HW_PCI_701F_DEVICE_ID 0x701F -+#define HAL_HW_PCI_DLINK_DEVICE_ID 0x3304 -+#define HAL_HW_PCI_8188EE_DEVICE_ID 0x8179 -+ -+#define HAL_MEMORY_MAPPED_IO_RANGE_8190PCI 0x1000 /* 8190 support 16 pages of IO registers */ -+#define HAL_HW_PCI_REVISION_ID_8190PCI 0x00 -+#define HAL_MEMORY_MAPPED_IO_RANGE_8192PCIE 0x4000 /* 8192 support 16 pages of IO registers */ -+#define HAL_HW_PCI_REVISION_ID_8192PCIE 0x01 -+#define HAL_MEMORY_MAPPED_IO_RANGE_8192SE 0x4000 /* 8192 support 16 pages of IO registers */ -+#define HAL_HW_PCI_REVISION_ID_8192SE 0x10 -+#define HAL_HW_PCI_REVISION_ID_8192CE 0x1 -+#define HAL_MEMORY_MAPPED_IO_RANGE_8192CE 0x4000 /* 8192 support 16 pages of IO registers */ -+#define HAL_HW_PCI_REVISION_ID_8192DE 0x0 -+#define HAL_MEMORY_MAPPED_IO_RANGE_8192DE 0x4000 /* 8192 support 16 pages of IO registers */ -+ -+enum pci_bridge_vendor { -+ PCI_BRIDGE_VENDOR_INTEL = 0x0,/* 0b'0000,0001 */ -+ PCI_BRIDGE_VENDOR_ATI, /* = 0x02, */ /* 0b'0000,0010 */ -+ PCI_BRIDGE_VENDOR_AMD, /* = 0x04, */ /* 0b'0000,0100 */ -+ PCI_BRIDGE_VENDOR_SIS ,/* = 0x08, */ /* 0b'0000,1000 */ -+ PCI_BRIDGE_VENDOR_UNKNOWN, /* = 0x40, */ /* 0b'0100,0000 */ -+ PCI_BRIDGE_VENDOR_MAX ,/* = 0x80 */ -+} ; -+ -+/* copy this data structor defination from MSDN SDK */ -+typedef struct _PCI_COMMON_CONFIG { -+ u16 VendorID; -+ u16 DeviceID; -+ u16 Command; -+ u16 Status; -+ u8 RevisionID; -+ u8 ProgIf; -+ u8 SubClass; -+ u8 BaseClass; -+ u8 CacheLineSize; -+ u8 LatencyTimer; -+ u8 HeaderType; -+ u8 BIST; -+ -+ union { -+ struct _PCI_HEADER_TYPE_0 { -+ u32 BaseAddresses[6]; -+ u32 CIS; -+ u16 SubVendorID; -+ u16 SubSystemID; -+ u32 ROMBaseAddress; -+ u8 CapabilitiesPtr; -+ u8 Reserved1[3]; -+ u32 Reserved2; -+ -+ u8 InterruptLine; -+ u8 InterruptPin; -+ u8 MinimumGrant; -+ u8 MaximumLatency; -+ } type0; -+#if 0 -+ struct _PCI_HEADER_TYPE_1 { -+ ULONG BaseAddresses[PCI_TYPE1_ADDRESSES]; -+ UCHAR PrimaryBusNumber; -+ UCHAR SecondaryBusNumber; -+ UCHAR SubordinateBusNumber; -+ UCHAR SecondaryLatencyTimer; -+ UCHAR IOBase; -+ UCHAR IOLimit; -+ USHORT SecondaryStatus; -+ USHORT MemoryBase; -+ USHORT MemoryLimit; -+ USHORT PrefetchableMemoryBase; -+ USHORT PrefetchableMemoryLimit; -+ ULONG PrefetchableMemoryBaseUpper32; -+ ULONG PrefetchableMemoryLimitUpper32; -+ USHORT IOBaseUpper; -+ USHORT IOLimitUpper; -+ ULONG Reserved2; -+ ULONG ExpansionROMBase; -+ UCHAR InterruptLine; -+ UCHAR InterruptPin; -+ USHORT BridgeControl; -+ } type1; -+ -+ struct _PCI_HEADER_TYPE_2 { -+ ULONG BaseAddress; -+ UCHAR CapabilitiesPtr; -+ UCHAR Reserved2; -+ USHORT SecondaryStatus; -+ UCHAR PrimaryBusNumber; -+ UCHAR CardbusBusNumber; -+ UCHAR SubordinateBusNumber; -+ UCHAR CardbusLatencyTimer; -+ ULONG MemoryBase0; -+ ULONG MemoryLimit0; -+ ULONG MemoryBase1; -+ ULONG MemoryLimit1; -+ USHORT IOBase0_LO; -+ USHORT IOBase0_HI; -+ USHORT IOLimit0_LO; -+ USHORT IOLimit0_HI; -+ USHORT IOBase1_LO; -+ USHORT IOBase1_HI; -+ USHORT IOLimit1_LO; -+ USHORT IOLimit1_HI; -+ UCHAR InterruptLine; -+ UCHAR InterruptPin; -+ USHORT BridgeControl; -+ USHORT SubVendorID; -+ USHORT SubSystemID; -+ ULONG LegacyBaseAddress; -+ UCHAR Reserved3[56]; -+ ULONG SystemControl; -+ UCHAR MultiMediaControl; -+ UCHAR GeneralStatus; -+ UCHAR Reserved4[2]; -+ UCHAR GPIO0Control; -+ UCHAR GPIO1Control; -+ UCHAR GPIO2Control; -+ UCHAR GPIO3Control; -+ ULONG IRQMuxRouting; -+ UCHAR RetryStatus; -+ UCHAR CardControl; -+ UCHAR DeviceControl; -+ UCHAR Diagnostic; -+ } type2; -+#endif -+ } u; -+ -+ u8 DeviceSpecific[108]; -+} PCI_COMMON_CONFIG , *PPCI_COMMON_CONFIG; -+ -+typedef struct _RT_PCI_CAPABILITIES_HEADER { -+ u8 CapabilityID; -+ u8 Next; -+} RT_PCI_CAPABILITIES_HEADER, *PRT_PCI_CAPABILITIES_HEADER; -+ -+struct pci_priv { -+ BOOLEAN pci_clk_req; -+ -+ u8 pciehdr_offset; -+ /* PCIeCap is only differece between B-cut and C-cut. */ -+ /* Configuration Space offset 72[7:4] */ -+ /* 0: A/B cut */ -+ /* 1: C cut and later. */ -+ u8 pcie_cap; -+ u8 linkctrl_reg; -+ -+ u8 busnumber; -+ u8 devnumber; -+ u8 funcnumber; -+ -+ u8 pcibridge_busnum; -+ u8 pcibridge_devnum; -+ u8 pcibridge_funcnum; -+ u8 pcibridge_vendor; -+ u16 pcibridge_vendorid; -+ u16 pcibridge_deviceid; -+ u8 pcibridge_pciehdr_offset; -+ u8 pcibridge_linkctrlreg; -+ -+ u8 amd_l1_patch; -+}; -+ -+typedef struct _RT_ISR_CONTENT { -+ union { -+ u32 IntArray[2]; -+ u32 IntReg4Byte; -+ u16 IntReg2Byte; -+ }; -+} RT_ISR_CONTENT, *PRT_ISR_CONTENT; -+ -+/* #define RegAddr(addr) (addr + 0xB2000000UL) */ -+/* some platform macros will def here */ -+static inline void NdisRawWritePortUlong(u32 port, u32 val) -+{ -+ outl(val, port); -+ /* writel(val, (u8 *)RegAddr(port)); */ -+} -+ -+static inline void NdisRawWritePortUchar(u32 port, u8 val) -+{ -+ outb(val, port); -+ /* writeb(val, (u8 *)RegAddr(port)); */ -+} -+ -+static inline void NdisRawReadPortUchar(u32 port, u8 *pval) -+{ -+ *pval = inb(port); -+ /* *pval = readb((u8 *)RegAddr(port)); */ -+} -+ -+static inline void NdisRawReadPortUshort(u32 port, u16 *pval) -+{ -+ *pval = inw(port); -+ /* *pval = readw((u8 *)RegAddr(port)); */ -+} -+ -+static inline void NdisRawReadPortUlong(u32 port, u32 *pval) -+{ -+ *pval = inl(port); -+ /* *pval = readl((u8 *)RegAddr(port)); */ -+} -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types_sdio.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_sdio.h ---- linux-4.14.18/3rdparty/rtl8723de/include/drv_types_sdio.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_sdio.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,91 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __DRV_TYPES_SDIO_H__ -+#define __DRV_TYPES_SDIO_H__ -+ -+/* SDIO Header Files */ -+#ifdef PLATFORM_LINUX -+ #include -+ #include -+ #include -+ #include -+ -+ #ifdef CONFIG_PLATFORM_SPRD -+ #include -+ #include -+ #endif /* CONFIG_PLATFORM_SPRD */ -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ #include -+ #include -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ #include -+#endif -+ -+ -+typedef struct sdio_data { -+ u8 func_number; -+ -+ u8 tx_block_mode; -+ u8 rx_block_mode; -+ u32 block_transfer_len; -+ -+#ifdef PLATFORM_LINUX -+ struct sdio_func *func; -+ _thread_hdl_ sys_sdio_irq_thd; -+ unsigned int clock; -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ PDEVICE_OBJECT pphysdevobj; -+ PDEVICE_OBJECT pfuncdevobj; -+ PDEVICE_OBJECT pnextdevobj; -+ SDBUS_INTERFACE_STANDARD sdbusinft; -+ u8 nextdevstacksz; -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ SD_DEVICE_HANDLE hDevice; -+ SD_CARD_RCA sd_rca; -+ SD_CARD_INTERFACE card_intf; -+ BOOLEAN enableIsarWithStatus; -+ WCHAR active_path[MAX_ACTIVE_REG_PATH]; -+ SD_HOST_BLOCK_CAPABILITY sd_host_blk_cap; -+#endif -+} SDIO_DATA, *PSDIO_DATA; -+ -+#define dvobj_to_sdio_func(d) ((d)->intf_data.func) -+ -+#define RTW_SDIO_ADDR_CMD52_BIT (1<<17) -+#define RTW_SDIO_ADDR_CMD52_GEN(a) (a | RTW_SDIO_ADDR_CMD52_BIT) -+#define RTW_SDIO_ADDR_CMD52_CLR(a) (a&~RTW_SDIO_ADDR_CMD52_BIT) -+#define RTW_SDIO_ADDR_CMD52_CHK(a) (a&RTW_SDIO_ADDR_CMD52_BIT ? 1 : 0) -+ -+#define RTW_SDIO_ADDR_F0_BIT (1<<18) -+#define RTW_SDIO_ADDR_F0_GEN(a) (a | RTW_SDIO_ADDR_F0_BIT) -+#define RTW_SDIO_ADDR_F0_CLR(a) (a&~RTW_SDIO_ADDR_F0_BIT) -+#define RTW_SDIO_ADDR_F0_CHK(a) (a&RTW_SDIO_ADDR_F0_BIT ? 1 : 0) -+ -+#define RTW_SDIO_CLK_40M 40000000 -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/drv_types_xp.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_xp.h ---- linux-4.14.18/3rdparty/rtl8723de/include/drv_types_xp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/drv_types_xp.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,93 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __DRV_TYPES_XP_H__ -+#define __DRV_TYPES_XP_H__ -+ -+#include -+#include -+ -+ -+ -+#define MAX_MCAST_LIST_NUM 32 -+ -+ -+ -+/* for ioctl */ -+#define MAKE_DRIVER_VERSION(_MainVer, _MinorVer) ((((u32)(_MainVer))<<16)+_MinorVer) -+ -+#define NIC_HEADER_SIZE 14 /* !< can be moved to typedef.h */ -+#define NIC_MAX_PACKET_SIZE 1514 /* !< can be moved to typedef.h */ -+#define NIC_MAX_SEND_PACKETS 10 /* max number of send packets the MiniportSendPackets function can accept, can be moved to typedef.h */ -+#define NIC_VENDOR_DRIVER_VERSION MAKE_DRIVER_VERSION(0, 001) /* !< can be moved to typedef.h */ -+#define NIC_MAX_PACKET_SIZE 1514 /* !< can be moved to typedef.h */ -+ -+ -+#undef ON_VISTA -+/* added by Jackson */ -+#ifndef ON_VISTA -+ /* -+ * Bus driver versions -+ * */ -+ -+ #define SDBUS_DRIVER_VERSION_1 0x100 -+ #define SDBUS_DRIVER_VERSION_2 0x200 -+ -+ #define SDP_FUNCTION_TYPE 4 -+ #define SDP_BUS_DRIVER_VERSION 5 -+ #define SDP_BUS_WIDTH 6 -+ #define SDP_BUS_CLOCK 7 -+ #define SDP_BUS_INTERFACE_CONTROL 8 -+ #define SDP_HOST_BLOCK_LENGTH 9 -+ #define SDP_FUNCTION_BLOCK_LENGTH 10 -+ #define SDP_FN0_BLOCK_LENGTH 11 -+ #define SDP_FUNCTION_INT_ENABLE 12 -+#endif -+ -+ -+typedef struct _MP_REG_ENTRY { -+ -+ NDIS_STRING RegName; /* variable name text */ -+ BOOLEAN bRequired; /* 1->required, 0->optional */ -+ -+ u8 Type; /* NdisParameterInteger/NdisParameterHexInteger/NdisParameterStringle/NdisParameterMultiString */ -+ uint FieldOffset; /* offset to MP_ADAPTER field */ -+ uint FieldSize; /* size (in bytes) of the field */ -+ -+#ifdef UNDER_AMD64 -+ u64 Default; -+#else -+ u32 Default; /* default value to use */ -+#endif -+ -+ u32 Min; /* minimum value allowed */ -+ u32 Max; /* maximum value allowed */ -+} MP_REG_ENTRY, *PMP_REG_ENTRY; -+ -+ -+typedef struct _OCTET_STRING { -+ u8 *Octet; -+ u16 Length; -+} OCTET_STRING, *POCTET_STRING; -+ -+ -+ -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/ethernet.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/ethernet.h ---- linux-4.14.18/3rdparty/rtl8723de/include/ethernet.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/ethernet.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/*! \file */ -+#ifndef __INC_ETHERNET_H -+#define __INC_ETHERNET_H -+ -+#define ETHERNET_ADDRESS_LENGTH 6 /* !< Ethernet Address Length */ -+#define ETHERNET_HEADER_SIZE 14 /* !< Ethernet Header Length */ -+#define LLC_HEADER_SIZE 6 /* !< LLC Header Length */ -+#define TYPE_LENGTH_FIELD_SIZE 2 /* !< Type/Length Size */ -+#define MINIMUM_ETHERNET_PACKET_SIZE 60 /* !< Minimum Ethernet Packet Size */ -+#define MAXIMUM_ETHERNET_PACKET_SIZE 1514 /* !< Maximum Ethernet Packet Size */ -+ -+#define RT_ETH_IS_MULTICAST(_pAddr) ((((UCHAR *)(_pAddr))[0]&0x01) != 0) /* !< Is Multicast Address? */ -+#define RT_ETH_IS_BROADCAST(_pAddr) (\ -+ ((UCHAR *)(_pAddr))[0] == 0xff && \ -+ ((UCHAR *)(_pAddr))[1] == 0xff && \ -+ ((UCHAR *)(_pAddr))[2] == 0xff && \ -+ ((UCHAR *)(_pAddr))[3] == 0xff && \ -+ ((UCHAR *)(_pAddr))[4] == 0xff && \ -+ ((UCHAR *)(_pAddr))[5] == 0xff) /* !< Is Broadcast Address? */ -+ -+ -+#endif /* #ifndef __INC_ETHERNET_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/gspi_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/gspi_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_hal.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,35 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __GSPI_HAL_H__ -+#define __GSPI_HAL_H__ -+ -+ -+void spi_int_dpc(PADAPTER padapter, u32 sdio_hisr); -+u8 rtw_set_hal_ops(_adapter *padapter); -+ -+#ifdef CONFIG_RTL8188E -+ void rtl8188es_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8723B -+ void rtl8723bs_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#endif /* __GSPI_HAL_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/gspi_ops.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_ops.h ---- linux-4.14.18/3rdparty/rtl8723de/include/gspi_ops.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_ops.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,185 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __GSPI_OPS_H__ -+#define __GSPI_OPS_H__ -+ -+/* follwing defination is based on -+ * GSPI spec of RTL8723, we temp -+ * suppose that it will be the same -+ * for diff chips of GSPI, if not -+ * we should move it to HAL folder */ -+#define SPI_LOCAL_DOMAIN 0x0 -+#define WLAN_IOREG_DOMAIN 0x8 -+#define FW_FIFO_DOMAIN 0x4 -+#define TX_HIQ_DOMAIN 0xc -+#define TX_MIQ_DOMAIN 0xd -+#define TX_LOQ_DOMAIN 0xe -+#define RX_RXFIFO_DOMAIN 0x1f -+ -+/* IO Bus domain address mapping */ -+#define DEFUALT_OFFSET 0x0 -+#define SPI_LOCAL_OFFSET 0x10250000 -+#define WLAN_IOREG_OFFSET 0x10260000 -+#define FW_FIFO_OFFSET 0x10270000 -+#define TX_HIQ_OFFSET 0x10310000 -+#define TX_MIQ_OFFSET 0x1032000 -+#define TX_LOQ_OFFSET 0x10330000 -+#define RX_RXOFF_OFFSET 0x10340000 -+ -+/* SPI Local registers */ -+#define SPI_REG_TX_CTRL 0x0000 /* SPI Tx Control */ -+#define SPI_REG_STATUS_RECOVERY 0x0004 -+#define SPI_REG_INT_TIMEOUT 0x0006 -+#define SPI_REG_HIMR 0x0014 /* SPI Host Interrupt Mask */ -+#define SPI_REG_HISR 0x0018 /* SPI Host Interrupt Service Routine */ -+#define SPI_REG_RX0_REQ_LEN 0x001C /* RXDMA Request Length */ -+#define SPI_REG_FREE_TXPG 0x0020 /* Free Tx Buffer Page */ -+#define SPI_REG_HCPWM1 0x0024 /* HCI Current Power Mode 1 */ -+#define SPI_REG_HCPWM2 0x0026 /* HCI Current Power Mode 2 */ -+#define SPI_REG_HTSFR_INFO 0x0030 /* HTSF Informaion */ -+#define SPI_REG_HRPWM1 0x0080 /* HCI Request Power Mode 1 */ -+#define SPI_REG_HRPWM2 0x0082 /* HCI Request Power Mode 2 */ -+#define SPI_REG_HPS_CLKR 0x0084 /* HCI Power Save Clock */ -+#define SPI_REG_HSUS_CTRL 0x0086 /* SPI HCI Suspend Control */ -+#define SPI_REG_HIMR_ON 0x0090 /* SPI Host Extension Interrupt Mask Always */ -+#define SPI_REG_HISR_ON 0x0091 /* SPI Host Extension Interrupt Status Always */ -+#define SPI_REG_CFG 0x00F0 /* SPI Configuration Register */ -+ -+#define SPI_TX_CTRL (SPI_REG_TX_CTRL | SPI_LOCAL_OFFSET) -+#define SPI_STATUS_RECOVERY (SPI_REG_STATUS_RECOVERY | SPI_LOCAL_OFFSET) -+#define SPI_INT_TIMEOUT (SPI_REG_INT_TIMEOUT | SPI_LOCAL_OFFSET) -+#define SPI_HIMR (SPI_REG_HIMR | SPI_LOCAL_OFFSET) -+#define SPI_HISR (SPI_REG_HISR | SPI_LOCAL_OFFSET) -+#define SPI_RX0_REQ_LEN_1_BYTE (SPI_REG_RX0_REQ_LEN | SPI_LOCAL_OFFSET) -+#define SPI_FREE_TXPG (SPI_REG_FREE_TXPG | SPI_LOCAL_OFFSET) -+ -+#define SPI_HIMR_DISABLED 0 -+ -+/* SPI HIMR MASK diff with SDIO */ -+#define SPI_HISR_RX_REQUEST BIT(0) -+#define SPI_HISR_AVAL BIT(1) -+#define SPI_HISR_TXERR BIT(2) -+#define SPI_HISR_RXERR BIT(3) -+#define SPI_HISR_TXFOVW BIT(4) -+#define SPI_HISR_RXFOVW BIT(5) -+#define SPI_HISR_TXBCNOK BIT(6) -+#define SPI_HISR_TXBCNERR BIT(7) -+#define SPI_HISR_BCNERLY_INT BIT(16) -+#define SPI_HISR_ATIMEND BIT(17) -+#define SPI_HISR_ATIMEND_E BIT(18) -+#define SPI_HISR_CTWEND BIT(19) -+#define SPI_HISR_C2HCMD BIT(20) -+#define SPI_HISR_CPWM1 BIT(21) -+#define SPI_HISR_CPWM2 BIT(22) -+#define SPI_HISR_HSISR_IND BIT(23) -+#define SPI_HISR_GTINT3_IND BIT(24) -+#define SPI_HISR_GTINT4_IND BIT(25) -+#define SPI_HISR_PSTIMEOUT BIT(26) -+#define SPI_HISR_OCPINT BIT(27) -+#define SPI_HISR_TSF_BIT32_TOGGLE BIT(29) -+ -+#define MASK_SPI_HISR_CLEAR (SPI_HISR_TXERR |\ -+ SPI_HISR_RXERR |\ -+ SPI_HISR_TXFOVW |\ -+ SPI_HISR_RXFOVW |\ -+ SPI_HISR_TXBCNOK |\ -+ SPI_HISR_TXBCNERR |\ -+ SPI_HISR_C2HCMD |\ -+ SPI_HISR_CPWM1 |\ -+ SPI_HISR_CPWM2 |\ -+ SPI_HISR_HSISR_IND |\ -+ SPI_HISR_GTINT3_IND |\ -+ SPI_HISR_GTINT4_IND |\ -+ SPI_HISR_PSTIMEOUT |\ -+ SPI_HISR_OCPINT) -+ -+#define REG_LEN_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 0, 8, x)/* (x<<(unsigned int)24) */ -+#define REG_ADDR_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 8, 16, x)/* (x<<(unsigned int)16) */ -+#define REG_DOMAIN_ID_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 24, 5, x)/* (x<<(unsigned int)0) */ -+#define REG_FUN_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 29, 2, x)/* (x<<(unsigned int)5) */ -+#define REG_RW_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 31, 1, x)/* (x<<(unsigned int)7) */ -+ -+#define FIFO_LEN_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 0, 16, x)/* (x<<(unsigned int)24) -+ * #define FIFO_ADDR_FORMAT(pcmd,x) SET_BITS_TO_LE_4BYTE(pcmd, 8, 16, x) */ /* (x<<(unsigned int)16) */ -+#define FIFO_DOMAIN_ID_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 24, 5, x)/* (x<<(unsigned int)0) */ -+#define FIFO_FUN_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 29, 2, x)/* (x<<(unsigned int)5) */ -+#define FIFO_RW_FORMAT(pcmd, x) SET_BITS_TO_LE_4BYTE(pcmd, 31, 1, x)/* (x<<(unsigned int)7) */ -+ -+ -+/* get status dword0 */ -+#define GET_STATUS_PUB_PAGE_NUM(status) LE_BITS_TO_4BYTE(status, 24, 8) -+#define GET_STATUS_HI_PAGE_NUM(status) LE_BITS_TO_4BYTE(status, 18, 6) -+#define GET_STATUS_MID_PAGE_NUM(status) LE_BITS_TO_4BYTE(status, 12, 6) -+#define GET_STATUS_LOW_PAGE_NUM(status) LE_BITS_TO_4BYTE(status, 6, 6) -+#define GET_STATUS_HISR_HI6BIT(status) LE_BITS_TO_4BYTE(status, 0, 6) -+ -+/* get status dword1 */ -+#define GET_STATUS_HISR_MID8BIT(status) LE_BITS_TO_4BYTE(status + 4, 24, 8) -+#define GET_STATUS_HISR_LOW8BIT(status) LE_BITS_TO_4BYTE(status + 4, 16, 8) -+#define GET_STATUS_ERROR(status) LE_BITS_TO_4BYTE(status + 4, 17, 1) -+#define GET_STATUS_INT(status) LE_BITS_TO_4BYTE(status + 4, 16, 1) -+#define GET_STATUS_RX_LENGTH(status) LE_BITS_TO_4BYTE(status + 4, 0, 16) -+ -+ -+#define RXDESC_SIZE 24 -+ -+ -+struct spi_more_data { -+ unsigned long more_data; -+ unsigned long len; -+}; -+ -+#ifdef CONFIG_RTL8188E -+ void rtl8188es_set_hal_ops(PADAPTER padapter); -+ #define set_hal_ops rtl8188es_set_hal_ops -+#endif -+extern void spi_set_chip_endian(PADAPTER padapter); -+extern unsigned int spi_write8_endian(ADAPTER *Adapter, unsigned int addr, unsigned int buf, u32 big); -+extern void spi_set_intf_ops(_adapter *padapter, struct _io_ops *pops); -+extern void spi_set_chip_endian(PADAPTER padapter); -+extern void InitInterrupt8723ASdio(PADAPTER padapter); -+extern void InitSysInterrupt8723ASdio(PADAPTER padapter); -+extern void EnableInterrupt8723ASdio(PADAPTER padapter); -+extern void DisableInterrupt8723ASdio(PADAPTER padapter); -+extern void spi_int_hdl(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8723ASdio(PADAPTER padapter); -+#ifdef CONFIG_RTL8723B -+ extern void InitInterrupt8723BSdio(PADAPTER padapter); -+ extern void InitSysInterrupt8723BSdio(PADAPTER padapter); -+ extern void EnableInterrupt8723BSdio(PADAPTER padapter); -+ extern void DisableInterrupt8723BSdio(PADAPTER padapter); -+ extern u8 HalQueryTxBufferStatus8723BSdio(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8188E -+ extern void InitInterrupt8188EGspi(PADAPTER padapter); -+ extern void EnableInterrupt8188EGspi(PADAPTER padapter); -+ extern void DisableInterrupt8188EGspi(PADAPTER padapter); -+ extern void UpdateInterruptMask8188EGspi(PADAPTER padapter, u32 AddMSR, u32 RemoveMSR); -+ extern u8 HalQueryTxBufferStatus8189EGspi(PADAPTER padapter); -+ extern u8 HalQueryTxOQTBufferStatus8189EGspi(PADAPTER padapter); -+ extern void ClearInterrupt8188EGspi(PADAPTER padapter); -+ extern u8 CheckIPSStatus(PADAPTER padapter); -+#endif /* CONFIG_RTL8188E */ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ extern u8 RecvOnePkt(PADAPTER padapter, u32 size); -+#endif /* CONFIG_WOWLAN */ -+ -+#endif /* __GSPI_OPS_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/gspi_ops_linux.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_ops_linux.h ---- linux-4.14.18/3rdparty/rtl8723de/include/gspi_ops_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_ops_linux.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,23 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OPS_LINUX_H__ -+#define __SDIO_OPS_LINUX_H__ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/gspi_osintf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_osintf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/gspi_osintf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/gspi_osintf.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OSINTF_H__ -+#define __SDIO_OSINTF_H__ -+ -+ -+#ifdef PLATFORM_OS_CE -+ extern NDIS_STATUS ce_sd_get_dev_hdl(PADAPTER padapter); -+ SD_API_STATUS ce_sd_int_callback(SD_DEVICE_HANDLE hDevice, PADAPTER padapter); -+ extern void sd_setup_irs(PADAPTER padapter); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/h2clbk.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/h2clbk.h ---- linux-4.14.18/3rdparty/rtl8723de/include/h2clbk.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/h2clbk.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#define _H2CLBK_H_ -+ -+ -+void _lbk_cmd(PADAPTER Adapter); -+ -+void _lbk_rsp(PADAPTER Adapter); -+ -+void _lbk_evt(IN PADAPTER Adapter); -+ -+void h2c_event_callback(unsigned char *dev, unsigned char *pbuf); -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8188EPhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188EPhyCfg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8188EPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188EPhyCfg.h 2018-02-11 21:44:27.164146345 +0200 -@@ -0,0 +1,265 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8188EPHYCFG_H__ -+#define __INC_HAL8188EPHYCFG_H__ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 /* us */ -+#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+#ifdef CONFIG_PCI_HCI -+ #define MAX_AGGR_NUM 0x0B -+#else -+ #define MAX_AGGR_NUM 0x07 -+#endif /* CONFIG_PCI_HCI */ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+#define MAX_TX_COUNT_8188E 1 -+ -+/* BB/RF related */ -+ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/*------------------------Export global variable----------------------------*/ -+/*------------------------Export global variable----------------------------*/ -+ -+ -+/*------------------------Export Marco Definition---------------------------*/ -+/*------------------------Export Marco Definition---------------------------*/ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+/* -+ * BB and RF register read/write -+ * */ -+u32 PHY_QueryBBReg8188E(IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask); -+void PHY_SetBBReg8188E(IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data); -+u32 PHY_QueryRFReg8188E(IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask); -+void PHY_SetRFReg8188E(IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data); -+ -+/* -+ * Initialization related function -+ */ -+/* MAC/BB/RF HAL config */ -+int PHY_MACConfig8188E(IN PADAPTER Adapter); -+int PHY_BBConfig8188E(IN PADAPTER Adapter); -+int PHY_RFConfig8188E(IN PADAPTER Adapter); -+ -+/* RF config */ -+int rtl8188e_PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, IN u8 *pFileName, u8 eRFPath); -+ -+/* -+ * RF Power setting -+ */ -+/* extern BOOLEAN PHY_SetRFPowerState(IN PADAPTER Adapter, -+ * IN RT_RF_POWER_STATE eRFPowerState); */ -+ -+/* -+ * BB TX Power R/W -+ * */ -+void PHY_GetTxPowerLevel8188E(IN PADAPTER Adapter, -+ OUT s32 *powerlevel); -+void PHY_SetTxPowerLevel8188E(IN PADAPTER Adapter, -+ IN u8 channel); -+BOOLEAN PHY_UpdateTxPowerDbm8188E(IN PADAPTER Adapter, -+ IN int powerInDbm); -+ -+VOID -+PHY_SetTxPowerIndex_8188E( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+); -+ -+u8 -+PHY_GetTxPowerIndex_8188E( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN u8 BandWidth, -+ IN u8 Channel, -+ struct txpwr_idx_comp *tic -+); -+ -+/* -+ * Switch bandwidth for 8192S -+ */ -+/* extern void PHY_SetBWModeCallback8192C( IN PRT_TIMER pTimer ); */ -+void PHY_SetBWMode8188E(IN PADAPTER pAdapter, -+ IN CHANNEL_WIDTH ChnlWidth, -+ IN unsigned char Offset); -+ -+/* -+ * Set FW CMD IO for 8192S. -+ */ -+/* extern BOOLEAN HalSetIO8192C( IN PADAPTER Adapter, -+ * IN IO_TYPE IOType); */ -+ -+/* -+ * Set A2 entry to fw for 8192S -+ * */ -+extern void FillA2Entry8192C(IN PADAPTER Adapter, -+ IN u8 index, -+ IN u8 *val); -+ -+ -+/* -+ * channel switch related funciton -+ */ -+/* extern void PHY_SwChnlCallback8192C( IN PRT_TIMER pTimer ); */ -+void PHY_SwChnl8188E(IN PADAPTER pAdapter, -+ IN u8 channel); -+ -+VOID -+PHY_SetSwChnlBWMode8188E( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+VOID -+PHY_SetRFEReg_8188E( -+ IN PADAPTER Adapter -+); -+/* -+ * BB/MAC/RF other monitor API -+ * */ -+VOID PHY_SetRFPathSwitch_8188E(IN PADAPTER pAdapter, IN BOOLEAN bMain); -+ -+extern VOID -+PHY_SwitchEphyParameter( -+ IN PADAPTER Adapter -+); -+ -+extern VOID -+PHY_EnableHostClkReq( -+ IN PADAPTER Adapter -+); -+ -+BOOLEAN -+SetAntennaConfig92C( -+ IN PADAPTER Adapter, -+ IN u8 DefaultAnt -+); -+ -+/*--------------------------Exported Function prototype---------------------*/ -+ -+/* -+ * Initialization related function -+ * -+ * MAC/BB/RF HAL config */ -+/* extern s32 PHY_MACConfig8723(PADAPTER padapter); -+ * s32 PHY_BBConfig8723(PADAPTER padapter); -+ * s32 PHY_RFConfig8723(PADAPTER padapter); */ -+ -+ -+ -+/* ****************************************************************** -+ * Note: If SIC_ENABLE under PCIE, because of the slow operation -+ * you should -+ * 2) "#define RTL8723_FPGA_VERIFICATION 1" in Precomp.h.WlanE.Windows -+ * 3) "#define RTL8190_Download_Firmware_From_Header 0" in Precomp.h.WlanE.Windows if needed. -+ * */ -+#if (RTL8188E_SUPPORT == 1) && (RTL8188E_FPGA_TRUE_PHY_VERIFICATION == 1) -+ #define SIC_ENABLE 1 -+ #define SIC_HW_SUPPORT 1 -+#else -+ #define SIC_ENABLE 0 -+ #define SIC_HW_SUPPORT 0 -+#endif -+/* ****************************************************************** */ -+ -+ -+#define SIC_MAX_POLL_CNT 5 -+ -+#if (SIC_HW_SUPPORT == 1) -+ #define SIC_CMD_READY 0 -+ #define SIC_CMD_PREWRITE 0x1 -+ #if (RTL8188E_SUPPORT == 1) -+ #define SIC_CMD_WRITE 0x40 -+ #define SIC_CMD_PREREAD 0x2 -+ #define SIC_CMD_READ 0x80 -+ #define SIC_CMD_INIT 0xf0 -+ #define SIC_INIT_VAL 0xff -+ -+ #define SIC_INIT_REG 0x1b7 -+ #define SIC_CMD_REG 0x1EB /* 1byte */ -+ #define SIC_ADDR_REG 0x1E8 /* 1b4~1b5, 2 bytes */ -+ #define SIC_DATA_REG 0x1EC /* 1b0~1b3 */ -+ #else -+ #define SIC_CMD_WRITE 0x11 -+ #define SIC_CMD_PREREAD 0x2 -+ #define SIC_CMD_READ 0x12 -+ #define SIC_CMD_INIT 0x1f -+ #define SIC_INIT_VAL 0xff -+ -+ #define SIC_INIT_REG 0x1b7 -+ #define SIC_CMD_REG 0x1b6 /* 1byte */ -+ #define SIC_ADDR_REG 0x1b4 /* 1b4~1b5, 2 bytes */ -+ #define SIC_DATA_REG 0x1b0 /* 1b0~1b3 */ -+ #endif -+#else -+ #define SIC_CMD_READY 0 -+ #define SIC_CMD_WRITE 1 -+ #define SIC_CMD_READ 2 -+ -+ #if (RTL8188E_SUPPORT == 1) -+ #define SIC_CMD_REG 0x1EB /* 1byte */ -+ #define SIC_ADDR_REG 0x1E8 /* 1b9~1ba, 2 bytes */ -+ #define SIC_DATA_REG 0x1EC /* 1bc~1bf */ -+ #else -+ #define SIC_CMD_REG 0x1b8 /* 1byte */ -+ #define SIC_ADDR_REG 0x1b9 /* 1b9~1ba, 2 bytes */ -+ #define SIC_DATA_REG 0x1bc /* 1bc~1bf */ -+ #endif -+#endif -+ -+#if (SIC_ENABLE == 1) -+ VOID SIC_Init(IN PADAPTER Adapter); -+#endif -+ -+ -+#endif /* __INC_HAL8192CPHYCFG_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8188EPhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188EPhyReg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8188EPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188EPhyReg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,1105 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8188EPHYREG_H__ -+#define __INC_HAL8188EPHYREG_H__ -+/*--------------------------Define Parameters-------------------------------*/ -+/* -+ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+ * 3. RF register 0x00-2E -+ * 4. Bit Mask for BB/RF register -+ * 5. Other defintion for BB/RF R/W -+ * */ -+ -+ -+/* -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 1. Page1(0x100) -+ * */ -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+/* -+ * 2. Page2(0x200) -+ * -+ * The following two definition are only used for USB interface. */ -+#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ -+#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ -+ -+/* -+ * 3. Page8(0x800) -+ * */ -+#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA0_TxInfo 0x804 /* Status report?? */ -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ -+ -+#define rFPGA0_RFTiming1 0x810 /* Useless now */ -+#define rFPGA0_RFTiming2 0x814 -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 -+#define rFPGA0_AdDaClockEn 0x888 /* enable ad/da clock1 for dual-phy */ -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 /* Useless now */ -+#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ -+#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ -+ -+/* -+ * 4. Page9(0x900) -+ * */ -+#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA1_TxBlock 0x904 /* Useless now */ -+#define rFPGA1_DebugSelect 0x908 /* Useless now */ -+#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ -+ -+/* -+ * 5. PageA(0xA00) -+ * -+ * Set Control channel to upper or lower. These settings are required only for 40MHz */ -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ -+#define rCCK0_CCA 0xa08 /* Disable init gain now */ /* Init gain */ -+ -+#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level */ /* Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ -+#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ -+#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ -+#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 /* 0xa57 */ -+#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ -+#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ -+ -+/* -+ * PageB(0xB00) -+ * */ -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_ram64x16 0xb2c -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rConfig_Pmpd_AntB 0xb98 -+#define rAPK 0xbd8 -+ -+ -+ -+/* -+ * 6. PageC(0xC00) -+ * */ -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ -+#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ -+#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ -+#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ -+#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ -+ -+#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ -+#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ -+#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ -+#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ -+ -+#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+ -+/* -+ * 7. PageD(0xD00) -+ * */ -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 /* No setting now */ -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_csi_fix_mask1 0xd40 -+#define rOFDM1_csi_fix_mask2 0xd44 -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ -+#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ -+#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ -+ -+#define rOFDM_ShortCFOAB 0xdac /* No setting now */ -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+/* -+ * 8. PageE(0xE00) -+ * */ -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+/* -+ * 7. RF Register 0x00-0x2E (RF 8256) -+ * RF-0222D 0x00-3F -+ * -+ * Zebra1 */ -+#define rZebra1_HSSIEnable 0x0 /* Useless now */ -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+#define rZebra1_Channel 0x7 /* RF channel switch */ -+ -+/* #endif */ -+#define rZebra1_TxGain 0x8 /* Useless now */ -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+/* Zebra4 */ -+#define rGlobalCtrl 0 /* Useless now */ -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+/* RTL8258 */ -+#define rRTL8258_TxLPF 0x11 /* Useless now */ -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+/* -+ * RL6052 Register definition -+ * */ -+#define RF_AC 0x00 /* */ -+ -+#define RF_IQADJ_G1 0x01 /* */ -+#define RF_IQADJ_G2 0x02 /* */ -+ -+#define RF_POW_TRSW 0x05 /* */ -+ -+#define RF_GAIN_RX 0x06 /* */ -+#define RF_GAIN_TX 0x07 /* */ -+ -+#define RF_TXM_IDAC 0x08 /* */ -+#define RF_IPA_G 0x09 /* */ -+#define RF_TXBIAS_G 0x0A -+#define RF_TXPA_AG 0x0B -+#define RF_IPA_A 0x0C /* */ -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_BS_IQGEN 0x0F /* */ -+ -+#define RF_MODE1 0x10 /* */ -+#define RF_MODE2 0x11 /* */ -+ -+#define RF_RX_AGC_HP 0x12 /* */ -+#define RF_TX_AGC 0x13 /* */ -+#define RF_BIAS 0x14 /* */ -+#define RF_IPA 0x15 /* */ -+#define RF_TXBIAS 0x16 -+#define RF_POW_ABILITY 0x17 /* */ -+#define RF_CHNLBW 0x18 /* RF channel and BW switch */ -+#define RF_TOP 0x19 /* */ -+ -+#define RF_RX_G1 0x1A /* */ -+#define RF_RX_G2 0x1B /* */ -+ -+#define RF_RX_BB2 0x1C /* */ -+#define RF_RX_BB1 0x1D /* */ -+ -+#define RF_RCK1 0x1E /* */ -+#define RF_RCK2 0x1F /* */ -+ -+#define RF_TX_G1 0x20 /* */ -+#define RF_TX_G2 0x21 /* */ -+#define RF_TX_G3 0x22 /* */ -+ -+#define RF_TX_BB1 0x23 /* */ -+ -+#define RF_T_METER_88E 0x42 /* */ -+#define RF_T_METER 0x24 /* */ -+ -+#define RF_SYN_G1 0x25 /* RF TX Power control */ -+#define RF_SYN_G2 0x26 /* RF TX Power control */ -+#define RF_SYN_G3 0x27 /* RF TX Power control */ -+#define RF_SYN_G4 0x28 /* RF TX Power control */ -+#define RF_SYN_G5 0x29 /* RF TX Power control */ -+#define RF_SYN_G6 0x2A /* RF TX Power control */ -+#define RF_SYN_G7 0x2B /* RF TX Power control */ -+#define RF_SYN_G8 0x2C /* RF TX Power control */ -+ -+#define RF_RCK_OS 0x30 /* RF TX PA control */ -+#define RF_TXPA_G1 0x31 /* RF TX PA control */ -+#define RF_TXPA_G2 0x32 /* RF TX PA control */ -+#define RF_TXPA_G3 0x33 /* RF TX PA control */ -+#define RF_TX_BIAS_A 0x35 -+#define RF_TX_BIAS_D 0x36 -+#define RF_LOBF_9 0x38 -+#define RF_RXRF_A3 0x3C /* */ -+#define RF_TRSW 0x3F -+ -+#define RF_TXRF_A2 0x41 -+#define RF_TXPA_G4 0x46 -+#define RF_TXPA_A4 0x4B -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+ -+ -+/* -+ * Bit Mask -+ * -+ * 1. Page1(0x100) */ -+#define bBBResetB 0x100 /* Useless now? */ -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+ -+/* 2. Page8(0x800) */ -+#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 /* Useless now */ -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bAntennaSelect 0x0300 -+ -+#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 /* Useless now */ -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf /* Reg0x814 */ -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 /* T2R */ -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 /* chane gain at continue Tx */ -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 /* Useless now -+ * #define bHWSISelect 0x8 */ -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ -+ -+#define bRFSI_TRSW 0x20 /* Useless now */ -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+ -+#define bLSSIReadAddress 0x7f800000 /* T65 RF */ -+ -+#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ -+ -+#define bLSSIReadBackData 0xfffff /* T65 RF */ -+ -+#define bLSSIReadOKFlag 0x1000 /* Useless now */ -+#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ -+ -+#define b80MClkDelay 0x18000000 /* Useless */ -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 /* Useless */ -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+/* 3. Page9(0x900) */ -+#define bOFDMTxSC 0x30000000 /* Useless */ -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ -+#define bDebugItem 0xff /* reset debug page and LWord */ -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+/* 4. PageA(0xA00) */ -+#define bCCKBBMode 0x3 /* Useless */ -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ -+ -+#define bCCKScramble 0x8 /* Useless */ -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ -+#define bCCKFixedRxAGC 0x8000 -+/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+/* 5. PageC(0xC00) */ -+#define bNumOfSTF 0x3 /* Useless */ -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 /* the threshold for high power */ -+#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+/* #define bRxMF_Hold 0x3800 */ -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+/* 6. PageE(0xE00) */ -+#define bSTBCEn 0x4 /* Useless */ -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+/* #define bRxPath1 0x01 */ -+/* #define bRxPath2 0x02 */ -+/* #define bRxPath3 0x04 */ -+/* #define bRxPath4 0x08 */ -+/* #define bTxPath1 0x10 */ -+/* #define bTxPath2 0x20 */ -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 /* total */ -+#define bShortCFOFLength 11 /* fraction */ -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf /* Useless */ -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 /* Useless */ -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 /* Useless */ -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+/* Rx Pseduo noise */ -+#define bRxPesudoNoiseOn 0x20000000 /* Useless */ -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+/* 7. RF Register -+ * Zebra1 */ -+#define bZebra1_HSSIEnable 0x8 /* Useless */ -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+/* Zebra4 */ -+#define bRTL8256RegModeCtrl1 0x100 /* Useless */ -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+/* RTL8258 */ -+#define bRTL8258_TxLPFBW 0xc /* Useless */ -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+/* -+ * Other Definition -+ * */ -+ -+/* byte endable for sb_write */ -+#define bByte0 0x1 /* Useless */ -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+/* for PutRegsetting & GetRegSetting BitMask */ -+#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+ -+#define bEnable 0x1 /* Useless */ -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 /* Useless */ -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 /* 500ms */ /* Useless */ -+#define tUpdateRxCounter 100 /* 100ms */ -+ -+#define rateCCK 0 /* Useless */ -+#define rateOFDM 1 -+#define rateHT 2 -+ -+/* define Register-End */ -+#define bPMAC_End 0x1ff /* Useless */ -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+/* define max debug item in each debug page -+ * #define bMaxItem_FPGA_PHY0 0x9 -+ * #define bMaxItem_FPGA_PHY1 0x3 -+ * #define bMaxItem_PHY_11B 0x16 -+ * #define bMaxItem_OFDM_PHY0 0x29 -+ * #define bMaxItem_OFDM_PHY1 0x0 */ -+ -+#define bPMACControl 0x0 /* Useless */ -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#define PathA 0x0 /* Useless */ -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8188EPwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188EPwrSeq.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8188EPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188EPwrSeq.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,175 @@ -+ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL8188EPWRSEQ_H__ -+#define __HAL8188EPWRSEQ_H__ -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WM-20110607-Paul-RTL8188E_Power_Architecture-R02.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+ -+ PWR SEQ Version: rtl8188E_PwrSeq_V09.h -+*/ -+#define RTL8188E_TRANS_CARDEMU_TO_ACT_STEPS 10 -+#define RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS 10 -+#define RTL8188E_TRANS_CARDEMU_TO_SUS_STEPS 10 -+#define RTL8188E_TRANS_SUS_TO_CARDEMU_STEPS 10 -+#define RTL8188E_TRANS_CARDEMU_TO_PDN_STEPS 10 -+#define RTL8188E_TRANS_PDN_TO_CARDEMU_STEPS 10 -+#define RTL8188E_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8188E_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8188E_TRANS_END_STEPS 1 -+ -+ -+#define RTL8188E_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 | BIT1, 0}, /* 0x02[1:0] = 0 reset BB*/ \ -+ {0x0026, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7}, /*0x24[23] = 2b'01 schmit trigger */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0}, /* 0x04[15] = 0 disable HWPDN (control by DRV)*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4 | BIT3, 0}, /*0x04[12:11] = 2b'00 disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*0x04[8] = 1 polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0}, /*wait till 0x04[8] = 0*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*LDO normal mode*/ \ -+ -+#define RTL8188E_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*LDO Sleep mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ -+#define RTL8188E_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3 | BIT4}, /*0x04[12:11] = 2b'11enable WL suspend for PCIe*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, BIT7}, /* 0x04[31:30] = 2b'10 enable enable bandgap mbias in suspend */ \ -+ {0x0041, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*Clear SIC_EN register 0x40[12] = 1'b0 */ \ -+ {0xfe10, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*Set USB suspend enable local register 0xfe10[4]=1 */ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8188E_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8188E_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0026, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7}, /*0x24[23] = 2b'01 schmit trigger */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /* 0x04[31:30] = 2b'10 enable enable bandgap mbias in suspend */ \ -+ {0x0041, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*Clear SIC_EN register 0x40[12] = 1'b0 */ \ -+ {0xfe10, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*Set USB suspend enable local register 0xfe10[4]=1 */ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8188E_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8188E_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8188E_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+ /* This is used by driver for LPSRadioOff Procedure, not for FW LPS Step */ -+#define RTL8188E_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x7F},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8188E_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8188E_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, -+ -+ -+ extern WLAN_PWR_CFG rtl8188E_power_on_flow[RTL8188E_TRANS_CARDEMU_TO_ACT_STEPS + RTL8188E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188E_radio_off_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188E_card_disable_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188E_TRANS_CARDEMU_TO_PDN_STEPS + RTL8188E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188E_card_enable_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188E_TRANS_CARDEMU_TO_PDN_STEPS + RTL8188E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188E_suspend_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188E_TRANS_CARDEMU_TO_SUS_STEPS + RTL8188E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188E_resume_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188E_TRANS_CARDEMU_TO_SUS_STEPS + RTL8188E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188E_hwpdn_flow[RTL8188E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188E_TRANS_CARDEMU_TO_PDN_STEPS + RTL8188E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188E_enter_lps_flow[RTL8188E_TRANS_ACT_TO_LPS_STEPS + RTL8188E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188E_leave_lps_flow[RTL8188E_TRANS_LPS_TO_ACT_STEPS + RTL8188E_TRANS_END_STEPS]; -+ -+#endif /* __HAL8188EPWRSEQ_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8188FPhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188FPhyCfg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8188FPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188FPhyCfg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,136 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8188FPHYCFG_H__ -+#define __INC_HAL8188FPHYCFG_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 /* us */ -+#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+#ifdef CONFIG_PCI_HCI -+ #define MAX_AGGR_NUM 0x0B -+#else -+ #define MAX_AGGR_NUM 0x07 -+#endif /* CONFIG_PCI_HCI */ -+ -+ -+/*--------------------------Define Parameters End-------------------------------*/ -+ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+/*------------------------------Define structure End----------------------------*/ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+u32 -+PHY_QueryBBReg_8188F( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask -+); -+ -+VOID -+PHY_SetBBReg_8188F( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+); -+ -+u32 -+PHY_QueryRFReg_8188F( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask -+); -+ -+VOID -+PHY_SetRFReg_8188F( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+); -+ -+/* MAC/BB/RF HAL config */ -+int PHY_BBConfig8188F(PADAPTER Adapter); -+ -+int PHY_RFConfig8188F(PADAPTER Adapter); -+ -+s32 PHY_MACConfig8188F(PADAPTER padapter); -+ -+int -+PHY_ConfigRFWithParaFile_8188F( -+ IN PADAPTER Adapter, -+ IN u8 *pFileName, -+ RF_PATH eRFPath -+); -+ -+VOID -+PHY_SetTxPowerIndex_8188F( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+); -+ -+u8 -+PHY_GetTxPowerIndex_8188F( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN u8 BandWidth, -+ IN u8 Channel, -+ struct txpwr_idx_comp *tic -+); -+ -+VOID -+PHY_GetTxPowerLevel8188F( -+ IN PADAPTER Adapter, -+ OUT s32 *powerlevel -+); -+ -+VOID -+PHY_SetTxPowerLevel8188F( -+ IN PADAPTER Adapter, -+ IN u8 channel -+); -+ -+VOID -+PHY_SetSwChnlBWMode8188F( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+VOID PHY_SetRFPathSwitch_8188F( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bMain -+); -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8188FPhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188FPhyReg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8188FPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188FPhyReg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,1170 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8188FPHYREG_H__ -+#define __INC_HAL8188FPHYREG_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+/* ************************************************************ -+ * Regsiter offset definition -+ * ************************************************************ */ -+ -+/* -+ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+ * 3. RF register 0x00-2E -+ * 4. Bit Mask for BB/RF register -+ * 5. Other defintion for BB/RF R/W -+ * */ -+ -+ -+/* -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 1. Page1(0x100) -+ * */ -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+/* -+ * 2. Page2(0x200) -+ * -+ * The following two definition are only used for USB interface. */ -+#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ -+#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ -+ -+/* -+ * 3. Page8(0x800) -+ * */ -+#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA0_TxInfo 0x804 /* Status report?? */ -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ -+ -+#define rFPGA0_RFTiming1 0x810 /* Useless now */ -+#define rFPGA0_RFTiming2 0x814 -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+ -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 /* Useless now */ -+#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ -+#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ -+ -+/* -+ * 4. Page9(0x900) -+ * */ -+#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA1_TxBlock 0x904 /* Useless now */ -+#define rFPGA1_DebugSelect 0x908 /* Useless now */ -+#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ -+#define rS0S1_PathSwitch 0x948 -+ -+/* -+ * 5. PageA(0xA00) -+ * -+ * Set Control channel to upper or lower. These settings are required only for 40MHz */ -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ -+#define rCCK0_CCA 0xa08 /* Disable init gain now */ /* Init gain */ -+ -+#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level */ /* Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ -+#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ -+#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ -+#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 /* 0xa57 */ -+#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ -+#define rCCK0_FACounterUpper 0xa58 /* 0xa5c -+ * -+ * PageB(0xB00) -+ * */ -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rConfig_Pmpd_AntB 0xb98 -+#define rAPK 0xbd8 -+ -+/* -+ * 6. PageC(0xC00) -+ * */ -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ -+#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ -+#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ -+#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ -+#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ -+ -+#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ -+#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ -+#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ -+#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ -+ -+#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+/* -+ * 7. PageD(0xD00) -+ * */ -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 /* No setting now */ -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ -+#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ -+#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ -+ -+#define rOFDM_ShortCFOAB 0xdac /* No setting now */ -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+/* -+ * 8. PageE(0xE00) -+ * */ -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+/* -+ * 7. RF Register 0x00-0x2E (RF 8256) -+ * RF-0222D 0x00-3F -+ * -+ * Zebra1 */ -+#define rZebra1_HSSIEnable 0x0 /* Useless now */ -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+#define rZebra1_Channel 0x7 /* RF channel switch */ -+ -+/* #endif */ -+#define rZebra1_TxGain 0x8 /* Useless now */ -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+/* Zebra4 */ -+#define rGlobalCtrl 0 /* Useless now */ -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+/* RTL8258 */ -+#define rRTL8258_TxLPF 0x11 /* Useless now */ -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+/* -+ * RL6052 Register definition -+ * */ -+#define RF_AC 0x00 /* */ -+ -+#define RF_IQADJ_G1 0x01 /* */ -+#define RF_IQADJ_G2 0x02 /* */ -+#define RF_BS_PA_APSET_G1_G4 0x03 -+#define RF_BS_PA_APSET_G5_G8 0x04 -+#define RF_POW_TRSW 0x05 /* */ -+ -+#define RF_GAIN_RX 0x06 /* */ -+#define RF_GAIN_TX 0x07 /* */ -+ -+#define RF_TXM_IDAC 0x08 /* */ -+#define RF_IPA_G 0x09 /* */ -+#define RF_TXBIAS_G 0x0A -+#define RF_TXPA_AG 0x0B -+#define RF_IPA_A 0x0C /* */ -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_BS_IQGEN 0x0F /* */ -+ -+#define RF_MODE1 0x10 /* */ -+#define RF_MODE2 0x11 /* */ -+ -+#define RF_RX_AGC_HP 0x12 /* */ -+#define RF_TX_AGC 0x13 /* */ -+#define RF_BIAS 0x14 /* */ -+#define RF_IPA 0x15 /* */ -+#define RF_TXBIAS 0x16 -+#define RF_POW_ABILITY 0x17 /* */ -+#define RF_MODE_AG 0x18 /* */ -+#define rRfChannel 0x18 /* RF channel and BW switch */ -+#define RF_CHNLBW 0x18 /* RF channel and BW switch */ -+#define RF_TOP 0x19 /* */ -+ -+#define RF_RX_G1 0x1A /* */ -+#define RF_RX_G2 0x1B /* */ -+ -+#define RF_RX_BB2 0x1C /* */ -+#define RF_RX_BB1 0x1D /* */ -+ -+#define RF_RCK1 0x1E /* */ -+#define RF_RCK2 0x1F /* */ -+ -+#define RF_TX_G1 0x20 /* */ -+#define RF_TX_G2 0x21 /* */ -+#define RF_TX_G3 0x22 /* */ -+ -+#define RF_TX_BB1 0x23 /* */ -+ -+#define RF_T_METER 0x24 /* */ -+ -+#define RF_SYN_G1 0x25 /* RF TX Power control */ -+#define RF_SYN_G2 0x26 /* RF TX Power control */ -+#define RF_SYN_G3 0x27 /* RF TX Power control */ -+#define RF_SYN_G4 0x28 /* RF TX Power control */ -+#define RF_SYN_G5 0x29 /* RF TX Power control */ -+#define RF_SYN_G6 0x2A /* RF TX Power control */ -+#define RF_SYN_G7 0x2B /* RF TX Power control */ -+#define RF_SYN_G8 0x2C /* RF TX Power control */ -+ -+#define RF_RCK_OS 0x30 /* RF TX PA control */ -+ -+#define RF_TXPA_G1 0x31 /* RF TX PA control */ -+#define RF_TXPA_G2 0x32 /* RF TX PA control */ -+#define RF_TXPA_G3 0x33 /* RF TX PA control */ -+#define RF_TX_BIAS_A 0x35 -+#define RF_TX_BIAS_D 0x36 -+#define RF_LOBF_9 0x38 -+#define RF_RXRF_A3 0x3C /* */ -+#define RF_TRSW 0x3F -+ -+#define RF_TXRF_A2 0x41 -+#define RF_TXPA_G4 0x46 -+#define RF_TXPA_A4 0x4B -+#define RF_0x52 0x52 -+#define RF_RXG_MIX_SWBW 0x87 -+#define RF_DBG_LP_RX2 0xDF -+#define RF_WE_LUT 0xEF -+#define RF_S0S1 0xB0 -+ -+#define RF_TX_GAIN_OFFSET_8188F(_val) (abs((_val)) | (((_val) > 0) ? BIT5 : 0)) -+ -+/* -+ * Bit Mask -+ * -+ * 1. Page1(0x100) */ -+#define bBBResetB 0x100 /* Useless now? */ -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+ -+/* 2. Page8(0x800) */ -+#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 /* Useless now */ -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bAntennaSelect 0x0300 -+ -+#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 /* Useless now */ -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf /* Reg0x814 */ -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 /* T2R */ -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 /* chane gain at continue Tx */ -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 /* Useless now -+ * #define bHWSISelect 0x8 */ -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ -+ -+#define bRFSI_TRSW 0x20 /* Useless now */ -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+ -+#define bLSSIReadAddress 0x7f800000 /* T65 RF */ -+ -+#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ -+ -+#define bLSSIReadBackData 0xfffff /* T65 RF */ -+ -+#define bLSSIReadOKFlag 0x1000 /* Useless now */ -+#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ -+ -+#define b80MClkDelay 0x18000000 /* Useless */ -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 /* Useless */ -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+/* 3. Page9(0x900) */ -+#define bOFDMTxSC 0x30000000 /* Useless */ -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ -+#define bDebugItem 0xff /* reset debug page and LWord */ -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+/* 4. PageA(0xA00) */ -+#define bCCKBBMode 0x3 /* Useless */ -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ -+ -+#define bCCKScramble 0x8 /* Useless */ -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ -+#define bCCKFixedRxAGC 0x8000 -+/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+/* 5. PageC(0xC00) */ -+#define bNumOfSTF 0x3 /* Useless */ -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 /* the threshold for high power */ -+#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+/* #define bRxMF_Hold 0x3800 */ -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+/* 6. PageE(0xE00) */ -+#define bSTBCEn 0x4 /* Useless */ -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+/* #define bRxPath1 0x01 */ -+/* #define bRxPath2 0x02 */ -+/* #define bRxPath3 0x04 */ -+/* #define bRxPath4 0x08 */ -+/* #define bTxPath1 0x10 */ -+/* #define bTxPath2 0x20 */ -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 /* total */ -+#define bShortCFOFLength 11 /* fraction */ -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf /* Useless */ -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 /* Useless */ -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 /* Useless */ -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+/* Rx Pseduo noise */ -+#define bRxPesudoNoiseOn 0x20000000 /* Useless */ -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+/* 7. RF Register -+ * Zebra1 */ -+#define bZebra1_HSSIEnable 0x8 /* Useless */ -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+/* Zebra4 */ -+#define bRTL8256RegModeCtrl1 0x100 /* Useless */ -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+/* RTL8258 */ -+#define bRTL8258_TxLPFBW 0xc /* Useless */ -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+/* -+ * Other Definition -+ * */ -+ -+/* byte endable for sb_write */ -+#define bByte0 0x1 /* Useless */ -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+/* for PutRegsetting & GetRegSetting BitMask */ -+#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+#define bEnable 0x1 /* Useless */ -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 /* Useless */ -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 /* 500ms */ /* Useless */ -+#define tUpdateRxCounter 100 /* 100ms */ -+ -+#define rateCCK 0 /* Useless */ -+#define rateOFDM 1 -+#define rateHT 2 -+ -+/* define Register-End */ -+#define bPMAC_End 0x1ff /* Useless */ -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+/* define max debug item in each debug page -+ * #define bMaxItem_FPGA_PHY0 0x9 -+ * #define bMaxItem_FPGA_PHY1 0x3 -+ * #define bMaxItem_PHY_11B 0x16 -+ * #define bMaxItem_OFDM_PHY0 0x29 -+ * #define bMaxItem_OFDM_PHY1 0x0 */ -+ -+#define bPMACControl 0x0 /* Useless */ -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#define PathA 0x0 /* Useless */ -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+/* BB Register Definition -+ * -+ * 4. Page9(0x900) -+ * */ -+#define rDPDT_control 0x92c -+#define rfe_ctrl_anta_src 0x930 -+#define rS0S1_PathSwitch 0x948 -+#define BBrx_DFIR 0x954 -+#define AGC_table_select 0xb2c -+ -+/* -+ * PageB(0xB00) -+ * */ -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rPdp_AntA_8 0xb08 -+#define rPdp_AntA_C 0xb0c -+#define rPdp_AntA_10 0xb10 -+#define rPdp_AntA_14 0xb14 -+#define rPdp_AntA_18 0xb18 -+#define rPdp_AntA_1C 0xb1c -+#define rPdp_AntA_20 0xb20 -+#define rPdp_AntA_24 0xb24 -+ -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_ram64x16 0xb2c -+ -+#define rBndA 0xb30 -+#define rHssiPar 0xb34 -+ -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+ -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rPdp_AntB_8 0xb78 -+#define rPdp_AntB_C 0xb7c -+#define rPdp_AntB_10 0xb80 -+#define rPdp_AntB_14 0xb84 -+#define rPdp_AntB_18 0xb88 -+#define rPdp_AntB_1C 0xb8c -+#define rPdp_AntB_20 0xb90 -+#define rPdp_AntB_24 0xb94 -+ -+#define rConfig_Pmpd_AntB 0xb98 -+ -+#define rBndB 0xba0 -+ -+#define rAPK 0xbd8 -+#define rPm_Rx0_AntA 0xbdc -+#define rPm_Rx1_AntA 0xbe0 -+#define rPm_Rx2_AntA 0xbe4 -+#define rPm_Rx3_AntA 0xbe8 -+#define rPm_Rx0_AntB 0xbec -+#define rPm_Rx1_AntB 0xbf0 -+#define rPm_Rx2_AntB 0xbf4 -+#define rPm_Rx3_AntB 0xbf8 -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8188FPwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188FPwrSeq.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8188FPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8188FPwrSeq.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,198 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8188F -+#define REALTEK_POWER_SEQUENCE_8188F -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WM-20130815-JackieLau-RTL8188F_Power_Architecture v08.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8188F_TRANS_CARDEMU_TO_ACT_STEPS 13 -+#define RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8188F_TRANS_CARDEMU_TO_SUS_STEPS 14 -+#define RTL8188F_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8188F_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8188F_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8188F_TRANS_ACT_TO_LPS_STEPS 11 -+#define RTL8188F_TRANS_LPS_TO_ACT_STEPS 13 -+#define RTL8188F_TRANS_ACT_TO_SWLPS_STEPS 21 -+#define RTL8188F_TRANS_SWLPS_TO_ACT_STEPS 14 -+#define RTL8188F_TRANS_END_STEPS 1 -+ -+ -+#define RTL8188F_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT3), 0},/* 0x4[11]=1'b0 disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* 0x4[8]=1 polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ {0x0027, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x35}, /*0x27<=35 to reduce RF noise*/ -+ -+#define RTL8188F_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ -+ {0x0027, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x34}, /*0x27 <= 34, xtal_qsel = 0 to xtal bring up*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ -+#define RTL8188F_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00}, /*0x07 = 0x00 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ \ -+ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/* 0xC4[4] <= 1, turn off USB APHY LDO under suspend mode*/ -+ -+#define RTL8188F_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ \ -+ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0},/* 0xC4[4] <= 1, turn off USB APHY LDO under suspend mode*/ -+ -+#define RTL8188F_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00}, /*0x07 = 0x00 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ \ -+ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/* 0xC4[4] <= 1, turn off USB APHY LDO under suspend mode*/ -+ -+#define RTL8188F_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ \ -+ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0},/* 0xC4[4] <= 1, turn off USB APHY LDO under suspend mode*/ -+ -+ -+#define RTL8188F_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8188F_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8188F_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0139, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*set RPWM IMR*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ -+ -+ -+#define RTL8188F_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0027, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x35},/*xtal_qsel = 1 for low noise*/ \ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x002B, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x1c, 0x1c}, /*. 0x2b[4:2] = 3b'111 to enable BB, AFE clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+ -+#define RTL8188F_TRANS_ACT_TO_SWLPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0139, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*set RPWM IMR*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ {0x002b, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x1C, 0x00},/*0x2b[4:2]<=0 to gated BB, AFE clock*/ \ -+ {0x0027, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x34},/*xtal_qsel = 0 for bring up*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x00},/* sdio LPS option*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0x83},/* usb LPS option, open bandgap, xtal*/ \ -+ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0}, /* 0xC4[5]<=0, digital LDO no standby mode*/ \ -+ {0x00C4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7}, /* 0xC4[7]<=1, on domain voltage adjust*/ \ -+ {0x00a7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0xe0}, /* low power LPS enable for sdio*/ \ -+ {0x00a7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xff, 0xe4}, /* low power LPS enable for usb*/ \ -+ {0x0090, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /* enable WL_LPS_EN*/ -+ -+ -+#define RTL8188F_TRANS_SWLPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/*polling TSF stable*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1, enable security engine*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x06B7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x09}, /*. reset MAC rx state machine*/\ -+ {0x06B4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x86}, /*. reset MAC rx state machine*/\ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/* set CPU RAM code ready*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*Reset CPU IO Wrapper*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* Enable CPU*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*enable CPU IO Wrapper*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2},/* Enable CPU*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, BIT7},/*polling FW init ready */ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT6, BIT6},/*polling FW init ready */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8188F_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, -+ -+ -+ extern WLAN_PWR_CFG rtl8188F_power_on_flow[RTL8188F_TRANS_CARDEMU_TO_ACT_STEPS + RTL8188F_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188F_radio_off_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188F_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188F_card_disable_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188F_TRANS_CARDEMU_TO_PDN_STEPS + RTL8188F_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188F_card_enable_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188F_TRANS_CARDEMU_TO_PDN_STEPS + RTL8188F_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188F_suspend_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188F_TRANS_CARDEMU_TO_SUS_STEPS + RTL8188F_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188F_resume_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188F_TRANS_CARDEMU_TO_SUS_STEPS + RTL8188F_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188F_hwpdn_flow[RTL8188F_TRANS_ACT_TO_CARDEMU_STEPS + RTL8188F_TRANS_CARDEMU_TO_PDN_STEPS + RTL8188F_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188F_enter_lps_flow[RTL8188F_TRANS_ACT_TO_LPS_STEPS + RTL8188F_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188F_leave_lps_flow[RTL8188F_TRANS_LPS_TO_ACT_STEPS + RTL8188F_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188F_enter_swlps_flow[RTL8188F_TRANS_ACT_TO_SWLPS_STEPS + RTL8188F_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8188F_leave_swlps_flow[RTL8188F_TRANS_SWLPS_TO_ACT_STEPS + RTL8188F_TRANS_END_STEPS]; -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8192EPhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8192EPhyCfg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8192EPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8192EPhyCfg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,153 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8192EPHYCFG_H__ -+#define __INC_HAL8192EPHYCFG_H__ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 /* us */ -+#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+#ifdef CONFIG_PCI_HCI -+ #define MAX_AGGR_NUM 0x0B -+#else -+ #define MAX_AGGR_NUM 0x07 -+#endif /* CONFIG_PCI_HCI */ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+/* BB/RF related */ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/*------------------------Export global variable----------------------------*/ -+/*------------------------Export global variable----------------------------*/ -+ -+ -+/*------------------------Export Marco Definition---------------------------*/ -+/*------------------------Export Marco Definition---------------------------*/ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+/* -+ * BB and RF register read/write -+ * */ -+u32 PHY_QueryBBReg8192E(IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask); -+void PHY_SetBBReg8192E(IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data); -+u32 PHY_QueryRFReg8192E(IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask); -+void PHY_SetRFReg8192E(IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data); -+ -+/* -+ * Initialization related function -+ * -+ * MAC/BB/RF HAL config */ -+int PHY_MACConfig8192E(IN PADAPTER Adapter); -+int PHY_BBConfig8192E(IN PADAPTER Adapter); -+int PHY_RFConfig8192E(IN PADAPTER Adapter); -+ -+/* RF config */ -+ -+ -+/* -+ * BB TX Power R/W -+ * */ -+void PHY_GetTxPowerLevel8192E(IN PADAPTER Adapter, OUT s32 *powerlevel); -+void PHY_SetTxPowerLevel8192E(IN PADAPTER Adapter, IN u8 channel); -+BOOLEAN PHY_UpdateTxPowerDbm8192E(IN PADAPTER Adapter, IN int powerInDbm); -+ -+VOID -+PHY_SetTxPowerIndex_8192E( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+); -+ -+u8 -+PHY_GetTxPowerIndex_8192E( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN u8 BandWidth, -+ IN u8 Channel, -+ struct txpwr_idx_comp *tic -+); -+ -+/* -+ * channel switch related funciton -+ * */ -+VOID -+PHY_SetSwChnlBWMode8192E( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+VOID -+PHY_SetRFEReg_8192E( -+ IN PADAPTER Adapter -+); -+ -+void -+phy_SpurCalibration_8192E( -+ IN PADAPTER Adapter, -+ IN SPUR_CAL_METHOD Method -+); -+void PHY_SpurCalibration_8192E(IN PADAPTER Adapter); -+ -+#ifdef CONFIG_SPUR_CAL_NBI -+void -+phy_SpurCalibration_8192E_NBI( -+ IN PADAPTER Adapter -+); -+#endif -+/* -+ * BB/MAC/RF other monitor API -+ * */ -+ -+VOID -+PHY_SetRFPathSwitch_8192E( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bMain -+); -+ -+/*--------------------------Exported Function prototype---------------------*/ -+#endif /* __INC_HAL8192CPHYCFG_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8192EPhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8192EPhyReg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8192EPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8192EPhyReg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,1132 @@ -+/***************************************************************************** -+ * Copyright(c) 2008, RealTEK Technology Inc. All Right Reserved. -+ * -+ * Module: __INC_HAL8192SPHYREG_H -+ * -+ * -+ * Note: 1. Define PMAC/BB register map -+ * 2. Define RF register map -+ * 3. PMAC/BB register bit mask. -+ * 4. RF reg bit mask. -+ * 5. Other BB/RF relative definition. -+ * -+ * -+ * Export: Constants, macro, functions(API), global variables(None). -+ * -+ * Abbrev: -+ * -+ * History: -+ * Data Who Remark -+ * 08/07/2007 MHC 1. Porting from 9x series PHYCFG.h. -+ * 2. Reorganize code architecture. -+ * 09/25/2008 MH 1. Add RL6052 register definition -+ * -+ *****************************************************************************/ -+#ifndef __INC_HAL8192EPHYREG_H -+#define __INC_HAL8192EPHYREG_H -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+/* ************************************************************ -+ * 8192S Regsiter offset definition -+ * ************************************************************ */ -+ -+/* -+ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+ * 3. RF register 0x00-2E -+ * 4. Bit Mask for BB/RF register -+ * 5. Other defintion for BB/RF R/W -+ * */ -+ -+ -+/* -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 1. Page1(0x100) -+ * */ -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+ -+/* -+ * 3. Page8(0x800) -+ * */ -+#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA0_TxInfo 0x804 /* Status report?? */ -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ -+ -+#define rFPGA0_RFTiming1 0x810 /* Useless now */ -+#define rFPGA0_RFTiming2 0x814 -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 -+#define rFPGA0_AdDaClockEn 0x888 /* enable ad/da clock1 for dual-phy */ -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 /* Useless now */ -+#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ -+#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ -+ -+/* -+ * 4. Page9(0x900) -+ * */ -+#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA1_TxBlock 0x904 /* Useless now */ -+#define rFPGA1_DebugSelect 0x908 /* Useless now */ -+#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ -+ -+/* -+ * 5. PageA(0xA00) -+ * -+ * Set Control channel to upper or lower. These settings are required only for 40MHz */ -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ -+#define rCCK0_CCA 0xa08 /* Disable init gain now */ /* Init gain */ -+ -+#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level */ /* Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ -+#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ -+#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ -+#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 /* 0xa57 */ -+#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ -+#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ -+ -+/* -+ * PageB(0xB00) -+ * */ -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_ram64x16 0xb2c -+ -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rConfig_Pmpd_AntB 0xb98 -+#define rAPK 0xbd8 -+ -+ -+ -+/* -+ * 6. PageC(0xC00) -+ * */ -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ -+#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ -+#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ -+#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ -+#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ -+ -+#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ -+#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ -+#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ -+#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ -+ -+#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+ -+/* -+ * 7. PageD(0xD00) -+ * */ -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 /* No setting now */ -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ -+#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ -+#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ -+ -+#define rOFDM_ShortCFOAB 0xdac /* No setting now */ -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+/* -+ * 8. PageE(0xE00) -+ * */ -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+/* -+ * 7. RF Register 0x00-0x2E (RF 8256) -+ * RF-0222D 0x00-3F -+ * -+ * Zebra1 */ -+#define rZebra1_HSSIEnable 0x0 /* Useless now */ -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+#define rZebra1_Channel 0x7 /* RF channel switch */ -+ -+/* #endif */ -+#define rZebra1_TxGain 0x8 /* Useless now */ -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+/* Zebra4 */ -+#define rGlobalCtrl 0 /* Useless now */ -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+/* RTL8258 */ -+#define rRTL8258_TxLPF 0x11 /* Useless now */ -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+/* -+ * RL6052 Register definition -+ * */ -+#define RF_AC 0x00 /* */ -+ -+#define RF_IQADJ_G1 0x01 /* */ -+#define RF_IQADJ_G2 0x02 /* */ -+ -+#define RF_POW_TRSW 0x05 /* */ -+ -+#define RF_GAIN_RX 0x06 /* */ -+#define RF_GAIN_TX 0x07 /* */ -+ -+#define RF_TXM_IDAC 0x08 /* */ -+#define RF_IPA_G 0x09 /* */ -+#define RF_TXBIAS_G 0x0A -+#define RF_TXPA_AG 0x0B -+#define RF_IPA_A 0x0C /* */ -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_BS_IQGEN 0x0F /* */ -+ -+#define RF_MODE1 0x10 /* */ -+#define RF_MODE2 0x11 /* */ -+ -+#define RF_RX_AGC_HP 0x12 /* */ -+#define RF_TX_AGC 0x13 /* */ -+#define RF_BIAS 0x14 /* */ -+#define RF_IPA 0x15 /* */ -+#define RF_TXBIAS 0x16 -+#define RF_POW_ABILITY 0x17 /* */ -+#define RF_CHNLBW 0x18 /* RF channel and BW switch */ -+#define RF_TOP 0x19 /* */ -+ -+#define RF_RX_G1 0x1A /* */ -+#define RF_RX_G2 0x1B /* */ -+ -+#define RF_RX_BB2 0x1C /* */ -+#define RF_RX_BB1 0x1D /* */ -+ -+#define RF_RCK1 0x1E /* */ -+#define RF_RCK2 0x1F /* */ -+ -+#define RF_TX_G1 0x20 /* */ -+#define RF_TX_G2 0x21 /* */ -+#define RF_TX_G3 0x22 /* */ -+ -+#define RF_TX_BB1 0x23 /* */ -+ -+#define RF_T_METER_8192E 0x42 /* */ -+#define RF_T_METER_88E 0x42 -+#define RF_T_METER 0x24 /* */ -+ -+/* #endif */ -+ -+#define RF_SYN_G1 0x25 /* RF TX Power control */ -+#define RF_SYN_G2 0x26 /* RF TX Power control */ -+#define RF_SYN_G3 0x27 /* RF TX Power control */ -+#define RF_SYN_G4 0x28 /* RF TX Power control */ -+#define RF_SYN_G5 0x29 /* RF TX Power control */ -+#define RF_SYN_G6 0x2A /* RF TX Power control */ -+#define RF_SYN_G7 0x2B /* RF TX Power control */ -+#define RF_SYN_G8 0x2C /* RF TX Power control */ -+ -+#define RF_RCK_OS 0x30 /* RF TX PA control */ -+#define RF_TXPA_G1 0x31 /* RF TX PA control */ -+#define RF_TXPA_G2 0x32 /* RF TX PA control */ -+#define RF_TXPA_G3 0x33 /* RF TX PA control */ -+#define RF_TX_BIAS_A 0x35 -+#define RF_TX_BIAS_D 0x36 -+#define RF_LOBF_9 0x38 -+#define RF_RXRF_A3 0x3C /* */ -+#define RF_TRSW 0x3F -+ -+#define RF_TXRF_A2 0x41 -+#define RF_TXPA_G4 0x46 -+#define RF_TXPA_A4 0x4B -+#define RF_0x52 0x52 -+#define RF_LDO 0xB1 -+#define RF_WE_LUT 0xEF -+ -+ -+/* -+ * Bit Mask -+ * -+ * 1. Page1(0x100) */ -+#define bBBResetB 0x100 /* Useless now? */ -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+#define RF_TX_GAIN_OFFSET_8192E(_val) ((abs((_val)) << 1) | (((_val) > 0) ? BIT0 : 0)) -+ -+ -+/* 2. Page8(0x800) */ -+#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 /* Useless now */ -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bAntennaSelect 0x0300 -+ -+#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 /* Useless now */ -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf /* Reg0x814 */ -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 /* T2R */ -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 /* chane gain at continue Tx */ -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 /* Useless now -+ * #define bHWSISelect 0x8 */ -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ -+ -+#define bRFSI_TRSW 0x20 /* Useless now */ -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+ -+#define bLSSIReadAddress 0x7f800000 /* T65 RF */ -+ -+#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ -+ -+#define bLSSIReadBackData 0xfffff /* T65 RF */ -+ -+#define bLSSIReadOKFlag 0x1000 /* Useless now */ -+#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ -+ -+#define b80MClkDelay 0x18000000 /* Useless */ -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 /* Useless */ -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+/* 3. Page9(0x900) */ -+#define bOFDMTxSC 0x30000000 /* Useless */ -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ -+#define bDebugItem 0xff /* reset debug page and LWord */ -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+/* 4. PageA(0xA00) */ -+#define bCCKBBMode 0x3 /* Useless */ -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ -+ -+#define bCCKScramble 0x8 /* Useless */ -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ -+#define bCCKFixedRxAGC 0x8000 -+/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+/* 5. PageC(0xC00) */ -+#define bNumOfSTF 0x3 /* Useless */ -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 /* the threshold for high power */ -+#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+/* #define bRxMF_Hold 0x3800 */ -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+/* 6. PageE(0xE00) */ -+#define bSTBCEn 0x4 /* Useless */ -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+/* #define bRxPath1 0x01 */ -+/* #define bRxPath2 0x02 */ -+/* #define bRxPath3 0x04 */ -+/* #define bRxPath4 0x08 */ -+/* #define bTxPath1 0x10 */ -+/* #define bTxPath2 0x20 */ -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 /* total */ -+#define bShortCFOFLength 11 /* fraction */ -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf /* Useless */ -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 /* Useless */ -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 /* Useless */ -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+/* Rx Pseduo noise */ -+#define bRxPesudoNoiseOn 0x20000000 /* Useless */ -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+/* 7. RF Register -+ * Zebra1 */ -+#define bZebra1_HSSIEnable 0x8 /* Useless */ -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+/* Zebra4 */ -+#define bRTL8256RegModeCtrl1 0x100 /* Useless */ -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+/* RTL8258 */ -+#define bRTL8258_TxLPFBW 0xc /* Useless */ -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+/* -+ * Other Definition -+ * */ -+ -+/* byte endable for sb_write */ -+#define bByte0 0x1 /* Useless */ -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+/* for PutRegsetting & GetRegSetting BitMask */ -+#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+/* for PutRFRegsetting & GetRFRegSetting BitMask -+ * #define bMask12Bits 0xfffff */ /* RF Reg mask bits -+ * #define bMask20Bits 0xfffff */ /* RF Reg mask bits T65 RF */ -+#define bRFRegOffsetMask 0xfffff -+ -+#define bEnable 0x1 /* Useless */ -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 /* Useless */ -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 /* 500ms */ /* Useless */ -+#define tUpdateRxCounter 100 /* 100ms */ -+ -+#define rateCCK 0 /* Useless */ -+#define rateOFDM 1 -+#define rateHT 2 -+ -+/* define Register-End */ -+#define bPMAC_End 0x1ff /* Useless */ -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+/* define max debug item in each debug page -+ * #define bMaxItem_FPGA_PHY0 0x9 -+ * #define bMaxItem_FPGA_PHY1 0x3 -+ * #define bMaxItem_PHY_11B 0x16 -+ * #define bMaxItem_OFDM_PHY0 0x29 -+ * #define bMaxItem_OFDM_PHY1 0x0 */ -+ -+#define bPMACControl 0x0 /* Useless */ -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#define PathA 0x0 /* Useless */ -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+ -+/* RSSI Dump Message */ -+#define rA_RSSIDump_92E 0xcb0 -+#define rB_RSSIDump_92E 0xcb1 -+#define rS1_RXevmDump_92E 0xcb2 -+#define rS2_RXevmDump_92E 0xcb3 -+#define rA_RXsnrDump_92E 0xcb4 -+#define rB_RXsnrDump_92E 0xcb5 -+#define rA_CfoShortDump_92E 0xcb6 -+#define rB_CfoShortDump_92E 0xcb8 -+#define rA_CfoLongDump_92E 0xcba -+#define rB_CfoLongDump_92E 0xcbc -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+#endif /* __INC_HAL8188EPHYREG_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8192EPwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8192EPwrSeq.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8192EPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8192EPwrSeq.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,155 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8192E -+#define REALTEK_POWER_SEQUENCE_8192E -+ -+#include "HalPwrSeqCmd.h" -+/* -+ Check document WM-20110607-Paul-RTL8192E_Power_Architecture-R02.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8192E_TRANS_CARDEMU_TO_ACT_STEPS 18 -+#define RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS 18 -+#define RTL8192E_TRANS_CARDEMU_TO_SUS_STEPS 18 -+#define RTL8192E_TRANS_SUS_TO_CARDEMU_STEPS 18 -+#define RTL8192E_TRANS_CARDEMU_TO_PDN_STEPS 18 -+#define RTL8192E_TRANS_PDN_TO_CARDEMU_STEPS 18 -+#define RTL8192E_TRANS_ACT_TO_LPS_STEPS 23 -+#define RTL8192E_TRANS_LPS_TO_ACT_STEPS 23 -+#define RTL8192E_TRANS_END_STEPS 1 -+ -+ -+#define RTL8192E_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3), 0},/* disable WL suspend*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ -+ -+#define RTL8192E_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ -+ -+#define RTL8192E_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4 | BIT3, (BIT4 | BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8192E_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8192E_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ -+ {0x00CC, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*Unlock small LDO Register*/ \ -+ {0x0011, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*Disable small LDO*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8192E_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0011, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*Enable small LDO*/ \ -+ {0x00CC, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*Lock small LDO Register*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ -+ -+#define RTL8192E_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8192E_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8192E_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8192E_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM, For Repeatly In and out, Taggle bit should be changed*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/\ -+ {0x013D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*Clear ISR*/ -+ -+#define RTL8192E_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, -+ -+ -+ extern WLAN_PWR_CFG rtl8192E_power_on_flow[RTL8192E_TRANS_CARDEMU_TO_ACT_STEPS + RTL8192E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8192E_radio_off_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8192E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8192E_card_disable_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8192E_TRANS_CARDEMU_TO_PDN_STEPS + RTL8192E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8192E_card_enable_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8192E_TRANS_CARDEMU_TO_PDN_STEPS + RTL8192E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8192E_suspend_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8192E_TRANS_CARDEMU_TO_SUS_STEPS + RTL8192E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8192E_resume_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8192E_TRANS_CARDEMU_TO_SUS_STEPS + RTL8192E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8192E_hwpdn_flow[RTL8192E_TRANS_ACT_TO_CARDEMU_STEPS + RTL8192E_TRANS_CARDEMU_TO_PDN_STEPS + RTL8192E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8192E_enter_lps_flow[RTL8192E_TRANS_ACT_TO_LPS_STEPS + RTL8192E_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8192E_leave_lps_flow[RTL8192E_TRANS_LPS_TO_ACT_STEPS + RTL8192E_TRANS_END_STEPS]; -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8703BPhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8703BPhyCfg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8703BPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8703BPhyCfg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,137 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8703BPHYCFG_H__ -+#define __INC_HAL8703BPHYCFG_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 /* us */ -+#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+#ifdef CONFIG_PCI_HCI -+ #define MAX_AGGR_NUM 0x0B -+#else -+ #define MAX_AGGR_NUM 0x07 -+#endif /* CONFIG_PCI_HCI */ -+ -+ -+/*--------------------------Define Parameters End-------------------------------*/ -+ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+/*------------------------------Define structure End----------------------------*/ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+u32 -+PHY_QueryBBReg_8703B( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask -+); -+ -+VOID -+PHY_SetBBReg_8703B( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+); -+ -+u32 -+PHY_QueryRFReg_8703B( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask -+); -+ -+VOID -+PHY_SetRFReg_8703B( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+); -+ -+/* MAC/BB/RF HAL config */ -+int PHY_BBConfig8703B(PADAPTER Adapter); -+ -+int PHY_RFConfig8703B(PADAPTER Adapter); -+ -+s32 PHY_MACConfig8703B(PADAPTER padapter); -+ -+int -+PHY_ConfigRFWithParaFile_8703B( -+ IN PADAPTER Adapter, -+ IN u8 *pFileName, -+ RF_PATH eRFPath -+); -+ -+VOID -+PHY_SetTxPowerIndex_8703B( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+); -+ -+u8 -+PHY_GetTxPowerIndex_8703B( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN u8 BandWidth, -+ IN u8 Channel, -+ struct txpwr_idx_comp *tic -+); -+ -+VOID -+PHY_GetTxPowerLevel8703B( -+ IN PADAPTER Adapter, -+ OUT s32 *powerlevel -+); -+ -+VOID -+PHY_SetTxPowerLevel8703B( -+ IN PADAPTER Adapter, -+ IN u8 channel -+); -+ -+VOID -+PHY_SetSwChnlBWMode8703B( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+VOID PHY_SetRFPathSwitch_8703B( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bMain -+); -+ -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8703BPhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8703BPhyReg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8703BPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8703BPhyReg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,1138 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8703BPHYREG_H__ -+#define __INC_HAL8703BPHYREG_H__ -+ -+#define rSYM_WLBT_PAPE_SEL 0x64 -+/* -+ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+ * 3. RF register 0x00-2E -+ * 4. Bit Mask for BB/RF register -+ * 5. Other defintion for BB/RF R/W -+ * */ -+ -+ -+/* -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 1. Page1(0x100) -+ * */ -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+/* -+ * 2. Page2(0x200) -+ * -+ * The following two definition are only used for USB interface. */ -+#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ -+#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ -+ -+/* -+ * 3. Page8(0x800) -+ * */ -+#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA0_TxInfo 0x804 /* Status report?? */ -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ -+ -+#define rFPGA0_RFTiming1 0x810 /* Useless now */ -+#define rFPGA0_RFTiming2 0x814 -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+ -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 /* Useless now */ -+#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ -+#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ -+ -+/* -+ * 4. Page9(0x900) -+ * */ -+#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ -+#define rFPGA1_TxBlock 0x904 /* Useless now */ -+#define rFPGA1_DebugSelect 0x908 /* Useless now */ -+#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ -+#define rDPDT_control 0x92c -+#define rfe_ctrl_anta_src 0x930 -+#define rS0S1_PathSwitch 0x948 -+#define rBBrx_DFIR 0x954 -+ -+/* -+ * 5. PageA(0xA00) -+ * -+ * Set Control channel to upper or lower. These settings are required only for 40MHz */ -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ -+#define rCCK0_CCA 0xa08 /* Disable init gain now */ /* Init gain */ -+ -+#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level */ /* Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ -+#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ -+#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ -+#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 /* 0xa57 */ -+#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ -+#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ -+ -+/* -+ * PageB(0xB00) -+ * */ -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rPdp_AntA_8 0xb08 -+#define rPdp_AntA_C 0xb0c -+#define rPdp_AntA_10 0xb10 -+#define rPdp_AntA_14 0xb14 -+#define rPdp_AntA_18 0xb18 -+#define rPdp_AntA_1C 0xb1c -+#define rPdp_AntA_20 0xb20 -+#define rPdp_AntA_24 0xb24 -+ -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_ram64x16 0xb2c -+ -+#define rBndA 0xb30 -+#define rHssiPar 0xb34 -+ -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+ -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rPdp_AntB_8 0xb78 -+#define rPdp_AntB_C 0xb7c -+#define rPdp_AntB_10 0xb80 -+#define rPdp_AntB_14 0xb84 -+#define rPdp_AntB_18 0xb88 -+#define rPdp_AntB_1C 0xb8c -+#define rPdp_AntB_20 0xb90 -+#define rPdp_AntB_24 0xb94 -+ -+#define rConfig_Pmpd_AntB 0xb98 -+ -+#define rBndB 0xba0 -+ -+#define rAPK 0xbd8 -+#define rPm_Rx0_AntA 0xbdc -+#define rPm_Rx1_AntA 0xbe0 -+#define rPm_Rx2_AntA 0xbe4 -+#define rPm_Rx3_AntA 0xbe8 -+#define rPm_Rx0_AntB 0xbec -+#define rPm_Rx1_AntB 0xbf0 -+#define rPm_Rx2_AntB 0xbf4 -+#define rPm_Rx3_AntB 0xbf8 -+/* -+ * 6. PageC(0xC00) -+ * */ -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ -+#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ -+#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ -+#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ -+#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ -+ -+#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ -+#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ -+#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ -+#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ -+ -+#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+/* -+ * 7. PageD(0xD00) -+ * */ -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 /* No setting now */ -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ -+#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ -+#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ -+ -+#define rOFDM_ShortCFOAB 0xdac /* No setting now */ -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+/* -+ * 8. PageE(0xE00) -+ * */ -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+/* -+ * 7. RF Register 0x00-0x2E (RF 8256) -+ * RF-0222D 0x00-3F -+ * -+ * Zebra1 */ -+#define rZebra1_HSSIEnable 0x0 /* Useless now */ -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+#define rZebra1_Channel 0x7 /* RF channel switch */ -+ -+/* #endif */ -+#define rZebra1_TxGain 0x8 /* Useless now */ -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+/* Zebra4 */ -+#define rGlobalCtrl 0 /* Useless now */ -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+/* RTL8258 */ -+#define rRTL8258_TxLPF 0x11 /* Useless now */ -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+/* -+ * RL6052 Register definition -+ * */ -+#define RF_AC 0x00 /* */ -+ -+#define RF_IQADJ_G1 0x01 /* */ -+#define RF_IQADJ_G2 0x02 /* */ -+#define RF_BS_PA_APSET_G1_G4 0x03 -+#define RF_BS_PA_APSET_G5_G8 0x04 -+#define RF_POW_TRSW 0x05 /* */ -+ -+#define RF_GAIN_RX 0x06 /* */ -+#define RF_GAIN_TX 0x07 /* */ -+ -+#define RF_TXM_IDAC 0x08 /* */ -+#define RF_IPA_G 0x09 /* */ -+#define RF_TXBIAS_G 0x0A -+#define RF_TXPA_AG 0x0B -+#define RF_IPA_A 0x0C /* */ -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_BS_IQGEN 0x0F /* */ -+ -+#define RF_MODE1 0x10 /* */ -+#define RF_MODE2 0x11 /* */ -+ -+#define RF_RX_AGC_HP 0x12 /* */ -+#define RF_TX_AGC 0x13 /* */ -+#define RF_BIAS 0x14 /* */ -+#define RF_IPA 0x15 /* */ -+#define RF_TXBIAS 0x16 -+#define RF_POW_ABILITY 0x17 /* */ -+#define RF_MODE_AG 0x18 /* */ -+#define rRfChannel 0x18 /* RF channel and BW switch */ -+#define RF_CHNLBW 0x18 /* RF channel and BW switch */ -+#define RF_TOP 0x19 /* */ -+ -+#define RF_RX_G1 0x1A /* */ -+#define RF_RX_G2 0x1B /* */ -+ -+#define RF_RX_BB2 0x1C /* */ -+#define RF_RX_BB1 0x1D /* */ -+ -+#define RF_RCK1 0x1E /* */ -+#define RF_RCK2 0x1F /* */ -+ -+#define RF_TX_G1 0x20 /* */ -+#define RF_TX_G2 0x21 /* */ -+#define RF_TX_G3 0x22 /* */ -+ -+#define RF_TX_BB1 0x23 /* */ -+ -+#define RF_T_METER 0x24 /* */ -+ -+#define RF_SYN_G1 0x25 /* RF TX Power control */ -+#define RF_SYN_G2 0x26 /* RF TX Power control */ -+#define RF_SYN_G3 0x27 /* RF TX Power control */ -+#define RF_SYN_G4 0x28 /* RF TX Power control */ -+#define RF_SYN_G5 0x29 /* RF TX Power control */ -+#define RF_SYN_G6 0x2A /* RF TX Power control */ -+#define RF_SYN_G7 0x2B /* RF TX Power control */ -+#define RF_SYN_G8 0x2C /* RF TX Power control */ -+ -+#define RF_RCK_OS 0x30 /* RF TX PA control */ -+ -+#define RF_TXPA_G1 0x31 /* RF TX PA control */ -+#define RF_TXPA_G2 0x32 /* RF TX PA control */ -+#define RF_TXPA_G3 0x33 /* RF TX PA control */ -+#define RF_TX_BIAS_A 0x35 -+#define RF_TX_BIAS_D 0x36 -+#define RF_LOBF_9 0x38 -+#define RF_RXRF_A3 0x3C /* */ -+#define RF_TRSW 0x3F -+ -+#define RF_TXRF_A2 0x41 -+#define RF_TXPA_G4 0x46 -+#define RF_TXPA_A4 0x4B -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+#define RF_S0S1 0xB0 -+ -+/* -+ * Bit Mask -+ * -+ * 1. Page1(0x100) */ -+#define bBBResetB 0x100 /* Useless now? */ -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+#define RF_TX_GAIN_OFFSET_8703B(_val) (abs((_val)) | (((_val) > 0) ? BIT5 : 0)) -+ -+/* 2. Page8(0x800) */ -+#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 /* Useless now */ -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bAntennaSelect 0x0300 -+ -+#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 /* Useless now */ -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf /* Reg0x814 */ -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 /* T2R */ -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 /* chane gain at continue Tx */ -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 /* Useless now -+ * #define bHWSISelect 0x8 */ -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ -+ -+#define bRFSI_TRSW 0x20 /* Useless now */ -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+ -+#define bLSSIReadAddress 0x7f800000 /* T65 RF */ -+ -+#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ -+ -+#define bLSSIReadBackData 0xfffff /* T65 RF */ -+ -+#define bLSSIReadOKFlag 0x1000 /* Useless now */ -+#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ -+ -+#define b80MClkDelay 0x18000000 /* Useless */ -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 /* Useless */ -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+/* 3. Page9(0x900) */ -+#define bOFDMTxSC 0x30000000 /* Useless */ -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ -+#define bDebugItem 0xff /* reset debug page and LWord */ -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+/* 4. PageA(0xA00) */ -+#define bCCKBBMode 0x3 /* Useless */ -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ -+ -+#define bCCKScramble 0x8 /* Useless */ -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ -+#define bCCKFixedRxAGC 0x8000 -+/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+/* 5. PageC(0xC00) */ -+#define bNumOfSTF 0x3 /* Useless */ -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 /* the threshold for high power */ -+#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+/* #define bRxMF_Hold 0x3800 */ -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+/* 6. PageE(0xE00) */ -+#define bSTBCEn 0x4 /* Useless */ -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+/* #define bRxPath1 0x01 */ -+/* #define bRxPath2 0x02 */ -+/* #define bRxPath3 0x04 */ -+/* #define bRxPath4 0x08 */ -+/* #define bTxPath1 0x10 */ -+/* #define bTxPath2 0x20 */ -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 /* total */ -+#define bShortCFOFLength 11 /* fraction */ -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf /* Useless */ -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 /* Useless */ -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 /* Useless */ -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+/* Rx Pseduo noise */ -+#define bRxPesudoNoiseOn 0x20000000 /* Useless */ -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+/* 7. RF Register -+ * Zebra1 */ -+#define bZebra1_HSSIEnable 0x8 /* Useless */ -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+/* Zebra4 */ -+#define bRTL8256RegModeCtrl1 0x100 /* Useless */ -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+/* RTL8258 */ -+#define bRTL8258_TxLPFBW 0xc /* Useless */ -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+/* -+ * Other Definition -+ * */ -+ -+/* byte endable for sb_write */ -+#define bByte0 0x1 /* Useless */ -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+/* for PutRegsetting & GetRegSetting BitMask */ -+#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+#define bEnable 0x1 /* Useless */ -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 /* Useless */ -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 /* 500ms */ /* Useless */ -+#define tUpdateRxCounter 100 /* 100ms */ -+ -+#define rateCCK 0 /* Useless */ -+#define rateOFDM 1 -+#define rateHT 2 -+ -+/* define Register-End */ -+#define bPMAC_End 0x1ff /* Useless */ -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+/* define max debug item in each debug page -+ * #define bMaxItem_FPGA_PHY0 0x9 -+ * #define bMaxItem_FPGA_PHY1 0x3 -+ * #define bMaxItem_PHY_11B 0x16 -+ * #define bMaxItem_OFDM_PHY0 0x29 -+ * #define bMaxItem_OFDM_PHY1 0x0 */ -+ -+#define bPMACControl 0x0 /* Useless */ -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#define PathA 0x0 /* Useless */ -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8703BPwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8703BPwrSeq.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8703BPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8703BPwrSeq.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,184 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8703B -+#define REALTEK_POWER_SEQUENCE_8703B -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WM-20140402-JackieLau-RTL8703B_Power_Architecture v09.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8703B_TRANS_CARDEMU_TO_ACT_STEPS 23 -+#define RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8703B_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8703B_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8703B_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8703B_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8703B_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8703B_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8703B_TRANS_END_STEPS 1 -+ -+ -+#define RTL8703B_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ -+ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3 | BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[11]=0*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , BIT0},/* Disable USB suspend */ \ -+ {0x0004, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 , BIT3},/* enabled usb resume */ \ -+ {0x0004, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 , 0},/* disable usb resume */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , 0},/* Enable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3), 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/* Enable WL control XTAL setting*/ \ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ -+ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable GPIO9 interrupt mode*/\ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ -+ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ -+ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable HSISR GPIO9 interrupt*/\ -+ {0x0068, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3},/*For GPIO9 internal pull high setting by test chip*/\ -+ {0x0069, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/*For GPIO9 internal pull high setting*/\ -+ -+ -+#define RTL8703B_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/* Enable BT control XTAL setting*/\ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/\ -+ -+ -+#define RTL8703B_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4 | BIT3, (BIT4 | BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8703B_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8703B_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8703B_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8703B_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK | PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8703B_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8703B_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8703B_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8703B_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, -+ -+ -+ extern WLAN_PWR_CFG rtl8703B_power_on_flow[RTL8703B_TRANS_CARDEMU_TO_ACT_STEPS + RTL8703B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8703B_radio_off_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8703B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8703B_card_disable_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8703B_TRANS_CARDEMU_TO_PDN_STEPS + RTL8703B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8703B_card_enable_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8703B_TRANS_CARDEMU_TO_PDN_STEPS + RTL8703B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8703B_suspend_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8703B_TRANS_CARDEMU_TO_SUS_STEPS + RTL8703B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8703B_resume_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8703B_TRANS_CARDEMU_TO_SUS_STEPS + RTL8703B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8703B_hwpdn_flow[RTL8703B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8703B_TRANS_CARDEMU_TO_PDN_STEPS + RTL8703B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8703B_enter_lps_flow[RTL8703B_TRANS_ACT_TO_LPS_STEPS + RTL8703B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8703B_leave_lps_flow[RTL8703B_TRANS_LPS_TO_ACT_STEPS + RTL8703B_TRANS_END_STEPS]; -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723BPhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723BPhyCfg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723BPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723BPhyCfg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,136 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8723BPHYCFG_H__ -+#define __INC_HAL8723BPHYCFG_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 /* us */ -+#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+#ifdef CONFIG_PCI_HCI -+ #define MAX_AGGR_NUM 0x0B -+#else -+ #define MAX_AGGR_NUM 0x07 -+#endif /* CONFIG_PCI_HCI */ -+ -+ -+/*--------------------------Define Parameters End-------------------------------*/ -+ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+/*------------------------------Define structure End----------------------------*/ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+u32 -+PHY_QueryBBReg_8723B( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask -+); -+ -+VOID -+PHY_SetBBReg_8723B( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+); -+ -+u32 -+PHY_QueryRFReg_8723B( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask -+); -+ -+VOID -+PHY_SetRFReg_8723B( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+); -+ -+/* MAC/BB/RF HAL config */ -+int PHY_BBConfig8723B(PADAPTER Adapter); -+ -+int PHY_RFConfig8723B(PADAPTER Adapter); -+ -+s32 PHY_MACConfig8723B(PADAPTER padapter); -+ -+int -+PHY_ConfigRFWithParaFile_8723B( -+ IN PADAPTER Adapter, -+ IN u8 *pFileName, -+ RF_PATH eRFPath -+); -+ -+VOID -+PHY_SetTxPowerIndex_8723B( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+); -+ -+u8 -+PHY_GetTxPowerIndex_8723B( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN u8 BandWidth, -+ IN u8 Channel, -+ struct txpwr_idx_comp *tic -+); -+ -+VOID -+PHY_GetTxPowerLevel8723B( -+ IN PADAPTER Adapter, -+ OUT s32 *powerlevel -+); -+ -+VOID -+PHY_SetTxPowerLevel8723B( -+ IN PADAPTER Adapter, -+ IN u8 channel -+); -+ -+VOID -+PHY_SetSwChnlBWMode8723B( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+VOID PHY_SetRFPathSwitch_8723B( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bMain -+); -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723BPhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723BPhyReg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723BPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723BPhyReg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,1136 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8723BPHYREG_H__ -+#define __INC_HAL8723BPHYREG_H__ -+ -+#define rSYM_WLBT_PAPE_SEL 0x64 -+/* -+ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+ * 3. RF register 0x00-2E -+ * 4. Bit Mask for BB/RF register -+ * 5. Other defintion for BB/RF R/W -+ * */ -+ -+ -+/* -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 1. Page1(0x100) -+ * */ -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+/* -+ * 2. Page2(0x200) -+ * -+ * The following two definition are only used for USB interface. */ -+#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ -+#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ -+ -+/* -+ * 3. Page8(0x800) -+ * */ -+#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA0_TxInfo 0x804 /* Status report?? */ -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ -+ -+#define rFPGA0_RFTiming1 0x810 /* Useless now */ -+#define rFPGA0_RFTiming2 0x814 -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+ -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 /* Useless now */ -+#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ -+#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ -+ -+/* -+ * 4. Page9(0x900) -+ * */ -+#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ -+#define rFPGA1_TxBlock 0x904 /* Useless now */ -+#define rFPGA1_DebugSelect 0x908 /* Useless now */ -+#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ -+#define rDPDT_control 0x92c -+#define rfe_ctrl_anta_src 0x930 -+#define rS0S1_PathSwitch 0x948 -+ -+/* -+ * 5. PageA(0xA00) -+ * -+ * Set Control channel to upper or lower. These settings are required only for 40MHz */ -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ -+#define rCCK0_CCA 0xa08 /* Disable init gain now */ /* Init gain */ -+ -+#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level */ /* Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ -+#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ -+#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ -+#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 /* 0xa57 */ -+#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ -+#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ -+ -+/* -+ * PageB(0xB00) -+ * */ -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rPdp_AntA_8 0xb08 -+#define rPdp_AntA_C 0xb0c -+#define rPdp_AntA_10 0xb10 -+#define rPdp_AntA_14 0xb14 -+#define rPdp_AntA_18 0xb18 -+#define rPdp_AntA_1C 0xb1c -+#define rPdp_AntA_20 0xb20 -+#define rPdp_AntA_24 0xb24 -+ -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_ram64x16 0xb2c -+ -+#define rBndA 0xb30 -+#define rHssiPar 0xb34 -+ -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+ -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rPdp_AntB_8 0xb78 -+#define rPdp_AntB_C 0xb7c -+#define rPdp_AntB_10 0xb80 -+#define rPdp_AntB_14 0xb84 -+#define rPdp_AntB_18 0xb88 -+#define rPdp_AntB_1C 0xb8c -+#define rPdp_AntB_20 0xb90 -+#define rPdp_AntB_24 0xb94 -+ -+#define rConfig_Pmpd_AntB 0xb98 -+ -+#define rBndB 0xba0 -+ -+#define rAPK 0xbd8 -+#define rPm_Rx0_AntA 0xbdc -+#define rPm_Rx1_AntA 0xbe0 -+#define rPm_Rx2_AntA 0xbe4 -+#define rPm_Rx3_AntA 0xbe8 -+#define rPm_Rx0_AntB 0xbec -+#define rPm_Rx1_AntB 0xbf0 -+#define rPm_Rx2_AntB 0xbf4 -+#define rPm_Rx3_AntB 0xbf8 -+/* -+ * 6. PageC(0xC00) -+ * */ -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ -+#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ -+#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ -+#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ -+#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ -+ -+#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ -+#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ -+#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ -+#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ -+ -+#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+/* -+ * 7. PageD(0xD00) -+ * */ -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 /* No setting now */ -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ -+#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ -+#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ -+ -+#define rOFDM_ShortCFOAB 0xdac /* No setting now */ -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+/* -+ * 8. PageE(0xE00) -+ * */ -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+/* -+ * 7. RF Register 0x00-0x2E (RF 8256) -+ * RF-0222D 0x00-3F -+ * -+ * Zebra1 */ -+#define rZebra1_HSSIEnable 0x0 /* Useless now */ -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+#define rZebra1_Channel 0x7 /* RF channel switch */ -+ -+/* #endif */ -+#define rZebra1_TxGain 0x8 /* Useless now */ -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+/* Zebra4 */ -+#define rGlobalCtrl 0 /* Useless now */ -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+/* RTL8258 */ -+#define rRTL8258_TxLPF 0x11 /* Useless now */ -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+/* -+ * RL6052 Register definition -+ * */ -+#define RF_AC 0x00 /* */ -+ -+#define RF_IQADJ_G1 0x01 /* */ -+#define RF_IQADJ_G2 0x02 /* */ -+#define RF_BS_PA_APSET_G1_G4 0x03 -+#define RF_BS_PA_APSET_G5_G8 0x04 -+#define RF_POW_TRSW 0x05 /* */ -+ -+#define RF_GAIN_RX 0x06 /* */ -+#define RF_GAIN_TX 0x07 /* */ -+ -+#define RF_TXM_IDAC 0x08 /* */ -+#define RF_IPA_G 0x09 /* */ -+#define RF_TXBIAS_G 0x0A -+#define RF_TXPA_AG 0x0B -+#define RF_IPA_A 0x0C /* */ -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_BS_IQGEN 0x0F /* */ -+ -+#define RF_MODE1 0x10 /* */ -+#define RF_MODE2 0x11 /* */ -+ -+#define RF_RX_AGC_HP 0x12 /* */ -+#define RF_TX_AGC 0x13 /* */ -+#define RF_BIAS 0x14 /* */ -+#define RF_IPA 0x15 /* */ -+#define RF_TXBIAS 0x16 -+#define RF_POW_ABILITY 0x17 /* */ -+#define RF_MODE_AG 0x18 /* */ -+#define rRfChannel 0x18 /* RF channel and BW switch */ -+#define RF_CHNLBW 0x18 /* RF channel and BW switch */ -+#define RF_TOP 0x19 /* */ -+ -+#define RF_RX_G1 0x1A /* */ -+#define RF_RX_G2 0x1B /* */ -+ -+#define RF_RX_BB2 0x1C /* */ -+#define RF_RX_BB1 0x1D /* */ -+ -+#define RF_RCK1 0x1E /* */ -+#define RF_RCK2 0x1F /* */ -+ -+#define RF_TX_G1 0x20 /* */ -+#define RF_TX_G2 0x21 /* */ -+#define RF_TX_G3 0x22 /* */ -+ -+#define RF_TX_BB1 0x23 /* */ -+ -+#define RF_T_METER 0x24 /* */ -+ -+#define RF_SYN_G1 0x25 /* RF TX Power control */ -+#define RF_SYN_G2 0x26 /* RF TX Power control */ -+#define RF_SYN_G3 0x27 /* RF TX Power control */ -+#define RF_SYN_G4 0x28 /* RF TX Power control */ -+#define RF_SYN_G5 0x29 /* RF TX Power control */ -+#define RF_SYN_G6 0x2A /* RF TX Power control */ -+#define RF_SYN_G7 0x2B /* RF TX Power control */ -+#define RF_SYN_G8 0x2C /* RF TX Power control */ -+ -+#define RF_RCK_OS 0x30 /* RF TX PA control */ -+ -+#define RF_TXPA_G1 0x31 /* RF TX PA control */ -+#define RF_TXPA_G2 0x32 /* RF TX PA control */ -+#define RF_TXPA_G3 0x33 /* RF TX PA control */ -+#define RF_TX_BIAS_A 0x35 -+#define RF_TX_BIAS_D 0x36 -+#define RF_LOBF_9 0x38 -+#define RF_RXRF_A3 0x3C /* */ -+#define RF_TRSW 0x3F -+ -+#define RF_TXRF_A2 0x41 -+#define RF_TXPA_G4 0x46 -+#define RF_TXPA_A4 0x4B -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+#define RF_S0S1 0xB0 -+ -+/* -+ * Bit Mask -+ * -+ * 1. Page1(0x100) */ -+#define bBBResetB 0x100 /* Useless now? */ -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+ -+/* 2. Page8(0x800) */ -+#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 /* Useless now */ -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bAntennaSelect 0x0300 -+ -+#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 /* Useless now */ -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf /* Reg0x814 */ -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 /* T2R */ -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 /* chane gain at continue Tx */ -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 /* Useless now -+ * #define bHWSISelect 0x8 */ -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ -+ -+#define bRFSI_TRSW 0x20 /* Useless now */ -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+ -+#define bLSSIReadAddress 0x7f800000 /* T65 RF */ -+ -+#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ -+ -+#define bLSSIReadBackData 0xfffff /* T65 RF */ -+ -+#define bLSSIReadOKFlag 0x1000 /* Useless now */ -+#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ -+ -+#define b80MClkDelay 0x18000000 /* Useless */ -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 /* Useless */ -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+/* 3. Page9(0x900) */ -+#define bOFDMTxSC 0x30000000 /* Useless */ -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ -+#define bDebugItem 0xff /* reset debug page and LWord */ -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+/* 4. PageA(0xA00) */ -+#define bCCKBBMode 0x3 /* Useless */ -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ -+ -+#define bCCKScramble 0x8 /* Useless */ -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ -+#define bCCKFixedRxAGC 0x8000 -+/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+/* 5. PageC(0xC00) */ -+#define bNumOfSTF 0x3 /* Useless */ -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 /* the threshold for high power */ -+#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+/* #define bRxMF_Hold 0x3800 */ -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+/* 6. PageE(0xE00) */ -+#define bSTBCEn 0x4 /* Useless */ -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+/* #define bRxPath1 0x01 */ -+/* #define bRxPath2 0x02 */ -+/* #define bRxPath3 0x04 */ -+/* #define bRxPath4 0x08 */ -+/* #define bTxPath1 0x10 */ -+/* #define bTxPath2 0x20 */ -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 /* total */ -+#define bShortCFOFLength 11 /* fraction */ -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf /* Useless */ -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 /* Useless */ -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 /* Useless */ -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+/* Rx Pseduo noise */ -+#define bRxPesudoNoiseOn 0x20000000 /* Useless */ -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+/* 7. RF Register -+ * Zebra1 */ -+#define bZebra1_HSSIEnable 0x8 /* Useless */ -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+/* Zebra4 */ -+#define bRTL8256RegModeCtrl1 0x100 /* Useless */ -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+/* RTL8258 */ -+#define bRTL8258_TxLPFBW 0xc /* Useless */ -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+/* -+ * Other Definition -+ * */ -+ -+/* byte endable for sb_write */ -+#define bByte0 0x1 /* Useless */ -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+/* for PutRegsetting & GetRegSetting BitMask */ -+#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+#define bEnable 0x1 /* Useless */ -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 /* Useless */ -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 /* 500ms */ /* Useless */ -+#define tUpdateRxCounter 100 /* 100ms */ -+ -+#define rateCCK 0 /* Useless */ -+#define rateOFDM 1 -+#define rateHT 2 -+ -+/* define Register-End */ -+#define bPMAC_End 0x1ff /* Useless */ -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+/* define max debug item in each debug page -+ * #define bMaxItem_FPGA_PHY0 0x9 -+ * #define bMaxItem_FPGA_PHY1 0x3 -+ * #define bMaxItem_PHY_11B 0x16 -+ * #define bMaxItem_OFDM_PHY0 0x29 -+ * #define bMaxItem_OFDM_PHY1 0x0 */ -+ -+#define bPMACControl 0x0 /* Useless */ -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#define PathA 0x0 /* Useless */ -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723BPwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723BPwrSeq.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723BPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723BPwrSeq.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,232 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8723B -+#define REALTEK_POWER_SEQUENCE_8723B -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WM-20130815-JackieLau-RTL8723B_Power_Architecture v08.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8723B_TRANS_CARDEMU_TO_ACT_STEPS 26 -+#define RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8723B_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8723B_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8723B_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8723B_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8723B_TRANS_ACT_TO_SWLPS_STEPS 22 -+#define RTL8723B_TRANS_SWLPS_TO_ACT_STEPS 15 -+#define RTL8723B_TRANS_END_STEPS 1 -+ -+ -+#define RTL8723B_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ -+ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3 | BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[11]=0*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , BIT0},/* Disable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , 0},/* Enable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3), 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/* Enable WL control XTAL setting*/ \ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ -+ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable GPIO9 interrupt mode*/\ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ -+ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ -+ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable HSISR GPIO9 interrupt*/\ -+ {0x0068, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3},/*For GPIO9 internal pull high setting by test chip*/\ -+ {0x0069, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/*For GPIO9 internal pull high setting*/\ -+ -+ -+#define RTL8723B_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/* Enable BT control XTAL setting*/\ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/\ -+ -+ -+#define RTL8723B_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4 | BIT3, (BIT4 | BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8723B_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8723B_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8723B_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8723B_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK | PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8723B_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8723B_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8723B_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+ -+#define RTL8723B_TRANS_ACT_TO_SWLPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0194, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*enable 32 K source*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1},/*CCK and OFDM are enable*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1},/*CCK and OFDM are enable*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x3F},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*disable security engine*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x40},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*reset dual TSF*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/*Reset CPU*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*Reset MCUFWDL register*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*Reset CPU IO Wrapper*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1},/*Reset CPU IO Wrapper*/ \ -+ {0x0287, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*polling RXFF packet number = 0 */ \ -+ {0x0286, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/*polling RXDMA idle */ \ -+ {0x013D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Clear FW RPWM interrupt */\ -+ {0x0139, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Set FW RPWM interrupt source*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/*switch TSF to 32K*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/*polling TSF stable*/\ -+ {0x0090, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Set FW LPS*/ \ -+ {0x0090, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/*polling FW LPS ready */ -+ -+ -+#define RTL8723B_TRANS_SWLPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0},/*switch TSF to 32K*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/*polling TSF stable*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1, enable security engine*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x06B7, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x09}, /*. reset MAC rx state machine*/\ -+ {0x06B4, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x86}, /*. reset MAC rx state machine*/\ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/* set CPU RAM code ready*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*Reset CPU IO Wrapper*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* Enable CPU*/ \ -+ {0x001D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*enable CPU IO Wrapper*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2},/* Enable CPU*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, BIT7},/*polling FW init ready */ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT6, BIT6},/*polling FW init ready */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8723B_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, -+ -+ -+ extern WLAN_PWR_CFG rtl8723B_power_on_flow[RTL8723B_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723B_radio_off_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723B_card_disable_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723B_card_enable_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723B_suspend_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS + RTL8723B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723B_resume_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723B_TRANS_CARDEMU_TO_SUS_STEPS + RTL8723B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723B_hwpdn_flow[RTL8723B_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723B_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723B_enter_lps_flow[RTL8723B_TRANS_ACT_TO_LPS_STEPS + RTL8723B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723B_leave_lps_flow[RTL8723B_TRANS_LPS_TO_ACT_STEPS + RTL8723B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723B_enter_swlps_flow[RTL8723B_TRANS_ACT_TO_SWLPS_STEPS + RTL8723B_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723B_leave_swlps_flow[RTL8723B_TRANS_SWLPS_TO_ACT_STEPS + RTL8723B_TRANS_END_STEPS]; -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723DPhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723DPhyCfg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723DPhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723DPhyCfg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,136 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8723DPHYCFG_H__ -+#define __INC_HAL8723DPHYCFG_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 /* us */ -+#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+#ifdef CONFIG_PCI_HCI -+ #define MAX_AGGR_NUM 0x0B -+#else -+ #define MAX_AGGR_NUM 0x07 -+#endif /* CONFIG_PCI_HCI */ -+ -+ -+/*--------------------------Define Parameters End-------------------------------*/ -+ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+/*------------------------------Define structure End----------------------------*/ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+u32 -+PHY_QueryBBReg_8723D( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask -+); -+ -+VOID -+PHY_SetBBReg_8723D( -+ IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+); -+ -+u32 -+PHY_QueryRFReg_8723D( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask -+); -+ -+VOID -+PHY_SetRFReg_8723D( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+); -+ -+/* MAC/BB/RF HAL config */ -+int PHY_BBConfig8723D(PADAPTER Adapter); -+ -+int PHY_RFConfig8723D(PADAPTER Adapter); -+ -+s32 PHY_MACConfig8723D(PADAPTER padapter); -+ -+int -+PHY_ConfigRFWithParaFile_8723D( -+ IN PADAPTER Adapter, -+ IN u8 *pFileName, -+ RF_PATH eRFPath -+); -+ -+VOID -+PHY_SetTxPowerIndex_8723D( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+); -+ -+u8 -+PHY_GetTxPowerIndex_8723D( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN u8 BandWidth, -+ IN u8 Channel, -+ struct txpwr_idx_comp *tic -+); -+ -+VOID -+PHY_GetTxPowerLevel8723D( -+ IN PADAPTER Adapter, -+ OUT s32 *powerlevel -+); -+ -+VOID -+PHY_SetTxPowerLevel8723D( -+ IN PADAPTER Adapter, -+ IN u8 channel -+); -+ -+VOID -+PHY_SetSwChnlBWMode8723D( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+VOID PHY_SetRFPathSwitch_8723D( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bMain -+); -+/*--------------------------Exported Function prototype End---------------------*/ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723DPhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723DPhyReg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723DPhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723DPhyReg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,1139 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8723DPHYREG_H__ -+#define __INC_HAL8723DPHYREG_H__ -+ -+#define rSYM_WLBT_PAPE_SEL 0x64 -+/* -+ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+ * 3. RF register 0x00-2E -+ * 4. Bit Mask for BB/RF register -+ * 5. Other definition for BB/RF R/W -+ * */ -+ -+ -+/* -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 1. Page1(0x100) -+ * */ -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+/* -+ * 2. Page2(0x200) -+ * -+ * The following two definition are only used for USB interface. */ -+#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ -+#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ -+ -+/* -+ * 3. Page8(0x800) -+ * */ -+#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC // RF BW Setting?? */ -+ -+#define rFPGA0_TxInfo 0x804 /* Status report?? */ -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ -+ -+#define rFPGA0_RFTiming1 0x810 /* Useless now */ -+#define rFPGA0_RFTiming2 0x814 -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+ -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 /* Useless now */ -+#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ -+#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now // RF Interface Readback Value */ -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ -+ -+/* -+ * 4. Page9(0x900) -+ * */ -+#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC // RF BW Setting?? */ -+#define rFPGA1_TxBlock 0x904 /* Useless now */ -+#define rFPGA1_DebugSelect 0x908 /* Useless now */ -+#define rFPGA1_TxInfo 0x90c /* Useless now // Status report?? */ -+#define rDPDT_control 0x92c -+#define rfe_ctrl_anta_src 0x930 -+#define rS0S1_PathSwitch 0x948 -+#define rBBrx_DFIR 0x954 -+ -+/* -+ * 5. PageA(0xA00) -+ * -+ * Set Control channel to upper or lower. These settings are required only for 40MHz */ -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 /* Disable init gain now // Select RX path by RSSI */ -+#define rCCK0_CCA 0xa08 /* Disable init gain now // Init gain */ -+ -+#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level // Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ -+#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ -+#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ -+#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 /* 0xa57 */ -+#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ -+#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ -+ -+/* -+ * PageB(0xB00) -+ * */ -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rPdp_AntA_8 0xb08 -+#define rPdp_AntA_C 0xb0c -+#define rPdp_AntA_10 0xb10 -+#define rPdp_AntA_14 0xb14 -+#define rPdp_AntA_18 0xb18 -+#define rPdp_AntA_1C 0xb1c -+#define rPdp_AntA_20 0xb20 -+#define rPdp_AntA_24 0xb24 -+ -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_ram64x16 0xb2c -+ -+#define rBndA 0xb30 -+#define rHssiPar 0xb34 -+ -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+ -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rPdp_AntB_8 0xb78 -+#define rPdp_AntB_C 0xb7c -+#define rPdp_AntB_10 0xb80 -+#define rPdp_AntB_14 0xb84 -+#define rPdp_AntB_18 0xb88 -+#define rPdp_AntB_1C 0xb8c -+#define rPdp_AntB_20 0xb90 -+#define rPdp_AntB_24 0xb94 -+ -+#define rConfig_Pmpd_AntB 0xb98 -+ -+#define rBndB 0xba0 -+ -+#define rAPK 0xbd8 -+#define rPm_Rx0_AntA 0xbdc -+#define rPm_Rx1_AntA 0xbe0 -+#define rPm_Rx2_AntA 0xbe4 -+#define rPm_Rx3_AntA 0xbe8 -+#define rPm_Rx0_AntB 0xbec -+#define rPm_Rx1_AntB 0xbf0 -+#define rPm_Rx2_AntB 0xbf4 -+#define rPm_Rx3_AntB 0xbf8 -+/* -+ * 6. PageC(0xC00) -+ * */ -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ -+#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imbalance matrix */ -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD // DM tune init gain */ -+#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ -+#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ -+#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ -+ -+#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ -+#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ -+#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ -+#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ -+ -+#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+/* -+ * 7. PageD(0xD00) -+ * */ -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 /* No setting now */ -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ -+#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ -+#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ -+ -+#define rOFDM_ShortCFOAB 0xdac /* No setting now */ -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+/* -+ * 8. PageE(0xE00) -+ * */ -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+/* -+ * 7. RF Register 0x00-0x2E (RF 8256) -+ * RF-0222D 0x00-3F -+ * -+ * Zebra1 */ -+#define rZebra1_HSSIEnable 0x0 /* Useless now */ -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+#define rZebra1_Channel 0x7 /* RF channel switch */ -+ -+/* #endif */ -+#define rZebra1_TxGain 0x8 /* Useless now */ -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+/* Zebra4 */ -+#define rGlobalCtrl 0 /* Useless now */ -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+/* RTL8258 */ -+#define rRTL8258_TxLPF 0x11 /* Useless now */ -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+/* -+ * RL6052 Register definition -+ * */ -+#define RF_AC 0x00 /* */ -+ -+#define RF_IQADJ_G1 0x01 /* */ -+#define RF_IQADJ_G2 0x02 /* */ -+#define RF_BS_PA_APSET_G1_G4 0x03 -+#define RF_BS_PA_APSET_G5_G8 0x04 -+#define RF_POW_TRSW 0x05 /* */ -+ -+#define RF_GAIN_RX 0x06 /* */ -+#define RF_GAIN_TX 0x07 /* */ -+ -+#define RF_TXM_IDAC 0x08 /* */ -+#define RF_IPA_G 0x09 /* */ -+#define RF_TXBIAS_G 0x0A -+#define RF_TXPA_AG 0x0B -+#define RF_IPA_A 0x0C /* */ -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_BS_IQGEN 0x0F /* */ -+ -+#define RF_MODE1 0x10 /* */ -+#define RF_MODE2 0x11 /* */ -+ -+#define RF_RX_AGC_HP 0x12 /* */ -+#define RF_TX_AGC 0x13 /* */ -+#define RF_BIAS 0x14 /* */ -+#define RF_IPA 0x15 /* */ -+#define RF_TXBIAS 0x16 -+#define RF_POW_ABILITY 0x17 /* */ -+#define RF_MODE_AG 0x18 /* */ -+#define rRfChannel 0x18 /* RF channel and BW switch */ -+#define RF_CHNLBW 0x18 /* RF channel and BW switch */ -+#define RF_TOP 0x19 /* */ -+ -+#define RF_RX_G1 0x1A /* */ -+#define RF_RX_G2 0x1B /* */ -+ -+#define RF_RX_BB2 0x1C /* */ -+#define RF_RX_BB1 0x1D /* */ -+ -+#define RF_RCK1 0x1E /* */ -+#define RF_RCK2 0x1F /* */ -+ -+#define RF_TX_G1 0x20 /* */ -+#define RF_TX_G2 0x21 /* */ -+#define RF_TX_G3 0x22 /* */ -+ -+#define RF_TX_BB1 0x23 /* */ -+ -+#define RF_T_METER 0x24 /* */ -+ -+#define RF_SYN_G1 0x25 /* RF TX Power control */ -+#define RF_SYN_G2 0x26 /* RF TX Power control */ -+#define RF_SYN_G3 0x27 /* RF TX Power control */ -+#define RF_SYN_G4 0x28 /* RF TX Power control */ -+#define RF_SYN_G5 0x29 /* RF TX Power control */ -+#define RF_SYN_G6 0x2A /* RF TX Power control */ -+#define RF_SYN_G7 0x2B /* RF TX Power control */ -+#define RF_SYN_G8 0x2C /* RF TX Power control */ -+ -+#define RF_RCK_OS 0x30 /* RF TX PA control */ -+ -+#define RF_TXPA_G1 0x31 /* RF TX PA control */ -+#define RF_TXPA_G2 0x32 /* RF TX PA control */ -+#define RF_TXPA_G3 0x33 /* RF TX PA control */ -+#define RF_TX_BIAS_A 0x35 -+#define RF_TX_BIAS_D 0x36 -+#define RF_LOBF_9 0x38 -+#define RF_RXRF_A3 0x3C /* */ -+#define RF_TRSW 0x3F -+ -+#define RF_TXRF_A2 0x41 -+#define RF_T_METER_88E 0x42 -+#define RF_TXPA_G4 0x46 -+#define RF_TXPA_A4 0x4B -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+#define RF_S0S1 0xB0 -+ -+/* -+ * Bit Mask -+ * -+ * 1. Page1(0x100) */ -+#define bBBResetB 0x100 /* Useless now? */ -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+#define RF_TX_GAIN_OFFSET_8723D(_val) (abs((_val)) | (((_val) > 0) ? BIT(4) : 0)) -+ -+/* 2. Page8(0x800) */ -+#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 /* Useless now */ -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bAntennaSelect 0x0300 -+ -+#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 /* Useless now */ -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf /* Reg0x814 */ -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 /* T2R */ -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 /* chane gain at continue Tx */ -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 /* Useless now -+ * #define bHWSISelect 0x8 */ -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ -+ -+#define bRFSI_TRSW 0x20 /* Useless now */ -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+ -+#define bLSSIReadAddress 0x7f800000 /* T65 RF */ -+ -+#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ -+ -+#define bLSSIReadBackData 0xfffff /* T65 RF */ -+ -+#define bLSSIReadOKFlag 0x1000 /* Useless now */ -+#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ -+ -+#define b80MClkDelay 0x18000000 /* Useless */ -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 /* Useless */ -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+/* 3. Page9(0x900) */ -+#define bOFDMTxSC 0x30000000 /* Useless */ -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ -+#define bDebugItem 0xff /* reset debug page and LWord */ -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+/* 4. PageA(0xA00) */ -+#define bCCKBBMode 0x3 /* Useless */ -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ -+ -+#define bCCKScramble 0x8 /* Useless */ -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ -+#define bCCKFixedRxAGC 0x8000 -+/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+/* 5. PageC(0xC00) */ -+#define bNumOfSTF 0x3 /* Useless */ -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 /* the threshold for high power */ -+#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+/* #define bRxMF_Hold 0x3800 */ -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+/* 6. PageE(0xE00) */ -+#define bSTBCEn 0x4 /* Useless */ -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+/* #define bRxPath1 0x01 */ -+/* #define bRxPath2 0x02 */ -+/* #define bRxPath3 0x04 */ -+/* #define bRxPath4 0x08 */ -+/* #define bTxPath1 0x10 */ -+/* #define bTxPath2 0x20 */ -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 /* total */ -+#define bShortCFOFLength 11 /* fraction */ -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf /* Useless */ -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 /* Useless */ -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 /* Useless */ -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+/* Rx Pseduo noise */ -+#define bRxPesudoNoiseOn 0x20000000 /* Useless */ -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+/* 7. RF Register -+ * Zebra1 */ -+#define bZebra1_HSSIEnable 0x8 /* Useless */ -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+/* Zebra4 */ -+#define bRTL8256RegModeCtrl1 0x100 /* Useless */ -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+/* RTL8258 */ -+#define bRTL8258_TxLPFBW 0xc /* Useless */ -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+/* -+ * Other Definition -+ * */ -+ -+/* byte endable for sb_write */ -+#define bByte0 0x1 /* Useless */ -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+/* for PutRegsetting & GetRegSetting BitMask */ -+#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+#define bEnable 0x1 /* Useless */ -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 /* Useless */ -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 /* 500ms // Useless */ -+#define tUpdateRxCounter 100 /* 100ms */ -+ -+#define rateCCK 0 /* Useless */ -+#define rateOFDM 1 -+#define rateHT 2 -+ -+/* define Register-End */ -+#define bPMAC_End 0x1ff /* Useless */ -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+/* define max debug item in each debug page -+ * #define bMaxItem_FPGA_PHY0 0x9 -+ * #define bMaxItem_FPGA_PHY1 0x3 -+ * #define bMaxItem_PHY_11B 0x16 -+ * #define bMaxItem_OFDM_PHY0 0x29 -+ * #define bMaxItem_OFDM_PHY1 0x0 */ -+ -+#define bPMACControl 0x0 /* Useless */ -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#define PathA 0x0 /* Useless */ -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723DPwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723DPwrSeq.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723DPwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723DPwrSeq.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,193 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8723D -+#define REALTEK_POWER_SEQUENCE_8723D -+ -+/* #include "PwrSeqCmd.h" */ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WM-20110607-Paul-RTL8192e_Power_Architecture-R02.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transition from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS 27 -+#define RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS 8 -+#define RTL8723D_TRANS_CARDEMU_TO_SUS_STEPS 7 -+#define RTL8723D_TRANS_SUS_TO_CARDEMU_STEPS 5 -+#define RTL8723D_TRANS_CARDEMU_TO_CARDDIS_STEPS 8 -+#define RTL8723D_TRANS_CARDDIS_TO_CARDEMU_STEPS 7 -+#define RTL8723D_TRANS_CARDEMU_TO_PDN_STEPS 4 -+#define RTL8723D_TRANS_PDN_TO_CARDEMU_STEPS 1 -+#define RTL8723D_TRANS_ACT_TO_LPS_STEPS 13 -+#define RTL8723D_TRANS_LPS_TO_ACT_STEPS 11 -+#define RTL8723D_TRANS_END_STEPS 1 -+ -+ -+#define RTL8723D_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), BIT(0)}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ -+ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(5), 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT(4) | BIT(3) | BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[11]=0*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0) , BIT(0)},/* Disable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT(1), BIT(1)},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0) , 0},/* Enable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), BIT(0)},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, (BIT(1) | BIT(0)), 0}, \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(7), 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT(4) | BIT(3)), 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), BIT(0)},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT(0), 0},/**/ \ -+ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(6), BIT(6)},/* Enable WL control XTAL setting*/ \ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), BIT(1)},/*Enable falling edge triggering interrupt*/\ -+ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), BIT(1)},/*Enable GPIO9 interrupt mode*/\ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), 0},/*Enable GPIO9 input mode*/\ -+ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), BIT(0)},/*Enable HSISR GPIO[C:0] interrupt*/\ -+ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), BIT(1)},/*Enable HSISR GPIO9 interrupt*/\ -+ {0x0068, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3), BIT(3)},/*For GPIO9 internal pull high setting by test chip*/\ -+ {0x0069, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(6), BIT(6)},/*For GPIO9 internal pull high setting*/\ -+ {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*reset RF path S1*/\ -+ {0x0077, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*reset RF path S0*/\ -+ {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x07},/*enable RF path S1*/\ -+ {0x0077, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x07},/*enalbe RF path S0*/\ -+ -+ -+#define RTL8723D_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ -+ /*{0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, */ /*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), 0}, /*0x2[0]=0 Reset BB, RF enter Power Down mode*/ \ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), 0},/*Enable rising edge triggering interrupt*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), BIT(0)},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), BIT(1)}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT(1), 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(6), 0},/* Enable BT control XTAL setting*/\ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(5), BIT(5)}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/\ -+ -+ -+#define RTL8723D_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4) | BIT(3), (BIT4 | BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(4), BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), BIT(4)}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(4), BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT(0), BIT(0)}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT(1), 0}, /*wait power state to suspend*/ -+ -+#define RTL8723D_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(7), 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT(0), 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT(1), BIT(1)}, /*wait power state to suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(4), 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+ -+#define RTL8723D_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(4), BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(2), BIT(2)}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(4), BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend*/ \ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), BIT(4)}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT(0), BIT(0)}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT(1), 0}, /*wait power state to suspend*/ -+ -+#define RTL8723D_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(7), 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT(0), 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT(1), BIT(1)}, /*wait power state to suspend*/\ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(3) | BIT(4), 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8723D_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), BIT(4)}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK | PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(7), BIT(7)},/* 0x04[15] = 1*/ -+ -+#define RTL8723D_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(7), 0},/* 0x04[15] = 0*/ -+ -+#define RTL8723D_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(5), BIT(5)},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8723D_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT(7), 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(6) | BIT(7), 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1), BIT(1)}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(1) | BIT(0), BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8723D_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, -+ -+ -+ extern WLAN_PWR_CFG rtl8723D_power_on_flow[RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723D_radio_off_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723D_card_disable_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_CARDDIS_STEPS + RTL8723D_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723D_card_enable_flow[RTL8723D_TRANS_CARDDIS_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723D_suspend_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_SUS_STEPS + RTL8723D_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723D_resume_flow[RTL8723D_TRANS_SUS_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723D_hwpdn_flow[RTL8723D_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723D_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723D_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723D_enter_lps_flow[RTL8723D_TRANS_ACT_TO_LPS_STEPS + RTL8723D_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723D_leave_lps_flow[RTL8723D_TRANS_LPS_TO_ACT_STEPS + RTL8723D_TRANS_END_STEPS]; -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8723PwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723PwrSeq.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8723PwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8723PwrSeq.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,169 @@ -+#ifndef __HAL8723PWRSEQ_H__ -+#define __HAL8723PWRSEQ_H__ -+/* -+ Check document WM-20110607-Paul-RTL8723A_Power_Architecture-R02.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#include "HalPwrSeqCmd.h" -+ -+#define RTL8723A_TRANS_CARDEMU_TO_ACT_STEPS 15 -+#define RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8723A_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8723A_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8723A_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8723A_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8723A_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8723A_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8723A_TRANS_END_STEPS 1 -+ -+ -+#define RTL8723A_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ -+ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3), 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ {0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 1},/*0x4C[23] = 0x4E[7] = 1, switch DPDT_SEL_P output from WL BB */\ -+ -+#define RTL8723A_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/ \ -+ -+ -+#define RTL8723A_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4 | BIT3, (BIT4 | BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8723A_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8723A_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8723A_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8723A_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK | PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8723A_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8723A_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8723A_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8723A_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, -+ -+ -+ extern WLAN_PWR_CFG rtl8723A_power_on_flow[RTL8723A_TRANS_CARDEMU_TO_ACT_STEPS + RTL8723A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723A_radio_off_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723A_card_disable_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723A_card_enable_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723A_suspend_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723A_TRANS_CARDEMU_TO_SUS_STEPS + RTL8723A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723A_resume_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723A_TRANS_CARDEMU_TO_SUS_STEPS + RTL8723A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723A_hwpdn_flow[RTL8723A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8723A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8723A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723A_enter_lps_flow[RTL8723A_TRANS_ACT_TO_LPS_STEPS + RTL8723A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8723A_leave_lps_flow[RTL8723A_TRANS_LPS_TO_ACT_STEPS + RTL8723A_TRANS_END_STEPS]; -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8812PhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8812PhyCfg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8812PhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8812PhyCfg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,148 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8812PHYCFG_H__ -+#define __INC_HAL8812PHYCFG_H__ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 /* us */ -+#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+ -+#ifdef CONFIG_PCI_HCI -+ #define MAX_AGGR_NUM 0x0B -+#else -+ #define MAX_AGGR_NUM 0x07 -+#endif /* CONFIG_PCI_HCI */ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/* BB/RF related */ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/*------------------------Export global variable----------------------------*/ -+/*------------------------Export global variable----------------------------*/ -+ -+ -+/*------------------------Export Marco Definition---------------------------*/ -+/*------------------------Export Marco Definition---------------------------*/ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+/* -+ * BB and RF register read/write -+ * */ -+u32 PHY_QueryBBReg8812(IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask); -+void PHY_SetBBReg8812(IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data); -+u32 PHY_QueryRFReg8812(IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask); -+void PHY_SetRFReg8812(IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data); -+ -+/* -+ * Initialization related function -+ * -+ * MAC/BB/RF HAL config */ -+int PHY_MACConfig8812(IN PADAPTER Adapter); -+int PHY_BBConfig8812(IN PADAPTER Adapter); -+void PHY_BB8812_Config_1T(IN PADAPTER Adapter); -+int PHY_RFConfig8812(IN PADAPTER Adapter); -+ -+/* RF config */ -+ -+s32 -+PHY_SwitchWirelessBand8812( -+ IN PADAPTER Adapter, -+ IN u8 Band -+); -+ -+/* -+ * BB TX Power R/W -+ * */ -+void PHY_GetTxPowerLevel8812(IN PADAPTER Adapter, OUT s32 *powerlevel); -+void PHY_SetTxPowerLevel8812(IN PADAPTER Adapter, IN u8 Channel); -+ -+BOOLEAN PHY_UpdateTxPowerDbm8812(IN PADAPTER Adapter, IN int powerInDbm); -+u8 PHY_GetTxPowerIndex_8812A( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN u8 BandWidth, -+ IN u8 Channel, -+ struct txpwr_idx_comp *tic -+); -+ -+u32 PHY_GetTxBBSwing_8812A( -+ IN PADAPTER Adapter, -+ IN BAND_TYPE Band, -+ IN u8 RFPath -+); -+ -+VOID -+PHY_SetTxPowerIndex_8812A( -+ IN PADAPTER Adapter, -+ IN u4Byte PowerIndex, -+ IN u1Byte RFPath, -+ IN u1Byte Rate -+); -+ -+/* -+ * channel switch related funciton -+ * */ -+VOID -+PHY_SetSwChnlBWMode8812( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+/* -+ * BB/MAC/RF other monitor API -+ * */ -+ -+VOID -+PHY_SetRFPathSwitch_8812A( -+ IN PADAPTER pAdapter, -+ IN BOOLEAN bMain -+); -+ -+/*--------------------------Exported Function prototype---------------------*/ -+#endif /* __INC_HAL8192CPHYCFG_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8812PhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8812PhyReg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8812PhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8812PhyReg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,738 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8812PHYREG_H__ -+#define __INC_HAL8812PHYREG_H__ -+/*--------------------------Define Parameters-------------------------------*/ -+/* -+ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+ * 3. RF register 0x00-2E -+ * 4. Bit Mask for BB/RF register -+ * 5. Other defintion for BB/RF R/W -+ * */ -+ -+ -+/* BB Register Definition */ -+ -+#define rCCAonSec_Jaguar 0x838 -+#define rPwed_TH_Jaguar 0x830 -+ -+/* BW and sideband setting */ -+#define rBWIndication_Jaguar 0x834 -+#define rL1PeakTH_Jaguar 0x848 -+#define rFPGA0_XA_LSSIReadBack 0x8a0 /*Tranceiver LSSI Readback*/ -+#define rRFMOD_Jaguar 0x8ac /* RF mode */ -+#define rADC_Buf_Clk_Jaguar 0x8c4 -+#define rRFECTRL_Jaguar 0x900 -+#define bRFMOD_Jaguar 0xc3 -+#define rCCK_System_Jaguar 0xa00 /* for cck sideband */ -+#define bCCK_System_Jaguar 0x10 -+ -+/* Block & Path enable */ -+#define rOFDMCCKEN_Jaguar 0x808 /* OFDM/CCK block enable */ -+#define bOFDMEN_Jaguar 0x20000000 -+#define bCCKEN_Jaguar 0x10000000 -+#define rRxPath_Jaguar 0x808 /* Rx antenna */ -+#define bRxPath_Jaguar 0xff -+#define rTxPath_Jaguar 0x80c /* Tx antenna */ -+#define bTxPath_Jaguar 0x0fffffff -+#define rCCK_RX_Jaguar 0xa04 /* for cck rx path selection */ -+#define bCCK_RX_Jaguar 0x0c000000 -+#define rVhtlen_Use_Lsig_Jaguar 0x8c3 /* Use LSIG for VHT length */ -+ -+/* RF read/write-related */ -+#define rHSSIRead_Jaguar 0x8b0 /* RF read addr */ -+#define bHSSIRead_addr_Jaguar 0xff -+#define bHSSIRead_trigger_Jaguar 0x100 -+#define rA_PIRead_Jaguar 0xd04 /* RF readback with PI */ -+#define rB_PIRead_Jaguar 0xd44 /* RF readback with PI */ -+#define rA_SIRead_Jaguar 0xd08 /* RF readback with SI */ -+#define rB_SIRead_Jaguar 0xd48 /* RF readback with SI */ -+#define rRead_data_Jaguar 0xfffff -+#define rA_LSSIWrite_Jaguar 0xc90 /* RF write addr */ -+#define rB_LSSIWrite_Jaguar 0xe90 /* RF write addr */ -+#define bLSSIWrite_data_Jaguar 0x000fffff -+#define bLSSIWrite_addr_Jaguar 0x0ff00000 -+ -+ -+ -+/* YN: mask the following register definition temporarily */ -+#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+/* #define rFPGA0_XAB_RFParameter 0x878 */ /* RF Parameter -+ * #define rFPGA0_XCD_RFParameter 0x87c */ -+ -+/* #define rFPGA0_AnalogParameter1 0x880 */ /* Crystal cap setting RF-R/W protection for parameter4?? -+ * #define rFPGA0_AnalogParameter2 0x884 -+ * #define rFPGA0_AnalogParameter3 0x888 -+ * #define rFPGA0_AdDaClockEn 0x888 */ /* enable ad/da clock1 for dual-phy -+ * #define rFPGA0_AnalogParameter4 0x88c */ -+ -+ -+/* CCK TX scaling */ -+#define rCCK_TxFilter1_Jaguar 0xa20 -+#define bCCK_TxFilter1_C0_Jaguar 0x00ff0000 -+#define bCCK_TxFilter1_C1_Jaguar 0xff000000 -+#define rCCK_TxFilter2_Jaguar 0xa24 -+#define bCCK_TxFilter2_C2_Jaguar 0x000000ff -+#define bCCK_TxFilter2_C3_Jaguar 0x0000ff00 -+#define bCCK_TxFilter2_C4_Jaguar 0x00ff0000 -+#define bCCK_TxFilter2_C5_Jaguar 0xff000000 -+#define rCCK_TxFilter3_Jaguar 0xa28 -+#define bCCK_TxFilter3_C6_Jaguar 0x000000ff -+#define bCCK_TxFilter3_C7_Jaguar 0x0000ff00 -+ -+ -+/* YN: mask the following register definition temporarily -+ * #define rPdp_AntA 0xb00 -+ * #define rPdp_AntA_4 0xb04 -+ * #define rConfig_Pmpd_AntA 0xb28 -+ * #define rConfig_AntA 0xb68 -+ * #define rConfig_AntB 0xb6c -+ * #define rPdp_AntB 0xb70 -+ * #define rPdp_AntB_4 0xb74 -+ * #define rConfig_Pmpd_AntB 0xb98 -+ * #define rAPK 0xbd8 */ -+ -+/* RXIQC */ -+#define rA_RxIQC_AB_Jaguar 0xc10 /* RxIQ imblance matrix coeff. A & B */ -+#define rA_RxIQC_CD_Jaguar 0xc14 /* RxIQ imblance matrix coeff. C & D */ -+#define rA_TxScale_Jaguar 0xc1c /* Pah_A TX scaling factor */ -+#define rB_TxScale_Jaguar 0xe1c /* Path_B TX scaling factor */ -+#define rB_RxIQC_AB_Jaguar 0xe10 /* RxIQ imblance matrix coeff. A & B */ -+#define rB_RxIQC_CD_Jaguar 0xe14 /* RxIQ imblance matrix coeff. C & D */ -+#define b_RxIQC_AC_Jaguar 0x02ff /* bit mask for IQC matrix element A & C */ -+#define b_RxIQC_BD_Jaguar 0x02ff0000 /* bit mask for IQC matrix element A & C */ -+ -+ -+/* DIG-related */ -+#define rA_IGI_Jaguar 0xc50 /* Initial Gain for path-A */ -+#define rB_IGI_Jaguar 0xe50 /* Initial Gain for path-B */ -+#define rOFDM_FalseAlarm1_Jaguar 0xf48 /* counter for break */ -+#define rOFDM_FalseAlarm2_Jaguar 0xf4c /* counter for spoofing */ -+#define rCCK_FalseAlarm_Jaguar 0xa5c /* counter for cck false alarm */ -+#define b_FalseAlarm_Jaguar 0xffff -+#define rCCK_CCA_Jaguar 0xa08 /* cca threshold */ -+#define bCCK_CCA_Jaguar 0x00ff0000 -+ -+/* Tx Power Ttraining-related */ -+#define rA_TxPwrTraing_Jaguar 0xc54 -+#define rB_TxPwrTraing_Jaguar 0xe54 -+ -+/* Report-related */ -+#define rOFDM_ShortCFOAB_Jaguar 0xf60 -+#define rOFDM_LongCFOAB_Jaguar 0xf64 -+#define rOFDM_EndCFOAB_Jaguar 0xf70 -+#define rOFDM_AGCReport_Jaguar 0xf84 -+#define rOFDM_RxSNR_Jaguar 0xf88 -+#define rOFDM_RxEVMCSI_Jaguar 0xf8c -+#define rOFDM_SIGReport_Jaguar 0xf90 -+ -+/* Misc functions */ -+#define rEDCCA_Jaguar 0x8a4 /* EDCCA */ -+#define bEDCCA_Jaguar 0xffff -+#define rAGC_table_Jaguar 0x82c /* AGC tabel select */ -+#define bAGC_table_Jaguar 0x3 -+#define b_sel5g_Jaguar 0x1000 /* sel5g */ -+#define b_LNA_sw_Jaguar 0x8000 /* HW/WS control for LNA */ -+#define rFc_area_Jaguar 0x860 /* fc_area */ -+#define bFc_area_Jaguar 0x1ffe000 -+#define rSingleTone_ContTx_Jaguar 0x914 -+ -+/* RFE */ -+#define rA_RFE_Pinmux_Jaguar 0xcb0 /* Path_A RFE cotrol pinmux */ -+#define rB_RFE_Pinmux_Jaguar 0xeb0 /* Path_B RFE control pinmux */ -+#define rA_RFE_Inv_Jaguar 0xcb4 /* Path_A RFE cotrol */ -+#define rB_RFE_Inv_Jaguar 0xeb4 /* Path_B RFE control */ -+#define rA_RFE_Jaguar 0xcb8 /* Path_A RFE cotrol */ -+#define rB_RFE_Jaguar 0xeb8 /* Path_B RFE control */ -+#define r_ANTSEL_SW_Jaguar 0x900 /* ANTSEL SW Control */ -+#define bMask_RFEInv_Jaguar 0x3ff00000 -+#define bMask_AntselPathFollow_Jaguar 0x00030000 -+ -+/* TX AGC */ -+#define rTxAGC_A_CCK11_CCK1_JAguar 0xc20 -+#define rTxAGC_A_Ofdm18_Ofdm6_JAguar 0xc24 -+#define rTxAGC_A_Ofdm54_Ofdm24_JAguar 0xc28 -+#define rTxAGC_A_MCS3_MCS0_JAguar 0xc2c -+#define rTxAGC_A_MCS7_MCS4_JAguar 0xc30 -+#define rTxAGC_A_MCS11_MCS8_JAguar 0xc34 -+#define rTxAGC_A_MCS15_MCS12_JAguar 0xc38 -+#define rTxAGC_A_Nss1Index3_Nss1Index0_JAguar 0xc3c -+#define rTxAGC_A_Nss1Index7_Nss1Index4_JAguar 0xc40 -+#define rTxAGC_A_Nss2Index1_Nss1Index8_JAguar 0xc44 -+#define rTxAGC_A_Nss2Index5_Nss2Index2_JAguar 0xc48 -+#define rTxAGC_A_Nss2Index9_Nss2Index6_JAguar 0xc4c -+#define rTxAGC_B_CCK11_CCK1_JAguar 0xe20 -+#define rTxAGC_B_Ofdm18_Ofdm6_JAguar 0xe24 -+#define rTxAGC_B_Ofdm54_Ofdm24_JAguar 0xe28 -+#define rTxAGC_B_MCS3_MCS0_JAguar 0xe2c -+#define rTxAGC_B_MCS7_MCS4_JAguar 0xe30 -+#define rTxAGC_B_MCS11_MCS8_JAguar 0xe34 -+#define rTxAGC_B_MCS15_MCS12_JAguar 0xe38 -+#define rTxAGC_B_Nss1Index3_Nss1Index0_JAguar 0xe3c -+#define rTxAGC_B_Nss1Index7_Nss1Index4_JAguar 0xe40 -+#define rTxAGC_B_Nss2Index1_Nss1Index8_JAguar 0xe44 -+#define rTxAGC_B_Nss2Index5_Nss2Index2_JAguar 0xe48 -+#define rTxAGC_B_Nss2Index9_Nss2Index6_JAguar 0xe4c -+#define bTxAGC_byte0_Jaguar 0xff -+#define bTxAGC_byte1_Jaguar 0xff00 -+#define bTxAGC_byte2_Jaguar 0xff0000 -+#define bTxAGC_byte3_Jaguar 0xff000000 -+ -+/* IQK YN: temporaily mask this part -+ * #define rFPGA0_IQK 0xe28 -+ * #define rTx_IQK_Tone_A 0xe30 -+ * #define rRx_IQK_Tone_A 0xe34 -+ * #define rTx_IQK_PI_A 0xe38 -+ * #define rRx_IQK_PI_A 0xe3c */ -+ -+/* #define rTx_IQK 0xe40 */ -+/* #define rRx_IQK 0xe44 */ -+/* #define rIQK_AGC_Pts 0xe48 */ -+/* #define rIQK_AGC_Rsp 0xe4c */ -+/* #define rTx_IQK_Tone_B 0xe50 */ -+/* #define rRx_IQK_Tone_B 0xe54 */ -+/* #define rTx_IQK_PI_B 0xe58 */ -+/* #define rRx_IQK_PI_B 0xe5c */ -+/* #define rIQK_AGC_Cont 0xe60 */ -+ -+ -+/* AFE-related */ -+#define rA_AFEPwr1_Jaguar 0xc60 /* dynamic AFE power control */ -+#define rA_AFEPwr2_Jaguar 0xc64 /* dynamic AFE power control */ -+#define rA_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xc68 -+#define rA_Tx_CCKBBON_OFDMRFON_Jaguar 0xc6c -+#define rA_Tx_OFDMBBON_Tx2Rx_Jaguar 0xc70 -+#define rA_Tx2Tx_RXCCK_Jaguar 0xc74 -+#define rA_Rx_OFDM_WaitRIFS_Jaguar 0xc78 -+#define rA_Rx2Rx_BT_Jaguar 0xc7c -+#define rA_sleep_nav_Jaguar 0xc80 -+#define rA_pmpd_Jaguar 0xc84 -+#define rB_AFEPwr1_Jaguar 0xe60 /* dynamic AFE power control */ -+#define rB_AFEPwr2_Jaguar 0xe64 /* dynamic AFE power control */ -+#define rB_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xe68 -+#define rB_Tx_CCKBBON_OFDMRFON_Jaguar 0xe6c -+#define rB_Tx_OFDMBBON_Tx2Rx_Jaguar 0xe70 -+#define rB_Tx2Tx_RXCCK_Jaguar 0xe74 -+#define rB_Rx_OFDM_WaitRIFS_Jaguar 0xe78 -+#define rB_Rx2Rx_BT_Jaguar 0xe7c -+#define rB_sleep_nav_Jaguar 0xe80 -+#define rB_pmpd_Jaguar 0xe84 -+ -+ -+/* YN: mask these registers temporaily -+ * #define rTx_Power_Before_IQK_A 0xe94 -+ * #define rTx_Power_After_IQK_A 0xe9c */ -+ -+/* #define rRx_Power_Before_IQK_A 0xea0 */ -+/* #define rRx_Power_Before_IQK_A_2 0xea4 */ -+/* #define rRx_Power_After_IQK_A 0xea8 */ -+/* #define rRx_Power_After_IQK_A_2 0xeac */ -+ -+/* #define rTx_Power_Before_IQK_B 0xeb4 */ -+/* #define rTx_Power_After_IQK_B 0xebc */ -+ -+/* #define rRx_Power_Before_IQK_B 0xec0 */ -+/* #define rRx_Power_Before_IQK_B_2 0xec4 */ -+/* #define rRx_Power_After_IQK_B 0xec8 */ -+/* #define rRx_Power_After_IQK_B_2 0xecc */ -+ -+ -+/* RSSI Dump */ -+#define rA_RSSIDump_Jaguar 0xBF0 -+#define rB_RSSIDump_Jaguar 0xBF1 -+#define rS1_RXevmDump_Jaguar 0xBF4 -+#define rS2_RXevmDump_Jaguar 0xBF5 -+#define rA_RXsnrDump_Jaguar 0xBF6 -+#define rB_RXsnrDump_Jaguar 0xBF7 -+#define rA_CfoShortDump_Jaguar 0xBF8 -+#define rB_CfoShortDump_Jaguar 0xBFA -+#define rA_CfoLongDump_Jaguar 0xBEC -+#define rB_CfoLongDump_Jaguar 0xBEE -+ -+ -+/* RF Register -+ * */ -+#define RF_AC_Jaguar 0x00 /* */ -+#define RF_RF_Top_Jaguar 0x07 /* */ -+#define RF_TXLOK_Jaguar 0x08 /* */ -+#define RF_TXAPK_Jaguar 0x0B -+#define RF_CHNLBW_Jaguar 0x18 /* RF channel and BW switch */ -+#define RF_RCK1_Jaguar 0x1c /* */ -+#define RF_RCK2_Jaguar 0x1d -+#define RF_RCK3_Jaguar 0x1e -+#define RF_ModeTableAddr 0x30 -+#define RF_ModeTableData0 0x31 -+#define RF_ModeTableData1 0x32 -+#define RF_TxLCTank_Jaguar 0x54 -+#define RF_APK_Jaguar 0x63 -+#define RF_LCK 0xB4 -+#define RF_WeLut_Jaguar 0xEF -+ -+#define bRF_CHNLBW_MOD_AG_Jaguar 0x70300 -+#define bRF_CHNLBW_BW 0xc00 -+ -+ -+/* -+ * RL6052 Register definition -+ * */ -+#define RF_AC 0x00 /* */ -+#define RF_IPA_A 0x0C /* */ -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_MODE1 0x10 /* */ -+#define RF_MODE2 0x11 /* */ -+#define RF_CHNLBW 0x18 /* RF channel and BW switch */ -+#define RF_RCK_OS 0x30 /* RF TX PA control */ -+#define RF_TXPA_G1 0x31 /* RF TX PA control */ -+#define RF_TXPA_G2 0x32 /* RF TX PA control */ -+#define RF_TXPA_G3 0x33 /* RF TX PA control */ -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+ -+#define RF_TX_GAIN_OFFSET_8812A(_val) ((abs((_val)) << 1) | (((_val) > 0) ? BIT0 : 0)) -+#define RF_TX_GAIN_OFFSET_8821A(_val) ((abs((_val)) << 1) | (((_val) > 0) ? BIT0 : 0)) -+ -+/* -+ * Bit Mask -+ * -+ * 1. Page1(0x100) */ -+#define bBBResetB 0x100 /* Useless now? */ -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+ -+/* -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 1. Page1(0x100) -+ * */ -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+/* -+ * 3. Page8(0x800) -+ * */ -+#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA0_TxInfo 0x804 /* Status report?? */ -+#define rFPGA0_PSDFunction 0x808 -+#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+ -+#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 -+#define rFPGA0_AdDaClockEn 0x888 /* enable ad/da clock1 for dual-phy */ -+#define rFPGA0_AnalogParameter4 0x88c -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XCD_RFPara 0x8b4 -+ -+/* -+ * 4. Page9(0x900) -+ * */ -+#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA1_TxBlock 0x904 /* Useless now */ -+#define rFPGA1_DebugSelect 0x908 /* Useless now */ -+#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ -+ -+/* -+ * PageA(0xA00) -+ * */ -+#define rCCK0_System 0xa00 -+#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ -+#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ -+#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ -+ -+/* -+ * PageB(0xB00) -+ * */ -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rConfig_Pmpd_AntB 0xb98 -+#define rAPK 0xbd8 -+ -+/* -+ * 6. PageC(0xC00) -+ * */ -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ -+#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ -+#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ -+#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ -+#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ -+ -+#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ -+#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ -+#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ -+#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ -+ -+#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+/* -+ * 7. PageD(0xD00) -+ * */ -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+/* -+ * 8. PageE(0xE00) -+ * */ -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+ -+/* 2. Page8(0x800) */ -+#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+/* 4. PageA(0xA00) */ -+#define bCCKBBMode 0x3 /* Useless */ -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ -+ -+#define bCCKScramble 0x8 /* Useless */ -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ -+#define bCCKFixedRxAGC 0x8000 -+/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+/* 6. PageE(0xE00) */ -+#define bSTBCEn 0x4 /* Useless */ -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+ -+ -+/* -+ * Other Definition -+ * */ -+ -+#define bEnable 0x1 /* Useless */ -+#define bDisable 0x0 -+ -+/* byte endable for srwrite */ -+#define bByte0 0x1 /* Useless */ -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+/* for PutRegsetting & GetRegSetting BitMask */ -+#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8812PwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8812PwrSeq.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8812PwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8812PwrSeq.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,209 @@ -+ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL8812PWRSEQ_H__ -+#define __HAL8812PWRSEQ_H__ -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WB-110628-DZ-RTL8195 (Jaguar) Power Architecture-R04.pdf -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8812_TRANS_CARDEMU_TO_ACT_STEPS 15 -+#define RTL8812_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8812_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8812_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8812_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8812_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8812_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8812_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8812_TRANS_END_STEPS 1 -+ -+ -+#define RTL8812_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ /*{0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0}, disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ -+ -+#define RTL8812_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ -+ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ /*{0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},//0x1F[7:0] = 0 turn off RF*/ \ -+ /*{0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},//0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x2A}, /* 0x07[7:0] = 0x28 sps pwm mode 0x2a for BT coex*/ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk = 500k */ \ -+ /*{0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 | BIT1, 0}, // 0x02[1:0] = 0 reset BB */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ -+ -+#define RTL8812_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xF0, 0xcc},\ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xF0, 0xEC},\ -+ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ -+ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ -+ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/* suspend option all off */ \ -+ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x80, BIT7},/*0x14[7] = 1 turn on ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x01, BIT0},/* 0x15[0] =1 trun on ZCD */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x10, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk = 500k */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 2b'11 enable WL suspend for PCIe*/ -+ -+#define RTL8812_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 2b'01enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO sleep mode leave */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x01, 0},/* 0x15[0] =0 trun off ZCD */ \ -+ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x80, 0},/*0x14[7] = 0 turn off ZCD */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ -+ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ -+ -+#define RTL8812_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ /**{0x0194, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, //0x194[0]=0 , disable 32K clock*/ \ -+ /**{0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x94}, //0x93 = 0x94 , 90[30] =0 enable 500k ANA clock .switch clock from 12M to 500K , 90 [26] =0 disable EEprom loader clock*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*0x03[2] = 0, reset 8051*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x05}, /*0x80 = 05h if reload fw, fill the default value of host_CPU handshake field*/ \ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xF0, 0xcc},\ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xF0, 0xEC},\ -+ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ -+ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ -+ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ -+ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x80, BIT7},/*0x14[7] = 1 turn on ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x01, BIT0},/* 0x15[0] =1 trun on ZCD */ \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x01, 0},/*0x12[0] = 0 force PFM mode */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x10, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk = 500k */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ -+ {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /*0x01f[1]=0 , disable RFC_0 control REG_RF_CTRL_8812 */ \ -+ {0x0076, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /*0x076[1]=0 , disable RFC_1 control REG_OPT_CTRL_8812 +2 */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 2b'01 enable WL suspend*/ -+ -+#define RTL8812_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*0x12[0] = 1 force PWM mode */ \ -+ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x80, 0},/*0x14[7] = 0 turn off ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x01, 0},/* 0x15[0] =0 trun off ZCD */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO leave sleep mode */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ -+ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*0x04[10] = 0, enable SW LPS PCIE only*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 2b'01enable WL suspend*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x03[2] = 1, enable 8051*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8812_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8812_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8812_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x7F},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ -+ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated, and RF closed*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ -+ -+ -+#define RTL8812_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/ \ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/ \ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/ \ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/ \ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8812_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, -+ -+ -+extern WLAN_PWR_CFG rtl8812_power_on_flow[RTL8812_TRANS_CARDEMU_TO_ACT_STEPS + RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_radio_off_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS + RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_card_disable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS + RTL8812_TRANS_CARDEMU_TO_PDN_STEPS + RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_card_enable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS + RTL8812_TRANS_CARDEMU_TO_PDN_STEPS + RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_suspend_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS + RTL8812_TRANS_CARDEMU_TO_SUS_STEPS + RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_resume_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS + RTL8812_TRANS_CARDEMU_TO_SUS_STEPS + RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_hwpdn_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS + RTL8812_TRANS_CARDEMU_TO_PDN_STEPS + RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_enter_lps_flow[RTL8812_TRANS_ACT_TO_LPS_STEPS + RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_leave_lps_flow[RTL8812_TRANS_LPS_TO_ACT_STEPS + RTL8812_TRANS_END_STEPS]; -+ -+#endif /* __HAL8812PWRSEQ_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8814PhyCfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8814PhyCfg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8814PhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8814PhyCfg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,269 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8814PHYCFG_H__ -+#define __INC_HAL8814PHYCFG_H__ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 /* us */ -+#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+ -+#ifdef CONFIG_PCI_HCI -+ #define MAX_AGGR_NUM 0x0B -+#else -+ #define MAX_AGGR_NUM 0x07 -+#endif /* CONFIG_PCI_HCI */ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/* BB/RF related */ -+ -+#define SIC_ENABLE 0 -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/*------------------------Export global variable----------------------------*/ -+/*------------------------Export global variable----------------------------*/ -+ -+ -+/*------------------------Export Marco Definition---------------------------*/ -+/*------------------------Export Marco Definition---------------------------*/ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+/* 1. BB register R/W API */ -+ -+extern u32 -+PHY_QueryBBReg8814A(IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask); -+ -+ -+VOID -+PHY_SetBBReg8814A(IN PADAPTER Adapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data); -+ -+ -+extern u32 -+PHY_QueryRFReg8814A(IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask); -+ -+ -+void -+PHY_SetRFReg8814A(IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data); -+ -+/* 1 3. Initial BB/RF config by reading MAC/BB/RF txt. */ -+s32 -+phy_BB8814A_Config_ParaFile( -+ IN PADAPTER Adapter -+); -+ -+VOID -+PHY_ConfigBB_8814A( -+ IN PADAPTER Adapter -+); -+ -+ -+VOID -+phy_ADC_CLK_8814A( -+ IN PADAPTER Adapter -+); -+ -+s32 -+PHY_RFConfig8814A( -+ IN PADAPTER Adapter -+); -+ -+/* -+ * RF Power setting -+ * -+ * BOOLEAN PHY_SetRFPowerState8814A(PADAPTER Adapter, rt_rf_power_state eRFPowerState); */ -+ -+/* 1 5. Tx Power setting API */ -+ -+VOID -+PHY_GetTxPowerLevel8814( -+ IN PADAPTER Adapter, -+ OUT ps4Byte powerlevel -+); -+ -+VOID -+PHY_SetTxPowerLevel8814( -+ IN PADAPTER Adapter, -+ IN u8 Channel -+); -+ -+u8 -+PHY_GetTxPowerIndex_8814A( -+ IN PADAPTER Adapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel -+); -+ -+u8 -+PHY_GetTxPowerIndex8814A( -+ IN PADAPTER Adapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN u8 BandWidth, -+ IN u8 Channel, -+ struct txpwr_idx_comp *tic -+); -+ -+VOID -+PHY_SetTxPowerIndex_8814A( -+ IN PADAPTER Adapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+); -+ -+ -+BOOLEAN -+PHY_UpdateTxPowerDbm8814A( -+ IN PADAPTER Adapter, -+ IN s4Byte powerInDbm -+); -+ -+ -+u32 -+PHY_GetTxBBSwing_8814A( -+ IN PADAPTER Adapter, -+ IN BAND_TYPE Band, -+ IN u8 RFPath -+); -+ -+ -+ -+/* 1 6. Channel setting API */ -+ -+VOID -+PHY_SwChnlTimerCallback8814A( -+ IN PRT_TIMER pTimer -+); -+ -+VOID -+PHY_SwChnlWorkItemCallback8814A( -+ IN PVOID pContext -+); -+ -+ -+VOID -+HAL_HandleSwChnl8814A( -+ IN PADAPTER pAdapter, -+ IN u8 channel -+); -+ -+VOID -+PHY_SwChnlSynchronously8814A(IN PADAPTER pAdapter, -+ IN u8 channel); -+ -+VOID -+PHY_SwChnlAndSetBWModeCallback8814A(IN PVOID pContext); -+ -+ -+VOID -+PHY_HandleSwChnlAndSetBW8814A( -+ IN PADAPTER Adapter, -+ IN BOOLEAN bSwitchChannel, -+ IN BOOLEAN bSetBandWidth, -+ IN u8 ChannelNum, -+ IN CHANNEL_WIDTH ChnlWidth, -+ IN u8 ChnlOffsetOf40MHz, -+ IN u8 ChnlOffsetOf80MHz, -+ IN u8 CenterFrequencyIndex1 -+); -+ -+ -+BOOLEAN -+PHY_QueryRFPathSwitch_8814A(IN PADAPTER pAdapter); -+ -+ -+ -+#if (USE_WORKITEM) -+VOID -+RtCheckForHangWorkItemCallback8814A( -+ IN PVOID pContext -+); -+#endif -+ -+BOOLEAN -+SetAntennaConfig8814A( -+ IN PADAPTER Adapter, -+ IN u8 DefaultAnt -+); -+ -+VOID -+PHY_SetRFEReg8814A( -+ IN PADAPTER Adapter, -+ IN BOOLEAN bInit, -+ IN u8 Band -+); -+ -+ -+s32 -+PHY_SwitchWirelessBand8814A( -+ IN PADAPTER Adapter, -+ IN u8 Band -+); -+ -+VOID -+PHY_SetIO_8814A( -+ PADAPTER pAdapter -+); -+ -+VOID -+PHY_SetSwChnlBWMode8814( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 Offset40, -+ IN u8 Offset80 -+); -+ -+s32 PHY_MACConfig8814(PADAPTER Adapter); -+int PHY_BBConfig8814(PADAPTER Adapter); -+VOID PHY_Set_SecCCATH_by_RXANT_8814A(PADAPTER pAdapter, u4Byte ulAntennaRx); -+ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+#endif /* __INC_HAL8192CPHYCFG_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8814PhyReg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8814PhyReg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8814PhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8814PhyReg.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,866 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8814PHYREG_H__ -+#define __INC_HAL8814PHYREG_H__ -+/*--------------------------Define Parameters-------------------------------*/ -+/* -+ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+ * 3. RF register 0x00-2E -+ * 4. Bit Mask for BB/RF register -+ * 5. Other defintion for BB/RF R/W -+ * */ -+ -+ -+/* BB Register Definition */ -+ -+#define rCCAonSec_Jaguar 0x838 -+#define rPwed_TH_Jaguar 0x830 -+#define rL1_Weight_Jaguar 0x840 -+#define r_L1_SBD_start_time 0x844 -+ -+/* BW and sideband setting */ -+#define rBWIndication_Jaguar 0x834 -+#define rL1PeakTH_Jaguar 0x848 -+#define rRFMOD_Jaguar 0x8ac /* RF mode */ -+#define rADC_Buf_Clk_Jaguar 0x8c4 -+#define rADC_Buf_40_Clk_Jaguar2 0x8c8 -+#define rRFECTRL_Jaguar 0x900 -+#define bRFMOD_Jaguar 0xc3 -+#define rCCK_System_Jaguar 0xa00 /* for cck sideband */ -+#define bCCK_System_Jaguar 0x10 -+ -+/* Block & Path enable */ -+#define rOFDMCCKEN_Jaguar 0x808 /* OFDM/CCK block enable */ -+#define bOFDMEN_Jaguar 0x20000000 -+#define bCCKEN_Jaguar 0x10000000 -+#define rRxPath_Jaguar 0x808 /* Rx antenna */ -+#define bRxPath_Jaguar 0xff -+#define rTxPath_Jaguar 0x80c /* Tx antenna */ -+#define bTxPath_Jaguar 0x0fffffff -+#define rCCK_RX_Jaguar 0xa04 /* for cck rx path selection */ -+#define bCCK_RX_Jaguar 0x0c000000 -+#define rVhtlen_Use_Lsig_Jaguar 0x8c3 /* Use LSIG for VHT length */ -+ -+#define rRxPath_Jaguar2 0xa04 /* Rx antenna */ -+#define rTxAnt_1Nsts_Jaguar2 0x93c /* Tx antenna for 1Nsts */ -+#define rTxAnt_23Nsts_Jaguar2 0x940 /* Tx antenna for 2Nsts and 3Nsts */ -+ -+ -+/* RF read/write-related */ -+#define rHSSIRead_Jaguar 0x8b0 /* RF read addr */ -+#define bHSSIRead_addr_Jaguar 0xff -+#define bHSSIRead_trigger_Jaguar 0x100 -+#define rA_PIRead_Jaguar 0xd04 /* RF readback with PI */ -+#define rB_PIRead_Jaguar 0xd44 /* RF readback with PI */ -+#define rA_SIRead_Jaguar 0xd08 /* RF readback with SI */ -+#define rB_SIRead_Jaguar 0xd48 /* RF readback with SI */ -+#define rRead_data_Jaguar 0xfffff -+#define rA_LSSIWrite_Jaguar 0xc90 /* RF write addr */ -+#define rB_LSSIWrite_Jaguar 0xe90 /* RF write addr */ -+#define bLSSIWrite_data_Jaguar 0x000fffff -+#define bLSSIWrite_addr_Jaguar 0x0ff00000 -+ -+#define rC_PIRead_Jaguar2 0xd84 /* RF readback with PI */ -+#define rD_PIRead_Jaguar2 0xdC4 /* RF readback with PI */ -+#define rC_SIRead_Jaguar2 0xd88 /* RF readback with SI */ -+#define rD_SIRead_Jaguar2 0xdC8 /* RF readback with SI */ -+#define rC_LSSIWrite_Jaguar2 0x1890 /* RF write addr */ -+#define rD_LSSIWrite_Jaguar2 0x1A90 /* RF write addr */ -+ -+ -+/* YN: mask the following register definition temporarily */ -+#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+/* #define rFPGA0_XAB_RFParameter 0x878 */ /* RF Parameter -+ * #define rFPGA0_XCD_RFParameter 0x87c */ -+ -+/* #define rFPGA0_AnalogParameter1 0x880 */ /* Crystal cap setting RF-R/W protection for parameter4?? -+ * #define rFPGA0_AnalogParameter2 0x884 -+ * #define rFPGA0_AnalogParameter3 0x888 -+ * #define rFPGA0_AdDaClockEn 0x888 */ /* enable ad/da clock1 for dual-phy -+ * #define rFPGA0_AnalogParameter4 0x88c */ -+ -+ -+/* CCK TX scaling */ -+#define rCCK_TxFilter1_Jaguar 0xa20 -+#define bCCK_TxFilter1_C0_Jaguar 0x00ff0000 -+#define bCCK_TxFilter1_C1_Jaguar 0xff000000 -+#define rCCK_TxFilter2_Jaguar 0xa24 -+#define bCCK_TxFilter2_C2_Jaguar 0x000000ff -+#define bCCK_TxFilter2_C3_Jaguar 0x0000ff00 -+#define bCCK_TxFilter2_C4_Jaguar 0x00ff0000 -+#define bCCK_TxFilter2_C5_Jaguar 0xff000000 -+#define rCCK_TxFilter3_Jaguar 0xa28 -+#define bCCK_TxFilter3_C6_Jaguar 0x000000ff -+#define bCCK_TxFilter3_C7_Jaguar 0x0000ff00 -+/* NBI & CSI Mask setting */ -+#define rCSI_Mask_Setting1_Jaguar 0x874 -+#define rCSI_Fix_Mask0_Jaguar 0x880 -+#define rCSI_Fix_Mask1_Jaguar 0x884 -+#define rCSI_Fix_Mask2_Jaguar 0x888 -+#define rCSI_Fix_Mask3_Jaguar 0x88c -+#define rCSI_Fix_Mask4_Jaguar 0x890 -+#define rCSI_Fix_Mask5_Jaguar 0x894 -+#define rCSI_Fix_Mask6_Jaguar 0x898 -+#define rCSI_Fix_Mask7_Jaguar 0x89c -+#define rNBI_Setting_Jaguar 0x87c -+ -+ -+/* YN: mask the following register definition temporarily -+ * #define rPdp_AntA 0xb00 -+ * #define rPdp_AntA_4 0xb04 -+ * #define rConfig_Pmpd_AntA 0xb28 -+ * #define rConfig_AntA 0xb68 -+ * #define rConfig_AntB 0xb6c -+ * #define rPdp_AntB 0xb70 -+ * #define rPdp_AntB_4 0xb74 -+ * #define rConfig_Pmpd_AntB 0xb98 -+ * #define rAPK 0xbd8 */ -+ -+/* RXIQC */ -+#define rA_RxIQC_AB_Jaguar 0xc10 /* RxIQ imblance matrix coeff. A & B */ -+#define rA_RxIQC_CD_Jaguar 0xc14 /* RxIQ imblance matrix coeff. C & D */ -+#define rA_TxScale_Jaguar 0xc1c /* Pah_A TX scaling factor */ -+#define rB_TxScale_Jaguar 0xe1c /* Path_B TX scaling factor */ -+#define rB_RxIQC_AB_Jaguar 0xe10 /* RxIQ imblance matrix coeff. A & B */ -+#define rB_RxIQC_CD_Jaguar 0xe14 /* RxIQ imblance matrix coeff. C & D */ -+#define b_RxIQC_AC_Jaguar 0x02ff /* bit mask for IQC matrix element A & C */ -+#define b_RxIQC_BD_Jaguar 0x02ff0000 /* bit mask for IQC matrix element A & C */ -+ -+#define rC_TxScale_Jaguar2 0x181c /* Pah_C TX scaling factor */ -+#define rD_TxScale_Jaguar2 0x1A1c /* Path_D TX scaling factor */ -+#define rRF_TxGainOffset 0x55 -+ -+/* DIG-related */ -+#define rA_IGI_Jaguar 0xc50 /* Initial Gain for path-A */ -+#define rB_IGI_Jaguar 0xe50 /* Initial Gain for path-B */ -+#define rC_IGI_Jaguar2 0x1850 /* Initial Gain for path-C */ -+#define rD_IGI_Jaguar2 0x1A50 /* Initial Gain for path-D */ -+ -+#define rOFDM_FalseAlarm1_Jaguar 0xf48 /* counter for break */ -+#define rOFDM_FalseAlarm2_Jaguar 0xf4c /* counter for spoofing */ -+#define rCCK_FalseAlarm_Jaguar 0xa5c /* counter for cck false alarm */ -+#define b_FalseAlarm_Jaguar 0xffff -+#define rCCK_CCA_Jaguar 0xa08 /* cca threshold */ -+#define bCCK_CCA_Jaguar 0x00ff0000 -+ -+/* Tx Power Ttraining-related */ -+#define rA_TxPwrTraing_Jaguar 0xc54 -+#define rB_TxPwrTraing_Jaguar 0xe54 -+ -+/* Report-related */ -+#define rOFDM_ShortCFOAB_Jaguar 0xf60 -+#define rOFDM_LongCFOAB_Jaguar 0xf64 -+#define rOFDM_EndCFOAB_Jaguar 0xf70 -+#define rOFDM_AGCReport_Jaguar 0xf84 -+#define rOFDM_RxSNR_Jaguar 0xf88 -+#define rOFDM_RxEVMCSI_Jaguar 0xf8c -+#define rOFDM_SIGReport_Jaguar 0xf90 -+ -+/* Misc functions */ -+#define rEDCCA_Jaguar 0x8a4 /* EDCCA */ -+#define bEDCCA_Jaguar 0xffff -+#define rAGC_table_Jaguar 0x82c /* AGC tabel select */ -+#define bAGC_table_Jaguar 0x3 -+#define b_sel5g_Jaguar 0x1000 /* sel5g */ -+#define b_LNA_sw_Jaguar 0x8000 /* HW/WS control for LNA */ -+#define rFc_area_Jaguar 0x860 /* fc_area */ -+#define bFc_area_Jaguar 0x1ffe000 -+#define rSingleTone_ContTx_Jaguar 0x914 -+ -+#define rAGC_table_Jaguar2 0x958 /* AGC tabel select */ -+#define rDMA_trigger_Jaguar2 0x95C /* ADC sample mode */ -+ -+ -+/* RFE */ -+#define rA_RFE_Pinmux_Jaguar 0xcb0 /* Path_A RFE cotrol pinmux */ -+#define rB_RFE_Pinmux_Jaguar 0xeb0 /* Path_B RFE control pinmux */ -+#define rA_RFE_Inv_Jaguar 0xcb4 /* Path_A RFE cotrol */ -+#define rB_RFE_Inv_Jaguar 0xeb4 /* Path_B RFE control */ -+#define rA_RFE_Jaguar 0xcb8 /* Path_A RFE cotrol */ -+#define rB_RFE_Jaguar 0xeb8 /* Path_B RFE control */ -+#define r_ANTSEL_SW_Jaguar 0x900 /* ANTSEL SW Control */ -+#define bMask_RFEInv_Jaguar 0x3ff00000 -+#define bMask_AntselPathFollow_Jaguar 0x00030000 -+ -+#define rC_RFE_Pinmux_Jaguar 0x18B4 /* Path_C RFE cotrol pinmux */ -+#define rD_RFE_Pinmux_Jaguar 0x1AB4 /* Path_D RFE cotrol pinmux */ -+#define rA_RFE_Sel_Jaguar2 0x1990 -+ -+ -+ -+/* TX AGC */ -+#define rTxAGC_A_CCK11_CCK1_JAguar 0xc20 -+#define rTxAGC_A_Ofdm18_Ofdm6_JAguar 0xc24 -+#define rTxAGC_A_Ofdm54_Ofdm24_JAguar 0xc28 -+#define rTxAGC_A_MCS3_MCS0_JAguar 0xc2c -+#define rTxAGC_A_MCS7_MCS4_JAguar 0xc30 -+#define rTxAGC_A_MCS11_MCS8_JAguar 0xc34 -+#define rTxAGC_A_MCS15_MCS12_JAguar 0xc38 -+#define rTxAGC_A_Nss1Index3_Nss1Index0_JAguar 0xc3c -+#define rTxAGC_A_Nss1Index7_Nss1Index4_JAguar 0xc40 -+#define rTxAGC_A_Nss2Index1_Nss1Index8_JAguar 0xc44 -+#define rTxAGC_A_Nss2Index5_Nss2Index2_JAguar 0xc48 -+#define rTxAGC_A_Nss2Index9_Nss2Index6_JAguar 0xc4c -+#define rTxAGC_B_CCK11_CCK1_JAguar 0xe20 -+#define rTxAGC_B_Ofdm18_Ofdm6_JAguar 0xe24 -+#define rTxAGC_B_Ofdm54_Ofdm24_JAguar 0xe28 -+#define rTxAGC_B_MCS3_MCS0_JAguar 0xe2c -+#define rTxAGC_B_MCS7_MCS4_JAguar 0xe30 -+#define rTxAGC_B_MCS11_MCS8_JAguar 0xe34 -+#define rTxAGC_B_MCS15_MCS12_JAguar 0xe38 -+#define rTxAGC_B_Nss1Index3_Nss1Index0_JAguar 0xe3c -+#define rTxAGC_B_Nss1Index7_Nss1Index4_JAguar 0xe40 -+#define rTxAGC_B_Nss2Index1_Nss1Index8_JAguar 0xe44 -+#define rTxAGC_B_Nss2Index5_Nss2Index2_JAguar 0xe48 -+#define rTxAGC_B_Nss2Index9_Nss2Index6_JAguar 0xe4c -+#define bTxAGC_byte0_Jaguar 0xff -+#define bTxAGC_byte1_Jaguar 0xff00 -+#define bTxAGC_byte2_Jaguar 0xff0000 -+#define bTxAGC_byte3_Jaguar 0xff000000 -+ -+ -+/* TX AGC */ -+#define rTxAGC_A_CCK11_CCK1_Jaguar2 0xc20 -+#define rTxAGC_A_Ofdm18_Ofdm6_Jaguar2 0xc24 -+#define rTxAGC_A_Ofdm54_Ofdm24_Jaguar2 0xc28 -+#define rTxAGC_A_MCS3_MCS0_Jaguar2 0xc2c -+#define rTxAGC_A_MCS7_MCS4_Jaguar2 0xc30 -+#define rTxAGC_A_MCS11_MCS8_Jaguar2 0xc34 -+#define rTxAGC_A_MCS15_MCS12_Jaguar2 0xc38 -+#define rTxAGC_A_MCS19_MCS16_Jaguar2 0xcd8 -+#define rTxAGC_A_MCS23_MCS20_Jaguar2 0xcdc -+#define rTxAGC_A_Nss1Index3_Nss1Index0_Jaguar2 0xc3c -+#define rTxAGC_A_Nss1Index7_Nss1Index4_Jaguar2 0xc40 -+#define rTxAGC_A_Nss2Index1_Nss1Index8_Jaguar2 0xc44 -+#define rTxAGC_A_Nss2Index5_Nss2Index2_Jaguar2 0xc48 -+#define rTxAGC_A_Nss2Index9_Nss2Index6_Jaguar2 0xc4c -+#define rTxAGC_A_Nss3Index3_Nss3Index0_Jaguar2 0xce0 -+#define rTxAGC_A_Nss3Index7_Nss3Index4_Jaguar2 0xce4 -+#define rTxAGC_A_Nss3Index9_Nss3Index8_Jaguar2 0xce8 -+#define rTxAGC_B_CCK11_CCK1_Jaguar2 0xe20 -+#define rTxAGC_B_Ofdm18_Ofdm6_Jaguar2 0xe24 -+#define rTxAGC_B_Ofdm54_Ofdm24_Jaguar2 0xe28 -+#define rTxAGC_B_MCS3_MCS0_Jaguar2 0xe2c -+#define rTxAGC_B_MCS7_MCS4_Jaguar2 0xe30 -+#define rTxAGC_B_MCS11_MCS8_Jaguar2 0xe34 -+#define rTxAGC_B_MCS15_MCS12_Jaguar2 0xe38 -+#define rTxAGC_B_MCS19_MCS16_Jaguar2 0xed8 -+#define rTxAGC_B_MCS23_MCS20_Jaguar2 0xedc -+#define rTxAGC_B_Nss1Index3_Nss1Index0_Jaguar2 0xe3c -+#define rTxAGC_B_Nss1Index7_Nss1Index4_Jaguar2 0xe40 -+#define rTxAGC_B_Nss2Index1_Nss1Index8_Jaguar2 0xe44 -+#define rTxAGC_B_Nss2Index5_Nss2Index2_Jaguar2 0xe48 -+#define rTxAGC_B_Nss2Index9_Nss2Index6_Jaguar2 0xe4c -+#define rTxAGC_B_Nss3Index3_Nss3Index0_Jaguar2 0xee0 -+#define rTxAGC_B_Nss3Index7_Nss3Index4_Jaguar2 0xee4 -+#define rTxAGC_B_Nss3Index9_Nss3Index8_Jaguar2 0xee8 -+#define rTxAGC_C_CCK11_CCK1_Jaguar2 0x1820 -+#define rTxAGC_C_Ofdm18_Ofdm6_Jaguar2 0x1824 -+#define rTxAGC_C_Ofdm54_Ofdm24_Jaguar2 0x1828 -+#define rTxAGC_C_MCS3_MCS0_Jaguar2 0x182c -+#define rTxAGC_C_MCS7_MCS4_Jaguar2 0x1830 -+#define rTxAGC_C_MCS11_MCS8_Jaguar2 0x1834 -+#define rTxAGC_C_MCS15_MCS12_Jaguar2 0x1838 -+#define rTxAGC_C_MCS19_MCS16_Jaguar2 0x18d8 -+#define rTxAGC_C_MCS23_MCS20_Jaguar2 0x18dc -+#define rTxAGC_C_Nss1Index3_Nss1Index0_Jaguar2 0x183c -+#define rTxAGC_C_Nss1Index7_Nss1Index4_Jaguar2 0x1840 -+#define rTxAGC_C_Nss2Index1_Nss1Index8_Jaguar2 0x1844 -+#define rTxAGC_C_Nss2Index5_Nss2Index2_Jaguar2 0x1848 -+#define rTxAGC_C_Nss2Index9_Nss2Index6_Jaguar2 0x184c -+#define rTxAGC_C_Nss3Index3_Nss3Index0_Jaguar2 0x18e0 -+#define rTxAGC_C_Nss3Index7_Nss3Index4_Jaguar2 0x18e4 -+#define rTxAGC_C_Nss3Index9_Nss3Index8_Jaguar2 0x18e8 -+#define rTxAGC_D_CCK11_CCK1_Jaguar2 0x1a20 -+#define rTxAGC_D_Ofdm18_Ofdm6_Jaguar2 0x1a24 -+#define rTxAGC_D_Ofdm54_Ofdm24_Jaguar2 0x1a28 -+#define rTxAGC_D_MCS3_MCS0_Jaguar2 0x1a2c -+#define rTxAGC_D_MCS7_MCS4_Jaguar2 0x1a30 -+#define rTxAGC_D_MCS11_MCS8_Jaguar2 0x1a34 -+#define rTxAGC_D_MCS15_MCS12_Jaguar2 0x1a38 -+#define rTxAGC_D_MCS19_MCS16_Jaguar2 0x1ad8 -+#define rTxAGC_D_MCS23_MCS20_Jaguar2 0x1adc -+#define rTxAGC_D_Nss1Index3_Nss1Index0_Jaguar2 0x1a3c -+#define rTxAGC_D_Nss1Index7_Nss1Index4_Jaguar2 0x1a40 -+#define rTxAGC_D_Nss2Index1_Nss1Index8_Jaguar2 0x1a44 -+#define rTxAGC_D_Nss2Index5_Nss2Index2_Jaguar2 0x1a48 -+#define rTxAGC_D_Nss2Index9_Nss2Index6_Jaguar2 0x1a4c -+#define rTxAGC_D_Nss3Index3_Nss3Index0_Jaguar2 0x1ae0 -+#define rTxAGC_D_Nss3Index7_Nss3Index4_Jaguar2 0x1ae4 -+#define rTxAGC_D_Nss3Index9_Nss3Index8_Jaguar2 0x1ae8 -+/* IQK YN: temporaily mask this part -+ * #define rFPGA0_IQK 0xe28 -+ * #define rTx_IQK_Tone_A 0xe30 -+ * #define rRx_IQK_Tone_A 0xe34 -+ * #define rTx_IQK_PI_A 0xe38 -+ * #define rRx_IQK_PI_A 0xe3c */ -+ -+/* #define rTx_IQK 0xe40 */ -+/* #define rRx_IQK 0xe44 */ -+/* #define rIQK_AGC_Pts 0xe48 */ -+/* #define rIQK_AGC_Rsp 0xe4c */ -+/* #define rTx_IQK_Tone_B 0xe50 */ -+/* #define rRx_IQK_Tone_B 0xe54 */ -+/* #define rTx_IQK_PI_B 0xe58 */ -+/* #define rRx_IQK_PI_B 0xe5c */ -+/* #define rIQK_AGC_Cont 0xe60 */ -+ -+ -+/* AFE-related */ -+#define rA_AFEPwr1_Jaguar 0xc60 /* dynamic AFE power control */ -+#define rA_AFEPwr2_Jaguar 0xc64 /* dynamic AFE power control */ -+#define rA_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xc68 -+#define rA_Tx_CCKBBON_OFDMRFON_Jaguar 0xc6c -+#define rA_Tx_OFDMBBON_Tx2Rx_Jaguar 0xc70 -+#define rA_Tx2Tx_RXCCK_Jaguar 0xc74 -+#define rA_Rx_OFDM_WaitRIFS_Jaguar 0xc78 -+#define rA_Rx2Rx_BT_Jaguar 0xc7c -+#define rA_sleep_nav_Jaguar 0xc80 -+#define rA_pmpd_Jaguar 0xc84 -+#define rB_AFEPwr1_Jaguar 0xe60 /* dynamic AFE power control */ -+#define rB_AFEPwr2_Jaguar 0xe64 /* dynamic AFE power control */ -+#define rB_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xe68 -+#define rB_Tx_CCKBBON_OFDMRFON_Jaguar 0xe6c -+#define rB_Tx_OFDMBBON_Tx2Rx_Jaguar 0xe70 -+#define rB_Tx2Tx_RXCCK_Jaguar 0xe74 -+#define rB_Rx_OFDM_WaitRIFS_Jaguar 0xe78 -+#define rB_Rx2Rx_BT_Jaguar 0xe7c -+#define rB_sleep_nav_Jaguar 0xe80 -+#define rB_pmpd_Jaguar 0xe84 -+ -+ -+/* YN: mask these registers temporaily -+ * #define rTx_Power_Before_IQK_A 0xe94 -+ * #define rTx_Power_After_IQK_A 0xe9c */ -+ -+/* #define rRx_Power_Before_IQK_A 0xea0 */ -+/* #define rRx_Power_Before_IQK_A_2 0xea4 */ -+/* #define rRx_Power_After_IQK_A 0xea8 */ -+/* #define rRx_Power_After_IQK_A_2 0xeac */ -+ -+/* #define rTx_Power_Before_IQK_B 0xeb4 */ -+/* #define rTx_Power_After_IQK_B 0xebc */ -+ -+/* #define rRx_Power_Before_IQK_B 0xec0 */ -+/* #define rRx_Power_Before_IQK_B_2 0xec4 */ -+/* #define rRx_Power_After_IQK_B 0xec8 */ -+/* #define rRx_Power_After_IQK_B_2 0xecc */ -+ -+ -+/* RSSI Dump */ -+#define rA_RSSIDump_Jaguar 0xBF0 -+#define rB_RSSIDump_Jaguar 0xBF1 -+#define rS1_RXevmDump_Jaguar 0xBF4 -+#define rS2_RXevmDump_Jaguar 0xBF5 -+#define rA_RXsnrDump_Jaguar 0xBF6 -+#define rB_RXsnrDump_Jaguar 0xBF7 -+#define rA_CfoShortDump_Jaguar 0xBF8 -+#define rB_CfoShortDump_Jaguar 0xBFA -+#define rA_CfoLongDump_Jaguar 0xBEC -+#define rB_CfoLongDump_Jaguar 0xBEE -+ -+ -+/* RF Register -+ * */ -+#define RF_AC_Jaguar 0x00 /* */ -+#define RF_RF_Top_Jaguar 0x07 /* */ -+#define RF_TXLOK_Jaguar 0x08 /* */ -+#define RF_TXAPK_Jaguar 0x0B -+#define RF_CHNLBW_Jaguar 0x18 /* RF channel and BW switch */ -+#define RF_RCK1_Jaguar 0x1c /* */ -+#define RF_RCK2_Jaguar 0x1d -+#define RF_RCK3_Jaguar 0x1e -+#define RF_ModeTableAddr 0x30 -+#define RF_ModeTableData0 0x31 -+#define RF_ModeTableData1 0x32 -+#define RF_TxLCTank_Jaguar 0x54 -+#define RF_APK_Jaguar 0x63 -+#define RF_LCK 0xB4 -+#define RF_WeLut_Jaguar 0xEF -+ -+#define bRF_CHNLBW_MOD_AG_Jaguar 0x70300 -+#define bRF_CHNLBW_BW 0xc00 -+ -+ -+/* -+ * RL6052 Register definition -+ * */ -+#define RF_AC 0x00 /* */ -+#define RF_IPA_A 0x0C /* */ -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_MODE1 0x10 /* */ -+#define RF_MODE2 0x11 /* */ -+#define RF_CHNLBW 0x18 /* RF channel and BW switch */ -+#define RF_RCK_OS 0x30 /* RF TX PA control */ -+#define RF_TXPA_G1 0x31 /* RF TX PA control */ -+#define RF_TXPA_G2 0x32 /* RF TX PA control */ -+#define RF_TXPA_G3 0x33 /* RF TX PA control */ -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+ -+/* -+ * Bit Mask -+ * -+ * 1. Page1(0x100) */ -+#define bBBResetB 0x100 /* Useless now? */ -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+ -+/* -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 1. Page1(0x100) -+ * */ -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+/* -+ * 3. Page8(0x800) -+ * */ -+#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA0_TxInfo 0x804 /* Status report?? */ -+#define rFPGA0_PSDFunction 0x808 -+#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+ -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 -+#define rFPGA0_AdDaClockEn 0x888 /* enable ad/da clock1 for dual-phy */ -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_XCD_RFPara 0x8b4 -+#define rFPGA0_PSDReport 0x8b4 /* Useless now */ -+#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ -+#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ -+ -+/* -+ * 4. Page9(0x900) -+ * */ -+#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ -+#define REG_BB_TX_PATH_SEL_1_8814A 0x93c -+#define REG_BB_TX_PATH_SEL_2_8814A 0x940 -+#define rFPGA1_TxBlock 0x904 /* Useless now */ -+#define rFPGA1_DebugSelect 0x908 /* Useless now */ -+#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ -+/*Page 19 for TxBF*/ -+#define REG_BB_TXBF_ANT_SET_BF1_8814A 0x19ac -+#define REG_BB_TXBF_ANT_SET_BF0_8814A 0x19b4 -+/* -+ * PageA(0xA00) -+ * */ -+#define rCCK0_System 0xa00 -+#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ -+#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ -+#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ -+ -+/* -+ * PageB(0xB00) -+ * */ -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rConfig_Pmpd_AntB 0xb98 -+#define rAPK 0xbd8 -+ -+/* -+ * 6. PageC(0xC00) -+ * */ -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ -+#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ -+#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ -+#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ -+#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ -+ -+#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ -+#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ -+#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ -+#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ -+ -+#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+/* -+ * 7. PageD(0xD00) -+ * */ -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+/* -+ * 8. PageE(0xE00) -+ * */ -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+ -+/* 2. Page8(0x800) */ -+#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+/* 4. PageA(0xA00) */ -+#define bCCKBBMode 0x3 /* Useless */ -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ -+ -+#define bCCKScramble 0x8 /* Useless */ -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ -+#define bCCKFixedRxAGC 0x8000 -+/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+#define RF_T_METER_88E 0x42 -+ -+/* 6. PageE(0xE00) */ -+#define bSTBCEn 0x4 /* Useless */ -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+ -+ -+/* -+ * Other Definition -+ * */ -+ -+#define bEnable 0x1 /* Useless */ -+#define bDisable 0x0 -+ -+/* byte endable for srwrite */ -+#define bByte0 0x1 /* Useless */ -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+/* for PutRegsetting & GetRegSetting BitMask */ -+#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH3Bytes 0xffffff00 -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+#define bMask7bits 0x7f -+#define bMaskByte2HighNibble 0x00f00000 -+#define bMaskByte3LowNibble 0x0f000000 -+#define bMaskL3Bytes 0x00ffffff -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8814PwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8814PwrSeq.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8814PwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8814PwrSeq.h 2018-02-11 21:44:27.165146360 +0200 -@@ -0,0 +1,236 @@ -+ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL8814PWRSEQ_H__ -+#define __HAL8814PWRSEQ_H__ -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WB-110628-DZ-RTL8195 (Jaguar) Power Architecture-R04.pdf -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8814A_TRANS_CARDEMU_TO_ACT_STEPS 16 -+#define RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS 20 -+#define RTL8814A_TRANS_CARDEMU_TO_SUS_STEPS 17 -+#define RTL8814A_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8814A_TRANS_CARDEMU_TO_PDN_STEPS 17 -+#define RTL8814A_TRANS_PDN_TO_CARDEMU_STEPS 16 -+#define RTL8814A_TRANS_ACT_TO_LPS_STEPS 20 -+#define RTL8814A_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8814A_TRANS_END_STEPS 1 -+ -+ -+#define RTL8814A_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x002B, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /* ??0x28[24]=1, enable pll phase select*/ \ -+ {0x0015, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT3 | BIT2 | BIT1), (BIT3 | BIT2 | BIT1)},/* 0x14[11:9]=3'b111, OCP current threshold = 1.5A */ \ -+ {0x002D, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x0E, 0x08},/* 0x2C[11:9]=3'b100, select lpf R3 */ \ -+ {0x002D, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x70, 0x50},/* 0x2C[14:12]=3'b101, select lpf Rs*/ \ -+ {0x007B, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/* 0x78[30]=1'b1, SDM order select*/ \ -+ /*{0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0}, */ /* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0},/* disable WL suspend*/ \ -+ {0x00F0, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* */ \ -+ {0x0081, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x30, 0x20},/* */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ -+ -+#define RTL8814A_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ -+ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US}, /*Delay 1us*/ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ -+ {0x0002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US}, /*Delay 1us*/ \ -+ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*0x1F[7:0] = 0 turn off RF*/ \ -+ /*{0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},*/ /*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x28}, /* 0x07[7:0] = 0x28 sps pwm mode 0x2a for BT coex*/ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x02, 0}, /*0x8[1] = 0 ANA clk = 500k */ \ -+ /*{0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 | BIT1, 0},*/ /* 0x02[1:0] = 0 reset BB */ \ -+ {0x0066, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0}, /*0x66[7]=0, disable ckreq for gpio7 output SUS */ \ -+ {0x0041, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x41[4]=0, disable sic for gpio7 output SUS */ \ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /*0x42[1]=0, disable ckout for gpio7 output SUS */ \ -+ {0x004e, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5}, /*0x4E[5]=1, disable LED2 for gpio7 output SUS */ \ -+ {0x0041, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x41[0]=0, disable uart for gpio7 output SUS */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ -+ -+#define RTL8814A_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0061, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x0F, 0x0c},\ -+ {0x0061, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x0F, 0x0E},\ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x0F, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ -+ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ -+ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/* suspend option all off */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*0x14[13] = 1 turn on ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/* 0x14[14] =1 trun on ZCD */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*0x8[1] = 0 ANA clk = 500k */ \ -+ {0x0091, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xA0, 0xA0}, /* 0x91[7]=1 0x91[5]=1 , disable sps, ldo sleep mode */ \ -+ {0x0070, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3}, /* 0x70[3]=1 enable mainbias polling */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 1 enable WL suspend */ -+ -+#define RTL8814A_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 0 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO sleep mode leave */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/* 0x14[14] =0 trun off ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0},/*0x14[13] = 0 turn off ZCD */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ -+ -+#define RTL8814A_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ /**{0x0194, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, //0x194[0]=0 , disable 32K clock*/ \ -+ /**{0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x94}, //0x93 = 0x94 , 90[30] =0 enable 500k ANA clock .switch clock from 12M to 500K , 90 [26] =0 disable EEprom loader clock*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*0x03[2] = 0, reset 3081*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x01}, /*0x80 = 05h if reload fw, fill the default value of host_CPU handshake field*/ \ -+ {0x0081, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x30}, /*0x80 = 05h if reload fw, fill the default value of host_CPU handshake field*/ \ -+ /*{0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xF0, 0xcc},*/ \ -+ /*{0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xF0, 0xEC},*/ \ -+ /*{0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x07},*/ /* gpio11 input mode, gpio10~8 output mode */ \ -+ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ -+ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/* 0x15[6] =1 trun on ZCD output */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*0x15[5] = 1 turn on ZCD */ \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/*0x12[6] = 0 force PFM mode */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*0x8[1] = 0 ANA clk = 500k */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ -+ {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* 0x01f[1]=0 , disable RFC_0 control REG_RF_CTRL_8814A */ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* 0x020[1]=0 , disable RFC_1 control REG_RF_CTRL_8814A */ \ -+ {0x0021, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* 0x021[1]=0 , disable RFC_2 control REG_RF_CTRL_8814A */ \ -+ {0x0076, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* 0x076[1]=0 , disable RFC_3 control REG_OPT_CTRL_8814A +2 */ \ -+ {0x0091, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xA0, 0xA0}, /* 0x91[7]=1 0x91[5]=1 , disable sps, ldo sleep mode */ \ -+ {0x0070, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3}, /* 0x70[3]=1 enable mainbias polling */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 1 enable WL suspend*/ -+ -+#define RTL8814A_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, BIT6},/*0x12[6] = 1 force PWM mode */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0},/*0x15[5] = 0 turn off ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/* 0x15[6] =0 trun off ZCD output */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0},/*0x23[4] = 0 hpon LDO leave sleep mode */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00}, /* gpio11 input mode, gpio10~8 input mode */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*0x04[10] = 0, enable SW LPS PCIE only*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 0, enable WL suspend*/ \ -+ /*{0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2},*/ /*0x03[2] = 1, enable 3081*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ \ -+ {0x0071, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0},/*0x70[10] = 0, CPHY_MBIAS_EN disable*/ -+ -+ -+#define RTL8814A_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8814A_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8814A_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x7F},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ -+ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated, and RF closed*/ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated, and RF closed*/ \ -+ {0x0002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x05F1, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Respond TxOK to scheduler*/ -+ -+ -+#define RTL8814A_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/ \ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/ \ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /* Delay*/ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/ \ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /* Polling 0x109[7]=0 TSF in 40M*/ \ -+ /*{0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, */ /*. ??0x29[7:6] = 2b'00 enable BB clock*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/ \ -+ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/ \ -+ {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x1002[1:0] = 2b'11 enable BB macro*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8814A_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, -+ -+ -+extern WLAN_PWR_CFG rtl8814A_power_on_flow[RTL8814A_TRANS_CARDEMU_TO_ACT_STEPS + RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_radio_off_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_card_disable_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8814A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_card_enable_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8814A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_suspend_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8814A_TRANS_CARDEMU_TO_SUS_STEPS + RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_resume_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8814A_TRANS_CARDEMU_TO_SUS_STEPS + RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_hwpdn_flow[RTL8814A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8814A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_enter_lps_flow[RTL8814A_TRANS_ACT_TO_LPS_STEPS + RTL8814A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8814A_leave_lps_flow[RTL8814A_TRANS_LPS_TO_ACT_STEPS + RTL8814A_TRANS_END_STEPS]; -+ -+#endif /* __HAL8814PWRSEQ_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/Hal8821APwrSeq.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8821APwrSeq.h ---- linux-4.14.18/3rdparty/rtl8723de/include/Hal8821APwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/Hal8821APwrSeq.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,186 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8821 -+#define REALTEK_POWER_SEQUENCE_8821 -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WM-20130516-JackieLau-RTL8821A_Power_Architecture-R10.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS 25 -+#define RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8821A_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS 15 -+#define RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8821A_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8821A_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8821A_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8821A_TRANS_END_STEPS 1 -+ -+ -+#define RTL8821A_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ -+ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3 | BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[12:11]=0*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , BIT0},/* Disable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0 , 0},/* Enable USB suspend */ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT4 | BIT3), 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ {0x004F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*0x4C[24] = 0x4F[0] = 1, switch DPDT_SEL_P output from WL BB */\ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT5 | BIT4), (BIT5 | BIT4)},/*0x66[13] = 0x67[5] = 1, switch for PAPE_G/PAPE_A from WL BB ; 0x66[12] = 0x67[4] = 1, switch LNAON from WL BB */\ -+ {0x0025, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6, 0},/*anapar_mac<118> , 0x25[6]=0 by wlan single function*/\ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ -+ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable GPIO9 interrupt mode*/\ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ -+ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ -+ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1},/*Enable HSISR GPIO9 interrupt*/\ -+ {0x007A, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x3A},/*0x7A = 0x3A start BT*/\ -+ {0x002E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF , 0x82 },/* 0x2C[23:12]=0x820 ; XTAL trim */ \ -+ {0x0010, PWR_CUT_A_MSK , PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 , BIT6 },/* 0x10[6]=1 ; MP·s¼W¹ï©ó0x2Cªº±±¨îÅv¡A¶·§â0x10[6]³]¬°1¤~¯àÅýWLAN±±¨î */ \ -+ -+ -+#define RTL8821A_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x004F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*0x4C[24] = 0x4F[0] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/ \ -+ -+ -+#define RTL8821A_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4 | BIT3, (BIT4 | BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3 | BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8821A_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8821A_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07 = 0x20 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8821A_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3 | BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8821A_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK | PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8821A_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8821A_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8821A_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK, PWR_BASEADDR_SDIO, PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT6 | BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8821A_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, 0, PWR_CMD_END, 0, 0}, -+ -+ -+ extern WLAN_PWR_CFG rtl8821A_power_on_flow[RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS + RTL8821A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8821A_radio_off_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8821A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8821A_card_disable_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8821A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8821A_card_enable_flow[RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS + RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS + RTL8821A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8821A_suspend_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS + RTL8821A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8821A_resume_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS + RTL8821A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8821A_hwpdn_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS + RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS + RTL8821A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8821A_enter_lps_flow[RTL8821A_TRANS_ACT_TO_LPS_STEPS + RTL8821A_TRANS_END_STEPS]; -+ extern WLAN_PWR_CFG rtl8821A_leave_lps_flow[RTL8821A_TRANS_LPS_TO_ACT_STEPS + RTL8821A_TRANS_END_STEPS]; -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_btcoex.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_btcoex.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_btcoex.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_btcoex.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,94 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_BTCOEX_H__ -+#define __HAL_BTCOEX_H__ -+ -+#include -+ -+/* Some variables can't get from outsrc BT-Coex, -+ * so we need to save here */ -+typedef struct _BT_COEXIST { -+ u8 bBtExist; -+ u8 btTotalAntNum; -+ u8 btChipType; -+ u8 bInitlized; -+ u8 btAntisolation; -+} BT_COEXIST, *PBT_COEXIST; -+ -+void DBG_BT_INFO(u8 *dbgmsg); -+ -+void hal_btcoex_SetBTCoexist(PADAPTER padapter, u8 bBtExist); -+u8 hal_btcoex_IsBtExist(PADAPTER padapter); -+u8 hal_btcoex_IsBtDisabled(PADAPTER); -+void hal_btcoex_SetChipType(PADAPTER padapter, u8 chipType); -+void hal_btcoex_SetPgAntNum(PADAPTER padapter, u8 antNum); -+ -+u8 hal_btcoex_Initialize(PADAPTER padapter); -+void hal_btcoex_PowerOnSetting(PADAPTER padapter); -+void hal_btcoex_PowerOffSetting(PADAPTER padapter); -+void hal_btcoex_PreLoadFirmware(PADAPTER padapter); -+void hal_btcoex_InitHwConfig(PADAPTER padapter, u8 bWifiOnly); -+ -+void hal_btcoex_IpsNotify(PADAPTER padapter, u8 type); -+void hal_btcoex_LpsNotify(PADAPTER padapter, u8 type); -+void hal_btcoex_ScanNotify(PADAPTER padapter, u8 type); -+void hal_btcoex_ConnectNotify(PADAPTER padapter, u8 action); -+void hal_btcoex_MediaStatusNotify(PADAPTER padapter, u8 mediaStatus); -+void hal_btcoex_SpecialPacketNotify(PADAPTER padapter, u8 pktType); -+void hal_btcoex_IQKNotify(PADAPTER padapter, u8 state); -+void hal_btcoex_BtInfoNotify(PADAPTER padapter, u8 length, u8 *tmpBuf); -+void hal_btcoex_BtMpRptNotify(PADAPTER padapter, u8 length, u8 *tmpBuf); -+void hal_btcoex_SuspendNotify(PADAPTER padapter, u8 state); -+void hal_btcoex_HaltNotify(PADAPTER padapter, u8 do_halt); -+void hal_btcoex_SwitchBtTRxMask(PADAPTER padapter); -+ -+void hal_btcoex_Hanlder(PADAPTER padapter); -+ -+s32 hal_btcoex_IsBTCoexRejectAMPDU(PADAPTER padapter); -+s32 hal_btcoex_IsBTCoexCtrlAMPDUSize(PADAPTER padapter); -+u32 hal_btcoex_GetAMPDUSize(PADAPTER padapter); -+void hal_btcoex_SetManualControl(PADAPTER padapter, u8 bmanual); -+u8 hal_btcoex_1Ant(PADAPTER padapter); -+u8 hal_btcoex_IsBtControlLps(PADAPTER); -+u8 hal_btcoex_IsLpsOn(PADAPTER); -+u8 hal_btcoex_RpwmVal(PADAPTER); -+u8 hal_btcoex_LpsVal(PADAPTER); -+u32 hal_btcoex_GetRaMask(PADAPTER); -+void hal_btcoex_RecordPwrMode(PADAPTER padapter, u8 *pCmdBuf, u8 cmdLen); -+void hal_btcoex_DisplayBtCoexInfo(PADAPTER, u8 *pbuf, u32 bufsize); -+void hal_btcoex_SetDBG(PADAPTER, u32 *pDbgModule); -+u32 hal_btcoex_GetDBG(PADAPTER, u8 *pStrBuf, u32 bufSize); -+u8 hal_btcoex_IncreaseScanDeviceNum(PADAPTER); -+u8 hal_btcoex_IsBtLinkExist(PADAPTER); -+void hal_btcoex_SetBtPatchVersion(PADAPTER, u16 btHciVer, u16 btPatchVer); -+void hal_btcoex_SetHciVersion(PADAPTER, u16 hciVersion); -+void hal_btcoex_SendScanNotify(PADAPTER, u8 type); -+void hal_btcoex_StackUpdateProfileInfo(void); -+void hal_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON); -+void hal_btcoex_SetAntIsolationType(PADAPTER padapter, u8 anttype); -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ int hal_btcoex_AntIsolationConfig_ParaFile(IN PADAPTER Adapter, IN char *pFileName); -+ int hal_btcoex_ParseAntIsolationConfigFile(PADAPTER Adapter, char *buffer); -+#endif /* CONFIG_LOAD_PHY_PARA_FROM_FILE */ -+u16 hal_btcoex_btreg_read(PADAPTER padapter, u8 type, u16 addr, u32 *data); -+u16 hal_btcoex_btreg_write(PADAPTER padapter, u8 type, u16 addr, u16 val); -+void hal_btcoex_set_rfe_type(u8 type); -+void hal_btcoex_switchband_notify(u8 under_scan, u8 band_type); -+#endif /* !__HAL_BTCOEX_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_com.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_com.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,639 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_COMMON_H__ -+#define __HAL_COMMON_H__ -+ -+#include "HalVerDef.h" -+#include "hal_pg.h" -+#include "hal_phy.h" -+#include "hal_phy_reg.h" -+#include "hal_com_reg.h" -+#include "hal_com_phycfg.h" -+#include "../hal/hal_com_c2h.h" -+ -+/*------------------------------ Tx Desc definition Macro ------------------------*/ -+/* #pragma mark -- Tx Desc related definition. -- */ -+/* ---------------------------------------------------------------------------- -+ * ----------------------------------------------------------- -+ * Rate -+ * ----------------------------------------------------------- -+ * CCK Rates, TxHT = 0 */ -+#define DESC_RATE1M 0x00 -+#define DESC_RATE2M 0x01 -+#define DESC_RATE5_5M 0x02 -+#define DESC_RATE11M 0x03 -+ -+/* OFDM Rates, TxHT = 0 */ -+#define DESC_RATE6M 0x04 -+#define DESC_RATE9M 0x05 -+#define DESC_RATE12M 0x06 -+#define DESC_RATE18M 0x07 -+#define DESC_RATE24M 0x08 -+#define DESC_RATE36M 0x09 -+#define DESC_RATE48M 0x0a -+#define DESC_RATE54M 0x0b -+ -+/* MCS Rates, TxHT = 1 */ -+#define DESC_RATEMCS0 0x0c -+#define DESC_RATEMCS1 0x0d -+#define DESC_RATEMCS2 0x0e -+#define DESC_RATEMCS3 0x0f -+#define DESC_RATEMCS4 0x10 -+#define DESC_RATEMCS5 0x11 -+#define DESC_RATEMCS6 0x12 -+#define DESC_RATEMCS7 0x13 -+#define DESC_RATEMCS8 0x14 -+#define DESC_RATEMCS9 0x15 -+#define DESC_RATEMCS10 0x16 -+#define DESC_RATEMCS11 0x17 -+#define DESC_RATEMCS12 0x18 -+#define DESC_RATEMCS13 0x19 -+#define DESC_RATEMCS14 0x1a -+#define DESC_RATEMCS15 0x1b -+#define DESC_RATEMCS16 0x1C -+#define DESC_RATEMCS17 0x1D -+#define DESC_RATEMCS18 0x1E -+#define DESC_RATEMCS19 0x1F -+#define DESC_RATEMCS20 0x20 -+#define DESC_RATEMCS21 0x21 -+#define DESC_RATEMCS22 0x22 -+#define DESC_RATEMCS23 0x23 -+#define DESC_RATEMCS24 0x24 -+#define DESC_RATEMCS25 0x25 -+#define DESC_RATEMCS26 0x26 -+#define DESC_RATEMCS27 0x27 -+#define DESC_RATEMCS28 0x28 -+#define DESC_RATEMCS29 0x29 -+#define DESC_RATEMCS30 0x2A -+#define DESC_RATEMCS31 0x2B -+#define DESC_RATEVHTSS1MCS0 0x2C -+#define DESC_RATEVHTSS1MCS1 0x2D -+#define DESC_RATEVHTSS1MCS2 0x2E -+#define DESC_RATEVHTSS1MCS3 0x2F -+#define DESC_RATEVHTSS1MCS4 0x30 -+#define DESC_RATEVHTSS1MCS5 0x31 -+#define DESC_RATEVHTSS1MCS6 0x32 -+#define DESC_RATEVHTSS1MCS7 0x33 -+#define DESC_RATEVHTSS1MCS8 0x34 -+#define DESC_RATEVHTSS1MCS9 0x35 -+#define DESC_RATEVHTSS2MCS0 0x36 -+#define DESC_RATEVHTSS2MCS1 0x37 -+#define DESC_RATEVHTSS2MCS2 0x38 -+#define DESC_RATEVHTSS2MCS3 0x39 -+#define DESC_RATEVHTSS2MCS4 0x3A -+#define DESC_RATEVHTSS2MCS5 0x3B -+#define DESC_RATEVHTSS2MCS6 0x3C -+#define DESC_RATEVHTSS2MCS7 0x3D -+#define DESC_RATEVHTSS2MCS8 0x3E -+#define DESC_RATEVHTSS2MCS9 0x3F -+#define DESC_RATEVHTSS3MCS0 0x40 -+#define DESC_RATEVHTSS3MCS1 0x41 -+#define DESC_RATEVHTSS3MCS2 0x42 -+#define DESC_RATEVHTSS3MCS3 0x43 -+#define DESC_RATEVHTSS3MCS4 0x44 -+#define DESC_RATEVHTSS3MCS5 0x45 -+#define DESC_RATEVHTSS3MCS6 0x46 -+#define DESC_RATEVHTSS3MCS7 0x47 -+#define DESC_RATEVHTSS3MCS8 0x48 -+#define DESC_RATEVHTSS3MCS9 0x49 -+#define DESC_RATEVHTSS4MCS0 0x4A -+#define DESC_RATEVHTSS4MCS1 0x4B -+#define DESC_RATEVHTSS4MCS2 0x4C -+#define DESC_RATEVHTSS4MCS3 0x4D -+#define DESC_RATEVHTSS4MCS4 0x4E -+#define DESC_RATEVHTSS4MCS5 0x4F -+#define DESC_RATEVHTSS4MCS6 0x50 -+#define DESC_RATEVHTSS4MCS7 0x51 -+#define DESC_RATEVHTSS4MCS8 0x52 -+#define DESC_RATEVHTSS4MCS9 0x53 -+ -+#define HDATA_RATE(rate)\ -+ (rate == DESC_RATE1M) ? "CCK_1M" :\ -+ (rate == DESC_RATE2M) ? "CCK_2M" :\ -+ (rate == DESC_RATE5_5M) ? "CCK5_5M" :\ -+ (rate == DESC_RATE11M) ? "CCK_11M" :\ -+ (rate == DESC_RATE6M) ? "OFDM_6M" :\ -+ (rate == DESC_RATE9M) ? "OFDM_9M" :\ -+ (rate == DESC_RATE12M) ? "OFDM_12M" :\ -+ (rate == DESC_RATE18M) ? "OFDM_18M" :\ -+ (rate == DESC_RATE24M) ? "OFDM_24M" :\ -+ (rate == DESC_RATE36M) ? "OFDM_36M" :\ -+ (rate == DESC_RATE48M) ? "OFDM_48M" :\ -+ (rate == DESC_RATE54M) ? "OFDM_54M" :\ -+ (rate == DESC_RATEMCS0) ? "MCS0" :\ -+ (rate == DESC_RATEMCS1) ? "MCS1" :\ -+ (rate == DESC_RATEMCS2) ? "MCS2" :\ -+ (rate == DESC_RATEMCS3) ? "MCS3" :\ -+ (rate == DESC_RATEMCS4) ? "MCS4" :\ -+ (rate == DESC_RATEMCS5) ? "MCS5" :\ -+ (rate == DESC_RATEMCS6) ? "MCS6" :\ -+ (rate == DESC_RATEMCS7) ? "MCS7" :\ -+ (rate == DESC_RATEMCS8) ? "MCS8" :\ -+ (rate == DESC_RATEMCS9) ? "MCS9" :\ -+ (rate == DESC_RATEMCS10) ? "MCS10" :\ -+ (rate == DESC_RATEMCS11) ? "MCS11" :\ -+ (rate == DESC_RATEMCS12) ? "MCS12" :\ -+ (rate == DESC_RATEMCS13) ? "MCS13" :\ -+ (rate == DESC_RATEMCS14) ? "MCS14" :\ -+ (rate == DESC_RATEMCS15) ? "MCS15" :\ -+ (rate == DESC_RATEMCS16) ? "MCS16" :\ -+ (rate == DESC_RATEMCS17) ? "MCS17" :\ -+ (rate == DESC_RATEMCS18) ? "MCS18" :\ -+ (rate == DESC_RATEMCS19) ? "MCS19" :\ -+ (rate == DESC_RATEMCS20) ? "MCS20" :\ -+ (rate == DESC_RATEMCS21) ? "MCS21" :\ -+ (rate == DESC_RATEMCS22) ? "MCS22" :\ -+ (rate == DESC_RATEMCS23) ? "MCS23" :\ -+ (rate == DESC_RATEVHTSS1MCS0) ? "VHTSS1MCS0" :\ -+ (rate == DESC_RATEVHTSS1MCS1) ? "VHTSS1MCS1" :\ -+ (rate == DESC_RATEVHTSS1MCS2) ? "VHTSS1MCS2" :\ -+ (rate == DESC_RATEVHTSS1MCS3) ? "VHTSS1MCS3" :\ -+ (rate == DESC_RATEVHTSS1MCS4) ? "VHTSS1MCS4" :\ -+ (rate == DESC_RATEVHTSS1MCS5) ? "VHTSS1MCS5" :\ -+ (rate == DESC_RATEVHTSS1MCS6) ? "VHTSS1MCS6" :\ -+ (rate == DESC_RATEVHTSS1MCS7) ? "VHTSS1MCS7" :\ -+ (rate == DESC_RATEVHTSS1MCS8) ? "VHTSS1MCS8" :\ -+ (rate == DESC_RATEVHTSS1MCS9) ? "VHTSS1MCS9" :\ -+ (rate == DESC_RATEVHTSS2MCS0) ? "VHTSS2MCS0" :\ -+ (rate == DESC_RATEVHTSS2MCS1) ? "VHTSS2MCS1" :\ -+ (rate == DESC_RATEVHTSS2MCS2) ? "VHTSS2MCS2" :\ -+ (rate == DESC_RATEVHTSS2MCS3) ? "VHTSS2MCS3" :\ -+ (rate == DESC_RATEVHTSS2MCS4) ? "VHTSS2MCS4" :\ -+ (rate == DESC_RATEVHTSS2MCS5) ? "VHTSS2MCS5" :\ -+ (rate == DESC_RATEVHTSS2MCS6) ? "VHTSS2MCS6" :\ -+ (rate == DESC_RATEVHTSS2MCS7) ? "VHTSS2MCS7" :\ -+ (rate == DESC_RATEVHTSS2MCS8) ? "VHTSS2MCS8" :\ -+ (rate == DESC_RATEVHTSS2MCS9) ? "VHTSS2MCS9" :\ -+ (rate == DESC_RATEVHTSS3MCS0) ? "VHTSS3MCS0" :\ -+ (rate == DESC_RATEVHTSS3MCS1) ? "VHTSS3MCS1" :\ -+ (rate == DESC_RATEVHTSS3MCS2) ? "VHTSS3MCS2" :\ -+ (rate == DESC_RATEVHTSS3MCS3) ? "VHTSS3MCS3" :\ -+ (rate == DESC_RATEVHTSS3MCS4) ? "VHTSS3MCS4" :\ -+ (rate == DESC_RATEVHTSS3MCS5) ? "VHTSS3MCS5" :\ -+ (rate == DESC_RATEVHTSS3MCS6) ? "VHTSS3MCS6" :\ -+ (rate == DESC_RATEVHTSS3MCS7) ? "VHTSS3MCS7" :\ -+ (rate == DESC_RATEVHTSS3MCS8) ? "VHTSS3MCS8" :\ -+ (rate == DESC_RATEVHTSS3MCS9) ? "VHTSS3MCS9" : "UNKNOWN" -+ -+enum { -+ UP_LINK, -+ DOWN_LINK, -+}; -+typedef enum _RT_MEDIA_STATUS { -+ RT_MEDIA_DISCONNECT = 0, -+ RT_MEDIA_CONNECT = 1 -+} RT_MEDIA_STATUS; -+ -+#define MAX_DLFW_PAGE_SIZE 4096 /* @ page : 4k bytes */ -+typedef enum _FIRMWARE_SOURCE { -+ FW_SOURCE_IMG_FILE = 0, -+ FW_SOURCE_HEADER_FILE = 1, /* from header file */ -+} FIRMWARE_SOURCE, *PFIRMWARE_SOURCE; -+ -+typedef enum _CH_SW_USE_CASE { -+ CH_SW_USE_CASE_TDLS = 0, -+ CH_SW_USE_CASE_MCC = 1 -+} CH_SW_USE_CASE; -+ -+typedef enum _WAKEUP_REASON{ -+ RX_PAIRWISEKEY = 0x01, -+ RX_GTK = 0x02, -+ RX_FOURWAY_HANDSHAKE = 0x03, -+ RX_DISASSOC = 0x04, -+ RX_DEAUTH = 0x08, -+ RX_ARP_REQUEST = 0x09, -+ FW_DECISION_DISCONNECT = 0x10, -+ RX_MAGIC_PKT = 0x21, -+ RX_UNICAST_PKT = 0x22, -+ RX_PATTERN_PKT = 0x23, -+ RTD3_SSID_MATCH = 0x24, -+ RX_REALWOW_V2_WAKEUP_PKT = 0x30, -+ RX_REALWOW_V2_ACK_LOST = 0x31, -+ ENABLE_FAIL_DMA_IDLE = 0x40, -+ ENABLE_FAIL_DMA_PAUSE = 0x41, -+ RTIME_FAIL_DMA_IDLE = 0x42, -+ RTIME_FAIL_DMA_PAUSE = 0x43, -+ RX_PNO = 0x55, -+ AP_OFFLOAD_WAKEUP = 0x66, -+ CLK_32K_UNLOCK = 0xFD, -+ CLK_32K_LOCK = 0xFE -+}WAKEUP_REASON; -+ -+/* -+ * Queue Select Value in TxDesc -+ * */ -+#define QSLT_BK 0x2/* 0x01 */ -+#define QSLT_BE 0x0 -+#define QSLT_VI 0x5/* 0x4 */ -+#define QSLT_VO 0x7/* 0x6 */ -+#define QSLT_BEACON 0x10 -+#define QSLT_HIGH 0x11 -+#define QSLT_MGNT 0x12 -+#define QSLT_CMD 0x13 -+ -+/* BK, BE, VI, VO, HCCA, MANAGEMENT, COMMAND, HIGH, BEACON. -+ * #define MAX_TX_QUEUE 9 */ -+ -+#define TX_SELE_HQ BIT(0) /* High Queue */ -+#define TX_SELE_LQ BIT(1) /* Low Queue */ -+#define TX_SELE_NQ BIT(2) /* Normal Queue */ -+#define TX_SELE_EQ BIT(3) /* Extern Queue */ -+ -+#define PageNum_128(_Len) (u32)(((_Len)>>7) + ((_Len) & 0x7F ? 1 : 0)) -+#define PageNum_256(_Len) (u32)(((_Len)>>8) + ((_Len) & 0xFF ? 1 : 0)) -+#define PageNum_512(_Len) (u32)(((_Len)>>9) + ((_Len) & 0x1FF ? 1 : 0)) -+#define PageNum(_Len, _Size) (u32)(((_Len)/(_Size)) + ((_Len)&((_Size) - 1) ? 1 : 0)) -+ -+struct dbg_rx_counter { -+ u32 rx_pkt_ok; -+ u32 rx_pkt_crc_error; -+ u32 rx_pkt_drop; -+ u32 rx_ofdm_fa; -+ u32 rx_cck_fa; -+ u32 rx_ht_fa; -+}; -+ -+#ifdef CONFIG_MBSSID_CAM -+ #define DBG_MBID_CAM_DUMP -+ -+ void rtw_mbid_cam_init(struct dvobj_priv *dvobj); -+ void rtw_mbid_cam_deinit(struct dvobj_priv *dvobj); -+ void rtw_mbid_cam_reset(_adapter *adapter); -+ u8 rtw_get_max_mbid_cam_id(_adapter *adapter); -+ u8 rtw_get_mbid_cam_entry_num(_adapter *adapter); -+ int rtw_mbid_cam_cache_dump(void *sel, const char *fun_name , _adapter *adapter); -+ int rtw_mbid_cam_dump(void *sel, const char *fun_name, _adapter *adapter); -+ void rtw_mbid_cam_restore(_adapter *adapter); -+#endif -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ void rtw_hal_set_macaddr_mbid(_adapter *adapter, u8 *mac_addr); -+ void rtw_hal_change_macaddr_mbid(_adapter *adapter, u8 *mac_addr); -+#endif -+ -+void rtw_dump_mac_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter); -+void rtw_dump_phy_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter); -+void rtw_reset_mac_rx_counters(_adapter *padapter); -+void rtw_reset_phy_rx_counters(_adapter *padapter); -+void rtw_reset_phy_trx_ok_counters(_adapter *padapter); -+ -+#ifdef DBG_RX_COUNTER_DUMP -+ #define DUMP_DRV_RX_COUNTER BIT0 -+ #define DUMP_MAC_RX_COUNTER BIT1 -+ #define DUMP_PHY_RX_COUNTER BIT2 -+ #define DUMP_DRV_TRX_COUNTER_DATA BIT3 -+ -+ void rtw_dump_phy_rxcnts_preprocess(_adapter *padapter, u8 rx_cnt_mode); -+ void rtw_dump_rx_counters(_adapter *padapter); -+#endif -+ -+void dump_chip_info(HAL_VERSION ChipVersion); -+void rtw_hal_config_rftype(PADAPTER padapter); -+ -+#define BAND_CAP_2G BIT0 -+#define BAND_CAP_5G BIT1 -+#define BAND_CAP_BIT_NUM 2 -+ -+#define BW_CAP_5M BIT0 -+#define BW_CAP_10M BIT1 -+#define BW_CAP_20M BIT2 -+#define BW_CAP_40M BIT3 -+#define BW_CAP_80M BIT4 -+#define BW_CAP_160M BIT5 -+#define BW_CAP_80_80M BIT6 -+#define BW_CAP_BIT_NUM 7 -+ -+#define PROTO_CAP_11B BIT0 -+#define PROTO_CAP_11G BIT1 -+#define PROTO_CAP_11N BIT2 -+#define PROTO_CAP_11AC BIT3 -+#define PROTO_CAP_BIT_NUM 4 -+ -+#define WL_FUNC_P2P BIT0 -+#define WL_FUNC_MIRACAST BIT1 -+#define WL_FUNC_TDLS BIT2 -+#define WL_FUNC_FTM BIT3 -+#define WL_FUNC_BIT_NUM 4 -+ -+int hal_spec_init(_adapter *adapter); -+void dump_hal_spec(void *sel, _adapter *adapter); -+ -+bool hal_chk_band_cap(_adapter *adapter, u8 cap); -+bool hal_chk_bw_cap(_adapter *adapter, u8 cap); -+bool hal_chk_proto_cap(_adapter *adapter, u8 cap); -+bool hal_is_band_support(_adapter *adapter, u8 band); -+bool hal_is_bw_support(_adapter *adapter, u8 bw); -+bool hal_is_wireless_mode_support(_adapter *adapter, u8 mode); -+u8 hal_largest_bw(_adapter *adapter, u8 in_bw); -+ -+bool hal_chk_wl_func(_adapter *adapter, u8 func); -+ -+u8 hal_com_config_channel_plan( -+ IN PADAPTER padapter, -+ IN char *hw_alpha2, -+ IN u8 hw_chplan, -+ IN char *sw_alpha2, -+ IN u8 sw_chplan, -+ IN u8 def_chplan, -+ IN BOOLEAN AutoLoadFail -+); -+ -+int hal_config_macaddr(_adapter *adapter, bool autoload_fail); -+ -+BOOLEAN -+HAL_IsLegalChannel( -+ IN PADAPTER Adapter, -+ IN u32 Channel -+); -+ -+u8 MRateToHwRate(u8 rate); -+ -+u8 HwRateToMRate(u8 rate); -+ -+void HalSetBrateCfg( -+ IN PADAPTER Adapter, -+ IN u8 *mBratesOS, -+ OUT u16 *pBrateCfg); -+ -+BOOLEAN -+Hal_MappingOutPipe( -+ IN PADAPTER pAdapter, -+ IN u8 NumOutPipe -+); -+ -+ -+void rtw_restore_mac_addr(_adapter *adapter);/*set mac addr when hal_init for all iface*/ -+void rtw_hal_dump_macaddr(void *sel, _adapter *adapter); -+ -+void rtw_init_hal_com_default_value(PADAPTER Adapter); -+ -+#ifdef CONFIG_FW_C2H_REG -+void c2h_evt_clear(_adapter *adapter); -+s32 c2h_evt_read_88xx(_adapter *adapter, u8 *buf); -+#endif -+ -+#ifdef CONFIG_FW_C2H_PKT -+void rtw_hal_c2h_pkt_pre_hdl(_adapter *adapter, u8 *buf, u16 len); -+void rtw_hal_c2h_pkt_hdl(_adapter *adapter, u8 *buf, u16 len); -+#endif -+ -+u8 rtw_hal_networktype_to_raid(_adapter *adapter, struct sta_info *psta); -+u8 rtw_get_mgntframe_raid(_adapter *adapter, unsigned char network_type); -+void rtw_hal_update_sta_rate_mask(PADAPTER padapter, struct sta_info *psta); -+ -+/* access HW only */ -+u32 rtw_sec_read_cam(_adapter *adapter, u8 addr); -+void rtw_sec_write_cam(_adapter *adapter, u8 addr, u32 wdata); -+void rtw_sec_read_cam_ent(_adapter *adapter, u8 id, u8 *ctrl, u8 *mac, u8 *key); -+void rtw_sec_write_cam_ent(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key); -+void rtw_sec_clr_cam_ent(_adapter *adapter, u8 id); -+bool rtw_sec_read_cam_is_gk(_adapter *adapter, u8 id); -+ -+void rtw_hal_set_msr(_adapter *adapter, u8 net_type); -+void rtw_hal_set_macaddr_port(_adapter *adapter, u8 *val); -+void rtw_hal_get_macaddr_port(_adapter *adapter, u8 *mac_addr); -+ -+void rtw_hal_set_bssid(_adapter *adapter, u8 *val); -+ -+void hw_var_port_switch(_adapter *adapter); -+ -+void SetHwReg(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg(PADAPTER padapter, u8 variable, u8 *val); -+void rtw_hal_check_rxfifo_full(_adapter *adapter); -+ -+u8 SetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value); -+u8 GetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value); -+ -+BOOLEAN -+eqNByte( -+ u8 *str1, -+ u8 *str2, -+ u32 num -+); -+ -+u32 -+MapCharToHexDigit( -+ IN char chTmp -+); -+ -+BOOLEAN -+GetHexValueFromString( -+ IN char *szStr, -+ IN OUT u32 *pu4bVal, -+ IN OUT u32 *pu4bMove -+); -+ -+BOOLEAN -+GetFractionValueFromString( -+ IN char *szStr, -+ IN OUT u8 *pInteger, -+ IN OUT u8 *pFraction, -+ IN OUT u32 *pu4bMove -+); -+ -+BOOLEAN -+IsCommentString( -+ IN char *szStr -+); -+ -+BOOLEAN -+ParseQualifiedString( -+ IN char *In, -+ IN OUT u32 *Start, -+ OUT char *Out, -+ IN char LeftQualifier, -+ IN char RightQualifier -+); -+ -+BOOLEAN -+GetU1ByteIntegerFromStringInDecimal( -+ IN char *Str, -+ IN OUT u8 *pInt -+); -+ -+BOOLEAN -+isAllSpaceOrTab( -+ u8 *data, -+ u8 size -+); -+ -+void linked_info_dump(_adapter *padapter, u8 benable); -+#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA -+ void rtw_get_raw_rssi_info(void *sel, _adapter *padapter); -+ void rtw_dump_raw_rssi_info(_adapter *padapter, void *sel); -+#endif -+ -+#ifdef DBG_RX_DFRAME_RAW_DATA -+ void rtw_dump_rx_dframe_info(_adapter *padapter, void *sel); -+#endif -+void rtw_store_phy_info(_adapter *padapter, union recv_frame *prframe); -+#define HWSET_MAX_SIZE 1024 -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ #define EFUSE_FILE_COLUMN_NUM 16 -+ u32 Hal_readPGDataFromConfigFile(PADAPTER padapter); -+ u32 Hal_ReadMACAddrFromFile(PADAPTER padapter, u8 *mac_addr); -+#endif /* CONFIG_EFUSE_CONFIG_FILE */ -+ -+int check_phy_efuse_tx_power_info_valid(PADAPTER padapter); -+int hal_efuse_macaddr_offset(_adapter *adapter); -+int Hal_GetPhyEfuseMACAddr(PADAPTER padapter, u8 *mac_addr); -+void rtw_dump_cur_efuse(PADAPTER padapter); -+ -+#ifdef CONFIG_RF_POWER_TRIM -+ void rtw_bb_rf_gain_offset(_adapter *padapter); -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ -+void dm_DynamicUsbTxAgg(_adapter *padapter, u8 from_timer); -+u8 rtw_hal_busagg_qsel_check(_adapter *padapter, u8 pre_qsel, u8 next_qsel); -+void GetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ PVOID pValue1, -+ PVOID pValue2); -+void SetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ PVOID pValue1, -+ BOOLEAN bSet); -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+struct noise_info { -+ u8 bPauseDIG; -+ u8 IGIValue; -+ u32 max_time;/* ms */ -+ u8 chan; -+}; -+#endif -+ -+void rtw_get_noise(_adapter *padapter); -+u8 rtw_get_current_tx_rate(_adapter *padapter, u8 macid); -+u8 rtw_get_current_tx_sgi(_adapter *padapter, u8 macid); -+void rtw_hal_construct_NullFunctionData(PADAPTER, u8 *pframe, u32 *pLength, u8 *StaAddr, u8 bQoS, u8 AC, u8 bEosp, u8 bForcePowerSave); -+ -+void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished); -+ -+#ifdef CONFIG_TDLS -+ #ifdef CONFIG_TDLS_CH_SW -+ s32 rtw_hal_ch_sw_oper_offload(_adapter *padapter, u8 channel, u8 channel_offset, u16 bwmode); -+ #endif -+#endif -+ -+#ifdef CONFIG_GPIO_API -+ u8 rtw_hal_get_gpio(_adapter *adapter, u8 gpio_num); -+ int rtw_hal_set_gpio_output_value(_adapter *adapter, u8 gpio_num, bool isHigh); -+ int rtw_hal_config_gpio(_adapter *adapter, u8 gpio_num, bool isOutput); -+ int rtw_hal_register_gpio_interrupt(_adapter *adapter, int gpio_num, void(*callback)(u8 level)); -+ int rtw_hal_disable_gpio_interrupt(_adapter *adapter, int gpio_num); -+#endif -+ -+s8 rtw_hal_ch_sw_iqk_info_search(_adapter *padapter, u8 central_chnl, u8 bw_mode); -+void rtw_hal_ch_sw_iqk_info_backup(_adapter *adapter); -+void rtw_hal_ch_sw_iqk_info_restore(_adapter *padapter, u8 ch_sw_use_case); -+ -+#ifdef CONFIG_RTW_SDIO_OOB_INT -+void rtw_hal_switch_ood_int_ctrl(_adapter *padapter, u8 enable); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ void rtw_hal_switch_gpio_wl_ctrl(_adapter *padapter, u8 index, u8 enable); -+ void rtw_hal_set_output_gpio(_adapter *padapter, u8 index, u8 outputval); -+#endif -+ -+typedef enum _HAL_PHYDM_OPS { -+ HAL_PHYDM_DIS_ALL_FUNC, -+ HAL_PHYDM_FUNC_SET, -+ HAL_PHYDM_FUNC_CLR, -+ HAL_PHYDM_ABILITY_BK, -+ HAL_PHYDM_ABILITY_RESTORE, -+ HAL_PHYDM_ABILITY_SET, -+ HAL_PHYDM_ABILITY_GET, -+} HAL_PHYDM_OPS; -+ -+ -+#define DYNAMIC_FUNC_DISABLE (0x0) -+u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability); -+ -+#define rtw_phydm_func_disable_all(adapter) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_DIS_ALL_FUNC, 0) -+ -+#define rtw_phydm_func_for_offchannel(adapter) \ -+ do { \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_DIS_ALL_FUNC, 0); \ -+ if (rtw_odm_adaptivity_needed(adapter)) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_SET, ODM_BB_ADAPTIVITY); \ -+ } while (0) -+ -+#define rtw_phydm_func_set(adapter, ability) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_SET, ability) -+ -+#define rtw_phydm_func_clr(adapter, ability) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_CLR, ability) -+ -+#define rtw_phydm_ability_backup(adapter) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_BK, 0) -+ -+#define rtw_phydm_ability_restore(adapter) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_RESTORE, 0) -+ -+#define rtw_phydm_ability_set(adapter, ability) \ -+ rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_SET, ability) -+ -+static inline u32 rtw_phydm_ability_get(_adapter *adapter) -+{ -+ return rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_GET, 0); -+} -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ extern char *rtw_phy_file_path; -+ extern char rtw_phy_para_file_path[PATH_LENGTH_MAX]; -+ #define GetLineFromBuffer(buffer) strsep(&buffer, "\r\n") -+#endif -+ -+void update_IOT_info(_adapter *padapter); -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ void rtw_acs_start(_adapter *padapter, bool bStart); -+#endif -+ -+void hal_set_crystal_cap(_adapter *adapter, u8 crystal_cap); -+void rtw_hal_correct_tsf(_adapter *padapter, u8 hw_port, u64 tsf); -+ -+void ResumeTxBeacon(_adapter *padapter); -+void StopTxBeacon(_adapter *padapter); -+#ifdef CONFIG_MI_WITH_MBSSID_CAM /*HW port0 - MBSS*/ -+ void hw_var_set_opmode_mbid(_adapter *Adapter, u8 mode); -+ u8 rtw_mbid_camid_alloc(_adapter *adapter, u8 *mac_addr); -+#endif -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ u8 rtw_hal_antdiv_before_linked(_adapter *padapter); -+ void rtw_hal_antdiv_rssi_compared(_adapter *padapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src); -+#endif -+ -+#ifdef DBG_SEC_CAM_MOVE -+ void rtw_hal_move_sta_gk_to_dk(_adapter *adapter); -+ void rtw_hal_read_sta_dk_key(_adapter *adapter, u8 key_id); -+#endif -+ -+#ifdef CONFIG_LPS_PG -+ u8 rtw_hal_set_lps_pg_info(_adapter *adapter); -+#endif -+ -+#endif /* __HAL_COMMON_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_com_h2c.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_h2c.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_com_h2c.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_h2c.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,528 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __COMMON_H2C_H__ -+#define __COMMON_H2C_H__ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ -+ * --------------------------------------------------------------------------------------------------------- -+ * 88e, 8723b, 8812, 8821, 92e use the same FW code base */ -+enum h2c_cmd { -+ /* Common Class: 000 */ -+ H2C_RSVD_PAGE = 0x00, -+ H2C_MEDIA_STATUS_RPT = 0x01, -+ H2C_SCAN_ENABLE = 0x02, -+ H2C_KEEP_ALIVE = 0x03, -+ H2C_DISCON_DECISION = 0x04, -+ H2C_PSD_OFFLOAD = 0x05, -+ H2C_CUSTOMER_STR_REQ = 0x06, -+ H2C_AP_OFFLOAD = 0x08, -+ H2C_BCN_RSVDPAGE = 0x09, -+ H2C_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_FCS_RSVDPAGE = 0x10, -+ H2C_FCS_INFO = 0x11, -+ H2C_AP_WOW_GPIO_CTRL = 0x13, -+#ifdef CONFIG_MCC_MODE -+ H2C_MCC_UPDATE_PARAM = 0x15, -+ H2C_MCC_MACID_BITMAP = 0x16, -+ H2C_MCC_LOCATION = 0x10, -+ H2C_MCC_INFO = 0x18, -+ H2C_MCC_NOA_PARAM = 0x19, -+ H2C_MCC_IQK_PARAM = 0x1A, -+#endif /* CONFIG_MCC_MODE */ -+ H2C_CHNL_SWITCH_OPER_OFFLOAD = 0x1C, -+ -+ /* PoweSave Class: 001 */ -+ H2C_SET_PWR_MODE = 0x20, -+ H2C_PS_TUNING_PARA = 0x21, -+ H2C_PS_TUNING_PARA2 = 0x22, -+ H2C_P2P_LPS_PARAM = 0x23, -+ H2C_P2P_PS_OFFLOAD = 0x24, -+ H2C_PS_SCAN_ENABLE = 0x25, -+ H2C_SAP_PS_ = 0x26, -+ H2C_INACTIVE_PS_ = 0x27, /* Inactive_PS */ -+ H2C_FWLPS_IN_IPS_ = 0x28, -+#ifdef CONFIG_LPS_POFF -+ H2C_LPS_POFF_CTRL = 0x29, -+ H2C_LPS_POFF_PARAM = 0x2A, -+#endif -+#ifdef CONFIG_LPS_PG -+ H2C_LPS_PG_INFO = 0x2B, -+#endif -+ /* Dynamic Mechanism Class: 010 */ -+ H2C_MACID_CFG = 0x40, -+ H2C_TXBF = 0x41, -+ H2C_RSSI_SETTING = 0x42, -+ H2C_AP_REQ_TXRPT = 0x43, -+ H2C_INIT_RATE_COLLECT = 0x44, -+ H2C_IQ_CALIBRATION = 0x45, -+ -+ H2C_RA_MASK_3SS = 0x46,/* for 8814A */ -+ H2C_RA_PARA_ADJUST = 0x47,/* CONFIG_RA_DBG_CMD */ -+ H2C_DYNAMIC_TX_PATH = 0x48,/* for 8814A */ -+ -+ H2C_FW_TRACE_EN = 0x49, -+ -+ /* BT Class: 011 */ -+ H2C_B_TYPE_TDMA = 0x60, -+ H2C_BT_INFO = 0x61, -+ H2C_FORCE_BT_TXPWR = 0x62, -+ H2C_BT_IGNORE_WLANACT = 0x63, -+ H2C_DAC_SWING_VALUE = 0x64, -+ H2C_ANT_SEL_RSV = 0x65, -+ H2C_WL_OPMODE = 0x66, -+ H2C_BT_MP_OPER = 0x67, -+ H2C_BT_CONTROL = 0x68, -+ H2C_BT_WIFI_CTRL = 0x69, -+ H2C_BT_FW_PATCH = 0x6A, -+ -+ /* WOWLAN Class: 100 */ -+ H2C_WOWLAN = 0x80, -+ H2C_REMOTE_WAKE_CTRL = 0x81, -+ H2C_AOAC_GLOBAL_INFO = 0x82, -+ H2C_AOAC_RSVD_PAGE = 0x83, -+ H2C_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_CHNL_SWITCH_OFFLOAD = 0x87, -+ H2C_AOAC_RSVDPAGE3 = 0x88, -+ H2C_P2P_OFFLOAD_RSVD_PAGE = 0x8A, -+ H2C_P2P_OFFLOAD = 0x8B, -+ -+ H2C_RESET_TSF = 0xC0, -+ H2C_BCNHWSEQ = 0xC5, -+ H2C_CUSTOMER_STR_W1 = 0xC6, -+ H2C_CUSTOMER_STR_W2 = 0xC7, -+ H2C_CUSTOMER_STR_W3 = 0xC8, -+ H2C_MAXID, -+}; -+ -+#define H2C_RSVDPAGE_LOC_LEN 5 -+#define H2C_MEDIA_STATUS_RPT_LEN 3 -+#define H2C_KEEP_ALIVE_CTRL_LEN 2 -+#define H2C_DISCON_DECISION_LEN 3 -+#define H2C_AP_OFFLOAD_LEN 3 -+#define H2C_AP_WOW_GPIO_CTRL_LEN 4 -+#define H2C_AP_PS_LEN 2 -+#define H2C_PWRMODE_LEN 7 -+#define H2C_PSTUNEPARAM_LEN 4 -+#define H2C_MACID_CFG_LEN 7 -+#define H2C_BTMP_OPER_LEN 5 -+#define H2C_WOWLAN_LEN 5 -+#define H2C_REMOTE_WAKE_CTRL_LEN 3 -+#define H2C_AOAC_GLOBAL_INFO_LEN 2 -+#define H2C_AOAC_RSVDPAGE_LOC_LEN 7 -+#define H2C_SCAN_OFFLOAD_CTRL_LEN 4 -+#define H2C_BT_FW_PATCH_LEN 6 -+#define H2C_RSSI_SETTING_LEN 4 -+#define H2C_AP_REQ_TXRPT_LEN 2 -+#define H2C_FORCE_BT_TXPWR_LEN 3 -+#define H2C_BCN_RSVDPAGE_LEN 5 -+#define H2C_PROBERSP_RSVDPAGE_LEN 5 -+#define H2C_P2PRSVDPAGE_LOC_LEN 5 -+#define H2C_P2P_OFFLOAD_LEN 3 -+#define H2C_INACTIVE_PS_LEN 4 -+#ifdef CONFIG_MCC_MODE -+ #define H2C_MCC_INFO_LEN 7 -+ #define H2C_MCC_LOCATION_LEN 3 -+ #define H2C_MCC_MACID_BITMAP_LEN 6 -+ #define H2C_MCC_UPDATE_INFO_LEN 4 -+ #define H2C_MCC_NOA_PARAM_LEN 4 -+ #define H2C_MCC_IQK_PARAM_LEN 7 -+#endif /* CONFIG_MCC_MODE */ -+#ifdef CONFIG_LPS_PG -+ #define H2C_LPS_PG_INFO_LEN 2 -+ #define H2C_LPSPG_LEN 16 -+#endif -+#ifdef CONFIG_LPS_POFF -+ #define H2C_LPS_POFF_CTRL_LEN 1 -+ #define H2C_LPS_POFF_PARAM_LEN 5 -+#endif -+#define eqMacAddr(a, b) (((a)[0] == (b)[0] && (a)[1] == (b)[1] && (a)[2] == (b)[2] && (a)[3] == (b)[3] && (a)[4] == (b)[4] && (a)[5] == (b)[5]) ? 1 : 0) -+#define cpMacAddr(des, src) ((des)[0] = (src)[0], (des)[1] = (src)[1], (des)[2] = (src)[2], (des)[3] = (src)[3], (des)[4] = (src)[4], (des)[5] = (src)[5]) -+#define cpIpAddr(des, src) ((des)[0] = (src)[0], (des)[1] = (src)[1], (des)[2] = (src)[2], (des)[3] = (src)[3]) -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+/* -+* ARP packet -+* -+* LLC Header */ -+#define GET_ARP_PKT_LLC_TYPE(__pHeader) ReadLE2Byte(((u8 *)(__pHeader)) + 6) -+ -+/* ARP element */ -+#define GET_ARP_PKT_OPERATION(__pHeader) ReadLE2Byte(((u8 *)(__pHeader)) + 6) -+#define GET_ARP_PKT_SENDER_MAC_ADDR(__pHeader, _val) cpMacAddr((u8 *)(_val), ((u8 *)(__pHeader))+8) -+#define GET_ARP_PKT_SENDER_IP_ADDR(__pHeader, _val) cpIpAddr((u8 *)(_val), ((u8 *)(__pHeader))+14) -+#define GET_ARP_PKT_TARGET_MAC_ADDR(__pHeader, _val) cpMacAddr((u8 *)(_val), ((u8 *)(__pHeader))+18) -+#define GET_ARP_PKT_TARGET_IP_ADDR(__pHeader, _val) cpIpAddr((u8 *)(_val), ((u8 *)(__pHeader))+24) -+ -+#define SET_ARP_PKT_HW(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 0, __Value) -+#define SET_ARP_PKT_PROTOCOL(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 2, __Value) -+#define SET_ARP_PKT_HW_ADDR_LEN(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 4, __Value) -+#define SET_ARP_PKT_PROTOCOL_ADDR_LEN(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 5, __Value) -+#define SET_ARP_PKT_OPERATION(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 6, __Value) -+#define SET_ARP_PKT_SENDER_MAC_ADDR(__pHeader, _val) cpMacAddr(((u8 *)(__pHeader))+8, (u8 *)(_val)) -+#define SET_ARP_PKT_SENDER_IP_ADDR(__pHeader, _val) cpIpAddr(((u8 *)(__pHeader))+14, (u8 *)(_val)) -+#define SET_ARP_PKT_TARGET_MAC_ADDR(__pHeader, _val) cpMacAddr(((u8 *)(__pHeader))+18, (u8 *)(_val)) -+#define SET_ARP_PKT_TARGET_IP_ADDR(__pHeader, _val) cpIpAddr(((u8 *)(__pHeader))+24, (u8 *)(_val)) -+ -+#define FW_WOWLAN_FUN_EN BIT(0) -+#define FW_WOWLAN_PATTERN_MATCH BIT(1) -+#define FW_WOWLAN_MAGIC_PKT BIT(2) -+#define FW_WOWLAN_UNICAST BIT(3) -+#define FW_WOWLAN_ALL_PKT_DROP BIT(4) -+#define FW_WOWLAN_GPIO_ACTIVE BIT(5) -+#define FW_WOWLAN_REKEY_WAKEUP BIT(6) -+#define FW_WOWLAN_DEAUTH_WAKEUP BIT(7) -+ -+#define FW_WOWLAN_GPIO_WAKEUP_EN BIT(0) -+#define FW_FW_PARSE_MAGIC_PKT BIT(1) -+ -+#define FW_REMOTE_WAKE_CTRL_EN BIT(0) -+#define FW_REALWOWLAN_EN BIT(5) -+ -+#define FW_WOWLAN_KEEP_ALIVE_EN BIT(0) -+#define FW_ADOPT_USER BIT(1) -+#define FW_WOWLAN_KEEP_ALIVE_PKT_TYPE BIT(2) -+ -+#define FW_REMOTE_WAKE_CTRL_EN BIT(0) -+#define FW_ARP_EN BIT(1) -+#define FW_REALWOWLAN_EN BIT(5) -+#define FW_WOW_FW_UNICAST_EN BIT(7) -+ -+#endif /* CONFIG_WOWLAN */ -+ -+/* _RSVDPAGE_LOC_CMD_0x00 */ -+#define SET_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value)SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+/* _MEDIA_STATUS_RPT_PARM_CMD_0x01 */ -+#define SET_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 0, 1, (__Value)) -+#define SET_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 1, 1, (__Value)) -+#define SET_H2CCMD_MSRRPT_PARM_MIRACAST(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 2, 1, (__Value)) -+#define SET_H2CCMD_MSRRPT_PARM_MIRACAST_SINK(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 3, 1, (__Value)) -+#define SET_H2CCMD_MSRRPT_PARM_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 4, 4, (__Value)) -+#define SET_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)) + 1, 0, 8, (__Value)) -+#define SET_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)) + 2, 0, 8, (__Value)) -+ -+#define GET_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd) LE_BITS_TO_1BYTE(((u8 *)(__pH2CCmd)), 0, 1) -+#define GET_H2CCMD_MSRRPT_PARM_MIRACAST(__pH2CCmd) LE_BITS_TO_1BYTE(((u8 *)(__pH2CCmd)), 2, 1) -+#define GET_H2CCMD_MSRRPT_PARM_MIRACAST_SINK(__pH2CCmd) LE_BITS_TO_1BYTE(((u8 *)(__pH2CCmd)), 3, 1) -+#define GET_H2CCMD_MSRRPT_PARM_ROLE(__pH2CCmd) LE_BITS_TO_1BYTE(((u8 *)(__pH2CCmd)), 4, 4) -+ -+#define H2C_MSR_ROLE_RSVD 0 -+#define H2C_MSR_ROLE_STA 1 -+#define H2C_MSR_ROLE_AP 2 -+#define H2C_MSR_ROLE_GC 3 -+#define H2C_MSR_ROLE_GO 4 -+#define H2C_MSR_ROLE_TDLS 5 -+#define H2C_MSR_ROLE_ADHOC 6 -+#define H2C_MSR_ROLE_MAX 7 -+ -+extern const char *const _h2c_msr_role_str[]; -+#define h2c_msr_role_str(role) (((role) >= H2C_MSR_ROLE_MAX) ? _h2c_msr_role_str[H2C_MSR_ROLE_MAX] : _h2c_msr_role_str[(role)]) -+ -+#define H2C_MSR_FMT "%s %s%s" -+#define H2C_MSR_ARG(h2c_msr) \ -+ GET_H2CCMD_MSRRPT_PARM_OPMODE((h2c_msr)) ? " C" : "", \ -+ h2c_msr_role_str(GET_H2CCMD_MSRRPT_PARM_ROLE((h2c_msr))), \ -+ GET_H2CCMD_MSRRPT_PARM_MIRACAST((h2c_msr)) ? (GET_H2CCMD_MSRRPT_PARM_MIRACAST_SINK((h2c_msr)) ? " MSINK" : " MSRC") : "" -+ -+s32 rtw_hal_set_FwMediaStatusRpt_cmd(_adapter *adapter, bool opmode, bool miracast, bool miracast_sink, u8 role, u8 macid, bool macid_ind, u8 macid_end); -+s32 rtw_hal_set_FwMediaStatusRpt_single_cmd(_adapter *adapter, bool opmode, bool miracast, bool miracast_sink, u8 role, u8 macid); -+s32 rtw_hal_set_FwMediaStatusRpt_range_cmd(_adapter *adapter, bool opmode, bool miracast, bool miracast_sink, u8 role, u8 macid, u8 macid_end); -+ -+/* _KEEP_ALIVE_CMD_0x03 */ -+#define SET_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _DISCONNECT_DECISION_CMD_0x04 */ -+#define SET_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+ -+#ifdef CONFIG_RTW_CUSTOMER_STR -+#define RTW_CUSTOMER_STR_LEN 16 -+#define RTW_CUSTOMER_STR_FMT "%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x" -+#define RTW_CUSTOMER_STR_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5], \ -+ ((u8 *)(x))[6], ((u8 *)(x))[7], ((u8 *)(x))[8], ((u8 *)(x))[9], ((u8 *)(x))[10], ((u8 *)(x))[11], \ -+ ((u8 *)(x))[12], ((u8 *)(x))[13], ((u8 *)(x))[14], ((u8 *)(x))[15] -+ -+/* H2C_CUSTOMER_STR_REQ 0x06 */ -+#define H2C_CUSTOMER_STR_REQ_LEN 1 -+#define SET_H2CCMD_CUSTOMER_STR_REQ_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 0, 1, (__Value)) -+s32 rtw_hal_h2c_customer_str_req(_adapter *adapter); -+s32 rtw_hal_customer_str_read(_adapter *adapter, u8 *cs); -+ -+/* H2C_CUSTOMER_STR_W1 0xC6 */ -+#define H2C_CUSTOMER_STR_W1_LEN 7 -+#define SET_H2CCMD_CUSTOMER_STR_W1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 0, 1, (__Value)) -+#define H2CCMD_CUSTOMER_STR_W1_BYTE0(__pH2CCmd) (((u8 *)(__pH2CCmd)) + 1) -+ -+/* H2C_CUSTOMER_STR_W2 0xC7 */ -+#define H2C_CUSTOMER_STR_W2_LEN 7 -+#define SET_H2CCMD_CUSTOMER_STR_W2_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 0, 1, (__Value)) -+#define H2CCMD_CUSTOMER_STR_W2_BYTE6(__pH2CCmd) (((u8 *)(__pH2CCmd)) + 1) -+ -+/* H2C_CUSTOMER_STR_W3 0xC8 */ -+#define H2C_CUSTOMER_STR_W3_LEN 5 -+#define SET_H2CCMD_CUSTOMER_STR_W3_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 0, 1, (__Value)) -+#define H2CCMD_CUSTOMER_STR_W3_BYTE12(__pH2CCmd) (((u8 *)(__pH2CCmd)) + 1) -+s32 rtw_hal_h2c_customer_str_write(_adapter *adapter, const u8 *cs); -+s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); -+#endif /* CONFIG_RTW_CUSTOMER_STR */ -+ -+/* _AP_Offload 0x08 */ -+#define SET_H2CCMD_AP_WOWLAN_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+/* _BCN_RsvdPage 0x09 */ -+#define SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_BCN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+/* _Probersp_RsvdPage 0x0a */ -+#define SET_H2CCMD_AP_WOWLAN_RSVDPAGE_LOC_ProbeRsp(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+/* _Probersp_RsvdPage 0x13 */ -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_INDEX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_C2H_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_PLUS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_HIGH_ACTIVE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_AP_WOW_GPIO_CTRL_C2H_DURATION(__pH2CCmd, __Value)SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+/* _AP_PS 0x26 */ -+#define SET_H2CCMD_AP_WOW_PS_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_AP_WOW_PS_32K_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_AP_WOW_PS_RF(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_AP_WOW_PS_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+ -+/* INACTIVE_PS 0x27, duration unit is TBTT */ -+#define SET_H2CCMD_INACTIVE_PS_EN(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_INACTIVE_PS_IGNORE_PS(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_INACTIVE_PS_PERIOD_SCAN_EN(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_INACTIVE_PS_FREQ(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd + 1, 0, 8, __Value) -+#define SET_H2CCMD_INACTIVE_PS_DURATION(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd + 2, 0, 8, __Value) -+#define SET_H2CCMD_INACTIVE_PS_PERIOD_SCAN_TIME(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd + 3, 0, 8, __Value) -+ -+#ifdef CONFIG_LPS_POFF -+/*PARTIAL OFF Control 0x29*/ -+#define SET_H2CCMD_LPS_POFF_CTRL_EN(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+/*PARTIAL OFF PARAM 0x2A*/ -+#define SET_H2CCMD_LPS_POFF_PARAM_RDVLD(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_LPS_POFF_PARAM_WRVLD(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_LPS_POFF_PARAM_STARTADDL(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_H2CCMD_LPS_POFF_PARAM_STARTADDH(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+#define SET_H2CCMD_LPS_POFF_PARAM_ENDADDL(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_H2CCMD_LPS_POFF_PARAM_ENDADDH(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+#endif -+ -+#ifdef CONFIG_MCC_MODE -+/* MCC LOC CMD 0x10 */ -+#define SET_H2CCMD_MCC_RSVDPAGE_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+ -+/* MCC MAC ID CMD 0x16 */ -+#define SET_H2CCMD_MCC_MACID_BITMAP_L(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_MCC_MACID_BITMAP_H(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+ -+/* MCC INFO CMD 0x18 */ -+#define SET_H2CCMD_MCC_INFO_ORDER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_H2CCMD_MCC_INFO_TOTALNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_H2CCMD_MCC_INFO_CHIDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_MCC_INFO_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 2, __Value) -+#define SET_H2CCMD_MCC_INFO_BW40SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 2, 3, __Value) -+#define SET_H2CCMD_MCC_INFO_BW80SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 5, 3, __Value) -+#define SET_H2CCMD_MCC_INFO_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_MCC_INFO_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 3, __Value) -+#define SET_H2CCMD_MCC_INFO_INCURCH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 3, 1, __Value) -+#define SET_H2CCMD_MCC_INFO_RSVD0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 4, 4, __Value) -+#define SET_H2CCMD_MCC_INFO_RSVD1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+#define SET_H2CCMD_MCC_INFO_RFETYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 0, 4, __Value) -+#define SET_H2CCMD_MCC_INFO_DISTXNULL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 4, 1, __Value) -+#define SET_H2CCMD_MCC_INFO_C2HRPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 5, 2, __Value) -+#define SET_H2CCMD_MCC_INFO_CHSCAN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 7, 1, __Value) -+ -+/* MCC NoA CMD 0x19 */ -+#define SET_H2CCMD_MCC_NOA_FW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_MCC_NOA_TSF_SYNC_OFFSET(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 7, __Value) -+#define SET_H2CCMD_MCC_NOA_START_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_MCC_NOA_INTERVAL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_MCC_EARLY_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+ -+/* MCC IQK CMD 0x1A */ -+#define SET_H2CCMD_MCC_IQK_READY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_MCC_IQK_ORDER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 2, __Value) -+#define SET_H2CCMD_MCC_IQK_RX_L(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_MCC_IQK_RX_M1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 2, __Value) -+#define SET_H2CCMD_MCC_IQK_RX_M2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 2, 6, __Value) -+#define SET_H2CCMD_MCC_IQK_RX_H(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 4, __Value) -+#define SET_H2CCMD_MCC_IQK_TX_L(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_H2CCMD_MCC_IQK_TX_M1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 3, __Value) -+#define SET_H2CCMD_MCC_IQK_TX_M2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 3, 5, __Value) -+#define SET_H2CCMD_MCC_IQK_TX_H(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 0, 6, __Value) -+#endif /* CONFIG_MCC_MODE */ -+ -+/* CHNL SWITCH OPER OFFLOAD 0x1C */ -+#define SET_H2CCMD_CH_SW_OPER_OFFLOAD_CH_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 0, 2, __Value) -+#define SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_40M_SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 2, 3, __Value) -+#define SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_80M_SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 5, 3, __Value) -+#define SET_H2CCMD_CH_SW_OPER_OFFLOAD_RFE_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 2, 0, 4, __Value) -+ -+/* _WoWLAN PARAM_CMD_0x80 */ -+#define SET_H2CCMD_WOWLAN_FUNC_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_WOWLAN_MAGIC_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_WOWLAN_UNICAST_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_H2CCMD_WOWLAN_ALL_PKT_DROP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIO_ACTIVE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -+#define SET_H2CCMD_WOWLAN_DISCONNECT_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIONUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 7, __Value) -+#define SET_H2CCMD_WOWLAN_DATAPIN_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 7, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIO_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_WOWLAN_GPIO_PULSE_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 1, __Value) -+#define SET_H2CCMD_WOWLAN_GPIO_PULSE_COUNT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 1, 7, __Value) -+#define SET_H2CCMD_WOWLAN_LOWPR_RX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 1, __Value) -+#define SET_H2CCMD_WOWLAN_CHANGE_UNIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 2, 1, __Value) -+/* _REMOTE_WAKEUP_CMD_0x81 */ -+#define SET_H2CCMD_REMOTE_WAKECTRL_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_NDP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_NLO_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_FW_UNICAST_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_NBNS_FILTER_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 2, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 3, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 1, __Value) -+#define SET_H2CCMD_REMOTE_WAKE_CTRL_FW_PARSING_UNTIL_WAKEUP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 4, 1, __Value) -+ -+/* AOAC_GLOBAL_INFO_0x82 */ -+#define SET_H2CCMD_AOAC_GLOBAL_INFO_PAIRWISE_ENC_ALG(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_GLOBAL_INFO_GROUP_ENC_ALG(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+ -+/* AOAC_RSVDPAGE_LOC_0x83 */ -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#ifdef CONFIG_GTK_OL -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+#endif /* CONFIG_GTK_OL */ -+#ifdef CONFIG_PNO_SUPPORT -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_NLO_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 8, __Value) -+#endif -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_AOAC_REPORT(__pH2CCmd, __Value) \ -+ SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 0, 8, __Value) -+ -+#ifdef CONFIG_PNO_SUPPORT -+/* D0_Scan_Offload_Info_0x86 */ -+#define SET_H2CCMD_AOAC_NLO_FUN_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 3, 1, __Value) -+#define SET_H2CCMD_AOAC_NLO_IPS_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 4, 1, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_PROBE_PACKET(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_SCAN_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_SSID_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+#ifdef CONFIG_P2P_WOWLAN -+/* P2P_RsvdPage_0x8a */ -+#define SET_H2CCMD_RSVDPAGE_LOC_P2P_BCN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_P2P_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_P2P_NEGO_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_P2P_INVITE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_H2CCMD_RSVDPAGE_LOC_P2P_PD_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+#ifdef CONFIG_LPS_PG -+#define SET_H2CCMD_LPSPG_SEC_CAM_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value)/*SecurityCAM_En*/ -+#define SET_H2CCMD_LPSPG_MBID_CAM_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value)/*BSSIDCAM_En*/ -+#define SET_H2CCMD_LPSPG_PMC_CAM_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value)/*PatternMatchCAM_En*/ -+#define SET_H2CCMD_LPSPG_MACID_SEARCH_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value)/*MACIDSearch_En*/ -+#define SET_H2CCMD_LPSPG_TXSC_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value)/*TXSC_En*/ -+#define SET_H2CCMD_LPSPG_MU_RATE_TB_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value)/*MURateTable_En*/ -+#define SET_H2CCMD_LPSPG_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value)/*Loc_LPS_PG*/ -+#endif -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ------------------------------------------- Structure -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- */ -+typedef struct _RSVDPAGE_LOC { -+ u8 LocProbeRsp; -+ u8 LocPsPoll; -+ u8 LocNullData; -+ u8 LocQosNull; -+ u8 LocBTQosNull; -+#ifdef CONFIG_WOWLAN -+ u8 LocRemoteCtrlInfo; -+ u8 LocArpRsp; -+ u8 LocNbrAdv; -+ u8 LocGTKRsp; -+ u8 LocGTKInfo; -+ u8 LocProbeReq; -+ u8 LocNetList; -+#ifdef CONFIG_GTK_OL -+ u8 LocGTKEXTMEM; -+#endif /* CONFIG_GTK_OL */ -+ u8 LocAOACReport; -+#ifdef CONFIG_PNO_SUPPORT -+ u8 LocPNOInfo; -+ u8 LocScanInfo; -+ u8 LocSSIDInfo; -+ u8 LocProbePacket; -+#endif /* CONFIG_PNO_SUPPORT */ -+#endif /* CONFIG_WOWLAN */ -+ u8 LocApOffloadBCN; -+#ifdef CONFIG_P2P_WOWLAN -+ u8 LocP2PBeacon; -+ u8 LocP2PProbeRsp; -+ u8 LocNegoRsp; -+ u8 LocInviteRsp; -+ u8 LocPDRsp; -+#endif /* CONFIG_P2P_WOWLAN */ -+} RSVDPAGE_LOC, *PRSVDPAGE_LOC; -+ -+#endif -+void dump_TX_FIFO(PADAPTER padapter, u8 page_num, u16 page_size); -+u8 rtw_hal_set_fw_media_status_cmd(_adapter *adapter, u8 mstatus, u8 macid); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ /* WOW command function */ -+ void rtw_hal_set_fw_wow_related_cmd(_adapter *padapter, u8 enable); -+ #ifdef CONFIG_P2P_WOWLAN -+ /* H2C 0x8A */ -+ u8 rtw_hal_set_FwP2PRsvdPage_cmd(_adapter *adapter, PRSVDPAGE_LOC rsvdpageloc); -+ /* H2C 0x8B */ -+ u8 rtw_hal_set_p2p_wowlan_offload_cmd(_adapter *adapter); -+ #endif /* CONFIG_P2P_WOWLAN */ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_com_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_led.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_com_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_led.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,396 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_COMMON_LED_H_ -+#define __HAL_COMMON_LED_H_ -+ -+ -+#define MSECS(t) (HZ * ((t) / 1000) + (HZ * ((t) % 1000)) / 1000) -+ -+/* ******************************************************************************** -+ * LED Behavior Constant. -+ * ******************************************************************************** -+ * Default LED behavior. -+ * */ -+#define LED_BLINK_NORMAL_INTERVAL 100 -+#define LED_BLINK_SLOWLY_INTERVAL 200 -+#define LED_BLINK_LONG_INTERVAL 400 -+#define LED_INITIAL_INTERVAL 1800 -+ -+/* LED Customerization */ -+ -+/* NETTRONIX */ -+#define LED_BLINK_NORMAL_INTERVAL_NETTRONIX 100 -+#define LED_BLINK_SLOWLY_INTERVAL_NETTRONIX 2000 -+ -+/* PORNET */ -+#define LED_BLINK_SLOWLY_INTERVAL_PORNET 1000 -+#define LED_BLINK_NORMAL_INTERVAL_PORNET 100 -+#define LED_BLINK_FAST_INTERVAL_BITLAND 30 -+ -+/* AzWave. */ -+#define LED_CM2_BLINK_ON_INTERVAL 250 -+#define LED_CM2_BLINK_OFF_INTERVAL 4750 -+#define LED_CM8_BLINK_OFF_INTERVAL 3750 /* for QMI */ -+ -+/* RunTop */ -+#define LED_RunTop_BLINK_INTERVAL 300 -+ -+/* ALPHA */ -+#define LED_BLINK_NO_LINK_INTERVAL_ALPHA 1000 -+#define LED_BLINK_NO_LINK_INTERVAL_ALPHA_500MS 500 /* add by ylb 20121012 for customer led for alpha */ -+#define LED_BLINK_LINK_INTERVAL_ALPHA 500 /* 500 */ -+#define LED_BLINK_SCAN_INTERVAL_ALPHA 180 /* 150 */ -+#define LED_BLINK_FASTER_INTERVAL_ALPHA 50 -+#define LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA 5000 -+ -+/* 111122 by hpfan: Customized for Xavi */ -+#define LED_CM11_BLINK_INTERVAL 300 -+#define LED_CM11_LINK_ON_INTERVEL 3000 -+ -+/* Netgear */ -+#define LED_BLINK_LINK_INTERVAL_NETGEAR 500 -+#define LED_BLINK_LINK_SLOWLY_INTERVAL_NETGEAR 1000 -+ -+#define LED_WPS_BLINK_OFF_INTERVAL_NETGEAR 100 -+#define LED_WPS_BLINK_ON_INTERVAL_NETGEAR 500 -+ -+/* Belkin AC950 */ -+#define LED_BLINK_LINK_INTERVAL_ON_BELKIN 200 -+#define LED_BLINK_LINK_INTERVAL_OFF_BELKIN 100 -+#define LED_BLINK_ERROR_INTERVAL_BELKIN 100 -+ -+/* by chiyokolin for Azurewave */ -+#define LED_CM12_BLINK_INTERVAL_5Mbps 160 -+#define LED_CM12_BLINK_INTERVAL_10Mbps 80 -+#define LED_CM12_BLINK_INTERVAL_20Mbps 50 -+#define LED_CM12_BLINK_INTERVAL_40Mbps 40 -+#define LED_CM12_BLINK_INTERVAL_80Mbps 30 -+#define LED_CM12_BLINK_INTERVAL_MAXMbps 25 -+ -+/* Dlink */ -+#define LED_BLINK_NO_LINK_INTERVAL 1000 -+#define LED_BLINK_LINK_IDEL_INTERVAL 100 -+ -+#define LED_BLINK_SCAN_ON_INTERVAL 30 -+#define LED_BLINK_SCAN_OFF_INTERVAL 300 -+ -+#define LED_WPS_BLINK_ON_INTERVAL_DLINK 30 -+#define LED_WPS_BLINK_OFF_INTERVAL_DLINK 300 -+#define LED_WPS_BLINK_LINKED_ON_INTERVAL_DLINK 5000 -+ -+/* ******************************************************************************** -+ * LED object. -+ * ******************************************************************************** */ -+ -+typedef enum _LED_CTL_MODE { -+ LED_CTL_POWER_ON = 1, -+ LED_CTL_LINK = 2, -+ LED_CTL_NO_LINK = 3, -+ LED_CTL_TX = 4, -+ LED_CTL_RX = 5, -+ LED_CTL_SITE_SURVEY = 6, -+ LED_CTL_POWER_OFF = 7, -+ LED_CTL_START_TO_LINK = 8, -+ LED_CTL_START_WPS = 9, -+ LED_CTL_STOP_WPS = 10, -+ LED_CTL_START_WPS_BOTTON = 11, /* added for runtop */ -+ LED_CTL_STOP_WPS_FAIL = 12, /* added for ALPHA */ -+ LED_CTL_STOP_WPS_FAIL_OVERLAP = 13, /* added for BELKIN */ -+ LED_CTL_CONNECTION_NO_TRANSFER = 14, -+} LED_CTL_MODE; -+ -+typedef enum _LED_STATE { -+ LED_UNKNOWN = 0, -+ RTW_LED_ON = 1, -+ RTW_LED_OFF = 2, -+ LED_BLINK_NORMAL = 3, -+ LED_BLINK_SLOWLY = 4, -+ LED_BLINK_POWER_ON = 5, -+ LED_BLINK_SCAN = 6, /* LED is blinking during scanning period, the # of times to blink is depend on time for scanning. */ -+ LED_BLINK_NO_LINK = 7, /* LED is blinking during no link state. */ -+ LED_BLINK_StartToBlink = 8, /* Customzied for Sercomm Printer Server case */ -+ LED_BLINK_TXRX = 9, -+ LED_BLINK_WPS = 10, /* LED is blinkg during WPS communication */ -+ LED_BLINK_WPS_STOP = 11, /* for ALPHA */ -+ LED_BLINK_WPS_STOP_OVERLAP = 12, /* for BELKIN */ -+ LED_BLINK_RUNTOP = 13, /* Customized for RunTop */ -+ LED_BLINK_CAMEO = 14, -+ LED_BLINK_XAVI = 15, -+ LED_BLINK_ALWAYS_ON = 16, -+ LED_BLINK_LINK_IN_PROCESS = 17, /* Customized for Belkin AC950 */ -+ LED_BLINK_AUTH_ERROR = 18, /* Customized for Belkin AC950 */ -+ LED_BLINK_Azurewave_5Mbps = 19, -+ LED_BLINK_Azurewave_10Mbps = 20, -+ LED_BLINK_Azurewave_20Mbps = 21, -+ LED_BLINK_Azurewave_40Mbps = 22, -+ LED_BLINK_Azurewave_80Mbps = 23, -+ LED_BLINK_Azurewave_MAXMbps = 24, -+ LED_BLINK_LINK_IDEL = 25, -+ LED_BLINK_WPS_LINKED = 26, -+} LED_STATE; -+ -+typedef enum _LED_PIN { -+ LED_PIN_GPIO0, -+ LED_PIN_LED0, -+ LED_PIN_LED1, -+ LED_PIN_LED2 -+} LED_PIN; -+ -+ -+/* ******************************************************************************** -+ * PCIE LED Definition. -+ * ******************************************************************************** */ -+#ifdef CONFIG_PCI_HCI -+typedef enum _LED_STRATEGY_PCIE { -+ SW_LED_MODE0, /* SW control 1 LED via GPIO0. It is default option. */ -+ SW_LED_MODE1, /* SW control for PCI Express */ -+ SW_LED_MODE2, /* SW control for Cameo. */ -+ SW_LED_MODE3, /* SW contorl for RunTop. */ -+ SW_LED_MODE4, /* SW control for Netcore */ -+ SW_LED_MODE5, /* added by vivi, for led new mode, DLINK */ -+ SW_LED_MODE6, /* added by vivi, for led new mode, PRONET */ -+ SW_LED_MODE7, /* added by chiyokolin, for Lenovo, PCI Express Minicard Spec Rev.1.2 spec */ -+ SW_LED_MODE8, /* added by chiyokolin, for QMI */ -+ SW_LED_MODE9, /* added by chiyokolin, for BITLAND-LENOVO, PCI Express Minicard Spec Rev.1.1 */ -+ SW_LED_MODE10, /* added by chiyokolin, for Edimax-ASUS */ -+ SW_LED_MODE11, /* added by hpfan, for Xavi */ -+ SW_LED_MODE12, /* added by chiyokolin, for Azurewave */ -+ HW_LED, /* HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes) */ -+} LED_STRATEGY_PCIE, *PLED_STRATEGY_PCIE; -+ -+typedef struct _LED_PCIE { -+ PADAPTER padapter; -+ -+ LED_PIN LedPin; /* Identify how to implement this SW led. */ -+ -+ LED_STATE CurrLedState; /* Current LED state. */ -+ BOOLEAN bLedOn; /* TRUE if LED is ON, FALSE if LED is OFF. */ -+ -+ BOOLEAN bLedBlinkInProgress; /* TRUE if it is blinking, FALSE o.w.. */ -+ BOOLEAN bLedWPSBlinkInProgress; /* TRUE if it is blinking, FALSE o.w.. */ -+ -+ BOOLEAN bLedSlowBlinkInProgress;/* added by vivi, for led new mode */ -+ u32 BlinkTimes; /* Number of times to toggle led state for blinking. */ -+ LED_STATE BlinkingLedState; /* Next state for blinking, either LED_ON or LED_OFF are. */ -+ -+ _timer BlinkTimer; /* Timer object for led blinking. */ -+} LED_PCIE, *PLED_PCIE; -+ -+typedef struct _LED_PCIE LED_DATA, *PLED_DATA; -+typedef enum _LED_STRATEGY_PCIE LED_STRATEGY, *PLED_STRATEGY; -+ -+VOID -+LedControlPCIE( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+); -+ -+VOID -+gen_RefreshLedState( -+ IN PADAPTER Adapter); -+ -+/* ******************************************************************************** -+ * USB LED Definition. -+ * ******************************************************************************** */ -+#elif defined(CONFIG_USB_HCI) -+ -+#define IS_LED_WPS_BLINKING(_LED_USB) (((PLED_USB)_LED_USB)->CurrLedState == LED_BLINK_WPS \ -+ || ((PLED_USB)_LED_USB)->CurrLedState == LED_BLINK_WPS_STOP \ -+ || ((PLED_USB)_LED_USB)->bLedWPSBlinkInProgress) -+ -+#define IS_LED_BLINKING(_LED_USB) (((PLED_USB)_LED_USB)->bLedWPSBlinkInProgress \ -+ || ((PLED_USB)_LED_USB)->bLedScanBlinkInProgress) -+ -+ -+typedef enum _LED_STRATEGY_USB { -+ SW_LED_MODE0, /* SW control 1 LED via GPIO0. It is default option. */ -+ SW_LED_MODE1, /* 2 LEDs, through LED0 and LED1. For ALPHA. */ -+ SW_LED_MODE2, /* SW control 1 LED via GPIO0, customized for AzWave 8187 minicard. */ -+ SW_LED_MODE3, /* SW control 1 LED via GPIO0, customized for Sercomm Printer Server case. */ -+ SW_LED_MODE4, /* for Edimax / Belkin */ -+ SW_LED_MODE5, /* for Sercomm / Belkin */ -+ SW_LED_MODE6, /* for 88CU minicard, porting from ce SW_LED_MODE7 */ -+ SW_LED_MODE7, /* for Netgear special requirement */ -+ SW_LED_MODE8, /* for LC */ -+ SW_LED_MODE9, /* for Belkin AC950 */ -+ SW_LED_MODE10, /* for Netgear A6200V2 */ -+ SW_LED_MODE11, /* for Edimax / ASUS */ -+ SW_LED_MODE12, /* for WNC/NEC */ -+ SW_LED_MODE13, /* for Netgear A6100, 8811Au */ -+ SW_LED_MODE14, /* for Buffalo, DNI, 8811Au */ -+ SW_LED_MODE15, /* for DLINK, 8811Au/8812AU */ -+ HW_LED, /* HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes, see MAC.CONFIG1 for details.) */ -+} LED_STRATEGY_USB, *PLED_STRATEGY_USB; -+ -+ -+typedef struct _LED_USB { -+ PADAPTER padapter; -+ -+ LED_PIN LedPin; /* Identify how to implement this SW led. */ -+ -+ LED_STATE CurrLedState; /* Current LED state. */ -+ BOOLEAN bLedOn; /* TRUE if LED is ON, FALSE if LED is OFF. */ -+ -+ BOOLEAN bSWLedCtrl; -+ -+ BOOLEAN bLedBlinkInProgress; /* TRUE if it is blinking, FALSE o.w.. */ -+ /* ALPHA, added by chiyoko, 20090106 */ -+ BOOLEAN bLedNoLinkBlinkInProgress; -+ BOOLEAN bLedLinkBlinkInProgress; -+ BOOLEAN bLedStartToLinkBlinkInProgress; -+ BOOLEAN bLedScanBlinkInProgress; -+ BOOLEAN bLedWPSBlinkInProgress; -+ -+ u32 BlinkTimes; /* Number of times to toggle led state for blinking. */ -+ u8 BlinkCounter; /* Added for turn off overlap led after blinking a while, by page, 20120821 */ -+ LED_STATE BlinkingLedState; /* Next state for blinking, either LED_ON or LED_OFF are. */ -+ -+ _timer BlinkTimer; /* Timer object for led blinking. */ -+ -+ _workitem BlinkWorkItem; /* Workitem used by BlinkTimer to manipulate H/W to blink LED.' */ -+} LED_USB, *PLED_USB; -+ -+typedef struct _LED_USB LED_DATA, *PLED_DATA; -+typedef enum _LED_STRATEGY_USB LED_STRATEGY, *PLED_STRATEGY; -+ -+VOID -+LedControlUSB( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+); -+ -+ -+/* ******************************************************************************** -+ * SDIO LED Definition. -+ * ******************************************************************************** */ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ -+#define IS_LED_WPS_BLINKING(_LED_SDIO) (((PLED_SDIO)_LED_SDIO)->CurrLedState == LED_BLINK_WPS \ -+ || ((PLED_SDIO)_LED_SDIO)->CurrLedState == LED_BLINK_WPS_STOP \ -+ || ((PLED_SDIO)_LED_SDIO)->bLedWPSBlinkInProgress) -+ -+#define IS_LED_BLINKING(_LED_SDIO) (((PLED_SDIO)_LED_SDIO)->bLedWPSBlinkInProgress \ -+ || ((PLED_SDIO)_LED_SDIO)->bLedScanBlinkInProgress) -+ -+ -+typedef enum _LED_STRATEGY_SDIO { -+ SW_LED_MODE0, /* SW control 1 LED via GPIO0. It is default option. */ -+ SW_LED_MODE1, /* 2 LEDs, through LED0 and LED1. For ALPHA. */ -+ SW_LED_MODE2, /* SW control 1 LED via GPIO0, customized for AzWave 8187 minicard. */ -+ SW_LED_MODE3, /* SW control 1 LED via GPIO0, customized for Sercomm Printer Server case. */ -+ SW_LED_MODE4, /* for Edimax / Belkin */ -+ SW_LED_MODE5, /* for Sercomm / Belkin */ -+ SW_LED_MODE6, /* for 88CU minicard, porting from ce SW_LED_MODE7 */ -+ HW_LED, /* HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes, see MAC.CONFIG1 for details.) */ -+} LED_STRATEGY_SDIO, *PLED_STRATEGY_SDIO; -+ -+typedef struct _LED_SDIO { -+ PADAPTER padapter; -+ -+ LED_PIN LedPin; /* Identify how to implement this SW led. */ -+ -+ LED_STATE CurrLedState; /* Current LED state. */ -+ BOOLEAN bLedOn; /* TRUE if LED is ON, FALSE if LED is OFF. */ -+ -+ BOOLEAN bSWLedCtrl; -+ -+ BOOLEAN bLedBlinkInProgress; /* TRUE if it is blinking, FALSE o.w.. */ -+ /* ALPHA, added by chiyoko, 20090106 */ -+ BOOLEAN bLedNoLinkBlinkInProgress; -+ BOOLEAN bLedLinkBlinkInProgress; -+ BOOLEAN bLedStartToLinkBlinkInProgress; -+ BOOLEAN bLedScanBlinkInProgress; -+ BOOLEAN bLedWPSBlinkInProgress; -+ -+ u32 BlinkTimes; /* Number of times to toggle led state for blinking. */ -+ LED_STATE BlinkingLedState; /* Next state for blinking, either LED_ON or LED_OFF are. */ -+ -+ _timer BlinkTimer; /* Timer object for led blinking. */ -+ -+ _workitem BlinkWorkItem; /* Workitem used by BlinkTimer to manipulate H/W to blink LED. */ -+} LED_SDIO, *PLED_SDIO; -+ -+typedef struct _LED_SDIO LED_DATA, *PLED_DATA; -+typedef enum _LED_STRATEGY_SDIO LED_STRATEGY, *PLED_STRATEGY; -+ -+VOID -+LedControlSDIO( -+ IN PADAPTER Adapter, -+ IN LED_CTL_MODE LedAction -+); -+ -+#endif -+ -+struct led_priv { -+ /* add for led controll */ -+ LED_DATA SwLed0; -+ LED_DATA SwLed1; -+ LED_DATA SwLed2; -+ LED_STRATEGY LedStrategy; -+ u8 bRegUseLed; -+ void (*LedControlHandler)(_adapter *padapter, LED_CTL_MODE LedAction); -+ void (*SwLedOn)(_adapter *padapter, PLED_DATA pLed); -+ void (*SwLedOff)(_adapter *padapter, PLED_DATA pLed); -+ /* add for led controll */ -+}; -+ -+#ifdef CONFIG_SW_LED -+#define rtw_led_control(adapter, LedAction) \ -+ do { \ -+ if ((adapter)->ledpriv.LedControlHandler) \ -+ (adapter)->ledpriv.LedControlHandler((adapter), (LedAction)); \ -+ } while (0) -+#else /* CONFIG_SW_LED */ -+#define rtw_led_control(adapter, LedAction) -+#endif /* CONFIG_SW_LED */ -+ -+#define SwLedOn(adapter, pLed) \ -+ do { \ -+ if ((adapter)->ledpriv.SwLedOn) \ -+ (adapter)->ledpriv.SwLedOn((adapter), (pLed)); \ -+ } while (0) -+ -+#define SwLedOff(adapter, pLed) \ -+ do { \ -+ if ((adapter)->ledpriv.SwLedOff) \ -+ (adapter)->ledpriv.SwLedOff((adapter), (pLed)); \ -+ } while (0) -+ -+void BlinkTimerCallback(void *data); -+void BlinkWorkItemCallback(_workitem *work); -+ -+void ResetLedStatus(PLED_DATA pLed); -+ -+void -+InitLed( -+ _adapter *padapter, -+ PLED_DATA pLed, -+ LED_PIN LedPin -+); -+ -+void -+DeInitLed( -+ PLED_DATA pLed -+); -+ -+/* hal... */ -+extern void BlinkHandler(PLED_DATA pLed); -+ -+#endif /* __RTW_LED_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_com_phycfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_phycfg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_com_phycfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_phycfg.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,348 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_COM_PHYCFG_H__ -+#define __HAL_COM_PHYCFG_H__ -+ -+#define PathA 0x0 /* Useless */ -+#define PathB 0x1 -+#define PathC 0x2 -+#define PathD 0x3 -+ -+typedef enum _RF_TX_NUM { -+ RF_1TX = 0, -+ RF_2TX, -+ RF_3TX, -+ RF_4TX, -+ RF_MAX_TX_NUM, -+ RF_TX_NUM_NONIMPLEMENT, -+} RF_TX_NUM; -+ -+#define MAX_POWER_INDEX 0x3F -+ -+typedef enum _REGULATION_TXPWR_LMT { -+ TXPWR_LMT_FCC = 0, -+ TXPWR_LMT_MKK = 1, -+ TXPWR_LMT_ETSI = 2, -+ TXPWR_LMT_WW = 3, -+ -+ TXPWR_LMT_MAX_REGULATION_NUM = 4 -+} REGULATION_TXPWR_LMT; -+ -+#define TX_PWR_LMT_REF_VHT_FROM_HT BIT0 -+#define TX_PWR_LMT_REF_HT_FROM_VHT BIT1 -+ -+/*------------------------------Define structure----------------------------*/ -+typedef struct _BB_REGISTER_DEFINITION { -+ u32 rfintfs; /* set software control: */ -+ /* 0x870~0x877[8 bytes] */ -+ -+ u32 rfintfo; /* output data: */ -+ /* 0x860~0x86f [16 bytes] */ -+ -+ u32 rfintfe; /* output enable: */ -+ /* 0x860~0x86f [16 bytes] */ -+ -+ u32 rf3wireOffset; /* LSSI data: */ -+ /* 0x840~0x84f [16 bytes] */ -+ -+ u32 rfHSSIPara2; /* wire parameter control2 : */ -+ /* 0x824~0x827,0x82c~0x82f, 0x834~0x837, 0x83c~0x83f [16 bytes] */ -+ -+ u32 rfLSSIReadBack; /* LSSI RF readback data SI mode */ -+ /* 0x8a0~0x8af [16 bytes] */ -+ -+ u32 rfLSSIReadBackPi; /* LSSI RF readback data PI mode 0x8b8-8bc for Path A and B */ -+ -+} BB_REGISTER_DEFINITION_T, *PBB_REGISTER_DEFINITION_T; -+ -+ -+/* ---------------------------------------------------------------------- */ -+u8 -+PHY_GetTxPowerByRateBase( -+ IN PADAPTER Adapter, -+ IN u8 Band, -+ IN u8 RfPath, -+ IN u8 TxNum, -+ IN RATE_SECTION RateSection -+); -+ -+VOID -+PHY_GetRateValuesOfTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Value, -+ OUT u8 *Rate, -+ OUT s8 *PwrByRateVal, -+ OUT u8 *RateNum -+); -+ -+u8 -+PHY_GetRateIndexOfTxPowerByRate( -+ IN u8 Rate -+); -+ -+VOID -+PHY_SetTxPowerIndexByRateSection( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Channel, -+ IN u8 RateSection -+); -+ -+s8 -+_PHY_GetTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u8 Band, -+ IN u8 RFPath, -+ IN u8 TxNum, -+ IN u8 RateIndex -+); -+ -+s8 -+PHY_GetTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u8 Band, -+ IN u8 RFPath, -+ IN u8 TxNum, -+ IN u8 RateIndex -+); -+ -+#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI -+s8 -+PHY_GetTxPowerByRateOriginal( -+ IN PADAPTER pAdapter, -+ IN u8 Band, -+ IN u8 RFPath, -+ IN u8 TxNum, -+ IN u8 Rate -+); -+#endif -+ -+VOID -+PHY_SetTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u8 Band, -+ IN u8 RFPath, -+ IN u8 TxNum, -+ IN u8 Rate, -+ IN s8 Value -+); -+ -+VOID -+PHY_SetTxPowerLevelByPath( -+ IN PADAPTER Adapter, -+ IN u8 channel, -+ IN u8 path -+); -+ -+VOID -+PHY_SetTxPowerIndexByRateArray( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel, -+ IN u8 *Rates, -+ IN u8 RateArraySize -+); -+ -+VOID -+PHY_InitTxPowerByRate( -+ IN PADAPTER pAdapter -+); -+ -+VOID -+PHY_StoreTxPowerByRate( -+ IN PADAPTER pAdapter, -+ IN u32 Band, -+ IN u32 RfPath, -+ IN u32 TxNum, -+ IN u32 RegAddr, -+ IN u32 BitMask, -+ IN u32 Data -+); -+ -+VOID -+PHY_TxPowerByRateConfiguration( -+ IN PADAPTER pAdapter -+); -+ -+u8 -+PHY_GetTxPowerIndexBase( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel, -+ OUT PBOOLEAN bIn24G -+); -+ -+s8 -+PHY_GetTxPowerLimit( -+ IN PADAPTER Adapter, -+ IN u32 RegPwrTblSel, -+ IN BAND_TYPE Band, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 RfPath, -+ IN u8 DataRate, -+ IN u8 Channel -+); -+ -+s8 -+PHY_GetTxPowerLimit_no_sc( -+ IN PADAPTER Adapter, -+ IN u32 RegPwrTblSel, -+ IN BAND_TYPE Band, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 RfPath, -+ IN u8 DataRate, -+ IN u8 Channel -+); -+ -+#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI -+s8 -+PHY_GetTxPowerLimitOriginal( -+ IN PADAPTER Adapter, -+ IN u32 RegPwrTblSel, -+ IN BAND_TYPE Band, -+ IN CHANNEL_WIDTH Bandwidth, -+ IN u8 RfPath, -+ IN u8 DataRate, -+ IN u8 Channel -+); -+#endif -+ -+VOID -+PHY_ConvertTxPowerLimitToPowerIndex( -+ IN PADAPTER Adapter -+); -+ -+VOID -+PHY_InitTxPowerLimit( -+ IN PADAPTER Adapter -+); -+ -+s8 -+PHY_GetTxPowerTrackingOffset( -+ PADAPTER pAdapter, -+ u8 Rate, -+ u8 RFPath -+); -+ -+struct txpwr_idx_comp { -+ u8 base; -+ s8 by_rate; -+ s8 limit; -+ s8 tpt; -+ s8 ebias; -+}; -+ -+u8 -+PHY_GetTxPowerIndex( -+ IN PADAPTER pAdapter, -+ IN u8 RFPath, -+ IN u8 Rate, -+ IN CHANNEL_WIDTH BandWidth, -+ IN u8 Channel -+); -+ -+VOID -+PHY_SetTxPowerIndex( -+ IN PADAPTER pAdapter, -+ IN u32 PowerIndex, -+ IN u8 RFPath, -+ IN u8 Rate -+); -+ -+void dump_tx_power_idx_title(void *sel, _adapter *adapter); -+void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath, u8 rs); -+void dump_tx_power_idx(void *sel, _adapter *adapter); -+ -+bool phy_is_tx_power_limit_needed(_adapter *adapter); -+bool phy_is_tx_power_by_rate_needed(_adapter *adapter); -+int phy_load_tx_power_by_rate(_adapter *adapter, u8 chk_file); -+int phy_load_tx_power_limit(_adapter *adapter, u8 chk_file); -+void phy_load_tx_power_ext_info(_adapter *adapter, u8 chk_file); -+void phy_reload_tx_power_ext_info(_adapter *adapter); -+void phy_reload_default_tx_power_ext_info(_adapter *adapter); -+ -+const struct map_t *hal_pg_txpwr_def_info(_adapter *adapter); -+ -+void dump_pg_txpwr_info_2g(void *sel, TxPowerInfo24G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt); -+void dump_pg_txpwr_info_5g(void *sel, TxPowerInfo5G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt); -+ -+void dump_hal_txpwr_info_2g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt); -+void dump_hal_txpwr_info_5g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt); -+ -+void hal_load_txpwr_info( -+ _adapter *adapter, -+ TxPowerInfo24G *pwr_info_2g, -+ TxPowerInfo5G *pwr_info_5g, -+ u8 *pg_data -+); -+ -+void dump_tx_power_ext_info(void *sel, _adapter *adapter); -+void dump_target_tx_power(void *sel, _adapter *adapter); -+void dump_tx_power_by_rate(void *sel, _adapter *adapter); -+void dump_tx_power_limit(void *sel, _adapter *adapter); -+ -+int rtw_get_phy_file_path(_adapter *adapter, const char *file_name); -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+#define MAC_FILE_FW_NIC "FW_NIC.bin" -+#define MAC_FILE_FW_WW_IMG "FW_WoWLAN.bin" -+#define PHY_FILE_MAC_REG "MAC_REG.txt" -+ -+#define PHY_FILE_AGC_TAB "AGC_TAB.txt" -+#define PHY_FILE_PHY_REG "PHY_REG.txt" -+#define PHY_FILE_PHY_REG_MP "PHY_REG_MP.txt" -+#define PHY_FILE_PHY_REG_PG "PHY_REG_PG.txt" -+ -+#define PHY_FILE_RADIO_A "RadioA.txt" -+#define PHY_FILE_RADIO_B "RadioB.txt" -+#define PHY_FILE_RADIO_C "RadioC.txt" -+#define PHY_FILE_RADIO_D "RadioD.txt" -+#define PHY_FILE_TXPWR_TRACK "TxPowerTrack.txt" -+#define PHY_FILE_TXPWR_LMT "TXPWR_LMT.txt" -+ -+#define PHY_FILE_WIFI_ANT_ISOLATION "wifi_ant_isolation.txt" -+ -+#define MAX_PARA_FILE_BUF_LEN 25600 -+ -+#define LOAD_MAC_PARA_FILE BIT0 -+#define LOAD_BB_PARA_FILE BIT1 -+#define LOAD_BB_PG_PARA_FILE BIT2 -+#define LOAD_BB_MP_PARA_FILE BIT3 -+#define LOAD_RF_PARA_FILE BIT4 -+#define LOAD_RF_TXPWR_TRACK_PARA_FILE BIT5 -+#define LOAD_RF_TXPWR_LMT_PARA_FILE BIT6 -+ -+int phy_ConfigMACWithParaFile(IN PADAPTER Adapter, IN char *pFileName); -+int phy_ConfigBBWithParaFile(IN PADAPTER Adapter, IN char *pFileName, IN u32 ConfigType); -+int phy_ConfigBBWithPgParaFile(IN PADAPTER Adapter, IN const char *pFileName); -+int phy_ConfigBBWithMpParaFile(IN PADAPTER Adapter, IN char *pFileName); -+int PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, IN char *pFileName, IN u8 eRFPath); -+int PHY_ConfigRFWithTxPwrTrackParaFile(IN PADAPTER Adapter, IN char *pFileName); -+int PHY_ConfigRFWithPowerLimitTableParaFile(IN PADAPTER Adapter, IN const char *pFileName); -+void phy_free_filebuf_mask(_adapter *padapter, u8 mask); -+void phy_free_filebuf(_adapter *padapter); -+#endif /* CONFIG_LOAD_PHY_PARA_FROM_FILE */ -+ -+#endif /* __HAL_COMMON_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_com_reg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_reg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_com_reg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_com_reg.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,1819 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_COMMON_REG_H__ -+#define __HAL_COMMON_REG_H__ -+ -+ -+#define MAC_ADDR_LEN 6 -+ -+#define HAL_NAV_UPPER_UNIT 128 /* micro-second */ -+ -+/* 8188E PKT_BUFF_ACCESS_CTRL value */ -+#define TXPKT_BUF_SELECT 0x69 -+#define RXPKT_BUF_SELECT 0xA5 -+#define DISABLE_TRXPKT_BUF_ACCESS 0x0 -+ -+#ifndef RTW_HALMAC -+/* ************************************************************ -+* -+* ************************************************************ */ -+ -+/* ----------------------------------------------------- -+* -+* 0x0000h ~ 0x00FFh System Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_SYS_ISO_CTRL 0x0000 -+#define REG_SYS_FUNC_EN 0x0002 -+#define REG_APS_FSMCO 0x0004 -+#define REG_SYS_CLKR 0x0008 -+#define REG_SYS_CLK_CTRL REG_SYS_CLKR -+#define REG_9346CR 0x000A -+#define REG_SYS_EEPROM_CTRL 0x000A -+#define REG_EE_VPD 0x000C -+#define REG_AFE_MISC 0x0010 -+#define REG_SPS0_CTRL 0x0011 -+#define REG_SPS0_CTRL_6 0x0016 -+#define REG_POWER_OFF_IN_PROCESS 0x0017 -+#define REG_SPS_OCP_CFG 0x0018 -+#define REG_RSV_CTRL 0x001C -+#define REG_RF_CTRL 0x001F -+#define REG_LDOA15_CTRL 0x0020 -+#define REG_LDOV12D_CTRL 0x0021 -+#define REG_LDOHCI12_CTRL 0x0022 -+#define REG_LPLDO_CTRL 0x0023 -+#define REG_AFE_XTAL_CTRL 0x0024 -+#define REG_AFE_LDO_CTRL 0x0027 /* 1.5v for 8188EE test chip, 1.4v for MP chip */ -+#define REG_AFE_PLL_CTRL 0x0028 -+#define REG_MAC_PHY_CTRL 0x002c /* for 92d, DMDP, SMSP, DMSP contrl */ -+#define REG_APE_PLL_CTRL_EXT 0x002c -+#define REG_EFUSE_CTRL 0x0030 -+#define REG_EFUSE_TEST 0x0034 -+#define REG_PWR_DATA 0x0038 -+#define REG_CAL_TIMER 0x003C -+#define REG_ACLK_MON 0x003E -+#define REG_GPIO_MUXCFG 0x0040 -+#define REG_GPIO_IO_SEL 0x0042 -+#define REG_MAC_PINMUX_CFG 0x0043 -+#define REG_GPIO_PIN_CTRL 0x0044 -+#define REG_GPIO_INTM 0x0048 -+#define REG_LEDCFG0 0x004C -+#define REG_LEDCFG1 0x004D -+#define REG_LEDCFG2 0x004E -+#define REG_LEDCFG3 0x004F -+#define REG_FSIMR 0x0050 -+#define REG_FSISR 0x0054 -+#define REG_HSIMR 0x0058 -+#define REG_HSISR 0x005c -+#define REG_GPIO_PIN_CTRL_2 0x0060 /* RTL8723 WIFI/BT/GPS Multi-Function GPIO Pin Control. */ -+#define REG_GPIO_IO_SEL_2 0x0062 /* RTL8723 WIFI/BT/GPS Multi-Function GPIO Select. */ -+#define REG_PAD_CTRL_1 0x0064 -+#define REG_MULTI_FUNC_CTRL 0x0068 /* RTL8723 WIFI/BT/GPS Multi-Function control source. */ -+#define REG_GSSR 0x006c -+#define REG_AFE_XTAL_CTRL_EXT 0x0078 /* RTL8188E */ -+#define REG_XCK_OUT_CTRL 0x007c /* RTL8188E */ -+#define REG_MCUFWDL 0x0080 -+#define REG_WOL_EVENT 0x0081 /* RTL8188E */ -+#define REG_MCUTSTCFG 0x0084 -+#define REG_FDHM0 0x0088 -+#define REG_HOST_SUSP_CNT 0x00BC /* RTL8192C Host suspend counter on FPGA platform */ -+#define REG_SYSTEM_ON_CTRL 0x00CC /* For 8723AE Reset after S3 */ -+#define REG_EFUSE_ACCESS 0x00CF /* Efuse access protection for RTL8723 */ -+#define REG_BIST_SCAN 0x00D0 -+#define REG_BIST_RPT 0x00D4 -+#define REG_BIST_ROM_RPT 0x00D8 -+#define REG_USB_SIE_INTF 0x00E0 -+#define REG_PCIE_MIO_INTF 0x00E4 -+#define REG_PCIE_MIO_INTD 0x00E8 -+#define REG_HPON_FSM 0x00EC -+#define REG_SYS_CFG 0x00F0 -+#define REG_GPIO_OUTSTS 0x00F4 /* For RTL8723 only. */ -+#define REG_TYPE_ID 0x00FC -+ -+/* -+* 2010/12/29 MH Add for 92D -+* */ -+#define REG_MAC_PHY_CTRL_NORMAL 0x00f8 -+ -+ -+/* ----------------------------------------------------- -+* -+* 0x0100h ~ 0x01FFh MACTOP General Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_CR 0x0100 -+#define REG_PBP 0x0104 -+#define REG_PKT_BUFF_ACCESS_CTRL 0x0106 -+#define REG_TRXDMA_CTRL 0x010C -+#define REG_TRXFF_BNDY 0x0114 -+#define REG_TRXFF_STATUS 0x0118 -+#define REG_RXFF_PTR 0x011C -+#define REG_HIMR 0x0120 -+#define REG_HISR 0x0124 -+#define REG_HIMRE 0x0128 -+#define REG_HISRE 0x012C -+#define REG_CPWM 0x012F -+#define REG_FWIMR 0x0130 -+#define REG_FWISR 0x0134 -+#define REG_FTIMR 0x0138 -+#define REG_FTISR 0x013C /* RTL8192C */ -+#define REG_PKTBUF_DBG_CTRL 0x0140 -+#define REG_RXPKTBUF_CTRL (REG_PKTBUF_DBG_CTRL+2) -+#define REG_PKTBUF_DBG_DATA_L 0x0144 -+#define REG_PKTBUF_DBG_DATA_H 0x0148 -+ -+#define REG_TC0_CTRL 0x0150 -+#define REG_TC1_CTRL 0x0154 -+#define REG_TC2_CTRL 0x0158 -+#define REG_TC3_CTRL 0x015C -+#define REG_TC4_CTRL 0x0160 -+#define REG_TCUNIT_BASE 0x0164 -+#define REG_MBIST_START 0x0174 -+#define REG_MBIST_DONE 0x0178 -+#define REG_MBIST_FAIL 0x017C -+#define REG_32K_CTRL 0x0194 /* RTL8188E */ -+#define REG_C2HEVT_MSG_NORMAL 0x01A0 -+#define REG_C2HEVT_CLEAR 0x01AF -+#define REG_MCUTST_1 0x01c0 -+#define REG_MCUTST_WOWLAN 0x01C7 /* Defined after 8188E series. */ -+#define REG_FMETHR 0x01C8 -+#define REG_HMETFR 0x01CC -+#define REG_HMEBOX_0 0x01D0 -+#define REG_HMEBOX_1 0x01D4 -+#define REG_HMEBOX_2 0x01D8 -+#define REG_HMEBOX_3 0x01DC -+#define REG_LLT_INIT 0x01E0 -+#define REG_HMEBOX_EXT_0 0x01F0 -+#define REG_HMEBOX_EXT_1 0x01F4 -+#define REG_HMEBOX_EXT_2 0x01F8 -+#define REG_HMEBOX_EXT_3 0x01FC -+ -+ -+/* ----------------------------------------------------- -+* -+* 0x0200h ~ 0x027Fh TXDMA Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_RQPN 0x0200 -+#define REG_FIFOPAGE 0x0204 -+#define REG_TDECTRL 0x0208 -+#define REG_TXDMA_OFFSET_CHK 0x020C -+#define REG_TXDMA_STATUS 0x0210 -+#define REG_RQPN_NPQ 0x0214 -+#define REG_AUTO_LLT 0x0224 -+ -+ -+/* ----------------------------------------------------- -+* -+* 0x0280h ~ 0x02FFh RXDMA Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_RXDMA_AGG_PG_TH 0x0280 -+#define REG_RXPKT_NUM 0x0284 -+#define REG_RXDMA_STATUS 0x0288 -+ -+/* ----------------------------------------------------- -+* -+* 0x0300h ~ 0x03FFh PCIe -+* -+* ----------------------------------------------------- */ -+#ifndef CONFIG_TRX_BD_ARCH /* prevent CONFIG_TRX_BD_ARCH to use old registers */ -+ -+#define REG_PCIE_CTRL_REG 0x0300 -+#define REG_INT_MIG 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_DESA 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_HQ_DESA 0x0310 /* TX High Queue Descriptor Address */ -+#define REG_MGQ_DESA 0x0318 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_DESA 0x0320 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_DESA 0x0328 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_DESA 0x0330 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_DESA 0x0338 /* TX BK Queue Descriptor Address */ -+#define REG_RX_DESA 0x0340 /* RX Queue Descriptor Address */ -+/* sherry added for DBI Read/Write 20091126 */ -+#define REG_DBI_WDATA 0x0348 /* Backdoor REG for Access Configuration */ -+#define REG_DBI_RDATA 0x034C /* Backdoor REG for Access Configuration */ -+#define REG_DBI_CTRL 0x0350 /* Backdoor REG for Access Configuration */ -+#define REG_DBI_FLAG 0x0352 /* Backdoor REG for Access Configuration */ -+#define REG_MDIO 0x0354 /* MDIO for Access PCIE PHY */ -+#define REG_DBG_SEL 0x0360 /* Debug Selection Register */ -+#define REG_PCIE_HRPWM 0x0361 /* PCIe RPWM */ -+#define REG_PCIE_HCPWM 0x0363 /* PCIe CPWM */ -+#define REG_WATCH_DOG 0x0368 -+#define REG_RX_RXBD_NUM 0x0382 -+ -+/* RTL8723 series ------------------------------- */ -+#define REG_PCIE_HISR_EN 0x0394 /* PCIE Local Interrupt Enable Register */ -+#define REG_PCIE_HISR 0x03A0 -+#define REG_PCIE_HISRE 0x03A4 -+#define REG_PCIE_HIMR 0x03A8 -+#define REG_PCIE_HIMRE 0x03AC -+ -+#endif /* !CONFIG_TRX_BD_ARCH */ -+ -+#define REG_USB_HIMR 0xFE38 -+#define REG_USB_HIMRE 0xFE3C -+#define REG_USB_HISR 0xFE78 -+#define REG_USB_HISRE 0xFE7C -+ -+ -+/* ----------------------------------------------------- -+* -+* 0x0400h ~ 0x047Fh Protocol Configuration -+* -+* ----------------------------------------------------- */ -+ -+/* 92C, 92D */ -+#define REG_VOQ_INFO 0x0400 -+#define REG_VIQ_INFO 0x0404 -+#define REG_BEQ_INFO 0x0408 -+#define REG_BKQ_INFO 0x040C -+ -+/* 88E, 8723A, 8812A, 8821A, 92E, 8723B */ -+#define REG_Q0_INFO 0x400 -+#define REG_Q1_INFO 0x404 -+#define REG_Q2_INFO 0x408 -+#define REG_Q3_INFO 0x40C -+ -+#define REG_MGQ_INFO 0x0410 -+#define REG_HGQ_INFO 0x0414 -+#define REG_BCNQ_INFO 0x0418 -+#define REG_TXPKT_EMPTY 0x041A -+#define REG_CPU_MGQ_INFORMATION 0x041C -+#define REG_FWHW_TXQ_CTRL 0x0420 -+#define REG_HWSEQ_CTRL 0x0423 -+#define REG_BCNQ_BDNY 0x0424 -+#define REG_MGQ_BDNY 0x0425 -+#define REG_LIFETIME_CTRL 0x0426 -+#define REG_MULTI_BCNQ_OFFSET 0x0427 -+#define REG_SPEC_SIFS 0x0428 -+#define REG_RL 0x042A -+#define REG_DARFRC 0x0430 -+#define REG_RARFRC 0x0438 -+#define REG_RRSR 0x0440 -+#define REG_ARFR0 0x0444 -+#define REG_ARFR1 0x0448 -+#define REG_ARFR2 0x044C -+#define REG_ARFR3 0x0450 -+#define REG_CCK_CHECK 0x0454 -+#define REG_BCNQ1_BDNY 0x0457 -+ -+#define REG_AGGLEN_LMT 0x0458 -+#define REG_AMPDU_MIN_SPACE 0x045C -+#define REG_WMAC_LBK_BF_HD 0x045D -+#define REG_FAST_EDCA_CTRL 0x0460 -+#define REG_RD_RESP_PKT_TH 0x0463 -+ -+/* 8723A, 8812A, 8821A, 92E, 8723B */ -+#define REG_Q4_INFO 0x468 -+#define REG_Q5_INFO 0x46C -+#define REG_Q6_INFO 0x470 -+#define REG_Q7_INFO 0x474 -+ -+#define REG_INIRTS_RATE_SEL 0x0480 -+#define REG_INIDATA_RATE_SEL 0x0484 -+ -+/* 8723B, 92E, 8812A, 8821A*/ -+#define REG_MACID_SLEEP_3 0x0484 -+#define REG_MACID_SLEEP_1 0x0488 -+ -+#define REG_POWER_STAGE1 0x04B4 -+#define REG_POWER_STAGE2 0x04B8 -+#define REG_PKT_VO_VI_LIFE_TIME 0x04C0 -+#define REG_PKT_BE_BK_LIFE_TIME 0x04C2 -+#define REG_STBC_SETTING 0x04C4 -+#define REG_QUEUE_CTRL 0x04C6 -+#define REG_SINGLE_AMPDU_CTRL 0x04c7 -+#define REG_PROT_MODE_CTRL 0x04C8 -+#define REG_MAX_AGGR_NUM 0x04CA -+#define REG_RTS_MAX_AGGR_NUM 0x04CB -+#define REG_BAR_MODE_CTRL 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT 0x04CF -+ -+/* 8723A */ -+#define REG_MACID_DROP 0x04D0 -+ -+/* 88E */ -+#define REG_EARLY_MODE_CONTROL 0x04D0 -+ -+/* 8723B, 92E, 8812A, 8821A */ -+#define REG_MACID_SLEEP_2 0x04D0 -+ -+/* 8723A, 8723B, 92E, 8812A, 8821A */ -+#define REG_MACID_SLEEP 0x04D4 -+ -+#define REG_NQOS_SEQ 0x04DC -+#define REG_QOS_SEQ 0x04DE -+#define REG_NEED_CPU_HANDLE 0x04E0 -+#define REG_PKT_LOSE_RPT 0x04E1 -+#define REG_PTCL_ERR_STATUS 0x04E2 -+#define REG_TX_RPT_CTRL 0x04EC -+#define REG_TX_RPT_TIME 0x04F0 /* 2 byte */ -+#define REG_DUMMY 0x04FC -+ -+/* ----------------------------------------------------- -+* -+* 0x0500h ~ 0x05FFh EDCA Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_EDCA_VO_PARAM 0x0500 -+#define REG_EDCA_VI_PARAM 0x0504 -+#define REG_EDCA_BE_PARAM 0x0508 -+#define REG_EDCA_BK_PARAM 0x050C -+#define REG_BCNTCFG 0x0510 -+#define REG_PIFS 0x0512 -+#define REG_RDG_PIFS 0x0513 -+#define REG_SIFS_CTX 0x0514 -+#define REG_SIFS_TRX 0x0516 -+#define REG_TSFTR_SYN_OFFSET 0x0518 -+#define REG_AGGR_BREAK_TIME 0x051A -+#define REG_SLOT 0x051B -+#define REG_TX_PTCL_CTRL 0x0520 -+#define REG_TXPAUSE 0x0522 -+#define REG_DIS_TXREQ_CLR 0x0523 -+#define REG_RD_CTRL 0x0524 -+/* -+* Format for offset 540h-542h: -+* [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. -+* [7:4]: Reserved. -+* [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. -+* [23:20]: Reserved -+* Description: -+* | -+* |<--Setup--|--Hold------------>| -+* --------------|---------------------- -+* | -+* TBTT -+* Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. -+* Described by Designer Tim and Bruce, 2011-01-14. -+* */ -+#define REG_TBTT_PROHIBIT 0x0540 -+#define REG_RD_NAV_NXT 0x0544 -+#define REG_NAV_PROT_LEN 0x0546 -+#define REG_BCN_CTRL 0x0550 -+#define REG_BCN_CTRL_1 0x0551 -+#define REG_MBID_NUM 0x0552 -+#define REG_DUAL_TSF_RST 0x0553 -+#define REG_BCN_INTERVAL 0x0554 /* The same as REG_MBSSID_BCN_SPACE */ -+#define REG_DRVERLYINT 0x0558 -+#define REG_BCNDMATIM 0x0559 -+#define REG_ATIMWND 0x055A -+#define REG_USTIME_TSF 0x055C -+#define REG_BCN_MAX_ERR 0x055D -+#define REG_RXTSF_OFFSET_CCK 0x055E -+#define REG_RXTSF_OFFSET_OFDM 0x055F -+#define REG_TSFTR 0x0560 -+#define REG_TSFTR1 0x0568 /* HW Port 1 TSF Register */ -+#define REG_ATIMWND_1 0x0570 -+#define REG_P2P_CTWIN 0x0572 /* 1 Byte long (in unit of TU) */ -+#define REG_PSTIMER 0x0580 -+#define REG_TIMER0 0x0584 -+#define REG_TIMER1 0x0588 -+#define REG_ACMHWCTRL 0x05C0 -+#define REG_NOA_DESC_SEL 0x05CF -+#define REG_NOA_DESC_DURATION 0x05E0 -+#define REG_NOA_DESC_INTERVAL 0x05E4 -+#define REG_NOA_DESC_START 0x05E8 -+#define REG_NOA_DESC_COUNT 0x05EC -+ -+#define REG_DMC 0x05F0 /* Dual MAC Co-Existence Register */ -+#define REG_SCH_TX_CMD 0x05F8 -+ -+#define REG_FW_RESET_TSF_CNT_1 0x05FC -+#define REG_FW_RESET_TSF_CNT_0 0x05FD -+#define REG_FW_BCN_DIS_CNT 0x05FE -+ -+/* ----------------------------------------------------- -+* -+* 0x0600h ~ 0x07FFh WMAC Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_APSD_CTRL 0x0600 -+#define REG_BWOPMODE 0x0603 -+#define REG_TCR 0x0604 -+#define REG_RCR 0x0608 -+#define REG_RX_PKT_LIMIT 0x060C -+#define REG_RX_DLK_TIME 0x060D -+#define REG_RX_DRVINFO_SZ 0x060F -+ -+#define REG_MACID 0x0610 -+#define REG_BSSID 0x0618 -+#define REG_MAR 0x0620 -+#define REG_MBIDCAMCFG_1 0x0628 -+#define REG_MBIDCAMCFG_2 0x062C -+ -+#define REG_PNO_STATUS 0x0631 -+#define REG_USTIME_EDCA 0x0638 -+#define REG_MAC_SPEC_SIFS 0x063A -+/* 20100719 Joseph: Hardware register definition change. (HW datasheet v54) */ -+#define REG_RESP_SIFS_CCK 0x063C /* [15:8]SIFS_R2T_OFDM, [7:0]SIFS_R2T_CCK */ -+#define REG_RESP_SIFS_OFDM 0x063E /* [15:8]SIFS_T2T_OFDM, [7:0]SIFS_T2T_CCK */ -+ -+#define REG_ACKTO 0x0640 -+#define REG_CTS2TO 0x0641 -+#define REG_EIFS 0x0642 -+ -+ -+/* RXERR_RPT */ -+#define RXERR_TYPE_OFDM_PPDU 0 -+#define RXERR_TYPE_OFDM_FALSE_ALARM 1 -+#define RXERR_TYPE_OFDM_MPDU_OK 2 -+#define RXERR_TYPE_OFDM_MPDU_FAIL 3 -+#define RXERR_TYPE_CCK_PPDU 4 -+#define RXERR_TYPE_CCK_FALSE_ALARM 5 -+#define RXERR_TYPE_CCK_MPDU_OK 6 -+#define RXERR_TYPE_CCK_MPDU_FAIL 7 -+#define RXERR_TYPE_HT_PPDU 8 -+#define RXERR_TYPE_HT_FALSE_ALARM 9 -+#define RXERR_TYPE_HT_MPDU_TOTAL 10 -+#define RXERR_TYPE_HT_MPDU_OK 11 -+#define RXERR_TYPE_HT_MPDU_FAIL 12 -+#define RXERR_TYPE_RX_FULL_DROP 15 -+ -+#define RXERR_COUNTER_MASK 0xFFFFF -+#define RXERR_RPT_RST BIT(27) -+#define _RXERR_RPT_SEL(type) ((type) << 28) -+ -+/* -+* Note: -+* The NAV upper value is very important to WiFi 11n 5.2.3 NAV test. The default value is -+* always too small, but the WiFi TestPlan test by 25,000 microseconds of NAV through sending -+* CTS in the air. We must update this value greater than 25,000 microseconds to pass the item. -+* The offset of NAV_UPPER in 8192C Spec is incorrect, and the offset should be 0x0652. Commented -+* by SD1 Scott. -+* By Bruce, 2011-07-18. -+* */ -+#define REG_NAV_UPPER 0x0652 /* unit of 128 */ -+ -+/* WMA, BA, CCX */ -+#define REG_NAV_CTRL 0x0650 -+#define REG_BACAMCMD 0x0654 -+#define REG_BACAMCONTENT 0x0658 -+#define REG_LBDLY 0x0660 -+#define REG_FWDLY 0x0661 -+#define REG_RXERR_RPT 0x0664 -+#define REG_WMAC_TRXPTCL_CTL 0x0668 -+ -+/* Security */ -+#define REG_CAMCMD 0x0670 -+#define REG_CAMWRITE 0x0674 -+#define REG_CAMREAD 0x0678 -+#define REG_CAMDBG 0x067C -+#define REG_SECCFG 0x0680 -+ -+/* Power */ -+#define REG_WOW_CTRL 0x0690 -+#define REG_PS_RX_INFO 0x0692 -+#define REG_UAPSD_TID 0x0693 -+#define REG_WKFMCAM_CMD 0x0698 -+#define REG_WKFMCAM_NUM REG_WKFMCAM_CMD -+#define REG_WKFMCAM_RWD 0x069C -+#define REG_RXFLTMAP0 0x06A0 -+#define REG_RXFLTMAP1 0x06A2 -+#define REG_RXFLTMAP2 0x06A4 -+#define REG_BCN_PSR_RPT 0x06A8 -+#define REG_BT_COEX_TABLE 0x06C0 -+ -+/* Hardware Port 1 */ -+#define REG_MACID1 0x0700 -+#define REG_BSSID1 0x0708 -+/* Hardware Port 2 */ -+#define REG_MACID2 0x1620 -+#define REG_BSSID2 0x1628 -+/* Hardware Port 3*/ -+#define REG_MACID3 0x1630 -+#define REG_BSSID3 0x1638 -+/* Hardware Port 4 */ -+#define REG_MACID4 0x1640 -+#define REG_BSSID4 0x1648 -+ -+ -+#define REG_CR_EXT 0x1100 -+ -+/* ----------------------------------------------------- -+* -+* 0xFE00h ~ 0xFE55h USB Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_USB_INFO 0xFE17 -+#define REG_USB_SPECIAL_OPTION 0xFE55 -+#define REG_USB_DMA_AGG_TO 0xFE5B -+#define REG_USB_AGG_TO 0xFE5C -+#define REG_USB_AGG_TH 0xFE5D -+ -+#define REG_USB_HRPWM 0xFE58 -+#define REG_USB_HCPWM 0xFE57 -+ -+/* for 92DU high_Queue low_Queue Normal_Queue select */ -+#define REG_USB_High_NORMAL_Queue_Select_MAC0 0xFE44 -+/* #define REG_USB_LOW_Queue_Select_MAC0 0xFE45 */ -+#define REG_USB_High_NORMAL_Queue_Select_MAC1 0xFE47 -+/* #define REG_USB_LOW_Queue_Select_MAC1 0xFE48 */ -+ -+/* For test chip */ -+#define REG_TEST_USB_TXQS 0xFE48 -+#define REG_TEST_SIE_VID 0xFE60 /* 0xFE60~0xFE61 */ -+#define REG_TEST_SIE_PID 0xFE62 /* 0xFE62~0xFE63 */ -+#define REG_TEST_SIE_OPTIONAL 0xFE64 -+#define REG_TEST_SIE_CHIRP_K 0xFE65 -+#define REG_TEST_SIE_PHY 0xFE66 /* 0xFE66~0xFE6B */ -+#define REG_TEST_SIE_MAC_ADDR 0xFE70 /* 0xFE70~0xFE75 */ -+#define REG_TEST_SIE_STRING 0xFE80 /* 0xFE80~0xFEB9 */ -+ -+ -+/* For normal chip */ -+#define REG_NORMAL_SIE_VID 0xFE60 /* 0xFE60~0xFE61 */ -+#define REG_NORMAL_SIE_PID 0xFE62 /* 0xFE62~0xFE63 */ -+#define REG_NORMAL_SIE_OPTIONAL 0xFE64 -+#define REG_NORMAL_SIE_EP 0xFE65 /* 0xFE65~0xFE67 */ -+#define REG_NORMAL_SIE_PHY 0xFE68 /* 0xFE68~0xFE6B */ -+#define REG_NORMAL_SIE_OPTIONAL2 0xFE6C -+#define REG_NORMAL_SIE_GPS_EP 0xFE6D /* 0xFE6D, for RTL8723 only. */ -+#define REG_NORMAL_SIE_MAC_ADDR 0xFE70 /* 0xFE70~0xFE75 */ -+#define REG_NORMAL_SIE_STRING 0xFE80 /* 0xFE80~0xFEDF */ -+ -+ -+/* ----------------------------------------------------- -+* -+* Redifine 8192C register definition for compatibility -+* -+* ----------------------------------------------------- */ -+ -+/* TODO: use these definition when using REG_xxx naming rule. -+* NOTE: DO NOT Remove these definition. Use later. */ -+ -+#define EFUSE_CTRL REG_EFUSE_CTRL /* E-Fuse Control. */ -+#define EFUSE_TEST REG_EFUSE_TEST /* E-Fuse Test. */ -+#define MSR (REG_CR + 2) /* Media Status register */ -+/* #define ISR REG_HISR */ -+#define MSR1 REG_CR_EXT -+ -+#define TSFR REG_TSFTR /* Timing Sync Function Timer Register. */ -+#define TSFR1 REG_TSFTR1 /* HW Port 1 TSF Register */ -+ -+#define PBP REG_PBP -+ -+/* Redifine MACID register, to compatible prior ICs. */ -+#define IDR0 REG_MACID /* MAC ID Register, Offset 0x0050-0x0053 */ -+#define IDR4 (REG_MACID + 4) /* MAC ID Register, Offset 0x0054-0x0055 */ -+ -+ -+/* -+* 9. Security Control Registers (Offset: ) -+* */ -+#define RWCAM REG_CAMCMD /* IN 8190 Data Sheet is called CAMcmd */ -+#define WCAMI REG_CAMWRITE /* Software write CAM input content */ -+#define RCAMO REG_CAMREAD /* Software read/write CAM config */ -+#define CAMDBG REG_CAMDBG -+#define SECR REG_SECCFG /* Security Configuration Register */ -+ -+/* Unused register */ -+#define UnusedRegister 0x1BF -+#define DCAM UnusedRegister -+#define PSR UnusedRegister -+#define BBAddr UnusedRegister -+#define PhyDataR UnusedRegister -+ -+/* Min Spacing related settings. */ -+#define MAX_MSS_DENSITY_2T 0x13 -+#define MAX_MSS_DENSITY_1T 0x0A -+ -+/* ---------------------------------------------------------------------------- -+* 8192C Cmd9346CR bits (Offset 0xA, 16bit) -+* ---------------------------------------------------------------------------- */ -+#define CmdEEPROM_En BIT5 /* EEPROM enable when set 1 */ -+#define CmdEERPOMSEL BIT4 /* System EEPROM select, 0: boot from E-FUSE, 1: The EEPROM used is 9346 */ -+#define Cmd9346CR_9356SEL BIT4 -+ -+/* ---------------------------------------------------------------------------- -+* 8192C GPIO MUX Configuration Register (offset 0x40, 4 byte) -+* ---------------------------------------------------------------------------- */ -+#define GPIOSEL_GPIO 0 -+#define GPIOSEL_ENBT BIT5 -+ -+/* ---------------------------------------------------------------------------- -+* 8192C GPIO PIN Control Register (offset 0x44, 4 byte) -+* ---------------------------------------------------------------------------- */ -+#define GPIO_IN REG_GPIO_PIN_CTRL /* GPIO pins input value */ -+#define GPIO_OUT (REG_GPIO_PIN_CTRL+1) /* GPIO pins output value */ -+#define GPIO_IO_SEL (REG_GPIO_PIN_CTRL+2) /* GPIO pins output enable when a bit is set to "1"; otherwise, input is configured. */ -+#define GPIO_MOD (REG_GPIO_PIN_CTRL+3) -+ -+/* ---------------------------------------------------------------------------- -+* 8811A GPIO PIN Control Register (offset 0x60, 4 byte) -+* ---------------------------------------------------------------------------- */ -+#define GPIO_IN_8811A REG_GPIO_PIN_CTRL_2 /* GPIO pins input value */ -+#define GPIO_OUT_8811A (REG_GPIO_PIN_CTRL_2+1) /* GPIO pins output value */ -+#define GPIO_IO_SEL_8811A (REG_GPIO_PIN_CTRL_2+2) /* GPIO pins output enable when a bit is set to "1"; otherwise, input is configured. */ -+#define GPIO_MOD_8811A (REG_GPIO_PIN_CTRL_2+3) -+ -+/* ---------------------------------------------------------------------------- -+* 8723/8188E Host System Interrupt Mask Register (offset 0x58, 32 byte) -+* ---------------------------------------------------------------------------- */ -+#define HSIMR_GPIO12_0_INT_EN BIT0 -+#define HSIMR_SPS_OCP_INT_EN BIT5 -+#define HSIMR_RON_INT_EN BIT6 -+#define HSIMR_PDN_INT_EN BIT7 -+#define HSIMR_GPIO9_INT_EN BIT25 -+ -+/* ---------------------------------------------------------------------------- -+* 8723/8188E Host System Interrupt Status Register (offset 0x5C, 32 byte) -+* ---------------------------------------------------------------------------- */ -+#define HSISR_GPIO12_0_INT BIT0 -+#define HSISR_SPS_OCP_INT BIT5 -+#define HSISR_RON_INT BIT6 -+#define HSISR_PDNINT BIT7 -+#define HSISR_GPIO9_INT BIT25 -+ -+/* ---------------------------------------------------------------------------- -+* 8192C (MSR) Media Status Register (Offset 0x4C, 8 bits) -+* ---------------------------------------------------------------------------- */ -+/* -+Network Type -+00: No link -+01: Link in ad hoc network -+10: Link in infrastructure network -+11: AP mode -+Default: 00b. -+*/ -+#define MSR_NOLINK 0x00 -+#define MSR_ADHOC 0x01 -+#define MSR_INFRA 0x02 -+#define MSR_AP 0x03 -+ -+/* ---------------------------------------------------------------------------- -+* USB INTR CONTENT -+* ---------------------------------------------------------------------------- */ -+#define USB_C2H_CMDID_OFFSET 0 -+#define USB_C2H_SEQ_OFFSET 1 -+#define USB_C2H_EVENT_OFFSET 2 -+#define USB_INTR_CPWM_OFFSET 16 -+#define USB_INTR_CONTENT_C2H_OFFSET 0 -+#define USB_INTR_CONTENT_CPWM1_OFFSET 16 -+#define USB_INTR_CONTENT_CPWM2_OFFSET 20 -+#define USB_INTR_CONTENT_HISR_OFFSET 48 -+#define USB_INTR_CONTENT_HISRE_OFFSET 52 -+#define USB_INTR_CONTENT_LENGTH 56 -+ -+/* ---------------------------------------------------------------------------- -+* Response Rate Set Register (offset 0x440, 24bits) -+* ---------------------------------------------------------------------------- */ -+#define RRSR_1M BIT0 -+#define RRSR_2M BIT1 -+#define RRSR_5_5M BIT2 -+#define RRSR_11M BIT3 -+#define RRSR_6M BIT4 -+#define RRSR_9M BIT5 -+#define RRSR_12M BIT6 -+#define RRSR_18M BIT7 -+#define RRSR_24M BIT8 -+#define RRSR_36M BIT9 -+#define RRSR_48M BIT10 -+#define RRSR_54M BIT11 -+#define RRSR_MCS0 BIT12 -+#define RRSR_MCS1 BIT13 -+#define RRSR_MCS2 BIT14 -+#define RRSR_MCS3 BIT15 -+#define RRSR_MCS4 BIT16 -+#define RRSR_MCS5 BIT17 -+#define RRSR_MCS6 BIT18 -+#define RRSR_MCS7 BIT19 -+ -+#define RRSR_CCK_RATES (RRSR_11M | RRSR_5_5M | RRSR_2M | RRSR_1M) -+#define RRSR_OFDM_RATES (RRSR_54M | RRSR_48M | RRSR_36M | RRSR_24M | RRSR_18M | RRSR_12M | RRSR_9M | RRSR_6M) -+ -+/* WOL bit information */ -+#define HAL92C_WOL_PTK_UPDATE_EVENT BIT0 -+#define HAL92C_WOL_GTK_UPDATE_EVENT BIT1 -+#define HAL92C_WOL_DISASSOC_EVENT BIT2 -+#define HAL92C_WOL_DEAUTH_EVENT BIT3 -+#define HAL92C_WOL_FW_DISCONNECT_EVENT BIT4 -+ -+ -+/*---------------------------------------------------------------------------- -+** REG_CCK_CHECK (offset 0x454) -+------------------------------------------------------------------------------*/ -+#define BIT_BCN_PORT_SEL BIT5 -+ -+#endif /* RTW_HALMAC */ -+ -+/* ---------------------------------------------------------------------------- -+ * Rate Definition -+ * ---------------------------------------------------------------------------- */ -+/* CCK */ -+#define RATR_1M 0x00000001 -+#define RATR_2M 0x00000002 -+#define RATR_55M 0x00000004 -+#define RATR_11M 0x00000008 -+/* OFDM */ -+#define RATR_6M 0x00000010 -+#define RATR_9M 0x00000020 -+#define RATR_12M 0x00000040 -+#define RATR_18M 0x00000080 -+#define RATR_24M 0x00000100 -+#define RATR_36M 0x00000200 -+#define RATR_48M 0x00000400 -+#define RATR_54M 0x00000800 -+/* MCS 1 Spatial Stream */ -+#define RATR_MCS0 0x00001000 -+#define RATR_MCS1 0x00002000 -+#define RATR_MCS2 0x00004000 -+#define RATR_MCS3 0x00008000 -+#define RATR_MCS4 0x00010000 -+#define RATR_MCS5 0x00020000 -+#define RATR_MCS6 0x00040000 -+#define RATR_MCS7 0x00080000 -+/* MCS 2 Spatial Stream */ -+#define RATR_MCS8 0x00100000 -+#define RATR_MCS9 0x00200000 -+#define RATR_MCS10 0x00400000 -+#define RATR_MCS11 0x00800000 -+#define RATR_MCS12 0x01000000 -+#define RATR_MCS13 0x02000000 -+#define RATR_MCS14 0x04000000 -+#define RATR_MCS15 0x08000000 -+ -+/* CCK */ -+#define RATE_1M BIT(0) -+#define RATE_2M BIT(1) -+#define RATE_5_5M BIT(2) -+#define RATE_11M BIT(3) -+/* OFDM */ -+#define RATE_6M BIT(4) -+#define RATE_9M BIT(5) -+#define RATE_12M BIT(6) -+#define RATE_18M BIT(7) -+#define RATE_24M BIT(8) -+#define RATE_36M BIT(9) -+#define RATE_48M BIT(10) -+#define RATE_54M BIT(11) -+/* MCS 1 Spatial Stream */ -+#define RATE_MCS0 BIT(12) -+#define RATE_MCS1 BIT(13) -+#define RATE_MCS2 BIT(14) -+#define RATE_MCS3 BIT(15) -+#define RATE_MCS4 BIT(16) -+#define RATE_MCS5 BIT(17) -+#define RATE_MCS6 BIT(18) -+#define RATE_MCS7 BIT(19) -+/* MCS 2 Spatial Stream */ -+#define RATE_MCS8 BIT(20) -+#define RATE_MCS9 BIT(21) -+#define RATE_MCS10 BIT(22) -+#define RATE_MCS11 BIT(23) -+#define RATE_MCS12 BIT(24) -+#define RATE_MCS13 BIT(25) -+#define RATE_MCS14 BIT(26) -+#define RATE_MCS15 BIT(27) -+ -+ -+/* ALL CCK Rate */ -+#define RATE_ALL_CCK (RATR_1M | RATR_2M | RATR_55M | RATR_11M) -+#define RATE_ALL_OFDM_AG (RATR_6M | RATR_9M | RATR_12M | RATR_18M | RATR_24M|\ -+ RATR_36M | RATR_48M | RATR_54M) -+#define RATE_ALL_OFDM_1SS (RATR_MCS0 | RATR_MCS1 | RATR_MCS2 | RATR_MCS3 |\ -+ RATR_MCS4 | RATR_MCS5 | RATR_MCS6 | RATR_MCS7) -+#define RATE_ALL_OFDM_2SS (RATR_MCS8 | RATR_MCS9 | RATR_MCS10 | RATR_MCS11|\ -+ RATR_MCS12 | RATR_MCS13 | RATR_MCS14 | RATR_MCS15) -+ -+#define RATE_BITMAP_ALL 0xFFFFF -+ -+/* Only use CCK 1M rate for ACK */ -+#define RATE_RRSR_CCK_ONLY_1M 0xFFFF1 -+#define RATE_RRSR_WITHOUT_CCK 0xFFFF0 -+ -+/* ---------------------------------------------------------------------------- -+ * BW_OPMODE bits (Offset 0x603, 8bit) -+ * ---------------------------------------------------------------------------- */ -+#define BW_OPMODE_20MHZ BIT2 -+#define BW_OPMODE_5G BIT1 -+ -+/* ---------------------------------------------------------------------------- -+ * CAM Config Setting (offset 0x680, 1 byte) -+ * ---------------------------------------------------------------------------- */ -+#define CAM_VALID BIT15 -+#define CAM_NOTVALID 0x0000 -+#define CAM_USEDK BIT5 -+ -+#define CAM_CONTENT_COUNT 8 -+ -+#define CAM_NONE 0x0 -+#define CAM_WEP40 0x01 -+#define CAM_TKIP 0x02 -+#define CAM_AES 0x04 -+#define CAM_WEP104 0x05 -+#define CAM_SMS4 0x6 -+ -+#define TOTAL_CAM_ENTRY 32 -+#define HALF_CAM_ENTRY 16 -+ -+#define CAM_CONFIG_USEDK _TRUE -+#define CAM_CONFIG_NO_USEDK _FALSE -+ -+#define CAM_WRITE BIT16 -+#define CAM_READ 0x00000000 -+#define CAM_POLLINIG BIT31 -+ -+/* -+ * 10. Power Save Control Registers -+ * */ -+#define WOW_PMEN BIT0 /* Power management Enable. */ -+#define WOW_WOMEN BIT1 /* WoW function on or off. */ -+#define WOW_MAGIC BIT2 /* Magic packet */ -+#define WOW_UWF BIT3 /* Unicast Wakeup frame. */ -+ -+/* -+ * 12. Host Interrupt Status Registers -+ * -+ * ---------------------------------------------------------------------------- -+ * 8190 IMR/ISR bits -+ * ---------------------------------------------------------------------------- */ -+#define IMR8190_DISABLED 0x0 -+#define IMR_DISABLED 0x0 -+/* IMR DW0 Bit 0-31 */ -+#define IMR_BCNDMAINT6 BIT31 /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5 BIT30 /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4 BIT29 /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3 BIT28 /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2 BIT27 /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1 BIT26 /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK8 BIT25 /* Beacon Queue DMA OK Interrup 8 */ -+#define IMR_BCNDOK7 BIT24 /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6 BIT23 /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5 BIT22 /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4 BIT21 /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3 BIT20 /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2 BIT19 /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1 BIT18 /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_TIMEOUT2 BIT17 /* Timeout interrupt 2 */ -+#define IMR_TIMEOUT1 BIT16 /* Timeout interrupt 1 */ -+#define IMR_TXFOVW BIT15 /* Transmit FIFO Overflow */ -+#define IMR_PSTIMEOUT BIT14 /* Power save time out interrupt */ -+#define IMR_BcnInt BIT13 /* Beacon DMA Interrupt 0 */ -+#define IMR_RXFOVW BIT12 /* Receive FIFO Overflow */ -+#define IMR_RDU BIT11 /* Receive Descriptor Unavailable */ -+#define IMR_ATIMEND BIT10 /* For 92C, ATIM Window End Interrupt. For 8723 and later ICs, it also means P2P CTWin End interrupt. */ -+#define IMR_BDOK BIT9 /* Beacon Queue DMA OK Interrup */ -+#define IMR_HIGHDOK BIT8 /* High Queue DMA OK Interrupt */ -+#define IMR_TBDOK BIT7 /* Transmit Beacon OK interrup */ -+#define IMR_MGNTDOK BIT6 /* Management Queue DMA OK Interrupt */ -+#define IMR_TBDER BIT5 /* For 92C, Transmit Beacon Error Interrupt */ -+#define IMR_BKDOK BIT4 /* AC_BK DMA OK Interrupt */ -+#define IMR_BEDOK BIT3 /* AC_BE DMA OK Interrupt */ -+#define IMR_VIDOK BIT2 /* AC_VI DMA OK Interrupt */ -+#define IMR_VODOK BIT1 /* AC_VO DMA Interrupt */ -+#define IMR_ROK BIT0 /* Receive DMA OK Interrupt */ -+ -+/* 13. Host Interrupt Status Extension Register (Offset: 0x012C-012Eh) */ -+#define IMR_TSF_BIT32_TOGGLE BIT15 -+#define IMR_BcnInt_E BIT12 -+#define IMR_TXERR BIT11 -+#define IMR_RXERR BIT10 -+#define IMR_C2HCMD BIT9 -+#define IMR_CPWM BIT8 -+/* RSVD [2-7] */ -+#define IMR_OCPINT BIT1 -+#define IMR_WLANOFF BIT0 -+ -+/* ---------------------------------------------------------------------------- -+ * 8723E series PCIE Host IMR/ISR bit -+ * ---------------------------------------------------------------------------- */ -+/* IMR DW0 Bit 0-31 */ -+#define PHIMR_TIMEOUT2 BIT31 -+#define PHIMR_TIMEOUT1 BIT30 -+#define PHIMR_PSTIMEOUT BIT29 -+#define PHIMR_GTINT4 BIT28 -+#define PHIMR_GTINT3 BIT27 -+#define PHIMR_TXBCNERR BIT26 -+#define PHIMR_TXBCNOK BIT25 -+#define PHIMR_TSF_BIT32_TOGGLE BIT24 -+#define PHIMR_BCNDMAINT3 BIT23 -+#define PHIMR_BCNDMAINT2 BIT22 -+#define PHIMR_BCNDMAINT1 BIT21 -+#define PHIMR_BCNDMAINT0 BIT20 -+#define PHIMR_BCNDOK3 BIT19 -+#define PHIMR_BCNDOK2 BIT18 -+#define PHIMR_BCNDOK1 BIT17 -+#define PHIMR_BCNDOK0 BIT16 -+#define PHIMR_HSISR_IND_ON BIT15 -+#define PHIMR_BCNDMAINT_E BIT14 -+#define PHIMR_ATIMEND_E BIT13 -+#define PHIMR_ATIM_CTW_END BIT12 -+#define PHIMR_HISRE_IND BIT11 /* RO. HISRE Indicator (HISRE & HIMRE is true, this bit is set to 1) */ -+#define PHIMR_C2HCMD BIT10 -+#define PHIMR_CPWM2 BIT9 -+#define PHIMR_CPWM BIT8 -+#define PHIMR_HIGHDOK BIT7 /* High Queue DMA OK Interrupt */ -+#define PHIMR_MGNTDOK BIT6 /* Management Queue DMA OK Interrupt */ -+#define PHIMR_BKDOK BIT5 /* AC_BK DMA OK Interrupt */ -+#define PHIMR_BEDOK BIT4 /* AC_BE DMA OK Interrupt */ -+#define PHIMR_VIDOK BIT3 /* AC_VI DMA OK Interrupt */ -+#define PHIMR_VODOK BIT2 /* AC_VO DMA Interrupt */ -+#define PHIMR_RDU BIT1 /* Receive Descriptor Unavailable */ -+#define PHIMR_ROK BIT0 /* Receive DMA OK Interrupt */ -+ -+/* PCIE Host Interrupt Status Extension bit */ -+#define PHIMR_BCNDMAINT7 BIT23 -+#define PHIMR_BCNDMAINT6 BIT22 -+#define PHIMR_BCNDMAINT5 BIT21 -+#define PHIMR_BCNDMAINT4 BIT20 -+#define PHIMR_BCNDOK7 BIT19 -+#define PHIMR_BCNDOK6 BIT18 -+#define PHIMR_BCNDOK5 BIT17 -+#define PHIMR_BCNDOK4 BIT16 -+/* bit12 15: RSVD */ -+#define PHIMR_TXERR BIT11 -+#define PHIMR_RXERR BIT10 -+#define PHIMR_TXFOVW BIT9 -+#define PHIMR_RXFOVW BIT8 -+/* bit2-7: RSVD */ -+#define PHIMR_OCPINT BIT1 -+/* bit0: RSVD */ -+ -+#define UHIMR_TIMEOUT2 BIT31 -+#define UHIMR_TIMEOUT1 BIT30 -+#define UHIMR_PSTIMEOUT BIT29 -+#define UHIMR_GTINT4 BIT28 -+#define UHIMR_GTINT3 BIT27 -+#define UHIMR_TXBCNERR BIT26 -+#define UHIMR_TXBCNOK BIT25 -+#define UHIMR_TSF_BIT32_TOGGLE BIT24 -+#define UHIMR_BCNDMAINT3 BIT23 -+#define UHIMR_BCNDMAINT2 BIT22 -+#define UHIMR_BCNDMAINT1 BIT21 -+#define UHIMR_BCNDMAINT0 BIT20 -+#define UHIMR_BCNDOK3 BIT19 -+#define UHIMR_BCNDOK2 BIT18 -+#define UHIMR_BCNDOK1 BIT17 -+#define UHIMR_BCNDOK0 BIT16 -+#define UHIMR_HSISR_IND BIT15 -+#define UHIMR_BCNDMAINT_E BIT14 -+/* RSVD BIT13 */ -+#define UHIMR_CTW_END BIT12 -+/* RSVD BIT11 */ -+#define UHIMR_C2HCMD BIT10 -+#define UHIMR_CPWM2 BIT9 -+#define UHIMR_CPWM BIT8 -+#define UHIMR_HIGHDOK BIT7 /* High Queue DMA OK Interrupt */ -+#define UHIMR_MGNTDOK BIT6 /* Management Queue DMA OK Interrupt */ -+#define UHIMR_BKDOK BIT5 /* AC_BK DMA OK Interrupt */ -+#define UHIMR_BEDOK BIT4 /* AC_BE DMA OK Interrupt */ -+#define UHIMR_VIDOK BIT3 /* AC_VI DMA OK Interrupt */ -+#define UHIMR_VODOK BIT2 /* AC_VO DMA Interrupt */ -+#define UHIMR_RDU BIT1 /* Receive Descriptor Unavailable */ -+#define UHIMR_ROK BIT0 /* Receive DMA OK Interrupt */ -+ -+/* USB Host Interrupt Status Extension bit */ -+#define UHIMR_BCNDMAINT7 BIT23 -+#define UHIMR_BCNDMAINT6 BIT22 -+#define UHIMR_BCNDMAINT5 BIT21 -+#define UHIMR_BCNDMAINT4 BIT20 -+#define UHIMR_BCNDOK7 BIT19 -+#define UHIMR_BCNDOK6 BIT18 -+#define UHIMR_BCNDOK5 BIT17 -+#define UHIMR_BCNDOK4 BIT16 -+/* bit14-15: RSVD */ -+#define UHIMR_ATIMEND_E BIT13 -+#define UHIMR_ATIMEND BIT12 -+#define UHIMR_TXERR BIT11 -+#define UHIMR_RXERR BIT10 -+#define UHIMR_TXFOVW BIT9 -+#define UHIMR_RXFOVW BIT8 -+/* bit2-7: RSVD */ -+#define UHIMR_OCPINT BIT1 -+/* bit0: RSVD */ -+ -+ -+#define HAL_NIC_UNPLUG_ISR 0xFFFFFFFF /* The value when the NIC is unplugged for PCI. */ -+#define HAL_NIC_UNPLUG_PCI_ISR 0xEAEAEAEA /* The value when the NIC is unplugged for PCI in PCI interrupt (page 3). */ -+ -+/* ---------------------------------------------------------------------------- -+ * 8188 IMR/ISR bits -+ * ---------------------------------------------------------------------------- */ -+#define IMR_DISABLED_88E 0x0 -+/* IMR DW0(0x0060-0063) Bit 0-31 */ -+#define IMR_TXCCK_88E BIT30 /* TXRPT interrupt when CCX bit of the packet is set */ -+#define IMR_PSTIMEOUT_88E BIT29 /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_88E BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_88E BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TBDER_88E BIT26 /* Transmit Beacon0 Error */ -+#define IMR_TBDOK_88E BIT25 /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_88E BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_88E BIT20 /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_88E BIT16 /* Beacon Queue DMA Error 0 */ -+#define IMR_HSISR_IND_ON_INT_88E BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_88E BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_88E BIT12 /* CTWidnow End or ATIM Window End */ -+#define IMR_HISR1_IND_INT_88E BIT11 /* HISR1 Indicator (HISR1 & HIMR1 is true, this bit is set to 1) */ -+#define IMR_C2HCMD_88E BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_88E BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_88E BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_88E BIT7 /* High Queue DMA OK */ -+#define IMR_MGNTDOK_88E BIT6 /* Management Queue DMA OK */ -+#define IMR_BKDOK_88E BIT5 /* AC_BK DMA OK */ -+#define IMR_BEDOK_88E BIT4 /* AC_BE DMA OK */ -+#define IMR_VIDOK_88E BIT3 /* AC_VI DMA OK */ -+#define IMR_VODOK_88E BIT2 /* AC_VO DMA OK */ -+#define IMR_RDU_88E BIT1 /* Rx Descriptor Unavailable */ -+#define IMR_ROK_88E BIT0 /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_88E BIT27 /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_88E BIT26 /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_88E BIT25 /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_88E BIT24 /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_88E BIT23 /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_88E BIT22 /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_88E BIT21 /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_88E BIT20 /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6_88E BIT19 /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5_88E BIT18 /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4_88E BIT17 /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3_88E BIT16 /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2_88E BIT15 /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1_88E BIT14 /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_ATIMEND_E_88E BIT13 /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_88E BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_88E BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_88E BIT9 /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_88E BIT8 /* Receive FIFO Overflow */ -+ -+/*=================================================================== -+===================================================================== -+Here the register defines are for 92C. When the define is as same with 92C, -+we will use the 92C's define for the consistency -+So the following defines for 92C is not entire!!!!!! -+===================================================================== -+=====================================================================*/ -+/* -+Based on Datasheet V33---090401 -+Register Summary -+Current IOREG MAP -+0x0000h ~ 0x00FFh System Configuration (256 Bytes) -+0x0100h ~ 0x01FFh MACTOP General Configuration (256 Bytes) -+0x0200h ~ 0x027Fh TXDMA Configuration (128 Bytes) -+0x0280h ~ 0x02FFh RXDMA Configuration (128 Bytes) -+0x0300h ~ 0x03FFh PCIE EMAC Reserved Region (256 Bytes) -+0x0400h ~ 0x04FFh Protocol Configuration (256 Bytes) -+0x0500h ~ 0x05FFh EDCA Configuration (256 Bytes) -+0x0600h ~ 0x07FFh WMAC Configuration (512 Bytes) -+0x2000h ~ 0x3FFFh 8051 FW Download Region (8196 Bytes) -+*/ -+/* ---------------------------------------------------------------------------- */ -+/* 8192C (TXPAUSE) transmission pause (Offset 0x522, 8 bits) */ -+/* ---------------------------------------------------------------------------- */ -+/* Note: -+* The the bits of stoping AC(VO/VI/BE/BK) queue in datasheet RTL8192S/RTL8192C are wrong, -+* the correct arragement is VO - Bit0, VI - Bit1, BE - Bit2, and BK - Bit3. -+* 8723 and 88E may be not correct either in the eralier version. Confirmed with DD Tim. -+* By Bruce, 2011-09-22. */ -+#define StopBecon BIT6 -+#define StopHigh BIT5 -+#define StopMgt BIT4 -+#define StopBK BIT3 -+#define StopBE BIT2 -+#define StopVI BIT1 -+#define StopVO BIT0 -+ -+/* ---------------------------------------------------------------------------- -+ * 8192C (RCR) Receive Configuration Register (Offset 0x608, 32 bits) -+ * ---------------------------------------------------------------------------- */ -+#define RCR_APPFCS BIT31 /* WMAC append FCS after pauload */ -+#define RCR_APP_MIC BIT30 /* MACRX will retain the MIC at the bottom of the packet. */ -+#define RCR_APP_ICV BIT29 /* MACRX will retain the ICV at the bottom of the packet. */ -+#define RCR_APP_PHYST_RXFF BIT28 /* PHY Status is appended before RX packet in RXFF */ -+#define RCR_APP_BA_SSN BIT27 /* SSN of previous TXBA is appended as after original RXDESC as the 4-th DW of RXDESC. */ -+#define RCR_VHT_DACK BIT26 /* This bit to control response type for vht single mpdu data packet. 1. ACK as response 0. BA as response */ -+#define RCR_TCPOFLD_EN BIT25 /* Enable TCP checksum offload */ -+#define RCR_ENMBID BIT24 /* Enable Multiple BssId. Only response ACK to the packets whose DID(A1) matching to the addresses in the MBSSID CAM Entries. */ -+#define RCR_LSIGEN BIT23 /* Enable LSIG TXOP Protection function. Search KEYCAM for each rx packet to check if LSIGEN bit is set. */ -+#define RCR_MFBEN BIT22 /* Enable immediate MCS Feedback function. When Rx packet with MRQ = 1'b1, then search KEYCAM to find sender's MCS Feedback function and send response. */ -+#define RCR_DISCHKPPDLLEN BIT21 /* Do not check PPDU while the PPDU length is smaller than 14 byte. */ -+#define RCR_PKTCTL_DLEN BIT20 /* While rx path dead lock occurs, reset rx path */ -+#define RCR_DISGCLK BIT19 /* Disable macrx clock gating control (no used) */ -+#define RCR_TIM_PARSER_EN BIT18 /* RX Beacon TIM Parser. */ -+#define RCR_BC_MD_EN BIT17 /* Broadcast data packet more data bit check interrupt enable.*/ -+#define RCR_UC_MD_EN BIT16 /* Unicast data packet more data bit check interrupt enable. */ -+#define RCR_RXSK_PERPKT BIT15 /* Executing key search per MPDU */ -+#define RCR_HTC_LOC_CTRL BIT14 /* MFC<--HTC = 1 MFC-->HTC = 0 */ -+#define RCR_AMF BIT13 /* Accept management type frame */ -+#define RCR_ACF BIT12 /* Accept control type frame. Control frames BA, BAR, and PS-Poll (when in AP mode) are not controlled by this bit. They are controlled by ADF. */ -+#define RCR_ADF BIT11 /* Accept data type frame. This bit also regulates BA, BAR, and PS-Poll (AP mode only). */ -+#define RCR_DISDECMYPKT BIT10 /* This bit determines whether hw need to do decryption.1: If A1 match, do decryption.0: Do decryption. */ -+#define RCR_AICV BIT9 /* Accept ICV error packet */ -+#define RCR_ACRC32 BIT8 /* Accept CRC32 error packet */ -+#define RCR_CBSSID_BCN BIT7 /* Accept BSSID match packet (Rx beacon, probe rsp) */ -+#define RCR_CBSSID_DATA BIT6 /* Accept BSSID match packet (Data) */ -+#define RCR_APWRMGT BIT5 /* Accept power management packet */ -+#define RCR_ADD3 BIT4 /* Accept address 3 match packet */ -+#define RCR_AB BIT3 /* Accept broadcast packet */ -+#define RCR_AM BIT2 /* Accept multicast packet */ -+#define RCR_APM BIT1 /* Accept physical match packet */ -+#define RCR_AAP BIT0 /* Accept all unicast packet */ -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0000h ~ 0x00FFh System Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* 2 SYS_ISO_CTRL */ -+#define ISO_MD2PP BIT(0) -+#define ISO_UA2USB BIT(1) -+#define ISO_UD2CORE BIT(2) -+#define ISO_PA2PCIE BIT(3) -+#define ISO_PD2CORE BIT(4) -+#define ISO_IP2MAC BIT(5) -+#define ISO_DIOP BIT(6) -+#define ISO_DIOE BIT(7) -+#define ISO_EB2CORE BIT(8) -+#define ISO_DIOR BIT(9) -+#define PWC_EV12V BIT(15) -+ -+ -+/* 2 SYS_FUNC_EN */ -+#define FEN_BBRSTB BIT(0) -+#define FEN_BB_GLB_RSTn BIT(1) -+#define FEN_USBA BIT(2) -+#define FEN_UPLL BIT(3) -+#define FEN_USBD BIT(4) -+#define FEN_DIO_PCIE BIT(5) -+#define FEN_PCIEA BIT(6) -+#define FEN_PPLL BIT(7) -+#define FEN_PCIED BIT(8) -+#define FEN_DIOE BIT(9) -+#define FEN_CPUEN BIT(10) -+#define FEN_DCORE BIT(11) -+#define FEN_ELDR BIT(12) -+#define FEN_EN_25_1 BIT(13) -+#define FEN_HWPDN BIT(14) -+#define FEN_MREGEN BIT(15) -+ -+/* 2 APS_FSMCO */ -+#define PFM_LDALL BIT(0) -+#define PFM_ALDN BIT(1) -+#define PFM_LDKP BIT(2) -+#define PFM_WOWL BIT(3) -+#define EnPDN BIT(4) -+#define PDN_PL BIT(5) -+#define APFM_ONMAC BIT(8) -+#define APFM_OFF BIT(9) -+#define APFM_RSM BIT(10) -+#define AFSM_HSUS BIT(11) -+#define AFSM_PCIE BIT(12) -+#define APDM_MAC BIT(13) -+#define APDM_HOST BIT(14) -+#define APDM_HPDN BIT(15) -+#define RDY_MACON BIT(16) -+#define SUS_HOST BIT(17) -+#define ROP_ALD BIT(20) -+#define ROP_PWR BIT(21) -+#define ROP_SPS BIT(22) -+#define SOP_MRST BIT(25) -+#define SOP_FUSE BIT(26) -+#define SOP_ABG BIT(27) -+#define SOP_AMB BIT(28) -+#define SOP_RCK BIT(29) -+#define SOP_A8M BIT(30) -+#define XOP_BTCK BIT(31) -+ -+/* 2 SYS_CLKR */ -+#define ANAD16V_EN BIT(0) -+#define ANA8M BIT(1) -+#define MACSLP BIT(4) -+#define LOADER_CLK_EN BIT(5) -+ -+ -+/* 2 9346CR /REG_SYS_EEPROM_CTRL */ -+#define BOOT_FROM_EEPROM BIT(4) -+#define EEPROMSEL BIT(4) -+#define EEPROM_EN BIT(5) -+ -+ -+/* 2 RF_CTRL */ -+#define RF_EN BIT(0) -+#define RF_RSTB BIT(1) -+#define RF_SDMRSTB BIT(2) -+ -+ -+/* 2 LDOV12D_CTRL */ -+#define LDV12_EN BIT(0) -+#define LDV12_SDBY BIT(1) -+#define LPLDO_HSM BIT(2) -+#define LPLDO_LSM_DIS BIT(3) -+#define _LDV12_VADJ(x) (((x) & 0xF) << 4) -+ -+ -+ -+/* 2 EFUSE_TEST (For RTL8723 partially) */ -+#define EF_TRPT BIT(7) -+#define EF_CELL_SEL (BIT(8) | BIT(9)) /* 00: Wifi Efuse, 01: BT Efuse0, 10: BT Efuse1, 11: BT Efuse2 */ -+#define LDOE25_EN BIT(31) -+#define EFUSE_SEL(x) (((x) & 0x3) << 8) -+#define EFUSE_SEL_MASK 0x300 -+#define EFUSE_WIFI_SEL_0 0x0 -+#define EFUSE_BT_SEL_0 0x1 -+#define EFUSE_BT_SEL_1 0x2 -+#define EFUSE_BT_SEL_2 0x3 -+ -+ -+/* 2 8051FWDL -+ * 2 MCUFWDL */ -+#define MCUFWDL_EN BIT(0) -+#define MCUFWDL_RDY BIT(1) -+#define FWDL_ChkSum_rpt BIT(2) -+#define MACINI_RDY BIT(3) -+#define BBINI_RDY BIT(4) -+#define RFINI_RDY BIT(5) -+#define WINTINI_RDY BIT(6) -+#define RAM_DL_SEL BIT(7) -+#define CPU_DL_READY BIT(15) /* add flag by gw for fw download ready 20130826 */ -+#define ROM_DLEN BIT(19) -+#define CPRST BIT(23) -+ -+ -+/* 2 REG_SYS_CFG */ -+#define XCLK_VLD BIT(0) -+#define ACLK_VLD BIT(1) -+#define UCLK_VLD BIT(2) -+#define PCLK_VLD BIT(3) -+#define PCIRSTB BIT(4) -+#define V15_VLD BIT(5) -+#define SW_OFFLOAD_EN BIT(7) -+#define SIC_IDLE BIT(8) -+#define BD_MAC2 BIT(9) -+#define BD_MAC1 BIT(10) -+#define IC_MACPHY_MODE BIT(11) -+#define CHIP_VER (BIT(12) | BIT(13) | BIT(14) | BIT(15)) -+#define BT_FUNC BIT(16) -+#define VENDOR_ID BIT(19) -+#define EXT_VENDOR_ID (BIT(18) | BIT(19)) /* Currently only for RTL8723B */ -+#define PAD_HWPD_IDN BIT(22) -+#define TRP_VAUX_EN BIT(23) /* RTL ID */ -+#define TRP_BT_EN BIT(24) -+#define BD_PKG_SEL BIT(25) -+#define BD_HCI_SEL BIT(26) -+#define TYPE_ID BIT(27) -+#define RF_TYPE_ID BIT(27) -+ -+#define RTL_ID BIT(23) /* TestChip ID, 1:Test(RLE); 0:MP(RL) */ -+#define SPS_SEL BIT(24) /* 1:LDO regulator mode; 0:Switching regulator mode */ -+ -+ -+#define CHIP_VER_RTL_MASK 0xF000 /* Bit 12 ~ 15 */ -+#define CHIP_VER_RTL_SHIFT 12 -+#define EXT_VENDOR_ID_SHIFT 18 -+ -+/* 2 REG_GPIO_OUTSTS (For RTL8723 only) */ -+#define EFS_HCI_SEL (BIT(0) | BIT(1)) -+#define PAD_HCI_SEL (BIT(2) | BIT(3)) -+#define HCI_SEL (BIT(4) | BIT(5)) -+#define PKG_SEL_HCI BIT(6) -+#define FEN_GPS BIT(7) -+#define FEN_BT BIT(8) -+#define FEN_WL BIT(9) -+#define FEN_PCI BIT(10) -+#define FEN_USB BIT(11) -+#define BTRF_HWPDN_N BIT(12) -+#define WLRF_HWPDN_N BIT(13) -+#define PDN_BT_N BIT(14) -+#define PDN_GPS_N BIT(15) -+#define BT_CTL_HWPDN BIT(16) -+#define GPS_CTL_HWPDN BIT(17) -+#define PPHY_SUSB BIT(20) -+#define UPHY_SUSB BIT(21) -+#define PCI_SUSEN BIT(22) -+#define USB_SUSEN BIT(23) -+#define RF_RL_ID (BIT(31) | BIT(30) | BIT(29) | BIT(28)) -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* 2 Function Enable Registers -+ * 2 CR */ -+#define HCI_TXDMA_EN BIT(0) -+#define HCI_RXDMA_EN BIT(1) -+#define TXDMA_EN BIT(2) -+#define RXDMA_EN BIT(3) -+#define PROTOCOL_EN BIT(4) -+#define SCHEDULE_EN BIT(5) -+#define MACTXEN BIT(6) -+#define MACRXEN BIT(7) -+#define ENSWBCN BIT(8) -+#define ENSEC BIT(9) -+#define CALTMR_EN BIT(10) /* 32k CAL TMR enable */ -+ -+/* Network type */ -+#define _NETTYPE(x) (((x) & 0x3) << 16) -+#define MASK_NETTYPE 0x30000 -+#define NT_NO_LINK 0x0 -+#define NT_LINK_AD_HOC 0x1 -+#define NT_LINK_AP 0x2 -+#define NT_AS_AP 0x3 -+ -+/* 2 PBP - Page Size Register */ -+#define GET_RX_PAGE_SIZE(value) ((value) & 0xF) -+#define GET_TX_PAGE_SIZE(value) (((value) & 0xF0) >> 4) -+#define _PSRX_MASK 0xF -+#define _PSTX_MASK 0xF0 -+#define _PSRX(x) (x) -+#define _PSTX(x) ((x) << 4) -+ -+#define PBP_64 0x0 -+#define PBP_128 0x1 -+#define PBP_256 0x2 -+#define PBP_512 0x3 -+#define PBP_1024 0x4 -+ -+ -+/* 2 TX/RXDMA */ -+#define RXDMA_ARBBW_EN BIT(0) -+#define RXSHFT_EN BIT(1) -+#define RXDMA_AGG_EN BIT(2) -+#define QS_VO_QUEUE BIT(8) -+#define QS_VI_QUEUE BIT(9) -+#define QS_BE_QUEUE BIT(10) -+#define QS_BK_QUEUE BIT(11) -+#define QS_MANAGER_QUEUE BIT(12) -+#define QS_HIGH_QUEUE BIT(13) -+ -+#define HQSEL_VOQ BIT(0) -+#define HQSEL_VIQ BIT(1) -+#define HQSEL_BEQ BIT(2) -+#define HQSEL_BKQ BIT(3) -+#define HQSEL_MGTQ BIT(4) -+#define HQSEL_HIQ BIT(5) -+ -+/* For normal driver, 0x10C */ -+#define _TXDMA_CMQ_MAP(x) (((x) & 0x3) << 16) -+#define _TXDMA_HIQ_MAP(x) (((x) & 0x3) << 14) -+#define _TXDMA_MGQ_MAP(x) (((x) & 0x3) << 12) -+#define _TXDMA_BKQ_MAP(x) (((x) & 0x3) << 10) -+#define _TXDMA_BEQ_MAP(x) (((x) & 0x3) << 8) -+#define _TXDMA_VIQ_MAP(x) (((x) & 0x3) << 6) -+#define _TXDMA_VOQ_MAP(x) (((x) & 0x3) << 4) -+ -+#define QUEUE_EXTRA 0 -+#define QUEUE_LOW 1 -+#define QUEUE_NORMAL 2 -+#define QUEUE_HIGH 3 -+ -+ -+/* 2 TRXFF_BNDY */ -+ -+ -+/* 2 LLT_INIT */ -+#define _LLT_NO_ACTIVE 0x0 -+#define _LLT_WRITE_ACCESS 0x1 -+#define _LLT_READ_ACCESS 0x2 -+ -+#define _LLT_INIT_DATA(x) ((x) & 0xFF) -+#define _LLT_INIT_ADDR(x) (((x) & 0xFF) << 8) -+#define _LLT_OP(x) (((x) & 0x3) << 30) -+#define _LLT_OP_VALUE(x) (((x) >> 30) & 0x3) -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+/* 2 RQPN */ -+#define _HPQ(x) ((x) & 0xFF) -+#define _LPQ(x) (((x) & 0xFF) << 8) -+#define _PUBQ(x) (((x) & 0xFF) << 16) -+#define _NPQ(x) ((x) & 0xFF) /* NOTE: in RQPN_NPQ register */ -+#define _EPQ(x) (((x) & 0xFF) << 16) /* NOTE: in RQPN_EPQ register */ -+ -+ -+#define HPQ_PUBLIC_DIS BIT(24) -+#define LPQ_PUBLIC_DIS BIT(25) -+#define LD_RQPN BIT(31) -+ -+ -+/* 2 TDECTL */ -+#define BLK_DESC_NUM_SHIFT 4 -+#define BLK_DESC_NUM_MASK 0xF -+ -+ -+/* 2 TXDMA_OFFSET_CHK */ -+#define DROP_DATA_EN BIT(9) -+ -+/* 2 AUTO_LLT */ -+#define BIT_SHIFT_TXPKTNUM 24 -+#define BIT_MASK_TXPKTNUM 0xff -+#define BIT_TXPKTNUM(x) (((x) & BIT_MASK_TXPKTNUM) << BIT_SHIFT_TXPKTNUM) -+ -+#define BIT_TDE_DBG_SEL BIT(23) -+#define BIT_AUTO_INIT_LLT BIT(16) -+ -+#define BIT_SHIFT_Tx_OQT_free_space 8 -+#define BIT_MASK_Tx_OQT_free_space 0xff -+#define BIT_Tx_OQT_free_space(x) (((x) & BIT_MASK_Tx_OQT_free_space) << BIT_SHIFT_Tx_OQT_free_space) -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0280h ~ 0x028Bh RX DMA Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* 2 REG_RXDMA_CONTROL, 0x0286h -+ * Write only. When this bit is set, RXDMA will decrease RX PKT counter by one. Before -+ * this bit is polled, FW shall update RXFF_RD_PTR first. This register is write pulse and auto clear. -+ * #define RXPKT_RELEASE_POLL BIT(0) -+ * Read only. When RXMA finishes on-going DMA operation, RXMDA will report idle state in -+ * this bit. FW can start releasing packets after RXDMA entering idle mode. -+ * #define RXDMA_IDLE BIT(1) -+ * When this bit is set, RXDMA will enter this mode after on-going RXDMA packet to host -+ * completed, and stop DMA packet to host. RXDMA will then report Default: 0; -+ * #define RW_RELEASE_EN BIT(2) */ -+ -+/* 2 REG_RXPKT_NUM, 0x0284 */ -+#define RXPKT_RELEASE_POLL BIT(16) -+#define RXDMA_IDLE BIT(17) -+#define RW_RELEASE_EN BIT(18) -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * -+ * ----------------------------------------------------- */ -+/* 2 FWHW_TXQ_CTRL */ -+#define EN_AMPDU_RTY_NEW BIT(7) -+ -+ -+/* 2 SPEC SIFS */ -+#define _SPEC_SIFS_CCK(x) ((x) & 0xFF) -+#define _SPEC_SIFS_OFDM(x) (((x) & 0xFF) << 8) -+ -+/* 2 RL */ -+#define RETRY_LIMIT_SHORT_SHIFT 8 -+#define RETRY_LIMIT_LONG_SHIFT 0 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* 2 EDCA setting */ -+#define AC_PARAM_TXOP_LIMIT_OFFSET 16 -+#define AC_PARAM_ECW_MAX_OFFSET 12 -+#define AC_PARAM_ECW_MIN_OFFSET 8 -+#define AC_PARAM_AIFS_OFFSET 0 -+ -+ -+#define _LRL(x) ((x) & 0x3F) -+#define _SRL(x) (((x) & 0x3F) << 8) -+ -+ -+/* 2 BCN_CTRL */ -+#define EN_TXBCN_RPT BIT(2) -+#define EN_BCN_FUNCTION BIT(3) -+#define STOP_BCNQ BIT(6) -+#define DIS_RX_BSSID_FIT BIT(6) -+ -+#define DIS_ATIM BIT(0) -+#define DIS_BCNQ_SUB BIT(1) -+#define DIS_TSF_UDT BIT(4) -+ -+/* The same function but different bit field. */ -+#define DIS_TSF_UDT0_NORMAL_CHIP BIT(4) -+#define DIS_TSF_UDT0_TEST_CHIP BIT(5) -+ -+ -+/* 2 ACMHWCTRL */ -+#define AcmHw_HwEn BIT(0) -+#define AcmHw_BeqEn BIT(1) -+#define AcmHw_ViqEn BIT(2) -+#define AcmHw_VoqEn BIT(3) -+#define AcmHw_BeqStatus BIT(4) -+#define AcmHw_ViqStatus BIT(5) -+#define AcmHw_VoqStatus BIT(6) -+ -+/* 2 */ /* REG_DUAL_TSF_RST (0x553) */ -+#define DUAL_TSF_RST_P2P BIT(4) -+ -+/* 2 */ /* REG_NOA_DESC_SEL (0x5CF) */ -+#define NOA_DESC_SEL_0 0 -+#define NOA_DESC_SEL_1 BIT(4) -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* 2 APSD_CTRL */ -+#define APSDOFF BIT(6) -+ -+/* 2 TCR */ -+#define TSFRST BIT(0) -+#define DIS_GCLK BIT(1) -+#define PAD_SEL BIT(2) -+#define PWR_ST BIT(6) -+#define PWRBIT_OW_EN BIT(7) -+#define ACRC BIT(8) -+#define CFENDFORM BIT(9) -+#define ICV BIT(10) -+ -+ -+/* 2 RCR */ -+#define AAP BIT(0) -+#define APM BIT(1) -+#define AM BIT(2) -+#define AB BIT(3) -+#define ADD3 BIT(4) -+#define APWRMGT BIT(5) -+#define CBSSID BIT(6) -+#define CBSSID_DATA BIT(6) -+#define CBSSID_BCN BIT(7) -+#define ACRC32 BIT(8) -+#define AICV BIT(9) -+#define ADF BIT(11) -+#define ACF BIT(12) -+#define AMF BIT(13) -+#define HTC_LOC_CTRL BIT(14) -+#define UC_DATA_EN BIT(16) -+#define BM_DATA_EN BIT(17) -+#define MFBEN BIT(22) -+#define LSIGEN BIT(23) -+#define EnMBID BIT(24) -+#define FORCEACK BIT(26) -+#define APP_BASSN BIT(27) -+#define APP_PHYSTS BIT(28) -+#define APP_ICV BIT(29) -+#define APP_MIC BIT(30) -+#define APP_FCS BIT(31) -+ -+ -+/* 2 SECCFG */ -+#define SCR_TxUseDK BIT(0) /* Force Tx Use Default Key */ -+#define SCR_RxUseDK BIT(1) /* Force Rx Use Default Key */ -+#define SCR_TxEncEnable BIT(2) /* Enable Tx Encryption */ -+#define SCR_RxDecEnable BIT(3) /* Enable Rx Decryption */ -+#define SCR_SKByA2 BIT(4) /* Search kEY BY A2 */ -+#define SCR_NoSKMC BIT(5) /* No Key Search Multicast */ -+#define SCR_TXBCUSEDK BIT(6) /* Force Tx Broadcast packets Use Default Key */ -+#define SCR_RXBCUSEDK BIT(7) /* Force Rx Broadcast packets Use Default Key */ -+#define SCR_CHK_KEYID BIT(8) -+#define SCR_CHK_BMC BIT(9) /* add option to support a2+keyid+bcm */ -+ -+/*REG_MBIDCAMCFG (Offset 0x0628/0x62C)*/ -+#define BIT_MBIDCAM_POLL BIT(31) -+#define BIT_MBIDCAM_WT_EN BIT(30) -+ -+#define MBIDCAM_ADDR_MASK 0x1F -+#define MBIDCAM_ADDR_SHIFT 24 -+ -+#define BIT_MBIDCAM_VALID BIT(23) -+#define BIT_LSIC_TXOP_EN BIT(17) -+#define BIT_CTS_EN BIT(16) -+ -+/* ----------------------------------------------------- -+ * -+ * SDIO Bus Specification -+ * -+ * ----------------------------------------------------- */ -+ -+/* I/O bus domain address mapping */ -+#define SDIO_LOCAL_BASE 0x10250000 -+#define WLAN_IOREG_BASE 0x10260000 -+#define FIRMWARE_FIFO_BASE 0x10270000 -+#define TX_HIQ_BASE 0x10310000 -+#define TX_MIQ_BASE 0x10320000 -+#define TX_LOQ_BASE 0x10330000 -+#define TX_EPQ_BASE 0x10350000 -+#define RX_RX0FF_BASE 0x10340000 -+ -+/* SDIO host local register space mapping. */ -+#define SDIO_LOCAL_MSK 0x0FFF -+#define WLAN_IOREG_MSK 0x7FFF -+#define WLAN_FIFO_MSK 0x1FFF /* Aggregation Length[12:0] */ -+#define WLAN_RX0FF_MSK 0x0003 -+ -+#define SDIO_WITHOUT_REF_DEVICE_ID 0 /* Without reference to the SDIO Device ID */ -+#define SDIO_LOCAL_DEVICE_ID 0 /* 0b[16], 000b[15:13] */ -+#define WLAN_TX_HIQ_DEVICE_ID 4 /* 0b[16], 100b[15:13] */ -+#define WLAN_TX_MIQ_DEVICE_ID 5 /* 0b[16], 101b[15:13] */ -+#define WLAN_TX_LOQ_DEVICE_ID 6 /* 0b[16], 110b[15:13] */ -+#define WLAN_TX_EXQ_DEVICE_ID 3 /* 0b[16], 011b[15:13] */ -+#define WLAN_RX0FF_DEVICE_ID 7 /* 0b[16], 111b[15:13] */ -+#define WLAN_IOREG_DEVICE_ID 8 /* 1b[16] */ -+ -+/* SDIO Tx Free Page Index */ -+#define HI_QUEUE_IDX 0 -+#define MID_QUEUE_IDX 1 -+#define LOW_QUEUE_IDX 2 -+#define PUBLIC_QUEUE_IDX 3 -+ -+#define SDIO_MAX_TX_QUEUE 3 /* HIQ, MIQ and LOQ */ -+#define SDIO_MAX_RX_QUEUE 1 -+ -+#define SDIO_REG_TX_CTRL 0x0000 /* SDIO Tx Control */ -+#define SDIO_REG_HIMR 0x0014 /* SDIO Host Interrupt Mask */ -+#define SDIO_REG_HISR 0x0018 /* SDIO Host Interrupt Service Routine */ -+#define SDIO_REG_HCPWM 0x0019 /* HCI Current Power Mode */ -+#define SDIO_REG_RX0_REQ_LEN 0x001C /* RXDMA Request Length */ -+#define SDIO_REG_OQT_FREE_PG 0x001E /* OQT Free Page */ -+#define SDIO_REG_FREE_TXPG 0x0020 /* Free Tx Buffer Page */ -+#define SDIO_REG_HCPWM1 0x0024 /* HCI Current Power Mode 1 */ -+#define SDIO_REG_HCPWM2 0x0026 /* HCI Current Power Mode 2 */ -+#define SDIO_REG_FREE_TXPG_SEQ 0x0028 /* Free Tx Page Sequence */ -+#define SDIO_REG_HTSFR_INFO 0x0030 /* HTSF Informaion */ -+#define SDIO_REG_HRPWM1 0x0080 /* HCI Request Power Mode 1 */ -+#define SDIO_REG_HRPWM2 0x0082 /* HCI Request Power Mode 2 */ -+#define SDIO_REG_HPS_CLKR 0x0084 /* HCI Power Save Clock */ -+#define SDIO_REG_HSUS_CTRL 0x0086 /* SDIO HCI Suspend Control */ -+#define SDIO_REG_HIMR_ON 0x0090 /* SDIO Host Extension Interrupt Mask Always */ -+#define SDIO_REG_HISR_ON 0x0091 /* SDIO Host Extension Interrupt Status Always */ -+ -+#define SDIO_HIMR_DISABLED 0 -+ -+/* RTL8723/RTL8188E SDIO Host Interrupt Mask Register */ -+#define SDIO_HIMR_RX_REQUEST_MSK BIT0 -+#define SDIO_HIMR_AVAL_MSK BIT1 -+#define SDIO_HIMR_TXERR_MSK BIT2 -+#define SDIO_HIMR_RXERR_MSK BIT3 -+#define SDIO_HIMR_TXFOVW_MSK BIT4 -+#define SDIO_HIMR_RXFOVW_MSK BIT5 -+#define SDIO_HIMR_TXBCNOK_MSK BIT6 -+#define SDIO_HIMR_TXBCNERR_MSK BIT7 -+#define SDIO_HIMR_BCNERLY_INT_MSK BIT16 -+#define SDIO_HIMR_C2HCMD_MSK BIT17 -+#define SDIO_HIMR_CPWM1_MSK BIT18 -+#define SDIO_HIMR_CPWM2_MSK BIT19 -+#define SDIO_HIMR_HSISR_IND_MSK BIT20 -+#define SDIO_HIMR_GTINT3_IND_MSK BIT21 -+#define SDIO_HIMR_GTINT4_IND_MSK BIT22 -+#define SDIO_HIMR_PSTIMEOUT_MSK BIT23 -+#define SDIO_HIMR_OCPINT_MSK BIT24 -+#define SDIO_HIMR_ATIMEND_MSK BIT25 -+#define SDIO_HIMR_ATIMEND_E_MSK BIT26 -+#define SDIO_HIMR_CTWEND_MSK BIT27 -+ -+/* RTL8188E SDIO Specific */ -+#define SDIO_HIMR_MCU_ERR_MSK BIT28 -+#define SDIO_HIMR_TSF_BIT32_TOGGLE_MSK BIT29 -+ -+/* SDIO Host Interrupt Service Routine */ -+#define SDIO_HISR_RX_REQUEST BIT0 -+#define SDIO_HISR_AVAL BIT1 -+#define SDIO_HISR_TXERR BIT2 -+#define SDIO_HISR_RXERR BIT3 -+#define SDIO_HISR_TXFOVW BIT4 -+#define SDIO_HISR_RXFOVW BIT5 -+#define SDIO_HISR_TXBCNOK BIT6 -+#define SDIO_HISR_TXBCNERR BIT7 -+#define SDIO_HISR_BCNERLY_INT BIT16 -+#define SDIO_HISR_C2HCMD BIT17 -+#define SDIO_HISR_CPWM1 BIT18 -+#define SDIO_HISR_CPWM2 BIT19 -+#define SDIO_HISR_HSISR_IND BIT20 -+#define SDIO_HISR_GTINT3_IND BIT21 -+#define SDIO_HISR_GTINT4_IND BIT22 -+#define SDIO_HISR_PSTIMEOUT BIT23 -+#define SDIO_HISR_OCPINT BIT24 -+#define SDIO_HISR_ATIMEND BIT25 -+#define SDIO_HISR_ATIMEND_E BIT26 -+#define SDIO_HISR_CTWEND BIT27 -+ -+/* RTL8188E SDIO Specific */ -+#define SDIO_HISR_MCU_ERR BIT28 -+#define SDIO_HISR_TSF_BIT32_TOGGLE BIT29 -+ -+#define MASK_SDIO_HISR_CLEAR (SDIO_HISR_TXERR |\ -+ SDIO_HISR_RXERR |\ -+ SDIO_HISR_TXFOVW |\ -+ SDIO_HISR_RXFOVW |\ -+ SDIO_HISR_TXBCNOK |\ -+ SDIO_HISR_TXBCNERR |\ -+ SDIO_HISR_C2HCMD |\ -+ SDIO_HISR_CPWM1 |\ -+ SDIO_HISR_CPWM2 |\ -+ SDIO_HISR_HSISR_IND |\ -+ SDIO_HISR_GTINT3_IND |\ -+ SDIO_HISR_GTINT4_IND |\ -+ SDIO_HISR_PSTIMEOUT |\ -+ SDIO_HISR_OCPINT) -+ -+/* SDIO HCI Suspend Control Register */ -+#define HCI_RESUME_PWR_RDY BIT1 -+#define HCI_SUS_CTRL BIT0 -+ -+/* SDIO Tx FIFO related */ -+#define SDIO_TX_FREE_PG_QUEUE 4 /* The number of Tx FIFO free page */ -+#define SDIO_TX_FIFO_PAGE_SZ 128 -+ -+#ifdef CONFIG_SDIO_HCI -+ #define MAX_TX_AGG_PACKET_NUMBER 0x8 -+#else -+ #define MAX_TX_AGG_PACKET_NUMBER 0xFF -+ #define MAX_TX_AGG_PACKET_NUMBER_8812 64 -+#endif -+ -+/* ----------------------------------------------------- -+ * -+ * 0xFE00h ~ 0xFE55h USB Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* 2 USB Information (0xFE17) */ -+#define USB_IS_HIGH_SPEED 0 -+#define USB_IS_FULL_SPEED 1 -+#define USB_SPEED_MASK BIT(5) -+ -+#define USB_NORMAL_SIE_EP_MASK 0xF -+#define USB_NORMAL_SIE_EP_SHIFT 4 -+ -+/* 2 Special Option */ -+#define USB_AGG_EN BIT(3) -+ -+/* 0; Use interrupt endpoint to upload interrupt pkt -+ * 1; Use bulk endpoint to upload interrupt pkt, */ -+#define INT_BULK_SEL BIT(4) -+ -+/* 2REG_C2HEVT_CLEAR */ -+#define C2H_EVT_HOST_CLOSE 0x00 /* Set by driver and notify FW that the driver has read the C2H command message */ -+#define C2H_EVT_FW_CLOSE 0xFF /* Set by FW indicating that FW had set the C2H command message and it's not yet read by driver. */ -+ -+ -+/* 2REG_MULTI_FUNC_CTRL(For RTL8723 Only) */ -+#define WL_HWPDN_EN BIT0 /* Enable GPIO[9] as WiFi HW PDn source */ -+#define WL_HWPDN_SL BIT1 /* WiFi HW PDn polarity control */ -+#define WL_FUNC_EN BIT2 /* WiFi function enable */ -+#define WL_HWROF_EN BIT3 /* Enable GPIO[9] as WiFi RF HW PDn source */ -+#define BT_HWPDN_EN BIT16 /* Enable GPIO[11] as BT HW PDn source */ -+#define BT_HWPDN_SL BIT17 /* BT HW PDn polarity control */ -+#define BT_FUNC_EN BIT18 /* BT function enable */ -+#define BT_HWROF_EN BIT19 /* Enable GPIO[11] as BT/GPS RF HW PDn source */ -+#define GPS_HWPDN_EN BIT20 /* Enable GPIO[10] as GPS HW PDn source */ -+#define GPS_HWPDN_SL BIT21 /* GPS HW PDn polarity control */ -+#define GPS_FUNC_EN BIT22 /* GPS function enable */ -+ -+/* 3 REG_LIFECTRL_CTRL */ -+#define HAL92C_EN_PKT_LIFE_TIME_BK BIT3 -+#define HAL92C_EN_PKT_LIFE_TIME_BE BIT2 -+#define HAL92C_EN_PKT_LIFE_TIME_VI BIT1 -+#define HAL92C_EN_PKT_LIFE_TIME_VO BIT0 -+ -+#define HAL92C_MSDU_LIFE_TIME_UNIT 128 /* in us, said by Tim. */ -+ -+/* 2 8192D PartNo. */ -+#define PARTNO_92D_NIC (BIT7 | BIT6) -+#define PARTNO_92D_NIC_REMARK (BIT5 | BIT4) -+#define PARTNO_SINGLE_BAND_VS BIT3 -+#define PARTNO_SINGLE_BAND_VS_REMARK BIT1 -+#define PARTNO_CONCURRENT_BAND_VC (BIT3 | BIT2) -+#define PARTNO_CONCURRENT_BAND_VC_REMARK (BIT1 | BIT0) -+ -+/* ******************************************************** -+ * General definitions -+ * ******************************************************** */ -+ -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8188E(__Adapter) (IS_VENDOR_8188E_I_CUT_SERIES(__Adapter) ? 255 : 175) -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8812 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8723B 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8192C 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8703B 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_DUAL_MAC 127 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8188F 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8723D 255 -+ -+#define POLLING_LLT_THRESHOLD 20 -+#if defined(CONFIG_RTL8723B) && defined(CONFIG_PCI_HCI) -+ #define POLLING_READY_TIMEOUT_COUNT 6000 -+#else -+ #define POLLING_READY_TIMEOUT_COUNT 1000 -+#endif -+ -+ -+/* GPIO BIT */ -+#define HAL_8812A_HW_GPIO_WPS_BIT BIT2 -+#define HAL_8192C_HW_GPIO_WPS_BIT BIT2 -+#define HAL_8192EU_HW_GPIO_WPS_BIT BIT7 -+#define HAL_8188E_HW_GPIO_WPS_BIT BIT7 -+ -+#endif /* __HAL_COMMON_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_data.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_data.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_data.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_data.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,771 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_DATA_H__ -+#define __HAL_DATA_H__ -+ -+#if 1/* def CONFIG_SINGLE_IMG */ -+ -+#include "../hal/phydm/phydm_precomp.h" -+#ifdef CONFIG_BT_COEXIST -+ #include -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+ #include -+#endif -+#ifdef CONFIG_GSPI_HCI -+ #include -+#endif -+/* -+ * For RTL8723 WiFi/BT/GPS multi-function configuration. 2010.10.06. -+ * */ -+typedef enum _RT_MULTI_FUNC { -+ RT_MULTI_FUNC_NONE = 0x00, -+ RT_MULTI_FUNC_WIFI = 0x01, -+ RT_MULTI_FUNC_BT = 0x02, -+ RT_MULTI_FUNC_GPS = 0x04, -+} RT_MULTI_FUNC, *PRT_MULTI_FUNC; -+/* -+ * For RTL8723 WiFi PDn/GPIO polarity control configuration. 2010.10.08. -+ * */ -+typedef enum _RT_POLARITY_CTL { -+ RT_POLARITY_LOW_ACT = 0, -+ RT_POLARITY_HIGH_ACT = 1, -+} RT_POLARITY_CTL, *PRT_POLARITY_CTL; -+ -+/* For RTL8723 regulator mode. by tynli. 2011.01.14. */ -+typedef enum _RT_REGULATOR_MODE { -+ RT_SWITCHING_REGULATOR = 0, -+ RT_LDO_REGULATOR = 1, -+} RT_REGULATOR_MODE, *PRT_REGULATOR_MODE; -+ -+/* -+ * Interface type. -+ * */ -+typedef enum _INTERFACE_SELECT_PCIE { -+ INTF_SEL0_SOLO_MINICARD = 0, /* WiFi solo-mCard */ -+ INTF_SEL1_BT_COMBO_MINICARD = 1, /* WiFi+BT combo-mCard */ -+ INTF_SEL2_PCIe = 2, /* PCIe Card */ -+} INTERFACE_SELECT_PCIE, *PINTERFACE_SELECT_PCIE; -+ -+ -+typedef enum _INTERFACE_SELECT_USB { -+ INTF_SEL0_USB = 0, /* USB */ -+ INTF_SEL1_USB_High_Power = 1, /* USB with high power PA */ -+ INTF_SEL2_MINICARD = 2, /* Minicard */ -+ INTF_SEL3_USB_Solo = 3, /* USB solo-Slim module */ -+ INTF_SEL4_USB_Combo = 4, /* USB Combo-Slim module */ -+ INTF_SEL5_USB_Combo_MF = 5, /* USB WiFi+BT Multi-Function Combo, i.e., Proprietary layout(AS-VAU) which is the same as SDIO card */ -+} INTERFACE_SELECT_USB, *PINTERFACE_SELECT_USB; -+ -+typedef enum _RT_AMPDU_BRUST_MODE { -+ RT_AMPDU_BRUST_NONE = 0, -+ RT_AMPDU_BRUST_92D = 1, -+ RT_AMPDU_BRUST_88E = 2, -+ RT_AMPDU_BRUST_8812_4 = 3, -+ RT_AMPDU_BRUST_8812_8 = 4, -+ RT_AMPDU_BRUST_8812_12 = 5, -+ RT_AMPDU_BRUST_8812_15 = 6, -+ RT_AMPDU_BRUST_8723B = 7, -+} RT_AMPDU_BRUST, *PRT_AMPDU_BRUST_MODE; -+ -+/* Tx Power Limit Table Size */ -+#define MAX_REGULATION_NUM 4 -+#define MAX_RF_PATH_NUM_IN_POWER_LIMIT_TABLE 4 -+#define MAX_2_4G_BANDWIDTH_NUM 2 -+#define MAX_RATE_SECTION_NUM 10 -+#define MAX_5G_BANDWIDTH_NUM 4 -+ -+#define MAX_BASE_NUM_IN_PHY_REG_PG_2_4G 10 /* CCK:1, OFDM:1, HT:4, VHT:4 */ -+#define MAX_BASE_NUM_IN_PHY_REG_PG_5G 9 /* OFDM:1, HT:4, VHT:4 */ -+ -+ -+/* ###### duplicate code,will move to ODM ######### */ -+/* #define IQK_MAC_REG_NUM 4 */ -+/* #define IQK_ADDA_REG_NUM 16 */ -+ -+/* #define IQK_BB_REG_NUM 10 */ -+#define IQK_BB_REG_NUM_92C 9 -+#define IQK_BB_REG_NUM_92D 10 -+#define IQK_BB_REG_NUM_test 6 -+ -+#define IQK_Matrix_Settings_NUM_92D (1+24+21) -+ -+/* #define HP_THERMAL_NUM 8 */ -+/* ###### duplicate code,will move to ODM ######### */ -+ -+#ifdef RTW_RX_AGGREGATION -+typedef enum _RX_AGG_MODE { -+ RX_AGG_DISABLE, -+ RX_AGG_DMA, -+ RX_AGG_USB, -+ RX_AGG_MIX -+} RX_AGG_MODE; -+ -+/* #define MAX_RX_DMA_BUFFER_SIZE 10240 */ /* 10K for 8192C RX DMA buffer */ -+ -+#endif /* RTW_RX_AGGREGATION */ -+ -+/* E-Fuse */ -+#ifdef CONFIG_RTL8188E -+ #define EFUSE_MAP_SIZE 512 -+#endif -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) -+ #define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8192E -+ #define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8723B -+ #define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8814A -+ #define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8703B -+ #define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8723D -+ #define EFUSE_MAP_SIZE 512 -+#endif -+#ifdef CONFIG_RTL8188F -+ #define EFUSE_MAP_SIZE 512 -+#endif -+ -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ #define EFUSE_MAX_SIZE 1024 -+#elif defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8703B) -+ #define EFUSE_MAX_SIZE 256 -+#else -+ #define EFUSE_MAX_SIZE 512 -+#endif -+/* end of E-Fuse */ -+ -+#define Mac_OFDM_OK 0x00000000 -+#define Mac_OFDM_Fail 0x10000000 -+#define Mac_OFDM_FasleAlarm 0x20000000 -+#define Mac_CCK_OK 0x30000000 -+#define Mac_CCK_Fail 0x40000000 -+#define Mac_CCK_FasleAlarm 0x50000000 -+#define Mac_HT_OK 0x60000000 -+#define Mac_HT_Fail 0x70000000 -+#define Mac_HT_FasleAlarm 0x90000000 -+#define Mac_DropPacket 0xA0000000 -+ -+#ifdef CONFIG_RF_POWER_TRIM -+#if defined(CONFIG_RTL8723B) -+ #define REG_RF_BB_GAIN_OFFSET 0x7f -+ #define RF_GAIN_OFFSET_MASK 0xfffff -+#elif defined(CONFIG_RTL8188E) -+ #define REG_RF_BB_GAIN_OFFSET 0x55 -+ #define RF_GAIN_OFFSET_MASK 0xfffff -+#else -+ #define REG_RF_BB_GAIN_OFFSET 0x55 -+ #define RF_GAIN_OFFSET_MASK 0xfffff -+#endif /* CONFIG_RTL8723B */ -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ -+/* For store initial value of BB register */ -+typedef struct _BB_INIT_REGISTER { -+ u16 offset; -+ u32 value; -+ -+} BB_INIT_REGISTER, *PBB_INIT_REGISTER; -+ -+#define PAGE_SIZE_128 128 -+#define PAGE_SIZE_256 256 -+#define PAGE_SIZE_512 512 -+ -+#define HCI_SUS_ENTER 0 -+#define HCI_SUS_LEAVING 1 -+#define HCI_SUS_LEAVE 2 -+#define HCI_SUS_ENTERING 3 -+#define HCI_SUS_ERR 4 -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+typedef enum _ACS_OP { -+ ACS_INIT, /*ACS - Variable init*/ -+ ACS_RESET, /*ACS - NHM Counter reset*/ -+ ACS_SELECT, /*ACS - NHM Counter Statistics */ -+} ACS_OP; -+ -+typedef enum _ACS_STATE { -+ ACS_DISABLE, -+ ACS_ENABLE, -+} ACS_STATE; -+ -+struct auto_chan_sel { -+ ATOMIC_T state; -+ u8 ch; /* previous channel*/ -+}; -+#endif /*CONFIG_AUTO_CHNL_SEL_NHM*/ -+ -+#define EFUSE_FILE_UNUSED 0 -+#define EFUSE_FILE_FAILED 1 -+#define EFUSE_FILE_LOADED 2 -+ -+#define MACADDR_FILE_UNUSED 0 -+#define MACADDR_FILE_FAILED 1 -+#define MACADDR_FILE_LOADED 2 -+ -+#define KFREE_FLAG_ON BIT0 -+#define KFREE_FLAG_THERMAL_K_ON BIT1 -+ -+#define MAX_IQK_INFO_BACKUP_CHNL_NUM 5 -+#define MAX_IQK_INFO_BACKUP_REG_NUM 10 -+ -+struct kfree_data_t { -+ u8 flag; -+ s8 bb_gain[BB_GAIN_NUM][RF_PATH_MAX]; -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ s8 pa_bias_5g[RF_PATH_MAX]; -+ s8 pad_bias_5g[RF_PATH_MAX]; -+#endif -+ s8 thermal; -+}; -+ -+bool kfree_data_is_bb_gain_empty(struct kfree_data_t *data); -+ -+struct hal_spec_t { -+ char *ic_name; -+ u8 macid_num; -+ -+ u8 sec_cam_ent_num; -+ u8 sec_cap; -+ -+ u8 rfpath_num_2g:4; /* used for tx power index path */ -+ u8 rfpath_num_5g:4; /* used for tx power index path */ -+ -+ u8 max_tx_cnt; -+ u8 nss_num; -+ u8 band_cap; /* value of BAND_CAP_XXX */ -+ u8 bw_cap; /* value of BW_CAP_XXX */ -+ u8 port_num; -+ u8 proto_cap; /* value of PROTO_CAP_XXX */ -+ u8 wl_func; /* value of WL_FUNC_XXX */ -+}; -+ -+#define HAL_SPEC_CHK_RF_PATH_2G(_spec, _path) ((_spec)->rfpath_num_2g > (_path)) -+#define HAL_SPEC_CHK_RF_PATH_5G(_spec, _path) ((_spec)->rfpath_num_5g > (_path)) -+#define HAL_SPEC_CHK_RF_PATH(_spec, _band, _path) ( \ -+ _band == BAND_ON_2_4G ? HAL_SPEC_CHK_RF_PATH_2G(_spec, _path) : \ -+ _band == BAND_ON_5G ? HAL_SPEC_CHK_RF_PATH_5G(_spec, _path) : 0) -+ -+#define HAL_SPEC_CHK_TX_CNT(_spec, _cnt_idx) ((_spec)->max_tx_cnt > (_cnt_idx)) -+ -+struct hal_iqk_reg_backup { -+ u8 central_chnl; -+ u8 bw_mode; -+ u32 reg_backup[MAX_RF_PATH][MAX_IQK_INFO_BACKUP_REG_NUM]; -+}; -+ -+typedef struct hal_com_data { -+ HAL_VERSION VersionID; -+ RT_MULTI_FUNC MultiFunc; /* For multi-function consideration. */ -+ RT_POLARITY_CTL PolarityCtl; /* For Wifi PDn Polarity control. */ -+ RT_REGULATOR_MODE RegulatorMode; /* switching regulator or LDO */ -+ u8 hw_init_completed; -+ /****** FW related ******/ -+ u16 FirmwareVersion; -+ u16 FirmwareVersionRev; -+ u16 FirmwareSubVersion; -+ u16 FirmwareSignature; -+ u8 RegFWOffload; -+ u8 fw_ractrl; -+ u8 FwRsvdPageStartOffset; /* 2010.06.23. Added by tynli. Reserve page start offset except beacon in TxQ.*/ -+ u8 LastHMEBoxNum; /* H2C - for host message to fw */ -+ -+ /****** current WIFI_PHY values ******/ -+ WIRELESS_MODE CurrentWirelessMode; -+ CHANNEL_WIDTH CurrentChannelBW; -+ BAND_TYPE CurrentBandType; /* 0:2.4G, 1:5G */ -+ BAND_TYPE BandSet; -+ u8 CurrentChannel; -+ u8 cch_20; -+ u8 cch_40; -+ u8 cch_80; -+ u8 CurrentCenterFrequencyIndex1; -+ u8 nCur40MhzPrimeSC; /* Control channel sub-carrier */ -+ u8 nCur80MhzPrimeSC; /* used for primary 40MHz of 80MHz mode */ -+ BOOLEAN bSwChnlAndSetBWInProgress; -+ u8 bDisableSWChannelPlan; /* flag of disable software change channel plan */ -+ u16 BasicRateSet; -+ u32 ReceiveConfig; -+ u8 rx_tsf_addr_filter_config; /* for 8822B/8821C USE */ -+ BOOLEAN bSwChnl; -+ BOOLEAN bSetChnlBW; -+ BOOLEAN bSWToBW40M; -+ BOOLEAN bSWToBW80M; -+ BOOLEAN bChnlBWInitialized; -+ u32 BackUp_BB_REG_4_2nd_CCA[3]; -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ struct auto_chan_sel acs; -+#endif -+ /****** rf_ctrl *****/ -+ u8 rf_chip; -+ u8 rf_type; -+ u8 PackageType; -+ u8 NumTotalRFPath; -+ -+ /****** Debug ******/ -+ u16 ForcedDataRate; /* Force Data Rate. 0: Auto, 0x02: 1M ~ 0x6C: 54M. */ -+ u8 u1ForcedIgiLb; /* forced IGI lower bound */ -+ u8 bDumpRxPkt; -+ u8 bDumpTxPkt; -+ u8 bDisableTXPowerTraining; -+ -+ -+ /****** EEPROM setting.******/ -+ u8 bautoload_fail_flag; -+ u8 efuse_file_status; -+ u8 macaddr_file_status; -+ u8 EepromOrEfuse; -+ u8 efuse_eeprom_data[EEPROM_MAX_SIZE]; /*92C:256bytes, 88E:512bytes, we use union set (512bytes)*/ -+ u8 InterfaceSel; /* board type kept in eFuse */ -+ u16 CustomerID; -+ -+ u16 EEPROMVID; -+ u16 EEPROMSVID; -+#ifdef CONFIG_USB_HCI -+ u8 EEPROMUsbSwitch; -+ u16 EEPROMPID; -+ u16 EEPROMSDID; -+#endif -+#ifdef CONFIG_PCI_HCI -+ u16 EEPROMDID; -+ u16 EEPROMSMID; -+#endif -+ -+ u8 EEPROMCustomerID; -+ u8 EEPROMSubCustomerID; -+ u8 EEPROMVersion; -+ u8 EEPROMRegulatory; -+ u8 EEPROMThermalMeter; -+ u8 EEPROMBluetoothCoexist; -+ u8 EEPROMBluetoothType; -+ u8 EEPROMBluetoothAntNum; -+ u8 EEPROMBluetoothAntIsolation; -+ u8 EEPROMBluetoothRadioShared; -+ u8 EEPROMMACAddr[ETH_ALEN]; -+ -+#ifdef CONFIG_RF_POWER_TRIM -+ u8 EEPROMRFGainOffset; -+ u8 EEPROMRFGainVal; -+ struct kfree_data_t kfree_data; -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || \ -+ defined(CONFIG_RTL8723D) -+ u8 adjuseVoltageVal; -+ u8 need_restore; -+#endif -+ u8 EfuseUsedPercentage; -+ u16 EfuseUsedBytes; -+ /*u8 EfuseMap[2][HWSET_MAX_SIZE_JAGUAR];*/ -+ EFUSE_HAL EfuseHal; -+ -+ /*---------------------------------------------------------------------------------*/ -+ /* 2.4G TX power info for target TX power*/ -+ u8 Index24G_CCK_Base[MAX_RF_PATH][CENTER_CH_2G_NUM]; -+ u8 Index24G_BW40_Base[MAX_RF_PATH][CENTER_CH_2G_NUM]; -+ s8 CCK_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 OFDM_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ -+ /* 5G TX power info for target TX power*/ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ u8 Index5G_BW40_Base[MAX_RF_PATH][CENTER_CH_5G_ALL_NUM]; -+ u8 Index5G_BW80_Base[MAX_RF_PATH][CENTER_CH_5G_80M_NUM]; -+ s8 OFDM_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW80_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+#endif -+ -+ u8 Regulation2_4G; -+ u8 Regulation5G; -+ -+ /******************************** -+ * TX power by rate table at most 4RF path. -+ * The register is -+ * -+ * VHT TX power by rate off setArray = -+ * Band:-2G&5G = 0 / 1 -+ * RF: at most 4*4 = ABCD=0/1/2/3 -+ * CCK=0 OFDM=1/2 HT-MCS 0-15=3/4/56 VHT=7/8/9/10/11 -+ **********************************/ -+ -+ u8 txpwr_by_rate_undefined_band_path[TX_PWR_BY_RATE_NUM_BAND] -+ [TX_PWR_BY_RATE_NUM_RF]; -+ -+ s8 TxPwrByRateOffset[TX_PWR_BY_RATE_NUM_BAND] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RATE]; -+ -+#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI -+ s8 TxPwrByRate[TX_PWR_BY_RATE_NUM_BAND] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RATE]; -+#endif -+ /* --------------------------------------------------------------------------------- */ -+ -+ u8 tx_pwr_lmt_5g_20_40_ref; -+ -+ /* Power Limit Table for 2.4G */ -+ s8 TxPwrLimit_2_4G[MAX_REGULATION_NUM] -+ [MAX_2_4G_BANDWIDTH_NUM] -+ [MAX_RATE_SECTION_NUM] -+ [CENTER_CH_2G_NUM] -+ [MAX_RF_PATH]; -+ -+ /* Power Limit Table for 5G */ -+ s8 TxPwrLimit_5G[MAX_REGULATION_NUM] -+ [MAX_5G_BANDWIDTH_NUM] -+ [MAX_RATE_SECTION_NUM] -+ [CENTER_CH_5G_ALL_NUM] -+ [MAX_RF_PATH]; -+ -+ -+#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI -+ s8 TxPwrLimit_2_4G_Original[MAX_REGULATION_NUM] -+ [MAX_2_4G_BANDWIDTH_NUM] -+ [MAX_RATE_SECTION_NUM] -+ [CENTER_CH_2G_NUM] -+ [MAX_RF_PATH]; -+ -+ -+ s8 TxPwrLimit_5G_Original[MAX_REGULATION_NUM] -+ [MAX_5G_BANDWIDTH_NUM] -+ [MAX_RATE_SECTION_NUM] -+ [CENTER_CH_5G_ALL_NUM] -+ [MAX_RF_PATH]; -+ -+#endif -+ -+ /* Store the original power by rate value of the base of each rate section of rf path A & B */ -+ u8 TxPwrByRateBase2_4G[TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [MAX_BASE_NUM_IN_PHY_REG_PG_2_4G]; -+ u8 TxPwrByRateBase5G[TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [MAX_BASE_NUM_IN_PHY_REG_PG_5G]; -+ -+ u8 txpwr_by_rate_loaded:1; -+ u8 txpwr_by_rate_from_file:1; -+ u8 txpwr_limit_loaded:1; -+ u8 txpwr_limit_from_file:1; -+ u8 RfPowerTrackingType; -+ -+ /* Read/write are allow for following hardware information variables */ -+ u8 CrystalCap; -+ -+ u8 PAType_2G; -+ u8 PAType_5G; -+ u8 LNAType_2G; -+ u8 LNAType_5G; -+ u8 ExternalPA_2G; -+ u8 ExternalLNA_2G; -+ u8 ExternalPA_5G; -+ u8 ExternalLNA_5G; -+ u16 TypeGLNA; -+ u16 TypeGPA; -+ u16 TypeALNA; -+ u16 TypeAPA; -+ u16 RFEType; -+ -+ u8 bLedOpenDrain; /* Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. */ -+ u32 AcParam_BE; /* Original parameter for BE, use for EDCA turbo. */ -+ -+ BB_REGISTER_DEFINITION_T PHYRegDef[MAX_RF_PATH]; /* Radio A/B/C/D */ -+ -+ u32 RfRegChnlVal[MAX_RF_PATH]; -+ -+ /* RDG enable */ -+ BOOLEAN bRDGEnable; -+ -+ u8 RegTxPause; -+ /* Beacon function related global variable. */ -+ u8 RegBcnCtrlVal; -+ u8 RegFwHwTxQCtrl; -+ u8 RegReg542; -+ u8 RegCR_1; -+ u8 Reg837; -+ u16 RegRRSR; -+ -+ /****** antenna diversity ******/ -+ u8 AntDivCfg; -+ u8 with_extenal_ant_switch; -+ u8 b_fix_tx_ant; -+ u8 AntDetection; -+ u8 TRxAntDivType; -+ u8 ant_path; /* for 8723B s0/s1 selection */ -+ u32 AntennaTxPath; /* Antenna path Tx */ -+ u32 AntennaRxPath; /* Antenna path Rx */ -+ u8 sw_antdiv_bl_state; -+ -+ /******** PHY DM & DM Section **********/ -+ u8 DM_Type; -+ _lock IQKSpinLock; -+ u8 INIDATA_RATE[MACID_NUM_SW_LIMIT]; -+ /* Upper and Lower Signal threshold for Rate Adaptive*/ -+ int EntryMinUndecoratedSmoothedPWDB; -+ int EntryMaxUndecoratedSmoothedPWDB; -+ int MinUndecoratedPWDBForDM; -+ DM_ODM_T odmpriv; -+ u8 bIQKInitialized; -+ u8 bNeedIQK; -+ u8 IQK_MP_Switch; -+ /******** PHY DM & DM Section **********/ -+ -+ -+ -+ /* 2010/08/09 MH Add CU power down mode. */ -+ BOOLEAN pwrdown; -+ -+ /* Add for dual MAC 0--Mac0 1--Mac1 */ -+ u32 interfaceIndex; -+ -+#ifdef CONFIG_P2P -+ u8 p2p_ps_offload; -+#endif -+ /* Auto FSM to Turn On, include clock, isolation, power control for MAC only */ -+ u8 bMacPwrCtrlOn; -+ u8 hci_sus_state; -+ -+ u8 RegIQKFWOffload; -+ struct submit_ctx iqk_sctx; -+ -+ RT_AMPDU_BRUST AMPDUBurstMode; /* 92C maybe not use, but for compile successfully */ -+ -+ u8 OutEpQueueSel; -+ u8 OutEpNumber; -+ -+#ifdef RTW_RX_AGGREGATION -+ RX_AGG_MODE rxagg_mode; -+ -+ /* For RX Aggregation DMA Mode */ -+ u8 rxagg_dma_size; -+ u8 rxagg_dma_timeout; -+#endif /* RTW_RX_AGGREGATION */ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ /* */ -+ /* For SDIO Interface HAL related */ -+ /* */ -+ -+ /* */ -+ /* SDIO ISR Related */ -+ /* -+ * u32 IntrMask[1]; -+ * u32 IntrMaskToSet[1]; -+ * LOG_INTERRUPT InterruptLog; */ -+ u32 sdio_himr; -+ u32 sdio_hisr; -+#ifndef RTW_HALMAC -+ /* */ -+ /* SDIO Tx FIFO related. */ -+ /* */ -+ /* HIQ, MID, LOW, PUB free pages; padapter->xmitpriv.free_txpg */ -+ u8 SdioTxFIFOFreePage[SDIO_TX_FREE_PG_QUEUE]; -+ _lock SdioTxFIFOFreePageLock; -+ u8 SdioTxOQTMaxFreeSpace; -+ u8 SdioTxOQTFreeSpace; -+#else /* RTW_HALMAC */ -+ u16 SdioTxOQTFreeSpace; -+#endif /* RTW_HALMAC */ -+ -+ /* */ -+ /* SDIO Rx FIFO related. */ -+ /* */ -+ u8 SdioRxFIFOCnt; -+ u16 SdioRxFIFOSize; -+ -+#ifndef RTW_HALMAC -+ u32 sdio_tx_max_len[SDIO_MAX_TX_QUEUE];/* H, N, L, used for sdio tx aggregation max length per queue */ -+#else -+#ifdef CONFIG_RTL8821C -+ u16 tx_high_page; -+ u16 tx_low_page; -+ u16 tx_normal_page; -+ u16 tx_extra_page; -+ u16 tx_pub_page; -+ u16 max_oqt_page; -+ u32 max_xmit_size_vovi; -+ u32 max_xmit_size_bebk; -+#endif -+#endif /* !RTW_HALMAC */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+#ifdef CONFIG_USB_HCI -+ -+ /* 2010/12/10 MH Add for USB aggreation mode dynamic shceme. */ -+ BOOLEAN UsbRxHighSpeedMode; -+ BOOLEAN UsbTxVeryHighSpeedMode; -+ u32 UsbBulkOutSize; -+ BOOLEAN bSupportUSB3; -+ u8 usb_intf_start; -+ -+ /* Interrupt relatd register information. */ -+ u32 IntArray[3];/* HISR0,HISR1,HSISR */ -+ u32 IntrMask[3]; -+#ifdef CONFIG_USB_TX_AGGREGATION -+ u8 UsbTxAggMode; -+ u8 UsbTxAggDescNum; -+#endif /* CONFIG_USB_TX_AGGREGATION */ -+ -+#ifdef CONFIG_USB_RX_AGGREGATION -+ u16 HwRxPageSize; /* Hardware setting */ -+ -+ /* For RX Aggregation USB Mode */ -+ u8 rxagg_usb_size; -+ u8 rxagg_usb_timeout; -+#endif/* CONFIG_USB_RX_AGGREGATION */ -+#endif /* CONFIG_USB_HCI */ -+ -+ -+#ifdef CONFIG_PCI_HCI -+ /* */ -+ /* EEPROM setting. */ -+ /* */ -+ u32 TransmitConfig; -+ u32 IntrMaskToSet[2]; -+ u32 IntArray[4]; -+ u32 IntrMask[4]; -+ u32 SysIntArray[1]; -+ u32 SysIntrMask[1]; -+ u32 IntrMaskReg[2]; -+ u32 IntrMaskDefault[4]; -+ -+ BOOLEAN bL1OffSupport; -+ BOOLEAN bSupportBackDoor; -+ -+ u8 bDefaultAntenna; -+ -+ u8 bInterruptMigration; -+ u8 bDisableTxInt; -+ -+ u16 RxTag; -+#endif /* CONFIG_PCI_HCI */ -+ -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ struct sreset_priv srestpriv; -+#endif /* #ifdef DBG_CONFIG_ERROR_DETECT */ -+ -+#ifdef CONFIG_BT_COEXIST -+ /* For bluetooth co-existance */ -+ BT_COEXIST bt_coexist; -+#endif /* CONFIG_BT_COEXIST */ -+ -+#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) \ -+ || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8723D) -+#ifndef CONFIG_PCI_HCI /* mutual exclusive with PCI -- so they're SDIO and GSPI */ -+ /* Interrupt relatd register information. */ -+ u32 SysIntrStatus; -+ u32 SysIntrMask; -+#endif -+#endif /*endif CONFIG_RTL8723B */ -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ char para_file_buf[MAX_PARA_FILE_BUF_LEN]; -+ char *mac_reg; -+ u32 mac_reg_len; -+ char *bb_phy_reg; -+ u32 bb_phy_reg_len; -+ char *bb_agc_tab; -+ u32 bb_agc_tab_len; -+ char *bb_phy_reg_pg; -+ u32 bb_phy_reg_pg_len; -+ char *bb_phy_reg_mp; -+ u32 bb_phy_reg_mp_len; -+ char *rf_radio_a; -+ u32 rf_radio_a_len; -+ char *rf_radio_b; -+ u32 rf_radio_b_len; -+ char *rf_tx_pwr_track; -+ u32 rf_tx_pwr_track_len; -+ char *rf_tx_pwr_lmt; -+ u32 rf_tx_pwr_lmt_len; -+#endif -+ -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ s16 noise[ODM_MAX_CHANNEL_NUM]; -+#endif -+ -+ struct hal_spec_t hal_spec; -+ -+ u8 RfKFreeEnable; -+ u8 RfKFree_ch_group; -+ BOOLEAN bCCKinCH14; -+ BB_INIT_REGISTER RegForRecover[5]; -+ -+#if defined(CONFIG_PCI_HCI) && defined(RTL8814AE_SW_BCN) -+ BOOLEAN bCorrectBCN; -+#endif -+ u32 RxGainOffset[4]; /*{2G, 5G_Low, 5G_Middle, G_High}*/ -+ u8 BackUp_IG_REG_4_Chnl_Section[4]; /*{A,B,C,D}*/ -+ -+ struct hal_iqk_reg_backup iqk_reg_backup[MAX_IQK_INFO_BACKUP_CHNL_NUM]; -+ -+#ifdef CONFIG_BEAMFORMING -+#ifdef RTW_BEAMFORMING_VERSION_2 -+ struct beamforming_info beamforming_info; -+#endif /* RTW_BEAMFORMING_VERSION_2 */ -+#endif /* CONFIG_BEAMFORMING */ -+} HAL_DATA_COMMON, *PHAL_DATA_COMMON; -+ -+ -+ -+typedef struct hal_com_data HAL_DATA_TYPE, *PHAL_DATA_TYPE; -+#define GET_HAL_DATA(__pAdapter) ((HAL_DATA_TYPE *)((__pAdapter)->HalData)) -+#define GET_HAL_SPEC(__pAdapter) (&(GET_HAL_DATA((__pAdapter))->hal_spec)) -+#define GET_ODM(__pAdapter) (&(GET_HAL_DATA((__pAdapter))->odmpriv)) -+ -+#define GET_HAL_RFPATH_NUM(__pAdapter) (((HAL_DATA_TYPE *)((__pAdapter)->HalData))->NumTotalRFPath) -+#define RT_GetInterfaceSelection(_Adapter) (GET_HAL_DATA(_Adapter)->InterfaceSel) -+#define GET_RF_TYPE(__pAdapter) (GET_HAL_DATA(__pAdapter)->rf_type) -+#define GET_KFREE_DATA(_adapter) (&(GET_HAL_DATA((_adapter))->kfree_data)) -+ -+#define SUPPORT_HW_RADIO_DETECT(Adapter) (RT_GetInterfaceSelection(Adapter) == INTF_SEL2_MINICARD || \ -+ RT_GetInterfaceSelection(Adapter) == INTF_SEL3_USB_Solo || \ -+ RT_GetInterfaceSelection(Adapter) == INTF_SEL4_USB_Combo) -+ -+#define get_hal_mac_addr(adapter) (GET_HAL_DATA(adapter)->EEPROMMACAddr) -+#define is_boot_from_eeprom(adapter) (GET_HAL_DATA(adapter)->EepromOrEfuse) -+#define rtw_get_hw_init_completed(adapter) (GET_HAL_DATA(adapter)->hw_init_completed) -+#define rtw_is_hw_init_completed(adapter) (GET_HAL_DATA(adapter)->hw_init_completed == _TRUE) -+#endif -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+#define GET_ACS_STATE(padapter) (ATOMIC_READ(&GET_HAL_DATA(padapter)->acs.state)) -+#define SET_ACS_STATE(padapter, set_state) (ATOMIC_SET(&GET_HAL_DATA(padapter)->acs.state, set_state)) -+#define rtw_get_acs_channel(padapter) (GET_HAL_DATA(padapter)->acs.ch) -+#define rtw_set_acs_channel(padapter, survey_ch) (GET_HAL_DATA(padapter)->acs.ch = survey_ch) -+#endif /*CONFIG_AUTO_CHNL_SEL_NHM*/ -+ -+#ifdef RTW_HALMAC -+int rtw_halmac_deinit_adapter(struct dvobj_priv *); -+#endif /* RTW_HALMAC */ -+ -+#endif /* __HAL_DATA_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_gspi.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_gspi.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_gspi.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_gspi.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_GSPI_H_ -+#define __HAL_GSPI_H_ -+ -+#define ffaddr2deviceId(pdvobj, addr) (pdvobj->Queue2Pipe[addr]) -+ -+u8 rtw_hal_gspi_max_txoqt_free_space(_adapter *padapter); -+u8 rtw_hal_gspi_query_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); -+void rtw_hal_gspi_update_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); -+void rtw_hal_set_gspi_tx_max_length(PADAPTER padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ); -+u32 rtw_hal_get_gspi_tx_max_length(PADAPTER padapter, u8 queue_idx); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_ic_cfg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_ic_cfg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_ic_cfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_ic_cfg.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,156 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_IC_CFG_H__ -+#define __HAL_IC_CFG_H__ -+ -+#define RTL8188E_SUPPORT 0 -+#define RTL8812A_SUPPORT 0 -+#define RTL8821A_SUPPORT 0 -+#define RTL8723B_SUPPORT 0 -+#define RTL8723D_SUPPORT 0 -+#define RTL8192E_SUPPORT 0 -+#define RTL8814A_SUPPORT 0 -+#define RTL8195A_SUPPORT 0 -+#define RTL8197F_SUPPORT 0 -+#define RTL8703B_SUPPORT 0 -+#define RTL8188F_SUPPORT 0 -+#define RTL8822B_SUPPORT 0 -+#define RTL8821B_SUPPORT 0 -+#define RTL8821C_SUPPORT 0 -+ -+/*#if (RTL8188E_SUPPORT==1)*/ -+#define RATE_ADAPTIVE_SUPPORT 0 -+#define POWER_TRAINING_ACTIVE 0 -+ -+#ifdef CONFIG_MULTIDRV -+#endif -+ -+#ifdef CONFIG_RTL8188E -+ #undef RTL8188E_SUPPORT -+ #undef RATE_ADAPTIVE_SUPPORT -+ #undef POWER_TRAINING_ACTIVE -+ -+ #define RTL8188E_SUPPORT 1 -+ #define RATE_ADAPTIVE_SUPPORT 1 -+ #define POWER_TRAINING_ACTIVE 1 -+ #define CONFIG_GET_RAID_BY_DRV -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ #undef RTL8812A_SUPPORT -+ #define RTL8812A_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8821A -+ #undef RTL8821A_SUPPORT -+ #define RTL8821A_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ #undef RTL8192E_SUPPORT -+ #define RTL8192E_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8723B -+ #undef RTL8723B_SUPPORT -+ #define RTL8723B_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ #undef RTL8723D_SUPPORT -+ #define RTL8723D_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT -+ #define CONFIG_RTW_MAC_HIDDEN_RPT -+ #endif -+ #ifndef CONFIG_RTW_CUSTOMER_STR -+ #define CONFIG_RTW_CUSTOMER_STR -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ #undef RTL8814A_SUPPORT -+ #define RTL8814A_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8703B -+ #undef RTL8703B_SUPPORT -+ #define RTL8703B_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT -+ #define CONFIG_RTW_MAC_HIDDEN_RPT -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8188F -+ #undef RTL8188F_SUPPORT -+ #define RTL8188F_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT -+ #define CONFIG_RTW_MAC_HIDDEN_RPT -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ #undef RTL8822B_SUPPORT -+ #define RTL8822B_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+#endif -+ -+#ifdef CONFIG_RTL8821C -+ #undef RTL8821C_SUPPORT -+ #define RTL8821C_SUPPORT 1 -+ #ifndef CONFIG_FW_C2H_PKT -+ #define CONFIG_FW_C2H_PKT -+ #endif -+ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT -+ #define CONFIG_RTW_MAC_HIDDEN_RPT -+ #endif -+ #define LOAD_FW_HEADER_FROM_DRIVER -+ #define CONFIG_PHY_CAPABILITY_QUERY -+ #ifdef CONFIG_CONCURRENT_MODE -+ #define CONFIG_SUPPORT_FW_MULTI_PORT -+ #endif -+#endif -+ -+#endif /*__HAL_IC_CFG_H__*/ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_intf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_intf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_intf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_intf.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,734 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_INTF_H__ -+#define __HAL_INTF_H__ -+ -+ -+enum RTL871X_HCI_TYPE { -+ RTW_PCIE = BIT0, -+ RTW_USB = BIT1, -+ RTW_SDIO = BIT2, -+ RTW_GSPI = BIT3, -+}; -+ -+enum _CHIP_TYPE { -+ -+ NULL_CHIP_TYPE, -+ RTL8188E, -+ RTL8192E, -+ RTL8812, -+ RTL8821, /* RTL8811 */ -+ RTL8723B, -+ RTL8814A, -+ RTL8703B, -+ RTL8188F, -+ RTL8822B, -+ RTL8723D, -+ RTL8821C, -+ MAX_CHIP_TYPE -+}; -+ -+extern const u32 _chip_type_to_odm_ic_type[]; -+#define chip_type_to_odm_ic_type(chip_type) (((chip_type) >= MAX_CHIP_TYPE) ? _chip_type_to_odm_ic_type[MAX_CHIP_TYPE] : _chip_type_to_odm_ic_type[(chip_type)]) -+ -+typedef enum _HAL_HW_TIMER_TYPE { -+ HAL_TIMER_NONE = 0, -+ HAL_TIMER_TXBF = 1, -+ HAL_TIMER_EARLYMODE = 2, -+} HAL_HW_TIMER_TYPE, *PHAL_HW_TIMER_TYPE; -+ -+ -+typedef enum _HW_VARIABLES { -+ HW_VAR_MEDIA_STATUS, -+ HW_VAR_SET_OPMODE, -+ HW_VAR_MAC_ADDR, -+ HW_VAR_BSSID, -+ HW_VAR_INIT_RTS_RATE, -+ HW_VAR_BASIC_RATE, -+ HW_VAR_TXPAUSE, -+ HW_VAR_BCN_FUNC, -+ HW_VAR_CORRECT_TSF, -+ HW_VAR_CHECK_BSSID, -+ HW_VAR_MLME_DISCONNECT, -+ HW_VAR_MLME_SITESURVEY, -+ HW_VAR_MLME_JOIN, -+ HW_VAR_ON_RCR_AM, -+ HW_VAR_OFF_RCR_AM, -+ HW_VAR_BEACON_INTERVAL, -+ HW_VAR_SLOT_TIME, -+ HW_VAR_RESP_SIFS, -+ HW_VAR_ACK_PREAMBLE, -+ HW_VAR_SEC_CFG, -+ HW_VAR_SEC_DK_CFG, -+ HW_VAR_BCN_VALID, -+ HW_VAR_RF_TYPE, -+ /* PHYDM odm->SupportAbility */ -+ HW_VAR_CAM_EMPTY_ENTRY, -+ HW_VAR_CAM_INVALID_ALL, -+ HW_VAR_AC_PARAM_VO, -+ HW_VAR_AC_PARAM_VI, -+ HW_VAR_AC_PARAM_BE, -+ HW_VAR_AC_PARAM_BK, -+ HW_VAR_ACM_CTRL, -+ HW_VAR_AMPDU_MIN_SPACE, -+ HW_VAR_AMPDU_FACTOR, -+ HW_VAR_RXDMA_AGG_PG_TH, -+ HW_VAR_SET_RPWM, -+ HW_VAR_CPWM, -+ HW_VAR_H2C_FW_PWRMODE, -+ HW_VAR_H2C_PS_TUNE_PARAM, -+ HW_VAR_H2C_FW_JOINBSSRPT, -+ HW_VAR_FWLPS_RF_ON, -+ HW_VAR_H2C_FW_P2P_PS_OFFLOAD, -+#ifdef CONFIG_LPS_POFF -+ HW_VAR_LPS_POFF_INIT, -+ HW_VAR_LPS_POFF_DEINIT, -+ HW_VAR_LPS_POFF_SET_MODE, -+ HW_VAR_LPS_POFF_WOW_EN, -+#endif -+ HW_VAR_TRIGGER_GPIO_0, -+ HW_VAR_BT_SET_COEXIST, -+ HW_VAR_BT_ISSUE_DELBA, -+ HW_VAR_SWITCH_EPHY_WoWLAN, -+ HW_VAR_EFUSE_USAGE, -+ HW_VAR_EFUSE_BYTES, -+ HW_VAR_EFUSE_BT_USAGE, -+ HW_VAR_EFUSE_BT_BYTES, -+ HW_VAR_FIFO_CLEARN_UP, -+ HW_VAR_RESTORE_HW_SEQ, -+ HW_VAR_CHECK_TXBUF, -+ HW_VAR_PCIE_STOP_TX_DMA, -+ HW_VAR_APFM_ON_MAC, /* Auto FSM to Turn On, include clock, isolation, power control for MAC only */ -+ HW_VAR_HCI_SUS_STATE, -+ /* The valid upper nav range for the HW updating, if the true value is larger than the upper range, the HW won't update it. */ -+ /* Unit in microsecond. 0 means disable this function. */ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ HW_VAR_WOWLAN, -+ HW_VAR_WAKEUP_REASON, -+ HW_VAR_RPWM_TOG, -+#endif -+#ifdef CONFIG_GPIO_WAKEUP -+ HW_SET_GPIO_WL_CTRL, -+#endif -+#ifdef CONFIG_RTW_SDIO_OOB_INT -+ HW_SET_OOB_CTRL, -+#endif -+ HW_VAR_SYS_CLKR, -+ HW_VAR_NAV_UPPER, -+ HW_VAR_RPT_TIMER_SETTING, -+ HW_VAR_TX_RPT_MAX_MACID, -+ HW_VAR_CHK_HI_QUEUE_EMPTY, -+ HW_VAR_DL_BCN_SEL, -+ HW_VAR_AMPDU_MAX_TIME, -+ HW_VAR_WIRELESS_MODE, -+ HW_VAR_USB_MODE, -+ HW_VAR_PORT_SWITCH, -+ HW_VAR_DO_IQK, -+ HW_VAR_DM_IN_LPS, -+ HW_VAR_SET_REQ_FW_PS, -+ HW_VAR_FW_PS_STATE, -+ HW_VAR_SOUNDING_ENTER, -+ HW_VAR_SOUNDING_LEAVE, -+ HW_VAR_SOUNDING_RATE, -+ HW_VAR_SOUNDING_STATUS, -+ HW_VAR_SOUNDING_FW_NDPA, -+ HW_VAR_SOUNDING_CLK, -+ HW_VAR_SOUNDING_SET_GID_TABLE, -+ /*Add by YuChen for TXBF HW timer*/ -+ HW_VAR_HW_REG_TIMER_INIT, -+ HW_VAR_HW_REG_TIMER_RESTART, -+ HW_VAR_HW_REG_TIMER_START, -+ HW_VAR_HW_REG_TIMER_STOP, -+ /*Add by YuChen for TXBF HW timer*/ -+ HW_VAR_DL_RSVD_PAGE, -+ HW_VAR_MACID_LINK, -+ HW_VAR_MACID_NOLINK, -+ HW_VAR_MACID_SLEEP, -+ HW_VAR_MACID_WAKEUP, -+ HW_VAR_DUMP_MAC_QUEUE_INFO, -+ HW_VAR_ASIX_IOT, -+#ifdef CONFIG_MBSSID_CAM -+ HW_VAR_MBSSID_CAM_WRITE, -+ HW_VAR_MBSSID_CAM_CLEAR, -+ HW_VAR_RCR_MBSSID_EN, -+#endif -+ HW_VAR_EN_HW_UPDATE_TSF, -+ HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, -+ HW_VAR_CH_SW_IQK_INFO_BACKUP, -+ HW_VAR_CH_SW_IQK_INFO_RESTORE, -+#ifdef CONFIG_TDLS -+ HW_VAR_TDLS_WRCR, -+ HW_VAR_TDLS_RS_RCR, -+#ifdef CONFIG_TDLS_CH_SW -+ HW_VAR_TDLS_BCN_EARLY_C2H_RPT -+#endif -+#endif -+} HW_VARIABLES; -+ -+typedef enum _HAL_DEF_VARIABLE { -+ HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, -+ HAL_DEF_IS_SUPPORT_ANT_DIV, -+ HAL_DEF_DRVINFO_SZ, -+ HAL_DEF_MAX_RECVBUF_SZ, -+ HAL_DEF_RX_PACKET_OFFSET, -+ HAL_DEF_RX_DMA_SZ_WOW, -+ HAL_DEF_RX_DMA_SZ, -+ HAL_DEF_RX_PAGE_SIZE, -+ HAL_DEF_DBG_DUMP_RXPKT,/* for dbg */ -+ HAL_DEF_RA_DECISION_RATE, -+ HAL_DEF_RA_SGI, -+ HAL_DEF_PT_PWR_STATUS, -+ HAL_DEF_TX_LDPC, /* LDPC support */ -+ HAL_DEF_RX_LDPC, /* LDPC support */ -+ HAL_DEF_TX_STBC, /* TX STBC support */ -+ HAL_DEF_RX_STBC, /* RX STBC support */ -+ HAL_DEF_EXPLICIT_BEAMFORMER,/* Explicit Compressed Steering Capable */ -+ HAL_DEF_EXPLICIT_BEAMFORMEE,/* Explicit Compressed Beamforming Feedback Capable */ -+ HAL_DEF_VHT_MU_BEAMFORMER, /* VHT MU Beamformer support */ -+ HAL_DEF_VHT_MU_BEAMFORMEE, /* VHT MU Beamformee support */ -+ HAL_DEF_BEAMFORMER_CAP, -+ HAL_DEF_BEAMFORMEE_CAP, -+ HW_VAR_MAX_RX_AMPDU_FACTOR, -+ HW_DEF_RA_INFO_DUMP, -+ HAL_DEF_DBG_DUMP_TXPKT, -+ -+ HAL_DEF_TX_PAGE_SIZE, -+ HAL_DEF_TX_PAGE_BOUNDARY, -+ HAL_DEF_TX_PAGE_BOUNDARY_WOWLAN, -+ HAL_DEF_ANT_DETECT,/* to do for 8723a */ -+ HAL_DEF_PCI_SUUPORT_L1_BACKDOOR, /* Determine if the L1 Backdoor setting is turned on. */ -+ HAL_DEF_PCI_AMD_L1_SUPPORT, -+ HAL_DEF_PCI_ASPM_OSC, /* Support for ASPM OSC, added by Roger, 2013.03.27. */ -+ HAL_DEF_MACID_SLEEP, /* Support for MACID sleep */ -+ HAL_DEF_DBG_DIS_PWT, /* disable Tx power training or not. */ -+ HAL_DEF_EFUSE_USAGE, /* Get current EFUSE utilization. 2008.12.19. Added by Roger. */ -+ HAL_DEF_EFUSE_BYTES, -+ HW_VAR_BEST_AMPDU_DENSITY, -+} HAL_DEF_VARIABLE; -+ -+typedef enum _HAL_ODM_VARIABLE { -+ HAL_ODM_STA_INFO, -+ HAL_ODM_P2P_STATE, -+ HAL_ODM_WIFI_DISPLAY_STATE, -+ HAL_ODM_NOISE_MONITOR, -+ HAL_ODM_REGULATION, -+ HAL_ODM_INITIAL_GAIN, -+ HAL_ODM_FA_CNT_DUMP, -+ HAL_ODM_DBG_FLAG, -+ HAL_ODM_DBG_LEVEL, -+ HAL_ODM_RX_INFO_DUMP, -+ HAL_ODM_RX_Dframe_INFO, -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ HAL_ODM_AUTO_CHNL_SEL, -+#endif -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ HAL_ODM_ANTDIV_SELECT -+#endif -+} HAL_ODM_VARIABLE; -+ -+typedef enum _HAL_INTF_PS_FUNC { -+ HAL_USB_SELECT_SUSPEND, -+ HAL_MAX_ID, -+} HAL_INTF_PS_FUNC; -+ -+typedef s32(*c2h_id_filter)(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); -+ -+struct txpwr_idx_comp; -+ -+struct hal_ops { -+ /*** initialize section ***/ -+ void (*read_chip_version)(_adapter *padapter); -+ void (*init_default_value)(_adapter *padapter); -+ void (*intf_chip_configure)(_adapter *padapter); -+ void (*read_adapter_info)(_adapter *padapter); -+ u32(*hal_power_on)(_adapter *padapter); -+ void (*hal_power_off)(_adapter *padapter); -+ u32(*hal_init)(_adapter *padapter); -+ u32(*hal_deinit)(_adapter *padapter); -+ void (*dm_init)(_adapter *padapter); -+ void (*dm_deinit)(_adapter *padapter); -+ -+ /*** xmit section ***/ -+ s32(*init_xmit_priv)(_adapter *padapter); -+ void (*free_xmit_priv)(_adapter *padapter); -+ s32(*hal_xmit)(_adapter *padapter, struct xmit_frame *pxmitframe); -+ /* -+ * mgnt_xmit should be implemented to run in interrupt context -+ */ -+ s32(*mgnt_xmit)(_adapter *padapter, struct xmit_frame *pmgntframe); -+ s32(*hal_xmitframe_enqueue)(_adapter *padapter, struct xmit_frame *pxmitframe); -+#ifdef CONFIG_XMIT_THREAD_MODE -+ s32(*xmit_thread_handler)(_adapter *padapter); -+#endif -+ void (*run_thread)(_adapter *padapter); -+ void (*cancel_thread)(_adapter *padapter); -+ -+ /*** recv section ***/ -+ s32(*init_recv_priv)(_adapter *padapter); -+ void (*free_recv_priv)(_adapter *padapter); -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) -+ u32(*inirp_init)(_adapter *padapter); -+ u32(*inirp_deinit)(_adapter *padapter); -+#endif -+ /*** interrupt hdl section ***/ -+ void (*enable_interrupt)(_adapter *padapter); -+ void (*disable_interrupt)(_adapter *padapter); -+ u8(*check_ips_status)(_adapter *padapter); -+#if defined(CONFIG_PCI_HCI) -+ s32(*interrupt_handler)(_adapter *padapter); -+#endif -+ -+#if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) -+ void (*interrupt_handler)(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+ -+#if defined(CONFIG_PCI_HCI) -+ void (*irp_reset)(_adapter *padapter); -+#endif -+ -+ /*** DM section ***/ -+ -+ void (*InitSwLeds)(_adapter *padapter); -+ void (*DeInitSwLeds)(_adapter *padapter); -+ -+ void (*set_chnl_bw_handler)(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80); -+ -+ void (*set_tx_power_level_handler)(_adapter *padapter, u8 channel); -+ void (*get_tx_power_level_handler)(_adapter *padapter, s32 *powerlevel); -+ -+ void (*set_tx_power_index_handler)(_adapter *padapter, u32 powerindex, u8 rfpath, u8 rate); -+ u8(*get_tx_power_index_handler)(_adapter *padapter, u8 rfpath, u8 rate, u8 bandwidth, u8 channel, struct txpwr_idx_comp *tic); -+ -+ void (*hal_dm_watchdog)(_adapter *padapter); -+#ifdef CONFIG_LPS_LCLK_WD_TIMER -+ void (*hal_dm_watchdog_in_lps)(_adapter *padapter); -+#endif -+ -+ void (*SetHwRegHandler)(_adapter *padapter, u8 variable, u8 *val); -+ void (*GetHwRegHandler)(_adapter *padapter, u8 variable, u8 *val); -+ -+ u8(*GetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); -+ u8(*SetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); -+ -+ void (*GetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, PVOID pValue2); -+ void (*SetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, BOOLEAN bSet); -+ -+ void (*UpdateRAMaskHandler)(_adapter *padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level); -+ void (*SetBeaconRelatedRegistersHandler)(_adapter *padapter); -+ -+ u8(*interface_ps_func)(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val); -+ -+ u32(*read_bbreg)(_adapter *padapter, u32 RegAddr, u32 BitMask); -+ void (*write_bbreg)(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); -+ u32(*read_rfreg)(_adapter *padapter, u8 eRFPath, u32 RegAddr, u32 BitMask); -+ void (*write_rfreg)(_adapter *padapter, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data); -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ s32(*hostap_mgnt_xmit_entry)(_adapter *padapter, _pkt *pkt); -+#endif -+ -+ void (*EfusePowerSwitch)(_adapter *padapter, u8 bWrite, u8 PwrState); -+ void (*BTEfusePowerSwitch)(_adapter *padapter, u8 bWrite, u8 PwrState); -+ void (*ReadEFuse)(_adapter *padapter, u8 efuseType, u16 _offset, u16 _size_byte, u8 *pbuf, BOOLEAN bPseudoTest); -+ void (*EFUSEGetEfuseDefinition)(_adapter *padapter, u8 efuseType, u8 type, void *pOut, BOOLEAN bPseudoTest); -+ u16(*EfuseGetCurrentSize)(_adapter *padapter, u8 efuseType, BOOLEAN bPseudoTest); -+ int (*Efuse_PgPacketRead)(_adapter *padapter, u8 offset, u8 *data, BOOLEAN bPseudoTest); -+ int (*Efuse_PgPacketWrite)(_adapter *padapter, u8 offset, u8 word_en, u8 *data, BOOLEAN bPseudoTest); -+ u8(*Efuse_WordEnableDataWrite)(_adapter *padapter, u16 efuse_addr, u8 word_en, u8 *data, BOOLEAN bPseudoTest); -+ BOOLEAN(*Efuse_PgPacketWrite_BT)(_adapter *padapter, u8 offset, u8 word_en, u8 *data, BOOLEAN bPseudoTest); -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ void (*sreset_init_value)(_adapter *padapter); -+ void (*sreset_reset_value)(_adapter *padapter); -+ void (*silentreset)(_adapter *padapter); -+ void (*sreset_xmit_status_check)(_adapter *padapter); -+ void (*sreset_linked_status_check)(_adapter *padapter); -+ u8(*sreset_get_wifi_status)(_adapter *padapter); -+ bool (*sreset_inprogress)(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_IOL -+ int (*IOL_exec_cmds_sync)(_adapter *padapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt); -+#endif -+ -+ void (*hal_notch_filter)(_adapter *adapter, bool enable); -+#ifdef RTW_HALMAC -+ void (*hal_mac_c2h_handler)(_adapter *adapter, u8 *pbuf, u16 length); -+#else -+ s32(*c2h_handler)(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); -+#endif -+ s32(*fill_h2c_cmd)(PADAPTER, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+ void (*fill_fake_txdesc)(PADAPTER, u8 *pDesc, u32 BufferLen, -+ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+ s32(*fw_dl)(_adapter *adapter, u8 wowlan); -+ -+ void (*clear_interrupt)(_adapter *padapter); -+ -+ u8(*hal_get_tx_buff_rsvd_page_num)(_adapter *adapter, bool wowlan); -+#ifdef CONFIG_GPIO_API -+ void (*update_hisr_hsisr_ind)(PADAPTER padapter, u32 flag); -+ int (*hal_gpio_func_check)(_adapter *padapter, u8 gpio_num); -+ void (*hal_gpio_multi_func_reset)(_adapter *padapter, u8 gpio_num); -+#endif -+ void (*fw_correct_bcn)(PADAPTER padapter); -+ -+#ifdef RTW_HALMAC -+ u8(*init_mac_register)(PADAPTER); -+ u8(*init_phy)(PADAPTER); -+#endif /* RTW_HALMAC */ -+}; -+ -+typedef enum _RT_EEPROM_TYPE { -+ EEPROM_93C46, -+ EEPROM_93C56, -+ EEPROM_BOOT_EFUSE, -+} RT_EEPROM_TYPE, *PRT_EEPROM_TYPE; -+ -+ -+ -+#define RF_CHANGE_BY_INIT 0 -+#define RF_CHANGE_BY_IPS BIT28 -+#define RF_CHANGE_BY_PS BIT29 -+#define RF_CHANGE_BY_HW BIT30 -+#define RF_CHANGE_BY_SW BIT31 -+ -+typedef enum _HARDWARE_TYPE { -+ HARDWARE_TYPE_RTL8188EE, -+ HARDWARE_TYPE_RTL8188EU, -+ HARDWARE_TYPE_RTL8188ES, -+ /* NEW_GENERATION_IC */ -+ HARDWARE_TYPE_RTL8192EE, -+ HARDWARE_TYPE_RTL8192EU, -+ HARDWARE_TYPE_RTL8192ES, -+ HARDWARE_TYPE_RTL8812E, -+ HARDWARE_TYPE_RTL8812AU, -+ HARDWARE_TYPE_RTL8811AU, -+ HARDWARE_TYPE_RTL8821E, -+ HARDWARE_TYPE_RTL8821U, -+ HARDWARE_TYPE_RTL8821S, -+ HARDWARE_TYPE_RTL8723BE, -+ HARDWARE_TYPE_RTL8723BU, -+ HARDWARE_TYPE_RTL8723BS, -+ HARDWARE_TYPE_RTL8814AE, -+ HARDWARE_TYPE_RTL8814AU, -+ HARDWARE_TYPE_RTL8814AS, -+ HARDWARE_TYPE_RTL8821BE, -+ HARDWARE_TYPE_RTL8821BU, -+ HARDWARE_TYPE_RTL8821BS, -+ HARDWARE_TYPE_RTL8822BE, -+ HARDWARE_TYPE_RTL8822BU, -+ HARDWARE_TYPE_RTL8822BS, -+ HARDWARE_TYPE_RTL8703BE, -+ HARDWARE_TYPE_RTL8703BU, -+ HARDWARE_TYPE_RTL8703BS, -+ HARDWARE_TYPE_RTL8188FE, -+ HARDWARE_TYPE_RTL8188FU, -+ HARDWARE_TYPE_RTL8188FS, -+ HARDWARE_TYPE_RTL8723DE, -+ HARDWARE_TYPE_RTL8723DU, -+ HARDWARE_TYPE_RTL8723DS, -+ HARDWARE_TYPE_RTL8821CE, -+ HARDWARE_TYPE_RTL8821CU, -+ HARDWARE_TYPE_RTL8821CS, -+ HARDWARE_TYPE_MAX, -+} HARDWARE_TYPE; -+ -+#define IS_NEW_GENERATION_IC(_Adapter) (rtw_get_hw_type(_Adapter) >= HARDWARE_TYPE_RTL8192EE) -+/* -+ * RTL8188E Series -+ * */ -+#define IS_HARDWARE_TYPE_8188EE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188EE) -+#define IS_HARDWARE_TYPE_8188EU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188EU) -+#define IS_HARDWARE_TYPE_8188ES(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188ES) -+#define IS_HARDWARE_TYPE_8188E(_Adapter) \ -+ (IS_HARDWARE_TYPE_8188EE(_Adapter) || IS_HARDWARE_TYPE_8188EU(_Adapter) || IS_HARDWARE_TYPE_8188ES(_Adapter)) -+ -+/* RTL8812 Series */ -+#define IS_HARDWARE_TYPE_8812E(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8812E) -+#define IS_HARDWARE_TYPE_8812AU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8812AU) -+#define IS_HARDWARE_TYPE_8812(_Adapter) \ -+ (IS_HARDWARE_TYPE_8812E(_Adapter) || IS_HARDWARE_TYPE_8812AU(_Adapter)) -+ -+/* RTL8821 Series */ -+#define IS_HARDWARE_TYPE_8821E(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821E) -+#define IS_HARDWARE_TYPE_8811AU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8811AU) -+#define IS_HARDWARE_TYPE_8821U(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821U || \ -+ rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8811AU) -+#define IS_HARDWARE_TYPE_8821S(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821S) -+#define IS_HARDWARE_TYPE_8821(_Adapter) \ -+ (IS_HARDWARE_TYPE_8821E(_Adapter) || IS_HARDWARE_TYPE_8821U(_Adapter) || IS_HARDWARE_TYPE_8821S(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_JAGUAR(_Adapter) \ -+ (IS_HARDWARE_TYPE_8812(_Adapter) || IS_HARDWARE_TYPE_8821(_Adapter)) -+ -+/* RTL8192E Series */ -+#define IS_HARDWARE_TYPE_8192EE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192EE) -+#define IS_HARDWARE_TYPE_8192EU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192EU) -+#define IS_HARDWARE_TYPE_8192ES(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192ES) -+ -+#define IS_HARDWARE_TYPE_8192E(_Adapter) \ -+ (IS_HARDWARE_TYPE_8192EE(_Adapter) || IS_HARDWARE_TYPE_8192EU(_Adapter) || IS_HARDWARE_TYPE_8192ES(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_8723BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723BE) -+#define IS_HARDWARE_TYPE_8723BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723BU) -+#define IS_HARDWARE_TYPE_8723BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723BS) -+ -+#define IS_HARDWARE_TYPE_8723B(_Adapter) \ -+ (IS_HARDWARE_TYPE_8723BE(_Adapter) || IS_HARDWARE_TYPE_8723BU(_Adapter) || IS_HARDWARE_TYPE_8723BS(_Adapter)) -+ -+/* RTL8814A Series */ -+#define IS_HARDWARE_TYPE_8814AE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814AE) -+#define IS_HARDWARE_TYPE_8814AU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814AU) -+#define IS_HARDWARE_TYPE_8814AS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814AS) -+ -+#define IS_HARDWARE_TYPE_8814A(_Adapter) \ -+ (IS_HARDWARE_TYPE_8814AE(_Adapter) || IS_HARDWARE_TYPE_8814AU(_Adapter) || IS_HARDWARE_TYPE_8814AS(_Adapter)) -+ -+/* RTL8703B Series */ -+#define IS_HARDWARE_TYPE_8703BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8703BE) -+#define IS_HARDWARE_TYPE_8703BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8703BS) -+#define IS_HARDWARE_TYPE_8703BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8703BU) -+#define IS_HARDWARE_TYPE_8703B(_Adapter) \ -+ (IS_HARDWARE_TYPE_8703BE(_Adapter) || IS_HARDWARE_TYPE_8703BU(_Adapter) || IS_HARDWARE_TYPE_8703BS(_Adapter)) -+ -+/* RTL8723D Series */ -+#define IS_HARDWARE_TYPE_8723DE(_Adapter)\ -+ (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723DE) -+#define IS_HARDWARE_TYPE_8723DS(_Adapter)\ -+ (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723DS) -+#define IS_HARDWARE_TYPE_8723DU(_Adapter)\ -+ (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8723DU) -+#define IS_HARDWARE_TYPE_8723D(_Adapter)\ -+ (IS_HARDWARE_TYPE_8723DE(_Adapter) || \ -+ IS_HARDWARE_TYPE_8723DU(_Adapter) || \ -+ IS_HARDWARE_TYPE_8723DS(_Adapter)) -+ -+/* RTL8188F Series */ -+#define IS_HARDWARE_TYPE_8188FE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188FE) -+#define IS_HARDWARE_TYPE_8188FS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188FS) -+#define IS_HARDWARE_TYPE_8188FU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188FU) -+#define IS_HARDWARE_TYPE_8188F(_Adapter) \ -+ (IS_HARDWARE_TYPE_8188FE(_Adapter) || IS_HARDWARE_TYPE_8188FU(_Adapter) || IS_HARDWARE_TYPE_8188FS(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_8821BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821BE) -+#define IS_HARDWARE_TYPE_8821BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821BU) -+#define IS_HARDWARE_TYPE_8821BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821BS) -+ -+#define IS_HARDWARE_TYPE_8821B(_Adapter) \ -+ (IS_HARDWARE_TYPE_8821BE(_Adapter) || IS_HARDWARE_TYPE_8821BU(_Adapter) || IS_HARDWARE_TYPE_8821BS(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_8822BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822BE) -+#define IS_HARDWARE_TYPE_8822BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822BU) -+#define IS_HARDWARE_TYPE_8822BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822BS) -+#define IS_HARDWARE_TYPE_8822B(_Adapter) \ -+ (IS_HARDWARE_TYPE_8822BE(_Adapter) || IS_HARDWARE_TYPE_8822BU(_Adapter) || IS_HARDWARE_TYPE_8822BS(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_8821CE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821CE) -+#define IS_HARDWARE_TYPE_8821CU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821CU) -+#define IS_HARDWARE_TYPE_8821CS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821CS) -+#define IS_HARDWARE_TYPE_8821C(_Adapter) \ -+ (IS_HARDWARE_TYPE_8821CE(_Adapter) || IS_HARDWARE_TYPE_8821CU(_Adapter) || IS_HARDWARE_TYPE_8821CS(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_JAGUAR2(_Adapter) \ -+ (IS_HARDWARE_TYPE_8814A(_Adapter) || IS_HARDWARE_TYPE_8821B(_Adapter) || IS_HARDWARE_TYPE_8822B(_Adapter) || IS_HARDWARE_TYPE_8821C(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(_Adapter) \ -+ (IS_HARDWARE_TYPE_JAGUAR(_Adapter) || IS_HARDWARE_TYPE_JAGUAR2(_Adapter)) -+ -+ -+ -+typedef enum _wowlan_subcode { -+ WOWLAN_ENABLE = 0, -+ WOWLAN_DISABLE = 1, -+ WOWLAN_AP_ENABLE = 2, -+ WOWLAN_AP_DISABLE = 3, -+ WOWLAN_PATTERN_CLEAN = 4 -+} wowlan_subcode; -+ -+struct wowlan_ioctl_param { -+ unsigned int subcode; -+ unsigned int subcode_value; -+ unsigned int wakeup_reason; -+}; -+ -+u8 rtw_hal_data_init(_adapter *padapter); -+void rtw_hal_data_deinit(_adapter *padapter); -+ -+void rtw_hal_def_value_init(_adapter *padapter); -+ -+void rtw_hal_free_data(_adapter *padapter); -+ -+void rtw_hal_dm_init(_adapter *padapter); -+void rtw_hal_dm_deinit(_adapter *padapter); -+void rtw_hal_sw_led_init(_adapter *padapter); -+void rtw_hal_sw_led_deinit(_adapter *padapter); -+ -+u32 rtw_hal_power_on(_adapter *padapter); -+void rtw_hal_power_off(_adapter *padapter); -+ -+uint rtw_hal_init(_adapter *padapter); -+uint rtw_hal_deinit(_adapter *padapter); -+void rtw_hal_stop(_adapter *padapter); -+void rtw_hal_set_hwreg(PADAPTER padapter, u8 variable, u8 *val); -+void rtw_hal_get_hwreg(PADAPTER padapter, u8 variable, u8 *val); -+ -+void rtw_hal_chip_configure(_adapter *padapter); -+void rtw_hal_read_chip_info(_adapter *padapter); -+void rtw_hal_read_chip_version(_adapter *padapter); -+ -+u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); -+u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); -+ -+void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, BOOLEAN bSet); -+void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, PVOID pValue2); -+ -+void rtw_hal_enable_interrupt(_adapter *padapter); -+void rtw_hal_disable_interrupt(_adapter *padapter); -+ -+u8 rtw_hal_check_ips_status(_adapter *padapter); -+ -+#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) -+ u32 rtw_hal_inirp_init(_adapter *padapter); -+ u32 rtw_hal_inirp_deinit(_adapter *padapter); -+#endif -+ -+#if defined(CONFIG_PCI_HCI) -+ void rtw_hal_irp_reset(_adapter *padapter); -+#endif -+ -+u8 rtw_hal_intf_ps_func(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val); -+ -+s32 rtw_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtw_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe); -+ -+s32 rtw_hal_init_xmit_priv(_adapter *padapter); -+void rtw_hal_free_xmit_priv(_adapter *padapter); -+ -+s32 rtw_hal_init_recv_priv(_adapter *padapter); -+void rtw_hal_free_recv_priv(_adapter *padapter); -+ -+void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level); -+void rtw_update_ramask(_adapter *padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level); -+ -+void rtw_hal_start_thread(_adapter *padapter); -+void rtw_hal_stop_thread(_adapter *padapter); -+ -+void rtw_hal_bcn_related_reg_setting(_adapter *padapter); -+ -+u32 rtw_hal_read_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask); -+void rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); -+u32 rtw_hal_read_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask); -+void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask, u32 Data); -+ -+#define PHY_QueryBBReg(Adapter, RegAddr, BitMask) rtw_hal_read_bbreg((Adapter), (RegAddr), (BitMask)) -+#define PHY_SetBBReg(Adapter, RegAddr, BitMask, Data) rtw_hal_write_bbreg((Adapter), (RegAddr), (BitMask), (Data)) -+#define PHY_QueryRFReg(Adapter, eRFPath, RegAddr, BitMask) rtw_hal_read_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask)) -+#define PHY_SetRFReg(Adapter, eRFPath, RegAddr, BitMask, Data) rtw_hal_write_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask), (Data)) -+ -+#define PHY_SetMacReg PHY_SetBBReg -+#define PHY_QueryMacReg PHY_QueryBBReg -+ -+#if defined(CONFIG_PCI_HCI) -+ s32 rtw_hal_interrupt_handler(_adapter *padapter); -+#endif -+#if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) -+ void rtw_hal_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+ -+void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80); -+void rtw_hal_dm_watchdog(_adapter *padapter); -+void rtw_hal_dm_watchdog_in_lps(_adapter *padapter); -+ -+void rtw_hal_set_tx_power_level(_adapter *padapter, u8 channel); -+void rtw_hal_get_tx_power_level(_adapter *padapter, s32 *powerlevel); -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ s32 rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt); -+#endif -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+void rtw_hal_sreset_init(_adapter *padapter); -+void rtw_hal_sreset_reset(_adapter *padapter); -+void rtw_hal_sreset_reset_value(_adapter *padapter); -+void rtw_hal_sreset_xmit_status_check(_adapter *padapter); -+void rtw_hal_sreset_linked_status_check(_adapter *padapter); -+u8 rtw_hal_sreset_get_wifi_status(_adapter *padapter); -+bool rtw_hal_sreset_inprogress(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_IOL -+int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt); -+#endif -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+s32 rtw_hal_xmit_thread_handler(_adapter *padapter); -+#endif -+ -+void rtw_hal_notch_filter(_adapter *adapter, bool enable); -+ -+#ifdef CONFIG_FW_C2H_REG -+bool rtw_hal_c2h_reg_hdr_parse(_adapter *adapter, u8 *buf, u8 *id, u8 *seq, u8 *plen, u8 **payload); -+bool rtw_hal_c2h_valid(_adapter *adapter, u8 *buf); -+s32 rtw_hal_c2h_evt_read(_adapter *adapter, u8 *buf); -+#endif -+ -+#ifdef CONFIG_FW_C2H_PKT -+bool rtw_hal_c2h_pkt_hdr_parse(_adapter *adapter, u8 *buf, u16 len, u8 *id, u8 *seq, u8 *plen, u8 **payload); -+#endif -+ -+s32 c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); -+#ifndef RTW_HALMAC -+s32 rtw_hal_c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); -+s32 rtw_hal_c2h_id_handle_directly(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); -+#endif -+ -+s32 rtw_hal_is_disable_sw_channel_plan(PADAPTER padapter); -+ -+s32 rtw_hal_macid_sleep(PADAPTER padapter, u8 macid); -+s32 rtw_hal_macid_wakeup(PADAPTER padapter, u8 macid); -+ -+s32 rtw_hal_fill_h2c_cmd(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+void rtw_hal_fill_fake_txdesc(_adapter *padapter, u8 *pDesc, u32 BufferLen, -+ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+u8 rtw_hal_get_txbuff_rsvd_page_num(_adapter *adapter, bool wowlan); -+ -+#ifdef CONFIG_GPIO_API -+void rtw_hal_update_hisr_hsisr_ind(_adapter *padapter, u32 flag); -+int rtw_hal_gpio_func_check(_adapter *padapter, u8 gpio_num); -+void rtw_hal_gpio_multi_func_reset(_adapter *padapter, u8 gpio_num); -+#endif -+ -+void rtw_hal_fw_correct_bcn(_adapter *padapter); -+s32 rtw_hal_fw_dl(_adapter *padapter, u8 wowlan); -+ -+void rtw_hal_clear_interrupt(_adapter *padapter); -+ -+void rtw_hal_set_tx_power_index(PADAPTER, u32 powerindex, u8 rfpath, u8 rate); -+u8 rtw_hal_get_tx_power_index(PADAPTER, u8 rfpath, u8 rate, u8 bandwidth, u8 channel,struct txpwr_idx_comp *tic); -+ -+u8 rtw_hal_ops_check(_adapter *padapter); -+ -+#ifdef RTW_HALMAC -+ u8 rtw_hal_init_mac_register(PADAPTER); -+ u8 rtw_hal_init_phy(PADAPTER); -+#endif /* RTW_HALMAC */ -+ -+#endif /* __HAL_INTF_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_pg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_pg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_pg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_pg.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,800 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PG_H__ -+#define __HAL_PG_H__ -+ -+#define PPG_BB_GAIN_2G_TX_OFFSET_MASK 0x0F -+#define PPG_BB_GAIN_2G_TXB_OFFSET_MASK 0xF0 -+ -+#define PPG_BB_GAIN_5G_TX_OFFSET_MASK 0x1F -+#define PPG_THERMAL_OFFSET_MASK 0x1F -+#define KFREE_BB_GAIN_2G_TX_OFFSET(_ppg_v) (((_ppg_v) == PPG_BB_GAIN_2G_TX_OFFSET_MASK) ? 0 : (((_ppg_v) & 0x01) ? ((_ppg_v) >> 1) : (-((_ppg_v) >> 1)))) -+#define KFREE_BB_GAIN_2G_TXB_OFFSET(_ppg_v) (((_ppg_v) == PPG_BB_GAIN_2G_TXB_OFFSET_MASK) ? 0 : (((_ppg_v) & 0x10) ? ((_ppg_v) >> 5) : (-((_ppg_v) >> 5)))) -+#define KFREE_BB_GAIN_5G_TX_OFFSET(_ppg_v) (((_ppg_v) == PPG_BB_GAIN_5G_TX_OFFSET_MASK) ? 0 : (((_ppg_v) & 0x01) ? ((_ppg_v) >> 1) : (-((_ppg_v) >> 1)))) -+#define KFREE_THERMAL_OFFSET(_ppg_v) (((_ppg_v) == PPG_THERMAL_OFFSET_MASK) ? 0 : (((_ppg_v) & 0x01) ? ((_ppg_v) >> 1) : (-((_ppg_v) >> 1)))) -+ -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 88EE/88EU/88ES -+ * **************************************************** */ -+#define EEPROM_TX_PWR_INX_88E 0x10 -+ -+#define EEPROM_ChannelPlan_88E 0xB8 -+#define EEPROM_XTAL_88E 0xB9 -+#define EEPROM_THERMAL_METER_88E 0xBA -+#define EEPROM_IQK_LCK_88E 0xBB -+ -+#define EEPROM_RF_BOARD_OPTION_88E 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_88E 0xC2 -+#define EEPROM_RF_BT_SETTING_88E 0xC3 -+#define EEPROM_VERSION_88E 0xC4 -+#define EEPROM_CustomID_88E 0xC5 -+#define EEPROM_RF_ANTENNA_OPT_88E 0xC9 -+#define EEPROM_COUNTRY_CODE_88E 0xCB -+ -+/* RTL88EE */ -+#define EEPROM_MAC_ADDR_88EE 0xD0 -+#define EEPROM_VID_88EE 0xD6 -+#define EEPROM_DID_88EE 0xD8 -+#define EEPROM_SVID_88EE 0xDA -+#define EEPROM_SMID_88EE 0xDC -+ -+/* RTL88EU */ -+#define EEPROM_MAC_ADDR_88EU 0xD7 -+#define EEPROM_VID_88EU 0xD0 -+#define EEPROM_PID_88EU 0xD2 -+#define EEPROM_USB_OPTIONAL_FUNCTION0 0xD4 /* 8188EU, 8192EU, 8812AU is the same */ -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8811AU 0x104 -+ -+/* RTL88ES */ -+#define EEPROM_MAC_ADDR_88ES 0x11A -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 8192EE/8192EU/8192ES -+ * **************************************************** */ -+#define GET_PG_KFREE_ON_8192E(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8192E(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define PPG_BB_GAIN_2G_TXA_OFFSET_8192E 0x1F6 -+#define PPG_THERMAL_OFFSET_8192E 0x1F5 -+ -+/* 0x10 ~ 0x63 = TX power area. */ -+#define EEPROM_TX_PWR_INX_8192E 0x10 -+ -+#define EEPROM_ChannelPlan_8192E 0xB8 -+#define EEPROM_XTAL_8192E 0xB9 -+#define EEPROM_THERMAL_METER_8192E 0xBA -+#define EEPROM_IQK_LCK_8192E 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8192E 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8192E 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8192E 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8192E 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_8192E 0xC2 -+#define EEPROM_RF_BT_SETTING_8192E 0xC3 -+#define EEPROM_VERSION_8192E 0xC4 -+#define EEPROM_CustomID_8192E 0xC5 -+#define EEPROM_TX_BBSWING_2G_8192E 0xC6 -+#define EEPROM_TX_BBSWING_5G_8192E 0xC7 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8192E 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8192E 0xC9 -+#define EEPROM_RFE_OPTION_8192E 0xCA -+#define EEPROM_RFE_OPTION_8188E 0xCA -+#define EEPROM_COUNTRY_CODE_8192E 0xCB -+ -+/* RTL8192EE */ -+#define EEPROM_MAC_ADDR_8192EE 0xD0 -+#define EEPROM_VID_8192EE 0xD6 -+#define EEPROM_DID_8192EE 0xD8 -+#define EEPROM_SVID_8192EE 0xDA -+#define EEPROM_SMID_8192EE 0xDC -+ -+/* RTL8192EU */ -+#define EEPROM_MAC_ADDR_8192EU 0xD7 -+#define EEPROM_VID_8192EU 0xD0 -+#define EEPROM_PID_8192EU 0xD2 -+#define EEPROM_PA_TYPE_8192EU 0xBC -+#define EEPROM_LNA_TYPE_2G_8192EU 0xBD -+#define EEPROM_LNA_TYPE_5G_8192EU 0xBF -+ -+/* RTL8192ES */ -+#define EEPROM_MAC_ADDR_8192ES 0x11A -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 8812AE/8812AU/8812AS -+ * **************************************************** -+ * 0x10 ~ 0x63 = TX power area. */ -+#define EEPROM_USB_MODE_8812 0x08 -+#define EEPROM_TX_PWR_INX_8812 0x10 -+ -+#define EEPROM_ChannelPlan_8812 0xB8 -+#define EEPROM_XTAL_8812 0xB9 -+#define EEPROM_THERMAL_METER_8812 0xBA -+#define EEPROM_IQK_LCK_8812 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8812 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8812 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8812 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8812 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_8812 0xC2 -+#define EEPROM_RF_BT_SETTING_8812 0xC3 -+#define EEPROM_VERSION_8812 0xC4 -+#define EEPROM_CustomID_8812 0xC5 -+#define EEPROM_TX_BBSWING_2G_8812 0xC6 -+#define EEPROM_TX_BBSWING_5G_8812 0xC7 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8812 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8812 0xC9 -+#define EEPROM_RFE_OPTION_8812 0xCA -+#define EEPROM_COUNTRY_CODE_8812 0xCB -+ -+/* RTL8812AE */ -+#define EEPROM_MAC_ADDR_8812AE 0xD0 -+#define EEPROM_VID_8812AE 0xD6 -+#define EEPROM_DID_8812AE 0xD8 -+#define EEPROM_SVID_8812AE 0xDA -+#define EEPROM_SMID_8812AE 0xDC -+ -+/* RTL8812AU */ -+#define EEPROM_MAC_ADDR_8812AU 0xD7 -+#define EEPROM_VID_8812AU 0xD0 -+#define EEPROM_PID_8812AU 0xD2 -+#define EEPROM_PA_TYPE_8812AU 0xBC -+#define EEPROM_LNA_TYPE_2G_8812AU 0xBD -+#define EEPROM_LNA_TYPE_5G_8812AU 0xBF -+ -+/* RTL8814AU */ -+#define EEPROM_MAC_ADDR_8814AU 0xD8 -+#define EEPROM_VID_8814AU 0xD0 -+#define EEPROM_PID_8814AU 0xD2 -+#define EEPROM_PA_TYPE_8814AU 0xBC -+#define EEPROM_LNA_TYPE_2G_8814AU 0xBD -+#define EEPROM_LNA_TYPE_5G_8814AU 0xBF -+ -+/* RTL8814AE */ -+#define EEPROM_MAC_ADDR_8814AE 0xD0 -+#define EEPROM_VID_8814AE 0xD6 -+#define EEPROM_DID_8814AE 0xD8 -+#define EEPROM_SVID_8814AE 0xDA -+#define EEPROM_SMID_8814AE 0xDC -+ -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 8814AU -+ * **************************************************** */ -+#define GET_PG_KFREE_ON_8814A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8814A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+#define GET_PG_TX_POWER_TRACKING_MODE_8814A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 6, 2) -+ -+#define KFREE_GAIN_DATA_LENGTH_8814A 22 -+ -+#define PPG_BB_GAIN_2G_TXBA_OFFSET_8814A 0x3EE -+ -+#define PPG_THERMAL_OFFSET_8814A 0x3EF -+ -+#define EEPROM_TX_PWR_INX_8814 0x10 -+#define EEPROM_USB_MODE_8814A 0x0E -+#define EEPROM_ChannelPlan_8814 0xB8 -+#define EEPROM_XTAL_8814 0xB9 -+#define EEPROM_THERMAL_METER_8814 0xBA -+#define EEPROM_IQK_LCK_8814 0xBB -+ -+ -+#define EEPROM_PA_TYPE_8814 0xBC -+#define EEPROM_LNA_TYPE_AB_2G_8814 0xBD -+#define EEPROM_LNA_TYPE_CD_2G_8814 0xBE -+#define EEPROM_LNA_TYPE_AB_5G_8814 0xBF -+#define EEPROM_LNA_TYPE_CD_5G_8814 0xC0 -+#define EEPROM_RF_BOARD_OPTION_8814 0xC1 -+#define EEPROM_RF_BT_SETTING_8814 0xC3 -+#define EEPROM_VERSION_8814 0xC4 -+#define EEPROM_CustomID_8814 0xC5 -+#define EEPROM_TX_BBSWING_2G_8814 0xC6 -+#define EEPROM_TX_BBSWING_5G_8814 0xC7 -+#define EEPROM_TRX_ANTENNA_OPTION_8814 0xC9 -+#define EEPROM_RFE_OPTION_8814 0xCA -+#define EEPROM_COUNTRY_CODE_8814 0xCB -+ -+/*Extra Info for 8814A Initial Gain Fine Tune suggested by Willis, JIRA: MP123*/ -+#define EEPROM_IG_OFFSET_4_AB_2G_8814A 0x120 -+#define EEPROM_IG_OFFSET_4_CD_2G_8814A 0x121 -+#define EEPROM_IG_OFFSET_4_AB_5GL_8814A 0x122 -+#define EEPROM_IG_OFFSET_4_CD_5GL_8814A 0x123 -+#define EEPROM_IG_OFFSET_4_AB_5GM_8814A 0x124 -+#define EEPROM_IG_OFFSET_4_CD_5GM_8814A 0x125 -+#define EEPROM_IG_OFFSET_4_AB_5GH_8814A 0x126 -+#define EEPROM_IG_OFFSET_4_CD_5GH_8814A 0x127 -+ -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 8821AE/8821AU/8821AS -+ * **************************************************** */ -+ -+#define GET_PG_KFREE_ON_8821A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8821A(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define PPG_BB_GAIN_2G_TXA_OFFSET_8821A 0x1F6 -+#define PPG_THERMAL_OFFSET_8821A 0x1F5 -+#define PPG_BB_GAIN_5GLB1_TXA_OFFSET_8821A 0x1F4 -+#define PPG_BB_GAIN_5GLB2_TXA_OFFSET_8821A 0x1F3 -+#define PPG_BB_GAIN_5GMB1_TXA_OFFSET_8821A 0x1F2 -+#define PPG_BB_GAIN_5GMB2_TXA_OFFSET_8821A 0x1F1 -+#define PPG_BB_GAIN_5GHB_TXA_OFFSET_8821A 0x1F0 -+ -+#define EEPROM_TX_PWR_INX_8821 0x10 -+ -+#define EEPROM_ChannelPlan_8821 0xB8 -+#define EEPROM_XTAL_8821 0xB9 -+#define EEPROM_THERMAL_METER_8821 0xBA -+#define EEPROM_IQK_LCK_8821 0xBB -+ -+ -+#define EEPROM_RF_BOARD_OPTION_8821 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_8821 0xC2 -+#define EEPROM_RF_BT_SETTING_8821 0xC3 -+#define EEPROM_VERSION_8821 0xC4 -+#define EEPROM_CustomID_8821 0xC5 -+#define EEPROM_RF_ANTENNA_OPT_8821 0xC9 -+ -+/* RTL8821AE */ -+#define EEPROM_MAC_ADDR_8821AE 0xD0 -+#define EEPROM_VID_8821AE 0xD6 -+#define EEPROM_DID_8821AE 0xD8 -+#define EEPROM_SVID_8821AE 0xDA -+#define EEPROM_SMID_8821AE 0xDC -+ -+/* RTL8821AU */ -+#define EEPROM_PA_TYPE_8821AU 0xBC -+#define EEPROM_LNA_TYPE_8821AU 0xBF -+ -+/* RTL8821AS */ -+#define EEPROM_MAC_ADDR_8821AS 0x11A -+ -+/* RTL8821AU */ -+#define EEPROM_MAC_ADDR_8821AU 0x107 -+#define EEPROM_VID_8821AU 0x100 -+#define EEPROM_PID_8821AU 0x102 -+ -+ -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 8192 SE/SU -+ * **************************************************** */ -+#define EEPROM_VID_92SE 0x0A -+#define EEPROM_DID_92SE 0x0C -+#define EEPROM_SVID_92SE 0x0E -+#define EEPROM_SMID_92SE 0x10 -+ -+#define EEPROM_MAC_ADDR_92S 0x12 -+ -+#define EEPROM_TSSI_A_92SE 0x74 -+#define EEPROM_TSSI_B_92SE 0x75 -+ -+#define EEPROM_Version_92SE 0x7C -+ -+ -+#define EEPROM_VID_92SU 0x08 -+#define EEPROM_PID_92SU 0x0A -+ -+#define EEPROM_Version_92SU 0x50 -+#define EEPROM_TSSI_A_92SU 0x6b -+#define EEPROM_TSSI_B_92SU 0x6c -+ -+/* ==================================================== -+ EEPROM/Efuse PG Offset for 8188FE/8188FU/8188FS -+ ==================================================== -+ */ -+ -+#define GET_PG_KFREE_ON_8188F(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8188F(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define PPG_BB_GAIN_2G_TXA_OFFSET_8188F 0xEE -+#define PPG_THERMAL_OFFSET_8188F 0xEF -+ -+/* 0x10 ~ 0x63 = TX power area. */ -+#define EEPROM_TX_PWR_INX_8188F 0x10 -+ -+#define EEPROM_ChannelPlan_8188F 0xB8 -+#define EEPROM_XTAL_8188F 0xB9 -+#define EEPROM_THERMAL_METER_8188F 0xBA -+#define EEPROM_IQK_LCK_8188F 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8188F 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8188F 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8188F 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8188F 0xC1 -+#define EEPROM_FEATURE_OPTION_8188F 0xC2 -+#define EEPROM_RF_BT_SETTING_8188F 0xC3 -+#define EEPROM_VERSION_8188F 0xC4 -+#define EEPROM_CustomID_8188F 0xC5 -+#define EEPROM_TX_BBSWING_2G_8188F 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8188F 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8188F 0xC9 -+#define EEPROM_RFE_OPTION_8188F 0xCA -+#define EEPROM_COUNTRY_CODE_8188F 0xCB -+#define EEPROM_CUSTOMER_ID_8188F 0x7F -+#define EEPROM_SUBCUSTOMER_ID_8188F 0x59 -+ -+/* RTL8188FU */ -+#define EEPROM_MAC_ADDR_8188FU 0xD7 -+#define EEPROM_VID_8188FU 0xD0 -+#define EEPROM_PID_8188FU 0xD2 -+#define EEPROM_PA_TYPE_8188FU 0xBC -+#define EEPROM_LNA_TYPE_2G_8188FU 0xBD -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8188FU 0xD4 -+ -+/* RTL8188FS */ -+#define EEPROM_MAC_ADDR_8188FS 0x11A -+#define EEPROM_Voltage_ADDR_8188F 0x8 -+ -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 8723BE/8723BU/8723BS -+ * **************************************************** -+ * 0x10 ~ 0x63 = TX power area. */ -+#define EEPROM_TX_PWR_INX_8723B 0x10 -+ -+#define EEPROM_ChannelPlan_8723B 0xB8 -+#define EEPROM_XTAL_8723B 0xB9 -+#define EEPROM_THERMAL_METER_8723B 0xBA -+#define EEPROM_IQK_LCK_8723B 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8723B 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8723B 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8723B 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8723B 0xC1 -+#define EEPROM_FEATURE_OPTION_8723B 0xC2 -+#define EEPROM_RF_BT_SETTING_8723B 0xC3 -+#define EEPROM_VERSION_8723B 0xC4 -+#define EEPROM_CustomID_8723B 0xC5 -+#define EEPROM_TX_BBSWING_2G_8723B 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8723B 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8723B 0xC9 -+#define EEPROM_RFE_OPTION_8723B 0xCA -+#define EEPROM_COUNTRY_CODE_8723B 0xCB -+ -+/* RTL8723BE */ -+#define EEPROM_MAC_ADDR_8723BE 0xD0 -+#define EEPROM_VID_8723BE 0xD6 -+#define EEPROM_DID_8723BE 0xD8 -+#define EEPROM_SVID_8723BE 0xDA -+#define EEPROM_SMID_8723BE 0xDC -+ -+/* RTL8723BU */ -+#define EEPROM_MAC_ADDR_8723BU 0x107 -+#define EEPROM_VID_8723BU 0x100 -+#define EEPROM_PID_8723BU 0x102 -+#define EEPROM_PA_TYPE_8723BU 0xBC -+#define EEPROM_LNA_TYPE_2G_8723BU 0xBD -+ -+ -+/* RTL8723BS */ -+#define EEPROM_MAC_ADDR_8723BS 0x11A -+#define EEPROM_Voltage_ADDR_8723B 0x8 -+ -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 8703B -+ * **************************************************** */ -+#define GET_PG_KFREE_ON_8703B(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8703B(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define PPG_BB_GAIN_2G_TXA_OFFSET_8703B 0xEE -+#define PPG_THERMAL_OFFSET_8703B 0xEF -+ -+#define EEPROM_TX_PWR_INX_8703B 0x10 -+ -+#define EEPROM_ChannelPlan_8703B 0xB8 -+#define EEPROM_XTAL_8703B 0xB9 -+#define EEPROM_THERMAL_METER_8703B 0xBA -+#define EEPROM_IQK_LCK_8703B 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8703B 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8703B 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8703B 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8703B 0xC1 -+#define EEPROM_FEATURE_OPTION_8703B 0xC2 -+#define EEPROM_RF_BT_SETTING_8703B 0xC3 -+#define EEPROM_VERSION_8703B 0xC4 -+#define EEPROM_CustomID_8703B 0xC5 -+#define EEPROM_TX_BBSWING_2G_8703B 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8703B 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8703B 0xC9 -+#define EEPROM_RFE_OPTION_8703B 0xCA -+#define EEPROM_COUNTRY_CODE_8703B 0xCB -+ -+/* RTL8703BU */ -+#define EEPROM_MAC_ADDR_8703BU 0x107 -+#define EEPROM_VID_8703BU 0x100 -+#define EEPROM_PID_8703BU 0x102 -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8703BU 0x104 -+#define EEPROM_PA_TYPE_8703BU 0xBC -+#define EEPROM_LNA_TYPE_2G_8703BU 0xBD -+ -+/* RTL8703BS */ -+#define EEPROM_MAC_ADDR_8703BS 0x11A -+#define EEPROM_Voltage_ADDR_8703B 0x8 -+ -+/* -+ * ==================================================== -+ * EEPROM/Efuse PG Offset for 8822B -+ * ==================================================== -+ */ -+#define GET_PG_KFREE_ON_8822B(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8822B(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define PPG_BB_GAIN_2G_TXA_OFFSET_8822B 0xEE -+#define PPG_THERMAL_OFFSET_8822B 0xEF -+ -+#define EEPROM_TX_PWR_INX_8822B 0x10 -+ -+#define EEPROM_ChannelPlan_8822B 0xB8 -+#define EEPROM_XTAL_8822B 0xB9 -+#define EEPROM_THERMAL_METER_8822B 0xBA -+#define EEPROM_IQK_LCK_8822B 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8822B 0xBC -+/* PATH A & PATH B */ -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_AB_8822B 0xBD -+/* PATH C & PATH D */ -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_CD_8822B 0xBE -+/* PATH A & PATH B */ -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_AB_8822B 0xBF -+/* PATH C & PATH D */ -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_CD_8822B 0xC0 -+ -+#define EEPROM_RF_BOARD_OPTION_8822B 0xC1 -+#define EEPROM_FEATURE_OPTION_8822B 0xC2 -+#define EEPROM_RF_BT_SETTING_8822B 0xC3 -+#define EEPROM_VERSION_8822B 0xC4 -+#define EEPROM_CustomID_8822B 0xC5 -+#define EEPROM_TX_BBSWING_2G_8822B 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8822B 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8822B 0xC9 -+#define EEPROM_RFE_OPTION_8822B 0xCA -+#define EEPROM_COUNTRY_CODE_8822B 0xCB -+ -+/* RTL8822BU */ -+#define EEPROM_MAC_ADDR_8822BU 0x107 -+#define EEPROM_VID_8822BU 0x100 -+#define EEPROM_PID_8822BU 0x102 -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8822BU 0x104 -+#define EEPROM_USB_MODE_8822BU 0x06 -+ -+/* RTL8822BS */ -+#define EEPROM_MAC_ADDR_8822BS 0x11A -+ -+/* RTL8822BE */ -+#define EEPROM_MAC_ADDR_8822BE 0xD0 -+/* -+ * ==================================================== -+ * EEPROM/Efuse PG Offset for 8821C -+ * ==================================================== -+ */ -+#define GET_PG_KFREE_ON_8821C(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8821C(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define PPG_BB_GAIN_2G_TXA_OFFSET_8821C 0xEE -+#define PPG_THERMAL_OFFSET_8821C 0xEF -+ -+#define EEPROM_TX_PWR_INX_8821C 0x10 -+ -+#define EEPROM_ChannelPlan_8821C 0xB8 -+#define EEPROM_XTAL_8821C 0xB9 -+#define EEPROM_THERMAL_METER_8821C 0xBA -+#define EEPROM_IQK_LCK_8821C 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8821C 0xBC -+/* PATH A & PATH B */ -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_AB_8821C 0xBD -+/* PATH C & PATH D */ -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_CD_8821C 0xBE -+/* PATH A & PATH B */ -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_AB_8821C 0xBF -+/* PATH C & PATH D */ -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_CD_8821C 0xC0 -+ -+#define EEPROM_RF_BOARD_OPTION_8821C 0xC1 -+#define EEPROM_FEATURE_OPTION_8821C 0xC2 -+#define EEPROM_RF_BT_SETTING_8821C 0xC3 -+#define EEPROM_VERSION_8821C 0xC4 -+#define EEPROM_CustomID_8821C 0xC5 -+#define EEPROM_TX_BBSWING_2G_8821C 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8821C 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8821C 0xC9 -+#define EEPROM_RFE_OPTION_8821C 0xCA -+#define EEPROM_COUNTRY_CODE_8821C 0xCB -+ -+/* RTL8821CU */ -+#define EEPROM_MAC_ADDR_8821CU 0x107 -+#define EEPROM_VID_8821CU 0x100 -+#define EEPROM_PID_8821CU 0x102 -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8821CU 0x104 -+#define EEPROM_USB_MODE_8821CU 0x06 -+ -+/* RTL8821CS */ -+#define EEPROM_MAC_ADDR_8821CS 0x11A -+ -+/* RTL8821CE */ -+#define EEPROM_MAC_ADDR_8821CE 0xD0 -+/* **************************************************** -+ * EEPROM/Efuse PG Offset for 8723D -+ * **************************************************** */ -+#define GET_PG_KFREE_ON_8723D(_pg_m) \ -+ LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) -+#define GET_PG_KFREE_THERMAL_K_ON_8723D(_pg_m) \ -+ LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) -+ -+#define PPG_8723D_S1 0 -+#define PPG_8723D_S0 1 -+ -+#define PPG_BB_GAIN_2G_TXA_OFFSET_8723D 0xEE -+#define PPG_BB_GAIN_2G_TX_OFFSET_8723D 0x1EE -+#define PPG_THERMAL_OFFSET_8723D 0xEF -+ -+#define EEPROM_TX_PWR_INX_8723D 0x10 -+ -+#define EEPROM_ChannelPlan_8723D 0xB8 -+#define EEPROM_XTAL_8723D 0xB9 -+#define EEPROM_THERMAL_METER_8723D 0xBA -+#define EEPROM_IQK_LCK_8723D 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8723D 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8723D 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8723D 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8723D 0xC1 -+#define EEPROM_FEATURE_OPTION_8723D 0xC2 -+#define EEPROM_RF_BT_SETTING_8723D 0xC3 -+#define EEPROM_VERSION_8723D 0xC4 -+#define EEPROM_CustomID_8723D 0xC5 -+#define EEPROM_TX_BBSWING_2G_8723D 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8723D 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8723D 0xC9 -+#define EEPROM_RFE_OPTION_8723D 0xCA -+#define EEPROM_COUNTRY_CODE_8723D 0xCB -+ -+/* RTL8723DE */ -+#define EEPROM_MAC_ADDR_8723DE 0xD0 -+#define EEPROM_VID_8723DE 0xD6 -+#define EEPROM_DID_8723DE 0xD8 -+#define EEPROM_SVID_8723DE 0xDA -+#define EEPROM_SMID_8723DE 0xDC -+ -+/* RTL8723DU */ -+#define EEPROM_MAC_ADDR_8723DU 0x107 -+#define EEPROM_VID_8723DU 0x100 -+#define EEPROM_PID_8723DU 0x102 -+#define EEPROM_USB_OPTIONAL_FUNCTION0_8723DU 0x104 -+ -+/* RTL8723BS */ -+#define EEPROM_MAC_ADDR_8723DS 0x11A -+#define EEPROM_Voltage_ADDR_8723D 0x8 -+ -+/* **************************************************** -+ * EEPROM/Efuse Value Type -+ * **************************************************** */ -+#define EETYPE_TX_PWR 0x0 -+/* **************************************************** -+ * EEPROM/Efuse Default Value -+ * **************************************************** */ -+#define EEPROM_CID_DEFAULT 0x0 -+#define EEPROM_CID_DEFAULT_EXT 0xFF /* Reserved for Realtek */ -+#define EEPROM_CID_TOSHIBA 0x4 -+#define EEPROM_CID_CCX 0x10 -+#define EEPROM_CID_QMI 0x0D -+#define EEPROM_CID_WHQL 0xFE -+ -+#define EEPROM_CHANNEL_PLAN_FCC 0x0 -+#define EEPROM_CHANNEL_PLAN_IC 0x1 -+#define EEPROM_CHANNEL_PLAN_ETSI 0x2 -+#define EEPROM_CHANNEL_PLAN_SPAIN 0x3 -+#define EEPROM_CHANNEL_PLAN_FRANCE 0x4 -+#define EEPROM_CHANNEL_PLAN_MKK 0x5 -+#define EEPROM_CHANNEL_PLAN_MKK1 0x6 -+#define EEPROM_CHANNEL_PLAN_ISRAEL 0x7 -+#define EEPROM_CHANNEL_PLAN_TELEC 0x8 -+#define EEPROM_CHANNEL_PLAN_GLOBAL_DOMAIN 0x9 -+#define EEPROM_CHANNEL_PLAN_WORLD_WIDE_13 0xA -+#define EEPROM_CHANNEL_PLAN_NCC_TAIWAN 0xB -+#define EEPROM_CHANNEL_PLAN_CHIAN 0XC -+#define EEPROM_CHANNEL_PLAN_SINGAPORE_INDIA_MEXICO 0XD -+#define EEPROM_CHANNEL_PLAN_KOREA 0xE -+#define EEPROM_CHANNEL_PLAN_TURKEY 0xF -+#define EEPROM_CHANNEL_PLAN_JAPAN 0x10 -+#define EEPROM_CHANNEL_PLAN_FCC_NO_DFS 0x11 -+#define EEPROM_CHANNEL_PLAN_JAPAN_NO_DFS 0x12 -+#define EEPROM_CHANNEL_PLAN_WORLD_WIDE_5G 0x13 -+#define EEPROM_CHANNEL_PLAN_TAIWAN_NO_DFS 0x14 -+ -+#define EEPROM_USB_OPTIONAL1 0xE -+#define EEPROM_CHANNEL_PLAN_BY_HW_MASK 0x80 -+ -+#define RTL_EEPROM_ID 0x8129 -+#define EEPROM_Default_TSSI 0x0 -+#define EEPROM_Default_BoardType 0x02 -+#define EEPROM_Default_ThermalMeter 0x12 -+#define EEPROM_Default_ThermalMeter_92SU 0x7 -+#define EEPROM_Default_ThermalMeter_88E 0x18 -+#define EEPROM_Default_ThermalMeter_8812 0x18 -+#define EEPROM_Default_ThermalMeter_8192E 0x1A -+#define EEPROM_Default_ThermalMeter_8723B 0x18 -+#define EEPROM_Default_ThermalMeter_8703B 0x18 -+#define EEPROM_Default_ThermalMeter_8723D 0x18 -+#define EEPROM_Default_ThermalMeter_8188F 0x18 -+#define EEPROM_Default_ThermalMeter_8814A 0x18 -+ -+ -+#define EEPROM_Default_CrystalCap 0x0 -+#define EEPROM_Default_CrystalCap_8723A 0x20 -+#define EEPROM_Default_CrystalCap_88E 0x20 -+#define EEPROM_Default_CrystalCap_8812 0x20 -+#define EEPROM_Default_CrystalCap_8814 0x20 -+#define EEPROM_Default_CrystalCap_8192E 0x20 -+#define EEPROM_Default_CrystalCap_8723B 0x20 -+#define EEPROM_Default_CrystalCap_8703B 0x20 -+#define EEPROM_Default_CrystalCap_8723D 0x20 -+#define EEPROM_Default_CrystalCap_8188F 0x20 -+#define EEPROM_Default_CrystalFreq 0x0 -+#define EEPROM_Default_TxPowerLevel_92C 0x22 -+#define EEPROM_Default_TxPowerLevel_2G 0x2C -+#define EEPROM_Default_TxPowerLevel_5G 0x22 -+#define EEPROM_Default_TxPowerLevel 0x22 -+#define EEPROM_Default_HT40_2SDiff 0x0 -+#define EEPROM_Default_HT20_Diff 2 -+#define EEPROM_Default_LegacyHTTxPowerDiff 0x3 -+#define EEPROM_Default_LegacyHTTxPowerDiff_92C 0x3 -+#define EEPROM_Default_LegacyHTTxPowerDiff_92D 0x4 -+#define EEPROM_Default_HT40_PwrMaxOffset 0 -+#define EEPROM_Default_HT20_PwrMaxOffset 0 -+ -+#define EEPROM_Default_PID 0x1234 -+#define EEPROM_Default_VID 0x5678 -+#define EEPROM_Default_CustomerID 0xAB -+#define EEPROM_Default_CustomerID_8188E 0x00 -+#define EEPROM_Default_SubCustomerID 0xCD -+#define EEPROM_Default_Version 0 -+ -+#define EEPROM_Default_externalPA_C9 0x00 -+#define EEPROM_Default_externalPA_CC 0xFF -+#define EEPROM_Default_internalPA_SP3T_C9 0xAA -+#define EEPROM_Default_internalPA_SP3T_CC 0xAF -+#define EEPROM_Default_internalPA_SPDT_C9 0xAA -+#ifdef CONFIG_PCI_HCI -+ #define EEPROM_Default_internalPA_SPDT_CC 0xA0 -+#else -+ #define EEPROM_Default_internalPA_SPDT_CC 0xFA -+#endif -+#define EEPROM_Default_PAType 0 -+#define EEPROM_Default_LNAType 0 -+ -+/* New EFUSE default value */ -+#define EEPROM_DEFAULT_CHANNEL_PLAN 0x7F -+#define EEPROM_DEFAULT_BOARD_OPTION 0x00 -+#define EEPROM_DEFAULT_RFE_OPTION_8192E 0xFF -+#define EEPROM_DEFAULT_RFE_OPTION_8188E 0xFF -+#define EEPROM_DEFAULT_RFE_OPTION 0x04 -+#define EEPROM_DEFAULT_FEATURE_OPTION 0x00 -+#define EEPROM_DEFAULT_BT_OPTION 0x10 -+ -+ -+#define EEPROM_DEFAULT_TX_CALIBRATE_RATE 0x00 -+ -+/* PCIe related */ -+#define EEPROM_PCIE_DEV_CAP_01 0xE0 /* Express device capability in PCIe configuration space, i.e., map to offset 0x74 */ -+#define EEPROM_PCIE_DEV_CAP_02 0xE1 /* Express device capability in PCIe configuration space, i.e., map to offset 0x75 */ -+ -+ -+/* -+ * For VHT series TX power by rate table. -+ * VHT TX power by rate off setArray = -+ * Band:-2G&5G = 0 / 1 -+ * RF: at most 4*4 = ABCD=0/1/2/3 -+ * CCK=0 OFDM=1/2 HT-MCS 0-15=3/4/56 VHT=7/8/9/10/11 -+ * */ -+#define TX_PWR_BY_RATE_NUM_BAND 2 -+#define TX_PWR_BY_RATE_NUM_RF 4 -+#define TX_PWR_BY_RATE_NUM_RATE 84 -+ -+#define TXPWR_LMT_MAX_RF 4 -+ -+/* ---------------------------------------------------------------------------- -+ * EEPROM/EFUSE data structure definition. -+ * ---------------------------------------------------------------------------- */ -+ -+/* For 88E new structure */ -+ -+/* -+2.4G: -+{ -+{1,2}, -+{3,4,5}, -+{6,7,8}, -+{9,10,11}, -+{12,13}, -+{14} -+} -+ -+5G: -+{ -+{36,38,40}, -+{44,46,48}, -+{52,54,56}, -+{60,62,64}, -+{100,102,104}, -+{108,110,112}, -+{116,118,120}, -+{124,126,128}, -+{132,134,136}, -+{140,142,144}, -+{149,151,153}, -+{157,159,161}, -+{173,175,177}, -+} -+*/ -+#define MAX_RF_PATH 4 -+#define RF_PATH_MAX MAX_RF_PATH -+#define MAX_CHNL_GROUP_24G 6 -+#define MAX_CHNL_GROUP_5G 14 -+ -+/* It must always set to 4, otherwise read efuse table sequence will be wrong. */ -+#define MAX_TX_COUNT 4 -+ -+typedef struct _TxPowerInfo24G { -+ u8 IndexCCK_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G]; -+ u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G]; -+ /* If only one tx, only BW20 and OFDM are used. */ -+ s8 CCK_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+} TxPowerInfo24G, *PTxPowerInfo24G; -+ -+typedef struct _TxPowerInfo5G { -+ u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_5G]; -+ /* If only one tx, only BW20, OFDM, BW80 and BW160 are used. */ -+ s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW80_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW160_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+} TxPowerInfo5G, *PTxPowerInfo5G; -+ -+ -+typedef enum _BT_Ant_NUM { -+ Ant_x2 = 0, -+ Ant_x1 = 1 -+} BT_Ant_NUM, *PBT_Ant_NUM; -+ -+typedef enum _BT_CoType { -+ BT_2WIRE = 0, -+ BT_ISSC_3WIRE = 1, -+ BT_ACCEL = 2, -+ BT_CSR_BC4 = 3, -+ BT_CSR_BC8 = 4, -+ BT_RTL8756 = 5, -+ BT_RTL8723A = 6, -+ BT_RTL8821 = 7, -+ BT_RTL8723B = 8, -+ BT_RTL8192E = 9, -+ BT_RTL8814A = 10, -+ BT_RTL8812A = 11, -+ BT_RTL8703B = 12, -+ BT_RTL8822B = 13, -+ BT_RTL8723D = 14, -+ BT_RTL8821C = 15 -+} BT_CoType, *PBT_CoType; -+ -+typedef enum _BT_RadioShared { -+ BT_Radio_Shared = 0, -+ BT_Radio_Individual = 1, -+} BT_RadioShared, *PBT_RadioShared; -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_phy.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_phy.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_phy.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_phy.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,243 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_PHY_H__ -+#define __HAL_PHY_H__ -+ -+ -+#if DISABLE_BB_RF -+ #define HAL_FW_ENABLE 0 -+ #define HAL_MAC_ENABLE 0 -+ #define HAL_BB_ENABLE 0 -+ #define HAL_RF_ENABLE 0 -+#else /* FPGA_PHY and ASIC */ -+ #define HAL_FW_ENABLE 1 -+ #define HAL_MAC_ENABLE 1 -+ #define HAL_BB_ENABLE 1 -+ #define HAL_RF_ENABLE 1 -+#endif -+ -+#define RF6052_MAX_TX_PWR 0x3F -+#define RF6052_MAX_REG_88E 0xFF -+#define RF6052_MAX_REG_92C 0x7F -+ -+#define RF6052_MAX_REG \ -+ ((RF6052_MAX_REG_88E > RF6052_MAX_REG_92C) ? RF6052_MAX_REG_88E : RF6052_MAX_REG_92C) -+ -+#define GET_RF6052_REAL_MAX_REG(_Adapter) \ -+ (IS_HARDWARE_TYPE_8188E(_Adapter) ? RF6052_MAX_REG_88E : RF6052_MAX_REG_92C) -+ -+#define RF6052_MAX_PATH 2 -+ -+/* -+ * Antenna detection method, i.e., using single tone detection or RSSI reported from each antenna detected. -+ * Added by Roger, 2013.05.22. -+ * */ -+#define ANT_DETECT_BY_SINGLE_TONE BIT0 -+#define ANT_DETECT_BY_RSSI BIT1 -+#define IS_ANT_DETECT_SUPPORT_SINGLE_TONE(__Adapter) ((GET_HAL_DATA(__Adapter)->AntDetection) & ANT_DETECT_BY_SINGLE_TONE) -+#define IS_ANT_DETECT_SUPPORT_RSSI(__Adapter) ((GET_HAL_DATA(__Adapter)->AntDetection) & ANT_DETECT_BY_RSSI) -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+typedef enum _RF_TYPE { -+ RF_TYPE_MIN = 0, /* 0 */ -+ RF_8225 = 1, /* 1 11b/g RF for verification only */ -+ RF_8256 = 2, /* 2 11b/g/n */ -+ RF_8258 = 3, /* 3 11a/b/g/n RF */ -+ RF_6052 = 4, /* 4 11b/g/n RF */ -+ RF_PSEUDO_11N = 5, /* 5, It is a temporality RF. */ -+ RF_TYPE_MAX -+} RF_TYPE_E, *PRF_TYPE_E; -+ -+#define TX_1S 0 -+#define TX_2S 1 -+#define TX_3S 2 -+#define TX_4S 3 -+ -+typedef enum _ANTENNA_PATH { -+ ANTENNA_NONE = 0, -+ ANTENNA_D = 1, -+ ANTENNA_C = 2, -+ ANTENNA_CD = 3, -+ ANTENNA_B = 4, -+ ANTENNA_BD = 5, -+ ANTENNA_BC = 6, -+ ANTENNA_BCD = 7, -+ ANTENNA_A = 8, -+ ANTENNA_AD = 9, -+ ANTENNA_AC = 10, -+ ANTENNA_ACD = 11, -+ ANTENNA_AB = 12, -+ ANTENNA_ABD = 13, -+ ANTENNA_ABC = 14, -+ ANTENNA_ABCD = 15 -+} ANTENNA_PATH; -+ -+typedef enum _RF_CONTENT { -+ radioa_txt = 0x1000, -+ radiob_txt = 0x1001, -+ radioc_txt = 0x1002, -+ radiod_txt = 0x1003 -+} RF_CONTENT; -+ -+typedef enum _BaseBand_Config_Type { -+ BaseBand_Config_PHY_REG = 0, /* Radio Path A */ -+ BaseBand_Config_AGC_TAB = 1, /* Radio Path B */ -+ BaseBand_Config_AGC_TAB_2G = 2, -+ BaseBand_Config_AGC_TAB_5G = 3, -+ BaseBand_Config_PHY_REG_PG -+} BaseBand_Config_Type, *PBaseBand_Config_Type; -+ -+typedef enum _HW_BLOCK { -+ HW_BLOCK_MAC = 0, -+ HW_BLOCK_PHY0 = 1, -+ HW_BLOCK_PHY1 = 2, -+ HW_BLOCK_RF = 3, -+ HW_BLOCK_MAXIMUM = 4, /* Never use this */ -+} HW_BLOCK_E, *PHW_BLOCK_E; -+ -+typedef enum _WIRELESS_MODE { -+ WIRELESS_MODE_UNKNOWN = 0x00, -+ WIRELESS_MODE_A = 0x01, -+ WIRELESS_MODE_B = 0x02, -+ WIRELESS_MODE_G = 0x04, -+ WIRELESS_MODE_AUTO = 0x08, -+ WIRELESS_MODE_N_24G = 0x10, -+ WIRELESS_MODE_N_5G = 0x20, -+ WIRELESS_MODE_AC_5G = 0x40, -+ WIRELESS_MODE_AC_24G = 0x80, -+ WIRELESS_MODE_AC_ONLY = 0x100, -+} WIRELESS_MODE; -+ -+typedef enum _SwChnlCmdID { -+ CmdID_End, -+ CmdID_SetTxPowerLevel, -+ CmdID_BBRegWrite10, -+ CmdID_WritePortUlong, -+ CmdID_WritePortUshort, -+ CmdID_WritePortUchar, -+ CmdID_RF_WriteReg, -+} SwChnlCmdID; -+ -+typedef struct _SwChnlCmd { -+ SwChnlCmdID CmdID; -+ u32 Para1; -+ u32 Para2; -+ u32 msDelay; -+} SwChnlCmd; -+ -+typedef struct _R_ANTENNA_SELECT_OFDM { -+ u32 r_tx_antenna:4; -+ u32 r_ant_l:4; -+ u32 r_ant_non_ht:4; -+ u32 r_ant_ht1:4; -+ u32 r_ant_ht2:4; -+ u32 r_ant_ht_s1:4; -+ u32 r_ant_non_ht_s1:4; -+ u32 OFDM_TXSC:2; -+ u32 Reserved:2; -+} R_ANTENNA_SELECT_OFDM; -+ -+typedef struct _R_ANTENNA_SELECT_CCK { -+ u8 r_cckrx_enable_2:2; -+ u8 r_cckrx_enable:2; -+ u8 r_ccktx_enable:4; -+} R_ANTENNA_SELECT_CCK; -+ -+typedef struct RF_Shadow_Compare_Map { -+ /* Shadow register value */ -+ u32 Value; -+ /* Compare or not flag */ -+ u8 Compare; -+ /* Record If it had ever modified unpredicted */ -+ u8 ErrorOrNot; -+ /* Recorver Flag */ -+ u8 Recorver; -+ /* */ -+ u8 Driver_Write; -+} RF_SHADOW_T; -+ -+/*--------------------------Exported Function prototype---------------------*/ -+ -+u32 -+PHY_CalculateBitShift( -+ u32 BitMask -+); -+ -+u32 -+PHY_RFShadowRead( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset); -+ -+VOID -+PHY_RFShadowWrite( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u32 Data); -+ -+BOOLEAN -+PHY_RFShadowCompare( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset); -+ -+VOID -+PHY_RFShadowRecorver( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset); -+ -+VOID -+PHY_RFShadowCompareAll( -+ IN PADAPTER Adapter); -+ -+VOID -+PHY_RFShadowRecorverAll( -+ IN PADAPTER Adapter); -+ -+VOID -+PHY_RFShadowCompareFlagSet( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u8 Type); -+ -+VOID -+PHY_RFShadowRecorverFlagSet( -+ IN PADAPTER Adapter, -+ IN u8 eRFPath, -+ IN u32 Offset, -+ IN u8 Type); -+ -+VOID -+PHY_RFShadowCompareFlagSetAll( -+ IN PADAPTER Adapter); -+ -+VOID -+PHY_RFShadowRecorverFlagSetAll( -+ IN PADAPTER Adapter); -+ -+VOID -+PHY_RFShadowRefresh( -+ IN PADAPTER Adapter); -+ -+#endif /* __HAL_COMMON_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_phy_reg.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_phy_reg.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_phy_reg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_phy_reg.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_PHY_REG_H__ -+#define __HAL_PHY_REG_H__ -+ -+/* for PutRFRegsetting & GetRFRegSetting BitMask -+ * #if (RTL92SE_FPGA_VERIFY == 1) -+ * #define bRFRegOffsetMask 0xfff -+ * #else */ -+#define bRFRegOffsetMask 0xfffff -+/* #endif */ -+ -+#endif /* __HAL_PHY_REG_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/HalPwrSeqCmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/HalPwrSeqCmd.h ---- linux-4.14.18/3rdparty/rtl8723de/include/HalPwrSeqCmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/HalPwrSeqCmd.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,135 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HALPWRSEQCMD_H__ -+#define __HALPWRSEQCMD_H__ -+ -+#include -+ -+/*---------------------------------------------*/ -+/* 3 The value of cmd: 4 bits -+ *---------------------------------------------*/ -+#define PWR_CMD_READ 0x00 -+/* offset: the read register offset -+ * msk: the mask of the read value -+ * value: N/A, left by 0 -+ * note: dirver shall implement this function by read & msk */ -+ -+#define PWR_CMD_WRITE 0x01 -+/* offset: the read register offset -+ * msk: the mask of the write bits -+ * value: write value -+ * note: driver shall implement this cmd by read & msk after write */ -+ -+#define PWR_CMD_POLLING 0x02 -+/* offset: the read register offset -+ * msk: the mask of the polled value -+ * value: the value to be polled, masked by the msd field. -+ * note: driver shall implement this cmd by -+ * do { -+ * if( (Read(offset) & msk) == (value & msk) ) -+ * break; -+ * } while(not timeout); */ -+ -+#define PWR_CMD_DELAY 0x03 -+/* offset: the value to delay -+ * msk: N/A -+ * value: the unit of delay, 0: us, 1: ms */ -+ -+#define PWR_CMD_END 0x04 -+/* offset: N/A -+ * msk: N/A -+ * value: N/A */ -+ -+/*---------------------------------------------*/ -+/* 3 The value of base: 4 bits -+ *--------------------------------------------- -+ * define the base address of each block */ -+#define PWR_BASEADDR_MAC 0x00 -+#define PWR_BASEADDR_USB 0x01 -+#define PWR_BASEADDR_PCIE 0x02 -+#define PWR_BASEADDR_SDIO 0x03 -+ -+/*---------------------------------------------*/ -+/* 3 The value of interface_msk: 4 bits -+ *---------------------------------------------*/ -+#define PWR_INTF_SDIO_MSK BIT(0) -+#define PWR_INTF_USB_MSK BIT(1) -+#define PWR_INTF_PCI_MSK BIT(2) -+#define PWR_INTF_ALL_MSK (BIT(0) | BIT(1) | BIT(2) | BIT(3)) -+ -+/*---------------------------------------------*/ -+/* 3 The value of fab_msk: 4 bits -+ *---------------------------------------------*/ -+#define PWR_FAB_TSMC_MSK BIT(0) -+#define PWR_FAB_UMC_MSK BIT(1) -+#define PWR_FAB_ALL_MSK (BIT(0) | BIT(1) | BIT(2) | BIT(3)) -+ -+/*---------------------------------------------*/ -+/* 3 The value of cut_msk: 8 bits -+ *---------------------------------------------*/ -+#define PWR_CUT_TESTCHIP_MSK BIT(0) -+#define PWR_CUT_A_MSK BIT(1) -+#define PWR_CUT_B_MSK BIT(2) -+#define PWR_CUT_C_MSK BIT(3) -+#define PWR_CUT_D_MSK BIT(4) -+#define PWR_CUT_E_MSK BIT(5) -+#define PWR_CUT_F_MSK BIT(6) -+#define PWR_CUT_G_MSK BIT(7) -+#define PWR_CUT_ALL_MSK 0xFF -+ -+ -+typedef enum _PWRSEQ_CMD_DELAY_UNIT_ { -+ PWRSEQ_DELAY_US, -+ PWRSEQ_DELAY_MS, -+} PWRSEQ_DELAY_UNIT; -+ -+typedef struct _WL_PWR_CFG_ { -+ u16 offset; -+ u8 cut_msk; -+ u8 fab_msk:4; -+ u8 interface_msk:4; -+ u8 base:4; -+ u8 cmd:4; -+ u8 msk; -+ u8 value; -+} WLAN_PWR_CFG, *PWLAN_PWR_CFG; -+ -+ -+#define GET_PWR_CFG_OFFSET(__PWR_CMD) ((__PWR_CMD).offset) -+#define GET_PWR_CFG_CUT_MASK(__PWR_CMD) ((__PWR_CMD).cut_msk) -+#define GET_PWR_CFG_FAB_MASK(__PWR_CMD) ((__PWR_CMD).fab_msk) -+#define GET_PWR_CFG_INTF_MASK(__PWR_CMD) ((__PWR_CMD).interface_msk) -+#define GET_PWR_CFG_BASE(__PWR_CMD) ((__PWR_CMD).base) -+#define GET_PWR_CFG_CMD(__PWR_CMD) ((__PWR_CMD).cmd) -+#define GET_PWR_CFG_MASK(__PWR_CMD) ((__PWR_CMD).msk) -+#define GET_PWR_CFG_VALUE(__PWR_CMD) ((__PWR_CMD).value) -+ -+ -+/* ******************************************************************************** -+ * Prototype of protected function. -+ * ******************************************************************************** */ -+u8 HalPwrSeqCmdParsing( -+ PADAPTER padapter, -+ u8 CutVersion, -+ u8 FabVersion, -+ u8 InterfaceType, -+ WLAN_PWR_CFG PwrCfgCmd[]); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/hal_sdio.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_sdio.h ---- linux-4.14.18/3rdparty/rtl8723de/include/hal_sdio.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/hal_sdio.h 2018-02-11 21:44:27.167146391 +0200 -@@ -0,0 +1,36 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_SDIO_H_ -+#define __HAL_SDIO_H_ -+ -+#define ffaddr2deviceId(pdvobj, addr) (pdvobj->Queue2Pipe[addr]) -+ -+u8 rtw_hal_sdio_max_txoqt_free_space(_adapter *padapter); -+u8 rtw_hal_sdio_query_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); -+void rtw_hal_sdio_update_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); -+void rtw_hal_set_sdio_tx_max_length(PADAPTER padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ); -+u32 rtw_hal_get_sdio_tx_max_length(PADAPTER padapter, u8 queue_idx); -+bool sdio_power_on_check(PADAPTER padapter); -+ -+#ifdef CONFIG_FW_C2H_REG -+void sd_c2h_hisr_hdl(_adapter *adapter); -+#endif -+ -+#endif /* __HAL_SDIO_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/HalVerDef.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/HalVerDef.h ---- linux-4.14.18/3rdparty/rtl8723de/include/HalVerDef.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/HalVerDef.h 2018-02-11 21:44:27.166146375 +0200 -@@ -0,0 +1,201 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __HAL_VERSION_DEF_H__ -+#define __HAL_VERSION_DEF_H__ -+ -+#define TRUE _TRUE -+#define FALSE _FALSE -+ -+/* HAL_IC_TYPE_E */ -+typedef enum tag_HAL_IC_Type_Definition { -+ CHIP_8192S = 0, -+ CHIP_8188C = 1, -+ CHIP_8192C = 2, -+ CHIP_8192D = 3, -+ CHIP_8723A = 4, -+ CHIP_8188E = 5, -+ CHIP_8812 = 6, -+ CHIP_8821 = 7, -+ CHIP_8723B = 8, -+ CHIP_8192E = 9, -+ CHIP_8814A = 10, -+ CHIP_8703B = 11, -+ CHIP_8188F = 12, -+ CHIP_8822B = 13, -+ CHIP_8723D = 14, -+ CHIP_8821C = 15 -+} HAL_IC_TYPE_E; -+ -+/* HAL_CHIP_TYPE_E */ -+typedef enum tag_HAL_CHIP_Type_Definition { -+ TEST_CHIP = 0, -+ NORMAL_CHIP = 1, -+ FPGA = 2, -+} HAL_CHIP_TYPE_E; -+ -+/* HAL_CUT_VERSION_E */ -+typedef enum tag_HAL_Cut_Version_Definition { -+ A_CUT_VERSION = 0, -+ B_CUT_VERSION = 1, -+ C_CUT_VERSION = 2, -+ D_CUT_VERSION = 3, -+ E_CUT_VERSION = 4, -+ F_CUT_VERSION = 5, -+ G_CUT_VERSION = 6, -+ H_CUT_VERSION = 7, -+ I_CUT_VERSION = 8, -+ J_CUT_VERSION = 9, -+ K_CUT_VERSION = 10, -+} HAL_CUT_VERSION_E; -+ -+/* HAL_Manufacturer */ -+typedef enum tag_HAL_Manufacturer_Version_Definition { -+ CHIP_VENDOR_TSMC = 0, -+ CHIP_VENDOR_UMC = 1, -+ CHIP_VENDOR_SMIC = 2, -+} HAL_VENDOR_E; -+ -+typedef enum tag_HAL_RF_Type_Definition { -+ RF_TYPE_1T1R = 0, -+ RF_TYPE_1T2R = 1, -+ RF_TYPE_2T2R = 2, -+ RF_TYPE_2T3R = 3, -+ RF_TYPE_2T4R = 4, -+ RF_TYPE_3T3R = 5, -+ RF_TYPE_3T4R = 6, -+ RF_TYPE_4T4R = 7, -+} HAL_RF_TYPE_E; -+ -+typedef struct tag_HAL_VERSION { -+ HAL_IC_TYPE_E ICType; -+ HAL_CHIP_TYPE_E ChipType; -+ HAL_CUT_VERSION_E CUTVersion; -+ HAL_VENDOR_E VendorType; -+ HAL_RF_TYPE_E RFType; -+ u8 ROMVer; -+} HAL_VERSION, *PHAL_VERSION; -+ -+/* VERSION_8192C VersionID; -+ * HAL_VERSION VersionID; */ -+ -+/* Get element */ -+#define GET_CVID_IC_TYPE(version) ((HAL_IC_TYPE_E)(((HAL_VERSION)version).ICType)) -+#define GET_CVID_CHIP_TYPE(version) ((HAL_CHIP_TYPE_E)(((HAL_VERSION)version).ChipType)) -+#define GET_CVID_RF_TYPE(version) ((HAL_RF_TYPE_E)(((HAL_VERSION)version).RFType)) -+#define GET_CVID_MANUFACTUER(version) ((HAL_VENDOR_E)(((HAL_VERSION)version).VendorType)) -+#define GET_CVID_CUT_VERSION(version) ((HAL_CUT_VERSION_E)(((HAL_VERSION)version).CUTVersion)) -+#define GET_CVID_ROM_VERSION(version) ((((HAL_VERSION)version).ROMVer) & ROM_VERSION_MASK) -+ -+/* ---------------------------------------------------------------------------- -+ * Common Macro. -- -+ * ---------------------------------------------------------------------------- -+ * HAL_VERSION VersionID */ -+ -+/* HAL_IC_TYPE_E */ -+#if 0 -+ #define IS_81XXC(version) (((GET_CVID_IC_TYPE(version) == CHIP_8192C) || (GET_CVID_IC_TYPE(version) == CHIP_8188C)) ? TRUE : FALSE) -+ #define IS_8723_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8723A) ? TRUE : FALSE) -+ #define IS_92D(version) ((GET_CVID_IC_TYPE(version) == CHIP_8192D) ? TRUE : FALSE) -+#endif -+ -+#define IS_8188E(version) ((GET_CVID_IC_TYPE(version) == CHIP_8188E) ? TRUE : FALSE) -+#define IS_8188F(version) ((GET_CVID_IC_TYPE(version) == CHIP_8188F) ? TRUE : FALSE) -+#define IS_8192E(version) ((GET_CVID_IC_TYPE(version) == CHIP_8192E) ? TRUE : FALSE) -+#define IS_8812_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8812) ? TRUE : FALSE) -+#define IS_8821_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8821) ? TRUE : FALSE) -+#define IS_8814A_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8814A) ? TRUE : FALSE) -+#define IS_8723B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8723B) ? TRUE : FALSE) -+#define IS_8703B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8703B) ? TRUE : FALSE) -+#define IS_8822B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8822B) ? TRUE : FALSE) -+#define IS_8821C_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8821C) ? TRUE : FALSE) -+#define IS_8723D_SERIES(version)\ -+ ((GET_CVID_IC_TYPE(version) == CHIP_8723D) ? TRUE : FALSE) -+/* HAL_CHIP_TYPE_E */ -+#define IS_TEST_CHIP(version) ((GET_CVID_CHIP_TYPE(version) == TEST_CHIP) ? TRUE : FALSE) -+#define IS_NORMAL_CHIP(version) ((GET_CVID_CHIP_TYPE(version) == NORMAL_CHIP) ? TRUE : FALSE) -+ -+/* HAL_CUT_VERSION_E */ -+#define IS_A_CUT(version) ((GET_CVID_CUT_VERSION(version) == A_CUT_VERSION) ? TRUE : FALSE) -+#define IS_B_CUT(version) ((GET_CVID_CUT_VERSION(version) == B_CUT_VERSION) ? TRUE : FALSE) -+#define IS_C_CUT(version) ((GET_CVID_CUT_VERSION(version) == C_CUT_VERSION) ? TRUE : FALSE) -+#define IS_D_CUT(version) ((GET_CVID_CUT_VERSION(version) == D_CUT_VERSION) ? TRUE : FALSE) -+#define IS_E_CUT(version) ((GET_CVID_CUT_VERSION(version) == E_CUT_VERSION) ? TRUE : FALSE) -+#define IS_F_CUT(version) ((GET_CVID_CUT_VERSION(version) == F_CUT_VERSION) ? TRUE : FALSE) -+#define IS_I_CUT(version) ((GET_CVID_CUT_VERSION(version) == I_CUT_VERSION) ? TRUE : FALSE) -+#define IS_J_CUT(version) ((GET_CVID_CUT_VERSION(version) == J_CUT_VERSION) ? TRUE : FALSE) -+#define IS_K_CUT(version) ((GET_CVID_CUT_VERSION(version) == K_CUT_VERSION) ? TRUE : FALSE) -+ -+/* HAL_VENDOR_E */ -+#define IS_CHIP_VENDOR_TSMC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_TSMC) ? TRUE : FALSE) -+#define IS_CHIP_VENDOR_UMC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_UMC) ? TRUE : FALSE) -+#define IS_CHIP_VENDOR_SMIC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_SMIC) ? TRUE : FALSE) -+ -+/* HAL_RF_TYPE_E */ -+#define IS_1T1R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_1T1R) ? TRUE : FALSE) -+#define IS_1T2R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_1T2R) ? TRUE : FALSE) -+#define IS_2T2R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_2T2R) ? TRUE : FALSE) -+#define IS_3T3R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_3T3R) ? TRUE : FALSE) -+#define IS_3T4R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_3T4R) ? TRUE : FALSE) -+#define IS_4T4R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_4T4R) ? TRUE : FALSE) -+ -+ -+ -+/* ---------------------------------------------------------------------------- -+ * Chip version Macro. -- -+ * ---------------------------------------------------------------------------- */ -+#if 0 -+ #define IS_81XXC_TEST_CHIP(version) ((IS_81XXC(version) && (!IS_NORMAL_CHIP(version))) ? TRUE : FALSE) -+ -+ #define IS_92C_SERIAL(version) ((IS_81XXC(version) && IS_2T2R(version)) ? TRUE : FALSE) -+ #define IS_81xxC_VENDOR_UMC_A_CUT(version) (IS_81XXC(version) ? (IS_CHIP_VENDOR_UMC(version) ? (IS_A_CUT(version) ? TRUE : FALSE) : FALSE) : FALSE) -+ #define IS_81xxC_VENDOR_UMC_B_CUT(version) (IS_81XXC(version) ? (IS_CHIP_VENDOR_UMC(version) ? (IS_B_CUT(version) ? TRUE : FALSE) : FALSE) : FALSE) -+ #define IS_81xxC_VENDOR_UMC_C_CUT(version) (IS_81XXC(version) ? (IS_CHIP_VENDOR_UMC(version) ? (IS_C_CUT(version) ? TRUE : FALSE) : FALSE) : FALSE) -+ -+ #define IS_NORMAL_CHIP92D(version) ((IS_92D(version)) ? ((GET_CVID_CHIP_TYPE(version) == NORMAL_CHIP) ? TRUE : FALSE) : FALSE) -+ -+ #define IS_92D_SINGLEPHY(version) ((IS_92D(version)) ? (IS_2T2R(version) ? TRUE : FALSE) : FALSE) -+ #define IS_92D_C_CUT(version) ((IS_92D(version)) ? (IS_C_CUT(version) ? TRUE : FALSE) : FALSE) -+ #define IS_92D_D_CUT(version) ((IS_92D(version)) ? (IS_D_CUT(version) ? TRUE : FALSE) : FALSE) -+ #define IS_92D_E_CUT(version) ((IS_92D(version)) ? (IS_E_CUT(version) ? TRUE : FALSE) : FALSE) -+ -+ #define IS_8723A_A_CUT(version) ((IS_8723_SERIES(version)) ? (IS_A_CUT(version) ? TRUE : FALSE) : FALSE) -+ #define IS_8723A_B_CUT(version) ((IS_8723_SERIES(version)) ? (IS_B_CUT(version) ? TRUE : FALSE) : FALSE) -+#endif -+ -+#define IS_VENDOR_8188E_I_CUT_SERIES(_Adapter) ((IS_8188E(GET_HAL_DATA(_Adapter)->VersionID)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) >= I_CUT_VERSION) ? TRUE : FALSE) : FALSE) -+ -+#define IS_VENDOR_8812A_TEST_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8812A_MP_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) -+#define IS_VENDOR_8812A_C_CUT(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) == C_CUT_VERSION) ? TRUE : FALSE) : FALSE) -+ -+#define IS_VENDOR_8821A_TEST_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8821A_MP_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) -+ -+#define IS_VENDOR_8192E_B_CUT(_Adapter) ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) == B_CUT_VERSION) ? TRUE : FALSE) -+ -+#define IS_VENDOR_8723B_TEST_CHIP(_Adapter) ((IS_8723B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8723B_MP_CHIP(_Adapter) ((IS_8723B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) -+ -+#define IS_VENDOR_8703B_TEST_CHIP(_Adapter) ((IS_8703B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8703B_MP_CHIP(_Adapter) ((IS_8703B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) -+#define IS_VENDOR_8814A_TEST_CHIP(_Adapter) ((IS_8814A_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -+#define IS_VENDOR_8814A_MP_CHIP(_Adapter) ((IS_8814A_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/ieee80211_ext.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/ieee80211_ext.h ---- linux-4.14.18/3rdparty/rtl8723de/include/ieee80211_ext.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/ieee80211_ext.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,476 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __IEEE80211_EXT_H -+#define __IEEE80211_EXT_H -+ -+#include -+#include -+#include -+ -+#define WMM_OUI_TYPE 2 -+#define WMM_OUI_SUBTYPE_INFORMATION_ELEMENT 0 -+#define WMM_OUI_SUBTYPE_PARAMETER_ELEMENT 1 -+#define WMM_OUI_SUBTYPE_TSPEC_ELEMENT 2 -+#define WMM_VERSION 1 -+ -+#define WPA_PROTO_WPA BIT(0) -+#define WPA_PROTO_RSN BIT(1) -+ -+#define WPA_KEY_MGMT_IEEE8021X BIT(0) -+#define WPA_KEY_MGMT_PSK BIT(1) -+#define WPA_KEY_MGMT_NONE BIT(2) -+#define WPA_KEY_MGMT_IEEE8021X_NO_WPA BIT(3) -+#define WPA_KEY_MGMT_WPA_NONE BIT(4) -+ -+ -+#define WPA_CAPABILITY_PREAUTH BIT(0) -+#define WPA_CAPABILITY_MGMT_FRAME_PROTECTION BIT(6) -+#define WPA_CAPABILITY_PEERKEY_ENABLED BIT(9) -+ -+ -+#define PMKID_LEN 16 -+ -+ -+#ifdef PLATFORM_LINUX -+struct wpa_ie_hdr { -+ u8 elem_id; -+ u8 len; -+ u8 oui[4]; /* 24-bit OUI followed by 8-bit OUI type */ -+ u8 version[2]; /* little endian */ -+} __attribute__((packed)); -+ -+struct rsn_ie_hdr { -+ u8 elem_id; /* WLAN_EID_RSN */ -+ u8 len; -+ u8 version[2]; /* little endian */ -+} __attribute__((packed)); -+ -+struct wme_ac_parameter { -+#if defined(CONFIG_LITTLE_ENDIAN) -+ /* byte 1 */ -+ u8 aifsn:4, -+ acm:1, -+ aci:2, -+ reserved:1; -+ -+ /* byte 2 */ -+ u8 eCWmin:4, -+ eCWmax:4; -+#elif defined(CONFIG_BIG_ENDIAN) -+ /* byte 1 */ -+ u8 reserved:1, -+ aci:2, -+ acm:1, -+ aifsn:4; -+ -+ /* byte 2 */ -+ u8 eCWmax:4, -+ eCWmin:4; -+#else -+#error "Please fix " -+#endif -+ -+ /* bytes 3 & 4 */ -+ u16 txopLimit; -+} __attribute__((packed)); -+ -+struct wme_parameter_element { -+ /* required fields for WME version 1 */ -+ u8 oui[3]; -+ u8 oui_type; -+ u8 oui_subtype; -+ u8 version; -+ u8 acInfo; -+ u8 reserved; -+ struct wme_ac_parameter ac[4]; -+ -+} __attribute__((packed)); -+ -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+ -+struct wpa_ie_hdr { -+ u8 elem_id; -+ u8 len; -+ u8 oui[4]; /* 24-bit OUI followed by 8-bit OUI type */ -+ u8 version[2]; /* little endian */ -+}; -+ -+struct rsn_ie_hdr { -+ u8 elem_id; /* WLAN_EID_RSN */ -+ u8 len; -+ u8 version[2]; /* little endian */ -+}; -+ -+#pragma pack() -+ -+#endif -+ -+#define WPA_PUT_LE16(a, val) \ -+ do { \ -+ (a)[1] = ((u16) (val)) >> 8; \ -+ (a)[0] = ((u16) (val)) & 0xff; \ -+ } while (0) -+ -+#define WPA_PUT_BE32(a, val) \ -+ do { \ -+ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[3] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define WPA_PUT_LE32(a, val) \ -+ do { \ -+ (a)[3] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[0] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define RSN_SELECTOR_PUT(a, val) WPA_PUT_BE32((u8 *) (a), (val)) -+/* #define RSN_SELECTOR_PUT(a, val) WPA_PUT_LE32((u8 *) (a), (val)) */ -+ -+ -+ -+/* Action category code */ -+enum ieee80211_category { -+ WLAN_CATEGORY_SPECTRUM_MGMT = 0, -+ WLAN_CATEGORY_QOS = 1, -+ WLAN_CATEGORY_DLS = 2, -+ WLAN_CATEGORY_BACK = 3, -+ WLAN_CATEGORY_HT = 7, -+ WLAN_CATEGORY_WMM = 17, -+}; -+ -+/* SPECTRUM_MGMT action code */ -+enum ieee80211_spectrum_mgmt_actioncode { -+ WLAN_ACTION_SPCT_MSR_REQ = 0, -+ WLAN_ACTION_SPCT_MSR_RPRT = 1, -+ WLAN_ACTION_SPCT_TPC_REQ = 2, -+ WLAN_ACTION_SPCT_TPC_RPRT = 3, -+ WLAN_ACTION_SPCT_CHL_SWITCH = 4, -+ WLAN_ACTION_SPCT_EXT_CHL_SWITCH = 5, -+}; -+ -+/* BACK action code */ -+enum ieee80211_back_actioncode { -+ WLAN_ACTION_ADDBA_REQ = 0, -+ WLAN_ACTION_ADDBA_RESP = 1, -+ WLAN_ACTION_DELBA = 2, -+}; -+ -+/* HT features action code */ -+enum ieee80211_ht_actioncode { -+ WLAN_ACTION_NOTIFY_CH_WIDTH = 0, -+ WLAN_ACTION_SM_PS = 1, -+ WLAN_ACTION_PSPM = 2, -+ WLAN_ACTION_PCO_PHASE = 3, -+ WLAN_ACTION_MIMO_CSI_MX = 4, -+ WLAN_ACTION_MIMO_NONCP_BF = 5, -+ WLAN_ACTION_MIMP_CP_BF = 6, -+ WLAN_ACTION_ASEL_INDICATES_FB = 7, -+ WLAN_ACTION_HI_INFO_EXCHG = 8, -+}; -+ -+/* BACK (block-ack) parties */ -+enum ieee80211_back_parties { -+ WLAN_BACK_RECIPIENT = 0, -+ WLAN_BACK_INITIATOR = 1, -+ WLAN_BACK_TIMER = 2, -+}; -+ -+#ifdef PLATFORM_LINUX -+ -+struct ieee80211_mgmt { -+ u16 frame_control; -+ u16 duration; -+ u8 da[6]; -+ u8 sa[6]; -+ u8 bssid[6]; -+ u16 seq_ctrl; -+ union { -+ struct { -+ u16 auth_alg; -+ u16 auth_transaction; -+ u16 status_code; -+ /* possibly followed by Challenge text */ -+ u8 variable[0]; -+ } __attribute__((packed)) auth; -+ struct { -+ u16 reason_code; -+ } __attribute__((packed)) deauth; -+ struct { -+ u16 capab_info; -+ u16 listen_interval; -+ /* followed by SSID and Supported rates */ -+ u8 variable[0]; -+ } __attribute__((packed)) assoc_req; -+ struct { -+ u16 capab_info; -+ u16 status_code; -+ u16 aid; -+ /* followed by Supported rates */ -+ u8 variable[0]; -+ } __attribute__((packed)) assoc_resp, reassoc_resp; -+ struct { -+ u16 capab_info; -+ u16 listen_interval; -+ u8 current_ap[6]; -+ /* followed by SSID and Supported rates */ -+ u8 variable[0]; -+ } __attribute__((packed)) reassoc_req; -+ struct { -+ u16 reason_code; -+ } __attribute__((packed)) disassoc; -+ struct { -+ __le64 timestamp; -+ u16 beacon_int; -+ u16 capab_info; -+ /* followed by some of SSID, Supported rates, -+ * FH Params, DS Params, CF Params, IBSS Params, TIM */ -+ u8 variable[0]; -+ } __attribute__((packed)) beacon; -+ struct { -+ /* only variable items: SSID, Supported rates */ -+ u8 variable[0]; -+ } __attribute__((packed)) probe_req; -+ struct { -+ __le64 timestamp; -+ u16 beacon_int; -+ u16 capab_info; -+ /* followed by some of SSID, Supported rates, -+ * FH Params, DS Params, CF Params, IBSS Params */ -+ u8 variable[0]; -+ } __attribute__((packed)) probe_resp; -+ struct { -+ u8 category; -+ union { -+ struct { -+ u8 action_code; -+ u8 dialog_token; -+ u8 status_code; -+ u8 variable[0]; -+ } __attribute__((packed)) wme_action; -+#if 0 -+ struct { -+ u8 action_code; -+ u8 element_id; -+ u8 length; -+ struct ieee80211_channel_sw_ie sw_elem; -+ } __attribute__((packed)) chan_switch; -+ struct { -+ u8 action_code; -+ u8 dialog_token; -+ u8 element_id; -+ u8 length; -+ struct ieee80211_msrment_ie msr_elem; -+ } __attribute__((packed)) measurement; -+#endif -+ struct { -+ u8 action_code; -+ u8 dialog_token; -+ u16 capab; -+ u16 timeout; -+ u16 start_seq_num; -+ } __attribute__((packed)) addba_req; -+ struct { -+ u8 action_code; -+ u8 dialog_token; -+ u16 status; -+ u16 capab; -+ u16 timeout; -+ } __attribute__((packed)) addba_resp; -+ struct { -+ u8 action_code; -+ u16 params; -+ u16 reason_code; -+ } __attribute__((packed)) delba; -+ struct { -+ u8 action_code; -+ /* capab_info for open and confirm, -+ * reason for close -+ */ -+ u16 aux; -+ /* Followed in plink_confirm by status -+ * code, AID and supported rates, -+ * and directly by supported rates in -+ * plink_open and plink_close -+ */ -+ u8 variable[0]; -+ } __attribute__((packed)) plink_action; -+ struct { -+ u8 action_code; -+ u8 variable[0]; -+ } __attribute__((packed)) mesh_action; -+ } __attribute__((packed)) u; -+ } __attribute__((packed)) action; -+ } __attribute__((packed)) u; -+} __attribute__((packed)); -+ -+#endif -+ -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+ -+struct ieee80211_mgmt { -+ u16 frame_control; -+ u16 duration; -+ u8 da[6]; -+ u8 sa[6]; -+ u8 bssid[6]; -+ u16 seq_ctrl; -+ union { -+ struct { -+ u16 auth_alg; -+ u16 auth_transaction; -+ u16 status_code; -+ /* possibly followed by Challenge text */ -+ u8 variable[0]; -+ } auth; -+ struct { -+ u16 reason_code; -+ } deauth; -+ struct { -+ u16 capab_info; -+ u16 listen_interval; -+ /* followed by SSID and Supported rates */ -+ u8 variable[0]; -+ } assoc_req; -+ struct { -+ u16 capab_info; -+ u16 status_code; -+ u16 aid; -+ /* followed by Supported rates */ -+ u8 variable[0]; -+ } assoc_resp, reassoc_resp; -+ struct { -+ u16 capab_info; -+ u16 listen_interval; -+ u8 current_ap[6]; -+ /* followed by SSID and Supported rates */ -+ u8 variable[0]; -+ } reassoc_req; -+ struct { -+ u16 reason_code; -+ } disassoc; -+#if 0 -+ struct { -+ __le64 timestamp; -+ u16 beacon_int; -+ u16 capab_info; -+ /* followed by some of SSID, Supported rates, -+ * FH Params, DS Params, CF Params, IBSS Params, TIM */ -+ u8 variable[0]; -+ } beacon; -+ struct { -+ /* only variable items: SSID, Supported rates */ -+ u8 variable[0]; -+ } probe_req; -+ -+ struct { -+ __le64 timestamp; -+ u16 beacon_int; -+ u16 capab_info; -+ /* followed by some of SSID, Supported rates, -+ * FH Params, DS Params, CF Params, IBSS Params */ -+ u8 variable[0]; -+ } probe_resp; -+#endif -+ struct { -+ u8 category; -+ union { -+ struct { -+ u8 action_code; -+ u8 dialog_token; -+ u8 status_code; -+ u8 variable[0]; -+ } wme_action; -+ #if 0 -+ struct{ -+ u8 action_code; -+ u8 element_id; -+ u8 length; -+ struct ieee80211_channel_sw_ie sw_elem; -+ } chan_switch; -+ struct{ -+ u8 action_code; -+ u8 dialog_token; -+ u8 element_id; -+ u8 length; -+ struct ieee80211_msrment_ie msr_elem; -+ } measurement; -+ #endif -+ struct { -+ u8 action_code; -+ u8 dialog_token; -+ u16 capab; -+ u16 timeout; -+ u16 start_seq_num; -+ } addba_req; -+ struct { -+ u8 action_code; -+ u8 dialog_token; -+ u16 status; -+ u16 capab; -+ u16 timeout; -+ } addba_resp; -+ struct { -+ u8 action_code; -+ u16 params; -+ u16 reason_code; -+ } delba; -+ struct { -+ u8 action_code; -+ /* capab_info for open and confirm, -+ * reason for close -+ */ -+ u16 aux; -+ /* Followed in plink_confirm by status -+ * code, AID and supported rates, -+ * and directly by supported rates in -+ * plink_open and plink_close -+ */ -+ u8 variable[0]; -+ } plink_action; -+ struct { -+ u8 action_code; -+ u8 variable[0]; -+ } mesh_action; -+ } u; -+ } action; -+ } u; -+} ; -+ -+#pragma pack() -+ -+#endif -+ -+/* mgmt header + 1 byte category code */ -+#define IEEE80211_MIN_ACTION_SIZE FIELD_OFFSET(struct ieee80211_mgmt, u.action.u) -+ -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/ieee80211.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/ieee80211.h ---- linux-4.14.18/3rdparty/rtl8723de/include/ieee80211.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/ieee80211.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,1931 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __IEEE80211_H -+#define __IEEE80211_H -+ -+ -+#ifndef CONFIG_RTL8711FW -+ -+ #if defined PLATFORM_OS_XP -+ #include -+ #endif -+#else -+ -+#endif -+ -+#define MGMT_QUEUE_NUM 5 -+ -+#define ETH_ALEN 6 -+#define ETH_TYPE_LEN 2 -+#define PAYLOAD_TYPE_LEN 1 -+ -+#define NET80211_TU_TO_US 1024 /* unit:us */ -+#define DEFAULT_BCN_INTERVAL 100 /* 100 ms */ -+ -+#ifdef CONFIG_AP_MODE -+ -+#define RTL_IOCTL_HOSTAPD (SIOCIWFIRSTPRIV + 28) -+ -+/* RTL871X_IOCTL_HOSTAPD ioctl() cmd: */ -+enum { -+ RTL871X_HOSTAPD_FLUSH = 1, -+ RTL871X_HOSTAPD_ADD_STA = 2, -+ RTL871X_HOSTAPD_REMOVE_STA = 3, -+ RTL871X_HOSTAPD_GET_INFO_STA = 4, -+ /* REMOVED: PRISM2_HOSTAPD_RESET_TXEXC_STA = 5, */ -+ RTL871X_HOSTAPD_GET_WPAIE_STA = 5, -+ RTL871X_SET_ENCRYPTION = 6, -+ RTL871X_GET_ENCRYPTION = 7, -+ RTL871X_HOSTAPD_SET_FLAGS_STA = 8, -+ RTL871X_HOSTAPD_GET_RID = 9, -+ RTL871X_HOSTAPD_SET_RID = 10, -+ RTL871X_HOSTAPD_SET_ASSOC_AP_ADDR = 11, -+ RTL871X_HOSTAPD_SET_GENERIC_ELEMENT = 12, -+ RTL871X_HOSTAPD_MLME = 13, -+ RTL871X_HOSTAPD_SCAN_REQ = 14, -+ RTL871X_HOSTAPD_STA_CLEAR_STATS = 15, -+ RTL871X_HOSTAPD_SET_BEACON = 16, -+ RTL871X_HOSTAPD_SET_WPS_BEACON = 17, -+ RTL871X_HOSTAPD_SET_WPS_PROBE_RESP = 18, -+ RTL871X_HOSTAPD_SET_WPS_ASSOC_RESP = 19, -+ RTL871X_HOSTAPD_SET_HIDDEN_SSID = 20, -+ RTL871X_HOSTAPD_SET_MACADDR_ACL = 21, -+ RTL871X_HOSTAPD_ACL_ADD_STA = 22, -+ RTL871X_HOSTAPD_ACL_REMOVE_STA = 23, -+}; -+ -+/* STA flags */ -+#define WLAN_STA_AUTH BIT(0) -+#define WLAN_STA_ASSOC BIT(1) -+#define WLAN_STA_PS BIT(2) -+#define WLAN_STA_TIM BIT(3) -+#define WLAN_STA_PERM BIT(4) -+#define WLAN_STA_AUTHORIZED BIT(5) -+#define WLAN_STA_PENDING_POLL BIT(6) /* pending activity poll not ACKed */ -+#define WLAN_STA_SHORT_PREAMBLE BIT(7) -+#define WLAN_STA_PREAUTH BIT(8) -+#define WLAN_STA_WME BIT(9) -+#define WLAN_STA_MFP BIT(10) -+#define WLAN_STA_HT BIT(11) -+#define WLAN_STA_WPS BIT(12) -+#define WLAN_STA_MAYBE_WPS BIT(13) -+#define WLAN_STA_VHT BIT(14) -+#define WLAN_STA_NONERP BIT(31) -+ -+#endif -+ -+#define IEEE_CMD_SET_WPA_PARAM 1 -+#define IEEE_CMD_SET_WPA_IE 2 -+#define IEEE_CMD_SET_ENCRYPTION 3 -+#define IEEE_CMD_MLME 4 -+ -+#define IEEE_PARAM_WPA_ENABLED 1 -+#define IEEE_PARAM_TKIP_COUNTERMEASURES 2 -+#define IEEE_PARAM_DROP_UNENCRYPTED 3 -+#define IEEE_PARAM_PRIVACY_INVOKED 4 -+#define IEEE_PARAM_AUTH_ALGS 5 -+#define IEEE_PARAM_IEEE_802_1X 6 -+#define IEEE_PARAM_WPAX_SELECT 7 -+ -+#define AUTH_ALG_OPEN_SYSTEM 0x1 -+#define AUTH_ALG_SHARED_KEY 0x2 -+#define AUTH_ALG_LEAP 0x00000004 -+ -+#define IEEE_MLME_STA_DEAUTH 1 -+#define IEEE_MLME_STA_DISASSOC 2 -+ -+#define IEEE_CRYPT_ERR_UNKNOWN_ALG 2 -+#define IEEE_CRYPT_ERR_UNKNOWN_ADDR 3 -+#define IEEE_CRYPT_ERR_CRYPT_INIT_FAILED 4 -+#define IEEE_CRYPT_ERR_KEY_SET_FAILED 5 -+#define IEEE_CRYPT_ERR_TX_KEY_SET_FAILED 6 -+#define IEEE_CRYPT_ERR_CARD_CONF_FAILED 7 -+ -+ -+#define IEEE_CRYPT_ALG_NAME_LEN 16 -+ -+#define WPA_CIPHER_NONE BIT(0) -+#define WPA_CIPHER_WEP40 BIT(1) -+#define WPA_CIPHER_WEP104 BIT(2) -+#define WPA_CIPHER_TKIP BIT(3) -+#define WPA_CIPHER_CCMP BIT(4) -+ -+ -+ -+#define WPA_SELECTOR_LEN 4 -+extern u8 RTW_WPA_OUI_TYPE[] ; -+extern u16 RTW_WPA_VERSION ; -+extern u8 WPA_AUTH_KEY_MGMT_NONE[]; -+extern u8 WPA_AUTH_KEY_MGMT_UNSPEC_802_1X[]; -+extern u8 WPA_AUTH_KEY_MGMT_PSK_OVER_802_1X[]; -+extern u8 WPA_CIPHER_SUITE_NONE[]; -+extern u8 WPA_CIPHER_SUITE_WEP40[]; -+extern u8 WPA_CIPHER_SUITE_TKIP[]; -+extern u8 WPA_CIPHER_SUITE_WRAP[]; -+extern u8 WPA_CIPHER_SUITE_CCMP[]; -+extern u8 WPA_CIPHER_SUITE_WEP104[]; -+ -+ -+#define RSN_HEADER_LEN 4 -+#define RSN_SELECTOR_LEN 4 -+ -+extern u16 RSN_VERSION_BSD; -+extern u8 RSN_AUTH_KEY_MGMT_UNSPEC_802_1X[]; -+extern u8 RSN_AUTH_KEY_MGMT_PSK_OVER_802_1X[]; -+extern u8 RSN_CIPHER_SUITE_NONE[]; -+extern u8 RSN_CIPHER_SUITE_WEP40[]; -+extern u8 RSN_CIPHER_SUITE_TKIP[]; -+extern u8 RSN_CIPHER_SUITE_WRAP[]; -+extern u8 RSN_CIPHER_SUITE_CCMP[]; -+extern u8 RSN_CIPHER_SUITE_WEP104[]; -+ -+ -+typedef enum _RATEID_IDX_ { -+ RATEID_IDX_BGN_40M_2SS = 0, -+ RATEID_IDX_BGN_40M_1SS = 1, -+ RATEID_IDX_BGN_20M_2SS_BN = 2, -+ RATEID_IDX_BGN_20M_1SS_BN = 3, -+ RATEID_IDX_GN_N2SS = 4, -+ RATEID_IDX_GN_N1SS = 5, -+ RATEID_IDX_BG = 6, -+ RATEID_IDX_G = 7, -+ RATEID_IDX_B = 8, -+ RATEID_IDX_VHT_2SS = 9, -+ RATEID_IDX_VHT_1SS = 10, -+ RATEID_IDX_MIX1 = 11, -+ RATEID_IDX_MIX2 = 12, -+ RATEID_IDX_VHT_3SS = 13, -+ RATEID_IDX_BGN_3SS = 14, -+} RATEID_IDX, *PRATEID_IDX; -+ -+typedef enum _RATR_TABLE_MODE { -+ RATR_INX_WIRELESS_NGB = 0, /* BGN 40 Mhz 2SS 1SS */ -+ RATR_INX_WIRELESS_NG = 1, /* GN or N */ -+ RATR_INX_WIRELESS_NB = 2, /* BGN 20 Mhz 2SS 1SS or BN */ -+ RATR_INX_WIRELESS_N = 3, -+ RATR_INX_WIRELESS_GB = 4, -+ RATR_INX_WIRELESS_G = 5, -+ RATR_INX_WIRELESS_B = 6, -+ RATR_INX_WIRELESS_MC = 7, -+ RATR_INX_WIRELESS_AC_N = 8, -+} RATR_TABLE_MODE, *PRATR_TABLE_MODE; -+ -+ -+enum NETWORK_TYPE { -+ WIRELESS_INVALID = 0, -+ /* Sub-Element */ -+ WIRELESS_11B = BIT(0), /* tx: cck only , rx: cck only, hw: cck */ -+ WIRELESS_11G = BIT(1), /* tx: ofdm only, rx: ofdm & cck, hw: cck & ofdm */ -+ WIRELESS_11A = BIT(2), /* tx: ofdm only, rx: ofdm only, hw: ofdm only */ -+ WIRELESS_11_24N = BIT(3), /* tx: MCS only, rx: MCS & cck, hw: MCS & cck */ -+ WIRELESS_11_5N = BIT(4), /* tx: MCS only, rx: MCS & ofdm, hw: ofdm only */ -+ WIRELESS_AUTO = BIT(5), -+ WIRELESS_11AC = BIT(6), -+ -+ /* Combination */ -+ /* Type for current wireless mode */ -+ WIRELESS_11BG = (WIRELESS_11B | WIRELESS_11G), /* tx: cck & ofdm, rx: cck & ofdm & MCS, hw: cck & ofdm */ -+ WIRELESS_11G_24N = (WIRELESS_11G | WIRELESS_11_24N), /* tx: ofdm & MCS, rx: ofdm & cck & MCS, hw: cck & ofdm */ -+ WIRELESS_11A_5N = (WIRELESS_11A | WIRELESS_11_5N), /* tx: ofdm & MCS, rx: ofdm & MCS, hw: ofdm only */ -+ WIRELESS_11B_24N = (WIRELESS_11B | WIRELESS_11_24N), /* tx: ofdm & cck & MCS, rx: ofdm & cck & MCS, hw: ofdm & cck */ -+ WIRELESS_11BG_24N = (WIRELESS_11B | WIRELESS_11G | WIRELESS_11_24N), /* tx: ofdm & cck & MCS, rx: ofdm & cck & MCS, hw: ofdm & cck */ -+ WIRELESS_11_24AC = (WIRELESS_11G | WIRELESS_11AC), -+ WIRELESS_11_5AC = (WIRELESS_11A | WIRELESS_11AC), -+ -+ -+ /* Type for registry default wireless mode */ -+ WIRELESS_11AGN = (WIRELESS_11A | WIRELESS_11G | WIRELESS_11_24N | WIRELESS_11_5N), /* tx: ofdm & MCS, rx: ofdm & MCS, hw: ofdm only */ -+ WIRELESS_11ABGN = (WIRELESS_11A | WIRELESS_11B | WIRELESS_11G | WIRELESS_11_24N | WIRELESS_11_5N), -+ WIRELESS_MODE_24G = (WIRELESS_11B | WIRELESS_11G | WIRELESS_11_24N), -+ WIRELESS_MODE_5G = (WIRELESS_11A | WIRELESS_11_5N | WIRELESS_11AC), -+ WIRELESS_MODE_MAX = (WIRELESS_11A | WIRELESS_11B | WIRELESS_11G | WIRELESS_11_24N | WIRELESS_11_5N | WIRELESS_11AC), -+}; -+ -+#define SUPPORTED_24G_NETTYPE_MSK WIRELESS_MODE_24G -+#define SUPPORTED_5G_NETTYPE_MSK WIRELESS_MODE_5G -+ -+#define IsLegacyOnly(NetType) ((NetType) == ((NetType) & (WIRELESS_11BG | WIRELESS_11A))) -+ -+#define IsSupported24G(NetType) ((NetType) & SUPPORTED_24G_NETTYPE_MSK ? _TRUE : _FALSE) -+#define IsSupported5G(NetType) ((NetType) & SUPPORTED_5G_NETTYPE_MSK ? _TRUE : _FALSE) -+ -+#define IsEnableHWCCK(NetType) IsSupported24G(NetType) -+#define IsEnableHWOFDM(NetType) ((NetType) & (WIRELESS_11G | WIRELESS_11_24N | SUPPORTED_5G_NETTYPE_MSK) ? _TRUE : _FALSE) -+ -+#define IsSupportedRxCCK(NetType) IsEnableHWCCK(NetType) -+#define IsSupportedRxOFDM(NetType) IsEnableHWOFDM(NetType) -+#define IsSupportedRxHT(NetType) IsEnableHWOFDM(NetType) -+ -+#define IsSupportedTxCCK(NetType) ((NetType) & (WIRELESS_11B) ? _TRUE : _FALSE) -+#define IsSupportedTxOFDM(NetType) ((NetType) & (WIRELESS_11G | WIRELESS_11A) ? _TRUE : _FALSE) -+#define IsSupportedHT(NetType) ((NetType) & (WIRELESS_11_24N | WIRELESS_11_5N) ? _TRUE : _FALSE) -+ -+#define IsSupportedVHT(NetType) ((NetType) & (WIRELESS_11AC) ? _TRUE : _FALSE) -+ -+ -+typedef struct ieee_param { -+ u32 cmd; -+ u8 sta_addr[ETH_ALEN]; -+ union { -+ struct { -+ u8 name; -+ u32 value; -+ } wpa_param; -+ struct { -+ u32 len; -+ u8 reserved[32]; -+ u8 data[0]; -+ } wpa_ie; -+ struct { -+ int command; -+ int reason_code; -+ } mlme; -+ struct { -+ u8 alg[IEEE_CRYPT_ALG_NAME_LEN]; -+ u8 set_tx; -+ u32 err; -+ u8 idx; -+ u8 seq[8]; /* sequence counter (set: RX, get: TX) */ -+ u16 key_len; -+ u8 key[0]; -+ } crypt; -+#ifdef CONFIG_AP_MODE -+ struct { -+ u16 aid; -+ u16 capability; -+ int flags; -+ u8 tx_supp_rates[16]; -+ struct rtw_ieee80211_ht_cap ht_cap; -+ } add_sta; -+ struct { -+ u8 reserved[2];/* for set max_num_sta */ -+ u8 buf[0]; -+ } bcn_ie; -+#endif -+ -+ } u; -+} ieee_param; -+ -+#ifdef CONFIG_AP_MODE -+typedef struct ieee_param_ex { -+ u32 cmd; -+ u8 sta_addr[ETH_ALEN]; -+ u8 data[0]; -+} ieee_param_ex; -+ -+struct sta_data { -+ u16 aid; -+ u16 capability; -+ int flags; -+ u32 sta_set; -+ u8 tx_supp_rates[16]; -+ u32 tx_supp_rates_len; -+ struct rtw_ieee80211_ht_cap ht_cap; -+ u64 rx_pkts; -+ u64 rx_bytes; -+ u64 rx_drops; -+ u64 tx_pkts; -+ u64 tx_bytes; -+ u64 tx_drops; -+}; -+#endif -+ -+ -+#if WIRELESS_EXT < 17 -+ #define IW_QUAL_QUAL_INVALID 0x10 -+ #define IW_QUAL_LEVEL_INVALID 0x20 -+ #define IW_QUAL_NOISE_INVALID 0x40 -+ #define IW_QUAL_QUAL_UPDATED 0x1 -+ #define IW_QUAL_LEVEL_UPDATED 0x2 -+ #define IW_QUAL_NOISE_UPDATED 0x4 -+#endif -+ -+#define IEEE80211_DATA_LEN 2304 -+/* Maximum size for the MA-UNITDATA primitive, 802.11 standard section -+ 6.2.1.1.2. -+ -+ The figure in section 7.1.2 suggests a body size of up to 2312 -+ bytes is allowed, which is a bit confusing, I suspect this -+ represents the 2304 bytes of real data, plus a possible 8 bytes of -+ WEP IV and ICV. (this interpretation suggested by Ramiro Barreiro) */ -+ -+ -+#define IEEE80211_HLEN 30 -+#define IEEE80211_FRAME_LEN (IEEE80211_DATA_LEN + IEEE80211_HLEN) -+ -+ -+/* this is stolen from ipw2200 driver */ -+#define IEEE_IBSS_MAC_HASH_SIZE 31 -+ -+struct ieee_ibss_seq { -+ u8 mac[ETH_ALEN]; -+ u16 seq_num; -+ u16 frag_num; -+ unsigned long packet_time; -+ _list list; -+}; -+ -+#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) || defined(PLATFORM_FREEBSD) -+ -+struct rtw_ieee80211_hdr { -+ u16 frame_ctl; -+ u16 duration_id; -+ u8 addr1[ETH_ALEN]; -+ u8 addr2[ETH_ALEN]; -+ u8 addr3[ETH_ALEN]; -+ u16 seq_ctl; -+ u8 addr4[ETH_ALEN]; -+} __attribute__((packed)); -+ -+struct rtw_ieee80211_hdr_3addr { -+ u16 frame_ctl; -+ u16 duration_id; -+ u8 addr1[ETH_ALEN]; -+ u8 addr2[ETH_ALEN]; -+ u8 addr3[ETH_ALEN]; -+ u16 seq_ctl; -+} __attribute__((packed)); -+ -+ -+struct rtw_ieee80211_hdr_qos { -+ u16 frame_ctl; -+ u16 duration_id; -+ u8 addr1[ETH_ALEN]; -+ u8 addr2[ETH_ALEN]; -+ u8 addr3[ETH_ALEN]; -+ u16 seq_ctl; -+ u8 addr4[ETH_ALEN]; -+ u16 qc; -+} __attribute__((packed)); -+ -+struct rtw_ieee80211_hdr_3addr_qos { -+ u16 frame_ctl; -+ u16 duration_id; -+ u8 addr1[ETH_ALEN]; -+ u8 addr2[ETH_ALEN]; -+ u8 addr3[ETH_ALEN]; -+ u16 seq_ctl; -+ u16 qc; -+} __attribute__((packed)); -+ -+struct eapol { -+ u8 snap[6]; -+ u16 ethertype; -+ u8 version; -+ u8 type; -+ u16 length; -+} __attribute__((packed)); -+ -+#endif -+ -+ -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+struct rtw_ieee80211_hdr { -+ u16 frame_ctl; -+ u16 duration_id; -+ u8 addr1[ETH_ALEN]; -+ u8 addr2[ETH_ALEN]; -+ u8 addr3[ETH_ALEN]; -+ u16 seq_ctl; -+ u8 addr4[ETH_ALEN]; -+}; -+ -+struct rtw_ieee80211_hdr_3addr { -+ u16 frame_ctl; -+ u16 duration_id; -+ u8 addr1[ETH_ALEN]; -+ u8 addr2[ETH_ALEN]; -+ u8 addr3[ETH_ALEN]; -+ u16 seq_ctl; -+}; -+ -+ -+struct rtw_ieee80211_hdr_qos { -+ struct rtw_ieee80211_hdr wlan_hdr; -+ u16 qc; -+}; -+ -+struct rtw_ieee80211_hdr_3addr_qos { -+ struct rtw_ieee80211_hdr_3addr wlan_hdr; -+ u16 qc; -+}; -+ -+struct eapol { -+ u8 snap[6]; -+ u16 ethertype; -+ u8 version; -+ u8 type; -+ u16 length; -+}; -+#pragma pack() -+ -+#endif -+ -+ -+ -+enum eap_type { -+ EAP_PACKET = 0, -+ EAPOL_START, -+ EAPOL_LOGOFF, -+ EAPOL_KEY, -+ EAPOL_ENCAP_ASF_ALERT -+}; -+ -+#define IEEE80211_3ADDR_LEN 24 -+#define IEEE80211_4ADDR_LEN 30 -+#define IEEE80211_FCS_LEN 4 -+ -+#define MIN_FRAG_THRESHOLD 256U -+#define MAX_FRAG_THRESHOLD 2346U -+ -+/* Frame control field constants */ -+#define RTW_IEEE80211_FCTL_VERS 0x0003 -+#define RTW_IEEE80211_FCTL_FTYPE 0x000c -+#define RTW_IEEE80211_FCTL_STYPE 0x00f0 -+#define RTW_IEEE80211_FCTL_TODS 0x0100 -+#define RTW_IEEE80211_FCTL_FROMDS 0x0200 -+#define RTW_IEEE80211_FCTL_MOREFRAGS 0x0400 -+#define RTW_IEEE80211_FCTL_RETRY 0x0800 -+#define RTW_IEEE80211_FCTL_PM 0x1000 -+#define RTW_IEEE80211_FCTL_MOREDATA 0x2000 -+#define RTW_IEEE80211_FCTL_PROTECTED 0x4000 -+#define RTW_IEEE80211_FCTL_ORDER 0x8000 -+#define RTW_IEEE80211_FCTL_CTL_EXT 0x0f00 -+ -+#define RTW_IEEE80211_FTYPE_MGMT 0x0000 -+#define RTW_IEEE80211_FTYPE_CTL 0x0004 -+#define RTW_IEEE80211_FTYPE_DATA 0x0008 -+#define RTW_IEEE80211_FTYPE_EXT 0x000c -+ -+/* management */ -+#define RTW_IEEE80211_STYPE_ASSOC_REQ 0x0000 -+#define RTW_IEEE80211_STYPE_ASSOC_RESP 0x0010 -+#define RTW_IEEE80211_STYPE_REASSOC_REQ 0x0020 -+#define RTW_IEEE80211_STYPE_REASSOC_RESP 0x0030 -+#define RTW_IEEE80211_STYPE_PROBE_REQ 0x0040 -+#define RTW_IEEE80211_STYPE_PROBE_RESP 0x0050 -+#define RTW_IEEE80211_STYPE_BEACON 0x0080 -+#define RTW_IEEE80211_STYPE_ATIM 0x0090 -+#define RTW_IEEE80211_STYPE_DISASSOC 0x00A0 -+#define RTW_IEEE80211_STYPE_AUTH 0x00B0 -+#define RTW_IEEE80211_STYPE_DEAUTH 0x00C0 -+#define RTW_IEEE80211_STYPE_ACTION 0x00D0 -+ -+/* control */ -+#define RTW_IEEE80211_STYPE_CTL_EXT 0x0060 -+#define RTW_IEEE80211_STYPE_BACK_REQ 0x0080 -+#define RTW_IEEE80211_STYPE_BACK 0x0090 -+#define RTW_IEEE80211_STYPE_PSPOLL 0x00A0 -+#define RTW_IEEE80211_STYPE_RTS 0x00B0 -+#define RTW_IEEE80211_STYPE_CTS 0x00C0 -+#define RTW_IEEE80211_STYPE_ACK 0x00D0 -+#define RTW_IEEE80211_STYPE_CFEND 0x00E0 -+#define RTW_IEEE80211_STYPE_CFENDACK 0x00F0 -+ -+/* data */ -+#define RTW_IEEE80211_STYPE_DATA 0x0000 -+#define RTW_IEEE80211_STYPE_DATA_CFACK 0x0010 -+#define RTW_IEEE80211_STYPE_DATA_CFPOLL 0x0020 -+#define RTW_IEEE80211_STYPE_DATA_CFACKPOLL 0x0030 -+#define RTW_IEEE80211_STYPE_NULLFUNC 0x0040 -+#define RTW_IEEE80211_STYPE_CFACK 0x0050 -+#define RTW_IEEE80211_STYPE_CFPOLL 0x0060 -+#define RTW_IEEE80211_STYPE_CFACKPOLL 0x0070 -+#define RTW_IEEE80211_STYPE_QOS_DATA 0x0080 -+#define RTW_IEEE80211_STYPE_QOS_DATA_CFACK 0x0090 -+#define RTW_IEEE80211_STYPE_QOS_DATA_CFPOLL 0x00A0 -+#define RTW_IEEE80211_STYPE_QOS_DATA_CFACKPOLL 0x00B0 -+#define RTW_IEEE80211_STYPE_QOS_NULLFUNC 0x00C0 -+#define RTW_IEEE80211_STYPE_QOS_CFACK 0x00D0 -+#define RTW_IEEE80211_STYPE_QOS_CFPOLL 0x00E0 -+#define RTW_IEEE80211_STYPE_QOS_CFACKPOLL 0x00F0 -+ -+/* sequence control field */ -+#define RTW_IEEE80211_SCTL_FRAG 0x000F -+#define RTW_IEEE80211_SCTL_SEQ 0xFFF0 -+ -+ -+#define RTW_ERP_INFO_NON_ERP_PRESENT BIT(0) -+#define RTW_ERP_INFO_USE_PROTECTION BIT(1) -+#define RTW_ERP_INFO_BARKER_PREAMBLE_MODE BIT(2) -+ -+/* QoS,QOS */ -+#define NORMAL_ACK 0 -+#define NO_ACK 1 -+#define NON_EXPLICIT_ACK 2 -+#define BLOCK_ACK 3 -+ -+#ifndef ETH_P_PAE -+ #define ETH_P_PAE 0x888E /* Port Access Entity (IEEE 802.1X) */ -+#endif /* ETH_P_PAE */ -+ -+#define ETH_P_PREAUTH 0x88C7 /* IEEE 802.11i pre-authentication */ -+ -+#define ETH_P_ECONET 0x0018 -+ -+#ifndef ETH_P_80211_RAW -+ #define ETH_P_80211_RAW (ETH_P_ECONET + 1) -+#endif -+ -+/* IEEE 802.11 defines */ -+ -+#define P80211_OUI_LEN 3 -+ -+#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) || defined(PLATFORM_FREEBSD) -+ -+struct ieee80211_snap_hdr { -+ -+ u8 dsap; /* always 0xAA */ -+ u8 ssap; /* always 0xAA */ -+ u8 ctrl; /* always 0x03 */ -+ u8 oui[P80211_OUI_LEN]; /* organizational universal id */ -+ -+} __attribute__((packed)); -+ -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+struct ieee80211_snap_hdr { -+ -+ u8 dsap; /* always 0xAA */ -+ u8 ssap; /* always 0xAA */ -+ u8 ctrl; /* always 0x03 */ -+ u8 oui[P80211_OUI_LEN]; /* organizational universal id */ -+ -+}; -+#pragma pack() -+ -+#endif -+ -+ -+#define SNAP_SIZE sizeof(struct ieee80211_snap_hdr) -+ -+#define WLAN_FC_GET_TYPE(fc) ((fc) & RTW_IEEE80211_FCTL_FTYPE) -+#define WLAN_FC_GET_STYPE(fc) ((fc) & RTW_IEEE80211_FCTL_STYPE) -+ -+#define WLAN_QC_GET_TID(qc) ((qc) & 0x0f) -+ -+#define WLAN_GET_SEQ_FRAG(seq) ((seq) & RTW_IEEE80211_SCTL_FRAG) -+#define WLAN_GET_SEQ_SEQ(seq) ((seq) & RTW_IEEE80211_SCTL_SEQ) -+ -+/* Authentication algorithms */ -+#define WLAN_AUTH_OPEN 0 -+#define WLAN_AUTH_SHARED_KEY 1 -+ -+#define WLAN_AUTH_CHALLENGE_LEN 128 -+ -+#define WLAN_CAPABILITY_BSS (1<<0) -+#define WLAN_CAPABILITY_IBSS (1<<1) -+#define WLAN_CAPABILITY_CF_POLLABLE (1<<2) -+#define WLAN_CAPABILITY_CF_POLL_REQUEST (1<<3) -+#define WLAN_CAPABILITY_PRIVACY (1<<4) -+#define WLAN_CAPABILITY_SHORT_PREAMBLE (1<<5) -+#define WLAN_CAPABILITY_PBCC (1<<6) -+#define WLAN_CAPABILITY_CHANNEL_AGILITY (1<<7) -+#define WLAN_CAPABILITY_SHORT_SLOT (1<<10) -+ -+/* Status codes */ -+#define WLAN_STATUS_SUCCESS 0 -+#define WLAN_STATUS_UNSPECIFIED_FAILURE 1 -+#define WLAN_STATUS_CAPS_UNSUPPORTED 10 -+#define WLAN_STATUS_REASSOC_NO_ASSOC 11 -+#define WLAN_STATUS_ASSOC_DENIED_UNSPEC 12 -+#define WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG 13 -+#define WLAN_STATUS_UNKNOWN_AUTH_TRANSACTION 14 -+#define WLAN_STATUS_CHALLENGE_FAIL 15 -+#define WLAN_STATUS_AUTH_TIMEOUT 16 -+#define WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA 17 -+#define WLAN_STATUS_ASSOC_DENIED_RATES 18 -+/* 802.11b */ -+#define WLAN_STATUS_ASSOC_DENIED_NOSHORT 19 -+#define WLAN_STATUS_ASSOC_DENIED_NOPBCC 20 -+#define WLAN_STATUS_ASSOC_DENIED_NOAGILITY 21 -+ -+/* Reason codes */ -+#define WLAN_REASON_UNSPECIFIED 1 -+#define WLAN_REASON_PREV_AUTH_NOT_VALID 2 -+#define WLAN_REASON_DEAUTH_LEAVING 3 -+#define WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY 4 -+#define WLAN_REASON_DISASSOC_AP_BUSY 5 -+#define WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA 6 -+#define WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA 7 -+#define WLAN_REASON_DISASSOC_STA_HAS_LEFT 8 -+#define WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH 9 -+#define WLAN_REASON_ACTIVE_ROAM 65533 -+#define WLAN_REASON_JOIN_WRONG_CHANNEL 65534 -+#define WLAN_REASON_EXPIRATION_CHK 65535 -+ -+/* Information Element IDs */ -+#define WLAN_EID_SSID 0 -+#define WLAN_EID_SUPP_RATES 1 -+#define WLAN_EID_FH_PARAMS 2 -+#define WLAN_EID_DS_PARAMS 3 -+#define WLAN_EID_CF_PARAMS 4 -+#define WLAN_EID_TIM 5 -+#define WLAN_EID_IBSS_PARAMS 6 -+#define WLAN_EID_CHALLENGE 16 -+/* EIDs defined by IEEE 802.11h - START */ -+#define WLAN_EID_PWR_CONSTRAINT 32 -+#define WLAN_EID_PWR_CAPABILITY 33 -+#define WLAN_EID_TPC_REQUEST 34 -+#define WLAN_EID_TPC_REPORT 35 -+#define WLAN_EID_SUPPORTED_CHANNELS 36 -+#define WLAN_EID_CHANNEL_SWITCH 37 -+#define WLAN_EID_MEASURE_REQUEST 38 -+#define WLAN_EID_MEASURE_REPORT 39 -+#define WLAN_EID_QUITE 40 -+#define WLAN_EID_IBSS_DFS 41 -+/* EIDs defined by IEEE 802.11h - END */ -+#define WLAN_EID_ERP_INFO 42 -+#define WLAN_EID_HT_CAP 45 -+#define WLAN_EID_RSN 48 -+#define WLAN_EID_EXT_SUPP_RATES 50 -+#define WLAN_EID_MOBILITY_DOMAIN 54 -+#define WLAN_EID_FAST_BSS_TRANSITION 55 -+#define WLAN_EID_TIMEOUT_INTERVAL 56 -+#define WLAN_EID_RIC_DATA 57 -+#define WLAN_EID_HT_OPERATION 61 -+#define WLAN_EID_SECONDARY_CHANNEL_OFFSET 62 -+#define WLAN_EID_20_40_BSS_COEXISTENCE 72 -+#define WLAN_EID_20_40_BSS_INTOLERANT 73 -+#define WLAN_EID_OVERLAPPING_BSS_SCAN_PARAMS 74 -+#define WLAN_EID_MMIE 76 -+#define WLAN_EID_VENDOR_SPECIFIC 221 -+#define WLAN_EID_GENERIC (WLAN_EID_VENDOR_SPECIFIC) -+#define WLAN_EID_VHT_CAPABILITY 191 -+#define WLAN_EID_VHT_OPERATION 192 -+#define WLAN_EID_VHT_OP_MODE_NOTIFY 199 -+ -+#define IEEE80211_MGMT_HDR_LEN 24 -+#define IEEE80211_DATA_HDR3_LEN 24 -+#define IEEE80211_DATA_HDR4_LEN 30 -+ -+ -+#define IEEE80211_STATMASK_SIGNAL (1<<0) -+#define IEEE80211_STATMASK_RSSI (1<<1) -+#define IEEE80211_STATMASK_NOISE (1<<2) -+#define IEEE80211_STATMASK_RATE (1<<3) -+#define IEEE80211_STATMASK_WEMASK 0x7 -+ -+ -+#define IEEE80211_CCK_MODULATION (1<<0) -+#define IEEE80211_OFDM_MODULATION (1<<1) -+ -+#define IEEE80211_24GHZ_BAND (1<<0) -+#define IEEE80211_52GHZ_BAND (1<<1) -+ -+#define IEEE80211_CCK_RATE_LEN 4 -+#define IEEE80211_NUM_OFDM_RATESLEN 8 -+ -+ -+#define IEEE80211_CCK_RATE_1MB 0x02 -+#define IEEE80211_CCK_RATE_2MB 0x04 -+#define IEEE80211_CCK_RATE_5MB 0x0B -+#define IEEE80211_CCK_RATE_11MB 0x16 -+#define IEEE80211_OFDM_RATE_LEN 8 -+#define IEEE80211_OFDM_RATE_6MB 0x0C -+#define IEEE80211_OFDM_RATE_9MB 0x12 -+#define IEEE80211_OFDM_RATE_12MB 0x18 -+#define IEEE80211_OFDM_RATE_18MB 0x24 -+#define IEEE80211_OFDM_RATE_24MB 0x30 -+#define IEEE80211_OFDM_RATE_36MB 0x48 -+#define IEEE80211_OFDM_RATE_48MB 0x60 -+#define IEEE80211_OFDM_RATE_54MB 0x6C -+#define IEEE80211_BASIC_RATE_MASK 0x80 -+ -+#define IEEE80211_CCK_RATE_1MB_MASK (1<<0) -+#define IEEE80211_CCK_RATE_2MB_MASK (1<<1) -+#define IEEE80211_CCK_RATE_5MB_MASK (1<<2) -+#define IEEE80211_CCK_RATE_11MB_MASK (1<<3) -+#define IEEE80211_OFDM_RATE_6MB_MASK (1<<4) -+#define IEEE80211_OFDM_RATE_9MB_MASK (1<<5) -+#define IEEE80211_OFDM_RATE_12MB_MASK (1<<6) -+#define IEEE80211_OFDM_RATE_18MB_MASK (1<<7) -+#define IEEE80211_OFDM_RATE_24MB_MASK (1<<8) -+#define IEEE80211_OFDM_RATE_36MB_MASK (1<<9) -+#define IEEE80211_OFDM_RATE_48MB_MASK (1<<10) -+#define IEEE80211_OFDM_RATE_54MB_MASK (1<<11) -+ -+#define IEEE80211_CCK_RATES_MASK 0x0000000F -+#define IEEE80211_CCK_BASIC_RATES_MASK (IEEE80211_CCK_RATE_1MB_MASK | \ -+ IEEE80211_CCK_RATE_2MB_MASK) -+#define IEEE80211_CCK_DEFAULT_RATES_MASK (IEEE80211_CCK_BASIC_RATES_MASK | \ -+ IEEE80211_CCK_RATE_5MB_MASK | \ -+ IEEE80211_CCK_RATE_11MB_MASK) -+ -+#define IEEE80211_OFDM_RATES_MASK 0x00000FF0 -+#define IEEE80211_OFDM_BASIC_RATES_MASK (IEEE80211_OFDM_RATE_6MB_MASK | \ -+ IEEE80211_OFDM_RATE_12MB_MASK | \ -+ IEEE80211_OFDM_RATE_24MB_MASK) -+#define IEEE80211_OFDM_DEFAULT_RATES_MASK (IEEE80211_OFDM_BASIC_RATES_MASK | \ -+ IEEE80211_OFDM_RATE_9MB_MASK | \ -+ IEEE80211_OFDM_RATE_18MB_MASK | \ -+ IEEE80211_OFDM_RATE_36MB_MASK | \ -+ IEEE80211_OFDM_RATE_48MB_MASK | \ -+ IEEE80211_OFDM_RATE_54MB_MASK) -+#define IEEE80211_DEFAULT_RATES_MASK (IEEE80211_OFDM_DEFAULT_RATES_MASK | \ -+ IEEE80211_CCK_DEFAULT_RATES_MASK) -+ -+#define IEEE80211_NUM_OFDM_RATES 8 -+#define IEEE80211_NUM_CCK_RATES 4 -+#define IEEE80211_OFDM_SHIFT_MASK_A 4 -+ -+ -+enum MGN_RATE { -+ MGN_1M = 0x02, -+ MGN_2M = 0x04, -+ MGN_5_5M = 0x0B, -+ MGN_6M = 0x0C, -+ MGN_9M = 0x12, -+ MGN_11M = 0x16, -+ MGN_12M = 0x18, -+ MGN_18M = 0x24, -+ MGN_24M = 0x30, -+ MGN_36M = 0x48, -+ MGN_48M = 0x60, -+ MGN_54M = 0x6C, -+ MGN_MCS32 = 0x7F, -+ MGN_MCS0, -+ MGN_MCS1, -+ MGN_MCS2, -+ MGN_MCS3, -+ MGN_MCS4, -+ MGN_MCS5, -+ MGN_MCS6, -+ MGN_MCS7, -+ MGN_MCS8, -+ MGN_MCS9, -+ MGN_MCS10, -+ MGN_MCS11, -+ MGN_MCS12, -+ MGN_MCS13, -+ MGN_MCS14, -+ MGN_MCS15, -+ MGN_MCS16, -+ MGN_MCS17, -+ MGN_MCS18, -+ MGN_MCS19, -+ MGN_MCS20, -+ MGN_MCS21, -+ MGN_MCS22, -+ MGN_MCS23, -+ MGN_MCS24, -+ MGN_MCS25, -+ MGN_MCS26, -+ MGN_MCS27, -+ MGN_MCS28, -+ MGN_MCS29, -+ MGN_MCS30, -+ MGN_MCS31, -+ MGN_VHT1SS_MCS0, -+ MGN_VHT1SS_MCS1, -+ MGN_VHT1SS_MCS2, -+ MGN_VHT1SS_MCS3, -+ MGN_VHT1SS_MCS4, -+ MGN_VHT1SS_MCS5, -+ MGN_VHT1SS_MCS6, -+ MGN_VHT1SS_MCS7, -+ MGN_VHT1SS_MCS8, -+ MGN_VHT1SS_MCS9, -+ MGN_VHT2SS_MCS0, -+ MGN_VHT2SS_MCS1, -+ MGN_VHT2SS_MCS2, -+ MGN_VHT2SS_MCS3, -+ MGN_VHT2SS_MCS4, -+ MGN_VHT2SS_MCS5, -+ MGN_VHT2SS_MCS6, -+ MGN_VHT2SS_MCS7, -+ MGN_VHT2SS_MCS8, -+ MGN_VHT2SS_MCS9, -+ MGN_VHT3SS_MCS0, -+ MGN_VHT3SS_MCS1, -+ MGN_VHT3SS_MCS2, -+ MGN_VHT3SS_MCS3, -+ MGN_VHT3SS_MCS4, -+ MGN_VHT3SS_MCS5, -+ MGN_VHT3SS_MCS6, -+ MGN_VHT3SS_MCS7, -+ MGN_VHT3SS_MCS8, -+ MGN_VHT3SS_MCS9, -+ MGN_VHT4SS_MCS0, -+ MGN_VHT4SS_MCS1, -+ MGN_VHT4SS_MCS2, -+ MGN_VHT4SS_MCS3, -+ MGN_VHT4SS_MCS4, -+ MGN_VHT4SS_MCS5, -+ MGN_VHT4SS_MCS6, -+ MGN_VHT4SS_MCS7, -+ MGN_VHT4SS_MCS8, -+ MGN_VHT4SS_MCS9, -+ MGN_UNKNOWN -+}; -+ -+#define IS_HT_RATE(_rate) ((_rate) >= MGN_MCS0 && (_rate) <= MGN_MCS31) -+#define IS_VHT_RATE(_rate) ((_rate) >= MGN_VHT1SS_MCS0 && (_rate) <= MGN_VHT4SS_MCS9) -+#define IS_CCK_RATE(_rate) ((_rate) == MGN_1M || (_rate) == MGN_2M || (_rate) == MGN_5_5M || (_rate) == MGN_11M) -+#define IS_OFDM_RATE(_rate) ((_rate) >= MGN_6M && (_rate) <= MGN_54M && (_rate) != MGN_11M) -+ -+#define IS_HT1SS_RATE(_rate) ((_rate) >= MGN_MCS0 && (_rate) <= MGN_MCS7) -+#define IS_HT2SS_RATE(_rate) ((_rate) >= MGN_MCS8 && (_rate) <= MGN_MCS15) -+#define IS_HT3SS_RATE(_rate) ((_rate) >= MGN_MCS16 && (_rate) <= MGN_MCS23) -+#define IS_HT4SS_RATE(_rate) ((_rate) >= MGN_MCS24 && (_rate) <= MGN_MCS31) -+ -+#define IS_VHT1SS_RATE(_rate) ((_rate) >= MGN_VHT1SS_MCS0 && (_rate) <= MGN_VHT1SS_MCS9) -+#define IS_VHT2SS_RATE(_rate) ((_rate) >= MGN_VHT2SS_MCS0 && (_rate) <= MGN_VHT2SS_MCS9) -+#define IS_VHT3SS_RATE(_rate) ((_rate) >= MGN_VHT3SS_MCS0 && (_rate) <= MGN_VHT3SS_MCS9) -+#define IS_VHT4SS_RATE(_rate) ((_rate) >= MGN_VHT4SS_MCS0 && (_rate) <= MGN_VHT4SS_MCS9) -+ -+#define IS_1T_RATE(_rate) (IS_CCK_RATE((_rate)) || IS_OFDM_RATE((_rate)) || IS_HT1SS_RATE((_rate)) || IS_VHT1SS_RATE((_rate))) -+#define IS_2T_RATE(_rate) (IS_HT2SS_RATE((_rate)) || IS_VHT2SS_RATE((_rate))) -+#define IS_3T_RATE(_rate) (IS_HT3SS_RATE((_rate)) || IS_VHT3SS_RATE((_rate))) -+#define IS_4T_RATE(_rate) (IS_HT4SS_RATE((_rate)) || IS_VHT4SS_RATE((_rate))) -+ -+#define MGN_RATE_STR(_rate) \ -+ (_rate == MGN_1M) ? "CCK_1M" : \ -+ (_rate == MGN_2M) ? "CCK_2M" : \ -+ (_rate == MGN_5_5M) ? "CCK_5.5M" : \ -+ (_rate == MGN_11M) ? "CCK_11M" : \ -+ (_rate == MGN_6M) ? "OFDM_6M" : \ -+ (_rate == MGN_9M) ? "OFDM_9M" : \ -+ (_rate == MGN_12M) ? "OFDM_12M" : \ -+ (_rate == MGN_18M) ? "OFDM_18M" : \ -+ (_rate == MGN_24M) ? "OFDM_24M" : \ -+ (_rate == MGN_36M) ? "OFDM_36M" : \ -+ (_rate == MGN_48M) ? "OFDM_48M" : \ -+ (_rate == MGN_54M) ? "OFDM_54M" : \ -+ (_rate == MGN_MCS32) ? "MCS32" : \ -+ (_rate == MGN_MCS0) ? "MCS0" : \ -+ (_rate == MGN_MCS1) ? "MCS1" : \ -+ (_rate == MGN_MCS2) ? "MCS2" : \ -+ (_rate == MGN_MCS3) ? "MCS3" : \ -+ (_rate == MGN_MCS4) ? "MCS4" : \ -+ (_rate == MGN_MCS5) ? "MCS5" : \ -+ (_rate == MGN_MCS6) ? "MCS6" : \ -+ (_rate == MGN_MCS7) ? "MCS7" : \ -+ (_rate == MGN_MCS8) ? "MCS8" : \ -+ (_rate == MGN_MCS9) ? "MCS9" : \ -+ (_rate == MGN_MCS10) ? "MCS10" : \ -+ (_rate == MGN_MCS11) ? "MCS11" : \ -+ (_rate == MGN_MCS12) ? "MCS12" : \ -+ (_rate == MGN_MCS13) ? "MCS13" : \ -+ (_rate == MGN_MCS14) ? "MCS14" : \ -+ (_rate == MGN_MCS15) ? "MCS15" : \ -+ (_rate == MGN_MCS16) ? "MCS16" : \ -+ (_rate == MGN_MCS17) ? "MCS17" : \ -+ (_rate == MGN_MCS18) ? "MCS18" : \ -+ (_rate == MGN_MCS19) ? "MCS19" : \ -+ (_rate == MGN_MCS20) ? "MCS20" : \ -+ (_rate == MGN_MCS21) ? "MCS21" : \ -+ (_rate == MGN_MCS22) ? "MCS22" : \ -+ (_rate == MGN_MCS23) ? "MCS23" : \ -+ (_rate == MGN_MCS24) ? "MCS24" : \ -+ (_rate == MGN_MCS25) ? "MCS25" : \ -+ (_rate == MGN_MCS26) ? "MCS26" : \ -+ (_rate == MGN_MCS27) ? "MCS27" : \ -+ (_rate == MGN_MCS28) ? "MCS28" : \ -+ (_rate == MGN_MCS29) ? "MCS29" : \ -+ (_rate == MGN_MCS30) ? "MCS30" : \ -+ (_rate == MGN_MCS31) ? "MCS31" : \ -+ (_rate == MGN_VHT1SS_MCS0) ? "VHT1SMCS0" : \ -+ (_rate == MGN_VHT1SS_MCS1) ? "VHT1SMCS1" : \ -+ (_rate == MGN_VHT1SS_MCS2) ? "VHT1SMCS2" : \ -+ (_rate == MGN_VHT1SS_MCS3) ? "VHT1SMCS3" : \ -+ (_rate == MGN_VHT1SS_MCS4) ? "VHT1SMCS4" : \ -+ (_rate == MGN_VHT1SS_MCS5) ? "VHT1SMCS5" : \ -+ (_rate == MGN_VHT1SS_MCS6) ? "VHT1SMCS6" : \ -+ (_rate == MGN_VHT1SS_MCS7) ? "VHT1SMCS7" : \ -+ (_rate == MGN_VHT1SS_MCS8) ? "VHT1SMCS8" : \ -+ (_rate == MGN_VHT1SS_MCS9) ? "VHT1SMCS9" : \ -+ (_rate == MGN_VHT2SS_MCS0) ? "VHT2SMCS0" : \ -+ (_rate == MGN_VHT2SS_MCS1) ? "VHT2SMCS1" : \ -+ (_rate == MGN_VHT2SS_MCS2) ? "VHT2SMCS2" : \ -+ (_rate == MGN_VHT2SS_MCS3) ? "VHT2SMCS3" : \ -+ (_rate == MGN_VHT2SS_MCS4) ? "VHT2SMCS4" : \ -+ (_rate == MGN_VHT2SS_MCS5) ? "VHT2SMCS5" : \ -+ (_rate == MGN_VHT2SS_MCS6) ? "VHT2SMCS6" : \ -+ (_rate == MGN_VHT2SS_MCS7) ? "VHT2SMCS7" : \ -+ (_rate == MGN_VHT2SS_MCS8) ? "VHT2SMCS8" : \ -+ (_rate == MGN_VHT2SS_MCS9) ? "VHT2SMCS9" : \ -+ (_rate == MGN_VHT3SS_MCS0) ? "VHT3SMCS0" : \ -+ (_rate == MGN_VHT3SS_MCS1) ? "VHT3SMCS1" : \ -+ (_rate == MGN_VHT3SS_MCS2) ? "VHT3SMCS2" : \ -+ (_rate == MGN_VHT3SS_MCS3) ? "VHT3SMCS3" : \ -+ (_rate == MGN_VHT3SS_MCS4) ? "VHT3SMCS4" : \ -+ (_rate == MGN_VHT3SS_MCS5) ? "VHT3SMCS5" : \ -+ (_rate == MGN_VHT3SS_MCS6) ? "VHT3SMCS6" : \ -+ (_rate == MGN_VHT3SS_MCS7) ? "VHT3SMCS7" : \ -+ (_rate == MGN_VHT3SS_MCS8) ? "VHT3SMCS8" : \ -+ (_rate == MGN_VHT3SS_MCS9) ? "VHT3SMCS9" : \ -+ (_rate == MGN_VHT4SS_MCS0) ? "VHT4SMCS0" : \ -+ (_rate == MGN_VHT4SS_MCS1) ? "VHT4SMCS1" : \ -+ (_rate == MGN_VHT4SS_MCS2) ? "VHT4SMCS2" : \ -+ (_rate == MGN_VHT4SS_MCS3) ? "VHT4SMCS3" : \ -+ (_rate == MGN_VHT4SS_MCS4) ? "VHT4SMCS4" : \ -+ (_rate == MGN_VHT4SS_MCS5) ? "VHT4SMCS5" : \ -+ (_rate == MGN_VHT4SS_MCS6) ? "VHT4SMCS6" : \ -+ (_rate == MGN_VHT4SS_MCS7) ? "VHT4SMCS7" : \ -+ (_rate == MGN_VHT4SS_MCS8) ? "VHT4SMCS8" : \ -+ (_rate == MGN_VHT4SS_MCS9) ? "VHT4SMCS9" : "UNKNOWN" -+ -+typedef enum _RATE_SECTION { -+ CCK = 0, -+ OFDM = 1, -+ HT_MCS0_MCS7 = 2, -+ HT_MCS8_MCS15 = 3, -+ HT_MCS16_MCS23 = 4, -+ HT_MCS24_MCS31 = 5, -+ HT_1SS = HT_MCS0_MCS7, -+ HT_2SS = HT_MCS8_MCS15, -+ HT_3SS = HT_MCS16_MCS23, -+ HT_4SS = HT_MCS24_MCS31, -+ VHT_1SSMCS0_1SSMCS9 = 6, -+ VHT_2SSMCS0_2SSMCS9 = 7, -+ VHT_3SSMCS0_3SSMCS9 = 8, -+ VHT_4SSMCS0_4SSMCS9 = 9, -+ VHT_1SS = VHT_1SSMCS0_1SSMCS9, -+ VHT_2SS = VHT_2SSMCS0_2SSMCS9, -+ VHT_3SS = VHT_3SSMCS0_3SSMCS9, -+ VHT_4SS = VHT_4SSMCS0_4SSMCS9, -+ RATE_SECTION_NUM, -+} RATE_SECTION; -+ -+const char *rate_section_str(u8 section); -+ -+#define IS_CCK_RATE_SECTION(section) ((section) == CCK) -+#define IS_OFDM_RATE_SECTION(section) ((section) == OFDM) -+#define IS_HT_RATE_SECTION(section) ((section) >= HT_1SS && (section) <= HT_4SS) -+#define IS_VHT_RATE_SECTION(section) ((section) >= VHT_1SS && (section) <= VHT_4SS) -+ -+#define IS_1T_RATE_SECTION(section) ((section) == CCK || (section) == OFDM || (section) == HT_1SS || (section) == VHT_1SS) -+#define IS_2T_RATE_SECTION(section) ((section) == HT_2SS || (section) == VHT_2SS) -+#define IS_3T_RATE_SECTION(section) ((section) == HT_3SS || (section) == VHT_3SS) -+#define IS_4T_RATE_SECTION(section) ((section) == HT_4SS || (section) == VHT_4SS) -+ -+extern u8 mgn_rates_cck[]; -+extern u8 mgn_rates_ofdm[]; -+extern u8 mgn_rates_mcs0_7[]; -+extern u8 mgn_rates_mcs8_15[]; -+extern u8 mgn_rates_mcs16_23[]; -+extern u8 mgn_rates_mcs24_31[]; -+extern u8 mgn_rates_vht1ss[]; -+extern u8 mgn_rates_vht2ss[]; -+extern u8 mgn_rates_vht3ss[]; -+extern u8 mgn_rates_vht4ss[]; -+ -+struct rate_section_ent { -+ u8 tx_num; /* value of RF_TX_NUM */ -+ u8 rate_num; -+ u8 *rates; -+}; -+ -+extern struct rate_section_ent rates_by_sections[]; -+ -+#define rate_section_to_tx_num(section) (rates_by_sections[(section)].tx_num) -+#define rate_section_rate_num(section) (rates_by_sections[(section)].rate_num) -+ -+/* NOTE: This data is for statistical purposes; not all hardware provides this -+ * information for frames received. Not setting these will not cause -+ * any adverse affects. */ -+struct ieee80211_rx_stats { -+ /* u32 mac_time[2]; */ -+ s8 rssi; -+ u8 signal; -+ u8 noise; -+ u8 received_channel; -+ u16 rate; /* in 100 kbps */ -+ /* u8 control; */ -+ u8 mask; -+ u8 freq; -+ u16 len; -+}; -+ -+/* IEEE 802.11 requires that STA supports concurrent reception of at least -+ * three fragmented frames. This define can be increased to support more -+ * concurrent frames, but it should be noted that each entry can consume about -+ * 2 kB of RAM and increasing cache size will slow down frame reassembly. */ -+#define IEEE80211_FRAG_CACHE_LEN 4 -+ -+struct ieee80211_frag_entry { -+ u32 first_frag_time; -+ uint seq; -+ uint last_frag; -+ uint qos; /* jackson */ -+ uint tid; /* jackson */ -+ struct sk_buff *skb; -+ u8 src_addr[ETH_ALEN]; -+ u8 dst_addr[ETH_ALEN]; -+}; -+ -+#ifndef PLATFORM_FREEBSD /* Baron BSD has already defined */ -+struct ieee80211_stats { -+ uint tx_unicast_frames; -+ uint tx_multicast_frames; -+ uint tx_fragments; -+ uint tx_unicast_octets; -+ uint tx_multicast_octets; -+ uint tx_deferred_transmissions; -+ uint tx_single_retry_frames; -+ uint tx_multiple_retry_frames; -+ uint tx_retry_limit_exceeded; -+ uint tx_discards; -+ uint rx_unicast_frames; -+ uint rx_multicast_frames; -+ uint rx_fragments; -+ uint rx_unicast_octets; -+ uint rx_multicast_octets; -+ uint rx_fcs_errors; -+ uint rx_discards_no_buffer; -+ uint tx_discards_wrong_sa; -+ uint rx_discards_undecryptable; -+ uint rx_message_in_msg_fragments; -+ uint rx_message_in_bad_msg_fragments; -+}; -+#endif /* PLATFORM_FREEBSD */ -+struct ieee80211_softmac_stats { -+ uint rx_ass_ok; -+ uint rx_ass_err; -+ uint rx_probe_rq; -+ uint tx_probe_rs; -+ uint tx_beacons; -+ uint rx_auth_rq; -+ uint rx_auth_rs_ok; -+ uint rx_auth_rs_err; -+ uint tx_auth_rq; -+ uint no_auth_rs; -+ uint no_ass_rs; -+ uint tx_ass_rq; -+ uint rx_ass_rq; -+ uint tx_probe_rq; -+ uint reassoc; -+ uint swtxstop; -+ uint swtxawake; -+}; -+ -+#define SEC_KEY_1 (1<<0) -+#define SEC_KEY_2 (1<<1) -+#define SEC_KEY_3 (1<<2) -+#define SEC_KEY_4 (1<<3) -+#define SEC_ACTIVE_KEY (1<<4) -+#define SEC_AUTH_MODE (1<<5) -+#define SEC_UNICAST_GROUP (1<<6) -+#define SEC_LEVEL (1<<7) -+#define SEC_ENABLED (1<<8) -+ -+#define SEC_LEVEL_0 0 /* None */ -+#define SEC_LEVEL_1 1 /* WEP 40 and 104 bit */ -+#define SEC_LEVEL_2 2 /* Level 1 + TKIP */ -+#define SEC_LEVEL_2_CKIP 3 /* Level 1 + CKIP */ -+#define SEC_LEVEL_3 4 /* Level 2 + CCMP */ -+ -+#define WEP_KEYS 4 -+#define WEP_KEY_LEN 13 -+ -+#ifdef CONFIG_IEEE80211W -+ #define BIP_MAX_KEYID 5 -+ #define BIP_AAD_SIZE 20 -+#endif /* CONFIG_IEEE80211W */ -+ -+#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) -+ -+struct ieee80211_security { -+ u16 active_key:2, -+ enabled:1, -+ auth_mode:2, -+ auth_algo:4, -+ unicast_uses_group:1; -+ u8 key_sizes[WEP_KEYS]; -+ u8 keys[WEP_KEYS][WEP_KEY_LEN]; -+ u8 level; -+ u16 flags; -+} __attribute__((packed)); -+ -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+struct ieee80211_security { -+ u16 active_key:2, -+ enabled:1, -+ auth_mode:2, -+ auth_algo:4, -+ unicast_uses_group:1; -+ u8 key_sizes[WEP_KEYS]; -+ u8 keys[WEP_KEYS][WEP_KEY_LEN]; -+ u8 level; -+ u16 flags; -+} ; -+#pragma pack() -+ -+#endif -+ -+/* -+ -+ 802.11 data frame from AP -+ -+ ,-------------------------------------------------------------------. -+Bytes | 2 | 2 | 6 | 6 | 6 | 2 | 0..2312 | 4 | -+ |------|------|---------|---------|---------|------|---------|------| -+Desc. | ctrl | dura | DA/RA | TA | SA | Sequ | frame | fcs | -+ | | tion | (BSSID) | | | ence | data | | -+ `-------------------------------------------------------------------' -+ -+Total: 28-2340 bytes -+ -+*/ -+ -+struct ieee80211_header_data { -+ u16 frame_ctl; -+ u16 duration_id; -+ u8 addr1[6]; -+ u8 addr2[6]; -+ u8 addr3[6]; -+ u16 seq_ctrl; -+}; -+ -+#define BEACON_PROBE_SSID_ID_POSITION 12 -+ -+/* Management Frame Information Element Types */ -+#define MFIE_TYPE_SSID 0 -+#define MFIE_TYPE_RATES 1 -+#define MFIE_TYPE_FH_SET 2 -+#define MFIE_TYPE_DS_SET 3 -+#define MFIE_TYPE_CF_SET 4 -+#define MFIE_TYPE_TIM 5 -+#define MFIE_TYPE_IBSS_SET 6 -+#define MFIE_TYPE_CHALLENGE 16 -+#define MFIE_TYPE_ERP 42 -+#define MFIE_TYPE_RSN 48 -+#define MFIE_TYPE_RATES_EX 50 -+#define MFIE_TYPE_GENERIC 221 -+ -+#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) -+ -+struct ieee80211_info_element_hdr { -+ u8 id; -+ u8 len; -+} __attribute__((packed)); -+ -+struct ieee80211_info_element { -+ u8 id; -+ u8 len; -+ u8 data[0]; -+} __attribute__((packed)); -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+struct ieee80211_info_element_hdr { -+ u8 id; -+ u8 len; -+} ; -+ -+struct ieee80211_info_element { -+ u8 id; -+ u8 len; -+ u8 data[0]; -+} ; -+#pragma pack() -+ -+#endif -+ -+ -+/* -+ * These are the data types that can make up management packets -+ * -+ u16 auth_algorithm; -+ u16 auth_sequence; -+ u16 beacon_interval; -+ u16 capability; -+ u8 current_ap[ETH_ALEN]; -+ u16 listen_interval; -+ struct { -+ u16 association_id:14, reserved:2; -+ } __attribute__ ((packed)); -+ u32 time_stamp[2]; -+ u16 reason; -+ u16 status; -+*/ -+ -+#define IEEE80211_DEFAULT_TX_ESSID "Penguin" -+#define IEEE80211_DEFAULT_BASIC_RATE 10 -+ -+ -+#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) -+ -+ -+struct ieee80211_authentication { -+ struct ieee80211_header_data header; -+ u16 algorithm; -+ u16 transaction; -+ u16 status; -+ /* struct ieee80211_info_element_hdr info_element; */ -+} __attribute__((packed)); -+ -+ -+struct ieee80211_probe_response { -+ struct ieee80211_header_data header; -+ u32 time_stamp[2]; -+ u16 beacon_interval; -+ u16 capability; -+ struct ieee80211_info_element info_element; -+} __attribute__((packed)); -+ -+struct ieee80211_probe_request { -+ struct ieee80211_header_data header; -+ /*struct ieee80211_info_element info_element;*/ -+} __attribute__((packed)); -+ -+struct ieee80211_assoc_request_frame { -+ struct rtw_ieee80211_hdr_3addr header; -+ u16 capability; -+ u16 listen_interval; -+ /* u8 current_ap[ETH_ALEN]; */ -+ struct ieee80211_info_element_hdr info_element; -+} __attribute__((packed)); -+ -+struct ieee80211_assoc_response_frame { -+ struct rtw_ieee80211_hdr_3addr header; -+ u16 capability; -+ u16 status; -+ u16 aid; -+ /* struct ieee80211_info_element info_element; supported rates */ -+} __attribute__((packed)); -+#endif -+ -+ -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+ -+struct ieee80211_authentication { -+ struct ieee80211_header_data header; -+ u16 algorithm; -+ u16 transaction; -+ u16 status; -+ /* struct ieee80211_info_element_hdr info_element; */ -+} ; -+ -+ -+struct ieee80211_probe_response { -+ struct ieee80211_header_data header; -+ u32 time_stamp[2]; -+ u16 beacon_interval; -+ u16 capability; -+ struct ieee80211_info_element info_element; -+} ; -+ -+struct ieee80211_probe_request { -+ struct ieee80211_header_data header; -+ /*struct ieee80211_info_element info_element;*/ -+} ; -+ -+struct ieee80211_assoc_request_frame { -+ struct rtw_ieee80211_hdr_3addr header; -+ u16 capability; -+ u16 listen_interval; -+ /* u8 current_ap[ETH_ALEN]; */ -+ struct ieee80211_info_element_hdr info_element; -+} ; -+ -+struct ieee80211_assoc_response_frame { -+ struct rtw_ieee80211_hdr_3addr header; -+ u16 capability; -+ u16 status; -+ u16 aid; -+ /* struct ieee80211_info_element info_element; supported rates */ -+}; -+ -+#pragma pack() -+ -+#endif -+ -+ -+ -+ -+struct ieee80211_txb { -+ u8 nr_frags; -+ u8 encrypted; -+ u16 reserved; -+ u16 frag_size; -+ u16 payload_size; -+ struct sk_buff *fragments[0]; -+}; -+ -+ -+/* SWEEP TABLE ENTRIES NUMBER*/ -+#define MAX_SWEEP_TAB_ENTRIES 42 -+#define MAX_SWEEP_TAB_ENTRIES_PER_PACKET 7 -+/* MAX_RATES_LENGTH needs to be 12. The spec says 8, and many APs -+ * only use 8, and then use extended rates for the remaining supported -+ * rates. Other APs, however, stick all of their supported rates on the -+ * main rates information element... */ -+#define MAX_RATES_LENGTH ((u8)12) -+#define MAX_RATES_EX_LENGTH ((u8)16) -+#define MAX_NETWORK_COUNT 128 -+#define MAX_CHANNEL_NUMBER 161 -+#define IEEE80211_SOFTMAC_SCAN_TIME 400 -+/* (HZ / 2) */ -+#define IEEE80211_SOFTMAC_ASSOC_RETRY_TIME (HZ * 2) -+ -+#define CRC_LENGTH 4U -+ -+#define MAX_WPA_IE_LEN (256) -+#define MAX_WPS_IE_LEN (512) -+#define MAX_P2P_IE_LEN (256) -+#define MAX_WFD_IE_LEN (128) -+ -+#define NETWORK_EMPTY_ESSID (1<<0) -+#define NETWORK_HAS_OFDM (1<<1) -+#define NETWORK_HAS_CCK (1<<2) -+ -+#define IEEE80211_DTIM_MBCAST 4 -+#define IEEE80211_DTIM_UCAST 2 -+#define IEEE80211_DTIM_VALID 1 -+#define IEEE80211_DTIM_INVALID 0 -+ -+#define IEEE80211_PS_DISABLED 0 -+#define IEEE80211_PS_UNICAST IEEE80211_DTIM_UCAST -+#define IEEE80211_PS_MBCAST IEEE80211_DTIM_MBCAST -+#define IW_ESSID_MAX_SIZE 32 -+#if 0 -+struct ieee80211_network { -+ /* These entries are used to identify a unique network */ -+ u8 bssid[ETH_ALEN]; -+ u8 channel; -+ /* Ensure null-terminated for any debug msgs */ -+ u8 ssid[IW_ESSID_MAX_SIZE + 1]; -+ u8 ssid_len; -+ u8 rssi; /* relative signal strength */ -+ u8 sq; /* signal quality */ -+ -+ /* These are network statistics */ -+ /* struct ieee80211_rx_stats stats; */ -+ u16 capability; -+ u16 aid; -+ u8 rates[MAX_RATES_LENGTH]; -+ u8 rates_len; -+ u8 rates_ex[MAX_RATES_EX_LENGTH]; -+ u8 rates_ex_len; -+ -+ u8 edca_parmsets[18]; -+ -+ u8 mode; -+ u8 flags; -+ u8 time_stamp[8]; -+ u16 beacon_interval; -+ u16 listen_interval; -+ u16 atim_window; -+ u8 wpa_ie[MAX_WPA_IE_LEN]; -+ size_t wpa_ie_len; -+ u8 rsn_ie[MAX_WPA_IE_LEN]; -+ size_t rsn_ie_len; -+ u8 country[6]; -+ u8 dtim_period; -+ u8 dtim_data; -+ u8 power_constraint; -+ u8 qosinfo; -+ u8 qbssload[5]; -+ u8 network_type; -+ int join_res; -+ unsigned long last_scanned; -+}; -+#endif -+/* -+join_res: -+-1: authentication fail -+-2: association fail -+> 0: TID -+*/ -+ -+#ifndef PLATFORM_FREEBSD /* Baron BSD has already defined */ -+ -+enum ieee80211_state { -+ -+ /* the card is not linked at all */ -+ IEEE80211_NOLINK = 0, -+ -+ /* IEEE80211_ASSOCIATING* are for BSS client mode -+ * the driver shall not perform RX filtering unless -+ * the state is LINKED. -+ * The driver shall just check for the state LINKED and -+ * defaults to NOLINK for ALL the other states (including -+ * LINKED_SCANNING) -+ */ -+ -+ /* the association procedure will start (wq scheduling)*/ -+ IEEE80211_ASSOCIATING, -+ IEEE80211_ASSOCIATING_RETRY, -+ -+ /* the association procedure is sending AUTH request*/ -+ IEEE80211_ASSOCIATING_AUTHENTICATING, -+ -+ /* the association procedure has successfully authentcated -+ * and is sending association request -+ */ -+ IEEE80211_ASSOCIATING_AUTHENTICATED, -+ -+ /* the link is ok. the card associated to a BSS or linked -+ * to a ibss cell or acting as an AP and creating the bss -+ */ -+ IEEE80211_LINKED, -+ -+ /* same as LINKED, but the driver shall apply RX filter -+ * rules as we are in NO_LINK mode. As the card is still -+ * logically linked, but it is doing a syncro site survey -+ * then it will be back to LINKED state. -+ */ -+ IEEE80211_LINKED_SCANNING, -+ -+}; -+#endif /* PLATFORM_FREEBSD */ -+ -+#define DEFAULT_MAX_SCAN_AGE (15 * HZ) -+#define DEFAULT_FTS 2346 -+#define MAC_FMT "%02x:%02x:%02x:%02x:%02x:%02x" -+#define MAC_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5] -+#define MAC_SFMT "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx" -+#define MAC_SARG(x) ((u8*)(x)),((u8*)(x)) + 1,((u8*)(x)) + 2,((u8*)(x)) + 3,((u8*)(x)) + 4,((u8*)(x)) + 5 -+#define IP_FMT "%d.%d.%d.%d" -+#define IP_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3] -+#define PORT_FMT "%u" -+#define PORT_ARG(x) ntohs(*((u16 *)(x))) -+ -+#ifdef PLATFORM_FREEBSD /* Baron change func to macro */ -+#define is_multicast_mac_addr(Addr) ((((Addr[0]) & 0x01) == 0x01) && ((Addr[0]) != 0xff)) -+#define is_broadcast_mac_addr(Addr) ((((Addr[0]) & 0xff) == 0xff) && (((Addr[1]) & 0xff) == 0xff) && \ -+ (((Addr[2]) & 0xff) == 0xff) && (((Addr[3]) & 0xff) == 0xff) && (((Addr[4]) & 0xff) == 0xff) && \ -+ (((Addr[5]) & 0xff) == 0xff)) -+#else -+extern __inline int is_multicast_mac_addr(const u8 *addr) -+{ -+ return (addr[0] != 0xff) && (0x01 & addr[0]); -+} -+ -+extern __inline int is_broadcast_mac_addr(const u8 *addr) -+{ -+ return ((addr[0] == 0xff) && (addr[1] == 0xff) && (addr[2] == 0xff) && \ -+ (addr[3] == 0xff) && (addr[4] == 0xff) && (addr[5] == 0xff)); -+} -+ -+extern __inline int is_zero_mac_addr(const u8 *addr) -+{ -+ return ((addr[0] == 0x00) && (addr[1] == 0x00) && (addr[2] == 0x00) && \ -+ (addr[3] == 0x00) && (addr[4] == 0x00) && (addr[5] == 0x00)); -+} -+#endif /* PLATFORM_FREEBSD */ -+ -+#define CFG_IEEE80211_RESERVE_FCS (1<<0) -+#define CFG_IEEE80211_COMPUTE_FCS (1<<1) -+ -+typedef struct tx_pending_t { -+ int frag; -+ struct ieee80211_txb *txb; -+} tx_pending_t; -+ -+ -+ -+#define TID_NUM 16 -+ -+#define IEEE_A (1<<0) -+#define IEEE_B (1<<1) -+#define IEEE_G (1<<2) -+#define IEEE_MODE_MASK (IEEE_A | IEEE_B | IEEE_G) -+ -+/* Baron move to ieee80211.c */ -+int ieee80211_is_empty_essid(const char *essid, int essid_len); -+int ieee80211_get_hdrlen(u16 fc); -+ -+#if 0 -+ /* Action frame categories (IEEE 802.11-2007, 7.3.1.11, Table 7-24) */ -+ #define WLAN_ACTION_SPECTRUM_MGMT 0 -+ #define WLAN_ACTION_QOS 1 -+ #define WLAN_ACTION_DLS 2 -+ #define WLAN_ACTION_BLOCK_ACK 3 -+ #define WLAN_ACTION_RADIO_MEASUREMENT 5 -+ #define WLAN_ACTION_FT 6 -+ #define WLAN_ACTION_SA_QUERY 8 -+ #define WLAN_ACTION_WMM 17 -+#endif -+ -+ -+/* Action category code */ -+enum rtw_ieee80211_category { -+ RTW_WLAN_CATEGORY_SPECTRUM_MGMT = 0, -+ RTW_WLAN_CATEGORY_QOS = 1, -+ RTW_WLAN_CATEGORY_DLS = 2, -+ RTW_WLAN_CATEGORY_BACK = 3, -+ RTW_WLAN_CATEGORY_PUBLIC = 4, /* IEEE 802.11 public action frames */ -+ RTW_WLAN_CATEGORY_RADIO_MEASUREMENT = 5, -+ RTW_WLAN_CATEGORY_FT = 6, -+ RTW_WLAN_CATEGORY_HT = 7, -+ RTW_WLAN_CATEGORY_SA_QUERY = 8, -+ RTW_WLAN_CATEGORY_WNM = 10, -+ RTW_WLAN_CATEGORY_UNPROTECTED_WNM = 11, /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ RTW_WLAN_CATEGORY_TDLS = 12, -+ RTW_WLAN_CATEGORY_SELF_PROTECTED = 15, /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ RTW_WLAN_CATEGORY_WMM = 17, -+ RTW_WLAN_CATEGORY_VHT = 21, -+ RTW_WLAN_CATEGORY_P2P = 0x7f,/* P2P action frames */ -+}; -+ -+/* SPECTRUM_MGMT action code */ -+enum rtw_ieee80211_spectrum_mgmt_actioncode { -+ RTW_WLAN_ACTION_SPCT_MSR_REQ = 0, -+ RTW_WLAN_ACTION_SPCT_MSR_RPRT = 1, -+ RTW_WLAN_ACTION_SPCT_TPC_REQ = 2, -+ RTW_WLAN_ACTION_SPCT_TPC_RPRT = 3, -+ RTW_WLAN_ACTION_SPCT_CHL_SWITCH = 4, -+ RTW_WLAN_ACTION_SPCT_EXT_CHL_SWITCH = 5, -+}; -+ -+enum _PUBLIC_ACTION { -+ ACT_PUBLIC_BSSCOEXIST = 0, /* 20/40 BSS Coexistence */ -+ ACT_PUBLIC_DSE_ENABLE = 1, -+ ACT_PUBLIC_DSE_DEENABLE = 2, -+ ACT_PUBLIC_DSE_REG_LOCATION = 3, -+ ACT_PUBLIC_EXT_CHL_SWITCH = 4, -+ ACT_PUBLIC_DSE_MSR_REQ = 5, -+ ACT_PUBLIC_DSE_MSR_RPRT = 6, -+ ACT_PUBLIC_MP = 7, /* Measurement Pilot */ -+ ACT_PUBLIC_DSE_PWR_CONSTRAINT = 8, -+ ACT_PUBLIC_VENDOR = 9, /* for WIFI_DIRECT */ -+ ACT_PUBLIC_GAS_INITIAL_REQ = 10, -+ ACT_PUBLIC_GAS_INITIAL_RSP = 11, -+ ACT_PUBLIC_GAS_COMEBACK_REQ = 12, -+ ACT_PUBLIC_GAS_COMEBACK_RSP = 13, -+ ACT_PUBLIC_TDLS_DISCOVERY_RSP = 14, -+ ACT_PUBLIC_LOCATION_TRACK = 15, -+ ACT_PUBLIC_MAX -+}; -+ -+#ifdef CONFIG_TDLS -+enum TDLS_ACTION_FIELD { -+ TDLS_SETUP_REQUEST = 0, -+ TDLS_SETUP_RESPONSE = 1, -+ TDLS_SETUP_CONFIRM = 2, -+ TDLS_TEARDOWN = 3, -+ TDLS_PEER_TRAFFIC_INDICATION = 4, -+ TDLS_CHANNEL_SWITCH_REQUEST = 5, -+ TDLS_CHANNEL_SWITCH_RESPONSE = 6, -+ TDLS_PEER_PSM_REQUEST = 7, -+ TDLS_PEER_PSM_RESPONSE = 8, -+ TDLS_PEER_TRAFFIC_RESPONSE = 9, -+ TDLS_DISCOVERY_REQUEST = 10, -+ TDLS_DISCOVERY_RESPONSE = 14, /* it's used in public action frame */ -+}; -+ -+#define TUNNELED_PROBE_REQ 15 -+#define TUNNELED_PROBE_RSP 16 -+#endif /* CONFIG_TDLS */ -+ -+/* BACK action code */ -+enum rtw_ieee80211_back_actioncode { -+ RTW_WLAN_ACTION_ADDBA_REQ = 0, -+ RTW_WLAN_ACTION_ADDBA_RESP = 1, -+ RTW_WLAN_ACTION_DELBA = 2, -+}; -+ -+/* HT features action code */ -+enum rtw_ieee80211_ht_actioncode { -+ RTW_WLAN_ACTION_HT_NOTI_CHNL_WIDTH = 0, -+ RTW_WLAN_ACTION_HT_SM_PS = 1, -+ RTW_WLAN_ACTION_HT_PSMP = 2, -+ RTW_WLAN_ACTION_HT_SET_PCO_PHASE = 3, -+ RTW_WLAN_ACTION_HT_CSI = 4, -+ RTW_WLAN_ACTION_HT_NON_COMPRESS_BEAMFORMING = 5, -+ RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING = 6, -+ RTW_WLAN_ACTION_HT_ASEL_FEEDBACK = 7, -+}; -+ -+/* BACK (block-ack) parties */ -+enum rtw_ieee80211_back_parties { -+ RTW_WLAN_BACK_RECIPIENT = 0, -+ RTW_WLAN_BACK_INITIATOR = 1, -+ RTW_WLAN_BACK_TIMER = 2, -+}; -+ -+/*20/40 BSS Coexistence element */ -+#define RTW_WLAN_20_40_BSS_COEX_INFO_REQ BIT(0) -+#define RTW_WLAN_20_40_BSS_COEX_40MHZ_INTOL BIT(1) -+#define RTW_WLAN_20_40_BSS_COEX_20MHZ_WIDTH_REQ BIT(2) -+#define RTW_WLAN_20_40_BSS_COEX_OBSS_EXEMPT_REQ BIT(3) -+#define RTW_WLAN_20_40_BSS_COEX_OBSS_EXEMPT_GRNT BIT(4) -+ -+/* VHT features action code */ -+enum rtw_ieee80211_vht_actioncode { -+ RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING = 0, -+ RTW_WLAN_ACTION_VHT_GROUPID_MANAGEMENT = 1, -+ RTW_WLAN_ACTION_VHT_OPMODE_NOTIFICATION = 2, -+}; -+ -+/*IEEE 802.11r action code*/ -+#ifdef CONFIG_RTW_80211R -+enum rtw_ieee80211_ft_actioncode { -+ RTW_WLAN_ACTION_FT_RESV, -+ RTW_WLAN_ACTION_FT_REQUEST, -+ RTW_WLAN_ACTION_FT_RESPONSE, -+ RTW_WLAN_ACTION_FT_CONFIRM, -+ RTW_WLAN_ACTION_FT_ACK, -+ RTW_WLAN_ACTION_FT_MAX, -+}; -+#endif -+ -+#define OUI_MICROSOFT 0x0050f2 /* Microsoft (also used in Wi-Fi specs) -+ * 00:50:F2 */ -+#ifndef PLATFORM_FREEBSD /* Baron BSD has defined */ -+ #define WME_OUI_TYPE 2 -+#endif /* PLATFORM_FREEBSD */ -+#define WME_OUI_SUBTYPE_INFORMATION_ELEMENT 0 -+#define WME_OUI_SUBTYPE_PARAMETER_ELEMENT 1 -+#define WME_OUI_SUBTYPE_TSPEC_ELEMENT 2 -+#define WME_VERSION 1 -+ -+#define WME_ACTION_CODE_SETUP_REQUEST 0 -+#define WME_ACTION_CODE_SETUP_RESPONSE 1 -+#define WME_ACTION_CODE_TEARDOWN 2 -+ -+#define WME_SETUP_RESPONSE_STATUS_ADMISSION_ACCEPTED 0 -+#define WME_SETUP_RESPONSE_STATUS_INVALID_PARAMETERS 1 -+#define WME_SETUP_RESPONSE_STATUS_REFUSED 3 -+ -+#define WME_TSPEC_DIRECTION_UPLINK 0 -+#define WME_TSPEC_DIRECTION_DOWNLINK 1 -+#define WME_TSPEC_DIRECTION_BI_DIRECTIONAL 3 -+ -+ -+#define OUI_BROADCOM 0x00904c /* Broadcom (Epigram) */ -+ -+#define VENDOR_HT_CAPAB_OUI_TYPE 0x33 /* 00-90-4c:0x33 */ -+ -+/** -+ * enum rtw_ieee80211_channel_flags - channel flags -+ * -+ * Channel flags set by the regulatory control code. -+ * -+ * @RTW_IEEE80211_CHAN_DISABLED: This channel is disabled. -+ * @RTW_IEEE80211_CHAN_PASSIVE_SCAN: Only passive scanning is permitted -+ * on this channel. -+ * @RTW_IEEE80211_CHAN_NO_IBSS: IBSS is not allowed on this channel. -+ * @RTW_IEEE80211_CHAN_RADAR: Radar detection is required on this channel. -+ * @RTW_IEEE80211_CHAN_NO_HT40PLUS: extension channel above this channel -+ * is not permitted. -+ * @RTW_IEEE80211_CHAN_NO_HT40MINUS: extension channel below this channel -+ * is not permitted. -+ */ -+enum rtw_ieee80211_channel_flags { -+ RTW_IEEE80211_CHAN_DISABLED = 1 << 0, -+ RTW_IEEE80211_CHAN_PASSIVE_SCAN = 1 << 1, -+ RTW_IEEE80211_CHAN_NO_IBSS = 1 << 2, -+ RTW_IEEE80211_CHAN_RADAR = 1 << 3, -+ RTW_IEEE80211_CHAN_NO_HT40PLUS = 1 << 4, -+ RTW_IEEE80211_CHAN_NO_HT40MINUS = 1 << 5, -+}; -+ -+#define RTW_IEEE80211_CHAN_NO_HT40 \ -+ (RTW_IEEE80211_CHAN_NO_HT40PLUS | RTW_IEEE80211_CHAN_NO_HT40MINUS) -+ -+/* Represent channel details, subset of ieee80211_channel */ -+struct rtw_ieee80211_channel { -+ /* enum ieee80211_band band; */ -+ /* u16 center_freq; */ -+ u16 hw_value; -+ u32 flags; -+ /* int max_antenna_gain; */ -+ /* int max_power; */ -+ /* int max_reg_power; */ -+ /* bool beacon_found; */ -+ /* u32 orig_flags; */ -+ /* int orig_mag; */ -+ /* int orig_mpwr; */ -+}; -+ -+#define CHAN_FMT \ -+ /*"band:%d, "*/ \ -+ /*"center_freq:%u, "*/ \ -+ "hw_value:%u, " \ -+ "flags:0x%08x" \ -+ /*"max_antenna_gain:%d\n"*/ \ -+ /*"max_power:%d\n"*/ \ -+ /*"max_reg_power:%d\n"*/ \ -+ /*"beacon_found:%u\n"*/ \ -+ /*"orig_flags:0x%08x\n"*/ \ -+ /*"orig_mag:%d\n"*/ \ -+ /*"orig_mpwr:%d\n"*/ -+ -+#define CHAN_ARG(channel) \ -+ /*(channel)->band*/ \ -+ /*, (channel)->center_freq*/ \ -+ (channel)->hw_value \ -+ , (channel)->flags \ -+ /*, (channel)->max_antenna_gain*/ \ -+ /*, (channel)->max_power*/ \ -+ /*, (channel)->max_reg_power*/ \ -+ /*, (channel)->beacon_found*/ \ -+ /*, (channel)->orig_flags*/ \ -+ /*, (channel)->orig_mag*/ \ -+ /*, (channel)->orig_mpwr*/ \ -+ -+/* Parsed Information Elements */ -+struct rtw_ieee802_11_elems { -+ u8 *ssid; -+ u8 ssid_len; -+ u8 *supp_rates; -+ u8 supp_rates_len; -+ u8 *fh_params; -+ u8 fh_params_len; -+ u8 *ds_params; -+ u8 ds_params_len; -+ u8 *cf_params; -+ u8 cf_params_len; -+ u8 *tim; -+ u8 tim_len; -+ u8 *ibss_params; -+ u8 ibss_params_len; -+ u8 *challenge; -+ u8 challenge_len; -+ u8 *erp_info; -+ u8 erp_info_len; -+ u8 *ext_supp_rates; -+ u8 ext_supp_rates_len; -+ u8 *wpa_ie; -+ u8 wpa_ie_len; -+ u8 *rsn_ie; -+ u8 rsn_ie_len; -+ u8 *wme; -+ u8 wme_len; -+ u8 *wme_tspec; -+ u8 wme_tspec_len; -+ u8 *wps_ie; -+ u8 wps_ie_len; -+ u8 *power_cap; -+ u8 power_cap_len; -+ u8 *supp_channels; -+ u8 supp_channels_len; -+ u8 *mdie; -+ u8 mdie_len; -+ u8 *ftie; -+ u8 ftie_len; -+ u8 *timeout_int; -+ u8 timeout_int_len; -+ u8 *ht_capabilities; -+ u8 ht_capabilities_len; -+ u8 *ht_operation; -+ u8 ht_operation_len; -+ u8 *vendor_ht_cap; -+ u8 vendor_ht_cap_len; -+ u8 *vht_capabilities; -+ u8 vht_capabilities_len; -+ u8 *vht_operation; -+ u8 vht_operation_len; -+ u8 *vht_op_mode_notify; -+ u8 vht_op_mode_notify_len; -+}; -+ -+typedef enum { ParseOK = 0, ParseUnknown = 1, ParseFailed = -1 } ParseRes; -+ -+ParseRes rtw_ieee802_11_parse_elems(u8 *start, uint len, -+ struct rtw_ieee802_11_elems *elems, -+ int show_errors); -+ -+u8 *rtw_set_fixed_ie(unsigned char *pbuf, unsigned int len, unsigned char *source, unsigned int *frlen); -+u8 *rtw_set_ie(u8 *pbuf, sint index, uint len, u8 *source, uint *frlen); -+ -+enum secondary_ch_offset { -+ SCN = 0, /* no secondary channel */ -+ SCA = 1, /* secondary channel above */ -+ SCB = 3, /* secondary channel below */ -+}; -+u8 secondary_ch_offset_to_hal_ch_offset(u8 ch_offset); -+u8 hal_ch_offset_to_secondary_ch_offset(u8 ch_offset); -+u8 *rtw_set_ie_ch_switch(u8 *buf, u32 *buf_len, u8 ch_switch_mode, u8 new_ch, u8 ch_switch_cnt); -+u8 *rtw_set_ie_secondary_ch_offset(u8 *buf, u32 *buf_len, u8 secondary_ch_offset); -+u8 *rtw_set_ie_mesh_ch_switch_parm(u8 *buf, u32 *buf_len, u8 ttl, u8 flags, u16 reason, u16 precedence); -+ -+u8 *rtw_get_ie(u8 *pbuf, sint index, sint *len, sint limit); -+u8 *rtw_get_ie_ex(u8 *in_ie, uint in_len, u8 eid, u8 *oui, u8 oui_len, u8 *ie, uint *ielen); -+int rtw_ies_remove_ie(u8 *ies, uint *ies_len, uint offset, u8 eid, u8 *oui, u8 oui_len); -+ -+void rtw_set_supported_rate(u8 *SupportedRates, uint mode) ; -+ -+unsigned char *rtw_get_wpa_ie(unsigned char *pie, int *wpa_ie_len, int limit); -+unsigned char *rtw_get_wpa2_ie(unsigned char *pie, int *rsn_ie_len, int limit); -+int rtw_get_wpa_cipher_suite(u8 *s); -+int rtw_get_wpa2_cipher_suite(u8 *s); -+int rtw_get_wapi_ie(u8 *in_ie, uint in_len, u8 *wapi_ie, u16 *wapi_len); -+int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x); -+int rtw_parse_wpa2_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x); -+ -+int rtw_get_sec_ie(u8 *in_ie, uint in_len, u8 *rsn_ie, u16 *rsn_len, u8 *wpa_ie, u16 *wpa_len); -+ -+u8 rtw_is_wps_ie(u8 *ie_ptr, uint *wps_ielen); -+u8 *rtw_get_wps_ie_from_scan_queue(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen, u8 frame_type); -+u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen); -+u8 *rtw_get_wps_attr(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 *buf_attr, u32 *len_attr); -+u8 *rtw_get_wps_attr_content(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 *buf_content, uint *len_content); -+ -+/** -+ * for_each_ie - iterate over continuous IEs -+ * @ie: -+ * @buf: -+ * @buf_len: -+ */ -+#define for_each_ie(ie, buf, buf_len) \ -+ for (ie = (void *)buf; (((u8 *)ie) - ((u8 *)buf) + 1) < buf_len; ie = (void *)(((u8 *)ie) + *(((u8 *)ie)+1) + 2)) -+ -+void dump_ies(void *sel, u8 *buf, u32 buf_len); -+ -+#ifdef CONFIG_80211N_HT -+void dump_ht_cap_ie_content(void *sel, u8 *buf, u32 buf_len); -+#endif -+ -+void dump_wps_ie(void *sel, u8 *ie, u32 ie_len); -+ -+void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset); -+ -+void rtw_bss_get_chbw(WLAN_BSSID_EX *bss, u8 *ch, u8 *bw, u8 *offset); -+ -+bool rtw_is_chbw_grouped(u8 ch_a, u8 bw_a, u8 offset_a -+ , u8 ch_b, u8 bw_b, u8 offset_b); -+void rtw_sync_chbw(u8 *req_ch, u8 *req_bw, u8 *req_offset -+ , u8 *g_ch, u8 *g_bw, u8 *g_offset); -+ -+u32 rtw_get_p2p_merged_ies_len(u8 *in_ie, u32 in_len); -+int rtw_p2p_merge_ies(u8 *in_ie, u32 in_len, u8 *merge_ie); -+void dump_p2p_ie(void *sel, u8 *ie, u32 ie_len); -+u8 *rtw_get_p2p_ie(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen); -+u8 *rtw_get_p2p_attr(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id, u8 *buf_attr, u32 *len_attr); -+u8 *rtw_get_p2p_attr_content(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id, u8 *buf_content, uint *len_content); -+u32 rtw_set_p2p_attr_content(u8 *pbuf, u8 attr_id, u16 attr_len, u8 *pdata_attr); -+uint rtw_del_p2p_ie(u8 *ies, uint ies_len_ori, const char *msg); -+uint rtw_del_p2p_attr(u8 *ie, uint ielen_ori, u8 attr_id); -+u8 *rtw_bss_ex_get_p2p_ie(WLAN_BSSID_EX *bss_ex, u8 *p2p_ie, uint *p2p_ielen); -+void rtw_bss_ex_del_p2p_ie(WLAN_BSSID_EX *bss_ex); -+void rtw_bss_ex_del_p2p_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id); -+ -+void dump_wfd_ie(void *sel, u8 *ie, u32 ie_len); -+u8 *rtw_get_wfd_ie(u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen); -+u8 *rtw_get_wfd_attr(u8 *wfd_ie, uint wfd_ielen, u8 target_attr_id, u8 *buf_attr, u32 *len_attr); -+u8 *rtw_get_wfd_attr_content(u8 *wfd_ie, uint wfd_ielen, u8 target_attr_id, u8 *buf_content, uint *len_content); -+uint rtw_del_wfd_ie(u8 *ies, uint ies_len_ori, const char *msg); -+uint rtw_del_wfd_attr(u8 *ie, uint ielen_ori, u8 attr_id); -+u8 *rtw_bss_ex_get_wfd_ie(WLAN_BSSID_EX *bss_ex, u8 *wfd_ie, uint *wfd_ielen); -+void rtw_bss_ex_del_wfd_ie(WLAN_BSSID_EX *bss_ex); -+void rtw_bss_ex_del_wfd_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id); -+ -+uint rtw_get_rateset_len(u8 *rateset); -+ -+struct registry_priv; -+int rtw_generate_ie(struct registry_priv *pregistrypriv); -+ -+int rtw_get_bit_value_from_ieee_value(u8 val); -+ -+uint rtw_is_cckrates_included(u8 *rate); -+ -+uint rtw_is_cckratesonly_included(u8 *rate); -+ -+int rtw_check_network_type(unsigned char *rate, int ratelen, int channel); -+ -+void rtw_get_bcn_info(struct wlan_network *pnetwork); -+ -+u8 rtw_check_invalid_mac_address(u8 *mac_addr, u8 check_local_bit); -+void rtw_macaddr_cfg(u8 *out, const u8 *hw_mac_addr); -+ -+u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI, unsigned char *MCS_rate); -+u8 rtw_ht_mcsset_to_nss(u8 *supp_mcs_set); -+ -+int rtw_action_frame_parse(const u8 *frame, u32 frame_len, u8 *category, u8 *action); -+const char *action_public_str(u8 action); -+ -+u8 key_2char2num(u8 hch, u8 lch); -+u8 str_2char2num(u8 hch, u8 lch); -+void macstr2num(u8 *dst, u8 *src); -+u8 convert_ip_addr(u8 hch, u8 mch, u8 lch); -+int wifirate2_ratetbl_inx(unsigned char rate); -+ -+ -+#endif /* IEEE80211_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/if_ether.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/if_ether.h ---- linux-4.14.18/3rdparty/rtl8723de/include/if_ether.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/if_ether.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,111 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef _LINUX_IF_ETHER_H -+#define _LINUX_IF_ETHER_H -+ -+/* -+ * IEEE 802.3 Ethernet magic constants. The frame sizes omit the preamble -+ * and FCS/CRC (frame check sequence). -+ */ -+ -+#define ETH_ALEN 6 /* Octets in one ethernet addr */ -+#define ETH_HLEN 14 /* Total octets in header. */ -+#define ETH_ZLEN 60 /* Min. octets in frame sans FCS */ -+#define ETH_DATA_LEN 1500 /* Max. octets in payload */ -+#define ETH_FRAME_LEN 1514 /* Max. octets in frame sans FCS */ -+ -+/* -+ * These are the defined Ethernet Protocol ID's. -+ */ -+ -+#define ETH_P_LOOP 0x0060 /* Ethernet Loopback packet */ -+#define ETH_P_PUP 0x0200 /* Xerox PUP packet */ -+#define ETH_P_PUPAT 0x0201 /* Xerox PUP Addr Trans packet */ -+#define ETH_P_IP 0x0800 /* Internet Protocol packet */ -+#define ETH_P_X25 0x0805 /* CCITT X.25 */ -+#define ETH_P_ARP 0x0806 /* Address Resolution packet */ -+#define ETH_P_BPQ 0x08FF /* G8BPQ AX.25 Ethernet Packet [ NOT AN OFFICIALLY REGISTERED ID ] */ -+#define ETH_P_IEEEPUP 0x0a00 /* Xerox IEEE802.3 PUP packet */ -+#define ETH_P_IEEEPUPAT 0x0a01 /* Xerox IEEE802.3 PUP Addr Trans packet */ -+#define ETH_P_DEC 0x6000 /* DEC Assigned proto */ -+#define ETH_P_DNA_DL 0x6001 /* DEC DNA Dump/Load */ -+#define ETH_P_DNA_RC 0x6002 /* DEC DNA Remote Console */ -+#define ETH_P_DNA_RT 0x6003 /* DEC DNA Routing */ -+#define ETH_P_LAT 0x6004 /* DEC LAT */ -+#define ETH_P_DIAG 0x6005 /* DEC Diagnostics */ -+#define ETH_P_CUST 0x6006 /* DEC Customer use */ -+#define ETH_P_SCA 0x6007 /* DEC Systems Comms Arch */ -+#define ETH_P_RARP 0x8035 /* Reverse Addr Res packet */ -+#define ETH_P_ATALK 0x809B /* Appletalk DDP */ -+#define ETH_P_AARP 0x80F3 /* Appletalk AARP */ -+#define ETH_P_8021Q 0x8100 /* 802.1Q VLAN Extended Header */ -+#define ETH_P_IPX 0x8137 /* IPX over DIX */ -+#define ETH_P_IPV6 0x86DD /* IPv6 over bluebook */ -+#define ETH_P_PPP_DISC 0x8863 /* PPPoE discovery messages */ -+#define ETH_P_PPP_SES 0x8864 /* PPPoE session messages */ -+#define ETH_P_ATMMPOA 0x884c /* MultiProtocol Over ATM */ -+#define ETH_P_ATMFATE 0x8884 /* Frame-based ATM Transport -+ * over Ethernet -+ */ -+ -+/* -+ * Non DIX types. Won't clash for 1500 types. -+ */ -+ -+#define ETH_P_802_3 0x0001 /* Dummy type for 802.3 frames */ -+#define ETH_P_AX25 0x0002 /* Dummy protocol id for AX.25 */ -+#define ETH_P_ALL 0x0003 /* Every packet (be careful!!!) */ -+#define ETH_P_802_2 0x0004 /* 802.2 frames */ -+#define ETH_P_SNAP 0x0005 /* Internal only */ -+#define ETH_P_DDCMP 0x0006 /* DEC DDCMP: Internal only */ -+#define ETH_P_WAN_PPP 0x0007 /* Dummy type for WAN PPP frames*/ -+#define ETH_P_PPP_MP 0x0008 /* Dummy type for PPP MP frames */ -+#define ETH_P_LOCALTALK 0x0009 /* Localtalk pseudo type */ -+#define ETH_P_PPPTALK 0x0010 /* Dummy type for Atalk over PPP*/ -+#define ETH_P_TR_802_2 0x0011 /* 802.2 frames */ -+#define ETH_P_MOBITEX 0x0015 /* Mobitex (kaz@cafe.net) */ -+#define ETH_P_CONTROL 0x0016 /* Card specific control frames */ -+#define ETH_P_IRDA 0x0017 /* Linux-IrDA */ -+#define ETH_P_ECONET 0x0018 /* Acorn Econet */ -+ -+/* -+ * This is an Ethernet frame header. -+ */ -+ -+struct ethhdr { -+ unsigned char h_dest[ETH_ALEN]; /* destination eth addr */ -+ unsigned char h_source[ETH_ALEN]; /* source ether addr */ -+ unsigned short h_proto; /* packet type ID field */ -+}; -+ -+struct _vlan { -+ unsigned short h_vlan_TCI; /* Encapsulates priority and VLAN ID */ -+ unsigned short h_vlan_encapsulated_proto; -+}; -+ -+ -+ -+#define get_vlan_id(pvlan) ((ntohs((unsigned short)pvlan->h_vlan_TCI)) & 0xfff) -+#define get_vlan_priority(pvlan) ((ntohs((unsigned short)pvlan->h_vlan_TCI))>>13) -+#define get_vlan_encap_proto(pvlan) (ntohs((unsigned short)pvlan->h_vlan_encapsulated_proto)) -+ -+ -+#endif /* _LINUX_IF_ETHER_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/ip.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/ip.h ---- linux-4.14.18/3rdparty/rtl8723de/include/ip.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/ip.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,140 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _LINUX_IP_H -+#define _LINUX_IP_H -+ -+/* SOL_IP socket options */ -+ -+#define IPTOS_TOS_MASK 0x1E -+#define IPTOS_TOS(tos) ((tos)&IPTOS_TOS_MASK) -+#define IPTOS_LOWDELAY 0x10 -+#define IPTOS_THROUGHPUT 0x08 -+#define IPTOS_RELIABILITY 0x04 -+#define IPTOS_MINCOST 0x02 -+ -+#define IPTOS_PREC_MASK 0xE0 -+#define IPTOS_PREC(tos) ((tos)&IPTOS_PREC_MASK) -+#define IPTOS_PREC_NETCONTROL 0xe0 -+#define IPTOS_PREC_INTERNETCONTROL 0xc0 -+#define IPTOS_PREC_CRITIC_ECP 0xa0 -+#define IPTOS_PREC_FLASHOVERRIDE 0x80 -+#define IPTOS_PREC_FLASH 0x60 -+#define IPTOS_PREC_IMMEDIATE 0x40 -+#define IPTOS_PREC_PRIORITY 0x20 -+#define IPTOS_PREC_ROUTINE 0x00 -+ -+ -+/* IP options */ -+#define IPOPT_COPY 0x80 -+#define IPOPT_CLASS_MASK 0x60 -+#define IPOPT_NUMBER_MASK 0x1f -+ -+#define IPOPT_COPIED(o) ((o)&IPOPT_COPY) -+#define IPOPT_CLASS(o) ((o)&IPOPT_CLASS_MASK) -+#define IPOPT_NUMBER(o) ((o)&IPOPT_NUMBER_MASK) -+ -+#define IPOPT_CONTROL 0x00 -+#define IPOPT_RESERVED1 0x20 -+#define IPOPT_MEASUREMENT 0x40 -+#define IPOPT_RESERVED2 0x60 -+ -+#define IPOPT_END (0 | IPOPT_CONTROL) -+#define IPOPT_NOOP (1 | IPOPT_CONTROL) -+#define IPOPT_SEC (2 | IPOPT_CONTROL | IPOPT_COPY) -+#define IPOPT_LSRR (3 | IPOPT_CONTROL | IPOPT_COPY) -+#define IPOPT_TIMESTAMP (4 | IPOPT_MEASUREMENT) -+#define IPOPT_RR (7 | IPOPT_CONTROL) -+#define IPOPT_SID (8 | IPOPT_CONTROL | IPOPT_COPY) -+#define IPOPT_SSRR (9 | IPOPT_CONTROL | IPOPT_COPY) -+#define IPOPT_RA (20 | IPOPT_CONTROL | IPOPT_COPY) -+ -+#define IPVERSION 4 -+#define MAXTTL 255 -+#define IPDEFTTL 64 -+ -+/* struct timestamp, struct route and MAX_ROUTES are removed. -+ -+ REASONS: it is clear that nobody used them because: -+ - MAX_ROUTES value was wrong. -+ - "struct route" was wrong. -+ - "struct timestamp" had fatally misaligned bitfields and was completely unusable. -+ */ -+ -+#define IPOPT_OPTVAL 0 -+#define IPOPT_OLEN 1 -+#define IPOPT_OFFSET 2 -+#define IPOPT_MINOFF 4 -+#define MAX_IPOPTLEN 40 -+#define IPOPT_NOP IPOPT_NOOP -+#define IPOPT_EOL IPOPT_END -+#define IPOPT_TS IPOPT_TIMESTAMP -+ -+#define IPOPT_TS_TSONLY 0 /* timestamps only */ -+#define IPOPT_TS_TSANDADDR 1 /* timestamps and addresses */ -+#define IPOPT_TS_PRESPEC 3 /* specified modules only */ -+ -+#ifdef PLATFORM_LINUX -+ -+struct ip_options { -+ __u32 faddr; /* Saved first hop address */ -+ unsigned char optlen; -+ unsigned char srr; -+ unsigned char rr; -+ unsigned char ts; -+ unsigned char is_setbyuser:1, /* Set by setsockopt? */ -+ is_data:1, /* Options in __data, rather than skb */ -+ is_strictroute:1, /* Strict source route */ -+ srr_is_hit:1, /* Packet destination addr was our one */ -+ is_changed:1, /* IP checksum more not valid */ -+ rr_needaddr:1, /* Need to record addr of outgoing dev */ -+ ts_needtime:1, /* Need to record timestamp */ -+ ts_needaddr:1; /* Need to record addr of outgoing dev */ -+ unsigned char router_alert; -+ unsigned char __pad1; -+ unsigned char __pad2; -+ unsigned char __data[0]; -+}; -+ -+#define optlength(opt) (sizeof(struct ip_options) + opt->optlen) -+#endif -+ -+struct iphdr { -+#if defined(__LITTLE_ENDIAN_BITFIELD) -+ __u8 ihl:4, -+ version:4; -+#elif defined (__BIG_ENDIAN_BITFIELD) -+ __u8 version:4, -+ ihl:4; -+#else -+#error "Please fix " -+#endif -+ __u8 tos; -+ __u16 tot_len; -+ __u16 id; -+ __u16 frag_off; -+ __u8 ttl; -+ __u8 protocol; -+ __u16 check; -+ __u32 saddr; -+ __u32 daddr; -+ /*The options start here. */ -+}; -+ -+#endif /* _LINUX_IP_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/linux/wireless.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/linux/wireless.h ---- linux-4.14.18/3rdparty/rtl8723de/include/linux/wireless.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/linux/wireless.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,92 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef _LINUX_WIRELESS_H -+#define _LINUX_WIRELESS_H -+ -+/***************************** INCLUDES *****************************/ -+ -+#if 0 -+ #include /* for __u* and __s* typedefs */ -+ #include /* for "struct sockaddr" et al */ -+ #include /* for IFNAMSIZ and co... */ -+#else -+ #define __user -+ /* typedef uint16_t __u16; */ -+ #include /* for "struct sockaddr" et al */ -+ #include /* for IFNAMSIZ and co... */ -+#endif -+ -+/****************************** TYPES ******************************/ -+#ifdef CONFIG_COMPAT -+struct compat_iw_point { -+ compat_caddr_t pointer; -+ __u16 length; -+ __u16 flags; -+}; -+#endif -+/* --------------------------- SUBTYPES --------------------------- */ -+/* -+ * For all data larger than 16 octets, we need to use a -+ * pointer to memory allocated in user space. -+ */ -+struct iw_point { -+ void __user *pointer; /* Pointer to the data (in user space) */ -+ __u16 length; /* number of fields or size in bytes */ -+ __u16 flags; /* Optional params */ -+}; -+ -+ -+/* ------------------------ IOCTL REQUEST ------------------------ */ -+/* -+ * This structure defines the payload of an ioctl, and is used -+ * below. -+ * -+ * Note that this structure should fit on the memory footprint -+ * of iwreq (which is the same as ifreq), which mean a max size of -+ * 16 octets = 128 bits. Warning, pointers might be 64 bits wide... -+ * You should check this when increasing the structures defined -+ * above in this file... -+ */ -+union iwreq_data { -+ /* Config - generic */ -+ char name[IFNAMSIZ]; -+ /* Name : used to verify the presence of wireless extensions. -+ * Name of the protocol/provider... */ -+ -+ struct iw_point data; /* Other large parameters */ -+}; -+ -+/* -+ * The structure to exchange data for ioctl. -+ * This structure is the same as 'struct ifreq', but (re)defined for -+ * convenience... -+ * Do I need to remind you about structure size (32 octets) ? -+ */ -+struct iwreq { -+ union { -+ char ifrn_name[IFNAMSIZ]; /* if name, e.g. "eth0" */ -+ } ifr_ifrn; -+ -+ /* Data part (defined just above) */ -+ union iwreq_data u; -+}; -+ -+#endif /* _LINUX_WIRELESS_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/mlme_osdep.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/mlme_osdep.h ---- linux-4.14.18/3rdparty/rtl8723de/include/mlme_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/mlme_osdep.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,36 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __MLME_OSDEP_H_ -+#define __MLME_OSDEP_H_ -+ -+ -+#if defined(PLATFORM_WINDOWS) || defined(PLATFORM_MPIXEL) -+ extern int time_after(u32 now, u32 old); -+#endif -+ -+extern void rtw_init_mlme_timer(_adapter *padapter); -+extern void rtw_os_indicate_disconnect(_adapter *adapter, u16 reason, u8 locally_generated); -+extern void rtw_os_indicate_connect(_adapter *adapter); -+void rtw_os_indicate_scan_done(_adapter *padapter, bool aborted); -+extern void rtw_report_sec_ie(_adapter *adapter, u8 authmode, u8 *sec_ie); -+ -+void rtw_reset_securitypriv(_adapter *adapter); -+ -+#endif /* _MLME_OSDEP_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/mp_custom_oid.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/mp_custom_oid.h ---- linux-4.14.18/3rdparty/rtl8723de/include/mp_custom_oid.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/mp_custom_oid.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,353 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __CUSTOM_OID_H -+#define __CUSTOM_OID_H -+ -+/* by Owen -+ * 0xFF818000 - 0xFF81802F RTL8180 Mass Production Kit -+ * 0xFF818500 - 0xFF81850F RTL8185 Setup Utility -+ * 0xFF818580 - 0xFF81858F RTL8185 Phy Status Utility */ -+ -+/* */ -+ -+/* by Owen for Production Kit -+ * For Production Kit with Agilent Equipments -+ * in order to make our custom oids hopefully somewhat unique -+ * we will use 0xFF (indicating implementation specific OID) -+ * 81(first byte of non zero Realtek unique identifier) -+ * 80 (second byte of non zero Realtek unique identifier) -+ * XX (the custom OID number - providing 255 possible custom oids) */ -+ -+#define OID_RT_PRO_RESET_DUT 0xFF818000 -+#define OID_RT_PRO_SET_DATA_RATE 0xFF818001 -+#define OID_RT_PRO_START_TEST 0xFF818002 -+#define OID_RT_PRO_STOP_TEST 0xFF818003 -+#define OID_RT_PRO_SET_PREAMBLE 0xFF818004 -+#define OID_RT_PRO_SET_SCRAMBLER 0xFF818005 -+#define OID_RT_PRO_SET_FILTER_BB 0xFF818006 -+#define OID_RT_PRO_SET_MANUAL_DIVERSITY_BB 0xFF818007 -+#define OID_RT_PRO_SET_CHANNEL_DIRECT_CALL 0xFF818008 -+#define OID_RT_PRO_SET_SLEEP_MODE_DIRECT_CALL 0xFF818009 -+#define OID_RT_PRO_SET_WAKE_MODE_DIRECT_CALL 0xFF81800A -+ -+#define OID_RT_PRO_SET_TX_ANTENNA_BB 0xFF81800D -+#define OID_RT_PRO_SET_ANTENNA_BB 0xFF81800E -+#define OID_RT_PRO_SET_CR_SCRAMBLER 0xFF81800F -+#define OID_RT_PRO_SET_CR_NEW_FILTER 0xFF818010 -+#define OID_RT_PRO_SET_TX_POWER_CONTROL 0xFF818011 -+#define OID_RT_PRO_SET_CR_TX_CONFIG 0xFF818012 -+#define OID_RT_PRO_GET_TX_POWER_CONTROL 0xFF818013 -+#define OID_RT_PRO_GET_CR_SIGNAL_QUALITY 0xFF818014 -+#define OID_RT_PRO_SET_CR_SETPOINT 0xFF818015 -+#define OID_RT_PRO_SET_INTEGRATOR 0xFF818016 -+#define OID_RT_PRO_SET_SIGNAL_QUALITY 0xFF818017 -+#define OID_RT_PRO_GET_INTEGRATOR 0xFF818018 -+#define OID_RT_PRO_GET_SIGNAL_QUALITY 0xFF818019 -+#define OID_RT_PRO_QUERY_EEPROM_TYPE 0xFF81801A -+#define OID_RT_PRO_WRITE_MAC_ADDRESS 0xFF81801B -+#define OID_RT_PRO_READ_MAC_ADDRESS 0xFF81801C -+#define OID_RT_PRO_WRITE_CIS_DATA 0xFF81801D -+#define OID_RT_PRO_READ_CIS_DATA 0xFF81801E -+#define OID_RT_PRO_WRITE_POWER_CONTROL 0xFF81801F -+#define OID_RT_PRO_READ_POWER_CONTROL 0xFF818020 -+#define OID_RT_PRO_WRITE_EEPROM 0xFF818021 -+#define OID_RT_PRO_READ_EEPROM 0xFF818022 -+#define OID_RT_PRO_RESET_TX_PACKET_SENT 0xFF818023 -+#define OID_RT_PRO_QUERY_TX_PACKET_SENT 0xFF818024 -+#define OID_RT_PRO_RESET_RX_PACKET_RECEIVED 0xFF818025 -+#define OID_RT_PRO_QUERY_RX_PACKET_RECEIVED 0xFF818026 -+#define OID_RT_PRO_QUERY_RX_PACKET_CRC32_ERROR 0xFF818027 -+#define OID_RT_PRO_QUERY_CURRENT_ADDRESS 0xFF818028 -+#define OID_RT_PRO_QUERY_PERMANENT_ADDRESS 0xFF818029 -+#define OID_RT_PRO_SET_PHILIPS_RF_PARAMETERS 0xFF81802A -+#define OID_RT_PRO_RECEIVE_PACKET 0xFF81802C -+/* added by Owen on 04/08/03 for Cameo's request */ -+#define OID_RT_PRO_WRITE_EEPROM_BYTE 0xFF81802D -+#define OID_RT_PRO_READ_EEPROM_BYTE 0xFF81802E -+#define OID_RT_PRO_SET_MODULATION 0xFF81802F -+/* */ -+ -+/* Sean */ -+#define OID_RT_DRIVER_OPTION 0xFF818080 -+#define OID_RT_RF_OFF 0xFF818081 -+#define OID_RT_AUTH_STATUS 0xFF818082 -+ -+/* ************************************************************************ */ -+#define OID_RT_PRO_SET_CONTINUOUS_TX 0xFF81800B -+#define OID_RT_PRO_SET_SINGLE_CARRIER_TX 0xFF81800C -+#define OID_RT_PRO_SET_CARRIER_SUPPRESSION_TX 0xFF81802B -+#define OID_RT_PRO_SET_SINGLE_TONE_TX 0xFF818043 -+/* ************************************************************************ */ -+ -+ -+/* by Owen for RTL8185 Phy Status Report Utility */ -+#define OID_RT_UTILITY_FALSE_ALARM_COUNTERS 0xFF818580 -+#define OID_RT_UTILITY_SELECT_DEBUG_MODE 0xFF818581 -+#define OID_RT_UTILITY_SELECT_SUBCARRIER_NUMBER 0xFF818582 -+#define OID_RT_UTILITY_GET_RSSI_STATUS 0xFF818583 -+#define OID_RT_UTILITY_GET_FRAME_DETECTION_STATUS 0xFF818584 -+#define OID_RT_UTILITY_GET_AGC_AND_FREQUENCY_OFFSET_ESTIMATION_STATUS 0xFF818585 -+#define OID_RT_UTILITY_GET_CHANNEL_ESTIMATION_STATUS 0xFF818586 -+/* */ -+ -+/* by Owen on 03/09/19-03/09/22 for RTL8185 */ -+#define OID_RT_WIRELESS_MODE 0xFF818500 -+#define OID_RT_SUPPORTED_RATES 0xFF818501 -+#define OID_RT_DESIRED_RATES 0xFF818502 -+#define OID_RT_WIRELESS_MODE_STARTING_ADHOC 0xFF818503 -+/* */ -+ -+#define OID_RT_GET_CONNECT_STATE 0xFF030001 -+#define OID_RT_RESCAN 0xFF030002 -+#define OID_RT_SET_KEY_LENGTH 0xFF030003 -+#define OID_RT_SET_DEFAULT_KEY_ID 0xFF030004 -+ -+#define OID_RT_SET_CHANNEL 0xFF010182 -+#define OID_RT_SET_SNIFFER_MODE 0xFF010183 -+#define OID_RT_GET_SIGNAL_QUALITY 0xFF010184 -+#define OID_RT_GET_SMALL_PACKET_CRC 0xFF010185 -+#define OID_RT_GET_MIDDLE_PACKET_CRC 0xFF010186 -+#define OID_RT_GET_LARGE_PACKET_CRC 0xFF010187 -+#define OID_RT_GET_TX_RETRY 0xFF010188 -+#define OID_RT_GET_RX_RETRY 0xFF010189 -+#define OID_RT_PRO_SET_FW_DIG_STATE 0xFF01018A/* S */ -+#define OID_RT_PRO_SET_FW_RA_STATE 0xFF01018B/* S */ -+ -+#define OID_RT_GET_RX_TOTAL_PACKET 0xFF010190 -+#define OID_RT_GET_TX_BEACON_OK 0xFF010191 -+#define OID_RT_GET_TX_BEACON_ERR 0xFF010192 -+#define OID_RT_GET_RX_ICV_ERR 0xFF010193 -+#define OID_RT_SET_ENCRYPTION_ALGORITHM 0xFF010194 -+#define OID_RT_SET_NO_AUTO_RESCAN 0xFF010195 -+#define OID_RT_GET_PREAMBLE_MODE 0xFF010196 -+#define OID_RT_GET_DRIVER_UP_DELTA_TIME 0xFF010197 -+#define OID_RT_GET_AP_IP 0xFF010198 -+#define OID_RT_GET_CHANNELPLAN 0xFF010199 -+#define OID_RT_SET_PREAMBLE_MODE 0xFF01019A -+#define OID_RT_SET_BCN_INTVL 0xFF01019B -+#define OID_RT_GET_RF_VENDER 0xFF01019C -+#define OID_RT_DEDICATE_PROBE 0xFF01019D -+#define OID_RT_PRO_RX_FILTER_PATTERN 0xFF01019E -+ -+#define OID_RT_GET_DCST_CURRENT_THRESHOLD 0xFF01019F -+ -+#define OID_RT_GET_CCA_ERR 0xFF0101A0 -+#define OID_RT_GET_CCA_UPGRADE_THRESHOLD 0xFF0101A1 -+#define OID_RT_GET_CCA_FALLBACK_THRESHOLD 0xFF0101A2 -+ -+#define OID_RT_GET_CCA_UPGRADE_EVALUATE_TIMES 0xFF0101A3 -+#define OID_RT_GET_CCA_FALLBACK_EVALUATE_TIMES 0xFF0101A4 -+ -+/* by Owen on 03/31/03 for Cameo's request */ -+#define OID_RT_SET_RATE_ADAPTIVE 0xFF0101A5 -+/* */ -+#define OID_RT_GET_DCST_EVALUATE_PERIOD 0xFF0101A5 -+#define OID_RT_GET_DCST_TIME_UNIT_INDEX 0xFF0101A6 -+#define OID_RT_GET_TOTAL_TX_BYTES 0xFF0101A7 -+#define OID_RT_GET_TOTAL_RX_BYTES 0xFF0101A8 -+#define OID_RT_CURRENT_TX_POWER_LEVEL 0xFF0101A9 -+#define OID_RT_GET_ENC_KEY_MISMATCH_COUNT 0xFF0101AA -+#define OID_RT_GET_ENC_KEY_MATCH_COUNT 0xFF0101AB -+#define OID_RT_GET_CHANNEL 0xFF0101AC -+ -+#define OID_RT_SET_CHANNELPLAN 0xFF0101AD -+#define OID_RT_GET_HARDWARE_RADIO_OFF 0xFF0101AE -+#define OID_RT_CHANNELPLAN_BY_COUNTRY 0xFF0101AF -+#define OID_RT_SCAN_AVAILABLE_BSSID 0xFF0101B0 -+#define OID_RT_GET_HARDWARE_VERSION 0xFF0101B1 -+#define OID_RT_GET_IS_ROAMING 0xFF0101B2 -+#define OID_RT_GET_IS_PRIVACY 0xFF0101B3 -+#define OID_RT_GET_KEY_MISMATCH 0xFF0101B4 -+#define OID_RT_SET_RSSI_ROAM_TRAFFIC_TH 0xFF0101B5 -+#define OID_RT_SET_RSSI_ROAM_SIGNAL_TH 0xFF0101B6 -+#define OID_RT_RESET_LOG 0xFF0101B7 -+#define OID_RT_GET_LOG 0xFF0101B8 -+#define OID_RT_SET_INDICATE_HIDDEN_AP 0xFF0101B9 -+#define OID_RT_GET_HEADER_FAIL 0xFF0101BA -+#define OID_RT_SUPPORTED_WIRELESS_MODE 0xFF0101BB -+#define OID_RT_GET_CHANNEL_LIST 0xFF0101BC -+#define OID_RT_GET_SCAN_IN_PROGRESS 0xFF0101BD -+#define OID_RT_GET_TX_INFO 0xFF0101BE -+#define OID_RT_RF_READ_WRITE_OFFSET 0xFF0101BF -+#define OID_RT_RF_READ_WRITE 0xFF0101C0 -+ -+/* For Netgear request. 2005.01.13, by rcnjko. */ -+#define OID_RT_FORCED_DATA_RATE 0xFF0101C1 -+#define OID_RT_WIRELESS_MODE_FOR_SCAN_LIST 0xFF0101C2 -+/* For Netgear request. 2005.02.17, by rcnjko. */ -+#define OID_RT_GET_BSS_WIRELESS_MODE 0xFF0101C3 -+/* For AZ project. 2005.06.27, by rcnjko. */ -+#define OID_RT_SCAN_WITH_MAGIC_PACKET 0xFF0101C4 -+ -+/* Vincent 8185MP */ -+#define OID_RT_PRO_RX_FILTER 0xFF0111C0 -+ -+/* Andy TEST -+ * #define OID_RT_PRO_WRITE_REGISTRY 0xFF0111C1 -+ * #define OID_RT_PRO_READ_REGISTRY 0xFF0111C2 */ -+#define OID_CE_USB_WRITE_REGISTRY 0xFF0111C1 -+#define OID_CE_USB_READ_REGISTRY 0xFF0111C2 -+ -+ -+#define OID_RT_PRO_SET_INITIAL_GAIN 0xFF0111C3 -+#define OID_RT_PRO_SET_BB_RF_STANDBY_MODE 0xFF0111C4 -+#define OID_RT_PRO_SET_BB_RF_SHUTDOWN_MODE 0xFF0111C5 -+#define OID_RT_PRO_SET_TX_CHARGE_PUMP 0xFF0111C6 -+#define OID_RT_PRO_SET_RX_CHARGE_PUMP 0xFF0111C7 -+#define OID_RT_PRO_RF_WRITE_REGISTRY 0xFF0111C8 -+#define OID_RT_PRO_RF_READ_REGISTRY 0xFF0111C9 -+#define OID_RT_PRO_QUERY_RF_TYPE 0xFF0111CA -+ -+/* AP OID */ -+#define OID_RT_AP_GET_ASSOCIATED_STATION_LIST 0xFF010300 -+#define OID_RT_AP_GET_CURRENT_TIME_STAMP 0xFF010301 -+#define OID_RT_AP_SWITCH_INTO_AP_MODE 0xFF010302 -+#define OID_RT_AP_SET_DTIM_PERIOD 0xFF010303 -+#define OID_RT_AP_SUPPORTED 0xFF010304 /* Determine if driver supports AP mode. 2004.08.27, by rcnjko. */ -+#define OID_RT_AP_SET_PASSPHRASE 0xFF010305 /* Set WPA-PSK passphrase into authenticator. 2005.07.08, byrcnjko. */ -+ -+/* 8187MP. 2004.09.06, by rcnjko. */ -+#define OID_RT_PRO8187_WI_POLL 0xFF818780 -+#define OID_RT_PRO_WRITE_BB_REG 0xFF818781 -+#define OID_RT_PRO_READ_BB_REG 0xFF818782 -+#define OID_RT_PRO_WRITE_RF_REG 0xFF818783 -+#define OID_RT_PRO_READ_RF_REG 0xFF818784 -+ -+/* Meeting House. added by Annie, 2005-07-20. */ -+#define OID_RT_MH_VENDER_ID 0xFFEDC100 -+ -+/* 8711 MP OID added 20051230. */ -+#define OID_RT_PRO8711_JOIN_BSS 0xFF871100/* S */ -+ -+#define OID_RT_PRO_READ_REGISTER 0xFF871101 /* Q */ -+#define OID_RT_PRO_WRITE_REGISTER 0xFF871102 /* S */ -+ -+#define OID_RT_PRO_BURST_READ_REGISTER 0xFF871103 /* Q */ -+#define OID_RT_PRO_BURST_WRITE_REGISTER 0xFF871104 /* S */ -+ -+#define OID_RT_PRO_WRITE_TXCMD 0xFF871105 /* S */ -+ -+#define OID_RT_PRO_READ16_EEPROM 0xFF871106 /* Q */ -+#define OID_RT_PRO_WRITE16_EEPROM 0xFF871107 /* S */ -+ -+#define OID_RT_PRO_H2C_SET_COMMAND 0xFF871108 /* S */ -+#define OID_RT_PRO_H2C_QUERY_RESULT 0xFF871109 /* Q */ -+ -+#define OID_RT_PRO8711_WI_POLL 0xFF87110A /* Q */ -+#define OID_RT_PRO8711_PKT_LOSS 0xFF87110B /* Q */ -+#define OID_RT_RD_ATTRIB_MEM 0xFF87110C/* Q */ -+#define OID_RT_WR_ATTRIB_MEM 0xFF87110D/* S */ -+ -+ -+/* Method 2 for H2C/C2H */ -+#define OID_RT_PRO_H2C_CMD_MODE 0xFF871110 /* S */ -+#define OID_RT_PRO_H2C_CMD_RSP_MODE 0xFF871111 /* Q */ -+#define OID_RT_PRO_H2C_CMD_EVENT_MODE 0xFF871112 /* S */ -+#define OID_RT_PRO_WAIT_C2H_EVENT 0xFF871113 /* Q */ -+#define OID_RT_PRO_RW_ACCESS_PROTOCOL_TEST 0xFF871114/* Q */ -+ -+#define OID_RT_PRO_SCSI_ACCESS_TEST 0xFF871115 /* Q, S */ -+ -+#define OID_RT_PRO_SCSI_TCPIPOFFLOAD_OUT 0xFF871116 /* S */ -+#define OID_RT_PRO_SCSI_TCPIPOFFLOAD_IN 0xFF871117 /* Q, S */ -+#define OID_RT_RRO_RX_PKT_VIA_IOCTRL 0xFF871118 /* Q */ -+#define OID_RT_RRO_RX_PKTARRAY_VIA_IOCTRL 0xFF871119 /* Q */ -+ -+#define OID_RT_RPO_SET_PWRMGT_TEST 0xFF87111A /* S */ -+#define OID_RT_PRO_QRY_PWRMGT_TEST 0XFF87111B /* Q */ -+#define OID_RT_RPO_ASYNC_RWIO_TEST 0xFF87111C /* S */ -+#define OID_RT_RPO_ASYNC_RWIO_POLL 0xFF87111D /* Q */ -+#define OID_RT_PRO_SET_RF_INTFS 0xFF87111E /* S */ -+#define OID_RT_POLL_RX_STATUS 0xFF87111F /* Q */ -+ -+#define OID_RT_PRO_CFG_DEBUG_MESSAGE 0xFF871120 /* Q, S */ -+#define OID_RT_PRO_SET_DATA_RATE_EX 0xFF871121/* S */ -+#define OID_RT_PRO_SET_BASIC_RATE 0xFF871122/* S */ -+#define OID_RT_PRO_READ_TSSI 0xFF871123/* S */ -+#define OID_RT_PRO_SET_POWER_TRACKING 0xFF871124/* S */ -+ -+ -+#define OID_RT_PRO_QRY_PWRSTATE 0xFF871150 /* Q */ -+#define OID_RT_PRO_SET_PWRSTATE 0xFF871151 /* S */ -+ -+/* Method 2 , using workitem */ -+#define OID_RT_SET_READ_REG 0xFF871181 /* S */ -+#define OID_RT_SET_WRITE_REG 0xFF871182 /* S */ -+#define OID_RT_SET_BURST_READ_REG 0xFF871183 /* S */ -+#define OID_RT_SET_BURST_WRITE_REG 0xFF871184 /* S */ -+#define OID_RT_SET_WRITE_TXCMD 0xFF871185 /* S */ -+#define OID_RT_SET_READ16_EEPROM 0xFF871186 /* S */ -+#define OID_RT_SET_WRITE16_EEPROM 0xFF871187 /* S */ -+#define OID_RT_QRY_POLL_WKITEM 0xFF871188 /* Q */ -+ -+/* For SDIO INTERFACE only */ -+#define OID_RT_PRO_SYNCPAGERW_SRAM 0xFF8711A0 /* Q, S */ -+#define OID_RT_PRO_871X_DRV_EXT 0xFF8711A1 -+ -+/* For USB INTERFACE only */ -+#define OID_RT_PRO_USB_VENDOR_REQ 0xFF8711B0 /* Q, S */ -+#define OID_RT_PRO_SCSI_AUTO_TEST 0xFF8711B1 /* S */ -+#define OID_RT_PRO_USB_MAC_AC_FIFO_WRITE 0xFF8711B2 /* S */ -+#define OID_RT_PRO_USB_MAC_RX_FIFO_READ 0xFF8711B3 /* Q */ -+#define OID_RT_PRO_USB_MAC_RX_FIFO_POLLING 0xFF8711B4 /* Q */ -+ -+#define OID_RT_PRO_H2C_SET_RATE_TABLE 0xFF8711FB /* S */ -+#define OID_RT_PRO_H2C_GET_RATE_TABLE 0xFF8711FC /* S */ -+#define OID_RT_PRO_H2C_C2H_LBK_TEST 0xFF8711FE -+ -+#define OID_RT_PRO_ENCRYPTION_CTRL 0xFF871200 /* Q, S */ -+#define OID_RT_PRO_ADD_STA_INFO 0xFF871201 /* S */ -+#define OID_RT_PRO_DELE_STA_INFO 0xFF871202 /* S */ -+#define OID_RT_PRO_QUERY_DR_VARIABLE 0xFF871203 /* Q */ -+ -+#define OID_RT_PRO_RX_PACKET_TYPE 0xFF871204 /* Q, S */ -+ -+#define OID_RT_PRO_READ_EFUSE 0xFF871205 /* Q */ -+#define OID_RT_PRO_WRITE_EFUSE 0xFF871206 /* S */ -+#define OID_RT_PRO_RW_EFUSE_PGPKT 0xFF871207 /* Q, S */ -+#define OID_RT_GET_EFUSE_CURRENT_SIZE 0xFF871208 /* Q */ -+ -+#define OID_RT_SET_BANDWIDTH 0xFF871209 /* S */ -+#define OID_RT_SET_CRYSTAL_CAP 0xFF87120A /* S */ -+ -+#define OID_RT_SET_RX_PACKET_TYPE 0xFF87120B /* S */ -+ -+#define OID_RT_GET_EFUSE_MAX_SIZE 0xFF87120C /* Q */ -+ -+#define OID_RT_PRO_SET_TX_AGC_OFFSET 0xFF87120D /* S */ -+ -+#define OID_RT_PRO_SET_PKT_TEST_MODE 0xFF87120E /* S */ -+ -+#define OID_RT_PRO_FOR_EVM_TEST_SETTING 0xFF87120F /* S */ -+ -+#define OID_RT_PRO_GET_THERMAL_METER 0xFF871210 /* Q */ -+ -+#define OID_RT_RESET_PHY_RX_PACKET_COUNT 0xFF871211 /* S */ -+#define OID_RT_GET_PHY_RX_PACKET_RECEIVED 0xFF871212 /* Q */ -+#define OID_RT_GET_PHY_RX_PACKET_CRC32_ERROR 0xFF871213 /* Q */ -+ -+#define OID_RT_SET_POWER_DOWN 0xFF871214 /* S */ -+ -+#define OID_RT_GET_POWER_MODE 0xFF871215 /* Q */ -+ -+#define OID_RT_PRO_EFUSE 0xFF871216 /* Q, S */ -+#define OID_RT_PRO_EFUSE_MAP 0xFF871217 /* Q, S */ -+ -+#endif /* #ifndef __CUSTOM_OID_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/nic_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/nic_spec.h ---- linux-4.14.18/3rdparty/rtl8723de/include/nic_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/nic_spec.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,46 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __NIC_SPEC_H__ -+#define __NIC_SPEC_H__ -+ -+#include -+ -+#define RTL8711_MCTRL_ (0x20000) -+#define RTL8711_UART_ (0x30000) -+#define RTL8711_TIMER_ (0x40000) -+#define RTL8711_FINT_ (0x50000) -+#define RTL8711_HINT_ (0x50000) -+#define RTL8711_GPIO_ (0x60000) -+#define RTL8711_WLANCTRL_ (0x200000) -+#define RTL8711_WLANFF_ (0xe00000) -+#define RTL8711_HCICTRL_ (0x600000) -+#define RTL8711_SYSCFG_ (0x620000) -+#define RTL8711_SYSCTRL_ (0x620000) -+#define RTL8711_MCCTRL_ (0x020000) -+ -+ -+#include -+ -+#include -+ -+ -+#endif /* __RTL8711_SPEC_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/osdep_intf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_intf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/osdep_intf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_intf.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,171 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __OSDEP_INTF_H_ -+#define __OSDEP_INTF_H_ -+ -+ -+struct intf_priv { -+ -+ u8 *intf_dev; -+ u32 max_iosz; /* USB2.0: 128, USB1.1: 64, SDIO:64 */ -+ u32 max_xmitsz; /* USB2.0: unlimited, SDIO:512 */ -+ u32 max_recvsz; /* USB2.0: unlimited, SDIO:512 */ -+ -+ volatile u8 *io_rwmem; -+ volatile u8 *allocated_io_rwmem; -+ u32 io_wsz; /* unit: 4bytes */ -+ u32 io_rsz;/* unit: 4bytes */ -+ u8 intf_status; -+ -+ void (*_bus_io)(u8 *priv); -+ -+ /* -+ Under Sync. IRP (SDIO/USB) -+ A protection mechanism is necessary for the io_rwmem(read/write protocol) -+ -+ Under Async. IRP (SDIO/USB) -+ The protection mechanism is through the pending queue. -+ */ -+ -+ _mutex ioctl_mutex; -+ -+ -+#ifdef PLATFORM_LINUX -+#ifdef CONFIG_USB_HCI -+ /* when in USB, IO is through interrupt in/out endpoints */ -+ struct usb_device *udev; -+ PURB piorw_urb; -+ u8 io_irp_cnt; -+ u8 bio_irp_pending; -+ _sema io_retevt; -+ _timer io_timer; -+ u8 bio_irp_timeout; -+ u8 bio_timer_cancel; -+#endif -+#endif -+ -+#ifdef PLATFORM_OS_XP -+#ifdef CONFIG_SDIO_HCI -+ /* below is for io_rwmem... */ -+ PMDL pmdl; -+ PSDBUS_REQUEST_PACKET sdrp; -+ PSDBUS_REQUEST_PACKET recv_sdrp; -+ PSDBUS_REQUEST_PACKET xmit_sdrp; -+ -+ PIRP piorw_irp; -+ -+#endif -+#ifdef CONFIG_USB_HCI -+ PURB piorw_urb; -+ PIRP piorw_irp; -+ u8 io_irp_cnt; -+ u8 bio_irp_pending; -+ _sema io_retevt; -+#endif -+#endif -+ -+}; -+ -+ -+#ifdef CONFIG_R871X_TEST -+ int rtw_start_pseudo_adhoc(_adapter *padapter); -+ int rtw_stop_pseudo_adhoc(_adapter *padapter); -+#endif -+ -+struct dvobj_priv *devobj_init(void); -+void devobj_deinit(struct dvobj_priv *pdvobj); -+ -+u8 rtw_init_drv_sw(_adapter *padapter); -+u8 rtw_free_drv_sw(_adapter *padapter); -+u8 rtw_reset_drv_sw(_adapter *padapter); -+void rtw_dev_unload(PADAPTER padapter); -+ -+u32 rtw_start_drv_threads(_adapter *padapter); -+void rtw_stop_drv_threads(_adapter *padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void rtw_cancel_dynamic_chk_timer(_adapter *padapter); -+#endif -+void rtw_cancel_all_timer(_adapter *padapter); -+ -+uint loadparam(_adapter *adapter); -+ -+#ifdef PLATFORM_LINUX -+int rtw_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); -+ -+int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname); -+struct net_device *rtw_init_netdev(_adapter *padapter); -+ -+void rtw_os_ndev_free(_adapter *adapter); -+int rtw_os_ndev_init(_adapter *adapter, const char *name); -+void rtw_os_ndev_deinit(_adapter *adapter); -+void rtw_os_ndev_unregister(_adapter *adapter); -+void rtw_os_ndevs_unregister(struct dvobj_priv *dvobj); -+int rtw_os_ndevs_init(struct dvobj_priv *dvobj); -+void rtw_os_ndevs_deinit(struct dvobj_priv *dvobj); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+u16 rtw_recv_select_queue(struct sk_buff *skb); -+#endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35) */ -+ -+int rtw_ndev_notifier_register(void); -+void rtw_ndev_notifier_unregister(void); -+ -+#include "../os_dep/linux/rtw_proc.h" -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ #include "../os_dep/linux/ioctl_cfg80211.h" -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+u8 rtw_rtnl_lock_needed(struct dvobj_priv *dvobj); -+void rtw_set_rtnl_lock_holder(struct dvobj_priv *dvobj, _thread_hdl_ thd_hdl); -+ -+#endif /* PLATFORM_LINUX */ -+ -+ -+#ifdef PLATFORM_FREEBSD -+extern int rtw_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data); -+#endif -+ -+void rtw_ips_dev_unload(_adapter *padapter); -+ -+#ifdef CONFIG_IPS -+int rtw_ips_pwr_up(_adapter *padapter); -+void rtw_ips_pwr_down(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+struct _io_ops; -+struct dvobj_priv; -+_adapter *rtw_drv_add_vir_if(_adapter *primary_padapter, void (*set_intf_ops)(_adapter *primary_padapter, struct _io_ops *pops)); -+void rtw_drv_stop_vir_ifaces(struct dvobj_priv *dvobj); -+void rtw_drv_free_vir_ifaces(struct dvobj_priv *dvobj); -+#endif -+ -+void rtw_ndev_destructor(_nic_hdl ndev); -+ -+#ifdef CONFIG_ARP_KEEP_ALIVE -+int rtw_gw_addr_query(_adapter *padapter); -+#endif -+ -+int rtw_suspend_common(_adapter *padapter); -+int rtw_resume_common(_adapter *padapter); -+ -+#endif /* _OSDEP_INTF_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_bsd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_bsd.h ---- linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_bsd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_bsd.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,745 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __OSDEP_BSD_SERVICE_H_ -+#define __OSDEP_BSD_SERVICE_H_ -+ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+ -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include "usbdevs.h" -+ -+#define USB_DEBUG_VAR rum_debug -+#include -+ -+#if 1 //Baron porting from linux, it's all temp solution, needs to check again -+#include -+#include /* XXX for PCPU_GET */ -+// typedef struct semaphore _sema; -+ typedef struct sema _sema; -+// typedef spinlock_t _lock; -+ typedef struct mtx _lock; -+ typedef struct mtx _mutex; -+ typedef struct timer_list _timer; -+ struct list_head { -+ struct list_head *next, *prev; -+ }; -+ struct __queue { -+ struct list_head queue; -+ _lock lock; -+ }; -+ -+ //typedef struct sk_buff _pkt; -+ typedef struct mbuf _pkt; -+ typedef struct mbuf _buffer; -+ -+ typedef struct __queue _queue; -+ typedef struct list_head _list; -+ typedef int _OS_STATUS; -+ //typedef u32 _irqL; -+ typedef unsigned long _irqL; -+ typedef struct ifnet * _nic_hdl; -+ -+ typedef pid_t _thread_hdl_; -+// typedef struct thread _thread_hdl_; -+ typedef void thread_return; -+ typedef void* thread_context; -+ -+ typedef void timer_hdl_return; -+ typedef void* timer_hdl_context; -+ typedef struct work_struct _workitem; -+ -+#define KERNEL_VERSION(a,b,c) (((a) << 16) + ((b) << 8) + (c)) -+/* emulate a modern version */ -+#define LINUX_VERSION_CODE KERNEL_VERSION(2, 6, 35) -+ -+#define WIRELESS_EXT -1 -+#define HZ hz -+#define spin_lock_irqsave mtx_lock_irqsave -+#define spin_lock_bh mtx_lock_irqsave -+#define mtx_lock_irqsave(lock, x) mtx_lock(lock)//{local_irq_save((x)); mtx_lock_spin((lock));} -+//#define IFT_RTW 0xf9 //ifnet allocate type for RTW -+#define free_netdev if_free -+#define LIST_CONTAINOR(ptr, type, member) \ -+ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) -+#define container_of(p,t,n) (t*)((p)-&(((t*)0)->n)) -+/* -+ * Linux timers are emulated using FreeBSD callout functions -+ * (and taskqueue functionality). -+ * -+ * Currently no timer stats functionality. -+ * -+ * See (linux_compat) processes.c -+ * -+ */ -+struct timer_list { -+ -+ /* FreeBSD callout related fields */ -+ struct callout callout; -+ -+ //timeout function -+ void (*function)(void*); -+ //argument -+ void *arg; -+ -+}; -+struct workqueue_struct; -+struct work_struct; -+typedef void (*work_func_t)(struct work_struct *work); -+/* Values for the state of an item of work (work_struct) */ -+typedef enum work_state { -+ WORK_STATE_UNSET = 0, -+ WORK_STATE_CALLOUT_PENDING = 1, -+ WORK_STATE_TASK_PENDING = 2, -+ WORK_STATE_WORK_CANCELLED = 3 -+} work_state_t; -+ -+struct work_struct { -+ struct task task; /* FreeBSD task */ -+ work_state_t state; /* the pending or otherwise state of work. */ -+ work_func_t func; -+}; -+#define spin_unlock_irqrestore mtx_unlock_irqrestore -+#define spin_unlock_bh mtx_unlock_irqrestore -+#define mtx_unlock_irqrestore(lock,x) mtx_unlock(lock); -+extern void _rtw_spinlock_init(_lock *plock); -+ -+//modify private structure to match freebsd -+#define BITS_PER_LONG 32 -+union ktime { -+ s64 tv64; -+#if BITS_PER_LONG != 64 && !defined(CONFIG_KTIME_SCALAR) -+ struct { -+#ifdef __BIG_ENDIAN -+ s32 sec, nsec; -+#else -+ s32 nsec, sec; -+#endif -+ } tv; -+#endif -+}; -+#define kmemcheck_bitfield_begin(name) -+#define kmemcheck_bitfield_end(name) -+#define CHECKSUM_NONE 0 -+typedef unsigned char *sk_buff_data_t; -+typedef union ktime ktime_t; /* Kill this */ -+ -+void rtw_mtx_lock(_lock *plock); -+ -+void rtw_mtx_unlock(_lock *plock); -+ -+/** -+ * struct sk_buff - socket buffer -+ * @next: Next buffer in list -+ * @prev: Previous buffer in list -+ * @sk: Socket we are owned by -+ * @tstamp: Time we arrived -+ * @dev: Device we arrived on/are leaving by -+ * @transport_header: Transport layer header -+ * @network_header: Network layer header -+ * @mac_header: Link layer header -+ * @_skb_refdst: destination entry (with norefcount bit) -+ * @sp: the security path, used for xfrm -+ * @cb: Control buffer. Free for use by every layer. Put private vars here -+ * @len: Length of actual data -+ * @data_len: Data length -+ * @mac_len: Length of link layer header -+ * @hdr_len: writable header length of cloned skb -+ * @csum: Checksum (must include start/offset pair) -+ * @csum_start: Offset from skb->head where checksumming should start -+ * @csum_offset: Offset from csum_start where checksum should be stored -+ * @local_df: allow local fragmentation -+ * @cloned: Head may be cloned (check refcnt to be sure) -+ * @nohdr: Payload reference only, must not modify header -+ * @pkt_type: Packet class -+ * @fclone: skbuff clone status -+ * @ip_summed: Driver fed us an IP checksum -+ * @priority: Packet queueing priority -+ * @users: User count - see {datagram,tcp}.c -+ * @protocol: Packet protocol from driver -+ * @truesize: Buffer size -+ * @head: Head of buffer -+ * @data: Data head pointer -+ * @tail: Tail pointer -+ * @end: End pointer -+ * @destructor: Destruct function -+ * @mark: Generic packet mark -+ * @nfct: Associated connection, if any -+ * @ipvs_property: skbuff is owned by ipvs -+ * @peeked: this packet has been seen already, so stats have been -+ * done for it, don't do them again -+ * @nf_trace: netfilter packet trace flag -+ * @nfctinfo: Relationship of this skb to the connection -+ * @nfct_reasm: netfilter conntrack re-assembly pointer -+ * @nf_bridge: Saved data about a bridged frame - see br_netfilter.c -+ * @skb_iif: ifindex of device we arrived on -+ * @rxhash: the packet hash computed on receive -+ * @queue_mapping: Queue mapping for multiqueue devices -+ * @tc_index: Traffic control index -+ * @tc_verd: traffic control verdict -+ * @ndisc_nodetype: router type (from link layer) -+ * @dma_cookie: a cookie to one of several possible DMA operations -+ * done by skb DMA functions -+ * @secmark: security marking -+ * @vlan_tci: vlan tag control information -+ */ -+ -+struct sk_buff { -+ /* These two members must be first. */ -+ struct sk_buff *next; -+ struct sk_buff *prev; -+ -+ ktime_t tstamp; -+ -+ struct sock *sk; -+ //struct net_device *dev; -+ struct ifnet *dev; -+ -+ /* -+ * This is the control buffer. It is free to use for every -+ * layer. Please put your private variables there. If you -+ * want to keep them across layers you have to do a skb_clone() -+ * first. This is owned by whoever has the skb queued ATM. -+ */ -+ char cb[48] __aligned(8); -+ -+ unsigned long _skb_refdst; -+#ifdef CONFIG_XFRM -+ struct sec_path *sp; -+#endif -+ unsigned int len, -+ data_len; -+ u16 mac_len, -+ hdr_len; -+ union { -+ u32 csum; -+ struct { -+ u16 csum_start; -+ u16 csum_offset; -+ }smbol2; -+ }smbol1; -+ u32 priority; -+ kmemcheck_bitfield_begin(flags1); -+ u8 local_df:1, -+ cloned:1, -+ ip_summed:2, -+ nohdr:1, -+ nfctinfo:3; -+ u8 pkt_type:3, -+ fclone:2, -+ ipvs_property:1, -+ peeked:1, -+ nf_trace:1; -+ kmemcheck_bitfield_end(flags1); -+ u16 protocol; -+ -+ void (*destructor)(struct sk_buff *skb); -+#if defined(CONFIG_NF_CONNTRACK) || defined(CONFIG_NF_CONNTRACK_MODULE) -+ struct nf_conntrack *nfct; -+ struct sk_buff *nfct_reasm; -+#endif -+#ifdef CONFIG_BRIDGE_NETFILTER -+ struct nf_bridge_info *nf_bridge; -+#endif -+ -+ int skb_iif; -+#ifdef CONFIG_NET_SCHED -+ u16 tc_index; /* traffic control index */ -+#ifdef CONFIG_NET_CLS_ACT -+ u16 tc_verd; /* traffic control verdict */ -+#endif -+#endif -+ -+ u32 rxhash; -+ -+ kmemcheck_bitfield_begin(flags2); -+ u16 queue_mapping:16; -+#ifdef CONFIG_IPV6_NDISC_NODETYPE -+ u8 ndisc_nodetype:2, -+ deliver_no_wcard:1; -+#else -+ u8 deliver_no_wcard:1; -+#endif -+ kmemcheck_bitfield_end(flags2); -+ -+ /* 0/14 bit hole */ -+ -+#ifdef CONFIG_NET_DMA -+ dma_cookie_t dma_cookie; -+#endif -+#ifdef CONFIG_NETWORK_SECMARK -+ u32 secmark; -+#endif -+ union { -+ u32 mark; -+ u32 dropcount; -+ }symbol3; -+ -+ u16 vlan_tci; -+ -+ sk_buff_data_t transport_header; -+ sk_buff_data_t network_header; -+ sk_buff_data_t mac_header; -+ /* These elements must be at the end, see alloc_skb() for details. */ -+ sk_buff_data_t tail; -+ sk_buff_data_t end; -+ unsigned char *head, -+ *data; -+ unsigned int truesize; -+ atomic_t users; -+}; -+struct sk_buff_head { -+ /* These two members must be first. */ -+ struct sk_buff *next; -+ struct sk_buff *prev; -+ -+ u32 qlen; -+ _lock lock; -+}; -+#define skb_tail_pointer(skb) skb->tail -+static inline unsigned char *skb_put(struct sk_buff *skb, unsigned int len) -+{ -+ unsigned char *tmp = skb_tail_pointer(skb); -+ //SKB_LINEAR_ASSERT(skb); -+ skb->tail += len; -+ skb->len += len; -+ return tmp; -+} -+ -+static inline unsigned char *__skb_pull(struct sk_buff *skb, unsigned int len) -+{ -+ skb->len -= len; -+ if(skb->len < skb->data_len) -+ printf("%s(),%d,error!\n",__FUNCTION__,__LINE__); -+ return skb->data += len; -+} -+static inline unsigned char *skb_pull(struct sk_buff *skb, unsigned int len) -+{ -+ #ifdef PLATFORM_FREEBSD -+ return __skb_pull(skb, len); -+ #else -+ return unlikely(len > skb->len) ? NULL : __skb_pull(skb, len); -+ #endif //PLATFORM_FREEBSD -+} -+static inline u32 skb_queue_len(const struct sk_buff_head *list_) -+{ -+ return list_->qlen; -+} -+static inline void __skb_insert(struct sk_buff *newsk, -+ struct sk_buff *prev, struct sk_buff *next, -+ struct sk_buff_head *list) -+{ -+ newsk->next = next; -+ newsk->prev = prev; -+ next->prev = prev->next = newsk; -+ list->qlen++; -+} -+static inline void __skb_queue_before(struct sk_buff_head *list, -+ struct sk_buff *next, -+ struct sk_buff *newsk) -+{ -+ __skb_insert(newsk, next->prev, next, list); -+} -+static inline void skb_queue_tail(struct sk_buff_head *list, -+ struct sk_buff *newsk) -+{ -+ mtx_lock(&list->lock); -+ __skb_queue_before(list, (struct sk_buff *)list, newsk); -+ mtx_unlock(&list->lock); -+} -+static inline struct sk_buff *skb_peek(struct sk_buff_head *list_) -+{ -+ struct sk_buff *list = ((struct sk_buff *)list_)->next; -+ if (list == (struct sk_buff *)list_) -+ list = NULL; -+ return list; -+} -+static inline void __skb_unlink(struct sk_buff *skb, struct sk_buff_head *list) -+{ -+ struct sk_buff *next, *prev; -+ -+ list->qlen--; -+ next = skb->next; -+ prev = skb->prev; -+ skb->next = skb->prev = NULL; -+ next->prev = prev; -+ prev->next = next; -+} -+ -+static inline struct sk_buff *skb_dequeue(struct sk_buff_head *list) -+{ -+ mtx_lock(&list->lock); -+ -+ struct sk_buff *skb = skb_peek(list); -+ if (skb) -+ __skb_unlink(skb, list); -+ -+ mtx_unlock(&list->lock); -+ -+ return skb; -+} -+static inline void skb_reserve(struct sk_buff *skb, int len) -+{ -+ skb->data += len; -+ skb->tail += len; -+} -+static inline void __skb_queue_head_init(struct sk_buff_head *list) -+{ -+ list->prev = list->next = (struct sk_buff *)list; -+ list->qlen = 0; -+} -+/* -+ * This function creates a split out lock class for each invocation; -+ * this is needed for now since a whole lot of users of the skb-queue -+ * infrastructure in drivers have different locking usage (in hardirq) -+ * than the networking core (in softirq only). In the long run either the -+ * network layer or drivers should need annotation to consolidate the -+ * main types of usage into 3 classes. -+ */ -+static inline void skb_queue_head_init(struct sk_buff_head *list) -+{ -+ _rtw_spinlock_init(&list->lock); -+ __skb_queue_head_init(list); -+} -+unsigned long copy_from_user(void *to, const void *from, unsigned long n); -+unsigned long copy_to_user(void *to, const void *from, unsigned long n); -+struct sk_buff * dev_alloc_skb(unsigned int size); -+struct sk_buff *skb_clone(const struct sk_buff *skb); -+void dev_kfree_skb_any(struct sk_buff *skb); -+#endif //Baron porting from linux, it's all temp solution, needs to check again -+ -+ -+#if 1 // kenny add Linux compatibility code for Linux USB driver -+#include -+ -+#define __init // __attribute ((constructor)) -+#define __exit // __attribute ((destructor)) -+ -+/* -+ * Definitions for module_init and module_exit macros. -+ * -+ * These macros will use the SYSINIT framework to call a specified -+ * function (with no arguments) on module loading or unloading. -+ * -+ */ -+ -+void module_init_exit_wrapper(void *arg); -+ -+#define module_init(initfn) \ -+ SYSINIT(mod_init_ ## initfn, \ -+ SI_SUB_KLD, SI_ORDER_FIRST, \ -+ module_init_exit_wrapper, initfn) -+ -+#define module_exit(exitfn) \ -+ SYSUNINIT(mod_exit_ ## exitfn, \ -+ SI_SUB_KLD, SI_ORDER_ANY, \ -+ module_init_exit_wrapper, exitfn) -+ -+/* -+ * The usb_register and usb_deregister functions are used to register -+ * usb drivers with the usb subsystem. -+ */ -+int usb_register(struct usb_driver *driver); -+int usb_deregister(struct usb_driver *driver); -+ -+/* -+ * usb_get_dev and usb_put_dev - increment/decrement the reference count -+ * of the usb device structure. -+ * -+ * Original body of usb_get_dev: -+ * -+ * if (dev) -+ * get_device(&dev->dev); -+ * return dev; -+ * -+ * Reference counts are not currently used in this compatibility -+ * layer. So these functions will do nothing. -+ */ -+static inline struct usb_device * -+usb_get_dev(struct usb_device *dev) -+{ -+ return dev; -+} -+ -+static inline void -+usb_put_dev(struct usb_device *dev) -+{ -+ return; -+} -+ -+ -+// rtw_usb_compat_linux -+int rtw_usb_submit_urb(struct urb *urb, uint16_t mem_flags); -+int rtw_usb_unlink_urb(struct urb *urb); -+int rtw_usb_clear_halt(struct usb_device *dev, struct usb_host_endpoint *uhe); -+int rtw_usb_control_msg(struct usb_device *dev, struct usb_host_endpoint *uhe, -+ uint8_t request, uint8_t requesttype, -+ uint16_t value, uint16_t index, void *data, -+ uint16_t size, usb_timeout_t timeout); -+int rtw_usb_set_interface(struct usb_device *dev, uint8_t iface_no, uint8_t alt_index); -+int rtw_usb_setup_endpoint(struct usb_device *dev, -+ struct usb_host_endpoint *uhe, usb_size_t bufsize); -+struct urb *rtw_usb_alloc_urb(uint16_t iso_packets, uint16_t mem_flags); -+struct usb_host_endpoint *rtw_usb_find_host_endpoint(struct usb_device *dev, uint8_t type, uint8_t ep); -+struct usb_host_interface *rtw_usb_altnum_to_altsetting(const struct usb_interface *intf, uint8_t alt_index); -+struct usb_interface *rtw_usb_ifnum_to_if(struct usb_device *dev, uint8_t iface_no); -+void *rtw_usbd_get_intfdata(struct usb_interface *intf); -+void rtw_usb_linux_register(void *arg); -+void rtw_usb_linux_deregister(void *arg); -+void rtw_usb_linux_free_device(struct usb_device *dev); -+void rtw_usb_free_urb(struct urb *urb); -+void rtw_usb_init_urb(struct urb *urb); -+void rtw_usb_kill_urb(struct urb *urb); -+void rtw_usb_set_intfdata(struct usb_interface *intf, void *data); -+void rtw_usb_fill_bulk_urb(struct urb *urb, struct usb_device *udev, -+ struct usb_host_endpoint *uhe, void *buf, -+ int length, usb_complete_t callback, void *arg); -+int rtw_usb_bulk_msg(struct usb_device *udev, struct usb_host_endpoint *uhe, -+ void *data, int len, uint16_t *pactlen, usb_timeout_t timeout); -+void *usb_get_intfdata(struct usb_interface *intf); -+int usb_linux_init_endpoints(struct usb_device *udev); -+ -+ -+ -+typedef struct urb * PURB; -+ -+typedef unsigned gfp_t; -+#define __GFP_WAIT ((gfp_t)0x10u) /* Can wait and reschedule? */ -+#define __GFP_HIGH ((gfp_t)0x20u) /* Should access emergency pools? */ -+#define __GFP_IO ((gfp_t)0x40u) /* Can start physical IO? */ -+#define __GFP_FS ((gfp_t)0x80u) /* Can call down to low-level FS? */ -+#define __GFP_COLD ((gfp_t)0x100u) /* Cache-cold page required */ -+#define __GFP_NOWARN ((gfp_t)0x200u) /* Suppress page allocation failure warning */ -+#define __GFP_REPEAT ((gfp_t)0x400u) /* Retry the allocation. Might fail */ -+#define __GFP_NOFAIL ((gfp_t)0x800u) /* Retry for ever. Cannot fail */ -+#define __GFP_NORETRY ((gfp_t)0x1000u)/* Do not retry. Might fail */ -+#define __GFP_NO_GROW ((gfp_t)0x2000u)/* Slab internal usage */ -+#define __GFP_COMP ((gfp_t)0x4000u)/* Add compound page metadata */ -+#define __GFP_ZERO ((gfp_t)0x8000u)/* Return zeroed page on success */ -+#define __GFP_NOMEMALLOC ((gfp_t)0x10000u) /* Don't use emergency reserves */ -+#define __GFP_HARDWALL ((gfp_t)0x20000u) /* Enforce hardwall cpuset memory allocs */ -+ -+/* This equals 0, but use constants in case they ever change */ -+#define GFP_NOWAIT (GFP_ATOMIC & ~__GFP_HIGH) -+/* GFP_ATOMIC means both !wait (__GFP_WAIT not set) and use emergency pool */ -+#define GFP_ATOMIC (__GFP_HIGH) -+#define GFP_NOIO (__GFP_WAIT) -+#define GFP_NOFS (__GFP_WAIT | __GFP_IO) -+#define GFP_KERNEL (__GFP_WAIT | __GFP_IO | __GFP_FS) -+#define GFP_USER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL) -+#define GFP_HIGHUSER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL | \ -+ __GFP_HIGHMEM) -+ -+ -+#endif // kenny add Linux compatibility code for Linux USB -+ -+__inline static _list *get_next(_list *list) -+{ -+ return list->next; -+} -+ -+__inline static _list *get_list_head(_queue *queue) -+{ -+ return (&(queue->queue)); -+} -+ -+ -+#define LIST_CONTAINOR(ptr, type, member) \ -+ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) -+ -+ -+__inline static void _enter_critical(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_irqsave(plock, *pirqL); -+} -+ -+__inline static void _exit_critical(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_irqrestore(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_irqsave(plock, *pirqL); -+} -+ -+__inline static void _exit_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_irqrestore(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_bh(plock, *pirqL); -+} -+ -+__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_bh(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ -+ mtx_lock(pmutex); -+ -+} -+ -+ -+__inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ -+ mtx_unlock(pmutex); -+ -+} -+static inline void __list_del(struct list_head * prev, struct list_head * next) -+{ -+ next->prev = prev; -+ prev->next = next; -+} -+static inline void INIT_LIST_HEAD(struct list_head *list) -+{ -+ list->next = list; -+ list->prev = list; -+} -+__inline static void rtw_list_delete(_list *plist) -+{ -+ __list_del(plist->prev, plist->next); -+ INIT_LIST_HEAD(plist); -+} -+ -+__inline static void _init_timer(_timer *ptimer,_nic_hdl padapter,void *pfunc,void* cntx) -+{ -+ ptimer->function = pfunc; -+ ptimer->arg = cntx; -+ callout_init(&ptimer->callout, CALLOUT_MPSAFE); -+} -+ -+__inline static void _set_timer(_timer *ptimer,u32 delay_time) -+{ -+ // mod_timer(ptimer , (jiffies+(delay_time*HZ/1000))); -+ if(ptimer->function && ptimer->arg){ -+ rtw_mtx_lock(NULL); -+ callout_reset(&ptimer->callout, delay_time,ptimer->function, ptimer->arg); -+ rtw_mtx_unlock(NULL); -+ } -+} -+ -+__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -+{ -+ // del_timer_sync(ptimer); -+ // *bcancelled= _TRUE;//TRUE ==1; FALSE==0 -+ rtw_mtx_lock(NULL); -+ callout_drain(&ptimer->callout); -+ rtw_mtx_unlock(NULL); -+} -+ -+__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) -+{ -+ printf("%s Not implement yet! \n",__FUNCTION__); -+} -+ -+__inline static void _set_workitem(_workitem *pwork) -+{ -+ printf("%s Not implement yet! \n",__FUNCTION__); -+// schedule_work(pwork); -+} -+ -+// -+// Global Mutex: can only be used at PASSIVE level. -+// -+ -+#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+} -+ -+#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+} -+ -+#define ATOMIC_INIT(i) { (i) } -+ -+static __inline void thread_enter(char *name); -+ -+//Atomic integer operations -+typedef uint32_t ATOMIC_T ; -+ -+#define rtw_netdev_priv(netdev) (((struct ifnet *)netdev)->if_softc) -+ -+#define rtw_free_netdev(netdev) if_free((netdev)) -+ -+#define NDEV_FMT "%s" -+#define NDEV_ARG(ndev) "" -+#define ADPT_FMT "%s" -+#define ADPT_ARG(adapter) "" -+#define FUNC_NDEV_FMT "%s" -+#define FUNC_NDEV_ARG(ndev) __func__ -+#define FUNC_ADPT_FMT "%s" -+#define FUNC_ADPT_ARG(adapter) __func__ -+ -+#define STRUCT_PACKED -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_ce.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_ce.h ---- linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_ce.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,191 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __OSDEP_CE_SERVICE_H_ -+#define __OSDEP_CE_SERVICE_H_ -+ -+ -+#include -+#include -+ -+#ifdef CONFIG_SDIO_HCI -+#include "SDCardDDK.h" -+#endif -+ -+#ifdef CONFIG_USB_HCI -+#include -+#endif -+ -+typedef HANDLE _sema; -+typedef LIST_ENTRY _list; -+typedef NDIS_STATUS _OS_STATUS; -+ -+typedef NDIS_SPIN_LOCK _lock; -+ -+typedef HANDLE _rwlock; //Mutex -+ -+typedef u32 _irqL; -+ -+typedef NDIS_HANDLE _nic_hdl; -+ -+ -+typedef NDIS_MINIPORT_TIMER _timer; -+ -+struct __queue { -+ LIST_ENTRY queue; -+ _lock lock; -+}; -+ -+typedef NDIS_PACKET _pkt; -+typedef NDIS_BUFFER _buffer; -+typedef struct __queue _queue; -+ -+typedef HANDLE _thread_hdl_; -+typedef DWORD thread_return; -+typedef void* thread_context; -+typedef NDIS_WORK_ITEM _workitem; -+ -+ -+ -+#define SEMA_UPBND (0x7FFFFFFF) //8192 -+ -+__inline static _list *get_prev(_list *list) -+{ -+ return list->Blink; -+} -+ -+__inline static _list *get_next(_list *list) -+{ -+ return list->Flink; -+} -+ -+__inline static _list *get_list_head(_queue *queue) -+{ -+ return (&(queue->queue)); -+} -+ -+#define LIST_CONTAINOR(ptr, type, member) CONTAINING_RECORD(ptr, type, member) -+ -+__inline static void _enter_critical(_lock *plock, _irqL *pirqL) -+{ -+ NdisAcquireSpinLock(plock); -+} -+ -+__inline static void _exit_critical(_lock *plock, _irqL *pirqL) -+{ -+ NdisReleaseSpinLock(plock); -+} -+ -+__inline static _enter_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprAcquireSpinLock(plock); -+} -+ -+__inline static _exit_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprReleaseSpinLock(plock); -+} -+ -+ -+__inline static void _enter_hwio_critical(_rwlock *prwlock, _irqL *pirqL) -+{ -+ WaitForSingleObject(*prwlock, INFINITE ); -+ -+} -+ -+__inline static void _exit_hwio_critical(_rwlock *prwlock, _irqL *pirqL) -+{ -+ ReleaseMutex(*prwlock); -+} -+ -+__inline static void rtw_list_delete(_list *plist) -+{ -+ RemoveEntryList(plist); -+ InitializeListHead(plist); -+} -+ -+#define RTW_TIMER_HDL_ARGS IN PVOID SystemSpecific1, IN PVOID FunctionContext, IN PVOID SystemSpecific2, IN PVOID SystemSpecific3 -+ -+__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,PVOID cntx) -+{ -+ NdisMInitializeTimer(ptimer, nic_hdl, pfunc, cntx); -+} -+ -+__inline static void _set_timer(_timer *ptimer,u32 delay_time) -+{ -+ NdisMSetTimer(ptimer,delay_time); -+} -+ -+__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -+{ -+ NdisMCancelTimer(ptimer,bcancelled); -+} -+ -+__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) -+{ -+ -+ NdisInitializeWorkItem(pwork, pfunc, cntx); -+} -+ -+__inline static void _set_workitem(_workitem *pwork) -+{ -+ NdisScheduleWorkItem(pwork); -+} -+ -+#define ATOMIC_INIT(i) { (i) } -+ -+// -+// Global Mutex: can only be used at PASSIVE level. -+// -+ -+#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ while (NdisInterlockedIncrement((PULONG)&(_MutexCounter)) != 1)\ -+ { \ -+ NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ -+ NdisMSleep(10000); \ -+ } \ -+} -+ -+#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ -+} -+ -+// limitation of path length -+#define PATH_LENGTH_MAX MAX_PATH -+ -+//Atomic integer operations -+#define ATOMIC_T LONG -+ -+#define NDEV_FMT "%s" -+#define NDEV_ARG(ndev) "" -+#define ADPT_FMT "%s" -+#define ADPT_ARG(adapter) "" -+#define FUNC_NDEV_FMT "%s" -+#define FUNC_NDEV_ARG(ndev) __func__ -+#define FUNC_ADPT_FMT "%s" -+#define FUNC_ADPT_ARG(adapter) __func__ -+ -+#define STRUCT_PACKED -+ -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/osdep_service.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service.h ---- linux-4.14.18/3rdparty/rtl8723de/include/osdep_service.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,707 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __OSDEP_SERVICE_H_ -+#define __OSDEP_SERVICE_H_ -+ -+ -+#define _FAIL 0 -+#define _SUCCESS 1 -+#define RTW_RX_HANDLED 2 -+/* #define RTW_STATUS_TIMEDOUT -110 */ -+ -+#undef _TRUE -+#define _TRUE 1 -+ -+#undef _FALSE -+#define _FALSE 0 -+ -+ -+#ifdef PLATFORM_FREEBSD -+ #include -+#endif -+ -+#ifdef PLATFORM_LINUX -+ #include -+ #include -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ #include -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ #include -+#endif -+ -+#define RTW_TIMER_HDL_NAME(name) rtw_##name##_timer_hdl -+#define RTW_DECLARE_TIMER_HDL(name) void RTW_TIMER_HDL_NAME(name)(RTW_TIMER_HDL_ARGS) -+ -+/* #include */ -+ -+#ifndef BIT -+ #define BIT(x) (1 << (x)) -+#endif -+ -+#define BIT0 0x00000001 -+#define BIT1 0x00000002 -+#define BIT2 0x00000004 -+#define BIT3 0x00000008 -+#define BIT4 0x00000010 -+#define BIT5 0x00000020 -+#define BIT6 0x00000040 -+#define BIT7 0x00000080 -+#define BIT8 0x00000100 -+#define BIT9 0x00000200 -+#define BIT10 0x00000400 -+#define BIT11 0x00000800 -+#define BIT12 0x00001000 -+#define BIT13 0x00002000 -+#define BIT14 0x00004000 -+#define BIT15 0x00008000 -+#define BIT16 0x00010000 -+#define BIT17 0x00020000 -+#define BIT18 0x00040000 -+#define BIT19 0x00080000 -+#define BIT20 0x00100000 -+#define BIT21 0x00200000 -+#define BIT22 0x00400000 -+#define BIT23 0x00800000 -+#define BIT24 0x01000000 -+#define BIT25 0x02000000 -+#define BIT26 0x04000000 -+#define BIT27 0x08000000 -+#define BIT28 0x10000000 -+#define BIT29 0x20000000 -+#define BIT30 0x40000000 -+#define BIT31 0x80000000 -+#define BIT32 0x0100000000 -+#define BIT33 0x0200000000 -+#define BIT34 0x0400000000 -+#define BIT35 0x0800000000 -+#define BIT36 0x1000000000 -+ -+extern int RTW_STATUS_CODE(int error_code); -+ -+#ifndef RTK_DMP_PLATFORM -+ #define CONFIG_USE_VMALLOC -+#endif -+ -+/* flags used for rtw_mstat_update() */ -+enum mstat_f { -+ /* type: 0x00ff */ -+ MSTAT_TYPE_VIR = 0x00, -+ MSTAT_TYPE_PHY = 0x01, -+ MSTAT_TYPE_SKB = 0x02, -+ MSTAT_TYPE_USB = 0x03, -+ MSTAT_TYPE_MAX = 0x04, -+ -+ /* func: 0xff00 */ -+ MSTAT_FUNC_UNSPECIFIED = 0x00 << 8, -+ MSTAT_FUNC_IO = 0x01 << 8, -+ MSTAT_FUNC_TX_IO = 0x02 << 8, -+ MSTAT_FUNC_RX_IO = 0x03 << 8, -+ MSTAT_FUNC_TX = 0x04 << 8, -+ MSTAT_FUNC_RX = 0x05 << 8, -+ MSTAT_FUNC_CFG_VENDOR = 0x06 << 8, -+ MSTAT_FUNC_MAX = 0x07 << 8, -+}; -+ -+#define mstat_tf_idx(flags) ((flags) & 0xff) -+#define mstat_ff_idx(flags) (((flags) & 0xff00) >> 8) -+ -+typedef enum mstat_status { -+ MSTAT_ALLOC_SUCCESS = 0, -+ MSTAT_ALLOC_FAIL, -+ MSTAT_FREE -+} MSTAT_STATUS; -+ -+#ifdef DBG_MEM_ALLOC -+void rtw_mstat_update(const enum mstat_f flags, const MSTAT_STATUS status, u32 sz); -+void rtw_mstat_dump(void *sel); -+u8 *dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -+u8 *dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -+void dbg_rtw_vmfree(u8 *pbuf, const enum mstat_f flags, u32 sz, const char *func, const int line); -+u8 *dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -+u8 *dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -+void dbg_rtw_mfree(u8 *pbuf, const enum mstat_f flags, u32 sz, const char *func, const int line); -+ -+struct sk_buff *dbg_rtw_skb_alloc(unsigned int size, const enum mstat_f flags, const char *func, const int line); -+void dbg_rtw_skb_free(struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line); -+struct sk_buff *dbg_rtw_skb_copy(const struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line); -+struct sk_buff *dbg_rtw_skb_clone(struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line); -+int dbg_rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line); -+#ifdef CONFIG_RTW_NAPI -+int dbg_rtw_netif_receive_skb(_nic_hdl ndev, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line); -+#ifdef CONFIG_RTW_GRO -+gro_result_t dbg_rtw_napi_gro_receive(struct napi_struct *napi, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line); -+#endif -+#endif /* CONFIG_RTW_NAPI */ -+void dbg_rtw_skb_queue_purge(struct sk_buff_head *list, enum mstat_f flags, const char *func, int line); -+#ifdef CONFIG_USB_HCI -+void *dbg_rtw_usb_buffer_alloc(struct usb_device *dev, size_t size, dma_addr_t *dma, const enum mstat_f flags, const char *func, const int line); -+void dbg_rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_addr_t dma, const enum mstat_f flags, const char *func, const int line); -+#endif /* CONFIG_USB_HCI */ -+ -+#ifdef CONFIG_USE_VMALLOC -+#define rtw_vmalloc(sz) dbg_rtw_vmalloc((sz), MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) -+#define rtw_zvmalloc(sz) dbg_rtw_zvmalloc((sz), MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) -+#define rtw_vmfree(pbuf, sz) dbg_rtw_vmfree((pbuf), (sz), MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) -+#define rtw_vmalloc_f(sz, mstat_f) dbg_rtw_vmalloc((sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) -+#define rtw_zvmalloc_f(sz, mstat_f) dbg_rtw_zvmalloc((sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) -+#define rtw_vmfree_f(pbuf, sz, mstat_f) dbg_rtw_vmfree((pbuf), (sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_VIR, __FUNCTION__, __LINE__) -+#else /* CONFIG_USE_VMALLOC */ -+#define rtw_vmalloc(sz) dbg_rtw_malloc((sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_zvmalloc(sz) dbg_rtw_zmalloc((sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_vmfree(pbuf, sz) dbg_rtw_mfree((pbuf), (sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_vmalloc_f(sz, mstat_f) dbg_rtw_malloc((sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_zvmalloc_f(sz, mstat_f) dbg_rtw_zmalloc((sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_vmfree_f(pbuf, sz, mstat_f) dbg_rtw_mfree((pbuf), (sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#endif /* CONFIG_USE_VMALLOC */ -+#define rtw_malloc(sz) dbg_rtw_malloc((sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_zmalloc(sz) dbg_rtw_zmalloc((sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_mfree(pbuf, sz) dbg_rtw_mfree((pbuf), (sz), MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_malloc_f(sz, mstat_f) dbg_rtw_malloc((sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_zmalloc_f(sz, mstat_f) dbg_rtw_zmalloc((sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+#define rtw_mfree_f(pbuf, sz, mstat_f) dbg_rtw_mfree((pbuf), (sz), ((mstat_f) & 0xff00) | MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) -+ -+#define rtw_skb_alloc(size) dbg_rtw_skb_alloc((size), MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_free(skb) dbg_rtw_skb_free((skb), MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_alloc_f(size, mstat_f) dbg_rtw_skb_alloc((size), ((mstat_f) & 0xff00) | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_free_f(skb, mstat_f) dbg_rtw_skb_free((skb), ((mstat_f) & 0xff00) | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_copy(skb) dbg_rtw_skb_copy((skb), MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_clone(skb) dbg_rtw_skb_clone((skb), MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_copy_f(skb, mstat_f) dbg_rtw_skb_copy((skb), ((mstat_f) & 0xff00) | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_skb_clone_f(skb, mstat_f) dbg_rtw_skb_clone((skb), ((mstat_f) & 0xff00) | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#define rtw_netif_rx(ndev, skb) dbg_rtw_netif_rx(ndev, skb, MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#ifdef CONFIG_RTW_NAPI -+#define rtw_netif_receive_skb(ndev, skb) dbg_rtw_netif_receive_skb(ndev, skb, MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#ifdef CONFIG_RTW_GRO -+#define rtw_napi_gro_receive(napi, skb) dbg_rtw_napi_gro_receive(napi, skb, MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#endif -+#endif /* CONFIG_RTW_NAPI */ -+#define rtw_skb_queue_purge(sk_buff_head) dbg_rtw_skb_queue_purge(sk_buff_head, MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#ifdef CONFIG_USB_HCI -+#define rtw_usb_buffer_alloc(dev, size, dma) dbg_rtw_usb_buffer_alloc((dev), (size), (dma), MSTAT_TYPE_USB, __FUNCTION__, __LINE__) -+#define rtw_usb_buffer_free(dev, size, addr, dma) dbg_rtw_usb_buffer_free((dev), (size), (addr), (dma), MSTAT_TYPE_USB, __FUNCTION__, __LINE__) -+#define rtw_usb_buffer_alloc_f(dev, size, dma, mstat_f) dbg_rtw_usb_buffer_alloc((dev), (size), (dma), ((mstat_f) & 0xff00) | MSTAT_TYPE_USB, __FUNCTION__, __LINE__) -+#define rtw_usb_buffer_free_f(dev, size, addr, dma, mstat_f) dbg_rtw_usb_buffer_free((dev), (size), (addr), (dma), ((mstat_f) & 0xff00) | MSTAT_TYPE_USB, __FUNCTION__, __LINE__) -+#endif /* CONFIG_USB_HCI */ -+ -+#else /* DBG_MEM_ALLOC */ -+#define rtw_mstat_update(flag, status, sz) do {} while (0) -+#define rtw_mstat_dump(sel) do {} while (0) -+u8 *_rtw_vmalloc(u32 sz); -+u8 *_rtw_zvmalloc(u32 sz); -+void _rtw_vmfree(u8 *pbuf, u32 sz); -+u8 *_rtw_zmalloc(u32 sz); -+u8 *_rtw_malloc(u32 sz); -+void _rtw_mfree(u8 *pbuf, u32 sz); -+ -+struct sk_buff *_rtw_skb_alloc(u32 sz); -+void _rtw_skb_free(struct sk_buff *skb); -+struct sk_buff *_rtw_skb_copy(const struct sk_buff *skb); -+struct sk_buff *_rtw_skb_clone(struct sk_buff *skb); -+int _rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb); -+#ifdef CONFIG_RTW_NAPI -+int _rtw_netif_receive_skb(_nic_hdl ndev, struct sk_buff *skb); -+#ifdef CONFIG_RTW_GRO -+gro_result_t _rtw_napi_gro_receive(struct napi_struct *napi, struct sk_buff *skb); -+#endif -+#endif /* CONFIG_RTW_NAPI */ -+void _rtw_skb_queue_purge(struct sk_buff_head *list); -+ -+#ifdef CONFIG_USB_HCI -+void *_rtw_usb_buffer_alloc(struct usb_device *dev, size_t size, dma_addr_t *dma); -+void _rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_addr_t dma); -+#endif /* CONFIG_USB_HCI */ -+ -+#ifdef CONFIG_USE_VMALLOC -+#define rtw_vmalloc(sz) _rtw_vmalloc((sz)) -+#define rtw_zvmalloc(sz) _rtw_zvmalloc((sz)) -+#define rtw_vmfree(pbuf, sz) _rtw_vmfree((pbuf), (sz)) -+#define rtw_vmalloc_f(sz, mstat_f) _rtw_vmalloc((sz)) -+#define rtw_zvmalloc_f(sz, mstat_f) _rtw_zvmalloc((sz)) -+#define rtw_vmfree_f(pbuf, sz, mstat_f) _rtw_vmfree((pbuf), (sz)) -+#else /* CONFIG_USE_VMALLOC */ -+#define rtw_vmalloc(sz) _rtw_malloc((sz)) -+#define rtw_zvmalloc(sz) _rtw_zmalloc((sz)) -+#define rtw_vmfree(pbuf, sz) _rtw_mfree((pbuf), (sz)) -+#define rtw_vmalloc_f(sz, mstat_f) _rtw_malloc((sz)) -+#define rtw_zvmalloc_f(sz, mstat_f) _rtw_zmalloc((sz)) -+#define rtw_vmfree_f(pbuf, sz, mstat_f) _rtw_mfree((pbuf), (sz)) -+#endif /* CONFIG_USE_VMALLOC */ -+#define rtw_malloc(sz) _rtw_malloc((sz)) -+#define rtw_zmalloc(sz) _rtw_zmalloc((sz)) -+#define rtw_mfree(pbuf, sz) _rtw_mfree((pbuf), (sz)) -+#define rtw_malloc_f(sz, mstat_f) _rtw_malloc((sz)) -+#define rtw_zmalloc_f(sz, mstat_f) _rtw_zmalloc((sz)) -+#define rtw_mfree_f(pbuf, sz, mstat_f) _rtw_mfree((pbuf), (sz)) -+ -+#define rtw_skb_alloc(size) _rtw_skb_alloc((size)) -+#define rtw_skb_free(skb) _rtw_skb_free((skb)) -+#define rtw_skb_alloc_f(size, mstat_f) _rtw_skb_alloc((size)) -+#define rtw_skb_free_f(skb, mstat_f) _rtw_skb_free((skb)) -+#define rtw_skb_copy(skb) _rtw_skb_copy((skb)) -+#define rtw_skb_clone(skb) _rtw_skb_clone((skb)) -+#define rtw_skb_copy_f(skb, mstat_f) _rtw_skb_copy((skb)) -+#define rtw_skb_clone_f(skb, mstat_f) _rtw_skb_clone((skb)) -+#define rtw_netif_rx(ndev, skb) _rtw_netif_rx(ndev, skb) -+#ifdef CONFIG_RTW_NAPI -+#define rtw_netif_receive_skb(ndev, skb) _rtw_netif_receive_skb(ndev, skb) -+#ifdef CONFIG_RTW_GRO -+#define rtw_napi_gro_receive(napi, skb) _rtw_napi_gro_receive(napi, skb) -+#endif -+#endif /* CONFIG_RTW_NAPI */ -+#define rtw_skb_queue_purge(sk_buff_head) _rtw_skb_queue_purge(sk_buff_head) -+#ifdef CONFIG_USB_HCI -+#define rtw_usb_buffer_alloc(dev, size, dma) _rtw_usb_buffer_alloc((dev), (size), (dma)) -+#define rtw_usb_buffer_free(dev, size, addr, dma) _rtw_usb_buffer_free((dev), (size), (addr), (dma)) -+#define rtw_usb_buffer_alloc_f(dev, size, dma, mstat_f) _rtw_usb_buffer_alloc((dev), (size), (dma)) -+#define rtw_usb_buffer_free_f(dev, size, addr, dma, mstat_f) _rtw_usb_buffer_free((dev), (size), (addr), (dma)) -+#endif /* CONFIG_USB_HCI */ -+#endif /* DBG_MEM_ALLOC */ -+ -+extern void *rtw_malloc2d(int h, int w, size_t size); -+extern void rtw_mfree2d(void *pbuf, int h, int w, int size); -+ -+extern void _rtw_memcpy(void *dec, const void *sour, u32 sz); -+extern void _rtw_memmove(void *dst, const void *src, u32 sz); -+extern int _rtw_memcmp(const void *dst, const void *src, u32 sz); -+extern void _rtw_memset(void *pbuf, int c, u32 sz); -+ -+extern void _rtw_init_listhead(_list *list); -+extern u32 rtw_is_list_empty(_list *phead); -+extern void rtw_list_insert_head(_list *plist, _list *phead); -+extern void rtw_list_insert_tail(_list *plist, _list *phead); -+#ifndef PLATFORM_FREEBSD -+extern void rtw_list_delete(_list *plist); -+#endif /* PLATFORM_FREEBSD */ -+ -+extern void _rtw_init_sema(_sema *sema, int init_val); -+extern void _rtw_free_sema(_sema *sema); -+extern void _rtw_up_sema(_sema *sema); -+extern u32 _rtw_down_sema(_sema *sema); -+extern void _rtw_mutex_init(_mutex *pmutex); -+extern void _rtw_mutex_free(_mutex *pmutex); -+#ifndef PLATFORM_FREEBSD -+extern void _rtw_spinlock_init(_lock *plock); -+#endif /* PLATFORM_FREEBSD */ -+extern void _rtw_spinlock_free(_lock *plock); -+extern void _rtw_spinlock(_lock *plock); -+extern void _rtw_spinunlock(_lock *plock); -+extern void _rtw_spinlock_ex(_lock *plock); -+extern void _rtw_spinunlock_ex(_lock *plock); -+ -+extern void _rtw_init_queue(_queue *pqueue); -+extern void _rtw_deinit_queue(_queue *pqueue); -+extern u32 _rtw_queue_empty(_queue *pqueue); -+extern u32 rtw_end_of_queue_search(_list *queue, _list *pelement); -+ -+extern u32 rtw_get_current_time(void); -+extern u32 rtw_systime_to_ms(u32 systime); -+extern u32 rtw_ms_to_systime(u32 ms); -+extern s32 rtw_get_passing_time_ms(u32 start); -+extern s32 rtw_get_time_interval_ms(u32 start, u32 end); -+ -+extern void rtw_sleep_schedulable(int ms); -+ -+extern void rtw_msleep_os(int ms); -+extern void rtw_usleep_os(int us); -+ -+extern u32 rtw_atoi(u8 *s); -+ -+#ifdef DBG_DELAY_OS -+#define rtw_mdelay_os(ms) _rtw_mdelay_os((ms), __FUNCTION__, __LINE__) -+#define rtw_udelay_os(ms) _rtw_udelay_os((ms), __FUNCTION__, __LINE__) -+extern void _rtw_mdelay_os(int ms, const char *func, const int line); -+extern void _rtw_udelay_os(int us, const char *func, const int line); -+#else -+extern void rtw_mdelay_os(int ms); -+extern void rtw_udelay_os(int us); -+#endif -+ -+extern void rtw_yield_os(void); -+ -+ -+extern void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc); -+ -+ -+__inline static unsigned char _cancel_timer_ex(_timer *ptimer) -+{ -+#ifdef PLATFORM_LINUX -+ return del_timer_sync(ptimer); -+#endif -+#ifdef PLATFORM_FREEBSD -+ _cancel_timer(ptimer, 0); -+ return 0; -+#endif -+#ifdef PLATFORM_WINDOWS -+ u8 bcancelled; -+ -+ _cancel_timer(ptimer, &bcancelled); -+ -+ return bcancelled; -+#endif -+} -+ -+static __inline void thread_enter(char *name) -+{ -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+ daemonize("%s", name); -+#endif -+ allow_signal(SIGTERM); -+#endif -+#ifdef PLATFORM_FREEBSD -+ printf("%s", "RTKTHREAD_enter"); -+#endif -+} -+void thread_exit(_completion *comp); -+void _rtw_init_completion(_completion *comp); -+void _rtw_wait_for_comp_timeout(_completion *comp); -+void _rtw_wait_for_comp(_completion *comp); -+#if 1 -+#define rtw_wait_for_thread_stop(_comp) _rtw_wait_for_comp_timeout(_comp) -+#else -+#define rtw_wait_for_thread_stop(_comp) _rtw_wait_for_comp(_comp) -+#endif -+ -+bool rtw_thread_stop(_thread_hdl_ th); -+bool rtw_thread_should_stop(void); -+ -+__inline static void flush_signals_thread(void) -+{ -+#ifdef PLATFORM_LINUX -+ if (signal_pending(current)) -+ flush_signals(current); -+#endif -+} -+ -+__inline static _OS_STATUS res_to_status(sint res) -+{ -+ -+#if defined(PLATFORM_LINUX) || defined (PLATFORM_MPIXEL) || defined (PLATFORM_FREEBSD) -+ return res; -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+ if (res == _SUCCESS) -+ return NDIS_STATUS_SUCCESS; -+ else -+ return NDIS_STATUS_FAILURE; -+ -+#endif -+ -+} -+ -+__inline static void rtw_dump_stack(void) -+{ -+#ifdef PLATFORM_LINUX -+ dump_stack(); -+#endif -+} -+ -+#ifdef PLATFORM_LINUX -+#define rtw_warn_on(condition) WARN_ON(condition) -+#else -+#define rtw_warn_on(condition) do {} while (0) -+#endif -+ -+__inline static int rtw_bug_check(void *parg1, void *parg2, void *parg3, void *parg4) -+{ -+ int ret = _TRUE; -+ -+#ifdef PLATFORM_WINDOWS -+ if (((uint)parg1) <= 0x7fffffff || -+ ((uint)parg2) <= 0x7fffffff || -+ ((uint)parg3) <= 0x7fffffff || -+ ((uint)parg4) <= 0x7fffffff) { -+ ret = _FALSE; -+ KeBugCheckEx(0x87110000, (ULONG_PTR)parg1, (ULONG_PTR)parg2, (ULONG_PTR)parg3, (ULONG_PTR)parg4); -+ } -+#endif -+ -+ return ret; -+ -+} -+ -+#define _RND(sz, r) ((((sz)+((r)-1))/(r))*(r)) -+#define RND4(x) (((x >> 2) + (((x & 3) == 0) ? 0 : 1)) << 2) -+ -+__inline static u32 _RND4(u32 sz) -+{ -+ -+ u32 val; -+ -+ val = ((sz >> 2) + ((sz & 3) ? 1 : 0)) << 2; -+ -+ return val; -+ -+} -+ -+__inline static u32 _RND8(u32 sz) -+{ -+ -+ u32 val; -+ -+ val = ((sz >> 3) + ((sz & 7) ? 1 : 0)) << 3; -+ -+ return val; -+ -+} -+ -+__inline static u32 _RND128(u32 sz) -+{ -+ -+ u32 val; -+ -+ val = ((sz >> 7) + ((sz & 127) ? 1 : 0)) << 7; -+ -+ return val; -+ -+} -+ -+__inline static u32 _RND256(u32 sz) -+{ -+ -+ u32 val; -+ -+ val = ((sz >> 8) + ((sz & 255) ? 1 : 0)) << 8; -+ -+ return val; -+ -+} -+ -+__inline static u32 _RND512(u32 sz) -+{ -+ -+ u32 val; -+ -+ val = ((sz >> 9) + ((sz & 511) ? 1 : 0)) << 9; -+ -+ return val; -+ -+} -+ -+__inline static u32 bitshift(u32 bitmask) -+{ -+ u32 i; -+ -+ for (i = 0; i <= 31; i++) -+ if (((bitmask >> i) & 0x1) == 1) -+ break; -+ -+ return i; -+} -+ -+static inline int largest_bit(u32 bitmask) -+{ -+ int i; -+ -+ for (i = 31; i >= 0; i--) -+ if (bitmask & BIT(i)) -+ break; -+ -+ return i; -+} -+ -+#define rtw_min(a, b) ((a > b) ? b : a) -+#define rtw_is_range_a_in_b(hi_a, lo_a, hi_b, lo_b) (((hi_a) <= (hi_b)) && ((lo_a) >= (lo_b))) -+#define rtw_is_range_overlap(hi_a, lo_a, hi_b, lo_b) (((hi_a) > (lo_b)) && ((lo_a) < (hi_b))) -+ -+#ifndef MAC_FMT -+#define MAC_FMT "%02x:%02x:%02x:%02x:%02x:%02x" -+#endif -+#ifndef MAC_ARG -+#define MAC_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5] -+#endif -+ -+ -+extern void rtw_suspend_lock_init(void); -+extern void rtw_suspend_lock_uninit(void); -+extern void rtw_lock_suspend(void); -+extern void rtw_unlock_suspend(void); -+extern void rtw_lock_suspend_timeout(u32 timeout_ms); -+extern void rtw_lock_ext_suspend_timeout(u32 timeout_ms); -+extern void rtw_lock_rx_suspend_timeout(u32 timeout_ms); -+extern void rtw_lock_traffic_suspend_timeout(u32 timeout_ms); -+extern void rtw_lock_resume_scan_timeout(u32 timeout_ms); -+extern void rtw_resume_lock_suspend(void); -+extern void rtw_resume_unlock_suspend(void); -+#ifdef CONFIG_AP_WOWLAN -+extern void rtw_softap_lock_suspend(void); -+extern void rtw_softap_unlock_suspend(void); -+#endif -+ -+extern void ATOMIC_SET(ATOMIC_T *v, int i); -+extern int ATOMIC_READ(ATOMIC_T *v); -+extern void ATOMIC_ADD(ATOMIC_T *v, int i); -+extern void ATOMIC_SUB(ATOMIC_T *v, int i); -+extern void ATOMIC_INC(ATOMIC_T *v); -+extern void ATOMIC_DEC(ATOMIC_T *v); -+extern int ATOMIC_ADD_RETURN(ATOMIC_T *v, int i); -+extern int ATOMIC_SUB_RETURN(ATOMIC_T *v, int i); -+extern int ATOMIC_INC_RETURN(ATOMIC_T *v); -+extern int ATOMIC_DEC_RETURN(ATOMIC_T *v); -+ -+/* File operation APIs, just for linux now */ -+extern int rtw_is_file_readable(const char *path); -+extern int rtw_is_file_readable_with_size(const char *path, u32 *sz); -+extern int rtw_retrieve_from_file(const char *path, u8 *buf, u32 sz); -+extern int rtw_store_to_file(const char *path, u8 *buf, u32 sz); -+ -+ -+#ifndef PLATFORM_FREEBSD -+extern void rtw_free_netdev(struct net_device *netdev); -+#endif /* PLATFORM_FREEBSD */ -+ -+ -+extern u64 rtw_modular64(u64 x, u64 y); -+extern u64 rtw_division64(u64 x, u64 y); -+extern u32 rtw_random32(void); -+ -+/* Macros for handling unaligned memory accesses */ -+ -+#define RTW_GET_BE16(a) ((u16) (((a)[0] << 8) | (a)[1])) -+#define RTW_PUT_BE16(a, val) \ -+ do { \ -+ (a)[0] = ((u16) (val)) >> 8; \ -+ (a)[1] = ((u16) (val)) & 0xff; \ -+ } while (0) -+ -+#define RTW_GET_LE16(a) ((u16) (((a)[1] << 8) | (a)[0])) -+#define RTW_PUT_LE16(a, val) \ -+ do { \ -+ (a)[1] = ((u16) (val)) >> 8; \ -+ (a)[0] = ((u16) (val)) & 0xff; \ -+ } while (0) -+ -+#define RTW_GET_BE24(a) ((((u32) (a)[0]) << 16) | (((u32) (a)[1]) << 8) | \ -+ ((u32) (a)[2])) -+#define RTW_PUT_BE24(a, val) \ -+ do { \ -+ (a)[0] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[2] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define RTW_GET_BE32(a) ((((u32) (a)[0]) << 24) | (((u32) (a)[1]) << 16) | \ -+ (((u32) (a)[2]) << 8) | ((u32) (a)[3])) -+#define RTW_PUT_BE32(a, val) \ -+ do { \ -+ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[3] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define RTW_GET_LE32(a) ((((u32) (a)[3]) << 24) | (((u32) (a)[2]) << 16) | \ -+ (((u32) (a)[1]) << 8) | ((u32) (a)[0])) -+#define RTW_PUT_LE32(a, val) \ -+ do { \ -+ (a)[3] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[0] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define RTW_GET_BE64(a) ((((u64) (a)[0]) << 56) | (((u64) (a)[1]) << 48) | \ -+ (((u64) (a)[2]) << 40) | (((u64) (a)[3]) << 32) | \ -+ (((u64) (a)[4]) << 24) | (((u64) (a)[5]) << 16) | \ -+ (((u64) (a)[6]) << 8) | ((u64) (a)[7])) -+#define RTW_PUT_BE64(a, val) \ -+ do { \ -+ (a)[0] = (u8) (((u64) (val)) >> 56); \ -+ (a)[1] = (u8) (((u64) (val)) >> 48); \ -+ (a)[2] = (u8) (((u64) (val)) >> 40); \ -+ (a)[3] = (u8) (((u64) (val)) >> 32); \ -+ (a)[4] = (u8) (((u64) (val)) >> 24); \ -+ (a)[5] = (u8) (((u64) (val)) >> 16); \ -+ (a)[6] = (u8) (((u64) (val)) >> 8); \ -+ (a)[7] = (u8) (((u64) (val)) & 0xff); \ -+ } while (0) -+ -+#define RTW_GET_LE64(a) ((((u64) (a)[7]) << 56) | (((u64) (a)[6]) << 48) | \ -+ (((u64) (a)[5]) << 40) | (((u64) (a)[4]) << 32) | \ -+ (((u64) (a)[3]) << 24) | (((u64) (a)[2]) << 16) | \ -+ (((u64) (a)[1]) << 8) | ((u64) (a)[0])) -+ -+void rtw_buf_free(u8 **buf, u32 *buf_len); -+void rtw_buf_update(u8 **buf, u32 *buf_len, u8 *src, u32 src_len); -+ -+struct rtw_cbuf { -+ u32 write; -+ u32 read; -+ u32 size; -+ void *bufs[0]; -+}; -+ -+bool rtw_cbuf_full(struct rtw_cbuf *cbuf); -+bool rtw_cbuf_empty(struct rtw_cbuf *cbuf); -+bool rtw_cbuf_push(struct rtw_cbuf *cbuf, void *buf); -+void *rtw_cbuf_pop(struct rtw_cbuf *cbuf); -+struct rtw_cbuf *rtw_cbuf_alloc(u32 size); -+void rtw_cbuf_free(struct rtw_cbuf *cbuf); -+ -+struct map_seg_t { -+ u16 sa; -+ u16 len; -+ u8 *c; -+}; -+ -+struct map_t { -+ u16 len; -+ u16 seg_num; -+ u8 init_value; -+ struct map_seg_t *segs; -+}; -+ -+#define MAPSEG_ARRAY_ENT(_sa, _len, _c, arg...) \ -+ { .sa = _sa, .len = _len, .c = (u8[_len]){ _c, ##arg}, } -+ -+#define MAPSEG_PTR_ENT(_sa, _len, _p) \ -+ { .sa = _sa, .len = _len, .c = _p, } -+ -+#define MAP_ENT(_len, _seg_num, _init_v, _seg, arg...) \ -+ { .len = _len, .seg_num = _seg_num, .init_value = _init_v, .segs = (struct map_seg_t[_seg_num]){ _seg, ##arg}, } -+ -+int map_readN(const struct map_t *map, u16 offset, u16 len, u8 *buf); -+u8 map_read8(const struct map_t *map, u16 offset); -+ -+/* String handler */ -+ -+BOOLEAN is_null(char c); -+BOOLEAN is_eol(char c); -+BOOLEAN is_space(char c); -+BOOLEAN IsHexDigit(char chTmp); -+BOOLEAN is_alpha(char chTmp); -+char alpha_to_upper(char c); -+ -+/* -+ * Write formatted output to sized buffer -+ */ -+#ifdef PLATFORM_LINUX -+#define rtw_sprintf(buf, size, format, arg...) snprintf(buf, size, format, ##arg) -+#else /* !PLATFORM_LINUX */ -+#error "NOT DEFINE \"rtw_sprintf\"!!" -+#endif /* !PLATFORM_LINUX */ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_linux.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_linux.h ---- linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_linux.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,443 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __OSDEP_LINUX_SERVICE_H_ -+#define __OSDEP_LINUX_SERVICE_H_ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 5)) -+ #include -+#endif -+/* #include */ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) -+ #include -+#else -+ #include -+#endif -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include /* for struct tasklet_struct */ -+#include -+#include -+#include -+#include -+ -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 5, 41)) -+ #include -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 7, 0)) -+ #include -+#else -+ #include -+#endif -+ -+#ifdef RTK_DMP_PLATFORM -+ #if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12)) -+ #include -+ #endif -+ #include -+#endif -+ -+#ifdef CONFIG_NET_RADIO -+ #define CONFIG_WIRELESS_EXT -+#endif -+ -+/* Monitor mode */ -+#include -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+ #include -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ /* #include */ -+ #include -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ #include -+ #include -+#endif -+ -+#ifdef CONFIG_HAS_EARLYSUSPEND -+ #include -+#endif /* CONFIG_HAS_EARLYSUSPEND */ -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ #include -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ #include -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 21)) -+ #include -+ #else -+ #include -+ #endif -+#endif -+ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ #include -+ #include -+ #include -+ #include -+ #include -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ -+#ifdef CONFIG_USB_HCI -+ typedef struct urb *PURB; -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 22)) -+ #ifdef CONFIG_USB_SUSPEND -+ #define CONFIG_AUTOSUSPEND 1 -+ #endif -+ #endif -+#endif -+ -+#if defined(CONFIG_RTW_GRO) && (!defined(CONFIG_RTW_NAPI)) -+ -+ #error "Enable NAPI before enable GRO\n" -+ -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,29) && defined(CONFIG_RTW_NAPI)) -+ -+ #error "Linux Kernel version too old (should newer than 2.6.29)\n" -+ -+#endif -+ -+ -+typedef struct semaphore _sema; -+typedef spinlock_t _lock; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) -+ typedef struct mutex _mutex; -+#else -+ typedef struct semaphore _mutex; -+#endif -+typedef struct timer_list _timer; -+typedef struct completion _completion; -+ -+struct __queue { -+ struct list_head queue; -+ _lock lock; -+}; -+ -+typedef struct sk_buff _pkt; -+typedef unsigned char _buffer; -+ -+typedef struct __queue _queue; -+typedef struct list_head _list; -+typedef int _OS_STATUS; -+/* typedef u32 _irqL; */ -+typedef unsigned long _irqL; -+typedef struct net_device *_nic_hdl; -+ -+typedef void *_thread_hdl_; -+typedef int thread_return; -+typedef void *thread_context; -+ -+typedef void timer_hdl_return; -+typedef void *timer_hdl_context; -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 5, 41)) -+ typedef struct work_struct _workitem; -+#else -+ typedef struct tq_struct _workitem; -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) -+ #define DMA_BIT_MASK(n) (((n) == 64) ? ~0ULL : ((1ULL<<(n))-1)) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 22)) -+/* Porting from linux kernel, for compatible with old kernel. */ -+static inline unsigned char *skb_tail_pointer(const struct sk_buff *skb) -+{ -+ return skb->tail; -+} -+ -+static inline void skb_reset_tail_pointer(struct sk_buff *skb) -+{ -+ skb->tail = skb->data; -+} -+ -+static inline void skb_set_tail_pointer(struct sk_buff *skb, const int offset) -+{ -+ skb->tail = skb->data + offset; -+} -+ -+static inline unsigned char *skb_end_pointer(const struct sk_buff *skb) -+{ -+ return skb->end; -+} -+#endif -+ -+__inline static _list *get_next(_list *list) -+{ -+ return list->next; -+} -+ -+__inline static _list *get_list_head(_queue *queue) -+{ -+ return &(queue->queue); -+} -+ -+ -+#define LIST_CONTAINOR(ptr, type, member) \ -+ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) -+ -+ -+__inline static void _enter_critical(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_irqsave(plock, *pirqL); -+} -+ -+__inline static void _exit_critical(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_irqrestore(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_irqsave(plock, *pirqL); -+} -+ -+__inline static void _exit_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_irqrestore(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_bh(plock); -+} -+ -+__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_bh(plock); -+} -+ -+__inline static int _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ int ret = 0; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) -+ /* mutex_lock(pmutex); */ -+ ret = mutex_lock_interruptible(pmutex); -+#else -+ ret = down_interruptible(pmutex); -+#endif -+ return ret; -+} -+ -+ -+__inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) -+ mutex_unlock(pmutex); -+#else -+ up(pmutex); -+#endif -+} -+ -+__inline static void rtw_list_delete(_list *plist) -+{ -+ list_del_init(plist); -+} -+ -+#define RTW_TIMER_HDL_ARGS void *FunctionContext -+ -+__inline static void _init_timer(_timer *ptimer, _nic_hdl nic_hdl, void *pfunc, void *cntx) -+{ -+ /* setup_timer(ptimer, pfunc,(u32)cntx); */ -+ ptimer->function = pfunc; -+ ptimer->data = (unsigned long)cntx; -+ init_timer(ptimer); -+} -+ -+__inline static void _set_timer(_timer *ptimer, u32 delay_time) -+{ -+ mod_timer(ptimer , (jiffies + (delay_time * HZ / 1000))); -+} -+ -+__inline static void _cancel_timer(_timer *ptimer, u8 *bcancelled) -+{ -+ del_timer_sync(ptimer); -+ *bcancelled = 1; -+} -+ -+ -+static inline void _init_workitem(_workitem *pwork, void *pfunc, void *cntx) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 20)) -+ INIT_WORK(pwork, pfunc); -+#elif (LINUX_VERSION_CODE > KERNEL_VERSION(2, 5, 41)) -+ INIT_WORK(pwork, pfunc, pwork); -+#else -+ INIT_TQUEUE(pwork, pfunc, pwork); -+#endif -+} -+ -+__inline static void _set_workitem(_workitem *pwork) -+{ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 5, 41)) -+ schedule_work(pwork); -+#else -+ schedule_task(pwork); -+#endif -+} -+ -+__inline static void _cancel_workitem_sync(_workitem *pwork) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 22)) -+ cancel_work_sync(pwork); -+#elif (LINUX_VERSION_CODE > KERNEL_VERSION(2, 5, 41)) -+ flush_scheduled_work(); -+#else -+ flush_scheduled_tasks(); -+#endif -+} -+/* -+ * Global Mutex: can only be used at PASSIVE level. -+ * */ -+ -+#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -+ { \ -+ while (atomic_inc_return((atomic_t *)&(_MutexCounter)) != 1) { \ -+ atomic_dec((atomic_t *)&(_MutexCounter)); \ -+ msleep(10); \ -+ } \ -+ } -+ -+#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -+ { \ -+ atomic_dec((atomic_t *)&(_MutexCounter)); \ -+ } -+ -+static inline int rtw_netif_queue_stopped(struct net_device *pnetdev) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ return (netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 0)) && -+ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 1)) && -+ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 2)) && -+ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 3))); -+#else -+ return netif_queue_stopped(pnetdev); -+#endif -+} -+ -+static inline void rtw_netif_wake_queue(struct net_device *pnetdev) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ netif_tx_wake_all_queues(pnetdev); -+#else -+ netif_wake_queue(pnetdev); -+#endif -+} -+ -+static inline void rtw_netif_start_queue(struct net_device *pnetdev) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ netif_tx_start_all_queues(pnetdev); -+#else -+ netif_start_queue(pnetdev); -+#endif -+} -+ -+static inline void rtw_netif_stop_queue(struct net_device *pnetdev) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ netif_tx_stop_all_queues(pnetdev); -+#else -+ netif_stop_queue(pnetdev); -+#endif -+} -+static inline void rtw_netif_carrier_on(struct net_device *pnetdev) -+{ -+ netif_device_attach(pnetdev); -+ netif_carrier_on(pnetdev); -+} -+static inline int rtw_merge_string(char *dst, int dst_len, const char *src1, const char *src2) -+{ -+ int len = 0; -+ len += snprintf(dst + len, dst_len - len, "%s", src1); -+ len += snprintf(dst + len, dst_len - len, "%s", src2); -+ -+ return len; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) -+ #define rtw_signal_process(pid, sig) kill_pid(find_vpid((pid)), (sig), 1) -+#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) */ -+ #define rtw_signal_process(pid, sig) kill_proc((pid), (sig), 1) -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27)) */ -+ -+ -+/* Suspend lock prevent system from going suspend */ -+#ifdef CONFIG_WAKELOCK -+ #include -+#elif defined(CONFIG_ANDROID_POWER) -+ #include -+#endif -+ -+/* limitation of path length */ -+#define PATH_LENGTH_MAX PATH_MAX -+ -+/* Atomic integer operations */ -+#define ATOMIC_T atomic_t -+ -+#define rtw_netdev_priv(netdev) (((struct rtw_netdev_priv_indicator *)netdev_priv(netdev))->priv) -+ -+#define NDEV_FMT "%s" -+#define NDEV_ARG(ndev) ndev->name -+#define ADPT_FMT "%s" -+#define ADPT_ARG(adapter) (adapter->pnetdev ? adapter->pnetdev->name : NULL) -+#define FUNC_NDEV_FMT "%s(%s)" -+#define FUNC_NDEV_ARG(ndev) __func__, ndev->name -+#define FUNC_ADPT_FMT "%s(%s)" -+#define FUNC_ADPT_ARG(adapter) __func__, (adapter->pnetdev ? adapter->pnetdev->name : NULL) -+ -+struct rtw_netdev_priv_indicator { -+ void *priv; -+ u32 sizeof_priv; -+}; -+struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv); -+extern struct net_device *rtw_alloc_etherdev(int sizeof_priv); -+ -+#define STRUCT_PACKED __attribute__ ((packed)) -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_xp.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_xp.h ---- linux-4.14.18/3rdparty/rtl8723de/include/osdep_service_xp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/osdep_service_xp.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,201 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __OSDEP_LINUX_SERVICE_H_ -+#define __OSDEP_LINUX_SERVICE_H_ -+ -+ #include -+ #include -+ #include -+ #include -+ -+#ifdef CONFIG_USB_HCI -+ #include -+ #include -+ #include -+#endif -+ -+ typedef KSEMAPHORE _sema; -+ typedef LIST_ENTRY _list; -+ typedef NDIS_STATUS _OS_STATUS; -+ -+ -+ typedef NDIS_SPIN_LOCK _lock; -+ -+ typedef KMUTEX _mutex; -+ -+ typedef KIRQL _irqL; -+ -+ // USB_PIPE for WINCE , but handle can be use just integer under windows -+ typedef NDIS_HANDLE _nic_hdl; -+ -+ -+ typedef NDIS_MINIPORT_TIMER _timer; -+ -+ struct __queue { -+ LIST_ENTRY queue; -+ _lock lock; -+ }; -+ -+ typedef NDIS_PACKET _pkt; -+ typedef NDIS_BUFFER _buffer; -+ typedef struct __queue _queue; -+ -+ typedef PKTHREAD _thread_hdl_; -+ typedef void thread_return; -+ typedef void* thread_context; -+ -+ typedef NDIS_WORK_ITEM _workitem; -+ -+ -+ #define HZ 10000000 -+ #define SEMA_UPBND (0x7FFFFFFF) //8192 -+ -+__inline static _list *get_next(_list *list) -+{ -+ return list->Flink; -+} -+ -+__inline static _list *get_list_head(_queue *queue) -+{ -+ return (&(queue->queue)); -+} -+ -+ -+#define LIST_CONTAINOR(ptr, type, member) CONTAINING_RECORD(ptr, type, member) -+ -+ -+__inline static _enter_critical(_lock *plock, _irqL *pirqL) -+{ -+ NdisAcquireSpinLock(plock); -+} -+ -+__inline static _exit_critical(_lock *plock, _irqL *pirqL) -+{ -+ NdisReleaseSpinLock(plock); -+} -+ -+ -+__inline static _enter_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprAcquireSpinLock(plock); -+} -+ -+__inline static _exit_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprReleaseSpinLock(plock); -+} -+ -+__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprAcquireSpinLock(plock); -+} -+ -+__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprReleaseSpinLock(plock); -+} -+ -+__inline static _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ KeWaitForSingleObject(pmutex, Executive, KernelMode, FALSE, NULL); -+} -+ -+ -+__inline static _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ KeReleaseMutex(pmutex, FALSE); -+} -+ -+ -+__inline static void rtw_list_delete(_list *plist) -+{ -+ RemoveEntryList(plist); -+ InitializeListHead(plist); -+} -+ -+#define RTW_TIMER_HDL_ARGS IN PVOID SystemSpecific1, IN PVOID FunctionContext, IN PVOID SystemSpecific2, IN PVOID SystemSpecific3 -+ -+__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,PVOID cntx) -+{ -+ NdisMInitializeTimer(ptimer, nic_hdl, pfunc, cntx); -+} -+ -+__inline static void _set_timer(_timer *ptimer,u32 delay_time) -+{ -+ NdisMSetTimer(ptimer,delay_time); -+} -+ -+__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -+{ -+ NdisMCancelTimer(ptimer,bcancelled); -+} -+ -+__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) -+{ -+ -+ NdisInitializeWorkItem(pwork, pfunc, cntx); -+} -+ -+__inline static void _set_workitem(_workitem *pwork) -+{ -+ NdisScheduleWorkItem(pwork); -+} -+ -+ -+#define ATOMIC_INIT(i) { (i) } -+ -+// -+// Global Mutex: can only be used at PASSIVE level. -+// -+ -+#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ while (NdisInterlockedIncrement((PULONG)&(_MutexCounter)) != 1)\ -+ { \ -+ NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ -+ NdisMSleep(10000); \ -+ } \ -+} -+ -+#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ -+} -+ -+// limitation of path length -+#define PATH_LENGTH_MAX MAX_PATH -+ -+//Atomic integer operations -+#define ATOMIC_T LONG -+ -+ -+#define NDEV_FMT "%s" -+#define NDEV_ARG(ndev) "" -+#define ADPT_FMT "%s" -+#define ADPT_ARG(adapter) "" -+#define FUNC_NDEV_FMT "%s" -+#define FUNC_NDEV_ARG(ndev) __func__ -+#define FUNC_ADPT_FMT "%s" -+#define FUNC_ADPT_ARG(adapter) __func__ -+ -+#define STRUCT_PACKED -+ -+#endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/pci_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/pci_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/pci_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/pci_hal.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,53 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __PCI_HAL_H__ -+#define __PCI_HAL_H__ -+ -+#ifdef CONFIG_RTL8188E -+ void rtl8188ee_set_hal_ops(_adapter *padapter); -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ void rtl8812ae_set_hal_ops(_adapter *padapter); -+#endif -+ -+#if defined(CONFIG_RTL8192E) -+ void rtl8192ee_set_hal_ops(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_RTL8723B -+ void rtl8723be_set_hal_ops(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ void rtl8723de_set_hal_ops(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ void rtl8814ae_set_hal_ops(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ void rtl8822be_set_hal_ops(PADAPTER padapter); -+#endif -+ -+u8 rtw_set_hal_ops(_adapter *padapter); -+ -+#endif /* __PCIE_HAL_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/pci_ops.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/pci_ops.h ---- linux-4.14.18/3rdparty/rtl8723de/include/pci_ops.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/pci_ops.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,92 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __PCI_OPS_H_ -+#define __PCI_OPS_H_ -+ -+ -+#ifdef CONFIG_RTL8188E -+ u32 rtl8188ee_init_desc_ring(_adapter *padapter); -+ u32 rtl8188ee_free_desc_ring(_adapter *padapter); -+ void rtl8188ee_reset_desc_ring(_adapter *padapter); -+ int rtl8188ee_interrupt(PADAPTER Adapter); -+ void rtl8188ee_xmit_tasklet(void *priv); -+ void rtl8188ee_recv_tasklet(void *priv); -+ void rtl8188ee_prepare_bcn_tasklet(void *priv); -+ void rtl8188ee_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ u32 rtl8812ae_init_desc_ring(_adapter *padapter); -+ u32 rtl8812ae_free_desc_ring(_adapter *padapter); -+ void rtl8812ae_reset_desc_ring(_adapter *padapter); -+ int rtl8812ae_interrupt(PADAPTER Adapter); -+ void rtl8812ae_xmit_tasklet(void *priv); -+ void rtl8812ae_recv_tasklet(void *priv); -+ void rtl8812ae_prepare_bcn_tasklet(void *priv); -+ void rtl8812ae_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ u32 rtl8192ee_init_desc_ring(_adapter *padapter); -+ u32 rtl8192ee_free_desc_ring(_adapter *padapter); -+ void rtl8192ee_reset_desc_ring(_adapter *padapter); -+ void rtl8192ee_recv_tasklet(void *priv); -+ void rtl8192ee_prepare_bcn_tasklet(void *priv); -+ int rtl8192ee_interrupt(PADAPTER Adapter); -+ void rtl8192ee_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#ifdef CONFIG_RTL8723B -+ u32 rtl8723be_init_desc_ring(_adapter *padapter); -+ u32 rtl8723be_free_desc_ring(_adapter *padapter); -+ void rtl8723be_reset_desc_ring(_adapter *padapter); -+ int rtl8723be_interrupt(PADAPTER Adapter); -+ void rtl8723be_recv_tasklet(void *priv); -+ void rtl8723be_prepare_bcn_tasklet(void *priv); -+ void rtl8723be_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ u32 rtl8723de_init_desc_ring(_adapter *padapter); -+ u32 rtl8723de_free_desc_ring(_adapter *padapter); -+ void rtl8723de_reset_desc_ring(_adapter *padapter); -+ int rtl8723de_interrupt(PADAPTER Adapter); -+ void rtl8723de_recv_tasklet(void *priv); -+ void rtl8723de_prepare_bcn_tasklet(void *priv); -+ void rtl8723de_set_intf_ops(struct _io_ops *pops); -+ u8 check_tx_desc_resource(_adapter *padapter, int prio); -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ u32 rtl8814ae_init_desc_ring(_adapter *padapter); -+ u32 rtl8814ae_free_desc_ring(_adapter *padapter); -+ void rtl8814ae_reset_desc_ring(_adapter *padapter); -+ int rtl8814ae_interrupt(PADAPTER Adapter); -+ void rtl8814ae_xmit_tasklet(void *priv); -+ void rtl8814ae_recv_tasklet(void *priv); -+ void rtl8814ae_prepare_bcn_tasklet(void *priv); -+ void rtl8814ae_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#ifdef CONFIG_RTL8822B -+ void rtl8822be_set_intf_ops(struct _io_ops *pops); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/pci_osintf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/pci_osintf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/pci_osintf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/pci_osintf.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,42 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __PCI_OSINTF_H -+#define __PCI_OSINTF_H -+ -+#ifdef RTK_129X_PLATFORM -+#define PCIE_SLOT1_MEM_START 0x9804F000 -+#define PCIE_SLOT1_MEM_LEN 0x1000 -+#define PCIE_SLOT1_MASK 0x9804ED00 -+ -+#define PCIE_SLOT2_MEM_START 0x9803C000 -+#define PCIE_SLOT2_MEM_LEN 0x1000 -+#define PCIE_SLOT2_MASK 0x9803BD00 -+ -+#define PCIE_TRANSLATE_OFFSET 4 /* offset from MASK reg */ -+#endif -+ -+void rtw_pci_disable_aspm(_adapter *padapter); -+void rtw_pci_enable_aspm(_adapter *padapter); -+void PlatformClearPciPMEStatus(PADAPTER Adapter); -+#ifdef CONFIG_64BIT_DMA -+ u8 PlatformEnableDMA64(PADAPTER Adapter); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/recv_osdep.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/recv_osdep.h ---- linux-4.14.18/3rdparty/rtl8723de/include/recv_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/recv_osdep.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,68 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RECV_OSDEP_H_ -+#define __RECV_OSDEP_H_ -+ -+ -+extern sint _rtw_init_recv_priv(struct recv_priv *precvpriv, _adapter *padapter); -+extern void _rtw_free_recv_priv(struct recv_priv *precvpriv); -+ -+ -+extern s32 rtw_recv_entry(union recv_frame *precv_frame); -+extern int rtw_recv_indicatepkt(_adapter *adapter, union recv_frame *precv_frame); -+extern void rtw_recv_returnpacket(IN _nic_hdl cnxt, IN _pkt *preturnedpkt); -+ -+extern int rtw_recv_monitor(_adapter *padapter, union recv_frame *precv_frame); -+ -+extern void rtw_hostapd_mlme_rx(_adapter *padapter, union recv_frame *precv_frame); -+ -+struct sta_info; -+extern void rtw_handle_tkip_mic_err(_adapter *padapter, struct sta_info *sta, u8 bgroup); -+ -+ -+int rtw_os_recv_resource_init(struct recv_priv *precvpriv, _adapter *padapter); -+int rtw_os_recv_resource_alloc(_adapter *padapter, union recv_frame *precvframe); -+void rtw_os_recv_resource_free(struct recv_priv *precvpriv); -+ -+ -+int rtw_os_alloc_recvframe(_adapter *padapter, union recv_frame *precvframe, u8 *pdata, _pkt *pskb); -+int rtw_os_recvframe_duplicate_skb(_adapter *padapter, union recv_frame *pcloneframe, _pkt *pskb); -+void rtw_os_free_recvframe(union recv_frame *precvframe); -+ -+ -+int rtw_os_recvbuf_resource_alloc(_adapter *padapter, struct recv_buf *precvbuf); -+int rtw_os_recvbuf_resource_free(_adapter *padapter, struct recv_buf *precvbuf); -+ -+_pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 *pdata); -+void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, struct rx_pkt_attrib *pattrib); -+ -+void rtw_os_read_port(_adapter *padapter, struct recv_buf *precvbuf); -+ -+void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl); -+ -+#ifdef PLATFORM_LINUX -+#ifdef CONFIG_RTW_NAPI -+#include /* struct napi_struct */ -+ -+int rtw_recv_napi_poll(struct napi_struct *, int budget); -+#endif /* CONFIG_RTW_NAPI */ -+#endif /* PLATFORM_LINUX */ -+ -+#endif /* */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_cmd.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_cmd.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,179 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_CMD_H__ -+#define __RTL8188E_CMD_H__ -+ -+#if 0 -+enum cmd_msg_element_id { -+ NONE_CMDMSG_EID, -+ AP_OFFLOAD_EID = 0, -+ SET_PWRMODE_EID = 1, -+ JOINBSS_RPT_EID = 2, -+ RSVD_PAGE_EID = 3, -+ RSSI_4_EID = 4, -+ RSSI_SETTING_EID = 5, -+ MACID_CONFIG_EID = 6, -+ MACID_PS_MODE_EID = 7, -+ P2P_PS_OFFLOAD_EID = 8, -+ SELECTIVE_SUSPEND_ROF_CMD = 9, -+ P2P_PS_CTW_CMD_EID = 32, -+ MAX_CMDMSG_EID -+}; -+#else -+typedef enum _RTL8188E_H2C_CMD_ID { -+ /* Class Common */ -+ H2C_COM_RSVD_PAGE = 0x00, -+ H2C_COM_MEDIA_STATUS_RPT = 0x01, -+ H2C_COM_SCAN = 0x02, -+ H2C_COM_KEEP_ALIVE = 0x03, -+ H2C_COM_DISCNT_DECISION = 0x04, -+#ifndef CONFIG_WOWLAN -+ H2C_COM_WWLAN = 0x05, -+#endif -+ H2C_COM_INIT_OFFLOAD = 0x06, -+ H2C_COM_REMOTE_WAKE_CTL = 0x07, -+ H2C_COM_AP_OFFLOAD = 0x08, -+ H2C_COM_BCN_RSVD_PAGE = 0x09, -+ H2C_COM_PROB_RSP_RSVD_PAGE = 0x0A, -+ -+ /* Class PS */ -+ H2C_PS_PWR_MODE = 0x20, -+ H2C_PS_TUNE_PARA = 0x21, -+ H2C_PS_TUNE_PARA_2 = 0x22, -+ H2C_PS_LPS_PARA = 0x23, -+ H2C_PS_P2P_OFFLOAD = 0x24, -+ -+ /* Class DM */ -+ H2C_DM_MACID_CFG = 0x40, -+ H2C_DM_TXBF = 0x41, -+ H2C_RSSI_REPORT = 0x42, -+ /* Class BT */ -+ H2C_BT_COEX_MASK = 0x60, -+ H2C_BT_COEX_GPIO_MODE = 0x61, -+ H2C_BT_DAC_SWING_VAL = 0x62, -+ H2C_BT_PSD_RST = 0x63, -+ -+ /* Class Remote WakeUp */ -+#ifdef CONFIG_WOWLAN -+ H2C_COM_WWLAN = 0x80, -+ H2C_COM_REMOTE_WAKE_CTRL = 0x81, -+ H2C_COM_AOAC_GLOBAL_INFO = 0x82, -+ H2C_COM_AOAC_RSVD_PAGE = 0x83, -+#endif -+ -+ /* Class */ -+ /* H2C_RESET_TSF =0xc0, */ -+} RTL8188E_H2C_CMD_ID; -+ -+#endif -+ -+ -+struct cmd_msg_parm { -+ u8 eid; /* element id */ -+ u8 sz; /* sz */ -+ u8 buf[6]; -+}; -+ -+enum { -+ PWRS -+}; -+ -+typedef struct _SETPWRMODE_PARM { -+ u8 Mode;/* 0:Active,1:LPS,2:WMMPS */ -+ /* u8 RLBM:4; */ /* 0:Min,1:Max,2: User define */ -+ u8 SmartPS_RLBM;/* LPS=0:PS_Poll,1:PS_Poll,2:NullData,WMM=0:PS_Poll,1:NullData */ -+ u8 AwakeInterval; /* unit: beacon interval */ -+ u8 bAllQueueUAPSD; -+ u8 PwrState;/* AllON(0x0c),RFON(0x04),RFOFF(0x00) */ -+} SETPWRMODE_PARM, *PSETPWRMODE_PARM; -+ -+struct H2C_SS_RFOFF_PARAM { -+ u8 ROFOn; /* 1: on, 0:off */ -+ u16 gpio_period; /* unit: 1024 us */ -+} __attribute__((packed)); -+ -+ -+typedef struct JOINBSSRPT_PARM_88E { -+ u8 OpMode; /* RT_MEDIA_STATUS */ -+#ifdef CONFIG_WOWLAN -+ u8 MacID; /* MACID */ -+#endif /* CONFIG_WOWLAN */ -+} JOINBSSRPT_PARM_88E, *PJOINBSSRPT_PARM_88E; -+ -+#if 0 -+/* move to hal_com_h2c.h */ -+typedef struct _RSVDPAGE_LOC_88E { -+ u8 LocProbeRsp; -+ u8 LocPsPoll; -+ u8 LocNullData; -+ u8 LocQosNull; -+ u8 LocBTQosNull; -+#ifdef CONFIG_WOWLAN -+ u8 LocRemoteCtrlInfo; -+ u8 LocArpRsp; -+ u8 LocNbrAdv; -+ u8 LocGTKRsp; -+ u8 LocGTKInfo; -+ u8 LocProbeReq; -+ u8 LocNetList; -+#endif /* CONFIG_WOWLAN */ -+} RSVDPAGE_LOC_88E, *PRSVDPAGE_LOC_88E; -+#endif -+ -+/* host message to firmware cmd */ -+void rtl8188e_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8188e_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); -+u8 rtl8188e_set_rssi_cmd(PADAPTER padapter, u8 *param); -+u8 rtl8188e_set_raid_cmd(_adapter *padapter, u32 bitmap, u8 *arg, u8 bw); -+s32 FillH2CCmd_88E(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+/* u8 rtl8192c_set_FwSelectSuspend_cmd(PADAPTER padapter, u8 bfwpoll, u16 period); */ -+u8 GetTxBufferRsvdPageNum8188E(_adapter *padapter, bool wowlan); -+ -+ -+#ifdef CONFIG_P2P -+ void rtl8188e_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif /* CONFIG_P2P */ -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+ /* u8 rtl8188e_reset_tsf(_adapter *padapter, u8 reset_port); */ -+ int reset_tsf(PADAPTER Adapter, u8 reset_port); -+#endif /* CONFIG_TSF_RESET_OFFLOAD */ -+ -+/* #define H2C_8188E_RSVDPAGE_LOC_LEN 5 */ -+/* #define H2C_8188E_AOAC_RSVDPAGE_LOC_LEN 7 */ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- -+ * */ -+#if 0 -+ /* move to hal_com_h2c.h -+ * _RSVDPAGE_LOC_CMD_0x00 */ -+ #define SET_8188E_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+ #define SET_8188E_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+ #define SET_8188E_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+ #define SET_8188E_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+ /* AOAC_RSVDPAGE_LOC_0x83 */ -+ #define SET_8188E_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 8, __Value) -+ #define SET_8188E_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#endif -+#endif/* __RTL8188E_CMD_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_dm.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_dm.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,32 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_DM_H__ -+#define __RTL8188E_DM_H__ -+ -+void rtl8188e_init_dm_priv(IN PADAPTER Adapter); -+void rtl8188e_deinit_dm_priv(IN PADAPTER Adapter); -+void rtl8188e_InitHalDm(IN PADAPTER Adapter); -+void rtl8188e_HalDmWatchDog(IN PADAPTER Adapter); -+ -+/* VOID rtl8192c_dm_CheckTXPowerTracking(IN PADAPTER Adapter); */ -+ -+/* void rtl8192c_dm_RF_Saving(IN PADAPTER pAdapter, IN u8 bForceInNormal); */ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_hal.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,320 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_HAL_H__ -+#define __RTL8188E_HAL_H__ -+ -+/* #include "hal_com.h" */ -+#include "hal_data.h" -+ -+/* include HAL Related header after HAL Related compiling flags */ -+#include "rtl8188e_spec.h" -+#include "Hal8188EPhyReg.h" -+#include "Hal8188EPhyCfg.h" -+#include "rtl8188e_rf.h" -+#include "rtl8188e_dm.h" -+#include "rtl8188e_recv.h" -+#include "rtl8188e_xmit.h" -+#include "rtl8188e_cmd.h" -+#include "rtl8188e_led.h" -+#include "Hal8188EPwrSeq.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+ #include "rtl8188e_sreset.h" -+#endif -+ -+/* --------------------------------------------------------------------- */ -+/* RTL8188E Power Configuration CMDs for USB/SDIO/PCIE interfaces */ -+/* --------------------------------------------------------------------- */ -+#define Rtl8188E_NIC_PWR_ON_FLOW rtl8188E_power_on_flow -+#define Rtl8188E_NIC_RF_OFF_FLOW rtl8188E_radio_off_flow -+#define Rtl8188E_NIC_DISABLE_FLOW rtl8188E_card_disable_flow -+#define Rtl8188E_NIC_ENABLE_FLOW rtl8188E_card_enable_flow -+#define Rtl8188E_NIC_SUSPEND_FLOW rtl8188E_suspend_flow -+#define Rtl8188E_NIC_RESUME_FLOW rtl8188E_resume_flow -+#define Rtl8188E_NIC_PDN_FLOW rtl8188E_hwpdn_flow -+#define Rtl8188E_NIC_LPS_ENTER_FLOW rtl8188E_enter_lps_flow -+#define Rtl8188E_NIC_LPS_LEAVE_FLOW rtl8188E_leave_lps_flow -+ -+ -+#if 1 /* download firmware related data structure */ -+#define MAX_FW_8188E_SIZE 0x8000 /* 32768, 32k / 16384, 16k */ -+ -+#define FW_8188E_SIZE 0x4000 /* 16384, 16k */ -+#define FW_8188E_SIZE_2 0x8000 /* 32768, 32k */ -+ -+#define FW_8188E_START_ADDRESS 0x1000 -+#define FW_8188E_END_ADDRESS 0x1FFF /* 0x5FFF */ -+ -+ -+#define IS_FW_HEADER_EXIST_88E(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature) & 0xFFF0) == 0x88E0) -+ -+typedef struct _RT_FIRMWARE_8188E { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8 *szFwBuffer; -+#else -+ u8 szFwBuffer[MAX_FW_8188E_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8188E, *PRT_FIRMWARE_8188E; -+ -+/* -+ * This structure must be cared byte-ordering -+ * */ -+ -+typedef struct _RT_8188E_FIRMWARE_HDR { -+ /* 8-byte alinment required */ -+ -+ /* --- LONG WORD 0 ---- */ -+ u16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ -+ u8 Category; /* AP/NIC and USB/PCI */ -+ u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ -+ u16 Version; /* FW Version */ -+ u8 Subversion; /* FW Subversion, default 0x00 */ -+ u16 Rsvd1; -+ -+ -+ /* --- LONG WORD 1 ---- */ -+ u8 Month; /* Release time Month field */ -+ u8 Date; /* Release time Date field */ -+ u8 Hour; /* Release time Hour field */ -+ u8 Minute; /* Release time Minute field */ -+ u16 RamCodeSize; /* The size of RAM code */ -+ u8 Foundry; -+ u8 Rsvd2; -+ -+ /* --- LONG WORD 2 ---- */ -+ u32 SvnIdx; /* The SVN entry index */ -+ u32 Rsvd3; -+ -+ /* --- LONG WORD 3 ---- */ -+ u32 Rsvd4; -+ u32 Rsvd5; -+} RT_8188E_FIRMWARE_HDR, *PRT_8188E_FIRMWARE_HDR; -+#endif /* download firmware related data structure */ -+ -+ -+#define DRIVER_EARLY_INT_TIME_8188E 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8188E 0x02 -+ -+ -+/* #define MAX_RX_DMA_BUFFER_SIZE_88E 0x2400 */ /* 9k for 88E nornal chip , */ /* MaxRxBuff=10k-max(TxReportSize(64*8), WOLPattern(16*24)) */ -+#ifdef CONFIG_USB_HCI -+ #define RX_DMA_SIZE_88E(__Adapter) 0x2800 /* no cut difference */ -+#else -+ #define RX_DMA_SIZE_88E(__Adapter) ((!IS_VENDOR_8188E_I_CUT_SERIES(__Adapter)) ? 0x2800 : 0x4000) -+#endif -+ -+#ifdef CONFIG_WOWLAN -+ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ -+#else -+ #define RESV_FMWF 0 -+#endif -+ -+#define RX_DMA_RESERVD_FW_FEATURE 0x200 /* for tx report (64*8) */ -+ -+#define MAX_RX_DMA_BUFFER_SIZE_88E(__Adapter) (RX_DMA_SIZE_88E(__Adapter)-RX_DMA_RESERVD_FW_FEATURE) -+ -+#define MAX_TX_REPORT_BUFFER_SIZE 0x0400 /* 1k */ -+ -+/* Note: We will divide number of page equally for each queue other than public queue! -+ * 22k = 22528 bytes = 176 pages (@page = 128 bytes) -+ * must reserved about 7 pages for LPS => 176-7 = 169 (0xA9) -+ * 2*BCN / 1*ps-poll / 1*null-data /1*prob_rsp /1*QOS null-data /1*BT QOS null-data */ -+ -+#define BCNQ_PAGE_NUM_88E 0x08 -+ -+/* For WoWLan , more reserved page */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_88E 0x00 -+#else -+ #define WOWLAN_PAGE_NUM_88E 0x00 -+#endif -+ -+/* Note: -+Tx FIFO Size : previous CUT:22K /I_CUT after:32KB -+Tx page Size : 128B -+Total page numbers : 176(0xB0) / 256(0x100) -+*/ -+#ifdef CONFIG_USB_HCI -+ #define TOTAL_PAGE_NUMBER_88E(_Adapter) (0xB0 - 1) /* no cut difference */ -+#else -+ #define TOTAL_PAGE_NUMBER_88E(_Adapter) ((IS_VENDOR_8188E_I_CUT_SERIES(_Adapter) ? 0x100 : 0xB0) - 1)/* must reserved 1 page for dma issue */ -+#endif -+#define TX_TOTAL_PAGE_NUMBER_88E(_Adapter) (TOTAL_PAGE_NUMBER_88E(_Adapter) - BCNQ_PAGE_NUM_88E - WOWLAN_PAGE_NUM_88E) -+#define TX_PAGE_BOUNDARY_88E(_Adapter) (TX_TOTAL_PAGE_NUMBER_88E(_Adapter) + 1) /* beacon header start address */ -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_88E(_Adapter) TX_TOTAL_PAGE_NUMBER_88E(_Adapter) -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_88E(_Adapter) (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_88E(_Adapter) + 1) -+ -+/* For Normal Chip Setting -+ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8723B */ -+#define NORMAL_PAGE_NUM_HPQ_88E 0x0 -+#define NORMAL_PAGE_NUM_LPQ_88E 0x09 -+#define NORMAL_PAGE_NUM_NPQ_88E 0x0 -+ -+/* Note: For Normal Chip Setting, modify later */ -+#define WMM_NORMAL_PAGE_NUM_HPQ_88E 0x29 -+#define WMM_NORMAL_PAGE_NUM_LPQ_88E 0x1C -+#define WMM_NORMAL_PAGE_NUM_NPQ_88E 0x1C -+ -+ -+/* ------------------------------------------------------------------------- -+ * Chip specific -+ * ------------------------------------------------------------------------- */ -+#define CHIP_BONDING_IDENTIFIER(_value) (((_value)>>22) & 0x3) -+#define CHIP_BONDING_92C_1T2R 0x1 -+#define CHIP_BONDING_88C_USB_MCARD 0x2 -+#define CHIP_BONDING_88C_USB_HP 0x1 -+ -+/* ------------------------------------------------------------------------- -+ * Channel Plan -+ * ------------------------------------------------------------------------- */ -+ -+ -+#define EFUSE_REAL_CONTENT_LEN 512 -+#define EFUSE_MAP_LEN 128 -+#define EFUSE_MAX_SECTION 16 -+#define EFUSE_IC_ID_OFFSET 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ -+#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN) -+/* -+ * -+ * To prevent out of boundary programming case, -+ * leave 1byte and program full section -+ * 9bytes + 1byt + 5bytes and pre 1byte. -+ * For worst case: -+ * | 1byte|----8bytes----|1byte|--5bytes--| -+ * | | Reserved(14bytes) | -+ * */ -+#define EFUSE_OOB_PROTECT_BYTES 15 /* PG data exclude header, dummy 6 bytes frome CP test and reserved 1byte. */ -+ -+#define EFUSE_REAL_CONTENT_LEN_88E 256 -+#define EFUSE_MAP_LEN_88E 512 -+#define EFUSE_MAX_SECTION_88E 64 -+#define EFUSE_MAX_WORD_UNIT_88E 4 -+#define EFUSE_IC_ID_OFFSET_88E 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ -+#define AVAILABLE_EFUSE_ADDR_88E(addr) (addr < EFUSE_REAL_CONTENT_LEN_88E) -+/* To prevent out of boundary programming case, leave 1byte and program full section -+ * 9bytes + 1byt + 5bytes and pre 1byte. -+ * For worst case: -+ * | 2byte|----8bytes----|1byte|--7bytes--| */ /* 92D */ -+#define EFUSE_OOB_PROTECT_BYTES_88E 18 /* PG data exclude header, dummy 7 bytes frome CP test and reserved 1byte. */ -+#define EFUSE_PROTECT_BYTES_BANK_88E 16 -+ -+ -+/* ******************************************************** -+ * EFUSE for BT definition -+ * ******************************************************** */ -+#define EFUSE_BT_REAL_CONTENT_LEN 1536 /* 512*3 */ -+#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ -+#define EFUSE_BT_MAX_SECTION 128 /* 1024/8 */ -+ -+#define EFUSE_PROTECT_BYTES_BANK 16 -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+/* #define IS_MULTI_FUNC_CHIP(_Adapter) (((((PHAL_DATA_TYPE)(_Adapter->HalData))->MultiFunc) & (RT_MULTI_FUNC_BT|RT_MULTI_FUNC_GPS)) ? _TRUE : _FALSE) */ -+ -+/* #define RT_IS_FUNC_DISABLED(__pAdapter, __FuncBits) ( (__pAdapter)->DisabledFunctions & (__FuncBits) ) */ -+ -+#ifdef CONFIG_PCI_HCI -+ /* according to the define in the rtw_xmit.h, rtw_recv.h */ -+ #define TX_DESC_NUM_8188EE TXDESC_NUM /* 128 */ -+ #ifdef CONFIG_CONCURRENT_MODE -+ /*#define BE_QUEUE_TX_DESC_NUM_8188EE (TXDESC_NUM<<1)*/ /* 256 */ -+ #define BE_QUEUE_TX_DESC_NUM_8188EE ((TXDESC_NUM<<1)+(TXDESC_NUM>>1)) /* 320 */ -+ /*#define BE_QUEUE_TX_DESC_NUM_8188EE ((TXDESC_NUM<<1)+TXDESC_NUM)*/ /* 384 */ -+ #else -+ #define BE_QUEUE_TX_DESC_NUM_8188EE TXDESC_NUM /* 128 */ -+ /*#define BE_QUEUE_TX_DESC_NUM_8188EE (TXDESC_NUM+(TXDESC_NUM>>1)) */ /* 192 */ -+ #endif -+ -+ void InterruptRecognized8188EE(PADAPTER Adapter, PRT_ISR_CONTENT pIsrContent); -+ void UpdateInterruptMask8188EE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+#endif /* CONFIG_PCI_HCI */ -+ -+/* rtl8188e_hal_init.c */ -+ -+s32 rtl8188e_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); -+void _8051Reset88E(PADAPTER padapter); -+void rtl8188e_InitializeFirmwareVars(PADAPTER padapter); -+ -+ -+s32 InitLLTTable(PADAPTER padapter, u8 txpktbuf_bndy); -+ -+/* EFuse */ -+u8 GetEEPROMSize8188E(PADAPTER padapter); -+void Hal_InitPGData88E(PADAPTER padapter); -+void Hal_EfuseParseIDCode88E(PADAPTER padapter, u8 *hwinfo); -+void Hal_ReadTxPowerInfo88E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+ -+void Hal_EfuseParseEEPROMVer88E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void rtl8188e_EfuseParseChnlPlan(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseCustomerID88E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadAntennaDiversity88E(PADAPTER pAdapter, u8 *PROMContent, BOOLEAN AutoLoadFail); -+void Hal_ReadThermalMeter_88E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_EfuseParseXtal_8188E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseBoardType88E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadPowerSavingMode88E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadPAType_8188E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_ReadAmplifierType_8188E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_ReadRFEType_8188E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+ -+BOOLEAN HalDetectPwrDownMode88E(PADAPTER Adapter); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif /* CONFIG_WOWLAN */ -+ -+ -+#ifdef CONFIG_RF_POWER_TRIM -+ void Hal_ReadRFGainOffset(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ -+void rtl8188e_init_default_value(_adapter *adapter); -+ -+void rtl8188e_set_hal_ops(struct hal_ops *pHalFunc); -+void init_hal_spec_8188e(_adapter *adapter); -+ -+/* register */ -+void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); -+ -+void rtl8188e_start_thread(_adapter *padapter); -+void rtl8188e_stop_thread(_adapter *padapter); -+ -+void rtw_IOL_cmd_tx_pkt_buf_dump(ADAPTER *Adapter, int data_len); -+#ifdef CONFIG_IOL_EFUSE_PATCH -+ s32 rtl8188e_iol_efuse_patch(PADAPTER padapter); -+#endif/* CONFIG_IOL_EFUSE_PATCH */ -+void _InitTransferPageSize(PADAPTER padapter); -+ -+void SetHwReg8188E(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg8188E(PADAPTER padapter, u8 variable, u8 *val); -+ -+u8 -+GetHalDefVar8188E( -+ IN PADAPTER Adapter, -+ IN HAL_DEF_VARIABLE eVariable, -+ IN PVOID pValue -+); -+#ifdef CONFIG_GPIO_API -+int rtl8188e_GpioFuncCheck(PADAPTER adapter, u8 gpio_num); -+#endif -+#endif /* __RTL8188E_HAL_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_led.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_led.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,40 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_LED_H__ -+#define __RTL8188E_LED_H__ -+ -+ -+/* ******************************************************************************** -+ * Interface to manipulate LED objects. -+ * ******************************************************************************** */ -+#ifdef CONFIG_USB_HCI -+ void rtl8188eu_InitSwLeds(PADAPTER padapter); -+ void rtl8188eu_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+ void rtl8188ee_InitSwLeds(PADAPTER padapter); -+ void rtl8188ee_DeInitSwLeds(PADAPTER padapter); -+#endif -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ void rtl8188es_InitSwLeds(PADAPTER padapter); -+ void rtl8188es_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_recv.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_recv.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,170 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_RECV_H__ -+#define __RTL8188E_RECV_H__ -+ -+#define RECV_BLK_SZ 512 -+#define RECV_BLK_CNT 16 -+#define RECV_BLK_TH RECV_BLK_CNT -+ -+#if defined(CONFIG_USB_HCI) -+ -+ #ifndef MAX_RECVBUF_SZ -+ #ifdef PLATFORM_OS_CE -+ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ -+ #else -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ -+ /* #define MAX_RECVBUF_SZ (16384) */ /* 16K */ -+ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ -+ #ifdef CONFIG_PLATFORM_MSTAR -+ #define MAX_RECVBUF_SZ (8192) /* 8K */ -+ #else -+ #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ -+ #endif -+ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ -+ #else -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+ #endif -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+ -+#elif defined(CONFIG_PCI_HCI) -+ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ -+ /* #define MAX_RECVBUF_SZ (9100) */ -+ /* #else */ -+ #define MAX_RECVBUF_SZ (4000) /* about 4K -+ * #endif */ -+ -+ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ -+ #define MAX_RECVBUF_SZ (10240) -+ -+#endif -+ -+/* Rx smooth factor */ -+#define Rx_Smooth_Factor (20) -+ -+#define TX_RPT1_PKT_LEN 8 -+ -+typedef struct rxreport_8188e { -+ /* Offset 0 */ -+ u32 pktlen:14; -+ u32 crc32:1; -+ u32 icverr:1; -+ u32 drvinfosize:4; -+ u32 security:3; -+ u32 qos:1; -+ u32 shift:2; -+ u32 physt:1; -+ u32 swdec:1; -+ u32 ls:1; -+ u32 fs:1; -+ u32 eor:1; -+ u32 own:1; -+ -+ /* Offset 4 */ -+ u32 macid:5; -+ u32 tid:4; -+ u32 hwrsvd:4; -+ u32 amsdu:1; -+ u32 paggr:1; -+ u32 faggr:1; -+ u32 a1fit:4; -+ u32 a2fit:4; -+ u32 pam:1; -+ u32 pwr:1; -+ u32 md:1; -+ u32 mf:1; -+ u32 type:2; -+ u32 mc:1; -+ u32 bc:1; -+ -+ /* Offset 8 */ -+ u32 seq:12; -+ u32 frag:4; -+ u32 nextpktlen:14; -+ u32 nextind:1; -+ u32 rsvd0831:1; -+ -+ /* Offset 12 */ -+ u32 rxmcs:6; -+ u32 rxht:1; -+ u32 gf:1; -+ u32 splcp:1; -+ u32 bw:1; -+ u32 htc:1; -+ u32 eosp:1; -+ u32 bssidfit:2; -+ u32 rpt_sel:2; -+ u32 rsvd1216:13; -+ u32 pattern_match:1; -+ u32 unicastwake:1; -+ u32 magicwake:1; -+ -+ /* Offset 16 */ -+ /* -+ u32 pattern0match:1; -+ u32 pattern1match:1; -+ u32 pattern2match:1; -+ u32 pattern3match:1; -+ u32 pattern4match:1; -+ u32 pattern5match:1; -+ u32 pattern6match:1; -+ u32 pattern7match:1; -+ u32 pattern8match:1; -+ u32 pattern9match:1; -+ u32 patternamatch:1; -+ u32 patternbmatch:1; -+ u32 patterncmatch:1; -+ u32 rsvd1613:19; -+ */ -+ u32 rsvd16; -+ -+ /* Offset 20 */ -+ u32 tsfl; -+ -+ /* Offset 24 */ -+ u32 bassn:12; -+ u32 bavld:1; -+ u32 rsvd2413:19; -+} RXREPORT, *PRXREPORT; -+ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ s32 rtl8188es_init_recv_priv(PADAPTER padapter); -+ void rtl8188es_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ void rtl8188eu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+ s32 rtl8188eu_init_recv_priv(PADAPTER padapter); -+ void rtl8188eu_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8188ee_init_recv_priv(PADAPTER padapter); -+ void rtl8188ee_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8188e_query_rx_desc_status(union recv_frame *precvframe, struct recv_stat *prxstat); -+ -+#endif /* __RTL8188E_RECV_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_rf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_rf.h 2018-02-11 21:44:27.168146406 +0200 -@@ -0,0 +1,32 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_RF_H__ -+#define __RTL8188E_RF_H__ -+ -+ -+ -+int PHY_RF6052_Config8188E(IN PADAPTER Adapter); -+void rtl8188e_RF_ChangeTxPath(IN PADAPTER Adapter, -+ IN u16 DataRate); -+void rtl8188e_PHY_RF6052SetBandwidth( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+#endif/* __RTL8188E_RF_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_spec.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_spec.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,165 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8188E_SPEC_H__ -+#define __RTL8188E_SPEC_H__ -+ -+ -+/* ************************************************************ -+ * 8188E Regsiter offset definition -+ * ************************************************************ */ -+ -+ -+/* ************************************************************ -+ * -+ * ************************************************************ */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0000h ~ 0x00FFh System Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_BB_PAD_CTRL 0x0064 -+#define REG_HMEBOX_E0 0x0088 -+#define REG_HMEBOX_E1 0x008A -+#define REG_HMEBOX_E2 0x008C -+#define REG_HMEBOX_E3 0x008E -+#define REG_HMEBOX_EXT_0 0x01F0 -+#define REG_HMEBOX_EXT_1 0x01F4 -+#define REG_HMEBOX_EXT_2 0x01F8 -+#define REG_HMEBOX_EXT_3 0x01FC -+#define REG_HIMR_88E 0x00B0 /* RTL8188E */ -+#define REG_HISR_88E 0x00B4 /* RTL8188E */ -+#define REG_HIMRE_88E 0x00B8 /* RTL8188E */ -+#define REG_HISRE_88E 0x00BC /* RTL8188E */ -+#define REG_MACID_NO_LINK_0 0x0484 -+#define REG_MACID_NO_LINK_1 0x0488 -+#define REG_MACID_PAUSE_0 0x048c -+#define REG_MACID_PAUSE_1 0x0490 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_PKTBUF_DBG_ADDR (REG_PKTBUF_DBG_CTRL) -+#define REG_RXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+2) -+#define REG_TXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+3) -+#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0280h ~ 0x02FFh RXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0300h ~ 0x03FFh PCIe -+ * -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * -+ * ----------------------------------------------------- */ -+#ifdef CONFIG_WOWLAN -+ #define REG_TXPKTBUF_IV_LOW 0x01a4 -+ #define REG_TXPKTBUF_IV_HIGH 0x01a8 -+#endif -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * -+ * ----------------------------------------------------- */ -+#ifdef CONFIG_RF_POWER_TRIM -+ #define EEPROM_RF_GAIN_OFFSET 0xC1 -+ #define EEPROM_RF_GAIN_VAL 0xF6 -+ #define EEPROM_THERMAL_OFFSET 0xF5 -+#endif /*CONFIG_RF_POWER_TRIM*/ -+/* ---------------------------------------------------------------------------- -+ * 88E Driver Initialization Offload REG_FDHM0(Offset 0x88, 8 bits) -+ * ---------------------------------------------------------------------------- -+ * IOL config for REG_FDHM0(Reg0x88) */ -+#define CMD_INIT_LLT BIT0 -+#define CMD_READ_EFUSE_MAP BIT1 -+#define CMD_EFUSE_PATCH BIT2 -+#define CMD_IOCONFIG BIT3 -+#define CMD_INIT_LLT_ERR BIT4 -+#define CMD_READ_EFUSE_MAP_ERR BIT5 -+#define CMD_EFUSE_PATCH_ERR BIT6 -+#define CMD_IOCONFIG_ERR BIT7 -+ -+/* ----------------------------------------------------- -+ * -+ * Redifine register definition for compatibility -+ * -+ * ----------------------------------------------------- */ -+ -+/* TODO: use these definition when using REG_xxx naming rule. -+ * NOTE: DO NOT Remove these definition. Use later. */ -+#define ISR_88E REG_HISR_88E -+ -+#ifdef CONFIG_PCI_HCI -+ /* #define IMR_RX_MASK (IMR_ROK_88E|IMR_RDU_88E|IMR_RXFOVW_88E) */ -+ #define IMR_TX_MASK (IMR_VODOK_88E | IMR_VIDOK_88E | IMR_BEDOK_88E | IMR_BKDOK_88E | IMR_MGNTDOK_88E | IMR_HIGHDOK_88E | IMR_BCNDERR0_88E) -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ #define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_88E | IMR_TBDOK_88E | IMR_TBDER_88E | IMR_BCNDMAINT_E_88E) -+ #else -+ #define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_88E | IMR_TBDOK_88E | IMR_TBDER_88E) -+ #endif -+ -+ #define RT_AC_INT_MASKS (IMR_VIDOK_88E | IMR_VODOK_88E | IMR_BEDOK_88E | IMR_BKDOK_88E) -+#endif -+ -+ -+/* ******************************************************** -+ * General definitions -+ * ******************************************************** */ -+ -+#define MACID_NUM_88E 64 -+#define SEC_CAM_ENT_NUM_88E 32 -+#define HW_PORT_NUM_88E 2 -+#define NSS_NUM_88E 1 -+#define BAND_CAP_88E (BAND_CAP_2G) -+#define BW_CAP_88E (BW_CAP_20M | BW_CAP_40M) -+#define PROTO_CAP_88E (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) -+ -+/* ---------------------------------------------------------------------------- -+ * 8192C EEPROM/EFUSE share register definition. -+ * ---------------------------------------------------------------------------- */ -+ -+#define EFUSE_ACCESS_ON 0x69 /* For RTL8723 only. */ -+#define EFUSE_ACCESS_OFF 0x00 /* For RTL8723 only. */ -+ -+#endif /* __RTL8188E_SPEC_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_sreset.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_sreset.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8188E_SRESET_H_ -+#define _RTL8188E_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ extern void rtl8188e_sreset_xmit_status_check(_adapter *padapter); -+ extern void rtl8188e_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_xmit.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188e_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188e_xmit.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,300 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188E_XMIT_H__ -+#define __RTL8188E_XMIT_H__ -+ -+ -+ -+ -+/* For 88e early mode */ -+#define SET_EARLYMODE_PKTNUM(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 3, __Value) -+#define SET_EARLYMODE_LEN0(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 12, __Value) -+#define SET_EARLYMODE_LEN1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 16, 12, __Value) -+#define SET_EARLYMODE_LEN2_1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 28, 4, __Value) -+#define SET_EARLYMODE_LEN2_2(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 8, __Value) -+#define SET_EARLYMODE_LEN3(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 8, 12, __Value) -+#define SET_EARLYMODE_LEN4(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 20, 12, __Value) -+ -+/* -+ * defined for TX DESC Operation -+ * */ -+ -+#define MAX_TID (15) -+ -+/* OFFSET 0 */ -+#define OFFSET_SZ 0 -+#define OFFSET_SHT 16 -+#define BMC BIT(24) -+#define LSG BIT(26) -+#define FSG BIT(27) -+#define OWN BIT(31) -+ -+ -+/* OFFSET 4 */ -+#define PKT_OFFSET_SZ 0 -+#define QSEL_SHT 8 -+#define RATE_ID_SHT 16 -+#define NAVUSEHDR BIT(20) -+#define SEC_TYPE_SHT 22 -+#define PKT_OFFSET_SHT 26 -+ -+/* OFFSET 8 */ -+#define AGG_EN BIT(12) -+#define AGG_BK BIT(16) -+#define AMPDU_DENSITY_SHT 20 -+#define ANTSEL_A BIT(24) -+#define ANTSEL_B BIT(25) -+#define TX_ANT_CCK_SHT 26 -+#define TX_ANTL_SHT 28 -+#define TX_ANT_HT_SHT 30 -+ -+/* OFFSET 12 */ -+#define SEQ_SHT 16 -+#define EN_HWSEQ BIT(31) -+ -+/* OFFSET 16 */ -+#define QOS BIT(6) -+#define HW_SSN BIT(7) -+#define USERATE BIT(8) -+#define DISDATAFB BIT(10) -+#define CTS_2_SELF BIT(11) -+#define RTS_EN BIT(12) -+#define HW_RTS_EN BIT(13) -+#define DATA_SHORT BIT(24) -+#define PWR_STATUS_SHT 15 -+#define DATA_SC_SHT 20 -+#define DATA_BW BIT(25) -+ -+/* OFFSET 20 */ -+#define RTY_LMT_EN BIT(17) -+ -+ -+/* OFFSET 20 */ -+#define SGI BIT(6) -+#define USB_TXAGG_NUM_SHT 24 -+ -+typedef struct txdesc_88e { -+ /* Offset 0 */ -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 ls:1; -+ u32 fs:1; -+ u32 linip:1; -+ u32 noacm:1; -+ u32 gf:1; -+ u32 own:1; -+ -+ /* Offset 4 */ -+ u32 macid:6; -+ u32 rsvd0406:2; -+ u32 qsel:5; -+ u32 rd_nav_ext:1; -+ u32 lsig_txop_en:1; -+ u32 pifs:1; -+ u32 rate_id:4; -+ u32 navusehdr:1; -+ u32 en_desc_id:1; -+ u32 sectype:2; -+ u32 rsvd0424:2; -+ u32 pkt_offset:5; /* unit: 8 bytes */ -+ u32 rsvd0431:1; -+ -+ /* Offset 8 */ -+ u32 rts_rc:6; -+ u32 data_rc:6; -+ u32 agg_en:1; -+ u32 rd_en:1; -+ u32 bar_rty_th:2; -+ u32 bk:1; -+ u32 morefrag:1; -+ u32 raw:1; -+ u32 ccx:1; -+ u32 ampdu_density:3; -+ u32 bt_null:1; -+ u32 ant_sel_a:1; -+ u32 ant_sel_b:1; -+ u32 tx_ant_cck:2; -+ u32 tx_antl:2; -+ u32 tx_ant_ht:2; -+ -+ /* Offset 12 */ -+ u32 nextheadpage:8; -+ u32 tailpage:8; -+ u32 seq:12; -+ u32 cpu_handle:1; -+ u32 tag1:1; -+ u32 trigger_int:1; -+ u32 hwseq_en:1; -+ -+ /* Offset 16 */ -+ u32 rtsrate:5; -+ u32 ap_dcfe:1; -+ u32 hwseq_sel:2; -+ u32 userate:1; -+ u32 disrtsfb:1; -+ u32 disdatafb:1; -+ u32 cts2self:1; -+ u32 rtsen:1; -+ u32 hw_rts_en:1; -+ u32 port_id:1; -+ u32 pwr_status:3; -+ u32 wait_dcts:1; -+ u32 cts2ap_en:1; -+ u32 data_sc:2; -+ u32 data_stbc:2; -+ u32 data_short:1; -+ u32 data_bw:1; -+ u32 rts_short:1; -+ u32 rts_bw:1; -+ u32 rts_sc:2; -+ u32 vcs_stbc:2; -+ -+ /* Offset 20 */ -+ u32 datarate:6; -+ u32 sgi:1; -+ u32 try_rate:1; -+ u32 data_ratefb_lmt:5; -+ u32 rts_ratefb_lmt:4; -+ u32 rty_lmt_en:1; -+ u32 data_rt_lmt:6; -+ u32 usb_txagg_num:8; -+ -+ /* Offset 24 */ -+ u32 txagg_a:5; -+ u32 txagg_b:5; -+ u32 use_max_len:1; -+ u32 max_agg_num:5; -+ u32 mcsg1_max_len:4; -+ u32 mcsg2_max_len:4; -+ u32 mcsg3_max_len:4; -+ u32 mcs7_sgi_max_len:4; -+ -+ /* Offset 28 */ -+ u32 checksum:16; /* TxBuffSize(PCIe)/CheckSum(USB) */ -+ u32 sw0:8; /* offset 30 */ -+ u32 sw1:4; -+ u32 mcs15_sgi_max_len:4; -+} TXDESC_8188E, *PTXDESC_8188E; -+ -+#define txdesc_set_ccx_sw_88e(txdesc, value) \ -+ do { \ -+ ((struct txdesc_88e *)(txdesc))->sw1 = (((value)>>8) & 0x0f); \ -+ ((struct txdesc_88e *)(txdesc))->sw0 = ((value) & 0xff); \ -+ } while (0) -+ -+struct txrpt_ccx_88e { -+ /* offset 0 */ -+ u8 tag1:1; -+ u8 pkt_num:3; -+ u8 txdma_underflow:1; -+ u8 int_bt:1; -+ u8 int_tri:1; -+ u8 int_ccx:1; -+ -+ /* offset 1 */ -+ u8 mac_id:6; -+ u8 pkt_ok:1; -+ u8 bmc:1; -+ -+ /* offset 2 */ -+ u8 retry_cnt:6; -+ u8 lifetime_over:1; -+ u8 retry_over:1; -+ -+ /* offset 3 */ -+ u8 ccx_qtime0; -+ u8 ccx_qtime1; -+ -+ /* offset 5 */ -+ u8 final_data_rate; -+ -+ /* offset 6 */ -+ u8 sw1:4; -+ u8 qsel:4; -+ -+ /* offset 7 */ -+ u8 sw0; -+}; -+ -+#define txrpt_ccx_sw_88e(txrpt_ccx) ((txrpt_ccx)->sw0 + ((txrpt_ccx)->sw1<<8)) -+#define txrpt_ccx_qtime_88e(txrpt_ccx) ((txrpt_ccx)->ccx_qtime0+((txrpt_ccx)->ccx_qtime1<<8)) -+ -+#define SET_TX_DESC_SEC_TYPE_8188E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+ -+void rtl8188e_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, -+ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+void rtl8188e_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+#if defined(CONFIG_CONCURRENT_MODE) -+ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ s32 rtl8188es_init_xmit_priv(PADAPTER padapter); -+ void rtl8188es_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8188es_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8188es_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8188es_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ thread_return rtl8188es_xmit_thread(thread_context context); -+ s32 rtl8188es_xmit_buf_handler(PADAPTER padapter); -+ -+ #ifdef CONFIG_SDIO_TX_TASKLET -+ void rtl8188es_xmit_tasklet(void *priv); -+ #endif -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ s32 rtl8188eu_init_xmit_priv(PADAPTER padapter); -+ void rtl8188eu_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8188eu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8188eu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8188eu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8188eu_xmit_buf_handler(PADAPTER padapter); -+ void rtl8188eu_xmit_tasklet(void *priv); -+ s32 rtl8188eu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8188ee_init_xmit_priv(PADAPTER padapter); -+ void rtl8188ee_free_xmit_priv(PADAPTER padapter); -+ void rtl8188ee_xmitframe_resume(_adapter *padapter); -+ s32 rtl8188ee_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8188ee_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8188ee_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ void rtl8188ee_xmit_tasklet(void *priv); -+#endif -+ -+ -+ -+#ifdef CONFIG_TX_EARLY_MODE -+ void UpdateEarlyModeInfo8188E(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif -+ -+#ifdef CONFIG_XMIT_ACK -+ void dump_txrpt_ccx_88e(void *buf); -+ void handle_txrpt_ccx_88e(_adapter *adapter, u8 *buf); -+#else -+ #define dump_txrpt_ccx_88e(buf) do {} while (0) -+ #define handle_txrpt_ccx_88e(adapter, buf) do {} while (0) -+#endif /* CONFIG_XMIT_ACK */ -+ -+void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, struct tx_desc *ptxdesc); -+#endif /* __RTL8188E_XMIT_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_cmd.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_cmd.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,219 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_CMD_H__ -+#define __RTL8188F_CMD_H__ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+enum h2c_cmd_8188F { -+ /* Common Class: 000 */ -+ H2C_8188F_RSVD_PAGE = 0x00, -+ H2C_8188F_MEDIA_STATUS_RPT = 0x01, -+ H2C_8188F_SCAN_ENABLE = 0x02, -+ H2C_8188F_KEEP_ALIVE = 0x03, -+ H2C_8188F_DISCON_DECISION = 0x04, -+ H2C_8188F_PSD_OFFLOAD = 0x05, -+ H2C_8188F_AP_OFFLOAD = 0x08, -+ H2C_8188F_BCN_RSVDPAGE = 0x09, -+ H2C_8188F_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_8188F_FCS_RSVDPAGE = 0x10, -+ H2C_8188F_FCS_INFO = 0x11, -+ H2C_8188F_AP_WOW_GPIO_CTRL = 0x13, -+ -+ /* PoweSave Class: 001 */ -+ H2C_8188F_SET_PWR_MODE = 0x20, -+ H2C_8188F_PS_TUNING_PARA = 0x21, -+ H2C_8188F_PS_TUNING_PARA2 = 0x22, -+ H2C_8188F_P2P_LPS_PARAM = 0x23, -+ H2C_8188F_P2P_PS_OFFLOAD = 0x24, -+ H2C_8188F_PS_SCAN_ENABLE = 0x25, -+ H2C_8188F_SAP_PS_ = 0x26, -+ H2C_8188F_INACTIVE_PS_ = 0x27, /* Inactive_PS */ -+ H2C_8188F_FWLPS_IN_IPS_ = 0x28, -+ -+ /* Dynamic Mechanism Class: 010 */ -+ H2C_8188F_MACID_CFG = 0x40, -+ H2C_8188F_TXBF = 0x41, -+ H2C_8188F_RSSI_SETTING = 0x42, -+ H2C_8188F_AP_REQ_TXRPT = 0x43, -+ H2C_8188F_INIT_RATE_COLLECT = 0x44, -+ H2C_8188F_RA_PARA_ADJUST = 0x46, -+ -+ /* BT Class: 011 */ -+ H2C_8188F_B_TYPE_TDMA = 0x60, -+ H2C_8188F_BT_INFO = 0x61, -+ H2C_8188F_FORCE_BT_TXPWR = 0x62, -+ H2C_8188F_BT_IGNORE_WLANACT = 0x63, -+ H2C_8188F_DAC_SWING_VALUE = 0x64, -+ H2C_8188F_ANT_SEL_RSV = 0x65, -+ H2C_8188F_WL_OPMODE = 0x66, -+ H2C_8188F_BT_MP_OPER = 0x67, -+ H2C_8188F_BT_CONTROL = 0x68, -+ H2C_8188F_BT_WIFI_CTRL = 0x69, -+ H2C_8188F_BT_FW_PATCH = 0x6A, -+ H2C_8188F_BT_WLAN_CALIBRATION = 0x6D, -+ -+ /* WOWLAN Class: 100 */ -+ H2C_8188F_WOWLAN = 0x80, -+ H2C_8188F_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8188F_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8188F_AOAC_RSVD_PAGE = 0x83, -+ H2C_8188F_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_8188F_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_8188F_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_8188F_CHNL_SWITCH_OFFLOAD = 0x87, -+ H2C_8188F_P2P_OFFLOAD_RSVD_PAGE = 0x8A, -+ H2C_8188F_P2P_OFFLOAD = 0x8B, -+ -+ H2C_8188F_RESET_TSF = 0xC0, -+ H2C_8188F_MAXID, -+}; -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- -+ * _RSVDPAGE_LOC_CMD_0x00 */ -+#define SET_8188F_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8188F_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8188F_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8188F_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8188F_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+/* _KEEP_ALIVE_CMD_0x03 */ -+#define SET_8188F_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8188F_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8188F_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8188F_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _DISCONNECT_DECISION_CMD_0x04 */ -+#define SET_8188F_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8188F_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8188F_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8188F_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+ -+/* _PWR_MOD_CMD_0x20 */ -+#define SET_8188F_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8188F_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+#define GET_8188F_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+/* _PS_TUNE_PARAM_CMD_0x21 */ -+#define SET_8188F_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8188F_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8188F_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) -+#define SET_8188F_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) -+#define SET_8188F_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _MACID_CFG_CMD_0x40 */ -+#define SET_8188F_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) -+#define SET_8188F_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) -+ -+/* _RSSI_SETTING_CMD_0x42 */ -+#define SET_8188F_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8188F_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) -+#define SET_8188F_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _AP_REQ_TXRPT_CMD_0x43 */ -+#define SET_8188F_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8188F_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _FORCE_BT_TXPWR_CMD_0x62 */ -+#define SET_8188F_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+ -+/* _FORCE_BT_MP_OPER_CMD_0x67 */ -+#define SET_8188F_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_8188F_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_8188F_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8188F_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+#define SET_8188F_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8188F_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+ -+/* _BT_FW_PATCH_0x6A */ -+#define SET_8188F_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) -+#define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ------------------------------------------- Structure -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- Function Statement -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+/* host message to firmware cmd */ -+void rtl8188f_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8188f_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -+void rtl8188f_set_rssi_cmd(PADAPTER padapter, u8 *param); -+void rtl8188f_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); -+/* s32 rtl8188f_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ -+void rtl8188f_set_FwPsTuneParam_cmd(PADAPTER padapter); -+void rtl8188f_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); -+void rtl8188f_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); -+void rtl8188f_download_rsvd_page(PADAPTER padapter, u8 mstatus); -+#ifdef CONFIG_BT_COEXIST -+ void rtl8188f_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif /* CONFIG_BT_COEXIST */ -+#ifdef CONFIG_P2P -+void rtl8188f_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif /* CONFIG_P2P */ -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+void rtl8188f_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); -+#endif -+#endif -+ -+#ifdef CONFIG_P2P_WOWLAN -+void rtl8188f_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+void rtl8188f_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+u8 rtl8188f_reset_tsf(_adapter *padapter, u8 reset_port); -+#endif /* CONFIG_TSF_RESET_OFFLOAD */ -+s32 FillH2CCmd8188F(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8188F(_adapter *padapter, bool wowlan); -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_dm.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_dm.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,47 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_DM_H__ -+#define __RTL8188F_DM_H__ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for 8188F dynamic mechanism only -+ * -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * structure and define -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * function prototype -+ * ************************************************************ */ -+ -+void rtl8188f_init_dm_priv(PADAPTER padapter); -+void rtl8188f_deinit_dm_priv(PADAPTER padapter); -+ -+void rtl8188f_InitHalDm(PADAPTER padapter); -+void rtl8188f_HalDmWatchDog(PADAPTER padapter); -+void rtl8188f_HalDmWatchDog_in_LPS(PADAPTER padapter); -+void rtl8188f_hal_dm_in_lps(PADAPTER padapter); -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_hal.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,271 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_HAL_H__ -+#define __RTL8188F_HAL_H__ -+ -+#include "hal_data.h" -+ -+#include "rtl8188f_spec.h" -+#include "rtl8188f_rf.h" -+#include "rtl8188f_dm.h" -+#include "rtl8188f_recv.h" -+#include "rtl8188f_xmit.h" -+#include "rtl8188f_cmd.h" -+#include "rtl8188f_led.h" -+#include "Hal8188FPwrSeq.h" -+#include "Hal8188FPhyReg.h" -+#include "Hal8188FPhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+#include "rtl8188f_sreset.h" -+#endif -+ -+#define FW_8188F_SIZE 0x8000 -+#define FW_8188F_START_ADDRESS 0x1000 -+#define FW_8188F_END_ADDRESS 0x1FFF /* 0x5FFF */ -+ -+#define IS_FW_HEADER_EXIST_8188F(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature) & 0xFFF0) == 0x88F0) -+ -+typedef struct _RT_FIRMWARE { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8 *szFwBuffer; -+#else -+ u8 szFwBuffer[FW_8188F_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8188F, *PRT_FIRMWARE_8188F; -+ -+/* -+ * This structure must be cared byte-ordering -+ * -+ * Added by tynli. 2009.12.04. */ -+typedef struct _RT_8188F_FIRMWARE_HDR { -+ /* 8-byte alinment required */ -+ -+ /* --- LONG WORD 0 ---- */ -+ u16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ -+ u8 Category; /* AP/NIC and USB/PCI */ -+ u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ -+ u16 Version; /* FW Version */ -+ u16 Subversion; /* FW Subversion, default 0x00 */ -+ -+ /* --- LONG WORD 1 ---- */ -+ u8 Month; /* Release time Month field */ -+ u8 Date; /* Release time Date field */ -+ u8 Hour; /* Release time Hour field */ -+ u8 Minute; /* Release time Minute field */ -+ u16 RamCodeSize; /* The size of RAM code */ -+ u16 Rsvd2; -+ -+ /* --- LONG WORD 2 ---- */ -+ u32 SvnIdx; /* The SVN entry index */ -+ u32 Rsvd3; -+ -+ /* --- LONG WORD 3 ---- */ -+ u32 Rsvd4; -+ u32 Rsvd5; -+} RT_8188F_FIRMWARE_HDR, *PRT_8188F_FIRMWARE_HDR; -+ -+#define DRIVER_EARLY_INT_TIME_8188F 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8188F 0x02 -+ -+/* for 8188F -+ * TX 32K, RX 16K, Page size 128B for TX, 8B for RX */ -+#define PAGE_SIZE_TX_8188F 128 -+#define PAGE_SIZE_RX_8188F 8 -+ -+#define RX_DMA_SIZE_8188F 0x4000 /* 16K */ -+#ifdef CONFIG_FW_C2H_DEBUG -+ #define RX_DMA_RESERVED_SIZE_8188F 0x100 /* 256B, reserved for c2h debug message */ -+#else -+ #define RX_DMA_RESERVED_SIZE_8188F 0x80 /* 128B, reserved for tx report */ -+#endif -+ -+#ifdef CONFIG_WOWLAN -+ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ -+#else -+ #define RESV_FMWF 0 -+#endif -+ -+#define RX_DMA_BOUNDARY_8188F (RX_DMA_SIZE_8188F - RX_DMA_RESERVED_SIZE_8188F - 1) -+ -+/* Note: We will divide number of page equally for each queue other than public queue! */ -+ -+/* For General Reserved Page Number(Beacon Queue is reserved page) -+ * Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 */ -+#define BCNQ_PAGE_NUM_8188F 0x08 -+#ifdef CONFIG_CONCURRENT_MODE -+ #define BCNQ1_PAGE_NUM_8188F 0x08 /* 0x04 */ -+#else -+ #define BCNQ1_PAGE_NUM_8188F 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+#undef BCNQ1_PAGE_NUM_8188F -+#define BCNQ1_PAGE_NUM_8188F 0x00 /* 0x04 */ -+#endif -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8188F 0x07 -+#else -+ #define WOWLAN_PAGE_NUM_8188F 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+#undef WOWLAN_PAGE_NUM_8188F -+#define WOWLAN_PAGE_NUM_8188F 0x15 -+#endif -+ -+#ifdef CONFIG_AP_WOWLAN -+#define AP_WOWLAN_PAGE_NUM_8188F 0x02 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8188F (0xFF - BCNQ_PAGE_NUM_8188F - BCNQ1_PAGE_NUM_8188F - WOWLAN_PAGE_NUM_8188F) -+#define TX_PAGE_BOUNDARY_8188F (TX_TOTAL_PAGE_NUMBER_8188F + 1) -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8188F TX_TOTAL_PAGE_NUMBER_8188F -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8188F (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8188F + 1) -+ -+/* For Normal Chip Setting -+ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8188F */ -+#define NORMAL_PAGE_NUM_HPQ_8188F 0x0C -+#define NORMAL_PAGE_NUM_LPQ_8188F 0x02 -+#define NORMAL_PAGE_NUM_NPQ_8188F 0x02 -+ -+/* Note: For Normal Chip Setting, modify later */ -+#define WMM_NORMAL_PAGE_NUM_HPQ_8188F 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8188F 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8188F 0x20 -+ -+ -+#include "HalVerDef.h" -+#include "hal_com.h" -+ -+#define EFUSE_OOB_PROTECT_BYTES 15 -+ -+#define HAL_EFUSE_MEMORY -+ -+#define HWSET_MAX_SIZE_8188F 512 -+#define EFUSE_REAL_CONTENT_LEN_8188F 512 -+#define EFUSE_MAP_LEN_8188F 512 -+#define EFUSE_MAX_SECTION_8188F 64 -+ -+#define EFUSE_IC_ID_OFFSET 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ -+#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8188F) -+ -+#define EFUSE_ACCESS_ON 0x69 /* For RTL8188 only. */ -+#define EFUSE_ACCESS_OFF 0x00 /* For RTL8188 only. */ -+ -+/* ******************************************************** -+ * EFUSE for BT definition -+ * ******************************************************** */ -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN 512 -+#define EFUSE_BT_REAL_CONTENT_LEN 1536 /* 512*3 */ -+#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ -+#define EFUSE_BT_MAX_SECTION 128 /* 1024/8 */ -+ -+#define EFUSE_PROTECT_BYTES_BANK 16 -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+/* rtl8188a_hal_init.c */ -+s32 rtl8188f_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); -+void rtl8188f_FirmwareSelfReset(PADAPTER padapter); -+void rtl8188f_InitializeFirmwareVars(PADAPTER padapter); -+ -+void rtl8188f_InitAntenna_Selection(PADAPTER padapter); -+void rtl8188f_DeinitAntenna_Selection(PADAPTER padapter); -+void rtl8188f_CheckAntenna_Selection(PADAPTER padapter); -+void rtl8188f_init_default_value(PADAPTER padapter); -+ -+s32 rtl8188f_InitLLTTable(PADAPTER padapter); -+ -+s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); -+s32 CardDisableWithoutHWSM(PADAPTER padapter); -+ -+/* EFuse */ -+u8 GetEEPROMSize8188F(PADAPTER padapter); -+void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); -+void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); -+void Hal_EfuseParseTxPowerInfo_8188F(PADAPTER padapter, u8 *PROMContent, BOOLEAN AutoLoadFail); -+/* void Hal_EfuseParseBTCoexistInfo_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); */ -+void Hal_EfuseParseEEPROMVer_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseChnlPlan_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseCustomerID_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParsePowerSavingMode_8188F(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseAntennaDiversity_8188F(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8188F(PADAPTER pAdapter, u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseThermalMeter_8188F(PADAPTER padapter, u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseKFreeData_8188F(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+ -+#if 0 /* Do not need for rtl8188f */ -+VOID Hal_EfuseParseVoltage_8188F(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+#endif -+ -+void rtl8188f_set_pll_ref_clk_sel(_adapter *adapter, u8 sel); -+ -+void rtl8188f_set_hal_ops(struct hal_ops *pHalFunc); -+void init_hal_spec_8188f(_adapter *adapter); -+void SetHwReg8188F(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg8188F(PADAPTER padapter, u8 variable, u8 *val); -+u8 SetHalDefVar8188F(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8188F(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+ -+/* register */ -+void rtl8188f_InitBeaconParameters(PADAPTER padapter); -+void rtl8188f_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); -+void _InitBurstPktLen_8188FS(PADAPTER Adapter); -+void _8051Reset8188(PADAPTER padapter); -+#ifdef CONFIG_WOWLAN -+void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif /* CONFIG_WOWLAN */ -+ -+void rtl8188f_start_thread(_adapter *padapter); -+void rtl8188f_stop_thread(_adapter *padapter); -+ -+#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) -+ void rtl8188fs_init_checkbthang_workqueue(_adapter *adapter); -+ void rtl8188fs_free_checkbthang_workqueue(_adapter *adapter); -+ void rtl8188fs_cancle_checkbthang_workqueue(_adapter *adapter); -+ void rtl8188fs_hal_check_bt_hang(_adapter *adapter); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); -+#endif -+ -+#ifdef CONFIG_MP_INCLUDED -+int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); -+#endif -+ -+void CCX_FwC2HTxRpt_8188f(PADAPTER padapter, u8 *pdata, u8 len); -+ -+u8 MRateToHwRate8188F(u8 rate); -+u8 HwRateToMRate8188F(u8 rate); -+ -+#ifdef CONFIG_PCI_HCI -+BOOLEAN InterruptRecognized8188FE(PADAPTER Adapter); -+VOID UpdateInterruptMask8188FE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_led.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_led.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_LED_H__ -+#define __RTL8188F_LED_H__ -+ -+#include -+#include -+#include -+ -+ -+/* ******************************************************************************** -+ * Interface to manipulate LED objects. -+ * ******************************************************************************** */ -+#ifdef CONFIG_USB_HCI -+void rtl8188fu_InitSwLeds(PADAPTER padapter); -+void rtl8188fu_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_SDIO_HCI -+void rtl8188fs_InitSwLeds(PADAPTER padapter); -+void rtl8188fs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_GSPI_HCI -+void rtl8188fs_InitSwLeds(PADAPTER padapter); -+void rtl8188fs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+void rtl8188fe_InitSwLeds(PADAPTER padapter); -+void rtl8188fe_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_recv.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_recv.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,72 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_RECV_H__ -+#define __RTL8188F_RECV_H__ -+ -+#if defined(CONFIG_USB_HCI) -+ #ifndef MAX_RECVBUF_SZ -+ #ifdef PLATFORM_OS_CE -+ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ -+ #else -+ #ifdef CONFIG_MINIMAL_MEMORY_USAGE -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+ #else -+ #ifdef CONFIG_PLATFORM_MSTAR -+ #define MAX_RECVBUF_SZ (8192) /* 8K */ -+ #elif defined(CONFIG_PLATFORM_HISILICON) -+ #define MAX_RECVBUF_SZ (16384) /* 16k */ -+ #else -+ #define MAX_RECVBUF_SZ (32768) /* 32k */ -+ #endif -+ /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ -+ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ -+ /* #define MAX_RECVBUF_SZ (16384) */ /* 16k - 92E RX BUF :16K */ -+ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ -+ #endif -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+#elif defined(CONFIG_PCI_HCI) -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+#elif defined(CONFIG_SDIO_HCI) -+ #define MAX_RECVBUF_SZ (RX_DMA_BOUNDARY_8188F + 1) -+#endif /* CONFIG_SDIO_HCI */ -+ -+/* Rx smooth factor */ -+#define Rx_Smooth_Factor (20) -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+s32 rtl8188fs_init_recv_priv(PADAPTER padapter); -+void rtl8188fs_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+int rtl8188fu_init_recv_priv(_adapter *padapter); -+void rtl8188fu_free_recv_priv(_adapter *padapter); -+void rtl8188fu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8188fe_init_recv_priv(PADAPTER padapter); -+void rtl8188fe_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8188f_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8188F_RECV_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_rf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_rf.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_RF_H__ -+#define __RTL8188F_RF_H__ -+ -+int PHY_RF6052_Config8188F(IN PADAPTER Adapter); -+ -+VOID -+PHY_RF6052SetBandwidth8188F( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_spec.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_spec.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,303 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8188F_SPEC_H__ -+#define __RTL8188F_SPEC_H__ -+ -+#include -+ -+ -+#define HAL_NAV_UPPER_UNIT_8188F 128 /* micro-second */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0000h ~ 0x00FFh System Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RSV_CTRL_8188F 0x001C /* 3 Byte */ -+#define REG_BT_WIFI_ANTENNA_SWITCH_8188F 0x0038 -+#define REG_HSISR_8188F 0x005c -+#define REG_PAD_CTRL1_8188F 0x0064 -+#define REG_AFE_CTRL_4_8188F 0x0078 -+#define REG_HMEBOX_DBG_0_8188F 0x0088 -+#define REG_HMEBOX_DBG_1_8188F 0x008A -+#define REG_HMEBOX_DBG_2_8188F 0x008C -+#define REG_HMEBOX_DBG_3_8188F 0x008E -+#define REG_HIMR0_8188F 0x00B0 -+#define REG_HISR0_8188F 0x00B4 -+#define REG_HIMR1_8188F 0x00B8 -+#define REG_HISR1_8188F 0x00BC -+#define REG_PMC_DBG_CTRL2_8188F 0x00CC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_C2HEVT_CMD_ID_8188F 0x01A0 -+#define REG_C2HEVT_CMD_LEN_8188F 0x01AE -+#define REG_WOWLAN_WAKE_REASON 0x01C7 -+#define REG_WOWLAN_GTK_DBG1 0x630 -+#define REG_WOWLAN_GTK_DBG2 0x634 -+ -+#define REG_HMEBOX_EXT0_8188F 0x01F0 -+#define REG_HMEBOX_EXT1_8188F 0x01F4 -+#define REG_HMEBOX_EXT2_8188F 0x01F8 -+#define REG_HMEBOX_EXT3_8188F 0x01FC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0280h ~ 0x02FFh RXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RXDMA_CONTROL_8188F 0x0286 /* Control the RX DMA. */ -+#define REG_RXDMA_MODE_CTRL_8188F 0x0290 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0300h ~ 0x03FFh PCIe -+ * -+ * ----------------------------------------------------- */ -+#define REG_PCIE_CTRL_REG_8188F 0x0300 -+#define REG_INT_MIG_8188F 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_DESA_8188F 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_HQ_DESA_8188F 0x0310 /* TX High Queue Descriptor Address */ -+#define REG_MGQ_DESA_8188F 0x0318 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_DESA_8188F 0x0320 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_DESA_8188F 0x0328 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_DESA_8188F 0x0330 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_DESA_8188F 0x0338 /* TX BK Queue Descriptor Address */ -+#define REG_RX_DESA_8188F 0x0340 /* RX Queue Descriptor Address */ -+#define REG_DBI_WDATA_8188F 0x0348 /* DBI Write Data */ -+#define REG_DBI_RDATA_8188F 0x034C /* DBI Read Data */ -+#define REG_DBI_ADDR_8188F 0x0350 /* DBI Address */ -+#define REG_DBI_FLAG_8188F 0x0352 /* DBI Read/Write Flag */ -+#define REG_MDIO_WDATA_8188F 0x0354 /* MDIO for Write PCIE PHY */ -+#define REG_MDIO_RDATA_8188F 0x0356 /* MDIO for Reads PCIE PHY */ -+#define REG_MDIO_CTL_8188F 0x0358 /* MDIO for Control */ -+#define REG_DBG_SEL_8188F 0x0360 /* Debug Selection Register */ -+#define REG_PCIE_HRPWM_8188F 0x0361 /* PCIe RPWM */ -+#define REG_PCIE_HCPWM_8188F 0x0363 /* PCIe CPWM */ -+#define REG_PCIE_MULTIFET_CTRL_8188F 0x036A /* PCIE Multi-Fethc Control */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_TXPKTBUF_BCNQ_BDNY_8188F 0x0424 -+#define REG_TXPKTBUF_MGQ_BDNY_8188F 0x0425 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8188F 0x045D -+#ifdef CONFIG_WOWLAN -+#define REG_TXPKTBUF_IV_LOW 0x0484 -+#define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif -+#define REG_AMPDU_BURST_MODE_8188F 0x04BC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_SECONDARY_CCA_CTRL_8188F 0x0577 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+ -+/* ************************************************************ -+ * SDIO Bus Specification -+ * ************************************************************ */ -+ -+/* ----------------------------------------------------- -+ * SDIO CMD Address Mapping -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * I/O bus domain (Host) -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * SDIO register -+ * ----------------------------------------------------- */ -+#define SDIO_REG_HIQ_FREEPG_8188F 0x0020 -+#define SDIO_REG_MID_FREEPG_8188F 0x0022 -+#define SDIO_REG_LOW_FREEPG_8188F 0x0024 -+#define SDIO_REG_PUB_FREEPG_8188F 0x0026 -+#define SDIO_REG_EXQ_FREEPG_8188F 0x0028 -+#define SDIO_REG_AC_OQT_FREEPG_8188F 0x002A -+#define SDIO_REG_NOAC_OQT_FREEPG_8188F 0x002B -+ -+#define SDIO_REG_HCPWM1_8188F 0x0038 -+ -+/* indirect access */ -+#define SDIO_REG_INDIRECT_REG_CFG_8188F 0x40 -+#define SET_INDIRECT_REG_ADDR(_cmd, _addr) SET_BITS_TO_LE_2BYTE(((u8 *)(_cmd)) + 0, 0, 16, (_addr)) -+#define SET_INDIRECT_REG_SIZE_1BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 0) -+#define SET_INDIRECT_REG_SIZE_2BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 1) -+#define SET_INDIRECT_REG_SIZE_4BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 2) -+#define SET_INDIRECT_REG_WRITE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 2, 1, 1) -+#define SET_INDIRECT_REG_READ(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 3, 1, 1) -+#define GET_INDIRECT_REG_RDY(_cmd) LE_BITS_TO_1BYTE(((u8 *)(_cmd)) + 2, 4, 1) -+ -+#define SDIO_REG_INDIRECT_REG_DATA_8188F 0x44 -+ -+/* **************************************************************************** -+ * 8188 Regsiter Bit and Content definition -+ * **************************************************************************** */ -+ -+/* 2 HSISR -+ * interrupt mask which needs to clear */ -+#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ -+ HSISR_SPS_OCP_INT |\ -+ HSISR_RON_INT |\ -+ HSISR_PDNINT |\ -+ HSISR_GPIO9_INT) -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0280h ~ 0x02FFh RXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define BIT_USB_RXDMA_AGG_EN BIT(31) -+#define RXDMA_AGG_MODE_EN BIT(1) -+ -+#ifdef CONFIG_WOWLAN -+#define RXPKT_RELEASE_POLL BIT(16) -+#define RXDMA_IDLE BIT(17) -+#define RW_RELEASE_EN BIT(18) -+#endif -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* ---------------------------------------------------------------------------- -+ * 8188F REG_CCK_CHECK (offset 0x454) -+ * ---------------------------------------------------------------------------- */ -+#define BIT_BCN_PORT_SEL BIT5 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* ---------------------------------------------------------------------------- -+ * 8195 IMR/ISR bits (offset 0xB0, 8bits) -+ * ---------------------------------------------------------------------------- */ -+#define IMR_DISABLED_8188F 0 -+/* IMR DW0(0x00B0-00B3) Bit 0-31 */ -+#define IMR_TIMER2_8188F BIT31 /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8188F BIT30 /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8188F BIT29 /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8188F BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8188F BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8188F BIT26 /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8188F BIT25 /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8188F BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8188F BIT20 /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8188F BIT16 /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8188F BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8188F BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8188F BIT12 /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8188F BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_8188F BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_8188F BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_8188F BIT7 /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8188F BIT6 /* Management Queue DMA OK */ -+#define IMR_BKDOK_8188F BIT5 /* AC_BK DMA OK */ -+#define IMR_BEDOK_8188F BIT4 /* AC_BE DMA OK */ -+#define IMR_VIDOK_8188F BIT3 /* AC_VI DMA OK */ -+#define IMR_VODOK_8188F BIT2 /* AC_VO DMA OK */ -+#define IMR_RDU_8188F BIT1 /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8188F BIT0 /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_8188F BIT27 /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8188F BIT26 /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8188F BIT25 /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8188F BIT24 /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8188F BIT23 /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8188F BIT22 /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8188F BIT21 /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8188F BIT20 /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6_8188F BIT19 /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5_8188F BIT18 /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4_8188F BIT17 /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3_8188F BIT16 /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2_8188F BIT15 /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1_8188F BIT14 /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_ATIMEND_E_8188F BIT13 /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8188F BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_8188F BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_8188F BIT9 /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8188F BIT8 /* Receive FIFO Overflow */ -+ -+#ifdef CONFIG_PCI_HCI -+/* #define IMR_RX_MASK (IMR_ROK_8188F|IMR_RDU_8188F|IMR_RXFOVW_8188F) */ -+#define IMR_TX_MASK (IMR_VODOK_8188F | IMR_VIDOK_8188F | IMR_BEDOK_8188F | IMR_BKDOK_8188F | IMR_MGNTDOK_8188F | IMR_HIGHDOK_8188F) -+ -+#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8188F | IMR_TXBCN0OK_8188F | IMR_TXBCN0ERR_8188F | IMR_BCNDERR0_8188F) -+ -+#define RT_AC_INT_MASKS (IMR_VIDOK_8188F | IMR_VODOK_8188F | IMR_BEDOK_8188F | IMR_BKDOK_8188F) -+#endif -+ -+/* ******************************************************** -+ * General definitions -+ * ******************************************************** */ -+ -+#define MACID_NUM_8188F 16 -+#define SEC_CAM_ENT_NUM_8188F 16 -+#define HW_PORT_NUM_8188F 2 -+#define NSS_NUM_8188F 1 -+#define BAND_CAP_8188F (BAND_CAP_2G) -+#define BW_CAP_8188F (BW_CAP_20M | BW_CAP_40M) -+#define PROTO_CAP_8188F (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) -+ -+#endif /* __RTL8188F_SPEC_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_sreset.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_sreset.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8188F_SRESET_H_ -+#define _RTL8188F_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+extern void rtl8188f_sreset_xmit_status_check(_adapter *padapter); -+extern void rtl8188f_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_xmit.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8188f_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8188f_xmit.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,338 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8188F_XMIT_H__ -+#define __RTL8188F_XMIT_H__ -+ -+ -+#define MAX_TID (15) -+ -+ -+#ifndef __INC_HAL8188FDESC_H -+#define __INC_HAL8188FDESC_H -+ -+#define RX_STATUS_DESC_SIZE_8188F 24 -+#define RX_DRV_INFO_SIZE_UNIT_8188F 8 -+ -+ -+/* DWORD 0 */ -+#define SET_RX_STATUS_DESC_PKT_LEN_8188F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8188F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8188F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_LAST_SEG_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 28, 1) -+#define GET_RX_STATUS_DESC_FIRST_SEG_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 29, 1) -+#define GET_RX_STATUS_DESC_EOR_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+ -+/* DWORD 1 */ -+#define GET_RX_STATUS_DESC_MACID_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_AMSDU_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_CHKERR_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_IPVER_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_IS_TCPUDP__8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_CHK_VLD_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) -+ -+/* DWORD 2 */ -+#define GET_RX_STATUS_DESC_SEQ_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_RPT_SEL_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) -+ -+/* DWORD 3 */ -+#define GET_RX_STATUS_DESC_RX_RATE_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) -+#ifdef CONFIG_USB_RX_AGGREGATION -+#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) -+#endif -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_MATCH_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_MATCH_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) -+ -+/* DWORD 6 */ -+#define GET_RX_STATUS_DESC_SPLCP_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 1) -+#define GET_RX_STATUS_DESC_LDPC_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 1, 1) -+#define GET_RX_STATUS_DESC_STBC_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 2, 1) -+#define GET_RX_STATUS_DESC_BW_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 4, 2) -+ -+/* DWORD 5 */ -+#define GET_RX_STATUS_DESC_TSFL_8188F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_8188F(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+#define SET_RX_STATUS_DESC_BUFF_ADDR_8188F(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) -+ -+ -+/* Dword 0 */ -+#define GET_TX_DESC_OWN_8188F(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+#define SET_TX_DESC_PKT_SIZE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_LAST_SEG_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+#define SET_TX_DESC_FIRST_SEG_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_LINIP_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+#define SET_TX_DESC_OWN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+/* Dword 1 */ -+#define SET_TX_DESC_MACID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+ -+ -+/* Dword 2 */ -+#define SET_TX_DESC_PAID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_AGG_BREAK_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_SPE_RPT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_INT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_GID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+ -+ -+/* Dword 3 */ -+#define SET_TX_DESC_WHEADER_LEN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) -+#define SET_TX_DESC_CHK_EN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) -+#define SET_TX_DESC_EARLY_MODE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HWSEQ_SEL_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+/* Dword 4 */ -+#define SET_TX_DESC_TX_RATE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+ -+ -+/* Dword 5 */ -+#define SET_TX_DESC_DATA_SC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_CTROL_STBC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+ -+ -+/* Dword 6 */ -+#define SET_TX_DESC_SW_DEFINE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_MBSSID_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+#define SET_TX_DESC_ANTSEL_A_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+#define SET_TX_DESC_ANTSEL_B_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+#define SET_TX_DESC_ANTSEL_C_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) -+#define SET_TX_DESC_ANTSEL_D_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) -+ -+/* Dword 7 */ -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+#define SET_TX_DESC_TX_BUFFER_SIZE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#else -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+#define SET_TX_DESC_USB_TXAGG_NUM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+#if (DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+#define SET_TX_DESC_SDIO_TXSEQ_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) -+#endif -+ -+/* Dword 8 */ -+#define SET_TX_DESC_HWSEQ_EN_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+ -+/* Dword 9 */ -+#define SET_TX_DESC_SEQ_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+ -+/* Dword 10 */ -+#define SET_TX_DESC_TX_BUFFER_ADDRESS_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) -+#define GET_TX_DESC_TX_BUFFER_ADDRESS_8188F(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) -+ -+/* Dword 11 */ -+#define SET_TX_DESC_NEXT_DESC_ADDRESS_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8188F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+#endif -+/* ----------------------------------------------------------- -+ * -+ * Rate -+ * -+ * ----------------------------------------------------------- -+ * CCK Rates, TxHT = 0 */ -+#define DESC8188F_RATE1M 0x00 -+#define DESC8188F_RATE2M 0x01 -+#define DESC8188F_RATE5_5M 0x02 -+#define DESC8188F_RATE11M 0x03 -+ -+/* OFDM Rates, TxHT = 0 */ -+#define DESC8188F_RATE6M 0x04 -+#define DESC8188F_RATE9M 0x05 -+#define DESC8188F_RATE12M 0x06 -+#define DESC8188F_RATE18M 0x07 -+#define DESC8188F_RATE24M 0x08 -+#define DESC8188F_RATE36M 0x09 -+#define DESC8188F_RATE48M 0x0a -+#define DESC8188F_RATE54M 0x0b -+ -+/* MCS Rates, TxHT = 1 */ -+#define DESC8188F_RATEMCS0 0x0c -+#define DESC8188F_RATEMCS1 0x0d -+#define DESC8188F_RATEMCS2 0x0e -+#define DESC8188F_RATEMCS3 0x0f -+#define DESC8188F_RATEMCS4 0x10 -+#define DESC8188F_RATEMCS5 0x11 -+#define DESC8188F_RATEMCS6 0x12 -+#define DESC8188F_RATEMCS7 0x13 -+#define DESC8188F_RATEMCS8 0x14 -+#define DESC8188F_RATEMCS9 0x15 -+#define DESC8188F_RATEMCS10 0x16 -+#define DESC8188F_RATEMCS11 0x17 -+#define DESC8188F_RATEMCS12 0x18 -+#define DESC8188F_RATEMCS13 0x19 -+#define DESC8188F_RATEMCS14 0x1a -+#define DESC8188F_RATEMCS15 0x1b -+#define DESC8188F_RATEVHTSS1MCS0 0x2c -+#define DESC8188F_RATEVHTSS1MCS1 0x2d -+#define DESC8188F_RATEVHTSS1MCS2 0x2e -+#define DESC8188F_RATEVHTSS1MCS3 0x2f -+#define DESC8188F_RATEVHTSS1MCS4 0x30 -+#define DESC8188F_RATEVHTSS1MCS5 0x31 -+#define DESC8188F_RATEVHTSS1MCS6 0x32 -+#define DESC8188F_RATEVHTSS1MCS7 0x33 -+#define DESC8188F_RATEVHTSS1MCS8 0x34 -+#define DESC8188F_RATEVHTSS1MCS9 0x35 -+#define DESC8188F_RATEVHTSS2MCS0 0x36 -+#define DESC8188F_RATEVHTSS2MCS1 0x37 -+#define DESC8188F_RATEVHTSS2MCS2 0x38 -+#define DESC8188F_RATEVHTSS2MCS3 0x39 -+#define DESC8188F_RATEVHTSS2MCS4 0x3a -+#define DESC8188F_RATEVHTSS2MCS5 0x3b -+#define DESC8188F_RATEVHTSS2MCS6 0x3c -+#define DESC8188F_RATEVHTSS2MCS7 0x3d -+#define DESC8188F_RATEVHTSS2MCS8 0x3e -+#define DESC8188F_RATEVHTSS2MCS9 0x3f -+ -+ -+#define RX_HAL_IS_CCK_RATE_8188F(pDesc)\ -+ (GET_RX_STATUS_DESC_RX_RATE_8188F(pDesc) == DESC8188F_RATE1M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8188F(pDesc) == DESC8188F_RATE2M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8188F(pDesc) == DESC8188F_RATE5_5M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8188F(pDesc) == DESC8188F_RATE11M) -+ -+ -+void rtl8188f_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); -+void rtl8188f_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+#if defined(CONFIG_CONCURRENT_MODE) -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+s32 rtl8188fs_init_xmit_priv(PADAPTER padapter); -+void rtl8188fs_free_xmit_priv(PADAPTER padapter); -+s32 rtl8188fs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8188fs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8188fs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8188fs_xmit_buf_handler(PADAPTER padapter); -+thread_return rtl8188fs_xmit_thread(thread_context context); -+#define hal_xmit_handler rtl8188fs_xmit_buf_handler -+#endif -+ -+#ifdef CONFIG_USB_HCI -+s32 rtl8188fu_xmit_buf_handler(PADAPTER padapter); -+#define hal_xmit_handler rtl8188fu_xmit_buf_handler -+ -+ -+s32 rtl8188fu_init_xmit_priv(PADAPTER padapter); -+void rtl8188fu_free_xmit_priv(PADAPTER padapter); -+s32 rtl8188fu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8188fu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8188fu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+/* s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); */ -+void rtl8188fu_xmit_tasklet(void *priv); -+s32 rtl8188fu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, struct tx_desc *ptxdesc); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8188fe_init_xmit_priv(PADAPTER padapter); -+void rtl8188fe_free_xmit_priv(PADAPTER padapter); -+struct xmit_buf *rtl8188fe_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+void rtl8188fe_xmitframe_resume(_adapter *padapter); -+s32 rtl8188fe_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8188fe_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8188fe_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+void rtl8188fe_xmit_tasklet(void *priv); -+#endif -+ -+u8 BWMapping_8188F(PADAPTER Adapter, struct pkt_attrib *pattrib); -+u8 SCMapping_8188F(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_cmd.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_cmd.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,161 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_CMD_H__ -+#define __RTL8192E_CMD_H__ -+ -+typedef enum _RTL8192E_H2C_CMD { -+ H2C_8192E_RSVDPAGE = 0x00, -+ H2C_8192E_MSRRPT = 0x01, -+ H2C_8192E_SCAN = 0x02, -+ H2C_8192E_KEEP_ALIVE_CTRL = 0x03, -+ H2C_8192E_DISCONNECT_DECISION = 0x04, -+ H2C_8192E_INIT_OFFLOAD = 0x06, -+ H2C_8192E_AP_OFFLOAD = 0x08, -+ H2C_8192E_BCN_RSVDPAGE = 0x09, -+ H2C_8192E_PROBERSP_RSVDPAGE = 0x0a, -+ -+ H2C_8192E_AP_WOW_GPIO_CTRL = 0x13, -+ -+ H2C_8192E_SETPWRMODE = 0x20, -+ H2C_8192E_PS_TUNING_PARA = 0x21, -+ H2C_8192E_PS_TUNING_PARA2 = 0x22, -+ H2C_8192E_PS_LPS_PARA = 0x23, -+ H2C_8192E_P2P_PS_OFFLOAD = 0x24, -+ H2C_8192E_SAP_PS = 0x26, -+ H2C_8192E_RA_MASK = 0x40, -+ H2C_8192E_RSSI_REPORT = 0x42, -+ H2C_8192E_RA_PARA_ADJUST = 0x46, -+ -+ H2C_8192E_WO_WLAN = 0x80, -+ H2C_8192E_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8192E_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8192E_AOAC_RSVDPAGE = 0x83, -+ -+ /* Not defined in new 88E H2C CMD Format */ -+ H2C_8192E_SELECTIVE_SUSPEND_ROF_CMD, -+ H2C_8192E_P2P_PS_MODE, -+ H2C_8192E_PSD_RESULT, -+ MAX_8192E_H2CCMD -+} RTL8192E_H2C_CMD; -+ -+struct cmd_msg_parm { -+ u8 eid; /* element id */ -+ u8 sz; /* sz */ -+ u8 buf[6]; -+}; -+ -+enum { -+ PWRS -+}; -+ -+typedef struct _SETPWRMODE_PARM { -+ u8 Mode;/* 0:Active,1:LPS,2:WMMPS */ -+ /* u8 RLBM:4; */ /* 0:Min,1:Max,2: User define */ -+ u8 SmartPS_RLBM;/* LPS=0:PS_Poll,1:PS_Poll,2:NullData,WMM=0:PS_Poll,1:NullData */ -+ u8 AwakeInterval; /* unit: beacon interval */ -+ u8 bAllQueueUAPSD; -+ u8 PwrState;/* AllON(0x0c),RFON(0x04),RFOFF(0x00) */ -+} SETPWRMODE_PARM, *PSETPWRMODE_PARM; -+ -+struct H2C_SS_RFOFF_PARAM { -+ u8 ROFOn; /* 1: on, 0:off */ -+ u16 gpio_period; /* unit: 1024 us */ -+} __attribute__((packed)); -+ -+ -+typedef struct JOINBSSRPT_PARM_92E { -+ u8 OpMode; /* RT_MEDIA_STATUS */ -+#ifdef CONFIG_WOWLAN -+ u8 MacID; /* MACID */ -+#endif /* CONFIG_WOWLAN */ -+} JOINBSSRPT_PARM_92E, *PJOINBSSRPT_PARM_92E; -+ -+/* move to hal_com_h2c.h -+typedef struct _RSVDPAGE_LOC_92E { -+ u8 LocProbeRsp; -+ u8 LocPsPoll; -+ u8 LocNullData; -+ u8 LocQosNull; -+ u8 LocBTQosNull; -+} RSVDPAGE_LOC_92E, *PRSVDPAGE_LOC_92E; -+*/ -+ -+ -+/* _SETPWRMODE_PARM */ -+#define SET_8192E_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8192E_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+#define GET_8192E_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+/* _P2P_PS_OFFLOAD */ -+#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_8192E_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+ -+ -+/* host message to firmware cmd */ -+void rtl8192e_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8192e_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); -+u8 rtl8192e_set_rssi_cmd(PADAPTER padapter, u8 *param); -+void rtl8192e_set_raid_cmd(PADAPTER padapter, u32 bitmap, u8 *arg, u8 bw); -+s32 FillH2CCmd_8192E(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8192E(_adapter *padapter, bool wowlan); -+/* u8 rtl8192c_set_FwSelectSuspend_cmd(PADAPTER padapter, u8 bfwpoll, u16 period); */ -+s32 c2h_handler_8192e(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); -+#ifdef CONFIG_BT_COEXIST -+ void rtl8192e_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif /* CONFIG_BT_COEXIST */ -+#ifdef CONFIG_P2P_PS -+ void rtl8192e_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif /* CONFIG_P2P */ -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+ -+#ifdef CONFIG_TDLS -+ #ifdef CONFIG_TDLS_CH_SW -+ void rtl8192e_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); -+ #endif -+#endif -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+ int reset_tsf(PADAPTER Adapter, u8 reset_port); -+#endif /* CONFIG_TSF_RESET_OFFLOAD */ -+ -+/* / TX Feedback Content */ -+#define USEC_UNIT_FOR_8192E_C2H_TX_RPT_QUEUE_TIME 256 -+ -+#define GET_8192E_C2H_TX_RPT_QUEUE_SELECT(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 5) -+#define GET_8192E_C2H_TX_RPT_PKT_BROCAST(_Header) LE_BITS_TO_1BYTE((_Header + 0), 5, 1) -+#define GET_8192E_C2H_TX_RPT_LIFE_TIME_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 6, 1) -+#define GET_8192E_C2H_TX_RPT_RETRY_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 7, 1) -+#define GET_8192E_C2H_TX_RPT_MAC_ID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) -+#define GET_8192E_C2H_TX_RPT_DATA_RETRY_CNT(_Header) LE_BITS_TO_1BYTE((_Header + 2), 0, 6) -+#define GET_8192E_C2H_TX_RPT_QUEUE_TIME(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) /* In unit of 256 microseconds. */ -+#define GET_8192E_C2H_TX_RPT_FINAL_DATA_RATE(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) -+ -+#endif /* __RTL8192E_CMD_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_dm.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_dm.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,33 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_DM_H__ -+#define __RTL8192E_DM_H__ -+ -+ -+void rtl8192e_init_dm_priv(IN PADAPTER Adapter); -+void rtl8192e_deinit_dm_priv(IN PADAPTER Adapter); -+void rtl8192e_InitHalDm(IN PADAPTER Adapter); -+void rtl8192e_HalDmWatchDog(IN PADAPTER Adapter); -+ -+/* VOID rtl8192c_dm_CheckTXPowerTracking(IN PADAPTER Adapter); */ -+ -+/* void rtl8192c_dm_RF_Saving(IN PADAPTER pAdapter, IN u8 bForceInNormal); */ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_hal.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,332 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_HAL_H__ -+#define __RTL8192E_HAL_H__ -+ -+/* #include "hal_com.h" */ -+ -+#include "hal_data.h" -+ -+/* include HAL Related header after HAL Related compiling flags */ -+#include "rtl8192e_spec.h" -+#include "rtl8192e_rf.h" -+#include "rtl8192e_dm.h" -+#include "rtl8192e_recv.h" -+#include "rtl8192e_xmit.h" -+#include "rtl8192e_cmd.h" -+#include "rtl8192e_led.h" -+#include "Hal8192EPwrSeq.h" -+#include "Hal8192EPhyReg.h" -+#include "Hal8192EPhyCfg.h" -+ -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ #include "rtl8192e_sreset.h" -+#endif -+ -+/* --------------------------------------------------------------------- -+ * RTL8192E Power Configuration CMDs for PCIe interface -+ * --------------------------------------------------------------------- */ -+#define Rtl8192E_NIC_PWR_ON_FLOW rtl8192E_power_on_flow -+#define Rtl8192E_NIC_RF_OFF_FLOW rtl8192E_radio_off_flow -+#define Rtl8192E_NIC_DISABLE_FLOW rtl8192E_card_disable_flow -+#define Rtl8192E_NIC_ENABLE_FLOW rtl8192E_card_enable_flow -+#define Rtl8192E_NIC_SUSPEND_FLOW rtl8192E_suspend_flow -+#define Rtl8192E_NIC_RESUME_FLOW rtl8192E_resume_flow -+#define Rtl8192E_NIC_PDN_FLOW rtl8192E_hwpdn_flow -+#define Rtl8192E_NIC_LPS_ENTER_FLOW rtl8192E_enter_lps_flow -+#define Rtl8192E_NIC_LPS_LEAVE_FLOW rtl8192E_leave_lps_flow -+ -+ -+#if 1 /* download firmware related data structure */ -+#define FW_SIZE_8192E 0x8000 /* Compatible with RTL8192e Maximal RAM code size 32k */ -+#define FW_START_ADDRESS 0x1000 -+#define FW_END_ADDRESS 0x5FFF -+ -+ -+#define IS_FW_HEADER_EXIST_8192E(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8192E(_pFwHdr) & 0xFFF0) == 0x92E0) -+ -+ -+ -+typedef struct _RT_FIRMWARE_8192E { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8 *szFwBuffer; -+#else -+ u8 szFwBuffer[FW_SIZE_8192E]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8192E, *PRT_FIRMWARE_8192E; -+ -+/* -+ * This structure must be cared byte-ordering -+ * -+ * Added by tynli. 2009.12.04. */ -+ -+/* ***************************************************** -+ * Firmware Header(8-byte alinment required) -+ * ***************************************************** -+ * --- LONG WORD 0 ---- */ -+#define GET_FIRMWARE_HDR_SIGNATURE_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 0, 16) /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ -+#define GET_FIRMWARE_HDR_CATEGORY_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 16, 8) /* AP/NIC and USB/PCI */ -+#define GET_FIRMWARE_HDR_FUNCTION_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 24, 8) /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ -+#define GET_FIRMWARE_HDR_VERSION_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 0, 16)/* FW Version */ -+#define GET_FIRMWARE_HDR_SUB_VER_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 16, 8) /* FW Subversion, default 0x00 */ -+#define GET_FIRMWARE_HDR_RSVD1_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 24, 8) -+ -+/* --- LONG WORD 1 ---- */ -+#define GET_FIRMWARE_HDR_MONTH_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 0, 8) /* Release time Month field */ -+#define GET_FIRMWARE_HDR_DATE_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 8, 8) /* Release time Date field */ -+#define GET_FIRMWARE_HDR_HOUR_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 16, 8)/* Release time Hour field */ -+#define GET_FIRMWARE_HDR_MINUTE_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 24, 8)/* Release time Minute field */ -+#define GET_FIRMWARE_HDR_ROMCODE_SIZE_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 0, 16)/* The size of RAM code */ -+#define GET_FIRMWARE_HDR_RSVD2_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 16, 16) -+ -+/* --- LONG WORD 2 ---- */ -+#define GET_FIRMWARE_HDR_SVN_IDX_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 0, 32)/* The SVN entry index */ -+#define GET_FIRMWARE_HDR_RSVD3_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 0, 32) -+ -+/* --- LONG WORD 3 ---- */ -+#define GET_FIRMWARE_HDR_RSVD4_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 0, 32) -+#define GET_FIRMWARE_HDR_RSVD5_8192E(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+28, 0, 32) -+ -+#endif /* download firmware related data structure */ -+ -+#define DRIVER_EARLY_INT_TIME_8192E 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8192E 0x02 -+#define RX_DMA_SIZE_8192E 0x4000 /* 16K*/ -+ -+#ifdef CONFIG_WOWLAN -+ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ -+#else -+ #define RESV_FMWF 0 -+#endif -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+ #define RX_DMA_RESERVED_SIZE_8192E 0x100 /* 256B, reserved for c2h debug message*/ -+#else -+ #define RX_DMA_RESERVED_SIZE_8192E 0x40 /* 64B, reserved for c2h event(16bytes) or ccx(8 Bytes)*/ -+#endif -+#define MAX_RX_DMA_BUFFER_SIZE_8192E (RX_DMA_SIZE_8192E-RX_DMA_RESERVED_SIZE_8192E) /*RX 16K*/ -+ -+/* For General Reserved Page Number(Beacon Queue is reserved page) -+ * if (CONFIG_2BCN_EN) Beacon:4, PS-Poll:1, Null Data:1,Prob Rsp:1,Qos Null Data:1 -+ * Beacon:2, PS-Poll:1, Null Data:1,Prob Rsp:1,Qos Null Data:1 */ -+#define RSVD_PAGE_NUM_8192E 0x08 -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8192E 0x07 -+#else -+ #define WOWLAN_PAGE_NUM_8192E 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+ #undef WOWLAN_PAGE_NUM_8192E -+ #define WOWLAN_PAGE_NUM_8192E 0x0d -+#endif -+ -+/* Note: -+Tx FIFO Size : 64KB -+Tx page Size : 256B -+Total page numbers : 256(0x100) -+*/ -+ -+#define TOTAL_RSVD_PAGE_NUMBER_8192E (RSVD_PAGE_NUM_8192E + WOWLAN_PAGE_NUM_8192E) -+ -+#define TOTAL_PAGE_NUMBER_8192E (0x100) -+#define TX_TOTAL_PAGE_NUMBER_8192E (TOTAL_PAGE_NUMBER_8192E - TOTAL_RSVD_PAGE_NUMBER_8192E) -+ -+#define TX_PAGE_BOUNDARY_8192E (TX_TOTAL_PAGE_NUMBER_8192E) /* beacon header start address */ -+ -+ -+#define PAGE_SIZE_TX_92E PAGE_SIZE_256 -+#define RSVD_PKT_LEN_92E (TOTAL_RSVD_PAGE_NUMBER_8192E * PAGE_SIZE_TX_92E) -+ -+#define TX_PAGE_LOAD_FW_BOUNDARY_8192E 0x47 /* 0xA5 */ -+#define TX_PAGE_BOUNDARY_WOWLAN_8192E 0xE0 -+ -+/* For Normal Chip Setting -+ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_92C */ -+ -+#define NORMAL_PAGE_NUM_HPQ_8192E 0x10 -+#define NORMAL_PAGE_NUM_LPQ_8192E 0x10 -+#define NORMAL_PAGE_NUM_NPQ_8192E 0x10 -+#define NORMAL_PAGE_NUM_EPQ_8192E 0x00 -+ -+ -+/* Note: For WMM Normal Chip Setting ,modify later */ -+#define WMM_NORMAL_PAGE_NUM_HPQ_8192E NORMAL_PAGE_NUM_HPQ_8192E -+#define WMM_NORMAL_PAGE_NUM_LPQ_8192E NORMAL_PAGE_NUM_LPQ_8192E -+#define WMM_NORMAL_PAGE_NUM_NPQ_8192E NORMAL_PAGE_NUM_NPQ_8192E -+ -+ -+/* ------------------------------------------------------------------------- -+ * Chip specific -+ * ------------------------------------------------------------------------- */ -+ -+/* pic buffer descriptor */ -+#define RTL8192EE_SEG_NUM TX_BUFFER_SEG_NUM -+#define TX_DESC_NUM_92E 128 -+#define RX_DESC_NUM_92E 128 -+ -+/* ------------------------------------------------------------------------- -+ * Channel Plan -+ * ------------------------------------------------------------------------- */ -+ -+#define HWSET_MAX_SIZE_8192E 512 -+ -+#define EFUSE_REAL_CONTENT_LEN_8192E 512 -+ -+#define EFUSE_MAP_LEN_8192E 512 -+#define EFUSE_MAX_SECTION_8192E 64 -+#define EFUSE_MAX_WORD_UNIT_8192E 4 -+#define EFUSE_IC_ID_OFFSET_8192E 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ -+#define AVAILABLE_EFUSE_ADDR_8192E(addr) (addr < EFUSE_REAL_CONTENT_LEN_8192E) -+/* -+ * To prevent out of boundary programming case, leave 1byte and program full section -+ * 9bytes + 1byt + 5bytes and pre 1byte. -+ * For worst case: -+ * | 1byte|----8bytes----|1byte|--5bytes--| -+ * | | Reserved(14bytes) | -+ * */ -+#define EFUSE_OOB_PROTECT_BYTES_8192E 15 /* PG data exclude header, dummy 6 bytes frome CP test and reserved 1byte. */ -+ -+ -+ -+/* ******************************************************** -+ * EFUSE for BT definition -+ * ******************************************************** */ -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN_8192E 512 -+#define EFUSE_BT_REAL_CONTENT_LEN_8192E 1024 /* 512*2 */ -+#define EFUSE_BT_MAP_LEN_8192E 1024 /* 1k bytes */ -+#define EFUSE_BT_MAX_SECTION_8192E 128 /* 1024/8 */ -+ -+#define EFUSE_PROTECT_BYTES_BANK_8192E 16 -+#define EFUSE_MAX_BANK_8192E 3 -+/* *********************************************************** */ -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+/* #define IS_MULTI_FUNC_CHIP(_Adapter) (((((PHAL_DATA_TYPE)(_Adapter->HalData))->MultiFunc) & (RT_MULTI_FUNC_BT|RT_MULTI_FUNC_GPS)) ? _TRUE : _FALSE) */ -+ -+/* #define RT_IS_FUNC_DISABLED(__pAdapter, __FuncBits) ( (__pAdapter)->DisabledFunctions & (__FuncBits) ) */ -+ -+/* rtl8812_hal_init.c */ -+void _8051Reset8192E(PADAPTER padapter); -+s32 FirmwareDownload8192E(PADAPTER Adapter, BOOLEAN bUsedWoWLANFw); -+void InitializeFirmwareVars8192E(PADAPTER padapter); -+ -+s32 InitLLTTable8192E(PADAPTER padapter, u8 txpktbuf_bndy); -+ -+/* EFuse */ -+u8 GetEEPROMSize8192E(PADAPTER padapter); -+void hal_InitPGData_8192E(PADAPTER padapter, u8 *PROMContent); -+void Hal_EfuseParseIDCode8192E(PADAPTER padapter, u8 *hwinfo); -+void Hal_ReadPROMVersion8192E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadPowerSavingMode8192E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadTxPowerInfo8192E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadBoardType8192E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadThermalMeter_8192E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_ReadChannelPlan8192E(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8192E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadAntennaDiversity8192E(PADAPTER pAdapter, u8 *PROMContent, BOOLEAN AutoLoadFail); -+void Hal_ReadPAType_8192E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_ReadAmplifierType_8192E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_ReadRFEType_8192E(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_EfuseParseBTCoexistInfo8192E(PADAPTER Adapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseKFreeData_8192E(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+ -+u8 Hal_CrystalAFEAdjust(_adapter *Adapter); -+ -+BOOLEAN HalDetectPwrDownMode8192E(PADAPTER Adapter); -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif /* CONFIG_WOWLAN */ -+ -+/***********************************************************/ -+/* RTL8192E-MAC Setting */ -+VOID _InitQueueReservedPage_8192E(IN PADAPTER Adapter); -+VOID _InitQueuePriority_8192E(IN PADAPTER Adapter); -+VOID _InitTxBufferBoundary_8192E(IN PADAPTER Adapter, IN u8 txpktbuf_bndy); -+VOID _InitPageBoundary_8192E(IN PADAPTER Adapter); -+/* VOID _InitTransferPageSize_8192E(IN PADAPTER Adapter); */ -+VOID _InitDriverInfoSize_8192E(IN PADAPTER Adapter, IN u8 drvInfoSize); -+VOID _InitRDGSetting_8192E(PADAPTER Adapter); -+void _InitID_8192E(IN PADAPTER Adapter); -+VOID _InitNetworkType_8192E(IN PADAPTER Adapter); -+VOID _InitWMACSetting_8192E(IN PADAPTER Adapter); -+VOID _InitAdaptiveCtrl_8192E(IN PADAPTER Adapter); -+VOID _InitRateFallback_8192E(IN PADAPTER Adapter); -+VOID _InitEDCA_8192E(IN PADAPTER Adapter); -+VOID _InitRetryFunction_8192E(IN PADAPTER Adapter); -+VOID _BBTurnOnBlock_8192E(IN PADAPTER Adapter); -+VOID _InitBeaconParameters_8192E(IN PADAPTER Adapter); -+VOID _InitBeaconMaxError_8192E( -+ IN PADAPTER Adapter, -+ IN BOOLEAN InfraMode -+); -+void SetBeaconRelatedRegisters8192E(PADAPTER padapter); -+VOID hal_ReadRFType_8192E(PADAPTER Adapter); -+/* RTL8192E-MAC Setting -+ ***********************************************************/ -+ -+void SetHwReg8192E(PADAPTER Adapter, u8 variable, u8 *val); -+void GetHwReg8192E(PADAPTER Adapter, u8 variable, u8 *val); -+u8 -+SetHalDefVar8192E( -+ IN PADAPTER Adapter, -+ IN HAL_DEF_VARIABLE eVariable, -+ IN PVOID pValue -+); -+u8 -+GetHalDefVar8192E( -+ IN PADAPTER Adapter, -+ IN HAL_DEF_VARIABLE eVariable, -+ IN PVOID pValue -+); -+ -+void rtl8192e_set_hal_ops(struct hal_ops *pHalFunc); -+void init_hal_spec_8192e(_adapter *adapter); -+void rtl8192e_init_default_value(_adapter *padapter); -+/* register */ -+void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); -+ -+void rtl8192e_start_thread(_adapter *padapter); -+void rtl8192e_stop_thread(_adapter *padapter); -+ -+#ifdef CONFIG_PCI_HCI -+ BOOLEAN InterruptRecognized8192EE(PADAPTER Adapter); -+ u16 get_txdesc_buf_addr(u16 ff_hwaddr); -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+ #ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT -+ void _init_available_page_threshold(PADAPTER padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ); -+ #endif -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ void rtl8192e_combo_card_WifiOnlyHwInit(PADAPTER Adapter); -+#endif -+ -+#endif /* __RTL8192E_HAL_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_led.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_led.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,40 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_LED_H__ -+#define __RTL8192E_LED_H__ -+ -+ -+/* ******************************************************************************** -+ * Interface to manipulate LED objects. -+ * ******************************************************************************** */ -+#ifdef CONFIG_USB_HCI -+ void rtl8192eu_InitSwLeds(PADAPTER padapter); -+ void rtl8192eu_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+ void rtl8192ee_InitSwLeds(PADAPTER padapter); -+ void rtl8192ee_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_SDIO_HCI -+ void rtl8192es_InitSwLeds(PADAPTER padapter); -+ void rtl8192es_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_recv.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_recv.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,173 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_RECV_H__ -+#define __RTL8192E_RECV_H__ -+ -+#if defined(CONFIG_USB_HCI) -+ -+ #ifndef MAX_RECVBUF_SZ -+ #ifdef PLATFORM_OS_CE -+ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ -+ #else -+ #ifdef CONFIG_MINIMAL_MEMORY_USAGE -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+ #else -+ #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ #define MAX_RECVBUF_SZ (rtw_rtkm_get_buff_size()) /*depend rtkm*/ -+ #elif defined(CONFIG_PLATFORM_HISILICON) -+ #define MAX_RECVBUF_SZ (16384) /* 16k */ -+ #else -+ #define MAX_RECVBUF_SZ (32768) /* 32k */ -+ #endif -+ /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ -+ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ -+ /* #define MAX_RECVBUF_SZ (16384) */ /* 16k - 92E RX BUF :16K */ -+ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ -+ #endif -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+ -+#elif defined(CONFIG_PCI_HCI) -+ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ -+ /* #define MAX_RECVBUF_SZ (9100) */ -+ /* #else */ -+ #define MAX_RECVBUF_SZ (4000) /* about 4K -+ * #endif */ -+ -+ -+#elif defined(CONFIG_SDIO_HCI) -+ -+ #define MAX_RECVBUF_SZ (16384) -+ -+#endif -+ -+ -+/* Rx smooth factor */ -+#define Rx_Smooth_Factor (20) -+ -+/* ************* -+ * [1] Rx Buffer Descriptor (for PCIE) buffer descriptor architecture -+ * DWORD 0 */ -+#define SET_RX_BUFFER_DESC_DATA_LENGTH_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_BUFFER_DESC_LS_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 15, 1, __Value) -+#define SET_RX_BUFFER_DESC_FS_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 1, __Value) -+#define SET_RX_BUFFER_DESC_TOTAL_LENGTH_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 15, __Value) -+ -+#define GET_RX_BUFFER_DESC_OWN_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+#define GET_RX_BUFFER_DESC_LS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_BUFFER_DESC_FS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 1) -+#define GET_RX_BUFFER_DESC_TOTAL_LENGTH_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 15) -+ -+ -+/* DWORD 1 */ -+#define SET_RX_BUFFER_PHYSICAL_LOW_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+4, 0, 32, __Value) -+#define GET_RX_BUFFER_PHYSICAL_LOW_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 0, 32) -+ -+/* DWORD 2 */ -+#define SET_RX_BUFFER_PHYSICAL_HIGH_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+8, 0, 32, __Value) -+ -+/* ************* -+ * [2] Rx Descriptor -+ * DWORD 0 */ -+#define GET_RX_STATUS_DESC_PKT_LEN_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICVERR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_EOR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+ -+ -+#define SET_RX_STATUS_DESC_PKT_LEN_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_92E(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) -+ -+/* DWORD 1 */ -+#define GET_RX_STATUS_DESC_MACID_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_MACID_VLD_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 12, 1) -+#define GET_RX_STATUS_DESC_AMSDU_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FITS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_CHKERR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_IPVER_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_IS_TCPUDP_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_CHK_VLD_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 31, 1) -+ -+/* DWORD 2 */ -+#define GET_RX_STATUS_DESC_SEQ_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) -+ -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_HWRSVD_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 24, 4) -+#define GET_RX_STATUS_DESC_FCS_OK_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 31, 1) -+#define GET_RX_STATUS_DESC_RPT_SEL_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) -+ -+/* DWORD 3 */ -+#define GET_RX_STATUS_DESC_RX_RATE_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) -+#define GET_RX_STATUS_DESC_DMA_AGG_NUM_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) -+ -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_WAKE_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) -+ -+ -+/* DWORD 5 */ -+#define GET_RX_STATUS_DESC_TSFL_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+ -+#ifdef CONFIG_SDIO_HCI -+ s32 rtl8192es_init_recv_priv(PADAPTER padapter); -+ void rtl8192es_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ void rtl8192eu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+ s32 rtl8192eu_init_recv_priv(PADAPTER padapter); -+ void rtl8192eu_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8192ee_init_recv_priv(PADAPTER padapter); -+ void rtl8192ee_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8192e_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8192E_RECV_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_rf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_rf.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,33 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_RF_H__ -+#define __RTL8192E_RF_H__ -+ -+VOID -+PHY_RF6052SetBandwidth8192E( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+ -+int -+PHY_RF6052_Config_8192E( -+ IN PADAPTER Adapter); -+ -+#endif/* __RTL8192E_RF_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_spec.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_spec.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,329 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8192E_SPEC_H__ -+#define __RTL8192E_SPEC_H__ -+ -+#include -+ -+#define HAL_NAV_UPPER_UNIT_8192E 128 /* micro-second */ -+ -+/* ************************************************************ -+ * 8192E Regsiter offset definition -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * -+ * ************************************************************ */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0000h ~ 0x00FFh System Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_SYS_SWR_CTRL1_8192E 0x0010 /* 1 Byte */ -+#define REG_SYS_SWR_CTRL2_8192E 0x0014 /* 1 Byte */ -+#define REG_AFE_CTRL1_8192E 0x0024 -+#define REG_AFE_CTRL2_8192E 0x0028 -+#define REG_AFE_CTRL3_8192E 0x002c -+ -+#define REG_PAD_CTRL1_8192E 0x0064 -+#define REG_SDIO_CTRL_8192E 0x0070 -+#define REG_OPT_CTRL_8192E 0x0074 -+#define REG_RF_B_CTRL_8192E 0x0076 -+#define REG_AFE_CTRL4_8192E 0x0078 -+#define REG_LDO_SWR_CTRL 0x007C -+#define REG_FW_DRV_MSG_8192E 0x0088 -+#define REG_HMEBOX_E2_E3_8192E 0x008C -+#define REG_HIMR0_8192E 0x00B0 -+#define REG_HISR0_8192E 0x00B4 -+#define REG_HIMR1_8192E 0x00B8 -+#define REG_HISR1_8192E 0x00BC -+ -+#define REG_SYS_CFG1_8192E 0x00F0 -+#define REG_SYS_CFG2_8192E 0x00FC -+/* ----------------------------------------------------- -+ * -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_PKTBUF_DBG_ADDR (REG_PKTBUF_DBG_CTRL) -+#define REG_RXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+2) -+#define REG_TXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+3) -+#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN -+ -+#define REG_RSVD3_8192E 0x0168 -+#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 -+#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 -+#define REG_C2HEVT_CMD_LEN_88XX 0x01AE -+ -+#define REG_HMEBOX_EXT0_8192E 0x01F0 -+#define REG_HMEBOX_EXT1_8192E 0x01F4 -+#define REG_HMEBOX_EXT2_8192E 0x01F8 -+#define REG_HMEBOX_EXT3_8192E 0x01FC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_DWBCN0_CTRL 0x0208 -+#define REG_DWBCN1_CTRL 0x0228 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0280h ~ 0x02FFh RXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RXDMA_8192E 0x0290 -+#define REG_EARLY_MODE_CONTROL_8192E 0x02BC -+ -+#define REG_RSVD5_8192E 0x02F0 -+#define REG_RSVD6_8192E 0x02F4 -+#define REG_RSVD7_8192E 0x02F8 -+#define REG_RSVD8_8192E 0x02FC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0300h ~ 0x03FFh PCIe -+ * -+ * ----------------------------------------------------- */ -+#define REG_PCIE_CTRL_REG_8192E 0x0300 -+#define REG_INT_MIG_8192E 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_TXBD_DESA_8192E 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_MGQ_TXBD_DESA_8192E 0x0310 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_TXBD_DESA_8192E 0x0318 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_TXBD_DESA_8192E 0x0320 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_TXBD_DESA_8192E 0x0328 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_TXBD_DESA_8192E 0x0330 /* TX BK Queue Descriptor Address */ -+#define REG_RXQ_RXBD_DESA_8192E 0x0338 /* RX Queue Descriptor Address */ -+#define REG_HI0Q_TXBD_DESA_8192E 0x0340 -+#define REG_HI1Q_TXBD_DESA_8192E 0x0348 -+#define REG_HI2Q_TXBD_DESA_8192E 0x0350 -+#define REG_HI3Q_TXBD_DESA_8192E 0x0358 -+#define REG_HI4Q_TXBD_DESA_8192E 0x0360 -+#define REG_HI5Q_TXBD_DESA_8192E 0x0368 -+#define REG_HI6Q_TXBD_DESA_8192E 0x0370 -+#define REG_HI7Q_TXBD_DESA_8192E 0x0378 -+#define REG_MGQ_TXBD_NUM_8192E 0x0380 -+#define REG_RX_RXBD_NUM_8192E 0x0382 -+#define REG_VOQ_TXBD_NUM_8192E 0x0384 -+#define REG_VIQ_TXBD_NUM_8192E 0x0386 -+#define REG_BEQ_TXBD_NUM_8192E 0x0388 -+#define REG_BKQ_TXBD_NUM_8192E 0x038A -+#define REG_HI0Q_TXBD_NUM_8192E 0x038C -+#define REG_HI1Q_TXBD_NUM_8192E 0x038E -+#define REG_HI2Q_TXBD_NUM_8192E 0x0390 -+#define REG_HI3Q_TXBD_NUM_8192E 0x0392 -+#define REG_HI4Q_TXBD_NUM_8192E 0x0394 -+#define REG_HI5Q_TXBD_NUM_8192E 0x0396 -+#define REG_HI6Q_TXBD_NUM_8192E 0x0398 -+#define REG_HI7Q_TXBD_NUM_8192E 0x039A -+#define REG_TSFTIMER_HCI_8192E 0x039C -+ -+/* Read Write Point */ -+#define REG_VOQ_TXBD_IDX_8192E 0x03A0 -+#define REG_VIQ_TXBD_IDX_8192E 0x03A4 -+#define REG_BEQ_TXBD_IDX_8192E 0x03A8 -+#define REG_BKQ_TXBD_IDX_8192E 0x03AC -+#define REG_MGQ_TXBD_IDX_8192E 0x03B0 -+#define REG_RXQ_TXBD_IDX_8192E 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8192E 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8192E 0x03BC -+#define REG_HI2Q_TXBD_IDX_8192E 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8192E 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8192E 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8192E 0x03CC -+#define REG_HI6Q_TXBD_IDX_8192E 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8192E 0x03D4 -+ -+#define REG_PCIE_HCPWM_8192EE 0x03D8 /* ?????? */ -+#define REG_PCIE_HRPWM_8192EE 0x03DC /* PCIe RPWM */ /* ?????? */ -+#define REG_DBI_WDATA_V1_8192E 0x03E8 -+#define REG_DBI_RDATA_V1_8192E 0x03EC -+#define REG_DBI_FLAG_V1_8192E 0x03F0 -+#define REG_MDIO_V1_8192E 0x3F4 -+#define REG_PCIE_MIX_CFG_8192E 0x3F8 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_TXBF_CTRL_8192E 0x042C -+#define REG_ARFR0_8192E 0x0444 -+#define REG_ARFR1_8192E 0x044C -+#define REG_CCK_CHECK_8192E 0x0454 -+#define REG_AMPDU_MAX_TIME_8192E 0x0456 -+#define REG_BCNQ1_BDNY_8192E 0x0457 -+ -+#define REG_AMPDU_MAX_LENGTH_8192E 0x0458 -+#define REG_WMAC_LBK_BUF_HD_8192E 0x045D -+#define REG_NDPA_OPT_CTRL_8192E 0x045F -+#define REG_DATA_SC_8192E 0x0483 -+#ifdef CONFIG_WOWLAN -+ #define REG_TXPKTBUF_IV_LOW 0x0484 -+ #define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif -+#define REG_ARFR2_8192E 0x048C -+#define REG_ARFR3_8192E 0x0494 -+#define REG_TXRPT_START_OFFSET 0x04AC -+#define REG_AMPDU_BURST_MODE_8192E 0x04BC -+#define REG_HT_SINGLE_AMPDU_8192E 0x04C7 -+#define REG_MACID_PKT_DROP0_8192E 0x04D0 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_CTWND_8192E 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8192E 0x0577 -+#define REG_SCH_TXCMD_8192E 0x05F8 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_MAC_CR_8192E 0x0600 -+ -+#define REG_MAC_TX_SM_STATE_8192E 0x06B4 -+ -+/* Power */ -+#define REG_BFMER0_INFO_8192E 0x06E4 -+#define REG_BFMER1_INFO_8192E 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8192E 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8192E 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8192E 0x06FC -+ -+/* Hardware Port 2 */ -+#define REG_BFMEE_SEL_8192E 0x0714 -+#define REG_SND_PTCL_CTRL_8192E 0x0718 -+ -+ -+/* ----------------------------------------------------- -+ * -+ * Redifine register definition for compatibility -+ * -+ * ----------------------------------------------------- */ -+ -+/* TODO: use these definition when using REG_xxx naming rule. -+ * NOTE: DO NOT Remove these definition. Use later. */ -+#define ISR_8192E REG_HISR0_8192E -+ -+/* ---------------------------------------------------------------------------- -+ * 8192E IMR/ISR bits (offset 0xB0, 8bits) -+ * ---------------------------------------------------------------------------- */ -+#define IMR_DISABLED_8192E 0 -+/* IMR DW0(0x00B0-00B3) Bit 0-31 */ -+#define IMR_TIMER2_8192E BIT31 /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8192E BIT30 /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8192E BIT29 /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8192E BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8192E BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8192E BIT26 /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8192E BIT25 /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8192E BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8192E BIT20 /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8192E BIT16 /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8192E BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8192E BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8192E BIT12 /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8192E BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_8192E BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_8192E BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_8192E BIT7 /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8192E BIT6 /* Management Queue DMA OK */ -+#define IMR_BKDOK_8192E BIT5 /* AC_BK DMA OK */ -+#define IMR_BEDOK_8192E BIT4 /* AC_BE DMA OK */ -+#define IMR_VIDOK_8192E BIT3 /* AC_VI DMA OK */ -+#define IMR_VODOK_8192E BIT2 /* AC_VO DMA OK */ -+#define IMR_RDU_8192E BIT1 /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8192E BIT0 /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_8192E BIT27 /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8192E BIT26 /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8192E BIT25 /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8192E BIT24 /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8192E BIT23 /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8192E BIT22 /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8192E BIT21 /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8192E BIT20 /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6_8192E BIT19 /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5_8192E BIT18 /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4_8192E BIT17 /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3_8192E BIT16 /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2_8192E BIT15 /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1_8192E BIT14 /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_ATIMEND_E_8192E BIT13 /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8192E BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_8192E BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_8192E BIT9 /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8192E BIT8 /* Receive FIFO Overflow */ -+ -+/* ---------------------------------------------------------------------------- -+ * 8192E Auto LLT bits (offset 0x224, 8bits) -+ * ---------------------------------------------------------------------------- -+ * 224 REG_AUTO_LLT -+ * move to hal_com_reg.h */ -+ -+/* ---------------------------------------------------------------------------- -+ * 8192E Auto LLT bits (offset 0x290, 32bits) -+ * ---------------------------------------------------------------------------- */ -+#define BIT_DMA_MODE BIT1 -+#define BIT_USB_RXDMA_AGG_EN BIT31 -+ -+/* ---------------------------------------------------------------------------- -+ * 8192E REG_SYS_CFG1 (offset 0xF0, 32bits) -+ * ---------------------------------------------------------------------------- */ -+#define BIT_SPSLDO_SEL BIT24 -+ -+ -+/* ---------------------------------------------------------------------------- -+ * 8192E REG_CCK_CHECK (offset 0x454, 8bits) -+ * ---------------------------------------------------------------------------- */ -+#define BIT_BCN_PORT_SEL BIT5 -+ -+/* **************************************************************************** -+ * Regsiter Bit and Content definition -+ * **************************************************************************** */ -+ -+/* 2 ACMHWCTRL 0x05C0 */ -+#define AcmHw_HwEn_8192E BIT(0) -+#define AcmHw_VoqEn_8192E BIT(1) -+#define AcmHw_ViqEn_8192E BIT(2) -+#define AcmHw_BeqEn_8192E BIT(3) -+#define AcmHw_VoqStatus_8192E BIT(5) -+#define AcmHw_ViqStatus_8192E BIT(6) -+#define AcmHw_BeqStatus_8192E BIT(7) -+ -+/* ******************************************************** -+ * General definitions -+ * ******************************************************** */ -+ -+#define MACID_NUM_8192E 128 -+#define SEC_CAM_ENT_NUM_8192E 64 -+#define HW_PORT_NUM_8192E 2 -+#define NSS_NUM_8192E 2 -+#define BAND_CAP_8192E (BAND_CAP_2G) -+#define BW_CAP_8192E (BW_CAP_20M | BW_CAP_40M) -+#define PROTO_CAP_8192E (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) -+ -+#endif /* __RTL8192E_SPEC_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_sreset.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_sreset.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL88812A_SRESET_H_ -+#define _RTL8812A_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ extern void rtl8192e_sreset_xmit_status_check(_adapter *padapter); -+ extern void rtl8192e_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_xmit.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8192e_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8192e_xmit.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,451 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8192E_XMIT_H__ -+#define __RTL8192E_XMIT_H__ -+ -+typedef struct txdescriptor_8192e { -+ /* Offset 0 */ -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 ls:1; -+ u32 fs:1; -+ u32 linip:1; -+ u32 noacm:1; -+ u32 gf:1; -+ u32 own:1; -+ -+ /* Offset 4 */ -+ u32 macid:6; -+ u32 rsvd0406:2; -+ u32 qsel:5; -+ u32 rd_nav_ext:1; -+ u32 lsig_txop_en:1; -+ u32 pifs:1; -+ u32 rate_id:4; -+ u32 navusehdr:1; -+ u32 en_desc_id:1; -+ u32 sectype:2; -+ u32 rsvd0424:2; -+ u32 pkt_offset:5; /* unit: 8 bytes */ -+ u32 rsvd0431:1; -+ -+ /* Offset 8 */ -+ u32 rts_rc:6; -+ u32 data_rc:6; -+ u32 agg_en:1; -+ u32 rd_en:1; -+ u32 bar_rty_th:2; -+ u32 bk:1; -+ u32 morefrag:1; -+ u32 raw:1; -+ u32 ccx:1; -+ u32 ampdu_density:3; -+ u32 bt_null:1; -+ u32 ant_sel_a:1; -+ u32 ant_sel_b:1; -+ u32 tx_ant_cck:2; -+ u32 tx_antl:2; -+ u32 tx_ant_ht:2; -+ -+ /* Offset 12 */ -+ u32 nextheadpage:8; -+ u32 tailpage:8; -+ u32 seq:12; -+ u32 cpu_handle:1; -+ u32 tag1:1; -+ u32 trigger_int:1; -+ u32 hwseq_en:1; -+ -+ /* Offset 16 */ -+ u32 rtsrate:5; -+ u32 ap_dcfe:1; -+ u32 hwseq_sel:2; -+ u32 userate:1; -+ u32 disrtsfb:1; -+ u32 disdatafb:1; -+ u32 cts2self:1; -+ u32 rtsen:1; -+ u32 hw_rts_en:1; -+ u32 port_id:1; -+ u32 pwr_status:3; -+ u32 wait_dcts:1; -+ u32 cts2ap_en:1; -+ u32 data_sc:2; -+ u32 data_stbc:2; -+ u32 data_short:1; -+ u32 data_bw:1; -+ u32 rts_short:1; -+ u32 rts_bw:1; -+ u32 rts_sc:2; -+ u32 vcs_stbc:2; -+ -+ /* Offset 20 */ -+ u32 datarate:6; -+ u32 sgi:1; -+ u32 try_rate:1; -+ u32 data_ratefb_lmt:5; -+ u32 rts_ratefb_lmt:4; -+ u32 rty_lmt_en:1; -+ u32 data_rt_lmt:6; -+ u32 usb_txagg_num:8; -+ -+ /* Offset 24 */ -+ u32 txagg_a:5; -+ u32 txagg_b:5; -+ u32 use_max_len:1; -+ u32 max_agg_num:5; -+ u32 mcsg1_max_len:4; -+ u32 mcsg2_max_len:4; -+ u32 mcsg3_max_len:4; -+ u32 mcs7_sgi_max_len:4; -+ -+ /* Offset 28 */ -+ u32 checksum:16; /* TxBuffSize(PCIe)/CheckSum(USB) */ -+ u32 mcsg4_max_len:4; -+ u32 mcsg5_max_len:4; -+ u32 mcsg6_max_len:4; -+ u32 mcs15_sgi_max_len:4; -+} TXDESC_8192E, *PTXDESC_8192E; -+ -+ -+ -+/* For 88e early mode */ -+#define SET_EARLYMODE_PKTNUM(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 3, __Value) -+#define SET_EARLYMODE_LEN0(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 12, __Value) -+#define SET_EARLYMODE_LEN1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 16, 12, __Value) -+#define SET_EARLYMODE_LEN2_1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 28, 4, __Value) -+#define SET_EARLYMODE_LEN2_2(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 8, __Value) -+#define SET_EARLYMODE_LEN3(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 8, 12, __Value) -+#define SET_EARLYMODE_LEN4(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 20, 12, __Value) -+ -+/* -+ * defined for TX DESC Operation -+ * */ -+ -+#define MAX_TID (15) -+ -+/* OFFSET 0 */ -+#define OFFSET_SZ 0 -+#define OFFSET_SHT 16 -+#define BMC BIT(24) -+#define LSG BIT(26) -+#define FSG BIT(27) -+#define OWN BIT(31) -+ -+ -+/* OFFSET 4 */ -+#define PKT_OFFSET_SZ 0 -+#define QSEL_SHT 8 -+#define RATE_ID_SHT 16 -+#define NAVUSEHDR BIT(20) -+#define SEC_TYPE_SHT 22 -+#define PKT_OFFSET_SHT 26 -+ -+/* OFFSET 8 */ -+#define AGG_EN BIT(12) -+#define AGG_BK BIT(16) -+#define AMPDU_DENSITY_SHT 20 -+#define ANTSEL_A BIT(24) -+#define ANTSEL_B BIT(25) -+#define TX_ANT_CCK_SHT 26 -+#define TX_ANTL_SHT 28 -+#define TX_ANT_HT_SHT 30 -+ -+/* OFFSET 12 */ -+#define SEQ_SHT 16 -+#define EN_HWSEQ BIT(31) -+ -+/* OFFSET 16 */ -+#define QOS BIT(6) -+#define HW_SSN BIT(7) -+#define USERATE BIT(8) -+#define DISDATAFB BIT(10) -+#define CTS_2_SELF BIT(11) -+#define RTS_EN BIT(12) -+#define HW_RTS_EN BIT(13) -+#define DATA_SHORT BIT(24) -+#define PWR_STATUS_SHT 15 -+#define DATA_SC_SHT 20 -+#define DATA_BW BIT(25) -+ -+/* OFFSET 20 */ -+#define RTY_LMT_EN BIT(17) -+ -+ -+/* OFFSET 20 */ -+#define SGI BIT(6) -+#define USB_TXAGG_NUM_SHT 24 -+ -+ -+/* *****Tx Desc Buffer content */ -+ -+/* config element for each tx buffer -+ * -+#define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16), 0, 16, __Valeu) -+#define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16), 31, 1, __Valeu) -+#define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16)+4, 0, 32, __Valeu) -+#define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16)+8, 0, 32, __Valeu) -+*/ -+#define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 0, 16, __Valeu) -+#define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 31, 1, __Valeu) -+#define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8)+4, 0, 32, __Valeu) -+#define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*16)+8, 0, 32, __Valeu) -+ -+ -+/* Dword 0 */ -+#define SET_TX_BUFF_DESC_LEN_0_92E(__pTxDesc, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 14, __Valeu) -+#define SET_TX_BUFF_DESC_PSB_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 15, __Value) -+#define SET_TX_BUFF_DESC_OWN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+/* Dword 1 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_0_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 32, __Value) -+#define GET_TX_DESC_TX_BUFFER_ADDRESS_92E(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+4, 0, 32) -+ -+ -+/* Dword 2 */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_0_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 32, __Value) -+/* Dword 3, RESERVED */ -+ -+ -+/* *****Tx Desc content -+ * Dword 0 */ -+#define SET_TX_DESC_PKT_SIZE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_LAST_SEG_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+#define SET_TX_DESC_FIRST_SEG_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_LINIP_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+#define SET_TX_DESC_NO_ACM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+#define SET_TX_DESC_OWN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+#define GET_TX_DESC_OWN_92E(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+/* Dword 1 */ -+#define SET_TX_DESC_MACID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+#define SET_TX_DESC_MORE_DATA_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 29, 1, __Value) -+#define SET_TX_DESC_TXOP_PS_CAP_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 30, 1, __Value) -+#define SET_TX_DESC_TXOP_PS_MODE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 31, 1, __Value) -+ -+ -+/* Dword 2 */ -+#define SET_TX_DESC_PAID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_NULL_0_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 14, 1, __Value) -+#define SET_TX_DESC_NULL_1_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 15, 1, __Value) -+#define SET_TX_DESC_BK_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define GET_TX_DESC_MORE_FRAG_92E(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 17, 1) -+#define SET_TX_DESC_SPE_RPT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_NULL_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_GID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+ -+ -+/* Dword 3 */ -+#define SET_TX_DESC_WHEADER_LEN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) -+#define SET_TX_DESC_CHK_EN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) -+#define SET_TX_DESC_EARLY_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HWSEQ_SEL_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_HW_PORT_ID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+/* Dword 4 */ -+#define SET_TX_DESC_TX_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_TRY_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 7, 1, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+#define SET_TX_DESC_PCTS_ENABLE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 29, 1, __Value) -+#define SET_TX_DESC_PCTS_MASK_IDX_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 30, 2, __Value) -+ -+ -+/* Dword 5 */ -+#define SET_TX_DESC_DATA_SC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_VCS_STBC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+#define SET_TX_DESC_TX_ANT_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 4, __Value) -+#define SET_TX_DESC_TX_POWER_0_PSET_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 28, 3, __Value) -+ -+/* Dword 6 */ -+#define SET_TX_DESC_SW_DEFINE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_MBSSID_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+#define SET_TX_DESC_ANTSEL_A_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+#define SET_TX_DESC_ANTSEL_B_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+#define SET_TX_DESC_ANTSEL_C_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) -+#define SET_TX_DESC_ANTSEL_D_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) -+ -+/* Dword 7 */ -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ #define SET_TX_DESC_TX_BUFFER_SIZE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#else -+ #define SET_TX_DESC_TX_DESC_CHECKSUM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+#define SET_TX_DESC_USB_TXAGG_NUM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+ -+ -+/* #define SET_TX_DESC_HWSEQ_EN_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) */ -+/* Dword 8 */ -+ -+#define SET_TX_DESC_RTS_RC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 6, __Value) -+#define SET_TX_DESC_BAR_RTY_TH_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 6, 2, __Value) -+#define SET_TX_DESC_DATA_RC_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) -+#define SET_TX_DESC_EN_HWSEQ_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+#define SET_TX_DESC_NEXT_HEAD_PAGE_92E(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) -+#define SET_TX_DESC_TAIL_PAGE_92E(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) -+ -+/* Dword 9 */ -+#define SET_TX_DESC_PADDING_LENGTH_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 11, __Value) -+#define SET_TX_DESC_TXBF_PATH_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 11, 1, __Value) -+#define SET_TX_DESC_SEQ_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+#define SET_TX_DESC_FINAL_DATA_RATE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 24, 8, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_92E(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+void rtl8192e_cal_txdesc_chksum(u8 *ptxdesc); -+ -+#ifdef CONFIG_USB_HCI -+ s32 rtl8192eu_init_xmit_priv(PADAPTER padapter); -+ void rtl8192eu_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8192eu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8192eu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8192eu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8192eu_xmit_buf_handler(PADAPTER padapter); -+ #define hal_xmit_handler rtl8192eu_xmit_buf_handler -+ void rtl8192eu_xmit_tasklet(void *priv); -+ s32 rtl8192eu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8192ee_init_xmit_priv(PADAPTER padapter); -+ void rtl8192ee_free_xmit_priv(PADAPTER padapter); -+ struct xmit_buf *rtl8192ee_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+ s32 rtl8192ee_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ void rtl8192ee_xmitframe_resume(_adapter *padapter); -+ s32 rtl8192ee_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8192ee_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ void rtl8192ee_xmit_tasklet(void *priv); -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ s32 rtl8192es_init_xmit_priv(PADAPTER padapter); -+ void rtl8192es_free_xmit_priv(PADAPTER padapter); -+ -+ s32 rtl8192es_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8192es_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8192es_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ thread_return rtl8192es_xmit_thread(thread_context context); -+ s32 rtl8192es_xmit_buf_handler(PADAPTER padapter); -+ -+ #ifdef CONFIG_SDIO_TX_TASKLET -+ void rtl8192es_xmit_tasklet(void *priv); -+ #endif -+#endif -+ -+struct txrpt_ccx_92e { -+ /* offset 0 */ -+ u8 tag1:1; -+ u8 pkt_num:3; -+ u8 txdma_underflow:1; -+ u8 int_bt:1; -+ u8 int_tri:1; -+ u8 int_ccx:1; -+ -+ /* offset 1 */ -+ u8 mac_id:6; -+ u8 pkt_ok:1; -+ u8 bmc:1; -+ -+ /* offset 2 */ -+ u8 retry_cnt:6; -+ u8 lifetime_over:1; -+ u8 retry_over:1; -+ -+ /* offset 3 */ -+ u8 ccx_qtime0; -+ u8 ccx_qtime1; -+ -+ /* offset 5 */ -+ u8 final_data_rate; -+ -+ /* offset 6 */ -+ u8 sw1:4; -+ u8 qsel:4; -+ -+ /* offset 7 */ -+ u8 sw0; -+}; -+ -+#ifdef CONFIG_TX_EARLY_MODE -+ void UpdateEarlyModeInfo8192E(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif -+s32 rtl8192e_init_xmit_priv(_adapter *padapter); -+void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, u8 *ptxdesc); -+ -+void rtl8192e_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, -+ u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+void rtl8192e_cal_txdesc_chksum(u8 *ptxdesc); -+ -+u8 BWMapping_92E(PADAPTER Adapter, struct pkt_attrib *pattrib); -+u8 SCMapping_92E(PADAPTER Adapter, struct pkt_attrib *pattrib); -+void fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); -+void fill_txdesc_vcs(struct pkt_attrib *pattrib, u8 *ptxdesc); -+#if defined(CONFIG_CONCURRENT_MODE) -+ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+#endif -+void fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void rtl8192e_fixed_rate(_adapter *padapter, u8 *ptxdesc); -+ -+#endif /* __RTL8192E_XMIT_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_cmd.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_cmd.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,218 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_CMD_H__ -+#define __RTL8703B_CMD_H__ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+enum h2c_cmd_8703B { -+ /* Common Class: 000 */ -+ H2C_8703B_RSVD_PAGE = 0x00, -+ H2C_8703B_MEDIA_STATUS_RPT = 0x01, -+ H2C_8703B_SCAN_ENABLE = 0x02, -+ H2C_8703B_KEEP_ALIVE = 0x03, -+ H2C_8703B_DISCON_DECISION = 0x04, -+ H2C_8703B_PSD_OFFLOAD = 0x05, -+ H2C_8703B_AP_OFFLOAD = 0x08, -+ H2C_8703B_BCN_RSVDPAGE = 0x09, -+ H2C_8703B_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_8703B_FCS_RSVDPAGE = 0x10, -+ H2C_8703B_FCS_INFO = 0x11, -+ H2C_8703B_AP_WOW_GPIO_CTRL = 0x13, -+ -+ /* PoweSave Class: 001 */ -+ H2C_8703B_SET_PWR_MODE = 0x20, -+ H2C_8703B_PS_TUNING_PARA = 0x21, -+ H2C_8703B_PS_TUNING_PARA2 = 0x22, -+ H2C_8703B_P2P_LPS_PARAM = 0x23, -+ H2C_8703B_P2P_PS_OFFLOAD = 0x24, -+ H2C_8703B_PS_SCAN_ENABLE = 0x25, -+ H2C_8703B_SAP_PS_ = 0x26, -+ H2C_8703B_INACTIVE_PS_ = 0x27, /* Inactive_PS */ -+ H2C_8703B_FWLPS_IN_IPS_ = 0x28, -+ -+ /* Dynamic Mechanism Class: 010 */ -+ H2C_8703B_MACID_CFG = 0x40, -+ H2C_8703B_TXBF = 0x41, -+ H2C_8703B_RSSI_SETTING = 0x42, -+ H2C_8703B_AP_REQ_TXRPT = 0x43, -+ H2C_8703B_INIT_RATE_COLLECT = 0x44, -+ H2C_8703B_RA_PARA_ADJUST = 0x46, -+ -+ /* BT Class: 011 */ -+ H2C_8703B_B_TYPE_TDMA = 0x60, -+ H2C_8703B_BT_INFO = 0x61, -+ H2C_8703B_FORCE_BT_TXPWR = 0x62, -+ H2C_8703B_BT_IGNORE_WLANACT = 0x63, -+ H2C_8703B_DAC_SWING_VALUE = 0x64, -+ H2C_8703B_ANT_SEL_RSV = 0x65, -+ H2C_8703B_WL_OPMODE = 0x66, -+ H2C_8703B_BT_MP_OPER = 0x67, -+ H2C_8703B_BT_CONTROL = 0x68, -+ H2C_8703B_BT_WIFI_CTRL = 0x69, -+ H2C_8703B_BT_FW_PATCH = 0x6A, -+ H2C_8703B_BT_WLAN_CALIBRATION = 0x6D, -+ -+ /* WOWLAN Class: 100 */ -+ H2C_8703B_WOWLAN = 0x80, -+ H2C_8703B_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8703B_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8703B_AOAC_RSVD_PAGE = 0x83, -+ H2C_8703B_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_8703B_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_8703B_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_8703B_CHNL_SWITCH_OFFLOAD = 0x87, -+ H2C_8703B_P2P_OFFLOAD_RSVD_PAGE = 0x8A, -+ H2C_8703B_P2P_OFFLOAD = 0x8B, -+ -+ H2C_8703B_RESET_TSF = 0xC0, -+ H2C_8703B_MAXID, -+}; -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- -+ * _RSVDPAGE_LOC_CMD_0x00 */ -+#define SET_8703B_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8703B_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8703B_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8703B_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8703B_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+/* _KEEP_ALIVE_CMD_0x03 */ -+#define SET_8703B_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8703B_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8703B_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8703B_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _DISCONNECT_DECISION_CMD_0x04 */ -+#define SET_8703B_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8703B_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8703B_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8703B_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+ -+/* _PWR_MOD_CMD_0x20 */ -+#define SET_8703B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8703B_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+#define GET_8703B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+/* _PS_TUNE_PARAM_CMD_0x21 */ -+#define SET_8703B_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8703B_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8703B_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) -+#define SET_8703B_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) -+#define SET_8703B_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _MACID_CFG_CMD_0x40 */ -+#define SET_8703B_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) -+#define SET_8703B_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) -+ -+/* _RSSI_SETTING_CMD_0x42 */ -+#define SET_8703B_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8703B_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) -+#define SET_8703B_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _AP_REQ_TXRPT_CMD_0x43 */ -+#define SET_8703B_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8703B_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _FORCE_BT_TXPWR_CMD_0x62 */ -+#define SET_8703B_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+ -+/* _FORCE_BT_MP_OPER_CMD_0x67 */ -+#define SET_8703B_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_8703B_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_8703B_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8703B_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+#define SET_8703B_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8703B_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+ -+/* _BT_FW_PATCH_0x6A */ -+#define SET_8703B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) -+#define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ------------------------------------------- Structure -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- Function Statement -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+/* host message to firmware cmd */ -+void rtl8703b_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8703b_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -+void rtl8703b_set_rssi_cmd(PADAPTER padapter, u8 *param); -+void rtl8703b_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); -+/* s32 rtl8703b_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ -+void rtl8703b_set_FwPsTuneParam_cmd(PADAPTER padapter); -+void rtl8703b_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); -+void rtl8703b_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); -+void rtl8703b_download_rsvd_page(PADAPTER padapter, u8 mstatus); -+#ifdef CONFIG_BT_COEXIST -+ void rtl8703b_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif /* CONFIG_BT_COEXIST */ -+#ifdef CONFIG_P2P -+ void rtl8703b_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif /* CONFIG_P2P */ -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+ -+#ifdef CONFIG_TDLS -+ #ifdef CONFIG_TDLS_CH_SW -+ void rtl8703b_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); -+ #endif -+#endif -+ -+#ifdef CONFIG_P2P_WOWLAN -+ void rtl8703b_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+void rtl8703b_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+ u8 rtl8703b_reset_tsf(_adapter *padapter, u8 reset_port); -+#endif /* CONFIG_TSF_RESET_OFFLOAD */ -+s32 FillH2CCmd8703B(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8703B(_adapter *padapter, bool wowlan); -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_dm.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_dm.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,47 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_DM_H__ -+#define __RTL8703B_DM_H__ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for 8703B dynamic mechanism only -+ * -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * structure and define -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * function prototype -+ * ************************************************************ */ -+ -+void rtl8703b_init_dm_priv(PADAPTER padapter); -+void rtl8703b_deinit_dm_priv(PADAPTER padapter); -+ -+void rtl8703b_InitHalDm(PADAPTER padapter); -+void rtl8703b_HalDmWatchDog(PADAPTER padapter); -+void rtl8703b_HalDmWatchDog_in_LPS(PADAPTER padapter); -+void rtl8703b_hal_dm_in_lps(PADAPTER padapter); -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_hal.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,277 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_HAL_H__ -+#define __RTL8703B_HAL_H__ -+ -+#include "hal_data.h" -+ -+#include "rtl8703b_spec.h" -+#include "rtl8703b_rf.h" -+#include "rtl8703b_dm.h" -+#include "rtl8703b_recv.h" -+#include "rtl8703b_xmit.h" -+#include "rtl8703b_cmd.h" -+#include "rtl8703b_led.h" -+#include "Hal8703BPwrSeq.h" -+#include "Hal8703BPhyReg.h" -+#include "Hal8703BPhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+ #include "rtl8703b_sreset.h" -+#endif -+ -+#define FW_8703B_SIZE 0x8000 -+#define FW_8703B_START_ADDRESS 0x1000 -+#define FW_8703B_END_ADDRESS 0x1FFF /* 0x5FFF */ -+ -+#define IS_FW_HEADER_EXIST_8703B(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature) & 0xFFF0) == 0x03B0) -+ -+typedef struct _RT_FIRMWARE { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8 *szFwBuffer; -+#else -+ u8 szFwBuffer[FW_8703B_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8703B, *PRT_FIRMWARE_8703B; -+ -+/* -+ * This structure must be cared byte-ordering -+ * -+ * Added by tynli. 2009.12.04. */ -+typedef struct _RT_8703B_FIRMWARE_HDR { -+ /* 8-byte alinment required */ -+ -+ /* --- LONG WORD 0 ---- */ -+ u16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ -+ u8 Category; /* AP/NIC and USB/PCI */ -+ u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ -+ u16 Version; /* FW Version */ -+ u16 Subversion; /* FW Subversion, default 0x00 */ -+ -+ /* --- LONG WORD 1 ---- */ -+ u8 Month; /* Release time Month field */ -+ u8 Date; /* Release time Date field */ -+ u8 Hour; /* Release time Hour field */ -+ u8 Minute; /* Release time Minute field */ -+ u16 RamCodeSize; /* The size of RAM code */ -+ u16 Rsvd2; -+ -+ /* --- LONG WORD 2 ---- */ -+ u32 SvnIdx; /* The SVN entry index */ -+ u32 Rsvd3; -+ -+ /* --- LONG WORD 3 ---- */ -+ u32 Rsvd4; -+ u32 Rsvd5; -+} RT_8703B_FIRMWARE_HDR, *PRT_8703B_FIRMWARE_HDR; -+ -+#define DRIVER_EARLY_INT_TIME_8703B 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8703B 0x02 -+ -+/* for 8703B -+ * TX 32K, RX 16K, Page size 128B for TX, 8B for RX */ -+#define PAGE_SIZE_TX_8703B 128 -+#define PAGE_SIZE_RX_8703B 8 -+ -+#define TX_DMA_SIZE_8703B 0x8000 /* 32K(TX) */ -+#define RX_DMA_SIZE_8703B 0x4000 /* 16K(RX) */ -+ -+#ifdef CONFIG_WOWLAN -+ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ -+#else -+ #define RESV_FMWF 0 -+#endif -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+ #define RX_DMA_RESERVED_SIZE_8703B 0x100 /* 256B, reserved for c2h debug message */ -+#else -+ #define RX_DMA_RESERVED_SIZE_8703B 0x80 /* 128B, reserved for tx report */ -+#endif -+#define RX_DMA_BOUNDARY_8703B (RX_DMA_SIZE_8703B - RX_DMA_RESERVED_SIZE_8703B - 1) -+ -+ -+/* Note: We will divide number of page equally for each queue other than public queue! */ -+ -+/* For General Reserved Page Number(Beacon Queue is reserved page) -+ * Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 */ -+#define BCNQ_PAGE_NUM_8703B 0x08 -+#ifdef CONFIG_CONCURRENT_MODE -+ #define BCNQ1_PAGE_NUM_8703B 0x08 /* 0x04 */ -+#else -+ #define BCNQ1_PAGE_NUM_8703B 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+ #undef BCNQ1_PAGE_NUM_8703B -+ #define BCNQ1_PAGE_NUM_8703B 0x00 /* 0x04 */ -+#endif -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8703B 0x07 -+#else -+ #define WOWLAN_PAGE_NUM_8703B 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+ #undef WOWLAN_PAGE_NUM_8703B -+ #define WOWLAN_PAGE_NUM_8703B 0x15 -+#endif -+ -+#ifdef CONFIG_AP_WOWLAN -+ #define AP_WOWLAN_PAGE_NUM_8703B 0x02 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8703B (0xFF - BCNQ_PAGE_NUM_8703B - BCNQ1_PAGE_NUM_8703B - WOWLAN_PAGE_NUM_8703B) -+#define TX_PAGE_BOUNDARY_8703B (TX_TOTAL_PAGE_NUMBER_8703B + 1) -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8703B TX_TOTAL_PAGE_NUMBER_8703B -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8703B (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8703B + 1) -+ -+/* For Normal Chip Setting -+ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8703B */ -+#define NORMAL_PAGE_NUM_HPQ_8703B 0x0C -+#define NORMAL_PAGE_NUM_LPQ_8703B 0x02 -+#define NORMAL_PAGE_NUM_NPQ_8703B 0x02 -+ -+/* Note: For Normal Chip Setting, modify later */ -+#define WMM_NORMAL_PAGE_NUM_HPQ_8703B 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8703B 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8703B 0x20 -+ -+ -+#include "HalVerDef.h" -+#include "hal_com.h" -+ -+#define EFUSE_OOB_PROTECT_BYTES 15 -+ -+#define HAL_EFUSE_MEMORY -+ -+#define HWSET_MAX_SIZE_8703B 256 -+#define EFUSE_REAL_CONTENT_LEN_8703B 256 -+#define EFUSE_MAP_LEN_8703B 512 -+#define EFUSE_MAX_SECTION_8703B 64 -+ -+#define EFUSE_IC_ID_OFFSET 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ -+#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8703B) -+ -+#define EFUSE_ACCESS_ON 0x69 -+#define EFUSE_ACCESS_OFF 0x00 -+ -+/* ******************************************************** -+ * EFUSE for BT definition -+ * ******************************************************** */ -+#define BANK_NUM 1 -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN 128 -+#define EFUSE_BT_REAL_CONTENT_LEN (EFUSE_BT_REAL_BANK_CONTENT_LEN * BANK_NUM) -+#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ -+#define EFUSE_BT_MAX_SECTION (EFUSE_BT_MAP_LEN / 8) -+#define EFUSE_PROTECT_BYTES_BANK 16 -+ -+typedef enum tag_Package_Definition { -+ PACKAGE_DEFAULT, -+ PACKAGE_QFN68, -+ PACKAGE_TFBGA90, -+ PACKAGE_TFBGA80, -+ PACKAGE_TFBGA79 -+} PACKAGE_TYPE_E; -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+/* rtl8703b_hal_init.c */ -+s32 rtl8703b_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); -+void rtl8703b_FirmwareSelfReset(PADAPTER padapter); -+void rtl8703b_InitializeFirmwareVars(PADAPTER padapter); -+ -+void rtl8703b_InitAntenna_Selection(PADAPTER padapter); -+void rtl8703b_DeinitAntenna_Selection(PADAPTER padapter); -+void rtl8703b_CheckAntenna_Selection(PADAPTER padapter); -+void rtl8703b_init_default_value(PADAPTER padapter); -+ -+s32 rtl8703b_InitLLTTable(PADAPTER padapter); -+ -+s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); -+s32 CardDisableWithoutHWSM(PADAPTER padapter); -+ -+/* EFuse */ -+u8 GetEEPROMSize8703B(PADAPTER padapter); -+void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); -+void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); -+void Hal_EfuseParseTxPowerInfo_8703B(PADAPTER padapter, u8 *PROMContent, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseBTCoexistInfo_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseEEPROMVer_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseChnlPlan_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseCustomerID_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseAntennaDiversity_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8703B(PADAPTER pAdapter, u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseThermalMeter_8703B(PADAPTER padapter, u8 *hwinfo, u8 AutoLoadFail); -+VOID Hal_EfuseParseVoltage_8703B(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+VOID Hal_EfuseParseBoardType_8703B(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+ -+void rtl8703b_set_hal_ops(struct hal_ops *pHalFunc); -+void init_hal_spec_8703b(_adapter *adapter); -+void SetHwReg8703B(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg8703B(PADAPTER padapter, u8 variable, u8 *val); -+u8 SetHalDefVar8703B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8703B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+ -+/* register */ -+void rtl8703b_InitBeaconParameters(PADAPTER padapter); -+void rtl8703b_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); -+void _InitBurstPktLen_8703BS(PADAPTER Adapter); -+void _InitLTECoex_8703BS(PADAPTER Adapter); -+void _InitMacAPLLSetting_8703B(PADAPTER Adapter); -+void _8051Reset8703(PADAPTER padapter); -+#ifdef CONFIG_WOWLAN -+ void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif /* CONFIG_WOWLAN */ -+ -+void rtl8703b_start_thread(_adapter *padapter); -+void rtl8703b_stop_thread(_adapter *padapter); -+ -+#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) -+ void rtl8703bs_init_checkbthang_workqueue(_adapter *adapter); -+ void rtl8703bs_free_checkbthang_workqueue(_adapter *adapter); -+ void rtl8703bs_cancle_checkbthang_workqueue(_adapter *adapter); -+ void rtl8703bs_hal_check_bt_hang(_adapter *adapter); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); -+#endif -+#ifdef CONFIG_MP_INCLUDED -+int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); -+#endif -+void CCX_FwC2HTxRpt_8703b(PADAPTER padapter, u8 *pdata, u8 len); -+ -+u8 MRateToHwRate8703B(u8 rate); -+u8 HwRateToMRate8703B(u8 rate); -+ -+void Hal_ReadRFGainOffset(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+ -+#ifdef CONFIG_PCI_HCI -+ BOOLEAN InterruptRecognized8703BE(PADAPTER Adapter); -+ VOID UpdateInterruptMask8703BE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_led.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_led.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_LED_H__ -+#define __RTL8703B_LED_H__ -+ -+#include -+#include -+#include -+ -+ -+/* ******************************************************************************** -+ * Interface to manipulate LED objects. -+ * ******************************************************************************** */ -+#ifdef CONFIG_USB_HCI -+ void rtl8703bu_InitSwLeds(PADAPTER padapter); -+ void rtl8703bu_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_SDIO_HCI -+ void rtl8703bs_InitSwLeds(PADAPTER padapter); -+ void rtl8703bs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_GSPI_HCI -+ void rtl8703bs_InitSwLeds(PADAPTER padapter); -+ void rtl8703bs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+ void rtl8703be_InitSwLeds(PADAPTER padapter); -+ void rtl8703be_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_recv.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_recv.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,91 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_RECV_H__ -+#define __RTL8703B_RECV_H__ -+ -+#define RECV_BLK_SZ 512 -+#define RECV_BLK_CNT 16 -+#define RECV_BLK_TH RECV_BLK_CNT -+ -+#if defined(CONFIG_USB_HCI) -+ -+ #ifndef MAX_RECVBUF_SZ -+ #ifdef PLATFORM_OS_CE -+ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ -+ #else -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ -+ /* #define MAX_RECVBUF_SZ (16384) */ /* 16K */ -+ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ -+ #ifdef CONFIG_PLATFORM_MSTAR -+ #define MAX_RECVBUF_SZ (8192) /* 8K */ -+ #else -+ #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ -+ #endif -+ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ -+ #else -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+ #endif -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+ -+#elif defined(CONFIG_PCI_HCI) -+ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ -+ /* #define MAX_RECVBUF_SZ (9100) */ -+ /* #else */ -+ #define MAX_RECVBUF_SZ (4000) /* about 4K -+ * #endif */ -+ -+ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ -+ #define MAX_RECVBUF_SZ (RX_DMA_SIZE_8703B - RX_DMA_RESERVED_SIZE_8703B) -+ -+#endif -+ -+/* Rx smooth factor */ -+#define Rx_Smooth_Factor (20) -+ -+#ifdef CONFIG_SDIO_HCI -+ #ifndef CONFIG_SDIO_RX_COPY -+ #undef MAX_RECVBUF_SZ -+ #define MAX_RECVBUF_SZ (RX_DMA_SIZE_8703B - RX_DMA_RESERVED_SIZE_8703B) -+ #endif /* !CONFIG_SDIO_RX_COPY */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ s32 rtl8703bs_init_recv_priv(PADAPTER padapter); -+ void rtl8703bs_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ int rtl8703bu_init_recv_priv(_adapter *padapter); -+ void rtl8703bu_free_recv_priv(_adapter *padapter); -+ void rtl8703bu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8703be_init_recv_priv(PADAPTER padapter); -+ void rtl8703be_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8703b_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8703B_RECV_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_rf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_rf.h 2018-02-11 21:44:27.169146421 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_RF_H__ -+#define __RTL8703B_RF_H__ -+ -+int PHY_RF6052_Config8703B(IN PADAPTER Adapter); -+ -+VOID -+PHY_RF6052SetBandwidth8703B( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_spec.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_spec.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,480 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8703B_SPEC_H__ -+#define __RTL8703B_SPEC_H__ -+ -+#include -+ -+ -+#define HAL_NAV_UPPER_UNIT_8703B 128 /* micro-second */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0000h ~ 0x00FFh System Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_SYS_ISO_CTRL_8703B 0x0000 /* 2 Byte */ -+#define REG_SYS_FUNC_EN_8703B 0x0002 /* 2 Byte */ -+#define REG_APS_FSMCO_8703B 0x0004 /* 4 Byte */ -+#define REG_SYS_CLKR_8703B 0x0008 /* 2 Byte */ -+#define REG_9346CR_8703B 0x000A /* 2 Byte */ -+#define REG_EE_VPD_8703B 0x000C /* 2 Byte */ -+#define REG_AFE_MISC_8703B 0x0010 /* 1 Byte */ -+#define REG_SPS0_CTRL_8703B 0x0011 /* 7 Byte */ -+#define REG_SPS_OCP_CFG_8703B 0x0018 /* 4 Byte */ -+#define REG_RSV_CTRL_8703B 0x001C /* 3 Byte */ -+#define REG_RF_CTRL_8703B 0x001F /* 1 Byte */ -+#define REG_LPLDO_CTRL_8703B 0x0023 /* 1 Byte */ -+#define REG_AFE_XTAL_CTRL_8703B 0x0024 /* 4 Byte */ -+#define REG_AFE_PLL_CTRL_8703B 0x0028 /* 4 Byte */ -+#define REG_MAC_PLL_CTRL_EXT_8703B 0x002c /* 4 Byte */ -+#define REG_EFUSE_CTRL_8703B 0x0030 -+#define REG_EFUSE_TEST_8703B 0x0034 -+#define REG_PWR_DATA_8703B 0x0038 -+#define REG_CAL_TIMER_8703B 0x003C -+#define REG_ACLK_MON_8703B 0x003E -+#define REG_GPIO_MUXCFG_8703B 0x0040 -+#define REG_GPIO_IO_SEL_8703B 0x0042 -+#define REG_MAC_PINMUX_CFG_8703B 0x0043 -+#define REG_GPIO_PIN_CTRL_8703B 0x0044 -+#define REG_GPIO_INTM_8703B 0x0048 -+#define REG_LEDCFG0_8703B 0x004C -+#define REG_LEDCFG1_8703B 0x004D -+#define REG_LEDCFG2_8703B 0x004E -+#define REG_LEDCFG3_8703B 0x004F -+#define REG_FSIMR_8703B 0x0050 -+#define REG_FSISR_8703B 0x0054 -+#define REG_HSIMR_8703B 0x0058 -+#define REG_HSISR_8703B 0x005c -+#define REG_GPIO_EXT_CTRL 0x0060 -+#define REG_PAD_CTRL1_8703B 0x0064 -+#define REG_MULTI_FUNC_CTRL_8703B 0x0068 -+#define REG_GPIO_STATUS_8703B 0x006C -+#define REG_SDIO_CTRL_8703B 0x0070 -+#define REG_OPT_CTRL_8703B 0x0074 -+#define REG_AFE_CTRL_4_8703B 0x0078 -+#define REG_MCUFWDL_8703B 0x0080 -+#define REG_HMEBOX_DBG_0_8703B 0x0088 -+#define REG_HMEBOX_DBG_1_8703B 0x008A -+#define REG_HMEBOX_DBG_2_8703B 0x008C -+#define REG_HMEBOX_DBG_3_8703B 0x008E -+#define REG_HIMR0_8703B 0x00B0 -+#define REG_HISR0_8703B 0x00B4 -+#define REG_HIMR1_8703B 0x00B8 -+#define REG_HISR1_8703B 0x00BC -+#define REG_PMC_DBG_CTRL2_8703B 0x00CC -+#define REG_EFUSE_BURN_GNT_8703B 0x00CF -+#define REG_HPON_FSM_8703B 0x00EC -+#define REG_SYS_CFG_8703B 0x00F0 -+#define REG_SYS_CFG1_8703B 0x00FC -+#define REG_ROM_VERSION 0x00FD -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_C2HEVT_CMD_ID_8703B 0x01A0 -+#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 -+#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 -+#define REG_C2HEVT_CMD_LEN_8703B 0x01AE -+#define REG_C2HEVT_CMD_LEN_88XX REG_C2HEVT_CMD_LEN_8703B -+#define REG_C2HEVT_CLEAR_8703B 0x01AF -+#define REG_MCUTST_1_8703B 0x01C0 -+#define REG_WOWLAN_WAKE_REASON 0x01C7 -+#define REG_FMETHR_8703B 0x01C8 -+#define REG_HMETFR_8703B 0x01CC -+#define REG_HMEBOX_0_8703B 0x01D0 -+#define REG_HMEBOX_1_8703B 0x01D4 -+#define REG_HMEBOX_2_8703B 0x01D8 -+#define REG_HMEBOX_3_8703B 0x01DC -+#define REG_LLT_INIT_8703B 0x01E0 -+#define REG_HMEBOX_EXT0_8703B 0x01F0 -+#define REG_HMEBOX_EXT1_8703B 0x01F4 -+#define REG_HMEBOX_EXT2_8703B 0x01F8 -+#define REG_HMEBOX_EXT3_8703B 0x01FC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RQPN_8703B 0x0200 -+#define REG_FIFOPAGE_8703B 0x0204 -+#define REG_DWBCN0_CTRL_8703B REG_TDECTRL -+#define REG_TXDMA_OFFSET_CHK_8703B 0x020C -+#define REG_TXDMA_STATUS_8703B 0x0210 -+#define REG_RQPN_NPQ_8703B 0x0214 -+#define REG_DWBCN1_CTRL_8703B 0x0228 -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0280h ~ 0x02FFh RXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RXDMA_AGG_PG_TH_8703B 0x0280 -+#define REG_FW_UPD_RDPTR_8703B 0x0284 /* FW shall update this register before FW write RXPKT_RELEASE_POLL to 1 */ -+#define REG_RXDMA_CONTROL_8703B 0x0286 /* Control the RX DMA. */ -+#define REG_RXPKT_NUM_8703B 0x0287 /* The number of packets in RXPKTBUF. */ -+#define REG_RXDMA_STATUS_8703B 0x0288 -+#define REG_RXDMA_MODE_CTRL_8703B 0x0290 -+#define REG_EARLY_MODE_CONTROL_8703B 0x02BC -+#define REG_RSVD5_8703B 0x02F0 -+#define REG_RSVD6_8703B 0x02F4 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0300h ~ 0x03FFh PCIe -+ * -+ * ----------------------------------------------------- */ -+#define REG_PCIE_CTRL_REG_8703B 0x0300 -+#define REG_INT_MIG_8703B 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_DESA_8703B 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_HQ_DESA_8703B 0x0310 /* TX High Queue Descriptor Address */ -+#define REG_MGQ_DESA_8703B 0x0318 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_DESA_8703B 0x0320 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_DESA_8703B 0x0328 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_DESA_8703B 0x0330 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_DESA_8703B 0x0338 /* TX BK Queue Descriptor Address */ -+#define REG_RX_DESA_8703B 0x0340 /* RX Queue Descriptor Address */ -+#define REG_DBI_WDATA_8703B 0x0348 /* DBI Write Data */ -+#define REG_DBI_RDATA_8703B 0x034C /* DBI Read Data */ -+#define REG_DBI_ADDR_8703B 0x0350 /* DBI Address */ -+#define REG_DBI_FLAG_8703B 0x0352 /* DBI Read/Write Flag */ -+#define REG_MDIO_WDATA_8703B 0x0354 /* MDIO for Write PCIE PHY */ -+#define REG_MDIO_RDATA_8703B 0x0356 /* MDIO for Reads PCIE PHY */ -+#define REG_MDIO_CTL_8703B 0x0358 /* MDIO for Control */ -+#define REG_DBG_SEL_8703B 0x0360 /* Debug Selection Register */ -+#define REG_PCIE_HRPWM_8703B 0x0361 /* PCIe RPWM */ -+#define REG_PCIE_HCPWM_8703B 0x0363 /* PCIe CPWM */ -+#define REG_PCIE_MULTIFET_CTRL_8703B 0x036A /* PCIE Multi-Fethc Control */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_VOQ_INFORMATION_8703B 0x0400 -+#define REG_VIQ_INFORMATION_8703B 0x0404 -+#define REG_BEQ_INFORMATION_8703B 0x0408 -+#define REG_BKQ_INFORMATION_8703B 0x040C -+#define REG_MGQ_INFORMATION_8703B 0x0410 -+#define REG_HGQ_INFORMATION_8703B 0x0414 -+#define REG_BCNQ_INFORMATION_8703B 0x0418 -+#define REG_TXPKT_EMPTY_8703B 0x041A -+ -+#define REG_FWHW_TXQ_CTRL_8703B 0x0420 -+#define REG_HWSEQ_CTRL_8703B 0x0423 -+#define REG_TXPKTBUF_BCNQ_BDNY_8703B 0x0424 -+#define REG_TXPKTBUF_MGQ_BDNY_8703B 0x0425 -+#define REG_LIFECTRL_CTRL_8703B 0x0426 -+#define REG_MULTI_BCNQ_OFFSET_8703B 0x0427 -+#define REG_SPEC_SIFS_8703B 0x0428 -+#define REG_RL_8703B 0x042A -+#define REG_TXBF_CTRL_8703B 0x042C -+#define REG_DARFRC_8703B 0x0430 -+#define REG_RARFRC_8703B 0x0438 -+#define REG_RRSR_8703B 0x0440 -+#define REG_ARFR0_8703B 0x0444 -+#define REG_ARFR1_8703B 0x044C -+#define REG_CCK_CHECK_8703B 0x0454 -+#define REG_AMPDU_MAX_TIME_8703B 0x0456 -+#define REG_TXPKTBUF_BCNQ_BDNY1_8703B 0x0457 -+ -+#define REG_AMPDU_MAX_LENGTH_8703B 0x0458 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8703B 0x045D -+#define REG_NDPA_OPT_CTRL_8703B 0x045F -+#define REG_FAST_EDCA_CTRL_8703B 0x0460 -+#define REG_RD_RESP_PKT_TH_8703B 0x0463 -+#define REG_DATA_SC_8703B 0x0483 -+#ifdef CONFIG_WOWLAN -+ #define REG_TXPKTBUF_IV_LOW 0x0484 -+ #define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif -+#define REG_TXRPT_START_OFFSET 0x04AC -+#define REG_POWER_STAGE1_8703B 0x04B4 -+#define REG_POWER_STAGE2_8703B 0x04B8 -+#define REG_AMPDU_BURST_MODE_8703B 0x04BC -+#define REG_PKT_VO_VI_LIFE_TIME_8703B 0x04C0 -+#define REG_PKT_BE_BK_LIFE_TIME_8703B 0x04C2 -+#define REG_STBC_SETTING_8703B 0x04C4 -+#define REG_HT_SINGLE_AMPDU_8703B 0x04C7 -+#define REG_PROT_MODE_CTRL_8703B 0x04C8 -+#define REG_MAX_AGGR_NUM_8703B 0x04CA -+#define REG_RTS_MAX_AGGR_NUM_8703B 0x04CB -+#define REG_BAR_MODE_CTRL_8703B 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8703B 0x04CF -+#define REG_MACID_PKT_DROP0_8703B 0x04D0 -+#define REG_MACID_PKT_SLEEP_8703B 0x04D4 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_EDCA_VO_PARAM_8703B 0x0500 -+#define REG_EDCA_VI_PARAM_8703B 0x0504 -+#define REG_EDCA_BE_PARAM_8703B 0x0508 -+#define REG_EDCA_BK_PARAM_8703B 0x050C -+#define REG_BCNTCFG_8703B 0x0510 -+#define REG_PIFS_8703B 0x0512 -+#define REG_RDG_PIFS_8703B 0x0513 -+#define REG_SIFS_CTX_8703B 0x0514 -+#define REG_SIFS_TRX_8703B 0x0516 -+#define REG_AGGR_BREAK_TIME_8703B 0x051A -+#define REG_SLOT_8703B 0x051B -+#define REG_TX_PTCL_CTRL_8703B 0x0520 -+#define REG_TXPAUSE_8703B 0x0522 -+#define REG_DIS_TXREQ_CLR_8703B 0x0523 -+#define REG_RD_CTRL_8703B 0x0524 -+/* -+ * Format for offset 540h-542h: -+ * [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. -+ * [7:4]: Reserved. -+ * [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. -+ * [23:20]: Reserved -+ * Description: -+ * | -+ * |<--Setup--|--Hold------------>| -+ * --------------|---------------------- -+ * | -+ * TBTT -+ * Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. -+ * Described by Designer Tim and Bruce, 2011-01-14. -+ * */ -+#define REG_TBTT_PROHIBIT_8703B 0x0540 -+#define REG_RD_NAV_NXT_8703B 0x0544 -+#define REG_NAV_PROT_LEN_8703B 0x0546 -+#define REG_BCN_CTRL_8703B 0x0550 -+#define REG_BCN_CTRL_1_8703B 0x0551 -+#define REG_MBID_NUM_8703B 0x0552 -+#define REG_DUAL_TSF_RST_8703B 0x0553 -+#define REG_BCN_INTERVAL_8703B 0x0554 -+#define REG_DRVERLYINT_8703B 0x0558 -+#define REG_BCNDMATIM_8703B 0x0559 -+#define REG_ATIMWND_8703B 0x055A -+#define REG_USTIME_TSF_8703B 0x055C -+#define REG_BCN_MAX_ERR_8703B 0x055D -+#define REG_RXTSF_OFFSET_CCK_8703B 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8703B 0x055F -+#define REG_TSFTR_8703B 0x0560 -+#define REG_CTWND_8703B 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8703B 0x0577 -+#define REG_PSTIMER_8703B 0x0580 -+#define REG_TIMER0_8703B 0x0584 -+#define REG_TIMER1_8703B 0x0588 -+#define REG_ACMHWCTRL_8703B 0x05C0 -+#define REG_SCH_TXCMD_8703B 0x05F8 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_MAC_CR_8703B 0x0600 -+#define REG_TCR_8703B 0x0604 -+#define REG_RCR_8703B 0x0608 -+#define REG_RX_PKT_LIMIT_8703B 0x060C -+#define REG_RX_DLK_TIME_8703B 0x060D -+#define REG_RX_DRVINFO_SZ_8703B 0x060F -+ -+#define REG_MACID_8703B 0x0610 -+#define REG_BSSID_8703B 0x0618 -+#define REG_MAR_8703B 0x0620 -+#define REG_MBIDCAMCFG_8703B 0x0628 -+#define REG_WOWLAN_GTK_DBG1 0x630 -+#define REG_WOWLAN_GTK_DBG2 0x634 -+ -+#define REG_USTIME_EDCA_8703B 0x0638 -+#define REG_MAC_SPEC_SIFS_8703B 0x063A -+#define REG_RESP_SIFP_CCK_8703B 0x063C -+#define REG_RESP_SIFS_OFDM_8703B 0x063E -+#define REG_ACKTO_8703B 0x0640 -+#define REG_CTS2TO_8703B 0x0641 -+#define REG_EIFS_8703B 0x0642 -+ -+#define REG_NAV_UPPER_8703B 0x0652 /* unit of 128 */ -+#define REG_TRXPTCL_CTL_8703B 0x0668 -+ -+/* Security */ -+#define REG_CAMCMD_8703B 0x0670 -+#define REG_CAMWRITE_8703B 0x0674 -+#define REG_CAMREAD_8703B 0x0678 -+#define REG_CAMDBG_8703B 0x067C -+#define REG_SECCFG_8703B 0x0680 -+ -+/* Power */ -+#define REG_WOW_CTRL_8703B 0x0690 -+#define REG_PS_RX_INFO_8703B 0x0692 -+#define REG_UAPSD_TID_8703B 0x0693 -+#define REG_WKFMCAM_CMD_8703B 0x0698 -+#define REG_WKFMCAM_NUM_8703B 0x0698 -+#define REG_WKFMCAM_RWD_8703B 0x069C -+#define REG_RXFLTMAP0_8703B 0x06A0 -+#define REG_RXFLTMAP1_8703B 0x06A2 -+#define REG_RXFLTMAP2_8703B 0x06A4 -+#define REG_BCN_PSR_RPT_8703B 0x06A8 -+#define REG_BT_COEX_TABLE_8703B 0x06C0 -+#define REG_BFMER0_INFO_8703B 0x06E4 -+#define REG_BFMER1_INFO_8703B 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8703B 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8703B 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8703B 0x06FC -+ -+/* Hardware Port 2 */ -+#define REG_MACID1_8703B 0x0700 -+#define REG_BSSID1_8703B 0x0708 -+#define REG_BFMEE_SEL_8703B 0x0714 -+#define REG_SND_PTCL_CTRL_8703B 0x0718 -+ -+/* LTE_COEX */ -+#define REG_LTECOEX_CTRL 0x07C0 -+#define REG_LTECOEX_WRITE_DATA 0x07C4 -+#define REG_LTECOEX_READ_DATA 0x07C8 -+#define REG_LTECOEX_PATH_CONTROL 0x70 -+ -+/* ************************************************************ -+ * SDIO Bus Specification -+ * ************************************************************ */ -+ -+/* ----------------------------------------------------- -+ * SDIO CMD Address Mapping -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * I/O bus domain (Host) -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * SDIO register -+ * ----------------------------------------------------- */ -+#define SDIO_REG_HCPWM1_8703B 0x025 /* HCI Current Power Mode 1 */ -+ -+ -+/* **************************************************************************** -+ * 8703 Regsiter Bit and Content definition -+ * **************************************************************************** */ -+ -+#define BIT_USB_RXDMA_AGG_EN BIT(31) -+#define RXDMA_AGG_MODE_EN BIT(1) -+ -+#ifdef CONFIG_WOWLAN -+ #define RXPKT_RELEASE_POLL BIT(16) -+ #define RXDMA_IDLE BIT(17) -+ #define RW_RELEASE_EN BIT(18) -+#endif -+ -+/* 2 HSISR -+ * interrupt mask which needs to clear */ -+#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ -+ HSISR_SPS_OCP_INT |\ -+ HSISR_RON_INT |\ -+ HSISR_PDNINT |\ -+ HSISR_GPIO9_INT) -+ -+ -+/* ---------------------------------------------------------------------------- -+ * 8703B REG_CCK_CHECK (offset 0x454) -+ * ---------------------------------------------------------------------------- */ -+#define BIT_BCN_PORT_SEL BIT5 -+ -+#ifdef CONFIG_RF_POWER_TRIM -+ -+ #ifdef CONFIG_RTL8703B -+ #define EEPROM_RF_GAIN_OFFSET 0xC1 -+ #endif -+ -+ #define EEPROM_RF_GAIN_VAL 0x1F6 -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ -+ -+/* ---------------------------------------------------------------------------- -+ * 8195 IMR/ISR bits (offset 0xB0, 8bits) -+ * ---------------------------------------------------------------------------- */ -+#define IMR_DISABLED_8703B 0 -+/* IMR DW0(0x00B0-00B3) Bit 0-31 */ -+#define IMR_TIMER2_8703B BIT31 /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8703B BIT30 /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8703B BIT29 /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8703B BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8703B BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8703B BIT26 /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8703B BIT25 /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8703B BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8703B BIT20 /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8703B BIT16 /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8703B BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8703B BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8703B BIT12 /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8703B BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_8703B BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_8703B BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_8703B BIT7 /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8703B BIT6 /* Management Queue DMA OK */ -+#define IMR_BKDOK_8703B BIT5 /* AC_BK DMA OK */ -+#define IMR_BEDOK_8703B BIT4 /* AC_BE DMA OK */ -+#define IMR_VIDOK_8703B BIT3 /* AC_VI DMA OK */ -+#define IMR_VODOK_8703B BIT2 /* AC_VO DMA OK */ -+#define IMR_RDU_8703B BIT1 /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8703B BIT0 /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_8703B BIT27 /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8703B BIT26 /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8703B BIT25 /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8703B BIT24 /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8703B BIT23 /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8703B BIT22 /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8703B BIT21 /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8703B BIT20 /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6_8703B BIT19 /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5_8703B BIT18 /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4_8703B BIT17 /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3_8703B BIT16 /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2_8703B BIT15 /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1_8703B BIT14 /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_ATIMEND_E_8703B BIT13 /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8703B BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_8703B BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_8703B BIT9 /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8703B BIT8 /* Receive FIFO Overflow */ -+ -+#ifdef CONFIG_PCI_HCI -+ /* #define IMR_RX_MASK (IMR_ROK_8703B|IMR_RDU_8703B|IMR_RXFOVW_8703B) */ -+ #define IMR_TX_MASK (IMR_VODOK_8703B | IMR_VIDOK_8703B | IMR_BEDOK_8703B | IMR_BKDOK_8703B | IMR_MGNTDOK_8703B | IMR_HIGHDOK_8703B) -+ -+ #define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8703B | IMR_TXBCN0OK_8703B | IMR_TXBCN0ERR_8703B | IMR_BCNDERR0_8703B) -+ -+ #define RT_AC_INT_MASKS (IMR_VIDOK_8703B | IMR_VODOK_8703B | IMR_BEDOK_8703B | IMR_BKDOK_8703B) -+#endif -+ -+/* ******************************************************** -+ * General definitions -+ * ******************************************************** */ -+ -+#define MACID_NUM_8703B 16 -+#define SEC_CAM_ENT_NUM_8703B 16 -+#define HW_PORT_NUM_8703B 2 -+#define NSS_NUM_8703B 1 -+#define BAND_CAP_8703B (BAND_CAP_2G) -+#define BW_CAP_8703B (BW_CAP_20M | BW_CAP_40M) -+#define PROTO_CAP_8703B (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) -+ -+#endif /* __RTL8703B_SPEC_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_sreset.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_sreset.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8703B_SRESET_H_ -+#define _RTL8703B_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ extern void rtl8703b_sreset_xmit_status_check(_adapter *padapter); -+ extern void rtl8703b_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_xmit.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8703b_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8703b_xmit.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,338 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8703B_XMIT_H__ -+#define __RTL8703B_XMIT_H__ -+ -+ -+#define MAX_TID (15) -+ -+ -+#ifndef __INC_HAL8703BDESC_H -+ #define __INC_HAL8703BDESC_H -+ -+ #define RX_STATUS_DESC_SIZE_8703B 24 -+ #define RX_DRV_INFO_SIZE_UNIT_8703B 8 -+ -+ -+ /* DWORD 0 */ -+ #define SET_RX_STATUS_DESC_PKT_LEN_8703B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+ #define SET_RX_STATUS_DESC_EOR_8703B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) -+ #define SET_RX_STATUS_DESC_OWN_8703B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) -+ -+ #define GET_RX_STATUS_DESC_PKT_LEN_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) -+ #define GET_RX_STATUS_DESC_CRC32_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) -+ #define GET_RX_STATUS_DESC_ICV_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+ #define GET_RX_STATUS_DESC_DRVINFO_SIZE_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) -+ #define GET_RX_STATUS_DESC_SECURITY_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) -+ #define GET_RX_STATUS_DESC_QOS_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) -+ #define GET_RX_STATUS_DESC_SHIFT_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) -+ #define GET_RX_STATUS_DESC_PHY_STATUS_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) -+ #define GET_RX_STATUS_DESC_SWDEC_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) -+ #define GET_RX_STATUS_DESC_LAST_SEG_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 28, 1) -+ #define GET_RX_STATUS_DESC_FIRST_SEG_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 29, 1) -+ #define GET_RX_STATUS_DESC_EOR_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) -+ #define GET_RX_STATUS_DESC_OWN_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+ -+ /* DWORD 1 */ -+ #define GET_RX_STATUS_DESC_MACID_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+ #define GET_RX_STATUS_DESC_TID_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+ #define GET_RX_STATUS_DESC_AMSDU_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+ #define GET_RX_STATUS_DESC_RXID_MATCH_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) -+ #define GET_RX_STATUS_DESC_PAGGR_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) -+ #define GET_RX_STATUS_DESC_A1_FIT_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) -+ #define GET_RX_STATUS_DESC_CHKERR_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) -+ #define GET_RX_STATUS_DESC_IPVER_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+ #define GET_RX_STATUS_DESC_IS_TCPUDP__8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+ #define GET_RX_STATUS_DESC_CHK_VLD_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+ #define GET_RX_STATUS_DESC_PAM_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) -+ #define GET_RX_STATUS_DESC_PWR_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) -+ #define GET_RX_STATUS_DESC_MORE_DATA_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) -+ #define GET_RX_STATUS_DESC_MORE_FRAG_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) -+ #define GET_RX_STATUS_DESC_TYPE_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) -+ #define GET_RX_STATUS_DESC_MC_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) -+ #define GET_RX_STATUS_DESC_BC_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) -+ -+ /* DWORD 2 */ -+ #define GET_RX_STATUS_DESC_SEQ_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) -+ #define GET_RX_STATUS_DESC_FRAG_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) -+ #define GET_RX_STATUS_DESC_RX_IS_QOS_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) -+ #define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) -+ #define GET_RX_STATUS_DESC_RPT_SEL_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) -+ -+ /* DWORD 3 */ -+ #define GET_RX_STATUS_DESC_RX_RATE_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) -+ #define GET_RX_STATUS_DESC_HTC_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) -+ #define GET_RX_STATUS_DESC_EOSP_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) -+ #define GET_RX_STATUS_DESC_BSSID_FIT_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) -+ #ifdef CONFIG_USB_RX_AGGREGATION -+ #define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) -+ #endif -+ #define GET_RX_STATUS_DESC_PATTERN_MATCH_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) -+ #define GET_RX_STATUS_DESC_UNICAST_MATCH_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) -+ #define GET_RX_STATUS_DESC_MAGIC_MATCH_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) -+ -+ /* DWORD 6 */ -+ #define GET_RX_STATUS_DESC_SPLCP_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 1) -+ #define GET_RX_STATUS_DESC_LDPC_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 1, 1) -+ #define GET_RX_STATUS_DESC_STBC_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 2, 1) -+ #define GET_RX_STATUS_DESC_BW_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 4, 2) -+ -+ /* DWORD 5 */ -+ #define GET_RX_STATUS_DESC_TSFL_8703B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) -+ -+ #define GET_RX_STATUS_DESC_BUFF_ADDR_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+ #define GET_RX_STATUS_DESC_BUFF_ADDR64_8703B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+ #define SET_RX_STATUS_DESC_BUFF_ADDR_8703B(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) -+ -+ -+ /* Dword 0 */ -+ #define GET_TX_DESC_OWN_8703B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+ #define SET_TX_DESC_PKT_SIZE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+ #define SET_TX_DESC_OFFSET_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+ #define SET_TX_DESC_BMC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+ #define SET_TX_DESC_HTC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+ #define SET_TX_DESC_LAST_SEG_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+ #define SET_TX_DESC_FIRST_SEG_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+ #define SET_TX_DESC_LINIP_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+ #define SET_TX_DESC_NO_ACM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+ #define SET_TX_DESC_GF_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+ #define SET_TX_DESC_OWN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+ /* Dword 1 */ -+ #define SET_TX_DESC_MACID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+ #define SET_TX_DESC_QUEUE_SEL_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+ #define SET_TX_DESC_RDG_NAV_EXT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+ #define SET_TX_DESC_LSIG_TXOP_EN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+ #define SET_TX_DESC_PIFS_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+ #define SET_TX_DESC_RATE_ID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+ #define SET_TX_DESC_EN_DESC_ID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+ #define SET_TX_DESC_SEC_TYPE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+ #define SET_TX_DESC_PKT_OFFSET_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+ -+ -+ /* Dword 2 */ -+ #define SET_TX_DESC_PAID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+ #define SET_TX_DESC_CCA_RTS_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+ #define SET_TX_DESC_AGG_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+ #define SET_TX_DESC_RDG_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+ #define SET_TX_DESC_AGG_BREAK_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+ #define SET_TX_DESC_MORE_FRAG_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+ #define SET_TX_DESC_RAW_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+ #define SET_TX_DESC_SPE_RPT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+ #define SET_TX_DESC_AMPDU_DENSITY_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+ #define SET_TX_DESC_BT_INT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+ #define SET_TX_DESC_GID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+ -+ -+ /* Dword 3 */ -+ #define SET_TX_DESC_WHEADER_LEN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) -+ #define SET_TX_DESC_CHK_EN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) -+ #define SET_TX_DESC_EARLY_MODE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+ #define SET_TX_DESC_HWSEQ_SEL_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+ #define SET_TX_DESC_USE_RATE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+ #define SET_TX_DESC_DISABLE_RTS_FB_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+ #define SET_TX_DESC_DISABLE_FB_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+ #define SET_TX_DESC_CTS2SELF_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+ #define SET_TX_DESC_RTS_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+ #define SET_TX_DESC_HW_RTS_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+ #define SET_TX_DESC_NAV_USE_HDR_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+ #define SET_TX_DESC_USE_MAX_LEN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+ #define SET_TX_DESC_MAX_AGG_NUM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+ #define SET_TX_DESC_NDPA_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+ #define SET_TX_DESC_AMPDU_MAX_TIME_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+ /* Dword 4 */ -+ #define SET_TX_DESC_TX_RATE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+ #define SET_TX_DESC_DATA_RATE_FB_LIMIT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+ #define SET_TX_DESC_RTS_RATE_FB_LIMIT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+ #define SET_TX_DESC_RETRY_LIMIT_ENABLE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+ #define SET_TX_DESC_DATA_RETRY_LIMIT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+ #define SET_TX_DESC_RTS_RATE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+ -+ -+ /* Dword 5 */ -+ #define SET_TX_DESC_DATA_SC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+ #define SET_TX_DESC_DATA_SHORT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+ #define SET_TX_DESC_DATA_BW_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+ #define SET_TX_DESC_DATA_LDPC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+ #define SET_TX_DESC_DATA_STBC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+ #define SET_TX_DESC_CTROL_STBC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+ #define SET_TX_DESC_RTS_SHORT_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+ #define SET_TX_DESC_RTS_SC_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+ -+ -+ /* Dword 6 */ -+ #define SET_TX_DESC_SW_DEFINE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+ #define SET_TX_DESC_MBSSID_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+ #define SET_TX_DESC_ANTSEL_A_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+ #define SET_TX_DESC_ANTSEL_B_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+ #define SET_TX_DESC_ANTSEL_C_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) -+ #define SET_TX_DESC_ANTSEL_D_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) -+ -+ /* Dword 7 */ -+ #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ #define SET_TX_DESC_TX_BUFFER_SIZE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+ #else -+ #define SET_TX_DESC_TX_DESC_CHECKSUM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+ #endif -+ #define SET_TX_DESC_USB_TXAGG_NUM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+ #if (DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+ #define SET_TX_DESC_SDIO_TXSEQ_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) -+ #endif -+ -+ /* Dword 8 */ -+ #define SET_TX_DESC_HWSEQ_EN_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+ -+ /* Dword 9 */ -+ #define SET_TX_DESC_SEQ_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+ -+ /* Dword 10 */ -+ #define SET_TX_DESC_TX_BUFFER_ADDRESS_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) -+ #define GET_TX_DESC_TX_BUFFER_ADDRESS_8703B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) -+ -+ /* Dword 11 */ -+ #define SET_TX_DESC_NEXT_DESC_ADDRESS_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) -+ -+ -+ #define SET_EARLYMODE_PKTNUM_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+ #define SET_EARLYMODE_LEN0_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+ #define SET_EARLYMODE_LEN1_1_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+ #define SET_EARLYMODE_LEN1_2_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+ #define SET_EARLYMODE_LEN2_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+ #define SET_EARLYMODE_LEN3_8703B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+#endif -+/* ----------------------------------------------------------- -+ * -+ * Rate -+ * -+ * ----------------------------------------------------------- -+ * CCK Rates, TxHT = 0 */ -+#define DESC8703B_RATE1M 0x00 -+#define DESC8703B_RATE2M 0x01 -+#define DESC8703B_RATE5_5M 0x02 -+#define DESC8703B_RATE11M 0x03 -+ -+/* OFDM Rates, TxHT = 0 */ -+#define DESC8703B_RATE6M 0x04 -+#define DESC8703B_RATE9M 0x05 -+#define DESC8703B_RATE12M 0x06 -+#define DESC8703B_RATE18M 0x07 -+#define DESC8703B_RATE24M 0x08 -+#define DESC8703B_RATE36M 0x09 -+#define DESC8703B_RATE48M 0x0a -+#define DESC8703B_RATE54M 0x0b -+ -+/* MCS Rates, TxHT = 1 */ -+#define DESC8703B_RATEMCS0 0x0c -+#define DESC8703B_RATEMCS1 0x0d -+#define DESC8703B_RATEMCS2 0x0e -+#define DESC8703B_RATEMCS3 0x0f -+#define DESC8703B_RATEMCS4 0x10 -+#define DESC8703B_RATEMCS5 0x11 -+#define DESC8703B_RATEMCS6 0x12 -+#define DESC8703B_RATEMCS7 0x13 -+#define DESC8703B_RATEMCS8 0x14 -+#define DESC8703B_RATEMCS9 0x15 -+#define DESC8703B_RATEMCS10 0x16 -+#define DESC8703B_RATEMCS11 0x17 -+#define DESC8703B_RATEMCS12 0x18 -+#define DESC8703B_RATEMCS13 0x19 -+#define DESC8703B_RATEMCS14 0x1a -+#define DESC8703B_RATEMCS15 0x1b -+#define DESC8703B_RATEVHTSS1MCS0 0x2c -+#define DESC8703B_RATEVHTSS1MCS1 0x2d -+#define DESC8703B_RATEVHTSS1MCS2 0x2e -+#define DESC8703B_RATEVHTSS1MCS3 0x2f -+#define DESC8703B_RATEVHTSS1MCS4 0x30 -+#define DESC8703B_RATEVHTSS1MCS5 0x31 -+#define DESC8703B_RATEVHTSS1MCS6 0x32 -+#define DESC8703B_RATEVHTSS1MCS7 0x33 -+#define DESC8703B_RATEVHTSS1MCS8 0x34 -+#define DESC8703B_RATEVHTSS1MCS9 0x35 -+#define DESC8703B_RATEVHTSS2MCS0 0x36 -+#define DESC8703B_RATEVHTSS2MCS1 0x37 -+#define DESC8703B_RATEVHTSS2MCS2 0x38 -+#define DESC8703B_RATEVHTSS2MCS3 0x39 -+#define DESC8703B_RATEVHTSS2MCS4 0x3a -+#define DESC8703B_RATEVHTSS2MCS5 0x3b -+#define DESC8703B_RATEVHTSS2MCS6 0x3c -+#define DESC8703B_RATEVHTSS2MCS7 0x3d -+#define DESC8703B_RATEVHTSS2MCS8 0x3e -+#define DESC8703B_RATEVHTSS2MCS9 0x3f -+ -+ -+#define RX_HAL_IS_CCK_RATE_8703B(pDesc)\ -+ (GET_RX_STATUS_DESC_RX_RATE_8703B(pDesc) == DESC8703B_RATE1M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8703B(pDesc) == DESC8703B_RATE2M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8703B(pDesc) == DESC8703B_RATE5_5M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8703B(pDesc) == DESC8703B_RATE11M) -+ -+ -+void rtl8703b_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); -+void rtl8703b_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+#if defined(CONFIG_CONCURRENT_MODE) -+ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ s32 rtl8703bs_init_xmit_priv(PADAPTER padapter); -+ void rtl8703bs_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8703bs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8703bs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8703bs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8703bs_xmit_buf_handler(PADAPTER padapter); -+ thread_return rtl8703bs_xmit_thread(thread_context context); -+ #define hal_xmit_handler rtl8703bs_xmit_buf_handler -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ s32 rtl8703bu_xmit_buf_handler(PADAPTER padapter); -+ #define hal_xmit_handler rtl8703bu_xmit_buf_handler -+ -+ -+ s32 rtl8703bu_init_xmit_priv(PADAPTER padapter); -+ void rtl8703bu_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8703bu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8703bu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8703bu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ /* s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); */ -+ void rtl8703bu_xmit_tasklet(void *priv); -+ s32 rtl8703bu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+ void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, struct tx_desc *ptxdesc); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8703be_init_xmit_priv(PADAPTER padapter); -+ void rtl8703be_free_xmit_priv(PADAPTER padapter); -+ struct xmit_buf *rtl8703be_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+ void rtl8703be_xmitframe_resume(_adapter *padapter); -+ s32 rtl8703be_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8703be_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8703be_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ void rtl8703be_xmit_tasklet(void *priv); -+#endif -+ -+u8 BWMapping_8703B(PADAPTER Adapter, struct pkt_attrib *pattrib); -+u8 SCMapping_8703B(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_cmd.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_cmd.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,218 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_CMD_H__ -+#define __RTL8723B_CMD_H__ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+enum h2c_cmd_8723B { -+ /* Common Class: 000 */ -+ H2C_8723B_RSVD_PAGE = 0x00, -+ H2C_8723B_MEDIA_STATUS_RPT = 0x01, -+ H2C_8723B_SCAN_ENABLE = 0x02, -+ H2C_8723B_KEEP_ALIVE = 0x03, -+ H2C_8723B_DISCON_DECISION = 0x04, -+ H2C_8723B_PSD_OFFLOAD = 0x05, -+ H2C_8723B_AP_OFFLOAD = 0x08, -+ H2C_8723B_BCN_RSVDPAGE = 0x09, -+ H2C_8723B_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_8723B_FCS_RSVDPAGE = 0x10, -+ H2C_8723B_FCS_INFO = 0x11, -+ H2C_8723B_AP_WOW_GPIO_CTRL = 0x13, -+ -+ /* PoweSave Class: 001 */ -+ H2C_8723B_SET_PWR_MODE = 0x20, -+ H2C_8723B_PS_TUNING_PARA = 0x21, -+ H2C_8723B_PS_TUNING_PARA2 = 0x22, -+ H2C_8723B_P2P_LPS_PARAM = 0x23, -+ H2C_8723B_P2P_PS_OFFLOAD = 0x24, -+ H2C_8723B_PS_SCAN_ENABLE = 0x25, -+ H2C_8723B_SAP_PS_ = 0x26, -+ H2C_8723B_INACTIVE_PS_ = 0x27, /* Inactive_PS */ -+ H2C_8723B_FWLPS_IN_IPS_ = 0x28, -+ -+ /* Dynamic Mechanism Class: 010 */ -+ H2C_8723B_MACID_CFG = 0x40, -+ H2C_8723B_TXBF = 0x41, -+ H2C_8723B_RSSI_SETTING = 0x42, -+ H2C_8723B_AP_REQ_TXRPT = 0x43, -+ H2C_8723B_INIT_RATE_COLLECT = 0x44, -+ H2C_8723B_RA_PARA_ADJUST = 0x46, -+ -+ /* BT Class: 011 */ -+ H2C_8723B_B_TYPE_TDMA = 0x60, -+ H2C_8723B_BT_INFO = 0x61, -+ H2C_8723B_FORCE_BT_TXPWR = 0x62, -+ H2C_8723B_BT_IGNORE_WLANACT = 0x63, -+ H2C_8723B_DAC_SWING_VALUE = 0x64, -+ H2C_8723B_ANT_SEL_RSV = 0x65, -+ H2C_8723B_WL_OPMODE = 0x66, -+ H2C_8723B_BT_MP_OPER = 0x67, -+ H2C_8723B_BT_CONTROL = 0x68, -+ H2C_8723B_BT_WIFI_CTRL = 0x69, -+ H2C_8723B_BT_FW_PATCH = 0x6A, -+ H2C_8723B_BT_WLAN_CALIBRATION = 0x6D, -+ -+ /* WOWLAN Class: 100 */ -+ H2C_8723B_WOWLAN = 0x80, -+ H2C_8723B_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8723B_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8723B_AOAC_RSVD_PAGE = 0x83, -+ H2C_8723B_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_8723B_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_8723B_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_8723B_CHNL_SWITCH_OFFLOAD = 0x87, -+ H2C_8723B_P2P_OFFLOAD_RSVD_PAGE = 0x8A, -+ H2C_8723B_P2P_OFFLOAD = 0x8B, -+ -+ H2C_8723B_RESET_TSF = 0xC0, -+ H2C_8723B_MAXID, -+}; -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- -+ * _RSVDPAGE_LOC_CMD_0x00 */ -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+/* _KEEP_ALIVE_CMD_0x03 */ -+#define SET_8723B_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8723B_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8723B_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8723B_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _DISCONNECT_DECISION_CMD_0x04 */ -+#define SET_8723B_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8723B_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8723B_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+ -+/* _PWR_MOD_CMD_0x20 */ -+#define SET_8723B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+#define GET_8723B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+/* _PS_TUNE_PARAM_CMD_0x21 */ -+#define SET_8723B_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) -+#define SET_8723B_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) -+#define SET_8723B_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _MACID_CFG_CMD_0x40 */ -+#define SET_8723B_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) -+#define SET_8723B_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) -+ -+/* _RSSI_SETTING_CMD_0x42 */ -+#define SET_8723B_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) -+#define SET_8723B_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _AP_REQ_TXRPT_CMD_0x43 */ -+#define SET_8723B_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723B_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _FORCE_BT_TXPWR_CMD_0x62 */ -+#define SET_8723B_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+ -+/* _FORCE_BT_MP_OPER_CMD_0x67 */ -+#define SET_8723B_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+ -+/* _BT_FW_PATCH_0x6A */ -+#define SET_8723B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) -+#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ------------------------------------------- Structure -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- Function Statement -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+/* host message to firmware cmd */ -+void rtl8723b_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8723b_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -+void rtl8723b_set_rssi_cmd(PADAPTER padapter, u8 *param); -+void rtl8723b_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); -+/* s32 rtl8723b_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ -+void rtl8723b_set_FwPsTuneParam_cmd(PADAPTER padapter); -+void rtl8723b_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); -+void rtl8723b_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); -+void rtl8723b_download_rsvd_page(PADAPTER padapter, u8 mstatus); -+#ifdef CONFIG_BT_COEXIST -+ void rtl8723b_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif /* CONFIG_BT_COEXIST */ -+#ifdef CONFIG_P2P -+ void rtl8723b_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif /* CONFIG_P2P */ -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+ -+#ifdef CONFIG_TDLS -+ #ifdef CONFIG_TDLS_CH_SW -+ void rtl8723b_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); -+ #endif -+#endif -+ -+#ifdef CONFIG_P2P_WOWLAN -+ void rtl8723b_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+void rtl8723b_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+ u8 rtl8723b_reset_tsf(_adapter *padapter, u8 reset_port); -+#endif /* CONFIG_TSF_RESET_OFFLOAD */ -+s32 FillH2CCmd8723B(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8723B(_adapter *padapter, bool wowlan); -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_dm.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_dm.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,47 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_DM_H__ -+#define __RTL8723B_DM_H__ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for 8723B dynamic mechanism only -+ * -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * structure and define -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * function prototype -+ * ************************************************************ */ -+ -+void rtl8723b_init_dm_priv(PADAPTER padapter); -+void rtl8723b_deinit_dm_priv(PADAPTER padapter); -+ -+void rtl8723b_InitHalDm(PADAPTER padapter); -+void rtl8723b_HalDmWatchDog(PADAPTER padapter); -+void rtl8723b_HalDmWatchDog_in_LPS(PADAPTER padapter); -+void rtl8723b_hal_dm_in_lps(PADAPTER padapter); -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_hal.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,283 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_HAL_H__ -+#define __RTL8723B_HAL_H__ -+ -+#include "hal_data.h" -+ -+#include "rtl8723b_spec.h" -+#include "rtl8723b_rf.h" -+#include "rtl8723b_dm.h" -+#include "rtl8723b_recv.h" -+#include "rtl8723b_xmit.h" -+#include "rtl8723b_cmd.h" -+#include "rtl8723b_led.h" -+#include "Hal8723BPwrSeq.h" -+#include "Hal8723BPhyReg.h" -+#include "Hal8723BPhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+ #include "rtl8723b_sreset.h" -+#endif -+ -+#define FW_8723B_SIZE 0x8000 -+#define FW_8723B_START_ADDRESS 0x1000 -+#define FW_8723B_END_ADDRESS 0x1FFF /* 0x5FFF */ -+ -+#define IS_FW_HEADER_EXIST_8723B(_pFwHdr) ((le16_to_cpu(_pFwHdr->Signature) & 0xFFF0) == 0x5300) -+ -+typedef struct _RT_FIRMWARE { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8 *szFwBuffer; -+#else -+ u8 szFwBuffer[FW_8723B_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8723B, *PRT_FIRMWARE_8723B; -+ -+/* -+ * This structure must be cared byte-ordering -+ * -+ * Added by tynli. 2009.12.04. */ -+typedef struct _RT_8723B_FIRMWARE_HDR { -+ /* 8-byte alinment required */ -+ -+ /* --- LONG WORD 0 ---- */ -+ u16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ -+ u8 Category; /* AP/NIC and USB/PCI */ -+ u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ -+ u16 Version; /* FW Version */ -+ u16 Subversion; /* FW Subversion, default 0x00 */ -+ -+ /* --- LONG WORD 1 ---- */ -+ u8 Month; /* Release time Month field */ -+ u8 Date; /* Release time Date field */ -+ u8 Hour; /* Release time Hour field */ -+ u8 Minute; /* Release time Minute field */ -+ u16 RamCodeSize; /* The size of RAM code */ -+ u16 Rsvd2; -+ -+ /* --- LONG WORD 2 ---- */ -+ u32 SvnIdx; /* The SVN entry index */ -+ u32 Rsvd3; -+ -+ /* --- LONG WORD 3 ---- */ -+ u32 Rsvd4; -+ u32 Rsvd5; -+} RT_8723B_FIRMWARE_HDR, *PRT_8723B_FIRMWARE_HDR; -+ -+#define DRIVER_EARLY_INT_TIME_8723B 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8723B 0x02 -+ -+/* for 8723B -+ * TX 32K, RX 16K, Page size 128B for TX, 8B for RX */ -+#define PAGE_SIZE_TX_8723B 128 -+#define PAGE_SIZE_RX_8723B 8 -+ -+#define TX_DMA_SIZE_8723B 0x8000 /* 32K(TX) */ -+#define RX_DMA_SIZE_8723B 0x4000 /* 16K(RX) */ -+ -+#ifdef CONFIG_WOWLAN -+ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ -+#else -+ #define RESV_FMWF 0 -+#endif -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+ #define RX_DMA_RESERVED_SIZE_8723B 0x100 /* 256B, reserved for c2h debug message */ -+#else -+ #define RX_DMA_RESERVED_SIZE_8723B 0x80 /* 128B, reserved for tx report */ -+#endif -+#define RX_DMA_BOUNDARY_8723B (RX_DMA_SIZE_8723B - RX_DMA_RESERVED_SIZE_8723B - 1) -+ -+ -+/* Note: We will divide number of page equally for each queue other than public queue! */ -+ -+/* For General Reserved Page Number(Beacon Queue is reserved page) -+ * Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 */ -+#define BCNQ_PAGE_NUM_8723B 0x08 -+#ifdef CONFIG_CONCURRENT_MODE -+ #define BCNQ1_PAGE_NUM_8723B 0x08 /* 0x04 */ -+#else -+ #define BCNQ1_PAGE_NUM_8723B 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+ #undef BCNQ1_PAGE_NUM_8723B -+ #define BCNQ1_PAGE_NUM_8723B 0x00 /* 0x04 */ -+#endif -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8723B 0x07 -+#else -+ #define WOWLAN_PAGE_NUM_8723B 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+ #undef WOWLAN_PAGE_NUM_8723B -+ #define WOWLAN_PAGE_NUM_8723B 0x15 -+#endif -+ -+#ifdef CONFIG_AP_WOWLAN -+ #define AP_WOWLAN_PAGE_NUM_8723B 0x02 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8723B (0xFF - BCNQ_PAGE_NUM_8723B - BCNQ1_PAGE_NUM_8723B - WOWLAN_PAGE_NUM_8723B) -+#define TX_PAGE_BOUNDARY_8723B (TX_TOTAL_PAGE_NUMBER_8723B + 1) -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723B TX_TOTAL_PAGE_NUMBER_8723B -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8723B (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723B + 1) -+ -+/* For Normal Chip Setting -+ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8723B */ -+#define NORMAL_PAGE_NUM_HPQ_8723B 0x0C -+#define NORMAL_PAGE_NUM_LPQ_8723B 0x02 -+#define NORMAL_PAGE_NUM_NPQ_8723B 0x02 -+ -+/* Note: For Normal Chip Setting, modify later */ -+#define WMM_NORMAL_PAGE_NUM_HPQ_8723B 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8723B 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8723B 0x20 -+ -+ -+#include "HalVerDef.h" -+#include "hal_com.h" -+ -+#define EFUSE_OOB_PROTECT_BYTES 15 -+ -+#define HAL_EFUSE_MEMORY -+ -+#define HWSET_MAX_SIZE_8723B 512 -+#define EFUSE_REAL_CONTENT_LEN_8723B 512 -+#define EFUSE_MAP_LEN_8723B 512 -+#define EFUSE_MAX_SECTION_8723B 64 -+ -+#define EFUSE_IC_ID_OFFSET 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ -+#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8723B) -+ -+#define EFUSE_ACCESS_ON 0x69 /* For RTL8723 only. */ -+#define EFUSE_ACCESS_OFF 0x00 /* For RTL8723 only. */ -+ -+/* ******************************************************** -+ * EFUSE for BT definition -+ * ******************************************************** */ -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN 512 -+#define EFUSE_BT_REAL_CONTENT_LEN 1536 /* 512*3 */ -+#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ -+#define EFUSE_BT_MAX_SECTION 128 /* 1024/8 */ -+ -+#define EFUSE_PROTECT_BYTES_BANK 16 -+ -+typedef enum tag_Package_Definition { -+ PACKAGE_DEFAULT, -+ PACKAGE_QFN68, -+ PACKAGE_TFBGA90, -+ PACKAGE_TFBGA80, -+ PACKAGE_TFBGA79 -+} PACKAGE_TYPE_E; -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+/* rtl8723a_hal_init.c */ -+s32 rtl8723b_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); -+void rtl8723b_FirmwareSelfReset(PADAPTER padapter); -+void rtl8723b_InitializeFirmwareVars(PADAPTER padapter); -+ -+void rtl8723b_InitAntenna_Selection(PADAPTER padapter); -+void rtl8723b_DeinitAntenna_Selection(PADAPTER padapter); -+void rtl8723b_CheckAntenna_Selection(PADAPTER padapter); -+void rtl8723b_init_default_value(PADAPTER padapter); -+ -+s32 rtl8723b_InitLLTTable(PADAPTER padapter); -+ -+s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); -+s32 CardDisableWithoutHWSM(PADAPTER padapter); -+ -+/* EFuse */ -+u8 GetEEPROMSize8723B(PADAPTER padapter); -+void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); -+void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); -+void Hal_EfuseParseTxPowerInfo_8723B(PADAPTER padapter, u8 *PROMContent, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseBTCoexistInfo_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseEEPROMVer_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseChnlPlan_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseCustomerID_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseAntennaDiversity_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8723B(PADAPTER pAdapter, u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseThermalMeter_8723B(PADAPTER padapter, u8 *hwinfo, u8 AutoLoadFail); -+VOID Hal_EfuseParsePackageType_8723B(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+VOID Hal_EfuseParseVoltage_8723B(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+VOID Hal_EfuseParseBoardType_8723B(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+ -+void rtl8723b_set_hal_ops(struct hal_ops *pHalFunc); -+void init_hal_spec_8723b(_adapter *adapter); -+void SetHwReg8723B(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg8723B(PADAPTER padapter, u8 variable, u8 *val); -+u8 SetHalDefVar8723B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8723B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+ -+/* register */ -+void rtl8723b_InitBeaconParameters(PADAPTER padapter); -+void rtl8723b_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); -+void _InitBurstPktLen_8723BS(PADAPTER Adapter); -+void _8051Reset8723(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+ void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif /* CONFIG_WOWLAN */ -+ -+void rtl8723b_start_thread(_adapter *padapter); -+void rtl8723b_stop_thread(_adapter *padapter); -+ -+#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) -+ void rtl8723bs_init_checkbthang_workqueue(_adapter *adapter); -+ void rtl8723bs_free_checkbthang_workqueue(_adapter *adapter); -+ void rtl8723bs_cancle_checkbthang_workqueue(_adapter *adapter); -+ void rtl8723bs_hal_check_bt_hang(_adapter *adapter); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); -+#endif -+#ifdef CONFIG_MP_INCLUDED -+int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); -+#endif -+void CCX_FwC2HTxRpt_8723b(PADAPTER padapter, u8 *pdata, u8 len); -+ -+u8 MRateToHwRate8723B(u8 rate); -+u8 HwRateToMRate8723B(u8 rate); -+ -+#ifdef CONFIG_RF_POWER_TRIM -+ void Hal_ReadRFGainOffset(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ -+#ifdef CONFIG_PCI_HCI -+ BOOLEAN InterruptRecognized8723BE(PADAPTER Adapter); -+ VOID UpdateInterruptMask8723BE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+#endif -+ -+#ifdef CONFIG_GPIO_API -+int rtl8723b_GpioFuncCheck(PADAPTER adapter, u8 gpio_num); -+VOID rtl8723b_GpioMultiFuncReset(PADAPTER adapter, u8 gpio_num); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_led.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_led.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_LED_H__ -+#define __RTL8723B_LED_H__ -+ -+#include -+#include -+#include -+ -+ -+/* ******************************************************************************** -+ * Interface to manipulate LED objects. -+ * ******************************************************************************** */ -+#ifdef CONFIG_USB_HCI -+ void rtl8723bu_InitSwLeds(PADAPTER padapter); -+ void rtl8723bu_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_SDIO_HCI -+ void rtl8723bs_InitSwLeds(PADAPTER padapter); -+ void rtl8723bs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_GSPI_HCI -+ void rtl8723bs_InitSwLeds(PADAPTER padapter); -+ void rtl8723bs_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+ void rtl8723be_InitSwLeds(PADAPTER padapter); -+ void rtl8723be_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_recv.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_recv.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,91 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_RECV_H__ -+#define __RTL8723B_RECV_H__ -+ -+#define RECV_BLK_SZ 512 -+#define RECV_BLK_CNT 16 -+#define RECV_BLK_TH RECV_BLK_CNT -+ -+#if defined(CONFIG_USB_HCI) -+ -+ #ifndef MAX_RECVBUF_SZ -+ #ifdef PLATFORM_OS_CE -+ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ -+ #else -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ -+ /* #define MAX_RECVBUF_SZ (16384) */ /* 16K */ -+ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ -+ #ifdef CONFIG_PLATFORM_MSTAR -+ #define MAX_RECVBUF_SZ (8192) /* 8K */ -+ #else -+ #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ -+ #endif -+ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ -+ #else -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+ #endif -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+ -+#elif defined(CONFIG_PCI_HCI) -+ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ -+ /* #define MAX_RECVBUF_SZ (9100) */ -+ /* #else */ -+ #define MAX_RECVBUF_SZ (4000) /* about 4K -+ * #endif */ -+ -+ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ -+ #define MAX_RECVBUF_SZ (RX_DMA_SIZE_8723B - RX_DMA_RESERVED_SIZE_8723B) -+ -+#endif -+ -+/* Rx smooth factor */ -+#define Rx_Smooth_Factor (20) -+ -+#ifdef CONFIG_SDIO_HCI -+ #ifndef CONFIG_SDIO_RX_COPY -+ #undef MAX_RECVBUF_SZ -+ #define MAX_RECVBUF_SZ (RX_DMA_SIZE_8723B - RX_DMA_RESERVED_SIZE_8723B) -+ #endif /* !CONFIG_SDIO_RX_COPY */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ s32 rtl8723bs_init_recv_priv(PADAPTER padapter); -+ void rtl8723bs_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ int rtl8723bu_init_recv_priv(_adapter *padapter); -+ void rtl8723bu_free_recv_priv(_adapter *padapter); -+ void rtl8723bu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8723be_init_recv_priv(PADAPTER padapter); -+ void rtl8723be_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8723b_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8723B_RECV_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_rf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_rf.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_RF_H__ -+#define __RTL8723B_RF_H__ -+ -+int PHY_RF6052_Config8723B(IN PADAPTER Adapter); -+ -+VOID -+PHY_RF6052SetBandwidth8723B( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_spec.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_spec.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,296 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8723B_SPEC_H__ -+#define __RTL8723B_SPEC_H__ -+ -+#include -+ -+ -+#define HAL_NAV_UPPER_UNIT_8723B 128 /* micro-second */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0000h ~ 0x00FFh System Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RSV_CTRL_8723B 0x001C /* 3 Byte */ -+#define REG_BT_WIFI_ANTENNA_SWITCH_8723B 0x0038 -+#define REG_HSISR_8723B 0x005c -+#define REG_PAD_CTRL1_8723B 0x0064 -+#define REG_AFE_CTRL_4_8723B 0x0078 -+#define REG_HMEBOX_DBG_0_8723B 0x0088 -+#define REG_HMEBOX_DBG_1_8723B 0x008A -+#define REG_HMEBOX_DBG_2_8723B 0x008C -+#define REG_HMEBOX_DBG_3_8723B 0x008E -+#define REG_HIMR0_8723B 0x00B0 -+#define REG_HISR0_8723B 0x00B4 -+#define REG_HIMR1_8723B 0x00B8 -+#define REG_HISR1_8723B 0x00BC -+#define REG_PMC_DBG_CTRL2_8723B 0x00CC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_C2HEVT_CMD_ID_8723B 0x01A0 -+#define REG_C2HEVT_CMD_LEN_8723B 0x01AE -+#define REG_WOWLAN_WAKE_REASON 0x01C7 -+#define REG_WOWLAN_GTK_DBG1 0x630 -+#define REG_WOWLAN_GTK_DBG2 0x634 -+ -+#define REG_HMEBOX_EXT0_8723B 0x01F0 -+#define REG_HMEBOX_EXT1_8723B 0x01F4 -+#define REG_HMEBOX_EXT2_8723B 0x01F8 -+#define REG_HMEBOX_EXT3_8723B 0x01FC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0280h ~ 0x02FFh RXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RXDMA_CONTROL_8723B 0x0286 /* Control the RX DMA. */ -+#define REG_RXDMA_MODE_CTRL_8723B 0x0290 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0300h ~ 0x03FFh PCIe -+ * -+ * ----------------------------------------------------- */ -+#define REG_PCIE_CTRL_REG_8723B 0x0300 -+#define REG_INT_MIG_8723B 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_DESA_8723B 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_HQ_DESA_8723B 0x0310 /* TX High Queue Descriptor Address */ -+#define REG_MGQ_DESA_8723B 0x0318 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_DESA_8723B 0x0320 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_DESA_8723B 0x0328 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_DESA_8723B 0x0330 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_DESA_8723B 0x0338 /* TX BK Queue Descriptor Address */ -+#define REG_RX_DESA_8723B 0x0340 /* RX Queue Descriptor Address */ -+#define REG_DBI_WDATA_8723B 0x0348 /* DBI Write Data */ -+#define REG_DBI_RDATA_8723B 0x034C /* DBI Read Data */ -+#define REG_DBI_ADDR_8723B 0x0350 /* DBI Address */ -+#define REG_DBI_FLAG_8723B 0x0352 /* DBI Read/Write Flag */ -+#define REG_MDIO_WDATA_8723B 0x0354 /* MDIO for Write PCIE PHY */ -+#define REG_MDIO_RDATA_8723B 0x0356 /* MDIO for Reads PCIE PHY */ -+#define REG_MDIO_CTL_8723B 0x0358 /* MDIO for Control */ -+#define REG_DBG_SEL_8723B 0x0360 /* Debug Selection Register */ -+#define REG_PCIE_HRPWM_8723B 0x0361 /* PCIe RPWM */ -+#define REG_PCIE_HCPWM_8723B 0x0363 /* PCIe CPWM */ -+#define REG_PCIE_MULTIFET_CTRL_8723B 0x036A /* PCIE Multi-Fethc Control */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_TXPKTBUF_BCNQ_BDNY_8723B 0x0424 -+#define REG_TXPKTBUF_MGQ_BDNY_8723B 0x0425 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8723B 0x045D -+#ifdef CONFIG_WOWLAN -+ #define REG_TXPKTBUF_IV_LOW 0x0484 -+ #define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif -+#define REG_AMPDU_BURST_MODE_8723B 0x04BC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_SECONDARY_CCA_CTRL_8723B 0x0577 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+ -+/* ************************************************************ -+ * SDIO Bus Specification -+ * ************************************************************ */ -+ -+/* ----------------------------------------------------- -+ * SDIO CMD Address Mapping -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * I/O bus domain (Host) -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * SDIO register -+ * ----------------------------------------------------- */ -+#define SDIO_REG_HCPWM1_8723B 0x025 /* HCI Current Power Mode 1 */ -+ -+ -+/* **************************************************************************** -+ * 8723 Regsiter Bit and Content definition -+ * **************************************************************************** */ -+ -+/* 2 HSISR -+ * interrupt mask which needs to clear */ -+#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ -+ HSISR_SPS_OCP_INT |\ -+ HSISR_RON_INT |\ -+ HSISR_PDNINT |\ -+ HSISR_GPIO9_INT) -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * -+ * ----------------------------------------------------- */ -+#undef IS_E_CUT -+#define IS_E_CUT(version) FALSE -+#undef IS_F_CUT -+#define IS_F_CUT(version) ((GET_CVID_CUT_VERSION(version) == E_CUT_VERSION) ? TRUE : FALSE) -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0280h ~ 0x02FFh RXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define BIT_USB_RXDMA_AGG_EN BIT(31) -+#define RXDMA_AGG_MODE_EN BIT(1) -+ -+#ifdef CONFIG_WOWLAN -+ #define RXPKT_RELEASE_POLL BIT(16) -+ #define RXDMA_IDLE BIT(17) -+ #define RW_RELEASE_EN BIT(18) -+#endif -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* ---------------------------------------------------------------------------- -+ * 8723B REG_CCK_CHECK (offset 0x454) -+ * ---------------------------------------------------------------------------- */ -+#define BIT_BCN_PORT_SEL BIT5 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * -+ * ----------------------------------------------------- */ -+#ifdef CONFIG_RF_POWER_TRIM -+ -+ #ifdef CONFIG_RTL8723B -+ #define EEPROM_RF_GAIN_OFFSET 0xC1 -+ #endif -+ -+ #define EEPROM_RF_GAIN_VAL 0x1F6 -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ -+ -+/* ---------------------------------------------------------------------------- -+ * 8195 IMR/ISR bits (offset 0xB0, 8bits) -+ * ---------------------------------------------------------------------------- */ -+#define IMR_DISABLED_8723B 0 -+/* IMR DW0(0x00B0-00B3) Bit 0-31 */ -+#define IMR_TIMER2_8723B BIT31 /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8723B BIT30 /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8723B BIT29 /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8723B BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8723B BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8723B BIT26 /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8723B BIT25 /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8723B BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8723B BIT20 /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8723B BIT16 /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8723B BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8723B BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8723B BIT12 /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8723B BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_8723B BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_8723B BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_8723B BIT7 /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8723B BIT6 /* Management Queue DMA OK */ -+#define IMR_BKDOK_8723B BIT5 /* AC_BK DMA OK */ -+#define IMR_BEDOK_8723B BIT4 /* AC_BE DMA OK */ -+#define IMR_VIDOK_8723B BIT3 /* AC_VI DMA OK */ -+#define IMR_VODOK_8723B BIT2 /* AC_VO DMA OK */ -+#define IMR_RDU_8723B BIT1 /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8723B BIT0 /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_8723B BIT27 /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8723B BIT26 /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8723B BIT25 /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8723B BIT24 /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8723B BIT23 /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8723B BIT22 /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8723B BIT21 /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8723B BIT20 /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6_8723B BIT19 /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5_8723B BIT18 /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4_8723B BIT17 /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3_8723B BIT16 /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2_8723B BIT15 /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1_8723B BIT14 /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_ATIMEND_E_8723B BIT13 /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8723B BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_8723B BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_8723B BIT9 /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8723B BIT8 /* Receive FIFO Overflow */ -+ -+#ifdef CONFIG_PCI_HCI -+ /* #define IMR_RX_MASK (IMR_ROK_8723B|IMR_RDU_8723B|IMR_RXFOVW_8723B) */ -+ #define IMR_TX_MASK (IMR_VODOK_8723B | IMR_VIDOK_8723B | IMR_BEDOK_8723B | IMR_BKDOK_8723B | IMR_MGNTDOK_8723B | IMR_HIGHDOK_8723B) -+ -+ #define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8723B | IMR_TXBCN0OK_8723B | IMR_TXBCN0ERR_8723B | IMR_BCNDERR0_8723B) -+ -+ #define RT_AC_INT_MASKS (IMR_VIDOK_8723B | IMR_VODOK_8723B | IMR_BEDOK_8723B | IMR_BKDOK_8723B) -+#endif -+ -+/* ******************************************************** -+ * General definitions -+ * ******************************************************** */ -+ -+#define MACID_NUM_8723B 128 -+#define SEC_CAM_ENT_NUM_8723B 64 -+#define HW_PORT_NUM_8723B 2 -+#define NSS_NUM_8723B 1 -+#define BAND_CAP_8723B (BAND_CAP_2G) -+#define BW_CAP_8723B (BW_CAP_20M | BW_CAP_40M) -+#define PROTO_CAP_8723B (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) -+ -+#endif /* __RTL8723B_SPEC_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_sreset.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_sreset.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8723B_SRESET_H_ -+#define _RTL8723B_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ extern void rtl8723b_sreset_xmit_status_check(_adapter *padapter); -+ extern void rtl8723b_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_xmit.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723b_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723b_xmit.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,338 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723B_XMIT_H__ -+#define __RTL8723B_XMIT_H__ -+ -+ -+#define MAX_TID (15) -+ -+ -+#ifndef __INC_HAL8723BDESC_H -+ #define __INC_HAL8723BDESC_H -+ -+ #define RX_STATUS_DESC_SIZE_8723B 24 -+ #define RX_DRV_INFO_SIZE_UNIT_8723B 8 -+ -+ -+ /* DWORD 0 */ -+ #define SET_RX_STATUS_DESC_PKT_LEN_8723B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+ #define SET_RX_STATUS_DESC_EOR_8723B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) -+ #define SET_RX_STATUS_DESC_OWN_8723B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) -+ -+ #define GET_RX_STATUS_DESC_PKT_LEN_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) -+ #define GET_RX_STATUS_DESC_CRC32_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) -+ #define GET_RX_STATUS_DESC_ICV_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+ #define GET_RX_STATUS_DESC_DRVINFO_SIZE_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) -+ #define GET_RX_STATUS_DESC_SECURITY_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) -+ #define GET_RX_STATUS_DESC_QOS_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) -+ #define GET_RX_STATUS_DESC_SHIFT_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) -+ #define GET_RX_STATUS_DESC_PHY_STATUS_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) -+ #define GET_RX_STATUS_DESC_SWDEC_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) -+ #define GET_RX_STATUS_DESC_LAST_SEG_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 28, 1) -+ #define GET_RX_STATUS_DESC_FIRST_SEG_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 29, 1) -+ #define GET_RX_STATUS_DESC_EOR_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) -+ #define GET_RX_STATUS_DESC_OWN_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+ -+ /* DWORD 1 */ -+ #define GET_RX_STATUS_DESC_MACID_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+ #define GET_RX_STATUS_DESC_TID_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+ #define GET_RX_STATUS_DESC_AMSDU_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+ #define GET_RX_STATUS_DESC_RXID_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) -+ #define GET_RX_STATUS_DESC_PAGGR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) -+ #define GET_RX_STATUS_DESC_A1_FIT_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) -+ #define GET_RX_STATUS_DESC_CHKERR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) -+ #define GET_RX_STATUS_DESC_IPVER_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+ #define GET_RX_STATUS_DESC_IS_TCPUDP__8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+ #define GET_RX_STATUS_DESC_CHK_VLD_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+ #define GET_RX_STATUS_DESC_PAM_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) -+ #define GET_RX_STATUS_DESC_PWR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) -+ #define GET_RX_STATUS_DESC_MORE_DATA_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) -+ #define GET_RX_STATUS_DESC_MORE_FRAG_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) -+ #define GET_RX_STATUS_DESC_TYPE_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) -+ #define GET_RX_STATUS_DESC_MC_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) -+ #define GET_RX_STATUS_DESC_BC_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) -+ -+ /* DWORD 2 */ -+ #define GET_RX_STATUS_DESC_SEQ_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) -+ #define GET_RX_STATUS_DESC_FRAG_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) -+ #define GET_RX_STATUS_DESC_RX_IS_QOS_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) -+ #define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) -+ #define GET_RX_STATUS_DESC_RPT_SEL_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) -+ -+ /* DWORD 3 */ -+ #define GET_RX_STATUS_DESC_RX_RATE_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) -+ #define GET_RX_STATUS_DESC_HTC_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) -+ #define GET_RX_STATUS_DESC_EOSP_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) -+ #define GET_RX_STATUS_DESC_BSSID_FIT_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) -+ #ifdef CONFIG_USB_RX_AGGREGATION -+ #define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) -+ #endif -+ #define GET_RX_STATUS_DESC_PATTERN_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) -+ #define GET_RX_STATUS_DESC_UNICAST_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) -+ #define GET_RX_STATUS_DESC_MAGIC_MATCH_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) -+ -+ /* DWORD 6 */ -+ #define GET_RX_STATUS_DESC_SPLCP_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 1) -+ #define GET_RX_STATUS_DESC_LDPC_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 1, 1) -+ #define GET_RX_STATUS_DESC_STBC_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 2, 1) -+ #define GET_RX_STATUS_DESC_BW_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 4, 2) -+ -+ /* DWORD 5 */ -+ #define GET_RX_STATUS_DESC_TSFL_8723B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) -+ -+ #define GET_RX_STATUS_DESC_BUFF_ADDR_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+ #define GET_RX_STATUS_DESC_BUFF_ADDR64_8723B(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+ #define SET_RX_STATUS_DESC_BUFF_ADDR_8723B(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) -+ -+ -+ /* Dword 0 */ -+ #define GET_TX_DESC_OWN_8723B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+ #define SET_TX_DESC_PKT_SIZE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+ #define SET_TX_DESC_OFFSET_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+ #define SET_TX_DESC_BMC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+ #define SET_TX_DESC_HTC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+ #define SET_TX_DESC_LAST_SEG_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+ #define SET_TX_DESC_FIRST_SEG_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+ #define SET_TX_DESC_LINIP_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+ #define SET_TX_DESC_NO_ACM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+ #define SET_TX_DESC_GF_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+ #define SET_TX_DESC_OWN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+ /* Dword 1 */ -+ #define SET_TX_DESC_MACID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+ #define SET_TX_DESC_QUEUE_SEL_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+ #define SET_TX_DESC_RDG_NAV_EXT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+ #define SET_TX_DESC_LSIG_TXOP_EN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+ #define SET_TX_DESC_PIFS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+ #define SET_TX_DESC_RATE_ID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+ #define SET_TX_DESC_EN_DESC_ID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+ #define SET_TX_DESC_SEC_TYPE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+ #define SET_TX_DESC_PKT_OFFSET_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+ -+ -+ /* Dword 2 */ -+ #define SET_TX_DESC_PAID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+ #define SET_TX_DESC_CCA_RTS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+ #define SET_TX_DESC_AGG_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+ #define SET_TX_DESC_RDG_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+ #define SET_TX_DESC_AGG_BREAK_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+ #define SET_TX_DESC_MORE_FRAG_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+ #define SET_TX_DESC_RAW_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+ #define SET_TX_DESC_SPE_RPT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+ #define SET_TX_DESC_AMPDU_DENSITY_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+ #define SET_TX_DESC_BT_INT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+ #define SET_TX_DESC_GID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+ -+ -+ /* Dword 3 */ -+ #define SET_TX_DESC_WHEADER_LEN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) -+ #define SET_TX_DESC_CHK_EN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) -+ #define SET_TX_DESC_EARLY_MODE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+ #define SET_TX_DESC_HWSEQ_SEL_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+ #define SET_TX_DESC_USE_RATE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+ #define SET_TX_DESC_DISABLE_RTS_FB_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+ #define SET_TX_DESC_DISABLE_FB_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+ #define SET_TX_DESC_CTS2SELF_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+ #define SET_TX_DESC_RTS_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+ #define SET_TX_DESC_HW_RTS_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+ #define SET_TX_DESC_NAV_USE_HDR_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+ #define SET_TX_DESC_USE_MAX_LEN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+ #define SET_TX_DESC_MAX_AGG_NUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+ #define SET_TX_DESC_NDPA_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+ #define SET_TX_DESC_AMPDU_MAX_TIME_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+ /* Dword 4 */ -+ #define SET_TX_DESC_TX_RATE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+ #define SET_TX_DESC_DATA_RATE_FB_LIMIT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+ #define SET_TX_DESC_RTS_RATE_FB_LIMIT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+ #define SET_TX_DESC_RETRY_LIMIT_ENABLE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+ #define SET_TX_DESC_DATA_RETRY_LIMIT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+ #define SET_TX_DESC_RTS_RATE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+ -+ -+ /* Dword 5 */ -+ #define SET_TX_DESC_DATA_SC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+ #define SET_TX_DESC_DATA_SHORT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+ #define SET_TX_DESC_DATA_BW_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+ #define SET_TX_DESC_DATA_LDPC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+ #define SET_TX_DESC_DATA_STBC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+ #define SET_TX_DESC_CTROL_STBC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+ #define SET_TX_DESC_RTS_SHORT_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+ #define SET_TX_DESC_RTS_SC_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+ -+ -+ /* Dword 6 */ -+ #define SET_TX_DESC_SW_DEFINE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+ #define SET_TX_DESC_MBSSID_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+ #define SET_TX_DESC_ANTSEL_A_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+ #define SET_TX_DESC_ANTSEL_B_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+ #define SET_TX_DESC_ANTSEL_C_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) -+ #define SET_TX_DESC_ANTSEL_D_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) -+ -+ /* Dword 7 */ -+ #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ #define SET_TX_DESC_TX_BUFFER_SIZE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+ #else -+ #define SET_TX_DESC_TX_DESC_CHECKSUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+ #endif -+ #define SET_TX_DESC_USB_TXAGG_NUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+ #if (DEV_BUS_TYPE == RT_SDIO_INTERFACE) -+ #define SET_TX_DESC_SDIO_TXSEQ_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) -+ #endif -+ -+ /* Dword 8 */ -+ #define SET_TX_DESC_HWSEQ_EN_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+ -+ /* Dword 9 */ -+ #define SET_TX_DESC_SEQ_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+ -+ /* Dword 10 */ -+ #define SET_TX_DESC_TX_BUFFER_ADDRESS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) -+ #define GET_TX_DESC_TX_BUFFER_ADDRESS_8723B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) -+ -+ /* Dword 11 */ -+ #define SET_TX_DESC_NEXT_DESC_ADDRESS_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) -+ -+ -+ #define SET_EARLYMODE_PKTNUM_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+ #define SET_EARLYMODE_LEN0_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+ #define SET_EARLYMODE_LEN1_1_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+ #define SET_EARLYMODE_LEN1_2_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+ #define SET_EARLYMODE_LEN2_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+ #define SET_EARLYMODE_LEN3_8723B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+#endif -+/* ----------------------------------------------------------- -+ * -+ * Rate -+ * -+ * ----------------------------------------------------------- -+ * CCK Rates, TxHT = 0 */ -+#define DESC8723B_RATE1M 0x00 -+#define DESC8723B_RATE2M 0x01 -+#define DESC8723B_RATE5_5M 0x02 -+#define DESC8723B_RATE11M 0x03 -+ -+/* OFDM Rates, TxHT = 0 */ -+#define DESC8723B_RATE6M 0x04 -+#define DESC8723B_RATE9M 0x05 -+#define DESC8723B_RATE12M 0x06 -+#define DESC8723B_RATE18M 0x07 -+#define DESC8723B_RATE24M 0x08 -+#define DESC8723B_RATE36M 0x09 -+#define DESC8723B_RATE48M 0x0a -+#define DESC8723B_RATE54M 0x0b -+ -+/* MCS Rates, TxHT = 1 */ -+#define DESC8723B_RATEMCS0 0x0c -+#define DESC8723B_RATEMCS1 0x0d -+#define DESC8723B_RATEMCS2 0x0e -+#define DESC8723B_RATEMCS3 0x0f -+#define DESC8723B_RATEMCS4 0x10 -+#define DESC8723B_RATEMCS5 0x11 -+#define DESC8723B_RATEMCS6 0x12 -+#define DESC8723B_RATEMCS7 0x13 -+#define DESC8723B_RATEMCS8 0x14 -+#define DESC8723B_RATEMCS9 0x15 -+#define DESC8723B_RATEMCS10 0x16 -+#define DESC8723B_RATEMCS11 0x17 -+#define DESC8723B_RATEMCS12 0x18 -+#define DESC8723B_RATEMCS13 0x19 -+#define DESC8723B_RATEMCS14 0x1a -+#define DESC8723B_RATEMCS15 0x1b -+#define DESC8723B_RATEVHTSS1MCS0 0x2c -+#define DESC8723B_RATEVHTSS1MCS1 0x2d -+#define DESC8723B_RATEVHTSS1MCS2 0x2e -+#define DESC8723B_RATEVHTSS1MCS3 0x2f -+#define DESC8723B_RATEVHTSS1MCS4 0x30 -+#define DESC8723B_RATEVHTSS1MCS5 0x31 -+#define DESC8723B_RATEVHTSS1MCS6 0x32 -+#define DESC8723B_RATEVHTSS1MCS7 0x33 -+#define DESC8723B_RATEVHTSS1MCS8 0x34 -+#define DESC8723B_RATEVHTSS1MCS9 0x35 -+#define DESC8723B_RATEVHTSS2MCS0 0x36 -+#define DESC8723B_RATEVHTSS2MCS1 0x37 -+#define DESC8723B_RATEVHTSS2MCS2 0x38 -+#define DESC8723B_RATEVHTSS2MCS3 0x39 -+#define DESC8723B_RATEVHTSS2MCS4 0x3a -+#define DESC8723B_RATEVHTSS2MCS5 0x3b -+#define DESC8723B_RATEVHTSS2MCS6 0x3c -+#define DESC8723B_RATEVHTSS2MCS7 0x3d -+#define DESC8723B_RATEVHTSS2MCS8 0x3e -+#define DESC8723B_RATEVHTSS2MCS9 0x3f -+ -+ -+#define RX_HAL_IS_CCK_RATE_8723B(pDesc)\ -+ (GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE1M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE2M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE5_5M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8723B(pDesc) == DESC8723B_RATE11M) -+ -+ -+void rtl8723b_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); -+void rtl8723b_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+#if defined(CONFIG_CONCURRENT_MODE) -+ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ s32 rtl8723bs_init_xmit_priv(PADAPTER padapter); -+ void rtl8723bs_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8723bs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8723bs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8723bs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8723bs_xmit_buf_handler(PADAPTER padapter); -+ thread_return rtl8723bs_xmit_thread(thread_context context); -+ #define hal_xmit_handler rtl8723bs_xmit_buf_handler -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ s32 rtl8723bu_xmit_buf_handler(PADAPTER padapter); -+ #define hal_xmit_handler rtl8723bu_xmit_buf_handler -+ -+ -+ s32 rtl8723bu_init_xmit_priv(PADAPTER padapter); -+ void rtl8723bu_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8723bu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8723bu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8723bu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ /* s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); */ -+ void rtl8723bu_xmit_tasklet(void *priv); -+ s32 rtl8723bu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+ void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, struct tx_desc *ptxdesc); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8723be_init_xmit_priv(PADAPTER padapter); -+ void rtl8723be_free_xmit_priv(PADAPTER padapter); -+ struct xmit_buf *rtl8723be_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+ void rtl8723be_xmitframe_resume(_adapter *padapter); -+ s32 rtl8723be_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8723be_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8723be_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ void rtl8723be_xmit_tasklet(void *priv); -+#endif -+ -+u8 BWMapping_8723B(PADAPTER Adapter, struct pkt_attrib *pattrib); -+u8 SCMapping_8723B(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_cmd.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_cmd.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,211 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723D_CMD_H__ -+#define __RTL8723D_CMD_H__ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+enum h2c_cmd_8723D { -+ /* Common Class: 000 */ -+ H2C_8723D_RSVD_PAGE = 0x00, -+ H2C_8723D_MEDIA_STATUS_RPT = 0x01, -+ H2C_8723D_SCAN_ENABLE = 0x02, -+ H2C_8723D_KEEP_ALIVE = 0x03, -+ H2C_8723D_DISCON_DECISION = 0x04, -+ H2C_8723D_PSD_OFFLOAD = 0x05, -+ H2C_8723D_AP_OFFLOAD = 0x08, -+ H2C_8723D_BCN_RSVDPAGE = 0x09, -+ H2C_8723D_PROBERSP_RSVDPAGE = 0x0A, -+ H2C_8723D_FCS_RSVDPAGE = 0x10, -+ H2C_8723D_FCS_INFO = 0x11, -+ H2C_8723D_AP_WOW_GPIO_CTRL = 0x13, -+ -+ /* PoweSave Class: 001 */ -+ H2C_8723D_SET_PWR_MODE = 0x20, -+ H2C_8723D_PS_TUNING_PARA = 0x21, -+ H2C_8723D_PS_TUNING_PARA2 = 0x22, -+ H2C_8723D_P2P_LPS_PARAM = 0x23, -+ H2C_8723D_P2P_PS_OFFLOAD = 0x24, -+ H2C_8723D_PS_SCAN_ENABLE = 0x25, -+ H2C_8723D_SAP_PS_ = 0x26, -+ H2C_8723D_INACTIVE_PS_ = 0x27, /* Inactive_PS */ -+ H2C_8723D_FWLPS_IN_IPS_ = 0x28, -+ -+ /* Dynamic Mechanism Class: 010 */ -+ H2C_8723D_MACID_CFG = 0x40, -+ H2C_8723D_TXBF = 0x41, -+ H2C_8723D_RSSI_SETTING = 0x42, -+ H2C_8723D_AP_REQ_TXRPT = 0x43, -+ H2C_8723D_INIT_RATE_COLLECT = 0x44, -+ H2C_8723D_RA_PARA_ADJUST = 0x46, -+ -+ /* BT Class: 011 */ -+ H2C_8723D_B_TYPE_TDMA = 0x60, -+ H2C_8723D_BT_INFO = 0x61, -+ H2C_8723D_FORCE_BT_TXPWR = 0x62, -+ H2C_8723D_BT_IGNORE_WLANACT = 0x63, -+ H2C_8723D_DAC_SWING_VALUE = 0x64, -+ H2C_8723D_ANT_SEL_RSV = 0x65, -+ H2C_8723D_WL_OPMODE = 0x66, -+ H2C_8723D_BT_MP_OPER = 0x67, -+ H2C_8723D_BT_CONTROL = 0x68, -+ H2C_8723D_BT_WIFI_CTRL = 0x69, -+ H2C_8723D_BT_FW_PATCH = 0x6A, -+ H2C_8723D_BT_WLAN_CALIBRATION = 0x6D, -+ -+ /* WOWLAN Class: 100 */ -+ H2C_8723D_WOWLAN = 0x80, -+ H2C_8723D_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8723D_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8723D_AOAC_RSVD_PAGE = 0x83, -+ H2C_8723D_AOAC_RSVD_PAGE2 = 0x84, -+ H2C_8723D_D0_SCAN_OFFLOAD_CTRL = 0x85, -+ H2C_8723D_D0_SCAN_OFFLOAD_INFO = 0x86, -+ H2C_8723D_CHNL_SWITCH_OFFLOAD = 0x87, -+ H2C_8723D_P2P_OFFLOAD_RSVD_PAGE = 0x8A, -+ H2C_8723D_P2P_OFFLOAD = 0x8B, -+ -+ H2C_8723D_RESET_TSF = 0xC0, -+ H2C_8723D_MAXID, -+}; -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- -+ * _RSVDPAGE_LOC_CMD_0x00 */ -+#define SET_8723D_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723D_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8723D_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8723D_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8723D_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+/* _KEEP_ALIVE_CMD_0x03 */ -+#define SET_8723D_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8723D_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8723D_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8723D_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _DISCONNECT_DECISION_CMD_0x04 */ -+#define SET_8723D_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8723D_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8723D_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723D_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+ -+/* _PWR_MOD_CMD_0x20 */ -+#define SET_8723D_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723D_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8723D_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8723D_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8723D_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8723D_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8723D_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+#define GET_8723D_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+/* _PS_TUNE_PARAM_CMD_0x21 */ -+#define SET_8723D_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723D_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723D_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) -+#define SET_8723D_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) -+#define SET_8723D_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _MACID_CFG_CMD_0x40 */ -+#define SET_8723D_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723D_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) -+#define SET_8723D_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) -+#define SET_8723D_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) -+#define SET_8723D_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) -+#define SET_8723D_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) -+#define SET_8723D_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) -+#define SET_8723D_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) -+#define SET_8723D_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8723D_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+#define SET_8723D_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) -+#define SET_8723D_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) -+ -+/* _RSSI_SETTING_CMD_0x42 */ -+#define SET_8723D_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723D_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) -+#define SET_8723D_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+ -+/* _AP_REQ_TXRPT_CMD_0x43 */ -+#define SET_8723D_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8723D_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+ -+/* _FORCE_BT_TXPWR_CMD_0x62 */ -+#define SET_8723D_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+ -+/* _FORCE_BT_MP_OPER_CMD_0x67 */ -+#define SET_8723D_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -+#define SET_8723D_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -+#define SET_8723D_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8723D_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+#define SET_8723D_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) -+#define SET_8723D_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) -+ -+/* _BT_FW_PATCH_0x6A */ -+#define SET_8723D_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) -+#define SET_8723D_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8723D_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8723D_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8723D_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ------------------------------------------- Structure -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+ -+/* --------------------------------------------------------------------------------------------------------- -+ * ---------------------------------- Function Statement -------------------------------------------------- -+ * --------------------------------------------------------------------------------------------------------- */ -+ -+/* host message to firmware cmd */ -+void rtl8723d_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); -+void rtl8723d_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -+void rtl8723d_set_rssi_cmd(PADAPTER padapter, u8 *param); -+void rtl8723d_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); -+/* s32 rtl8723d_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ -+void rtl8723d_set_FwPsTuneParam_cmd(PADAPTER padapter); -+void rtl8723d_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); -+void rtl8723d_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); -+void rtl8723d_download_rsvd_page(PADAPTER padapter, u8 mstatus); -+#ifdef CONFIG_BT_COEXIST -+ void rtl8723d_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif /* CONFIG_BT_COEXIST */ -+#ifdef CONFIG_P2P -+ void rtl8723d_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif /* CONFIG_P2P */ -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+ -+#ifdef CONFIG_P2P_WOWLAN -+ void rtl8723d_set_p2p_wowlan_offload_cmd(PADAPTER padapter); -+#endif -+ -+void rtl8723d_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 en); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+ u8 rtl8723d_reset_tsf(_adapter *padapter, u8 reset_port); -+#endif /* CONFIG_TSF_RESET_OFFLOAD */ -+s32 FillH2CCmd8723D(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8723D(_adapter *padapter, bool wowlan); -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_dm.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_dm.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,47 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723D_DM_H__ -+#define __RTL8723D_DM_H__ -+/* ************************************************************ -+ * Description: -+ * -+ * This file is for 8723D dynamic mechanism only -+ * -+ * -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * structure and define -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * function prototype -+ * ************************************************************ */ -+ -+void rtl8723d_init_dm_priv(PADAPTER padapter); -+void rtl8723d_deinit_dm_priv(PADAPTER padapter); -+ -+void rtl8723d_InitHalDm(PADAPTER padapter); -+void rtl8723d_HalDmWatchDog(PADAPTER padapter); -+void rtl8723d_HalDmWatchDog_in_LPS(PADAPTER padapter); -+void rtl8723d_hal_dm_in_lps(PADAPTER padapter); -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_hal.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,316 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723D_HAL_H__ -+#define __RTL8723D_HAL_H__ -+ -+#include "hal_data.h" -+ -+#include "rtl8723d_spec.h" -+#include "rtl8723d_rf.h" -+#include "rtl8723d_dm.h" -+#include "rtl8723d_recv.h" -+#include "rtl8723d_xmit.h" -+#include "rtl8723d_cmd.h" -+#include "rtl8723d_led.h" -+#include "Hal8723DPwrSeq.h" -+#include "Hal8723DPhyReg.h" -+#include "Hal8723DPhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+ #include "rtl8723d_sreset.h" -+#endif -+#ifdef CONFIG_LPS_POFF -+ #include "rtl8723d_lps_poff.h" -+#endif -+ -+#define FW_8723D_SIZE 0x8000 -+#define FW_8723D_START_ADDRESS 0x1000 -+#define FW_8723D_END_ADDRESS 0x1FFF /* 0x5FFF */ -+ -+#define IS_FW_HEADER_EXIST_8723D(_pFwHdr)\ -+ ((le16_to_cpu(_pFwHdr->Signature) & 0xFFF0) == 0x23D0) -+ -+typedef struct _RT_FIRMWARE { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8 *szFwBuffer; -+#else -+ u8 szFwBuffer[FW_8723D_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8723D, *PRT_FIRMWARE_8723D; -+ -+/* -+ * This structure must be cared byte-ordering -+ * -+ * Added by tynli. 2009.12.04. */ -+typedef struct _RT_8723D_FIRMWARE_HDR { -+ /* 8-byte alinment required */ -+ -+ /* --- LONG WORD 0 ---- */ -+ u16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ -+ u8 Category; /* AP/NIC and USB/PCI */ -+ u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ -+ u16 Version; /* FW Version */ -+ u16 Subversion; /* FW Subversion, default 0x00 */ -+ -+ /* --- LONG WORD 1 ---- */ -+ u8 Month; /* Release time Month field */ -+ u8 Date; /* Release time Date field */ -+ u8 Hour; /* Release time Hour field */ -+ u8 Minute; /* Release time Minute field */ -+ u16 RamCodeSize; /* The size of RAM code */ -+ u16 Rsvd2; -+ -+ /* --- LONG WORD 2 ---- */ -+ u32 SvnIdx; /* The SVN entry index */ -+ u32 Rsvd3; -+ -+ /* --- LONG WORD 3 ---- */ -+ u32 Rsvd4; -+ u32 Rsvd5; -+} RT_8723D_FIRMWARE_HDR, *PRT_8723D_FIRMWARE_HDR; -+ -+#define DRIVER_EARLY_INT_TIME_8723D 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8723D 0x02 -+ -+/* for 8723D -+ * TX 32K, RX 16K, Page size 128B for TX, 8B for RX */ -+#define PAGE_SIZE_TX_8723D 128 -+#define PAGE_SIZE_RX_8723D 8 -+ -+#define TX_DMA_SIZE_8723D 0x8000 /* 32K(TX) */ -+#define RX_DMA_SIZE_8723D 0x4000 /* 16K(RX) */ -+ -+#ifdef CONFIG_WOWLAN -+ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ -+#else -+ #define RESV_FMWF 0 -+#endif -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+ #define RX_DMA_RESERVED_SIZE_8723D 0x100 /* 256B, reserved for c2h debug message */ -+#else -+ #define RX_DMA_RESERVED_SIZE_8723D 0x80 /* 128B, reserved for tx report */ -+#endif -+#define RX_DMA_BOUNDARY_8723D\ -+ (RX_DMA_SIZE_8723D - RX_DMA_RESERVED_SIZE_8723D - 1) -+ -+ -+/* Note: We will divide number of page equally for each queue other than public queue! */ -+ -+/* For General Reserved Page Number(Beacon Queue is reserved page) -+ * Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 */ -+#define BCNQ_PAGE_NUM_8723D 0x08 -+#ifdef CONFIG_CONCURRENT_MODE -+ #define BCNQ1_PAGE_NUM_8723D 0x08 /* 0x04 */ -+#else -+ #define BCNQ1_PAGE_NUM_8723D 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+ #undef BCNQ1_PAGE_NUM_8723D -+ #define BCNQ1_PAGE_NUM_8723D 0x00 /* 0x04 */ -+#endif -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8723D 0x07 -+#else -+ #define WOWLAN_PAGE_NUM_8723D 0x00 -+#endif -+ -+#ifdef CONFIG_PNO_SUPPORT -+ #undef WOWLAN_PAGE_NUM_8723D -+ #define WOWLAN_PAGE_NUM_8723D 0x15 -+#endif -+ -+#ifdef CONFIG_AP_WOWLAN -+ #define AP_WOWLAN_PAGE_NUM_8723D 0x02 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8723D\ -+ (0xFF - BCNQ_PAGE_NUM_8723D - BCNQ1_PAGE_NUM_8723D - WOWLAN_PAGE_NUM_8723D) -+#define TX_PAGE_BOUNDARY_8723D (TX_TOTAL_PAGE_NUMBER_8723D + 1) -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723D TX_TOTAL_PAGE_NUMBER_8723D -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8723D\ -+ (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723D + 1) -+ -+/* For Normal Chip Setting -+ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8723D */ -+#define NORMAL_PAGE_NUM_HPQ_8723D 0x0C -+#define NORMAL_PAGE_NUM_LPQ_8723D 0x02 -+#define NORMAL_PAGE_NUM_NPQ_8723D 0x02 -+ -+/* Note: For Normal Chip Setting, modify later */ -+#define WMM_NORMAL_PAGE_NUM_HPQ_8723D 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8723D 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8723D 0x20 -+ -+ -+#include "HalVerDef.h" -+#include "hal_com.h" -+ -+#define EFUSE_OOB_PROTECT_BYTES (96 + 1) -+ -+#define HAL_EFUSE_MEMORY -+#define HWSET_MAX_SIZE_8723D 512 -+#define EFUSE_REAL_CONTENT_LEN_8723D 512 -+#define EFUSE_MAP_LEN_8723D 512 -+#define EFUSE_MAX_SECTION_8723D 64 -+ -+/* For some inferiority IC purpose. added by Roger, 2009.09.02.*/ -+#define EFUSE_IC_ID_OFFSET 506 -+#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8723D) -+ -+#define EFUSE_ACCESS_ON 0x69 -+#define EFUSE_ACCESS_OFF 0x00 -+ -+/* ******************************************************** -+ * EFUSE for BT definition -+ * ******************************************************** */ -+#define BANK_NUM 1 -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN 128 -+#define EFUSE_BT_REAL_CONTENT_LEN \ -+ (EFUSE_BT_REAL_BANK_CONTENT_LEN * BANK_NUM) -+#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ -+#define EFUSE_BT_MAX_SECTION (EFUSE_BT_MAP_LEN / 8) -+#define EFUSE_PROTECT_BYTES_BANK 16 -+ -+typedef enum tag_Package_Definition { -+ PACKAGE_DEFAULT, -+ PACKAGE_QFN68, -+ PACKAGE_TFBGA90, -+ PACKAGE_TFBGA80, -+ PACKAGE_TFBGA79 -+} PACKAGE_TYPE_E; -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) \ -+ (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) \ -+ (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+#ifdef CONFIG_FILE_FWIMG -+ extern char *rtw_fw_file_path; -+ extern char *rtw_fw_wow_file_path; -+ #ifdef CONFIG_MP_INCLUDED -+ extern char *rtw_fw_mp_bt_file_path; -+ #endif /* CONFIG_MP_INCLUDED */ -+#endif /* CONFIG_FILE_FWIMG */ -+ -+/* rtl8723d_hal_init.c */ -+s32 rtl8723d_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); -+void rtl8723d_FirmwareSelfReset(PADAPTER padapter); -+void rtl8723d_InitializeFirmwareVars(PADAPTER padapter); -+ -+void rtl8723d_InitAntenna_Selection(PADAPTER padapter); -+void rtl8723d_DeinitAntenna_Selection(PADAPTER padapter); -+void rtl8723d_CheckAntenna_Selection(PADAPTER padapter); -+void rtl8723d_init_default_value(PADAPTER padapter); -+ -+s32 rtl8723d_InitLLTTable(PADAPTER padapter); -+ -+s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); -+s32 CardDisableWithoutHWSM(PADAPTER padapter); -+ -+/* EFuse */ -+u8 GetEEPROMSize8723D(PADAPTER padapter); -+void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); -+void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); -+void Hal_EfuseParseTxPowerInfo_8723D(PADAPTER padapter, -+ u8 *PROMContent, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseBTCoexistInfo_8723D(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseEEPROMVer_8723D(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParsePackageType_8723D(PADAPTER pAdapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseChnlPlan_8723D(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseCustomerID_8723D(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseAntennaDiversity_8723D(PADAPTER padapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8723D(PADAPTER pAdapter, -+ u8 *hwinfo, u8 AutoLoadFail); -+void Hal_EfuseParseThermalMeter_8723D(PADAPTER padapter, -+ u8 *hwinfo, u8 AutoLoadFail); -+VOID Hal_EfuseParseVoltage_8723D(PADAPTER pAdapter, -+ u8 *hwinfo, BOOLEAN AutoLoadFail); -+VOID Hal_EfuseParseBoardType_8723D(PADAPTER Adapter, -+ u8 *PROMContent, BOOLEAN AutoloadFail); -+ -+void rtl8723d_set_hal_ops(struct hal_ops *pHalFunc); -+void init_hal_spec_8723d(_adapter *adapter); -+void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val); -+void GetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val); -+u8 SetHalDefVar8723D(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8723D(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+ -+/* register */ -+void rtl8723d_InitBeaconParameters(PADAPTER padapter); -+void rtl8723d_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); -+void _InitBurstPktLen_8723DS(PADAPTER Adapter); -+void _InitLTECoex_8723DS(PADAPTER Adapter); -+void _InitMacAPLLSetting_8723D(PADAPTER Adapter); -+void _8051Reset8723(PADAPTER padapter); -+#ifdef CONFIG_WOWLAN -+ void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif /* CONFIG_WOWLAN */ -+ -+void rtl8723d_start_thread(_adapter *padapter); -+void rtl8723d_stop_thread(_adapter *padapter); -+ -+#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) -+ void rtl8723ds_init_checkbthang_workqueue(_adapter *adapter); -+ void rtl8723ds_free_checkbthang_workqueue(_adapter *adapter); -+ void rtl8723ds_cancle_checkbthang_workqueue(_adapter *adapter); -+ void rtl8723ds_hal_check_bt_hang(_adapter *adapter); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); -+#endif -+#ifdef CONFIG_MP_INCLUDED -+int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); -+#endif -+void CCX_FwC2HTxRpt_8723d(PADAPTER padapter, u8 *pdata, u8 len); -+ -+u8 MRateToHwRate8723D(u8 rate); -+u8 HwRateToMRate8723D(u8 rate); -+ -+void Hal_ReadRFGainOffset(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+ -+#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) -+ void check_bt_status_work(void *data); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ void rtl8723d_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ BOOLEAN InterruptRecognized8723DE(PADAPTER Adapter); -+ VOID UpdateInterruptMask8723DE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+ u16 get_txbufdesc_idx_hwaddr(u16 ff_hwaddr); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_led.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_led.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723D_LED_H__ -+#define __RTL8723D_LED_H__ -+ -+#include -+#include -+#include -+ -+ -+/* ******************************************************************************** -+ * Interface to manipulate LED objects. -+ * ******************************************************************************** */ -+#ifdef CONFIG_USB_HCI -+ void rtl8723du_InitSwLeds(PADAPTER padapter); -+ void rtl8723du_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_SDIO_HCI -+ void rtl8723ds_InitSwLeds(PADAPTER padapter); -+ void rtl8723ds_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_GSPI_HCI -+ void rtl8723ds_InitSwLeds(PADAPTER padapter); -+ void rtl8723ds_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+ void rtl8723de_InitSwLeds(PADAPTER padapter); -+ void rtl8723de_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_lps_poff.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_lps_poff.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_lps_poff.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_lps_poff.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,61 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+/******************************************** CONST ************************/ -+#define NUM_OF_REGISTER_BANK 13 -+#define NUM_OF_TOTAL_DWORD (NUM_OF_REGISTER_BANK * 64) -+#define TOTAL_LEN_FOR_HIOE ((NUM_OF_TOTAL_DWORD + 1) * 8) -+#define LPS_POFF_STATIC_FILE_LEN (TOTAL_LEN_FOR_HIOE + TXDESC_SIZE) -+#define LPS_POFF_DYNAMIC_FILE_LEN (512 + TXDESC_SIZE) -+/******************************************** CONST ************************/ -+ -+/******************************************** MACRO ************************/ -+/* HOIE Entry Definition */ -+#define SET_HOIE_ENTRY_LOW_DATA(__pHOIE, __Value) \ -+ SET_BITS_TO_LE_4BYTE((__pHOIE), 0, 16, __Value) -+#define SET_HOIE_ENTRY_HIGH_DATA(__pHOIE, __Value) \ -+ SET_BITS_TO_LE_4BYTE((__pHOIE), 16, 16, __Value) -+#define SET_HOIE_ENTRY_MODE_SELECT(__pHOIE, __Value) \ -+ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 0, 1, __Value) -+#define SET_HOIE_ENTRY_ADDRESS(__pHOIE, __Value) \ -+ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 1, 14, __Value) -+#define SET_HOIE_ENTRY_BYTE_MASK(__pHOIE, __Value) \ -+ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 15, 4, __Value) -+#define SET_HOIE_ENTRY_IO_LOCK(__pHOIE, __Value) \ -+ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 19, 1, __Value) -+#define SET_HOIE_ENTRY_RD_EN(__pHOIE, __Value) \ -+ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 20, 1, __Value) -+#define SET_HOIE_ENTRY_WR_EN(__pHOIE, __Value) \ -+ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 21, 1, __Value) -+#define SET_HOIE_ENTRY_RAW_RW(__pHOIE, __Value) \ -+ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 22, 1, __Value) -+#define SET_HOIE_ENTRY_RAW(__pHOIE, __Value) \ -+ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 23, 1, __Value) -+#define SET_HOIE_ENTRY_IO_DELAY(__pHOIE, __Value) \ -+ SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 24, 8, __Value) -+ -+/*********************Function Definition*******************************************/ -+void rtl8723d_lps_poff_init(PADAPTER padapter); -+void rtl8723d_lps_poff_deinit(PADAPTER padapter); -+bool rtl8723d_lps_poff_get_txbndy_status(PADAPTER padapter); -+void rtl8723d_lps_poff_h2c_ctrl(PADAPTER padapter, u8 enable); -+void rtl8723d_lps_poff_set_ps_mode(PADAPTER padapter, bool bEnterLPS); -+bool rtl8723d_lps_poff_get_status(PADAPTER padapter); -+void rtl8723d_lps_poff_wow(PADAPTER padapter); -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_recv.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_recv.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,120 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723D_RECV_H__ -+#define __RTL8723D_RECV_H__ -+ -+#define RECV_BLK_SZ 512 -+#define RECV_BLK_CNT 16 -+#define RECV_BLK_TH RECV_BLK_CNT -+ -+#if defined(CONFIG_USB_HCI) -+ -+ #ifndef MAX_RECVBUF_SZ -+ #ifdef PLATFORM_OS_CE -+ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ -+ #else -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ -+ /* #define MAX_RECVBUF_SZ (16384) */ /* 16K */ -+ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ -+ #ifdef CONFIG_PLATFORM_MSTAR -+ #define MAX_RECVBUF_SZ (8192) /* 8K */ -+ #else -+ #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ -+ #endif -+ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ -+ #else -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+ #endif -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+ -+#elif defined(CONFIG_PCI_HCI) -+ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ -+ /* #define MAX_RECVBUF_SZ (9100) */ -+ /* #else */ -+ #define MAX_RECVBUF_SZ (4000) /* about 4K -+ * #endif */ -+ -+ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ -+ #define MAX_RECVBUF_SZ (RX_DMA_BOUNDARY_8723D + 1) -+ -+#endif -+ -+/* Rx smooth factor */ -+#define Rx_Smooth_Factor (20) -+ -+#ifdef CONFIG_SDIO_HCI -+ #ifndef CONFIG_SDIO_RX_COPY -+ #undef MAX_RECVBUF_SZ -+ #define MAX_RECVBUF_SZ (RX_DMA_SIZE_8723D - RX_DMA_RESERVED_SIZE_8723D) -+ #endif /* !CONFIG_SDIO_RX_COPY */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+/*-----------------------------------------------------------------*/ -+/* RTL8723D RX BUFFER DESC */ -+/*-----------------------------------------------------------------*/ -+/*DWORD 0*/ -+#define SET_RX_BUFFER_DESC_DATA_LENGTH_8723D(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_BUFFER_DESC_LS_8723D(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 15, 1, __Value) -+#define SET_RX_BUFFER_DESC_FS_8723D(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 1, __Value) -+#define SET_RX_BUFFER_DESC_TOTAL_LENGTH_8723D(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 15, __Value) -+ -+#define GET_RX_BUFFER_DESC_OWN_8723D(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+#define GET_RX_BUFFER_DESC_LS_8723D(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_BUFFER_DESC_FS_8723D(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 1) -+#ifdef USING_RX_TAG -+ #define GET_RX_BUFFER_DESC_RX_TAG_8723D(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 13) -+#else -+ #define GET_RX_BUFFER_DESC_TOTAL_LENGTH_8723D(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 15) -+#endif -+ -+/*DWORD 1*/ -+#define SET_RX_BUFFER_PHYSICAL_LOW_8723D(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+4, 0, 32, __Value) -+ -+/*DWORD 2*/ -+#ifdef CONFIG_64BIT_DMA -+ #define SET_RX_BUFFER_PHYSICAL_HIGH_8723D(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+8, 0, 32, __Value) -+#else -+ #define SET_RX_BUFFER_PHYSICAL_HIGH_8723D(__pRxStatusDesc, __Value) -+#endif -+ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ s32 rtl8723ds_init_recv_priv(PADAPTER padapter); -+ void rtl8723ds_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ int rtl8723du_init_recv_priv(_adapter *padapter); -+ void rtl8723du_free_recv_priv(_adapter *padapter); -+ void rtl8723du_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8723de_init_recv_priv(PADAPTER padapter); -+ void rtl8723de_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8723d_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8723D_RECV_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_rf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_rf.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723D_RF_H__ -+#define __RTL8723D_RF_H__ -+ -+int PHY_RF6052_Config8723D(IN PADAPTER pdapter); -+ -+void PHY_RF6052SetBandwidth8723D(IN PADAPTER Adapter, IN CHANNEL_WIDTH Bandwidth); -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_spec.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_spec.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,459 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8723D_SPEC_H__ -+#define __RTL8723D_SPEC_H__ -+ -+#include -+ -+ -+#define HAL_NAV_UPPER_UNIT_8723D 128 /* micro-second */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0000h ~ 0x00FFh System Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_SYS_ISO_CTRL_8723D 0x0000 /* 2 Byte */ -+#define REG_SYS_FUNC_EN_8723D 0x0002 /* 2 Byte */ -+#define REG_APS_FSMCO_8723D 0x0004 /* 4 Byte */ -+#define REG_SYS_CLKR_8723D 0x0008 /* 2 Byte */ -+#define REG_9346CR_8723D 0x000A /* 2 Byte */ -+#define REG_EE_VPD_8723D 0x000C /* 2 Byte */ -+#define REG_AFE_MISC_8723D 0x0010 /* 1 Byte */ -+#define REG_SPS0_CTRL_8723D 0x0011 /* 7 Byte */ -+#define REG_SPS_OCP_CFG_8723D 0x0018 /* 4 Byte */ -+#define REG_RSV_CTRL_8723D 0x001C /* 3 Byte */ -+#define REG_RF_CTRL_8723D 0x001F /* 1 Byte */ -+#define REG_LPLDO_CTRL_8723D 0x0023 /* 1 Byte */ -+#define REG_AFE_XTAL_CTRL_8723D 0x0024 /* 4 Byte */ -+#define REG_AFE_PLL_CTRL_8723D 0x0028 /* 4 Byte */ -+#define REG_MAC_PLL_CTRL_EXT_8723D 0x002c /* 4 Byte */ -+#define REG_EFUSE_CTRL_8723D 0x0030 -+#define REG_EFUSE_TEST_8723D 0x0034 -+#define REG_PWR_DATA_8723D 0x0038 -+#define REG_CAL_TIMER_8723D 0x003C -+#define REG_ACLK_MON_8723D 0x003E -+#define REG_GPIO_MUXCFG_8723D 0x0040 -+#define REG_GPIO_IO_SEL_8723D 0x0042 -+#define REG_MAC_PINMUX_CFG_8723D 0x0043 -+#define REG_GPIO_PIN_CTRL_8723D 0x0044 -+#define REG_GPIO_INTM_8723D 0x0048 -+#define REG_LEDCFG0_8723D 0x004C -+#define REG_LEDCFG1_8723D 0x004D -+#define REG_LEDCFG2_8723D 0x004E -+#define REG_LEDCFG3_8723D 0x004F -+#define REG_FSIMR_8723D 0x0050 -+#define REG_FSISR_8723D 0x0054 -+#define REG_HSIMR_8723D 0x0058 -+#define REG_HSISR_8723D 0x005c -+#define REG_GPIO_EXT_CTRL 0x0060 -+#define REG_PAD_CTRL1_8723D 0x0064 -+#define REG_MULTI_FUNC_CTRL_8723D 0x0068 -+#define REG_GPIO_STATUS_8723D 0x006C -+#define REG_SDIO_CTRL_8723D 0x0070 -+#define REG_OPT_CTRL_8723D 0x0074 -+#define REG_AFE_CTRL_4_8723D 0x0078 -+#define REG_MCUFWDL_8723D 0x0080 -+#define REG_8051FW_CTRL_8723D 0x0080 -+#define REG_HMEBOX_DBG_0_8723D 0x0088 -+#define REG_HMEBOX_DBG_1_8723D 0x008A -+#define REG_HMEBOX_DBG_2_8723D 0x008C -+#define REG_HMEBOX_DBG_3_8723D 0x008E -+#define REG_WLLPS_CTRL 0x0090 -+#define REG_HIMR0_8723D 0x00B0 -+#define REG_HISR0_8723D 0x00B4 -+#define REG_HIMR1_8723D 0x00B8 -+#define REG_HISR1_8723D 0x00BC -+#define REG_PMC_DBG_CTRL2_8723D 0x00CC -+#define REG_EFUSE_BURN_GNT_8723D 0x00CF -+#define REG_HPON_FSM_8723D 0x00EC -+#define REG_SYS_CFG_8723D 0x00FC -+#define REG_ROM_VERSION 0x00FD -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_C2HEVT_CMD_ID_8723D 0x01A0 -+#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 -+#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 -+#define REG_C2HEVT_CMD_LEN_8723D 0x01AE -+#define REG_C2HEVT_CLEAR_8723D 0x01AF -+#define REG_MCUTST_1_8723D 0x01C0 -+#define REG_WOWLAN_WAKE_REASON 0x01C7 -+#define REG_FMETHR_8723D 0x01C8 -+#define REG_HMETFR_8723D 0x01CC -+#define REG_HMEBOX_0_8723D 0x01D0 -+#define REG_HMEBOX_1_8723D 0x01D4 -+#define REG_HMEBOX_2_8723D 0x01D8 -+#define REG_HMEBOX_3_8723D 0x01DC -+#define REG_LLT_INIT_8723D 0x01E0 -+#define REG_HMEBOX_EXT0_8723D 0x01F0 -+#define REG_HMEBOX_EXT1_8723D 0x01F4 -+#define REG_HMEBOX_EXT2_8723D 0x01F8 -+#define REG_HMEBOX_EXT3_8723D 0x01FC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RQPN_8723D 0x0200 -+#define REG_FIFOPAGE_8723D 0x0204 -+#define REG_DWBCN0_CTRL_8723D REG_TDECTRL -+#define REG_TXDMA_OFFSET_CHK_8723D 0x020C -+#define REG_TXDMA_STATUS_8723D 0x0210 -+#define REG_RQPN_NPQ_8723D 0x0214 -+#define REG_DWBCN1_CTRL_8723D 0x0228 -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0280h ~ 0x02FFh RXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RXDMA_AGG_PG_TH_8723D 0x0280 -+#define REG_FW_UPD_RDPTR_8723D 0x0284 /* FW shall update this register before FW write RXPKT_RELEASE_POLL to 1 */ -+#define REG_RXDMA_CONTROL_8723D 0x0286 /* Control the RX DMA. */ -+#define REG_RXDMA_STATUS_8723D 0x0288 -+#define REG_RXDMA_MODE_CTRL_8723D 0x0290 -+#define REG_EARLY_MODE_CONTROL_8723D 0x02BC -+#define REG_RSVD5_8723D 0x02F0 -+#define REG_RSVD6_8723D 0x02F4 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0300h ~ 0x03FFh PCIe -+ * -+ * ----------------------------------------------------- */ -+#define REG_PCIE_CTRL_REG_8723D 0x0300 -+#define REG_INT_MIG_8723D 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_TXBD_DESA_8723D 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_MGQ_TXBD_DESA_8723D 0x0310 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_TXBD_DESA_8723D 0x0318 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_TXBD_DESA_8723D 0x0320 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_TXBD_DESA_8723D 0x0328 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_TXBD_DESA_8723D 0x0330 /* TX BK Queue Descriptor Address */ -+#define REG_RXQ_RXBD_DESA_8723D 0x0338 /* RX Queue Descriptor Address */ -+#define REG_HI0Q_TXBD_DESA_8723D 0x0340 -+#define REG_HI1Q_TXBD_DESA_8723D 0x0348 -+#define REG_HI2Q_TXBD_DESA_8723D 0x0350 -+#define REG_HI3Q_TXBD_DESA_8723D 0x0358 -+#define REG_HI4Q_TXBD_DESA_8723D 0x0360 -+#define REG_HI5Q_TXBD_DESA_8723D 0x0368 -+#define REG_HI6Q_TXBD_DESA_8723D 0x0370 -+#define REG_HI7Q_TXBD_DESA_8723D 0x0378 -+#define REG_MGQ_TXBD_NUM_8723D 0x0380 -+#define REG_RX_RXBD_NUM_8723D 0x0382 -+#define REG_VOQ_TXBD_NUM_8723D 0x0384 -+#define REG_VIQ_TXBD_NUM_8723D 0x0386 -+#define REG_BEQ_TXBD_NUM_8723D 0x0388 -+#define REG_BKQ_TXBD_NUM_8723D 0x038A -+#define REG_HI0Q_TXBD_NUM_8723D 0x038C -+#define REG_HI1Q_TXBD_NUM_8723D 0x038E -+#define REG_HI2Q_TXBD_NUM_8723D 0x0390 -+#define REG_HI3Q_TXBD_NUM_8723D 0x0392 -+#define REG_HI4Q_TXBD_NUM_8723D 0x0394 -+#define REG_HI5Q_TXBD_NUM_8723D 0x0396 -+#define REG_HI6Q_TXBD_NUM_8723D 0x0398 -+#define REG_HI7Q_TXBD_NUM_8723D 0x039A -+#define REG_TSFTIMER_HCI_8723D 0x039C -+#define REG_BD_RW_PTR_CLR_8723D 0x039C -+ -+/* Read Write Point */ -+#define REG_VOQ_TXBD_IDX_8723D 0x03A0 -+#define REG_VIQ_TXBD_IDX_8723D 0x03A4 -+#define REG_BEQ_TXBD_IDX_8723D 0x03A8 -+#define REG_BKQ_TXBD_IDX_8723D 0x03AC -+#define REG_MGQ_TXBD_IDX_8723D 0x03B0 -+#define REG_RXQ_TXBD_IDX_8723D 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8723D 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8723D 0x03BC -+#define REG_HI2Q_TXBD_IDX_8723D 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8723D 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8723D 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8723D 0x03CC -+#define REG_HI6Q_TXBD_IDX_8723D 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8723D 0x03D4 -+ -+#define REG_PCIE_HCPWM_8723DE 0x03D8 /* ?????? */ -+#define REG_PCIE_HRPWM_8723DE 0x03DC /* PCIe RPWM ?????? */ -+#define REG_DBI_WDATA_V1_8723D 0x03E8 -+#define REG_DBI_RDATA_V1_8723D 0x03EC -+#define REG_DBI_FLAG_V1_8723D 0x03F0 -+#define REG_MDIO_V1_8723D 0x03F4 -+#define REG_PCIE_MIX_CFG_8723D 0x03F8 -+#define REG_HCI_MIX_CFG_8723D 0x03FC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_VOQ_INFORMATION_8723D 0x0400 -+#define REG_VIQ_INFORMATION_8723D 0x0404 -+#define REG_BEQ_INFORMATION_8723D 0x0408 -+#define REG_BKQ_INFORMATION_8723D 0x040C -+#define REG_MGQ_INFORMATION_8723D 0x0410 -+#define REG_HGQ_INFORMATION_8723D 0x0414 -+#define REG_BCNQ_INFORMATION_8723D 0x0418 -+#define REG_TXPKT_EMPTY_8723D 0x041A -+ -+#define REG_FWHW_TXQ_CTRL_8723D 0x0420 -+#define REG_HWSEQ_CTRL_8723D 0x0423 -+#define REG_TXPKTBUF_BCNQ_BDNY_8723D 0x0424 -+#define REG_TXPKTBUF_MGQ_BDNY_8723D 0x0425 -+#define REG_LIFECTRL_CTRL_8723D 0x0426 -+#define REG_MULTI_BCNQ_OFFSET_8723D 0x0427 -+#define REG_SPEC_SIFS_8723D 0x0428 -+#define REG_RL_8723D 0x042A -+#define REG_TXBF_CTRL_8723D 0x042C -+#define REG_DARFRC_8723D 0x0430 -+#define REG_RARFRC_8723D 0x0438 -+#define REG_RRSR_8723D 0x0440 -+#define REG_ARFR0_8723D 0x0444 -+#define REG_ARFR1_8723D 0x044C -+#define REG_CCK_CHECK_8723D 0x0454 -+#define REG_AMPDU_MAX_TIME_8723D 0x0456 -+#define REG_TXPKTBUF_BCNQ_BDNY1_8723D 0x0457 -+ -+#define REG_AMPDU_MAX_LENGTH_8723D 0x0458 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8723D 0x045D -+#define REG_NDPA_OPT_CTRL_8723D 0x045F -+#define REG_FAST_EDCA_CTRL_8723D 0x0460 -+#define REG_RD_RESP_PKT_TH_8723D 0x0463 -+#define REG_DATA_SC_8723D 0x0483 -+#ifdef CONFIG_WOWLAN -+ #define REG_TXPKTBUF_IV_LOW 0x0484 -+ #define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif -+#define REG_TXRPT_START_OFFSET 0x04AC -+#define REG_POWER_STAGE1_8723D 0x04B4 -+#define REG_POWER_STAGE2_8723D 0x04B8 -+#define REG_AMPDU_BURST_MODE_8723D 0x04BC -+#define REG_PKT_VO_VI_LIFE_TIME_8723D 0x04C0 -+#define REG_PKT_BE_BK_LIFE_TIME_8723D 0x04C2 -+#define REG_STBC_SETTING_8723D 0x04C4 -+#define REG_HT_SINGLE_AMPDU_8723D 0x04C7 -+#define REG_PROT_MODE_CTRL_8723D 0x04C8 -+#define REG_MAX_AGGR_NUM_8723D 0x04CA -+#define REG_RTS_MAX_AGGR_NUM_8723D 0x04CB -+#define REG_BAR_MODE_CTRL_8723D 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8723D 0x04CF -+#define REG_MACID_PKT_DROP0_8723D 0x04D0 -+#define REG_MACID_PKT_SLEEP_8723D 0x04D4 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_EDCA_VO_PARAM_8723D 0x0500 -+#define REG_EDCA_VI_PARAM_8723D 0x0504 -+#define REG_EDCA_BE_PARAM_8723D 0x0508 -+#define REG_EDCA_BK_PARAM_8723D 0x050C -+#define REG_BCNTCFG_8723D 0x0510 -+#define REG_PIFS_8723D 0x0512 -+#define REG_RDG_PIFS_8723D 0x0513 -+#define REG_SIFS_CTX_8723D 0x0514 -+#define REG_SIFS_TRX_8723D 0x0516 -+#define REG_AGGR_BREAK_TIME_8723D 0x051A -+#define REG_SLOT_8723D 0x051B -+#define REG_TX_PTCL_CTRL_8723D 0x0520 -+#define REG_TXPAUSE_8723D 0x0522 -+#define REG_DIS_TXREQ_CLR_8723D 0x0523 -+#define REG_RD_CTRL_8723D 0x0524 -+/* -+ * Format for offset 540h-542h: -+ * [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. -+ * [7:4]: Reserved. -+ * [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. -+ * [23:20]: Reserved -+ * Description: -+ * | -+ * |<--Setup--|--Hold------------>| -+ * --------------|---------------------- -+ * | -+ * TBTT -+ * Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. -+ * Described by Designer Tim and Bruce, 2011-01-14. -+ * */ -+#define REG_TBTT_PROHIBIT_8723D 0x0540 -+#define REG_RD_NAV_NXT_8723D 0x0544 -+#define REG_NAV_PROT_LEN_8723D 0x0546 -+#define REG_BCN_CTRL_8723D 0x0550 -+#define REG_BCN_CTRL_1_8723D 0x0551 -+#define REG_MBID_NUM_8723D 0x0552 -+#define REG_DUAL_TSF_RST_8723D 0x0553 -+#define REG_BCN_INTERVAL_8723D 0x0554 -+#define REG_DRVERLYINT_8723D 0x0558 -+#define REG_BCNDMATIM_8723D 0x0559 -+#define REG_ATIMWND_8723D 0x055A -+#define REG_USTIME_TSF_8723D 0x055C -+#define REG_BCN_MAX_ERR_8723D 0x055D -+#define REG_RXTSF_OFFSET_CCK_8723D 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8723D 0x055F -+#define REG_TSFTR_8723D 0x0560 -+#define REG_CTWND_8723D 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8723D 0x0577 -+#define REG_PSTIMER_8723D 0x0580 -+#define REG_TIMER0_8723D 0x0584 -+#define REG_TIMER1_8723D 0x0588 -+#define REG_ACMHWCTRL_8723D 0x05C0 -+#define REG_SCH_TXCMD_8723D 0x05F8 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_MAC_CR_8723D 0x0600 -+#define REG_TCR_8723D 0x0604 -+#define REG_RCR_8723D 0x0608 -+#define REG_RX_PKT_LIMIT_8723D 0x060C -+#define REG_RX_DLK_TIME_8723D 0x060D -+#define REG_RX_DRVINFO_SZ_8723D 0x060F -+ -+#define REG_MACID_8723D 0x0610 -+#define REG_BSSID_8723D 0x0618 -+#define REG_MAR_8723D 0x0620 -+#define REG_MBIDCAMCFG_8723D 0x0628 -+#define REG_WOWLAN_GTK_DBG1 0x630 -+#define REG_WOWLAN_GTK_DBG2 0x634 -+ -+#define REG_USTIME_EDCA_8723D 0x0638 -+#define REG_MAC_SPEC_SIFS_8723D 0x063A -+#define REG_RESP_SIFP_CCK_8723D 0x063C -+#define REG_RESP_SIFS_OFDM_8723D 0x063E -+#define REG_ACKTO_8723D 0x0640 -+#define REG_CTS2TO_8723D 0x0641 -+#define REG_EIFS_8723D 0x0642 -+ -+#define REG_NAV_UPPER_8723D 0x0652 /* unit of 128 */ -+#define REG_TRXPTCL_CTL_8723D 0x0668 -+ -+/* Security */ -+#define REG_CAMCMD_8723D 0x0670 -+#define REG_CAMWRITE_8723D 0x0674 -+#define REG_CAMREAD_8723D 0x0678 -+#define REG_CAMDBG_8723D 0x067C -+#define REG_SECCFG_8723D 0x0680 -+ -+/* Power */ -+#define REG_WOW_CTRL_8723D 0x0690 -+#define REG_PS_RX_INFO_8723D 0x0692 -+#define REG_UAPSD_TID_8723D 0x0693 -+#define REG_WKFMCAM_CMD_8723D 0x0698 -+#define REG_WKFMCAM_NUM_8723D 0x0698 -+#define REG_WKFMCAM_RWD_8723D 0x069C -+#define REG_RXFLTMAP0_8723D 0x06A0 -+#define REG_RXFLTMAP1_8723D 0x06A2 -+#define REG_RXFLTMAP2_8723D 0x06A4 -+#define REG_BCN_PSR_RPT_8723D 0x06A8 -+#define REG_BT_COEX_TABLE_8723D 0x06C0 -+#define REG_BFMER0_INFO_8723D 0x06E4 -+#define REG_BFMER1_INFO_8723D 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8723D 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8723D 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8723D 0x06FC -+ -+/* Hardware Port 2 */ -+#define REG_MACID1_8723D 0x0700 -+#define REG_BSSID1_8723D 0x0708 -+#define REG_BFMEE_SEL_8723D 0x0714 -+#define REG_SND_PTCL_CTRL_8723D 0x0718 -+ -+/* LTE_COEX */ -+#define REG_LTECOEX_CTRL 0x07C0 -+#define REG_LTECOEX_WRITE_DATA 0x07C4 -+#define REG_LTECOEX_READ_DATA 0x07C8 -+#define REG_LTECOEX_PATH_CONTROL 0x70 -+ -+/* ************************************************************ -+ * SDIO Bus Specification -+ * ************************************************************ */ -+ -+/* ----------------------------------------------------- -+ * SDIO CMD Address Mapping -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * I/O bus domain (Host) -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * SDIO register -+ * ----------------------------------------------------- */ -+#define SDIO_REG_HCPWM1_8723D 0x025 /* HCI Current Power Mode 1 */ -+#define REG_SDIO_HIMR_8723D 0x10250014 -+#define REG_SDIO_HISR_8723D 0x10250018 -+#define REG_SDIO_RX_REQ_LEN_8723D 0x1025001C -+ -+/* **************************************************************************** -+ * 8723 Regsiter Bit and Content definition -+ * **************************************************************************** */ -+ -+#define BIT_USB_RXDMA_AGG_EN BIT(31) -+#define RXDMA_AGG_MODE_EN BIT(1) -+ -+#ifdef CONFIG_WOWLAN -+ #define RXPKT_RELEASE_POLL BIT(16) -+ #define RXDMA_IDLE BIT(17) -+ #define RW_RELEASE_EN BIT(18) -+#endif -+ -+/* 2 HSISR -+ * interrupt mask which needs to clear */ -+#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ -+ HSISR_SPS_OCP_INT |\ -+ HSISR_RON_INT |\ -+ HSISR_PDNINT |\ -+ HSISR_GPIO9_INT) -+ -+#ifdef CONFIG_RF_POWER_TRIM -+ #ifdef CONFIG_RTL8723D -+ #define EEPROM_RF_GAIN_OFFSET 0xC1 -+ #endif -+ -+ #define EEPROM_RF_GAIN_VAL 0x1F6 -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ -+#ifdef CONFIG_PCI_HCI -+ /* #define IMR_RX_MASK (IMR_ROK_8723D|IMR_RDU_8723D|IMR_RXFOVW_8723D) */ -+ #define IMR_TX_MASK (IMR_VODOK_8723D | IMR_VIDOK_8723D | IMR_BEDOK_8723D | IMR_BKDOK_8723D | IMR_MGNTDOK_8723D | IMR_HIGHDOK_8723D) -+ -+ #define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8723D | IMR_TXBCN0OK_8723D | IMR_TXBCN0ERR_8723D | IMR_BCNDERR0_8723D) -+ -+ #define RT_AC_INT_MASKS (IMR_VIDOK_8723D | IMR_VODOK_8723D | IMR_BEDOK_8723D | IMR_BKDOK_8723D) -+#endif -+ -+/* ******************************************************** -+ * General definitions -+ * ******************************************************** */ -+ -+#define MACID_NUM_8723D 16 -+#define SEC_CAM_ENT_NUM_8723D 32 -+#define HW_PORT_NUM_8723D 3 /*port0, port1, port2*/ -+#define NSS_NUM_8723D 1 -+#define BAND_CAP_8723D (BAND_CAP_2G) -+#define BW_CAP_8723D (BW_CAP_20M | BW_CAP_40M) -+#define PROTO_CAP_8723D (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) -+ -+#endif /* __RTL8723D_SPEC_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_sreset.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_sreset.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8723D_SRESET_H_ -+#define _RTL8723D_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ extern void rtl8723d_sreset_xmit_status_check(_adapter *padapter); -+ extern void rtl8723d_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_xmit.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8723d_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8723d_xmit.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,522 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8723D_XMIT_H__ -+#define __RTL8723D_XMIT_H__ -+ -+ -+#define MAX_TID (15) -+ -+ -+#ifndef __INC_HAL8723DDESC_H -+#define __INC_HAL8723DDESC_H -+ -+#define RX_STATUS_DESC_SIZE_8723D 24 -+#define RX_DRV_INFO_SIZE_UNIT_8723D 8 -+ -+ -+/* DWORD 0 */ -+#define SET_RX_STATUS_DESC_PKT_LEN_8723D(__pRxStatusDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8723D(__pRxStatusDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8723D(__pRxStatusDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_EOR_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+ -+/* DWORD 1 */ -+#define GET_RX_STATUS_DESC_MACID_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_AMSDU_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_CHKERR_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_IPVER_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_IS_TCPUDP__8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_CHK_VLD_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) -+ -+/* DWORD 2 */ -+#define GET_RX_STATUS_DESC_SEQ_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_RPT_SEL_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) -+#define GET_RX_STATUS_DESC_FCS_OK_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 31, 1) -+ -+/* DWORD 3 */ -+#define GET_RX_STATUS_DESC_RX_RATE_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) -+#ifdef CONFIG_USB_RX_AGGREGATION -+#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) -+#endif -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_MATCH_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_MATCH_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) -+ -+/* DWORD 6 */ -+#define GET_RX_STATUS_DESC_MATCH_ID_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 7) -+ -+/* DWORD 5 */ -+#define GET_RX_STATUS_DESC_TSFL_8723D(__pRxStatusDesc) \ -+ LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_8723D(__pRxDesc) \ -+ LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+#define SET_RX_STATUS_DESC_BUFF_ADDR_8723D(__pRxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) -+ -+ -+/* Dword 0, rsvd: bit26, bit28 */ -+#define GET_TX_DESC_OWN_8723D(__pTxDesc)\ -+ LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+#define SET_TX_DESC_PKT_SIZE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_AMSDU_PAD_EN_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+ -+/* Dword 1 */ -+#define SET_TX_DESC_MACID_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+#define SET_TX_DESC_MORE_DATA_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 29, 1, __Value) -+ -+/* Dword 2 remove P_AID, G_ID field*/ -+#define SET_TX_DESC_CCA_RTS_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_NULL0_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 14, 1, __Value) -+#define SET_TX_DESC_NULL1_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 15, 1, __Value) -+#define SET_TX_DESC_BK_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_CCX_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_INT_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_FTM_EN_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 30, 1, __Value) -+ -+/* Dword 3 */ -+#define SET_TX_DESC_NAV_USE_HDR_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HWSEQ_SEL_8723D(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_PORT_ID_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 2, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+/* Dword 4 */ -+#define SET_TX_DESC_TX_RATE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_TX_TRY_RATE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 7, 1, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+#define SET_TX_DESC_PCTS_EN_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 29, 1, __Value) -+#define SET_TX_DESC_PCTS_MASK_IDX_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 30, 2, __Value) -+ -+/* Dword 5 */ -+#define SET_TX_DESC_DATA_SC_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_STBC_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_RTS_STBC_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+#define SET_TX_DESC_PATH_A_EN_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 1, __Value) -+#define SET_TX_DESC_TXPWR_OF_SET_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 28, 3, __Value) -+ -+/* Dword 6 */ -+#define SET_TX_DESC_SW_DEFINE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_MBSSID_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+#define SET_TX_DESC_RF_SEL_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+ -+/* Dword 7 */ -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+#define SET_TX_DESC_TX_BUFFER_SIZE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#elif(DEV_BUS_TYPE == RT_USB_INTERFACE) -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#else -+#define SET_TX_DESC_TX_TIMESTAMP_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 6, 18, __Value) -+#endif -+ -+#define SET_TX_DESC_USB_TXAGG_NUM_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+ -+/* Dword 8 */ -+#define SET_TX_DESC_RTS_RC_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 6, __Value) -+#define SET_TX_DESC_BAR_RC_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 6, 2, __Value) -+#define SET_TX_DESC_DATA_RC_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) -+#define SET_TX_DESC_HWSEQ_EN_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+#define SET_TX_DESC_NEXTHEADPAGE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) -+#define SET_TX_DESC_TAILPAGE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) -+ -+/* Dword 9 */ -+#define SET_TX_DESC_PADDING_LEN_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 11, __Value) -+#define SET_TX_DESC_SEQ_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+#define SET_TX_DESC_FINAL_DATA_RATE_8723D(__pTxDesc, __Value) \ -+ SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 24, 8, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_8723D(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8723D(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8723D(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8723D(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8723D(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8723D(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+ -+/*-----------------------------------------------------------------*/ -+/* RTL8723D TX BUFFER DESC */ -+/*-----------------------------------------------------------------*/ -+#ifdef CONFIG_64BIT_DMA -+ #define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 0, 16, __Valeu) -+ #define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 31, 1, __Valeu) -+ #define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+4, 0, 32, __Valeu) -+ #define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+8, 0, 32, __Valeu) -+#else -+ #define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 0, 16, __Valeu) -+ #define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 31, 1, __Valeu) -+ #define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8)+4, 0, 32, __Valeu) -+ #define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) /* 64 BIT mode only */ -+#endif -+/* ********************************************************* */ -+ -+/* 64 bits -- 32 bits */ -+/* ======= ======= */ -+/* Dword 0 0 */ -+#define SET_TX_BUFF_DESC_LEN_0_8723D(__pTxDesc, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 14, __Valeu) -+#define SET_TX_BUFF_DESC_PSB_8723D(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 15, __Value) -+#define SET_TX_BUFF_DESC_OWN_8723D(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+/* Dword 1 1 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_0_8723D(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 32, __Value) -+#define GET_TX_BUFF_DESC_ADDR_LOW_0_8723D(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+4, 0, 32) -+/* Dword 2 NA */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 0, __Value) -+#ifdef CONFIG_64BIT_DMA -+ #define GET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 0, 32) -+#else -+ #define GET_TX_BUFF_DESC_ADDR_HIGH_0_8723D(__pTxDesc) 0 -+#endif -+/* Dword 3 NA */ -+/* RESERVED 0 */ -+/* Dword 4 2 */ -+#define SET_TX_BUFF_DESC_LEN_1_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 1, __Value) -+#define SET_TX_BUFF_DESC_AMSDU_1_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 1, __Value) -+/* Dword 5 3 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_1_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 1, __Value) -+/* Dword 6 NA */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_1_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 1, __Value) -+/* Dword 7 NA */ -+/*RESERVED 0 */ -+/* Dword 8 4 */ -+#define SET_TX_BUFF_DESC_LEN_2_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 2, __Value) -+#define SET_TX_BUFF_DESC_AMSDU_2_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 2, __Value) -+/* Dword 9 5 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_2_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 2, __Value) -+/* Dword 10 NA */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_2_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 2, __Value) -+/* Dword 11 NA */ -+/*RESERVED 0 */ -+/* Dword 12 6 */ -+#define SET_TX_BUFF_DESC_LEN_3_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 3, __Value) -+#define SET_TX_BUFF_DESC_AMSDU_3_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 3, __Value) -+/* Dword 13 7 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_3_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 3, __Value) -+/* Dword 14 NA */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_3_8723D(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 3, __Value) -+/* Dword 15 NA */ -+/*RESERVED 0 */ -+ -+ -+#endif -+/* ----------------------------------------------------------- -+ * -+ * Rate -+ * -+ * ----------------------------------------------------------- -+ * CCK Rates, TxHT = 0 */ -+#define DESC8723D_RATE1M 0x00 -+#define DESC8723D_RATE2M 0x01 -+#define DESC8723D_RATE5_5M 0x02 -+#define DESC8723D_RATE11M 0x03 -+ -+/* OFDM Rates, TxHT = 0 */ -+#define DESC8723D_RATE6M 0x04 -+#define DESC8723D_RATE9M 0x05 -+#define DESC8723D_RATE12M 0x06 -+#define DESC8723D_RATE18M 0x07 -+#define DESC8723D_RATE24M 0x08 -+#define DESC8723D_RATE36M 0x09 -+#define DESC8723D_RATE48M 0x0a -+#define DESC8723D_RATE54M 0x0b -+ -+/* MCS Rates, TxHT = 1 */ -+#define DESC8723D_RATEMCS0 0x0c -+#define DESC8723D_RATEMCS1 0x0d -+#define DESC8723D_RATEMCS2 0x0e -+#define DESC8723D_RATEMCS3 0x0f -+#define DESC8723D_RATEMCS4 0x10 -+#define DESC8723D_RATEMCS5 0x11 -+#define DESC8723D_RATEMCS6 0x12 -+#define DESC8723D_RATEMCS7 0x13 -+#define DESC8723D_RATEMCS8 0x14 -+#define DESC8723D_RATEMCS9 0x15 -+#define DESC8723D_RATEMCS10 0x16 -+#define DESC8723D_RATEMCS11 0x17 -+#define DESC8723D_RATEMCS12 0x18 -+#define DESC8723D_RATEMCS13 0x19 -+#define DESC8723D_RATEMCS14 0x1a -+#define DESC8723D_RATEMCS15 0x1b -+#define DESC8723D_RATEVHTSS1MCS0 0x2c -+#define DESC8723D_RATEVHTSS1MCS1 0x2d -+#define DESC8723D_RATEVHTSS1MCS2 0x2e -+#define DESC8723D_RATEVHTSS1MCS3 0x2f -+#define DESC8723D_RATEVHTSS1MCS4 0x30 -+#define DESC8723D_RATEVHTSS1MCS5 0x31 -+#define DESC8723D_RATEVHTSS1MCS6 0x32 -+#define DESC8723D_RATEVHTSS1MCS7 0x33 -+#define DESC8723D_RATEVHTSS1MCS8 0x34 -+#define DESC8723D_RATEVHTSS1MCS9 0x35 -+#define DESC8723D_RATEVHTSS2MCS0 0x36 -+#define DESC8723D_RATEVHTSS2MCS1 0x37 -+#define DESC8723D_RATEVHTSS2MCS2 0x38 -+#define DESC8723D_RATEVHTSS2MCS3 0x39 -+#define DESC8723D_RATEVHTSS2MCS4 0x3a -+#define DESC8723D_RATEVHTSS2MCS5 0x3b -+#define DESC8723D_RATEVHTSS2MCS6 0x3c -+#define DESC8723D_RATEVHTSS2MCS7 0x3d -+#define DESC8723D_RATEVHTSS2MCS8 0x3e -+#define DESC8723D_RATEVHTSS2MCS9 0x3f -+ -+ -+#define RX_HAL_IS_CCK_RATE_8723D(pDesc)\ -+ (GET_RX_STATUS_DESC_RX_RATE_8723D(pDesc) == DESC8723D_RATE1M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8723D(pDesc) == DESC8723D_RATE2M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8723D(pDesc) == DESC8723D_RATE5_5M || \ -+ GET_RX_STATUS_DESC_RX_RATE_8723D(pDesc) == DESC8723D_RATE11M) -+ -+#ifdef CONFIG_TRX_BD_ARCH -+ struct tx_desc; -+#endif -+ -+void rtl8723d_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+void rtl8723d_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); -+void rtl8723d_fill_txdesc_sectype(struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); -+void rtl8723d_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); -+void rtl8723d_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); -+void rtl8723d_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ s32 rtl8723ds_init_xmit_priv(PADAPTER padapter); -+ void rtl8723ds_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8723ds_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8723ds_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8723ds_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8723ds_xmit_buf_handler(PADAPTER padapter); -+ thread_return rtl8723ds_xmit_thread(thread_context context); -+ #define hal_xmit_handler rtl8723ds_xmit_buf_handler -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ s32 rtl8723du_xmit_buf_handler(PADAPTER padapter); -+ #define hal_xmit_handler rtl8723du_xmit_buf_handler -+ s32 rtl8723du_init_xmit_priv(PADAPTER padapter); -+ void rtl8723du_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8723du_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8723du_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8723du_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ void rtl8723du_xmit_tasklet(void *priv); -+ s32 rtl8723du_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+ void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, struct tx_desc *ptxdesc); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8723de_init_xmit_priv(PADAPTER padapter); -+ void rtl8723de_free_xmit_priv(PADAPTER padapter); -+ struct xmit_buf *rtl8723de_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+ void rtl8723de_xmitframe_resume(_adapter *padapter); -+ s32 rtl8723de_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8723de_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8723de_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ void rtl8723de_xmit_tasklet(void *priv); -+#endif -+ -+u8 BWMapping_8723D(PADAPTER Adapter, struct pkt_attrib *pattrib); -+u8 SCMapping_8723D(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_cmd.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_cmd.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,172 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_CMD_H__ -+#define __RTL8812A_CMD_H__ -+ -+typedef enum _RTL8812_H2C_CMD { -+ H2C_8812_RSVDPAGE = 0, -+ H2C_8812_MSRRPT = 1, -+ H2C_8812_SCAN = 2, -+ H2C_8812_KEEP_ALIVE_CTRL = 3, -+ H2C_8812_DISCONNECT_DECISION = 4, -+ -+ H2C_8812_INIT_OFFLOAD = 6, -+ H2C_8812_AP_OFFLOAD = 8, -+ H2C_8812_BCN_RSVDPAGE = 9, -+ H2C_8812_PROBERSP_RSVDPAGE = 10, -+ -+ H2C_8812_SETPWRMODE = 0x20, -+ H2C_8812_PS_TUNING_PARA = 0x21, -+ H2C_8812_PS_TUNING_PARA2 = 0x22, -+ H2C_8812_PS_LPS_PARA = 0x23, -+ H2C_8812_P2P_PS_OFFLOAD = 0x24, -+ H2C_8812_INACTIVE_PS = 0x27, -+ H2C_8812_RA_MASK = 0x40, -+ H2C_8812_TxBF = 0x41, -+ H2C_8812_RSSI_REPORT = 0x42, -+ H2C_8812_IQ_CALIBRATION = 0x45, -+ H2C_8812_RA_PARA_ADJUST = 0x46, -+ -+ H2C_8812_BT_FW_PATCH = 0x6a, -+ -+ H2C_8812_WO_WLAN = 0x80, -+ H2C_8812_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8812_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8812_AOAC_RSVDPAGE = 0x83, -+ H2C_8812_FW_SWCHANNL = 0x87, -+ -+ H2C_8812_TSF_RESET = 0xC0, -+ -+ MAX_8812_H2CCMD -+} RTL8812_H2C_CMD; -+ -+struct cmd_msg_parm { -+ u8 eid; /* element id */ -+ u8 sz; /* sz */ -+ u8 buf[6]; -+}; -+ -+enum { -+ PWRS -+}; -+ -+struct H2C_SS_RFOFF_PARAM { -+ u8 ROFOn; /* 1: on, 0:off */ -+ u16 gpio_period; /* unit: 1024 us */ -+} __attribute__((packed)); -+ -+ -+ -+/* _RSVDPAGE_LOC_CMD0 */ -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+/* _SETPWRMODE_PARM */ -+#define SET_8812_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+#define GET_8812_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+/* _P2P_PS_OFFLOAD */ -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -+ -+ -+void Set_RA_LDPC_8812(struct sta_info *psta, BOOLEAN bLDPC); -+ -+/* host message to firmware cmd */ -+s32 FillH2CCmd_8812(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+void rtl8812_set_FwPwrMode_cmd(PADAPTER padapter, u8 PSMode); -+void rtl8812_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); -+u8 rtl8812_set_rssi_cmd(PADAPTER padapter, u8 *param); -+void rtl8812_set_raid_cmd(PADAPTER padapter, u32 bitmap, u8 *arg, u8 bw); -+void rtl8812_set_wowlan_cmd(_adapter *padapter, u8 enable); -+s32 FillH2CCmd_8812(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+u8 GetTxBufferRsvdPageNum8812(_adapter *padapter, bool wowlan); -+ -+#ifdef CONFIG_BT_COEXIST -+void rtl8812a_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); -+#endif /* CONFIG_BT_COEXIST */ -+#ifdef CONFIG_P2P_PS -+void rtl8812_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_FWLPS_IN_IPS -+void rtl8812_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -+#endif -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+void rtl8812_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); -+#endif -+#endif -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+int reset_tsf(PADAPTER Adapter, u8 reset_port); -+#endif /* CONFIG_TSF_RESET_OFFLOAD */ -+ -+/* ------------------------------------ -+ * C2H format -+ * ------------------------------------ */ -+ -+/* TX Beamforming */ -+#define GET_8812_C2H_TXBF_ORIGINATE(_Header) LE_BITS_TO_1BYTE(_Header, 0, 8) -+#define GET_8812_C2H_TXBF_MACID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) -+ -+ -+ -+/* / TX Feedback Content */ -+#define USEC_UNIT_FOR_8812_C2H_TX_RPT_QUEUE_TIME 256 -+ -+#define GET_8812_C2H_TX_RPT_QUEUE_SELECT(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 5) -+#define GET_8812_C2H_TX_RPT_PKT_BROCAST(_Header) LE_BITS_TO_1BYTE((_Header + 0), 5, 1) -+#define GET_8812_C2H_TX_RPT_LIFE_TIME_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 6, 1) -+#define GET_8812_C2H_TX_RPT_RETRY_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 7, 1) -+#define GET_8812_C2H_TX_RPT_MAC_ID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) -+#define GET_8812_C2H_TX_RPT_DATA_RETRY_CNT(_Header) LE_BITS_TO_1BYTE((_Header + 2), 0, 6) -+#define GET_8812_C2H_TX_RPT_QUEUE_TIME(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) /* In unit of 256 microseconds. */ -+#define GET_8812_C2H_TX_RPT_FINAL_DATA_RATE(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) -+ -+/* BT_FW_PATCH */ -+#define SET_8812_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) -+#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+5, 0, 8, __Value) -+ -+s32 c2h_handler_8812a(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); -+ -+#endif/* __RTL8812A_CMD_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_dm.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_dm.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,32 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_DM_H__ -+#define __RTL8812A_DM_H__ -+ -+void rtl8812_init_dm_priv(IN PADAPTER Adapter); -+void rtl8812_deinit_dm_priv(IN PADAPTER Adapter); -+void rtl8812_InitHalDm(IN PADAPTER Adapter); -+void rtl8812_HalDmWatchDog(IN PADAPTER Adapter); -+ -+/* VOID rtl8192c_dm_CheckTXPowerTracking(IN PADAPTER Adapter); */ -+ -+/* void rtl8192c_dm_RF_Saving(IN PADAPTER pAdapter, IN u8 bForceInNormal); */ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_hal.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,348 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_HAL_H__ -+#define __RTL8812A_HAL_H__ -+ -+/* #include "hal_com.h" */ -+#include "hal_data.h" -+ -+/* include HAL Related header after HAL Related compiling flags */ -+#include "rtl8812a_spec.h" -+#include "rtl8812a_rf.h" -+#include "rtl8812a_dm.h" -+#include "rtl8812a_recv.h" -+#include "rtl8812a_xmit.h" -+#include "rtl8812a_cmd.h" -+#include "rtl8812a_led.h" -+#include "Hal8812PwrSeq.h" -+#include "Hal8821APwrSeq.h" /* for 8821A/8811A */ -+#include "Hal8812PhyReg.h" -+#include "Hal8812PhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+#include "rtl8812a_sreset.h" -+#endif -+ -+/* --------------------------------------------------------------------- -+ * RTL8812 Power Configuration CMDs for PCIe interface -+ * --------------------------------------------------------------------- */ -+#define Rtl8812_NIC_PWR_ON_FLOW rtl8812_power_on_flow -+#define Rtl8812_NIC_RF_OFF_FLOW rtl8812_radio_off_flow -+#define Rtl8812_NIC_DISABLE_FLOW rtl8812_card_disable_flow -+#define Rtl8812_NIC_ENABLE_FLOW rtl8812_card_enable_flow -+#define Rtl8812_NIC_SUSPEND_FLOW rtl8812_suspend_flow -+#define Rtl8812_NIC_RESUME_FLOW rtl8812_resume_flow -+#define Rtl8812_NIC_PDN_FLOW rtl8812_hwpdn_flow -+#define Rtl8812_NIC_LPS_ENTER_FLOW rtl8812_enter_lps_flow -+#define Rtl8812_NIC_LPS_LEAVE_FLOW rtl8812_leave_lps_flow -+ -+/* --------------------------------------------------------------------- -+ * RTL8821 Power Configuration CMDs for PCIe interface -+ * --------------------------------------------------------------------- */ -+#define Rtl8821A_NIC_PWR_ON_FLOW rtl8821A_power_on_flow -+#define Rtl8821A_NIC_RF_OFF_FLOW rtl8821A_radio_off_flow -+#define Rtl8821A_NIC_DISABLE_FLOW rtl8821A_card_disable_flow -+#define Rtl8821A_NIC_ENABLE_FLOW rtl8821A_card_enable_flow -+#define Rtl8821A_NIC_SUSPEND_FLOW rtl8821A_suspend_flow -+#define Rtl8821A_NIC_RESUME_FLOW rtl8821A_resume_flow -+#define Rtl8821A_NIC_PDN_FLOW rtl8821A_hwpdn_flow -+#define Rtl8821A_NIC_LPS_ENTER_FLOW rtl8821A_enter_lps_flow -+#define Rtl8821A_NIC_LPS_LEAVE_FLOW rtl8821A_leave_lps_flow -+ -+ -+#if 1 /* download firmware related data structure */ -+#define FW_SIZE_8812 0x8000 /* Compatible with RTL8723 Maximal RAM code size 24K. modified to 32k, TO compatible with 92d maximal fw size 32k */ -+#define FW_START_ADDRESS 0x1000 -+#define FW_END_ADDRESS 0x5FFF -+ -+ -+ -+typedef struct _RT_FIRMWARE_8812 { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8 *szFwBuffer; -+#else -+ u8 szFwBuffer[FW_SIZE_8812]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8812, *PRT_FIRMWARE_8812; -+ -+/* -+ * This structure must be cared byte-ordering -+ * -+ * Added by tynli. 2009.12.04. */ -+#define IS_FW_HEADER_EXIST_8812(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8812(_pFwHdr) & 0xFFF0) == 0x9500) -+ -+#define IS_FW_HEADER_EXIST_8821(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8812(_pFwHdr) & 0xFFF0) == 0x2100) -+/* ***************************************************** -+ * Firmware Header(8-byte alinment required) -+ * ***************************************************** -+ * --- LONG WORD 0 ---- */ -+#define GET_FIRMWARE_HDR_SIGNATURE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 0, 16) /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ -+#define GET_FIRMWARE_HDR_CATEGORY_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 16, 8) /* AP/NIC and USB/PCI */ -+#define GET_FIRMWARE_HDR_FUNCTION_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 24, 8) /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ -+#define GET_FIRMWARE_HDR_VERSION_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 0, 16)/* FW Version */ -+#define GET_FIRMWARE_HDR_SUB_VER_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 16, 8) /* FW Subversion, default 0x00 */ -+#define GET_FIRMWARE_HDR_RSVD1_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 24, 8) -+ -+/* --- LONG WORD 1 ---- */ -+#define GET_FIRMWARE_HDR_MONTH_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 0, 8) /* Release time Month field */ -+#define GET_FIRMWARE_HDR_DATE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 8, 8) /* Release time Date field */ -+#define GET_FIRMWARE_HDR_HOUR_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 16, 8)/* Release time Hour field */ -+#define GET_FIRMWARE_HDR_MINUTE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 24, 8)/* Release time Minute field */ -+#define GET_FIRMWARE_HDR_ROMCODE_SIZE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 0, 16)/* The size of RAM code */ -+#define GET_FIRMWARE_HDR_RSVD2_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 16, 16) -+ -+/* --- LONG WORD 2 ---- */ -+#define GET_FIRMWARE_HDR_SVN_IDX_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 0, 32)/* The SVN entry index */ -+#define GET_FIRMWARE_HDR_RSVD3_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 0, 32) -+ -+/* --- LONG WORD 3 ---- */ -+#define GET_FIRMWARE_HDR_RSVD4_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 0, 32) -+#define GET_FIRMWARE_HDR_RSVD5_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+28, 0, 32) -+ -+#endif /* download firmware related data structure */ -+ -+ -+#define DRIVER_EARLY_INT_TIME_8812 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8812 0x02 -+ -+/* for 8812 -+ * TX 128K, RX 16K, Page size 512B for TX, 128B for RX */ -+#define MAX_RX_DMA_BUFFER_SIZE_8812 0x3E80 /* RX 16K */ -+ -+#ifdef CONFIG_WOWLAN -+ #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ -+#else -+ #define RESV_FMWF 0 -+#endif -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+ #define RX_DMA_RESERVED_SIZE_8812 0x100 /* 256B, reserved for c2h debug message */ -+#else -+ #define RX_DMA_RESERVED_SIZE_8812 0x0 /* 0B */ -+#endif -+#define RX_DMA_BOUNDARY_8812 (MAX_RX_DMA_BUFFER_SIZE_8812 - RX_DMA_RESERVED_SIZE_8812 - 1) -+ -+#define BCNQ_PAGE_NUM_8812 0x07 -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:1,GTK EXT MEM:1, PNO: 6 */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8812 0x05 -+#else -+ #define WOWLAN_PAGE_NUM_8812 0x00 -+#endif -+ -+ -+#ifdef CONFIG_BEAMFORMER_FW_NDPA -+ #define FW_NDPA_PAGE_NUM 0x02 -+#else -+ #define FW_NDPA_PAGE_NUM 0x00 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8812 (0xFF - BCNQ_PAGE_NUM_8812 - WOWLAN_PAGE_NUM_8812-FW_NDPA_PAGE_NUM) -+#define TX_PAGE_BOUNDARY_8812 (TX_TOTAL_PAGE_NUMBER_8812 + 1) -+ -+#define TX_PAGE_BOUNDARY_WOWLAN_8812 (0xFF - BCNQ_PAGE_NUM_8812 - WOWLAN_PAGE_NUM_8812 + 1) -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8812 TX_TOTAL_PAGE_NUMBER_8812 -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8812 (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8812 + 1) -+ -+/* For Normal Chip Setting -+ * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8812 */ -+#define NORMAL_PAGE_NUM_LPQ_8812 0x10 -+#define NORMAL_PAGE_NUM_HPQ_8812 0x10 -+#define NORMAL_PAGE_NUM_NPQ_8812 0x00 -+ -+#define WMM_NORMAL_PAGE_NUM_HPQ_8812 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8812 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8812 0x20 -+ -+ -+/* for 8821A -+ * TX 64K, RX 16K, Page size 256B for TX, 128B for RX */ -+#define PAGE_SIZE_TX_8821A 256 -+#define PAGE_SIZE_RX_8821A 128 -+ -+#define MAX_RX_DMA_BUFFER_SIZE_8821 0x3E80 /* RX 16K */ -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+ #define RX_DMA_RESERVED_SIZE_8821 0x100 /* 256B, reserved for c2h debug message */ -+#else -+ #define RX_DMA_RESERVED_SIZE_8821 0x0 /* 0B */ -+#endif -+#define RX_DMA_BOUNDARY_8821 (MAX_RX_DMA_BUFFER_SIZE_8821 - RX_DMA_RESERVED_SIZE_8821 - 1) -+ -+#define BCNQ_PAGE_NUM_8821 0x08 -+#ifdef CONFIG_CONCURRENT_MODE -+ #define BCNQ1_PAGE_NUM_8821 0x04 -+#else -+ #define BCNQ1_PAGE_NUM_8821 0x00 -+#endif -+ -+/* For WoWLan , more reserved page -+ * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:1,GTK EXT MEM:1, PNO: 6 */ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8821 0x06 -+#else -+ #define WOWLAN_PAGE_NUM_8821 0x00 -+#endif -+ -+#define TX_TOTAL_PAGE_NUMBER_8821 (0xFF - BCNQ_PAGE_NUM_8821 - BCNQ1_PAGE_NUM_8821 - WOWLAN_PAGE_NUM_8821) -+#define TX_PAGE_BOUNDARY_8821 (TX_TOTAL_PAGE_NUMBER_8821 + 1) -+/* #define TX_PAGE_BOUNDARY_WOWLAN_8821 0xE0 */ -+ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8821 TX_TOTAL_PAGE_NUMBER_8821 -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8821 (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8821 + 1) -+ -+ -+/* (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER */ -+#define NORMAL_PAGE_NUM_LPQ_8821 0x08/* 0x10 */ -+#define NORMAL_PAGE_NUM_HPQ_8821 0x08/* 0x10 */ -+#define NORMAL_PAGE_NUM_NPQ_8821 0x00 -+ -+#define WMM_NORMAL_PAGE_NUM_HPQ_8821 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8821 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8821 0x20 -+ -+#define MCC_NORMAL_PAGE_NUM_HPQ_8821 0x10 -+#define MCC_NORMAL_PAGE_NUM_LPQ_8821 0x10 -+#define MCC_NORMAL_PAGE_NUM_NPQ_8821 0x10 -+ -+#define EFUSE_HIDDEN_812AU 0 -+#define EFUSE_HIDDEN_812AU_VS 1 -+#define EFUSE_HIDDEN_812AU_VL 2 -+#define EFUSE_HIDDEN_812AU_VN 3 -+ -+#if 0 -+#define EFUSE_REAL_CONTENT_LEN_JAGUAR 1024 -+#define HWSET_MAX_SIZE_JAGUAR 1024 -+#else -+#define EFUSE_REAL_CONTENT_LEN_JAGUAR 512 -+#define HWSET_MAX_SIZE_JAGUAR 512 -+#endif -+ -+#define EFUSE_MAX_BANK_8812A 2 -+#define EFUSE_MAP_LEN_JAGUAR 512 -+#define EFUSE_MAX_SECTION_JAGUAR 64 -+#define EFUSE_MAX_WORD_UNIT_JAGUAR 4 -+#define EFUSE_IC_ID_OFFSET_JAGUAR 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ -+#define AVAILABLE_EFUSE_ADDR_8812(addr) (addr < EFUSE_REAL_CONTENT_LEN_JAGUAR) -+/* To prevent out of boundary programming case, leave 1byte and program full section -+ * 9bytes + 1byt + 5bytes and pre 1byte. -+ * For worst case: -+ * | 2byte|----8bytes----|1byte|--7bytes--| */ /* 92D */ -+#define EFUSE_OOB_PROTECT_BYTES_JAGUAR 18 /* PG data exclude header, dummy 7 bytes frome CP test and reserved 1byte. */ -+#define EFUSE_PROTECT_BYTES_BANK_JAGUAR 16 -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+/* #define IS_MULTI_FUNC_CHIP(_Adapter) (((((PHAL_DATA_TYPE)(_Adapter->HalData))->MultiFunc) & (RT_MULTI_FUNC_BT|RT_MULTI_FUNC_GPS)) ? _TRUE : _FALSE) */ -+ -+/* #define RT_IS_FUNC_DISABLED(__pAdapter, __FuncBits) ( (__pAdapter)->DisabledFunctions & (__FuncBits) ) */ -+ -+ -+#ifdef CONFIG_FILE_FWIMG -+extern char *rtw_fw_file_path; -+#ifdef CONFIG_WOWLAN -+extern char *rtw_fw_wow_file_path; -+#endif -+#ifdef CONFIG_MP_INCLUDED -+extern char *rtw_fw_mp_bt_file_path; -+#endif -+#endif -+ -+ -+/* rtl8812_hal_init.c */ -+void _8051Reset8812(PADAPTER padapter); -+s32 FirmwareDownload8812(PADAPTER Adapter, BOOLEAN bUsedWoWLANFw); -+void InitializeFirmwareVars8812(PADAPTER padapter); -+ -+s32 _LLTWrite_8812A(PADAPTER Adapter, u32 address, u32 data); -+s32 InitLLTTable8812A(PADAPTER padapter, u8 txpktbuf_bndy); -+void InitRDGSetting8812A(PADAPTER padapter); -+ -+void CheckAutoloadState8812A(PADAPTER padapter); -+ -+/* EFuse */ -+u8 GetEEPROMSize8812A(PADAPTER padapter); -+void InitPGData8812A(PADAPTER padapter); -+void Hal_EfuseParseIDCode8812A(PADAPTER padapter, u8 *hwinfo); -+void Hal_ReadPROMVersion8812A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadTxPowerInfo8812A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadBoardType8812A(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadThermalMeter_8812A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_ReadChannelPlan8812A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_EfuseParseXtal_8812A(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void Hal_ReadAntennaDiversity8812A(PADAPTER pAdapter, u8 *PROMContent, BOOLEAN AutoLoadFail); -+void Hal_ReadAmplifierType_8812A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_ReadPAType_8821A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_ReadRFEType_8812A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void Hal_EfuseParseBTCoexistInfo8812A(PADAPTER Adapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void hal_ReadUsbType_8812AU(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+#ifdef CONFIG_MP_INCLUDED -+int FirmwareDownloadBT(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); -+#endif -+void Hal_ReadRemoteWakeup_8812A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+ -+BOOLEAN HalDetectPwrDownMode8812(PADAPTER Adapter); -+void Hal_EfuseParseKFreeData_8821A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+ -+#ifdef CONFIG_WOWLAN -+void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif /* CONFIG_WOWLAN */ -+ -+void _InitBeaconParameters_8812A(PADAPTER padapter); -+void SetBeaconRelatedRegisters8812A(PADAPTER padapter); -+ -+void ReadRFType8812A(PADAPTER padapter); -+void InitDefaultValue8821A(PADAPTER padapter); -+ -+void SetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); -+void GetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); -+u8 SetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+void rtl8812_set_hal_ops(struct hal_ops *pHalFunc); -+void init_hal_spec_8812a(_adapter *adapter); -+void init_hal_spec_8821a(_adapter *adapter); -+ -+/* register */ -+void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); -+ -+void rtl8812_start_thread(PADAPTER padapter); -+void rtl8812_stop_thread(PADAPTER padapter); -+ -+#ifdef CONFIG_PCI_HCI -+BOOLEAN InterruptRecognized8812AE(PADAPTER Adapter); -+VOID UpdateInterruptMask8812AE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+void rtl8812a_combo_card_WifiOnlyHwInit(PADAPTER Adapter); -+#endif -+ -+VOID -+Hal_PatchwithJaguar_8812( -+ IN PADAPTER Adapter, -+ IN RT_MEDIA_STATUS MediaStatus -+); -+ -+#endif /* __RTL8188E_HAL_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_led.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_led.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_LED_H__ -+#define __RTL8812A_LED_H__ -+ -+ -+/* ******************************************************************************** -+ * Interface to manipulate LED objects. -+ * ******************************************************************************** */ -+#ifdef CONFIG_USB_HCI -+void rtl8812au_InitSwLeds(PADAPTER padapter); -+void rtl8812au_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_PCI_HCI -+void rtl8812ae_InitSwLeds(PADAPTER padapter); -+void rtl8812ae_DeInitSwLeds(PADAPTER padapter); -+#endif -+#ifdef CONFIG_SDIO_HCI -+void rtl8821as_hw_led_config(PADAPTER adapter); -+void rtl8821as_InitSwLeds(PADAPTER padapter); -+void rtl8821as_DeInitSwLeds(PADAPTER padapter); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_recv.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_recv.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,158 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_RECV_H__ -+#define __RTL8812A_RECV_H__ -+ -+#if defined(CONFIG_USB_HCI) -+ -+ #ifndef MAX_RECVBUF_SZ -+ #ifdef PLATFORM_OS_CE -+ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ -+ #else -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ #define MAX_RECVBUF_SZ (rtw_rtkm_get_buff_size()) /*depend rtkm*/ -+ #else -+ #define MAX_RECVBUF_SZ (32768) /*32k*/ -+ #endif -+ /* #define MAX_RECVBUF_SZ (24576) */ /* 24k */ -+ /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ -+ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ -+ /* #define MAX_RECVBUF_SZ (15360) */ /* 15k < 16k */ -+ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ -+ #ifdef CONFIG_PLATFORM_NOVATEK_NT72668 -+ #undef MAX_RECVBUF_SZ -+ #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ -+ #endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ -+ #else -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+ #endif -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+ -+#elif defined(CONFIG_PCI_HCI) -+ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ -+ /* #define MAX_RECVBUF_SZ (9100) */ -+ /* #else */ -+ #define MAX_RECVBUF_SZ (4000) /* about 4K -+ * #endif */ -+ -+ -+#elif defined(CONFIG_SDIO_HCI) -+ -+ #define MAX_RECVBUF_SZ (RX_DMA_BOUNDARY_8821 + 1) -+ -+#endif -+ -+ -+/* Rx smooth factor */ -+#define Rx_Smooth_Factor (20) -+ -+/* DWORD 0 */ -+#define SET_RX_STATUS_DESC_PKT_LEN_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_LAST_SEG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 28, 1) -+#define GET_RX_STATUS_DESC_FIRST_SEG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 29, 1) -+#define GET_RX_STATUS_DESC_EOR_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+ -+/* DWORD 1 */ -+#define GET_RX_STATUS_DESC_MACID_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_AMSDU_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_CHKERR_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_IPVER_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_IS_TCPUDP__8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_CHK_VLD_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) -+ -+/* DWORD 2 */ -+#define GET_RX_STATUS_DESC_SEQ_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_RPT_SEL_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) -+ -+/* DWORD 3 */ -+#define GET_RX_STATUS_DESC_RX_RATE_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) -+#ifdef CONFIG_USB_RX_AGGREGATION -+#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) -+#endif -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) -+ -+/* DWORD 6 */ -+#define GET_RX_STATUS_DESC_SPLCP_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 1) -+#define GET_RX_STATUS_DESC_LDPC_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 1, 1) -+#define GET_RX_STATUS_DESC_STBC_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 2, 1) -+#define GET_RX_STATUS_DESC_BW_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 4, 2) -+ -+/* DWORD 5 */ -+#define GET_RX_STATUS_DESC_TSFL_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+#define SET_RX_STATUS_DESC_BUFF_ADDR_8812(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) -+ -+ -+#ifdef CONFIG_SDIO_HCI -+s32 InitRecvPriv8821AS(PADAPTER padapter); -+void FreeRecvPriv8821AS(PADAPTER padapter); -+#endif /* CONFIG_SDIO_HCI */ -+ -+#ifdef CONFIG_USB_HCI -+void rtl8812au_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+s32 rtl8812au_init_recv_priv(PADAPTER padapter); -+void rtl8812au_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8812ae_init_recv_priv(PADAPTER padapter); -+void rtl8812ae_free_recv_priv(PADAPTER padapter); -+#endif -+ -+void rtl8812_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8812A_RECV_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_rf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_rf.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,33 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_RF_H__ -+#define __RTL8812A_RF_H__ -+ -+VOID -+PHY_RF6052SetBandwidth8812( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+ -+int -+PHY_RF6052_Config_8812( -+ IN PADAPTER Adapter); -+ -+#endif/* __RTL8188E_RF_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_spec.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_spec.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,276 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8812A_SPEC_H__ -+#define __RTL8812A_SPEC_H__ -+ -+#include -+ -+ -+/* ************************************************************ -+* 8812 Regsiter offset definition -+* ************************************************************ */ -+ -+/* ************************************************************ -+* -+* ************************************************************ */ -+ -+/* ----------------------------------------------------- -+* -+* 0x0000h ~ 0x00FFh System Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_SYS_CLKR_8812A 0x0008 -+#define REG_AFE_PLL_CTRL_8812A 0x0028 -+#define REG_HSIMR_8812 0x0058 -+#define REG_HSISR_8812 0x005c -+#define REG_GPIO_EXT_CTRL 0x0060 -+#define REG_GPIO_STATUS_8812 0x006C -+#define REG_SDIO_CTRL_8812 0x0070 -+#define REG_OPT_CTRL_8812 0x0074 -+#define REG_RF_B_CTRL_8812 0x0076 -+#define REG_FW_DRV_MSG_8812 0x0088 -+#define REG_HMEBOX_E2_E3_8812 0x008C -+#define REG_HIMR0_8812 0x00B0 -+#define REG_HISR0_8812 0x00B4 -+#define REG_HIMR1_8812 0x00B8 -+#define REG_HISR1_8812 0x00BC -+#define REG_EFUSE_BURN_GNT_8812 0x00CF -+#define REG_SYS_CFG1_8812 0x00FC -+ -+/* ----------------------------------------------------- -+* -+* 0x0100h ~ 0x01FFh MACTOP General Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_CR_8812A 0x100 -+#define REG_PKTBUF_DBG_ADDR (REG_PKTBUF_DBG_CTRL) -+#define REG_RXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+2) -+#define REG_TXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+3) -+#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN -+ -+#define REG_RSVD3_8812 0x0168 -+#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 -+#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 -+#define REG_C2HEVT_CMD_LEN_88XX 0x01AE -+ -+#define REG_HMEBOX_EXT0_8812 0x01F0 -+#define REG_HMEBOX_EXT1_8812 0x01F4 -+#define REG_HMEBOX_EXT2_8812 0x01F8 -+#define REG_HMEBOX_EXT3_8812 0x01FC -+ -+/* ----------------------------------------------------- -+* -+* 0x0200h ~ 0x027Fh TXDMA Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_DWBCN0_CTRL_8812 REG_TDECTRL -+#define REG_DWBCN1_CTRL_8812 0x0228 -+ -+/* ----------------------------------------------------- -+* -+* 0x0280h ~ 0x02FFh RXDMA Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_TDECTRL_8812A 0x0208 -+#define REG_RXDMA_CONTROL_8812A 0x0286 /*Control the RX DMA.*/ -+#define REG_RXDMA_PRO_8812 0x0290 -+#define REG_EARLY_MODE_CONTROL_8812 0x02BC -+#define REG_RSVD5_8812 0x02F0 -+#define REG_RSVD6_8812 0x02F4 -+#define REG_RSVD7_8812 0x02F8 -+#define REG_RSVD8_8812 0x02FC -+ -+ -+/* ----------------------------------------------------- -+* -+* 0x0300h ~ 0x03FFh PCIe -+* -+* ----------------------------------------------------- */ -+#define REG_PCIE_CTRL_REG_8812A 0x0300 -+#define REG_DBI_WDATA_8812 0x0348 /* DBI Write Data */ -+#define REG_DBI_RDATA_8812 0x034C /* DBI Read Data */ -+#define REG_DBI_ADDR_8812 0x0350 /* DBI Address */ -+#define REG_DBI_FLAG_8812 0x0352 /* DBI Read/Write Flag */ -+#define REG_MDIO_WDATA_8812 0x0354 /* MDIO for Write PCIE PHY */ -+#define REG_MDIO_RDATA_8812 0x0356 /* MDIO for Reads PCIE PHY */ -+#define REG_MDIO_CTL_8812 0x0358 /* MDIO for Control */ -+#define REG_PCIE_MULTIFET_CTRL_8812 0x036A /* PCIE Multi-Fethc Control */ -+ -+/* ----------------------------------------------------- -+* -+* 0x0400h ~ 0x047Fh Protocol Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_TXPKT_EMPTY_8812A 0x041A -+#define REG_FWHW_TXQ_CTRL_8812A 0x0420 -+#define REG_TXBF_CTRL_8812A 0x042C -+#define REG_ARFR0_8812 0x0444 -+#define REG_ARFR1_8812 0x044C -+#define REG_CCK_CHECK_8812 0x0454 -+#define REG_AMPDU_MAX_TIME_8812 0x0456 -+#define REG_TXPKTBUF_BCNQ_BDNY1_8812 0x0457 -+ -+#define REG_AMPDU_MAX_LENGTH_8812 0x0458 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8812 0x045D -+#define REG_NDPA_OPT_CTRL_8812A 0x045F -+#define REG_DATA_SC_8812 0x0483 -+#ifdef CONFIG_WOWLAN -+#define REG_TXPKTBUF_IV_LOW 0x0484 -+#define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif -+#define REG_ARFR2_8812 0x048C -+#define REG_ARFR3_8812 0x0494 -+#define REG_TXRPT_START_OFFSET 0x04AC -+#define REG_AMPDU_BURST_MODE_8812 0x04BC -+#define REG_HT_SINGLE_AMPDU_8812 0x04C7 -+#define REG_MACID_PKT_DROP0_8812 0x04D0 -+ -+/* ----------------------------------------------------- -+* -+* 0x0500h ~ 0x05FFh EDCA Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_TXPAUSE_8812A 0x0522 -+#define REG_CTWND_8812 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8812 0x0577 -+#define REG_SCH_TXCMD_8812A 0x05F8 -+ -+/* ----------------------------------------------------- -+* -+* 0x0600h ~ 0x07FFh WMAC Configuration -+* -+* ----------------------------------------------------- */ -+#define REG_MAC_CR_8812 0x0600 -+ -+#define REG_MAC_TX_SM_STATE_8812 0x06B4 -+ -+/* Power */ -+#define REG_BFMER0_INFO_8812A 0x06E4 -+#define REG_BFMER1_INFO_8812A 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8812A 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8812A 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8812A 0x06FC -+ -+/* Hardware Port 2 */ -+#define REG_BFMEE_SEL_8812A 0x0714 -+#define REG_SND_PTCL_CTRL_8812A 0x0718 -+ -+ -+/* ----------------------------------------------------- -+* -+* Redifine register definition for compatibility -+* -+* ----------------------------------------------------- */ -+ -+/* TODO: use these definition when using REG_xxx naming rule. -+* NOTE: DO NOT Remove these definition. Use later. */ -+#define ISR_8812 REG_HISR0_8812 -+ -+/* ---------------------------------------------------------------------------- -+* 8195 IMR/ISR bits (offset 0xB0, 8bits) -+* ---------------------------------------------------------------------------- */ -+#define IMR_DISABLED_8812 0 -+/* IMR DW0(0x00B0-00B3) Bit 0-31 */ -+#define IMR_TIMER2_8812 BIT31 /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8812 BIT30 /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8812 BIT29 /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8812 BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8812 BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8812 BIT26 /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8812 BIT25 /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8812 BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8812 BIT20 /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8812 BIT16 /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8812 BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8812 BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8812 BIT12 /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8812 BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_8812 BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_8812 BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_8812 BIT7 /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8812 BIT6 /* Management Queue DMA OK */ -+#define IMR_BKDOK_8812 BIT5 /* AC_BK DMA OK */ -+#define IMR_BEDOK_8812 BIT4 /* AC_BE DMA OK */ -+#define IMR_VIDOK_8812 BIT3 /* AC_VI DMA OK */ -+#define IMR_VODOK_8812 BIT2 /* AC_VO DMA OK */ -+#define IMR_RDU_8812 BIT1 /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8812 BIT0 /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_BCNDMAINT7_8812 BIT27 /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8812 BIT26 /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8812 BIT25 /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8812 BIT24 /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8812 BIT23 /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8812 BIT22 /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8812 BIT21 /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8812 BIT20 /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6_8812 BIT19 /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5_8812 BIT18 /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4_8812 BIT17 /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3_8812 BIT16 /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2_8812 BIT15 /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1_8812 BIT14 /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_ATIMEND_E_8812 BIT13 /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8812 BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_8812 BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_8812 BIT9 /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8812 BIT8 /* Receive FIFO Overflow */ -+ -+ -+#ifdef CONFIG_PCI_HCI -+/* #define IMR_RX_MASK (IMR_ROK_8812|IMR_RDU_8812|IMR_RXFOVW_8812) */ -+#define IMR_TX_MASK (IMR_VODOK_8812 | IMR_VIDOK_8812 | IMR_BEDOK_8812 | IMR_BKDOK_8812 | IMR_MGNTDOK_8812 | IMR_HIGHDOK_8812) -+ -+#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8812 | IMR_TXBCN0OK_8812 | IMR_TXBCN0ERR_8812 | IMR_BCNDERR0_8812) -+ -+#define RT_AC_INT_MASKS (IMR_VIDOK_8812 | IMR_VODOK_8812 | IMR_BEDOK_8812 | IMR_BKDOK_8812) -+#endif -+ -+ -+/* **************************************************************************** -+* Regsiter Bit and Content definition -+* **************************************************************************** */ -+ -+/* 2 ACMHWCTRL 0x05C0 */ -+#define AcmHw_HwEn_8812 BIT(0) -+#define AcmHw_VoqEn_8812 BIT(1) -+#define AcmHw_ViqEn_8812 BIT(2) -+#define AcmHw_BeqEn_8812 BIT(3) -+#define AcmHw_VoqStatus_8812 BIT(5) -+#define AcmHw_ViqStatus_8812 BIT(6) -+#define AcmHw_BeqStatus_8812 BIT(7) -+ -+/* ******************************************************** -+* General definitions -+* ******************************************************** */ -+ -+#define MACID_NUM_8812A 128 -+#define SEC_CAM_ENT_NUM_8812A 64 -+#define HW_PORT_NUM_8812A 2 -+#define NSS_NUM_8812A 2 -+#define BAND_CAP_8812A (BAND_CAP_2G | BAND_CAP_5G) -+#define BW_CAP_8812A (BW_CAP_20M | BW_CAP_40M | BW_CAP_80M) -+#define PROTO_CAP_8812A (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N | PROTO_CAP_11AC) -+ -+#endif /* __RTL8812A_SPEC_H__ */ -+ -+#ifdef CONFIG_RTL8821A -+#include "rtl8821a_spec.h" -+#endif /* CONFIG_RTL8821A */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_sreset.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_sreset.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL88812A_SRESET_H_ -+#define _RTL8812A_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+extern void rtl8812_sreset_xmit_status_check(_adapter *padapter); -+extern void rtl8812_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_xmit.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8812a_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8812a_xmit.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,366 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_XMIT_H__ -+#define __RTL8812A_XMIT_H__ -+ -+ -+/* For 88e early mode */ -+#define SET_EARLYMODE_PKTNUM(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 3, __Value) -+#define SET_EARLYMODE_LEN0(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 12, __Value) -+#define SET_EARLYMODE_LEN1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 16, 12, __Value) -+#define SET_EARLYMODE_LEN2_1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 28, 4, __Value) -+#define SET_EARLYMODE_LEN2_2(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 8, __Value) -+#define SET_EARLYMODE_LEN3(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 8, 12, __Value) -+#define SET_EARLYMODE_LEN4(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 20, 12, __Value) -+ -+/* -+ * defined for TX DESC Operation -+ * */ -+ -+#define MAX_TID (15) -+ -+/* OFFSET 0 */ -+#define OFFSET_SZ 0 -+#define OFFSET_SHT 16 -+#define BMC BIT(24) -+#define LSG BIT(26) -+#define FSG BIT(27) -+#define OWN BIT(31) -+ -+ -+/* OFFSET 4 */ -+#define PKT_OFFSET_SZ 0 -+#define QSEL_SHT 8 -+#define RATE_ID_SHT 16 -+#define NAVUSEHDR BIT(20) -+#define SEC_TYPE_SHT 22 -+#define PKT_OFFSET_SHT 26 -+ -+/* OFFSET 8 */ -+#define AGG_EN BIT(12) -+#define AGG_BK BIT(16) -+#define AMPDU_DENSITY_SHT 20 -+#define ANTSEL_A BIT(24) -+#define ANTSEL_B BIT(25) -+#define TX_ANT_CCK_SHT 26 -+#define TX_ANTL_SHT 28 -+#define TX_ANT_HT_SHT 30 -+ -+/* OFFSET 12 */ -+#define SEQ_SHT 16 -+#define EN_HWSEQ BIT(31) -+ -+/* OFFSET 16 */ -+#define QOS BIT(6) -+#define HW_SSN BIT(7) -+#define USERATE BIT(8) -+#define DISDATAFB BIT(10) -+#define CTS_2_SELF BIT(11) -+#define RTS_EN BIT(12) -+#define HW_RTS_EN BIT(13) -+#define DATA_SHORT BIT(24) -+#define PWR_STATUS_SHT 15 -+#define DATA_SC_SHT 20 -+#define DATA_BW BIT(25) -+ -+/* OFFSET 20 */ -+#define RTY_LMT_EN BIT(17) -+ -+/* OFFSET 20 */ -+#define SGI BIT(6) -+#define USB_TXAGG_NUM_SHT 24 -+ -+typedef struct txdescriptor_8812 { -+ /* Offset 0 */ -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 ls:1; -+ u32 fs:1; -+ u32 linip:1; -+ u32 noacm:1; -+ u32 gf:1; -+ u32 own:1; -+ -+ /* Offset 4 */ -+ u32 macid:6; -+ u32 rsvd0406:2; -+ u32 qsel:5; -+ u32 rd_nav_ext:1; -+ u32 lsig_txop_en:1; -+ u32 pifs:1; -+ u32 rate_id:4; -+ u32 navusehdr:1; -+ u32 en_desc_id:1; -+ u32 sectype:2; -+ u32 rsvd0424:2; -+ u32 pkt_offset:5; /* unit: 8 bytes */ -+ u32 rsvd0431:1; -+ -+ /* Offset 8 */ -+ u32 rts_rc:6; -+ u32 data_rc:6; -+ u32 agg_en:1; -+ u32 rd_en:1; -+ u32 bar_rty_th:2; -+ u32 bk:1; -+ u32 morefrag:1; -+ u32 raw:1; -+ u32 ccx:1; -+ u32 ampdu_density:3; -+ u32 bt_null:1; -+ u32 ant_sel_a:1; -+ u32 ant_sel_b:1; -+ u32 tx_ant_cck:2; -+ u32 tx_antl:2; -+ u32 tx_ant_ht:2; -+ -+ /* Offset 12 */ -+ u32 nextheadpage:8; -+ u32 tailpage:8; -+ u32 seq:12; -+ u32 cpu_handle:1; -+ u32 tag1:1; -+ u32 trigger_int:1; -+ u32 hwseq_en:1; -+ -+ /* Offset 16 */ -+ u32 rtsrate:5; -+ u32 ap_dcfe:1; -+ u32 hwseq_sel:2; -+ u32 userate:1; -+ u32 disrtsfb:1; -+ u32 disdatafb:1; -+ u32 cts2self:1; -+ u32 rtsen:1; -+ u32 hw_rts_en:1; -+ u32 port_id:1; -+ u32 pwr_status:3; -+ u32 wait_dcts:1; -+ u32 cts2ap_en:1; -+ u32 data_sc:2; -+ u32 data_stbc:2; -+ u32 data_short:1; -+ u32 data_bw:1; -+ u32 rts_short:1; -+ u32 rts_bw:1; -+ u32 rts_sc:2; -+ u32 vcs_stbc:2; -+ -+ /* Offset 20 */ -+ u32 datarate:6; -+ u32 sgi:1; -+ u32 try_rate:1; -+ u32 data_ratefb_lmt:5; -+ u32 rts_ratefb_lmt:4; -+ u32 rty_lmt_en:1; -+ u32 data_rt_lmt:6; -+ u32 usb_txagg_num:8; -+ -+ /* Offset 24 */ -+ u32 txagg_a:5; -+ u32 txagg_b:5; -+ u32 use_max_len:1; -+ u32 max_agg_num:5; -+ u32 mcsg1_max_len:4; -+ u32 mcsg2_max_len:4; -+ u32 mcsg3_max_len:4; -+ u32 mcs7_sgi_max_len:4; -+ -+ /* Offset 28 */ -+ u32 checksum:16; /* TxBuffSize(PCIe)/CheckSum(USB) */ -+ u32 mcsg4_max_len:4; -+ u32 mcsg5_max_len:4; -+ u32 mcsg6_max_len:4; -+ u32 mcs15_sgi_max_len:4; -+ -+ /* Offset 32 */ -+ u32 rsvd32; -+ -+ /* Offset 36 */ -+ u32 rsvd36; -+} TXDESC_8812, *PTXDESC_8812; -+ -+ -+/* Dword 0 */ -+#define GET_TX_DESC_OWN_8812(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+#define SET_TX_DESC_PKT_SIZE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_LAST_SEG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+#define SET_TX_DESC_FIRST_SEG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_LINIP_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+#define SET_TX_DESC_OWN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+/* Dword 1 */ -+#define SET_TX_DESC_MACID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+ -+/* Dword 2 */ -+#define SET_TX_DESC_PAID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_AGG_BREAK_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_SPE_RPT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_INT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_GID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+ -+/* Dword 3 */ -+#define SET_TX_DESC_WHEADER_LEN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) -+#define SET_TX_DESC_CHK_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) -+#define SET_TX_DESC_EARLY_MODE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HWSEQ_SEL_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+/* Dword 4 */ -+#define SET_TX_DESC_TX_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+ -+/* Dword 5 */ -+#define SET_TX_DESC_DATA_SC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_CTROL_STBC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+#define SET_TX_DESC_TX_ANT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 4, __Value) -+ -+/* Dword 6 */ -+#define SET_TX_DESC_SW_DEFINE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_ANTSEL_A_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+#define SET_TX_DESC_ANTSEL_B_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+#define SET_TX_DESC_ANTSEL_C_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 3, __Value) -+#define SET_TX_DESC_ANTSEL_D_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) -+#define SET_TX_DESC_MBSSID_8821(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+ -+/* Dword 7 */ -+#define SET_TX_DESC_TX_BUFFER_SIZE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#define SET_TX_DESC_USB_TXAGG_NUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+#ifdef CONFIG_SDIO_HCI -+#define SET_TX_DESC_SDIO_TXSEQ_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) -+#endif -+ -+/* Dword 8 */ -+#define SET_TX_DESC_HWSEQ_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+ -+/* Dword 9 */ -+#define SET_TX_DESC_SEQ_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+ -+/* Dword 10 */ -+#define SET_TX_DESC_TX_BUFFER_ADDRESS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) -+#define GET_TX_DESC_TX_BUFFER_ADDRESS_8812(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+40, 0, 32) -+ -+/* Dword 11 */ -+#define SET_TX_DESC_NEXT_DESC_ADDRESS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+#ifdef CONFIG_TX_EARLY_MODE -+ #define USB_DUMMY_OFFSET 2 -+#else -+ #define USB_DUMMY_OFFSET 1 -+#endif -+#define USB_DUMMY_LENGTH (USB_DUMMY_OFFSET * PACKET_OFFSET_SZ) -+ -+ -+void rtl8812a_cal_txdesc_chksum(u8 *ptxdesc); -+void rtl8812a_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+void rtl8812a_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void rtl8812a_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); -+void rtl8812a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); -+#if defined(CONFIG_CONCURRENT_MODE) -+void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+s32 rtl8812au_init_xmit_priv(PADAPTER padapter); -+void rtl8812au_free_xmit_priv(PADAPTER padapter); -+s32 rtl8812au_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8812au_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8812au_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); -+void rtl8812au_xmit_tasklet(void *priv); -+s32 rtl8812au_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8812ae_init_xmit_priv(PADAPTER padapter); -+void rtl8812ae_free_xmit_priv(PADAPTER padapter); -+struct xmit_buf *rtl8812ae_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+void rtl8812ae_xmitframe_resume(_adapter *padapter); -+s32 rtl8812ae_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8812ae_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8812ae_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+void rtl8812ae_xmit_tasklet(void *priv); -+#endif -+ -+#ifdef CONFIG_TX_EARLY_MODE -+void UpdateEarlyModeInfo8812(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif -+ -+void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, u8 *ptxdesc); -+ -+u8 BWMapping_8812(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+u8 SCMapping_8812(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+#endif /* __RTL8812_XMIT_H__ */ -+ -+#ifdef CONFIG_RTL8821A -+#include "rtl8821a_xmit.h" -+#endif /* CONFIG_RTL8821A */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_cmd.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_cmd.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,145 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8814A_CMD_H__ -+#define __RTL8814A_CMD_H__ -+#include "hal_com_h2c.h" -+ -+/* _RSVDPAGE_LOC_CMD0 */ -+#define SET_8814A_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8814A_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8814A_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8814A_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8814A_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+/* _SETPWRMODE_PARM */ -+#define SET_8814A_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+#define SET_8814A_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -+ -+#define GET_8814A_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+ -+/* _WoWLAN PARAM_CMD5 */ -+#define SET_8814A_H2CCMD_WOWLAN_FUNC_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_MAGIC_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_UNICAST_PKT_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_ALL_PKT_DROP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_GPIO_ACTIVE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_REKEY_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_DISCONNECT_WAKE_UP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_GPIONUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8814A_H2CCMD_WOWLAN_GPIO_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+ -+ -+/* WLANINFO_PARM */ -+#define SET_8814A_H2CCMD_WLANINFO_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8814A_H2CCMD_WLANINFO_PARM_CHANNEL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8814A_H2CCMD_WLANINFO_PARM_BW40MHZ(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+ -+/* _REMOTE_WAKEUP_CMD7 */ -+#define SET_8814A_H2CCMD_REMOTE_WAKECTRL_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8814A_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8814A_H2CCMD_REMOTE_WAKE_CTRL_NDP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8814A_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+ -+ -+/* _AP_OFFLOAD_CMD8 */ -+#define SET_8814A_H2CCMD_AP_OFFLOAD_ON(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8814A_H2CCMD_AP_OFFLOAD_HIDDEN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8814A_H2CCMD_AP_OFFLOAD_DENYANY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8814A_H2CCMD_AP_OFFLOAD_WAKEUP_EVT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+ -+/* _PWR_MOD_CMD20 */ -+#define SET_88E_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_88E_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_88E_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_88E_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_88E_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_88E_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+/*BCNHWSEQ*/ -+#define SET_8814A_H2CCMD_BCNHWSEQ_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 1, __Value) -+#define SET_8814A_H2CCMD_BCNHWSEQ_BCN_NUMBER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 1, 3, __Value) -+#define SET_8814A_H2CCMD_BCNHWSEQ_HWSEQ(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 6, 1, __Value) -+#define SET_8814A_H2CCMD_BCNHWSEQ_EXHWSEQ(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 7, 1, __Value) -+#define SET_8814A_H2CCMD_BCNHWSEQ_PAGE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+void rtl8814_fw_update_beacon_cmd(_adapter *padapter); -+ -+/* TX Beamforming */ -+#define GET_8814A_C2H_TXBF_ORIGINATE(_Header) LE_BITS_TO_1BYTE(_Header, 0, 8) -+#define GET_8814A_C2H_TXBF_MACID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) -+ -+ -+ -+/* / TX Feedback Content */ -+#define USEC_UNIT_FOR_8814A_C2H_TX_RPT_QUEUE_TIME 256 -+ -+#define GET_8814A_C2H_TX_RPT_QUEUE_SELECT(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 5) -+#define GET_8814A_C2H_TX_RPT_PKT_BROCAST(_Header) LE_BITS_TO_1BYTE((_Header + 0), 5, 1) -+#define GET_8814A_C2H_TX_RPT_LIFE_TIME_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 6, 1) -+#define GET_8814A_C2H_TX_RPT_RETRY_OVER(_Header) LE_BITS_TO_1BYTE((_Header + 0), 7, 1) -+#define GET_8814A_C2H_TX_RPT_MAC_ID(_Header) LE_BITS_TO_1BYTE((_Header + 1), 0, 8) -+#define GET_8814A_C2H_TX_RPT_DATA_RETRY_CNT(_Header) LE_BITS_TO_1BYTE((_Header + 2), 0, 6) -+#define GET_8814A_C2H_TX_RPT_QUEUE_TIME(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) /* In unit of 256 microseconds. */ -+#define GET_8814A_C2H_TX_RPT_FINAL_DATA_RATE(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) -+ -+ -+/* _P2P_PS_OFFLOAD */ -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -+ -+s32 FillH2CCmd_8814(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -+void rtl8814_set_raid_cmd(PADAPTER padapter, u64 bitmap, u8 *arg, u8 bw); -+void rtl8814_set_wowlan_cmd(_adapter *padapter, u8 enable); -+void rtl8814_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); -+void rtl8814_set_FwPwrMode_cmd(PADAPTER padapter, u8 PSMode); -+u8 GetTxBufferRsvdPageNum8814(_adapter *padapter, bool wowlan); -+u8 rtl8814_set_rssi_cmd(_adapter *padapter, u8 *param); -+ -+#ifdef CONFIG_TDLS -+ #ifdef CONFIG_TDLS_CH_SW -+ void rtl8814_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); -+ #endif -+#endif -+ -+void -+Set_RA_LDPC_8814( -+ struct sta_info *psta, -+ BOOLEAN bLDPC -+); -+ -+s32 c2h_handler_8814a(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); -+ -+#ifdef CONFIG_P2P_PS -+ void rtl8814_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif /* CONFIG_P2P */ -+ -+#endif/* __RTL8814A_CMD_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_dm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_dm.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_dm.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8814A_DM_H__ -+#define __RTL8814A_DM_H__ -+ -+void rtl8814_init_dm_priv(IN PADAPTER Adapter); -+void rtl8814_deinit_dm_priv(IN PADAPTER Adapter); -+void rtl8814_InitHalDm(IN PADAPTER Adapter); -+void rtl8814_HalDmWatchDog(IN PADAPTER Adapter); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_hal.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,324 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8814A_HAL_H__ -+#define __RTL8814A_HAL_H__ -+ -+/* #include "hal_com.h" */ -+#include "hal_data.h" -+ -+/* include HAL Related header after HAL Related compiling flags */ -+#include "rtl8814a_spec.h" -+#include "rtl8814a_rf.h" -+#include "rtl8814a_dm.h" -+#include "rtl8814a_recv.h" -+#include "rtl8814a_xmit.h" -+#include "rtl8814a_cmd.h" -+#include "rtl8814a_led.h" -+#include "Hal8814PwrSeq.h" -+#include "Hal8814PhyReg.h" -+#include "Hal8814PhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+ #include "rtl8814a_sreset.h" -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ -+enum { -+ VOLTAGE_V25 = 0x03, -+ LDOE25_SHIFT = 28 , -+}; -+/* max. iram is 64k , max dmen is 32k. Total = 96k = 0x18000*/ -+#define FW_SIZE 0x18000 -+#define FW_START_ADDRESS 0x1000 -+typedef struct _RT_FIRMWARE_8814 { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8 *szFwBuffer; -+#else -+ u8 szFwBuffer[FW_SIZE]; -+#endif -+ u32 ulFwLength; -+} RT_FIRMWARE_8814, *PRT_FIRMWARE_8814; -+ -+#define PAGE_SIZE_TX_8814 PAGE_SIZE_128 -+#define BCNQ_PAGE_NUM_8814 0x08 -+ -+#define Rtl8814A_NIC_PWR_ON_FLOW rtl8814A_power_on_flow -+#define Rtl8814A_NIC_RF_OFF_FLOW rtl8814A_radio_off_flow -+#define Rtl8814A_NIC_DISABLE_FLOW rtl8814A_card_disable_flow -+#define Rtl8814A_NIC_ENABLE_FLOW rtl8814A_card_enable_flow -+#define Rtl8814A_NIC_SUSPEND_FLOW rtl8814A_suspend_flow -+#define Rtl8814A_NIC_RESUME_FLOW rtl8814A_resume_flow -+#define Rtl8814A_NIC_PDN_FLOW rtl8814A_hwpdn_flow -+#define Rtl8814A_NIC_LPS_ENTER_FLOW rtl8814A_enter_lps_flow -+#define Rtl8814A_NIC_LPS_LEAVE_FLOW rtl8814A_leave_lps_flow -+ -+/* ***************************************************** -+ * New Firmware Header(8-byte alinment required) -+ * ***************************************************** -+ * --- LONG WORD 0 ---- */ -+#define GET_FIRMWARE_HDR_SIGNATURE_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 0, 16) -+#define GET_FIRMWARE_HDR_CATEGORY_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 16, 8) /* AP/NIC and USB/PCI */ -+#define GET_FIRMWARE_HDR_FUNCTION_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 24, 8) /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ -+#define GET_FIRMWARE_HDR_VERSION_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 0, 16)/* FW Version */ -+#define GET_FIRMWARE_HDR_SUB_VER_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 16, 8) /* FW Subversion, default 0x00 */ -+#define GET_FIRMWARE_HDR_SUB_IDX_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 24, 8) /* FW Subversion Index */ -+ -+/* --- LONG WORD 1 ---- */ -+#define GET_FIRMWARE_HDR_SVN_IDX_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 0, 32)/* The SVN entry index */ -+#define GET_FIRMWARE_HDR_RSVD1_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 0, 32) -+ -+/* --- LONG WORD 2 ---- */ -+#define GET_FIRMWARE_HDR_MONTH_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 0, 8) /* Release time Month field */ -+#define GET_FIRMWARE_HDR_DATE_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 8, 8) /* Release time Date field */ -+#define GET_FIRMWARE_HDR_HOUR_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 16, 8)/* Release time Hour field */ -+#define GET_FIRMWARE_HDR_MINUTE_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 24, 8)/* Release time Minute field */ -+#define GET_FIRMWARE_HDR_YEAR_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 0, 16)/* Release time Year field */ -+#define GET_FIRMWARE_HDR_FOUNDRY_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 16, 8)/* Release time Foundry field */ -+#define GET_FIRMWARE_HDR_RSVD2_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 24, 8) -+ -+/* --- LONG WORD 3 ---- */ -+#define GET_FIRMWARE_HDR_MEM_UASGE_DL_FROM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 0, 1) -+#define GET_FIRMWARE_HDR_MEM_UASGE_BOOT_FROM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 1, 1) -+#define GET_FIRMWARE_HDR_MEM_UASGE_BOOT_LOADER_3081(__FwHdr)LE_BITS_TO_4BYTE(__FwHdr+24, 2, 1) -+#define GET_FIRMWARE_HDR_MEM_UASGE_IRAM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 3, 1) -+#define GET_FIRMWARE_HDR_MEM_UASGE_ERAM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 4, 1) -+#define GET_FIRMWARE_HDR_MEM_UASGE_RSVD4_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 5, 3) -+#define GET_FIRMWARE_HDR_RSVD3_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 8, 8) -+#define GET_FIRMWARE_HDR_BOOT_LOADER_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 16, 16) -+#define GET_FIRMWARE_HDR_RSVD5_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+28, 0, 32) -+ -+/* --- LONG WORD 4 ---- */ -+#define GET_FIRMWARE_HDR_TOTAL_DMEM_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+36, 0, 32) -+#define GET_FIRMWARE_HDR_FW_CFG_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+36, 0, 16) -+#define GET_FIRMWARE_HDR_FW_ATTR_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+36, 16, 16) -+ -+/* --- LONG WORD 5 ---- */ -+#define GET_FIRMWARE_HDR_IROM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+40, 0, 32) -+#define GET_FIRMWARE_HDR_EROM_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+44, 0, 32) -+ -+/* --- LONG WORD 6 ---- */ -+#define GET_FIRMWARE_HDR_IRAM_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+48, 0, 32) -+#define GET_FIRMWARE_HDR_ERAM_SZ_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+52, 0, 32) -+ -+/* --- LONG WORD 7 ---- */ -+#define GET_FIRMWARE_HDR_RSVD6_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+56, 0, 32) -+#define GET_FIRMWARE_HDR_RSVD7_3081(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+60, 0, 32) -+ -+ -+ -+/* -+ * 2013/08/16 MH MOve from SDIO.h for common use. -+ * */ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) -+ #define TRX_SHARE_MODE_8814A 0 /* TRX Buffer Share Index */ -+ #define BASIC_RXFF_SIZE_8814A 24576/* Basic RXFF Size is 24K = 24*1024 Unit: Byte */ -+ #define TRX_SHARE_BUFF_UNIT_8814A 65536/* TRX Share Buffer unit Size 64K = 64*1024 Unit: Byte */ -+ #define TRX_SHARE_BUFF_UNIT_PAGE_8814A (TRX_SHARE_BUFF_UNIT_8814A/PAGE_SIZE_8814A)/* 512 Pages */ -+ -+ /* Origin: */ -+ #define HPQ_PGNUM_8814A 0x20 /* High Queue */ -+ #define LPQ_PGNUM_8814A 0x20 /* Low Queue */ -+ #define NPQ_PGNUM_8814A 0x20 /* Normal Queue */ -+ #define EPQ_PGNUM_8814A 0x20 /* Extra Queue */ -+ -+#else /* #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) */ -+ -+ #define HPQ_PGNUM_8814A 20 -+ #define NPQ_PGNUM_8814A 20 -+ #define LPQ_PGNUM_8814A 20 /* 1972 */ -+ #define EPQ_PGNUM_8814A 20 -+ #define BCQ_PGNUM_8814A 32 -+ -+#endif /* #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) */ -+ -+#ifdef CONFIG_WOWLAN -+ #define WOWLAN_PAGE_NUM_8814 0x00 -+#else -+ #define WOWLAN_PAGE_NUM_8814 0x00 -+#endif -+ -+#define PAGE_SIZE_8814A 128/* TXFF Page Size, Unit: Byte */ -+#define MAX_RX_DMA_BUFFER_SIZE_8814A 0x5C00 /* BASIC_RXFF_SIZE_8814A + TRX_SHARE_MODE_8814A * TRX_SHARE_BUFF_UNIT_8814A */ /* Basic RXFF Size + ShareBuffer Size */ -+#define TX_PAGE_BOUNDARY_8814A TXPKT_PGNUM_8814A /* Need to enlarge boundary, by KaiYuan */ -+#define TX_PAGE_BOUNDARY_WOWLAN_8814A TXPKT_PGNUM_8814A /* TODO: 20130415 KaiYuan Check this value later */ -+ -+#ifdef CONFIG_FW_C2H_DEBUG -+ #define RX_DMA_RESERVED_SIZE_8814A 0x100 /* 256B, reserved for c2h debug message */ -+#else -+ #define RX_DMA_RESERVED_SIZE_8814A 0x0 /* 0B */ -+#endif -+#define RX_DMA_BOUNDARY_8814A (MAX_RX_DMA_BUFFER_SIZE_8814A - RX_DMA_RESERVED_SIZE_8814A - 1) -+ -+#define TOTAL_PGNUM_8814A 2048 -+#define TXPKT_PGNUM_8814A (2048 - BCNQ_PAGE_NUM_8814-WOWLAN_PAGE_NUM_8814) -+#define PUB_PGNUM_8814A (TXPKT_PGNUM_8814A-HPQ_PGNUM_8814A-NPQ_PGNUM_8814A-LPQ_PGNUM_8814A-EPQ_PGNUM_8814A) -+ -+/* Note: For WMM Normal Chip Setting ,modify later */ -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8814A TX_PAGE_BOUNDARY_8814A -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8814A (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8814A + 1) -+ -+#define DRIVER_EARLY_INT_TIME_8814 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8814 0x02 -+ -+ -+#define MAX_PAGE_SIZE 4096 /* @ page : 4k bytes */ -+ -+#define EFUSE_MAX_SECTION_JAGUAR 64 -+ -+#define HWSET_MAX_SIZE_8814A 512 -+ -+#define EFUSE_REAL_CONTENT_LEN_8814A 1024 -+#define EFUSE_MAX_BANK_8814A 2 -+ -+#define EFUSE_MAP_LEN_8814A 512 -+#define EFUSE_MAX_SECTION_8814A 64 -+#define EFUSE_MAX_WORD_UNIT_8814A 4 -+#define EFUSE_PROTECT_BYTES_BANK_8814A 16 -+ -+#define EFUSE_IC_ID_OFFSET_8814A 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ -+#define AVAILABLE_EFUSE_ADDR_8814A(addr) (addr < EFUSE_REAL_CONTENT_LEN_8814A) -+ -+/*------------------------------------------------------------------------- -+Chip specific -+-------------------------------------------------------------------------*/ -+ -+/* pic buffer descriptor */ -+#if 1 /* according to the define in the rtw_xmit.h, rtw_recv.h */ -+ #define RTL8814AE_SEG_NUM TX_BUFFER_SEG_NUM /* 0:2 seg, 1: 4 seg, 2: 8 seg */ -+ #define TX_DESC_NUM_8814A TXDESC_NUM /* 128 */ -+ #define RX_DESC_NUM_8814A PCI_MAX_RX_COUNT /* 128 */ -+ #ifdef CONFIG_CONCURRENT_MODE -+ #define BE_QUEUE_TX_DESC_NUM_8814A (TXDESC_NUM<<1) /* 256 */ -+ #else -+ #define BE_QUEUE_TX_DESC_NUM_8814A (TXDESC_NUM+(TXDESC_NUM>>1)) /* 192 */ -+ #endif -+#else -+ #define RTL8814AE_SEG_NUM TX_BUFFER_SEG_NUM /* 0:2 seg, 1: 4 seg, 2: 8 seg */ -+ #define TX_DESC_NUM_8814A 128 /* 1024//2048 change by ylb 20130624 */ -+ #define RX_DESC_NUM_8814A 128 /* 1024 //512 change by ylb 20130624 */ -+#endif -+ -+/* To prevent out of boundary programming case, leave 1byte and program full section -+ * 9bytes + 1byt + 5bytes and pre 1byte. -+ * For worst case: -+ * | 1byte|----8bytes----|1byte|--5bytes--| -+ * | | Reserved(14bytes) | -+ * */ -+#define EFUSE_OOB_PROTECT_BYTES 15 /* PG data exclude header, dummy 6 bytes frome CP test and reserved 1byte. */ -+ -+/* rtl8814_hal_init.c */ -+s32 FirmwareDownload8814A(PADAPTER Adapter, BOOLEAN bUsedWoWLANFw); -+void InitializeFirmwareVars8814(PADAPTER padapter); -+ -+VOID -+Hal_InitEfuseVars_8814A( -+ IN PADAPTER Adapter -+); -+ -+s32 InitLLTTable8814A( -+ IN PADAPTER Adapter -+); -+ -+ -+void InitRDGSetting8814A(PADAPTER padapter); -+ -+/* void CheckAutoloadState8812A(PADAPTER padapter); */ -+ -+/* EFuse */ -+u8 GetEEPROMSize8814A(PADAPTER padapter); -+VOID hal_InitPGData_8814A( -+ IN PADAPTER padapter, -+ IN OUT u8 *PROMContent -+); -+ -+void hal_ReadPROMVersion8814A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void hal_ReadTxPowerInfo8814A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void hal_ReadBoardType8814A(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void hal_ReadThermalMeter_8814A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void hal_ReadChannelPlan8814A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void hal_EfuseParseXtal_8814A(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+void hal_ReadAntennaDiversity8814A(PADAPTER pAdapter, u8 *PROMContent, BOOLEAN AutoLoadFail); -+void hal_Read_TRX_antenna_8814A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+VOID hal_ReadAmplifierType_8814A( -+ IN PADAPTER Adapter -+); -+VOID hal_ReadPAType_8814A( -+ IN PADAPTER Adapter, -+ IN u8 *PROMContent, -+ IN BOOLEAN AutoloadFail, -+ OUT u8 *pPAType, -+ OUT u8 *pLNAType -+); -+ -+void hal_ReadPowerTrackingType_8814A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+ -+void hal_GetRxGainOffset_8814A( -+ PADAPTER Adapter, -+ pu1Byte PROMContent, -+ BOOLEAN AutoloadFail -+); -+void Hal_EfuseParseKFreeData_8814A( -+ IN PADAPTER Adapter, -+ IN u8 *PROMContent, -+ IN BOOLEAN AutoloadFail); -+void hal_ReadRFEType_8814A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+void hal_EfuseParseBTCoexistInfo8814A(PADAPTER Adapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+ -+/* void hal_ReadUsbType_8812AU(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -+ * int FirmwareDownloadBT(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); */ -+void hal_ReadRemoteWakeup_8814A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -+u8 MgntQuery_NssTxRate(u16 Rate); -+ -+/* BOOLEAN HalDetectPwrDownMode8812(PADAPTER Adapter); */ -+ -+#ifdef CONFIG_WOWLAN -+ void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif /* CONFIG_WOWLAN */ -+ -+void _InitBeaconParameters_8814A(PADAPTER padapter); -+void SetBeaconRelatedRegisters8814A(PADAPTER padapter); -+ -+void ReadRFType8814A(PADAPTER padapter); -+void InitDefaultValue8814A(PADAPTER padapter); -+ -+void SetHwReg8814A(PADAPTER padapter, u8 variable, u8 *pval); -+void GetHwReg8814A(PADAPTER padapter, u8 variable, u8 *pval); -+u8 SetHalDefVar8814A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8814A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+void rtl8814_set_hal_ops(struct hal_ops *pHalFunc); -+void init_hal_spec_8814a(_adapter *adapter); -+ -+/* register */ -+void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); -+void SetBcnCtrlReg(PADAPTER Adapter, u8 SetBits, u8 ClearBits); -+void rtl8814_start_thread(PADAPTER padapter); -+void rtl8814_stop_thread(PADAPTER padapter); -+ -+ -+#ifdef CONFIG_PCI_HCI -+ BOOLEAN InterruptRecognized8814AE(PADAPTER Adapter); -+ VOID UpdateInterruptMask8814AE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+ u16 get_txbd_idx_addr(u16 ff_hwaddr); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ void rtl8812a_combo_card_WifiOnlyHwInit(PADAPTER Adapter); -+#endif -+ -+#endif /* __RTL8188E_HAL_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_led.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_led.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_led.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,40 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8814A_LED_H__ -+#define __RTL8814A_LED_H__ -+ -+ -+/* ******************************************************************************** -+ * Interface to manipulate LED objects. -+ * ******************************************************************************** */ -+#ifdef CONFIG_USB_HCI -+ void rtl8814au_InitSwLeds(PADAPTER padapter); -+ void rtl8814au_DeInitSwLeds(PADAPTER padapter); -+#endif /* CONFIG_USB_HCI */ -+#ifdef CONFIG_PCI_HCI -+ void rtl8814ae_InitSwLeds(PADAPTER padapter); -+ void rtl8814ae_DeInitSwLeds(PADAPTER padapter); -+#endif /* CONFIG_PCI_HCI */ -+#ifdef CONFIG_SDIO_HCI -+ void rtl8814s_InitSwLeds(PADAPTER padapter); -+ void rtl8814s_DeInitSwLeds(PADAPTER padapter); -+#endif /* CONFIG_SDIO_HCI */ -+ -+#endif /* __RTL8814A_LED_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_recv.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_recv.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,191 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8814A_RECV_H__ -+#define __RTL8814A_RECV_H__ -+ -+#if defined(CONFIG_USB_HCI) -+ -+ #ifndef MAX_RECVBUF_SZ -+ #ifdef PLATFORM_OS_CE -+ #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ -+ #else -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #ifdef CONFIG_PLATFORM_MSTAR -+ #define MAX_RECVBUF_SZ (8192) /* 8K */ -+ #else -+ #define MAX_RECVBUF_SZ (32768) /* 32k */ -+ #endif -+ /* #define MAX_RECVBUF_SZ (24576) */ /* 24k */ -+ /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ -+ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ -+ /* #define MAX_RECVBUF_SZ (15360) */ /* 15k < 16k */ -+ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ -+ #else -+ #define MAX_RECVBUF_SZ (4000) /* about 4K */ -+ #endif -+ #endif -+ #endif /* !MAX_RECVBUF_SZ */ -+ -+#elif defined(CONFIG_PCI_HCI) -+ /* #ifndef CONFIG_MINIMAL_MEMORY_USAGE */ -+ /* #define MAX_RECVBUF_SZ (9100) */ -+ /* #else */ -+ #define MAX_RECVBUF_SZ (4000) /* about 4K -+ * #endif */ -+ -+ -+#elif defined(CONFIG_SDIO_HCI) -+ #if 0 -+ /* temp solution */ -+ #ifdef CONFIG_SDIO_RX_COPY -+ #define MAX_RECVBUF_SZ (10240) -+ #else /* !CONFIG_SDIO_RX_COPY */ -+ #define MAX_RECVBUF_SZ MAX_RX_DMA_BUFFER_SIZE_8821 -+ #endif /* !CONFIG_SDIO_RX_COPY */ -+ #endif -+#endif -+ -+ -+/* RX buffer descriptor */ -+/* DWORD 0 */ -+#define SET_RX_BUFFER_DESC_DATA_LENGTH_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_BUFFER_DESC_LS_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 14, 1, __Value) -+#define SET_RX_BUFFER_DESC_FS_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 15, 1, __Value) -+#define SET_RX_BUFFER_DESC_TOTAL_LENGTH_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 16, __Value) -+ -+#define GET_RX_BUFFER_DESC_OWN_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) -+#define GET_RX_BUFFER_DESC_LS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) -+#define GET_RX_BUFFER_DESC_FS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_BUFFER_DESC_TOTAL_LENGTH_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 15) -+ -+/* DWORD 1 */ -+#define SET_RX_BUFFER_PHYSICAL_LOW_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+4, 0, 32, __Value) -+#define GET_RX_BUFFER_PHYSICAL_LOW_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 0, 32) -+ -+/* DWORD 2 */ -+#define SET_RX_BUFFER_PHYSICAL_HIGH_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+8, 0, 32, __Value) -+ -+/* DWORD 3*/ /* RESERVED */ -+ -+ -+#if 0 -+ /* ============= -+ * RX Info -+ * ============== */ -+#endif -+/* DWORD 0 */ -+#define SET_RX_STATUS_DESC_PKT_LEN_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8814A(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8814AE(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_LAST_SEG_8814AE(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 28, 1) -+#define GET_RX_STATUS_DESC_EOR_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) -+ -+/* DWORD 1 */ -+#define GET_RX_STATUS_DESC_MACID_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_EXT_SECTYPE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 7, 1)/* 20130415 KaiYuan add for 8814 */ -+#define GET_RX_STATUS_DESC_TID_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_MACID_VLD_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 12, 1) -+#define GET_RX_STATUS_DESC_AMSDU_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_CHKERR_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_IPVER_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_IS_TCPUDP_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_TCPOFFLOAD_CHK_VLD_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_FIRST_SEG_8814AE(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 29, 1) -+#define GET_RX_STATUS_DESC_EOR_8814AE(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_MC_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+4, 31, 1) -+ -+/* DWORD 2 */ -+#define GET_RX_STATUS_DESC_SEQ_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) -+#ifdef CONFIG_USB_RX_AGGREGATION -+ #define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 8) -+#else -+ #define GET_RX_STATUS_DESC_RX_IS_QOS_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) -+#endif -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_HWRSVD_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 24, 4) -+#define GET_RX_STATUS_C2H_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) -+#define GET_RX_STATUS_DESC_FCS_OK_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 31, 1) -+ -+/* DWORD 3 */ -+#define GET_RX_STATUS_DESC_RX_RATE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_BSSID_FIT_H_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 7, 3)/* 20130415 KaiYuan add for 8814 */ -+#define GET_RX_STATUS_DESC_HTC_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_L_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) -+#define GET_RX_STATUS_DESC_DMA_AGG_NUM_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8)/* 20130415 KaiYuan Check if it exist anymore */ -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_WAKE_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 31, 1) -+ -+/* DWORD 4 */ -+#define GET_RX_STATUS_DESC_PATTERN_IDX_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+16, 0, 8) -+#define GET_RX_STATUS_DESC_RX_EOF_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+16, 8, 1) -+#define GET_RX_STATUS_DESC_RX_SCRAMBLER_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+16, 9, 7) -+#define GET_RX_STATUS_DESC_RX_PRE_NDP_VLD_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+16, 16, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+16, 24, 5) -+ -+ -+/* DWORD 5 */ -+#define GET_RX_STATUS_DESC_TSFL_8814A(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) -+ -+ -+/* Rx smooth factor */ -+#define Rx_Smooth_Factor (20) -+ -+#ifdef CONFIG_USB_HCI -+ s32 rtl8814au_init_recv_priv(PADAPTER padapter); -+ void rtl8814au_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8814ae_init_recv_priv(PADAPTER padapter); -+ void rtl8814ae_free_recv_priv(PADAPTER padapter); -+#endif -+ -+#if 0 -+ /* temp solution */ -+ #ifdef CONFIG_SDIO_HCI -+ s32 InitRecvPriv8821AS(PADAPTER padapter); -+ void FreeRecvPriv8821AS(PADAPTER padapter); -+ #endif /* CONFIG_SDIO_HCI */ -+#endif -+ -+void rtl8814_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+ -+#endif /* __RTL8814A_RECV_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_rf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_rf.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,33 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8814A_RF_H__ -+#define __RTL8814A_RF_H__ -+ -+VOID -+PHY_RF6052SetBandwidth8814A( -+ IN PADAPTER Adapter, -+ IN CHANNEL_WIDTH Bandwidth); -+ -+ -+int -+PHY_RF6052_Config_8814A( -+ IN PADAPTER Adapter); -+ -+#endif/* __RTL8188E_RF_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_spec.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_spec.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,651 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8814A_SPEC_H__ -+#define __RTL8814A_SPEC_H__ -+ -+#include -+ -+ -+/* ************************************************************ -+ * -+ * ************************************************************ */ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0000h ~ 0x00FFh System Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_SYS_ISO_CTRL_8814A 0x0000 /* 2 Byte */ -+#define REG_SYS_FUNC_EN_8814A 0x0002 /* 2 Byte */ -+#define REG_SYS_PW_CTRL_8814A 0x0004 /* 4 Byte */ -+#define REG_SYS_CLKR_8814A 0x0008 /* 2 Byte */ -+#define REG_SYS_EEPROM_CTRL_8814A 0x000A /* 2 Byte */ -+#define REG_EE_VPD_8814A 0x000C /* 2 Byte */ -+#define REG_SYS_SWR_CTRL1_8814A 0x0010 /* 1 Byte */ -+#define REG_SPS0_CTRL_8814A 0x0011 /* 7 Byte */ -+#define REG_SYS_SWR_CTRL3_8814A 0x0018 /* 4 Byte */ -+#define REG_RSV_CTRL_8814A 0x001C /* 3 Byte */ -+#define REG_RF_CTRL0_8814A 0x001F /* 1 Byte */ -+#define REG_RF_CTRL1_8814A 0x0020 /* 1 Byte */ -+#define REG_RF_CTRL2_8814A 0x0021 /* 1 Byte */ -+#define REG_LPLDO_CTRL_8814A 0x0023 /* 1 Byte */ -+#define REG_AFE_CTRL1_8814A 0x0024 /* 4 Byte */ -+#define REG_AFE_CTRL2_8814A 0x0028 /* 4 Byte */ -+#define REG_AFE_CTRL3_8814A 0x002c /* 4 Byte */ -+#define REG_EFUSE_CTRL_8814A 0x0030 -+#define REG_LDO_EFUSE_CTRL_8814A 0x0034 -+#define REG_PWR_DATA_8814A 0x0038 -+#define REG_CAL_TIMER_8814A 0x003C -+#define REG_ACLK_MON_8814A 0x003E -+#define REG_GPIO_MUXCFG_8814A 0x0040 -+#define REG_GPIO_IO_SEL_8814A 0x0042 -+#define REG_MAC_PINMUX_CFG_8814A 0x0043 -+#define REG_GPIO_PIN_CTRL_8814A 0x0044 -+#define REG_GPIO_INTM_8814A 0x0048 -+#define REG_LEDCFG0_8814A 0x004C -+#define REG_LEDCFG1_8814A 0x004D -+#define REG_LEDCFG2_8814A 0x004E -+#define REG_LEDCFG3_8814A 0x004F -+#define REG_FSIMR_8814A 0x0050 -+#define REG_FSISR_8814A 0x0054 -+#define REG_HSIMR_8814A 0x0058 -+#define REG_HSISR_8814A 0x005c -+#define REG_GPIO_EXT_CTRL_8814A 0x0060 -+#define REG_GPIO_STATUS_8814A 0x006C -+#define REG_SDIO_CTRL_8814A 0x0070 -+#define REG_HCI_OPT_CTRL_8814A 0x0074 -+#define REG_RF_CTRL3_8814A 0x0076 /* 1 Byte */ -+#define REG_AFE_CTRL4_8814A 0x0078 -+#define REG_8051FW_CTRL_8814A 0x0080 -+#define REG_HIMR0_8814A 0x00B0 -+#define REG_HISR0_8814A 0x00B4 -+#define REG_HIMR1_8814A 0x00B8 -+#define REG_HISR1_8814A 0x00BC -+#define REG_SYS_CFG1_8814A 0x00F0 -+#define REG_SYS_CFG2_8814A 0x00FC -+#define REG_SYS_CFG3_8814A 0x1000 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_CR_8814A 0x0100 -+#define REG_PBP_8814A 0x0104 -+#define REG_PKT_BUFF_ACCESS_CTRL_8814A 0x0106 -+#define REG_TRXDMA_CTRL_8814A 0x010C -+#define REG_TRXFF_BNDY_8814A 0x0114 -+#define REG_TRXFF_STATUS_8814A 0x0118 -+#define REG_RXFF_PTR_8814A 0x011C -+#define REG_CPWM_8814A 0x012F -+#define REG_FWIMR_8814A 0x0130 -+#define REG_FWISR_8814A 0x0134 -+#define REG_FTIMR_8814A 0x0138 -+#define REG_PKTBUF_DBG_CTRL_8814A 0x0140 -+#define REG_RXPKTBUF_CTRL_8814A 0x0142 -+#define REG_PKTBUF_DBG_DATA_L_8814A 0x0144 -+#define REG_PKTBUF_DBG_DATA_H_8814A 0x0148 -+ -+#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN -+ -+#define REG_TC0_CTRL_8814A 0x0150 -+#define REG_TC1_CTRL_8814A 0x0154 -+#define REG_TC2_CTRL_8814A 0x0158 -+#define REG_TC3_CTRL_8814A 0x015C -+#define REG_TC4_CTRL_8814A 0x0160 -+#define REG_TCUNIT_BASE_8814A 0x0164 -+#define REG_RSVD3_8814A 0x0168 -+#define REG_C2HEVT_MSG_NORMAL_8814A 0x01A0 -+#define REG_C2HEVT_CLEAR_8814A 0x01AF -+#define REG_MCUTST_1_8814A 0x01C0 -+#define REG_MCUTST_WOWLAN_8814A 0x01C7 -+#define REG_FMETHR_8814A 0x01C8 -+#define REG_HMETFR_8814A 0x01CC -+#define REG_HMEBOX_0_8814A 0x01D0 -+#define REG_HMEBOX_1_8814A 0x01D4 -+#define REG_HMEBOX_2_8814A 0x01D8 -+#define REG_HMEBOX_3_8814A 0x01DC -+#define REG_LLT_INIT_8814A 0x01E0 -+#define REG_LLT_ADDR_8814A 0x01E4 /* 20130415 KaiYuan add for 8814 */ -+#define REG_HMEBOX_EXT0_8814A 0x01F0 -+#define REG_HMEBOX_EXT1_8814A 0x01F4 -+#define REG_HMEBOX_EXT2_8814A 0x01F8 -+#define REG_HMEBOX_EXT3_8814A 0x01FC -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_FIFOPAGE_CTRL_1_8814A 0x0200 -+#define REG_FIFOPAGE_CTRL_2_8814A 0x0204 -+#define REG_AUTO_LLT_8814A 0x0208 -+#define REG_TXDMA_OFFSET_CHK_8814A 0x020C -+#define REG_TXDMA_STATUS_8814A 0x0210 -+#define REG_RQPN_NPQ_8814A 0x0214 -+#define REG_TQPNT1_8814A 0x0218 -+#define REG_TQPNT2_8814A 0x021C -+#define REG_TQPNT3_8814A 0x0220 -+#define REG_TQPNT4_8814A 0x0224 -+#define REG_RQPN_CTRL_1_8814A 0x0228 -+#define REG_RQPN_CTRL_2_8814A 0x022C -+#define REG_FIFOPAGE_INFO_1_8814A 0x0230 -+#define REG_FIFOPAGE_INFO_2_8814A 0x0234 -+#define REG_FIFOPAGE_INFO_3_8814A 0x0238 -+#define REG_FIFOPAGE_INFO_4_8814A 0x023C -+#define REG_FIFOPAGE_INFO_5_8814A 0x0240 -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0280h ~ 0x02FFh RXDMA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_RXDMA_AGG_PG_TH_8814A 0x0280 -+#define REG_RXPKT_NUM_8814A 0x0284 /* The number of packets in RXPKTBUF. */ -+#define REG_RXDMA_CONTROL_8814A 0x0286 /* ?????? Control the RX DMA. */ -+#define REG_RXDMA_STATUS_8814A 0x0288 -+#define REG_RXDMA_MODE_8814A 0x0290 /* ?????? */ -+#define REG_EARLY_MODE_CONTROL_8814A 0x02BC /* ?????? */ -+#define REG_RSVD5_8814A 0x02F0 /* ?????? */ -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0300h ~ 0x03FFh PCIe -+ * -+ * ----------------------------------------------------- */ -+#define REG_PCIE_CTRL_REG_8814A 0x0300 -+#define REG_INT_MIG_8814A 0x0304 /* Interrupt Migration */ -+#define REG_BCNQ_TXBD_DESA_8814A 0x0308 /* TX Beacon Descriptor Address */ -+#define REG_MGQ_TXBD_DESA_8814A 0x0310 /* TX Manage Queue Descriptor Address */ -+#define REG_VOQ_TXBD_DESA_8814A 0x0318 /* TX VO Queue Descriptor Address */ -+#define REG_VIQ_TXBD_DESA_8814A 0x0320 /* TX VI Queue Descriptor Address */ -+#define REG_BEQ_TXBD_DESA_8814A 0x0328 /* TX BE Queue Descriptor Address */ -+#define REG_BKQ_TXBD_DESA_8814A 0x0330 /* TX BK Queue Descriptor Address */ -+#define REG_RXQ_RXBD_DESA_8814A 0x0338 /* RX Queue Descriptor Address */ -+#define REG_HI0Q_TXBD_DESA_8814A 0x0340 -+#define REG_HI1Q_TXBD_DESA_8814A 0x0348 -+#define REG_HI2Q_TXBD_DESA_8814A 0x0350 -+#define REG_HI3Q_TXBD_DESA_8814A 0x0358 -+#define REG_HI4Q_TXBD_DESA_8814A 0x0360 -+#define REG_HI5Q_TXBD_DESA_8814A 0x0368 -+#define REG_HI6Q_TXBD_DESA_8814A 0x0370 -+#define REG_HI7Q_TXBD_DESA_8814A 0x0378 -+#define REG_MGQ_TXBD_NUM_8814A 0x0380 -+#define REG_RX_RXBD_NUM_8814A 0x0382 -+#define REG_VOQ_TXBD_NUM_8814A 0x0384 -+#define REG_VIQ_TXBD_NUM_8814A 0x0386 -+#define REG_BEQ_TXBD_NUM_8814A 0x0388 -+#define REG_BKQ_TXBD_NUM_8814A 0x038A -+#define REG_HI0Q_TXBD_NUM_8814A 0x038C -+#define REG_HI1Q_TXBD_NUM_8814A 0x038E -+#define REG_HI2Q_TXBD_NUM_8814A 0x0390 -+#define REG_HI3Q_TXBD_NUM_8814A 0x0392 -+#define REG_HI4Q_TXBD_NUM_8814A 0x0394 -+#define REG_HI5Q_TXBD_NUM_8814A 0x0396 -+#define REG_HI6Q_TXBD_NUM_8814A 0x0398 -+#define REG_HI7Q_TXBD_NUM_8814A 0x039A -+#define REG_TSFTIMER_HCI_8814A 0x039C -+ -+/* Read Write Point */ -+#define REG_VOQ_TXBD_IDX_8814A 0x03A0 -+#define REG_VIQ_TXBD_IDX_8814A 0x03A4 -+#define REG_BEQ_TXBD_IDX_8814A 0x03A8 -+#define REG_BKQ_TXBD_IDX_8814A 0x03AC -+#define REG_MGQ_TXBD_IDX_8814A 0x03B0 -+#define REG_RXQ_TXBD_IDX_8814A 0x03B4 -+#define REG_HI0Q_TXBD_IDX_8814A 0x03B8 -+#define REG_HI1Q_TXBD_IDX_8814A 0x03BC -+#define REG_HI2Q_TXBD_IDX_8814A 0x03C0 -+#define REG_HI3Q_TXBD_IDX_8814A 0x03C4 -+#define REG_HI4Q_TXBD_IDX_8814A 0x03C8 -+#define REG_HI5Q_TXBD_IDX_8814A 0x03CC -+#define REG_HI6Q_TXBD_IDX_8814A 0x03D0 -+#define REG_HI7Q_TXBD_IDX_8814A 0x03D4 -+#define REG_DBG_SEL_V1_8814A 0x03D8 -+#define REG_PCIE_HRPWM1_V1_8814A 0x03D9 -+#define REG_PCIE_HCPWM1_V1_8814A 0x03DA -+#define REG_PCIE_CTRL2_8814A 0x03DB -+#define REG_PCIE_HRPWM2_V1_8814A 0x03DC -+#define REG_PCIE_HCPWM2_V1_8814A 0x03DE -+#define REG_PCIE_H2C_MSG_V1_8814A 0x03E0 -+#define REG_PCIE_C2H_MSG_V1_8814A 0x03E4 -+#define REG_DBI_WDATA_V1_8814A 0x03E8 -+#define REG_DBI_RDATA_V1_8814A 0x03EC -+#define REG_DBI_FLAG_V1_8814A 0x03F0 -+#define REG_MDIO_V1_8814A 0x03F4 -+#define REG_PCIE_MIX_CFG_8814A 0x03F8 -+#define REG_DBG_8814A 0x03FC -+/* ----------------------------------------------------- -+ * -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_VOQ_INFORMATION_8814A 0x0400 -+#define REG_VIQ_INFORMATION_8814A 0x0404 -+#define REG_BEQ_INFORMATION_8814A 0x0408 -+#define REG_BKQ_INFORMATION_8814A 0x040C -+#define REG_MGQ_INFORMATION_8814A 0x0410 -+#define REG_HGQ_INFORMATION_8814A 0x0414 -+#define REG_BCNQ_INFORMATION_8814A 0x0418 -+#define REG_TXPKT_EMPTY_8814A 0x041A -+#define REG_CPU_MGQ_INFORMATION_8814A 0x041C -+#define REG_FWHW_TXQ_CTRL_8814A 0x0420 -+#define REG_HWSEQ_CTRL_8814A 0x0423 -+#define REG_TXPKTBUF_BCNQ_BDNY_8814A 0x0424 -+/* #define REG_MGQ_BDNY_8814A 0x0425 */ -+#define REG_LIFETIME_EN_8814A 0x0426 -+/* #define REG_FW_FREE_TAIL_8814A 0x0427 */ -+#define REG_SPEC_SIFS_8814A 0x0428 -+#define REG_RETRY_LIMIT_8814A 0x042A -+#define REG_TXBF_CTRL_8814A 0x042C -+#define REG_DARFRC_8814A 0x0430 -+#define REG_RARFRC_8814A 0x0438 -+#define REG_RRSR_8814A 0x0440 -+#define REG_ARFR0_8814A 0x0444 -+#define REG_ARFR1_8814A 0x044C -+#define REG_CCK_CHECK_8814A 0x0454 -+#define REG_AMPDU_MAX_TIME_8814A 0x0455 -+#define REG_TXPKTBUF_BCNQ1_BDNY_8814A 0x0456 -+#define REG_AMPDU_MAX_LENGTH_8814A 0x0458 -+#define REG_ACQ_STOP_8814A 0x045C -+#define REG_NDPA_RATE_8814A 0x045D -+#define REG_TX_HANG_CTRL_8814A 0x045E -+#define REG_NDPA_OPT_CTRL_8814A 0x045F -+#define REG_FAST_EDCA_CTRL_8814A 0x0460 -+#define REG_RD_RESP_PKT_TH_8814A 0x0463 -+#define REG_CMDQ_INFO_8814A 0x0464 -+#define REG_Q4_INFO_8814A 0x0468 -+#define REG_Q5_INFO_8814A 0x046C -+#define REG_Q6_INFO_8814A 0x0470 -+#define REG_Q7_INFO_8814A 0x0474 -+#define REG_WMAC_LBK_BUF_HD_8814A 0x0478 -+#define REG_MGQ_PGBNDY_8814A 0x047A -+#define REG_INIRTS_RATE_SEL_8814A 0x0480 -+#define REG_BASIC_CFEND_RATE_8814A 0x0481 -+#define REG_STBC_CFEND_RATE_8814A 0x0482 -+#define REG_DATA_SC_8814A 0x0483 -+#define REG_MACID_SLEEP3_8814A 0x0484 -+#define REG_MACID_SLEEP1_8814A 0x0488 -+#ifdef CONFIG_WOWLAN -+ #define REG_TXPKTBUF_IV_LOW 0x0484 -+ #define REG_TXPKTBUF_IV_HIGH 0x0488 -+#endif /* CONFIG_WOWLAN */ -+#define REG_ARFR2_8814A 0x048C -+#define REG_ARFR3_8814A 0x0494 -+#define REG_ARFR4_8814A 0x049C -+#define REG_ARFR5_8814A 0x04A4 -+#define REG_TXRPT_START_OFFSET_8814A 0x04AC -+#define REG_TRYING_CNT_TH_8814A 0x04B0 -+#define REG_POWER_STAGE1_8814A 0x04B4 -+#define REG_POWER_STAGE2_8814A 0x04B8 -+#define REG_SW_AMPDU_BURST_MODE_CTRL_8814A 0x04BC -+#define REG_PKT_LIFE_TIME_8814A 0x04C0 -+#define REG_PKT_BE_BK_LIFE_TIME_8814A 0x04C2 /* ?????? */ -+#define REG_STBC_SETTING_8814A 0x04C4 -+#define REG_STBC_8814A 0x04C5 -+#define REG_QUEUE_CTRL_8814A 0x04C6 -+#define REG_SINGLE_AMPDU_CTRL_8814A 0x04C7 -+#define REG_PROT_MODE_CTRL_8814A 0x04C8 -+#define REG_MAX_AGGR_NUM_8814A 0x04CA -+#define REG_RTS_MAX_AGGR_NUM_8814A 0x04CB -+#define REG_BAR_MODE_CTRL_8814A 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT_8814A 0x04CF -+#define REG_MACID_SLEEP2_8814A 0x04D0 -+#define REG_MACID_SLEEP0_8814A 0x04D4 -+#define REG_HW_SEQ0_8814A 0x04D8 -+#define REG_HW_SEQ1_8814A 0x04DA -+#define REG_HW_SEQ2_8814A 0x04DC -+#define REG_HW_SEQ3_8814A 0x04DE -+#define REG_NULL_PKT_STATUS_8814A 0x04E0 -+#define REG_PTCL_ERR_STATUS_8814A 0x04E2 -+#define REG_DROP_PKT_NUM_8814A 0x04EC -+#define REG_PTCL_TX_RPT_8814A 0x04F0 -+#define REG_Dummy_8814A 0x04FC -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_EDCA_VO_PARAM_8814A 0x0500 -+#define REG_EDCA_VI_PARAM_8814A 0x0504 -+#define REG_EDCA_BE_PARAM_8814A 0x0508 -+#define REG_EDCA_BK_PARAM_8814A 0x050C -+#define REG_BCNTCFG_8814A 0x0510 -+#define REG_PIFS_8814A 0x0512 -+#define REG_RDG_PIFS_8814A 0x0513 -+#define REG_SIFS_CTX_8814A 0x0514 -+#define REG_SIFS_TRX_8814A 0x0516 -+#define REG_AGGR_BREAK_TIME_8814A 0x051A -+#define REG_SLOT_8814A 0x051B -+#define REG_TX_PTCL_CTRL_8814A 0x0520 -+#define REG_TXPAUSE_8814A 0x0522 -+#define REG_DIS_TXREQ_CLR_8814A 0x0523 -+#define REG_RD_CTRL_8814A 0x0524 -+/* -+ * Format for offset 540h-542h: -+ * [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. -+ * [7:4]: Reserved. -+ * [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. -+ * [23:20]: Reserved -+ * Description: -+ * | -+ * |<--Setup--|--Hold------------>| -+ * --------------|---------------------- -+ * | -+ * TBTT -+ * Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. -+ * Described by Designer Tim and Bruce, 2011-01-14. -+ * */ -+#define REG_TBTT_PROHIBIT_8814A 0x0540 -+#define REG_RD_NAV_NXT_8814A 0x0544 -+#define REG_NAV_PROT_LEN_8814A 0x0546 -+#define REG_BCN_CTRL_8814A 0x0550 -+#define REG_BCN_CTRL_1_8814A 0x0551 -+#define REG_MBID_NUM_8814A 0x0552 -+#define REG_DUAL_TSF_RST_8814A 0x0553 -+#define REG_MBSSID_BCN_SPACE_8814A 0x0554 -+#define REG_DRVERLYINT_8814A 0x0558 -+#define REG_BCNDMATIM_8814A 0x0559 -+#define REG_ATIMWND_8814A 0x055A -+#define REG_USTIME_TSF_8814A 0x055C -+#define REG_BCN_MAX_ERR_8814A 0x055D -+#define REG_RXTSF_OFFSET_CCK_8814A 0x055E -+#define REG_RXTSF_OFFSET_OFDM_8814A 0x055F -+#define REG_TSFTR_8814A 0x0560 -+#define REG_CTWND_8814A 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8814A 0x0577 /* ?????? */ -+#define REG_PSTIMER_8814A 0x0580 -+#define REG_TIMER0_8814A 0x0584 -+#define REG_TIMER1_8814A 0x0588 -+#define REG_BCN_PREDL_ITV_8814A 0x058F /* Pre download beacon interval */ -+#define REG_ACMHWCTRL_8814A 0x05C0 -+#define REG_P2P_RST_8814A 0x05F0 -+ -+/* ----------------------------------------------------- -+ * -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * -+ * ----------------------------------------------------- */ -+#define REG_MAC_CR_8814A 0x0600 -+#define REG_TCR_8814A 0x0604 -+#define REG_RCR_8814A 0x0608 -+#define REG_RX_PKT_LIMIT_8814A 0x060C -+#define REG_RX_DLK_TIME_8814A 0x060D -+#define REG_RX_DRVINFO_SZ_8814A 0x060F -+ -+#define REG_MACID_8814A 0x0610 -+#define REG_BSSID_8814A 0x0618 -+#define REG_MAR_8814A 0x0620 -+#define REG_MBIDCAMCFG_8814A 0x0628 -+ -+#define REG_USTIME_EDCA_8814A 0x0638 -+#define REG_MAC_SPEC_SIFS_8814A 0x063A -+#define REG_RESP_SIFP_CCK_8814A 0x063C -+#define REG_RESP_SIFS_OFDM_8814A 0x063E -+#define REG_ACKTO_8814A 0x0640 -+#define REG_CTS2TO_8814A 0x0641 -+#define REG_EIFS_8814A 0x0642 -+ -+#define REG_NAV_UPPER_8814A 0x0652 /* unit of 128 */ -+#define REG_TRXPTCL_CTL_8814A 0x0668 -+ -+/* Security */ -+#define REG_CAMCMD_8814A 0x0670 -+#define REG_CAMWRITE_8814A 0x0674 -+#define REG_CAMREAD_8814A 0x0678 -+#define REG_CAMDBG_8814A 0x067C -+#define REG_SECCFG_8814A 0x0680 -+ -+/* Power */ -+#define REG_WOW_CTRL_8814A 0x0690 -+#define REG_PS_RX_INFO_8814A 0x0692 -+#define REG_UAPSD_TID_8814A 0x0693 -+#define REG_WKFMCAM_NUM_8814A 0x0698 -+#define REG_RXFLTMAP0_8814A 0x06A0 -+#define REG_RXFLTMAP1_8814A 0x06A2 -+#define REG_RXFLTMAP2_8814A 0x06A4 -+#define REG_BCN_PSR_RPT_8814A 0x06A8 -+#define REG_BT_COEX_TABLE_8814A 0x06C0 -+#define REG_TX_DATA_RSP_RATE_8814A 0x06DE -+#define REG_ASSOCIATED_BFMER0_INFO_8814A 0x06E4 -+#define REG_ASSOCIATED_BFMER1_INFO_8814A 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8814A 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8814A 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8814A 0x06FC -+ -+/* Hardware Port 2 */ -+#define REG_MACID1_8814A 0x0700 -+#define REG_BSSID1_8814A 0x0708 -+/* Hardware Port 3 */ -+#define REG_MACID2_8814A 0x1620 -+#define REG_BSSID2_8814A 0x1628 -+/* Hardware Port 4 */ -+#define REG_MACID3_8814A 0x1630 -+#define REG_BSSID3_8814A 0x1638 -+/* Hardware Port 5 */ -+#define REG_MACID4_8814A 0x1640 -+#define REG_BSSID4_8814A 0x1648 -+ -+#define REG_ASSOCIATED_BFMEE_SEL_8814A 0x0714 -+#define REG_SND_PTCL_CTRL_8814A 0x0718 -+#define REG_IQ_DUMP_8814A 0x07C0 -+ -+/**** page 19 ****/ -+/* TX BeamForming */ -+#define REG_BB_TXBF_ANT_SET_BF1 0x19ac -+#define REG_BB_TXBF_ANT_SET_BF0 0x19b4 -+ -+/* 0x1200h ~ 0x12FFh DDMA CTRL -+ * -+ * ----------------------------------------------------- */ -+#define REG_DDMA_CH0SA 0x1200 -+#define REG_DDMA_CH0DA 0x1204 -+#define REG_DDMA_CH0CTRL 0x1208 -+#define REG_DDMA_CH1SA 0x1210 -+#define REG_DDMA_CH1DA 0x1214 -+#define REG_DDMA_CH1CTRL 0x1218 -+#define REG_DDMA_CH2SA 0x1220 -+#define REG_DDMA_CH2DA 0x1224 -+#define REG_DDMA_CH2CTRL 0x1228 -+#define REG_DDMA_CH3SA 0x1230 -+#define REG_DDMA_CH3DA 0x1234 -+#define REG_DDMA_CH3CTRL 0x1238 -+#define REG_DDMA_CH4SA 0x1240 -+#define REG_DDMA_CH4DA 0x1244 -+#define REG_DDMA_CH4CTRL 0x1248 -+#define REG_DDMA_CH5SA 0x1250 -+#define REG_DDMA_CH5DA 0x1254 -+#define REG_DDMA_CH5CTRL 0x1258 -+#define REG_DDMA_INT_MSK 0x12E0 -+#define REG_DDMA_CHSTATUS 0x12E8 -+#define REG_DDMA_CHKSUM 0x12F0 -+#define REG_DDMA_MONITER 0x12FC -+ -+#define DDMA_LEN_MASK 0x0001FFFF -+#define FW_CHKSUM_DUMMY_SZ 8 -+#define DDMA_CH_CHKSUM_CNT BIT(24) -+#define DDMA_RST_CHKSUM_STS BIT(25) -+#define DDMA_MODE_BLOCK_CPU BIT(26) -+#define DDMA_CHKSUM_FAIL BIT(27) -+#define DDMA_DA_W_DISABLE BIT(28) -+#define DDMA_CHKSUM_EN BIT(29) -+#define DDMA_CH_OWN BIT(31) -+ -+ -+/* 3081 FWDL */ -+#define FWDL_EN BIT0 -+#define IMEM_BOOT_DL_RDY BIT1 -+#define IMEM_BOOT_CHKSUM_FAIL BIT2 -+#define IMEM_DL_RDY BIT3 -+#define IMEM_CHKSUM_OK BIT4 -+#define DMEM_DL_RDY BIT5 -+#define DMEM_CHKSUM_OK BIT6 -+#define EMEM_DL_RDY BIT7 -+#define EMEM_CHKSUM_FAIL BIT8 -+#define EMEM_TXBUF_DL_RDY BIT9 -+#define EMEM_TXBUF_CHKSUM_FAIL BIT10 -+#define CPU_CLK_SWITCH_BUSY BIT11 -+#define CPU_CLK_SEL (BIT12 | BIT13) -+#define FWDL_OK BIT14 -+#define FW_INIT_RDY BIT15 -+#define R_EN_BOOT_FLASH BIT20 -+ -+#define OCPBASE_IMEM_3081 0x00000000 -+#define OCPBASE_DMEM_3081 0x00200000 -+#define OCPBASE_RPTBUF_3081 0x18660000 -+#define OCPBASE_RXBUF2_3081 0x18680000 -+#define OCPBASE_RXBUF_3081 0x18700000 -+#define OCPBASE_TXBUF_3081 0x18780000 -+ -+ -+#define REG_FAST_EDCA_VOVI_SETTING_8814A 0x1448 -+#define REG_FAST_EDCA_BEBK_SETTING_8814A 0x144C -+ -+ -+/* ----------------------------------------------------- -+ * */ -+ -+ -+/* ----------------------------------------------------- -+ * -+ * Redifine 8192C register definition for compatibility -+ * -+ * ----------------------------------------------------- */ -+ -+/* TODO: use these definition when using REG_xxx naming rule. -+ * NOTE: DO NOT Remove these definition. Use later. */ -+#define EFUSE_CTRL_8814A REG_EFUSE_CTRL_8814A /* E-Fuse Control. */ -+#define EFUSE_TEST_8814A REG_LDO_EFUSE_CTRL_8814A /* E-Fuse Test. */ -+#define MSR_8814A (REG_CR_8814A + 2) /* Media Status register */ -+#define ISR_8814A REG_HISR0_8814A -+#define TSFR_8814A REG_TSFTR_8814A /* Timing Sync Function Timer Register. */ -+ -+#define PBP_8814A REG_PBP_8814A -+ -+/* Redifine MACID register, to compatible prior ICs. */ -+#define IDR0_8814A REG_MACID_8814A /* MAC ID Register, Offset 0x0050-0x0053 */ -+#define IDR4_8814A (REG_MACID_8814A + 4) /* MAC ID Register, Offset 0x0054-0x0055 */ -+ -+ -+/* -+ * 9. Security Control Registers (Offset: ) -+ * */ -+#define RWCAM_8814A REG_CAMCMD_8814A /* IN 8190 Data Sheet is called CAMcmd */ -+#define WCAMI_8814A REG_CAMWRITE_8814A /* Software write CAM input content */ -+#define RCAMO_8814A REG_CAMREAD_8814A /* Software read/write CAM config */ -+#define CAMDBG_8814A REG_CAMDBG_8814A -+#define SECR_8814A REG_SECCFG_8814A /* Security Configuration Register */ -+ -+ -+/* ---------------------------------------------------------------------------- -+ * 8195 IMR/ISR bits (offset 0xB0, 8bits) -+ * ---------------------------------------------------------------------------- */ -+#define IMR_DISABLED_8814A 0 -+/* IMR DW0(0x00B0-00B3) Bit 0-31 */ -+#define IMR_TIMER2_8814A BIT31 /* Timeout interrupt 2 */ -+#define IMR_TIMER1_8814A BIT30 /* Timeout interrupt 1 */ -+#define IMR_PSTIMEOUT_8814A BIT29 /* Power Save Time Out Interrupt */ -+#define IMR_GTINT4_8814A BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -+#define IMR_GTINT3_8814A BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -+#define IMR_TXBCN0ERR_8814A BIT26 /* Transmit Beacon0 Error */ -+#define IMR_TXBCN0OK_8814A BIT25 /* Transmit Beacon0 OK */ -+#define IMR_TSF_BIT32_TOGGLE_8814A BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -+#define IMR_BCNDMAINT0_8814A BIT20 /* Beacon DMA Interrupt 0 */ -+#define IMR_BCNDERR0_8814A BIT16 /* Beacon Queue DMA OK0 */ -+#define IMR_HSISR_IND_ON_INT_8814A BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -+#define IMR_BCNDMAINT_E_8814A BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -+#define IMR_ATIMEND_8814A BIT12 /* CTWidnow End or ATIM Window End */ -+#define IMR_C2HCMD_8814A BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -+#define IMR_CPWM2_8814A BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_CPWM_8814A BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -+#define IMR_HIGHDOK_8814A BIT7 /* High Queue DMA OK */ -+#define IMR_MGNTDOK_8814A BIT6 /* Management Queue DMA OK */ -+#define IMR_BKDOK_8814A BIT5 /* AC_BK DMA OK */ -+#define IMR_BEDOK_8814A BIT4 /* AC_BE DMA OK */ -+#define IMR_VIDOK_8814A BIT3 /* AC_VI DMA OK */ -+#define IMR_VODOK_8814A BIT2 /* AC_VO DMA OK */ -+#define IMR_RDU_8814A BIT1 /* Rx Descriptor Unavailable */ -+#define IMR_ROK_8814A BIT0 /* Receive DMA OK */ -+ -+/* IMR DW1(0x00B4-00B7) Bit 0-31 */ -+#define IMR_MCUERR_8814A BIT28 /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT7_8814A BIT27 /* Beacon DMA Interrupt 7 */ -+#define IMR_BCNDMAINT6_8814A BIT26 /* Beacon DMA Interrupt 6 */ -+#define IMR_BCNDMAINT5_8814A BIT25 /* Beacon DMA Interrupt 5 */ -+#define IMR_BCNDMAINT4_8814A BIT24 /* Beacon DMA Interrupt 4 */ -+#define IMR_BCNDMAINT3_8814A BIT23 /* Beacon DMA Interrupt 3 */ -+#define IMR_BCNDMAINT2_8814A BIT22 /* Beacon DMA Interrupt 2 */ -+#define IMR_BCNDMAINT1_8814A BIT21 /* Beacon DMA Interrupt 1 */ -+#define IMR_BCNDOK7_8814A BIT20 /* Beacon Queue DMA OK Interrup 7 */ -+#define IMR_BCNDOK6_8814A BIT19 /* Beacon Queue DMA OK Interrup 6 */ -+#define IMR_BCNDOK5_8814A BIT18 /* Beacon Queue DMA OK Interrup 5 */ -+#define IMR_BCNDOK4_8814A BIT17 /* Beacon Queue DMA OK Interrup 4 */ -+#define IMR_BCNDOK3_8814A BIT16 /* Beacon Queue DMA OK Interrup 3 */ -+#define IMR_BCNDOK2_8814A BIT15 /* Beacon Queue DMA OK Interrup 2 */ -+#define IMR_BCNDOK1_8814A BIT14 /* Beacon Queue DMA OK Interrup 1 */ -+#define IMR_ATIMEND_E_8814A BIT13 /* ATIM Window End Extension for Win7 */ -+#define IMR_TXERR_8814A BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -+#define IMR_RXERR_8814A BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -+#define IMR_TXFOVW_8814A BIT9 /* Transmit FIFO Overflow */ -+#define IMR_RXFOVW_8814A BIT8 /* Receive FIFO Overflow */ -+ -+ -+#ifdef CONFIG_PCI_HCI -+ #define IMR_TX_MASK (IMR_VODOK_8814A | IMR_VIDOK_8814A | IMR_BEDOK_8814A | IMR_BKDOK_8814A | IMR_MGNTDOK_8814A | IMR_HIGHDOK_8814A) -+ -+ #define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8814A | IMR_TXBCN0OK_8814A | IMR_TXBCN0ERR_8814A | IMR_BCNDERR0_8814A) -+ -+ #define RT_AC_INT_MASKS (IMR_VIDOK_8814A | IMR_VODOK_8814A | IMR_BEDOK_8814A | IMR_BKDOK_8814A) -+#endif -+ -+ -+/*=================================================================== -+===================================================================== -+Here the register defines are for 92C. When the define is as same with 92C, -+we will use the 92C's define for the consistency -+So the following defines for 92C is not entire!!!!!! -+===================================================================== -+=====================================================================*/ -+ -+ -+/* ----------------------------------------------------- -+ * -+ * 0xFE00h ~ 0xFE55h USB Configuration -+ * -+ * ----------------------------------------------------- */ -+ -+/* 2 Special Option */ -+#define USB_AGG_EN_8814A BIT(7) -+#define REG_USB_HRPWM_U3 0xF052 -+ -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8814A (2048-1) /* 20130415 KaiYuan add for 8814 */ -+ -+#define MACID_NUM_8814A 128 -+#define SEC_CAM_ENT_NUM_8814A 64 -+#define HW_PORT_NUM_8814A 5 -+#define NSS_NUM_8814A 3 -+#define BAND_CAP_8814A (BAND_CAP_2G | BAND_CAP_5G) -+#define BW_CAP_8814A (BW_CAP_20M | BW_CAP_40M | BW_CAP_80M) -+#define PROTO_CAP_8814A (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N | PROTO_CAP_11AC) -+ -+#endif /* __RTL8814A_SPEC_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_sreset.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_sreset.h 2018-02-11 21:44:27.170146436 +0200 -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL88814A_SRESET_H_ -+#define _RTL8814A_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ extern void rtl8814_sreset_xmit_status_check(_adapter *padapter); -+ extern void rtl8814_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_xmit.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8814a_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8814a_xmit.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,310 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8814A_XMIT_H__ -+#define __RTL8814A_XMIT_H__ -+ -+typedef struct txdescriptor_8814 { -+ /* Offset 0 */ -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 ls:1; -+} TXDESC_8814, *PTXDESC_8814; -+ -+ -+#define OFFSET_SZ 0 -+#define OFFSET_SHT 16 -+ -+ -+ -+#ifdef CONFIG_SDIO_HCI -+ #define SET_TX_DESC_SDIO_TXSEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) -+#endif /* CONFIG_SDIO_HCI */ -+ -+/* ----------------------------------------------------------------- -+ * RTL8814A TX BUFFER DESC -+ * ----------------------------------------------------------------- -+ * -+- Each TXBD has 4 segment. -+ -- For 32 bit, each segment is 8 bytes. -+ -- For 64 bit, each segment is 16 bytes. -+*/ -+#if 0 -+ #if 1 /* 32 bit */ -+ #define SET_TX_EXTBUFF_DESC_LEN_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*8), 0, 16, __Value) -+ #define SET_TX_EXTBUFF_DESC_ADDR_LOW_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*8)+4, 0, 32, __Value) -+ #else /* 64 bit */ -+ #define SET_TX_EXTBUFF_DESC_LEN_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*16), 0, 16, __Value) -+ #define SET_TX_EXTBUFF_DESC_ADDR_LOW_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*16)+4, 0, 32, __Value) -+ #endif -+ #define SET_TX_EXTBUFF_DESC_ADDR_HIGH_8814A(__pTxDesc, __Value, __Set) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Set*16)+8, 0, 32, __Value) -+#endif -+/*c2h-DWORD 2*/ -+#define GET_RX_STATUS_DESC_RPT_SEL_8814A(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+8, 28, 1) -+ -+/* ********************************************************* -+ * for Txfilldescroptor8814Ae, fill the desc content. */ -+#if 1 /* 32 bit */ -+ #define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*8), 0, 16, __Valeu) -+ #define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*8), 31, 1, __Valeu) -+ #define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*8)+4, 0, 32, __Valeu) -+#else /* 64 bit */ -+ #define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 0, 16, __Valeu) -+ #define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 31, 1, __Valeu) -+ #define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+4, 0, 32, __Valeu) -+#endif -+#define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+8, 0, 32, __Valeu) -+ -+/* ********************************************************* */ -+ -+/* TX buffer -+ * ************* -+ * Dword 0 */ -+#define SET_TX_BUFF_DESC_LEN_0_8814A(__pTxDesc, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Valeu) -+#define SET_TX_BUFF_DESC_PSB_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 15, __Value) -+#define SET_TX_BUFF_DESC_OWN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+#define GET_TX_BUFF_DESC_OWN_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+ -+/* Dword 1 */ -+#define SET_TX_BUFF_DESC_ADDR_LOW_0_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 32, __Value) -+#define GET_TX_BUFF_DESC_ADDR_LOW_0_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+4, 0, 32) -+/* Dword 2 */ -+#define SET_TX_BUFF_DESC_ADDR_HIGH_0_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 32, __Value) -+#define GET_TX_BUFF_DESC_ADDR_HIGH_0_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 0, 32) -+/* Dword 3 */ /* RESERVED 0 */ -+ -+#if 0 /* 64 bit */ -+ /* Dword 4 */ -+ #define SET_TX_BUFF_DESC_LEN_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 16, __Value) -+ #define SET_TX_BUFF_DESC_AMSDU_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 31, 1, __Value) -+ /* Dword 5 */ -+ #define SET_TX_BUFF_DESC_ADDR_LOW_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 32, __Value) -+ /* Dword 6 */ -+ #define SET_TX_BUFF_DESC_ADDR_HIGH_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 32, __Value) -+ /* Dword 7 */ /* RESERVED 0 */ -+ /* Dword 8 */ -+ #define SET_TX_BUFF_DESC_LEN_2_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 16, __Value) -+ #define SET_TX_BUFF_DESC_AMSDU_2_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 31, 1, __Value) -+ /* Dword 9 */ -+ #define SET_TX_BUFF_DESC_ADDR_LOW_2_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 32, __Value) -+ /* Dword 10 */ -+ #define SET_TX_BUFF_DESC_ADDR_HIGH_2_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) -+ /* Dword 11 */ /* RESERVED 0 */ -+ /* Dword 12 */ -+ #define SET_TX_BUFF_DESC_LEN_3_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 16, __Value) -+ #define SET_TX_BUFF_DESC_AMSDU_3_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 31, 1, __Value) -+ /* Dword 13 */ -+ #define SET_TX_BUFF_DESC_ADDR_LOW_3_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+52, 0, 32, __Value) -+ /* Dword 14 */ -+ #define SET_TX_BUFF_DESC_ADDR_HIGH_3_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+56, 0, 32, __Value) -+ /* Dword 15 */ /* RESERVED 0 */ -+#endif -+ -+/* *****Desc content -+ * TX Info -+ * ************* -+ * Dword 0 */ -+#define SET_TX_DESC_PKT_SIZE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define GET_TX_DESC_PKT_SIZE_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 0, 16) -+#define SET_TX_DESC_OFFSET_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define GET_TX_DESC_OFFSET_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 16, 8) -+#define SET_TX_DESC_BMC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_LAST_SEG_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+#define SET_TX_DESC_LINIP_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+#define SET_TX_DESC_AMSDU_PAD_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+#define SET_TX_DESC_DISQSELSEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+/* Dword 1 */ -+#define SET_TX_DESC_MACID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+#define SET_TX_DESC_MORE_DATA_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 29, 1, __Value) -+#define SET_TX_DESC_TXOP_PS_CAP_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 30, 1, __Value) -+#define SET_TX_DESC_TXOP_PS_MODE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 31, 1, __Value) -+ -+ -+/* Dword 2 */ -+#define SET_TX_DESC_PAID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_NULL_0_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 14, 1, __Value) -+#define SET_TX_DESC_NULL_1_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 15, 1, __Value) -+#define SET_TX_DESC_BK_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define GET_TX_DESC_MORE_FRAG_8814A(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 17, 1) -+#define SET_TX_DESC_RAW_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_SPE_RPT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_NULL_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_GID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+#define SET_TX_DESC_HW_AES_IV_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 31, 1, __Value) -+ -+ -+/* Dword 3 */ -+#define SET_TX_DESC_WHEADER_LEN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 5, __Value) -+#define SET_TX_DESC_EARLY_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HW_SSN_SEL_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_CHECK_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+/* Dword 4 */ -+#define SET_TX_DESC_TX_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_TRY_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 7, 1, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+#define SET_TX_DESC_PCTS_ENABLE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 29, 1, __Value) -+#define SET_TX_DESC_PCTS_MASK_IDX_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 30, 2, __Value) -+ -+ -+/* Dword 5 */ -+#define SET_TX_DESC_DATA_SC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_CTROL_STBC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+#define SET_TX_DESC_SIGNALING_TA_PKT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 17, 1, __Value) -+#define SET_TX_DESC_PORT_ID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 21, 3, __Value)/* 20130415 KaiYuan add for 8814 */ -+#define SET_TX_DESC_TX_ANT_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 4, __Value) -+#define SET_TX_DESC_TX_POWER_OFFSET_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 28, 3, __Value) -+ -+/* Dword 6 */ -+#define SET_TX_DESC_SW_DEFINE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) -+#define SET_TX_DESC_MBSSID_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+#define SET_TX_DESC_ANTSEL_A_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) -+#define SET_TX_DESC_ANTSEL_B_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 19, 3, __Value) -+#define SET_TX_DESC_ANT_MAPA_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 22, 2, __Value) -+#define SET_TX_DESC_ANT_MAPB_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 24, 2, __Value) -+#define SET_TX_DESC_ANT_MAPC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 26, 2, __Value) -+#define SET_TX_DESC_ANT_MAPD_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 28, 2, __Value) -+ -+ -+/* Dword 7 */ -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ #define SET_TX_DESC_TX_BUFFER_SIZE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#else -+ #define SET_TX_DESC_TX_DESC_CHECKSUM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#endif -+#define SET_TX_DESC_NTX_MAP_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 20, 4, __Value) -+#define SET_TX_DESC_USB_TXAGG_NUM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+ -+ -+/* Dword 8 */ -+#define SET_TX_DESC_RTS_RC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 6, __Value) -+#define SET_TX_DESC_BAR_RTY_TH_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 6, 2, __Value) -+#define SET_TX_DESC_DATA_RC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) -+#define SET_TX_DESC_EN_HWEXSEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 14, 1, __Value) -+#define SET_TX_DESC_HWSEQ_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+#if (DEV_BUS_TYPE != RT_SDIO_INTERFACE) -+ #define SET_TX_DESC_NEXT_HEAD_PAGE_L_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) -+#else -+ #define SET_TX_DESC_SDIO_SEQ_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) /* 20130415 KaiYuan add for 8814AS */ -+#endif -+#define SET_TX_DESC_TAIL_PAGE_L_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) -+ -+/* Dword 9 */ -+#define SET_TX_DESC_PADDING_LENGTH_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 11, __Value) -+#define SET_TX_DESC_TXBF_PATH_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 11, 1, __Value) -+#define SET_TX_DESC_SEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+#define SET_TX_DESC_NEXT_HEAD_PAGE_H_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 24, 4, __Value) -+#define SET_TX_DESC_TAIL_PAGE_H_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 28, 4, __Value) -+ -+ -+ -+#define SET_EARLYMODE_PKTNUM_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8814A(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+ -+void rtl8814a_cal_txdesc_chksum(u8 *ptxdesc); -+void rtl8814a_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); -+void rtl8814a_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void rtl8814a_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); -+void rtl8814a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); -+#if defined(CONFIG_CONCURRENT_MODE) -+ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ s32 rtl8814au_init_xmit_priv(PADAPTER padapter); -+ void rtl8814au_free_xmit_priv(PADAPTER padapter); -+ s32 rtl8814au_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8814au_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8814au_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8814au_xmit_buf_handler(PADAPTER padapter); -+ void rtl8814au_xmit_tasklet(void *priv); -+ s32 rtl8814au_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif /* CONFIG_USB_HCI */ -+ -+#ifdef CONFIG_PCI_HCI -+ s32 rtl8814ae_init_xmit_priv(PADAPTER padapter); -+ void rtl8814ae_free_xmit_priv(PADAPTER padapter); -+ struct xmit_buf *rtl8814ae_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+ void rtl8814ae_xmitframe_resume(_adapter *padapter); -+ s32 rtl8814ae_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+ s32 rtl8814ae_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+ s32 rtl8814ae_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+ void rtl8814ae_xmit_tasklet(void *priv); -+#endif -+ -+void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, u8 *ptxdesc); -+u8 -+SCMapping_8814( -+ IN PADAPTER Adapter, -+ IN struct pkt_attrib *pattrib -+); -+ -+u8 -+BWMapping_8814( -+ IN PADAPTER Adapter, -+ IN struct pkt_attrib *pattrib -+); -+ -+ -+#endif /* __RTL8814_XMIT_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8821a_spec.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821a_spec.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8821a_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821a_spec.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,108 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#ifndef __RTL8821A_SPEC_H__ -+#define __RTL8821A_SPEC_H__ -+ -+#include -+/* This file should based on "hal_com_reg.h" */ -+#include -+/* Because 8812a and 8821a is the same serial, -+ * most of 8821a register definitions are the same as 8812a. */ -+#include -+ -+ -+/* ************************************************************ -+ * 8821A Regsiter offset definition -+ * ************************************************************ */ -+ -+/* ************************************************************ -+ * MAC register -+ * ************************************************************ */ -+ -+/* ----------------------------------------------------- -+ * 0x0000h ~ 0x00FFh System Configuration -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * 0x0100h ~ 0x01FFh MACTOP General Configuration -+ * ----------------------------------------------------- */ -+#define REG_WOWLAN_WAKE_REASON REG_MCUTST_WOWLAN -+ -+/* ----------------------------------------------------- -+ * 0x0200h ~ 0x027Fh TXDMA Configuration -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * 0x0280h ~ 0x02FFh RXDMA Configuration -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * 0x0300h ~ 0x03FFh PCIe -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * 0x0400h ~ 0x047Fh Protocol Configuration -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * 0x0500h ~ 0x05FFh EDCA Configuration -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * 0x0600h ~ 0x07FFh WMAC Configuration -+ * ----------------------------------------------------- */ -+ -+ -+/* ************************************************************ -+ * SDIO Bus Specification -+ * ************************************************************ */ -+ -+/* ----------------------------------------------------- -+ * SDIO CMD Address Mapping -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * I/O bus domain (Host) -+ * ----------------------------------------------------- */ -+ -+/* ----------------------------------------------------- -+ * SDIO register -+ * ----------------------------------------------------- */ -+#undef SDIO_REG_HCPWM1 -+#define SDIO_REG_FREE_TXPG2 0x024 -+#define SDIO_REG_HCPWM1 0x025 -+ -+ -+/* ************************************************************ -+ * Regsiter Bit and Content definition -+ * ************************************************************ */ -+ -+/* ******************************************************** -+ * General definitions -+ * ******************************************************** */ -+ -+#define MACID_NUM_8821A 128 -+#define SEC_CAM_ENT_NUM_8821A 64 -+#define HW_PORT_NUM_8821A 2 -+#define NSS_NUM_8821A 1 -+#define BAND_CAP_8821A (BAND_CAP_2G | BAND_CAP_5G) -+#define BW_CAP_8821A (BW_CAP_20M | BW_CAP_40M | BW_CAP_80M) -+#define PROTO_CAP_8821A (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N | PROTO_CAP_11AC) -+ -+#endif /* __RTL8821A_SPEC_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8821a_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821a_xmit.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8821a_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821a_xmit.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,178 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTL8821A_XMIT_H__ -+#define __RTL8821A_XMIT_H__ -+ -+#include -+ -+typedef struct txdescriptor_8821a { -+ /* Offset 0 */ -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 rsvd0026:1; -+ u32 rsvd0027:1; -+ u32 linip:1; -+ u32 noacm:1; -+ u32 gf:1; -+ u32 rsvd0031:1; -+ -+ /* Offset 4 */ -+ u32 macid:7; -+ u32 rsvd0407:1; -+ u32 qsel:5; -+ u32 rdg_nav_ext:1; -+ u32 lsig_txop_en:1; -+ u32 pifs:1; -+ u32 rate_id:5; -+ u32 en_desc_id:1; -+ u32 sectype:2; -+ u32 pkt_offset:5; /* unit: 8 bytes */ -+ u32 moredata:1; -+ u32 txop_ps_cap:1; -+ u32 txop_ps_mode:1; -+ -+ /* Offset 8 */ -+ u32 p_aid:9; -+ u32 rsvd0809:1; -+ u32 cca_rts:2; -+ u32 agg_en:1; -+ u32 rdg_en:1; -+ u32 null_0:1; -+ u32 null_1:1; -+ u32 bk:1; -+ u32 morefrag:1; -+ u32 raw:1; -+ u32 spe_rpt:1; -+ u32 ampdu_density:3; -+ u32 bt_null:1; -+ u32 g_id:6; -+ u32 rsvd0830:2; -+ -+ /* Offset 12 */ -+ u32 wheader_len:4; -+ u32 chk_en:1; -+ u32 early_rate:1; -+ u32 hw_ssn_sel:2; -+ u32 userate:1; -+ u32 disrtsfb:1; -+ u32 disdatafb:1; -+ u32 cts2self:1; -+ u32 rtsen:1; -+ u32 hw_rts_en:1; -+ u32 port_id:1; -+ u32 navusehdr:1; -+ u32 use_max_len:1; -+ u32 max_agg_num:5; -+ u32 ndpa:2; -+ u32 ampdu_max_time:8; -+ -+ /* Offset 16 */ -+ u32 datarate:7; -+ u32 try_rate:1; -+ u32 data_ratefb_lmt:5; -+ u32 rts_ratefb_lmt:4; -+ u32 rty_lmt_en:1; -+ u32 data_rt_lmt:6; -+ u32 rtsrate:5; -+ u32 pcts_en:1; -+ u32 pcts_mask_idx:2; -+ -+ /* Offset 20 */ -+ u32 data_sc:4; -+ u32 data_short:1; -+ u32 data_bw:2; -+ u32 data_ldpc:1; -+ u32 data_stbc:2; -+ u32 vcs_stbc:2; -+ u32 rts_short:1; -+ u32 rts_sc:4; -+ u32 rsvd2016:7; -+ u32 tx_ant:4; -+ u32 txpwr_offset:3; -+ u32 rsvd2031:1; -+ -+ /* Offset 24 */ -+ u32 sw_define:12; -+ u32 mbssid:4; -+ u32 antsel_A:3; -+ u32 antsel_B:3; -+ u32 antsel_C:3; -+ u32 antsel_D:3; -+ u32 rsvd2428:4; -+ -+ /* Offset 28 */ -+ u32 checksum:16; -+ u32 rsvd2816:8; -+ u32 usb_txagg_num:8; -+ -+ /* Offset 32 */ -+ u32 rts_rc:6; -+ u32 bar_rty_th:2; -+ u32 data_rc:6; -+ u32 rsvd3214:1; -+ u32 en_hwseq:1; -+ u32 nextneadpage:8; -+ u32 tailpage:8; -+ -+ /* Offset 36 */ -+ u32 padding_len:11; -+ u32 txbf_path:1; -+ u32 seq:12; -+ u32 final_data_rate:8; -+} TXDESC_8821A, *PTXDESC_8821A; -+ -+#ifdef CONFIG_SDIO_HCI -+s32 InitXmitPriv8821AS(PADAPTER padapter); -+void FreeXmitPriv8821AS(PADAPTER padapter); -+s32 XmitBufHandler8821AS(PADAPTER padapter); -+s32 MgntXmit8821AS(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 HalXmitNoLock8821AS(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 HalXmit8821AS(PADAPTER padapter, struct xmit_frame *pxmitframe); -+#ifndef CONFIG_SDIO_TX_TASKLET -+thread_return XmitThread8821AS(thread_context context); -+#endif /* !CONFIG_SDIO_TX_TASKLET */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+#if 0 -+#ifdef CONFIG_USB_HCI -+s32 rtl8821au_init_xmit_priv(PADAPTER padapter); -+void rtl8821au_free_xmit_priv(PADAPTER padapter); -+s32 rtl8821au_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8821au_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8821au_hal_xmitframe_enqueue(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8821au_xmit_buf_handler(PADAPTER padapter); -+void rtl8821au_xmit_tasklet(void *priv); -+s32 rtl8821au_xmitframe_complete(PADAPTER padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+#endif /* CONFIG_USB_HCI */ -+ -+#ifdef CONFIG_PCI_HCI -+s32 rtl8821e_init_xmit_priv(PADAPTER padapter); -+void rtl8821e_free_xmit_priv(PADAPTER padapter); -+struct xmit_buf *rtl8821e_dequeue_xmitbuf(struct rtw_tx_ring *ring); -+void rtl8821e_xmitframe_resume(PADAPTER padapter); -+s32 rtl8821e_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8821e_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+void rtl8821e_xmit_tasklet(void *priv); -+#endif /* CONFIG_PCI_HCI */ -+#endif -+ -+#endif /* __RTL8821_XMIT_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8821c_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821c_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8821c_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821c_hal.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,68 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8821C_HAL_H_ -+#define _RTL8821C_HAL_H_ -+ -+#include /* BIT(x) */ -+#include "../hal/halmac/halmac_api.h" /* MAC REG definition */ -+#include "hal_data.h" -+ -+#if defined(CONFIG_USB_HCI) -+ -+ #ifndef MAX_RECVBUF_SZ -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #ifdef CONFIG_PLATFORM_MSTAR -+ #define MAX_RECVBUF_SZ (8192) /* 8K */ -+ #else -+ /* 8821C - RX FIFO :16K ,for RX agg DMA mode = 16K, Rx agg USB mode could large than 16k*/ -+ #define MAX_RECVBUF_SZ HALMAC_RX_FIFO_SIZE_8821C -+ #endif -+ /*#define MAX_RECVBUF_SZ_8821C (24576)*/ /* 24k*/ -+ /*#define MAX_RECVBUF_SZ_8821C (20480)*/ /*20K*/ -+ /*#define MAX_RECVBUF_SZ_8821C (10240) */ /*10K*/ -+ /*#define MAX_RECVBUF_SZ_8821C (15360)*/ /*15k < 16k*/ -+ /*#define MAX_RECVBUF_SZ_8821C (8192+1024)*/ /* 8K+1k*/ -+ #else -+ #define MAX_RECVBUF_SZ (4096) /* about 4K */ -+ #endif -+ #endif/* !MAX_RECVBUF_SZ*/ -+ -+#elif defined(CONFIG_PCI_HCI) -+ /*#ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #define MAX_RECVBUF_SZ (9100) -+ #else*/ -+ #define MAX_RECVBUF_SZ (4096) /* about 4K */ -+ /*#endif*/ -+ -+#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ -+ #define MAX_RECVBUF_SZ HALMAC_RX_FIFO_SIZE_8821C -+ -+#endif -+ -+void init_hal_spec_rtl8821c(PADAPTER); -+/* MP Functions */ -+#ifdef CONFIG_MP_INCLUDED -+void rtl8821c_phy_init_haldm(PADAPTER); /* rtw_mp.c */ -+void rtl8821c_prepare_mp_txdesc(PADAPTER, struct mp_priv *); /* rtw_mp.c */ -+void rtl8821c_mp_config_rfpath(PADAPTER); /* hal_mp.c */ -+#endif -+ -+#endif /* _RTL8821C_HAL_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8821cs_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821cs_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8821cs_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821cs_hal.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8821CS_HAL_H_ -+#define _RTL8821CS_HAL_H_ -+ -+#include /* PADAPTER */ -+ -+/* rtl8821cs_ops.c */ -+u8 rtl8821cs_set_hal_ops(PADAPTER); -+ -+#endif /* _RTL8821CS_HAL_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8821cu_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821cu_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8821cu_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8821cu_hal.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8821CU_HAL_H_ -+#define _RTL8821CU_HAL_H_ -+ -+#include /* PADAPTER */ -+ -+/* rtl8821cu_ops.c */ -+u8 rtl8821cu_set_hal_ops(PADAPTER); -+void rtl8821cu_set_hw_type(struct dvobj_priv *pdvobj); -+ -+#endif /* _RTL8821CU_HAL_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8822be_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822be_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8822be_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822be_hal.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8822BE_HAL_H_ -+#define _RTL8822BE_HAL_H_ -+ -+#include /* PADAPTER */ -+ -+#define RT_BCN_INT_MASKS (BIT20 | BIT25 | BIT26 | BIT16) -+ -+/* rtl8822be_ops.c */ -+void UpdateInterruptMask8822BE(PADAPTER, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); -+ -+#endif /* _RTL8822BE_HAL_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8822b_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822b_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8822b_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822b_hal.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,216 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8822B_HAL_H_ -+#define _RTL8822B_HAL_H_ -+ -+#include /* BIT(x) */ -+#include /* PADAPTER */ -+#include "../hal/halmac/halmac_api.h" /* MAC REG definition */ -+ -+ -+#define MAX_RECVBUF_SZ HALMAC_RX_FIFO_SIZE_8822B -+ -+/* -+ * MAC Register definition -+ */ -+#define REG_AFE_XTAL_CTRL REG_AFE_CTRL1_8822B /* hal_com.c & phydm */ -+#define REG_AFE_PLL_CTRL REG_AFE_CTRL2_8822B /* hal_com.c & phydm */ -+#define REG_MAC_PHY_CTRL REG_AFE_CTRL3_8822B /* phydm only */ -+#define REG_LEDCFG0 REG_LED_CFG_8822B /* rtw_mp.c */ -+#define MSR (REG_CR_8822B + 2) /* rtw_mp.c & hal_com.c */ -+#define MSR1 REG_CR_EXT_8822B /* rtw_mp.c & hal_com.c */ -+#define REG_C2HEVT_MSG_NORMAL 0x1A0 /* hal_com.c */ -+#define REG_C2HEVT_CLEAR 0x1AF /* hal_com.c */ -+#define REG_BCN_CTRL_1 REG_BCN_CTRL_CLINT0_8822B /* hal_com.c */ -+#define REG_TSFTR1 REG_FREERUN_CNT_8822B /* hal_com.c */ -+#define REG_RXFLTMAP2 REG_RXFLTMAP_8822B /* rtw_mp.c */ -+ -+/* RXERR_RPT, for rtw_mp.c */ -+#define RXERR_TYPE_OFDM_PPDU 0 -+#define RXERR_TYPE_OFDM_FALSE_ALARM 2 -+#define RXERR_TYPE_OFDM_MPDU_OK 0 -+#define RXERR_TYPE_OFDM_MPDU_FAIL 1 -+#define RXERR_TYPE_CCK_PPDU 3 -+#define RXERR_TYPE_CCK_FALSE_ALARM 5 -+#define RXERR_TYPE_CCK_MPDU_OK 3 -+#define RXERR_TYPE_CCK_MPDU_FAIL 4 -+#define RXERR_TYPE_HT_PPDU 8 -+#define RXERR_TYPE_HT_FALSE_ALARM 9 -+#define RXERR_TYPE_HT_MPDU_TOTAL 6 -+#define RXERR_TYPE_HT_MPDU_OK 6 -+#define RXERR_TYPE_HT_MPDU_FAIL 7 -+#define RXERR_TYPE_RX_FULL_DROP 10 -+ -+#define RXERR_COUNTER_MASK BIT_MASK_RPT_COUNTER_8822B -+#define RXERR_RPT_RST BIT_RXERR_RPT_RST_8822B -+#define _RXERR_RPT_SEL(type) (BIT_RXERR_RPT_SEL_V1_3_0_8822B(type) \ -+ | ((type & 0x10) ? BIT_RXERR_RPT_SEL_V1_4_8822B : 0)) -+ -+/* -+ * BB Register definition -+ */ -+#define rPMAC_Reset 0x100 /* hal_mp.c */ -+ -+#define rFPGA0_RFMOD 0x800 -+#define rFPGA0_TxInfo 0x804 -+#define rOFDMCCKEN_Jaguar 0x808 /* hal_mp.c */ -+#define rFPGA0_TxGainStage 0x80C /* phydm only */ -+#define rFPGA0_XA_HSSIParameter1 0x820 /* hal_mp.c */ -+#define rFPGA0_XA_HSSIParameter2 0x824 /* hal_mp.c */ -+#define rFPGA0_XB_HSSIParameter1 0x828 /* hal_mp.c */ -+#define rFPGA0_XB_HSSIParameter2 0x82C /* hal_mp.c */ -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rCCAonSec_Jaguar 0x838 /* hal_mp.c */ -+#define rTxAGC_B_Mcs03_Mcs00 0x83C -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84C -+#define rFPGA0_XA_RFInterfaceOE 0x860 -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86C -+#define rFPGA0_XAB_RFInterfaceSW 0x870 -+#define rFPGA0_XAB_RFParameter 0x878 -+#define rFPGA0_AnalogParameter4 0x88C /* hal_mp.c & phydm */ -+#define rFPGA0_XB_LSSIReadBack 0x8A4 /* phydm */ -+#define rHSSIRead_Jaguar 0x8B0 /* RF read addr (rtl8822b_phy.c) */ -+ -+#define rC_TxScale_Jaguar2 0x181C /* Pah_C TX scaling factor (hal_mp.c) */ -+#define rC_IGI_Jaguar2 0x1850 /* Initial Gain for path-C (hal_mp.c) */ -+ -+#define rFPGA1_TxInfo 0x90C /* hal_mp.c */ -+#define rSingleTone_ContTx_Jaguar 0x914 /* hal_mp.c */ -+/* TX BeamForming */ -+#define REG_BB_TX_PATH_SEL_1_8822B 0x93C /* rtl8822b_phy.c */ -+#define REG_BB_TX_PATH_SEL_2_8822B 0x940 /* rtl8822b_phy.c */ -+ -+/* TX BeamForming */ -+#define REG_BB_TXBF_ANT_SET_BF1_8822B 0x19AC /* rtl8822b_phy.c */ -+#define REG_BB_TXBF_ANT_SET_BF0_8822B 0x19B4 /* rtl8822b_phy.c */ -+ -+#define rCCK0_System 0xA00 -+#define rCCK0_AFESetting 0xA04 -+ -+#define rCCK0_DSPParameter2 0xA1C -+#define rCCK0_TxFilter1 0xA20 -+#define rCCK0_TxFilter2 0xA24 -+#define rCCK0_DebugPort 0xA28 -+#define rCCK0_FalseAlarmReport 0xA2C -+ -+#define rD_TxScale_Jaguar2 0x1A1C /* Path_D TX scaling factor (hal_mp.c) */ -+#define rD_IGI_Jaguar2 0x1A50 /* Initial Gain for path-D (hal_mp.c) */ -+ -+#define rOFDM0_TRxPathEnable 0xC04 -+#define rOFDM0_TRMuxPar 0xC08 -+#define rA_TxScale_Jaguar 0xC1C /* Pah_A TX scaling factor (hal_mp.c) */ -+#define rOFDM0_RxDetector1 0xC30 /* rtw_mp.c */ -+#define rOFDM0_ECCAThreshold 0xC4C /* phydm only */ -+#define rOFDM0_XAAGCCore1 0xC50 /* phydm only */ -+#define rA_IGI_Jaguar 0xC50 /* Initial Gain for path-A (hal_mp.c) */ -+#define rOFDM0_XBAGCCore1 0xC58 /* phydm only */ -+#define rOFDM0_XATxIQImbalance 0xC80 /* phydm only */ -+#define rA_LSSIWrite_Jaguar 0xC90 /* RF write addr, LSSI Parameter (rtl8822b_phy.c) */ -+#define rA_RFE_Pinmux_Jaguar 0xCB0 /* hal_mp.c */ -+ -+#define rOFDM1_LSTF 0xD00 -+#define rOFDM1_TRxPathEnable 0xD04 /* hal_mp.c */ -+#define rA_PIRead_Jaguar 0xD04 /* RF readback with PI (rtl8822b_phy.c) */ -+#define rA_SIRead_Jaguar 0xD08 /* RF readback with SI (rtl8822b_phy.c) */ -+#define rB_PIRead_Jaguar 0xD44 /* RF readback with PI (rtl8822b_phy.c) */ -+#define rB_SIRead_Jaguar 0xD48 /* RF readback with SI (rtl8822b_phy.c) */ -+ -+#define rTxAGC_A_Rate18_06 0xE00 -+#define rTxAGC_A_Rate54_24 0xE04 -+#define rTxAGC_A_CCK1_Mcs32 0xE08 -+#define rTxAGC_A_Mcs03_Mcs00 0xE10 -+#define rTxAGC_A_Mcs07_Mcs04 0xE14 -+#define rTxAGC_A_Mcs11_Mcs08 0xE18 -+#define rTxAGC_A_Mcs15_Mcs12 0xE1C -+#define rB_TxScale_Jaguar 0xE1C /* Path_B TX scaling factor (hal_mp.c) */ -+#define rB_IGI_Jaguar 0xE50 /* Initial Gain for path-B (hal_mp.c) */ -+#define rB_LSSIWrite_Jaguar 0xE90 /* RF write addr, LSSI Parameter (rtl8822b_phy.c) */ -+#define rB_RFE_Pinmux_Jaguar 0xEB0 /* hal_mp.c */ -+ -+/* Page1(0x100) */ -+#define bBBResetB 0x100 -+ -+/* Page8(0x800) */ -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+/* Reg 0x80C rFPGA0_TxGainStage */ -+#define bXBTxAGC 0xF00 -+#define bXCTxAGC 0xF000 -+#define bXDTxAGC 0xF0000 -+ -+/* PageA(0xA00) */ -+#define bCCKBBMode 0x3 -+ -+#define bCCKScramble 0x8 -+#define bCCKTxRate 0x3000 -+ -+/* General */ -+#define bMaskByte0 0xFF /* mp, rtw_odm.c & phydm */ -+#define bMaskByte1 0xFF00 /* hal_mp.c & phydm */ -+#define bMaskByte2 0xFF0000 /* hal_mp.c & phydm */ -+#define bMaskByte3 0xFF000000 /* hal_mp.c & phydm */ -+#define bMaskHWord 0xFFFF0000 /* hal_com.c, rtw_mp.c */ -+#define bMaskLWord 0x0000FFFF /* mp, hal_com.c & phydm */ -+#define bMaskDWord 0xFFFFFFFF /* mp, hal, rtw_odm.c & phydm */ -+ -+#define bEnable 0x1 /* hal_mp.c, rtw_mp.c */ -+#define bDisable 0x0 /* rtw_mp.c */ -+ -+#define MAX_STALL_TIME 50 /* unit: us, hal_com_phycfg.c */ -+ -+#define Rx_Smooth_Factor 20 /* phydm only */ -+ -+/* -+ * RF Register definition -+ */ -+#define RF_AC 0x00 -+#define RF_AC_Jaguar 0x00 /* hal_mp.c */ -+#define RF_CHNLBW 0x18 /* rtl8822b_phy.c */ -+#define RF_ModeTableAddr 0x30 /* rtl8822b_phy.c */ -+#define RF_ModeTableData0 0x31 /* rtl8822b_phy.c */ -+#define RF_ModeTableData1 0x32 /* rtl8822b_phy.c */ -+#define RF_0x52 0x52 -+#define RF_WeLut_Jaguar 0xEF /* rtl8822b_phy.c */ -+ -+/* General Functions */ -+void rtl8822b_init_hal_spec(PADAPTER); /* hal/hal_com.c */ -+ -+#ifdef CONFIG_MP_INCLUDED -+/* MP Functions */ -+#include /* struct mp_priv */ -+void rtl8822b_phy_init_haldm(PADAPTER); /* rtw_mp.c */ -+void rtl8822b_prepare_mp_txdesc(PADAPTER, struct mp_priv *); /* rtw_mp.c */ -+void rtl8822b_mp_config_rfpath(PADAPTER); /* hal_mp.c */ -+#endif -+ -+#ifdef CONFIG_USB_HCI -+#include -+#elif defined(CONFIG_SDIO_HCI) -+#include -+#elif defined(CONFIG_PCI_HCI) -+#include -+#endif -+ -+#endif /* _RTL8822B_HAL_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8822bs_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822bs_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8822bs_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822bs_hal.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,32 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8822BS_HAL_H_ -+#define _RTL8822BS_HAL_H_ -+ -+#include /* PADAPTER */ -+ -+/* rtl8822bs_ops.c */ -+void rtl8822bs_set_hal_ops(PADAPTER); -+ -+/* rtl8822bs_xmit.c */ -+s32 rtl8822bs_dequeue_writeport(PADAPTER); -+#define _dequeue_writeport(a) rtl8822bs_dequeue_writeport(a) -+ -+#endif /* _RTL8822BS_HAL_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtl8822bu_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822bu_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtl8822bu_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtl8822bu_hal.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,58 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL8822BU_HAL_H_ -+#define _RTL8822BU_HAL_H_ -+ -+#ifdef CONFIG_USB_HCI -+ #include /* PADAPTER */ -+ -+ #ifdef CONFIG_USB_HCI -+ #ifdef USB_PACKET_OFFSET_SZ -+ #define PACKET_OFFSET_SZ (USB_PACKET_OFFSET_SZ) -+ #else -+ #define PACKET_OFFSET_SZ (8) -+ #endif -+ #define TXDESC_OFFSET (TXDESC_SIZE + PACKET_OFFSET_SZ) -+ #endif -+ -+ /* recv_buffer must be large than usb agg size */ -+ #ifndef MAX_RECVBUF_SZ -+ #ifdef PLATFORM_OS_CE -+ #define MAX_RECVBUF_SZ (8192+1024) -+ #else /* !PLATFORM_OS_CE */ -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #define MAX_RECVBUF_SZ (32768) -+ #else -+ #define MAX_RECVBUF_SZ (4000) -+ #endif -+ #endif /* PLATFORM_OS_CE */ -+ #endif /* !MAX_RECVBUF_SZ */ -+ -+ /* rtl8822bu_ops.c */ -+ void rtl8822bu_set_hal_ops(PADAPTER padapter); -+ void rtl8822bu_set_hw_type(struct dvobj_priv *pdvobj); -+ -+ /* rtl8822bu_io.c */ -+ void rtl8822bu_set_intf_ops(struct _io_ops *pops); -+ -+#endif /* CONFIG_USB_HCI */ -+ -+ -+#endif /* _RTL8822BU_HAL_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_android.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_android.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_android.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_android.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,115 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __RTW_ANDROID_H__ -+#define __RTW_ANDROID_H__ -+ -+enum ANDROID_WIFI_CMD { -+ ANDROID_WIFI_CMD_START, -+ ANDROID_WIFI_CMD_STOP, -+ ANDROID_WIFI_CMD_SCAN_ACTIVE, -+ ANDROID_WIFI_CMD_SCAN_PASSIVE, -+ ANDROID_WIFI_CMD_RSSI, -+ ANDROID_WIFI_CMD_LINKSPEED, -+ ANDROID_WIFI_CMD_RXFILTER_START, -+ ANDROID_WIFI_CMD_RXFILTER_STOP, -+ ANDROID_WIFI_CMD_RXFILTER_ADD, -+ ANDROID_WIFI_CMD_RXFILTER_REMOVE, -+ ANDROID_WIFI_CMD_BTCOEXSCAN_START, -+ ANDROID_WIFI_CMD_BTCOEXSCAN_STOP, -+ ANDROID_WIFI_CMD_BTCOEXMODE, -+ ANDROID_WIFI_CMD_SETSUSPENDOPT, -+ ANDROID_WIFI_CMD_P2P_DEV_ADDR, -+ ANDROID_WIFI_CMD_SETFWPATH, -+ ANDROID_WIFI_CMD_SETBAND, -+ ANDROID_WIFI_CMD_GETBAND, -+ ANDROID_WIFI_CMD_COUNTRY, -+ ANDROID_WIFI_CMD_P2P_SET_NOA, -+ ANDROID_WIFI_CMD_P2P_GET_NOA, -+ ANDROID_WIFI_CMD_P2P_SET_PS, -+ ANDROID_WIFI_CMD_SET_AP_WPS_P2P_IE, -+ -+ ANDROID_WIFI_CMD_MIRACAST, -+ -+#ifdef CONFIG_PNO_SUPPORT -+ ANDROID_WIFI_CMD_PNOSSIDCLR_SET, -+ ANDROID_WIFI_CMD_PNOSETUP_SET, -+ ANDROID_WIFI_CMD_PNOENABLE_SET, -+ ANDROID_WIFI_CMD_PNODEBUG_SET, -+#endif -+ -+ ANDROID_WIFI_CMD_MACADDR, -+ -+ ANDROID_WIFI_CMD_BLOCK_SCAN, -+ ANDROID_WIFI_CMD_BLOCK, -+ -+ ANDROID_WIFI_CMD_WFD_ENABLE, -+ ANDROID_WIFI_CMD_WFD_DISABLE, -+ -+ ANDROID_WIFI_CMD_WFD_SET_TCPPORT, -+ ANDROID_WIFI_CMD_WFD_SET_MAX_TPUT, -+ ANDROID_WIFI_CMD_WFD_SET_DEVTYPE, -+ ANDROID_WIFI_CMD_CHANGE_DTIM, -+ ANDROID_WIFI_CMD_HOSTAPD_SET_MACADDR_ACL, -+ ANDROID_WIFI_CMD_HOSTAPD_ACL_ADD_STA, -+ ANDROID_WIFI_CMD_HOSTAPD_ACL_REMOVE_STA, -+#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 1, 0)) -+ ANDROID_WIFI_CMD_GTK_REKEY_OFFLOAD, -+#endif /* CONFIG_GTK_OL */ -+ ANDROID_WIFI_CMD_P2P_DISABLE, -+ ANDROID_WIFI_CMD_DRIVERVERSION, -+ ANDROID_WIFI_CMD_MAX -+}; -+ -+int rtw_android_cmdstr_to_num(char *cmdstr); -+int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd); -+ -+#if defined(CONFIG_PNO_SUPPORT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+int rtw_android_pno_enable(struct net_device *net, int pno_enable); -+int rtw_android_cfg80211_pno_setup(struct net_device *net, -+ struct cfg80211_ssid *ssid, int n_ssids, int interval); -+#endif -+ -+#if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) -+int rtw_android_wifictrl_func_add(void); -+void rtw_android_wifictrl_func_del(void); -+void *wl_android_prealloc(int section, unsigned long size); -+ -+int wifi_get_irq_number(unsigned long *irq_flags_ptr); -+int wifi_set_power(int on, unsigned long msec); -+int wifi_get_mac_addr(unsigned char *buf); -+void *wifi_get_country_code(char *ccode); -+#else -+static int rtw_android_wifictrl_func_add(void) -+{ -+ return 0; -+} -+static void rtw_android_wifictrl_func_del(void) {} -+#endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ -+ -+#if defined (CONFIG_GPIO_WAKEUP) || defined (CONFIG_RTW_SDIO_OOB_INT) -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+int wifi_configure_gpio(void); -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+void wifi_free_gpio(unsigned int gpio); -+#endif /* CONFIG_GPIO_WAKEUP */ -+ -+ -+#endif /* __RTW_ANDROID_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_ap.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ap.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_ap.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ap.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,90 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_AP_H_ -+#define __RTW_AP_H_ -+ -+ -+#ifdef CONFIG_AP_MODE -+ -+/* external function */ -+extern void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta); -+extern void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta); -+ -+ -+void init_mlme_ap_info(_adapter *padapter); -+void free_mlme_ap_info(_adapter *padapter); -+/* void update_BCNTIM(_adapter *padapter); */ -+void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *data, u8 len); -+void rtw_remove_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index); -+void _update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx, const char *tag); -+#define update_beacon(adapter, ie_id, oui, tx) _update_beacon((adapter), (ie_id), (oui), (tx), __func__) -+void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level); -+void expire_timeout_chk(_adapter *padapter); -+void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta); -+void rtw_start_bss_hdl_after_chbw_decided(_adapter *adapter); -+void start_bss_network(_adapter *padapter, struct createbss_parm *parm); -+int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len); -+void rtw_ap_restore_network(_adapter *padapter); -+ -+#if CONFIG_RTW_MACADDR_ACL -+void rtw_set_macaddr_acl(_adapter *adapter, int mode); -+int rtw_acl_add_sta(_adapter *adapter, const u8 *addr); -+int rtw_acl_remove_sta(_adapter *adapter, const u8 *addr); -+#endif /* CONFIG_RTW_MACADDR_ACL */ -+ -+u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta); -+int rtw_ap_set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid); -+int rtw_ap_set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx); -+ -+#ifdef CONFIG_NATIVEAP_MLME -+void associated_clients_update(_adapter *padapter, u8 updated, u32 sta_info_type); -+void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta); -+u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta); -+void sta_info_update(_adapter *padapter, struct sta_info *psta); -+void ap_sta_info_defer_update(_adapter *padapter, struct sta_info *psta); -+u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reason, bool enqueue); -+int rtw_sta_flush(_adapter *padapter, bool enqueue); -+int rtw_ap_inform_ch_switch(_adapter *padapter, u8 new_ch, u8 ch_offset); -+void start_ap_mode(_adapter *padapter); -+void stop_ap_mode(_adapter *padapter); -+#endif -+ -+void rtw_ap_update_bss_chbw(_adapter *adapter, WLAN_BSSID_EX *bss, u8 ch, u8 bw, u8 offset); -+bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offset, u8 *ch, u8 *bw, u8 *offset, u8 *chbw_allow); -+ -+#ifdef CONFIG_AUTO_AP_MODE -+extern void rtw_start_auto_ap(_adapter *adapter); -+#endif /* CONFIG_AUTO_AP_MODE */ -+ -+#endif /* end of CONFIG_AP_MODE */ -+ -+#endif -+void update_bmc_sta(_adapter *padapter); -+void rtw_process_public_act_bsscoex(_adapter *padapter, u8 *pframe, uint frame_len); -+ -+#ifdef CONFIG_80211N_HT -+void rtw_process_ht_action_smps(_adapter *padapter, u8 *ta, u8 ctrl_field); -+int rtw_ht_operation_update(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+void tx_beacon_handlder(struct dvobj_priv *pdvobj); -+void tx_beacon_timer_handlder(struct dvobj_priv *pdvobj); -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_beamforming.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_beamforming.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_beamforming.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_beamforming.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,299 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_BEAMFORMING_H_ -+#define __RTW_BEAMFORMING_H_ -+ -+#ifdef CONFIG_BEAMFORMING -+ -+#if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ -+#ifdef RTW_BEAMFORMING_VERSION_2 -+#define MAX_NUM_BEAMFORMEE_SU 2 -+#define MAX_NUM_BEAMFORMER_SU 2 -+#define MAX_NUM_BEAMFORMEE_MU 6 -+#define MAX_NUM_BEAMFORMER_MU 1 -+ -+#define MAX_BEAMFORMEE_ENTRY_NUM (MAX_NUM_BEAMFORMEE_SU + MAX_NUM_BEAMFORMEE_MU) -+#define MAX_BEAMFORMER_ENTRY_NUM (MAX_NUM_BEAMFORMER_SU + MAX_NUM_BEAMFORMER_MU) -+ -+#define GetInitSoundCnt(_SoundPeriod, _MinSoundPeriod) ((_SoundPeriod)/(_MinSoundPeriod)) -+ -+#define GET_BEAMFORM_INFO(adapter) (&GET_HAL_DATA(adapter)->beamforming_info) -+#else /* !RTW_BEAMFORMING_VERSION_2 */ -+#define BEAMFORMING_ENTRY_NUM 2 -+#define GET_BEAMFORM_INFO(_pmlmepriv) ((struct beamforming_info *)(&(_pmlmepriv)->beamforming_info)) -+#endif /* !RTW_BEAMFORMING_VERSION_2 */ -+ -+typedef enum _BEAMFORMING_ENTRY_STATE { -+ BEAMFORMING_ENTRY_STATE_UNINITIALIZE, -+ BEAMFORMING_ENTRY_STATE_INITIALIZEING, -+ BEAMFORMING_ENTRY_STATE_INITIALIZED, -+ BEAMFORMING_ENTRY_STATE_PROGRESSING, -+ BEAMFORMING_ENTRY_STATE_PROGRESSED, -+} BEAMFORMING_ENTRY_STATE, *PBEAMFORMING_ENTRY_STATE; -+ -+ -+typedef enum _BEAMFORMING_STATE { -+ BEAMFORMING_STATE_IDLE, -+ BEAMFORMING_STATE_START, -+ BEAMFORMING_STATE_END, -+} BEAMFORMING_STATE, *PBEAMFORMING_STATE; -+ -+ -+typedef enum _BEAMFORMING_CAP { -+ BEAMFORMING_CAP_NONE = 0x0, -+ BEAMFORMER_CAP_HT_EXPLICIT = 0x1, -+ BEAMFORMEE_CAP_HT_EXPLICIT = 0x2, -+ BEAMFORMER_CAP_VHT_SU = 0x4, /* Self has er Cap, because Reg er & peer ee */ -+ BEAMFORMEE_CAP_VHT_SU = 0x8, /* Self has ee Cap, because Reg ee & peer er */ -+ BEAMFORMER_CAP_VHT_MU = 0x10, /* Self has er Cap, because Reg er & peer ee */ -+ BEAMFORMEE_CAP_VHT_MU = 0x20, /* Self has ee Cap, because Reg ee & peer er */ -+ BEAMFORMER_CAP = 0x40, -+ BEAMFORMEE_CAP = 0x80, -+} BEAMFORMING_CAP, *PBEAMFORMING_CAP; -+ -+ -+typedef enum _SOUNDING_MODE { -+ SOUNDING_SW_VHT_TIMER = 0x0, -+ SOUNDING_SW_HT_TIMER = 0x1, -+ SOUNDING_STOP_All_TIMER = 0x2, -+ SOUNDING_HW_VHT_TIMER = 0x3, -+ SOUNDING_HW_HT_TIMER = 0x4, -+ SOUNDING_STOP_OID_TIMER = 0x5, -+ SOUNDING_AUTO_VHT_TIMER = 0x6, -+ SOUNDING_AUTO_HT_TIMER = 0x7, -+ SOUNDING_FW_VHT_TIMER = 0x8, -+ SOUNDING_FW_HT_TIMER = 0x9, -+} SOUNDING_MODE, *PSOUNDING_MODE; -+ -+#ifdef RTW_BEAMFORMING_VERSION_2 -+enum _BEAMFORM_ENTRY_HW_STATE { -+ BEAMFORM_ENTRY_HW_STATE_NONE, -+ BEAMFORM_ENTRY_HW_STATE_ADD_INIT, -+ BEAMFORM_ENTRY_HW_STATE_ADDING, -+ BEAMFORM_ENTRY_HW_STATE_ADDED, -+ BEAMFORM_ENTRY_HW_STATE_DELETE_INIT, -+ BEAMFORM_ENTRY_HW_STATE_DELETING, -+ BEAMFORM_ENTRY_HW_STATE_MAX -+}; -+ -+struct beamformee_entry { -+ u8 used; /* _TRUE/_FALSE */ -+ u8 txbf; -+ u8 sounding; -+ /* Used to construct AID field of NDPA packet */ -+ u16 aid; -+ /* Used to Set Reg42C in IBSS mode */ -+ u16 mac_id; -+ /* Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC */ -+ u16 p_aid; -+ u16 g_id; -+ /* Used to fill Reg6E4 to fill Mac address of CSI report frame */ -+ u8 mac_addr[ETH_ALEN]; -+ /* Sounding BandWidth */ -+ CHANNEL_WIDTH sound_bw; -+ u16 sound_period; -+ -+ BEAMFORMING_CAP cap; -+ enum _BEAMFORM_ENTRY_HW_STATE state; -+ -+ /* The BFee need to be sounded when count to zero */ -+ u8 SoundCnt; -+ u8 bCandidateSoundingPeer; -+ u8 bSoundingTimeout; -+ u8 bDeleteSounding; -+ -+ u16 LogStatusFailCnt:5; /* 0~21 */ -+ u16 DefaultCSICnt:5; /* 0~21 */ -+ u8 CSIMatrix[327]; -+ u16 CSIMatrixLen; -+ -+ u8 NumofSoundingDim; -+ u8 CompSteeringNumofBFer; -+ -+ u8 su_reg_index; -+ -+ /* MU-MIMO */ -+ u8 mu_reg_index; -+ u8 gid_valid[8]; -+ u8 user_position[16]; -+}; -+ -+struct beamformer_entry { -+ u8 used; -+ /* p_aid of BFer entry is probably not used */ -+ /* Used to fill Reg42C & Reg714 to compare with p_aid of Tx DESC */ -+ u16 p_aid; -+ u16 g_id; -+ u8 mac_addr[ETH_ALEN]; -+ -+ BEAMFORMING_CAP cap; -+ enum _BEAMFORM_ENTRY_HW_STATE state; -+ -+ u8 NumofSoundingDim; -+ u8 su_reg_index; -+ -+ /* MU-MIMO */ -+ u8 gid_valid[8]; -+ u8 user_position[16]; -+ u16 aid; -+}; -+ -+/* The sounding state is recorded by BFer. */ -+enum _SOUNDING_STATE { -+ SOUNDING_STATE_NONE = 0, -+ SOUNDING_STATE_INIT = 1, -+ SOUNDING_STATE_SU_START = 2, -+ SOUNDING_STATE_SU_SOUNDDOWN = 3, -+ SOUNDING_STATE_MU_START = 4, -+ SOUNDING_STATE_MU_SOUNDDOWN = 5, -+ SOUNDING_STATE_SOUNDING_TIMEOUT = 6, -+ SOUNDING_STATE_MAX -+}; -+ -+struct sounding_info { -+ u8 su_sounding_list[MAX_NUM_BEAMFORMEE_SU]; -+ u8 mu_sounding_list[MAX_NUM_BEAMFORMEE_MU]; -+ -+ enum _SOUNDING_STATE state; -+ u8 su_bfee_curidx; -+ u8 candidate_mu_bfee_cnt; -+ -+ /* For sounding schedule maintenance */ -+ u16 min_sounding_period; -+ /* Get from sounding list */ -+ /* Ex: SU STA1, SU STA2, MU STA(1~n) => the value will be 2+1=3 */ -+ u8 sound_remain_cnt_per_period; -+ /* Real number of SU sound per period */ -+ u8 su_sound_num_per_period; -+ /* Real number of MU sound per period */ -+ u8 mu_sound_num_per_period; -+}; -+ -+struct beamforming_info { -+ BEAMFORMING_CAP beamforming_cap; -+ BEAMFORMING_STATE beamforming_state; -+ struct beamformee_entry bfee_entry[MAX_BEAMFORMEE_ENTRY_NUM]; -+ struct beamformer_entry bfer_entry[MAX_BEAMFORMER_ENTRY_NUM]; -+ u8 sounding_sequence; -+ u8 beamformee_su_cnt; -+ u8 beamformer_su_cnt; -+ u32 beamformee_su_reg_maping; -+ u32 beamformer_su_reg_maping; -+ /* For MU-MINO */ -+ u8 beamformee_mu_cnt; -+ u8 beamformer_mu_cnt; -+ u32 beamformee_mu_reg_maping; -+ u8 first_mu_bfee_index; -+ u8 mu_bfer_curidx; -+ -+ struct sounding_info sounding_info; -+ -+ /* For HW configuration */ -+ u8 SetHalBFEnterOnDemandCnt; -+ u8 SetHalBFLeaveOnDemandCnt; -+ u8 SetHalSoundownOnDemandCnt; -+}; -+ -+struct beamformee_entry *beamforming_get_bfee_entry_by_addr(PADAPTER, u8 *ra); -+struct beamformer_entry *beamforming_get_bfer_entry_by_addr(PADAPTER, u8 *ra); -+u8 beamforming_send_vht_gid_mgnt_packet(PADAPTER, struct beamformee_entry*); -+ -+#else /* !RTW_BEAMFORMING_VERSION_2 */ -+struct beamforming_entry { -+ BOOLEAN bUsed; -+ BOOLEAN bSound; -+ u16 aid; /* Used to construct AID field of NDPA packet. */ -+ u16 mac_id; /* Used to Set Reg42C in IBSS mode. */ -+ u16 p_aid; /* Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ -+ u16 g_id; -+ u8 mac_addr[6];/* Used to fill Reg6E4 to fill Mac address of CSI report frame. */ -+ CHANNEL_WIDTH sound_bw; /* Sounding BandWidth */ -+ u16 sound_period; -+ BEAMFORMING_CAP beamforming_entry_cap; -+ BEAMFORMING_ENTRY_STATE beamforming_entry_state; -+ u8 ClockResetTimes; /*Modified by Jeffery @2015-04-10*/ -+ u8 PreLogSeq; /*Modified by Jeffery @2015-03-30*/ -+ u8 LogSeq; /*Modified by Jeffery @2014-10-29*/ -+ u16 LogRetryCnt:3; /*Modified by Jeffery @2014-10-29*/ -+ u16 LogSuccess:2; /*Modified by Jeffery @2014-10-29*/ -+ -+ u8 LogStatusFailCnt; -+ u8 PreCsiReport[327]; -+ u8 DefaultCsiCnt; -+ BOOLEAN bDefaultCSI; -+}; -+ -+struct sounding_info { -+ u8 sound_idx; -+ CHANNEL_WIDTH sound_bw; -+ SOUNDING_MODE sound_mode; -+ u16 sound_period; -+}; -+ -+struct beamforming_info { -+ BEAMFORMING_CAP beamforming_cap; -+ BEAMFORMING_STATE beamforming_state; -+ struct beamforming_entry beamforming_entry[BEAMFORMING_ENTRY_NUM]; -+ u8 beamforming_cur_idx; -+ u8 beamforming_in_progress; -+ u8 sounding_sequence; -+ struct sounding_info sounding_info; -+}; -+ -+struct rtw_ndpa_sta_info { -+ u16 aid:12; -+ u16 feedback_type:1; -+ u16 nc_index:3; -+}; -+ -+void beamforming_notify(PADAPTER adapter); -+BEAMFORMING_CAP beamforming_get_beamform_cap(struct beamforming_info *pBeamInfo); -+#endif /* !RTW_BEAMFORMING_VERSION_2 */ -+ -+BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(void *mlmepriv, u8 mac_id); -+ -+BOOLEAN beamforming_send_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx); -+BOOLEAN beamforming_send_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx); -+ -+void beamforming_check_sounding_success(PADAPTER Adapter, BOOLEAN status); -+ -+void beamforming_watchdog(PADAPTER Adapter); -+#endif /*#if (BEAMFORMING_SUPPORT ==0)- for diver defined beamforming*/ -+ -+enum BEAMFORMING_CTRL_TYPE { -+ BEAMFORMING_CTRL_ENTER = 0, -+ BEAMFORMING_CTRL_LEAVE = 1, -+ BEAMFORMING_CTRL_START_PERIOD = 2, -+ BEAMFORMING_CTRL_END_PERIOD = 3, -+ BEAMFORMING_CTRL_SOUNDING_FAIL = 4, -+ BEAMFORMING_CTRL_SOUNDING_CLK = 5, -+ BEAMFORMING_CTRL_SET_GID_TABLE = 6, -+}; -+u32 beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_frame); -+void beamforming_get_ndpa_frame(PADAPTER Adapter, union recv_frame *precv_frame); -+u32 beamforming_get_vht_gid_mgnt_frame(PADAPTER, union recv_frame *); -+ -+void beamforming_wk_hdl(_adapter *padapter, u8 type, u8 *pbuf); -+u8 beamforming_wk_cmd(_adapter *padapter, s32 type, u8 *pbuf, s32 size, u8 enqueue); -+void update_attrib_txbf_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta); -+ -+#endif /*#ifdef CONFIG_BEAMFORMING */ -+ -+#endif /*__RTW_BEAMFORMING_H_*/ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_br_ext.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_br_ext.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_br_ext.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_br_ext.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,74 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTW_BR_EXT_H_ -+#define _RTW_BR_EXT_H_ -+ -+#if 1 /* rtw_wifi_driver */ -+#define CL_IPV6_PASS 1 -+#define MACADDRLEN 6 -+#define _DEBUG_ERR RTW_INFO -+#define _DEBUG_INFO /* RTW_INFO */ -+#define DEBUG_WARN RTW_INFO -+#define DEBUG_INFO /* RTW_INFO */ -+#define DEBUG_ERR RTW_INFO -+/* #define GET_MY_HWADDR ((GET_MIB(priv))->dot11OperationEntry.hwaddr) */ -+#define GET_MY_HWADDR(padapter) (adapter_mac_addr(padapter)) -+#endif /* rtw_wifi_driver */ -+ -+#define NAT25_HASH_BITS 4 -+#define NAT25_HASH_SIZE (1 << NAT25_HASH_BITS) -+#define NAT25_AGEING_TIME 300 -+ -+#ifdef CL_IPV6_PASS -+ #define MAX_NETWORK_ADDR_LEN 17 -+#else -+ #define MAX_NETWORK_ADDR_LEN 11 -+#endif -+ -+struct nat25_network_db_entry { -+ struct nat25_network_db_entry *next_hash; -+ struct nat25_network_db_entry **pprev_hash; -+ atomic_t use_count; -+ unsigned char macAddr[6]; -+ unsigned long ageing_timer; -+ unsigned char networkAddr[MAX_NETWORK_ADDR_LEN]; -+}; -+ -+enum NAT25_METHOD { -+ NAT25_MIN, -+ NAT25_CHECK, -+ NAT25_INSERT, -+ NAT25_LOOKUP, -+ NAT25_PARSE, -+ NAT25_MAX -+}; -+ -+struct br_ext_info { -+ unsigned int nat25_disable; -+ unsigned int macclone_enable; -+ unsigned int dhcp_bcst_disable; -+ int addPPPoETag; /* 1: Add PPPoE relay-SID, 0: disable */ -+ unsigned char nat25_dmzMac[MACADDRLEN]; -+ unsigned int nat25sc_disable; -+}; -+ -+void nat25_db_cleanup(_adapter *priv); -+ -+#endif /* _RTW_BR_EXT_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_btcoex.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_btcoex.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_btcoex.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_btcoex.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,446 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_BTCOEX_H__ -+#define __RTW_BTCOEX_H__ -+ -+#include -+ -+/* For H2C: H2C_BT_MP_OPER. Return status definition to the user layer */ -+typedef enum _BT_CTRL_STATUS { -+ BT_STATUS_SUCCESS = 0x00, /* Success */ -+ BT_STATUS_BT_OP_SUCCESS = 0x01, /* bt fw op execution success */ -+ BT_STATUS_H2C_SUCCESS = 0x02, /* H2c success */ -+ BT_STATUS_H2C_FAIL = 0x03, /* H2c fail */ -+ BT_STATUS_H2C_LENGTH_EXCEEDED = 0x04, /* H2c command length exceeded */ -+ BT_STATUS_H2C_TIMTOUT = 0x05, /* H2c timeout */ -+ BT_STATUS_H2C_BT_NO_RSP = 0x06, /* H2c sent, bt no rsp */ -+ BT_STATUS_C2H_SUCCESS = 0x07, /* C2h success */ -+ BT_STATUS_C2H_REQNUM_MISMATCH = 0x08, /* bt fw wrong rsp */ -+ BT_STATUS_OPCODE_U_VERSION_MISMATCH = 0x08, /* Upper layer OP code version mismatch. */ -+ BT_STATUS_OPCODE_L_VERSION_MISMATCH = 0x0a, /* Lower layer OP code version mismatch. */ -+ BT_STATUS_UNKNOWN_OPCODE_U = 0x0b, /* Unknown Upper layer OP code */ -+ BT_STATUS_UNKNOWN_OPCODE_L = 0x0c, /* Unknown Lower layer OP code */ -+ BT_STATUS_PARAMETER_FORMAT_ERROR_U = 0x0d, /* Wrong parameters sent by upper layer. */ -+ BT_STATUS_PARAMETER_FORMAT_ERROR_L = 0x0e, /* bt fw parameter format is not consistency */ -+ BT_STATUS_PARAMETER_OUT_OF_RANGE_U = 0x0f, /* uppery layer parameter value is out of range */ -+ BT_STATUS_PARAMETER_OUT_OF_RANGE_L = 0x10, /* bt fw parameter value is out of range */ -+ BT_STATUS_UNKNOWN_STATUS_L = 0x11, /* bt returned an defined status code */ -+ BT_STATUS_UNKNOWN_STATUS_H = 0x12, /* driver need to do error handle or not handle-well. */ -+ BT_STATUS_WRONG_LEVEL = 0x13, /* should be under passive level */ -+ BT_STATUS_NOT_IMPLEMENT = 0x14, /* op code not implemented yet */ -+ BT_STATUS_BT_STACK_OP_SUCCESS = 0x15, /* bt stack op execution success */ -+ BT_STATUS_BT_STACK_NOT_SUPPORT = 0x16, /* stack version not support this. */ -+ BT_STATUS_BT_STACK_SEND_HCI_EVENT_FAIL = 0x17, /* send hci event fail */ -+ BT_STATUS_BT_STACK_NOT_BIND = 0x18, /* stack not bind wifi driver */ -+ BT_STATUS_BT_STACK_NO_RSP = 0x19, /* stack doesn't have any rsp. */ -+ BT_STATUS_MAX -+} BT_CTRL_STATUS, *PBT_CTRL_STATUS; -+ -+typedef enum _BTCOEX_SUSPEND_STATE { -+ BTCOEX_SUSPEND_STATE_RESUME = 0x0, -+ BTCOEX_SUSPEND_STATE_SUSPEND = 0x1, -+ BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT = 0x2, -+ BTCOEX_SUSPEND_STATE_MAX -+} BTCOEX_SUSPEND_STATE, *PBTCOEX_SUSPEND_STATE; -+ -+#define SET_BT_MP_OPER_RET(OpCode, StatusCode) ((OpCode << 8) | StatusCode) -+#define GET_OP_CODE_FROM_BT_MP_OPER_RET(RetCode) ((RetCode & 0xF0) >> 8) -+#define GET_STATUS_CODE_FROM_BT_MP_OPER_RET(RetCode) (RetCode & 0x0F) -+#define CHECK_STATUS_CODE_FROM_BT_MP_OPER_RET(RetCode, StatusCode) (GET_STATUS_CODE_FROM_BT_MP_OPER_RET(RetCode) == StatusCode) -+ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ -+#define NETLINK_USER 31 -+#define CONNECT_PORT 30000 -+#define CONNECT_PORT_BT 30001 -+#define KERNEL_SOCKET_OK 0x01 -+#define NETLINK_SOCKET_OK 0x02 -+ -+#define OTHER 0 -+#define RX_ATTEND_ACK 1 -+#define RX_LEAVE_ACK 2 -+#define RX_BT_LEAVE 3 -+#define RX_INVITE_REQ 4 -+#define RX_ATTEND_REQ 5 -+#define RX_INVITE_RSP 6 -+ -+#define invite_req "INVITE_REQ" -+#define invite_rsp "INVITE_RSP" -+#define attend_req "ATTEND_REQ" -+#define attend_ack "ATTEND_ACK" -+#define wifi_leave "WIFI_LEAVE" -+#define leave_ack "LEAVE_ACK" -+#define bt_leave "BT_LEAVE" -+ -+#define BT_INFO_NOTIFY_CMD 0x0106 -+#define BT_INFO_LEN 8 -+ -+typedef struct _HCI_LINK_INFO { -+ u2Byte ConnectHandle; -+ u1Byte IncomingTrafficMode; -+ u1Byte OutgoingTrafficMode; -+ u1Byte BTProfile; -+ u1Byte BTCoreSpec; -+ s1Byte BT_RSSI; -+ u1Byte TrafficProfile; -+ u1Byte linkRole; -+} HCI_LINK_INFO, *PHCI_LINK_INFO; -+ -+#define MAX_BT_ACL_LINK_NUM 8 -+ -+typedef struct _HCI_EXT_CONFIG { -+ HCI_LINK_INFO aclLink[MAX_BT_ACL_LINK_NUM]; -+ u1Byte btOperationCode; -+ u2Byte CurrentConnectHandle; -+ u1Byte CurrentIncomingTrafficMode; -+ u1Byte CurrentOutgoingTrafficMode; -+ -+ u1Byte NumberOfACL; -+ u1Byte NumberOfSCO; -+ u1Byte CurrentBTStatus; -+ u2Byte HCIExtensionVer; -+ -+ BOOLEAN bEnableWifiScanNotify; -+} HCI_EXT_CONFIG, *PHCI_EXT_CONFIG; -+ -+typedef struct _HCI_PHY_LINK_BSS_INFO { -+ u2Byte bdCap; /* capability information */ -+ -+ /* Qos related. Added by Annie, 2005-11-01. */ -+ /* BSS_QOS BssQos; */ -+ -+} HCI_PHY_LINK_BSS_INFO, *PHCI_PHY_LINK_BSS_INFO; -+ -+typedef enum _BT_CONNECT_TYPE { -+ BT_CONNECT_AUTH_REQ = 0x00, -+ BT_CONNECT_AUTH_RSP = 0x01, -+ BT_CONNECT_ASOC_REQ = 0x02, -+ BT_CONNECT_ASOC_RSP = 0x03, -+ BT_DISCONNECT = 0x04 -+} BT_CONNECT_TYPE, *PBT_CONNECT_TYPE; -+ -+ -+typedef struct _PACKET_IRP_HCIEVENT_DATA { -+ u8 EventCode; -+ u8 Length; /* total cmd length = extension event length+1(extension event code length) */ -+ u8 Data[1]; /* byte1 is extension event code */ -+} rtw_HCI_event; -+ -+ -+struct btinfo_8761ATV { -+ u8 cid; -+ u8 len; -+ -+ u8 bConnection:1; -+ u8 bSCOeSCO:1; -+ u8 bInQPage:1; -+ u8 bACLBusy:1; -+ u8 bSCOBusy:1; -+ u8 bHID:1; -+ u8 bA2DP:1; -+ u8 bFTP:1; -+ -+ u8 retry_cnt:4; -+ u8 rsvd_34:1; -+ u8 bPage:1; -+ u8 TRxMask:1; -+ u8 Sniff_attempt:1; -+ -+ u8 rssi; -+ -+ u8 A2dp_rate:1; -+ u8 ReInit:1; -+ u8 MaxPower:1; -+ u8 bEnIgnoreWlanAct:1; -+ u8 TxPowerLow:1; -+ u8 TxPowerHigh:1; -+ u8 eSCO_SCO:1; -+ u8 Master_Slave:1; -+ -+ u8 ACL_TRx_TP_low; -+ u8 ACL_TRx_TP_high; -+}; -+ -+#define HCIOPCODE(_OCF, _OGF) ((_OGF)<<10|(_OCF)) -+#define HCIOPCODELOW(_OCF, _OGF) (u8)(HCIOPCODE(_OCF, _OGF) & 0x00ff) -+#define HCIOPCODEHIGHT(_OCF, _OGF) (u8)(HCIOPCODE(_OCF, _OGF)>>8) -+#define HCI_OGF(opCode) (unsigned char)((0xFC00 & (opCode)) >> 10) -+#define HCI_OCF(opCode) (0x3FF & (opCode)) -+ -+ -+typedef enum _HCI_STATUS { -+ HCI_STATUS_SUCCESS = 0x00, /* Success */ -+ HCI_STATUS_UNKNOW_HCI_CMD = 0x01, /* Unknown HCI Command */ -+ HCI_STATUS_UNKNOW_CONNECT_ID = 0X02, /* Unknown Connection Identifier */ -+ HCI_STATUS_HW_FAIL = 0X03, /* Hardware Failure */ -+ HCI_STATUS_PAGE_TIMEOUT = 0X04, /* Page Timeout */ -+ HCI_STATUS_AUTH_FAIL = 0X05, /* Authentication Failure */ -+ HCI_STATUS_PIN_OR_KEY_MISSING = 0X06, /* PIN or Key Missing */ -+ HCI_STATUS_MEM_CAP_EXCEED = 0X07, /* Memory Capacity Exceeded */ -+ HCI_STATUS_CONNECT_TIMEOUT = 0X08, /* Connection Timeout */ -+ HCI_STATUS_CONNECT_LIMIT = 0X09, /* Connection Limit Exceeded */ -+ HCI_STATUS_SYN_CONNECT_LIMIT = 0X0a, /* Synchronous Connection Limit To A Device Exceeded */ -+ HCI_STATUS_ACL_CONNECT_EXISTS = 0X0b, /* ACL Connection Already Exists */ -+ HCI_STATUS_CMD_DISALLOW = 0X0c, /* Command Disallowed */ -+ HCI_STATUS_CONNECT_RJT_LIMIT_RESOURCE = 0X0d, /* Connection Rejected due to Limited Resources */ -+ HCI_STATUS_CONNECT_RJT_SEC_REASON = 0X0e, /* Connection Rejected Due To Security Reasons */ -+ HCI_STATUS_CONNECT_RJT_UNACCEPT_BD_ADDR = 0X0f, /* Connection Rejected due to Unacceptable BD_ADDR */ -+ HCI_STATUS_CONNECT_ACCEPT_TIMEOUT = 0X10, /* Connection Accept Timeout Exceeded */ -+ HCI_STATUS_UNSUPPORT_FEATURE_PARA_VALUE = 0X11, /* Unsupported Feature or Parameter Value */ -+ HCI_STATUS_INVALID_HCI_CMD_PARA_VALUE = 0X12, /* Invalid HCI Command Parameters */ -+ HCI_STATUS_REMOTE_USER_TERMINATE_CONNECT = 0X13, /* Remote User Terminated Connection */ -+ HCI_STATUS_REMOTE_DEV_TERMINATE_LOW_RESOURCE = 0X14, /* Remote Device Terminated Connection due to Low Resources */ -+ HCI_STATUS_REMOTE_DEV_TERMINATE_CONNECT_POWER_OFF = 0X15, /* Remote Device Terminated Connection due to Power Off */ -+ HCI_STATUS_CONNECT_TERMINATE_LOCAL_HOST = 0X16, /* Connection Terminated By Local Host */ -+ HCI_STATUS_REPEATE_ATTEMPT = 0X17, /* Repeated Attempts */ -+ HCI_STATUS_PAIR_NOT_ALLOW = 0X18, /* Pairing Not Allowed */ -+ HCI_STATUS_UNKNOW_LMP_PDU = 0X19, /* Unknown LMP PDU */ -+ HCI_STATUS_UNSUPPORT_REMOTE_LMP_FEATURE = 0X1a, /* Unsupported Remote Feature / Unsupported LMP Feature */ -+ HCI_STATUS_SOC_OFFSET_REJECT = 0X1b, /* SCO Offset Rejected */ -+ HCI_STATUS_SOC_INTERVAL_REJECT = 0X1c, /* SCO Interval Rejected */ -+ HCI_STATUS_SOC_AIR_MODE_REJECT = 0X1d, /* SCO Air Mode Rejected */ -+ HCI_STATUS_INVALID_LMP_PARA = 0X1e, /* Invalid LMP Parameters */ -+ HCI_STATUS_UNSPECIFIC_ERROR = 0X1f, /* Unspecified Error */ -+ HCI_STATUS_UNSUPPORT_LMP_PARA_VALUE = 0X20, /* Unsupported LMP Parameter Value */ -+ HCI_STATUS_ROLE_CHANGE_NOT_ALLOW = 0X21, /* Role Change Not Allowed */ -+ HCI_STATUS_LMP_RESPONSE_TIMEOUT = 0X22, /* LMP Response Timeout */ -+ HCI_STATUS_LMP_ERROR_TRANSACTION_COLLISION = 0X23, /* LMP Error Transaction Collision */ -+ HCI_STATUS_LMP_PDU_NOT_ALLOW = 0X24, /* LMP PDU Not Allowed */ -+ HCI_STATUS_ENCRYPTION_MODE_NOT_ALLOW = 0X25, /* Encryption Mode Not Acceptable */ -+ HCI_STATUS_LINK_KEY_CAN_NOT_CHANGE = 0X26, /* Link Key Can Not be Changed */ -+ HCI_STATUS_REQUEST_QOS_NOT_SUPPORT = 0X27, /* Requested QoS Not Supported */ -+ HCI_STATUS_INSTANT_PASSED = 0X28, /* Instant Passed */ -+ HCI_STATUS_PAIRING_UNIT_KEY_NOT_SUPPORT = 0X29, /* Pairing With Unit Key Not Supported */ -+ HCI_STATUS_DIFFERENT_TRANSACTION_COLLISION = 0X2a, /* Different Transaction Collision */ -+ HCI_STATUS_RESERVE_1 = 0X2b, /* Reserved */ -+ HCI_STATUS_QOS_UNACCEPT_PARA = 0X2c, /* QoS Unacceptable Parameter */ -+ HCI_STATUS_QOS_REJECT = 0X2d, /* QoS Rejected */ -+ HCI_STATUS_CHNL_CLASSIFICATION_NOT_SUPPORT = 0X2e, /* Channel Classification Not Supported */ -+ HCI_STATUS_INSUFFICIENT_SECURITY = 0X2f, /* Insufficient Security */ -+ HCI_STATUS_PARA_OUT_OF_RANGE = 0x30, /* Parameter Out Of Mandatory Range */ -+ HCI_STATUS_RESERVE_2 = 0X31, /* Reserved */ -+ HCI_STATUS_ROLE_SWITCH_PENDING = 0X32, /* Role Switch Pending */ -+ HCI_STATUS_RESERVE_3 = 0X33, /* Reserved */ -+ HCI_STATUS_RESERVE_SOLT_VIOLATION = 0X34, /* Reserved Slot Violation */ -+ HCI_STATUS_ROLE_SWITCH_FAIL = 0X35, /* Role Switch Failed */ -+ HCI_STATUS_EXTEND_INQUIRY_RSP_TOO_LARGE = 0X36, /* Extended Inquiry Response Too Large */ -+ HCI_STATUS_SEC_SIMPLE_PAIRING_NOT_SUPPORT = 0X37, /* Secure Simple Pairing Not Supported By Host. */ -+ HCI_STATUS_HOST_BUSY_PAIRING = 0X38, /* Host Busy - Pairing */ -+ HCI_STATUS_CONNECT_REJ_NOT_SUIT_CHNL_FOUND = 0X39, /* Connection Rejected due to No Suitable Channel Found */ -+ HCI_STATUS_CONTROLLER_BUSY = 0X3a /* CONTROLLER BUSY */ -+} RTW_HCI_STATUS; -+ -+#define HCI_EVENT_COMMAND_COMPLETE 0x0e -+ -+#define OGF_EXTENSION 0X3f -+typedef enum HCI_EXTENSION_COMMANDS { -+ HCI_SET_ACL_LINK_DATA_FLOW_MODE = 0x0010, -+ HCI_SET_ACL_LINK_STATUS = 0x0020, -+ HCI_SET_SCO_LINK_STATUS = 0x0030, -+ HCI_SET_RSSI_VALUE = 0x0040, -+ HCI_SET_CURRENT_BLUETOOTH_STATUS = 0x0041, -+ -+ /* The following is for RTK8723 */ -+ HCI_EXTENSION_VERSION_NOTIFY = 0x0100, -+ HCI_LINK_STATUS_NOTIFY = 0x0101, -+ HCI_BT_OPERATION_NOTIFY = 0x0102, -+ HCI_ENABLE_WIFI_SCAN_NOTIFY = 0x0103, -+ HCI_QUERY_RF_STATUS = 0x0104, -+ HCI_BT_ABNORMAL_NOTIFY = 0x0105, -+ HCI_BT_INFO_NOTIFY = 0x0106, -+ HCI_BT_COEX_NOTIFY = 0x0107, -+ HCI_BT_PATCH_VERSION_NOTIFY = 0x0108, -+ HCI_BT_AFH_MAP_NOTIFY = 0x0109, -+ HCI_BT_REGISTER_VALUE_NOTIFY = 0x010a, -+ -+ /* The following is for IVT */ -+ HCI_WIFI_CURRENT_CHANNEL = 0x0300, -+ HCI_WIFI_CURRENT_BANDWIDTH = 0x0301, -+ HCI_WIFI_CONNECTION_STATUS = 0x0302 -+} RTW_HCI_EXT_CMD; -+ -+#define HCI_EVENT_EXTENSION_RTK 0xfe -+typedef enum HCI_EXTENSION_EVENT_RTK { -+ HCI_EVENT_EXT_WIFI_SCAN_NOTIFY = 0x01, -+ HCI_EVENT_EXT_WIFI_RF_STATUS_NOTIFY = 0x02, -+ HCI_EVENT_EXT_BT_INFO_CONTROL = 0x03, -+ HCI_EVENT_EXT_BT_COEX_CONTROL = 0x04 -+} RTW_HCI_EXT_EVENT; -+ -+typedef enum _BT_TRAFFIC_MODE { -+ BT_MOTOR_EXT_BE = 0x00, /* Best Effort. Default. for HCRP, PAN, SDP, RFCOMM-based profiles like FTP,OPP, SPP, DUN, etc. */ -+ BT_MOTOR_EXT_GUL = 0x01, /* Guaranteed Latency. This type of traffic is used e.g. for HID and AVRCP. */ -+ BT_MOTOR_EXT_GUB = 0X02, /* Guaranteed Bandwidth. */ -+ BT_MOTOR_EXT_GULB = 0X03 /* Guaranteed Latency and Bandwidth. for A2DP and VDP. */ -+} BT_TRAFFIC_MODE; -+ -+typedef enum _BT_TRAFFIC_MODE_PROFILE { -+ BT_PROFILE_NONE, -+ BT_PROFILE_A2DP, -+ BT_PROFILE_PAN , -+ BT_PROFILE_HID, -+ BT_PROFILE_SCO -+} BT_TRAFFIC_MODE_PROFILE; -+ -+typedef enum _HCI_EXT_BT_OPERATION { -+ HCI_BT_OP_NONE = 0x0, -+ HCI_BT_OP_INQUIRY_START = 0x1, -+ HCI_BT_OP_INQUIRY_FINISH = 0x2, -+ HCI_BT_OP_PAGING_START = 0x3, -+ HCI_BT_OP_PAGING_SUCCESS = 0x4, -+ HCI_BT_OP_PAGING_UNSUCCESS = 0x5, -+ HCI_BT_OP_PAIRING_START = 0x6, -+ HCI_BT_OP_PAIRING_FINISH = 0x7, -+ HCI_BT_OP_BT_DEV_ENABLE = 0x8, -+ HCI_BT_OP_BT_DEV_DISABLE = 0x9, -+ HCI_BT_OP_MAX -+} HCI_EXT_BT_OPERATION, *PHCI_EXT_BT_OPERATION; -+ -+typedef struct _BT_MGNT { -+ BOOLEAN bBTConnectInProgress; -+ BOOLEAN bLogLinkInProgress; -+ BOOLEAN bPhyLinkInProgress; -+ BOOLEAN bPhyLinkInProgressStartLL; -+ u1Byte BtCurrentPhyLinkhandle; -+ u2Byte BtCurrentLogLinkhandle; -+ u1Byte CurrentConnectEntryNum; -+ u1Byte DisconnectEntryNum; -+ u1Byte CurrentBTConnectionCnt; -+ BT_CONNECT_TYPE BTCurrentConnectType; -+ BT_CONNECT_TYPE BTReceiveConnectPkt; -+ u1Byte BTAuthCount; -+ u1Byte BTAsocCount; -+ BOOLEAN bStartSendSupervisionPkt; -+ BOOLEAN BtOperationOn; -+ BOOLEAN BTNeedAMPStatusChg; -+ BOOLEAN JoinerNeedSendAuth; -+ HCI_PHY_LINK_BSS_INFO bssDesc; -+ HCI_EXT_CONFIG ExtConfig; -+ BOOLEAN bNeedNotifyAMPNoCap; -+ BOOLEAN bCreateSpportQos; -+ BOOLEAN bSupportProfile; -+ u1Byte BTChannel; -+ BOOLEAN CheckChnlIsSuit; -+ BOOLEAN bBtScan; -+ BOOLEAN btLogoTest; -+ BOOLEAN bRfStatusNotified; -+ BOOLEAN bBtRsvedPageDownload; -+} BT_MGNT, *PBT_MGNT; -+ -+struct bt_coex_info { -+ /* For Kernel Socket */ -+ struct socket *udpsock; -+ struct sockaddr_in wifi_sockaddr; /*wifi socket*/ -+ struct sockaddr_in bt_sockaddr;/* BT socket */ -+ struct sock *sk_store;/*back up socket for UDP RX int*/ -+ -+ /* store which socket is OK */ -+ u8 sock_open; -+ -+ u8 BT_attend; -+ u8 is_exist; /* socket exist */ -+ BT_MGNT BtMgnt; -+ struct workqueue_struct *btcoex_wq; -+ struct delayed_work recvmsg_work; -+}; -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ -+#define PACKET_NORMAL 0 -+#define PACKET_DHCP 1 -+#define PACKET_ARP 2 -+#define PACKET_EAPOL 3 -+ -+void rtw_btcoex_Initialize(PADAPTER); -+void rtw_btcoex_PowerOnSetting(PADAPTER padapter); -+void rtw_btcoex_PowerOffSetting(PADAPTER padapter); -+void rtw_btcoex_PreLoadFirmware(PADAPTER padapter); -+void rtw_btcoex_HAL_Initialize(PADAPTER padapter, u8 bWifiOnly); -+void rtw_btcoex_IpsNotify(PADAPTER, u8 type); -+void rtw_btcoex_LpsNotify(PADAPTER, u8 type); -+void rtw_btcoex_ScanNotify(PADAPTER, u8 type); -+void rtw_btcoex_ConnectNotify(PADAPTER, u8 action); -+void rtw_btcoex_MediaStatusNotify(PADAPTER, u8 mediaStatus); -+void rtw_btcoex_SpecialPacketNotify(PADAPTER, u8 pktType); -+void rtw_btcoex_IQKNotify(PADAPTER padapter, u8 state); -+void rtw_btcoex_BtInfoNotify(PADAPTER, u8 length, u8 *tmpBuf); -+void rtw_btcoex_BtMpRptNotify(PADAPTER, u8 length, u8 *tmpBuf); -+void rtw_btcoex_SuspendNotify(PADAPTER, u8 state); -+void rtw_btcoex_HaltNotify(PADAPTER); -+void rtw_btcoex_switchband_notify(u8 under_scan, u8 band_type); -+void rtw_btcoex_SwitchBtTRxMask(PADAPTER); -+void rtw_btcoex_Switch(PADAPTER, u8 enable); -+u8 rtw_btcoex_IsBtDisabled(PADAPTER); -+void rtw_btcoex_Handler(PADAPTER); -+s32 rtw_btcoex_IsBTCoexRejectAMPDU(PADAPTER padapter); -+s32 rtw_btcoex_IsBTCoexCtrlAMPDUSize(PADAPTER); -+u32 rtw_btcoex_GetAMPDUSize(PADAPTER); -+void rtw_btcoex_SetManualControl(PADAPTER, u8 bmanual); -+u8 rtw_btcoex_1Ant(PADAPTER); -+u8 rtw_btcoex_IsBtControlLps(PADAPTER); -+u8 rtw_btcoex_IsLpsOn(PADAPTER); -+u8 rtw_btcoex_RpwmVal(PADAPTER); -+u8 rtw_btcoex_LpsVal(PADAPTER); -+u32 rtw_btcoex_GetRaMask(PADAPTER); -+void rtw_btcoex_RecordPwrMode(PADAPTER, u8 *pCmdBuf, u8 cmdLen); -+void rtw_btcoex_DisplayBtCoexInfo(PADAPTER, u8 *pbuf, u32 bufsize); -+void rtw_btcoex_SetDBG(PADAPTER, u32 *pDbgModule); -+u32 rtw_btcoex_GetDBG(PADAPTER, u8 *pStrBuf, u32 bufSize); -+u8 rtw_btcoex_IncreaseScanDeviceNum(PADAPTER); -+u8 rtw_btcoex_IsBtLinkExist(PADAPTER); -+void rtw_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON); -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+void rtw_btcoex_SetBtPatchVersion(PADAPTER padapter, u16 btHciVer, u16 btPatchVer); -+void rtw_btcoex_SetHciVersion(PADAPTER padapter, u16 hciVersion); -+void rtw_btcoex_StackUpdateProfileInfo(void); -+void rtw_btcoex_init_socket(_adapter *padapter); -+void rtw_btcoex_close_socket(_adapter *padapter); -+void rtw_btcoex_dump_tx_msg(u8 *tx_msg, u8 len, u8 *msg_name); -+u8 rtw_btcoex_sendmsgbysocket(_adapter *padapter, u8 *msg, u8 msg_size, bool force); -+u8 rtw_btcoex_create_kernel_socket(_adapter *padapter); -+void rtw_btcoex_close_kernel_socket(_adapter *padapter); -+void rtw_btcoex_recvmsgbysocket(void *data); -+u16 rtw_btcoex_parse_recv_data(u8 *msg, u8 msg_size); -+u8 rtw_btcoex_btinfo_cmd(PADAPTER padapter, u8 *pbuf, u16 length); -+void rtw_btcoex_parse_hci_cmd(_adapter *padapter, u8 *cmd, u16 len); -+void rtw_btcoex_SendEventExtBtCoexControl(PADAPTER Adapter, u8 bNeedDbgRsp, u8 dataLen, void *pData); -+void rtw_btcoex_SendEventExtBtInfoControl(PADAPTER Adapter, u8 dataLen, void *pData); -+void rtw_btcoex_SendScanNotify(PADAPTER padapter, u8 scanType); -+#define BT_SendEventExtBtCoexControl(Adapter, bNeedDbgRsp, dataLen, pData) rtw_btcoex_SendEventExtBtCoexControl(Adapter, bNeedDbgRsp, dataLen, pData) -+#define BT_SendEventExtBtInfoControl(Adapter, dataLen, pData) rtw_btcoex_SendEventExtBtInfoControl(Adapter, dataLen, pData) -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+u16 rtw_btcoex_btreg_read(PADAPTER padapter, u8 type, u16 addr, u32 *data); -+u16 rtw_btcoex_btreg_write(PADAPTER padapter, u8 type, u16 addr, u16 val); -+u8 rtw_btcoex_get_ant_div_cfg(PADAPTER padapter); -+u8 rtw_btcoex_get_bt_coexist(PADAPTER padapter); -+u8 rtw_btcoex_get_chip_type(PADAPTER padapter); -+u8 rtw_btcoex_get_pg_ant_num(PADAPTER padapter); -+u8 rtw_btcoex_get_pg_single_ant_path(PADAPTER padapter); -+u8 rtw_btcoex_get_pg_rfe_type(PADAPTER padapter); -+u8 rtw_btcoex_is_tfbga_package_type(PADAPTER padapter); -+u8 rtw_btcoex_get_ant_div_cfg(PADAPTER padapter); -+ -+/* ================================================== -+ * Below Functions are called by BT-Coex -+ * ================================================== */ -+void rtw_btcoex_rx_ampdu_apply(PADAPTER); -+void rtw_btcoex_LPS_Enter(PADAPTER); -+void rtw_btcoex_LPS_Leave(PADAPTER); -+ -+#endif /* __RTW_BTCOEX_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_bt_mp.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_bt_mp.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_bt_mp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_bt_mp.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,293 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef __RTW_BT_MP_H -+#define __RTW_BT_MP_H -+ -+ -+#if (MP_DRIVER == 1) -+ -+#pragma pack(1) -+ -+/* definition for BT_UP_OP_BT_READY */ -+#define MP_BT_NOT_READY 0 -+#define MP_BT_READY 1 -+ -+/* definition for BT_UP_OP_BT_SET_MODE */ -+typedef enum _MP_BT_MODE { -+ MP_BT_MODE_RF_TXRX_TEST_MODE = 0, -+ MP_BT_MODE_BT20_DUT_TEST_MODE = 1, -+ MP_BT_MODE_BT40_DIRECT_TEST_MODE = 2, -+ MP_BT_MODE_CONNECT_TEST_MODE = 3, -+ MP_BT_MODE_MAX -+} MP_BT_MODE, *PMP_BT_MODE; -+ -+ -+/* definition for BT_UP_OP_BT_SET_TX_RX_PARAMETER */ -+typedef struct _BT_TXRX_PARAMETERS { -+ u1Byte txrxChannel; -+ u4Byte txrxTxPktCnt; -+ u1Byte txrxTxPktInterval; -+ u1Byte txrxPayloadType; -+ u1Byte txrxPktType; -+ u2Byte txrxPayloadLen; -+ u4Byte txrxPktHeader; -+ u1Byte txrxWhitenCoeff; -+ u1Byte txrxBdaddr[6]; -+ u1Byte txrxTxGainIndex; -+} BT_TXRX_PARAMETERS, *PBT_TXRX_PARAMETERS; -+ -+/* txrxPktType */ -+typedef enum _MP_BT_PKT_TYPE { -+ MP_BT_PKT_DH1 = 0, -+ MP_BT_PKT_DH3 = 1, -+ MP_BT_PKT_DH5 = 2, -+ MP_BT_PKT_2DH1 = 3, -+ MP_BT_PKT_2DH3 = 4, -+ MP_BT_PKT_2DH5 = 5, -+ MP_BT_PKT_3DH1 = 6, -+ MP_BT_PKT_3DH3 = 7, -+ MP_BT_PKT_3DH5 = 8, -+ MP_BT_PKT_LE = 9, -+ MP_BT_PKT_MAX -+} MP_BT_PKT_TYPE, *PMP_BT_PKT_TYPE; -+/* txrxPayloadType */ -+typedef enum _MP_BT_PAYLOAD_TYPE { -+ MP_BT_PAYLOAD_01010101 = 0, -+ MP_BT_PAYLOAD_ALL_1 = 1, -+ MP_BT_PAYLOAD_ALL_0 = 2, -+ MP_BT_PAYLOAD_11110000 = 3, -+ MP_BT_PAYLOAD_PRBS9 = 4, -+ MP_BT_PAYLOAD_MAX = 8, -+} MP_BT_PAYLOAD_TYPE, *PMP_BT_PAYLOAD_TYPE; -+ -+ -+/* definition for BT_UP_OP_BT_TEST_CTRL */ -+typedef enum _MP_BT_TEST_CTRL { -+ MP_BT_TEST_STOP_ALL_TESTS = 0, -+ MP_BT_TEST_START_RX_TEST = 1, -+ MP_BT_TEST_START_PACKET_TX_TEST = 2, -+ MP_BT_TEST_START_CONTINUOUS_TX_TEST = 3, -+ MP_BT_TEST_START_INQUIRY_SCAN_TEST = 4, -+ MP_BT_TEST_START_PAGE_SCAN_TEST = 5, -+ MP_BT_TEST_START_INQUIRY_PAGE_SCAN_TEST = 6, -+ MP_BT_TEST_START_LEGACY_CONNECT_TEST = 7, -+ MP_BT_TEST_START_LE_CONNECT_TEST_INITIATOR = 8, -+ MP_BT_TEST_START_LE_CONNECT_TEST_ADVERTISER = 9, -+ MP_BT_TEST_MAX -+} MP_BT_TEST_CTRL, *PMP_BT_TEST_CTRL; -+ -+ -+typedef enum _RTL_EXT_C2H_EVT { -+ EXT_C2H_WIFI_FW_ACTIVE_RSP = 0, -+ EXT_C2H_TRIG_BY_BT_FW = 1, -+ MAX_EXT_C2HEVENT -+} RTL_EXT_C2H_EVT; -+ -+/* OP codes definition between the user layer and driver */ -+typedef enum _BT_CTRL_OPCODE_UPPER { -+ BT_UP_OP_BT_READY = 0x00, -+ BT_UP_OP_BT_SET_MODE = 0x01, -+ BT_UP_OP_BT_SET_TX_RX_PARAMETER = 0x02, -+ BT_UP_OP_BT_SET_GENERAL = 0x03, -+ BT_UP_OP_BT_GET_GENERAL = 0x04, -+ BT_UP_OP_BT_TEST_CTRL = 0x05, -+ BT_UP_OP_TEST_BT = 0x06, -+ BT_UP_OP_MAX -+} BT_CTRL_OPCODE_UPPER, *PBT_CTRL_OPCODE_UPPER; -+ -+ -+typedef enum _BT_SET_GENERAL { -+ BT_GSET_REG = 0x00, -+ BT_GSET_RESET = 0x01, -+ BT_GSET_TARGET_BD_ADDR = 0x02, -+ BT_GSET_TX_PWR_FINETUNE = 0x03, -+ BT_SET_TRACKING_INTERVAL = 0x04, -+ BT_SET_THERMAL_METER = 0x05, -+ BT_ENABLE_CFO_TRACKING = 0x06, -+ BT_GSET_UPDATE_BT_PATCH = 0x07, -+ BT_GSET_MAX -+} BT_SET_GENERAL, *PBT_SET_GENERAL; -+ -+typedef enum _BT_GET_GENERAL { -+ BT_GGET_REG = 0x00, -+ BT_GGET_STATUS = 0x01, -+ BT_GGET_REPORT = 0x02, -+ BT_GGET_AFH_MAP = 0x03, -+ BT_GGET_AFH_STATUS = 0x04, -+ BT_GGET_MAX -+} BT_GET_GENERAL, *PBT_GET_GENERAL; -+ -+/* definition for BT_UP_OP_BT_SET_GENERAL */ -+typedef enum _BT_REG_TYPE { -+ BT_REG_RF = 0, -+ BT_REG_MODEM = 1, -+ BT_REG_BLUEWIZE = 2, -+ BT_REG_VENDOR = 3, -+ BT_REG_LE = 4, -+ BT_REG_MAX -+} BT_REG_TYPE, *PBT_REG_TYPE; -+ -+/* definition for BT_LO_OP_GET_AFH_MAP */ -+typedef enum _BT_AFH_MAP_TYPE { -+ BT_AFH_MAP_RESULT = 0, -+ BT_AFH_MAP_WIFI_PSD_ONLY = 1, -+ BT_AFH_MAP_WIFI_CH_BW_ONLY = 2, -+ BT_AFH_MAP_BT_PSD_ONLY = 3, -+ BT_AFH_MAP_HOST_CLASSIFICATION_ONLY = 4, -+ BT_AFH_MAP_MAX -+} BT_AFH_MAP_TYPE, *PBT_AFH_MAP_TYPE; -+ -+/* definition for BT_UP_OP_BT_GET_GENERAL */ -+typedef enum _BT_REPORT_TYPE { -+ BT_REPORT_RX_PACKET_CNT = 0, -+ BT_REPORT_RX_ERROR_BITS = 1, -+ BT_REPORT_RSSI = 2, -+ BT_REPORT_CFO_HDR_QUALITY = 3, -+ BT_REPORT_CONNECT_TARGET_BD_ADDR = 4, -+ BT_REPORT_MAX -+} BT_REPORT_TYPE, *PBT_REPORT_TYPE; -+ -+VOID -+MPTBT_Test( -+ IN PADAPTER Adapter, -+ IN u1Byte opCode, -+ IN u1Byte byte1, -+ IN u1Byte byte2, -+ IN u1Byte byte3 -+); -+ -+NDIS_STATUS -+MPTBT_SendOidBT( -+ IN PADAPTER pAdapter, -+ IN PVOID InformationBuffer, -+ IN ULONG InformationBufferLength, -+ OUT PULONG BytesRead, -+ OUT PULONG BytesNeeded -+); -+ -+VOID -+MPTBT_FwC2hBtMpCtrl( -+ PADAPTER Adapter, -+ pu1Byte tmpBuf, -+ u1Byte length -+); -+ -+void MPh2c_timeout_handle(void *FunctionContext); -+ -+VOID mptbt_BtControlProcess( -+ PADAPTER Adapter, -+ PVOID pInBuf -+); -+ -+#define BT_H2C_MAX_RETRY 1 -+#define BT_MAX_C2H_LEN 20 -+ -+typedef struct _BT_REQ_CMD { -+ UCHAR opCodeVer; -+ UCHAR OpCode; -+ USHORT paraLength; -+ UCHAR pParamStart[100]; -+} BT_REQ_CMD, *PBT_REQ_CMD; -+ -+typedef struct _BT_RSP_CMD { -+ USHORT status; -+ USHORT paraLength; -+ UCHAR pParamStart[100]; -+} BT_RSP_CMD, *PBT_RSP_CMD; -+ -+ -+typedef struct _BT_H2C { -+ u1Byte opCodeVer:4; -+ u1Byte reqNum:4; -+ u1Byte opCode; -+ u1Byte buf[100]; -+} BT_H2C, *PBT_H2C; -+ -+ -+ -+typedef struct _BT_EXT_C2H { -+ u1Byte extendId; -+ u1Byte statusCode:4; -+ u1Byte retLen:4; -+ u1Byte opCodeVer:4; -+ u1Byte reqNum:4; -+ u1Byte buf[100]; -+} BT_EXT_C2H, *PBT_EXT_C2H; -+ -+ -+typedef enum _BT_OPCODE_STATUS { -+ BT_OP_STATUS_SUCCESS = 0x00, /* Success */ -+ BT_OP_STATUS_VERSION_MISMATCH = 0x01, -+ BT_OP_STATUS_UNKNOWN_OPCODE = 0x02, -+ BT_OP_STATUS_ERROR_PARAMETER = 0x03, -+ BT_OP_STATUS_MAX -+} BT_OPCODE_STATUS, *PBT_OPCODE_STATUS; -+ -+ -+ -+/* OP codes definition between driver and bt fw */ -+typedef enum _BT_CTRL_OPCODE_LOWER { -+ BT_LO_OP_GET_BT_VERSION = 0x00, -+ BT_LO_OP_RESET = 0x01, -+ BT_LO_OP_TEST_CTRL = 0x02, -+ BT_LO_OP_SET_BT_MODE = 0x03, -+ BT_LO_OP_SET_CHNL_TX_GAIN = 0x04, -+ BT_LO_OP_SET_PKT_TYPE_LEN = 0x05, -+ BT_LO_OP_SET_PKT_CNT_L_PL_TYPE = 0x06, -+ BT_LO_OP_SET_PKT_CNT_H_PKT_INTV = 0x07, -+ BT_LO_OP_SET_PKT_HEADER = 0x08, -+ BT_LO_OP_SET_WHITENCOEFF = 0x09, -+ BT_LO_OP_SET_BD_ADDR_L = 0x0a, -+ BT_LO_OP_SET_BD_ADDR_H = 0x0b, -+ BT_LO_OP_WRITE_REG_ADDR = 0x0c, -+ BT_LO_OP_WRITE_REG_VALUE = 0x0d, -+ BT_LO_OP_GET_BT_STATUS = 0x0e, -+ BT_LO_OP_GET_BD_ADDR_L = 0x0f, -+ BT_LO_OP_GET_BD_ADDR_H = 0x10, -+ BT_LO_OP_READ_REG = 0x11, -+ BT_LO_OP_SET_TARGET_BD_ADDR_L = 0x12, -+ BT_LO_OP_SET_TARGET_BD_ADDR_H = 0x13, -+ BT_LO_OP_SET_TX_POWER_CALIBRATION = 0x14, -+ BT_LO_OP_GET_RX_PKT_CNT_L = 0x15, -+ BT_LO_OP_GET_RX_PKT_CNT_H = 0x16, -+ BT_LO_OP_GET_RX_ERROR_BITS_L = 0x17, -+ BT_LO_OP_GET_RX_ERROR_BITS_H = 0x18, -+ BT_LO_OP_GET_RSSI = 0x19, -+ BT_LO_OP_GET_CFO_HDR_QUALITY_L = 0x1a, -+ BT_LO_OP_GET_CFO_HDR_QUALITY_H = 0x1b, -+ BT_LO_OP_GET_TARGET_BD_ADDR_L = 0x1c, -+ BT_LO_OP_GET_TARGET_BD_ADDR_H = 0x1d, -+ BT_LO_OP_GET_AFH_MAP_L = 0x1e, -+ BT_LO_OP_GET_AFH_MAP_M = 0x1f, -+ BT_LO_OP_GET_AFH_MAP_H = 0x20, -+ BT_LO_OP_GET_AFH_STATUS = 0x21, -+ BT_LO_OP_SET_TRACKING_INTERVAL = 0x22, -+ BT_LO_OP_SET_THERMAL_METER = 0x23, -+ BT_LO_OP_ENABLE_CFO_TRACKING = 0x24, -+ BT_LO_OP_MAX -+} BT_CTRL_OPCODE_LOWER, *PBT_CTRL_OPCODE_LOWER; -+ -+ -+ -+ -+#endif /* #if(MP_DRIVER == 1) */ -+ -+#endif /* #ifndef __INC_MPT_BT_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_byteorder.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_byteorder.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_byteorder.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_byteorder.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,38 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTL871X_BYTEORDER_H_ -+#define _RTL871X_BYTEORDER_H_ -+ -+ -+#if defined(CONFIG_LITTLE_ENDIAN) && defined (CONFIG_BIG_ENDIAN) -+ #error "Shall be CONFIG_LITTLE_ENDIAN or CONFIG_BIG_ENDIAN, but not both!\n" -+#endif -+ -+#if defined(CONFIG_LITTLE_ENDIAN) -+ #ifndef CONFIG_PLATFORM_MSTAR389 -+ #include -+ #endif -+#elif defined (CONFIG_BIG_ENDIAN) -+ #include -+#else -+ # error "Must be LITTLE/BIG Endian Host" -+#endif -+ -+#endif /* _RTL871X_BYTEORDER_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_cmd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_cmd.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_cmd.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,1319 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_CMD_H_ -+#define __RTW_CMD_H_ -+ -+ -+#define C2H_MEM_SZ (16*1024) -+ -+#ifndef CONFIG_RTL8711FW -+ -+#define FREE_CMDOBJ_SZ 128 -+ -+#define MAX_CMDSZ 1024 -+#define MAX_RSPSZ 512 -+#define MAX_EVTSZ 1024 -+ -+#ifdef PLATFORM_OS_CE -+ #define CMDBUFF_ALIGN_SZ 4 -+#else -+ #define CMDBUFF_ALIGN_SZ 512 -+#endif -+ -+struct cmd_obj { -+ _adapter *padapter; -+ u16 cmdcode; -+ u8 res; -+ u8 *parmbuf; -+ u32 cmdsz; -+ u8 *rsp; -+ u32 rspsz; -+ struct submit_ctx *sctx; -+ u8 no_io; -+ /* _sema cmd_sem; */ -+ _list list; -+}; -+ -+/* cmd flags */ -+enum { -+ RTW_CMDF_DIRECTLY = BIT0, -+ RTW_CMDF_WAIT_ACK = BIT1, -+}; -+ -+struct cmd_priv { -+ _sema cmd_queue_sema; -+ /* _sema cmd_done_sema; */ -+ /*_sema terminate_cmdthread_sema;*/ -+ _sema start_cmdthread_sema; -+ _completion cmdthread_comp; -+ _queue cmd_queue; -+ u8 cmd_seq; -+ u8 *cmd_buf; /* shall be non-paged, and 4 bytes aligned */ -+ u8 *cmd_allocated_buf; -+ u8 *rsp_buf; /* shall be non-paged, and 4 bytes aligned */ -+ u8 *rsp_allocated_buf; -+ u32 cmd_issued_cnt; -+ u32 cmd_done_cnt; -+ u32 rsp_cnt; -+ ATOMIC_T cmdthd_running; -+ /* u8 cmdthd_running; */ -+ u8 stop_req; -+ _adapter *padapter; -+ _mutex sctx_mutex; -+}; -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+struct evt_obj { -+ u16 evtcode; -+ u8 res; -+ u8 *parmbuf; -+ u32 evtsz; -+ _list list; -+}; -+#endif -+ -+struct evt_priv { -+#ifdef CONFIG_EVENT_THREAD_MODE -+ _sema evt_notify; -+ _sema terminate_evtthread_sema; -+ _queue evt_queue; -+#endif -+ -+#ifdef CONFIG_FW_C2H_REG -+ #define CONFIG_C2H_WK -+#endif -+ -+#ifdef CONFIG_C2H_WK -+ _workitem c2h_wk; -+ bool c2h_wk_alive; -+ struct rtw_cbuf *c2h_queue; -+ #define C2H_QUEUE_MAX_LEN 10 -+#endif -+ -+#ifdef CONFIG_H2CLBK -+ _sema lbkevt_done; -+ u8 lbkevt_limit; -+ u8 lbkevt_num; -+ u8 *cmdevt_parm; -+#endif -+ ATOMIC_T event_seq; -+ u8 *evt_buf; /* shall be non-paged, and 4 bytes aligned */ -+ u8 *evt_allocated_buf; -+ u32 evt_done_cnt; -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ u8 *c2h_mem; -+ u8 *allocated_c2h_mem; -+#ifdef PLATFORM_OS_XP -+ PMDL pc2h_mdl; -+#endif -+#endif -+ -+}; -+ -+#define init_h2fwcmd_w_parm_no_rsp(pcmd, pparm, code) \ -+ do {\ -+ _rtw_init_listhead(&pcmd->list);\ -+ pcmd->cmdcode = code;\ -+ pcmd->parmbuf = (u8 *)(pparm);\ -+ pcmd->cmdsz = sizeof (*pparm);\ -+ pcmd->rsp = NULL;\ -+ pcmd->rspsz = 0;\ -+ } while (0) -+ -+#define init_h2fwcmd_w_parm_no_parm_rsp(pcmd, code) \ -+ do {\ -+ _rtw_init_listhead(&pcmd->list);\ -+ pcmd->cmdcode = code;\ -+ pcmd->parmbuf = NULL;\ -+ pcmd->cmdsz = 0;\ -+ pcmd->rsp = NULL;\ -+ pcmd->rspsz = 0;\ -+ } while (0) -+ -+struct P2P_PS_Offload_t { -+ u8 Offload_En:1; -+ u8 role:1; /* 1: Owner, 0: Client */ -+ u8 CTWindow_En:1; -+ u8 NoA0_En:1; -+ u8 NoA1_En:1; -+ u8 AllStaSleep:1; /* Only valid in Owner */ -+ u8 discovery:1; -+ u8 rsvd:1; -+}; -+ -+struct P2P_PS_CTWPeriod_t { -+ u8 CTWPeriod; /* TU */ -+}; -+ -+#ifdef CONFIG_P2P_WOWLAN -+ -+struct P2P_WoWlan_Offload_t { -+ u8 Disconnect_Wkup_Drv:1; -+ u8 role:2; -+ u8 Wps_Config[2]; -+}; -+ -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+extern u32 rtw_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *obj); -+extern struct cmd_obj *rtw_dequeue_cmd(struct cmd_priv *pcmdpriv); -+extern void rtw_free_cmd_obj(struct cmd_obj *pcmd); -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+extern u32 rtw_enqueue_evt(struct evt_priv *pevtpriv, struct evt_obj *obj); -+extern struct evt_obj *rtw_dequeue_evt(_queue *queue); -+extern void rtw_free_evt_obj(struct evt_obj *pcmd); -+#endif -+ -+void rtw_stop_cmd_thread(_adapter *adapter); -+thread_return rtw_cmd_thread(thread_context context); -+ -+extern u32 rtw_init_cmd_priv(struct cmd_priv *pcmdpriv); -+extern void rtw_free_cmd_priv(struct cmd_priv *pcmdpriv); -+ -+extern u32 rtw_init_evt_priv(struct evt_priv *pevtpriv); -+extern void rtw_free_evt_priv(struct evt_priv *pevtpriv); -+extern void rtw_cmd_clr_isr(struct cmd_priv *pcmdpriv); -+extern void rtw_evt_notify_isr(struct evt_priv *pevtpriv); -+#ifdef CONFIG_P2P -+u8 p2p_protocol_wk_cmd(_adapter *padapter, int intCmdType); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+struct p2p_roch_parm { -+ u64 cookie; -+ struct wireless_dev *wdev; -+ struct ieee80211_channel ch; -+ enum nl80211_channel_type ch_type; -+ unsigned int duration; -+}; -+ -+u8 p2p_roch_cmd(_adapter *adapter -+ , u64 cookie, struct wireless_dev *wdev -+ , struct ieee80211_channel *ch, enum nl80211_channel_type ch_type -+ , unsigned int duration -+ , u8 flags -+); -+u8 p2p_cancel_roch_cmd(_adapter *adapter, u64 cookie, struct wireless_dev *wdev, u8 flags); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+#endif /* CONFIG_P2P */ -+ -+#else -+/* #include */ -+#endif /* CONFIG_RTL8711FW */ -+ -+enum rtw_drvextra_cmd_id { -+ NONE_WK_CID, -+ STA_MSTATUS_RPT_WK_CID, -+ DYNAMIC_CHK_WK_CID, -+ DM_CTRL_WK_CID, -+ PBC_POLLING_WK_CID, -+ POWER_SAVING_CTRL_WK_CID,/* IPS,AUTOSuspend */ -+ LPS_CTRL_WK_CID, -+ ANT_SELECT_WK_CID, -+ P2P_PS_WK_CID, -+ P2P_PROTO_WK_CID, -+ CHECK_HIQ_WK_CID,/* for softap mode, check hi queue if empty */ -+ INTEl_WIDI_WK_CID, -+ C2H_WK_CID, -+ RTP_TIMER_CFG_WK_CID, -+ RESET_SECURITYPRIV, /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ FREE_ASSOC_RESOURCES, /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ DM_IN_LPS_WK_CID, -+ DM_RA_MSK_WK_CID, /* add for STA update RAMask when bandwith change. */ -+ BEAMFORMING_WK_CID, -+ LPS_CHANGE_DTIM_CID, -+ BTINFO_WK_CID, -+ DFS_MASTER_WK_CID, -+ SESSION_TRACKER_WK_CID, -+ EN_HW_UPDATE_TSF_WK_CID, -+ TEST_H2C_CID, -+ CUSTOMER_STR_WK_CID, -+ MAX_WK_CID -+}; -+ -+enum LPS_CTRL_TYPE { -+ LPS_CTRL_SCAN = 0, -+ LPS_CTRL_JOINBSS = 1, -+ LPS_CTRL_CONNECT = 2, -+ LPS_CTRL_DISCONNECT = 3, -+ LPS_CTRL_SPECIAL_PACKET = 4, -+ LPS_CTRL_LEAVE = 5, -+ LPS_CTRL_TRAFFIC_BUSY = 6, -+ LPS_CTRL_TX_TRAFFIC_LEAVE = 7, -+ LPS_CTRL_RX_TRAFFIC_LEAVE = 8, -+ LPS_CTRL_ENTER = 9, -+ LPS_CTRL_LEAVE_CFG80211_PWRMGMT = 10, -+}; -+ -+enum STAKEY_TYPE { -+ GROUP_KEY = 0, -+ UNICAST_KEY = 1, -+ TDLS_KEY = 2, -+}; -+ -+enum RFINTFS { -+ SWSI, -+ HWSI, -+ HWPI, -+}; -+ -+/* -+Caller Mode: Infra, Ad-HoC(C) -+ -+Notes: To enter USB suspend mode -+ -+Command Mode -+ -+*/ -+struct usb_suspend_parm { -+ u32 action;/* 1: sleep, 0:resume */ -+}; -+ -+/* -+Caller Mode: Infra, Ad-HoC -+ -+Notes: To join a known BSS. -+ -+Command-Event Mode -+ -+*/ -+ -+/* -+Caller Mode: Infra, Ad-Hoc -+ -+Notes: To join the specified bss -+ -+Command Event Mode -+ -+*/ -+struct joinbss_parm { -+ WLAN_BSSID_EX network; -+}; -+ -+/* -+Caller Mode: Infra, Ad-HoC(C) -+ -+Notes: To disconnect the current associated BSS -+ -+Command Mode -+ -+*/ -+struct disconnect_parm { -+ u32 deauth_timeout_ms; -+}; -+ -+/* -+Caller Mode: AP, Ad-HoC(M) -+ -+Notes: To create a BSS -+ -+Command Mode -+*/ -+struct createbss_parm { -+ bool adhoc; -+ -+ /* used by AP mode now */ -+ s16 req_ch; -+ s8 req_bw; -+ s8 req_offset; -+}; -+ -+#if 0 -+/* Caller Mode: AP, Ad-HoC, Infra */ -+/* Notes: To set the NIC mode of RTL8711 */ -+/* Command Mode */ -+/* The definition of mode: */ -+ -+#define IW_MODE_AUTO 0 /* Let the driver decides which AP to join */ -+#define IW_MODE_ADHOC 1 /* Single cell network (Ad-Hoc Clients) */ -+#define IW_MODE_INFRA 2 /* Multi cell network, roaming, .. */ -+#define IW_MODE_MASTER 3 /* Synchronisation master or Access Point */ -+#define IW_MODE_REPEAT 4 /* Wireless Repeater (forwarder) */ -+#define IW_MODE_SECOND 5 /* Secondary master/repeater (backup) */ -+#define IW_MODE_MONITOR 6 /* Passive monitor (listen only) */ -+#endif -+ -+struct setopmode_parm { -+ u8 mode; -+ u8 rsvd[3]; -+}; -+ -+/* -+Caller Mode: AP, Ad-HoC, Infra -+ -+Notes: To ask RTL8711 performing site-survey -+ -+Command-Event Mode -+ -+*/ -+ -+#define RTW_SSID_SCAN_AMOUNT 9 /* for WEXT_CSCAN_AMOUNT 9 */ -+#define RTW_CHANNEL_SCAN_AMOUNT (14+37) -+struct sitesurvey_parm { -+ sint scan_mode; /* active: 1, passive: 0 */ -+ /* sint bsslimit; // 1 ~ 48 */ -+ u8 ssid_num; -+ u8 ch_num; -+ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; -+ struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To set the auth type of RTL8711. open/shared/802.1x -+ -+Command Mode -+ -+*/ -+struct setauth_parm { -+ u8 mode; /* 0: legacy open, 1: legacy shared 2: 802.1x */ -+ u8 _1x; /* 0: PSK, 1: TLS */ -+ u8 rsvd[2]; -+}; -+ -+/* -+Caller Mode: Infra -+ -+a. algorithm: wep40, wep104, tkip & aes -+b. keytype: grp key/unicast key -+c. key contents -+ -+when shared key ==> keyid is the camid -+when 802.1x ==> keyid [0:1] ==> grp key -+when 802.1x ==> keyid > 2 ==> unicast key -+ -+*/ -+struct setkey_parm { -+ u8 algorithm; /* encryption algorithm, could be none, wep40, TKIP, CCMP, wep104 */ -+ u8 keyid; -+ u8 grpkey; /* 1: this is the grpkey for 802.1x. 0: this is the unicast key for 802.1x */ -+ u8 set_tx; /* 1: main tx key for wep. 0: other key. */ -+ u8 key[16]; /* this could be 40 or 104 */ -+}; -+ -+/* -+When in AP or Ad-Hoc mode, this is used to -+allocate an sw/hw entry for a newly associated sta. -+ -+Command -+ -+when shared key ==> algorithm/keyid -+ -+*/ -+struct set_stakey_parm { -+ u8 addr[ETH_ALEN]; -+ u8 algorithm; -+ u8 keyid; -+ u8 key[16]; -+}; -+ -+struct set_stakey_rsp { -+ u8 addr[ETH_ALEN]; -+ u8 keyid; -+ u8 rsvd; -+}; -+ -+/* -+Caller Ad-Hoc/AP -+ -+Command -Rsp(AID == CAMID) mode -+ -+This is to force fw to add an sta_data entry per driver's request. -+ -+FW will write an cam entry associated with it. -+ -+*/ -+struct set_assocsta_parm { -+ u8 addr[ETH_ALEN]; -+}; -+ -+struct set_assocsta_rsp { -+ u8 cam_id; -+ u8 rsvd[3]; -+}; -+ -+/* -+ Caller Ad-Hoc/AP -+ Command mode -+ This is to force fw to del an sta_data entry per driver's request -+ FW will invalidate the cam entry associated with it. -+*/ -+struct del_assocsta_parm { -+ u8 addr[ETH_ALEN]; -+}; -+ -+/* -+Caller Mode: AP/Ad-HoC(M) -+ -+Notes: To notify fw that given staid has changed its power state -+ -+Command Mode -+ -+*/ -+struct setstapwrstate_parm { -+ u8 staid; -+ u8 status; -+ u8 hwaddr[6]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To setup the basic rate of RTL8711 -+ -+Command Mode -+ -+*/ -+struct setbasicrate_parm { -+ u8 basicrates[NumRates]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To read the current basic rate -+ -+Command-Rsp Mode -+ -+*/ -+struct getbasicrate_parm { -+ u32 rsvd; -+}; -+ -+struct getbasicrate_rsp { -+ u8 basicrates[NumRates]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To setup the data rate of RTL8711 -+ -+Command Mode -+ -+*/ -+struct setdatarate_parm { -+#ifdef MP_FIRMWARE_OFFLOAD -+ u32 curr_rateidx; -+#else -+ u8 mac_id; -+ u8 datarates[NumRates]; -+#endif -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To read the current data rate -+ -+Command-Rsp Mode -+ -+*/ -+struct getdatarate_parm { -+ u32 rsvd; -+ -+}; -+struct getdatarate_rsp { -+ u8 datarates[NumRates]; -+}; -+ -+ -+/* -+Caller Mode: Any -+AP: AP can use the info for the contents of beacon frame -+Infra: STA can use the info when sitesurveying -+Ad-HoC(M): Like AP -+Ad-HoC(C): Like STA -+ -+ -+Notes: To set the phy capability of the NIC -+ -+Command Mode -+ -+*/ -+ -+struct setphyinfo_parm { -+ struct regulatory_class class_sets[NUM_REGULATORYS]; -+ u8 status; -+}; -+ -+struct getphyinfo_parm { -+ u32 rsvd; -+}; -+ -+struct getphyinfo_rsp { -+ struct regulatory_class class_sets[NUM_REGULATORYS]; -+ u8 status; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To set the channel/modem/band -+This command will be used when channel/modem/band is changed. -+ -+Command Mode -+ -+*/ -+struct setphy_parm { -+ u8 rfchannel; -+ u8 modem; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To get the current setting of channel/modem/band -+ -+Command-Rsp Mode -+ -+*/ -+struct getphy_parm { -+ u32 rsvd; -+ -+}; -+struct getphy_rsp { -+ u8 rfchannel; -+ u8 modem; -+}; -+ -+struct readBB_parm { -+ u8 offset; -+}; -+struct readBB_rsp { -+ u8 value; -+}; -+ -+struct readTSSI_parm { -+ u8 offset; -+}; -+struct readTSSI_rsp { -+ u8 value; -+}; -+ -+struct readMAC_parm { -+ u8 len; -+ u32 addr; -+}; -+ -+struct writeBB_parm { -+ u8 offset; -+ u8 value; -+}; -+ -+struct readRF_parm { -+ u8 offset; -+}; -+struct readRF_rsp { -+ u32 value; -+}; -+ -+struct writeRF_parm { -+ u32 offset; -+ u32 value; -+}; -+ -+struct getrfintfs_parm { -+ u8 rfintfs; -+}; -+ -+ -+struct Tx_Beacon_param { -+ WLAN_BSSID_EX network; -+}; -+ -+/* -+ Notes: This command is used for H2C/C2H loopback testing -+ -+ mac[0] == 0 -+ ==> CMD mode, return H2C_SUCCESS. -+ The following condition must be ture under CMD mode -+ mac[1] == mac[4], mac[2] == mac[3], mac[0]=mac[5]= 0; -+ s0 == 0x1234, s1 == 0xabcd, w0 == 0x78563412, w1 == 0x5aa5def7; -+ s2 == (b1 << 8 | b0); -+ -+ mac[0] == 1 -+ ==> CMD_RSP mode, return H2C_SUCCESS_RSP -+ -+ The rsp layout shall be: -+ rsp: parm: -+ mac[0] = mac[5]; -+ mac[1] = mac[4]; -+ mac[2] = mac[3]; -+ mac[3] = mac[2]; -+ mac[4] = mac[1]; -+ mac[5] = mac[0]; -+ s0 = s1; -+ s1 = swap16(s0); -+ w0 = swap32(w1); -+ b0 = b1 -+ s2 = s0 + s1 -+ b1 = b0 -+ w1 = w0 -+ -+ mac[0] == 2 -+ ==> CMD_EVENT mode, return H2C_SUCCESS -+ The event layout shall be: -+ event: parm: -+ mac[0] = mac[5]; -+ mac[1] = mac[4]; -+ mac[2] = event's sequence number, starting from 1 to parm's marc[3] -+ mac[3] = mac[2]; -+ mac[4] = mac[1]; -+ mac[5] = mac[0]; -+ s0 = swap16(s0) - event.mac[2]; -+ s1 = s1 + event.mac[2]; -+ w0 = swap32(w0); -+ b0 = b1 -+ s2 = s0 + event.mac[2] -+ b1 = b0 -+ w1 = swap32(w1) - event.mac[2]; -+ -+ parm->mac[3] is the total event counts that host requested. -+ -+ -+ event will be the same with the cmd's param. -+ -+*/ -+ -+#ifdef CONFIG_H2CLBK -+ -+struct seth2clbk_parm { -+ u8 mac[6]; -+ u16 s0; -+ u16 s1; -+ u32 w0; -+ u8 b0; -+ u16 s2; -+ u8 b1; -+ u32 w1; -+}; -+ -+struct geth2clbk_parm { -+ u32 rsv; -+}; -+ -+struct geth2clbk_rsp { -+ u8 mac[6]; -+ u16 s0; -+ u16 s1; -+ u32 w0; -+ u8 b0; -+ u16 s2; -+ u8 b1; -+ u32 w1; -+}; -+ -+#endif /* CONFIG_H2CLBK */ -+ -+/* CMD param Formart for driver extra cmd handler */ -+struct drvextra_cmd_parm { -+ int ec_id; /* extra cmd id */ -+ int type; /* Can use this field as the type id or command size */ -+ int size; /* buffer size */ -+ unsigned char *pbuf; -+}; -+ -+/*------------------- Below are used for RF/BB tunning ---------------------*/ -+ -+struct setantenna_parm { -+ u8 tx_antset; -+ u8 rx_antset; -+ u8 tx_antenna; -+ u8 rx_antenna; -+}; -+ -+struct enrateadaptive_parm { -+ u32 en; -+}; -+ -+struct settxagctbl_parm { -+ u32 txagc[MAX_RATES_LENGTH]; -+}; -+ -+struct gettxagctbl_parm { -+ u32 rsvd; -+}; -+struct gettxagctbl_rsp { -+ u32 txagc[MAX_RATES_LENGTH]; -+}; -+ -+struct setagcctrl_parm { -+ u32 agcctrl; /* 0: pure hw, 1: fw */ -+}; -+ -+ -+struct setssup_parm { -+ u32 ss_ForceUp[MAX_RATES_LENGTH]; -+}; -+ -+struct getssup_parm { -+ u32 rsvd; -+}; -+struct getssup_rsp { -+ u8 ss_ForceUp[MAX_RATES_LENGTH]; -+}; -+ -+ -+struct setssdlevel_parm { -+ u8 ss_DLevel[MAX_RATES_LENGTH]; -+}; -+ -+struct getssdlevel_parm { -+ u32 rsvd; -+}; -+struct getssdlevel_rsp { -+ u8 ss_DLevel[MAX_RATES_LENGTH]; -+}; -+ -+struct setssulevel_parm { -+ u8 ss_ULevel[MAX_RATES_LENGTH]; -+}; -+ -+struct getssulevel_parm { -+ u32 rsvd; -+}; -+struct getssulevel_rsp { -+ u8 ss_ULevel[MAX_RATES_LENGTH]; -+}; -+ -+ -+struct setcountjudge_parm { -+ u8 count_judge[MAX_RATES_LENGTH]; -+}; -+ -+struct getcountjudge_parm { -+ u32 rsvd; -+}; -+struct getcountjudge_rsp { -+ u8 count_judge[MAX_RATES_LENGTH]; -+}; -+ -+ -+struct setratable_parm { -+ u8 ss_ForceUp[NumRates]; -+ u8 ss_ULevel[NumRates]; -+ u8 ss_DLevel[NumRates]; -+ u8 count_judge[NumRates]; -+}; -+ -+struct getratable_parm { -+ uint rsvd; -+}; -+struct getratable_rsp { -+ u8 ss_ForceUp[NumRates]; -+ u8 ss_ULevel[NumRates]; -+ u8 ss_DLevel[NumRates]; -+ u8 count_judge[NumRates]; -+}; -+ -+ -+/* to get TX,RX retry count */ -+struct gettxretrycnt_parm { -+ unsigned int rsvd; -+}; -+struct gettxretrycnt_rsp { -+ unsigned long tx_retrycnt; -+}; -+ -+struct getrxretrycnt_parm { -+ unsigned int rsvd; -+}; -+struct getrxretrycnt_rsp { -+ unsigned long rx_retrycnt; -+}; -+ -+/* to get BCNOK,BCNERR count */ -+struct getbcnokcnt_parm { -+ unsigned int rsvd; -+}; -+struct getbcnokcnt_rsp { -+ unsigned long bcnokcnt; -+}; -+ -+struct getbcnerrcnt_parm { -+ unsigned int rsvd; -+}; -+struct getbcnerrcnt_rsp { -+ unsigned long bcnerrcnt; -+}; -+ -+/* to get current TX power level */ -+struct getcurtxpwrlevel_parm { -+ unsigned int rsvd; -+}; -+struct getcurtxpwrlevel_rsp { -+ unsigned short tx_power; -+}; -+ -+struct setprobereqextraie_parm { -+ unsigned char e_id; -+ unsigned char ie_len; -+ unsigned char ie[0]; -+}; -+ -+struct setassocreqextraie_parm { -+ unsigned char e_id; -+ unsigned char ie_len; -+ unsigned char ie[0]; -+}; -+ -+struct setproberspextraie_parm { -+ unsigned char e_id; -+ unsigned char ie_len; -+ unsigned char ie[0]; -+}; -+ -+struct setassocrspextraie_parm { -+ unsigned char e_id; -+ unsigned char ie_len; -+ unsigned char ie[0]; -+}; -+ -+ -+struct addBaReq_parm { -+ unsigned int tid; -+ u8 addr[ETH_ALEN]; -+}; -+ -+struct addBaRsp_parm { -+ unsigned int tid; -+ unsigned int start_seq; -+ u8 addr[ETH_ALEN]; -+ u8 status; -+ u8 size; -+}; -+ -+/*H2C Handler index: 46 */ -+struct set_ch_parm { -+ u8 ch; -+ u8 bw; -+ u8 ch_offset; -+}; -+ -+#ifdef MP_FIRMWARE_OFFLOAD -+/*H2C Handler index: 47 */ -+struct SetTxPower_parm { -+ u8 TxPower; -+}; -+ -+/*H2C Handler index: 48 */ -+struct SwitchAntenna_parm { -+ u16 antenna_tx; -+ u16 antenna_rx; -+ /* R_ANTENNA_SELECT_CCK cck_txrx; */ -+ u8 cck_txrx; -+}; -+ -+/*H2C Handler index: 49 */ -+struct SetCrystalCap_parm { -+ u32 curr_crystalcap; -+}; -+ -+/*H2C Handler index: 50 */ -+struct SetSingleCarrierTx_parm { -+ u8 bStart; -+}; -+ -+/*H2C Handler index: 51 */ -+struct SetSingleToneTx_parm { -+ u8 bStart; -+ u8 curr_rfpath; -+}; -+ -+/*H2C Handler index: 52 */ -+struct SetCarrierSuppressionTx_parm { -+ u8 bStart; -+ u32 curr_rateidx; -+}; -+ -+/*H2C Handler index: 53 */ -+struct SetContinuousTx_parm { -+ u8 bStart; -+ u8 CCK_flag; /*1:CCK 2:OFDM*/ -+ u32 curr_rateidx; -+}; -+ -+/*H2C Handler index: 54 */ -+struct SwitchBandwidth_parm { -+ u8 curr_bandwidth; -+}; -+ -+#endif /* MP_FIRMWARE_OFFLOAD */ -+ -+/*H2C Handler index: 59 */ -+struct SetChannelPlan_param { -+ const struct country_chplan *country_ent; -+ u8 channel_plan; -+}; -+ -+/*H2C Handler index: 60 */ -+struct LedBlink_param { -+ PVOID pLed; -+}; -+ -+/*H2C Handler index: 61 */ -+struct SetChannelSwitch_param { -+ u8 new_ch_no; -+}; -+ -+/*H2C Handler index: 62 */ -+struct TDLSoption_param { -+ u8 addr[ETH_ALEN]; -+ u8 option; -+}; -+ -+/*H2C Handler index: 64 */ -+struct RunInThread_param { -+ void (*func)(void *); -+ void *context; -+}; -+ -+ -+#define GEN_CMD_CODE(cmd) cmd ## _CMD_ -+ -+ -+/* -+ -+Result: -+0x00: success -+0x01: sucess, and check Response. -+0x02: cmd ignored due to duplicated sequcne number -+0x03: cmd dropped due to invalid cmd code -+0x04: reserved. -+ -+*/ -+ -+#define H2C_RSP_OFFSET 512 -+ -+#define H2C_SUCCESS 0x00 -+#define H2C_SUCCESS_RSP 0x01 -+#define H2C_DUPLICATED 0x02 -+#define H2C_DROPPED 0x03 -+#define H2C_PARAMETERS_ERROR 0x04 -+#define H2C_REJECTED 0x05 -+#define H2C_CMD_OVERFLOW 0x06 -+#define H2C_RESERVED 0x07 -+#define H2C_ENQ_HEAD 0x08 -+#define H2C_ENQ_HEAD_FAIL 0x09 -+ -+extern u8 rtw_setassocsta_cmd(_adapter *padapter, u8 *mac_addr); -+extern u8 rtw_setstandby_cmd(_adapter *padapter, uint action); -+u8 rtw_sitesurvey_cmd(_adapter *padapter, NDIS_802_11_SSID *ssid, int ssid_num, struct rtw_ieee80211_channel *ch, int ch_num); -+ -+u8 rtw_create_ibss_cmd(_adapter *adapter, int flags); -+u8 rtw_startbss_cmd(_adapter *adapter, int flags); -+u8 rtw_change_bss_chbw_cmd(_adapter *adapter, int flags, s16 req_ch, s8 req_bw, s8 req_offset); -+ -+extern u8 rtw_setphy_cmd(_adapter *padapter, u8 modem, u8 ch); -+ -+struct sta_info; -+extern u8 rtw_setstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 key_type, bool enqueue); -+extern u8 rtw_clearstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 enqueue); -+ -+extern u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork); -+u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, bool enqueue); -+extern u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, bool enqueue); -+extern u8 rtw_setdatarate_cmd(_adapter *padapter, u8 *rateset); -+extern u8 rtw_setbasicrate_cmd(_adapter *padapter, u8 *rateset); -+extern u8 rtw_getmacreg_cmd(_adapter *padapter, u8 len, u32 addr); -+extern void rtw_usb_catc_trigger_cmd(_adapter *padapter, const char *caller); -+extern u8 rtw_setbbreg_cmd(_adapter *padapter, u8 offset, u8 val); -+extern u8 rtw_setrfreg_cmd(_adapter *padapter, u8 offset, u32 val); -+extern u8 rtw_getbbreg_cmd(_adapter *padapter, u8 offset, u8 *pval); -+extern u8 rtw_getrfreg_cmd(_adapter *padapter, u8 offset, u8 *pval); -+extern u8 rtw_setrfintfs_cmd(_adapter *padapter, u8 mode); -+extern u8 rtw_setrttbl_cmd(_adapter *padapter, struct setratable_parm *prate_table); -+extern u8 rtw_getrttbl_cmd(_adapter *padapter, struct getratable_rsp *pval); -+ -+extern u8 rtw_gettssi_cmd(_adapter *padapter, u8 offset, u8 *pval); -+extern u8 rtw_setfwdig_cmd(_adapter *padapter, u8 type); -+extern u8 rtw_setfwra_cmd(_adapter *padapter, u8 type); -+ -+extern u8 rtw_addbareq_cmd(_adapter *padapter, u8 tid, u8 *addr); -+extern u8 rtw_addbarsp_cmd(_adapter *padapter, u8 *addr, u16 tid, u8 status, u8 size, u16 start_seq); -+/* add for CONFIG_IEEE80211W, none 11w also can use */ -+extern u8 rtw_reset_securitypriv_cmd(_adapter *padapter); -+extern u8 rtw_free_assoc_resources_cmd(_adapter *padapter); -+extern u8 rtw_dynamic_chk_wk_cmd(_adapter *adapter); -+ -+u8 rtw_lps_ctrl_wk_cmd(_adapter *padapter, u8 lps_ctrl_type, u8 enqueue); -+u8 rtw_dm_in_lps_wk_cmd(_adapter *padapter); -+u8 rtw_lps_change_dtim_cmd(_adapter *padapter, u8 dtim); -+ -+#if (RATE_ADAPTIVE_SUPPORT == 1) -+u8 rtw_rpt_timer_cfg_cmd(_adapter *padapter, u16 minRptTime); -+#endif -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+extern u8 rtw_antenna_select_cmd(_adapter *padapter, u8 antenna, u8 enqueue); -+#endif -+ -+u8 rtw_dm_ra_mask_wk_cmd(_adapter *padapter, u8 *psta); -+ -+extern u8 rtw_ps_cmd(_adapter *padapter); -+ -+#ifdef CONFIG_AP_MODE -+u8 rtw_chk_hi_queue_cmd(_adapter *padapter); -+#ifdef CONFIG_DFS_MASTER -+u8 rtw_dfs_master_cmd(_adapter *adapter, bool enqueue); -+void rtw_dfs_master_timer_hdl(RTW_TIMER_HDL_ARGS); -+void rtw_dfs_master_enable(_adapter *adapter, u8 ch, u8 bw, u8 offset); -+void rtw_dfs_master_disable(_adapter *adapter, u8 ch, u8 bw, u8 offset, bool by_others); -+enum { -+ MLME_STA_CONNECTING, -+ MLME_STA_CONNECTED, -+ MLME_STA_DISCONNECTED, -+ MLME_AP_STARTED, -+ MLME_AP_STOPPED, -+}; -+void rtw_dfs_master_status_apply(_adapter *adapter, u8 self_action); -+#endif /* CONFIG_DFS_MASTER */ -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_BT_COEXIST -+u8 rtw_btinfo_cmd(PADAPTER padapter, u8 *pbuf, u16 length); -+#endif -+ -+u8 rtw_test_h2c_cmd(_adapter *adapter, u8 *buf, u8 len); -+ -+u8 rtw_enable_hw_update_tsf_cmd(_adapter *padapter); -+ -+u8 rtw_set_ch_cmd(_adapter *padapter, u8 ch, u8 bw, u8 ch_offset, u8 enqueue); -+ -+u8 rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, u8 swconfig); -+u8 rtw_set_country_cmd(_adapter *adapter, int flags, const char *country_code, u8 swconfig); -+ -+extern u8 rtw_led_blink_cmd(_adapter *padapter, PVOID pLed); -+extern u8 rtw_set_csa_cmd(_adapter *padapter, u8 new_ch_no); -+extern u8 rtw_tdls_cmd(_adapter *padapter, u8 *addr, u8 option); -+ -+#ifdef CONFIG_RTW_CUSTOMER_STR -+u8 rtw_customer_str_req_cmd(_adapter *adapter); -+u8 rtw_customer_str_write_cmd(_adapter *adapter, const u8 *cstr); -+#endif -+ -+#ifdef CONFIG_FW_C2H_REG -+u8 rtw_c2h_reg_wk_cmd(_adapter *adapter, u8 *c2h_evt); -+#endif -+#ifdef CONFIG_FW_C2H_PKT -+u8 rtw_c2h_packet_wk_cmd(_adapter *adapter, u8 *c2h_evt, u16 length); -+#endif -+ -+u8 rtw_run_in_thread_cmd(PADAPTER padapter, void (*func)(void *), void *context); -+ -+u8 session_tracker_chk_cmd(_adapter *adapter, struct sta_info *sta); -+u8 session_tracker_add_cmd(_adapter *adapter, struct sta_info *sta, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port); -+u8 session_tracker_del_cmd(_adapter *adapter, struct sta_info *sta, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port); -+ -+u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf); -+ -+extern void rtw_survey_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_disassoc_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_joinbss_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); -+void rtw_create_ibss_post_hdl(_adapter *padapter, int status); -+extern void rtw_getbbrfreg_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_readtssi_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+ -+extern void rtw_setstaKey_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_setassocsta_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_getrttbl_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_getmacreg_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+ -+ -+struct _cmd_callback { -+ u32 cmd_code; -+ void (*callback)(_adapter *padapter, struct cmd_obj *cmd); -+}; -+ -+enum rtw_h2c_cmd { -+ GEN_CMD_CODE(_Read_MACREG) , /*0*/ -+ GEN_CMD_CODE(_Write_MACREG) , -+ GEN_CMD_CODE(_Read_BBREG) , -+ GEN_CMD_CODE(_Write_BBREG) , -+ GEN_CMD_CODE(_Read_RFREG) , -+ GEN_CMD_CODE(_Write_RFREG) , /*5*/ -+ GEN_CMD_CODE(_Read_EEPROM) , -+ GEN_CMD_CODE(_Write_EEPROM) , -+ GEN_CMD_CODE(_Read_EFUSE) , -+ GEN_CMD_CODE(_Write_EFUSE) , -+ -+ GEN_CMD_CODE(_Read_CAM) , /*10*/ -+ GEN_CMD_CODE(_Write_CAM) , -+ GEN_CMD_CODE(_setBCNITV), -+ GEN_CMD_CODE(_setMBIDCFG), -+ GEN_CMD_CODE(_JoinBss), /*14*/ -+ GEN_CMD_CODE(_DisConnect) , /*15*/ -+ GEN_CMD_CODE(_CreateBss) , -+ GEN_CMD_CODE(_SetOpMode) , -+ GEN_CMD_CODE(_SiteSurvey), /*18*/ -+ GEN_CMD_CODE(_SetAuth) , -+ -+ GEN_CMD_CODE(_SetKey) , /*20*/ -+ GEN_CMD_CODE(_SetStaKey) , -+ GEN_CMD_CODE(_SetAssocSta) , -+ GEN_CMD_CODE(_DelAssocSta) , -+ GEN_CMD_CODE(_SetStaPwrState) , -+ GEN_CMD_CODE(_SetBasicRate) , /*25*/ -+ GEN_CMD_CODE(_GetBasicRate) , -+ GEN_CMD_CODE(_SetDataRate) , -+ GEN_CMD_CODE(_GetDataRate) , -+ GEN_CMD_CODE(_SetPhyInfo) , -+ -+ GEN_CMD_CODE(_GetPhyInfo) , /*30*/ -+ GEN_CMD_CODE(_SetPhy) , -+ GEN_CMD_CODE(_GetPhy) , -+ GEN_CMD_CODE(_readRssi) , -+ GEN_CMD_CODE(_readGain) , -+ GEN_CMD_CODE(_SetAtim) , /*35*/ -+ GEN_CMD_CODE(_SetPwrMode) , -+ GEN_CMD_CODE(_JoinbssRpt), -+ GEN_CMD_CODE(_SetRaTable) , -+ GEN_CMD_CODE(_GetRaTable) , -+ -+ GEN_CMD_CODE(_GetCCXReport), /*40*/ -+ GEN_CMD_CODE(_GetDTMReport), -+ GEN_CMD_CODE(_GetTXRateStatistics), -+ GEN_CMD_CODE(_SetUsbSuspend), -+ GEN_CMD_CODE(_SetH2cLbk), -+ GEN_CMD_CODE(_AddBAReq) , /*45*/ -+ GEN_CMD_CODE(_SetChannel), /*46*/ -+ GEN_CMD_CODE(_SetTxPower), -+ GEN_CMD_CODE(_SwitchAntenna), -+ GEN_CMD_CODE(_SetCrystalCap), -+ GEN_CMD_CODE(_SetSingleCarrierTx), /*50*/ -+ -+ GEN_CMD_CODE(_SetSingleToneTx),/*51*/ -+ GEN_CMD_CODE(_SetCarrierSuppressionTx), -+ GEN_CMD_CODE(_SetContinuousTx), -+ GEN_CMD_CODE(_SwitchBandwidth), /*54*/ -+ GEN_CMD_CODE(_TX_Beacon), /*55*/ -+ -+ GEN_CMD_CODE(_Set_MLME_EVT), /*56*/ -+ GEN_CMD_CODE(_Set_Drv_Extra), /*57*/ -+ GEN_CMD_CODE(_Set_H2C_MSG), /*58*/ -+ -+ GEN_CMD_CODE(_SetChannelPlan), /*59*/ -+ GEN_CMD_CODE(_LedBlink), /*60*/ -+ -+ GEN_CMD_CODE(_SetChannelSwitch), /*61*/ -+ GEN_CMD_CODE(_TDLS), /*62*/ -+ GEN_CMD_CODE(_ChkBMCSleepq), /*63*/ -+ -+ GEN_CMD_CODE(_RunInThreadCMD), /*64*/ -+ GEN_CMD_CODE(_AddBARsp) , /*65*/ -+ -+ MAX_H2CCMD -+}; -+ -+#define _GetMACReg_CMD_ _Read_MACREG_CMD_ -+#define _SetMACReg_CMD_ _Write_MACREG_CMD_ -+#define _GetBBReg_CMD_ _Read_BBREG_CMD_ -+#define _SetBBReg_CMD_ _Write_BBREG_CMD_ -+#define _GetRFReg_CMD_ _Read_RFREG_CMD_ -+#define _SetRFReg_CMD_ _Write_RFREG_CMD_ -+ -+#ifdef _RTW_CMD_C_ -+struct _cmd_callback rtw_cmd_callback[] = { -+ {GEN_CMD_CODE(_Read_MACREG), &rtw_getmacreg_cmdrsp_callback}, /*0*/ -+ {GEN_CMD_CODE(_Write_MACREG), NULL}, -+ {GEN_CMD_CODE(_Read_BBREG), &rtw_getbbrfreg_cmdrsp_callback}, -+ {GEN_CMD_CODE(_Write_BBREG), NULL}, -+ {GEN_CMD_CODE(_Read_RFREG), &rtw_getbbrfreg_cmdrsp_callback}, -+ {GEN_CMD_CODE(_Write_RFREG), NULL}, /*5*/ -+ {GEN_CMD_CODE(_Read_EEPROM), NULL}, -+ {GEN_CMD_CODE(_Write_EEPROM), NULL}, -+ {GEN_CMD_CODE(_Read_EFUSE), NULL}, -+ {GEN_CMD_CODE(_Write_EFUSE), NULL}, -+ -+ {GEN_CMD_CODE(_Read_CAM), NULL}, /*10*/ -+ {GEN_CMD_CODE(_Write_CAM), NULL}, -+ {GEN_CMD_CODE(_setBCNITV), NULL}, -+ {GEN_CMD_CODE(_setMBIDCFG), NULL}, -+ {GEN_CMD_CODE(_JoinBss), &rtw_joinbss_cmd_callback}, /*14*/ -+ {GEN_CMD_CODE(_DisConnect), &rtw_disassoc_cmd_callback}, /*15*/ -+ {GEN_CMD_CODE(_CreateBss), NULL}, -+ {GEN_CMD_CODE(_SetOpMode), NULL}, -+ {GEN_CMD_CODE(_SiteSurvey), &rtw_survey_cmd_callback}, /*18*/ -+ {GEN_CMD_CODE(_SetAuth), NULL}, -+ -+ {GEN_CMD_CODE(_SetKey), NULL}, /*20*/ -+ {GEN_CMD_CODE(_SetStaKey), &rtw_setstaKey_cmdrsp_callback}, -+ {GEN_CMD_CODE(_SetAssocSta), &rtw_setassocsta_cmdrsp_callback}, -+ {GEN_CMD_CODE(_DelAssocSta), NULL}, -+ {GEN_CMD_CODE(_SetStaPwrState), NULL}, -+ {GEN_CMD_CODE(_SetBasicRate), NULL}, /*25*/ -+ {GEN_CMD_CODE(_GetBasicRate), NULL}, -+ {GEN_CMD_CODE(_SetDataRate), NULL}, -+ {GEN_CMD_CODE(_GetDataRate), NULL}, -+ {GEN_CMD_CODE(_SetPhyInfo), NULL}, -+ -+ {GEN_CMD_CODE(_GetPhyInfo), NULL}, /*30*/ -+ {GEN_CMD_CODE(_SetPhy), NULL}, -+ {GEN_CMD_CODE(_GetPhy), NULL}, -+ {GEN_CMD_CODE(_readRssi), NULL}, -+ {GEN_CMD_CODE(_readGain), NULL}, -+ {GEN_CMD_CODE(_SetAtim), NULL}, /*35*/ -+ {GEN_CMD_CODE(_SetPwrMode), NULL}, -+ {GEN_CMD_CODE(_JoinbssRpt), NULL}, -+ {GEN_CMD_CODE(_SetRaTable), NULL}, -+ {GEN_CMD_CODE(_GetRaTable) , NULL}, -+ -+ {GEN_CMD_CODE(_GetCCXReport), NULL}, /*40*/ -+ {GEN_CMD_CODE(_GetDTMReport), NULL}, -+ {GEN_CMD_CODE(_GetTXRateStatistics), NULL}, -+ {GEN_CMD_CODE(_SetUsbSuspend), NULL}, -+ {GEN_CMD_CODE(_SetH2cLbk), NULL}, -+ {GEN_CMD_CODE(_AddBAReq), NULL}, /*45*/ -+ {GEN_CMD_CODE(_SetChannel), NULL}, /*46*/ -+ {GEN_CMD_CODE(_SetTxPower), NULL}, -+ {GEN_CMD_CODE(_SwitchAntenna), NULL}, -+ {GEN_CMD_CODE(_SetCrystalCap), NULL}, -+ {GEN_CMD_CODE(_SetSingleCarrierTx), NULL}, /*50*/ -+ -+ {GEN_CMD_CODE(_SetSingleToneTx), NULL}, /*51*/ -+ {GEN_CMD_CODE(_SetCarrierSuppressionTx), NULL}, -+ {GEN_CMD_CODE(_SetContinuousTx), NULL}, -+ {GEN_CMD_CODE(_SwitchBandwidth), NULL}, /*54*/ -+ {GEN_CMD_CODE(_TX_Beacon), NULL},/*55*/ -+ -+ {GEN_CMD_CODE(_Set_MLME_EVT), NULL},/*56*/ -+ {GEN_CMD_CODE(_Set_Drv_Extra), NULL},/*57*/ -+ {GEN_CMD_CODE(_Set_H2C_MSG), NULL},/*58*/ -+ {GEN_CMD_CODE(_SetChannelPlan), NULL},/*59*/ -+ {GEN_CMD_CODE(_LedBlink), NULL},/*60*/ -+ -+ {GEN_CMD_CODE(_SetChannelSwitch), NULL},/*61*/ -+ {GEN_CMD_CODE(_TDLS), NULL},/*62*/ -+ {GEN_CMD_CODE(_ChkBMCSleepq), NULL}, /*63*/ -+ -+ {GEN_CMD_CODE(_RunInThreadCMD), NULL},/*64*/ -+ {GEN_CMD_CODE(_AddBARsp), NULL}, /*65*/ -+}; -+#endif -+ -+#define CMD_FMT "cmd=%d,%d,%d" -+#define CMD_ARG(cmd) \ -+ (cmd)->cmdcode, \ -+ (cmd)->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra) ? ((struct drvextra_cmd_parm *)(cmd)->parmbuf)->ec_id : ((cmd)->cmdcode == GEN_CMD_CODE(_Set_MLME_EVT) ? ((struct C2HEvent_Header *)(cmd)->parmbuf)->ID : 0), \ -+ (cmd)->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra) ? ((struct drvextra_cmd_parm *)(cmd)->parmbuf)->type : 0 -+ -+#endif /* _CMD_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_debug.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_debug.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_debug.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_debug.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,599 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_DEBUG_H__ -+#define __RTW_DEBUG_H__ -+ -+/* driver log level*/ -+enum { -+ _DRV_NONE_ = 0, -+ _DRV_ALWAYS_ = 1, -+ _DRV_ERR_ = 2, -+ _DRV_WARNING_ = 3, -+ _DRV_INFO_ = 4, -+ _DRV_DEBUG_ = 5, -+ _DRV_MAX_ = 6 -+}; -+ -+#define DRIVER_PREFIX "RTW: " -+ -+#ifdef PLATFORM_OS_CE -+extern void rtl871x_cedbg(const char *fmt, ...); -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ #define RTW_PRINT do {} while (0) -+ #define RTW_ERR do {} while (0) -+ #define RTW_WARN do {} while (0) -+ #define RTW_INFO do {} while (0) -+ #define RTW_DBG do {} while (0) -+ #define RTW_PRINT_SEL do {} while (0) -+ #define _RTW_PRINT do {} while (0) -+ #define _RTW_ERR do {} while (0) -+ #define _RTW_WARN do {} while (0) -+ #define _RTW_INFO do {} while (0) -+ #define _RTW_DBG do {} while (0) -+ #define _RTW_PRINT_SEL do {} while (0) -+#else -+ #define RTW_PRINT(x, ...) do {} while (0) -+ #define RTW_ERR(x, ...) do {} while (0) -+ #define RTW_WARN(x,...) do {} while (0) -+ #define RTW_INFO(x,...) do {} while (0) -+ #define RTW_DBG(x,...) do {} while (0) -+ #define RTW_PRINT_SEL(x,...) do {} while (0) -+ #define _RTW_PRINT(x, ...) do {} while (0) -+ #define _RTW_ERR(x, ...) do {} while (0) -+ #define _RTW_WARN(x,...) do {} while (0) -+ #define _RTW_INFO(x,...) do {} while (0) -+ #define _RTW_DBG(x,...) do {} while (0) -+ #define _RTW_PRINT_SEL(x,...) do {} while (0) -+#endif -+ -+#define RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) -+#define RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) -+#define RTW_PRINT_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) -+#define _RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) -+#define _RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) -+ -+#define RTW_DBG_EXPR(EXPR) do {} while (0) -+ -+#define RTW_DBGDUMP 0 /* 'stream' for _dbgdump */ -+ -+/* don't use these 3 APIs anymore, will be removed later */ -+#define RT_TRACE(_Comp, _Level, Fmt) do {} while (0) -+ -+ -+#undef _dbgdump -+#undef _seqdump -+ -+#if defined(PLATFORM_WINDOWS) && defined(PLATFORM_OS_XP) -+ #define _dbgdump DbgPrint -+ #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) -+#elif defined(PLATFORM_WINDOWS) && defined(PLATFORM_OS_CE) -+ #define _dbgdump rtl871x_cedbg -+ #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) -+#elif defined PLATFORM_LINUX -+ #define _dbgdump printk -+ #define _seqdump seq_printf -+#elif defined PLATFORM_FREEBSD -+ #define _dbgdump printf -+ #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) -+#endif -+ -+#ifdef CONFIG_RTW_DEBUG -+ -+#ifndef _OS_INTFS_C_ -+extern uint rtw_drv_log_level; -+#endif -+ -+#if defined(_dbgdump) -+ -+/* with driver-defined prefix */ -+#undef RTW_PRINT -+#define RTW_PRINT(fmt, arg...) \ -+ do {\ -+ if (_DRV_ALWAYS_ <= rtw_drv_log_level) {\ -+ _dbgdump(DRIVER_PREFIX fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+#undef RTW_ERR -+#define RTW_ERR(fmt, arg...) \ -+ do {\ -+ if (_DRV_ERR_ <= rtw_drv_log_level) {\ -+ _dbgdump(DRIVER_PREFIX"ERROR " fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+ -+#undef RTW_WARN -+#define RTW_WARN(fmt, arg...) \ -+ do {\ -+ if (_DRV_WARNING_ <= rtw_drv_log_level) {\ -+ _dbgdump(DRIVER_PREFIX"WARN " fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+#undef RTW_INFO -+#define RTW_INFO(fmt, arg...) \ -+ do {\ -+ if (_DRV_INFO_ <= rtw_drv_log_level) {\ -+ _dbgdump(DRIVER_PREFIX fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+ -+#undef RTW_DBG -+#define RTW_DBG(fmt, arg...) \ -+ do {\ -+ if (_DRV_DEBUG_ <= rtw_drv_log_level) {\ -+ _dbgdump(DRIVER_PREFIX fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+ -+#undef RTW_INFO_DUMP -+#define RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) \ -+ do {\ -+ if (_DRV_INFO_ <= rtw_drv_log_level) { \ -+ int __i; \ -+ u8 *ptr = (u8 *)_HexData; \ -+ _dbgdump("%s", DRIVER_PREFIX); \ -+ _dbgdump(_TitleString); \ -+ for (__i = 0; __i < (int)_HexDataLen; __i++) { \ -+ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ -+ if (((__i + 1) % 16) == 0) \ -+ _dbgdump("\n"); \ -+ } \ -+ _dbgdump("\n"); \ -+ } \ -+ } while (0) -+ -+#undef RTW_DBG_DUMP -+#define RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) \ -+ do {\ -+ if (_DRV_DEBUG_ <= rtw_drv_log_level) { \ -+ int __i; \ -+ u8 *ptr = (u8 *)_HexData; \ -+ _dbgdump("%s", DRIVER_PREFIX); \ -+ _dbgdump(_TitleString); \ -+ for (__i = 0; __i < (int)_HexDataLen; __i++) { \ -+ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ -+ if (((__i + 1) % 16) == 0) \ -+ _dbgdump("\n"); \ -+ } \ -+ _dbgdump("\n"); \ -+ } \ -+ } while (0) -+ -+ -+#undef RTW_PRINT_DUMP -+#define RTW_PRINT_DUMP(_TitleString, _HexData, _HexDataLen) \ -+ do {\ -+ if (_DRV_ALWAYS_ <= rtw_drv_log_level) { \ -+ int __i; \ -+ u8 *ptr = (u8 *)_HexData; \ -+ _dbgdump("%s", DRIVER_PREFIX); \ -+ _dbgdump(_TitleString); \ -+ for (__i = 0; __i < (int)_HexDataLen; __i++) { \ -+ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ -+ if (((__i + 1) % 16) == 0) \ -+ _dbgdump("\n"); \ -+ } \ -+ _dbgdump("\n"); \ -+ } \ -+ } while (0) -+ -+/* without driver-defined prefix */ -+#undef _RTW_PRINT -+#define _RTW_PRINT(fmt, arg...) \ -+ do {\ -+ if (_DRV_ALWAYS_ <= rtw_drv_log_level) {\ -+ _dbgdump(fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+#undef _RTW_ERR -+#define _RTW_ERR(fmt, arg...) \ -+ do {\ -+ if (_DRV_ERR_ <= rtw_drv_log_level) {\ -+ _dbgdump(fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+ -+#undef _RTW_WARN -+#define _RTW_WARN(fmt, arg...) \ -+ do {\ -+ if (_DRV_WARNING_ <= rtw_drv_log_level) {\ -+ _dbgdump(fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+#undef _RTW_INFO -+#define _RTW_INFO(fmt, arg...) \ -+ do {\ -+ if (_DRV_INFO_ <= rtw_drv_log_level) {\ -+ _dbgdump(fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+#undef _RTW_DBG -+#define _RTW_DBG(fmt, arg...) \ -+ do {\ -+ if (_DRV_DEBUG_ <= rtw_drv_log_level) {\ -+ _dbgdump(fmt, ##arg);\ -+ } \ -+ } while (0) -+ -+ -+#undef _RTW_INFO_DUMP -+#define _RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) \ -+ if (_DRV_INFO_ <= rtw_drv_log_level) { \ -+ int __i; \ -+ u8 *ptr = (u8 *)_HexData; \ -+ _dbgdump(_TitleString); \ -+ for (__i = 0; __i<(int)_HexDataLen; __i++) \ -+ { \ -+ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ -+ if (((__i + 1) % 16) == 0) _dbgdump("\n"); \ -+ } \ -+ _dbgdump("\n"); \ -+ } -+ -+#undef _RTW_DBG_DUMP -+#define _RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) \ -+ if (_DRV_DEBUG_ <= rtw_drv_log_level) { \ -+ int __i; \ -+ u8 *ptr = (u8 *)_HexData; \ -+ _dbgdump(_TitleString); \ -+ for (__i = 0; __i<(int)_HexDataLen; __i++) \ -+ { \ -+ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ -+ if (((__i + 1) % 16) == 0) _dbgdump("\n"); \ -+ } \ -+ _dbgdump("\n"); \ -+ } -+ -+/* other debug APIs */ -+#undef RTW_DBG_EXPR -+#define RTW_DBG_EXPR(EXPR) do { if (_DRV_DEBUG_ <= rtw_drv_log_level) EXPR; } while (0) -+ -+#endif /* defined(_dbgdump) */ -+#endif /* CONFIG_RTW_DEBUG */ -+ -+ -+#if defined(_seqdump) -+/* dump message to selected 'stream' with driver-defined prefix */ -+#undef RTW_PRINT_SEL -+#define RTW_PRINT_SEL(sel, fmt, arg...) \ -+ do {\ -+ if (sel == RTW_DBGDUMP)\ -+ RTW_PRINT(fmt, ##arg); \ -+ else {\ -+ _seqdump(sel, fmt, ##arg) /*rtw_warn_on(1)*/; \ -+ } \ -+ } while (0) -+ -+/* dump message to selected 'stream' */ -+#undef _RTW_PRINT_SEL -+#define _RTW_PRINT_SEL(sel, fmt, arg...) \ -+ do {\ -+ if (sel == RTW_DBGDUMP)\ -+ _RTW_PRINT(fmt, ##arg); \ -+ else {\ -+ _seqdump(sel, fmt, ##arg) /*rtw_warn_on(1)*/; \ -+ } \ -+ } while (0) -+ -+#endif /* defined(_seqdump) */ -+ -+ -+#ifdef CONFIG_DBG_COUNTER -+ #define DBG_COUNTER(counter) counter++ -+#else -+ #define DBG_COUNTER(counter) -+#endif -+ -+void dump_drv_version(void *sel); -+void dump_log_level(void *sel); -+void dump_drv_cfg(void *sel); -+ -+#ifdef CONFIG_SDIO_HCI -+void sd_f0_reg_dump(void *sel, _adapter *adapter); -+void sdio_local_reg_dump(void *sel, _adapter *adapter); -+#endif /* CONFIG_SDIO_HCI */ -+ -+void mac_reg_dump(void *sel, _adapter *adapter); -+void bb_reg_dump(void *sel, _adapter *adapter); -+void rf_reg_dump(void *sel, _adapter *adapter); -+ -+bool rtw_fwdl_test_trigger_chksum_fail(void); -+bool rtw_fwdl_test_trigger_wintint_rdy_fail(void); -+bool rtw_del_rx_ampdu_test_trigger_no_tx_fail(void); -+ -+u32 rtw_get_wait_hiq_empty_ms(void); -+void rtw_sink_rtp_seq_dbg(_adapter *adapter, _pkt *pkt); -+ -+struct sta_info; -+void sta_rx_reorder_ctl_dump(void *sel, struct sta_info *sta); -+ -+struct dvobj_priv; -+void dump_tx_rate_bmp(void *sel, struct dvobj_priv *dvobj); -+void dump_adapters_status(void *sel, struct dvobj_priv *dvobj); -+ -+struct sec_cam_ent; -+void dump_sec_cam_ent(void *sel, struct sec_cam_ent *ent, int id); -+void dump_sec_cam_ent_title(void *sel, u8 has_id); -+void dump_sec_cam(void *sel, _adapter *adapter); -+void dump_sec_cam_cache(void *sel, _adapter *adapter); -+ -+#ifdef CONFIG_PROC_DEBUG -+ssize_t proc_set_write_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_read_reg(struct seq_file *m, void *v); -+ssize_t proc_set_read_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_fwstate(struct seq_file *m, void *v); -+int proc_get_sec_info(struct seq_file *m, void *v); -+int proc_get_mlmext_state(struct seq_file *m, void *v); -+#ifdef CONFIG_LAYER2_ROAMING -+int proc_get_roam_flags(struct seq_file *m, void *v); -+ssize_t proc_set_roam_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_roam_param(struct seq_file *m, void *v); -+ssize_t proc_set_roam_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_roam_tgt_addr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_LAYER2_ROAMING */ -+#ifdef CONFIG_RTW_80211R -+int proc_get_ft_flags(struct seq_file *m, void *v); -+ssize_t proc_set_ft_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+int proc_get_qos_option(struct seq_file *m, void *v); -+int proc_get_ht_option(struct seq_file *m, void *v); -+int proc_get_rf_info(struct seq_file *m, void *v); -+int proc_get_scan_param(struct seq_file *m, void *v); -+ssize_t proc_set_scan_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_scan_abort(struct seq_file *m, void *v); -+#ifdef CONFIG_SCAN_BACKOP -+int proc_get_backop_flags_sta(struct seq_file *m, void *v); -+ssize_t proc_set_backop_flags_sta(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_backop_flags_ap(struct seq_file *m, void *v); -+ssize_t proc_set_backop_flags_ap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_SCAN_BACKOP */ -+int proc_get_survey_info(struct seq_file *m, void *v); -+ssize_t proc_set_survey_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_ap_info(struct seq_file *m, void *v); -+ssize_t proc_reset_trx_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_trx_info(struct seq_file *m, void *v); -+int proc_get_rate_ctl(struct seq_file *m, void *v); -+int proc_get_wifi_spec(struct seq_file *m, void *v); -+ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_bw_ctl(struct seq_file *m, void *v); -+ssize_t proc_set_bw_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#ifdef DBG_RX_COUNTER_DUMP -+int proc_get_rx_cnt_dump(struct seq_file *m, void *v); -+ssize_t proc_set_rx_cnt_dump(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+int proc_get_dis_pwt(struct seq_file *m, void *v); -+ssize_t proc_set_dis_pwt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_suspend_resume_info(struct seq_file *m, void *v); -+ -+ssize_t proc_set_fwdl_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_del_rx_ampdu_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#ifdef CONFIG_DFS_MASTER -+int proc_get_dfs_master_test_case(struct seq_file *m, void *v); -+ssize_t proc_set_dfs_master_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_DFS_MASTER */ -+ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+#ifdef CONFIG_AP_MODE -+int proc_get_all_sta_info(struct seq_file *m, void *v); -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef DBG_MEMORY_LEAK -+int proc_get_malloc_cnt(struct seq_file *m, void *v); -+#endif /* DBG_MEMORY_LEAK */ -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+int proc_get_best_channel(struct seq_file *m, void *v); -+ssize_t proc_set_best_channel(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_FIND_BEST_CHANNEL */ -+ -+int proc_get_trx_info_debug(struct seq_file *m, void *v); -+ -+int proc_get_rx_signal(struct seq_file *m, void *v); -+ssize_t proc_set_rx_signal(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_hw_status(struct seq_file *m, void *v); -+ssize_t proc_set_hw_status(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+#ifdef CONFIG_80211N_HT -+int proc_get_ht_enable(struct seq_file *m, void *v); -+ssize_t proc_set_ht_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_bw_mode(struct seq_file *m, void *v); -+ssize_t proc_set_bw_mode(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_ampdu_enable(struct seq_file *m, void *v); -+ssize_t proc_set_ampdu_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_rx_ampdu(struct seq_file *m, void *v); -+ssize_t proc_set_rx_ampdu(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_rx_stbc(struct seq_file *m, void *v); -+ssize_t proc_set_rx_stbc(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_rx_ampdu_factor(struct seq_file *m, void *v); -+ssize_t proc_set_rx_ampdu_factor(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_rx_ampdu_density(struct seq_file *m, void *v); -+ssize_t proc_set_rx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_tx_ampdu_density(struct seq_file *m, void *v); -+ssize_t proc_set_tx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_80211N_HT */ -+ -+int proc_get_mac_rptbuf(struct seq_file *m, void *v); -+int proc_get_en_fwps(struct seq_file *m, void *v); -+ssize_t proc_set_en_fwps(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+#if 0 -+int proc_get_two_path_rssi(struct seq_file *m, void *v); -+int proc_get_rssi_disp(struct seq_file *m, void *v); -+ssize_t proc_set_rssi_disp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+int proc_get_btcoex_dbg(struct seq_file *m, void *v); -+ssize_t proc_set_btcoex_dbg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_btcoex_info(struct seq_file *m, void *v); -+#endif /* CONFIG_BT_COEXIST */ -+ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+int proc_get_sreset(struct seq_file *m, void *v); -+ssize_t proc_set_sreset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ -+int proc_get_odm_dbg_comp(struct seq_file *m, void *v); -+ssize_t proc_set_odm_dbg_comp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_odm_dbg_level(struct seq_file *m, void *v); -+ssize_t proc_set_odm_dbg_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+int proc_get_odm_adaptivity(struct seq_file *m, void *v); -+ssize_t proc_set_odm_adaptivity(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+#ifdef CONFIG_DBG_COUNTER -+int proc_get_rx_logs(struct seq_file *m, void *v); -+int proc_get_tx_logs(struct seq_file *m, void *v); -+int proc_get_int_logs(struct seq_file *m, void *v); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+int proc_get_rx_ring(struct seq_file *m, void *v); -+int proc_get_tx_ring(struct seq_file *m, void *v); -+#endif -+ -+#ifdef CONFIG_WOWLAN -+int proc_get_pattern_info(struct seq_file *m, void *v); -+ssize_t proc_set_pattern_info(struct file *file, const char __user *buffer, -+ size_t count, loff_t *pos, void *data); -+int proc_get_wakeup_reason(struct seq_file *m, void *v); -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+int proc_get_wowlan_gpio_info(struct seq_file *m, void *v); -+ssize_t proc_set_wowlan_gpio_info(struct file *file, const char __user *buffer, -+ size_t count, loff_t *pos, void *data); -+#endif /*CONFIG_GPIO_WAKEUP*/ -+ -+#ifdef CONFIG_P2P_WOWLAN -+int proc_get_p2p_wowlan_info(struct seq_file *m, void *v); -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+int proc_get_new_bcn_max(struct seq_file *m, void *v); -+ssize_t proc_set_new_bcn_max(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+#ifdef CONFIG_POWER_SAVING -+int proc_get_ps_info(struct seq_file *m, void *v); -+#endif /* CONFIG_POWER_SAVING */ -+ -+#ifdef CONFIG_TDLS -+int proc_get_tdls_info(struct seq_file *m, void *v); -+#endif -+ -+int proc_get_monitor(struct seq_file *m, void *v); -+ssize_t proc_set_monitor(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+ -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+int proc_get_rtkm_info(struct seq_file *m, void *v); -+#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ -+#ifdef CONFIG_IEEE80211W -+ssize_t proc_set_tx_sa_query(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_tx_sa_query(struct seq_file *m, void *v); -+ssize_t proc_set_tx_deauth(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_tx_deauth(struct seq_file *m, void *v); -+ssize_t proc_set_tx_auth(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+int proc_get_tx_auth(struct seq_file *m, void *v); -+#endif /* CONFIG_IEEE80211W */ -+ -+#endif /* CONFIG_PROC_DEBUG */ -+ -+int proc_get_efuse_map(struct seq_file *m, void *v); -+ssize_t proc_set_efuse_map(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ -+#ifdef CONFIG_MCC_MODE -+int proc_get_mcc_info(struct seq_file *m, void *v); -+ssize_t proc_set_mcc_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_mcc_single_tx_criteria(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_mcc_ap_bw20_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_mcc_ap_bw40_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_mcc_ap_bw80_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_mcc_sta_bw20_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_mcc_sta_bw40_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+ssize_t proc_set_mcc_sta_bw80_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+#endif /* CONFIG_MCC_MODE */ -+ -+ -+#define _drv_always_ 1 -+#define _drv_emerg_ 2 -+#define _drv_alert_ 3 -+#define _drv_crit_ 4 -+#define _drv_err_ 5 -+#define _drv_warning_ 6 -+#define _drv_notice_ 7 -+#define _drv_info_ 8 -+#define _drv_dump_ 9 -+#define _drv_debug_ 10 -+ -+#define _module_rtl871x_xmit_c_ BIT(0) -+#define _module_xmit_osdep_c_ BIT(1) -+#define _module_rtl871x_recv_c_ BIT(2) -+#define _module_recv_osdep_c_ BIT(3) -+#define _module_rtl871x_mlme_c_ BIT(4) -+#define _module_mlme_osdep_c_ BIT(5) -+#define _module_rtl871x_sta_mgt_c_ BIT(6) -+#define _module_rtl871x_cmd_c_ BIT(7) -+#define _module_cmd_osdep_c_ BIT(8) -+#define _module_rtl871x_io_c_ BIT(9) -+#define _module_io_osdep_c_ BIT(10) -+#define _module_os_intfs_c_ BIT(11) -+#define _module_rtl871x_security_c_ BIT(12) -+#define _module_rtl871x_eeprom_c_ BIT(13) -+#define _module_hal_init_c_ BIT(14) -+#define _module_hci_hal_init_c_ BIT(15) -+#define _module_rtl871x_ioctl_c_ BIT(16) -+#define _module_rtl871x_ioctl_set_c_ BIT(17) -+#define _module_rtl871x_ioctl_query_c_ BIT(18) -+#define _module_rtl871x_pwrctrl_c_ BIT(19) -+#define _module_hci_intfs_c_ BIT(20) -+#define _module_hci_ops_c_ BIT(21) -+#define _module_osdep_service_c_ BIT(22) -+#define _module_mp_ BIT(23) -+#define _module_hci_ops_os_c_ BIT(24) -+#define _module_rtl871x_ioctl_os_c BIT(25) -+#define _module_rtl8712_cmd_c_ BIT(26) -+/* #define _module_efuse_ BIT(27) */ -+#define _module_rtl8192c_xmit_c_ BIT(28) -+#define _module_hal_xmit_c_ BIT(28) -+#define _module_efuse_ BIT(29) -+#define _module_rtl8712_recv_c_ BIT(30) -+#define _module_rtl8712_led_c_ BIT(31) -+ -+#endif /* __RTW_DEBUG_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_eeprom.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_eeprom.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_eeprom.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_eeprom.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,121 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_EEPROM_H__ -+#define __RTW_EEPROM_H__ -+ -+ -+#define RTL8712_EEPROM_ID 0x8712 -+/* #define EEPROM_MAX_SIZE 256 */ -+ -+#define HWSET_MAX_SIZE_128 128 -+#define HWSET_MAX_SIZE_256 256 -+#define HWSET_MAX_SIZE_512 512 -+#define HWSET_MAX_SIZE_1024 1024 -+ -+#define EEPROM_MAX_SIZE HWSET_MAX_SIZE_1024 -+ -+#define CLOCK_RATE 50 /* 100us */ -+ -+/* - EEPROM opcodes */ -+#define EEPROM_READ_OPCODE 06 -+#define EEPROM_WRITE_OPCODE 05 -+#define EEPROM_ERASE_OPCODE 07 -+#define EEPROM_EWEN_OPCODE 19 /* Erase/write enable */ -+#define EEPROM_EWDS_OPCODE 16 /* Erase/write disable */ -+ -+/* Country codes */ -+#define USA 0x555320 -+#define EUROPE 0x1 /* temp, should be provided later */ -+#define JAPAN 0x2 /* temp, should be provided later */ -+ -+/* -+ * Customer ID, note that: -+ * This variable is initiailzed through EEPROM or registry, -+ * however, its definition may be different with that in EEPROM for -+ * EEPROM size consideration. So, we have to perform proper translation between them. -+ * Besides, CustomerID of registry has precedence of that of EEPROM. -+ * defined below. 060703, by rcnjko. -+ * */ -+typedef enum _RT_CUSTOMER_ID { -+ RT_CID_DEFAULT = 0, -+ RT_CID_8187_ALPHA0 = 1, -+ RT_CID_8187_SERCOMM_PS = 2, -+ RT_CID_8187_HW_LED = 3, -+ RT_CID_8187_NETGEAR = 4, -+ RT_CID_WHQL = 5, -+ RT_CID_819x_CAMEO = 6, -+ RT_CID_819x_RUNTOP = 7, -+ RT_CID_819x_Senao = 8, -+ RT_CID_TOSHIBA = 9, /* Merge by Jacken, 2008/01/31. */ -+ RT_CID_819x_Netcore = 10, -+ RT_CID_Nettronix = 11, -+ RT_CID_DLINK = 12, -+ RT_CID_PRONET = 13, -+ RT_CID_COREGA = 14, -+ RT_CID_CHINA_MOBILE = 15, -+ RT_CID_819x_ALPHA = 16, -+ RT_CID_819x_Sitecom = 17, -+ RT_CID_CCX = 18, /* It's set under CCX logo test and isn't demanded for CCX functions, but for test behavior like retry limit and tx report. By Bruce, 2009-02-17. */ -+ RT_CID_819x_Lenovo = 19, -+ RT_CID_819x_QMI = 20, -+ RT_CID_819x_Edimax_Belkin = 21, -+ RT_CID_819x_Sercomm_Belkin = 22, -+ RT_CID_819x_CAMEO1 = 23, -+ RT_CID_819x_MSI = 24, -+ RT_CID_819x_Acer = 25, -+ RT_CID_819x_AzWave_ASUS = 26, -+ RT_CID_819x_AzWave = 27, /* For AzWave in PCIe, The ID is AzWave use and not only Asus */ -+ RT_CID_819x_HP = 28, -+ RT_CID_819x_WNC_COREGA = 29, -+ RT_CID_819x_Arcadyan_Belkin = 30, -+ RT_CID_819x_SAMSUNG = 31, -+ RT_CID_819x_CLEVO = 32, -+ RT_CID_819x_DELL = 33, -+ RT_CID_819x_PRONETS = 34, -+ RT_CID_819x_Edimax_ASUS = 35, -+ RT_CID_NETGEAR = 36, -+ RT_CID_PLANEX = 37, -+ RT_CID_CC_C = 38, -+ RT_CID_819x_Xavi = 39, -+ RT_CID_LENOVO_CHINA = 40, -+ RT_CID_INTEL_CHINA = 41, -+ RT_CID_TPLINK_HPWR = 42, -+ RT_CID_819x_Sercomm_Netgear = 43, -+ RT_CID_819x_ALPHA_Dlink = 44,/* add by ylb 20121012 for customer led for alpha */ -+ RT_CID_WNC_NEC = 45,/* add by page for NEC */ -+ RT_CID_DNI_BUFFALO = 46,/* add by page for NEC */ -+} RT_CUSTOMER_ID, *PRT_CUSTOMER_ID; -+ -+extern void eeprom_write16(_adapter *padapter, u16 reg, u16 data); -+extern u16 eeprom_read16(_adapter *padapter, u16 reg); -+extern void read_eeprom_content(_adapter *padapter); -+extern void eeprom_read_sz(_adapter *padapter, u16 reg, u8 *data, u32 sz); -+ -+extern void read_eeprom_content_by_attrib(_adapter *padapter); -+ -+#ifdef PLATFORM_LINUX -+#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+extern int isAdaptorInfoFileValid(void); -+extern int storeAdaptorInfoFile(char *path, u8 *efuse_data); -+extern int retriveAdaptorInfoFile(char *path, u8 *efuse_data); -+#endif /* CONFIG_ADAPTOR_INFO_CACHING_FILE */ -+#endif /* PLATFORM_LINUX */ -+ -+#endif /* __RTL871X_EEPROM_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_efuse.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_efuse.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_efuse.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_efuse.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,244 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_EFUSE_H__ -+#define __RTW_EFUSE_H__ -+ -+ -+#define EFUSE_ERROE_HANDLE 1 -+ -+#define PG_STATE_HEADER 0x01 -+#define PG_STATE_WORD_0 0x02 -+#define PG_STATE_WORD_1 0x04 -+#define PG_STATE_WORD_2 0x08 -+#define PG_STATE_WORD_3 0x10 -+#define PG_STATE_DATA 0x20 -+ -+#define PG_SWBYTE_H 0x01 -+#define PG_SWBYTE_L 0x02 -+ -+#define PGPKT_DATA_SIZE 8 -+ -+#define EFUSE_WIFI 0 -+#define EFUSE_BT 1 -+ -+enum _EFUSE_DEF_TYPE { -+ TYPE_EFUSE_MAX_SECTION = 0, -+ TYPE_EFUSE_REAL_CONTENT_LEN = 1, -+ TYPE_AVAILABLE_EFUSE_BYTES_BANK = 2, -+ TYPE_AVAILABLE_EFUSE_BYTES_TOTAL = 3, -+ TYPE_EFUSE_MAP_LEN = 4, -+ TYPE_EFUSE_PROTECT_BYTES_BANK = 5, -+ TYPE_EFUSE_CONTENT_LEN_BANK = 6, -+}; -+ -+#define EFUSE_MAX_MAP_LEN 1024 -+ -+#define EFUSE_MAX_HW_SIZE 1024 -+#define EFUSE_MAX_SECTION_BASE 16 -+ -+/*RTL8822B 8821C BT EFUSE Define 1 BANK 128 size logical map 1024*/ -+#ifdef RTW_HALMAC -+#define BANK_NUM 1 -+#define EFUSE_BT_REAL_BANK_CONTENT_LEN 128 -+#define EFUSE_BT_REAL_CONTENT_LEN (EFUSE_BT_REAL_BANK_CONTENT_LEN * BANK_NUM) -+#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ -+#define EFUSE_BT_MAX_SECTION (EFUSE_BT_MAP_LEN / 8) -+#define EFUSE_PROTECT_BYTES_BANK 16 -+#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_BT_REAL_CONTENT_LEN) -+#endif -+ -+#define EXT_HEADER(header) ((header & 0x1F) == 0x0F) -+#define ALL_WORDS_DISABLED(wde) ((wde & 0x0F) == 0x0F) -+#define GET_HDR_OFFSET_2_0(header) ((header & 0xE0) >> 5) -+ -+#define EFUSE_REPEAT_THRESHOLD_ 3 -+ -+#define IS_MASKED_MP(ic, txt, offset) (EFUSE_IsAddressMasked_MP_##ic##txt(offset)) -+#define IS_MASKED_TC(ic, txt, offset) (EFUSE_IsAddressMasked_TC_##ic##txt(offset)) -+#define GET_MASK_ARRAY_LEN_MP(ic, txt) (EFUSE_GetArrayLen_MP_##ic##txt()) -+#define GET_MASK_ARRAY_LEN_TC(ic, txt) (EFUSE_GetArrayLen_TC_##ic##txt()) -+#define GET_MASK_ARRAY_MP(ic, txt, offset) (EFUSE_GetMaskArray_MP_##ic##txt(offset)) -+#define GET_MASK_ARRAY_TC(ic, txt, offset) (EFUSE_GetMaskArray_TC_##ic##txt(offset)) -+ -+ -+#define IS_MASKED(ic, txt, offset) (IS_MASKED_MP(ic, txt, offset)) -+#define GET_MASK_ARRAY_LEN(ic, txt) (GET_MASK_ARRAY_LEN_MP(ic, txt)) -+#define GET_MASK_ARRAY(ic, txt, out) do { GET_MASK_ARRAY_MP(ic, txt, out); } while (0) -+ -+/* ********************************************* -+ * The following is for BT Efuse definition -+ * ********************************************* */ -+#define EFUSE_BT_MAX_MAP_LEN 1024 -+#define EFUSE_MAX_BANK 4 -+#define EFUSE_MAX_BT_BANK (EFUSE_MAX_BANK-1) -+/* ********************************************* -+ *--------------------------Define Parameters-------------------------------*/ -+#define EFUSE_MAX_WORD_UNIT 4 -+ -+/*------------------------------Define structure----------------------------*/ -+typedef struct PG_PKT_STRUCT_A { -+ u8 offset; -+ u8 word_en; -+ u8 data[8]; -+ u8 word_cnts; -+} PGPKT_STRUCT, *PPGPKT_STRUCT; -+ -+typedef enum { -+ ERR_SUCCESS = 0, -+ ERR_DRIVER_FAILURE, -+ ERR_IO_FAILURE, -+ ERR_WI_TIMEOUT, -+ ERR_WI_BUSY, -+ ERR_BAD_FORMAT, -+ ERR_INVALID_DATA, -+ ERR_NOT_ENOUGH_SPACE, -+ ERR_WRITE_PROTECT, -+ ERR_READ_BACK_FAIL, -+ ERR_OUT_OF_RANGE -+} ERROR_CODE; -+ -+/*------------------------------Define structure----------------------------*/ -+typedef struct _EFUSE_HAL { -+ u8 fakeEfuseBank; -+ u32 fakeEfuseUsedBytes; -+ u8 fakeEfuseContent[EFUSE_MAX_HW_SIZE]; -+ u8 fakeEfuseInitMap[EFUSE_MAX_MAP_LEN]; -+ u8 fakeEfuseModifiedMap[EFUSE_MAX_MAP_LEN]; -+ u32 EfuseUsedBytes; -+ u8 EfuseUsedPercentage; -+ -+ u16 BTEfuseUsedBytes; -+ u8 BTEfuseUsedPercentage; -+ u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+ u8 BTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN]; -+ u8 BTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN]; -+ -+ u16 fakeBTEfuseUsedBytes; -+ u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+ u8 fakeBTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN]; -+ u8 fakeBTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN]; -+ -+ /* EFUSE Configuration, initialized in HAL_CmnInitPGData(). */ -+ const u16 MaxSecNum_WiFi; -+ const u16 MaxSecNum_BT; -+ const u16 WordUnit; -+ const u16 PhysicalLen_WiFi; -+ const u16 PhysicalLen_BT; -+ const u16 LogicalLen_WiFi; -+ const u16 LogicalLen_BT; -+ const u16 BankSize; -+ const u16 TotalBankNum; -+ const u16 BankNum_WiFi; -+ const u16 BankNum_BT; -+ const u16 OOBProtectBytes; -+ const u16 ProtectBytes; -+ const u16 BankAvailBytes; -+ const u16 TotalAvailBytes_WiFi; -+ const u16 TotalAvailBytes_BT; -+ const u16 HeaderRetry; -+ const u16 DataRetry; -+ -+ ERROR_CODE Status; -+ -+} EFUSE_HAL, *PEFUSE_HAL; -+ -+extern u8 maskfileBuffer[64]; -+ -+/*------------------------Export global variable----------------------------*/ -+extern u8 fakeEfuseBank; -+extern u32 fakeEfuseUsedBytes; -+extern u8 fakeEfuseContent[]; -+extern u8 fakeEfuseInitMap[]; -+extern u8 fakeEfuseModifiedMap[]; -+ -+extern u32 BTEfuseUsedBytes; -+extern u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+extern u8 BTEfuseInitMap[]; -+extern u8 BTEfuseModifiedMap[]; -+ -+extern u32 fakeBTEfuseUsedBytes; -+extern u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+extern u8 fakeBTEfuseInitMap[]; -+extern u8 fakeBTEfuseModifiedMap[]; -+/*------------------------Export global variable----------------------------*/ -+u8 efuse_bt_GetCurrentSize(PADAPTER padapter, u16 *size); -+u16 efuse_bt_GetMaxSize(PADAPTER padapter); -+ -+u8 efuse_GetCurrentSize(PADAPTER padapter, u16 *size); -+u16 efuse_GetMaxSize(PADAPTER padapter); -+u8 rtw_efuse_access(PADAPTER padapter, u8 bRead, u16 start_addr, u16 cnts, u8 *data); -+u8 rtw_efuse_bt_access(PADAPTER adapter, u8 write, u16 addr, u16 cnts, u8 *data); -+ -+u8 rtw_efuse_mask_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); -+u8 rtw_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); -+u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); -+u8 rtw_BT_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); -+u8 rtw_BT_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); -+ -+u16 Efuse_GetCurrentSize(PADAPTER pAdapter, u8 efuseType, BOOLEAN bPseudoTest); -+u8 Efuse_CalculateWordCnts(u8 word_en); -+void ReadEFuseByte(PADAPTER Adapter, u16 _offset, u8 *pbuf, BOOLEAN bPseudoTest) ; -+void EFUSE_GetEfuseDefinition(PADAPTER pAdapter, u8 efuseType, u8 type, void *pOut, BOOLEAN bPseudoTest); -+u8 efuse_OneByteRead(PADAPTER pAdapter, u16 addr, u8 *data, BOOLEAN bPseudoTest); -+u8 efuse_OneByteWrite(PADAPTER pAdapter, u16 addr, u8 data, BOOLEAN bPseudoTest); -+ -+void BTEfuse_PowerSwitch(PADAPTER pAdapter, u8 bWrite, u8 PwrState); -+void Efuse_PowerSwitch(PADAPTER pAdapter, u8 bWrite, u8 PwrState); -+int Efuse_PgPacketRead(PADAPTER pAdapter, u8 offset, u8 *data, BOOLEAN bPseudoTest); -+int Efuse_PgPacketWrite(PADAPTER pAdapter, u8 offset, u8 word_en, u8 *data, BOOLEAN bPseudoTest); -+void efuse_WordEnableDataRead(u8 word_en, u8 *sourdata, u8 *targetdata); -+u8 Efuse_WordEnableDataWrite(PADAPTER pAdapter, u16 efuse_addr, u8 word_en, u8 *data, BOOLEAN bPseudoTest); -+void EFUSE_ShadowMapUpdate(PADAPTER pAdapter, u8 efuseType, BOOLEAN bPseudoTest); -+void EFUSE_ShadowRead(PADAPTER pAdapter, u8 Type, u16 Offset, u32 *Value); -+ -+VOID hal_ReadEFuse_BT_logic_map( -+ PADAPTER padapter, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf -+); -+u8 EfusePgPacketWrite_BT( -+ PADAPTER pAdapter, -+ u8 offset, -+ u8 word_en, -+ u8 *pData, -+ u8 bPseudoTest); -+u16 rtw_get_efuse_mask_arraylen(PADAPTER pAdapter); -+void rtw_efuse_mask_array(PADAPTER pAdapter, u8 *pArray); -+ -+#define MAC_HIDDEN_MAX_BW_NUM 8 -+extern const u8 _mac_hidden_max_bw_to_hal_bw_cap[]; -+#define mac_hidden_max_bw_to_hal_bw_cap(max_bw) (((max_bw) >= MAC_HIDDEN_MAX_BW_NUM) ? 0 : _mac_hidden_max_bw_to_hal_bw_cap[(max_bw)]) -+ -+#define MAC_HIDDEN_PROTOCOL_NUM 4 -+extern const u8 _mac_hidden_proto_to_hal_proto_cap[]; -+#define mac_hidden_proto_to_hal_proto_cap(proto) (((proto) >= MAC_HIDDEN_PROTOCOL_NUM) ? 0 : _mac_hidden_proto_to_hal_proto_cap[(proto)]) -+ -+u8 mac_hidden_wl_func_to_hal_wl_func(u8 func); -+ -+#ifdef PLATFORM_LINUX -+u8 rtw_efuse_file_read(PADAPTER padapter, u8 *filepatch, u8 *buf, u32 len); -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+u32 rtw_read_efuse_from_file(const char *path, u8 *buf, int map_size); -+u32 rtw_read_macaddr_from_file(const char *path, u8 *buf); -+#endif /* CONFIG_EFUSE_CONFIG_FILE */ -+#endif /* PLATFORM_LINUX */ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_event.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_event.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_event.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_event.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,135 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTW_EVENT_H_ -+#define _RTW_EVENT_H_ -+ -+#ifdef CONFIG_H2CLBK -+ #include -+#endif -+ -+/* -+Used to report a bss has been scanned -+ -+*/ -+struct survey_event { -+ WLAN_BSSID_EX bss; -+}; -+ -+/* -+Used to report that the requested site survey has been done. -+ -+bss_cnt indicates the number of bss that has been reported. -+ -+ -+*/ -+struct surveydone_event { -+ unsigned int bss_cnt; -+ -+}; -+ -+/* -+Used to report the link result of joinning the given bss -+ -+ -+join_res: -+-1: authentication fail -+-2: association fail -+> 0: TID -+ -+*/ -+struct joinbss_event { -+ struct wlan_network network; -+}; -+ -+/* -+Used to report a given STA has joinned the created BSS. -+It is used in AP/Ad-HoC(M) mode. -+ -+ -+*/ -+struct stassoc_event { -+ unsigned char macaddr[6]; -+}; -+ -+struct stadel_event { -+ unsigned char macaddr[6]; -+ unsigned char rsvd[2]; /* for reason */ -+ unsigned char locally_generated; -+ int mac_id; -+}; -+ -+struct addba_event { -+ unsigned int tid; -+}; -+ -+struct wmm_event { -+ unsigned char wmm; -+}; -+ -+#ifdef CONFIG_H2CLBK -+struct c2hlbk_event { -+ unsigned char mac[6]; -+ unsigned short s0; -+ unsigned short s1; -+ unsigned int w0; -+ unsigned char b0; -+ unsigned short s2; -+ unsigned char b1; -+ unsigned int w1; -+}; -+#endif/* CONFIG_H2CLBK */ -+ -+#define GEN_EVT_CODE(event) event ## _EVT_ -+ -+ -+ -+struct fwevent { -+ u32 parmsize; -+ void (*event_callback)(_adapter *dev, u8 *pbuf); -+}; -+ -+ -+#define C2HEVENT_SZ 32 -+ -+struct event_node { -+ unsigned char *node; -+ unsigned char evt_code; -+ unsigned short evt_sz; -+ volatile int *caller_ff_tail; -+ int caller_ff_sz; -+}; -+ -+struct c2hevent_queue { -+ volatile int head; -+ volatile int tail; -+ struct event_node nodes[C2HEVENT_SZ]; -+ unsigned char seq; -+}; -+ -+#define NETWORK_QUEUE_SZ 4 -+ -+struct network_queue { -+ volatile int head; -+ volatile int tail; -+ WLAN_BSSID_EX networks[NETWORK_QUEUE_SZ]; -+}; -+ -+ -+#endif /* _WLANEVENT_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_ht.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ht.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_ht.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ht.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,219 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTW_HT_H_ -+#define _RTW_HT_H_ -+ -+ -+struct ht_priv { -+ u8 ht_option; -+ u8 ampdu_enable;/* for enable Tx A-MPDU */ -+ u8 tx_amsdu_enable;/* for enable Tx A-MSDU */ -+ u8 bss_coexist;/* for 20/40 Bss coexist */ -+ -+ /* u8 baddbareq_issued[16]; */ -+ u32 tx_amsdu_maxlen; /* 1: 8k, 0:4k ; default:8k, for tx */ -+ u32 rx_ampdu_maxlen; /* for rx reordering ctrl win_sz, updated when join_callback. */ -+ -+ u8 rx_ampdu_min_spacing; -+ -+ u8 ch_offset;/* PRIME_CHNL_OFFSET */ -+ u8 sgi_20m; -+ u8 sgi_40m; -+ -+ /* for processing Tx A-MPDU */ -+ u8 agg_enable_bitmap; -+ /* u8 ADDBA_retry_count; */ -+ u8 candidate_tid_bitmap; -+ -+ u8 ldpc_cap; -+ u8 stbc_cap; -+ u8 beamform_cap; -+ u8 smps_cap; /*spatial multiplexing power save mode. 0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ -+ -+ struct rtw_ieee80211_ht_cap ht_cap; -+ -+}; -+ -+typedef enum AGGRE_SIZE { -+ HT_AGG_SIZE_8K = 0, -+ HT_AGG_SIZE_16K = 1, -+ HT_AGG_SIZE_32K = 2, -+ HT_AGG_SIZE_64K = 3, -+ VHT_AGG_SIZE_128K = 4, -+ VHT_AGG_SIZE_256K = 5, -+ VHT_AGG_SIZE_512K = 6, -+ VHT_AGG_SIZE_1024K = 7, -+} AGGRE_SIZE_E, *PAGGRE_SIZE_E; -+ -+typedef enum _RT_HT_INF0_CAP { -+ RT_HT_CAP_USE_TURBO_AGGR = 0x01, -+ RT_HT_CAP_USE_LONG_PREAMBLE = 0x02, -+ RT_HT_CAP_USE_AMPDU = 0x04, -+ RT_HT_CAP_USE_WOW = 0x8, -+ RT_HT_CAP_USE_SOFTAP = 0x10, -+ RT_HT_CAP_USE_92SE = 0x20, -+ RT_HT_CAP_USE_88C_92C = 0x40, -+ RT_HT_CAP_USE_AP_CLIENT_MODE = 0x80, /* AP team request to reserve this bit, by Emily */ -+} RT_HT_INF0_CAPBILITY, *PRT_HT_INF0_CAPBILITY; -+ -+typedef enum _RT_HT_INF1_CAP { -+ RT_HT_CAP_USE_VIDEO_CLIENT = 0x01, -+ RT_HT_CAP_USE_JAGUAR_BCUT = 0x02, -+ RT_HT_CAP_USE_JAGUAR_CCUT = 0x04, -+} RT_HT_INF1_CAPBILITY, *PRT_HT_INF1_CAPBILITY; -+ -+#define LDPC_HT_ENABLE_RX BIT0 -+#define LDPC_HT_ENABLE_TX BIT1 -+#define LDPC_HT_TEST_TX_ENABLE BIT2 -+#define LDPC_HT_CAP_TX BIT3 -+ -+#define STBC_HT_ENABLE_RX BIT0 -+#define STBC_HT_ENABLE_TX BIT1 -+#define STBC_HT_TEST_TX_ENABLE BIT2 -+#define STBC_HT_CAP_TX BIT3 -+ -+#define BEAMFORMING_HT_BEAMFORMER_ENABLE BIT0 /* Declare our NIC supports beamformer */ -+#define BEAMFORMING_HT_BEAMFORMEE_ENABLE BIT1 /* Declare our NIC supports beamformee */ -+#define BEAMFORMING_HT_BEAMFORMER_TEST BIT2 /* Transmiting Beamforming no matter the target supports it or not */ -+#define BEAMFORMING_HT_BEAMFORMER_STEER_NUM (BIT4 | BIT5) -+#define BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP (BIT6 | BIT7) -+ -+/* ------------------------------------------------------------ -+ * The HT Control field -+ * ------------------------------------------------------------ */ -+#define SET_HT_CTRL_CSI_STEERING(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart))+2, 6, 2, _val) -+#define SET_HT_CTRL_NDP_ANNOUNCEMENT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart))+3, 0, 1, _val) -+#define GET_HT_CTRL_NDP_ANNOUNCEMENT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+3, 0, 1) -+ -+/* 20/40 BSS Coexist */ -+#define SET_EXT_CAPABILITY_ELE_BSS_COEXIST(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 0, 1, _val) -+#define GET_EXT_CAPABILITY_ELE_BSS_COEXIST(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 0, 1) -+ -+/* HT Capabilities Info field */ -+#define HT_CAP_ELE_CAP_INFO(_pEleStart) ((u8 *)(_pEleStart)) -+#define GET_HT_CAP_ELE_LDPC_CAP(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 0, 1) -+#define GET_HT_CAP_ELE_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 1, 1) -+#define GET_HT_CAP_ELE_SM_PS(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 2, 2) -+#define GET_HT_CAP_ELE_GREENFIELD(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 4, 1) -+#define GET_HT_CAP_ELE_SHORT_GI20M(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 5, 1) -+#define GET_HT_CAP_ELE_SHORT_GI40M(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 6, 1) -+#define GET_HT_CAP_ELE_TX_STBC(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 7, 1) -+#define GET_HT_CAP_ELE_RX_STBC(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 0, 2) -+#define GET_HT_CAP_ELE_DELAYED_BA(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 2, 1) -+#define GET_HT_CAP_ELE_MAX_AMSDU_LENGTH(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 3, 1) -+#define GET_HT_CAP_ELE_DSSS_CCK_40M(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 4, 1) -+#define GET_HT_CAP_ELE_FORTY_INTOLERANT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 6, 1) -+#define GET_HT_CAP_ELE_LSIG_TXOP_PROTECT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+1, 7, 1) -+ -+#define SET_HT_CAP_ELE_LDPC_CAP(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 0, 1, _val) -+#define SET_HT_CAP_ELE_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 1, 1, _val) -+#define SET_HT_CAP_ELE_SM_PS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 2, 2, _val) -+#define SET_HT_CAP_ELE_GREENFIELD(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 4, 1, _val) -+#define SET_HT_CAP_ELE_SHORT_GI20M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 5, 1, _val) -+#define SET_HT_CAP_ELE_SHORT_GI40M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 6, 1, _val) -+#define SET_HT_CAP_ELE_TX_STBC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 7, 1, _val) -+#define SET_HT_CAP_ELE_RX_STBC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 0, 2, _val) -+#define SET_HT_CAP_ELE_DELAYED_BA(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 2, 1, _val) -+#define SET_HT_CAP_ELE_MAX_AMSDU_LENGTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 3, 1, _val) -+#define SET_HT_CAP_ELE_DSSS_CCK_40M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 4, 1, _val) -+#define SET_HT_CAP_ELE_FORTY_INTOLERANT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 6, 1, _val) -+#define SET_HT_CAP_ELE_LSIG_TXOP_PROTECT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 7, 1, _val) -+ -+/* A-MPDU Parameters field */ -+#define HT_CAP_ELE_AMPDU_PARA(_pEleStart) (((u8 *)(_pEleStart))+2) -+#define GET_HT_CAP_ELE_MAX_AMPDU_LEN_EXP(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+2, 0, 2) -+#define GET_HT_CAP_ELE_MIN_MPDU_S_SPACE(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+2, 2, 3) -+ -+#define HT_AMPDU_PARA_FMT "%02x " \ -+ "MAX AMPDU len:%u bytes, MIN MPDU Start Spacing:%u" -+ -+#define HT_AMPDU_PARA_ARG(x) \ -+ *((u8 *)(x)) \ -+ , (1 << (13+GET_HT_CAP_ELE_MAX_AMPDU_LEN_EXP(((u8 *)x)-2)))-1 \ -+ , GET_HT_CAP_ELE_MIN_MPDU_S_SPACE(((u8 *)x)-2) -+ -+/* Supported MCS Set field */ -+#define HT_CAP_ELE_SUP_MCS_SET(_pEleStart) (((u8 *)(_pEleStart))+3) -+#define HT_CAP_ELE_RX_MCS_MAP(_pEleStart) HT_CAP_ELE_SUP_MCS_SET(_pEleStart) -+#define GET_HT_CAP_ELE_RX_HIGHEST_DATA_RATE(_pEleStart) LE_BITS_TO_2BYTE(((u8 *)(_pEleStart))+13, 0, 10) -+#define GET_HT_CAP_ELE_TX_MCS_DEF(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 0, 1) -+#define GET_HT_CAP_ELE_TRX_MCS_NEQ(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 1, 1) -+#define GET_HT_CAP_ELE_TX_MAX_SS(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 2, 2) -+#define GET_HT_CAP_ELE_TX_UEQM(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 4, 1) -+ -+#define HT_SUP_MCS_SET_FMT "%02x %02x %02x %02x %02x%02x%02x%02x%02x%02x" \ -+ /* "\n%02x%02x%02x%02x%02x%02x" */\ -+ " %uMbps %s%s%s" -+#define HT_SUP_MCS_SET_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5], \ -+ ((u8 *)(x))[6], ((u8 *)(x))[7], ((u8 *)(x))[8], ((u8 *)(x))[9] \ -+ /*,((u8 *)(x))[10], ((u8 *)(x))[11], ((u8 *)(x))[12], ((u8 *)(x))[13], ((u8 *)(x))[14], ((u8 *)(x))[15] */\ -+ , GET_HT_CAP_ELE_RX_HIGHEST_DATA_RATE(((u8 *)x)-3) \ -+ , GET_HT_CAP_ELE_TX_MCS_DEF(((u8 *)x)-3) ? "TX_MCS_DEF " : "" \ -+ , GET_HT_CAP_ELE_TRX_MCS_NEQ(((u8 *)x)-3) ? "TRX_MCS_NEQ " : "" \ -+ , GET_HT_CAP_ELE_TX_UEQM(((u8 *)x)-3) ? "TX_UEQM " : "" -+ -+/* TXBF Capabilities */ -+#define SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 3, 1, ((u8)_val)) -+#define SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 4, 1, ((u8)_val)) -+#define SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 10, 1, ((u8)_val)) -+#define SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 15, 2, ((u8)_val)) -+#define SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 23, 2, ((u8)_val)) -+#define SET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(_pEleStart, _val) SET_BITS_TO_LE_4BYTE(((u8 *)(_pEleStart))+21, 27, 2, ((u8)_val)) -+ -+ -+#define GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(_pEleStart) LE_BITS_TO_4BYTE(((u8 *)(_pEleStart))+21, 10, 1) -+#define GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(_pEleStart) LE_BITS_TO_4BYTE(((u8 *)(_pEleStart))+21, 15, 2) -+#define GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(_pEleStart) LE_BITS_TO_4BYTE(((u8 *)(_pEleStart))+21, 23, 2) -+#define GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(_pEleStart) LE_BITS_TO_4BYTE(((u8 *)(_pEleStart))+21, 27, 2) -+ -+/* HT Operation element */ -+ -+#define GET_HT_OP_ELE_PRI_CHL(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)), 0, 8) -+#define SET_HT_OP_ELE_PRI_CHL(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)), 0, 8, _val) -+ -+/* HT Operation Info field */ -+#define HT_OP_ELE_OP_INFO(_pEleStart) (((u8 *)(_pEleStart)) + 1) -+#define GET_HT_OP_ELE_2ND_CHL_OFFSET(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 1, 0, 2) -+#define GET_HT_OP_ELE_STA_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 1, 2, 1) -+#define GET_HT_OP_ELE_RIFS_MODE(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 1, 3, 1) -+#define GET_HT_OP_ELE_HT_PROTECT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 2, 0, 2) -+#define GET_HT_OP_ELE_NON_GREEN_PRESENT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 2, 2, 1) -+#define GET_HT_OP_ELE_OBSS_NON_HT_PRESENT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 2, 4, 1) -+#define GET_HT_OP_ELE_DUAL_BEACON(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 4, 6, 1) -+#define GET_HT_OP_ELE_DUAL_CTS(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 4, 7, 1) -+#define GET_HT_OP_ELE_STBC_BEACON(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 5, 0, 1) -+#define GET_HT_OP_ELE_LSIG_TXOP_PROTECT(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 5, 1, 1) -+#define GET_HT_OP_ELE_PCO_ACTIVE(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 5, 2, 1) -+#define GET_HT_OP_ELE_PCO_PHASE(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart)) + 5, 3, 1) -+ -+#define SET_HT_OP_ELE_2ND_CHL_OFFSET(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 0, 2, _val) -+#define SET_HT_OP_ELE_STA_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 2, 1, _val) -+#define SET_HT_OP_ELE_RIFS_MODE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 1, 3, 1, _val) -+#define SET_HT_OP_ELE_HT_PROTECT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 0, 2, _val) -+#define SET_HT_OP_ELE_NON_GREEN_PRESENT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 2, 1, _val) -+#define SET_HT_OP_ELE_OBSS_NON_HT_PRESENT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 4, 1, _val) -+#define SET_HT_OP_ELE_DUAL_BEACON(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 4, 6, 1, _val) -+#define SET_HT_OP_ELE_DUAL_CTS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 4, 7, 1, _val) -+#define SET_HT_OP_ELE_STBC_BEACON(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 5, 0, 1, _val) -+#define SET_HT_OP_ELE_LSIG_TXOP_PROTECT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 5, 1, 1, _val) -+#define SET_HT_OP_ELE_PCO_ACTIVE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 5, 2, 1, _val) -+#define SET_HT_OP_ELE_PCO_PHASE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 5, 3, 1, _val) -+ -+#endif /* _RTL871X_HT_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,317 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTW_IOCTL_H_ -+#define _RTW_IOCTL_H_ -+ -+#ifndef PLATFORM_WINDOWS -+/* 00 - Success -+* 11 - Error */ -+#define STATUS_SUCCESS (0x00000000L) -+#define STATUS_PENDING (0x00000103L) -+ -+#define STATUS_UNSUCCESSFUL (0xC0000001L) -+#define STATUS_INSUFFICIENT_RESOURCES (0xC000009AL) -+#define STATUS_NOT_SUPPORTED (0xC00000BBL) -+ -+#define NDIS_STATUS_SUCCESS ((NDIS_STATUS)STATUS_SUCCESS) -+#define NDIS_STATUS_PENDING ((NDIS_STATUS)STATUS_PENDING) -+#define NDIS_STATUS_NOT_RECOGNIZED ((NDIS_STATUS)0x00010001L) -+#define NDIS_STATUS_NOT_COPIED ((NDIS_STATUS)0x00010002L) -+#define NDIS_STATUS_NOT_ACCEPTED ((NDIS_STATUS)0x00010003L) -+#define NDIS_STATUS_CALL_ACTIVE ((NDIS_STATUS)0x00010007L) -+ -+#define NDIS_STATUS_FAILURE ((NDIS_STATUS)STATUS_UNSUCCESSFUL) -+#define NDIS_STATUS_RESOURCES ((NDIS_STATUS)STATUS_INSUFFICIENT_RESOURCES) -+#define NDIS_STATUS_CLOSING ((NDIS_STATUS)0xC0010002L) -+#define NDIS_STATUS_BAD_VERSION ((NDIS_STATUS)0xC0010004L) -+#define NDIS_STATUS_BAD_CHARACTERISTICS ((NDIS_STATUS)0xC0010005L) -+#define NDIS_STATUS_ADAPTER_NOT_FOUND ((NDIS_STATUS)0xC0010006L) -+#define NDIS_STATUS_OPEN_FAILED ((NDIS_STATUS)0xC0010007L) -+#define NDIS_STATUS_DEVICE_FAILED ((NDIS_STATUS)0xC0010008L) -+#define NDIS_STATUS_MULTICAST_FULL ((NDIS_STATUS)0xC0010009L) -+#define NDIS_STATUS_MULTICAST_EXISTS ((NDIS_STATUS)0xC001000AL) -+#define NDIS_STATUS_MULTICAST_NOT_FOUND ((NDIS_STATUS)0xC001000BL) -+#define NDIS_STATUS_REQUEST_ABORTED ((NDIS_STATUS)0xC001000CL) -+#define NDIS_STATUS_RESET_IN_PROGRESS ((NDIS_STATUS)0xC001000DL) -+#define NDIS_STATUS_CLOSING_INDICATING ((NDIS_STATUS)0xC001000EL) -+#define NDIS_STATUS_NOT_SUPPORTED ((NDIS_STATUS)STATUS_NOT_SUPPORTED) -+#define NDIS_STATUS_INVALID_PACKET ((NDIS_STATUS)0xC001000FL) -+#define NDIS_STATUS_OPEN_LIST_FULL ((NDIS_STATUS)0xC0010010L) -+#define NDIS_STATUS_ADAPTER_NOT_READY ((NDIS_STATUS)0xC0010011L) -+#define NDIS_STATUS_ADAPTER_NOT_OPEN ((NDIS_STATUS)0xC0010012L) -+#define NDIS_STATUS_NOT_INDICATING ((NDIS_STATUS)0xC0010013L) -+#define NDIS_STATUS_INVALID_LENGTH ((NDIS_STATUS)0xC0010014L) -+#define NDIS_STATUS_INVALID_DATA ((NDIS_STATUS)0xC0010015L) -+#define NDIS_STATUS_BUFFER_TOO_SHORT ((NDIS_STATUS)0xC0010016L) -+#define NDIS_STATUS_INVALID_OID ((NDIS_STATUS)0xC0010017L) -+#define NDIS_STATUS_ADAPTER_REMOVED ((NDIS_STATUS)0xC0010018L) -+#define NDIS_STATUS_UNSUPPORTED_MEDIA ((NDIS_STATUS)0xC0010019L) -+#define NDIS_STATUS_GROUP_ADDRESS_IN_USE ((NDIS_STATUS)0xC001001AL) -+#define NDIS_STATUS_FILE_NOT_FOUND ((NDIS_STATUS)0xC001001BL) -+#define NDIS_STATUS_ERROR_READING_FILE ((NDIS_STATUS)0xC001001CL) -+#define NDIS_STATUS_ALREADY_MAPPED ((NDIS_STATUS)0xC001001DL) -+#define NDIS_STATUS_RESOURCE_CONFLICT ((NDIS_STATUS)0xC001001EL) -+#define NDIS_STATUS_NO_CABLE ((NDIS_STATUS)0xC001001FL) -+ -+#define NDIS_STATUS_INVALID_SAP ((NDIS_STATUS)0xC0010020L) -+#define NDIS_STATUS_SAP_IN_USE ((NDIS_STATUS)0xC0010021L) -+#define NDIS_STATUS_INVALID_ADDRESS ((NDIS_STATUS)0xC0010022L) -+#define NDIS_STATUS_VC_NOT_ACTIVATED ((NDIS_STATUS)0xC0010023L) -+#define NDIS_STATUS_DEST_OUT_OF_ORDER ((NDIS_STATUS)0xC0010024L) /* cause 27 */ -+#define NDIS_STATUS_VC_NOT_AVAILABLE ((NDIS_STATUS)0xC0010025L) /* cause 35, 45 */ -+#define NDIS_STATUS_CELLRATE_NOT_AVAILABLE ((NDIS_STATUS)0xC0010026L) /* cause 37 */ -+#define NDIS_STATUS_INCOMPATABLE_QOS ((NDIS_STATUS)0xC0010027L) /* cause 49 */ -+#define NDIS_STATUS_AAL_PARAMS_UNSUPPORTED ((NDIS_STATUS)0xC0010028L) /* cause 93 */ -+#define NDIS_STATUS_NO_ROUTE_TO_DESTINATION ((NDIS_STATUS)0xC0010029L) /* cause 3 */ -+#endif /* #ifndef PLATFORM_WINDOWS */ -+ -+ -+#ifndef OID_802_11_CAPABILITY -+ #define OID_802_11_CAPABILITY 0x0d010122 -+#endif -+ -+#ifndef OID_802_11_PMKID -+ #define OID_802_11_PMKID 0x0d010123 -+#endif -+ -+ -+/* For DDK-defined OIDs */ -+#define OID_NDIS_SEG1 0x00010100 -+#define OID_NDIS_SEG2 0x00010200 -+#define OID_NDIS_SEG3 0x00020100 -+#define OID_NDIS_SEG4 0x01010100 -+#define OID_NDIS_SEG5 0x01020100 -+#define OID_NDIS_SEG6 0x01020200 -+#define OID_NDIS_SEG7 0xFD010100 -+#define OID_NDIS_SEG8 0x0D010100 -+#define OID_NDIS_SEG9 0x0D010200 -+#define OID_NDIS_SEG10 0x0D020200 -+ -+#define SZ_OID_NDIS_SEG1 23 -+#define SZ_OID_NDIS_SEG2 3 -+#define SZ_OID_NDIS_SEG3 6 -+#define SZ_OID_NDIS_SEG4 6 -+#define SZ_OID_NDIS_SEG5 4 -+#define SZ_OID_NDIS_SEG6 8 -+#define SZ_OID_NDIS_SEG7 7 -+#define SZ_OID_NDIS_SEG8 36 -+#define SZ_OID_NDIS_SEG9 24 -+#define SZ_OID_NDIS_SEG10 19 -+ -+/* For Realtek-defined OIDs */ -+#define OID_MP_SEG1 0xFF871100 -+#define OID_MP_SEG2 0xFF818000 -+ -+#define OID_MP_SEG3 0xFF818700 -+#define OID_MP_SEG4 0xFF011100 -+ -+enum oid_type { -+ QUERY_OID, -+ SET_OID -+}; -+ -+struct oid_funs_node { -+ unsigned int oid_start; /* the starting number for OID */ -+ unsigned int oid_end; /* the ending number for OID */ -+ struct oid_obj_priv *node_array; -+ unsigned int array_sz; /* the size of node_array */ -+ int query_counter; /* count the number of query hits for this segment */ -+ int set_counter; /* count the number of set hits for this segment */ -+}; -+ -+struct oid_par_priv { -+ void *adapter_context; -+ NDIS_OID oid; -+ void *information_buf; -+ u32 information_buf_len; -+ u32 *bytes_rw; -+ u32 *bytes_needed; -+ enum oid_type type_of_oid; -+ u32 dbg; -+}; -+ -+struct oid_obj_priv { -+ unsigned char dbg; /* 0: without OID debug message 1: with OID debug message */ -+ NDIS_STATUS(*oidfuns)(struct oid_par_priv *poid_par_priv); -+}; -+ -+#if (defined(CONFIG_MP_INCLUDED) && defined(_RTW_MP_IOCTL_C_)) || \ -+ (defined(PLATFORM_WINDOWS) && defined(_RTW_IOCTL_RTL_C_)) -+static NDIS_STATUS oid_null_function(struct oid_par_priv *poid_par_priv) -+{ -+ return NDIS_STATUS_SUCCESS; -+} -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+int TranslateNdisPsToRtPs(IN NDIS_802_11_POWER_MODE ndisPsMode); -+ -+/* OID Handler for Segment 1 */ -+NDIS_STATUS oid_gen_supported_list_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_hardware_status_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_media_supported_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_media_in_use_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_maximum_lookahead_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_maximum_frame_size_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_link_speed_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_transmit_buffer_space_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_receive_buffer_space_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_transmit_block_size_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_receive_block_size_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_vendor_id_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_vendor_description_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_current_packet_filter_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_current_lookahead_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_driver_version_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_maximum_total_size_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_protocol_options_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_mac_options_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_media_connect_status_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_maximum_send_packets_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_vendor_driver_version_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+/* OID Handler for Segment 2 */ -+NDIS_STATUS oid_gen_physical_medium_hdl(struct oid_par_priv *poid_par_priv); -+ -+/* OID Handler for Segment 3 */ -+NDIS_STATUS oid_gen_xmit_ok_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_rcv_ok_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_xmit_error_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_rcv_error_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_gen_rcv_no_buffer_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+/* OID Handler for Segment 4 */ -+NDIS_STATUS oid_802_3_permanent_address_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_3_current_address_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_3_multicast_list_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_3_maximum_list_size_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_3_mac_options_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+ -+/* OID Handler for Segment 5 */ -+NDIS_STATUS oid_802_3_rcv_error_alignment_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_one_collision_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_more_collisions_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+/* OID Handler for Segment 6 */ -+NDIS_STATUS oid_802_3_xmit_deferred_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_max_collisions_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_3_rcv_overrun_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_underrun_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_heartbeat_failure_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_times_crs_lost_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_3_xmit_late_collisions_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+ -+/* OID Handler for Segment 7 */ -+NDIS_STATUS oid_pnp_capabilities_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_pnp_set_power_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_pnp_query_power_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_pnp_add_wake_up_pattern_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_pnp_remove_wake_up_pattern_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_pnp_wake_up_pattern_list_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_pnp_enable_wake_up_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+ -+/* OID Handler for Segment 8 */ -+NDIS_STATUS oid_802_11_bssid_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_ssid_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_infrastructure_mode_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_add_wep_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_remove_wep_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_disassociate_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_authentication_mode_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_privacy_filter_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_bssid_list_scan_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_encryption_status_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_reload_defaults_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_add_key_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_remove_key_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_association_information_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_test_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_media_stream_mode_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_capability_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_pmkid_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+ -+ -+ -+/* OID Handler for Segment 9 */ -+NDIS_STATUS oid_802_11_network_types_supported_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_network_type_in_use_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_tx_power_level_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_rssi_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_rssi_trigger_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_fragmentation_threshold_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_rts_threshold_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_number_of_antennas_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_rx_antenna_selected_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_tx_antenna_selected_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_supported_rates_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_desired_rates_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_configuration_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_power_mode_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_802_11_bssid_list_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+/* OID Handler for Segment 10 */ -+NDIS_STATUS oid_802_11_statistics_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+/* OID Handler for Segment ED */ -+NDIS_STATUS oid_rt_mh_vender_id_hdl(struct oid_par_priv *poid_par_priv); -+ -+void Set_802_3_MULTICAST_LIST(ADAPTER *pAdapter, UCHAR *MCListbuf, ULONG MCListlen, BOOLEAN bAcceptAllMulticast); -+ -+#endif/* end of PLATFORM_WINDOWS */ -+ -+#if defined(PLATFORM_LINUX) && defined(CONFIG_WIRELESS_EXT) -+extern struct iw_handler_def rtw_handlers_def; -+#endif -+ -+extern void rtw_request_wps_pbc_event(_adapter *padapter); -+ -+extern NDIS_STATUS drv_query_info( -+ IN _nic_hdl MiniportAdapterContext, -+ IN NDIS_OID Oid, -+ IN void *InformationBuffer, -+ IN u32 InformationBufferLength, -+ OUT u32 *BytesWritten, -+ OUT u32 *BytesNeeded -+); -+ -+extern NDIS_STATUS drv_set_info( -+ IN _nic_hdl MiniportAdapterContext, -+ IN NDIS_OID Oid, -+ IN void *InformationBuffer, -+ IN u32 InformationBufferLength, -+ OUT u32 *BytesRead, -+ OUT u32 *BytesNeeded -+); -+ -+#endif /* #ifndef __INC_CEINFO_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl_query.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl_query.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl_query.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl_query.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTW_IOCTL_QUERY_H_ -+#define _RTW_IOCTL_QUERY_H_ -+ -+ -+#ifdef PLATFORM_WINDOWS -+u8 query_802_11_capability(_adapter *padapter, u8 *pucBuf, u32 *pulOutLen); -+u8 query_802_11_association_information(_adapter *padapter, PNDIS_802_11_ASSOCIATION_INFORMATION pAssocInfo); -+#endif -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl_rtl.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl_rtl.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl_rtl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl_rtl.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,80 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTW_IOCTL_RTL_H_ -+#define _RTW_IOCTL_RTL_H_ -+ -+ -+/* ************** oid_rtl_seg_01_01 ************** */ -+NDIS_STATUS oid_rt_get_signal_quality_hdl(struct oid_par_priv *poid_par_priv);/* 84 */ -+NDIS_STATUS oid_rt_get_small_packet_crc_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_middle_packet_crc_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_large_packet_crc_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_tx_retry_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_rx_retry_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_rx_total_packet_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_tx_beacon_ok_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_tx_beacon_err_hdl(struct oid_par_priv *poid_par_priv); -+ -+NDIS_STATUS oid_rt_pro_set_fw_dig_state_hdl(struct oid_par_priv *poid_par_priv); /* 8a */ -+NDIS_STATUS oid_rt_pro_set_fw_ra_state_hdl(struct oid_par_priv *poid_par_priv); /* 8b */ -+ -+NDIS_STATUS oid_rt_get_rx_icv_err_hdl(struct oid_par_priv *poid_par_priv);/* 93 */ -+NDIS_STATUS oid_rt_set_encryption_algorithm_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_preamble_mode_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_ap_ip_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_channelplan_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_set_channelplan_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_set_preamble_mode_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_set_bcn_intvl_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_dedicate_probe_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_total_tx_bytes_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_total_rx_bytes_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_current_tx_power_level_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_enc_key_mismatch_count_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_enc_key_match_count_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_channel_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_hardware_radio_off_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_key_mismatch_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_supported_wireless_mode_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_channel_list_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_scan_in_progress_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_forced_data_rate_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_wireless_mode_for_scan_list_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_bss_wireless_mode_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_scan_with_magic_packet_hdl(struct oid_par_priv *poid_par_priv); -+ -+/* ************** oid_rtl_seg_01_03 section start ************** */ -+NDIS_STATUS oid_rt_ap_get_associated_station_list_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_ap_switch_into_ap_mode_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_ap_supported_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_ap_set_passphrase_hdl(struct oid_par_priv *poid_par_priv); -+ -+/* oid_rtl_seg_01_11 */ -+NDIS_STATUS oid_rt_pro_rf_write_registry_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_rf_read_registry_hdl(struct oid_par_priv *poid_par_priv); -+ -+/* ************** oid_rtl_seg_03_00 section start ************** */ -+NDIS_STATUS oid_rt_get_connect_state_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_set_default_key_id_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl_set.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl_set.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_ioctl_set.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_ioctl_set.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,75 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_IOCTL_SET_H_ -+#define __RTW_IOCTL_SET_H_ -+ -+ -+typedef u8 NDIS_802_11_PMKID_VALUE[16]; -+ -+typedef struct _BSSIDInfo { -+ NDIS_802_11_MAC_ADDRESS BSSID; -+ NDIS_802_11_PMKID_VALUE PMKID; -+} BSSIDInfo, *PBSSIDInfo; -+ -+ -+#ifdef PLATFORM_OS_XP -+typedef struct _NDIS_802_11_PMKID { -+ u32 Length; -+ u32 BSSIDInfoCount; -+ BSSIDInfo BSSIDInfo[1]; -+} NDIS_802_11_PMKID, *PNDIS_802_11_PMKID; -+#endif -+ -+ -+#ifdef PLATFORM_WINDOWS -+u8 rtw_set_802_11_reload_defaults(_adapter *padapter, NDIS_802_11_RELOAD_DEFAULTS reloadDefaults); -+u8 rtw_set_802_11_test(_adapter *padapter, NDIS_802_11_TEST *test); -+u8 rtw_set_802_11_pmkid(_adapter *pdapter, NDIS_802_11_PMKID *pmkid); -+ -+u8 rtw_pnp_set_power_sleep(_adapter *padapter); -+u8 rtw_pnp_set_power_wakeup(_adapter *padapter); -+ -+void rtw_pnp_resume_wk(void *context); -+void rtw_pnp_sleep_wk(void *context); -+ -+#endif -+ -+u8 rtw_set_802_11_add_key(_adapter *padapter, NDIS_802_11_KEY *key); -+u8 rtw_set_802_11_authentication_mode(_adapter *pdapter, NDIS_802_11_AUTHENTICATION_MODE authmode); -+u8 rtw_set_802_11_bssid(_adapter *padapter, u8 *bssid); -+u8 rtw_set_802_11_add_wep(_adapter *padapter, NDIS_802_11_WEP *wep); -+u8 rtw_set_802_11_disassociate(_adapter *padapter); -+u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, NDIS_802_11_SSID *pssid, int ssid_max_num, struct rtw_ieee80211_channel *ch, int ch_num); -+u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype); -+u8 rtw_set_802_11_remove_wep(_adapter *padapter, u32 keyindex); -+u8 rtw_set_802_11_ssid(_adapter *padapter, NDIS_802_11_SSID *ssid); -+u8 rtw_set_802_11_connect(_adapter *padapter, u8 *bssid, NDIS_802_11_SSID *ssid); -+u8 rtw_set_802_11_remove_key(_adapter *padapter, NDIS_802_11_REMOVE_KEY *key); -+ -+u8 rtw_validate_bssid(u8 *bssid); -+u8 rtw_validate_ssid(NDIS_802_11_SSID *ssid); -+ -+u16 rtw_get_cur_max_rate(_adapter *adapter); -+int rtw_set_scan_mode(_adapter *adapter, RT_SCAN_TYPE scan_mode); -+int rtw_set_channel_plan(_adapter *adapter, u8 channel_plan); -+int rtw_set_country(_adapter *adapter, const char *country_code); -+int rtw_set_band(_adapter *adapter, u8 band); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_io.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_io.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_io.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_io.h 2018-02-11 21:44:27.171146452 +0200 -@@ -0,0 +1,576 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef _RTW_IO_H_ -+#define _RTW_IO_H_ -+ -+#define NUM_IOREQ 8 -+ -+#ifdef PLATFORM_WINDOWS -+ #define MAX_PROT_SZ 64 -+#endif -+#ifdef PLATFORM_LINUX -+ #define MAX_PROT_SZ (64-16) -+#endif -+ -+#define _IOREADY 0 -+#define _IO_WAIT_COMPLETE 1 -+#define _IO_WAIT_RSP 2 -+ -+/* IO COMMAND TYPE */ -+#define _IOSZ_MASK_ (0x7F) -+#define _IO_WRITE_ BIT(7) -+#define _IO_FIXED_ BIT(8) -+#define _IO_BURST_ BIT(9) -+#define _IO_BYTE_ BIT(10) -+#define _IO_HW_ BIT(11) -+#define _IO_WORD_ BIT(12) -+#define _IO_SYNC_ BIT(13) -+#define _IO_CMDMASK_ (0x1F80) -+ -+ -+/* -+ For prompt mode accessing, caller shall free io_req -+ Otherwise, io_handler will free io_req -+*/ -+ -+ -+ -+/* IO STATUS TYPE */ -+#define _IO_ERR_ BIT(2) -+#define _IO_SUCCESS_ BIT(1) -+#define _IO_DONE_ BIT(0) -+ -+ -+#define IO_RD32 (_IO_SYNC_ | _IO_WORD_) -+#define IO_RD16 (_IO_SYNC_ | _IO_HW_) -+#define IO_RD8 (_IO_SYNC_ | _IO_BYTE_) -+ -+#define IO_RD32_ASYNC (_IO_WORD_) -+#define IO_RD16_ASYNC (_IO_HW_) -+#define IO_RD8_ASYNC (_IO_BYTE_) -+ -+#define IO_WR32 (_IO_WRITE_ | _IO_SYNC_ | _IO_WORD_) -+#define IO_WR16 (_IO_WRITE_ | _IO_SYNC_ | _IO_HW_) -+#define IO_WR8 (_IO_WRITE_ | _IO_SYNC_ | _IO_BYTE_) -+ -+#define IO_WR32_ASYNC (_IO_WRITE_ | _IO_WORD_) -+#define IO_WR16_ASYNC (_IO_WRITE_ | _IO_HW_) -+#define IO_WR8_ASYNC (_IO_WRITE_ | _IO_BYTE_) -+ -+/* -+ -+ Only Sync. burst accessing is provided. -+ -+*/ -+ -+#define IO_WR_BURST(x) (_IO_WRITE_ | _IO_SYNC_ | _IO_BURST_ | ((x) & _IOSZ_MASK_)) -+#define IO_RD_BURST(x) (_IO_SYNC_ | _IO_BURST_ | ((x) & _IOSZ_MASK_)) -+ -+ -+ -+/* below is for the intf_option bit defition... */ -+ -+#define _INTF_ASYNC_ BIT(0) /* support async io */ -+ -+struct intf_priv; -+struct intf_hdl; -+struct io_queue; -+ -+struct _io_ops { -+ u8(*_read8)(struct intf_hdl *pintfhdl, u32 addr); -+ u16(*_read16)(struct intf_hdl *pintfhdl, u32 addr); -+ u32(*_read32)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ int (*_write8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int (*_write16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int (*_write32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ int (*_writeN)(struct intf_hdl *pintfhdl, u32 addr, u32 length, u8 *pdata); -+ -+ int (*_write8_async)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int (*_write16_async)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int (*_write32_async)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ -+ void (*_read_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ void (*_write_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ -+ void (*_sync_irp_protocol_rw)(struct io_queue *pio_q); -+ -+ u32(*_read_interrupt)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ u32(*_read_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ u32(*_write_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ -+ u32(*_write_scsi)(struct intf_hdl *pintfhdl, u32 cnt, u8 *pmem); -+ -+ void (*_read_port_cancel)(struct intf_hdl *pintfhdl); -+ void (*_write_port_cancel)(struct intf_hdl *pintfhdl); -+ -+#ifdef CONFIG_SDIO_HCI -+ u8(*_sd_f0_read8)(struct intf_hdl *pintfhdl, u32 addr); -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ u8(*_sd_iread8)(struct intf_hdl *pintfhdl, u32 addr); -+ u16(*_sd_iread16)(struct intf_hdl *pintfhdl, u32 addr); -+ u32(*_sd_iread32)(struct intf_hdl *pintfhdl, u32 addr); -+ int (*_sd_iwrite8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int (*_sd_iwrite16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int (*_sd_iwrite32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+#endif -+ -+}; -+ -+struct io_req { -+ _list list; -+ u32 addr; -+ volatile u32 val; -+ u32 command; -+ u32 status; -+ u8 *pbuf; -+ _sema sema; -+ -+#ifdef PLATFORM_OS_CE -+#ifdef CONFIG_USB_HCI -+ /* URB handler for rtw_write_mem */ -+ USB_TRANSFER usb_transfer_write_mem; -+#endif -+#endif -+ -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt); -+ u8 *cnxt; -+ -+#ifdef PLATFORM_OS_XP -+ PMDL pmdl; -+ PIRP pirp; -+ -+#ifdef CONFIG_SDIO_HCI -+ PSDBUS_REQUEST_PACKET sdrp; -+#endif -+ -+#endif -+ -+ -+}; -+ -+struct intf_hdl { -+ -+#if 0 -+ u32 intf_option; -+ u32 bus_status; -+ u32 do_flush; -+ u8 *adapter; -+ u8 *intf_dev; -+ struct intf_priv *pintfpriv; -+ u8 cnt; -+ void (*intf_hdl_init)(u8 *priv); -+ void (*intf_hdl_unload)(u8 *priv); -+ void (*intf_hdl_open)(u8 *priv); -+ void (*intf_hdl_close)(u8 *priv); -+ struct _io_ops io_ops; -+ /* u8 intf_status;//moved to struct intf_priv */ -+ u16 len; -+ u16 done_len; -+#endif -+ _adapter *padapter; -+ struct dvobj_priv *pintf_dev;/* pointer to &(padapter->dvobjpriv); */ -+ -+ struct _io_ops io_ops; -+ -+}; -+ -+struct reg_protocol_rd { -+ -+#ifdef CONFIG_LITTLE_ENDIAN -+ -+ /* DW1 */ -+ u32 NumOfTrans:4; -+ u32 Reserved1:4; -+ u32 Reserved2:24; -+ /* DW2 */ -+ u32 ByteCount:7; -+ u32 WriteEnable:1; /* 0:read, 1:write */ -+ u32 FixOrContinuous:1; /* 0:continuous, 1: Fix */ -+ u32 BurstMode:1; -+ u32 Byte1Access:1; -+ u32 Byte2Access:1; -+ u32 Byte4Access:1; -+ u32 Reserved3:3; -+ u32 Reserved4:16; -+ /* DW3 */ -+ u32 BusAddress; -+ /* DW4 */ -+ /* u32 Value; */ -+#else -+ -+ -+ /* DW1 */ -+ u32 Reserved1:4; -+ u32 NumOfTrans:4; -+ -+ u32 Reserved2:24; -+ -+ /* DW2 */ -+ u32 WriteEnable:1; -+ u32 ByteCount:7; -+ -+ -+ u32 Reserved3:3; -+ u32 Byte4Access:1; -+ -+ u32 Byte2Access:1; -+ u32 Byte1Access:1; -+ u32 BurstMode:1; -+ u32 FixOrContinuous:1; -+ -+ u32 Reserved4:16; -+ -+ /* DW3 */ -+ u32 BusAddress; -+ -+ /* DW4 */ -+ /* u32 Value; */ -+ -+#endif -+ -+}; -+ -+ -+struct reg_protocol_wt { -+ -+ -+#ifdef CONFIG_LITTLE_ENDIAN -+ -+ /* DW1 */ -+ u32 NumOfTrans:4; -+ u32 Reserved1:4; -+ u32 Reserved2:24; -+ /* DW2 */ -+ u32 ByteCount:7; -+ u32 WriteEnable:1; /* 0:read, 1:write */ -+ u32 FixOrContinuous:1; /* 0:continuous, 1: Fix */ -+ u32 BurstMode:1; -+ u32 Byte1Access:1; -+ u32 Byte2Access:1; -+ u32 Byte4Access:1; -+ u32 Reserved3:3; -+ u32 Reserved4:16; -+ /* DW3 */ -+ u32 BusAddress; -+ /* DW4 */ -+ u32 Value; -+ -+#else -+ /* DW1 */ -+ u32 Reserved1:4; -+ u32 NumOfTrans:4; -+ -+ u32 Reserved2:24; -+ -+ /* DW2 */ -+ u32 WriteEnable:1; -+ u32 ByteCount:7; -+ -+ u32 Reserved3:3; -+ u32 Byte4Access:1; -+ -+ u32 Byte2Access:1; -+ u32 Byte1Access:1; -+ u32 BurstMode:1; -+ u32 FixOrContinuous:1; -+ -+ u32 Reserved4:16; -+ -+ /* DW3 */ -+ u32 BusAddress; -+ -+ /* DW4 */ -+ u32 Value; -+ -+#endif -+ -+}; -+#ifdef CONFIG_PCI_HCI -+#define MAX_CONTINUAL_IO_ERR 4 -+#endif -+ -+#ifdef CONFIG_USB_HCI -+#define MAX_CONTINUAL_IO_ERR 4 -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+#define SD_IO_TRY_CNT (8) -+#define MAX_CONTINUAL_IO_ERR SD_IO_TRY_CNT -+#endif -+ -+#ifdef CONFIG_GSPI_HCI -+#define SD_IO_TRY_CNT (8) -+#define MAX_CONTINUAL_IO_ERR SD_IO_TRY_CNT -+#endif -+ -+ -+int rtw_inc_and_chk_continual_io_error(struct dvobj_priv *dvobj); -+void rtw_reset_continual_io_error(struct dvobj_priv *dvobj); -+ -+/* -+Below is the data structure used by _io_handler -+ -+*/ -+ -+struct io_queue { -+ _lock lock; -+ _list free_ioreqs; -+ _list pending; /* The io_req list that will be served in the single protocol read/write. */ -+ _list processing; -+ u8 *free_ioreqs_buf; /* 4-byte aligned */ -+ u8 *pallocated_free_ioreqs_buf; -+ struct intf_hdl intf; -+}; -+ -+struct io_priv { -+ -+ _adapter *padapter; -+ -+ struct intf_hdl intf; -+ -+}; -+ -+extern uint ioreq_flush(_adapter *adapter, struct io_queue *ioqueue); -+extern void sync_ioreq_enqueue(struct io_req *preq, struct io_queue *ioqueue); -+extern uint sync_ioreq_flush(_adapter *adapter, struct io_queue *ioqueue); -+ -+ -+extern uint free_ioreq(struct io_req *preq, struct io_queue *pio_queue); -+extern struct io_req *alloc_ioreq(struct io_queue *pio_q); -+ -+extern uint register_intf_hdl(u8 *dev, struct intf_hdl *pintfhdl); -+extern void unregister_intf_hdl(struct intf_hdl *pintfhdl); -+ -+extern void _rtw_attrib_read(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void _rtw_attrib_write(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+ -+extern u8 _rtw_read8(_adapter *adapter, u32 addr); -+extern u16 _rtw_read16(_adapter *adapter, u32 addr); -+extern u32 _rtw_read32(_adapter *adapter, u32 addr); -+extern void _rtw_read_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void _rtw_read_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void _rtw_read_port_cancel(_adapter *adapter); -+ -+ -+extern int _rtw_write8(_adapter *adapter, u32 addr, u8 val); -+extern int _rtw_write16(_adapter *adapter, u32 addr, u16 val); -+extern int _rtw_write32(_adapter *adapter, u32 addr, u32 val); -+extern int _rtw_writeN(_adapter *adapter, u32 addr, u32 length, u8 *pdata); -+ -+#ifdef CONFIG_SDIO_HCI -+u8 _rtw_sd_f0_read8(_adapter *adapter, u32 addr); -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+u8 _rtw_sd_iread8(_adapter *adapter, u32 addr); -+u16 _rtw_sd_iread16(_adapter *adapter, u32 addr); -+u32 _rtw_sd_iread32(_adapter *adapter, u32 addr); -+int _rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val); -+int _rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val); -+int _rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val); -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+extern int _rtw_write8_async(_adapter *adapter, u32 addr, u8 val); -+extern int _rtw_write16_async(_adapter *adapter, u32 addr, u16 val); -+extern int _rtw_write32_async(_adapter *adapter, u32 addr, u32 val); -+ -+extern void _rtw_write_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern u32 _rtw_write_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+u32 _rtw_write_port_and_wait(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem, int timeout_ms); -+extern void _rtw_write_port_cancel(_adapter *adapter); -+ -+#ifdef DBG_IO -+bool match_read_sniff_ranges(u32 addr, u16 len); -+bool match_write_sniff_ranges(u32 addr, u16 len); -+bool match_rf_read_sniff_ranges(u8 path, u32 addr, u32 mask); -+bool match_rf_write_sniff_ranges(u8 path, u32 addr, u32 mask); -+ -+extern u8 dbg_rtw_read8(_adapter *adapter, u32 addr, const char *caller, const int line); -+extern u16 dbg_rtw_read16(_adapter *adapter, u32 addr, const char *caller, const int line); -+extern u32 dbg_rtw_read32(_adapter *adapter, u32 addr, const char *caller, const int line); -+ -+extern int dbg_rtw_write8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line); -+extern int dbg_rtw_write16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line); -+extern int dbg_rtw_write32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line); -+extern int dbg_rtw_writeN(_adapter *adapter, u32 addr , u32 length , u8 *data, const char *caller, const int line); -+ -+#ifdef CONFIG_SDIO_HCI -+u8 dbg_rtw_sd_f0_read8(_adapter *adapter, u32 addr, const char *caller, const int line); -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+u8 dbg_rtw_sd_iread8(_adapter *adapter, u32 addr, const char *caller, const int line); -+u16 dbg_rtw_sd_iread16(_adapter *adapter, u32 addr, const char *caller, const int line); -+u32 dbg_rtw_sd_iread32(_adapter *adapter, u32 addr, const char *caller, const int line); -+int dbg_rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line); -+int dbg_rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line); -+int dbg_rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line); -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+#define rtw_read8(adapter, addr) dbg_rtw_read8((adapter), (addr), __FUNCTION__, __LINE__) -+#define rtw_read16(adapter, addr) dbg_rtw_read16((adapter), (addr), __FUNCTION__, __LINE__) -+#define rtw_read32(adapter, addr) dbg_rtw_read32((adapter), (addr), __FUNCTION__, __LINE__) -+#define rtw_read_mem(adapter, addr, cnt, mem) _rtw_read_mem((adapter), (addr), (cnt), (mem)) -+#define rtw_read_port(adapter, addr, cnt, mem) _rtw_read_port((adapter), (addr), (cnt), (mem)) -+#define rtw_read_port_cancel(adapter) _rtw_read_port_cancel((adapter)) -+ -+#define rtw_write8(adapter, addr, val) dbg_rtw_write8((adapter), (addr), (val), __FUNCTION__, __LINE__) -+#define rtw_write16(adapter, addr, val) dbg_rtw_write16((adapter), (addr), (val), __FUNCTION__, __LINE__) -+#define rtw_write32(adapter, addr, val) dbg_rtw_write32((adapter), (addr), (val), __FUNCTION__, __LINE__) -+#define rtw_writeN(adapter, addr, length, data) dbg_rtw_writeN((adapter), (addr), (length), (data), __FUNCTION__, __LINE__) -+ -+#define rtw_write8_async(adapter, addr, val) _rtw_write8_async((adapter), (addr), (val)) -+#define rtw_write16_async(adapter, addr, val) _rtw_write16_async((adapter), (addr), (val)) -+#define rtw_write32_async(adapter, addr, val) _rtw_write32_async((adapter), (addr), (val)) -+ -+#define rtw_write_mem(adapter, addr, cnt, mem) _rtw_write_mem((adapter), addr, cnt, mem) -+#define rtw_write_port(adapter, addr, cnt, mem) _rtw_write_port(adapter, addr, cnt, mem) -+#define rtw_write_port_and_wait(adapter, addr, cnt, mem, timeout_ms) _rtw_write_port_and_wait((adapter), (addr), (cnt), (mem), (timeout_ms)) -+#define rtw_write_port_cancel(adapter) _rtw_write_port_cancel(adapter) -+ -+#ifdef CONFIG_SDIO_HCI -+#define rtw_sd_f0_read8(adapter, addr) dbg_rtw_sd_f0_read8((adapter), (addr), __func__, __LINE__) -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+#define rtw_sd_iread8(adapter, addr) dbg_rtw_sd_iread8((adapter), (addr), __func__, __LINE__) -+#define rtw_sd_iread16(adapter, addr) dbg_rtw_sd_iread16((adapter), (addr), __func__, __LINE__) -+#define rtw_sd_iread32(adapter, addr) dbg_rtw_sd_iread32((adapter), (addr), __func__, __LINE__) -+#define rtw_sd_iwrite8(adapter, addr, val) dbg_rtw_sd_iwrite8((adapter), (addr), (val), __func__, __LINE__) -+#define rtw_sd_iwrite16(adapter, addr, val) dbg_rtw_sd_iwrite16((adapter), (addr), (val), __func__, __LINE__) -+#define rtw_sd_iwrite32(adapter, addr, val) dbg_rtw_sd_iwrite32((adapter), (addr), (val), __func__, __LINE__) -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+#else /* DBG_IO */ -+#define match_read_sniff_ranges(addr, len) _FALSE -+#define match_write_sniff_ranges(addr, len) _FALSE -+#define match_rf_read_sniff_ranges(path, addr, mask) _FALSE -+#define match_rf_write_sniff_ranges(path, addr, mask) _FALSE -+#define rtw_read8(adapter, addr) _rtw_read8((adapter), (addr)) -+#define rtw_read16(adapter, addr) _rtw_read16((adapter), (addr)) -+#define rtw_read32(adapter, addr) _rtw_read32((adapter), (addr)) -+#define rtw_read_mem(adapter, addr, cnt, mem) _rtw_read_mem((adapter), (addr), (cnt), (mem)) -+#define rtw_read_port(adapter, addr, cnt, mem) _rtw_read_port((adapter), (addr), (cnt), (mem)) -+#define rtw_read_port_cancel(adapter) _rtw_read_port_cancel((adapter)) -+ -+#define rtw_write8(adapter, addr, val) _rtw_write8((adapter), (addr), (val)) -+#define rtw_write16(adapter, addr, val) _rtw_write16((adapter), (addr), (val)) -+#define rtw_write32(adapter, addr, val) _rtw_write32((adapter), (addr), (val)) -+#define rtw_writeN(adapter, addr, length, data) _rtw_writeN((adapter), (addr), (length), (data)) -+ -+#define rtw_write8_async(adapter, addr, val) _rtw_write8_async((adapter), (addr), (val)) -+#define rtw_write16_async(adapter, addr, val) _rtw_write16_async((adapter), (addr), (val)) -+#define rtw_write32_async(adapter, addr, val) _rtw_write32_async((adapter), (addr), (val)) -+ -+#define rtw_write_mem(adapter, addr, cnt, mem) _rtw_write_mem((adapter), (addr), (cnt), (mem)) -+#define rtw_write_port(adapter, addr, cnt, mem) _rtw_write_port((adapter), (addr), (cnt), (mem)) -+#define rtw_write_port_and_wait(adapter, addr, cnt, mem, timeout_ms) _rtw_write_port_and_wait((adapter), (addr), (cnt), (mem), (timeout_ms)) -+#define rtw_write_port_cancel(adapter) _rtw_write_port_cancel((adapter)) -+ -+#ifdef CONFIG_SDIO_HCI -+#define rtw_sd_f0_read8(adapter, addr) _rtw_sd_f0_read8((adapter), (addr)) -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+#define rtw_sd_iread8(adapter, addr) _rtw_sd_iread8((adapter), (addr)) -+#define rtw_sd_iread16(adapter, addr) _rtw_sd_iread16((adapter), (addr)) -+#define rtw_sd_iread32(adapter, addr) _rtw_sd_iread32((adapter), (addr)) -+#define rtw_sd_iwrite8(adapter, addr, val) _rtw_sd_iwrite8((adapter), (addr), (val)) -+#define rtw_sd_iwrite16(adapter, addr, val) _rtw_sd_iwrite16((adapter), (addr), (val)) -+#define rtw_sd_iwrite32(adapter, addr, val) _rtw_sd_iwrite32((adapter), (addr), (val)) -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+#endif /* DBG_IO */ -+ -+extern void rtw_write_scsi(_adapter *adapter, u32 cnt, u8 *pmem); -+ -+/* ioreq */ -+extern void ioreq_read8(_adapter *adapter, u32 addr, u8 *pval); -+extern void ioreq_read16(_adapter *adapter, u32 addr, u16 *pval); -+extern void ioreq_read32(_adapter *adapter, u32 addr, u32 *pval); -+extern void ioreq_write8(_adapter *adapter, u32 addr, u8 val); -+extern void ioreq_write16(_adapter *adapter, u32 addr, u16 val); -+extern void ioreq_write32(_adapter *adapter, u32 addr, u32 val); -+ -+ -+extern uint async_read8(_adapter *adapter, u32 addr, u8 *pbuff, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+extern uint async_read16(_adapter *adapter, u32 addr, u8 *pbuff, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+extern uint async_read32(_adapter *adapter, u32 addr, u8 *pbuff, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+ -+extern void async_read_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void async_read_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+ -+extern void async_write8(_adapter *adapter, u32 addr, u8 val, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+extern void async_write16(_adapter *adapter, u32 addr, u16 val, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+extern void async_write32(_adapter *adapter, u32 addr, u32 val, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+ -+extern void async_write_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void async_write_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+ -+ -+int rtw_init_io_priv(_adapter *padapter, void (*set_intf_ops)(_adapter *padapter, struct _io_ops *pops)); -+ -+ -+extern uint alloc_io_queue(_adapter *adapter); -+extern void free_io_queue(_adapter *adapter); -+extern void async_bus_io(struct io_queue *pio_q); -+extern void bus_sync_io(struct io_queue *pio_q); -+extern u32 _ioreq2rwmem(struct io_queue *pio_q); -+extern void dev_power_down(_adapter *Adapter, u8 bpwrup); -+ -+/* -+#define RTL_R8(reg) rtw_read8(padapter, reg) -+#define RTL_R16(reg) rtw_read16(padapter, reg) -+#define RTL_R32(reg) rtw_read32(padapter, reg) -+#define RTL_W8(reg, val8) rtw_write8(padapter, reg, val8) -+#define RTL_W16(reg, val16) rtw_write16(padapter, reg, val16) -+#define RTL_W32(reg, val32) rtw_write32(padapter, reg, val32) -+*/ -+ -+/* -+#define RTL_W8_ASYNC(reg, val8) rtw_write32_async(padapter, reg, val8) -+#define RTL_W16_ASYNC(reg, val16) rtw_write32_async(padapter, reg, val16) -+#define RTL_W32_ASYNC(reg, val32) rtw_write32_async(padapter, reg, val32) -+ -+#define RTL_WRITE_BB(reg, val32) phy_SetUsbBBReg(padapter, reg, val32) -+#define RTL_READ_BB(reg) phy_QueryUsbBBReg(padapter, reg) -+*/ -+ -+#define PlatformEFIOWrite1Byte(_a, _b, _c) \ -+ rtw_write8(_a, _b, _c) -+#define PlatformEFIOWrite2Byte(_a, _b, _c) \ -+ rtw_write16(_a, _b, _c) -+#define PlatformEFIOWrite4Byte(_a, _b, _c) \ -+ rtw_write32(_a, _b, _c) -+ -+#define PlatformEFIORead1Byte(_a, _b) \ -+ rtw_read8(_a, _b) -+#define PlatformEFIORead2Byte(_a, _b) \ -+ rtw_read16(_a, _b) -+#define PlatformEFIORead4Byte(_a, _b) \ -+ rtw_read32(_a, _b) -+ -+#endif /* _RTL8711_IO_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_iol.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_iol.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_iol.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_iol.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,136 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_IOL_H_ -+#define __RTW_IOL_H_ -+ -+ -+struct xmit_frame *rtw_IOL_accquire_xmit_frame(ADAPTER *adapter); -+int rtw_IOL_append_cmds(struct xmit_frame *xmit_frame, u8 *IOL_cmds, u32 cmd_len); -+int rtw_IOL_append_LLT_cmd(struct xmit_frame *xmit_frame, u8 page_boundary); -+int rtw_IOL_exec_cmds_sync(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt); -+bool rtw_IOL_applied(ADAPTER *adapter); -+int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us); -+int rtw_IOL_append_DELAY_MS_cmd(struct xmit_frame *xmit_frame, u16 ms); -+int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame); -+ -+ -+#ifdef CONFIG_IOL_NEW_GENERATION -+#define IOREG_CMD_END_LEN 4 -+ -+struct ioreg_cfg { -+ u8 length; -+ u8 cmd_id; -+ u16 address; -+ u32 data; -+ u32 mask; -+}; -+enum ioreg_cmd { -+ IOREG_CMD_LLT = 0x01, -+ IOREG_CMD_REFUSE = 0x02, -+ IOREG_CMD_EFUSE_PATH = 0x03, -+ IOREG_CMD_WB_REG = 0x04, -+ IOREG_CMD_WW_REG = 0x05, -+ IOREG_CMD_WD_REG = 0x06, -+ IOREG_CMD_W_RF = 0x07, -+ IOREG_CMD_DELAY_US = 0x10, -+ IOREG_CMD_DELAY_MS = 0x11, -+ IOREG_CMD_END = 0xFF, -+}; -+void read_efuse_from_txpktbuf(ADAPTER *adapter, int bcnhead, u8 *content, u16 *size); -+ -+int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, u8 mask); -+int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, u16 mask); -+int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, u32 mask); -+int _rtw_IOL_append_WRF_cmd(struct xmit_frame *xmit_frame, u8 rf_path, u16 addr, u32 value, u32 mask); -+#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value, mask) _rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value), (mask)) -+#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value, mask) _rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value), (mask)) -+#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value, mask) _rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value), (mask)) -+#define rtw_IOL_append_WRF_cmd(xmit_frame, rf_path, addr, value, mask) _rtw_IOL_append_WRF_cmd((xmit_frame), (rf_path), (addr), (value), (mask)) -+ -+u8 rtw_IOL_cmd_boundary_handle(struct xmit_frame *pxmit_frame); -+void rtw_IOL_cmd_buf_dump(ADAPTER *Adapter, int buf_len, u8 *pbuf); -+ -+#ifdef CONFIG_IOL_IOREG_CFG_DBG -+struct cmd_cmp { -+ u16 addr; -+ u32 value; -+}; -+#endif -+ -+#else /* CONFIG_IOL_NEW_GENERATION */ -+ -+typedef struct _io_offload_cmd { -+ u8 rsvd0; -+ u8 cmd; -+ u16 address; -+ u32 value; -+} IO_OFFLOAD_CMD, IOL_CMD; -+ -+#define IOL_CMD_LLT 0x00 -+/* #define IOL_CMD_R_EFUSE 0x01 */ -+#define IOL_CMD_WB_REG 0x02 -+#define IOL_CMD_WW_REG 0x03 -+#define IOL_CMD_WD_REG 0x04 -+/* #define IOL_CMD_W_RF 0x05 */ -+#define IOL_CMD_DELAY_US 0x80 -+#define IOL_CMD_DELAY_MS 0x81 -+/* #define IOL_CMD_DELAY_S 0x82 */ -+#define IOL_CMD_END 0x83 -+ -+/***************************************************** -+CMD Address Value -+(B1) (B2/B3:H/L addr) (B4:B7 : MSB:LSB) -+****************************************************** -+IOL_CMD_LLT - B7: PGBNDY -+IOL_CMD_R_EFUSE - - -+IOL_CMD_WB_REG 0x0~0xFFFF B7 -+IOL_CMD_WW_REG 0x0~0xFFFF B6~B7 -+IOL_CMD_WD_REG 0x0~0xFFFF B4~B7 -+IOL_CMD_W_RF RF Reg B5~B7 -+IOL_CMD_DELAY_US - B6~B7 -+IOL_CMD_DELAY_MS - B6~B7 -+IOL_CMD_DELAY_S - B6~B7 -+IOL_CMD_END - - -+******************************************************/ -+int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value); -+int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value); -+int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value); -+ -+ -+int rtw_IOL_exec_cmd_array_sync(PADAPTER adapter, u8 *IOL_cmds, u32 cmd_num, u32 max_wating_ms); -+int rtw_IOL_exec_empty_cmds_sync(ADAPTER *adapter, u32 max_wating_ms); -+ -+#ifdef DBG_IO -+int dbg_rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, const char *caller, const int line); -+int dbg_rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, const char *caller, const int line); -+int dbg_rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, const char *caller, const int line); -+#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) -+#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) -+#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) -+#else -+#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value) _rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value)) -+#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value) _rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value)) -+#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value) _rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value)) -+#endif /* DBG_IO */ -+#endif /* CONFIG_IOL_NEW_GENERATION */ -+ -+ -+ -+#endif /* __RTW_IOL_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mcc.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mcc.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mcc.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mcc.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,207 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ ******************************************************************************/ -+#ifdef CONFIG_MCC_MODE -+ -+#ifndef _RTW_MCC_H_ -+#define _RTW_MCC_H_ -+ -+#include /* PADAPTER */ -+ -+#define MCC_STATUS_PROCESS_MCC_START_SETTING BIT0 -+#define MCC_STATUS_PROCESS_MCC_STOP_SETTING BIT1 -+#define MCC_STATUS_NEED_MCC BIT2 -+#define MCC_STATUS_DOING_MCC BIT3 -+ -+ -+#define MCC_DURATION 35 /* ms */ -+#define MCC_SWCH_FW_EARLY_TIME 10 /* ms */ -+#define MCC_EXPIRE_TIME 50 /* ms */ -+#define MCC_TOLERANCE_TIME 2 /* 2*2 = 4s */ -+ -+#define MCC_ROLE_STA_GC_MGMT_QUEUE_MACID 0 -+#define MCC_ROLE_SOFTAP_GO_MGMT_QUEUE_MACID 1 -+ -+/* Lower for stop, Higher for start */ -+#define MCC_SETCMD_STATUS_STOP_DISCONNECT 0x0 -+#define MCC_SETCMD_STATUS_STOP_SCAN_START 0x1 -+#define MCC_SETCMD_STATUS_START_CONNECT 0x80 -+#define MCC_SETCMD_STATUS_START_SCAN_DONE 0x81 -+ -+/* -+* depenad platform or customer requirement(TP unit:Mbps), -+* must be provided by PM or sales or product document -+* too large value means not to limit tx bytes (current for ap mode) -+* NOTE: following values ref from test results -+*/ -+#define MCC_AP_BW20_TARGET_TX_TP (300) -+#define MCC_AP_BW40_TARGET_TX_TP (300) -+#define MCC_AP_BW80_TARGET_TX_TP (300) -+#define MCC_STA_BW20_TARGET_TX_TP (35) -+#define MCC_STA_BW40_TARGET_TX_TP (70) -+#define MCC_STA_BW80_TARGET_TX_TP (140) -+#define MCC_SINGLE_TX_CRITERIA 5 /* Mbps */ -+ -+#define MAX_MCC_NUM 2 -+ -+#define MCC_STOP(adapter) (adapter->mcc_adapterpriv.mcc_tx_stop) -+#define MCC_EN(adapter) (adapter->registrypriv.en_mcc) -+ -+/* Represent Channel Tx Null setting */ -+enum mcc_channel_tx_null { -+ MCC_ENABLE_TX_NULL = 0, -+ MCC_DISABLE_TX_NULL = 1, -+}; -+ -+/* Represent C2H Report setting */ -+enum mcc_c2h_report { -+ MCC_C2H_REPORT_DISABLE = 0, -+ MCC_C2H_REPORT_FAIL_STATUS = 1, -+ MCC_C2H_REPORT_ALL_STATUS = 2, -+}; -+ -+/* Represent Channel Scan */ -+enum mcc_channel_scan { -+ MCC_CHIDX = 0, -+ MCC_SCANCH_RSVD_LOC = 1, -+}; -+ -+/* Represent FW status report of channel switch */ -+enum mcc_status_rpt { -+ MCC_RPT_SUCCESS = 0, -+ MCC_RPT_TXNULL_FAIL = 1, -+ MCC_RPT_STOPMCC = 2, -+ MCC_RPT_READY = 3, -+ MCC_RPT_SWICH_CHANNEL_NOTIFY = 7, -+ MCC_RPT_MAX, -+}; -+ -+enum MCC_ROLE { -+ MCC_ROLE_STA = 0, -+ MCC_ROLE_AP = 1, -+ MCC_ROLE_GC = 2, -+ MCC_ROLE_GO = 3, -+ MCC_ROLE_MAX, -+}; -+ -+struct mcc_iqk_backup { -+ u16 TX_X; -+ u16 TX_Y; -+ u16 RX_X; -+ u16 RX_Y; -+}; -+ -+/* mcc data for adapter */ -+struct mcc_adapter_priv { -+ u8 order; /* FW document, softap/AP must be 0 */ -+ u8 role; /* MCC role(AP,STA,GO,GC) */ -+ u8 mcc_duration; /* channel stay period, UNIT:1TU */ -+ -+ /* flow control */ -+ u8 mcc_tx_stop; /* check if tp stop or not */ -+ u8 mcc_tp_limit; /* check if tp limit or not */ -+ u32 mcc_target_tx_bytes_to_port; /* customer require */ -+ u32 mcc_tx_bytes_to_port; /* already tx to tx fifo (write port) */ -+ -+ /* data from kernel to check if enqueue data or netif stop queue */ -+ u32 mcc_tp; -+ u64 mcc_tx_bytes_from_kernel; -+ u64 mcc_last_tx_bytes_from_kernel; -+ -+ /* Backup IQK value for MCC */ -+ struct mcc_iqk_backup mcc_iqk_arr[MAX_RF_PATH]; -+ -+ /* mgmt queue macid to avoid RA issue */ -+ u8 mgmt_queue_macid; -+ -+ /* set macid bitmap to let fw know which macid should be tx pause */ -+ /* all interface share total 16 macid */ -+ u16 mcc_macid_bitmap; -+}; -+ -+struct mcc_obj_priv { -+ u8 duration; /* channel stay period, UNIT:1TU */ -+ u8 mcc_c2h_status; -+ u8 cur_mcc_success_cnt; /* used for check mcc switch channel success */ -+ u8 prev_mcc_success_cnt; /* used for check mcc switch channel success */ -+ u8 mcc_tolerance_time; /* used for detect mcc switch channel success */ -+ u8 mcc_loc_rsvd_paga[MAX_MCC_NUM]; /* mcc rsvd page */ -+ u8 mcc_status; /* mcc status stop or start .... */ -+ u32 mcc_launch_time; /* mcc launch time, used for starting detect mcc switch channel success */ -+ _mutex mcc_mutex; -+ _lock mcc_lock; -+ PADAPTER iface[MAX_MCC_NUM]; /* by order, use for mcc parameter cmd */ -+ struct submit_ctx mcc_sctx; -+}; -+ -+/* backup IQK val */ -+void rtw_hal_mcc_backup_IQK_val(PADAPTER padapter); -+ -+/* check mcc status */ -+u8 rtw_hal_check_mcc_status(PADAPTER padapter, u8 mcc_status); -+ -+/* set mcc status */ -+void rtw_hal_set_mcc_status(PADAPTER padapter, u8 mcc_status); -+ -+/* clear mcc status */ -+void rtw_hal_clear_mcc_status(PADAPTER padapter, u8 mcc_status); -+ -+/* dl mcc rsvd page */ -+u8 rtw_hal_dl_mcc_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 *index -+ , u8 tx_desc, u32 page_size, u8 *page_num, u32 *total_pkt_len, RSVDPAGE_LOC *rsvd_page_loc); -+ -+/* handle C2H */ -+void rtw_hal_mcc_c2h_handler(PADAPTER padapter, u8 buflen, u8 *tmpBuf); -+ -+/* switch channel successfully or not */ -+void rtw_hal_mcc_sw_status_check(PADAPTER padapter); -+ -+/* change some scan flags under site survey */ -+u8 rtw_hal_mcc_change_scan_flag(PADAPTER padapter, u8 *ch, u8 *bw, u8 *offset); -+ -+/* record data kernel TX to driver to check MCC concurrent TX */ -+void rtw_hal_mcc_calc_tx_bytes_from_kernel(PADAPTER padapter, u32 len); -+ -+/* record data to port to let driver do flow ctrl */ -+void rtw_hal_mcc_calc_tx_bytes_to_port(PADAPTER padapter, u32 len); -+ -+/* check stop write port or not */ -+u8 rtw_hal_mcc_stop_tx_bytes_to_port(PADAPTER padapter); -+ -+u8 rtw_hal_set_mcc_setting_scan_start(PADAPTER padapter); -+ -+u8 rtw_hal_set_mcc_setting_scan_complete(PADAPTER padapter); -+ -+u8 rtw_hal_set_mcc_setting_start_bss_network(PADAPTER padapter, u8 chbw_grouped); -+ -+u8 rtw_hal_set_mcc_setting_disconnect(PADAPTER padapter); -+ -+u8 rtw_hal_set_mcc_setting_join_done_chk_ch(PADAPTER padapter); -+ -+u8 rtw_hal_set_mcc_setting_chk_start_clnt_join(PADAPTER padapter, u8 *ch, u8 *bw, u8 *offset, u8 chbw_allow); -+ -+void rtw_hal_dump_mcc_info(void *sel, struct dvobj_priv *dvobj); -+ -+void update_mcc_mgntframe_attrib(_adapter *padapter, struct pkt_attrib *pattrib); -+ -+u8 rtw_hal_mcc_link_status_chk(_adapter *padapter, const char *msg); -+ -+void rtw_hal_mcc_issue_null_data(_adapter *padapter, u8 chbw_allow, u8 ps_mode); -+ -+#endif /* _RTW_MCC_H_ */ -+#endif /* CONFIG_MCC_MODE */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mem.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mem.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mem.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mem.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_MEM_H__ -+#define __RTW_MEM_H__ -+ -+#include -+#include -+#include -+ -+#ifdef CONFIG_PLATFORM_MSTAR_HIGH -+ #define MAX_RTKM_RECVBUF_SZ (31744) /* 31k */ -+#else -+ #define MAX_RTKM_RECVBUF_SZ (15360) /* 15k */ -+#endif /* CONFIG_PLATFORM_MSTAR_HIGH */ -+#define MAX_RTKM_NR_PREALLOC_RECV_SKB 16 -+ -+u16 rtw_rtkm_get_buff_size(void); -+u8 rtw_rtkm_get_nr_recv_skb(void); -+struct u8 *rtw_alloc_revcbuf_premem(void); -+struct sk_buff *rtw_alloc_skb_premem(u16 in_size); -+int rtw_free_skb_premem(struct sk_buff *pskb); -+ -+ -+#endif /* __RTW_MEM_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mi.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mi.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mi.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mi.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,240 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_MI_H_ -+#define __RTW_MI_H_ -+ -+void rtw_mi_update_union_chan_inf(_adapter *adapter, u8 ch, u8 offset , u8 bw); -+int rtw_mi_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset); -+int rtw_mi_get_ch_setting_union_no_self(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset); -+ -+struct mi_state { -+ u8 sta_num; /*WIFI_FW_STATION_STATE*/ -+ u8 ld_sta_num; /*WIFI_FW_STATION_STATE |_FW_LINKED*/ -+ u8 lg_sta_num; /*WIFI_FW_STATION_STATE |_FW_UNDER_LINKING*/ -+ u8 ap_num; /*WIFI_FW_AP_STATE|_FW_LINKED*/ -+ u8 ld_ap_num; /*WIFI_FW_AP_STATE|_FW_LINKED && asoc_sta_count > 2*/ -+ u8 adhoc_num; /* WIFI_FW_ADHOC_STATE */ -+ u8 ld_adhoc_num; /* WIFI_FW_ADHOC_STATE && asoc_sta_count > 2 */ -+ u8 uwps_num; /*WIFI_UNDER_WPS*/ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ #ifdef CONFIG_P2P -+ u8 roch_num; -+ #endif -+ u8 mgmt_tx_num; -+#endif -+ -+ u8 union_ch; -+ u8 union_bw; -+ u8 union_offset; -+}; -+ -+#define MSTATE_STA_NUM(_mstate) ((_mstate)->sta_num) -+#define MSTATE_STA_LD_NUM(_mstate) ((_mstate)->ld_sta_num) -+#define MSTATE_STA_LG_NUM(_mstate) ((_mstate)->lg_sta_num) -+#define MSTATE_AP_NUM(_mstate) ((_mstate)->ap_num) -+#define MSTATE_AP_LD_NUM(_mstate) ((_mstate)->ld_ap_num) -+#define MSTATE_ADHOC_NUM(_mstate) ((_mstate)->adhoc_num) -+#define MSTATE_ADHOC_LD_NUM(_mstate) ((_mstate)->ld_adhoc_num) -+#define MSTATE_WPS_NUM(_mstate) ((_mstate)->uwps_num) -+ -+#if defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P) -+#define MSTATE_ROCH_NUM(_mstate) ((_mstate)->roch_num) -+#else -+#define MSTATE_ROCH_NUM(_mstate) 0 -+#endif -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+#define MSTATE_MGMT_TX_NUM(_mstate) ((_mstate)->mgmt_tx_num) -+#else -+#define MSTATE_MGMT_TX_NUM(_mstate) 0 -+#endif -+ -+#define MSTATE_U_CH(_mstate) ((_mstate)->union_ch) -+#define MSTATE_U_BW(_mstate) ((_mstate)->union_bw) -+#define MSTATE_U_OFFSET(_mstate) ((_mstate)->union_offset) -+ -+#define rtw_mi_get_union_chan(adapter) adapter_to_dvobj(adapter)->iface_state.union_ch -+#define rtw_mi_get_union_bw(adapter) adapter_to_dvobj(adapter)->iface_state.union_bw -+#define rtw_mi_get_union_offset(adapter) adapter_to_dvobj(adapter)->iface_state.union_offset -+ -+#define rtw_mi_get_assoced_sta_num(adapter) DEV_STA_LD_NUM(adapter_to_dvobj(adapter)) -+#define rtw_mi_get_ap_num(adapter) DEV_AP_NUM(adapter_to_dvobj(adapter)) -+ -+/* For now, not return union_ch/bw/offset */ -+void rtw_mi_status(_adapter *adapter, struct mi_state *mstate); -+void rtw_mi_status_no_self(_adapter *adapter, struct mi_state *mstate); -+ -+void rtw_mi_update_iface_status(struct mlme_priv *pmlmepriv, sint state); -+ -+u8 rtw_mi_mp_mode_check(_adapter *padapter); -+ -+u8 rtw_mi_netif_stop_queue(_adapter *padapter, bool carrier_off); -+u8 rtw_mi_buddy_netif_stop_queue(_adapter *padapter, bool carrier_off); -+ -+u8 rtw_mi_netif_wake_queue(_adapter *padapter); -+u8 rtw_mi_buddy_netif_wake_queue(_adapter *padapter); -+ -+u8 rtw_mi_netif_carrier_on(_adapter *padapter); -+u8 rtw_mi_buddy_netif_carrier_on(_adapter *padapter); -+ -+void rtw_mi_scan_abort(_adapter *adapter, bool bwait); -+void rtw_mi_buddy_scan_abort(_adapter *adapter, bool bwait); -+void rtw_mi_start_drv_threads(_adapter *adapter); -+void rtw_mi_buddy_start_drv_threads(_adapter *adapter); -+void rtw_mi_stop_drv_threads(_adapter *adapter); -+void rtw_mi_buddy_stop_drv_threads(_adapter *adapter); -+void rtw_mi_cancel_all_timer(_adapter *adapter); -+void rtw_mi_buddy_cancel_all_timer(_adapter *adapter); -+void rtw_mi_reset_drv_sw(_adapter *adapter); -+void rtw_mi_buddy_reset_drv_sw(_adapter *adapter); -+ -+extern void rtw_intf_start(_adapter *adapter); -+extern void rtw_intf_stop(_adapter *adapter); -+void rtw_mi_intf_start(_adapter *adapter); -+void rtw_mi_buddy_intf_start(_adapter *adapter); -+void rtw_mi_intf_stop(_adapter *adapter); -+void rtw_mi_buddy_intf_stop(_adapter *adapter); -+ -+void rtw_mi_suspend_free_assoc_resource(_adapter *adapter); -+void rtw_mi_buddy_suspend_free_assoc_resource(_adapter *adapter); -+ -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+void rtw_mi_set_scan_deny(_adapter *adapter, u32 ms); -+void rtw_mi_buddy_set_scan_deny(_adapter *adapter, u32 ms); -+#else -+#define rtw_mi_set_scan_deny(adapter, ms) do {} while (0) -+#define rtw_mi_buddy_set_scan_deny(adapter, ms) do {} while (0) -+#endif -+ -+u8 rtw_mi_is_scan_deny(_adapter *adapter); -+u8 rtw_mi_buddy_is_scan_deny(_adapter *adapter); -+ -+u8 rtw_mi_issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); -+u8 rtw_mi_buddy_issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); -+ -+void rtw_mi_beacon_update(_adapter *padapter); -+void rtw_mi_buddy_beacon_update(_adapter *padapter); -+ -+void rtw_mi_hal_dump_macaddr(_adapter *padapter); -+void rtw_mi_buddy_hal_dump_macaddr(_adapter *padapter); -+ -+#ifdef CONFIG_PCI_HCI -+void rtw_mi_xmit_tasklet_schedule(_adapter *padapter); -+void rtw_mi_buddy_xmit_tasklet_schedule(_adapter *padapter); -+#endif -+ -+u8 rtw_mi_busy_traffic_check(_adapter *padapter, bool check_sc_interval); -+u8 rtw_mi_buddy_busy_traffic_check(_adapter *padapter, bool check_sc_interval); -+ -+u8 rtw_mi_check_mlmeinfo_state(_adapter *padapter, u32 state); -+u8 rtw_mi_buddy_check_mlmeinfo_state(_adapter *padapter, u32 state); -+ -+u8 rtw_mi_check_fwstate(_adapter *padapter, sint state); -+u8 rtw_mi_buddy_check_fwstate(_adapter *padapter, sint state); -+enum { -+ MI_LINKED, -+ MI_ASSOC, -+ MI_UNDER_WPS, -+ MI_AP_MODE, -+ MI_AP_ASSOC, -+ MI_ADHOC, -+ MI_ADHOC_ASSOC, -+ MI_STA_NOLINK, /* this is misleading, but not used now */ -+ MI_STA_LINKED, -+ MI_STA_LINKING, -+}; -+u8 rtw_mi_check_status(_adapter *adapter, u8 type); -+ -+void dump_dvobj_mi_status(void *sel, const char *fun_name, _adapter *adapter); -+#ifdef DBG_IFACE_STATUS -+#define DBG_IFACE_STATUS_DUMP(adapter) dump_dvobj_mi_status(RTW_DBGDUMP, __func__, adapter) -+#endif -+void dump_mi_status(void *sel, struct dvobj_priv *dvobj); -+ -+u8 rtw_mi_traffic_statistics(_adapter *padapter); -+u8 rtw_mi_check_miracast_enabled(_adapter *padapter); -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+u8 rtw_mi_check_pending_xmitbuf(_adapter *padapter); -+u8 rtw_mi_buddy_check_pending_xmitbuf(_adapter *padapter); -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifdef CONFIG_RTL8822B -+ #include -+#else -+ extern s32 _dequeue_writeport(PADAPTER padapter); -+#endif -+u8 rtw_mi_dequeue_writeport(_adapter *padapter); -+u8 rtw_mi_buddy_dequeue_writeport(_adapter *padapter); -+#endif -+ -+void rtw_mi_adapter_reset(_adapter *padapter); -+void rtw_mi_buddy_adapter_reset(_adapter *padapter); -+ -+u8 rtw_mi_dynamic_check_timer_handlder(_adapter *padapter); -+u8 rtw_mi_buddy_dynamic_check_timer_handlder(_adapter *padapter); -+ -+u8 rtw_mi_dev_unload(_adapter *padapter); -+u8 rtw_mi_buddy_dev_unload(_adapter *padapter); -+ -+extern void rtw_iface_dynamic_chk_wk_hdl(_adapter *padapter); -+u8 rtw_mi_dynamic_chk_wk_hdl(_adapter *padapter); -+u8 rtw_mi_buddy_dynamic_chk_wk_hdl(_adapter *padapter); -+ -+u8 rtw_mi_os_xmit_schedule(_adapter *padapter); -+u8 rtw_mi_buddy_os_xmit_schedule(_adapter *padapter); -+ -+u8 rtw_mi_report_survey_event(_adapter *padapter, union recv_frame *precv_frame); -+u8 rtw_mi_buddy_report_survey_event(_adapter *padapter, union recv_frame *precv_frame); -+ -+extern void sreset_start_adapter(_adapter *padapter); -+extern void sreset_stop_adapter(_adapter *padapter); -+u8 rtw_mi_sreset_adapter_hdl(_adapter *padapter, u8 bstart); -+u8 rtw_mi_buddy_sreset_adapter_hdl(_adapter *padapter, u8 bstart); -+ -+u8 rtw_mi_tx_beacon_hdl(_adapter *padapter); -+u8 rtw_mi_buddy_tx_beacon_hdl(_adapter *padapter); -+ -+u8 rtw_mi_set_tx_beacon_cmd(_adapter *padapter); -+u8 rtw_mi_buddy_set_tx_beacon_cmd(_adapter *padapter); -+ -+#ifdef CONFIG_P2P -+u8 rtw_mi_p2p_chk_state(_adapter *padapter, enum P2P_STATE p2p_state); -+u8 rtw_mi_buddy_p2p_chk_state(_adapter *padapter, enum P2P_STATE p2p_state); -+u8 rtw_mi_stay_in_p2p_mode(_adapter *padapter); -+u8 rtw_mi_buddy_stay_in_p2p_mode(_adapter *padapter); -+#endif -+ -+_adapter *rtw_get_iface_by_id(_adapter *padapter, u8 iface_id); -+_adapter *rtw_get_iface_by_macddr(_adapter *padapter, u8 *mac_addr); -+_adapter *rtw_get_iface_by_hwport(_adapter *padapter, u8 hw_port); -+ -+void rtw_mi_buddy_clone_bcmc_packet(_adapter *padapter, union recv_frame *precvframe, u8 *pphy_status); -+ -+#ifdef CONFIG_PCI_HCI -+/*API be create temporary for MI, caller is interrupt-handler, PCIE's interrupt handler cannot apply to multi-AP*/ -+_adapter *rtw_mi_get_ap_adapter(_adapter *padapter); -+#endif -+ -+void rtw_mi_update_ap_bmc_camid(_adapter *padapter, u8 camid_a, u8 camid_b); -+ -+#endif /*__RTW_MI_H_*/ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mlme_ext.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mlme_ext.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mlme_ext.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mlme_ext.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,1287 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_MLME_EXT_H_ -+#define __RTW_MLME_EXT_H_ -+ -+ -+/* Commented by Albert 20101105 -+ * Increase the SURVEY_TO value from 100 to 150 ( 100ms to 150ms ) -+ * The Realtek 8188CE SoftAP will spend around 100ms to send the probe response after receiving the probe request. -+ * So, this driver tried to extend the dwell time for each scanning channel. -+ * This will increase the chance to receive the probe response from SoftAP. */ -+ -+#define SURVEY_TO (100) -+#define REAUTH_TO (300) /* (50) */ -+#define REASSOC_TO (300) /* (50) */ -+/* #define DISCONNECT_TO (3000) */ -+#define ADDBA_TO (2000) -+ -+#define LINKED_TO (1) /* unit:2 sec, 1x2 = 2 sec */ -+ -+#define REAUTH_LIMIT (4) -+#define REASSOC_LIMIT (4) -+#define READDBA_LIMIT (2) -+ -+#ifdef CONFIG_GSPI_HCI -+ #define ROAMING_LIMIT 5 -+#else -+ #define ROAMING_LIMIT 8 -+#endif -+/* #define IOCMD_REG0 0x10250370 */ -+/* #define IOCMD_REG1 0x10250374 */ -+/* #define IOCMD_REG2 0x10250378 */ -+ -+/* #define FW_DYNAMIC_FUN_SWITCH 0x10250364 */ -+ -+/* #define WRITE_BB_CMD 0xF0000001 */ -+/* #define SET_CHANNEL_CMD 0xF3000000 */ -+/* #define UPDATE_RA_CMD 0xFD0000A2 */ -+ -+#define _HW_STATE_NOLINK_ 0x00 -+#define _HW_STATE_ADHOC_ 0x01 -+#define _HW_STATE_STATION_ 0x02 -+#define _HW_STATE_AP_ 0x03 -+#define _HW_STATE_MONITOR_ 0x04 -+ -+ -+#define _1M_RATE_ 0 -+#define _2M_RATE_ 1 -+#define _5M_RATE_ 2 -+#define _11M_RATE_ 3 -+#define _6M_RATE_ 4 -+#define _9M_RATE_ 5 -+#define _12M_RATE_ 6 -+#define _18M_RATE_ 7 -+#define _24M_RATE_ 8 -+#define _36M_RATE_ 9 -+#define _48M_RATE_ 10 -+#define _54M_RATE_ 11 -+ -+/******************************************************** -+MCS rate definitions -+*********************************************************/ -+#define MCS_RATE_1R (0x000000ff) -+#define MCS_RATE_2R (0x0000ffff) -+#define MCS_RATE_3R (0x00ffffff) -+#define MCS_RATE_4R (0xffffffff) -+#define MCS_RATE_2R_13TO15_OFF (0x00001fff) -+ -+ -+extern unsigned char RTW_WPA_OUI[]; -+extern unsigned char WMM_OUI[]; -+extern unsigned char WPS_OUI[]; -+extern unsigned char WFD_OUI[]; -+extern unsigned char P2P_OUI[]; -+ -+extern unsigned char WMM_INFO_OUI[]; -+extern unsigned char WMM_PARA_OUI[]; -+ -+typedef enum _RT_CHANNEL_DOMAIN { -+ /* ===== 0x00 ~ 0x1F, legacy channel plan ===== */ -+ RTW_CHPLAN_FCC = 0x00, -+ RTW_CHPLAN_IC = 0x01, -+ RTW_CHPLAN_ETSI = 0x02, -+ RTW_CHPLAN_SPAIN = 0x03, -+ RTW_CHPLAN_FRANCE = 0x04, -+ RTW_CHPLAN_MKK = 0x05, -+ RTW_CHPLAN_MKK1 = 0x06, -+ RTW_CHPLAN_ISRAEL = 0x07, -+ RTW_CHPLAN_TELEC = 0x08, -+ RTW_CHPLAN_GLOBAL_DOAMIN = 0x09, -+ RTW_CHPLAN_WORLD_WIDE_13 = 0x0A, -+ RTW_CHPLAN_TAIWAN = 0x0B, -+ RTW_CHPLAN_CHINA = 0x0C, -+ RTW_CHPLAN_SINGAPORE_INDIA_MEXICO = 0x0D, -+ RTW_CHPLAN_KOREA = 0x0E, -+ RTW_CHPLAN_TURKEY = 0x0F, -+ RTW_CHPLAN_JAPAN = 0x10, -+ RTW_CHPLAN_FCC_NO_DFS = 0x11, -+ RTW_CHPLAN_JAPAN_NO_DFS = 0x12, -+ RTW_CHPLAN_WORLD_WIDE_5G = 0x13, -+ RTW_CHPLAN_TAIWAN_NO_DFS = 0x14, -+ -+ /* ===== 0x20 ~ 0x7F, new channel plan ===== */ -+ RTW_CHPLAN_WORLD_NULL = 0x20, -+ RTW_CHPLAN_ETSI1_NULL = 0x21, -+ RTW_CHPLAN_FCC1_NULL = 0x22, -+ RTW_CHPLAN_MKK1_NULL = 0x23, -+ RTW_CHPLAN_ETSI2_NULL = 0x24, -+ RTW_CHPLAN_FCC1_FCC1 = 0x25, -+ RTW_CHPLAN_WORLD_ETSI1 = 0x26, -+ RTW_CHPLAN_MKK1_MKK1 = 0x27, -+ RTW_CHPLAN_WORLD_KCC1 = 0x28, -+ RTW_CHPLAN_WORLD_FCC2 = 0x29, -+ RTW_CHPLAN_FCC2_NULL = 0x2A, -+ RTW_CHPLAN_WORLD_FCC3 = 0x30, -+ RTW_CHPLAN_WORLD_FCC4 = 0x31, -+ RTW_CHPLAN_WORLD_FCC5 = 0x32, -+ RTW_CHPLAN_WORLD_FCC6 = 0x33, -+ RTW_CHPLAN_FCC1_FCC7 = 0x34, -+ RTW_CHPLAN_WORLD_ETSI2 = 0x35, -+ RTW_CHPLAN_WORLD_ETSI3 = 0x36, -+ RTW_CHPLAN_MKK1_MKK2 = 0x37, -+ RTW_CHPLAN_MKK1_MKK3 = 0x38, -+ RTW_CHPLAN_FCC1_NCC1 = 0x39, -+ RTW_CHPLAN_FCC1_NCC2 = 0x40, -+ RTW_CHPLAN_GLOBAL_NULL = 0x41, -+ RTW_CHPLAN_ETSI1_ETSI4 = 0x42, -+ RTW_CHPLAN_FCC1_FCC2 = 0x43, -+ RTW_CHPLAN_FCC1_NCC3 = 0x44, -+ RTW_CHPLAN_WORLD_ETSI5 = 0x45, -+ RTW_CHPLAN_FCC1_FCC8 = 0x46, -+ RTW_CHPLAN_WORLD_ETSI6 = 0x47, -+ RTW_CHPLAN_WORLD_ETSI7 = 0x48, -+ RTW_CHPLAN_WORLD_ETSI8 = 0x49, -+ RTW_CHPLAN_WORLD_ETSI9 = 0x50, -+ RTW_CHPLAN_WORLD_ETSI10 = 0x51, -+ RTW_CHPLAN_WORLD_ETSI11 = 0x52, -+ RTW_CHPLAN_FCC1_NCC4 = 0x53, -+ RTW_CHPLAN_WORLD_ETSI12 = 0x54, -+ RTW_CHPLAN_FCC1_FCC9 = 0x55, -+ RTW_CHPLAN_WORLD_ETSI13 = 0x56, -+ RTW_CHPLAN_FCC1_FCC10 = 0x57, -+ RTW_CHPLAN_MKK2_MKK4 = 0x58, -+ RTW_CHPLAN_WORLD_ETSI14 = 0x59, -+ RTW_CHPLAN_FCC1_FCC5 = 0x60, -+ RTW_CHPLAN_FCC2_FCC7 = 0x61, -+ RTW_CHPLAN_FCC2_FCC1 = 0x62, -+ -+ RTW_CHPLAN_MAX, -+ RTW_CHPLAN_REALTEK_DEFINE = 0x7F, -+} RT_CHANNEL_DOMAIN, *PRT_CHANNEL_DOMAIN; -+ -+typedef enum _RT_CHANNEL_DOMAIN_2G { -+ RTW_RD_2G_NULL = 0, -+ RTW_RD_2G_WORLD = 1, /* Worldwird 13 */ -+ RTW_RD_2G_ETSI1 = 2, /* Europe */ -+ RTW_RD_2G_FCC1 = 3, /* US */ -+ RTW_RD_2G_MKK1 = 4, /* Japan */ -+ RTW_RD_2G_ETSI2 = 5, /* France */ -+ RTW_RD_2G_GLOBAL = 6, /* Global domain */ -+ RTW_RD_2G_MKK2 = 7, /* Japan */ -+ RTW_RD_2G_FCC2 = 8, /* US */ -+ -+ RTW_RD_2G_MAX, -+} RT_CHANNEL_DOMAIN_2G, *PRT_CHANNEL_DOMAIN_2G; -+ -+typedef enum _RT_CHANNEL_DOMAIN_5G { -+ RTW_RD_5G_NULL = 0, /* */ -+ RTW_RD_5G_ETSI1 = 1, /* Europe */ -+ RTW_RD_5G_ETSI2 = 2, /* Australia, New Zealand */ -+ RTW_RD_5G_ETSI3 = 3, /* Russia */ -+ RTW_RD_5G_FCC1 = 4, /* US */ -+ RTW_RD_5G_FCC2 = 5, /* FCC w/o DFS Channels */ -+ RTW_RD_5G_FCC3 = 6, /* Bolivia, Chile, El Salvador, Venezuela */ -+ RTW_RD_5G_FCC4 = 7, /* Venezuela */ -+ RTW_RD_5G_FCC5 = 8, /* China */ -+ RTW_RD_5G_FCC6 = 9, /* */ -+ RTW_RD_5G_FCC7 = 10, /* US Canada(w/o Weather radar) */ -+ RTW_RD_5G_KCC1 = 11, /* Korea */ -+ RTW_RD_5G_MKK1 = 12, /* Japan */ -+ RTW_RD_5G_MKK2 = 13, /* Japan (W52, W53) */ -+ RTW_RD_5G_MKK3 = 14, /* Japan (W56) */ -+ RTW_RD_5G_NCC1 = 15, /* Taiwan, (w/o Weather radar) */ -+ RTW_RD_5G_NCC2 = 16, /* Taiwan, Band2, Band4 */ -+ RTW_RD_5G_NCC3 = 17, /* Taiwan w/o DFS, Band4 only */ -+ RTW_RD_5G_ETSI4 = 18, /* Europe w/o DFS, Band1 only */ -+ RTW_RD_5G_ETSI5 = 19, /* Australia, New Zealand(w/o Weather radar) */ -+ RTW_RD_5G_FCC8 = 20, /* Latin America */ -+ RTW_RD_5G_ETSI6 = 21, /* Israel, Bahrain, Egypt, India, China, Malaysia */ -+ RTW_RD_5G_ETSI7 = 22, /* China */ -+ RTW_RD_5G_ETSI8 = 23, /* Jordan */ -+ RTW_RD_5G_ETSI9 = 24, /* Lebanon */ -+ RTW_RD_5G_ETSI10 = 25, /* Qatar */ -+ RTW_RD_5G_ETSI11 = 26, /* Russia */ -+ RTW_RD_5G_NCC4 = 27, /* Taiwan, (w/o Weather radar) */ -+ RTW_RD_5G_ETSI12 = 28, /* Indonesia */ -+ RTW_RD_5G_FCC9 = 29, /* (w/o Weather radar) */ -+ RTW_RD_5G_ETSI13 = 30, /* (w/o Weather radar) */ -+ RTW_RD_5G_FCC10 = 31, /* Argentina(w/o Weather radar) */ -+ RTW_RD_5G_MKK4 = 32, /* Japan (W52) */ -+ RTW_RD_5G_ETSI14 = 33, /* Russia */ -+ RTW_RD_5G_FCC11 = 34, /* US(include CH144) */ -+ -+ /* === Below are driver defined for legacy channel plan compatible, DON'T assign index ==== */ -+ RTW_RD_5G_OLD_FCC1, -+ RTW_RD_5G_OLD_NCC1, -+ RTW_RD_5G_OLD_KCC1, -+ -+ RTW_RD_5G_MAX, -+} RT_CHANNEL_DOMAIN_5G, *PRT_CHANNEL_DOMAIN_5G; -+ -+bool rtw_chplan_is_empty(u8 id); -+#define rtw_is_channel_plan_valid(chplan) (((chplan) < RTW_CHPLAN_MAX || (chplan) == RTW_CHPLAN_REALTEK_DEFINE) && !rtw_chplan_is_empty(chplan)) -+#define rtw_is_legacy_channel_plan(chplan) ((chplan) < 0x20) -+ -+typedef struct _RT_CHANNEL_PLAN { -+ unsigned char Channel[MAX_CHANNEL_NUM]; -+ unsigned char Len; -+} RT_CHANNEL_PLAN, *PRT_CHANNEL_PLAN; -+ -+struct ch_list_t { -+ u8 *len_ch; -+}; -+ -+#define CH_LIST_ENT(_len, arg...) \ -+ {.len_ch = (u8[_len + 1]) {_len, ##arg}, } -+ -+#define CH_LIST_LEN(_ch_list) (_ch_list.len_ch[0]) -+#define CH_LIST_CH(_ch_list, _i) (_ch_list.len_ch[_i + 1]) -+ -+typedef struct _RT_CHANNEL_PLAN_MAP { -+ u8 Index2G; -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ u8 Index5G; -+#endif -+ u8 regd; /* value of REGULATION_TXPWR_LMT */ -+} RT_CHANNEL_PLAN_MAP, *PRT_CHANNEL_PLAN_MAP; -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+#define CHPLAN_ENT(i2g, i5g, regd) {i2g, i5g, regd} -+#else -+#define CHPLAN_ENT(i2g, i5g, regd) {i2g, regd} -+#endif -+ -+enum Associated_AP { -+ atherosAP = 0, -+ broadcomAP = 1, -+ ciscoAP = 2, -+ marvellAP = 3, -+ ralinkAP = 4, -+ realtekAP = 5, -+ airgocapAP = 6, -+ unknownAP = 7, -+ maxAP, -+}; -+ -+typedef enum _HT_IOT_PEER { -+ HT_IOT_PEER_UNKNOWN = 0, -+ HT_IOT_PEER_REALTEK = 1, -+ HT_IOT_PEER_REALTEK_92SE = 2, -+ HT_IOT_PEER_BROADCOM = 3, -+ HT_IOT_PEER_RALINK = 4, -+ HT_IOT_PEER_ATHEROS = 5, -+ HT_IOT_PEER_CISCO = 6, -+ HT_IOT_PEER_MERU = 7, -+ HT_IOT_PEER_MARVELL = 8, -+ HT_IOT_PEER_REALTEK_SOFTAP = 9,/* peer is RealTek SOFT_AP, by Bohn, 2009.12.17 */ -+ HT_IOT_PEER_SELF_SOFTAP = 10, /* Self is SoftAP */ -+ HT_IOT_PEER_AIRGO = 11, -+ HT_IOT_PEER_INTEL = 12, -+ HT_IOT_PEER_RTK_APCLIENT = 13, -+ HT_IOT_PEER_REALTEK_81XX = 14, -+ HT_IOT_PEER_REALTEK_WOW = 15, -+ HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP = 16, -+ HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP = 17, -+ HT_IOT_PEER_MAX = 18 -+} HT_IOT_PEER_E, *PHTIOT_PEER_E; -+ -+struct mlme_handler { -+ unsigned int num; -+ char *str; -+ unsigned int (*func)(_adapter *padapter, union recv_frame *precv_frame); -+}; -+ -+struct action_handler { -+ unsigned int num; -+ char *str; -+ unsigned int (*func)(_adapter *padapter, union recv_frame *precv_frame); -+}; -+ -+enum SCAN_STATE { -+ SCAN_DISABLE = 0, -+ SCAN_START = 1, -+ SCAN_PS_ANNC_WAIT = 2, -+ SCAN_ENTER = 3, -+ SCAN_PROCESS = 4, -+ -+ /* backop */ -+ SCAN_BACKING_OP = 5, -+ SCAN_BACK_OP = 6, -+ SCAN_LEAVING_OP = 7, -+ SCAN_LEAVE_OP = 8, -+ -+ /* SW antenna diversity (before linked) */ -+ SCAN_SW_ANTDIV_BL = 9, -+ -+ /* legacy p2p */ -+ SCAN_TO_P2P_LISTEN = 10, -+ SCAN_P2P_LISTEN = 11, -+ -+ SCAN_COMPLETE = 12, -+ SCAN_STATE_MAX, -+}; -+ -+const char *scan_state_str(u8 state); -+ -+enum ss_backop_flag { -+ SS_BACKOP_EN = BIT0, /* backop when linked */ -+ SS_BACKOP_EN_NL = BIT1, /* backop even when no linked */ -+ -+ SS_BACKOP_PS_ANNC = BIT4, -+ SS_BACKOP_TX_RESUME = BIT5, -+}; -+ -+struct ss_res { -+ u8 state; -+ u8 next_state; /* will set to state on next cmd hdl */ -+ int bss_cnt; -+ int channel_idx; -+ int scan_mode; -+ u16 scan_ch_ms; -+ u8 rx_ampdu_accept; -+ u8 rx_ampdu_size; -+ u8 igi_scan; -+ u8 igi_before_scan; /* used for restoring IGI value without enable DIG & FA_CNT */ -+#ifdef CONFIG_SCAN_BACKOP -+ u8 backop_flags_sta; /* policy for station mode*/ -+ u8 backop_flags_ap; /* policy for ap mode */ -+ u8 backop_flags; /* per backop runtime decision */ -+ u8 scan_cnt; -+ u8 scan_cnt_max; -+ u32 backop_time; /* the start time of backop */ -+ u16 backop_ms; -+#endif -+#if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) -+ u8 is_sw_antdiv_bl_scan; -+#endif -+ u8 ssid_num; -+ u8 ch_num; -+ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; -+ struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; -+}; -+ -+/* #define AP_MODE 0x0C */ -+/* #define STATION_MODE 0x08 */ -+/* #define AD_HOC_MODE 0x04 */ -+/* #define NO_LINK_MODE 0x00 */ -+ -+#define WIFI_FW_NULL_STATE _HW_STATE_NOLINK_ -+#define WIFI_FW_STATION_STATE _HW_STATE_STATION_ -+#define WIFI_FW_AP_STATE _HW_STATE_AP_ -+#define WIFI_FW_ADHOC_STATE _HW_STATE_ADHOC_ -+ -+#define WIFI_FW_AUTH_NULL 0x00000100 -+#define WIFI_FW_AUTH_STATE 0x00000200 -+#define WIFI_FW_AUTH_SUCCESS 0x00000400 -+ -+#define WIFI_FW_ASSOC_STATE 0x00002000 -+#define WIFI_FW_ASSOC_SUCCESS 0x00004000 -+ -+#define WIFI_FW_LINKING_STATE (WIFI_FW_AUTH_NULL | WIFI_FW_AUTH_STATE | WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE) -+ -+#ifdef CONFIG_TDLS -+enum TDLS_option { -+ TDLS_ESTABLISHED = 1, -+ TDLS_ISSUE_PTI, -+ TDLS_CH_SW_RESP, -+ TDLS_CH_SW_PREPARE, -+ TDLS_CH_SW_START, -+ TDLS_CH_SW_TO_OFF_CHNL, -+ TDLS_CH_SW_TO_BASE_CHNL_UNSOLICITED, -+ TDLS_CH_SW_TO_BASE_CHNL, -+ TDLS_CH_SW_END_TO_BASE_CHNL, -+ TDLS_CH_SW_END, -+ TDLS_RS_RCR, -+ TDLS_TEARDOWN_STA, -+ TDLS_TEARDOWN_STA_LOCALLY, -+ maxTDLS, -+}; -+ -+#endif /* CONFIG_TDLS */ -+ -+/* -+ * Usage: -+ * When one iface acted as AP mode and the other iface is STA mode and scanning, -+ * it should switch back to AP's operating channel periodically. -+ * Parameters info: -+ * When the driver scanned RTW_SCAN_NUM_OF_CH channels, it would switch back to AP's operating channel for -+ * RTW_BACK_OP_CH_MS milliseconds. -+ * Example: -+ * For chip supports 2.4G + 5GHz and AP mode is operating in channel 1, -+ * RTW_SCAN_NUM_OF_CH is 8, RTW_BACK_OP_CH_MS is 300 -+ * When it's STA mode gets set_scan command, -+ * it would -+ * 1. Doing the scan on channel 1.2.3.4.5.6.7.8 -+ * 2. Back to channel 1 for 300 milliseconds -+ * 3. Go through doing site survey on channel 9.10.11.36.40.44.48.52 -+ * 4. Back to channel 1 for 300 milliseconds -+ * 5. ... and so on, till survey done. -+ */ -+#if defined(CONFIG_ATMEL_RC_PATCH) -+ #define RTW_SCAN_NUM_OF_CH 2 -+ #define RTW_BACK_OP_CH_MS 200 -+#else -+ #define RTW_SCAN_NUM_OF_CH 3 -+ #define RTW_BACK_OP_CH_MS 400 -+#endif -+ -+struct mlme_ext_info { -+ u32 state; -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ u8 hw_media_state; -+#endif -+ u32 reauth_count; -+ u32 reassoc_count; -+ u32 link_count; -+ u32 auth_seq; -+ u32 auth_algo; /* 802.11 auth, could be open, shared, auto */ -+ u32 authModeToggle; -+ u32 enc_algo;/* encrypt algorithm; */ -+ u32 key_index; /* this is only valid for legendary wep, 0~3 for key id. */ -+ u32 iv; -+ u8 chg_txt[128]; -+ u16 aid; -+ u16 bcn_interval; -+ u16 capability; -+ u8 assoc_AP_vendor; -+ u8 slotTime; -+ u8 preamble_mode; -+ u8 WMM_enable; -+ u8 ERP_enable; -+ u8 ERP_IE; -+ u8 HT_enable; -+ u8 HT_caps_enable; -+ u8 HT_info_enable; -+ u8 HT_protection; -+ u8 turboMode_cts2self; -+ u8 turboMode_rtsen; -+ u8 SM_PS; -+ u8 agg_enable_bitmap; -+ u8 ADDBA_retry_count; -+ u8 candidate_tid_bitmap; -+ u8 dialogToken; -+ /* Accept ADDBA Request */ -+ BOOLEAN bAcceptAddbaReq; -+ u8 bwmode_updated; -+ u8 hidden_ssid_mode; -+ u8 VHT_enable; -+ -+ struct ADDBA_request ADDBA_req; -+ struct WMM_para_element WMM_param; -+ struct HT_caps_element HT_caps; -+ struct HT_info_element HT_info; -+ WLAN_BSSID_EX network;/* join network or bss_network, if in ap mode, it is the same to cur_network.network */ -+}; -+ -+/* The channel information about this channel including joining, scanning, and power constraints. */ -+typedef struct _RT_CHANNEL_INFO { -+ u8 ChannelNum; /* The channel number. */ -+ RT_SCAN_TYPE ScanType; /* Scan type such as passive or active scan. */ -+ /* u16 ScanPeriod; */ /* Listen time in millisecond in this channel. */ -+ /* s32 MaxTxPwrDbm; */ /* Max allowed tx power. */ -+ /* u32 ExInfo; */ /* Extended Information for this channel. */ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ u32 rx_count; -+#endif -+#ifdef CONFIG_DFS_MASTER -+ u32 non_ocp_end_time; -+#endif -+} RT_CHANNEL_INFO, *PRT_CHANNEL_INFO; -+ -+#define DFS_MASTER_TIMER_MS 100 -+#define CAC_TIME_MS (60*1000) -+#define CAC_TIME_CE_MS (10*60*1000) -+#define NON_OCP_TIME_MS (30*60*1000) -+ -+void rtw_rfctl_init(_adapter *adapter); -+ -+#ifdef CONFIG_DFS_MASTER -+struct rf_ctl_t; -+#define CH_IS_NON_OCP(rt_ch_info) (time_after((unsigned long)(rt_ch_info)->non_ocp_end_time, (unsigned long)rtw_get_current_time())) -+bool rtw_is_cac_reset_needed(_adapter *adapter, u8 ch, u8 bw, u8 offset); -+bool _rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset); -+bool rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl); -+bool rtw_rfctl_is_tx_blocked_by_ch_waiting(struct rf_ctl_t *rfctl); -+bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); -+void rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); -+void rtw_chset_update_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset, int ms); -+u32 rtw_get_ch_waiting_ms(_adapter *adapter, u8 ch, u8 bw, u8 offset, u32 *r_non_ocp_ms, u32 *r_cac_ms); -+void rtw_reset_cac(_adapter *adapter, u8 ch, u8 bw, u8 offset); -+bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 *dec_bw, u8 *dec_offset, u8 d_flags); -+#else -+#define CH_IS_NON_OCP(rt_ch_info) 0 -+#define rtw_chset_is_ch_non_ocp(ch_set, ch, bw, offset) _FALSE -+#define rtw_rfctl_is_tx_blocked_by_ch_waiting(rfctl) _FALSE -+#endif -+ -+enum { -+ RTW_CHF_2G = BIT0, -+ RTW_CHF_5G = BIT1, -+ RTW_CHF_DFS = BIT2, -+ RTW_CHF_LONG_CAC = BIT3, -+ RTW_CHF_NON_DFS = BIT4, -+ RTW_CHF_NON_LONG_CAC = BIT5, -+ RTW_CHF_NON_OCP = BIT6, -+}; -+void dump_country_chplan(void *sel, const struct country_chplan *ent); -+void dump_country_chplan_map(void *sel); -+void dump_chplan_id_list(void *sel); -+void dump_chplan_test(void *sel); -+void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set); -+void dump_cur_chset(void *sel, _adapter *adapter); -+ -+int rtw_ch_set_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch); -+u8 rtw_chset_is_chbw_valid(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); -+ -+bool rtw_mlme_band_check(_adapter *adapter, const u32 ch); -+ -+ -+enum { -+ BAND_24G = BIT0, -+ BAND_5G = BIT1, -+}; -+void RTW_SET_SCAN_BAND_SKIP(_adapter *padapter, int skip_band); -+void RTW_CLR_SCAN_BAND_SKIP(_adapter *padapter, int skip_band); -+int RTW_GET_SCAN_BAND_SKIP(_adapter *padapter); -+ -+bool rtw_mlme_ignore_chan(_adapter *adapter, const u32 ch); -+ -+/* P2P_MAX_REG_CLASSES - Maximum number of regulatory classes */ -+#define P2P_MAX_REG_CLASSES 10 -+ -+/* P2P_MAX_REG_CLASS_CHANNELS - Maximum number of channels per regulatory class */ -+#define P2P_MAX_REG_CLASS_CHANNELS 20 -+ -+/* struct p2p_channels - List of supported channels */ -+struct p2p_channels { -+ /* struct p2p_reg_class - Supported regulatory class */ -+ struct p2p_reg_class { -+ /* reg_class - Regulatory class (IEEE 802.11-2007, Annex J) */ -+ u8 reg_class; -+ -+ /* channel - Supported channels */ -+ u8 channel[P2P_MAX_REG_CLASS_CHANNELS]; -+ -+ /* channels - Number of channel entries in use */ -+ size_t channels; -+ } reg_class[P2P_MAX_REG_CLASSES]; -+ -+ /* reg_classes - Number of reg_class entries in use */ -+ size_t reg_classes; -+}; -+ -+struct p2p_oper_class_map { -+ enum hw_mode {IEEE80211G, IEEE80211A} mode; -+ u8 op_class; -+ u8 min_chan; -+ u8 max_chan; -+ u8 inc; -+ enum { BW20, BW40PLUS, BW40MINUS } bw; -+}; -+ -+struct mlme_ext_priv { -+ _adapter *padapter; -+ u8 mlmeext_init; -+ ATOMIC_T event_seq; -+ u16 mgnt_seq; -+#ifdef CONFIG_IEEE80211W -+ u16 sa_query_seq; -+ u64 mgnt_80211w_IPN; -+ u64 mgnt_80211w_IPN_rx; -+#endif /* CONFIG_IEEE80211W */ -+ /* struct fw_priv fwpriv; */ -+ -+ unsigned char cur_channel; -+ unsigned char cur_bwmode; -+ unsigned char cur_ch_offset;/* PRIME_CHNL_OFFSET */ -+ unsigned char cur_wireless_mode; /* NETWORK_TYPE */ -+ -+ unsigned char max_chan_nums; -+ RT_CHANNEL_INFO channel_set[MAX_CHANNEL_NUM]; -+ struct p2p_channels channel_list; -+ unsigned char basicrate[NumRates]; -+ unsigned char datarate[NumRates]; -+#ifdef CONFIG_80211N_HT -+ unsigned char default_supported_mcs_set[16]; -+#endif -+ -+ struct ss_res sitesurvey_res; -+ struct mlme_ext_info mlmext_info;/* for sta/adhoc mode, including current scanning/connecting/connected related info. -+ * for ap mode, network includes ap's cap_info */ -+ _timer survey_timer; -+ _timer link_timer; -+#ifdef CONFIG_RTW_80211R -+ _timer ft_link_timer; -+ _timer ft_roam_timer; -+#endif -+ -+ /* _timer ADDBA_timer; */ -+ u32 last_scan_time; -+ u8 scan_abort; -+ u8 tx_rate; /* TXRATE when USERATE is set. */ -+ -+ u32 retry; /* retry for issue probereq */ -+ -+ u64 TSFValue; -+ -+ /* for LPS-32K to adaptive bcn early and timeout */ -+ u8 adaptive_tsf_done; -+ u32 bcn_delay_cnt[9]; -+ u32 bcn_delay_ratio[9]; -+ u32 bcn_cnt; -+ u8 DrvBcnEarly; -+ u8 DrvBcnTimeOut; -+ -+#ifdef CONFIG_AP_MODE -+ unsigned char bstart_bss; -+#endif -+ -+#ifdef CONFIG_80211D -+ u8 update_channel_plan_by_ap_done; -+#endif -+ /* recv_decache check for Action_public frame */ -+ u8 action_public_dialog_token; -+ u16 action_public_rxseq; -+ -+ /* #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ u8 active_keep_alive_check; -+ /* #endif */ -+#ifdef DBG_FIXED_CHAN -+ u8 fixed_chan; -+#endif -+ /* set hw sync bcn tsf register or not */ -+ u8 en_hw_update_tsf; -+}; -+ -+static inline u8 check_mlmeinfo_state(struct mlme_ext_priv *plmeext, sint state) -+{ -+ if ((plmeext->mlmext_info.state & 0x03) == state) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+#define mlmeext_msr(mlmeext) ((mlmeext)->mlmext_info.state & 0x03) -+#define mlmeext_scan_state(mlmeext) ((mlmeext)->sitesurvey_res.state) -+#define mlmeext_scan_state_str(mlmeext) scan_state_str((mlmeext)->sitesurvey_res.state) -+#define mlmeext_chk_scan_state(mlmeext, _state) ((mlmeext)->sitesurvey_res.state == (_state)) -+#define mlmeext_set_scan_state(mlmeext, _state) \ -+ do { \ -+ ((mlmeext)->sitesurvey_res.state = (_state)); \ -+ ((mlmeext)->sitesurvey_res.next_state = (_state)); \ -+ /* RTW_INFO("set_scan_state:%s\n", scan_state_str(_state)); */ \ -+ } while (0) -+ -+#define mlmeext_scan_next_state(mlmeext) ((mlmeext)->sitesurvey_res.next_state) -+#define mlmeext_set_scan_next_state(mlmeext, _state) \ -+ do { \ -+ ((mlmeext)->sitesurvey_res.next_state = (_state)); \ -+ /* RTW_INFO("set_scan_next_state:%s\n", scan_state_str(_state)); */ \ -+ } while (0) -+ -+#ifdef CONFIG_SCAN_BACKOP -+#define mlmeext_scan_backop_flags(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags) -+#define mlmeext_chk_scan_backop_flags(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags & (flags)) -+#define mlmeext_assign_scan_backop_flags(mlmeext, flags) \ -+ do { \ -+ ((mlmeext)->sitesurvey_res.backop_flags = (flags)); \ -+ RTW_INFO("assign_scan_backop_flags:0x%02x\n", (mlmeext)->sitesurvey_res.backop_flags); \ -+ } while (0) -+ -+#define mlmeext_scan_backop_flags_sta(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags_sta) -+#define mlmeext_chk_scan_backop_flags_sta(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags_sta & (flags)) -+#define mlmeext_assign_scan_backop_flags_sta(mlmeext, flags) \ -+ do { \ -+ ((mlmeext)->sitesurvey_res.backop_flags_sta = (flags)); \ -+ } while (0) -+ -+#define mlmeext_scan_backop_flags_ap(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags_ap) -+#define mlmeext_chk_scan_backop_flags_ap(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags_ap & (flags)) -+#define mlmeext_assign_scan_backop_flags_ap(mlmeext, flags) \ -+ do { \ -+ ((mlmeext)->sitesurvey_res.backop_flags_ap = (flags)); \ -+ } while (0) -+#else -+#define mlmeext_scan_backop_flags(mlmeext) (0) -+#define mlmeext_chk_scan_backop_flags(mlmeext, flags) (0) -+#define mlmeext_assign_scan_backop_flags(mlmeext, flags) do {} while (0) -+ -+#define mlmeext_scan_backop_flags_sta(mlmeext) (0) -+#define mlmeext_chk_scan_backop_flags_sta(mlmeext, flags) (0) -+#define mlmeext_assign_scan_backop_flags_sta(mlmeext, flags) do {} while (0) -+ -+#define mlmeext_scan_backop_flags_ap(mlmeext) (0) -+#define mlmeext_chk_scan_backop_flags_ap(mlmeext, flags) (0) -+#define mlmeext_assign_scan_backop_flags_ap(mlmeext, flags) do {} while (0) -+#endif -+ -+void init_mlme_default_rate_set(_adapter *padapter); -+int init_mlme_ext_priv(_adapter *padapter); -+int init_hw_mlme_ext(_adapter *padapter); -+void free_mlme_ext_priv(struct mlme_ext_priv *pmlmeext); -+extern void init_mlme_ext_timer(_adapter *padapter); -+extern void init_addba_retry_timer(_adapter *padapter, struct sta_info *psta); -+extern struct xmit_frame *alloc_mgtxmitframe(struct xmit_priv *pxmitpriv); -+struct xmit_frame *alloc_mgtxmitframe_once(struct xmit_priv *pxmitpriv); -+ -+/* void fill_fwpriv(_adapter * padapter, struct fw_priv *pfwpriv); */ -+#ifdef CONFIG_GET_RAID_BY_DRV -+unsigned char networktype_to_raid(_adapter *adapter, struct sta_info *psta); -+unsigned char networktype_to_raid_ex(_adapter *adapter, struct sta_info *psta); -+#endif -+u8 judge_network_type(_adapter *padapter, unsigned char *rate, int ratelen); -+void get_rate_set(_adapter *padapter, unsigned char *pbssrate, int *bssrate_len); -+void set_mcs_rate_by_mask(u8 *mcs_set, u32 mask); -+void UpdateBrateTbl(_adapter *padapter, u8 *mBratesOS); -+void UpdateBrateTblForSoftAP(u8 *bssrateset, u32 bssratelen); -+void change_band_update_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 ch); -+ -+void Set_MSR(_adapter *padapter, u8 type); -+ -+u8 rtw_get_oper_ch(_adapter *adapter); -+void rtw_set_oper_ch(_adapter *adapter, u8 ch); -+u8 rtw_get_oper_bw(_adapter *adapter); -+void rtw_set_oper_bw(_adapter *adapter, u8 bw); -+u8 rtw_get_oper_choffset(_adapter *adapter); -+void rtw_set_oper_choffset(_adapter *adapter, u8 offset); -+u8 rtw_get_center_ch(u8 channel, u8 chnl_bw, u8 chnl_offset); -+u32 rtw_get_on_oper_ch_time(_adapter *adapter); -+u32 rtw_get_on_cur_ch_time(_adapter *adapter); -+ -+u8 rtw_get_offset_by_chbw(u8 ch, u8 bw, u8 *r_offset); -+u8 rtw_get_offset_by_ch(u8 channel); -+ -+void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char channel_offset, unsigned short bwmode); -+ -+unsigned int decide_wait_for_beacon_timeout(unsigned int bcn_interval); -+ -+void _clear_cam_entry(_adapter *padapter, u8 entry); -+void write_cam_from_cache(_adapter *adapter, u8 id); -+void rtw_sec_cam_swap(_adapter *adapter, u8 cam_id_a, u8 cam_id_b); -+void rtw_clean_dk_section(_adapter *adapter); -+void rtw_clean_hw_dk_cam(_adapter *adapter); -+ -+/* modify both HW and cache */ -+void write_cam(_adapter *padapter, u8 id, u16 ctrl, u8 *mac, u8 *key); -+void clear_cam_entry(_adapter *padapter, u8 id); -+ -+/* modify cache only */ -+void write_cam_cache(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key); -+void clear_cam_cache(_adapter *adapter, u8 id); -+ -+void invalidate_cam_all(_adapter *padapter); -+void CAM_empty_entry(PADAPTER Adapter, u8 ucIndex); -+ -+void flush_all_cam_entry(_adapter *padapter); -+ -+BOOLEAN IsLegal5GChannel(PADAPTER Adapter, u8 channel); -+ -+void site_survey(_adapter *padapter, u8 survey_channel, RT_SCAN_TYPE ScanType); -+u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSID_EX *bssid); -+void update_network(WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src, _adapter *padapter, bool update_ie); -+ -+int get_bsstype(unsigned short capability); -+u8 *get_my_bssid(WLAN_BSSID_EX *pnetwork); -+u16 get_beacon_interval(WLAN_BSSID_EX *bss); -+ -+int is_client_associated_to_ap(_adapter *padapter); -+int is_client_associated_to_ibss(_adapter *padapter); -+int is_IBSS_empty(_adapter *padapter); -+ -+unsigned char check_assoc_AP(u8 *pframe, uint len); -+ -+int WMM_param_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+#ifdef CONFIG_WFD -+void rtw_process_wfd_ie(_adapter *adapter, u8 *ie, u8 ie_len, const char *tag); -+void rtw_process_wfd_ies(_adapter *adapter, u8 *ies, u8 ies_len, const char *tag); -+#endif -+void WMMOnAssocRsp(_adapter *padapter); -+ -+void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+void HT_info_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+void HTOnAssocRsp(_adapter *padapter); -+ -+void ERP_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+void VCS_update(_adapter *padapter, struct sta_info *psta); -+void update_ldpc_stbc_cap(struct sta_info *psta); -+ -+int rtw_get_bcn_keys(ADAPTER *Adapter, u8 *pframe, u32 packet_len, -+ struct beacon_keys *recv_beacon); -+void rtw_dump_bcn_keys(struct beacon_keys *recv_beacon); -+int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len); -+void update_beacon_info(_adapter *padapter, u8 *pframe, uint len, struct sta_info *psta); -+#ifdef CONFIG_DFS -+void process_csa_ie(_adapter *padapter, u8 *pframe, uint len); -+#endif /* CONFIG_DFS */ -+void update_capinfo(PADAPTER Adapter, u16 updateCap); -+void update_wireless_mode(_adapter *padapter); -+void update_tx_basic_rate(_adapter *padapter, u8 modulation); -+void update_sta_basic_rate(struct sta_info *psta, u8 wireless_mode); -+int rtw_ies_get_supported_rate(u8 *ies, uint ies_len, u8 *rate_set, u8 *rate_num); -+ -+/* for sta/adhoc mode */ -+void update_sta_info(_adapter *padapter, struct sta_info *psta); -+unsigned int update_basic_rate(unsigned char *ptn, unsigned int ptn_sz); -+unsigned int update_supported_rate(unsigned char *ptn, unsigned int ptn_sz); -+unsigned int update_MCS_rate(struct HT_caps_element *pHT_caps); -+void Update_RA_Entry(_adapter *padapter, struct sta_info *psta); -+void set_sta_rate(_adapter *padapter, struct sta_info *psta); -+ -+unsigned int receive_disconnect(_adapter *padapter, unsigned char *MacAddr, unsigned short reason, u8 locally_generated); -+ -+unsigned char get_highest_rate_idx(u32 mask); -+int support_short_GI(_adapter *padapter, struct HT_caps_element *pHT_caps, u8 bwmode); -+unsigned int is_ap_in_tkip(_adapter *padapter); -+unsigned int is_ap_in_wep(_adapter *padapter); -+unsigned int should_forbid_n_rate(_adapter *padapter); -+ -+bool _rtw_camctl_chk_cap(_adapter *adapter, u8 cap); -+void _rtw_camctl_set_flags(_adapter *adapter, u32 flags); -+void rtw_camctl_set_flags(_adapter *adapter, u32 flags); -+void _rtw_camctl_clr_flags(_adapter *adapter, u32 flags); -+void rtw_camctl_clr_flags(_adapter *adapter, u32 flags); -+bool _rtw_camctl_chk_flags(_adapter *adapter, u32 flags); -+ -+struct sec_cam_bmp; -+void dump_sec_cam_map(void *sel, struct sec_cam_bmp *map, u8 max_num); -+void rtw_sec_cam_map_clr_all(struct sec_cam_bmp *map); -+ -+bool _rtw_camid_is_gk(_adapter *adapter, u8 cam_id); -+bool rtw_camid_is_gk(_adapter *adapter, u8 cam_id); -+s16 rtw_camid_search(_adapter *adapter, u8 *addr, s16 kid, s8 gk); -+s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, bool *used); -+void rtw_camid_free(_adapter *adapter, u8 cam_id); -+u8 rtw_get_sec_camid(_adapter *adapter, u8 max_bk_key_num, u8 *sec_key_id); -+ -+struct macid_bmp; -+struct macid_ctl_t; -+void dump_macid_map(void *sel, struct macid_bmp *map, u8 max_num); -+bool rtw_macid_is_set(struct macid_bmp *map, u8 id); -+bool rtw_macid_is_used(struct macid_ctl_t *macid_ctl, u8 id); -+bool rtw_macid_is_bmc(struct macid_ctl_t *macid_ctl, u8 id); -+s8 rtw_macid_get_if_g(struct macid_ctl_t *macid_ctl, u8 id); -+s8 rtw_macid_get_ch_g(struct macid_ctl_t *macid_ctl, u8 id); -+void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta); -+void rtw_release_macid(_adapter *padapter, struct sta_info *psta); -+u8 rtw_search_max_mac_id(_adapter *padapter); -+void rtw_macid_ctl_set_h2c_msr(struct macid_ctl_t *macid_ctl, u8 id, u8 h2c_msr); -+void rtw_macid_ctl_set_bw(struct macid_ctl_t *macid_ctl, u8 id, u8 bw); -+void rtw_macid_ctl_set_vht_en(struct macid_ctl_t *macid_ctl, u8 id, u8 en); -+void rtw_macid_ctl_set_rate_bmp0(struct macid_ctl_t *macid_ctl, u8 id, u32 bmp); -+void rtw_macid_ctl_set_rate_bmp1(struct macid_ctl_t *macid_ctl, u8 id, u32 bmp); -+void rtw_macid_ctl_init(struct macid_ctl_t *macid_ctl); -+void rtw_macid_ctl_deinit(struct macid_ctl_t *macid_ctl); -+u8 rtw_iface_bcmc_id_get(_adapter *padapter); -+ -+u32 report_join_res(_adapter *padapter, int res); -+void report_survey_event(_adapter *padapter, union recv_frame *precv_frame); -+void report_surveydone_event(_adapter *padapter); -+u32 report_del_sta_event(_adapter *padapter, unsigned char *MacAddr, unsigned short reason, bool enqueue, u8 locally_generated); -+void report_add_sta_event(_adapter *padapter, unsigned char *MacAddr); -+bool rtw_port_switch_chk(_adapter *adapter); -+void report_wmm_edca_update(_adapter *padapter); -+ -+void beacon_timing_control(_adapter *padapter); -+u8 chk_bmc_sleepq_cmd(_adapter *padapter); -+extern u8 set_tx_beacon_cmd(_adapter *padapter); -+unsigned int setup_beacon_frame(_adapter *padapter, unsigned char *beacon_frame); -+void update_mgnt_tx_rate(_adapter *padapter, u8 rate); -+void update_monitor_frame_attrib(_adapter *padapter, struct pkt_attrib *pattrib); -+void update_mgntframe_attrib(_adapter *padapter, struct pkt_attrib *pattrib); -+void update_mgntframe_attrib_addr(_adapter *padapter, struct xmit_frame *pmgntframe); -+void dump_mgntframe(_adapter *padapter, struct xmit_frame *pmgntframe); -+s32 dump_mgntframe_and_wait(_adapter *padapter, struct xmit_frame *pmgntframe, int timeout_ms); -+s32 dump_mgntframe_and_wait_ack(_adapter *padapter, struct xmit_frame *pmgntframe); -+s32 dump_mgntframe_and_wait_ack_timeout(_adapter *padapter, struct xmit_frame *pmgntframe, int timeout_ms); -+ -+#ifdef CONFIG_P2P -+void issue_probersp_p2p(_adapter *padapter, unsigned char *da); -+void issue_p2p_provision_request(_adapter *padapter, u8 *pssid, u8 ussidlen, u8 *pdev_raddr); -+void issue_p2p_GO_request(_adapter *padapter, u8 *raddr); -+void issue_probereq_p2p(_adapter *padapter, u8 *da); -+int issue_probereq_p2p_ex(_adapter *adapter, u8 *da, int try_cnt, int wait_ms); -+void issue_p2p_invitation_response(_adapter *padapter, u8 *raddr, u8 dialogToken, u8 success); -+void issue_p2p_invitation_request(_adapter *padapter, u8 *raddr); -+#endif /* CONFIG_P2P */ -+void issue_beacon(_adapter *padapter, int timeout_ms); -+void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probereq); -+void _issue_assocreq(_adapter *padapter, u8 is_assoc); -+void issue_assocreq(_adapter *padapter); -+void issue_reassocreq(_adapter *padapter); -+void issue_asocrsp(_adapter *padapter, unsigned short status, struct sta_info *pstat, int pkt_type); -+void issue_auth(_adapter *padapter, struct sta_info *psta, unsigned short status); -+void issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da); -+s32 issue_probereq_ex(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, bool append_wps, int try_cnt, int wait_ms); -+int issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); -+s32 issue_nulldata_in_interrupt(PADAPTER padapter, u8 *da, unsigned int power_mode); -+int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int try_cnt, int wait_ms); -+int issue_deauth(_adapter *padapter, unsigned char *da, unsigned short reason); -+int issue_deauth_ex(_adapter *padapter, u8 *da, unsigned short reason, int try_cnt, int wait_ms); -+void issue_action_spct_ch_switch(_adapter *padapter, u8 *ra, u8 new_ch, u8 ch_offset); -+void issue_addba_req(_adapter *adapter, unsigned char *ra, u8 tid); -+void issue_addba_rsp(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size); -+u8 issue_addba_rsp_wait_ack(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size, int try_cnt, int wait_ms); -+void issue_del_ba(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator); -+int issue_del_ba_ex(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator, int try_cnt, int wait_ms); -+ -+#ifdef CONFIG_IEEE80211W -+void issue_action_SA_Query(_adapter *padapter, unsigned char *raddr, unsigned char action, unsigned short tid, u8 key_type); -+int issue_deauth_11w(_adapter *padapter, unsigned char *da, unsigned short reason, u8 key_type); -+extern void init_dot11w_expire_timer(_adapter *padapter, struct sta_info *psta); -+#endif /* CONFIG_IEEE80211W */ -+int issue_action_SM_PS(_adapter *padapter , unsigned char *raddr , u8 NewMimoPsMode); -+int issue_action_SM_PS_wait_ack(_adapter *padapter, unsigned char *raddr, u8 NewMimoPsMode, int try_cnt, int wait_ms); -+ -+unsigned int send_delba_sta_tid(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid, u8 force); -+unsigned int send_delba_sta_tid_wait_ack(_adapter *adapter, u8 initiator, struct sta_info *sta, u8 tid, u8 force); -+ -+unsigned int send_delba(_adapter *padapter, u8 initiator, u8 *addr); -+unsigned int send_beacon(_adapter *padapter); -+ -+void start_clnt_assoc(_adapter *padapter); -+void start_clnt_auth(_adapter *padapter); -+void start_clnt_join(_adapter *padapter); -+void start_create_ibss(_adapter *padapter); -+ -+unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnProbeReq(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnProbeRsp(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int DoReserved(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnAtim(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnDisassoc(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnAuth(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnAuthClient(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnDeAuth(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnAction(_adapter *padapter, union recv_frame *precv_frame); -+ -+unsigned int on_action_spct(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnAction_qos(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnAction_dls(_adapter *padapter, union recv_frame *precv_frame); -+#ifdef CONFIG_RTW_WNM -+unsigned int on_action_wnm(_adapter *adapter, union recv_frame *rframe); -+#endif -+ -+#define RX_AMPDU_ACCEPT_INVALID 0xFF -+#define RX_AMPDU_SIZE_INVALID 0xFF -+ -+enum rx_ampdu_reason { -+ RX_AMPDU_DRV_FIXED = 1, -+ RX_AMPDU_BTCOEX = 2, /* not used, because BTCOEX has its own variable management */ -+ RX_AMPDU_DRV_SCAN = 3, -+}; -+u8 rtw_rx_ampdu_size(_adapter *adapter); -+bool rtw_rx_ampdu_is_accept(_adapter *adapter); -+bool rtw_rx_ampdu_set_size(_adapter *adapter, u8 size, u8 reason); -+bool rtw_rx_ampdu_set_accept(_adapter *adapter, u8 accept, u8 reason); -+u8 rx_ampdu_apply_sta_tid(_adapter *adapter, struct sta_info *sta, u8 tid, u8 accept, u8 size); -+u8 rx_ampdu_apply_sta(_adapter *adapter, struct sta_info *sta, u8 accept, u8 size); -+u16 rtw_rx_ampdu_apply(_adapter *adapter); -+ -+unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int on_action_public(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnAction_ft(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnAction_ht(_adapter *padapter, union recv_frame *precv_frame); -+#ifdef CONFIG_IEEE80211W -+unsigned int OnAction_sa_query(_adapter *padapter, union recv_frame *precv_frame); -+#endif /* CONFIG_IEEE80211W */ -+unsigned int OnAction_wmm(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnAction_vht(_adapter *padapter, union recv_frame *precv_frame); -+unsigned int OnAction_p2p(_adapter *padapter, union recv_frame *precv_frame); -+ -+#ifdef CONFIG_RTW_80211R -+void start_clnt_ft_action(_adapter *padapter, u8 *pTargetAddr); -+void issue_action_ft_request(_adapter *padapter, u8 *pTargetAddr); -+void report_ft_event(_adapter *padapter); -+void report_ft_reassoc_event(_adapter *padapter, u8 *pMacAddr); -+void ft_link_timer_hdl(_adapter *padapter); -+void ft_roam_timer_hdl(_adapter *padapter); -+#endif -+void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res); -+void mlmeext_sta_del_event_callback(_adapter *padapter); -+void mlmeext_sta_add_event_callback(_adapter *padapter, struct sta_info *psta); -+ -+void linked_status_chk(_adapter *padapter, u8 from_timer); -+ -+void _linked_info_dump(_adapter *padapter); -+ -+void survey_timer_hdl(_adapter *padapter); -+void link_timer_hdl(_adapter *padapter); -+void addba_timer_hdl(struct sta_info *psta); -+#ifdef CONFIG_IEEE80211W -+void sa_query_timer_hdl(struct sta_info *psta); -+#endif /* CONFIG_IEEE80211W */ -+#if 0 -+void reauth_timer_hdl(_adapter *padapter); -+void reassoc_timer_hdl(_adapter *padapter); -+#endif -+ -+#define set_survey_timer(mlmeext, ms) \ -+ do { \ -+ /*RTW_INFO("%s set_survey_timer(%p, %d)\n", __FUNCTION__, (mlmeext), (ms));*/ \ -+ _set_timer(&(mlmeext)->survey_timer, (ms)); \ -+ } while (0) -+ -+#define set_link_timer(mlmeext, ms) \ -+ do { \ -+ /*RTW_INFO("%s set_link_timer(%p, %d)\n", __FUNCTION__, (mlmeext), (ms));*/ \ -+ _set_timer(&(mlmeext)->link_timer, (ms)); \ -+ } while (0) -+ -+extern int cckrates_included(unsigned char *rate, int ratelen); -+extern int cckratesonly_included(unsigned char *rate, int ratelen); -+ -+extern void process_addba_req(_adapter *padapter, u8 *paddba_req, u8 *addr); -+ -+extern void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len); -+extern void correct_TSF(_adapter *padapter, struct mlme_ext_priv *pmlmeext); -+extern void adaptive_early_32k(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len); -+extern u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer); -+ -+ -+void rtw_join_done_chk_ch(_adapter *padapter, int join_res); -+ -+int rtw_chk_start_clnt_join(_adapter *padapter, u8 *ch, u8 *bw, u8 *offset); -+ -+#ifdef CONFIG_PLATFORM_ARM_SUN8I -+ #define BUSY_TRAFFIC_SCAN_DENY_PERIOD 8000 -+#else -+ #define BUSY_TRAFFIC_SCAN_DENY_PERIOD 12000 -+#endif -+ -+struct cmd_hdl { -+ uint parmsize; -+ u8(*h2cfuns)(struct _ADAPTER *padapter, u8 *pbuf); -+}; -+ -+ -+u8 read_macreg_hdl(_adapter *padapter, u8 *pbuf); -+u8 write_macreg_hdl(_adapter *padapter, u8 *pbuf); -+u8 read_bbreg_hdl(_adapter *padapter, u8 *pbuf); -+u8 write_bbreg_hdl(_adapter *padapter, u8 *pbuf); -+u8 read_rfreg_hdl(_adapter *padapter, u8 *pbuf); -+u8 write_rfreg_hdl(_adapter *padapter, u8 *pbuf); -+ -+ -+u8 NULL_hdl(_adapter *padapter, u8 *pbuf); -+u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf); -+u8 disconnect_hdl(_adapter *padapter, u8 *pbuf); -+u8 createbss_hdl(_adapter *padapter, u8 *pbuf); -+u8 setopmode_hdl(_adapter *padapter, u8 *pbuf); -+u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf); -+u8 setauth_hdl(_adapter *padapter, u8 *pbuf); -+u8 setkey_hdl(_adapter *padapter, u8 *pbuf); -+u8 set_stakey_hdl(_adapter *padapter, u8 *pbuf); -+u8 set_assocsta_hdl(_adapter *padapter, u8 *pbuf); -+u8 del_assocsta_hdl(_adapter *padapter, u8 *pbuf); -+u8 add_ba_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 add_ba_rsp_hdl(_adapter *padapter, unsigned char *pbuf); -+ -+void rtw_ap_wep_pk_setting(_adapter *adapter, struct sta_info *psta); -+ -+u8 mlme_evt_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 h2c_msg_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 chk_bmc_sleepq_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 tx_beacon_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 set_ch_hdl(_adapter *padapter, u8 *pbuf); -+u8 set_chplan_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 led_blink_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 set_csa_hdl(_adapter *padapter, unsigned char *pbuf); /* Kurt: Handling DFS channel switch announcement ie. */ -+u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 run_in_thread_hdl(_adapter *padapter, u8 *pbuf); -+u8 rtw_getmacreg_hdl(_adapter *padapter, u8 *pbuf); -+ -+#define GEN_DRV_CMD_HANDLER(size, cmd) {size, &cmd ## _hdl}, -+#define GEN_MLME_EXT_HANDLER(size, cmd) {size, cmd}, -+ -+#ifdef _RTW_CMD_C_ -+ -+struct cmd_hdl wlancmds[] = { -+ GEN_DRV_CMD_HANDLER(sizeof(struct readMAC_parm), rtw_getmacreg) /*0*/ -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) /*10*/ -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct joinbss_parm), join_cmd_hdl) /*14*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct disconnect_parm), disconnect_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct createbss_parm), createbss_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct setopmode_parm), setopmode_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct sitesurvey_parm), sitesurvey_cmd_hdl) /*18*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct setauth_parm), setauth_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct setkey_parm), setkey_hdl) /*20*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct set_stakey_parm), set_stakey_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct set_assocsta_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct del_assocsta_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct setstapwrstate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct setbasicrate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct getbasicrate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct setdatarate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct getdatarate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct setphyinfo_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct getphyinfo_parm), NULL) /*30*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct setphy_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct getphy_parm), NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) /*40*/ -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct addBaReq_parm), add_ba_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct set_ch_parm), set_ch_hdl) /* 46 */ -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) /*50*/ -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct Tx_Beacon_param), tx_beacon_hdl) /*55*/ -+ -+ GEN_MLME_EXT_HANDLER(0, mlme_evt_hdl) /*56*/ -+ GEN_MLME_EXT_HANDLER(0, rtw_drvextra_cmd_hdl) /*57*/ -+ -+ GEN_MLME_EXT_HANDLER(0, h2c_msg_hdl) /*58*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelPlan_param), set_chplan_hdl) /*59*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct LedBlink_param), led_blink_hdl) /*60*/ -+ -+ GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelSwitch_param), set_csa_hdl) /*61*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct TDLSoption_param), tdls_hdl) /*62*/ -+ GEN_MLME_EXT_HANDLER(0, chk_bmc_sleepq_hdl) /*63*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct RunInThread_param), run_in_thread_hdl) /*64*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct addBaRsp_parm), add_ba_rsp_hdl) /* 65 */ -+}; -+ -+#endif -+ -+struct C2HEvent_Header { -+ -+#ifdef CONFIG_LITTLE_ENDIAN -+ -+ unsigned int len:16; -+ unsigned int ID:8; -+ unsigned int seq:8; -+ -+#elif defined(CONFIG_BIG_ENDIAN) -+ -+ unsigned int seq:8; -+ unsigned int ID:8; -+ unsigned int len:16; -+ -+#else -+ -+# error "Must be LITTLE or BIG Endian" -+ -+#endif -+ -+ unsigned int rsvd; -+ -+}; -+ -+void rtw_dummy_event_callback(_adapter *adapter , u8 *pbuf); -+void rtw_fwdbg_event_callback(_adapter *adapter , u8 *pbuf); -+ -+enum rtw_c2h_event { -+ GEN_EVT_CODE(_Read_MACREG) = 0, /*0*/ -+ GEN_EVT_CODE(_Read_BBREG), -+ GEN_EVT_CODE(_Read_RFREG), -+ GEN_EVT_CODE(_Read_EEPROM), -+ GEN_EVT_CODE(_Read_EFUSE), -+ GEN_EVT_CODE(_Read_CAM), /*5*/ -+ GEN_EVT_CODE(_Get_BasicRate), -+ GEN_EVT_CODE(_Get_DataRate), -+ GEN_EVT_CODE(_Survey), /*8*/ -+ GEN_EVT_CODE(_SurveyDone), /*9*/ -+ -+ GEN_EVT_CODE(_JoinBss) , /*10*/ -+ GEN_EVT_CODE(_AddSTA), -+ GEN_EVT_CODE(_DelSTA), -+ GEN_EVT_CODE(_AtimDone) , -+ GEN_EVT_CODE(_TX_Report), -+ GEN_EVT_CODE(_CCX_Report), /*15*/ -+ GEN_EVT_CODE(_DTM_Report), -+ GEN_EVT_CODE(_TX_Rate_Statistics), -+ GEN_EVT_CODE(_C2HLBK), -+ GEN_EVT_CODE(_FWDBG), -+ GEN_EVT_CODE(_C2HFEEDBACK), /*20*/ -+ GEN_EVT_CODE(_ADDBA), -+ GEN_EVT_CODE(_C2HBCN), -+ GEN_EVT_CODE(_ReportPwrState), /* filen: only for PCIE, USB */ -+ GEN_EVT_CODE(_CloseRF), /* filen: only for PCIE, work around ASPM */ -+ GEN_EVT_CODE(_WMM), /*25*/ -+#ifdef CONFIG_IEEE80211W -+ GEN_EVT_CODE(_TimeoutSTA), -+#endif /* CONFIG_IEEE80211W */ -+#ifdef CONFIG_RTW_80211R -+ GEN_EVT_CODE(_FT_REASSOC), -+#endif -+ MAX_C2HEVT -+}; -+ -+ -+#ifdef _RTW_MLME_EXT_C_ -+ -+static struct fwevent wlanevents[] = { -+ {0, rtw_dummy_event_callback}, /*0*/ -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, &rtw_survey_event_callback}, /*8*/ -+ {sizeof(struct surveydone_event), &rtw_surveydone_event_callback}, /*9*/ -+ -+ {0, &rtw_joinbss_event_callback}, /*10*/ -+ {sizeof(struct stassoc_event), &rtw_stassoc_event_callback}, -+ {sizeof(struct stadel_event), &rtw_stadel_event_callback}, -+ {0, &rtw_atimdone_event_callback}, -+ {0, rtw_dummy_event_callback}, -+ {0, NULL}, /*15*/ -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, rtw_fwdbg_event_callback}, -+ {0, NULL}, /*20*/ -+ {0, NULL}, -+ {0, NULL}, -+ {0, &rtw_cpwm_event_callback}, -+ {0, NULL}, -+ {0, &rtw_wmm_event_callback}, /*25*/ -+#ifdef CONFIG_IEEE80211W -+ {sizeof(struct stadel_event), &rtw_sta_timeout_event_callback}, -+#endif /* CONFIG_IEEE80211W */ -+#ifdef CONFIG_RTW_80211R -+ {sizeof(struct stassoc_event), &rtw_ft_reassoc_event_callback}, -+#endif -+}; -+ -+#endif/* _RTW_MLME_EXT_C_ */ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mlme.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mlme.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mlme.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mlme.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,1205 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_MLME_H_ -+#define __RTW_MLME_H_ -+ -+ -+#define MAX_BSS_CNT 128 -+/* #define MAX_JOIN_TIMEOUT 2000 */ -+/* #define MAX_JOIN_TIMEOUT 2500 */ -+#define MAX_JOIN_TIMEOUT 6500 -+ -+/* Commented by Albert 20101105 -+ * Increase the scanning timeout because of increasing the SURVEY_TO value. */ -+ -+#define SCANNING_TIMEOUT 8000 -+#ifdef CONFIG_SCAN_BACKOP -+#define CONC_SCANNING_TIMEOUT_SINGLE_BAND 10000 -+#define CONC_SCANNING_TIMEOUT_DUAL_BAND 15000 -+#endif -+ -+#ifdef PALTFORM_OS_WINCE -+#define SCANQUEUE_LIFETIME 12000000 /* unit:us */ -+#else -+#define SCANQUEUE_LIFETIME 20000 /* 20sec, unit:msec */ -+#endif -+ -+#define WIFI_NULL_STATE 0x00000000 -+#define WIFI_ASOC_STATE 0x00000001 /* Linked */ -+#define WIFI_REASOC_STATE 0x00000002 -+#define WIFI_SLEEP_STATE 0x00000004 -+#define WIFI_STATION_STATE 0x00000008 -+#define WIFI_AP_STATE 0x00000010 -+#define WIFI_ADHOC_STATE 0x00000020 -+#define WIFI_ADHOC_MASTER_STATE 0x00000040 -+#define WIFI_UNDER_LINKING 0x00000080 -+#define WIFI_UNDER_WPS 0x00000100 -+/*#define WIFI_UNDEFINED_STATE 0x00000200*/ -+#define WIFI_STA_ALIVE_CHK_STATE 0x00000400 -+#define WIFI_SITE_MONITOR 0x00000800 /* under site surveying */ -+#define WIFI_WDS 0x00001000 -+#define WIFI_WDS_RX_BEACON 0x00002000 /* already rx WDS AP beacon */ -+#define WIFI_AUTOCONF 0x00004000 -+#define WIFI_AUTOCONF_IND 0x00008000 -+#define WIFI_MP_STATE 0x00010000 -+#define WIFI_MP_CTX_BACKGROUND 0x00020000 /* in continuous tx background */ -+#define WIFI_MP_CTX_ST 0x00040000 /* in continuous tx with single-tone */ -+#define WIFI_MP_CTX_BACKGROUND_PENDING 0x00080000 /* pending in continuous tx background due to out of skb */ -+#define WIFI_MP_CTX_CCK_HW 0x00100000 /* in continuous tx */ -+#define WIFI_MP_CTX_CCK_CS 0x00200000 /* in continuous tx with carrier suppression */ -+#define WIFI_MP_LPBK_STATE 0x00400000 -+#define WIFI_OP_CH_SWITCHING 0x00800000 -+/*#define WIFI_UNDEFINED_STATE 0x01000000*/ -+/*#define WIFI_UNDEFINED_STATE 0x02000000*/ -+/*#define WIFI_UNDEFINED_STATE 0x04000000*/ -+/*#define WIFI_UNDEFINED_STATE 0x08000000*/ -+/*#define WIFI_UNDEFINED_STATE 0x10000000*/ -+/*#define WIFI_UNDEFINED_STATE 0x20000000*/ -+/*#define WIFI_UNDEFINED_STATE 0x40000000*/ -+#define WIFI_MONITOR_STATE 0x80000000 -+ -+#define MIRACAST_DISABLED 0 -+#define MIRACAST_SOURCE BIT0 -+#define MIRACAST_SINK BIT1 -+ -+#define MIRACAST_MODE_REVERSE(mode) \ -+ ((((mode) & MIRACAST_SOURCE) ? MIRACAST_SINK : 0) | (((mode) & MIRACAST_SINK) ? MIRACAST_SOURCE : 0)) -+ -+bool is_miracast_enabled(_adapter *adapter); -+bool rtw_chk_miracast_mode(_adapter *adapter, u8 mode); -+const char *get_miracast_mode_str(int mode); -+void rtw_wfd_st_switch(struct sta_info *sta, bool on); -+ -+#define MLME_STATE(adapter) get_fwstate(&((adapter)->mlmepriv)) -+ -+#define MLME_IS_STA(adapter) (MLME_STATE((adapter)) & WIFI_STATION_STATE) -+#define MLME_IS_AP(adapter) (MLME_STATE((adapter)) & WIFI_AP_STATE) -+#define MLME_IS_ADHOC(adapter) (MLME_STATE((adapter)) & WIFI_ADHOC_STATE) -+#define MLME_IS_ADHOC_MASTER(adapter) (MLME_STATE((adapter)) & WIFI_ADHOC_MASTER_STATE) -+#define MLME_IS_MONITOR(adapter) (MLME_STATE((adapter)) & WIFI_MONITOR_STATE) -+#define MLME_IS_MP(adapter) (MLME_STATE((adapter)) & WIFI_MP_STATE) -+#ifdef CONFIG_P2P -+ #define MLME_IS_PD(adapter) rtw_p2p_chk_role(&(adapter)->wdinfo, P2P_ROLE_DEVICE) -+ #define MLME_IS_GC(adapter) rtw_p2p_chk_role(&(adapter)->wdinfo, P2P_ROLE_CLIENT) -+ #define MLME_IS_GO(adapter) rtw_p2p_chk_role(&(adapter)->wdinfo, P2P_ROLE_GO) -+#else /* !CONFIG_P2P */ -+ #define MLME_IS_PD(adapter) 0 -+ #define MLME_IS_GC(adapter) 0 -+ #define MLME_IS_GO(adapter) 0 -+#endif /* !CONFIG_P2P */ -+ -+#if defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P) -+#define MLME_IS_ROCH(adapter) (rtw_cfg80211_get_is_roch(adapter) == _TRUE) -+#else -+#define MLME_IS_ROCH(adapter) 0 -+#endif -+ -+#define MLME_IS_MSRC(adapter) rtw_chk_miracast_mode((adapter), MIRACAST_SOURCE) -+#define MLME_IS_MSINK(adapter) rtw_chk_miracast_mode((adapter), MIRACAST_SINK) -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+#define MLME_IS_MGMT_TX(adapter) rtw_cfg80211_get_is_mgmt_tx(adapter) -+#else -+#define MLME_IS_MGMT_TX(adapter) 0 -+#endif -+ -+#define MLME_STATE_FMT "%s%s%s%s%s%s%s%s%s%s%s%s" -+#define MLME_STATE_ARG(adapter) \ -+ MLME_IS_STA((adapter)) ? (MLME_IS_GC((adapter)) ? " GC" : " STA") : \ -+ MLME_IS_AP((adapter)) ? (MLME_IS_GO((adapter)) ? " GO" : " AP") : \ -+ MLME_IS_ADHOC((adapter)) ? " ADHOC" : \ -+ MLME_IS_ADHOC_MASTER((adapter)) ? " ADHOC_M" : \ -+ MLME_IS_MONITOR((adapter)) ? " MONITOR" : \ -+ MLME_IS_MP((adapter)) ? " MP" : "", \ -+ MLME_IS_PD((adapter)) ? " PD" : "", \ -+ MLME_IS_MSRC((adapter)) ? " MSRC" : "", \ -+ MLME_IS_MSINK((adapter)) ? " MSINK" : "", \ -+ (MLME_STATE((adapter)) & WIFI_SITE_MONITOR) ? " SCAN" : "", \ -+ (MLME_STATE((adapter)) & WIFI_UNDER_LINKING) ? " LINKING" : "", \ -+ (MLME_STATE((adapter)) & WIFI_ASOC_STATE) ? " ASOC" : "", \ -+ (MLME_STATE((adapter)) & WIFI_OP_CH_SWITCHING) ? " OP_CH_SW" : "", \ -+ (MLME_STATE((adapter)) & WIFI_UNDER_WPS) ? " WPS" : "", \ -+ MLME_IS_ROCH((adapter)) ? " ROCH" : "", \ -+ MLME_IS_MGMT_TX((adapter)) ? " MGMT_TX" : "", \ -+ (MLME_STATE((adapter)) & WIFI_SLEEP_STATE) ? " SLEEP" : "" -+ -+#define _FW_UNDER_LINKING WIFI_UNDER_LINKING -+#define _FW_LINKED WIFI_ASOC_STATE -+#define _FW_UNDER_SURVEY WIFI_SITE_MONITOR -+ -+ -+enum dot11AuthAlgrthmNum { -+ dot11AuthAlgrthm_Open = 0, -+ dot11AuthAlgrthm_Shared, -+ dot11AuthAlgrthm_8021X, -+ dot11AuthAlgrthm_Auto, -+ dot11AuthAlgrthm_WAPI, -+ dot11AuthAlgrthm_MaxNum -+}; -+ -+/* Scan type including active and passive scan. */ -+typedef enum _RT_SCAN_TYPE { -+ SCAN_PASSIVE, -+ SCAN_ACTIVE, -+ SCAN_MIX, -+} RT_SCAN_TYPE, *PRT_SCAN_TYPE; -+ -+#define WIFI_FREQUENCY_BAND_AUTO 0 -+#define WIFI_FREQUENCY_BAND_5GHZ 1 -+#define WIFI_FREQUENCY_BAND_2GHZ 2 -+ -+#define rtw_band_valid(band) ((band) <= WIFI_FREQUENCY_BAND_2GHZ) -+ -+enum DriverInterface { -+ DRIVER_WEXT = 1, -+ DRIVER_CFG80211 = 2 -+}; -+ -+enum SCAN_RESULT_TYPE { -+ SCAN_RESULT_P2P_ONLY = 0, /* Will return all the P2P devices. */ -+ SCAN_RESULT_ALL = 1, /* Will return all the scanned device, include AP. */ -+ SCAN_RESULT_WFD_TYPE = 2 /* Will just return the correct WFD device. */ -+ /* If this device is Miracast sink device, it will just return all the Miracast source devices. */ -+}; -+ -+/* -+ -+there are several "locks" in mlme_priv, -+since mlme_priv is a shared resource between many threads, -+like ISR/Call-Back functions, the OID handlers, and even timer functions. -+ -+ -+Each _queue has its own locks, already. -+Other items are protected by mlme_priv.lock. -+ -+To avoid possible dead lock, any thread trying to modifiying mlme_priv -+SHALL not lock up more than one locks at a time! -+ -+*/ -+ -+ -+#define traffic_threshold 10 -+#define traffic_scan_period 500 -+ -+struct sitesurvey_ctrl { -+ u64 last_tx_pkts; -+ uint last_rx_pkts; -+ sint traffic_busy; -+ _timer sitesurvey_ctrl_timer; -+}; -+ -+typedef struct _RT_LINK_DETECT_T { -+ u32 NumTxOkInPeriod; -+ u32 NumRxOkInPeriod; -+ u32 NumRxUnicastOkInPeriod; -+ BOOLEAN bBusyTraffic; -+ BOOLEAN bTxBusyTraffic; -+ BOOLEAN bRxBusyTraffic; -+ BOOLEAN bHigherBusyTraffic; /* For interrupt migration purpose. */ -+ BOOLEAN bHigherBusyRxTraffic; /* We may disable Tx interrupt according as Rx traffic. */ -+ BOOLEAN bHigherBusyTxTraffic; /* We may disable Tx interrupt according as Tx traffic. */ -+ /* u8 TrafficBusyState; */ -+ u8 TrafficTransitionCount; -+ u32 LowPowerTransitionCount; -+} RT_LINK_DETECT_T, *PRT_LINK_DETECT_T; -+ -+struct profile_info { -+ u8 ssidlen; -+ u8 ssid[WLAN_SSID_MAXLEN]; -+ u8 peermac[ETH_ALEN]; -+}; -+ -+struct tx_invite_req_info { -+ u8 token; -+ u8 benable; -+ u8 go_ssid[WLAN_SSID_MAXLEN]; -+ u8 ssidlen; -+ u8 go_bssid[ETH_ALEN]; -+ u8 peer_macaddr[ETH_ALEN]; -+ u8 operating_ch; /* This information will be set by using the p2p_set op_ch=x */ -+ u8 peer_ch; /* The listen channel for peer P2P device */ -+ -+}; -+ -+struct tx_invite_resp_info { -+ u8 token; /* Used to record the dialog token of p2p invitation request frame. */ -+}; -+ -+#ifdef CONFIG_WFD -+ -+struct wifi_display_info { -+ u16 wfd_enable; /* Eanble/Disable the WFD function. */ -+ u16 init_rtsp_ctrlport; /* init value of rtsp_ctrlport when WFD enable */ -+ u16 rtsp_ctrlport; /* TCP port number at which the this WFD device listens for RTSP messages, 0 when WFD disable */ -+ u16 tdls_rtsp_ctrlport; /* rtsp_ctrlport used by tdls, will sync when rtsp_ctrlport is changed by user */ -+ u16 peer_rtsp_ctrlport; /* TCP port number at which the peer WFD device listens for RTSP messages */ -+ /* This filed should be filled when receiving the gropu negotiation request */ -+ -+ u8 peer_session_avail; /* WFD session is available or not for the peer wfd device. */ -+ /* This variable will be set when sending the provisioning discovery request to peer WFD device. */ -+ /* And this variable will be reset when it is read by using the iwpriv p2p_get wfd_sa command. */ -+ u8 ip_address[4]; -+ u8 peer_ip_address[4]; -+ u8 wfd_pc; /* WFD preferred connection */ -+ /* 0 -> Prefer to use the P2P for WFD connection on peer side. */ -+ /* 1 -> Prefer to use the TDLS for WFD connection on peer side. */ -+ -+ u8 wfd_device_type; /* WFD Device Type */ -+ /* 0 -> WFD Source Device */ -+ /* 1 -> WFD Primary Sink Device */ -+ enum SCAN_RESULT_TYPE scan_result_type; /* Used when P2P is enable. This parameter will impact the scan result. */ -+ u8 op_wfd_mode; -+ u8 stack_wfd_mode; -+}; -+#endif /* CONFIG_WFD */ -+ -+struct tx_provdisc_req_info { -+ u16 wps_config_method_request; /* Used when sending the provisioning request frame */ -+ u16 peer_channel_num[2]; /* The channel number which the receiver stands. */ -+ NDIS_802_11_SSID ssid; -+ u8 peerDevAddr[ETH_ALEN]; /* Peer device address */ -+ u8 peerIFAddr[ETH_ALEN]; /* Peer interface address */ -+ u8 benable; /* This provision discovery request frame is trigger to send or not */ -+}; -+ -+struct rx_provdisc_req_info { /* When peer device issue prov_disc_req first, we should store the following informations */ -+ u8 peerDevAddr[ETH_ALEN]; /* Peer device address */ -+ u8 strconfig_method_desc_of_prov_disc_req[4]; /* description for the config method located in the provisioning discovery request frame. */ -+ /* The UI must know this information to know which config method the remote p2p device is requiring. */ -+}; -+ -+struct tx_nego_req_info { -+ u16 peer_channel_num[2]; /* The channel number which the receiver stands. */ -+ u8 peerDevAddr[ETH_ALEN]; /* Peer device address */ -+ u8 benable; /* This negoitation request frame is trigger to send or not */ -+ u8 peer_ch; /* The listen channel for peer P2P device */ -+}; -+ -+struct group_id_info { -+ u8 go_device_addr[ETH_ALEN]; /* The GO's device address of this P2P group */ -+ u8 ssid[WLAN_SSID_MAXLEN]; /* The SSID of this P2P group */ -+}; -+ -+struct scan_limit_info { -+ u8 scan_op_ch_only; /* When this flag is set, the driver should just scan the operation channel */ -+#ifndef CONFIG_P2P_OP_CHK_SOCIAL_CH -+ u8 operation_ch[2]; /* Store the operation channel of invitation request frame */ -+#else -+ u8 operation_ch[5]; /* Store additional channel 1,6,11 for Android 4.2 IOT & Nexus 4 */ -+#endif /* CONFIG_P2P_OP_CHK_SOCIAL_CH */ -+}; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+struct cfg80211_wifidirect_info { -+ _timer remain_on_ch_timer; -+ u8 restore_channel; -+ struct ieee80211_channel remain_on_ch_channel; -+ enum nl80211_channel_type remain_on_ch_type; -+ ATOMIC_T ro_ch_cookie_gen; -+ u64 remain_on_ch_cookie; -+ bool is_ro_ch; -+ struct wireless_dev *ro_ch_wdev; -+ u32 last_ro_ch_time; /* this will be updated at the beginning and end of ro_ch */ -+}; -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+#ifdef CONFIG_P2P_WOWLAN -+ -+enum P2P_WOWLAN_RECV_FRAME_TYPE { -+ P2P_WOWLAN_RECV_NEGO_REQ = 0, -+ P2P_WOWLAN_RECV_INVITE_REQ = 1, -+ P2P_WOWLAN_RECV_PROVISION_REQ = 2, -+}; -+ -+struct p2p_wowlan_info { -+ -+ u8 is_trigger; -+ enum P2P_WOWLAN_RECV_FRAME_TYPE wowlan_recv_frame_type; -+ u8 wowlan_peer_addr[ETH_ALEN]; -+ u16 wowlan_peer_wpsconfig; -+ u8 wowlan_peer_is_persistent; -+ u8 wowlan_peer_invitation_type; -+}; -+ -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+struct wifidirect_info { -+ _adapter *padapter; -+ _timer find_phase_timer; -+ _timer restore_p2p_state_timer; -+ -+ /* Used to do the scanning. After confirming the peer is availalble, the driver transmits the P2P frame to peer. */ -+ _timer pre_tx_scan_timer; -+ _timer reset_ch_sitesurvey; -+ _timer reset_ch_sitesurvey2; /* Just for resetting the scan limit function by using p2p nego */ -+#ifdef CONFIG_CONCURRENT_MODE -+ /* Used to switch the channel between legacy AP and listen state. */ -+ _timer ap_p2p_switch_timer; -+#endif -+ struct tx_provdisc_req_info tx_prov_disc_info; -+ struct rx_provdisc_req_info rx_prov_disc_info; -+ struct tx_invite_req_info invitereq_info; -+ struct profile_info profileinfo[P2P_MAX_PERSISTENT_GROUP_NUM]; /* Store the profile information of persistent group */ -+ struct tx_invite_resp_info inviteresp_info; -+ struct tx_nego_req_info nego_req_info; -+ struct group_id_info groupid_info; /* Store the group id information when doing the group negotiation handshake. */ -+ struct scan_limit_info rx_invitereq_info; /* Used for get the limit scan channel from the Invitation procedure */ -+ struct scan_limit_info p2p_info; /* Used for get the limit scan channel from the P2P negotiation handshake */ -+#ifdef CONFIG_WFD -+ struct wifi_display_info *wfd_info; -+#endif -+ -+#ifdef CONFIG_P2P_WOWLAN -+ struct p2p_wowlan_info p2p_wow_info; -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+ enum P2P_ROLE role; -+ enum P2P_STATE pre_p2p_state; -+ enum P2P_STATE p2p_state; -+ u8 device_addr[ETH_ALEN]; /* The device address should be the mac address of this device. */ -+ u8 interface_addr[ETH_ALEN]; -+ u8 social_chan[4]; -+ u8 listen_channel; -+ u8 operating_channel; -+ u8 listen_dwell; /* This value should be between 1 and 3 */ -+ u8 support_rate[8]; -+ u8 p2p_wildcard_ssid[P2P_WILDCARD_SSID_LEN]; -+ u8 intent; /* should only include the intent value. */ -+ u8 p2p_peer_interface_addr[ETH_ALEN]; -+ u8 p2p_peer_device_addr[ETH_ALEN]; -+ u8 peer_intent; /* Included the intent value and tie breaker value. */ -+ u8 device_name[WPS_MAX_DEVICE_NAME_LEN]; /* Device name for displaying on searching device screen */ -+ u8 device_name_len; -+ u8 profileindex; /* Used to point to the index of profileinfo array */ -+ u8 peer_operating_ch; -+ u8 find_phase_state_exchange_cnt; -+ u16 device_password_id_for_nego; /* The device password ID for group negotation */ -+ u8 negotiation_dialog_token; -+ u8 nego_ssid[WLAN_SSID_MAXLEN]; /* SSID information for group negotitation */ -+ u8 nego_ssidlen; -+ u8 p2p_group_ssid[WLAN_SSID_MAXLEN]; -+ u8 p2p_group_ssid_len; -+ u8 persistent_supported; /* Flag to know the persistent function should be supported or not. */ -+ /* In the Sigma test, the Sigma will provide this enable from the sta_set_p2p CAPI. */ -+ /* 0: disable */ -+ /* 1: enable */ -+ u8 session_available; /* Flag to set the WFD session available to enable or disable "by Sigma" */ -+ /* In the Sigma test, the Sigma will disable the session available by using the sta_preset CAPI. */ -+ /* 0: disable */ -+ /* 1: enable */ -+ -+ u8 wfd_tdls_enable; /* Flag to enable or disable the TDLS by WFD Sigma */ -+ /* 0: disable */ -+ /* 1: enable */ -+ u8 wfd_tdls_weaksec; /* Flag to enable or disable the weak security function for TDLS by WFD Sigma */ -+ /* 0: disable */ -+ /* In this case, the driver can't issue the tdsl setup request frame. */ -+ /* 1: enable */ -+ /* In this case, the driver can issue the tdls setup request frame */ -+ /* even the current security is weak security. */ -+ -+ enum P2P_WPSINFO ui_got_wps_info; /* This field will store the WPS value (PIN value or PBC) that UI had got from the user. */ -+ u16 supported_wps_cm; /* This field describes the WPS config method which this driver supported. */ -+ /* The value should be the combination of config method defined in page104 of WPS v2.0 spec. */ -+ u8 external_uuid; /* UUID flag */ -+ u8 uuid[16]; /* UUID */ -+ uint channel_list_attr_len; /* This field will contain the length of body of P2P Channel List attribute of group negotitation response frame. */ -+ u8 channel_list_attr[100]; /* This field will contain the body of P2P Channel List attribute of group negotitation response frame. */ -+ /* We will use the channel_cnt and channel_list fields when constructing the group negotitation confirm frame. */ -+ u8 driver_interface; /* Indicate DRIVER_WEXT or DRIVER_CFG80211 */ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ u16 ext_listen_interval; /* The interval to be available with legacy AP (ms) */ -+ u16 ext_listen_period; /* The time period to be available for P2P listen state (ms) */ -+#endif -+#ifdef CONFIG_P2P_PS -+ enum P2P_PS_MODE p2p_ps_mode; /* indicate p2p ps mode */ -+ enum P2P_PS_STATE p2p_ps_state; /* indicate p2p ps state */ -+ u8 noa_index; /* Identifies and instance of Notice of Absence timing. */ -+ u8 ctwindow; /* Client traffic window. A period of time in TU after TBTT. */ -+ u8 opp_ps; /* opportunistic power save. */ -+ u8 noa_num; /* number of NoA descriptor in P2P IE. */ -+ u8 noa_count[P2P_MAX_NOA_NUM]; /* Count for owner, Type of client. */ -+ u32 noa_duration[P2P_MAX_NOA_NUM]; /* Max duration for owner, preferred or min acceptable duration for client. */ -+ u32 noa_interval[P2P_MAX_NOA_NUM]; /* Length of interval for owner, preferred or max acceptable interval of client. */ -+ u32 noa_start_time[P2P_MAX_NOA_NUM]; /* schedule expressed in terms of the lower 4 bytes of the TSF timer. */ -+#endif /* CONFIG_P2P_PS */ -+}; -+ -+struct tdls_ss_record { /* signal strength record */ -+ u8 macaddr[ETH_ALEN]; -+ u8 RxPWDBAll; -+ u8 is_tdls_sta; /* _TRUE: direct link sta, _FALSE: else */ -+}; -+ -+struct tdls_temp_mgmt { -+ u8 initiator; /* 0: None, 1: we initiate, 2: peer initiate */ -+ u8 peer_addr[ETH_ALEN]; -+}; -+ -+#ifdef CONFIG_TDLS_CH_SW -+struct tdls_ch_switch { -+ u32 ch_sw_state; -+ ATOMIC_T chsw_on; -+ u8 addr[ETH_ALEN]; -+ u8 off_ch_num; -+ u8 ch_offset; -+ u32 cur_time; -+ u8 delay_switch_back; -+ u8 dump_stack; -+ struct submit_ctx chsw_sctx; -+}; -+#endif -+ -+struct tdls_info { -+ u8 ap_prohibited; -+ u8 ch_switch_prohibited; -+ u8 link_established; -+ u8 sta_cnt; -+ u8 sta_maximum; /* 1:tdls sta is equal (NUM_STA-1), reach max direct link number; 0: else; */ -+ struct tdls_ss_record ss_record; -+#ifdef CONFIG_TDLS_CH_SW -+ struct tdls_ch_switch chsw_info; -+#endif -+ -+ u8 ch_sensing; -+ u8 cur_channel; -+ u8 collect_pkt_num[MAX_CHANNEL_NUM]; -+ _lock cmd_lock; -+ _lock hdl_lock; -+ u8 watchdog_count; -+ u8 dev_discovered; /* WFD_TDLS: for sigma test */ -+ u8 tdls_enable; -+ -+ /* Let wpa_supplicant to setup*/ -+ u8 driver_setup; -+#ifdef CONFIG_WFD -+ struct wifi_display_info *wfd_info; -+#endif -+}; -+ -+struct tdls_txmgmt { -+ u8 peer[ETH_ALEN]; -+ u8 action_code; -+ u8 dialog_token; -+ u16 status_code; -+ u8 *buf; -+ size_t len; -+}; -+ -+/* used for mlme_priv.roam_flags */ -+enum { -+ RTW_ROAM_ON_EXPIRED = BIT0, -+ RTW_ROAM_ON_RESUME = BIT1, -+ RTW_ROAM_ACTIVE = BIT2, -+}; -+ -+struct beacon_keys { -+ u8 ssid[IW_ESSID_MAX_SIZE]; -+ u32 ssid_len; -+ u8 bcn_channel; -+ u16 ht_cap_info; -+ u8 ht_info_infos_0_sco; /* bit0 & bit1 in infos[0] is second channel offset */ -+ int encryp_protocol; -+ int pairwise_cipher; -+ int group_cipher; -+ int is_8021x; -+}; -+#ifdef CONFIG_RTW_80211R -+#define FT_ACTION_REQ_LIMIT 4 -+ -+typedef enum _RTW_WIFI_FT_STA_STATUS { -+ RTW_FT_UNASSOCIATED_STA = 0, -+ RTW_FT_AUTHENTICATING_STA, -+ RTW_FT_AUTHENTICATED_STA, -+ RTW_FT_ASSOCIATING_STA, -+ RTW_FT_ASSOCIATED_STA, -+ RTW_FT_REQUESTING_STA, -+ RTW_FT_REQUESTED_STA, -+ RTW_FT_CONFIRMED_STA, -+ RTW_FT_UNSPECIFIED_STA -+} RTW_WIFI_FT_STA_STATUS; -+ -+#define rtw_chk_ft_status(adapter, status) ((adapter)->mlmepriv.ftpriv.ft_status == status) -+#define rtw_set_ft_status(adapter, status) \ -+ do { \ -+ ((adapter)->mlmepriv.ftpriv.ft_status = status); \ -+ } while (0) -+ -+#define rtw_reset_ft_status(adapter) \ -+ do { \ -+ ((adapter)->mlmepriv.ftpriv.ft_status = RTW_FT_UNASSOCIATED_STA); \ -+ } while (0) -+ -+typedef enum _RTW_WIFI_FT_CAPABILITY { -+ RTW_FT_STA_SUPPORTED = BIT0, -+ RTW_FT_STA_OVER_DS_SUPPORTED = BIT1, -+ RTW_FT_SUPPORTED = BIT2, -+ RTW_FT_OVER_DS_SUPPORTED = BIT3, -+} RTW_WIFI_FT_CAPABILITY; -+ -+#define rtw_chk_ft_flags(adapter, flags) ((adapter)->mlmepriv.ftpriv.ft_flags & (flags)) -+#define rtw_set_ft_flags(adapter, flags) \ -+ do { \ -+ ((adapter)->mlmepriv.ftpriv.ft_flags |= (flags)); \ -+ } while (0) -+ -+#define rtw_clr_ft_flags(adapter, flags) \ -+ do { \ -+ ((adapter)->mlmepriv.ftpriv.ft_flags &= ~(flags)); \ -+ } while (0) -+ -+#define RTW_MAX_FTIE_SZ 256 -+typedef struct _ft_priv { -+ u16 mdid; -+ u8 ft_cap; /*b0: FT over DS, b1: Resource Req Protocol Cap, b2~b7: Reserved*/ -+ u8 updated_ft_ies[RTW_MAX_FTIE_SZ]; -+ u16 updated_ft_ies_len; -+ u8 ft_action[RTW_MAX_FTIE_SZ]; -+ u16 ft_action_len; -+ struct cfg80211_ft_event_params ft_event; -+ u8 ft_roam_on_expired; -+ u8 ft_flags; -+ u32 ft_status; -+ u32 ft_req_retry_cnt; -+} ft_priv; -+#endif -+ -+struct mlme_priv { -+ -+ _lock lock; -+ sint fw_state; /* shall we protect this variable? maybe not necessarily... */ -+ u8 bScanInProcess; -+ u8 to_join; /* flag */ -+#ifdef CONFIG_LAYER2_ROAMING -+ u8 to_roam; /* roaming trying times */ -+ struct wlan_network *roam_network; /* the target of active roam */ -+ u8 roam_flags; -+ u8 roam_rssi_diff_th; /* rssi difference threshold for active scan candidate selection */ -+ u32 roam_scan_int_ms; /* scan interval for active roam */ -+ u32 roam_scanr_exp_ms; /* scan result expire time in ms for roam */ -+ u8 roam_tgt_addr[ETH_ALEN]; /* request to roam to speicific target without other consideration */ -+ u8 roam_rssi_threshold; -+ bool need_to_roam; -+#endif -+ -+ u8 *nic_hdl; -+ -+ _list *pscanned; -+ _queue free_bss_pool; -+ _queue scanned_queue; -+ u8 *free_bss_buf; -+ u32 num_of_scanned; -+ -+ NDIS_802_11_SSID assoc_ssid; -+ u8 assoc_bssid[6]; -+ -+ struct wlan_network cur_network; -+ struct wlan_network *cur_network_scanned; -+ -+ /* bcn check info */ -+ struct beacon_keys cur_beacon_keys; /* save current beacon keys */ -+ struct beacon_keys new_beacon_keys; /* save new beacon keys */ -+ u8 new_beacon_cnts; /* if new_beacon_cnts >= threshold, ap beacon is changed */ -+ -+#ifdef CONFIG_ARP_KEEP_ALIVE -+ /* for arp offload keep alive */ -+ u8 bGetGateway; -+ u8 GetGatewayTryCnt; -+ u8 gw_mac_addr[6]; -+ u8 gw_ip[4]; -+#endif -+ -+ /* uint wireless_mode; no used, remove it */ -+ -+ u32 auto_scan_int_ms; -+ -+ _timer assoc_timer; -+ -+ uint assoc_by_bssid; -+ uint assoc_by_rssi; -+ -+ _timer scan_to_timer; /* driver itself handles scan_timeout status. */ -+ u32 scan_start_time; /* used to evaluate the time spent in scanning */ -+ -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+ _timer set_scan_deny_timer; -+ ATOMIC_T set_scan_deny; /* 0: allowed, 1: deny */ -+#endif -+ -+ struct qos_priv qospriv; -+ -+#ifdef CONFIG_80211N_HT -+ -+ /* Number of non-HT AP/stations */ -+ int num_sta_no_ht; -+ -+ /* Number of HT AP/stations 20 MHz */ -+ /* int num_sta_ht_20mhz; */ -+ -+ -+ int num_FortyMHzIntolerant; -+ -+ struct ht_priv htpriv; -+ -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv vhtpriv; -+#endif -+#ifdef CONFIG_BEAMFORMING -+#if (BEAMFORMING_SUPPORT == 0)/*for driver beamforming*/ -+#ifndef RTW_BEAMFORMING_VERSION_2 -+ struct beamforming_info beamforming_info; -+#endif /* !RTW_BEAMFORMING_VERSION_2 */ -+#endif -+#endif -+ -+#ifdef CONFIG_DFS -+ u8 handle_dfs; -+#endif -+#ifdef CONFIG_DFS_MASTER -+ /* TODO: move to rfctl */ -+ _timer dfs_master_timer; -+#endif -+#ifdef CONFIG_RTW_80211R -+ ft_priv ftpriv; -+#endif -+ -+ RT_LINK_DETECT_T LinkDetectInfo; -+ -+ u8 acm_mask; /* for wmm acm mask */ -+ const struct country_chplan *country_ent; -+ u8 ChannelPlan; -+ RT_SCAN_TYPE scan_mode; /* active: 1, passive: 0 */ -+ -+ u8 *wps_probe_req_ie; -+ u32 wps_probe_req_ie_len; -+ -+ u8 ext_capab_ie_data[8];/*currently for ap mode only*/ -+ u8 ext_capab_ie_len; -+ -+ u8 *assoc_req; -+ u32 assoc_req_len; -+ -+ u8 *assoc_rsp; -+ u32 assoc_rsp_len; -+ -+#if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ /* Number of associated Non-ERP stations (i.e., stations using 802.11b -+ * in 802.11g BSS) */ -+ int num_sta_non_erp; -+ -+ /* Number of associated stations that do not support Short Slot Time */ -+ int num_sta_no_short_slot_time; -+ -+ /* Number of associated stations that do not support Short Preamble */ -+ int num_sta_no_short_preamble; -+ -+ ATOMIC_T olbc; /* Overlapping Legacy BSS Condition (Legacy b/g)*/ -+ -+ /* Number of HT associated stations that do not support greenfield */ -+ int num_sta_ht_no_gf; -+ -+ /* Number of associated non-HT stations */ -+ /* int num_sta_no_ht; */ -+ -+ /* Number of HT associated stations 20 MHz */ -+ int num_sta_ht_20mhz; -+ -+ /* number of associated stations 40MHz intolerant */ -+ int num_sta_40mhz_intolerant; -+ -+ /* Overlapping BSS information */ -+ ATOMIC_T olbc_ht; -+ -+#ifdef CONFIG_80211N_HT -+ int ht_20mhz_width_req; -+ int ht_intolerant_ch_reported; -+ u16 ht_op_mode; -+ u8 sw_to_20mhz; /*switch to 20Mhz BW*/ -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_RTW_80211R -+ u8 *auth_rsp; -+ u32 auth_rsp_len; -+#endif -+ -+ /* u8 *wps_probe_req_ie; */ -+ /* u32 wps_probe_req_ie_len; */ -+ -+ u8 *wps_beacon_ie; -+ u32 wps_beacon_ie_len; -+ -+ u8 *wps_probe_resp_ie; -+ u32 wps_probe_resp_ie_len; -+ -+ u8 *wps_assoc_resp_ie; -+ u32 wps_assoc_resp_ie_len; -+ -+ u8 *p2p_beacon_ie; -+ u32 p2p_beacon_ie_len; -+ -+ u8 *p2p_probe_req_ie; -+ u32 p2p_probe_req_ie_len; -+ -+ u8 *p2p_probe_resp_ie; -+ u32 p2p_probe_resp_ie_len; -+ -+ u8 *p2p_go_probe_resp_ie; /* for GO */ -+ u32 p2p_go_probe_resp_ie_len; /* for GO */ -+ -+ u8 *p2p_assoc_req_ie; -+ u32 p2p_assoc_req_ie_len; -+ -+ u8 *p2p_assoc_resp_ie; -+ u32 p2p_assoc_resp_ie_len; -+ -+ _lock bcn_update_lock; -+ u8 update_bcn; -+ -+ u8 ori_ch; -+ u8 ori_bw; -+ u8 ori_offset; -+#endif /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ -+ -+#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) -+ u8 *wfd_beacon_ie; -+ u32 wfd_beacon_ie_len; -+ -+ u8 *wfd_probe_req_ie; -+ u32 wfd_probe_req_ie_len; -+ -+ u8 *wfd_probe_resp_ie; -+ u32 wfd_probe_resp_ie_len; -+ -+ u8 *wfd_go_probe_resp_ie; /* for GO */ -+ u32 wfd_go_probe_resp_ie_len; /* for GO */ -+ -+ u8 *wfd_assoc_req_ie; -+ u32 wfd_assoc_req_ie_len; -+ -+ u8 *wfd_assoc_resp_ie; -+ u32 wfd_assoc_resp_ie_len; -+#endif -+ -+#ifdef RTK_DMP_PLATFORM -+ /* DMP kobject_hotplug function signal need in passive level */ -+ _workitem Linkup_workitem; -+ _workitem Linkdown_workitem; -+#endif -+ -+#ifdef CONFIG_INTEL_WIDI -+ int widi_state; -+ int listen_state; -+ _timer listen_timer; -+ ATOMIC_T rx_probe_rsp; /* 1:receive probe respone from RDS source. */ -+ u8 *l2sdTaBuffer; -+ u8 channel_idx; -+ u8 group_cnt; /* In WiDi 3.5, they specified another scan algo. for WFD/RDS co-existed */ -+ u8 sa_ext[L2SDTA_SERVICE_VE_LEN]; -+ -+ u8 widi_enable; -+ /** -+ * For WiDi 4; upper layer would set -+ * p2p_primary_device_type_category_id -+ * p2p_primary_device_type_sub_category_id -+ * p2p_secondary_device_type_category_id -+ * p2p_secondary_device_type_sub_category_id -+ */ -+ u16 p2p_pdt_cid; -+ u16 p2p_pdt_scid; -+ u8 num_p2p_sdt; -+ u16 p2p_sdt_cid[MAX_NUM_P2P_SDT]; -+ u16 p2p_sdt_scid[MAX_NUM_P2P_SDT]; -+ u8 p2p_reject_disable; /* When starting NL80211 wpa_supplicant/hostapd, it will call netdev_close */ -+ /* such that it will cause p2p disabled. Use this flag to reject. */ -+#endif /* CONFIG_INTEL_WIDI */ -+ u32 lastscantime; -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 scanning_via_buddy_intf; -+#endif -+ -+#if 0 -+ u8 NumOfBcnInfoChkFail; -+ u32 timeBcnInfoChkStart; -+#endif -+ -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ u32 vendor_ie_mask[WLAN_MAX_VENDOR_IE_NUM]; -+ u8 vendor_ie[WLAN_MAX_VENDOR_IE_NUM][WLAN_MAX_VENDOR_IE_LEN]; -+ u32 vendor_ielen[WLAN_MAX_VENDOR_IE_NUM]; -+#endif -+}; -+ -+#define mlme_set_scan_to_timer(mlme, ms) \ -+ do { \ -+ /* RTW_INFO("%s set_scan_to_timer(%p, %d)\n", __FUNCTION__, (mlme), (ms)); */ \ -+ _set_timer(&(mlme)->scan_to_timer, (ms)); \ -+ } while (0) -+ -+#define rtw_mlme_set_auto_scan_int(adapter, ms) \ -+ do { \ -+ adapter->mlmepriv.auto_scan_int_ms = ms; \ -+ } while (0) -+ -+#define RTW_AUTO_SCAN_REASON_UNSPECIFIED 0 -+#define RTW_AUTO_SCAN_REASON_2040_BSS BIT0 -+#define RTW_AUTO_SCAN_REASON_ACS BIT1 -+#define RTW_AUTO_SCAN_REASON_ROAM BIT2 -+ -+void rtw_mlme_reset_auto_scan_int(_adapter *adapter, u8 *reason); -+ -+#ifdef CONFIG_AP_MODE -+ -+struct hostapd_priv { -+ _adapter *padapter; -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ struct net_device *pmgnt_netdev; -+ struct usb_anchor anchored; -+#endif -+ -+}; -+ -+extern int hostapd_mode_init(_adapter *padapter); -+extern void hostapd_mode_unload(_adapter *padapter); -+#endif -+ -+ -+extern void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf); -+extern void rtw_survey_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_joinbss_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf); -+void rtw_sta_mstatus_report(_adapter *adapter); -+extern void rtw_atimdone_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_cpwm_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_wmm_event_callback(PADAPTER padapter, u8 *pbuf); -+#ifdef CONFIG_IEEE80211W -+void rtw_sta_timeout_event_callback(_adapter *adapter, u8 *pbuf); -+#endif /* CONFIG_IEEE80211W */ -+#ifdef CONFIG_RTW_80211R -+void rtw_update_ft_stainfo(_adapter *padapter, WLAN_BSSID_EX *pnetwork); -+void rtw_ft_reassoc_event_callback(_adapter *padapter, u8 *pbuf); -+#endif -+extern void rtw_join_timeout_handler(RTW_TIMER_HDL_ARGS); -+extern void _rtw_scan_timeout_handler(RTW_TIMER_HDL_ARGS); -+ -+thread_return event_thread(thread_context context); -+ -+extern void rtw_free_network_queue(_adapter *adapter, u8 isfreeall); -+extern int rtw_init_mlme_priv(_adapter *adapter);/* (struct mlme_priv *pmlmepriv); */ -+ -+extern void rtw_free_mlme_priv(struct mlme_priv *pmlmepriv); -+ -+ -+extern sint rtw_select_and_join_from_scanned_queue(struct mlme_priv *pmlmepriv); -+extern sint rtw_set_key(_adapter *adapter, struct security_priv *psecuritypriv, sint keyid, u8 set_tx, bool enqueue); -+extern sint rtw_set_auth(_adapter *adapter, struct security_priv *psecuritypriv); -+ -+__inline static u8 *get_bssid(struct mlme_priv *pmlmepriv) -+{ -+ /* if sta_mode:pmlmepriv->cur_network.network.MacAddress=> bssid */ -+ /* if adhoc_mode:pmlmepriv->cur_network.network.MacAddress=> ibss mac address */ -+ return pmlmepriv->cur_network.network.MacAddress; -+} -+ -+__inline static sint check_fwstate(struct mlme_priv *pmlmepriv, sint state) -+{ -+ if ((state == WIFI_NULL_STATE) && -+ (pmlmepriv->fw_state == WIFI_NULL_STATE)) -+ return _TRUE; -+ -+ if (pmlmepriv->fw_state & state) -+ return _TRUE; -+ -+ return _FALSE; -+} -+ -+__inline static sint get_fwstate(struct mlme_priv *pmlmepriv) -+{ -+ return pmlmepriv->fw_state; -+} -+ -+/* -+ * No Limit on the calling context, -+ * therefore set it to be the critical section... -+ * -+ * ### NOTE:#### (!!!!) -+ * MUST TAKE CARE THAT BEFORE CALLING THIS FUNC, YOU SHOULD HAVE LOCKED pmlmepriv->lock -+ */ -+extern void rtw_mi_update_iface_status(struct mlme_priv *pmlmepriv, sint state); -+ -+static inline void set_fwstate(struct mlme_priv *pmlmepriv, sint state) -+{ -+ pmlmepriv->fw_state |= state; -+ -+ /*bScanInProcess hook in phydm*/ -+ if (_FW_UNDER_SURVEY == state) -+ pmlmepriv->bScanInProcess = _TRUE; -+ -+ rtw_mi_update_iface_status(pmlmepriv, state); -+} -+static inline void init_fwstate(struct mlme_priv *pmlmepriv, sint state) -+{ -+ pmlmepriv->fw_state = state; -+ -+ /*bScanInProcess hook in phydm*/ -+ if (_FW_UNDER_SURVEY == state) -+ pmlmepriv->bScanInProcess = _TRUE; -+ -+ rtw_mi_update_iface_status(pmlmepriv, state); -+} -+ -+static inline void _clr_fwstate_(struct mlme_priv *pmlmepriv, sint state) -+{ -+ pmlmepriv->fw_state &= ~state; -+ -+ /*bScanInProcess hook in phydm*/ -+ if (_FW_UNDER_SURVEY == state) -+ pmlmepriv->bScanInProcess = _FALSE; -+ -+ rtw_mi_update_iface_status(pmlmepriv, state); -+} -+ -+/* -+ * No Limit on the calling context, -+ * therefore set it to be the critical section... -+ */ -+static inline void clr_fwstate(struct mlme_priv *pmlmepriv, sint state) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ _clr_fwstate_(pmlmepriv, state); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+ -+static inline void up_scanned_network(struct mlme_priv *pmlmepriv) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ pmlmepriv->num_of_scanned++; -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+u8 rtw_is_adapter_up(_adapter *padapter); -+ -+__inline static void down_scanned_network(struct mlme_priv *pmlmepriv) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ pmlmepriv->num_of_scanned--; -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+ -+__inline static void set_scanned_network_val(struct mlme_priv *pmlmepriv, sint val) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ pmlmepriv->num_of_scanned = val; -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+ -+extern u16 rtw_get_capability(WLAN_BSSID_EX *bss); -+extern void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target); -+extern void rtw_disconnect_hdl_under_linked(_adapter *adapter, struct sta_info *psta, u8 free_assoc); -+extern void rtw_generate_random_ibss(u8 *pibss); -+extern struct wlan_network *rtw_find_network(_queue *scanned_queue, u8 *addr); -+extern struct wlan_network *rtw_get_oldest_wlan_network(_queue *scanned_queue); -+struct wlan_network *_rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network); -+struct wlan_network *rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network); -+ -+extern void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue); -+extern void rtw_indicate_disconnect(_adapter *adapter, u16 reason, u8 locally_generated); -+extern void rtw_indicate_connect(_adapter *adapter); -+void rtw_indicate_scan_done(_adapter *padapter, bool aborted); -+ -+void rtw_drv_scan_by_self(_adapter *padapter, u8 reason); -+void rtw_scan_wait_completed(_adapter *adapter); -+u32 rtw_scan_abort_timeout(_adapter *adapter, u32 timeout_ms); -+void rtw_scan_abort_no_wait(_adapter *adapter); -+void rtw_scan_abort(_adapter *adapter); -+ -+extern int rtw_restruct_sec_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len); -+extern int rtw_restruct_wmm_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len, uint initial_out_len); -+extern void rtw_init_registrypriv_dev_network(_adapter *adapter); -+ -+extern void rtw_update_registrypriv_dev_network(_adapter *adapter); -+ -+extern void rtw_get_encrypt_decrypt_from_registrypriv(_adapter *adapter); -+ -+extern void _rtw_join_timeout_handler(_adapter *adapter); -+extern void rtw_scan_timeout_handler(_adapter *adapter); -+ -+extern void _dynamic_check_timer_handlder(void *FunctionContext); -+extern void rtw_dynamic_check_timer_handlder(_adapter *adapter); -+extern void rtw_iface_dynamic_check_timer_handlder(_adapter *adapter); -+ -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+bool rtw_is_scan_deny(_adapter *adapter); -+void rtw_clear_scan_deny(_adapter *adapter); -+void rtw_set_scan_deny_timer_hdl(_adapter *adapter); -+void rtw_set_scan_deny(_adapter *adapter, u32 ms); -+#else -+#define rtw_is_scan_deny(adapter) _FALSE -+#define rtw_clear_scan_deny(adapter) do {} while (0) -+#define rtw_set_scan_deny_timer_hdl(adapter) do {} while (0) -+#define rtw_set_scan_deny(adapter, ms) do {} while (0) -+#endif -+ -+void rtw_free_mlme_priv_ie_data(struct mlme_priv *pmlmepriv); -+ -+#define MLME_BEACON_IE 0 -+#define MLME_PROBE_REQ_IE 1 -+#define MLME_PROBE_RESP_IE 2 -+#define MLME_GO_PROBE_RESP_IE 3 -+#define MLME_ASSOC_REQ_IE 4 -+#define MLME_ASSOC_RESP_IE 5 -+ -+#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) -+int rtw_mlme_update_wfd_ie_data(struct mlme_priv *mlme, u8 type, u8 *ie, u32 ie_len); -+#endif -+ -+ -+/* extern struct wlan_network* _rtw_dequeue_network(_queue *queue); */ -+ -+extern struct wlan_network *_rtw_alloc_network(struct mlme_priv *pmlmepriv); -+ -+ -+extern void _rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 isfreeall); -+extern void _rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork); -+ -+ -+extern struct wlan_network *_rtw_find_network(_queue *scanned_queue, u8 *addr); -+ -+extern void _rtw_free_network_queue(_adapter *padapter, u8 isfreeall); -+ -+extern sint rtw_if_up(_adapter *padapter); -+ -+sint rtw_linked_check(_adapter *padapter); -+ -+u8 *rtw_get_capability_from_ie(u8 *ie); -+u8 *rtw_get_timestampe_from_ie(u8 *ie); -+u8 *rtw_get_beacon_interval_from_ie(u8 *ie); -+ -+ -+void rtw_joinbss_reset(_adapter *padapter); -+ -+#ifdef CONFIG_80211N_HT -+void rtw_ht_use_default_setting(_adapter *padapter); -+void rtw_build_wmm_ie_ht(_adapter *padapter, u8 *out_ie, uint *pout_len); -+unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len, u8 channel); -+void rtw_update_ht_cap(_adapter *padapter, u8 *pie, uint ie_len, u8 channel); -+void rtw_issue_addbareq_cmd(_adapter *padapter, struct xmit_frame *pxmitframe); -+void rtw_append_exented_cap(_adapter *padapter, u8 *out_ie, uint *pout_len); -+#endif -+ -+int rtw_is_same_ibss(_adapter *adapter, struct wlan_network *pnetwork); -+int is_same_network(WLAN_BSSID_EX *src, WLAN_BSSID_EX *dst, u8 feature); -+ -+#ifdef CONFIG_LAYER2_ROAMING -+#define rtw_roam_flags(adapter) ((adapter)->mlmepriv.roam_flags) -+#define rtw_chk_roam_flags(adapter, flags) ((adapter)->mlmepriv.roam_flags & flags) -+#define rtw_clr_roam_flags(adapter, flags) \ -+ do { \ -+ ((adapter)->mlmepriv.roam_flags &= ~flags); \ -+ } while (0) -+ -+#define rtw_set_roam_flags(adapter, flags) \ -+ do { \ -+ ((adapter)->mlmepriv.roam_flags |= flags); \ -+ } while (0) -+ -+#define rtw_assign_roam_flags(adapter, flags) \ -+ do { \ -+ ((adapter)->mlmepriv.roam_flags = flags); \ -+ } while (0) -+ -+void _rtw_roaming(_adapter *adapter, struct wlan_network *tgt_network); -+void rtw_roaming(_adapter *adapter, struct wlan_network *tgt_network); -+void rtw_set_to_roam(_adapter *adapter, u8 to_roam); -+u8 rtw_dec_to_roam(_adapter *adapter); -+u8 rtw_to_roam(_adapter *adapter); -+int rtw_select_roaming_candidate(struct mlme_priv *pmlmepriv); -+#else -+#define rtw_roam_flags(adapter) 0 -+#define rtw_chk_roam_flags(adapter, flags) 0 -+#define rtw_clr_roam_flags(adapter, flags) do {} while (0) -+#define rtw_set_roam_flags(adapter, flags) do {} while (0) -+#define rtw_assign_roam_flags(adapter, flags) do {} while (0) -+#define _rtw_roaming(adapter, tgt_network) do {} while (0) -+#define rtw_roaming(adapter, tgt_network) do {} while (0) -+#define rtw_set_to_roam(adapter, to_roam) do {} while (0) -+#define rtw_dec_to_roam(adapter) 0 -+#define rtw_to_roam(adapter) 0 -+#define rtw_select_roaming_candidate(mlme) _FAIL -+#endif /* CONFIG_LAYER2_ROAMING */ -+ -+#ifdef CONFIG_80211N_HT -+bool rtw_adjust_chbw(_adapter *adapter, u8 req_ch, u8 *req_bw, u8 *req_offset); -+#endif -+ -+struct sta_media_status_rpt_cmd_parm { -+ struct sta_info *sta; -+ bool connected; -+}; -+ -+void rtw_sta_media_status_rpt(_adapter *adapter, struct sta_info *sta, bool connected); -+u8 rtw_sta_media_status_rpt_cmd(_adapter *adapter, struct sta_info *sta, bool connected); -+void rtw_sta_media_status_rpt_cmd_hdl(_adapter *adapter, struct sta_media_status_rpt_cmd_parm *parm); -+ -+#ifdef CONFIG_INTEL_PROXIM -+void rtw_proxim_enable(_adapter *padapter); -+void rtw_proxim_disable(_adapter *padapter); -+void rtw_proxim_send_packet(_adapter *padapter, u8 *pbuf, u16 len, u8 m_rate); -+#endif /* CONFIG_INTEL_PROXIM */ -+ -+#define IPV4_SRC(_iphdr) (((u8 *)(_iphdr)) + 12) -+#define IPV4_DST(_iphdr) (((u8 *)(_iphdr)) + 16) -+#define GET_IPV4_IHL(_iphdr) BE_BITS_TO_1BYTE(((u8 *)(_iphdr)) + 0, 0, 4) -+#define GET_IPV4_PROTOCOL(_iphdr) BE_BITS_TO_1BYTE(((u8 *)(_iphdr)) + 9, 0, 8) -+#define GET_IPV4_SRC(_iphdr) BE_BITS_TO_4BYTE(((u8 *)(_iphdr)) + 12, 0, 32) -+#define GET_IPV4_DST(_iphdr) BE_BITS_TO_4BYTE(((u8 *)(_iphdr)) + 16, 0, 32) -+ -+#define GET_UDP_SRC(_udphdr) BE_BITS_TO_2BYTE(((u8 *)(_udphdr)) + 0, 0, 16) -+#define GET_UDP_DST(_udphdr) BE_BITS_TO_2BYTE(((u8 *)(_udphdr)) + 2, 0, 16) -+ -+#define TCP_SRC(_tcphdr) (((u8 *)(_tcphdr)) + 0) -+#define TCP_DST(_tcphdr) (((u8 *)(_tcphdr)) + 2) -+#define GET_TCP_SRC(_tcphdr) BE_BITS_TO_2BYTE(((u8 *)(_tcphdr)) + 0, 0, 16) -+#define GET_TCP_DST(_tcphdr) BE_BITS_TO_2BYTE(((u8 *)(_tcphdr)) + 2, 0, 16) -+#define GET_TCP_SEQ(_tcphdr) BE_BITS_TO_4BYTE(((u8 *)(_tcphdr)) + 4, 0, 32) -+#define GET_TCP_ACK_SEQ(_tcphdr) BE_BITS_TO_4BYTE(((u8 *)(_tcphdr)) + 8, 0, 32) -+#define GET_TCP_DOFF(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 12, 4, 4) -+#define GET_TCP_FIN(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 0, 1) -+#define GET_TCP_SYN(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 1, 1) -+#define GET_TCP_RST(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 2, 1) -+#define GET_TCP_PSH(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 3, 1) -+#define GET_TCP_ACK(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 4, 1) -+#define GET_TCP_URG(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 5, 1) -+#define GET_TCP_ECE(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 6, 1) -+#define GET_TCP_CWR(_tcphdr) BE_BITS_TO_1BYTE(((u8 *)(_tcphdr)) + 13, 7, 1) -+ -+#endif /* __RTL871X_MLME_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mp.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mp.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mp.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,936 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTW_MP_H_ -+#define _RTW_MP_H_ -+ -+#define RTWPRIV_VER_INFO 1 -+ -+#define MAX_MP_XMITBUF_SZ 2048 -+#define NR_MP_XMITFRAME 8 -+ -+struct mp_xmit_frame { -+ _list list; -+ -+ struct pkt_attrib attrib; -+ -+ _pkt *pkt; -+ -+ int frame_tag; -+ -+ _adapter *padapter; -+ -+#ifdef CONFIG_USB_HCI -+ -+ /* insert urb, irp, and irpcnt info below... */ -+ /* max frag_cnt = 8 */ -+ -+ u8 *mem_addr; -+ u32 sz[8]; -+ -+#if defined(PLATFORM_OS_XP) || defined(PLATFORM_LINUX) -+ PURB pxmit_urb[8]; -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ PIRP pxmit_irp[8]; -+#endif -+ -+ u8 bpending[8]; -+ sint ac_tag[8]; -+ sint last[8]; -+ uint irpcnt; -+ uint fragcnt; -+#endif /* CONFIG_USB_HCI */ -+ -+ uint mem[(MAX_MP_XMITBUF_SZ >> 2)]; -+}; -+ -+struct mp_wiparam { -+ u32 bcompleted; -+ u32 act_type; -+ u32 io_offset; -+ u32 io_value; -+}; -+ -+typedef void(*wi_act_func)(void *padapter); -+ -+#ifdef PLATFORM_WINDOWS -+struct mp_wi_cntx { -+ u8 bmpdrv_unload; -+ -+ /* Work Item */ -+ NDIS_WORK_ITEM mp_wi; -+ NDIS_EVENT mp_wi_evt; -+ _lock mp_wi_lock; -+ u8 bmp_wi_progress; -+ wi_act_func curractfunc; -+ /* Variable needed in each implementation of CurrActFunc. */ -+ struct mp_wiparam param; -+}; -+#endif -+ -+struct mp_tx { -+ u8 stop; -+ u32 count, sended; -+ u8 payload; -+ struct pkt_attrib attrib; -+ /* struct tx_desc desc; */ -+ /* u8 resvdtx[7]; */ -+ u8 desc[TXDESC_SIZE]; -+ u8 *pallocated_buf; -+ u8 *buf; -+ u32 buf_size, write_size; -+ _thread_hdl_ PktTxThread; -+}; -+ -+#define MP_MAX_LINES 1000 -+#define MP_MAX_LINES_BYTES 256 -+#define u1Byte u8 -+#define s1Byte s8 -+#define u4Byte u32 -+#define s4Byte s32 -+#define u1Byte u8 -+#define pu1Byte u8* -+ -+#define u2Byte u16 -+#define pu2Byte u16* -+ -+#define u4Byte u32 -+#define pu4Byte u32* -+ -+#define u8Byte u64 -+#define pu8Byte u64* -+ -+#define s1Byte s8 -+#define ps1Byte s8* -+ -+#define s2Byte s16 -+#define ps2Byte s16* -+ -+#define s4Byte s32 -+#define ps4Byte s32* -+ -+#define s8Byte s64 -+#define ps8Byte s64* -+ -+#define UCHAR u8 -+#define USHORT u16 -+#define UINT u32 -+#define ULONG u32 -+#define PULONG u32* -+ -+typedef struct _RT_PMAC_PKT_INFO { -+ UCHAR MCS; -+ UCHAR Nss; -+ UCHAR Nsts; -+ UINT N_sym; -+ UCHAR SIGA2B3; -+} RT_PMAC_PKT_INFO, *PRT_PMAC_PKT_INFO; -+ -+typedef struct _RT_PMAC_TX_INFO { -+ u8 bEnPMacTx:1; /* 0: Disable PMac 1: Enable PMac */ -+ u8 Mode:3; /* 0: Packet TX 3:Continuous TX */ -+ u8 Ntx:4; /* 0-7 */ -+ u8 TX_RATE; /* MPT_RATE_E */ -+ u8 TX_RATE_HEX; -+ u8 TX_SC; -+ u8 bSGI:1; -+ u8 bSPreamble:1; -+ u8 bSTBC:1; -+ u8 bLDPC:1; -+ u8 NDP_sound:1; -+ u8 BandWidth:3; /* 0: 20 1:40 2:80Mhz */ -+ u8 m_STBC; /* bSTBC + 1 */ -+ USHORT PacketPeriod; -+ UINT PacketCount; -+ UINT PacketLength; -+ u8 PacketPattern; -+ USHORT SFD; -+ u8 SignalField; -+ u8 ServiceField; -+ USHORT LENGTH; -+ u8 CRC16[2]; -+ u8 LSIG[3]; -+ u8 HT_SIG[6]; -+ u8 VHT_SIG_A[6]; -+ u8 VHT_SIG_B[4]; -+ u8 VHT_SIG_B_CRC; -+ u8 VHT_Delimiter[4]; -+ u8 MacAddress[6]; -+} RT_PMAC_TX_INFO, *PRT_PMAC_TX_INFO; -+ -+ -+typedef VOID (*MPT_WORK_ITEM_HANDLER)(IN PVOID Adapter); -+typedef struct _MPT_CONTEXT { -+ /* Indicate if we have started Mass Production Test. */ -+ BOOLEAN bMassProdTest; -+ -+ /* Indicate if the driver is unloading or unloaded. */ -+ BOOLEAN bMptDrvUnload; -+ -+ _sema MPh2c_Sema; -+ _timer MPh2c_timeout_timer; -+ /* Event used to sync H2c for BT control */ -+ -+ BOOLEAN MptH2cRspEvent; -+ BOOLEAN MptBtC2hEvent; -+ BOOLEAN bMPh2c_timeout; -+ -+ /* 8190 PCI does not support NDIS_WORK_ITEM. */ -+ /* Work Item for Mass Production Test. */ -+ /* NDIS_WORK_ITEM MptWorkItem; -+ * RT_WORK_ITEM MptWorkItem; */ -+ /* Event used to sync the case unloading driver and MptWorkItem is still in progress. -+ * NDIS_EVENT MptWorkItemEvent; */ -+ /* To protect the following variables. -+ * NDIS_SPIN_LOCK MptWorkItemSpinLock; */ -+ /* Indicate a MptWorkItem is scheduled and not yet finished. */ -+ BOOLEAN bMptWorkItemInProgress; -+ /* An instance which implements function and context of MptWorkItem. */ -+ MPT_WORK_ITEM_HANDLER CurrMptAct; -+ -+ /* 1=Start, 0=Stop from UI. */ -+ ULONG MptTestStart; -+ /* _TEST_MODE, defined in MPT_Req2.h */ -+ ULONG MptTestItem; -+ /* Variable needed in each implementation of CurrMptAct. */ -+ ULONG MptActType; /* Type of action performed in CurrMptAct. */ -+ /* The Offset of IO operation is depend of MptActType. */ -+ ULONG MptIoOffset; -+ /* The Value of IO operation is depend of MptActType. */ -+ ULONG MptIoValue; -+ /* The RfPath of IO operation is depend of MptActType. */ -+ ULONG MptRfPath; -+ -+ WIRELESS_MODE MptWirelessModeToSw; /* Wireless mode to switch. */ -+ u8 MptChannelToSw; /* Channel to switch. */ -+ u8 MptInitGainToSet; /* Initial gain to set. */ -+ /* ULONG bMptAntennaA; */ /* TRUE if we want to use antenna A. */ -+ ULONG MptBandWidth; /* bandwidth to switch. */ -+ ULONG MptRateIndex; /* rate index. */ -+ /* Register value kept for Single Carrier Tx test. */ -+ u8 btMpCckTxPower; -+ /* Register value kept for Single Carrier Tx test. */ -+ u8 btMpOfdmTxPower; -+ /* For MP Tx Power index */ -+ u8 TxPwrLevel[4]; /* rf-A, rf-B*/ -+ u32 RegTxPwrLimit; -+ /* Content of RCR Regsiter for Mass Production Test. */ -+ ULONG MptRCR; -+ /* TRUE if we only receive packets with specific pattern. */ -+ BOOLEAN bMptFilterPattern; -+ /* Rx OK count, statistics used in Mass Production Test. */ -+ ULONG MptRxOkCnt; -+ /* Rx CRC32 error count, statistics used in Mass Production Test. */ -+ ULONG MptRxCrcErrCnt; -+ -+ BOOLEAN bCckContTx; /* TRUE if we are in CCK Continuous Tx test. */ -+ BOOLEAN bOfdmContTx; /* TRUE if we are in OFDM Continuous Tx test. */ -+ BOOLEAN bStartContTx; /* TRUE if we have start Continuous Tx test. */ -+ /* TRUE if we are in Single Carrier Tx test. */ -+ BOOLEAN bSingleCarrier; -+ /* TRUE if we are in Carrier Suppression Tx Test. */ -+ BOOLEAN bCarrierSuppression; -+ /* TRUE if we are in Single Tone Tx test. */ -+ BOOLEAN bSingleTone; -+ -+ /* ACK counter asked by K.Y.. */ -+ BOOLEAN bMptEnableAckCounter; -+ ULONG MptAckCounter; -+ -+ /* SD3 Willis For 8192S to save 1T/2T RF table for ACUT Only fro ACUT delete later ~~~! */ -+ /* s1Byte BufOfLines[2][MAX_LINES_HWCONFIG_TXT][MAX_BYTES_LINE_HWCONFIG_TXT]; */ -+ /* s1Byte BufOfLines[2][MP_MAX_LINES][MP_MAX_LINES_BYTES]; */ -+ /* s4Byte RfReadLine[2]; */ -+ -+ u8 APK_bound[2]; /* for APK path A/path B */ -+ BOOLEAN bMptIndexEven; -+ -+ u8 backup0xc50; -+ u8 backup0xc58; -+ u8 backup0xc30; -+ u8 backup0x52_RF_A; -+ u8 backup0x52_RF_B; -+ -+ u4Byte backup0x58_RF_A; -+ u4Byte backup0x58_RF_B; -+ -+ u1Byte h2cReqNum; -+ u1Byte c2hBuf[32]; -+ -+ u1Byte btInBuf[100]; -+ ULONG mptOutLen; -+ u1Byte mptOutBuf[100]; -+ RT_PMAC_TX_INFO PMacTxInfo; -+ RT_PMAC_PKT_INFO PMacPktInfo; -+ u8 HWTxmode; -+ -+ BOOLEAN bldpc; -+ BOOLEAN bstbc; -+} MPT_CONTEXT, *PMPT_CONTEXT; -+/* #endif */ -+ -+ -+/* #define RTPRIV_IOCTL_MP ( SIOCIWFIRSTPRIV + 0x17) */ -+enum { -+ WRITE_REG = 1, -+ READ_REG, -+ WRITE_RF, -+ READ_RF, -+ MP_START, -+ MP_STOP, -+ MP_RATE, -+ MP_CHANNEL, -+ MP_BANDWIDTH, -+ MP_TXPOWER, -+ MP_ANT_TX, -+ MP_ANT_RX, -+ MP_CTX, -+ MP_QUERY, -+ MP_ARX, -+ MP_PSD, -+ MP_PWRTRK, -+ MP_THER, -+ MP_IOCTL, -+ EFUSE_GET, -+ EFUSE_SET, -+ MP_RESET_STATS, -+ MP_DUMP, -+ MP_PHYPARA, -+ MP_SetRFPathSwh, -+ MP_QueryDrvStats, -+ CTA_TEST, -+ MP_DISABLE_BT_COEXIST, -+ MP_PwrCtlDM, -+ MP_GETVER, -+ MP_MON, -+ EFUSE_MASK, -+ EFUSE_FILE, -+ MP_TX, -+ MP_RX, -+ MP_IQK, -+ MP_LCK, -+ MP_HW_TX_MODE, -+ MP_GET_TXPOWER_INX, -+ MP_CUSTOMER_STR, -+ MP_NULL, -+ MP_SetBT, -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ VENDOR_IE_SET , -+ VENDOR_IE_GET , -+#endif -+#ifdef CONFIG_WOWLAN -+ MP_WOW_ENABLE, -+ MP_WOW_SET_PATTERN, -+#endif -+#ifdef CONFIG_AP_WOWLAN -+ MP_AP_WOW_ENABLE, -+#endif -+ MP_SD_IREAD, -+ MP_SD_IWRITE, -+}; -+ -+struct mp_priv { -+ _adapter *papdater; -+ -+ /* Testing Flag */ -+ u32 mode;/* 0 for normal type packet, 1 for loopback packet (16bytes TXCMD) */ -+ -+ u32 prev_fw_state; -+ -+ /* OID cmd handler */ -+ struct mp_wiparam workparam; -+ /* u8 act_in_progress; */ -+ -+ /* Tx Section */ -+ u8 TID; -+ u32 tx_pktcount; -+ u32 pktInterval; -+ u32 pktLength; -+ struct mp_tx tx; -+ -+ /* Rx Section */ -+ u32 rx_bssidpktcount; -+ u32 rx_pktcount; -+ u32 rx_pktcount_filter_out; -+ u32 rx_crcerrpktcount; -+ u32 rx_pktloss; -+ BOOLEAN rx_bindicatePkt; -+ struct recv_stat rxstat; -+ -+ /* RF/BB relative */ -+ u8 channel; -+ u8 bandwidth; -+ u8 prime_channel_offset; -+ u8 txpoweridx; -+ u8 rateidx; -+ u32 preamble; -+ /* u8 modem; */ -+ u32 CrystalCap; -+ /* u32 curr_crystalcap; */ -+ -+ u16 antenna_tx; -+ u16 antenna_rx; -+ /* u8 curr_rfpath; */ -+ -+ u8 check_mp_pkt; -+ -+ u8 bSetTxPower; -+ /* uint ForcedDataRate; */ -+ u8 mp_dm; -+ u8 mac_filter[ETH_ALEN]; -+ u8 bmac_filter; -+ -+ struct wlan_network mp_network; -+ NDIS_802_11_MAC_ADDRESS network_macaddr; -+ -+#ifdef PLATFORM_WINDOWS -+ u32 rx_testcnt; -+ u32 rx_testcnt1; -+ u32 rx_testcnt2; -+ u32 tx_testcnt; -+ u32 tx_testcnt1; -+ -+ struct mp_wi_cntx wi_cntx; -+ -+ u8 h2c_result; -+ u8 h2c_seqnum; -+ u16 h2c_cmdcode; -+ u8 h2c_resp_parambuf[512]; -+ _lock h2c_lock; -+ _lock wkitm_lock; -+ u32 h2c_cmdcnt; -+ NDIS_EVENT h2c_cmd_evt; -+ NDIS_EVENT c2h_set; -+ NDIS_EVENT h2c_clr; -+ NDIS_EVENT cpwm_int; -+ -+ NDIS_EVENT scsir_full_evt; -+ NDIS_EVENT scsiw_empty_evt; -+#endif -+ -+ u8 *pallocated_mp_xmitframe_buf; -+ u8 *pmp_xmtframe_buf; -+ _queue free_mp_xmitqueue; -+ u32 free_mp_xmitframe_cnt; -+ BOOLEAN bSetRxBssid; -+ BOOLEAN bTxBufCkFail; -+ BOOLEAN bRTWSmbCfg; -+ BOOLEAN bloopback; -+ MPT_CONTEXT MptCtx; -+ BOOLEAN bloadefusemap; -+ -+ u8 *TXradomBuffer; -+}; -+ -+typedef struct _IOCMD_STRUCT_ { -+ u8 cmdclass; -+ u16 value; -+ u8 index; -+} IOCMD_STRUCT; -+ -+struct rf_reg_param { -+ u32 path; -+ u32 offset; -+ u32 value; -+}; -+ -+struct bb_reg_param { -+ u32 offset; -+ u32 value; -+}; -+ -+typedef struct _MP_FIRMWARE { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8 *szFwBuffer; -+#else -+ u8 szFwBuffer[0x8000]; -+#endif -+ u32 ulFwLength; -+} RT_MP_FIRMWARE, *PRT_MP_FIRMWARE; -+ -+ -+ -+ -+/* *********************************************************************** */ -+ -+#define LOWER _TRUE -+#define RAISE _FALSE -+ -+/* Hardware Registers */ -+#if 0 -+#if 0 -+#define IOCMD_CTRL_REG 0x102502C0 -+#define IOCMD_DATA_REG 0x102502C4 -+#else -+#define IOCMD_CTRL_REG 0x10250370 -+#define IOCMD_DATA_REG 0x10250374 -+#endif -+ -+#define IOCMD_GET_THERMAL_METER 0xFD000028 -+ -+#define IOCMD_CLASS_BB_RF 0xF0 -+#define IOCMD_BB_READ_IDX 0x00 -+#define IOCMD_BB_WRITE_IDX 0x01 -+#define IOCMD_RF_READ_IDX 0x02 -+#define IOCMD_RF_WRIT_IDX 0x03 -+#endif -+#define BB_REG_BASE_ADDR 0x800 -+ -+/* MP variables */ -+#if 0 -+#define _2MAC_MODE_ 0 -+#define _LOOPBOOK_MODE_ 1 -+#endif -+typedef enum _MP_MODE_ { -+ MP_OFF, -+ MP_ON, -+ MP_ERR, -+ MP_CONTINUOUS_TX, -+ MP_SINGLE_CARRIER_TX, -+ MP_CARRIER_SUPPRISSION_TX, -+ MP_SINGLE_TONE_TX, -+ MP_PACKET_TX, -+ MP_PACKET_RX -+} MP_MODE; -+ -+typedef enum _TEST_MODE { -+ TEST_NONE , -+ PACKETS_TX , -+ PACKETS_RX , -+ CONTINUOUS_TX , -+ OFDM_Single_Tone_TX , -+ CCK_Carrier_Suppression_TX -+} TEST_MODE; -+ -+ -+typedef enum _MPT_BANDWIDTH { -+ MPT_BW_20MHZ = 0, -+ MPT_BW_40MHZ_DUPLICATE = 1, -+ MPT_BW_40MHZ_ABOVE = 2, -+ MPT_BW_40MHZ_BELOW = 3, -+ MPT_BW_40MHZ = 4, -+ MPT_BW_80MHZ = 5, -+ MPT_BW_80MHZ_20_ABOVE = 6, -+ MPT_BW_80MHZ_20_BELOW = 7, -+ MPT_BW_80MHZ_20_BOTTOM = 8, -+ MPT_BW_80MHZ_20_TOP = 9, -+ MPT_BW_80MHZ_40_ABOVE = 10, -+ MPT_BW_80MHZ_40_BELOW = 11, -+} MPT_BANDWIDTHE, *PMPT_BANDWIDTH; -+ -+#define MAX_RF_PATH_NUMS RF_PATH_MAX -+ -+ -+extern u8 mpdatarate[NumRates]; -+ -+/* MP set force data rate base on the definition. */ -+typedef enum _MPT_RATE_INDEX { -+ /* CCK rate. */ -+ MPT_RATE_1M = 1 , /* 0 */ -+ MPT_RATE_2M, -+ MPT_RATE_55M, -+ MPT_RATE_11M, /* 3 */ -+ -+ /* OFDM rate. */ -+ MPT_RATE_6M, /* 4 */ -+ MPT_RATE_9M, -+ MPT_RATE_12M, -+ MPT_RATE_18M, -+ MPT_RATE_24M, -+ MPT_RATE_36M, -+ MPT_RATE_48M, -+ MPT_RATE_54M, /* 11 */ -+ -+ /* HT rate. */ -+ MPT_RATE_MCS0, /* 12 */ -+ MPT_RATE_MCS1, -+ MPT_RATE_MCS2, -+ MPT_RATE_MCS3, -+ MPT_RATE_MCS4, -+ MPT_RATE_MCS5, -+ MPT_RATE_MCS6, -+ MPT_RATE_MCS7, /* 19 */ -+ MPT_RATE_MCS8, -+ MPT_RATE_MCS9, -+ MPT_RATE_MCS10, -+ MPT_RATE_MCS11, -+ MPT_RATE_MCS12, -+ MPT_RATE_MCS13, -+ MPT_RATE_MCS14, -+ MPT_RATE_MCS15, /* 27 */ -+ MPT_RATE_MCS16, -+ MPT_RATE_MCS17, /* #29 */ -+ MPT_RATE_MCS18, -+ MPT_RATE_MCS19, -+ MPT_RATE_MCS20, -+ MPT_RATE_MCS21, -+ MPT_RATE_MCS22, /* #34 */ -+ MPT_RATE_MCS23, -+ MPT_RATE_MCS24, -+ MPT_RATE_MCS25, -+ MPT_RATE_MCS26, -+ MPT_RATE_MCS27, /* #39 */ -+ MPT_RATE_MCS28, /* #40 */ -+ MPT_RATE_MCS29, /* #41 */ -+ MPT_RATE_MCS30, /* #42 */ -+ MPT_RATE_MCS31, /* #43 */ -+ /* VHT rate. Total: 20*/ -+ MPT_RATE_VHT1SS_MCS0 = 100,/* #44*/ -+ MPT_RATE_VHT1SS_MCS1, /* # */ -+ MPT_RATE_VHT1SS_MCS2, -+ MPT_RATE_VHT1SS_MCS3, -+ MPT_RATE_VHT1SS_MCS4, -+ MPT_RATE_VHT1SS_MCS5, -+ MPT_RATE_VHT1SS_MCS6, /* # */ -+ MPT_RATE_VHT1SS_MCS7, -+ MPT_RATE_VHT1SS_MCS8, -+ MPT_RATE_VHT1SS_MCS9, /* #53 */ -+ MPT_RATE_VHT2SS_MCS0, /* #54 */ -+ MPT_RATE_VHT2SS_MCS1, -+ MPT_RATE_VHT2SS_MCS2, -+ MPT_RATE_VHT2SS_MCS3, -+ MPT_RATE_VHT2SS_MCS4, -+ MPT_RATE_VHT2SS_MCS5, -+ MPT_RATE_VHT2SS_MCS6, -+ MPT_RATE_VHT2SS_MCS7, -+ MPT_RATE_VHT2SS_MCS8, -+ MPT_RATE_VHT2SS_MCS9, /* #63 */ -+ MPT_RATE_VHT3SS_MCS0, -+ MPT_RATE_VHT3SS_MCS1, -+ MPT_RATE_VHT3SS_MCS2, -+ MPT_RATE_VHT3SS_MCS3, -+ MPT_RATE_VHT3SS_MCS4, -+ MPT_RATE_VHT3SS_MCS5, -+ MPT_RATE_VHT3SS_MCS6, /* #126 */ -+ MPT_RATE_VHT3SS_MCS7, -+ MPT_RATE_VHT3SS_MCS8, -+ MPT_RATE_VHT3SS_MCS9, -+ MPT_RATE_VHT4SS_MCS0, -+ MPT_RATE_VHT4SS_MCS1, /* #131 */ -+ MPT_RATE_VHT4SS_MCS2, -+ MPT_RATE_VHT4SS_MCS3, -+ MPT_RATE_VHT4SS_MCS4, -+ MPT_RATE_VHT4SS_MCS5, -+ MPT_RATE_VHT4SS_MCS6, /* #136 */ -+ MPT_RATE_VHT4SS_MCS7, -+ MPT_RATE_VHT4SS_MCS8, -+ MPT_RATE_VHT4SS_MCS9, -+ MPT_RATE_LAST -+} MPT_RATE_E, *PMPT_RATE_E; -+ -+#define MAX_TX_PWR_INDEX_N_MODE 64 /* 0x3F */ -+ -+#define MPT_IS_CCK_RATE(_value) (MPT_RATE_1M <= _value && _value <= MPT_RATE_11M) -+#define MPT_IS_OFDM_RATE(_value) (MPT_RATE_6M <= _value && _value <= MPT_RATE_54M) -+#define MPT_IS_HT_RATE(_value) (MPT_RATE_MCS0 <= _value && _value <= MPT_RATE_MCS31) -+#define MPT_IS_HT_1S_RATE(_value) (MPT_RATE_MCS0 <= _value && _value <= MPT_RATE_MCS7) -+#define MPT_IS_HT_2S_RATE(_value) (MPT_RATE_MCS8 <= _value && _value <= MPT_RATE_MCS15) -+#define MPT_IS_HT_3S_RATE(_value) (MPT_RATE_MCS16 <= _value && _value <= MPT_RATE_MCS23) -+#define MPT_IS_HT_4S_RATE(_value) (MPT_RATE_MCS24 <= _value && _value <= MPT_RATE_MCS31) -+ -+#define MPT_IS_VHT_RATE(_value) (MPT_RATE_VHT1SS_MCS0 <= _value && _value <= MPT_RATE_VHT4SS_MCS9) -+#define MPT_IS_VHT_1S_RATE(_value) (MPT_RATE_VHT1SS_MCS0 <= _value && _value <= MPT_RATE_VHT1SS_MCS9) -+#define MPT_IS_VHT_2S_RATE(_value) (MPT_RATE_VHT2SS_MCS0 <= _value && _value <= MPT_RATE_VHT2SS_MCS9) -+#define MPT_IS_VHT_3S_RATE(_value) (MPT_RATE_VHT3SS_MCS0 <= _value && _value <= MPT_RATE_VHT3SS_MCS9) -+#define MPT_IS_VHT_4S_RATE(_value) (MPT_RATE_VHT4SS_MCS0 <= _value && _value <= MPT_RATE_VHT4SS_MCS9) -+ -+#define MPT_IS_2SS_RATE(_rate) ((MPT_RATE_MCS8 <= _rate && _rate <= MPT_RATE_MCS15) || \ -+ (MPT_RATE_VHT2SS_MCS0 <= _rate && _rate <= MPT_RATE_VHT2SS_MCS9)) -+#define MPT_IS_3SS_RATE(_rate) ((MPT_RATE_MCS16 <= _rate && _rate <= MPT_RATE_MCS23) || \ -+ (MPT_RATE_VHT3SS_MCS0 <= _rate && _rate <= MPT_RATE_VHT3SS_MCS9)) -+#define MPT_IS_4SS_RATE(_rate) ((MPT_RATE_MCS24 <= _rate && _rate <= MPT_RATE_MCS31) || \ -+ (MPT_RATE_VHT4SS_MCS0 <= _rate && _rate <= MPT_RATE_VHT4SS_MCS9)) -+ -+typedef enum _POWER_MODE_ { -+ POWER_LOW = 0, -+ POWER_NORMAL -+} POWER_MODE; -+ -+/* The following enumeration is used to define the value of Reg0xD00[30:28] or JaguarReg0x914[18:16]. */ -+typedef enum _OFDM_TX_MODE { -+ OFDM_ALL_OFF = 0, -+ OFDM_ContinuousTx = 1, -+ OFDM_SingleCarrier = 2, -+ OFDM_SingleTone = 4, -+} OFDM_TX_MODE; -+ -+ -+#define RX_PKT_BROADCAST 1 -+#define RX_PKT_DEST_ADDR 2 -+#define RX_PKT_PHY_MATCH 3 -+ -+typedef enum _ENCRY_CTRL_STATE_ { -+ HW_CONTROL, /* hw encryption& decryption */ -+ SW_CONTROL, /* sw encryption& decryption */ -+ HW_ENCRY_SW_DECRY, /* hw encryption & sw decryption */ -+ SW_ENCRY_HW_DECRY /* sw encryption & hw decryption */ -+} ENCRY_CTRL_STATE; -+ -+typedef enum _MPT_TXPWR_DEF { -+ MPT_CCK, -+ MPT_OFDM, /* L and HT OFDM */ -+ MPT_OFDM_AND_HT, -+ MPT_HT, -+ MPT_VHT -+} MPT_TXPWR_DEF; -+ -+ -+#define IS_MPT_HT_RATE(_rate) (_rate >= MPT_RATE_MCS0 && _rate <= MPT_RATE_MCS31) -+#define IS_MPT_VHT_RATE(_rate) (_rate >= MPT_RATE_VHT1SS_MCS0 && _rate <= MPT_RATE_VHT4SS_MCS9) -+#define IS_MPT_CCK_RATE(_rate) (_rate >= MPT_RATE_1M && _rate <= MPT_RATE_11M) -+#define IS_MPT_OFDM_RATE(_rate) (_rate >= MPT_RATE_6M && _rate <= MPT_RATE_54M) -+/*************************************************************************/ -+#if 0 -+extern struct mp_xmit_frame *alloc_mp_xmitframe(struct mp_priv *pmp_priv); -+extern int free_mp_xmitframe(struct xmit_priv *pxmitpriv, struct mp_xmit_frame *pmp_xmitframe); -+#endif -+ -+extern s32 init_mp_priv(PADAPTER padapter); -+extern void free_mp_priv(struct mp_priv *pmp_priv); -+extern s32 MPT_InitializeAdapter(PADAPTER padapter, u8 Channel); -+extern void MPT_DeInitAdapter(PADAPTER padapter); -+extern s32 mp_start_test(PADAPTER padapter); -+extern void mp_stop_test(PADAPTER padapter); -+ -+extern u32 _read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask); -+extern void _write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask, u32 val); -+ -+extern u32 read_macreg(_adapter *padapter, u32 addr, u32 sz); -+extern void write_macreg(_adapter *padapter, u32 addr, u32 val, u32 sz); -+extern u32 read_bbreg(_adapter *padapter, u32 addr, u32 bitmask); -+extern void write_bbreg(_adapter *padapter, u32 addr, u32 bitmask, u32 val); -+extern u32 read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr); -+extern void write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 val); -+ -+void SetChannel(PADAPTER pAdapter); -+void SetBandwidth(PADAPTER pAdapter); -+int SetTxPower(PADAPTER pAdapter); -+void SetAntenna(PADAPTER pAdapter); -+void SetDataRate(PADAPTER pAdapter); -+void SetAntenna(PADAPTER pAdapter); -+s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther); -+void GetThermalMeter(PADAPTER pAdapter, u8 *value); -+void SetContinuousTx(PADAPTER pAdapter, u8 bStart); -+void SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart); -+void SetSingleToneTx(PADAPTER pAdapter, u8 bStart); -+void SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart); -+void PhySetTxPowerLevel(PADAPTER pAdapter); -+void fill_txdesc_for_mp(PADAPTER padapter, u8 *ptxdesc); -+void SetPacketTx(PADAPTER padapter); -+void SetPacketRx(PADAPTER pAdapter, u8 bStartRx, u8 bAB); -+void ResetPhyRxPktCount(PADAPTER pAdapter); -+u32 GetPhyRxPktReceived(PADAPTER pAdapter); -+u32 GetPhyRxPktCRC32Error(PADAPTER pAdapter); -+s32 SetPowerTracking(PADAPTER padapter, u8 enable); -+void GetPowerTracking(PADAPTER padapter, u8 *enable); -+u32 mp_query_psd(PADAPTER pAdapter, u8 *data); -+void rtw_mp_trigger_iqk(PADAPTER padapter); -+void rtw_mp_trigger_lck(PADAPTER padapter); -+ -+ -+ -+void hal_mpt_SwitchRfSetting(PADAPTER pAdapter); -+s32 hal_mpt_SetPowerTracking(PADAPTER padapter, u8 enable); -+void hal_mpt_GetPowerTracking(PADAPTER padapter, u8 *enable); -+void hal_mpt_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14); -+void hal_mpt_SetChannel(PADAPTER pAdapter); -+void hal_mpt_SetBandwidth(PADAPTER pAdapter); -+void hal_mpt_SetTxPower(PADAPTER pAdapter); -+void hal_mpt_SetDataRate(PADAPTER pAdapter); -+void hal_mpt_SetAntenna(PADAPTER pAdapter); -+s32 hal_mpt_SetThermalMeter(PADAPTER pAdapter, u8 target_ther); -+void hal_mpt_TriggerRFThermalMeter(PADAPTER pAdapter); -+u8 hal_mpt_ReadRFThermalMeter(PADAPTER pAdapter); -+void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 *value); -+void hal_mpt_SetContinuousTx(PADAPTER pAdapter, u8 bStart); -+void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart); -+void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart); -+void hal_mpt_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart); -+void hal_mpt_SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart); -+void hal_mpt_SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart); -+void mpt_ProSetPMacTx(PADAPTER Adapter); -+ -+void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter , BOOLEAN bMain); -+ULONG mpt_ProQueryCalTxPower(PADAPTER pAdapter, u8 RfPath); -+void MPT_PwrCtlDM(PADAPTER padapter, u32 bstart); -+u8 MptToMgntRate(u32 MptRateIdx); -+u8 rtw_mpRateParseFunc(PADAPTER pAdapter, u8 *targetStr); -+u32 mp_join(PADAPTER padapter, u8 mode); -+u32 hal_mpt_query_phytxok(PADAPTER pAdapter); -+ -+void -+PMAC_Get_Pkt_Param( -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo -+); -+void -+CCK_generator( -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo -+); -+void -+PMAC_Nsym_generator( -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo -+); -+void -+L_SIG_generator( -+ UINT N_SYM, /* Max: 750*/ -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo -+); -+ -+void HT_SIG_generator( -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo); -+ -+void VHT_SIG_A_generator( -+ PRT_PMAC_TX_INFO pPMacTxInfo, -+ PRT_PMAC_PKT_INFO pPMacPktInfo); -+ -+void VHT_SIG_B_generator( -+ PRT_PMAC_TX_INFO pPMacTxInfo); -+ -+void VHT_Delimiter_generator( -+ PRT_PMAC_TX_INFO pPMacTxInfo); -+ -+ -+int rtw_mp_write_reg(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_read_reg(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_write_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_read_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_start(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_stop(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_rate(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_channel(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_bandwidth(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_txpower_index(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_txpower(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_txpower(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_ant_tx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_ant_rx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_set_ctx_destAddr(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_ctx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_disable_bt_coexist(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_disable_bt_coexist(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_arx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_trx_query(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_pwrtrk(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_psd(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_thermal(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_reset_stats(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_dump(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_phypara(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_SetRFPath(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_QueryDrv(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_PwrCtlDM(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_getver(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_mon(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_efuse_mask_file(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_efuse_file_map(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_SetBT(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_pretx_proc(PADAPTER padapter, u8 bStartTest, char *extra); -+int rtw_mp_tx(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_rx(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+int rtw_mp_hwtx(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+u8 HwRateToMPTRate(u8 rate); -+int rtw_mp_iqk(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+int rtw_mp_lck(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra); -+#endif /* _RTW_MP_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mp_ioctl.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mp_ioctl.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mp_ioctl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mp_ioctl.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,575 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTW_MP_IOCTL_H_ -+#define _RTW_MP_IOCTL_H_ -+ -+#include -+#include -+ -+#if 0 -+#define TESTFWCMDNUMBER 1000000 -+#define TEST_H2CINT_WAIT_TIME 500 -+#define TEST_C2HINT_WAIT_TIME 500 -+#define HCI_TEST_SYSCFG_HWMASK 1 -+#define _BUSCLK_40M (4 << 2) -+#endif -+/* ------------------------------------------------------------------------------ */ -+typedef struct CFG_DBG_MSG_STRUCT { -+ u32 DebugLevel; -+ u32 DebugComponent_H32; -+ u32 DebugComponent_L32; -+} CFG_DBG_MSG_STRUCT, *PCFG_DBG_MSG_STRUCT; -+ -+typedef struct _RW_REG { -+ u32 offset; -+ u32 width; -+ u32 value; -+} mp_rw_reg, RW_Reg, *pRW_Reg; -+ -+/* for OID_RT_PRO_READ16_EEPROM & OID_RT_PRO_WRITE16_EEPROM */ -+typedef struct _EEPROM_RW_PARAM { -+ u32 offset; -+ u16 value; -+} eeprom_rw_param, EEPROM_RWParam, *pEEPROM_RWParam; -+ -+typedef struct _EFUSE_ACCESS_STRUCT_ { -+ u16 start_addr; -+ u16 cnts; -+ u8 data[0]; -+} EFUSE_ACCESS_STRUCT, *PEFUSE_ACCESS_STRUCT; -+ -+typedef struct _BURST_RW_REG { -+ u32 offset; -+ u32 len; -+ u8 Data[256]; -+} burst_rw_reg, Burst_RW_Reg, *pBurst_RW_Reg; -+ -+typedef struct _USB_VendorReq { -+ u8 bRequest; -+ u16 wValue; -+ u16 wIndex; -+ u16 wLength; -+ u8 u8Dir;/* 0:OUT, 1:IN */ -+ u8 u8InData; -+} usb_vendor_req, USB_VendorReq, *pUSB_VendorReq; -+ -+typedef struct _DR_VARIABLE_STRUCT_ { -+ u8 offset; -+ u32 variable; -+} DR_VARIABLE_STRUCT; -+ -+/* int mp_start_joinbss(_adapter *padapter, NDIS_802_11_SSID *pssid); */ -+ -+/* void _irqlevel_changed_(_irqL *irqlevel, BOOLEANunsigned char bLower); */ -+#ifdef PLATFORM_OS_XP -+static void _irqlevel_changed_(_irqL *irqlevel, u8 bLower) -+{ -+ -+ if (bLower == LOWER) { -+ *irqlevel = KeGetCurrentIrql(); -+ -+ if (*irqlevel > PASSIVE_LEVEL) -+ KeLowerIrql(PASSIVE_LEVEL); -+ } else { -+ if (KeGetCurrentIrql() == PASSIVE_LEVEL) -+ KeRaiseIrql(DISPATCH_LEVEL, irqlevel); -+ } -+ -+} -+#else -+#define _irqlevel_changed_(a, b) -+#endif -+ -+/* oid_rtl_seg_81_80_00 */ -+NDIS_STATUS oid_rt_pro_set_data_rate_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_start_test_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_stop_test_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv *poid_par_priv); -+/* oid_rtl_seg_81_80_20 */ -+NDIS_STATUS oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv); -+ -+NDIS_STATUS oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_modulation_hdl(struct oid_par_priv *poid_par_priv); -+ -+NDIS_STATUS oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+/* oid_rtl_seg_81_87 */ -+NDIS_STATUS oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv *poid_par_priv); -+ -+NDIS_STATUS oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+/* oid_rtl_seg_81_85 */ -+NDIS_STATUS oid_rt_wireless_mode_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+/* oid_rtl_seg_87_11_00 */ -+NDIS_STATUS oid_rt_pro8711_join_bss_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_read_register_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_write_register_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_burst_read_register_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_burst_write_register_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_write_txcmd_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_write16_eeprom_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_rd_attrib_mem_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_wr_attrib_mem_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_poll_rx_status_hdl(struct oid_par_priv *poid_par_priv); -+/* oid_rtl_seg_87_11_20 */ -+NDIS_STATUS oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_read_tssi_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv *poid_par_priv); -+/* oid_rtl_seg_87_11_50 */ -+NDIS_STATUS oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv *poid_par_priv); -+/* oid_rtl_seg_87_11_F0 */ -+NDIS_STATUS oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv *poid_par_priv); -+ -+ -+/* oid_rtl_seg_87_12_00 */ -+NDIS_STATUS oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_add_sta_info_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv); -+ -+NDIS_STATUS oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv); -+ -+NDIS_STATUS oid_rt_set_bandwidth_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_set_crystal_cap_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_set_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_efuse_max_size_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv *poid_par_priv); -+ -+NDIS_STATUS oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv *poid_par_priv); -+ -+NDIS_STATUS oid_rt_get_thermal_meter_hdl(struct oid_par_priv *poid_par_priv); -+ -+NDIS_STATUS oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv); -+NDIS_STATUS oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv); -+ -+NDIS_STATUS oid_rt_set_power_down_hdl(struct oid_par_priv *poid_par_priv); -+ -+NDIS_STATUS oid_rt_get_power_mode_hdl(struct oid_par_priv *poid_par_priv); -+ -+NDIS_STATUS oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv); -+ -+#ifdef _RTW_MP_IOCTL_C_ -+ -+const struct oid_obj_priv oid_rtl_seg_81_80_00[] = { -+ {1, &oid_null_function}, /* 0x00 OID_RT_PRO_RESET_DUT */ -+ {1, &oid_rt_pro_set_data_rate_hdl}, /* 0x01 */ -+ {1, &oid_rt_pro_start_test_hdl}, /* 0x02 */ -+ {1, &oid_rt_pro_stop_test_hdl}, /* 0x03 */ -+ {1, &oid_null_function}, /* 0x04 OID_RT_PRO_SET_PREAMBLE */ -+ {1, &oid_null_function}, /* 0x05 OID_RT_PRO_SET_SCRAMBLER */ -+ {1, &oid_null_function}, /* 0x06 OID_RT_PRO_SET_FILTER_BB */ -+ {1, &oid_null_function}, /* 0x07 OID_RT_PRO_SET_MANUAL_DIVERSITY_BB */ -+ {1, &oid_rt_pro_set_channel_direct_call_hdl}, /* 0x08 */ -+ {1, &oid_null_function}, /* 0x09 OID_RT_PRO_SET_SLEEP_MODE_DIRECT_CALL */ -+ {1, &oid_null_function}, /* 0x0A OID_RT_PRO_SET_WAKE_MODE_DIRECT_CALL */ -+ {1, &oid_rt_pro_set_continuous_tx_hdl}, /* 0x0B OID_RT_PRO_SET_TX_CONTINUOUS_DIRECT_CALL */ -+ {1, &oid_rt_pro_set_single_carrier_tx_hdl}, /* 0x0C OID_RT_PRO_SET_SINGLE_CARRIER_TX_CONTINUOUS */ -+ {1, &oid_null_function}, /* 0x0D OID_RT_PRO_SET_TX_ANTENNA_BB */ -+ {1, &oid_rt_pro_set_antenna_bb_hdl}, /* 0x0E */ -+ {1, &oid_null_function}, /* 0x0F OID_RT_PRO_SET_CR_SCRAMBLER */ -+ {1, &oid_null_function}, /* 0x10 OID_RT_PRO_SET_CR_NEW_FILTER */ -+ {1, &oid_rt_pro_set_tx_power_control_hdl}, /* 0x11 OID_RT_PRO_SET_TX_POWER_CONTROL */ -+ {1, &oid_null_function}, /* 0x12 OID_RT_PRO_SET_CR_TX_CONFIG */ -+ {1, &oid_null_function}, /* 0x13 OID_RT_PRO_GET_TX_POWER_CONTROL */ -+ {1, &oid_null_function}, /* 0x14 OID_RT_PRO_GET_CR_SIGNAL_QUALITY */ -+ {1, &oid_null_function}, /* 0x15 OID_RT_PRO_SET_CR_SETPOINT */ -+ {1, &oid_null_function}, /* 0x16 OID_RT_PRO_SET_INTEGRATOR */ -+ {1, &oid_null_function}, /* 0x17 OID_RT_PRO_SET_SIGNAL_QUALITY */ -+ {1, &oid_null_function}, /* 0x18 OID_RT_PRO_GET_INTEGRATOR */ -+ {1, &oid_null_function}, /* 0x19 OID_RT_PRO_GET_SIGNAL_QUALITY */ -+ {1, &oid_null_function}, /* 0x1A OID_RT_PRO_QUERY_EEPROM_TYPE */ -+ {1, &oid_null_function}, /* 0x1B OID_RT_PRO_WRITE_MAC_ADDRESS */ -+ {1, &oid_null_function}, /* 0x1C OID_RT_PRO_READ_MAC_ADDRESS */ -+ {1, &oid_null_function}, /* 0x1D OID_RT_PRO_WRITE_CIS_DATA */ -+ {1, &oid_null_function}, /* 0x1E OID_RT_PRO_READ_CIS_DATA */ -+ {1, &oid_null_function} /* 0x1F OID_RT_PRO_WRITE_POWER_CONTROL */ -+ -+}; -+ -+const struct oid_obj_priv oid_rtl_seg_81_80_20[] = { -+ {1, &oid_null_function}, /* 0x20 OID_RT_PRO_READ_POWER_CONTROL */ -+ {1, &oid_null_function}, /* 0x21 OID_RT_PRO_WRITE_EEPROM */ -+ {1, &oid_null_function}, /* 0x22 OID_RT_PRO_READ_EEPROM */ -+ {1, &oid_rt_pro_reset_tx_packet_sent_hdl}, /* 0x23 */ -+ {1, &oid_rt_pro_query_tx_packet_sent_hdl}, /* 0x24 */ -+ {1, &oid_rt_pro_reset_rx_packet_received_hdl}, /* 0x25 */ -+ {1, &oid_rt_pro_query_rx_packet_received_hdl}, /* 0x26 */ -+ {1, &oid_rt_pro_query_rx_packet_crc32_error_hdl}, /* 0x27 */ -+ {1, &oid_null_function}, /* 0x28 OID_RT_PRO_QUERY_CURRENT_ADDRESS */ -+ {1, &oid_null_function}, /* 0x29 OID_RT_PRO_QUERY_PERMANENT_ADDRESS */ -+ {1, &oid_null_function}, /* 0x2A OID_RT_PRO_SET_PHILIPS_RF_PARAMETERS */ -+ {1, &oid_rt_pro_set_carrier_suppression_tx_hdl},/* 0x2B OID_RT_PRO_SET_CARRIER_SUPPRESSION_TX */ -+ {1, &oid_null_function}, /* 0x2C OID_RT_PRO_RECEIVE_PACKET */ -+ {1, &oid_null_function}, /* 0x2D OID_RT_PRO_WRITE_EEPROM_BYTE */ -+ {1, &oid_null_function}, /* 0x2E OID_RT_PRO_READ_EEPROM_BYTE */ -+ {1, &oid_rt_pro_set_modulation_hdl} /* 0x2F */ -+ -+}; -+ -+const struct oid_obj_priv oid_rtl_seg_81_80_40[] = { -+ {1, &oid_null_function}, /* 0x40 */ -+ {1, &oid_null_function}, /* 0x41 */ -+ {1, &oid_null_function}, /* 0x42 */ -+ {1, &oid_rt_pro_set_single_tone_tx_hdl}, /* 0x43 */ -+ {1, &oid_null_function}, /* 0x44 */ -+ {1, &oid_null_function} /* 0x45 */ -+}; -+ -+const struct oid_obj_priv oid_rtl_seg_81_80_80[] = { -+ {1, &oid_null_function}, /* 0x80 OID_RT_DRIVER_OPTION */ -+ {1, &oid_null_function}, /* 0x81 OID_RT_RF_OFF */ -+ {1, &oid_null_function} /* 0x82 OID_RT_AUTH_STATUS */ -+ -+}; -+ -+const struct oid_obj_priv oid_rtl_seg_81_85[] = { -+ {1, &oid_rt_wireless_mode_hdl} /* 0x00 OID_RT_WIRELESS_MODE */ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_81_87[] = { -+ {1, &oid_null_function}, /* 0x80 OID_RT_PRO8187_WI_POLL */ -+ {1, &oid_rt_pro_write_bb_reg_hdl}, /* 0x81 */ -+ {1, &oid_rt_pro_read_bb_reg_hdl}, /* 0x82 */ -+ {1, &oid_rt_pro_write_rf_reg_hdl}, /* 0x82 */ -+ {1, &oid_rt_pro_read_rf_reg_hdl} /* 0x83 */ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_87_11_00[] = { -+ {1, &oid_rt_pro8711_join_bss_hdl}, /* 0x00 */ /* S */ -+ {1, &oid_rt_pro_read_register_hdl}, /* 0x01 */ -+ {1, &oid_rt_pro_write_register_hdl}, /* 0x02 */ -+ {1, &oid_rt_pro_burst_read_register_hdl}, /* 0x03 */ -+ {1, &oid_rt_pro_burst_write_register_hdl}, /* 0x04 */ -+ {1, &oid_rt_pro_write_txcmd_hdl}, /* 0x05 */ -+ {1, &oid_rt_pro_read16_eeprom_hdl}, /* 0x06 */ -+ {1, &oid_rt_pro_write16_eeprom_hdl}, /* 0x07 */ -+ {1, &oid_null_function}, /* 0x08 OID_RT_PRO_H2C_SET_COMMAND */ -+ {1, &oid_null_function}, /* 0x09 OID_RT_PRO_H2C_QUERY_RESULT */ -+ {1, &oid_rt_pro8711_wi_poll_hdl}, /* 0x0A */ -+ {1, &oid_rt_pro8711_pkt_loss_hdl}, /* 0x0B */ -+ {1, &oid_rt_rd_attrib_mem_hdl}, /* 0x0C */ -+ {1, &oid_rt_wr_attrib_mem_hdl}, /* 0x0D */ -+ {1, &oid_null_function}, /* 0x0E */ -+ {1, &oid_null_function}, /* 0x0F */ -+ {1, &oid_null_function}, /* 0x10 OID_RT_PRO_H2C_CMD_MODE */ -+ {1, &oid_null_function}, /* 0x11 OID_RT_PRO_H2C_CMD_RSP_MODE */ -+ {1, &oid_null_function}, /* 0X12 OID_RT_PRO_WAIT_C2H_EVENT */ -+ {1, &oid_null_function}, /* 0X13 OID_RT_PRO_RW_ACCESS_PROTOCOL_TEST */ -+ {1, &oid_null_function}, /* 0X14 OID_RT_PRO_SCSI_ACCESS_TEST */ -+ {1, &oid_null_function}, /* 0X15 OID_RT_PRO_SCSI_TCPIPOFFLOAD_OUT */ -+ {1, &oid_null_function}, /* 0X16 OID_RT_PRO_SCSI_TCPIPOFFLOAD_IN */ -+ {1, &oid_null_function}, /* 0X17 OID_RT_RRO_RX_PKT_VIA_IOCTRL */ -+ {1, &oid_null_function}, /* 0X18 OID_RT_RRO_RX_PKTARRAY_VIA_IOCTRL */ -+ {1, &oid_null_function}, /* 0X19 OID_RT_RPO_SET_PWRMGT_TEST */ -+ {1, &oid_null_function}, /* 0X1A */ -+ {1, &oid_null_function}, /* 0X1B OID_RT_PRO_QRY_PWRMGT_TEST */ -+ {1, &oid_null_function}, /* 0X1C OID_RT_RPO_ASYNC_RWIO_TEST */ -+ {1, &oid_null_function}, /* 0X1D OID_RT_RPO_ASYNC_RWIO_POLL */ -+ {1, &oid_rt_pro_set_rf_intfs_hdl}, /* 0X1E */ -+ {1, &oid_rt_poll_rx_status_hdl} /* 0X1F */ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_87_11_20[] = { -+ {1, &oid_rt_pro_cfg_debug_message_hdl}, /* 0x20 */ -+ {1, &oid_rt_pro_set_data_rate_ex_hdl}, /* 0x21 */ -+ {1, &oid_rt_pro_set_basic_rate_hdl}, /* 0x22 */ -+ {1, &oid_rt_pro_read_tssi_hdl}, /* 0x23 */ -+ {1, &oid_rt_pro_set_power_tracking_hdl} /* 0x24 */ -+}; -+ -+ -+struct oid_obj_priv oid_rtl_seg_87_11_50[] = { -+ {1, &oid_rt_pro_qry_pwrstate_hdl}, /* 0x50 */ -+ {1, &oid_rt_pro_set_pwrstate_hdl} /* 0x51 */ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_87_11_80[] = { -+ {1, &oid_null_function} /* 0x80 */ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_87_11_B0[] = { -+ {1, &oid_null_function} /* 0xB0 */ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_87_11_F0[] = { -+ {1, &oid_null_function}, /* 0xF0 */ -+ {1, &oid_null_function}, /* 0xF1 */ -+ {1, &oid_null_function}, /* 0xF2 */ -+ {1, &oid_null_function}, /* 0xF3 */ -+ {1, &oid_null_function}, /* 0xF4 */ -+ {1, &oid_null_function}, /* 0xF5 */ -+ {1, &oid_null_function}, /* 0xF6 */ -+ {1, &oid_null_function}, /* 0xF7 */ -+ {1, &oid_null_function}, /* 0xF8 */ -+ {1, &oid_null_function}, /* 0xF9 */ -+ {1, &oid_null_function}, /* 0xFA */ -+ {1, &oid_rt_pro_h2c_set_rate_table_hdl}, /* 0xFB */ -+ {1, &oid_rt_pro_h2c_get_rate_table_hdl}, /* 0xFC */ -+ {1, &oid_null_function}, /* 0xFD */ -+ {1, &oid_null_function}, /* 0xFE OID_RT_PRO_H2C_C2H_LBK_TEST */ -+ {1, &oid_null_function} /* 0xFF */ -+ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_87_12_00[] = { -+ {1, &oid_rt_pro_encryption_ctrl_hdl}, /* 0x00 Q&S */ -+ {1, &oid_rt_pro_add_sta_info_hdl}, /* 0x01 S */ -+ {1, &oid_rt_pro_dele_sta_info_hdl}, /* 0x02 S */ -+ {1, &oid_rt_pro_query_dr_variable_hdl}, /* 0x03 Q */ -+ {1, &oid_rt_pro_rx_packet_type_hdl}, /* 0x04 Q,S */ -+ {1, &oid_rt_pro_read_efuse_hdl}, /* 0x05 Q OID_RT_PRO_READ_EFUSE */ -+ {1, &oid_rt_pro_write_efuse_hdl}, /* 0x06 S OID_RT_PRO_WRITE_EFUSE */ -+ {1, &oid_rt_pro_rw_efuse_pgpkt_hdl}, /* 0x07 Q,S */ -+ {1, &oid_rt_get_efuse_current_size_hdl}, /* 0x08 Q */ -+ {1, &oid_rt_set_bandwidth_hdl}, /* 0x09 */ -+ {1, &oid_rt_set_crystal_cap_hdl}, /* 0x0a */ -+ {1, &oid_rt_set_rx_packet_type_hdl}, /* 0x0b S */ -+ {1, &oid_rt_get_efuse_max_size_hdl}, /* 0x0c */ -+ {1, &oid_rt_pro_set_tx_agc_offset_hdl}, /* 0x0d */ -+ {1, &oid_rt_pro_set_pkt_test_mode_hdl}, /* 0x0e */ -+ {1, &oid_null_function}, /* 0x0f OID_RT_PRO_FOR_EVM_TEST_SETTING */ -+ {1, &oid_rt_get_thermal_meter_hdl}, /* 0x10 Q OID_RT_PRO_GET_THERMAL_METER */ -+ {1, &oid_rt_reset_phy_rx_packet_count_hdl}, /* 0x11 S OID_RT_RESET_PHY_RX_PACKET_COUNT */ -+ {1, &oid_rt_get_phy_rx_packet_received_hdl}, /* 0x12 Q OID_RT_GET_PHY_RX_PACKET_RECEIVED */ -+ {1, &oid_rt_get_phy_rx_packet_crc32_error_hdl}, /* 0x13 Q OID_RT_GET_PHY_RX_PACKET_CRC32_ERROR */ -+ {1, &oid_rt_set_power_down_hdl}, /* 0x14 Q OID_RT_SET_POWER_DOWN */ -+ {1, &oid_rt_get_power_mode_hdl} /* 0x15 Q OID_RT_GET_POWER_MODE */ -+}; -+ -+#else /* _RTL871X_MP_IOCTL_C_ */ -+ -+extern struct oid_obj_priv oid_rtl_seg_81_80_00[32]; -+extern struct oid_obj_priv oid_rtl_seg_81_80_20[16]; -+extern struct oid_obj_priv oid_rtl_seg_81_80_40[6]; -+extern struct oid_obj_priv oid_rtl_seg_81_80_80[3]; -+ -+extern struct oid_obj_priv oid_rtl_seg_81_85[1]; -+extern struct oid_obj_priv oid_rtl_seg_81_87[5]; -+ -+extern struct oid_obj_priv oid_rtl_seg_87_11_00[32]; -+extern struct oid_obj_priv oid_rtl_seg_87_11_20[5]; -+extern struct oid_obj_priv oid_rtl_seg_87_11_50[2]; -+extern struct oid_obj_priv oid_rtl_seg_87_11_80[1]; -+extern struct oid_obj_priv oid_rtl_seg_87_11_B0[1]; -+extern struct oid_obj_priv oid_rtl_seg_87_11_F0[16]; -+ -+extern struct oid_obj_priv oid_rtl_seg_87_12_00[32]; -+ -+#endif /* _RTL871X_MP_IOCTL_C_ */ -+ -+struct rwreg_param { -+ u32 offset; -+ u32 width; -+ u32 value; -+}; -+ -+struct bbreg_param { -+ u32 offset; -+ u32 phymask; -+ u32 value; -+}; -+/* -+struct rfchannel_param{ -+ u32 ch; -+ u32 modem; -+}; -+*/ -+struct txpower_param { -+ u32 pwr_index; -+}; -+ -+ -+struct datarate_param { -+ u32 rate_index; -+}; -+ -+ -+struct rfintfs_parm { -+ u32 rfintfs; -+}; -+ -+typedef struct _mp_xmit_parm_ { -+ u8 enable; -+ u32 count; -+ u16 length; -+ u8 payload_type; -+ u8 da[ETH_ALEN]; -+} MP_XMIT_PARM, *PMP_XMIT_PARM; -+ -+struct mp_xmit_packet { -+ u32 len; -+ u32 mem[MAX_MP_XMITBUF_SZ >> 2]; -+}; -+ -+struct psmode_param { -+ u32 ps_mode; -+ u32 smart_ps; -+}; -+ -+/* for OID_RT_PRO_READ16_EEPROM & OID_RT_PRO_WRITE16_EEPROM */ -+struct eeprom_rw_param { -+ u32 offset; -+ u16 value; -+}; -+ -+struct mp_ioctl_handler { -+ u32 paramsize; -+ u32(*handler)(struct oid_par_priv *poid_par_priv); -+ u32 oid; -+}; -+ -+struct mp_ioctl_param { -+ u32 subcode; -+ u32 len; -+ u8 data[0]; -+}; -+ -+#define GEN_MP_IOCTL_SUBCODE(code) _MP_IOCTL_ ## code ## _CMD_ -+ -+enum RTL871X_MP_IOCTL_SUBCODE { -+ GEN_MP_IOCTL_SUBCODE(MP_START), /*0*/ -+ GEN_MP_IOCTL_SUBCODE(MP_STOP), -+ GEN_MP_IOCTL_SUBCODE(READ_REG), -+ GEN_MP_IOCTL_SUBCODE(WRITE_REG), -+ GEN_MP_IOCTL_SUBCODE(READ_BB_REG), -+ GEN_MP_IOCTL_SUBCODE(WRITE_BB_REG), /*5*/ -+ GEN_MP_IOCTL_SUBCODE(READ_RF_REG), -+ GEN_MP_IOCTL_SUBCODE(WRITE_RF_REG), -+ GEN_MP_IOCTL_SUBCODE(SET_CHANNEL), -+ GEN_MP_IOCTL_SUBCODE(SET_TXPOWER), -+ GEN_MP_IOCTL_SUBCODE(SET_DATARATE), /*10*/ -+ GEN_MP_IOCTL_SUBCODE(SET_BANDWIDTH), -+ GEN_MP_IOCTL_SUBCODE(SET_ANTENNA), -+ GEN_MP_IOCTL_SUBCODE(CNTU_TX), -+ GEN_MP_IOCTL_SUBCODE(SC_TX), -+ GEN_MP_IOCTL_SUBCODE(CS_TX), /*15*/ -+ GEN_MP_IOCTL_SUBCODE(ST_TX), -+ GEN_MP_IOCTL_SUBCODE(IOCTL_XMIT_PACKET), -+ GEN_MP_IOCTL_SUBCODE(SET_RX_PKT_TYPE), -+ GEN_MP_IOCTL_SUBCODE(RESET_PHY_RX_PKT_CNT), -+ GEN_MP_IOCTL_SUBCODE(GET_PHY_RX_PKT_RECV), /*20*/ -+ GEN_MP_IOCTL_SUBCODE(GET_PHY_RX_PKT_ERROR), -+ GEN_MP_IOCTL_SUBCODE(READ16_EEPROM), -+ GEN_MP_IOCTL_SUBCODE(WRITE16_EEPROM), -+ GEN_MP_IOCTL_SUBCODE(EFUSE), -+ GEN_MP_IOCTL_SUBCODE(EFUSE_MAP), /*25*/ -+ GEN_MP_IOCTL_SUBCODE(GET_EFUSE_MAX_SIZE), -+ GEN_MP_IOCTL_SUBCODE(GET_EFUSE_CURRENT_SIZE), -+ GEN_MP_IOCTL_SUBCODE(GET_THERMAL_METER), -+ GEN_MP_IOCTL_SUBCODE(SET_PTM), -+ GEN_MP_IOCTL_SUBCODE(SET_POWER_DOWN), /*30*/ -+ GEN_MP_IOCTL_SUBCODE(TRIGGER_GPIO), -+ GEN_MP_IOCTL_SUBCODE(SET_DM_BT), /*32*/ -+ GEN_MP_IOCTL_SUBCODE(DEL_BA), /*33*/ -+ GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS), /*34*/ -+ MAX_MP_IOCTL_SUBCODE, -+}; -+ -+u32 mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv); -+ -+#ifdef _RTW_MP_IOCTL_C_ -+ -+#define GEN_MP_IOCTL_HANDLER(sz, hdl, oid) {sz, hdl, oid}, -+ -+#define EXT_MP_IOCTL_HANDLER(sz, subcode, oid) {sz, mp_ioctl_ ## subcode ## _hdl, oid}, -+ -+ -+struct mp_ioctl_handler mp_ioctl_hdl[] = { -+ -+ /*0*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_start_test_hdl, OID_RT_PRO_START_TEST) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_stop_test_hdl, OID_RT_PRO_STOP_TEST) -+ -+ GEN_MP_IOCTL_HANDLER(sizeof(struct rwreg_param), oid_rt_pro_read_register_hdl, OID_RT_PRO_READ_REGISTER) -+ GEN_MP_IOCTL_HANDLER(sizeof(struct rwreg_param), oid_rt_pro_write_register_hdl, OID_RT_PRO_WRITE_REGISTER) -+ GEN_MP_IOCTL_HANDLER(sizeof(struct bb_reg_param), oid_rt_pro_read_bb_reg_hdl, OID_RT_PRO_READ_BB_REG) -+ /*5*/ GEN_MP_IOCTL_HANDLER(sizeof(struct bb_reg_param), oid_rt_pro_write_bb_reg_hdl, OID_RT_PRO_WRITE_BB_REG) -+ GEN_MP_IOCTL_HANDLER(sizeof(struct rf_reg_param), oid_rt_pro_read_rf_reg_hdl, OID_RT_PRO_RF_READ_REGISTRY) -+ GEN_MP_IOCTL_HANDLER(sizeof(struct rf_reg_param), oid_rt_pro_write_rf_reg_hdl, OID_RT_PRO_RF_WRITE_REGISTRY) -+ -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_channel_direct_call_hdl, OID_RT_PRO_SET_CHANNEL_DIRECT_CALL) -+ GEN_MP_IOCTL_HANDLER(sizeof(struct txpower_param), oid_rt_pro_set_tx_power_control_hdl, OID_RT_PRO_SET_TX_POWER_CONTROL) -+ /*10*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_data_rate_hdl, OID_RT_PRO_SET_DATA_RATE) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_set_bandwidth_hdl, OID_RT_SET_BANDWIDTH) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_antenna_bb_hdl, OID_RT_PRO_SET_ANTENNA_BB) -+ -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_continuous_tx_hdl, OID_RT_PRO_SET_CONTINUOUS_TX) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_single_carrier_tx_hdl, OID_RT_PRO_SET_SINGLE_CARRIER_TX) -+ /*15*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_carrier_suppression_tx_hdl, OID_RT_PRO_SET_CARRIER_SUPPRESSION_TX) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_single_tone_tx_hdl, OID_RT_PRO_SET_SINGLE_TONE_TX) -+ -+ EXT_MP_IOCTL_HANDLER(0, xmit_packet, 0) -+ -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_set_rx_packet_type_hdl, OID_RT_SET_RX_PACKET_TYPE) -+ GEN_MP_IOCTL_HANDLER(0, oid_rt_reset_phy_rx_packet_count_hdl, OID_RT_RESET_PHY_RX_PACKET_COUNT) -+ /*20*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_phy_rx_packet_received_hdl, OID_RT_GET_PHY_RX_PACKET_RECEIVED) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_phy_rx_packet_crc32_error_hdl, OID_RT_GET_PHY_RX_PACKET_CRC32_ERROR) -+ -+ GEN_MP_IOCTL_HANDLER(sizeof(struct eeprom_rw_param), NULL, 0) -+ GEN_MP_IOCTL_HANDLER(sizeof(struct eeprom_rw_param), NULL, 0) -+ GEN_MP_IOCTL_HANDLER(sizeof(EFUSE_ACCESS_STRUCT), oid_rt_pro_efuse_hdl, OID_RT_PRO_EFUSE) -+ /*25*/ GEN_MP_IOCTL_HANDLER(0, oid_rt_pro_efuse_map_hdl, OID_RT_PRO_EFUSE_MAP) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_efuse_max_size_hdl, OID_RT_GET_EFUSE_MAX_SIZE) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_efuse_current_size_hdl, OID_RT_GET_EFUSE_CURRENT_SIZE) -+ -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_thermal_meter_hdl, OID_RT_PRO_GET_THERMAL_METER) -+ GEN_MP_IOCTL_HANDLER(sizeof(u8), oid_rt_pro_set_power_tracking_hdl, OID_RT_PRO_SET_POWER_TRACKING) -+ /*30*/ GEN_MP_IOCTL_HANDLER(sizeof(u8), oid_rt_set_power_down_hdl, OID_RT_SET_POWER_DOWN) -+ /*31*/ GEN_MP_IOCTL_HANDLER(0, oid_rt_pro_trigger_gpio_hdl, 0) -+ GEN_MP_IOCTL_HANDLER(0, NULL, 0) -+ GEN_MP_IOCTL_HANDLER(0, NULL, 0) -+ GEN_MP_IOCTL_HANDLER(0, NULL, 0) -+}; -+ -+#else /* _RTW_MP_IOCTL_C_ */ -+ -+extern struct mp_ioctl_handler mp_ioctl_hdl[]; -+ -+#endif /* _RTW_MP_IOCTL_C_ */ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_mp_phy_regdef.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mp_phy_regdef.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_mp_phy_regdef.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_mp_phy_regdef.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,1099 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/***************************************************************************** -+ * -+ * Module: __RTW_MP_PHY_REGDEF_H_ -+ * -+ * -+ * Note: 1. Define PMAC/BB register map -+ * 2. Define RF register map -+ * 3. PMAC/BB register bit mask. -+ * 4. RF reg bit mask. -+ * 5. Other BB/RF relative definition. -+ * -+ * -+ * Export: Constants, macro, functions(API), global variables(None). -+ * -+ * Abbrev: -+ * -+ * History: -+ * Data Who Remark -+ * 08/07/2007 MHC 1. Porting from 9x series PHYCFG.h. -+ * 2. Reorganize code architecture. -+ * 09/25/2008 MH 1. Add RL6052 register definition -+ * -+ *****************************************************************************/ -+#ifndef __RTW_MP_PHY_REGDEF_H_ -+#define __RTW_MP_PHY_REGDEF_H_ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+/* ************************************************************ -+ * 8192S Regsiter offset definition -+ * ************************************************************ */ -+ -+/* -+ * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+ * 3. RF register 0x00-2E -+ * 4. Bit Mask for BB/RF register -+ * 5. Other defintion for BB/RF R/W -+ * */ -+ -+ -+/* -+ * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+ * 1. Page1(0x100) -+ * */ -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+/* -+ * 2. Page2(0x200) -+ * -+ * The following two definition are only used for USB interface. -+ * #define RF_BB_CMD_ADDR 0x02c0 */ /* RF/BB read/write command address. -+ * #define RF_BB_CMD_DATA 0x02c4 */ /* RF/BB read/write command data. */ -+ -+/* -+ * 3. Page8(0x800) -+ * */ -+#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA0_TxInfo 0x804 /* Status report?? */ -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ -+ -+#define rFPGA0_RFTiming1 0x810 /* Useless now */ -+#define rFPGA0_RFTiming2 0x814 -+/* #define rFPGA0_XC_RFTiming 0x818 */ -+/* #define rFPGA0_XD_RFTiming 0x81c */ -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+#define rFPGA0_XC_HSSIParameter1 0x830 -+#define rFPGA0_XC_HSSIParameter2 0x834 -+#define rFPGA0_XD_HSSIParameter1 0x838 -+#define rFPGA0_XD_HSSIParameter2 0x83c -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+#define rFPGA0_XC_LSSIParameter 0x848 -+#define rFPGA0_XD_LSSIParameter 0x84c -+ -+#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+#define rFPGA0_XC_RFInterfaceOE 0x868 -+#define rFPGA0_XD_RFInterfaceOE 0x86c -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 /* Useless now */ -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now */ /* RF Interface Readback Value */ -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ -+ -+/* -+ * 4. Page9(0x900) -+ * */ -+#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC */ /* RF BW Setting?? */ -+ -+#define rFPGA1_TxBlock 0x904 /* Useless now */ -+#define rFPGA1_DebugSelect 0x908 /* Useless now */ -+#define rFPGA1_TxInfo 0x90c /* Useless now */ /* Status report?? */ -+#define rS0S1_PathSwitch 0x948 -+ -+/* -+ * 5. PageA(0xA00) -+ * -+ * Set Control channel to upper or lower. These settings are required only for 40MHz */ -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 /* Disable init gain now */ /* Select RX path by RSSI */ -+#define rCCK0_CCA 0xa08 /* Disable init gain now */ /* Init gain */ -+ -+#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level */ /* Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ -+#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ -+#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ -+#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 /* 0xa57 */ -+#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ -+#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ -+ -+/* -+ * 6. PageC(0xC00) -+ * */ -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ -+#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imblance matrix */ -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD */ /* DM tune init gain */ -+#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ -+#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ -+#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ -+ -+#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ -+#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ -+#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ -+#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ -+ -+#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+#define rOFDM0_RxIQExtAnta 0xca0 -+ -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+ -+ -+/* -+ * 7. PageD(0xD00) -+ * */ -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 /* No setting now */ -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ -+#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ -+#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ -+ -+#define rOFDM_ShortCFOAB 0xdac /* No setting now */ -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+/* -+ * 8. PageE(0xE00) -+ * */ -+#define rTxAGC_Rate18_06 0xe00 -+#define rTxAGC_Rate54_24 0xe04 -+#define rTxAGC_CCK_Mcs32 0xe08 -+#define rTxAGC_Mcs03_Mcs00 0xe10 -+#define rTxAGC_Mcs07_Mcs04 0xe14 -+#define rTxAGC_Mcs11_Mcs08 0xe18 -+#define rTxAGC_Mcs15_Mcs12 0xe1c -+ -+/* Analog- control in RX_WAIT_CCA : REG: EE0 [Analog- Power & Control Register] */ -+#define rRx_Wait_CCCA 0xe70 -+#define rAnapar_Ctrl_BB 0xee0 -+ -+/* -+ * 7. RF Register 0x00-0x2E (RF 8256) -+ * RF-0222D 0x00-3F -+ * -+ * Zebra1 */ -+#define RTL92SE_FPGA_VERIFY 0 -+#define rZebra1_HSSIEnable 0x0 /* Useless now */ -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+/* #if (RTL92SE_FPGA_VERIFY == 1) */ -+#define rZebra1_Channel 0x7 /* RF channel switch -+ * #else */ -+ -+/* #endif */ -+#define rZebra1_TxGain 0x8 /* Useless now */ -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+/* Zebra4 */ -+#define rGlobalCtrl 0 /* Useless now */ -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+/* RTL8258 */ -+#define rRTL8258_TxLPF 0x11 /* Useless now */ -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+/* -+ * RL6052 Register definition -+ * */ -+#define RF_AC 0x00 /* */ -+ -+#define RF_IQADJ_G1 0x01 /* */ -+#define RF_IQADJ_G2 0x02 /* */ -+#define RF_POW_TRSW 0x05 /* */ -+ -+#define RF_GAIN_RX 0x06 /* */ -+#define RF_GAIN_TX 0x07 /* */ -+ -+#define RF_TXM_IDAC 0x08 /* */ -+#define RF_BS_IQGEN 0x0F /* */ -+ -+#define RF_MODE1 0x10 /* */ -+#define RF_MODE2 0x11 /* */ -+ -+#define RF_RX_AGC_HP 0x12 /* */ -+#define RF_TX_AGC 0x13 /* */ -+#define RF_BIAS 0x14 /* */ -+#define RF_IPA 0x15 /* */ -+#define RF_TXBIAS 0x16 -+#define RF_POW_ABILITY 0x17 /* */ -+#define RF_MODE_AG 0x18 /* */ -+#define rRfChannel 0x18 /* RF channel and BW switch */ -+#define RF_CHNLBW 0x18 /* RF channel and BW switch */ -+#define RF_TOP 0x19 /* */ -+ -+#define RF_RX_G1 0x1A /* */ -+#define RF_RX_G2 0x1B /* */ -+ -+#define RF_RX_BB2 0x1C /* */ -+#define RF_RX_BB1 0x1D /* */ -+ -+#define RF_RCK1 0x1E /* */ -+#define RF_RCK2 0x1F /* */ -+ -+#define RF_TX_G1 0x20 /* */ -+#define RF_TX_G2 0x21 /* */ -+#define RF_TX_G3 0x22 /* */ -+ -+#define RF_TX_BB1 0x23 /* */ -+ -+#define RF_T_METER 0x24 /* */ -+ -+#define RF_SYN_G1 0x25 /* RF TX Power control */ -+#define RF_SYN_G2 0x26 /* RF TX Power control */ -+#define RF_SYN_G3 0x27 /* RF TX Power control */ -+#define RF_SYN_G4 0x28 /* RF TX Power control */ -+#define RF_SYN_G5 0x29 /* RF TX Power control */ -+#define RF_SYN_G6 0x2A /* RF TX Power control */ -+#define RF_SYN_G7 0x2B /* RF TX Power control */ -+#define RF_SYN_G8 0x2C /* RF TX Power control */ -+ -+#define RF_RCK_OS 0x30 /* RF TX PA control */ -+ -+#define RF_TXPA_G1 0x31 /* RF TX PA control */ -+#define RF_TXPA_G2 0x32 /* RF TX PA control */ -+#define RF_TXPA_G3 0x33 /* RF TX PA control */ -+ -+/* -+ * Bit Mask -+ * -+ * 1. Page1(0x100) */ -+#define bBBResetB 0x100 /* Useless now? */ -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+ -+/* 2. Page8(0x800) */ -+#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 /* Useless now */ -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 /* Useless now */ -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf /* Reg0x814 */ -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 /* T2R */ -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 /* chane gain at continue Tx */ -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 /* Useless now -+ * #define bHWSISelect 0x8 */ -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ -+ -+#define bRFSI_TRSW 0x20 /* Useless now */ -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+#if (RTL92SE_FPGA_VERIFY == 1) -+ #define bLSSIReadAddress 0x3f000000 /* LSSI "Read" Address */ /* Reg 0x824 rFPGA0_XA_HSSIParameter2 */ -+#else -+ #define bLSSIReadAddress 0x7f800000 /* T65 RF */ -+#endif -+#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ -+#if (RTL92SE_FPGA_VERIFY == 1) -+ #define bLSSIReadBackData 0xfff /* Reg 0x8a0 rFPGA0_XA_LSSIReadBack */ -+#else -+ #define bLSSIReadBackData 0xfffff /* T65 RF */ -+#endif -+#define bLSSIReadOKFlag 0x1000 /* Useless now */ -+#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ -+ -+#define b80MClkDelay 0x18000000 /* Useless */ -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 /* Useless */ -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+/* 3. Page9(0x900) */ -+#define bOFDMTxSC 0x30000000 /* Useless */ -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ -+#define bDebugItem 0xff /* reset debug page and LWord */ -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+/* 4. PageA(0xA00) */ -+#define bCCKBBMode 0x3 /* Useless */ -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ -+ -+#define bCCKScramble 0x8 /* Useless */ -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ -+#define bCCKFixedRxAGC 0x8000 -+/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+/* 5. PageC(0xC00) */ -+#define bNumOfSTF 0x3 /* Useless */ -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 /* the threshold for high power */ -+#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+/* #define bRxMF_Hold 0x3800 */ -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+/* 6. PageE(0xE00) */ -+#define bSTBCEn 0x4 /* Useless */ -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+/* #define bRxPath1 0x01 */ -+/* #define bRxPath2 0x02 */ -+/* #define bRxPath3 0x04 */ -+/* #define bRxPath4 0x08 */ -+/* #define bTxPath1 0x10 */ -+/* #define bTxPath2 0x20 */ -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 /* total */ -+#define bShortCFOFLength 11 /* fraction */ -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf /* Useless */ -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 /* Useless */ -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 /* Useless */ -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+#define bTxAGCRate18_06 0x7f7f7f7f /* Useless */ -+#define bTxAGCRate54_24 0x7f7f7f7f -+#define bTxAGCRateMCS32 0x7f -+#define bTxAGCRateCCK 0x7f00 -+#define bTxAGCRateMCS3_MCS0 0x7f7f7f7f -+#define bTxAGCRateMCS7_MCS4 0x7f7f7f7f -+#define bTxAGCRateMCS11_MCS8 0x7f7f7f7f -+#define bTxAGCRateMCS15_MCS12 0x7f7f7f7f -+ -+/* Rx Pseduo noise */ -+#define bRxPesudoNoiseOn 0x20000000 /* Useless */ -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+/* 7. RF Register -+ * Zebra1 */ -+#define bZebra1_HSSIEnable 0x8 /* Useless */ -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+/* Zebra4 */ -+#define bRTL8256RegModeCtrl1 0x100 /* Useless */ -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+/* RTL8258 */ -+#define bRTL8258_TxLPFBW 0xc /* Useless */ -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+/* -+ * Other Definition -+ * */ -+ -+/* byte endable for sb_write */ -+#define bByte0 0x1 /* Useless */ -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+/* for PutRegsetting & GetRegSetting BitMask */ -+#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskH3Bytes 0xffffff00 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+#define bMask12Bits 0xfff -+ -+/* for PutRFRegsetting & GetRFRegSetting BitMask */ -+#if (RTL92SE_FPGA_VERIFY == 1) -+/* #define bMask12Bits 0xfff */ /* RF Reg mask bits */ -+/* #define bMask20Bits 0xfff */ /* RF Reg mask bits T65 RF */ -+#define bRFRegOffsetMask 0xfff -+#else -+/* #define bMask12Bits 0xfffff */ /* RF Reg mask bits */ -+/* #define bMask20Bits 0xfffff */ /* RF Reg mask bits T65 RF */ -+#define bRFRegOffsetMask 0xfffff -+#endif -+#define bEnable 0x1 /* Useless */ -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 /* Useless */ -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 /* 500ms */ /* Useless */ -+#define tUpdateRxCounter 100 /* 100ms */ -+ -+#define rateCCK 0 /* Useless */ -+#define rateOFDM 1 -+#define rateHT 2 -+ -+/* define Register-End */ -+#define bPMAC_End 0x1ff /* Useless */ -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+/* define max debug item in each debug page -+ * #define bMaxItem_FPGA_PHY0 0x9 -+ * #define bMaxItem_FPGA_PHY1 0x3 -+ * #define bMaxItem_PHY_11B 0x16 -+ * #define bMaxItem_OFDM_PHY0 0x29 -+ * #define bMaxItem_OFDM_PHY1 0x0 */ -+ -+#define bPMACControl 0x0 /* Useless */ -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#if 0 -+#define ANTENNA_A 0x1 /* Useless */ -+#define ANTENNA_B 0x2 -+#define ANTENNA_AB 0x3 /* ANTENNA_A | ANTENNA_B */ -+ -+#define ANTENNA_C 0x4 -+#define ANTENNA_D 0x8 -+#endif -+ -+#define RCR_AAP BIT(0) /* accept all physical address */ -+#define RCR_APM BIT(1) /* accept physical match */ -+#define RCR_AM BIT(2) /* accept multicast */ -+#define RCR_AB BIT(3) /* accept broadcast */ -+#define RCR_ACRC32 BIT(5) /* accept error packet */ -+#define RCR_9356SEL BIT(6) -+#define RCR_AICV BIT(9) /* Accept ICV error packet */ -+#define RCR_RXFTH0 (BIT(13) | BIT(14) | BIT(15)) /* Rx FIFO threshold */ -+#define RCR_ADF BIT(18) /* Accept Data(frame type) frame */ -+#define RCR_ACF BIT(19) /* Accept control frame */ -+#define RCR_AMF BIT(20) /* Accept management frame */ -+#define RCR_ADD3 BIT(21) -+#define RCR_APWRMGT BIT(22) /* Accept power management packet */ -+#define RCR_CBSSID BIT(23) /* Accept BSSID match packet */ -+#define RCR_ENMARP BIT(28) /* enable mac auto reset phy */ -+#define RCR_EnCS1 BIT(29) /* enable carrier sense method 1 */ -+#define RCR_EnCS2 BIT(30) /* enable carrier sense method 2 */ -+#define RCR_OnlyErlPkt BIT(31) /* Rx Early mode is performed for packet size greater than 1536 */ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+#endif /* __INC_HAL8192SPHYREG_H */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_odm.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_odm.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_odm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_odm.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,61 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_ODM_H__ -+#define __RTW_ODM_H__ -+ -+#include -+#include "../hal/phydm/phydm_types.h" -+/* -+* This file provides utilities/wrappers for rtw driver to use ODM -+*/ -+ -+void rtw_odm_dbg_comp_msg(void *sel, _adapter *adapter); -+void rtw_odm_dbg_comp_set(_adapter *adapter, u64 comps); -+void rtw_odm_dbg_level_msg(void *sel, _adapter *adapter); -+void rtw_odm_dbg_level_set(_adapter *adapter, u32 level); -+ -+void rtw_odm_ability_msg(void *sel, _adapter *adapter); -+void rtw_odm_ability_set(_adapter *adapter, u32 ability); -+ -+void rtw_odm_init_ic_type(_adapter *adapter); -+ -+void rtw_odm_set_force_igi_lb(_adapter *adapter, u8 lb); -+u8 rtw_odm_get_force_igi_lb(_adapter *adapter); -+ -+void rtw_odm_adaptivity_config_msg(void *sel, _adapter *adapter); -+ -+bool rtw_odm_adaptivity_needed(_adapter *adapter); -+void rtw_odm_adaptivity_parm_msg(void *sel, _adapter *adapter); -+void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff, s8 TH_L2H_ini_mode2, s8 TH_EDCCA_HL_diff_mode2, u8 EDCCA_enable); -+void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter); -+void rtw_odm_acquirespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type); -+void rtw_odm_releasespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type); -+ -+#ifdef CONFIG_DFS_MASTER -+u8 rtw_odm_get_dfs_domain(_adapter *adapter); -+VOID rtw_odm_radar_detect_reset(_adapter *adapter); -+VOID rtw_odm_radar_detect_disable(_adapter *adapter); -+VOID rtw_odm_radar_detect_enable(_adapter *adapter); -+BOOLEAN rtw_odm_radar_detect(_adapter *adapter); -+#endif /* CONFIG_DFS_MASTER */ -+ -+void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys); -+ -+#endif /* __RTW_ODM_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_p2p.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_p2p.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_p2p.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_p2p.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,176 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_P2P_H_ -+#define __RTW_P2P_H_ -+ -+ -+u32 build_beacon_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_probe_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_prov_disc_request_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 *pssid, u8 ussidlen, u8 *pdev_raddr); -+u32 build_assoc_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 status_code); -+u32 build_deauth_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+#ifdef CONFIG_WFD -+int rtw_init_wifi_display_info(_adapter *padapter); -+void rtw_wfd_enable(_adapter *adapter, bool on); -+void rtw_wfd_set_ctrl_port(_adapter *adapter, u16 port); -+void rtw_tdls_wfd_enable(_adapter *adapter, bool on); -+ -+u32 build_probe_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_probe_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 tunneled); -+u32 build_beacon_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_nego_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_nego_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_nego_confirm_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_invitation_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_invitation_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_assoc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_assoc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_provdisc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_provdisc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+ -+u32 rtw_append_beacon_wfd_ie(_adapter *adapter, u8 *pbuf); -+u32 rtw_append_probe_req_wfd_ie(_adapter *adapter, u8 *pbuf); -+u32 rtw_append_probe_resp_wfd_ie(_adapter *adapter, u8 *pbuf); -+u32 rtw_append_assoc_req_wfd_ie(_adapter *adapter, u8 *pbuf); -+u32 rtw_append_assoc_resp_wfd_ie(_adapter *adapter, u8 *pbuf); -+#endif /*CONFIG_WFD */ -+ -+void rtw_xframe_chk_wfd_ie(struct xmit_frame *xframe); -+ -+u32 process_probe_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+u32 process_assoc_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len, struct sta_info *psta); -+u32 process_p2p_devdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+u32 process_p2p_devdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+u8 process_p2p_provdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+u8 process_p2p_provdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe); -+u8 process_p2p_group_negotation_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+u8 process_p2p_group_negotation_resp(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+u8 process_p2p_group_negotation_confirm(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+u8 process_p2p_presence_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+int process_p2p_cross_connect_ie(PADAPTER padapter, u8 *IEs, u32 IELength); -+ -+s32 p2p_protocol_wk_hdl(_adapter *padapter, int intCmdType, u8 *buf); -+ -+#ifdef CONFIG_P2P_PS -+void process_p2p_ps_ie(PADAPTER padapter, u8 *IEs, u32 IELength); -+void p2p_ps_wk_hdl(_adapter *padapter, u8 p2p_ps_state); -+u8 p2p_ps_wk_cmd(_adapter *padapter, u8 p2p_ps_state, u8 enqueue); -+#endif /* CONFIG_P2P_PS */ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+void rtw_init_cfg80211_wifidirect_info(_adapter *padapter); -+int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+void reset_global_wifidirect_info(_adapter *padapter); -+void rtw_init_wifidirect_timers(_adapter *padapter); -+void rtw_init_wifidirect_addrs(_adapter *padapter, u8 *dev_addr, u8 *iface_addr); -+void init_wifidirect_info(_adapter *padapter, enum P2P_ROLE role); -+int rtw_p2p_enable(_adapter *padapter, enum P2P_ROLE role); -+ -+static inline void _rtw_p2p_set_state(struct wifidirect_info *wdinfo, enum P2P_STATE state) -+{ -+ if (wdinfo->p2p_state != state) { -+ /* wdinfo->pre_p2p_state = wdinfo->p2p_state; */ -+ wdinfo->p2p_state = state; -+ } -+} -+static inline void _rtw_p2p_set_pre_state(struct wifidirect_info *wdinfo, enum P2P_STATE state) -+{ -+ if (wdinfo->pre_p2p_state != state) -+ wdinfo->pre_p2p_state = state; -+} -+#if 0 -+static inline void _rtw_p2p_restore_state(struct wifidirect_info *wdinfo) -+{ -+ if (wdinfo->pre_p2p_state != -1) { -+ wdinfo->p2p_state = wdinfo->pre_p2p_state; -+ wdinfo->pre_p2p_state = -1; -+ } -+} -+#endif -+static inline void _rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role) -+{ -+ if (wdinfo->role != role) -+ wdinfo->role = role; -+} -+static inline int _rtw_p2p_state(struct wifidirect_info *wdinfo) -+{ -+ return wdinfo->p2p_state; -+} -+static inline int _rtw_p2p_pre_state(struct wifidirect_info *wdinfo) -+{ -+ return wdinfo->pre_p2p_state; -+} -+static inline int _rtw_p2p_role(struct wifidirect_info *wdinfo) -+{ -+ return wdinfo->role; -+} -+static inline bool _rtw_p2p_chk_state(struct wifidirect_info *wdinfo, enum P2P_STATE state) -+{ -+ return wdinfo->p2p_state == state; -+} -+static inline bool _rtw_p2p_chk_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role) -+{ -+ return wdinfo->role == role; -+} -+ -+#ifdef CONFIG_DBG_P2P -+void dbg_rtw_p2p_set_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line); -+void dbg_rtw_p2p_set_pre_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line); -+/* void dbg_rtw_p2p_restore_state(struct wifidirect_info *wdinfo, const char *caller, int line); */ -+void dbg_rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role, const char *caller, int line); -+#define rtw_p2p_set_state(wdinfo, state) dbg_rtw_p2p_set_state(wdinfo, state, __FUNCTION__, __LINE__) -+#define rtw_p2p_set_pre_state(wdinfo, state) dbg_rtw_p2p_set_pre_state(wdinfo, state, __FUNCTION__, __LINE__) -+#define rtw_p2p_set_role(wdinfo, role) dbg_rtw_p2p_set_role(wdinfo, role, __FUNCTION__, __LINE__) -+/* #define rtw_p2p_restore_state(wdinfo) dbg_rtw_p2p_restore_state(wdinfo, __FUNCTION__, __LINE__) */ -+#else /* CONFIG_DBG_P2P */ -+#define rtw_p2p_set_state(wdinfo, state) _rtw_p2p_set_state(wdinfo, state) -+#define rtw_p2p_set_pre_state(wdinfo, state) _rtw_p2p_set_pre_state(wdinfo, state) -+#define rtw_p2p_set_role(wdinfo, role) _rtw_p2p_set_role(wdinfo, role) -+/* #define rtw_p2p_restore_state(wdinfo) _rtw_p2p_restore_state(wdinfo) */ -+#endif /* CONFIG_DBG_P2P */ -+ -+#define rtw_p2p_state(wdinfo) _rtw_p2p_state(wdinfo) -+#define rtw_p2p_pre_state(wdinfo) _rtw_p2p_pre_state(wdinfo) -+#define rtw_p2p_role(wdinfo) _rtw_p2p_role(wdinfo) -+#define rtw_p2p_chk_state(wdinfo, state) _rtw_p2p_chk_state(wdinfo, state) -+#define rtw_p2p_chk_role(wdinfo, role) _rtw_p2p_chk_role(wdinfo, role) -+ -+#define rtw_p2p_findphase_ex_set(wdinfo, value) \ -+ (wdinfo)->find_phase_state_exchange_cnt = (value) -+ -+#ifdef CONFIG_P2P -+/* is this find phase exchange for social channel scan? */ -+#define rtw_p2p_findphase_ex_is_social(wdinfo) \ -+ (wdinfo)->find_phase_state_exchange_cnt >= P2P_FINDPHASE_EX_SOCIAL_FIRST -+ -+/* should we need find phase exchange anymore? */ -+#define rtw_p2p_findphase_ex_is_needed(wdinfo) \ -+ ((wdinfo)->find_phase_state_exchange_cnt < P2P_FINDPHASE_EX_MAX && \ -+ (wdinfo)->find_phase_state_exchange_cnt != P2P_FINDPHASE_EX_NONE && \ -+ !(wdinfo)->rx_invitereq_info.scan_op_ch_only && \ -+ !(wdinfo)->p2p_info.scan_op_ch_only) -+#else -+#define rtw_p2p_findphase_ex_is_social(wdinfo) 0 -+#define rtw_p2p_findphase_ex_is_needed(wdinfo) 0 -+#endif /* CONFIG_P2P */ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_pwrctrl.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_pwrctrl.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_pwrctrl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_pwrctrl.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,556 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_PWRCTRL_H_ -+#define __RTW_PWRCTRL_H_ -+ -+ -+#define FW_PWR0 0 -+#define FW_PWR1 1 -+#define FW_PWR2 2 -+#define FW_PWR3 3 -+ -+ -+#define HW_PWR0 7 -+#define HW_PWR1 6 -+#define HW_PWR2 2 -+#define HW_PWR3 0 -+#define HW_PWR4 8 -+ -+#define FW_PWRMSK 0x7 -+ -+ -+#define XMIT_ALIVE BIT(0) -+#define RECV_ALIVE BIT(1) -+#define CMD_ALIVE BIT(2) -+#define EVT_ALIVE BIT(3) -+#ifdef CONFIG_BT_COEXIST -+#define BTCOEX_ALIVE BIT(4) -+#endif /* CONFIG_BT_COEXIST */ -+ -+#ifdef CONFIG_WOWLAN -+#ifdef CONFIG_DEFAULT_PATTERNS_EN -+ #ifdef CONFIG_PLATFORM_ANDROID_INTEL_X86 -+ /* TCP/ICMP/UDP multicast with specific IP addr */ -+ #define DEFAULT_PATTERN_NUM 3 -+ #else -+ /* TCP/ICMP */ -+ #define DEFAULT_PATTERN_NUM 2 -+ #endif -+#else -+ #define DEFAULT_PATTERN_NUM 0 -+#endif /*CONFIG_DEFAULT_PATTERNS_EN*/ -+ -+#define MAX_WKFM_NUM 16 /* Frame Mask Cam number for pattern match */ -+#define MAX_WKFM_SIZE 16 /* (16 bytes for WKFM bit mask, 16*8 = 128 bits) */ -+#define MAX_WKFM_PATTERN_SIZE 128 -+#define WKFMCAM_ADDR_NUM 6 -+#define WKFMCAM_SIZE 24 /* each entry need 6*4 bytes */ -+enum pattern_type { -+ PATTERN_BROADCAST = 0, -+ PATTERN_MULTICAST, -+ PATTERN_UNICAST, -+ PATTERN_VALID, -+ PATTERN_INVALID, -+}; -+ -+typedef struct rtl_priv_pattern { -+ int len; -+ char content[MAX_WKFM_PATTERN_SIZE]; -+ char mask[MAX_WKFM_SIZE]; -+} rtl_priv_pattern_t; -+ -+struct rtl_wow_pattern { -+ u16 crc; -+ u8 type; -+ u32 mask[4]; -+}; -+ -+struct aoac_report { -+ u8 iv[8]; -+ u8 replay_counter_eapol_key[8]; -+ u8 group_key[32]; -+ u8 key_index; -+ u8 scurity_type; -+}; -+#endif /* CONFIG_WOWLAN */ -+ -+enum Power_Mgnt { -+ PS_MODE_ACTIVE = 0 , -+ PS_MODE_MIN , -+ PS_MODE_MAX , -+ PS_MODE_DTIM , /* PS_MODE_SELF_DEFINED */ -+ PS_MODE_VOIP , -+ PS_MODE_UAPSD_WMM , -+ PS_MODE_UAPSD , -+ PS_MODE_IBSS , -+ PS_MODE_WWLAN , -+ PM_Radio_Off , -+ PM_Card_Disable , -+ PS_MODE_NUM, -+}; -+ -+#ifdef CONFIG_PNO_SUPPORT -+#define MAX_PNO_LIST_COUNT 16 -+#define MAX_SCAN_LIST_COUNT 14 /* 2.4G only */ -+#define MAX_HIDDEN_AP 8 /* 8 hidden AP */ -+#endif -+ -+/* -+ BIT[2:0] = HW state -+ BIT[3] = Protocol PS state, 0: register active state , 1: register sleep state -+ BIT[4] = sub-state -+*/ -+ -+#define PS_DPS BIT(0) -+#define PS_LCLK (PS_DPS) -+#define PS_RF_OFF BIT(1) -+#define PS_ALL_ON BIT(2) -+#define PS_ST_ACTIVE BIT(3) -+ -+#define PS_ISR_ENABLE BIT(4) -+#define PS_IMR_ENABLE BIT(5) -+#define PS_ACK BIT(6) -+#define PS_TOGGLE BIT(7) -+ -+#define PS_STATE_MASK (0x0F) -+#define PS_STATE_HW_MASK (0x07) -+#define PS_SEQ_MASK (0xc0) -+ -+#define PS_STATE(x) (PS_STATE_MASK & (x)) -+#define PS_STATE_HW(x) (PS_STATE_HW_MASK & (x)) -+#define PS_SEQ(x) (PS_SEQ_MASK & (x)) -+ -+#define PS_STATE_S0 (PS_DPS) -+#define PS_STATE_S1 (PS_LCLK) -+#define PS_STATE_S2 (PS_RF_OFF) -+#define PS_STATE_S3 (PS_ALL_ON) -+#define PS_STATE_S4 ((PS_ST_ACTIVE) | (PS_ALL_ON)) -+ -+ -+#define PS_IS_RF_ON(x) ((x) & (PS_ALL_ON)) -+#define PS_IS_ACTIVE(x) ((x) & (PS_ST_ACTIVE)) -+#define CLR_PS_STATE(x) ((x) = ((x) & (0xF0))) -+ -+ -+struct reportpwrstate_parm { -+ unsigned char mode; -+ unsigned char state; /* the CPWM value */ -+ unsigned short rsvd; -+}; -+ -+ -+typedef _sema _pwrlock; -+ -+ -+__inline static void _init_pwrlock(_pwrlock *plock) -+{ -+ _rtw_init_sema(plock, 1); -+} -+ -+__inline static void _free_pwrlock(_pwrlock *plock) -+{ -+ _rtw_free_sema(plock); -+} -+ -+ -+__inline static void _enter_pwrlock(_pwrlock *plock) -+{ -+ _rtw_down_sema(plock); -+} -+ -+ -+__inline static void _exit_pwrlock(_pwrlock *plock) -+{ -+ _rtw_up_sema(plock); -+} -+ -+#define LPS_DELAY_TIME 1*HZ /* 1 sec */ -+ -+#define EXE_PWR_NONE 0x01 -+#define EXE_PWR_IPS 0x02 -+#define EXE_PWR_LPS 0x04 -+ -+/* RF state. */ -+typedef enum _rt_rf_power_state { -+ rf_on, /* RF is on after RFSleep or RFOff */ -+ rf_sleep, /* 802.11 Power Save mode */ -+ rf_off, /* HW/SW Radio OFF or Inactive Power Save */ -+ /* =====Add the new RF state above this line===== */ -+ rf_max -+} rt_rf_power_state; -+ -+/* RF Off Level for IPS or HW/SW radio off */ -+#define RT_RF_OFF_LEVL_ASPM BIT(0) /* PCI ASPM */ -+#define RT_RF_OFF_LEVL_CLK_REQ BIT(1) /* PCI clock request */ -+#define RT_RF_OFF_LEVL_PCI_D3 BIT(2) /* PCI D3 mode */ -+#define RT_RF_OFF_LEVL_HALT_NIC BIT(3) /* NIC halt, re-initialize hw parameters */ -+#define RT_RF_OFF_LEVL_FREE_FW BIT(4) /* FW free, re-download the FW */ -+#define RT_RF_OFF_LEVL_FW_32K BIT(5) /* FW in 32k */ -+#define RT_RF_PS_LEVEL_ALWAYS_ASPM BIT(6) /* Always enable ASPM and Clock Req in initialization. */ -+#define RT_RF_LPS_DISALBE_2R BIT(30) /* When LPS is on, disable 2R if no packet is received or transmittd. */ -+#define RT_RF_LPS_LEVEL_ASPM BIT(31) /* LPS with ASPM */ -+ -+#define RT_IN_PS_LEVEL(ppsc, _PS_FLAG) ((ppsc->cur_ps_level & _PS_FLAG) ? _TRUE : _FALSE) -+#define RT_CLEAR_PS_LEVEL(ppsc, _PS_FLAG) (ppsc->cur_ps_level &= (~(_PS_FLAG))) -+#define RT_SET_PS_LEVEL(ppsc, _PS_FLAG) (ppsc->cur_ps_level |= _PS_FLAG) -+ -+/* ASPM OSC Control bit, added by Roger, 2013.03.29. */ -+#define RT_PCI_ASPM_OSC_IGNORE 0 /* PCI ASPM ignore OSC control in default */ -+#define RT_PCI_ASPM_OSC_ENABLE BIT0 /* PCI ASPM controlled by OS according to ACPI Spec 5.0 */ -+#define RT_PCI_ASPM_OSC_DISABLE BIT1 /* PCI ASPM controlled by driver or BIOS, i.e., force enable ASPM */ -+ -+ -+enum _PS_BBRegBackup_ { -+ PSBBREG_RF0 = 0, -+ PSBBREG_RF1, -+ PSBBREG_RF2, -+ PSBBREG_AFE0, -+ PSBBREG_TOTALCNT -+}; -+ -+enum { /* for ips_mode */ -+ IPS_NONE = 0, -+ IPS_NORMAL, -+ IPS_LEVEL_2, -+ IPS_NUM -+}; -+ -+/* Design for pwrctrl_priv.ips_deny, 32 bits for 32 reasons at most */ -+typedef enum _PS_DENY_REASON { -+ PS_DENY_DRV_INITIAL = 0, -+ PS_DENY_SCAN, -+ PS_DENY_JOIN, -+ PS_DENY_DISCONNECT, -+ PS_DENY_SUSPEND, -+ PS_DENY_IOCTL, -+ PS_DENY_MGNT_TX, -+ PS_DENY_DRV_REMOVE = 30, -+ PS_DENY_OTHERS = 31 -+} PS_DENY_REASON; -+ -+#ifdef CONFIG_PNO_SUPPORT -+typedef struct pno_nlo_info { -+ u32 fast_scan_period; /* Fast scan period */ -+ u8 ssid_num; /* number of entry */ -+ u8 hidden_ssid_num; -+ u32 slow_scan_period; /* slow scan period */ -+ u32 fast_scan_iterations; /* Fast scan iterations */ -+ u8 ssid_length[MAX_PNO_LIST_COUNT]; /* SSID Length Array */ -+ u8 ssid_cipher_info[MAX_PNO_LIST_COUNT]; /* Cipher information for security */ -+ u8 ssid_channel_info[MAX_PNO_LIST_COUNT]; /* channel information */ -+ u8 loc_probe_req[MAX_HIDDEN_AP]; /* loc_probeReq */ -+} pno_nlo_info_t; -+ -+typedef struct pno_ssid { -+ u32 SSID_len; -+ u8 SSID[32]; -+} pno_ssid_t; -+ -+typedef struct pno_ssid_list { -+ pno_ssid_t node[MAX_PNO_LIST_COUNT]; -+} pno_ssid_list_t; -+ -+typedef struct pno_scan_channel_info { -+ u8 channel; -+ u8 tx_power; -+ u8 timeout; -+ u8 active; /* set 1 means active scan, or pasivite scan. */ -+} pno_scan_channel_info_t; -+ -+typedef struct pno_scan_info { -+ u8 enableRFE; /* Enable RFE */ -+ u8 period_scan_time; /* exclusive with fast_scan_period and slow_scan_period */ -+ u8 periodScan; /* exclusive with fast_scan_period and slow_scan_period */ -+ u8 orig_80_offset; /* original channel 80 offset */ -+ u8 orig_40_offset; /* original channel 40 offset */ -+ u8 orig_bw; /* original bandwidth */ -+ u8 orig_ch; /* original channel */ -+ u8 channel_num; /* number of channel */ -+ u64 rfe_type; /* rfe_type && 0x00000000000000ff */ -+ pno_scan_channel_info_t ssid_channel_info[MAX_SCAN_LIST_COUNT]; -+} pno_scan_info_t; -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+#ifdef CONFIG_LPS_POFF -+/* Driver context for LPS 32K Close IO Power */ -+typedef struct lps_poff_info { -+ bool bEn; -+ u8 *pStaticFile; -+ u8 *pDynamicFile; -+ u32 ConfFileOffset; -+ u32 tx_bndy_static; -+ u32 tx_bndy_dynamic; -+ u16 ConfLenForPTK; -+ u16 ConfLenForGTK; -+ ATOMIC_T bEnterPOFF; -+ ATOMIC_T bTxBoundInProgress; -+ ATOMIC_T bSetPOFFParm; -+} lps_poff_info_t; -+#endif /*CONFIG_LPS_POFF*/ -+ -+struct pwrctrl_priv { -+ _pwrlock lock; -+ _pwrlock check_32k_lock; -+ volatile u8 rpwm; /* requested power state for fw */ -+ volatile u8 cpwm; /* fw current power state. updated when 1. read from HCPWM 2. driver lowers power level */ -+ volatile u8 tog; /* toggling */ -+ volatile u8 cpwm_tog; /* toggling */ -+ -+ u8 pwr_mode; -+ u8 smart_ps; -+ u8 bcn_ant_mode; -+ u8 dtim; -+ -+ u32 alives; -+ _workitem cpwm_event; -+#ifdef CONFIG_LPS_RPWM_TIMER -+ u8 brpwmtimeout; -+ _workitem rpwmtimeoutwi; -+ _timer pwr_rpwm_timer; -+#endif /* CONFIG_LPS_RPWM_TIMER */ -+ u8 bpower_saving; /* for LPS/IPS */ -+ -+ u8 b_hw_radio_off; -+ u8 reg_rfoff; -+ u8 reg_pdnmode; /* powerdown mode */ -+ u32 rfoff_reason; -+ -+ /* RF OFF Level */ -+ u32 cur_ps_level; -+ u32 reg_rfps_level; -+ -+ uint ips_enter_cnts; -+ uint ips_leave_cnts; -+ uint lps_enter_cnts; -+ uint lps_leave_cnts; -+ -+ u8 ips_mode; -+ u8 ips_org_mode; -+ u8 ips_mode_req; /* used to accept the mode setting request, will update to ipsmode later */ -+ uint bips_processing; -+ u32 ips_deny_time; /* will deny IPS when system time is smaller than this */ -+ u8 pre_ips_type;/* 0: default flow, 1: carddisbale flow */ -+ -+ /* ps_deny: if 0, power save is free to go; otherwise deny all kinds of power save. */ -+ /* Use PS_DENY_REASON to decide reason. */ -+ /* Don't access this variable directly without control function, */ -+ /* and this variable should be protected by lock. */ -+ u32 ps_deny; -+ -+ u8 ps_processing; /* temporarily used to mark whether in rtw_ps_processor */ -+ -+ u8 fw_psmode_iface_id; -+ u8 bLeisurePs; -+ u8 LpsIdleCount; -+ u8 power_mgnt; -+ u8 org_power_mgnt; -+ u8 bFwCurrentInPSMode; -+ u32 DelayLPSLastTimeStamp; -+ s32 pnp_current_pwr_state; -+ u8 pnp_bstop_trx; -+ -+ -+ u8 bInternalAutoSuspend; -+ u8 bInSuspend; -+#ifdef CONFIG_BT_COEXIST -+ u8 bAutoResume; -+ u8 autopm_cnt; -+#endif -+ u8 bSupportRemoteWakeup; -+ u8 wowlan_wake_reason; -+ u8 wowlan_last_wake_reason; -+ u8 wowlan_ap_mode; -+ u8 wowlan_mode; -+ u8 wowlan_p2p_mode; -+ u8 wowlan_pno_enable; -+#ifdef CONFIG_GPIO_WAKEUP -+ u8 is_high_active; -+#endif /* CONFIG_GPIO_WAKEUP */ -+#ifdef CONFIG_WOWLAN -+ u8 wowlan_txpause_status; -+ u8 wowlan_pattern_idx; -+ u8 wowlan_in_resume; -+ u64 wowlan_fw_iv; -+ struct rtl_priv_pattern patterns[MAX_WKFM_NUM]; -+ struct aoac_report wowlan_aoac_rpt; -+ u8 wowlan_aoac_rpt_loc; -+#ifdef CONFIG_PNO_SUPPORT -+ u8 pno_inited; -+ pno_nlo_info_t *pnlo_info; -+ pno_scan_info_t *pscan_info; -+ pno_ssid_list_t *pno_ssid_list; -+#endif /* CONFIG_PNO_SUPPORT */ -+#endif /* CONFIG_WOWLAN */ -+ _timer pwr_state_check_timer; -+ int pwr_state_check_interval; -+ u8 pwr_state_check_cnts; -+ -+ int ps_flag; /* used by autosuspend */ -+ -+ rt_rf_power_state rf_pwrstate;/* cur power state, only for IPS */ -+ /* rt_rf_power_state current_rfpwrstate; */ -+ rt_rf_power_state change_rfpwrstate; -+ -+ u8 bHWPowerdown; /* power down mode selection. 0:radio off, 1:power down */ -+ u8 bHWPwrPindetect; /* come from registrypriv.hwpwrp_detect. enable power down function. 0:disable, 1:enable */ -+ u8 bkeepfwalive; -+ u8 brfoffbyhw; -+ unsigned long PS_BBRegBackup[PSBBREG_TOTALCNT]; -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+ struct workqueue_struct *rtw_workqueue; -+ _workitem resume_work; -+#endif -+ -+#ifdef CONFIG_HAS_EARLYSUSPEND -+ struct early_suspend early_suspend; -+ u8 do_late_resume; -+#endif /* CONFIG_HAS_EARLYSUSPEND */ -+ -+#ifdef CONFIG_ANDROID_POWER -+ android_early_suspend_t early_suspend; -+ u8 do_late_resume; -+#endif -+ -+#ifdef CONFIG_INTEL_PROXIM -+ u8 stored_power_mgnt; -+#endif -+ -+#ifdef CONFIG_LPS_POFF -+ lps_poff_info_t *plps_poff_info; -+#endif -+ -+#ifdef CONFIG_LPS_PG -+ u8 lpspg_rsvd_page_locate; -+ u8 blpspg_info_up; -+#endif -+}; -+ -+#define rtw_get_ips_mode_req(pwrctl) \ -+ (pwrctl)->ips_mode_req -+ -+#define rtw_ips_mode_req(pwrctl, ips_mode) \ -+ (pwrctl)->ips_mode_req = (ips_mode) -+ -+#define RTW_PWR_STATE_CHK_INTERVAL 2000 -+ -+#define _rtw_set_pwr_state_check_timer(pwrctl, ms) \ -+ do { \ -+ /*RTW_INFO("%s _rtw_set_pwr_state_check_timer(%p, %d)\n", __FUNCTION__, (pwrctl), (ms));*/ \ -+ _set_timer(&(pwrctl)->pwr_state_check_timer, (ms)); \ -+ } while (0) -+ -+#define rtw_set_pwr_state_check_timer(pwrctl) \ -+ _rtw_set_pwr_state_check_timer((pwrctl), (pwrctl)->pwr_state_check_interval) -+ -+extern void rtw_init_pwrctrl_priv(_adapter *adapter); -+extern void rtw_free_pwrctrl_priv(_adapter *adapter); -+ -+#ifdef CONFIG_LPS_LCLK -+s32 rtw_register_task_alive(PADAPTER, u32 task); -+void rtw_unregister_task_alive(PADAPTER, u32 task); -+extern s32 rtw_register_tx_alive(PADAPTER padapter); -+extern void rtw_unregister_tx_alive(PADAPTER padapter); -+extern s32 rtw_register_rx_alive(PADAPTER padapter); -+extern void rtw_unregister_rx_alive(PADAPTER padapter); -+extern s32 rtw_register_cmd_alive(PADAPTER padapter); -+extern void rtw_unregister_cmd_alive(PADAPTER padapter); -+extern s32 rtw_register_evt_alive(PADAPTER padapter); -+extern void rtw_unregister_evt_alive(PADAPTER padapter); -+extern void cpwm_int_hdl(PADAPTER padapter, struct reportpwrstate_parm *preportpwrstate); -+extern void LPS_Leave_check(PADAPTER padapter); -+#endif -+ -+extern void LeaveAllPowerSaveMode(PADAPTER Adapter); -+extern void LeaveAllPowerSaveModeDirect(PADAPTER Adapter); -+#ifdef CONFIG_IPS -+void _ips_enter(_adapter *padapter); -+void ips_enter(_adapter *padapter); -+int _ips_leave(_adapter *padapter); -+int ips_leave(_adapter *padapter); -+#endif -+ -+void rtw_ps_processor(_adapter *padapter); -+ -+#ifdef CONFIG_AUTOSUSPEND -+int autoresume_enter(_adapter *padapter); -+#endif -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+rt_rf_power_state RfOnOffDetect(IN PADAPTER pAdapter); -+#endif -+ -+ -+int rtw_fw_ps_state(PADAPTER padapter); -+ -+#ifdef CONFIG_LPS -+s32 LPS_RF_ON_check(PADAPTER padapter, u32 delay_ms); -+void LPS_Enter(PADAPTER padapter, const char *msg); -+void LPS_Leave(PADAPTER padapter, const char *msg); -+void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets); -+void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode, const char *msg); -+void rtw_set_fw_in_ips_mode(PADAPTER padapter, u8 enable); -+void rtw_set_rpwm(_adapter *padapter, u8 val8); -+#endif -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+void rtw_resume_in_workqueue(struct pwrctrl_priv *pwrpriv); -+#endif /* CONFIG_RESUME_IN_WORKQUEUE */ -+ -+#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) -+bool rtw_is_earlysuspend_registered(struct pwrctrl_priv *pwrpriv); -+bool rtw_is_do_late_resume(struct pwrctrl_priv *pwrpriv); -+void rtw_set_do_late_resume(struct pwrctrl_priv *pwrpriv, bool enable); -+void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv); -+void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv); -+#else -+#define rtw_is_earlysuspend_registered(pwrpriv) _FALSE -+#define rtw_is_do_late_resume(pwrpriv) _FALSE -+#define rtw_set_do_late_resume(pwrpriv, enable) do {} while (0) -+#define rtw_register_early_suspend(pwrpriv) do {} while (0) -+#define rtw_unregister_early_suspend(pwrpriv) do {} while (0) -+#endif /* CONFIG_HAS_EARLYSUSPEND || CONFIG_ANDROID_POWER */ -+ -+u8 rtw_interface_ps_func(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val); -+void rtw_set_ips_deny(_adapter *padapter, u32 ms); -+int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller); -+#define rtw_pwr_wakeup(adapter) _rtw_pwr_wakeup(adapter, RTW_PWR_STATE_CHK_INTERVAL, __FUNCTION__) -+#define rtw_pwr_wakeup_ex(adapter, ips_deffer_ms) _rtw_pwr_wakeup(adapter, ips_deffer_ms, __FUNCTION__) -+int rtw_pm_set_ips(_adapter *padapter, u8 mode); -+int rtw_pm_set_lps(_adapter *padapter, u8 mode); -+ -+void rtw_ps_deny(PADAPTER padapter, PS_DENY_REASON reason); -+void rtw_ps_deny_cancel(PADAPTER padapter, PS_DENY_REASON reason); -+u32 rtw_ps_deny_get(PADAPTER padapter); -+ -+#if defined(CONFIG_WOWLAN) -+void rtw_get_current_ip_address(PADAPTER padapter, u8 *pcurrentip); -+void rtw_get_sec_iv(PADAPTER padapter, u8 *pcur_dot11txpn, u8 *StaAddr); -+bool rtw_check_pattern_valid(u8 *input, u8 len); -+bool rtw_write_to_frame_mask(_adapter *adapter, u8 idx, -+ struct rtl_wow_pattern *content); -+ -+bool rtw_read_from_frame_mask(_adapter *adapter, u8 idx); -+bool rtw_wowlan_parser_pattern_cmd(u8 *input, char *pattern, -+ int *pattern_len, char *bit_mask); -+u8 rtw_set_default_pattern(_adapter *adapter); -+void rtw_dump_priv_pattern(_adapter *adapter, u8 idx); -+void rtw_clean_pattern(_adapter *adapter); -+#endif /* CONFIG_WOWLAN */ -+#endif /* __RTL871X_PWRCTRL_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_qos.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_qos.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_qos.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_qos.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,34 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef _RTW_QOS_H_ -+#define _RTW_QOS_H_ -+ -+ -+ -+struct qos_priv { -+ -+ unsigned int qos_option; /* bit mask option: u-apsd, s-apsd, ts, block ack... */ -+ -+}; -+ -+ -+#endif /* _RTL871X_QOS_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_recv.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_recv.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_recv.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,893 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTW_RECV_H_ -+#define _RTW_RECV_H_ -+ -+#ifdef PLATFORM_OS_XP -+ #ifdef CONFIG_SDIO_HCI -+ #define NR_RECVBUFF 1024/* 512 */ /* 128 */ -+ #else -+ #define NR_RECVBUFF (16) -+ #endif -+#elif defined(PLATFORM_OS_CE) -+ #ifdef CONFIG_SDIO_HCI -+ #define NR_RECVBUFF (128) -+ #else -+ #define NR_RECVBUFF (4) -+ #endif -+#else /* PLATFORM_LINUX /PLATFORM_BSD */ -+ -+ #ifdef CONFIG_SINGLE_RECV_BUF -+ #define NR_RECVBUFF (1) -+ #else -+ #if defined(CONFIG_GSPI_HCI) -+ #define NR_RECVBUFF (32) -+ #elif defined(CONFIG_SDIO_HCI) -+ #define NR_RECVBUFF (8) -+ #else -+ #define NR_RECVBUFF (8) -+ #endif -+ #endif /* CONFIG_SINGLE_RECV_BUF */ -+ #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ #define NR_PREALLOC_RECV_SKB (rtw_rtkm_get_nr_recv_skb()>>1) -+ #else /*!CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ #define NR_PREALLOC_RECV_SKB 8 -+ #endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ -+ -+ #ifdef CONFIG_RTW_NAPI -+ #define RTL_NAPI_WEIGHT (32) -+ #endif -+#endif -+ -+#define NR_RECVFRAME 256 -+ -+#define RXFRAME_ALIGN 8 -+#define RXFRAME_ALIGN_SZ (1<network.PhyInfo.SignalStrength); */ -+ struct rx_raw_rssi raw_rssi_info; -+ /* s8 rxpwdb; */ -+ s16 noise; -+ /* int RxSNRdB[2]; */ -+ /* s8 RxRssi[2]; */ -+ /* int FalseAlmCnt_all; */ -+ -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ _timer signal_stat_timer; -+ u32 signal_stat_sampling_interval; -+ /* u32 signal_stat_converging_constant; */ -+ struct signal_stat signal_qual_data; -+ struct signal_stat signal_strength_data; -+#else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ struct smooth_rssi_data signal_qual_data; -+ struct smooth_rssi_data signal_strength_data; -+#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ u16 sink_udpport, pre_rtp_rxseq, cur_rtp_rxseq; -+ -+ BOOLEAN store_law_data_flag; -+}; -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+#define rtw_set_signal_stat_timer(recvpriv) _set_timer(&(recvpriv)->signal_stat_timer, (recvpriv)->signal_stat_sampling_interval) -+#endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ -+ -+struct sta_recv_priv { -+ -+ _lock lock; -+ sint option; -+ -+ /* _queue blk_strms[MAX_RX_NUMBLKS]; */ -+ _queue defrag_q; /* keeping the fragment frame until defrag */ -+ -+ struct stainfo_rxcache rxcache; -+ -+ /* uint sta_rx_bytes; */ -+ /* uint sta_rx_pkts; */ -+ /* uint sta_rx_fail; */ -+ -+}; -+ -+ -+struct recv_buf { -+ _list list; -+ -+ _lock recvbuf_lock; -+ -+ u32 ref_cnt; -+ -+ PADAPTER adapter; -+ -+ u8 *pbuf; -+ u8 *pallocated_buf; -+ -+ u32 len; -+ u8 *phead; -+ u8 *pdata; -+ u8 *ptail; -+ u8 *pend; -+ -+#ifdef CONFIG_USB_HCI -+ -+#if defined(PLATFORM_OS_XP) || defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) -+ PURB purb; -+ dma_addr_t dma_transfer_addr; /* (in) dma addr for transfer_buffer */ -+ u32 alloc_sz; -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ PIRP pirp; -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ USB_TRANSFER usb_transfer_read_port; -+#endif -+ -+ u8 irp_pending; -+ int transfer_len; -+ -+#endif -+ -+#ifdef PLATFORM_LINUX -+ _pkt *pskb; -+#endif -+#ifdef PLATFORM_FREEBSD /* skb solution */ -+ struct sk_buff *pskb; -+#endif /* PLATFORM_FREEBSD */ /* skb solution */ -+}; -+ -+ -+/* -+ head -----> -+ -+ data -----> -+ -+ payload -+ -+ tail -----> -+ -+ -+ end -----> -+ -+ len = (unsigned int )(tail - data); -+ -+*/ -+struct recv_frame_hdr { -+ _list list; -+#ifndef CONFIG_BSD_RX_USE_MBUF -+ struct sk_buff *pkt; -+ struct sk_buff *pkt_newalloc; -+#else /* CONFIG_BSD_RX_USE_MBUF */ -+ _pkt *pkt; -+ _pkt *pkt_newalloc; -+#endif /* CONFIG_BSD_RX_USE_MBUF */ -+ -+ _adapter *adapter; -+ -+ u8 fragcnt; -+ -+ int frame_tag; -+ -+ struct rx_pkt_attrib attrib; -+ -+ uint len; -+ u8 *rx_head; -+ u8 *rx_data; -+ u8 *rx_tail; -+ u8 *rx_end; -+ -+ void *precvbuf; -+ -+ -+ /* */ -+ struct sta_info *psta; -+ -+ /* for A-MPDU Rx reordering buffer control */ -+ struct recv_reorder_ctrl *preorder_ctrl; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ u8 UserPriority; -+ u8 WapiTempPN[16]; -+ u8 WapiSrcAddr[6]; -+ u8 bWapiCheckPNInDecrypt; -+ u8 bIsWaiPacket; -+#endif -+ -+}; -+ -+ -+union recv_frame { -+ -+ union { -+ _list list; -+ struct recv_frame_hdr hdr; -+ uint mem[RECVFRAME_HDR_ALIGN >> 2]; -+ } u; -+ -+ /* uint mem[MAX_RXSZ>>2]; */ -+ -+}; -+ -+bool rtw_rframe_del_wfd_ie(union recv_frame *rframe, u8 ies_offset); -+ -+typedef enum _RX_PACKET_TYPE { -+ NORMAL_RX,/* Normal rx packet */ -+ TX_REPORT1,/* CCX */ -+ TX_REPORT2,/* TX RPT */ -+ HIS_REPORT,/* USB HISR RPT */ -+ C2H_PACKET -+} RX_PACKET_TYPE, *PRX_PACKET_TYPE; -+ -+extern union recv_frame *_rtw_alloc_recvframe(_queue *pfree_recv_queue); /* get a free recv_frame from pfree_recv_queue */ -+extern union recv_frame *rtw_alloc_recvframe(_queue *pfree_recv_queue); /* get a free recv_frame from pfree_recv_queue */ -+extern void rtw_init_recvframe(union recv_frame *precvframe , struct recv_priv *precvpriv); -+extern int rtw_free_recvframe(union recv_frame *precvframe, _queue *pfree_recv_queue); -+ -+#define rtw_dequeue_recvframe(queue) rtw_alloc_recvframe(queue) -+extern int _rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue); -+extern int rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue); -+ -+extern void rtw_free_recvframe_queue(_queue *pframequeue, _queue *pfree_recv_queue); -+u32 rtw_free_uc_swdec_pending_queue(_adapter *adapter); -+ -+sint rtw_enqueue_recvbuf_to_head(struct recv_buf *precvbuf, _queue *queue); -+sint rtw_enqueue_recvbuf(struct recv_buf *precvbuf, _queue *queue); -+struct recv_buf *rtw_dequeue_recvbuf(_queue *queue); -+ -+void rtw_reordering_ctrl_timeout_handler(void *pcontext); -+ -+void rx_query_phy_status(union recv_frame *rframe, u8 *phy_stat); -+int rtw_inc_and_chk_continual_no_rx_packet(struct sta_info *sta, int tid_index); -+void rtw_reset_continual_no_rx_packet(struct sta_info *sta, int tid_index); -+ -+__inline static u8 *get_rxmem(union recv_frame *precvframe) -+{ -+ /* always return rx_head... */ -+ if (precvframe == NULL) -+ return NULL; -+ -+ return precvframe->u.hdr.rx_head; -+} -+ -+__inline static u8 *get_rx_status(union recv_frame *precvframe) -+{ -+ -+ return get_rxmem(precvframe); -+ -+} -+ -+__inline static u8 *get_recvframe_data(union recv_frame *precvframe) -+{ -+ -+ /* alwasy return rx_data */ -+ if (precvframe == NULL) -+ return NULL; -+ -+ return precvframe->u.hdr.rx_data; -+ -+} -+ -+__inline static u8 *recvframe_push(union recv_frame *precvframe, sint sz) -+{ -+ /* append data before rx_data */ -+ -+ /* add data to the start of recv_frame -+ * -+ * This function extends the used data area of the recv_frame at the buffer -+ * start. rx_data must be still larger than rx_head, after pushing. -+ */ -+ -+ if (precvframe == NULL) -+ return NULL; -+ -+ -+ precvframe->u.hdr.rx_data -= sz ; -+ if (precvframe->u.hdr.rx_data < precvframe->u.hdr.rx_head) { -+ precvframe->u.hdr.rx_data += sz ; -+ return NULL; -+ } -+ -+ precvframe->u.hdr.len += sz; -+ -+ return precvframe->u.hdr.rx_data; -+ -+} -+ -+ -+__inline static u8 *recvframe_pull(union recv_frame *precvframe, sint sz) -+{ -+ /* rx_data += sz; move rx_data sz bytes hereafter */ -+ -+ /* used for extract sz bytes from rx_data, update rx_data and return the updated rx_data to the caller */ -+ -+ -+ if (precvframe == NULL) -+ return NULL; -+ -+ -+ precvframe->u.hdr.rx_data += sz; -+ -+ if (precvframe->u.hdr.rx_data > precvframe->u.hdr.rx_tail) { -+ precvframe->u.hdr.rx_data -= sz; -+ return NULL; -+ } -+ -+ precvframe->u.hdr.len -= sz; -+ -+ return precvframe->u.hdr.rx_data; -+ -+} -+ -+__inline static u8 *recvframe_put(union recv_frame *precvframe, sint sz) -+{ -+ /* rx_tai += sz; move rx_tail sz bytes hereafter */ -+ -+ /* used for append sz bytes from ptr to rx_tail, update rx_tail and return the updated rx_tail to the caller */ -+ /* after putting, rx_tail must be still larger than rx_end. */ -+ unsigned char *prev_rx_tail; -+ -+ /* RTW_INFO("recvframe_put: len=%d\n", sz); */ -+ -+ if (precvframe == NULL) -+ return NULL; -+ -+ prev_rx_tail = precvframe->u.hdr.rx_tail; -+ -+ precvframe->u.hdr.rx_tail += sz; -+ -+ if (precvframe->u.hdr.rx_tail > precvframe->u.hdr.rx_end) { -+ precvframe->u.hdr.rx_tail -= sz; -+ return NULL; -+ } -+ -+ precvframe->u.hdr.len += sz; -+ -+ return precvframe->u.hdr.rx_tail; -+ -+} -+ -+ -+ -+__inline static u8 *recvframe_pull_tail(union recv_frame *precvframe, sint sz) -+{ -+ /* rmv data from rx_tail (by yitsen) */ -+ -+ /* used for extract sz bytes from rx_end, update rx_end and return the updated rx_end to the caller */ -+ /* after pulling, rx_end must be still larger than rx_data. */ -+ -+ if (precvframe == NULL) -+ return NULL; -+ -+ precvframe->u.hdr.rx_tail -= sz; -+ -+ if (precvframe->u.hdr.rx_tail < precvframe->u.hdr.rx_data) { -+ precvframe->u.hdr.rx_tail += sz; -+ return NULL; -+ } -+ -+ precvframe->u.hdr.len -= sz; -+ -+ return precvframe->u.hdr.rx_tail; -+ -+} -+ -+ -+ -+__inline static _buffer *get_rxbuf_desc(union recv_frame *precvframe) -+{ -+ _buffer *buf_desc; -+ -+ if (precvframe == NULL) -+ return NULL; -+#ifdef PLATFORM_WINDOWS -+ NdisQueryPacket(precvframe->u.hdr.pkt, NULL, NULL, &buf_desc, NULL); -+#endif -+ -+ return buf_desc; -+} -+ -+ -+__inline static union recv_frame *rxmem_to_recvframe(u8 *rxmem) -+{ -+ /* due to the design of 2048 bytes alignment of recv_frame, we can reference the union recv_frame */ -+ /* from any given member of recv_frame. */ -+ /* rxmem indicates the any member/address in recv_frame */ -+ -+ return (union recv_frame *)(((SIZE_PTR)rxmem >> RXFRAME_ALIGN) << RXFRAME_ALIGN); -+ -+} -+ -+__inline static union recv_frame *pkt_to_recvframe(_pkt *pkt) -+{ -+ -+ u8 *buf_star; -+ union recv_frame *precv_frame; -+#ifdef PLATFORM_WINDOWS -+ _buffer *buf_desc; -+ uint len; -+ -+ NdisQueryPacket(pkt, NULL, NULL, &buf_desc, &len); -+ NdisQueryBufferSafe(buf_desc, &buf_star, &len, HighPagePriority); -+#endif -+ precv_frame = rxmem_to_recvframe((unsigned char *)buf_star); -+ -+ return precv_frame; -+} -+ -+__inline static u8 *pkt_to_recvmem(_pkt *pkt) -+{ -+ /* return the rx_head */ -+ -+ union recv_frame *precv_frame = pkt_to_recvframe(pkt); -+ -+ return precv_frame->u.hdr.rx_head; -+ -+} -+ -+__inline static u8 *pkt_to_recvdata(_pkt *pkt) -+{ -+ /* return the rx_data */ -+ -+ union recv_frame *precv_frame = pkt_to_recvframe(pkt); -+ -+ return precv_frame->u.hdr.rx_data; -+ -+} -+ -+ -+__inline static sint get_recvframe_len(union recv_frame *precvframe) -+{ -+ return precvframe->u.hdr.len; -+} -+ -+ -+__inline static s32 translate_percentage_to_dbm(u32 SignalStrengthIndex) -+{ -+ s32 SignalPower; /* in dBm. */ -+ -+#ifdef CONFIG_SIGNAL_SCALE_MAPPING -+ /* Translate to dBm (x=0.5y-95). */ -+ SignalPower = (s32)((SignalStrengthIndex + 1) >> 1); -+ SignalPower -= 95; -+#else -+ /* Translate to dBm (x=y-100) */ -+ SignalPower = SignalStrengthIndex - 100; -+#endif -+ -+ return SignalPower; -+} -+ -+ -+struct sta_info; -+ -+extern void _rtw_init_sta_recv_priv(struct sta_recv_priv *psta_recvpriv); -+ -+extern void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame); -+ -+s32 pre_recv_entry(union recv_frame *precvframe, u8 *pphy_status); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_rf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_rf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_rf.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,287 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_RF_H_ -+#define __RTW_RF_H_ -+ -+ -+#define OFDM_PHY 1 -+#define MIXED_PHY 2 -+#define CCK_PHY 3 -+ -+#define b_mode_rate_num 4 -+#define g_mode_rate_num 8 -+#define NumRates (13) -+ -+/* slot time for 11g */ -+#define SHORT_SLOT_TIME 9 -+#define NON_SHORT_SLOT_TIME 20 -+ -+#define RTL8711_RF_MAX_SENS 6 -+#define RTL8711_RF_DEF_SENS 4 -+ -+/* -+ * We now define the following channels as the max channels in each channel plan. -+ * 2G, total 14 chnls -+ * {1,2,3,4,5,6,7,8,9,10,11,12,13,14} -+ * 5G, total 25 chnls -+ * {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,144,149,153,157,161,165} -+ */ -+#define MAX_CHANNEL_NUM_2G 14 -+#define MAX_CHANNEL_NUM_5G 25 -+#define MAX_CHANNEL_NUM (MAX_CHANNEL_NUM_2G + MAX_CHANNEL_NUM_5G) -+ -+#define CENTER_CH_2G_40M_NUM 9 -+#define CENTER_CH_2G_NUM 14 -+#define CENTER_CH_5G_20M_NUM 28 /* 20M center channels */ -+#define CENTER_CH_5G_40M_NUM 14 /* 40M center channels */ -+#define CENTER_CH_5G_80M_NUM 7 /* 80M center channels */ -+#define CENTER_CH_5G_160M_NUM 3 /* 160M center channels */ -+#define CENTER_CH_5G_ALL_NUM (CENTER_CH_5G_20M_NUM + CENTER_CH_5G_40M_NUM + CENTER_CH_5G_80M_NUM) -+ -+extern u8 center_ch_2g[CENTER_CH_2G_NUM]; -+extern u8 center_ch_2g_40m[CENTER_CH_2G_40M_NUM]; -+ -+u8 center_chs_2g_num(u8 bw); -+u8 center_chs_2g(u8 bw, u8 id); -+ -+extern u8 center_ch_5g_20m[CENTER_CH_5G_20M_NUM]; -+extern u8 center_ch_5g_40m[CENTER_CH_5G_40M_NUM]; -+extern u8 center_ch_5g_20m_40m[CENTER_CH_5G_20M_NUM + CENTER_CH_5G_40M_NUM]; -+extern u8 center_ch_5g_80m[CENTER_CH_5G_80M_NUM]; -+extern u8 center_ch_5g_all[CENTER_CH_5G_ALL_NUM]; -+ -+u8 center_chs_5g_num(u8 bw); -+u8 center_chs_5g(u8 bw, u8 id); -+ -+u8 rtw_get_scch_by_cch_offset(u8 cch, u8 bw, u8 offset); -+ -+u8 rtw_get_op_chs_by_cch_bw(u8 cch, u8 bw, u8 **op_chs, u8 *op_ch_num); -+ -+u8 rtw_get_ch_group(u8 ch, u8 *group, u8 *cck_group); -+ -+/* #define NUM_REGULATORYS 21 */ -+#define NUM_REGULATORYS 1 -+ -+/* Country codes */ -+#define USA 0x555320 -+#define EUROPE 0x1 /* temp, should be provided later */ -+#define JAPAN 0x2 /* temp, should be provided later */ -+ -+struct regulatory_class { -+ u32 starting_freq; /* MHz, */ -+ u8 channel_set[MAX_CHANNEL_NUM]; -+ u8 channel_cck_power[MAX_CHANNEL_NUM];/* dbm */ -+ u8 channel_ofdm_power[MAX_CHANNEL_NUM];/* dbm */ -+ u8 txpower_limit; /* dbm */ -+ u8 channel_spacing; /* MHz */ -+ u8 modem; -+}; -+ -+typedef enum _CAPABILITY { -+ cESS = 0x0001, -+ cIBSS = 0x0002, -+ cPollable = 0x0004, -+ cPollReq = 0x0008, -+ cPrivacy = 0x0010, -+ cShortPreamble = 0x0020, -+ cPBCC = 0x0040, -+ cChannelAgility = 0x0080, -+ cSpectrumMgnt = 0x0100, -+ cQos = 0x0200, /* For HCCA, use with CF-Pollable and CF-PollReq */ -+ cShortSlotTime = 0x0400, -+ cAPSD = 0x0800, -+ cRM = 0x1000, /* RRM (Radio Request Measurement) */ -+ cDSSS_OFDM = 0x2000, -+ cDelayedBA = 0x4000, -+ cImmediateBA = 0x8000, -+} CAPABILITY, *PCAPABILITY; -+ -+enum _REG_PREAMBLE_MODE { -+ PREAMBLE_LONG = 1, -+ PREAMBLE_AUTO = 2, -+ PREAMBLE_SHORT = 3, -+}; -+ -+ -+enum _RTL8712_RF_MIMO_CONFIG_ { -+ RTL8712_RFCONFIG_1T = 0x10, -+ RTL8712_RFCONFIG_2T = 0x20, -+ RTL8712_RFCONFIG_1R = 0x01, -+ RTL8712_RFCONFIG_2R = 0x02, -+ RTL8712_RFCONFIG_1T1R = 0x11, -+ RTL8712_RFCONFIG_1T2R = 0x12, -+ RTL8712_RFCONFIG_TURBO = 0x92, -+ RTL8712_RFCONFIG_2T2R = 0x22 -+}; -+ -+typedef enum _RF_PATH { -+ RF_PATH_A = 0, -+ RF_PATH_B = 1, -+ RF_PATH_C = 2, -+ RF_PATH_D = 3, -+} RF_PATH, *PRF_PATH; -+ -+#define rf_path_char(path) (((path) >= RF_PATH_MAX) ? 'X' : 'A' + (path)) -+ -+/* Bandwidth Offset */ -+#define HAL_PRIME_CHNL_OFFSET_DONT_CARE 0 -+#define HAL_PRIME_CHNL_OFFSET_LOWER 1 -+#define HAL_PRIME_CHNL_OFFSET_UPPER 2 -+ -+typedef enum _BAND_TYPE { -+ BAND_ON_2_4G = 0, -+ BAND_ON_5G = 1, -+ BAND_ON_BOTH = 2, -+ BAND_MAX = 3, -+} BAND_TYPE, *PBAND_TYPE; -+ -+extern const char *const _band_str[]; -+#define band_str(band) (((band) >= BAND_MAX) ? _band_str[BAND_MAX] : _band_str[(band)]) -+ -+extern const u8 _band_to_band_cap[]; -+#define band_to_band_cap(band) (((band) >= BAND_MAX) ? _band_to_band_cap[BAND_MAX] : _band_to_band_cap[(band)]) -+ -+/* Represent Channel Width in HT Capabilities -+ * */ -+typedef enum _CHANNEL_WIDTH { -+ CHANNEL_WIDTH_20 = 0, -+ CHANNEL_WIDTH_40 = 1, -+ CHANNEL_WIDTH_80 = 2, -+ CHANNEL_WIDTH_160 = 3, -+ CHANNEL_WIDTH_80_80 = 4, -+ CHANNEL_WIDTH_MAX = 5, -+} CHANNEL_WIDTH, *PCHANNEL_WIDTH; -+ -+extern const char *const _ch_width_str[]; -+#define ch_width_str(bw) (((bw) >= CHANNEL_WIDTH_MAX) ? _ch_width_str[CHANNEL_WIDTH_MAX] : _ch_width_str[(bw)]) -+ -+extern const u8 _ch_width_to_bw_cap[]; -+#define ch_width_to_bw_cap(bw) (((bw) >= CHANNEL_WIDTH_MAX) ? _ch_width_to_bw_cap[CHANNEL_WIDTH_MAX] : _ch_width_to_bw_cap[(bw)]) -+ -+/* -+ * Represent Extention Channel Offset in HT Capabilities -+ * This is available only in 40Mhz mode. -+ * */ -+typedef enum _EXTCHNL_OFFSET { -+ EXTCHNL_OFFSET_NO_EXT = 0, -+ EXTCHNL_OFFSET_UPPER = 1, -+ EXTCHNL_OFFSET_NO_DEF = 2, -+ EXTCHNL_OFFSET_LOWER = 3, -+} EXTCHNL_OFFSET, *PEXTCHNL_OFFSET; -+ -+typedef enum _VHT_DATA_SC { -+ VHT_DATA_SC_DONOT_CARE = 0, -+ VHT_DATA_SC_20_UPPER_OF_80MHZ = 1, -+ VHT_DATA_SC_20_LOWER_OF_80MHZ = 2, -+ VHT_DATA_SC_20_UPPERST_OF_80MHZ = 3, -+ VHT_DATA_SC_20_LOWEST_OF_80MHZ = 4, -+ VHT_DATA_SC_20_RECV1 = 5, -+ VHT_DATA_SC_20_RECV2 = 6, -+ VHT_DATA_SC_20_RECV3 = 7, -+ VHT_DATA_SC_20_RECV4 = 8, -+ VHT_DATA_SC_40_UPPER_OF_80MHZ = 9, -+ VHT_DATA_SC_40_LOWER_OF_80MHZ = 10, -+} VHT_DATA_SC, *PVHT_DATA_SC_E; -+ -+typedef enum _PROTECTION_MODE { -+ PROTECTION_MODE_AUTO = 0, -+ PROTECTION_MODE_FORCE_ENABLE = 1, -+ PROTECTION_MODE_FORCE_DISABLE = 2, -+} PROTECTION_MODE, *PPROTECTION_MODE; -+ -+typedef enum _RT_RF_TYPE_DEFINITION { -+ RF_1T2R = 0, -+ RF_2T4R = 1, -+ RF_2T2R = 2, -+ RF_1T1R = 3, -+ RF_2T2R_GREEN = 4, -+ RF_2T3R = 5, -+ RF_3T3R = 6, -+ RF_3T4R = 7, -+ RF_4T4R = 8, -+ -+ RF_MAX_TYPE = 0xF, /* u1Byte */ -+} RT_RF_TYPE_DEF_E; -+ -+int rtw_ch2freq(int chan); -+int rtw_freq2ch(int freq); -+bool rtw_chbw_to_freq_range(u8 ch, u8 bw, u8 offset, u32 *hi, u32 *lo); -+ -+#define RTW_MODULE_RTL8821AE_HMC_M2 BIT0 /* RTL8821AE(HMC + M.2) */ -+#define RTW_MODULE_RTL8821AU BIT1 /* RTL8821AU */ -+#define RTW_MODULE_RTL8812AENF_NGFF BIT2 /* RTL8812AENF(8812AE+8761)_NGFF */ -+#define RTW_MODULE_RTL8812AEBT_HMC BIT3 /* RTL8812AEBT(8812AE+8761)_HMC */ -+#define RTW_MODULE_RTL8188EE_HMC_M2 BIT4 /* RTL8188EE(HMC + M.2) */ -+#define RTW_MODULE_RTL8723BE_HMC_M2 BIT5 /* RTL8723BE(HMC + M.2) */ -+#define RTW_MODULE_RTL8723BS_NGFF1216 BIT6 /* RTL8723BS(NGFF1216) */ -+#define RTW_MODULE_RTL8192EEBT_HMC_M2 BIT7 /* RTL8192EEBT(8192EE+8761AU)_(HMC + M.2) */ -+ -+#define IS_ALPHA2_NO_SPECIFIED(_alpha2) ((*((u16 *)(_alpha2))) == 0xFFFF) -+ -+struct country_chplan { -+ char alpha2[2]; -+ u8 chplan; -+#ifdef CONFIG_80211AC_VHT -+ u8 en_11ac; -+#endif -+#if RTW_DEF_MODULE_REGULATORY_CERT -+ u8 def_module_flags; /* RTW_MODULE_RTLXXX */ -+#endif -+}; -+ -+#ifdef CONFIG_80211AC_VHT -+#define COUNTRY_CHPLAN_EN_11AC(_ent) ((_ent)->en_11ac) -+#else -+#define COUNTRY_CHPLAN_EN_11AC(_ent) 0 -+#endif -+ -+#if RTW_DEF_MODULE_REGULATORY_CERT -+#define COUNTRY_CHPLAN_DEF_MODULE_FALGS(_ent) ((_ent)->def_module_flags) -+#else -+#define COUNTRY_CHPLAN_DEF_MODULE_FALGS(_ent) 0 -+#endif -+ -+const struct country_chplan *rtw_get_chplan_from_country(const char *country_code); -+ -+#define BB_GAIN_2G 0 -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+#define BB_GAIN_5GLB1 1 -+#define BB_GAIN_5GLB2 2 -+#define BB_GAIN_5GMB1 3 -+#define BB_GAIN_5GMB2 4 -+#define BB_GAIN_5GHB 5 -+#endif -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+#define BB_GAIN_NUM 6 -+#else -+#define BB_GAIN_NUM 1 -+#endif -+ -+int rtw_ch_to_bb_gain_sel(int ch); -+void rtw_rf_set_tx_gain_offset(_adapter *adapter, u8 path, s8 offset); -+void rtw_rf_apply_tx_gain_offset(_adapter *adapter, u8 ch); -+ -+bool rtw_is_dfs_range(u32 hi, u32 lo); -+bool rtw_is_dfs_ch(u8 ch, u8 bw, u8 offset); -+bool rtw_is_long_cac_range(u32 hi, u32 lo, u8 dfs_region); -+bool rtw_is_long_cac_ch(u8 ch, u8 bw, u8 offset, u8 dfs_region); -+ -+#endif /* _RTL8711_RF_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_sdio.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_sdio.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_sdio.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_sdio.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ ******************************************************************************/ -+#ifndef _RTW_SDIO_H_ -+#define _RTW_SDIO_H_ -+ -+#include /* struct dvobj_priv and etc. */ -+ -+u8 rtw_sdio_read_cmd52(struct dvobj_priv *, u32 addr, void *buf, size_t len); -+u8 rtw_sdio_read_cmd53(struct dvobj_priv *, u32 addr, void *buf, size_t len); -+u8 rtw_sdio_write_cmd52(struct dvobj_priv *, u32 addr, void *buf, size_t len); -+u8 rtw_sdio_write_cmd53(struct dvobj_priv *, u32 addr, void *buf, size_t len); -+u8 rtw_sdio_f0_read(struct dvobj_priv *, u32 addr, void *buf, size_t len); -+ -+#endif /* _RTW_SDIO_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_security.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_security.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_security.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_security.h 2018-02-11 21:44:27.172146467 +0200 -@@ -0,0 +1,494 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_SECURITY_H_ -+#define __RTW_SECURITY_H_ -+ -+ -+#define _NO_PRIVACY_ 0x0 -+#define _WEP40_ 0x1 -+#define _TKIP_ 0x2 -+#define _TKIP_WTMIC_ 0x3 -+#define _AES_ 0x4 -+#define _WEP104_ 0x5 -+#define _WEP_WPA_MIXED_ 0x07 /* WEP + WPA */ -+#define _SMS4_ 0x06 -+#ifdef CONFIG_IEEE80211W -+#define _BIP_ 0x8 -+#endif /* CONFIG_IEEE80211W */ -+/* 802.11W use wrong key */ -+#define IEEE80211W_RIGHT_KEY 0x0 -+#define IEEE80211W_WRONG_KEY 0x1 -+#define IEEE80211W_NO_KEY 0x2 -+ -+#define is_wep_enc(alg) (((alg) == _WEP40_) || ((alg) == _WEP104_)) -+ -+const char *security_type_str(u8 value); -+ -+#define _WPA_IE_ID_ 0xdd -+#define _WPA2_IE_ID_ 0x30 -+ -+#define SHA256_MAC_LEN 32 -+#define AES_BLOCK_SIZE 16 -+#define AES_PRIV_SIZE (4 * 44) -+ -+#define RTW_KEK_LEN 16 -+#define RTW_KCK_LEN 16 -+#define RTW_TKIP_MIC_LEN 8 -+#define RTW_REPLAY_CTR_LEN 8 -+ -+#define INVALID_SEC_MAC_CAM_ID 0xFF -+ -+typedef enum { -+ ENCRYP_PROTOCOL_OPENSYS, /* open system */ -+ ENCRYP_PROTOCOL_WEP, /* WEP */ -+ ENCRYP_PROTOCOL_WPA, /* WPA */ -+ ENCRYP_PROTOCOL_WPA2, /* WPA2 */ -+ ENCRYP_PROTOCOL_WAPI, /* WAPI: Not support in this version */ -+ ENCRYP_PROTOCOL_MAX -+} ENCRYP_PROTOCOL_E; -+ -+ -+#ifndef Ndis802_11AuthModeWPA2 -+#define Ndis802_11AuthModeWPA2 (Ndis802_11AuthModeWPANone + 1) -+#endif -+ -+#ifndef Ndis802_11AuthModeWPA2PSK -+#define Ndis802_11AuthModeWPA2PSK (Ndis802_11AuthModeWPANone + 2) -+#endif -+ -+union pn48 { -+ -+ u64 val; -+ -+#ifdef CONFIG_LITTLE_ENDIAN -+ -+struct { -+ u8 TSC0; -+ u8 TSC1; -+ u8 TSC2; -+ u8 TSC3; -+ u8 TSC4; -+ u8 TSC5; -+ u8 TSC6; -+ u8 TSC7; -+} _byte_; -+ -+#elif defined(CONFIG_BIG_ENDIAN) -+ -+struct { -+ u8 TSC7; -+ u8 TSC6; -+ u8 TSC5; -+ u8 TSC4; -+ u8 TSC3; -+ u8 TSC2; -+ u8 TSC1; -+ u8 TSC0; -+} _byte_; -+ -+#endif -+ -+}; -+ -+union Keytype { -+ u8 skey[16]; -+ u32 lkey[4]; -+}; -+ -+ -+typedef struct _RT_PMKID_LIST { -+ u8 bUsed; -+ u8 Bssid[6]; -+ u8 PMKID[16]; -+ u8 SsidBuf[33]; -+ u8 *ssid_octet; -+ u16 ssid_length; -+} RT_PMKID_LIST, *PRT_PMKID_LIST; -+ -+ -+struct security_priv { -+ u32 dot11AuthAlgrthm; /* 802.11 auth, could be open, shared, 8021x and authswitch */ -+ u32 dot11PrivacyAlgrthm; /* This specify the privacy for shared auth. algorithm. */ -+ -+ /* WEP */ -+ u32 dot11PrivacyKeyIndex; /* this is only valid for legendary wep, 0~3 for key id. (tx key index) */ -+ union Keytype dot11DefKey[4]; /* this is only valid for def. key */ -+ u32 dot11DefKeylen[4]; -+ u8 dot11Def_camid[4]; -+ u8 key_mask; /* use to restore wep key after hal_init */ -+ -+ u32 dot118021XGrpPrivacy; /* This specify the privacy algthm. used for Grp key */ -+ u32 dot118021XGrpKeyid; /* key id used for Grp Key ( tx key index) */ -+ union Keytype dot118021XGrpKey[4]; /* 802.1x Group Key, for inx0 and inx1 */ -+ union Keytype dot118021XGrptxmickey[4]; -+ union Keytype dot118021XGrprxmickey[4]; -+ union pn48 dot11Grptxpn; /* PN48 used for Grp Key xmit. */ -+ union pn48 dot11Grprxpn; /* PN48 used for Grp Key recv. */ -+ u8 iv_seq[4][8]; -+#ifdef CONFIG_IEEE80211W -+ u32 dot11wBIPKeyid; /* key id used for BIP Key ( tx key index) */ -+ union Keytype dot11wBIPKey[6]; /* BIP Key, for index4 and index5 */ -+ union pn48 dot11wBIPtxpn; /* PN48 used for Grp Key xmit. */ -+ union pn48 dot11wBIPrxpn; /* PN48 used for Grp Key recv. */ -+#endif /* CONFIG_IEEE80211W */ -+#ifdef CONFIG_AP_MODE -+ /* extend security capabilities for AP_MODE */ -+ unsigned int dot8021xalg;/* 0:disable, 1:psk, 2:802.1x */ -+ unsigned int wpa_psk;/* 0:disable, bit(0): WPA, bit(1):WPA2 */ -+ unsigned int wpa_group_cipher; -+ unsigned int wpa2_group_cipher; -+ unsigned int wpa_pairwise_cipher; -+ unsigned int wpa2_pairwise_cipher; -+#endif -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 dot118021x_bmc_cam_id; -+#endif -+ /*IEEE802.11-2012 Std. Table 8-101 AKM Suite Selectors*/ -+ u32 rsn_akm_suite_type; -+ -+ u8 wps_ie[MAX_WPS_IE_LEN];/* added in assoc req */ -+ int wps_ie_len; -+ -+ -+ u8 binstallGrpkey; -+#ifdef CONFIG_GTK_OL -+ u8 binstallKCK_KEK; -+#endif /* CONFIG_GTK_OL */ -+#ifdef CONFIG_IEEE80211W -+ u8 binstallBIPkey; -+#endif /* CONFIG_IEEE80211W */ -+ u8 busetkipkey; -+ /* _timer tkip_timer; */ -+ u8 bcheck_grpkey; -+ u8 bgrpkey_handshake; -+ -+ /* u8 packet_cnt; */ /* unused, removed */ -+ -+ s32 sw_encrypt;/* from registry_priv */ -+ s32 sw_decrypt;/* from registry_priv */ -+ -+ s32 hw_decrypted;/* if the rx packets is hw_decrypted==_FALSE, it means the hw has not been ready. */ -+ -+ -+ /* keeps the auth_type & enc_status from upper layer ioctl(wpa_supplicant or wzc) */ -+ u32 ndisauthtype; /* NDIS_802_11_AUTHENTICATION_MODE */ -+ u32 ndisencryptstatus; /* NDIS_802_11_ENCRYPTION_STATUS */ -+ -+ NDIS_802_11_WEP ndiswep; -+#ifdef PLATFORM_WINDOWS -+ u8 KeyMaterial[16];/* variable length depending on above field. */ -+#endif -+ -+ u8 assoc_info[600]; -+ u8 szofcapability[256]; /* for wpa2 usage */ -+ u8 oidassociation[512]; /* for wpa/wpa2 usage */ -+ u8 authenticator_ie[256]; /* store ap security information element */ -+ u8 supplicant_ie[256]; /* store sta security information element */ -+ -+ -+ /* for tkip countermeasure */ -+ u32 last_mic_err_time; -+ u8 btkip_countermeasure; -+ u8 btkip_wait_report; -+ u32 btkip_countermeasure_time; -+ -+ /* --------------------------------------------------------------------------- */ -+ /* For WPA2 Pre-Authentication. */ -+ /* --------------------------------------------------------------------------- */ -+ /* u8 RegEnablePreAuth; */ /* Default value: Pre-Authentication enabled or not, from registry "EnablePreAuth". Added by Annie, 2005-11-01. */ -+ /* u8 EnablePreAuthentication; */ /* Current Value: Pre-Authentication enabled or not. */ -+ RT_PMKID_LIST PMKIDList[NUM_PMKID_CACHE]; /* Renamed from PreAuthKey[NUM_PRE_AUTH_KEY]. Annie, 2006-10-13. */ -+ u8 PMKIDIndex; -+ /* u32 PMKIDCount; */ /* Added by Annie, 2006-10-13. */ -+ /* u8 szCapability[256]; */ /* For WPA2-PSK using zero-config, by Annie, 2005-09-20. */ -+ -+ u8 bWepDefaultKeyIdxSet; -+ -+#define DBG_SW_SEC_CNT -+#ifdef DBG_SW_SEC_CNT -+ u64 wep_sw_enc_cnt_bc; -+ u64 wep_sw_enc_cnt_mc; -+ u64 wep_sw_enc_cnt_uc; -+ u64 wep_sw_dec_cnt_bc; -+ u64 wep_sw_dec_cnt_mc; -+ u64 wep_sw_dec_cnt_uc; -+ -+ u64 tkip_sw_enc_cnt_bc; -+ u64 tkip_sw_enc_cnt_mc; -+ u64 tkip_sw_enc_cnt_uc; -+ u64 tkip_sw_dec_cnt_bc; -+ u64 tkip_sw_dec_cnt_mc; -+ u64 tkip_sw_dec_cnt_uc; -+ -+ u64 aes_sw_enc_cnt_bc; -+ u64 aes_sw_enc_cnt_mc; -+ u64 aes_sw_enc_cnt_uc; -+ u64 aes_sw_dec_cnt_bc; -+ u64 aes_sw_dec_cnt_mc; -+ u64 aes_sw_dec_cnt_uc; -+#endif /* DBG_SW_SEC_CNT */ -+}; -+ -+struct sha256_state { -+ u64 length; -+ u32 state[8], curlen; -+ u8 buf[64]; -+}; -+ -+#define GET_ENCRY_ALGO(psecuritypriv, psta, encry_algo, bmcst)\ -+ do {\ -+ switch (psecuritypriv->dot11AuthAlgrthm) {\ -+ case dot11AuthAlgrthm_Open:\ -+ case dot11AuthAlgrthm_Shared:\ -+ case dot11AuthAlgrthm_Auto:\ -+ encry_algo = (u8)psecuritypriv->dot11PrivacyAlgrthm;\ -+ break;\ -+ case dot11AuthAlgrthm_8021X:\ -+ if (bmcst)\ -+ encry_algo = (u8)psecuritypriv->dot118021XGrpPrivacy;\ -+ else\ -+ encry_algo = (u8) psta->dot118021XPrivacy;\ -+ break;\ -+ case dot11AuthAlgrthm_WAPI:\ -+ encry_algo = (u8)psecuritypriv->dot11PrivacyAlgrthm;\ -+ break;\ -+ } \ -+ } while (0) -+ -+#define _AES_IV_LEN_ 8 -+ -+#define SET_ICE_IV_LEN(iv_len, icv_len, encrypt)\ -+ do {\ -+ switch (encrypt) {\ -+ case _WEP40_:\ -+ case _WEP104_:\ -+ iv_len = 4;\ -+ icv_len = 4;\ -+ break;\ -+ case _TKIP_:\ -+ iv_len = 8;\ -+ icv_len = 4;\ -+ break;\ -+ case _AES_:\ -+ iv_len = 8;\ -+ icv_len = 8;\ -+ break;\ -+ case _SMS4_:\ -+ iv_len = 18;\ -+ icv_len = 16;\ -+ break;\ -+ default:\ -+ iv_len = 0;\ -+ icv_len = 0;\ -+ break;\ -+ } \ -+ } while (0) -+ -+ -+#define GET_TKIP_PN(iv, dot11txpn)\ -+ do {\ -+ dot11txpn._byte_.TSC0 = iv[2];\ -+ dot11txpn._byte_.TSC1 = iv[0];\ -+ dot11txpn._byte_.TSC2 = iv[4];\ -+ dot11txpn._byte_.TSC3 = iv[5];\ -+ dot11txpn._byte_.TSC4 = iv[6];\ -+ dot11txpn._byte_.TSC5 = iv[7];\ -+ } while (0) -+ -+ -+#define ROL32(A, n) (((A) << (n)) | (((A)>>(32-(n))) & ((1UL << (n)) - 1))) -+#define ROR32(A, n) ROL32((A), 32-(n)) -+ -+struct mic_data { -+ u32 K0, K1; /* Key */ -+ u32 L, R; /* Current state */ -+ u32 M; /* Message accumulator (single word) */ -+ u32 nBytesInM; /* # bytes in M */ -+}; -+ -+extern const u32 Te0[256]; -+extern const u32 Te1[256]; -+extern const u32 Te2[256]; -+extern const u32 Te3[256]; -+extern const u32 Te4[256]; -+extern const u32 Td0[256]; -+extern const u32 Td1[256]; -+extern const u32 Td2[256]; -+extern const u32 Td3[256]; -+extern const u32 Td4[256]; -+extern const u32 rcon[10]; -+extern const u8 Td4s[256]; -+extern const u8 rcons[10]; -+ -+#define RCON(i) (rcons[(i)] << 24) -+ -+static inline u32 rotr(u32 val, int bits) -+{ -+ return (val >> bits) | (val << (32 - bits)); -+} -+ -+#define TE0(i) Te0[((i) >> 24) & 0xff] -+#define TE1(i) rotr(Te0[((i) >> 16) & 0xff], 8) -+#define TE2(i) rotr(Te0[((i) >> 8) & 0xff], 16) -+#define TE3(i) rotr(Te0[(i) & 0xff], 24) -+#define TE41(i) ((Te0[((i) >> 24) & 0xff] << 8) & 0xff000000) -+#define TE42(i) (Te0[((i) >> 16) & 0xff] & 0x00ff0000) -+#define TE43(i) (Te0[((i) >> 8) & 0xff] & 0x0000ff00) -+#define TE44(i) ((Te0[(i) & 0xff] >> 8) & 0x000000ff) -+#define TE421(i) ((Te0[((i) >> 16) & 0xff] << 8) & 0xff000000) -+#define TE432(i) (Te0[((i) >> 8) & 0xff] & 0x00ff0000) -+#define TE443(i) (Te0[(i) & 0xff] & 0x0000ff00) -+#define TE414(i) ((Te0[((i) >> 24) & 0xff] >> 8) & 0x000000ff) -+#define TE4(i) ((Te0[(i)] >> 8) & 0x000000ff) -+ -+#define TD0(i) Td0[((i) >> 24) & 0xff] -+#define TD1(i) rotr(Td0[((i) >> 16) & 0xff], 8) -+#define TD2(i) rotr(Td0[((i) >> 8) & 0xff], 16) -+#define TD3(i) rotr(Td0[(i) & 0xff], 24) -+#define TD41(i) (Td4s[((i) >> 24) & 0xff] << 24) -+#define TD42(i) (Td4s[((i) >> 16) & 0xff] << 16) -+#define TD43(i) (Td4s[((i) >> 8) & 0xff] << 8) -+#define TD44(i) (Td4s[(i) & 0xff]) -+#define TD0_(i) Td0[(i) & 0xff] -+#define TD1_(i) rotr(Td0[(i) & 0xff], 8) -+#define TD2_(i) rotr(Td0[(i) & 0xff], 16) -+#define TD3_(i) rotr(Td0[(i) & 0xff], 24) -+ -+#define GETU32(pt) (((u32)(pt)[0] << 24) ^ ((u32)(pt)[1] << 16) ^ \ -+ ((u32)(pt)[2] << 8) ^ ((u32)(pt)[3])) -+ -+#define PUTU32(ct, st) { \ -+ (ct)[0] = (u8)((st) >> 24); (ct)[1] = (u8)((st) >> 16); \ -+ (ct)[2] = (u8)((st) >> 8); (ct)[3] = (u8)(st); } -+ -+#define WPA_GET_BE32(a) ((((u32) (a)[0]) << 24) | (((u32) (a)[1]) << 16) | \ -+ (((u32) (a)[2]) << 8) | ((u32) (a)[3])) -+ -+#define WPA_PUT_LE16(a, val) \ -+ do { \ -+ (a)[1] = ((u16) (val)) >> 8; \ -+ (a)[0] = ((u16) (val)) & 0xff; \ -+ } while (0) -+ -+#define WPA_PUT_BE32(a, val) \ -+ do { \ -+ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[3] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define WPA_PUT_BE64(a, val) \ -+ do { \ -+ (a)[0] = (u8) (((u64) (val)) >> 56); \ -+ (a)[1] = (u8) (((u64) (val)) >> 48); \ -+ (a)[2] = (u8) (((u64) (val)) >> 40); \ -+ (a)[3] = (u8) (((u64) (val)) >> 32); \ -+ (a)[4] = (u8) (((u64) (val)) >> 24); \ -+ (a)[5] = (u8) (((u64) (val)) >> 16); \ -+ (a)[6] = (u8) (((u64) (val)) >> 8); \ -+ (a)[7] = (u8) (((u64) (val)) & 0xff); \ -+ } while (0) -+ -+/* ===== start - public domain SHA256 implementation ===== */ -+ -+/* This is based on SHA256 implementation in LibTomCrypt that was released into -+ * public domain by Tom St Denis. */ -+ -+/* the K array */ -+static const unsigned long K[64] = { -+ 0x428a2f98UL, 0x71374491UL, 0xb5c0fbcfUL, 0xe9b5dba5UL, 0x3956c25bUL, -+ 0x59f111f1UL, 0x923f82a4UL, 0xab1c5ed5UL, 0xd807aa98UL, 0x12835b01UL, -+ 0x243185beUL, 0x550c7dc3UL, 0x72be5d74UL, 0x80deb1feUL, 0x9bdc06a7UL, -+ 0xc19bf174UL, 0xe49b69c1UL, 0xefbe4786UL, 0x0fc19dc6UL, 0x240ca1ccUL, -+ 0x2de92c6fUL, 0x4a7484aaUL, 0x5cb0a9dcUL, 0x76f988daUL, 0x983e5152UL, -+ 0xa831c66dUL, 0xb00327c8UL, 0xbf597fc7UL, 0xc6e00bf3UL, 0xd5a79147UL, -+ 0x06ca6351UL, 0x14292967UL, 0x27b70a85UL, 0x2e1b2138UL, 0x4d2c6dfcUL, -+ 0x53380d13UL, 0x650a7354UL, 0x766a0abbUL, 0x81c2c92eUL, 0x92722c85UL, -+ 0xa2bfe8a1UL, 0xa81a664bUL, 0xc24b8b70UL, 0xc76c51a3UL, 0xd192e819UL, -+ 0xd6990624UL, 0xf40e3585UL, 0x106aa070UL, 0x19a4c116UL, 0x1e376c08UL, -+ 0x2748774cUL, 0x34b0bcb5UL, 0x391c0cb3UL, 0x4ed8aa4aUL, 0x5b9cca4fUL, -+ 0x682e6ff3UL, 0x748f82eeUL, 0x78a5636fUL, 0x84c87814UL, 0x8cc70208UL, -+ 0x90befffaUL, 0xa4506cebUL, 0xbef9a3f7UL, 0xc67178f2UL -+}; -+ -+ -+/* Various logical functions */ -+#define RORc(x, y) \ -+ (((((unsigned long) (x) & 0xFFFFFFFFUL) >> (unsigned long) ((y) & 31)) | \ -+ ((unsigned long) (x) << (unsigned long) (32 - ((y) & 31)))) & 0xFFFFFFFFUL) -+#define Ch(x, y, z) (z ^ (x & (y ^ z))) -+#define Maj(x, y, z) (((x | y) & z) | (x & y)) -+#define S(x, n) RORc((x), (n)) -+#define R(x, n) (((x) & 0xFFFFFFFFUL)>>(n)) -+#define Sigma0(x) (S(x, 2) ^ S(x, 13) ^ S(x, 22)) -+#define Sigma1(x) (S(x, 6) ^ S(x, 11) ^ S(x, 25)) -+#define Gamma0(x) (S(x, 7) ^ S(x, 18) ^ R(x, 3)) -+#define Gamma1(x) (S(x, 17) ^ S(x, 19) ^ R(x, 10)) -+#ifndef MIN -+#define MIN(x, y) (((x) < (y)) ? (x) : (y)) -+#endif -+#ifdef CONFIG_IEEE80211W -+int omac1_aes_128(u8 *key, u8 *data, size_t data_len, u8 *mac); -+#endif /* CONFIG_IEEE80211W */ -+void rtw_secmicsetkey(struct mic_data *pmicdata, u8 *key); -+void rtw_secmicappendbyte(struct mic_data *pmicdata, u8 b); -+void rtw_secmicappend(struct mic_data *pmicdata, u8 *src, u32 nBytes); -+void rtw_secgetmic(struct mic_data *pmicdata, u8 *dst); -+ -+void rtw_seccalctkipmic( -+ u8 *key, -+ u8 *header, -+ u8 *data, -+ u32 data_len, -+ u8 *Miccode, -+ u8 priority); -+ -+u32 rtw_aes_encrypt(_adapter *padapter, u8 *pxmitframe); -+u32 rtw_tkip_encrypt(_adapter *padapter, u8 *pxmitframe); -+void rtw_wep_encrypt(_adapter *padapter, u8 *pxmitframe); -+ -+u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe); -+u32 rtw_tkip_decrypt(_adapter *padapter, u8 *precvframe); -+void rtw_wep_decrypt(_adapter *padapter, u8 *precvframe); -+#ifdef CONFIG_IEEE80211W -+u32 rtw_BIP_verify(_adapter *padapter, u8 *precvframe); -+#endif /* CONFIG_IEEE80211W */ -+#ifdef CONFIG_TDLS -+void wpa_tdls_generate_tpk(_adapter *padapter, PVOID sta); -+int wpa_tdls_ftie_mic(u8 *kck, u8 trans_seq, -+ u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie, -+ u8 *mic); -+int wpa_tdls_teardown_ftie_mic(u8 *kck, u8 *lnkid, u16 reason, -+ u8 dialog_token, u8 trans_seq, u8 *ftie, u8 *mic); -+int tdls_verify_mic(u8 *kck, u8 trans_seq, -+ u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie); -+#endif /* CONFIG_TDLS */ -+ -+void rtw_use_tkipkey_handler(RTW_TIMER_HDL_ARGS); -+ -+void rtw_sec_restore_wep_key(_adapter *adapter); -+u8 rtw_handle_tkip_countermeasure(_adapter *adapter, const char *caller); -+ -+#ifdef CONFIG_WOWLAN -+u16 rtw_calc_crc(u8 *pdata, int length); -+#endif /*CONFIG_WOWLAN*/ -+ -+#endif /* __RTL871X_SECURITY_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_sreset.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_sreset.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_sreset.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,60 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTW_SRESET_H_ -+#define _RTW_SRESET_H_ -+ -+/* #include */ -+ -+enum { -+ SRESET_TGP_NULL = 0, -+ SRESET_TGP_XMIT_STATUS = 1, -+ SRESET_TGP_LINK_STATUS = 2, -+}; -+ -+struct sreset_priv { -+ _mutex silentreset_mutex; -+ u8 silent_reset_inprogress; -+ u8 Wifi_Error_Status; -+ unsigned long last_tx_time; -+ unsigned long last_tx_complete_time; -+ -+ s32 dbg_trigger_point; -+}; -+ -+ -+ -+#define WIFI_STATUS_SUCCESS 0 -+#define USB_VEN_REQ_CMD_FAIL BIT0 -+#define USB_READ_PORT_FAIL BIT1 -+#define USB_WRITE_PORT_FAIL BIT2 -+#define WIFI_MAC_TXDMA_ERROR BIT3 -+#define WIFI_TX_HANG BIT4 -+#define WIFI_RX_HANG BIT5 -+#define WIFI_IF_NOT_EXIST BIT6 -+ -+void sreset_init_value(_adapter *padapter); -+void sreset_reset_value(_adapter *padapter); -+u8 sreset_get_wifi_status(_adapter *padapter); -+void sreset_set_wifi_error_status(_adapter *padapter, u32 status); -+void sreset_set_trigger_point(_adapter *padapter, s32 tgp); -+bool sreset_inprogress(_adapter *padapter); -+void sreset_reset(_adapter *padapter); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_tdls.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_tdls.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_tdls.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_tdls.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,173 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_TDLS_H_ -+#define __RTW_TDLS_H_ -+ -+ -+#ifdef CONFIG_TDLS -+/* TDLS STA state */ -+ -+ -+/* TDLS Diect Link Establishment */ -+#define TDLS_STATE_NONE 0x00000000 /* Default state */ -+#define TDLS_INITIATOR_STATE BIT(28) /* 0x10000000 */ -+#define TDLS_RESPONDER_STATE BIT(29) /* 0x20000000 */ -+#define TDLS_LINKED_STATE BIT(30) /* 0x40000000 */ -+/* TDLS PU Buffer STA */ -+#define TDLS_WAIT_PTR_STATE BIT(24) /* 0x01000000 */ /* Waiting peer's TDLS_PEER_TRAFFIC_RESPONSE frame */ -+/* TDLS Check ALive */ -+#define TDLS_ALIVE_STATE BIT(20) /* 0x00100000 */ /* Check if peer sta is alived. */ -+/* TDLS Channel Switch */ -+#define TDLS_CH_SWITCH_PREPARE_STATE BIT(15) /* 0x00008000 */ -+#define TDLS_CH_SWITCH_ON_STATE BIT(16) /* 0x00010000 */ -+#define TDLS_PEER_AT_OFF_STATE BIT(17) /* 0x00020000 */ /* Could send pkt on target ch */ -+#define TDLS_CH_SW_INITIATOR_STATE BIT(18) /* 0x00040000 */ /* Avoid duplicated or unconditional ch. switch rsp. */ -+#define TDLS_WAIT_CH_RSP_STATE BIT(19) /* 0x00080000 */ /* Wait Ch. response as we are TDLS channel switch initiator */ -+ -+ -+#define TDLS_TPK_RESEND_COUNT 86400 /*Unit: seconds */ -+#define TDLS_CH_SWITCH_TIME 15 -+#define TDLS_CH_SWITCH_TIMEOUT 30 -+#define TDLS_CH_SWITCH_OPER_OFFLOAD_TIMEOUT 10 -+#define TDLS_SIGNAL_THRESH 0x20 -+#define TDLS_WATCHDOG_PERIOD 10 /* Periodically sending tdls discovery request in TDLS_WATCHDOG_PERIOD * 2 sec */ -+#define TDLS_HANDSHAKE_TIME 3000 -+#define TDLS_PTI_TIME 7000 -+ -+#define TDLS_CH_SW_STAY_ON_BASE_CHNL_TIMEOUT 20 /* ms */ -+#define TDLS_CH_SW_MONITOR_TIMEOUT 2000 /*ms */ -+ -+#define TDLS_MIC_LEN 16 -+#define WPA_NONCE_LEN 32 -+#define TDLS_TIMEOUT_LEN 4 -+ -+enum TDLS_CH_SW_CHNL { -+ TDLS_CH_SW_BASE_CHNL = 0, -+ TDLS_CH_SW_OFF_CHNL -+}; -+ -+struct wpa_tdls_ftie { -+ u8 ie_type; /* FTIE */ -+ u8 ie_len; -+ u8 mic_ctrl[2]; -+ u8 mic[TDLS_MIC_LEN]; -+ u8 Anonce[WPA_NONCE_LEN]; /* Responder Nonce in TDLS */ -+ u8 Snonce[WPA_NONCE_LEN]; /* Initiator Nonce in TDLS */ -+ /* followed by optional elements */ -+} ; -+ -+struct wpa_tdls_lnkid { -+ u8 ie_type; /* Link Identifier IE */ -+ u8 ie_len; -+ u8 bssid[ETH_ALEN]; -+ u8 init_sta[ETH_ALEN]; -+ u8 resp_sta[ETH_ALEN]; -+} ; -+ -+static u8 TDLS_RSNIE[20] = { 0x01, 0x00, /* Version shall be set to 1 */ -+ 0x00, 0x0f, 0xac, 0x07, /* Group sipher suite */ -+ 0x01, 0x00, /* Pairwise cipher suite count */ -+ 0x00, 0x0f, 0xac, 0x04, /* Pairwise cipher suite list; CCMP only */ -+ 0x01, 0x00, /* AKM suite count */ -+ 0x00, 0x0f, 0xac, 0x07, /* TPK Handshake */ -+ 0x0c, 0x02, -+ /* PMKID shall not be present */ -+ }; -+ -+static u8 TDLS_WMMIE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01, 0x00}; /* Qos info all set zero */ -+ -+static u8 TDLS_WMM_PARAM_IE[] = {0x00, 0x00, 0x03, 0xa4, 0x00, 0x00, 0x27, 0xa4, 0x00, 0x00, 0x42, 0x43, 0x5e, 0x00, 0x62, 0x32, 0x2f, 0x00}; -+ -+static u8 TDLS_EXT_CAPIE[] = {0x00, 0x00, 0x00, 0x50, 0x20, 0x00, 0x00, 0x00}; /* bit(28), bit(30), bit(37) */ -+ -+/* SRC: Supported Regulatory Classes */ -+static u8 TDLS_SRC[] = { 0x01, 0x01, 0x02, 0x03, 0x04, 0x0c, 0x16, 0x17, 0x18, 0x19, 0x1b, 0x1c, 0x1d, 0x1e, 0x20, 0x21 }; -+ -+int check_ap_tdls_prohibited(u8 *pframe, u8 pkt_len); -+int check_ap_tdls_ch_switching_prohibited(u8 *pframe, u8 pkt_len); -+ -+u8 rtw_tdls_is_setup_allowed(_adapter *padapter); -+#ifdef CONFIG_TDLS_CH_SW -+u8 rtw_tdls_is_chsw_allowed(_adapter *padapter); -+#endif -+ -+void rtw_reset_tdls_info(_adapter *padapter); -+int rtw_init_tdls_info(_adapter *padapter); -+void rtw_free_tdls_info(struct tdls_info *ptdlsinfo); -+int issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); -+void rtw_init_tdls_timer(_adapter *padapter, struct sta_info *psta); -+void rtw_free_tdls_timer(struct sta_info *psta); -+void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta); -+ -+#ifdef CONFIG_TDLS_CH_SW -+void rtw_tdls_set_ch_sw_oper_control(_adapter *padapter, u8 enable); -+void rtw_tdls_ch_sw_back_to_base_chnl(_adapter *padapter); -+s32 rtw_tdls_do_ch_sw(_adapter *padapter, struct sta_info *ptdls_sta, u8 chnl_type, u8 channel, u8 channel_offset, u16 bwmode, u16 ch_switch_time); -+void rtw_tdls_chsw_oper_done(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_WFD -+int issue_tunneled_probe_req(_adapter *padapter); -+int issue_tunneled_probe_rsp(_adapter *padapter, union recv_frame *precv_frame); -+#endif /* CONFIG_WFD */ -+int issue_tdls_dis_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt); -+int issue_tdls_setup_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack); -+int issue_tdls_setup_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt); -+int issue_tdls_setup_cfm(_adapter *padapter, struct tdls_txmgmt *ptxmgmt); -+int issue_tdls_dis_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 privacy); -+int issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack); -+int issue_tdls_peer_traffic_rsp(_adapter *padapter, struct sta_info *psta, struct tdls_txmgmt *ptxmgmt); -+int issue_tdls_peer_traffic_indication(_adapter *padapter, struct sta_info *psta); -+#ifdef CONFIG_TDLS_CH_SW -+int issue_tdls_ch_switch_req(_adapter *padapter, struct sta_info *ptdls_sta); -+int issue_tdls_ch_switch_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack); -+#endif -+sint On_TDLS_Dis_Rsp(_adapter *adapter, union recv_frame *precv_frame); -+sint On_TDLS_Setup_Req(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Setup_Rsp(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Setup_Cfm(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Dis_Req(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Teardown(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Peer_Traffic_Indication(_adapter *adapter, union recv_frame *precv_frame); -+int On_TDLS_Peer_Traffic_Rsp(_adapter *adapter, union recv_frame *precv_frame); -+#ifdef CONFIG_TDLS_CH_SW -+sint On_TDLS_Ch_Switch_Req(_adapter *adapter, union recv_frame *precv_frame); -+sint On_TDLS_Ch_Switch_Rsp(_adapter *adapter, union recv_frame *precv_frame); -+void rtw_build_tdls_ch_switch_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_ch_switch_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+#endif -+void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_teardown_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_dis_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_dis_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, u8 privacy); -+void rtw_build_tdls_peer_traffic_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tdls_peer_traffic_indication_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -+void rtw_build_tunneled_probe_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe); -+void rtw_build_tunneled_probe_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe); -+ -+u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta); -+int rtw_tdls_is_driver_setup(_adapter *padapter); -+void rtw_tdls_set_key(_adapter *padapter, struct sta_info *ptdls_sta); -+const char *rtw_tdls_action_txt(enum TDLS_ACTION_FIELD action); -+#endif /* CONFIG_TDLS */ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_version.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_version.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_version.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_version.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,2 @@ -+#define DRIVERVERSION "v5.1.1.8_21285.20171026" -+#define BTCOEXVERSION "BTCOEX20170111-1414" -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_vht.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_vht.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_vht.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_vht.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,143 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTW_VHT_H_ -+#define _RTW_VHT_H_ -+ -+#define LDPC_VHT_ENABLE_RX BIT0 -+#define LDPC_VHT_ENABLE_TX BIT1 -+#define LDPC_VHT_TEST_TX_ENABLE BIT2 -+#define LDPC_VHT_CAP_TX BIT3 -+ -+#define STBC_VHT_ENABLE_RX BIT0 -+#define STBC_VHT_ENABLE_TX BIT1 -+#define STBC_VHT_TEST_TX_ENABLE BIT2 -+#define STBC_VHT_CAP_TX BIT3 -+ -+#define BEAMFORMING_VHT_BEAMFORMER_ENABLE BIT0 /* Declare our NIC supports beamformer */ -+#define BEAMFORMING_VHT_BEAMFORMEE_ENABLE BIT1 /* Declare our NIC supports beamformee */ -+#define BEAMFORMING_VHT_MU_MIMO_AP_ENABLE BIT2 /*Declare our NIC support MU-MIMO AP mode*/ -+#define BEAMFORMING_VHT_MU_MIMO_STA_ENABLE BIT3 /*Declare our NIC support MU-MIMO STA mode*/ -+#define BEAMFORMING_VHT_BEAMFORMER_TEST BIT4 /*Transmiting Beamforming no matter the target supports it or not*/ -+#define BEAMFORMING_VHT_BEAMFORMER_STS_CAP (BIT8 | BIT9 | BIT10) /*Asoc rsp cap*/ -+#define BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM (BIT12 | BIT13 | BIT14) /*Asoc rsp cap*/ -+ -+ -+/* VHT capability info */ -+#define SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 2, _val) -+#define SET_VHT_CAPABILITY_ELE_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 2, 2, _val) -+#define SET_VHT_CAPABILITY_ELE_RX_LDPC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 4, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_SHORT_GI80M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 5, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_SHORT_GI160M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 6, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_TX_STBC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 7, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_RX_STBC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 0, 3, _val) -+#define SET_VHT_CAPABILITY_ELE_SU_BFER(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 3, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_SU_BFEE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 4, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_BFER_ANT_SUPP(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 5, 3, _val) -+#define SET_VHT_CAPABILITY_ELE_SOUNDING_DIMENSIONS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 0, 3, _val) -+ -+#define SET_VHT_CAPABILITY_ELE_MU_BFER(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 3, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_MU_BFEE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 4, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_TXOP_PS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 5, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_HTC_VHT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 6, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+2, 7, 3, _val) /* B23~B25 */ -+#define SET_VHT_CAPABILITY_ELE_LINK_ADAPTION(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 2, 2, _val) -+#define SET_VHT_CAPABILITY_ELE_MCS_RX_MAP(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+4, 0, 16, _val) /* B0~B15 indicate Rx MCS MAP, we write 0 to indicate MCS0~7. by page */ -+#define SET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+6, 0, 13, _val) -+#define SET_VHT_CAPABILITY_ELE_MCS_TX_MAP(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+8, 0, 16, _val) /* B0~B15 indicate Tx MCS MAP, we write 0 to indicate MCS0~7. by page */ -+#define SET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+10, 0, 13, _val) -+ -+ -+#define GET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 0, 2) -+#define GET_VHT_CAPABILITY_ELE_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 2, 2) -+#define GET_VHT_CAPABILITY_ELE_RX_LDPC(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 4, 1) -+#define GET_VHT_CAPABILITY_ELE_SHORT_GI80M(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 5, 1) -+#define GET_VHT_CAPABILITY_ELE_SHORT_GI160M(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 6, 1) -+#define GET_VHT_CAPABILITY_ELE_TX_STBC(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 7, 1) -+#define GET_VHT_CAPABILITY_ELE_RX_STBC(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 0, 3) -+#define GET_VHT_CAPABILITY_ELE_SU_BFER(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 3, 1) -+#define GET_VHT_CAPABILITY_ELE_SU_BFEE(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 4, 1) -+/*phydm-beamforming*/ -+#define GET_VHT_CAPABILITY_ELE_SU_BFEE_STS_CAP(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+1, 5, 3) -+#define GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+2, 0, 3) -+#define GET_VHT_CAPABILITY_ELE_MU_BFER(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2, 3, 1) -+#define GET_VHT_CAPABILITY_ELE_MU_BFEE(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2, 4, 1) -+#define GET_VHT_CAPABILITY_ELE_TXOP_PS(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2, 5, 1) -+#define GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+2, 7, 3) -+#define GET_VHT_CAPABILITY_ELE_RX_MCS(_pEleStart) ((_pEleStart)+4) -+#define GET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+6, 0, 13) -+#define GET_VHT_CAPABILITY_ELE_TX_MCS(_pEleStart) ((_pEleStart)+8) -+#define GET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+10, 0, 13) -+ -+ -+/* VHT Operation Information Element */ -+#define SET_VHT_OPERATION_ELE_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 8, _val) -+#define SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart+1, 0, 8, _val) -+#define SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart+2, 0, 8, _val) -+#define SET_VHT_OPERATION_ELE_BASIC_MCS_SET(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+3, 0, 16, _val) -+ -+#define GET_VHT_OPERATION_ELE_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 0, 8) -+#define GET_VHT_OPERATION_ELE_CENTER_FREQ1(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 0, 8) -+#define GET_VHT_OPERATION_ELE_CENTER_FREQ2(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2, 0, 8) -+ -+/* VHT Operating Mode */ -+#define SET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 2, _val) -+#define SET_VHT_OPERATING_MODE_FIELD_RX_NSS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 4, 3, _val) -+#define SET_VHT_OPERATING_MODE_FIELD_RX_NSS_TYPE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 7, 1, _val) -+#define GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 0, 2) -+#define GET_VHT_OPERATING_MODE_FIELD_RX_NSS(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 4, 3) -+#define GET_VHT_OPERATING_MODE_FIELD_RX_NSS_TYPE(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 7, 1) -+ -+#define SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+7, 6, 1, _val) -+#define GET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+7, 6, 1) -+ -+struct vht_priv { -+ u8 vht_option; -+ -+ u8 ldpc_cap; -+ u8 stbc_cap; -+ u16 beamform_cap; -+ -+ u8 sgi_80m;/* short GI */ -+ u8 ampdu_len; -+ -+ u8 vht_op_mode_notify; -+ u8 vht_highest_rate; -+ u8 vht_mcs_map[2]; -+ -+ u8 vht_cap[32]; -+}; -+ -+u8 rtw_get_vht_highest_rate(u8 *pvht_mcs_map); -+u16 rtw_vht_mcs_to_data_rate(u8 bw, u8 short_GI, u8 vht_mcs_rate); -+u64 rtw_vht_rate_to_bitmap(u8 *pVHTRate); -+void rtw_vht_use_default_setting(_adapter *padapter); -+u32 rtw_build_vht_operation_ie(_adapter *padapter, u8 *pbuf, u8 channel); -+u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf, u8 bw); -+u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf); -+void update_sta_vht_info_apmode(_adapter *padapter, PVOID psta); -+void update_hw_vht_param(_adapter *padapter); -+void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+void VHT_operation_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, PVOID sta); -+u32 rtw_restructure_vht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len); -+void VHTOnAssocRsp(_adapter *padapter); -+u8 rtw_vht_mcsmap_to_nss(u8 *pvht_mcs_map); -+ -+#endif /* _RTW_VHT_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_wapi.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_wapi.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_wapi.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_wapi.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,214 @@ -+#ifndef __INC_WAPI_H -+#define __INC_WAPI_H -+ -+ -+#define CONFIG_WAPI_SW_SMS4 -+#define WAPI_DEBUG -+ -+#define SMS4_MIC_LEN 16 -+#define WAPI_EXT_LEN 18 -+#define MAX_WAPI_IE_LEN 256 -+#define sMacHdrLng 24 /* octets in data header, no WEP */ -+ -+#ifdef WAPI_DEBUG -+ -+/* WAPI trace debug */ -+extern u32 wapi_debug_component; -+ -+static inline void dump_buf(u8 *buf, u32 len) -+{ -+ u32 i; -+ printk("-----------------Len %d----------------\n", len); -+ for (i = 0; i < len; i++) -+ printk("%2.2x-", *(buf + i)); -+ printk("\n"); -+} -+ -+#define WAPI_TRACE(component, x, args...) \ -+ do { if (wapi_debug_component & (component)) \ -+ printk(KERN_DEBUG "WAPI" ":" x "" , \ -+ ##args);\ -+ } while (0); -+ -+#define WAPI_DATA(component, x, buf, len) \ -+ do { if (wapi_debug_component & (component)) { \ -+ printk("%s:\n", x);\ -+ dump_buf((buf), (len)); } \ -+ } while (0); -+ -+#define RT_ASSERT_RET(_Exp) \ -+ if (!(_Exp)) { \ -+ printk("RTWLAN: "); \ -+ printk("Assertion failed! %s,%s, line=%d\n", \ -+ #_Exp, __FUNCTION__, __LINE__); \ -+ return; \ -+ } -+#define RT_ASSERT_RET_VALUE(_Exp, Ret) \ -+ if (!(_Exp)) { \ -+ printk("RTWLAN: "); \ -+ printk("Assertion failed! %s,%s, line=%d\n", \ -+ #_Exp, __FUNCTION__, __LINE__); \ -+ return Ret; \ -+ } -+ -+#else -+#define RT_ASSERT_RET(_Exp) do {} while (0) -+#define RT_ASSERT_RET_VALUE(_Exp, Ret) do {} while (0) -+#define WAPI_TRACE(component, x, args...) do {} while (0) -+#define WAPI_DATA(component, x, buf, len) do {} while (0) -+#endif -+ -+ -+enum WAPI_DEBUG { -+ WAPI_INIT = 1, -+ WAPI_API = 1 << 1, -+ WAPI_TX = 1 << 2, -+ WAPI_RX = 1 << 3, -+ WAPI_MLME = 1 << 4, -+ WAPI_IOCTL = 1 << 5, -+ WAPI_ERR = 1 << 31 -+}; -+ -+#define WAPI_MAX_BKID_NUM 4 -+#define WAPI_MAX_STAINFO_NUM 4 -+#define WAPI_CAM_ENTRY_NUM 14 /* 28/2 = 14 */ -+ -+typedef struct _RT_WAPI_BKID { -+ struct list_head list; -+ u8 bkid[16]; -+} RT_WAPI_BKID, *PRT_WAPI_BKID; -+ -+typedef struct _RT_WAPI_KEY { -+ u8 dataKey[16]; -+ u8 micKey[16]; -+ u8 keyId; -+ bool bSet; -+ bool bTxEnable; -+} RT_WAPI_KEY, *PRT_WAPI_KEY; -+ -+typedef enum _RT_WAPI_PACKET_TYPE { -+ WAPI_NONE = 0, -+ WAPI_PREAUTHENTICATE = 1, -+ WAPI_STAKEY_REQUEST = 2, -+ WAPI_AUTHENTICATE_ACTIVE = 3, -+ WAPI_ACCESS_AUTHENTICATE_REQUEST = 4, -+ WAPI_ACCESS_AUTHENTICATE_RESPONSE = 5, -+ WAPI_CERTIFICATE_AUTHENTICATE_REQUEST = 6, -+ WAPI_CERTIFICATE_AUTHENTICATE_RESPONSE = 7, -+ WAPI_USK_REQUEST = 8, -+ WAPI_USK_RESPONSE = 9, -+ WAPI_USK_CONFIRM = 10, -+ WAPI_MSK_NOTIFICATION = 11, -+ WAPI_MSK_RESPONSE = 12 -+} RT_WAPI_PACKET_TYPE; -+ -+typedef struct _RT_WAPI_STA_INFO { -+ struct list_head list; -+ u8 PeerMacAddr[6]; -+ RT_WAPI_KEY wapiUsk; -+ RT_WAPI_KEY wapiUskUpdate; -+ RT_WAPI_KEY wapiMsk; -+ RT_WAPI_KEY wapiMskUpdate; -+ u8 lastRxUnicastPN[16]; -+ u8 lastTxUnicastPN[16]; -+ u8 lastRxMulticastPN[16]; -+ u8 lastRxUnicastPNBEQueue[16]; -+ u8 lastRxUnicastPNBKQueue[16]; -+ u8 lastRxUnicastPNVIQueue[16]; -+ u8 lastRxUnicastPNVOQueue[16]; -+ bool bSetkeyOk; -+ bool bAuthenticateInProgress; -+ bool bAuthenticatorInUpdata; -+} RT_WAPI_STA_INFO, *PRT_WAPI_STA_INFO; -+ -+/* Added for HW wapi en/decryption */ -+typedef struct _RT_WAPI_CAM_ENTRY { -+ /* RT_LIST_ENTRY list; */ -+ u8 IsUsed; -+ u8 entry_idx;/* for cam entry */ -+ u8 keyidx; /* 0 or 1,new or old key */ -+ u8 PeerMacAddr[6]; -+ u8 type; /* should be 110,wapi */ -+} RT_WAPI_CAM_ENTRY, *PRT_WAPI_CAM_ENTRY; -+ -+typedef struct _RT_WAPI_T { -+ /* BKID */ -+ RT_WAPI_BKID wapiBKID[WAPI_MAX_BKID_NUM]; -+ struct list_head wapiBKIDIdleList; -+ struct list_head wapiBKIDStoreList; -+ /* Key for Tx Multicast/Broadcast */ -+ RT_WAPI_KEY wapiTxMsk; -+ -+ /* sec related */ -+ u8 lastTxMulticastPN[16]; -+ /* STA list */ -+ RT_WAPI_STA_INFO wapiSta[WAPI_MAX_STAINFO_NUM]; -+ struct list_head wapiSTAIdleList; -+ struct list_head wapiSTAUsedList; -+ /* */ -+ bool bWapiEnable; -+ -+ /* store WAPI IE */ -+ u8 wapiIE[256]; -+ u8 wapiIELength; -+ bool bWapiPSK; -+ /* last sequece number for wai packet */ -+ u16 wapiSeqnumAndFragNum; -+ int extra_prefix_len; -+ int extra_postfix_len; -+ -+ RT_WAPI_CAM_ENTRY wapiCamEntry[WAPI_CAM_ENTRY_NUM]; -+} RT_WAPI_T, *PRT_WAPI_T; -+ -+typedef struct _WLAN_HEADER_WAPI_EXTENSION { -+ u8 KeyIdx; -+ u8 Reserved; -+ u8 PN[16]; -+} WLAN_HEADER_WAPI_EXTENSION, *PWLAN_HEADER_WAPI_EXTENSION; -+ -+u32 WapiComparePN(u8 *PN1, u8 *PN2); -+ -+ -+void rtw_wapi_init(_adapter *padapter); -+ -+void rtw_wapi_free(_adapter *padapter); -+ -+void rtw_wapi_disable_tx(_adapter *padapter); -+ -+u8 rtw_wapi_is_wai_packet(_adapter *padapter, u8 *pkt_data); -+ -+void rtw_wapi_update_info(_adapter *padapter, union recv_frame *precv_frame); -+ -+u8 rtw_wapi_check_for_drop(_adapter *padapter, union recv_frame *precv_frame); -+ -+void rtw_build_probe_resp_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib); -+ -+void rtw_build_beacon_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib); -+ -+void rtw_build_assoc_req_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib); -+ -+void rtw_wapi_on_assoc_ok(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+ -+void rtw_wapi_return_one_sta_info(_adapter *padapter, u8 *MacAddr); -+ -+void rtw_wapi_return_all_sta_info(_adapter *padapter); -+ -+void rtw_wapi_clear_cam_entry(_adapter *padapter, u8 *pMacAddr); -+ -+void rtw_wapi_clear_all_cam_entry(_adapter *padapter); -+ -+void rtw_wapi_set_key(_adapter *padapter, RT_WAPI_KEY *pWapiKey, RT_WAPI_STA_INFO *pWapiSta, u8 bGroupKey, u8 bUseDefaultKey); -+ -+int rtw_wapi_create_event_send(_adapter *padapter, u8 EventId, u8 *MacAddr, u8 *Buff, u16 BufLen); -+ -+u32 rtw_sms4_encrypt(_adapter *padapter, u8 *pxmitframe); -+ -+u32 rtw_sms4_decrypt(_adapter *padapter, u8 *precvframe); -+ -+void rtw_wapi_get_iv(_adapter *padapter, u8 *pRA, u8 *IV); -+ -+u8 WapiIncreasePN(u8 *PN, u8 AddCount); -+ -+bool rtw_wapi_drop_for_key_absent(_adapter *padapter, u8 *pRA); -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_wifi_regd.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_wifi_regd.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_wifi_regd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_wifi_regd.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,25 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2009-2010 Realtek Corporation. -+ * -+ *****************************************************************************/ -+ -+#ifndef __RTW_WIFI_REGD_H__ -+#define __RTW_WIFI_REGD_H__ -+ -+struct country_code_to_enum_rd { -+ u16 countrycode; -+ const char *iso_name; -+}; -+ -+enum country_code_type_t { -+ COUNTRY_CODE_USER = 0, -+ -+ /*add new channel plan above this line */ -+ COUNTRY_CODE_MAX -+}; -+ -+int rtw_regd_init(_adapter *padapter); -+void rtw_reg_notify_by_driver(_adapter *adapter); -+ -+#endif /* __RTW_WIFI_REGD_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/rtw_xmit.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_xmit.h ---- linux-4.14.18/3rdparty/rtl8723de/include/rtw_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/rtw_xmit.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,936 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _RTW_XMIT_H_ -+#define _RTW_XMIT_H_ -+ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ #ifdef CONFIG_TX_AGGREGATION -+ #define MAX_XMITBUF_SZ (20480) /* 20k */ -+ /* #define SDIO_TX_AGG_MAX 5 */ -+ #else -+ #define MAX_XMITBUF_SZ (1664) -+ #define SDIO_TX_AGG_MAX 1 -+ #endif -+ -+ #if defined CONFIG_SDIO_HCI -+ #define NR_XMITBUFF (16) -+ #endif -+ #if defined(CONFIG_GSPI_HCI) -+ #define NR_XMITBUFF (128) -+ #endif -+ -+#elif defined (CONFIG_USB_HCI) -+ -+ #ifdef CONFIG_USB_TX_AGGREGATION -+ #if defined(CONFIG_PLATFORM_ARM_SUNxI) || defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) || defined(CONFIG_PLATFORM_ARM_SUN8I) || defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) -+ #define MAX_XMITBUF_SZ (12288) /* 12k 1536*8 */ -+ #elif defined (CONFIG_PLATFORM_MSTAR) -+ #define MAX_XMITBUF_SZ 7680 /* 7.5k */ -+ #else -+ #define MAX_XMITBUF_SZ (20480) /* 20k */ -+ #endif -+ #else -+ #define MAX_XMITBUF_SZ (2048) -+ #endif -+ -+ #ifdef CONFIG_SINGLE_XMIT_BUF -+ #define NR_XMITBUFF (1) -+ #else -+ #define NR_XMITBUFF (4) -+ #endif /* CONFIG_SINGLE_XMIT_BUF */ -+#elif defined (CONFIG_PCI_HCI) -+ #define MAX_XMITBUF_SZ (1664) -+ #define NR_XMITBUFF (128) -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ #define XMITBUF_ALIGN_SZ 4 -+#else -+ #ifdef CONFIG_PCI_HCI -+ #define XMITBUF_ALIGN_SZ 4 -+ #else -+ #ifdef USB_XMITBUF_ALIGN_SZ -+ #define XMITBUF_ALIGN_SZ (USB_XMITBUF_ALIGN_SZ) -+ #else -+ #define XMITBUF_ALIGN_SZ 512 -+ #endif -+ #endif -+#endif -+ -+/* xmit extension buff defination */ -+#define MAX_XMIT_EXTBUF_SZ (1536) -+ -+#ifdef CONFIG_SINGLE_XMIT_BUF -+ #define NR_XMIT_EXTBUFF (1) -+#else -+ #define NR_XMIT_EXTBUFF (32) -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ #define MAX_CMDBUF_SZ (512*14) -+#elif defined(CONFIG_RTL8723D) && defined(CONFIG_LPS_POFF) -+ #define MAX_CMDBUF_SZ (128*70) /*(8960)*/ -+#else -+ #define MAX_CMDBUF_SZ (5120) /* (4096) */ -+#endif -+ -+#define MAX_NUMBLKS (1) -+ -+#define XMIT_VO_QUEUE (0) -+#define XMIT_VI_QUEUE (1) -+#define XMIT_BE_QUEUE (2) -+#define XMIT_BK_QUEUE (3) -+ -+#define VO_QUEUE_INX 0 -+#define VI_QUEUE_INX 1 -+#define BE_QUEUE_INX 2 -+#define BK_QUEUE_INX 3 -+#define BCN_QUEUE_INX 4 -+#define MGT_QUEUE_INX 5 -+#define HIGH_QUEUE_INX 6 -+#define TXCMD_QUEUE_INX 7 -+ -+#define HW_QUEUE_ENTRY 8 -+ -+#ifdef CONFIG_PCI_HCI -+ #ifdef CONFIG_TRX_BD_ARCH -+ #define TX_BD_NUM (128+1) /* +1 result from ring buffer */ -+ #else -+ /* #define TXDESC_NUM 64 */ -+ #define TXDESC_NUM 128 -+ #define TXBD_NUM TXDESC_NUM -+ #define TXDESC_NUM_BE_QUEUE 128 -+ #define TXBD_NUM_RSVD 2 -+ #endif -+#endif -+ -+#define WEP_IV(pattrib_iv, dot11txpn, keyidx)\ -+ do {\ -+ pattrib_iv[0] = dot11txpn._byte_.TSC0;\ -+ pattrib_iv[1] = dot11txpn._byte_.TSC1;\ -+ pattrib_iv[2] = dot11txpn._byte_.TSC2;\ -+ pattrib_iv[3] = ((keyidx & 0x3)<<6);\ -+ dot11txpn.val = (dot11txpn.val == 0xffffff) ? 0 : (dot11txpn.val+1);\ -+ } while (0) -+ -+ -+#define TKIP_IV(pattrib_iv, dot11txpn, keyidx)\ -+ do {\ -+ pattrib_iv[0] = dot11txpn._byte_.TSC1;\ -+ pattrib_iv[1] = (dot11txpn._byte_.TSC1 | 0x20) & 0x7f;\ -+ pattrib_iv[2] = dot11txpn._byte_.TSC0;\ -+ pattrib_iv[3] = BIT(5) | ((keyidx & 0x3)<<6);\ -+ pattrib_iv[4] = dot11txpn._byte_.TSC2;\ -+ pattrib_iv[5] = dot11txpn._byte_.TSC3;\ -+ pattrib_iv[6] = dot11txpn._byte_.TSC4;\ -+ pattrib_iv[7] = dot11txpn._byte_.TSC5;\ -+ dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0 : (dot11txpn.val+1);\ -+ } while (0) -+ -+#define AES_IV(pattrib_iv, dot11txpn, keyidx)\ -+ do {\ -+ pattrib_iv[0] = dot11txpn._byte_.TSC0;\ -+ pattrib_iv[1] = dot11txpn._byte_.TSC1;\ -+ pattrib_iv[2] = 0;\ -+ pattrib_iv[3] = BIT(5) | ((keyidx & 0x3)<<6);\ -+ pattrib_iv[4] = dot11txpn._byte_.TSC2;\ -+ pattrib_iv[5] = dot11txpn._byte_.TSC3;\ -+ pattrib_iv[6] = dot11txpn._byte_.TSC4;\ -+ pattrib_iv[7] = dot11txpn._byte_.TSC5;\ -+ dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0 : (dot11txpn.val+1);\ -+ } while (0) -+ -+ -+#define HWXMIT_ENTRY 4 -+ -+/* For Buffer Descriptor ring architecture */ -+#if defined(BUF_DESC_ARCH) || defined(CONFIG_TRX_BD_ARCH) -+ #if defined(CONFIG_RTL8192E) -+ #define TX_BUFFER_SEG_NUM 1 /* 0:2 seg, 1: 4 seg, 2: 8 seg. */ -+ #elif defined(CONFIG_RTL8814A) -+ #define TX_BUFFER_SEG_NUM 1 /* 0:2 seg, 1: 4 seg, 2: 8 seg. */ -+ #else -+ #define TX_BUFFER_SEG_NUM 1 /* 0:2 seg, 1: 4 seg, 2: 8 seg. */ -+ #endif -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ||\ -+ defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8192E) ||\ -+ defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8703B) ||\ -+ defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8723D) -+ #define TXDESC_SIZE 40 -+#elif defined(CONFIG_RTL8822B) -+ #define TXDESC_SIZE 48 /* HALMAC_TX_DESC_SIZE_8822B */ -+#elif defined(CONFIG_RTL8821C) -+ #define TXDESC_SIZE 48 /* HALMAC_TX_DESC_SIZE_8821C */ -+#else -+ #define TXDESC_SIZE 32 /* old IC (ex: 8188E) */ -+#endif -+ -+#ifdef CONFIG_TX_EARLY_MODE -+ #define EARLY_MODE_INFO_SIZE 8 -+#endif -+ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ #define TXDESC_OFFSET TXDESC_SIZE -+#endif -+ -+#ifdef CONFIG_USB_HCI -+ #ifdef USB_PACKET_OFFSET_SZ -+ #define PACKET_OFFSET_SZ (USB_PACKET_OFFSET_SZ) -+ #else -+ #define PACKET_OFFSET_SZ (8) -+ #endif -+ #define TXDESC_OFFSET (TXDESC_SIZE + PACKET_OFFSET_SZ) -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ #if defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_TRX_BD_ARCH) -+ /* this section is defined for buffer descriptor ring architecture */ -+ #define TX_WIFI_INFO_SIZE (TXDESC_SIZE) /* it may add 802.11 hdr or others... */ -+ /* tx desc and payload are in the same buf */ -+ #define TXDESC_OFFSET (TX_WIFI_INFO_SIZE) -+ #else -+ /* tx desc and payload are NOT in the same buf */ -+ #define TXDESC_OFFSET (0) -+ /* 8188ee/8723be/8812ae/8821ae has extra PCI DMA info in tx desc */ -+ #define TX_DESC_NEXT_DESC_OFFSET (TXDESC_SIZE + 8) -+ #endif -+#endif /* CONFIG_PCI_HCI */ -+ -+enum TXDESC_SC { -+ SC_DONT_CARE = 0x00, -+ SC_UPPER = 0x01, -+ SC_LOWER = 0x02, -+ SC_DUPLICATE = 0x03 -+}; -+ -+#ifdef CONFIG_PCI_HCI -+ #ifndef CONFIG_TRX_BD_ARCH /* CONFIG_TRX_BD_ARCH doesn't need this */ -+ #define TXDESC_64_BYTES -+ #endif -+#elif defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8723B) \ -+ || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8723D) -+ #define TXDESC_40_BYTES -+#endif -+ -+#ifdef CONFIG_TRX_BD_ARCH -+struct tx_buf_desc { -+#ifdef CONFIG_64BIT_DMA -+#define TX_BUFFER_SEG_SIZE 4 /* in unit of DWORD */ -+#else -+#define TX_BUFFER_SEG_SIZE 2 /* in unit of DWORD */ -+#endif -+ unsigned int dword[TX_BUFFER_SEG_SIZE * (2 << TX_BUFFER_SEG_NUM)]; -+} __packed; -+#elif (defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B)) && defined(CONFIG_PCI_HCI) /* 8192ee or 8814ae */ -+/* 8192EE_TODO */ -+struct tx_desc { -+ unsigned int txdw0; -+ unsigned int txdw1; -+ unsigned int txdw2; -+ unsigned int txdw3; -+ unsigned int txdw4; -+ unsigned int txdw5; -+ unsigned int txdw6; -+ unsigned int txdw7; -+}; -+#else -+struct tx_desc { -+ unsigned int txdw0; -+ unsigned int txdw1; -+ unsigned int txdw2; -+ unsigned int txdw3; -+ unsigned int txdw4; -+ unsigned int txdw5; -+ unsigned int txdw6; -+ unsigned int txdw7; -+ -+#if defined(TXDESC_40_BYTES) || defined(TXDESC_64_BYTES) -+ unsigned int txdw8; -+ unsigned int txdw9; -+#endif /* TXDESC_40_BYTES */ -+ -+#ifdef TXDESC_64_BYTES -+ unsigned int txdw10; -+ unsigned int txdw11; -+ -+ /* 2008/05/15 MH Because PCIE HW memory R/W 4K limit. And now, our descriptor */ -+ /* size is 40 bytes. If you use more than 102 descriptor( 103*40>4096), HW will execute */ -+ /* memoryR/W CRC error. And then all DMA fetch will fail. We must decrease descriptor */ -+ /* number or enlarge descriptor size as 64 bytes. */ -+ unsigned int txdw12; -+ unsigned int txdw13; -+ unsigned int txdw14; -+ unsigned int txdw15; -+#endif -+}; -+#endif -+ -+#ifndef CONFIG_TRX_BD_ARCH -+union txdesc { -+ struct tx_desc txdesc; -+ unsigned int value[TXDESC_SIZE >> 2]; -+}; -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+#define PCI_MAX_TX_QUEUE_COUNT 8 /* == HW_QUEUE_ENTRY */ -+ -+struct rtw_tx_ring { -+ unsigned char qid; -+#ifdef CONFIG_TRX_BD_ARCH -+ struct tx_buf_desc *buf_desc; -+#else -+ struct tx_desc *desc; -+#endif -+ dma_addr_t dma; -+ unsigned int idx; -+ unsigned int entries; -+ _queue queue; -+ u32 qlen; -+#ifdef CONFIG_TRX_BD_ARCH -+ u16 hw_rp_cache; -+#endif -+}; -+#endif -+ -+struct hw_xmit { -+ /* _lock xmit_lock; */ -+ /* _list pending; */ -+ _queue *sta_queue; -+ /* struct hw_txqueue *phwtxqueue; */ -+ /* sint txcmdcnt; */ -+ int accnt; -+}; -+ -+#if 0 -+struct pkt_attrib { -+ u8 type; -+ u8 subtype; -+ u8 bswenc; -+ u8 dhcp_pkt; -+ u16 ether_type; -+ int pktlen; /* the original 802.3 pkt raw_data len (not include ether_hdr data) */ -+ int pkt_hdrlen; /* the original 802.3 pkt header len */ -+ int hdrlen; /* the WLAN Header Len */ -+ int nr_frags; -+ int last_txcmdsz; -+ int encrypt; /* when 0 indicate no encrypt. when non-zero, indicate the encrypt algorith */ -+ u8 iv[8]; -+ int iv_len; -+ u8 icv[8]; -+ int icv_len; -+ int priority; -+ int ack_policy; -+ int mac_id; -+ int vcs_mode; /* virtual carrier sense method */ -+ -+ u8 dst[ETH_ALEN]; -+ u8 src[ETH_ALEN]; -+ u8 ta[ETH_ALEN]; -+ u8 ra[ETH_ALEN]; -+ -+ u8 key_idx; -+ -+ u8 qos_en; -+ u8 ht_en; -+ u8 raid;/* rate adpative id */ -+ u8 bwmode; -+ u8 ch_offset;/* PRIME_CHNL_OFFSET */ -+ u8 sgi;/* short GI */ -+ u8 ampdu_en;/* tx ampdu enable */ -+ u8 mdata;/* more data bit */ -+ u8 eosp; -+ -+ u8 triggered;/* for ap mode handling Power Saving sta */ -+ -+ u32 qsel; -+ u16 seqnum; -+ -+ struct sta_info *psta; -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ u8 hw_tcp_csum; -+#endif -+}; -+#else -+/* reduce size */ -+struct pkt_attrib { -+ u8 type; -+ u8 subtype; -+ u8 bswenc; -+ u8 dhcp_pkt; -+ u16 ether_type; -+ u16 seqnum; -+ u8 hw_ssn_sel; /* for HW_SEQ0,1,2,3 */ -+ u16 pkt_hdrlen; /* the original 802.3 pkt header len */ -+ u16 hdrlen; /* the WLAN Header Len */ -+ u32 pktlen; /* the original 802.3 pkt raw_data len (not include ether_hdr data) */ -+ u32 last_txcmdsz; -+ u8 nr_frags; -+ u8 encrypt; /* when 0 indicate no encrypt. when non-zero, indicate the encrypt algorith */ -+#if defined(CONFIG_CONCURRENT_MODE) -+ u8 bmc_camid; -+#endif -+ u8 iv_len; -+ u8 icv_len; -+ u8 iv[18]; -+ u8 icv[16]; -+ u8 priority; -+ u8 ack_policy; -+ u8 mac_id; -+ u8 vcs_mode; /* virtual carrier sense method */ -+ u8 dst[ETH_ALEN]; -+ u8 src[ETH_ALEN]; -+ u8 ta[ETH_ALEN]; -+ u8 ra[ETH_ALEN]; -+ u8 key_idx; -+ u8 qos_en; -+ u8 ht_en; -+ u8 raid;/* rate adpative id */ -+ u8 bwmode; -+ u8 ch_offset;/* PRIME_CHNL_OFFSET */ -+ u8 sgi;/* short GI */ -+ u8 ampdu_en;/* tx ampdu enable */ -+ u8 ampdu_spacing; /* ampdu_min_spacing for peer sta's rx */ -+ u8 mdata;/* more data bit */ -+ u8 pctrl;/* per packet txdesc control enable */ -+ u8 triggered;/* for ap mode handling Power Saving sta */ -+ u8 qsel; -+ u8 order;/* order bit */ -+ u8 eosp; -+ u8 rate; -+ u8 intel_proxim; -+ u8 retry_ctrl; -+ u8 mbssid; -+ u8 ldpc; -+ u8 stbc; -+ struct sta_info *psta; -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ u8 hw_tcp_csum; -+#endif -+ -+ u8 rtsen; -+ u8 cts2self; -+ union Keytype dot11tkiptxmickey; -+ /* union Keytype dot11tkiprxmickey; */ -+ union Keytype dot118021x_UncstKey; -+ -+#ifdef CONFIG_TDLS -+ u8 direct_link; -+ struct sta_info *ptdls_sta; -+#endif /* CONFIG_TDLS */ -+ u8 key_type; -+ -+ u8 icmp_pkt; -+ -+#ifdef CONFIG_BEAMFORMING -+ u16 txbf_p_aid;/*beamforming Partial_AID*/ -+ u16 txbf_g_id;/*beamforming Group ID*/ -+#endif -+ -+}; -+#endif -+ -+#define WLANHDR_OFFSET 64 -+ -+#define NULL_FRAMETAG (0x0) -+#define DATA_FRAMETAG 0x01 -+#define L2_FRAMETAG 0x02 -+#define MGNT_FRAMETAG 0x03 -+#define AMSDU_FRAMETAG 0x04 -+ -+#define EII_FRAMETAG 0x05 -+#define IEEE8023_FRAMETAG 0x06 -+ -+#define MP_FRAMETAG 0x07 -+ -+#define TXAGG_FRAMETAG 0x08 -+ -+enum { -+ XMITBUF_DATA = 0, -+ XMITBUF_MGNT = 1, -+ XMITBUF_CMD = 2, -+}; -+ -+bool rtw_xmit_ac_blocked(_adapter *adapter); -+ -+struct submit_ctx { -+ u32 submit_time; /* */ -+ u32 timeout_ms; /* <0: not synchronous, 0: wait forever, >0: up to ms waiting */ -+ int status; /* status for operation */ -+#ifdef PLATFORM_LINUX -+ struct completion done; -+#endif -+}; -+ -+enum { -+ RTW_SCTX_SUBMITTED = -1, -+ RTW_SCTX_DONE_SUCCESS = 0, -+ RTW_SCTX_DONE_UNKNOWN, -+ RTW_SCTX_DONE_TIMEOUT, -+ RTW_SCTX_DONE_BUF_ALLOC, -+ RTW_SCTX_DONE_BUF_FREE, -+ RTW_SCTX_DONE_WRITE_PORT_ERR, -+ RTW_SCTX_DONE_TX_DESC_NA, -+ RTW_SCTX_DONE_TX_DENY, -+ RTW_SCTX_DONE_CCX_PKT_FAIL, -+ RTW_SCTX_DONE_DRV_STOP, -+ RTW_SCTX_DONE_DEV_REMOVE, -+ RTW_SCTX_DONE_CMD_ERROR, -+ RTW_SCTX_DONE_CMD_DROP, -+ RTX_SCTX_CSTR_WAIT_RPT2, -+}; -+ -+ -+void rtw_sctx_init(struct submit_ctx *sctx, int timeout_ms); -+int rtw_sctx_wait(struct submit_ctx *sctx, const char *msg); -+void rtw_sctx_done_err(struct submit_ctx **sctx, int status); -+void rtw_sctx_done(struct submit_ctx **sctx); -+ -+struct xmit_buf { -+ _list list; -+ -+ _adapter *padapter; -+ -+ u8 *pallocated_buf; -+ -+ u8 *pbuf; -+ -+ void *priv_data; -+ -+ u16 buf_tag; /* 0: Normal xmitbuf, 1: extension xmitbuf, 2:cmd xmitbuf */ -+ u16 flags; -+ u32 alloc_sz; -+ -+ u32 len; -+ -+ struct submit_ctx *sctx; -+ -+#ifdef CONFIG_USB_HCI -+ -+ /* u32 sz[8]; */ -+ u32 ff_hwaddr; -+#ifdef RTW_HALMAC -+ u8 bulkout_id; /* for halmac */ -+#endif /* RTW_HALMAC */ -+ -+#if defined(PLATFORM_OS_XP) || defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) -+ PURB pxmit_urb[8]; -+ dma_addr_t dma_transfer_addr; /* (in) dma addr for transfer_buffer */ -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ PIRP pxmit_irp[8]; -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ USB_TRANSFER usb_transfer_write_port; -+#endif -+ -+ u8 bpending[8]; -+ -+ sint last[8]; -+ -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ u8 *phead; -+ u8 *pdata; -+ u8 *ptail; -+ u8 *pend; -+ u32 ff_hwaddr; -+ u8 pg_num; -+ u8 agg_num; -+#ifdef PLATFORM_OS_XP -+ PMDL pxmitbuf_mdl; -+ PIRP pxmitbuf_irp; -+ PSDBUS_REQUEST_PACKET pxmitbuf_sdrp; -+#endif -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+#ifdef CONFIG_TRX_BD_ARCH -+ /*struct tx_buf_desc *buf_desc;*/ -+#else -+ struct tx_desc *desc; -+#endif -+#endif -+ -+#if defined(DBG_XMIT_BUF) || defined(DBG_XMIT_BUF_EXT) -+ u8 no; -+#endif -+ -+}; -+ -+ -+struct xmit_frame { -+ _list list; -+ -+ struct pkt_attrib attrib; -+ -+ _pkt *pkt; -+ -+ int frame_tag; -+ -+ _adapter *padapter; -+ -+ u8 *buf_addr; -+ -+ struct xmit_buf *pxmitbuf; -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ u8 pg_num; -+ u8 agg_num; -+#endif -+ -+#ifdef CONFIG_USB_HCI -+#ifdef CONFIG_USB_TX_AGGREGATION -+ u8 agg_num; -+#endif -+ s8 pkt_offset; -+#endif -+ -+#ifdef CONFIG_XMIT_ACK -+ u8 ack_report; -+#endif -+ -+ u8 *alloc_addr; /* the actual address this xmitframe allocated */ -+ u8 ext_tag; /* 0:data, 1:mgmt */ -+ -+}; -+ -+struct tx_servq { -+ _list tx_pending; -+ _queue sta_pending; -+ int qcnt; -+}; -+ -+ -+struct sta_xmit_priv { -+ _lock lock; -+ sint option; -+ sint apsd_setting; /* When bit mask is on, the associated edca queue supports APSD. */ -+ -+ -+ /* struct tx_servq blk_q[MAX_NUMBLKS]; */ -+ struct tx_servq be_q; /* priority == 0,3 */ -+ struct tx_servq bk_q; /* priority == 1,2 */ -+ struct tx_servq vi_q; /* priority == 4,5 */ -+ struct tx_servq vo_q; /* priority == 6,7 */ -+ _list legacy_dz; -+ _list apsd; -+ -+ u16 txseq_tid[16]; -+ -+ /* uint sta_tx_bytes; */ -+ /* u64 sta_tx_pkts; */ -+ /* uint sta_tx_fail; */ -+ -+ -+}; -+ -+ -+struct hw_txqueue { -+ volatile sint head; -+ volatile sint tail; -+ volatile sint free_sz; /* in units of 64 bytes */ -+ volatile sint free_cmdsz; -+ volatile sint txsz[8]; -+ uint ff_hwaddr; -+ uint cmd_hwaddr; -+ sint ac_tag; -+}; -+ -+struct agg_pkt_info { -+ u16 offset; -+ u16 pkt_len; -+}; -+ -+enum cmdbuf_type { -+ CMDBUF_BEACON = 0x00, -+ CMDBUF_RSVD, -+ CMDBUF_MAX -+}; -+ -+u8 rtw_get_hwseq_no(_adapter *padapter); -+ -+struct xmit_priv { -+ -+ _lock lock; -+ -+ _sema xmit_sema; -+ /*_sema terminate_xmitthread_sema;*/ -+ _completion xmitthread_comp; -+ -+ /* _queue blk_strms[MAX_NUMBLKS]; */ -+ _queue be_pending; -+ _queue bk_pending; -+ _queue vi_pending; -+ _queue vo_pending; -+ _queue bm_pending; -+ -+ /* _queue legacy_dz_queue; */ -+ /* _queue apsd_queue; */ -+ -+ u8 *pallocated_frame_buf; -+ u8 *pxmit_frame_buf; -+ uint free_xmitframe_cnt; -+ _queue free_xmit_queue; -+ -+ /* uint mapping_addr; */ -+ /* uint pkt_sz; */ -+ -+ u8 *xframe_ext_alloc_addr; -+ u8 *xframe_ext; -+ uint free_xframe_ext_cnt; -+ _queue free_xframe_ext_queue; -+ -+ /* struct hw_txqueue be_txqueue; */ -+ /* struct hw_txqueue bk_txqueue; */ -+ /* struct hw_txqueue vi_txqueue; */ -+ /* struct hw_txqueue vo_txqueue; */ -+ /* struct hw_txqueue bmc_txqueue; */ -+ -+ uint frag_len; -+ -+ _adapter *adapter; -+ -+ u8 vcs_setting; -+ u8 vcs; -+ u8 vcs_type; -+ /* u16 rts_thresh; */ -+ -+ u64 tx_bytes; -+ u64 tx_pkts; -+ u64 tx_drop; -+ u64 last_tx_pkts; -+ -+ struct hw_xmit *hwxmits; -+ u8 hwxmit_entry; -+ -+ u8 wmm_para_seq[4];/* sequence for wmm ac parameter strength from large to small. it's value is 0->vo, 1->vi, 2->be, 3->bk. */ -+ -+#ifdef CONFIG_USB_HCI -+ _sema tx_retevt;/* all tx return event; */ -+ u8 txirp_cnt; -+ -+#ifdef PLATFORM_OS_CE -+ USB_TRANSFER usb_transfer_write_port; -+ /* USB_TRANSFER usb_transfer_write_mem; */ -+#endif -+#ifdef PLATFORM_LINUX -+ struct tasklet_struct xmit_tasklet; -+#endif -+#ifdef PLATFORM_FREEBSD -+ struct task xmit_tasklet; -+#endif -+ /* per AC pending irp */ -+ int beq_cnt; -+ int bkq_cnt; -+ int viq_cnt; -+ int voq_cnt; -+ -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ /* Tx */ -+ struct rtw_tx_ring tx_ring[PCI_MAX_TX_QUEUE_COUNT]; -+ int txringcount[PCI_MAX_TX_QUEUE_COUNT]; -+ u8 beaconDMAing; /* flag of indicating beacon is transmiting to HW by DMA */ -+#ifdef PLATFORM_LINUX -+ struct tasklet_struct xmit_tasklet; -+#endif -+#endif -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+#ifdef CONFIG_SDIO_TX_TASKLET -+#ifdef PLATFORM_LINUX -+ struct tasklet_struct xmit_tasklet; -+#endif /* PLATFORM_LINUX */ -+#else -+ _thread_hdl_ SdioXmitThread; -+ _sema SdioXmitSema; -+ /*_sema SdioXmitTerminateSema;*/ -+ _completion sdio_xmit_thread_comp; -+#endif /* CONFIG_SDIO_TX_TASKLET */ -+#endif /* CONFIG_SDIO_HCI */ -+ -+ _queue free_xmitbuf_queue; -+ _queue pending_xmitbuf_queue; -+ u8 *pallocated_xmitbuf; -+ u8 *pxmitbuf; -+ uint free_xmitbuf_cnt; -+ -+ _queue free_xmit_extbuf_queue; -+ u8 *pallocated_xmit_extbuf; -+ u8 *pxmit_extbuf; -+ uint free_xmit_extbuf_cnt; -+ -+ struct xmit_buf pcmd_xmitbuf[CMDBUF_MAX]; -+ u8 hw_ssn_seq_no;/* mapping to REG_HW_SEQ 0,1,2,3 */ -+ u16 nqos_ssn; -+#ifdef CONFIG_TX_EARLY_MODE -+ -+#ifdef CONFIG_SDIO_HCI -+#define MAX_AGG_PKT_NUM 20 -+#else -+#define MAX_AGG_PKT_NUM 256 /* Max tx ampdu coounts */ -+#endif -+ -+ struct agg_pkt_info agg_pkt[MAX_AGG_PKT_NUM]; -+#endif -+ -+#ifdef CONFIG_XMIT_ACK -+ int ack_tx; -+ _mutex ack_tx_mutex; -+ struct submit_ctx ack_tx_ops; -+ u8 seq_no; -+#endif -+ _lock lock_sctx; -+ -+ u8 stop_req; -+}; -+ -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_cmdxmitframe(p) __rtw_alloc_cmdxmitframe(p, CMDBUF_RSVD) -+#if defined(CONFIG_RTL8192E) && defined(CONFIG_PCI_HCI) -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8192ee(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8192ee(p, CMDBUF_BEACON) -+#elif defined(CONFIG_RTL8822B) && defined(CONFIG_PCI_HCI) -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8822be(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8822be(p, CMDBUF_BEACON) -+#elif defined(CONFIG_RTL8821C) && defined(CONFIG_PCI_HCI) -+extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8821ce(struct xmit_priv *pxmitpriv, -+ enum cmdbuf_type buf_type); -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8821ce(p, CMDBUF_BEACON) -+#else -+#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe(p, CMDBUF_BEACON) -+#endif -+ -+extern struct xmit_buf *rtw_alloc_xmitbuf_ext(struct xmit_priv *pxmitpriv); -+extern s32 rtw_free_xmitbuf_ext(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+ -+extern struct xmit_buf *rtw_alloc_xmitbuf(struct xmit_priv *pxmitpriv); -+extern s32 rtw_free_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+ -+void rtw_count_tx_stats(_adapter *padapter, struct xmit_frame *pxmitframe, int sz); -+extern void rtw_update_protection(_adapter *padapter, u8 *ie, uint ie_len); -+static s32 update_attrib_sec_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta); -+static void update_attrib_phy_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta); -+extern s32 rtw_make_wlanhdr(_adapter *padapter, u8 *hdr, struct pkt_attrib *pattrib); -+extern s32 rtw_put_snap(u8 *data, u16 h_proto); -+ -+extern struct xmit_frame *rtw_alloc_xmitframe(struct xmit_priv *pxmitpriv); -+struct xmit_frame *rtw_alloc_xmitframe_ext(struct xmit_priv *pxmitpriv); -+struct xmit_frame *rtw_alloc_xmitframe_once(struct xmit_priv *pxmitpriv); -+extern s32 rtw_free_xmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe); -+extern void rtw_free_xmitframe_queue(struct xmit_priv *pxmitpriv, _queue *pframequeue); -+struct tx_servq *rtw_get_sta_pending(_adapter *padapter, struct sta_info *psta, sint up, u8 *ac); -+extern s32 rtw_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+extern struct xmit_frame *rtw_dequeue_xframe(struct xmit_priv *pxmitpriv, struct hw_xmit *phwxmit_i, sint entry); -+ -+extern s32 rtw_xmit_classifier(_adapter *padapter, struct xmit_frame *pxmitframe); -+extern u32 rtw_calculate_wlan_pkt_size_by_attribue(struct pkt_attrib *pattrib); -+#define rtw_wlan_pkt_size(f) rtw_calculate_wlan_pkt_size_by_attribue(&f->attrib) -+extern s32 rtw_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe); -+#ifdef CONFIG_IEEE80211W -+extern s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe); -+#endif /* CONFIG_IEEE80211W */ -+#ifdef CONFIG_TDLS -+extern struct tdls_txmgmt *ptxmgmt; -+s32 rtw_xmit_tdls_coalesce(_adapter *padapter, struct xmit_frame *pxmitframe, struct tdls_txmgmt *ptxmgmt); -+s32 update_tdls_attrib(_adapter *padapter, struct pkt_attrib *pattrib); -+#endif -+s32 _rtw_init_hw_txqueue(struct hw_txqueue *phw_txqueue, u8 ac_tag); -+void _rtw_init_sta_xmit_priv(struct sta_xmit_priv *psta_xmitpriv); -+ -+ -+s32 rtw_txframes_pending(_adapter *padapter); -+s32 rtw_txframes_sta_ac_pending(_adapter *padapter, struct pkt_attrib *pattrib); -+void rtw_init_hwxmits(struct hw_xmit *phwxmit, sint entry); -+ -+ -+s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, _adapter *padapter); -+void _rtw_free_xmit_priv(struct xmit_priv *pxmitpriv); -+ -+ -+void rtw_alloc_hwxmits(_adapter *padapter); -+void rtw_free_hwxmits(_adapter *padapter); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+s32 rtw_monitor_xmit_entry(struct sk_buff *skb, struct net_device *ndev); -+#endif -+s32 rtw_xmit(_adapter *padapter, _pkt **pkt); -+bool xmitframe_hiq_filter(struct xmit_frame *xmitframe); -+#if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) -+sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe); -+void stop_sta_xmit(_adapter *padapter, struct sta_info *psta); -+void wakeup_sta_to_xmit(_adapter *padapter, struct sta_info *psta); -+void xmit_delivery_enabled_frames(_adapter *padapter, struct sta_info *psta); -+#endif -+ -+u8 rtw_get_tx_bw_mode(_adapter *adapter, struct sta_info *sta); -+ -+void rtw_get_adapter_tx_rate_bmp_by_bw(_adapter *adapter, u8 bw, u16 *r_bmp_cck_ofdm, u32 *r_bmp_ht, u32 *r_bmp_vht); -+void rtw_update_tx_rate_bmp(struct dvobj_priv *dvobj); -+u16 rtw_get_tx_rate_bmp_cck_ofdm(struct dvobj_priv *dvobj); -+u32 rtw_get_tx_rate_bmp_ht_by_bw(struct dvobj_priv *dvobj, u8 bw); -+u32 rtw_get_tx_rate_bmp_vht_by_bw(struct dvobj_priv *dvobj, u8 bw); -+u8 rtw_get_tx_bw_bmp_of_ht_rate(struct dvobj_priv *dvobj, u8 rate, u8 max_bw); -+u8 rtw_get_tx_bw_bmp_of_vht_rate(struct dvobj_priv *dvobj, u8 rate, u8 max_bw); -+ -+ -+void rtw_get_adapter_tx_rate_bmp_by_bw(_adapter *adapter, u8 bw, u16 *r_bmp_cck_ofdm, u32 *r_bmp_ht, u32 *r_bmp_vht); -+void rtw_update_tx_rate_bmp(struct dvobj_priv *dvobj); -+u16 rtw_get_tx_rate_bmp_cck_ofdm(struct dvobj_priv *dvobj); -+u32 rtw_get_tx_rate_bmp_ht_by_bw(struct dvobj_priv *dvobj, u8 bw); -+u32 rtw_get_tx_rate_bmp_vht_by_bw(struct dvobj_priv *dvobj, u8 bw); -+ -+u8 query_ra_short_GI(struct sta_info *psta, u8 bw); -+ -+u8 qos_acm(u8 acm_mask, u8 priority); -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+void enqueue_pending_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+void enqueue_pending_xmitbuf_to_head(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+struct xmit_buf *dequeue_pending_xmitbuf(struct xmit_priv *pxmitpriv); -+struct xmit_buf *select_and_dequeue_pending_xmitbuf(_adapter *padapter); -+sint check_pending_xmitbuf(struct xmit_priv *pxmitpriv); -+thread_return rtw_xmit_thread(thread_context context); -+#endif -+ -+static void do_queue_select(_adapter *padapter, struct pkt_attrib *pattrib); -+u32 rtw_get_ff_hwaddr(struct xmit_frame *pxmitframe); -+ -+#ifdef CONFIG_XMIT_ACK -+int rtw_ack_tx_wait(struct xmit_priv *pxmitpriv, u32 timeout_ms); -+void rtw_ack_tx_done(struct xmit_priv *pxmitpriv, int status); -+#endif /* CONFIG_XMIT_ACK */ -+ -+ -+/* include after declaring struct xmit_buf, in order to avoid warning */ -+#include -+ -+#endif /* _RTL871X_XMIT_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sdio_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/sdio_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_hal.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,54 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_HAL_H__ -+#define __SDIO_HAL_H__ -+ -+void sd_int_dpc(PADAPTER padapter); -+u8 rtw_set_hal_ops(_adapter *padapter); -+ -+#ifdef CONFIG_RTL8188E -+void rtl8188es_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8723B -+void rtl8723bs_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8821A -+void rtl8821as_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8192E -+void rtl8192es_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8703B -+void rtl8703bs_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8723D -+void rtl8723ds_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8188F -+void rtl8188fs_set_hal_ops(PADAPTER padapter); -+#endif -+ -+#endif /* __SDIO_HAL_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops_ce.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops_ce.h ---- linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops_ce.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,54 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _SDIO_OPS_WINCE_H_ -+#define _SDIO_OPS_WINCE_H_ -+ -+#include -+#include -+#include -+#include -+ -+ -+#ifdef PLATFORM_OS_CE -+ -+ -+extern u8 sdbus_cmd52r_ce(struct intf_priv *pintfpriv, u32 addr); -+ -+ -+extern void sdbus_cmd52w_ce(struct intf_priv *pintfpriv, u32 addr, u8 val8); -+ -+ -+uint sdbus_read_blocks_to_membuf_ce(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); -+ -+extern uint sdbus_read_bytes_to_membuf_ce(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); -+ -+ -+extern uint sdbus_write_blocks_from_membuf_ce(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf, u8 async); -+ -+extern uint sdbus_write_bytes_from_membuf_ce(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); -+extern u8 sdbus_func1cmd52r_ce(struct intf_priv *pintfpriv, u32 addr); -+extern void sdbus_func1cmd52w_ce(struct intf_priv *pintfpriv, u32 addr, u8 val8); -+extern uint sdbus_read_reg(struct intf_priv *pintfpriv, u32 addr, u32 cnt, void *pdata); -+extern uint sdbus_write_reg(struct intf_priv *pintfpriv, u32 addr, u32 cnt, void *pdata); -+extern void sdio_read_int(_adapter *padapter, u32 addr, u8 sz, void *pdata); -+ -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops.h ---- linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,161 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OPS_H__ -+#define __SDIO_OPS_H__ -+ -+ -+/* Follow mac team suggestion, default I/O fail return value is 0xFF */ -+#define SDIO_ERR_VAL8 0xFF -+#define SDIO_ERR_VAL16 0xFFFF -+#define SDIO_ERR_VAL32 0xFFFFFFFF -+ -+#ifdef PLATFORM_LINUX -+#include -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+#ifdef PLATFORM_OS_XP -+#include -+struct async_context { -+ PMDL pmdl; -+ PSDBUS_REQUEST_PACKET sdrp; -+ unsigned char *r_buf; -+ unsigned char *padapter; -+}; -+#endif -+ -+#ifdef PLATFORM_OS_CE -+#include -+#endif -+ -+#endif /* PLATFORM_WINDOWS */ -+ -+ -+extern void sdio_set_intf_ops(_adapter *padapter, struct _io_ops *pops); -+ -+#if 0 -+extern void sdio_func1cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem); -+extern void sdio_func1cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem); -+#endif -+extern u8 SdioLocalCmd52Read1Byte(PADAPTER padapter, u32 addr); -+extern void SdioLocalCmd52Write1Byte(PADAPTER padapter, u32 addr, u8 v); -+extern s32 _sdio_local_read(PADAPTER padapter, u32 addr, u32 cnt, u8 *pbuf); -+extern s32 sdio_local_read(PADAPTER padapter, u32 addr, u32 cnt, u8 *pbuf); -+extern s32 _sdio_local_write(PADAPTER padapter, u32 addr, u32 cnt, u8 *pbuf); -+extern s32 sdio_local_write(PADAPTER padapter, u32 addr, u32 cnt, u8 *pbuf); -+ -+u32 _sdio_read32(PADAPTER padapter, u32 addr); -+s32 _sdio_write32(PADAPTER padapter, u32 addr, u32 val); -+ -+extern void sd_int_hdl(PADAPTER padapter); -+extern u8 CheckIPSStatus(PADAPTER padapter); -+ -+#ifdef CONFIG_RTL8188E -+extern void InitInterrupt8188ESdio(PADAPTER padapter); -+extern void EnableInterrupt8188ESdio(PADAPTER padapter); -+extern void DisableInterrupt8188ESdio(PADAPTER padapter); -+extern void UpdateInterruptMask8188ESdio(PADAPTER padapter, u32 AddMSR, u32 RemoveMSR); -+extern u8 HalQueryTxBufferStatus8189ESdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8189ESdio(PADAPTER padapter); -+extern void ClearInterrupt8188ESdio(PADAPTER padapter); -+#endif /* CONFIG_RTL8188E */ -+ -+#ifdef CONFIG_RTL8821A -+extern void InitInterrupt8821AS(PADAPTER padapter); -+extern void EnableInterrupt8821AS(PADAPTER padapter); -+extern void DisableInterrupt8821AS(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8821AS(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8821ASdio(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+void ClearInterrupt8821AS(PADAPTER padapter); -+#endif /* defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) */ -+#endif /* CONFIG_RTL8821A */ -+ -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+#ifdef CONFIG_RTL8821C -+u8 rtw_hal_enable_cpwm2(_adapter *adapter); -+#endif -+extern u8 RecvOnePkt(PADAPTER padapter, u32 size); -+#endif /* CONFIG_WOWLAN */ -+#ifdef CONFIG_RTL8723B -+extern void InitInterrupt8723BSdio(PADAPTER padapter); -+extern void InitSysInterrupt8723BSdio(PADAPTER padapter); -+extern void EnableInterrupt8723BSdio(PADAPTER padapter); -+extern void DisableInterrupt8723BSdio(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8723BSdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8723BSdio(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern void DisableInterruptButCpwm28723BSdio(PADAPTER padapter); -+extern void ClearInterrupt8723BSdio(PADAPTER padapter); -+#endif /* CONFIG_WOWLAN */ -+#endif -+ -+ -+#ifdef CONFIG_RTL8192E -+extern void InitInterrupt8192ESdio(PADAPTER padapter); -+extern void EnableInterrupt8192ESdio(PADAPTER padapter); -+extern void DisableInterrupt8192ESdio(PADAPTER padapter); -+extern void UpdateInterruptMask8192ESdio(PADAPTER padapter, u32 AddMSR, u32 RemoveMSR); -+extern u8 HalQueryTxBufferStatus8192ESdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8192ESdio(PADAPTER padapter); -+extern void ClearInterrupt8192ESdio(PADAPTER padapter); -+#endif /* CONFIG_RTL8192E */ -+ -+#ifdef CONFIG_RTL8703B -+extern void InitInterrupt8703BSdio(PADAPTER padapter); -+extern void InitSysInterrupt8703BSdio(PADAPTER padapter); -+extern void EnableInterrupt8703BSdio(PADAPTER padapter); -+extern void DisableInterrupt8703BSdio(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8703BSdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8703BSdio(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern void DisableInterruptButCpwm28703BSdio(PADAPTER padapter); -+extern void ClearInterrupt8703BSdio(PADAPTER padapter); -+#endif /* CONFIG_WOWLAN */ -+#endif -+ -+#ifdef CONFIG_RTL8723D -+extern void InitInterrupt8723DSdio(PADAPTER padapter); -+extern void InitSysInterrupt8723DSdio(PADAPTER padapter); -+extern void EnableInterrupt8723DSdio(PADAPTER padapter); -+extern void DisableInterrupt8723DSdio(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8723DSdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8723DSdio(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern void DisableInterruptButCpwm28723dSdio(PADAPTER padapter); -+#endif /* CONFIG_WOWLAN */ -+extern void ClearInterrupt8723DSdio(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RTL8188F -+extern void InitInterrupt8188FSdio(PADAPTER padapter); -+extern void InitSysInterrupt8188FSdio(PADAPTER padapter); -+extern void EnableInterrupt8188FSdio(PADAPTER padapter); -+extern void DisableInterrupt8188FSdio(PADAPTER padapter); -+extern u8 HalQueryTxBufferStatus8188FSdio(PADAPTER padapter); -+extern u8 HalQueryTxOQTBufferStatus8188FSdio(PADAPTER padapter); -+#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -+extern void DisableInterruptButCpwm28188FSdio(PADAPTER padapter); -+extern void ClearInterrupt8188FSdio(PADAPTER padapter); -+#endif /* defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) */ -+#endif -+ -+#endif /* !__SDIO_OPS_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops_linux.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops_linux.h ---- linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops_linux.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,53 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OPS_LINUX_H__ -+#define __SDIO_OPS_LINUX_H__ -+ -+#ifndef RTW_HALMAC -+u8 sd_f0_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+void sd_f0_write8(struct intf_hdl *pintfhdl, u32 addr, u8 v, s32 *err); -+ -+s32 _sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); -+s32 _sd_cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); -+s32 sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); -+s32 sd_cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata); -+ -+u8 _sd_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+u8 sd_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+u16 sd_read16(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+u32 _sd_read32(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+u32 sd_read32(struct intf_hdl *pintfhdl, u32 addr, s32 *err); -+void sd_write8(struct intf_hdl *pintfhdl, u32 addr, u8 v, s32 *err); -+void sd_write16(struct intf_hdl *pintfhdl, u32 addr, u16 v, s32 *err); -+void _sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err); -+void sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err); -+#endif /* RTW_HALMAC */ -+ -+s32 _sd_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); -+s32 sd_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); -+s32 _sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); -+s32 sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); -+ -+void rtw_sdio_set_irq_thd(struct dvobj_priv *dvobj, _thread_hdl_ thd_hdl); -+int __must_check rtw_sdio_raw_read(struct dvobj_priv *d, int addr, -+ void *buf, size_t len, bool fixed); -+int __must_check rtw_sdio_raw_write(struct dvobj_priv *d, int addr, -+ void *buf, size_t len, bool fixed); -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops_xp.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops_xp.h ---- linux-4.14.18/3rdparty/rtl8723de/include/sdio_ops_xp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_ops_xp.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,54 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _SDIO_OPS_XP_H_ -+#define _SDIO_OPS_XP_H_ -+ -+#include -+#include -+#include -+#include -+ -+ -+#ifdef PLATFORM_OS_XP -+ -+ -+extern u8 sdbus_cmd52r_xp(struct intf_priv *pintfpriv, u32 addr); -+ -+ -+extern void sdbus_cmd52w_xp(struct intf_priv *pintfpriv, u32 addr, u8 val8); -+ -+ -+uint sdbus_read_blocks_to_membuf_xp(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); -+ -+extern uint sdbus_read_bytes_to_membuf_xp(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); -+ -+ -+extern uint sdbus_write_blocks_from_membuf_xp(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf, u8 async); -+ -+extern uint sdbus_write_bytes_from_membuf_xp(struct intf_priv *pintfpriv, u32 addr, u32 cnt, u8 *pbuf); -+extern u8 sdbus_func1cmd52r_xp(struct intf_priv *pintfpriv, u32 addr); -+extern void sdbus_func1cmd52w_xp(struct intf_priv *pintfpriv, u32 addr, u8 val8); -+extern uint sdbus_read_reg(struct intf_priv *pintfpriv, u32 addr, u32 cnt, void *pdata); -+extern uint sdbus_write_reg(struct intf_priv *pintfpriv, u32 addr, u32 cnt, void *pdata); -+extern void sdio_read_int(_adapter *padapter, u32 addr, u8 sz, void *pdata); -+ -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sdio_osintf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_osintf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/sdio_osintf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sdio_osintf.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __SDIO_OSINTF_H__ -+#define __SDIO_OSINTF_H__ -+ -+ -+#ifdef PLATFORM_OS_CE -+extern NDIS_STATUS ce_sd_get_dev_hdl(PADAPTER padapter); -+SD_API_STATUS ce_sd_int_callback(SD_DEVICE_HANDLE hDevice, PADAPTER padapter); -+extern void sd_setup_irs(PADAPTER padapter); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/sta_info.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/sta_info.h ---- linux-4.14.18/3rdparty/rtl8723de/include/sta_info.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/sta_info.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,628 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __STA_INFO_H_ -+#define __STA_INFO_H_ -+ -+ -+#define IBSS_START_MAC_ID 2 -+#define NUM_STA MACID_NUM_SW_LIMIT -+ -+#ifndef CONFIG_RTW_MACADDR_ACL -+ #define CONFIG_RTW_MACADDR_ACL 1 -+#endif -+#define NUM_ACL 16 -+#define RTW_ACL_MODE_DISABLED 0 -+#define RTW_ACL_MODE_ACCEPT_UNLESS_LISTED 1 -+#define RTW_ACL_MODE_DENY_UNLESS_LISTED 2 -+#define RTW_ACL_MODE_MAX 3 -+ -+#if CONFIG_RTW_MACADDR_ACL -+extern const char *const _acl_mode_str[]; -+#define acl_mode_str(mode) (((mode) >= RTW_ACL_MODE_MAX) ? _acl_mode_str[RTW_ACL_MODE_DISABLED] : _acl_mode_str[(mode)]) -+#endif -+ -+#ifdef CONFIG_TDLS -+#define MAX_ALLOWED_TDLS_STA_NUM 4 -+#endif -+ -+enum sta_info_update_type { -+ STA_INFO_UPDATE_NONE = 0, -+ STA_INFO_UPDATE_BW = BIT(0), -+ STA_INFO_UPDATE_RATE = BIT(1), -+ STA_INFO_UPDATE_PROTECTION_MODE = BIT(2), -+ STA_INFO_UPDATE_CAP = BIT(3), -+ STA_INFO_UPDATE_HT_CAP = BIT(4), -+ STA_INFO_UPDATE_VHT_CAP = BIT(5), -+ STA_INFO_UPDATE_ALL = STA_INFO_UPDATE_BW -+ | STA_INFO_UPDATE_RATE -+ | STA_INFO_UPDATE_PROTECTION_MODE -+ | STA_INFO_UPDATE_CAP -+ | STA_INFO_UPDATE_HT_CAP -+ | STA_INFO_UPDATE_VHT_CAP, -+ STA_INFO_UPDATE_MAX -+}; -+ -+struct rtw_wlan_acl_node { -+ _list list; -+ u8 addr[ETH_ALEN]; -+ u8 valid; -+}; -+ -+struct wlan_acl_pool { -+ int mode; -+ int num; -+ struct rtw_wlan_acl_node aclnode[NUM_ACL]; -+ _queue acl_node_q; -+}; -+ -+typedef struct _RSSI_STA { -+ s32 UndecoratedSmoothedPWDB; -+ s32 UndecoratedSmoothedCCK; -+ s32 UndecoratedSmoothedOFDM; -+ u8 OFDM_pkt; -+ u8 CCK_pkt; -+ u16 CCK_sum_power; -+ u8 bsend_rssi; -+ u64 PacketMap; -+ u8 ValidBit; -+} RSSI_STA, *PRSSI_STA; -+ -+struct stainfo_stats { -+ -+ u64 rx_mgnt_pkts; -+ u64 rx_beacon_pkts; -+ u64 rx_probereq_pkts; -+ u64 rx_probersp_pkts; -+ u64 rx_probersp_bm_pkts; -+ u64 rx_probersp_uo_pkts; -+ u64 rx_ctrl_pkts; -+ u64 rx_data_pkts; -+ u64 rx_data_qos_pkts[TID_NUM]; -+ u64 last_rx_mgnt_pkts; -+ u64 last_rx_beacon_pkts; -+ u64 last_rx_probereq_pkts; -+ u64 last_rx_probersp_pkts; -+ u64 last_rx_probersp_bm_pkts; -+ u64 last_rx_probersp_uo_pkts; -+ u64 last_rx_ctrl_pkts; -+ u64 last_rx_data_pkts; -+ u64 last_rx_data_qos_pkts[TID_NUM]; -+#ifdef CONFIG_TDLS -+ u64 rx_tdls_disc_rsp_pkts; -+ u64 last_rx_tdls_disc_rsp_pkts; -+#endif -+ u64 rx_bytes; -+ u64 rx_drops; -+ -+ u64 tx_pkts; -+ u64 tx_bytes; -+ u64 tx_drops; -+}; -+ -+#ifndef DBG_SESSION_TRACKER -+#define DBG_SESSION_TRACKER 0 -+#endif -+ -+/* session tracker status */ -+#define ST_STATUS_NONE 0 -+#define ST_STATUS_CHECK BIT0 -+#define ST_STATUS_ESTABLISH BIT1 -+#define ST_STATUS_EXPIRE BIT2 -+ -+#define ST_EXPIRE_MS (10 * 1000) -+ -+struct session_tracker { -+ _list list; /* session_tracker_queue */ -+ u32 local_naddr; -+ u16 local_port; -+ u32 remote_naddr; -+ u16 remote_port; -+ u32 set_time; -+ u8 status; -+}; -+ -+/* session tracker cmd */ -+#define ST_CMD_ADD 0 -+#define ST_CMD_DEL 1 -+#define ST_CMD_CHK 2 -+ -+struct st_cmd_parm { -+ u8 cmd; -+ struct sta_info *sta; -+ u32 local_naddr; /* TODO: IPV6 */ -+ u16 local_port; -+ u32 remote_naddr; /* TODO: IPV6 */ -+ u16 remote_port; -+}; -+ -+typedef bool (*st_match_rule)(_adapter *adapter, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port); -+ -+struct st_register { -+ u8 s_proto; -+ st_match_rule rule; -+}; -+ -+#define SESSION_TRACKER_REG_ID_WFD 0 -+#define SESSION_TRACKER_REG_ID_NUM 1 -+ -+struct st_ctl_t { -+ struct st_register reg[SESSION_TRACKER_REG_ID_NUM]; -+ _queue tracker_q; -+}; -+ -+void rtw_st_ctl_init(struct st_ctl_t *st_ctl); -+void rtw_st_ctl_deinit(struct st_ctl_t *st_ctl); -+void rtw_st_ctl_register(struct st_ctl_t *st_ctl, u8 st_reg_id, struct st_register *reg); -+void rtw_st_ctl_unregister(struct st_ctl_t *st_ctl, u8 st_reg_id); -+bool rtw_st_ctl_chk_reg_s_proto(struct st_ctl_t *st_ctl, u8 s_proto); -+bool rtw_st_ctl_chk_reg_rule(struct st_ctl_t *st_ctl, _adapter *adapter, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port); -+void dump_st_ctl(void *sel, struct st_ctl_t *st_ctl); -+ -+#ifdef CONFIG_TDLS -+struct TDLS_PeerKey { -+ u8 kck[16]; /* TPK-KCK */ -+ u8 tk[16]; /* TPK-TK; only CCMP will be used */ -+} ; -+#endif /* CONFIG_TDLS */ -+ -+#ifdef DBG_RX_DFRAME_RAW_DATA -+struct sta_recv_dframe_info { -+ -+ u8 sta_data_rate; -+ u8 sta_sgi; -+ u8 sta_bw_mode; -+ s8 sta_mimo_signal_strength[4]; -+ s8 sta_RxPwr[4]; -+ u8 sta_ofdm_snr[4]; -+}; -+#endif -+ -+struct sta_info { -+ -+ _lock lock; -+ _list list; /* free_sta_queue */ -+ _list hash_list; /* sta_hash */ -+ /* _list asoc_list; */ /* 20061114 */ -+ /* _list sleep_list; */ /* sleep_q */ -+ /* _list wakeup_list; */ /* wakeup_q */ -+ _adapter *padapter; -+ -+ struct sta_xmit_priv sta_xmitpriv; -+ struct sta_recv_priv sta_recvpriv; -+ -+#ifdef DBG_RX_DFRAME_RAW_DATA -+ struct sta_recv_dframe_info sta_dframe_info; -+#endif -+ _queue sleep_q; -+ unsigned int sleepq_len; -+ -+ uint state; -+ uint aid; -+ uint mac_id; -+ uint qos_option; -+ u8 hwaddr[ETH_ALEN]; -+ u16 hwseq; -+ u8 ra_rpt_linked; -+ -+ uint ieee8021x_blocked; /* 0: allowed, 1:blocked */ -+ uint dot118021XPrivacy; /* aes, tkip... */ -+ union Keytype dot11tkiptxmickey; -+ union Keytype dot11tkiprxmickey; -+ union Keytype dot118021x_UncstKey; -+ union pn48 dot11txpn; /* PN48 used for Unicast xmit */ -+#ifdef CONFIG_GTK_OL -+ u8 kek[RTW_KEK_LEN]; -+ u8 kck[RTW_KCK_LEN]; -+ u8 replay_ctr[RTW_REPLAY_CTR_LEN]; -+#endif /* CONFIG_GTK_OL */ -+#ifdef CONFIG_IEEE80211W -+ union pn48 dot11wtxpn; /* PN48 used for Unicast mgmt xmit. */ -+ _timer dot11w_expire_timer; -+#endif /* CONFIG_IEEE80211W */ -+ union pn48 dot11rxpn; /* PN48 used for Unicast recv. */ -+ -+ -+ u8 bssrateset[16]; -+ u32 bssratelen; -+ s32 rssi; -+ s32 signal_quality; -+ -+ u8 cts2self; -+ u8 rtsen; -+ -+ u8 raid; -+ u8 init_rate; -+ u64 ra_mask; -+ u8 wireless_mode; /* NETWORK_TYPE */ -+ u8 bw_mode; -+ -+ u8 ldpc; -+ u8 stbc; -+ -+#ifdef CONFIG_BEAMFORMING -+ u16 txbf_paid; -+ u16 txbf_gid; -+#endif -+ -+ struct stainfo_stats sta_stats; -+ -+#ifdef CONFIG_TDLS -+ u32 tdls_sta_state; -+ u8 SNonce[32]; -+ u8 ANonce[32]; -+ u32 TDLS_PeerKey_Lifetime; -+ u32 TPK_count; -+ _timer TPK_timer; -+ struct TDLS_PeerKey tpk; -+#ifdef CONFIG_TDLS_CH_SW -+ u16 ch_switch_time; -+ u16 ch_switch_timeout; -+ /* u8 option; */ -+ _timer ch_sw_timer; -+ _timer delay_timer; -+ _timer stay_on_base_chnl_timer; -+ _timer ch_sw_monitor_timer; -+#endif -+ _timer handshake_timer; -+ u8 alive_count; -+ _timer pti_timer; -+ u8 TDLS_RSNIE[20]; /* Save peer's RSNIE, used for sending TDLS_SETUP_RSP */ -+#endif /* CONFIG_TDLS */ -+ -+ /* for A-MPDU TX, ADDBA timeout check */ -+ _timer addba_retry_timer; -+ -+ /* for A-MPDU Rx reordering buffer control */ -+ struct recv_reorder_ctrl recvreorder_ctrl[TID_NUM]; -+ ATOMIC_T continual_no_rx_packet[TID_NUM]; -+ /* for A-MPDU Tx */ -+ /* unsigned char ampdu_txen_bitmap; */ -+ u16 BA_starting_seqctrl[16]; -+ -+ -+#ifdef CONFIG_80211N_HT -+ struct ht_priv htpriv; -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv vhtpriv; -+#endif -+ -+ /* Notes: */ -+ /* STA_Mode: */ -+ /* curr_network(mlme_priv/security_priv/qos/ht) + sta_info: (STA & AP) CAP/INFO */ -+ /* scan_q: AP CAP/INFO */ -+ -+ /* AP_Mode: */ -+ /* curr_network(mlme_priv/security_priv/qos/ht) : AP CAP/INFO */ -+ /* sta_info: (AP & STA) CAP/INFO */ -+ -+ unsigned int expire_to; -+ u8 bpairwise_key_installed; -+ -+#ifdef CONFIG_AP_MODE -+ -+ _list asoc_list; -+ _list auth_list; -+ -+ unsigned int auth_seq; -+ unsigned int authalg; -+ unsigned char chg_txt[128]; -+ -+ u16 capability; -+ int flags; -+ -+ int dot8021xalg;/* 0:disable, 1:psk, 2:802.1x */ -+ int wpa_psk;/* 0:disable, bit(0): WPA, bit(1):WPA2 */ -+ int wpa_group_cipher; -+ int wpa2_group_cipher; -+ int wpa_pairwise_cipher; -+ int wpa2_pairwise_cipher; -+ -+#ifdef CONFIG_RTW_80211R -+ u8 ft_pairwise_key_installed; -+#endif -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ u8 wpa_ie[32]; -+ -+ u8 nonerp_set; -+ u8 no_short_slot_time_set; -+ u8 no_short_preamble_set; -+ u8 no_ht_gf_set; -+ u8 no_ht_set; -+ u8 ht_20mhz_set; -+ u8 ht_40mhz_intolerant; -+#endif /* CONFIG_NATIVEAP_MLME */ -+ -+#ifdef CONFIG_ATMEL_RC_PATCH -+ u8 flag_atmel_rc; -+#endif -+ -+ u8 qos_info; -+ -+ u8 max_sp_len; -+ u8 uapsd_bk;/* BIT(0): Delivery enabled, BIT(1): Trigger enabled */ -+ u8 uapsd_be; -+ u8 uapsd_vi; -+ u8 uapsd_vo; -+ -+ u8 has_legacy_ac; -+ unsigned int sleepq_ac_len; -+ -+#ifdef CONFIG_P2P -+ /* p2p priv data */ -+ u8 is_p2p_device; -+ u8 p2p_status_code; -+ -+ /* p2p client info */ -+ u8 dev_addr[ETH_ALEN]; -+ /* u8 iface_addr[ETH_ALEN]; */ /* = hwaddr[ETH_ALEN] */ -+ u8 dev_cap; -+ u16 config_methods; -+ u8 primary_dev_type[8]; -+ u8 num_of_secdev_type; -+ u8 secdev_types_list[32];/* 32/8 == 4; */ -+ u16 dev_name_len; -+ u8 dev_name[32]; -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_WFD -+ u8 op_wfd_mode; -+#endif -+ -+#ifdef CONFIG_TX_MCAST2UNI -+ u8 under_exist_checking; -+#endif /* CONFIG_TX_MCAST2UNI */ -+ -+ u8 keep_alive_trycnt; -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ u8 isrc; /* this device is rc */ -+ u16 pid; /* pairing id */ -+#endif -+ -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ u8 *passoc_req; -+ u32 assoc_req_len; -+#endif -+ -+ /* for DM */ -+ RSSI_STA rssi_stat; -+ -+ /* ODM_STA_INFO_T */ -+ /* ================ODM Relative Info======================= */ -+ /* Please be care, dont declare too much structure here. It will cost memory * STA support num. */ -+ /* */ -+ /* */ -+ /* 2011/10/20 MH Add for ODM STA info. */ -+ /* */ -+ /* Driver Write */ -+ u8 bValid; /* record the sta status link or not? */ -+ /* u8 WirelessMode; */ /* */ -+ u8 IOTPeer; /* Enum value. HT_IOT_PEER_E */ -+ /* ODM Write */ -+ /* 1 PHY_STATUS_INFO */ -+ u8 RSSI_Path[4]; /* */ -+ u8 RSSI_Ave; -+ u8 RXEVM[4]; -+ u8 RXSNR[4]; -+ -+ u8 rssi_level; /* for Refresh RA mask */ -+ /* ODM Write */ -+ /* 1 TX_INFO (may changed by IC) */ -+ /* TX_INFO_T pTxInfo; */ /* Define in IC folder. Move lower layer. */ -+ /* */ -+ /* ================ODM Relative Info======================= */ -+ /* */ -+ -+ /* To store the sequence number of received management frame */ -+ u16 RxMgmtFrameSeqNum; -+ -+ struct st_ctl_t st_ctl; -+}; -+ -+#define sta_rx_pkts(sta) \ -+ (sta->sta_stats.rx_mgnt_pkts \ -+ + sta->sta_stats.rx_ctrl_pkts \ -+ + sta->sta_stats.rx_data_pkts) -+ -+#define sta_last_rx_pkts(sta) \ -+ (sta->sta_stats.last_rx_mgnt_pkts \ -+ + sta->sta_stats.last_rx_ctrl_pkts \ -+ + sta->sta_stats.last_rx_data_pkts) -+ -+#define sta_rx_data_pkts(sta) \ -+ (sta->sta_stats.rx_data_pkts) -+ -+#define sta_rx_data_qos_pkts(sta, i) \ -+ (sta->sta_stats.rx_data_qos_pkts[i]) -+ -+#define sta_last_rx_data_pkts(sta) \ -+ (sta->sta_stats.last_rx_data_pkts) -+ -+#define sta_last_rx_data_qos_pkts(sta, i) \ -+ (sta->sta_stats.last_rx_data_qos_pkts[i]) -+ -+#define sta_rx_mgnt_pkts(sta) \ -+ (sta->sta_stats.rx_mgnt_pkts) -+ -+#define sta_last_rx_mgnt_pkts(sta) \ -+ (sta->sta_stats.last_rx_mgnt_pkts) -+ -+#define sta_rx_beacon_pkts(sta) \ -+ (sta->sta_stats.rx_beacon_pkts) -+ -+#define sta_last_rx_beacon_pkts(sta) \ -+ (sta->sta_stats.last_rx_beacon_pkts) -+ -+#define sta_rx_probereq_pkts(sta) \ -+ (sta->sta_stats.rx_probereq_pkts) -+ -+#define sta_last_rx_probereq_pkts(sta) \ -+ (sta->sta_stats.last_rx_probereq_pkts) -+ -+#define sta_rx_probersp_pkts(sta) \ -+ (sta->sta_stats.rx_probersp_pkts) -+ -+#define sta_last_rx_probersp_pkts(sta) \ -+ (sta->sta_stats.last_rx_probersp_pkts) -+ -+#define sta_rx_probersp_bm_pkts(sta) \ -+ (sta->sta_stats.rx_probersp_bm_pkts) -+ -+#define sta_last_rx_probersp_bm_pkts(sta) \ -+ (sta->sta_stats.last_rx_probersp_bm_pkts) -+ -+#define sta_rx_probersp_uo_pkts(sta) \ -+ (sta->sta_stats.rx_probersp_uo_pkts) -+ -+#define sta_last_rx_probersp_uo_pkts(sta) \ -+ (sta->sta_stats.last_rx_probersp_uo_pkts) -+ -+#define sta_update_last_rx_pkts(sta) \ -+ do { \ -+ sta->sta_stats.last_rx_mgnt_pkts = sta->sta_stats.rx_mgnt_pkts; \ -+ sta->sta_stats.last_rx_beacon_pkts = sta->sta_stats.rx_beacon_pkts; \ -+ sta->sta_stats.last_rx_probereq_pkts = sta->sta_stats.rx_probereq_pkts; \ -+ sta->sta_stats.last_rx_probersp_pkts = sta->sta_stats.rx_probersp_pkts; \ -+ sta->sta_stats.last_rx_probersp_bm_pkts = sta->sta_stats.rx_probersp_bm_pkts; \ -+ sta->sta_stats.last_rx_probersp_uo_pkts = sta->sta_stats.rx_probersp_uo_pkts; \ -+ sta->sta_stats.last_rx_ctrl_pkts = sta->sta_stats.rx_ctrl_pkts; \ -+ sta->sta_stats.last_rx_data_pkts = sta->sta_stats.rx_data_pkts; \ -+ } while (0) -+ -+#define STA_RX_PKTS_ARG(sta) \ -+ sta->sta_stats.rx_mgnt_pkts \ -+ , sta->sta_stats.rx_ctrl_pkts \ -+ , sta->sta_stats.rx_data_pkts -+ -+#define STA_LAST_RX_PKTS_ARG(sta) \ -+ sta->sta_stats.last_rx_mgnt_pkts \ -+ , sta->sta_stats.last_rx_ctrl_pkts \ -+ , sta->sta_stats.last_rx_data_pkts -+ -+#define STA_RX_PKTS_DIFF_ARG(sta) \ -+ sta->sta_stats.rx_mgnt_pkts - sta->sta_stats.last_rx_mgnt_pkts \ -+ , sta->sta_stats.rx_ctrl_pkts - sta->sta_stats.last_rx_ctrl_pkts \ -+ , sta->sta_stats.rx_data_pkts - sta->sta_stats.last_rx_data_pkts -+ -+#define STA_PKTS_FMT "(m:%llu, c:%llu, d:%llu)" -+ -+#ifdef CONFIG_WFD -+#define STA_OP_WFD_MODE(sta) (sta)->op_wfd_mode -+#define STA_SET_OP_WFD_MODE(sta, mode) (sta)->op_wfd_mode = (mode) -+#else -+#define STA_OP_WFD_MODE(sta) 0 -+#define STA_SET_OP_WFD_MODE(sta, mode) do {} while (0) -+#endif -+ -+struct sta_priv { -+ -+ u8 *pallocated_stainfo_buf; -+ u8 *pstainfo_buf; -+ _queue free_sta_queue; -+ -+ _lock sta_hash_lock; -+ _list sta_hash[NUM_STA]; -+ int asoc_sta_count; -+ _queue sleep_q; -+ _queue wakeup_q; -+ -+ _adapter *padapter; -+ -+ u32 adhoc_expire_to; -+ -+#ifdef CONFIG_AP_MODE -+ _list asoc_list; -+ _list auth_list; -+ _lock asoc_list_lock; -+ _lock auth_list_lock; -+ u8 asoc_list_cnt; -+ u8 auth_list_cnt; -+ -+ unsigned int auth_to; /* sec, time to expire in authenticating. */ -+ unsigned int assoc_to; /* sec, time to expire before associating. */ -+ unsigned int expire_to; /* sec , time to expire after associated. */ -+ -+ /* pointers to STA info; based on allocated AID or NULL if AID free -+ * AID is in the range 1-2007, so sta_aid[0] corresponders to AID 1 -+ * and so on -+ */ -+ struct sta_info *sta_aid[NUM_STA]; -+ -+ u16 sta_dz_bitmap;/* only support 15 stations, staion aid bitmap for sleeping sta. */ -+ u16 tim_bitmap;/* only support 15 stations, aid=0~15 mapping bit0~bit15 */ -+ -+ u16 max_num_sta; -+ -+#ifdef CONFIG_RTW_MACADDR_ACL -+ struct wlan_acl_pool acl_list; -+#endif -+ -+#endif -+ -+#ifdef CONFIG_ATMEL_RC_PATCH -+ u8 atmel_rc_pattern[6]; -+#endif -+ -+}; -+ -+ -+__inline static u32 wifi_mac_hash(u8 *mac) -+{ -+ u32 x; -+ -+ x = mac[0]; -+ x = (x << 2) ^ mac[1]; -+ x = (x << 2) ^ mac[2]; -+ x = (x << 2) ^ mac[3]; -+ x = (x << 2) ^ mac[4]; -+ x = (x << 2) ^ mac[5]; -+ -+ x ^= x >> 8; -+ x = x & (NUM_STA - 1); -+ -+ return x; -+} -+ -+ -+extern u32 _rtw_init_sta_priv(struct sta_priv *pstapriv); -+extern u32 _rtw_free_sta_priv(struct sta_priv *pstapriv); -+ -+#define stainfo_offset_valid(offset) (offset < NUM_STA && offset >= 0) -+int rtw_stainfo_offset(struct sta_priv *stapriv, struct sta_info *sta); -+struct sta_info *rtw_get_stainfo_by_offset(struct sta_priv *stapriv, int offset); -+ -+extern struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr); -+extern u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta); -+extern void rtw_free_all_stainfo(_adapter *padapter); -+extern struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr); -+extern u32 rtw_init_bcmc_stainfo(_adapter *padapter); -+extern struct sta_info *rtw_get_bcmc_stainfo(_adapter *padapter); -+ -+#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) -+extern u8 rtw_access_ctrl(_adapter *adapter, u8 *mac_addr); -+void dump_macaddr_acl(void *sel, _adapter *adapter); -+#endif -+ -+#endif /* _STA_INFO_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/usb_hal.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_hal.h ---- linux-4.14.18/3rdparty/rtl8723de/include/usb_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_hal.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,67 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __USB_HAL_H__ -+#define __USB_HAL_H__ -+ -+int usb_init_recv_priv(_adapter *padapter, u16 ini_in_buf_sz); -+void usb_free_recv_priv(_adapter *padapter, u16 ini_in_buf_sz); -+#ifdef CONFIG_FW_C2H_REG -+void usb_c2h_hisr_hdl(_adapter *adapter, u8 *buf); -+#endif -+ -+u8 rtw_set_hal_ops(_adapter *padapter); -+ -+#ifdef CONFIG_RTL8188E -+void rtl8188eu_set_hal_ops(_adapter *padapter); -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+void rtl8812au_set_hal_ops(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_RTL8192E -+void rtl8192eu_set_hal_ops(_adapter *padapter); -+#endif -+ -+ -+#ifdef CONFIG_RTL8723B -+void rtl8723bu_set_hal_ops(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_RTL8814A -+void rtl8814au_set_hal_ops(_adapter *padapter); -+#endif /* CONFIG_RTL8814A */ -+ -+#ifdef CONFIG_RTL8188F -+void rtl8188fu_set_hal_ops(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_RTL8703B -+void rtl8703bu_set_hal_ops(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_RTL8723D -+void rtl8723du_set_hal_ops(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_INTEL_PROXIM -+extern _adapter *rtw_usb_get_sw_pointer(void); -+#endif /* CONFIG_INTEL_PROXIM */ -+#endif /* __USB_HAL_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/usb_ops.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_ops.h ---- linux-4.14.18/3rdparty/rtl8723de/include/usb_ops.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_ops.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,133 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __USB_OPS_H_ -+#define __USB_OPS_H_ -+ -+ -+#define REALTEK_USB_VENQT_READ 0xC0 -+#define REALTEK_USB_VENQT_WRITE 0x40 -+#define REALTEK_USB_VENQT_CMD_REQ 0x05 -+#define REALTEK_USB_VENQT_CMD_IDX 0x00 -+#define REALTEK_USB_IN_INT_EP_IDX 1 -+ -+enum { -+ VENDOR_WRITE = 0x00, -+ VENDOR_READ = 0x01, -+}; -+#define ALIGNMENT_UNIT 16 -+#define MAX_VENDOR_REQ_CMD_SIZE 254 /* 8188cu SIE Support */ -+#define MAX_USB_IO_CTL_SIZE (MAX_VENDOR_REQ_CMD_SIZE + ALIGNMENT_UNIT) -+ -+#ifdef PLATFORM_LINUX -+#include -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef CONFIG_RTL8188E -+void rtl8188eu_set_hw_type(struct dvobj_priv *pdvobj); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8188eu(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+void rtl8812au_set_hw_type(struct dvobj_priv *pdvobj); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8812au(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+#endif -+ -+#ifdef CONFIG_RTL8814A -+void rtl8814au_set_hw_type(struct dvobj_priv *pdvobj); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8814au(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+#endif /* CONFIG_RTL8814 */ -+ -+#ifdef CONFIG_RTL8192E -+void rtl8192eu_set_hw_type(struct dvobj_priv *pdvobj); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8192eu(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+ -+#endif -+ -+#ifdef CONFIG_RTL8188F -+void rtl8188fu_set_hw_type(struct dvobj_priv *pdvobj); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8188fu(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+#endif -+ -+#ifdef CONFIG_RTL8723B -+void rtl8723bu_set_hw_type(struct dvobj_priv *pdvobj); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8723bu(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif -+#endif -+ -+#ifdef CONFIG_RTL8703B -+void rtl8703bu_set_hw_type(struct dvobj_priv *pdvobj); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8703bu(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif /* CONFIG_SUPPORT_USB_INT */ -+#endif /* CONFIG_RTL8703B */ -+ -+void usb_set_intf_ops(_adapter *padapter, struct _io_ops *pops); -+ -+#ifdef CONFIG_RTL8723D -+void rtl8723du_set_hw_type(struct dvobj_priv *pdvobj); -+void rtl8723du_set_intf_ops(struct _io_ops *pops); -+void rtl8723du_recv_tasklet(void *priv); -+void rtl8723du_xmit_tasklet(void *priv); -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8723du(_adapter *padapter, u16 pkt_len, u8 *pbuf); -+#endif /* CONFIG_SUPPORT_USB_INT */ -+#endif /* CONFIG_RTL8723D */ -+ -+enum RTW_USB_SPEED { -+ RTW_USB_SPEED_UNKNOWN = 0, -+ RTW_USB_SPEED_1_1 = 1, -+ RTW_USB_SPEED_2 = 2, -+ RTW_USB_SPEED_3 = 3, -+}; -+ -+#define IS_FULL_SPEED_USB(Adapter) (adapter_to_dvobj(Adapter)->usb_speed == RTW_USB_SPEED_1_1) -+#define IS_HIGH_SPEED_USB(Adapter) (adapter_to_dvobj(Adapter)->usb_speed == RTW_USB_SPEED_2) -+#define IS_SUPER_SPEED_USB(Adapter) (adapter_to_dvobj(Adapter)->usb_speed == RTW_USB_SPEED_3) -+ -+#define USB_SUPER_SPEED_BULK_SIZE 1024 /* usb 3.0 */ -+#define USB_HIGH_SPEED_BULK_SIZE 512 /* usb 2.0 */ -+#define USB_FULL_SPEED_BULK_SIZE 64 /* usb 1.1 */ -+ -+static inline u8 rtw_usb_bulk_size_boundary(_adapter *padapter, int buf_len) -+{ -+ u8 rst = _TRUE; -+ -+ if (IS_SUPER_SPEED_USB(padapter)) -+ rst = (0 == (buf_len) % USB_SUPER_SPEED_BULK_SIZE) ? _TRUE : _FALSE; -+ if (IS_HIGH_SPEED_USB(padapter)) -+ rst = (0 == (buf_len) % USB_HIGH_SPEED_BULK_SIZE) ? _TRUE : _FALSE; -+ else -+ rst = (0 == (buf_len) % USB_FULL_SPEED_BULK_SIZE) ? _TRUE : _FALSE; -+ return rst; -+} -+ -+ -+#endif /* __USB_OPS_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/usb_ops_linux.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_ops_linux.h ---- linux-4.14.18/3rdparty/rtl8723de/include/usb_ops_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_ops_linux.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,103 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __USB_OPS_LINUX_H__ -+#define __USB_OPS_LINUX_H__ -+ -+#define VENDOR_CMD_MAX_DATA_LEN 254 -+#define FW_START_ADDRESS 0x1000 -+ -+#define RTW_USB_CONTROL_MSG_TIMEOUT_TEST 10/* ms */ -+#define RTW_USB_CONTROL_MSG_TIMEOUT 500/* ms */ -+ -+#define RECV_BULK_IN_ADDR 0x80/* assign by drv, not real address */ -+#define RECV_INT_IN_ADDR 0x81/* assign by drv, not real address */ -+ -+#define INTERRUPT_MSG_FORMAT_LEN 60 -+ -+#if defined(CONFIG_VENDOR_REQ_RETRY) && defined(CONFIG_USB_VENDOR_REQ_MUTEX) -+ /* vendor req retry should be in the situation when each vendor req is atomically submitted from others */ -+ #define MAX_USBCTRL_VENDORREQ_TIMES 10 -+#else -+ #define MAX_USBCTRL_VENDORREQ_TIMES 1 -+#endif -+ -+#define RTW_USB_BULKOUT_TIMEOUT 5000/* ms */ -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 5, 0)) || (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 18)) -+#define _usbctrl_vendorreq_async_callback(urb, regs) _usbctrl_vendorreq_async_callback(urb) -+#define usb_bulkout_zero_complete(purb, regs) usb_bulkout_zero_complete(purb) -+#define usb_write_mem_complete(purb, regs) usb_write_mem_complete(purb) -+#define usb_write_port_complete(purb, regs) usb_write_port_complete(purb) -+#define usb_read_port_complete(purb, regs) usb_read_port_complete(purb) -+#define usb_read_interrupt_complete(purb, regs) usb_read_interrupt_complete(purb) -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 12)) -+#define rtw_usb_control_msg(dev, pipe, request, requesttype, value, index, data, size, timeout_ms) \ -+ usb_control_msg((dev), (pipe), (request), (requesttype), (value), (index), (data), (size), (timeout_ms)) -+#define rtw_usb_bulk_msg(usb_dev, pipe, data, len, actual_length, timeout_ms) \ -+ usb_bulk_msg((usb_dev), (pipe), (data), (len), (actual_length), (timeout_ms)) -+#else -+#define rtw_usb_control_msg(dev, pipe, request, requesttype, value, index, data, size, timeout_ms) \ -+ usb_control_msg((dev), (pipe), (request), (requesttype), (value), (index), (data), (size), \ -+ ((timeout_ms) == 0) || ((timeout_ms) * HZ / 1000 > 0) ? ((timeout_ms) * HZ / 1000) : 1) -+#define rtw_usb_bulk_msg(usb_dev, pipe, data, len, actual_length, timeout_ms) \ -+ usb_bulk_msg((usb_dev), (pipe), (data), (len), (actual_length), \ -+ ((timeout_ms) == 0) || ((timeout_ms) * HZ / 1000 > 0) ? ((timeout_ms) * HZ / 1000) : 1) -+#endif -+ -+ -+#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ -+int usb_async_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+int usb_async_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+int usb_async_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+#endif /* CONFIG_USB_SUPPORT_ASYNC_VDN_REQ */ -+ -+unsigned int ffaddr2pipehdl(struct dvobj_priv *pdvobj, u32 addr); -+ -+void usb_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem); -+void usb_write_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem); -+ -+void usb_read_port_cancel(struct intf_hdl *pintfhdl); -+ -+u32 usb_write_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem); -+void usb_write_port_cancel(struct intf_hdl *pintfhdl); -+ -+int usbctrl_vendorreq(struct intf_hdl *pintfhdl, u8 request, u16 value, u16 index, void *pdata, u16 len, u8 requesttype); -+#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ -+int _usbctrl_vendorreq_async_write(struct usb_device *udev, u8 request, -+ u16 value, u16 index, void *pdata, u16 len, u8 requesttype); -+#endif /* CONFIG_USB_SUPPORT_ASYNC_VDN_REQ */ -+ -+u8 usb_read8(struct intf_hdl *pintfhdl, u32 addr); -+u16 usb_read16(struct intf_hdl *pintfhdl, u32 addr); -+u32 usb_read32(struct intf_hdl *pintfhdl, u32 addr); -+int usb_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+int usb_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+int usb_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+int usb_writeN(struct intf_hdl *pintfhdl, u32 addr, u32 length, u8 *pdata); -+u32 usb_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem); -+void usb_recv_tasklet(void *priv); -+ -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+void usb_read_interrupt_complete(struct urb *purb, struct pt_regs *regs); -+u32 usb_read_interrupt(struct intf_hdl *pintfhdl, u32 addr); -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/usb_osintf.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_osintf.h ---- linux-4.14.18/3rdparty/rtl8723de/include/usb_osintf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_osintf.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __USB_OSINTF_H -+#define __USB_OSINTF_H -+ -+#include -+ -+#define USBD_HALTED(Status) ((ULONG)(Status) >> 30 == 3) -+ -+ -+u8 usbvendorrequest(struct dvobj_priv *pdvobjpriv, RT_USB_BREQUEST brequest, RT_USB_WVALUE wvalue, u8 windex, void *data, u8 datalen, u8 isdirectionin); -+ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/usb_vendor_req.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_vendor_req.h ---- linux-4.14.18/3rdparty/rtl8723de/include/usb_vendor_req.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/usb_vendor_req.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,61 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _USB_VENDOR_REQUEST_H_ -+#define _USB_VENDOR_REQUEST_H_ -+ -+/* 4 Set/Get Register related wIndex/Data */ -+#define RT_USB_RESET_MASK_OFF 0 -+#define RT_USB_RESET_MASK_ON 1 -+#define RT_USB_SLEEP_MASK_OFF 0 -+#define RT_USB_SLEEP_MASK_ON 1 -+#define RT_USB_LDO_ON 1 -+#define RT_USB_LDO_OFF 0 -+ -+/* 4 Set/Get SYSCLK related wValue or Data */ -+#define RT_USB_SYSCLK_32KHZ 0 -+#define RT_USB_SYSCLK_40MHZ 1 -+#define RT_USB_SYSCLK_60MHZ 2 -+ -+ -+typedef enum _RT_USB_BREQUEST { -+ RT_USB_SET_REGISTER = 1, -+ RT_USB_SET_SYSCLK = 2, -+ RT_USB_GET_SYSCLK = 3, -+ RT_USB_GET_REGISTER = 4 -+} RT_USB_BREQUEST; -+ -+ -+typedef enum _RT_USB_WVALUE { -+ RT_USB_RESET_MASK = 1, -+ RT_USB_SLEEP_MASK = 2, -+ RT_USB_USB_HRCPWM = 3, -+ RT_USB_LDO = 4, -+ RT_USB_BOOT_TYPE = 5 -+} RT_USB_WVALUE; -+ -+ -+#if 0 -+BOOLEAN usbvendorrequest(PCE_USB_DEVICE CEdevice, RT_USB_BREQUEST bRequest, RT_USB_WVALUE wValue, UCHAR wIndex, PVOID Data, UCHAR DataLength, BOOLEAN isDirectionIn); -+BOOLEAN CEusbGetStatusRequest(PCE_USB_DEVICE CEdevice, IN USHORT Op, IN USHORT Index, PVOID Data); -+BOOLEAN CEusbFeatureRequest(PCE_USB_DEVICE CEdevice, IN USHORT Op, IN USHORT FeatureSelector, IN USHORT Index); -+BOOLEAN CEusbGetDescriptorRequest(PCE_USB_DEVICE CEdevice, IN short urbLength, IN UCHAR DescriptorType, IN UCHAR Index, IN USHORT LanguageId, IN PVOID TransferBuffer, IN ULONG TransferBufferLength); -+#endif -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/wifi.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/wifi.h ---- linux-4.14.18/3rdparty/rtl8723de/include/wifi.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/wifi.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,1391 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef _WIFI_H_ -+#define _WIFI_H_ -+ -+ -+#ifdef BIT -+/* #error "BIT define occurred earlier elsewhere!\n" */ -+#undef BIT -+#endif -+#define BIT(x) (1 << (x)) -+ -+ -+#define WLAN_ETHHDR_LEN 14 -+#define WLAN_ETHADDR_LEN 6 -+#define WLAN_IEEE_OUI_LEN 3 -+#define WLAN_ADDR_LEN 6 -+#define WLAN_CRC_LEN 4 -+#define WLAN_BSSID_LEN 6 -+#define WLAN_BSS_TS_LEN 8 -+#define WLAN_HDR_A3_LEN 24 -+#define WLAN_HDR_A4_LEN 30 -+#define WLAN_HDR_A3_QOS_LEN 26 -+#define WLAN_HDR_A4_QOS_LEN 32 -+#define WLAN_SSID_MAXLEN 32 -+#define WLAN_DATA_MAXLEN 2312 -+ -+#define WLAN_A3_PN_OFFSET 24 -+#define WLAN_A4_PN_OFFSET 30 -+ -+#define WLAN_MIN_ETHFRM_LEN 60 -+#define WLAN_MAX_ETHFRM_LEN 1514 -+#define WLAN_ETHHDR_LEN 14 -+#define WLAN_WMM_LEN 24 -+ -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+#define WLAN_MAX_VENDOR_IE_LEN 255 -+#define WLAN_MAX_VENDOR_IE_NUM 5 -+#define WIFI_BEACON_VENDOR_IE_BIT BIT(0) -+#define WIFI_PROBEREQ_VENDOR_IE_BIT BIT(1) -+#define WIFI_PROBERESP_VENDOR_IE_BIT BIT(2) -+#define WIFI_ASSOCREQ_VENDOR_IE_BIT BIT(3) -+#define WIFI_ASSOCRESP_VENDOR_IE_BIT BIT(4) -+#endif -+ -+#define P80211CAPTURE_VERSION 0x80211001 -+ -+/* This value is tested by WiFi 11n Test Plan 5.2.3. -+ * This test verifies the WLAN NIC can update the NAV through sending the CTS with large duration. */ -+#define WiFiNavUpperUs 30000 /* 30 ms */ -+ -+#ifdef GREEN_HILL -+#pragma pack(1) -+#endif -+ -+enum WIFI_FRAME_TYPE { -+ WIFI_MGT_TYPE = (0), -+ WIFI_CTRL_TYPE = (BIT(2)), -+ WIFI_DATA_TYPE = (BIT(3)), -+ WIFI_QOS_DATA_TYPE = (BIT(7) | BIT(3)), /* !< QoS Data */ -+}; -+ -+enum WIFI_FRAME_SUBTYPE { -+ -+ /* below is for mgt frame */ -+ WIFI_ASSOCREQ = (0 | WIFI_MGT_TYPE), -+ WIFI_ASSOCRSP = (BIT(4) | WIFI_MGT_TYPE), -+ WIFI_REASSOCREQ = (BIT(5) | WIFI_MGT_TYPE), -+ WIFI_REASSOCRSP = (BIT(5) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_PROBEREQ = (BIT(6) | WIFI_MGT_TYPE), -+ WIFI_PROBERSP = (BIT(6) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_BEACON = (BIT(7) | WIFI_MGT_TYPE), -+ WIFI_ATIM = (BIT(7) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_DISASSOC = (BIT(7) | BIT(5) | WIFI_MGT_TYPE), -+ WIFI_AUTH = (BIT(7) | BIT(5) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_DEAUTH = (BIT(7) | BIT(6) | WIFI_MGT_TYPE), -+ WIFI_ACTION = (BIT(7) | BIT(6) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_ACTION_NOACK = (BIT(7) | BIT(6) | BIT(5) | WIFI_MGT_TYPE), -+ -+ /* below is for control frame */ -+ WIFI_NDPA = (BIT(6) | BIT(4) | WIFI_CTRL_TYPE), -+ WIFI_PSPOLL = (BIT(7) | BIT(5) | WIFI_CTRL_TYPE), -+ WIFI_RTS = (BIT(7) | BIT(5) | BIT(4) | WIFI_CTRL_TYPE), -+ WIFI_CTS = (BIT(7) | BIT(6) | WIFI_CTRL_TYPE), -+ WIFI_ACK = (BIT(7) | BIT(6) | BIT(4) | WIFI_CTRL_TYPE), -+ WIFI_CFEND = (BIT(7) | BIT(6) | BIT(5) | WIFI_CTRL_TYPE), -+ WIFI_CFEND_CFACK = (BIT(7) | BIT(6) | BIT(5) | BIT(4) | WIFI_CTRL_TYPE), -+ -+ /* below is for data frame */ -+ WIFI_DATA = (0 | WIFI_DATA_TYPE), -+ WIFI_DATA_CFACK = (BIT(4) | WIFI_DATA_TYPE), -+ WIFI_DATA_CFPOLL = (BIT(5) | WIFI_DATA_TYPE), -+ WIFI_DATA_CFACKPOLL = (BIT(5) | BIT(4) | WIFI_DATA_TYPE), -+ WIFI_DATA_NULL = (BIT(6) | WIFI_DATA_TYPE), -+ WIFI_CF_ACK = (BIT(6) | BIT(4) | WIFI_DATA_TYPE), -+ WIFI_CF_POLL = (BIT(6) | BIT(5) | WIFI_DATA_TYPE), -+ WIFI_CF_ACKPOLL = (BIT(6) | BIT(5) | BIT(4) | WIFI_DATA_TYPE), -+ WIFI_QOS_DATA_NULL = (BIT(6) | WIFI_QOS_DATA_TYPE), -+}; -+ -+enum WIFI_REASON_CODE { -+ _RSON_RESERVED_ = 0, -+ _RSON_UNSPECIFIED_ = 1, -+ _RSON_AUTH_NO_LONGER_VALID_ = 2, -+ _RSON_DEAUTH_STA_LEAVING_ = 3, -+ _RSON_INACTIVITY_ = 4, -+ _RSON_UNABLE_HANDLE_ = 5, -+ _RSON_CLS2_ = 6, -+ _RSON_CLS3_ = 7, -+ _RSON_DISAOC_STA_LEAVING_ = 8, -+ _RSON_ASOC_NOT_AUTH_ = 9, -+ -+ /* WPA reason */ -+ _RSON_INVALID_IE_ = 13, -+ _RSON_MIC_FAILURE_ = 14, -+ _RSON_4WAY_HNDSHK_TIMEOUT_ = 15, -+ _RSON_GROUP_KEY_UPDATE_TIMEOUT_ = 16, -+ _RSON_DIFF_IE_ = 17, -+ _RSON_MLTCST_CIPHER_NOT_VALID_ = 18, -+ _RSON_UNICST_CIPHER_NOT_VALID_ = 19, -+ _RSON_AKMP_NOT_VALID_ = 20, -+ _RSON_UNSUPPORT_RSNE_VER_ = 21, -+ _RSON_INVALID_RSNE_CAP_ = 22, -+ _RSON_IEEE_802DOT1X_AUTH_FAIL_ = 23, -+ -+ /* belowing are Realtek definition */ -+ _RSON_PMK_NOT_AVAILABLE_ = 24, -+ _RSON_TDLS_TEAR_TOOFAR_ = 25, -+ _RSON_TDLS_TEAR_UN_RSN_ = 26, -+}; -+ -+/* Reason codes (IEEE 802.11-2007, 7.3.1.7, Table 7-22) */ -+#if 0 -+#define WLAN_REASON_UNSPECIFIED 1 -+#define WLAN_REASON_PREV_AUTH_NOT_VALID 2 -+#define WLAN_REASON_DEAUTH_LEAVING 3 -+#define WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY 4 -+#define WLAN_REASON_DISASSOC_AP_BUSY 5 -+#define WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA 6 -+#define WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA 7 -+#define WLAN_REASON_DISASSOC_STA_HAS_LEFT 8 -+#define WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH 9 -+#endif -+/* IEEE 802.11h */ -+#define WLAN_REASON_PWR_CAPABILITY_NOT_VALID 10 -+#define WLAN_REASON_SUPPORTED_CHANNEL_NOT_VALID 11 -+#if 0 -+/* IEEE 802.11i */ -+#define WLAN_REASON_INVALID_IE 13 -+#define WLAN_REASON_MICHAEL_MIC_FAILURE 14 -+#define WLAN_REASON_4WAY_HANDSHAKE_TIMEOUT 15 -+#define WLAN_REASON_GROUP_KEY_UPDATE_TIMEOUT 16 -+#define WLAN_REASON_IE_IN_4WAY_DIFFERS 17 -+#define WLAN_REASON_GROUP_CIPHER_NOT_VALID 18 -+#define WLAN_REASON_PAIRWISE_CIPHER_NOT_VALID 19 -+#define WLAN_REASON_AKMP_NOT_VALID 20 -+#define WLAN_REASON_UNSUPPORTED_RSN_IE_VERSION 21 -+#define WLAN_REASON_INVALID_RSN_IE_CAPAB 22 -+#define WLAN_REASON_IEEE_802_1X_AUTH_FAILED 23 -+#define WLAN_REASON_CIPHER_SUITE_REJECTED 24 -+#endif -+ -+enum WIFI_STATUS_CODE { -+ _STATS_SUCCESSFUL_ = 0, -+ _STATS_FAILURE_ = 1, -+ _STATS_SEC_DISABLED_ = 5, -+ _STATS_NOT_IN_SAME_BSS_ = 7, -+ _STATS_CAP_FAIL_ = 10, -+ _STATS_NO_ASOC_ = 11, -+ _STATS_OTHER_ = 12, -+ _STATS_NO_SUPP_ALG_ = 13, -+ _STATS_OUT_OF_AUTH_SEQ_ = 14, -+ _STATS_CHALLENGE_FAIL_ = 15, -+ _STATS_AUTH_TIMEOUT_ = 16, -+ _STATS_UNABLE_HANDLE_STA_ = 17, -+ _STATS_RATE_FAIL_ = 18, -+ _STATS_REFUSED_TEMPORARILY_ = 30, -+ _STATS_DECLINE_REQ_ = 37, -+ _STATS_INVALID_PARAMETERS_ = 38, -+ _STATS_INVALID_RSNIE_ = 72, -+}; -+ -+/* Status codes (IEEE 802.11-2007, 7.3.1.9, Table 7-23) */ -+#if 0 -+#define WLAN_STATUS_SUCCESS 0 -+#define WLAN_STATUS_UNSPECIFIED_FAILURE 1 -+#define WLAN_STATUS_CAPS_UNSUPPORTED 10 -+#define WLAN_STATUS_REASSOC_NO_ASSOC 11 -+#define WLAN_STATUS_ASSOC_DENIED_UNSPEC 12 -+#define WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG 13 -+#define WLAN_STATUS_UNKNOWN_AUTH_TRANSACTION 14 -+#define WLAN_STATUS_CHALLENGE_FAIL 15 -+#define WLAN_STATUS_AUTH_TIMEOUT 16 -+#define WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA 17 -+#define WLAN_STATUS_ASSOC_DENIED_RATES 18 -+#endif -+/* entended */ -+/* IEEE 802.11b */ -+#define WLAN_STATUS_ASSOC_DENIED_NOSHORT 19 -+#define WLAN_STATUS_ASSOC_DENIED_NOPBCC 20 -+#define WLAN_STATUS_ASSOC_DENIED_NOAGILITY 21 -+/* IEEE 802.11h */ -+#define WLAN_STATUS_SPEC_MGMT_REQUIRED 22 -+#define WLAN_STATUS_PWR_CAPABILITY_NOT_VALID 23 -+#define WLAN_STATUS_SUPPORTED_CHANNEL_NOT_VALID 24 -+/* IEEE 802.11g */ -+#define WLAN_STATUS_ASSOC_DENIED_NO_SHORT_SLOT_TIME 25 -+#define WLAN_STATUS_ASSOC_DENIED_NO_ER_PBCC 26 -+#define WLAN_STATUS_ASSOC_DENIED_NO_DSSS_OFDM 27 -+/* IEEE 802.11w */ -+#define WLAN_STATUS_ASSOC_REJECTED_TEMPORARILY 30 -+#define WLAN_STATUS_ROBUST_MGMT_FRAME_POLICY_VIOLATION 31 -+/* IEEE 802.11i */ -+#define WLAN_STATUS_INVALID_IE 40 -+#define WLAN_STATUS_GROUP_CIPHER_NOT_VALID 41 -+#define WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID 42 -+#define WLAN_STATUS_AKMP_NOT_VALID 43 -+#define WLAN_STATUS_UNSUPPORTED_RSN_IE_VERSION 44 -+#define WLAN_STATUS_INVALID_RSN_IE_CAPAB 45 -+#define WLAN_STATUS_CIPHER_REJECTED_PER_POLICY 46 -+#define WLAN_STATUS_TS_NOT_CREATED 47 -+#define WLAN_STATUS_DIRECT_LINK_NOT_ALLOWED 48 -+#define WLAN_STATUS_DEST_STA_NOT_PRESENT 49 -+#define WLAN_STATUS_DEST_STA_NOT_QOS_STA 50 -+#define WLAN_STATUS_ASSOC_DENIED_LISTEN_INT_TOO_LARGE 51 -+/* IEEE 802.11r */ -+#define WLAN_STATUS_INVALID_FT_ACTION_FRAME_COUNT 52 -+#define WLAN_STATUS_INVALID_PMKID 53 -+#define WLAN_STATUS_INVALID_MDIE 54 -+#define WLAN_STATUS_INVALID_FTIE 55 -+ -+ -+enum WIFI_REG_DOMAIN { -+ DOMAIN_FCC = 1, -+ DOMAIN_IC = 2, -+ DOMAIN_ETSI = 3, -+ DOMAIN_SPAIN = 4, -+ DOMAIN_FRANCE = 5, -+ DOMAIN_MKK = 6, -+ DOMAIN_ISRAEL = 7, -+ DOMAIN_MKK1 = 8, -+ DOMAIN_MKK2 = 9, -+ DOMAIN_MKK3 = 10, -+ DOMAIN_MAX -+}; -+ -+#define _TO_DS_ BIT(8) -+#define _FROM_DS_ BIT(9) -+#define _MORE_FRAG_ BIT(10) -+#define _RETRY_ BIT(11) -+#define _PWRMGT_ BIT(12) -+#define _MORE_DATA_ BIT(13) -+#define _PRIVACY_ BIT(14) -+#define _ORDER_ BIT(15) -+ -+#define SetToDs(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_TO_DS_); \ -+ } while (0) -+ -+#define GetToDs(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_TO_DS_)) != 0) -+ -+#define ClearToDs(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_TO_DS_)); \ -+ } while (0) -+ -+#define SetFrDs(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_FROM_DS_); \ -+ } while (0) -+ -+#define GetFrDs(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_FROM_DS_)) != 0) -+ -+#define ClearFrDs(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_FROM_DS_)); \ -+ } while (0) -+ -+#define get_tofr_ds(pframe) ((GetToDs(pframe) << 1) | GetFrDs(pframe)) -+ -+ -+#define SetMFrag(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_MORE_FRAG_); \ -+ } while (0) -+ -+#define GetMFrag(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_MORE_FRAG_)) != 0) -+ -+#define ClearMFrag(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_MORE_FRAG_)); \ -+ } while (0) -+ -+#define SetRetry(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_RETRY_); \ -+ } while (0) -+ -+#define GetRetry(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_RETRY_)) != 0) -+ -+#define ClearRetry(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_RETRY_)); \ -+ } while (0) -+ -+#define SetPwrMgt(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_PWRMGT_); \ -+ } while (0) -+ -+#define GetPwrMgt(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_PWRMGT_)) != 0) -+ -+#define ClearPwrMgt(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_PWRMGT_)); \ -+ } while (0) -+ -+#define SetMData(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_MORE_DATA_); \ -+ } while (0) -+ -+#define GetMData(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_MORE_DATA_)) != 0) -+ -+#define ClearMData(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_MORE_DATA_)); \ -+ } while (0) -+ -+#define SetPrivacy(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_PRIVACY_); \ -+ } while (0) -+ -+#define GetPrivacy(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_PRIVACY_)) != 0) -+ -+#define ClearPrivacy(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= (~cpu_to_le16(_PRIVACY_)); \ -+ } while (0) -+ -+ -+#define GetOrder(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_ORDER_)) != 0) -+ -+#define GetFrameType(pbuf) (le16_to_cpu(*(unsigned short *)(pbuf)) & (BIT(3) | BIT(2))) -+ -+#define SetFrameType(pbuf, type) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= __constant_cpu_to_le16(~(BIT(3) | BIT(2))); \ -+ *(unsigned short *)(pbuf) |= __constant_cpu_to_le16(type); \ -+ } while (0) -+ -+#define GetFrameSubType(pbuf) (cpu_to_le16(*(unsigned short *)(pbuf)) & (BIT(7) | BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))) -+ -+#define SetFrameSubType(pbuf, type) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= cpu_to_le16(~(BIT(7) | BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))); \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(type); \ -+ } while (0) -+ -+#define GetSequence(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) >> 4) -+ -+#define GetFragNum(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) & 0x0f) -+ -+#define GetTupleCache(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 22))) -+ -+#define SetFragNum(pbuf, num) \ -+ do { \ -+ *(unsigned short *)((SIZE_PTR)(pbuf) + 22) = \ -+ ((*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) & le16_to_cpu(~(0x000f))) | \ -+ cpu_to_le16(0x0f & (num)); \ -+ } while (0) -+ -+#define SetSeqNum(pbuf, num) \ -+ do { \ -+ *(unsigned short *)((SIZE_PTR)(pbuf) + 22) = \ -+ ((*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) & le16_to_cpu((unsigned short)~0xfff0)) | \ -+ le16_to_cpu((unsigned short)(0xfff0 & (num << 4))); \ -+ } while (0) -+ -+#define SetDuration(pbuf, dur) \ -+ do { \ -+ *(unsigned short *)((SIZE_PTR)(pbuf) + 2) = cpu_to_le16(0xffff & (dur)); \ -+ } while (0) -+ -+ -+#define SetPriority(pbuf, tid) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(tid & 0xf); \ -+ } while (0) -+ -+#define GetPriority(pbuf) ((le16_to_cpu(*(unsigned short *)(pbuf))) & 0xf) -+ -+#define SetEOSP(pbuf, eosp) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16((eosp & 1) << 4); \ -+ } while (0) -+ -+#define SetAckpolicy(pbuf, ack) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16((ack & 3) << 5); \ -+ } while (0) -+ -+#define GetAckpolicy(pbuf) (((le16_to_cpu(*(unsigned short *)pbuf)) >> 5) & 0x3) -+ -+#define GetAMsdu(pbuf) (((le16_to_cpu(*(unsigned short *)pbuf)) >> 7) & 0x1) -+ -+#define SetAMsdu(pbuf, amsdu) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16((amsdu & 1) << 7); \ -+ } while (0) -+ -+#define GetAid(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 2)) & 0x3fff) -+ -+#define GetTid(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + (((GetToDs(pbuf)<<1) | GetFrDs(pbuf)) == 3 ? 30 : 24))) & 0x000f) -+ -+#define GetAddr1Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 4)) -+ -+#define GetAddr2Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 10)) -+ -+#define GetAddr3Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 16)) -+ -+#define GetAddr4Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 24)) -+ -+#define MacAddr_isBcst(addr) \ -+ (\ -+ ((addr[0] == 0xff) && (addr[1] == 0xff) && \ -+ (addr[2] == 0xff) && (addr[3] == 0xff) && \ -+ (addr[4] == 0xff) && (addr[5] == 0xff)) ? _TRUE : _FALSE \ -+ ) -+ -+__inline static int IS_MCAST(unsigned char *da) -+{ -+ if ((*da) & 0x01) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+__inline static unsigned char *get_ra(unsigned char *pframe) -+{ -+ unsigned char *ra; -+ ra = GetAddr1Ptr(pframe); -+ return ra; -+} -+__inline static unsigned char *get_ta(unsigned char *pframe) -+{ -+ unsigned char *ta; -+ ta = GetAddr2Ptr(pframe); -+ return ta; -+} -+ -+__inline static unsigned char *get_da(unsigned char *pframe) -+{ -+ unsigned char *da; -+ unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); -+ -+ switch (to_fr_ds) { -+ case 0x00: /* ToDs=0, FromDs=0 */ -+ da = GetAddr1Ptr(pframe); -+ break; -+ case 0x01: /* ToDs=0, FromDs=1 */ -+ da = GetAddr1Ptr(pframe); -+ break; -+ case 0x02: /* ToDs=1, FromDs=0 */ -+ da = GetAddr3Ptr(pframe); -+ break; -+ default: /* ToDs=1, FromDs=1 */ -+ da = GetAddr3Ptr(pframe); -+ break; -+ } -+ -+ return da; -+} -+ -+ -+__inline static unsigned char *get_sa(unsigned char *pframe) -+{ -+ unsigned char *sa; -+ unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); -+ -+ switch (to_fr_ds) { -+ case 0x00: /* ToDs=0, FromDs=0 */ -+ sa = GetAddr2Ptr(pframe); -+ break; -+ case 0x01: /* ToDs=0, FromDs=1 */ -+ sa = GetAddr3Ptr(pframe); -+ break; -+ case 0x02: /* ToDs=1, FromDs=0 */ -+ sa = GetAddr2Ptr(pframe); -+ break; -+ default: /* ToDs=1, FromDs=1 */ -+ sa = GetAddr4Ptr(pframe); -+ break; -+ } -+ -+ return sa; -+} -+ -+__inline static unsigned char *get_hdr_bssid(unsigned char *pframe) -+{ -+ unsigned char *sa = NULL; -+ unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); -+ -+ switch (to_fr_ds) { -+ case 0x00: /* ToDs=0, FromDs=0 */ -+ sa = GetAddr3Ptr(pframe); -+ break; -+ case 0x01: /* ToDs=0, FromDs=1 */ -+ sa = GetAddr2Ptr(pframe); -+ break; -+ case 0x02: /* ToDs=1, FromDs=0 */ -+ sa = GetAddr1Ptr(pframe); -+ break; -+ case 0x03: /* ToDs=1, FromDs=1 */ -+ sa = GetAddr1Ptr(pframe); -+ break; -+ } -+ -+ return sa; -+} -+ -+ -+__inline static int IsFrameTypeCtrl(unsigned char *pframe) -+{ -+ if (WIFI_CTRL_TYPE == GetFrameType(pframe)) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+/*----------------------------------------------------------------------------- -+ Below is for the security related definition -+------------------------------------------------------------------------------*/ -+#define _RESERVED_FRAME_TYPE_ 0 -+#define _SKB_FRAME_TYPE_ 2 -+#define _PRE_ALLOCMEM_ 1 -+#define _PRE_ALLOCHDR_ 3 -+#define _PRE_ALLOCLLCHDR_ 4 -+#define _PRE_ALLOCICVHDR_ 5 -+#define _PRE_ALLOCMICHDR_ 6 -+ -+#define _SIFSTIME_ ((priv->pmib->dot11BssType.net_work_type&WIRELESS_11A) ? 16 : 10) -+#define _ACKCTSLNG_ 14 /* 14 bytes long, including crclng */ -+#define _CRCLNG_ 4 -+ -+#define _ASOCREQ_IE_OFFSET_ 4 /* excluding wlan_hdr */ -+#define _ASOCRSP_IE_OFFSET_ 6 -+#define _REASOCREQ_IE_OFFSET_ 10 -+#define _REASOCRSP_IE_OFFSET_ 6 -+#define _PROBEREQ_IE_OFFSET_ 0 -+#define _PROBERSP_IE_OFFSET_ 12 -+#define _AUTH_IE_OFFSET_ 6 -+#define _DEAUTH_IE_OFFSET_ 0 -+#define _BEACON_IE_OFFSET_ 12 -+#define _PUBLIC_ACTION_IE_OFFSET_ 8 -+ -+#define _FIXED_IE_LENGTH_ _BEACON_IE_OFFSET_ -+ -+#define _SSID_IE_ 0 -+#define _SUPPORTEDRATES_IE_ 1 -+#define _DSSET_IE_ 3 -+#define _TIM_IE_ 5 -+#define _IBSS_PARA_IE_ 6 -+#define _COUNTRY_IE_ 7 -+#define _CHLGETXT_IE_ 16 -+#define _SUPPORTED_CH_IE_ 36 -+#define _CH_SWTICH_ANNOUNCE_ 37 /* Secondary Channel Offset */ -+#define _RSN_IE_2_ 48 -+#define _SSN_IE_1_ 221 -+#define _ERPINFO_IE_ 42 -+#define _EXT_SUPPORTEDRATES_IE_ 50 -+ -+#define _HT_CAPABILITY_IE_ 45 -+#define _MDIE_ 54 -+#define _FTIE_ 55 -+#define _TIMEOUT_ITVL_IE_ 56 -+#define _SRC_IE_ 59 -+#define _HT_EXTRA_INFO_IE_ 61 -+#define _HT_ADD_INFO_IE_ 61 /* _HT_EXTRA_INFO_IE_ */ -+#define _WAPI_IE_ 68 -+ -+ -+/* #define EID_BSSCoexistence 72 */ /* 20/40 BSS Coexistence -+ * #define EID_BSSIntolerantChlReport 73 */ -+#define _RIC_Descriptor_IE_ 75 -+#ifdef CONFIG_IEEE80211W -+#define _MME_IE_ 76 /* 802.11w Management MIC element */ -+#endif /* CONFIG_IEEE80211W */ -+#define _LINK_ID_IE_ 101 -+#define _CH_SWITCH_TIMING_ 104 -+#define _PTI_BUFFER_STATUS_ 106 -+#define _EXT_CAP_IE_ 127 -+#define _VENDOR_SPECIFIC_IE_ 221 -+ -+#define _RESERVED47_ 47 -+ -+typedef enum _ELEMENT_ID { -+ EID_SsId = 0, /* service set identifier (0:32) */ -+ EID_SupRates = 1, /* supported rates (1:8) */ -+ EID_FHParms = 2, /* FH parameter set (5) */ -+ EID_DSParms = 3, /* DS parameter set (1) */ -+ EID_CFParms = 4, /* CF parameter set (6) */ -+ EID_Tim = 5, /* Traffic Information Map (4:254) */ -+ EID_IbssParms = 6, /* IBSS parameter set (2) */ -+ EID_Country = 7, /* */ -+ -+ /* Form 7.3.2: Information elements in 802.11E/D13.0, page 46. */ -+ EID_QBSSLoad = 11, -+ EID_EDCAParms = 12, -+ EID_TSpec = 13, -+ EID_TClass = 14, -+ EID_Schedule = 15, -+ /* */ -+ -+ EID_Ctext = 16, /* challenge text*/ -+ EID_POWER_CONSTRAINT = 32, /* Power Constraint*/ -+ -+ /* vivi for WIFITest, 802.11h AP, 20100427 */ -+ /* 2010/12/26 MH The definition we can declare always!! */ -+ EID_PowerCap = 33, -+ EID_SupportedChannels = 36, -+ EID_ChlSwitchAnnounce = 37, -+ -+ EID_MeasureRequest = 38, /* Measurement Request */ -+ EID_MeasureReport = 39, /* Measurement Report */ -+ -+ EID_ERPInfo = 42, -+ -+ /* Form 7.3.2: Information elements in 802.11E/D13.0, page 46. */ -+ EID_TSDelay = 43, -+ EID_TCLASProc = 44, -+ EID_HTCapability = 45, -+ EID_QoSCap = 46, -+ /* */ -+ -+ EID_WPA2 = 48, -+ EID_ExtSupRates = 50, -+ -+ EID_FTIE = 55, /* Defined in 802.11r */ -+ EID_Timeout = 56, /* Defined in 802.11r */ -+ -+ EID_SupRegulatory = 59, /* Supported Requlatory Classes 802.11y */ -+ EID_HTInfo = 61, -+ EID_SecondaryChnlOffset = 62, -+ -+ EID_BSSCoexistence = 72, /* 20/40 BSS Coexistence */ -+ EID_BSSIntolerantChlReport = 73, -+ EID_OBSS = 74, /* Overlapping BSS Scan Parameters */ -+ -+ EID_LinkIdentifier = 101, /* Defined in 802.11z */ -+ EID_WakeupSchedule = 102, /* Defined in 802.11z */ -+ EID_ChnlSwitchTimeing = 104, /* Defined in 802.11z */ -+ EID_PTIControl = 105, /* Defined in 802.11z */ -+ EID_PUBufferStatus = 106, /* Defined in 802.11z */ -+ -+ EID_EXTCapability = 127, /* Extended Capabilities */ -+ /* From S19:Aironet IE and S21:AP IP address IE in CCX v1.13, p16 and p18. */ -+ EID_Aironet = 133, /* 0x85: Aironet Element for Cisco CCX */ -+ EID_CiscoIP = 149, /* 0x95: IP Address IE for Cisco CCX */ -+ -+ EID_CellPwr = 150, /* 0x96: Cell Power Limit IE. Ref. 0x96. */ -+ -+ EID_CCKM = 156, -+ -+ EID_Vendor = 221, /* 0xDD: Vendor Specific */ -+ -+ EID_WAPI = 68, -+ EID_VHTCapability = 191, /* Based on 802.11ac D2.0 */ -+ EID_VHTOperation = 192, /* Based on 802.11ac D2.0 */ -+ EID_AID = 197, /* Based on 802.11ac D4.0 */ -+ EID_OpModeNotification = 199, /* Based on 802.11ac D3.0 */ -+} ELEMENT_ID, *PELEMENT_ID; -+ -+/* --------------------------------------------------------------------------- -+ Below is the fixed elements... -+-----------------------------------------------------------------------------*/ -+#define _AUTH_ALGM_NUM_ 2 -+#define _AUTH_SEQ_NUM_ 2 -+#define _BEACON_ITERVAL_ 2 -+#define _CAPABILITY_ 2 -+#define _CURRENT_APADDR_ 6 -+#define _LISTEN_INTERVAL_ 2 -+#define _RSON_CODE_ 2 -+#define _ASOC_ID_ 2 -+#define _STATUS_CODE_ 2 -+#define _TIMESTAMP_ 8 -+ -+#define AUTH_ODD_TO 0 -+#define AUTH_EVEN_TO 1 -+ -+#define WLAN_ETHCONV_ENCAP 1 -+#define WLAN_ETHCONV_RFC1042 2 -+#define WLAN_ETHCONV_8021h 3 -+ -+#define cap_ESS BIT(0) -+#define cap_IBSS BIT(1) -+#define cap_CFPollable BIT(2) -+#define cap_CFRequest BIT(3) -+#define cap_Privacy BIT(4) -+#define cap_ShortPremble BIT(5) -+#define cap_PBCC BIT(6) -+#define cap_ChAgility BIT(7) -+#define cap_SpecMgmt BIT(8) -+#define cap_QoS BIT(9) -+#define cap_ShortSlot BIT(10) -+ -+/*----------------------------------------------------------------------------- -+ Below is the definition for 802.11i / 802.1x -+------------------------------------------------------------------------------*/ -+#define _IEEE8021X_MGT_ 1 /* WPA */ -+#define _IEEE8021X_PSK_ 2 /* WPA with pre-shared key */ -+ -+#if 0 -+#define _NO_PRIVACY_ 0 -+#define _WEP_40_PRIVACY_ 1 -+#define _TKIP_PRIVACY_ 2 -+#define _WRAP_PRIVACY_ 3 -+#define _CCMP_PRIVACY_ 4 -+#define _WEP_104_PRIVACY_ 5 -+#define _WEP_WPA_MIXED_PRIVACY_ 6 /* WEP + WPA */ -+#endif -+ -+#ifdef CONFIG_IEEE80211W -+#define _MME_IE_LENGTH_ 18 -+#endif /* CONFIG_IEEE80211W */ -+/*----------------------------------------------------------------------------- -+ Below is the definition for WMM -+------------------------------------------------------------------------------*/ -+#define _WMM_IE_Length_ 7 /* for WMM STA */ -+#define _WMM_Para_Element_Length_ 24 -+ -+ -+/*----------------------------------------------------------------------------- -+ Below is the definition for 802.11n -+------------------------------------------------------------------------------*/ -+ -+/* #ifdef CONFIG_80211N_HT */ -+ -+#define SetOrderBit(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_ORDER_); \ -+ } while (0) -+ -+#define GetOrderBit(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_ORDER_)) != 0) -+ -+#define ACT_CAT_VENDOR 0x7F/* 127 */ -+ -+/** -+ * struct rtw_ieee80211_bar - HT Block Ack Request -+ * -+ * This structure refers to "HT BlockAckReq" as -+ * described in 802.11n draft section 7.2.1.7.1 -+ */ -+#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8712FW) -+struct rtw_ieee80211_bar { -+ unsigned short frame_control; -+ unsigned short duration; -+ unsigned char ra[6]; -+ unsigned char ta[6]; -+ unsigned short control; -+ unsigned short start_seq_num; -+} __attribute__((packed)); -+#endif -+ -+/* 802.11 BAR control masks */ -+#define IEEE80211_BAR_CTRL_ACK_POLICY_NORMAL 0x0000 -+#define IEEE80211_BAR_CTRL_CBMTID_COMPRESSED_BA 0x0004 -+ -+ -+#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8712FW) || defined(PLATFORM_FREEBSD) -+ -+ -+ -+/** -+* struct rtw_ieee80211_ht_cap - HT capabilities -+* -+* This structure refers to "HT capabilities element" as -+* described in 802.11n draft section 7.3.2.52 -+*/ -+ -+struct rtw_ieee80211_ht_cap { -+ unsigned short cap_info; -+ unsigned char ampdu_params_info; -+ unsigned char supp_mcs_set[16]; -+ unsigned short extended_ht_cap_info; -+ unsigned int tx_BF_cap_info; -+ unsigned char antenna_selection_info; -+} __attribute__((packed)); -+ -+/** -+ * struct rtw_ieee80211_ht_cap - HT additional information -+ * -+ * This structure refers to "HT information element" as -+ * described in 802.11n draft section 7.3.2.53 -+ */ -+struct ieee80211_ht_addt_info { -+ unsigned char control_chan; -+ unsigned char ht_param; -+ unsigned short operation_mode; -+ unsigned short stbc_param; -+ unsigned char basic_set[16]; -+} __attribute__((packed)); -+ -+ -+struct HT_caps_element { -+ union { -+ struct { -+ unsigned short HT_caps_info; -+ unsigned char AMPDU_para; -+ unsigned char MCS_rate[16]; -+ unsigned short HT_ext_caps; -+ unsigned int Beamforming_caps; -+ unsigned char ASEL_caps; -+ } HT_cap_element; -+ unsigned char HT_cap[26]; -+ } u; -+} __attribute__((packed)); -+ -+struct HT_info_element { -+ unsigned char primary_channel; -+ unsigned char infos[5]; -+ unsigned char MCS_rate[16]; -+} __attribute__((packed)); -+ -+struct AC_param { -+ unsigned char ACI_AIFSN; -+ unsigned char CW; -+ unsigned short TXOP_limit; -+} __attribute__((packed)); -+ -+struct WMM_para_element { -+ unsigned char QoS_info; -+ unsigned char reserved; -+ struct AC_param ac_param[4]; -+} __attribute__((packed)); -+ -+struct ADDBA_request { -+ unsigned char dialog_token; -+ unsigned short BA_para_set; -+ unsigned short BA_timeout_value; -+ unsigned short BA_starting_seqctrl; -+} __attribute__((packed)); -+ -+ -+ -+#endif -+ -+ -+#ifdef PLATFORM_WINDOWS -+ -+#pragma pack(1) -+ -+struct rtw_ieee80211_ht_cap { -+ unsigned short cap_info; -+ unsigned char ampdu_params_info; -+ unsigned char supp_mcs_set[16]; -+ unsigned short extended_ht_cap_info; -+ unsigned int tx_BF_cap_info; -+ unsigned char antenna_selection_info; -+}; -+ -+ -+struct ieee80211_ht_addt_info { -+ unsigned char control_chan; -+ unsigned char ht_param; -+ unsigned short operation_mode; -+ unsigned short stbc_param; -+ unsigned char basic_set[16]; -+}; -+ -+struct HT_caps_element { -+ union { -+ struct { -+ unsigned short HT_caps_info; -+ unsigned char AMPDU_para; -+ unsigned char MCS_rate[16]; -+ unsigned short HT_ext_caps; -+ unsigned int Beamforming_caps; -+ unsigned char ASEL_caps; -+ } HT_cap_element; -+ unsigned char HT_cap[26]; -+ }; -+}; -+ -+struct HT_info_element { -+ unsigned char primary_channel; -+ unsigned char infos[5]; -+ unsigned char MCS_rate[16]; -+}; -+ -+struct AC_param { -+ unsigned char ACI_AIFSN; -+ unsigned char CW; -+ unsigned short TXOP_limit; -+}; -+ -+struct WMM_para_element { -+ unsigned char QoS_info; -+ unsigned char reserved; -+ struct AC_param ac_param[4]; -+}; -+ -+struct ADDBA_request { -+ unsigned char dialog_token; -+ unsigned short BA_para_set; -+ unsigned short BA_timeout_value; -+ unsigned short BA_starting_seqctrl; -+}; -+ -+ -+#pragma pack() -+ -+#endif -+ -+typedef enum _HT_CAP_AMPDU_FACTOR { -+ MAX_AMPDU_FACTOR_8K = 0, -+ MAX_AMPDU_FACTOR_16K = 1, -+ MAX_AMPDU_FACTOR_32K = 2, -+ MAX_AMPDU_FACTOR_64K = 3, -+} HT_CAP_AMPDU_FACTOR; -+ -+ -+typedef enum _HT_CAP_AMPDU_DENSITY { -+ AMPDU_DENSITY_VALUE_0 = 0 , /* For no restriction */ -+ AMPDU_DENSITY_VALUE_1 = 1 , /* For 1/4 us */ -+ AMPDU_DENSITY_VALUE_2 = 2 , /* For 1/2 us */ -+ AMPDU_DENSITY_VALUE_3 = 3 , /* For 1 us */ -+ AMPDU_DENSITY_VALUE_4 = 4 , /* For 2 us */ -+ AMPDU_DENSITY_VALUE_5 = 5 , /* For 4 us */ -+ AMPDU_DENSITY_VALUE_6 = 6 , /* For 8 us */ -+ AMPDU_DENSITY_VALUE_7 = 7 , /* For 16 us */ -+} HT_CAP_AMPDU_DENSITY; -+ -+/* 802.11n HT capabilities masks */ -+#define IEEE80211_HT_CAP_LDPC_CODING 0x0001 -+#define IEEE80211_HT_CAP_SUP_WIDTH 0x0002 -+#define IEEE80211_HT_CAP_SM_PS 0x000C -+#define IEEE80211_HT_CAP_GRN_FLD 0x0010 -+#define IEEE80211_HT_CAP_SGI_20 0x0020 -+#define IEEE80211_HT_CAP_SGI_40 0x0040 -+#define IEEE80211_HT_CAP_TX_STBC 0x0080 -+#define IEEE80211_HT_CAP_RX_STBC_1R 0x0100 -+#define IEEE80211_HT_CAP_RX_STBC_2R 0x0200 -+#define IEEE80211_HT_CAP_RX_STBC_3R 0x0300 -+#define IEEE80211_HT_CAP_DELAY_BA 0x0400 -+#define IEEE80211_HT_CAP_MAX_AMSDU 0x0800 -+#define IEEE80211_HT_CAP_DSSSCCK40 0x1000 -+#define RTW_IEEE80211_HT_CAP_40MHZ_INTOLERANT ((u16) BIT(14)) -+/* 802.11n HT capability AMPDU settings */ -+#define IEEE80211_HT_CAP_AMPDU_FACTOR 0x03 -+#define IEEE80211_HT_CAP_AMPDU_DENSITY 0x1C -+/* 802.11n HT capability MSC set */ -+#define IEEE80211_SUPP_MCS_SET_UEQM 4 -+#define IEEE80211_HT_CAP_MAX_STREAMS 4 -+#define IEEE80211_SUPP_MCS_SET_LEN 10 -+/* maximum streams the spec allows */ -+#define IEEE80211_HT_CAP_MCS_TX_DEFINED 0x01 -+#define IEEE80211_HT_CAP_MCS_TX_RX_DIFF 0x02 -+#define IEEE80211_HT_CAP_MCS_TX_STREAMS 0x0C -+#define IEEE80211_HT_CAP_MCS_TX_UEQM 0x10 -+/* 802.11n HT capability TXBF capability */ -+#define IEEE80211_HT_CAP_TXBF_RX_NDP 0x00000008 -+#define IEEE80211_HT_CAP_TXBF_TX_NDP 0x00000010 -+#define IEEE80211_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP 0x00000400 -+ -+/* 802.11n HT IE masks */ -+#define IEEE80211_HT_IE_CHA_SEC_OFFSET 0x03 -+#define IEEE80211_HT_IE_CHA_SEC_NONE 0x00 -+#define IEEE80211_HT_IE_CHA_SEC_ABOVE 0x01 -+#define IEEE80211_HT_IE_CHA_SEC_BELOW 0x03 -+#define IEEE80211_HT_IE_CHA_WIDTH 0x04 -+#define IEEE80211_HT_IE_HT_PROTECTION 0x0003 -+#define IEEE80211_HT_IE_NON_GF_STA_PRSNT 0x0004 -+#define IEEE80211_HT_IE_NON_HT_STA_PRSNT 0x0010 -+ -+/* block-ack parameters */ -+#define IEEE80211_ADDBA_PARAM_POLICY_MASK 0x0002 -+#define IEEE80211_ADDBA_PARAM_TID_MASK 0x003C -+#define RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK 0xFFC0 -+#define IEEE80211_DELBA_PARAM_TID_MASK 0xF000 -+#define IEEE80211_DELBA_PARAM_INITIATOR_MASK 0x0800 -+ -+/* -+ * A-PMDU buffer sizes -+ * According to IEEE802.11n spec size varies from 8K to 64K (in powers of 2) -+ */ -+#define IEEE80211_MIN_AMPDU_BUF 0x8 -+#define IEEE80211_MAX_AMPDU_BUF 0x40 -+ -+ -+/* Spatial Multiplexing Power Save Modes */ -+#define WLAN_HT_CAP_SM_PS_STATIC 0 -+#define WLAN_HT_CAP_SM_PS_DYNAMIC 1 -+#define WLAN_HT_CAP_SM_PS_INVALID 2 -+#define WLAN_HT_CAP_SM_PS_DISABLED 3 -+ -+ -+#define OP_MODE_PURE 0 -+#define OP_MODE_MAY_BE_LEGACY_STAS 1 -+#define OP_MODE_20MHZ_HT_STA_ASSOCED 2 -+#define OP_MODE_MIXED 3 -+ -+#define HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK ((u8) BIT(0) | BIT(1)) -+#define HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE ((u8) BIT(0)) -+#define HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW ((u8) BIT(0) | BIT(1)) -+#define HT_INFO_HT_PARAM_REC_TRANS_CHNL_WIDTH ((u8) BIT(2)) -+#define HT_INFO_HT_PARAM_RIFS_MODE ((u8) BIT(3)) -+#define HT_INFO_HT_PARAM_CTRL_ACCESS_ONLY ((u8) BIT(4)) -+#define HT_INFO_HT_PARAM_SRV_INTERVAL_GRANULARITY ((u8) BIT(5)) -+ -+#define HT_INFO_OPERATION_MODE_OP_MODE_MASK \ -+ ((u16) (0x0001 | 0x0002)) -+#define HT_INFO_OPERATION_MODE_OP_MODE_OFFSET 0 -+#define HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT ((u8) BIT(2)) -+#define HT_INFO_OPERATION_MODE_TRANSMIT_BURST_LIMIT ((u8) BIT(3)) -+#define HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT ((u8) BIT(4)) -+ -+#define HT_INFO_STBC_PARAM_DUAL_BEACON ((u16) BIT(6)) -+#define HT_INFO_STBC_PARAM_DUAL_STBC_PROTECT ((u16) BIT(7)) -+#define HT_INFO_STBC_PARAM_SECONDARY_BCN ((u16) BIT(8)) -+#define HT_INFO_STBC_PARAM_LSIG_TXOP_PROTECT_ALLOWED ((u16) BIT(9)) -+#define HT_INFO_STBC_PARAM_PCO_ACTIVE ((u16) BIT(10)) -+#define HT_INFO_STBC_PARAM_PCO_PHASE ((u16) BIT(11)) -+ -+ -+ -+/* #endif */ -+ -+/* ===============WPS Section=============== */ -+/* For WPSv1.0 */ -+#define WPSOUI 0x0050f204 -+/* WPS attribute ID */ -+#define WPS_ATTR_VER1 0x104A -+#define WPS_ATTR_SIMPLE_CONF_STATE 0x1044 -+#define WPS_ATTR_RESP_TYPE 0x103B -+#define WPS_ATTR_UUID_E 0x1047 -+#define WPS_ATTR_MANUFACTURER 0x1021 -+#define WPS_ATTR_MODEL_NAME 0x1023 -+#define WPS_ATTR_MODEL_NUMBER 0x1024 -+#define WPS_ATTR_SERIAL_NUMBER 0x1042 -+#define WPS_ATTR_PRIMARY_DEV_TYPE 0x1054 -+#define WPS_ATTR_SEC_DEV_TYPE_LIST 0x1055 -+#define WPS_ATTR_DEVICE_NAME 0x1011 -+#define WPS_ATTR_CONF_METHOD 0x1008 -+#define WPS_ATTR_RF_BANDS 0x103C -+#define WPS_ATTR_DEVICE_PWID 0x1012 -+#define WPS_ATTR_REQUEST_TYPE 0x103A -+#define WPS_ATTR_ASSOCIATION_STATE 0x1002 -+#define WPS_ATTR_CONFIG_ERROR 0x1009 -+#define WPS_ATTR_VENDOR_EXT 0x1049 -+#define WPS_ATTR_SELECTED_REGISTRAR 0x1041 -+ -+/* Value of WPS attribute "WPS_ATTR_DEVICE_NAME */ -+#define WPS_MAX_DEVICE_NAME_LEN 32 -+ -+/* Value of WPS Request Type Attribute */ -+#define WPS_REQ_TYPE_ENROLLEE_INFO_ONLY 0x00 -+#define WPS_REQ_TYPE_ENROLLEE_OPEN_8021X 0x01 -+#define WPS_REQ_TYPE_REGISTRAR 0x02 -+#define WPS_REQ_TYPE_WLAN_MANAGER_REGISTRAR 0x03 -+ -+/* Value of WPS Response Type Attribute */ -+#define WPS_RESPONSE_TYPE_INFO_ONLY 0x00 -+#define WPS_RESPONSE_TYPE_8021X 0x01 -+#define WPS_RESPONSE_TYPE_REGISTRAR 0x02 -+#define WPS_RESPONSE_TYPE_AP 0x03 -+ -+/* Value of WPS WiFi Simple Configuration State Attribute */ -+#define WPS_WSC_STATE_NOT_CONFIG 0x01 -+#define WPS_WSC_STATE_CONFIG 0x02 -+ -+/* Value of WPS Version Attribute */ -+#define WPS_VERSION_1 0x10 -+ -+/* Value of WPS Configuration Method Attribute */ -+#define WPS_CONFIG_METHOD_FLASH 0x0001 -+#define WPS_CONFIG_METHOD_ETHERNET 0x0002 -+#define WPS_CONFIG_METHOD_LABEL 0x0004 -+#define WPS_CONFIG_METHOD_DISPLAY 0x0008 -+#define WPS_CONFIG_METHOD_E_NFC 0x0010 -+#define WPS_CONFIG_METHOD_I_NFC 0x0020 -+#define WPS_CONFIG_METHOD_NFC 0x0040 -+#define WPS_CONFIG_METHOD_PBC 0x0080 -+#define WPS_CONFIG_METHOD_KEYPAD 0x0100 -+#define WPS_CONFIG_METHOD_VPBC 0x0280 -+#define WPS_CONFIG_METHOD_PPBC 0x0480 -+#define WPS_CONFIG_METHOD_VDISPLAY 0x2008 -+#define WPS_CONFIG_METHOD_PDISPLAY 0x4008 -+ -+/* Value of Category ID of WPS Primary Device Type Attribute */ -+#define WPS_PDT_CID_DISPLAYS 0x0007 -+#define WPS_PDT_CID_MULIT_MEDIA 0x0008 -+#define WPS_PDT_CID_RTK_WIDI WPS_PDT_CID_MULIT_MEDIA -+ -+/* Value of Sub Category ID of WPS Primary Device Type Attribute */ -+#define WPS_PDT_SCID_MEDIA_SERVER 0x0005 -+#define WPS_PDT_SCID_RTK_DMP WPS_PDT_SCID_MEDIA_SERVER -+ -+/* Value of Device Password ID */ -+#define WPS_DPID_PIN 0x0000 -+#define WPS_DPID_USER_SPEC 0x0001 -+#define WPS_DPID_MACHINE_SPEC 0x0002 -+#define WPS_DPID_REKEY 0x0003 -+#define WPS_DPID_PBC 0x0004 -+#define WPS_DPID_REGISTRAR_SPEC 0x0005 -+ -+/* Value of WPS RF Bands Attribute */ -+#define WPS_RF_BANDS_2_4_GHZ 0x01 -+#define WPS_RF_BANDS_5_GHZ 0x02 -+ -+/* Value of WPS Association State Attribute */ -+#define WPS_ASSOC_STATE_NOT_ASSOCIATED 0x00 -+#define WPS_ASSOC_STATE_CONNECTION_SUCCESS 0x01 -+#define WPS_ASSOC_STATE_CONFIGURATION_FAILURE 0x02 -+#define WPS_ASSOC_STATE_ASSOCIATION_FAILURE 0x03 -+#define WPS_ASSOC_STATE_IP_FAILURE 0x04 -+ -+/* =====================P2P Section===================== */ -+/* For P2P */ -+#define P2POUI 0x506F9A09 -+ -+/* P2P Attribute ID */ -+#define P2P_ATTR_STATUS 0x00 -+#define P2P_ATTR_MINOR_REASON_CODE 0x01 -+#define P2P_ATTR_CAPABILITY 0x02 -+#define P2P_ATTR_DEVICE_ID 0x03 -+#define P2P_ATTR_GO_INTENT 0x04 -+#define P2P_ATTR_CONF_TIMEOUT 0x05 -+#define P2P_ATTR_LISTEN_CH 0x06 -+#define P2P_ATTR_GROUP_BSSID 0x07 -+#define P2P_ATTR_EX_LISTEN_TIMING 0x08 -+#define P2P_ATTR_INTENDED_IF_ADDR 0x09 -+#define P2P_ATTR_MANAGEABILITY 0x0A -+#define P2P_ATTR_CH_LIST 0x0B -+#define P2P_ATTR_NOA 0x0C -+#define P2P_ATTR_DEVICE_INFO 0x0D -+#define P2P_ATTR_GROUP_INFO 0x0E -+#define P2P_ATTR_GROUP_ID 0x0F -+#define P2P_ATTR_INTERFACE 0x10 -+#define P2P_ATTR_OPERATING_CH 0x11 -+#define P2P_ATTR_INVITATION_FLAGS 0x12 -+ -+/* Value of Status Attribute */ -+#define P2P_STATUS_SUCCESS 0x00 -+#define P2P_STATUS_FAIL_INFO_UNAVAILABLE 0x01 -+#define P2P_STATUS_FAIL_INCOMPATIBLE_PARAM 0x02 -+#define P2P_STATUS_FAIL_LIMIT_REACHED 0x03 -+#define P2P_STATUS_FAIL_INVALID_PARAM 0x04 -+#define P2P_STATUS_FAIL_REQUEST_UNABLE 0x05 -+#define P2P_STATUS_FAIL_PREVOUS_PROTO_ERR 0x06 -+#define P2P_STATUS_FAIL_NO_COMMON_CH 0x07 -+#define P2P_STATUS_FAIL_UNKNOWN_P2PGROUP 0x08 -+#define P2P_STATUS_FAIL_BOTH_GOINTENT_15 0x09 -+#define P2P_STATUS_FAIL_INCOMPATIBLE_PROVSION 0x0A -+#define P2P_STATUS_FAIL_USER_REJECT 0x0B -+ -+/* Value of Inviation Flags Attribute */ -+#define P2P_INVITATION_FLAGS_PERSISTENT BIT(0) -+ -+#define DMP_P2P_DEVCAP_SUPPORT (P2P_DEVCAP_SERVICE_DISCOVERY | \ -+ P2P_DEVCAP_CLIENT_DISCOVERABILITY | \ -+ P2P_DEVCAP_CONCURRENT_OPERATION | \ -+ P2P_DEVCAP_INVITATION_PROC) -+ -+#define DMP_P2P_GRPCAP_SUPPORT (P2P_GRPCAP_INTRABSS) -+ -+/* Value of Device Capability Bitmap */ -+#define P2P_DEVCAP_SERVICE_DISCOVERY BIT(0) -+#define P2P_DEVCAP_CLIENT_DISCOVERABILITY BIT(1) -+#define P2P_DEVCAP_CONCURRENT_OPERATION BIT(2) -+#define P2P_DEVCAP_INFRA_MANAGED BIT(3) -+#define P2P_DEVCAP_DEVICE_LIMIT BIT(4) -+#define P2P_DEVCAP_INVITATION_PROC BIT(5) -+ -+/* Value of Group Capability Bitmap */ -+#define P2P_GRPCAP_GO BIT(0) -+#define P2P_GRPCAP_PERSISTENT_GROUP BIT(1) -+#define P2P_GRPCAP_GROUP_LIMIT BIT(2) -+#define P2P_GRPCAP_INTRABSS BIT(3) -+#define P2P_GRPCAP_CROSS_CONN BIT(4) -+#define P2P_GRPCAP_PERSISTENT_RECONN BIT(5) -+#define P2P_GRPCAP_GROUP_FORMATION BIT(6) -+ -+/* P2P Public Action Frame ( Management Frame ) */ -+#define P2P_PUB_ACTION_ACTION 0x09 -+ -+/* P2P Public Action Frame Type */ -+#define P2P_GO_NEGO_REQ 0 -+#define P2P_GO_NEGO_RESP 1 -+#define P2P_GO_NEGO_CONF 2 -+#define P2P_INVIT_REQ 3 -+#define P2P_INVIT_RESP 4 -+#define P2P_DEVDISC_REQ 5 -+#define P2P_DEVDISC_RESP 6 -+#define P2P_PROVISION_DISC_REQ 7 -+#define P2P_PROVISION_DISC_RESP 8 -+ -+/* P2P Action Frame Type */ -+#define P2P_NOTICE_OF_ABSENCE 0 -+#define P2P_PRESENCE_REQUEST 1 -+#define P2P_PRESENCE_RESPONSE 2 -+#define P2P_GO_DISC_REQUEST 3 -+ -+ -+#define P2P_MAX_PERSISTENT_GROUP_NUM 10 -+ -+#define P2P_PROVISIONING_SCAN_CNT 3 -+ -+#define P2P_WILDCARD_SSID_LEN 7 -+ -+#define P2P_FINDPHASE_EX_NONE 0 /* default value, used when: (1)p2p disabed or (2)p2p enabled but only do 1 scan phase */ -+#define P2P_FINDPHASE_EX_FULL 1 /* used when p2p enabled and want to do 1 scan phase and P2P_FINDPHASE_EX_MAX-1 find phase */ -+#define P2P_FINDPHASE_EX_SOCIAL_FIRST (P2P_FINDPHASE_EX_FULL+1) -+#define P2P_FINDPHASE_EX_MAX 4 -+#define P2P_FINDPHASE_EX_SOCIAL_LAST P2P_FINDPHASE_EX_MAX -+ -+#define P2P_PROVISION_TIMEOUT 5000 /* 5 seconds timeout for sending the provision discovery request */ -+#define P2P_CONCURRENT_PROVISION_TIMEOUT 3000 /* 3 seconds timeout for sending the provision discovery request under concurrent mode */ -+#define P2P_GO_NEGO_TIMEOUT 5000 /* 5 seconds timeout for receiving the group negotation response */ -+#define P2P_CONCURRENT_GO_NEGO_TIMEOUT 3000 /* 3 seconds timeout for sending the negotiation request under concurrent mode */ -+#define P2P_TX_PRESCAN_TIMEOUT 100 /* 100ms */ -+#define P2P_INVITE_TIMEOUT 5000 /* 5 seconds timeout for sending the invitation request */ -+#define P2P_CONCURRENT_INVITE_TIMEOUT 3000 /* 3 seconds timeout for sending the invitation request under concurrent mode */ -+#define P2P_RESET_SCAN_CH 25000 /* 25 seconds timeout to reset the scan channel (based on channel plan) */ -+#define P2P_MAX_INTENT 15 -+ -+#define P2P_MAX_NOA_NUM 2 -+ -+/* WPS Configuration Method */ -+#define WPS_CM_NONE 0x0000 -+#define WPS_CM_LABEL 0x0004 -+#define WPS_CM_DISPLYA 0x0008 -+#define WPS_CM_EXTERNAL_NFC_TOKEN 0x0010 -+#define WPS_CM_INTEGRATED_NFC_TOKEN 0x0020 -+#define WPS_CM_NFC_INTERFACE 0x0040 -+#define WPS_CM_PUSH_BUTTON 0x0080 -+#define WPS_CM_KEYPAD 0x0100 -+#define WPS_CM_SW_PUHS_BUTTON 0x0280 -+#define WPS_CM_HW_PUHS_BUTTON 0x0480 -+#define WPS_CM_SW_DISPLAY_PIN 0x2008 -+#define WPS_CM_LCD_DISPLAY_PIN 0x4008 -+ -+enum P2P_ROLE { -+ P2P_ROLE_DISABLE = 0, -+ P2P_ROLE_DEVICE = 1, -+ P2P_ROLE_CLIENT = 2, -+ P2P_ROLE_GO = 3 -+}; -+ -+enum P2P_STATE { -+ P2P_STATE_NONE = 0, /* P2P disable */ -+ P2P_STATE_IDLE = 1, /* P2P had enabled and do nothing , buddy adapters is linked */ -+ P2P_STATE_LISTEN = 2, /* In pure listen state */ -+ P2P_STATE_SCAN = 3, /* In scan phase */ -+ P2P_STATE_FIND_PHASE_LISTEN = 4, /* In the listen state of find phase */ -+ P2P_STATE_FIND_PHASE_SEARCH = 5, /* In the search state of find phase */ -+ P2P_STATE_TX_PROVISION_DIS_REQ = 6, /* In P2P provisioning discovery */ -+ P2P_STATE_RX_PROVISION_DIS_RSP = 7, -+ P2P_STATE_RX_PROVISION_DIS_REQ = 8, -+ P2P_STATE_GONEGO_ING = 9, /* Doing the group owner negoitation handshake */ -+ P2P_STATE_GONEGO_OK = 10, /* finish the group negoitation handshake with success */ -+ P2P_STATE_GONEGO_FAIL = 11, /* finish the group negoitation handshake with failure */ -+ P2P_STATE_RECV_INVITE_REQ_MATCH = 12, /* receiving the P2P Inviation request and match with the profile. */ -+ P2P_STATE_PROVISIONING_ING = 13, /* Doing the P2P WPS */ -+ P2P_STATE_PROVISIONING_DONE = 14, /* Finish the P2P WPS */ -+ P2P_STATE_TX_INVITE_REQ = 15, /* Transmit the P2P Invitation request */ -+ P2P_STATE_RX_INVITE_RESP_OK = 16, /* Receiving the P2P Invitation response */ -+ P2P_STATE_RECV_INVITE_REQ_DISMATCH = 17, /* receiving the P2P Inviation request and dismatch with the profile. */ -+ P2P_STATE_RECV_INVITE_REQ_GO = 18, /* receiving the P2P Inviation request and this wifi is GO. */ -+ P2P_STATE_RECV_INVITE_REQ_JOIN = 19, /* receiving the P2P Inviation request to join an existing P2P Group. */ -+ P2P_STATE_RX_INVITE_RESP_FAIL = 20, /* recveing the P2P Inviation response with failure */ -+ P2P_STATE_RX_INFOR_NOREADY = 21, /* receiving p2p negoitation response with information is not available */ -+ P2P_STATE_TX_INFOR_NOREADY = 22, /* sending p2p negoitation response with information is not available */ -+}; -+ -+enum P2P_WPSINFO { -+ P2P_NO_WPSINFO = 0, -+ P2P_GOT_WPSINFO_PEER_DISPLAY_PIN = 1, -+ P2P_GOT_WPSINFO_SELF_DISPLAY_PIN = 2, -+ P2P_GOT_WPSINFO_PBC = 3, -+}; -+ -+#define P2P_PRIVATE_IOCTL_SET_LEN 64 -+ -+enum P2P_PROTO_WK_ID { -+ P2P_FIND_PHASE_WK = 0, -+ P2P_RESTORE_STATE_WK = 1, -+ P2P_PRE_TX_PROVDISC_PROCESS_WK = 2, -+ P2P_PRE_TX_NEGOREQ_PROCESS_WK = 3, -+ P2P_PRE_TX_INVITEREQ_PROCESS_WK = 4, -+ P2P_AP_P2P_CH_SWITCH_PROCESS_WK = 5, -+ P2P_RO_CH_WK = 6, -+ P2P_CANCEL_RO_CH_WK = 7, -+}; -+ -+#ifdef CONFIG_P2P_PS -+enum P2P_PS_STATE { -+ P2P_PS_DISABLE = 0, -+ P2P_PS_ENABLE = 1, -+ P2P_PS_SCAN = 2, -+ P2P_PS_SCAN_DONE = 3, -+ P2P_PS_ALLSTASLEEP = 4, /* for P2P GO */ -+}; -+ -+enum P2P_PS_MODE { -+ P2P_PS_NONE = 0, -+ P2P_PS_CTWINDOW = 1, -+ P2P_PS_NOA = 2, -+ P2P_PS_MIX = 3, /* CTWindow and NoA */ -+}; -+#endif /* CONFIG_P2P_PS */ -+ -+/* =====================WFD Section===================== -+ * For Wi-Fi Display */ -+#define WFD_ATTR_DEVICE_INFO 0x00 -+#define WFD_ATTR_ASSOC_BSSID 0x01 -+#define WFD_ATTR_COUPLED_SINK_INFO 0x06 -+#define WFD_ATTR_LOCAL_IP_ADDR 0x08 -+#define WFD_ATTR_SESSION_INFO 0x09 -+#define WFD_ATTR_ALTER_MAC 0x0a -+ -+/* For WFD Device Information Attribute */ -+#define WFD_DEVINFO_SOURCE 0x0000 -+#define WFD_DEVINFO_PSINK 0x0001 -+#define WFD_DEVINFO_SSINK 0x0002 -+#define WFD_DEVINFO_DUAL 0x0003 -+ -+#define WFD_DEVINFO_SESSION_AVAIL 0x0010 -+#define WFD_DEVINFO_WSD 0x0040 -+#define WFD_DEVINFO_PC_TDLS 0x0080 -+#define WFD_DEVINFO_HDCP_SUPPORT 0x0100 -+ -+#ifdef CONFIG_TX_MCAST2UNI -+#define IP_MCAST_MAC(mac) ((mac[0] == 0x01) && (mac[1] == 0x00) && (mac[2] == 0x5e)) -+#define ICMPV6_MCAST_MAC(mac) ((mac[0] == 0x33) && (mac[1] == 0x33) && (mac[2] != 0xff)) -+#endif /* CONFIG_TX_MCAST2UNI */ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+/* Regulatroy Domain */ -+struct regd_pair_mapping { -+ u16 reg_dmnenum; -+ u16 reg_5ghz_ctl; -+ u16 reg_2ghz_ctl; -+}; -+ -+struct rtw_regulatory { -+ char alpha2[2]; -+ u16 country_code; -+ u16 max_power_level; -+ u32 tp_scale; -+ u16 current_rd; -+ u16 current_rd_ext; -+ int16_t power_limit; -+ struct regd_pair_mapping *regpair; -+}; -+#endif -+ -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef IW_AUTH_WAPI_VERSION_1 -+#define IW_AUTH_WAPI_VERSION_1 0x00000008 -+#endif -+#ifndef IW_AUTH_KEY_MGMT_WAPI_PSK -+#define IW_AUTH_KEY_MGMT_WAPI_PSK 0x04 -+#endif -+#ifndef IW_AUTH_WAPI_ENABLED -+#define IW_AUTH_WAPI_ENABLED 0x20 -+#endif -+#ifndef IW_ENCODE_ALG_SM4 -+#define IW_ENCODE_ALG_SM4 0x20 -+#endif -+#endif -+ -+#endif /* _WIFI_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/wlan_bssdef.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/wlan_bssdef.h ---- linux-4.14.18/3rdparty/rtl8723de/include/wlan_bssdef.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/wlan_bssdef.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,690 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __WLAN_BSSDEF_H__ -+#define __WLAN_BSSDEF_H__ -+ -+ -+#define MAX_IE_SZ 768 -+ -+ -+#ifdef PLATFORM_LINUX -+ -+#define NDIS_802_11_LENGTH_SSID 32 -+#define NDIS_802_11_LENGTH_RATES 8 -+#define NDIS_802_11_LENGTH_RATES_EX 16 -+ -+typedef unsigned char NDIS_802_11_MAC_ADDRESS[6]; -+typedef long NDIS_802_11_RSSI; /* in dBm */ -+typedef unsigned char NDIS_802_11_RATES[NDIS_802_11_LENGTH_RATES]; /* Set of 8 data rates */ -+typedef unsigned char NDIS_802_11_RATES_EX[NDIS_802_11_LENGTH_RATES_EX]; /* Set of 16 data rates */ -+ -+ -+typedef ULONG NDIS_802_11_KEY_INDEX; -+typedef unsigned long long NDIS_802_11_KEY_RSC; -+ -+ -+typedef struct _NDIS_802_11_SSID { -+ ULONG SsidLength; -+ UCHAR Ssid[32]; -+} NDIS_802_11_SSID, *PNDIS_802_11_SSID; -+ -+typedef enum _NDIS_802_11_NETWORK_TYPE { -+ Ndis802_11FH, -+ Ndis802_11DS, -+ Ndis802_11OFDM5, -+ Ndis802_11OFDM24, -+ Ndis802_11NetworkTypeMax /* not a real type, defined as an upper bound */ -+} NDIS_802_11_NETWORK_TYPE, *PNDIS_802_11_NETWORK_TYPE; -+ -+typedef struct _NDIS_802_11_CONFIGURATION_FH { -+ ULONG Length; /* Length of structure */ -+ ULONG HopPattern; /* As defined by 802.11, MSB set */ -+ ULONG HopSet; /* to one if non-802.11 */ -+ ULONG DwellTime; /* units are Kusec */ -+} NDIS_802_11_CONFIGURATION_FH, *PNDIS_802_11_CONFIGURATION_FH; -+ -+ -+/* -+ FW will only save the channel number in DSConfig. -+ ODI Handler will convert the channel number to freq. number. -+*/ -+typedef struct _NDIS_802_11_CONFIGURATION { -+ ULONG Length; /* Length of structure */ -+ ULONG BeaconPeriod; /* units are Kusec */ -+ ULONG ATIMWindow; /* units are Kusec */ -+ ULONG DSConfig; /* channel number */ -+ NDIS_802_11_CONFIGURATION_FH FHConfig; -+} NDIS_802_11_CONFIGURATION, *PNDIS_802_11_CONFIGURATION; -+ -+ -+ -+typedef enum _NDIS_802_11_NETWORK_INFRASTRUCTURE { -+ Ndis802_11IBSS, -+ Ndis802_11Infrastructure, -+ Ndis802_11AutoUnknown, -+ Ndis802_11InfrastructureMax, /* Not a real value, defined as upper bound */ -+ Ndis802_11APMode, -+ Ndis802_11Monitor, -+} NDIS_802_11_NETWORK_INFRASTRUCTURE, *PNDIS_802_11_NETWORK_INFRASTRUCTURE; -+ -+ -+ -+ -+ -+typedef struct _NDIS_802_11_FIXED_IEs { -+ UCHAR Timestamp[8]; -+ USHORT BeaconInterval; -+ USHORT Capabilities; -+} NDIS_802_11_FIXED_IEs, *PNDIS_802_11_FIXED_IEs; -+ -+ -+ -+typedef struct _NDIS_802_11_VARIABLE_IEs { -+ UCHAR ElementID; -+ UCHAR Length; -+ UCHAR data[1]; -+} NDIS_802_11_VARIABLE_IEs, *PNDIS_802_11_VARIABLE_IEs; -+ -+ -+ -+/* -+ -+ -+ -+Length is the 4 bytes multiples of the sume of -+ sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + sizeof (NDIS_802_11_SSID) + sizeof (ULONG) -++ sizeof (NDIS_802_11_RSSI) + sizeof (NDIS_802_11_NETWORK_TYPE) + sizeof (NDIS_802_11_CONFIGURATION) -++ sizeof (NDIS_802_11_RATES_EX) + IELength -+ -+Except the IELength, all other fields are fixed length. Therefore, we can define a marco to present the -+partial sum. -+ -+*/ -+#if 0 -+typedef struct _NDIS_WLAN_BSSID_EX { -+ ULONG Length; -+ NDIS_802_11_MAC_ADDRESS MacAddress; -+ UCHAR Reserved[2];/* [0]: IS beacon frame, [1]:optimum_antenna=>For antenna diversity; */ -+ NDIS_802_11_SSID Ssid; -+ ULONG Privacy; -+ NDIS_802_11_RSSI Rssi; -+ NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; -+ NDIS_802_11_CONFIGURATION Configuration; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; -+ NDIS_802_11_RATES_EX SupportedRates; -+ ULONG IELength; -+ UCHAR IEs[MAX_IE_SZ]; /* (timestamp, beacon interval, and capability information) */ -+} NDIS_WLAN_BSSID_EX, *PNDIS_WLAN_BSSID_EX; -+ -+ -+typedef struct _NDIS_802_11_BSSID_LIST_EX { -+ ULONG NumberOfItems; -+ NDIS_WLAN_BSSID_EX Bssid[1]; -+} NDIS_802_11_BSSID_LIST_EX, *PNDIS_802_11_BSSID_LIST_EX; -+#endif -+ -+typedef enum _NDIS_802_11_AUTHENTICATION_MODE { -+ Ndis802_11AuthModeOpen, -+ Ndis802_11AuthModeShared, -+ Ndis802_11AuthModeAutoSwitch, -+ Ndis802_11AuthModeWPA, -+ Ndis802_11AuthModeWPAPSK, -+ Ndis802_11AuthModeWPANone, -+ Ndis802_11AuthModeWAPI, -+ Ndis802_11AuthModeMax /* Not a real mode, defined as upper bound */ -+} NDIS_802_11_AUTHENTICATION_MODE, *PNDIS_802_11_AUTHENTICATION_MODE; -+ -+typedef enum _NDIS_802_11_WEP_STATUS { -+ Ndis802_11WEPEnabled, -+ Ndis802_11Encryption1Enabled = Ndis802_11WEPEnabled, -+ Ndis802_11WEPDisabled, -+ Ndis802_11EncryptionDisabled = Ndis802_11WEPDisabled, -+ Ndis802_11WEPKeyAbsent, -+ Ndis802_11Encryption1KeyAbsent = Ndis802_11WEPKeyAbsent, -+ Ndis802_11WEPNotSupported, -+ Ndis802_11EncryptionNotSupported = Ndis802_11WEPNotSupported, -+ Ndis802_11Encryption2Enabled, -+ Ndis802_11Encryption2KeyAbsent, -+ Ndis802_11Encryption3Enabled, -+ Ndis802_11Encryption3KeyAbsent, -+ Ndis802_11_EncrypteionWAPI -+} NDIS_802_11_WEP_STATUS, *PNDIS_802_11_WEP_STATUS, -+NDIS_802_11_ENCRYPTION_STATUS, *PNDIS_802_11_ENCRYPTION_STATUS; -+ -+ -+#define NDIS_802_11_AI_REQFI_CAPABILITIES 1 -+#define NDIS_802_11_AI_REQFI_LISTENINTERVAL 2 -+#define NDIS_802_11_AI_REQFI_CURRENTAPADDRESS 4 -+ -+#define NDIS_802_11_AI_RESFI_CAPABILITIES 1 -+#define NDIS_802_11_AI_RESFI_STATUSCODE 2 -+#define NDIS_802_11_AI_RESFI_ASSOCIATIONID 4 -+ -+typedef struct _NDIS_802_11_AI_REQFI { -+ USHORT Capabilities; -+ USHORT ListenInterval; -+ NDIS_802_11_MAC_ADDRESS CurrentAPAddress; -+} NDIS_802_11_AI_REQFI, *PNDIS_802_11_AI_REQFI; -+ -+typedef struct _NDIS_802_11_AI_RESFI { -+ USHORT Capabilities; -+ USHORT StatusCode; -+ USHORT AssociationId; -+} NDIS_802_11_AI_RESFI, *PNDIS_802_11_AI_RESFI; -+ -+typedef struct _NDIS_802_11_ASSOCIATION_INFORMATION { -+ ULONG Length; -+ USHORT AvailableRequestFixedIEs; -+ NDIS_802_11_AI_REQFI RequestFixedIEs; -+ ULONG RequestIELength; -+ ULONG OffsetRequestIEs; -+ USHORT AvailableResponseFixedIEs; -+ NDIS_802_11_AI_RESFI ResponseFixedIEs; -+ ULONG ResponseIELength; -+ ULONG OffsetResponseIEs; -+} NDIS_802_11_ASSOCIATION_INFORMATION, *PNDIS_802_11_ASSOCIATION_INFORMATION; -+ -+typedef enum _NDIS_802_11_RELOAD_DEFAULTS { -+ Ndis802_11ReloadWEPKeys -+} NDIS_802_11_RELOAD_DEFAULTS, *PNDIS_802_11_RELOAD_DEFAULTS; -+ -+ -+/* Key mapping keys require a BSSID */ -+typedef struct _NDIS_802_11_KEY { -+ ULONG Length; /* Length of this structure */ -+ ULONG KeyIndex; -+ ULONG KeyLength; /* length of key in bytes */ -+ NDIS_802_11_MAC_ADDRESS BSSID; -+ NDIS_802_11_KEY_RSC KeyRSC; -+ UCHAR KeyMaterial[32]; /* variable length depending on above field */ -+} NDIS_802_11_KEY, *PNDIS_802_11_KEY; -+ -+typedef struct _NDIS_802_11_REMOVE_KEY { -+ ULONG Length; /* Length of this structure */ -+ ULONG KeyIndex; -+ NDIS_802_11_MAC_ADDRESS BSSID; -+} NDIS_802_11_REMOVE_KEY, *PNDIS_802_11_REMOVE_KEY; -+ -+typedef struct _NDIS_802_11_WEP { -+ ULONG Length; /* Length of this structure */ -+ ULONG KeyIndex; /* 0 is the per-client key, 1-N are the global keys */ -+ ULONG KeyLength; /* length of key in bytes */ -+ UCHAR KeyMaterial[16];/* variable length depending on above field */ -+} NDIS_802_11_WEP, *PNDIS_802_11_WEP; -+ -+typedef struct _NDIS_802_11_AUTHENTICATION_REQUEST { -+ ULONG Length; /* Length of structure */ -+ NDIS_802_11_MAC_ADDRESS Bssid; -+ ULONG Flags; -+} NDIS_802_11_AUTHENTICATION_REQUEST, *PNDIS_802_11_AUTHENTICATION_REQUEST; -+ -+typedef enum _NDIS_802_11_STATUS_TYPE { -+ Ndis802_11StatusType_Authentication, -+ Ndis802_11StatusType_MediaStreamMode, -+ Ndis802_11StatusType_PMKID_CandidateList, -+ Ndis802_11StatusTypeMax /* not a real type, defined as an upper bound */ -+} NDIS_802_11_STATUS_TYPE, *PNDIS_802_11_STATUS_TYPE; -+ -+typedef struct _NDIS_802_11_STATUS_INDICATION { -+ NDIS_802_11_STATUS_TYPE StatusType; -+} NDIS_802_11_STATUS_INDICATION, *PNDIS_802_11_STATUS_INDICATION; -+ -+/* mask for authentication/integrity fields */ -+#define NDIS_802_11_AUTH_REQUEST_AUTH_FIELDS 0x0f -+#define NDIS_802_11_AUTH_REQUEST_REAUTH 0x01 -+#define NDIS_802_11_AUTH_REQUEST_KEYUPDATE 0x02 -+#define NDIS_802_11_AUTH_REQUEST_PAIRWISE_ERROR 0x06 -+#define NDIS_802_11_AUTH_REQUEST_GROUP_ERROR 0x0E -+ -+/* MIC check time, 60 seconds. */ -+#define MIC_CHECK_TIME 60000000 -+ -+typedef struct _NDIS_802_11_AUTHENTICATION_EVENT { -+ NDIS_802_11_STATUS_INDICATION Status; -+ NDIS_802_11_AUTHENTICATION_REQUEST Request[1]; -+} NDIS_802_11_AUTHENTICATION_EVENT, *PNDIS_802_11_AUTHENTICATION_EVENT; -+ -+typedef struct _NDIS_802_11_TEST { -+ ULONG Length; -+ ULONG Type; -+ union { -+ NDIS_802_11_AUTHENTICATION_EVENT AuthenticationEvent; -+ NDIS_802_11_RSSI RssiTrigger; -+ } tt; -+} NDIS_802_11_TEST, *PNDIS_802_11_TEST; -+ -+ -+#endif /* end of #ifdef PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ -+#define NDIS_802_11_LENGTH_SSID 32 -+#define NDIS_802_11_LENGTH_RATES 8 -+#define NDIS_802_11_LENGTH_RATES_EX 16 -+ -+typedef unsigned char NDIS_802_11_MAC_ADDRESS[6]; -+typedef long NDIS_802_11_RSSI; /* in dBm */ -+typedef unsigned char NDIS_802_11_RATES[NDIS_802_11_LENGTH_RATES]; /* Set of 8 data rates */ -+typedef unsigned char NDIS_802_11_RATES_EX[NDIS_802_11_LENGTH_RATES_EX]; /* Set of 16 data rates */ -+ -+ -+typedef ULONG NDIS_802_11_KEY_INDEX; -+typedef unsigned long long NDIS_802_11_KEY_RSC; -+ -+ -+typedef struct _NDIS_802_11_SSID { -+ ULONG SsidLength; -+ UCHAR Ssid[32]; -+} NDIS_802_11_SSID, *PNDIS_802_11_SSID; -+ -+typedef enum _NDIS_802_11_NETWORK_TYPE { -+ Ndis802_11FH, -+ Ndis802_11DS, -+ Ndis802_11OFDM5, -+ Ndis802_11OFDM24, -+ Ndis802_11NetworkTypeMax /* not a real type, defined as an upper bound */ -+} NDIS_802_11_NETWORK_TYPE, *PNDIS_802_11_NETWORK_TYPE; -+ -+typedef struct _NDIS_802_11_CONFIGURATION_FH { -+ ULONG Length; /* Length of structure */ -+ ULONG HopPattern; /* As defined by 802.11, MSB set */ -+ ULONG HopSet; /* to one if non-802.11 */ -+ ULONG DwellTime; /* units are Kusec */ -+} NDIS_802_11_CONFIGURATION_FH, *PNDIS_802_11_CONFIGURATION_FH; -+ -+ -+/* -+ FW will only save the channel number in DSConfig. -+ ODI Handler will convert the channel number to freq. number. -+*/ -+typedef struct _NDIS_802_11_CONFIGURATION { -+ ULONG Length; /* Length of structure */ -+ ULONG BeaconPeriod; /* units are Kusec */ -+ ULONG ATIMWindow; /* units are Kusec */ -+ ULONG DSConfig; /* channel number */ -+ NDIS_802_11_CONFIGURATION_FH FHConfig; -+} NDIS_802_11_CONFIGURATION, *PNDIS_802_11_CONFIGURATION; -+ -+ -+ -+typedef enum _NDIS_802_11_NETWORK_INFRASTRUCTURE { -+ Ndis802_11IBSS, -+ Ndis802_11Infrastructure, -+ Ndis802_11AutoUnknown, -+ Ndis802_11InfrastructureMax, /* Not a real value, defined as upper bound */ -+ Ndis802_11APMode -+} NDIS_802_11_NETWORK_INFRASTRUCTURE, *PNDIS_802_11_NETWORK_INFRASTRUCTURE; -+ -+ -+ -+ -+ -+typedef struct _NDIS_802_11_FIXED_IEs { -+ UCHAR Timestamp[8]; -+ USHORT BeaconInterval; -+ USHORT Capabilities; -+} NDIS_802_11_FIXED_IEs, *PNDIS_802_11_FIXED_IEs; -+ -+ -+ -+typedef struct _NDIS_802_11_VARIABLE_IEs { -+ UCHAR ElementID; -+ UCHAR Length; -+ UCHAR data[1]; -+} NDIS_802_11_VARIABLE_IEs, *PNDIS_802_11_VARIABLE_IEs; -+ -+ -+ -+/* -+ -+ -+ -+Length is the 4 bytes multiples of the sume of -+ sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + sizeof (NDIS_802_11_SSID) + sizeof (ULONG) -++ sizeof (NDIS_802_11_RSSI) + sizeof (NDIS_802_11_NETWORK_TYPE) + sizeof (NDIS_802_11_CONFIGURATION) -++ sizeof (NDIS_802_11_RATES_EX) + IELength -+ -+Except the IELength, all other fields are fixed length. Therefore, we can define a marco to present the -+partial sum. -+ -+*/ -+#if 0 -+typedef struct _NDIS_WLAN_BSSID_EX { -+ ULONG Length; -+ NDIS_802_11_MAC_ADDRESS MacAddress; -+ UCHAR Reserved[2];/* [0]: IS beacon frame, [1]:optimum_antenna=>For antenna diversity; */ -+ NDIS_802_11_SSID Ssid; -+ ULONG Privacy; -+ NDIS_802_11_RSSI Rssi; -+ NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; -+ NDIS_802_11_CONFIGURATION Configuration; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; -+ NDIS_802_11_RATES_EX SupportedRates; -+ ULONG IELength; -+ UCHAR IEs[MAX_IE_SZ]; /* (timestamp, beacon interval, and capability information) */ -+} NDIS_WLAN_BSSID_EX, *PNDIS_WLAN_BSSID_EX; -+ -+ -+typedef struct _NDIS_802_11_BSSID_LIST_EX { -+ ULONG NumberOfItems; -+ NDIS_WLAN_BSSID_EX Bssid[1]; -+} NDIS_802_11_BSSID_LIST_EX, *PNDIS_802_11_BSSID_LIST_EX; -+#endif -+ -+typedef enum _NDIS_802_11_AUTHENTICATION_MODE { -+ Ndis802_11AuthModeOpen, -+ Ndis802_11AuthModeShared, -+ Ndis802_11AuthModeAutoSwitch, -+ Ndis802_11AuthModeWPA, -+ Ndis802_11AuthModeWPAPSK, -+ Ndis802_11AuthModeWPANone, -+ Ndis802_11AuthModeMax /* Not a real mode, defined as upper bound */ -+} NDIS_802_11_AUTHENTICATION_MODE, *PNDIS_802_11_AUTHENTICATION_MODE; -+ -+typedef enum _NDIS_802_11_WEP_STATUS { -+ Ndis802_11WEPEnabled, -+ Ndis802_11Encryption1Enabled = Ndis802_11WEPEnabled, -+ Ndis802_11WEPDisabled, -+ Ndis802_11EncryptionDisabled = Ndis802_11WEPDisabled, -+ Ndis802_11WEPKeyAbsent, -+ Ndis802_11Encryption1KeyAbsent = Ndis802_11WEPKeyAbsent, -+ Ndis802_11WEPNotSupported, -+ Ndis802_11EncryptionNotSupported = Ndis802_11WEPNotSupported, -+ Ndis802_11Encryption2Enabled, -+ Ndis802_11Encryption2KeyAbsent, -+ Ndis802_11Encryption3Enabled, -+ Ndis802_11Encryption3KeyAbsent -+} NDIS_802_11_WEP_STATUS, *PNDIS_802_11_WEP_STATUS, -+NDIS_802_11_ENCRYPTION_STATUS, *PNDIS_802_11_ENCRYPTION_STATUS; -+ -+ -+#define NDIS_802_11_AI_REQFI_CAPABILITIES 1 -+#define NDIS_802_11_AI_REQFI_LISTENINTERVAL 2 -+#define NDIS_802_11_AI_REQFI_CURRENTAPADDRESS 4 -+ -+#define NDIS_802_11_AI_RESFI_CAPABILITIES 1 -+#define NDIS_802_11_AI_RESFI_STATUSCODE 2 -+#define NDIS_802_11_AI_RESFI_ASSOCIATIONID 4 -+ -+typedef struct _NDIS_802_11_AI_REQFI { -+ USHORT Capabilities; -+ USHORT ListenInterval; -+ NDIS_802_11_MAC_ADDRESS CurrentAPAddress; -+} NDIS_802_11_AI_REQFI, *PNDIS_802_11_AI_REQFI; -+ -+typedef struct _NDIS_802_11_AI_RESFI { -+ USHORT Capabilities; -+ USHORT StatusCode; -+ USHORT AssociationId; -+} NDIS_802_11_AI_RESFI, *PNDIS_802_11_AI_RESFI; -+ -+typedef struct _NDIS_802_11_ASSOCIATION_INFORMATION { -+ ULONG Length; -+ USHORT AvailableRequestFixedIEs; -+ NDIS_802_11_AI_REQFI RequestFixedIEs; -+ ULONG RequestIELength; -+ ULONG OffsetRequestIEs; -+ USHORT AvailableResponseFixedIEs; -+ NDIS_802_11_AI_RESFI ResponseFixedIEs; -+ ULONG ResponseIELength; -+ ULONG OffsetResponseIEs; -+} NDIS_802_11_ASSOCIATION_INFORMATION, *PNDIS_802_11_ASSOCIATION_INFORMATION; -+ -+typedef enum _NDIS_802_11_RELOAD_DEFAULTS { -+ Ndis802_11ReloadWEPKeys -+} NDIS_802_11_RELOAD_DEFAULTS, *PNDIS_802_11_RELOAD_DEFAULTS; -+ -+ -+/* Key mapping keys require a BSSID */ -+typedef struct _NDIS_802_11_KEY { -+ ULONG Length; /* Length of this structure */ -+ ULONG KeyIndex; -+ ULONG KeyLength; /* length of key in bytes */ -+ NDIS_802_11_MAC_ADDRESS BSSID; -+ NDIS_802_11_KEY_RSC KeyRSC; -+ UCHAR KeyMaterial[32]; /* variable length depending on above field */ -+} NDIS_802_11_KEY, *PNDIS_802_11_KEY; -+ -+typedef struct _NDIS_802_11_REMOVE_KEY { -+ ULONG Length; /* Length of this structure */ -+ ULONG KeyIndex; -+ NDIS_802_11_MAC_ADDRESS BSSID; -+} NDIS_802_11_REMOVE_KEY, *PNDIS_802_11_REMOVE_KEY; -+ -+typedef struct _NDIS_802_11_WEP { -+ ULONG Length; /* Length of this structure */ -+ ULONG KeyIndex; /* 0 is the per-client key, 1-N are the global keys */ -+ ULONG KeyLength; /* length of key in bytes */ -+ UCHAR KeyMaterial[16];/* variable length depending on above field */ -+} NDIS_802_11_WEP, *PNDIS_802_11_WEP; -+ -+typedef struct _NDIS_802_11_AUTHENTICATION_REQUEST { -+ ULONG Length; /* Length of structure */ -+ NDIS_802_11_MAC_ADDRESS Bssid; -+ ULONG Flags; -+} NDIS_802_11_AUTHENTICATION_REQUEST, *PNDIS_802_11_AUTHENTICATION_REQUEST; -+ -+typedef enum _NDIS_802_11_STATUS_TYPE { -+ Ndis802_11StatusType_Authentication, -+ Ndis802_11StatusType_MediaStreamMode, -+ Ndis802_11StatusType_PMKID_CandidateList, -+ Ndis802_11StatusTypeMax /* not a real type, defined as an upper bound */ -+} NDIS_802_11_STATUS_TYPE, *PNDIS_802_11_STATUS_TYPE; -+ -+typedef struct _NDIS_802_11_STATUS_INDICATION { -+ NDIS_802_11_STATUS_TYPE StatusType; -+} NDIS_802_11_STATUS_INDICATION, *PNDIS_802_11_STATUS_INDICATION; -+ -+/* mask for authentication/integrity fields */ -+#define NDIS_802_11_AUTH_REQUEST_AUTH_FIELDS 0x0f -+#define NDIS_802_11_AUTH_REQUEST_REAUTH 0x01 -+#define NDIS_802_11_AUTH_REQUEST_KEYUPDATE 0x02 -+#define NDIS_802_11_AUTH_REQUEST_PAIRWISE_ERROR 0x06 -+#define NDIS_802_11_AUTH_REQUEST_GROUP_ERROR 0x0E -+ -+/* MIC check time, 60 seconds. */ -+#define MIC_CHECK_TIME 60000000 -+ -+typedef struct _NDIS_802_11_AUTHENTICATION_EVENT { -+ NDIS_802_11_STATUS_INDICATION Status; -+ NDIS_802_11_AUTHENTICATION_REQUEST Request[1]; -+} NDIS_802_11_AUTHENTICATION_EVENT, *PNDIS_802_11_AUTHENTICATION_EVENT; -+ -+typedef struct _NDIS_802_11_TEST { -+ ULONG Length; -+ ULONG Type; -+ union { -+ NDIS_802_11_AUTHENTICATION_EVENT AuthenticationEvent; -+ NDIS_802_11_RSSI RssiTrigger; -+ } tt; -+} NDIS_802_11_TEST, *PNDIS_802_11_TEST; -+ -+ -+#endif /* PLATFORM_FREEBSD */ -+#ifndef Ndis802_11APMode -+#define Ndis802_11APMode (Ndis802_11InfrastructureMax+1) -+#endif -+ -+typedef struct _WLAN_PHY_INFO { -+ u8 SignalStrength;/* (in percentage) */ -+ u8 SignalQuality;/* (in percentage) */ -+ u8 Optimum_antenna; /* for Antenna diversity */ -+ u8 Reserved_0; -+} WLAN_PHY_INFO, *PWLAN_PHY_INFO; -+ -+typedef struct _WLAN_BCN_INFO { -+ /* these infor get from rtw_get_encrypt_info when -+ * * translate scan to UI */ -+ u8 encryp_protocol;/* ENCRYP_PROTOCOL_E: OPEN/WEP/WPA/WPA2/WAPI */ -+ int group_cipher; /* WPA/WPA2 group cipher */ -+ int pairwise_cipher;/* //WPA/WPA2/WEP pairwise cipher */ -+ int is_8021x; -+ -+ /* bwmode 20/40 and ch_offset UP/LOW */ -+ unsigned short ht_cap_info; -+ unsigned char ht_info_infos_0; -+} WLAN_BCN_INFO, *PWLAN_BCN_INFO; -+ -+/* temporally add #pragma pack for structure alignment issue of -+* WLAN_BSSID_EX and get_WLAN_BSSID_EX_sz() -+*/ -+#ifdef PLATFORM_WINDOWS -+#pragma pack(push) -+#pragma pack(1) -+#endif -+typedef struct _WLAN_BSSID_EX { -+ ULONG Length; -+ NDIS_802_11_MAC_ADDRESS MacAddress; -+ UCHAR Reserved[2];/* [0]: IS beacon frame */ -+ NDIS_802_11_SSID Ssid; -+ ULONG Privacy; -+ NDIS_802_11_RSSI Rssi;/* (in dBM,raw data ,get from PHY) */ -+ NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; -+ NDIS_802_11_CONFIGURATION Configuration; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; -+ NDIS_802_11_RATES_EX SupportedRates; -+ WLAN_PHY_INFO PhyInfo; -+ ULONG IELength; -+ UCHAR IEs[MAX_IE_SZ]; /* (timestamp, beacon interval, and capability information) */ -+} -+#ifndef PLATFORM_WINDOWS -+__attribute__((packed)) -+#endif -+WLAN_BSSID_EX, *PWLAN_BSSID_EX; -+#ifdef PLATFORM_WINDOWS -+#pragma pack(pop) -+#endif -+ -+#define BSS_EX_IES(bss_ex) ((bss_ex)->IEs) -+#define BSS_EX_IES_LEN(bss_ex) ((bss_ex)->IELength) -+#define BSS_EX_FIXED_IE_OFFSET(bss_ex) ((bss_ex)->Reserved[0] == 2 ? 0 : 12) -+#define BSS_EX_TLV_IES(bss_ex) (BSS_EX_IES((bss_ex)) + BSS_EX_FIXED_IE_OFFSET((bss_ex))) -+#define BSS_EX_TLV_IES_LEN(bss_ex) (BSS_EX_IES_LEN((bss_ex)) - BSS_EX_FIXED_IE_OFFSET((bss_ex))) -+ -+__inline static uint get_WLAN_BSSID_EX_sz(WLAN_BSSID_EX *bss) -+{ -+#if 0 -+ uint t_len; -+ -+ t_len = sizeof(ULONG) -+ + sizeof(NDIS_802_11_MAC_ADDRESS) -+ + 2 -+ + sizeof(NDIS_802_11_SSID) -+ + sizeof(ULONG) -+ + sizeof(NDIS_802_11_RSSI) -+ + sizeof(NDIS_802_11_NETWORK_TYPE) -+ + sizeof(NDIS_802_11_CONFIGURATION) -+ + sizeof(NDIS_802_11_NETWORK_INFRASTRUCTURE) -+ + sizeof(NDIS_802_11_RATES_EX) -+ /* all new member add here */ -+ + sizeof(WLAN_PHY_INFO) -+ /* all new member add here */ -+ + sizeof(ULONG) -+ + bss->IELength; -+ return t_len; -+#else -+ return sizeof(WLAN_BSSID_EX) - MAX_IE_SZ + bss->IELength; -+#endif -+} -+ -+struct wlan_network { -+ _list list; -+ int network_type; /* refer to ieee80211.h for WIRELESS_11A/B/G */ -+ int fixed; /* set to fixed when not to be removed as site-surveying */ -+ unsigned long last_scanned; /* timestamp for the network */ -+ int aid; /* will only be valid when a BSS is joinned. */ -+ int join_res; -+ WLAN_BSSID_EX network; /* must be the last item */ -+ WLAN_BCN_INFO BcnInfo; -+#ifdef PLATFORM_WINDOWS -+ unsigned char iebuf[MAX_IE_SZ]; -+#endif -+ -+}; -+ -+enum VRTL_CARRIER_SENSE { -+ DISABLE_VCS, -+ ENABLE_VCS, -+ AUTO_VCS -+}; -+ -+enum VCS_TYPE { -+ NONE_VCS, -+ RTS_CTS, -+ CTS_TO_SELF -+}; -+ -+ -+ -+ -+#define PWR_CAM 0 -+#define PWR_MINPS 1 -+#define PWR_MAXPS 2 -+#define PWR_UAPSD 3 -+#define PWR_VOIP 4 -+ -+ -+enum UAPSD_MAX_SP { -+ NO_LIMIT, -+ TWO_MSDU, -+ FOUR_MSDU, -+ SIX_MSDU -+}; -+ -+ -+/* john */ -+#define NUM_PRE_AUTH_KEY 16 -+#define NUM_PMKID_CACHE NUM_PRE_AUTH_KEY -+ -+/* -+* WPA2 -+*/ -+ -+#ifndef PLATFORM_OS_CE -+typedef struct _PMKID_CANDIDATE { -+ NDIS_802_11_MAC_ADDRESS BSSID; -+ ULONG Flags; -+} PMKID_CANDIDATE, *PPMKID_CANDIDATE; -+ -+typedef struct _NDIS_802_11_PMKID_CANDIDATE_LIST { -+ ULONG Version; /* Version of the structure */ -+ ULONG NumCandidates; /* No. of pmkid candidates */ -+ PMKID_CANDIDATE CandidateList[1]; -+} NDIS_802_11_PMKID_CANDIDATE_LIST, *PNDIS_802_11_PMKID_CANDIDATE_LIST; -+ -+ -+typedef struct _NDIS_802_11_AUTHENTICATION_ENCRYPTION { -+ NDIS_802_11_AUTHENTICATION_MODE AuthModeSupported; -+ NDIS_802_11_ENCRYPTION_STATUS EncryptStatusSupported; -+ -+} NDIS_802_11_AUTHENTICATION_ENCRYPTION, *PNDIS_802_11_AUTHENTICATION_ENCRYPTION; -+ -+typedef struct _NDIS_802_11_CAPABILITY { -+ ULONG Length; -+ ULONG Version; -+ ULONG NoOfPMKIDs; -+ ULONG NoOfAuthEncryptPairsSupported; -+ NDIS_802_11_AUTHENTICATION_ENCRYPTION AuthenticationEncryptionSupported[1]; -+ -+} NDIS_802_11_CAPABILITY, *PNDIS_802_11_CAPABILITY; -+#endif -+ -+ -+#endif /* #ifndef WLAN_BSSDEF_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/include/xmit_osdep.h linux-4.14.18-rtl/3rdparty/rtl8723de/include/xmit_osdep.h ---- linux-4.14.18/3rdparty/rtl8723de/include/xmit_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/include/xmit_osdep.h 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,99 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __XMIT_OSDEP_H_ -+#define __XMIT_OSDEP_H_ -+ -+ -+struct pkt_file { -+ _pkt *pkt; -+ SIZE_T pkt_len; /* the remainder length of the open_file */ -+ _buffer *cur_buffer; -+ u8 *buf_start; -+ u8 *cur_addr; -+ SIZE_T buf_len; -+}; -+ -+#ifdef PLATFORM_WINDOWS -+ -+#ifdef PLATFORM_OS_XP -+#ifdef CONFIG_USB_HCI -+#include -+#include -+#include -+#endif -+#endif -+ -+#ifdef CONFIG_GSPI_HCI -+ #define NR_XMITFRAME 64 -+#else -+ #define NR_XMITFRAME 128 -+#endif -+ -+#define ETH_ALEN 6 -+ -+extern NDIS_STATUS rtw_xmit_entry( -+ IN _nic_hdl cnxt, -+ IN NDIS_PACKET *pkt, -+ IN UINT flags -+); -+ -+#endif /* PLATFORM_WINDOWS */ -+ -+#ifdef PLATFORM_FREEBSD -+#define NR_XMITFRAME 256 -+extern int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); -+extern void rtw_xmit_entry_wrap(struct ifnet *pifp); -+#endif /* PLATFORM_FREEBSD */ -+ -+#ifdef PLATFORM_LINUX -+ -+#define NR_XMITFRAME 256 -+ -+struct xmit_priv; -+struct pkt_attrib; -+struct sta_xmit_priv; -+struct xmit_frame; -+struct xmit_buf; -+ -+extern int _rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); -+extern int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); -+ -+#endif /* PLATFORM_LINUX */ -+ -+void rtw_os_xmit_schedule(_adapter *padapter); -+ -+int rtw_os_xmit_resource_alloc(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 alloc_sz, u8 flag); -+void rtw_os_xmit_resource_free(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 free_sz, u8 flag); -+ -+extern void rtw_set_tx_chksum_offload(_pkt *pkt, struct pkt_attrib *pattrib); -+ -+extern uint rtw_remainder_len(struct pkt_file *pfile); -+extern void _rtw_open_pktfile(_pkt *pkt, struct pkt_file *pfile); -+extern uint _rtw_pktfile_read(struct pkt_file *pfile, u8 *rmem, uint rlen); -+extern sint rtw_endofpktfile(struct pkt_file *pfile); -+ -+extern void rtw_os_pkt_complete(_adapter *padapter, _pkt *pkt); -+extern void rtw_os_xmit_complete(_adapter *padapter, struct xmit_frame *pxframe); -+ -+void rtw_os_wake_queue_at_free_stainfo(_adapter *padapter, int *qcnt_freed); -+ -+void dump_os_queue(void *sel, _adapter *padapter); -+ -+#endif /* __XMIT_OSDEP_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/Kconfig linux-4.14.18-rtl/3rdparty/rtl8723de/Kconfig ---- linux-4.14.18/3rdparty/rtl8723de/Kconfig 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/Kconfig 2018-02-11 21:44:27.134145888 +0200 -@@ -0,0 +1,6 @@ -+config RTL8723DE -+ tristate "Realtek 8723DE PCI WiFi" -+ depends on PCI -+ ---help--- -+ Help message of RTL8723DE -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/Makefile linux-4.14.18-rtl/3rdparty/rtl8723de/Makefile ---- linux-4.14.18/3rdparty/rtl8723de/Makefile 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/Makefile 2018-02-11 21:44:27.134145888 +0200 -@@ -0,0 +1,1919 @@ -+EXTRA_CFLAGS += $(USER_EXTRA_CFLAGS) -+EXTRA_CFLAGS += -O1 -+#EXTRA_CFLAGS += -O3 -+#EXTRA_CFLAGS += -Wall -+#EXTRA_CFLAGS += -Wextra -+#EXTRA_CFLAGS += -Werror -+#EXTRA_CFLAGS += -pedantic -+#EXTRA_CFLAGS += -Wshadow -Wpointer-arith -Wcast-qual -Wstrict-prototypes -Wmissing-prototypes -+ -+EXTRA_CFLAGS += -Wno-unused-variable -+EXTRA_CFLAGS += -Wno-unused-value -+EXTRA_CFLAGS += -Wno-unused-label -+EXTRA_CFLAGS += -Wno-unused-parameter -+EXTRA_CFLAGS += -Wno-unused-function -+EXTRA_CFLAGS += -Wno-unused -+#EXTRA_CFLAGS += -Wno-uninitialized -+ -+GCC_VER_49 := $(shell echo `$(CC) -dumpversion | cut -f1-2 -d.` \>= 4.9 | bc ) -+ifeq ($(GCC_VER_49),1) -+EXTRA_CFLAGS += -Wno-date-time # Fix compile error && warning on gcc 4.9 and later -+endif -+ -+EXTRA_CFLAGS += -I$(src)/include -+EXTRA_CFLAGS += -I$(src)/hal/phydm -+ -+EXTRA_LDFLAGS += --strip-debug -+ -+CONFIG_AUTOCFG_CP = n -+ -+########################## WIFI IC ############################ -+CONFIG_MULTIDRV = n -+CONFIG_RTL8188E = n -+CONFIG_RTL8812A = n -+CONFIG_RTL8821A = n -+CONFIG_RTL8192E = n -+CONFIG_RTL8723B = n -+CONFIG_RTL8814A = n -+CONFIG_RTL8723C = n -+CONFIG_RTL8188F = n -+CONFIG_RTL8822B = n -+CONFIG_RTL8723D = y -+CONFIG_RTL8821C = n -+######################### Interface ########################### -+CONFIG_USB_HCI = n -+CONFIG_PCI_HCI = y -+CONFIG_SDIO_HCI = n -+CONFIG_GSPI_HCI = n -+########################## Features ########################### -+CONFIG_MP_INCLUDED = y -+CONFIG_POWER_SAVING = y -+CONFIG_USB_AUTOSUSPEND = n -+CONFIG_HW_PWRP_DETECTION = n -+CONFIG_WIFI_TEST = n -+CONFIG_BT_COEXIST = y -+CONFIG_INTEL_WIDI = n -+CONFIG_WAPI_SUPPORT = n -+CONFIG_EFUSE_CONFIG_FILE = y -+CONFIG_EXT_CLK = n -+CONFIG_TRAFFIC_PROTECT = y -+CONFIG_LOAD_PHY_PARA_FROM_FILE = y -+CONFIG_TXPWR_BY_RATE_EN = auto -+CONFIG_TXPWR_LIMIT_EN = auto -+CONFIG_RTW_ADAPTIVITY_EN = disable -+CONFIG_RTW_ADAPTIVITY_MODE = normal -+CONFIG_SIGNAL_SCALE_MAPPING = n -+CONFIG_80211W = n -+CONFIG_REDUCE_TX_CPU_LOADING = n -+CONFIG_BR_EXT = y -+CONFIG_TDLS = n -+CONFIG_WIFI_MONITOR = n -+CONFIG_MCC_MODE = n -+CONFIG_APPEND_VENDOR_IE_ENABLE = n -+CONFIG_RTW_NAPI = y -+CONFIG_RTW_GRO = y -+########################## Debug ########################### -+CONFIG_RTW_DEBUG = y -+# default log level is _DRV_INFO_ = 4, -+# please refer to "How_to_set_driver_debug_log_level.doc" to set the available level. -+CONFIG_RTW_LOG_LEVEL = 4 -+######################## Wake On Lan ########################## -+CONFIG_WOWLAN = n -+CONFIG_GPIO_WAKEUP = n -+CONFIG_DEFAULT_PATTERNS_EN = n -+CONFIG_WAKEUP_GPIO_IDX = default -+CONFIG_HIGH_ACTIVE = n -+CONFIG_PNO_SUPPORT = n -+CONFIG_PNO_SET_DEBUG = n -+CONFIG_AP_WOWLAN = n -+######### Notify SDIO Host Keep Power During Syspend ########## -+CONFIG_RTW_SDIO_PM_KEEP_POWER = y -+###################### MP HW TX MODE FOR VHT ####################### -+CONFIG_MP_VHT_HW_TX_MODE = n -+###################### Platform Related ####################### -+CONFIG_PLATFORM_I386_PC = y -+CONFIG_PLATFORM_ARM_NV_TK1 = n -+CONFIG_PLATFORM_ANDROID_X86 = n -+CONFIG_PLATFORM_ANDROID_INTEL_X86 = n -+CONFIG_PLATFORM_JB_X86 = n -+CONFIG_PLATFORM_ARM_S3C2K4 = n -+CONFIG_PLATFORM_ARM_PXA2XX = n -+CONFIG_PLATFORM_ARM_S3C6K4 = n -+CONFIG_PLATFORM_MIPS_RMI = n -+CONFIG_PLATFORM_RTD2880B = n -+CONFIG_PLATFORM_MIPS_AR9132 = n -+CONFIG_PLATFORM_RTK_DMP = n -+CONFIG_PLATFORM_MIPS_PLM = n -+CONFIG_PLATFORM_MSTAR389 = n -+CONFIG_PLATFORM_MT53XX = n -+CONFIG_PLATFORM_ARM_MX51_241H = n -+CONFIG_PLATFORM_FS_MX61 = n -+CONFIG_PLATFORM_ACTIONS_ATJ227X = n -+CONFIG_PLATFORM_TEGRA3_CARDHU = n -+CONFIG_PLATFORM_TEGRA4_DALMORE = n -+CONFIG_PLATFORM_ARM_TCC8900 = n -+CONFIG_PLATFORM_ARM_TCC8920 = n -+CONFIG_PLATFORM_ARM_TCC8920_JB42 = n -+CONFIG_PLATFORM_ARM_TCC8930_JB42 = n -+CONFIG_PLATFORM_ARM_RK2818 = n -+CONFIG_PLATFORM_ARM_RK3066 = n -+CONFIG_PLATFORM_ARM_RK3188 = n -+CONFIG_PLATFORM_ARM_URBETTER = n -+CONFIG_PLATFORM_ARM_TI_PANDA = n -+CONFIG_PLATFORM_MIPS_JZ4760 = n -+CONFIG_PLATFORM_DMP_PHILIPS = n -+CONFIG_PLATFORM_MSTAR_TITANIA12 = n -+CONFIG_PLATFORM_MSTAR = n -+CONFIG_PLATFORM_SZEBOOK = n -+CONFIG_PLATFORM_ARM_SUNxI = n -+CONFIG_PLATFORM_ARM_SUN6I = n -+CONFIG_PLATFORM_ARM_SUN7I = n -+CONFIG_PLATFORM_ARM_SUN8I_W3P1 = n -+CONFIG_PLATFORM_ARM_SUN8I_W5P1 = n -+CONFIG_PLATFORM_ACTIONS_ATM702X = n -+CONFIG_PLATFORM_ACTIONS_ATV5201 = n -+CONFIG_PLATFORM_ACTIONS_ATM705X = n -+CONFIG_PLATFORM_ARM_SUN50IW1P1 = n -+CONFIG_PLATFORM_ARM_RTD299X = n -+CONFIG_PLATFORM_ARM_SPREADTRUM_6820 = n -+CONFIG_PLATFORM_ARM_SPREADTRUM_8810 = n -+CONFIG_PLATFORM_ARM_WMT = n -+CONFIG_PLATFORM_TI_DM365 = n -+CONFIG_PLATFORM_MOZART = n -+CONFIG_PLATFORM_RTK119X = n -+CONFIG_PLATFORM_RTK129X = n -+CONFIG_PLATFORM_NOVATEK_NT72668 = n -+CONFIG_PLATFORM_HISILICON = n -+############################################################### -+ -+CONFIG_DRVEXT_MODULE = n -+ -+export TopDIR ?= $(shell pwd) -+ -+########### COMMON ################################# -+ifeq ($(CONFIG_GSPI_HCI), y) -+HCI_NAME = gspi -+endif -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+HCI_NAME = sdio -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+HCI_NAME = usb -+endif -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+HCI_NAME = pci -+endif -+ -+ -+_OS_INTFS_FILES := os_dep/osdep_service.o \ -+ os_dep/linux/os_intfs.o \ -+ os_dep/linux/$(HCI_NAME)_intf.o \ -+ os_dep/linux/$(HCI_NAME)_ops_linux.o \ -+ os_dep/linux/ioctl_linux.o \ -+ os_dep/linux/xmit_linux.o \ -+ os_dep/linux/mlme_linux.o \ -+ os_dep/linux/recv_linux.o \ -+ os_dep/linux/ioctl_cfg80211.o \ -+ os_dep/linux/rtw_cfgvendor.o \ -+ os_dep/linux/wifi_regd.o \ -+ os_dep/linux/rtw_android.o \ -+ os_dep/linux/rtw_proc.o -+ -+ifeq ($(CONFIG_MP_INCLUDED), y) -+_OS_INTFS_FILES += os_dep/linux/ioctl_mp.o -+endif -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_OS_INTFS_FILES += os_dep/linux/custom_gpio_linux.o -+_OS_INTFS_FILES += os_dep/linux/$(HCI_NAME)_ops_linux.o -+endif -+ -+ifeq ($(CONFIG_GSPI_HCI), y) -+_OS_INTFS_FILES += os_dep/linux/custom_gpio_linux.o -+_OS_INTFS_FILES += os_dep/linux/$(HCI_NAME)_ops_linux.o -+endif -+ -+ -+_HAL_INTFS_FILES := hal/hal_intf.o \ -+ hal/hal_com.o \ -+ hal/hal_com_phycfg.o \ -+ hal/hal_phy.o \ -+ hal/hal_dm.o \ -+ hal/hal_btcoex.o \ -+ hal/hal_mp.o \ -+ hal/hal_mcc.o \ -+ hal/hal_hci/hal_$(HCI_NAME).o \ -+ hal/led/hal_$(HCI_NAME)_led.o -+ -+ -+_OUTSRC_FILES := hal/phydm/phydm_debug.o \ -+ hal/phydm/phydm_antdiv.o\ -+ hal/phydm/phydm_antdect.o\ -+ hal/phydm/phydm_interface.o\ -+ hal/phydm/phydm_hwconfig.o\ -+ hal/phydm/phydm.o\ -+ hal/phydm/halphyrf_ce.o\ -+ hal/phydm/phydm_edcaturbocheck.o\ -+ hal/phydm/phydm_dig.o\ -+ hal/phydm/phydm_pathdiv.o\ -+ hal/phydm/phydm_rainfo.o\ -+ hal/phydm/phydm_dynamicbbpowersaving.o\ -+ hal/phydm/phydm_powertracking_ce.o\ -+ hal/phydm/phydm_dynamictxpower.o\ -+ hal/phydm/phydm_adaptivity.o\ -+ hal/phydm/phydm_cfotracking.o\ -+ hal/phydm/phydm_noisemonitor.o\ -+ hal/phydm/phydm_acs.o\ -+ hal/phydm/phydm_beamforming.o\ -+ hal/phydm/phydm_dfs.o\ -+ hal/phydm/txbf/halcomtxbf.o\ -+ hal/phydm/txbf/haltxbfinterface.o\ -+ hal/phydm/txbf/phydm_hal_txbf_api.o\ -+ hal/phydm/phydm_kfree.o\ -+ hal/phydm/phydm_ccx.o -+ -+ -+EXTRA_CFLAGS += -I$(src)/platform -+_PLATFORM_FILES := platform/platform_ops.o -+ -+ifeq ($(CONFIG_BT_COEXIST), y) -+EXTRA_CFLAGS += -I$(src)/hal/btc -+_OUTSRC_FILES += hal/btc/HalBtc8192e1Ant.o \ -+ hal/btc/HalBtc8192e2Ant.o \ -+ hal/btc/HalBtc8723b1Ant.o \ -+ hal/btc/HalBtc8723b2Ant.o \ -+ hal/btc/HalBtc8812a1Ant.o \ -+ hal/btc/HalBtc8812a2Ant.o \ -+ hal/btc/HalBtc8821a1Ant.o \ -+ hal/btc/HalBtc8821a2Ant.o \ -+ hal/btc/HalBtc8821aCsr2Ant.o \ -+ hal/btc/HalBtc8703b1Ant.o \ -+ hal/btc/halbtc8723d1ant.o \ -+ hal/btc/halbtc8723d2ant.o \ -+ hal/btc/HalBtc8822b1Ant.o \ -+ hal/btc/halbtc8821c1ant.o \ -+ hal/btc/halbtc8821c2ant.o -+endif -+ -+ -+########### HAL_RTL8188E ################################# -+ifeq ($(CONFIG_RTL8188E), y) -+ -+RTL871X = rtl8188e -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8189es -+endif -+ -+ifeq ($(CONFIG_GSPI_HCI), y) -+MODULE_NAME = 8189es -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8188eu -+endif -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8188ee -+endif -+EXTRA_CFLAGS += -DCONFIG_RTL8188E -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8188EPwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_xmit.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ hal/$(RTL871X)/hal8188e_s_fw.o \ -+ hal/$(RTL871X)/hal8188e_t_fw.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+ifeq ($(CONFIG_GSPI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+endif -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188E_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188E_PCIE.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188E_SDIO.o -+endif -+ -+#hal/OUTSRC/$(RTL871X)/Hal8188EFWImg_CE.o -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8188e_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188e_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188e_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188e_t_fw.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188e_s_fw.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8188e_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8188e.o\ -+ hal/phydm/$(RTL871X)/hal8188erateadaptive.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8188e.o -+ -+endif -+ -+########### HAL_RTL8192E ################################# -+ifeq ($(CONFIG_RTL8192E), y) -+ -+RTL871X = rtl8192e -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8192es -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8192eu -+endif -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8192ee -+endif -+EXTRA_CFLAGS += -DCONFIG_RTL8192E -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8192EPwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_xmit.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ hal/$(RTL871X)/hal8192e_fw.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+ifeq ($(CONFIG_GSPI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+endif -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8192E_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8192E_PCIE.o -+endif -+ -+#hal/OUTSRC/$(RTL871X)/HalHWImg8188E_FW.o -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8192e_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192e_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192e_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8192e_fw.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8192e_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8192e.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8192e.o -+ -+endif -+ -+########### HAL_RTL8812A_RTL8821A ################################# -+ -+ifneq ($(CONFIG_RTL8812A)_$(CONFIG_RTL8821A), n_n) -+ -+RTL871X = rtl8812a -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8812au -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8812ae -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8812as -+endif -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8812PwrSeq.o \ -+ hal/$(RTL871X)/Hal8821APwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_xmit.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+ifeq ($(CONFIG_GSPI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+endif -+endif -+ -+ifeq ($(CONFIG_RTL8812A), y) -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8812A_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8812A_PCIE.o -+endif -+endif -+ifeq ($(CONFIG_RTL8821A), y) -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8821A_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8821A_PCIE.o -+endif -+endif -+ -+ifeq ($(CONFIG_RTL8812A), y) -+EXTRA_CFLAGS += -DCONFIG_RTL8812A -+_HAL_INTFS_FILES += hal/rtl8812a/hal8812a_fw.o -+ -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8812a_fw.o\ -+ hal/phydm/$(RTL871X)/halhwimg8812a_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8812a_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8812a_rf.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8812a_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8812a.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8812a.o\ -+ hal/phydm/txbf/haltxbfjaguar.o -+endif -+ -+ifeq ($(CONFIG_RTL8821A), y) -+ -+ifeq ($(CONFIG_RTL8812A), n) -+ -+RTL871X = rtl8821a -+ifeq ($(CONFIG_USB_HCI), y) -+ifeq ($(CONFIG_BT_COEXIST), y) -+MODULE_NAME := 8821au -+else -+MODULE_NAME := 8811au -+endif -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME := 8821ae -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME := 8821as -+endif -+ -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8821A -+ -+_HAL_INTFS_FILES += hal/rtl8812a/hal8821a_fw.o -+_OUTSRC_FILES += hal/phydm/rtl8821a/halhwimg8821a_fw.o\ -+ hal/phydm/rtl8821a/halhwimg8821a_mac.o\ -+ hal/phydm/rtl8821a/halhwimg8821a_bb.o\ -+ hal/phydm/rtl8821a/halhwimg8821a_rf.o\ -+ hal/phydm/rtl8812a/halphyrf_8812a_ce.o\ -+ hal/phydm/rtl8821a/halphyrf_8821a_ce.o\ -+ hal/phydm/rtl8821a/phydm_regconfig8821a.o\ -+ hal/phydm/rtl8821a/phydm_rtl8821a.o\ -+ hal/phydm/rtl8821a/phydm_iqk_8821a_ce.o\ -+ hal/phydm/txbf/haltxbfjaguar.o -+ -+endif -+ -+endif -+ -+########### HAL_RTL8723B ################################# -+ifeq ($(CONFIG_RTL8723B), y) -+ -+RTL871X = rtl8723b -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8723bu -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8723be -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8723bs -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8723B -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8723BPwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ hal/$(RTL871X)/hal8723b_fw.o \ -+ -+_HAL_INTFS_FILES += \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723B_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723B_PCIE.o -+endif -+ -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8723b_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_fw.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723b_mp.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8723b.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8723b_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8723b.o -+ -+endif -+ -+########### HAL_RTL8814A ################################# -+ifeq ($(CONFIG_RTL8814A), y) -+## ADD NEW VHT MP HW TX MODE ## -+EXTRA_CFLAGS += -DCONFIG_MP_VHT_HW_TX_MODE -+CONFIG_MP_VHT_HW_TX_MODE = y -+########################################## -+RTL871X = rtl8814a -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8814au -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8814ae -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8814as -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8814A -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8814PwrSeq.o \ -+ hal/$(RTL871X)/$(RTL871X)_xmit.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ hal/$(RTL871X)/hal8814a_fw.o \ -+ -+ -+_HAL_INTFS_FILES += \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+ifeq ($(CONFIG_GSPI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+endif -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8814A_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8814A_PCIE.o -+endif -+ -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8814a_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8814a_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8814a_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8814a_fw.o\ -+ hal/phydm/$(RTL871X)/phydm_iqk_8814a.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8814a.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8814a_ce.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8814a.o\ -+ hal/phydm/txbf/haltxbf8814a.o -+ -+endif -+ -+########### HAL_RTL8723C ################################# -+ifeq ($(CONFIG_RTL8723C), y) -+ -+RTL871X = rtl8703b -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8723cu -+MODULE_SUB_NAME = 8703bu -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8723ce -+MODULE_SUB_NAME = 8703be -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8723cs -+MODULE_SUB_NAME = 8703bs -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8703B -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8703BPwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ hal/$(RTL871X)/hal8703b_fw.o \ -+ -+_HAL_INTFS_FILES += \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_recv.o -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8703B_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8703B_PCIE.o -+endif -+ -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8703b_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8703b_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8703b_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8703b_fw.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8703b.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8703b.o -+endif -+ -+########### HAL_RTL8723D ################################# -+ifeq ($(CONFIG_RTL8723D), y) -+ -+RTL871X = rtl8723d -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8723du -+MODULE_SUB_NAME = 8723du -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8723de -+MODULE_SUB_NAME = 8723de -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8723ds -+MODULE_SUB_NAME = 8723ds -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8723D -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8723DPwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ hal/$(RTL871X)/hal8723d_fw.o \ -+ hal/$(RTL871X)/$(RTL871X)_lps_poff.o -+ -+ -+_HAL_INTFS_FILES += \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_recv.o -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723D_USB.o -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723D_PCIE.o -+endif -+ -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8723d_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723d_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723d_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8723d_fw.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8723d.o\ -+ hal/phydm/$(RTL871X)/phydm_rtl8723d.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8723d.o -+endif -+ -+########### HAL_RTL8188F ################################# -+ifeq ($(CONFIG_RTL8188F), y) -+ -+RTL871X = rtl8188f -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME = 8188fu -+endif -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME = 8188fe -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME = 8189fs -+endif -+ -+EXTRA_CFLAGS += -DCONFIG_RTL8188F -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/$(RTL871X)/Hal8188FPwrSeq.o\ -+ hal/$(RTL871X)/$(RTL871X)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ -+ hal/$(RTL871X)/$(RTL871X)_phycfg.o \ -+ hal/$(RTL871X)/$(RTL871X)_rf6052.o \ -+ hal/$(RTL871X)/$(RTL871X)_dm.o \ -+ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ -+ hal/$(RTL871X)/$(RTL871X)_cmd.o \ -+ hal/$(RTL871X)/hal8188f_fw.o \ -+ -+_HAL_INTFS_FILES += \ -+ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ -+ hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o -+else -+_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188F_USB.o -+endif -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188F_SDIO.o -+endif -+ -+_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8188f_bb.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188f_mac.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188f_rf.o\ -+ hal/phydm/$(RTL871X)/halhwimg8188f_fw.o\ -+ hal/phydm/$(RTL871X)/phydm_regconfig8188f.o\ -+ hal/phydm/$(RTL871X)/halphyrf_8188f.o \ -+ hal/phydm/$(RTL871X)/phydm_rtl8188f.o -+ -+endif -+ -+########### HAL_RTL8822B ################################# -+ifeq ($(CONFIG_RTL8822B), y) -+include $(TopDIR)/rtl8822b.mk -+endif -+ -+########### HAL_RTL8821C ################################# -+ifeq ($(CONFIG_RTL8821C), y) -+include $(TopDIR)/rtl8821c.mk -+ -+_OUTSRC_FILES += hal/phydm/rtl8821c/halhwimg8821c_testchip_bb.o \ -+ hal/phydm/rtl8821c/halhwimg8821c_testchip_mac.o \ -+ hal/phydm/rtl8821c/halhwimg8821c_testchip_rf.o \ -+ hal/phydm/rtl8821c/phydm_hal_api8821c.o \ -+ hal/phydm/rtl8821c/phydm_regconfig8821c.o -+endif -+ -+########### AUTO_CFG ################################# -+ -+ifeq ($(CONFIG_AUTOCFG_CP), y) -+ -+ifeq ($(CONFIG_MULTIDRV), y) -+$(shell cp $(TopDIR)/autoconf_multidrv_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) -+else -+ifeq ($(CONFIG_RTL8188E)$(CONFIG_SDIO_HCI),yy) -+$(shell cp $(TopDIR)/autoconf_rtl8189e_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) -+else ifeq ($(CONFIG_RTL8188F)$(CONFIG_SDIO_HCI),yy) -+$(shell cp $(TopDIR)/autoconf_rtl8189f_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) -+else ifeq ($(CONFIG_RTL8723C),y) -+$(shell cp $(TopDIR)/autoconf_rtl8723c_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) -+else -+$(shell cp $(TopDIR)/autoconf_$(RTL871X)_$(HCI_NAME)_linux.h $(TopDIR)/include/autoconf.h) -+endif -+endif -+ -+endif -+ -+########### END OF PATH ################################# -+ -+ifeq ($(CONFIG_USB_HCI), y) -+ifeq ($(CONFIG_USB_AUTOSUSPEND), y) -+EXTRA_CFLAGS += -DCONFIG_USB_AUTOSUSPEND -+endif -+endif -+ -+ifeq ($(CONFIG_MP_INCLUDED), y) -+#MODULE_NAME := $(MODULE_NAME)_mp -+EXTRA_CFLAGS += -DCONFIG_MP_INCLUDED -+endif -+ -+ifeq ($(CONFIG_POWER_SAVING), y) -+EXTRA_CFLAGS += -DCONFIG_POWER_SAVING -+endif -+ -+ifeq ($(CONFIG_HW_PWRP_DETECTION), y) -+EXTRA_CFLAGS += -DCONFIG_HW_PWRP_DETECTION -+endif -+ -+ifeq ($(CONFIG_WIFI_TEST), y) -+EXTRA_CFLAGS += -DCONFIG_WIFI_TEST -+endif -+ -+ifeq ($(CONFIG_BT_COEXIST), y) -+EXTRA_CFLAGS += -DCONFIG_BT_COEXIST -+endif -+ -+ifeq ($(CONFIG_INTEL_WIDI), y) -+EXTRA_CFLAGS += -DCONFIG_INTEL_WIDI -+endif -+ -+ifeq ($(CONFIG_WAPI_SUPPORT), y) -+EXTRA_CFLAGS += -DCONFIG_WAPI_SUPPORT -+endif -+ -+ -+ifeq ($(CONFIG_EFUSE_CONFIG_FILE), y) -+EXTRA_CFLAGS += -DCONFIG_EFUSE_CONFIG_FILE -+ -+#EFUSE_MAP_PATH -+USER_EFUSE_MAP_PATH ?= -+ifneq ($(USER_EFUSE_MAP_PATH),) -+EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"$(USER_EFUSE_MAP_PATH)\" -+else ifeq ($(MODULE_NAME), 8189es) -+EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/system/etc/wifi/wifi_efuse_8189e.map\" -+else ifeq ($(MODULE_NAME), 8723bs) -+EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/system/etc/wifi/wifi_efuse_8723bs.map\" -+else -+EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/system/etc/wifi/wifi_efuse_$(MODULE_NAME).map\" -+endif -+ -+#WIFIMAC_PATH -+USER_WIFIMAC_PATH ?= -+ifneq ($(USER_WIFIMAC_PATH),) -+EXTRA_CFLAGS += -DWIFIMAC_PATH=\"$(USER_WIFIMAC_PATH)\" -+else -+EXTRA_CFLAGS += -DWIFIMAC_PATH=\"/data/wifimac.txt\" -+endif -+ -+endif -+ -+ifeq ($(CONFIG_EXT_CLK), y) -+EXTRA_CFLAGS += -DCONFIG_EXT_CLK -+endif -+ -+ifeq ($(CONFIG_TRAFFIC_PROTECT), y) -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+endif -+ -+ifeq ($(CONFIG_LOAD_PHY_PARA_FROM_FILE), y) -+EXTRA_CFLAGS += -DCONFIG_LOAD_PHY_PARA_FROM_FILE -+#EXTRA_CFLAGS += -DREALTEK_CONFIG_PATH_WITH_IC_NAME_FOLDER -+#EXTRA_CFLAGS += -DREALTEK_CONFIG_PATH=\"/lib/firmware/\" -+EXTRA_CFLAGS += -DREALTEK_CONFIG_PATH=\"\" -+endif -+ -+ifeq ($(CONFIG_TXPWR_BY_RATE_EN), n) -+EXTRA_CFLAGS += -DCONFIG_TXPWR_BY_RATE_EN=0 -+else ifeq ($(CONFIG_TXPWR_BY_RATE_EN), y) -+EXTRA_CFLAGS += -DCONFIG_TXPWR_BY_RATE_EN=1 -+else ifeq ($(CONFIG_TXPWR_BY_RATE_EN), auto) -+EXTRA_CFLAGS += -DCONFIG_TXPWR_BY_RATE_EN=2 -+endif -+ -+ifeq ($(CONFIG_TXPWR_LIMIT_EN), n) -+EXTRA_CFLAGS += -DCONFIG_TXPWR_LIMIT_EN=0 -+else ifeq ($(CONFIG_TXPWR_LIMIT_EN), y) -+EXTRA_CFLAGS += -DCONFIG_TXPWR_LIMIT_EN=1 -+else ifeq ($(CONFIG_TXPWR_LIMIT_EN), auto) -+EXTRA_CFLAGS += -DCONFIG_TXPWR_LIMIT_EN=2 -+endif -+ -+ifeq ($(CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY), y) -+EXTRA_CFLAGS += -DCONFIG_CALIBRATE_TX_POWER_BY_REGULATORY -+endif -+ -+ifeq ($(CONFIG_CALIBRATE_TX_POWER_TO_MAX), y) -+EXTRA_CFLAGS += -DCONFIG_CALIBRATE_TX_POWER_TO_MAX -+endif -+ -+ifeq ($(CONFIG_RTW_ADAPTIVITY_EN), disable) -+EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_EN=0 -+else ifeq ($(CONFIG_RTW_ADAPTIVITY_EN), enable) -+EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_EN=1 -+endif -+ -+ifeq ($(CONFIG_RTW_ADAPTIVITY_MODE), normal) -+EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_MODE=0 -+else ifeq ($(CONFIG_RTW_ADAPTIVITY_MODE), carrier_sense) -+EXTRA_CFLAGS += -DCONFIG_RTW_ADAPTIVITY_MODE=1 -+endif -+ -+ifeq ($(CONFIG_SIGNAL_SCALE_MAPPING), y) -+EXTRA_CFLAGS += -DCONFIG_SIGNAL_SCALE_MAPPING -+endif -+ -+ifeq ($(CONFIG_80211W), y) -+EXTRA_CFLAGS += -DCONFIG_IEEE80211W -+endif -+ -+ifeq ($(CONFIG_WOWLAN), y) -+EXTRA_CFLAGS += -DCONFIG_WOWLAN -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER -+endif -+ifeq ($(CONFIG_DEFAULT_PATTERNS_EN), y) -+EXTRA_CFLAGS += -DCONFIG_DEFAULT_PATTERNS_EN -+endif -+endif -+ -+ifeq ($(CONFIG_AP_WOWLAN), y) -+EXTRA_CFLAGS += -DCONFIG_AP_WOWLAN -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER -+endif -+endif -+ -+ifeq ($(CONFIG_PNO_SUPPORT), y) -+EXTRA_CFLAGS += -DCONFIG_PNO_SUPPORT -+ifeq ($(CONFIG_PNO_SET_DEBUG), y) -+EXTRA_CFLAGS += -DCONFIG_PNO_SET_DEBUG -+endif -+endif -+ -+ifeq ($(CONFIG_GPIO_WAKEUP), y) -+EXTRA_CFLAGS += -DCONFIG_GPIO_WAKEUP -+ifeq ($(CONFIG_HIGH_ACTIVE), y) -+EXTRA_CFLAGS += -DHIGH_ACTIVE=1 -+else -+EXTRA_CFLAGS += -DHIGH_ACTIVE=0 -+endif -+endif -+ -+ifneq ($(CONFIG_WAKEUP_GPIO_IDX), default) -+EXTRA_CFLAGS += -DWAKEUP_GPIO_IDX=$(CONFIG_WAKEUP_GPIO_IDX) -+endif -+ -+ifeq ($(CONFIG_RTW_SDIO_PM_KEEP_POWER), y) -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER -+endif -+endif -+ -+ifeq ($(CONFIG_REDUCE_TX_CPU_LOADING), y) -+EXTRA_CFLAGS += -DCONFIG_REDUCE_TX_CPU_LOADING -+endif -+ -+ifeq ($(CONFIG_BR_EXT), y) -+BR_NAME = br0 -+EXTRA_CFLAGS += -DCONFIG_BR_EXT -+EXTRA_CFLAGS += '-DCONFIG_BR_EXT_BRNAME="'$(BR_NAME)'"' -+endif -+ -+ifeq ($(CONFIG_ANTENNA_DIVERSITY), y) -+EXTRA_CFLAGS += -DCONFIG_ANTENNA_DIVERSITY -+endif -+ -+ifeq ($(CONFIG_TDLS), y) -+EXTRA_CFLAGS += -DCONFIG_TDLS -+endif -+ -+ifeq ($(CONFIG_WIFI_MONITOR), y) -+EXTRA_CFLAGS += -DCONFIG_WIFI_MONITOR -+endif -+ -+ifeq ($(CONFIG_MCC_MODE), y) -+EXTRA_CFLAGS += -DCONFIG_MCC_MODE -+endif -+ -+ifeq ($(CONFIG_RTW_NAPI), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_NAPI -+endif -+ -+ifeq ($(CONFIG_RTW_GRO), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_GRO -+endif -+ -+ifeq ($(CONFIG_MP_VHT_HW_TX_MODE), y) -+EXTRA_CFLAGS += -DCONFIG_MP_VHT_HW_TX_MODE -+ifeq ($(CONFIG_PLATFORM_I386_PC), y) -+## For I386 X86 ToolChain use Hardware FLOATING -+EXTRA_CFLAGS += -mhard-float -+else -+## For ARM ToolChain use Hardware FLOATING -+EXTRA_CFLAGS += -mfloat-abi=hard -+endif -+endif -+ -+ifeq ($(CONFIG_APPEND_VENDOR_IE_ENABLE), y) -+EXTRA_CFLAGS += -DCONFIG_APPEND_VENDOR_IE_ENABLE -+endif -+ -+ifeq ($(CONFIG_RTW_DEBUG), y) -+EXTRA_CFLAGS += -DCONFIG_RTW_DEBUG -+EXTRA_CFLAGS += -DRTW_LOG_LEVEL=$(CONFIG_RTW_LOG_LEVEL) -+endif -+ -+EXTRA_CFLAGS += -DDM_ODM_SUPPORT_TYPE=0x04 -+ -+ifeq ($(CONFIG_PLATFORM_I386_PC), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+SUBARCH := $(shell uname -m | sed -e s/i.86/i386/) -+ARCH ?= $(SUBARCH) -+CROSS_COMPILE ?= -+KVER := $(shell uname -r) -+KSRC := /lib/modules/$(KVER)/build -+MODDESTDIR := /lib/modules/$(KVER)/kernel/drivers/net/wireless/ -+INSTALL_PREFIX := -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ACTIONS_ATM702X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFORM_ACTIONS_ATM702X -+#ARCH := arm -+ARCH := $(R_ARCH) -+#CROSS_COMPILE := arm-none-linux-gnueabi- -+CROSS_COMPILE := $(R_CROSS_COMPILE) -+KVER:= 3.4.0 -+#KSRC := ../../../../build/out/kernel -+KSRC := $(KERNEL_BUILD_PATH) -+MODULE_NAME :=wlan -+endif -+ -+ -+ifeq ($(CONFIG_PLATFORM_ACTIONS_ATM705X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+#EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -+# default setting for Android 4.1, 4.2, 4.3, 4.4 -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ACTIONS_ATM705X -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+ -+# Enable this for Android 5.0 -+EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+_PLATFORM_FILES += platform/platform_arm_act_sdio.o -+endif -+ -+ARCH := arm -+CROSS_COMPILE := /opt/arm-2011.09/bin/arm-none-linux-gnueabi- -+KSRC := /home/android_sdk/Action-semi/705a_android_L/android/kernel -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SUN50IW1P1), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN50IW1P1 -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_RESUME_IN_WORKQUEUE -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ -+# Enable this for Android 5.0 -+EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+ -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+_PLATFORM_FILES += platform/platform_ARM_SUN50IW1P1_sdio.o -+endif -+ -+ARCH := arm64 -+# ===Cross compile setting for Android 5.1(64) SDK === -+CROSS_COMPILE := /home/android_sdk/Allwinner/a64/android-51/lichee/out/sun50iw1p1/android/common/buildroot/external-toolchain/bin/aarch64-linux-gnu- -+KSRC :=/home/android_sdk/Allwinner/a64/android-51/lichee/linux-3.10/ -+endif -+ -+ifeq ($(CONFIG_PLATFORM_TI_AM3517), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFORM_SHUTTLE -+CROSS_COMPILE := arm-eabi- -+KSRC := $(shell pwd)/../../../Android/kernel -+ARCH := arm -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MSTAR_TITANIA12), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MSTAR -DCONFIG_PLATFORM_MSTAR_TITANIA12 -+ARCH:=mips -+CROSS_COMPILE:= /usr/src/Mstar_kernel/mips-4.3/bin/mips-linux-gnu- -+KVER:= 2.6.28.9 -+KSRC:= /usr/src/Mstar_kernel/2.6.28.9/ -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MSTAR), y) -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MSTAR -DCONFIG_USE_USB_BUFFER_ALLOC_TX -DCONFIG_FIX_NR_BULKIN_BUFFER -DCONFIG_PREALLOC_RX_SKB_BUFFER -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_MSTAR_HIGH -+ARCH:=arm -+CROSS_COMPILE:= /usr/src/bin/arm-none-linux-gnueabi- -+KVER:= 3.1.10 -+KSRC:= /usr/src/Mstar_kernel/3.1.10/ -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ANDROID_X86), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+SUBARCH := $(shell uname -m | sed -e s/i.86/i386/) -+ARCH := $(SUBARCH) -+CROSS_COMPILE := /media/DATA-2/android-x86/ics-x86_20120130/prebuilt/linux-x86/toolchain/i686-unknown-linux-gnu-4.2.1/bin/i686-unknown-linux-gnu- -+KSRC := /media/DATA-2/android-x86/ics-x86_20120130/out/target/product/generic_x86/obj/kernel -+MODULE_NAME :=wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ANDROID_INTEL_X86), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ANDROID_INTEL_X86 -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_INTEL_BYT -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_SKIP_SIGNAL_SCALE_MAPPING -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_RESUME_IN_WORKQUEUE -+endif -+endif -+ -+ifeq ($(CONFIG_PLATFORM_JB_X86), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+SUBARCH := $(shell uname -m | sed -e s/i.86/i386/) -+ARCH := $(SUBARCH) -+CROSS_COMPILE := /home/android_sdk/android-x86_JB/prebuilts/gcc/linux-x86/x86/i686-linux-android-4.7/bin/i686-linux-android- -+KSRC := /home/android_sdk/android-x86_JB/out/target/product/x86/obj/kernel/ -+MODULE_NAME :=wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_NV_TK1), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_P2P_IPS -DCONFIG_PLATFORM_ANDROID -+EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -+#EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_OOB_INT -+# Enable this for Android 5.0 -+EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+EXTRA_CFLAGS += -DRTW_VENDOR_EXT_SUPPORT -+EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -+ARCH := arm -+CROSS_COMPILE := /mnt/newdisk/android_sdk/nvidia_tk1/android_L/prebuilts/gcc/linux-x86/arm/arm-eabi-4.8/bin/arm-eabi- -+KSRC :=/mnt/newdisk/android_sdk/nvidia_tk1/android_L/out/target/product/shieldtablet/obj/KERNEL/ -+MODULE_NAME = wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_PXA2XX), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH := arm -+CROSS_COMPILE := arm-none-linux-gnueabi- -+KVER := 2.6.34.1 -+KSRC ?= /usr/src/linux-2.6.34.1 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_S3C2K4), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH := arm -+CROSS_COMPILE := arm-linux- -+KVER := 2.6.24.7_$(ARCH) -+KSRC := /usr/src/kernels/linux-$(KVER) -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_S3C6K4), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH := arm -+CROSS_COMPILE := arm-none-linux-gnueabi- -+KVER := 2.6.34.1 -+KSRC ?= /usr/src/linux-2.6.34.1 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_RTD2880B), y) -+EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN -DCONFIG_PLATFORM_RTD2880B -+ARCH:= -+CROSS_COMPILE:= -+KVER:= -+KSRC:= -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MIPS_RMI), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH:=mips -+CROSS_COMPILE:=mipsisa32r2-uclibc- -+KVER:= -+KSRC:= /root/work/kernel_realtek -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MIPS_PLM), y) -+EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN -+ARCH:=mips -+CROSS_COMPILE:=mipsisa32r2-uclibc- -+KVER:= -+KSRC:= /root/work/kernel_realtek -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MSTAR389), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MSTAR389 -+ARCH:=mips -+CROSS_COMPILE:= mips-linux-gnu- -+KVER:= 2.6.28.10 -+KSRC:= /home/mstar/mstar_linux/2.6.28.9/ -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MIPS_AR9132), y) -+EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN -+ARCH := mips -+CROSS_COMPILE := mips-openwrt-linux- -+KSRC := /home/alex/test_openwrt/tmp/linux-2.6.30.9 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_DMP_PHILIPS), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DRTK_DMP_PLATFORM -+ARCH := mips -+#CROSS_COMPILE:=/usr/local/msdk-4.3.6-mips-EL-2.6.12.6-0.9.30.3/bin/mipsel-linux- -+CROSS_COMPILE:=/usr/local/toolchain_mipsel/bin/mipsel-linux- -+KSRC ?=/usr/local/Jupiter/linux-2.6.12 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_RTK_DMP), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DRTK_DMP_PLATFORM -DCONFIG_WIRELESS_EXT -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+_PLATFORM_FILES += platform/platform_RTK_DMP_usb.o -+endif -+ARCH:=mips -+CROSS_COMPILE:=mipsel-linux- -+KVER:= -+KSRC ?= /usr/src/DMP_Kernel/jupiter/linux-2.6.12 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MT53XX), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MT53XX -+ARCH:= arm -+CROSS_COMPILE:= arm11_mtk_le- -+KVER:= 2.6.27 -+KSRC?= /proj/mtk00802/BD_Compare/BDP/Dev/BDP_V301/BDP_Linux/linux-2.6.27 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_MX51_241H), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_WISTRON_PLATFORM -+ARCH := arm -+CROSS_COMPILE := /opt/freescale/usr/local/gcc-4.1.2-glibc-2.5-nptl-3/arm-none-linux-gnueabi/bin/arm-none-linux-gnueabi- -+KVER := 2.6.31 -+KSRC ?= /lib/modules/2.6.31-770-g0e46b52/source -+endif -+ -+ifeq ($(CONFIG_PLATFORM_FS_MX61), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH := arm -+CROSS_COMPILE := /home/share/CusEnv/FreeScale/arm-eabi-4.4.3/bin/arm-eabi- -+KSRC ?= /home/share/CusEnv/FreeScale/FS_kernel_env -+endif -+ -+ -+ -+ifeq ($(CONFIG_PLATFORM_ACTIONS_ATJ227X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ACTIONS_ATJ227X -+ARCH := mips -+CROSS_COMPILE := /home/cnsd4/project/actions/tools-2.6.27/bin/mipsel-linux-gnu- -+KVER := 2.6.27 -+KSRC := /home/cnsd4/project/actions/linux-2.6.27.28 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_TI_DM365), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_TI_DM365 -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_RX -+EXTRA_CFLAGS += -DCONFIG_SINGLE_XMIT_BUF -DCONFIG_SINGLE_RECV_BUF -+ARCH := arm -+#CROSS_COMPILE := /home/cnsd4/Appro/mv_pro_5.0/montavista/pro/devkit/arm/v5t_le/bin/arm_v5t_le- -+#KSRC := /home/cnsd4/Appro/mv_pro_5.0/montavista/pro/devkit/lsp/ti-davinci/linux-dm365 -+CROSS_COMPILE := /opt/montavista/pro5.0/devkit/arm/v5t_le/bin/arm-linux- -+KSRC:= /home/vivotek/lsp/DM365/kernel_platform/kernel/linux-2.6.18 -+KERNELOUTPUT := ${PRODUCTDIR}/tmp -+KVER := 2.6.18 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MOZART), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MOZART -+ARCH := arm -+CROSS_COMPILE := /home/vivotek/lsp/mozart3v2/Mozart3e_Toolchain/build_arm_nofpu/usr/bin/arm-linux- -+KVER := $(shell uname -r) -+KSRC:= /opt/Vivotek/lsp/mozart3v2/kernel_platform/kernel/mozart_kernel-1.17 -+KERNELOUTPUT := /home/pink/sample/ODM/IP8136W-VINT/tmp/kernel -+endif -+ -+ifeq ($(CONFIG_PLATFORM_TEGRA3_CARDHU), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/nvidia/tegra-16r3-partner-android-4.1_20120723/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- -+KSRC := /home/android_sdk/nvidia/tegra-16r3-partner-android-4.1_20120723/out/target/product/cardhu/obj/KERNEL -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_TEGRA4_DALMORE), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/nvidia/tegra-17r9-partner-android-4.2-dalmore_20130131/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- -+KSRC := /home/android_sdk/nvidia/tegra-17r9-partner-android-4.2-dalmore_20130131/out/target/product/dalmore/obj/KERNEL -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_TCC8900), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/Telechips/SDK_2304_20110613/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- -+KSRC := /home/android_sdk/Telechips/SDK_2304_20110613/kernel -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_TCC8920), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/Telechips/v12.06_r1-tcc-android-4.0.4/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- -+KSRC := /home/android_sdk/Telechips/v12.06_r1-tcc-android-4.0.4/kernel -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_TCC8920_JB42), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/Telechips/v13.03_r1-tcc-android-4.2.2_ds_patched/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- -+KSRC := /home/android_sdk/Telechips/v13.03_r1-tcc-android-4.2.2_ds_patched/kernel -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_RK2818), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFORM_ROCKCHIPS -+ARCH := arm -+CROSS_COMPILE := /usr/src/release_fae_version/toolchain/arm-eabi-4.4.0/bin/arm-eabi- -+KSRC := /usr/src/release_fae_version/kernel25_A7_281x -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_RK3188), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFORM_ROCKCHIPS -+# default setting for Android 4.1, 4.2, 4.3, 4.4 -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+# default setting for Power control -+EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -+EXTRA_CFLAGS += -DRTW_SUPPORT_PLATFORM_SHUTDOWN -+# default setting for Special function -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/Rockchip/Rk3188/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- -+KSRC := /home/android_sdk/Rockchip/Rk3188/kernel -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_RK3066), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_RK3066 -+EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DRTW_SUPPORT_PLATFORM_SHUTDOWN -+endif -+EXTRA_CFLAGS += -fno-pic -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/Rockchip/rk3066_20130607/prebuilts/gcc/linux-x86/arm/arm-linux-androideabi-4.6/bin/arm-linux-androideabi- -+#CROSS_COMPILE := /home/android_sdk/Rockchip/Rk3066sdk/prebuilts/gcc/linux-x86/arm/arm-linux-androideabi-4.6/bin/arm-linux-androideabi- -+KSRC := /home/android_sdk/Rockchip/Rk3066sdk/kernel -+MODULE_NAME :=wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_URBETTER), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN #-DCONFIG_MINIMAL_MEMORY_USAGE -+ARCH := arm -+CROSS_COMPILE := /media/DATA-1/urbetter/arm-2009q3/bin/arm-none-linux-gnueabi- -+KSRC := /media/DATA-1/urbetter/ics-urbetter/kernel -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_TI_PANDA), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN #-DCONFIG_MINIMAL_MEMORY_USAGE -+ARCH := arm -+#CROSS_COMPILE := /media/DATA-1/aosp/ics-aosp_20111227/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- -+#KSRC := /media/DATA-1/aosp/android-omap-panda-3.0_20120104 -+CROSS_COMPILE := /media/DATA-1/android-4.0/prebuilt/linux-x86/toolchain/arm-eabi-4.4.3/bin/arm-eabi- -+KSRC := /media/DATA-1/android-4.0/panda_kernel/omap -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_PLATFORM_MIPS_JZ4760), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_MINIMAL_MEMORY_USAGE -+ARCH ?= mips -+CROSS_COMPILE ?= /mnt/sdb5/Ingenic/Umido/mips-4.3/bin/mips-linux-gnu- -+KSRC ?= /mnt/sdb5/Ingenic/Umido/kernel -+endif -+ -+ifeq ($(CONFIG_PLATFORM_SZEBOOK), y) -+EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN -+ARCH:=arm -+CROSS_COMPILE:=/opt/crosstool2/bin/armeb-unknown-linux-gnueabi- -+KVER:= 2.6.31.6 -+KSRC:= ../code/linux-2.6.31.6-2020/ -+endif -+ -+#Add setting for MN10300 -+ifeq ($(CONFIG_PLATFORM_MN10300), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MN10300 -+ARCH := mn10300 -+CROSS_COMPILE := mn10300-linux- -+KVER := 2.6.32.2 -+KSRC := /home/winuser/work/Plat_sLD2T_V3010/usr/src/linux-2.6.32.2 -+INSTALL_PREFIX := -+endif -+ -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SUNxI), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUNxI -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+ -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+# default setting for A10-EVB mmc0 -+#EXTRA_CFLAGS += -DCONFIG_WITS_EVB_V13 -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_sdio.o -+endif -+ -+ARCH := arm -+#CROSS_COMPILE := arm-none-linux-gnueabi- -+CROSS_COMPILE=/home/android_sdk/Allwinner/a10/android-jb42/lichee-jb42/buildroot/output/external-toolchain/bin/arm-none-linux-gnueabi- -+KVER := 3.0.8 -+#KSRC:= ../lichee/linux-3.0/ -+KSRC=/home/android_sdk/Allwinner/a10/android-jb42/lichee-jb42/linux-3.0 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SUN6I), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN6I -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2, 4.3, 4.4 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION -+ -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+# default setting for A31-EVB mmc0 -+EXTRA_CFLAGS += -DCONFIG_A31_EVB -+_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o -+endif -+ -+ARCH := arm -+#Android-JB42 -+#CROSS_COMPILE := /home/android_sdk/Allwinner/a31/android-jb42/lichee/buildroot/output/external-toolchain/bin/arm-linux-gnueabi- -+#KSRC :=/home/android_sdk/Allwinner/a31/android-jb42/lichee/linux-3.3 -+#ifeq ($(CONFIG_USB_HCI), y) -+#MODULE_NAME := 8188eu_sw -+#endif -+# ==== Cross compile setting for kitkat-a3x_v4.5 ===== -+CROSS_COMPILE := /home/android_sdk/Allwinner/a31/kitkat-a3x_v4.5/lichee/buildroot/output/external-toolchain/bin/arm-linux-gnueabi- -+KSRC :=/home/android_sdk/Allwinner/a31/kitkat-a3x_v4.5/lichee/linux-3.3 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SUN7I), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN7I -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2, 4.3, 4.4 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION -+ -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o -+endif -+ -+ARCH := arm -+# ===Cross compile setting for Android 4.2 SDK === -+#CROSS_COMPILE := /home/android_sdk/Allwinner/a20_evb/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- -+#KSRC := /home/android_sdk/Allwinner/a20_evb/lichee/linux-3.3 -+# ==== Cross compile setting for Android 4.3 SDK ===== -+#CROSS_COMPILE := /home/android_sdk/Allwinner/a20/android-jb43/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- -+#KSRC := /home/android_sdk/Allwinner/a20/android-jb43/lichee/linux-3.4 -+# ==== Cross compile setting for kitkat-a20_v4.4 ===== -+CROSS_COMPILE := /home/android_sdk/Allwinner/a20/kitkat-a20_v4.4/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- -+KSRC := /home/android_sdk/Allwinner/a20/kitkat-a20_v4.4/lichee/linux-3.4 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SUN8I_W3P1), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN8I -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN8I_W3P1 -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+ -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o -+endif -+ -+ARCH := arm -+# ===Cross compile setting for Android 4.2 SDK === -+#CROSS_COMPILE := /home/android_sdk/Allwinner/a23/android-jb42/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- -+#KSRC :=/home/android_sdk/Allwinner/a23/android-jb42/lichee/linux-3.4 -+# ===Cross compile setting for Android 4.4 SDK === -+CROSS_COMPILE := /home/android_sdk/Allwinner/a23/android-kk44/lichee/out/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- -+KSRC :=/home/android_sdk/Allwinner/a23/android-kk44/lichee/linux-3.4 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SUN8I_W5P1), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN8I -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN8I_W5P1 -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+ -+# Enable this for Android 5.0 -+EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+ -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o -+endif -+ -+ARCH := arm -+# ===Cross compile setting for Android L SDK === -+CROSS_COMPILE := /home/android_sdk/Allwinner/a33/android-L/lichee/out/sun8iw5p1/android/common/buildroot/external-toolchain/bin/arm-linux-gnueabi- -+KSRC :=/home/android_sdk/Allwinner/a33/android-L/lichee/linux-3.4 -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ACTIONS_ATV5201), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ACTIONS_ATV5201 -+EXTRA_CFLAGS += -DCONFIG_SDIO_DISABLE_RXFIFO_POLLING_LOOP -+ARCH := mips -+CROSS_COMPILE := mipsel-linux-gnu- -+KVER := $(KERNEL_VER) -+KSRC:= $(CFGDIR)/../../kernel/linux-$(KERNEL_VER) -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_RTD299X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DUSB_XMITBUF_ALIGN_SZ=1024 -DUSB_PACKET_OFFSET_SZ=0 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+ifeq ($(CONFIG_ANDROID), y) -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+# Enable this for Android 5.0 -+EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -+endif -+#ARCH, CROSS_COMPILE, KSRC,and MODDESTDIR are provided by external makefile -+INSTALL_PREFIX := -+endif -+ -+ifeq ($(CONFIG_PLATFORM_HISILICON), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_HISILICON -+ifeq ($(SUPPORT_CONCURRENT),y) -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+endif -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+ARCH := arm -+ifeq ($(CROSS_COMPILE),) -+ CROSS_COMPILE = arm-hisiv200-linux- -+endif -+MODULE_NAME := rtl8192eu -+ifeq ($(KSRC),) -+ KSRC := ../../../../../../kernel/linux-3.4.y -+endif -+endif -+ -+# Platform setting -+ifeq ($(CONFIG_PLATFORM_ARM_SPREADTRUM_6820), y) -+ifeq ($(CONFIG_ANDROID_2X), y) -+EXTRA_CFLAGS += -DANDROID_2X -+endif -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_SPRD -+EXTRA_CFLAGS += -DPLATFORM_SPREADTRUM_6820 -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ifeq ($(RTL871X), rtl8188e) -+EXTRA_CFLAGS += -DSOFTAP_PS_DURATION=50 -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+_PLATFORM_FILES += platform/platform_sprd_sdio.o -+endif -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_SPREADTRUM_8810), y) -+ifeq ($(CONFIG_ANDROID_2X), y) -+EXTRA_CFLAGS += -DANDROID_2X -+endif -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_SPRD -+EXTRA_CFLAGS += -DPLATFORM_SPREADTRUM_8810 -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+ifeq ($(RTL871X), rtl8188e) -+EXTRA_CFLAGS += -DSOFTAP_PS_DURATION=50 -+endif -+ifeq ($(CONFIG_SDIO_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+_PLATFORM_FILES += platform/platform_sprd_sdio.o -+endif -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_WMT), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS -+ifeq ($(CONFIG_SDIO_HCI), y) -+_PLATFORM_FILES += platform/platform_ARM_WMT_sdio.o -+endif -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/WonderMedia/wm8880-android4.4/toolchain/arm_201103_gcc4.5.2/mybin/arm_1103_le- -+KSRC := /home/android_sdk/WonderMedia/wm8880-android4.4/kernel4.4/ -+MODULE_NAME :=8189es_kk -+endif -+ -+ifeq ($(CONFIG_PLATFORM_RTK119X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+#EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUN7I -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+#EXTRA_CFLAGS += -DCONFIG_IFACE_NUMBER=3 -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+#EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION -+EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION -+ -+#EXTRA_CFLAGS += -DCONFIG_#PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+#_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+#ifeq ($(CONFIG_SDIO_HCI), y) -+#_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o -+#endif -+ -+ARCH := arm -+ -+# ==== Cross compile setting for Android 4.4 SDK ===== -+#CROSS_COMPILE := arm-linux-gnueabihf- -+KVER := 3.10.24 -+#KSRC :=/home/android_sdk/Allwinner/a20/android-kitkat44/lichee/linux-3.4 -+CROSS_COMPILE := $(CROSS) -+KSRC := $(LINUX_KERNEL_PATH) -+MODULE_NAME := 8192eu -+ -+endif -+ -+ifeq ($(CONFIG_PLATFORM_RTK129X), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DRTK_129X_PLATFORM -+EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+#EXTRA_CFLAGS += -DCONFIG_P2P_IPS -DCONFIG_QOS_OPTIMIZATION -+EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION -+EXTRA_CFLAGS += -Wno-error=date-time -+ -+#EXTRA_CFLAGS += -DCONFIG_#PLATFORM_OPS -+ifeq ($(CONFIG_USB_HCI), y) -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+#_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o -+endif -+ -+ARCH := arm64 -+ -+# ==== Cross compile setting for Android 4.4 SDK ===== -+#CROSS_COMPILE := arm-linux-gnueabihf- -+KVER := 4.1.10 -+CROSS_COMPILE := $(CROSS) -+KSRC := $(LINUX_KERNEL_PATH) -+MODULE_NAME := 8822be -+endif -+ -+ifeq ($(CONFIG_PLATFORM_NOVATEK_NT72668), y) -+EXTRA_CFLAGS += -DCONFIG_PLATFORM_NOVATEK_NT72668 -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_RX -+EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -+ARCH ?= arm -+CROSS_COMPILE := arm-linux-gnueabihf- -+KVER := 3.8.0 -+KSRC := /Custom/Novatek/TCL/linux-3.8_header -+#KSRC := $(KERNELDIR) -+endif -+ -+ifeq ($(CONFIG_PLATFORM_ARM_TCC8930_JB42), y) -+EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -+# default setting for Android 4.1, 4.2 -+EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -+EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -+ARCH := arm -+CROSS_COMPILE := /home/android_sdk/Telechips/v13.05_r1-tcc-android-4.2.2_tcc893x-evm_build/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- -+KSRC := /home/android_sdk/Telechips/v13.05_r1-tcc-android-4.2.2_tcc893x-evm_build/kernel -+MODULE_NAME := wlan -+endif -+ -+ifeq ($(CONFIG_MULTIDRV), y) -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+MODULE_NAME := rtw_sdio -+endif -+ -+ifeq ($(CONFIG_USB_HCI), y) -+MODULE_NAME := rtw_usb -+endif -+ -+ifeq ($(CONFIG_PCI_HCI), y) -+MODULE_NAME := rtw_pci -+endif -+ -+ -+endif -+ -+USER_MODULE_NAME ?= -+ifneq ($(USER_MODULE_NAME),) -+MODULE_NAME := $(USER_MODULE_NAME) -+endif -+ -+ifneq ($(KERNELRELEASE),) -+ -+rtk_core := core/rtw_cmd.o \ -+ core/rtw_security.o \ -+ core/rtw_debug.o \ -+ core/rtw_io.o \ -+ core/rtw_ioctl_query.o \ -+ core/rtw_ioctl_set.o \ -+ core/rtw_ieee80211.o \ -+ core/rtw_mlme.o \ -+ core/rtw_mlme_ext.o \ -+ core/rtw_mi.o \ -+ core/rtw_wlan_util.o \ -+ core/rtw_vht.o \ -+ core/rtw_pwrctrl.o \ -+ core/rtw_rf.o \ -+ core/rtw_recv.o \ -+ core/rtw_sta_mgt.o \ -+ core/rtw_ap.o \ -+ core/rtw_xmit.o \ -+ core/rtw_p2p.o \ -+ core/rtw_tdls.o \ -+ core/rtw_br_ext.o \ -+ core/rtw_iol.o \ -+ core/rtw_sreset.o \ -+ core/rtw_btcoex.o \ -+ core/rtw_beamforming.o \ -+ core/rtw_odm.o \ -+ core/efuse/rtw_efuse.o -+ -+ifeq ($(CONFIG_SDIO_HCI), y) -+rtk_core += core/rtw_sdio.o -+endif -+ -+$(MODULE_NAME)-y += $(rtk_core) -+ -+$(MODULE_NAME)-$(CONFIG_INTEL_WIDI) += core/rtw_intel_widi.o -+ -+$(MODULE_NAME)-$(CONFIG_WAPI_SUPPORT) += core/rtw_wapi.o \ -+ core/rtw_wapi_sms4.o -+ -+$(MODULE_NAME)-y += $(_OS_INTFS_FILES) -+$(MODULE_NAME)-y += $(_HAL_INTFS_FILES) -+$(MODULE_NAME)-y += $(_OUTSRC_FILES) -+$(MODULE_NAME)-y += $(_PLATFORM_FILES) -+ -+$(MODULE_NAME)-$(CONFIG_MP_INCLUDED) += core/rtw_mp.o -+ -+ifeq ($(CONFIG_RTL8723B), y) -+$(MODULE_NAME)-$(CONFIG_MP_INCLUDED)+= core/rtw_bt_mp.o -+endif -+ -+obj-$(CONFIG_RTL8723DE) := $(MODULE_NAME).o -+ -+else -+ -+export CONFIG_RTL8723DE = m -+ -+all: modules -+ -+modules: -+ $(MAKE) ARCH=$(ARCH) CROSS_COMPILE=$(CROSS_COMPILE) -C $(KSRC) M=$(shell pwd) modules -+ -+strip: -+ $(CROSS_COMPILE)strip $(MODULE_NAME).ko --strip-unneeded -+ -+install: -+ install -p -m 644 $(MODULE_NAME).ko $(MODDESTDIR) -+ /sbin/depmod -a ${KVER} -+ -+uninstall: -+ rm -f $(MODDESTDIR)/$(MODULE_NAME).ko -+ /sbin/depmod -a ${KVER} -+ -+config_r: -+ @echo "make config" -+ /bin/bash script/Configure script/config.in -+ -+ -+.PHONY: modules clean -+ -+clean: -+ #$(MAKE) -C $(KSRC) M=$(shell pwd) clean -+ cd hal ; rm -fr */*/*/*.mod.c */*/*/*.mod */*/*/*.o */*/*/.*.cmd */*/*/*.ko -+ cd hal ; rm -fr */*/*.mod.c */*/*.mod */*/*.o */*/.*.cmd */*/*.ko -+ cd hal ; rm -fr */*.mod.c */*.mod */*.o */.*.cmd */*.ko -+ cd hal ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ cd core/efuse ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ cd core ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ cd os_dep/linux ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ cd os_dep ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ cd platform ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ rm -fr Module.symvers ; rm -fr Module.markers ; rm -fr modules.order -+ rm -fr *.mod.c *.mod *.o .*.cmd *.ko *~ -+ rm -fr .tmp_versions -+endif -+ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/custom_gpio_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/custom_gpio_linux.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/custom_gpio_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/custom_gpio_linux.c 2018-02-11 21:44:27.173146482 +0200 -@@ -0,0 +1,346 @@ -+/****************************************************************************** -+ * Customer code to add GPIO control during WLAN start/stop -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#include "drv_types.h" -+ -+#ifdef CONFIG_PLATFORM_SPRD -+ -+/* gspi func & GPIO define */ -+#include /* 0915 */ -+#include -+ -+#if !(defined ANDROID_2X) -+ -+#ifdef CONFIG_RTL8188E -+#include -+#include -+#endif /* CONFIG_RTL8188E */ -+ -+#ifndef GPIO_WIFI_POWER -+#define GPIO_WIFI_POWER -1 -+#endif /* !GPIO_WIFI_POWER */ -+ -+#ifndef GPIO_WIFI_RESET -+#define GPIO_WIFI_RESET -1 -+#endif /* !GPIO_WIFI_RESET */ -+ -+#ifndef GPIO_WIFI_PWDN -+#define GPIO_WIFI_PWDN -1 -+#endif /* !GPIO_WIFI_RESET */ -+#ifdef CONFIG_GSPI_HCI -+extern unsigned int oob_irq; -+#endif /* CONFIG_GSPI_HCI */ -+ -+#ifdef CONFIG_SDIO_HCI -+extern int rtw_mp_mode; -+#else /* !CONFIG_SDIO_HCI */ -+#endif /* !CONFIG_SDIO_HCI */ -+ -+int rtw_wifi_gpio_init(void) -+{ -+#ifdef CONFIG_GSPI_HCI -+ if (GPIO_WIFI_IRQ > 0) { -+ gpio_request(GPIO_WIFI_IRQ, "oob_irq"); -+ gpio_direction_input(GPIO_WIFI_IRQ); -+ -+ oob_irq = gpio_to_irq(GPIO_WIFI_IRQ); -+ -+ RTW_INFO("%s oob_irq:%d\n", __func__, oob_irq); -+ } -+#endif -+ if (GPIO_WIFI_RESET > 0) -+ gpio_request(GPIO_WIFI_RESET , "wifi_rst"); -+ if (GPIO_WIFI_POWER > 0) -+ gpio_request(GPIO_WIFI_POWER, "wifi_power"); -+ -+#ifdef CONFIG_SDIO_HCI -+#if (defined(CONFIG_RTL8723B)) && (MP_DRIVER == 1) -+ if (rtw_mp_mode == 1) { -+ RTW_INFO("%s GPIO_BT_RESET pin special for mp_test\n", __func__); -+ if (GPIO_BT_RESET > 0) -+ gpio_request(GPIO_BT_RESET , "bt_rst"); -+ } -+#endif -+#endif -+ return 0; -+} -+ -+int rtw_wifi_gpio_deinit(void) -+{ -+#ifdef CONFIG_GSPI_HCI -+ if (GPIO_WIFI_IRQ > 0) -+ gpio_free(GPIO_WIFI_IRQ); -+#endif -+ if (GPIO_WIFI_RESET > 0) -+ gpio_free(GPIO_WIFI_RESET); -+ if (GPIO_WIFI_POWER > 0) -+ gpio_free(GPIO_WIFI_POWER); -+ -+#ifdef CONFIG_SDIO_HCI -+#if (defined(CONFIG_RTL8723B)) && (MP_DRIVER == 1) -+ if (rtw_mp_mode == 1) { -+ RTW_INFO("%s GPIO_BT_RESET pin special for mp_test\n", __func__); -+ if (GPIO_BT_RESET > 0) -+ gpio_free(GPIO_BT_RESET); -+ } -+#endif -+#endif -+ return 0; -+} -+ -+/* Customer function to control hw specific wlan gpios */ -+void rtw_wifi_gpio_wlan_ctrl(int onoff) -+{ -+ switch (onoff) { -+ case WLAN_PWDN_OFF: -+ RTW_INFO("%s: call customer specific GPIO(%d) to set wifi power down pin to 0\n", -+ __FUNCTION__, GPIO_WIFI_RESET); -+ -+#ifndef CONFIG_DONT_BUS_SCAN -+ if (GPIO_WIFI_RESET > 0) -+ gpio_direction_output(GPIO_WIFI_RESET , 0); -+#endif -+ break; -+ -+ case WLAN_PWDN_ON: -+ RTW_INFO("%s: callc customer specific GPIO(%d) to set wifi power down pin to 1\n", -+ __FUNCTION__, GPIO_WIFI_RESET); -+ -+ if (GPIO_WIFI_RESET > 0) -+ gpio_direction_output(GPIO_WIFI_RESET , 1); -+ break; -+ -+ case WLAN_POWER_OFF: -+ break; -+ -+ case WLAN_POWER_ON: -+ break; -+#ifdef CONFIG_SDIO_HCI -+#if (defined(CONFIG_RTL8723B)) && (MP_DRIVER == 1) -+ case WLAN_BT_PWDN_OFF: -+ if (rtw_mp_mode == 1) { -+ RTW_INFO("%s: call customer specific GPIO to set wifi power down pin to 0\n", -+ __FUNCTION__); -+ if (GPIO_BT_RESET > 0) -+ gpio_direction_output(GPIO_BT_RESET , 0); -+ } -+ break; -+ -+ case WLAN_BT_PWDN_ON: -+ if (rtw_mp_mode == 1) { -+ RTW_INFO("%s: callc customer specific GPIO to set wifi power down pin to 1 %x\n", -+ __FUNCTION__, GPIO_BT_RESET); -+ -+ if (GPIO_BT_RESET > 0) -+ gpio_direction_output(GPIO_BT_RESET , 1); -+ } -+ break; -+#endif -+#endif -+ } -+} -+ -+#else /* ANDROID_2X */ -+ -+#include -+ -+#ifdef CONFIG_RTL8188E -+extern int sprd_3rdparty_gpio_wifi_power; -+#endif -+extern int sprd_3rdparty_gpio_wifi_pwd; -+#if defined(CONFIG_RTL8723B) -+extern int sprd_3rdparty_gpio_bt_reset; -+#endif -+ -+int rtw_wifi_gpio_init(void) -+{ -+#if defined(CONFIG_RTL8723B) -+ if (sprd_3rdparty_gpio_bt_reset > 0) -+ gpio_direction_output(sprd_3rdparty_gpio_bt_reset, 1); -+#endif -+ -+ return 0; -+} -+ -+int rtw_wifi_gpio_deinit(void) -+{ -+ return 0; -+} -+ -+/* Customer function to control hw specific wlan gpios */ -+void rtw_wifi_gpio_wlan_ctrl(int onoff) -+{ -+ switch (onoff) { -+ case WLAN_PWDN_OFF: -+ RTW_INFO("%s: call customer specific GPIO to set wifi power down pin to 0\n", -+ __FUNCTION__); -+ if (sprd_3rdparty_gpio_wifi_pwd > 0) -+ gpio_set_value(sprd_3rdparty_gpio_wifi_pwd, 0); -+ -+ if (sprd_3rdparty_gpio_wifi_pwd == 60) { -+ RTW_INFO("%s: turn off VSIM2 2.8V\n", __func__); -+ LDO_TurnOffLDO(LDO_LDO_SIM2); -+ } -+ break; -+ -+ case WLAN_PWDN_ON: -+ RTW_INFO("%s: callc customer specific GPIO to set wifi power down pin to 1\n", -+ __FUNCTION__); -+ if (sprd_3rdparty_gpio_wifi_pwd == 60) { -+ RTW_INFO("%s: turn on VSIM2 2.8V\n", __func__); -+ LDO_SetVoltLevel(LDO_LDO_SIM2, LDO_VOLT_LEVEL0); -+ LDO_TurnOnLDO(LDO_LDO_SIM2); -+ } -+ if (sprd_3rdparty_gpio_wifi_pwd > 0) -+ gpio_set_value(sprd_3rdparty_gpio_wifi_pwd, 1); -+ break; -+ -+ case WLAN_POWER_OFF: -+#ifdef CONFIG_RTL8188E -+#ifdef CONFIG_WIF1_LDO -+ RTW_INFO("%s: turn off VDD-WIFI0 1.2V\n", __FUNCTION__); -+ LDO_TurnOffLDO(LDO_LDO_WIF1); -+#endif /* CONFIG_WIF1_LDO */ -+ -+ RTW_INFO("%s: turn off VDD-WIFI0 3.3V\n", __FUNCTION__); -+ LDO_TurnOffLDO(LDO_LDO_WIF0); -+ -+ RTW_INFO("%s: call customer specific GPIO(%d) to turn off wifi power\n", -+ __FUNCTION__, sprd_3rdparty_gpio_wifi_power); -+ if (sprd_3rdparty_gpio_wifi_power != 65535) -+ gpio_set_value(sprd_3rdparty_gpio_wifi_power, 0); -+#endif -+ break; -+ -+ case WLAN_POWER_ON: -+#ifdef CONFIG_RTL8188E -+ RTW_INFO("%s: call customer specific GPIO(%d) to turn on wifi power\n", -+ __FUNCTION__, sprd_3rdparty_gpio_wifi_power); -+ if (sprd_3rdparty_gpio_wifi_power != 65535) -+ gpio_set_value(sprd_3rdparty_gpio_wifi_power, 1); -+ -+ RTW_INFO("%s: turn on VDD-WIFI0 3.3V\n", __FUNCTION__); -+ LDO_TurnOnLDO(LDO_LDO_WIF0); -+ LDO_SetVoltLevel(LDO_LDO_WIF0, LDO_VOLT_LEVEL1); -+ -+#ifdef CONFIG_WIF1_LDO -+ RTW_INFO("%s: turn on VDD-WIFI1 1.2V\n", __func__); -+ LDO_TurnOnLDO(LDO_LDO_WIF1); -+ LDO_SetVoltLevel(LDO_LDO_WIF1, LDO_VOLT_LEVEL3); -+#endif /* CONFIG_WIF1_LDO */ -+#endif -+ break; -+ -+ case WLAN_BT_PWDN_OFF: -+ RTW_INFO("%s: call customer specific GPIO to set bt power down pin to 0\n", -+ __FUNCTION__); -+#if defined(CONFIG_RTL8723B) -+ if (sprd_3rdparty_gpio_bt_reset > 0) -+ gpio_set_value(sprd_3rdparty_gpio_bt_reset, 0); -+#endif -+ break; -+ -+ case WLAN_BT_PWDN_ON: -+ RTW_INFO("%s: callc customer specific GPIO to set bt power down pin to 1\n", -+ __FUNCTION__); -+#if defined(CONFIG_RTL8723B) -+ if (sprd_3rdparty_gpio_bt_reset > 0) -+ gpio_set_value(sprd_3rdparty_gpio_bt_reset, 1); -+#endif -+ break; -+ } -+} -+#endif /* ANDROID_2X */ -+ -+#elif defined(CONFIG_PLATFORM_ARM_RK3066) -+#include -+ -+#define GPIO_WIFI_IRQ RK30_PIN2_PC2 -+extern unsigned int oob_irq; -+int rtw_wifi_gpio_init(void) -+{ -+#ifdef CONFIG_GSPI_HCI -+ if (GPIO_WIFI_IRQ > 0) { -+ rk30_mux_api_set(GPIO2C2_LCDC1DATA18_SMCBLSN1_HSADCDATA5_NAME, GPIO2C_GPIO2C2);/* jacky_test */ -+ gpio_request(GPIO_WIFI_IRQ, "oob_irq"); -+ gpio_direction_input(GPIO_WIFI_IRQ); -+ -+ oob_irq = gpio_to_irq(GPIO_WIFI_IRQ); -+ -+ RTW_INFO("%s oob_irq:%d\n", __func__, oob_irq); -+ } -+#endif -+ return 0; -+} -+ -+ -+int rtw_wifi_gpio_deinit(void) -+{ -+#ifdef CONFIG_GSPI_HCI -+ if (GPIO_WIFI_IRQ > 0) -+ gpio_free(GPIO_WIFI_IRQ); -+#endif -+ return 0; -+} -+ -+void rtw_wifi_gpio_wlan_ctrl(int onoff) -+{ -+} -+ -+#ifdef CONFIG_GPIO_API -+/* this is a demo for extending GPIO pin[7] as interrupt mode */ -+struct net_device *rtl_net; -+extern int rtw_register_gpio_interrupt(struct net_device *netdev, int gpio_num, void(*callback)(u8 level)); -+extern int rtw_disable_gpio_interrupt(struct net_device *netdev, int gpio_num); -+void gpio_int(u8 is_high) -+{ -+ RTW_INFO("%s level=%d\n", __func__, is_high); -+} -+int register_net_gpio_init(void) -+{ -+ rtl_net = dev_get_by_name(&init_net, "wlan0"); -+ if (!rtl_net) { -+ RTW_PRINT("rtl_net init fail!\n"); -+ return -1; -+ } -+ return rtw_register_gpio_interrupt(rtl_net, 7, gpio_int); -+} -+int unregister_net_gpio_init(void) -+{ -+ rtl_net = dev_get_by_name(&init_net, "wlan0"); -+ if (!rtl_net) { -+ RTW_PRINT("rtl_net init fail!\n"); -+ return -1; -+ } -+ return rtw_disable_gpio_interrupt(rtl_net, 7); -+} -+#endif -+ -+#else -+ -+int rtw_wifi_gpio_init(void) -+{ -+ return 0; -+} -+ -+void rtw_wifi_gpio_wlan_ctrl(int onoff) -+{ -+} -+#endif /* CONFIG_PLATFORM_SPRD */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.c 2018-02-11 21:44:27.174146497 +0200 -@@ -0,0 +1,7183 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _IOCTL_CFG80211_C_ -+ -+#include -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -+#define STATION_INFO_SIGNAL BIT(NL80211_STA_INFO_SIGNAL) -+#define STATION_INFO_TX_BITRATE BIT(NL80211_STA_INFO_TX_BITRATE) -+#define STATION_INFO_RX_PACKETS BIT(NL80211_STA_INFO_RX_PACKETS) -+#define STATION_INFO_TX_PACKETS BIT(NL80211_STA_INFO_TX_PACKETS) -+#define STATION_INFO_ASSOC_REQ_IES 0 -+#endif /* Linux kernel >= 4.0.0 */ -+ -+#include -+ -+#define RTW_MAX_MGMT_TX_CNT (8) -+#define RTW_MAX_MGMT_TX_MS_GAS (500) -+ -+#define RTW_SCAN_IE_LEN_MAX 2304 -+#define RTW_MAX_REMAIN_ON_CHANNEL_DURATION 5000 /* ms */ -+#define RTW_MAX_NUM_PMKIDS 4 -+ -+#define RTW_CH_MAX_2G_CHANNEL 14 /* Max channel in 2G band */ -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ -+#ifndef WLAN_CIPHER_SUITE_SMS4 -+#define WLAN_CIPHER_SUITE_SMS4 0x00147201 -+#endif -+ -+#ifndef WLAN_AKM_SUITE_WAPI_PSK -+#define WLAN_AKM_SUITE_WAPI_PSK 0x000FAC04 -+#endif -+ -+#ifndef WLAN_AKM_SUITE_WAPI_CERT -+#define WLAN_AKM_SUITE_WAPI_CERT 0x000FAC12 -+#endif -+ -+#ifndef NL80211_WAPI_VERSION_1 -+#define NL80211_WAPI_VERSION_1 (1 << 2) -+#endif -+ -+#endif /* CONFIG_WAPI_SUPPORT */ -+ -+#ifdef CONFIG_RTW_80211R -+#define WLAN_AKM_SUITE_FT_8021X 0x000FAC03 -+#define WLAN_AKM_SUITE_FT_PSK 0x000FAC04 -+#endif -+ -+static const u32 rtw_cipher_suites[] = { -+ WLAN_CIPHER_SUITE_WEP40, -+ WLAN_CIPHER_SUITE_WEP104, -+ WLAN_CIPHER_SUITE_TKIP, -+ WLAN_CIPHER_SUITE_CCMP, -+#ifdef CONFIG_WAPI_SUPPORT -+ WLAN_CIPHER_SUITE_SMS4, -+#endif /* CONFIG_WAPI_SUPPORT */ -+#ifdef CONFIG_IEEE80211W -+ WLAN_CIPHER_SUITE_AES_CMAC, -+#endif /* CONFIG_IEEE80211W */ -+}; -+ -+#define RATETAB_ENT(_rate, _rateid, _flags) \ -+ { \ -+ .bitrate = (_rate), \ -+ .hw_value = (_rateid), \ -+ .flags = (_flags), \ -+ } -+ -+#define CHAN2G(_channel, _freq, _flags) { \ -+ .band = NL80211_BAND_2GHZ, \ -+ .center_freq = (_freq), \ -+ .hw_value = (_channel), \ -+ .flags = (_flags), \ -+ .max_antenna_gain = 0, \ -+ .max_power = 30, \ -+ } -+ -+#define CHAN5G(_channel, _flags) { \ -+ .band = NL80211_BAND_5GHZ, \ -+ .center_freq = 5000 + (5 * (_channel)), \ -+ .hw_value = (_channel), \ -+ .flags = (_flags), \ -+ .max_antenna_gain = 0, \ -+ .max_power = 30, \ -+ } -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+/* if wowlan is not supported, kernel generate a disconnect at each suspend -+ * cf: /net/wireless/sysfs.c, so register a stub wowlan. -+ * Moreover wowlan has to be enabled via a the nl80211_set_wowlan callback. -+ * (from user space, e.g. iw phy0 wowlan enable) -+ */ -+static const struct wiphy_wowlan_support wowlan_stub = { -+ .flags = WIPHY_WOWLAN_ANY, -+ .n_patterns = 0, -+ .pattern_max_len = 0, -+ .pattern_min_len = 0, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) -+ .max_pkt_offset = 0, -+#endif -+}; -+#endif -+ -+static struct ieee80211_rate rtw_rates[] = { -+ RATETAB_ENT(10, 0x1, 0), -+ RATETAB_ENT(20, 0x2, 0), -+ RATETAB_ENT(55, 0x4, 0), -+ RATETAB_ENT(110, 0x8, 0), -+ RATETAB_ENT(60, 0x10, 0), -+ RATETAB_ENT(90, 0x20, 0), -+ RATETAB_ENT(120, 0x40, 0), -+ RATETAB_ENT(180, 0x80, 0), -+ RATETAB_ENT(240, 0x100, 0), -+ RATETAB_ENT(360, 0x200, 0), -+ RATETAB_ENT(480, 0x400, 0), -+ RATETAB_ENT(540, 0x800, 0), -+}; -+ -+#define rtw_a_rates (rtw_rates + 4) -+#define RTW_A_RATES_NUM 8 -+#define rtw_g_rates (rtw_rates + 0) -+#define RTW_G_RATES_NUM 12 -+ -+#define RTW_2G_CHANNELS_NUM 14 -+#define RTW_5G_CHANNELS_NUM 37 -+ -+static struct ieee80211_channel rtw_2ghz_channels[] = { -+ CHAN2G(1, 2412, 0), -+ CHAN2G(2, 2417, 0), -+ CHAN2G(3, 2422, 0), -+ CHAN2G(4, 2427, 0), -+ CHAN2G(5, 2432, 0), -+ CHAN2G(6, 2437, 0), -+ CHAN2G(7, 2442, 0), -+ CHAN2G(8, 2447, 0), -+ CHAN2G(9, 2452, 0), -+ CHAN2G(10, 2457, 0), -+ CHAN2G(11, 2462, 0), -+ CHAN2G(12, 2467, 0), -+ CHAN2G(13, 2472, 0), -+ CHAN2G(14, 2484, 0), -+}; -+ -+static struct ieee80211_channel rtw_5ghz_a_channels[] = { -+ CHAN5G(34, 0), CHAN5G(36, 0), -+ CHAN5G(38, 0), CHAN5G(40, 0), -+ CHAN5G(42, 0), CHAN5G(44, 0), -+ CHAN5G(46, 0), CHAN5G(48, 0), -+ CHAN5G(52, 0), CHAN5G(56, 0), -+ CHAN5G(60, 0), CHAN5G(64, 0), -+ CHAN5G(100, 0), CHAN5G(104, 0), -+ CHAN5G(108, 0), CHAN5G(112, 0), -+ CHAN5G(116, 0), CHAN5G(120, 0), -+ CHAN5G(124, 0), CHAN5G(128, 0), -+ CHAN5G(132, 0), CHAN5G(136, 0), -+ CHAN5G(140, 0), CHAN5G(149, 0), -+ CHAN5G(153, 0), CHAN5G(157, 0), -+ CHAN5G(161, 0), CHAN5G(165, 0), -+ CHAN5G(184, 0), CHAN5G(188, 0), -+ CHAN5G(192, 0), CHAN5G(196, 0), -+ CHAN5G(200, 0), CHAN5G(204, 0), -+ CHAN5G(208, 0), CHAN5G(212, 0), -+ CHAN5G(216, 0), -+}; -+ -+ -+void rtw_2g_channels_init(struct ieee80211_channel *channels) -+{ -+ _rtw_memcpy((void *)channels, (void *)rtw_2ghz_channels, -+ sizeof(struct ieee80211_channel) * RTW_2G_CHANNELS_NUM -+ ); -+} -+ -+void rtw_5g_channels_init(struct ieee80211_channel *channels) -+{ -+ _rtw_memcpy((void *)channels, (void *)rtw_5ghz_a_channels, -+ sizeof(struct ieee80211_channel) * RTW_5G_CHANNELS_NUM -+ ); -+} -+ -+void rtw_2g_rates_init(struct ieee80211_rate *rates) -+{ -+ _rtw_memcpy(rates, rtw_g_rates, -+ sizeof(struct ieee80211_rate) * RTW_G_RATES_NUM -+ ); -+} -+ -+void rtw_5g_rates_init(struct ieee80211_rate *rates) -+{ -+ _rtw_memcpy(rates, rtw_a_rates, -+ sizeof(struct ieee80211_rate) * RTW_A_RATES_NUM -+ ); -+} -+ -+struct ieee80211_supported_band *rtw_spt_band_alloc( -+ enum nl80211_band band -+) -+{ -+ struct ieee80211_supported_band *spt_band = NULL; -+ int n_channels, n_bitrates; -+ -+ if (band == NL80211_BAND_2GHZ) { -+ n_channels = RTW_2G_CHANNELS_NUM; -+ n_bitrates = RTW_G_RATES_NUM; -+ } else if (band == NL80211_BAND_5GHZ) { -+ n_channels = RTW_5G_CHANNELS_NUM; -+ n_bitrates = RTW_A_RATES_NUM; -+ } else -+ goto exit; -+ -+ spt_band = (struct ieee80211_supported_band *)rtw_zmalloc( -+ sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel) * n_channels -+ + sizeof(struct ieee80211_rate) * n_bitrates -+ ); -+ if (!spt_band) -+ goto exit; -+ -+ spt_band->channels = (struct ieee80211_channel *)(((u8 *)spt_band) + sizeof(struct ieee80211_supported_band)); -+ spt_band->bitrates = (struct ieee80211_rate *)(((u8 *)spt_band->channels) + sizeof(struct ieee80211_channel) * n_channels); -+ spt_band->band = band; -+ spt_band->n_channels = n_channels; -+ spt_band->n_bitrates = n_bitrates; -+ -+ if (band == NL80211_BAND_2GHZ) { -+ rtw_2g_channels_init(spt_band->channels); -+ rtw_2g_rates_init(spt_band->bitrates); -+ } else if (band == NL80211_BAND_5GHZ) { -+ rtw_5g_channels_init(spt_band->channels); -+ rtw_5g_rates_init(spt_band->bitrates); -+ } -+ -+ /* spt_band.ht_cap */ -+ -+exit: -+ -+ return spt_band; -+} -+ -+void rtw_spt_band_free(struct ieee80211_supported_band *spt_band) -+{ -+ u32 size = 0; -+ -+ if (!spt_band) -+ return; -+ -+#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) -+ if (spt_band->band == NL80211_BAND_2GHZ) { -+#else -+ if (spt_band->band == IEEE80211_BAND_2GHZ) { -+#endif -+ size = sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel) * RTW_2G_CHANNELS_NUM -+ + sizeof(struct ieee80211_rate) * RTW_G_RATES_NUM; -+#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) -+ } else if (spt_band->band == NL80211_BAND_5GHZ) { -+#else -+ } else if (spt_band->band == IEEE80211_BAND_5GHZ) { -+#endif -+ size = sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel) * RTW_5G_CHANNELS_NUM -+ + sizeof(struct ieee80211_rate) * RTW_A_RATES_NUM; -+ } else { -+ -+ } -+ rtw_mfree((u8 *)spt_band, size); -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+static const struct ieee80211_txrx_stypes -+ rtw_cfg80211_default_mgmt_stypes[NUM_NL80211_IFTYPES] = { -+ [NL80211_IFTYPE_ADHOC] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+ [NL80211_IFTYPE_STATION] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) -+ }, -+ [NL80211_IFTYPE_AP] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | -+ BIT(IEEE80211_STYPE_DISASSOC >> 4) | -+ BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_DEAUTH >> 4) | -+ BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+ [NL80211_IFTYPE_AP_VLAN] = { -+ /* copy AP */ -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | -+ BIT(IEEE80211_STYPE_DISASSOC >> 4) | -+ BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_DEAUTH >> 4) | -+ BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+ [NL80211_IFTYPE_P2P_CLIENT] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) -+ }, -+ [NL80211_IFTYPE_P2P_GO] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | -+ BIT(IEEE80211_STYPE_DISASSOC >> 4) | -+ BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_DEAUTH >> 4) | -+ BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+#if defined(RTW_DEDICATED_P2P_DEVICE) -+ [NL80211_IFTYPE_P2P_DEVICE] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) -+ }, -+#endif -+}; -+#endif -+ -+static u64 rtw_get_systime_us(void) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39)) -+ struct timespec ts; -+ get_monotonic_boottime(&ts); -+ return ((u64)ts.tv_sec * 1000000) + ts.tv_nsec / 1000; -+#else -+ struct timeval tv; -+ do_gettimeofday(&tv); -+ return ((u64)tv.tv_sec * 1000000) + tv.tv_usec; -+#endif -+} -+ -+/* Try to remove non target BSS's SR to reduce PBC overlap rate */ -+static int rtw_cfg80211_clear_wps_sr_of_non_target_bss(_adapter *padapter, struct wlan_network *pnetwork, struct cfg80211_ssid *req_ssid) -+{ -+ struct rtw_wdev_priv *wdev_data = adapter_wdev_data(padapter); -+ int ret = 0; -+ u8 *psr = NULL, sr = 0; -+ NDIS_802_11_SSID *pssid = &pnetwork->network.Ssid; -+ u32 wpsielen = 0; -+ u8 *wpsie = NULL; -+ -+ if (pssid->SsidLength == req_ssid->ssid_len -+ && _rtw_memcmp(pssid->Ssid, req_ssid->ssid, req_ssid->ssid_len) == _TRUE) -+ goto exit; -+ -+ wpsie = rtw_get_wps_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_ -+ , pnetwork->network.IELength - _FIXED_IE_LENGTH_, NULL, &wpsielen); -+ if (wpsie && wpsielen > 0) -+ psr = rtw_get_wps_attr_content(wpsie, wpsielen, WPS_ATTR_SELECTED_REGISTRAR, &sr, NULL); -+ -+ if (psr && sr) { -+ if (0) -+ RTW_INFO("clear sr of non target bss:%s("MAC_FMT")\n" -+ , pssid->Ssid, MAC_ARG(pnetwork->network.MacAddress)); -+ *psr = 0; /* clear sr */ -+ ret = 1; -+ } -+ -+exit: -+ return ret; -+} -+ -+#define MAX_BSSINFO_LEN 1000 -+struct cfg80211_bss *rtw_cfg80211_inform_bss(_adapter *padapter, struct wlan_network *pnetwork) -+{ -+ struct ieee80211_channel *notify_channel; -+ struct cfg80211_bss *bss = NULL; -+ /* struct ieee80211_supported_band *band; */ -+ u16 channel; -+ u32 freq; -+ u64 notify_timestamp; -+ u16 notify_capability; -+ u16 notify_interval; -+ u8 *notify_ie; -+ size_t notify_ielen; -+ s32 notify_signal; -+ /* u8 buf[MAX_BSSINFO_LEN]; */ -+ -+ u8 *pbuf; -+ size_t buf_size = MAX_BSSINFO_LEN; -+ size_t len, bssinf_len = 0; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ struct wireless_dev *wdev = padapter->rtw_wdev; -+ struct wiphy *wiphy = wdev->wiphy; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ pbuf = rtw_zmalloc(buf_size); -+ if (pbuf == NULL) { -+ RTW_INFO("%s pbuf allocate failed !!\n", __FUNCTION__); -+ return bss; -+ } -+ -+ /* RTW_INFO("%s\n", __func__); */ -+ -+ bssinf_len = pnetwork->network.IELength + sizeof(struct rtw_ieee80211_hdr_3addr); -+ if (bssinf_len > buf_size) { -+ RTW_INFO("%s IE Length too long > %zu byte\n", __FUNCTION__, buf_size); -+ goto exit; -+ } -+ -+#ifndef CONFIG_WAPI_SUPPORT -+ { -+ u16 wapi_len = 0; -+ -+ if (rtw_get_wapi_ie(pnetwork->network.IEs, pnetwork->network.IELength, NULL, &wapi_len) > 0) { -+ if (wapi_len > 0) { -+ RTW_INFO("%s, no support wapi!\n", __FUNCTION__); -+ goto exit; -+ } -+ } -+ } -+#endif /* !CONFIG_WAPI_SUPPORT */ -+ -+ channel = pnetwork->network.Configuration.DSConfig; -+ freq = rtw_ch2freq(channel); -+ notify_channel = ieee80211_get_channel(wiphy, freq); -+ -+ if (0) -+ notify_timestamp = le64_to_cpu(*(u64 *)rtw_get_timestampe_from_ie(pnetwork->network.IEs)); -+ else -+ notify_timestamp = rtw_get_systime_us(); -+ -+ notify_interval = le16_to_cpu(*(u16 *)rtw_get_beacon_interval_from_ie(pnetwork->network.IEs)); -+ notify_capability = le16_to_cpu(*(u16 *)rtw_get_capability_from_ie(pnetwork->network.IEs)); -+ -+ notify_ie = pnetwork->network.IEs + _FIXED_IE_LENGTH_; -+ notify_ielen = pnetwork->network.IELength - _FIXED_IE_LENGTH_; -+ -+ /* We've set wiphy's signal_type as CFG80211_SIGNAL_TYPE_MBM: signal strength in mBm (100*dBm) */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { -+ notify_signal = 100 * translate_percentage_to_dbm(padapter->recvpriv.signal_strength); /* dbm */ -+ } else { -+ notify_signal = 100 * translate_percentage_to_dbm(pnetwork->network.PhyInfo.SignalStrength); /* dbm */ -+ } -+ -+#if 0 -+ RTW_INFO("bssid: "MAC_FMT"\n", MAC_ARG(pnetwork->network.MacAddress)); -+ RTW_INFO("Channel: %d(%d)\n", channel, freq); -+ RTW_INFO("Capability: %X\n", notify_capability); -+ RTW_INFO("Beacon interval: %d\n", notify_interval); -+ RTW_INFO("Signal: %d\n", notify_signal); -+ RTW_INFO("notify_timestamp: %llu\n", notify_timestamp); -+#endif -+ -+ /* pbuf = buf; */ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pbuf; -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ /* pmlmeext->mgnt_seq++; */ -+ -+ if (pnetwork->network.Reserved[0] == 1) { /* WIFI_BEACON */ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ SetFrameSubType(pbuf, WIFI_BEACON); -+ } else { -+ _rtw_memcpy(pwlanhdr->addr1, adapter_mac_addr(padapter), ETH_ALEN); -+ SetFrameSubType(pbuf, WIFI_PROBERSP); -+ } -+ -+ _rtw_memcpy(pwlanhdr->addr2, pnetwork->network.MacAddress, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pnetwork->network.MacAddress, ETH_ALEN); -+ -+ -+ /* pbuf += sizeof(struct rtw_ieee80211_hdr_3addr); */ -+ len = sizeof(struct rtw_ieee80211_hdr_3addr); -+ _rtw_memcpy((pbuf + len), pnetwork->network.IEs, pnetwork->network.IELength); -+ *((u64 *)(pbuf + len)) = cpu_to_le64(notify_timestamp); -+ -+ len += pnetwork->network.IELength; -+ -+ #if defined(CONFIG_P2P) && 0 -+ if(rtw_get_p2p_ie(pnetwork->network.IEs+12, pnetwork->network.IELength-12, NULL, NULL)) -+ RTW_INFO("%s, got p2p_ie\n", __func__); -+ #endif -+ -+#if 1 -+ bss = cfg80211_inform_bss_frame(wiphy, notify_channel, (struct ieee80211_mgmt *)pbuf, -+ len, notify_signal, GFP_ATOMIC); -+#else -+ -+ bss = cfg80211_inform_bss(wiphy, notify_channel, (const u8 *)pnetwork->network.MacAddress, -+ notify_timestamp, notify_capability, notify_interval, notify_ie, -+ notify_ielen, notify_signal, GFP_ATOMIC/*GFP_KERNEL*/); -+#endif -+ -+ if (unlikely(!bss)) { -+ RTW_INFO(FUNC_ADPT_FMT" bss NULL\n", FUNC_ADPT_ARG(padapter)); -+ goto exit; -+ } -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 38)) -+#ifndef COMPAT_KERNEL_RELEASE -+ /* patch for cfg80211, update beacon ies to information_elements */ -+ if (pnetwork->network.Reserved[0] == 1) { /* WIFI_BEACON */ -+ -+ if (bss->len_information_elements != bss->len_beacon_ies) { -+ bss->information_elements = bss->beacon_ies; -+ bss->len_information_elements = bss->len_beacon_ies; -+ } -+ } -+#endif /* COMPAT_KERNEL_RELEASE */ -+#endif /* LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 38) */ -+ -+#if 0 -+ { -+ if (bss->information_elements == bss->proberesp_ies) { -+ if (bss->len_information_elements != bss->len_proberesp_ies) -+ RTW_INFO("error!, len_information_elements != bss->len_proberesp_ies\n"); -+ } else if (bss->len_information_elements < bss->len_beacon_ies) { -+ bss->information_elements = bss->beacon_ies; -+ bss->len_information_elements = bss->len_beacon_ies; -+ } -+ } -+#endif -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0) -+ cfg80211_put_bss(wiphy, bss); -+#else -+ cfg80211_put_bss(bss); -+#endif -+ -+exit: -+ if (pbuf) -+ rtw_mfree(pbuf, buf_size); -+ return bss; -+ -+} -+ -+/* -+ Check the given bss is valid by kernel API cfg80211_get_bss() -+ @padapter : the given adapter -+ -+ return _TRUE if bss is valid, _FALSE for not found. -+*/ -+int rtw_cfg80211_check_bss(_adapter *padapter) -+{ -+ WLAN_BSSID_EX *pnetwork = &(padapter->mlmeextpriv.mlmext_info.network); -+ struct cfg80211_bss *bss = NULL; -+ struct ieee80211_channel *notify_channel = NULL; -+ u32 freq; -+ -+ if (!(pnetwork) || !(padapter->rtw_wdev)) -+ return _FALSE; -+ -+ freq = rtw_ch2freq(pnetwork->Configuration.DSConfig); -+ notify_channel = ieee80211_get_channel(padapter->rtw_wdev->wiphy, freq); -+ bss = cfg80211_get_bss(padapter->rtw_wdev->wiphy, notify_channel, -+ pnetwork->MacAddress, pnetwork->Ssid.Ssid, -+ pnetwork->Ssid.SsidLength, -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0) -+ pnetwork->InfrastructureMode == Ndis802_11Infrastructure?IEEE80211_BSS_TYPE_ESS:IEEE80211_BSS_TYPE_IBSS, -+ IEEE80211_PRIVACY(pnetwork->Privacy)); -+#else -+ pnetwork->InfrastructureMode == Ndis802_11Infrastructure?WLAN_CAPABILITY_ESS:WLAN_CAPABILITY_IBSS, pnetwork->InfrastructureMode == Ndis802_11Infrastructure?WLAN_CAPABILITY_ESS:WLAN_CAPABILITY_IBSS); -+#endif -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0) -+ cfg80211_put_bss(padapter->rtw_wdev->wiphy, bss); -+#else -+ cfg80211_put_bss(bss); -+#endif -+ -+ return bss != NULL; -+} -+ -+void rtw_cfg80211_ibss_indicate_connect(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct cfg80211_bss *bss = NULL; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) -+ struct wiphy *wiphy = pwdev->wiphy; -+ int freq = 2412; -+ struct ieee80211_channel *notify_channel; -+#endif -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) -+ freq = rtw_ch2freq(cur_network->network.Configuration.DSConfig); -+ -+ if (0) -+ RTW_INFO("chan: %d, freq: %d\n", cur_network->network.Configuration.DSConfig, freq); -+#endif -+ -+ if (pwdev->iftype != NL80211_IFTYPE_ADHOC) -+ return; -+ -+ if (!rtw_cfg80211_check_bss(padapter)) { -+ WLAN_BSSID_EX *pnetwork = &(padapter->mlmeextpriv.mlmext_info.network); -+ struct wlan_network *scanned = pmlmepriv->cur_network_scanned; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) { -+ -+ _rtw_memcpy(&cur_network->network, pnetwork, sizeof(WLAN_BSSID_EX)); -+ if (cur_network) { -+ if (!rtw_cfg80211_inform_bss(padapter, cur_network)) -+ RTW_INFO(FUNC_ADPT_FMT" inform fail !!\n", FUNC_ADPT_ARG(padapter)); -+ else -+ RTW_INFO(FUNC_ADPT_FMT" inform success !!\n", FUNC_ADPT_ARG(padapter)); -+ } else { -+ RTW_INFO("cur_network is not exist!!!\n"); -+ return ; -+ } -+ } else { -+ if (scanned == NULL) -+ rtw_warn_on(1); -+ -+ if (_rtw_memcmp(&(scanned->network.Ssid), &(pnetwork->Ssid), sizeof(NDIS_802_11_SSID)) == _TRUE -+ && _rtw_memcmp(scanned->network.MacAddress, pnetwork->MacAddress, sizeof(NDIS_802_11_MAC_ADDRESS)) == _TRUE -+ ) { -+ if (!rtw_cfg80211_inform_bss(padapter, scanned)) -+ RTW_INFO(FUNC_ADPT_FMT" inform fail !!\n", FUNC_ADPT_ARG(padapter)); -+ else { -+ /* RTW_INFO(FUNC_ADPT_FMT" inform success !!\n", FUNC_ADPT_ARG(padapter)); */ -+ } -+ } else { -+ RTW_INFO("scanned & pnetwork compare fail\n"); -+ rtw_warn_on(1); -+ } -+ } -+ -+ if (!rtw_cfg80211_check_bss(padapter)) -+ RTW_PRINT(FUNC_ADPT_FMT" BSS not found !!\n", FUNC_ADPT_ARG(padapter)); -+ } -+ /* notify cfg80211 that device joined an IBSS */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) -+ notify_channel = ieee80211_get_channel(wiphy, freq); -+ cfg80211_ibss_joined(padapter->pnetdev, cur_network->network.MacAddress, notify_channel, GFP_ATOMIC); -+#else -+ cfg80211_ibss_joined(padapter->pnetdev, cur_network->network.MacAddress, GFP_ATOMIC); -+#endif -+} -+ -+void rtw_cfg80211_indicate_connect(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ _irqL irqL; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif -+ struct cfg80211_bss *bss = NULL; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ if (pwdev->iftype != NL80211_IFTYPE_STATION -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ && pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT -+ #endif -+ ) -+ return; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ return; -+ -+#ifdef CONFIG_P2P -+ if (pwdinfo->driver_interface == DRIVER_CFG80211) { -+ #if !RTW_P2P_GROUP_INTERFACE -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ RTW_INFO("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); -+ } -+ #endif -+ } -+#endif /* CONFIG_P2P */ -+ -+ if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) != _TRUE) { -+ WLAN_BSSID_EX *pnetwork = &(padapter->mlmeextpriv.mlmext_info.network); -+ struct wlan_network *scanned = pmlmepriv->cur_network_scanned; -+ -+ /* RTW_INFO(FUNC_ADPT_FMT" BSS not found\n", FUNC_ADPT_ARG(padapter)); */ -+ -+ if (scanned == NULL) { -+ rtw_warn_on(1); -+ goto check_bss; -+ } -+ -+ if (_rtw_memcmp(scanned->network.MacAddress, pnetwork->MacAddress, sizeof(NDIS_802_11_MAC_ADDRESS)) == _TRUE -+ && _rtw_memcmp(&(scanned->network.Ssid), &(pnetwork->Ssid), sizeof(NDIS_802_11_SSID)) == _TRUE -+ ) { -+ if (!rtw_cfg80211_inform_bss(padapter, scanned)) -+ RTW_INFO(FUNC_ADPT_FMT" inform fail !!\n", FUNC_ADPT_ARG(padapter)); -+ else { -+ /* RTW_INFO(FUNC_ADPT_FMT" inform success !!\n", FUNC_ADPT_ARG(padapter)); */ -+ } -+ } else { -+ RTW_INFO("scanned: %s("MAC_FMT"), cur: %s("MAC_FMT")\n", -+ scanned->network.Ssid.Ssid, MAC_ARG(scanned->network.MacAddress), -+ pnetwork->Ssid.Ssid, MAC_ARG(pnetwork->MacAddress) -+ ); -+ rtw_warn_on(1); -+ } -+ } -+ -+check_bss: -+ if (!rtw_cfg80211_check_bss(padapter)) -+ RTW_PRINT(FUNC_ADPT_FMT" BSS not found !!\n", FUNC_ADPT_ARG(padapter)); -+ -+ _enter_critical_bh(&pwdev_priv->connect_req_lock, &irqL); -+ -+ if (rtw_to_roam(padapter) > 0) { -+ #if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 39) || defined(COMPAT_KERNEL_RELEASE) -+ struct wiphy *wiphy = pwdev->wiphy; -+ struct ieee80211_channel *notify_channel; -+ struct cfg80211_roam_info roam_info = {}; -+ u32 freq; -+ u16 channel = cur_network->network.Configuration.DSConfig; -+ -+ freq = rtw_ch2freq(channel); -+ notify_channel = ieee80211_get_channel(wiphy, freq); -+ #endif -+ -+ RTW_INFO(FUNC_ADPT_FMT" call cfg80211_roamed\n", FUNC_ADPT_ARG(padapter)); -+ roam_info.channel = notify_channel; -+ roam_info.bssid = cur_network->network.MacAddress; -+ roam_info.req_ie = pmlmepriv->assoc_req + sizeof(struct rtw_ieee80211_hdr_3addr) + 2; -+ roam_info.req_ie_len = pmlmepriv->assoc_req_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 2; -+ roam_info.resp_ie = pmlmepriv->assoc_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6; -+ roam_info.resp_ie_len = pmlmepriv->assoc_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6; -+ -+ cfg80211_roamed(padapter->pnetdev, &roam_info, GFP_ATOMIC); -+#ifdef CONFIG_RTW_80211R -+ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) -+ rtw_set_ft_status(padapter, RTW_FT_ASSOCIATED_STA); -+#endif -+ } else { -+ #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) || defined(COMPAT_KERNEL_RELEASE) -+ RTW_INFO("pwdev->sme_state(b)=%d\n", pwdev->sme_state); -+ #endif -+ rtw_cfg80211_connect_result(pwdev, cur_network->network.MacAddress -+ , pmlmepriv->assoc_req + sizeof(struct rtw_ieee80211_hdr_3addr) + 2 -+ , pmlmepriv->assoc_req_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 2 -+ , pmlmepriv->assoc_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6 -+ , pmlmepriv->assoc_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6 -+ , WLAN_STATUS_SUCCESS, GFP_ATOMIC); -+ #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) || defined(COMPAT_KERNEL_RELEASE) -+ RTW_INFO("pwdev->sme_state(a)=%d\n", pwdev->sme_state); -+ #endif -+ } -+ -+ rtw_wdev_free_connect_req(pwdev_priv); -+ -+ _exit_critical_bh(&pwdev_priv->connect_req_lock, &irqL); -+} -+ -+void rtw_cfg80211_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally_generated) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ _irqL irqL; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ /*always replace privated definitions with wifi reserved value 0*/ -+ if ((reason == WLAN_REASON_ACTIVE_ROAM) || (reason == WLAN_REASON_JOIN_WRONG_CHANNEL) || (reason == WLAN_REASON_EXPIRATION_CHK)) -+ reason = 0; -+ -+ if (pwdev->iftype != NL80211_IFTYPE_STATION -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ && pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT -+ #endif -+ ) -+ return; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ return; -+ -+#ifdef CONFIG_P2P -+ if (pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ if (pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT) -+ #endif -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ -+ RTW_INFO("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); -+ } -+ } -+#endif /* CONFIG_P2P */ -+ -+ _enter_critical_bh(&pwdev_priv->connect_req_lock, &irqL); -+ -+ if (padapter->ndev_unregistering || !rtw_wdev_not_indic_disco(pwdev_priv)) { -+ #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) || defined(COMPAT_KERNEL_RELEASE) -+ RTW_INFO("pwdev->sme_state(b)=%d\n", pwdev->sme_state); -+ -+ if (pwdev->sme_state == CFG80211_SME_CONNECTING) -+ rtw_cfg80211_connect_result(pwdev, NULL, NULL, 0, NULL, 0, -+ WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC); -+ else if (pwdev->sme_state == CFG80211_SME_CONNECTED) -+ rtw_cfg80211_disconnected(pwdev, reason, NULL, 0, locally_generated, GFP_ATOMIC); -+ -+ RTW_INFO("pwdev->sme_state(a)=%d\n", pwdev->sme_state); -+ #else -+ if (pwdev_priv->connect_req) { -+ RTW_INFO(FUNC_ADPT_FMT" call cfg80211_connect_result\n", FUNC_ADPT_ARG(padapter)); -+ rtw_cfg80211_connect_result(pwdev, NULL, NULL, 0, NULL, 0, -+ WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC); -+ } else { -+ RTW_INFO(FUNC_ADPT_FMT" call cfg80211_disconnected\n", FUNC_ADPT_ARG(padapter)); -+ rtw_cfg80211_disconnected(pwdev, reason, NULL, 0, locally_generated, GFP_ATOMIC); -+ } -+ #endif -+ } -+ -+ rtw_wdev_free_connect_req(pwdev_priv); -+ -+ _exit_critical_bh(&pwdev_priv->connect_req_lock, &irqL); -+} -+ -+ -+#ifdef CONFIG_AP_MODE -+static int rtw_cfg80211_ap_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len, wep_total_len; -+ struct sta_info *psta = NULL, *pbcmc_sta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ /* sizeof(struct ieee_param) = 64 bytes; */ -+ /* if (param_len != (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) */ -+ if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) { -+ if (param->u.crypt.idx >= WEP_KEYS -+#ifdef CONFIG_IEEE80211W -+ && param->u.crypt.idx > BIP_MAX_KEYID -+#endif /* CONFIG_IEEE80211W */ -+ ) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } else { -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (!psta) { -+ /* ret = -EINVAL; */ -+ RTW_INFO("rtw_set_encryption(), sta has already been removed or never been added\n"); -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "none") == 0 && (psta == NULL)) { -+ /* todo:clear default encryption keys */ -+ -+ RTW_INFO("clear default encryption keys, keyid=%d\n", param->u.crypt.idx); -+ -+ goto exit; -+ } -+ -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta == NULL)) { -+ RTW_INFO("r871x_set_encryption, crypt.alg = WEP\n"); -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ RTW_INFO("r871x_set_encryption, wep_key_idx=%d, len=%d\n", wep_key_idx, wep_key_len); -+ -+ if ((wep_key_idx >= WEP_KEYS) || (wep_key_len <= 0)) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (wep_key_len > 0) -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ -+ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) { -+ /* wep default key has not been set, so use this key index as default key. */ -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ -+ if (wep_key_len == 13) { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ } -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; -+ -+ rtw_ap_set_wep_key(padapter, param->u.crypt.key, wep_key_len, wep_key_idx, 1); -+ -+ goto exit; -+ -+ } -+ -+ -+ if (!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) { /* group key */ -+ if (param->u.crypt.set_tx == 0) { /* group key */ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) { -+ RTW_INFO("%s, set group_key, WEP\n", __FUNCTION__); -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ -+ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { -+ RTW_INFO("%s, set group_key, TKIP\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ -+ /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ -+ /* set mic key */ -+ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = _TRUE; -+ -+ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { -+ RTW_INFO("%s, set group_key, CCMP\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ } -+#ifdef CONFIG_IEEE80211W -+ else if (strcmp(param->u.crypt.alg, "BIP") == 0) { -+ int no; -+ -+ RTW_INFO("BIP key_len=%d , index=%d\n", param->u.crypt.key_len, param->u.crypt.idx); -+ /* save the IGTK key, length 16 bytes */ -+ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ /* RTW_INFO("IGTK key below:\n"); -+ for(no=0;no<16;no++) -+ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); -+ RTW_INFO("\n"); */ -+ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; -+ padapter->securitypriv.binstallBIPkey = _TRUE; -+ RTW_INFO(" ~~~~set sta key:IGKT\n"); -+ goto exit; -+ } -+#endif /* CONFIG_IEEE80211W */ -+ else { -+ RTW_INFO("%s, set group_key, none\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = _TRUE; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta) { -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ -+ } -+ -+ } -+ -+ goto exit; -+ -+ } -+ -+ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) { /* psk/802_1x */ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ if (param->u.crypt.set_tx == 1) { /* pairwise key */ -+ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) { -+ RTW_INFO("%s, set pairwise key, WEP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ psta->dot118021XPrivacy = _WEP104_; -+ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { -+ RTW_INFO("%s, set pairwise key, TKIP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _TKIP_; -+ -+ /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ -+ /* set mic key */ -+ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = _TRUE; -+ -+ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { -+ -+ RTW_INFO("%s, set pairwise key, CCMP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _AES_; -+ } else { -+ RTW_INFO("%s, set pairwise key, none\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _NO_PRIVACY_; -+ } -+ -+ rtw_ap_set_pairwise_key(padapter, psta); -+ -+ psta->ieee8021x_blocked = _FALSE; -+ -+ psta->bpairwise_key_installed = _TRUE; -+ -+ } else { /* group key??? */ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) { -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ -+ /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ -+ /* set mic key */ -+ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = _TRUE; -+ -+ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ } else -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = _TRUE; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta) { -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ -+ } -+ -+ } -+ -+ } -+ -+ } -+ -+exit: -+ -+ return ret; -+ -+} -+#endif -+ -+static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len, wep_total_len; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif /* CONFIG_P2P */ -+ -+ -+ RTW_INFO("%s\n", __func__); -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ if (param_len < (u32)((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) { -+ if (param->u.crypt.idx >= WEP_KEYS -+#ifdef CONFIG_IEEE80211W -+ && param->u.crypt.idx > BIP_MAX_KEYID -+#endif /* CONFIG_IEEE80211W */ -+ ) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } else { -+#ifdef CONFIG_WAPI_SUPPORT -+ if (strcmp(param->u.crypt.alg, "SMS4")) -+#endif -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) { -+ RTW_INFO("wpa_set_encryption, crypt.alg = WEP\n"); -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ if ((wep_key_idx > WEP_KEYS) || (wep_key_len <= 0)) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) { -+ /* wep default key has not been set, so use this key index as default key. */ -+ -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ -+ if (wep_key_len == 13) { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ } -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; -+ -+ rtw_set_key(padapter, psecuritypriv, wep_key_idx, 0, _TRUE); -+ -+ goto exit; -+ } -+ -+ if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { /* 802_1x */ -+ struct sta_info *psta, *pbcmc_sta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ /* RTW_INFO("%s, : dot11AuthAlgrthm == dot11AuthAlgrthm_8021X\n", __func__); */ -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == _TRUE) { /* sta mode */ -+#ifdef CONFIG_RTW_80211R -+ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) -+ psta = rtw_get_stainfo(pstapriv, pmlmepriv->assoc_bssid); -+ else -+#endif -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ /* DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail\n")); */ -+ RTW_INFO("%s, : Obtain Sta_info fail\n", __func__); -+ } else { -+ /* Jeff: don't disable ieee8021x_blocked while clearing key */ -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ psta->ieee8021x_blocked = _FALSE; -+ -+ -+ if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled) || -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ -+ if (param->u.crypt.set_tx == 1) { /* pairwise key */ -+ -+ RTW_INFO("%s, : param->u.crypt.set_tx ==1\n", __func__); -+ -+ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ -+ if (strcmp(param->u.crypt.alg, "TKIP") == 0) { /* set mic key */ -+ /* DEBUG_ERR(("\nset key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ -+ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ padapter->securitypriv.busetkipkey = _FALSE; -+ /* _set_timer(&padapter->securitypriv.tkip_timer, 50); */ -+ } -+ psta->bpairwise_key_installed = _TRUE; -+#ifdef CONFIG_RTW_80211R -+ psta->ft_pairwise_key_installed = _TRUE; -+#endif -+ /* DEBUG_ERR((" param->u.crypt.key_len=%d\n",param->u.crypt.key_len)); */ -+ RTW_INFO(" ~~~~set sta key:unicastkey\n"); -+ -+ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _TRUE); -+ } else { /* group key */ -+ if (strcmp(param->u.crypt.alg, "TKIP") == 0 || strcmp(param->u.crypt.alg, "CCMP") == 0) { -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, -+ (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ padapter->securitypriv.binstallGrpkey = _TRUE; -+ if (param->u.crypt.idx < 4) -+ _rtw_memcpy(padapter->securitypriv.iv_seq[param->u.crypt.idx], param->u.crypt.seq, 8); -+ -+ /* DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ -+ RTW_INFO(" ~~~~set sta key:groupkey\n"); -+ -+ padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; -+ rtw_set_key(padapter, &padapter->securitypriv, param->u.crypt.idx, 1, _TRUE); -+ } -+#ifdef CONFIG_IEEE80211W -+ else if (strcmp(param->u.crypt.alg, "BIP") == 0) { -+ int no; -+ /* RTW_INFO("BIP key_len=%d , index=%d @@@@@@@@@@@@@@@@@@\n", param->u.crypt.key_len, param->u.crypt.idx); */ -+ /* save the IGTK key, length 16 bytes */ -+ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, -+ (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ /*RTW_INFO("IGTK key below:\n"); -+ for(no=0;no<16;no++) -+ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); -+ RTW_INFO("\n");*/ -+ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; -+ padapter->securitypriv.binstallBIPkey = _TRUE; -+ RTW_INFO(" ~~~~set sta key:IGKT\n"); -+ } -+#endif /* CONFIG_IEEE80211W */ -+ -+#ifdef CONFIG_P2P -+ if (pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_DONE); -+ } -+#endif /* CONFIG_P2P */ -+ -+ } -+ } -+ -+ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta == NULL) { -+ /* DEBUG_ERR( ("Set OID_802_11_ADD_KEY: bcmc stainfo is null\n")); */ -+ } else { -+ /* Jeff: don't disable ieee8021x_blocked while clearing key */ -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ -+ if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled) || -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { /* adhoc mode */ -+ } -+ } -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (strcmp(param->u.crypt.alg, "SMS4") == 0) { -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_STA_INFO pWapiSta; -+ u8 WapiASUEPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ -+ if (param->u.crypt.set_tx == 1) { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (_rtw_memcmp(pWapiSta->PeerMacAddr, param->sta_addr, 6)) { -+ _rtw_memcpy(pWapiSta->lastTxUnicastPN, WapiASUEPNInitialValueSrc, 16); -+ -+ pWapiSta->wapiUsk.bSet = true; -+ _rtw_memcpy(pWapiSta->wapiUsk.dataKey, param->u.crypt.key, 16); -+ _rtw_memcpy(pWapiSta->wapiUsk.micKey, param->u.crypt.key + 16, 16); -+ pWapiSta->wapiUsk.keyId = param->u.crypt.idx ; -+ pWapiSta->wapiUsk.bTxEnable = true; -+ -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiAEPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiAEPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiAEPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiAEPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPN, WapiAEPNInitialValueSrc, 16); -+ pWapiSta->wapiUskUpdate.bTxEnable = false; -+ pWapiSta->wapiUskUpdate.bSet = false; -+ -+ if (psecuritypriv->sw_encrypt == false || psecuritypriv->sw_decrypt == false) { -+ /* set unicast key for ASUE */ -+ rtw_wapi_set_key(padapter, &pWapiSta->wapiUsk, pWapiSta, false, false); -+ } -+ } -+ } -+ } else { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (_rtw_memcmp(pWapiSta->PeerMacAddr, get_bssid(pmlmepriv), 6)) { -+ pWapiSta->wapiMsk.bSet = true; -+ _rtw_memcpy(pWapiSta->wapiMsk.dataKey, param->u.crypt.key, 16); -+ _rtw_memcpy(pWapiSta->wapiMsk.micKey, param->u.crypt.key + 16, 16); -+ pWapiSta->wapiMsk.keyId = param->u.crypt.idx ; -+ pWapiSta->wapiMsk.bTxEnable = false; -+ if (!pWapiSta->bSetkeyOk) -+ pWapiSta->bSetkeyOk = true; -+ pWapiSta->bAuthenticateInProgress = false; -+ -+ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); -+ -+ if (psecuritypriv->sw_decrypt == false) { -+ /* set rx broadcast key for ASUE */ -+ rtw_wapi_set_key(padapter, &pWapiSta->wapiMsk, pWapiSta, true, false); -+ } -+ } -+ -+ } -+ } -+ } -+#endif -+ -+ -+exit: -+ -+ RTW_INFO("%s, ret=%d\n", __func__, ret); -+ -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_add_key(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ u8 key_index, bool pairwise, const u8 *mac_addr, -+#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ -+ u8 key_index, const u8 *mac_addr, -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ -+ struct key_params *params) -+{ -+ char *alg_name; -+ u32 param_len; -+ struct ieee_param *param = NULL; -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct wireless_dev *rtw_wdev = padapter->rtw_wdev; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_TDLS -+ struct sta_info *ptdls_sta; -+#endif /* CONFIG_TDLS */ -+ -+ RTW_INFO(FUNC_NDEV_FMT" adding key for %pM\n", FUNC_NDEV_ARG(ndev), mac_addr); -+ RTW_INFO("cipher=0x%x\n", params->cipher); -+ RTW_INFO("key_len=0x%x\n", params->key_len); -+ RTW_INFO("seq_len=0x%x\n", params->seq_len); -+ RTW_INFO("key_index=%d\n", key_index); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ RTW_INFO("pairwise=%d\n", pairwise); -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ -+ -+ param_len = sizeof(struct ieee_param) + params->key_len; -+ param = (struct ieee_param *)rtw_malloc(param_len); -+ if (param == NULL) -+ return -1; -+ -+ _rtw_memset(param, 0, param_len); -+ -+ param->cmd = IEEE_CMD_SET_ENCRYPTION; -+ _rtw_memset(param->sta_addr, 0xff, ETH_ALEN); -+ -+ switch (params->cipher) { -+ case IW_AUTH_CIPHER_NONE: -+ /* todo: remove key */ -+ /* remove = 1; */ -+ alg_name = "none"; -+ break; -+ case WLAN_CIPHER_SUITE_WEP40: -+ case WLAN_CIPHER_SUITE_WEP104: -+ alg_name = "WEP"; -+ break; -+ case WLAN_CIPHER_SUITE_TKIP: -+ alg_name = "TKIP"; -+ break; -+ case WLAN_CIPHER_SUITE_CCMP: -+ alg_name = "CCMP"; -+ break; -+#ifdef CONFIG_IEEE80211W -+ case WLAN_CIPHER_SUITE_AES_CMAC: -+ alg_name = "BIP"; -+ break; -+#endif /* CONFIG_IEEE80211W */ -+#ifdef CONFIG_WAPI_SUPPORT -+ case WLAN_CIPHER_SUITE_SMS4: -+ alg_name = "SMS4"; -+ if (pairwise == NL80211_KEYTYPE_PAIRWISE) { -+ if (key_index != 0 && key_index != 1) { -+ ret = -ENOTSUPP; -+ goto addkey_end; -+ } -+ _rtw_memcpy((void *)param->sta_addr, (void *)mac_addr, ETH_ALEN); -+ } else -+ RTW_INFO("mac_addr is null\n"); -+ RTW_INFO("rtw_wx_set_enc_ext: SMS4 case\n"); -+ break; -+#endif -+ -+ default: -+ ret = -ENOTSUPP; -+ goto addkey_end; -+ } -+ -+ strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN); -+ -+ -+ if (!mac_addr || is_broadcast_ether_addr(mac_addr)) { -+ param->u.crypt.set_tx = 0; /* for wpa/wpa2 group key */ -+ } else { -+ param->u.crypt.set_tx = 1; /* for wpa/wpa2 pairwise key */ -+ } -+ -+ -+ /* param->u.crypt.idx = key_index - 1; */ -+ param->u.crypt.idx = key_index; -+ -+ if (params->seq_len && params->seq) -+ _rtw_memcpy(param->u.crypt.seq, (u8 *)params->seq, params->seq_len); -+ -+ if (params->key_len && params->key) { -+ param->u.crypt.key_len = params->key_len; -+ _rtw_memcpy(param->u.crypt.key, (u8 *)params->key, params->key_len); -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { -+#ifdef CONFIG_TDLS -+ if (rtw_tdls_is_driver_setup(padapter) == _FALSE && mac_addr) { -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, (void *)mac_addr); -+ if (ptdls_sta != NULL && ptdls_sta->tdls_sta_state) { -+ _rtw_memcpy(ptdls_sta->tpk.tk, params->key, params->key_len); -+ rtw_tdls_set_key(padapter, ptdls_sta); -+ goto addkey_end; -+ } -+ } -+#endif /* CONFIG_TDLS */ -+ -+ ret = rtw_cfg80211_set_encryption(ndev, param, param_len); -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+#ifdef CONFIG_AP_MODE -+ if (mac_addr) -+ _rtw_memcpy(param->sta_addr, (void *)mac_addr, ETH_ALEN); -+ -+ ret = rtw_cfg80211_ap_set_encryption(ndev, param, param_len); -+#endif -+ } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE -+ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE -+ ) { -+ /* RTW_INFO("@@@@@@@@@@ fw_state=0x%x, iftype=%d\n", pmlmepriv->fw_state, rtw_wdev->iftype); */ -+ ret = rtw_cfg80211_set_encryption(ndev, param, param_len); -+ } else -+ RTW_INFO("error! fw_state=0x%x, iftype=%d\n", pmlmepriv->fw_state, rtw_wdev->iftype); -+ -+ -+addkey_end: -+ if (param) -+ rtw_mfree((u8 *)param, param_len); -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_get_key(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ u8 key_index, bool pairwise, const u8 *mac_addr, -+#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ -+ u8 key_index, const u8 *mac_addr, -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ -+ void *cookie, -+ void (*callback)(void *cookie, struct key_params *)) -+{ -+#if 0 -+ struct iwm_priv *iwm = ndev_to_iwm(ndev); -+ struct iwm_key *key = &iwm->keys[key_index]; -+ struct key_params params; -+ -+ IWM_DBG_WEXT(iwm, DBG, "Getting key %d\n", key_index); -+ -+ memset(¶ms, 0, sizeof(params)); -+ -+ params.cipher = key->cipher; -+ params.key_len = key->key_len; -+ params.seq_len = key->seq_len; -+ params.seq = key->seq; -+ params.key = key->key; -+ -+ callback(cookie, ¶ms); -+ -+ return key->key_len ? 0 : -ENOENT; -+#endif -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+static int cfg80211_rtw_del_key(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ u8 key_index, bool pairwise, const u8 *mac_addr) -+#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ -+ u8 key_index, const u8 *mac_addr) -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ RTW_INFO(FUNC_NDEV_FMT" key_index=%d\n", FUNC_NDEV_ARG(ndev), key_index); -+ -+ if (key_index == psecuritypriv->dot11PrivacyKeyIndex) { -+ /* clear the flag of wep default key set. */ -+ psecuritypriv->bWepDefaultKeyIdxSet = 0; -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_set_default_key(struct wiphy *wiphy, -+ struct net_device *ndev, u8 key_index -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) -+ , bool unicast, bool multicast -+ #endif -+) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+#define SET_DEF_KEY_PARAM_FMT " key_index=%d" -+#define SET_DEF_KEY_PARAM_ARG , key_index -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) -+ #define SET_DEF_KEY_PARAM_FMT_2_6_38 ", unicast=%d, multicast=%d" -+ #define SET_DEF_KEY_PARAM_ARG_2_6_38 , unicast, multicast -+#else -+ #define SET_DEF_KEY_PARAM_FMT_2_6_38 "" -+ #define SET_DEF_KEY_PARAM_ARG_2_6_38 -+#endif -+ -+ RTW_INFO(FUNC_NDEV_FMT -+ SET_DEF_KEY_PARAM_FMT -+ SET_DEF_KEY_PARAM_FMT_2_6_38 -+ "\n", FUNC_NDEV_ARG(ndev) -+ SET_DEF_KEY_PARAM_ARG -+ SET_DEF_KEY_PARAM_ARG_2_6_38 -+ ); -+ -+ if ((key_index < WEP_KEYS) && ((psecuritypriv->dot11PrivacyAlgrthm == _WEP40_) || (psecuritypriv->dot11PrivacyAlgrthm == _WEP104_))) { /* set wep default key */ -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+ psecuritypriv->dot11PrivacyKeyIndex = key_index; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if (psecuritypriv->dot11DefKeylen[key_index] == 13) { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ psecuritypriv->bWepDefaultKeyIdxSet = 1; /* set the flag to represent that wep default key has been set */ -+ } -+ -+ return 0; -+ -+} -+#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 1, 0)) -+static int cfg80211_rtw_set_rekey_data(struct wiphy *wiphy, -+ struct net_device *ndev, -+ struct cfg80211_gtk_rekey_data *data) -+{ -+ /*int i;*/ -+ struct sta_info *psta; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ RTW_INFO("%s, : Obtain Sta_info fail\n", __func__); -+ return -1; -+ } -+ -+ _rtw_memcpy(psta->kek, data->kek, NL80211_KEK_LEN); -+ /*printk("\ncfg80211_rtw_set_rekey_data KEK:"); -+ for(i=0;ikek[i]);*/ -+ _rtw_memcpy(psta->kck, data->kck, NL80211_KCK_LEN); -+ /*printk("\ncfg80211_rtw_set_rekey_data KCK:"); -+ for(i=0;ikck[i]);*/ -+ _rtw_memcpy(psta->replay_ctr, data->replay_ctr, NL80211_REPLAY_CTR_LEN); -+ psecuritypriv->binstallKCK_KEK = _TRUE; -+ /*printk("\nREPLAY_CTR: "); -+ for(i=0;ireplay_ctr[i]);*/ -+ -+ return 0; -+} -+#endif /*CONFIG_GTK_OL*/ -+static int cfg80211_rtw_get_station(struct wiphy *wiphy, -+ struct net_device *ndev, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0)) -+ u8 *mac, -+#else -+ const u8 *mac, -+#endif -+ struct station_info *sinfo) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ sinfo->filled = 0; -+ -+ if (!mac) { -+ RTW_INFO(FUNC_NDEV_FMT" mac==%p\n", FUNC_NDEV_ARG(ndev), mac); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, (u8 *)mac); -+ if (psta == NULL) { -+ RTW_INFO("%s, sta_info is null\n", __func__); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO(FUNC_NDEV_FMT" mac="MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(mac)); -+#endif -+ -+ /* for infra./P2PClient mode */ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED) -+ ) { -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ -+ if (_rtw_memcmp((u8 *)mac, cur_network->network.MacAddress, ETH_ALEN) == _FALSE) { -+ RTW_INFO("%s, mismatch bssid="MAC_FMT"\n", __func__, MAC_ARG(cur_network->network.MacAddress)); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ sinfo->filled |= STATION_INFO_SIGNAL; -+ sinfo->signal = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); -+ -+ sinfo->filled |= STATION_INFO_TX_BITRATE; -+ sinfo->txrate.legacy = rtw_get_cur_max_rate(padapter); -+ -+ sinfo->filled |= STATION_INFO_RX_PACKETS; -+ sinfo->rx_packets = sta_rx_data_pkts(psta); -+ -+ sinfo->filled |= STATION_INFO_TX_PACKETS; -+ sinfo->tx_packets = psta->sta_stats.tx_pkts; -+ -+ } -+ -+ /* for Ad-Hoc/AP mode */ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) -+ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) -+ || check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ && check_fwstate(pmlmepriv, _FW_LINKED) -+ ) { -+ /* TODO: should acquire station info... */ -+ } -+ -+exit: -+ return ret; -+} -+ -+extern int netdev_open(struct net_device *pnetdev); -+ -+#if 0 -+enum nl80211_iftype { -+ NL80211_IFTYPE_UNSPECIFIED, -+ NL80211_IFTYPE_ADHOC, /* 1 */ -+ NL80211_IFTYPE_STATION, /* 2 */ -+ NL80211_IFTYPE_AP, /* 3 */ -+ NL80211_IFTYPE_AP_VLAN, -+ NL80211_IFTYPE_WDS, -+ NL80211_IFTYPE_MONITOR, /* 6 */ -+ NL80211_IFTYPE_MESH_POINT, -+ NL80211_IFTYPE_P2P_CLIENT, /* 8 */ -+ NL80211_IFTYPE_P2P_GO, /* 9 */ -+ /* keep last */ -+ NUM_NL80211_IFTYPES, -+ NL80211_IFTYPE_MAX = NUM_NL80211_IFTYPES - 1 -+}; -+#endif -+static int cfg80211_rtw_change_iface(struct wiphy *wiphy, -+ struct net_device *ndev, -+ enum nl80211_iftype type, -+ struct vif_params *params) -+{ -+ enum nl80211_iftype old_type; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct wireless_dev *rtw_wdev = padapter->rtw_wdev; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 is_p2p = _FALSE; -+#endif -+ int ret = 0; -+ u8 change = _FALSE; -+ -+ RTW_INFO(FUNC_NDEV_FMT" type=%d\n", FUNC_NDEV_ARG(ndev), type); -+ -+ if (adapter_to_dvobj(padapter)->processing_dev_remove == _TRUE) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ -+ RTW_INFO(FUNC_NDEV_FMT" call netdev_open\n", FUNC_NDEV_ARG(ndev)); -+ if (netdev_open(ndev) != 0) { -+ RTW_INFO(FUNC_NDEV_FMT" call netdev_open fail\n", FUNC_NDEV_ARG(ndev)); -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ RTW_INFO(FUNC_NDEV_FMT" call rtw_pwr_wakeup fail\n", FUNC_NDEV_ARG(ndev)); -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ old_type = rtw_wdev->iftype; -+ RTW_INFO(FUNC_NDEV_FMT" old_iftype=%d, new_iftype=%d\n", -+ FUNC_NDEV_ARG(ndev), old_type, type); -+ -+ if (old_type != type) { -+ change = _TRUE; -+ pmlmeext->action_public_rxseq = 0xffff; -+ pmlmeext->action_public_dialog_token = 0xff; -+ } -+ -+ /* initial default type */ -+ ndev->type = ARPHRD_ETHER; -+ -+ switch (type) { -+ case NL80211_IFTYPE_ADHOC: -+ networkType = Ndis802_11IBSS; -+ break; -+ -+ #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) -+ case NL80211_IFTYPE_P2P_CLIENT: -+ is_p2p = _TRUE; -+ #endif -+ case NL80211_IFTYPE_STATION: -+ networkType = Ndis802_11Infrastructure; -+ -+ #ifdef CONFIG_P2P -+ if (change && pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (is_p2p == _TRUE) -+ rtw_p2p_enable(padapter, P2P_ROLE_CLIENT); -+ #if !RTW_P2P_GROUP_INTERFACE -+ else if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) -+ || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) -+ ) { -+ /* it means remove GC/GO and change mode from GC/GO to station(P2P DEVICE) */ -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ } -+ #endif -+ } -+ #endif /* CONFIG_P2P */ -+ -+ break; -+ -+ #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) -+ case NL80211_IFTYPE_P2P_GO: -+ is_p2p = _TRUE; -+ #endif -+ case NL80211_IFTYPE_AP: -+ networkType = Ndis802_11APMode; -+ -+ #ifdef CONFIG_P2P -+ if (change && pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (is_p2p == _TRUE) -+ rtw_p2p_enable(padapter, P2P_ROLE_GO); -+ #if !RTW_P2P_GROUP_INTERFACE -+ else if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ /* it means P2P Group created, we will be GO and change mode from P2P DEVICE to AP(GO) */ -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } -+ #endif -+ } -+ #endif /* CONFIG_P2P */ -+ -+ break; -+ -+ case NL80211_IFTYPE_MONITOR: -+ networkType = Ndis802_11Monitor; -+#if 0 -+ ndev->type = ARPHRD_IEEE80211; /* IEEE 802.11 : 801 */ -+#endif -+ ndev->type = ARPHRD_IEEE80211_RADIOTAP; /* IEEE 802.11 + radiotap header : 803 */ -+ break; -+ default: -+ ret = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+ rtw_wdev->iftype = type; -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, networkType) == _FALSE) { -+ rtw_wdev->iftype = old_type; -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ rtw_setopmode_cmd(padapter, networkType, _TRUE); -+ -+exit: -+ -+ RTW_INFO(FUNC_NDEV_FMT" ret:%d\n", FUNC_NDEV_ARG(ndev), ret); -+ return ret; -+} -+ -+void rtw_cfg80211_indicate_scan_done(_adapter *adapter, bool aborted) -+{ -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+ _irqL irqL; -+ -+#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) -+ struct cfg80211_scan_info info; -+ -+ memset(&info, 0, sizeof(info)); -+ info.aborted = aborted; -+#endif -+ -+ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ if (pwdev_priv->scan_request != NULL) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s with scan req\n", __FUNCTION__); -+ #endif -+ -+ /* avoid WARN_ON(request != wiphy_to_dev(request->wiphy)->scan_req); */ -+ if (pwdev_priv->scan_request->wiphy != pwdev_priv->rtw_wdev->wiphy) -+ RTW_INFO("error wiphy compare\n"); -+ else -+#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) -+ cfg80211_scan_done(pwdev_priv->scan_request, &info); -+#else -+ cfg80211_scan_done(pwdev_priv->scan_request, aborted); -+#endif -+ -+ pwdev_priv->scan_request = NULL; -+ } else { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s without scan req\n", __FUNCTION__); -+ #endif -+ } -+ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+} -+ -+u32 rtw_cfg80211_wait_scan_req_empty(_adapter *adapter, u32 timeout_ms) -+{ -+ struct rtw_wdev_priv *wdev_priv = adapter_wdev_data(adapter); -+ u8 empty = _FALSE; -+ u32 start; -+ u32 pass_ms; -+ -+ start = rtw_get_current_time(); -+ -+ while (rtw_get_passing_time_ms(start) <= timeout_ms) { -+ -+ if (RTW_CANNOT_RUN(adapter)) -+ break; -+ -+ if (!wdev_priv->scan_request) { -+ empty = _TRUE; -+ break; -+ } -+ -+ rtw_msleep_os(10); -+ } -+ -+ pass_ms = rtw_get_passing_time_ms(start); -+ -+ if (empty == _FALSE && pass_ms > timeout_ms) -+ RTW_PRINT(FUNC_ADPT_FMT" pass_ms:%u, timeout\n" -+ , FUNC_ADPT_ARG(adapter), pass_ms); -+ -+ return pass_ms; -+} -+ -+void rtw_cfg80211_unlink_bss(_adapter *padapter, struct wlan_network *pnetwork) -+{ -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct wiphy *wiphy = pwdev->wiphy; -+ struct cfg80211_bss *bss = NULL; -+ WLAN_BSSID_EX select_network = pnetwork->network; -+ -+ bss = cfg80211_get_bss(wiphy, NULL/*notify_channel*/, -+ select_network.MacAddress, select_network.Ssid.Ssid, -+ select_network.Ssid.SsidLength, -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0) -+ select_network.InfrastructureMode == Ndis802_11Infrastructure?IEEE80211_BSS_TYPE_ESS:IEEE80211_BSS_TYPE_IBSS, -+ IEEE80211_PRIVACY(select_network.Privacy)); -+#else -+ select_network.InfrastructureMode == Ndis802_11Infrastructure?WLAN_CAPABILITY_ESS:WLAN_CAPABILITY_IBSS, -+ select_network.InfrastructureMode == Ndis802_11Infrastructure?WLAN_CAPABILITY_ESS:WLAN_CAPABILITY_IBSS); -+#endif -+ -+ if (bss) { -+ cfg80211_unlink_bss(wiphy, bss); -+ RTW_INFO("%s(): cfg80211_unlink %s!!\n", __func__, select_network.Ssid.Ssid); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0) -+ cfg80211_put_bss(padapter->rtw_wdev->wiphy, bss); -+#else -+ cfg80211_put_bss(bss); -+#endif -+ } -+ return; -+} -+ -+/* if target wps scan ongoing, target_ssid is filled */ -+int rtw_cfg80211_is_target_wps_scan(struct cfg80211_scan_request *scan_req, struct cfg80211_ssid *target_ssid) -+{ -+ int ret = 0; -+ -+ if (scan_req->n_ssids != 1 -+ || scan_req->ssids[0].ssid_len == 0 -+ || scan_req->n_channels != 1 -+ ) -+ goto exit; -+ -+ /* under target WPS scan */ -+ _rtw_memcpy(target_ssid, scan_req->ssids, sizeof(struct cfg80211_ssid)); -+ ret = 1; -+ -+exit: -+ return ret; -+} -+ -+static void _rtw_cfg80211_surveydone_event_callback(_adapter *padapter, struct cfg80211_scan_request *scan_req) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u32 cnt = 0; -+ u32 wait_for_surveydone; -+ sint wait_status; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ struct cfg80211_ssid target_ssid; -+ u8 target_wps_scan = 0; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s\n", __func__); -+#endif -+ -+ if (scan_req) -+ target_wps_scan = rtw_cfg80211_is_target_wps_scan(scan_req, &target_ssid); -+ else { -+ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ if (pwdev_priv->scan_request != NULL) -+ target_wps_scan = rtw_cfg80211_is_target_wps_scan(pwdev_priv->scan_request, &target_ssid); -+ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ } -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ /* report network only if the current channel set contains the channel to which this network belongs */ -+ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 -+ && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE -+ && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) -+ ) { -+ if (target_wps_scan) -+ rtw_cfg80211_clear_wps_sr_of_non_target_bss(padapter, pnetwork, &target_ssid); -+ rtw_cfg80211_inform_bss(padapter, pnetwork); -+ } -+#if 0 -+ /* check ralink testbed RSN IE length */ -+ { -+ if (_rtw_memcmp(pnetwork->network.Ssid.Ssid, "Ralink_11n_AP", 13)) { -+ uint ie_len = 0; -+ u8 *p = NULL; -+ p = rtw_get_ie(pnetwork->network.IEs + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pnetwork->network.IELength - _BEACON_IE_OFFSET_)); -+ RTW_INFO("ie_len=%d\n", ie_len); -+ } -+ } -+#endif -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+} -+ -+inline void rtw_cfg80211_surveydone_event_callback(_adapter *padapter) -+{ -+ _rtw_cfg80211_surveydone_event_callback(padapter, NULL); -+} -+ -+static int rtw_cfg80211_set_probe_req_wpsp2pie(_adapter *padapter, char *buf, int len) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u8 *wps_ie; -+ u32 p2p_ielen = 0; -+ u8 *p2p_ie; -+ u32 wfd_ielen = 0; -+ u8 *wfd_ie; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s, ielen=%d\n", __func__, len); -+#endif -+ -+ if (len > 0) { -+ wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen); -+ if (wps_ie) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("probe_req_wps_ielen=%d\n", wps_ielen); -+ #endif -+ -+ if (pmlmepriv->wps_probe_req_ie) { -+ u32 free_len = pmlmepriv->wps_probe_req_ie_len; -+ pmlmepriv->wps_probe_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); -+ pmlmepriv->wps_probe_req_ie = NULL; -+ } -+ -+ pmlmepriv->wps_probe_req_ie = rtw_malloc(wps_ielen); -+ if (pmlmepriv->wps_probe_req_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->wps_probe_req_ie, wps_ie, wps_ielen); -+ pmlmepriv->wps_probe_req_ie_len = wps_ielen; -+ } -+ -+ /* buf += wps_ielen; */ -+ /* len -= wps_ielen; */ -+ -+ #ifdef CONFIG_P2P -+ p2p_ie = rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen); -+ if (p2p_ie) { -+ struct wifidirect_info *wdinfo = &padapter->wdinfo; -+ u32 attr_contentlen = 0; -+ u8 listen_ch_attr[5]; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("probe_req_p2p_ielen=%d\n", p2p_ielen); -+ #endif -+ -+ if (pmlmepriv->p2p_probe_req_ie) { -+ u32 free_len = pmlmepriv->p2p_probe_req_ie_len; -+ pmlmepriv->p2p_probe_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_probe_req_ie, free_len); -+ pmlmepriv->p2p_probe_req_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_probe_req_ie = rtw_malloc(p2p_ielen); -+ if (pmlmepriv->p2p_probe_req_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->p2p_probe_req_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_probe_req_ie_len = p2p_ielen; -+ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_LISTEN_CH, (u8 *)listen_ch_attr, (uint *) &attr_contentlen) -+ && attr_contentlen == 5) { -+ if (wdinfo->listen_channel != listen_ch_attr[4]) { -+ RTW_INFO(FUNC_ADPT_FMT" listen channel - country:%c%c%c, class:%u, ch:%u\n", -+ FUNC_ADPT_ARG(padapter), listen_ch_attr[0], listen_ch_attr[1], listen_ch_attr[2], -+ listen_ch_attr[3], listen_ch_attr[4]); -+ wdinfo->listen_channel = listen_ch_attr[4]; -+ } -+ } -+ } -+ #endif /* CONFIG_P2P */ -+ -+ #ifdef CONFIG_WFD -+ wfd_ie = rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen); -+ if (wfd_ie) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("probe_req_wfd_ielen=%d\n", wfd_ielen); -+ #endif -+ -+ if (rtw_mlme_update_wfd_ie_data(pmlmepriv, MLME_PROBE_REQ_IE, wfd_ie, wfd_ielen) != _SUCCESS) -+ return -EINVAL; -+ } -+ #endif /* CONFIG_WFD */ -+ } -+ -+ return ret; -+ -+} -+ -+#ifdef CONFIG_CONCURRENT_MODE -+u8 rtw_cfg80211_scan_via_buddy(_adapter *padapter, struct cfg80211_scan_request *request) -+{ -+ int i; -+ u8 ret = _FALSE; -+ _adapter *iface = NULL; -+ _irqL irqL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ struct mlme_priv *buddy_mlmepriv; -+ struct rtw_wdev_priv *buddy_wdev_priv; -+ -+ iface = dvobj->padapters[i]; -+ if (iface == NULL) -+ continue; -+ -+ if (iface == padapter) -+ continue; -+ -+ if (rtw_is_adapter_up(iface) == _FALSE) -+ continue; -+ -+ buddy_mlmepriv = &iface->mlmepriv; -+ if (!check_fwstate(buddy_mlmepriv, _FW_UNDER_SURVEY)) -+ continue; -+ -+ buddy_wdev_priv = adapter_wdev_data(iface); -+ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ _enter_critical_bh(&buddy_wdev_priv->scan_req_lock, &irqL); -+ if (buddy_wdev_priv->scan_request) { -+ pmlmepriv->scanning_via_buddy_intf = _TRUE; -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ set_fwstate(pmlmepriv, _FW_UNDER_SURVEY); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ pwdev_priv->scan_request = request; -+ ret = _TRUE; -+ } -+ _exit_critical_bh(&buddy_wdev_priv->scan_req_lock, &irqL); -+ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ -+ if (ret == _TRUE) -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+void rtw_cfg80211_indicate_scan_done_for_buddy(_adapter *padapter, bool bscan_aborted) -+{ -+ int i; -+ u8 ret = 0; -+ _adapter *iface = NULL; -+ _irqL irqL; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct mlme_priv *mlmepriv; -+ struct rtw_wdev_priv *wdev_priv; -+ bool indicate_buddy_scan; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ -+ if (iface == padapter) -+ continue; -+ -+ mlmepriv = &(iface->mlmepriv); -+ wdev_priv = adapter_wdev_data(iface); -+ -+ indicate_buddy_scan = _FALSE; -+ _enter_critical_bh(&wdev_priv->scan_req_lock, &irqL); -+ if (wdev_priv->scan_request && mlmepriv->scanning_via_buddy_intf == _TRUE) { -+ mlmepriv->scanning_via_buddy_intf = _FALSE; -+ clr_fwstate(mlmepriv, _FW_UNDER_SURVEY); -+ indicate_buddy_scan = _TRUE; -+ } -+ _exit_critical_bh(&wdev_priv->scan_req_lock, &irqL); -+ -+ if (indicate_buddy_scan == _TRUE) { -+ rtw_cfg80211_surveydone_event_callback(iface); -+ rtw_indicate_scan_done(iface, bscan_aborted); -+ } -+ -+ } -+ } -+} -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+static int cfg80211_rtw_scan(struct wiphy *wiphy -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) -+ , struct net_device *ndev -+ #endif -+ , struct cfg80211_scan_request *request) -+{ -+ int i, chan_num = 0; -+ u8 _status = _FALSE; -+ int ret = 0; -+ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; -+ struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; -+ struct rtw_ieee80211_channel *pch; -+ _irqL irqL; -+ u8 *wps_ie = NULL; -+ uint wps_ielen = 0; -+ u8 *p2p_ie = NULL; -+ uint p2p_ielen = 0; -+ u8 survey_times = 3; -+ u8 survey_times_for_one_ch = 6; -+ struct cfg80211_ssid *ssids = request->ssids; -+ int social_channel = 0, j = 0; -+ bool need_indicate_scan_done = _FALSE; -+ bool ps_denied = _FALSE; -+ -+ _adapter *padapter; -+ struct wireless_dev *wdev; -+ struct rtw_wdev_priv *pwdev_priv; -+ struct mlme_priv *pmlmepriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo; -+#endif /* CONFIG_P2P */ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ wdev = request->wdev; -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ if (wdev == wiphy_to_pd_wdev(wiphy)) -+ padapter = wiphy_to_adapter(wiphy); -+ else -+ #endif -+ if (wdev_to_ndev(wdev)) -+ padapter = (_adapter *)rtw_netdev_priv(wdev_to_ndev(wdev)); -+ else { -+ ret = -EINVAL; -+ goto exit; -+ } -+#else -+ if (ndev == NULL) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ padapter = (_adapter *)rtw_netdev_priv(ndev); -+ wdev = ndev_to_wdev(ndev); -+#endif -+ -+ pwdev_priv = adapter_wdev_data(padapter); -+ pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_P2P -+ pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P */ -+ -+ RTW_INFO(FUNC_ADPT_FMT"%s\n", FUNC_ADPT_ARG(padapter) -+ , wdev == wiphy_to_pd_wdev(wiphy) ? " PD" : ""); -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_mi_mp_mode_check(padapter)) { -+ RTW_INFO("MP mode block Scan request\n"); -+ ret = -EPERM; -+ goto exit; -+ } -+#endif -+ -+ if (adapter_wdev_data(padapter)->block_scan == _TRUE) { -+ RTW_INFO(FUNC_ADPT_FMT" wdev_priv.block_scan is set\n", FUNC_ADPT_ARG(padapter)); -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+ -+ rtw_ps_deny(padapter, PS_DENY_SCAN); -+ ps_denied = _TRUE; -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+ -+#ifdef CONFIG_P2P -+ if (pwdinfo->driver_interface == DRIVER_CFG80211) { -+ if (ssids->ssid != NULL -+ && _rtw_memcmp(ssids->ssid, "DIRECT-", 7) -+ && rtw_get_p2p_ie((u8 *)request->ie, request->ie_len, NULL, NULL) -+ ) { -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); -+ else { -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); -+ #endif -+ } -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+ -+ if (request->n_channels == 3 && -+ request->channels[0]->hw_value == 1 && -+ request->channels[1]->hw_value == 6 && -+ request->channels[2]->hw_value == 11 -+ ) -+ social_channel = 1; -+ } -+ } -+#endif /*CONFIG_P2P*/ -+ -+ if (request->ie && request->ie_len > 0) -+ rtw_cfg80211_set_probe_req_wpsp2pie(padapter, (u8 *)request->ie, request->ie_len); -+ -+ if (rtw_is_scan_deny(padapter)) { -+ RTW_INFO(FUNC_ADPT_FMT ": scan deny\n", FUNC_ADPT_ARG(padapter)); -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+ -+ /* check fw state*/ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO(FUNC_ADPT_FMT" under WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter)); -+#endif -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS | _FW_UNDER_SURVEY | _FW_UNDER_LINKING) == _TRUE) { -+ RTW_INFO("%s, fwstate=0x%x\n", __func__, pmlmepriv->fw_state); -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) -+ RTW_INFO("AP mode process WPS\n"); -+ -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { -+ RTW_INFO("%s, fwstate=0x%x\n", __func__, pmlmepriv->fw_state); -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { -+ RTW_INFO("%s, fwstate=0x%x\n", __func__, pmlmepriv->fw_state); -+ ret = -EBUSY; -+ goto check_need_indicate_scan_done; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING | WIFI_UNDER_WPS)) { -+ RTW_INFO("%s exit due to buddy_intf's mlme state under linking or wps\n", __func__); -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ -+ } else if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_SURVEY)) { -+ bool scan_via_buddy = rtw_cfg80211_scan_via_buddy(padapter, request); -+ -+ if (scan_via_buddy == _FALSE) -+ need_indicate_scan_done = _TRUE; -+ -+ goto check_need_indicate_scan_done; -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ /* busy traffic check*/ -+ if (rtw_mi_busy_traffic_check(padapter, _TRUE)) { -+ need_indicate_scan_done = _TRUE; -+ goto check_need_indicate_scan_done; -+ } -+ -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ rtw_free_network_queue(padapter, _TRUE); -+ -+ if (social_channel == 0) -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+ else -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_SOCIAL_LAST); -+ } -+#endif /* CONFIG_P2P */ -+ -+ -+ _rtw_memset(ssid, 0, sizeof(NDIS_802_11_SSID) * RTW_SSID_SCAN_AMOUNT); -+ /* parsing request ssids, n_ssids */ -+ for (i = 0; i < request->n_ssids && i < RTW_SSID_SCAN_AMOUNT; i++) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("ssid=%s, len=%d\n", ssids[i].ssid, ssids[i].ssid_len); -+ #endif -+ _rtw_memcpy(ssid[i].Ssid, ssids[i].ssid, ssids[i].ssid_len); -+ ssid[i].SsidLength = ssids[i].ssid_len; -+ } -+ -+ /* parsing channels, n_channels */ -+ _rtw_memset(ch, 0, sizeof(struct rtw_ieee80211_channel) * RTW_CHANNEL_SCAN_AMOUNT); -+ for (i = 0; i < request->n_channels && i < RTW_CHANNEL_SCAN_AMOUNT; i++) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO(FUNC_ADPT_FMT CHAN_FMT"\n", FUNC_ADPT_ARG(padapter), CHAN_ARG(request->channels[i])); -+ #endif -+ ch[i].hw_value = request->channels[i]->hw_value; -+ ch[i].flags = request->channels[i]->flags; -+ } -+ -+ if (request->n_channels == 1) { -+ for (i = 1; i < survey_times_for_one_ch; i++) -+ _rtw_memcpy(&ch[i], &ch[0], sizeof(struct rtw_ieee80211_channel)); -+ pch = ch; -+ chan_num = survey_times_for_one_ch; -+ } else if (request->n_channels <= 4) { -+ for (j = request->n_channels - 1; j >= 0; j--) -+ for (i = 0; i < survey_times; i++) -+ _rtw_memcpy(&ch[j * survey_times + i], &ch[j], sizeof(struct rtw_ieee80211_channel)); -+ pch = ch; -+ chan_num = survey_times * request->n_channels; -+ } else { -+ pch = ch; -+ chan_num = request->n_channels; -+ } -+ -+ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ _status = rtw_sitesurvey_cmd(padapter, ssid, RTW_SSID_SCAN_AMOUNT, pch, chan_num); -+ if (_status == _SUCCESS) -+ pwdev_priv->scan_request = request; -+ else -+ ret = -1; -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ -+check_need_indicate_scan_done: -+ if (_TRUE == need_indicate_scan_done) { -+#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) -+ struct cfg80211_scan_info info; -+ -+ memset(&info, 0, sizeof(info)); -+ info.aborted = 0; -+#endif -+ -+ _rtw_cfg80211_surveydone_event_callback(padapter, request); -+#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) -+ cfg80211_scan_done(request, &info); -+#else -+ cfg80211_scan_done(request, 0); -+#endif -+ } -+ -+cancel_ps_deny: -+ if (ps_denied == _TRUE) -+ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); -+ -+exit: -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_set_wiphy_params(struct wiphy *wiphy, u32 changed) -+{ -+#if 0 -+ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); -+ -+ if (changed & WIPHY_PARAM_RTS_THRESHOLD && -+ (iwm->conf.rts_threshold != wiphy->rts_threshold)) { -+ int ret; -+ -+ iwm->conf.rts_threshold = wiphy->rts_threshold; -+ -+ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX, -+ CFG_RTS_THRESHOLD, -+ iwm->conf.rts_threshold); -+ if (ret < 0) -+ return ret; -+ } -+ -+ if (changed & WIPHY_PARAM_FRAG_THRESHOLD && -+ (iwm->conf.frag_threshold != wiphy->frag_threshold)) { -+ int ret; -+ -+ iwm->conf.frag_threshold = wiphy->frag_threshold; -+ -+ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_FA_CFG_FIX, -+ CFG_FRAG_THRESHOLD, -+ iwm->conf.frag_threshold); -+ if (ret < 0) -+ return ret; -+ } -+#endif -+ RTW_INFO("%s\n", __func__); -+ return 0; -+} -+ -+ -+ -+static int rtw_cfg80211_set_wpa_version(struct security_priv *psecuritypriv, u32 wpa_version) -+{ -+ RTW_INFO("%s, wpa_version=%d\n", __func__, wpa_version); -+ -+ if (!wpa_version) { -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ return 0; -+ } -+ -+ -+ if (wpa_version & (NL80211_WPA_VERSION_1 | NL80211_WPA_VERSION_2)) -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPAPSK; -+ -+#if 0 -+ if (wpa_version & NL80211_WPA_VERSION_2) -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; -+#endif -+ -+ #ifdef CONFIG_WAPI_SUPPORT -+ if (wpa_version & NL80211_WAPI_VERSION_1) -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWAPI; -+ #endif -+ -+ return 0; -+ -+} -+ -+static int rtw_cfg80211_set_auth_type(struct security_priv *psecuritypriv, -+ enum nl80211_auth_type sme_auth_type) -+{ -+ RTW_INFO("%s, nl80211_auth_type=%d\n", __func__, sme_auth_type); -+ -+ -+ switch (sme_auth_type) { -+ case NL80211_AUTHTYPE_AUTOMATIC: -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ -+ break; -+ case NL80211_AUTHTYPE_OPEN_SYSTEM: -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ -+ if (psecuritypriv->ndisauthtype > Ndis802_11AuthModeWPA) -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWAPI) -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; -+#endif -+ -+ break; -+ case NL80211_AUTHTYPE_SHARED_KEY: -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+ -+ break; -+ default: -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ /* return -ENOTSUPP; */ -+ } -+ -+ return 0; -+ -+} -+ -+static int rtw_cfg80211_set_cipher(struct security_priv *psecuritypriv, u32 cipher, bool ucast) -+{ -+ u32 ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ -+ u32 *profile_cipher = ucast ? &psecuritypriv->dot11PrivacyAlgrthm : -+ &psecuritypriv->dot118021XGrpPrivacy; -+ -+ RTW_INFO("%s, ucast=%d, cipher=0x%x\n", __func__, ucast, cipher); -+ -+ -+ if (!cipher) { -+ *profile_cipher = _NO_PRIVACY_; -+ psecuritypriv->ndisencryptstatus = ndisencryptstatus; -+ return 0; -+ } -+ -+ switch (cipher) { -+ case IW_AUTH_CIPHER_NONE: -+ *profile_cipher = _NO_PRIVACY_; -+ ndisencryptstatus = Ndis802_11EncryptionDisabled; -+#ifdef CONFIG_WAPI_SUPPORT -+ if (psecuritypriv->dot11PrivacyAlgrthm == _SMS4_) -+ *profile_cipher = _SMS4_; -+#endif -+ break; -+ case WLAN_CIPHER_SUITE_WEP40: -+ *profile_cipher = _WEP40_; -+ ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WLAN_CIPHER_SUITE_WEP104: -+ *profile_cipher = _WEP104_; -+ ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WLAN_CIPHER_SUITE_TKIP: -+ *profile_cipher = _TKIP_; -+ ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WLAN_CIPHER_SUITE_CCMP: -+ *profile_cipher = _AES_; -+ ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case WLAN_CIPHER_SUITE_SMS4: -+ *profile_cipher = _SMS4_; -+ ndisencryptstatus = Ndis802_11_EncrypteionWAPI; -+ break; -+#endif -+ default: -+ RTW_INFO("Unsupported cipher: 0x%x\n", cipher); -+ return -ENOTSUPP; -+ } -+ -+ if (ucast) { -+ psecuritypriv->ndisencryptstatus = ndisencryptstatus; -+ -+ /* if(psecuritypriv->dot11PrivacyAlgrthm >= _AES_) */ -+ /* psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; */ -+ } -+ -+ return 0; -+} -+ -+static int rtw_cfg80211_set_key_mgt(struct security_priv *psecuritypriv, u32 key_mgt) -+{ -+ RTW_INFO("%s, key_mgt=0x%x\n", __func__, key_mgt); -+ -+ if (key_mgt == WLAN_AKM_SUITE_8021X) { -+ /* *auth_type = UMAC_AUTH_TYPE_8021X; */ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ psecuritypriv->rsn_akm_suite_type = 1; -+ } else if (key_mgt == WLAN_AKM_SUITE_PSK) { -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ psecuritypriv->rsn_akm_suite_type = 2; -+ } -+#ifdef CONFIG_WAPI_SUPPORT -+ else if (key_mgt == WLAN_AKM_SUITE_WAPI_PSK) -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; -+ else if (key_mgt == WLAN_AKM_SUITE_WAPI_CERT) -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; -+#endif -+#ifdef CONFIG_RTW_80211R -+ else if (key_mgt == WLAN_AKM_SUITE_FT_8021X) { -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ psecuritypriv->rsn_akm_suite_type = 3; -+ } else if (key_mgt == WLAN_AKM_SUITE_FT_PSK) { -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ psecuritypriv->rsn_akm_suite_type = 4; -+ } -+#endif -+ else { -+ RTW_INFO("Invalid key mgt: 0x%x\n", key_mgt); -+ /* return -EINVAL; */ -+ } -+ -+ return 0; -+} -+ -+static int rtw_cfg80211_set_wpa_ie(_adapter *padapter, u8 *pie, size_t ielen) -+{ -+ u8 *buf = NULL, *pos = NULL; -+ u32 left; -+ int group_cipher = 0, pairwise_cipher = 0; -+ int ret = 0; -+ int wpa_ielen = 0; -+ int wpa2_ielen = 0; -+ u8 *pwpa, *pwpa2; -+ u8 null_addr[] = {0, 0, 0, 0, 0, 0}; -+ -+ if (pie == NULL || !ielen) { -+ /* Treat this as normal case, but need to clear WIFI_UNDER_WPS */ -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ goto exit; -+ } -+ -+ if (ielen > MAX_WPA_IE_LEN + MAX_WPS_IE_LEN + MAX_P2P_IE_LEN) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ buf = rtw_zmalloc(ielen); -+ if (buf == NULL) { -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ _rtw_memcpy(buf, pie , ielen); -+ -+ /* dump */ -+ { -+ int i; -+ RTW_INFO("set wpa_ie(length:%zu):\n", ielen); -+ for (i = 0; i < ielen; i = i + 8) -+ RTW_INFO("0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x\n", buf[i], buf[i + 1], buf[i + 2], buf[i + 3], buf[i + 4], buf[i + 5], buf[i + 6], buf[i + 7]); -+ } -+ -+ pos = buf; -+ if (ielen < RSN_HEADER_LEN) { -+ ret = -1; -+ goto exit; -+ } -+ -+ pwpa = rtw_get_wpa_ie(buf, &wpa_ielen, ielen); -+ if (pwpa && wpa_ielen > 0) { -+ if (rtw_parse_wpa_ie(pwpa, wpa_ielen + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPAPSK; -+ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &pwpa[0], wpa_ielen + 2); -+ -+ RTW_INFO("got wpa_ie, wpa_ielen:%u\n", wpa_ielen); -+ } -+ } -+ -+ pwpa2 = rtw_get_wpa2_ie(buf, &wpa2_ielen, ielen); -+ if (pwpa2 && wpa2_ielen > 0) { -+ if (rtw_parse_wpa2_ie(pwpa2, wpa2_ielen + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK; -+ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &pwpa2[0], wpa2_ielen + 2); -+ -+ RTW_INFO("got wpa2_ie, wpa2_ielen:%u\n", wpa2_ielen); -+ } -+ } -+ -+ if (group_cipher == 0) -+ group_cipher = WPA_CIPHER_NONE; -+ if (pairwise_cipher == 0) -+ pairwise_cipher = WPA_CIPHER_NONE; -+ -+ switch (group_cipher) { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot118021XGrpPrivacy = _TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot118021XGrpPrivacy = _AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ switch (pairwise_cipher) { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ {/* handle wps_ie */ -+ uint wps_ielen; -+ u8 *wps_ie; -+ -+ wps_ie = rtw_get_wps_ie(buf, ielen, NULL, &wps_ielen); -+ if (wps_ie && wps_ielen > 0) { -+ RTW_INFO("got wps_ie, wps_ielen:%u\n", wps_ielen); -+ padapter->securitypriv.wps_ie_len = wps_ielen < MAX_WPS_IE_LEN ? wps_ielen : MAX_WPS_IE_LEN; -+ _rtw_memcpy(padapter->securitypriv.wps_ie, wps_ie, padapter->securitypriv.wps_ie_len); -+ set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ } else -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ } -+ -+ #ifdef CONFIG_P2P -+ {/* check p2p_ie for assoc req; */ -+ uint p2p_ielen = 0; -+ u8 *p2p_ie; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ p2p_ie = rtw_get_p2p_ie(buf, ielen, NULL, &p2p_ielen); -+ if (p2p_ie) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s p2p_assoc_req_ielen=%d\n", __FUNCTION__, p2p_ielen); -+ #endif -+ -+ if (pmlmepriv->p2p_assoc_req_ie) { -+ u32 free_len = pmlmepriv->p2p_assoc_req_ie_len; -+ pmlmepriv->p2p_assoc_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_assoc_req_ie, free_len); -+ pmlmepriv->p2p_assoc_req_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_assoc_req_ie = rtw_malloc(p2p_ielen); -+ if (pmlmepriv->p2p_assoc_req_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ goto exit; -+ } -+ _rtw_memcpy(pmlmepriv->p2p_assoc_req_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_assoc_req_ie_len = p2p_ielen; -+ } -+ } -+ #endif /* CONFIG_P2P */ -+ -+ #ifdef CONFIG_WFD -+ { -+ uint wfd_ielen = 0; -+ u8 *wfd_ie; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ wfd_ie = rtw_get_wfd_ie(buf, ielen, NULL, &wfd_ielen); -+ if (wfd_ie) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s wfd_assoc_req_ielen=%d\n", __FUNCTION__, wfd_ielen); -+ #endif -+ -+ if (rtw_mlme_update_wfd_ie_data(pmlmepriv, MLME_ASSOC_REQ_IE, wfd_ie, wfd_ielen) != _SUCCESS) -+ goto exit; -+ } -+ } -+ #endif /* CONFIG_WFD */ -+ -+ /* TKIP and AES disallow multicast packets until installing group key */ -+ if (padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) -+ /* WPS open need to enable multicast */ -+ /* || check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == _TRUE) */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr); -+ -+ -+exit: -+ if (buf) -+ rtw_mfree(buf, ielen); -+ if (ret) -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_join_ibss(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_ibss_params *params) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ NDIS_802_11_SSID ndis_ssid; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ struct cfg80211_chan_def *pch_def; -+#endif -+ struct ieee80211_channel *pch; -+ int ret = 0; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ pch_def = (struct cfg80211_chan_def *)(¶ms->chandef); -+ pch = (struct ieee80211_channel *) pch_def->chan; -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 31)) -+ pch = (struct ieee80211_channel *)(params->channel); -+#endif -+ -+ if (!params->ssid || !params->ssid_len) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (params->ssid_len > IW_ESSID_MAX_SIZE) { -+ ret = -E2BIG; -+ goto exit; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ rtw_ps_deny(padapter, PS_DENY_JOIN); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -EPERM; -+ goto cancel_ps_deny; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING)) { -+ RTW_INFO("%s, but buddy_intf is under linking\n", __FUNCTION__); -+ ret = -EINVAL; -+ goto cancel_ps_deny; -+ } -+ rtw_mi_buddy_scan_abort(padapter, _TRUE); /* OR rtw_mi_scan_abort(padapter, _TRUE);*/ -+#endif /*CONFIG_CONCURRENT_MODE*/ -+ -+ -+ _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ ndis_ssid.SsidLength = params->ssid_len; -+ _rtw_memcpy(ndis_ssid.Ssid, (u8 *)params->ssid, params->ssid_len); -+ -+ /* RTW_INFO("ssid=%s, len=%zu\n", ndis_ssid.Ssid, params->ssid_len); */ -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ -+ ret = rtw_cfg80211_set_auth_type(psecuritypriv, NL80211_AUTHTYPE_OPEN_SYSTEM); -+ rtw_set_802_11_authentication_mode(padapter, psecuritypriv->ndisauthtype); -+ -+ RTW_INFO("%s: center_freq = %d\n", __func__, pch->center_freq); -+ pmlmeext->cur_channel = rtw_freq2ch(pch->center_freq); -+ -+ if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == _FALSE) { -+ ret = -1; -+ goto cancel_ps_deny; -+ } -+ -+cancel_ps_deny: -+ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); -+exit: -+ return ret; -+} -+ -+static int cfg80211_rtw_leave_ibss(struct wiphy *wiphy, struct net_device *ndev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct wireless_dev *rtw_wdev = padapter->rtw_wdev; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ enum nl80211_iftype old_type; -+ int ret = 0; -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ rtw_wdev_set_not_indic_disco(pwdev_priv, 1); -+ -+ old_type = rtw_wdev->iftype; -+ -+ rtw_set_to_roam(padapter, 0); -+ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { -+ rtw_scan_abort(padapter); -+ LeaveAllPowerSaveMode(padapter); -+ -+ rtw_wdev->iftype = NL80211_IFTYPE_STATION; -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, Ndis802_11Infrastructure) == _FALSE) { -+ rtw_wdev->iftype = old_type; -+ ret = -EPERM; -+ goto leave_ibss; -+ } -+ rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure, _TRUE); -+ } -+ -+leave_ibss: -+ rtw_wdev_set_not_indic_disco(pwdev_priv, 0); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_connect_params *sme) -+{ -+ int ret = 0; -+ struct wlan_network *pnetwork = NULL; -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ NDIS_802_11_SSID ndis_ssid; -+ u8 *dst_ssid, *src_ssid; -+ u8 *dst_bssid, *src_bssid; -+ /* u8 matched_by_bssid=_FALSE; */ -+ /* u8 matched_by_ssid=_FALSE; */ -+ u8 matched = _FALSE; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ _queue *queue = &pmlmepriv->scanned_queue; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ _irqL irqL; -+ -+ rtw_wdev_set_not_indic_disco(pwdev_priv, 1); -+ -+ RTW_INFO("=>"FUNC_NDEV_FMT" - Start to Connection\n", FUNC_NDEV_ARG(ndev)); -+ RTW_INFO("privacy=%d, key=%p, key_len=%d, key_idx=%d, auth_type=%d\n", -+ sme->privacy, sme->key, sme->key_len, sme->key_idx, sme->auth_type); -+ -+ -+ if (pwdev_priv->block == _TRUE) { -+ ret = -EBUSY; -+ RTW_INFO("%s wdev_priv.block is set\n", __FUNCTION__); -+ goto exit; -+ } -+ -+#ifdef CONFIG_PLATFORM_MSTAR_SCAN_BEFORE_CONNECT -+ printk("MStar Android!\n"); -+ if (pwdev_priv->bandroid_scan == _FALSE) { -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+#endif /* CONFIG_P2P */ -+ { -+ ret = -EBUSY; -+ printk("Android hasn't attached yet!\n"); -+ goto exit; -+ } -+ } -+#endif -+ -+ if (!sme->ssid || !sme->ssid_len) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (sme->ssid_len > IW_ESSID_MAX_SIZE) { -+ ret = -E2BIG; -+ goto exit; -+ } -+ -+ rtw_ps_deny(padapter, PS_DENY_JOIN); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -EPERM; -+ goto cancel_ps_deny; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ ret = -EPERM; -+ goto cancel_ps_deny; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { -+ ret = -EBUSY; -+ RTW_INFO("%s, fw_state=0x%x, goto exit\n", __func__, pmlmepriv->fw_state); -+ goto cancel_ps_deny; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING)) { -+ ret = -EINVAL; -+ goto cancel_ps_deny; -+ } -+#endif -+ -+ rtw_mi_scan_abort(padapter, _TRUE); -+ -+ _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ ndis_ssid.SsidLength = sme->ssid_len; -+ _rtw_memcpy(ndis_ssid.Ssid, (u8 *)sme->ssid, sme->ssid_len); -+ -+ RTW_INFO("ssid=%s, len=%zu\n", ndis_ssid.Ssid, sme->ssid_len); -+ -+ -+ if (sme->bssid) -+ RTW_INFO("bssid="MAC_FMT"\n", MAC_ARG(sme->bssid)); -+ -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ padapter->wapiInfo.bWapiEnable = false; -+#endif -+ -+ ret = rtw_cfg80211_set_wpa_version(psecuritypriv, sme->crypto.wpa_versions); -+ if (ret < 0) -+ goto cancel_ps_deny; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (sme->crypto.wpa_versions & NL80211_WAPI_VERSION_1) { -+ padapter->wapiInfo.bWapiEnable = true; -+ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; -+ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; -+ } -+#endif -+ -+ ret = rtw_cfg80211_set_auth_type(psecuritypriv, sme->auth_type); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_WAPI) -+ padapter->mlmeextpriv.mlmext_info.auth_algo = psecuritypriv->dot11AuthAlgrthm; -+#endif -+ -+ -+ if (ret < 0) -+ goto cancel_ps_deny; -+ -+ RTW_INFO("%s, ie_len=%zu\n", __func__, sme->ie_len); -+ -+ ret = rtw_cfg80211_set_wpa_ie(padapter, (u8 *)sme->ie, sme->ie_len); -+ if (ret < 0) -+ goto cancel_ps_deny; -+ -+ if (sme->crypto.n_ciphers_pairwise) { -+ ret = rtw_cfg80211_set_cipher(psecuritypriv, sme->crypto.ciphers_pairwise[0], _TRUE); -+ if (ret < 0) -+ goto cancel_ps_deny; -+ } -+ -+ /* For WEP Shared auth */ -+ if (sme->key_len > 0 && sme->key) { -+ u32 wep_key_idx, wep_key_len, wep_total_len; -+ NDIS_802_11_WEP *pwep = NULL; -+ RTW_INFO("%s(): Shared/Auto WEP\n", __FUNCTION__); -+ -+ wep_key_idx = sme->key_idx; -+ wep_key_len = sme->key_len; -+ -+ if (sme->key_idx > WEP_KEYS) { -+ ret = -EINVAL; -+ goto cancel_ps_deny; -+ } -+ -+ if (wep_key_len > 0) { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); -+ pwep = (NDIS_802_11_WEP *) rtw_malloc(wep_total_len); -+ if (pwep == NULL) { -+ RTW_INFO(" wpa_set_encryption: pwep allocate fail !!!\n"); -+ ret = -ENOMEM; -+ goto cancel_ps_deny; -+ } -+ -+ _rtw_memset(pwep, 0, wep_total_len); -+ -+ pwep->KeyLength = wep_key_len; -+ pwep->Length = wep_total_len; -+ -+ if (wep_key_len == 13) { -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP104_; -+ } -+ } else { -+ ret = -EINVAL; -+ goto cancel_ps_deny; -+ } -+ -+ pwep->KeyIndex = wep_key_idx; -+ pwep->KeyIndex |= 0x80000000; -+ -+ _rtw_memcpy(pwep->KeyMaterial, (void *)sme->key, pwep->KeyLength); -+ -+ if (rtw_set_802_11_add_wep(padapter, pwep) == (u8)_FAIL) -+ ret = -EOPNOTSUPP ; -+ -+ if (pwep) -+ rtw_mfree((u8 *)pwep, wep_total_len); -+ -+ if (ret < 0) -+ goto cancel_ps_deny; -+ } -+ -+ ret = rtw_cfg80211_set_cipher(psecuritypriv, sme->crypto.cipher_group, _FALSE); -+ if (ret < 0) -+ return ret; -+ -+ if (sme->crypto.n_akm_suites) { -+ ret = rtw_cfg80211_set_key_mgt(psecuritypriv, sme->crypto.akm_suites[0]); -+ if (ret < 0) -+ goto cancel_ps_deny; -+ } -+#ifdef CONFIG_8011R -+ else { -+ /*It could be a connection without RSN IEs*/ -+ psecuritypriv->rsn_akm_suite_type = 0; -+ } -+#endif -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (sme->crypto.akm_suites[0] == WLAN_AKM_SUITE_WAPI_PSK) -+ padapter->wapiInfo.bWapiPSK = true; -+ else if (sme->crypto.akm_suites[0] == WLAN_AKM_SUITE_WAPI_CERT) -+ padapter->wapiInfo.bWapiPSK = false; -+#endif -+ -+ authmode = psecuritypriv->ndisauthtype; -+ rtw_set_802_11_authentication_mode(padapter, authmode); -+ -+ /* rtw_set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); */ -+ -+ if (rtw_set_802_11_connect(padapter, (u8 *)sme->bssid, &ndis_ssid) == _FALSE) { -+ ret = -1; -+ goto cancel_ps_deny; -+ } -+ -+ -+ _enter_critical_bh(&pwdev_priv->connect_req_lock, &irqL); -+ -+ if (pwdev_priv->connect_req) { -+ rtw_wdev_free_connect_req(pwdev_priv); -+ RTW_INFO(FUNC_NDEV_FMT" free existing connect_req\n", FUNC_NDEV_ARG(ndev)); -+ } -+ -+ pwdev_priv->connect_req = (struct cfg80211_connect_params *)rtw_malloc(sizeof(*pwdev_priv->connect_req)); -+ if (pwdev_priv->connect_req) -+ _rtw_memcpy(pwdev_priv->connect_req, sme, sizeof(*pwdev_priv->connect_req)); -+ else -+ RTW_WARN(FUNC_NDEV_FMT" alloc connect_req fail\n", FUNC_NDEV_ARG(ndev)); -+ -+ _exit_critical_bh(&pwdev_priv->connect_req_lock, &irqL); -+ -+ RTW_INFO("set ssid:dot11AuthAlgrthm=%d, dot11PrivacyAlgrthm=%d, dot118021XGrpPrivacy=%d\n", psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, -+ psecuritypriv->dot118021XGrpPrivacy); -+ -+cancel_ps_deny: -+ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); -+ -+exit: -+ RTW_INFO("<=%s, ret %d\n", __FUNCTION__, ret); -+ -+ rtw_wdev_set_not_indic_disco(pwdev_priv, 0); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_disconnect(struct wiphy *wiphy, struct net_device *ndev, -+ u16 reason_code) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ -+ RTW_INFO(FUNC_NDEV_FMT" - Start to Disconnect\n", FUNC_NDEV_ARG(ndev)); -+ -+ rtw_wdev_set_not_indic_disco(pwdev_priv, 1); -+ -+ rtw_set_to_roam(padapter, 0); -+ -+ /* if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)) */ -+ { -+ rtw_scan_abort(padapter); -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, _FALSE); -+ rtw_sta_mstatus_report(padapter); -+ -+ RTW_INFO("%s...call rtw_indicate_disconnect\n", __func__); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ rtw_indicate_disconnect(padapter, 0, _TRUE); -+ -+ rtw_pwr_wakeup(padapter); -+ } -+ -+ rtw_wdev_set_not_indic_disco(pwdev_priv, 0); -+ -+ RTW_INFO(FUNC_NDEV_FMT" return 0\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+static int cfg80211_rtw_set_txpower(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ struct wireless_dev *wdev, -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) || defined(COMPAT_KERNEL_RELEASE) -+ enum nl80211_tx_power_setting type, int mbm) -+#else -+ enum tx_power_setting type, int dbm) -+#endif -+{ -+#if 0 -+ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); -+ int ret; -+ -+ switch (type) { -+ case NL80211_TX_POWER_AUTOMATIC: -+ return 0; -+ case NL80211_TX_POWER_FIXED: -+ if (mbm < 0 || (mbm % 100)) -+ return -EOPNOTSUPP; -+ -+ if (!test_bit(IWM_STATUS_READY, &iwm->status)) -+ return 0; -+ -+ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX, -+ CFG_TX_PWR_LIMIT_USR, -+ MBM_TO_DBM(mbm) * 2); -+ if (ret < 0) -+ return ret; -+ -+ return iwm_tx_power_trigger(iwm); -+ default: -+ IWM_ERR(iwm, "Unsupported power type: %d\n", type); -+ return -EOPNOTSUPP; -+ } -+#endif -+ RTW_INFO("%s\n", __func__); -+ return 0; -+} -+ -+static int cfg80211_rtw_get_txpower(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ struct wireless_dev *wdev, -+#endif -+ int *dbm) -+{ -+ RTW_INFO("%s\n", __func__); -+ -+ *dbm = (12); -+ -+ return 0; -+} -+ -+inline bool rtw_cfg80211_pwr_mgmt(_adapter *adapter) -+{ -+ struct rtw_wdev_priv *rtw_wdev_priv = adapter_wdev_data(adapter); -+ return rtw_wdev_priv->power_mgmt; -+} -+ -+static int cfg80211_rtw_set_power_mgmt(struct wiphy *wiphy, -+ struct net_device *ndev, -+ bool enabled, int timeout) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct rtw_wdev_priv *rtw_wdev_priv = adapter_wdev_data(padapter); -+ -+ RTW_INFO(FUNC_NDEV_FMT" enabled:%u, timeout:%d\n", FUNC_NDEV_ARG(ndev), -+ enabled, timeout); -+ -+ rtw_wdev_priv->power_mgmt = enabled; -+ -+#ifdef CONFIG_LPS -+ if (!enabled) -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE_CFG80211_PWRMGMT, 1); -+#endif -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_set_pmksa(struct wiphy *wiphy, -+ struct net_device *ndev, -+ struct cfg80211_pmksa *pmksa) -+{ -+ u8 index, blInserted = _FALSE; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *mlme = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u8 strZeroMacAddress[ETH_ALEN] = { 0x00 }; -+ -+ RTW_INFO(FUNC_NDEV_FMT" "MAC_FMT" "KEY_FMT"\n", FUNC_NDEV_ARG(ndev) -+ , MAC_ARG(pmksa->bssid), KEY_ARG(pmksa->pmkid)); -+ -+ if (_rtw_memcmp((u8 *)pmksa->bssid, strZeroMacAddress, ETH_ALEN) == _TRUE) -+ return -EINVAL; -+ -+ if (check_fwstate(mlme, _FW_LINKED) == _FALSE) { -+ RTW_INFO(FUNC_NDEV_FMT" not set pmksa cause not in linked state\n", FUNC_NDEV_ARG(ndev)); -+ return -EINVAL; -+ } -+ -+ blInserted = _FALSE; -+ -+ /* overwrite PMKID */ -+ for (index = 0 ; index < NUM_PMKID_CACHE; index++) { -+ if (_rtw_memcmp(psecuritypriv->PMKIDList[index].Bssid, (u8 *)pmksa->bssid, ETH_ALEN) == _TRUE) { -+ /* BSSID is matched, the same AP => rewrite with new PMKID. */ -+ RTW_INFO(FUNC_NDEV_FMT" BSSID exists in the PMKList.\n", FUNC_NDEV_ARG(ndev)); -+ -+ _rtw_memcpy(psecuritypriv->PMKIDList[index].PMKID, (u8 *)pmksa->pmkid, WLAN_PMKID_LEN); -+ psecuritypriv->PMKIDList[index].bUsed = _TRUE; -+ psecuritypriv->PMKIDIndex = index + 1; -+ blInserted = _TRUE; -+ break; -+ } -+ } -+ -+ if (!blInserted) { -+ /* Find a new entry */ -+ RTW_INFO(FUNC_NDEV_FMT" Use the new entry index = %d for this PMKID.\n", -+ FUNC_NDEV_ARG(ndev), psecuritypriv->PMKIDIndex); -+ -+ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, (u8 *)pmksa->bssid, ETH_ALEN); -+ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, (u8 *)pmksa->pmkid, WLAN_PMKID_LEN); -+ -+ psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].bUsed = _TRUE; -+ psecuritypriv->PMKIDIndex++ ; -+ if (psecuritypriv->PMKIDIndex == 16) -+ psecuritypriv->PMKIDIndex = 0; -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_del_pmksa(struct wiphy *wiphy, -+ struct net_device *ndev, -+ struct cfg80211_pmksa *pmksa) -+{ -+ u8 index, bMatched = _FALSE; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ RTW_INFO(FUNC_NDEV_FMT" "MAC_FMT" "KEY_FMT"\n", FUNC_NDEV_ARG(ndev) -+ , MAC_ARG(pmksa->bssid), KEY_ARG(pmksa->pmkid)); -+ -+ for (index = 0 ; index < NUM_PMKID_CACHE; index++) { -+ if (_rtw_memcmp(psecuritypriv->PMKIDList[index].Bssid, (u8 *)pmksa->bssid, ETH_ALEN) == _TRUE) { -+ /* BSSID is matched, the same AP => Remove this PMKID information and reset it. */ -+ _rtw_memset(psecuritypriv->PMKIDList[index].Bssid, 0x00, ETH_ALEN); -+ _rtw_memset(psecuritypriv->PMKIDList[index].PMKID, 0x00, WLAN_PMKID_LEN); -+ psecuritypriv->PMKIDList[index].bUsed = _FALSE; -+ bMatched = _TRUE; -+ RTW_INFO(FUNC_NDEV_FMT" clear id:%hhu\n", FUNC_NDEV_ARG(ndev), index); -+ break; -+ } -+ } -+ -+ if (_FALSE == bMatched) { -+ RTW_INFO(FUNC_NDEV_FMT" do not have matched BSSID\n" -+ , FUNC_NDEV_ARG(ndev)); -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_flush_pmksa(struct wiphy *wiphy, -+ struct net_device *ndev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ _rtw_memset(&psecuritypriv->PMKIDList[0], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); -+ psecuritypriv->PMKIDIndex = 0; -+ -+ return 0; -+} -+ -+#ifdef CONFIG_AP_MODE -+void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) -+{ -+ s32 freq; -+ int channel; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct net_device *ndev = padapter->pnetdev; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+#if defined(RTW_USE_CFG80211_STA_EVENT) || defined(COMPAT_KERNEL_RELEASE) -+ { -+ struct station_info sinfo; -+ u8 ie_offset; -+ if (GetFrameSubType(pmgmt_frame) == WIFI_ASSOCREQ) -+ ie_offset = _ASOCREQ_IE_OFFSET_; -+ else /* WIFI_REASSOCREQ */ -+ ie_offset = _REASOCREQ_IE_OFFSET_; -+ -+ memset(&sinfo, 0, sizeof(sinfo)); -+ sinfo.filled = STATION_INFO_ASSOC_REQ_IES; -+ sinfo.assoc_req_ies = pmgmt_frame + WLAN_HDR_A3_LEN + ie_offset; -+ sinfo.assoc_req_ies_len = frame_len - WLAN_HDR_A3_LEN - ie_offset; -+ cfg80211_new_sta(ndev, GetAddr2Ptr(pmgmt_frame), &sinfo, GFP_ATOMIC); -+ } -+#else /* defined(RTW_USE_CFG80211_STA_EVENT) */ -+ channel = pmlmeext->cur_channel; -+ freq = rtw_ch2freq(channel); -+ -+ #ifdef COMPAT_KERNEL_RELEASE -+ rtw_cfg80211_rx_mgmt(pwdev, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); -+ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ rtw_cfg80211_rx_mgmt(pwdev, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); -+ #else /* COMPAT_KERNEL_RELEASE */ -+ { -+ /* to avoid WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION) when calling cfg80211_send_rx_assoc() */ -+ #ifndef CONFIG_PLATFORM_MSTAR -+ pwdev->iftype = NL80211_IFTYPE_STATION; -+ #endif /* CONFIG_PLATFORM_MSTAR */ -+ RTW_INFO("iftype=%d before call cfg80211_send_rx_assoc()\n", pwdev->iftype); -+ rtw_cfg80211_send_rx_assoc(padapter, NULL, pmgmt_frame, frame_len); -+ RTW_INFO("iftype=%d after call cfg80211_send_rx_assoc()\n", pwdev->iftype); -+ pwdev->iftype = NL80211_IFTYPE_AP; -+ /* cfg80211_rx_action(padapter->pnetdev, freq, pmgmt_frame, frame_len, GFP_ATOMIC); */ -+ } -+ #endif /* COMPAT_KERNEL_RELEASE */ -+#endif /* defined(RTW_USE_CFG80211_STA_EVENT) */ -+ -+} -+ -+void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, unsigned short reason) -+{ -+ s32 freq; -+ int channel; -+ u8 *pmgmt_frame; -+ uint frame_len; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ u8 mgmt_buf[128] = {0}; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wireless_dev *wdev = padapter->rtw_wdev; -+ struct net_device *ndev = padapter->pnetdev; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+#if defined(RTW_USE_CFG80211_STA_EVENT) || defined(COMPAT_KERNEL_RELEASE) -+ cfg80211_del_sta(ndev, da, GFP_ATOMIC); -+#else /* defined(RTW_USE_CFG80211_STA_EVENT) */ -+ channel = pmlmeext->cur_channel; -+ freq = rtw_ch2freq(channel); -+ -+ pmgmt_frame = mgmt_buf; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pmgmt_frame; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pmgmt_frame, WIFI_DEAUTH); -+ -+ pmgmt_frame += sizeof(struct rtw_ieee80211_hdr_3addr); -+ frame_len = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ reason = cpu_to_le16(reason); -+ pmgmt_frame = rtw_set_fixed_ie(pmgmt_frame, _RSON_CODE_ , (unsigned char *)&reason, &frame_len); -+ -+ #ifdef COMPAT_KERNEL_RELEASE -+ rtw_cfg80211_rx_mgmt(wdev, freq, 0, mgmt_buf, frame_len, GFP_ATOMIC); -+ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ rtw_cfg80211_rx_mgmt(wdev, freq, 0, mgmt_buf, frame_len, GFP_ATOMIC); -+ #else /* COMPAT_KERNEL_RELEASE */ -+ cfg80211_send_disassoc(padapter->pnetdev, mgmt_buf, frame_len); -+ /* cfg80211_rx_action(padapter->pnetdev, freq, mgmt_buf, frame_len, GFP_ATOMIC); */ -+ #endif /* COMPAT_KERNEL_RELEASE */ -+#endif /* defined(RTW_USE_CFG80211_STA_EVENT) */ -+} -+ -+static int rtw_cfg80211_monitor_if_open(struct net_device *ndev) -+{ -+ int ret = 0; -+ -+ RTW_INFO("%s\n", __func__); -+ -+ return ret; -+} -+ -+static int rtw_cfg80211_monitor_if_close(struct net_device *ndev) -+{ -+ int ret = 0; -+ -+ RTW_INFO("%s\n", __func__); -+ -+ return ret; -+} -+ -+static int rtw_cfg80211_monitor_if_xmit_entry(struct sk_buff *skb, struct net_device *ndev) -+{ -+ int ret = 0; -+ int rtap_len; -+ int qos_len = 0; -+ int dot11_hdr_len = 24; -+ int snap_len = 6; -+ unsigned char *pdata; -+ u16 frame_ctl; -+ unsigned char src_mac_addr[6]; -+ unsigned char dst_mac_addr[6]; -+ struct rtw_ieee80211_hdr *dot11_hdr; -+ struct ieee80211_radiotap_header *rtap_hdr; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ if (skb) -+ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize); -+ -+ if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header))) -+ goto fail; -+ -+ rtap_hdr = (struct ieee80211_radiotap_header *)skb->data; -+ if (unlikely(rtap_hdr->it_version)) -+ goto fail; -+ -+ rtap_len = ieee80211_get_radiotap_len(skb->data); -+ if (unlikely(skb->len < rtap_len)) -+ goto fail; -+ -+ if (rtap_len != 14) { -+ RTW_INFO("radiotap len (should be 14): %d\n", rtap_len); -+ goto fail; -+ } -+ -+ /* Skip the ratio tap header */ -+ skb_pull(skb, rtap_len); -+ -+ dot11_hdr = (struct rtw_ieee80211_hdr *)skb->data; -+ frame_ctl = le16_to_cpu(dot11_hdr->frame_ctl); -+ /* Check if the QoS bit is set */ -+ if ((frame_ctl & RTW_IEEE80211_FCTL_FTYPE) == RTW_IEEE80211_FTYPE_DATA) { -+ /* Check if this ia a Wireless Distribution System (WDS) frame -+ * which has 4 MAC addresses -+ */ -+ if (dot11_hdr->frame_ctl & 0x0080) -+ qos_len = 2; -+ if ((dot11_hdr->frame_ctl & 0x0300) == 0x0300) -+ dot11_hdr_len += 6; -+ -+ memcpy(dst_mac_addr, dot11_hdr->addr1, sizeof(dst_mac_addr)); -+ memcpy(src_mac_addr, dot11_hdr->addr2, sizeof(src_mac_addr)); -+ -+ /* Skip the 802.11 header, QoS (if any) and SNAP, but leave spaces for -+ * for two MAC addresses -+ */ -+ skb_pull(skb, dot11_hdr_len + qos_len + snap_len - sizeof(src_mac_addr) * 2); -+ pdata = (unsigned char *)skb->data; -+ memcpy(pdata, dst_mac_addr, sizeof(dst_mac_addr)); -+ memcpy(pdata + sizeof(dst_mac_addr), src_mac_addr, sizeof(src_mac_addr)); -+ -+ RTW_INFO("should be eapol packet\n"); -+ -+ /* Use the real net device to transmit the packet */ -+ ret = _rtw_xmit_entry(skb, padapter->pnetdev); -+ -+ return ret; -+ -+ } else if ((frame_ctl & (RTW_IEEE80211_FCTL_FTYPE | RTW_IEEE80211_FCTL_STYPE)) -+ == (RTW_IEEE80211_FTYPE_MGMT | RTW_IEEE80211_STYPE_ACTION) -+ ) { -+ /* only for action frames */ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ /* u8 category, action, OUI_Subtype, dialogToken=0; */ -+ /* unsigned char *frame_body; */ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ u8 *buf = skb->data; -+ u32 len = skb->len; -+ u8 category, action; -+ int type = -1; -+ -+ if (rtw_action_frame_parse(buf, len, &category, &action) == _FALSE) { -+ RTW_INFO(FUNC_NDEV_FMT" frame_control:0x%x\n", FUNC_NDEV_ARG(ndev), -+ le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl)); -+ goto fail; -+ } -+ -+ RTW_INFO("RTW_Tx:da="MAC_FMT" via "FUNC_NDEV_FMT"\n", -+ MAC_ARG(GetAddr1Ptr(buf)), FUNC_NDEV_ARG(ndev)); -+ #ifdef CONFIG_P2P -+ type = rtw_p2p_check_frames(padapter, buf, len, _TRUE); -+ if (type >= 0) -+ goto dump; -+ #endif -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) -+ RTW_INFO("RTW_Tx:%s\n", action_public_str(action)); -+ else -+ RTW_INFO("RTW_Tx:category(%u), action(%u)\n", category, action); -+ -+dump: -+ /* starting alloc mgmt frame to dump it */ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ goto fail; -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = _FALSE; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ _rtw_memcpy(pframe, (void *)buf, len); -+ pattrib->pktlen = len; -+ -+#ifdef CONFIG_P2P -+ if (type >= 0) -+ rtw_xframe_chk_wfd_ie(pmgntframe); -+#endif /* CONFIG_P2P */ -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ /* update seq number */ -+ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ pmlmeext->mgnt_seq++; -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ } else -+ RTW_INFO("frame_ctl=0x%x\n", frame_ctl & (RTW_IEEE80211_FCTL_FTYPE | RTW_IEEE80211_FCTL_STYPE)); -+ -+ -+fail: -+ -+ rtw_skb_free(skb); -+ -+ return 0; -+ -+} -+ -+static void rtw_cfg80211_monitor_if_set_multicast_list(struct net_device *ndev) -+{ -+ RTW_INFO("%s\n", __func__); -+} -+ -+static int rtw_cfg80211_monitor_if_set_mac_address(struct net_device *ndev, void *addr) -+{ -+ int ret = 0; -+ -+ RTW_INFO("%s\n", __func__); -+ -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+static const struct net_device_ops rtw_cfg80211_monitor_if_ops = { -+ .ndo_open = rtw_cfg80211_monitor_if_open, -+ .ndo_stop = rtw_cfg80211_monitor_if_close, -+ .ndo_start_xmit = rtw_cfg80211_monitor_if_xmit_entry, -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 2, 0)) -+ .ndo_set_multicast_list = rtw_cfg80211_monitor_if_set_multicast_list, -+ #endif -+ .ndo_set_mac_address = rtw_cfg80211_monitor_if_set_mac_address, -+}; -+#endif -+ -+static int rtw_cfg80211_add_monitor_if(_adapter *padapter, char *name, struct net_device **ndev) -+{ -+ int ret = 0; -+ struct net_device *mon_ndev = NULL; -+ struct wireless_dev *mon_wdev = NULL; -+ struct rtw_netdev_priv_indicator *pnpi; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ -+ if (!name) { -+ RTW_INFO(FUNC_ADPT_FMT" without specific name\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ if (pwdev_priv->pmon_ndev) { -+ RTW_INFO(FUNC_ADPT_FMT" monitor interface exist: "NDEV_FMT"\n", -+ FUNC_ADPT_ARG(padapter), NDEV_ARG(pwdev_priv->pmon_ndev)); -+ ret = -EBUSY; -+ goto out; -+ } -+ -+ mon_ndev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); -+ if (!mon_ndev) { -+ RTW_INFO(FUNC_ADPT_FMT" allocate ndev fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ mon_ndev->type = ARPHRD_IEEE80211_RADIOTAP; -+ strncpy(mon_ndev->name, name, IFNAMSIZ); -+ mon_ndev->name[IFNAMSIZ - 1] = 0; -+ mon_ndev->priv_destructor = rtw_ndev_destructor; -+ mon_ndev->needs_free_netdev = true; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+ mon_ndev->netdev_ops = &rtw_cfg80211_monitor_if_ops; -+#else -+ mon_ndev->open = rtw_cfg80211_monitor_if_open; -+ mon_ndev->stop = rtw_cfg80211_monitor_if_close; -+ mon_ndev->hard_start_xmit = rtw_cfg80211_monitor_if_xmit_entry; -+ mon_ndev->set_mac_address = rtw_cfg80211_monitor_if_set_mac_address; -+#endif -+ -+ pnpi = netdev_priv(mon_ndev); -+ pnpi->priv = padapter; -+ pnpi->sizeof_priv = sizeof(_adapter); -+ -+ /* wdev */ -+ mon_wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); -+ if (!mon_wdev) { -+ RTW_INFO(FUNC_ADPT_FMT" allocate mon_wdev fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ mon_wdev->wiphy = padapter->rtw_wdev->wiphy; -+ mon_wdev->netdev = mon_ndev; -+ mon_wdev->iftype = NL80211_IFTYPE_MONITOR; -+ mon_ndev->ieee80211_ptr = mon_wdev; -+ -+ ret = register_netdevice(mon_ndev); -+ if (ret) -+ goto out; -+ -+ *ndev = pwdev_priv->pmon_ndev = mon_ndev; -+ _rtw_memcpy(pwdev_priv->ifname_mon, name, IFNAMSIZ + 1); -+ -+out: -+ if (ret && mon_wdev) { -+ rtw_mfree((u8 *)mon_wdev, sizeof(struct wireless_dev)); -+ mon_wdev = NULL; -+ } -+ -+ if (ret && mon_ndev) { -+ free_netdev(mon_ndev); -+ *ndev = mon_ndev = NULL; -+ } -+ -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+static struct wireless_dev * -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) -+static struct net_device * -+#else -+static int -+#endif -+ cfg80211_rtw_add_virtual_intf( -+ struct wiphy *wiphy, -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 7, 0)) -+ const char *name, -+ #else -+ char *name, -+ #endif -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ unsigned char name_assign_type, -+ #endif -+ enum nl80211_iftype type, struct vif_params *params) -+{ -+ int ret = 0; -+ struct wireless_dev *wdev = NULL; -+ struct net_device *ndev = NULL; -+ _adapter *padapter; -+ struct dvobj_priv *dvobj = wiphy_to_dvobj(wiphy); -+ -+ rtw_set_rtnl_lock_holder(dvobj, current); -+ -+ RTW_INFO(FUNC_WIPHY_FMT" name:%s, type:%d\n", FUNC_WIPHY_ARG(wiphy), name, type); -+ -+ switch (type) { -+ case NL80211_IFTYPE_MONITOR: -+ padapter = wiphy_to_adapter(wiphy); /* TODO: get ap iface ? */ -+ ret = rtw_cfg80211_add_monitor_if(padapter, (char *)name, &ndev); -+ if (ret == 0) -+ wdev = ndev->ieee80211_ptr; -+ break; -+ -+#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) -+ case NL80211_IFTYPE_P2P_CLIENT: -+ case NL80211_IFTYPE_P2P_GO: -+#endif -+ case NL80211_IFTYPE_STATION: -+ case NL80211_IFTYPE_AP: -+ padapter = dvobj_get_unregisterd_adapter(dvobj); -+ if (!padapter) { -+ RTW_WARN("adapter pool empty!\n"); -+ ret = -ENODEV; -+ break; -+ } -+ if (rtw_os_ndev_init(padapter, name) != _SUCCESS) { -+ RTW_WARN("ndev init fail!\n"); -+ ret = -ENODEV; -+ break; -+ } -+ #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) -+ if (type == NL80211_IFTYPE_P2P_CLIENT || type == NL80211_IFTYPE_P2P_GO) -+ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); -+ #endif -+ ndev = padapter->pnetdev; -+ wdev = ndev->ieee80211_ptr; -+ break; -+ -+#if defined(CONFIG_P2P) && defined(RTW_DEDICATED_P2P_DEVICE) -+ case NL80211_IFTYPE_P2P_DEVICE: -+ ret = rtw_pd_iface_alloc(wiphy, name, &wdev); -+ break; -+#endif -+ -+ case NL80211_IFTYPE_ADHOC: -+ case NL80211_IFTYPE_AP_VLAN: -+ case NL80211_IFTYPE_WDS: -+ case NL80211_IFTYPE_MESH_POINT: -+ default: -+ ret = -ENODEV; -+ RTW_INFO("Unsupported interface type\n"); -+ break; -+ } -+ -+ if (ndev) -+ RTW_INFO(FUNC_WIPHY_FMT" ndev:%p, ret:%d\n", FUNC_WIPHY_ARG(wiphy), ndev, ret); -+ else -+ RTW_INFO(FUNC_WIPHY_FMT" wdev:%p, ret:%d\n", FUNC_WIPHY_ARG(wiphy), wdev, ret); -+ -+ rtw_set_rtnl_lock_holder(dvobj, NULL); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ return wdev ? wdev : ERR_PTR(ret); -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) -+ return ndev ? ndev : ERR_PTR(ret); -+#else -+ return ret; -+#endif -+} -+ -+static int cfg80211_rtw_del_virtual_intf(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ struct wireless_dev *wdev -+#else -+ struct net_device *ndev -+#endif -+) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ struct net_device *ndev = wdev_to_ndev(wdev); -+#endif -+ int ret = 0; -+ struct dvobj_priv *dvobj = wiphy_to_dvobj(wiphy); -+ _adapter *adapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ rtw_set_rtnl_lock_holder(dvobj, current); -+ -+ if (ndev) { -+ adapter = (_adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(adapter); -+ -+ if (ndev == pwdev_priv->pmon_ndev) { -+ unregister_netdevice(ndev); -+ pwdev_priv->pmon_ndev = NULL; -+ pwdev_priv->ifname_mon[0] = '\0'; -+ RTW_INFO(FUNC_NDEV_FMT" remove monitor ndev\n", FUNC_NDEV_ARG(ndev)); -+ } else { -+ RTW_INFO(FUNC_NDEV_FMT" unregister ndev\n", FUNC_NDEV_ARG(ndev)); -+ rtw_os_ndev_unregister(adapter); -+ } -+ } else -+#if defined(CONFIG_P2P) && defined(RTW_DEDICATED_P2P_DEVICE) -+ if (wdev->iftype == NL80211_IFTYPE_P2P_DEVICE) { -+ if (wdev == wiphy_to_pd_wdev(wiphy)) -+ rtw_pd_iface_free(wiphy); -+ else { -+ RTW_ERR(FUNC_WIPHY_FMT" unknown P2P Device wdev:%p\n", FUNC_WIPHY_ARG(wiphy), wdev); -+ rtw_warn_on(1); -+ } -+ } else -+#endif -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+exit: -+ rtw_set_rtnl_lock_holder(dvobj, NULL); -+ return ret; -+} -+ -+static int rtw_add_beacon(_adapter *adapter, const u8 *head, size_t head_len, const u8 *tail, size_t tail_len) -+{ -+ int ret = 0; -+ u8 *pbuf = NULL; -+ uint len, wps_ielen = 0; -+ uint p2p_ielen = 0; -+ u8 *p2p_ie; -+ u8 got_p2p_ie = _FALSE; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ /* struct sta_priv *pstapriv = &padapter->stapriv; */ -+ -+ -+ RTW_INFO("%s beacon_head_len=%zu, beacon_tail_len=%zu\n", __FUNCTION__, head_len, tail_len); -+ -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return -EINVAL; -+ -+ if (head_len < 24) -+ return -EINVAL; -+ -+ -+ pbuf = rtw_zmalloc(head_len + tail_len); -+ if (!pbuf) -+ return -ENOMEM; -+ -+ -+ /* _rtw_memcpy(&pstapriv->max_num_sta, param->u.bcn_ie.reserved, 2); */ -+ -+ /* if((pstapriv->max_num_sta>NUM_STA) || (pstapriv->max_num_sta<=0)) */ -+ /* pstapriv->max_num_sta = NUM_STA; */ -+ -+ -+ _rtw_memcpy(pbuf, (void *)head + 24, head_len - 24); /* 24=beacon header len. */ -+ _rtw_memcpy(pbuf + head_len - 24, (void *)tail, tail_len); -+ -+ len = head_len + tail_len - 24; -+ -+ /* check wps ie if inclued */ -+ if (rtw_get_wps_ie(pbuf + _FIXED_IE_LENGTH_, len - _FIXED_IE_LENGTH_, NULL, &wps_ielen)) -+ RTW_INFO("add bcn, wps_ielen=%d\n", wps_ielen); -+ -+#ifdef CONFIG_P2P -+ if (adapter->wdinfo.driver_interface == DRIVER_CFG80211) { -+ /* check p2p if enable */ -+ if (rtw_get_p2p_ie(pbuf + _FIXED_IE_LENGTH_, len - _FIXED_IE_LENGTH_, NULL, &p2p_ielen)) { -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); -+ -+ RTW_INFO("got p2p_ie, len=%d\n", p2p_ielen); -+ -+ got_p2p_ie = _TRUE; -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ RTW_INFO("Enable P2P function for the first time\n"); -+ rtw_p2p_enable(adapter, P2P_ROLE_GO); -+ -+ adapter->stapriv.expire_to = 3; /* 3x2 = 6 sec in p2p mode */ -+ } else { -+ RTW_INFO("enter GO Mode, p2p_ielen=%d\n", p2p_ielen); -+ -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ pwdinfo->intent = 15; -+ } -+ } -+ } -+#endif /* CONFIG_P2P */ -+ -+ /* pbss_network->IEs will not include p2p_ie, wfd ie */ -+ rtw_ies_remove_ie(pbuf, &len, _BEACON_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, P2P_OUI, 4); -+ rtw_ies_remove_ie(pbuf, &len, _BEACON_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, WFD_OUI, 4); -+ -+ if (rtw_check_beacon_data(adapter, pbuf, len) == _SUCCESS) { -+#ifdef CONFIG_P2P -+ /* check p2p if enable */ -+ if (got_p2p_ie == _TRUE) { -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); -+ pwdinfo->operating_channel = pmlmeext->cur_channel; -+ } -+#endif /* CONFIG_P2P */ -+ ret = 0; -+ } else -+ ret = -EINVAL; -+ -+ -+ rtw_mfree(pbuf, head_len + tail_len); -+ -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) && !defined(COMPAT_KERNEL_RELEASE) -+static int cfg80211_rtw_add_beacon(struct wiphy *wiphy, struct net_device *ndev, -+ struct beacon_parameters *info) -+{ -+ int ret = 0; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_set_beacon(struct wiphy *wiphy, struct net_device *ndev, -+ struct beacon_parameters *info) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ pmlmeext->bstart_bss = _TRUE; -+ -+ cfg80211_rtw_add_beacon(wiphy, ndev, info); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_del_beacon(struct wiphy *wiphy, struct net_device *ndev) -+{ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+#else -+static int cfg80211_rtw_start_ap(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_ap_settings *settings) -+{ -+ int ret = 0; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ RTW_INFO(FUNC_NDEV_FMT" hidden_ssid:%d, auth_type:%d\n", FUNC_NDEV_ARG(ndev), -+ settings->hidden_ssid, settings->auth_type); -+ -+ ret = rtw_add_beacon(adapter, settings->beacon.head, settings->beacon.head_len, -+ settings->beacon.tail, settings->beacon.tail_len); -+ -+ adapter->mlmeextpriv.mlmext_info.hidden_ssid_mode = settings->hidden_ssid; -+ -+ if (settings->ssid && settings->ssid_len) { -+ WLAN_BSSID_EX *pbss_network = &adapter->mlmepriv.cur_network.network; -+ WLAN_BSSID_EX *pbss_network_ext = &adapter->mlmeextpriv.mlmext_info.network; -+ -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" ssid:(%s,%zu), from ie:(%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ settings->ssid, settings->ssid_len, -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength); -+ -+ _rtw_memcpy(pbss_network->Ssid.Ssid, (void *)settings->ssid, settings->ssid_len); -+ pbss_network->Ssid.SsidLength = settings->ssid_len; -+ _rtw_memcpy(pbss_network_ext->Ssid.Ssid, (void *)settings->ssid, settings->ssid_len); -+ pbss_network_ext->Ssid.SsidLength = settings->ssid_len; -+ -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, -+ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); -+ } -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_change_beacon(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_beacon_data *info) -+{ -+ int ret = 0; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_stop_ap(struct wiphy *wiphy, struct net_device *ndev) -+{ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) */ -+ -+#if CONFIG_RTW_MACADDR_ACL && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+static int cfg80211_rtw_set_mac_acl(struct wiphy *wiphy, struct net_device *ndev, -+ const struct cfg80211_acl_data *params) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); -+ u8 acl_mode = RTW_ACL_MODE_DISABLED; -+ int ret = -1; -+ int i; -+ -+ if (!params) { -+ RTW_WARN(FUNC_ADPT_FMT" params NULL\n", FUNC_ADPT_ARG(adapter)); -+ goto exit; -+ } -+ -+ RTW_INFO(FUNC_ADPT_FMT" acl_policy:%d, entry_num:%d\n" -+ , FUNC_ADPT_ARG(adapter), params->acl_policy, params->n_acl_entries); -+ -+ if (params->acl_policy == NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED) -+ acl_mode = RTW_ACL_MODE_ACCEPT_UNLESS_LISTED; -+ else if (params->acl_policy == NL80211_ACL_POLICY_DENY_UNLESS_LISTED) -+ acl_mode = RTW_ACL_MODE_DENY_UNLESS_LISTED; -+ -+ if (!params->n_acl_entries) { -+ if (acl_mode != RTW_ACL_MODE_DISABLED) -+ RTW_WARN(FUNC_ADPT_FMT" acl_policy:%d with no entry\n" -+ , FUNC_ADPT_ARG(adapter), params->acl_policy); -+ acl_mode = RTW_ACL_MODE_DISABLED; -+ goto exit; -+ } -+ -+ for (i = 0; i < params->n_acl_entries; i++) -+ rtw_acl_add_sta(adapter, params->mac_addrs[i].addr); -+ -+ ret = 0; -+ -+exit: -+ rtw_set_macaddr_acl(adapter, acl_mode); -+ return ret; -+} -+#endif /* CONFIG_RTW_MACADDR_ACL && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) */ -+ -+static int cfg80211_rtw_add_station(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0)) -+ u8 *mac, -+#else -+ const u8 *mac, -+#endif -+ struct station_parameters *params) -+{ -+ int ret = 0; -+#ifdef CONFIG_TDLS -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+#endif /* CONFIG_TDLS */ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+#ifdef CONFIG_TDLS -+ psta = rtw_get_stainfo(pstapriv, (u8 *)mac); -+ if (psta == NULL) { -+ psta = rtw_alloc_stainfo(pstapriv, (u8 *)mac); -+ if (psta == NULL) { -+ RTW_INFO("[%s] Alloc station for "MAC_FMT" fail\n", __FUNCTION__, MAC_ARG(mac)); -+ ret = -EOPNOTSUPP; -+ goto exit; -+ } -+ } -+#endif /* CONFIG_TDLS */ -+ -+exit: -+ return ret; -+} -+ -+static int cfg80211_rtw_del_station(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0)) -+ u8 *mac -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 0)) -+ const u8 *mac -+#else -+ struct station_del_parameters *params -+#endif -+) -+{ -+ int ret = 0; -+ _irqL irqL; -+ _list *phead, *plist; -+ u8 updated = _FALSE; -+ const u8 *target_mac; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ RTW_INFO("+"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 0)) -+ target_mac = mac; -+#else -+ target_mac = params->mac; -+#endif -+ -+ if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE) { -+ RTW_INFO("%s, fw_state != FW_LINKED|WIFI_AP_STATE\n", __func__); -+ return -EINVAL; -+ } -+ -+ -+ if (!target_mac) { -+ RTW_INFO("flush all sta, and cam_entry\n"); -+ -+ flush_all_cam_entry(padapter); /* clear CAM */ -+ -+ ret = rtw_sta_flush(padapter, _TRUE); -+ -+ return ret; -+ } -+ -+ -+ RTW_INFO("free sta macaddr =" MAC_FMT "\n", MAC_ARG(target_mac)); -+ -+ if (target_mac[0] == 0xff && target_mac[1] == 0xff && -+ target_mac[2] == 0xff && target_mac[3] == 0xff && -+ target_mac[4] == 0xff && target_mac[5] == 0xff) -+ return -EINVAL; -+ -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* check asoc_queue */ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ if (_rtw_memcmp((u8 *)target_mac, psta->hwaddr, ETH_ALEN)) { -+ if (psta->dot8021xalg == 1 && psta->bpairwise_key_installed == _FALSE) -+ RTW_INFO("%s, sta's dot8021xalg = 1 and key_installed = _FALSE\n", __func__); -+ else { -+ RTW_INFO("free psta=%p, aid=%d\n", psta, psta->aid); -+ -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ -+ /* _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); */ -+ if (check_fwstate(pmlmepriv, (WIFI_AP_STATE)) == _TRUE) -+ updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); -+ else -+ updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); -+ /* _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); */ -+ -+ psta = NULL; -+ -+ break; -+ } -+ -+ } -+ -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); -+ -+ RTW_INFO("-"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_change_station(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0)) -+ u8 *mac, -+#else -+ const u8 *mac, -+#endif -+ struct station_parameters *params) -+{ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+ -+struct sta_info *rtw_sta_info_get_by_idx(const int idx, struct sta_priv *pstapriv) -+ -+{ -+ -+ _list *phead, *plist; -+ struct sta_info *psta = NULL; -+ int i = 0; -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* check asoc_queue */ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ if (idx == i) -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ i++; -+ } -+ return psta; -+} -+ -+static int cfg80211_rtw_dump_station(struct wiphy *wiphy, struct net_device *ndev, -+ int idx, u8 *mac, struct station_info *sinfo) -+{ -+ -+ int ret = 0; -+ _irqL irqL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ psta = rtw_sta_info_get_by_idx(idx, pstapriv); -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (NULL == psta) { -+ RTW_INFO("Station is not found\n"); -+ ret = -ENOENT; -+ goto exit; -+ } -+ _rtw_memcpy(mac, psta->hwaddr, ETH_ALEN); -+ sinfo->filled = 0; -+ sinfo->filled |= STATION_INFO_SIGNAL; -+ sinfo->signal = psta->rssi; -+ -+exit: -+ return ret; -+} -+ -+static int cfg80211_rtw_change_bss(struct wiphy *wiphy, struct net_device *ndev, -+ struct bss_parameters *params) -+{ -+ u8 i; -+ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+/* -+ RTW_INFO("use_cts_prot=%d\n", params->use_cts_prot); -+ RTW_INFO("use_short_preamble=%d\n", params->use_short_preamble); -+ RTW_INFO("use_short_slot_time=%d\n", params->use_short_slot_time); -+ RTW_INFO("ap_isolate=%d\n", params->ap_isolate); -+ -+ RTW_INFO("basic_rates_len=%d\n", params->basic_rates_len); -+ for(i = 0; i < params->basic_rates_len; i++) -+ RTW_INFO("basic_rates=%d\n", params->basic_rates[i]); -+*/ -+ return 0; -+ -+} -+ -+static int cfg80211_rtw_set_channel(struct wiphy *wiphy -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ , struct net_device *ndev -+ #endif -+ , struct ieee80211_channel *chan, enum nl80211_channel_type channel_type) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+#else -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+#endif -+ int chan_target = (u8) ieee80211_frequency_to_channel(chan->center_freq); -+ int chan_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ int chan_width = CHANNEL_WIDTH_20; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+#endif -+ -+ switch (channel_type) { -+ case NL80211_CHAN_NO_HT: -+ case NL80211_CHAN_HT20: -+ chan_width = CHANNEL_WIDTH_20; -+ chan_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case NL80211_CHAN_HT40MINUS: -+ chan_width = CHANNEL_WIDTH_40; -+ chan_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ case NL80211_CHAN_HT40PLUS: -+ chan_width = CHANNEL_WIDTH_40; -+ chan_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ default: -+ chan_width = CHANNEL_WIDTH_20; -+ chan_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ -+ set_channel_bwmode(padapter, chan_target, chan_offset, chan_width); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_set_monitor_channel(struct wiphy *wiphy -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ , struct cfg80211_chan_def *chandef -+#else -+ , struct ieee80211_channel *chan -+ , enum nl80211_channel_type channel_type -+#endif -+) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ struct ieee80211_channel *chan = chandef->chan; -+#endif -+ -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ int target_channal = chan->hw_value; -+ int target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ int target_width = CHANNEL_WIDTH_20; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("center_freq %u Mhz ch %u width %u freq1 %u freq2 %u\n" -+ , chan->center_freq -+ , chan->hw_value -+ , chandef->width -+ , chandef->center_freq1 -+ , chandef->center_freq2); -+#endif /* CONFIG_DEBUG_CFG80211 */ -+ -+ switch (chandef->width) { -+ case NL80211_CHAN_WIDTH_20_NOHT: -+ case NL80211_CHAN_WIDTH_20: -+ target_width = CHANNEL_WIDTH_20; -+ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case NL80211_CHAN_WIDTH_40: -+ target_width = CHANNEL_WIDTH_40; -+ if (chandef->center_freq1 > chan->center_freq) -+ target_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else -+ target_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ case NL80211_CHAN_WIDTH_80: -+ target_width = CHANNEL_WIDTH_80; -+ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case NL80211_CHAN_WIDTH_80P80: -+ target_width = CHANNEL_WIDTH_80_80; -+ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case NL80211_CHAN_WIDTH_160: -+ target_width = CHANNEL_WIDTH_160; -+ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ case NL80211_CHAN_WIDTH_5: -+ case NL80211_CHAN_WIDTH_10: -+#endif -+ default: -+ target_width = CHANNEL_WIDTH_20; -+ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+#else -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("center_freq %u Mhz ch %u channel_type %u\n" -+ , chan->center_freq -+ , chan->hw_value -+ , channel_type); -+#endif /* CONFIG_DEBUG_CFG80211 */ -+ -+ switch (channel_type) { -+ case NL80211_CHAN_NO_HT: -+ case NL80211_CHAN_HT20: -+ target_width = CHANNEL_WIDTH_20; -+ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ case NL80211_CHAN_HT40MINUS: -+ target_width = CHANNEL_WIDTH_40; -+ target_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ case NL80211_CHAN_HT40PLUS: -+ target_width = CHANNEL_WIDTH_40; -+ target_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ default: -+ target_width = CHANNEL_WIDTH_20; -+ target_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+#endif -+ -+ set_channel_bwmode(padapter, target_channal, target_offset, target_width); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_auth(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_auth_request *req) -+{ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_assoc(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_assoc_request *req) -+{ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+#endif /* CONFIG_AP_MODE */ -+ -+void rtw_cfg80211_rx_probe_request(_adapter *adapter, union recv_frame *rframe) -+{ -+ struct wireless_dev *wdev = adapter->rtw_wdev; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+ u8 *frame = get_recvframe_data(rframe); -+ uint frame_len = rframe->u.hdr.len; -+ s32 freq; -+ u8 ch, sch = rtw_get_oper_ch(adapter); -+ -+ ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; -+ freq = rtw_ch2freq(ch); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("RTW_Rx: probe request, ch=%d(%d)\n", ch, sch); -+#endif -+ -+ rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, frame_len, GFP_ATOMIC); -+} -+ -+void rtw_cfg80211_rx_action_p2p(_adapter *adapter, union recv_frame *rframe) -+{ -+ struct wireless_dev *wdev = adapter->rtw_wdev; -+ u8 *frame = get_recvframe_data(rframe); -+ uint frame_len = rframe->u.hdr.len; -+ s32 freq; -+ u8 ch, sch = rtw_get_oper_ch(adapter); -+ u8 category, action; -+ int type; -+ -+ ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; -+ freq = rtw_ch2freq(ch); -+ -+ RTW_INFO("RTW_Rx:ch=%d(%d)\n", ch, sch); -+#ifdef CONFIG_P2P -+ type = rtw_p2p_check_frames(adapter, frame, frame_len, _FALSE); -+ if (type >= 0) -+ goto indicate; -+#endif -+ rtw_action_frame_parse(frame, frame_len, &category, &action); -+ RTW_INFO("RTW_Rx:category(%u), action(%u)\n", category, action); -+ -+indicate: -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, frame_len, GFP_ATOMIC); -+#else -+ cfg80211_rx_action(adapter->pnetdev, freq, frame, frame_len, GFP_ATOMIC); -+#endif -+} -+ -+void rtw_cfg80211_rx_p2p_action_public(_adapter *adapter, union recv_frame *rframe) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct wireless_dev *wdev = adapter->rtw_wdev; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+ u8 *frame = get_recvframe_data(rframe); -+ uint frame_len = rframe->u.hdr.len; -+ s32 freq; -+ u8 ch, sch = rtw_get_oper_ch(adapter); -+ u8 category, action; -+ int type; -+ -+ ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; -+ freq = rtw_ch2freq(ch); -+ -+ RTW_INFO("RTW_Rx:ch=%d(%d)\n", ch, sch); -+ #ifdef CONFIG_P2P -+ type = rtw_p2p_check_frames(adapter, frame, frame_len, _FALSE); -+ if (type >= 0) { -+ switch (type) { -+ case P2P_GO_NEGO_CONF: -+ if (0) { -+ RTW_INFO(FUNC_ADPT_FMT" Nego confirm. state=%u, status=%u, iaddr="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), pwdev_priv->nego_info.state, pwdev_priv->nego_info.status -+ , MAC_ARG(pwdev_priv->nego_info.iface_addr)); -+ } -+ if (pwdev_priv->nego_info.state == 2 -+ && pwdev_priv->nego_info.status == 0 -+ && rtw_check_invalid_mac_address(pwdev_priv->nego_info.iface_addr, _FALSE) == _FALSE -+ ) { -+ _adapter *intended_iface = dvobj_get_adapter_by_addr(dvobj, pwdev_priv->nego_info.iface_addr); -+ -+ if (intended_iface) { -+ RTW_INFO(FUNC_ADPT_FMT" Nego confirm. Allow only "ADPT_FMT" to scan for 2000 ms\n" -+ , FUNC_ADPT_ARG(adapter), ADPT_ARG(intended_iface)); -+ /* allow only intended_iface to do scan for 2000 ms */ -+ rtw_mi_set_scan_deny(adapter, 2000); -+ rtw_clear_scan_deny(intended_iface); -+ } -+ } -+ break; -+ case P2P_PROVISION_DISC_RESP: -+ case P2P_INVIT_RESP: -+ #if !RTW_P2P_GROUP_INTERFACE -+ rtw_mi_buddy_set_scan_deny(adapter, 2000); -+ #endif -+ break; -+ } -+ goto indicate; -+ } -+ #endif -+ rtw_action_frame_parse(frame, frame_len, &category, &action); -+ RTW_INFO("RTW_Rx:category(%u), action(%u)\n", category, action); -+ -+indicate: -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ if (rtw_cfg80211_redirect_pd_wdev(dvobj_to_wiphy(dvobj), get_ra(frame), &wdev)) -+ if (0) -+ RTW_INFO("redirect to pd_wdev:%p\n", wdev); -+ #endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, frame_len, GFP_ATOMIC); -+#else -+ cfg80211_rx_action(adapter->pnetdev, freq, frame, frame_len, GFP_ATOMIC); -+#endif -+} -+ -+void rtw_cfg80211_rx_action(_adapter *adapter, union recv_frame *rframe, const char *msg) -+{ -+ struct wireless_dev *wdev = adapter->rtw_wdev; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); -+ u8 *frame = get_recvframe_data(rframe); -+ uint frame_len = rframe->u.hdr.len; -+ s32 freq; -+ u8 ch, sch = rtw_get_oper_ch(adapter); -+ u8 category, action; -+ -+ ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; -+ freq = rtw_ch2freq(ch); -+ -+ rtw_action_frame_parse(frame, frame_len, &category, &action); -+ -+ if (action == ACT_PUBLIC_GAS_INITIAL_REQ) { -+ rtw_mi_set_scan_deny(adapter, 200); -+ rtw_mi_scan_abort(adapter, _FALSE); /*rtw_scan_abort_no_wait*/ -+ } -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, frame_len, GFP_ATOMIC); -+#else -+ cfg80211_rx_action(adapter->pnetdev, freq, frame, frame_len, GFP_ATOMIC); -+#endif -+ -+ RTW_INFO("RTW_Rx:ch=%d(%d)\n", ch, sch); -+ if (msg) -+ RTW_INFO("RTW_Rx:%s\n", msg); -+ else -+ RTW_INFO("RTW_Rx:category(%u), action(%u)\n", category, action); -+} -+ -+#ifdef CONFIG_P2P -+void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, size_t len) -+{ -+ u16 wps_devicepassword_id = 0x0000; -+ uint wps_devicepassword_id_len = 0; -+ u8 wpsie[255] = { 0x00 }, p2p_ie[255] = { 0x00 }; -+ uint p2p_ielen = 0; -+ uint wpsielen = 0; -+ u32 devinfo_contentlen = 0; -+ u8 devinfo_content[64] = { 0x00 }; -+ u16 capability = 0; -+ uint capability_len = 0; -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u8 dialogToken = 1; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_PROVISION_DISC_REQ; -+ u32 p2pielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 *frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ size_t frame_body_len = len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ -+ RTW_INFO("[%s] In\n", __FUNCTION__); -+ -+ /* prepare for building provision_request frame */ -+ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerIFAddr, GetAddr1Ptr(buf), ETH_ALEN); -+ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerDevAddr, GetAddr1Ptr(buf), ETH_ALEN); -+ -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; -+ -+ rtw_get_wps_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, wpsie, &wpsielen); -+ rtw_get_wps_attr_content(wpsie, wpsielen, WPS_ATTR_DEVICE_PWID, (u8 *) &wps_devicepassword_id, &wps_devicepassword_id_len); -+ wps_devicepassword_id = be16_to_cpu(wps_devicepassword_id); -+ -+ switch (wps_devicepassword_id) { -+ case WPS_DPID_PIN: -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_LABEL; -+ break; -+ case WPS_DPID_USER_SPEC: -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_DISPLYA; -+ break; -+ case WPS_DPID_MACHINE_SPEC: -+ break; -+ case WPS_DPID_REKEY: -+ break; -+ case WPS_DPID_PBC: -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; -+ break; -+ case WPS_DPID_REGISTRAR_SPEC: -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_KEYPAD; -+ break; -+ default: -+ break; -+ } -+ -+ -+ if (rtw_get_p2p_ie(frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, p2p_ie, &p2p_ielen)) { -+ -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO, devinfo_content, &devinfo_contentlen); -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8 *)&capability, &capability_len); -+ -+ } -+ -+ -+ /* start to build provision_request frame */ -+ _rtw_memset(wpsie, 0, sizeof(wpsie)); -+ _rtw_memset(p2p_ie, 0, sizeof(p2p_ie)); -+ p2p_ielen = 0; -+ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) -+ return; -+ -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, pwdinfo->tx_prov_disc_info.peerDevAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->tx_prov_disc_info.peerDevAddr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ -+ /* build_prov_disc_request_p2p_ie */ -+ /* P2P OUI */ -+ p2pielen = 0; -+ p2p_ie[p2pielen++] = 0x50; -+ p2p_ie[p2pielen++] = 0x6F; -+ p2p_ie[p2pielen++] = 0x9A; -+ p2p_ie[p2pielen++] = 0x09; /* WFA P2P v1.0 */ -+ -+ /* Commented by Albert 20110301 */ -+ /* According to the P2P Specification, the provision discovery request frame should contain 3 P2P attributes */ -+ /* 1. P2P Capability */ -+ /* 2. Device Info */ -+ /* 3. Group ID ( When joining an operating P2P Group ) */ -+ -+ /* P2P Capability ATTR */ -+ /* Type: */ -+ p2p_ie[p2pielen++] = P2P_ATTR_CAPABILITY; -+ -+ /* Length: */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); */ -+ RTW_PUT_LE16(p2p_ie + p2pielen, 0x0002); -+ p2pielen += 2; -+ -+ /* Value: */ -+ /* Device Capability Bitmap, 1 byte */ -+ /* Group Capability Bitmap, 1 byte */ -+ _rtw_memcpy(p2p_ie + p2pielen, &capability, 2); -+ p2pielen += 2; -+ -+ -+ /* Device Info ATTR */ -+ /* Type: */ -+ p2p_ie[p2pielen++] = P2P_ATTR_DEVICE_INFO; -+ -+ /* Length: */ -+ /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ -+ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ -+ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); */ -+ RTW_PUT_LE16(p2p_ie + p2pielen, devinfo_contentlen); -+ p2pielen += 2; -+ -+ /* Value: */ -+ _rtw_memcpy(p2p_ie + p2pielen, devinfo_content, devinfo_contentlen); -+ p2pielen += devinfo_contentlen; -+ -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2p_ie, &p2p_ielen); -+ /* p2pielen = build_prov_disc_request_p2p_ie( pwdinfo, pframe, NULL, 0, pwdinfo->tx_prov_disc_info.peerDevAddr); */ -+ /* pframe += p2pielen; */ -+ pattrib->pktlen += p2p_ielen; -+ -+ wpsielen = 0; -+ /* WPS OUI */ -+ *(u32 *)(wpsie) = cpu_to_be32(WPSOUI); -+ wpsielen += 4; -+ -+ /* WPS version */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_VER1); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0001); -+ wpsielen += 2; -+ -+ /* Value: */ -+ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ -+ -+ /* Config Method */ -+ /* Type: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_CONF_METHOD); -+ wpsielen += 2; -+ -+ /* Length: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0002); -+ wpsielen += 2; -+ -+ /* Value: */ -+ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(pwdinfo->tx_prov_disc_info.wps_config_method_request); -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen); -+ -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_provdisc_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ /* dump_mgntframe(padapter, pmgntframe); */ -+ if (dump_mgntframe_and_wait_ack(padapter, pmgntframe) != _SUCCESS) -+ RTW_INFO("%s, ack to\n", __func__); -+ -+ #if 0 -+ if(wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) { -+ RTW_INFO("waiting for p2p peer key-in PIN CODE\n"); -+ rtw_msleep_os(15000); /* 15 sec for key in PIN CODE, workaround for GS2 before issuing Nego Req. */ -+ } -+ #endif -+ -+} -+ -+#ifdef CONFIG_RTW_80211R -+static s32 cfg80211_rtw_update_ft_ies(struct wiphy *wiphy, -+ struct net_device *ndev, -+ struct cfg80211_update_ft_ies_params *ftie) -+{ -+ _adapter *padapter = NULL; -+ struct mlme_priv *pmlmepriv = NULL; -+ ft_priv *pftpriv = NULL; -+ _irqL irqL; -+ u8 *p; -+ u8 *pie = NULL; -+ u32 ie_len = 0; -+ -+ if (ndev == NULL) -+ return -EINVAL; -+ -+ padapter = (_adapter *)rtw_netdev_priv(ndev); -+ pmlmepriv = &(padapter->mlmepriv); -+ pftpriv = &pmlmepriv->ftpriv; -+ -+ p = (u8 *)ftie->ie; -+ if (ftie->ie_len <= sizeof(pftpriv->updated_ft_ies)) { -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ _rtw_memcpy(pftpriv->updated_ft_ies, ftie->ie, ftie->ie_len); -+ pftpriv->updated_ft_ies_len = ftie->ie_len; -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ } else { -+ RTW_ERR("FTIEs parsing fail!\n"); -+ return -EINVAL; -+ } -+ -+ if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_status(padapter, RTW_FT_AUTHENTICATED_STA)) { -+ RTW_PRINT("auth success, start reassoc\n"); -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ rtw_set_ft_status(padapter, RTW_FT_ASSOCIATING_STA); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ start_clnt_assoc(padapter); -+ } -+ -+ return 0; -+} -+#endif -+ -+inline void rtw_cfg80211_set_is_roch(_adapter *adapter, bool val) -+{ -+ adapter->cfg80211_wdinfo.is_ro_ch = val; -+ rtw_mi_update_iface_status(&(adapter->mlmepriv), 0); -+} -+ -+inline bool rtw_cfg80211_get_is_roch(_adapter *adapter) -+{ -+ return adapter->cfg80211_wdinfo.is_ro_ch; -+} -+ -+static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ struct wireless_dev *wdev, -+#else -+ struct net_device *ndev, -+#endif -+ struct ieee80211_channel *channel, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+ enum nl80211_channel_type channel_type, -+#endif -+ unsigned int duration, u64 *cookie) -+{ -+ s32 err = 0; -+ u8 remain_ch = (u8) ieee80211_frequency_to_channel(channel->center_freq); -+ u8 union_ch = 0, union_bw = 0, union_offset = 0; -+ u8 i; -+ u8 ready_on_channel = _FALSE; -+ _adapter *padapter = NULL; -+ _adapter *iface; -+ struct dvobj_priv *dvobj; -+ struct rtw_wdev_priv *pwdev_priv; -+ struct mlme_ext_priv *pmlmeext; -+ struct wifidirect_info *pwdinfo; -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo; -+ u8 is_p2p_find = _FALSE; -+ -+#ifndef CONFIG_RADIO_WORK -+#define RTW_ROCH_DURATION_ENLARGE -+#define RTW_ROCH_BACK_OP -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ if (wdev == wiphy_to_pd_wdev(wiphy)) -+ padapter = wiphy_to_adapter(wiphy); -+ else -+ #endif -+ if (wdev_to_ndev(wdev)) -+ padapter = (_adapter *)rtw_netdev_priv(wdev_to_ndev(wdev)); -+ else { -+ err = -EINVAL; -+ goto exit; -+ } -+#else -+ struct wireless_dev *wdev; -+ -+ if (ndev == NULL) { -+ err = -EINVAL; -+ goto exit; -+ } -+ padapter = (_adapter *)rtw_netdev_priv(ndev); -+ wdev = ndev_to_wdev(ndev); -+#endif -+ -+ dvobj = adapter_to_dvobj(padapter); -+ pwdev_priv = adapter_wdev_data(padapter); -+ pmlmeext = &padapter->mlmeextpriv; -+ pwdinfo = &padapter->wdinfo; -+ pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+#ifdef CONFIG_CONCURRENT_MODE -+ is_p2p_find = (duration < (pwdinfo->ext_listen_interval)) ? _TRUE : _FALSE; -+#endif -+ -+ *cookie = ATOMIC_INC_RETURN(&pcfg80211_wdinfo->ro_ch_cookie_gen); -+ -+ RTW_INFO(FUNC_ADPT_FMT"%s ch:%u duration:%d, cookie:0x%llx\n" -+ , FUNC_ADPT_ARG(padapter), wdev == wiphy_to_pd_wdev(wiphy) ? " PD" : "" -+ , remain_ch, duration, *cookie); -+ -+ if (rtw_ch_set_search_ch(pmlmeext->channel_set, remain_ch) < 0) { -+ RTW_WARN(FUNC_ADPT_FMT" invalid ch:%u\n", FUNC_ADPT_ARG(padapter), remain_ch); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_mi_mp_mode_check(padapter)) { -+ RTW_INFO("MP mode block remain_on_channel request\n"); -+ err = -EFAULT; -+ goto exit; -+ } -+#endif -+ -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ rtw_scan_abort(padapter); -+#ifdef CONFIG_CONCURRENT_MODE -+ /*don't scan_abort during p2p_listen.*/ -+ if (is_p2p_find) -+ rtw_mi_buddy_scan_abort(padapter, _TRUE); -+#endif /*CONFIG_CONCURRENT_MODE*/ -+ -+ if (rtw_cfg80211_get_is_roch(padapter) == _TRUE) { -+ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); -+ p2p_cancel_roch_cmd(padapter, 0, NULL, RTW_CMDF_WAIT_ACK); -+ } -+ -+ /* if(!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) */ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); -+ padapter->wdinfo.listen_channel = remain_ch; -+ RTW_INFO(FUNC_ADPT_FMT" init listen_channel %u\n" -+ , FUNC_ADPT_ARG(padapter), padapter->wdinfo.listen_channel); -+ } else if (rtw_p2p_chk_state(pwdinfo , P2P_STATE_LISTEN) -+ && (time_after_eq((unsigned long)rtw_get_current_time(), (unsigned long)pwdev_priv->probe_resp_ie_update_time) -+ && rtw_get_passing_time_ms(pwdev_priv->probe_resp_ie_update_time) < 50) -+ ) { -+ if (padapter->wdinfo.listen_channel != remain_ch) { -+ padapter->wdinfo.listen_channel = remain_ch; -+ RTW_INFO(FUNC_ADPT_FMT" update listen_channel %u\n" -+ , FUNC_ADPT_ARG(padapter), padapter->wdinfo.listen_channel); -+ } -+ } else { -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); -+ #endif -+ } -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if (check_fwstate(&iface->mlmepriv, _FW_UNDER_LINKING | WIFI_UNDER_WPS) == _TRUE) { -+ RTW_INFO(ADPT_FMT"- _FW_UNDER_LINKING |WIFI_UNDER_WPS (mlme state:0x%x)\n", ADPT_ARG(iface), get_fwstate(&iface->mlmepriv)); -+ remain_ch = iface->mlmeextpriv.cur_channel; -+ } -+ } -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+ -+ #ifdef RTW_ROCH_DURATION_ENLARGE -+ if (duration < 400) -+ duration = duration * 3; /* extend from exper */ -+ #endif -+ -+#if defined(RTW_ROCH_BACK_OP) && defined(CONFIG_CONCURRENT_MODE) -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ if (is_p2p_find) /* p2p_find , duration<1000 */ -+ duration = duration + pwdinfo->ext_listen_interval; -+ else /* p2p_listen, duration=5000 */ -+ duration = pwdinfo->ext_listen_interval + (pwdinfo->ext_listen_interval / 4); -+ } -+#endif /*defined (RTW_ROCH_BACK_OP) && defined(CONFIG_CONCURRENT_MODE) */ -+ -+ rtw_cfg80211_set_is_roch(padapter, _TRUE); -+ pcfg80211_wdinfo->ro_ch_wdev = wdev; -+ pcfg80211_wdinfo->remain_on_ch_cookie = *cookie; -+ pcfg80211_wdinfo->last_ro_ch_time = rtw_get_current_time(); -+ _rtw_memcpy(&pcfg80211_wdinfo->remain_on_ch_channel, channel, sizeof(struct ieee80211_channel)); -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+ pcfg80211_wdinfo->remain_on_ch_type = channel_type; -+ #endif -+ pcfg80211_wdinfo->restore_channel = rtw_get_oper_ch(padapter); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED) && (0 != rtw_mi_get_union_chan(padapter))) { -+ if ((remain_ch != rtw_mi_get_union_chan(padapter)) && !check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { -+ if (ATOMIC_READ(&pwdev_priv->switch_ch_to) == 1 || -+ (remain_ch != pmlmeext->cur_channel)) { -+ -+ rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); -+ -+ #ifdef RTW_ROCH_BACK_OP -+ RTW_INFO("%s, set switch ch timer, duration=%d\n", __func__, duration - pwdinfo->ext_listen_interval); -+ _set_timer(&pwdinfo->ap_p2p_switch_timer, duration - pwdinfo->ext_listen_interval); -+ #endif -+ } -+ } -+ ready_on_channel = _TRUE; -+ } else -+#endif /* CONFIG_CONCURRENT_MODE */ -+ { -+ if (remain_ch != rtw_get_oper_ch(padapter)) -+ ready_on_channel = _TRUE; -+ } -+ -+ if (ready_on_channel == _TRUE) { -+ #ifndef RTW_SINGLE_WIPHY -+ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) -+ #endif -+ { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_get_oper_ch(padapter) != remain_ch) -+ #endif -+ { -+ /* if (!padapter->mlmepriv.LinkDetectInfo.bBusyTraffic) */ -+ set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ } -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_ScanNotify(padapter, _TRUE); -+#endif -+ -+ RTW_INFO("%s, set ro ch timer, duration=%d\n", __func__, duration); -+ _set_timer(&pcfg80211_wdinfo->remain_on_ch_timer, duration); -+ -+ rtw_cfg80211_ready_on_channel(wdev, *cookie, channel, channel_type, duration, GFP_KERNEL); -+ -+exit: -+ return err; -+} -+ -+static s32 cfg80211_rtw_cancel_remain_on_channel(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ struct wireless_dev *wdev, -+#else -+ struct net_device *ndev, -+#endif -+ u64 cookie) -+{ -+ s32 err = 0; -+ _adapter *padapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ struct wifidirect_info *pwdinfo; -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ if (wdev == wiphy_to_pd_wdev(wiphy)) -+ padapter = wiphy_to_adapter(wiphy); -+ else -+ #endif -+ if (wdev_to_ndev(wdev)) -+ padapter = (_adapter *)rtw_netdev_priv(wdev_to_ndev(wdev)); -+ else { -+ err = -EINVAL; -+ goto exit; -+ } -+#else -+ struct wireless_dev *wdev; -+ -+ if (ndev == NULL) { -+ err = -EINVAL; -+ goto exit; -+ } -+ padapter = (_adapter *)rtw_netdev_priv(ndev); -+ wdev = ndev_to_wdev(ndev); -+#endif -+ -+ pwdev_priv = adapter_wdev_data(padapter); -+ pwdinfo = &padapter->wdinfo; -+ pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+ -+ RTW_INFO(FUNC_ADPT_FMT"%s cookie:0x%llx\n" -+ , FUNC_ADPT_ARG(padapter), wdev == wiphy_to_pd_wdev(wiphy) ? " PD" : "" -+ , cookie); -+ -+ if (rtw_cfg80211_get_is_roch(padapter) == _TRUE) { -+ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); -+ p2p_cancel_roch_cmd(padapter, cookie, wdev, RTW_CMDF_WAIT_ACK); -+ } -+ -+exit: -+ return err; -+} -+ -+inline int rtw_cfg80211_iface_has_p2p_group_cap(_adapter *adapter) -+{ -+ struct wiphy *wiphy = adapter_to_wiphy(adapter); -+ struct rtw_wdev_priv *wdev_data = adapter_wdev_data(adapter); -+ -+#if RTW_P2P_GROUP_INTERFACE -+ if (is_primary_adapter(adapter)) -+ return 0; -+#endif -+ return 1; -+} -+ -+inline int rtw_cfg80211_is_p2p_scan(_adapter *adapter) -+{ -+#if RTW_P2P_GROUP_INTERFACE -+ if (rtw_cfg80211_iface_has_p2p_group_cap(adapter)) -+#endif -+ { -+ struct wifidirect_info *wdinfo = &adapter->wdinfo; -+ -+ return rtw_p2p_chk_state(wdinfo, P2P_STATE_SCAN) -+ || rtw_p2p_chk_state(wdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ } -+ -+#if RTW_P2P_GROUP_INTERFACE -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ if (wiphy_to_pd_wdev(adapter_to_wiphy(adapter))) /* pd_wdev exist */ -+ return rtw_cfg80211_is_scan_by_pd_wdev(adapter); -+ #endif -+ { -+ /* -+ * For 2 RTW_P2P_GROUP_INTERFACE cases: -+ * 1. RTW_DEDICATED_P2P_DEVICE defined but upper layer don't use pd_wdev or -+ * 2. RTW_DEDICATED_P2P_DEVICE not defined -+ */ -+ struct rtw_wdev_priv *wdev_data = adapter_wdev_data(adapter); -+ _irqL irqL; -+ int is_p2p_scan = 0; -+ -+ _enter_critical_bh(&wdev_data->scan_req_lock, &irqL); -+ if (wdev_data->scan_request -+ && wdev_data->scan_request->ssids -+ && wdev_data->scan_request->ie -+ ) { -+ if (_rtw_memcmp(wdev_data->scan_request->ssids->ssid, "DIRECT-", 7) -+ && rtw_get_p2p_ie((u8 *)wdev_data->scan_request->ie, wdev_data->scan_request->ie_len, NULL, NULL)) -+ is_p2p_scan = 1; -+ } -+ _exit_critical_bh(&wdev_data->scan_req_lock, &irqL); -+ -+ return is_p2p_scan; -+ } -+#endif -+} -+ -+#if defined(RTW_DEDICATED_P2P_DEVICE) -+int rtw_pd_iface_alloc(struct wiphy *wiphy, const char *name, struct wireless_dev **pd_wdev) -+{ -+ struct rtw_wiphy_data *wiphy_data = rtw_wiphy_priv(wiphy); -+ struct wireless_dev *wdev = NULL; -+ struct rtw_netdev_priv_indicator *npi; -+ _adapter *primary_adpt = wiphy_to_adapter(wiphy); -+ int ret = 0; -+ -+ if (wiphy_data->pd_wdev) { -+ RTW_WARN(FUNC_WIPHY_FMT" pd_wdev already exists\n", FUNC_WIPHY_ARG(wiphy)); -+ ret = -EBUSY; -+ goto exit; -+ } -+ -+ wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); -+ if (!wdev) { -+ RTW_WARN(FUNC_WIPHY_FMT" allocate wdev fail\n", FUNC_WIPHY_ARG(wiphy)); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ wdev->wiphy = wiphy; -+ wdev->iftype = NL80211_IFTYPE_P2P_DEVICE; -+ _rtw_memcpy(wdev->address, adapter_mac_addr(primary_adpt), ETH_ALEN); -+ -+ wiphy_data->pd_wdev = wdev; -+ *pd_wdev = wdev; -+ -+ RTW_INFO(FUNC_WIPHY_FMT" pd_wdev:%p, addr="MAC_FMT" added\n" -+ , FUNC_WIPHY_ARG(wiphy), wdev, MAC_ARG(wdev_address(wdev))); -+ -+exit: -+ if (ret && wdev) { -+ rtw_mfree((u8 *)wdev, sizeof(struct wireless_dev)); -+ wdev = NULL; -+ } -+ -+ return ret; -+} -+ -+void rtw_pd_iface_free(struct wiphy *wiphy) -+{ -+ struct dvobj_priv *dvobj = wiphy_to_dvobj(wiphy); -+ struct rtw_wiphy_data *wiphy_data = rtw_wiphy_priv(wiphy); -+ u8 rtnl_lock_needed; -+ -+ if (!wiphy_data->pd_wdev) -+ goto exit; -+ -+ RTW_INFO(FUNC_WIPHY_FMT" pd_wdev:%p, addr="MAC_FMT"\n" -+ , FUNC_WIPHY_ARG(wiphy), wiphy_data->pd_wdev -+ , MAC_ARG(wdev_address(wiphy_data->pd_wdev))); -+ -+ rtnl_lock_needed = rtw_rtnl_lock_needed(dvobj); -+ if (rtnl_lock_needed) -+ rtnl_lock(); -+ cfg80211_unregister_wdev(wiphy_data->pd_wdev); -+ if (rtnl_lock_needed) -+ rtnl_unlock(); -+ -+ rtw_mfree((u8 *)wiphy_data->pd_wdev, sizeof(struct wireless_dev)); -+ wiphy_data->pd_wdev = NULL; -+ -+exit: -+ return; -+} -+ -+static int cfg80211_rtw_start_p2p_device(struct wiphy *wiphy, struct wireless_dev *wdev) -+{ -+ _adapter *adapter = wiphy_to_adapter(wiphy); -+ -+ RTW_INFO(FUNC_WIPHY_FMT" wdev=%p\n", FUNC_WIPHY_ARG(wiphy), wdev); -+ -+ rtw_p2p_enable(adapter, P2P_ROLE_DEVICE); -+ return 0; -+} -+ -+static void cfg80211_rtw_stop_p2p_device(struct wiphy *wiphy, struct wireless_dev *wdev) -+{ -+ _adapter *adapter = wiphy_to_adapter(wiphy); -+ -+ RTW_INFO(FUNC_WIPHY_FMT" wdev=%p\n", FUNC_WIPHY_ARG(wiphy), wdev); -+ -+ if (rtw_cfg80211_is_p2p_scan(adapter)) -+ rtw_scan_abort(adapter); -+ -+ rtw_p2p_enable(adapter, P2P_ROLE_DISABLE); -+} -+ -+inline int rtw_cfg80211_redirect_pd_wdev(struct wiphy *wiphy, u8 *ra, struct wireless_dev **wdev) -+{ -+ struct wireless_dev *pd_wdev = wiphy_to_pd_wdev(wiphy); -+ -+ if (pd_wdev && pd_wdev != *wdev -+ && _rtw_memcmp(wdev_address(pd_wdev), ra, ETH_ALEN) == _TRUE -+ ) { -+ *wdev = pd_wdev; -+ return 1; -+ } -+ return 0; -+} -+ -+inline int rtw_cfg80211_is_scan_by_pd_wdev(_adapter *adapter) -+{ -+ struct wiphy *wiphy = adapter_to_wiphy(adapter); -+ struct rtw_wdev_priv *wdev_data = adapter_wdev_data(adapter); -+ struct wireless_dev *wdev = NULL; -+ _irqL irqL; -+ -+ _enter_critical_bh(&wdev_data->scan_req_lock, &irqL); -+ if (wdev_data->scan_request) -+ wdev = wdev_data->scan_request->wdev; -+ _exit_critical_bh(&wdev_data->scan_req_lock, &irqL); -+ -+ if (wdev && wdev == wiphy_to_pd_wdev(wiphy)) -+ return 1; -+ -+ return 0; -+} -+#endif /* RTW_DEDICATED_P2P_DEVICE */ -+#endif /* CONFIG_P2P */ -+ -+inline void rtw_cfg80211_set_is_mgmt_tx(_adapter *adapter, u8 val) -+{ -+ struct rtw_wdev_priv *wdev_priv = adapter_wdev_data(adapter); -+ -+ wdev_priv->is_mgmt_tx = val; -+ rtw_mi_update_iface_status(&(adapter->mlmepriv), 0); -+} -+ -+inline u8 rtw_cfg80211_get_is_mgmt_tx(_adapter *adapter) -+{ -+ struct rtw_wdev_priv *wdev_priv = adapter_wdev_data(adapter); -+ -+ return wdev_priv->is_mgmt_tx; -+} -+ -+static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, u8 no_cck, const u8 *buf, size_t len, int wait_ack) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ int ret = _FAIL; -+ bool ack = _TRUE; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif /* CONFIG_P2P */ -+ /* struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; */ -+ -+ rtw_mi_set_scan_deny(padapter, 1000); -+ rtw_mi_scan_abort(padapter, _TRUE); -+ -+ rtw_cfg80211_set_is_mgmt_tx(padapter, 1); -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_ScanNotify(padapter, _TRUE); -+#endif -+ -+#ifdef CONFIG_P2P -+ if (rtw_cfg80211_get_is_roch(padapter) == _TRUE) { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { -+ RTW_INFO("%s, extend ro ch time\n", __func__); -+ _set_timer(&padapter->cfg80211_wdinfo.remain_on_ch_timer, pwdinfo->ext_listen_period); -+ } -+ #endif /* CONFIG_CONCURRENT_MODE */ -+ } -+#endif /* CONFIG_P2P */ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ u8 co_channel = 0xff; -+ co_channel = rtw_get_oper_ch(padapter); -+ -+ if (tx_ch != union_ch) { -+ u16 ext_listen_period; -+ -+ if (ATOMIC_READ(&pwdev_priv->switch_ch_to) == 1) { -+ rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); -+ /* RTW_INFO("%s, set switch ch timer, period=%d\n", __func__, pwdinfo->ext_listen_period); */ -+ /* _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period); */ -+ } -+ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) -+ ext_listen_period = 500;/*500ms*/ -+#ifdef CONFIG_P2P -+ else -+ ext_listen_period = pwdinfo->ext_listen_period; -+ -+ _set_timer(&pwdinfo->ap_p2p_switch_timer, ext_listen_period); -+#endif -+ RTW_INFO("%s, set switch ch timer, period=%d\n", __func__, ext_listen_period); -+ } -+ -+ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) -+ pmlmeext->cur_channel = tx_ch; -+ -+ if (tx_ch != co_channel) -+ set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } else -+#endif /* CONFIG_CONCURRENT_MODE */ -+ /* if (tx_ch != pmlmeext->cur_channel) { */ -+ if (tx_ch != rtw_get_oper_ch(padapter)) { -+ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) -+ pmlmeext->cur_channel = tx_ch; -+ set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ -+ /* starting alloc mgmt frame to dump it */ -+ pmgntframe = alloc_mgtxmitframe(pxmitpriv); -+ if (pmgntframe == NULL) { -+ /* ret = -ENOMEM; */ -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ /* update attribute */ -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ if (no_cck && IS_CCK_RATE(pattrib->rate)) { -+ /* force OFDM 6M rate*/ -+ pattrib->rate = MGN_6M; -+ pattrib->raid = rtw_get_mgntframe_raid(padapter, WIRELESS_11G); -+ } -+ -+ pattrib->retry_ctrl = _FALSE; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ _rtw_memcpy(pframe, (void *)buf, len); -+ pattrib->pktlen = len; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ /* update seq number */ -+ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ pmlmeext->mgnt_seq++; -+ -+#ifdef CONFIG_P2P -+ rtw_xframe_chk_wfd_ie(pmgntframe); -+#endif /* CONFIG_P2P */ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if (wait_ack) { -+ if (dump_mgntframe_and_wait_ack(padapter, pmgntframe) != _SUCCESS) { -+ ack = _FALSE; -+ ret = _FAIL; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s, ack == _FAIL\n", __func__); -+#endif -+ } else { -+ -+#ifdef CONFIG_XMIT_ACK -+ rtw_msleep_os(50); -+#endif -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s, ack=%d, ok!\n", __func__, ack); -+#endif -+ ret = _SUCCESS; -+ } -+ } else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+exit: -+ rtw_cfg80211_set_is_mgmt_tx(padapter, 0); -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_ScanNotify(padapter, _FALSE); -+#endif -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s, ret=%d\n", __func__, ret); -+#endif -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ struct wireless_dev *wdev, -+#else -+ struct net_device *ndev, -+#endif -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) || defined(COMPAT_KERNEL_RELEASE) -+ struct ieee80211_channel *chan, -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) -+ bool offchan, -+ #endif -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34)) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+ enum nl80211_channel_type channel_type, -+ #endif -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+ bool channel_type_valid, -+ #endif -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) -+ unsigned int wait, -+ #endif -+ const u8 *buf, size_t len, -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) -+ bool no_cck, -+ #endif -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) -+ bool dont_wait_for_ack, -+ #endif -+#else -+ struct cfg80211_mgmt_tx_params *params, -+#endif -+ u64 *cookie) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(COMPAT_KERNEL_RELEASE) -+ struct ieee80211_channel *chan = params->chan; -+ bool offchan = params->offchan; -+ unsigned int wait = params->wait; -+ const u8 *buf = params->buf; -+ size_t len = params->len; -+ bool no_cck = params->no_cck; -+ bool dont_wait_for_ack = params->dont_wait_for_ack; -+#endif -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 2, 0)) -+ bool no_cck = 0; -+#endif -+ int ret = 0; -+ int tx_ret; -+ int wait_ack = 1; -+ u32 dump_limit = RTW_MAX_MGMT_TX_CNT; -+ u32 dump_cnt = 0; -+ bool ack = _TRUE; -+ u8 tx_ch; -+ u8 category, action; -+ u8 frame_styp; -+ int type = (-1); -+ u32 start = rtw_get_current_time(); -+ _adapter *padapter; -+ struct dvobj_priv *dvobj; -+ struct rtw_wdev_priv *pwdev_priv; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ if (wdev == wiphy_to_pd_wdev(wiphy)) -+ padapter = wiphy_to_adapter(wiphy); -+ else -+ #endif -+ if (wdev_to_ndev(wdev)) -+ padapter = (_adapter *)rtw_netdev_priv(wdev_to_ndev(wdev)); -+ else { -+ ret = -EINVAL; -+ goto exit; -+ } -+#else -+ struct wireless_dev *wdev; -+ -+ if (ndev == NULL) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ padapter = (_adapter *)rtw_netdev_priv(ndev); -+ wdev = ndev_to_wdev(ndev); -+#endif -+ -+ if (chan == NULL) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ tx_ch = (u8)ieee80211_frequency_to_channel(chan->center_freq); -+ -+ dvobj = adapter_to_dvobj(padapter); -+ pwdev_priv = adapter_wdev_data(padapter); -+ -+ /* cookie generation */ -+ *cookie = (unsigned long) buf; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO(FUNC_ADPT_FMT"%s len=%zu, ch=%d" -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34)) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+ ", ch_type=%d" -+ #endif -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+ ", channel_type_valid=%d" -+ #endif -+ "\n", FUNC_ADPT_ARG(padapter), wdev == wiphy_to_pd_wdev(wiphy) ? " PD" : "" -+ , len, tx_ch -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34)) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+ , channel_type -+ #endif -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34)) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+ , channel_type_valid -+ #endif -+ ); -+#endif /* CONFIG_DEBUG_CFG80211 */ -+ -+ /* indicate ack before issue frame to avoid racing with rsp frame */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_mgmt_tx_status(wdev, *cookie, buf, len, ack, GFP_KERNEL); -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34) && LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 36)) -+ cfg80211_action_tx_status(ndev, *cookie, buf, len, ack, GFP_KERNEL); -+#endif -+ -+ frame_styp = le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl) & IEEE80211_FCTL_STYPE; -+ if (IEEE80211_STYPE_PROBE_RESP == frame_styp) { -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("RTW_Tx: probe_resp tx_ch=%d, no_cck=%u, da="MAC_FMT"\n", tx_ch, no_cck, MAC_ARG(GetAddr1Ptr(buf))); -+#endif /* CONFIG_DEBUG_CFG80211 */ -+ wait_ack = 0; -+ goto dump; -+ } -+ -+ if (rtw_action_frame_parse(buf, len, &category, &action) == _FALSE) { -+ RTW_INFO(FUNC_ADPT_FMT" frame_control:0x%x\n", FUNC_ADPT_ARG(padapter), -+ le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl)); -+ goto exit; -+ } -+ -+ RTW_INFO("RTW_Tx:tx_ch=%d, no_cck=%u, da="MAC_FMT"\n", tx_ch, no_cck, MAC_ARG(GetAddr1Ptr(buf))); -+#ifdef CONFIG_P2P -+ type = rtw_p2p_check_frames(padapter, buf, len, _TRUE); -+ if (type >= 0) { -+ no_cck = 1; /* force no CCK for P2P frames */ -+ goto dump; -+ } -+#endif -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) -+ RTW_INFO("RTW_Tx:%s\n", action_public_str(action)); -+ else -+ RTW_INFO("RTW_Tx:category(%u), action(%u)\n", category, action); -+ -+dump: -+ -+ rtw_ps_deny(padapter, PS_DENY_MGNT_TX); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -EFAULT; -+ goto cancel_ps_deny; -+ } -+ -+ while (1) { -+ u32 sleep_ms = 0; -+ u32 retry_guarantee_ms = 0; -+ -+ dump_cnt++; -+ tx_ret = _cfg80211_rtw_mgmt_tx(padapter, tx_ch, no_cck, buf, len, wait_ack); -+ -+ switch (action) { -+ case ACT_PUBLIC_GAS_INITIAL_REQ: -+ case ACT_PUBLIC_GAS_INITIAL_RSP: -+ sleep_ms = 50; -+ retry_guarantee_ms = RTW_MAX_MGMT_TX_MS_GAS; -+ } -+ -+ if (tx_ret == _SUCCESS -+ || (dump_cnt >= dump_limit && rtw_get_passing_time_ms(start) >= retry_guarantee_ms)) -+ break; -+ -+ if (sleep_ms > 0) -+ rtw_msleep_os(sleep_ms); -+ } -+ -+ if (tx_ret != _SUCCESS || dump_cnt > 1) { -+ RTW_INFO(FUNC_ADPT_FMT" %s (%d/%d) in %d ms\n", FUNC_ADPT_ARG(padapter), -+ tx_ret == _SUCCESS ? "OK" : "FAIL", dump_cnt, dump_limit, rtw_get_passing_time_ms(start)); -+ } -+ -+ switch (type) { -+ case P2P_GO_NEGO_CONF: -+ if (0) { -+ RTW_INFO(FUNC_ADPT_FMT" Nego confirm. state=%u, status=%u, iaddr="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(padapter), pwdev_priv->nego_info.state, pwdev_priv->nego_info.status -+ , MAC_ARG(pwdev_priv->nego_info.iface_addr)); -+ } -+ if (pwdev_priv->nego_info.state == 2 -+ && pwdev_priv->nego_info.status == 0 -+ && rtw_check_invalid_mac_address(pwdev_priv->nego_info.iface_addr, _FALSE) == _FALSE -+ ) { -+ _adapter *intended_iface = dvobj_get_adapter_by_addr(dvobj, pwdev_priv->nego_info.iface_addr); -+ -+ if (intended_iface) { -+ RTW_INFO(FUNC_ADPT_FMT" Nego confirm. Allow only "ADPT_FMT" to scan for 2000 ms\n" -+ , FUNC_ADPT_ARG(padapter), ADPT_ARG(intended_iface)); -+ /* allow only intended_iface to do scan for 2000 ms */ -+ rtw_mi_set_scan_deny(padapter, 2000); -+ rtw_clear_scan_deny(intended_iface); -+ } -+ } -+ break; -+ case P2P_INVIT_RESP: -+ if (pwdev_priv->invit_info.flags & BIT(0) -+ && pwdev_priv->invit_info.status == 0 -+ ) { -+ RTW_INFO(FUNC_ADPT_FMT" agree with invitation of persistent group\n", -+ FUNC_ADPT_ARG(padapter)); -+ #if !RTW_P2P_GROUP_INTERFACE -+ rtw_mi_buddy_set_scan_deny(padapter, 5000); -+ #endif -+ rtw_pwr_wakeup_ex(padapter, 5000); -+ } -+ break; -+ } -+ -+cancel_ps_deny: -+ rtw_ps_deny_cancel(padapter, PS_DENY_MGNT_TX); -+exit: -+ return ret; -+} -+ -+static void cfg80211_rtw_mgmt_frame_register(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ struct wireless_dev *wdev, -+#else -+ struct net_device *ndev, -+#endif -+ u16 frame_type, bool reg) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ struct net_device *ndev = wdev_to_ndev(wdev); -+#endif -+ _adapter *adapter; -+ -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ if (ndev == NULL) -+ goto exit; -+ -+ adapter = (_adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(adapter); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO(FUNC_ADPT_FMT" frame_type:%x, reg:%d\n", FUNC_ADPT_ARG(adapter), -+ frame_type, reg); -+#endif -+ -+ /* Wait QC Verify */ -+ return; -+ -+ switch (frame_type) { -+ case IEEE80211_STYPE_PROBE_REQ: /* 0x0040 */ -+ SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_PROBE_REQ, reg); -+ break; -+ case IEEE80211_STYPE_ACTION: /* 0x00D0 */ -+ SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_ACTION, reg); -+ break; -+ default: -+ break; -+ } -+ -+exit: -+ return; -+} -+ -+#if defined(CONFIG_TDLS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) -+static int cfg80211_rtw_tdls_mgmt(struct wiphy *wiphy, -+ struct net_device *ndev, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0)) -+ const u8 *peer, -+#else -+ u8 *peer, -+#endif -+ u8 action_code, -+ u8 dialog_token, -+ u16 status_code, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) -+ u32 peer_capability, -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0)) -+ bool initiator, -+#endif -+ const u8 *buf, -+ size_t len) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ int ret = 0; -+ struct tdls_txmgmt txmgmt; -+ -+ if (hal_chk_wl_func(padapter, WL_FUNC_TDLS) == _FALSE) { -+ RTW_INFO("Discard tdls action:%d, since hal doesn't support tdls\n", action_code); -+ goto discard; -+ } -+ -+ if (rtw_tdls_is_driver_setup(padapter)) { -+ RTW_INFO("Discard tdls action:%d, let driver to set up direct link\n", action_code); -+ goto discard; -+ } -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ _rtw_memcpy(txmgmt.peer, peer, ETH_ALEN); -+ txmgmt.action_code = action_code; -+ txmgmt.dialog_token = dialog_token; -+ txmgmt.status_code = status_code; -+ txmgmt.len = len; -+ txmgmt.buf = (u8 *)rtw_malloc(txmgmt.len); -+ if (txmgmt.buf == NULL) { -+ ret = -ENOMEM; -+ goto bad; -+ } -+ _rtw_memcpy(txmgmt.buf, (void *)buf, txmgmt.len); -+ -+ /* Debug purpose */ -+#if 1 -+ RTW_INFO("%s %d\n", __FUNCTION__, __LINE__); -+ RTW_INFO("peer:"MAC_FMT", action code:%d, dialog:%d, status code:%d\n", -+ MAC_ARG(txmgmt.peer), txmgmt.action_code, -+ txmgmt.dialog_token, txmgmt.status_code); -+ if (txmgmt.len > 0) { -+ int i = 0; -+ for (; i < len; i++) -+ printk("%02x ", *(txmgmt.buf + i)); -+ RTW_INFO("len:%d\n", (u32)txmgmt.len); -+ } -+#endif -+ -+ switch (txmgmt.action_code) { -+ case TDLS_SETUP_REQUEST: -+ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); -+ break; -+ case TDLS_SETUP_RESPONSE: -+ issue_tdls_setup_rsp(padapter, &txmgmt); -+ break; -+ case TDLS_SETUP_CONFIRM: -+ issue_tdls_setup_cfm(padapter, &txmgmt); -+ break; -+ case TDLS_TEARDOWN: -+ issue_tdls_teardown(padapter, &txmgmt, _TRUE); -+ break; -+ case TDLS_DISCOVERY_REQUEST: -+ issue_tdls_dis_req(padapter, &txmgmt); -+ break; -+ case TDLS_DISCOVERY_RESPONSE: -+ issue_tdls_dis_rsp(padapter, &txmgmt, pmlmeinfo->enc_algo ? _TRUE : _FALSE); -+ break; -+ } -+ -+bad: -+ if (txmgmt.buf) -+ rtw_mfree(txmgmt.buf, txmgmt.len); -+ -+discard: -+ return ret; -+} -+ -+static int cfg80211_rtw_tdls_oper(struct wiphy *wiphy, -+ struct net_device *ndev, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0)) -+ const u8 *peer, -+#else -+ u8 *peer, -+#endif -+ enum nl80211_tdls_operation oper) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct tdls_txmgmt txmgmt; -+ struct sta_info *ptdls_sta = NULL; -+ -+ RTW_INFO(FUNC_NDEV_FMT", nl80211_tdls_operation:%d\n", FUNC_NDEV_ARG(ndev), oper); -+ -+ if (hal_chk_wl_func(padapter, WL_FUNC_TDLS) == _FALSE) { -+ RTW_INFO("Discard tdls oper:%d, since hal doesn't support tdls\n", oper); -+ return 0; -+ } -+ -+#ifdef CONFIG_LPS -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); -+#endif /* CONFIG_LPS */ -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ if (peer) -+ _rtw_memcpy(txmgmt.peer, peer, ETH_ALEN); -+ -+ if (rtw_tdls_is_driver_setup(padapter)) { -+ /* these two cases are done by driver itself */ -+ if (oper == NL80211_TDLS_ENABLE_LINK || oper == NL80211_TDLS_DISABLE_LINK) -+ return 0; -+ } -+ -+ switch (oper) { -+ case NL80211_TDLS_DISCOVERY_REQ: -+ issue_tdls_dis_req(padapter, &txmgmt); -+ break; -+ case NL80211_TDLS_SETUP: -+#ifdef CONFIG_WFD -+ if (_AES_ != padapter->securitypriv.dot11PrivacyAlgrthm) { -+ if (padapter->wdinfo.wfd_tdls_weaksec == _TRUE) -+ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); -+ else -+ RTW_INFO("[%s] Current link is not AES, SKIP sending the tdls setup request!!\n", __FUNCTION__); -+ } else -+#endif /* CONFIG_WFD */ -+ { -+ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); -+ } -+ break; -+ case NL80211_TDLS_TEARDOWN: -+ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), txmgmt.peer); -+ if (ptdls_sta != NULL) { -+ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; -+ issue_tdls_teardown(padapter, &txmgmt, _TRUE); -+ } else -+ RTW_INFO("TDLS peer not found\n"); -+ break; -+ case NL80211_TDLS_ENABLE_LINK: -+ RTW_INFO(FUNC_NDEV_FMT", NL80211_TDLS_ENABLE_LINK;mac:"MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(peer)); -+ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), (u8 *)peer); -+ if (ptdls_sta != NULL) { -+ ptdlsinfo->link_established = _TRUE; -+ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; -+ ptdls_sta->state |= _FW_LINKED; -+ rtw_tdls_cmd(padapter, txmgmt.peer, TDLS_ESTABLISHED); -+ } -+ break; -+ case NL80211_TDLS_DISABLE_LINK: -+ RTW_INFO(FUNC_NDEV_FMT", NL80211_TDLS_DISABLE_LINK;mac:"MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(peer)); -+ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), (u8 *)peer); -+ if (ptdls_sta != NULL) -+ rtw_tdls_cmd(padapter, (u8 *)peer, TDLS_TEARDOWN_STA_LOCALLY); -+ break; -+ } -+ return 0; -+} -+#endif /* CONFIG_TDLS */ -+ -+#if defined(CONFIG_PNO_SUPPORT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+static int cfg80211_rtw_sched_scan_start(struct wiphy *wiphy, -+ struct net_device *dev, -+ struct cfg80211_sched_scan_request *request) -+{ -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 ret; -+ -+ if (padapter->bup == _FALSE) { -+ RTW_INFO("%s: net device is down.\n", __func__); -+ return -EIO; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE || -+ check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE || -+ check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { -+ RTW_INFO("%s: device is busy.\n", __func__); -+ rtw_scan_abort(padapter); -+ } -+ -+ if (request == NULL) { -+ RTW_INFO("%s: invalid cfg80211_requests parameters.\n", __func__); -+ return -EINVAL; -+ } -+ -+ ret = rtw_android_cfg80211_pno_setup(dev, request->ssids, -+ request->n_ssids, request->interval); -+ -+ if (ret < 0) { -+ RTW_INFO("%s ret: %d\n", __func__, ret); -+ goto exit; -+ } -+ -+ ret = rtw_android_pno_enable(dev, _TRUE); -+ if (ret < 0) { -+ RTW_INFO("%s ret: %d\n", __func__, ret); -+ goto exit; -+ } -+exit: -+ return ret; -+} -+ -+static int cfg80211_rtw_sched_scan_stop(struct wiphy *wiphy, -+ struct net_device *dev) -+{ -+ return rtw_android_pno_enable(dev, _FALSE); -+} -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+#ifdef CONFIG_AP_MODE -+static int rtw_cfg80211_set_beacon_wpsp2pie(struct net_device *ndev, char *buf, int len) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u8 *wps_ie; -+ u32 p2p_ielen = 0; -+ u8 wps_oui[8] = {0x0, 0x50, 0xf2, 0x04}; -+ u8 *p2p_ie; -+ u32 wfd_ielen = 0; -+ u8 *wfd_ie; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ RTW_INFO(FUNC_NDEV_FMT" ielen=%d\n", FUNC_NDEV_ARG(ndev), len); -+ -+ if (len > 0) { -+ wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen); -+ if (wps_ie) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("bcn_wps_ielen=%d\n", wps_ielen); -+ #endif -+ -+ if (pmlmepriv->wps_beacon_ie) { -+ u32 free_len = pmlmepriv->wps_beacon_ie_len; -+ pmlmepriv->wps_beacon_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_beacon_ie, free_len); -+ pmlmepriv->wps_beacon_ie = NULL; -+ } -+ -+ pmlmepriv->wps_beacon_ie = rtw_malloc(wps_ielen); -+ if (pmlmepriv->wps_beacon_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ -+ _rtw_memcpy(pmlmepriv->wps_beacon_ie, wps_ie, wps_ielen); -+ pmlmepriv->wps_beacon_ie_len = wps_ielen; -+ -+ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, _TRUE); -+ -+ } -+ -+ /* buf += wps_ielen; */ -+ /* len -= wps_ielen; */ -+ -+ #ifdef CONFIG_P2P -+ p2p_ie = rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen); -+ if (p2p_ie) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("bcn_p2p_ielen=%d\n", p2p_ielen); -+ #endif -+ -+ if (pmlmepriv->p2p_beacon_ie) { -+ u32 free_len = pmlmepriv->p2p_beacon_ie_len; -+ pmlmepriv->p2p_beacon_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_beacon_ie, free_len); -+ pmlmepriv->p2p_beacon_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_beacon_ie = rtw_malloc(p2p_ielen); -+ if (pmlmepriv->p2p_beacon_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ -+ _rtw_memcpy(pmlmepriv->p2p_beacon_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_beacon_ie_len = p2p_ielen; -+ -+ } -+ #endif /* CONFIG_P2P */ -+ -+ -+ #ifdef CONFIG_WFD -+ wfd_ie = rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen); -+ if (wfd_ie) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("bcn_wfd_ielen=%d\n", wfd_ielen); -+ #endif -+ -+ if (rtw_mlme_update_wfd_ie_data(pmlmepriv, MLME_BEACON_IE, wfd_ie, wfd_ielen) != _SUCCESS) -+ return -EINVAL; -+ } -+ #endif /* CONFIG_WFD */ -+ -+ pmlmeext->bstart_bss = _TRUE; -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_cfg80211_set_probe_resp_wpsp2pie(struct net_device *net, char *buf, int len) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u8 *wps_ie; -+ u32 p2p_ielen = 0; -+ u8 *p2p_ie; -+ u32 wfd_ielen = 0; -+ u8 *wfd_ie; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s, ielen=%d\n", __func__, len); -+#endif -+ -+ if (len > 0) { -+ wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen); -+ if (wps_ie) { -+ uint attr_contentlen = 0; -+ u16 uconfig_method, *puconfig_method = NULL; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("probe_resp_wps_ielen=%d\n", wps_ielen); -+ #endif -+ -+ if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { -+ u8 sr = 0; -+ rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8 *)(&sr), NULL); -+ -+ if (sr != 0) -+ RTW_INFO("%s, got sr\n", __func__); -+ else { -+ RTW_INFO("GO mode process WPS under site-survey, sr no set\n"); -+ return ret; -+ } -+ } -+ -+ if (pmlmepriv->wps_probe_resp_ie) { -+ u32 free_len = pmlmepriv->wps_probe_resp_ie_len; -+ pmlmepriv->wps_probe_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_probe_resp_ie, free_len); -+ pmlmepriv->wps_probe_resp_ie = NULL; -+ } -+ -+ pmlmepriv->wps_probe_resp_ie = rtw_malloc(wps_ielen); -+ if (pmlmepriv->wps_probe_resp_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ -+ /* add PUSH_BUTTON config_method by driver self in wpsie of probe_resp at GO Mode */ -+ puconfig_method = (u16 *)rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_CONF_METHOD , NULL, &attr_contentlen); -+ if (puconfig_method != NULL) { -+ /* struct registry_priv *pregistrypriv = &padapter->registrypriv; */ -+ struct wireless_dev *wdev = padapter->rtw_wdev; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ /* printk("config_method in wpsie of probe_resp = 0x%x\n", be16_to_cpu(*puconfig_method)); */ -+ #endif -+ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ /* for WIFI-DIRECT LOGO 4.2.2, AUTO GO can't set PUSH_BUTTON flags */ -+ if (wdev->iftype == NL80211_IFTYPE_P2P_GO) { -+ uconfig_method = WPS_CM_PUSH_BUTTON; -+ uconfig_method = cpu_to_be16(uconfig_method); -+ -+ *puconfig_method &= ~uconfig_method; -+ } -+ #endif -+ } -+ -+ _rtw_memcpy(pmlmepriv->wps_probe_resp_ie, wps_ie, wps_ielen); -+ pmlmepriv->wps_probe_resp_ie_len = wps_ielen; -+ -+ } -+ -+ /* buf += wps_ielen; */ -+ /* len -= wps_ielen; */ -+ -+ #ifdef CONFIG_P2P -+ p2p_ie = rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen); -+ if (p2p_ie) { -+ u8 is_GO = _FALSE; -+ u32 attr_contentlen = 0; -+ u16 cap_attr = 0; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("probe_resp_p2p_ielen=%d\n", p2p_ielen); -+ #endif -+ -+ /* Check P2P Capability ATTR */ -+ if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8 *)&cap_attr, (uint *) &attr_contentlen)) { -+ u8 grp_cap = 0; -+ /* RTW_INFO( "[%s] Got P2P Capability Attr!!\n", __FUNCTION__ ); */ -+ cap_attr = le16_to_cpu(cap_attr); -+ grp_cap = (u8)((cap_attr >> 8) & 0xff); -+ -+ is_GO = (grp_cap & BIT(0)) ? _TRUE : _FALSE; -+ -+ if (is_GO) -+ RTW_INFO("Got P2P Capability Attr, grp_cap=0x%x, is_GO\n", grp_cap); -+ } -+ -+ -+ if (is_GO == _FALSE) { -+ if (pmlmepriv->p2p_probe_resp_ie) { -+ u32 free_len = pmlmepriv->p2p_probe_resp_ie_len; -+ pmlmepriv->p2p_probe_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_probe_resp_ie, free_len); -+ pmlmepriv->p2p_probe_resp_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_probe_resp_ie = rtw_malloc(p2p_ielen); -+ if (pmlmepriv->p2p_probe_resp_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->p2p_probe_resp_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_probe_resp_ie_len = p2p_ielen; -+ } else { -+ if (pmlmepriv->p2p_go_probe_resp_ie) { -+ u32 free_len = pmlmepriv->p2p_go_probe_resp_ie_len; -+ pmlmepriv->p2p_go_probe_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_go_probe_resp_ie, free_len); -+ pmlmepriv->p2p_go_probe_resp_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_go_probe_resp_ie = rtw_malloc(p2p_ielen); -+ if (pmlmepriv->p2p_go_probe_resp_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->p2p_go_probe_resp_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_go_probe_resp_ie_len = p2p_ielen; -+ } -+ -+ } -+ #endif /* CONFIG_P2P */ -+ -+ -+ #ifdef CONFIG_WFD -+ wfd_ie = rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen); -+ if (wfd_ie) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("probe_resp_wfd_ielen=%d\n", wfd_ielen); -+ #endif -+ -+ if (rtw_mlme_update_wfd_ie_data(pmlmepriv, MLME_PROBE_RESP_IE, wfd_ie, wfd_ielen) != _SUCCESS) -+ return -EINVAL; -+ } -+ #endif /* CONFIG_WFD */ -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_cfg80211_set_assoc_resp_wpsp2pie(struct net_device *net, char *buf, int len) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 *ie; -+ u32 ie_len; -+ -+ RTW_INFO("%s, ielen=%d\n", __func__, len); -+ -+ if (len <= 0) -+ goto exit; -+ -+ ie = rtw_get_wps_ie(buf, len, NULL, &ie_len); -+ if (ie && ie_len) { -+ if (pmlmepriv->wps_assoc_resp_ie) { -+ u32 free_len = pmlmepriv->wps_assoc_resp_ie_len; -+ -+ pmlmepriv->wps_assoc_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_assoc_resp_ie, free_len); -+ pmlmepriv->wps_assoc_resp_ie = NULL; -+ } -+ -+ pmlmepriv->wps_assoc_resp_ie = rtw_malloc(ie_len); -+ if (pmlmepriv->wps_assoc_resp_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ } -+ _rtw_memcpy(pmlmepriv->wps_assoc_resp_ie, ie, ie_len); -+ pmlmepriv->wps_assoc_resp_ie_len = ie_len; -+ } -+ -+ ie = rtw_get_p2p_ie(buf, len, NULL, &ie_len); -+ if (ie && ie_len) { -+ if (pmlmepriv->p2p_assoc_resp_ie) { -+ u32 free_len = pmlmepriv->p2p_assoc_resp_ie_len; -+ -+ pmlmepriv->p2p_assoc_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_assoc_resp_ie, free_len); -+ pmlmepriv->p2p_assoc_resp_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_assoc_resp_ie = rtw_malloc(ie_len); -+ if (pmlmepriv->p2p_assoc_resp_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ } -+ _rtw_memcpy(pmlmepriv->p2p_assoc_resp_ie, ie, ie_len); -+ pmlmepriv->p2p_assoc_resp_ie_len = ie_len; -+ } -+ -+#ifdef CONFIG_WFD -+ ie = rtw_get_wfd_ie(buf, len, NULL, &ie_len); -+ if (rtw_mlme_update_wfd_ie_data(pmlmepriv, MLME_ASSOC_RESP_IE, ie, ie_len) != _SUCCESS) -+ return -EINVAL; -+#endif -+ -+exit: -+ return ret; -+} -+ -+int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, -+ int type) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u32 p2p_ielen = 0; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ RTW_INFO("%s, ielen=%d\n", __func__, len); -+#endif -+ -+ if ((rtw_get_wps_ie(buf, len, NULL, &wps_ielen) && (wps_ielen > 0)) -+ #ifdef CONFIG_P2P -+ || (rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen) && (p2p_ielen > 0)) -+ #endif -+ ) { -+ if (net != NULL) { -+ switch (type) { -+ case 0x1: /* BEACON */ -+ ret = rtw_cfg80211_set_beacon_wpsp2pie(net, buf, len); -+ break; -+ case 0x2: /* PROBE_RESP */ -+ ret = rtw_cfg80211_set_probe_resp_wpsp2pie(net, buf, len); -+ #ifdef CONFIG_P2P -+ if (ret == 0) -+ adapter_wdev_data((_adapter *)rtw_netdev_priv(net))->probe_resp_ie_update_time = rtw_get_current_time(); -+ #endif -+ break; -+ case 0x4: /* ASSOC_RESP */ -+ ret = rtw_cfg80211_set_assoc_resp_wpsp2pie(net, buf, len); -+ break; -+ } -+ } -+ } -+ -+ return ret; -+ -+} -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_80211N_HT -+static void rtw_cfg80211_init_ht_capab_ex(_adapter *padapter, struct ieee80211_sta_ht_cap *ht_cap, enum nl80211_band band, u8 rf_type) -+{ -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ u8 stbc_rx_enable = _FALSE; -+ -+ rtw_ht_use_default_setting(padapter); -+ -+ /* RX LDPC */ -+ if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_RX)) -+ ht_cap->cap |= IEEE80211_HT_CAP_LDPC_CODING; -+ -+ /* TX STBC */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX)) -+ ht_cap->cap |= IEEE80211_HT_CAP_TX_STBC; -+ -+ /* RX STBC */ -+ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX)) { -+ /*rtw_rx_stbc 0: disable, bit(0):enable 2.4g, bit(1):enable 5g*/ -+ if (band == NL80211_BAND_2GHZ) -+ stbc_rx_enable = (pregistrypriv->rx_stbc & BIT(0)) ? _TRUE : _FALSE; -+ if (band == NL80211_BAND_5GHZ) -+ stbc_rx_enable = (pregistrypriv->rx_stbc & BIT(1)) ? _TRUE : _FALSE; -+ -+ if (stbc_rx_enable) { -+ switch (rf_type) { -+ case RF_1T1R: -+ ht_cap->cap |= IEEE80211_HT_CAP_RX_STBC_1R;/*RX STBC One spatial stream*/ -+ break; -+ -+ case RF_2T2R: -+ case RF_1T2R: -+ ht_cap->cap |= IEEE80211_HT_CAP_RX_STBC_1R;/* Only one spatial-stream STBC RX is supported */ -+ break; -+ case RF_3T3R: -+ case RF_3T4R: -+ case RF_4T4R: -+ ht_cap->cap |= IEEE80211_HT_CAP_RX_STBC_1R;/* Only one spatial-stream STBC RX is supported */ -+ break; -+ default: -+ RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); -+ break; -+ } -+ } -+ } -+} -+ -+static void rtw_cfg80211_init_ht_capab(_adapter *padapter, struct ieee80211_sta_ht_cap *ht_cap, enum nl80211_band band, u8 rf_type) -+{ -+#define MAX_BIT_RATE_40MHZ_MCS23 450 /* Mbps */ -+#define MAX_BIT_RATE_40MHZ_MCS15 300 /* Mbps */ -+#define MAX_BIT_RATE_40MHZ_MCS7 150 /* Mbps */ -+ -+ ht_cap->ht_supported = _TRUE; -+ -+ ht_cap->cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 | -+ IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_SGI_20 | -+ IEEE80211_HT_CAP_DSSSCCK40 | IEEE80211_HT_CAP_MAX_AMSDU; -+ rtw_cfg80211_init_ht_capab_ex(padapter, ht_cap, band, rf_type); -+ -+ /* -+ *Maximum length of AMPDU that the STA can receive. -+ *Length = 2 ^ (13 + max_ampdu_length_exp) - 1 (octets) -+ */ -+ ht_cap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K; -+ -+ /*Minimum MPDU start spacing , */ -+ ht_cap->ampdu_density = IEEE80211_HT_MPDU_DENSITY_16; -+ -+ ht_cap->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED; -+ -+ /* -+ *hw->wiphy->bands[IEEE80211_BAND_2GHZ] -+ *base on ant_num -+ *rx_mask: RX mask -+ *if rx_ant =1 rx_mask[0]=0xff;==>MCS0-MCS7 -+ *if rx_ant =2 rx_mask[1]=0xff;==>MCS8-MCS15 -+ *if rx_ant >=3 rx_mask[2]=0xff; -+ *if BW_40 rx_mask[4]=0x01; -+ *highest supported RX rate -+ */ -+ if (rf_type == RF_1T1R) { -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ -+ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS7; -+ } else if ((rf_type == RF_1T2R) || (rf_type == RF_2T2R) || (rf_type == RF_2T2R_GREEN)) { -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ ht_cap->mcs.rx_mask[1] = 0xFF; -+ -+ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS15; -+ } else if ((rf_type == RF_2T3R) || (rf_type == RF_3T3R)) { -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ ht_cap->mcs.rx_mask[1] = 0xFF; -+ ht_cap->mcs.rx_mask[2] = 0xFF; -+ -+ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS23; -+ } else { -+ rtw_warn_on(1); -+ RTW_INFO("%s, error rf_type=%d\n", __func__, rf_type); -+ } -+ -+} -+#endif /* CONFIG_80211N_HT */ -+ -+void rtw_cfg80211_init_wdev_data(_adapter *padapter) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); -+ -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); -+#endif -+} -+ -+void rtw_cfg80211_init_wiphy(_adapter *padapter) -+{ -+ u8 rf_type; -+ struct ieee80211_supported_band *bands; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct wiphy *wiphy = pwdev->wiphy; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ RTW_INFO("%s:rf_type=%d\n", __func__, rf_type); -+ -+#ifdef CONFIG_80211N_HT -+ if (IsSupported24G(padapter->registrypriv.wireless_mode)) { -+ bands = wiphy->bands[NL80211_BAND_2GHZ]; -+ if (bands) -+ rtw_cfg80211_init_ht_capab(padapter, &bands->ht_cap, NL80211_BAND_2GHZ, rf_type); -+ } -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ if (IsSupported5G(padapter->registrypriv.wireless_mode)) { -+ bands = wiphy->bands[NL80211_BAND_5GHZ]; -+ if (bands) -+ rtw_cfg80211_init_ht_capab(padapter, &bands->ht_cap, NL80211_BAND_5GHZ, rf_type); -+ } -+#endif -+ /* init regulary domain */ -+ rtw_regd_init(padapter); -+ -+ /* copy mac_addr to wiphy */ -+ _rtw_memcpy(wiphy->perm_addr, adapter_mac_addr(padapter), ETH_ALEN); -+ -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+struct ieee80211_iface_limit rtw_limits[] = { -+ { -+ .max = 2, -+ .types = BIT(NL80211_IFTYPE_STATION) -+ #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) -+ | BIT(NL80211_IFTYPE_P2P_CLIENT) -+ #endif -+ }, -+ #ifdef CONFIG_AP_MODE -+ { -+ .max = 1, -+ .types = BIT(NL80211_IFTYPE_AP) -+ #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) -+ | BIT(NL80211_IFTYPE_P2P_GO) -+ #endif -+ }, -+ #endif -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ { -+ .max = 1, -+ .types = BIT(NL80211_IFTYPE_P2P_DEVICE) -+ } -+ #endif -+}; -+ -+struct ieee80211_iface_combination rtw_combinations[] = { -+ { -+ .limits = rtw_limits, -+ .n_limits = ARRAY_SIZE(rtw_limits), -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ .max_interfaces = 3, -+ #else -+ .max_interfaces = 2, -+ #endif -+ .num_different_channels = 1, -+ }, -+}; -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) */ -+ -+static void rtw_cfg80211_preinit_wiphy(_adapter *adapter, struct wiphy *wiphy) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct registry_priv *regsty = dvobj_to_regsty(dvobj); -+ -+ wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; -+ -+ wiphy->max_scan_ssids = RTW_SSID_SCAN_AMOUNT; -+ wiphy->max_scan_ie_len = RTW_SCAN_IE_LEN_MAX; -+ wiphy->max_num_pmkids = RTW_MAX_NUM_PMKIDS; -+ -+#if CONFIG_RTW_MACADDR_ACL && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+ wiphy->max_acl_mac_addrs = NUM_ACL; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) -+ wiphy->max_remain_on_channel_duration = RTW_MAX_REMAIN_ON_CHANNEL_DURATION; -+#endif -+ -+ wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) -+ | BIT(NL80211_IFTYPE_ADHOC) -+#ifdef CONFIG_AP_MODE -+ | BIT(NL80211_IFTYPE_AP) -+ #ifdef CONFIG_WIFI_MONITOR -+ | BIT(NL80211_IFTYPE_MONITOR) -+ #endif -+#endif -+#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) -+ | BIT(NL80211_IFTYPE_P2P_CLIENT) -+ | BIT(NL80211_IFTYPE_P2P_GO) -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ | BIT(NL80211_IFTYPE_P2P_DEVICE) -+ #endif -+#endif -+ ; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+#ifdef CONFIG_AP_MODE -+ wiphy->mgmt_stypes = rtw_cfg80211_default_mgmt_stypes; -+#endif /* CONFIG_AP_MODE */ -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+ #ifdef CONFIG_WIFI_MONITOR -+ wiphy->software_iftypes |= BIT(NL80211_IFTYPE_MONITOR); -+ #endif -+#endif -+ -+#if defined(RTW_SINGLE_WIPHY) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+ wiphy->iface_combinations = rtw_combinations; -+ wiphy->n_iface_combinations = ARRAY_SIZE(rtw_combinations); -+#endif -+ -+ wiphy->cipher_suites = rtw_cipher_suites; -+ wiphy->n_cipher_suites = ARRAY_SIZE(rtw_cipher_suites); -+ -+ if (IsSupported24G(adapter->registrypriv.wireless_mode)) -+ wiphy->bands[NL80211_BAND_2GHZ] = rtw_spt_band_alloc(NL80211_BAND_2GHZ); -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ if (IsSupported5G(adapter->registrypriv.wireless_mode)) -+ wiphy->bands[NL80211_BAND_5GHZ] = rtw_spt_band_alloc(NL80211_BAND_5GHZ); -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38) && LINUX_VERSION_CODE < KERNEL_VERSION(3, 0, 0)) -+ wiphy->flags |= WIPHY_FLAG_SUPPORTS_SEPARATE_DEFAULT_KEYS; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) -+ wiphy->flags |= WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL; -+ wiphy->flags |= WIPHY_FLAG_HAVE_AP_SME; -+ /* remove WIPHY_FLAG_OFFCHAN_TX, because we not support this feature */ -+ /* wiphy->flags |= WIPHY_FLAG_OFFCHAN_TX | WIPHY_FLAG_HAVE_AP_SME; */ -+#endif -+ -+#if defined(CONFIG_PM) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+ wiphy->max_sched_scan_reqs = 1; -+#ifdef CONFIG_PNO_SUPPORT -+ wiphy->max_sched_scan_ssids = MAX_PNO_LIST_COUNT; -+#endif -+#endif -+ -+#if defined(CONFIG_PM) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0)) -+ wiphy->wowlan = wowlan_stub; -+#else -+ wiphy->wowlan = &wowlan_stub; -+#endif -+#endif -+ -+#if defined(CONFIG_TDLS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) -+ wiphy->flags |= WIPHY_FLAG_SUPPORTS_TDLS; -+#ifndef CONFIG_TDLS_DRIVER_SETUP -+ wiphy->flags |= WIPHY_FLAG_TDLS_EXTERNAL_SETUP; /* Driver handles key exchange */ -+ wiphy->flags |= NL80211_ATTR_HT_CAPABILITY; -+#endif /* CONFIG_TDLS_DRIVER_SETUP */ -+#endif /* CONFIG_TDLS */ -+ -+ if (regsty->power_mgnt != PS_MODE_ACTIVE) -+ wiphy->flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT; -+ else -+ wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) -+ /* wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM; */ -+#endif -+} -+ -+static struct cfg80211_ops rtw_cfg80211_ops = { -+ .change_virtual_intf = cfg80211_rtw_change_iface, -+ .add_key = cfg80211_rtw_add_key, -+ .get_key = cfg80211_rtw_get_key, -+ .del_key = cfg80211_rtw_del_key, -+ .set_default_key = cfg80211_rtw_set_default_key, -+#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 1, 0)) -+ .set_rekey_data = cfg80211_rtw_set_rekey_data, -+#endif /*CONFIG_GTK_OL*/ -+ .get_station = cfg80211_rtw_get_station, -+ .scan = cfg80211_rtw_scan, -+ .set_wiphy_params = cfg80211_rtw_set_wiphy_params, -+ .connect = cfg80211_rtw_connect, -+ .disconnect = cfg80211_rtw_disconnect, -+ .join_ibss = cfg80211_rtw_join_ibss, -+ .leave_ibss = cfg80211_rtw_leave_ibss, -+ .set_tx_power = cfg80211_rtw_set_txpower, -+ .get_tx_power = cfg80211_rtw_get_txpower, -+ .set_power_mgmt = cfg80211_rtw_set_power_mgmt, -+ .set_pmksa = cfg80211_rtw_set_pmksa, -+ .del_pmksa = cfg80211_rtw_del_pmksa, -+ .flush_pmksa = cfg80211_rtw_flush_pmksa, -+ -+#ifdef CONFIG_AP_MODE -+ .add_virtual_intf = cfg80211_rtw_add_virtual_intf, -+ .del_virtual_intf = cfg80211_rtw_del_virtual_intf, -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) && !defined(COMPAT_KERNEL_RELEASE) -+ .add_beacon = cfg80211_rtw_add_beacon, -+ .set_beacon = cfg80211_rtw_set_beacon, -+ .del_beacon = cfg80211_rtw_del_beacon, -+#else -+ .start_ap = cfg80211_rtw_start_ap, -+ .change_beacon = cfg80211_rtw_change_beacon, -+ .stop_ap = cfg80211_rtw_stop_ap, -+#endif -+ -+#if CONFIG_RTW_MACADDR_ACL && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) -+ .set_mac_acl = cfg80211_rtw_set_mac_acl, -+#endif -+ -+ .add_station = cfg80211_rtw_add_station, -+ .del_station = cfg80211_rtw_del_station, -+ .change_station = cfg80211_rtw_change_station, -+ .dump_station = cfg80211_rtw_dump_station, -+ .change_bss = cfg80211_rtw_change_bss, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) -+ .set_channel = cfg80211_rtw_set_channel, -+#endif -+ /* .auth = cfg80211_rtw_auth, */ -+ /* .assoc = cfg80211_rtw_assoc, */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ .set_monitor_channel = cfg80211_rtw_set_monitor_channel, -+#endif -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_P2P -+ .remain_on_channel = cfg80211_rtw_remain_on_channel, -+ .cancel_remain_on_channel = cfg80211_rtw_cancel_remain_on_channel, -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ .start_p2p_device = cfg80211_rtw_start_p2p_device, -+ .stop_p2p_device = cfg80211_rtw_stop_p2p_device, -+ #endif -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_RTW_80211R -+ .update_ft_ies = cfg80211_rtw_update_ft_ies, -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) -+ .mgmt_tx = cfg80211_rtw_mgmt_tx, -+ .mgmt_frame_register = cfg80211_rtw_mgmt_frame_register, -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34) && LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ .action = cfg80211_rtw_mgmt_tx, -+#endif -+ -+#if defined(CONFIG_TDLS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) -+ .tdls_mgmt = cfg80211_rtw_tdls_mgmt, -+ .tdls_oper = cfg80211_rtw_tdls_oper, -+#endif /* CONFIG_TDLS */ -+ -+#if defined(CONFIG_PNO_SUPPORT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) -+ .sched_scan_start = cfg80211_rtw_sched_scan_start, -+ .sched_scan_stop = cfg80211_rtw_sched_scan_stop, -+#endif /* CONFIG_PNO_SUPPORT */ -+}; -+ -+struct wiphy *rtw_wiphy_alloc(_adapter *padapter, struct device *dev) -+{ -+ struct wiphy *wiphy; -+ struct rtw_wiphy_data *wiphy_data; -+ -+ /* wiphy */ -+ wiphy = wiphy_new(&rtw_cfg80211_ops, sizeof(struct rtw_wiphy_data)); -+ if (!wiphy) { -+ RTW_INFO("Couldn't allocate wiphy device\n"); -+ goto exit; -+ } -+ set_wiphy_dev(wiphy, dev); -+ -+ /* wiphy_data */ -+ wiphy_data = rtw_wiphy_priv(wiphy); -+ wiphy_data->dvobj = adapter_to_dvobj(padapter); -+#ifndef RTW_SINGLE_WIPHY -+ wiphy_data->adapter = padapter; -+#endif -+ -+ rtw_cfg80211_preinit_wiphy(padapter, wiphy); -+ -+ RTW_INFO(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); -+ -+exit: -+ return wiphy; -+} -+ -+void rtw_wiphy_free(struct wiphy *wiphy) -+{ -+ if (!wiphy) -+ return; -+ -+ RTW_INFO(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); -+ -+ if (wiphy->bands[NL80211_BAND_2GHZ]) { -+ rtw_spt_band_free(wiphy->bands[NL80211_BAND_2GHZ]); -+ wiphy->bands[NL80211_BAND_2GHZ] = NULL; -+ } -+ if (wiphy->bands[NL80211_BAND_5GHZ]) { -+ rtw_spt_band_free(wiphy->bands[NL80211_BAND_5GHZ]); -+ wiphy->bands[NL80211_BAND_5GHZ] = NULL; -+ } -+ -+ wiphy_free(wiphy); -+} -+ -+int rtw_wiphy_register(struct wiphy *wiphy) -+{ -+ RTW_INFO(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) -+ rtw_cfgvendor_attach(wiphy); -+#endif -+ -+ return wiphy_register(wiphy); -+} -+ -+void rtw_wiphy_unregister(struct wiphy *wiphy) -+{ -+ RTW_INFO(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) -+ rtw_cfgvendor_detach(wiphy); -+#endif -+ -+ #if defined(RTW_DEDICATED_P2P_DEVICE) -+ rtw_pd_iface_free(wiphy); -+ #endif -+ -+ return wiphy_unregister(wiphy); -+} -+ -+int rtw_wdev_alloc(_adapter *padapter, struct wiphy *wiphy) -+{ -+ int ret = 0; -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct wireless_dev *wdev; -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ RTW_INFO("%s(padapter=%p)\n", __func__, padapter); -+ -+ /* wdev */ -+ wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); -+ if (!wdev) { -+ RTW_INFO("Couldn't allocate wireless device\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ wdev->wiphy = wiphy; -+ wdev->netdev = pnetdev; -+ -+ wdev->iftype = NL80211_IFTYPE_STATION; /* will be init in rtw_hal_init() */ -+ /* Must sync with _rtw_init_mlme_priv() */ -+ /* pmlmepriv->fw_state = WIFI_STATION_STATE */ -+ /* wdev->iftype = NL80211_IFTYPE_MONITOR; */ /* for rtw_setopmode_cmd() in cfg80211_rtw_change_iface() */ -+ padapter->rtw_wdev = wdev; -+ pnetdev->ieee80211_ptr = wdev; -+ -+ /* init pwdev_priv */ -+ pwdev_priv = adapter_wdev_data(padapter); -+ pwdev_priv->rtw_wdev = wdev; -+ pwdev_priv->pmon_ndev = NULL; -+ pwdev_priv->ifname_mon[0] = '\0'; -+ pwdev_priv->padapter = padapter; -+ pwdev_priv->scan_request = NULL; -+ _rtw_spinlock_init(&pwdev_priv->scan_req_lock); -+ pwdev_priv->connect_req = NULL; -+ _rtw_spinlock_init(&pwdev_priv->connect_req_lock); -+ -+ pwdev_priv->p2p_enabled = _FALSE; -+ pwdev_priv->probe_resp_ie_update_time = rtw_get_current_time(); -+ pwdev_priv->provdisc_req_issued = _FALSE; -+ rtw_wdev_invit_info_init(&pwdev_priv->invit_info); -+ rtw_wdev_nego_info_init(&pwdev_priv->nego_info); -+ -+ pwdev_priv->bandroid_scan = _FALSE; -+ -+ if (padapter->registrypriv.power_mgnt != PS_MODE_ACTIVE) -+ pwdev_priv->power_mgmt = _TRUE; -+ else -+ pwdev_priv->power_mgmt = _FALSE; -+ -+ _rtw_mutex_init(&pwdev_priv->roch_mutex); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); -+#endif -+ -+exit: -+ return ret; -+} -+ -+void rtw_wdev_free(struct wireless_dev *wdev) -+{ -+ if (!wdev) -+ return; -+ -+ RTW_INFO("%s(wdev=%p)\n", __func__, wdev); -+ -+ if (wdev_to_ndev(wdev)) { -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(wdev_to_ndev(wdev)); -+ struct rtw_wdev_priv *wdev_priv = adapter_wdev_data(adapter); -+ _irqL irqL; -+ -+ _rtw_spinlock_free(&wdev_priv->scan_req_lock); -+ -+ _enter_critical_bh(&wdev_priv->connect_req_lock, &irqL); -+ rtw_wdev_free_connect_req(wdev_priv); -+ _exit_critical_bh(&wdev_priv->connect_req_lock, &irqL); -+ _rtw_spinlock_free(&wdev_priv->connect_req_lock); -+ -+ _rtw_mutex_free(&wdev_priv->roch_mutex); -+ } -+ -+ rtw_mfree((u8 *)wdev, sizeof(struct wireless_dev)); -+} -+ -+void rtw_wdev_unregister(struct wireless_dev *wdev) -+{ -+ struct net_device *ndev; -+ _adapter *adapter; -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ if (!wdev) -+ return; -+ -+ RTW_INFO("%s(wdev=%p)\n", __func__, wdev); -+ -+ ndev = wdev_to_ndev(wdev); -+ if (!ndev) -+ return; -+ -+ adapter = (_adapter *)rtw_netdev_priv(ndev); -+ pwdev_priv = adapter_wdev_data(adapter); -+ -+ rtw_cfg80211_indicate_scan_done(adapter, _TRUE); -+ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) || defined(COMPAT_KERNEL_RELEASE) -+ if (wdev->current_bss) { -+ RTW_INFO(FUNC_ADPT_FMT" clear current_bss by cfg80211_disconnected\n", FUNC_ADPT_ARG(adapter)); -+ rtw_cfg80211_indicate_disconnect(adapter, 0, 1); -+ } -+ #endif -+ -+ if (pwdev_priv->pmon_ndev) { -+ RTW_INFO("%s, unregister monitor interface\n", __func__); -+ unregister_netdev(pwdev_priv->pmon_ndev); -+ } -+} -+ -+int rtw_cfg80211_ndev_res_alloc(_adapter *adapter) -+{ -+ int ret = _FAIL; -+ -+#if !defined(RTW_SINGLE_WIPHY) -+ struct wiphy *wiphy; -+ struct device *dev = dvobj_to_dev(adapter_to_dvobj(adapter)); -+ -+ wiphy = rtw_wiphy_alloc(adapter, dev); -+ if (wiphy == NULL) -+ goto exit; -+ -+ adapter->wiphy = wiphy; -+#endif -+ -+ if (rtw_wdev_alloc(adapter, adapter_to_wiphy(adapter)) == 0) -+ ret = _SUCCESS; -+ -+#if !defined(RTW_SINGLE_WIPHY) -+ if (ret != _SUCCESS) { -+ rtw_wiphy_free(wiphy); -+ adapter->wiphy = NULL; -+ } -+#endif -+ -+exit: -+ return ret; -+} -+ -+void rtw_cfg80211_ndev_res_free(_adapter *adapter) -+{ -+ rtw_wdev_free(adapter->rtw_wdev); -+#if !defined(RTW_SINGLE_WIPHY) -+ rtw_wiphy_free(adapter_to_wiphy(adapter)); -+ adapter->wiphy = NULL; -+#endif -+} -+ -+int rtw_cfg80211_ndev_res_register(_adapter *adapter) -+{ -+ int ret = _FAIL; -+ -+#if !defined(RTW_SINGLE_WIPHY) -+ if (rtw_wiphy_register(adapter_to_wiphy(adapter)) < 0) { -+ RTW_INFO("%s rtw_wiphy_register fail for if%d\n", __func__, (adapter->iface_id + 1)); -+ goto exit; -+ } -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+void rtw_cfg80211_ndev_res_unregister(_adapter *adapter) -+{ -+ rtw_wdev_unregister(adapter->rtw_wdev); -+} -+ -+int rtw_cfg80211_dev_res_alloc(struct dvobj_priv *dvobj) -+{ -+ int ret = _FAIL; -+ -+#if defined(RTW_SINGLE_WIPHY) -+ struct wiphy *wiphy; -+ struct device *dev = dvobj_to_dev(dvobj); -+ -+ wiphy = rtw_wiphy_alloc(dvobj->padapters[IFACE_ID0], dev); -+ if (wiphy == NULL) -+ goto exit; -+ -+ dvobj->wiphy = wiphy; -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+void rtw_cfg80211_dev_res_free(struct dvobj_priv *dvobj) -+{ -+#if defined(RTW_SINGLE_WIPHY) -+ rtw_wiphy_free(dvobj_to_wiphy(dvobj)); -+ dvobj->wiphy = NULL; -+#endif -+} -+ -+int rtw_cfg80211_dev_res_register(struct dvobj_priv *dvobj) -+{ -+ int ret = _FAIL; -+ -+#if defined(RTW_SINGLE_WIPHY) -+ if (rtw_wiphy_register(dvobj_to_wiphy(dvobj)) != 0) -+ goto exit; -+#endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+void rtw_cfg80211_dev_res_unregister(struct dvobj_priv *dvobj) -+{ -+#if defined(RTW_SINGLE_WIPHY) -+ rtw_wiphy_unregister(dvobj_to_wiphy(dvobj)); -+#endif -+} -+ -+#endif /* CONFIG_IOCTL_CFG80211 */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.h linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.h ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_cfg80211.h 2018-02-11 21:44:27.174146497 +0200 -@@ -0,0 +1,353 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __IOCTL_CFG80211_H__ -+#define __IOCTL_CFG80211_H__ -+ -+ -+#ifndef RTW_CFG80211_ALWAYS_INFORM_STA_DISCONNECT_EVENT -+ #define RTW_CFG80211_ALWAYS_INFORM_STA_DISCONNECT_EVENT 0 -+#endif -+ -+#if defined(RTW_USE_CFG80211_STA_EVENT) -+ #undef CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER -+#endif -+ -+#ifndef RTW_P2P_GROUP_INTERFACE -+ #define RTW_P2P_GROUP_INTERFACE 0 -+#endif -+ -+/* -+* (RTW_P2P_GROUP_INTERFACE, RTW_DEDICATED_P2P_DEVICE) -+* (0, 0): wlan0 + p2p0(PD+PG) -+* (1, 0): wlan0(with PD) + dynamic PGs -+* (1, 1): wlan0 (with dynamic PD wdev) + dynamic PGs -+*/ -+ -+#if RTW_P2P_GROUP_INTERFACE -+ #ifndef CONFIG_RTW_DYNAMIC_NDEV -+ #define CONFIG_RTW_DYNAMIC_NDEV -+ #endif -+ #ifndef RTW_SINGLE_WIPHY -+ #define RTW_SINGLE_WIPHY -+ #endif -+ #ifndef CONFIG_RADIO_WORK -+ #define CONFIG_RADIO_WORK -+ #endif -+ #ifndef RTW_DEDICATED_P2P_DEVICE -+ #define RTW_DEDICATED_P2P_DEVICE -+ #endif -+#endif -+ -+#if !defined(CONFIG_P2P) && RTW_P2P_GROUP_INTERFACE -+ #error "RTW_P2P_GROUP_INTERFACE can't be enabled when CONFIG_P2P is disabled\n" -+#endif -+ -+#if !RTW_P2P_GROUP_INTERFACE && defined(RTW_DEDICATED_P2P_DEVICE) -+ #error "RTW_DEDICATED_P2P_DEVICE can't be enabled when RTW_P2P_GROUP_INTERFACE is disabled\n" -+#endif -+ -+#if defined(RTW_DEDICATED_P2P_DEVICE) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 7, 0)) -+ #error "RTW_DEDICATED_P2P_DEVICE can't be enabled when kernel < 3.7.0\n" -+#endif -+ -+struct rtw_wdev_invit_info { -+ u8 state; /* 0: req, 1:rep */ -+ u8 peer_mac[ETH_ALEN]; -+ u8 group_bssid[ETH_ALEN]; -+ u8 active; -+ u8 token; -+ u8 flags; -+ u8 status; -+ u8 req_op_ch; -+ u8 rsp_op_ch; -+}; -+ -+#define rtw_wdev_invit_info_init(invit_info) \ -+ do { \ -+ (invit_info)->state = 0xff; \ -+ _rtw_memset((invit_info)->peer_mac, 0, ETH_ALEN); \ -+ _rtw_memset((invit_info)->group_bssid, 0, ETH_ALEN); \ -+ (invit_info)->active = 0xff; \ -+ (invit_info)->token = 0; \ -+ (invit_info)->flags = 0x00; \ -+ (invit_info)->status = 0xff; \ -+ (invit_info)->req_op_ch = 0; \ -+ (invit_info)->rsp_op_ch = 0; \ -+ } while (0) -+ -+struct rtw_wdev_nego_info { -+ u8 state; /* 0: req, 1:rep, 2:conf */ -+ u8 iface_addr[ETH_ALEN]; -+ u8 peer_mac[ETH_ALEN]; -+ u8 peer_iface_addr[ETH_ALEN]; -+ u8 active; -+ u8 token; -+ u8 status; -+ u8 req_intent; -+ u8 req_op_ch; -+ u8 req_listen_ch; -+ u8 rsp_intent; -+ u8 rsp_op_ch; -+ u8 conf_op_ch; -+}; -+ -+#define rtw_wdev_nego_info_init(nego_info) \ -+ do { \ -+ (nego_info)->state = 0xff; \ -+ _rtw_memset((nego_info)->iface_addr, 0, ETH_ALEN); \ -+ _rtw_memset((nego_info)->peer_mac, 0, ETH_ALEN); \ -+ _rtw_memset((nego_info)->peer_iface_addr, 0, ETH_ALEN); \ -+ (nego_info)->active = 0xff; \ -+ (nego_info)->token = 0; \ -+ (nego_info)->status = 0xff; \ -+ (nego_info)->req_intent = 0xff; \ -+ (nego_info)->req_op_ch = 0; \ -+ (nego_info)->req_listen_ch = 0; \ -+ (nego_info)->rsp_intent = 0xff; \ -+ (nego_info)->rsp_op_ch = 0; \ -+ (nego_info)->conf_op_ch = 0; \ -+ } while (0) -+ -+struct rtw_wdev_priv { -+ struct wireless_dev *rtw_wdev; -+ -+ _adapter *padapter; -+ -+ #if !RTW_CFG80211_ALWAYS_INFORM_STA_DISCONNECT_EVENT -+ u8 not_indic_disco; -+ #endif -+ -+ struct cfg80211_scan_request *scan_request; -+ _lock scan_req_lock; -+ -+ struct cfg80211_connect_params *connect_req; -+ _lock connect_req_lock; -+ -+ struct net_device *pmon_ndev;/* for monitor interface */ -+ char ifname_mon[IFNAMSIZ + 1]; /* interface name for monitor interface */ -+ -+ u8 p2p_enabled; -+ u32 probe_resp_ie_update_time; -+ -+ u8 provdisc_req_issued; -+ -+ struct rtw_wdev_invit_info invit_info; -+ struct rtw_wdev_nego_info nego_info; -+ -+ u8 bandroid_scan; -+ bool block; -+ bool block_scan; -+ bool power_mgmt; -+ -+ /* report mgmt_frame registered */ -+ u16 report_mgmt; -+ -+ u8 is_mgmt_tx; -+ -+ _mutex roch_mutex; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_T switch_ch_to; -+#endif -+ -+}; -+ -+#if RTW_CFG80211_ALWAYS_INFORM_STA_DISCONNECT_EVENT -+#define rtw_wdev_not_indic_disco(rtw_wdev_data) 0 -+#define rtw_wdev_set_not_indic_disco(rtw_wdev_data, val) do {} while (0) -+#else -+#define rtw_wdev_not_indic_disco(rtw_wdev_data) ((rtw_wdev_data)->not_indic_disco) -+#define rtw_wdev_set_not_indic_disco(rtw_wdev_data, val) do { (rtw_wdev_data)->not_indic_disco = (val); } while (0) -+#endif -+ -+#define rtw_wdev_free_connect_req(rtw_wdev_data) \ -+ do { \ -+ if ((rtw_wdev_data)->connect_req) { \ -+ rtw_mfree((u8 *)(rtw_wdev_data)->connect_req, sizeof(*(rtw_wdev_data)->connect_req)); \ -+ (rtw_wdev_data)->connect_req = NULL; \ -+ } \ -+ } while (0) -+ -+#define wdev_to_ndev(w) ((w)->netdev) -+#define wdev_to_wiphy(w) ((w)->wiphy) -+#define ndev_to_wdev(n) ((n)->ieee80211_ptr) -+ -+struct rtw_wiphy_data { -+ struct dvobj_priv *dvobj; -+ -+#ifndef RTW_SINGLE_WIPHY -+ _adapter *adapter; -+#endif -+ -+#if defined(RTW_DEDICATED_P2P_DEVICE) -+ struct wireless_dev *pd_wdev; /* P2P device wdev */ -+#endif -+}; -+ -+#define rtw_wiphy_priv(wiphy) ((struct rtw_wiphy_data *)wiphy_priv(wiphy)) -+#define wiphy_to_dvobj(wiphy) (((struct rtw_wiphy_data *)wiphy_priv(wiphy))->dvobj) -+#ifdef RTW_SINGLE_WIPHY -+#define wiphy_to_adapter(wiphy) (dvobj_get_primary_adapter(wiphy_to_dvobj(wiphy))) -+#else -+#define wiphy_to_adapter(wiphy) (((struct rtw_wiphy_data *)wiphy_priv(wiphy))->adapter) -+#endif -+ -+#if defined(RTW_DEDICATED_P2P_DEVICE) -+#define wiphy_to_pd_wdev(wiphy) (rtw_wiphy_priv(wiphy)->pd_wdev) -+#else -+#define wiphy_to_pd_wdev(wiphy) NULL -+#endif -+ -+#define WIPHY_FMT "%s" -+#define WIPHY_ARG(wiphy) wiphy_name(wiphy) -+#define FUNC_WIPHY_FMT "%s("WIPHY_FMT")" -+#define FUNC_WIPHY_ARG(wiphy) __func__, WIPHY_ARG(wiphy) -+ -+#define SET_CFG80211_REPORT_MGMT(w, t, v) (w->report_mgmt |= (v ? BIT(t >> 4) : 0)) -+#define GET_CFG80211_REPORT_MGMT(w, t) ((w->report_mgmt & BIT(t >> 4)) > 0) -+ -+struct wiphy *rtw_wiphy_alloc(_adapter *padapter, struct device *dev); -+void rtw_wiphy_free(struct wiphy *wiphy); -+int rtw_wiphy_register(struct wiphy *wiphy); -+void rtw_wiphy_unregister(struct wiphy *wiphy); -+ -+int rtw_wdev_alloc(_adapter *padapter, struct wiphy *wiphy); -+void rtw_wdev_free(struct wireless_dev *wdev); -+void rtw_wdev_unregister(struct wireless_dev *wdev); -+ -+int rtw_cfg80211_ndev_res_alloc(_adapter *adapter); -+void rtw_cfg80211_ndev_res_free(_adapter *adapter); -+int rtw_cfg80211_ndev_res_register(_adapter *adapter); -+void rtw_cfg80211_ndev_res_unregister(_adapter *adapter); -+ -+int rtw_cfg80211_dev_res_alloc(struct dvobj_priv *dvobj); -+void rtw_cfg80211_dev_res_free(struct dvobj_priv *dvobj); -+int rtw_cfg80211_dev_res_register(struct dvobj_priv *dvobj); -+void rtw_cfg80211_dev_res_unregister(struct dvobj_priv *dvobj); -+ -+void rtw_cfg80211_init_wdev_data(_adapter *padapter); -+void rtw_cfg80211_init_wiphy(_adapter *padapter); -+ -+void rtw_cfg80211_unlink_bss(_adapter *padapter, struct wlan_network *pnetwork); -+void rtw_cfg80211_surveydone_event_callback(_adapter *padapter); -+struct cfg80211_bss *rtw_cfg80211_inform_bss(_adapter *padapter, struct wlan_network *pnetwork); -+int rtw_cfg80211_check_bss(_adapter *padapter); -+void rtw_cfg80211_ibss_indicate_connect(_adapter *padapter); -+void rtw_cfg80211_indicate_connect(_adapter *padapter); -+void rtw_cfg80211_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally_generated); -+void rtw_cfg80211_indicate_scan_done(_adapter *adapter, bool aborted); -+u32 rtw_cfg80211_wait_scan_req_empty(_adapter *adapter, u32 timeout_ms); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+u8 rtw_cfg80211_scan_via_buddy(_adapter *padapter, struct cfg80211_scan_request *request); -+void rtw_cfg80211_indicate_scan_done_for_buddy(_adapter *padapter, bool bscan_aborted); -+#endif -+ -+#ifdef CONFIG_AP_MODE -+void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); -+void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, unsigned short reason); -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_P2P -+void rtw_cfg80211_set_is_roch(_adapter *adapter, bool val); -+bool rtw_cfg80211_get_is_roch(_adapter *adapter); -+ -+int rtw_cfg80211_iface_has_p2p_group_cap(_adapter *adapter); -+int rtw_cfg80211_is_p2p_scan(_adapter *adapter); -+#if defined(RTW_DEDICATED_P2P_DEVICE) -+int rtw_cfg80211_redirect_pd_wdev(struct wiphy *wiphy, u8 *ra, struct wireless_dev **wdev); -+int rtw_cfg80211_is_scan_by_pd_wdev(_adapter *adapter); -+int rtw_pd_iface_alloc(struct wiphy *wiphy, const char *name, struct wireless_dev **pd_wdev); -+void rtw_pd_iface_free(struct wiphy *wiphy); -+#endif -+#endif /* CONFIG_P2P */ -+ -+void rtw_cfg80211_set_is_mgmt_tx(_adapter *adapter, u8 val); -+u8 rtw_cfg80211_get_is_mgmt_tx(_adapter *adapter); -+ -+void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, size_t len); -+ -+void rtw_cfg80211_rx_p2p_action_public(_adapter *padapter, union recv_frame *rframe); -+void rtw_cfg80211_rx_action_p2p(_adapter *padapter, union recv_frame *rframe); -+void rtw_cfg80211_rx_action(_adapter *adapter, union recv_frame *rframe, const char *msg); -+void rtw_cfg80211_rx_probe_request(_adapter *padapter, union recv_frame *rframe); -+ -+int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, int type); -+ -+bool rtw_cfg80211_pwr_mgmt(_adapter *adapter); -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) && !defined(COMPAT_KERNEL_RELEASE) -+#define rtw_cfg80211_rx_mgmt(wdev, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt(wdev_to_ndev(wdev), freq, buf, len, gfp) -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) -+#define rtw_cfg80211_rx_mgmt(wdev, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt(wdev_to_ndev(wdev), freq, sig_dbm, buf, len, gfp) -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0)) -+#define rtw_cfg80211_rx_mgmt(wdev, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt(wdev, freq, sig_dbm, buf, len, gfp) -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3 , 18 , 0)) -+#define rtw_cfg80211_rx_mgmt(wdev , freq , sig_dbm , buf , len , gfp) cfg80211_rx_mgmt(wdev , freq , sig_dbm , buf , len , 0 , gfp) -+#else -+#define rtw_cfg80211_rx_mgmt(wdev , freq , sig_dbm , buf , len , gfp) cfg80211_rx_mgmt(wdev , freq , sig_dbm , buf , len , 0) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) && !defined(COMPAT_KERNEL_RELEASE) -+#define rtw_cfg80211_send_rx_assoc(adapter, bss, buf, len) cfg80211_send_rx_assoc((adapter)->pnetdev, buf, len) -+#else -+#define rtw_cfg80211_send_rx_assoc(adapter, bss, buf, len) cfg80211_send_rx_assoc((adapter)->pnetdev, bss, buf, len) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) -+#define rtw_cfg80211_mgmt_tx_status(wdev, cookie, buf, len, ack, gfp) cfg80211_mgmt_tx_status(wdev_to_ndev(wdev), cookie, buf, len, ack, gfp) -+#else -+#define rtw_cfg80211_mgmt_tx_status(wdev, cookie, buf, len, ack, gfp) cfg80211_mgmt_tx_status(wdev, cookie, buf, len, ack, gfp) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) -+#define rtw_cfg80211_ready_on_channel(wdev, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel(wdev_to_ndev(wdev), cookie, chan, channel_type, duration, gfp) -+#define rtw_cfg80211_remain_on_channel_expired(wdev, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired(wdev_to_ndev(wdev), cookie, chan, chan_type, gfp) -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+#define rtw_cfg80211_ready_on_channel(wdev, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel(wdev, cookie, chan, channel_type, duration, gfp) -+#define rtw_cfg80211_remain_on_channel_expired(wdev, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired(wdev, cookie, chan, chan_type, gfp) -+#else -+#define rtw_cfg80211_ready_on_channel(wdev, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel(wdev, cookie, chan, duration, gfp) -+#define rtw_cfg80211_remain_on_channel_expired(wdev, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired(wdev, cookie, chan, gfp) -+#endif -+ -+#define rtw_cfg80211_connect_result(wdev, bssid, req_ie, req_ie_len, resp_ie, resp_ie_len, status, gfp) cfg80211_connect_result(wdev_to_ndev(wdev), bssid, req_ie, req_ie_len, resp_ie, resp_ie_len, status, gfp) -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0)) -+#define rtw_cfg80211_disconnected(wdev, reason, ie, ie_len, locally_generated, gfp) cfg80211_disconnected(wdev_to_ndev(wdev), reason, ie, ie_len, gfp) -+#else -+#define rtw_cfg80211_disconnected(wdev, reason, ie, ie_len, locally_generated, gfp) cfg80211_disconnected(wdev_to_ndev(wdev), reason, ie, ie_len, locally_generated, gfp) -+#endif -+ -+#ifdef CONFIG_RTW_80211R -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) -+#define rtw_cfg80211_ft_event(adapter, parm) cfg80211_ft_event((adapter)->pnetdev, parm) -+#else -+ #error "Cannot support FT for KERNEL_VERSION < 3.10\n" -+#endif -+#endif -+ -+#if (KERNEL_VERSION(4, 7, 0) >= LINUX_VERSION_CODE) -+#define NUM_NL80211_BANDS IEEE80211_NUM_BANDS -+#endif -+ -+#include "rtw_cfgvendor.h" -+ -+#endif /* __IOCTL_CFG80211_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_linux.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_linux.c 2018-02-11 21:44:27.175146513 +0200 -@@ -0,0 +1,13299 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _IOCTL_LINUX_C_ -+ -+#include -+#include -+#include -+#include "../../hal/phydm/phydm_precomp.h" -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 27)) -+#define iwe_stream_add_event(a, b, c, d, e) iwe_stream_add_event(b, c, d, e) -+#define iwe_stream_add_point(a, b, c, d, e) iwe_stream_add_point(b, c, d, e) -+#endif -+ -+#ifdef CONFIG_80211N_HT -+extern int rtw_ht_enable; -+#endif -+ -+ -+#define RTL_IOCTL_WPA_SUPPLICANT (SIOCIWFIRSTPRIV+30) -+ -+#define SCAN_ITEM_SIZE 768 -+#define MAX_CUSTOM_LEN 64 -+#define RATE_COUNT 4 -+ -+#ifdef CONFIG_GLOBAL_UI_PID -+extern int ui_pid[3]; -+#endif -+ -+/* combo scan */ -+#define WEXT_CSCAN_AMOUNT 9 -+#define WEXT_CSCAN_BUF_LEN 360 -+#define WEXT_CSCAN_HEADER "CSCAN S\x01\x00\x00S\x00" -+#define WEXT_CSCAN_HEADER_SIZE 12 -+#define WEXT_CSCAN_SSID_SECTION 'S' -+#define WEXT_CSCAN_CHANNEL_SECTION 'C' -+#define WEXT_CSCAN_NPROBE_SECTION 'N' -+#define WEXT_CSCAN_ACTV_DWELL_SECTION 'A' -+#define WEXT_CSCAN_PASV_DWELL_SECTION 'P' -+#define WEXT_CSCAN_HOME_DWELL_SECTION 'H' -+#define WEXT_CSCAN_TYPE_SECTION 'T' -+ -+ -+extern u8 key_2char2num(u8 hch, u8 lch); -+extern u8 str_2char2num(u8 hch, u8 lch); -+extern void macstr2num(u8 *dst, u8 *src); -+extern u8 convert_ip_addr(u8 hch, u8 mch, u8 lch); -+ -+u32 rtw_rates[] = {1000000, 2000000, 5500000, 11000000, -+ 6000000, 9000000, 12000000, 18000000, 24000000, 36000000, 48000000, 54000000}; -+ -+static const char *const iw_operation_mode[] = { -+ "Auto", "Ad-Hoc", "Managed", "Master", "Repeater", "Secondary", "Monitor" -+}; -+ -+static int hex2num_i(char c) -+{ -+ if (c >= '0' && c <= '9') -+ return c - '0'; -+ if (c >= 'a' && c <= 'f') -+ return c - 'a' + 10; -+ if (c >= 'A' && c <= 'F') -+ return c - 'A' + 10; -+ return -1; -+} -+ -+static int hex2byte_i(const char *hex) -+{ -+ int a, b; -+ a = hex2num_i(*hex++); -+ if (a < 0) -+ return -1; -+ b = hex2num_i(*hex++); -+ if (b < 0) -+ return -1; -+ return (a << 4) | b; -+} -+ -+/** -+ * hwaddr_aton - Convert ASCII string to MAC address -+ * @txt: MAC address as a string (e.g., "00:11:22:33:44:55") -+ * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes) -+ * Returns: 0 on success, -1 on failure (e.g., string not a MAC address) -+ */ -+static int hwaddr_aton_i(const char *txt, u8 *addr) -+{ -+ int i; -+ -+ for (i = 0; i < 6; i++) { -+ int a, b; -+ -+ a = hex2num_i(*txt++); -+ if (a < 0) -+ return -1; -+ b = hex2num_i(*txt++); -+ if (b < 0) -+ return -1; -+ *addr++ = (a << 4) | b; -+ if (i < 5 && *txt++ != ':') -+ return -1; -+ } -+ -+ return 0; -+} -+ -+static void indicate_wx_custom_event(_adapter *padapter, char *msg) -+{ -+ u8 *buff, *p; -+ union iwreq_data wrqu; -+ -+ if (strlen(msg) > IW_CUSTOM_MAX) { -+ RTW_INFO("%s strlen(msg):%zu > IW_CUSTOM_MAX:%u\n", __FUNCTION__ , strlen(msg), IW_CUSTOM_MAX); -+ return; -+ } -+ -+ buff = rtw_zmalloc(IW_CUSTOM_MAX + 1); -+ if (!buff) -+ return; -+ -+ _rtw_memcpy(buff, msg, strlen(msg)); -+ -+ _rtw_memset(&wrqu, 0, sizeof(wrqu)); -+ wrqu.data.length = strlen(msg); -+ -+ RTW_INFO("%s %s\n", __FUNCTION__, buff); -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(padapter->pnetdev, IWEVCUSTOM, &wrqu, buff); -+#endif -+ -+ rtw_mfree(buff, IW_CUSTOM_MAX + 1); -+ -+} -+ -+ -+static void request_wps_pbc_event(_adapter *padapter) -+{ -+ u8 *buff, *p; -+ union iwreq_data wrqu; -+ -+ -+ buff = rtw_malloc(IW_CUSTOM_MAX); -+ if (!buff) -+ return; -+ -+ _rtw_memset(buff, 0, IW_CUSTOM_MAX); -+ -+ p = buff; -+ -+ p += sprintf(p, "WPS_PBC_START.request=TRUE"); -+ -+ _rtw_memset(&wrqu, 0, sizeof(wrqu)); -+ -+ wrqu.data.length = p - buff; -+ -+ wrqu.data.length = (wrqu.data.length < IW_CUSTOM_MAX) ? wrqu.data.length : IW_CUSTOM_MAX; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(padapter->pnetdev, IWEVCUSTOM, &wrqu, buff); -+#endif -+ -+ if (buff) -+ rtw_mfree(buff, IW_CUSTOM_MAX); -+ -+} -+ -+#ifdef CONFIG_SUPPORT_HW_WPS_PBC -+void rtw_request_wps_pbc_event(_adapter *padapter) -+{ -+#ifdef RTK_DMP_PLATFORM -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12)) -+ kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_NET_PBC); -+#else -+ kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_NET_PBC); -+#endif -+#else -+ -+ if (padapter->pid[0] == 0) { -+ /* 0 is the default value and it means the application monitors the HW PBC doesn't privde its pid to driver. */ -+ return; -+ } -+ -+ rtw_signal_process(padapter->pid[0], SIGUSR1); -+ -+#endif -+ -+ rtw_led_control(padapter, LED_CTL_START_WPS_BOTTON); -+} -+#endif/* #ifdef CONFIG_SUPPORT_HW_WPS_PBC */ -+ -+void indicate_wx_scan_complete_event(_adapter *padapter) -+{ -+ union iwreq_data wrqu; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); -+ -+ /* RTW_INFO("+rtw_indicate_wx_scan_complete_event\n"); */ -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(padapter->pnetdev, SIOCGIWSCAN, &wrqu, NULL); -+#endif -+} -+ -+ -+void rtw_indicate_wx_assoc_event(_adapter *padapter) -+{ -+ union iwreq_data wrqu; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -+ -+ _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); -+ -+ wrqu.ap_addr.sa_family = ARPHRD_ETHER; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) -+ _rtw_memcpy(wrqu.ap_addr.sa_data, pnetwork->MacAddress, ETH_ALEN); -+ else -+ _rtw_memcpy(wrqu.ap_addr.sa_data, pmlmepriv->cur_network.network.MacAddress, ETH_ALEN); -+ -+ RTW_PRINT("assoc success\n"); -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(padapter->pnetdev, SIOCGIWAP, &wrqu, NULL); -+#endif -+} -+ -+void rtw_indicate_wx_disassoc_event(_adapter *padapter) -+{ -+ union iwreq_data wrqu; -+ -+ _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); -+ -+ wrqu.ap_addr.sa_family = ARPHRD_ETHER; -+ _rtw_memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN); -+ -+#ifndef CONFIG_IOCTL_CFG80211 -+ RTW_PRINT("indicate disassoc\n"); -+ wireless_send_event(padapter->pnetdev, SIOCGIWAP, &wrqu, NULL); -+#endif -+} -+ -+/* -+uint rtw_is_cckrates_included(u8 *rate) -+{ -+ u32 i = 0; -+ -+ while(rate[i]!=0) -+ { -+ if ( (((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || -+ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22) ) -+ return _TRUE; -+ i++; -+ } -+ -+ return _FALSE; -+} -+ -+uint rtw_is_cckratesonly_included(u8 *rate) -+{ -+ u32 i = 0; -+ -+ while(rate[i]!=0) -+ { -+ if ( (((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && -+ (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22) ) -+ return _FALSE; -+ i++; -+ } -+ -+ return _TRUE; -+} -+*/ -+ -+static int search_p2p_wfd_ie(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop) -+{ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#ifdef CONFIG_WFD -+ if (SCAN_RESULT_ALL == pwdinfo->wfd_info->scan_result_type) { -+ -+ } else if ((SCAN_RESULT_P2P_ONLY == pwdinfo->wfd_info->scan_result_type) || -+ (SCAN_RESULT_WFD_TYPE == pwdinfo->wfd_info->scan_result_type)) -+#endif /* CONFIG_WFD */ -+ { -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ u32 blnGotP2PIE = _FALSE; -+ -+ /* User is doing the P2P device discovery */ -+ /* The prefix of SSID should be "DIRECT-" and the IE should contains the P2P IE. */ -+ /* If not, the driver should ignore this AP and go to the next AP. */ -+ -+ /* Verifying the SSID */ -+ if (_rtw_memcmp(pnetwork->network.Ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN)) { -+ u32 p2pielen = 0; -+ -+ /* Verifying the P2P IE */ -+ if (rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen)) -+ blnGotP2PIE = _TRUE; -+ } -+ -+ if (blnGotP2PIE == _FALSE) -+ return _FALSE; -+ -+ } -+ } -+ -+#ifdef CONFIG_WFD -+ if (SCAN_RESULT_WFD_TYPE == pwdinfo->wfd_info->scan_result_type) { -+ u32 blnGotWFD = _FALSE; -+ u8 *wfd_ie; -+ uint wfd_ielen = 0; -+ -+ wfd_ie = rtw_bss_ex_get_wfd_ie(&pnetwork->network, NULL, &wfd_ielen); -+ if (wfd_ie) { -+ u8 *wfd_devinfo; -+ uint wfd_devlen; -+ -+ wfd_devinfo = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &wfd_devlen); -+ if (wfd_devinfo) { -+ if (pwdinfo->wfd_info->wfd_device_type == WFD_DEVINFO_PSINK) { -+ /* the first two bits will indicate the WFD device type */ -+ if ((wfd_devinfo[1] & 0x03) == WFD_DEVINFO_SOURCE) { -+ /* If this device is Miracast PSink device, the scan reuslt should just provide the Miracast source. */ -+ blnGotWFD = _TRUE; -+ } -+ } else if (pwdinfo->wfd_info->wfd_device_type == WFD_DEVINFO_SOURCE) { -+ /* the first two bits will indicate the WFD device type */ -+ if ((wfd_devinfo[1] & 0x03) == WFD_DEVINFO_PSINK) { -+ /* If this device is Miracast source device, the scan reuslt should just provide the Miracast PSink. */ -+ /* Todo: How about the SSink?! */ -+ blnGotWFD = _TRUE; -+ } -+ } -+ } -+ } -+ -+ if (blnGotWFD == _FALSE) -+ return _FALSE; -+ } -+#endif /* CONFIG_WFD */ -+ -+#endif /* CONFIG_P2P */ -+ return _TRUE; -+} -+static inline char *iwe_stream_mac_addr_proess(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop, struct iw_event *iwe) -+{ -+ /* AP MAC address */ -+ iwe->cmd = SIOCGIWAP; -+ iwe->u.ap_addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memcpy(iwe->u.ap_addr.sa_data, pnetwork->network.MacAddress, ETH_ALEN); -+ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_ADDR_LEN); -+ return start; -+} -+static inline char *iwe_stream_essid_proess(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop, struct iw_event *iwe) -+{ -+ -+ /* Add the ESSID */ -+ iwe->cmd = SIOCGIWESSID; -+ iwe->u.data.flags = 1; -+ iwe->u.data.length = min((u16)pnetwork->network.Ssid.SsidLength, (u16)32); -+ start = iwe_stream_add_point(info, start, stop, iwe, pnetwork->network.Ssid.Ssid); -+ return start; -+} -+ -+static inline char *iwe_stream_chan_process(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop, struct iw_event *iwe) -+{ -+ if (pnetwork->network.Configuration.DSConfig < 1 /*|| pnetwork->network.Configuration.DSConfig>14*/) -+ pnetwork->network.Configuration.DSConfig = 1; -+ -+ /* Add frequency/channel */ -+ iwe->cmd = SIOCGIWFREQ; -+ iwe->u.freq.m = rtw_ch2freq(pnetwork->network.Configuration.DSConfig) * 100000; -+ iwe->u.freq.e = 1; -+ iwe->u.freq.i = pnetwork->network.Configuration.DSConfig; -+ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_FREQ_LEN); -+ return start; -+} -+static inline char *iwe_stream_mode_process(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop, struct iw_event *iwe, u16 cap) -+{ -+ /* Add mode */ -+ if (cap & (WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_BSS)) { -+ iwe->cmd = SIOCGIWMODE; -+ if (cap & WLAN_CAPABILITY_BSS) -+ iwe->u.mode = IW_MODE_MASTER; -+ else -+ iwe->u.mode = IW_MODE_ADHOC; -+ -+ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_UINT_LEN); -+ } -+ return start; -+} -+static inline char *iwe_stream_encryption_process(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop, struct iw_event *iwe, u16 cap) -+{ -+ -+ /* Add encryption capability */ -+ iwe->cmd = SIOCGIWENCODE; -+ if (cap & WLAN_CAPABILITY_PRIVACY) -+ iwe->u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; -+ else -+ iwe->u.data.flags = IW_ENCODE_DISABLED; -+ iwe->u.data.length = 0; -+ start = iwe_stream_add_point(info, start, stop, iwe, pnetwork->network.Ssid.Ssid); -+ return start; -+ -+} -+ -+static inline char *iwe_stream_protocol_process(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop, struct iw_event *iwe) -+{ -+ u16 ht_cap = _FALSE, vht_cap = _FALSE; -+ u32 ht_ielen = 0, vht_ielen = 0; -+ char *p; -+ u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0 : 12); /* Probe Request */ -+ -+ /* parsing HT_CAP_IE */ -+ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - ie_offset); -+ if (p && ht_ielen > 0) -+ ht_cap = _TRUE; -+ -+#ifdef CONFIG_80211AC_VHT -+ /* parsing VHT_CAP_IE */ -+ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength - ie_offset); -+ if (p && vht_ielen > 0) -+ vht_cap = _TRUE; -+#endif -+ /* Add the protocol name */ -+ iwe->cmd = SIOCGIWNAME; -+ if ((rtw_is_cckratesonly_included((u8 *)&pnetwork->network.SupportedRates)) == _TRUE) { -+ if (ht_cap == _TRUE) -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11bn"); -+ else -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11b"); -+ } else if ((rtw_is_cckrates_included((u8 *)&pnetwork->network.SupportedRates)) == _TRUE) { -+ if (ht_cap == _TRUE) -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11bgn"); -+ else -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11bg"); -+ } else { -+ if (pnetwork->network.Configuration.DSConfig > 14) { -+ #ifdef CONFIG_80211AC_VHT -+ if (vht_cap == _TRUE) -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11AC"); -+ else -+ #endif -+ { -+ if (ht_cap == _TRUE) -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11an"); -+ else -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11a"); -+ } -+ } else { -+ if (ht_cap == _TRUE) -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11gn"); -+ else -+ snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11g"); -+ } -+ } -+ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_CHAR_LEN); -+ return start; -+} -+ -+static inline char *iwe_stream_rate_process(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop, struct iw_event *iwe) -+{ -+ u32 ht_ielen = 0, vht_ielen = 0; -+ char *p; -+ u16 max_rate = 0, rate, ht_cap = _FALSE, vht_cap = _FALSE; -+ u32 i = 0; -+ u8 bw_40MHz = 0, short_GI = 0, bw_160MHz = 0, vht_highest_rate = 0; -+ u16 mcs_rate = 0, vht_data_rate = 0; -+ char custom[MAX_CUSTOM_LEN] = {0}; -+ u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0 : 12); /* Probe Request */ -+ -+ /* parsing HT_CAP_IE */ -+ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - ie_offset); -+ if (p && ht_ielen > 0) { -+ struct rtw_ieee80211_ht_cap *pht_capie; -+ ht_cap = _TRUE; -+ pht_capie = (struct rtw_ieee80211_ht_cap *)(p + 2); -+ _rtw_memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2); -+ bw_40MHz = (pht_capie->cap_info & IEEE80211_HT_CAP_SUP_WIDTH) ? 1 : 0; -+ short_GI = (pht_capie->cap_info & (IEEE80211_HT_CAP_SGI_20 | IEEE80211_HT_CAP_SGI_40)) ? 1 : 0; -+ } -+ -+#ifdef CONFIG_80211AC_VHT -+ /* parsing VHT_CAP_IE */ -+ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength - ie_offset); -+ if (p && vht_ielen > 0) { -+ u8 mcs_map[2]; -+ -+ vht_cap = _TRUE; -+ bw_160MHz = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p + 2); -+ if (bw_160MHz) -+ short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI160M(p + 2); -+ else -+ short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI80M(p + 2); -+ -+ _rtw_memcpy(mcs_map, GET_VHT_CAPABILITY_ELE_TX_MCS(p + 2), 2); -+ -+ vht_highest_rate = rtw_get_vht_highest_rate(mcs_map); -+ vht_data_rate = rtw_vht_mcs_to_data_rate(CHANNEL_WIDTH_80, short_GI, vht_highest_rate); -+ } -+#endif -+ -+ /*Add basic and extended rates */ -+ p = custom; -+ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): "); -+ while (pnetwork->network.SupportedRates[i] != 0) { -+ rate = pnetwork->network.SupportedRates[i] & 0x7F; -+ if (rate > max_rate) -+ max_rate = rate; -+ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), -+ "%d%s ", rate >> 1, (rate & 1) ? ".5" : ""); -+ i++; -+ } -+#ifdef CONFIG_80211AC_VHT -+ if (vht_cap == _TRUE) -+ max_rate = vht_data_rate; -+ else -+#endif -+ if (ht_cap == _TRUE) { -+ if (mcs_rate & 0x8000) /* MCS15 */ -+ max_rate = (bw_40MHz) ? ((short_GI) ? 300 : 270) : ((short_GI) ? 144 : 130); -+ -+ else if (mcs_rate & 0x0080) /* MCS7 */ -+ max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65); -+ else { /* default MCS7 */ -+ /* RTW_INFO("wx_get_scan, mcs_rate_bitmap=0x%x\n", mcs_rate); */ -+ max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65); -+ } -+ -+ max_rate = max_rate * 2; /* Mbps/2; */ -+ } -+ -+ iwe->cmd = SIOCGIWRATE; -+ iwe->u.bitrate.fixed = iwe->u.bitrate.disabled = 0; -+ iwe->u.bitrate.value = max_rate * 500000; -+ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_PARAM_LEN); -+ return start ; -+} -+ -+static inline char *iwe_stream_wpa_wpa2_process(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop, struct iw_event *iwe) -+{ -+ int buf_size = MAX_WPA_IE_LEN * 2; -+ /* u8 pbuf[buf_size]={0}; */ -+ u8 *pbuf = rtw_zmalloc(buf_size); -+ -+ u8 wpa_ie[255] = {0}, rsn_ie[255] = {0}; -+ u16 i, wpa_len = 0, rsn_len = 0; -+ u8 *p; -+ sint out_len = 0; -+ -+ -+ if (pbuf) { -+ p = pbuf; -+ -+ /* parsing WPA/WPA2 IE */ -+ if (pnetwork->network.Reserved[0] != 2) { /* Probe Request */ -+ out_len = rtw_get_sec_ie(pnetwork->network.IEs , pnetwork->network.IELength, rsn_ie, &rsn_len, wpa_ie, &wpa_len); -+ -+ if (wpa_len > 0) { -+ -+ _rtw_memset(pbuf, 0, buf_size); -+ p += sprintf(p, "wpa_ie="); -+ for (i = 0; i < wpa_len; i++) -+ p += sprintf(p, "%02x", wpa_ie[i]); -+ -+ if (wpa_len > 100) { -+ printk("-----------------Len %d----------------\n", wpa_len); -+ for (i = 0; i < wpa_len; i++) -+ printk("%02x ", wpa_ie[i]); -+ printk("\n"); -+ printk("-----------------Len %d----------------\n", wpa_len); -+ } -+ -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd = IWEVCUSTOM; -+ iwe->u.data.length = strlen(pbuf); -+ start = iwe_stream_add_point(info, start, stop, iwe, pbuf); -+ -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd = IWEVGENIE; -+ iwe->u.data.length = wpa_len; -+ start = iwe_stream_add_point(info, start, stop, iwe, wpa_ie); -+ } -+ if (rsn_len > 0) { -+ -+ _rtw_memset(pbuf, 0, buf_size); -+ p += sprintf(p, "rsn_ie="); -+ for (i = 0; i < rsn_len; i++) -+ p += sprintf(p, "%02x", rsn_ie[i]); -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd = IWEVCUSTOM; -+ iwe->u.data.length = strlen(pbuf); -+ start = iwe_stream_add_point(info, start, stop, iwe, pbuf); -+ -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd = IWEVGENIE; -+ iwe->u.data.length = rsn_len; -+ start = iwe_stream_add_point(info, start, stop, iwe, rsn_ie); -+ } -+ } -+ -+ rtw_mfree(pbuf, buf_size); -+ } -+ return start; -+} -+ -+static inline char *iwe_stream_wps_process(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop, struct iw_event *iwe) -+{ -+ /* parsing WPS IE */ -+ uint cnt = 0, total_ielen; -+ u8 *wpsie_ptr = NULL; -+ uint wps_ielen = 0; -+ u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0 : 12); -+ -+ u8 *ie_ptr = pnetwork->network.IEs + ie_offset; -+ total_ielen = pnetwork->network.IELength - ie_offset; -+ -+ if (pnetwork->network.Reserved[0] == 2) { /* Probe Request */ -+ ie_ptr = pnetwork->network.IEs; -+ total_ielen = pnetwork->network.IELength; -+ } else { /* Beacon or Probe Respones */ -+ ie_ptr = pnetwork->network.IEs + _FIXED_IE_LENGTH_; -+ total_ielen = pnetwork->network.IELength - _FIXED_IE_LENGTH_; -+ } -+ while (cnt < total_ielen) { -+ if (rtw_is_wps_ie(&ie_ptr[cnt], &wps_ielen) && (wps_ielen > 2)) { -+ wpsie_ptr = &ie_ptr[cnt]; -+ iwe->cmd = IWEVGENIE; -+ iwe->u.data.length = (u16)wps_ielen; -+ start = iwe_stream_add_point(info, start, stop, iwe, wpsie_ptr); -+ } -+ cnt += ie_ptr[cnt + 1] + 2; /* goto next */ -+ } -+ return start; -+} -+ -+static inline char *iwe_stream_wapi_process(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop, struct iw_event *iwe) -+{ -+#ifdef CONFIG_WAPI_SUPPORT -+ char *p; -+ -+ if (pnetwork->network.Reserved[0] != 2) { /* Probe Request */ -+ sint out_len_wapi = 0; -+ /* here use static for stack size */ -+ static u8 buf_wapi[MAX_WAPI_IE_LEN * 2] = {0}; -+ static u8 wapi_ie[MAX_WAPI_IE_LEN] = {0}; -+ u16 wapi_len = 0; -+ u16 i; -+ -+ out_len_wapi = rtw_get_wapi_ie(pnetwork->network.IEs , pnetwork->network.IELength, wapi_ie, &wapi_len); -+ -+ RTW_INFO("rtw_wx_get_scan: %s ", pnetwork->network.Ssid.Ssid); -+ RTW_INFO("rtw_wx_get_scan: ssid = %d ", wapi_len); -+ -+ -+ if (wapi_len > 0) { -+ p = buf_wapi; -+ /* _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN*2); */ -+ p += sprintf(p, "wapi_ie="); -+ for (i = 0; i < wapi_len; i++) -+ p += sprintf(p, "%02x", wapi_ie[i]); -+ -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd = IWEVCUSTOM; -+ iwe->u.data.length = strlen(buf_wapi); -+ start = iwe_stream_add_point(info, start, stop, iwe, buf_wapi); -+ -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd = IWEVGENIE; -+ iwe->u.data.length = wapi_len; -+ start = iwe_stream_add_point(info, start, stop, iwe, wapi_ie); -+ } -+ } -+#endif/* #ifdef CONFIG_WAPI_SUPPORT */ -+ return start; -+} -+ -+static inline char *iwe_stream_rssi_process(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop, struct iw_event *iwe) -+{ -+ u8 ss, sq; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ /* Add quality statistics */ -+ iwe->cmd = IWEVQUAL; -+ iwe->u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ | IW_QUAL_NOISE_UPDATED -+#else -+ | IW_QUAL_NOISE_INVALID -+#endif -+#ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ | IW_QUAL_DBM -+#endif -+ ; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { -+ ss = padapter->recvpriv.signal_strength; -+ sq = padapter->recvpriv.signal_qual; -+ } else { -+ ss = pnetwork->network.PhyInfo.SignalStrength; -+ sq = pnetwork->network.PhyInfo.SignalQuality; -+ } -+ -+ -+#ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ iwe->u.qual.level = (u8) translate_percentage_to_dbm(ss); /* dbm */ -+#else -+#ifdef CONFIG_SIGNAL_SCALE_MAPPING -+ iwe->u.qual.level = (u8)ss; /* % */ -+#else -+ { -+ /* Do signal scale mapping when using percentage as the unit of signal strength, since the scale mapping is skipped in odm */ -+ -+ HAL_DATA_TYPE *pHal = GET_HAL_DATA(padapter); -+ -+ iwe->u.qual.level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, ss); -+ } -+#endif -+#endif -+ -+ iwe->u.qual.qual = (u8)sq; /* signal quality */ -+ -+#ifdef CONFIG_PLATFORM_ROCKCHIPS -+ iwe->u.qual.noise = -100; /* noise level suggest by zhf@rockchips */ -+#else -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ { -+ s16 tmp_noise = 0; -+ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(pnetwork->network.Configuration.DSConfig), &(tmp_noise)); -+ iwe->u.qual.noise = tmp_noise ; -+ } -+#else -+ iwe->u.qual.noise = 0; /* noise level */ -+#endif -+#endif /* CONFIG_PLATFORM_ROCKCHIPS */ -+ -+ /* RTW_INFO("iqual=%d, ilevel=%d, inoise=%d, iupdated=%d\n", iwe.u.qual.qual, iwe.u.qual.level , iwe.u.qual.noise, iwe.u.qual.updated); */ -+ -+ start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_QUAL_LEN); -+ return start; -+} -+ -+static inline char *iwe_stream_net_rsv_process(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop, struct iw_event *iwe) -+{ -+ u8 buf[32] = {0}; -+ u8 *p, *pos; -+ int len; -+ p = buf; -+ pos = pnetwork->network.Reserved; -+ -+ p += sprintf(p, "fm=%02X%02X", pos[1], pos[0]); -+ _rtw_memset(iwe, 0, sizeof(*iwe)); -+ iwe->cmd = IWEVCUSTOM; -+ iwe->u.data.length = strlen(buf); -+ start = iwe_stream_add_point(info, start, stop, iwe, buf); -+ return start; -+} -+ -+#if 1 -+static char *translate_scan(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop) -+{ -+ struct iw_event iwe; -+ u16 cap = 0; -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ -+ if (_FALSE == search_p2p_wfd_ie(padapter, info, pnetwork, start, stop)) -+ return start; -+ -+ start = iwe_stream_mac_addr_proess(padapter, info, pnetwork, start, stop, &iwe); -+ start = iwe_stream_essid_proess(padapter, info, pnetwork, start, stop, &iwe); -+ start = iwe_stream_protocol_process(padapter, info, pnetwork, start, stop, &iwe); -+ if (pnetwork->network.Reserved[0] == 2) /* Probe Request */ -+ cap = 0; -+ else { -+ _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); -+ cap = le16_to_cpu(cap); -+ } -+ -+ start = iwe_stream_mode_process(padapter, info, pnetwork, start, stop, &iwe, cap); -+ start = iwe_stream_chan_process(padapter, info, pnetwork, start, stop, &iwe); -+ start = iwe_stream_encryption_process(padapter, info, pnetwork, start, stop, &iwe, cap); -+ start = iwe_stream_rate_process(padapter, info, pnetwork, start, stop, &iwe); -+ start = iwe_stream_wpa_wpa2_process(padapter, info, pnetwork, start, stop, &iwe); -+ start = iwe_stream_wps_process(padapter, info, pnetwork, start, stop, &iwe); -+ start = iwe_stream_wapi_process(padapter, info, pnetwork, start, stop, &iwe); -+ start = iwe_stream_rssi_process(padapter, info, pnetwork, start, stop, &iwe); -+ start = iwe_stream_net_rsv_process(padapter, info, pnetwork, start, stop, &iwe); -+ -+ return start; -+} -+#else -+static char *translate_scan(_adapter *padapter, -+ struct iw_request_info *info, struct wlan_network *pnetwork, -+ char *start, char *stop) -+{ -+ struct iw_event iwe; -+ u16 cap; -+ u32 ht_ielen = 0, vht_ielen = 0; -+ char custom[MAX_CUSTOM_LEN]; -+ char *p; -+ u16 max_rate = 0, rate, ht_cap = _FALSE, vht_cap = _FALSE; -+ u32 i = 0; -+ char *current_val; -+ long rssi; -+ u8 bw_40MHz = 0, short_GI = 0, bw_160MHz = 0, vht_highest_rate = 0; -+ u16 mcs_rate = 0, vht_data_rate = 0; -+ u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0 : 12); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ if (_FALSE == search_p2p_wfd_ie(padapter, info, pnetwork, start, stop)) -+ return start; -+ -+ /* AP MAC address */ -+ iwe.cmd = SIOCGIWAP; -+ iwe.u.ap_addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memcpy(iwe.u.ap_addr.sa_data, pnetwork->network.MacAddress, ETH_ALEN); -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_ADDR_LEN); -+ -+ /* Add the ESSID */ -+ iwe.cmd = SIOCGIWESSID; -+ iwe.u.data.flags = 1; -+ iwe.u.data.length = min((u16)pnetwork->network.Ssid.SsidLength, (u16)32); -+ start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid); -+ -+ /* parsing HT_CAP_IE */ -+ if (pnetwork->network.Reserved[0] == 2) /* Probe Request */ -+ p = rtw_get_ie(&pnetwork->network.IEs[0], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength); -+ else -+ p = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - 12); -+ if (p && ht_ielen > 0) { -+ struct rtw_ieee80211_ht_cap *pht_capie; -+ ht_cap = _TRUE; -+ pht_capie = (struct rtw_ieee80211_ht_cap *)(p + 2); -+ _rtw_memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2); -+ bw_40MHz = (pht_capie->cap_info & IEEE80211_HT_CAP_SUP_WIDTH) ? 1 : 0; -+ short_GI = (pht_capie->cap_info & (IEEE80211_HT_CAP_SGI_20 | IEEE80211_HT_CAP_SGI_40)) ? 1 : 0; -+ } -+ -+#ifdef CONFIG_80211AC_VHT -+ /* parsing VHT_CAP_IE */ -+ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength - ie_offset); -+ if (p && vht_ielen > 0) { -+ u8 mcs_map[2]; -+ -+ vht_cap = _TRUE; -+ bw_160MHz = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p + 2); -+ if (bw_160MHz) -+ short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI160M(p + 2); -+ else -+ short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI80M(p + 2); -+ -+ _rtw_memcpy(mcs_map, GET_VHT_CAPABILITY_ELE_TX_MCS(p + 2), 2); -+ -+ vht_highest_rate = rtw_get_vht_highest_rate(mcs_map); -+ vht_data_rate = rtw_vht_mcs_to_data_rate(CHANNEL_WIDTH_80, short_GI, vht_highest_rate); -+ } -+#endif -+ -+ /* Add the protocol name */ -+ iwe.cmd = SIOCGIWNAME; -+ if ((rtw_is_cckratesonly_included((u8 *)&pnetwork->network.SupportedRates)) == _TRUE) { -+ if (ht_cap == _TRUE) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bn"); -+ else -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11b"); -+ } else if ((rtw_is_cckrates_included((u8 *)&pnetwork->network.SupportedRates)) == _TRUE) { -+ if (ht_cap == _TRUE) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bgn"); -+ else -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bg"); -+ } else { -+ if (pnetwork->network.Configuration.DSConfig > 14) { -+ if (vht_cap == _TRUE) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11AC"); -+ else if (ht_cap == _TRUE) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11an"); -+ else -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11a"); -+ } else { -+ if (ht_cap == _TRUE) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11gn"); -+ else -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11g"); -+ } -+ } -+ -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_CHAR_LEN); -+ -+ /* Add mode */ -+ if (pnetwork->network.Reserved[0] == 2) /* Probe Request */ -+ cap = 0; -+ else { -+ iwe.cmd = SIOCGIWMODE; -+ _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); -+ cap = le16_to_cpu(cap); -+ } -+ -+ if (cap & (WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_BSS)) { -+ if (cap & WLAN_CAPABILITY_BSS) -+ iwe.u.mode = IW_MODE_MASTER; -+ else -+ iwe.u.mode = IW_MODE_ADHOC; -+ -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_UINT_LEN); -+ } -+ -+ if (pnetwork->network.Configuration.DSConfig < 1 /*|| pnetwork->network.Configuration.DSConfig>14*/) -+ pnetwork->network.Configuration.DSConfig = 1; -+ -+ /* Add frequency/channel */ -+ iwe.cmd = SIOCGIWFREQ; -+ iwe.u.freq.m = rtw_ch2freq(pnetwork->network.Configuration.DSConfig) * 100000; -+ iwe.u.freq.e = 1; -+ iwe.u.freq.i = pnetwork->network.Configuration.DSConfig; -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_FREQ_LEN); -+ -+ /* Add encryption capability */ -+ iwe.cmd = SIOCGIWENCODE; -+ if (cap & WLAN_CAPABILITY_PRIVACY) -+ iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; -+ else -+ iwe.u.data.flags = IW_ENCODE_DISABLED; -+ iwe.u.data.length = 0; -+ start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid); -+ -+ /*Add basic and extended rates */ -+ max_rate = 0; -+ p = custom; -+ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): "); -+ while (pnetwork->network.SupportedRates[i] != 0) { -+ rate = pnetwork->network.SupportedRates[i] & 0x7F; -+ if (rate > max_rate) -+ max_rate = rate; -+ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), -+ "%d%s ", rate >> 1, (rate & 1) ? ".5" : ""); -+ i++; -+ } -+ -+ if (vht_cap == _TRUE) -+ max_rate = vht_data_rate; -+ else if (ht_cap == _TRUE) { -+ if (mcs_rate & 0x8000) /* MCS15 */ -+ max_rate = (bw_40MHz) ? ((short_GI) ? 300 : 270) : ((short_GI) ? 144 : 130); -+ -+ else if (mcs_rate & 0x0080) /* MCS7 */ -+ max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65); -+ else { /* default MCS7 */ -+ /* RTW_INFO("wx_get_scan, mcs_rate_bitmap=0x%x\n", mcs_rate); */ -+ max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65); -+ } -+ -+ max_rate = max_rate * 2; /* Mbps/2; */ -+ } -+ -+ iwe.cmd = SIOCGIWRATE; -+ iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0; -+ iwe.u.bitrate.value = max_rate * 500000; -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_PARAM_LEN); -+ -+ /* parsing WPA/WPA2 IE */ -+ if (pnetwork->network.Reserved[0] != 2) { /* Probe Request */ -+ u8 buf[MAX_WPA_IE_LEN * 2]; -+ u8 wpa_ie[255], rsn_ie[255]; -+ u16 wpa_len = 0, rsn_len = 0; -+ u8 *p; -+ sint out_len = 0; -+ out_len = rtw_get_sec_ie(pnetwork->network.IEs , pnetwork->network.IELength, rsn_ie, &rsn_len, wpa_ie, &wpa_len); -+ -+ if (wpa_len > 0) { -+ p = buf; -+ _rtw_memset(buf, 0, MAX_WPA_IE_LEN * 2); -+ p += sprintf(p, "wpa_ie="); -+ for (i = 0; i < wpa_len; i++) -+ p += sprintf(p, "%02x", wpa_ie[i]); -+ -+ if (wpa_len > 100) { -+ printk("-----------------Len %d----------------\n", wpa_len); -+ for (i = 0; i < wpa_len; i++) -+ printk("%02x ", wpa_ie[i]); -+ printk("\n"); -+ printk("-----------------Len %d----------------\n", wpa_len); -+ } -+ -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ iwe.u.data.length = strlen(buf); -+ start = iwe_stream_add_point(info, start, stop, &iwe, buf); -+ -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVGENIE; -+ iwe.u.data.length = wpa_len; -+ start = iwe_stream_add_point(info, start, stop, &iwe, wpa_ie); -+ } -+ if (rsn_len > 0) { -+ p = buf; -+ _rtw_memset(buf, 0, MAX_WPA_IE_LEN * 2); -+ p += sprintf(p, "rsn_ie="); -+ for (i = 0; i < rsn_len; i++) -+ p += sprintf(p, "%02x", rsn_ie[i]); -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ iwe.u.data.length = strlen(buf); -+ start = iwe_stream_add_point(info, start, stop, &iwe, buf); -+ -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVGENIE; -+ iwe.u.data.length = rsn_len; -+ start = iwe_stream_add_point(info, start, stop, &iwe, rsn_ie); -+ } -+ } -+ -+ { /* parsing WPS IE */ -+ uint cnt = 0, total_ielen; -+ u8 *wpsie_ptr = NULL; -+ uint wps_ielen = 0; -+ -+ u8 *ie_ptr = pnetwork->network.IEs + ie_offset; -+ total_ielen = pnetwork->network.IELength - ie_offset; -+ -+ if (pnetwork->network.Reserved[0] == 2) { /* Probe Request */ -+ ie_ptr = pnetwork->network.IEs; -+ total_ielen = pnetwork->network.IELength; -+ } else { /* Beacon or Probe Respones */ -+ ie_ptr = pnetwork->network.IEs + _FIXED_IE_LENGTH_; -+ total_ielen = pnetwork->network.IELength - _FIXED_IE_LENGTH_; -+ } -+ -+ while (cnt < total_ielen) { -+ if (rtw_is_wps_ie(&ie_ptr[cnt], &wps_ielen) && (wps_ielen > 2)) { -+ wpsie_ptr = &ie_ptr[cnt]; -+ iwe.cmd = IWEVGENIE; -+ iwe.u.data.length = (u16)wps_ielen; -+ start = iwe_stream_add_point(info, start, stop, &iwe, wpsie_ptr); -+ } -+ cnt += ie_ptr[cnt + 1] + 2; /* goto next */ -+ } -+ } -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (pnetwork->network.Reserved[0] != 2) { /* Probe Request */ -+ sint out_len_wapi = 0; -+ /* here use static for stack size */ -+ static u8 buf_wapi[MAX_WAPI_IE_LEN * 2]; -+ static u8 wapi_ie[MAX_WAPI_IE_LEN]; -+ u16 wapi_len = 0; -+ u16 i; -+ -+ _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN); -+ _rtw_memset(wapi_ie, 0, MAX_WAPI_IE_LEN); -+ -+ out_len_wapi = rtw_get_wapi_ie(pnetwork->network.IEs , pnetwork->network.IELength, wapi_ie, &wapi_len); -+ -+ RTW_INFO("rtw_wx_get_scan: %s ", pnetwork->network.Ssid.Ssid); -+ RTW_INFO("rtw_wx_get_scan: ssid = %d ", wapi_len); -+ -+ -+ if (wapi_len > 0) { -+ p = buf_wapi; -+ _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN * 2); -+ p += sprintf(p, "wapi_ie="); -+ for (i = 0; i < wapi_len; i++) -+ p += sprintf(p, "%02x", wapi_ie[i]); -+ -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ iwe.u.data.length = strlen(buf_wapi); -+ start = iwe_stream_add_point(info, start, stop, &iwe, buf_wapi); -+ -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVGENIE; -+ iwe.u.data.length = wapi_len; -+ start = iwe_stream_add_point(info, start, stop, &iwe, wapi_ie); -+ } -+ } -+#endif -+ -+ { -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 ss, sq; -+ -+ /* Add quality statistics */ -+ iwe.cmd = IWEVQUAL; -+ iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ | IW_QUAL_NOISE_UPDATED -+#else -+ | IW_QUAL_NOISE_INVALID -+#endif -+#ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ | IW_QUAL_DBM -+#endif -+ ; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { -+ ss = padapter->recvpriv.signal_strength; -+ sq = padapter->recvpriv.signal_qual; -+ } else { -+ ss = pnetwork->network.PhyInfo.SignalStrength; -+ sq = pnetwork->network.PhyInfo.SignalQuality; -+ } -+ -+ -+#ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ iwe.u.qual.level = (u8) translate_percentage_to_dbm(ss); /* dbm */ -+#else -+#ifdef CONFIG_SIGNAL_SCALE_MAPPING -+ iwe.u.qual.level = (u8)ss; /* % */ -+#else -+ { -+ /* Do signal scale mapping when using percentage as the unit of signal strength, since the scale mapping is skipped in odm */ -+ -+ HAL_DATA_TYPE *pHal = GET_HAL_DATA(padapter); -+ -+ iwe.u.qual.level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, ss); -+ } -+#endif -+#endif -+ -+ iwe.u.qual.qual = (u8)sq; /* signal quality */ -+ -+#ifdef CONFIG_PLATFORM_ROCKCHIPS -+ iwe.u.qual.noise = -100; /* noise level suggest by zhf@rockchips */ -+#else -+#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) -+ { -+ s16 tmp_noise = 0; -+ rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(pnetwork->network.Configuration.DSConfig), &(tmp_noise)); -+ iwe.u.qual.noise = tmp_noise ; -+ } -+#else -+ iwe.u.qual.noise = 0; /* noise level */ -+#endif -+#endif /* CONFIG_PLATFORM_ROCKCHIPS */ -+ -+ /* RTW_INFO("iqual=%d, ilevel=%d, inoise=%d, iupdated=%d\n", iwe.u.qual.qual, iwe.u.qual.level , iwe.u.qual.noise, iwe.u.qual.updated); */ -+ -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_QUAL_LEN); -+ } -+ -+ { -+ u8 buf[MAX_WPA_IE_LEN]; -+ u8 *p, *pos; -+ int len; -+ p = buf; -+ pos = pnetwork->network.Reserved; -+ _rtw_memset(buf, 0, MAX_WPA_IE_LEN); -+ p += sprintf(p, "fm=%02X%02X", pos[1], pos[0]); -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ iwe.u.data.length = strlen(buf); -+ start = iwe_stream_add_point(info, start, stop, &iwe, buf); -+ } -+ -+ return start; -+} -+#endif -+ -+static int wpa_set_auth_algs(struct net_device *dev, u32 value) -+{ -+ _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); -+ int ret = 0; -+ -+ if ((value & AUTH_ALG_SHARED_KEY) && (value & AUTH_ALG_OPEN_SYSTEM)) { -+ RTW_INFO("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY and AUTH_ALG_OPEN_SYSTEM [value:0x%x]\n", value); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ } else if (value & AUTH_ALG_SHARED_KEY) { -+ RTW_INFO("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY [value:0x%x]\n", value); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+#ifdef CONFIG_PLATFORM_MT53XX -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+#else -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeShared; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; -+#endif -+ } else if (value & AUTH_ALG_OPEN_SYSTEM) { -+ RTW_INFO("wpa_set_auth_algs, AUTH_ALG_OPEN_SYSTEM\n"); -+ /* padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; */ -+ if (padapter->securitypriv.ndisauthtype < Ndis802_11AuthModeWPAPSK) { -+#ifdef CONFIG_PLATFORM_MT53XX -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+#else -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+#endif -+ } -+ -+ } else if (value & AUTH_ALG_LEAP) -+ RTW_INFO("wpa_set_auth_algs, AUTH_ALG_LEAP\n"); -+ else { -+ RTW_INFO("wpa_set_auth_algs, error!\n"); -+ ret = -EINVAL; -+ } -+ -+ return ret; -+ -+} -+ -+static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len, wep_total_len; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif /* CONFIG_P2P */ -+ -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ if (param_len < (u32)((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) { -+ -+ if (param->u.crypt.idx >= WEP_KEYS -+#ifdef CONFIG_IEEE80211W -+ && param->u.crypt.idx > BIP_MAX_KEYID -+#endif /* CONFIG_IEEE80211W */ -+ ) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } else { -+#ifdef CONFIG_WAPI_SUPPORT -+ if (strcmp(param->u.crypt.alg, "SMS4")) -+#endif -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) { -+ RTW_INFO("wpa_set_encryption, crypt.alg = WEP\n"); -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ if ((wep_key_idx > WEP_KEYS) || (wep_key_len <= 0)) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) { -+ /* wep default key has not been set, so use this key index as default key.*/ -+ -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ -+ if (wep_key_len == 13) { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ } -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; -+ -+ psecuritypriv->key_mask |= BIT(wep_key_idx); -+ -+ goto exit; -+ } -+ -+ if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { /* 802_1x */ -+ struct sta_info *psta, *pbcmc_sta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == _TRUE) { /* sta mode */ -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ /* DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail\n")); */ -+ } else { -+ /* Jeff: don't disable ieee8021x_blocked while clearing key */ -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ psta->ieee8021x_blocked = _FALSE; -+ -+ if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled) || -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ -+ if (param->u.crypt.set_tx == 1) { /* pairwise key */ -+ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ -+ if (strcmp(param->u.crypt.alg, "TKIP") == 0) { /* set mic key */ -+ /* DEBUG_ERR(("\nset key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ -+ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ padapter->securitypriv.busetkipkey = _FALSE; -+ /* _set_timer(&padapter->securitypriv.tkip_timer, 50); */ -+ } -+ -+ /* DEBUG_ERR((" param->u.crypt.key_len=%d\n",param->u.crypt.key_len)); */ -+ RTW_INFO(" ~~~~set sta key:unicastkey\n"); -+ -+ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _TRUE); -+ -+ psta->bpairwise_key_installed = _TRUE; -+ -+ } else { /* group key */ -+ if (strcmp(param->u.crypt.alg, "TKIP") == 0 || strcmp(param->u.crypt.alg, "CCMP") == 0) { -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, -+ (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ /* only TKIP group key need to install this */ -+ if (param->u.crypt.key_len > 16) { -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ } -+ padapter->securitypriv.binstallGrpkey = _TRUE; -+ /* DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ -+ RTW_INFO(" ~~~~set sta key:groupkey\n"); -+ -+ padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ rtw_set_key(padapter, &padapter->securitypriv, param->u.crypt.idx, 1, _TRUE); -+ } -+#ifdef CONFIG_IEEE80211W -+ else if (strcmp(param->u.crypt.alg, "BIP") == 0) { -+ int no; -+ /* printk("BIP key_len=%d , index=%d @@@@@@@@@@@@@@@@@@\n", param->u.crypt.key_len, param->u.crypt.idx); */ -+ /* save the IGTK key, length 16 bytes */ -+ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, -+ (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ /*printk("IGTK key below:\n"); -+ for(no=0;no<16;no++) -+ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); -+ printk("\n");*/ -+ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; -+ padapter->securitypriv.binstallBIPkey = _TRUE; -+ RTW_INFO(" ~~~~set sta key:IGKT\n"); -+ } -+#endif /* CONFIG_IEEE80211W */ -+ -+#ifdef CONFIG_P2P -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_DONE); -+#endif /* CONFIG_P2P */ -+ -+ } -+ } -+ -+ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta == NULL) { -+ /* DEBUG_ERR( ("Set OID_802_11_ADD_KEY: bcmc stainfo is null\n")); */ -+ } else { -+ /* Jeff: don't disable ieee8021x_blocked while clearing key */ -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ -+ if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled) || -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { /* adhoc mode */ -+ } -+ } -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (strcmp(param->u.crypt.alg, "SMS4") == 0) { -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_STA_INFO pWapiSta; -+ u8 WapiASUEPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; -+ -+ if (param->u.crypt.set_tx == 1) { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (_rtw_memcmp(pWapiSta->PeerMacAddr, param->sta_addr, 6)) { -+ _rtw_memcpy(pWapiSta->lastTxUnicastPN, WapiASUEPNInitialValueSrc, 16); -+ -+ pWapiSta->wapiUsk.bSet = true; -+ _rtw_memcpy(pWapiSta->wapiUsk.dataKey, param->u.crypt.key, 16); -+ _rtw_memcpy(pWapiSta->wapiUsk.micKey, param->u.crypt.key + 16, 16); -+ pWapiSta->wapiUsk.keyId = param->u.crypt.idx ; -+ pWapiSta->wapiUsk.bTxEnable = true; -+ -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiAEPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiAEPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiAEPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiAEPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPN, WapiAEPNInitialValueSrc, 16); -+ pWapiSta->wapiUskUpdate.bTxEnable = false; -+ pWapiSta->wapiUskUpdate.bSet = false; -+ -+ if (psecuritypriv->sw_encrypt == false || psecuritypriv->sw_decrypt == false) { -+ /* set unicast key for ASUE */ -+ rtw_wapi_set_key(padapter, &pWapiSta->wapiUsk, pWapiSta, false, false); -+ } -+ } -+ } -+ } else { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (_rtw_memcmp(pWapiSta->PeerMacAddr, get_bssid(pmlmepriv), 6)) { -+ pWapiSta->wapiMsk.bSet = true; -+ _rtw_memcpy(pWapiSta->wapiMsk.dataKey, param->u.crypt.key, 16); -+ _rtw_memcpy(pWapiSta->wapiMsk.micKey, param->u.crypt.key + 16, 16); -+ pWapiSta->wapiMsk.keyId = param->u.crypt.idx ; -+ pWapiSta->wapiMsk.bTxEnable = false; -+ if (!pWapiSta->bSetkeyOk) -+ pWapiSta->bSetkeyOk = true; -+ pWapiSta->bAuthenticateInProgress = false; -+ -+ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); -+ -+ if (psecuritypriv->sw_decrypt == false) { -+ /* set rx broadcast key for ASUE */ -+ rtw_wapi_set_key(padapter, &pWapiSta->wapiMsk, pWapiSta, true, false); -+ } -+ } -+ -+ } -+ } -+ } -+#endif -+ -+exit: -+ -+ -+ return ret; -+} -+ -+static int rtw_set_wpa_ie(_adapter *padapter, char *pie, unsigned short ielen) -+{ -+ u8 *buf = NULL, *pos = NULL; -+ u32 left; -+ int group_cipher = 0, pairwise_cipher = 0; -+ int ret = 0; -+ u8 null_addr[] = {0, 0, 0, 0, 0, 0}; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif /* CONFIG_P2P */ -+ -+ if ((ielen > MAX_WPA_IE_LEN) || (pie == NULL)) { -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ if (pie == NULL) -+ return ret; -+ else -+ return -EINVAL; -+ } -+ -+ if (ielen) { -+ buf = rtw_zmalloc(ielen); -+ if (buf == NULL) { -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ _rtw_memcpy(buf, pie , ielen); -+ -+ /* dump */ -+ { -+ int i; -+ RTW_INFO("\n wpa_ie(length:%d):\n", ielen); -+ for (i = 0; i < ielen; i = i + 8) -+ RTW_INFO("0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x\n", buf[i], buf[i + 1], buf[i + 2], buf[i + 3], buf[i + 4], buf[i + 5], buf[i + 6], buf[i + 7]); -+ } -+ -+ pos = buf; -+ if (ielen < RSN_HEADER_LEN) { -+ ret = -1; -+ goto exit; -+ } -+ -+#if 0 -+ pos += RSN_HEADER_LEN; -+ left = ielen - RSN_HEADER_LEN; -+ -+ if (left >= RSN_SELECTOR_LEN) { -+ pos += RSN_SELECTOR_LEN; -+ left -= RSN_SELECTOR_LEN; -+ } else if (left > 0) { -+ ret = -1; -+ goto exit; -+ } -+#endif -+ -+ if (rtw_parse_wpa_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPAPSK; -+ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); -+ } -+ -+ if (rtw_parse_wpa2_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK; -+ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); -+ } -+ -+ if (group_cipher == 0) -+ group_cipher = WPA_CIPHER_NONE; -+ if (pairwise_cipher == 0) -+ pairwise_cipher = WPA_CIPHER_NONE; -+ -+ switch (group_cipher) { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot118021XGrpPrivacy = _TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot118021XGrpPrivacy = _AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ switch (pairwise_cipher) { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ {/* set wps_ie */ -+ u16 cnt = 0; -+ u8 eid, wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; -+ -+ while (cnt < ielen) { -+ eid = buf[cnt]; -+ -+ if ((eid == _VENDOR_SPECIFIC_IE_) && (_rtw_memcmp(&buf[cnt + 2], wps_oui, 4) == _TRUE)) { -+ RTW_INFO("SET WPS_IE\n"); -+ -+ padapter->securitypriv.wps_ie_len = ((buf[cnt + 1] + 2) < MAX_WPS_IE_LEN) ? (buf[cnt + 1] + 2) : MAX_WPS_IE_LEN; -+ -+ _rtw_memcpy(padapter->securitypriv.wps_ie, &buf[cnt], padapter->securitypriv.wps_ie_len); -+ -+ set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ -+#ifdef CONFIG_P2P -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_OK)) -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_ING); -+#endif /* CONFIG_P2P */ -+ cnt += buf[cnt + 1] + 2; -+ -+ break; -+ } else { -+ cnt += buf[cnt + 1] + 2; /* goto next */ -+ } -+ } -+ } -+ } -+ -+ /* TKIP and AES disallow multicast packets until installing group key */ -+ if (padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) -+ /* WPS open need to enable multicast -+ * || check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == _TRUE) */ -+ rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr); -+ -+ -+exit: -+ -+ if (buf) -+ rtw_mfree(buf, ielen); -+ -+ return ret; -+} -+ -+static int rtw_wx_get_name(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u16 cap; -+ u32 ht_ielen = 0; -+ char *p; -+ u8 ht_cap = _FALSE, vht_cap = _FALSE; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ NDIS_802_11_RATES_EX *prates = NULL; -+ -+ -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED | WIFI_ADHOC_MASTER_STATE) == _TRUE) { -+ /* parsing HT_CAP_IE */ -+ p = rtw_get_ie(&pcur_bss->IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pcur_bss->IELength - 12); -+ if (p && ht_ielen > 0) -+ ht_cap = _TRUE; -+ -+#ifdef CONFIG_80211AC_VHT -+ if (pmlmepriv->vhtpriv.vht_option == _TRUE) -+ vht_cap = _TRUE; -+#endif -+ -+ prates = &pcur_bss->SupportedRates; -+ -+ if (rtw_is_cckratesonly_included((u8 *)prates) == _TRUE) { -+ if (ht_cap == _TRUE) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bn"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11b"); -+ } else if ((rtw_is_cckrates_included((u8 *)prates)) == _TRUE) { -+ if (ht_cap == _TRUE) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bgn"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bg"); -+ } else { -+ if (pcur_bss->Configuration.DSConfig > 14) { -+#ifdef CONFIG_80211AC_VHT -+ if (vht_cap == _TRUE) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11AC"); -+ else -+#endif -+ { -+ if (ht_cap == _TRUE) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11an"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11a"); -+ } -+ } else { -+ if (ht_cap == _TRUE) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11gn"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g"); -+ } -+ } -+ } else { -+ /* prates = &padapter->registrypriv.dev_network.SupportedRates; */ -+ /* snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g"); */ -+ snprintf(wrqu->name, IFNAMSIZ, "unassociated"); -+ } -+ -+ -+ return 0; -+} -+ -+static int rtw_wx_set_freq(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ int exp = 1, freq = 0, div = 0; -+ -+ -+ -+ if (wrqu->freq.m <= 1000) { -+ if (wrqu->freq.flags == IW_FREQ_AUTO) { -+ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, wrqu->freq.m) > 0) { -+ padapter->mlmeextpriv.cur_channel = wrqu->freq.m; -+ RTW_INFO("%s: channel is auto, set to channel %d\n", __func__, wrqu->freq.m); -+ } else { -+ padapter->mlmeextpriv.cur_channel = 1; -+ RTW_INFO("%s: channel is auto, Channel Plan don't match just set to channel 1\n", __func__); -+ } -+ } else { -+ padapter->mlmeextpriv.cur_channel = wrqu->freq.m; -+ RTW_INFO("%s: set to channel %d\n", __func__, padapter->mlmeextpriv.cur_channel); -+ } -+ } else { -+ while (wrqu->freq.e) { -+ exp *= 10; -+ wrqu->freq.e--; -+ } -+ -+ freq = wrqu->freq.m; -+ -+ while (!(freq % 10)) { -+ freq /= 10; -+ exp *= 10; -+ } -+ -+ /* freq unit is MHz here */ -+ div = 1000000 / exp; -+ -+ if (div) -+ freq /= div; -+ else { -+ div = exp / 1000000; -+ freq *= div; -+ } -+ -+ /* If freq is invalid, rtw_freq2ch() will return channel 1 */ -+ padapter->mlmeextpriv.cur_channel = rtw_freq2ch(freq); -+ RTW_INFO("%s: set to channel %d\n", __func__, padapter->mlmeextpriv.cur_channel); -+ } -+ -+ set_channel_bwmode(padapter, padapter->mlmeextpriv.cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ -+ -+ return 0; -+} -+ -+static int rtw_wx_get_freq(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) != _TRUE) { -+ -+ wrqu->freq.m = rtw_ch2freq(pcur_bss->Configuration.DSConfig) * 100000; -+ wrqu->freq.e = 1; -+ wrqu->freq.i = pcur_bss->Configuration.DSConfig; -+ -+ } else { -+ wrqu->freq.m = rtw_ch2freq(padapter->mlmeextpriv.cur_channel) * 100000; -+ wrqu->freq.e = 1; -+ wrqu->freq.i = padapter->mlmeextpriv.cur_channel; -+ } -+ -+ return 0; -+} -+ -+static int rtw_wx_set_mode(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType ; -+ int ret = 0; -+ -+ -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ if (!rtw_is_hw_init_completed(padapter)) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ /* initial default type */ -+ dev->type = ARPHRD_ETHER; -+ -+ switch (wrqu->mode) { -+ case IW_MODE_MONITOR: -+ networkType = Ndis802_11Monitor; -+#if 0 -+ dev->type = ARPHRD_IEEE80211; /* IEEE 802.11 : 801 */ -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+ dev->type = ARPHRD_IEEE80211_RADIOTAP; /* IEEE 802.11 + radiotap header : 803 */ -+ RTW_INFO("set_mode = IW_MODE_MONITOR\n"); -+#else -+ RTW_INFO("kernel version < 2.6.24 not support IW_MODE_MONITOR\n"); -+#endif -+ break; -+ -+ case IW_MODE_AUTO: -+ networkType = Ndis802_11AutoUnknown; -+ RTW_INFO("set_mode = IW_MODE_AUTO\n"); -+ break; -+ case IW_MODE_ADHOC: -+ networkType = Ndis802_11IBSS; -+ RTW_INFO("set_mode = IW_MODE_ADHOC\n"); -+ break; -+ case IW_MODE_MASTER: -+ networkType = Ndis802_11APMode; -+ RTW_INFO("set_mode = IW_MODE_MASTER\n"); -+ /* rtw_setopmode_cmd(padapter, networkType,_TRUE); */ -+ break; -+ case IW_MODE_INFRA: -+ networkType = Ndis802_11Infrastructure; -+ RTW_INFO("set_mode = IW_MODE_INFRA\n"); -+ break; -+ -+ default: -+ ret = -EINVAL;; -+ goto exit; -+ } -+ -+ /* -+ if(Ndis802_11APMode == networkType) -+ { -+ rtw_setopmode_cmd(padapter, networkType,_TRUE); -+ } -+ else -+ { -+ rtw_setopmode_cmd(padapter, Ndis802_11AutoUnknown,_TRUE); -+ } -+ */ -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, networkType) == _FALSE) { -+ -+ ret = -EPERM; -+ goto exit; -+ -+ } -+ -+ rtw_setopmode_cmd(padapter, networkType, _TRUE); -+ -+ if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) == _TRUE) -+ rtw_indicate_connect(padapter); -+ -+exit: -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_wx_get_mode(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) -+ wrqu->mode = IW_MODE_INFRA; -+ else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) -+ -+ wrqu->mode = IW_MODE_ADHOC; -+ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) -+ wrqu->mode = IW_MODE_MASTER; -+ else if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) == _TRUE) -+ wrqu->mode = IW_MODE_MONITOR; -+ else -+ wrqu->mode = IW_MODE_AUTO; -+ -+ -+ return 0; -+ -+} -+ -+ -+static int rtw_wx_set_pmkid(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 j, blInserted = _FALSE; -+ int intReturn = _FALSE; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct iw_pmksa *pPMK = (struct iw_pmksa *) extra; -+ u8 strZeroMacAddress[ETH_ALEN] = { 0x00 }; -+ u8 strIssueBssid[ETH_ALEN] = { 0x00 }; -+ -+#if 0 -+ struct iw_pmksa { -+ __u32 cmd; -+ struct sockaddr bssid; -+ __u8 pmkid[IW_PMKID_LEN]; /* IW_PMKID_LEN=16 */ -+ } -+ There are the BSSID information in the bssid.sa_data array. -+ If cmd is IW_PMKSA_FLUSH, it means the wpa_suppplicant wants to clear all the PMKID information. -+ If cmd is IW_PMKSA_ADD, it means the wpa_supplicant wants to add a PMKID / BSSID to driver. -+ If cmd is IW_PMKSA_REMOVE, it means the wpa_supplicant wants to remove a PMKID / BSSID from driver. -+#endif -+ -+ _rtw_memcpy(strIssueBssid, pPMK->bssid.sa_data, ETH_ALEN); -+ if (pPMK->cmd == IW_PMKSA_ADD) { -+ RTW_INFO("[rtw_wx_set_pmkid] IW_PMKSA_ADD!\n"); -+ if (_rtw_memcmp(strIssueBssid, strZeroMacAddress, ETH_ALEN) == _TRUE) -+ return intReturn ; -+ else -+ intReturn = _TRUE; -+ blInserted = _FALSE; -+ -+ /* overwrite PMKID */ -+ for (j = 0 ; j < NUM_PMKID_CACHE; j++) { -+ if (_rtw_memcmp(psecuritypriv->PMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) == _TRUE) { -+ /* BSSID is matched, the same AP => rewrite with new PMKID. */ -+ -+ RTW_INFO("[rtw_wx_set_pmkid] BSSID exists in the PMKList.\n"); -+ -+ _rtw_memcpy(psecuritypriv->PMKIDList[j].PMKID, pPMK->pmkid, IW_PMKID_LEN); -+ psecuritypriv->PMKIDList[j].bUsed = _TRUE; -+ psecuritypriv->PMKIDIndex = j + 1; -+ blInserted = _TRUE; -+ break; -+ } -+ } -+ -+ if (!blInserted) { -+ /* Find a new entry */ -+ RTW_INFO("[rtw_wx_set_pmkid] Use the new entry index = %d for this PMKID.\n", -+ psecuritypriv->PMKIDIndex); -+ -+ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, strIssueBssid, ETH_ALEN); -+ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, pPMK->pmkid, IW_PMKID_LEN); -+ -+ psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].bUsed = _TRUE; -+ psecuritypriv->PMKIDIndex++ ; -+ if (psecuritypriv->PMKIDIndex == 16) -+ psecuritypriv->PMKIDIndex = 0; -+ } -+ } else if (pPMK->cmd == IW_PMKSA_REMOVE) { -+ RTW_INFO("[rtw_wx_set_pmkid] IW_PMKSA_REMOVE!\n"); -+ intReturn = _TRUE; -+ for (j = 0 ; j < NUM_PMKID_CACHE; j++) { -+ if (_rtw_memcmp(psecuritypriv->PMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) == _TRUE) { -+ /* BSSID is matched, the same AP => Remove this PMKID information and reset it. */ -+ _rtw_memset(psecuritypriv->PMKIDList[j].Bssid, 0x00, ETH_ALEN); -+ psecuritypriv->PMKIDList[j].bUsed = _FALSE; -+ break; -+ } -+ } -+ } else if (pPMK->cmd == IW_PMKSA_FLUSH) { -+ RTW_INFO("[rtw_wx_set_pmkid] IW_PMKSA_FLUSH!\n"); -+ _rtw_memset(&psecuritypriv->PMKIDList[0], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); -+ psecuritypriv->PMKIDIndex = 0; -+ intReturn = _TRUE; -+ } -+ return intReturn ; -+} -+ -+static int rtw_wx_get_sens(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+#ifdef CONFIG_PLATFORM_ROCKCHIPS -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ /* -+ * 20110311 Commented by Jeff -+ * For rockchip platform's wpa_driver_wext_get_rssi -+ */ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ /* wrqu->sens.value=-padapter->recvpriv.signal_strength; */ -+ wrqu->sens.value = -padapter->recvpriv.rssi; -+ /* RTW_INFO("%s: %d\n", __FUNCTION__, wrqu->sens.value); */ -+ wrqu->sens.fixed = 0; /* no auto select */ -+ } else -+#endif -+ { -+ wrqu->sens.value = 0; -+ wrqu->sens.fixed = 0; /* no auto select */ -+ wrqu->sens.disabled = 1; -+ } -+ return 0; -+} -+ -+static int rtw_wx_get_range(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct iw_range *range = (struct iw_range *)extra; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ u16 val; -+ int i; -+ -+ -+ -+ wrqu->data.length = sizeof(*range); -+ _rtw_memset(range, 0, sizeof(*range)); -+ -+ /* Let's try to keep this struct in the same order as in -+ * linux/include/wireless.h -+ */ -+ -+ /* TODO: See what values we can set, and remove the ones we can't -+ * set, or fill them with some default data. -+ */ -+ -+ /* ~5 Mb/s real (802.11b) */ -+ range->throughput = 5 * 1000 * 1000; -+ -+ /* TODO: Not used in 802.11b? -+ * range->min_nwid; Minimal NWID we are able to set */ -+ /* TODO: Not used in 802.11b? -+ * range->max_nwid; Maximal NWID we are able to set */ -+ -+ /* Old Frequency (backward compat - moved lower ) */ -+ /* range->old_num_channels; -+ * range->old_num_frequency; -+ * range->old_freq[6]; Filler to keep "version" at the same offset */ -+ -+ /* signal level threshold range */ -+ -+ /* Quality of link & SNR stuff */ -+ /* Quality range (link, level, noise) -+ * If the quality is absolute, it will be in the range [0 ; max_qual], -+ * if the quality is dBm, it will be in the range [max_qual ; 0]. -+ * Don't forget that we use 8 bit arithmetics... -+ * -+ * If percentage range is 0~100 -+ * Signal strength dbm range logical is -100 ~ 0 -+ * but usually value is -90 ~ -20 -+ * When CONFIG_SIGNAL_SCALE_MAPPING is defined, dbm range is -95 ~ -45 -+ */ -+ range->max_qual.qual = 100; -+#ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ range->max_qual.level = (u8)-100; -+ range->max_qual.noise = (u8)-100; -+ range->max_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */ -+ range->max_qual.updated |= IW_QUAL_DBM; -+#else /* !CONFIG_SIGNAL_DISPLAY_DBM */ -+ /* percent values between 0 and 100. */ -+ range->max_qual.level = 100; -+ range->max_qual.noise = 100; -+ range->max_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */ -+#endif /* !CONFIG_SIGNAL_DISPLAY_DBM */ -+ -+ /* This should contain the average/typical values of the quality -+ * indicator. This should be the threshold between a "good" and -+ * a "bad" link (example : monitor going from green to orange). -+ * Currently, user space apps like quality monitors don't have any -+ * way to calibrate the measurement. With this, they can split -+ * the range between 0 and max_qual in different quality level -+ * (using a geometric subdivision centered on the average). -+ * I expect that people doing the user space apps will feedback -+ * us on which value we need to put in each driver... */ -+ range->avg_qual.qual = 92; /* > 8% missed beacons is 'bad' */ -+#ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ /* TODO: Find real 'good' to 'bad' threshold value for RSSI */ -+ range->avg_qual.level = (u8)-70; -+ range->avg_qual.noise = 0; -+ range->avg_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */ -+ range->avg_qual.updated |= IW_QUAL_DBM; -+#else /* !CONFIG_SIGNAL_DISPLAY_DBM */ -+ /* TODO: Find real 'good' to 'bad' threshol value for RSSI */ -+ range->avg_qual.level = 30; -+ range->avg_qual.noise = 100; -+ range->avg_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */ -+#endif /* !CONFIG_SIGNAL_DISPLAY_DBM */ -+ -+ range->num_bitrates = RATE_COUNT; -+ -+ for (i = 0; i < RATE_COUNT && i < IW_MAX_BITRATES; i++) -+ range->bitrate[i] = rtw_rates[i]; -+ -+ range->min_frag = MIN_FRAG_THRESHOLD; -+ range->max_frag = MAX_FRAG_THRESHOLD; -+ -+ range->pm_capa = 0; -+ -+ range->we_version_compiled = WIRELESS_EXT; -+ range->we_version_source = 16; -+ -+ /* range->retry_capa; What retry options are supported -+ * range->retry_flags; How to decode max/min retry limit -+ * range->r_time_flags; How to decode max/min retry life -+ * range->min_retry; Minimal number of retries -+ * range->max_retry; Maximal number of retries -+ * range->min_r_time; Minimal retry lifetime -+ * range->max_r_time; Maximal retry lifetime */ -+ -+ for (i = 0, val = 0; i < MAX_CHANNEL_NUM; i++) { -+ -+ /* Include only legal frequencies for some countries */ -+ if (pmlmeext->channel_set[i].ChannelNum != 0) { -+ range->freq[val].i = pmlmeext->channel_set[i].ChannelNum; -+ range->freq[val].m = rtw_ch2freq(pmlmeext->channel_set[i].ChannelNum) * 100000; -+ range->freq[val].e = 1; -+ val++; -+ } -+ -+ if (val == IW_MAX_FREQUENCIES) -+ break; -+ } -+ -+ range->num_channels = val; -+ range->num_frequency = val; -+ -+ /* Commented by Albert 2009/10/13 -+ * The following code will proivde the security capability to network manager. -+ * If the driver doesn't provide this capability to network manager, -+ * the WPA/WPA2 routers can't be choosen in the network manager. */ -+ -+ /* -+ #define IW_SCAN_CAPA_NONE 0x00 -+ #define IW_SCAN_CAPA_ESSID 0x01 -+ #define IW_SCAN_CAPA_BSSID 0x02 -+ #define IW_SCAN_CAPA_CHANNEL 0x04 -+ #define IW_SCAN_CAPA_MODE 0x08 -+ #define IW_SCAN_CAPA_RATE 0x10 -+ #define IW_SCAN_CAPA_TYPE 0x20 -+ #define IW_SCAN_CAPA_TIME 0x40 -+ */ -+ -+#if WIRELESS_EXT > 17 -+ range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 | -+ IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP; -+#endif -+ -+#ifdef IW_SCAN_CAPA_ESSID /* WIRELESS_EXT > 21 */ -+ range->scan_capa = IW_SCAN_CAPA_ESSID | IW_SCAN_CAPA_TYPE | IW_SCAN_CAPA_BSSID | -+ IW_SCAN_CAPA_CHANNEL | IW_SCAN_CAPA_MODE | IW_SCAN_CAPA_RATE; -+#endif -+ -+ -+ -+ return 0; -+ -+} -+ -+/* set bssid flow -+ * s1. rtw_set_802_11_infrastructure_mode() -+ * s2. rtw_set_802_11_authentication_mode() -+ * s3. set_802_11_encryption_mode() -+ * s4. rtw_set_802_11_bssid() */ -+static int rtw_wx_set_wap(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *awrq, -+ char *extra) -+{ -+ _irqL irqL; -+ uint ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sockaddr *temp = (struct sockaddr *)awrq; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _list *phead; -+ u8 *dst_bssid, *src_bssid; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ -+ /* -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->adapter_type > PRIMARY_IFACE) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ #endif -+ */ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) == _TRUE) { -+ RTW_INFO("set bssid, but buddy_intf is under scanning or linking\n"); -+ -+ ret = -EINVAL; -+ -+ goto exit; -+ } -+#endif -+ -+ rtw_ps_deny(padapter, PS_DENY_JOIN); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -1; -+ goto cancel_ps_deny; -+ } -+ -+ if (!padapter->bup) { -+ ret = -1; -+ goto cancel_ps_deny; -+ } -+ -+ -+ if (temp->sa_family != ARPHRD_ETHER) { -+ ret = -EINVAL; -+ goto cancel_ps_deny; -+ } -+ -+ authmode = padapter->securitypriv.ndisauthtype; -+ _enter_critical_bh(&queue->lock, &irqL); -+ phead = get_list_head(queue); -+ pmlmepriv->pscanned = get_next(phead); -+ -+ while (1) { -+ -+ if ((rtw_end_of_queue_search(phead, pmlmepriv->pscanned)) == _TRUE) { -+#if 0 -+ ret = -EINVAL; -+ goto cancel_ps_deny; -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) { -+ rtw_set_802_11_bssid(padapter, temp->sa_data); -+ goto cancel_ps_deny; -+ } else { -+ ret = -EINVAL; -+ goto cancel_ps_deny; -+ } -+#endif -+ -+ break; -+ } -+ -+ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); -+ -+ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); -+ -+ dst_bssid = pnetwork->network.MacAddress; -+ -+ src_bssid = temp->sa_data; -+ -+ if ((_rtw_memcmp(dst_bssid, src_bssid, ETH_ALEN)) == _TRUE) { -+ if (!rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode)) { -+ ret = -1; -+ _exit_critical_bh(&queue->lock, &irqL); -+ goto cancel_ps_deny; -+ } -+ -+ break; -+ } -+ -+ } -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ rtw_set_802_11_authentication_mode(padapter, authmode); -+ /* set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); */ -+ if (rtw_set_802_11_bssid(padapter, temp->sa_data) == _FALSE) { -+ ret = -1; -+ goto cancel_ps_deny; -+ } -+ -+cancel_ps_deny: -+ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); -+ -+exit: -+ return ret; -+} -+ -+static int rtw_wx_get_wap(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ -+ wrqu->ap_addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN); -+ -+ -+ -+ if (((check_fwstate(pmlmepriv, _FW_LINKED)) == _TRUE) || -+ ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == _TRUE) || -+ ((check_fwstate(pmlmepriv, WIFI_AP_STATE)) == _TRUE)) -+ -+ _rtw_memcpy(wrqu->ap_addr.sa_data, pcur_bss->MacAddress, ETH_ALEN); -+ else -+ _rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN); -+ -+ -+ return 0; -+ -+} -+ -+static int rtw_wx_set_mlme(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+#if 0 -+ /* SIOCSIWMLME data */ -+ struct iw_mlme { -+ __u16 cmd; /* IW_MLME_* */ -+ __u16 reason_code; -+ struct sockaddr addr; -+ }; -+#endif -+ -+ int ret = 0; -+ u16 reason; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_mlme *mlme = (struct iw_mlme *) extra; -+ -+ -+ if (mlme == NULL) -+ return -1; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ reason = cpu_to_le16(mlme->reason_code); -+ -+ -+ RTW_INFO("%s, cmd=%d, reason=%d\n", __FUNCTION__, mlme->cmd, reason); -+ -+ -+ switch (mlme->cmd) { -+ case IW_MLME_DEAUTH: -+ if (!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ break; -+ -+ case IW_MLME_DISASSOC: -+ if (!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ -+ break; -+ -+ default: -+ return -EOPNOTSUPP; -+ } -+ -+ return ret; -+} -+ -+static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ u8 _status = _FALSE; -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_P2P */ -+ -+ -+#ifdef DBG_IOCTL -+ RTW_INFO("DBG_IOCTL %s:%d\n", __FUNCTION__, __LINE__); -+#endif -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (rtw_mi_mp_mode_check(padapter)) { -+ RTW_INFO("MP mode block Scan request\n"); -+ ret = -EPERM; -+ goto exit; -+ } -+#endif -+ if (rtw_is_scan_deny(padapter)) { -+ indicate_wx_scan_complete_event(padapter); -+ goto exit; -+ } -+ -+ rtw_ps_deny(padapter, PS_DENY_SCAN); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -1; -+ goto cancel_ps_deny; -+ } -+ -+ if (!rtw_is_adapter_up(padapter)) { -+ ret = -1; -+ goto cancel_ps_deny; -+ } -+ -+#ifndef CONFIG_DOSCAN_IN_BUSYTRAFFIC -+ /* When Busy Traffic, driver do not site survey. So driver return success. */ -+ /* wpa_supplicant will not issue SIOCSIWSCAN cmd again after scan timeout. */ -+ /* modify by thomas 2011-02-22. */ -+ if (rtw_mi_busy_traffic_check(padapter, _FALSE)) { -+ indicate_wx_scan_complete_event(padapter); -+ goto cancel_ps_deny; -+ } -+#endif -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) && check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { -+ RTW_INFO("AP mode process WPS\n"); -+ indicate_wx_scan_complete_event(padapter); -+ goto cancel_ps_deny; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) == _TRUE) { -+ indicate_wx_scan_complete_event(padapter); -+ goto cancel_ps_deny; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, -+ _FW_UNDER_SURVEY | _FW_UNDER_LINKING | WIFI_UNDER_WPS)) { -+ -+ indicate_wx_scan_complete_event(padapter); -+ goto cancel_ps_deny; -+ } -+#endif -+ -+#ifdef CONFIG_P2P -+ if (pwdinfo->p2p_state != P2P_STATE_NONE) { -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_FULL); -+ rtw_free_network_queue(padapter, _TRUE); -+ } -+#endif /* CONFIG_P2P */ -+ -+ _rtw_memset(ssid, 0, sizeof(NDIS_802_11_SSID) * RTW_SSID_SCAN_AMOUNT); -+ -+#if WIRELESS_EXT >= 17 -+ if (wrqu->data.length == sizeof(struct iw_scan_req)) { -+ struct iw_scan_req *req = (struct iw_scan_req *)extra; -+ -+ if (wrqu->data.flags & IW_SCAN_THIS_ESSID) { -+ int len = min((int)req->essid_len, IW_ESSID_MAX_SIZE); -+ -+ _rtw_memcpy(ssid[0].Ssid, req->essid, len); -+ ssid[0].SsidLength = len; -+ -+ RTW_INFO("IW_SCAN_THIS_ESSID, ssid=%s, len=%d\n", req->essid, req->essid_len); -+ -+ _status = rtw_set_802_11_bssid_list_scan(padapter, ssid, 1, NULL, 0); -+ -+ } else if (req->scan_type == IW_SCAN_TYPE_PASSIVE) -+ RTW_INFO("rtw_wx_set_scan, req->scan_type == IW_SCAN_TYPE_PASSIVE\n"); -+ -+ } else -+#endif -+ -+ if (wrqu->data.length >= WEXT_CSCAN_HEADER_SIZE -+ && _rtw_memcmp(extra, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == _TRUE -+ ) { -+ int len = wrqu->data.length - WEXT_CSCAN_HEADER_SIZE; -+ char *pos = extra + WEXT_CSCAN_HEADER_SIZE; -+ char section; -+ char sec_len; -+ int ssid_index = 0; -+ -+ /* RTW_INFO("%s COMBO_SCAN header is recognized\n", __FUNCTION__); */ -+ -+ while (len >= 1) { -+ section = *(pos++); -+ len -= 1; -+ -+ switch (section) { -+ case WEXT_CSCAN_SSID_SECTION: -+ /* RTW_INFO("WEXT_CSCAN_SSID_SECTION\n"); */ -+ if (len < 1) { -+ len = 0; -+ break; -+ } -+ -+ sec_len = *(pos++); -+ len -= 1; -+ -+ if (sec_len > 0 && sec_len <= len) { -+ ssid[ssid_index].SsidLength = sec_len; -+ _rtw_memcpy(ssid[ssid_index].Ssid, pos, ssid[ssid_index].SsidLength); -+ /* RTW_INFO("%s COMBO_SCAN with specific ssid:%s, %d\n", __FUNCTION__ */ -+ /* , ssid[ssid_index].Ssid, ssid[ssid_index].SsidLength); */ -+ ssid_index++; -+ } -+ -+ pos += sec_len; -+ len -= sec_len; -+ break; -+ -+ -+ case WEXT_CSCAN_CHANNEL_SECTION: -+ /* RTW_INFO("WEXT_CSCAN_CHANNEL_SECTION\n"); */ -+ pos += 1; -+ len -= 1; -+ break; -+ case WEXT_CSCAN_ACTV_DWELL_SECTION: -+ /* RTW_INFO("WEXT_CSCAN_ACTV_DWELL_SECTION\n"); */ -+ pos += 2; -+ len -= 2; -+ break; -+ case WEXT_CSCAN_PASV_DWELL_SECTION: -+ /* RTW_INFO("WEXT_CSCAN_PASV_DWELL_SECTION\n"); */ -+ pos += 2; -+ len -= 2; -+ break; -+ case WEXT_CSCAN_HOME_DWELL_SECTION: -+ /* RTW_INFO("WEXT_CSCAN_HOME_DWELL_SECTION\n"); */ -+ pos += 2; -+ len -= 2; -+ break; -+ case WEXT_CSCAN_TYPE_SECTION: -+ /* RTW_INFO("WEXT_CSCAN_TYPE_SECTION\n"); */ -+ pos += 1; -+ len -= 1; -+ break; -+#if 0 -+ case WEXT_CSCAN_NPROBE_SECTION: -+ RTW_INFO("WEXT_CSCAN_NPROBE_SECTION\n"); -+ break; -+#endif -+ -+ default: -+ /* RTW_INFO("Unknown CSCAN section %c\n", section); */ -+ len = 0; /* stop parsing */ -+ } -+ /* RTW_INFO("len:%d\n", len); */ -+ -+ } -+ -+ /* jeff: it has still some scan paramater to parse, we only do this now... */ -+ _status = rtw_set_802_11_bssid_list_scan(padapter, ssid, RTW_SSID_SCAN_AMOUNT, NULL, 0); -+ -+ } else -+ -+ _status = rtw_set_802_11_bssid_list_scan(padapter, NULL, 0, NULL, 0); -+ -+ if (_status == _FALSE) -+ ret = -1; -+ -+cancel_ps_deny: -+ rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); -+ -+exit: -+#ifdef DBG_IOCTL -+ RTW_INFO("DBG_IOCTL %s:%d return %d\n", __FUNCTION__, __LINE__, ret); -+#endif -+ -+ return ret; -+} -+ -+static int rtw_wx_get_scan(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ char *ev = extra; -+ char *stop = ev + wrqu->data.length; -+ u32 ret = 0; -+ u32 cnt = 0; -+ u32 wait_for_surveydone; -+ sint wait_status; -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif /* CONFIG_P2P */ -+ -+ -+#ifdef DBG_IOCTL -+ RTW_INFO("DBG_IOCTL %s:%d\n", __FUNCTION__, __LINE__); -+#endif -+ -+ if (adapter_to_pwrctl(padapter)->brfoffbyhw && rtw_is_drv_stopped(padapter)) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ wait_for_surveydone = 200; -+ else { -+ /* P2P is disabled */ -+ wait_for_surveydone = 100; -+ } -+#else -+ { -+ wait_for_surveydone = 100; -+ } -+#endif /* CONFIG_P2P */ -+ -+#if 1 /* Wireless Extension use EAGAIN to try */ -+ wait_status = _FW_UNDER_SURVEY -+#ifndef CONFIG_ANDROID -+ | _FW_UNDER_LINKING -+#endif -+ ; -+ -+ while (check_fwstate(pmlmepriv, wait_status) == _TRUE) -+ return -EAGAIN; -+#else -+ wait_status = _FW_UNDER_SURVEY -+#ifndef CONFIG_ANDROID -+ | _FW_UNDER_LINKING -+#endif -+ ; -+ -+ while (check_fwstate(pmlmepriv, wait_status) == _TRUE) { -+ rtw_msleep_os(30); -+ cnt++; -+ if (cnt > wait_for_surveydone) -+ break; -+ } -+#endif -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ if ((stop - ev) < SCAN_ITEM_SIZE) { -+ ret = -E2BIG; -+ break; -+ } -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ /* report network only if the current channel set contains the channel to which this network belongs */ -+ if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 -+ && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE -+ && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) -+ ) -+ ev = translate_scan(padapter, a, pnetwork, ev, stop); -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ wrqu->data.length = ev - extra; -+ wrqu->data.flags = 0; -+ -+exit: -+ -+ -+#ifdef DBG_IOCTL -+ RTW_INFO("DBG_IOCTL %s:%d return %d\n", __FUNCTION__, __LINE__, ret); -+#endif -+ -+ return ret ; -+ -+} -+ -+/* set ssid flow -+ * s1. rtw_set_802_11_infrastructure_mode() -+ * s2. set_802_11_authenticaion_mode() -+ * s3. set_802_11_encryption_mode() -+ * s4. rtw_set_802_11_ssid() */ -+static int rtw_wx_set_essid(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _irqL irqL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _queue *queue = &pmlmepriv->scanned_queue; -+ _list *phead; -+ s8 status = _TRUE; -+ struct wlan_network *pnetwork = NULL; -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ NDIS_802_11_SSID ndis_ssid; -+ u8 *dst_ssid, *src_ssid; -+ -+ uint ret = 0, len; -+ -+ -+#ifdef DBG_IOCTL -+ RTW_INFO("DBG_IOCTL %s:%d\n", __FUNCTION__, __LINE__); -+#endif -+#ifdef CONFIG_WEXT_DONT_JOIN_BYSSID -+ RTW_INFO("%s: CONFIG_WEXT_DONT_JOIN_BYSSID be defined!! only allow bssid joining\n", __func__); -+ return -EPERM; -+#endif -+ -+#if WIRELESS_EXT <= 20 -+ if ((wrqu->essid.length - 1) > IW_ESSID_MAX_SIZE) { -+#else -+ if (wrqu->essid.length > IW_ESSID_MAX_SIZE) { -+#endif -+ ret = -E2BIG; -+ goto exit; -+ } -+ -+ -+ -+ rtw_ps_deny(padapter, PS_DENY_JOIN); -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -1; -+ goto cancel_ps_deny; -+ } -+ -+ if (!padapter->bup) { -+ ret = -1; -+ goto cancel_ps_deny; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ ret = -1; -+ goto cancel_ps_deny; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_SURVEY | _FW_UNDER_LINKING)) { -+ RTW_INFO("set ssid, but buddy_intf is under scanning or linking\n"); -+ ret = -EINVAL; -+ goto cancel_ps_deny; -+ } -+#endif -+ authmode = padapter->securitypriv.ndisauthtype; -+ RTW_INFO("=>%s\n", __FUNCTION__); -+ if (wrqu->essid.flags && wrqu->essid.length) { -+ /* Commented by Albert 20100519 */ -+ /* We got the codes in "set_info" function of iwconfig source code. */ -+ /* ========================================= */ -+ /* wrq.u.essid.length = strlen(essid) + 1; */ -+ /* if(we_kernel_version > 20) */ -+ /* wrq.u.essid.length--; */ -+ /* ========================================= */ -+ /* That means, if the WIRELESS_EXT less than or equal to 20, the correct ssid len should subtract 1. */ -+#if WIRELESS_EXT <= 20 -+ len = ((wrqu->essid.length - 1) < IW_ESSID_MAX_SIZE) ? (wrqu->essid.length - 1) : IW_ESSID_MAX_SIZE; -+#else -+ len = (wrqu->essid.length < IW_ESSID_MAX_SIZE) ? wrqu->essid.length : IW_ESSID_MAX_SIZE; -+#endif -+ -+ if (wrqu->essid.length != 33) -+ RTW_INFO("ssid=%s, len=%d\n", extra, wrqu->essid.length); -+ -+ _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ ndis_ssid.SsidLength = len; -+ _rtw_memcpy(ndis_ssid.Ssid, extra, len); -+ src_ssid = ndis_ssid.Ssid; -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ phead = get_list_head(queue); -+ pmlmepriv->pscanned = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, pmlmepriv->pscanned) == _TRUE) { -+#if 0 -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) { -+ rtw_set_802_11_ssid(padapter, &ndis_ssid); -+ -+ goto cancel_ps_deny; -+ } else { -+ ret = -EINVAL; -+ goto cancel_ps_deny; -+ } -+#endif -+ -+ break; -+ } -+ -+ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); -+ -+ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); -+ -+ dst_ssid = pnetwork->network.Ssid.Ssid; -+ -+ -+ if ((_rtw_memcmp(dst_ssid, src_ssid, ndis_ssid.SsidLength) == _TRUE) && -+ (pnetwork->network.Ssid.SsidLength == ndis_ssid.SsidLength)) { -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) { -+ if (pnetwork->network.InfrastructureMode != pmlmepriv->cur_network.network.InfrastructureMode) -+ continue; -+ } -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode) == _FALSE) { -+ ret = -1; -+ _exit_critical_bh(&queue->lock, &irqL); -+ goto cancel_ps_deny; -+ } -+ -+ break; -+ } -+ } -+ _exit_critical_bh(&queue->lock, &irqL); -+ rtw_set_802_11_authentication_mode(padapter, authmode); -+ /* set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); */ -+ if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == _FALSE) { -+ ret = -1; -+ goto cancel_ps_deny; -+ } -+ } -+ -+cancel_ps_deny: -+ rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); -+ -+exit: -+ RTW_INFO("<=%s, ret %d\n", __FUNCTION__, ret); -+ -+#ifdef DBG_IOCTL -+ RTW_INFO("DBG_IOCTL %s:%d return %d\n", __FUNCTION__, __LINE__, ret); -+#endif -+ -+ -+ return ret; -+} -+ -+static int rtw_wx_get_essid(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ u32 len, ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ -+ -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { -+ len = pcur_bss->Ssid.SsidLength; -+ -+ wrqu->essid.length = len; -+ -+ _rtw_memcpy(extra, pcur_bss->Ssid.Ssid, len); -+ -+ wrqu->essid.flags = 1; -+ } else { -+ ret = -1; -+ goto exit; -+ } -+ -+exit: -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_wx_set_rate(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int i, ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 datarates[NumRates]; -+ u32 target_rate = wrqu->bitrate.value; -+ u32 fixed = wrqu->bitrate.fixed; -+ u32 ratevalue = 0; -+ u8 mpdatarate[NumRates] = {11, 10, 9, 8, 7, 6, 5, 4, 3, 2, 1, 0, 0xff}; -+ -+ -+ -+ if (target_rate == -1) { -+ ratevalue = 11; -+ goto set_rate; -+ } -+ target_rate = target_rate / 100000; -+ -+ switch (target_rate) { -+ case 10: -+ ratevalue = 0; -+ break; -+ case 20: -+ ratevalue = 1; -+ break; -+ case 55: -+ ratevalue = 2; -+ break; -+ case 60: -+ ratevalue = 3; -+ break; -+ case 90: -+ ratevalue = 4; -+ break; -+ case 110: -+ ratevalue = 5; -+ break; -+ case 120: -+ ratevalue = 6; -+ break; -+ case 180: -+ ratevalue = 7; -+ break; -+ case 240: -+ ratevalue = 8; -+ break; -+ case 360: -+ ratevalue = 9; -+ break; -+ case 480: -+ ratevalue = 10; -+ break; -+ case 540: -+ ratevalue = 11; -+ break; -+ default: -+ ratevalue = 11; -+ break; -+ } -+ -+set_rate: -+ -+ for (i = 0; i < NumRates; i++) { -+ if (ratevalue == mpdatarate[i]) { -+ datarates[i] = mpdatarate[i]; -+ if (fixed == 0) -+ break; -+ } else -+ datarates[i] = 0xff; -+ -+ } -+ -+ if (rtw_setdatarate_cmd(padapter, datarates) != _SUCCESS) { -+ ret = -1; -+ } -+ -+ -+ return ret; -+} -+ -+static int rtw_wx_get_rate(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ u16 max_rate = 0; -+ -+ max_rate = rtw_get_cur_max_rate((_adapter *)rtw_netdev_priv(dev)); -+ -+ if (max_rate == 0) -+ return -EPERM; -+ -+ wrqu->bitrate.fixed = 0; /* no auto select */ -+ wrqu->bitrate.value = max_rate * 100000; -+ -+ return 0; -+} -+ -+static int rtw_wx_set_rts(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ if (wrqu->rts.disabled) -+ padapter->registrypriv.rts_thresh = 2347; -+ else { -+ if (wrqu->rts.value < 0 || -+ wrqu->rts.value > 2347) -+ return -EINVAL; -+ -+ padapter->registrypriv.rts_thresh = wrqu->rts.value; -+ } -+ -+ RTW_INFO("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh); -+ -+ -+ return 0; -+ -+} -+ -+static int rtw_wx_get_rts(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ RTW_INFO("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh); -+ -+ wrqu->rts.value = padapter->registrypriv.rts_thresh; -+ wrqu->rts.fixed = 0; /* no auto select */ -+ /* wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD); */ -+ -+ -+ return 0; -+} -+ -+static int rtw_wx_set_frag(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ if (wrqu->frag.disabled) -+ padapter->xmitpriv.frag_len = MAX_FRAG_THRESHOLD; -+ else { -+ if (wrqu->frag.value < MIN_FRAG_THRESHOLD || -+ wrqu->frag.value > MAX_FRAG_THRESHOLD) -+ return -EINVAL; -+ -+ padapter->xmitpriv.frag_len = wrqu->frag.value & ~0x1; -+ } -+ -+ RTW_INFO("%s, frag_len=%d\n", __func__, padapter->xmitpriv.frag_len); -+ -+ -+ return 0; -+ -+} -+ -+static int rtw_wx_get_frag(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ RTW_INFO("%s, frag_len=%d\n", __func__, padapter->xmitpriv.frag_len); -+ -+ wrqu->frag.value = padapter->xmitpriv.frag_len; -+ wrqu->frag.fixed = 0; /* no auto select */ -+ /* wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FRAG_THRESHOLD); */ -+ -+ -+ return 0; -+} -+ -+static int rtw_wx_get_retry(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ /* _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); */ -+ -+ -+ wrqu->retry.value = 7; -+ wrqu->retry.fixed = 0; /* no auto select */ -+ wrqu->retry.disabled = 1; -+ -+ return 0; -+ -+} -+ -+#if 0 -+ #define IW_ENCODE_INDEX 0x00FF /* Token index (if needed) */ -+ #define IW_ENCODE_FLAGS 0xFF00 /* Flags defined below */ -+ #define IW_ENCODE_MODE 0xF000 /* Modes defined below */ -+ #define IW_ENCODE_DISABLED 0x8000 /* Encoding disabled */ -+ #define IW_ENCODE_ENABLED 0x0000 /* Encoding enabled */ -+ #define IW_ENCODE_RESTRICTED 0x4000 /* Refuse non-encoded packets */ -+ #define IW_ENCODE_OPEN 0x2000 /* Accept non-encoded packets */ -+ #define IW_ENCODE_NOKEY 0x0800 /* Key is write only, so not present */ -+ #define IW_ENCODE_TEMP 0x0400 /* Temporary key */ -+ /* -+ iwconfig wlan0 key on->flags = 0x6001->maybe it means auto -+ iwconfig wlan0 key off->flags = 0x8800 -+ iwconfig wlan0 key open->flags = 0x2800 -+ iwconfig wlan0 key open 1234567890->flags = 0x2000 -+ iwconfig wlan0 key restricted->flags = 0x4800 -+ iwconfig wlan0 key open [3] 1234567890->flags = 0x2003 -+ iwconfig wlan0 key restricted [2] 1234567890->flags = 0x4002 -+ iwconfig wlan0 key open [3] -> flags = 0x2803 -+ iwconfig wlan0 key restricted [2] -> flags = 0x4802 -+ */ -+#endif -+ -+static int rtw_wx_set_enc(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *keybuf) -+{ -+ u32 key, ret = 0; -+ u32 keyindex_provided; -+ NDIS_802_11_WEP wep; -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ -+ struct iw_point *erq = &(wrqu->encoding); -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ RTW_INFO("+rtw_wx_set_enc, flags=0x%x\n", erq->flags); -+ -+ _rtw_memset(&wep, 0, sizeof(NDIS_802_11_WEP)); -+ -+ key = erq->flags & IW_ENCODE_INDEX; -+ -+ -+ if (erq->flags & IW_ENCODE_DISABLED) { -+ RTW_INFO("EncryptionDisabled\n"); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ authmode = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisauthtype = authmode; -+ -+ goto exit; -+ } -+ -+ if (key) { -+ if (key > WEP_KEYS) -+ return -EINVAL; -+ key--; -+ keyindex_provided = 1; -+ } else { -+ keyindex_provided = 0; -+ key = padapter->securitypriv.dot11PrivacyKeyIndex; -+ RTW_INFO("rtw_wx_set_enc, key=%d\n", key); -+ } -+ -+ /* set authentication mode */ -+ if (erq->flags & IW_ENCODE_OPEN) { -+ RTW_INFO("rtw_wx_set_enc():IW_ENCODE_OPEN\n"); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;/* Ndis802_11EncryptionDisabled; */ -+ -+#ifdef CONFIG_PLATFORM_MT53XX -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+#else -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+#endif -+ -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; -+ authmode = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisauthtype = authmode; -+ } else if (erq->flags & IW_ENCODE_RESTRICTED) { -+ RTW_INFO("rtw_wx_set_enc():IW_ENCODE_RESTRICTED\n"); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+#ifdef CONFIG_PLATFORM_MT53XX -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+#else -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; -+#endif -+ -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _WEP40_; -+ authmode = Ndis802_11AuthModeShared; -+ padapter->securitypriv.ndisauthtype = authmode; -+ } else { -+ RTW_INFO("rtw_wx_set_enc():erq->flags=0x%x\n", erq->flags); -+ -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;/* Ndis802_11EncryptionDisabled; */ -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; -+ authmode = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisauthtype = authmode; -+ } -+ -+ wep.KeyIndex = key; -+ if (erq->length > 0) { -+ wep.KeyLength = erq->length <= 5 ? 5 : 13; -+ -+ wep.Length = wep.KeyLength + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); -+ } else { -+ wep.KeyLength = 0 ; -+ -+ if (keyindex_provided == 1) { /* set key_id only, no given KeyMaterial(erq->length==0). */ -+ padapter->securitypriv.dot11PrivacyKeyIndex = key; -+ -+ RTW_INFO("(keyindex_provided == 1), keyid=%d, key_len=%d\n", key, padapter->securitypriv.dot11DefKeylen[key]); -+ -+ switch (padapter->securitypriv.dot11DefKeylen[key]) { -+ case 5: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; -+ break; -+ case 13: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; -+ break; -+ default: -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ break; -+ } -+ -+ goto exit; -+ -+ } -+ -+ } -+ -+ wep.KeyIndex |= 0x80000000; -+ -+ _rtw_memcpy(wep.KeyMaterial, keybuf, wep.KeyLength); -+ -+ if (rtw_set_802_11_add_wep(padapter, &wep) == _FALSE) { -+ if (rf_on == pwrpriv->rf_pwrstate) -+ ret = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+exit: -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_wx_get_enc(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *keybuf) -+{ -+ uint key, ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *erq = &(wrqu->encoding); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) != _TRUE) { -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != _TRUE) { -+ erq->length = 0; -+ erq->flags |= IW_ENCODE_DISABLED; -+ return 0; -+ } -+ } -+ -+ -+ key = erq->flags & IW_ENCODE_INDEX; -+ -+ if (key) { -+ if (key > WEP_KEYS) -+ return -EINVAL; -+ key--; -+ } else -+ key = padapter->securitypriv.dot11PrivacyKeyIndex; -+ -+ erq->flags = key + 1; -+ -+ /* if(padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen) */ -+ /* { */ -+ /* erq->flags |= IW_ENCODE_OPEN; */ -+ /* } */ -+ -+ switch (padapter->securitypriv.ndisencryptstatus) { -+ case Ndis802_11EncryptionNotSupported: -+ case Ndis802_11EncryptionDisabled: -+ -+ erq->length = 0; -+ erq->flags |= IW_ENCODE_DISABLED; -+ -+ break; -+ -+ case Ndis802_11Encryption1Enabled: -+ -+ erq->length = padapter->securitypriv.dot11DefKeylen[key]; -+ -+ if (erq->length) { -+ _rtw_memcpy(keybuf, padapter->securitypriv.dot11DefKey[key].skey, padapter->securitypriv.dot11DefKeylen[key]); -+ -+ erq->flags |= IW_ENCODE_ENABLED; -+ -+ if (padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen) -+ erq->flags |= IW_ENCODE_OPEN; -+ else if (padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeShared) -+ erq->flags |= IW_ENCODE_RESTRICTED; -+ } else { -+ erq->length = 0; -+ erq->flags |= IW_ENCODE_DISABLED; -+ } -+ -+ break; -+ -+ case Ndis802_11Encryption2Enabled: -+ case Ndis802_11Encryption3Enabled: -+ -+ erq->length = 16; -+ erq->flags |= (IW_ENCODE_ENABLED | IW_ENCODE_OPEN | IW_ENCODE_NOKEY); -+ -+ break; -+ -+ default: -+ erq->length = 0; -+ erq->flags |= IW_ENCODE_DISABLED; -+ -+ break; -+ -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_wx_get_power(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ /* _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); */ -+ -+ wrqu->power.value = 0; -+ wrqu->power.fixed = 0; /* no auto select */ -+ wrqu->power.disabled = 1; -+ -+ return 0; -+ -+} -+ -+static int rtw_wx_set_gen_ie(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ ret = rtw_set_wpa_ie(padapter, extra, wrqu->data.length); -+ -+ return ret; -+} -+ -+static int rtw_wx_set_auth(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_param *param = (struct iw_param *)&(wrqu->param); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u32 value = param->value; -+ int ret = 0; -+ -+ switch (param->flags & IW_AUTH_INDEX) { -+ -+ case IW_AUTH_WPA_VERSION: -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef CONFIG_IOCTL_CFG80211 -+ padapter->wapiInfo.bWapiEnable = false; -+ if (value == IW_AUTH_WAPI_VERSION_1) { -+ padapter->wapiInfo.bWapiEnable = true; -+ psecuritypriv->dot11PrivacyAlgrthm = _SMS4_; -+ psecuritypriv->dot118021XGrpPrivacy = _SMS4_; -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; -+ pmlmeinfo->auth_algo = psecuritypriv->dot11AuthAlgrthm; -+ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; -+ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; -+ } -+#endif -+#endif -+ break; -+ case IW_AUTH_CIPHER_PAIRWISE: -+ -+ break; -+ case IW_AUTH_CIPHER_GROUP: -+ -+ break; -+ case IW_AUTH_KEY_MGMT: -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef CONFIG_IOCTL_CFG80211 -+ RTW_INFO("rtw_wx_set_auth: IW_AUTH_KEY_MGMT case\n"); -+ if (value == IW_AUTH_KEY_MGMT_WAPI_PSK) -+ padapter->wapiInfo.bWapiPSK = true; -+ else -+ padapter->wapiInfo.bWapiPSK = false; -+ RTW_INFO("rtw_wx_set_auth: IW_AUTH_KEY_MGMT bwapipsk %d\n", padapter->wapiInfo.bWapiPSK); -+#endif -+#endif -+ /* -+ * ??? does not use these parameters -+ */ -+ break; -+ -+ case IW_AUTH_TKIP_COUNTERMEASURES: { -+ if (param->value) { -+ /* wpa_supplicant is enabling the tkip countermeasure. */ -+ padapter->securitypriv.btkip_countermeasure = _TRUE; -+ } else { -+ /* wpa_supplicant is disabling the tkip countermeasure. */ -+ padapter->securitypriv.btkip_countermeasure = _FALSE; -+ } -+ break; -+ } -+ case IW_AUTH_DROP_UNENCRYPTED: { -+ /* HACK: -+ * -+ * wpa_supplicant calls set_wpa_enabled when the driver -+ * is loaded and unloaded, regardless of if WPA is being -+ * used. No other calls are made which can be used to -+ * determine if encryption will be used or not prior to -+ * association being expected. If encryption is not being -+ * used, drop_unencrypted is set to false, else true -- we -+ * can use this to determine if the CAP_PRIVACY_ON bit should -+ * be set. -+ */ -+ -+ if (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption1Enabled) { -+ break;/* it means init value, or using wep, ndisencryptstatus = Ndis802_11Encryption1Enabled, */ -+ /* then it needn't reset it; */ -+ } -+ -+ if (param->value) { -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; -+ } -+ -+ break; -+ } -+ -+ case IW_AUTH_80211_AUTH_ALG: -+ -+#if defined(CONFIG_ANDROID) || 1 -+ /* -+ * It's the starting point of a link layer connection using wpa_supplicant -+ */ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, _FALSE); -+ RTW_INFO("%s...call rtw_indicate_disconnect\n ", __FUNCTION__); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ rtw_free_assoc_resources(padapter, 1); -+ } -+#endif -+ -+ -+ ret = wpa_set_auth_algs(dev, (u32)param->value); -+ -+ break; -+ -+ case IW_AUTH_WPA_ENABLED: -+ -+ /* if(param->value) */ -+ /* padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; */ /* 802.1x */ -+ /* else */ -+ /* padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; */ /* open system */ -+ -+ /* _disassociate(priv); */ -+ -+ break; -+ -+ case IW_AUTH_RX_UNENCRYPTED_EAPOL: -+ /* ieee->ieee802_1x = param->value; */ -+ break; -+ -+ case IW_AUTH_PRIVACY_INVOKED: -+ /* ieee->privacy_invoked = param->value; */ -+ break; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef CONFIG_IOCTL_CFG80211 -+ case IW_AUTH_WAPI_ENABLED: -+ break; -+#endif -+#endif -+ -+ default: -+ return -EOPNOTSUPP; -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_wx_set_enc_ext(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ char *alg_name; -+ u32 param_len; -+ struct ieee_param *param = NULL; -+ struct iw_point *pencoding = &wrqu->encoding; -+ struct iw_encode_ext *pext = (struct iw_encode_ext *)extra; -+ int ret = 0; -+ -+ param_len = sizeof(struct ieee_param) + pext->key_len; -+ param = (struct ieee_param *)rtw_malloc(param_len); -+ if (param == NULL) -+ return -1; -+ -+ _rtw_memset(param, 0, param_len); -+ -+ param->cmd = IEEE_CMD_SET_ENCRYPTION; -+ _rtw_memset(param->sta_addr, 0xff, ETH_ALEN); -+ -+ -+ switch (pext->alg) { -+ case IW_ENCODE_ALG_NONE: -+ /* todo: remove key */ -+ /* remove = 1; */ -+ alg_name = "none"; -+ break; -+ case IW_ENCODE_ALG_WEP: -+ alg_name = "WEP"; -+ break; -+ case IW_ENCODE_ALG_TKIP: -+ alg_name = "TKIP"; -+ break; -+ case IW_ENCODE_ALG_CCMP: -+ alg_name = "CCMP"; -+ break; -+#ifdef CONFIG_IEEE80211W -+ case IW_ENCODE_ALG_AES_CMAC: -+ alg_name = "BIP"; -+ break; -+#endif /* CONFIG_IEEE80211W */ -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef CONFIG_IOCTL_CFG80211 -+ case IW_ENCODE_ALG_SM4: -+ alg_name = "SMS4"; -+ _rtw_memcpy(param->sta_addr, pext->addr.sa_data, ETH_ALEN); -+ RTW_INFO("rtw_wx_set_enc_ext: SMS4 case\n"); -+ break; -+#endif -+#endif -+ default: -+ ret = -1; -+ goto exit; -+ } -+ -+ strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN); -+ -+ if (pext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) -+ param->u.crypt.set_tx = 1; -+ -+ /* cliW: WEP does not have group key -+ * just not checking GROUP key setting -+ */ -+ if ((pext->alg != IW_ENCODE_ALG_WEP) && -+ ((pext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) -+#ifdef CONFIG_IEEE80211W -+ || (pext->ext_flags & IW_ENCODE_ALG_AES_CMAC) -+#endif /* CONFIG_IEEE80211W */ -+ )) -+ param->u.crypt.set_tx = 0; -+ -+ param->u.crypt.idx = (pencoding->flags & 0x00FF) - 1 ; -+ -+ if (pext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) { -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef CONFIG_IOCTL_CFG80211 -+ if (pext->alg == IW_ENCODE_ALG_SM4) -+ _rtw_memcpy(param->u.crypt.seq, pext->rx_seq, 16); -+ else -+#endif /* CONFIG_IOCTL_CFG80211 */ -+#endif /* CONFIG_WAPI_SUPPORT */ -+ _rtw_memcpy(param->u.crypt.seq, pext->rx_seq, 8); -+ } -+ -+ if (pext->key_len) { -+ param->u.crypt.key_len = pext->key_len; -+ /* _rtw_memcpy(param + 1, pext + 1, pext->key_len); */ -+ _rtw_memcpy(param->u.crypt.key, pext + 1, pext->key_len); -+ } -+ -+ if (pencoding->flags & IW_ENCODE_DISABLED) { -+ /* todo: remove key */ -+ /* remove = 1; */ -+ } -+ -+ ret = wpa_set_encryption(dev, param, param_len); -+ -+exit: -+ if (param) -+ rtw_mfree((u8 *)param, param_len); -+ -+ return ret; -+} -+ -+ -+static int rtw_wx_get_nick(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ /* _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); */ -+ /* struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); */ -+ /* struct security_priv *psecuritypriv = &padapter->securitypriv; */ -+ -+ if (extra) { -+ wrqu->data.length = 14; -+ wrqu->data.flags = 1; -+ _rtw_memcpy(extra, "", 14); -+ } -+ -+ /* rtw_signal_process(pid, SIGUSR1); */ /* for test */ -+ -+ /* dump debug info here */ -+#if 0 -+ u32 dot11AuthAlgrthm; /* 802.11 auth, could be open, shared, and 8021x */ -+ u32 dot11PrivacyAlgrthm; /* This specify the privacy for shared auth. algorithm. */ -+ u32 dot118021XGrpPrivacy; /* This specify the privacy algthm. used for Grp key */ -+ u32 ndisauthtype; -+ u32 ndisencryptstatus; -+#endif -+ -+ /* RTW_INFO("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", */ -+ /* psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, */ -+ /* psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus); */ -+ -+ /* RTW_INFO("enc_alg=0x%x\n", psecuritypriv->dot11PrivacyAlgrthm); */ -+ /* RTW_INFO("auth_type=0x%x\n", psecuritypriv->ndisauthtype); */ -+ /* RTW_INFO("enc_type=0x%x\n", psecuritypriv->ndisencryptstatus); */ -+ -+#if 0 -+ RTW_INFO("dbg(0x210)=0x%x\n", rtw_read32(padapter, 0x210)); -+ RTW_INFO("dbg(0x608)=0x%x\n", rtw_read32(padapter, 0x608)); -+ RTW_INFO("dbg(0x280)=0x%x\n", rtw_read32(padapter, 0x280)); -+ RTW_INFO("dbg(0x284)=0x%x\n", rtw_read32(padapter, 0x284)); -+ RTW_INFO("dbg(0x288)=0x%x\n", rtw_read32(padapter, 0x288)); -+ -+ RTW_INFO("dbg(0x664)=0x%x\n", rtw_read32(padapter, 0x664)); -+ -+ -+ RTW_INFO("\n"); -+ -+ RTW_INFO("dbg(0x430)=0x%x\n", rtw_read32(padapter, 0x430)); -+ RTW_INFO("dbg(0x438)=0x%x\n", rtw_read32(padapter, 0x438)); -+ -+ RTW_INFO("dbg(0x440)=0x%x\n", rtw_read32(padapter, 0x440)); -+ -+ RTW_INFO("dbg(0x458)=0x%x\n", rtw_read32(padapter, 0x458)); -+ -+ RTW_INFO("dbg(0x484)=0x%x\n", rtw_read32(padapter, 0x484)); -+ RTW_INFO("dbg(0x488)=0x%x\n", rtw_read32(padapter, 0x488)); -+ -+ RTW_INFO("dbg(0x444)=0x%x\n", rtw_read32(padapter, 0x444)); -+ RTW_INFO("dbg(0x448)=0x%x\n", rtw_read32(padapter, 0x448)); -+ RTW_INFO("dbg(0x44c)=0x%x\n", rtw_read32(padapter, 0x44c)); -+ RTW_INFO("dbg(0x450)=0x%x\n", rtw_read32(padapter, 0x450)); -+#endif -+ -+ return 0; -+ -+} -+ -+static int rtw_wx_read32(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter; -+ struct iw_point *p; -+ u16 len; -+ u32 addr; -+ u32 data32; -+ u32 bytes; -+ u8 *ptmp; -+ int ret; -+ -+ -+ ret = 0; -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ p = &wrqu->data; -+ len = p->length; -+ if (0 == len) -+ return -EINVAL; -+ -+ ptmp = (u8 *)rtw_malloc(len); -+ if (NULL == ptmp) -+ return -ENOMEM; -+ -+ if (copy_from_user(ptmp, p->pointer, len)) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ bytes = 0; -+ addr = 0; -+ sscanf(ptmp, "%d,%x", &bytes, &addr); -+ -+ switch (bytes) { -+ case 1: -+ data32 = rtw_read8(padapter, addr); -+ sprintf(extra, "0x%02X", data32); -+ break; -+ case 2: -+ data32 = rtw_read16(padapter, addr); -+ sprintf(extra, "0x%04X", data32); -+ break; -+ case 4: -+ data32 = rtw_read32(padapter, addr); -+ sprintf(extra, "0x%08X", data32); -+ break; -+ -+ #if defined(CONFIG_SDIO_HCI) && defined(CONFIG_SDIO_INDIRECT_ACCESS) && defined(DBG_SDIO_INDIRECT_ACCESS) -+ case 11: -+ data32 = rtw_sd_iread8(padapter, addr); -+ sprintf(extra, "0x%02X", data32); -+ break; -+ case 12: -+ data32 = rtw_sd_iread16(padapter, addr); -+ sprintf(extra, "0x%04X", data32); -+ break; -+ case 14: -+ data32 = rtw_sd_iread32(padapter, addr); -+ sprintf(extra, "0x%08X", data32); -+ break; -+ #endif -+ default: -+ RTW_INFO("%s: usage> read [bytes],[address(hex)]\n", __func__); -+ ret = -EINVAL; -+ goto exit; -+ } -+ RTW_INFO("%s: addr=0x%08X data=%s\n", __func__, addr, extra); -+ -+exit: -+ rtw_mfree(ptmp, len); -+ -+ return 0; -+} -+ -+static int rtw_wx_write32(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+ u32 addr; -+ u32 data32; -+ u32 bytes; -+ -+ -+ bytes = 0; -+ addr = 0; -+ data32 = 0; -+ sscanf(extra, "%d,%x,%x", &bytes, &addr, &data32); -+ -+ switch (bytes) { -+ case 1: -+ rtw_write8(padapter, addr, (u8)data32); -+ RTW_INFO("%s: addr=0x%08X data=0x%02X\n", __func__, addr, (u8)data32); -+ break; -+ case 2: -+ rtw_write16(padapter, addr, (u16)data32); -+ RTW_INFO("%s: addr=0x%08X data=0x%04X\n", __func__, addr, (u16)data32); -+ break; -+ case 4: -+ rtw_write32(padapter, addr, data32); -+ RTW_INFO("%s: addr=0x%08X data=0x%08X\n", __func__, addr, data32); -+ break; -+ default: -+ RTW_INFO("%s: usage> write [bytes],[address(hex)],[data(hex)]\n", __func__); -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int rtw_wx_read_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u32 path, addr, data32; -+ -+ -+ path = *(u32 *)extra; -+ addr = *((u32 *)extra + 1); -+ data32 = rtw_hal_read_rfreg(padapter, path, addr, 0xFFFFF); -+ /* RTW_INFO("%s: path=%d addr=0x%02x data=0x%05x\n", __func__, path, addr, data32); */ -+ /* -+ * IMPORTANT!! -+ * Only when wireless private ioctl is at odd order, -+ * "extra" would be copied to user space. -+ */ -+ sprintf(extra, "0x%05x", data32); -+ -+ return 0; -+} -+ -+static int rtw_wx_write_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u32 path, addr, data32; -+ -+ -+ path = *(u32 *)extra; -+ addr = *((u32 *)extra + 1); -+ data32 = *((u32 *)extra + 2); -+ /* RTW_INFO("%s: path=%d addr=0x%02x data=0x%05x\n", __func__, path, addr, data32); */ -+ rtw_hal_write_rfreg(padapter, path, addr, 0xFFFFF, data32); -+ -+ return 0; -+} -+ -+static int rtw_wx_priv_null(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ return -1; -+} -+ -+static int dummy(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ /* _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); */ -+ /* struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); */ -+ -+ /* RTW_INFO("cmd_code=%x, fwstate=0x%x\n", a->cmd, get_fwstate(pmlmepriv)); */ -+ -+ return -1; -+ -+} -+ -+static int rtw_wx_set_channel_plan(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 channel_plan_req = (u8)(*((int *)wrqu)); -+ -+ if (_SUCCESS != rtw_set_channel_plan(padapter, channel_plan_req)) -+ return -EPERM; -+ -+ return 0; -+} -+ -+static int rtw_wx_set_mtk_wps_probe_ie(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+#ifdef CONFIG_PLATFORM_MT53XX -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+#endif -+ return 0; -+} -+ -+static int rtw_wx_get_sensitivity(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *buf) -+{ -+#ifdef CONFIG_PLATFORM_MT53XX -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ /* Modified by Albert 20110914 */ -+ /* This is in dbm format for MTK platform. */ -+ wrqu->qual.level = padapter->recvpriv.rssi; -+ RTW_INFO(" level = %u\n", wrqu->qual.level); -+#endif -+ return 0; -+} -+ -+static int rtw_wx_set_mtk_wps_ie(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+#ifdef CONFIG_PLATFORM_MT53XX -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ return rtw_set_wpa_ie(padapter, wrqu->data.pointer, wrqu->data.length); -+#else -+ return 0; -+#endif -+} -+ -+/* -+typedef int (*iw_handler)(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+*/ -+/* -+ * For all data larger than 16 octets, we need to use a -+ * pointer to memory allocated in user space. -+ */ -+static int rtw_drvext_hdl(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+#if 0 -+ struct iw_point { -+ void __user *pointer; /* Pointer to the data (in user space) */ -+ __u16 length; /* number of fields or size in bytes */ -+ __u16 flags; /* Optional params */ -+ }; -+#endif -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ u8 res; -+ struct drvext_handler *phandler; -+ struct drvext_oidparam *poidparam; -+ int ret; -+ u16 len; -+ u8 *pparmbuf, bset; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *p = &wrqu->data; -+ -+ if ((!p->length) || (!p->pointer)) { -+ ret = -EINVAL; -+ goto _rtw_drvext_hdl_exit; -+ } -+ -+ -+ bset = (u8)(p->flags & 0xFFFF); -+ len = p->length; -+ pparmbuf = (u8 *)rtw_malloc(len); -+ if (pparmbuf == NULL) { -+ ret = -ENOMEM; -+ goto _rtw_drvext_hdl_exit; -+ } -+ -+ if (bset) { /* set info */ -+ if (copy_from_user(pparmbuf, p->pointer, len)) { -+ rtw_mfree(pparmbuf, len); -+ ret = -EFAULT; -+ goto _rtw_drvext_hdl_exit; -+ } -+ } else { /* query info */ -+ -+ } -+ -+ -+ /* */ -+ poidparam = (struct drvext_oidparam *)pparmbuf; -+ -+ -+ -+ /* check subcode */ -+ if (poidparam->subcode >= MAX_DRVEXT_HANDLERS) { -+ ret = -EINVAL; -+ goto _rtw_drvext_hdl_exit; -+ } -+ -+ -+ if (poidparam->subcode >= MAX_DRVEXT_OID_SUBCODES) { -+ ret = -EINVAL; -+ goto _rtw_drvext_hdl_exit; -+ } -+ -+ -+ phandler = drvextoidhandlers + poidparam->subcode; -+ -+ if (poidparam->len != phandler->parmsize) { -+ ret = -EINVAL; -+ goto _rtw_drvext_hdl_exit; -+ } -+ -+ -+ res = phandler->handler(&padapter->drvextpriv, bset, poidparam->data); -+ -+ if (res == 0) { -+ ret = 0; -+ -+ if (bset == 0x00) {/* query info */ -+ /* _rtw_memcpy(p->pointer, pparmbuf, len); */ -+ if (copy_to_user(p->pointer, pparmbuf, len)) -+ ret = -EFAULT; -+ } -+ } else -+ ret = -EFAULT; -+ -+ -+_rtw_drvext_hdl_exit: -+ -+ return ret; -+ -+#endif -+ -+ return 0; -+ -+} -+ -+static void rtw_dbg_mode_hdl(_adapter *padapter, u32 id, u8 *pdata, u32 len) -+{ -+ pRW_Reg RegRWStruct; -+ struct rf_reg_param *prfreg; -+ u8 path; -+ u8 offset; -+ u32 value; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ switch (id) { -+ case GEN_MP_IOCTL_SUBCODE(MP_START): -+ RTW_INFO("871x_driver is only for normal mode, can't enter mp mode\n"); -+ break; -+ case GEN_MP_IOCTL_SUBCODE(READ_REG): -+ RegRWStruct = (pRW_Reg)pdata; -+ switch (RegRWStruct->width) { -+ case 1: -+ RegRWStruct->value = rtw_read8(padapter, RegRWStruct->offset); -+ break; -+ case 2: -+ RegRWStruct->value = rtw_read16(padapter, RegRWStruct->offset); -+ break; -+ case 4: -+ RegRWStruct->value = rtw_read32(padapter, RegRWStruct->offset); -+ break; -+ default: -+ break; -+ } -+ -+ break; -+ case GEN_MP_IOCTL_SUBCODE(WRITE_REG): -+ RegRWStruct = (pRW_Reg)pdata; -+ switch (RegRWStruct->width) { -+ case 1: -+ rtw_write8(padapter, RegRWStruct->offset, (u8)RegRWStruct->value); -+ break; -+ case 2: -+ rtw_write16(padapter, RegRWStruct->offset, (u16)RegRWStruct->value); -+ break; -+ case 4: -+ rtw_write32(padapter, RegRWStruct->offset, (u32)RegRWStruct->value); -+ break; -+ default: -+ break; -+ } -+ -+ break; -+ case GEN_MP_IOCTL_SUBCODE(READ_RF_REG): -+ -+ prfreg = (struct rf_reg_param *)pdata; -+ -+ path = (u8)prfreg->path; -+ offset = (u8)prfreg->offset; -+ -+ value = rtw_hal_read_rfreg(padapter, path, offset, 0xffffffff); -+ -+ prfreg->value = value; -+ -+ break; -+ case GEN_MP_IOCTL_SUBCODE(WRITE_RF_REG): -+ -+ prfreg = (struct rf_reg_param *)pdata; -+ -+ path = (u8)prfreg->path; -+ offset = (u8)prfreg->offset; -+ value = prfreg->value; -+ -+ rtw_hal_write_rfreg(padapter, path, offset, 0xffffffff, value); -+ -+ break; -+ case GEN_MP_IOCTL_SUBCODE(TRIGGER_GPIO): -+ RTW_INFO("==> trigger gpio 0\n"); -+ rtw_hal_set_hwreg(padapter, HW_VAR_TRIGGER_GPIO_0, 0); -+ break; -+#ifdef CONFIG_BT_COEXIST -+ case GEN_MP_IOCTL_SUBCODE(SET_DM_BT): -+ RTW_INFO("==> set dm_bt_coexist:%x\n", *(u8 *)pdata); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BT_SET_COEXIST, pdata); -+ break; -+ case GEN_MP_IOCTL_SUBCODE(DEL_BA): -+ RTW_INFO("==> delete ba:%x\n", *(u8 *)pdata); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BT_ISSUE_DELBA, pdata); -+ break; -+#endif -+#ifdef DBG_CONFIG_ERROR_DETECT -+ case GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS): -+ *pdata = rtw_hal_sreset_get_wifi_status(padapter); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+ -+} -+#ifdef MP_IOCTL_HDL -+static int rtw_mp_ioctl_hdl(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ u32 BytesRead, BytesWritten, BytesNeeded; -+ struct oid_par_priv oid_par; -+ struct mp_ioctl_handler *phandler; -+ struct mp_ioctl_param *poidparam; -+ uint status = 0; -+ u16 len; -+ u8 *pparmbuf = NULL, bset; -+ PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev); -+ struct iw_point *p = &wrqu->data; -+ -+ /* RTW_INFO("+rtw_mp_ioctl_hdl\n"); */ -+ -+ /* mutex_lock(&ioctl_mutex); */ -+ -+ if ((!p->length) || (!p->pointer)) { -+ ret = -EINVAL; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ -+ pparmbuf = NULL; -+ bset = (u8)(p->flags & 0xFFFF); -+ len = p->length; -+ pparmbuf = (u8 *)rtw_malloc(len); -+ if (pparmbuf == NULL) { -+ ret = -ENOMEM; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ -+ if (copy_from_user(pparmbuf, p->pointer, len)) { -+ ret = -EFAULT; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ -+ poidparam = (struct mp_ioctl_param *)pparmbuf; -+ -+ if (poidparam->subcode >= MAX_MP_IOCTL_SUBCODE) { -+ ret = -EINVAL; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ -+ /* RTW_INFO("%s: %d\n", __func__, poidparam->subcode); */ -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) { -+ phandler = mp_ioctl_hdl + poidparam->subcode; -+ -+ if ((phandler->paramsize != 0) && (poidparam->len < phandler->paramsize)) { -+ ret = -EINVAL; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ -+ if (phandler->handler) { -+ oid_par.adapter_context = padapter; -+ oid_par.oid = phandler->oid; -+ oid_par.information_buf = poidparam->data; -+ oid_par.information_buf_len = poidparam->len; -+ oid_par.dbg = 0; -+ -+ BytesWritten = 0; -+ BytesNeeded = 0; -+ -+ if (bset) { -+ oid_par.bytes_rw = &BytesRead; -+ oid_par.bytes_needed = &BytesNeeded; -+ oid_par.type_of_oid = SET_OID; -+ } else { -+ oid_par.bytes_rw = &BytesWritten; -+ oid_par.bytes_needed = &BytesNeeded; -+ oid_par.type_of_oid = QUERY_OID; -+ } -+ -+ status = phandler->handler(&oid_par); -+ -+ /* todo:check status, BytesNeeded, etc. */ -+ } else { -+ RTW_INFO("rtw_mp_ioctl_hdl(): err!, subcode=%d, oid=%d, handler=%p\n", -+ poidparam->subcode, phandler->oid, phandler->handler); -+ ret = -EFAULT; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ } else -+#endif -+ { -+ rtw_dbg_mode_hdl(padapter, poidparam->subcode, poidparam->data, poidparam->len); -+ } -+ -+ if (bset == 0x00) {/* query info */ -+ if (copy_to_user(p->pointer, pparmbuf, len)) -+ ret = -EFAULT; -+ } -+ -+ if (status) { -+ ret = -EFAULT; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ -+_rtw_mp_ioctl_hdl_exit: -+ -+ if (pparmbuf) -+ rtw_mfree(pparmbuf, len); -+ -+ /* mutex_unlock(&ioctl_mutex); */ -+ -+ return ret; -+} -+#endif -+static int rtw_get_ap_info(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int bssid_match, ret = 0; -+ u32 cnt = 0, wpa_ielen; -+ _irqL irqL; -+ _list *plist, *phead; -+ unsigned char *pbuf; -+ u8 bssid[ETH_ALEN]; -+ char data[32]; -+ struct wlan_network *pnetwork = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct iw_point *pdata = &wrqu->data; -+ -+ RTW_INFO("+rtw_get_aplist_info\n"); -+ -+ if (rtw_is_drv_stopped(padapter) || (pdata == NULL)) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ while ((check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY | _FW_UNDER_LINKING))) == _TRUE) { -+ rtw_msleep_os(30); -+ cnt++; -+ if (cnt > 100) -+ break; -+ } -+ -+ -+ /* pdata->length = 0; */ /* ? */ -+ pdata->flags = 0; -+ if (pdata->length >= 32) { -+ if (copy_from_user(data, pdata->pointer, 32)) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } else { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ /* if(hwaddr_aton_i(pdata->pointer, bssid)) */ -+ if (hwaddr_aton_i(data, bssid)) { -+ RTW_INFO("Invalid BSSID '%s'.\n", (u8 *)data); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ return -EINVAL; -+ } -+ -+ -+ if (_rtw_memcmp(bssid, pnetwork->network.MacAddress, ETH_ALEN) == _TRUE) { /* BSSID match, then check if supporting wpa/wpa2 */ -+ RTW_INFO("BSSID:" MAC_FMT "\n", MAC_ARG(bssid)); -+ -+ pbuf = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength - 12); -+ if (pbuf && (wpa_ielen > 0)) { -+ pdata->flags = 1; -+ break; -+ } -+ -+ pbuf = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength - 12); -+ if (pbuf && (wpa_ielen > 0)) { -+ pdata->flags = 2; -+ break; -+ } -+ -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (pdata->length >= 34) { -+ if (copy_to_user((u8 *)pdata->pointer + 32, (u8 *)&pdata->flags, 1)) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_set_pid(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = rtw_netdev_priv(dev); -+ int *pdata = (int *)wrqu; -+ int selector; -+ -+ if (rtw_is_drv_stopped(padapter) || (pdata == NULL)) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ selector = *pdata; -+ if (selector < 3 && selector >= 0) { -+ padapter->pid[selector] = *(pdata + 1); -+#ifdef CONFIG_GLOBAL_UI_PID -+ ui_pid[selector] = *(pdata + 1); -+#endif -+ RTW_INFO("%s set pid[%d]=%d\n", __FUNCTION__, selector , padapter->pid[selector]); -+ } else -+ RTW_INFO("%s selector %d error\n", __FUNCTION__, selector); -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_wps_start(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ u32 u32wps_start = 0; -+ unsigned int uintRet = 0; -+ -+ if (RTW_CANNOT_RUN(padapter) || (NULL == pdata)) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ uintRet = copy_from_user((void *) &u32wps_start, pdata->pointer, 4); -+ if (u32wps_start == 0) -+ u32wps_start = *extra; -+ -+ RTW_INFO("[%s] wps_start = %d\n", __FUNCTION__, u32wps_start); -+ -+ if (u32wps_start == 1) /* WPS Start */ -+ rtw_led_control(padapter, LED_CTL_START_WPS); -+ else if (u32wps_start == 2) /* WPS Stop because of wps success */ -+ rtw_led_control(padapter, LED_CTL_STOP_WPS); -+ else if (u32wps_start == 3) /* WPS Stop because of wps fail */ -+ rtw_led_control(padapter, LED_CTL_STOP_WPS_FAIL); -+ -+#ifdef CONFIG_INTEL_WIDI -+ process_intel_widi_wps_status(padapter, u32wps_start); -+#endif /* CONFIG_INTEL_WIDI */ -+ -+exit: -+ -+ return ret; -+ -+} -+ -+#ifdef CONFIG_P2P -+static int rtw_wext_p2p_enable(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ enum P2P_ROLE init_role = P2P_ROLE_DISABLE; -+ -+ if (*extra == '0') -+ init_role = P2P_ROLE_DISABLE; -+ else if (*extra == '1') -+ init_role = P2P_ROLE_DEVICE; -+ else if (*extra == '2') -+ init_role = P2P_ROLE_CLIENT; -+ else if (*extra == '3') -+ init_role = P2P_ROLE_GO; -+ -+ if (_FAIL == rtw_p2p_enable(padapter, init_role)) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ /* set channel/bandwidth */ -+ if (init_role != P2P_ROLE_DISABLE) { -+ u8 channel, ch_offset; -+ u16 bwmode; -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN)) { -+ /* Stay at the listen state and wait for discovery. */ -+ channel = pwdinfo->listen_channel; -+ pwdinfo->operating_channel = pwdinfo->listen_channel; -+ ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ bwmode = CHANNEL_WIDTH_20; -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) { -+ -+ _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_interval); -+ -+ channel = rtw_mi_get_union_chan(padapter); -+ ch_offset = rtw_mi_get_union_offset(padapter); -+ bwmode = rtw_mi_get_union_bw(padapter); -+ -+ pwdinfo->operating_channel = channel; -+ } -+#endif -+ else { -+ pwdinfo->operating_channel = pmlmeext->cur_channel; -+ -+ channel = pwdinfo->operating_channel; -+ ch_offset = pmlmeext->cur_ch_offset; -+ bwmode = pmlmeext->cur_bwmode; -+ } -+ -+ set_channel_bwmode(padapter, channel, ch_offset, bwmode); -+ } -+ -+exit: -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_go_nego_ssid(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ RTW_INFO("[%s] ssid = %s, len = %zu\n", __FUNCTION__, extra, strlen(extra)); -+ _rtw_memcpy(pwdinfo->nego_ssid, extra, strlen(extra)); -+ pwdinfo->nego_ssidlen = strlen(extra); -+ -+ return ret; -+ -+} -+ -+ -+static int rtw_p2p_set_intent(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 intent = pwdinfo->intent; -+ -+ extra[wrqu->data.length] = 0x00; -+ -+ intent = rtw_atoi(extra); -+ -+ if (intent <= 15) -+ pwdinfo->intent = intent; -+ else -+ ret = -1; -+ -+ RTW_INFO("[%s] intent = %d\n", __FUNCTION__, intent); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_listen_ch(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 listen_ch = pwdinfo->listen_channel; /* Listen channel number */ -+ -+ extra[wrqu->data.length] = 0x00; -+ listen_ch = rtw_atoi(extra); -+ -+ if ((listen_ch == 1) || (listen_ch == 6) || (listen_ch == 11)) { -+ pwdinfo->listen_channel = listen_ch; -+ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } else -+ ret = -1; -+ -+ RTW_INFO("[%s] listen_ch = %d\n", __FUNCTION__, pwdinfo->listen_channel); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_op_ch(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ /* Commented by Albert 20110524 -+ * This function is used to set the operating channel if the driver will become the group owner */ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 op_ch = pwdinfo->operating_channel; /* Operating channel number */ -+ -+ extra[wrqu->data.length] = 0x00; -+ -+ op_ch = (u8) rtw_atoi(extra); -+ if (op_ch > 0) -+ pwdinfo->operating_channel = op_ch; -+ else -+ ret = -1; -+ -+ RTW_INFO("[%s] op_ch = %d\n", __FUNCTION__, pwdinfo->operating_channel); -+ -+ return ret; -+ -+} -+ -+ -+static int rtw_p2p_profilefound(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ /* Comment by Albert 2010/10/13 */ -+ /* Input data format: */ -+ /* Ex: 0 */ -+ /* Ex: 1XX:XX:XX:XX:XX:XXYYSSID */ -+ /* 0 => Reflush the profile record list. */ -+ /* 1 => Add the profile list */ -+ /* XX:XX:XX:XX:XX:XX => peer's MAC Address ( ex: 00:E0:4C:00:00:01 ) */ -+ /* YY => SSID Length */ -+ /* SSID => SSID for persistence group */ -+ -+ RTW_INFO("[%s] In value = %s, len = %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ -+ /* The upper application should pass the SSID to driver by using this rtw_p2p_profilefound function. */ -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ if (extra[0] == '0') { -+ /* Remove all the profile information of wifidirect_info structure. */ -+ _rtw_memset(&pwdinfo->profileinfo[0], 0x00, sizeof(struct profile_info) * P2P_MAX_PERSISTENT_GROUP_NUM); -+ pwdinfo->profileindex = 0; -+ } else { -+ if (pwdinfo->profileindex >= P2P_MAX_PERSISTENT_GROUP_NUM) -+ ret = -1; -+ else { -+ int jj, kk; -+ -+ /* Add this profile information into pwdinfo->profileinfo */ -+ /* Ex: 1XX:XX:XX:XX:XX:XXYYSSID */ -+ for (jj = 0, kk = 1; jj < ETH_ALEN; jj++, kk += 3) -+ pwdinfo->profileinfo[pwdinfo->profileindex].peermac[jj] = key_2char2num(extra[kk], extra[kk + 1]); -+ -+ /* pwdinfo->profileinfo[pwdinfo->profileindex].ssidlen = ( extra[18] - '0' ) * 10 + ( extra[19] - '0' ); */ -+ /* _rtw_memcpy( pwdinfo->profileinfo[pwdinfo->profileindex].ssid, &extra[20], pwdinfo->profileinfo[pwdinfo->profileindex].ssidlen ); */ -+ pwdinfo->profileindex++; -+ } -+ } -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_setDN(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ _rtw_memset(pwdinfo->device_name, 0x00, WPS_MAX_DEVICE_NAME_LEN); -+ _rtw_memcpy(pwdinfo->device_name, extra, wrqu->data.length - 1); -+ pwdinfo->device_name_len = wrqu->data.length - 1; -+ -+ return ret; -+ -+} -+ -+ -+static int rtw_p2p_get_status(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ if (padapter->bShowGetP2PState) { -+ RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), -+ pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2], -+ pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]); -+ } -+ -+ /* Commented by Albert 2010/10/12 */ -+ /* Because of the output size limitation, I had removed the "Role" information. */ -+ /* About the "Role" information, we will use the new private IOCTL to get the "Role" information. */ -+ sprintf(extra, "\n\nStatus=%.2d\n", rtw_p2p_state(pwdinfo)); -+ wrqu->data.length = strlen(extra); -+ -+ return ret; -+ -+} -+ -+/* Commented by Albert 20110520 -+ * This function will return the config method description -+ * This config method description will show us which config method the remote P2P device is intented to use -+ * by sending the provisioning discovery request frame. */ -+ -+static int rtw_p2p_get_req_cm(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ sprintf(extra, "\n\nCM=%s\n", pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req); -+ wrqu->data.length = strlen(extra); -+ return ret; -+ -+} -+ -+ -+static int rtw_p2p_get_role(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ -+ RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), -+ pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2], -+ pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]); -+ -+ sprintf(extra, "\n\nRole=%.2d\n", rtw_p2p_role(pwdinfo)); -+ wrqu->data.length = strlen(extra); -+ return ret; -+ -+} -+ -+ -+static int rtw_p2p_get_peer_ifaddr(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ -+ RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), -+ pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2], -+ pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]); -+ -+ sprintf(extra, "\nMAC %.2X:%.2X:%.2X:%.2X:%.2X:%.2X", -+ pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2], -+ pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]); -+ wrqu->data.length = strlen(extra); -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_peer_devaddr(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+ -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), -+ pwdinfo->rx_prov_disc_info.peerDevAddr[0], pwdinfo->rx_prov_disc_info.peerDevAddr[1], -+ pwdinfo->rx_prov_disc_info.peerDevAddr[2], pwdinfo->rx_prov_disc_info.peerDevAddr[3], -+ pwdinfo->rx_prov_disc_info.peerDevAddr[4], pwdinfo->rx_prov_disc_info.peerDevAddr[5]); -+ sprintf(extra, "\n%.2X%.2X%.2X%.2X%.2X%.2X", -+ pwdinfo->rx_prov_disc_info.peerDevAddr[0], pwdinfo->rx_prov_disc_info.peerDevAddr[1], -+ pwdinfo->rx_prov_disc_info.peerDevAddr[2], pwdinfo->rx_prov_disc_info.peerDevAddr[3], -+ pwdinfo->rx_prov_disc_info.peerDevAddr[4], pwdinfo->rx_prov_disc_info.peerDevAddr[5]); -+ wrqu->data.length = strlen(extra); -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_peer_devaddr_by_invitation(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+ -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), -+ pwdinfo->p2p_peer_device_addr[0], pwdinfo->p2p_peer_device_addr[1], -+ pwdinfo->p2p_peer_device_addr[2], pwdinfo->p2p_peer_device_addr[3], -+ pwdinfo->p2p_peer_device_addr[4], pwdinfo->p2p_peer_device_addr[5]); -+ sprintf(extra, "\nMAC %.2X:%.2X:%.2X:%.2X:%.2X:%.2X", -+ pwdinfo->p2p_peer_device_addr[0], pwdinfo->p2p_peer_device_addr[1], -+ pwdinfo->p2p_peer_device_addr[2], pwdinfo->p2p_peer_device_addr[3], -+ pwdinfo->p2p_peer_device_addr[4], pwdinfo->p2p_peer_device_addr[5]); -+ wrqu->data.length = strlen(extra); -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_groupid(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+ -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ sprintf(extra, "\n%.2X:%.2X:%.2X:%.2X:%.2X:%.2X %s", -+ pwdinfo->groupid_info.go_device_addr[0], pwdinfo->groupid_info.go_device_addr[1], -+ pwdinfo->groupid_info.go_device_addr[2], pwdinfo->groupid_info.go_device_addr[3], -+ pwdinfo->groupid_info.go_device_addr[4], pwdinfo->groupid_info.go_device_addr[5], -+ pwdinfo->groupid_info.ssid); -+ wrqu->data.length = strlen(extra); -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_op_ch(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+ -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ -+ RTW_INFO("[%s] Op_ch = %02x\n", __FUNCTION__, pwdinfo->operating_channel); -+ -+ sprintf(extra, "\n\nOp_ch=%.2d\n", pwdinfo->operating_channel); -+ wrqu->data.length = strlen(extra); -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_wps_configmethod(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 blnMatch = 0; -+ u16 attr_content = 0; -+ uint attr_contentlen = 0; -+ u8 attr_content_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; -+ -+ /* Commented by Albert 20110727 */ -+ /* The input data is the MAC address which the application wants to know its WPS config method. */ -+ /* After knowing its WPS config method, the application can decide the config method for provisioning discovery. */ -+ /* Format: iwpriv wlanx p2p_get_wpsCM 00:E0:4C:00:00:05 */ -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd); -+ -+ macstr2num(peerMAC, subcmd); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { -+ u8 *wpsie; -+ uint wpsie_len = 0; -+ -+ /* The mac address is matched. */ -+ -+ wpsie = rtw_get_wps_ie_from_scan_queue(&pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &wpsie_len, pnetwork->network.Reserved[0]); -+ if (wpsie) { -+ rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_CONF_METHOD, (u8 *)&attr_content, &attr_contentlen); -+ if (attr_contentlen) { -+ attr_content = be16_to_cpu(attr_content); -+ sprintf(attr_content_str, "\n\nM=%.4d", attr_content); -+ blnMatch = 1; -+ } -+ } -+ -+ break; -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (!blnMatch) -+ sprintf(attr_content_str, "\n\nM=0000"); -+ -+ wrqu->data.length = strlen(attr_content_str); -+ _rtw_memcpy(extra, attr_content_str, wrqu->data.length); -+ -+ return ret; -+ -+} -+ -+#ifdef CONFIG_WFD -+static int rtw_p2p_get_peer_wfd_port(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ RTW_INFO("[%s] p2p_state = %d\n", __FUNCTION__, rtw_p2p_state(pwdinfo)); -+ -+ sprintf(extra, "\n\nPort=%d\n", pwdinfo->wfd_info->peer_rtsp_ctrlport); -+ RTW_INFO("[%s] remote port = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_rtsp_ctrlport); -+ -+ wrqu->data.length = strlen(extra); -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_peer_wfd_preferred_connection(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ sprintf(extra, "\n\nwfd_pc=%d\n", pwdinfo->wfd_info->wfd_pc); -+ RTW_INFO("[%s] wfd_pc = %d\n", __FUNCTION__, pwdinfo->wfd_info->wfd_pc); -+ -+ wrqu->data.length = strlen(extra); -+ pwdinfo->wfd_info->wfd_pc = _FALSE; /* Reset the WFD preferred connection to P2P */ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_peer_wfd_session_available(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ sprintf(extra, "\n\nwfd_sa=%d\n", pwdinfo->wfd_info->peer_session_avail); -+ RTW_INFO("[%s] wfd_sa = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_session_avail); -+ -+ wrqu->data.length = strlen(extra); -+ pwdinfo->wfd_info->peer_session_avail = _TRUE; /* Reset the WFD session available */ -+ return ret; -+ -+} -+#endif /* CONFIG_WFD */ -+ -+static int rtw_p2p_get_go_device_address(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 blnMatch = 0; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 0; -+ u8 attr_content[100] = { 0x00 }; -+ u8 go_devadd_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; -+ -+ /* Commented by Albert 20121209 */ -+ /* The input data is the GO's interface address which the application wants to know its device address. */ -+ /* Format: iwpriv wlanx p2p_get2 go_devadd=00:E0:4C:00:00:05 */ -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd); -+ -+ macstr2num(peerMAC, subcmd); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { -+ /* Commented by Albert 2011/05/18 */ -+ /* Match the device address located in the P2P IE */ -+ /* This is for the case that the P2P device address is not the same as the P2P interface address. */ -+ -+ p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen); -+ if (p2pie) { -+ while (p2pie) { -+ /* The P2P Device ID attribute is included in the Beacon frame. */ -+ /* The P2P Device Info attribute is included in the probe response frame. */ -+ -+ _rtw_memset(attr_content, 0x00, 100); -+ if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) { -+ /* Handle the P2P Device ID attribute of Beacon first */ -+ blnMatch = 1; -+ break; -+ -+ } else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) { -+ /* Handle the P2P Device Info attribute of probe response */ -+ blnMatch = 1; -+ break; -+ } -+ -+ /* Get the next P2P IE */ -+ p2pie = rtw_get_p2p_ie(p2pie + p2pielen, BSS_EX_TLV_IES_LEN(&pnetwork->network) - (p2pie + p2pielen - BSS_EX_TLV_IES(&pnetwork->network)), NULL, &p2pielen); -+ } -+ } -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (!blnMatch) -+ sprintf(go_devadd_str, "\n\ndev_add=NULL"); -+ else { -+ sprintf(go_devadd_str, "\n\ndev_add=%.2X:%.2X:%.2X:%.2X:%.2X:%.2X", -+ attr_content[0], attr_content[1], attr_content[2], attr_content[3], attr_content[4], attr_content[5]); -+ } -+ -+ wrqu->data.length = strlen(go_devadd_str); -+ _rtw_memcpy(extra, go_devadd_str, wrqu->data.length); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_device_type(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 blnMatch = 0; -+ u8 dev_type[8] = { 0x00 }; -+ uint dev_type_len = 0; -+ u8 dev_type_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; /* +9 is for the str "dev_type=", we have to clear it at wrqu->data.pointer */ -+ -+ /* Commented by Albert 20121209 */ -+ /* The input data is the MAC address which the application wants to know its device type. */ -+ /* Such user interface could know the device type. */ -+ /* Format: iwpriv wlanx p2p_get2 dev_type=00:E0:4C:00:00:05 */ -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd); -+ -+ macstr2num(peerMAC, subcmd); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { -+ u8 *wpsie; -+ uint wpsie_len = 0; -+ -+ /* The mac address is matched. */ -+ -+ wpsie = rtw_get_wps_ie_from_scan_queue(&pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &wpsie_len, pnetwork->network.Reserved[0]); -+ if (wpsie) { -+ rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_PRIMARY_DEV_TYPE, dev_type, &dev_type_len); -+ if (dev_type_len) { -+ u16 type = 0; -+ -+ _rtw_memcpy(&type, dev_type, 2); -+ type = be16_to_cpu(type); -+ sprintf(dev_type_str, "\n\nN=%.2d", type); -+ blnMatch = 1; -+ } -+ } -+ break; -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (!blnMatch) -+ sprintf(dev_type_str, "\n\nN=00"); -+ -+ wrqu->data.length = strlen(dev_type_str); -+ _rtw_memcpy(extra, dev_type_str, wrqu->data.length); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_device_name(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 blnMatch = 0; -+ u8 dev_name[WPS_MAX_DEVICE_NAME_LEN] = { 0x00 }; -+ uint dev_len = 0; -+ u8 dev_name_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; -+ -+ /* Commented by Albert 20121225 */ -+ /* The input data is the MAC address which the application wants to know its device name. */ -+ /* Such user interface could show peer device's device name instead of ssid. */ -+ /* Format: iwpriv wlanx p2p_get2 devN=00:E0:4C:00:00:05 */ -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd); -+ -+ macstr2num(peerMAC, subcmd); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { -+ u8 *wpsie; -+ uint wpsie_len = 0; -+ -+ /* The mac address is matched. */ -+ -+ wpsie = rtw_get_wps_ie_from_scan_queue(&pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &wpsie_len, pnetwork->network.Reserved[0]); -+ if (wpsie) { -+ rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_DEVICE_NAME, dev_name, &dev_len); -+ if (dev_len) { -+ sprintf(dev_name_str, "\n\nN=%s", dev_name); -+ blnMatch = 1; -+ } -+ } -+ break; -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (!blnMatch) -+ sprintf(dev_name_str, "\n\nN=0000"); -+ -+ wrqu->data.length = strlen(dev_name_str); -+ _rtw_memcpy(extra, dev_name_str, wrqu->data.length); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_invitation_procedure(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 blnMatch = 0; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 0; -+ u8 attr_content[2] = { 0x00 }; -+ u8 inv_proc_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; -+ -+ /* Commented by Ouden 20121226 */ -+ /* The application wants to know P2P initation procedure is support or not. */ -+ /* Format: iwpriv wlanx p2p_get2 InvProc=00:E0:4C:00:00:05 */ -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd); -+ -+ macstr2num(peerMAC, subcmd); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { -+ /* Commented by Albert 20121226 */ -+ /* Match the device address located in the P2P IE */ -+ /* This is for the case that the P2P device address is not the same as the P2P interface address. */ -+ -+ p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen); -+ if (p2pie) { -+ while (p2pie) { -+ /* _rtw_memset( attr_content, 0x00, 2); */ -+ if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_CAPABILITY, attr_content, &attr_contentlen)) { -+ /* Handle the P2P capability attribute */ -+ blnMatch = 1; -+ break; -+ -+ } -+ -+ /* Get the next P2P IE */ -+ p2pie = rtw_get_p2p_ie(p2pie + p2pielen, BSS_EX_TLV_IES_LEN(&pnetwork->network) - (p2pie + p2pielen - BSS_EX_TLV_IES(&pnetwork->network)), NULL, &p2pielen); -+ } -+ } -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (!blnMatch) -+ sprintf(inv_proc_str, "\nIP=-1"); -+ else { -+ if ((attr_content[0] & 0x20) == 0x20) -+ sprintf(inv_proc_str, "\nIP=1"); -+ else -+ sprintf(inv_proc_str, "\nIP=0"); -+ } -+ -+ wrqu->data.length = strlen(inv_proc_str); -+ _rtw_memcpy(extra, inv_proc_str, wrqu->data.length); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_connect(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ int jj, kk; -+ u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ uint uintPeerChannel = 0; -+ -+ /* Commented by Albert 20110304 */ -+ /* The input data contains two informations. */ -+ /* 1. First information is the MAC address which wants to formate with */ -+ /* 2. Second information is the WPS PINCode or "pbc" string for push button method */ -+ /* Format: 00:E0:4C:00:00:05 */ -+ /* Format: 00:E0:4C:00:00:05 */ -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); -+ -+ if (pwdinfo->p2p_state == P2P_STATE_NONE) { -+ RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); -+ return ret; -+ } -+ -+#ifdef CONFIG_INTEL_WIDI -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { -+ RTW_INFO("[%s] WiFi is under survey!\n", __FUNCTION__); -+ return ret; -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ if (pwdinfo->ui_got_wps_info == P2P_NO_WPSINFO) -+ return -1; -+ -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) -+ peerMAC[jj] = key_2char2num(extra[kk], extra[kk + 1]); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { -+ if (pnetwork->network.Configuration.DSConfig != 0) -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ else if (pwdinfo->nego_req_info.peer_ch != 0) -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig = pwdinfo->nego_req_info.peer_ch; -+ else { -+ /* Unexpected case */ -+ uintPeerChannel = 0; -+ RTW_INFO("%s uintPeerChannel = 0\n", __func__); -+ } -+ break; -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (uintPeerChannel) { -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ _rtw_memset(&pwdinfo->nego_req_info, 0x00, sizeof(struct tx_nego_req_info)); -+ _rtw_memset(&pwdinfo->groupid_info, 0x00, sizeof(struct group_id_info)); -+ -+ pwdinfo->nego_req_info.peer_channel_num[0] = uintPeerChannel; -+ _rtw_memcpy(pwdinfo->nego_req_info.peerDevAddr, pnetwork->network.MacAddress, ETH_ALEN); -+ pwdinfo->nego_req_info.benable = _TRUE; -+ -+ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); -+ if (rtw_p2p_state(pwdinfo) != P2P_STATE_GONEGO_OK) { -+ /* Restore to the listen state if the current p2p state is not nego OK */ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+ } -+ -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_ING); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ u8 union_bw = rtw_mi_get_union_bw(padapter); -+ u8 union_offset = rtw_mi_get_union_offset(padapter); -+ /* Have to enter the power saving with the AP */ -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ -+ rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); -+ } -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ RTW_INFO("[%s] Start PreTx Procedure!\n", __FUNCTION__); -+ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_GO_NEGO_TIMEOUT); -+ else -+ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_GO_NEGO_TIMEOUT); -+#else -+ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_GO_NEGO_TIMEOUT); -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ } else { -+ RTW_INFO("[%s] Not Found in Scanning Queue~\n", __FUNCTION__); -+#ifdef CONFIG_INTEL_WIDI -+ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+ rtw_free_network_queue(padapter, _TRUE); -+ /** -+ * For WiDi, if we can't find candidate device in scanning queue, -+ * driver will do scanning itself -+ */ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ rtw_sitesurvey_cmd(padapter, NULL, 0, NULL, 0); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+#endif /* CONFIG_INTEL_WIDI */ -+ ret = -1; -+ } -+exit: -+ return ret; -+} -+ -+static int rtw_p2p_invite_req(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ int jj, kk; -+ u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ uint uintPeerChannel = 0; -+ u8 attr_content[50] = { 0x00 }, _status = 0; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 0; -+ _irqL irqL; -+ struct tx_invite_req_info *pinvite_req_info = &pwdinfo->invitereq_info; -+ -+ /* Commented by Albert 20120321 */ -+ /* The input data contains two informations. */ -+ /* 1. First information is the P2P device address which you want to send to. */ -+ /* 2. Second information is the group id which combines with GO's mac address, space and GO's ssid. */ -+ /* Command line sample: iwpriv wlan0 p2p_set invite="00:11:22:33:44:55 00:E0:4C:00:00:05 DIRECT-xy" */ -+ /* Format: 00:11:22:33:44:55 00:E0:4C:00:00:05 DIRECT-xy */ -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); -+ -+ if (wrqu->data.length <= 37) { -+ RTW_INFO("[%s] Wrong format!\n", __FUNCTION__); -+ return ret; -+ } -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); -+ return ret; -+ } else { -+ /* Reset the content of struct tx_invite_req_info */ -+ pinvite_req_info->benable = _FALSE; -+ _rtw_memset(pinvite_req_info->go_bssid, 0x00, ETH_ALEN); -+ _rtw_memset(pinvite_req_info->go_ssid, 0x00, WLAN_SSID_MAXLEN); -+ pinvite_req_info->ssidlen = 0x00; -+ pinvite_req_info->operating_ch = pwdinfo->operating_channel; -+ _rtw_memset(pinvite_req_info->peer_macaddr, 0x00, ETH_ALEN); -+ pinvite_req_info->token = 3; -+ } -+ -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) -+ pinvite_req_info->peer_macaddr[jj] = key_2char2num(extra[kk], extra[kk + 1]); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ /* Commented by Albert 2011/05/18 */ -+ /* Match the device address located in the P2P IE */ -+ /* This is for the case that the P2P device address is not the same as the P2P interface address. */ -+ -+ p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen); -+ if (p2pie) { -+ /* The P2P Device ID attribute is included in the Beacon frame. */ -+ /* The P2P Device Info attribute is included in the probe response frame. */ -+ -+ if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) { -+ /* Handle the P2P Device ID attribute of Beacon first */ -+ if (_rtw_memcmp(attr_content, pinvite_req_info->peer_macaddr, ETH_ALEN)) { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) { -+ /* Handle the P2P Device Info attribute of probe response */ -+ if (_rtw_memcmp(attr_content, pinvite_req_info->peer_macaddr, ETH_ALEN)) { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } -+ -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+#ifdef CONFIG_WFD -+ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST) && uintPeerChannel) { -+ struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; -+ u8 *wfd_ie; -+ uint wfd_ielen = 0; -+ -+ wfd_ie = rtw_bss_ex_get_wfd_ie(&pnetwork->network, NULL, &wfd_ielen); -+ if (wfd_ie) { -+ u8 *wfd_devinfo; -+ uint wfd_devlen; -+ -+ RTW_INFO("[%s] Found WFD IE!\n", __FUNCTION__); -+ wfd_devinfo = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &wfd_devlen); -+ if (wfd_devinfo) { -+ u16 wfd_devinfo_field = 0; -+ -+ /* Commented by Albert 20120319 */ -+ /* The first two bytes are the WFD device information field of WFD device information subelement. */ -+ /* In big endian format. */ -+ wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo); -+ if (wfd_devinfo_field & WFD_DEVINFO_SESSION_AVAIL) -+ pwfd_info->peer_session_avail = _TRUE; -+ else -+ pwfd_info->peer_session_avail = _FALSE; -+ } -+ } -+ -+ if (_FALSE == pwfd_info->peer_session_avail) { -+ RTW_INFO("[%s] WFD Session not avaiable!\n", __FUNCTION__); -+ goto exit; -+ } -+ } -+#endif /* CONFIG_WFD */ -+ -+ if (uintPeerChannel) { -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ /* Store the GO's bssid */ -+ for (jj = 0, kk = 18; jj < ETH_ALEN; jj++, kk += 3) -+ pinvite_req_info->go_bssid[jj] = key_2char2num(extra[kk], extra[kk + 1]); -+ -+ /* Store the GO's ssid */ -+ pinvite_req_info->ssidlen = wrqu->data.length - 36; -+ _rtw_memcpy(pinvite_req_info->go_ssid, &extra[36], (u32) pinvite_req_info->ssidlen); -+ pinvite_req_info->benable = _TRUE; -+ pinvite_req_info->peer_ch = uintPeerChannel; -+ -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_INVITE_REQ); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ u8 union_bw = rtw_mi_get_union_bw(padapter); -+ u8 union_offset = rtw_mi_get_union_offset(padapter); -+ /* Have to enter the power saving with the AP */ -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ -+ rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); -+ } else -+ set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+#else -+ set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+#endif -+ -+ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_INVITE_TIMEOUT); -+ else -+ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_INVITE_TIMEOUT); -+#else -+ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_INVITE_TIMEOUT); -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ -+ } else -+ RTW_INFO("[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__); -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_persistent(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ int jj, kk; -+ u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ uint uintPeerChannel = 0; -+ u8 attr_content[50] = { 0x00 }, _status = 0; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 0; -+ _irqL irqL; -+ struct tx_invite_req_info *pinvite_req_info = &pwdinfo->invitereq_info; -+ -+ /* Commented by Albert 20120328 */ -+ /* The input data is 0 or 1 */ -+ /* 0: disable persistent group functionality */ -+ /* 1: enable persistent group founctionality */ -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); -+ return ret; -+ } else { -+ if (extra[0] == '0') /* Disable the persistent group function. */ -+ pwdinfo->persistent_supported = _FALSE; -+ else if (extra[0] == '1') /* Enable the persistent group function. */ -+ pwdinfo->persistent_supported = _TRUE; -+ else -+ pwdinfo->persistent_supported = _FALSE; -+ } -+ printk("[%s] persistent_supported = %d\n", __FUNCTION__, pwdinfo->persistent_supported); -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int hexstr2bin(const char *hex, u8 *buf, size_t len) -+{ -+ size_t i; -+ int a; -+ const char *ipos = hex; -+ u8 *opos = buf; -+ -+ for (i = 0; i < len; i++) { -+ a = hex2byte_i(ipos); -+ if (a < 0) -+ return -1; -+ *opos++ = a; -+ ipos += 2; -+ } -+ return 0; -+} -+ -+static int uuid_str2bin(const char *str, u8 *bin) -+{ -+ const char *pos; -+ u8 *opos; -+ -+ pos = str; -+ opos = bin; -+ -+ if (hexstr2bin(pos, opos, 4)) -+ return -1; -+ pos += 8; -+ opos += 4; -+ -+ if (*pos++ != '-' || hexstr2bin(pos, opos, 2)) -+ return -1; -+ pos += 4; -+ opos += 2; -+ -+ if (*pos++ != '-' || hexstr2bin(pos, opos, 2)) -+ return -1; -+ pos += 4; -+ opos += 2; -+ -+ if (*pos++ != '-' || hexstr2bin(pos, opos, 2)) -+ return -1; -+ pos += 4; -+ opos += 2; -+ -+ if (*pos++ != '-' || hexstr2bin(pos, opos, 6)) -+ return -1; -+ -+ return 0; -+} -+ -+static int rtw_p2p_set_wps_uuid(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); -+ -+ if ((36 == strlen(extra)) && (uuid_str2bin(extra, pwdinfo->uuid) == 0)) -+ pwdinfo->external_uuid = 1; -+ else { -+ pwdinfo->external_uuid = 0; -+ ret = -EINVAL; -+ } -+ -+ return ret; -+ -+} -+#ifdef CONFIG_WFD -+static int rtw_p2p_set_pc(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ int jj, kk; -+ u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 attr_content[50] = { 0x00 }, _status = 0; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 0; -+ _irqL irqL; -+ uint uintPeerChannel = 0; -+ -+ struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; -+ -+ /* Commented by Albert 20120512 */ -+ /* 1. Input information is the MAC address which wants to know the Preferred Connection bit (PC bit) */ -+ /* Format: 00:E0:4C:00:00:05 */ -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); -+ -+ if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); -+ return ret; -+ } -+ -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) -+ peerMAC[jj] = key_2char2num(extra[kk], extra[kk + 1]); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ /* Commented by Albert 2011/05/18 */ -+ /* Match the device address located in the P2P IE */ -+ /* This is for the case that the P2P device address is not the same as the P2P interface address. */ -+ -+ p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen); -+ if (p2pie) { -+ /* The P2P Device ID attribute is included in the Beacon frame. */ -+ /* The P2P Device Info attribute is included in the probe response frame. */ -+ printk("[%s] Got P2P IE\n", __FUNCTION__); -+ if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) { -+ /* Handle the P2P Device ID attribute of Beacon first */ -+ printk("[%s] P2P_ATTR_DEVICE_ID\n", __FUNCTION__); -+ if (_rtw_memcmp(attr_content, peerMAC, ETH_ALEN)) { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) { -+ /* Handle the P2P Device Info attribute of probe response */ -+ printk("[%s] P2P_ATTR_DEVICE_INFO\n", __FUNCTION__); -+ if (_rtw_memcmp(attr_content, peerMAC, ETH_ALEN)) { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } -+ -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ printk("[%s] channel = %d\n", __FUNCTION__, uintPeerChannel); -+ -+ if (uintPeerChannel) { -+ u8 *wfd_ie; -+ uint wfd_ielen = 0; -+ -+ wfd_ie = rtw_bss_ex_get_wfd_ie(&pnetwork->network, NULL, &wfd_ielen); -+ if (wfd_ie) { -+ u8 *wfd_devinfo; -+ uint wfd_devlen; -+ -+ RTW_INFO("[%s] Found WFD IE!\n", __FUNCTION__); -+ wfd_devinfo = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &wfd_devlen); -+ if (wfd_devinfo) { -+ u16 wfd_devinfo_field = 0; -+ -+ /* Commented by Albert 20120319 */ -+ /* The first two bytes are the WFD device information field of WFD device information subelement. */ -+ /* In big endian format. */ -+ wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo); -+ if (wfd_devinfo_field & WFD_DEVINFO_PC_TDLS) -+ pwfd_info->wfd_pc = _TRUE; -+ else -+ pwfd_info->wfd_pc = _FALSE; -+ } -+ } -+ } else -+ RTW_INFO("[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__); -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_wfd_device_type(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; -+ -+ /* Commented by Albert 20120328 */ -+ /* The input data is 0 or 1 */ -+ /* 0: specify to Miracast source device */ -+ /* 1 or others: specify to Miracast sink device (display device) */ -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); -+ -+ if (extra[0] == '0') /* Set to Miracast source device. */ -+ pwfd_info->wfd_device_type = WFD_DEVINFO_SOURCE; -+ else /* Set to Miracast sink device. */ -+ pwfd_info->wfd_device_type = WFD_DEVINFO_PSINK; -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_wfd_enable(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ /* Commented by Kurt 20121206 -+ * This function is used to set wfd enabled */ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ if (*extra == '0') -+ rtw_wfd_enable(padapter, 0); -+ else if (*extra == '1') -+ rtw_wfd_enable(padapter, 1); -+ -+ RTW_INFO("[%s] wfd_enable = %d\n", __FUNCTION__, pwdinfo->wfd_info->wfd_enable); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_driver_iface(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ /* Commented by Kurt 20121206 -+ * This function is used to set driver iface is WEXT or CFG80211 */ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ if (*extra == '1') { -+ pwdinfo->driver_interface = DRIVER_WEXT; -+ RTW_INFO("[%s] driver_interface = WEXT\n", __FUNCTION__); -+ } else if (*extra == '2') { -+ pwdinfo->driver_interface = DRIVER_CFG80211; -+ RTW_INFO("[%s] driver_interface = CFG80211\n", __FUNCTION__); -+ } -+ -+ return ret; -+ -+} -+ -+/* To set the WFD session available to enable or disable */ -+static int rtw_p2p_set_sa(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); -+ -+ if (0) { -+ RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); -+ return ret; -+ } else { -+ if (extra[0] == '0') /* Disable the session available. */ -+ pwdinfo->session_available = _FALSE; -+ else if (extra[0] == '1') /* Enable the session available. */ -+ pwdinfo->session_available = _TRUE; -+ else -+ pwdinfo->session_available = _FALSE; -+ } -+ printk("[%s] session available = %d\n", __FUNCTION__, pwdinfo->session_available); -+ -+exit: -+ -+ return ret; -+ -+} -+#endif /* CONFIG_WFD */ -+ -+static int rtw_p2p_prov_disc(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ int jj, kk; -+ u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ uint uintPeerChannel = 0; -+ u8 attr_content[100] = { 0x00 }, _status = 0; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 0; -+ _irqL irqL; -+ -+ /* Commented by Albert 20110301 */ -+ /* The input data contains two informations. */ -+ /* 1. First information is the MAC address which wants to issue the provisioning discovery request frame. */ -+ /* 2. Second information is the WPS configuration method which wants to discovery */ -+ /* Format: 00:E0:4C:00:00:05_display */ -+ /* Format: 00:E0:4C:00:00:05_keypad */ -+ /* Format: 00:E0:4C:00:00:05_pbc */ -+ /* Format: 00:E0:4C:00:00:05_label */ -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); -+ -+ if (pwdinfo->p2p_state == P2P_STATE_NONE) { -+ RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); -+ return ret; -+ } else { -+#ifdef CONFIG_INTEL_WIDI -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { -+ RTW_INFO("[%s] WiFi is under survey!\n", __FUNCTION__); -+ return ret; -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ /* Reset the content of struct tx_provdisc_req_info excluded the wps_config_method_request. */ -+ _rtw_memset(pwdinfo->tx_prov_disc_info.peerDevAddr, 0x00, ETH_ALEN); -+ _rtw_memset(pwdinfo->tx_prov_disc_info.peerIFAddr, 0x00, ETH_ALEN); -+ _rtw_memset(&pwdinfo->tx_prov_disc_info.ssid, 0x00, sizeof(NDIS_802_11_SSID)); -+ pwdinfo->tx_prov_disc_info.peer_channel_num[0] = 0; -+ pwdinfo->tx_prov_disc_info.peer_channel_num[1] = 0; -+ pwdinfo->tx_prov_disc_info.benable = _FALSE; -+ } -+ -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) -+ peerMAC[jj] = key_2char2num(extra[kk], extra[kk + 1]); -+ -+ if (_rtw_memcmp(&extra[18], "display", 7)) -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_DISPLYA; -+ else if (_rtw_memcmp(&extra[18], "keypad", 7)) -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_KEYPAD; -+ else if (_rtw_memcmp(&extra[18], "pbc", 3)) -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; -+ else if (_rtw_memcmp(&extra[18], "label", 5)) -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_LABEL; -+ else { -+ RTW_INFO("[%s] Unknown WPS config methodn", __FUNCTION__); -+ return ret ; -+ } -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) { -+ if (rtw_end_of_queue_search(phead, plist) == _TRUE) -+ break; -+ -+ if (uintPeerChannel != 0) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ /* Commented by Albert 2011/05/18 */ -+ /* Match the device address located in the P2P IE */ -+ /* This is for the case that the P2P device address is not the same as the P2P interface address. */ -+ -+ p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen); -+ if (p2pie) { -+ while (p2pie) { -+ /* The P2P Device ID attribute is included in the Beacon frame. */ -+ /* The P2P Device Info attribute is included in the probe response frame. */ -+ -+ if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) { -+ /* Handle the P2P Device ID attribute of Beacon first */ -+ if (_rtw_memcmp(attr_content, peerMAC, ETH_ALEN)) { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) { -+ /* Handle the P2P Device Info attribute of probe response */ -+ if (_rtw_memcmp(attr_content, peerMAC, ETH_ALEN)) { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } -+ -+ /* Get the next P2P IE */ -+ p2pie = rtw_get_p2p_ie(p2pie + p2pielen, BSS_EX_TLV_IES_LEN(&pnetwork->network) - (p2pie + p2pielen - BSS_EX_TLV_IES(&pnetwork->network)), NULL, &p2pielen); -+ } -+ -+ } -+ -+#ifdef CONFIG_INTEL_WIDI -+ /* Some Intel WiDi source may not provide P2P IE, */ -+ /* so we could only compare mac addr by 802.11 Source Address */ -+ if (pmlmepriv->widi_state == INTEL_WIDI_STATE_WFD_CONNECTION -+ && uintPeerChannel == 0) { -+ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (uintPeerChannel) { -+#ifdef CONFIG_WFD -+ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) { -+ struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; -+ u8 *wfd_ie; -+ uint wfd_ielen = 0; -+ -+ wfd_ie = rtw_bss_ex_get_wfd_ie(&pnetwork->network, NULL, &wfd_ielen); -+ if (wfd_ie) { -+ u8 *wfd_devinfo; -+ uint wfd_devlen; -+ -+ RTW_INFO("[%s] Found WFD IE!\n", __FUNCTION__); -+ wfd_devinfo = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &wfd_devlen); -+ if (wfd_devinfo) { -+ u16 wfd_devinfo_field = 0; -+ -+ /* Commented by Albert 20120319 */ -+ /* The first two bytes are the WFD device information field of WFD device information subelement. */ -+ /* In big endian format. */ -+ wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo); -+ if (wfd_devinfo_field & WFD_DEVINFO_SESSION_AVAIL) -+ pwfd_info->peer_session_avail = _TRUE; -+ else -+ pwfd_info->peer_session_avail = _FALSE; -+ } -+ } -+ -+ if (_FALSE == pwfd_info->peer_session_avail) { -+ RTW_INFO("[%s] WFD Session not avaiable!\n", __FUNCTION__); -+ goto exit; -+ } -+ } -+#endif /* CONFIG_WFD */ -+ -+ RTW_INFO("[%s] peer channel: %d!\n", __FUNCTION__, uintPeerChannel); -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); -+#endif /* CONFIG_CONCURRENT_MODE */ -+ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerIFAddr, pnetwork->network.MacAddress, ETH_ALEN); -+ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerDevAddr, peerMAC, ETH_ALEN); -+ pwdinfo->tx_prov_disc_info.peer_channel_num[0] = (u16) uintPeerChannel; -+ pwdinfo->tx_prov_disc_info.benable = _TRUE; -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ); -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) -+ _rtw_memcpy(&pwdinfo->tx_prov_disc_info.ssid, &pnetwork->network.Ssid, sizeof(NDIS_802_11_SSID)); -+ else if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { -+ _rtw_memcpy(pwdinfo->tx_prov_disc_info.ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN); -+ pwdinfo->tx_prov_disc_info.ssid.SsidLength = P2P_WILDCARD_SSID_LEN; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ u8 union_ch = rtw_mi_get_union_chan(padapter); -+ u8 union_bw = rtw_mi_get_union_bw(padapter); -+ u8 union_offset = rtw_mi_get_union_offset(padapter); -+ -+ /* Have to enter the power saving with the AP */ -+ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); -+ -+ rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); -+ } else -+ set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+#else -+ set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+#endif -+ -+ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_mi_check_status(padapter, MI_LINKED)) -+ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_PROVISION_TIMEOUT); -+ else -+ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT); -+#else -+ _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT); -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+ } else { -+ RTW_INFO("[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__); -+#ifdef CONFIG_INTEL_WIDI -+ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+ rtw_free_network_queue(padapter, _TRUE); -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ rtw_sitesurvey_cmd(padapter, NULL, 0, NULL, 0); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+#endif /* CONFIG_INTEL_WIDI */ -+ } -+exit: -+ -+ return ret; -+ -+} -+ -+/* Added by Albert 20110328 -+ * This function is used to inform the driver the user had specified the pin code value or pbc -+ * to application. */ -+ -+static int rtw_p2p_got_wpsinfo(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ -+ RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); -+ /* Added by Albert 20110328 */ -+ /* if the input data is P2P_NO_WPSINFO -> reset the wpsinfo */ -+ /* if the input data is P2P_GOT_WPSINFO_PEER_DISPLAY_PIN -> the utility just input the PIN code got from the peer P2P device. */ -+ /* if the input data is P2P_GOT_WPSINFO_SELF_DISPLAY_PIN -> the utility just got the PIN code from itself. */ -+ /* if the input data is P2P_GOT_WPSINFO_PBC -> the utility just determine to use the PBC */ -+ -+ if (*extra == '0') -+ pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO; -+ else if (*extra == '1') -+ pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_PEER_DISPLAY_PIN; -+ else if (*extra == '2') -+ pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_SELF_DISPLAY_PIN; -+ else if (*extra == '3') -+ pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_PBC; -+ else -+ pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO; -+ -+ return ret; -+ -+} -+ -+#endif /* CONFIG_P2P */ -+ -+static int rtw_p2p_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+#ifdef CONFIG_P2P -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ RTW_INFO("[%s] extra = %s\n", __FUNCTION__, extra); -+ -+ if (_rtw_memcmp(extra, "enable=", 7)) -+ rtw_wext_p2p_enable(dev, info, wrqu, &extra[7]); -+ else if (_rtw_memcmp(extra, "setDN=", 6)) { -+ wrqu->data.length -= 6; -+ rtw_p2p_setDN(dev, info, wrqu, &extra[6]); -+ } else if (_rtw_memcmp(extra, "profilefound=", 13)) { -+ wrqu->data.length -= 13; -+ rtw_p2p_profilefound(dev, info, wrqu, &extra[13]); -+ } else if (_rtw_memcmp(extra, "prov_disc=", 10)) { -+ wrqu->data.length -= 10; -+ rtw_p2p_prov_disc(dev, info, wrqu, &extra[10]); -+ } else if (_rtw_memcmp(extra, "nego=", 5)) { -+ wrqu->data.length -= 5; -+ rtw_p2p_connect(dev, info, wrqu, &extra[5]); -+ } else if (_rtw_memcmp(extra, "intent=", 7)) { -+ /* Commented by Albert 2011/03/23 */ -+ /* The wrqu->data.length will include the null character */ -+ /* So, we will decrease 7 + 1 */ -+ wrqu->data.length -= 8; -+ rtw_p2p_set_intent(dev, info, wrqu, &extra[7]); -+ } else if (_rtw_memcmp(extra, "ssid=", 5)) { -+ wrqu->data.length -= 5; -+ rtw_p2p_set_go_nego_ssid(dev, info, wrqu, &extra[5]); -+ } else if (_rtw_memcmp(extra, "got_wpsinfo=", 12)) { -+ wrqu->data.length -= 12; -+ rtw_p2p_got_wpsinfo(dev, info, wrqu, &extra[12]); -+ } else if (_rtw_memcmp(extra, "listen_ch=", 10)) { -+ /* Commented by Albert 2011/05/24 */ -+ /* The wrqu->data.length will include the null character */ -+ /* So, we will decrease (10 + 1) */ -+ wrqu->data.length -= 11; -+ rtw_p2p_set_listen_ch(dev, info, wrqu, &extra[10]); -+ } else if (_rtw_memcmp(extra, "op_ch=", 6)) { -+ /* Commented by Albert 2011/05/24 */ -+ /* The wrqu->data.length will include the null character */ -+ /* So, we will decrease (6 + 1) */ -+ wrqu->data.length -= 7; -+ rtw_p2p_set_op_ch(dev, info, wrqu, &extra[6]); -+ } else if (_rtw_memcmp(extra, "invite=", 7)) { -+ wrqu->data.length -= 8; -+ rtw_p2p_invite_req(dev, info, wrqu, &extra[7]); -+ } else if (_rtw_memcmp(extra, "persistent=", 11)) { -+ wrqu->data.length -= 11; -+ rtw_p2p_set_persistent(dev, info, wrqu, &extra[11]); -+ } else if (_rtw_memcmp(extra, "uuid=", 5)) { -+ wrqu->data.length -= 5; -+ ret = rtw_p2p_set_wps_uuid(dev, info, wrqu, &extra[5]); -+ } -+ -+#ifdef CONFIG_WFD -+ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) { -+ if (_rtw_memcmp(extra, "sa=", 3)) { -+ /* sa: WFD Session Available information */ -+ wrqu->data.length -= 3; -+ rtw_p2p_set_sa(dev, info, wrqu, &extra[3]); -+ } else if (_rtw_memcmp(extra, "pc=", 3)) { -+ /* pc: WFD Preferred Connection */ -+ wrqu->data.length -= 3; -+ rtw_p2p_set_pc(dev, info, wrqu, &extra[3]); -+ } else if (_rtw_memcmp(extra, "wfd_type=", 9)) { -+ wrqu->data.length -= 9; -+ rtw_p2p_set_wfd_device_type(dev, info, wrqu, &extra[9]); -+ } else if (_rtw_memcmp(extra, "wfd_enable=", 11)) { -+ wrqu->data.length -= 11; -+ rtw_p2p_set_wfd_enable(dev, info, wrqu, &extra[11]); -+ } else if (_rtw_memcmp(extra, "driver_iface=", 13)) { -+ wrqu->data.length -= 13; -+ rtw_p2p_set_driver_iface(dev, info, wrqu, &extra[13]); -+ } -+ } -+#endif /* CONFIG_WFD */ -+ -+#endif /* CONFIG_P2P */ -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+#ifdef CONFIG_P2P -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (padapter->bShowGetP2PState) -+ RTW_INFO("[%s] extra = %s\n", __FUNCTION__, (char *) wrqu->data.pointer); -+ -+ if (_rtw_memcmp(wrqu->data.pointer, "status", 6)) -+ rtw_p2p_get_status(dev, info, wrqu, extra); -+ else if (_rtw_memcmp(wrqu->data.pointer, "role", 4)) -+ rtw_p2p_get_role(dev, info, wrqu, extra); -+ else if (_rtw_memcmp(wrqu->data.pointer, "peer_ifa", 8)) -+ rtw_p2p_get_peer_ifaddr(dev, info, wrqu, extra); -+ else if (_rtw_memcmp(wrqu->data.pointer, "req_cm", 6)) -+ rtw_p2p_get_req_cm(dev, info, wrqu, extra); -+ else if (_rtw_memcmp(wrqu->data.pointer, "peer_deva", 9)) { -+ /* Get the P2P device address when receiving the provision discovery request frame. */ -+ rtw_p2p_get_peer_devaddr(dev, info, wrqu, extra); -+ } else if (_rtw_memcmp(wrqu->data.pointer, "group_id", 8)) -+ rtw_p2p_get_groupid(dev, info, wrqu, extra); -+ else if (_rtw_memcmp(wrqu->data.pointer, "inv_peer_deva", 13)) { -+ /* Get the P2P device address when receiving the P2P Invitation request frame. */ -+ rtw_p2p_get_peer_devaddr_by_invitation(dev, info, wrqu, extra); -+ } else if (_rtw_memcmp(wrqu->data.pointer, "op_ch", 5)) -+ rtw_p2p_get_op_ch(dev, info, wrqu, extra); -+ -+#ifdef CONFIG_WFD -+ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) { -+ if (_rtw_memcmp(wrqu->data.pointer, "peer_port", 9)) -+ rtw_p2p_get_peer_wfd_port(dev, info, wrqu, extra); -+ else if (_rtw_memcmp(wrqu->data.pointer, "wfd_sa", 6)) -+ rtw_p2p_get_peer_wfd_session_available(dev, info, wrqu, extra); -+ else if (_rtw_memcmp(wrqu->data.pointer, "wfd_pc", 6)) -+ rtw_p2p_get_peer_wfd_preferred_connection(dev, info, wrqu, extra); -+ } -+#endif /* CONFIG_WFD */ -+ -+#endif /* CONFIG_P2P */ -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get2(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+#ifdef CONFIG_P2P -+ -+ int length = wrqu->data.length; -+ char *buffer = (u8 *)rtw_malloc(length); -+ -+ if (buffer == NULL) { -+ ret = -ENOMEM; -+ goto bad; -+ } -+ -+ if (copy_from_user(buffer, wrqu->data.pointer, wrqu->data.length)) { -+ ret = -EFAULT; -+ goto bad; -+ } -+ -+ RTW_INFO("[%s] buffer = %s\n", __FUNCTION__, buffer); -+ -+ if (_rtw_memcmp(buffer, "wpsCM=", 6)) -+ ret = rtw_p2p_get_wps_configmethod(dev, info, wrqu, extra, &buffer[6]); -+ else if (_rtw_memcmp(buffer, "devN=", 5)) -+ ret = rtw_p2p_get_device_name(dev, info, wrqu, extra, &buffer[5]); -+ else if (_rtw_memcmp(buffer, "dev_type=", 9)) -+ ret = rtw_p2p_get_device_type(dev, info, wrqu, extra, &buffer[9]); -+ else if (_rtw_memcmp(buffer, "go_devadd=", 10)) -+ ret = rtw_p2p_get_go_device_address(dev, info, wrqu, extra, &buffer[10]); -+ else if (_rtw_memcmp(buffer, "InvProc=", 8)) -+ ret = rtw_p2p_get_invitation_procedure(dev, info, wrqu, extra, &buffer[8]); -+ else { -+ snprintf(extra, sizeof("Command not found."), "Command not found."); -+ wrqu->data.length = strlen(extra); -+ } -+ -+bad: -+ if (buffer) -+ rtw_mfree(buffer, length); -+ -+#endif /* CONFIG_P2P */ -+ -+ return ret; -+ -+} -+ -+static int rtw_cta_test_start(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ RTW_INFO("%s %s\n", __func__, extra); -+ if (!strcmp(extra, "1")) -+ padapter->in_cta_test = 1; -+ else -+ padapter->in_cta_test = 0; -+ -+ if (padapter->in_cta_test) { -+ u32 v = rtw_read32(padapter, REG_RCR); -+ v &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN); /* | RCR_ADF */ -+ rtw_write32(padapter, REG_RCR, v); -+ RTW_INFO("enable RCR_ADF\n"); -+ } else { -+ u32 v = rtw_read32(padapter, REG_RCR); -+ v |= RCR_CBSSID_DATA | RCR_CBSSID_BCN ;/* | RCR_ADF */ -+ rtw_write32(padapter, REG_RCR, v); -+ RTW_INFO("disable RCR_ADF\n"); -+ } -+ return ret; -+} -+ -+ -+extern int rtw_change_ifname(_adapter *padapter, const char *ifname); -+static int rtw_rereg_nd_name(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ _adapter *padapter = rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct rereg_nd_name_data *rereg_priv = &padapter->rereg_nd_name_priv; -+ char new_ifname[IFNAMSIZ]; -+ -+ if (rereg_priv->old_ifname[0] == 0) { -+ char *reg_ifname; -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->isprimary) -+ reg_ifname = padapter->registrypriv.ifname; -+ else -+#endif -+ reg_ifname = padapter->registrypriv.if2name; -+ -+ strncpy(rereg_priv->old_ifname, reg_ifname, IFNAMSIZ); -+ rereg_priv->old_ifname[IFNAMSIZ - 1] = 0; -+ } -+ -+ /* RTW_INFO("%s wrqu->data.length:%d\n", __FUNCTION__, wrqu->data.length); */ -+ if (wrqu->data.length > IFNAMSIZ) -+ return -EFAULT; -+ -+ if (copy_from_user(new_ifname, wrqu->data.pointer, IFNAMSIZ)) -+ return -EFAULT; -+ -+ if (0 == strcmp(rereg_priv->old_ifname, new_ifname)) -+ return ret; -+ -+ RTW_INFO("%s new_ifname:%s\n", __FUNCTION__, new_ifname); -+ rtw_set_rtnl_lock_holder(dvobj, current); -+ ret = rtw_change_ifname(padapter, new_ifname); -+ rtw_set_rtnl_lock_holder(dvobj, NULL); -+ if (0 != ret) -+ goto exit; -+ -+ if (_rtw_memcmp(rereg_priv->old_ifname, "disable%d", 9) == _TRUE) { -+ padapter->ledpriv.bRegUseLed = rereg_priv->old_bRegUseLed; -+ rtw_hal_sw_led_init(padapter); -+ /* rtw_ips_mode_req(&padapter->pwrctrlpriv, rereg_priv->old_ips_mode); */ -+ } -+ -+ strncpy(rereg_priv->old_ifname, new_ifname, IFNAMSIZ); -+ rereg_priv->old_ifname[IFNAMSIZ - 1] = 0; -+ -+ if (_rtw_memcmp(new_ifname, "disable%d", 9) == _TRUE) { -+ -+ RTW_INFO("%s disable\n", __FUNCTION__); -+ /* free network queue for Android's timming issue */ -+ rtw_free_network_queue(padapter, _TRUE); -+ -+ /* close led */ -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ rereg_priv->old_bRegUseLed = padapter->ledpriv.bRegUseLed; -+ padapter->ledpriv.bRegUseLed = _FALSE; -+ rtw_hal_sw_led_deinit(padapter); -+ -+ /* the interface is being "disabled", we can do deeper IPS */ -+ /* rereg_priv->old_ips_mode = rtw_get_ips_mode_req(&padapter->pwrctrlpriv); */ -+ /* rtw_ips_mode_req(&padapter->pwrctrlpriv, IPS_NORMAL); */ -+ } -+exit: -+ return ret; -+ -+} -+ -+#ifdef CONFIG_IOL -+#include -+#endif -+ -+#ifdef DBG_CMD_QUEUE -+u8 dump_cmd_id = 0; -+#endif -+static int rtw_dbg_port(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _irqL irqL; -+ int ret = 0; -+ u8 major_cmd, minor_cmd; -+ u16 arg; -+ u32 extra_arg, *pdata, val32; -+ struct sta_info *psta; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ -+ pdata = (u32 *)&wrqu->data; -+ -+ val32 = *pdata; -+ arg = (u16)(val32 & 0x0000ffff); -+ major_cmd = (u8)(val32 >> 24); -+ minor_cmd = (u8)((val32 >> 16) & 0x00ff); -+ -+ extra_arg = *(pdata + 1); -+ -+ switch (major_cmd) { -+ case 0x70: /* read_reg */ -+ switch (minor_cmd) { -+ case 1: -+ RTW_INFO("rtw_read8(0x%x)=0x%02x\n", arg, rtw_read8(padapter, arg)); -+ break; -+ case 2: -+ RTW_INFO("rtw_read16(0x%x)=0x%04x\n", arg, rtw_read16(padapter, arg)); -+ break; -+ case 4: -+ RTW_INFO("rtw_read32(0x%x)=0x%08x\n", arg, rtw_read32(padapter, arg)); -+ break; -+ } -+ break; -+ case 0x71: /* write_reg */ -+ switch (minor_cmd) { -+ case 1: -+ rtw_write8(padapter, arg, extra_arg); -+ RTW_INFO("rtw_write8(0x%x)=0x%02x\n", arg, rtw_read8(padapter, arg)); -+ break; -+ case 2: -+ rtw_write16(padapter, arg, extra_arg); -+ RTW_INFO("rtw_write16(0x%x)=0x%04x\n", arg, rtw_read16(padapter, arg)); -+ break; -+ case 4: -+ rtw_write32(padapter, arg, extra_arg); -+ RTW_INFO("rtw_write32(0x%x)=0x%08x\n", arg, rtw_read32(padapter, arg)); -+ break; -+ } -+ break; -+ case 0x72: /* read_bb */ -+ RTW_INFO("read_bbreg(0x%x)=0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff)); -+ break; -+ case 0x73: /* write_bb */ -+ rtw_hal_write_bbreg(padapter, arg, 0xffffffff, extra_arg); -+ RTW_INFO("write_bbreg(0x%x)=0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff)); -+ break; -+ case 0x74: /* read_rf */ -+ RTW_INFO("read RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n", minor_cmd, arg, rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff)); -+ break; -+ case 0x75: /* write_rf */ -+ rtw_hal_write_rfreg(padapter, minor_cmd, arg, 0xffffffff, extra_arg); -+ RTW_INFO("write RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n", minor_cmd, arg, rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff)); -+ break; -+ -+ case 0x76: -+ switch (minor_cmd) { -+ case 0x00: /* normal mode, */ -+ padapter->recvpriv.is_signal_dbg = 0; -+ break; -+ case 0x01: /* dbg mode */ -+ padapter->recvpriv.is_signal_dbg = 1; -+ extra_arg = extra_arg > 100 ? 100 : extra_arg; -+ padapter->recvpriv.signal_strength_dbg = extra_arg; -+ break; -+ } -+ break; -+ case 0x78: /* IOL test */ -+ switch (minor_cmd) { -+ #ifdef CONFIG_IOL -+ case 0x04: { /* LLT table initialization test */ -+ u8 page_boundary = 0xf9; -+ { -+ struct xmit_frame *xmit_frame; -+ -+ xmit_frame = rtw_IOL_accquire_xmit_frame(padapter); -+ if (xmit_frame == NULL) { -+ ret = -ENOMEM; -+ break; -+ } -+ -+ rtw_IOL_append_LLT_cmd(xmit_frame, page_boundary); -+ -+ -+ if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 500, 0)) -+ ret = -EPERM; -+ } -+ } -+ break; -+ case 0x05: { /* blink LED test */ -+ u16 reg = 0x4c; -+ u32 blink_num = 50; -+ u32 blink_delay_ms = 200; -+ int i; -+ -+ { -+ struct xmit_frame *xmit_frame; -+ -+ xmit_frame = rtw_IOL_accquire_xmit_frame(padapter); -+ if (xmit_frame == NULL) { -+ ret = -ENOMEM; -+ break; -+ } -+ -+ for (i = 0; i < blink_num; i++) { -+ #ifdef CONFIG_IOL_NEW_GENERATION -+ rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x00, 0xff); -+ rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms); -+ rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x08, 0xff); -+ rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms); -+ #else -+ rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x00); -+ rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms); -+ rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x08); -+ rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms); -+ #endif -+ } -+ if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, (blink_delay_ms * blink_num * 2) + 200, 0)) -+ ret = -EPERM; -+ } -+ } -+ break; -+ -+ case 0x06: { /* continuous wirte byte test */ -+ u16 reg = arg; -+ u16 start_value = 0; -+ u32 write_num = extra_arg; -+ int i; -+ u8 final; -+ -+ { -+ struct xmit_frame *xmit_frame; -+ -+ xmit_frame = rtw_IOL_accquire_xmit_frame(padapter); -+ if (xmit_frame == NULL) { -+ ret = -ENOMEM; -+ break; -+ } -+ -+ for (i = 0; i < write_num; i++) { -+ #ifdef CONFIG_IOL_NEW_GENERATION -+ rtw_IOL_append_WB_cmd(xmit_frame, reg, i + start_value, 0xFF); -+ #else -+ rtw_IOL_append_WB_cmd(xmit_frame, reg, i + start_value); -+ #endif -+ } -+ if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000, 0)) -+ ret = -EPERM; -+ } -+ -+ final = rtw_read8(padapter, reg); -+ if (start_value + write_num - 1 == final) -+ RTW_INFO("continuous IOL_CMD_WB_REG to 0x%x %u times Success, start:%u, final:%u\n", reg, write_num, start_value, final); -+ else -+ RTW_INFO("continuous IOL_CMD_WB_REG to 0x%x %u times Fail, start:%u, final:%u\n", reg, write_num, start_value, final); -+ } -+ break; -+ -+ case 0x07: { /* continuous wirte word test */ -+ u16 reg = arg; -+ u16 start_value = 200; -+ u32 write_num = extra_arg; -+ -+ int i; -+ u16 final; -+ -+ { -+ struct xmit_frame *xmit_frame; -+ -+ xmit_frame = rtw_IOL_accquire_xmit_frame(padapter); -+ if (xmit_frame == NULL) { -+ ret = -ENOMEM; -+ break; -+ } -+ -+ for (i = 0; i < write_num; i++) { -+ #ifdef CONFIG_IOL_NEW_GENERATION -+ rtw_IOL_append_WW_cmd(xmit_frame, reg, i + start_value, 0xFFFF); -+ #else -+ rtw_IOL_append_WW_cmd(xmit_frame, reg, i + start_value); -+ #endif -+ } -+ if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000, 0)) -+ ret = -EPERM; -+ } -+ -+ final = rtw_read16(padapter, reg); -+ if (start_value + write_num - 1 == final) -+ RTW_INFO("continuous IOL_CMD_WW_REG to 0x%x %u times Success, start:%u, final:%u\n", reg, write_num, start_value, final); -+ else -+ RTW_INFO("continuous IOL_CMD_WW_REG to 0x%x %u times Fail, start:%u, final:%u\n", reg, write_num, start_value, final); -+ } -+ break; -+ -+ case 0x08: { /* continuous wirte dword test */ -+ u16 reg = arg; -+ u32 start_value = 0x110000c7; -+ u32 write_num = extra_arg; -+ -+ int i; -+ u32 final; -+ -+ { -+ struct xmit_frame *xmit_frame; -+ -+ xmit_frame = rtw_IOL_accquire_xmit_frame(padapter); -+ if (xmit_frame == NULL) { -+ ret = -ENOMEM; -+ break; -+ } -+ -+ for (i = 0; i < write_num; i++) { -+ #ifdef CONFIG_IOL_NEW_GENERATION -+ rtw_IOL_append_WD_cmd(xmit_frame, reg, i + start_value, 0xFFFFFFFF); -+ #else -+ rtw_IOL_append_WD_cmd(xmit_frame, reg, i + start_value); -+ #endif -+ } -+ if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000, 0)) -+ ret = -EPERM; -+ -+ } -+ -+ final = rtw_read32(padapter, reg); -+ if (start_value + write_num - 1 == final) -+ RTW_INFO("continuous IOL_CMD_WD_REG to 0x%x %u times Success, start:%u, final:%u\n", reg, write_num, start_value, final); -+ else -+ RTW_INFO("continuous IOL_CMD_WD_REG to 0x%x %u times Fail, start:%u, final:%u\n", reg, write_num, start_value, final); -+ } -+ break; -+ #endif /* CONFIG_IOL */ -+ } -+ break; -+ case 0x79: { -+ /* -+ * dbg 0x79000000 [value], set RESP_TXAGC to + value, value:0~15 -+ * dbg 0x79010000 [value], set RESP_TXAGC to - value, value:0~15 -+ */ -+ u8 value = extra_arg & 0x0f; -+ u8 sign = minor_cmd; -+ u16 write_value = 0; -+ -+ RTW_INFO("%s set RESP_TXAGC to %s %u\n", __func__, sign ? "minus" : "plus", value); -+ -+ if (sign) -+ value = value | 0x10; -+ -+ write_value = value | (value << 5); -+ rtw_write16(padapter, 0x6d9, write_value); -+ } -+ break; -+ case 0x7a: -+ receive_disconnect(padapter, pmlmeinfo->network.MacAddress -+ , WLAN_REASON_EXPIRATION_CHK, _FALSE); -+ break; -+ case 0x7F: -+ switch (minor_cmd) { -+ case 0x0: -+ RTW_INFO("fwstate=0x%x\n", get_fwstate(pmlmepriv)); -+ break; -+ case 0x01: -+ RTW_INFO("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", -+ psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, -+ psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus); -+ break; -+ case 0x02: -+ RTW_INFO("pmlmeinfo->state=0x%x\n", pmlmeinfo->state); -+ RTW_INFO("DrvBcnEarly=%d\n", pmlmeext->DrvBcnEarly); -+ RTW_INFO("DrvBcnTimeOut=%d\n", pmlmeext->DrvBcnTimeOut); -+ break; -+ case 0x03: -+ RTW_INFO("qos_option=%d\n", pmlmepriv->qospriv.qos_option); -+#ifdef CONFIG_80211N_HT -+ RTW_INFO("ht_option=%d\n", pmlmepriv->htpriv.ht_option); -+#endif /* CONFIG_80211N_HT */ -+ break; -+ case 0x04: -+ RTW_INFO("cur_ch=%d\n", pmlmeext->cur_channel); -+ RTW_INFO("cur_bw=%d\n", pmlmeext->cur_bwmode); -+ RTW_INFO("cur_ch_off=%d\n", pmlmeext->cur_ch_offset); -+ -+ RTW_INFO("oper_ch=%d\n", rtw_get_oper_ch(padapter)); -+ RTW_INFO("oper_bw=%d\n", rtw_get_oper_bw(padapter)); -+ RTW_INFO("oper_ch_offet=%d\n", rtw_get_oper_choffset(padapter)); -+ -+ break; -+ case 0x05: -+ psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); -+ if (psta) { -+ RTW_INFO("SSID=%s\n", cur_network->network.Ssid.Ssid); -+ RTW_INFO("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ RTW_INFO("cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ RTW_INFO("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); -+ RTW_INFO("state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); -+#ifdef CONFIG_80211N_HT -+ RTW_INFO("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ RTW_INFO("bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); -+ RTW_INFO("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ RTW_INFO("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); -+#endif /* CONFIG_80211N_HT */ -+ -+ sta_rx_reorder_ctl_dump(RTW_DBGDUMP, psta); -+ } else -+ RTW_INFO("can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); -+ break; -+ case 0x06: { -+ } -+ break; -+ case 0x07: -+ RTW_INFO("bSurpriseRemoved=%s, bDriverStopped=%s\n" -+ , rtw_is_surprise_removed(padapter) ? "True" : "False" -+ , rtw_is_drv_stopped(padapter) ? "True" : "False"); -+ break; -+ case 0x08: { -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ RTW_INFO("free_xmitbuf_cnt=%d, free_xmitframe_cnt=%d" -+ ", free_xmit_extbuf_cnt=%d, free_xframe_ext_cnt=%d" -+ ", free_recvframe_cnt=%d\n", -+ pxmitpriv->free_xmitbuf_cnt, pxmitpriv->free_xmitframe_cnt, -+ pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xframe_ext_cnt, -+ precvpriv->free_recvframe_cnt); -+#ifdef CONFIG_USB_HCI -+ RTW_INFO("rx_urb_pending_cn=%d\n", ATOMIC_READ(&(precvpriv->rx_pending_cnt))); -+#endif -+ } -+ break; -+ case 0x09: { -+ int i; -+ _list *plist, *phead; -+ -+#ifdef CONFIG_AP_MODE -+ RTW_INFO("sta_dz_bitmap=0x%x, tim_bitmap=0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); -+#endif -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for (i = 0; i < NUM_STA; i++) { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ plist = get_next(plist); -+ -+ if (extra_arg == psta->aid) { -+ RTW_INFO("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ RTW_INFO("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); -+ RTW_INFO("state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); -+#ifdef CONFIG_80211N_HT -+ RTW_INFO("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ RTW_INFO("bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, -+ psta->htpriv.sgi_40m); -+ RTW_INFO("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ RTW_INFO("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_AP_MODE -+ RTW_INFO("capability=0x%x\n", psta->capability); -+ RTW_INFO("flags=0x%x\n", psta->flags); -+ RTW_INFO("wpa_psk=0x%x\n", psta->wpa_psk); -+ RTW_INFO("wpa2_group_cipher=0x%x\n", psta->wpa2_group_cipher); -+ RTW_INFO("wpa2_pairwise_cipher=0x%x\n", psta->wpa2_pairwise_cipher); -+ RTW_INFO("qos_info=0x%x\n", psta->qos_info); -+#endif -+ RTW_INFO("dot118021XPrivacy=0x%x\n", psta->dot118021XPrivacy); -+ -+ sta_rx_reorder_ctl_dump(RTW_DBGDUMP, psta); -+ } -+ -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ } -+ break; -+ -+ case 0x0b: { /* Enable=1, Disable=0 driver control vrtl_carrier_sense. */ -+ /* u8 driver_vcs_en; */ /* Enable=1, Disable=0 driver control vrtl_carrier_sense. */ -+ /* u8 driver_vcs_type; */ /* force 0:disable VCS, 1:RTS-CTS, 2:CTS-to-self when vcs_en=1. */ -+ -+ if (arg == 0) { -+ RTW_INFO("disable driver ctrl vcs\n"); -+ padapter->driver_vcs_en = 0; -+ } else if (arg == 1) { -+ RTW_INFO("enable driver ctrl vcs = %d\n", extra_arg); -+ padapter->driver_vcs_en = 1; -+ -+ if (extra_arg > 2) -+ padapter->driver_vcs_type = 1; -+ else -+ padapter->driver_vcs_type = extra_arg; -+ } -+ } -+ break; -+ case 0x0c: { /* dump rx/tx packet */ -+ if (arg == 0) { -+ RTW_INFO("dump rx packet (%d)\n", extra_arg); -+ /* pHalData->bDumpRxPkt =extra_arg; */ -+ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_RXPKT, &(extra_arg)); -+ } else if (arg == 1) { -+ RTW_INFO("dump tx packet (%d)\n", extra_arg); -+ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_TXPKT, &(extra_arg)); -+ } -+ } -+ break; -+ case 0x0e: { -+ if (arg == 0) { -+ RTW_INFO("disable driver ctrl rx_ampdu_factor\n"); -+ padapter->driver_rx_ampdu_factor = 0xFF; -+ } else if (arg == 1) { -+ -+ RTW_INFO("enable driver ctrl rx_ampdu_factor = %d\n", extra_arg); -+ -+ if (extra_arg > 0x03) -+ padapter->driver_rx_ampdu_factor = 0xFF; -+ else -+ padapter->driver_rx_ampdu_factor = extra_arg; -+ } -+ } -+ break; -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ case 0x0f: { -+ if (extra_arg == 0) { -+ RTW_INFO("###### silent reset test.......#####\n"); -+ rtw_hal_sreset_reset(padapter); -+ } else { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ psrtpriv->dbg_trigger_point = extra_arg; -+ } -+ -+ } -+ break; -+ case 0x15: { -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ RTW_INFO("==>silent resete cnts:%d\n", pwrpriv->ips_enter_cnts); -+ } -+ break; -+ -+ #endif -+ -+ case 0x10: /* driver version display */ -+ dump_drv_version(RTW_DBGDUMP); -+ break; -+ case 0x11: { /* dump linked status */ -+ int pre_mode; -+ pre_mode = padapter->bLinkInfoDump; -+ /* linked_info_dump(padapter,extra_arg); */ -+ if (extra_arg == 1 || (extra_arg == 0 && pre_mode == 1)) /* not consider pwr_saving 0: */ -+ padapter->bLinkInfoDump = extra_arg; -+ -+ else if ((extra_arg == 2) || (extra_arg == 0 && pre_mode == 2)) { /* consider power_saving */ -+ /* RTW_INFO("linked_info_dump =%s\n", (padapter->bLinkInfoDump)?"enable":"disable") */ -+ linked_info_dump(padapter, extra_arg); -+ } -+ -+ -+ -+ } -+ break; -+#ifdef CONFIG_80211N_HT -+ case 0x12: { /* set rx_stbc */ -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ /* 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, 0x3: enable both 2.4g and 5g */ -+ /* default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ */ -+ if (pregpriv && (extra_arg == 0 || extra_arg == 1 || extra_arg == 2 || extra_arg == 3)) { -+ pregpriv->rx_stbc = extra_arg; -+ RTW_INFO("set rx_stbc=%d\n", pregpriv->rx_stbc); -+ } else -+ RTW_INFO("get rx_stbc=%d\n", pregpriv->rx_stbc); -+ -+ } -+ break; -+ case 0x13: { /* set ampdu_enable */ -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ /* 0: disable, 0x1:enable */ -+ if (pregpriv && extra_arg < 2) { -+ pregpriv->ampdu_enable = extra_arg; -+ RTW_INFO("set ampdu_enable=%d\n", pregpriv->ampdu_enable); -+ } else -+ RTW_INFO("get ampdu_enable=%d\n", pregpriv->ampdu_enable); -+ -+ } -+ break; -+#endif -+ case 0x14: { /* get wifi_spec */ -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ RTW_INFO("get wifi_spec=%d\n", pregpriv->wifi_spec); -+ -+ } -+ break; -+ case 0x16: { -+ if (arg == 0xff) -+ rtw_odm_dbg_comp_msg(RTW_DBGDUMP, padapter); -+ else { -+ u64 dbg_comp = (u64)extra_arg; -+ rtw_odm_dbg_comp_set(padapter, dbg_comp); -+ } -+ } -+ break; -+#ifdef DBG_FIXED_CHAN -+ case 0x17: { -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ printk("===> Fixed channel to %d\n", extra_arg); -+ pmlmeext->fixed_chan = extra_arg; -+ -+ } -+ break; -+#endif -+#ifdef CONFIG_80211N_HT -+ case 0x19: { -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ /* extra_arg : */ -+ /* BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, */ -+ /* BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx */ -+ if (arg == 0) { -+ RTW_INFO("driver disable LDPC\n"); -+ pregistrypriv->ldpc_cap = 0x00; -+ } else if (arg == 1) { -+ RTW_INFO("driver set LDPC cap = 0x%x\n", extra_arg); -+ pregistrypriv->ldpc_cap = (u8)(extra_arg & 0x33); -+ } -+ } -+ break; -+ case 0x1a: { -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ /* extra_arg : */ -+ /* BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, */ -+ /* BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx */ -+ if (arg == 0) { -+ RTW_INFO("driver disable STBC\n"); -+ pregistrypriv->stbc_cap = 0x00; -+ } else if (arg == 1) { -+ RTW_INFO("driver set STBC cap = 0x%x\n", extra_arg); -+ pregistrypriv->stbc_cap = (u8)(extra_arg & 0x33); -+ } -+ } -+ break; -+#endif /* CONFIG_80211N_HT */ -+ case 0x1b: { -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ if (arg == 0) { -+ RTW_INFO("disable driver ctrl max_rx_rate, reset to default_rate_set\n"); -+ init_mlme_default_rate_set(padapter); -+#ifdef CONFIG_80211N_HT -+ pregistrypriv->ht_enable = (u8)rtw_ht_enable; -+#endif /* CONFIG_80211N_HT */ -+ } else if (arg == 1) { -+ -+ int i; -+ u8 max_rx_rate; -+ -+ RTW_INFO("enable driver ctrl max_rx_rate = 0x%x\n", extra_arg); -+ -+ max_rx_rate = (u8)extra_arg; -+ -+ if (max_rx_rate < 0xc) { /* max_rx_rate < MSC0->B or G -> disable HT */ -+#ifdef CONFIG_80211N_HT -+ pregistrypriv->ht_enable = 0; -+#endif /* CONFIG_80211N_HT */ -+ for (i = 0; i < NumRates; i++) { -+ if (pmlmeext->datarate[i] > max_rx_rate) -+ pmlmeext->datarate[i] = 0xff; -+ } -+ -+ } -+#ifdef CONFIG_80211N_HT -+ else if (max_rx_rate < 0x1c) { /* mcs0~mcs15 */ -+ u32 mcs_bitmap = 0x0; -+ -+ for (i = 0; i < ((max_rx_rate + 1) - 0xc); i++) -+ mcs_bitmap |= BIT(i); -+ -+ set_mcs_rate_by_mask(pmlmeext->default_supported_mcs_set, mcs_bitmap); -+ } -+#endif /* CONFIG_80211N_HT */ -+ } -+ } -+ break; -+ case 0x1c: { /* enable/disable driver control AMPDU Density for peer sta's rx */ -+ if (arg == 0) { -+ RTW_INFO("disable driver ctrl ampdu density\n"); -+ padapter->driver_ampdu_spacing = 0xFF; -+ } else if (arg == 1) { -+ -+ RTW_INFO("enable driver ctrl ampdu density = %d\n", extra_arg); -+ -+ if (extra_arg > 0x07) -+ padapter->driver_ampdu_spacing = 0xFF; -+ else -+ padapter->driver_ampdu_spacing = extra_arg; -+ } -+ } -+ break; -+#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -+ case 0x1e: { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 chan = rtw_get_oper_ch(padapter); -+ RTW_INFO("===========================================\n"); -+ ODM_InbandNoise_Monitor(pDM_Odm, _TRUE, 0x1e, 100); -+ RTW_INFO("channel(%d),noise_a = %d, noise_b = %d , noise_all:%d\n", -+ chan, pDM_Odm->noise_level.noise[ODM_RF_PATH_A], -+ pDM_Odm->noise_level.noise[ODM_RF_PATH_B], -+ pDM_Odm->noise_level.noise_all); -+ RTW_INFO("===========================================\n"); -+ -+ } -+ break; -+#endif -+ -+ -+#if defined(CONFIG_SDIO_HCI) && defined(CONFIG_SDIO_INDIRECT_ACCESS) && defined(DBG_SDIO_INDIRECT_ACCESS) -+ case 0x1f: -+ { -+ int i, j = 0, test_cnts = 0; -+ static u8 test_code = 0x5A; -+ static u32 data_misatch_cnt = 0, d_acc_err_cnt = 0; -+ -+ u32 d_data, i_data; -+ u32 imr; -+ -+ test_cnts = extra_arg; -+ for (i = 0; i < test_cnts; i++) { -+ if (RTW_CANNOT_IO(padapter)) -+ break; -+ -+ rtw_write8(padapter, 0x07, test_code); -+ -+ d_data = rtw_read32(padapter, 0x04); -+ imr = rtw_read32(padapter, 0x10250014); -+ rtw_write32(padapter, 0x10250014, 0); -+ rtw_msleep_os(50); -+ -+ i_data = rtw_sd_iread32(padapter, 0x04); -+ -+ rtw_write32(padapter, 0x10250014, imr); -+ -+ if (d_data != i_data) { -+ data_misatch_cnt++; -+ RTW_ERR("d_data :0x%08x, i_data : 0x%08x\n", d_data, i_data); -+ } -+ -+ if (test_code != (i_data >> 24)) { -+ d_acc_err_cnt++; -+ rtw_write8(padapter, 0x07, 0xAA); -+ RTW_ERR("test_code :0x%02x, i_data : 0x%08x\n", test_code, i_data); -+ } -+ if ((j++) == 100) { -+ rtw_msleep_os(2000); -+ RTW_INFO(" Indirect access testing..........%d/%d\n", i, test_cnts); -+ j = 0; -+ } -+ -+ test_code = ~test_code; -+ rtw_msleep_os(50); -+ } -+ RTW_INFO("========Indirect access test=========\n"); -+ RTW_INFO(" test_cnts = %d\n", test_cnts); -+ RTW_INFO(" direct & indirect read32 data missatch cnts = %d\n", data_misatch_cnt); -+ RTW_INFO(" indirect rdata is not equal to wdata cnts = %d\n", d_acc_err_cnt); -+ RTW_INFO("========Indirect access test=========\n\n"); -+ data_misatch_cnt = d_acc_err_cnt = 0; -+ -+ } -+ break; -+#endif -+ -+ case 0x23: { -+ RTW_INFO("turn %s the bNotifyChannelChange Variable\n", (extra_arg == 1) ? "on" : "off"); -+ padapter->bNotifyChannelChange = extra_arg; -+ break; -+ } -+ case 0x24: { -+#ifdef CONFIG_P2P -+ RTW_INFO("turn %s the bShowGetP2PState Variable\n", (extra_arg == 1) ? "on" : "off"); -+ padapter->bShowGetP2PState = extra_arg; -+#endif /* CONFIG_P2P */ -+ break; -+ } -+#ifdef CONFIG_GPIO_API -+ case 0x25: { /* Get GPIO register */ -+ /* -+ * dbg 0x7f250000 [gpio_num], Get gpio value, gpio_num:0~7 -+ */ -+ -+ u8 value; -+ RTW_INFO("Read GPIO Value extra_arg = %d\n", extra_arg); -+ value = rtw_hal_get_gpio(padapter, extra_arg); -+ RTW_INFO("Read GPIO Value = %d\n", value); -+ break; -+ } -+ case 0x26: { /* Set GPIO direction */ -+ -+ /* dbg 0x7f26000x [y], Set gpio direction, -+ * x: gpio_num,4~7 y: indicate direction, 0~1 -+ */ -+ -+ int value; -+ RTW_INFO("Set GPIO Direction! arg = %d ,extra_arg=%d\n", arg , extra_arg); -+ value = rtw_hal_config_gpio(padapter, arg, extra_arg); -+ RTW_INFO("Set GPIO Direction %s\n", (value == -1) ? "Fail!!!" : "Success"); -+ break; -+ } -+ case 0x27: { /* Set GPIO output direction value */ -+ /* -+ * dbg 0x7f27000x [y], Set gpio output direction value, -+ * x: gpio_num,4~7 y: indicate direction, 0~1 -+ */ -+ -+ int value; -+ RTW_INFO("Set GPIO Value! arg = %d ,extra_arg=%d\n", arg , extra_arg); -+ value = rtw_hal_set_gpio_output_value(padapter, arg, extra_arg); -+ RTW_INFO("Set GPIO Value %s\n", (value == -1) ? "Fail!!!" : "Success"); -+ break; -+ } -+#endif -+#ifdef DBG_CMD_QUEUE -+ case 0x28: { -+ dump_cmd_id = extra_arg; -+ RTW_INFO("dump_cmd_id:%d\n", dump_cmd_id); -+ } -+ break; -+#endif /* DBG_CMD_QUEUE */ -+ case 0xaa: { -+ if ((extra_arg & 0x7F) > 0x3F) -+ extra_arg = 0xFF; -+ RTW_INFO("chang data rate to :0x%02x\n", extra_arg); -+ padapter->fix_rate = extra_arg; -+ } -+ break; -+ case 0xdd: { /* registers dump , 0 for mac reg,1 for bb reg, 2 for rf reg */ -+ if (extra_arg == 0) -+ mac_reg_dump(RTW_DBGDUMP, padapter); -+ else if (extra_arg == 1) -+ bb_reg_dump(RTW_DBGDUMP, padapter); -+ else if (extra_arg == 2) -+ rf_reg_dump(RTW_DBGDUMP, padapter); -+ } -+ break; -+ -+ case 0xee: { -+ RTW_INFO(" === please control /proc to trun on/off PHYDM func ===\n"); -+ } -+ break; -+ -+ case 0xfd: -+ rtw_write8(padapter, 0xc50, arg); -+ RTW_INFO("wr(0xc50)=0x%x\n", rtw_read8(padapter, 0xc50)); -+ rtw_write8(padapter, 0xc58, arg); -+ RTW_INFO("wr(0xc58)=0x%x\n", rtw_read8(padapter, 0xc58)); -+ break; -+ case 0xfe: -+ RTW_INFO("rd(0xc50)=0x%x\n", rtw_read8(padapter, 0xc50)); -+ RTW_INFO("rd(0xc58)=0x%x\n", rtw_read8(padapter, 0xc58)); -+ break; -+ case 0xff: { -+ RTW_INFO("dbg(0x210)=0x%x\n", rtw_read32(padapter, 0x210)); -+ RTW_INFO("dbg(0x608)=0x%x\n", rtw_read32(padapter, 0x608)); -+ RTW_INFO("dbg(0x280)=0x%x\n", rtw_read32(padapter, 0x280)); -+ RTW_INFO("dbg(0x284)=0x%x\n", rtw_read32(padapter, 0x284)); -+ RTW_INFO("dbg(0x288)=0x%x\n", rtw_read32(padapter, 0x288)); -+ -+ RTW_INFO("dbg(0x664)=0x%x\n", rtw_read32(padapter, 0x664)); -+ -+ -+ RTW_INFO("\n"); -+ -+ RTW_INFO("dbg(0x430)=0x%x\n", rtw_read32(padapter, 0x430)); -+ RTW_INFO("dbg(0x438)=0x%x\n", rtw_read32(padapter, 0x438)); -+ -+ RTW_INFO("dbg(0x440)=0x%x\n", rtw_read32(padapter, 0x440)); -+ -+ RTW_INFO("dbg(0x458)=0x%x\n", rtw_read32(padapter, 0x458)); -+ -+ RTW_INFO("dbg(0x484)=0x%x\n", rtw_read32(padapter, 0x484)); -+ RTW_INFO("dbg(0x488)=0x%x\n", rtw_read32(padapter, 0x488)); -+ -+ RTW_INFO("dbg(0x444)=0x%x\n", rtw_read32(padapter, 0x444)); -+ RTW_INFO("dbg(0x448)=0x%x\n", rtw_read32(padapter, 0x448)); -+ RTW_INFO("dbg(0x44c)=0x%x\n", rtw_read32(padapter, 0x44c)); -+ RTW_INFO("dbg(0x450)=0x%x\n", rtw_read32(padapter, 0x450)); -+ } -+ break; -+ } -+ break; -+ default: -+ RTW_INFO("error dbg cmd!\n"); -+ break; -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int wpa_set_param(struct net_device *dev, u8 name, u32 value) -+{ -+ uint ret = 0; -+ u32 flags; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ switch (name) { -+ case IEEE_PARAM_WPA_ENABLED: -+ -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; /* 802.1x */ -+ -+ /* ret = ieee80211_wpa_enable(ieee, value); */ -+ -+ switch ((value) & 0xff) { -+ case 1: /* WPA */ -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPAPSK; /* WPA_PSK */ -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case 2: /* WPA2 */ -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK; /* WPA2_PSK */ -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ } -+ -+ -+ break; -+ -+ case IEEE_PARAM_TKIP_COUNTERMEASURES: -+ /* ieee->tkip_countermeasures=value; */ -+ break; -+ -+ case IEEE_PARAM_DROP_UNENCRYPTED: { -+ /* HACK: -+ * -+ * wpa_supplicant calls set_wpa_enabled when the driver -+ * is loaded and unloaded, regardless of if WPA is being -+ * used. No other calls are made which can be used to -+ * determine if encryption will be used or not prior to -+ * association being expected. If encryption is not being -+ * used, drop_unencrypted is set to false, else true -- we -+ * can use this to determine if the CAP_PRIVACY_ON bit should -+ * be set. -+ */ -+ -+#if 0 -+ struct ieee80211_security sec = { -+ .flags = SEC_ENABLED, -+ .enabled = value, -+ }; -+ ieee->drop_unencrypted = value; -+ /* We only change SEC_LEVEL for open mode. Others -+ * are set by ipw_wpa_set_encryption. -+ */ -+ if (!value) { -+ sec.flags |= SEC_LEVEL; -+ sec.level = SEC_LEVEL_0; -+ } else { -+ sec.flags |= SEC_LEVEL; -+ sec.level = SEC_LEVEL_1; -+ } -+ if (ieee->set_security) -+ ieee->set_security(ieee->dev, &sec); -+#endif -+ break; -+ -+ } -+ case IEEE_PARAM_PRIVACY_INVOKED: -+ -+ /* ieee->privacy_invoked=value; */ -+ -+ break; -+ -+ case IEEE_PARAM_AUTH_ALGS: -+ -+ ret = wpa_set_auth_algs(dev, value); -+ -+ break; -+ -+ case IEEE_PARAM_IEEE_802_1X: -+ -+ /* ieee->ieee802_1x=value; */ -+ -+ break; -+ -+ case IEEE_PARAM_WPAX_SELECT: -+ -+ /* added for WPA2 mixed mode */ -+ /*RTW_WARN("------------------------>wpax value = %x\n", value);*/ -+ /* -+ spin_lock_irqsave(&ieee->wpax_suitlist_lock,flags); -+ ieee->wpax_type_set = 1; -+ ieee->wpax_type_notify = value; -+ spin_unlock_irqrestore(&ieee->wpax_suitlist_lock,flags); -+ */ -+ -+ break; -+ -+ default: -+ -+ -+ -+ ret = -EOPNOTSUPP; -+ -+ -+ break; -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int wpa_mlme(struct net_device *dev, u32 command, u32 reason) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ switch (command) { -+ case IEEE_MLME_STA_DEAUTH: -+ -+ if (!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ -+ break; -+ -+ case IEEE_MLME_STA_DISASSOC: -+ -+ if (!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ -+ break; -+ -+ default: -+ ret = -EOPNOTSUPP; -+ break; -+ } -+ -+ return ret; -+ -+} -+ -+static int wpa_supplicant_ioctl(struct net_device *dev, struct iw_point *p) -+{ -+ struct ieee_param *param; -+ uint ret = 0; -+ -+ /* down(&ieee->wx_sem); */ -+ -+ if (p->length < sizeof(struct ieee_param) || !p->pointer) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ param = (struct ieee_param *)rtw_malloc(p->length); -+ if (param == NULL) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ if (copy_from_user(param, p->pointer, p->length)) { -+ rtw_mfree((u8 *)param, p->length); -+ ret = -EFAULT; -+ goto out; -+ } -+ -+ switch (param->cmd) { -+ -+ case IEEE_CMD_SET_WPA_PARAM: -+ ret = wpa_set_param(dev, param->u.wpa_param.name, param->u.wpa_param.value); -+ break; -+ -+ case IEEE_CMD_SET_WPA_IE: -+ /* ret = wpa_set_wpa_ie(dev, param, p->length); */ -+ ret = rtw_set_wpa_ie((_adapter *)rtw_netdev_priv(dev), (char *)param->u.wpa_ie.data, (u16)param->u.wpa_ie.len); -+ break; -+ -+ case IEEE_CMD_SET_ENCRYPTION: -+ ret = wpa_set_encryption(dev, param, p->length); -+ break; -+ -+ case IEEE_CMD_MLME: -+ ret = wpa_mlme(dev, param->u.mlme.command, param->u.mlme.reason_code); -+ break; -+ -+ default: -+ RTW_INFO("Unknown WPA supplicant request: %d\n", param->cmd); -+ ret = -EOPNOTSUPP; -+ break; -+ -+ } -+ -+ if (ret == 0 && copy_to_user(p->pointer, param, p->length)) -+ ret = -EFAULT; -+ -+ rtw_mfree((u8 *)param, p->length); -+ -+out: -+ -+ /* up(&ieee->wx_sem); */ -+ -+ return ret; -+ -+} -+ -+#ifdef CONFIG_AP_MODE -+static int rtw_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len, wep_total_len; -+ NDIS_802_11_WEP *pwep = NULL; -+ struct sta_info *psta = NULL, *pbcmc_sta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ /* sizeof(struct ieee_param) = 64 bytes; */ -+ /* if (param_len != (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) */ -+ if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) { -+ if (param->u.crypt.idx >= WEP_KEYS -+#ifdef CONFIG_IEEE80211W -+ && param->u.crypt.idx > BIP_MAX_KEYID -+#endif /* CONFIG_IEEE80211W */ -+ ) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } else { -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (!psta) { -+ /* ret = -EINVAL; */ -+ RTW_INFO("rtw_set_encryption(), sta has already been removed or never been added\n"); -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "none") == 0 && (psta == NULL)) { -+ /* todo:clear default encryption keys */ -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ -+ RTW_INFO("clear default encryption keys, keyid=%d\n", param->u.crypt.idx); -+ -+ goto exit; -+ } -+ -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta == NULL)) { -+ RTW_INFO("r871x_set_encryption, crypt.alg = WEP\n"); -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ RTW_INFO("r871x_set_encryption, wep_key_idx=%d, len=%d\n", wep_key_idx, wep_key_len); -+ -+ if ((wep_key_idx >= WEP_KEYS) || (wep_key_len <= 0)) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ -+ if (wep_key_len > 0) { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); -+ pwep = (NDIS_802_11_WEP *)rtw_malloc(wep_total_len); -+ if (pwep == NULL) { -+ RTW_INFO(" r871x_set_encryption: pwep allocate fail !!!\n"); -+ goto exit; -+ } -+ -+ _rtw_memset(pwep, 0, wep_total_len); -+ -+ pwep->KeyLength = wep_key_len; -+ pwep->Length = wep_total_len; -+ -+ } -+ -+ pwep->KeyIndex = wep_key_idx; -+ -+ _rtw_memcpy(pwep->KeyMaterial, param->u.crypt.key, pwep->KeyLength); -+ -+ if (param->u.crypt.set_tx) { -+ RTW_INFO("wep, set_tx=1\n"); -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ -+ if (pwep->KeyLength == 13) { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ -+ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = pwep->KeyLength; -+ -+ rtw_ap_set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx, 1); -+ } else { -+ RTW_INFO("wep, set_tx=0\n"); -+ -+ /* don't update "psecuritypriv->dot11PrivacyAlgrthm" and */ -+ /* "psecuritypriv->dot11PrivacyKeyIndex=keyid", but can rtw_set_key to cam */ -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = pwep->KeyLength; -+ -+ rtw_ap_set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx, 0); -+ } -+ -+ goto exit; -+ -+ } -+ -+ -+ if (!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) /* */ { /* group key */ -+ if (param->u.crypt.set_tx == 1) { -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) { -+ RTW_INFO("%s, set group_key, WEP\n", __FUNCTION__); -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ -+ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { -+ RTW_INFO("%s, set group_key, TKIP\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ -+ /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ -+ /* set mic key */ -+ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = _TRUE; -+ -+ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { -+ RTW_INFO("%s, set group_key, CCMP\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ } -+#ifdef CONFIG_IEEE80211W -+ else if (strcmp(param->u.crypt.alg, "BIP") == 0) { -+ int no; -+ -+ RTW_INFO("BIP key_len=%d , index=%d\n", param->u.crypt.key_len, param->u.crypt.idx); -+ /* save the IGTK key, length 16 bytes */ -+ _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ /* RTW_INFO("IGTK key below:\n"); -+ for(no=0;no<16;no++) -+ printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); -+ RTW_INFO("\n"); */ -+ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; -+ padapter->securitypriv.binstallBIPkey = _TRUE; -+ RTW_INFO(" ~~~~set sta key:IGKT\n"); -+ goto exit; -+ } -+#endif /* CONFIG_IEEE80211W */ -+ else { -+ RTW_INFO("%s, set group_key, none\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = _TRUE; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta) { -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ -+ } -+ -+ } -+ -+ goto exit; -+ -+ } -+ -+ if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) { /* psk/802_1x */ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ if (param->u.crypt.set_tx == 1) { -+ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) { -+ RTW_INFO("%s, set pairwise key, WEP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ psta->dot118021XPrivacy = _WEP104_; -+ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { -+ RTW_INFO("%s, set pairwise key, TKIP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _TKIP_; -+ -+ /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ -+ /* set mic key */ -+ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = _TRUE; -+ -+ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { -+ -+ RTW_INFO("%s, set pairwise key, CCMP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _AES_; -+ } else { -+ RTW_INFO("%s, set pairwise key, none\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _NO_PRIVACY_; -+ } -+ -+ rtw_ap_set_pairwise_key(padapter, psta); -+ -+ psta->ieee8021x_blocked = _FALSE; -+ -+ psta->bpairwise_key_installed = _TRUE; -+ -+ } else { /* group key??? */ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) { -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if (param->u.crypt.key_len == 13) -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ -+ /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ -+ /* set mic key */ -+ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = _TRUE; -+ -+ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); -+ } else -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = _TRUE; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if (pbcmc_sta) { -+ pbcmc_sta->ieee8021x_blocked = _FALSE; -+ pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ -+ } -+ -+ } -+ -+ } -+ -+ } -+ -+exit: -+ -+ if (pwep) -+ rtw_mfree((u8 *)pwep, wep_total_len); -+ -+ return ret; -+ -+} -+ -+static int rtw_set_beacon(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ unsigned char *pbuf = param->u.bcn_ie.buf; -+ -+ -+ RTW_INFO("%s, len=%d\n", __FUNCTION__, len); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return -EINVAL; -+ -+ _rtw_memcpy(&pstapriv->max_num_sta, param->u.bcn_ie.reserved, 2); -+ -+ if ((pstapriv->max_num_sta > NUM_STA) || (pstapriv->max_num_sta <= 0)) -+ pstapriv->max_num_sta = NUM_STA; -+ -+ -+ if (rtw_check_beacon_data(padapter, pbuf, (len - 12 - 2)) == _SUCCESS) /* 12 = param header, 2:no packed */ -+ ret = 0; -+ else -+ ret = -EINVAL; -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_hostapd_sta_flush(struct net_device *dev) -+{ -+ /* _irqL irqL; */ -+ /* _list *phead, *plist; */ -+ int ret = 0; -+ /* struct sta_info *psta = NULL; */ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ /* struct sta_priv *pstapriv = &padapter->stapriv; */ -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ flush_all_cam_entry(padapter); /* clear CAM */ -+ -+ ret = rtw_sta_flush(padapter, _TRUE); -+ -+ return ret; -+ -+} -+ -+static int rtw_add_sta(struct net_device *dev, struct ieee_param *param) -+{ -+ _irqL irqL; -+ int ret = 0; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ RTW_INFO("rtw_add_sta(aid=%d)=" MAC_FMT "\n", param->u.add_sta.aid, MAC_ARG(param->sta_addr)); -+ -+ if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE) -+ return -EINVAL; -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ return -EINVAL; -+ -+#if 0 -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (psta) { -+ RTW_INFO("rtw_add_sta(), free has been added psta=%p\n", psta); -+ /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ rtw_free_stainfo(padapter, psta); -+ /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ -+ -+ psta = NULL; -+ } -+#endif -+ /* psta = rtw_alloc_stainfo(pstapriv, param->sta_addr); */ -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (psta) { -+ int flags = param->u.add_sta.flags; -+ -+ /* RTW_INFO("rtw_add_sta(), init sta's variables, psta=%p\n", psta); */ -+ -+ psta->aid = param->u.add_sta.aid;/* aid=1~2007 */ -+ -+ _rtw_memcpy(psta->bssrateset, param->u.add_sta.tx_supp_rates, 16); -+ -+ -+ /* check wmm cap. */ -+ if (WLAN_STA_WME & flags) -+ psta->qos_option = 1; -+ else -+ psta->qos_option = 0; -+ -+ if (pmlmepriv->qospriv.qos_option == 0) -+ psta->qos_option = 0; -+ -+ -+#ifdef CONFIG_80211N_HT -+ /* chec 802.11n ht cap. */ -+ if (WLAN_STA_HT & flags) { -+ psta->htpriv.ht_option = _TRUE; -+ psta->qos_option = 1; -+ _rtw_memcpy((void *)&psta->htpriv.ht_cap, (void *)¶m->u.add_sta.ht_cap, sizeof(struct rtw_ieee80211_ht_cap)); -+ } else -+ psta->htpriv.ht_option = _FALSE; -+ -+ if (pmlmepriv->htpriv.ht_option == _FALSE) -+ psta->htpriv.ht_option = _FALSE; -+#endif -+ -+ -+ update_sta_info_apmode(padapter, psta); -+ -+ -+ } else -+ ret = -ENOMEM; -+ -+ return ret; -+ -+} -+ -+static int rtw_del_sta(struct net_device *dev, struct ieee_param *param) -+{ -+ _irqL irqL; -+ int ret = 0; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ RTW_INFO("rtw_del_sta=" MAC_FMT "\n", MAC_ARG(param->sta_addr)); -+ -+ if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE) -+ return -EINVAL; -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ return -EINVAL; -+ -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (psta) { -+ u8 updated = _FALSE; -+ -+ /* RTW_INFO("free psta=%p, aid=%d\n", psta, psta->aid); */ -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); -+ -+ psta = NULL; -+ -+ } else { -+ RTW_INFO("rtw_del_sta(), sta has already been removed or never been added\n"); -+ -+ /* ret = -1; */ -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_ioctl_get_sta_data(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct ieee_param_ex *param_ex = (struct ieee_param_ex *)param; -+ struct sta_data *psta_data = (struct sta_data *)param_ex->data; -+ -+ RTW_INFO("rtw_ioctl_get_sta_info, sta_addr: " MAC_FMT "\n", MAC_ARG(param_ex->sta_addr)); -+ -+ if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE) -+ return -EINVAL; -+ -+ if (param_ex->sta_addr[0] == 0xff && param_ex->sta_addr[1] == 0xff && -+ param_ex->sta_addr[2] == 0xff && param_ex->sta_addr[3] == 0xff && -+ param_ex->sta_addr[4] == 0xff && param_ex->sta_addr[5] == 0xff) -+ return -EINVAL; -+ -+ psta = rtw_get_stainfo(pstapriv, param_ex->sta_addr); -+ if (psta) { -+#if 0 -+ struct { -+ u16 aid; -+ u16 capability; -+ int flags; -+ u32 sta_set; -+ u8 tx_supp_rates[16]; -+ u32 tx_supp_rates_len; -+ struct rtw_ieee80211_ht_cap ht_cap; -+ u64 rx_pkts; -+ u64 rx_bytes; -+ u64 rx_drops; -+ u64 tx_pkts; -+ u64 tx_bytes; -+ u64 tx_drops; -+ } get_sta; -+#endif -+ psta_data->aid = (u16)psta->aid; -+ psta_data->capability = psta->capability; -+ psta_data->flags = psta->flags; -+ -+ /* -+ nonerp_set : BIT(0) -+ no_short_slot_time_set : BIT(1) -+ no_short_preamble_set : BIT(2) -+ no_ht_gf_set : BIT(3) -+ no_ht_set : BIT(4) -+ ht_20mhz_set : BIT(5) -+ */ -+ -+ psta_data->sta_set = ((psta->nonerp_set) | -+ (psta->no_short_slot_time_set << 1) | -+ (psta->no_short_preamble_set << 2) | -+ (psta->no_ht_gf_set << 3) | -+ (psta->no_ht_set << 4) | -+ (psta->ht_20mhz_set << 5)); -+ -+ psta_data->tx_supp_rates_len = psta->bssratelen; -+ _rtw_memcpy(psta_data->tx_supp_rates, psta->bssrateset, psta->bssratelen); -+#ifdef CONFIG_80211N_HT -+ _rtw_memcpy(&psta_data->ht_cap, &psta->htpriv.ht_cap, sizeof(struct rtw_ieee80211_ht_cap)); -+#endif /* CONFIG_80211N_HT */ -+ psta_data->rx_pkts = psta->sta_stats.rx_data_pkts; -+ psta_data->rx_bytes = psta->sta_stats.rx_bytes; -+ psta_data->rx_drops = psta->sta_stats.rx_drops; -+ -+ psta_data->tx_pkts = psta->sta_stats.tx_pkts; -+ psta_data->tx_bytes = psta->sta_stats.tx_bytes; -+ psta_data->tx_drops = psta->sta_stats.tx_drops; -+ -+ -+ } else -+ ret = -1; -+ -+ return ret; -+ -+} -+ -+static int rtw_get_sta_wpaie(struct net_device *dev, struct ieee_param *param) -+{ -+ int ret = 0; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ RTW_INFO("rtw_get_sta_wpaie, sta_addr: " MAC_FMT "\n", MAC_ARG(param->sta_addr)); -+ -+ if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE) -+ return -EINVAL; -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ return -EINVAL; -+ -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if (psta) { -+ if ((psta->wpa_ie[0] == WLAN_EID_RSN) || (psta->wpa_ie[0] == WLAN_EID_GENERIC)) { -+ int wpa_ie_len; -+ int copy_len; -+ -+ wpa_ie_len = psta->wpa_ie[1]; -+ -+ copy_len = ((wpa_ie_len + 2) > sizeof(psta->wpa_ie)) ? (sizeof(psta->wpa_ie)) : (wpa_ie_len + 2); -+ -+ param->u.wpa_ie.len = copy_len; -+ -+ _rtw_memcpy(param->u.wpa_ie.reserved, psta->wpa_ie, copy_len); -+ } else { -+ /* ret = -1; */ -+ RTW_INFO("sta's wpa_ie is NONE\n"); -+ } -+ } else -+ ret = -1; -+ -+ return ret; -+ -+} -+ -+static int rtw_set_wps_beacon(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ unsigned char wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int ie_len; -+ -+ RTW_INFO("%s, len=%d\n", __FUNCTION__, len); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return -EINVAL; -+ -+ ie_len = len - 12 - 2; /* 12 = param header, 2:no packed */ -+ -+ -+ if (pmlmepriv->wps_beacon_ie) { -+ rtw_mfree(pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len); -+ pmlmepriv->wps_beacon_ie = NULL; -+ } -+ -+ if (ie_len > 0) { -+ pmlmepriv->wps_beacon_ie = rtw_malloc(ie_len); -+ pmlmepriv->wps_beacon_ie_len = ie_len; -+ if (pmlmepriv->wps_beacon_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ } -+ -+ _rtw_memcpy(pmlmepriv->wps_beacon_ie, param->u.bcn_ie.buf, ie_len); -+ -+ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, _TRUE); -+ -+ pmlmeext->bstart_bss = _TRUE; -+ -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_set_wps_probe_resp(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ int ie_len; -+ -+ RTW_INFO("%s, len=%d\n", __FUNCTION__, len); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return -EINVAL; -+ -+ ie_len = len - 12 - 2; /* 12 = param header, 2:no packed */ -+ -+ -+ if (pmlmepriv->wps_probe_resp_ie) { -+ rtw_mfree(pmlmepriv->wps_probe_resp_ie, pmlmepriv->wps_probe_resp_ie_len); -+ pmlmepriv->wps_probe_resp_ie = NULL; -+ } -+ -+ if (ie_len > 0) { -+ pmlmepriv->wps_probe_resp_ie = rtw_malloc(ie_len); -+ pmlmepriv->wps_probe_resp_ie_len = ie_len; -+ if (pmlmepriv->wps_probe_resp_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ } -+ _rtw_memcpy(pmlmepriv->wps_probe_resp_ie, param->u.bcn_ie.buf, ie_len); -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_set_wps_assoc_resp(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ int ie_len; -+ -+ RTW_INFO("%s, len=%d\n", __FUNCTION__, len); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return -EINVAL; -+ -+ ie_len = len - 12 - 2; /* 12 = param header, 2:no packed */ -+ -+ -+ if (pmlmepriv->wps_assoc_resp_ie) { -+ rtw_mfree(pmlmepriv->wps_assoc_resp_ie, pmlmepriv->wps_assoc_resp_ie_len); -+ pmlmepriv->wps_assoc_resp_ie = NULL; -+ } -+ -+ if (ie_len > 0) { -+ pmlmepriv->wps_assoc_resp_ie = rtw_malloc(ie_len); -+ pmlmepriv->wps_assoc_resp_ie_len = ie_len; -+ if (pmlmepriv->wps_assoc_resp_ie == NULL) { -+ RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ } -+ -+ _rtw_memcpy(pmlmepriv->wps_assoc_resp_ie, param->u.bcn_ie.buf, ie_len); -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_set_hidden_ssid(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); -+ struct mlme_ext_info *mlmeinfo = &(mlmeext->mlmext_info); -+ int ie_len; -+ u8 *ssid_ie; -+ char ssid[NDIS_802_11_LENGTH_SSID + 1]; -+ sint ssid_len = 0; -+ u8 ignore_broadcast_ssid; -+ -+ if (check_fwstate(mlmepriv, WIFI_AP_STATE) != _TRUE) -+ return -EPERM; -+ -+ if (param->u.bcn_ie.reserved[0] != 0xea) -+ return -EINVAL; -+ -+ mlmeinfo->hidden_ssid_mode = ignore_broadcast_ssid = param->u.bcn_ie.reserved[1]; -+ -+ ie_len = len - 12 - 2; /* 12 = param header, 2:no packed */ -+ ssid_ie = rtw_get_ie(param->u.bcn_ie.buf, WLAN_EID_SSID, &ssid_len, ie_len); -+ -+ if (ssid_ie && ssid_len > 0 && ssid_len <= NDIS_802_11_LENGTH_SSID) { -+ WLAN_BSSID_EX *pbss_network = &mlmepriv->cur_network.network; -+ WLAN_BSSID_EX *pbss_network_ext = &mlmeinfo->network; -+ -+ _rtw_memcpy(ssid, ssid_ie + 2, ssid_len); -+ ssid[ssid_len] = 0x0; -+ -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" ssid:(%s,%d), from ie:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ ssid, ssid_len, -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, -+ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); -+ -+ _rtw_memcpy(pbss_network->Ssid.Ssid, (void *)ssid, ssid_len); -+ pbss_network->Ssid.SsidLength = ssid_len; -+ _rtw_memcpy(pbss_network_ext->Ssid.Ssid, (void *)ssid, ssid_len); -+ pbss_network_ext->Ssid.SsidLength = ssid_len; -+ -+ if (0) -+ RTW_INFO(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, -+ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); -+ } -+ -+ RTW_INFO(FUNC_ADPT_FMT" ignore_broadcast_ssid:%d, %s,%d\n", FUNC_ADPT_ARG(adapter), -+ ignore_broadcast_ssid, ssid, ssid_len); -+ -+ return ret; -+} -+ -+#if CONFIG_RTW_MACADDR_ACL -+static int rtw_ioctl_acl_remove_sta(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return -EINVAL; -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ return -EINVAL; -+ -+ ret = rtw_acl_remove_sta(padapter, param->sta_addr); -+ -+ return ret; -+ -+} -+ -+static int rtw_ioctl_acl_add_sta(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return -EINVAL; -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ return -EINVAL; -+ -+ ret = rtw_acl_add_sta(padapter, param->sta_addr); -+ -+ return ret; -+ -+} -+ -+static int rtw_ioctl_set_macaddr_acl(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) -+ return -EINVAL; -+ -+ rtw_set_macaddr_acl(padapter, param->u.mlme.command); -+ -+ return ret; -+} -+#endif /* CONFIG_RTW_MACADDR_ACL */ -+ -+static int rtw_hostapd_ioctl(struct net_device *dev, struct iw_point *p) -+{ -+ struct ieee_param *param; -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ /* -+ * this function is expect to call in master mode, which allows no power saving -+ * so, we just check hw_init_completed -+ */ -+ -+ if (!rtw_is_hw_init_completed(padapter)) { -+ ret = -EPERM; -+ goto out; -+ } -+ -+ -+ /* if (p->length < sizeof(struct ieee_param) || !p->pointer){ */ -+ if (!p->pointer) { -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ param = (struct ieee_param *)rtw_malloc(p->length); -+ if (param == NULL) { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ if (copy_from_user(param, p->pointer, p->length)) { -+ rtw_mfree((u8 *)param, p->length); -+ ret = -EFAULT; -+ goto out; -+ } -+ -+ /* RTW_INFO("%s, cmd=%d\n", __FUNCTION__, param->cmd); */ -+ -+ switch (param->cmd) { -+ case RTL871X_HOSTAPD_FLUSH: -+ -+ ret = rtw_hostapd_sta_flush(dev); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_ADD_STA: -+ -+ ret = rtw_add_sta(dev, param); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_REMOVE_STA: -+ -+ ret = rtw_del_sta(dev, param); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_BEACON: -+ -+ ret = rtw_set_beacon(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_SET_ENCRYPTION: -+ -+ ret = rtw_set_encryption(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_GET_WPAIE_STA: -+ -+ ret = rtw_get_sta_wpaie(dev, param); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_WPS_BEACON: -+ -+ ret = rtw_set_wps_beacon(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_WPS_PROBE_RESP: -+ -+ ret = rtw_set_wps_probe_resp(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_WPS_ASSOC_RESP: -+ -+ ret = rtw_set_wps_assoc_resp(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_HIDDEN_SSID: -+ -+ ret = rtw_set_hidden_ssid(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_GET_INFO_STA: -+ -+ ret = rtw_ioctl_get_sta_data(dev, param, p->length); -+ -+ break; -+ -+#if CONFIG_RTW_MACADDR_ACL -+ case RTL871X_HOSTAPD_SET_MACADDR_ACL: -+ ret = rtw_ioctl_set_macaddr_acl(dev, param, p->length); -+ break; -+ case RTL871X_HOSTAPD_ACL_ADD_STA: -+ ret = rtw_ioctl_acl_add_sta(dev, param, p->length); -+ break; -+ case RTL871X_HOSTAPD_ACL_REMOVE_STA: -+ ret = rtw_ioctl_acl_remove_sta(dev, param, p->length); -+ break; -+#endif /* CONFIG_RTW_MACADDR_ACL */ -+ -+ default: -+ RTW_INFO("Unknown hostapd request: %d\n", param->cmd); -+ ret = -EOPNOTSUPP; -+ break; -+ -+ } -+ -+ if (ret == 0 && copy_to_user(p->pointer, param, p->length)) -+ ret = -EFAULT; -+ -+ -+ rtw_mfree((u8 *)param, p->length); -+ -+out: -+ -+ return ret; -+ -+} -+#endif -+ -+static int rtw_wx_set_priv(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *awrq, -+ char *extra) -+{ -+ -+#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ char *ext_dbg; -+#endif -+ -+ int ret = 0; -+ int len = 0; -+ char *ext; -+ int i; -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *dwrq = (struct iw_point *)awrq; -+ -+ if (dwrq->length == 0) -+ return -EFAULT; -+ -+ len = dwrq->length; -+ ext = rtw_vmalloc(len); -+ if (!ext) -+ return -ENOMEM; -+ -+ if (copy_from_user(ext, dwrq->pointer, len)) { -+ rtw_vmfree(ext, len); -+ return -EFAULT; -+ } -+ -+ -+ -+#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ ext_dbg = rtw_vmalloc(len); -+ if (!ext_dbg) { -+ rtw_vmfree(ext, len); -+ return -ENOMEM; -+ } -+ -+ _rtw_memcpy(ext_dbg, ext, len); -+#endif -+ -+ /* added for wps2.0 @20110524 */ -+ if (dwrq->flags == 0x8766 && len > 8) { -+ u32 cp_sz; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 *probereq_wpsie = ext; -+ int probereq_wpsie_len = len; -+ u8 wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; -+ -+ if ((_VENDOR_SPECIFIC_IE_ == probereq_wpsie[0]) && -+ (_rtw_memcmp(&probereq_wpsie[2], wps_oui, 4) == _TRUE)) { -+ cp_sz = probereq_wpsie_len > MAX_WPS_IE_LEN ? MAX_WPS_IE_LEN : probereq_wpsie_len; -+ -+ if (pmlmepriv->wps_probe_req_ie) { -+ u32 free_len = pmlmepriv->wps_probe_req_ie_len; -+ pmlmepriv->wps_probe_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); -+ pmlmepriv->wps_probe_req_ie = NULL; -+ } -+ -+ pmlmepriv->wps_probe_req_ie = rtw_malloc(cp_sz); -+ if (pmlmepriv->wps_probe_req_ie == NULL) { -+ printk("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ ret = -EINVAL; -+ goto FREE_EXT; -+ -+ } -+ -+ _rtw_memcpy(pmlmepriv->wps_probe_req_ie, probereq_wpsie, cp_sz); -+ pmlmepriv->wps_probe_req_ie_len = cp_sz; -+ -+ } -+ -+ goto FREE_EXT; -+ -+ } -+ -+ if (len >= WEXT_CSCAN_HEADER_SIZE -+ && _rtw_memcmp(ext, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == _TRUE -+ ) { -+ ret = rtw_wx_set_scan(dev, info, awrq, ext); -+ goto FREE_EXT; -+ } -+ -+#ifdef CONFIG_ANDROID -+ /* RTW_INFO("rtw_wx_set_priv: %s req=%s\n", dev->name, ext); */ -+ -+ i = rtw_android_cmdstr_to_num(ext); -+ -+ switch (i) { -+ case ANDROID_WIFI_CMD_START: -+ indicate_wx_custom_event(padapter, "START"); -+ break; -+ case ANDROID_WIFI_CMD_STOP: -+ indicate_wx_custom_event(padapter, "STOP"); -+ break; -+ case ANDROID_WIFI_CMD_RSSI: { -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *pcur_network = &pmlmepriv->cur_network; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) -+ sprintf(ext, "%s rssi %d", pcur_network->network.Ssid.Ssid, padapter->recvpriv.rssi); -+ else -+ sprintf(ext, "OK"); -+ } -+ break; -+ case ANDROID_WIFI_CMD_LINKSPEED: { -+ u16 mbps = rtw_get_cur_max_rate(padapter) / 10; -+ sprintf(ext, "LINKSPEED %d", mbps); -+ } -+ break; -+ case ANDROID_WIFI_CMD_MACADDR: -+ sprintf(ext, "MACADDR = " MAC_FMT, MAC_ARG(dev->dev_addr)); -+ break; -+ case ANDROID_WIFI_CMD_SCAN_ACTIVE: { -+ /* rtw_set_scan_mode(padapter, SCAN_ACTIVE); */ -+ sprintf(ext, "OK"); -+ } -+ break; -+ case ANDROID_WIFI_CMD_SCAN_PASSIVE: { -+ /* rtw_set_scan_mode(padapter, SCAN_PASSIVE); */ -+ sprintf(ext, "OK"); -+ } -+ break; -+ -+ case ANDROID_WIFI_CMD_COUNTRY: { -+ char country_code[10]; -+ sscanf(ext, "%*s %s", country_code); -+ rtw_set_country(padapter, country_code); -+ sprintf(ext, "OK"); -+ } -+ break; -+ default: -+ #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ RTW_INFO("%s: %s unknowned req=%s\n", __FUNCTION__, -+ dev->name, ext_dbg); -+ #endif -+ -+ sprintf(ext, "OK"); -+ -+ } -+ -+ if (copy_to_user(dwrq->pointer, ext, min(dwrq->length, (u16)(strlen(ext) + 1)))) -+ ret = -EFAULT; -+ -+#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ RTW_INFO("%s: %s req=%s rep=%s dwrq->length=%d, strlen(ext)+1=%d\n", __FUNCTION__, -+ dev->name, ext_dbg , ext, dwrq->length, (u16)(strlen(ext) + 1)); -+#endif -+#endif /* end of CONFIG_ANDROID */ -+ -+ -+FREE_EXT: -+ -+ rtw_vmfree(ext, len); -+ #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ rtw_vmfree(ext_dbg, len); -+ #endif -+ -+ /* RTW_INFO("rtw_wx_set_priv: (SIOCSIWPRIV) %s ret=%d\n", */ -+ /* dev->name, ret); */ -+ -+ return ret; -+ -+} -+#ifdef CONFIG_WOWLAN -+static int rtw_wowlan_ctrl(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wowlan_ioctl_param poidparam; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ int ret = 0; -+ u32 start_time = rtw_get_current_time(); -+ poidparam.subcode = 0; -+ -+ RTW_INFO("+rtw_wowlan_ctrl: %s\n", extra); -+ -+ if (!check_fwstate(pmlmepriv, _FW_LINKED) && -+ check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+#ifdef CONFIG_PNO_SUPPORT -+ pwrctrlpriv->wowlan_pno_enable = _TRUE; -+#else -+ RTW_INFO("[%s] WARNING: Please Connect With AP First!!\n", __func__); -+ goto _rtw_wowlan_ctrl_exit_free; -+#endif /* CONFIG_PNO_SUPPORT */ -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) -+ rtw_scan_abort(padapter); -+ -+ if (_rtw_memcmp(extra, "enable", 6)) -+ -+ -+ rtw_suspend_common(padapter); -+ -+ else if (_rtw_memcmp(extra, "disable", 7)) { -+#ifdef CONFIG_USB_HCI -+ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); -+#endif -+ rtw_resume_common(padapter); -+ -+#ifdef CONFIG_PNO_SUPPORT -+ pwrctrlpriv->wowlan_pno_enable = _FALSE; -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+ } else { -+ RTW_INFO("[%s] Invalid Parameter.\n", __func__); -+ goto _rtw_wowlan_ctrl_exit_free; -+ } -+ /* mutex_lock(&ioctl_mutex); */ -+_rtw_wowlan_ctrl_exit_free: -+ RTW_INFO("-rtw_wowlan_ctrl( subcode = %d)\n", poidparam.subcode); -+ RTW_PRINT("%s in %d ms\n", __func__, -+ rtw_get_passing_time_ms(start_time)); -+_rtw_wowlan_ctrl_exit: -+ return ret; -+} -+ -+/* -+ * IP filter This pattern if for a frame containing a ip packet: -+ * AA:AA:AA:AA:AA:AA:BB:BB:BB:BB:BB:BB:CC:CC:DD:-:-:-:-:-:-:-:-:EE:-:-:FF:FF:FF:FF:GG:GG:GG:GG:HH:HH:II:II -+ * -+ * A: Ethernet destination address -+ * B: Ethernet source address -+ * C: Ethernet protocol type -+ * D: IP header VER+Hlen, use: 0x45 (4 is for ver 4, 5 is for len 20) -+ * E: IP protocol -+ * F: IP source address ( 192.168.0.4: C0:A8:00:2C ) -+ * G: IP destination address ( 192.168.0.4: C0:A8:00:2C ) -+ * H: Source port (1024: 04:00) -+ * I: Destination port (1024: 04:00) -+ */ -+ -+static int rtw_wowlan_set_pattern(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wowlan_ioctl_param poidparam; -+ int ret = 0, len = 0, i = 0; -+ u32 start_time = rtw_get_current_time(); -+ u8 input[wrqu->data.length]; -+ u8 index = 0; -+ -+ poidparam.subcode = 0; -+ -+ if (!check_fwstate(pmlmepriv, _FW_LINKED) && -+ check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ ret = -EFAULT; -+ RTW_INFO("Please Connect With AP First!!\n"); -+ goto _rtw_wowlan_set_pattern_exit; -+ } -+ -+ if (wrqu->data.length <= 0) { -+ ret = -EFAULT; -+ RTW_INFO("ERROR: parameter length <= 0\n"); -+ goto _rtw_wowlan_set_pattern_exit; -+ } else { -+ /* set pattern */ -+ if (copy_from_user(input, -+ wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ /* leave PS first */ -+ rtw_ps_deny(padapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(padapter); -+ if (strncmp(input, "pattern=", 8) == 0) { -+ if (pwrpriv->wowlan_pattern_idx >= MAX_WKFM_NUM) { -+ RTW_INFO("WARNING: priv-pattern is full(idx: %d)\n", -+ pwrpriv->wowlan_pattern_idx); -+ RTW_INFO("WARNING: please clean priv-pattern first\n"); -+ ret = -EINVAL; -+ goto _rtw_wowlan_set_pattern_exit; -+ } else { -+ index = pwrpriv->wowlan_pattern_idx; -+ ret = rtw_wowlan_parser_pattern_cmd(input, -+ pwrpriv->patterns[index].content, -+ &pwrpriv->patterns[index].len, -+ pwrpriv->patterns[index].mask); -+ -+ if (ret == _TRUE) -+ pwrpriv->wowlan_pattern_idx++; -+ } -+ } else if (strncmp(input, "clean", 5) == 0) { -+ poidparam.subcode = WOWLAN_PATTERN_CLEAN; -+ rtw_hal_set_hwreg(padapter, -+ HW_VAR_WOWLAN, (u8 *)&poidparam); -+ } else if (strncmp(input, "show", 4) == 0) { -+ for (i = 0 ; i < MAX_WKFM_NUM ; i++) { -+ RTW_INFO("=======[%d]=======\n", i); -+ rtw_read_from_frame_mask(padapter, i); -+ } -+ -+ RTW_INFO("********[RTK priv-patterns]*********\n"); -+ for (i = 0 ; i < MAX_WKFM_NUM ; i++) -+ rtw_dump_priv_pattern(padapter, i); -+ } else { -+ RTW_INFO("ERROR: incorrect parameter!\n"); -+ ret = -EINVAL; -+ } -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ } -+_rtw_wowlan_set_pattern_exit: -+ return ret; -+} -+#endif /* CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_AP_WOWLAN -+static int rtw_ap_wowlan_ctrl(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wowlan_ioctl_param poidparam; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ int ret = 0; -+ u32 start_time = rtw_get_current_time(); -+ poidparam.subcode = 0; -+ -+ RTW_INFO("+rtw_ap_wowlan_ctrl: %s\n", extra); -+ -+ if (!check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ RTW_INFO("[%s] It is not AP mode!!\n", __func__); -+ goto _rtw_ap_wowlan_ctrl_exit_free; -+ } -+ -+ if (_rtw_memcmp(extra, "enable", 6)) { -+ -+ pwrctrlpriv->wowlan_ap_mode = _TRUE; -+ -+ rtw_suspend_common(padapter); -+ } else if (_rtw_memcmp(extra, "disable", 7)) { -+#ifdef CONFIG_USB_HCI -+ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); -+#endif -+ rtw_resume_common(padapter); -+ } else { -+ RTW_INFO("[%s] Invalid Parameter.\n", __func__); -+ goto _rtw_ap_wowlan_ctrl_exit_free; -+ } -+ /* mutex_lock(&ioctl_mutex); */ -+_rtw_ap_wowlan_ctrl_exit_free: -+ RTW_INFO("-rtw_ap_wowlan_ctrl( subcode = %d)\n", poidparam.subcode); -+ RTW_PRINT("%s in %d ms\n", __func__, -+ rtw_get_passing_time_ms(start_time)); -+_rtw_ap_wowlan_ctrl_exit: -+ return ret; -+} -+#endif /* CONFIG_AP_WOWLAN */ -+ -+static int rtw_pm_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ unsigned mode = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_INFO("[%s] extra = %s\n", __FUNCTION__, extra); -+ -+ if (_rtw_memcmp(extra, "lps=", 4)) { -+ sscanf(extra + 4, "%u", &mode); -+ ret = rtw_pm_set_lps(padapter, mode); -+ } else if (_rtw_memcmp(extra, "ips=", 4)) { -+ sscanf(extra + 4, "%u", &mode); -+ ret = rtw_pm_set_ips(padapter, mode); -+ } else -+ ret = -EINVAL; -+ -+ return ret; -+} -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ -+int rtw_vendor_ie_get(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0, vendor_ie_num = 0 , j , len = 0 , cmdlen; -+ char *pstring; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct iw_point *p; -+ u8 *ptmp; -+ u32 vendor_ie_mask = 0; -+ -+ p = &wrqu->data; -+ cmdlen = p->length; -+ if (0 == cmdlen) -+ return -EINVAL; -+ -+ ptmp = (u8 *)rtw_malloc(cmdlen); -+ if (NULL == ptmp) -+ return -ENOMEM; -+ -+ if (copy_from_user(ptmp, p->pointer, cmdlen)) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ ret = sscanf(ptmp , "%d", &vendor_ie_num); -+ if (vendor_ie_num > WLAN_MAX_VENDOR_IE_NUM - 1) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ vendor_ie_mask = pmlmepriv->vendor_ie_mask[vendor_ie_num]; -+ pstring = extra; -+ pstring += sprintf(pstring , "\nVendor IE num %d , Mask:%x " , vendor_ie_num , vendor_ie_mask); -+ -+ if (vendor_ie_mask & WIFI_BEACON_VENDOR_IE_BIT) -+ pstring += sprintf(pstring , "[Beacon]"); -+ if (vendor_ie_mask & WIFI_PROBEREQ_VENDOR_IE_BIT) -+ pstring += sprintf(pstring , "[Probe Req]"); -+ if (vendor_ie_mask & WIFI_PROBERESP_VENDOR_IE_BIT) -+ pstring += sprintf(pstring , "[Probe Resp]"); -+ if (vendor_ie_mask & WIFI_ASSOCREQ_VENDOR_IE_BIT) -+ pstring += sprintf(pstring , "[Assoc Req]"); -+ if (vendor_ie_mask & WIFI_ASSOCRESP_VENDOR_IE_BIT) -+ pstring += sprintf(pstring , "[Assoc Resp]"); -+ -+ pstring += sprintf(pstring , "\nVendor IE:\n"); -+ for (j = 0 ; j < pmlmepriv->vendor_ielen[vendor_ie_num] ; j++) -+ pstring += sprintf(pstring , "%02x" , pmlmepriv->vendor_ie[vendor_ie_num][j]); -+ -+ wrqu->data.length = pstring - extra; -+ -+exit: -+ rtw_mfree(ptmp, cmdlen); -+ -+ return 0; -+} -+ -+int rtw_vendor_ie_set(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0, i , len = 0 , totoal_ie_len = 0 , total_ie_len_byte = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u32 vendor_ie_mask = 0; -+ u32 vendor_ie_num = 0; -+ u32 id, elen; -+ -+ ret = sscanf(extra, "%d,%x,%*s", &vendor_ie_num , &vendor_ie_mask); -+ if (strrchr(extra , ',')) -+ extra = strrchr(extra , ',') + 1; -+ else -+ return -EINVAL; -+ totoal_ie_len = strlen(extra); -+ RTW_INFO("[%s] vendor_ie_num = %d , vendor_ie_mask = %x , vendor_ie = %s , len = %d\n", __func__ , vendor_ie_num , vendor_ie_mask , extra , totoal_ie_len); -+ -+ if (vendor_ie_num > WLAN_MAX_VENDOR_IE_NUM - 1) { -+ RTW_INFO("[%s] only support %d vendor ie\n", __func__ , WLAN_MAX_VENDOR_IE_NUM); -+ return -EFAULT; -+ } -+ -+ if (totoal_ie_len > WLAN_MAX_VENDOR_IE_LEN) { -+ RTW_INFO("[%s] Fail , not support ie length extend %d\n", __func__ , WLAN_MAX_VENDOR_IE_LEN); -+ return -EFAULT; -+ } -+ -+ if (vendor_ie_mask == 0) { -+ RTW_INFO("[%s] Clear vendor_ie_num %d group\n", __func__ , vendor_ie_num); -+ goto _clear_path; -+ } -+ -+ if (totoal_ie_len % 2 != 0) { -+ RTW_INFO("[%s] Fail , IE length = %zu is odd\n" , __func__ , strlen(extra)); -+ return -EFAULT; -+ } -+ -+ if (totoal_ie_len > 0) { -+ for (i = 0 ; i < strlen(extra) ; i += 2) { -+ pmlmepriv->vendor_ie[vendor_ie_num][len] = key_2char2num(extra[i] , extra[i + 1]); -+ if (len == 0) { -+ id = pmlmepriv->vendor_ie[vendor_ie_num][len]; -+ if (id != WLAN_EID_VENDOR_SPECIFIC) { -+ RTW_INFO("[%s] Fail , VENDOR SPECIFIC IE ID \"%x\" was not correct\n", __func__ , id); -+ goto _clear_path; -+ } -+ } else if (len == 1) { -+ total_ie_len_byte = (totoal_ie_len / 2) - 2; -+ elen = pmlmepriv->vendor_ie[vendor_ie_num][len]; -+ if (elen != total_ie_len_byte) { -+ RTW_INFO("[%s] Fail , Input IE length = \"%d\"(hex:%x) bytes , not match input total IE context length \"%d\" bytes\n", __func__ , elen , elen , -+ total_ie_len_byte); -+ goto _clear_path; -+ } -+ } -+ len++; -+ } -+ pmlmepriv->vendor_ielen[vendor_ie_num] = len; -+ } else -+ pmlmepriv->vendor_ielen[vendor_ie_num] = 0; -+ -+ -+ -+ if (vendor_ie_mask & WIFI_BEACON_VENDOR_IE_BIT) -+ RTW_INFO("[%s] Beacon append vendor ie\n", __func__); -+ if (vendor_ie_mask & WIFI_PROBEREQ_VENDOR_IE_BIT) -+ RTW_INFO("[%s] Probe Req append vendor ie\n", __func__); -+ if (vendor_ie_mask & WIFI_PROBERESP_VENDOR_IE_BIT) -+ RTW_INFO("[%s] Probe Resp append vendor ie\n", __func__); -+ if (vendor_ie_mask & WIFI_ASSOCREQ_VENDOR_IE_BIT) -+ RTW_INFO("[%s] Assoc Req append vendor ie\n", __func__); -+ if (vendor_ie_mask & WIFI_ASSOCRESP_VENDOR_IE_BIT) -+ RTW_INFO("[%s] Assoc Resp append vendor ie\n", __func__); -+ -+ pmlmepriv->vendor_ie_mask[vendor_ie_num] = vendor_ie_mask; -+ -+ return ret; -+ -+_clear_path: -+ _rtw_memset(pmlmepriv->vendor_ie[vendor_ie_num] , 0 , sizeof(u32) * WLAN_MAX_VENDOR_IE_LEN); -+ pmlmepriv->vendor_ielen[vendor_ie_num] = 0; -+ pmlmepriv->vendor_ie_mask[vendor_ie_num] = 0; -+ return -EFAULT; -+} -+#endif -+ -+static int rtw_mp_efuse_get(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wdata, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ PEFUSE_HAL pEfuseHal; -+ struct iw_point *wrqu; -+ -+ u8 *PROMContent = pHalData->efuse_eeprom_data; -+ u8 ips_mode = IPS_NUM; /* init invalid value */ -+ u8 lps_mode = PS_MODE_NUM; /* init invalid value */ -+ struct pwrctrl_priv *pwrctrlpriv ; -+ u8 *data = NULL; -+ u8 *rawdata = NULL; -+ char *pch, *ptmp, *token, *tmp[3] = {0x00, 0x00, 0x00}; -+ u16 i = 0, j = 0, mapLen = 0, addr = 0, cnts = 0; -+ u16 max_available_len = 0, raw_cursize = 0, raw_maxsize = 0; -+ u16 mask_len; -+ u8 mask_buf[64] = ""; -+ int err; -+#ifdef CONFIG_IOL -+ u8 org_fw_iol = padapter->registrypriv.fw_iol;/* 0:Disable, 1:enable, 2:by usb speed */ -+#endif -+ -+ wrqu = (struct iw_point *)wdata; -+ pwrctrlpriv = adapter_to_pwrctl(padapter); -+ pEfuseHal = &pHalData->EfuseHal; -+ -+ err = 0; -+ data = rtw_zmalloc(EFUSE_BT_MAX_MAP_LEN); -+ if (data == NULL) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ rawdata = rtw_zmalloc(EFUSE_BT_MAX_MAP_LEN); -+ if (rawdata == NULL) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) { -+ err = -EFAULT; -+ goto exit; -+ } -+#ifdef CONFIG_LPS -+ lps_mode = pwrctrlpriv->power_mgnt;/* keep org value */ -+ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); -+#endif -+ -+#ifdef CONFIG_IPS -+ ips_mode = pwrctrlpriv->ips_mode;/* keep org value */ -+ rtw_pm_set_ips(padapter, IPS_NONE); -+#endif -+ -+ pch = extra; -+ RTW_INFO("%s: in=%s\n", __FUNCTION__, extra); -+ -+ i = 0; -+ /* mac 16 "00e04c871200" rmap,00,2 */ -+ while ((token = strsep(&pch, ",")) != NULL) { -+ if (i > 2) -+ break; -+ tmp[i] = token; -+ i++; -+ } -+#ifdef CONFIG_IOL -+ padapter->registrypriv.fw_iol = 0;/* 0:Disable, 1:enable, 2:by usb speed */ -+#endif -+ -+ if (strcmp(tmp[0], "status") == 0) { -+ sprintf(extra, "Load File efuse=%s,Load File MAC=%s" -+ , pHalData->efuse_file_status == EFUSE_FILE_FAILED ? "FAIL" : "OK" -+ , pHalData->macaddr_file_status == MACADDR_FILE_FAILED ? "FAIL" : "OK" -+ ); -+ goto exit; -+ } else if (strcmp(tmp[0], "drvmap") == 0) { -+ static u8 drvmaporder = 0; -+ u8 *efuse; -+ u32 shift, cnt; -+ u32 blksz = 0x200; /* The size of one time show, default 512 */ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, _FALSE); -+ -+ efuse = pHalData->efuse_eeprom_data; -+ -+ shift = blksz * drvmaporder; -+ efuse += shift; -+ cnt = mapLen - shift; -+ -+ if (cnt > blksz) { -+ cnt = blksz; -+ drvmaporder++; -+ } else -+ drvmaporder = 0; -+ -+ sprintf(extra, "\n"); -+ for (i = 0; i < cnt; i += 16) { -+ sprintf(extra, "%s0x%02x\t", extra, shift + i); -+ for (j = 0; j < 8; j++) -+ sprintf(extra, "%s%02X ", extra, efuse[i + j]); -+ sprintf(extra, "%s\t", extra); -+ for (; j < 16; j++) -+ sprintf(extra, "%s%02X ", extra, efuse[i + j]); -+ sprintf(extra, "%s\n", extra); -+ } -+ if ((shift + cnt) < mapLen) -+ sprintf(extra, "%s\t...more (left:%d/%d)\n", extra, mapLen-(shift + cnt), mapLen); -+ -+ } else if (strcmp(tmp[0], "realmap") == 0) { -+ static u8 order = 0; -+ u8 *efuse; -+ u32 shift, cnt; -+ u32 blksz = 0x200; /* The size of one time show, default 512 */ -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&mapLen, _FALSE); -+ efuse = pEfuseHal->fakeEfuseInitMap; -+ if (rtw_efuse_mask_map_read(padapter, 0, mapLen, efuse) == _FAIL) { -+ RTW_INFO("%s: read realmap Fail!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+#if 0 -+ RTW_INFO("OFFSET\tVALUE(hex)\n"); -+ for (i = 0; i < mapLen; i += 16) { -+ RTW_INFO("0x%02x\t", i); -+ for (j = 0; j < 8; j++) -+ RTW_INFO("%02X ", efuse[i + j]); -+ RTW_INFO("\t"); -+ for (; j < 16; j++) -+ RTW_INFO("%02X ", efuse[i + j]); -+ RTW_INFO("\n"); -+ } -+ RTW_INFO("\n"); -+#endif -+ -+ shift = blksz * order; -+ efuse += shift; -+ cnt = mapLen - shift; -+ if (cnt > blksz) { -+ cnt = blksz; -+ order++; -+ } else -+ order = 0; -+ -+ sprintf(extra, "\n"); -+ for (i = 0; i < cnt; i += 16) { -+ sprintf(extra, "%s0x%02x\t", extra, shift + i); -+ for (j = 0; j < 8; j++) -+ sprintf(extra, "%s%02X ", extra, efuse[i + j]); -+ sprintf(extra, "%s\t", extra); -+ for (; j < 16; j++) -+ sprintf(extra, "%s%02X ", extra, efuse[i + j]); -+ sprintf(extra, "%s\n", extra); -+ } -+ if ((shift + cnt) < mapLen) -+ sprintf(extra, "%s\t...more\n", extra); -+ } else if (strcmp(tmp[0], "rmap") == 0) { -+ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { -+ RTW_INFO("%s: rmap Fail!! Parameters error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ /* rmap addr cnts */ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ RTW_INFO("%s: addr=%x\n", __FUNCTION__, addr); -+ -+ cnts = simple_strtoul(tmp[2], &ptmp, 10); -+ if (cnts == 0) { -+ RTW_INFO("%s: rmap Fail!! cnts error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (PVOID)&max_available_len, _FALSE); -+ if ((addr + cnts) > max_available_len) { -+ RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ if (rtw_efuse_mask_map_read(padapter, addr, cnts, data) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_mask_map_read error!\n", __func__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ /* RTW_INFO("%s: data={", __FUNCTION__); */ -+ *extra = 0; -+ for (i = 0; i < cnts; i++) { -+ /* RTW_INFO("0x%02x ", data[i]); */ -+ sprintf(extra, "%s0x%02X ", extra, data[i]); -+ } -+ /* RTW_INFO("}\n"); */ -+ } else if (strcmp(tmp[0], "realraw") == 0) { -+ addr = 0; -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN , (PVOID)&mapLen, _FALSE); -+ RTW_INFO("EFUSE_MAX_SIZE = %d\n", EFUSE_MAX_SIZE); -+ -+ if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_access Fail!!\n", __func__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (mapLen >= 512) -+ mapLen = 512; -+ -+ _rtw_memset(extra, '\0', strlen(extra)); -+ -+ sprintf(extra, "\n0x00\t"); -+ -+ for (i = 0; i < mapLen ; i++) { -+ sprintf(extra, "%s%02X", extra, rawdata[i]); -+ if ((i & 0xF) == 0xF) { -+ sprintf(extra, "%s\n", extra); -+ sprintf(extra, "%s0x%02x\t", extra, i + 1); -+ } else if ((i & 0x7) == 0x7) -+ sprintf(extra, "%s \t", extra); -+ else -+ sprintf(extra, "%s ", extra); -+ } -+ -+ } else if (strcmp(tmp[0], "realrawb") == 0) { -+ addr = 0; -+ mapLen = EFUSE_MAX_SIZE; -+ RTW_INFO("EFUSE_MAX_SIZE =%d\n", EFUSE_MAX_SIZE); -+ if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_access Fail!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ _rtw_memset(extra, '\0', strlen(extra)); -+ /* RTW_INFO("%s: realraw={\n", __FUNCTION__); */ -+ sprintf(extra, "\n0x00\t"); -+ for (i = 512; i < mapLen; i++) { -+ /* RTW_INFO("%02X", rawdata[i]); */ -+ sprintf(extra, "%s%02X", extra, rawdata[i]); -+ if ((i & 0xF) == 0xF) { -+ /* RTW_INFO("\n"); */ -+ sprintf(extra, "%s\n", extra); -+ sprintf(extra, "%s0x%02x\t", extra, i + 1); -+ } else if ((i & 0x7) == 0x7) { -+ /* RTW_INFO("\t"); */ -+ sprintf(extra, "%s \t", extra); -+ } else { -+ /* RTW_INFO(" "); */ -+ sprintf(extra, "%s ", extra); -+ } -+ } -+ /* RTW_INFO("}\n"); */ -+ } else if (strcmp(tmp[0], "mac") == 0) { -+ if (hal_efuse_macaddr_offset(padapter) == -1) { -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ addr = hal_efuse_macaddr_offset(padapter); -+ cnts = 6; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); -+ if ((addr + cnts) > max_available_len) { -+ RTW_INFO("%s: addr(0x%02x)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_efuse_mask_map_read(padapter, addr, cnts, data) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_mask_map_read error!\n", __func__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ /* RTW_INFO("%s: MAC address={", __FUNCTION__); */ -+ *extra = 0; -+ for (i = 0; i < cnts; i++) { -+ /* RTW_INFO("%02X", data[i]); */ -+ sprintf(extra, "%s%02X", extra, data[i]); -+ if (i != (cnts - 1)) { -+ /* RTW_INFO(":"); */ -+ sprintf(extra, "%s:", extra); -+ } -+ } -+ /* RTW_INFO("}\n"); */ -+ } else if (strcmp(tmp[0], "vidpid") == 0) { -+#ifdef CONFIG_RTL8188E -+#ifdef CONFIG_USB_HCI -+ addr = EEPROM_VID_88EU; -+#endif -+#ifdef CONFIG_PCI_HCI -+ addr = EEPROM_VID_88EE; -+#endif -+#endif /* CONFIG_RTL8188E */ -+ -+#ifdef CONFIG_RTL8192E -+#ifdef CONFIG_USB_HCI -+ addr = EEPROM_VID_8192EU; -+#endif -+#ifdef CONFIG_PCI_HCI -+ addr = EEPROM_VID_8192EE; -+#endif -+#endif /* CONFIG_RTL8192E */ -+#ifdef CONFIG_RTL8723B -+ addr = EEPROM_VID_8723BU; -+#endif /* CONFIG_RTL8192E */ -+ -+#ifdef CONFIG_RTL8188F -+ addr = EEPROM_VID_8188FU; -+#endif /* CONFIG_RTL8188F */ -+ -+#ifdef CONFIG_RTL8703B -+#ifdef CONFIG_USB_HCI -+ addr = EEPROM_VID_8703BU; -+#endif -+#endif /* CONFIG_RTL8703B */ -+ -+#ifdef CONFIG_RTL8723D -+#ifdef CONFIG_USB_HCI -+ addr = EEPROM_VID_8723DU; -+#endif /* CONFIG_USB_HCI */ -+#endif /* CONFIG_RTL8723D */ -+ -+ cnts = 4; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); -+ if ((addr + cnts) > max_available_len) { -+ RTW_INFO("%s: addr(0x%02x)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ if (rtw_efuse_mask_map_read(padapter, addr, cnts, data) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_access error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ /* RTW_INFO("%s: {VID,PID}={", __FUNCTION__); */ -+ *extra = 0; -+ for (i = 0; i < cnts; i++) { -+ /* RTW_INFO("0x%02x", data[i]); */ -+ sprintf(extra, "%s0x%02X", extra, data[i]); -+ if (i != (cnts - 1)) { -+ /* RTW_INFO(","); */ -+ sprintf(extra, "%s,", extra); -+ } -+ } -+ /* RTW_INFO("}\n"); */ -+ } else if (strcmp(tmp[0], "ableraw") == 0) { -+ efuse_GetCurrentSize(padapter, &raw_cursize); -+ raw_maxsize = efuse_GetMaxSize(padapter); -+ sprintf(extra, "[available raw size]= %d bytes\n", raw_maxsize - raw_cursize); -+ } else if (strcmp(tmp[0], "btableraw") == 0) { -+ efuse_bt_GetCurrentSize(padapter, &raw_cursize); -+ raw_maxsize = efuse_bt_GetMaxSize(padapter); -+ sprintf(extra, "[available raw size]= %d bytes\n", raw_maxsize - raw_cursize); -+ } else if (strcmp(tmp[0], "btfmap") == 0) { -+ -+ BTEfuse_PowerSwitch(padapter, 1, _TRUE); -+ -+ mapLen = EFUSE_BT_MAX_MAP_LEN; -+ if (rtw_BT_efuse_map_read(padapter, 0, mapLen, pEfuseHal->BTEfuseInitMap) == _FAIL) { -+ RTW_INFO("%s: rtw_BT_efuse_map_read Fail!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ /* RTW_INFO("OFFSET\tVALUE(hex)\n"); */ -+ sprintf(extra, "\n"); -+ for (i = 0; i < 512; i += 16) { /* set 512 because the iwpriv's extra size have limit 0x7FF */ -+ /* RTW_INFO("0x%03x\t", i); */ -+ sprintf(extra, "%s0x%03x\t", extra, i); -+ for (j = 0; j < 8; j++) { -+ /* RTW_INFO("%02X ", pEfuseHal->BTEfuseInitMap[i+j]); */ -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i + j]); -+ } -+ /* RTW_INFO("\t"); */ -+ sprintf(extra, "%s\t", extra); -+ for (; j < 16; j++) { -+ /* RTW_INFO("%02X ", pEfuseHal->BTEfuseInitMap[i+j]); */ -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i + j]); -+ } -+ /* RTW_INFO("\n"); */ -+ sprintf(extra, "%s\n", extra); -+ } -+ /* RTW_INFO("\n"); */ -+ } else if (strcmp(tmp[0], "btbmap") == 0) { -+ BTEfuse_PowerSwitch(padapter, 1, _TRUE); -+ -+ mapLen = EFUSE_BT_MAX_MAP_LEN; -+ if (rtw_BT_efuse_map_read(padapter, 0, mapLen, pEfuseHal->BTEfuseInitMap) == _FAIL) { -+ RTW_INFO("%s: rtw_BT_efuse_map_read Fail!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ /* RTW_INFO("OFFSET\tVALUE(hex)\n"); */ -+ sprintf(extra, "\n"); -+ for (i = 512; i < 1024 ; i += 16) { -+ /* RTW_INFO("0x%03x\t", i); */ -+ sprintf(extra, "%s0x%03x\t", extra, i); -+ for (j = 0; j < 8; j++) { -+ /* RTW_INFO("%02X ", data[i+j]); */ -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i + j]); -+ } -+ /* RTW_INFO("\t"); */ -+ sprintf(extra, "%s\t", extra); -+ for (; j < 16; j++) { -+ /* RTW_INFO("%02X ", data[i+j]); */ -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i + j]); -+ } -+ /* RTW_INFO("\n"); */ -+ sprintf(extra, "%s\n", extra); -+ } -+ /* RTW_INFO("\n"); */ -+ } else if (strcmp(tmp[0], "btrmap") == 0) { -+ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ BTEfuse_PowerSwitch(padapter, 1, _TRUE); -+ -+ /* rmap addr cnts */ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); -+ -+ cnts = simple_strtoul(tmp[2], &ptmp, 10); -+ if (cnts == 0) { -+ RTW_INFO("%s: btrmap Fail!! cnts error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); -+ if ((addr + cnts) > max_available_len) { -+ RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_BT_efuse_map_read(padapter, addr, cnts, data) == _FAIL) { -+ RTW_INFO("%s: rtw_BT_efuse_map_read error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ *extra = 0; -+ /* RTW_INFO("%s: bt efuse data={", __FUNCTION__); */ -+ for (i = 0; i < cnts; i++) { -+ /* RTW_INFO("0x%02x ", data[i]); */ -+ sprintf(extra, "%s 0x%02X ", extra, data[i]); -+ } -+ /* RTW_INFO("}\n"); */ -+ RTW_INFO(FUNC_ADPT_FMT ": BT MAC=[%s]\n", FUNC_ADPT_ARG(padapter), extra); -+ } else if (strcmp(tmp[0], "btffake") == 0) { -+ /* RTW_INFO("OFFSET\tVALUE(hex)\n"); */ -+ sprintf(extra, "\n"); -+ for (i = 0; i < 512; i += 16) { -+ /* RTW_INFO("0x%03x\t", i); */ -+ sprintf(extra, "%s0x%03x\t", extra, i); -+ for (j = 0; j < 8; j++) { -+ /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i + j]); -+ } -+ /* RTW_INFO("\t"); */ -+ sprintf(extra, "%s\t", extra); -+ for (; j < 16; j++) { -+ /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i + j]); -+ } -+ /* RTW_INFO("\n"); */ -+ sprintf(extra, "%s\n", extra); -+ } -+ /* RTW_INFO("\n"); */ -+ } else if (strcmp(tmp[0], "btbfake") == 0) { -+ /* RTW_INFO("OFFSET\tVALUE(hex)\n"); */ -+ sprintf(extra, "\n"); -+ for (i = 512; i < 1024; i += 16) { -+ /* RTW_INFO("0x%03x\t", i); */ -+ sprintf(extra, "%s0x%03x\t", extra, i); -+ for (j = 0; j < 8; j++) { -+ /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i + j]); -+ } -+ /* RTW_INFO("\t"); */ -+ sprintf(extra, "%s\t", extra); -+ for (; j < 16; j++) { -+ /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i + j]); -+ } -+ /* RTW_INFO("\n"); */ -+ sprintf(extra, "%s\n", extra); -+ } -+ /* RTW_INFO("\n"); */ -+ } else if (strcmp(tmp[0], "wlrfkmap") == 0) { -+ static u8 fk_order = 0; -+ u8 *efuse; -+ u32 shift, cnt; -+ u32 blksz = 0x200; /* The size of one time show, default 512 */ -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&mapLen, _FALSE); -+ efuse = pEfuseHal->fakeEfuseModifiedMap; -+ -+ shift = blksz * fk_order; -+ efuse += shift; -+ cnt = mapLen - shift; -+ if (cnt > blksz) { -+ cnt = blksz; -+ fk_order++; -+ } else -+ fk_order = 0; -+ -+ sprintf(extra, "\n"); -+ for (i = 0; i < cnt; i += 16) { -+ sprintf(extra, "%s0x%02x\t", extra, shift + i); -+ for (j = 0; j < 8; j++) -+ sprintf(extra, "%s%02X ", extra, efuse[i + j]); -+ sprintf(extra, "%s\t", extra); -+ for (; j < 16; j++) -+ sprintf(extra, "%s%02X ", extra, efuse[i + j]); -+ sprintf(extra, "%s\n", extra); -+ } -+ if ((shift + cnt) < mapLen) -+ sprintf(extra, "%s\t...more\n", extra); -+ -+ } else if (strcmp(tmp[0], "wlrfkrmap") == 0) { -+ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { -+ RTW_INFO("%s: rmap Fail!! Parameters error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ /* rmap addr cnts */ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ RTW_INFO("%s: addr=%x\n", __FUNCTION__, addr); -+ -+ cnts = simple_strtoul(tmp[2], &ptmp, 10); -+ if (cnts == 0) { -+ RTW_INFO("%s: rmap Fail!! cnts error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ -+ /* RTW_INFO("%s: data={", __FUNCTION__); */ -+ *extra = 0; -+ for (i = 0; i < cnts; i++) { -+ RTW_INFO("wlrfkrmap = 0x%02x\n", pEfuseHal->fakeEfuseModifiedMap[addr + i]); -+ sprintf(extra, "%s0x%02X ", extra, pEfuseHal->fakeEfuseModifiedMap[addr + i]); -+ } -+ } else if (strcmp(tmp[0], "btrfkrmap") == 0) { -+ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { -+ RTW_INFO("%s: rmap Fail!! Parameters error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ /* rmap addr cnts */ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ RTW_INFO("%s: addr=%x\n", __FUNCTION__, addr); -+ -+ cnts = simple_strtoul(tmp[2], &ptmp, 10); -+ if (cnts == 0) { -+ RTW_INFO("%s: rmap Fail!! cnts error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ -+ /* RTW_INFO("%s: data={", __FUNCTION__); */ -+ *extra = 0; -+ for (i = 0; i < cnts; i++) { -+ RTW_INFO("wlrfkrmap = 0x%02x\n", pEfuseHal->fakeBTEfuseModifiedMap[addr + i]); -+ sprintf(extra, "%s0x%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[addr + i]); -+ } -+ } else if (strcmp(tmp[0], "mask") == 0) { -+ *extra = 0; -+ mask_len = sizeof(u8) * rtw_get_efuse_mask_arraylen(padapter); -+ rtw_efuse_mask_array(padapter, mask_buf); -+ -+ if (padapter->registrypriv.bFileMaskEfuse == _TRUE) -+ _rtw_memcpy(mask_buf, maskfileBuffer, mask_len); -+ -+ sprintf(extra, "\n"); -+ for (i = 0; i < mask_len; i++) -+ sprintf(extra, "%s0x%02X\n", extra, mask_buf[i]); -+ -+ } else -+ sprintf(extra, "Command not found!"); -+ -+exit: -+ if (data) -+ rtw_mfree(data, EFUSE_BT_MAX_MAP_LEN); -+ if (rawdata) -+ rtw_mfree(rawdata, EFUSE_BT_MAX_MAP_LEN); -+ if (!err) -+ wrqu->length = strlen(extra); -+ -+ if (padapter->registrypriv.mp_mode == 0) { -+#ifdef CONFIG_IPS -+ rtw_pm_set_ips(padapter, ips_mode); -+#endif /* CONFIG_IPS */ -+ -+#ifdef CONFIG_LPS -+ rtw_pm_set_lps(padapter, lps_mode); -+#endif /* CONFIG_LPS */ -+ } -+ -+#ifdef CONFIG_IOL -+ padapter->registrypriv.fw_iol = org_fw_iol;/* 0:Disable, 1:enable, 2:by usb speed */ -+#endif -+ return err; -+} -+ -+static int rtw_mp_efuse_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wdata, char *extra) -+{ -+ struct iw_point *wrqu; -+ PADAPTER padapter; -+ struct pwrctrl_priv *pwrctrlpriv ; -+ PHAL_DATA_TYPE pHalData; -+ PEFUSE_HAL pEfuseHal; -+ struct hal_ops *pHalFunc; -+ struct mp_priv *pmp_priv; -+ -+ u8 ips_mode = IPS_NUM; /* init invalid value */ -+ u8 lps_mode = PS_MODE_NUM; /* init invalid value */ -+ u32 i = 0, j = 0, jj, kk; -+ u8 *setdata = NULL; -+ u8 *ShadowMapBT = NULL; -+ u8 *ShadowMapWiFi = NULL; -+ u8 *setrawdata = NULL; -+ char *pch, *ptmp, *token, *tmp[3] = {0x00, 0x00, 0x00}; -+ u16 addr = 0xFF, cnts = 0, BTStatus = 0 , max_available_len = 0; -+ u16 wifimaplen; -+ int err; -+ -+ wrqu = (struct iw_point *)wdata; -+ padapter = rtw_netdev_priv(dev); -+ pwrctrlpriv = adapter_to_pwrctl(padapter); -+ pHalData = GET_HAL_DATA(padapter); -+ pEfuseHal = &pHalData->EfuseHal; -+ pHalFunc = &padapter->HalFunc; -+ pmp_priv = &padapter->mppriv; -+ -+ err = 0; -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&wifimaplen, _FALSE); -+ -+ setdata = rtw_zmalloc(1024); -+ if (setdata == NULL) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ ShadowMapBT = rtw_malloc(EFUSE_BT_MAX_MAP_LEN); -+ if (ShadowMapBT == NULL) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ ShadowMapWiFi = rtw_malloc(wifimaplen); -+ if (ShadowMapWiFi == NULL) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ setrawdata = rtw_malloc(EFUSE_MAX_SIZE); -+ if (setrawdata == NULL) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+#ifdef CONFIG_LPS -+ lps_mode = pwrctrlpriv->power_mgnt;/* keep org value */ -+ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); -+#endif -+ -+#ifdef CONFIG_IPS -+ ips_mode = pwrctrlpriv->ips_mode;/* keep org value */ -+ rtw_pm_set_ips(padapter, IPS_NONE); -+#endif -+ -+ pch = extra; -+ RTW_INFO("%s: in=%s\n", __FUNCTION__, extra); -+ -+ i = 0; -+ while ((token = strsep(&pch, ",")) != NULL) { -+ if (i > 2) -+ break; -+ tmp[i] = token; -+ i++; -+ } -+ -+ /* tmp[0],[1],[2] */ -+ /* wmap,addr,00e04c871200 */ -+ if (strcmp(tmp[0], "wmap") == 0) { -+ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+#ifndef RTW_HALMAC -+ /* unknown bug workaround, need to fix later */ -+ addr = 0x1ff; -+ rtw_write8(padapter, EFUSE_CTRL + 1, (addr & 0xff)); -+ rtw_msleep_os(10); -+ rtw_write8(padapter, EFUSE_CTRL + 2, ((addr >> 8) & 0x03)); -+ rtw_msleep_os(10); -+ rtw_write8(padapter, EFUSE_CTRL + 3, 0x72); -+ rtw_msleep_os(10); -+ rtw_read8(padapter, EFUSE_CTRL); -+#endif /* RTW_HALMAC */ -+ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ addr &= 0xFFF; -+ -+ cnts = strlen(tmp[2]); -+ if (cnts % 2) { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ RTW_INFO("%s: map data=%s\n", __FUNCTION__, tmp[2]); -+ -+ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) -+ setdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); -+ -+ if ((addr + cnts) > max_available_len) { -+ RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_map_write error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ *extra = 0; -+ RTW_INFO("%s: after rtw_efuse_map_write to _rtw_memcmp\n", __func__); -+ if (rtw_efuse_mask_map_read(padapter, addr, cnts, ShadowMapWiFi) == _SUCCESS) { -+ if (_rtw_memcmp((void *)ShadowMapWiFi , (void *)setdata, cnts)) { -+ RTW_INFO("%s: WiFi write map afterf compare success\n", __FUNCTION__); -+ sprintf(extra, "WiFi write map compare OK\n"); -+ err = 0; -+ goto exit; -+ } else { -+ sprintf(extra, "WiFi write map compare FAIL\n"); -+ RTW_INFO("%s: WiFi write map compare Fail\n", __FUNCTION__); -+ err = 0; -+ goto exit; -+ } -+ } -+ } else if (strcmp(tmp[0], "wraw") == 0) { -+ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ addr &= 0xFFF; -+ -+ cnts = strlen(tmp[2]); -+ if (cnts % 2) { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ RTW_INFO("%s: raw data=%s\n", __FUNCTION__, tmp[2]); -+ -+ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) -+ setrawdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); -+ -+ if (rtw_efuse_access(padapter, _TRUE, addr, cnts, setrawdata) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_access error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ } else if (strcmp(tmp[0], "btwraw") == 0) { -+ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ addr &= 0xFFF; -+ -+ cnts = strlen(tmp[2]); -+ if (cnts % 2) { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ RTW_INFO("%s: raw data=%s\n", __FUNCTION__, tmp[2]); -+ -+ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) -+ setrawdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); -+#ifdef RTW_HALMAC -+ if (rtw_efuse_bt_access(padapter, _TRUE, addr, cnts, setrawdata) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_access error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+#else -+ rtw_write8(padapter, 0x35, 1); /* switch bank 1 (BT)*/ -+ if (rtw_efuse_access(padapter, _TRUE, addr, cnts, setrawdata) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_access error!!\n", __FUNCTION__); -+ rtw_write8(padapter, 0x35, 0); /* switch bank 0 (WiFi)*/ -+ err = -EFAULT; -+ goto exit; -+ } -+ rtw_write8(padapter, 0x35, 0); /* switch bank 0 (WiFi)*/ -+#endif -+ } else if (strcmp(tmp[0], "mac") == 0) { -+ if (tmp[1] == NULL) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ /* mac,00e04c871200 */ -+ -+ if (hal_efuse_macaddr_offset(padapter) == -1) { -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ addr = hal_efuse_macaddr_offset(padapter); -+ cnts = strlen(tmp[1]); -+ if (cnts % 2) { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) { -+ err = -EINVAL; -+ goto exit; -+ } -+ if (cnts > 6) { -+ RTW_INFO("%s: error data for mac addr=\"%s\"\n", __FUNCTION__, tmp[1]); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ RTW_INFO("%s: MAC address=%s\n", __FUNCTION__, tmp[1]); -+ -+ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) -+ setdata[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); -+ -+ if ((addr + cnts) > max_available_len) { -+ RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_map_write error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ } else if (strcmp(tmp[0], "vidpid") == 0) { -+ if (tmp[1] == NULL) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ /* pidvid,da0b7881 */ -+#ifdef CONFIG_RTL8188E -+#ifdef CONFIG_USB_HCI -+ addr = EEPROM_VID_88EU; -+#endif -+#ifdef CONFIG_PCI_HCI -+ addr = EEPROM_VID_88EE; -+#endif -+#endif /* CONFIG_RTL8188E */ -+ -+#ifdef CONFIG_RTL8192E -+#ifdef CONFIG_USB_HCI -+ addr = EEPROM_VID_8192EU; -+#endif -+#ifdef CONFIG_PCI_HCI -+ addr = EEPROM_VID_8192EE; -+#endif -+#endif /* CONFIG_RTL8188E */ -+ -+#ifdef CONFIG_RTL8723B -+ addr = EEPROM_VID_8723BU; -+#endif -+ -+#ifdef CONFIG_RTL8188F -+ addr = EEPROM_VID_8188FU; -+#endif -+ -+#ifdef CONFIG_RTL8703B -+#ifdef CONFIG_USB_HCI -+ addr = EEPROM_VID_8703BU; -+#endif /* CONFIG_USB_HCI */ -+#endif /* CONFIG_RTL8703B */ -+ -+#ifdef CONFIG_RTL8723D -+#ifdef CONFIG_USB_HCI -+ addr = EEPROM_VID_8723DU; -+#endif /* CONFIG_USB_HCI */ -+#endif /* CONFIG_RTL8723D */ -+ -+ cnts = strlen(tmp[1]); -+ if (cnts % 2) { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ RTW_INFO("%s: VID/PID=%s\n", __FUNCTION__, tmp[1]); -+ -+ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) -+ setdata[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); -+ if ((addr + cnts) > max_available_len) { -+ RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_map_write error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ } else if (strcmp(tmp[0], "wldumpfake") == 0) { -+ if (wifimaplen > EFUSE_MAX_MAP_LEN) -+ cnts = EFUSE_MAX_MAP_LEN; -+ else -+ cnts = wifimaplen; -+ if (rtw_efuse_mask_map_read(padapter, 0, cnts, pEfuseHal->fakeEfuseModifiedMap) == _SUCCESS) -+ RTW_INFO("%s: WiFi hw efuse dump to Fake map success\n", __func__); -+ else { -+ RTW_INFO("%s: WiFi hw efuse dump to Fake map Fail\n", __func__); -+ err = -EFAULT; -+ } -+ } else if (strcmp(tmp[0], "btwmap") == 0) { -+ rtw_write8(padapter, 0xa3, 0x05); /* For 8723AB ,8821S ? */ -+ BTStatus = rtw_read8(padapter, 0xa0); -+ RTW_INFO("%s: btwmap before read 0xa0 BT Status =0x%x\n", __FUNCTION__, BTStatus); -+ if (BTStatus != 0x04) { -+ sprintf(extra, "BT Status not Active ,can't do Write\n"); -+ goto exit; -+ } -+ -+ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+#ifndef RTW_HALMAC -+ BTEfuse_PowerSwitch(padapter, 1, _TRUE); -+ addr = 0x1ff; -+ rtw_write8(padapter, EFUSE_CTRL + 1, (addr & 0xff)); -+ rtw_msleep_os(10); -+ rtw_write8(padapter, EFUSE_CTRL + 2, ((addr >> 8) & 0x03)); -+ rtw_msleep_os(10); -+ rtw_write8(padapter, EFUSE_CTRL + 3, 0x72); -+ rtw_msleep_os(10); -+ rtw_read8(padapter, EFUSE_CTRL); -+ BTEfuse_PowerSwitch(padapter, 1, _FALSE); -+#endif /* RTW_HALMAC */ -+ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ addr &= 0xFFF; -+ -+ cnts = strlen(tmp[2]); -+ if (cnts % 2) { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ RTW_INFO("%s: BT data=%s\n", __FUNCTION__, tmp[2]); -+ -+ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) -+ setdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); -+#ifdef CONFIG_RTL8703B -+ if (cnts == 1 && addr == 0x189) { -+ setdata[1] = setdata[0]; -+ setdata[0] = 0x00; -+ cnts += 1; -+ addr = 0x188; -+ RTW_INFO("addr 0x%x ,setdata=0x%X 0x%X\n", addr, setdata[0], setdata[1]); -+ } else if (cnts == 1 && addr == 0x161) { -+ setdata[1] = setdata[0]; -+ setdata[0] = 0xFE; -+ cnts += 1; -+ addr = 0x160; -+ RTW_INFO("addr 0x%x ,setdata=0x%X 0x%X\n", addr, setdata[0], setdata[1]); -+ } -+#endif -+#ifndef RTW_HALMAC -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); -+ if ((addr + cnts) > max_available_len) { -+ RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+#endif -+ if (rtw_BT_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) { -+ RTW_INFO("%s: rtw_BT_efuse_map_write error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ *extra = 0; -+ RTW_INFO("%s: after rtw_BT_efuse_map_write to _rtw_memcmp\n", __FUNCTION__); -+ if ((rtw_BT_efuse_map_read(padapter, addr, cnts, ShadowMapBT) == _SUCCESS)) { -+ if (_rtw_memcmp((void *)ShadowMapBT , (void *)setdata, cnts)) { -+ RTW_INFO("%s: BT write map compare OK BTStatus=0x%x\n", __FUNCTION__, BTStatus); -+ sprintf(extra, "BT write map compare OK"); -+ err = 0; -+ goto exit; -+ } else { -+ sprintf(extra, "BT write map compare FAIL"); -+ RTW_INFO("%s: BT write map compare FAIL BTStatus=0x%x\n", __FUNCTION__, BTStatus); -+ err = 0; -+ goto exit; -+ } -+ } -+ } else if (strcmp(tmp[0], "btwfake") == 0) { -+ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ addr &= 0xFFF; -+ -+ cnts = strlen(tmp[2]); -+ if (cnts % 2) { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ RTW_INFO("%s: BT tmp data=%s\n", __FUNCTION__, tmp[2]); -+ -+ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) -+ pEfuseHal->fakeBTEfuseModifiedMap[addr + jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); -+ } else if (strcmp(tmp[0], "btdumpfake") == 0) { -+ if (rtw_BT_efuse_map_read(padapter, 0, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseModifiedMap) == _SUCCESS) -+ RTW_INFO("%s: BT read all map success\n", __FUNCTION__); -+ else { -+ RTW_INFO("%s: BT read all map Fail!\n", __FUNCTION__); -+ err = -EFAULT; -+ } -+ } else if (strcmp(tmp[0], "btfk2map") == 0) { -+ rtw_write8(padapter, 0xa3, 0x05); -+ BTStatus = rtw_read8(padapter, 0xa0); -+ RTW_INFO("%s: btwmap before read 0xa0 BT Status =0x%x\n", __FUNCTION__, BTStatus); -+ if (BTStatus != 0x04) { -+ sprintf(extra, "BT Status not Active Write FAIL\n"); -+ goto exit; -+ } -+#ifndef RTW_HALMAC -+ BTEfuse_PowerSwitch(padapter, 1, _TRUE); -+ addr = 0x1ff; -+ rtw_write8(padapter, EFUSE_CTRL + 1, (addr & 0xff)); -+ rtw_msleep_os(10); -+ rtw_write8(padapter, EFUSE_CTRL + 2, ((addr >> 8) & 0x03)); -+ rtw_msleep_os(10); -+ rtw_write8(padapter, EFUSE_CTRL + 3, 0x72); -+ rtw_msleep_os(10); -+ rtw_read8(padapter, EFUSE_CTRL); -+ BTEfuse_PowerSwitch(padapter, 1, _FALSE); -+#endif /* RTW_HALMAC */ -+ _rtw_memcpy(pEfuseHal->BTEfuseModifiedMap, pEfuseHal->fakeBTEfuseModifiedMap, EFUSE_BT_MAX_MAP_LEN); -+ -+ if (rtw_BT_efuse_map_write(padapter, 0x00, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseModifiedMap) == _FAIL) { -+ RTW_INFO("%s: rtw_BT_efuse_map_write error!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ RTW_INFO("pEfuseHal->fakeBTEfuseModifiedMap OFFSET\tVALUE(hex)\n"); -+ for (i = 0; i < EFUSE_BT_MAX_MAP_LEN; i += 16) { -+ printk("0x%02x\t", i); -+ for (j = 0; j < 8; j++) -+ printk("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i + j]); -+ printk("\t"); -+ -+ for (; j < 16; j++) -+ printk("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i + j]); -+ printk("\n"); -+ } -+ printk("\n"); -+#if 1 -+ err = -EFAULT; -+ RTW_INFO("%s: rtw_BT_efuse_map_read _rtw_memcmp\n", __FUNCTION__); -+ if ((rtw_BT_efuse_map_read(padapter, 0x00, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseInitMap) == _SUCCESS)) { -+ if (_rtw_memcmp((void *)pEfuseHal->fakeBTEfuseModifiedMap, (void *)pEfuseHal->fakeBTEfuseInitMap, EFUSE_BT_MAX_MAP_LEN)) { -+ sprintf(extra, "BT write map compare OK"); -+ RTW_INFO("%s: BT write map afterf compare success BTStatus=0x%x\n", __FUNCTION__, BTStatus); -+ err = 0; -+ goto exit; -+ } else { -+ sprintf(extra, "BT write map compare FAIL"); -+ if (rtw_BT_efuse_map_write(padapter, 0x00, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseModifiedMap) == _FAIL) -+ RTW_INFO("%s: rtw_BT_efuse_map_write compare error,retry = %d!\n", __FUNCTION__, i); -+ -+ if (rtw_BT_efuse_map_read(padapter, EFUSE_BT, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseInitMap) == _SUCCESS) { -+ RTW_INFO("pEfuseHal->fakeBTEfuseInitMap OFFSET\tVALUE(hex)\n"); -+ -+ for (i = 0; i < EFUSE_BT_MAX_MAP_LEN; i += 16) { -+ printk("0x%02x\t", i); -+ for (j = 0; j < 8; j++) -+ printk("%02X ", pEfuseHal->fakeBTEfuseInitMap[i + j]); -+ printk("\t"); -+ for (; j < 16; j++) -+ printk("%02X ", pEfuseHal->fakeBTEfuseInitMap[i + j]); -+ printk("\n"); -+ } -+ printk("\n"); -+ } -+ RTW_INFO("%s: BT write map afterf compare not match to write efuse try write Map again , BTStatus=0x%x\n", __FUNCTION__, BTStatus); -+ goto exit; -+ } -+ } -+#endif -+ -+ } else if (strcmp(tmp[0], "wlfk2map") == 0) { -+ *extra = 0; -+ -+ if (padapter->registrypriv.bFileMaskEfuse != _TRUE && pmp_priv->bloadefusemap == _TRUE) { -+ RTW_INFO("%s: File eFuse mask file not to be loaded\n", __FUNCTION__); -+ sprintf(extra, "Not load eFuse mask file yet, Please use the efuse_mask CMD.\n"); -+ err = 0; -+ goto exit; -+ } -+ -+ if (wifimaplen > EFUSE_MAX_MAP_LEN) -+ cnts = EFUSE_MAX_MAP_LEN; -+ else -+ cnts = wifimaplen; -+ if (rtw_efuse_map_write(padapter, 0x00, cnts, pEfuseHal->fakeEfuseModifiedMap) == _FAIL) { -+ RTW_INFO("%s: rtw_efuse_map_write fakeEfuseModifiedMap error!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_efuse_mask_map_read(padapter, 0x00, wifimaplen, ShadowMapWiFi) == _SUCCESS) { -+ if (_rtw_memcmp((void *)ShadowMapWiFi , (void *)pEfuseHal->fakeEfuseModifiedMap, cnts)) { -+ RTW_INFO("%s: WiFi write map afterf compare OK\n", __FUNCTION__); -+ sprintf(extra, "WiFi write map compare OK\n"); -+ err = 0; -+ goto exit; -+ } else { -+ sprintf(extra, "WiFi write map compare FAIL\n"); -+ RTW_INFO("%s: WiFi write map compare Fail\n", __FUNCTION__); -+ err = 0; -+ goto exit; -+ } -+ } -+ } else if (strcmp(tmp[0], "wlwfake") == 0) { -+ if ((tmp[1] == NULL) || (tmp[2] == NULL)) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ addr &= 0xFFF; -+ -+ cnts = strlen(tmp[2]); -+ if (cnts % 2) { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ RTW_INFO("%s: map tmp data=%s\n", __FUNCTION__, tmp[2]); -+ -+ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) -+ pEfuseHal->fakeEfuseModifiedMap[addr + jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); -+ _rtw_memset(extra, '\0', strlen(extra)); -+ sprintf(extra, "wlwfake OK\n"); -+ -+ } -+ else if (strcmp(tmp[0], "wfakemac") == 0) { -+ if (tmp[1] == NULL) { -+ err = -EINVAL; -+ goto exit; -+ } -+ /* wfakemac,00e04c871200 */ -+ if (hal_efuse_macaddr_offset(padapter) == -1) { -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ addr = hal_efuse_macaddr_offset(padapter); -+ cnts = strlen(tmp[1]); -+ if (cnts % 2) { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) { -+ err = -EINVAL; -+ goto exit; -+ } -+ if (cnts > 6) { -+ RTW_INFO("%s: error data for mac addr=\"%s\"\n", __FUNCTION__, tmp[1]); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr); -+ RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); -+ RTW_INFO("%s: MAC address=%s\n", __FUNCTION__, tmp[1]); -+ -+ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) -+ pEfuseHal->fakeEfuseModifiedMap[addr + jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); -+ -+ _rtw_memset(extra, '\0', strlen(extra)); -+ sprintf(extra, "write mac addr to fake map OK\n"); -+ } else if(strcmp(tmp[0], "update") == 0) { -+ RTW_INFO("To Use new eFuse map\n"); -+ /*step read efuse/eeprom data and get mac_addr*/ -+ rtw_hal_read_chip_info(padapter); -+ /* set mac addr*/ -+ rtw_macaddr_cfg(adapter_mac_addr(padapter), get_hal_mac_addr(padapter)); -+ _rtw_memcpy(padapter->pnetdev->dev_addr, get_hal_mac_addr(padapter), ETH_ALEN); /* set mac addr to net_device */ -+ -+#ifdef CONFIG_P2P -+ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); -+#endif -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_hal_change_macaddr_mbid(padapter, adapter_mac_addr(padapter)); -+#else -+ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, adapter_mac_addr(padapter)); /* set mac addr to mac register */ -+#endif -+ /*pHalFunc->hal_deinit(padapter);*/ -+ if (pHalFunc->hal_init(padapter) == _FAIL) { -+ err = -EINVAL; -+ goto exit; -+ } -+ _rtw_memset(extra, '\0', strlen(extra)); -+ sprintf(extra, "eFuse Update OK\n"); -+ } -+ -+exit: -+ if (setdata) -+ rtw_mfree(setdata, 1024); -+ if (ShadowMapBT) -+ rtw_mfree(ShadowMapBT, EFUSE_BT_MAX_MAP_LEN); -+ if (ShadowMapWiFi) -+ rtw_mfree(ShadowMapWiFi, wifimaplen); -+ if (setrawdata) -+ rtw_mfree(setrawdata, EFUSE_MAX_SIZE); -+ -+ wrqu->length = strlen(extra); -+ -+ if (padapter->registrypriv.mp_mode == 0) { -+#ifdef CONFIG_IPS -+ rtw_pm_set_ips(padapter, ips_mode); -+#endif /* CONFIG_IPS */ -+ -+#ifdef CONFIG_LPS -+ rtw_pm_set_lps(padapter, lps_mode); -+#endif /* CONFIG_LPS */ -+ } -+ -+ return err; -+} -+ -+#ifdef CONFIG_MP_INCLUDED -+ -+#ifdef CONFIG_RTW_CUSTOMER_STR -+static int rtw_mp_customer_str( -+ struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *adapter = rtw_netdev_priv(dev); -+ u32 len; -+ u8 *pbuf = NULL, *pch; -+ char *ptmp; -+ u8 param[RTW_CUSTOMER_STR_LEN]; -+ u8 count = 0; -+ u8 tmp; -+ u8 i; -+ u32 pos; -+ u8 ret; -+ u8 read = 0; -+ -+ if (adapter->registrypriv.mp_mode != 1 -+ || !adapter->registrypriv.mp_customer_str) -+ return -EFAULT; -+ -+ len = wrqu->data.length; -+ -+ pbuf = (u8 *)rtw_zmalloc(len); -+ if (pbuf == NULL) { -+ RTW_WARN("%s: no memory!\n", __func__); -+ return -ENOMEM; -+ } -+ -+ if (copy_from_user(pbuf, wrqu->data.pointer, len)) { -+ rtw_mfree(pbuf, len); -+ RTW_WARN("%s: copy from user fail!\n", __func__); -+ return -EFAULT; -+ } -+ RTW_INFO("%s: string=\"%s\"\n", __func__, pbuf); -+ -+ ptmp = (char *)pbuf; -+ pch = strsep(&ptmp, ","); -+ if ((pch == NULL) || (strlen(pch) == 0)) { -+ rtw_mfree(pbuf, len); -+ RTW_INFO("%s: parameter error(no cmd)!\n", __func__); -+ return -EFAULT; -+ } -+ -+ _rtw_memset(param, 0xFF, RTW_CUSTOMER_STR_LEN); -+ -+ if (strcmp(pch, "read") == 0) { -+ read = 1; -+ ret = rtw_hal_customer_str_read(adapter, param); -+ -+ } else if (strcmp(pch, "write") == 0) { -+ do { -+ pch = strsep(&ptmp, ":"); -+ if ((pch == NULL) || (strlen(pch) == 0)) -+ break; -+ if (strlen(pch) != 2 -+ || IsHexDigit(*pch) == _FALSE -+ || IsHexDigit(*(pch + 1)) == _FALSE -+ || sscanf(pch, "%hhx", &tmp) != 1 -+ ) { -+ RTW_WARN("%s: invalid 8-bit hex!\n", __func__); -+ rtw_mfree(pbuf, len); -+ return -EFAULT; -+ } -+ -+ param[count++] = tmp; -+ -+ } while (count < RTW_CUSTOMER_STR_LEN); -+ -+ if (count == 0) { -+ rtw_mfree(pbuf, len); -+ RTW_WARN("%s: no input!\n", __func__); -+ return -EFAULT; -+ } -+ ret = rtw_hal_customer_str_write(adapter, param); -+ } else { -+ rtw_mfree(pbuf, len); -+ RTW_INFO("%s: parameter error(unknown cmd)!\n", __func__); -+ return -EFAULT; -+ } -+ -+ pos = sprintf(extra, "%s: ", read ? "read" : "write"); -+ if (read == 0 || ret == _SUCCESS) { -+ for (i = 0; i < RTW_CUSTOMER_STR_LEN; i++) -+ pos += sprintf(extra + pos, "%02x:", param[i]); -+ extra[pos] = 0; -+ pos--; -+ } -+ pos += sprintf(extra + pos, " %s", ret == _SUCCESS ? "OK" : "FAIL"); -+ -+ wrqu->data.length = strlen(extra) + 1; -+ -+free_buf: -+ rtw_mfree(pbuf, len); -+ return 0; -+} -+#endif /* CONFIG_RTW_CUSTOMER_STR */ -+ -+static int rtw_priv_mp_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wdata, char *extra) -+{ -+ -+ struct iw_point *wrqu = (struct iw_point *)wdata; -+ u32 subcmd = wrqu->flags; -+ -+ switch (subcmd) { -+ case CTA_TEST: -+ RTW_INFO("set CTA_TEST\n"); -+ rtw_cta_test_start(dev, info, wdata, extra); -+ break; -+ case MP_DISABLE_BT_COEXIST: -+ RTW_INFO("set case MP_DISABLE_BT_COEXIST\n"); -+ rtw_mp_disable_bt_coexist(dev, info, wdata, extra); -+ break; -+ case MP_IQK: -+ RTW_INFO("set MP_IQK\n"); -+ rtw_mp_iqk(dev, info, wrqu, extra); -+ break; -+ case MP_LCK: -+ RTW_INFO("set MP_LCK\n"); -+ rtw_mp_lck(dev, info, wrqu, extra); -+ break; -+ -+ default: -+ return -EIO; -+ } -+ -+ return 0; -+} -+ -+static int rtw_priv_mp_get(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wdata, char *extra) -+{ -+ -+ struct iw_point *wrqu = (struct iw_point *)wdata; -+ u32 subcmd = wrqu->flags; -+ -+ switch (subcmd) { -+ case MP_START: -+ RTW_INFO("set case mp_start\n"); -+ rtw_mp_start(dev, info, wrqu, extra); -+ break; -+ case MP_STOP: -+ RTW_INFO("set case mp_stop\n"); -+ rtw_mp_stop(dev, info, wrqu, extra); -+ break; -+ case MP_BANDWIDTH: -+ RTW_INFO("set case mp_bandwidth\n"); -+ rtw_mp_bandwidth(dev, info, wrqu, extra); -+ break; -+ case MP_RESET_STATS: -+ RTW_INFO("set case MP_RESET_STATS\n"); -+ rtw_mp_reset_stats(dev, info, wrqu, extra); -+ break; -+ case MP_SetRFPathSwh: -+ RTW_INFO("set MP_SetRFPathSwitch\n"); -+ rtw_mp_SetRFPath(dev, info, wrqu, extra); -+ break; -+ case WRITE_REG: -+ rtw_mp_write_reg(dev, info, wrqu, extra); -+ break; -+ case WRITE_RF: -+ rtw_mp_write_rf(dev, info, wrqu, extra); -+ break; -+ case MP_PHYPARA: -+ RTW_INFO("mp_get MP_PHYPARA\n"); -+ rtw_mp_phypara(dev, info, wrqu, extra); -+ break; -+ case MP_CHANNEL: -+ RTW_INFO("set case mp_channel\n"); -+ rtw_mp_channel(dev , info, wrqu, extra); -+ break; -+ case READ_REG: -+ RTW_INFO("mp_get READ_REG\n"); -+ rtw_mp_read_reg(dev, info, wrqu, extra); -+ break; -+ case READ_RF: -+ RTW_INFO("mp_get READ_RF\n"); -+ rtw_mp_read_rf(dev, info, wrqu, extra); -+ break; -+ case MP_RATE: -+ RTW_INFO("set case mp_rate\n"); -+ rtw_mp_rate(dev, info, wrqu, extra); -+ break; -+ case MP_TXPOWER: -+ RTW_INFO("set case MP_TXPOWER\n"); -+ rtw_mp_txpower(dev, info, wrqu, extra); -+ break; -+ case MP_ANT_TX: -+ RTW_INFO("set case MP_ANT_TX\n"); -+ rtw_mp_ant_tx(dev, info, wrqu, extra); -+ break; -+ case MP_ANT_RX: -+ RTW_INFO("set case MP_ANT_RX\n"); -+ rtw_mp_ant_rx(dev, info, wrqu, extra); -+ break; -+ case MP_QUERY: -+ rtw_mp_trx_query(dev, info, wrqu, extra); -+ break; -+ case MP_CTX: -+ RTW_INFO("set case MP_CTX\n"); -+ rtw_mp_ctx(dev, info, wrqu, extra); -+ break; -+ case MP_ARX: -+ RTW_INFO("set case MP_ARX\n"); -+ rtw_mp_arx(dev, info, wrqu, extra); -+ break; -+ case MP_DUMP: -+ RTW_INFO("set case MP_DUMP\n"); -+ rtw_mp_dump(dev, info, wrqu, extra); -+ break; -+ case MP_PSD: -+ RTW_INFO("set case MP_PSD\n"); -+ rtw_mp_psd(dev, info, wrqu, extra); -+ break; -+ case MP_THER: -+ RTW_INFO("set case MP_THER\n"); -+ rtw_mp_thermal(dev, info, wrqu, extra); -+ break; -+ case MP_PwrCtlDM: -+ RTW_INFO("set MP_PwrCtlDM\n"); -+ rtw_mp_PwrCtlDM(dev, info, wrqu, extra); -+ break; -+ case MP_QueryDrvStats: -+ RTW_INFO("mp_get MP_QueryDrvStats\n"); -+ rtw_mp_QueryDrv(dev, info, wdata, extra); -+ break; -+ case MP_PWRTRK: -+ RTW_INFO("set case MP_PWRTRK\n"); -+ rtw_mp_pwrtrk(dev, info, wrqu, extra); -+ break; -+ case EFUSE_SET: -+ RTW_INFO("set case efuse set\n"); -+ rtw_mp_efuse_set(dev, info, wdata, extra); -+ break; -+ case EFUSE_GET: -+ RTW_INFO("efuse get EFUSE_GET\n"); -+ rtw_mp_efuse_get(dev, info, wdata, extra); -+ break; -+ case MP_GET_TXPOWER_INX: -+ RTW_INFO("mp_get MP_GET_TXPOWER_INX\n"); -+ rtw_mp_txpower_index(dev, info, wrqu, extra); -+ break; -+ case MP_GETVER: -+ RTW_INFO("mp_get MP_GETVER\n"); -+ rtw_mp_getver(dev, info, wdata, extra); -+ break; -+ case MP_MON: -+ RTW_INFO("mp_get MP_MON\n"); -+ rtw_mp_mon(dev, info, wdata, extra); -+ break; -+ case EFUSE_MASK: -+ RTW_INFO("mp_get EFUSE_MASK\n"); -+ rtw_efuse_mask_file(dev, info, wdata, extra); -+ break; -+ case EFUSE_FILE: -+ RTW_INFO("mp_get EFUSE_FILE\n"); -+ rtw_efuse_file_map(dev, info, wdata, extra); -+ break; -+ case MP_TX: -+ RTW_INFO("mp_get MP_TX\n"); -+ rtw_mp_tx(dev, info, wdata, extra); -+ break; -+ case MP_RX: -+ RTW_INFO("mp_get MP_RX\n"); -+ rtw_mp_rx(dev, info, wdata, extra); -+ break; -+ case MP_HW_TX_MODE: -+ RTW_INFO("mp_get MP_HW_TX_MODE\n"); -+ rtw_mp_hwtx(dev, info, wdata, extra); -+ break; -+#ifdef CONFIG_RTW_CUSTOMER_STR -+ case MP_CUSTOMER_STR: -+ RTW_INFO("customer str\n"); -+ rtw_mp_customer_str(dev, info, wdata, extra); -+ break; -+#endif -+ default: -+ return -EIO; -+ } -+ -+ return 0; -+} -+#endif /*#if defined(CONFIG_MP_INCLUDED)*/ -+ -+ -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+#define DBG_MP_SDIO_INDIRECT_ACCESS 1 -+static int rtw_mp_sd_iread(struct net_device *dev -+ , struct iw_request_info *info -+ , struct iw_point *wrqu -+ , char *extra) -+{ -+ char input[16]; -+ u8 width; -+ unsigned long addr; -+ u32 ret = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if (wrqu->length > 16) { -+ RTW_INFO(FUNC_ADPT_FMT" wrqu->length:%d\n", FUNC_ADPT_ARG(padapter), wrqu->length); -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) { -+ RTW_INFO(FUNC_ADPT_FMT" copy_from_user fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ if (sscanf(input, "%hhu,%lx", &width, &addr) != 2) { -+ RTW_INFO(FUNC_ADPT_FMT" sscanf fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (addr > 0x3FFF) { -+ RTW_INFO(FUNC_ADPT_FMT" addr:0x%lx\n", FUNC_ADPT_ARG(padapter), addr); -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (DBG_MP_SDIO_INDIRECT_ACCESS) -+ RTW_INFO(FUNC_ADPT_FMT" width:%u, addr:0x%lx\n", FUNC_ADPT_ARG(padapter), width, addr); -+ -+ switch (width) { -+ case 1: -+ sprintf(extra, "0x%02x", rtw_sd_iread8(padapter, addr)); -+ wrqu->length = strlen(extra); -+ break; -+ case 2: -+ sprintf(extra, "0x%04x", rtw_sd_iread16(padapter, addr)); -+ wrqu->length = strlen(extra); -+ break; -+ case 4: -+ sprintf(extra, "0x%08x", rtw_sd_iread32(padapter, addr)); -+ wrqu->length = strlen(extra); -+ break; -+ default: -+ wrqu->length = 0; -+ ret = -EINVAL; -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+static int rtw_mp_sd_iwrite(struct net_device *dev -+ , struct iw_request_info *info -+ , struct iw_point *wrqu -+ , char *extra) -+{ -+ char width; -+ unsigned long addr, data; -+ int ret = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[32]; -+ -+ if (wrqu->length > 32) { -+ RTW_INFO(FUNC_ADPT_FMT" wrqu->length:%d\n", FUNC_ADPT_ARG(padapter), wrqu->length); -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) { -+ RTW_INFO(FUNC_ADPT_FMT" copy_from_user fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ if (sscanf(input, "%hhu,%lx,%lx", &width, &addr, &data) != 3) { -+ RTW_INFO(FUNC_ADPT_FMT" sscanf fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (addr > 0x3FFF) { -+ RTW_INFO(FUNC_ADPT_FMT" addr:0x%lx\n", FUNC_ADPT_ARG(padapter), addr); -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (DBG_MP_SDIO_INDIRECT_ACCESS) -+ RTW_INFO(FUNC_ADPT_FMT" width:%u, addr:0x%lx, data:0x%lx\n", FUNC_ADPT_ARG(padapter), width, addr, data); -+ -+ switch (width) { -+ case 1: -+ if (data > 0xFF) { -+ ret = -EINVAL; -+ break; -+ } -+ rtw_sd_iwrite8(padapter, addr, data); -+ break; -+ case 2: -+ if (data > 0xFFFF) { -+ ret = -EINVAL; -+ break; -+ } -+ rtw_sd_iwrite16(padapter, addr, data); -+ break; -+ case 4: -+ rtw_sd_iwrite32(padapter, addr, data); -+ break; -+ default: -+ wrqu->length = 0; -+ ret = -EINVAL; -+ break; -+ } -+ -+exit: -+ return ret; -+} -+#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ -+ -+static int rtw_priv_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wdata, char *extra) -+{ -+ struct iw_point *wrqu = (struct iw_point *)wdata; -+ u32 subcmd = wrqu->flags; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if (padapter == NULL) -+ return -ENETDOWN; -+ -+ if (padapter->bup == _FALSE) { -+ RTW_INFO(" %s fail =>(padapter->bup == _FALSE )\n", __FUNCTION__); -+ return -ENETDOWN; -+ } -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ RTW_INFO("%s fail =>(bSurpriseRemoved == _TRUE) || ( bDriverStopped == _TRUE)\n", __func__); -+ return -ENETDOWN; -+ } -+ -+ if (extra == NULL) { -+ wrqu->length = 0; -+ return -EIO; -+ } -+ -+ if (subcmd < MP_NULL) { -+#ifdef CONFIG_MP_INCLUDED -+ rtw_priv_mp_set(dev, info, wdata, extra); -+#endif -+ return 0; -+ } -+ -+ switch (subcmd) { -+#ifdef CONFIG_WOWLAN -+ case MP_WOW_ENABLE: -+ RTW_INFO("set case MP_WOW_ENABLE: %s\n", extra); -+ -+ rtw_wowlan_ctrl(dev, info, wdata, extra); -+ break; -+ case MP_WOW_SET_PATTERN: -+ RTW_INFO("set case MP_WOW_SET_PATTERN: %s\n", extra); -+ rtw_wowlan_set_pattern(dev, info, wdata, extra); -+ break; -+#endif -+#ifdef CONFIG_AP_WOWLAN -+ case MP_AP_WOW_ENABLE: -+ RTW_INFO("set case MP_AP_WOW_ENABLE: %s\n", extra); -+ rtw_ap_wowlan_ctrl(dev, info, wdata, extra); -+ break; -+#endif -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ case VENDOR_IE_SET: -+ RTW_INFO("set case VENDOR_IE_SET\n"); -+ rtw_vendor_ie_set(dev , info , wdata , extra); -+ break; -+#endif -+ default: -+ return -EIO; -+ } -+ -+ return 0; -+} -+ -+ -+static int rtw_priv_get(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wdata, char *extra) -+{ -+ struct iw_point *wrqu = (struct iw_point *)wdata; -+ u32 subcmd = wrqu->flags; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ -+ if (padapter == NULL) -+ return -ENETDOWN; -+ -+ if (padapter->bup == _FALSE) { -+ RTW_INFO(" %s fail =>(padapter->bup == _FALSE )\n", __FUNCTION__); -+ return -ENETDOWN; -+ } -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ RTW_INFO("%s fail =>(padapter->bSurpriseRemoved == _TRUE) || ( padapter->bDriverStopped == _TRUE)\n", __func__); -+ return -ENETDOWN; -+ } -+ -+ if (extra == NULL) { -+ wrqu->length = 0; -+ return -EIO; -+ } -+ -+ if (subcmd < MP_NULL) { -+#ifdef CONFIG_MP_INCLUDED -+ rtw_priv_mp_get(dev, info, wdata, extra); -+#endif -+ return 0; -+ } -+ -+ switch (subcmd) { -+#if defined(CONFIG_RTL8723B) -+ case MP_SetBT: -+ RTW_INFO("set MP_SetBT\n"); -+ rtw_mp_SetBT(dev, info, wdata, extra); -+ break; -+#endif -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ case MP_SD_IREAD: -+ rtw_mp_sd_iread(dev, info, wrqu, extra); -+ break; -+ case MP_SD_IWRITE: -+ rtw_mp_sd_iwrite(dev, info, wrqu, extra); -+ break; -+#endif -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ case VENDOR_IE_GET: -+ RTW_INFO("get case VENDOR_IE_GET\n"); -+ rtw_vendor_ie_get(dev , info , wdata , extra); -+ break; -+#endif -+ default: -+ return -EIO; -+ } -+ -+ rtw_msleep_os(10); /* delay 5ms for sending pkt before exit adb shell operation */ -+ return 0; -+} -+ -+ -+ -+static int rtw_wx_tdls_wfd_enable(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_WFD -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ if (extra[0] == '0') -+ rtw_tdls_wfd_enable(padapter, 0); -+ else -+ rtw_tdls_wfd_enable(padapter, 1); -+ -+#endif /* CONFIG_WFD */ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_weaksec(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ u8 i, j; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ if (extra[0] == '0') -+ padapter->wdinfo.wfd_tdls_weaksec = 0; -+ else -+ padapter->wdinfo.wfd_tdls_weaksec = 1; -+ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+ -+static int rtw_tdls_enable(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ _irqL irqL; -+ _list *plist, *phead; -+ s32 index; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 tdls_sta[NUM_STA][ETH_ALEN]; -+ u8 empty_hwaddr[ETH_ALEN] = { 0x00 }; -+ struct tdls_txmgmt txmgmt; -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ _rtw_memset(tdls_sta, 0x00, sizeof(tdls_sta)); -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ -+ if (extra[0] == '0') { -+ ptdlsinfo->tdls_enable = 0; -+ -+ if (pstapriv->asoc_sta_count == 1) -+ return ret; -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for (index = 0; index < NUM_STA; index++) { -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ while (rtw_end_of_queue_search(phead, plist) == _FALSE) { -+ psta = LIST_CONTAINOR(plist, struct sta_info , hash_list); -+ -+ plist = get_next(plist); -+ -+ if (psta->tdls_sta_state != TDLS_STATE_NONE) -+ _rtw_memcpy(tdls_sta[index], psta->hwaddr, ETH_ALEN); -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for (index = 0; index < NUM_STA; index++) { -+ if (!_rtw_memcmp(tdls_sta[index], empty_hwaddr, ETH_ALEN)) { -+ RTW_INFO("issue tear down to "MAC_FMT"\n", MAC_ARG(tdls_sta[index])); -+ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; -+ _rtw_memcpy(txmgmt.peer, tdls_sta[index], ETH_ALEN); -+ issue_tdls_teardown(padapter, &txmgmt, _TRUE); -+ } -+ } -+ rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); -+ rtw_reset_tdls_info(padapter); -+ } else if (extra[0] == '1') -+ ptdlsinfo->tdls_enable = 1; -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_setup(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+#ifdef CONFIG_TDLS -+ u8 i, j; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_txmgmt txmgmt; -+#ifdef CONFIG_WFD -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif /* CONFIG_WFD */ -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ if (wrqu->data.length - 1 != 17) { -+ RTW_INFO("[%s] length:%d != 17\n", __FUNCTION__, (wrqu->data.length - 1)); -+ return ret; -+ } -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3) -+ txmgmt.peer[i] = key_2char2num(*(extra + j), *(extra + j + 1)); -+ -+#ifdef CONFIG_WFD -+ if (_AES_ != padapter->securitypriv.dot11PrivacyAlgrthm) { -+ /* Weak Security situation with AP. */ -+ if (0 == pwdinfo->wfd_tdls_weaksec) { -+ /* Can't send the tdls setup request out!! */ -+ RTW_INFO("[%s] Current link is not AES, " -+ "SKIP sending the tdls setup request!!\n", __FUNCTION__); -+ } else -+ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); -+ } else -+#endif /* CONFIG_WFD */ -+ { -+ issue_tdls_setup_req(padapter, &txmgmt, _TRUE); -+ } -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_teardown(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ u8 i, j; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sta_info *ptdls_sta = NULL; -+ struct tdls_txmgmt txmgmt; -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ if (wrqu->data.length - 1 != 17 && wrqu->data.length - 1 != 19) { -+ RTW_INFO("[%s] length:%d != 17 or 19\n", -+ __FUNCTION__, (wrqu->data.length - 1)); -+ return ret; -+ } -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ for (i = 0, j = 0; i < ETH_ALEN; i++, j += 3) -+ txmgmt.peer[i] = key_2char2num(*(extra + j), *(extra + j + 1)); -+ -+ ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), txmgmt.peer); -+ -+ if (ptdls_sta != NULL) { -+ txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; -+ if (wrqu->data.length - 1 == 19) -+ issue_tdls_teardown(padapter, &txmgmt, _FALSE); -+ else -+ issue_tdls_teardown(padapter, &txmgmt, _TRUE); -+ } else -+ RTW_INFO("TDLS peer not found\n"); -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_discovery(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_txmgmt txmgmt; -+ int i = 0, j = 0; -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3) -+ txmgmt.peer[i] = key_2char2num(*(extra + j), *(extra + j + 1)); -+ -+ issue_tdls_dis_req(padapter, &txmgmt); -+ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_ch_switch(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ u8 i, j; -+ struct sta_info *ptdls_sta = NULL; -+ u8 take_care_iqk; -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) { -+ RTW_INFO("TDLS channel switch is not allowed\n"); -+ return ret; -+ } -+ -+ for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3) -+ pchsw_info->addr[i] = key_2char2num(*(extra + j), *(extra + j + 1)); -+ -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pchsw_info->addr); -+ if (ptdls_sta == NULL) -+ return ret; -+ -+ pchsw_info->ch_sw_state |= TDLS_CH_SW_INITIATOR_STATE; -+ -+ if (ptdls_sta != NULL) { -+ if (pchsw_info->off_ch_num == 0) -+ pchsw_info->off_ch_num = 11; -+ } else -+ RTW_INFO("TDLS peer not found\n"); -+ -+ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk); -+ if (take_care_iqk == _TRUE) { -+ u8 central_chnl; -+ u8 bw_mode; -+ -+ bw_mode = (pchsw_info->ch_offset) ? CHANNEL_WIDTH_40 : CHANNEL_WIDTH_20; -+ central_chnl = rtw_get_center_ch(pchsw_info->off_ch_num, bw_mode, pchsw_info->ch_offset); -+ if (rtw_hal_ch_sw_iqk_info_search(padapter, central_chnl, bw_mode) >= 0) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_START); -+ else -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_PREPARE); -+ } else -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_START); -+ -+ /* issue_tdls_ch_switch_req(padapter, ptdls_sta); */ -+ /* RTW_INFO("issue tdls ch switch req\n"); */ -+ -+#endif /* CONFIG_TDLS_CH_SW */ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_ch_switch_off(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; -+ u8 i, j, mac_addr[ETH_ALEN]; -+ struct sta_info *ptdls_sta = NULL; -+ struct tdls_txmgmt txmgmt; -+ -+ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) { -+ RTW_INFO("TDLS channel switch is not allowed\n"); -+ return ret; -+ } -+ -+ if (wrqu->data.length >= 17) { -+ for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3) -+ mac_addr[i] = key_2char2num(*(extra + j), *(extra + j + 1)); -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); -+ } -+ -+ if (ptdls_sta == NULL) -+ return ret; -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END_TO_BASE_CHNL); -+ -+ pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE | -+ TDLS_CH_SWITCH_ON_STATE | -+ TDLS_PEER_AT_OFF_STATE); -+ _rtw_memset(pchsw_info->addr, 0x00, ETH_ALEN); -+ -+ ptdls_sta->ch_switch_time = 0; -+ ptdls_sta->ch_switch_timeout = 0; -+ _cancel_timer_ex(&ptdls_sta->ch_sw_timer); -+ _cancel_timer_ex(&ptdls_sta->delay_timer); -+ _cancel_timer_ex(&ptdls_sta->stay_on_base_chnl_timer); -+ _cancel_timer_ex(&ptdls_sta->ch_sw_monitor_timer); -+ -+ rtw_pm_set_lps(padapter, PS_MODE_MAX); -+#endif /* CONFIG_TDLS_CH_SW */ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_dump_ch(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ RTW_INFO("[%s] dump_stack:%s\n", __FUNCTION__, extra); -+ -+ extra[wrqu->data.length] = 0x00; -+ ptdlsinfo->chsw_info.dump_stack = rtw_atoi(extra); -+ -+ return ret; -+ -+#endif -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_off_ch_num(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ RTW_INFO("[%s] off_ch_num:%s\n", __FUNCTION__, extra); -+ -+ extra[wrqu->data.length] = 0x00; -+ ptdlsinfo->chsw_info.off_ch_num = rtw_atoi(extra); -+ -+ return ret; -+ -+#endif -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_ch_offset(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_CH_SW -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ RTW_INFO("[%s] ch_offset:%s\n", __FUNCTION__, extra); -+ -+ extra[wrqu->data.length] = 0x00; -+ switch (rtw_atoi(extra)) { -+ case SCA: -+ ptdlsinfo->chsw_info.ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case SCB: -+ ptdlsinfo->chsw_info.ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ ptdlsinfo->chsw_info.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ -+ return ret; -+ -+#endif -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_pson(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 i, j, mac_addr[ETH_ALEN]; -+ struct sta_info *ptdls_sta = NULL; -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ for (i = 0, j = 0; i < ETH_ALEN; i++, j += 3) -+ mac_addr[i] = key_2char2num(*(extra + j), *(extra + j + 1)); -+ -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); -+ -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 1, 3, 500); -+ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_psoff(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 i, j, mac_addr[ETH_ALEN]; -+ struct sta_info *ptdls_sta = NULL; -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ for (i = 0, j = 0; i < ETH_ALEN; i++, j += 3) -+ mac_addr[i] = key_2char2num(*(extra + j), *(extra + j + 1)); -+ -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); -+ -+ if (ptdls_sta) -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 3, 500); -+ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_setip(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_WFD -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; -+ u8 i = 0, j = 0, k = 0, tag = 0; -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); -+ -+ while (i < 4) { -+ for (j = 0; j < 4; j++) { -+ if (*(extra + j + tag) == '.' || *(extra + j + tag) == '\0') { -+ if (j == 1) -+ pwfd_info->ip_address[i] = convert_ip_addr('0', '0', *(extra + (j - 1) + tag)); -+ if (j == 2) -+ pwfd_info->ip_address[i] = convert_ip_addr('0', *(extra + (j - 2) + tag), *(extra + (j - 1) + tag)); -+ if (j == 3) -+ pwfd_info->ip_address[i] = convert_ip_addr(*(extra + (j - 3) + tag), *(extra + (j - 2) + tag), *(extra + (j - 1) + tag)); -+ -+ tag += j + 1; -+ break; -+ } -+ } -+ i++; -+ } -+ -+ RTW_INFO("[%s] Set IP = %u.%u.%u.%u\n", __FUNCTION__, -+ ptdlsinfo->wfd_info->ip_address[0], -+ ptdlsinfo->wfd_info->ip_address[1], -+ ptdlsinfo->wfd_info->ip_address[2], -+ ptdlsinfo->wfd_info->ip_address[3]); -+ -+#endif /* CONFIG_WFD */ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_getip(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_WFD -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; -+ -+ RTW_INFO("[%s]\n", __FUNCTION__); -+ -+ sprintf(extra, "\n\n%u.%u.%u.%u\n", -+ pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1], -+ pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3]); -+ -+ RTW_INFO("[%s] IP=%u.%u.%u.%u\n", __FUNCTION__, -+ pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1], -+ pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3]); -+ -+ wrqu->data.length = strlen(extra); -+ -+#endif /* CONFIG_WFD */ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+static int rtw_tdls_getport(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_WFD -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; -+ -+ RTW_INFO("[%s]\n", __FUNCTION__); -+ -+ sprintf(extra, "\n\n%d\n", pwfd_info->peer_rtsp_ctrlport); -+ RTW_INFO("[%s] remote port = %d\n", -+ __FUNCTION__, pwfd_info->peer_rtsp_ctrlport); -+ -+ wrqu->data.length = strlen(extra); -+ -+#endif /* CONFIG_WFD */ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+ -+} -+ -+/* WFDTDLS, for sigma test */ -+static int rtw_tdls_dis_result(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_WFD -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ RTW_INFO("[%s]\n", __FUNCTION__); -+ -+ if (ptdlsinfo->dev_discovered == _TRUE) { -+ sprintf(extra, "\n\nDis=1\n"); -+ ptdlsinfo->dev_discovered = _FALSE; -+ } -+ -+ wrqu->data.length = strlen(extra); -+ -+#endif /* CONFIG_WFD */ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+ -+} -+ -+/* WFDTDLS, for sigma test */ -+static int rtw_wfd_tdls_status(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ RTW_INFO("[%s]\n", __FUNCTION__); -+ -+ sprintf(extra, "\nlink_established:%d\n" -+ "sta_cnt:%d\n" -+ "sta_maximum:%d\n" -+ "cur_channel:%d\n" -+ "tdls_enable:%d" -+#ifdef CONFIG_TDLS_CH_SW -+ "ch_sw_state:%08x\n" -+ "chsw_on:%d\n" -+ "off_ch_num:%d\n" -+ "cur_time:%d\n" -+ "ch_offset:%d\n" -+ "delay_swtich_back:%d" -+#endif -+ , -+ ptdlsinfo->link_established, ptdlsinfo->sta_cnt, -+ ptdlsinfo->sta_maximum, ptdlsinfo->cur_channel, -+ ptdlsinfo->tdls_enable -+#ifdef CONFIG_TDLS_CH_SW -+ , -+ ptdlsinfo->chsw_info.ch_sw_state, -+ ATOMIC_READ(&padapter->tdlsinfo.chsw_info.chsw_on), -+ ptdlsinfo->chsw_info.off_ch_num, -+ ptdlsinfo->chsw_info.cur_time, -+ ptdlsinfo->chsw_info.ch_offset, -+ ptdlsinfo->chsw_info.delay_switch_back -+#endif -+ ); -+ -+ wrqu->data.length = strlen(extra); -+ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+ -+} -+ -+static int rtw_tdls_getsta(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+#ifdef CONFIG_TDLS -+ u8 i, j; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 addr[ETH_ALEN] = {0}; -+ char charmac[17]; -+ struct sta_info *ptdls_sta = NULL; -+ -+ RTW_INFO("[%s] %s %d\n", __FUNCTION__, -+ (char *)wrqu->data.pointer, wrqu->data.length - 1); -+ -+ if (copy_from_user(charmac, wrqu->data.pointer + 9, 17)) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ RTW_INFO("[%s] %d, charmac:%s\n", __FUNCTION__, __LINE__, charmac); -+ for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3) -+ addr[i] = key_2char2num(*(charmac + j), *(charmac + j + 1)); -+ -+ RTW_INFO("[%s] %d, charmac:%s, addr:"MAC_FMT"\n", -+ __FUNCTION__, __LINE__, charmac, MAC_ARG(addr)); -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, addr); -+ if (ptdls_sta) { -+ sprintf(extra, "\n\ntdls_sta_state=0x%08x\n", ptdls_sta->tdls_sta_state); -+ RTW_INFO("\n\ntdls_sta_state=%d\n", ptdls_sta->tdls_sta_state); -+ } else { -+ sprintf(extra, "\n\nNot found this sta\n"); -+ RTW_INFO("\n\nNot found this sta\n"); -+ } -+ wrqu->data.length = strlen(extra); -+ -+#endif /* CONFIG_TDLS */ -+exit: -+ return ret; -+ -+} -+ -+static int rtw_tdls_get_best_ch(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u32 i, best_channel_24G = 1, best_channel_5G = 36, index_24G = 0, index_5G = 0; -+ -+ for (i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) { -+ if (pmlmeext->channel_set[i].ChannelNum == 1) -+ index_24G = i; -+ if (pmlmeext->channel_set[i].ChannelNum == 36) -+ index_5G = i; -+ } -+ -+ for (i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) { -+ /* 2.4G */ -+ if (pmlmeext->channel_set[i].ChannelNum == 6 || pmlmeext->channel_set[i].ChannelNum == 11) { -+ if (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_24G].rx_count) { -+ index_24G = i; -+ best_channel_24G = pmlmeext->channel_set[i].ChannelNum; -+ } -+ } -+ -+ /* 5G */ -+ if (pmlmeext->channel_set[i].ChannelNum >= 36 -+ && pmlmeext->channel_set[i].ChannelNum < 140) { -+ /* Find primary channel */ -+ if (((pmlmeext->channel_set[i].ChannelNum - 36) % 8 == 0) -+ && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { -+ index_5G = i; -+ best_channel_5G = pmlmeext->channel_set[i].ChannelNum; -+ } -+ } -+ -+ if (pmlmeext->channel_set[i].ChannelNum >= 149 -+ && pmlmeext->channel_set[i].ChannelNum < 165) { -+ /* Find primary channel */ -+ if (((pmlmeext->channel_set[i].ChannelNum - 149) % 8 == 0) -+ && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { -+ index_5G = i; -+ best_channel_5G = pmlmeext->channel_set[i].ChannelNum; -+ } -+ } -+#if 1 /* debug */ -+ RTW_INFO("The rx cnt of channel %3d = %d\n", -+ pmlmeext->channel_set[i].ChannelNum, -+ pmlmeext->channel_set[i].rx_count); -+#endif -+ } -+ -+ sprintf(extra, "\nbest_channel_24G = %d\n", best_channel_24G); -+ RTW_INFO("best_channel_24G = %d\n", best_channel_24G); -+ -+ if (index_5G != 0) { -+ sprintf(extra, "best_channel_5G = %d\n", best_channel_5G); -+ RTW_INFO("best_channel_5G = %d\n", best_channel_5G); -+ } -+ -+ wrqu->data.length = strlen(extra); -+ -+#endif -+ -+ return 0; -+ -+} -+ -+static int rtw_tdls(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_INFO("[%s] extra = %s\n", __FUNCTION__, extra); -+ -+ if (hal_chk_wl_func(padapter, WL_FUNC_TDLS) == _FALSE) { -+ RTW_INFO("Discard tdls oper since hal doesn't support tdls\n"); -+ return 0; -+ } -+ -+ if (padapter->tdlsinfo.tdls_enable == 0) { -+ RTW_INFO("tdls haven't enabled\n"); -+ return 0; -+ } -+ -+ /* WFD Sigma will use the tdls enable command to let the driver know we want to test the tdls now! */ -+ -+ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) { -+ if (_rtw_memcmp(extra, "wfdenable=", 10)) { -+ wrqu->data.length -= 10; -+ rtw_wx_tdls_wfd_enable(dev, info, wrqu, &extra[10]); -+ return ret; -+ } -+ } -+ -+ if (_rtw_memcmp(extra, "weaksec=", 8)) { -+ wrqu->data.length -= 8; -+ rtw_tdls_weaksec(dev, info, wrqu, &extra[8]); -+ return ret; -+ } else if (_rtw_memcmp(extra, "tdlsenable=", 11)) { -+ wrqu->data.length -= 11; -+ rtw_tdls_enable(dev, info, wrqu, &extra[11]); -+ return ret; -+ } -+ -+ if (_rtw_memcmp(extra, "setup=", 6)) { -+ wrqu->data.length -= 6; -+ rtw_tdls_setup(dev, info, wrqu, &extra[6]); -+ } else if (_rtw_memcmp(extra, "tear=", 5)) { -+ wrqu->data.length -= 5; -+ rtw_tdls_teardown(dev, info, wrqu, &extra[5]); -+ } else if (_rtw_memcmp(extra, "dis=", 4)) { -+ wrqu->data.length -= 4; -+ rtw_tdls_discovery(dev, info, wrqu, &extra[4]); -+ } else if (_rtw_memcmp(extra, "swoff=", 6)) { -+ wrqu->data.length -= 6; -+ rtw_tdls_ch_switch_off(dev, info, wrqu, &extra[6]); -+ } else if (_rtw_memcmp(extra, "sw=", 3)) { -+ wrqu->data.length -= 3; -+ rtw_tdls_ch_switch(dev, info, wrqu, &extra[3]); -+ } else if (_rtw_memcmp(extra, "dumpstack=", 10)) { -+ wrqu->data.length -= 10; -+ rtw_tdls_dump_ch(dev, info, wrqu, &extra[10]); -+ } else if (_rtw_memcmp(extra, "offchnum=", 9)) { -+ wrqu->data.length -= 9; -+ rtw_tdls_off_ch_num(dev, info, wrqu, &extra[9]); -+ } else if (_rtw_memcmp(extra, "choffset=", 9)) { -+ wrqu->data.length -= 9; -+ rtw_tdls_ch_offset(dev, info, wrqu, &extra[9]); -+ } else if (_rtw_memcmp(extra, "pson=", 5)) { -+ wrqu->data.length -= 5; -+ rtw_tdls_pson(dev, info, wrqu, &extra[5]); -+ } else if (_rtw_memcmp(extra, "psoff=", 6)) { -+ wrqu->data.length -= 6; -+ rtw_tdls_psoff(dev, info, wrqu, &extra[6]); -+ } -+ -+#ifdef CONFIG_WFD -+ if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) { -+ if (_rtw_memcmp(extra, "setip=", 6)) { -+ wrqu->data.length -= 6; -+ rtw_tdls_setip(dev, info, wrqu, &extra[6]); -+ } else if (_rtw_memcmp(extra, "tprobe=", 6)) -+ issue_tunneled_probe_req((_adapter *)rtw_netdev_priv(dev)); -+ } -+#endif /* CONFIG_WFD */ -+ -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+ -+static int rtw_tdls_get(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ RTW_INFO("[%s] extra = %s\n", __FUNCTION__, (char *) wrqu->data.pointer); -+ -+ if (_rtw_memcmp(wrqu->data.pointer, "ip", 2)) -+ rtw_tdls_getip(dev, info, wrqu, extra); -+ else if (_rtw_memcmp(wrqu->data.pointer, "port", 4)) -+ rtw_tdls_getport(dev, info, wrqu, extra); -+ /* WFDTDLS, for sigma test */ -+ else if (_rtw_memcmp(wrqu->data.pointer, "dis", 3)) -+ rtw_tdls_dis_result(dev, info, wrqu, extra); -+ else if (_rtw_memcmp(wrqu->data.pointer, "status", 6)) -+ rtw_wfd_tdls_status(dev, info, wrqu, extra); -+ else if (_rtw_memcmp(wrqu->data.pointer, "tdls_sta=", 9)) -+ rtw_tdls_getsta(dev, info, wrqu, extra); -+ else if (_rtw_memcmp(wrqu->data.pointer, "best_ch", 7)) -+ rtw_tdls_get_best_ch(dev, info, wrqu, extra); -+#endif /* CONFIG_TDLS */ -+ -+ return ret; -+} -+ -+ -+ -+ -+ -+#ifdef CONFIG_INTEL_WIDI -+static int rtw_widi_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ process_intel_widi_cmd(padapter, extra); -+ -+ return ret; -+} -+ -+static int rtw_widi_set_probe_request(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ u8 *pbuf = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ pbuf = rtw_malloc(sizeof(l2_msg_t)); -+ if (pbuf) { -+ if (copy_from_user(pbuf, wrqu->data.pointer, wrqu->data.length)) -+ ret = -EFAULT; -+ /* _rtw_memcpy(pbuf, wrqu->data.pointer, wrqu->data.length); */ -+ -+ if (wrqu->data.flags == 0) -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_ISSUE_PROB_WK, pbuf, sizeof(l2_msg_t)); -+ else if (wrqu->data.flags == 1) -+ rtw_set_wfd_rds_sink_info(padapter, (l2_msg_t *)pbuf); -+ } -+ return ret; -+} -+#endif /* CONFIG_INTEL_WIDI */ -+ -+#ifdef CONFIG_MAC_LOOPBACK_DRIVER -+ -+#if defined(CONFIG_RTL8188E) -+#include -+extern void rtl8188e_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+#define cal_txdesc_chksum rtl8188e_cal_txdesc_chksum -+#ifdef CONFIG_SDIO_HCI || defined(CONFIG_GSPI_HCI) -+extern void rtl8188es_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); -+#define fill_default_txdesc rtl8188es_fill_default_txdesc -+#endif /* CONFIG_SDIO_HCI */ -+#endif /* CONFIG_RTL8188E */ -+#if defined(CONFIG_RTL8723B) -+extern void rtl8723b_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+#define cal_txdesc_chksum rtl8723b_cal_txdesc_chksum -+extern void rtl8723b_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); -+#define fill_default_txdesc rtl8723b_fill_default_txdesc -+#endif /* CONFIG_RTL8723B */ -+ -+#if defined(CONFIG_RTL8703B) -+/* extern void rtl8703b_cal_txdesc_chksum(struct tx_desc *ptxdesc); */ -+#define cal_txdesc_chksum rtl8703b_cal_txdesc_chksum -+/* extern void rtl8703b_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); */ -+#define fill_default_txdesc rtl8703b_fill_default_txdesc -+#endif /* CONFIG_RTL8703B */ -+ -+#if defined(CONFIG_RTL8723D) -+/* extern void rtl8723d_cal_txdesc_chksum(struct tx_desc *ptxdesc); */ -+#define cal_txdesc_chksum rtl8723d_cal_txdesc_chksum -+/* extern void rtl8723d_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); */ -+#define fill_default_txdesc rtl8723d_fill_default_txdesc -+#endif /* CONFIG_RTL8723D */ -+ -+#if defined(CONFIG_RTL8192E) -+extern void rtl8192e_cal_txdesc_chksum(struct tx_desc *ptxdesc); -+#define cal_txdesc_chksum rtl8192e_cal_txdesc_chksum -+#ifdef CONFIG_SDIO_HCI || defined(CONFIG_GSPI_HCI) -+extern void rtl8192es_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); -+#define fill_default_txdesc rtl8192es_fill_default_txdesc -+#endif /* CONFIG_SDIO_HCI */ -+#endif /* CONFIG_RTL8192E */ -+ -+static s32 initLoopback(PADAPTER padapter) -+{ -+ PLOOPBACKDATA ploopback; -+ -+ -+ if (padapter->ploopback == NULL) { -+ ploopback = (PLOOPBACKDATA)rtw_zmalloc(sizeof(LOOPBACKDATA)); -+ if (ploopback == NULL) -+ return -ENOMEM; -+ -+ _rtw_init_sema(&ploopback->sema, 0); -+ ploopback->bstop = _TRUE; -+ ploopback->cnt = 0; -+ ploopback->size = 300; -+ _rtw_memset(ploopback->msg, 0, sizeof(ploopback->msg)); -+ -+ padapter->ploopback = ploopback; -+ } -+ -+ return 0; -+} -+ -+static void freeLoopback(PADAPTER padapter) -+{ -+ PLOOPBACKDATA ploopback; -+ -+ -+ ploopback = padapter->ploopback; -+ if (ploopback) { -+ rtw_mfree((u8 *)ploopback, sizeof(LOOPBACKDATA)); -+ padapter->ploopback = NULL; -+ } -+} -+ -+static s32 initpseudoadhoc(PADAPTER padapter) -+{ -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType; -+ s32 err; -+ -+ networkType = Ndis802_11IBSS; -+ err = rtw_set_802_11_infrastructure_mode(padapter, networkType); -+ if (err == _FALSE) -+ return _FAIL; -+ -+ err = rtw_setopmode_cmd(padapter, networkType, _TRUE); -+ if (err == _FAIL) -+ return _FAIL; -+ -+ return _SUCCESS; -+} -+ -+static s32 createpseudoadhoc(PADAPTER padapter) -+{ -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ struct mlme_priv *pmlmepriv; -+ NDIS_802_11_SSID *passoc_ssid; -+ WLAN_BSSID_EX *pdev_network; -+ u8 *pibss; -+ u8 ssid[] = "pseduo_ad-hoc"; -+ s32 err; -+ _irqL irqL; -+ -+ -+ pmlmepriv = &padapter->mlmepriv; -+ -+ authmode = Ndis802_11AuthModeOpen; -+ err = rtw_set_802_11_authentication_mode(padapter, authmode); -+ if (err == _FALSE) -+ return _FAIL; -+ -+ passoc_ssid = &pmlmepriv->assoc_ssid; -+ _rtw_memset(passoc_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ passoc_ssid->SsidLength = sizeof(ssid) - 1; -+ _rtw_memcpy(passoc_ssid->Ssid, ssid, passoc_ssid->SsidLength); -+ -+ pdev_network = &padapter->registrypriv.dev_network; -+ pibss = padapter->registrypriv.dev_network.MacAddress; -+ _rtw_memcpy(&pdev_network->Ssid, passoc_ssid, sizeof(NDIS_802_11_SSID)); -+ -+ rtw_update_registrypriv_dev_network(padapter); -+ rtw_generate_random_ibss(pibss); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ /*pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;*/ -+ init_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+#if 0 -+ err = rtw_create_ibss_cmd(padapter, 0); -+ if (err == _FAIL) -+ return _FAIL; -+#else -+ { -+ struct wlan_network *pcur_network; -+ struct sta_info *psta; -+ -+ /* 3 create a new psta */ -+ pcur_network = &pmlmepriv->cur_network; -+ -+ /* clear psta in the cur_network, if any */ -+ psta = rtw_get_stainfo(&padapter->stapriv, pcur_network->network.MacAddress); -+ if (psta) -+ rtw_free_stainfo(padapter, psta); -+ -+ psta = rtw_alloc_stainfo(&padapter->stapriv, pibss); -+ if (psta == NULL) -+ return _FAIL; -+ -+ /* 3 join psudo AdHoc */ -+ pcur_network->join_res = 1; -+ pcur_network->aid = psta->aid = 1; -+ _rtw_memcpy(&pcur_network->network, pdev_network, get_WLAN_BSSID_EX_sz(pdev_network)); -+ -+ /* set msr to WIFI_FW_ADHOC_STATE */ -+ padapter->hw_port = HW_PORT0; -+ Set_MSR(padapter, WIFI_FW_ADHOC_STATE); -+ -+ } -+#endif -+ -+ return _SUCCESS; -+} -+ -+static struct xmit_frame *createloopbackpkt(PADAPTER padapter, u32 size) -+{ -+ struct xmit_priv *pxmitpriv; -+ struct xmit_frame *pframe; -+ struct xmit_buf *pxmitbuf; -+ struct pkt_attrib *pattrib; -+ struct tx_desc *desc; -+ u8 *pkt_start, *pkt_end, *ptr; -+ struct rtw_ieee80211_hdr *hdr; -+ s32 bmcast; -+ _irqL irqL; -+ -+ -+ if ((TXDESC_SIZE + WLANHDR_OFFSET + size) > MAX_XMITBUF_SZ) -+ return NULL; -+ -+ pxmitpriv = &padapter->xmitpriv; -+ pframe = NULL; -+ -+ /* 2 1. allocate xmit frame */ -+ pframe = rtw_alloc_xmitframe(pxmitpriv); -+ if (pframe == NULL) -+ return NULL; -+ pframe->padapter = padapter; -+ -+ /* 2 2. allocate xmit buffer */ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ if (pxmitbuf == NULL) { -+ rtw_free_xmitframe(pxmitpriv, pframe); -+ return NULL; -+ } -+ -+ pframe->pxmitbuf = pxmitbuf; -+ pframe->buf_addr = pxmitbuf->pbuf; -+ pxmitbuf->priv_data = pframe; -+ -+ /* 2 3. update_attrib() */ -+ pattrib = &pframe->attrib; -+ -+ /* init xmitframe attribute */ -+ _rtw_memset(pattrib, 0, sizeof(struct pkt_attrib)); -+ -+ pattrib->ether_type = 0x8723; -+ _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ _rtw_memset(pattrib->dst, 0xFF, ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ -+ /* pattrib->dhcp_pkt = 0; -+ * pattrib->pktlen = 0; */ -+ pattrib->ack_policy = 0; -+ /* pattrib->pkt_hdrlen = ETH_HLEN; */ -+ pattrib->hdrlen = WLAN_HDR_A3_LEN; -+ pattrib->subtype = WIFI_DATA; -+ pattrib->priority = 0; -+ pattrib->qsel = pattrib->priority; -+ /* do_queue_select(padapter, pattrib); */ -+ pattrib->nr_frags = 1; -+ pattrib->encrypt = 0; -+ pattrib->bswenc = _FALSE; -+ pattrib->qos_en = _FALSE; -+ -+ bmcast = IS_MCAST(pattrib->ra); -+ if (bmcast) { -+ pattrib->mac_id = 1; -+ pattrib->psta = rtw_get_bcmc_stainfo(padapter); -+ } else { -+ pattrib->mac_id = 0; -+ pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); -+ } -+ -+ pattrib->pktlen = size; -+ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->pktlen; -+ -+ /* 2 4. fill TX descriptor */ -+ desc = (struct tx_desc *)pframe->buf_addr; -+ _rtw_memset(desc, 0, TXDESC_SIZE); -+ -+ fill_default_txdesc(pframe, (u8 *)desc); -+ -+ /* Hw set sequence number */ -+ ((PTXDESC)desc)->hwseq_en = 0; /* HWSEQ_EN, 0:disable, 1:enable -+ * ((PTXDESC)desc)->hwseq_sel = 0; */ /* HWSEQ_SEL */ -+ -+ ((PTXDESC)desc)->disdatafb = 1; -+ -+ /* convert to little endian */ -+ desc->txdw0 = cpu_to_le32(desc->txdw0); -+ desc->txdw1 = cpu_to_le32(desc->txdw1); -+ desc->txdw2 = cpu_to_le32(desc->txdw2); -+ desc->txdw3 = cpu_to_le32(desc->txdw3); -+ desc->txdw4 = cpu_to_le32(desc->txdw4); -+ desc->txdw5 = cpu_to_le32(desc->txdw5); -+ desc->txdw6 = cpu_to_le32(desc->txdw6); -+ desc->txdw7 = cpu_to_le32(desc->txdw7); -+#ifdef CONFIG_PCI_HCI -+ desc->txdw8 = cpu_to_le32(desc->txdw8); -+ desc->txdw9 = cpu_to_le32(desc->txdw9); -+ desc->txdw10 = cpu_to_le32(desc->txdw10); -+ desc->txdw11 = cpu_to_le32(desc->txdw11); -+ desc->txdw12 = cpu_to_le32(desc->txdw12); -+ desc->txdw13 = cpu_to_le32(desc->txdw13); -+ desc->txdw14 = cpu_to_le32(desc->txdw14); -+ desc->txdw15 = cpu_to_le32(desc->txdw15); -+#endif -+ -+ cal_txdesc_chksum(desc); -+ -+ /* 2 5. coalesce */ -+ pkt_start = pframe->buf_addr + TXDESC_SIZE; -+ pkt_end = pkt_start + pattrib->last_txcmdsz; -+ -+ /* 3 5.1. make wlan header, make_wlanhdr() */ -+ hdr = (struct rtw_ieee80211_hdr *)pkt_start; -+ SetFrameSubType(&hdr->frame_ctl, pattrib->subtype); -+ _rtw_memcpy(hdr->addr1, pattrib->dst, ETH_ALEN); /* DA */ -+ _rtw_memcpy(hdr->addr2, pattrib->src, ETH_ALEN); /* SA */ -+ _rtw_memcpy(hdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); /* RA, BSSID */ -+ -+ /* 3 5.2. make payload */ -+ ptr = pkt_start + pattrib->hdrlen; -+ get_random_bytes(ptr, pkt_end - ptr); -+ -+ pxmitbuf->len = TXDESC_SIZE + pattrib->last_txcmdsz; -+ pxmitbuf->ptail += pxmitbuf->len; -+ -+ return pframe; -+} -+ -+static void freeloopbackpkt(PADAPTER padapter, struct xmit_frame *pframe) -+{ -+ struct xmit_priv *pxmitpriv; -+ struct xmit_buf *pxmitbuf; -+ -+ -+ pxmitpriv = &padapter->xmitpriv; -+ pxmitbuf = pframe->pxmitbuf; -+ -+ rtw_free_xmitframe(pxmitpriv, pframe); -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+} -+ -+static void printdata(u8 *pbuf, u32 len) -+{ -+ u32 i, val; -+ -+ -+ for (i = 0; (i + 4) <= len; i += 4) { -+ printk("%08X", *(u32 *)(pbuf + i)); -+ if ((i + 4) & 0x1F) -+ printk(" "); -+ else -+ printk("\n"); -+ } -+ -+ if (i < len) { -+#ifdef CONFIG_BIG_ENDIAN -+ for (; i < len, i++) -+ printk("%02X", pbuf + i); -+#else /* CONFIG_LITTLE_ENDIAN */ -+#if 0 -+ val = 0; -+ _rtw_memcpy(&val, pbuf + i, len - i); -+ printk("%8X", val); -+#else -+ u8 str[9]; -+ u8 n; -+ val = 0; -+ n = len - i; -+ _rtw_memcpy(&val, pbuf + i, n); -+ sprintf(str, "%08X", val); -+ n = (4 - n) * 2; -+ printk("%8s", str + n); -+#endif -+#endif /* CONFIG_LITTLE_ENDIAN */ -+ } -+ printk("\n"); -+} -+ -+static u8 pktcmp(PADAPTER padapter, u8 *txbuf, u32 txsz, u8 *rxbuf, u32 rxsz) -+{ -+ PHAL_DATA_TYPE phal; -+ struct recv_stat *prxstat; -+ struct recv_stat report; -+ PRXREPORT prxreport; -+ u32 drvinfosize; -+ u32 rxpktsize; -+ u8 fcssize; -+ u8 ret = _FALSE; -+ -+ prxstat = (struct recv_stat *)rxbuf; -+ report.rxdw0 = le32_to_cpu(prxstat->rxdw0); -+ report.rxdw1 = le32_to_cpu(prxstat->rxdw1); -+ report.rxdw2 = le32_to_cpu(prxstat->rxdw2); -+ report.rxdw3 = le32_to_cpu(prxstat->rxdw3); -+ report.rxdw4 = le32_to_cpu(prxstat->rxdw4); -+ report.rxdw5 = le32_to_cpu(prxstat->rxdw5); -+ -+ prxreport = (PRXREPORT)&report; -+ drvinfosize = prxreport->drvinfosize << 3; -+ rxpktsize = prxreport->pktlen; -+ -+ phal = GET_HAL_DATA(padapter); -+ if (phal->ReceiveConfig & RCR_APPFCS) -+ fcssize = IEEE80211_FCS_LEN; -+ else -+ fcssize = 0; -+ -+ if ((txsz - TXDESC_SIZE) != (rxpktsize - fcssize)) { -+ RTW_INFO("%s: ERROR! size not match tx/rx=%d/%d !\n", -+ __func__, txsz - TXDESC_SIZE, rxpktsize - fcssize); -+ ret = _FALSE; -+ } else { -+ ret = _rtw_memcmp(txbuf + TXDESC_SIZE, \ -+ rxbuf + RXDESC_SIZE + drvinfosize, \ -+ txsz - TXDESC_SIZE); -+ if (ret == _FALSE) -+ RTW_INFO("%s: ERROR! pkt content mismatch!\n", __func__); -+ } -+ -+ if (ret == _FALSE) { -+ RTW_INFO("\n%s: TX PKT total=%d, desc=%d, content=%d\n", -+ __func__, txsz, TXDESC_SIZE, txsz - TXDESC_SIZE); -+ RTW_INFO("%s: TX DESC size=%d\n", __func__, TXDESC_SIZE); -+ printdata(txbuf, TXDESC_SIZE); -+ RTW_INFO("%s: TX content size=%d\n", __func__, txsz - TXDESC_SIZE); -+ printdata(txbuf + TXDESC_SIZE, txsz - TXDESC_SIZE); -+ -+ RTW_INFO("\n%s: RX PKT read=%d offset=%d(%d,%d) content=%d\n", -+ __func__, rxsz, RXDESC_SIZE + drvinfosize, RXDESC_SIZE, drvinfosize, rxpktsize); -+ if (rxpktsize != 0) { -+ RTW_INFO("%s: RX DESC size=%d\n", __func__, RXDESC_SIZE); -+ printdata(rxbuf, RXDESC_SIZE); -+ RTW_INFO("%s: RX drvinfo size=%d\n", __func__, drvinfosize); -+ printdata(rxbuf + RXDESC_SIZE, drvinfosize); -+ RTW_INFO("%s: RX content size=%d\n", __func__, rxpktsize); -+ printdata(rxbuf + RXDESC_SIZE + drvinfosize, rxpktsize); -+ } else { -+ RTW_INFO("%s: RX data size=%d\n", __func__, rxsz); -+ printdata(rxbuf, rxsz); -+ } -+ } -+ -+ return ret; -+} -+ -+thread_return lbk_thread(thread_context context) -+{ -+ s32 err; -+ PADAPTER padapter; -+ PLOOPBACKDATA ploopback; -+ struct xmit_frame *pxmitframe; -+ u32 cnt, ok, fail, headerlen; -+ u32 pktsize; -+ u32 ff_hwaddr; -+ -+ -+ padapter = (PADAPTER)context; -+ ploopback = padapter->ploopback; -+ if (ploopback == NULL) -+ return -1; -+ cnt = 0; -+ ok = 0; -+ fail = 0; -+ -+ daemonize("%s", "RTW_LBK_THREAD"); -+ allow_signal(SIGTERM); -+ -+ do { -+ if (ploopback->size == 0) { -+ get_random_bytes(&pktsize, 4); -+ pktsize = (pktsize % 1535) + 1; /* 1~1535 */ -+ } else -+ pktsize = ploopback->size; -+ -+ pxmitframe = createloopbackpkt(padapter, pktsize); -+ if (pxmitframe == NULL) { -+ sprintf(ploopback->msg, "loopback FAIL! 3. create Packet FAIL!"); -+ break; -+ } -+ -+ ploopback->txsize = TXDESC_SIZE + pxmitframe->attrib.last_txcmdsz; -+ _rtw_memcpy(ploopback->txbuf, pxmitframe->buf_addr, ploopback->txsize); -+ ff_hwaddr = rtw_get_ff_hwaddr(pxmitframe); -+ cnt++; -+ RTW_INFO("%s: wirte port cnt=%d size=%d\n", __func__, cnt, ploopback->txsize); -+ pxmitframe->pxmitbuf->pdata = ploopback->txbuf; -+ rtw_write_port(padapter, ff_hwaddr, ploopback->txsize, (u8 *)pxmitframe->pxmitbuf); -+ -+ /* wait for rx pkt */ -+ _rtw_down_sema(&ploopback->sema); -+ -+ err = pktcmp(padapter, ploopback->txbuf, ploopback->txsize, ploopback->rxbuf, ploopback->rxsize); -+ if (err == _TRUE) -+ ok++; -+ else -+ fail++; -+ -+ ploopback->txsize = 0; -+ _rtw_memset(ploopback->txbuf, 0, 0x8000); -+ ploopback->rxsize = 0; -+ _rtw_memset(ploopback->rxbuf, 0, 0x8000); -+ -+ freeloopbackpkt(padapter, pxmitframe); -+ pxmitframe = NULL; -+ -+ flush_signals_thread(); -+ -+ if ((ploopback->bstop == _TRUE) || -+ ((ploopback->cnt != 0) && (ploopback->cnt == cnt))) { -+ u32 ok_rate, fail_rate, all; -+ all = cnt; -+ ok_rate = (ok * 100) / all; -+ fail_rate = (fail * 100) / all; -+ sprintf(ploopback->msg, \ -+ "loopback result: ok=%d%%(%d/%d),error=%d%%(%d/%d)", \ -+ ok_rate, ok, all, fail_rate, fail, all); -+ break; -+ } -+ } while (1); -+ -+ ploopback->bstop = _TRUE; -+ -+ thread_exit(NULL); -+ return 0; -+} -+ -+static void loopbackTest(PADAPTER padapter, u32 cnt, u32 size, u8 *pmsg) -+{ -+ PLOOPBACKDATA ploopback; -+ u32 len; -+ s32 err; -+ -+ -+ ploopback = padapter->ploopback; -+ -+ if (ploopback) { -+ if (ploopback->bstop == _FALSE) { -+ ploopback->bstop = _TRUE; -+ _rtw_up_sema(&ploopback->sema); -+ } -+ len = 0; -+ do { -+ len = strlen(ploopback->msg); -+ if (len) -+ break; -+ rtw_msleep_os(1); -+ } while (1); -+ _rtw_memcpy(pmsg, ploopback->msg, len + 1); -+ freeLoopback(padapter); -+ -+ return; -+ } -+ -+ /* disable dynamic algorithm */ -+ rtw_phydm_ability_backup(padapter); -+ rtw_phydm_func_disable_all(padapter); -+ -+ /* create pseudo ad-hoc connection */ -+ err = initpseudoadhoc(padapter); -+ if (err == _FAIL) { -+ sprintf(pmsg, "loopback FAIL! 1.1 init ad-hoc FAIL!"); -+ return; -+ } -+ -+ err = createpseudoadhoc(padapter); -+ if (err == _FAIL) { -+ sprintf(pmsg, "loopback FAIL! 1.2 create ad-hoc master FAIL!"); -+ return; -+ } -+ -+ err = initLoopback(padapter); -+ if (err) { -+ sprintf(pmsg, "loopback FAIL! 2. init FAIL! error code=%d", err); -+ return; -+ } -+ -+ ploopback = padapter->ploopback; -+ -+ ploopback->bstop = _FALSE; -+ ploopback->cnt = cnt; -+ ploopback->size = size; -+ ploopback->lbkthread = kthread_run(lbk_thread, padapter, "RTW_LBK_THREAD"); -+ if (IS_ERR(padapter->lbkthread)) { -+ freeLoopback(padapter); -+ sprintf(pmsg, "loopback start FAIL! cnt=%d", cnt); -+ return; -+ } -+ -+ sprintf(pmsg, "loopback start! cnt=%d", cnt); -+} -+#endif /* CONFIG_MAC_LOOPBACK_DRIVER */ -+ -+static int rtw_test( -+ struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ u32 len; -+ u8 *pbuf, *pch; -+ char *ptmp; -+ u8 *delim = ","; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ -+ RTW_INFO("+%s\n", __func__); -+ len = wrqu->data.length; -+ -+ pbuf = (u8 *)rtw_zmalloc(len); -+ if (pbuf == NULL) { -+ RTW_INFO("%s: no memory!\n", __func__); -+ return -ENOMEM; -+ } -+ -+ if (copy_from_user(pbuf, wrqu->data.pointer, len)) { -+ rtw_mfree(pbuf, len); -+ RTW_INFO("%s: copy from user fail!\n", __func__); -+ return -EFAULT; -+ } -+ RTW_INFO("%s: string=\"%s\"\n", __func__, pbuf); -+ -+ ptmp = (char *)pbuf; -+ pch = strsep(&ptmp, delim); -+ if ((pch == NULL) || (strlen(pch) == 0)) { -+ rtw_mfree(pbuf, len); -+ RTW_INFO("%s: parameter error(level 1)!\n", __func__); -+ return -EFAULT; -+ } -+ -+#ifdef CONFIG_MAC_LOOPBACK_DRIVER -+ if (strcmp(pch, "loopback") == 0) { -+ s32 cnt = 0; -+ u32 size = 64; -+ -+ pch = strsep(&ptmp, delim); -+ if ((pch == NULL) || (strlen(pch) == 0)) { -+ rtw_mfree(pbuf, len); -+ RTW_INFO("%s: parameter error(level 2)!\n", __func__); -+ return -EFAULT; -+ } -+ -+ sscanf(pch, "%d", &cnt); -+ RTW_INFO("%s: loopback cnt=%d\n", __func__, cnt); -+ -+ pch = strsep(&ptmp, delim); -+ if ((pch == NULL) || (strlen(pch) == 0)) { -+ rtw_mfree(pbuf, len); -+ RTW_INFO("%s: parameter error(level 2)!\n", __func__); -+ return -EFAULT; -+ } -+ -+ sscanf(pch, "%d", &size); -+ RTW_INFO("%s: loopback size=%d\n", __func__, size); -+ -+ loopbackTest(padapter, cnt, size, extra); -+ wrqu->data.length = strlen(extra) + 1; -+ -+ goto free_buf; -+ } -+#endif -+ -+ -+#ifdef CONFIG_BT_COEXIST -+ if (strcmp(pch, "bton") == 0) { -+ rtw_btcoex_SetManualControl(padapter, _FALSE); -+ goto free_buf; -+ } else if (strcmp(pch, "btoff") == 0) { -+ rtw_btcoex_SetManualControl(padapter, _TRUE); -+ goto free_buf; -+ } -+#endif -+ -+ if (strcmp(pch, "h2c") == 0) { -+ u8 param[8]; -+ u8 count = 0; -+ u32 tmp; -+ u8 i; -+ u32 pos; -+ u8 ret; -+ -+ do { -+ pch = strsep(&ptmp, delim); -+ if ((pch == NULL) || (strlen(pch) == 0)) -+ break; -+ -+ sscanf(pch, "%x", &tmp); -+ param[count++] = (u8)tmp; -+ } while (count < 8); -+ -+ if (count == 0) { -+ rtw_mfree(pbuf, len); -+ RTW_INFO("%s: parameter error(level 2)!\n", __func__); -+ return -EFAULT; -+ } -+ -+ ret = rtw_test_h2c_cmd(padapter, param, count); -+ -+ pos = sprintf(extra, "H2C ID=0x%02x content=", param[0]); -+ for (i = 1; i < count; i++) -+ pos += sprintf(extra + pos, "%02x,", param[i]); -+ extra[pos] = 0; -+ pos--; -+ pos += sprintf(extra + pos, " %s", ret == _FAIL ? "FAIL" : "OK"); -+ -+ wrqu->data.length = strlen(extra) + 1; -+ -+ goto free_buf; -+ } -+ -+free_buf: -+ rtw_mfree(pbuf, len); -+ return 0; -+} -+ -+static iw_handler rtw_handlers[] = { -+ NULL, /* SIOCSIWCOMMIT */ -+ rtw_wx_get_name, /* SIOCGIWNAME */ -+ dummy, /* SIOCSIWNWID */ -+ dummy, /* SIOCGIWNWID */ -+ rtw_wx_set_freq, /* SIOCSIWFREQ */ -+ rtw_wx_get_freq, /* SIOCGIWFREQ */ -+ rtw_wx_set_mode, /* SIOCSIWMODE */ -+ rtw_wx_get_mode, /* SIOCGIWMODE */ -+ dummy, /* SIOCSIWSENS */ -+ rtw_wx_get_sens, /* SIOCGIWSENS */ -+ NULL, /* SIOCSIWRANGE */ -+ rtw_wx_get_range, /* SIOCGIWRANGE */ -+ rtw_wx_set_priv, /* SIOCSIWPRIV */ -+ NULL, /* SIOCGIWPRIV */ -+ NULL, /* SIOCSIWSTATS */ -+ NULL, /* SIOCGIWSTATS */ -+ dummy, /* SIOCSIWSPY */ -+ dummy, /* SIOCGIWSPY */ -+ NULL, /* SIOCGIWTHRSPY */ -+ NULL, /* SIOCWIWTHRSPY */ -+ rtw_wx_set_wap, /* SIOCSIWAP */ -+ rtw_wx_get_wap, /* SIOCGIWAP */ -+ rtw_wx_set_mlme, /* request MLME operation; uses struct iw_mlme */ -+ dummy, /* SIOCGIWAPLIST -- depricated */ -+ rtw_wx_set_scan, /* SIOCSIWSCAN */ -+ rtw_wx_get_scan, /* SIOCGIWSCAN */ -+ rtw_wx_set_essid, /* SIOCSIWESSID */ -+ rtw_wx_get_essid, /* SIOCGIWESSID */ -+ dummy, /* SIOCSIWNICKN */ -+ rtw_wx_get_nick, /* SIOCGIWNICKN */ -+ NULL, /* -- hole -- */ -+ NULL, /* -- hole -- */ -+ rtw_wx_set_rate, /* SIOCSIWRATE */ -+ rtw_wx_get_rate, /* SIOCGIWRATE */ -+ rtw_wx_set_rts, /* SIOCSIWRTS */ -+ rtw_wx_get_rts, /* SIOCGIWRTS */ -+ rtw_wx_set_frag, /* SIOCSIWFRAG */ -+ rtw_wx_get_frag, /* SIOCGIWFRAG */ -+ dummy, /* SIOCSIWTXPOW */ -+ dummy, /* SIOCGIWTXPOW */ -+ dummy, /* SIOCSIWRETRY */ -+ rtw_wx_get_retry, /* SIOCGIWRETRY */ -+ rtw_wx_set_enc, /* SIOCSIWENCODE */ -+ rtw_wx_get_enc, /* SIOCGIWENCODE */ -+ dummy, /* SIOCSIWPOWER */ -+ rtw_wx_get_power, /* SIOCGIWPOWER */ -+ NULL, /*---hole---*/ -+ NULL, /*---hole---*/ -+ rtw_wx_set_gen_ie, /* SIOCSIWGENIE */ -+ NULL, /* SIOCGWGENIE */ -+ rtw_wx_set_auth, /* SIOCSIWAUTH */ -+ NULL, /* SIOCGIWAUTH */ -+ rtw_wx_set_enc_ext, /* SIOCSIWENCODEEXT */ -+ NULL, /* SIOCGIWENCODEEXT */ -+ rtw_wx_set_pmkid, /* SIOCSIWPMKSA */ -+ NULL, /*---hole---*/ -+}; -+ -+ -+static const struct iw_priv_args rtw_private_args[] = { -+ { -+ SIOCIWFIRSTPRIV + 0x0, -+ IW_PRIV_TYPE_CHAR | 0x7FF, 0, "write" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x1, -+ IW_PRIV_TYPE_CHAR | 0x7FF, -+ IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ, "read" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x2, 0, 0, "driver_ext" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x3, 0, 0, "mp_ioctl" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x4, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "apinfo" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x5, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "setpid" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x6, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_start" -+ }, -+ /* for PLATFORM_MT53XX */ -+ { -+ SIOCIWFIRSTPRIV + 0x7, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "get_sensitivity" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x8, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_prob_req_ie" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x9, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_assoc_req_ie" -+ }, -+ -+ /* for RTK_DMP_PLATFORM */ -+ { -+ SIOCIWFIRSTPRIV + 0xA, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "channel_plan" -+ }, -+ -+ { -+ SIOCIWFIRSTPRIV + 0xB, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "dbg" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0xC, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 3, 0, "rfw" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0xD, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ, "rfr" -+ }, -+#if 0 -+ { -+ SIOCIWFIRSTPRIV + 0xE, 0, 0, "wowlan_ctrl" -+ }, -+#endif -+ { -+ SIOCIWFIRSTPRIV + 0x10, -+ IW_PRIV_TYPE_CHAR | 1024, 0, "p2p_set" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x11, -+ IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , "p2p_get" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x12, 0, 0, "NULL" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x13, -+ IW_PRIV_TYPE_CHAR | 64, IW_PRIV_TYPE_CHAR | 64 , "p2p_get2" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x14, -+ IW_PRIV_TYPE_CHAR | 64, 0, "tdls" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x15, -+ IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | 1024 , "tdls_get" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x16, -+ IW_PRIV_TYPE_CHAR | 64, 0, "pm_set" -+ }, -+ -+ {SIOCIWFIRSTPRIV + 0x18, IW_PRIV_TYPE_CHAR | IFNAMSIZ , 0 , "rereg_nd_name"}, -+#ifdef CONFIG_MP_INCLUDED -+ {SIOCIWFIRSTPRIV + 0x1A, IW_PRIV_TYPE_CHAR | 1024, 0, "NULL"}, -+ {SIOCIWFIRSTPRIV + 0x1B, IW_PRIV_TYPE_CHAR | 128, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "NULL"}, -+#else -+ {SIOCIWFIRSTPRIV + 0x1A, IW_PRIV_TYPE_CHAR | 1024, 0, "efuse_set"}, -+ {SIOCIWFIRSTPRIV + 0x1B, IW_PRIV_TYPE_CHAR | 128, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_get"}, -+#endif -+ { -+ SIOCIWFIRSTPRIV + 0x1D, -+ IW_PRIV_TYPE_CHAR | 40, IW_PRIV_TYPE_CHAR | 0x7FF, "test" -+ }, -+ -+#ifdef CONFIG_INTEL_WIDI -+ { -+ SIOCIWFIRSTPRIV + 0x1E, -+ IW_PRIV_TYPE_CHAR | 1024, 0, "widi_set" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x1F, -+ IW_PRIV_TYPE_CHAR | 128, 0, "widi_prob_req" -+ }, -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ { SIOCIWFIRSTPRIV + 0x0E, IW_PRIV_TYPE_CHAR | 1024, 0 , ""}, /* set */ -+ { SIOCIWFIRSTPRIV + 0x0F, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , ""},/* get -+ * --- sub-ioctls definitions --- */ -+ -+#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -+ { VENDOR_IE_SET, IW_PRIV_TYPE_CHAR | 1024 , 0 , "vendor_ie_set" }, -+ { VENDOR_IE_GET, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "vendor_ie_get" }, -+#endif -+#if defined(CONFIG_RTL8723B) -+ { MP_SetBT, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_setbt" }, -+ { MP_DISABLE_BT_COEXIST, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_disa_btcoex"}, -+#endif -+#ifdef CONFIG_WOWLAN -+ { MP_WOW_ENABLE , IW_PRIV_TYPE_CHAR | 1024, 0, "wow_mode" }, -+ { MP_WOW_SET_PATTERN , IW_PRIV_TYPE_CHAR | 1024, 0, "wow_set_pattern" }, -+#endif -+#ifdef CONFIG_AP_WOWLAN -+ { MP_AP_WOW_ENABLE , IW_PRIV_TYPE_CHAR | 1024, 0, "ap_wow_mode" }, /* set */ -+#endif -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ { MP_SD_IREAD, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "sd_iread" }, -+ { MP_SD_IWRITE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "sd_iwrite" }, -+#endif -+}; -+ -+ -+static const struct iw_priv_args rtw_mp_private_args[] = { -+ /* --- sub-ioctls definitions --- */ -+#ifdef CONFIG_MP_INCLUDED -+ { MP_START , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_start" }, -+ { MP_PHYPARA, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_phypara" }, -+ { MP_STOP , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_stop" }, -+ { MP_CHANNEL , IW_PRIV_TYPE_CHAR | 1024 , IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_channel" }, -+ { MP_BANDWIDTH , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_bandwidth"}, -+ { MP_RATE , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rate" }, -+ { MP_RESET_STATS , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_reset_stats"}, -+ { MP_QUERY , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , "mp_query"}, -+ { READ_REG , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "read_reg" }, -+ { MP_RATE , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rate" }, -+ { READ_RF , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "read_rf" }, -+ { MP_PSD , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_psd"}, -+ { MP_DUMP, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_dump" }, -+ { MP_TXPOWER , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_txpower"}, -+ { MP_ANT_TX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ant_tx"}, -+ { MP_ANT_RX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ant_rx"}, -+ { WRITE_REG , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "write_reg" }, -+ { WRITE_RF , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "write_rf" }, -+ { MP_CTX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ctx"}, -+ { MP_ARX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_arx"}, -+ { MP_THER , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ther"}, -+ { EFUSE_SET, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_set" }, -+ { EFUSE_GET, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_get" }, -+ { MP_PWRTRK , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_pwrtrk"}, -+ { MP_QueryDrvStats, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_drvquery" }, -+ { MP_IOCTL, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_ioctl"}, -+ { MP_SetRFPathSwh, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_setrfpath" }, -+ { MP_PwrCtlDM, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_pwrctldm" }, -+ { MP_GET_TXPOWER_INX, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_get_txpower" }, -+ { MP_GETVER, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_priv_ver" }, -+ { MP_MON, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_mon" }, -+ { EFUSE_MASK, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_mask" }, -+ { EFUSE_FILE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_file" }, -+ { MP_TX, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_tx" }, -+ { MP_RX, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rx" }, -+ { MP_HW_TX_MODE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_hxtx" }, -+ { CTA_TEST, IW_PRIV_TYPE_CHAR | 1024, 0, "cta_test"}, -+ { MP_IQK, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_iqk"}, -+ { MP_LCK, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_lck"}, -+#ifdef CONFIG_RTW_CUSTOMER_STR -+ { MP_CUSTOMER_STR, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "customer_str" }, -+#endif -+ -+#endif /* CONFIG_MP_INCLUDED */ -+}; -+ -+static iw_handler rtw_private_handler[] = { -+ rtw_wx_write32, /* 0x00 */ -+ rtw_wx_read32, /* 0x01 */ -+ rtw_drvext_hdl, /* 0x02 */ -+#ifdef MP_IOCTL_HDL -+ rtw_mp_ioctl_hdl, /* 0x03 */ -+#else -+ rtw_wx_priv_null, -+#endif -+ /* for MM DTV platform */ -+ rtw_get_ap_info, /* 0x04 */ -+ -+ rtw_set_pid, /* 0x05 */ -+ rtw_wps_start, /* 0x06 */ -+ -+ /* for PLATFORM_MT53XX */ -+ rtw_wx_get_sensitivity, /* 0x07 */ -+ rtw_wx_set_mtk_wps_probe_ie, /* 0x08 */ -+ rtw_wx_set_mtk_wps_ie, /* 0x09 */ -+ -+ /* for RTK_DMP_PLATFORM -+ * Set Channel depend on the country code */ -+ rtw_wx_set_channel_plan, /* 0x0A */ -+ -+ rtw_dbg_port, /* 0x0B */ -+ rtw_wx_write_rf, /* 0x0C */ -+ rtw_wx_read_rf, /* 0x0D */ -+ -+ rtw_priv_set, /*0x0E*/ -+ rtw_priv_get, /*0x0F*/ -+ -+ rtw_p2p_set, /* 0x10 */ -+ rtw_p2p_get, /* 0x11 */ -+ NULL, /* 0x12 */ -+ rtw_p2p_get2, /* 0x13 */ -+ -+ rtw_tdls, /* 0x14 */ -+ rtw_tdls_get, /* 0x15 */ -+ -+ rtw_pm_set, /* 0x16 */ -+ rtw_wx_priv_null, /* 0x17 */ -+ rtw_rereg_nd_name, /* 0x18 */ -+ rtw_wx_priv_null, /* 0x19 */ -+#ifdef CONFIG_MP_INCLUDED -+ rtw_wx_priv_null, /* 0x1A */ -+ rtw_wx_priv_null, /* 0x1B */ -+#else -+ rtw_mp_efuse_set, /* 0x1A */ -+ rtw_mp_efuse_get, /* 0x1B */ -+#endif -+ NULL, /* 0x1C is reserved for hostapd */ -+ rtw_test, /* 0x1D */ -+#ifdef CONFIG_INTEL_WIDI -+ rtw_widi_set, /* 0x1E */ -+ rtw_widi_set_probe_request, /* 0x1F */ -+#endif /* CONFIG_INTEL_WIDI */ -+}; -+ -+#if WIRELESS_EXT >= 17 -+static struct iw_statistics *rtw_get_wireless_stats(struct net_device *dev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_statistics *piwstats = &padapter->iwstats; -+ int tmp_level = 0; -+ int tmp_qual = 0; -+ int tmp_noise = 0; -+ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) != _TRUE) { -+ piwstats->qual.qual = 0; -+ piwstats->qual.level = 0; -+ piwstats->qual.noise = 0; -+ /* RTW_INFO("No link level:%d, qual:%d, noise:%d\n", tmp_level, tmp_qual, tmp_noise); */ -+ } else { -+#ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ tmp_level = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); -+#else -+#ifdef CONFIG_SIGNAL_SCALE_MAPPING -+ tmp_level = padapter->recvpriv.signal_strength; -+#else -+ { -+ /* Do signal scale mapping when using percentage as the unit of signal strength, since the scale mapping is skipped in odm */ -+ -+ HAL_DATA_TYPE *pHal = GET_HAL_DATA(padapter); -+ -+ tmp_level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, padapter->recvpriv.signal_strength); -+ } -+#endif -+#endif -+ -+ tmp_qual = padapter->recvpriv.signal_qual; -+ rtw_get_noise(padapter); -+ tmp_noise = padapter->recvpriv.noise; -+ /* RTW_INFO("level:%d, qual:%d, noise:%d, rssi (%d)\n", tmp_level, tmp_qual, tmp_noise,padapter->recvpriv.rssi); */ -+ -+ piwstats->qual.level = tmp_level; -+ piwstats->qual.qual = tmp_qual; -+ piwstats->qual.noise = tmp_noise; -+ } -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 14)) -+ piwstats->qual.updated = IW_QUAL_ALL_UPDATED ;/* |IW_QUAL_DBM; */ -+#else -+#ifdef RTK_DMP_PLATFORM -+ /* IW_QUAL_DBM= 0x8, if driver use this flag, wireless extension will show value of dbm. */ -+ /* remove this flag for show percentage 0~100 */ -+ piwstats->qual.updated = 0x07; -+#else -+ piwstats->qual.updated = 0x0f; -+#endif -+#endif -+ -+#ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ piwstats->qual.updated = piwstats->qual.updated | IW_QUAL_DBM; -+#endif -+ -+ return &padapter->iwstats; -+} -+#endif -+ -+#ifdef CONFIG_WIRELESS_EXT -+struct iw_handler_def rtw_handlers_def = { -+ .standard = rtw_handlers, -+ .num_standard = sizeof(rtw_handlers) / sizeof(iw_handler), -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 33)) || defined(CONFIG_WEXT_PRIV) -+ .private = rtw_private_handler, -+ .private_args = (struct iw_priv_args *)rtw_private_args, -+ .num_private = sizeof(rtw_private_handler) / sizeof(iw_handler), -+ .num_private_args = sizeof(rtw_private_args) / sizeof(struct iw_priv_args), -+#endif -+#if WIRELESS_EXT >= 17 -+ .get_wireless_stats = rtw_get_wireless_stats, -+#endif -+}; -+#endif -+ -+/* copy from net/wireless/wext.c start -+ * ---------------------------------------------------------------- -+ * -+ * Calculate size of private arguments -+ */ -+static const char iw_priv_type_size[] = { -+ 0, /* IW_PRIV_TYPE_NONE */ -+ 1, /* IW_PRIV_TYPE_BYTE */ -+ 1, /* IW_PRIV_TYPE_CHAR */ -+ 0, /* Not defined */ -+ sizeof(__u32), /* IW_PRIV_TYPE_INT */ -+ sizeof(struct iw_freq), /* IW_PRIV_TYPE_FLOAT */ -+ sizeof(struct sockaddr), /* IW_PRIV_TYPE_ADDR */ -+ 0, /* Not defined */ -+}; -+ -+static int get_priv_size(__u16 args) -+{ -+ int num = args & IW_PRIV_SIZE_MASK; -+ int type = (args & IW_PRIV_TYPE_MASK) >> 12; -+ -+ return num * iw_priv_type_size[type]; -+} -+/* copy from net/wireless/wext.c end */ -+ -+ -+static int _rtw_ioctl_wext_private(struct net_device *dev, union iwreq_data *wrq_data) -+{ -+ int err = 0; -+ u8 *input = NULL; -+ u32 input_len = 0; -+ const char delim[] = " "; -+ u8 *output = NULL; -+ u32 output_len = 0; -+ u32 count = 0; -+ u8 *buffer = NULL; -+ u32 buffer_len = 0; -+ char *ptr = NULL; -+ u8 cmdname[17] = {0}; /* IFNAMSIZ+1 */ -+ u32 cmdlen; -+ s32 len; -+ u8 *extra = NULL; -+ u32 extra_size = 0; -+ -+ s32 k; -+ const iw_handler *priv; /* Private ioctl */ -+ const struct iw_priv_args *priv_args; /* Private ioctl description */ -+ const struct iw_priv_args *mp_priv_args; /*MP Private ioctl description */ -+ const struct iw_priv_args *sel_priv_args; /*Selected Private ioctl description */ -+ u32 num_priv; /* Number of ioctl */ -+ u32 num_priv_args; /* Number of descriptions */ -+ u32 num_mp_priv_args; /*Number of MP descriptions */ -+ u32 num_sel_priv_args; /*Number of Selected descriptions */ -+ iw_handler handler; -+ int temp; -+ int subcmd = 0; /* sub-ioctl index */ -+ int offset = 0; /* Space for sub-ioctl index */ -+ -+ union iwreq_data wdata; -+ -+ _rtw_memcpy(&wdata, wrq_data, sizeof(wdata)); -+ -+ input_len = wdata.data.length; -+ if (!input_len) -+ return -EINVAL; -+ input = rtw_zmalloc(input_len); -+ if (NULL == input) -+ return -ENOMEM; -+ if (copy_from_user(input, wdata.data.pointer, input_len)) { -+ err = -EFAULT; -+ goto exit; -+ } -+ input[input_len - 1] = '\0'; -+ ptr = input; -+ len = input_len; -+ -+ if (ptr == NULL) { -+ err = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+ sscanf(ptr, "%16s", cmdname); -+ cmdlen = strlen(cmdname); -+ RTW_INFO("%s: cmd=%s\n", __func__, cmdname); -+ -+ /* skip command string */ -+ if (cmdlen > 0) -+ cmdlen += 1; /* skip one space */ -+ ptr += cmdlen; -+ len -= cmdlen; -+ RTW_INFO("%s: parameters=%s\n", __func__, ptr); -+ -+ priv = rtw_private_handler; -+ priv_args = rtw_private_args; -+ mp_priv_args = rtw_mp_private_args; -+ num_priv = sizeof(rtw_private_handler) / sizeof(iw_handler); -+ num_priv_args = sizeof(rtw_private_args) / sizeof(struct iw_priv_args); -+ num_mp_priv_args = sizeof(rtw_mp_private_args) / sizeof(struct iw_priv_args); -+ -+ if (num_priv_args == 0) { -+ err = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+ /* Search the correct ioctl */ -+ k = -1; -+ sel_priv_args = priv_args; -+ num_sel_priv_args = num_priv_args; -+ while -+ ((++k < num_sel_priv_args) && strcmp(sel_priv_args[k].name, cmdname)) -+ ; -+ -+ /* If not found... */ -+ if (k == num_sel_priv_args) { -+ k = -1; -+ sel_priv_args = mp_priv_args; -+ num_sel_priv_args = num_mp_priv_args; -+ while -+ ((++k < num_sel_priv_args) && strcmp(sel_priv_args[k].name, cmdname)) -+ ; -+ -+ if (k == num_sel_priv_args) { -+ err = -EOPNOTSUPP; -+ goto exit; -+ } -+ } -+ -+ /* Watch out for sub-ioctls ! */ -+ if (sel_priv_args[k].cmd < SIOCDEVPRIVATE) { -+ int j = -1; -+ -+ /* Find the matching *real* ioctl */ -+ while ((++j < num_priv_args) && ((priv_args[j].name[0] != '\0') || -+ (priv_args[j].set_args != sel_priv_args[k].set_args) || -+ (priv_args[j].get_args != sel_priv_args[k].get_args))) -+ ; -+ -+ /* If not found... */ -+ if (j == num_priv_args) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ /* Save sub-ioctl number */ -+ subcmd = sel_priv_args[k].cmd; -+ /* Reserve one int (simplify alignment issues) */ -+ offset = sizeof(__u32); -+ /* Use real ioctl definition from now on */ -+ k = j; -+ } -+ -+ buffer = rtw_zmalloc(4096); -+ if (NULL == buffer) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ /* If we have to set some data */ -+ if ((priv_args[k].set_args & IW_PRIV_TYPE_MASK) && -+ (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) { -+ u8 *str; -+ -+ switch (priv_args[k].set_args & IW_PRIV_TYPE_MASK) { -+ case IW_PRIV_TYPE_BYTE: -+ /* Fetch args */ -+ count = 0; -+ do { -+ str = strsep(&ptr, delim); -+ if (NULL == str) -+ break; -+ sscanf(str, "%i", &temp); -+ buffer[count++] = (u8)temp; -+ } while (1); -+ buffer_len = count; -+ -+ /* Number of args to fetch */ -+ wdata.data.length = count; -+ if (wdata.data.length > (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) -+ wdata.data.length = priv_args[k].set_args & IW_PRIV_SIZE_MASK; -+ -+ break; -+ -+ case IW_PRIV_TYPE_INT: -+ /* Fetch args */ -+ count = 0; -+ do { -+ str = strsep(&ptr, delim); -+ if (NULL == str) -+ break; -+ sscanf(str, "%i", &temp); -+ ((s32 *)buffer)[count++] = (s32)temp; -+ } while (1); -+ buffer_len = count * sizeof(s32); -+ -+ /* Number of args to fetch */ -+ wdata.data.length = count; -+ if (wdata.data.length > (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) -+ wdata.data.length = priv_args[k].set_args & IW_PRIV_SIZE_MASK; -+ -+ break; -+ -+ case IW_PRIV_TYPE_CHAR: -+ if (len > 0) { -+ /* Size of the string to fetch */ -+ wdata.data.length = len; -+ if (wdata.data.length > (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) -+ wdata.data.length = priv_args[k].set_args & IW_PRIV_SIZE_MASK; -+ -+ /* Fetch string */ -+ _rtw_memcpy(buffer, ptr, wdata.data.length); -+ } else { -+ wdata.data.length = 1; -+ buffer[0] = '\0'; -+ } -+ buffer_len = wdata.data.length; -+ break; -+ -+ default: -+ RTW_INFO("%s: Not yet implemented...\n", __func__); -+ err = -1; -+ goto exit; -+ } -+ -+ if ((priv_args[k].set_args & IW_PRIV_SIZE_FIXED) && -+ (wdata.data.length != (priv_args[k].set_args & IW_PRIV_SIZE_MASK))) { -+ RTW_INFO("%s: The command %s needs exactly %d argument(s)...\n", -+ __func__, cmdname, priv_args[k].set_args & IW_PRIV_SIZE_MASK); -+ err = -EINVAL; -+ goto exit; -+ } -+ } /* if args to set */ -+ else -+ wdata.data.length = 0L; -+ -+ /* Those two tests are important. They define how the driver -+ * will have to handle the data */ -+ if ((priv_args[k].set_args & IW_PRIV_SIZE_FIXED) && -+ ((get_priv_size(priv_args[k].set_args) + offset) <= IFNAMSIZ)) { -+ /* First case : all SET args fit within wrq */ -+ if (offset) -+ wdata.mode = subcmd; -+ _rtw_memcpy(wdata.name + offset, buffer, IFNAMSIZ - offset); -+ } else { -+ if ((priv_args[k].set_args == 0) && -+ (priv_args[k].get_args & IW_PRIV_SIZE_FIXED) && -+ (get_priv_size(priv_args[k].get_args) <= IFNAMSIZ)) { -+ /* Second case : no SET args, GET args fit within wrq */ -+ if (offset) -+ wdata.mode = subcmd; -+ } else { -+ /* Third case : args won't fit in wrq, or variable number of args */ -+ if (copy_to_user(wdata.data.pointer, buffer, buffer_len)) { -+ err = -EFAULT; -+ goto exit; -+ } -+ wdata.data.flags = subcmd; -+ } -+ } -+ -+ rtw_mfree(input, input_len); -+ input = NULL; -+ -+ extra_size = 0; -+ if (IW_IS_SET(priv_args[k].cmd)) { -+ /* Size of set arguments */ -+ extra_size = get_priv_size(priv_args[k].set_args); -+ -+ /* Does it fits in iwr ? */ -+ if ((priv_args[k].set_args & IW_PRIV_SIZE_FIXED) && -+ ((extra_size + offset) <= IFNAMSIZ)) -+ extra_size = 0; -+ } else { -+ /* Size of get arguments */ -+ extra_size = get_priv_size(priv_args[k].get_args); -+ -+ /* Does it fits in iwr ? */ -+ if ((priv_args[k].get_args & IW_PRIV_SIZE_FIXED) && -+ (extra_size <= IFNAMSIZ)) -+ extra_size = 0; -+ } -+ -+ if (extra_size == 0) { -+ extra = (u8 *)&wdata; -+ rtw_mfree(buffer, 4096); -+ buffer = NULL; -+ } else -+ extra = buffer; -+ -+ handler = priv[priv_args[k].cmd - SIOCIWFIRSTPRIV]; -+ err = handler(dev, NULL, &wdata, extra); -+ -+ /* If we have to get some data */ -+ if ((priv_args[k].get_args & IW_PRIV_TYPE_MASK) && -+ (priv_args[k].get_args & IW_PRIV_SIZE_MASK)) { -+ int j; -+ int n = 0; /* number of args */ -+ u8 str[20] = {0}; -+ -+ /* Check where is the returned data */ -+ if ((priv_args[k].get_args & IW_PRIV_SIZE_FIXED) && -+ (get_priv_size(priv_args[k].get_args) <= IFNAMSIZ)) -+ n = priv_args[k].get_args & IW_PRIV_SIZE_MASK; -+ else -+ n = wdata.data.length; -+ -+ output = rtw_zmalloc(4096); -+ if (NULL == output) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ switch (priv_args[k].get_args & IW_PRIV_TYPE_MASK) { -+ case IW_PRIV_TYPE_BYTE: -+ /* Display args */ -+ for (j = 0; j < n; j++) { -+ sprintf(str, "%d ", extra[j]); -+ len = strlen(str); -+ output_len = strlen(output); -+ if ((output_len + len + 1) > 4096) { -+ err = -E2BIG; -+ goto exit; -+ } -+ _rtw_memcpy(output + output_len, str, len); -+ } -+ break; -+ -+ case IW_PRIV_TYPE_INT: -+ /* Display args */ -+ for (j = 0; j < n; j++) { -+ sprintf(str, "%d ", ((__s32 *)extra)[j]); -+ len = strlen(str); -+ output_len = strlen(output); -+ if ((output_len + len + 1) > 4096) { -+ err = -E2BIG; -+ goto exit; -+ } -+ _rtw_memcpy(output + output_len, str, len); -+ } -+ break; -+ -+ case IW_PRIV_TYPE_CHAR: -+ /* Display args */ -+ _rtw_memcpy(output, extra, n); -+ break; -+ -+ default: -+ RTW_INFO("%s: Not yet implemented...\n", __func__); -+ err = -1; -+ goto exit; -+ } -+ -+ output_len = strlen(output) + 1; -+ wrq_data->data.length = output_len; -+ if (copy_to_user(wrq_data->data.pointer, output, output_len)) { -+ err = -EFAULT; -+ goto exit; -+ } -+ } /* if args to set */ -+ else -+ wrq_data->data.length = 0; -+ -+exit: -+ if (input) -+ rtw_mfree(input, input_len); -+ if (buffer) -+ rtw_mfree(buffer, 4096); -+ if (output) -+ rtw_mfree(output, 4096); -+ -+ return err; -+} -+ -+#ifdef CONFIG_COMPAT -+static int rtw_ioctl_compat_wext_private(struct net_device *dev, struct ifreq *rq) -+{ -+ struct compat_iw_point iwp_compat; -+ union iwreq_data wrq_data; -+ int err = 0; -+ RTW_INFO("%s:...\n", __func__); -+ if (copy_from_user(&iwp_compat, rq->ifr_ifru.ifru_data, sizeof(struct compat_iw_point))) -+ return -EFAULT; -+ -+ wrq_data.data.pointer = compat_ptr(iwp_compat.pointer); -+ wrq_data.data.length = iwp_compat.length; -+ wrq_data.data.flags = iwp_compat.flags; -+ -+ err = _rtw_ioctl_wext_private(dev, &wrq_data); -+ -+ iwp_compat.pointer = ptr_to_compat(wrq_data.data.pointer); -+ iwp_compat.length = wrq_data.data.length; -+ iwp_compat.flags = wrq_data.data.flags; -+ if (copy_to_user(rq->ifr_ifru.ifru_data, &iwp_compat, sizeof(struct compat_iw_point))) -+ return -EFAULT; -+ -+ return err; -+} -+#endif /* CONFIG_COMPAT */ -+ -+static int rtw_ioctl_standard_wext_private(struct net_device *dev, struct ifreq *rq) -+{ -+ struct iw_point *iwp; -+ struct ifreq ifrq; -+ union iwreq_data wrq_data; -+ int err = 0; -+ iwp = &wrq_data.data; -+ RTW_INFO("%s:...\n", __func__); -+ if (copy_from_user(iwp, rq->ifr_ifru.ifru_data, sizeof(struct iw_point))) -+ return -EFAULT; -+ -+ err = _rtw_ioctl_wext_private(dev, &wrq_data); -+ -+ if (copy_to_user(rq->ifr_ifru.ifru_data, iwp, sizeof(struct iw_point))) -+ return -EFAULT; -+ -+ return err; -+} -+ -+static int rtw_ioctl_wext_private(struct net_device *dev, struct ifreq *rq) -+{ -+#ifdef CONFIG_COMPAT -+#if (KERNEL_VERSION(4, 6, 0) > LINUX_VERSION_CODE) -+ if (is_compat_task()) -+#else -+ if (in_compat_syscall()) -+#endif -+ return rtw_ioctl_compat_wext_private(dev, rq); -+ else -+#endif /* CONFIG_COMPAT */ -+ return rtw_ioctl_standard_wext_private(dev, rq); -+} -+ -+int rtw_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) -+{ -+ struct iwreq *wrq = (struct iwreq *)rq; -+ int ret = 0; -+ -+ switch (cmd) { -+ case RTL_IOCTL_WPA_SUPPLICANT: -+ ret = wpa_supplicant_ioctl(dev, &wrq->u.data); -+ break; -+#ifdef CONFIG_AP_MODE -+ case RTL_IOCTL_HOSTAPD: -+ ret = rtw_hostapd_ioctl(dev, &wrq->u.data); -+ break; -+#ifdef CONFIG_WIRELESS_EXT -+ case SIOCSIWMODE: -+ ret = rtw_wx_set_mode(dev, NULL, &wrq->u, NULL); -+ break; -+#endif -+#endif /* CONFIG_AP_MODE */ -+ case SIOCDEVPRIVATE: -+ ret = rtw_ioctl_wext_private(dev, rq); -+ break; -+ case (SIOCDEVPRIVATE+1): -+ ret = rtw_android_priv_cmd(dev, rq, cmd); -+ break; -+ default: -+ ret = -EOPNOTSUPP; -+ break; -+ } -+ -+ return ret; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_mp.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_mp.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/ioctl_mp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/ioctl_mp.c 2018-02-11 21:44:27.175146513 +0200 -@@ -0,0 +1,2411 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#if defined(CONFIG_MP_INCLUDED) -+ -+#include -+#include -+#include -+#include "../../hal/phydm/phydm_precomp.h" -+ -+ -+#if defined(CONFIG_RTL8723B) -+ #include -+#endif -+ -+/* -+ * Input Format: %s,%d,%d -+ * %s is width, could be -+ * "b" for 1 byte -+ * "w" for WORD (2 bytes) -+ * "dw" for DWORD (4 bytes) -+ * 1st %d is address(offset) -+ * 2st %d is data to write -+ */ -+int rtw_mp_write_reg(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ char *pch, *pnext, *ptmp; -+ char *width_str; -+ char width, buf[5]; -+ u32 addr, data; -+ int ret; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->length]; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ pch = input; -+ -+ pnext = strpbrk(pch, " ,.-"); -+ if (pnext == NULL) -+ return -EINVAL; -+ *pnext = 0; -+ width_str = pch; -+ -+ pch = pnext + 1; -+ pnext = strpbrk(pch, " ,.-"); -+ if (pnext == NULL) -+ return -EINVAL; -+ *pnext = 0; -+ /*addr = simple_strtoul(pch, &ptmp, 16); -+ _rtw_memset(buf, '\0', sizeof(buf)); -+ _rtw_memcpy(buf, pch, pnext-pch); -+ ret = kstrtoul(buf, 16, &addr);*/ -+ ret = sscanf(pch, "%x", &addr); -+ if (addr > 0x3FFF) -+ return -EINVAL; -+ -+ pch = pnext + 1; -+ pnext = strpbrk(pch, " ,.-"); -+ if ((pch - input) >= wrqu->length) -+ return -EINVAL; -+ /*data = simple_strtoul(pch, &ptmp, 16);*/ -+ ret = sscanf(pch, "%x", &data); -+ RTW_INFO("data=%x,addr=%x\n", (u32)data, (u32)addr); -+ ret = 0; -+ width = width_str[0]; -+ switch (width) { -+ case 'b': -+ /* 1 byte*/ -+ if (data > 0xFF) { -+ ret = -EINVAL; -+ break; -+ } -+ rtw_write8(padapter, addr, data); -+ break; -+ case 'w': -+ /* 2 bytes*/ -+ if (data > 0xFFFF) { -+ ret = -EINVAL; -+ break; -+ } -+ rtw_write16(padapter, addr, data); -+ break; -+ case 'd': -+ /* 4 bytes*/ -+ rtw_write32(padapter, addr, data); -+ break; -+ default: -+ ret = -EINVAL; -+ break; -+ } -+ -+ return ret; -+} -+ -+ -+/* -+ * Input Format: %s,%d -+ * %s is width, could be -+ * "b" for 1 byte -+ * "w" for WORD (2 bytes) -+ * "dw" for DWORD (4 bytes) -+ * %d is address(offset) -+ * -+ * Return: -+ * %d for data readed -+ */ -+int rtw_mp_read_reg(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ char input[wrqu->length]; -+ char *pch, *pnext, *ptmp; -+ char *width_str; -+ char width; -+ char data[20], tmp[20], buf[3]; -+ u32 addr = 0, strtout = 0; -+ u32 i = 0, j = 0, ret = 0, data32 = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ -+ if (wrqu->length > 128) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ _rtw_memset(data, '\0', sizeof(data)); -+ _rtw_memset(tmp, '\0', sizeof(tmp)); -+ pch = input; -+ pnext = strpbrk(pch, " ,.-"); -+ if (pnext == NULL) -+ return -EINVAL; -+ *pnext = 0; -+ width_str = pch; -+ -+ pch = pnext + 1; -+ -+ ret = sscanf(pch, "%x", &addr); -+ if (addr > 0x3FFF) -+ return -EINVAL; -+ -+ ret = 0; -+ width = width_str[0]; -+ -+ switch (width) { -+ case 'b': -+ data32 = rtw_read8(padapter, addr); -+ RTW_INFO("%x\n", data32); -+ sprintf(extra, "%d", data32); -+ wrqu->length = strlen(extra); -+ break; -+ case 'w': -+ /* 2 bytes*/ -+ sprintf(data, "%04x\n", rtw_read16(padapter, addr)); -+ -+ for (i = 0 ; i <= strlen(data) ; i++) { -+ if (i % 2 == 0) { -+ tmp[j] = ' '; -+ j++; -+ } -+ if (data[i] != '\0') -+ tmp[j] = data[i]; -+ -+ j++; -+ } -+ pch = tmp; -+ RTW_INFO("pch=%s", pch); -+ -+ while (*pch != '\0') { -+ pnext = strpbrk(pch, " "); -+ if (!pnext || ((pnext - tmp) > 4)) -+ break; -+ -+ pnext++; -+ if (*pnext != '\0') { -+ /*strtout = simple_strtoul(pnext , &ptmp, 16);*/ -+ ret = sscanf(pnext, "%x", &strtout); -+ sprintf(extra, "%s %d" , extra , strtout); -+ } else -+ break; -+ pch = pnext; -+ } -+ wrqu->length = strlen(extra); -+ break; -+ case 'd': -+ /* 4 bytes */ -+ sprintf(data, "%08x", rtw_read32(padapter, addr)); -+ /*add read data format blank*/ -+ for (i = 0 ; i <= strlen(data) ; i++) { -+ if (i % 2 == 0) { -+ tmp[j] = ' '; -+ j++; -+ } -+ if (data[i] != '\0') -+ tmp[j] = data[i]; -+ -+ j++; -+ } -+ pch = tmp; -+ RTW_INFO("pch=%s", pch); -+ -+ while (*pch != '\0') { -+ pnext = strpbrk(pch, " "); -+ if (!pnext) -+ break; -+ -+ pnext++; -+ if (*pnext != '\0') { -+ ret = sscanf(pnext, "%x", &strtout); -+ sprintf(extra, "%s %d" , extra , strtout); -+ } else -+ break; -+ pch = pnext; -+ } -+ wrqu->length = strlen(extra); -+ break; -+ -+ default: -+ wrqu->length = 0; -+ ret = -EINVAL; -+ break; -+ } -+ -+ return ret; -+} -+ -+ -+/* -+ * Input Format: %d,%x,%x -+ * %d is RF path, should be smaller than MAX_RF_PATH_NUMS -+ * 1st %x is address(offset) -+ * 2st %x is data to write -+ */ -+int rtw_mp_write_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ -+ u32 path, addr, data; -+ int ret; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->length]; -+ -+ -+ _rtw_memset(input, 0, wrqu->length); -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ -+ ret = sscanf(input, "%d,%x,%x", &path, &addr, &data); -+ if (ret < 3) -+ return -EINVAL; -+ -+ if (path >= GET_HAL_RFPATH_NUM(padapter)) -+ return -EINVAL; -+ if (addr > 0xFF) -+ return -EINVAL; -+ if (data > 0xFFFFF) -+ return -EINVAL; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ write_rfreg(padapter, path, addr, data); -+ -+ sprintf(extra, "write_rf completed\n"); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+/* -+ * Input Format: %d,%x -+ * %d is RF path, should be smaller than MAX_RF_PATH_NUMS -+ * %x is address(offset) -+ * -+ * Return: -+ * %d for data readed -+ */ -+int rtw_mp_read_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ char input[wrqu->length]; -+ char *pch, *pnext, *ptmp; -+ char data[20], tmp[20], buf[3]; -+ u32 path, addr, strtou; -+ u32 ret, i = 0 , j = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if (wrqu->length > 128) -+ return -EFAULT; -+ _rtw_memset(input, 0, wrqu->length); -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ ret = sscanf(input, "%d,%x", &path, &addr); -+ if (ret < 2) -+ return -EINVAL; -+ -+ if (path >= GET_HAL_RFPATH_NUM(padapter)) -+ return -EINVAL; -+ if (addr > 0xFF) -+ return -EINVAL; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ sprintf(data, "%08x", read_rfreg(padapter, path, addr)); -+ /*add read data format blank*/ -+ for (i = 0 ; i <= strlen(data) ; i++) { -+ if (i % 2 == 0) { -+ tmp[j] = ' '; -+ j++; -+ } -+ tmp[j] = data[i]; -+ j++; -+ } -+ pch = tmp; -+ RTW_INFO("pch=%s", pch); -+ -+ while (*pch != '\0') { -+ pnext = strpbrk(pch, " "); -+ if (!pnext) -+ break; -+ pnext++; -+ if (*pnext != '\0') { -+ /*strtou =simple_strtoul(pnext , &ptmp, 16);*/ -+ ret = sscanf(pnext, "%x", &strtou); -+ sprintf(extra, "%s %d" , extra , strtou); -+ } else -+ break; -+ pch = pnext; -+ } -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_start(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 val8; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ LeaveAllPowerSaveMode(padapter); -+ -+ if (rtw_mi_check_fwstate(padapter, _FW_UNDER_SURVEY)) -+ rtw_mi_scan_abort(padapter, _FALSE); -+ -+ if (padapter->registrypriv.mp_mode == 0) { -+ rtw_hal_deinit(padapter); -+ padapter->registrypriv.mp_mode = 1; -+#ifdef CONFIG_RF_POWER_TRIM -+ if (!IS_HARDWARE_TYPE_8814A(padapter) && !IS_HARDWARE_TYPE_8822B(padapter)) { -+ padapter->registrypriv.RegPwrTrimEnable = 1; -+ rtw_hal_read_chip_info(padapter); -+ } -+#endif /*CONFIG_RF_POWER_TRIM*/ -+ rtw_hal_init(padapter); -+ } -+ -+ if (padapter->registrypriv.mp_mode == 0) -+ return -EPERM; -+ -+ if (padapter->mppriv.mode == MP_OFF) { -+ if (mp_start_test(padapter) == _FAIL) -+ return -EPERM; -+ padapter->mppriv.mode = MP_ON; -+ MPT_PwrCtlDM(padapter, 0); -+ } -+ padapter->mppriv.bmac_filter = _FALSE; -+#ifdef CONFIG_RTL8723B -+#ifdef CONFIG_USB_HCI -+ rtw_write32(padapter, 0x765, 0x0000); -+ rtw_write32(padapter, 0x948, 0x0280); -+#else -+ rtw_write32(padapter, 0x765, 0x0000); -+ rtw_write32(padapter, 0x948, 0x0000); -+#endif -+#ifdef CONFIG_FOR_RTL8723BS_VQ0 -+ rtw_write32(padapter, 0x765, 0x0000); -+ rtw_write32(padapter, 0x948, 0x0280); -+#endif -+ rtw_write8(padapter, 0x66, 0x27); /*Open BT uart Log*/ -+ rtw_write8(padapter, 0xc50, 0x20); /*for RX init Gain*/ -+#endif -+ ODM_Write_DIG(&pHalData->odmpriv, 0x20); -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ sprintf(extra, "mp_start ok\n"); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+ -+int rtw_mp_stop(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ -+ if (padapter->registrypriv.mp_mode == 1) { -+ -+ MPT_DeInitAdapter(padapter); -+ pHalFunc->hal_deinit(padapter); -+ padapter->registrypriv.mp_mode = 0; -+ pHalFunc->hal_init(padapter); -+ } -+ -+ if (padapter->mppriv.mode != MP_OFF) { -+ mp_stop_test(padapter); -+ padapter->mppriv.mode = MP_OFF; -+ } -+ _rtw_memset(extra, 0, wrqu->length); -+ sprintf(extra, "mp_stop ok\n"); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_rate(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 rate = MPT_RATE_1M; -+ u8 input[wrqu->length]; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ rate = rtw_mpRateParseFunc(padapter, input); -+ padapter->mppriv.rateidx = rate; -+ -+ if (rate == 0 && strcmp(input, "1M") != 0) { -+ rate = rtw_atoi(input); -+ padapter->mppriv.rateidx = MRateToHwRate(rate); -+ /*if (rate <= 0x7f) -+ rate = wifirate2_ratetbl_inx((u8)rate); -+ else if (rate < 0xC8) -+ rate = (rate - 0x79 + MPT_RATE_MCS0); -+ HT rate 0x80(MCS0) ~ 0x8F(MCS15) ~ 0x9F(MCS31) 128~159 -+ VHT1SS~2SS rate 0xA0 (VHT1SS_MCS0 44) ~ 0xB3 (VHT2SS_MCS9 #63) 160~179 -+ VHT rate 0xB4 (VHT3SS_MCS0 64) ~ 0xC7 (VHT2SS_MCS9 #83) 180~199 -+ else -+ VHT rate 0x90(VHT1SS_MCS0) ~ 0x99(VHT1SS_MCS9) 144~153 -+ rate =(rate - MPT_RATE_VHT1SS_MCS0); -+ */ -+ } -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ sprintf(extra, "Set data rate to %s index %d" , input, padapter->mppriv.rateidx); -+ RTW_INFO("%s: %s rate index=%d\n", __func__, input, padapter->mppriv.rateidx); -+ -+ if (padapter->mppriv.rateidx >= DESC_RATEVHTSS4MCS9) -+ return -EINVAL; -+ -+ pMptCtx->MptRateIndex = HwRateToMPTRate(padapter->mppriv.rateidx); -+ SetDataRate(padapter); -+ -+ wrqu->length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_channel(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 input[wrqu->length]; -+ u32 channel = 1; -+ int cur_ch_offset; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ channel = rtw_atoi(input); -+ /*RTW_INFO("%s: channel=%d\n", __func__, channel);*/ -+ _rtw_memset(extra, 0, wrqu->length); -+ sprintf(extra, "Change channel %d to channel %d", padapter->mppriv.channel , channel); -+ padapter->mppriv.channel = channel; -+ SetChannel(padapter); -+ pHalData->CurrentChannel = channel; -+ -+ wrqu->length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_bandwidth(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 bandwidth = 0, sg = 0; -+ int cur_ch_offset; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 input[wrqu->length]; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ if (sscanf(input, "40M=%d,shortGI=%d", &bandwidth, &sg) > 0) -+ RTW_INFO("%s: bw=%d sg=%d\n", __func__, bandwidth , sg); -+ -+ if (bandwidth == 1) -+ bandwidth = CHANNEL_WIDTH_40; -+ else if (bandwidth == 2) -+ bandwidth = CHANNEL_WIDTH_80; -+ -+ padapter->mppriv.bandwidth = (u8)bandwidth; -+ padapter->mppriv.preamble = sg; -+ _rtw_memset(extra, 0, wrqu->length); -+ sprintf(extra, "Change BW %d to BW %d\n", pHalData->CurrentChannelBW , bandwidth); -+ -+ SetBandwidth(padapter); -+ pHalData->CurrentChannelBW = bandwidth; -+ /*cur_ch_offset = rtw_get_offset_by_ch(padapter->mppriv.channel);*/ -+ /*set_channel_bwmode(padapter, padapter->mppriv.channel, cur_ch_offset, bandwidth);*/ -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_txpower_index(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->length]; -+ u32 rfpath; -+ u32 txpower_inx; -+ -+ if (wrqu->length > 128) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ rfpath = rtw_atoi(input); -+ txpower_inx = mpt_ProQueryCalTxPower(padapter, rfpath); -+ sprintf(extra, " %d", txpower_inx); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_txpower(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 idx_a = 0, idx_b = 0, idx_c = 0, idx_d = 0, status = 0; -+ int MsetPower = 1; -+ u8 input[wrqu->length]; -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ MsetPower = strncmp(input, "off", 3); -+ if (MsetPower == 0) { -+ padapter->mppriv.bSetTxPower = 0; -+ sprintf(extra, "MP Set power off"); -+ } else { -+ if (sscanf(input, "patha=%d,pathb=%d,pathc=%d,pathd=%d", &idx_a, &idx_b, &idx_c, &idx_d) < 3) -+ RTW_INFO("Invalid format on line %s ,patha=%d,pathb=%d,pathc=%d,pathd=%d\n", input , idx_a , idx_b , idx_c , idx_d); -+ -+ sprintf(extra, "Set power level path_A:%d path_B:%d path_C:%d path_D:%d", idx_a , idx_b , idx_c , idx_d); -+ padapter->mppriv.txpoweridx = (u8)idx_a; -+ -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_A] = (u8)idx_a; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_B] = (u8)idx_b; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_C] = (u8)idx_c; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_D] = (u8)idx_d; -+ padapter->mppriv.bSetTxPower = 1; -+ -+ SetTxPower(padapter); -+ } -+ -+ wrqu->length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_ant_tx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 i; -+ u8 input[wrqu->length]; -+ u16 antenna = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ sprintf(extra, "switch Tx antenna to %s", input); -+ -+ for (i = 0; i < strlen(input); i++) { -+ switch (input[i]) { -+ case 'a': -+ antenna |= ANTENNA_A; -+ break; -+ case 'b': -+ antenna |= ANTENNA_B; -+ break; -+ case 'c': -+ antenna |= ANTENNA_C; -+ break; -+ case 'd': -+ antenna |= ANTENNA_D; -+ break; -+ } -+ } -+ /*antenna |= BIT(extra[i]-'a');*/ -+ RTW_INFO("%s: antenna=0x%x\n", __func__, antenna); -+ padapter->mppriv.antenna_tx = antenna; -+ padapter->mppriv.antenna_rx = antenna; -+ /*RTW_INFO("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_tx);*/ -+ pHalData->AntennaTxPath = antenna; -+ -+ SetAntenna(padapter); -+ -+ wrqu->length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_ant_rx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 i; -+ u16 antenna = 0; -+ u8 input[wrqu->length]; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ /*RTW_INFO("%s: input=%s\n", __func__, input);*/ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ sprintf(extra, "switch Rx antenna to %s", input); -+ -+ for (i = 0; i < strlen(input); i++) { -+ switch (input[i]) { -+ case 'a': -+ antenna |= ANTENNA_A; -+ break; -+ case 'b': -+ antenna |= ANTENNA_B; -+ break; -+ case 'c': -+ antenna |= ANTENNA_C; -+ break; -+ case 'd': -+ antenna |= ANTENNA_D; -+ break; -+ } -+ } -+ -+ RTW_INFO("%s: antenna=0x%x\n", __func__, antenna); -+ padapter->mppriv.antenna_tx = antenna; -+ padapter->mppriv.antenna_rx = antenna; -+ pHalData->AntennaRxPath = antenna; -+ /*RTW_INFO("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_rx);*/ -+ SetAntenna(padapter); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+int rtw_set_ctx_destAddr(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ int jj, kk = 0; -+ -+ struct pkt_attrib *pattrib; -+ struct mp_priv *pmp_priv; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ pmp_priv = &padapter->mppriv; -+ pattrib = &pmp_priv->tx.attrib; -+ -+ if (strlen(extra) < 5) -+ return _FAIL; -+ -+ RTW_INFO("%s: in=%s\n", __func__, extra); -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) -+ pattrib->dst[jj] = key_2char2num(extra[kk], extra[kk + 1]); -+ -+ RTW_INFO("pattrib->dst:%x %x %x %x %x %x\n", pattrib->dst[0], pattrib->dst[1], pattrib->dst[2], pattrib->dst[3], pattrib->dst[4], pattrib->dst[5]); -+ return 0; -+} -+ -+ -+ -+int rtw_mp_ctx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 pkTx = 1; -+ int countPkTx = 1, cotuTx = 1, CarrSprTx = 1, scTx = 1, sgleTx = 1, stop = 1; -+ u32 bStartTest = 1; -+ u32 count = 0, pktinterval = 0, pktlen = 0; -+ u8 status; -+ struct mp_priv *pmp_priv; -+ struct pkt_attrib *pattrib; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ pmp_priv = &padapter->mppriv; -+ pattrib = &pmp_priv->tx.attrib; -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ RTW_INFO("%s: in=%s\n", __func__, extra); -+#ifdef CONFIG_CONCURRENT_MODE -+ if (!is_primary_adapter(padapter)) { -+ sprintf(extra, "Error: MP mode can't support Virtual Adapter, Please to use main Adapter.\n"); -+ wrqu->length = strlen(extra); -+ return 0; -+ } -+#endif -+ countPkTx = strncmp(extra, "count=", 5); /* strncmp TRUE is 0*/ -+ cotuTx = strncmp(extra, "background", 20); -+ CarrSprTx = strncmp(extra, "background,cs", 20); -+ scTx = strncmp(extra, "background,sc", 20); -+ sgleTx = strncmp(extra, "background,stone", 20); -+ pkTx = strncmp(extra, "background,pkt", 20); -+ stop = strncmp(extra, "stop", 4); -+ if (sscanf(extra, "count=%d,pkt", &count) > 0) -+ RTW_INFO("count= %d\n", count); -+ if (sscanf(extra, "pktinterval=%d", &pktinterval) > 0) -+ RTW_INFO("pktinterval= %d\n", pktinterval); -+ -+ if (sscanf(extra, "pktlen=%d", &pktlen) > 0) -+ RTW_INFO("pktlen= %d\n", pktlen); -+ -+ if (_rtw_memcmp(extra, "destmac=", 8)) { -+ wrqu->length -= 8; -+ rtw_set_ctx_destAddr(dev, info, wrqu, &extra[8]); -+ sprintf(extra, "Set dest mac OK !\n"); -+ return 0; -+ } -+ -+ /*RTW_INFO("%s: count=%d countPkTx=%d cotuTx=%d CarrSprTx=%d scTx=%d sgleTx=%d pkTx=%d stop=%d\n", __func__, count, countPkTx, cotuTx, CarrSprTx, pkTx, sgleTx, scTx, stop);*/ -+ _rtw_memset(extra, '\0', strlen(extra)); -+ -+ if (pktinterval != 0) { -+ sprintf(extra, "Pkt Interval = %d", pktinterval); -+ padapter->mppriv.pktInterval = pktinterval; -+ wrqu->length = strlen(extra); -+ return 0; -+ } -+ if (pktlen != 0) { -+ sprintf(extra, "Pkt len = %d", pktlen); -+ pattrib->pktlen = pktlen; -+ wrqu->length = strlen(extra); -+ return 0; -+ } -+ if (stop == 0) { -+ bStartTest = 0; /* To set Stop*/ -+ pmp_priv->tx.stop = 1; -+ sprintf(extra, "Stop continuous Tx"); -+ ODM_Write_DIG(&pHalData->odmpriv, 0x20); -+ } else { -+ bStartTest = 1; -+ ODM_Write_DIG(&pHalData->odmpriv, 0x7f); -+ if (pmp_priv->mode != MP_ON) { -+ if (pmp_priv->tx.stop != 1) { -+ RTW_INFO("%s: MP_MODE != ON %d\n", __func__, pmp_priv->mode); -+ return -EFAULT; -+ } -+ } -+ } -+ -+ pmp_priv->tx.count = count; -+ -+ if (pkTx == 0 || countPkTx == 0) -+ pmp_priv->mode = MP_PACKET_TX; -+ if (sgleTx == 0) -+ pmp_priv->mode = MP_SINGLE_TONE_TX; -+ if (cotuTx == 0) -+ pmp_priv->mode = MP_CONTINUOUS_TX; -+ if (CarrSprTx == 0) -+ pmp_priv->mode = MP_CARRIER_SUPPRISSION_TX; -+ if (scTx == 0) -+ pmp_priv->mode = MP_SINGLE_CARRIER_TX; -+ -+ status = rtw_mp_pretx_proc(padapter, bStartTest, extra); -+ -+ wrqu->length = strlen(extra); -+ return status; -+} -+ -+ -+ -+int rtw_mp_disable_bt_coexist(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ -+ u8 input[wrqu->data.length]; -+ u32 bt_coexist; -+ -+ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ bt_coexist = rtw_atoi(input); -+ -+ if (bt_coexist == 0) { -+ RTW_INFO("Set OID_RT_SET_DISABLE_BT_COEXIST: disable BT_COEXIST\n"); -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_HaltNotify(padapter); -+ rtw_btcoex_SetManualControl(padapter, _TRUE); -+ /* Force to switch Antenna to WiFi*/ -+ rtw_write16(padapter, 0x870, 0x300); -+ rtw_write16(padapter, 0x860, 0x110); -+#endif -+ /* CONFIG_BT_COEXIST */ -+ } else { -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SetManualControl(padapter, _FALSE); -+#endif -+ } -+ -+ return 0; -+} -+ -+ -+int rtw_mp_arx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ int bStartRx = 0, bStopRx = 0, bQueryPhy = 0, bQueryMac = 0, bSetBssid = 0; -+ int bmac_filter = 0, bfilter_init = 0, bmon = 0, bSmpCfg = 0, bloopbk = 0; -+ u8 input[wrqu->length]; -+ char *pch, *ptmp, *token, *tmp[2] = {0x00, 0x00}; -+ u32 i = 0, ii = 0, jj = 0, kk = 0, cnts = 0, ret; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ struct dbg_rx_counter rx_counter; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ RTW_INFO("%s: %s\n", __func__, input); -+#ifdef CONFIG_CONCURRENT_MODE -+ if (!is_primary_adapter(padapter)) { -+ sprintf(extra, "Error: MP mode can't support Virtual Adapter, Please to use main Adapter.\n"); -+ wrqu->length = strlen(extra); -+ return 0; -+ } -+#endif -+ bStartRx = (strncmp(input, "start", 5) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ bStopRx = (strncmp(input, "stop", 5) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ bQueryPhy = (strncmp(input, "phy", 3) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ bQueryMac = (strncmp(input, "mac", 3) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ bSetBssid = (strncmp(input, "setbssid=", 8) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ /*bfilter_init = (strncmp(input, "filter_init",11)==0)?1:0;*/ -+ bmac_filter = (strncmp(input, "accept_mac", 10) == 0) ? 1 : 0; -+ bmon = (strncmp(input, "mon=", 4) == 0) ? 1 : 0; -+ bSmpCfg = (strncmp(input , "smpcfg=" , 7) == 0) ? 1 : 0; -+ pmppriv->bloopback = (strncmp(input, "loopbk", 6) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ -+ -+ if (bSetBssid == 1) { -+ pch = input; -+ while ((token = strsep(&pch, "=")) != NULL) { -+ if (i > 1) -+ break; -+ tmp[i] = token; -+ i++; -+ } -+ if ((tmp[0] != NULL) && (tmp[1] != NULL)) { -+ cnts = strlen(tmp[1]) / 2; -+ if (cnts < 1) -+ return -EFAULT; -+ RTW_INFO("%s: cnts=%d\n", __func__, cnts); -+ RTW_INFO("%s: data=%s\n", __func__, tmp[1]); -+ for (jj = 0, kk = 0; jj < cnts ; jj++, kk += 2) { -+ pmppriv->network_macaddr[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); -+ RTW_INFO("network_macaddr[%d]=%x\n", jj, pmppriv->network_macaddr[jj]); -+ } -+ } else -+ return -EFAULT; -+ -+ pmppriv->bSetRxBssid = _TRUE; -+ } -+ -+ if (bmac_filter) { -+ pmppriv->bmac_filter = bmac_filter; -+ pch = input; -+ while ((token = strsep(&pch, "=")) != NULL) { -+ if (i > 1) -+ break; -+ tmp[i] = token; -+ i++; -+ } -+ if ((tmp[0] != NULL) && (tmp[1] != NULL)) { -+ cnts = strlen(tmp[1]) / 2; -+ if (cnts < 1) -+ return -EFAULT; -+ RTW_INFO("%s: cnts=%d\n", __func__, cnts); -+ RTW_INFO("%s: data=%s\n", __func__, tmp[1]); -+ for (jj = 0, kk = 0; jj < cnts ; jj++, kk += 2) { -+ pmppriv->mac_filter[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); -+ RTW_INFO("%s mac_filter[%d]=%x\n", __func__, jj, pmppriv->mac_filter[jj]); -+ } -+ } else -+ return -EFAULT; -+ -+ } -+ -+ if (bStartRx) { -+ sprintf(extra, "start"); -+ SetPacketRx(padapter, bStartRx, _FALSE); -+ } else if (bStopRx) { -+ SetPacketRx(padapter, bStartRx, _FALSE); -+ pmppriv->bmac_filter = _FALSE; -+ pmppriv->bSetRxBssid = _FALSE; -+ sprintf(extra, "Received packet OK:%d CRC error:%d ,Filter out:%d", padapter->mppriv.rx_pktcount, padapter->mppriv.rx_crcerrpktcount, padapter->mppriv.rx_pktcount_filter_out); -+ } else if (bQueryPhy) { -+ _rtw_memset(&rx_counter, 0, sizeof(struct dbg_rx_counter)); -+ rtw_dump_phy_rx_counters(padapter, &rx_counter); -+ -+ RTW_INFO("%s: OFDM_FA =%d\n", __func__, rx_counter.rx_ofdm_fa); -+ RTW_INFO("%s: CCK_FA =%d\n", __func__, rx_counter.rx_cck_fa); -+ sprintf(extra, "Phy Received packet OK:%d CRC error:%d FA Counter: %d", rx_counter.rx_pkt_ok, rx_counter.rx_pkt_crc_error, rx_counter.rx_cck_fa + rx_counter.rx_ofdm_fa); -+ -+ -+ } else if (bQueryMac) { -+ _rtw_memset(&rx_counter, 0, sizeof(struct dbg_rx_counter)); -+ rtw_dump_mac_rx_counters(padapter, &rx_counter); -+ sprintf(extra, "Mac Received packet OK: %d , CRC error: %d , Drop Packets: %d\n", -+ rx_counter.rx_pkt_ok, rx_counter.rx_pkt_crc_error, rx_counter.rx_pkt_drop); -+ -+ } -+ -+ if (bmon == 1) { -+ ret = sscanf(input, "mon=%d", &bmon); -+ -+ if (bmon == 1) { -+ pmppriv->rx_bindicatePkt = _TRUE; -+ sprintf(extra, "Indicating Receive Packet to network start\n"); -+ } else { -+ pmppriv->rx_bindicatePkt = _FALSE; -+ sprintf(extra, "Indicating Receive Packet to network Stop\n"); -+ } -+ } -+ if (bSmpCfg == 1) { -+ ret = sscanf(input, "smpcfg=%d", &bSmpCfg); -+ -+ if (bSmpCfg == 1) { -+ pmppriv->bRTWSmbCfg = _TRUE; -+ sprintf(extra , "Indicate By Simple Config Format\n"); -+ SetPacketRx(padapter, _TRUE, _TRUE); -+ } else { -+ pmppriv->bRTWSmbCfg = _FALSE; -+ sprintf(extra , "Indicate By Normal Format\n"); -+ SetPacketRx(padapter, _TRUE, _FALSE); -+ } -+ } -+ -+ if (pmppriv->bloopback == _TRUE) { -+ sprintf(extra , "Enter MAC LoopBack mode\n"); -+ _rtw_write32(padapter, 0x100, 0xB0106FF); -+ RTW_INFO("0x100 :0x%x" , _rtw_read32(padapter, 0x100)); -+ _rtw_write16(padapter, 0x608, 0x30c); -+ RTW_INFO("0x100 :0x%x" , _rtw_read32(padapter, 0x608)); -+ } -+ -+ wrqu->length = strlen(extra) + 1; -+ -+ return 0; -+} -+ -+ -+int rtw_mp_trx_query(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 txok, txfail, rxok, rxfail, rxfilterout; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; -+ -+ if (PMacTxInfo.bEnPMacTx == TRUE) -+ txok = hal_mpt_query_phytxok(padapter); -+ else -+ txok = padapter->mppriv.tx.sended; -+ -+ txfail = 0; -+ rxok = padapter->mppriv.rx_pktcount; -+ rxfail = padapter->mppriv.rx_crcerrpktcount; -+ rxfilterout = padapter->mppriv.rx_pktcount_filter_out; -+ -+ _rtw_memset(extra, '\0', 128); -+ -+ sprintf(extra, "Tx OK:%d, Tx Fail:%d, Rx OK:%d, CRC error:%d ,Rx Filter out:%d\n", txok, txfail, rxok, rxfail, rxfilterout); -+ -+ wrqu->length = strlen(extra) + 1; -+ -+ return 0; -+} -+ -+ -+int rtw_mp_pwrtrk(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 enable; -+ u32 thermal; -+ s32 ret; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 input[wrqu->length]; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ enable = 1; -+ if (wrqu->length > 1) { -+ /* not empty string*/ -+ if (strncmp(input, "stop", 4) == 0) { -+ enable = 0; -+ sprintf(extra, "mp tx power tracking stop"); -+ } else if (sscanf(input, "ther=%d", &thermal) == 1) { -+ ret = SetThermalMeter(padapter, (u8)thermal); -+ if (ret == _FAIL) -+ return -EPERM; -+ sprintf(extra, "mp tx power tracking start,target value=%d ok", thermal); -+ } else -+ return -EINVAL; -+ } -+ -+ ret = SetPowerTracking(padapter, enable); -+ if (ret == _FAIL) -+ return -EPERM; -+ -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+ -+int rtw_mp_psd(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ u8 input[wrqu->length]; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ strcpy(extra, input); -+ -+ wrqu->length = mp_query_psd(padapter, extra); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_thermal(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 val; -+ int bwrite = 1; -+ -+#ifdef CONFIG_RTL8188E -+ u16 addr = EEPROM_THERMAL_METER_88E; -+#endif -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) -+ u16 addr = EEPROM_THERMAL_METER_8812; -+#endif -+#ifdef CONFIG_RTL8192E -+ u16 addr = EEPROM_THERMAL_METER_8192E; -+#endif -+#ifdef CONFIG_RTL8723B -+ u16 addr = EEPROM_THERMAL_METER_8723B; -+#endif -+#ifdef CONFIG_RTL8703B -+ u16 addr = EEPROM_THERMAL_METER_8703B; -+#endif -+#ifdef CONFIG_RTL8723D -+ u16 addr = EEPROM_THERMAL_METER_8723D; -+#endif -+#ifdef CONFIG_RTL8188F -+ u16 addr = EEPROM_THERMAL_METER_8188F; -+#endif -+#ifdef CONFIG_RTL8822B -+ u16 addr = EEPROM_THERMAL_METER_8822B; -+#endif -+#ifdef CONFIG_RTL8821C -+ u16 addr = EEPROM_THERMAL_METER_8821C; -+#endif -+ u16 cnt = 1; -+ u16 max_available_size = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ bwrite = strncmp(extra, "write", 6);/* strncmp TRUE is 0*/ -+ -+ GetThermalMeter(padapter, &val); -+ -+ if (bwrite == 0) { -+ /*RTW_INFO("to write val:%d",val);*/ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); -+ if (2 > max_available_size) { -+ RTW_INFO("no available efuse!\n"); -+ return -EFAULT; -+ } -+ if (rtw_efuse_map_write(padapter, addr, cnt, &val) == _FAIL) { -+ RTW_INFO("rtw_efuse_map_write error\n"); -+ return -EFAULT; -+ } -+ sprintf(extra, " efuse write ok :%d", val); -+ } else -+ sprintf(extra, "%d", val); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+ -+int rtw_mp_reset_stats(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ struct mp_priv *pmp_priv; -+ struct pkt_attrib *pattrib; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ pmp_priv = &padapter->mppriv; -+ -+ pmp_priv->tx.sended = 0; -+ pmp_priv->tx_pktcount = 0; -+ pmp_priv->rx_pktcount = 0; -+ pmp_priv->rx_pktcount_filter_out = 0; -+ pmp_priv->rx_crcerrpktcount = 0; -+ -+ rtw_reset_phy_rx_counters(padapter); -+ rtw_reset_mac_rx_counters(padapter); -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ sprintf(extra, "mp_reset_stats ok\n"); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_dump(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ struct mp_priv *pmp_priv; -+ struct pkt_attrib *pattrib; -+ u32 value; -+ u8 input[wrqu->length]; -+ u8 rf_type, path_nums = 0; -+ u32 i, j = 1, path; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ pmp_priv = &padapter->mppriv; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ if (strncmp(input, "all", 4) == 0) { -+ mac_reg_dump(RTW_DBGDUMP, padapter); -+ bb_reg_dump(RTW_DBGDUMP, padapter); -+ rf_reg_dump(RTW_DBGDUMP, padapter); -+ } -+ return 0; -+} -+ -+ -+int rtw_mp_phypara(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ char input[wrqu->length]; -+ u32 valxcap, ret; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ RTW_INFO("%s:iwpriv in=%s\n", __func__, input); -+ -+ ret = sscanf(input, "xcap=%d", &valxcap); -+ -+ pHalData->CrystalCap = (u8)valxcap; -+ hal_set_crystal_cap(padapter , valxcap); -+ -+ sprintf(extra, "Set xcap=%d", valxcap); -+ wrqu->length = strlen(extra) + 1; -+ -+ return 0; -+ -+} -+ -+ -+int rtw_mp_SetRFPath(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->length]; -+ int bMain = 1, bTurnoff = 1; -+ -+ RTW_INFO("%s:iwpriv in=%s\n", __func__, input); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ bMain = strncmp(input, "1", 2); /* strncmp TRUE is 0*/ -+ bTurnoff = strncmp(input, "0", 3); /* strncmp TRUE is 0*/ -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ if (bMain == 0) { -+ MP_PHY_SetRFPathSwitch(padapter, _TRUE); -+ RTW_INFO("%s:PHY_SetRFPathSwitch=TRUE\n", __func__); -+ sprintf(extra, "mp_setrfpath Main\n"); -+ -+ } else if (bTurnoff == 0) { -+ MP_PHY_SetRFPathSwitch(padapter, _FALSE); -+ RTW_INFO("%s:PHY_SetRFPathSwitch=FALSE\n", __func__); -+ sprintf(extra, "mp_setrfpath Aux\n"); -+ } -+ -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+ -+int rtw_mp_QueryDrv(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->data.length]; -+ int qAutoLoad = 1; -+ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ RTW_INFO("%s:iwpriv in=%s\n", __func__, input); -+ -+ qAutoLoad = strncmp(input, "autoload", 8); /* strncmp TRUE is 0*/ -+ -+ if (qAutoLoad == 0) { -+ RTW_INFO("%s:qAutoLoad\n", __func__); -+ -+ if (pHalData->bautoload_fail_flag) -+ sprintf(extra, "fail"); -+ else -+ sprintf(extra, "ok"); -+ } -+ wrqu->data.length = strlen(extra) + 1; -+ return 0; -+} -+ -+ -+int rtw_mp_PwrCtlDM(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ u8 input[wrqu->length]; -+ int bstart = 1; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ bstart = strncmp(input, "start", 5); /* strncmp TRUE is 0*/ -+ if (bstart == 0) { -+ sprintf(extra, "PwrCtlDM start\n"); -+ MPT_PwrCtlDM(padapter, 1); -+ } else { -+ sprintf(extra, "PwrCtlDM stop\n"); -+ MPT_PwrCtlDM(padapter, 0); -+ } -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+int rtw_mp_iqk(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ rtw_mp_trigger_iqk(padapter); -+ -+ return 0; -+} -+ -+int rtw_mp_lck(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ rtw_mp_trigger_lck(padapter); -+ -+ return 0; -+} -+ -+int rtw_mp_getver(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct mp_priv *pmp_priv; -+ -+ pmp_priv = &padapter->mppriv; -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ sprintf(extra, "rtwpriv=%d\n", RTWPRIV_VER_INFO); -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_mon(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType; -+ int bstart = 1, bstop = 1; -+ -+ networkType = Ndis802_11Infrastructure; -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ LeaveAllPowerSaveMode(padapter); -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (init_mp_priv(padapter) == _FAIL) -+ RTW_INFO("%s: initialize MP private data Fail!\n", __func__); -+ padapter->mppriv.channel = 6; -+ -+ bstart = strncmp(extra, "start", 5); /* strncmp TRUE is 0*/ -+ bstop = strncmp(extra, "stop", 4); /* strncmp TRUE is 0*/ -+ if (bstart == 0) { -+ mp_join(padapter, WIFI_FW_ADHOC_STATE); -+ SetPacketRx(padapter, _TRUE, _FALSE); -+ SetChannel(padapter); -+ pmp_priv->rx_bindicatePkt = _TRUE; -+ pmp_priv->bRTWSmbCfg = _TRUE; -+ sprintf(extra, "monitor mode start\n"); -+ } else if (bstop == 0) { -+ SetPacketRx(padapter, _FALSE, _FALSE); -+ pmp_priv->rx_bindicatePkt = _FALSE; -+ pmp_priv->bRTWSmbCfg = _FALSE; -+ padapter->registrypriv.mp_mode = 1; -+ pHalFunc->hal_deinit(padapter); -+ padapter->registrypriv.mp_mode = 0; -+ pHalFunc->hal_init(padapter); -+ /*rtw_disassoc_cmd(padapter, 0, _TRUE);*/ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ rtw_disassoc_cmd(padapter, 500, _TRUE); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ /*rtw_free_assoc_resources(padapter, 1);*/ -+ } -+ rtw_pm_set_ips(padapter, IPS_NORMAL); -+ sprintf(extra, "monitor mode Stop\n"); -+ } -+#endif -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+int rtw_mp_pretx_proc(PADAPTER padapter, u8 bStartTest, char *extra) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ -+ switch (pmp_priv->mode) { -+ -+ case MP_PACKET_TX: -+ if (bStartTest == 0) { -+ pmp_priv->tx.stop = 1; -+ pmp_priv->mode = MP_ON; -+ sprintf(extra, "Stop continuous Tx"); -+ } else if (pmp_priv->tx.stop == 1) { -+ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500 count=%u\n", extra, pmp_priv->tx.count); -+ pmp_priv->tx.stop = 0; -+ SetPacketTx(padapter); -+ } else -+ return -EFAULT; -+ return 0; -+ case MP_SINGLE_TONE_TX: -+ if (bStartTest != 0) -+ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); -+ SetSingleToneTx(padapter, (u8)bStartTest); -+ break; -+ case MP_CONTINUOUS_TX: -+ if (bStartTest != 0) -+ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); -+ SetContinuousTx(padapter, (u8)bStartTest); -+ break; -+ case MP_CARRIER_SUPPRISSION_TX: -+ if (bStartTest != 0) { -+ if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_11M) -+ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); -+ else -+ sprintf(extra, "%s\nSpecify carrier suppression but not CCK rate", extra); -+ } -+ SetCarrierSuppressionTx(padapter, (u8)bStartTest); -+ break; -+ case MP_SINGLE_CARRIER_TX: -+ if (bStartTest != 0) -+ sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); -+ SetSingleCarrierTx(padapter, (u8)bStartTest); -+ break; -+ -+ default: -+ sprintf(extra, "Error! Continuous-Tx is not on-going."); -+ return -EFAULT; -+ } -+ -+ if (bStartTest == 1 && pmp_priv->mode != MP_ON) { -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ -+ if (pmp_priv->tx.stop == 0) { -+ pmp_priv->tx.stop = 1; -+ rtw_msleep_os(5); -+ } -+#ifdef CONFIG_80211N_HT -+ pmp_priv->tx.attrib.ht_en = 1; -+#endif -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx.count = 1; -+ SetPacketTx(padapter); -+ } else -+ pmp_priv->mode = MP_ON; -+ -+#if defined(CONFIG_RTL8812A) -+ if (IS_HARDWARE_TYPE_8812AU(padapter)) { -+ /* <20130425, Kordan> Turn off OFDM Rx to prevent from CCA causing Tx hang.*/ -+ if (pmp_priv->mode == MP_PACKET_TX) -+ PHY_SetBBReg(padapter, rCCAonSec_Jaguar, BIT3, 1); -+ else -+ PHY_SetBBReg(padapter, rCCAonSec_Jaguar, BIT3, 0); -+ } -+#endif -+ -+ return 0; -+} -+ -+ -+int rtw_mp_tx(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ u32 bandwidth = 0, sg = 0, channel = 6, txpower = 40, rate = 108, ant = 0, txmode = 1, count = 0; -+ u8 i = 0, j = 0, bStartTest = 1, status = 0, Idx = 0, tmpU1B = 0; -+ u16 antenna = 0; -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ RTW_INFO("extra = %s\n", extra); -+#ifdef CONFIG_CONCURRENT_MODE -+ if (!is_primary_adapter(padapter)) { -+ sprintf(extra, "Error: MP mode can't support Virtual Adapter, Please to use main Adapter.\n"); -+ wrqu->data.length = strlen(extra); -+ return 0; -+ } -+#endif -+ -+ if (strncmp(extra, "stop", 3) == 0) { -+ bStartTest = 0; /* To set Stop*/ -+ pmp_priv->tx.stop = 1; -+ sprintf(extra, "Stop continuous Tx"); -+ status = rtw_mp_pretx_proc(padapter, bStartTest, extra); -+ wrqu->data.length = strlen(extra); -+ return status; -+ } else if (strncmp(extra, "count", 5) == 0) { -+ if (sscanf(extra, "count=%d", &count) < 1) -+ RTW_INFO("Got Count=%d]\n", count); -+ pmp_priv->tx.count = count; -+ return 0; -+ } else if (strncmp(extra, "setting", 7) == 0) { -+ _rtw_memset(extra, 0, wrqu->data.length); -+ sprintf(extra, "Current Setting :\n Channel:%d", pmp_priv->channel); -+ sprintf(extra, "%s\n Bandwidth:%d", extra, pmp_priv->bandwidth); -+ sprintf(extra, "%s\n Rate index:%d", extra, pmp_priv->rateidx); -+ sprintf(extra, "%s\n TxPower index:%d", extra, pmp_priv->txpoweridx); -+ sprintf(extra, "%s\n Antenna TxPath:%d", extra, pmp_priv->antenna_tx); -+ sprintf(extra, "%s\n Antenna RxPath:%d", extra, pmp_priv->antenna_rx); -+ sprintf(extra, "%s\n MP Mode:%d", extra, pmp_priv->mode); -+ wrqu->data.length = strlen(extra); -+ return 0; -+#ifdef CONFIG_MP_VHT_HW_TX_MODE -+ } else if (strncmp(extra, "pmact", 5) == 0) { -+ if (strncmp(extra, "pmact=", 6) == 0) { -+ _rtw_memset(&pMptCtx->PMacTxInfo, 0, sizeof(pMptCtx->PMacTxInfo)); -+ if (strncmp(extra, "pmact=start", 11) == 0) { -+ pMptCtx->PMacTxInfo.bEnPMacTx = _TRUE; -+ sprintf(extra, "Set PMac Tx Mode start\n"); -+ } else { -+ pMptCtx->PMacTxInfo.bEnPMacTx = _FALSE; -+ sprintf(extra, "Set PMac Tx Mode Stop\n"); -+ } -+ if (pMptCtx->bldpc == TRUE) -+ pMptCtx->PMacTxInfo.bLDPC = _TRUE; -+ -+ if (pMptCtx->bstbc == TRUE) -+ pMptCtx->PMacTxInfo.bSTBC = _TRUE; -+ -+ pMptCtx->PMacTxInfo.bSPreamble = pmp_priv->preamble; -+ pMptCtx->PMacTxInfo.bSGI = pmp_priv->preamble; -+ pMptCtx->PMacTxInfo.BandWidth = pmp_priv->bandwidth; -+ pMptCtx->PMacTxInfo.TX_RATE = HwRateToMPTRate(pmp_priv->rateidx); -+ -+ pMptCtx->PMacTxInfo.Mode = pMptCtx->HWTxmode; -+ -+ pMptCtx->PMacTxInfo.NDP_sound = FALSE;/*(Adapter.PacketType == NDP_PKT)?TRUE:FALSE;*/ -+ -+ if (padapter->mppriv.pktInterval == 0) -+ pMptCtx->PMacTxInfo.PacketPeriod = 100; -+ else -+ pMptCtx->PMacTxInfo.PacketPeriod = padapter->mppriv.pktInterval; -+ -+ if (padapter->mppriv.pktLength < 1000) -+ pMptCtx->PMacTxInfo.PacketLength = 1000; -+ else -+ pMptCtx->PMacTxInfo.PacketLength = padapter->mppriv.pktLength; -+ -+ pMptCtx->PMacTxInfo.PacketPattern = rtw_random32() % 0xFF; -+ -+ if (padapter->mppriv.tx_pktcount != 0) -+ pMptCtx->PMacTxInfo.PacketCount = padapter->mppriv.tx_pktcount; -+ -+ pMptCtx->PMacTxInfo.Ntx = 0; -+ for (Idx = 16; Idx < 20; Idx++) { -+ tmpU1B = (padapter->mppriv.antenna_tx >> Idx) & 1; -+ if (tmpU1B) -+ pMptCtx->PMacTxInfo.Ntx++; -+ } -+ -+ _rtw_memset(pMptCtx->PMacTxInfo.MacAddress, 0xFF, ETH_ALEN); -+ -+ PMAC_Get_Pkt_Param(&pMptCtx->PMacTxInfo, &pMptCtx->PMacPktInfo); -+ -+ if (MPT_IS_CCK_RATE(pMptCtx->PMacTxInfo.TX_RATE)) -+ -+ CCK_generator(&pMptCtx->PMacTxInfo, &pMptCtx->PMacPktInfo); -+ else { -+ PMAC_Nsym_generator(&pMptCtx->PMacTxInfo, &pMptCtx->PMacPktInfo); -+ /* 24 BIT*/ -+ L_SIG_generator(pMptCtx->PMacPktInfo.N_sym, &pMptCtx->PMacTxInfo, &pMptCtx->PMacPktInfo); -+ } -+ /* 48BIT*/ -+ if (MPT_IS_HT_RATE(pMptCtx->PMacTxInfo.TX_RATE)) -+ HT_SIG_generator(&pMptCtx->PMacTxInfo, &pMptCtx->PMacPktInfo); -+ else if (MPT_IS_VHT_RATE(pMptCtx->PMacTxInfo.TX_RATE)) { -+ /* 48BIT*/ -+ VHT_SIG_A_generator(&pMptCtx->PMacTxInfo, &pMptCtx->PMacPktInfo); -+ -+ /* 26/27/29 BIT & CRC 8 BIT*/ -+ VHT_SIG_B_generator(&pMptCtx->PMacTxInfo); -+ -+ /* 32 BIT*/ -+ VHT_Delimiter_generator(&pMptCtx->PMacTxInfo); -+ } -+ -+ mpt_ProSetPMacTx(padapter); -+ -+ } else if (strncmp(extra, "pmact,mode=", 11) == 0) { -+ int txmode = 0; -+ -+ if (sscanf(extra, "pmact,mode=%d", &txmode) > 0) { -+ if (txmode == 1) { -+ pMptCtx->HWTxmode = CONTINUOUS_TX; -+ sprintf(extra, "\t Config HW Tx mode = CONTINUOUS_TX\n"); -+ } else if (txmode == 2) { -+ pMptCtx->HWTxmode = OFDM_Single_Tone_TX; -+ sprintf(extra, "\t Config HW Tx mode = OFDM_Single_Tone_TX\n"); -+ } else { -+ pMptCtx->HWTxmode = PACKETS_TX; -+ sprintf(extra, "\t Config HW Tx mode = PACKETS_TX\n"); -+ } -+ } else { -+ pMptCtx->HWTxmode = PACKETS_TX; -+ sprintf(extra, "\t Config HW Tx mode=\n 0 = PACKETS_TX\n 1 = CONTINUOUS_TX\n 2 = OFDM_Single_Tone_TX"); -+ } -+ } else if (strncmp(extra, "pmact,", 6) == 0) { -+ int PacketPeriod = 0, PacketLength = 0, PacketCout = 0; -+ int bldpc = 0, bstbc = 0; -+ -+ if (sscanf(extra, "pmact,period=%d", &PacketPeriod) > 0) { -+ padapter->mppriv.pktInterval = PacketPeriod; -+ RTW_INFO("PacketPeriod=%d\n", padapter->mppriv.pktInterval); -+ sprintf(extra, "PacketPeriod [1~255]= %d\n", padapter->mppriv.pktInterval); -+ -+ } else if (sscanf(extra, "pmact,length=%d", &PacketLength) > 0) { -+ padapter->mppriv.pktLength = PacketLength; -+ RTW_INFO("PacketPeriod=%d\n", padapter->mppriv.pktLength); -+ sprintf(extra, "PacketLength[~65535]=%d\n", padapter->mppriv.pktLength); -+ -+ } else if (sscanf(extra, "pmact,count=%d", &PacketCout) > 0) { -+ padapter->mppriv.tx_pktcount = PacketCout; -+ RTW_INFO("Packet Cout =%d\n", padapter->mppriv.tx_pktcount); -+ sprintf(extra, "Packet Cout =%d\n", padapter->mppriv.tx_pktcount); -+ -+ } else if (sscanf(extra, "pmact,ldpc=%d", &bldpc) > 0) { -+ pMptCtx->bldpc = bldpc; -+ RTW_INFO("Set LDPC =%d\n", pMptCtx->bldpc); -+ sprintf(extra, "Set LDPC =%d\n", pMptCtx->bldpc); -+ -+ } else if (sscanf(extra, "pmact,stbc=%d", &bstbc) > 0) { -+ pMptCtx->bstbc = bstbc; -+ RTW_INFO("Set STBC =%d\n", pMptCtx->bstbc); -+ sprintf(extra, "Set STBC =%d\n", pMptCtx->bstbc); -+ } else -+ sprintf(extra, "\n period={1~255}\n length={1000~65535}\n count={0~}\n ldpc={0/1}\n stbc={0/1}"); -+ -+ } -+ -+ wrqu->data.length = strlen(extra); -+ return 0; -+#endif -+ } else { -+ -+ if (sscanf(extra, "ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d", &channel, &bandwidth, &rate, &txpower, &ant, &txmode) < 6) { -+ RTW_INFO("Invalid format [ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d]\n", channel, bandwidth, rate, txpower, ant, txmode); -+ _rtw_memset(extra, 0, wrqu->data.length); -+ sprintf(extra, "\n Please input correct format as bleow:\n"); -+ sprintf(extra, "%s\t ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d\n", extra, channel, bandwidth, rate, txpower, ant, txmode); -+ sprintf(extra, "%s\n [ ch : BGN = <1~14> , A or AC = <36~165> ]", extra); -+ sprintf(extra, "%s\n [ bw : Bandwidth: 0 = 20M, 1 = 40M, 2 = 80M ]", extra); -+ sprintf(extra, "%s\n [ rate : CCK: 1 2 5.5 11M X 2 = < 2 4 11 22 >]", extra); -+ sprintf(extra, "%s\n [ OFDM: 6 9 12 18 24 36 48 54M X 2 = < 12 18 24 36 48 72 96 108>", extra); -+ sprintf(extra, "%s\n [ HT 1S2SS MCS0 ~ MCS15 : < [MCS0]=128 ~ [MCS7]=135 ~ [MCS15]=143 >", extra); -+ sprintf(extra, "%s\n [ HT 3SS MCS16 ~ MCS32 : < [MCS16]=144 ~ [MCS23]=151 ~ [MCS32]=159 >", extra); -+ sprintf(extra, "%s\n [ VHT 1SS MCS0 ~ MCS9 : < [MCS0]=160 ~ [MCS9]=169 >", extra); -+ sprintf(extra, "%s\n [ txpower : 1~63 power index", extra); -+ sprintf(extra, "%s\n [ ant : ,2T ex: AB=3 BC=6 CD=12", extra); -+ sprintf(extra, "%s\n [ txmode : < 0 = CONTINUOUS_TX, 1 = PACKET_TX, 2 = SINGLE_TONE_TX, 3 = CARRIER_SUPPRISSION_TX, 4 = SINGLE_CARRIER_TX>\n", extra); -+ wrqu->data.length = strlen(extra); -+ return status; -+ -+ } else { -+ RTW_INFO("Got format [ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d]\n", channel, bandwidth, rate, txpower, ant, txmode); -+ _rtw_memset(extra, 0, wrqu->data.length); -+ sprintf(extra, "Change Current channel %d to channel %d", padapter->mppriv.channel , channel); -+ padapter->mppriv.channel = channel; -+ SetChannel(padapter); -+ pHalData->CurrentChannel = channel; -+ -+ if (bandwidth == 1) -+ bandwidth = CHANNEL_WIDTH_40; -+ else if (bandwidth == 2) -+ bandwidth = CHANNEL_WIDTH_80; -+ sprintf(extra, "%s\nChange Current Bandwidth %d to Bandwidth %d", extra, padapter->mppriv.bandwidth , bandwidth); -+ padapter->mppriv.bandwidth = (u8)bandwidth; -+ padapter->mppriv.preamble = sg; -+ SetBandwidth(padapter); -+ pHalData->CurrentChannelBW = bandwidth; -+ -+ sprintf(extra, "%s\nSet power level :%d", extra, txpower); -+ padapter->mppriv.txpoweridx = (u8)txpower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_A] = (u8)txpower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_B] = (u8)txpower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_C] = (u8)txpower; -+ pMptCtx->TxPwrLevel[ODM_RF_PATH_D] = (u8)txpower; -+ -+ RTW_INFO("%s: bw=%d sg=%d\n", __func__, bandwidth, sg); -+ -+ if (rate <= 0x7f) -+ rate = wifirate2_ratetbl_inx((u8)rate); -+ else if (rate < 0xC8) -+ rate = (rate - 0x80 + MPT_RATE_MCS0); -+ /*HT rate 0x80(MCS0) ~ 0x8F(MCS15) ~ 0x9F(MCS31) 128~159 -+ VHT1SS~2SS rate 0xA0 (VHT1SS_MCS0 44) ~ 0xB3 (VHT2SS_MCS9 #63) 160~179 -+ VHT rate 0xB4 (VHT3SS_MCS0 64) ~ 0xC7 (VHT2SS_MCS9 #83) 180~199 -+ else -+ VHT rate 0x90(VHT1SS_MCS0) ~ 0x99(VHT1SS_MCS9) 144~153 -+ rate =(rate - MPT_RATE_VHT1SS_MCS0); -+ */ -+ RTW_INFO("%s: rate index=%d\n", __func__, rate); -+ if (rate >= MPT_RATE_LAST) -+ return -EINVAL; -+ sprintf(extra, "%s\nSet data rate to %d index %d", extra, padapter->mppriv.rateidx, rate); -+ -+ padapter->mppriv.rateidx = rate; -+ pMptCtx->MptRateIndex = rate; -+ SetDataRate(padapter); -+ -+ sprintf(extra, "%s\nSet Antenna Path :%d", extra, ant); -+ switch (ant) { -+ case 1: -+ antenna = ANTENNA_A; -+ break; -+ case 2: -+ antenna = ANTENNA_B; -+ break; -+ case 4: -+ antenna = ANTENNA_C; -+ break; -+ case 8: -+ antenna = ANTENNA_D; -+ break; -+ case 3: -+ antenna = ANTENNA_AB; -+ break; -+ case 5: -+ antenna = ANTENNA_AC; -+ break; -+ case 9: -+ antenna = ANTENNA_AD; -+ break; -+ case 6: -+ antenna = ANTENNA_BC; -+ break; -+ case 10: -+ antenna = ANTENNA_BD; -+ break; -+ case 12: -+ antenna = ANTENNA_CD; -+ break; -+ case 7: -+ antenna = ANTENNA_ABC; -+ break; -+ case 14: -+ antenna = ANTENNA_BCD; -+ break; -+ case 11: -+ antenna = ANTENNA_ABD; -+ break; -+ case 15: -+ antenna = ANTENNA_ABCD; -+ break; -+ } -+ RTW_INFO("%s: antenna=0x%x\n", __func__, antenna); -+ padapter->mppriv.antenna_tx = antenna; -+ padapter->mppriv.antenna_rx = antenna; -+ pHalData->AntennaTxPath = antenna; -+ SetAntenna(padapter); -+ -+ if (txmode == 0) -+ pmp_priv->mode = MP_CONTINUOUS_TX; -+ else if (txmode == 1) { -+ pmp_priv->mode = MP_PACKET_TX; -+ pmp_priv->tx.count = count; -+ } else if (txmode == 2) -+ pmp_priv->mode = MP_SINGLE_TONE_TX; -+ else if (txmode == 3) -+ pmp_priv->mode = MP_CARRIER_SUPPRISSION_TX; -+ else if (txmode == 4) -+ pmp_priv->mode = MP_SINGLE_CARRIER_TX; -+ -+ status = rtw_mp_pretx_proc(padapter, bStartTest, extra); -+ } -+ -+ } -+ -+ wrqu->data.length = strlen(extra); -+ return status; -+} -+ -+ -+int rtw_mp_rx(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ -+ u32 bandwidth = 0, sg = 0, channel = 6, ant = 0; -+ u16 antenna = 0; -+ u8 bStartRx = 0; -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (!is_primary_adapter(padapter)) { -+ sprintf(extra, "Error: MP mode can't support Virtual Adapter, Please to use main Adapter.\n"); -+ wrqu->data.length = strlen(extra); -+ return 0; -+ } -+#endif -+ -+ if (strncmp(extra, "stop", 4) == 0) { -+ _rtw_memset(extra, 0, wrqu->data.length); -+ SetPacketRx(padapter, bStartRx, _FALSE); -+ pmp_priv->bmac_filter = _FALSE; -+ sprintf(extra, "Received packet OK:%d CRC error:%d ,Filter out:%d", padapter->mppriv.rx_pktcount, padapter->mppriv.rx_crcerrpktcount, padapter->mppriv.rx_pktcount_filter_out); -+ wrqu->data.length = strlen(extra); -+ return 0; -+ -+ } else if (sscanf(extra, "ch=%d,bw=%d,ant=%d", &channel, &bandwidth, &ant) < 3) { -+ RTW_INFO("Invalid format [ch=%d,bw=%d,ant=%d]\n", channel, bandwidth, ant); -+ _rtw_memset(extra, 0, wrqu->data.length); -+ sprintf(extra, "\n Please input correct format as bleow:\n"); -+ sprintf(extra, "%s\t ch=%d,bw=%d,ant=%d\n", extra, channel, bandwidth, ant); -+ sprintf(extra, "%s\n [ ch : BGN = <1~14> , A or AC = <36~165> ]", extra); -+ sprintf(extra, "%s\n [ bw : Bandwidth: 0 = 20M, 1 = 40M, 2 = 80M ]", extra); -+ sprintf(extra, "%s\n [ ant : ,2T ex: AB=3 BC=6 CD=12", extra); -+ wrqu->data.length = strlen(extra); -+ return 0; -+ -+ } else { -+ bStartRx = 1; -+ RTW_INFO("Got format [ch=%d,bw=%d,ant=%d]\n", channel, bandwidth, ant); -+ _rtw_memset(extra, 0, wrqu->data.length); -+ sprintf(extra, "Change Current channel %d to channel %d", padapter->mppriv.channel , channel); -+ padapter->mppriv.channel = channel; -+ SetChannel(padapter); -+ pHalData->CurrentChannel = channel; -+ -+ if (bandwidth == 1) -+ bandwidth = CHANNEL_WIDTH_40; -+ else if (bandwidth == 2) -+ bandwidth = CHANNEL_WIDTH_80; -+ sprintf(extra, "%s\nChange Current Bandwidth %d to Bandwidth %d", extra, padapter->mppriv.bandwidth , bandwidth); -+ padapter->mppriv.bandwidth = (u8)bandwidth; -+ padapter->mppriv.preamble = sg; -+ SetBandwidth(padapter); -+ pHalData->CurrentChannelBW = bandwidth; -+ -+ sprintf(extra, "%s\nSet Antenna Path :%d", extra, ant); -+ switch (ant) { -+ case 1: -+ antenna = ANTENNA_A; -+ break; -+ case 2: -+ antenna = ANTENNA_B; -+ break; -+ case 4: -+ antenna = ANTENNA_C; -+ break; -+ case 8: -+ antenna = ANTENNA_D; -+ break; -+ case 3: -+ antenna = ANTENNA_AB; -+ break; -+ case 5: -+ antenna = ANTENNA_AC; -+ break; -+ case 9: -+ antenna = ANTENNA_AD; -+ break; -+ case 6: -+ antenna = ANTENNA_BC; -+ break; -+ case 10: -+ antenna = ANTENNA_BD; -+ break; -+ case 12: -+ antenna = ANTENNA_CD; -+ break; -+ case 7: -+ antenna = ANTENNA_ABC; -+ break; -+ case 14: -+ antenna = ANTENNA_BCD; -+ break; -+ case 11: -+ antenna = ANTENNA_ABD; -+ break; -+ case 15: -+ antenna = ANTENNA_ABCD; -+ break; -+ } -+ RTW_INFO("%s: antenna=0x%x\n", __func__, antenna); -+ padapter->mppriv.antenna_tx = antenna; -+ padapter->mppriv.antenna_rx = antenna; -+ pHalData->AntennaTxPath = antenna; -+ SetAntenna(padapter); -+ -+ sprintf(extra, "%s\nstart Rx", extra); -+ SetPacketRx(padapter, bStartRx, _FALSE); -+ } -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_mp_hwtx(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ u8 input[wrqu->data.length]; -+ -+ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ _rtw_memset(&pMptCtx->PMacTxInfo, 0, sizeof(RT_PMAC_TX_INFO)); -+ _rtw_memcpy((void *)&pMptCtx->PMacTxInfo, (void *)input, sizeof(RT_PMAC_TX_INFO)); -+ -+ mpt_ProSetPMacTx(padapter); -+ sprintf(extra, "Set PMac Tx Mode start\n"); -+ -+ wrqu->data.length = strlen(extra); -+#endif -+ return 0; -+ -+} -+ -+int rtw_efuse_mask_file(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ char *rtw_efuse_mask_file_path; -+ u8 Status; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ _rtw_memset(maskfileBuffer, 0x00, sizeof(maskfileBuffer)); -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ if (strncmp(extra, "off", 3) == 0 && strlen(extra) < 4) { -+ padapter->registrypriv.boffefusemask = 1; -+ sprintf(extra, "Turn off Efuse Mask\n"); -+ wrqu->data.length = strlen(extra); -+ return 0; -+ } -+ if (strncmp(extra, "on", 2) == 0 && strlen(extra) < 3) { -+ padapter->registrypriv.boffefusemask = 0; -+ sprintf(extra, "Turn on Efuse Mask\n"); -+ wrqu->data.length = strlen(extra); -+ return 0; -+ } -+ rtw_efuse_mask_file_path = extra; -+ -+ if (rtw_is_file_readable(rtw_efuse_mask_file_path) == _TRUE) { -+ RTW_INFO("%s do rtw_efuse_mask_file_read = %s! ,sizeof maskfileBuffer %zu\n", __func__, rtw_efuse_mask_file_path, sizeof(maskfileBuffer)); -+ Status = rtw_efuse_file_read(padapter, rtw_efuse_mask_file_path, maskfileBuffer, sizeof(maskfileBuffer)); -+ if (Status == _TRUE) -+ padapter->registrypriv.bFileMaskEfuse = _TRUE; -+ sprintf(extra, "efuse mask file read OK\n"); -+ } else { -+ padapter->registrypriv.bFileMaskEfuse = _FALSE; -+ sprintf(extra, "efuse mask file readable FAIL\n"); -+ RTW_INFO("%s rtw_is_file_readable fail!\n", __func__); -+ } -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+ -+int rtw_efuse_file_map(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ char *rtw_efuse_file_map_path; -+ u8 Status; -+ PEFUSE_HAL pEfuseHal; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ -+ pEfuseHal = &pHalData->EfuseHal; -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ -+ rtw_efuse_file_map_path = extra; -+ -+ _rtw_memset(pEfuseHal->fakeEfuseModifiedMap, 0xFF, EFUSE_MAX_MAP_LEN); -+ -+ if (rtw_is_file_readable(rtw_efuse_file_map_path) == _TRUE) { -+ RTW_INFO("%s do rtw_efuse_mask_file_read = %s!\n", __func__, rtw_efuse_file_map_path); -+ Status = rtw_efuse_file_read(padapter, rtw_efuse_file_map_path, pEfuseHal->fakeEfuseModifiedMap, sizeof(pEfuseHal->fakeEfuseModifiedMap)); -+ if (Status == _TRUE) { -+ pmp_priv->bloadefusemap = _TRUE; -+ sprintf(extra, "efuse file file_read OK\n"); -+ } else { -+ pmp_priv->bloadefusemap = _FALSE; -+ sprintf(extra, "efuse file file_read FAIL\n"); -+ } -+ } else { -+ sprintf(extra, "efuse file readable FAIL\n"); -+ RTW_INFO("%s rtw_is_file_readable fail!\n", __func__); -+ } -+ wrqu->data.length = strlen(extra); -+ return 0; -+} -+ -+#if defined(CONFIG_RTL8723B) -+int rtw_mp_SetBT(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ BT_REQ_CMD BtReq; -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ PBT_RSP_CMD pBtRsp = (PBT_RSP_CMD)&pMptCtx->mptOutBuf[0]; -+ char input[128]; -+ char *pch, *ptmp, *token, *tmp[2] = {0x00, 0x00}; -+ u8 setdata[100]; -+ u8 resetbt = 0x00; -+ u8 tempval, BTStatus; -+ u8 H2cSetbtmac[6]; -+ u8 u1H2CBtMpOperParm[4] = {0x01}; -+ int testmode = 1, ready = 1, trxparam = 1, setgen = 1, getgen = 1, testctrl = 1, testbt = 1, readtherm = 1, setbtmac = 1; -+ u32 i = 0, ii = 0, jj = 0, kk = 0, cnts = 0, status = 0; -+ PRT_MP_FIRMWARE pBTFirmware = NULL; -+ -+ if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ if (strlen(extra) < 1) -+ return -EFAULT; -+ -+ RTW_INFO("%s:iwpriv in=%s\n", __func__, extra); -+ ready = strncmp(extra, "ready", 5); -+ testmode = strncmp(extra, "testmode", 8); /* strncmp TRUE is 0*/ -+ trxparam = strncmp(extra, "trxparam", 8); -+ setgen = strncmp(extra, "setgen", 6); -+ getgen = strncmp(extra, "getgen", 6); -+ testctrl = strncmp(extra, "testctrl", 8); -+ testbt = strncmp(extra, "testbt", 6); -+ readtherm = strncmp(extra, "readtherm", 9); -+ setbtmac = strncmp(extra, "setbtmac", 8); -+ -+ if (strncmp(extra, "dlbt", 4) == 0) { -+ pHalData->LastHMEBoxNum = 0; -+ padapter->bBTFWReady = _FALSE; -+ rtw_write8(padapter, 0xa3, 0x05); -+ BTStatus = rtw_read8(padapter, 0xa0); -+ RTW_INFO("%s: btwmap before read 0xa0 BT Status =0x%x\n", __func__, BTStatus); -+ if (BTStatus != 0x04) { -+ sprintf(extra, "BT Status not Active DLFW FAIL\n"); -+ goto exit; -+ } -+ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval |= BIT7; -+ rtw_write8(padapter, 0x6B, tempval); -+ -+ /* Attention!! Between 0x6A[14] and 0x6A[15] setting need 100us delay*/ -+ /* So don't write 0x6A[14]=1 and 0x6A[15]=0 together!*/ -+ rtw_usleep_os(100); -+ /* disable BT power cut*/ -+ /* 0x6A[14] = 0*/ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval &= ~BIT6; -+ rtw_write8(padapter, 0x6B, tempval); -+ rtw_usleep_os(100); -+ MPT_PwrCtlDM(padapter, 0); -+ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) | 0x00000004)); -+ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) & 0xFFFFFFEF)); -+ rtw_msleep_os(600); -+ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) | 0x00000010)); -+ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) & 0xFFFFFFFB)); -+ rtw_msleep_os(1200); -+ pBTFirmware = (PRT_MP_FIRMWARE)rtw_zmalloc(sizeof(RT_MP_FIRMWARE)); -+ if (pBTFirmware == NULL) -+ goto exit; -+ padapter->bBTFWReady = _FALSE; -+ FirmwareDownloadBT(padapter, pBTFirmware); -+ if (pBTFirmware) -+ rtw_mfree((u8 *)pBTFirmware, sizeof(RT_MP_FIRMWARE)); -+ -+ RTW_INFO("Wait for FirmwareDownloadBT fw boot!\n"); -+ rtw_msleep_os(2000); -+ _rtw_memset(extra, '\0', wrqu->data.length); -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 0; -+ BtReq.paraLength = 0; -+ mptbt_BtControlProcess(padapter, &BtReq); -+ rtw_msleep_os(100); -+ -+ RTW_INFO("FirmwareDownloadBT ready = 0x%x 0x%x", pMptCtx->mptOutBuf[4], pMptCtx->mptOutBuf[5]); -+ if ((pMptCtx->mptOutBuf[4] == 0x00) && (pMptCtx->mptOutBuf[5] == 0x00)) { -+ -+ if (padapter->mppriv.bTxBufCkFail == _TRUE) -+ sprintf(extra, "check TxBuf Fail.\n"); -+ else -+ sprintf(extra, "download FW Fail.\n"); -+ } else { -+ sprintf(extra, "download FW OK.\n"); -+ goto exit; -+ } -+ goto exit; -+ } -+ if (strncmp(extra, "dlfw", 4) == 0) { -+ pHalData->LastHMEBoxNum = 0; -+ padapter->bBTFWReady = _FALSE; -+ rtw_write8(padapter, 0xa3, 0x05); -+ BTStatus = rtw_read8(padapter, 0xa0); -+ RTW_INFO("%s: btwmap before read 0xa0 BT Status =0x%x\n", __func__, BTStatus); -+ if (BTStatus != 0x04) { -+ sprintf(extra, "BT Status not Active DLFW FAIL\n"); -+ goto exit; -+ } -+ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval |= BIT7; -+ rtw_write8(padapter, 0x6B, tempval); -+ -+ /* Attention!! Between 0x6A[14] and 0x6A[15] setting need 100us delay*/ -+ /* So don't write 0x6A[14]=1 and 0x6A[15]=0 together!*/ -+ rtw_usleep_os(100); -+ /* disable BT power cut*/ -+ /* 0x6A[14] = 0*/ -+ tempval = rtw_read8(padapter, 0x6B); -+ tempval &= ~BIT6; -+ rtw_write8(padapter, 0x6B, tempval); -+ rtw_usleep_os(100); -+ -+ MPT_PwrCtlDM(padapter, 0); -+ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) | 0x00000004)); -+ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) & 0xFFFFFFEF)); -+ rtw_msleep_os(600); -+ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) | 0x00000010)); -+ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) & 0xFFFFFFFB)); -+ rtw_msleep_os(1200); -+ -+#if defined(CONFIG_PLATFORM_SPRD) && (MP_DRIVER == 1) -+ /* Pull up BT reset pin.*/ -+ RTW_INFO("%s: pull up BT reset pin when bt start mp test\n", __func__); -+ rtw_wifi_gpio_wlan_ctrl(WLAN_BT_PWDN_ON); -+#endif -+ RTW_INFO(" FirmwareDownload!\n"); -+ -+#if defined(CONFIG_RTL8723B) -+ status = rtl8723b_FirmwareDownload(padapter, _FALSE); -+#endif -+ RTW_INFO("Wait for FirmwareDownloadBT fw boot!\n"); -+ rtw_msleep_os(1000); -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_HaltNotify(padapter); -+ RTW_INFO("SetBT btcoex HaltNotify !\n"); -+ /*hal_btcoex1ant_SetAntPath(padapter);*/ -+ rtw_btcoex_SetManualControl(padapter, _TRUE); -+#endif -+ _rtw_memset(extra, '\0', wrqu->data.length); -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 0; -+ BtReq.paraLength = 0; -+ mptbt_BtControlProcess(padapter, &BtReq); -+ rtw_msleep_os(200); -+ -+ RTW_INFO("FirmwareDownloadBT ready = 0x%x 0x%x", pMptCtx->mptOutBuf[4], pMptCtx->mptOutBuf[5]); -+ if ((pMptCtx->mptOutBuf[4] == 0x00) && (pMptCtx->mptOutBuf[5] == 0x00)) { -+ if (padapter->mppriv.bTxBufCkFail == _TRUE) -+ sprintf(extra, "check TxBuf Fail.\n"); -+ else -+ sprintf(extra, "download FW Fail.\n"); -+ } else { -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SwitchBtTRxMask(padapter); -+#endif -+ rtw_msleep_os(200); -+ sprintf(extra, "download FW OK.\n"); -+ goto exit; -+ } -+ goto exit; -+ } -+ -+ if (strncmp(extra, "down", 4) == 0) { -+ RTW_INFO("SetBT down for to hal_init !\n"); -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SetManualControl(padapter, _FALSE); -+ rtw_btcoex_Initialize(padapter); -+#endif -+ pHalFunc->read_adapter_info(padapter); -+ pHalFunc->hal_deinit(padapter); -+ pHalFunc->hal_init(padapter); -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ LeaveAllPowerSaveMode(padapter); -+ MPT_PwrCtlDM(padapter, 0); -+ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) | 0x00000004)); -+ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) & 0xFFFFFFEF)); -+ rtw_msleep_os(600); -+ /*rtw_write32(padapter, 0x6a, (rtw_read32(padapter, 0x6a)& 0xFFFFFFFE));*/ -+ rtw_write32(padapter, 0x6b, (rtw_read32(padapter, 0x6b) | 0x00000010)); -+ rtw_write32(padapter, 0xcc, (rtw_read32(padapter, 0xcc) & 0xFFFFFFFB)); -+ rtw_msleep_os(1200); -+ goto exit; -+ } -+ if (strncmp(extra, "disable", 7) == 0) { -+ RTW_INFO("SetBT disable !\n"); -+ rtw_write32(padapter, 0x6a, (rtw_read32(padapter, 0x6a) & 0xFFFFFFFB)); -+ rtw_msleep_os(500); -+ goto exit; -+ } -+ if (strncmp(extra, "enable", 6) == 0) { -+ RTW_INFO("SetBT enable !\n"); -+ rtw_write32(padapter, 0x6a, (rtw_read32(padapter, 0x6a) | 0x00000004)); -+ rtw_msleep_os(500); -+ goto exit; -+ } -+ if (strncmp(extra, "h2c", 3) == 0) { -+ RTW_INFO("SetBT h2c !\n"); -+ padapter->bBTFWReady = _TRUE; -+ rtw_hal_fill_h2c_cmd(padapter, 0x63, 1, u1H2CBtMpOperParm); -+ goto exit; -+ } -+ if (strncmp(extra, "2ant", 4) == 0) { -+ RTW_INFO("Set BT 2ant use!\n"); -+ PHY_SetMacReg(padapter, 0x67, BIT5, 0x1); -+ rtw_write32(padapter, 0x948, 0000); -+ -+ goto exit; -+ } -+ -+ if (ready != 0 && testmode != 0 && trxparam != 0 && setgen != 0 && getgen != 0 && testctrl != 0 && testbt != 0 && readtherm != 0 && setbtmac != 0) -+ return -EFAULT; -+ -+ if (testbt == 0) { -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 6; -+ BtReq.paraLength = cnts / 2; -+ goto todo; -+ } -+ if (ready == 0) { -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 0; -+ BtReq.paraLength = 0; -+ goto todo; -+ } -+ -+ pch = extra; -+ i = 0; -+ while ((token = strsep(&pch, ",")) != NULL) { -+ if (i > 1) -+ break; -+ tmp[i] = token; -+ i++; -+ } -+ -+ if ((tmp[0] != NULL) && (tmp[1] != NULL)) { -+ cnts = strlen(tmp[1]); -+ if (cnts < 1) -+ return -EFAULT; -+ -+ RTW_INFO("%s: cnts=%d\n", __func__, cnts); -+ RTW_INFO("%s: data=%s\n", __func__, tmp[1]); -+ -+ for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) { -+ BtReq.pParamStart[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); -+ /* RTW_INFO("BtReq.pParamStart[%d]=0x%02x\n", jj, BtReq.pParamStart[jj]);*/ -+ } -+ } else -+ return -EFAULT; -+ -+ if (testmode == 0) { -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 1; -+ BtReq.paraLength = 1; -+ } -+ if (trxparam == 0) { -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 2; -+ BtReq.paraLength = cnts / 2; -+ } -+ if (setgen == 0) { -+ RTW_INFO("%s: BT_SET_GENERAL\n", __func__); -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 3;/*BT_SET_GENERAL 3*/ -+ BtReq.paraLength = cnts / 2; -+ } -+ if (getgen == 0) { -+ RTW_INFO("%s: BT_GET_GENERAL\n", __func__); -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 4;/*BT_GET_GENERAL 4*/ -+ BtReq.paraLength = cnts / 2; -+ } -+ if (readtherm == 0) { -+ RTW_INFO("%s: BT_GET_GENERAL\n", __func__); -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 4;/*BT_GET_GENERAL 4*/ -+ BtReq.paraLength = cnts / 2; -+ } -+ -+ if (testctrl == 0) { -+ RTW_INFO("%s: BT_TEST_CTRL\n", __func__); -+ BtReq.opCodeVer = 1; -+ BtReq.OpCode = 5;/*BT_TEST_CTRL 5*/ -+ BtReq.paraLength = cnts / 2; -+ } -+ -+ RTW_INFO("%s: Req opCodeVer=%d OpCode=%d paraLength=%d\n", -+ __func__, BtReq.opCodeVer, BtReq.OpCode, BtReq.paraLength); -+ -+ if (BtReq.paraLength < 1) -+ goto todo; -+ for (i = 0; i < BtReq.paraLength; i++) { -+ RTW_INFO("%s: BtReq.pParamStart[%d] = 0x%02x\n", -+ __func__, i, BtReq.pParamStart[i]); -+ } -+ -+todo: -+ _rtw_memset(extra, '\0', wrqu->data.length); -+ -+ if (padapter->bBTFWReady == _FALSE) { -+ sprintf(extra, "BTFWReady = FALSE.\n"); -+ goto exit; -+ } -+ -+ mptbt_BtControlProcess(padapter, &BtReq); -+ -+ if (readtherm == 0) { -+ sprintf(extra, "BT thermal="); -+ for (i = 4; i < pMptCtx->mptOutLen; i++) { -+ if ((pMptCtx->mptOutBuf[i] == 0x00) && (pMptCtx->mptOutBuf[i + 1] == 0x00)) -+ goto exit; -+ -+ sprintf(extra, "%s %d ", extra, (pMptCtx->mptOutBuf[i] & 0x1f)); -+ } -+ } else { -+ for (i = 4; i < pMptCtx->mptOutLen; i++) -+ sprintf(extra, "%s 0x%x ", extra, pMptCtx->mptOutBuf[i]); -+ } -+ -+exit: -+ wrqu->data.length = strlen(extra) + 1; -+ RTW_INFO("-%s: output len=%d data=%s\n", __func__, wrqu->data.length, extra); -+ -+ return status; -+} -+ -+#endif /*#ifdef CONFIG_RTL8723B*/ -+ -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/mlme_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/mlme_linux.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/mlme_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/mlme_linux.c 2018-02-11 21:44:27.175146513 +0200 -@@ -0,0 +1,604 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#define _MLME_OSDEP_C_ -+ -+#include -+ -+ -+#ifdef RTK_DMP_PLATFORM -+void Linkup_workitem_callback(struct work_struct *work) -+{ -+ struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkup_workitem); -+ _adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv); -+ -+ -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12)) -+ kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKUP); -+#else -+ kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKUP); -+#endif -+ -+} -+ -+void Linkdown_workitem_callback(struct work_struct *work) -+{ -+ struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkdown_workitem); -+ _adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv); -+ -+ -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12)) -+ kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKDOWN); -+#else -+ kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKDOWN); -+#endif -+ -+} -+#endif -+ -+ -+/* -+void sitesurvey_ctrl_handler(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ -+ _sitesurvey_ctrl_handler(adapter); -+ -+ _set_timer(&adapter->mlmepriv.sitesurveyctrl.sitesurvey_ctrl_timer, 3000); -+} -+*/ -+ -+void rtw_join_timeout_handler(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ _rtw_join_timeout_handler(adapter); -+} -+ -+ -+void _rtw_scan_timeout_handler(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ rtw_scan_timeout_handler(adapter); -+} -+ -+ -+void _dynamic_check_timer_handlder(void *FunctionContext) -+{ -+ struct dvobj_priv *pdvobj = (struct dvobj_priv *)FunctionContext; -+ _adapter *adapter = dvobj_get_primary_adapter(pdvobj); -+ -+#if (MP_DRIVER == 1) -+ if (adapter->registrypriv.mp_mode == 1 && adapter->mppriv.mp_dm == 0) { /* for MP ODM dynamic Tx power tracking */ -+ /* RTW_INFO("_dynamic_check_timer_handlder mp_dm =0 return\n"); */ -+ _set_timer(&pdvobj->dynamic_chk_timer, 2000); -+ return; -+ } -+#endif -+ -+ rtw_dynamic_check_timer_handlder(adapter); -+ -+ _set_timer(&pdvobj->dynamic_chk_timer, 2000); -+} -+ -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+void _rtw_set_scan_deny_timer_hdl(void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ rtw_set_scan_deny_timer_hdl(adapter); -+} -+#endif -+ -+ -+void rtw_init_mlme_timer(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ _init_timer(&(pmlmepriv->assoc_timer), padapter->pnetdev, rtw_join_timeout_handler, padapter); -+ /* _init_timer(&(pmlmepriv->sitesurveyctrl.sitesurvey_ctrl_timer), padapter->pnetdev, sitesurvey_ctrl_handler, padapter); */ -+ _init_timer(&(pmlmepriv->scan_to_timer), padapter->pnetdev, _rtw_scan_timeout_handler, padapter); -+ -+#ifdef CONFIG_DFS_MASTER -+ _init_timer(&(pmlmepriv->dfs_master_timer), padapter->pnetdev, rtw_dfs_master_timer_hdl, padapter); -+#endif -+ -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+ _init_timer(&(pmlmepriv->set_scan_deny_timer), padapter->pnetdev, _rtw_set_scan_deny_timer_hdl, padapter); -+#endif -+ -+#ifdef RTK_DMP_PLATFORM -+ _init_workitem(&(pmlmepriv->Linkup_workitem), Linkup_workitem_callback, padapter); -+ _init_workitem(&(pmlmepriv->Linkdown_workitem), Linkdown_workitem_callback, padapter); -+#endif -+ -+} -+ -+extern void rtw_indicate_wx_assoc_event(_adapter *padapter); -+extern void rtw_indicate_wx_disassoc_event(_adapter *padapter); -+ -+void rtw_os_indicate_connect(_adapter *adapter) -+{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) -+ rtw_cfg80211_ibss_indicate_connect(adapter); -+ else -+ rtw_cfg80211_indicate_connect(adapter); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ rtw_indicate_wx_assoc_event(adapter); -+ netif_carrier_on(adapter->pnetdev); -+ -+ if (adapter->pid[2] != 0) -+ rtw_signal_process(adapter->pid[2], SIGALRM); -+ -+#ifdef RTK_DMP_PLATFORM -+ _set_workitem(&adapter->mlmepriv.Linkup_workitem); -+#endif -+ -+ -+} -+ -+extern void indicate_wx_scan_complete_event(_adapter *padapter); -+void rtw_os_indicate_scan_done(_adapter *padapter, bool aborted) -+{ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_indicate_scan_done(padapter, aborted); -+#endif -+ indicate_wx_scan_complete_event(padapter); -+} -+ -+static RT_PMKID_LIST backupPMKIDList[NUM_PMKID_CACHE]; -+void rtw_reset_securitypriv(_adapter *adapter) -+{ -+ u8 backupPMKIDIndex = 0; -+ u8 backupTKIPCountermeasure = 0x00; -+ u32 backupTKIPcountermeasure_time = 0; -+ /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ _irqL irqL; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ -+ _enter_critical_bh(&adapter->security_key_mutex, &irqL); -+ -+ if (adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { /* 802.1x */ -+ /* Added by Albert 2009/02/18 */ -+ /* We have to backup the PMK information for WiFi PMK Caching test item. */ -+ /* */ -+ /* Backup the btkip_countermeasure information. */ -+ /* When the countermeasure is trigger, the driver have to disconnect with AP for 60 seconds. */ -+ -+ _rtw_memset(&backupPMKIDList[0], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); -+ -+ _rtw_memcpy(&backupPMKIDList[0], &adapter->securitypriv.PMKIDList[0], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); -+ backupPMKIDIndex = adapter->securitypriv.PMKIDIndex; -+ backupTKIPCountermeasure = adapter->securitypriv.btkip_countermeasure; -+ backupTKIPcountermeasure_time = adapter->securitypriv.btkip_countermeasure_time; -+#ifdef CONFIG_IEEE80211W -+ /* reset RX BIP packet number */ -+ pmlmeext->mgnt_80211w_IPN_rx = 0; -+#endif /* CONFIG_IEEE80211W */ -+ _rtw_memset((unsigned char *)&adapter->securitypriv, 0, sizeof(struct security_priv)); -+ /* _init_timer(&(adapter->securitypriv.tkip_timer),adapter->pnetdev, rtw_use_tkipkey_handler, adapter); */ -+ -+ /* Added by Albert 2009/02/18 */ -+ /* Restore the PMK information to securitypriv structure for the following connection. */ -+ _rtw_memcpy(&adapter->securitypriv.PMKIDList[0], &backupPMKIDList[0], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE); -+ adapter->securitypriv.PMKIDIndex = backupPMKIDIndex; -+ adapter->securitypriv.btkip_countermeasure = backupTKIPCountermeasure; -+ adapter->securitypriv.btkip_countermeasure_time = backupTKIPcountermeasure_time; -+ -+ adapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; -+ adapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; -+ -+ } else { /* reset values in securitypriv */ -+ /* if(adapter->mlmepriv.fw_state & WIFI_STATION_STATE) */ -+ /* { */ -+ struct security_priv *psec_priv = &adapter->securitypriv; -+ -+ psec_priv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ psec_priv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psec_priv->dot11PrivacyKeyIndex = 0; -+ -+ psec_priv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psec_priv->dot118021XGrpKeyid = 1; -+ -+ psec_priv->ndisauthtype = Ndis802_11AuthModeOpen; -+ psec_priv->ndisencryptstatus = Ndis802_11WEPDisabled; -+ /* } */ -+ } -+ /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ _exit_critical_bh(&adapter->security_key_mutex, &irqL); -+ -+ RTW_INFO(FUNC_ADPT_FMT" - End to Disconnect\n", FUNC_ADPT_ARG(adapter)); -+} -+ -+void rtw_os_indicate_disconnect(_adapter *adapter, u16 reason, u8 locally_generated) -+{ -+ /* RT_PMKID_LIST backupPMKIDList[NUM_PMKID_CACHE]; */ -+ -+ -+ netif_carrier_off(adapter->pnetdev); /* Do it first for tx broadcast pkt after disconnection issue! */ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_indicate_disconnect(adapter, reason, locally_generated); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ rtw_indicate_wx_disassoc_event(adapter); -+ -+#ifdef RTK_DMP_PLATFORM -+ _set_workitem(&adapter->mlmepriv.Linkdown_workitem); -+#endif -+ /* modify for CONFIG_IEEE80211W, none 11w also can use the same command */ -+ rtw_reset_securitypriv_cmd(adapter); -+ -+ -+} -+ -+void rtw_report_sec_ie(_adapter *adapter, u8 authmode, u8 *sec_ie) -+{ -+ uint len; -+ u8 *buff, *p, i; -+ union iwreq_data wrqu; -+ -+ -+ -+ buff = NULL; -+ if (authmode == _WPA_IE_ID_) { -+ -+ buff = rtw_zmalloc(IW_CUSTOM_MAX); -+ if (NULL == buff) { -+ RTW_INFO(FUNC_ADPT_FMT ": alloc memory FAIL!!\n", -+ FUNC_ADPT_ARG(adapter)); -+ return; -+ } -+ p = buff; -+ -+ p += sprintf(p, "ASSOCINFO(ReqIEs="); -+ -+ len = sec_ie[1] + 2; -+ len = (len < IW_CUSTOM_MAX) ? len : IW_CUSTOM_MAX; -+ -+ for (i = 0; i < len; i++) -+ p += sprintf(p, "%02x", sec_ie[i]); -+ -+ p += sprintf(p, ")"); -+ -+ _rtw_memset(&wrqu, 0, sizeof(wrqu)); -+ -+ wrqu.data.length = p - buff; -+ -+ wrqu.data.length = (wrqu.data.length < IW_CUSTOM_MAX) ? wrqu.data.length : IW_CUSTOM_MAX; -+ -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(adapter->pnetdev, IWEVCUSTOM, &wrqu, buff); -+#endif -+ -+ rtw_mfree(buff, IW_CUSTOM_MAX); -+ } -+ -+ -+} -+ -+void _survey_timer_hdl(void *FunctionContext) -+{ -+ _adapter *padapter = (_adapter *)FunctionContext; -+ -+ survey_timer_hdl(padapter); -+} -+ -+void _link_timer_hdl(void *FunctionContext) -+{ -+ _adapter *padapter = (_adapter *)FunctionContext; -+ link_timer_hdl(padapter); -+} -+ -+#ifdef CONFIG_RTW_80211R -+void _ft_link_timer_hdl(void *FunctionContext) -+{ -+ _adapter *padapter = (_adapter *)FunctionContext; -+ -+ ft_link_timer_hdl(padapter); -+} -+ -+void _ft_roam_timer_hdl(void *FunctionContext) -+{ -+ _adapter *padapter = (_adapter *)FunctionContext; -+ -+ ft_roam_timer_hdl(padapter); -+} -+#endif -+ -+void _addba_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *psta = (struct sta_info *)FunctionContext; -+ addba_timer_hdl(psta); -+} -+ -+#ifdef CONFIG_IEEE80211W -+ -+void _sa_query_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *psta = (struct sta_info *)FunctionContext; -+ -+ sa_query_timer_hdl(psta); -+} -+ -+void init_dot11w_expire_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ _init_timer(&psta->dot11w_expire_timer, padapter->pnetdev, _sa_query_timer_hdl, psta); -+} -+ -+#endif /* CONFIG_IEEE80211W */ -+ -+void init_addba_retry_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ -+ _init_timer(&psta->addba_retry_timer, padapter->pnetdev, _addba_timer_hdl, psta); -+} -+ -+/* -+void _reauth_timer_hdl(void *FunctionContext) -+{ -+ _adapter *padapter = (_adapter *)FunctionContext; -+ reauth_timer_hdl(padapter); -+} -+ -+void _reassoc_timer_hdl(void *FunctionContext) -+{ -+ _adapter *padapter = (_adapter *)FunctionContext; -+ reassoc_timer_hdl(padapter); -+} -+*/ -+ -+void init_mlme_ext_timer(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ _init_timer(&pmlmeext->survey_timer, padapter->pnetdev, _survey_timer_hdl, padapter); -+ _init_timer(&pmlmeext->link_timer, padapter->pnetdev, _link_timer_hdl, padapter); -+#ifdef CONFIG_RTW_80211R -+ _init_timer(&pmlmeext->ft_link_timer, padapter->pnetdev, _ft_link_timer_hdl, padapter); -+ _init_timer(&pmlmeext->ft_roam_timer, padapter->pnetdev, _ft_roam_timer_hdl, padapter); -+#endif -+ -+ /* _init_timer(&pmlmeext->ADDBA_timer, padapter->pnetdev, _addba_timer_hdl, padapter); */ -+ -+ /* _init_timer(&pmlmeext->reauth_timer, padapter->pnetdev, _reauth_timer_hdl, padapter); */ -+ /* _init_timer(&pmlmeext->reassoc_timer, padapter->pnetdev, _reassoc_timer_hdl, padapter); */ -+} -+ -+#ifdef CONFIG_AP_MODE -+ -+void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta) -+{ -+ union iwreq_data wrqu; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ if (psta == NULL) -+ return; -+ -+ if (psta->aid > NUM_STA) -+ return; -+ -+ if (pstapriv->sta_aid[psta->aid - 1] != psta) -+ return; -+ -+ -+ wrqu.addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN); -+ -+ RTW_INFO("+rtw_indicate_sta_assoc_event\n"); -+ -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(padapter->pnetdev, IWEVREGISTERED, &wrqu, NULL); -+#endif -+ -+} -+ -+void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta) -+{ -+ union iwreq_data wrqu; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ if (psta == NULL) -+ return; -+ -+ if (psta->aid > NUM_STA) -+ return; -+ -+ if (pstapriv->sta_aid[psta->aid - 1] != psta) -+ return; -+ -+ -+ wrqu.addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN); -+ -+ RTW_INFO("+rtw_indicate_sta_disassoc_event\n"); -+ -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(padapter->pnetdev, IWEVEXPIRED, &wrqu, NULL); -+#endif -+ -+} -+ -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ -+static int mgnt_xmit_entry(struct sk_buff *skb, struct net_device *pnetdev) -+{ -+ struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev); -+ _adapter *padapter = (_adapter *)phostapdpriv->padapter; -+ -+ /* RTW_INFO("%s\n", __FUNCTION__); */ -+ -+ return rtw_hal_hostap_mgnt_xmit_entry(padapter, skb); -+} -+ -+static int mgnt_netdev_open(struct net_device *pnetdev) -+{ -+ struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev); -+ -+ RTW_INFO("mgnt_netdev_open: MAC Address:" MAC_FMT "\n", MAC_ARG(pnetdev->dev_addr)); -+ -+ -+ init_usb_anchor(&phostapdpriv->anchored); -+ -+ rtw_netif_wake_queue(pnetdev); -+ -+ netif_carrier_on(pnetdev); -+ -+ /* rtw_write16(phostapdpriv->padapter, 0x0116, 0x0100); */ /* only excluding beacon */ -+ -+ return 0; -+} -+static int mgnt_netdev_close(struct net_device *pnetdev) -+{ -+ struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev); -+ -+ RTW_INFO("%s\n", __FUNCTION__); -+ -+ usb_kill_anchored_urbs(&phostapdpriv->anchored); -+ -+ netif_carrier_off(pnetdev); -+ -+ rtw_netif_stop_queue(pnetdev); -+ -+ /* rtw_write16(phostapdpriv->padapter, 0x0116, 0x3f3f); */ -+ -+ return 0; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+static const struct net_device_ops rtl871x_mgnt_netdev_ops = { -+ .ndo_open = mgnt_netdev_open, -+ .ndo_stop = mgnt_netdev_close, -+ .ndo_start_xmit = mgnt_xmit_entry, -+ #if 0 -+ .ndo_set_mac_address = r871x_net_set_mac_address, -+ .ndo_get_stats = r871x_net_get_stats, -+ .ndo_do_ioctl = r871x_mp_ioctl, -+ #endif -+}; -+#endif -+ -+int hostapd_mode_init(_adapter *padapter) -+{ -+ unsigned char mac[ETH_ALEN]; -+ struct hostapd_priv *phostapdpriv; -+ struct net_device *pnetdev; -+ -+ pnetdev = rtw_alloc_etherdev(sizeof(struct hostapd_priv)); -+ if (!pnetdev) -+ return -ENOMEM; -+ -+ /* SET_MODULE_OWNER(pnetdev); */ -+ ether_setup(pnetdev); -+ -+ /* pnetdev->type = ARPHRD_IEEE80211; */ -+ -+ phostapdpriv = rtw_netdev_priv(pnetdev); -+ phostapdpriv->pmgnt_netdev = pnetdev; -+ phostapdpriv->padapter = padapter; -+ padapter->phostapdpriv = phostapdpriv; -+ -+ /* pnetdev->init = NULL; */ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+ -+ RTW_INFO("register rtl871x_mgnt_netdev_ops to netdev_ops\n"); -+ -+ pnetdev->netdev_ops = &rtl871x_mgnt_netdev_ops; -+ -+#else -+ -+ pnetdev->open = mgnt_netdev_open; -+ -+ pnetdev->stop = mgnt_netdev_close; -+ -+ pnetdev->hard_start_xmit = mgnt_xmit_entry; -+ -+ /* pnetdev->set_mac_address = r871x_net_set_mac_address; */ -+ -+ /* pnetdev->get_stats = r871x_net_get_stats; */ -+ -+ /* pnetdev->do_ioctl = r871x_mp_ioctl; */ -+ -+#endif -+ -+ pnetdev->watchdog_timeo = HZ; /* 1 second timeout */ -+ -+ /* pnetdev->wireless_handlers = NULL; */ -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ pnetdev->features |= NETIF_F_IP_CSUM; -+#endif -+ -+ -+ -+ if (dev_alloc_name(pnetdev, "mgnt.wlan%d") < 0) -+ RTW_INFO("hostapd_mode_init(): dev_alloc_name, fail!\n"); -+ -+ -+ /* SET_NETDEV_DEV(pnetdev, pintfpriv->udev); */ -+ -+ -+ mac[0] = 0x00; -+ mac[1] = 0xe0; -+ mac[2] = 0x4c; -+ mac[3] = 0x87; -+ mac[4] = 0x11; -+ mac[5] = 0x12; -+ -+ _rtw_memcpy(pnetdev->dev_addr, mac, ETH_ALEN); -+ -+ -+ netif_carrier_off(pnetdev); -+ -+ -+ /* Tell the network stack we exist */ -+ if (register_netdev(pnetdev) != 0) { -+ RTW_INFO("hostapd_mode_init(): register_netdev fail!\n"); -+ -+ if (pnetdev) -+ rtw_free_netdev(pnetdev); -+ } -+ -+ return 0; -+ -+} -+ -+void hostapd_mode_unload(_adapter *padapter) -+{ -+ struct hostapd_priv *phostapdpriv = padapter->phostapdpriv; -+ struct net_device *pnetdev = phostapdpriv->pmgnt_netdev; -+ -+ unregister_netdev(pnetdev); -+ rtw_free_netdev(pnetdev); -+ -+} -+ -+#endif -+#endif -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/os_intfs.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/os_intfs.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/os_intfs.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/os_intfs.c 2018-02-11 21:44:27.176146528 +0200 -@@ -0,0 +1,4414 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _OS_INTFS_C_ -+ -+#include -+#include -+ -+#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+ -+ #error "Shall be Linux or Windows, but not both!\n" -+ -+#endif -+ -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Realtek Wireless Lan Driver"); -+MODULE_AUTHOR("Realtek Semiconductor Corp."); -+MODULE_VERSION(DRIVERVERSION); -+ -+/* module param defaults */ -+int rtw_chip_version = 0x00; -+int rtw_rfintfs = HWPI; -+int rtw_lbkmode = 0;/* RTL8712_AIR_TRX; */ -+ -+ -+int rtw_network_mode = Ndis802_11IBSS;/* Ndis802_11Infrastructure; */ /* infra, ad-hoc, auto */ -+/* NDIS_802_11_SSID ssid; */ -+int rtw_channel = 1;/* ad-hoc support requirement */ -+#ifdef CONFIG_80211N_HT -+int rtw_wireless_mode = WIRELESS_11BG_24N; -+#else -+int rtw_wireless_mode = WIRELESS_11BG; -+#endif -+int rtw_vrtl_carrier_sense = AUTO_VCS; -+int rtw_vcs_type = RTS_CTS; -+int rtw_rts_thresh = 2347; -+int rtw_frag_thresh = 2346; -+int rtw_preamble = PREAMBLE_LONG;/* long, short, auto */ -+int rtw_scan_mode = 1;/* active, passive */ -+int rtw_adhoc_tx_pwr = 1; -+int rtw_soft_ap = 0; -+/* int smart_ps = 1; */ -+#ifdef CONFIG_POWER_SAVING -+ int rtw_power_mgnt = PS_MODE_MAX; -+ #ifdef CONFIG_IPS_LEVEL_2 -+ int rtw_ips_mode = IPS_LEVEL_2; -+ #else -+ int rtw_ips_mode = IPS_NORMAL; -+ #endif -+#else -+ int rtw_power_mgnt = PS_MODE_ACTIVE; -+ int rtw_ips_mode = IPS_NONE; -+#endif -+module_param(rtw_ips_mode, int, 0644); -+MODULE_PARM_DESC(rtw_ips_mode, "The default IPS mode"); -+ -+int rtw_smart_ps = 2; -+ -+int rtw_check_fw_ps = 1; -+ -+#ifdef CONFIG_TX_EARLY_MODE -+int rtw_early_mode = 1; -+#endif -+ -+int rtw_usb_rxagg_mode = 2;/* RX_AGG_DMA=1, RX_AGG_USB=2 */ -+module_param(rtw_usb_rxagg_mode, int, 0644); -+ -+/* set log level when inserting driver module, default log level is _DRV_INFO_ = 4, -+* please refer to "How_to_set_driver_debug_log_level.doc" to set the available level. -+*/ -+#ifdef RTW_LOG_LEVEL -+ uint rtw_drv_log_level = (uint)RTW_LOG_LEVEL; /* from Makefile */ -+#else -+ uint rtw_drv_log_level = _DRV_INFO_; -+#endif -+module_param(rtw_drv_log_level, uint, 0644); -+MODULE_PARM_DESC(rtw_drv_log_level, "set log level when insert driver module, default log level is _DRV_INFO_ = 4"); -+ -+int rtw_radio_enable = 1; -+int rtw_long_retry_lmt = 7; -+int rtw_short_retry_lmt = 7; -+int rtw_busy_thresh = 40; -+/* int qos_enable = 0; */ /* * */ -+int rtw_ack_policy = NORMAL_ACK; -+ -+int rtw_mp_mode = 0; -+ -+#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTW_CUSTOMER_STR) -+uint rtw_mp_customer_str = 0; -+module_param(rtw_mp_customer_str, uint, 0644); -+MODULE_PARM_DESC(rtw_mp_customer_str, "Whether or not to enable customer str support on MP mode"); -+#endif -+ -+int rtw_software_encrypt = 0; -+int rtw_software_decrypt = 0; -+ -+int rtw_acm_method = 0;/* 0:By SW 1:By HW. */ -+ -+int rtw_wmm_enable = 1;/* default is set to enable the wmm. */ -+int rtw_uapsd_enable = 0; -+int rtw_uapsd_max_sp = NO_LIMIT; -+int rtw_uapsd_acbk_en = 0; -+int rtw_uapsd_acbe_en = 0; -+int rtw_uapsd_acvi_en = 0; -+int rtw_uapsd_acvo_en = 0; -+#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -+ int rtw_pwrtrim_enable = 2; /* disable kfree , rename to power trim disable */ -+#else -+ int rtw_pwrtrim_enable = 0; /* Default Enalbe power trim by efuse config */ -+#endif -+ -+uint rtw_tx_bw_mode = 0x21; -+module_param(rtw_tx_bw_mode, uint, 0644); -+MODULE_PARM_DESC(rtw_tx_bw_mode, "The max tx bw for 2.4G and 5G. format is the same as rtw_bw_mode"); -+ -+#ifdef CONFIG_80211N_HT -+int rtw_ht_enable = 1; -+/* 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz, 4: 80+80MHz -+* 2.4G use bit 0 ~ 3, 5G use bit 4 ~ 7 -+* 0x21 means enable 2.4G 40MHz & 5G 80MHz */ -+int rtw_bw_mode = 0x21; -+int rtw_ampdu_enable = 1;/* for enable tx_ampdu , */ /* 0: disable, 0x1:enable */ -+int rtw_rx_stbc = 1;/* 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ */ -+int rtw_ampdu_amsdu = 0;/* 0: disabled, 1:enabled, 2:auto . There is an IOT issu with DLINK DIR-629 when the flag turn on */ -+/* Short GI support Bit Map -+* BIT0 - 20MHz, 0: non-support, 1: support -+* BIT1 - 40MHz, 0: non-support, 1: support -+* BIT2 - 80MHz, 0: non-support, 1: support -+* BIT3 - 160MHz, 0: non-support, 1: support */ -+int rtw_short_gi = 0xf; -+/* BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx */ -+int rtw_ldpc_cap = 0x33; -+/* BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx */ -+int rtw_stbc_cap = 0x13; -+/* -+* BIT0: Enable VHT SU Beamformer -+* BIT1: Enable VHT SU Beamformee -+* BIT2: Enable VHT MU Beamformer, depend on VHT SU Beamformer -+* BIT3: Enable VHT MU Beamformee, depend on VHT SU Beamformee -+* BIT4: Enable HT Beamformer -+* BIT5: Enable HT Beamformee -+*/ -+int rtw_beamform_cap = BIT(1) | BIT(3); -+int rtw_bfer_rf_number = 0; /*BeamformerCapRfNum Rf path number, 0 for auto, others for manual*/ -+int rtw_bfee_rf_number = 0; /*BeamformeeCapRfNum Rf path number, 0 for auto, others for manual*/ -+ -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_80211AC_VHT -+int rtw_vht_enable = 1; /* 0:disable, 1:enable, 2:force auto enable */ -+int rtw_ampdu_factor = 7; -+int rtw_vht_rate_sel = 0; -+#endif /* CONFIG_80211AC_VHT */ -+ -+int rtw_lowrate_two_xmit = 1;/* Use 2 path Tx to transmit MCS0~7 and legacy mode */ -+ -+/* int rf_config = RF_1T2R; */ /* 1T2R */ -+int rtw_rf_config = RF_MAX_TYPE; /* auto */ -+ -+/* 0: not check in watch dog, 1: check in watch dog */ -+int rtw_check_hw_status = 0; -+ -+int rtw_low_power = 0; -+#ifdef CONFIG_WIFI_TEST -+ int rtw_wifi_spec = 1;/* for wifi test */ -+#else -+ int rtw_wifi_spec = 0; -+#endif -+ -+#ifdef CONFIG_DEFAULT_PATTERNS_EN -+ bool rtw_support_default_patterns = _TRUE; -+#else -+ bool rtw_support_default_patterns = _FALSE; -+#endif -+ -+int rtw_special_rf_path = 0; /* 0: 2T2R ,1: only turn on path A 1T1R */ -+ -+char rtw_country_unspecified[] = {0xFF, 0xFF, 0x00}; -+char *rtw_country_code = rtw_country_unspecified; -+module_param(rtw_country_code, charp, 0644); -+MODULE_PARM_DESC(rtw_country_code, "The default country code (in alpha2)"); -+ -+int rtw_channel_plan = RTW_CHPLAN_MAX; -+module_param(rtw_channel_plan, int, 0644); -+MODULE_PARM_DESC(rtw_channel_plan, "The default chplan ID when rtw_alpha2 is not specified or valid"); -+ -+static uint rtw_excl_chs[MAX_CHANNEL_NUM] = CONFIG_RTW_EXCL_CHS; -+static int rtw_excl_chs_num = 0; -+module_param_array(rtw_excl_chs, uint, &rtw_excl_chs_num, 0644); -+MODULE_PARM_DESC(rtw_excl_chs, "exclusive channel array"); -+ -+/*if concurrent softap + p2p(GO) is needed, this param lets p2p response full channel list. -+But Softap must be SHUT DOWN once P2P decide to set up connection and become a GO.*/ -+#ifdef CONFIG_FULL_CH_IN_P2P_HANDSHAKE -+ int rtw_full_ch_in_p2p_handshake = 1; /* reply full channel list*/ -+#else -+ int rtw_full_ch_in_p2p_handshake = 0; /* reply only softap channel*/ -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+int rtw_btcoex_enable = 2; -+module_param(rtw_btcoex_enable, int, 0644); -+MODULE_PARM_DESC(rtw_btcoex_enable, "BT co-existence on/off, 0:off, 1:on, 2:by efuse"); -+ -+int rtw_ant_num = 0; -+module_param(rtw_ant_num, int, 0644); -+MODULE_PARM_DESC(rtw_ant_num, "Antenna number setting, 0:by efuse"); -+ -+int rtw_bt_iso = 2;/* 0:Low, 1:High, 2:From Efuse */ -+int rtw_bt_sco = 3;/* 0:Idle, 1:None-SCO, 2:SCO, 3:From Counter, 4.Busy, 5.OtherBusy */ -+int rtw_bt_ampdu = 1 ; /* 0:Disable BT control A-MPDU, 1:Enable BT control A-MPDU. */ -+#endif /* CONFIG_BT_COEXIST */ -+ -+int rtw_AcceptAddbaReq = _TRUE;/* 0:Reject AP's Add BA req, 1:Accept AP's Add BA req. */ -+ -+int rtw_antdiv_cfg = 2; /* 0:OFF , 1:ON, 2:decide by Efuse config */ -+int rtw_antdiv_type = 0 -+ ; /* 0:decide by efuse 1: for 88EE, 1Tx and 1RxCG are diversity.(2 Ant with SPDT), 2: for 88EE, 1Tx and 2Rx are diversity.( 2 Ant, Tx and RxCG are both on aux port, RxCS is on main port ), 3: for 88EE, 1Tx and 1RxCG are fixed.(1Ant, Tx and RxCG are both on aux port) */ -+ -+int rtw_drv_ant_band_switch = 1; /* 0:OFF , 1:ON, Driver control antenna band switch*/ -+ -+/* 0: doesn't switch, 1: switch from usb2.0 to usb 3.0 2: switch from usb3.0 to usb 2.0 */ -+int rtw_switch_usb_mode = 0; -+ -+#ifdef CONFIG_USB_AUTOSUSPEND -+int rtw_enusbss = 1;/* 0:disable,1:enable */ -+#else -+int rtw_enusbss = 0;/* 0:disable,1:enable */ -+#endif -+ -+int rtw_hwpdn_mode = 2; /* 0:disable,1:enable,2: by EFUSE config */ -+ -+#ifdef CONFIG_HW_PWRP_DETECTION -+int rtw_hwpwrp_detect = 1; -+#else -+int rtw_hwpwrp_detect = 0; /* HW power ping detect 0:disable , 1:enable */ -+#endif -+ -+#ifdef CONFIG_USB_HCI -+int rtw_hw_wps_pbc = 1; -+#else -+int rtw_hw_wps_pbc = 0; -+#endif -+ -+#ifdef CONFIG_TX_MCAST2UNI -+int rtw_mc2u_disable = 0; -+#endif /* CONFIG_TX_MCAST2UNI */ -+ -+#ifdef CONFIG_80211D -+int rtw_80211d = 0; -+#endif -+ -+#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+int rtw_force_ant = 2;/* 0 :normal, 1:Main ant, 2:Aux ant */ -+int rtw_force_igi = 0; /* 0 :normal */ -+module_param(rtw_force_ant, int, 0644); -+module_param(rtw_force_igi, int, 0644); -+#endif -+ -+int rtw_force_igi_lb = CONFIG_RTW_FORCE_IGI_LB; -+module_param(rtw_force_igi_lb, int, 0644); -+MODULE_PARM_DESC(rtw_force_igi_lb, "force IGI low-bound, 0:no specified"); -+ -+#ifdef CONFIG_QOS_OPTIMIZATION -+int rtw_qos_opt_enable = 1; /* 0: disable,1:enable */ -+#else -+int rtw_qos_opt_enable = 0; /* 0: disable,1:enable */ -+#endif -+module_param(rtw_qos_opt_enable, int, 0644); -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+int rtw_acs_mode = 1; /*0:disable, 1:enable*/ -+module_param(rtw_acs_mode, int, 0644); -+ -+int rtw_acs_auto_scan = 0; /*0:disable, 1:enable*/ -+module_param(rtw_acs_auto_scan, int, 0644); -+ -+#endif -+ -+char *ifname = "wlan%d"; -+module_param(ifname, charp, 0644); -+MODULE_PARM_DESC(ifname, "The default name to allocate for first interface"); -+ -+#ifdef CONFIG_PLATFORM_ANDROID -+ char *if2name = "p2p%d"; -+#else /* CONFIG_PLATFORM_ANDROID */ -+ char *if2name = "wlan%d"; -+#endif /* CONFIG_PLATFORM_ANDROID */ -+module_param(if2name, charp, 0644); -+MODULE_PARM_DESC(if2name, "The default name to allocate for second interface"); -+ -+char *rtw_initmac = 0; /* temp mac address if users want to use instead of the mac address in Efuse */ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ -+ #if (CONFIG_IFACE_NUMBER > 2) -+ int rtw_virtual_iface_num = CONFIG_IFACE_NUMBER - 1; -+ module_param(rtw_virtual_iface_num, int, 0644); -+ #else -+ int rtw_virtual_iface_num = 1; -+ #endif -+ -+#endif -+ -+module_param(rtw_pwrtrim_enable, int, 0644); -+module_param(rtw_initmac, charp, 0644); -+module_param(rtw_special_rf_path, int, 0644); -+module_param(rtw_chip_version, int, 0644); -+module_param(rtw_rfintfs, int, 0644); -+module_param(rtw_lbkmode, int, 0644); -+module_param(rtw_network_mode, int, 0644); -+module_param(rtw_channel, int, 0644); -+module_param(rtw_mp_mode, int, 0644); -+module_param(rtw_wmm_enable, int, 0644); -+module_param(rtw_vrtl_carrier_sense, int, 0644); -+module_param(rtw_vcs_type, int, 0644); -+module_param(rtw_busy_thresh, int, 0644); -+ -+#ifdef CONFIG_80211N_HT -+module_param(rtw_ht_enable, int, 0644); -+module_param(rtw_bw_mode, int, 0644); -+module_param(rtw_ampdu_enable, int, 0644); -+module_param(rtw_rx_stbc, int, 0644); -+module_param(rtw_ampdu_amsdu, int, 0644); -+#endif /* CONFIG_80211N_HT */ -+#ifdef CONFIG_80211AC_VHT -+module_param(rtw_vht_enable, int, 0644); -+#endif /* CONFIG_80211AC_VHT */ -+#ifdef CONFIG_BEAMFORMING -+module_param(rtw_beamform_cap, int, 0644); -+#endif -+module_param(rtw_lowrate_two_xmit, int, 0644); -+ -+module_param(rtw_rf_config, int, 0644); -+module_param(rtw_power_mgnt, int, 0644); -+module_param(rtw_smart_ps, int, 0644); -+module_param(rtw_low_power, int, 0644); -+module_param(rtw_wifi_spec, int, 0644); -+ -+module_param(rtw_full_ch_in_p2p_handshake, int, 0644); -+module_param(rtw_antdiv_cfg, int, 0644); -+module_param(rtw_antdiv_type, int, 0644); -+ -+module_param(rtw_drv_ant_band_switch, int, 0644); -+ -+module_param(rtw_switch_usb_mode, int, 0644); -+ -+module_param(rtw_enusbss, int, 0644); -+module_param(rtw_hwpdn_mode, int, 0644); -+module_param(rtw_hwpwrp_detect, int, 0644); -+ -+module_param(rtw_hw_wps_pbc, int, 0644); -+module_param(rtw_check_hw_status, int, 0644); -+ -+#ifdef CONFIG_TX_EARLY_MODE -+module_param(rtw_early_mode, int, 0644); -+#endif -+#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+char *rtw_adaptor_info_caching_file_path = "/data/misc/wifi/rtw_cache"; -+module_param(rtw_adaptor_info_caching_file_path, charp, 0644); -+MODULE_PARM_DESC(rtw_adaptor_info_caching_file_path, "The path of adapter info cache file"); -+#endif /* CONFIG_ADAPTOR_INFO_CACHING_FILE */ -+ -+#ifdef CONFIG_LAYER2_ROAMING -+uint rtw_max_roaming_times = 2; -+module_param(rtw_max_roaming_times, uint, 0644); -+MODULE_PARM_DESC(rtw_max_roaming_times, "The max roaming times to try"); -+#endif /* CONFIG_LAYER2_ROAMING */ -+ -+#ifdef CONFIG_IOL -+int rtw_fw_iol = 1; -+module_param(rtw_fw_iol, int, 0644); -+MODULE_PARM_DESC(rtw_fw_iol, "FW IOL. 0:Disable, 1:enable, 2:by usb speed"); -+#endif /* CONFIG_IOL */ -+ -+#ifdef CONFIG_FILE_FWIMG -+char *rtw_fw_file_path = "/system/etc/firmware/rtlwifi/FW_NIC.BIN"; -+module_param(rtw_fw_file_path, charp, 0644); -+MODULE_PARM_DESC(rtw_fw_file_path, "The path of fw image"); -+ -+char *rtw_fw_wow_file_path = "/system/etc/firmware/rtlwifi/FW_WoWLAN.BIN"; -+module_param(rtw_fw_wow_file_path, charp, 0644); -+MODULE_PARM_DESC(rtw_fw_wow_file_path, "The path of fw for Wake on Wireless image"); -+ -+#ifdef CONFIG_MP_INCLUDED -+char *rtw_fw_mp_bt_file_path = ""; -+module_param(rtw_fw_mp_bt_file_path, charp, 0644); -+MODULE_PARM_DESC(rtw_fw_mp_bt_file_path, "The path of fw for MP-BT image"); -+#endif /* CONFIG_MP_INCLUDED */ -+#endif /* CONFIG_FILE_FWIMG */ -+ -+#ifdef CONFIG_TX_MCAST2UNI -+module_param(rtw_mc2u_disable, int, 0644); -+#endif /* CONFIG_TX_MCAST2UNI */ -+ -+#ifdef CONFIG_80211D -+module_param(rtw_80211d, int, 0644); -+MODULE_PARM_DESC(rtw_80211d, "Enable 802.11d mechanism"); -+#endif -+ -+uint rtw_notch_filter = RTW_NOTCH_FILTER; -+module_param(rtw_notch_filter, uint, 0644); -+MODULE_PARM_DESC(rtw_notch_filter, "0:Disable, 1:Enable, 2:Enable only for P2P"); -+ -+uint rtw_hiq_filter = CONFIG_RTW_HIQ_FILTER; -+module_param(rtw_hiq_filter, uint, 0644); -+MODULE_PARM_DESC(rtw_hiq_filter, "0:allow all, 1:allow special, 2:deny all"); -+ -+uint rtw_adaptivity_en = CONFIG_RTW_ADAPTIVITY_EN; -+module_param(rtw_adaptivity_en, uint, 0644); -+MODULE_PARM_DESC(rtw_adaptivity_en, "0:disable, 1:enable"); -+ -+uint rtw_adaptivity_mode = CONFIG_RTW_ADAPTIVITY_MODE; -+module_param(rtw_adaptivity_mode, uint, 0644); -+MODULE_PARM_DESC(rtw_adaptivity_mode, "0:normal, 1:carrier sense"); -+ -+uint rtw_adaptivity_dml = CONFIG_RTW_ADAPTIVITY_DML; -+module_param(rtw_adaptivity_dml, uint, 0644); -+MODULE_PARM_DESC(rtw_adaptivity_dml, "0:disable, 1:enable"); -+ -+uint rtw_adaptivity_dc_backoff = CONFIG_RTW_ADAPTIVITY_DC_BACKOFF; -+module_param(rtw_adaptivity_dc_backoff, uint, 0644); -+MODULE_PARM_DESC(rtw_adaptivity_dc_backoff, "DC backoff for Adaptivity"); -+ -+int rtw_adaptivity_th_l2h_ini = CONFIG_RTW_ADAPTIVITY_TH_L2H_INI; -+module_param(rtw_adaptivity_th_l2h_ini, int, 0644); -+MODULE_PARM_DESC(rtw_adaptivity_th_l2h_ini, "TH_L2H_ini for Adaptivity"); -+ -+int rtw_adaptivity_th_edcca_hl_diff = CONFIG_RTW_ADAPTIVITY_TH_EDCCA_HL_DIFF; -+module_param(rtw_adaptivity_th_edcca_hl_diff, int, 0644); -+MODULE_PARM_DESC(rtw_adaptivity_th_edcca_hl_diff, "TH_EDCCA_HL_diff for Adaptivity"); -+ -+#ifdef CONFIG_DFS_MASTER -+uint rtw_dfs_region_domain = CONFIG_RTW_DFS_REGION_DOMAIN; -+module_param(rtw_dfs_region_domain, uint, 0644); -+MODULE_PARM_DESC(rtw_dfs_region_domain, "1:FCC, 2:MKK, 3:ETSI"); -+#endif -+ -+uint rtw_amplifier_type_2g = CONFIG_RTW_AMPLIFIER_TYPE_2G; -+module_param(rtw_amplifier_type_2g, uint, 0644); -+MODULE_PARM_DESC(rtw_amplifier_type_2g, "BIT3:2G ext-PA, BIT4:2G ext-LNA"); -+ -+uint rtw_amplifier_type_5g = CONFIG_RTW_AMPLIFIER_TYPE_5G; -+module_param(rtw_amplifier_type_5g, uint, 0644); -+MODULE_PARM_DESC(rtw_amplifier_type_5g, "BIT6:5G ext-PA, BIT7:5G ext-LNA"); -+ -+uint rtw_RFE_type = CONFIG_RTW_RFE_TYPE; -+module_param(rtw_RFE_type, uint, 0644); -+MODULE_PARM_DESC(rtw_RFE_type, "default init value:64"); -+ -+uint rtw_powertracking_type = 64; -+module_param(rtw_powertracking_type, uint, 0644); -+MODULE_PARM_DESC(rtw_powertracking_type, "default init value:64"); -+ -+uint rtw_GLNA_type = CONFIG_RTW_GLNA_TYPE; -+module_param(rtw_GLNA_type, uint, 0644); -+MODULE_PARM_DESC(rtw_GLNA_type, "default init value:0"); -+ -+uint rtw_TxBBSwing_2G = 0xFF; -+module_param(rtw_TxBBSwing_2G, uint, 0644); -+MODULE_PARM_DESC(rtw_TxBBSwing_2G, "default init value:0xFF"); -+ -+uint rtw_TxBBSwing_5G = 0xFF; -+module_param(rtw_TxBBSwing_5G, uint, 0644); -+MODULE_PARM_DESC(rtw_TxBBSwing_5G, "default init value:0xFF"); -+ -+uint rtw_OffEfuseMask = 0; -+module_param(rtw_OffEfuseMask, uint, 0644); -+MODULE_PARM_DESC(rtw_OffEfuseMask, "default open Efuse Mask value:0"); -+ -+uint rtw_FileMaskEfuse = 0; -+module_param(rtw_FileMaskEfuse, uint, 0644); -+MODULE_PARM_DESC(rtw_FileMaskEfuse, "default drv Mask Efuse value:0"); -+ -+uint rtw_rxgain_offset_2g = 0; -+module_param(rtw_rxgain_offset_2g, uint, 0644); -+MODULE_PARM_DESC(rtw_rxgain_offset_2g, "default RF Gain 2G Offset value:0"); -+ -+uint rtw_rxgain_offset_5gl = 0; -+module_param(rtw_rxgain_offset_5gl, uint, 0644); -+MODULE_PARM_DESC(rtw_rxgain_offset_5gl, "default RF Gain 5GL Offset value:0"); -+ -+uint rtw_rxgain_offset_5gm = 0; -+module_param(rtw_rxgain_offset_5gm, uint, 0644); -+MODULE_PARM_DESC(rtw_rxgain_offset_5gm, "default RF Gain 5GM Offset value:0"); -+ -+uint rtw_rxgain_offset_5gh = 0; -+module_param(rtw_rxgain_offset_5gh, uint, 0644); -+MODULE_PARM_DESC(rtw_rxgain_offset_5gm, "default RF Gain 5GL Offset value:0"); -+ -+ -+uint rtw_pll_ref_clk_sel = CONFIG_RTW_PLL_REF_CLK_SEL; -+module_param(rtw_pll_ref_clk_sel, uint, 0644); -+MODULE_PARM_DESC(rtw_pll_ref_clk_sel, "force pll_ref_clk_sel, 0xF:use autoload value"); -+ -+int rtw_tx_pwr_by_rate = CONFIG_TXPWR_BY_RATE_EN; -+module_param(rtw_tx_pwr_by_rate, int, 0644); -+MODULE_PARM_DESC(rtw_tx_pwr_by_rate, "0:Disable, 1:Enable, 2: Depend on efuse"); -+ -+int rtw_tx_pwr_lmt_enable = CONFIG_TXPWR_LIMIT_EN; -+module_param(rtw_tx_pwr_lmt_enable, int, 0644); -+MODULE_PARM_DESC(rtw_tx_pwr_lmt_enable, "0:Disable, 1:Enable, 2: Depend on efuse"); -+ -+static int rtw_target_tx_pwr_2g_a[RATE_SECTION_NUM] = CONFIG_RTW_TARGET_TX_PWR_2G_A; -+static int rtw_target_tx_pwr_2g_a_num = 0; -+module_param_array(rtw_target_tx_pwr_2g_a, int, &rtw_target_tx_pwr_2g_a_num, 0644); -+MODULE_PARM_DESC(rtw_target_tx_pwr_2g_a, "2.4G target tx power (unit:dBm) of RF path A for each rate section, should match the real calibrate power, -1: undefined"); -+ -+static int rtw_target_tx_pwr_2g_b[RATE_SECTION_NUM] = CONFIG_RTW_TARGET_TX_PWR_2G_B; -+static int rtw_target_tx_pwr_2g_b_num = 0; -+module_param_array(rtw_target_tx_pwr_2g_b, int, &rtw_target_tx_pwr_2g_b_num, 0644); -+MODULE_PARM_DESC(rtw_target_tx_pwr_2g_b, "2.4G target tx power (unit:dBm) of RF path B for each rate section, should match the real calibrate power, -1: undefined"); -+ -+static int rtw_target_tx_pwr_2g_c[RATE_SECTION_NUM] = CONFIG_RTW_TARGET_TX_PWR_2G_C; -+static int rtw_target_tx_pwr_2g_c_num = 0; -+module_param_array(rtw_target_tx_pwr_2g_c, int, &rtw_target_tx_pwr_2g_c_num, 0644); -+MODULE_PARM_DESC(rtw_target_tx_pwr_2g_c, "2.4G target tx power (unit:dBm) of RF path C for each rate section, should match the real calibrate power, -1: undefined"); -+ -+static int rtw_target_tx_pwr_2g_d[RATE_SECTION_NUM] = CONFIG_RTW_TARGET_TX_PWR_2G_D; -+static int rtw_target_tx_pwr_2g_d_num = 0; -+module_param_array(rtw_target_tx_pwr_2g_d, int, &rtw_target_tx_pwr_2g_d_num, 0644); -+MODULE_PARM_DESC(rtw_target_tx_pwr_2g_d, "2.4G target tx power (unit:dBm) of RF path D for each rate section, should match the real calibrate power, -1: undefined"); -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+static int rtw_target_tx_pwr_5g_a[RATE_SECTION_NUM - 1] = CONFIG_RTW_TARGET_TX_PWR_5G_A; -+static int rtw_target_tx_pwr_5g_a_num = 0; -+module_param_array(rtw_target_tx_pwr_5g_a, int, &rtw_target_tx_pwr_5g_a_num, 0644); -+MODULE_PARM_DESC(rtw_target_tx_pwr_5g_a, "5G target tx power (unit:dBm) of RF path A for each rate section, should match the real calibrate power, -1: undefined"); -+ -+static int rtw_target_tx_pwr_5g_b[RATE_SECTION_NUM - 1] = CONFIG_RTW_TARGET_TX_PWR_5G_B; -+static int rtw_target_tx_pwr_5g_b_num = 0; -+module_param_array(rtw_target_tx_pwr_5g_b, int, &rtw_target_tx_pwr_5g_b_num, 0644); -+MODULE_PARM_DESC(rtw_target_tx_pwr_5g_b, "5G target tx power (unit:dBm) of RF path B for each rate section, should match the real calibrate power, -1: undefined"); -+ -+static int rtw_target_tx_pwr_5g_c[RATE_SECTION_NUM - 1] = CONFIG_RTW_TARGET_TX_PWR_5G_C; -+static int rtw_target_tx_pwr_5g_c_num = 0; -+module_param_array(rtw_target_tx_pwr_5g_c, int, &rtw_target_tx_pwr_5g_c_num, 0644); -+MODULE_PARM_DESC(rtw_target_tx_pwr_5g_c, "5G target tx power (unit:dBm) of RF path C for each rate section, should match the real calibrate power, -1: undefined"); -+ -+static int rtw_target_tx_pwr_5g_d[RATE_SECTION_NUM - 1] = CONFIG_RTW_TARGET_TX_PWR_5G_D; -+static int rtw_target_tx_pwr_5g_d_num = 0; -+module_param_array(rtw_target_tx_pwr_5g_d, int, &rtw_target_tx_pwr_5g_d_num, 0644); -+MODULE_PARM_DESC(rtw_target_tx_pwr_5g_d, "5G target tx power (unit:dBm) of RF path D for each rate section, should match the real calibrate power, -1: undefined"); -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+ -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+char *rtw_phy_file_path = REALTEK_CONFIG_PATH; -+module_param(rtw_phy_file_path, charp, 0644); -+MODULE_PARM_DESC(rtw_phy_file_path, "The path of phy parameter"); -+/* PHY FILE Bit Map -+* BIT0 - MAC, 0: non-support, 1: support -+* BIT1 - BB, 0: non-support, 1: support -+* BIT2 - BB_PG, 0: non-support, 1: support -+* BIT3 - BB_MP, 0: non-support, 1: support -+* BIT4 - RF, 0: non-support, 1: support -+* BIT5 - RF_TXPWR_TRACK, 0: non-support, 1: support -+* BIT6 - RF_TXPWR_LMT, 0: non-support, 1: support */ -+int rtw_load_phy_file = (BIT2 | BIT6); -+module_param(rtw_load_phy_file, int, 0644); -+MODULE_PARM_DESC(rtw_load_phy_file, "PHY File Bit Map"); -+int rtw_decrypt_phy_file = 0; -+module_param(rtw_decrypt_phy_file, int, 0644); -+MODULE_PARM_DESC(rtw_decrypt_phy_file, "Enable Decrypt PHY File"); -+#endif -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+#ifdef DFT_TRX_SHARE_MODE -+int rtw_trx_share_mode = DFT_TRX_SHARE_MODE; -+#else -+int rtw_trx_share_mode = 0; -+#endif -+module_param(rtw_trx_share_mode, int, 0644); -+MODULE_PARM_DESC(rtw_trx_share_mode, "TRx FIFO Shared"); -+#endif -+ -+int _netdev_open(struct net_device *pnetdev); -+int netdev_open(struct net_device *pnetdev); -+static int netdev_close(struct net_device *pnetdev); -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+extern int rtw_sdio_set_power(int on); -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+ -+#ifdef CONFIG_MCC_MODE -+/* enable MCC mode or not */ -+int rtw_en_mcc = 1; -+/* can referece following value before insmod driver */ -+int rtw_mcc_ap_bw20_target_tx_tp = MCC_AP_BW20_TARGET_TX_TP; -+int rtw_mcc_ap_bw40_target_tx_tp = MCC_AP_BW40_TARGET_TX_TP; -+int rtw_mcc_ap_bw80_target_tx_tp = MCC_AP_BW80_TARGET_TX_TP; -+int rtw_mcc_sta_bw20_target_tx_tp = MCC_STA_BW20_TARGET_TX_TP; -+int rtw_mcc_sta_bw40_target_tx_tp = MCC_STA_BW40_TARGET_TX_TP; -+int rtw_mcc_sta_bw80_target_tx_tp = MCC_STA_BW80_TARGET_TX_TP; -+int rtw_mcc_single_tx_cri = MCC_SINGLE_TX_CRITERIA; -+module_param(rtw_en_mcc, int, 0644); -+module_param(rtw_mcc_single_tx_cri, int, 0644); -+module_param(rtw_mcc_ap_bw20_target_tx_tp, int, 0644); -+module_param(rtw_mcc_ap_bw40_target_tx_tp, int, 0644); -+module_param(rtw_mcc_ap_bw80_target_tx_tp, int, 0644); -+module_param(rtw_mcc_sta_bw20_target_tx_tp, int, 0644); -+module_param(rtw_mcc_sta_bw40_target_tx_tp, int, 0644); -+module_param(rtw_mcc_sta_bw80_target_tx_tp, int, 0644); -+#endif /*CONFIG_MCC_MODE */ -+ -+#ifdef CONFIG_RTW_NAPI -+/*following setting should define NAPI in Makefile -+enable napi only = 1, disable napi = 0*/ -+int rtw_en_napi = 1; -+module_param(rtw_en_napi, int, 0644); -+#ifdef CONFIG_RTW_GRO -+/*following setting should define GRO in Makefile -+enable gro = 1, disable gro = 0*/ -+int rtw_en_gro = 1; -+module_param(rtw_en_gro, int, 0644); -+#endif /* CONFIG_RTW_GRO */ -+#endif /* CONFIG_RTW_NAPI */ -+ -+void rtw_regsty_load_target_tx_power(struct registry_priv *regsty) -+{ -+ int path, rs; -+ int *target_tx_pwr; -+ -+ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { -+ if (path == RF_PATH_A) -+ target_tx_pwr = rtw_target_tx_pwr_2g_a; -+ else if (path == RF_PATH_B) -+ target_tx_pwr = rtw_target_tx_pwr_2g_b; -+ else if (path == RF_PATH_C) -+ target_tx_pwr = rtw_target_tx_pwr_2g_c; -+ else if (path == RF_PATH_D) -+ target_tx_pwr = rtw_target_tx_pwr_2g_d; -+ -+ for (rs = CCK; rs < RATE_SECTION_NUM; rs++) -+ regsty->target_tx_pwr_2g[path][rs] = target_tx_pwr[rs]; -+ } -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { -+ if (path == RF_PATH_A) -+ target_tx_pwr = rtw_target_tx_pwr_5g_a; -+ else if (path == RF_PATH_B) -+ target_tx_pwr = rtw_target_tx_pwr_5g_b; -+ else if (path == RF_PATH_C) -+ target_tx_pwr = rtw_target_tx_pwr_5g_c; -+ else if (path == RF_PATH_D) -+ target_tx_pwr = rtw_target_tx_pwr_5g_d; -+ -+ for (rs = OFDM; rs < RATE_SECTION_NUM; rs++) -+ regsty->target_tx_pwr_5g[path][rs - 1] = target_tx_pwr[rs - 1]; -+ } -+#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -+} -+ -+inline void rtw_regsty_load_excl_chs(struct registry_priv *regsty) -+{ -+ int i; -+ int ch_num = 0; -+ -+ for (i = 0; i < MAX_CHANNEL_NUM; i++) -+ if (((u8)rtw_excl_chs[i]) != 0) -+ regsty->excl_chs[ch_num++] = (u8)rtw_excl_chs[i]; -+ -+ if (ch_num < MAX_CHANNEL_NUM) -+ regsty->excl_chs[ch_num] = 0; -+} -+ -+uint loadparam(_adapter *padapter) -+{ -+ uint status = _SUCCESS; -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ -+ -+#ifdef CONFIG_RTW_DEBUG -+ if (rtw_drv_log_level >= _DRV_MAX_) -+ rtw_drv_log_level = _DRV_DEBUG_; -+#endif -+ -+ registry_par->chip_version = (u8)rtw_chip_version; -+ registry_par->rfintfs = (u8)rtw_rfintfs; -+ registry_par->lbkmode = (u8)rtw_lbkmode; -+ /* registry_par->hci = (u8)hci; */ -+ registry_par->network_mode = (u8)rtw_network_mode; -+ -+ _rtw_memcpy(registry_par->ssid.Ssid, "ANY", 3); -+ registry_par->ssid.SsidLength = 3; -+ -+ registry_par->channel = (u8)rtw_channel; -+ registry_par->wireless_mode = (u8)rtw_wireless_mode; -+ -+ if (IsSupported24G(registry_par->wireless_mode) && (!IsSupported5G(registry_par->wireless_mode)) -+ && (registry_par->channel > 14)) -+ registry_par->channel = 1; -+ else if (IsSupported5G(registry_par->wireless_mode) && (!IsSupported24G(registry_par->wireless_mode)) -+ && (registry_par->channel <= 14)) -+ registry_par->channel = 36; -+ -+ registry_par->vrtl_carrier_sense = (u8)rtw_vrtl_carrier_sense ; -+ registry_par->vcs_type = (u8)rtw_vcs_type; -+ registry_par->rts_thresh = (u16)rtw_rts_thresh; -+ registry_par->frag_thresh = (u16)rtw_frag_thresh; -+ registry_par->preamble = (u8)rtw_preamble; -+ registry_par->scan_mode = (u8)rtw_scan_mode; -+ registry_par->adhoc_tx_pwr = (u8)rtw_adhoc_tx_pwr; -+ registry_par->soft_ap = (u8)rtw_soft_ap; -+ registry_par->smart_ps = (u8)rtw_smart_ps; -+ registry_par->check_fw_ps = (u8)rtw_check_fw_ps; -+ registry_par->power_mgnt = (u8)rtw_power_mgnt; -+ registry_par->ips_mode = (u8)rtw_ips_mode; -+ registry_par->radio_enable = (u8)rtw_radio_enable; -+ registry_par->long_retry_lmt = (u8)rtw_long_retry_lmt; -+ registry_par->short_retry_lmt = (u8)rtw_short_retry_lmt; -+ registry_par->busy_thresh = (u16)rtw_busy_thresh; -+ /* registry_par->qos_enable = (u8)rtw_qos_enable; */ -+ registry_par->ack_policy = (u8)rtw_ack_policy; -+ registry_par->mp_mode = (u8)rtw_mp_mode; -+#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTW_CUSTOMER_STR) -+ registry_par->mp_customer_str = (u8)rtw_mp_customer_str; -+#endif -+ registry_par->software_encrypt = (u8)rtw_software_encrypt; -+ registry_par->software_decrypt = (u8)rtw_software_decrypt; -+ -+ registry_par->acm_method = (u8)rtw_acm_method; -+ registry_par->usb_rxagg_mode = (u8)rtw_usb_rxagg_mode; -+ -+ /* UAPSD */ -+ registry_par->wmm_enable = (u8)rtw_wmm_enable; -+ registry_par->uapsd_enable = (u8)rtw_uapsd_enable; -+ registry_par->uapsd_max_sp = (u8)rtw_uapsd_max_sp; -+ registry_par->uapsd_acbk_en = (u8)rtw_uapsd_acbk_en; -+ registry_par->uapsd_acbe_en = (u8)rtw_uapsd_acbe_en; -+ registry_par->uapsd_acvi_en = (u8)rtw_uapsd_acvi_en; -+ registry_par->uapsd_acvo_en = (u8)rtw_uapsd_acvo_en; -+ -+ registry_par->RegPwrTrimEnable = (u8)rtw_pwrtrim_enable; -+ -+ registry_par->tx_bw_mode = (u8)rtw_tx_bw_mode; -+ -+#ifdef CONFIG_80211N_HT -+ registry_par->ht_enable = (u8)rtw_ht_enable; -+ registry_par->bw_mode = (u8)rtw_bw_mode; -+ registry_par->ampdu_enable = (u8)rtw_ampdu_enable; -+ registry_par->rx_stbc = (u8)rtw_rx_stbc; -+ registry_par->ampdu_amsdu = (u8)rtw_ampdu_amsdu; -+ registry_par->short_gi = (u8)rtw_short_gi; -+ registry_par->ldpc_cap = (u8)rtw_ldpc_cap; -+ registry_par->stbc_cap = (u8)rtw_stbc_cap; -+ registry_par->beamform_cap = (u8)rtw_beamform_cap; -+ registry_par->beamformer_rf_num = (u8)rtw_bfer_rf_number; -+ registry_par->beamformee_rf_num = (u8)rtw_bfee_rf_number; -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ registry_par->vht_enable = (u8)rtw_vht_enable; -+ registry_par->ampdu_factor = (u8)rtw_ampdu_factor; -+ registry_par->vht_rate_sel = (u8)rtw_vht_rate_sel; -+#endif -+ -+#ifdef CONFIG_TX_EARLY_MODE -+ registry_par->early_mode = (u8)rtw_early_mode; -+#endif -+ registry_par->lowrate_two_xmit = (u8)rtw_lowrate_two_xmit; -+ registry_par->rf_config = (u8)rtw_rf_config; -+ registry_par->low_power = (u8)rtw_low_power; -+ -+ registry_par->check_hw_status = (u8)rtw_check_hw_status; -+ -+ registry_par->wifi_spec = (u8)rtw_wifi_spec; -+ -+ if (strlen(rtw_country_code) != 2 -+ || is_alpha(rtw_country_code[0]) == _FALSE -+ || is_alpha(rtw_country_code[1]) == _FALSE -+ ) { -+ if (rtw_country_code != rtw_country_unspecified) -+ RTW_ERR("%s discard rtw_country_code not in alpha2\n", __func__); -+ _rtw_memset(registry_par->alpha2, 0xFF, 2); -+ } else -+ _rtw_memcpy(registry_par->alpha2, rtw_country_code, 2); -+ -+ registry_par->channel_plan = (u8)rtw_channel_plan; -+ rtw_regsty_load_excl_chs(registry_par); -+ -+ registry_par->special_rf_path = (u8)rtw_special_rf_path; -+ -+ registry_par->full_ch_in_p2p_handshake = (u8)rtw_full_ch_in_p2p_handshake; -+#ifdef CONFIG_BT_COEXIST -+ registry_par->btcoex = (u8)rtw_btcoex_enable; -+ registry_par->bt_iso = (u8)rtw_bt_iso; -+ registry_par->bt_sco = (u8)rtw_bt_sco; -+ registry_par->bt_ampdu = (u8)rtw_bt_ampdu; -+ registry_par->ant_num = (u8)rtw_ant_num; -+#endif -+ -+ registry_par->bAcceptAddbaReq = (u8)rtw_AcceptAddbaReq; -+ -+ registry_par->antdiv_cfg = (u8)rtw_antdiv_cfg; -+ registry_par->antdiv_type = (u8)rtw_antdiv_type; -+ -+ registry_par->drv_ant_band_switch = (u8) rtw_drv_ant_band_switch; -+ -+ registry_par->switch_usb_mode = (u8)rtw_switch_usb_mode; -+ -+#ifdef CONFIG_AUTOSUSPEND -+ registry_par->usbss_enable = (u8)rtw_enusbss;/* 0:disable,1:enable */ -+#endif -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+ registry_par->hwpdn_mode = (u8)rtw_hwpdn_mode;/* 0:disable,1:enable,2:by EFUSE config */ -+ registry_par->hwpwrp_detect = (u8)rtw_hwpwrp_detect;/* 0:disable,1:enable */ -+#endif -+ -+ registry_par->hw_wps_pbc = (u8)rtw_hw_wps_pbc; -+ -+#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+ snprintf(registry_par->adaptor_info_caching_file_path, PATH_LENGTH_MAX, "%s", rtw_adaptor_info_caching_file_path); -+ registry_par->adaptor_info_caching_file_path[PATH_LENGTH_MAX - 1] = 0; -+#endif -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ registry_par->max_roaming_times = (u8)rtw_max_roaming_times; -+#ifdef CONFIG_INTEL_WIDI -+ registry_par->max_roaming_times = (u8)rtw_max_roaming_times + 2; -+#endif /* CONFIG_INTEL_WIDI */ -+#endif -+ -+#ifdef CONFIG_IOL -+ registry_par->fw_iol = rtw_fw_iol; -+#endif -+ -+#ifdef CONFIG_80211D -+ registry_par->enable80211d = (u8)rtw_80211d; -+#endif -+ -+ snprintf(registry_par->ifname, 16, "%s", ifname); -+ snprintf(registry_par->if2name, 16, "%s", if2name); -+ -+ registry_par->notch_filter = (u8)rtw_notch_filter; -+ -+#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+ registry_par->force_ant = (u8)rtw_force_ant; -+ registry_par->force_igi = (u8)rtw_force_igi; -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ registry_par->virtual_iface_num = (u8)rtw_virtual_iface_num; -+#endif -+ -+ registry_par->force_igi_lb = (u8)rtw_force_igi_lb; -+ -+ registry_par->pll_ref_clk_sel = (u8)rtw_pll_ref_clk_sel; -+ -+ registry_par->RegEnableTxPowerLimit = (u8)rtw_tx_pwr_lmt_enable; -+ registry_par->RegEnableTxPowerByRate = (u8)rtw_tx_pwr_by_rate; -+ -+ rtw_regsty_load_target_tx_power(registry_par); -+ -+ registry_par->RegPowerBase = 14; -+ registry_par->TxBBSwing_2G = (s8)rtw_TxBBSwing_2G; -+ registry_par->TxBBSwing_5G = (s8)rtw_TxBBSwing_5G; -+ registry_par->bEn_RFE = 1; -+ registry_par->RFE_Type = (u8)rtw_RFE_type; -+ registry_par->PowerTracking_Type = (u8)rtw_powertracking_type; -+ registry_par->AmplifierType_2G = (u8)rtw_amplifier_type_2g; -+ registry_par->AmplifierType_5G = (u8)rtw_amplifier_type_5g; -+ registry_par->GLNA_Type = (u8)rtw_GLNA_type; -+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ registry_par->load_phy_file = (u8)rtw_load_phy_file; -+ registry_par->RegDecryptCustomFile = (u8)rtw_decrypt_phy_file; -+#endif -+ registry_par->qos_opt_enable = (u8)rtw_qos_opt_enable; -+ -+ registry_par->hiq_filter = (u8)rtw_hiq_filter; -+ -+ registry_par->adaptivity_en = (u8)rtw_adaptivity_en; -+ registry_par->adaptivity_mode = (u8)rtw_adaptivity_mode; -+ registry_par->adaptivity_dml = (u8)rtw_adaptivity_dml; -+ registry_par->adaptivity_dc_backoff = (u8)rtw_adaptivity_dc_backoff; -+ registry_par->adaptivity_th_l2h_ini = (s8)rtw_adaptivity_th_l2h_ini; -+ registry_par->adaptivity_th_edcca_hl_diff = (s8)rtw_adaptivity_th_edcca_hl_diff; -+ -+ registry_par->boffefusemask = (u8)rtw_OffEfuseMask; -+ registry_par->bFileMaskEfuse = (u8)rtw_FileMaskEfuse; -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ registry_par->acs_mode = (u8)rtw_acs_mode; -+ registry_par->acs_auto_scan = (u8)rtw_acs_auto_scan; -+#endif -+ registry_par->reg_rxgain_offset_2g = (u32) rtw_rxgain_offset_2g; -+ registry_par->reg_rxgain_offset_5gl = (u32) rtw_rxgain_offset_5gl; -+ registry_par->reg_rxgain_offset_5gm = (u32) rtw_rxgain_offset_5gm; -+ registry_par->reg_rxgain_offset_5gh = (u32) rtw_rxgain_offset_5gh; -+ -+#ifdef CONFIG_DFS_MASTER -+ registry_par->dfs_region_domain = (u8)rtw_dfs_region_domain; -+#endif -+ -+#ifdef CONFIG_MCC_MODE -+ registry_par->en_mcc = (u8)rtw_en_mcc; -+ registry_par->rtw_mcc_ap_bw20_target_tx_tp = (u32)rtw_mcc_ap_bw20_target_tx_tp; -+ registry_par->rtw_mcc_ap_bw40_target_tx_tp = (u32)rtw_mcc_ap_bw40_target_tx_tp; -+ registry_par->rtw_mcc_ap_bw80_target_tx_tp = (u32)rtw_mcc_ap_bw80_target_tx_tp; -+ registry_par->rtw_mcc_sta_bw20_target_tx_tp = (u32)rtw_mcc_sta_bw20_target_tx_tp; -+ registry_par->rtw_mcc_sta_bw40_target_tx_tp = (u32)rtw_mcc_sta_bw40_target_tx_tp; -+ registry_par->rtw_mcc_sta_bw80_target_tx_tp = (u32)rtw_mcc_sta_bw80_target_tx_tp; -+ registry_par->rtw_mcc_single_tx_cri = (u32)rtw_mcc_single_tx_cri; -+#endif /*CONFIG_MCC_MODE */ -+#ifdef CONFIG_DEFAULT_PATTERNS_EN -+ registry_par->default_patterns_en = rtw_support_default_patterns; -+#endif -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+ registry_par->trx_share_mode = rtw_trx_share_mode; -+#endif -+ -+#ifdef CONFIG_RTW_NAPI -+ registry_par->en_napi = (u8)rtw_en_napi; -+#ifdef CONFIG_RTW_GRO -+ registry_par->en_gro = (u8)rtw_en_gro; -+ if (!registry_par->en_napi && registry_par->en_gro) { -+ registry_par->en_gro = 0; -+ RTW_WARN("Disable GRO because NAPI is not enabled\n"); -+ } -+#endif /* CONFIG_RTW_GRO */ -+#endif /* CONFIG_RTW_NAPI */ -+ -+ return status; -+} -+ -+/** -+ * rtw_net_set_mac_address -+ * This callback function is used for the Media Access Control address -+ * of each net_device needs to be changed. -+ * -+ * Arguments: -+ * @pnetdev: net_device pointer. -+ * @addr: new MAC address. -+ * -+ * Return: -+ * ret = 0: Permit to change net_device's MAC address. -+ * ret = -1 (Default): Operation not permitted. -+ * -+ * Auther: Arvin Liu -+ * Date: 2015/05/29 -+ */ -+static int rtw_net_set_mac_address(struct net_device *pnetdev, void *addr) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sockaddr *sa = (struct sockaddr *)addr; -+ int ret = -1; -+ -+ /* only the net_device is in down state to permit modifying mac addr */ -+ if ((pnetdev->flags & IFF_UP) == _TRUE) { -+ RTW_INFO(FUNC_ADPT_FMT": The net_device's is not in down state\n" -+ , FUNC_ADPT_ARG(padapter)); -+ -+ return ret; -+ } -+ -+ /* if the net_device is linked, it's not permit to modify mac addr */ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) || -+ check_fwstate(pmlmepriv, _FW_LINKED) || -+ check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { -+ RTW_INFO(FUNC_ADPT_FMT": The net_device's is not idle currently\n" -+ , FUNC_ADPT_ARG(padapter)); -+ -+ return ret; -+ } -+ -+ /* check whether the input mac address is valid to permit modifying mac addr */ -+ if (rtw_check_invalid_mac_address(sa->sa_data, _FALSE) == _TRUE) { -+ RTW_INFO(FUNC_ADPT_FMT": Invalid Mac Addr for "MAC_FMT"\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(sa->sa_data)); -+ -+ return ret; -+ } -+ -+ _rtw_memcpy(adapter_mac_addr(padapter), sa->sa_data, ETH_ALEN); /* set mac addr to adapter */ -+ _rtw_memcpy(pnetdev->dev_addr, sa->sa_data, ETH_ALEN); /* set mac addr to net_device */ -+ -+#if 0 -+ if (rtw_is_hw_init_completed(padapter)) { -+ rtw_ps_deny(padapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(padapter); /* leave PS mode for guaranteeing to access hw register successfully */ -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_hal_change_macaddr_mbid(padapter, sa->sa_data); -+#else -+ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, sa->sa_data); /* set mac addr to mac register */ -+#endif -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+ } -+#else -+ rtw_ps_deny(padapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(padapter); /* leave PS mode for guaranteeing to access hw register successfully */ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_hal_change_macaddr_mbid(padapter, sa->sa_data); -+#else -+ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, sa->sa_data); /* set mac addr to mac register */ -+#endif -+ rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); -+#endif -+ -+ RTW_INFO(FUNC_ADPT_FMT": Set Mac Addr to "MAC_FMT" Successfully\n" -+ , FUNC_ADPT_ARG(padapter), MAC_ARG(sa->sa_data)); -+ -+ ret = 0; -+ -+ return ret; -+} -+ -+static struct net_device_stats *rtw_net_get_stats(struct net_device *pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ -+ padapter->stats.tx_packets = pxmitpriv->tx_pkts;/* pxmitpriv->tx_pkts++; */ -+ padapter->stats.rx_packets = precvpriv->rx_pkts;/* precvpriv->rx_pkts++; */ -+ padapter->stats.tx_dropped = pxmitpriv->tx_drop; -+ padapter->stats.rx_dropped = precvpriv->rx_drop; -+ padapter->stats.tx_bytes = pxmitpriv->tx_bytes; -+ padapter->stats.rx_bytes = precvpriv->rx_bytes; -+ -+ return &padapter->stats; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+/* -+ * AC to queue mapping -+ * -+ * AC_VO -> queue 0 -+ * AC_VI -> queue 1 -+ * AC_BE -> queue 2 -+ * AC_BK -> queue 3 -+ */ -+static const u16 rtw_1d_to_queue[8] = { 2, 3, 3, 2, 1, 1, 0, 0 }; -+ -+/* Given a data frame determine the 802.1p/1d tag to use. */ -+unsigned int rtw_classify8021d(struct sk_buff *skb) -+{ -+ unsigned int dscp; -+ -+ /* skb->priority values from 256->263 are magic values to -+ * directly indicate a specific 802.1d priority. This is used -+ * to allow 802.1d priority to be passed directly in from VLAN -+ * tags, etc. -+ */ -+ if (skb->priority >= 256 && skb->priority <= 263) -+ return skb->priority - 256; -+ -+ switch (skb->protocol) { -+ case htons(ETH_P_IP): -+ dscp = ip_hdr(skb)->tos & 0xfc; -+ break; -+ default: -+ return 0; -+ } -+ -+ return dscp >> 5; -+} -+ -+ -+static u16 rtw_select_queue(struct net_device *dev, struct sk_buff *skb -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0) -+ , void *accel_priv -+ #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0) -+ , select_queue_fallback_t fallback -+ #endif -+#endif -+) -+{ -+ _adapter *padapter = rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ skb->priority = rtw_classify8021d(skb); -+ -+ if (pmlmepriv->acm_mask != 0) -+ skb->priority = qos_acm(pmlmepriv->acm_mask, skb->priority); -+ -+ return rtw_1d_to_queue[skb->priority]; -+} -+ -+u16 rtw_recv_select_queue(struct sk_buff *skb) -+{ -+ struct iphdr *piphdr; -+ unsigned int dscp; -+ u16 eth_type; -+ u32 priority; -+ u8 *pdata = skb->data; -+ -+ _rtw_memcpy(ð_type, pdata + (ETH_ALEN << 1), 2); -+ -+ switch (eth_type) { -+ case htons(ETH_P_IP): -+ -+ piphdr = (struct iphdr *)(pdata + ETH_HLEN); -+ -+ dscp = piphdr->tos & 0xfc; -+ -+ priority = dscp >> 5; -+ -+ break; -+ default: -+ priority = 0; -+ } -+ -+ return rtw_1d_to_queue[priority]; -+ -+} -+ -+#endif -+static int rtw_ndev_notifier_call(struct notifier_block *nb, unsigned long state, void *ptr) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) -+ struct net_device *dev = netdev_notifier_info_to_dev(ptr); -+#else -+ struct net_device *dev = ptr; -+#endif -+ -+ if (dev == NULL) -+ return NOTIFY_DONE; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+ if (dev->netdev_ops == NULL) -+ return NOTIFY_DONE; -+ -+ if (dev->netdev_ops->ndo_do_ioctl == NULL) -+ return NOTIFY_DONE; -+ -+ if (dev->netdev_ops->ndo_do_ioctl != rtw_ioctl) -+#else -+ if (dev->do_ioctl == NULL) -+ return NOTIFY_DONE; -+ -+ if (dev->do_ioctl != rtw_ioctl) -+#endif -+ return NOTIFY_DONE; -+ -+ RTW_INFO(FUNC_NDEV_FMT" state:%lu\n", FUNC_NDEV_ARG(dev), state); -+ -+ switch (state) { -+ case NETDEV_CHANGENAME: -+ rtw_adapter_proc_replace(dev); -+ break; -+ } -+ -+ return NOTIFY_DONE; -+} -+ -+static struct notifier_block rtw_ndev_notifier = { -+ .notifier_call = rtw_ndev_notifier_call, -+}; -+ -+int rtw_ndev_notifier_register(void) -+{ -+ return register_netdevice_notifier(&rtw_ndev_notifier); -+} -+ -+void rtw_ndev_notifier_unregister(void) -+{ -+ unregister_netdevice_notifier(&rtw_ndev_notifier); -+} -+ -+ -+int rtw_ndev_init(struct net_device *dev) -+{ -+ _adapter *adapter = rtw_netdev_priv(dev); -+ -+ RTW_PRINT(FUNC_ADPT_FMT" if%d mac_addr="MAC_FMT"\n" -+ , FUNC_ADPT_ARG(adapter), (adapter->iface_id + 1), MAC_ARG(dev->dev_addr)); -+ strncpy(adapter->old_ifname, dev->name, IFNAMSIZ); -+ adapter->old_ifname[IFNAMSIZ - 1] = '\0'; -+ rtw_adapter_proc_init(dev); -+ -+ return 0; -+} -+ -+void rtw_ndev_uninit(struct net_device *dev) -+{ -+ _adapter *adapter = rtw_netdev_priv(dev); -+ -+ RTW_PRINT(FUNC_ADPT_FMT" if%d\n" -+ , FUNC_ADPT_ARG(adapter), (adapter->iface_id + 1)); -+ rtw_adapter_proc_deinit(dev); -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+static const struct net_device_ops rtw_netdev_ops = { -+ .ndo_init = rtw_ndev_init, -+ .ndo_uninit = rtw_ndev_uninit, -+ .ndo_open = netdev_open, -+ .ndo_stop = netdev_close, -+ .ndo_start_xmit = rtw_xmit_entry, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ .ndo_select_queue = rtw_select_queue, -+#endif -+ .ndo_set_mac_address = rtw_net_set_mac_address, -+ .ndo_get_stats = rtw_net_get_stats, -+ .ndo_do_ioctl = rtw_ioctl, -+}; -+#endif -+ -+int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname) -+{ -+ _adapter *padapter = rtw_netdev_priv(pnetdev); -+ -+#ifdef CONFIG_EASY_REPLACEMENT -+ struct net_device *TargetNetdev = NULL; -+ _adapter *TargetAdapter = NULL; -+ struct net *devnet = NULL; -+ -+ if (padapter->bDongle == 1) { -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) -+ TargetNetdev = dev_get_by_name("wlan0"); -+#else -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) -+ devnet = pnetdev->nd_net; -+#else -+ devnet = dev_net(pnetdev); -+#endif -+ TargetNetdev = dev_get_by_name(devnet, "wlan0"); -+#endif -+ if (TargetNetdev) { -+ RTW_INFO("Force onboard module driver disappear !!!\n"); -+ TargetAdapter = rtw_netdev_priv(TargetNetdev); -+ TargetAdapter->DriverState = DRIVER_DISAPPEAR; -+ -+ padapter->pid[0] = TargetAdapter->pid[0]; -+ padapter->pid[1] = TargetAdapter->pid[1]; -+ padapter->pid[2] = TargetAdapter->pid[2]; -+ -+ dev_put(TargetNetdev); -+ unregister_netdev(TargetNetdev); -+ -+ padapter->DriverState = DRIVER_REPLACE_DONGLE; -+ } -+ } -+#endif /* CONFIG_EASY_REPLACEMENT */ -+ -+ if (dev_alloc_name(pnetdev, ifname) < 0) -+ RTW_ERR("dev_alloc_name, fail!\n"); -+ -+ netif_carrier_off(pnetdev); -+ /* rtw_netif_stop_queue(pnetdev); */ -+ -+ return 0; -+} -+ -+void rtw_hook_if_ops(struct net_device *ndev) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+ ndev->netdev_ops = &rtw_netdev_ops; -+#else -+ ndev->init = rtw_ndev_init; -+ ndev->uninit = rtw_ndev_uninit; -+ ndev->open = netdev_open; -+ ndev->stop = netdev_close; -+ ndev->hard_start_xmit = rtw_xmit_entry; -+ ndev->set_mac_address = rtw_net_set_mac_address; -+ ndev->get_stats = rtw_net_get_stats; -+ ndev->do_ioctl = rtw_ioctl; -+#endif -+} -+ -+#ifdef CONFIG_CONCURRENT_MODE -+static void rtw_hook_vir_if_ops(struct net_device *ndev); -+#endif -+struct net_device *rtw_init_netdev(_adapter *old_padapter) -+{ -+ _adapter *padapter; -+ struct net_device *pnetdev; -+ -+ if (old_padapter != NULL) { -+ rtw_os_ndev_free(old_padapter); -+ pnetdev = rtw_alloc_etherdev_with_old_priv(sizeof(_adapter), (void *)old_padapter); -+ } else -+ pnetdev = rtw_alloc_etherdev(sizeof(_adapter)); -+ -+ if (!pnetdev) -+ return NULL; -+ -+ padapter = rtw_netdev_priv(pnetdev); -+ padapter->pnetdev = pnetdev; -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24) -+ SET_MODULE_OWNER(pnetdev); -+#endif -+ -+ rtw_hook_if_ops(pnetdev); -+#ifdef CONFIG_CONCURRENT_MODE -+ if (!is_primary_adapter(padapter)) -+ rtw_hook_vir_if_ops(pnetdev); -+#endif /* CONFIG_CONCURRENT_MODE */ -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ pnetdev->features |= NETIF_F_IP_CSUM; -+#endif -+ -+ /* pnetdev->tx_timeout = NULL; */ -+ pnetdev->watchdog_timeo = HZ * 3; /* 3 second timeout */ -+ -+#ifdef CONFIG_WIRELESS_EXT -+ pnetdev->wireless_handlers = (struct iw_handler_def *)&rtw_handlers_def; -+#endif -+ -+#ifdef WIRELESS_SPY -+ /* priv->wireless_data.spy_data = &priv->spy_data; */ -+ /* pnetdev->wireless_data = &priv->wireless_data; */ -+#endif -+ -+ return pnetdev; -+} -+ -+int rtw_os_ndev_alloc(_adapter *adapter) -+{ -+ int ret = _FAIL; -+ struct net_device *ndev = NULL; -+ -+ ndev = rtw_init_netdev(adapter); -+ if (ndev == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+#if LINUX_VERSION_CODE > KERNEL_VERSION(2, 5, 0) -+ SET_NETDEV_DEV(ndev, dvobj_to_dev(adapter_to_dvobj(adapter))); -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ if (adapter_to_dvobj(adapter)->bdma64) -+ ndev->features |= NETIF_F_HIGHDMA; -+ ndev->irq = adapter_to_dvobj(adapter)->irq; -+#endif -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (rtw_cfg80211_ndev_res_alloc(adapter) != _SUCCESS) { -+ rtw_warn_on(1); -+ goto free_ndev; -+ } -+#endif -+ -+ ret = _SUCCESS; -+ -+free_ndev: -+ if (ret != _SUCCESS && ndev) -+ rtw_free_netdev(ndev); -+exit: -+ return ret; -+} -+ -+void rtw_os_ndev_free(_adapter *adapter) -+{ -+#if defined(CONFIG_IOCTL_CFG80211) -+ rtw_cfg80211_ndev_res_free(adapter); -+#endif -+ -+ if (adapter->pnetdev) { -+ rtw_free_netdev(adapter->pnetdev); -+ adapter->pnetdev = NULL; -+ } -+} -+ -+int rtw_os_ndev_register(_adapter *adapter, const char *name) -+{ -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ int ret = _SUCCESS; -+ struct net_device *ndev = adapter->pnetdev; -+ u8 rtnl_lock_needed = rtw_rtnl_lock_needed(dvobj); -+ -+#ifdef CONFIG_RTW_NAPI -+ netif_napi_add(ndev, &adapter->napi, rtw_recv_napi_poll, RTL_NAPI_WEIGHT); -+#endif /* CONFIG_RTW_NAPI */ -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (rtw_cfg80211_ndev_res_register(adapter) != _SUCCESS) { -+ rtw_warn_on(1); -+ ret = _FAIL; -+ goto exit; -+ } -+#endif -+ -+ /* alloc netdev name */ -+ rtw_init_netdev_name(ndev, name); -+ -+ _rtw_memcpy(ndev->dev_addr, adapter_mac_addr(adapter), ETH_ALEN); -+ -+ /* Tell the network stack we exist */ -+ -+ if (rtnl_lock_needed) -+ ret = (register_netdev(ndev) == 0) ? _SUCCESS : _FAIL; -+ else -+ ret = (register_netdevice(ndev) == 0) ? _SUCCESS : _FAIL; -+ -+ if (ret == _SUCCESS) -+ adapter->registered = 1; -+ else -+ RTW_INFO(FUNC_NDEV_FMT" if%d Failed!\n", FUNC_NDEV_ARG(ndev), (adapter->iface_id + 1)); -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (ret != _SUCCESS) { -+ rtw_cfg80211_ndev_res_unregister(adapter); -+ #if !defined(RTW_SINGLE_WIPHY) -+ rtw_wiphy_unregister(adapter_to_wiphy(adapter)); -+ #endif -+ } -+#endif -+ -+exit: -+#ifdef CONFIG_RTW_NAPI -+ if (ret != _SUCCESS) -+ netif_napi_del(&adapter->napi); -+#endif /* CONFIG_RTW_NAPI */ -+ -+ return ret; -+} -+ -+void rtw_os_ndev_unregister(_adapter *adapter) -+{ -+ struct net_device *netdev = NULL; -+ -+ if (adapter == NULL || adapter->registered == 0) -+ return; -+ -+ adapter->ndev_unregistering = 1; -+ -+ netdev = adapter->pnetdev; -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ rtw_cfg80211_ndev_res_unregister(adapter); -+#endif -+ -+ if ((adapter->DriverState != DRIVER_DISAPPEAR) && netdev) { -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ u8 rtnl_lock_needed = rtw_rtnl_lock_needed(dvobj); -+ -+ if (rtnl_lock_needed) -+ unregister_netdev(netdev); -+ else -+ unregister_netdevice(netdev); -+ } -+ -+#if defined(CONFIG_IOCTL_CFG80211) && !defined(RTW_SINGLE_WIPHY) -+ rtw_wiphy_unregister(adapter_to_wiphy(adapter)); -+#endif -+ -+#ifdef CONFIG_RTW_NAPI -+ if (adapter->napi_state == NAPI_ENABLE) { -+ napi_disable(&adapter->napi); -+ adapter->napi_state = NAPI_DISABLE; -+ } -+ netif_napi_del(&adapter->napi); -+#endif /* CONFIG_RTW_NAPI */ -+ -+ adapter->registered = 0; -+ adapter->ndev_unregistering = 0; -+} -+ -+/** -+ * rtw_os_ndev_init - Allocate and register OS layer net device and relating structures for @adapter -+ * @adapter: the adapter on which this function applies -+ * @name: the requesting net device name -+ * -+ * Returns: -+ * _SUCCESS or _FAIL -+ */ -+int rtw_os_ndev_init(_adapter *adapter, const char *name) -+{ -+ int ret = _FAIL; -+ -+ if (rtw_os_ndev_alloc(adapter) != _SUCCESS) -+ goto exit; -+ -+ if (rtw_os_ndev_register(adapter, name) != _SUCCESS) -+ goto os_ndev_free; -+ -+ ret = _SUCCESS; -+ -+os_ndev_free: -+ if (ret != _SUCCESS) -+ rtw_os_ndev_free(adapter); -+exit: -+ return ret; -+} -+ -+/** -+ * rtw_os_ndev_deinit - Unregister and free OS layer net device and relating structures for @adapter -+ * @adapter: the adapter on which this function applies -+ */ -+void rtw_os_ndev_deinit(_adapter *adapter) -+{ -+ rtw_os_ndev_unregister(adapter); -+ rtw_os_ndev_free(adapter); -+} -+ -+int rtw_os_ndevs_alloc(struct dvobj_priv *dvobj) -+{ -+ int i, status = _SUCCESS; -+ _adapter *adapter; -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (rtw_cfg80211_dev_res_alloc(dvobj) != _SUCCESS) { -+ rtw_warn_on(1); -+ status = _FAIL; -+ goto exit; -+ } -+#endif -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ -+ if (i >= CONFIG_IFACE_NUMBER) { -+ RTW_ERR("%s %d >= CONFIG_IFACE_NUMBER(%d)\n", __func__, i, CONFIG_IFACE_NUMBER); -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ adapter = dvobj->padapters[i]; -+ if (adapter && !adapter->pnetdev) { -+ -+ #ifdef CONFIG_RTW_DYNAMIC_NDEV -+ if (!is_primary_adapter(adapter)) -+ continue; -+ #endif -+ -+ status = rtw_os_ndev_alloc(adapter); -+ if (status != _SUCCESS) { -+ rtw_warn_on(1); -+ break; -+ } -+ } -+ } -+ -+ if (status != _SUCCESS) { -+ for (; i >= 0; i--) { -+ adapter = dvobj->padapters[i]; -+ if (adapter && adapter->pnetdev) -+ rtw_os_ndev_free(adapter); -+ } -+ } -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (status != _SUCCESS) -+ rtw_cfg80211_dev_res_free(dvobj); -+#endif -+exit: -+ return status; -+} -+ -+void rtw_os_ndevs_free(struct dvobj_priv *dvobj) -+{ -+ int i; -+ _adapter *adapter = NULL; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ -+ if (i >= CONFIG_IFACE_NUMBER) { -+ RTW_ERR("%s %d >= CONFIG_IFACE_NUMBER(%d)\n", __func__, i, CONFIG_IFACE_NUMBER); -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ adapter = dvobj->padapters[i]; -+ -+ if (adapter == NULL) -+ continue; -+ -+ rtw_os_ndev_free(adapter); -+ } -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ rtw_cfg80211_dev_res_free(dvobj); -+#endif -+} -+ -+u32 rtw_start_drv_threads(_adapter *padapter) -+{ -+ u32 _status = _SUCCESS; -+ -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+#if defined(CONFIG_SDIO_HCI) -+ if (is_primary_adapter(padapter)) -+#endif -+ { -+ padapter->xmitThread = kthread_run(rtw_xmit_thread, padapter, "RTW_XMIT_THREAD"); -+ if (IS_ERR(padapter->xmitThread)) -+ _status = _FAIL; -+ } -+#endif /* #ifdef CONFIG_XMIT_THREAD_MODE */ -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+ padapter->recvThread = kthread_run(rtw_recv_thread, padapter, "RTW_RECV_THREAD"); -+ if (IS_ERR(padapter->recvThread)) -+ _status = _FAIL; -+#endif -+ -+ if (is_primary_adapter(padapter)) { -+ padapter->cmdThread = kthread_run(rtw_cmd_thread, padapter, "RTW_CMD_THREAD"); -+ if (IS_ERR(padapter->cmdThread)) -+ _status = _FAIL; -+ else -+ _rtw_down_sema(&padapter->cmdpriv.start_cmdthread_sema); /* wait for cmd_thread to run */ -+ } -+ -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+ padapter->evtThread = kthread_run(event_thread, padapter, "RTW_EVENT_THREAD"); -+ if (IS_ERR(padapter->evtThread)) -+ _status = _FAIL; -+#endif -+ -+ rtw_hal_start_thread(padapter); -+ return _status; -+ -+} -+ -+void rtw_stop_drv_threads(_adapter *padapter) -+{ -+ -+ if (is_primary_adapter(padapter)) -+ rtw_stop_cmd_thread(padapter); -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+ _rtw_up_sema(&padapter->evtpriv.evt_notify); -+ if (padapter->evtThread) -+ _rtw_down_sema(&padapter->evtpriv.terminate_evtthread_sema); -+#endif -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+ /* Below is to termindate tx_thread... */ -+#if defined(CONFIG_SDIO_HCI) -+ /* Only wake-up primary adapter */ -+ if (is_primary_adapter(padapter)) -+#endif /*SDIO_HCI */ -+ { -+ if (padapter->xmitpriv.stop_req == 0) { -+ _rtw_up_sema(&padapter->xmitpriv.xmit_sema); -+ /*_rtw_down_sema(&padapter->xmitpriv.terminate_xmitthread_sema);*/ -+ rtw_wait_for_thread_stop(&padapter->xmitpriv.xmitthread_comp); -+ padapter->xmitpriv.stop_req = 1; -+ } -+ } -+#endif -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+ if (is_primary_adapter(padapter)) { -+ /* Below is to termindate rx_thread... */ -+ _rtw_up_sema(&padapter->recvpriv.recv_sema); -+ /*_rtw_down_sema(&padapter->recvpriv.terminate_recvthread_sema);*/ -+ rtw_wait_for_thread_stop(&padapter->recvpriv.recvthread_comp); -+ } -+#endif -+ -+ rtw_hal_stop_thread(padapter); -+} -+ -+u8 rtw_init_default_value(_adapter *padapter); -+u8 rtw_init_default_value(_adapter *padapter) -+{ -+ u8 ret = _SUCCESS; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ /* xmit_priv */ -+ pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense; -+ pxmitpriv->vcs = pregistrypriv->vcs_type; -+ pxmitpriv->vcs_type = pregistrypriv->vcs_type; -+ /* pxmitpriv->rts_thresh = pregistrypriv->rts_thresh; */ -+ pxmitpriv->frag_len = pregistrypriv->frag_thresh; -+ -+ /* security_priv */ -+ /* rtw_get_encrypt_decrypt_from_registrypriv(padapter); */ -+ psecuritypriv->binstallGrpkey = _FAIL; -+#ifdef CONFIG_GTK_OL -+ psecuritypriv->binstallKCK_KEK = _FAIL; -+#endif /* CONFIG_GTK_OL */ -+ psecuritypriv->sw_encrypt = pregistrypriv->software_encrypt; -+ psecuritypriv->sw_decrypt = pregistrypriv->software_decrypt; -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ -+ psecuritypriv->dot11PrivacyKeyIndex = 0; -+ -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpKeyid = 1; -+ -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ psecuritypriv->ndisencryptstatus = Ndis802_11WEPDisabled; -+#ifdef CONFIG_CONCURRENT_MODE -+ psecuritypriv->dot118021x_bmc_cam_id = INVALID_SEC_MAC_CAM_ID; -+#endif -+ -+ -+ /* pwrctrl_priv */ -+ -+ -+ /* registry_priv */ -+ rtw_init_registrypriv_dev_network(padapter); -+ rtw_update_registrypriv_dev_network(padapter); -+ -+ -+ /* hal_priv */ -+ rtw_hal_def_value_init(padapter); -+ -+ /* misc. */ -+ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); -+ padapter->bLinkInfoDump = 0; -+ padapter->bNotifyChannelChange = _FALSE; -+#ifdef CONFIG_P2P -+ padapter->bShowGetP2PState = 1; -+#endif -+ -+ /* for debug purpose */ -+ padapter->fix_rate = 0xFF; -+ padapter->data_fb = 0; -+ padapter->fix_bw = 0xFF; -+ -+ padapter->driver_tx_bw_mode = pregistrypriv->tx_bw_mode; -+ -+ padapter->driver_ampdu_spacing = 0xFF; -+ padapter->driver_rx_ampdu_factor = 0xFF; -+ padapter->driver_rx_ampdu_spacing = 0xFF; -+ padapter->fix_rx_ampdu_accept = RX_AMPDU_ACCEPT_INVALID; -+ padapter->fix_rx_ampdu_size = RX_AMPDU_SIZE_INVALID; -+#ifdef DBG_RX_COUNTER_DUMP -+ padapter->dump_rx_cnt_mode = 0; -+ padapter->drv_rx_cnt_ok = 0; -+ padapter->drv_rx_cnt_crcerror = 0; -+ padapter->drv_rx_cnt_drop = 0; -+#endif -+#ifdef CONFIG_RTW_NAPI -+ padapter->napi_state = NAPI_DISABLE; -+#endif -+ return ret; -+} -+ -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+void _tx_beacon_timer_handlder(void *FunctionContext) -+{ -+ struct dvobj_priv *pdvobj = (struct dvobj_priv *)FunctionContext; -+ -+ tx_beacon_timer_handlder(pdvobj); -+} -+#endif -+ -+struct dvobj_priv *devobj_init(void) -+{ -+ struct dvobj_priv *pdvobj = NULL; -+ -+ pdvobj = (struct dvobj_priv *)rtw_zmalloc(sizeof(*pdvobj)); -+ if (pdvobj == NULL) -+ return NULL; -+ -+ _rtw_mutex_init(&pdvobj->hw_init_mutex); -+ _rtw_mutex_init(&pdvobj->h2c_fwcmd_mutex); -+ _rtw_mutex_init(&pdvobj->setch_mutex); -+ _rtw_mutex_init(&pdvobj->setbw_mutex); -+ _rtw_mutex_init(&pdvobj->rf_read_reg_mutex); -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ _rtw_mutex_init(&pdvobj->sd_indirect_access_mutex); -+#endif -+ -+#ifdef CONFIG_RTW_CUSTOMER_STR -+ _rtw_mutex_init(&pdvobj->customer_str_mutex); -+ _rtw_memset(pdvobj->customer_str, 0xFF, RTW_CUSTOMER_STR_LEN); -+#endif -+ -+ pdvobj->processing_dev_remove = _FALSE; -+ -+ ATOMIC_SET(&pdvobj->disable_func, 0); -+ -+ rtw_macid_ctl_init(&pdvobj->macid_ctl); -+ _rtw_spinlock_init(&pdvobj->cam_ctl.lock); -+ _rtw_mutex_init(&pdvobj->cam_ctl.sec_cam_access_mutex); -+#if defined(RTK_129X_PLATFORM) && defined(CONFIG_PCI_HCI) -+ _rtw_spinlock_init(&pdvobj->io_reg_lock); -+#endif -+#ifdef CONFIG_MBSSID_CAM -+ rtw_mbid_cam_init(pdvobj); -+#endif -+ -+#ifdef CONFIG_AP_MODE -+ pdvobj->nr_ap_if = 0; -+ pdvobj->inter_bcn_space = DEFAULT_BCN_INTERVAL; /* default value is equal to the default beacon_interval (100ms) */ -+ _rtw_init_queue(&pdvobj->ap_if_q); -+#ifdef CONFIG_SWTIMER_BASED_TXBCN -+ _init_timer(&(pdvobj->txbcn_timer), NULL, _tx_beacon_timer_handlder, pdvobj); -+#endif -+#endif -+ -+ _init_timer(&(pdvobj->dynamic_chk_timer), NULL, _dynamic_check_timer_handlder, pdvobj); -+ -+#ifdef CONFIG_MCC_MODE -+ _rtw_mutex_init(&(pdvobj->mcc_objpriv.mcc_mutex)); -+ _rtw_spinlock_init(&pdvobj->mcc_objpriv.mcc_lock); -+#endif /* CONFIG_MCC_MODE */ -+ -+ return pdvobj; -+ -+} -+ -+void devobj_deinit(struct dvobj_priv *pdvobj) -+{ -+ if (!pdvobj) -+ return; -+ -+ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ -+#if defined(CONFIG_IOCTL_CFG80211) -+ rtw_cfg80211_dev_res_free(pdvobj); -+#endif -+ -+#ifdef CONFIG_MCC_MODE -+ _rtw_mutex_free(&(pdvobj->mcc_objpriv.mcc_mutex)); -+ _rtw_spinlock_free(&pdvobj->mcc_objpriv.mcc_lock); -+#endif /* CONFIG_MCC_MODE */ -+ -+ _rtw_mutex_free(&pdvobj->hw_init_mutex); -+ _rtw_mutex_free(&pdvobj->h2c_fwcmd_mutex); -+ -+#ifdef CONFIG_RTW_CUSTOMER_STR -+ _rtw_mutex_free(&pdvobj->customer_str_mutex); -+#endif -+ -+ _rtw_mutex_free(&pdvobj->setch_mutex); -+ _rtw_mutex_free(&pdvobj->setbw_mutex); -+ _rtw_mutex_free(&pdvobj->rf_read_reg_mutex); -+#ifdef CONFIG_SDIO_INDIRECT_ACCESS -+ _rtw_mutex_free(&pdvobj->sd_indirect_access_mutex); -+#endif -+ -+ rtw_macid_ctl_deinit(&pdvobj->macid_ctl); -+ _rtw_spinlock_free(&pdvobj->cam_ctl.lock); -+ _rtw_mutex_free(&pdvobj->cam_ctl.sec_cam_access_mutex); -+ -+#if defined(RTK_129X_PLATFORM) && defined(CONFIG_PCI_HCI) -+ _rtw_spinlock_free(&pdvobj->io_reg_lock); -+#endif -+#ifdef CONFIG_MBSSID_CAM -+ rtw_mbid_cam_deinit(pdvobj); -+#endif -+ -+#ifdef CONFIG_AP_MODE -+ _rtw_spinlock_free(&(pdvobj->ap_if_q.lock)); -+#endif /* CONFIG_AP_MODE */ -+ -+ rtw_mfree((u8 *)pdvobj, sizeof(*pdvobj)); -+} -+ -+inline u8 rtw_rtnl_lock_needed(struct dvobj_priv *dvobj) -+{ -+ if (dvobj->rtnl_lock_holder && dvobj->rtnl_lock_holder == current) -+ return 0; -+ return 1; -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) -+static inline int rtnl_is_locked(void) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 17)) -+ if (unlikely(rtnl_trylock())) { -+ rtnl_unlock(); -+#else -+ if (unlikely(down_trylock(&rtnl_sem) == 0)) { -+ up(&rtnl_sem); -+#endif -+ return 0; -+ } -+ return 1; -+} -+#endif -+ -+inline void rtw_set_rtnl_lock_holder(struct dvobj_priv *dvobj, _thread_hdl_ thd_hdl) -+{ -+ rtw_warn_on(!rtnl_is_locked()); -+ -+ if (!thd_hdl || rtnl_is_locked()) -+ dvobj->rtnl_lock_holder = thd_hdl; -+ -+ if (dvobj->rtnl_lock_holder && 0) -+ RTW_INFO("rtnl_lock_holder: %s:%d\n", current->comm, current->pid); -+} -+ -+u8 rtw_reset_drv_sw(_adapter *padapter) -+{ -+ u8 ret8 = _SUCCESS; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ /* hal_priv */ -+ if (is_primary_adapter(padapter)) -+ rtw_hal_def_value_init(padapter); -+ -+ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); -+ RTW_ENABLE_FUNC(padapter, DF_TX_BIT); -+ padapter->bLinkInfoDump = 0; -+ -+ padapter->xmitpriv.tx_pkts = 0; -+ padapter->recvpriv.rx_pkts = 0; -+ -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; -+ -+ /* pmlmepriv->LinkDetectInfo.TrafficBusyState = _FALSE; */ -+ pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; -+ pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING); -+ -+#ifdef CONFIG_AUTOSUSPEND -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 22) && LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 34)) -+ adapter_to_dvobj(padapter)->pusbdev->autosuspend_disabled = 1;/* autosuspend disabled by the user */ -+#endif -+#endif -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ if (is_primary_adapter(padapter)) -+ rtw_hal_sreset_reset_value(padapter); -+#endif -+ pwrctrlpriv->pwr_state_check_cnts = 0; -+ -+ /* mlmeextpriv */ -+ mlmeext_set_scan_state(&padapter->mlmeextpriv, SCAN_DISABLE); -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ rtw_set_signal_stat_timer(&padapter->recvpriv); -+#endif -+ -+ return ret8; -+} -+ -+ -+u8 rtw_init_drv_sw(_adapter *padapter) -+{ -+ -+ u8 ret8 = _SUCCESS; -+ -+ -+ -+ _rtw_init_listhead(&padapter->list); -+ -+ ret8 = rtw_init_default_value(padapter); -+ -+ if ((rtw_init_cmd_priv(&padapter->cmdpriv)) == _FAIL) { -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+ padapter->cmdpriv.padapter = padapter; -+ -+ if ((rtw_init_evt_priv(&padapter->evtpriv)) == _FAIL) { -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+ rtw_rfctl_init(padapter); -+ -+ if (rtw_init_mlme_priv(padapter) == _FAIL) { -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+#ifdef CONFIG_P2P -+ rtw_init_wifidirect_timers(padapter); -+ init_wifidirect_info(padapter, P2P_ROLE_DISABLE); -+ reset_global_wifidirect_info(padapter); -+ #ifdef CONFIG_IOCTL_CFG80211 -+ rtw_init_cfg80211_wifidirect_info(padapter); -+ #endif -+#ifdef CONFIG_WFD -+ if (rtw_init_wifi_display_info(padapter) == _FAIL) -+ RTW_ERR("Can't init init_wifi_display_info\n"); -+#endif -+#endif /* CONFIG_P2P */ -+ -+ if (init_mlme_ext_priv(padapter) == _FAIL) { -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+#ifdef CONFIG_TDLS -+ if (rtw_init_tdls_info(padapter) == _FAIL) { -+ RTW_INFO("Can't rtw_init_tdls_info\n"); -+ ret8 = _FAIL; -+ goto exit; -+ } -+#endif /* CONFIG_TDLS */ -+ -+ if (_rtw_init_xmit_priv(&padapter->xmitpriv, padapter) == _FAIL) { -+ RTW_INFO("Can't _rtw_init_xmit_priv\n"); -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+ if (_rtw_init_recv_priv(&padapter->recvpriv, padapter) == _FAIL) { -+ RTW_INFO("Can't _rtw_init_recv_priv\n"); -+ ret8 = _FAIL; -+ goto exit; -+ } -+ /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ _rtw_spinlock_init(&padapter->security_key_mutex); -+ -+ /* We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). */ -+ /* _rtw_memset((unsigned char *)&padapter->securitypriv, 0, sizeof (struct security_priv)); */ -+ -+ /* _init_timer(&(padapter->securitypriv.tkip_timer), padapter->pifp, rtw_use_tkipkey_handler, padapter); */ -+ -+ if (_rtw_init_sta_priv(&padapter->stapriv) == _FAIL) { -+ RTW_INFO("Can't _rtw_init_sta_priv\n"); -+ ret8 = _FAIL; -+ goto exit; -+ } -+ -+ padapter->stapriv.padapter = padapter; -+ padapter->setband = WIFI_FREQUENCY_BAND_AUTO; -+ padapter->fix_rate = 0xFF; -+ padapter->data_fb = 0; -+ padapter->fix_rx_ampdu_accept = RX_AMPDU_ACCEPT_INVALID; -+ padapter->fix_rx_ampdu_size = RX_AMPDU_SIZE_INVALID; -+#ifdef DBG_RX_COUNTER_DUMP -+ padapter->dump_rx_cnt_mode = 0; -+ padapter->drv_rx_cnt_ok = 0; -+ padapter->drv_rx_cnt_crcerror = 0; -+ padapter->drv_rx_cnt_drop = 0; -+#endif -+ rtw_init_bcmc_stainfo(padapter); -+ -+ rtw_init_pwrctrl_priv(padapter); -+ -+ /* _rtw_memset((u8 *)&padapter->qospriv, 0, sizeof (struct qos_priv)); */ /* move to mlme_priv */ -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (init_mp_priv(padapter) == _FAIL) -+ RTW_INFO("%s: initialize MP private data Fail!\n", __func__); -+#endif -+ -+ rtw_hal_dm_init(padapter); -+#ifdef CONFIG_SW_LED -+ rtw_hal_sw_led_init(padapter); -+#endif -+#ifdef DBG_CONFIG_ERROR_DETECT -+ rtw_hal_sreset_init(padapter); -+#endif -+ -+#ifdef CONFIG_INTEL_WIDI -+ if (rtw_init_intel_widi(padapter) == _FAIL) { -+ RTW_INFO("Can't rtw_init_intel_widi\n"); -+ ret8 = _FAIL; -+ goto exit; -+ } -+#endif /* CONFIG_INTEL_WIDI */ -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ padapter->WapiSupport = true; /* set true temp, will revise according to Efuse or Registry value later. */ -+ rtw_wapi_init(padapter); -+#endif -+ -+#ifdef CONFIG_BR_EXT -+ _rtw_spinlock_init(&padapter->br_ext_lock); -+#endif /* CONFIG_BR_EXT */ -+ -+exit: -+ -+ -+ -+ return ret8; -+ -+} -+ -+#ifdef CONFIG_WOWLAN -+void rtw_cancel_dynamic_chk_timer(_adapter *padapter) -+{ -+ _cancel_timer_ex(&adapter_to_dvobj(padapter)->dynamic_chk_timer); -+} -+#endif -+ -+void rtw_cancel_all_timer(_adapter *padapter) -+{ -+ -+ _cancel_timer_ex(&padapter->mlmepriv.assoc_timer); -+ -+#if 0 -+ _cancel_timer_ex(&padapter->securitypriv.tkip_timer); -+#endif -+ -+ _cancel_timer_ex(&padapter->mlmepriv.scan_to_timer); -+ -+#ifdef CONFIG_DFS_MASTER -+ _cancel_timer_ex(&padapter->mlmepriv.dfs_master_timer); -+#endif -+ -+ _cancel_timer_ex(&adapter_to_dvobj(padapter)->dynamic_chk_timer); -+ -+ /* cancel sw led timer */ -+ rtw_hal_sw_led_deinit(padapter); -+ -+ _cancel_timer_ex(&(adapter_to_pwrctl(padapter)->pwr_state_check_timer)); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+#ifdef CONFIG_P2P -+ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); -+#endif /* CONFIG_P2P */ -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+ _cancel_timer_ex(&padapter->mlmepriv.set_scan_deny_timer); -+ rtw_clear_scan_deny(padapter); -+#endif -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ _cancel_timer_ex(&padapter->recvpriv.signal_stat_timer); -+#endif -+ /* cancel dm timer */ -+ rtw_hal_dm_deinit(padapter); -+ -+#ifdef CONFIG_PLATFORM_FS_MX61 -+ msleep(50); -+#endif -+} -+ -+u8 rtw_free_drv_sw(_adapter *padapter) -+{ -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_free(padapter); -+#endif -+ -+ /* we can call rtw_p2p_enable here, but: */ -+ /* 1. rtw_p2p_enable may have IO operation */ -+ /* 2. rtw_p2p_enable is bundled with wext interface */ -+ #ifdef CONFIG_P2P -+ { -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { -+ _cancel_timer_ex(&pwdinfo->find_phase_timer); -+ _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); -+ _cancel_timer_ex(&pwdinfo->pre_tx_scan_timer); -+ #ifdef CONFIG_CONCURRENT_MODE -+ _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); -+ #endif /* CONFIG_CONCURRENT_MODE */ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE); -+ } -+ } -+ #endif -+ /* add for CONFIG_IEEE80211W, none 11w also can use */ -+ _rtw_spinlock_free(&padapter->security_key_mutex); -+ -+#ifdef CONFIG_BR_EXT -+ _rtw_spinlock_free(&padapter->br_ext_lock); -+#endif /* CONFIG_BR_EXT */ -+ -+#ifdef CONFIG_INTEL_WIDI -+ rtw_free_intel_widi(padapter); -+#endif /* CONFIG_INTEL_WIDI */ -+ -+ free_mlme_ext_priv(&padapter->mlmeextpriv); -+ -+#ifdef CONFIG_TDLS -+ /* rtw_free_tdls_info(&padapter->tdlsinfo); */ -+#endif /* CONFIG_TDLS */ -+ -+ rtw_free_cmd_priv(&padapter->cmdpriv); -+ -+ rtw_free_evt_priv(&padapter->evtpriv); -+ -+ rtw_free_mlme_priv(&padapter->mlmepriv); -+ -+ /* free_io_queue(padapter); */ -+ -+ _rtw_free_xmit_priv(&padapter->xmitpriv); -+ -+ _rtw_free_sta_priv(&padapter->stapriv); /* will free bcmc_stainfo here */ -+ -+ _rtw_free_recv_priv(&padapter->recvpriv); -+ -+ rtw_free_pwrctrl_priv(padapter); -+ -+ /* rtw_mfree((void *)padapter, sizeof (padapter)); */ -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ free_drvext(&padapter->drvextpriv); -+#endif -+ -+ rtw_hal_free_data(padapter); -+ -+ -+ /* free the old_pnetdev */ -+ if (padapter->rereg_nd_name_priv.old_pnetdev) { -+ free_netdev(padapter->rereg_nd_name_priv.old_pnetdev); -+ padapter->rereg_nd_name_priv.old_pnetdev = NULL; -+ } -+ -+ return _SUCCESS; -+ -+} -+void rtw_intf_start(_adapter *adapter) -+{ -+ if (adapter->intf_start) -+ adapter->intf_start(adapter); -+} -+void rtw_intf_stop(_adapter *adapter) -+{ -+ if (adapter->intf_stop) -+ adapter->intf_stop(adapter); -+} -+ -+#ifdef CONFIG_CONCURRENT_MODE -+int _netdev_vir_if_open(struct net_device *pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ _adapter *primary_padapter = GET_PRIMARY_ADAPTER(padapter); -+ -+ RTW_INFO(FUNC_NDEV_FMT" , bup=%d\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); -+ -+ if (!primary_padapter) -+ goto _netdev_virtual_iface_open_error; -+ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ if (padapter->bup == _FALSE) { -+ u8 mac[ETH_ALEN]; -+ -+ /* get mac address from primary_padapter */ -+ if (primary_padapter->bup == _FALSE) -+ rtw_macaddr_cfg(adapter_mac_addr(primary_padapter), get_hal_mac_addr(primary_padapter)); -+ -+ _rtw_memcpy(mac, adapter_mac_addr(primary_padapter), ETH_ALEN); -+ -+ /* -+ * If the BIT1 is 0, the address is universally administered. -+ * If it is 1, the address is locally administered -+ */ -+ mac[0] |= BIT(1); -+ -+ _rtw_memcpy(adapter_mac_addr(padapter), mac, ETH_ALEN); -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_mbid_camid_alloc(padapter, adapter_mac_addr(padapter)); -+#endif -+ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); -+ _rtw_memcpy(pnetdev->dev_addr, adapter_mac_addr(padapter), ETH_ALEN); -+ } -+#endif /*CONFIG_PLATFORM_INTEL_BYT*/ -+ -+ if (primary_padapter->bup == _FALSE || !rtw_is_hw_init_completed(primary_padapter)) -+ _netdev_open(primary_padapter->pnetdev); -+ -+ if (padapter->bup == _FALSE && primary_padapter->bup == _TRUE && -+ rtw_is_hw_init_completed(primary_padapter)) { -+ padapter->bFWReady = primary_padapter->bFWReady; -+#if 0 /*#ifdef CONFIG_MI_WITH_MBSSID_CAM*/ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, adapter_mac_addr(padapter)); /* set mac addr to mac register */ -+#endif -+ -+ } -+ -+ if (padapter->bup == _FALSE) { -+ if (rtw_start_drv_threads(padapter) == _FAIL) -+ goto _netdev_virtual_iface_open_error; -+ } -+ -+#ifdef CONFIG_RTW_NAPI -+ if (padapter->napi_state == NAPI_DISABLE) { -+ napi_enable(&padapter->napi); -+ padapter->napi_state = NAPI_ENABLE; -+ } -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_init_wiphy(padapter); -+ rtw_cfg80211_init_wdev_data(padapter); -+#endif -+ -+ padapter->bup = _TRUE; -+ -+ padapter->net_closed = _FALSE; -+ -+ rtw_netif_wake_queue(pnetdev); -+ -+ RTW_INFO(FUNC_NDEV_FMT" (bup=%d) exit\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); -+ -+ return 0; -+ -+_netdev_virtual_iface_open_error: -+ -+ padapter->bup = _FALSE; -+ -+#ifdef CONFIG_RTW_NAPI -+ if(padapter->napi_state == NAPI_ENABLE) { -+ napi_disable(&padapter->napi); -+ padapter->napi_state = NAPI_DISABLE; -+ } -+#endif -+ -+ netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ -+ return -1; -+ -+} -+ -+int netdev_vir_if_open(struct net_device *pnetdev) -+{ -+ int ret; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ ret = _netdev_vir_if_open(pnetdev); -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ /* if(padapter->iface_id == 2) */ -+ /* rtw_start_auto_ap(padapter); */ -+#endif -+ -+ return ret; -+} -+ -+static int netdev_vir_if_close(struct net_device *pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ RTW_INFO(FUNC_NDEV_FMT" , bup=%d\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); -+ padapter->net_closed = _TRUE; -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; -+ -+ if (pnetdev) -+ rtw_netif_stop_queue(pnetdev); -+ -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_role(&padapter->wdinfo, P2P_ROLE_DISABLE)) -+ rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_scan_abort(padapter); -+ rtw_cfg80211_wait_scan_req_empty(padapter, 200); -+ adapter_wdev_data(padapter)->bandroid_scan = _FALSE; -+#endif -+ -+ return 0; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+static const struct net_device_ops rtw_netdev_vir_if_ops = { -+ .ndo_init = rtw_ndev_init, -+ .ndo_uninit = rtw_ndev_uninit, -+ .ndo_open = netdev_vir_if_open, -+ .ndo_stop = netdev_vir_if_close, -+ .ndo_start_xmit = rtw_xmit_entry, -+ .ndo_set_mac_address = rtw_net_set_mac_address, -+ .ndo_get_stats = rtw_net_get_stats, -+ .ndo_do_ioctl = rtw_ioctl, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ .ndo_select_queue = rtw_select_queue, -+#endif -+}; -+#endif -+ -+static void rtw_hook_vir_if_ops(struct net_device *ndev) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) -+ ndev->netdev_ops = &rtw_netdev_vir_if_ops; -+#else -+ ndev->init = rtw_ndev_init; -+ ndev->uninit = rtw_ndev_uninit; -+ ndev->open = netdev_vir_if_open; -+ ndev->stop = netdev_vir_if_close; -+ ndev->set_mac_address = rtw_net_set_mac_address; -+#endif -+} -+_adapter *rtw_drv_add_vir_if(_adapter *primary_padapter, -+ void (*set_intf_ops)(_adapter *primary_padapter, struct _io_ops *pops)) -+{ -+ int res = _FAIL; -+ _adapter *padapter = NULL; -+ struct dvobj_priv *pdvobjpriv; -+ u8 mac[ETH_ALEN]; -+ -+ /****** init adapter ******/ -+ padapter = (_adapter *)rtw_zvmalloc(sizeof(*padapter)); -+ if (padapter == NULL) -+ goto exit; -+ -+ if (loadparam(padapter) != _SUCCESS) -+ goto free_adapter; -+ -+ _rtw_memcpy(padapter, primary_padapter, sizeof(_adapter)); -+ -+ /* */ -+ padapter->bup = _FALSE; -+ padapter->net_closed = _TRUE; -+ padapter->dir_dev = NULL; -+ padapter->dir_odm = NULL; -+ -+ /*set adapter_type/iface type*/ -+ padapter->isprimary = _FALSE; -+ padapter->adapter_type = VIRTUAL_ADAPTER; -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ padapter->hw_port = HW_PORT0; -+#else -+ padapter->hw_port = HW_PORT1; -+#endif -+ -+ -+ /****** hook vir if into dvobj ******/ -+ pdvobjpriv = adapter_to_dvobj(padapter); -+ padapter->iface_id = pdvobjpriv->iface_nums; -+ pdvobjpriv->padapters[pdvobjpriv->iface_nums++] = padapter; -+ -+ padapter->intf_start = primary_padapter->intf_start; -+ padapter->intf_stop = primary_padapter->intf_stop; -+ -+ /* step init_io_priv */ -+ if ((rtw_init_io_priv(padapter, set_intf_ops)) == _FAIL) { -+ goto free_adapter; -+ } -+ -+ /*init drv data*/ -+ if (rtw_init_drv_sw(padapter) != _SUCCESS) -+ goto free_drv_sw; -+ -+ -+ /*get mac address from primary_padapter*/ -+ _rtw_memcpy(mac, adapter_mac_addr(primary_padapter), ETH_ALEN); -+ -+ /* -+ * If the BIT1 is 0, the address is universally administered. -+ * If it is 1, the address is locally administered -+ */ -+ mac[0] |= BIT(1); -+ if (padapter->iface_id > IFACE_ID1) -+ mac[4] ^= BIT(padapter->iface_id); -+ -+ _rtw_memcpy(adapter_mac_addr(padapter), mac, ETH_ALEN); -+ /* update mac-address to mbsid-cam cache*/ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_mbid_camid_alloc(padapter, adapter_mac_addr(padapter)); -+#endif -+ RTW_INFO("%s if%d mac_addr : "MAC_FMT"\n", __func__, padapter->iface_id + 1, MAC_ARG(adapter_mac_addr(padapter))); -+#ifdef CONFIG_P2P -+ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); -+#endif -+ res = _SUCCESS; -+ -+free_drv_sw: -+ if (res != _SUCCESS && padapter) -+ rtw_free_drv_sw(padapter); -+free_adapter: -+ if (res != _SUCCESS && padapter) { -+ rtw_vmfree((u8 *)padapter, sizeof(*padapter)); -+ padapter = NULL; -+ } -+exit: -+ return padapter; -+} -+ -+void rtw_drv_stop_vir_if(_adapter *padapter) -+{ -+ struct net_device *pnetdev = NULL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if (padapter == NULL) -+ return; -+ -+ pnetdev = padapter->pnetdev; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) -+ rtw_disassoc_cmd(padapter, 0, _FALSE); -+ -+#ifdef CONFIG_AP_MODE -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { -+ free_mlme_ap_info(padapter); -+ #ifdef CONFIG_HOSTAPD_MLME -+ hostapd_mode_unload(padapter); -+ #endif -+ } -+#endif -+ -+ if (padapter->bup == _TRUE) { -+ #ifdef CONFIG_XMIT_ACK -+ if (padapter->xmitpriv.ack_tx) -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP); -+ #endif -+ -+ rtw_intf_stop(padapter); -+ -+ rtw_stop_drv_threads(padapter); -+ -+ padapter->bup = _FALSE; -+ } -+ /* cancel timer after thread stop */ -+ rtw_cancel_all_timer(padapter); -+} -+ -+void rtw_drv_free_vir_if(_adapter *padapter) -+{ -+ if (padapter == NULL) -+ return; -+ -+ RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ rtw_free_drv_sw(padapter); -+ -+ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ -+ rtw_os_ndev_free(padapter); -+ -+ rtw_vmfree((u8 *)padapter, sizeof(_adapter)); -+} -+ -+ -+void rtw_drv_stop_vir_ifaces(struct dvobj_priv *dvobj) -+{ -+ int i; -+ -+ for (i = VIF_START_ID; i < dvobj->iface_nums; i++) -+ rtw_drv_stop_vir_if(dvobj->padapters[i]); -+} -+ -+void rtw_drv_free_vir_ifaces(struct dvobj_priv *dvobj) -+{ -+ int i; -+ -+ for (i = VIF_START_ID; i < dvobj->iface_nums; i++) -+ rtw_drv_free_vir_if(dvobj->padapters[i]); -+} -+ -+void rtw_drv_del_vir_if(_adapter *padapter) -+{ -+ rtw_drv_stop_vir_if(padapter); -+ rtw_drv_free_vir_if(padapter); -+} -+ -+void rtw_drv_del_vir_ifaces(_adapter *primary_padapter) -+{ -+ int i; -+ struct dvobj_priv *dvobj = primary_padapter->dvobj; -+ -+ for (i = VIF_START_ID; i < dvobj->iface_nums; i++) -+ rtw_drv_del_vir_if(dvobj->padapters[i]); -+ -+} -+ -+#endif /*end of CONFIG_CONCURRENT_MODE*/ -+ -+int rtw_os_ndevs_register(struct dvobj_priv *dvobj) -+{ -+ int i, status = _SUCCESS; -+ struct registry_priv *regsty = dvobj_to_regsty(dvobj); -+ _adapter *adapter; -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (rtw_cfg80211_dev_res_register(dvobj) != _SUCCESS) { -+ rtw_warn_on(1); -+ status = _FAIL; -+ goto exit; -+ } -+#endif -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ -+ if (i >= CONFIG_IFACE_NUMBER) { -+ RTW_ERR("%s %d >= CONFIG_IFACE_NUMBER(%d)\n", __func__, i, CONFIG_IFACE_NUMBER); -+ rtw_warn_on(1); -+ continue; -+ } -+ -+ adapter = dvobj->padapters[i]; -+ if (adapter) { -+ char *name; -+ -+ #ifdef CONFIG_RTW_DYNAMIC_NDEV -+ if (!is_primary_adapter(adapter)) -+ continue; -+ #endif -+ -+ if (adapter->iface_id == IFACE_ID0) -+ name = regsty->ifname; -+ else if (adapter->iface_id == IFACE_ID1) -+ name = regsty->if2name; -+ else -+ name = "wlan%d"; -+ -+ status = rtw_os_ndev_register(adapter, name); -+ -+ if (status != _SUCCESS) { -+ rtw_warn_on(1); -+ break; -+ } -+ } -+ } -+ -+ if (status != _SUCCESS) { -+ for (; i >= 0; i--) { -+ adapter = dvobj->padapters[i]; -+ if (adapter) -+ rtw_os_ndev_unregister(adapter); -+ } -+ } -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ if (status != _SUCCESS) -+ rtw_cfg80211_dev_res_unregister(dvobj); -+#endif -+exit: -+ return status; -+} -+ -+void rtw_os_ndevs_unregister(struct dvobj_priv *dvobj) -+{ -+ int i; -+ _adapter *adapter = NULL; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ adapter = dvobj->padapters[i]; -+ -+ if (adapter == NULL) -+ continue; -+ -+ rtw_os_ndev_unregister(adapter); -+ } -+ -+#if defined(CONFIG_IOCTL_CFG80211) -+ rtw_cfg80211_dev_res_unregister(dvobj); -+#endif -+} -+ -+/** -+ * rtw_os_ndevs_init - Allocate and register OS layer net devices and relating structures for @dvobj -+ * @dvobj: the dvobj on which this function applies -+ * -+ * Returns: -+ * _SUCCESS or _FAIL -+ */ -+int rtw_os_ndevs_init(struct dvobj_priv *dvobj) -+{ -+ int ret = _FAIL; -+ -+ if (rtw_os_ndevs_alloc(dvobj) != _SUCCESS) -+ goto exit; -+ -+ if (rtw_os_ndevs_register(dvobj) != _SUCCESS) -+ goto os_ndevs_free; -+ -+ ret = _SUCCESS; -+ -+os_ndevs_free: -+ if (ret != _SUCCESS) -+ rtw_os_ndevs_free(dvobj); -+exit: -+ return ret; -+} -+ -+/** -+ * rtw_os_ndevs_deinit - Unregister and free OS layer net devices and relating structures for @dvobj -+ * @dvobj: the dvobj on which this function applies -+ */ -+void rtw_os_ndevs_deinit(struct dvobj_priv *dvobj) -+{ -+ rtw_os_ndevs_unregister(dvobj); -+ rtw_os_ndevs_free(dvobj); -+} -+ -+#ifdef CONFIG_BR_EXT -+void netdev_br_init(struct net_device *netdev) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+ rcu_read_lock(); -+#endif /* (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) */ -+ -+ /* if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == _TRUE) */ -+ { -+ /* struct net_bridge *br = netdev->br_port->br; */ /* ->dev->dev_addr; */ -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ if (netdev->br_port) -+#else /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ -+ if (rcu_dereference(adapter->pnetdev->rx_handler_data)) -+#endif /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ -+ { -+ struct net_device *br_netdev; -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) -+ br_netdev = dev_get_by_name(CONFIG_BR_EXT_BRNAME); -+#else /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) */ -+ struct net *devnet = NULL; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) -+ devnet = netdev->nd_net; -+#else /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) */ -+ devnet = dev_net(netdev); -+#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) */ -+ -+ br_netdev = dev_get_by_name(devnet, CONFIG_BR_EXT_BRNAME); -+#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) */ -+ -+ if (br_netdev) { -+ memcpy(adapter->br_mac, br_netdev->dev_addr, ETH_ALEN); -+ dev_put(br_netdev); -+ } else -+ printk("%s()-%d: dev_get_by_name(%s) failed!", __FUNCTION__, __LINE__, CONFIG_BR_EXT_BRNAME); -+ } -+ -+ adapter->ethBrExtInfo.addPPPoETag = 1; -+ } -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+ rcu_read_unlock(); -+#endif /* (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) */ -+} -+#endif /* CONFIG_BR_EXT */ -+ -+int _netdev_open(struct net_device *pnetdev) -+{ -+ uint status; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ -+ -+ RTW_INFO(FUNC_NDEV_FMT" , bup=%d\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); -+ -+ padapter->netif_up = _TRUE; -+ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ rtw_sdio_set_power(1); -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+ -+ if (pwrctrlpriv->ps_flag == _TRUE) { -+ padapter->net_closed = _FALSE; -+ goto netdev_open_normal_process; -+ } -+ -+ if (padapter->bup == _FALSE) { -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ rtw_macaddr_cfg(adapter_mac_addr(padapter), get_hal_mac_addr(padapter)); -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_mbid_camid_alloc(padapter, adapter_mac_addr(padapter)); -+#endif -+ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); -+ _rtw_memcpy(pnetdev->dev_addr, adapter_mac_addr(padapter), ETH_ALEN); -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+ -+ rtw_clr_surprise_removed(padapter); -+ rtw_clr_drv_stopped(padapter); -+ -+ status = rtw_hal_init(padapter); -+ if (status == _FAIL) { -+ goto netdev_open_error; -+ } -+#if 0/*#ifdef CONFIG_MI_WITH_MBSSID_CAM*/ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, adapter_mac_addr(padapter)); /* set mac addr to mac register */ -+#endif -+ -+ RTW_INFO("MAC Address = "MAC_FMT"\n", MAC_ARG(pnetdev->dev_addr)); -+ -+ status = rtw_start_drv_threads(padapter); -+ if (status == _FAIL) { -+ RTW_INFO("Initialize driver software resource Failed!\n"); -+ goto netdev_open_error; -+ } -+ -+#ifdef CONFIG_RTW_NAPI -+ if(padapter->napi_state == NAPI_DISABLE) { -+ napi_enable(&padapter->napi); -+ padapter->napi_state = NAPI_ENABLE; -+ } -+#endif -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ init_drvext(padapter); -+#endif -+ rtw_intf_start(padapter); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_init_wiphy(padapter); -+ rtw_cfg80211_init_wdev_data(padapter); -+#endif -+ -+ rtw_led_control(padapter, LED_CTL_NO_LINK); -+ -+ padapter->bup = _TRUE; -+ pwrctrlpriv->bips_processing = _FALSE; -+ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_IpsNotify(padapter, IPS_NONE); -+#endif /* CONFIG_BT_COEXIST */ -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+ } -+ padapter->net_closed = _FALSE; -+ -+ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); -+ -+#ifndef CONFIG_IPS_CHECK_IN_WD -+ rtw_set_pwr_state_check_timer(pwrctrlpriv); -+#endif -+ -+ /* netif_carrier_on(pnetdev); */ /* call this func when rtw_joinbss_event_callback return success */ -+ rtw_netif_wake_queue(pnetdev); -+ -+#ifdef CONFIG_BR_EXT -+ netdev_br_init(pnetdev); -+#endif /* CONFIG_BR_EXT */ -+ -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ if (is_primary_adapter(padapter) && (_TRUE == pHalData->EEPROMBluetoothCoexist)) { -+ rtw_btcoex_init_socket(padapter); -+ padapter->coex_info.BtMgnt.ExtConfig.HCIExtensionVer = 0x04; -+ rtw_btcoex_SetHciVersion(padapter, 0x04); -+ } else -+ RTW_INFO("CONFIG_BT_COEXIST: VIRTUAL_ADAPTER\n"); -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ -+ -+netdev_open_normal_process: -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ { -+ _adapter *sec_adapter = adapter_to_dvobj(padapter)->padapters[IFACE_ID1]; -+ -+ #ifndef CONFIG_RTW_DYNAMIC_NDEV -+ if (sec_adapter && (sec_adapter->bup == _FALSE)) -+ _netdev_vir_if_open(sec_adapter->pnetdev); -+ #endif -+ } -+#endif -+ -+ RTW_INFO("-871x_drv - drv_open, bup=%d\n", padapter->bup); -+ -+ return 0; -+ -+netdev_open_error: -+ -+ padapter->bup = _FALSE; -+ -+#ifdef CONFIG_RTW_NAPI -+ if(padapter->napi_state == NAPI_ENABLE) { -+ napi_disable(&padapter->napi); -+ padapter->napi_state = NAPI_DISABLE; -+ } -+#endif -+ -+ netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ -+ RTW_INFO("-871x_drv - drv_open fail, bup=%d\n", padapter->bup); -+ -+ return -1; -+ -+} -+ -+int netdev_open(struct net_device *pnetdev) -+{ -+ int ret = _FALSE; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); -+ -+ if (pwrctrlpriv->bInSuspend == _TRUE) { -+ RTW_INFO(" [WARN] "ADPT_FMT" %s failed, bInSuspend=%d\n", ADPT_ARG(padapter), __func__, pwrctrlpriv->bInSuspend); -+ return 0; -+ } -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ if (is_primary_adapter(padapter)) -+ ret = _netdev_open(pnetdev); -+#ifdef CONFIG_CONCURRENT_MODE -+ else -+ ret = _netdev_vir_if_open(pnetdev); -+#endif -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (padapter->iface_id == IFACE_ID2) -+ rtw_start_auto_ap(padapter); -+#endif -+ -+ return ret; -+} -+ -+#ifdef CONFIG_IPS -+int ips_netdrv_open(_adapter *padapter) -+{ -+ int status = _SUCCESS; -+ /* struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); */ -+ -+ padapter->net_closed = _FALSE; -+ -+ RTW_INFO("===> %s.........\n", __FUNCTION__); -+ -+ -+ rtw_clr_drv_stopped(padapter); -+ /* padapter->bup = _TRUE; */ -+ -+ status = rtw_hal_init(padapter); -+ if (status == _FAIL) { -+ goto netdev_open_error; -+ } -+#if 0 -+ rtw_restore_mac_addr(padapter); -+#endif -+ rtw_intf_start(padapter); -+ -+#ifndef CONFIG_IPS_CHECK_IN_WD -+ rtw_set_pwr_state_check_timer(adapter_to_pwrctl(padapter)); -+#endif -+ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); -+ -+ return _SUCCESS; -+ -+netdev_open_error: -+ /* padapter->bup = _FALSE; */ -+ RTW_INFO("-ips_netdrv_open - drv_open failure, bup=%d\n", padapter->bup); -+ -+ return _FAIL; -+} -+ -+ -+int rtw_ips_pwr_up(_adapter *padapter) -+{ -+ int result; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+#ifdef DBG_CONFIG_ERROR_DETECT -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+#endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ -+ u32 start_time = rtw_get_current_time(); -+ RTW_INFO("===> rtw_ips_pwr_up..............\n"); -+ -+#if defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) -+#ifdef DBG_CONFIG_ERROR_DETECT -+ if (psrtpriv->silent_reset_inprogress == _TRUE) -+#endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ -+#endif /* defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) */ -+ rtw_reset_drv_sw(padapter); -+ -+ result = ips_netdrv_open(padapter); -+ -+ rtw_led_control(padapter, LED_CTL_NO_LINK); -+ -+ RTW_INFO("<=== rtw_ips_pwr_up.............. in %dms\n", rtw_get_passing_time_ms(start_time)); -+ return result; -+ -+} -+ -+void rtw_ips_pwr_down(_adapter *padapter) -+{ -+ u32 start_time = rtw_get_current_time(); -+ RTW_INFO("===> rtw_ips_pwr_down...................\n"); -+ -+ padapter->net_closed = _TRUE; -+ -+ rtw_ips_dev_unload(padapter); -+ RTW_INFO("<=== rtw_ips_pwr_down..................... in %dms\n", rtw_get_passing_time_ms(start_time)); -+} -+#endif -+void rtw_ips_dev_unload(_adapter *padapter) -+{ -+ struct net_device *pnetdev = (struct net_device *)padapter->pnetdev; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+#ifdef DBG_CONFIG_ERROR_DETECT -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+#endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ -+ RTW_INFO("====> %s...\n", __FUNCTION__); -+ -+ -+#if defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) -+#ifdef DBG_CONFIG_ERROR_DETECT -+ if (psrtpriv->silent_reset_inprogress == _TRUE) -+#endif /* #ifdef DBG_CONFIG_ERROR_DETECT */ -+#endif /* defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) */ -+ { -+ rtw_hal_set_hwreg(padapter, HW_VAR_FIFO_CLEARN_UP, 0); -+ rtw_intf_stop(padapter); -+ } -+ -+ if (!rtw_is_surprise_removed(padapter)) -+ rtw_hal_deinit(padapter); -+ -+} -+ -+ -+int pm_netdev_open(struct net_device *pnetdev, u8 bnormal) -+{ -+ int status = 0; -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ -+ if (_TRUE == bnormal) { -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ status = _netdev_open(pnetdev); -+#if 0 -+ rtw_restore_mac_addr(padapter); -+#endif -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ } -+#ifdef CONFIG_IPS -+ else -+ status = (_SUCCESS == ips_netdrv_open(padapter)) ? (0) : (-1); -+#endif -+ -+ return status; -+} -+ -+static int netdev_close(struct net_device *pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+ -+ RTW_INFO(FUNC_NDEV_FMT" , bup=%d\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); -+#ifndef CONFIG_PLATFORM_INTEL_BYT -+ if (pwrctl->bInternalAutoSuspend == _TRUE) { -+ /* rtw_pwr_wakeup(padapter); */ -+ if (pwrctl->rf_pwrstate == rf_off) -+ pwrctl->ps_flag = _TRUE; -+ } -+ padapter->net_closed = _TRUE; -+ padapter->netif_up = _FALSE; -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; -+ -+ /* if (!rtw_is_hw_init_completed(padapter)) { -+ RTW_INFO("(1)871x_drv - drv_close, bup=%d, hw_init_completed=%s\n", padapter->bup, rtw_is_hw_init_completed(padapter)?"_TRUE":"_FALSE"); -+ -+ rtw_set_drv_stopped(padapter); -+ -+ rtw_dev_unload(padapter); -+ } -+ else*/ -+ if (pwrctl->rf_pwrstate == rf_on) { -+ RTW_INFO("(2)871x_drv - drv_close, bup=%d, hw_init_completed=%s\n", padapter->bup, rtw_is_hw_init_completed(padapter) ? "_TRUE" : "_FALSE"); -+ -+ /* s1. */ -+ if (pnetdev) -+ rtw_netif_stop_queue(pnetdev); -+ -+#ifndef CONFIG_ANDROID -+ /* s2. */ -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, _FALSE); -+ /* s2-2. indicate disconnect to os */ -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ /* s2-3. */ -+ rtw_free_assoc_resources(padapter, 1); -+ /* s2-4. */ -+ rtw_free_network_queue(padapter, _TRUE); -+#endif -+ /* Close LED */ -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ } -+ -+#ifdef CONFIG_BR_EXT -+ /* if (OPMODE & (WIFI_STATION_STATE | WIFI_ADHOC_STATE)) */ -+ { -+ /* void nat25_db_cleanup(_adapter *priv); */ -+ nat25_db_cleanup(padapter); -+ } -+#endif /* CONFIG_BR_EXT */ -+ -+#ifdef CONFIG_P2P -+ if (!rtw_p2p_chk_role(&padapter->wdinfo, P2P_ROLE_DISABLE)) -+ rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); -+#endif /* CONFIG_P2P */ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_scan_abort(padapter); -+ rtw_cfg80211_wait_scan_req_empty(padapter, 200); -+ adapter_wdev_data(padapter)->bandroid_scan = _FALSE; -+ /* padapter->rtw_wdev->iftype = NL80211_IFTYPE_MONITOR; */ /* set this at the end */ -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_disable_tx(padapter); -+#endif -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ if (is_primary_adapter(padapter) && (_TRUE == pHalData->EEPROMBluetoothCoexist)) -+ rtw_btcoex_close_socket(padapter); -+ else -+ RTW_INFO("CONFIG_BT_COEXIST: VIRTUAL_ADAPTER\n"); -+#endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ -+#else /* !CONFIG_PLATFORM_INTEL_BYT */ -+ -+ if (pwrctl->bInSuspend == _TRUE) { -+ RTW_INFO("+871x_drv - drv_close, bInSuspend=%d\n", pwrctl->bInSuspend); -+ return 0; -+ } -+ -+ rtw_scan_abort(padapter); /* stop scanning process before wifi is going to down */ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_wait_scan_req_empty(padapter, 200); -+#endif -+ -+ RTW_INFO("netdev_close, bips_processing=%d\n", pwrctl->bips_processing); -+ while (pwrctl->bips_processing == _TRUE) /* waiting for ips_processing done before call rtw_dev_unload() */ -+ rtw_msleep_os(1); -+ -+ rtw_dev_unload(padapter); -+ rtw_sdio_set_power(0); -+ -+#endif /* !CONFIG_PLATFORM_INTEL_BYT */ -+ -+ RTW_INFO("-871x_drv - drv_close, bup=%d\n", padapter->bup); -+ -+ return 0; -+ -+} -+ -+int pm_netdev_close(struct net_device *pnetdev, u8 bnormal) -+{ -+ int status = 0; -+ -+ status = netdev_close(pnetdev); -+ -+ return status; -+} -+ -+void rtw_ndev_destructor(struct net_device *ndev) -+{ -+ RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (ndev->ieee80211_ptr) -+ rtw_mfree((u8 *)ndev->ieee80211_ptr, sizeof(struct wireless_dev)); -+#endif -+ free_netdev(ndev); -+} -+ -+#ifdef CONFIG_ARP_KEEP_ALIVE -+struct route_info { -+ struct in_addr dst_addr; -+ struct in_addr src_addr; -+ struct in_addr gateway; -+ unsigned int dev_index; -+}; -+ -+static void parse_routes(struct nlmsghdr *nl_hdr, struct route_info *rt_info) -+{ -+ struct rtmsg *rt_msg; -+ struct rtattr *rt_attr; -+ int rt_len; -+ -+ rt_msg = (struct rtmsg *) NLMSG_DATA(nl_hdr); -+ if ((rt_msg->rtm_family != AF_INET) || (rt_msg->rtm_table != RT_TABLE_MAIN)) -+ return; -+ -+ rt_attr = (struct rtattr *) RTM_RTA(rt_msg); -+ rt_len = RTM_PAYLOAD(nl_hdr); -+ -+ for (; RTA_OK(rt_attr, rt_len); rt_attr = RTA_NEXT(rt_attr, rt_len)) { -+ switch (rt_attr->rta_type) { -+ case RTA_OIF: -+ rt_info->dev_index = *(int *) RTA_DATA(rt_attr); -+ break; -+ case RTA_GATEWAY: -+ rt_info->gateway.s_addr = *(u_int *) RTA_DATA(rt_attr); -+ break; -+ case RTA_PREFSRC: -+ rt_info->src_addr.s_addr = *(u_int *) RTA_DATA(rt_attr); -+ break; -+ case RTA_DST: -+ rt_info->dst_addr.s_addr = *(u_int *) RTA_DATA(rt_attr); -+ break; -+ } -+ } -+} -+ -+static int route_dump(u32 *gw_addr , int *gw_index) -+{ -+ int err = 0; -+ struct socket *sock; -+ struct { -+ struct nlmsghdr nlh; -+ struct rtgenmsg g; -+ } req; -+ struct msghdr msg; -+ struct iovec iov; -+ struct sockaddr_nl nladdr; -+ mm_segment_t oldfs; -+ char *pg; -+ int size = 0; -+ -+ err = sock_create(AF_NETLINK, SOCK_DGRAM, NETLINK_ROUTE, &sock); -+ if (err) { -+ printk(": Could not create a datagram socket, error = %d\n", -ENXIO); -+ return err; -+ } -+ -+ memset(&nladdr, 0, sizeof(nladdr)); -+ nladdr.nl_family = AF_NETLINK; -+ -+ req.nlh.nlmsg_len = sizeof(req); -+ req.nlh.nlmsg_type = RTM_GETROUTE; -+ req.nlh.nlmsg_flags = NLM_F_ROOT | NLM_F_MATCH | NLM_F_REQUEST; -+ req.nlh.nlmsg_pid = 0; -+ req.g.rtgen_family = AF_INET; -+ -+ iov.iov_base = &req; -+ iov.iov_len = sizeof(req); -+ -+ msg.msg_name = &nladdr; -+ msg.msg_namelen = sizeof(nladdr); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ /* referece:sock_xmit in kernel code -+ * WRITE for sock_sendmsg, READ for sock_recvmsg -+ * third parameter for msg_iovlen -+ * last parameter for iov_len -+ */ -+ iov_iter_init(&msg.msg_iter, WRITE, &iov, 1, sizeof(req)); -+#else -+ msg.msg_iov = &iov; -+ msg.msg_iovlen = 1; -+#endif -+ msg.msg_control = NULL; -+ msg.msg_controllen = 0; -+ msg.msg_flags = MSG_DONTWAIT; -+ -+ oldfs = get_fs(); -+ set_fs(KERNEL_DS); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ err = sock_sendmsg(sock, &msg); -+#else -+ err = sock_sendmsg(sock, &msg, sizeof(req)); -+#endif -+ set_fs(oldfs); -+ -+ if (err < 0) -+ goto out_sock; -+ -+ pg = (char *) __get_free_page(GFP_KERNEL); -+ if (pg == NULL) { -+ err = -ENOMEM; -+ goto out_sock; -+ } -+ -+#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE) -+restart: -+#endif -+ -+ for (;;) { -+ struct nlmsghdr *h; -+ -+ iov.iov_base = pg; -+ iov.iov_len = PAGE_SIZE; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ iov_iter_init(&msg.msg_iter, READ, &iov, 1, PAGE_SIZE); -+#endif -+ -+ oldfs = get_fs(); -+ set_fs(KERNEL_DS); -+ err = sock_recvmsg(sock, &msg, PAGE_SIZE, MSG_DONTWAIT); -+ set_fs(oldfs); -+ -+ if (err < 0) -+ goto out_sock_pg; -+ -+ if (msg.msg_flags & MSG_TRUNC) { -+ err = -ENOBUFS; -+ goto out_sock_pg; -+ } -+ -+ h = (struct nlmsghdr *) pg; -+ -+ while (NLMSG_OK(h, err)) { -+ struct route_info rt_info; -+ if (h->nlmsg_type == NLMSG_DONE) { -+ err = 0; -+ goto done; -+ } -+ -+ if (h->nlmsg_type == NLMSG_ERROR) { -+ struct nlmsgerr *errm = (struct nlmsgerr *) NLMSG_DATA(h); -+ err = errm->error; -+ printk("NLMSG error: %d\n", errm->error); -+ goto done; -+ } -+ -+ if (h->nlmsg_type == RTM_GETROUTE) -+ printk("RTM_GETROUTE: NLMSG: %d\n", h->nlmsg_type); -+ if (h->nlmsg_type != RTM_NEWROUTE) { -+ printk("NLMSG: %d\n", h->nlmsg_type); -+ err = -EINVAL; -+ goto done; -+ } -+ -+ memset(&rt_info, 0, sizeof(struct route_info)); -+ parse_routes(h, &rt_info); -+ if (!rt_info.dst_addr.s_addr && rt_info.gateway.s_addr && rt_info.dev_index) { -+ *gw_addr = rt_info.gateway.s_addr; -+ *gw_index = rt_info.dev_index; -+ -+ } -+ h = NLMSG_NEXT(h, err); -+ } -+ -+ if (err) { -+ printk("!!!Remnant of size %d %d %d\n", err, h->nlmsg_len, h->nlmsg_type); -+ err = -EINVAL; -+ break; -+ } -+ } -+ -+done: -+#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE) -+ if (!err && req.g.rtgen_family == AF_INET) { -+ req.g.rtgen_family = AF_INET6; -+ -+ iov.iov_base = &req; -+ iov.iov_len = sizeof(req); -+ -+ msg.msg_name = &nladdr; -+ msg.msg_namelen = sizeof(nladdr); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ iov_iter_init(&msg.msg_iter, WRITE, &iov, 1, sizeof(req)); -+#else -+ msg.msg_iov = &iov; -+ msg.msg_iovlen = 1; -+#endif -+ msg.msg_control = NULL; -+ msg.msg_controllen = 0; -+ msg.msg_flags = MSG_DONTWAIT; -+ -+ oldfs = get_fs(); -+ set_fs(KERNEL_DS); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) -+ err = sock_sendmsg(sock, &msg); -+#else -+ err = sock_sendmsg(sock, &msg, sizeof(req)); -+#endif -+ set_fs(oldfs); -+ -+ if (err > 0) -+ goto restart; -+ } -+#endif -+ -+out_sock_pg: -+ free_page((unsigned long) pg); -+ -+out_sock: -+ sock_release(sock); -+ return err; -+} -+ -+static int arp_query(unsigned char *haddr, u32 paddr, -+ struct net_device *dev) -+{ -+ struct neighbour *neighbor_entry; -+ int ret = 0; -+ -+ neighbor_entry = neigh_lookup(&arp_tbl, &paddr, dev); -+ -+ if (neighbor_entry != NULL) { -+ neighbor_entry->used = jiffies; -+ if (neighbor_entry->nud_state & NUD_VALID) { -+ _rtw_memcpy(haddr, neighbor_entry->ha, dev->addr_len); -+ ret = 1; -+ } -+ neigh_release(neighbor_entry); -+ } -+ return ret; -+} -+ -+static int get_defaultgw(u32 *ip_addr , char mac[]) -+{ -+ int gw_index = 0; /* oif device index */ -+ struct net_device *gw_dev = NULL; /* oif device */ -+ -+ route_dump(ip_addr, &gw_index); -+ -+ if (!(*ip_addr) || !gw_index) { -+ /* RTW_INFO("No default GW\n"); */ -+ return -1; -+ } -+ -+ gw_dev = dev_get_by_index(&init_net, gw_index); -+ -+ if (gw_dev == NULL) { -+ /* RTW_INFO("get Oif Device Fail\n"); */ -+ return -1; -+ } -+ -+ if (!arp_query(mac, *ip_addr, gw_dev)) { -+ /* RTW_INFO( "arp query failed\n"); */ -+ dev_put(gw_dev); -+ return -1; -+ -+ } -+ dev_put(gw_dev); -+ -+ return 0; -+} -+ -+int rtw_gw_addr_query(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ u32 gw_addr = 0; /* default gw address */ -+ unsigned char gw_mac[32] = {0}; /* default gw mac */ -+ int i; -+ int res; -+ -+ res = get_defaultgw(&gw_addr, gw_mac); -+ if (!res) { -+ pmlmepriv->gw_ip[0] = gw_addr & 0xff; -+ pmlmepriv->gw_ip[1] = (gw_addr & 0xff00) >> 8; -+ pmlmepriv->gw_ip[2] = (gw_addr & 0xff0000) >> 16; -+ pmlmepriv->gw_ip[3] = (gw_addr & 0xff000000) >> 24; -+ _rtw_memcpy(pmlmepriv->gw_mac_addr, gw_mac, 6); -+ RTW_INFO("%s Gateway Mac:\t" MAC_FMT "\n", __FUNCTION__, MAC_ARG(pmlmepriv->gw_mac_addr)); -+ RTW_INFO("%s Gateway IP:\t" IP_FMT "\n", __FUNCTION__, IP_ARG(pmlmepriv->gw_ip)); -+ } else -+ RTW_INFO("Get Gateway IP/MAC fail!\n"); -+ -+ return res; -+} -+#endif -+ -+void rtw_dev_unload(PADAPTER padapter) -+{ -+ struct net_device *pnetdev = (struct net_device *)padapter->pnetdev; -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *pobjpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &pobjpriv->drv_dbg; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 cnt = 0; -+ -+ -+ if (padapter->bup == _TRUE) { -+ RTW_INFO("===> %s\n", __FUNCTION__); -+ -+ rtw_set_drv_stopped(padapter); -+#ifdef CONFIG_XMIT_ACK -+ if (padapter->xmitpriv.ack_tx) -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP); -+#endif -+ -+ rtw_intf_stop(padapter); -+ -+ -+ if (!pwrctl->bInternalAutoSuspend) -+ rtw_stop_drv_threads(padapter); -+ -+ while (ATOMIC_READ(&(pcmdpriv->cmdthd_running)) == _TRUE) { -+ if (cnt > 5) { -+ RTW_INFO("stop cmdthd timeout\n"); -+ break; -+ } else { -+ cnt++; -+ RTW_INFO("cmdthd is running(%d)\n", cnt); -+ rtw_msleep_os(10); -+ } -+ } -+ -+ -+ /* check the status of IPS */ -+ if (rtw_hal_check_ips_status(padapter) == _TRUE || pwrctl->rf_pwrstate == rf_off) { /* check HW status and SW state */ -+ RTW_PRINT("%s: driver in IPS-FWLPS\n", __func__); -+ pdbgpriv->dbg_dev_unload_inIPS_cnt++; -+ } else -+ RTW_PRINT("%s: driver not in IPS\n", __func__); -+ -+ if (!rtw_is_surprise_removed(padapter)) { -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_IpsNotify(padapter, pwrctl->ips_mode_req); -+#endif -+#ifdef CONFIG_WOWLAN -+ if (pwrctl->bSupportRemoteWakeup == _TRUE && -+ pwrctl->wowlan_mode == _TRUE) -+ RTW_PRINT("%s bSupportRemoteWakeup==_TRUE do not run rtw_hal_deinit()\n", __FUNCTION__); -+ else -+#endif -+ { -+ /* amy modify 20120221 for power seq is different between driver open and ips */ -+ rtw_hal_deinit(padapter); -+ } -+ rtw_set_surprise_removed(padapter); -+ } -+ -+ padapter->bup = _FALSE; -+ -+ RTW_INFO("<=== %s\n", __FUNCTION__); -+ } else { -+ RTW_INFO("%s: bup==_FALSE\n", __FUNCTION__); -+ } -+ rtw_cancel_all_timer(padapter); -+} -+ -+int rtw_suspend_free_assoc_resource(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct net_device *pnetdev = padapter->pnetdev; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif /* CONFIG_P2P */ -+ -+ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED) -+#ifdef CONFIG_P2P -+ && rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) -+#endif /* CONFIG_P2P */ -+ ) { -+ RTW_INFO("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n", __FUNCTION__, -+ pmlmepriv->cur_network.network.Ssid.Ssid, -+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress), -+ pmlmepriv->cur_network.network.Ssid.SsidLength, -+ pmlmepriv->assoc_ssid.SsidLength); -+ rtw_set_to_roam(padapter, 1); -+ } -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, _FW_LINKED)) { -+ rtw_disassoc_cmd(padapter, 0, _FALSE); -+ /* s2-2. indicate disconnect to os */ -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ } -+#ifdef CONFIG_AP_MODE -+ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ rtw_sta_flush(padapter, _TRUE); -+#endif -+ -+ /* s2-3. */ -+ rtw_free_assoc_resources(padapter, 1); -+ -+ /* s2-4. */ -+#ifdef CONFIG_AUTOSUSPEND -+ if (is_primary_adapter(padapter) && (!adapter_to_pwrctl(padapter)->bInternalAutoSuspend)) -+#endif -+ rtw_free_network_queue(padapter, _TRUE); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { -+ RTW_PRINT("%s: fw_under_survey\n", __func__); -+ rtw_indicate_scan_done(padapter, 1); -+ clr_fwstate(pmlmepriv, _FW_UNDER_SURVEY); -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { -+ RTW_PRINT("%s: fw_under_linking\n", __FUNCTION__); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ } -+ -+ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_WOWLAN -+int rtw_suspend_wow(_adapter *padapter) -+{ -+ u8 ch, bw, offset; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct wowlan_ioctl_param poidparam; -+ int i; -+ _adapter *iface = NULL; -+ u8 ps_mode; -+ int ret = _SUCCESS; -+ -+ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ -+ RTW_INFO("wowlan_mode: %d\n", pwrpriv->wowlan_mode); -+ RTW_INFO("wowlan_pno_enable: %d\n", pwrpriv->wowlan_pno_enable); -+#ifdef CONFIG_P2P_WOWLAN -+ RTW_INFO("wowlan_p2p_enable: %d\n", pwrpriv->wowlan_p2p_enable); -+#endif -+ -+ if (pwrpriv->wowlan_mode == _TRUE) { -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT); -+#endif -+ -+ if (pnetdev) -+ rtw_netif_stop_queue(pnetdev); -+ rtw_mi_buddy_netif_stop_queue(padapter, _TRUE); -+ -+ /* 0. Power off LED */ -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ /* 1. stop thread */ -+ rtw_set_drv_stopped(padapter); /*for stop thread*/ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && (iface->bup == _TRUE)) -+ rtw_stop_drv_threads(iface); -+ } -+ rtw_clr_drv_stopped(padapter); /*for 32k command*/ -+ -+ /* #ifdef CONFIG_LPS */ -+ /* rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN"); */ -+ /* #endif */ -+ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ /* 2. disable interrupt */ -+ rtw_mi_intf_stop(padapter); -+ -+ /* 2.1 clean interupt */ -+ rtw_hal_clear_interrupt(padapter); -+#endif /* CONFIG_SDIO_HCI */ -+ -+ /* 2.2 free irq */ -+ /* sdio_free_irq(adapter_to_dvobj(padapter)); */ -+#ifndef CONFIG_RTW_SDIO_KEEP_IRQ -+ if (padapter->intf_free_irq) -+ padapter->intf_free_irq(adapter_to_dvobj(padapter)); -+#endif -+ -+#ifdef CONFIG_RUNTIME_PORT_SWITCH -+ if (rtw_port_switch_chk(padapter)) { -+ RTW_INFO(" ### PORT SWITCH ###\n"); -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+ } -+#endif -+ -+ poidparam.subcode = WOWLAN_ENABLE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED)) { -+ RTW_INFO("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n", __FUNCTION__, -+ pmlmepriv->cur_network.network.Ssid.Ssid, -+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress), -+ pmlmepriv->cur_network.network.Ssid.SsidLength, -+ pmlmepriv->assoc_ssid.SsidLength); -+ -+ rtw_set_to_roam(padapter, 0); -+ } -+ } -+ -+ RTW_PRINT("%s: wowmode suspending\n", __func__); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { -+ RTW_PRINT("%s: fw_under_survey\n", __func__); -+ rtw_indicate_scan_done(padapter, 1); -+ clr_fwstate(pmlmepriv, _FW_UNDER_SURVEY); -+ } -+ -+#if 1 -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ ch = rtw_mi_get_union_chan(padapter); -+ bw = rtw_mi_get_union_bw(padapter); -+ offset = rtw_mi_get_union_offset(padapter); -+ RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ } -+#else -+ if (rtw_mi_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { -+ RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", -+ FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ rtw_mi_update_union_chan_inf(padapter, ch, offset, bw); -+ } -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_mi_buddy_suspend_free_assoc_resource(padapter); -+#endif -+ -+ if (pwrpriv->wowlan_pno_enable) { -+ RTW_PRINT("%s: pno: %d\n", __func__, -+ pwrpriv->wowlan_pno_enable); -+#ifdef CONFIG_FWLPS_IN_IPS -+ rtw_set_fw_in_ips_mode(padapter, _TRUE); -+#endif -+ } -+#ifdef CONFIG_LPS -+ else -+ rtw_set_ps_mode(padapter, PS_MODE_MAX, 0, 0, "WOWLAN"); -+#endif /* #ifdef CONFIG_LPS */ -+ -+ } else -+ RTW_PRINT("%s: ### ERROR ### wowlan_mode=%d\n", __FUNCTION__, pwrpriv->wowlan_mode); -+ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+#endif /* #ifdef CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_AP_WOWLAN -+int rtw_suspend_ap_wow(_adapter *padapter) -+{ -+ u8 ch, bw, offset; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ struct wowlan_ioctl_param poidparam; -+ int i; -+ _adapter *iface = NULL; -+ u8 ps_mode; -+ int ret = _SUCCESS; -+ -+ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ pwrpriv->wowlan_ap_mode = _TRUE; -+ -+ RTW_INFO("wowlan_ap_mode: %d\n", pwrpriv->wowlan_ap_mode); -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT); -+#endif -+ -+ rtw_mi_netif_stop_queue(padapter, _FALSE); -+ -+ /* 0. Power off LED */ -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ /* 1. stop thread */ -+ rtw_set_drv_stopped(padapter); /*for stop thread*/ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && (iface->bup == _TRUE)) -+ rtw_stop_drv_threads(iface); -+ } -+ rtw_clr_drv_stopped(padapter); /*for 32k command*/ -+ -+#ifdef CONFIG_SDIO_HCI -+ /* 2. disable interrupt*/ -+ rtw_mi_intf_stop(padapter); -+ -+ /* 2.1 clean interupt */ -+ rtw_hal_clear_interrupt(padapter); -+#endif /* CONFIG_SDIO_HCI */ -+ -+ /* 2.2 free irq */ -+ if (padapter->intf_free_irq) -+ padapter->intf_free_irq(adapter_to_dvobj(padapter)); -+ -+#ifdef CONFIG_RUNTIME_PORT_SWITCH -+ if (rtw_port_switch_chk(padapter)) { -+ RTW_INFO(" ### PORT SWITCH ###\n"); -+ rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, NULL); -+ } -+#endif -+ -+ poidparam.subcode = WOWLAN_AP_ENABLE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); -+ -+ RTW_PRINT("%s: wowmode suspending\n", __func__); -+#if 1 -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ ch = rtw_mi_get_union_chan(padapter); -+ bw = rtw_mi_get_union_bw(padapter); -+ offset = rtw_mi_get_union_offset(padapter); -+ RTW_INFO("back to linked/linking union - ch:%u, bw:%u, offset:%u\n", ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ } -+#else -+ if (rtw_mi_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { -+ RTW_INFO("back to linked/linking union - ch:%u, bw:%u, offset:%u\n", ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ rtw_mi_update_union_chan_inf(padapter, ch, offset, bw); -+ } -+#endif -+ -+ /*FOR ONE AP - TODO :Multi-AP*/ -+ { -+ int i; -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE | _FW_LINKED)) -+ rtw_mi_buddy_suspend_free_assoc_resource(iface); -+ } -+ } -+ -+ } -+ -+#ifdef CONFIG_LPS -+ rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, 0, "AP-WOWLAN"); -+#endif -+ -+ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+#endif /* #ifdef CONFIG_AP_WOWLAN */ -+ -+ -+int rtw_suspend_normal(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ int ret = _SUCCESS; -+#ifdef CONFIG_RTW_SDIO_KEEP_IRQ -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ struct sdio_func *func = pdvobj->intf_data.func; -+#endif -+ -+ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND); -+#endif -+ -+ rtw_mi_netif_stop_queue(padapter, _TRUE); -+ -+ rtw_mi_suspend_free_assoc_resource(padapter); -+ -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ -+#if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) -+ if ((rtw_hal_check_ips_status(padapter) == _TRUE) -+ || (adapter_to_pwrctl(padapter)->rf_pwrstate == rf_off)) -+ RTW_PRINT("%s: ### ERROR #### driver in IPS ####ERROR###!!!\n", __FUNCTION__); -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_mi_buddy_dev_unload(padapter); -+#endif -+ rtw_dev_unload(padapter); -+ -+ /* sdio_deinit(adapter_to_dvobj(padapter)); */ -+#ifdef CONFIG_RTW_SDIO_KEEP_IRQ -+ if (func) { -+ int err; -+ -+ sdio_claim_host(func); -+ err = sdio_disable_func(func); -+ if (err) { -+ pdvobj->drv_dbg.dbg_sdio_deinit_error_cnt++; -+ RTW_INFO("%s: sdio_disable_func(%d)\n", __func__, err); -+ } -+ -+ sdio_release_host(func); -+ } -+#else -+ if (padapter->intf_deinit) -+ padapter->intf_deinit(adapter_to_dvobj(padapter)); -+#endif -+ -+ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+ -+int rtw_suspend_common(_adapter *padapter) -+{ -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(psdpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ int ret = 0; -+ u32 start_time = rtw_get_current_time(); -+ -+ RTW_PRINT(" suspend start\n"); -+ RTW_INFO("==> %s (%s:%d)\n", __FUNCTION__, current->comm, current->pid); -+ -+ pdbgpriv->dbg_suspend_cnt++; -+ -+ pwrpriv->bInSuspend = _TRUE; -+ -+ while (pwrpriv->bips_processing == _TRUE) -+ rtw_msleep_os(1); -+ -+#ifdef CONFIG_IOL_READ_EFUSE_MAP -+ if (!padapter->bup) { -+ u8 bMacPwrCtrlOn = _FALSE; -+ rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); -+ if (bMacPwrCtrlOn) -+ rtw_hal_power_off(padapter); -+ } -+#endif -+ -+ if ((!padapter->bup) || RTW_CANNOT_RUN(padapter)) { -+ RTW_INFO("%s bup=%d bDriverStopped=%s bSurpriseRemoved = %s\n", __func__ -+ , padapter->bup -+ , rtw_is_drv_stopped(padapter) ? "True" : "False" -+ , rtw_is_surprise_removed(padapter) ? "True" : "False"); -+ pdbgpriv->dbg_suspend_error_cnt++; -+ goto exit; -+ } -+ rtw_ps_deny(padapter, PS_DENY_SUSPEND); -+ -+ rtw_mi_cancel_all_timer(padapter); -+ LeaveAllPowerSaveModeDirect(padapter); -+ rtw_stop_cmd_thread(padapter); -+ -+ rtw_ps_deny_cancel(padapter, PS_DENY_SUSPEND); -+ -+ if (rtw_mi_check_status(padapter, MI_AP_MODE) == _FALSE) { -+#ifdef CONFIG_WOWLAN -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) -+ pwrpriv->wowlan_mode = _TRUE; -+ else if (pwrpriv->wowlan_pno_enable == _TRUE) -+ pwrpriv->wowlan_mode |= pwrpriv->wowlan_pno_enable; -+ -+#ifdef CONFIG_P2P_WOWLAN -+ if (!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE) || P2P_ROLE_DISABLE != padapter->wdinfo.role) -+ pwrpriv->wowlan_p2p_mode = _TRUE; -+ if (_TRUE == pwrpriv->wowlan_p2p_mode) -+ pwrpriv->wowlan_mode |= pwrpriv->wowlan_p2p_mode; -+#endif /* CONFIG_P2P_WOWLAN */ -+ -+ if (pwrpriv->wowlan_mode == _TRUE) -+ rtw_suspend_wow(padapter); -+ else -+#endif /* CONFIG_WOWLAN */ -+ rtw_suspend_normal(padapter); -+ } else if (rtw_mi_check_status(padapter, MI_AP_MODE)) { -+#ifdef CONFIG_AP_WOWLAN -+ rtw_suspend_ap_wow(padapter); -+#else -+ rtw_suspend_normal(padapter); -+#endif /*CONFIG_AP_WOWLAN*/ -+ } -+ -+ -+ RTW_PRINT("rtw suspend success in %d ms\n", -+ rtw_get_passing_time_ms(start_time)); -+ -+exit: -+ RTW_INFO("<=== %s return %d.............. in %dms\n", __FUNCTION__ -+ , ret, rtw_get_passing_time_ms(start_time)); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_WOWLAN -+int rtw_resume_process_wow(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct wowlan_ioctl_param poidparam; -+ struct sta_info *psta = NULL; -+ int ret = _SUCCESS; -+ -+ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (padapter) { -+ pnetdev = padapter->pnetdev; -+ pwrpriv = adapter_to_pwrctl(padapter); -+ } else { -+ pdbgpriv->dbg_resume_error_cnt++; -+ ret = -1; -+ goto exit; -+ } -+ -+ if (RTW_CANNOT_RUN(padapter)) { -+ RTW_INFO("%s pdapter %p bDriverStopped %s bSurpriseRemoved %s\n" -+ , __func__, padapter -+ , rtw_is_drv_stopped(padapter) ? "True" : "False" -+ , rtw_is_surprise_removed(padapter) ? "True" : "False"); -+ goto exit; -+ } -+ -+ pwrpriv->wowlan_in_resume = _TRUE; -+#ifdef CONFIG_PNO_SUPPORT -+#ifdef CONFIG_FWLPS_IN_IPS -+ if (pwrpriv->wowlan_pno_enable) -+ rtw_set_fw_in_ips_mode(padapter, _FALSE); -+#endif /* CONFIG_FWLPS_IN_IPS */ -+#endif/* CONFIG_PNO_SUPPORT */ -+ -+ if (pwrpriv->wowlan_mode == _TRUE) { -+#ifdef CONFIG_LPS -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN"); -+#endif /* CONFIG_LPS */ -+ -+ pwrpriv->bFwCurrentInPSMode = _FALSE; -+ -+#ifdef CONFIG_SDIO_HCI -+ rtw_mi_intf_stop(padapter); -+ rtw_hal_clear_interrupt(padapter); -+#endif /* CONFIG_SDIO_HCI */ -+ -+#ifndef CONFIG_RTW_SDIO_KEEP_IRQ -+ /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { */ -+ if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) { -+ ret = -1; -+ goto exit; -+ } -+#endif -+ -+ /* Disable WOW, set H2C command */ -+ poidparam.subcode = WOWLAN_DISABLE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_mi_buddy_reset_drv_sw(padapter); -+#endif -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); -+ if (psta) -+ set_sta_rate(padapter, psta); -+ -+ -+ rtw_clr_drv_stopped(padapter); -+ RTW_INFO("%s: wowmode resuming, DriverStopped:%s\n", __func__, rtw_is_drv_stopped(padapter) ? "True" : "False"); -+ -+ rtw_mi_start_drv_threads(padapter); -+ -+ rtw_mi_intf_start(padapter); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_mi_buddy_netif_carrier_on(padapter); -+#endif -+ -+ /* start netif queue */ -+ if (pnetdev) -+ rtw_netif_wake_queue(pnetdev); -+ } else -+ -+ RTW_PRINT("%s: ### ERROR ### wowlan_mode=%d\n", __FUNCTION__, pwrpriv->wowlan_mode); -+ -+ if (padapter->pid[1] != 0) { -+ RTW_INFO("pid[1]:%d\n", padapter->pid[1]); -+ rtw_signal_process(padapter->pid[1], SIGUSR2); -+ } -+ -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { -+ if (pwrpriv->wowlan_wake_reason == FW_DECISION_DISCONNECT || -+ pwrpriv->wowlan_wake_reason == RX_DISASSOC|| -+ pwrpriv->wowlan_wake_reason == RX_DEAUTH) { -+ -+ RTW_INFO("%s: disconnect reason: %02x\n", __func__, -+ pwrpriv->wowlan_wake_reason); -+ rtw_indicate_disconnect(padapter, 0, _FALSE); -+ -+ rtw_sta_media_status_rpt(padapter, -+ rtw_get_stainfo(&padapter->stapriv, -+ get_bssid(&padapter->mlmepriv)), 0); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+ } else { -+ RTW_INFO("%s: do roaming\n", __func__); -+ rtw_roaming(padapter, NULL); -+ } -+ } -+ -+ if (pwrpriv->wowlan_wake_reason == FW_DECISION_DISCONNECT) -+ rtw_lock_ext_suspend_timeout(2000); -+ -+ if (pwrpriv->wowlan_wake_reason == RX_GTK || -+ pwrpriv->wowlan_wake_reason == RX_DISASSOC|| -+ pwrpriv->wowlan_wake_reason == RX_DEAUTH) -+ rtw_lock_ext_suspend_timeout(8000); -+ -+ if (pwrpriv->wowlan_wake_reason == RX_PNO) { -+ #ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_disconnected(padapter->rtw_wdev, 0, NULL, 0, 1, GFP_ATOMIC); -+ #endif -+ rtw_lock_ext_suspend_timeout(10000); -+ } -+ -+ if (pwrpriv->wowlan_mode == _TRUE) { -+ pwrpriv->bips_processing = _FALSE; -+ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); -+#ifndef CONFIG_IPS_CHECK_IN_WD -+ rtw_set_pwr_state_check_timer(pwrpriv); -+#endif -+ } else -+ RTW_PRINT("do not reset timer\n"); -+ -+ pwrpriv->wowlan_mode = _FALSE; -+ -+ /* Power On LED */ -+#ifdef CONFIG_SW_LED -+ -+ if (pwrpriv->wowlan_wake_reason == RX_DISASSOC|| -+ pwrpriv->wowlan_wake_reason == RX_DEAUTH|| -+ pwrpriv->wowlan_wake_reason == FW_DECISION_DISCONNECT) -+ rtw_led_control(padapter, LED_CTL_NO_LINK); -+ else -+ rtw_led_control(padapter, LED_CTL_LINK); -+#endif -+ /* clean driver side wake up reason. */ -+ pwrpriv->wowlan_last_wake_reason = pwrpriv->wowlan_wake_reason; -+ pwrpriv->wowlan_wake_reason = 0; -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_RESUME); -+#endif /* CONFIG_BT_COEXIST */ -+ -+exit: -+ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+#endif /* #ifdef CONFIG_WOWLAN */ -+ -+#ifdef CONFIG_AP_WOWLAN -+int rtw_resume_process_ap_wow(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct dvobj_priv *psdpriv = padapter->dvobj; -+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; -+ struct wowlan_ioctl_param poidparam; -+ struct sta_info *psta = NULL; -+ int ret = _SUCCESS; -+ u8 ch, bw, offset; -+ -+ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (padapter) { -+ pnetdev = padapter->pnetdev; -+ pwrpriv = adapter_to_pwrctl(padapter); -+ } else { -+ pdbgpriv->dbg_resume_error_cnt++; -+ ret = -1; -+ goto exit; -+ } -+ -+ -+#ifdef CONFIG_LPS -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "AP-WOWLAN"); -+#endif /* CONFIG_LPS */ -+ -+ pwrpriv->bFwCurrentInPSMode = _FALSE; -+ -+ rtw_hal_disable_interrupt(padapter); -+ -+ rtw_hal_clear_interrupt(padapter); -+ -+ /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { */ -+ if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) { -+ ret = -1; -+ goto exit; -+ } -+ -+ /* Disable WOW, set H2C command */ -+ poidparam.subcode = WOWLAN_AP_DISABLE; -+ rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); -+ pwrpriv->wowlan_ap_mode = _FALSE; -+ -+ rtw_clr_drv_stopped(padapter); -+ RTW_INFO("%s: wowmode resuming, DriverStopped:%s\n", __func__, rtw_is_drv_stopped(padapter) ? "True" : "False"); -+ -+ rtw_mi_start_drv_threads(padapter); -+ -+#if 1 -+ if (rtw_mi_check_status(padapter, MI_LINKED)) { -+ ch = rtw_mi_get_union_chan(padapter); -+ bw = rtw_mi_get_union_bw(padapter); -+ offset = rtw_mi_get_union_offset(padapter); -+ RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ } -+#else -+ if (rtw_mi_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { -+ RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", FUNC_ADPT_ARG(padapter), ch, bw, offset); -+ set_channel_bwmode(padapter, ch, offset, bw); -+ rtw_mi_update_union_chan_inf(padapter, ch, offset, bw); -+ } -+#endif -+ -+ /*FOR ONE AP - TODO :Multi-AP*/ -+ { -+ int i; -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE | _FW_LINKED)) -+ rtw_mi_buddy_reset_drv_sw(iface); -+ } -+ } -+ -+ } -+ rtw_mi_intf_start(padapter); -+ rtw_mi_netif_wake_queue(padapter); -+ -+ if (padapter->pid[1] != 0) { -+ RTW_INFO("pid[1]:%d\n", padapter->pid[1]); -+ rtw_signal_process(padapter->pid[1], SIGUSR2); -+ } -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+ /* rtw_unlock_suspend(); */ -+#endif /* CONFIG_RESUME_IN_WORKQUEUE */ -+ -+ if (pwrpriv->wowlan_wake_reason == AP_OFFLOAD_WAKEUP) -+ rtw_lock_ext_suspend_timeout(8000); -+ -+ pwrpriv->bips_processing = _FALSE; -+ _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); -+#ifndef CONFIG_IPS_CHECK_IN_WD -+ rtw_set_pwr_state_check_timer(pwrpriv); -+#endif -+ /* clean driver side wake up reason. */ -+ pwrpriv->wowlan_wake_reason = 0; -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_RESUME); -+#endif /* CONFIG_BT_COEXIST */ -+ -+ /* Power On LED */ -+#ifdef CONFIG_SW_LED -+ -+ rtw_led_control(padapter, LED_CTL_LINK); -+#endif -+exit: -+ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ return ret; -+} -+#endif /* #ifdef CONFIG_APWOWLAN */ -+ -+void rtw_mi_resume_process_normal(_adapter *padapter) -+{ -+ int i; -+ _adapter *iface; -+ struct mlme_priv *pmlmepriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ pmlmepriv = &iface->mlmepriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ -+ if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) -+ rtw_roaming(padapter, NULL); -+#ifdef CONFIG_AP_MODE -+ } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ rtw_ap_restore_network(padapter); -+#endif /* CONFIG_AP_MODE */ -+ } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) -+ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ else -+ RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); -+ } -+ } -+} -+ -+int rtw_resume_process_normal(_adapter *padapter) -+{ -+ struct net_device *pnetdev; -+ struct pwrctrl_priv *pwrpriv; -+ struct dvobj_priv *psdpriv; -+ struct debug_priv *pdbgpriv; -+ -+ int ret = _SUCCESS; -+ -+ if (!padapter) { -+ ret = -1; -+ goto exit; -+ } -+ -+ pnetdev = padapter->pnetdev; -+ pwrpriv = adapter_to_pwrctl(padapter); -+ psdpriv = padapter->dvobj; -+ pdbgpriv = &psdpriv->drv_dbg; -+ -+ RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); -+ /* interface init */ -+ /* if (sdio_init(adapter_to_dvobj(padapter)) != _SUCCESS) */ -+ if ((padapter->intf_init) && (padapter->intf_init(adapter_to_dvobj(padapter)) != _SUCCESS)) { -+ ret = -1; -+ goto exit; -+ } -+ rtw_hal_disable_interrupt(padapter); -+#ifndef CONFIG_RTW_SDIO_KEEP_IRQ -+ /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) */ -+ if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) { -+ ret = -1; -+ goto exit; -+ } -+#endif -+ -+ rtw_mi_reset_drv_sw(padapter); -+ -+ pwrpriv->bkeepfwalive = _FALSE; -+ -+ RTW_INFO("bkeepfwalive(%x)\n", pwrpriv->bkeepfwalive); -+ if (pm_netdev_open(pnetdev, _TRUE) != 0) { -+ ret = -1; -+ pdbgpriv->dbg_resume_error_cnt++; -+ goto exit; -+ } -+ -+ rtw_mi_netif_carrier_on(padapter); -+ -+ if (padapter->pid[1] != 0) { -+ RTW_INFO("pid[1]:%d\n", padapter->pid[1]); -+ rtw_signal_process(padapter->pid[1], SIGUSR2); -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_RESUME); -+#endif /* CONFIG_BT_COEXIST */ -+ -+ rtw_mi_resume_process_normal(padapter); -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+ /* rtw_unlock_suspend(); */ -+#endif /* CONFIG_RESUME_IN_WORKQUEUE */ -+ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); -+ -+exit: -+ return ret; -+} -+ -+int rtw_resume_common(_adapter *padapter) -+{ -+ int ret = 0; -+ u32 start_time = rtw_get_current_time(); -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ if (pwrpriv->bInSuspend == _FALSE) -+ return 0; -+ -+ RTW_PRINT("resume start\n"); -+ RTW_INFO("==> %s (%s:%d)\n", __FUNCTION__, current->comm, current->pid); -+ -+ if (rtw_mi_check_status(padapter, WIFI_AP_STATE) == _FALSE) { -+#ifdef CONFIG_WOWLAN -+ if (pwrpriv->wowlan_mode == _TRUE) -+ rtw_resume_process_wow(padapter); -+ else -+#endif -+ rtw_resume_process_normal(padapter); -+ -+ } else if (rtw_mi_check_status(padapter, WIFI_AP_STATE)) { -+#ifdef CONFIG_AP_WOWLAN -+ rtw_resume_process_ap_wow(padapter); -+#else -+ rtw_resume_process_normal(padapter); -+#endif /* CONFIG_AP_WOWLAN */ -+ } -+ -+ if (pwrpriv) { -+ pwrpriv->bInSuspend = _FALSE; -+#ifdef CONFIG_WOWLAN -+ pwrpriv->wowlan_in_resume = _FALSE; -+#endif -+ } -+ RTW_PRINT("%s:%d in %d ms\n", __FUNCTION__ , ret, -+ rtw_get_passing_time_ms(start_time)); -+ -+ -+ return ret; -+} -+ -+#ifdef CONFIG_GPIO_API -+u8 rtw_get_gpio(struct net_device *netdev, u8 gpio_num) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); -+ return rtw_hal_get_gpio(adapter, gpio_num); -+} -+EXPORT_SYMBOL(rtw_get_gpio); -+ -+int rtw_set_gpio_output_value(struct net_device *netdev, u8 gpio_num, bool isHigh) -+{ -+ u8 direction = 0; -+ u8 res = -1; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); -+ return rtw_hal_set_gpio_output_value(adapter, gpio_num, isHigh); -+} -+EXPORT_SYMBOL(rtw_set_gpio_output_value); -+ -+int rtw_config_gpio(struct net_device *netdev, u8 gpio_num, bool isOutput) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); -+ return rtw_hal_config_gpio(adapter, gpio_num, isOutput); -+} -+EXPORT_SYMBOL(rtw_config_gpio); -+int rtw_register_gpio_interrupt(struct net_device *netdev, int gpio_num, void(*callback)(u8 level)) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); -+ return rtw_hal_register_gpio_interrupt(adapter, gpio_num, callback); -+} -+EXPORT_SYMBOL(rtw_register_gpio_interrupt); -+ -+int rtw_disable_gpio_interrupt(struct net_device *netdev, int gpio_num) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); -+ return rtw_hal_disable_gpio_interrupt(adapter, gpio_num); -+} -+EXPORT_SYMBOL(rtw_disable_gpio_interrupt); -+ -+#endif /* #ifdef CONFIG_GPIO_API */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/pci_intf.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/pci_intf.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/pci_intf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/pci_intf.c 2018-02-11 21:44:27.176146528 +0200 -@@ -0,0 +1,1834 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _HCI_INTF_C_ -+ -+#include -+#include -+ -+#include -+ -+#ifndef CONFIG_PCI_HCI -+ -+ #error "CONFIG_PCI_HCI shall be on!\n" -+ -+#endif -+ -+ -+#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -+ -+ #error "Shall be Linux or Windows, but not both!\n" -+ -+#endif -+ -+#ifdef CONFIG_80211N_HT -+ extern int rtw_ht_enable; -+ extern int rtw_bw_mode; -+ extern int rtw_ampdu_enable;/* for enable tx_ampdu */ -+#endif -+ -+#ifdef CONFIG_GLOBAL_UI_PID -+int ui_pid[3] = {0, 0, 0}; -+#endif -+ -+extern int pm_netdev_open(struct net_device *pnetdev, u8 bnormal); -+int rtw_resume_process(_adapter *padapter); -+ -+#ifdef CONFIG_PM -+ static int rtw_pci_suspend(struct pci_dev *pdev, pm_message_t state); -+ static int rtw_pci_resume(struct pci_dev *pdev); -+#endif -+ -+static int rtw_drv_init(struct pci_dev *pdev, const struct pci_device_id *pdid); -+static void rtw_dev_remove(struct pci_dev *pdev); -+static void rtw_dev_shutdown(struct pci_dev *pdev); -+ -+static struct specific_device_id specific_device_id_tbl[] = { -+ {.idVendor = 0x0b05, .idProduct = 0x1791, .flags = SPEC_DEV_ID_DISABLE_HT}, -+ {.idVendor = 0x13D3, .idProduct = 0x3311, .flags = SPEC_DEV_ID_DISABLE_HT}, -+ {} -+}; -+ -+struct pci_device_id rtw_pci_id_tbl[] = { -+#ifdef CONFIG_RTL8188E -+ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0x8179), .driver_data = RTL8188E}, -+#endif -+#ifdef CONFIG_RTL8812A -+ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0x8812), .driver_data = RTL8812}, -+#endif -+#ifdef CONFIG_RTL8821A -+ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0x8821), .driver_data = RTL8821}, -+#endif -+#ifdef CONFIG_RTL8192E -+ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0x818B), .driver_data = RTL8192E}, -+#endif -+#ifdef CONFIG_RTL8723B -+ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0xb723), .driver_data = RTL8723B}, -+#endif -+#ifdef CONFIG_RTL8723D -+ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0xd723), .driver_data = RTL8723D}, -+#endif -+#ifdef CONFIG_RTL8814A -+ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0x8813), .driver_data = RTL8814A}, -+#endif -+#ifdef CONFIG_RTL8822B -+ {PCI_DEVICE(PCI_VENDER_ID_REALTEK, 0xB822), .driver_data = RTL8822B}, -+#endif -+ {}, -+}; -+ -+struct pci_drv_priv { -+ struct pci_driver rtw_pci_drv; -+ int drv_registered; -+}; -+ -+ -+static struct pci_drv_priv pci_drvpriv = { -+ .rtw_pci_drv.name = (char *)DRV_NAME, -+ .rtw_pci_drv.probe = rtw_drv_init, -+ .rtw_pci_drv.remove = rtw_dev_remove, -+ .rtw_pci_drv.shutdown = rtw_dev_shutdown, -+ .rtw_pci_drv.id_table = rtw_pci_id_tbl, -+#ifdef CONFIG_PM -+ .rtw_pci_drv.suspend = rtw_pci_suspend, -+ .rtw_pci_drv.resume = rtw_pci_resume, -+#endif -+}; -+ -+ -+MODULE_DEVICE_TABLE(pci, rtw_pci_id_tbl); -+ -+ -+static u16 pcibridge_vendors[PCI_BRIDGE_VENDOR_MAX] = { -+ INTEL_VENDOR_ID, -+ ATI_VENDOR_ID, -+ AMD_VENDOR_ID, -+ SIS_VENDOR_ID -+}; -+ -+#define PCI_PM_CAP_ID 0x01 /* The Capability ID for PME function */ -+void PlatformClearPciPMEStatus(PADAPTER Adapter) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ BOOLEAN PCIClkReq = _FALSE; -+ u8 CapId = 0xff; -+ u8 CapPointer = 0; -+ /* u16 CapHdr; */ -+ RT_PCI_CAPABILITIES_HEADER CapHdr; -+ u8 PMCSReg; -+ int result; -+ -+ /* Get the Capability pointer first, */ -+ /* the Capability Pointer is located at offset 0x34 from the Function Header */ -+ -+ result = pci_read_config_byte(pdev, 0x34, &CapPointer); -+ if (result != 0) -+ RTW_INFO("%s() pci_read_config_byte 0x34 Failed!\n", __FUNCTION__); -+ else { -+ RTW_INFO("PlatformClearPciPMEStatus(): PCI configration 0x34 = 0x%2x\n", CapPointer); -+ do { -+ /* end of pci capability */ -+ if (CapPointer == 0x00) { -+ CapId = 0xff; -+ break; -+ } -+ -+ /* result = pci_read_config_word(pdev, CapPointer, &CapHdr); */ -+ result = pci_read_config_byte(pdev, CapPointer, &CapHdr.CapabilityID); -+ if (result != 0) { -+ RTW_INFO("%s() pci_read_config_byte %x Failed!\n", __FUNCTION__, CapPointer); -+ CapId = 0xff; -+ break; -+ } -+ -+ result = pci_read_config_byte(pdev, CapPointer + 1, &CapHdr.Next); -+ if (result != 0) { -+ RTW_INFO("%s() pci_read_config_byte %x Failed!\n", __FUNCTION__, CapPointer); -+ CapId = 0xff; -+ break; -+ } -+ -+ /* CapId = CapHdr & 0xFF; */ -+ CapId = CapHdr.CapabilityID; -+ -+ RTW_INFO("PlatformClearPciPMEStatus(): in pci configration1, CapPointer%x = %x\n", CapPointer, CapId); -+ -+ if (CapId == PCI_PM_CAP_ID) -+ break; -+ else { -+ /* point to next Capability */ -+ /* CapPointer = (CapHdr >> 8) & 0xFF; */ -+ CapPointer = CapHdr.Next; -+ } -+ } while (_TRUE); -+ -+ if (CapId == PCI_PM_CAP_ID) { -+ /* Get the PM CSR (Control/Status Register), */ -+ /* The PME_Status is located at PM Capatibility offset 5, bit 7 */ -+ result = pci_read_config_byte(pdev, CapPointer + 5, &PMCSReg); -+ if (PMCSReg & BIT7) { -+ /* PME event occured, clear the PM_Status by write 1 */ -+ PMCSReg = PMCSReg | BIT7; -+ -+ pci_write_config_byte(pdev, CapPointer + 5, PMCSReg); -+ PCIClkReq = _TRUE; -+ /* Read it back to check */ -+ pci_read_config_byte(pdev, CapPointer + 5, &PMCSReg); -+ RTW_INFO("PlatformClearPciPMEStatus(): Clear PME status 0x%2x to 0x%2x\n", CapPointer + 5, PMCSReg); -+ } else -+ RTW_INFO("PlatformClearPciPMEStatus(): PME status(0x%2x) = 0x%2x\n", CapPointer + 5, PMCSReg); -+ } else -+ RTW_INFO("PlatformClearPciPMEStatus(): Cannot find PME Capability\n"); -+ } -+ -+ RTW_INFO("PME, value_offset = %x, PME EN = %x\n", CapPointer + 5, PCIClkReq); -+} -+ -+static u8 rtw_pci_platform_switch_device_pci_aspm(_adapter *padapter, u8 value) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); -+ BOOLEAN bResult = _FALSE; -+ int Result = 0; -+ int error; -+ -+ Result = pci_write_config_byte(pdvobjpriv->ppcidev, pcipriv->pciehdr_offset + 0x10, value); /* enable I/O space */ -+ RTW_INFO("PlatformSwitchDevicePciASPM(0x%x) = 0x%x\n", pcipriv->pciehdr_offset + 0x10, value); -+ if (Result != 0) { -+ RTW_INFO("PlatformSwitchDevicePciASPM() Failed!\n"); -+ bResult = _FALSE; -+ } else -+ bResult = _TRUE; -+ -+ return bResult; -+} -+ -+/* -+ * When we set 0x01 to enable clk request. Set 0x0 to disable clk req. -+ * */ -+static u8 rtw_pci_switch_clk_req(_adapter *padapter, u8 value) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ u8 buffer, bResult = _FALSE; -+ int error; -+ -+ buffer = value; -+ -+ if (!rtw_is_hw_init_completed(padapter)) -+ return bResult; -+ -+ /* the clock request is located at offset 0x81, suppose the PCIE Capability register is located at offset 0x70 */ -+ /* the correct code should be: search the PCIE capability register first and then the clock request is located offset 0x11 */ -+ error = pci_write_config_byte(pdvobjpriv->ppcidev, 0x81, buffer); -+ if (error != 0) -+ RTW_INFO("rtw_pci_switch_clk_req error (%d)\n", error); -+ else -+ bResult = _TRUE; -+ -+ return bResult; -+} -+ -+/*Disable RTL8192SE ASPM & Disable Pci Bridge ASPM*/ -+void rtw_pci_disable_aspm(_adapter *padapter) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(pdvobjpriv); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ struct pci_dev *bridge_pdev = pdev->bus->self; -+ struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); -+ u8 linkctrl_reg; -+ u8 pcibridge_linkctrlreg, aspmlevel = 0; -+ -+ -+ /* We shall check RF Off Level for ASPM function instead of registry settings, revised by Roger, 2013.03.29. */ -+ if (!(pwrpriv->reg_rfps_level & (RT_RF_LPS_LEVEL_ASPM | RT_RF_PS_LEVEL_ALWAYS_ASPM))) -+ return; -+ -+ if (!rtw_is_hw_init_completed(padapter)) -+ return; -+ -+ if (pcipriv->pcibridge_vendor == PCI_BRIDGE_VENDOR_UNKNOWN) { -+ return; -+ } -+ -+ linkctrl_reg = pcipriv->linkctrl_reg; -+ pcibridge_linkctrlreg = pcipriv->pcibridge_linkctrlreg; -+ -+ /* Set corresponding value. */ -+ aspmlevel |= BIT(0) | BIT(1); -+ linkctrl_reg &= ~aspmlevel; -+ pcibridge_linkctrlreg &= ~aspmlevel; -+ -+ /* */ -+ /* 09/08/21 MH From Sd1 suggestion. we need to adjust ASPM enable sequence */ -+ /* CLK_REQ ==> delay 50us ==> Device ==> Host ==> delay 50us */ -+ /* */ -+ -+ if (pwrpriv->reg_rfps_level & RT_RF_OFF_LEVL_CLK_REQ) { -+ RT_CLEAR_PS_LEVEL(pwrpriv, RT_RF_OFF_LEVL_CLK_REQ); -+ rtw_pci_switch_clk_req(padapter, 0x0); -+ } -+ -+ { -+ /*for promising device will in L0 state after an I/O.*/ -+ u8 tmp_u1b; -+ pci_read_config_byte(pdev, (pcipriv->pciehdr_offset + 0x10), &tmp_u1b); -+ } -+ -+ rtw_pci_platform_switch_device_pci_aspm(padapter, linkctrl_reg); -+ -+ rtw_udelay_os(50); -+ -+ /* When there exists anyone's BusNum, DevNum, and FuncNum that are set to 0xff, */ -+ /* we do not execute any action and return. Added by tynli. */ -+ if ((pcipriv->busnumber == 0xff && pcipriv->devnumber == 0xff && pcipriv->funcnumber == 0xff) || -+ (pcipriv->pcibridge_busnum == 0xff && pcipriv->pcibridge_devnum == 0xff && pcipriv->pcibridge_funcnum == 0xff)) { -+ /* Do Nothing!! */ -+ } else { -+ /* 4 */ /* Disable Pci Bridge ASPM */ -+ pci_write_config_byte(bridge_pdev, (pcipriv->pcibridge_pciehdr_offset + 0x10), pcibridge_linkctrlreg); -+ RTW_INFO("PlatformDisableASPM():PciBridge Write reg[%x] = %x\n", -+ (pcipriv->pcibridge_pciehdr_offset + 0x10), pcibridge_linkctrlreg); -+ rtw_udelay_os(50); -+ } -+ -+} -+ -+/*Enable RTL8192SE ASPM & Enable Pci Bridge ASPM for -+power saving We should follow the sequence to enable -+RTL8192SE first then enable Pci Bridge ASPM -+or the system will show bluescreen.*/ -+void rtw_pci_enable_aspm(_adapter *padapter) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(pdvobjpriv); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ struct pci_dev *bridge_pdev = pdev->bus->self; -+ struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); -+ u16 aspmlevel = 0; -+ u8 u_pcibridge_aspmsetting = 0; -+ u8 u_device_aspmsetting = 0; -+ u32 u_device_aspmsupportsetting = 0; -+ -+ -+ /* We shall check RF Off Level for ASPM function instead of registry settings, revised by Roger, 2013.03.29. */ -+ if (!(pwrpriv->reg_rfps_level & (RT_RF_LPS_LEVEL_ASPM | RT_RF_PS_LEVEL_ALWAYS_ASPM))) -+ return; -+ -+ /* When there exists anyone's BusNum, DevNum, and FuncNum that are set to 0xff, */ -+ /* we do not execute any action and return. Added by tynli. */ -+ if ((pcipriv->busnumber == 0xff && pcipriv->devnumber == 0xff && pcipriv->funcnumber == 0xff) || -+ (pcipriv->pcibridge_busnum == 0xff && pcipriv->pcibridge_devnum == 0xff && pcipriv->pcibridge_funcnum == 0xff)) { -+ RTW_INFO("rtw_pci_enable_aspm(): Fail to enable ASPM. Cannot find the Bus of PCI(Bridge).\n"); -+ return; -+ } -+ -+ /* Get Bridge ASPM Support -+ * not to enable bridge aspm if bridge does not support -+ * Added by sherry 20100803 */ -+ { -+ /* Get the Link Capability, it ls located at offset 0x0c from the PCIE Capability */ -+ pci_read_config_dword(bridge_pdev, (pcipriv->pcibridge_pciehdr_offset + 0x0C), &u_device_aspmsupportsetting); -+ -+ RTW_INFO("rtw_pci_enable_aspm(): Bridge ASPM support %x\n", u_device_aspmsupportsetting); -+ if (((u_device_aspmsupportsetting & BIT(11)) != BIT(11)) || ((u_device_aspmsupportsetting & BIT(10)) != BIT(10))) { -+ if (pdvobjpriv->const_devicepci_aspm_setting == 3) { -+ RTW_INFO("rtw_pci_enable_aspm(): Bridge not support L0S or L1\n"); -+ return; -+ } else if (pdvobjpriv->const_devicepci_aspm_setting == 2) { -+ if ((u_device_aspmsupportsetting & BIT(11)) != BIT(11)) { -+ RTW_INFO("rtw_pci_enable_aspm(): Bridge not support L1\n"); -+ return; -+ } -+ } else if (pdvobjpriv->const_devicepci_aspm_setting == 1) { -+ if ((u_device_aspmsupportsetting & BIT(10)) != BIT(10)) { -+ RTW_INFO("rtw_pci_enable_aspm(): Bridge not support L0s\n"); -+ return; -+ } -+ -+ } -+ } else -+ RTW_INFO("rtw_pci_enable_aspm(): Bridge support L0s and L1\n"); -+ } -+ -+ /* -+ * Skip following settings if ASPM has already enabled, added by Roger, 2013.03.15. -+ * */ -+ if ((pcipriv->pcibridge_linkctrlreg & (BIT0 | BIT1)) && -+ (pcipriv->linkctrl_reg & (BIT0 | BIT1))) { -+ /* BIT0: L0S, BIT1:L1 */ -+ -+ RTW_INFO("PlatformEnableASPM(): ASPM is already enabled, skip incoming settings!!\n"); -+ return; -+ } -+ -+ /* 4 Enable Pci Bridge ASPM */ -+ /* Write PCI bridge PCIE-capability Link Control Register */ -+ /* Justin: Can we change the ASPM Control register ? */ -+ /* The system BIOS should set this register with a correct value */ -+ /* If we change the force enable the ASPM L1/L0s, this may cause the system hang */ -+ u_pcibridge_aspmsetting = pcipriv->pcibridge_linkctrlreg; -+ u_pcibridge_aspmsetting |= pdvobjpriv->const_hostpci_aspm_setting; -+ -+ if (pcipriv->pcibridge_vendor == PCI_BRIDGE_VENDOR_INTEL || -+ pcipriv->pcibridge_vendor == PCI_BRIDGE_VENDOR_SIS) -+ u_pcibridge_aspmsetting &= ~BIT(0); /* for intel host 42 device 43 */ -+ -+ pci_write_config_byte(bridge_pdev, (pcipriv->pcibridge_pciehdr_offset + 0x10), u_pcibridge_aspmsetting); -+ RTW_INFO("PlatformEnableASPM():PciBridge Write reg[%x] = %x\n", -+ (pcipriv->pcibridge_pciehdr_offset + 0x10), -+ u_pcibridge_aspmsetting); -+ -+ rtw_udelay_os(50); -+ -+ /*Get ASPM level (with/without Clock Req)*/ -+ aspmlevel |= pdvobjpriv->const_devicepci_aspm_setting; -+ u_device_aspmsetting = pcipriv->linkctrl_reg; -+ u_device_aspmsetting |= aspmlevel; /* device 43 */ -+ -+ rtw_pci_platform_switch_device_pci_aspm(padapter, u_device_aspmsetting); -+ -+ if (pwrpriv->reg_rfps_level & RT_RF_OFF_LEVL_CLK_REQ) { -+ rtw_pci_switch_clk_req(padapter, (pwrpriv->reg_rfps_level & RT_RF_OFF_LEVL_CLK_REQ) ? 1 : 0); -+ RT_SET_PS_LEVEL(pwrpriv, RT_RF_OFF_LEVL_CLK_REQ); -+ } -+ -+ rtw_udelay_os(50); -+} -+ -+static u8 rtw_pci_get_amd_l1_patch(struct dvobj_priv *pdvobjpriv, struct pci_dev *pdev) -+{ -+ u8 status = _FALSE; -+ u8 offset_e0; -+ u32 offset_e4; -+ -+ pci_write_config_byte(pdev, 0xE0, 0xA0); -+ pci_read_config_byte(pdev, 0xE0, &offset_e0); -+ -+ if (offset_e0 == 0xA0) { -+ pci_read_config_dword(pdev, 0xE4, &offset_e4); -+ if (offset_e4 & BIT(23)) -+ status = _TRUE; -+ } -+ -+ return status; -+} -+ -+static s32 rtw_pci_get_linkcontrol_reg(struct pci_dev *pdev, u8 *LinkCtrlReg, u8 *HdrOffset) -+{ -+ u8 CapabilityPointer; -+ RT_PCI_CAPABILITIES_HEADER CapabilityHdr; -+ s32 status = _FAIL; -+ -+ /* get CapabilityOffset */ -+ pci_read_config_byte(pdev, 0x34, &CapabilityPointer); /* the capability pointer is located offset 0x34 */ -+ -+ /* Loop through the capabilities in search of the power management capability. */ -+ /* The list is NULL-terminated, so the last offset will always be zero. */ -+ -+ while (CapabilityPointer != 0) { -+ /* Read the header of the capability at this offset. If the retrieved capability is not */ -+ /* the power management capability that we are looking for, follow the link to the */ -+ /* next capability and continue looping. */ -+ -+ /* 4 get CapabilityHdr */ -+ /* pci_read_config_word(pdev, CapabilityPointer, (u16 *)&CapabilityHdr); */ -+ pci_read_config_byte(pdev, CapabilityPointer, (u8 *)&CapabilityHdr.CapabilityID); -+ pci_read_config_byte(pdev, CapabilityPointer + 1, (u8 *)&CapabilityHdr.Next); -+ -+ /* Found the PCI express capability */ -+ if (CapabilityHdr.CapabilityID == PCI_CAPABILITY_ID_PCI_EXPRESS) -+ break; -+ else { -+ /* This is some other capability. Keep looking for the PCI express capability. */ -+ CapabilityPointer = CapabilityHdr.Next; -+ } -+ } -+ -+ /* Get the Link Control Register, it located at offset 0x10 from the Capability Header */ -+ if (CapabilityHdr.CapabilityID == PCI_CAPABILITY_ID_PCI_EXPRESS) { -+ *HdrOffset = CapabilityPointer; -+ pci_read_config_byte(pdev, CapabilityPointer + 0x10, LinkCtrlReg); -+ -+ status = _SUCCESS; -+ } else { -+ /* We didn't find a PCIe capability. */ -+ RTW_INFO("GetPciLinkCtrlReg(): Cannot Find PCIe Capability\n"); -+ } -+ -+ return status; -+} -+ -+static s32 rtw_set_pci_cache_line_size(struct pci_dev *pdev, u8 CacheLineSizeToSet) -+{ -+ u8 ucPciCacheLineSize; -+ s32 Result; -+ -+ /* ucPciCacheLineSize = pPciConfig->CacheLineSize; */ -+ pci_read_config_byte(pdev, PCI_CACHE_LINE_SIZE, &ucPciCacheLineSize); -+ -+ if (ucPciCacheLineSize < 8 || ucPciCacheLineSize > 16) { -+ RTW_INFO("Driver Sets default Cache Line Size...\n"); -+ -+ ucPciCacheLineSize = CacheLineSizeToSet; -+ -+ Result = pci_write_config_byte(pdev, PCI_CACHE_LINE_SIZE, ucPciCacheLineSize); -+ -+ if (Result != 0) { -+ RTW_INFO("pci_write_config_byte (CacheLineSize) Result=%d\n", Result); -+ goto _SET_CACHELINE_SIZE_FAIL; -+ } -+ -+ Result = pci_read_config_byte(pdev, PCI_CACHE_LINE_SIZE, &ucPciCacheLineSize); -+ if (Result != 0) { -+ RTW_INFO("pci_read_config_byte (PciCacheLineSize) Result=%d\n", Result); -+ goto _SET_CACHELINE_SIZE_FAIL; -+ } -+ -+ if ((ucPciCacheLineSize != CacheLineSizeToSet)) { -+ RTW_INFO("Failed to set Cache Line Size to 0x%x! ucPciCacheLineSize=%x\n", CacheLineSizeToSet, ucPciCacheLineSize); -+ goto _SET_CACHELINE_SIZE_FAIL; -+ } -+ } -+ -+ return _SUCCESS; -+ -+_SET_CACHELINE_SIZE_FAIL: -+ -+ return _FAIL; -+} -+ -+ -+#define PCI_CMD_ENABLE_BUS_MASTER BIT(2) -+#define PCI_CMD_DISABLE_INTERRUPT BIT(10) -+#define CMD_BUS_MASTER BIT(2) -+ -+static s32 rtw_pci_parse_configuration(struct pci_dev *pdev, struct dvobj_priv *pdvobjpriv) -+{ -+ struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); -+ /* PPCI_COMMON_CONFIG pPciConfig = (PPCI_COMMON_CONFIG) pucBuffer; */ -+ /* u16 usPciCommand = pPciConfig->Command; */ -+ u16 usPciCommand = 0; -+ int Result, ret; -+ u8 CapabilityOffset; -+ RT_PCI_CAPABILITIES_HEADER CapabilityHdr; -+ u8 PCIeCap; -+ u8 LinkCtrlReg; -+ u8 ClkReqReg; -+ -+ /* RTW_INFO("%s==>\n", __FUNCTION__); */ -+ -+ pci_read_config_word(pdev, PCI_COMMAND, &usPciCommand); -+ -+ do { -+ /* 3 Enable bus matering if it isn't enabled by the BIOS */ -+ if (!(usPciCommand & PCI_CMD_ENABLE_BUS_MASTER)) { -+ RTW_INFO("Bus master is not enabled by BIOS! usPciCommand=%x\n", usPciCommand); -+ -+ usPciCommand |= CMD_BUS_MASTER; -+ -+ Result = pci_write_config_word(pdev, PCI_COMMAND, usPciCommand); -+ if (Result != 0) { -+ RTW_INFO("pci_write_config_word (Command) Result=%d\n", Result); -+ ret = _FAIL; -+ break; -+ } -+ -+ Result = pci_read_config_word(pdev, PCI_COMMAND, &usPciCommand); -+ if (Result != 0) { -+ RTW_INFO("pci_read_config_word (Command) Result=%d\n", Result); -+ ret = _FAIL; -+ break; -+ } -+ -+ if (!(usPciCommand & PCI_CMD_ENABLE_BUS_MASTER)) { -+ RTW_INFO("Failed to enable bus master! usPciCommand=%x\n", usPciCommand); -+ ret = _FAIL; -+ break; -+ } -+ } -+ RTW_INFO("Bus master is enabled. usPciCommand=%x\n", usPciCommand); -+ -+ /* 3 Enable interrupt */ -+ if ((usPciCommand & PCI_CMD_DISABLE_INTERRUPT)) { -+ RTW_INFO("INTDIS==1 usPciCommand=%x\n", usPciCommand); -+ -+ usPciCommand &= (~PCI_CMD_DISABLE_INTERRUPT); -+ -+ Result = pci_write_config_word(pdev, PCI_COMMAND, usPciCommand); -+ if (Result != 0) { -+ RTW_INFO("pci_write_config_word (Command) Result=%d\n", Result); -+ ret = _FAIL; -+ break; -+ } -+ -+ Result = pci_read_config_word(pdev, PCI_COMMAND, &usPciCommand); -+ if (Result != 0) { -+ RTW_INFO("pci_read_config_word (Command) Result=%d\n", Result); -+ ret = _FAIL; -+ break; -+ } -+ -+ if ((usPciCommand & PCI_CMD_DISABLE_INTERRUPT)) { -+ RTW_INFO("Failed to set INTDIS to 0! usPciCommand=%x\n", usPciCommand); -+ ret = _FAIL; -+ break; -+ } -+ } -+ -+ /* */ -+ /* Description: Find PCI express capability offset. Porting from 818xB by tynli 2008.12.19 */ -+ /* */ -+ /* ------------------------------------------------------------- */ -+ -+ /* 3 PCIeCap */ -+ /* The device supports capability lists. Find the capabilities. */ -+ -+ /* CapabilityOffset = pPciConfig->u.type0.CapabilitiesPtr; */ -+ pci_read_config_byte(pdev, PCI_CAPABILITY_LIST, &CapabilityOffset); -+ -+ /* Loop through the capabilities in search of the power management capability. */ -+ /* The list is NULL-terminated, so the last offset will always be zero. */ -+ -+ while (CapabilityOffset != 0) { -+ /* Read the header of the capability at this offset. If the retrieved capability is not */ -+ /* the power management capability that we are looking for, follow the link to the */ -+ /* next capability and continue looping. */ -+ -+ /* Result = pci_read_config_word(pdev, CapabilityOffset, (u16 *)&CapabilityHdr); */ -+ Result = pci_read_config_byte(pdev, CapabilityOffset, (u8 *)&CapabilityHdr.CapabilityID); -+ if (Result != 0) -+ break; -+ -+ Result = pci_read_config_byte(pdev, CapabilityOffset + 1, (u8 *)&CapabilityHdr.Next); -+ if (Result != 0) -+ break; -+ -+ /* Found the PCI express capability */ -+ if (CapabilityHdr.CapabilityID == PCI_CAPABILITY_ID_PCI_EXPRESS) -+ break; -+ else { -+ /* This is some other capability. Keep looking for the PCI express capability. */ -+ CapabilityOffset = CapabilityHdr.Next; -+ } -+ } -+ -+ if (Result != 0) { -+ RTW_INFO("pci_read_config_word (RT_PCI_CAPABILITIES_HEADER) Result=%d\n", Result); -+ break; -+ } -+ -+ if (CapabilityHdr.CapabilityID == PCI_CAPABILITY_ID_PCI_EXPRESS) { -+ pcipriv->pciehdr_offset = CapabilityOffset; -+ RTW_INFO("PCIe Header Offset =%x\n", CapabilityOffset); -+ -+ /* Skip past the capabilities header and read the PCI express capability */ -+ /* Justin: The PCI-e capability size should be 2 bytes, why we just get 1 byte */ -+ /* Beside, this PCIeCap seems no one reference it in the driver code */ -+ Result = pci_read_config_byte(pdev, CapabilityOffset + 2, &PCIeCap); -+ -+ if (Result != 0) { -+ RTW_INFO("pci_read_config_byte (PCIE Capability) Result=%d\n", Result); -+ break; -+ } -+ -+ pcipriv->pcie_cap = PCIeCap; -+ RTW_INFO("PCIe Capability =%x\n", PCIeCap); -+ -+ /* 3 Link Control Register */ -+ /* Read "Link Control Register" Field (80h ~81h) */ -+ Result = pci_read_config_byte(pdev, CapabilityOffset + 0x10, &LinkCtrlReg); -+ if (Result != 0) { -+ RTW_INFO("pci_read_config_byte (Link Control Register) Result=%d\n", Result); -+ break; -+ } -+ -+ pcipriv->linkctrl_reg = LinkCtrlReg; -+ RTW_INFO("Link Control Register =%x\n", LinkCtrlReg); -+ -+ /* 3 Get Capability of PCI Clock Request */ -+ /* The clock request setting is located at 0x81[0] */ -+ Result = pci_read_config_byte(pdev, CapabilityOffset + 0x11, &ClkReqReg); -+ if (Result != 0) { -+ pcipriv->pci_clk_req = _FALSE; -+ RTW_INFO("pci_read_config_byte (Clock Request Register) Result=%d\n", Result); -+ break; -+ } -+ if (ClkReqReg & BIT(0)) -+ pcipriv->pci_clk_req = _TRUE; -+ else -+ pcipriv->pci_clk_req = _FALSE; -+ RTW_INFO("Clock Request =%x\n", pcipriv->pci_clk_req); -+ } else { -+ /* We didn't find a PCIe capability. */ -+ RTW_INFO("Didn't Find PCIe Capability\n"); -+ break; -+ } -+ -+ /* 3 Fill Cacheline */ -+ ret = rtw_set_pci_cache_line_size(pdev, 8); -+ if (ret != _SUCCESS) { -+ RTW_INFO("rtw_set_pci_cache_line_size fail\n"); -+ break; -+ } -+ -+ /* Include 92C suggested by SD1. Added by tynli. 2009.11.25. -+ * Enable the Backdoor */ -+ { -+ u8 tmp; -+ -+ Result = pci_read_config_byte(pdev, 0x98, &tmp); -+ -+ tmp |= BIT4; -+ -+ Result = pci_write_config_byte(pdev, 0x98, tmp); -+ -+ } -+ ret = _SUCCESS; -+ } while (_FALSE); -+ -+ return ret; -+} -+ -+/* -+ * Update PCI dependent default settings. -+ * */ -+static void rtw_pci_update_default_setting(_adapter *padapter) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(pdvobjpriv); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ /* reset pPSC->reg_rfps_level & priv->b_support_aspm */ -+ pwrpriv->reg_rfps_level = 0; -+ -+ /* Update PCI ASPM setting */ -+ /* pwrpriv->const_amdpci_aspm = pdvobjpriv->const_amdpci_aspm; */ -+ switch (pdvobjpriv->const_pci_aspm) { -+ case 0: /* No ASPM */ -+ break; -+ -+ case 1: /* ASPM dynamically enabled/disable. */ -+ pwrpriv->reg_rfps_level |= RT_RF_LPS_LEVEL_ASPM; -+ break; -+ -+ case 2: /* ASPM with Clock Req dynamically enabled/disable. */ -+ pwrpriv->reg_rfps_level |= (RT_RF_LPS_LEVEL_ASPM | RT_RF_OFF_LEVL_CLK_REQ); -+ break; -+ -+ case 3: /* Always enable ASPM and Clock Req from initialization to halt. */ -+ pwrpriv->reg_rfps_level &= ~(RT_RF_LPS_LEVEL_ASPM); -+ pwrpriv->reg_rfps_level |= (RT_RF_PS_LEVEL_ALWAYS_ASPM | RT_RF_OFF_LEVL_CLK_REQ); -+ break; -+ -+ case 4: /* Always enable ASPM without Clock Req from initialization to halt. */ -+ pwrpriv->reg_rfps_level &= ~(RT_RF_LPS_LEVEL_ASPM | RT_RF_OFF_LEVL_CLK_REQ); -+ pwrpriv->reg_rfps_level |= RT_RF_PS_LEVEL_ALWAYS_ASPM; -+ break; -+ -+ case 5: /* Linux do not support ASPM OSC, added by Roger, 2013.03.27. */ -+ break; -+ } -+ -+ pwrpriv->reg_rfps_level |= RT_RF_OFF_LEVL_HALT_NIC; -+ -+ /* Update Radio OFF setting */ -+ switch (pdvobjpriv->const_hwsw_rfoff_d3) { -+ case 1: -+ if (pwrpriv->reg_rfps_level & RT_RF_LPS_LEVEL_ASPM) -+ pwrpriv->reg_rfps_level |= RT_RF_OFF_LEVL_ASPM; -+ break; -+ -+ case 2: -+ if (pwrpriv->reg_rfps_level & RT_RF_LPS_LEVEL_ASPM) -+ pwrpriv->reg_rfps_level |= RT_RF_OFF_LEVL_ASPM; -+ pwrpriv->reg_rfps_level |= RT_RF_OFF_LEVL_HALT_NIC; -+ break; -+ -+ case 3: -+ pwrpriv->reg_rfps_level |= RT_RF_OFF_LEVL_PCI_D3; -+ break; -+ } -+ -+ /* Update Rx 2R setting */ -+ /* pPSC->reg_rfps_level |= ((pDevice->RegLPS2RDisable) ? RT_RF_LPS_DISALBE_2R : 0); */ -+ -+ /* */ -+ /* Set HW definition to determine if it supports ASPM. */ -+ /* */ -+ switch (pdvobjpriv->const_support_pciaspm) { -+ case 1: { /* Support ASPM. */ -+ u8 b_support_backdoor = _TRUE; -+ u8 b_support_l1_on_amd = _FALSE; -+ -+ rtw_hal_get_def_var(padapter, HAL_DEF_PCI_AMD_L1_SUPPORT, &b_support_l1_on_amd); -+ -+ if (pHalData->CustomerID == RT_CID_TOSHIBA && -+ pcipriv->pcibridge_vendor == PCI_BRIDGE_VENDOR_AMD && -+ !pcipriv->amd_l1_patch && !b_support_l1_on_amd) { -+ RTW_INFO("%s(): Disable L1 Backdoor!!\n", __FUNCTION__); -+ b_support_backdoor = _FALSE; -+ } -+ rtw_hal_set_def_var(padapter, HAL_DEF_PCI_SUUPORT_L1_BACKDOOR, &b_support_backdoor); -+ } -+ break; -+ -+ default: -+ /* Do nothing. Set when finding the chipset. */ -+ break; -+ } -+} -+ -+static void rtw_pci_initialize_adapter_common(_adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -+ -+ rtw_pci_update_default_setting(padapter); -+ -+ if (pwrpriv->reg_rfps_level & RT_RF_PS_LEVEL_ALWAYS_ASPM) { -+ /* Always enable ASPM & Clock Req. */ -+ rtw_pci_enable_aspm(padapter); -+ RT_SET_PS_LEVEL(pwrpriv, RT_RF_PS_LEVEL_ALWAYS_ASPM); -+ } -+ -+} -+ -+/* -+ * 2009/10/28 MH Enable rtl8192ce DMA64 function. We need to enable 0x719 BIT5 -+ * */ -+#ifdef CONFIG_64BIT_DMA -+u8 PlatformEnableDMA64(PADAPTER Adapter) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); -+ struct pci_dev *pdev = pdvobjpriv->ppcidev; -+ u8 bResult = _TRUE; -+ u8 value; -+ -+ pci_read_config_byte(pdev, 0x719, &value); -+ -+ /* 0x719 Bit5 is DMA64 bit fetch. */ -+ value |= (BIT5); -+ -+ pci_write_config_byte(pdev, 0x719, value); -+ -+ return bResult; -+} -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 5, 0)) || (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 18)) -+ #define rtw_pci_interrupt(x, y, z) rtw_pci_interrupt(x, y) -+#endif -+ -+static irqreturn_t rtw_pci_interrupt(int irq, void *priv, struct pt_regs *regs) -+{ -+ struct dvobj_priv *dvobj = (struct dvobj_priv *)priv; -+ _adapter *adapter = dvobj->padapters[IFACE_ID0]; -+ -+ if (dvobj->irq_enabled == 0) -+ return IRQ_HANDLED; -+ -+ if (rtw_hal_interrupt_handler(adapter) == _FAIL) -+ return IRQ_HANDLED; -+ /* return IRQ_NONE; */ -+ -+ return IRQ_HANDLED; -+} -+ -+#ifdef RTK_DMP_PLATFORM -+ #define pci_iounmap(x, y) iounmap(y) -+#endif -+ -+int pci_alloc_irq(struct dvobj_priv *dvobj) -+{ -+ int err; -+ struct pci_dev *pdev = dvobj->ppcidev; -+ int ret; -+ -+ ret = pci_enable_msi(pdev); -+ -+ RTW_INFO("pci_enable_msi ret=%d\n", ret); -+ -+#if defined(IRQF_SHARED) -+ err = request_irq(pdev->irq, &rtw_pci_interrupt, IRQF_SHARED, DRV_NAME, dvobj); -+#else -+ err = request_irq(pdev->irq, &rtw_pci_interrupt, SA_SHIRQ, DRV_NAME, dvobj); -+#endif -+ if (err) -+ RTW_INFO("Error allocating IRQ %d", pdev->irq); -+ else { -+ dvobj->irq_alloc = 1; -+ dvobj->irq = pdev->irq; -+ RTW_INFO("Request_irq OK, IRQ %d\n", pdev->irq); -+ } -+ -+ return err ? _FAIL : _SUCCESS; -+} -+ -+static void rtw_decide_chip_type_by_pci_driver_data(struct dvobj_priv *pdvobj, const struct pci_device_id *pdid) -+{ -+ pdvobj->chip_type = pdid->driver_data; -+ -+#ifdef CONFIG_RTL8188E -+ if (pdvobj->chip_type == RTL8188E) { -+ pdvobj->HardwareType = HARDWARE_TYPE_RTL8188EE; -+ RTW_INFO("CHIP TYPE: RTL8188E\n"); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8812A -+ if (pdvobj->chip_type == RTL8812) { -+ pdvobj->HardwareType = HARDWARE_TYPE_RTL8812E; -+ RTW_INFO("CHIP TYPE: RTL8812AE\n"); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8821A -+ if (pdvobj->chip_type == RTL8821) { -+ pdvobj->HardwareType = HARDWARE_TYPE_RTL8821E; -+ RTW_INFO("CHIP TYPE: RTL8821AE\n"); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8723B -+ if (pdvobj->chip_type == RTL8723B) { -+ pdvobj->HardwareType = HARDWARE_TYPE_RTL8723BE; -+ RTW_INFO("CHIP TYPE: RTL8723BE\n"); -+ } -+#endif -+#ifdef CONFIG_RTL8723D -+ if (pdvobj->chip_type == RTL8723D) { -+ pdvobj->HardwareType = HARDWARE_TYPE_RTL8723DE; -+ RTW_INFO("CHIP TYPE: RTL8723DE\n"); -+ } -+#endif -+#ifdef CONFIG_RTL8192E -+ if (pdvobj->chip_type == RTL8192E) { -+ pdvobj->HardwareType = HARDWARE_TYPE_RTL8192EE; -+ RTW_INFO("CHIP TYPE: RTL8192EE\n"); -+ } -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ if (pdvobj->chip_type == RTL8814A) { -+ pdvobj->HardwareType = HARDWARE_TYPE_RTL8814AE; -+ RTW_INFO("CHIP TYPE: RTL8814AE\n"); -+ } -+#endif -+ -+#if defined(CONFIG_RTL8822B) -+ if (pdvobj->chip_type == RTL8822B) { -+ pdvobj->HardwareType = HARDWARE_TYPE_RTL8822BE; -+ RTW_INFO("CHIP TYPE: RTL8822BE\n"); -+ } -+#endif -+} -+ -+static struct dvobj_priv *pci_dvobj_init(struct pci_dev *pdev, const struct pci_device_id *pdid) -+{ -+ int err; -+ u32 status = _FAIL; -+ struct dvobj_priv *dvobj = NULL; -+ struct pci_priv *pcipriv = NULL; -+ struct pci_dev *bridge_pdev = pdev->bus->self; -+ /* u32 pci_cfg_space[16]; */ -+ unsigned long pmem_start, pmem_len, pmem_flags; -+ u8 tmp; -+ u8 PciBgVIdIdx; -+ int i; -+ -+ -+ dvobj = devobj_init(); -+ if (dvobj == NULL) -+ goto exit; -+ -+ -+ dvobj->ppcidev = pdev; -+ pcipriv = &(dvobj->pcipriv); -+ pci_set_drvdata(pdev, dvobj); -+ -+ -+ err = pci_enable_device(pdev); -+ if (err != 0) { -+ RTW_ERR("%s : Cannot enable new PCI device\n", pci_name(pdev)); -+ goto free_dvobj; -+ } -+ -+#ifdef CONFIG_64BIT_DMA -+ if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64))) { -+ RTW_INFO("RTL819xCE: Using 64bit DMA\n"); -+ err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); -+ if (err != 0) { -+ RTW_ERR("Unable to obtain 64bit DMA for consistent allocations\n"); -+ goto disable_picdev; -+ } -+ dvobj->bdma64 = _TRUE; -+ } else -+#endif -+ { -+ if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32))) { -+ err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)); -+ if (err != 0) { -+ RTW_ERR("Unable to obtain 32bit DMA for consistent allocations\n"); -+ goto disable_picdev; -+ } -+ } -+ } -+ -+ pci_set_master(pdev); -+ -+ err = pci_request_regions(pdev, DRV_NAME); -+ if (err != 0) { -+ RTW_ERR("Can't obtain PCI resources\n"); -+ goto disable_picdev; -+ } -+ -+#ifdef RTK_129X_PLATFORM -+ if (pdev->bus->number == 0x00) { -+ pmem_start = PCIE_SLOT1_MEM_START; -+ pmem_len = PCIE_SLOT1_MEM_LEN; -+ pmem_flags = 0; -+ RTW_PRINT("RTD129X: PCIE SLOT1\n"); -+ } else if (pdev->bus->number == 0x01) { -+ pmem_start = PCIE_SLOT2_MEM_START; -+ pmem_len = PCIE_SLOT2_MEM_LEN; -+ pmem_flags = 0; -+ RTW_PRINT("RTD129X: PCIE SLOT2\n"); -+ } else { -+ RTW_ERR(KERN_ERR "RTD129X: Wrong Slot Num\n"); -+ goto release_regions; -+ } -+#else -+ /* Search for memory map resource (index 0~5) */ -+ for (i = 0 ; i < 6 ; i++) { -+ pmem_start = pci_resource_start(pdev, i); -+ pmem_len = pci_resource_len(pdev, i); -+ pmem_flags = pci_resource_flags(pdev, i); -+ -+ if (pmem_flags & IORESOURCE_MEM) -+ break; -+ } -+ -+ if (i == 6) { -+ RTW_ERR("%s: No MMIO resource found, abort!\n", __func__); -+ goto release_regions; -+ } -+#endif /* RTK_DMP_PLATFORM */ -+ -+#ifdef RTK_DMP_PLATFORM -+ dvobj->pci_mem_start = (unsigned long)ioremap_nocache(pmem_start, pmem_len); -+#elif defined(RTK_129X_PLATFORM) -+ if (pdev->bus->number == 0x00) -+ dvobj->mask_addr = -+ (unsigned long)ioremap(PCIE_SLOT1_MASK, 0x100); -+ else if (pdev->bus->number == 0x01) -+ dvobj->mask_addr = -+ (unsigned long)ioremap(PCIE_SLOT2_MASK, 0x100); -+ -+ if (dvobj->mask_addr == 0) { -+ RTW_ERR("Can't map TRAN/MASK mem\n"); -+ goto release_regions; -+ } -+ -+ dvobj->tran_addr = dvobj->mask_addr + PCIE_TRANSLATE_OFFSET; -+ -+ dvobj->pci_mem_start = -+ (unsigned long)ioremap_nocache(pmem_start, pmem_len); -+#else -+ /* shared mem start */ -+ dvobj->pci_mem_start = (unsigned long)pci_iomap(pdev, i, pmem_len); -+#endif -+ if (dvobj->pci_mem_start == 0) { -+ RTW_ERR("Can't map PCI mem\n"); -+ goto release_regions; -+ } -+ -+ RTW_INFO("Memory mapped space start: 0x%08lx len:%08lx flags:%08lx, after map:0x%08lx\n", -+ pmem_start, pmem_len, pmem_flags, dvobj->pci_mem_start); -+ -+ /*find bus info*/ -+ pcipriv->busnumber = pdev->bus->number; -+ pcipriv->devnumber = PCI_SLOT(pdev->devfn); -+ pcipriv->funcnumber = PCI_FUNC(pdev->devfn); -+ -+ /*find bridge info*/ -+ if (bridge_pdev) { -+ pcipriv->pcibridge_busnum = bridge_pdev->bus->number; -+ pcipriv->pcibridge_devnum = PCI_SLOT(bridge_pdev->devfn); -+ pcipriv->pcibridge_funcnum = PCI_FUNC(bridge_pdev->devfn); -+ pcipriv->pcibridge_vendor = PCI_BRIDGE_VENDOR_UNKNOWN; -+ pcipriv->pcibridge_vendorid = bridge_pdev->vendor; -+ pcipriv->pcibridge_deviceid = bridge_pdev->device; -+ } -+ -+#if 0 -+ /* Read PCI configuration Space Header */ -+ for (i = 0; i < 16; i++) -+ pci_read_config_dword(pdev, (i << 2), &pci_cfg_space[i]); -+#endif -+ -+ /*step 1-1., decide the chip_type via device info*/ -+ dvobj->interface_type = RTW_PCIE; -+ rtw_decide_chip_type_by_pci_driver_data(dvobj, pdid); -+ -+ -+ /* rtw_pci_parse_configuration(pdev, dvobj, (u8 *)&pci_cfg_space); */ -+ rtw_pci_parse_configuration(pdev, dvobj); -+ -+ for (PciBgVIdIdx = 0; PciBgVIdIdx < PCI_BRIDGE_VENDOR_MAX; PciBgVIdIdx++) { -+ if (pcipriv->pcibridge_vendorid == pcibridge_vendors[PciBgVIdIdx]) { -+ pcipriv->pcibridge_vendor = PciBgVIdIdx; -+ RTW_INFO("Pci Bridge Vendor is found: VID=0x%x, VendorIdx=%d\n", pcipriv->pcibridge_vendorid, PciBgVIdIdx); -+ break; -+ } -+ } -+ -+ if (pcipriv->pcibridge_vendor != PCI_BRIDGE_VENDOR_UNKNOWN) { -+ rtw_pci_get_linkcontrol_reg(bridge_pdev, &pcipriv->pcibridge_linkctrlreg, &pcipriv->pcibridge_pciehdr_offset); -+ -+ if (pcipriv->pcibridge_vendor == PCI_BRIDGE_VENDOR_AMD) -+ pcipriv->amd_l1_patch = rtw_pci_get_amd_l1_patch(dvobj, bridge_pdev); -+ } -+ -+ status = _SUCCESS; -+ -+iounmap: -+ if (status != _SUCCESS && dvobj->pci_mem_start != 0) { -+#if 1/* def RTK_DMP_PLATFORM */ -+ pci_iounmap(pdev, (void *)dvobj->pci_mem_start); -+#endif -+ dvobj->pci_mem_start = 0; -+ } -+ -+#ifdef RTK_129X_PLATFORM -+ if (status != _SUCCESS && dvobj->mask_addr != 0) { -+ pci_iounmap(pdev, (void *)dvobj->mask_addr); -+ dvobj->mask_addr = 0; -+ } -+#endif -+ -+release_regions: -+ if (status != _SUCCESS) -+ pci_release_regions(pdev); -+disable_picdev: -+ if (status != _SUCCESS) -+ pci_disable_device(pdev); -+free_dvobj: -+ if (status != _SUCCESS && dvobj) { -+ pci_set_drvdata(pdev, NULL); -+ devobj_deinit(dvobj); -+ dvobj = NULL; -+ } -+exit: -+ return dvobj; -+} -+ -+ -+static void pci_dvobj_deinit(struct pci_dev *pdev) -+{ -+ struct dvobj_priv *dvobj = pci_get_drvdata(pdev); -+ -+ pci_set_drvdata(pdev, NULL); -+ if (dvobj) { -+ if (dvobj->irq_alloc) { -+ free_irq(pdev->irq, dvobj); -+ pci_disable_msi(pdev); -+ dvobj->irq_alloc = 0; -+ } -+ -+ if (dvobj->pci_mem_start != 0) { -+#if 1/* def RTK_DMP_PLATFORM */ -+ pci_iounmap(pdev, (void *)dvobj->pci_mem_start); -+#endif -+ dvobj->pci_mem_start = 0; -+ } -+ -+#ifdef RTK_129X_PLATFORM -+ if (dvobj->mask_addr != 0) { -+ pci_iounmap(pdev, (void *)dvobj->mask_addr); -+ dvobj->mask_addr = 0; -+ } -+#endif -+ devobj_deinit(dvobj); -+ } -+ -+ pci_release_regions(pdev); -+ pci_disable_device(pdev); -+ -+} -+ -+ -+u8 rtw_set_hal_ops(_adapter *padapter) -+{ -+ /* alloc memory for HAL DATA */ -+ if (rtw_hal_data_init(padapter) == _FAIL) -+ return _FAIL; -+ -+#ifdef CONFIG_RTL8188E -+ if (rtw_get_chip_type(padapter) == RTL8188E) -+ rtl8188ee_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ if ((rtw_get_chip_type(padapter) == RTL8812) || (rtw_get_chip_type(padapter) == RTL8821)) -+ rtl8812ae_set_hal_ops(padapter); -+#endif -+ -+#ifdef CONFIG_RTL8723B -+ if (rtw_get_chip_type(padapter) == RTL8723B) -+ rtl8723be_set_hal_ops(padapter); -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ if (rtw_get_chip_type(padapter) == RTL8723D) -+ rtl8723de_set_hal_ops(padapter); -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ if (rtw_get_chip_type(padapter) == RTL8192E) -+ rtl8192ee_set_hal_ops(padapter); -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ if (rtw_get_chip_type(padapter) == RTL8814A) -+ rtl8814ae_set_hal_ops(padapter); -+#endif -+ -+#if defined(CONFIG_RTL8822B) -+ if (rtw_get_chip_type(padapter) == RTL8822B) -+ rtl8822be_set_hal_ops(padapter); -+#endif -+ -+ if (rtw_hal_ops_check(padapter) == _FAIL) -+ return _FAIL; -+ -+ if (hal_spec_init(padapter) == _FAIL) -+ return _FAIL; -+ -+ return _SUCCESS; -+} -+ -+void pci_set_intf_ops(_adapter *padapter, struct _io_ops *pops) -+{ -+#ifdef CONFIG_RTL8188E -+ if (rtw_get_chip_type(padapter) == RTL8188E) -+ rtl8188ee_set_intf_ops(pops); -+#endif -+ -+#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) -+ if ((rtw_get_chip_type(padapter) == RTL8812) || (rtw_get_chip_type(padapter) == RTL8821)) -+ rtl8812ae_set_intf_ops(pops); -+#endif -+ -+#ifdef CONFIG_RTL8723B -+ if (rtw_get_chip_type(padapter) == RTL8723B) -+ rtl8723be_set_intf_ops(pops); -+#endif -+ -+#ifdef CONFIG_RTL8723D -+ if (rtw_get_chip_type(padapter) == RTL8723D) -+ rtl8723de_set_intf_ops(pops); -+#endif -+ -+#ifdef CONFIG_RTL8192E -+ if (rtw_get_chip_type(padapter) == RTL8192E) -+ rtl8192ee_set_intf_ops(pops); -+#endif -+ -+#ifdef CONFIG_RTL8814A -+ if (rtw_get_chip_type(padapter) == RTL8814A) -+ rtl8814ae_set_intf_ops(pops); -+#endif -+ -+#if defined(CONFIG_RTL8822B) -+ if (rtw_get_chip_type(padapter) == RTL8822B) -+ rtl8822be_set_intf_ops(pops); -+#endif -+ -+} -+ -+static void pci_intf_start(_adapter *padapter) -+{ -+ -+ RTW_INFO("+pci_intf_start\n"); -+ -+ /* Enable hw interrupt */ -+ rtw_hal_enable_interrupt(padapter); -+ -+ RTW_INFO("-pci_intf_start\n"); -+} -+static void rtw_mi_pci_tasklets_kill(_adapter *padapter) -+{ -+ int i; -+ _adapter *iface; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ for (i = 0; i < dvobj->iface_nums; i++) { -+ iface = dvobj->padapters[i]; -+ if ((iface) && rtw_is_adapter_up(iface)) { -+ tasklet_kill(&(padapter->recvpriv.recv_tasklet)); -+ tasklet_kill(&(padapter->recvpriv.irq_prepare_beacon_tasklet)); -+ tasklet_kill(&(padapter->xmitpriv.xmit_tasklet)); -+ } -+ } -+} -+ -+static void pci_intf_stop(_adapter *padapter) -+{ -+ -+ -+ /* Disable hw interrupt */ -+ if (!rtw_is_surprise_removed(padapter)) { -+ /* device still exists, so driver can do i/o operation */ -+ rtw_hal_disable_interrupt(padapter); -+ rtw_mi_pci_tasklets_kill(padapter); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_PCIE_STOP_TX_DMA, 0); -+ -+ rtw_hal_irp_reset(padapter); -+ -+ } else { -+ /* Clear irq_enabled to prevent handle interrupt function. */ -+ adapter_to_dvobj(padapter)->irq_enabled = 0; -+ } -+ -+ -+} -+ -+static void disable_ht_for_spec_devid(const struct pci_device_id *pdid) -+{ -+#ifdef CONFIG_80211N_HT -+ u16 vid, pid; -+ u32 flags; -+ int i; -+ int num = sizeof(specific_device_id_tbl) / sizeof(struct specific_device_id); -+ -+ for (i = 0; i < num; i++) { -+ vid = specific_device_id_tbl[i].idVendor; -+ pid = specific_device_id_tbl[i].idProduct; -+ flags = specific_device_id_tbl[i].flags; -+ -+ if ((pdid->vendor == vid) && (pdid->device == pid) && (flags & SPEC_DEV_ID_DISABLE_HT)) { -+ rtw_ht_enable = 0; -+ rtw_bw_mode = 0; -+ rtw_ampdu_enable = 0; -+ } -+ -+ } -+#endif -+} -+ -+#ifdef CONFIG_PM -+static int rtw_pci_suspend(struct pci_dev *pdev, pm_message_t state) -+{ -+ int ret = 0; -+ struct dvobj_priv *dvobj = pci_get_drvdata(pdev); -+ _adapter *padapter = dvobj->padapters[IFACE_ID0]; -+ -+ ret = rtw_suspend_common(padapter); -+ ret = pci_save_state(pdev); -+ if (ret != 0) { -+ RTW_INFO("%s Failed on pci_save_state (%d)\n", __FUNCTION__, ret); -+ goto exit; -+ } -+ -+#ifdef CONFIG_WOWLAN -+ device_set_wakeup_enable(&pdev->dev, true); -+#endif -+ pci_disable_device(pdev); -+ -+#ifdef CONFIG_WOWLAN -+ ret = pci_enable_wake(pdev, pci_choose_state(pdev, state), true); -+ if (ret != 0) -+ RTW_INFO("%s Failed on pci_enable_wake (%d)\n", __FUNCTION__, ret); -+#endif -+ ret = pci_set_power_state(pdev, pci_choose_state(pdev, state)); -+ if (ret != 0) -+ RTW_INFO("%s Failed on pci_set_power_state (%d)\n", __FUNCTION__, ret); -+ -+exit: -+ return ret; -+ -+} -+ -+int rtw_resume_process(_adapter *padapter) -+{ -+ return rtw_resume_common(padapter); -+} -+ -+static int rtw_pci_resume(struct pci_dev *pdev) -+{ -+ struct dvobj_priv *dvobj = pci_get_drvdata(pdev); -+ _adapter *padapter = dvobj->padapters[IFACE_ID0]; -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); -+ int err = 0; -+ -+ err = pci_set_power_state(pdev, PCI_D0); -+ if (err != 0) { -+ RTW_INFO("%s Failed on pci_set_power_state (%d)\n", __FUNCTION__, err); -+ goto exit; -+ } -+ -+ err = pci_enable_device(pdev); -+ if (err != 0) { -+ RTW_INFO("%s Failed on pci_enable_device (%d)\n", __FUNCTION__, err); -+ goto exit; -+ } -+ -+ -+#ifdef CONFIG_WOWLAN -+ err = pci_enable_wake(pdev, PCI_D0, 0); -+ if (err != 0) { -+ RTW_INFO("%s Failed on pci_enable_wake (%d)\n", __FUNCTION__, err); -+ goto exit; -+ } -+#endif -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 37)) -+ pci_restore_state(pdev); -+#else -+ err = pci_restore_state(pdev); -+ if (err != 0) { -+ RTW_INFO("%s Failed on pci_restore_state (%d)\n", __FUNCTION__, err); -+ goto exit; -+ } -+#endif -+ -+#ifdef CONFIG_WOWLAN -+ device_set_wakeup_enable(&pdev->dev, false); -+#endif -+ -+ if (pwrpriv->bInternalAutoSuspend) -+ err = rtw_resume_process(padapter); -+ else { -+ if (pwrpriv->wowlan_mode || pwrpriv->wowlan_ap_mode) { -+ rtw_resume_lock_suspend(); -+ err = rtw_resume_process(padapter); -+ rtw_resume_unlock_suspend(); -+ } else { -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+ rtw_resume_in_workqueue(pwrpriv); -+#else -+ if (rtw_is_earlysuspend_registered(pwrpriv)) { -+ /* jeff: bypass resume here, do in late_resume */ -+ rtw_set_do_late_resume(pwrpriv, _TRUE); -+ } else { -+ rtw_resume_lock_suspend(); -+ err = rtw_resume_process(padapter); -+ rtw_resume_unlock_suspend(); -+ } -+#endif -+ } -+ } -+ -+exit: -+ -+ return err; -+} -+#endif/* CONFIG_PM */ -+ -+_adapter *rtw_pci_primary_adapter_init(struct dvobj_priv *dvobj, struct pci_dev *pdev) -+{ -+ _adapter *padapter = NULL; -+ int status = _FAIL; -+ -+ padapter = (_adapter *)rtw_zvmalloc(sizeof(*padapter)); -+ if (padapter == NULL) -+ goto exit; -+ -+ if (loadparam(padapter) != _SUCCESS) -+ goto free_adapter; -+ -+ padapter->dvobj = dvobj; -+ -+ rtw_set_drv_stopped(padapter);/*init*/ -+ -+ dvobj->padapters[dvobj->iface_nums++] = padapter; -+ padapter->iface_id = IFACE_ID0; -+ -+ /* set adapter_type/iface type for primary padapter */ -+ padapter->isprimary = _TRUE; -+ padapter->adapter_type = PRIMARY_ADAPTER; -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ padapter->hw_port = HW_PORT0; -+#else -+ padapter->hw_port = HW_PORT0; -+#endif -+ -+ if (rtw_init_io_priv(padapter, pci_set_intf_ops) == _FAIL) -+ goto free_adapter; -+ -+ /* step 2. hook HalFunc, allocate HalData */ -+ /* hal_set_hal_ops(padapter); */ -+ if (rtw_set_hal_ops(padapter) == _FAIL) { -+ goto free_hal_data; -+ } -+ -+ /* step 3. */ -+ padapter->intf_start = &pci_intf_start; -+ padapter->intf_stop = &pci_intf_stop; -+ -+ /* .3 */ -+ rtw_hal_read_chip_version(padapter); -+ -+ /* .4 */ -+ rtw_hal_chip_configure(padapter); -+ -+ /* step 4. read efuse/eeprom data and get mac_addr */ -+ rtw_hal_read_chip_info(padapter); -+ -+ /* step 5. */ -+ if (rtw_init_drv_sw(padapter) == _FAIL) { -+ goto free_hal_data; -+ } -+ -+#ifdef CONFIG_BT_COEXIST -+ rtw_btcoex_Initialize(padapter); -+#endif /* CONFIG_BT_COEXIST */ -+ -+ if (rtw_hal_inirp_init(padapter) == _FAIL) { -+ goto free_hal_data; -+ } -+ rtw_macaddr_cfg(adapter_mac_addr(padapter), get_hal_mac_addr(padapter)); -+ -+#ifdef CONFIG_MI_WITH_MBSSID_CAM -+ rtw_mbid_camid_alloc(padapter, adapter_mac_addr(padapter)); -+#endif -+#ifdef CONFIG_P2P -+ rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); -+#endif /* CONFIG_P2P */ -+ -+ rtw_hal_disable_interrupt(padapter); -+ -+ /* step 6. Init pci related configuration */ -+ rtw_pci_initialize_adapter_common(padapter); -+ -+ RTW_INFO("bDriverStopped:%s, bSurpriseRemoved:%s, bup:%d, hw_init_completed:%s\n" -+ , rtw_is_drv_stopped(padapter) ? "True" : "False" -+ , rtw_is_surprise_removed(padapter) ? "True" : "False" -+ , padapter->bup -+ , rtw_is_hw_init_completed(padapter) ? "True" : "False" -+ ); -+ -+ status = _SUCCESS; -+ -+free_hal_data: -+ if (status != _SUCCESS && padapter->HalData) -+ rtw_hal_free_data(padapter); -+ -+free_adapter: -+ if (status != _SUCCESS && padapter) { -+ rtw_vmfree((u8 *)padapter, sizeof(*padapter)); -+ padapter = NULL; -+ } -+exit: -+ return padapter; -+} -+ -+static void rtw_pci_primary_adapter_deinit(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ /* padapter->intf_stop(padapter); */ -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) -+ rtw_disassoc_cmd(padapter, 0, _FALSE); -+ -+#ifdef CONFIG_AP_MODE -+ if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { -+ free_mlme_ap_info(padapter); -+#ifdef CONFIG_HOSTAPD_MLME -+ hostapd_mode_unload(padapter); -+#endif -+ } -+#endif -+ -+ /*rtw_cancel_all_timer(padapte);*/ -+#ifdef CONFIG_WOWLAN -+ adapter_to_pwrctl(padapter)->wowlan_mode = _FALSE; -+#endif /* CONFIG_WOWLAN */ -+ rtw_dev_unload(padapter); -+ -+ RTW_INFO("%s, hw_init_completed=%s\n", __func__, rtw_is_hw_init_completed(padapter) ? "_TRUE" : "_FALSE"); -+ -+ rtw_hal_inirp_deinit(padapter); -+ rtw_free_drv_sw(padapter); -+ -+ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ -+ rtw_os_ndev_free(padapter); -+ -+#ifdef RTW_HALMAC -+ rtw_halmac_deinit_adapter(adapter_to_dvobj(padapter)); -+#endif /* RTW_HALMAC */ -+ -+ rtw_vmfree((u8 *)padapter, sizeof(_adapter)); -+ -+#ifdef CONFIG_PLATFORM_RTD2880B -+ RTW_INFO("wlan link down\n"); -+ rtd2885_wlan_netlink_sendMsg("linkdown", "8712"); -+#endif -+} -+ -+/* -+ * drv_init() - a device potentially for us -+ * -+ * notes: drv_init() is called when the bus driver has located a card for us to support. -+ * We accept the new device by returning 0. -+*/ -+static int rtw_drv_init(struct pci_dev *pdev, const struct pci_device_id *pdid) -+{ -+ int i, err = -ENODEV; -+ -+ int status = _FAIL; -+ _adapter *padapter = NULL; -+ struct dvobj_priv *dvobj; -+ struct net_device *pnetdev; -+ -+ /* RTW_INFO("+rtw_drv_init\n"); */ -+ -+ /* step 0. */ -+ disable_ht_for_spec_devid(pdid); -+ -+ /* Initialize dvobj_priv */ -+ dvobj = pci_dvobj_init(pdev, pdid); -+ if (dvobj == NULL) { -+ goto exit; -+ } -+ -+ /* Initialize primary adapter */ -+ padapter = rtw_pci_primary_adapter_init(dvobj, pdev); -+ if (padapter == NULL) { -+ RTW_INFO("rtw_pci_primary_adapter_init Failed!\n"); -+ goto free_dvobj; -+ } -+ -+ /* Initialize virtual interface */ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->registrypriv.virtual_iface_num > (CONFIG_IFACE_NUMBER - 1)) -+ padapter->registrypriv.virtual_iface_num = (CONFIG_IFACE_NUMBER - 1); -+ -+ for (i = 0; i < padapter->registrypriv.virtual_iface_num; i++) { -+ if (rtw_drv_add_vir_if(padapter, pci_set_intf_ops) == NULL) { -+ RTW_INFO("rtw_drv_add_iface failed! (%d)\n", i); -+ goto free_if_vir; -+ } -+ } -+#endif -+ -+#ifdef CONFIG_GLOBAL_UI_PID -+ if (ui_pid[1] != 0) { -+ RTW_INFO("ui_pid[1]:%d\n", ui_pid[1]); -+ rtw_signal_process(ui_pid[1], SIGUSR2); -+ } -+#endif -+ -+ /* dev_alloc_name && register_netdev */ -+ if (rtw_os_ndevs_init(dvobj) != _SUCCESS) -+ goto free_if_vir; -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ hostapd_mode_init(padapter); -+#endif -+ -+#ifdef CONFIG_PLATFORM_RTD2880B -+ RTW_INFO("wlan link up\n"); -+ rtd2885_wlan_netlink_sendMsg("linkup", "8712"); -+#endif -+ -+ /* alloc irq */ -+ if (pci_alloc_irq(dvobj) != _SUCCESS) -+ goto os_ndevs_deinit; -+ -+ /* RTW_INFO("-871x_drv - drv_init, success!\n"); */ -+ -+ status = _SUCCESS; -+ -+os_ndevs_deinit: -+ if (status != _SUCCESS) -+ rtw_os_ndevs_deinit(dvobj); -+free_if_vir: -+ if (status != _SUCCESS) { -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_drv_stop_vir_ifaces(dvobj); -+ rtw_drv_free_vir_ifaces(dvobj); -+#endif -+ } -+ -+ if (status != _SUCCESS && padapter) -+ rtw_pci_primary_adapter_deinit(padapter); -+ -+free_dvobj: -+ if (status != _SUCCESS) -+ pci_dvobj_deinit(pdev); -+exit: -+ return status == _SUCCESS ? 0 : -ENODEV; -+} -+ -+/* -+ * dev_remove() - our device is being removed -+*/ -+/* rmmod module & unplug(SurpriseRemoved) will call r871xu_dev_remove() => how to recognize both */ -+static void rtw_dev_remove(struct pci_dev *pdev) -+{ -+ struct dvobj_priv *pdvobjpriv = pci_get_drvdata(pdev); -+ _adapter *padapter = pdvobjpriv->padapters[IFACE_ID0]; -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ if (pdvobjpriv->processing_dev_remove == _TRUE) { -+ RTW_WARN("%s-line%d: Warning! device has been removed!\n", __FUNCTION__, __LINE__); -+ return; -+ } -+ -+ RTW_INFO("+rtw_dev_remove\n"); -+ -+ pdvobjpriv->processing_dev_remove = _TRUE; -+ -+ if (unlikely(!padapter)) -+ return; -+ -+ /* TODO: use rtw_os_ndevs_deinit instead at the first stage of driver's dev deinit function */ -+ rtw_os_ndevs_unregister(pdvobjpriv); -+ -+#if 0 -+#ifdef RTK_DMP_PLATFORM -+ rtw_clr_surprise_removed(padapter); /* always trate as device exists*/ -+ /* this will let the driver to disable it's interrupt */ -+#else -+ if (pci_drvpriv.drv_registered == _TRUE) { -+ /* RTW_INFO("r871xu_dev_remove():padapter->bSurpriseRemoved == _TRUE\n"); */ -+ rtw_set_surprise_removed(padapter); -+ } -+ /*else -+ { -+ -+ GET_HAL_DATA(padapter)->hw_init_completed = _FALSE; -+ -+ }*/ -+#endif -+#endif -+ -+#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) -+ rtw_unregister_early_suspend(dvobj_to_pwrctl(pdvobjpriv)); -+#endif -+ -+ if (padapter->bFWReady == _TRUE) { -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); -+ -+ LeaveAllPowerSaveMode(padapter); -+ } -+ -+ rtw_set_drv_stopped(padapter); /*for stop thread*/ -+ rtw_stop_cmd_thread(padapter); -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_drv_stop_vir_ifaces(pdvobjpriv); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+#ifdef CONFIG_BT_COEXIST_SOCKET_TRX -+ if (GET_HAL_DATA(padapter)->EEPROMBluetoothCoexist) -+ rtw_btcoex_close_socket(padapter); -+#endif -+ rtw_btcoex_HaltNotify(padapter); -+#endif -+ -+ rtw_pci_primary_adapter_deinit(padapter); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_drv_free_vir_ifaces(pdvobjpriv); -+#endif -+ -+ pci_dvobj_deinit(pdev); -+ -+ RTW_INFO("-r871xu_dev_remove, done\n"); -+ -+ return; -+} -+ -+static void rtw_dev_shutdown(struct pci_dev *pdev) -+{ -+ struct dvobj_priv *pdvobjpriv = pci_get_drvdata(pdev); -+ _adapter *padapter = pdvobjpriv->padapters[IFACE_ID0]; -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ if (IS_HARDWARE_TYPE_8723DE(padapter)) { -+ u1Byte u1Tmp; -+ -+ u1Tmp = PlatformEFIORead1Byte(padapter, 0x75 /*REG_HCI_OPT_CTRL_8723D+1*/); -+ PlatformEFIOWrite1Byte(padapter, 0x75 /*REG_HCI_OPT_CTRL_8723D+1*/, (u1Tmp|BIT0));/*Disable USB Suspend Signal*/ -+ } -+ -+ rtw_dev_remove(pdev); -+} -+ -+static int __init rtw_drv_entry(void) -+{ -+ int ret = 0; -+ -+ RTW_PRINT("module init start\n"); -+ dump_drv_version(RTW_DBGDUMP); -+#ifdef BTCOEXVERSION -+ RTW_PRINT(DRV_NAME" BT-Coex version = %s\n", BTCOEXVERSION); -+#endif /* BTCOEXVERSION */ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+ /* console_suspend_enabled=0; */ -+#endif -+ -+ pci_drvpriv.drv_registered = _TRUE; -+ rtw_suspend_lock_init(); -+ rtw_drv_proc_init(); -+ rtw_ndev_notifier_register(); -+ -+ ret = pci_register_driver(&pci_drvpriv.rtw_pci_drv); -+ -+ if (ret != 0) { -+ pci_drvpriv.drv_registered = _FALSE; -+ rtw_suspend_lock_uninit(); -+ rtw_drv_proc_deinit(); -+ rtw_ndev_notifier_unregister(); -+ goto exit; -+ } -+ -+exit: -+ RTW_PRINT("module init ret=%d\n", ret); -+ return ret; -+} -+ -+static void __exit rtw_drv_halt(void) -+{ -+ RTW_PRINT("module exit start\n"); -+ -+ pci_drvpriv.drv_registered = _FALSE; -+ -+ pci_unregister_driver(&pci_drvpriv.rtw_pci_drv); -+ -+ rtw_suspend_lock_uninit(); -+ rtw_drv_proc_deinit(); -+ rtw_ndev_notifier_unregister(); -+ -+ RTW_PRINT("module exit success\n"); -+ -+ rtw_mstat_dump(RTW_DBGDUMP); -+} -+ -+ -+module_init(rtw_drv_entry); -+module_exit(rtw_drv_halt); -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/pci_ops_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/pci_ops_linux.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/pci_ops_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/pci_ops_linux.c 2018-02-11 21:44:27.176146528 +0200 -@@ -0,0 +1,21 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ *******************************************************************************/ -+#define _PCI_OPS_LINUX_C_ -+ -+#include -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/recv_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/recv_linux.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/recv_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/recv_linux.c 2018-02-11 21:44:27.176146528 +0200 -@@ -0,0 +1,885 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _RECV_OSDEP_C_ -+ -+#include -+ -+int rtw_os_recvframe_duplicate_skb(_adapter *padapter, union recv_frame *pcloneframe, _pkt *pskb) -+{ -+ int res = _SUCCESS; -+ _pkt *pkt_copy = NULL; -+ struct rx_pkt_attrib *pattrib = &pcloneframe->u.hdr.attrib; -+ -+ if (pskb == NULL) { -+ RTW_INFO("%s [WARN] skb == NULL, drop frag frame\n", __func__); -+ return _FAIL; -+ } -+#if 1 -+ pkt_copy = rtw_skb_copy(pskb); -+ -+ if (pkt_copy == NULL) { -+ RTW_INFO("%s [WARN] rtw_skb_copy fail , drop frag frame\n", __func__); -+ return _FAIL; -+ } -+#else -+ pkt_copy = rtw_skb_clone(pskb); -+ -+ if (pkt_copy == NULL) { -+ RTW_INFO("%s [WARN] rtw_skb_clone fail , drop frag frame\n", __func__); -+ return _FAIL; -+ } -+#endif -+ pkt_copy->dev = padapter->pnetdev; -+ -+ pcloneframe->u.hdr.pkt = pkt_copy; -+ pcloneframe->u.hdr.rx_head = pkt_copy->head; -+ pcloneframe->u.hdr.rx_data = pkt_copy->data; -+ pcloneframe->u.hdr.rx_end = skb_end_pointer(pkt_copy); -+ pcloneframe->u.hdr.rx_tail = skb_tail_pointer(pkt_copy); -+ pcloneframe->u.hdr.len = pkt_copy->len; -+ -+ return res; -+} -+ -+int rtw_os_alloc_recvframe(_adapter *padapter, union recv_frame *precvframe, u8 *pdata, _pkt *pskb) -+{ -+ int res = _SUCCESS; -+ u8 shift_sz = 0; -+ u32 skb_len, alloc_sz; -+ _pkt *pkt_copy = NULL; -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ -+ -+ if (pdata == NULL) { -+ precvframe->u.hdr.pkt = NULL; -+ res = _FAIL; -+ return res; -+ } -+ -+ -+ /* Modified by Albert 20101213 */ -+ /* For 8 bytes IP header alignment. */ -+ shift_sz = pattrib->qos ? 6 : 0; /* Qos data, wireless lan header length is 26 */ -+ -+ skb_len = pattrib->pkt_len; -+ -+ /* for first fragment packet, driver need allocate 1536+drvinfo_sz+RXDESC_SIZE to defrag packet. */ -+ /* modify alloc_sz for recvive crc error packet by thomas 2011-06-02 */ -+ if ((pattrib->mfrag == 1) && (pattrib->frag_num == 0)) { -+ /* alloc_sz = 1664; */ /* 1664 is 128 alignment. */ -+ alloc_sz = (skb_len <= 1650) ? 1664 : (skb_len + 14); -+ } else { -+ alloc_sz = skb_len; -+ /* 6 is for IP header 8 bytes alignment in QoS packet case. */ -+ /* 8 is for skb->data 4 bytes alignment. */ -+ alloc_sz += 14; -+ } -+ -+ pkt_copy = rtw_skb_alloc(alloc_sz); -+ -+ if (pkt_copy) { -+ pkt_copy->dev = padapter->pnetdev; -+ pkt_copy->len = skb_len; -+ precvframe->u.hdr.pkt = pkt_copy; -+ precvframe->u.hdr.rx_head = pkt_copy->head; -+ precvframe->u.hdr.rx_end = pkt_copy->data + alloc_sz; -+ skb_reserve(pkt_copy, 8 - ((SIZE_PTR)(pkt_copy->data) & 7)); /* force pkt_copy->data at 8-byte alignment address */ -+ skb_reserve(pkt_copy, shift_sz);/* force ip_hdr at 8-byte alignment address according to shift_sz. */ -+ _rtw_memcpy(pkt_copy->data, pdata, skb_len); -+ precvframe->u.hdr.rx_data = precvframe->u.hdr.rx_tail = pkt_copy->data; -+ } else { -+#if 0 -+ { -+ rtw_free_recvframe(precvframe_if2, &precvpriv->free_recv_queue); -+ rtw_enqueue_recvbuf_to_head(precvbuf, &precvpriv->recv_buf_pending_queue); -+ -+ /* The case of can't allocate skb is serious and may never be recovered, -+ once bDriverStopped is enable, this task should be stopped.*/ -+ if (!rtw_is_drv_stopped(secondary_padapter)) -+#ifdef PLATFORM_LINUX -+ tasklet_schedule(&precvpriv->recv_tasklet); -+#endif -+ return ret; -+ } -+ -+#endif -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ RTW_INFO("%s:can not allocate memory for skb copy\n", __func__); -+ -+ precvframe->u.hdr.pkt = NULL; -+ -+ /* rtw_free_recvframe(precvframe, pfree_recv_queue); */ -+ /*exit_rtw_os_recv_resource_alloc;*/ -+ -+ res = _FAIL; -+#else -+ if ((pattrib->mfrag == 1) && (pattrib->frag_num == 0)) { -+ RTW_INFO("%s: alloc_skb fail , drop frag frame\n", __FUNCTION__); -+ /* rtw_free_recvframe(precvframe, pfree_recv_queue); */ -+ res = _FAIL; -+ goto exit_rtw_os_recv_resource_alloc; -+ } -+ -+ if (pskb == NULL) { -+ res = _FAIL; -+ goto exit_rtw_os_recv_resource_alloc; -+ } -+ -+ precvframe->u.hdr.pkt = rtw_skb_clone(pskb); -+ if (precvframe->u.hdr.pkt) { -+ precvframe->u.hdr.pkt->dev = padapter->pnetdev; -+ precvframe->u.hdr.rx_head = precvframe->u.hdr.rx_data = precvframe->u.hdr.rx_tail = pdata; -+ precvframe->u.hdr.rx_end = pdata + alloc_sz; -+ } else { -+ RTW_INFO("%s: rtw_skb_clone fail\n", __FUNCTION__); -+ /* rtw_free_recvframe(precvframe, pfree_recv_queue); */ -+ /*exit_rtw_os_recv_resource_alloc;*/ -+ res = _FAIL; -+ } -+#endif -+ } -+ -+exit_rtw_os_recv_resource_alloc: -+ -+ return res; -+ -+} -+ -+void rtw_os_free_recvframe(union recv_frame *precvframe) -+{ -+ if (precvframe->u.hdr.pkt) { -+ rtw_skb_free(precvframe->u.hdr.pkt);/* free skb by driver */ -+ -+ precvframe->u.hdr.pkt = NULL; -+ } -+} -+ -+/* init os related resource in struct recv_priv */ -+int rtw_os_recv_resource_init(struct recv_priv *precvpriv, _adapter *padapter) -+{ -+ int res = _SUCCESS; -+ -+ -+#ifdef CONFIG_RTW_NAPI -+ skb_queue_head_init(&precvpriv->rx_napi_skb_queue); -+#endif /* CONFIG_RTW_NAPI */ -+ -+ return res; -+} -+ -+/* alloc os related resource in union recv_frame */ -+int rtw_os_recv_resource_alloc(_adapter *padapter, union recv_frame *precvframe) -+{ -+ int res = _SUCCESS; -+ -+ precvframe->u.hdr.pkt_newalloc = precvframe->u.hdr.pkt = NULL; -+ -+ return res; -+} -+ -+/* free os related resource in union recv_frame */ -+void rtw_os_recv_resource_free(struct recv_priv *precvpriv) -+{ -+ sint i; -+ union recv_frame *precvframe; -+ precvframe = (union recv_frame *) precvpriv->precv_frame_buf; -+ -+ -+#ifdef CONFIG_RTW_NAPI -+ if (skb_queue_len(&precvpriv->rx_napi_skb_queue)) -+ RTW_WARN("rx_napi_skb_queue not empty\n"); -+ rtw_skb_queue_purge(&precvpriv->rx_napi_skb_queue); -+#endif /* CONFIG_RTW_NAPI */ -+ -+ for (i = 0; i < NR_RECVFRAME; i++) { -+ if (precvframe->u.hdr.pkt) { -+ rtw_skb_free(precvframe->u.hdr.pkt);/* free skb by driver */ -+ precvframe->u.hdr.pkt = NULL; -+ } -+ precvframe++; -+ } -+} -+ -+/* alloc os related resource in struct recv_buf */ -+int rtw_os_recvbuf_resource_alloc(_adapter *padapter, struct recv_buf *precvbuf) -+{ -+ int res = _SUCCESS; -+ -+#ifdef CONFIG_USB_HCI -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct usb_device *pusbd = pdvobjpriv->pusbdev; -+ -+ precvbuf->irp_pending = _FALSE; -+ precvbuf->purb = usb_alloc_urb(0, GFP_KERNEL); -+ if (precvbuf->purb == NULL) -+ res = _FAIL; -+ -+ precvbuf->pskb = NULL; -+ -+ precvbuf->pallocated_buf = precvbuf->pbuf = NULL; -+ -+ precvbuf->pdata = precvbuf->phead = precvbuf->ptail = precvbuf->pend = NULL; -+ -+ precvbuf->transfer_len = 0; -+ -+ precvbuf->len = 0; -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ precvbuf->pallocated_buf = rtw_usb_buffer_alloc(pusbd, (size_t)precvbuf->alloc_sz, &precvbuf->dma_transfer_addr); -+ precvbuf->pbuf = precvbuf->pallocated_buf; -+ if (precvbuf->pallocated_buf == NULL) -+ return _FAIL; -+#endif /* CONFIG_USE_USB_BUFFER_ALLOC_RX */ -+ -+#endif /* CONFIG_USB_HCI */ -+ -+ return res; -+} -+ -+/* free os related resource in struct recv_buf */ -+int rtw_os_recvbuf_resource_free(_adapter *padapter, struct recv_buf *precvbuf) -+{ -+ int ret = _SUCCESS; -+ -+#ifdef CONFIG_USB_HCI -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct usb_device *pusbd = pdvobjpriv->pusbdev; -+ -+ rtw_usb_buffer_free(pusbd, (size_t)precvbuf->alloc_sz, precvbuf->pallocated_buf, precvbuf->dma_transfer_addr); -+ precvbuf->pallocated_buf = NULL; -+ precvbuf->dma_transfer_addr = 0; -+ -+#endif /* CONFIG_USE_USB_BUFFER_ALLOC_RX */ -+ -+ if (precvbuf->purb) { -+ /* usb_kill_urb(precvbuf->purb); */ -+ usb_free_urb(precvbuf->purb); -+ } -+ -+#endif /* CONFIG_USB_HCI */ -+ -+ -+ if (precvbuf->pskb) { -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ if (rtw_free_skb_premem(precvbuf->pskb) != 0) -+#endif -+ rtw_skb_free(precvbuf->pskb); -+ } -+ return ret; -+ -+} -+ -+_pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 *pdata) -+{ -+ u16 eth_type; -+ u8 *data_ptr; -+ _pkt *sub_skb; -+ struct rx_pkt_attrib *pattrib; -+ -+ pattrib = &prframe->u.hdr.attrib; -+ -+#ifdef CONFIG_SKB_COPY -+ sub_skb = rtw_skb_alloc(nSubframe_Length + 12); -+ if (sub_skb) { -+ skb_reserve(sub_skb, 12); -+ data_ptr = (u8 *)skb_put(sub_skb, nSubframe_Length); -+ _rtw_memcpy(data_ptr, (pdata + ETH_HLEN), nSubframe_Length); -+ } else -+#endif /* CONFIG_SKB_COPY */ -+ { -+ sub_skb = rtw_skb_clone(prframe->u.hdr.pkt); -+ if (sub_skb) { -+ sub_skb->data = pdata + ETH_HLEN; -+ sub_skb->len = nSubframe_Length; -+ skb_set_tail_pointer(sub_skb, nSubframe_Length); -+ } else { -+ RTW_INFO("%s(): rtw_skb_clone() Fail!!!\n", __FUNCTION__); -+ return NULL; -+ } -+ } -+ -+ eth_type = RTW_GET_BE16(&sub_skb->data[6]); -+ -+ if (sub_skb->len >= 8 && -+ ((_rtw_memcmp(sub_skb->data, rtw_rfc1042_header, SNAP_SIZE) && -+ eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || -+ _rtw_memcmp(sub_skb->data, rtw_bridge_tunnel_header, SNAP_SIZE))) { -+ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ -+ skb_pull(sub_skb, SNAP_SIZE); -+ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->src, ETH_ALEN); -+ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->dst, ETH_ALEN); -+ } else { -+ u16 len; -+ /* Leave Ethernet header part of hdr and full payload */ -+ len = htons(sub_skb->len); -+ _rtw_memcpy(skb_push(sub_skb, 2), &len, 2); -+ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->src, ETH_ALEN); -+ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->dst, ETH_ALEN); -+ } -+ -+ return sub_skb; -+} -+ -+#ifdef CONFIG_RTW_NAPI -+static int napi_recv(_adapter *padapter, int budget) -+{ -+ _pkt *pskb; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ int work_done = 0; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ u8 rx_ok; -+ -+ -+ while ((work_done < budget) && -+ (!skb_queue_empty(&precvpriv->rx_napi_skb_queue))) { -+ pskb = skb_dequeue(&precvpriv->rx_napi_skb_queue); -+ if (!pskb) -+ break; -+ -+ rx_ok = _FALSE; -+ -+#ifdef CONFIG_RTW_GRO -+ if (pregistrypriv->en_gro) { -+ if (rtw_napi_gro_receive(&padapter->napi, pskb) != GRO_DROP) -+ rx_ok = _TRUE; -+ goto next; -+ } -+#endif /* CONFIG_RTW_GRO */ -+ -+ if (rtw_netif_receive_skb(padapter->pnetdev, pskb) == NET_RX_SUCCESS) -+ rx_ok = _TRUE; -+ -+next: -+ if (rx_ok == _TRUE) { -+ work_done++; -+ DBG_COUNTER(padapter->rx_logs.os_netif_ok); -+ } else { -+ DBG_COUNTER(padapter->rx_logs.os_netif_err); -+ } -+ } -+ -+ return work_done; -+} -+ -+int rtw_recv_napi_poll(struct napi_struct *napi, int budget) -+{ -+ _adapter *padapter = container_of(napi, _adapter, napi); -+ int work_done = 0; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ -+ work_done = napi_recv(padapter, budget); -+ if (work_done < budget) { -+ napi_complete(napi); -+ if (!skb_queue_empty(&precvpriv->rx_napi_skb_queue)) -+ napi_schedule(napi); -+ } -+ -+ return work_done; -+} -+#endif /* CONFIG_RTW_NAPI */ -+ -+#ifdef DBG_UDP_PKT_LOSE_11AC -+ #define PAYLOAD_LEN_LOC_OF_IP_HDR 0x10 /*ethernet payload length location of ip header (DA + SA+eth_type+(version&hdr_len)) */ -+#endif -+ -+void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, struct rx_pkt_attrib *pattrib) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+#ifdef CONFIG_BR_EXT -+ void *br_port = NULL; -+#endif -+ int ret; -+ -+ /* Indicat the packets to upper layer */ -+ if (pkt) { -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -+ _pkt *pskb2 = NULL; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ int bmcast = IS_MCAST(pattrib->dst); -+ -+ /* RTW_INFO("bmcast=%d\n", bmcast); */ -+ -+ if (_rtw_memcmp(pattrib->dst, adapter_mac_addr(padapter), ETH_ALEN) == _FALSE) { -+ /* RTW_INFO("not ap psta=%p, addr=%pM\n", psta, pattrib->dst); */ -+ -+ if (bmcast) { -+ psta = rtw_get_bcmc_stainfo(padapter); -+ pskb2 = rtw_skb_clone(pkt); -+ } else -+ psta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ -+ if (psta) { -+ struct net_device *pnetdev = (struct net_device *)padapter->pnetdev; -+ -+ /* RTW_INFO("directly forwarding to the rtw_xmit_entry\n"); */ -+ -+ /* skb->ip_summed = CHECKSUM_NONE; */ -+ pkt->dev = pnetdev; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ skb_set_queue_mapping(pkt, rtw_recv_select_queue(pkt)); -+#endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35) */ -+ -+ _rtw_xmit_entry(pkt, pnetdev); -+ -+ if (bmcast && (pskb2 != NULL)) { -+ pkt = pskb2; -+ DBG_COUNTER(padapter->rx_logs.os_indicate_ap_mcast); -+ } else { -+ DBG_COUNTER(padapter->rx_logs.os_indicate_ap_forward); -+ return; -+ } -+ } -+ } else { /* to APself */ -+ /* RTW_INFO("to APSelf\n"); */ -+ DBG_COUNTER(padapter->rx_logs.os_indicate_ap_self); -+ } -+ } -+ -+#ifdef CONFIG_BR_EXT -+ /* Insert NAT2.5 RX here! */ -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ br_port = padapter->pnetdev->br_port; -+#else /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ -+ rcu_read_lock(); -+ br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); -+ rcu_read_unlock(); -+#endif /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ -+ -+ -+ if (br_port && (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) == _TRUE)) { -+ int nat25_handle_frame(_adapter *priv, struct sk_buff *skb); -+ if (nat25_handle_frame(padapter, pkt) == -1) { -+ /* priv->ext_stats.rx_data_drops++; */ -+ /* DEBUG_ERR("RX DROP: nat25_handle_frame fail!\n"); */ -+ /* return FAIL; */ -+ -+#if 1 -+ /* bypass this frame to upper layer!! */ -+#else -+ rtw_skb_free(sub_skb); -+ continue; -+#endif -+ } -+ } -+#endif /* CONFIG_BR_EXT */ -+ if (precvpriv->sink_udpport > 0) -+ rtw_sink_rtp_seq_dbg(padapter, pkt); -+#ifdef DBG_UDP_PKT_LOSE_11AC -+ /* After eth_type_trans process , pkt->data pointer will move from ethrnet header to ip header , -+ * we have to check ethernet type , so this debug must be print before eth_type_trans -+ */ -+ if (*((unsigned short *)(pkt->data + ETH_ALEN * 2)) == htons(ETH_P_ARP)) { -+ /* ARP Payload length will be 42bytes or 42+18(tailer)=60bytes*/ -+ if (pkt->len != 42 && pkt->len != 60) -+ RTW_INFO("Error !!%s,ARP Payload length %u not correct\n" , __func__ , pkt->len); -+ } else if (*((unsigned short *)(pkt->data + ETH_ALEN * 2)) == htons(ETH_P_IP)) { -+ if (be16_to_cpu(*((u16 *)(pkt->data + PAYLOAD_LEN_LOC_OF_IP_HDR))) != (pkt->len) - ETH_HLEN) { -+ RTW_INFO("Error !!%s,Payload length not correct\n" , __func__); -+ RTW_INFO("%s, IP header describe Total length=%u\n" , __func__ , be16_to_cpu(*((u16 *)(pkt->data + PAYLOAD_LEN_LOC_OF_IP_HDR)))); -+ RTW_INFO("%s, Pkt real length=%u\n" , __func__ , (pkt->len) - ETH_HLEN); -+ } -+ } -+#endif -+ /* After eth_type_trans process , pkt->data pointer will move from ethrnet header to ip header */ -+ pkt->protocol = eth_type_trans(pkt, padapter->pnetdev); -+ pkt->dev = padapter->pnetdev; -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_RX -+ if ((pattrib->tcpchk_valid == 1) && (pattrib->tcp_chkrpt == 1)) -+ pkt->ip_summed = CHECKSUM_UNNECESSARY; -+ else -+ pkt->ip_summed = CHECKSUM_NONE; -+#else /* !CONFIG_TCP_CSUM_OFFLOAD_RX */ -+ pkt->ip_summed = CHECKSUM_NONE; -+#endif /* CONFIG_TCP_CSUM_OFFLOAD_RX */ -+ -+#ifdef CONFIG_RTW_NAPI -+ if (pregistrypriv->en_napi) { -+ skb_queue_tail(&precvpriv->rx_napi_skb_queue, pkt); -+ napi_schedule(&padapter->napi); -+ return; -+ } -+#endif /* CONFIG_RTW_NAPI */ -+ -+ ret = rtw_netif_rx(padapter->pnetdev, pkt); -+ if (ret == NET_RX_SUCCESS) -+ DBG_COUNTER(padapter->rx_logs.os_netif_ok); -+ else -+ DBG_COUNTER(padapter->rx_logs.os_netif_err); -+ } -+} -+ -+void rtw_handle_tkip_mic_err(_adapter *padapter, struct sta_info *sta, u8 bgroup) -+{ -+#ifdef CONFIG_IOCTL_CFG80211 -+ enum nl80211_key_type key_type = 0; -+#endif -+ union iwreq_data wrqu; -+ struct iw_michaelmicfailure ev; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u32 cur_time = 0; -+ -+ if (psecuritypriv->last_mic_err_time == 0) -+ psecuritypriv->last_mic_err_time = rtw_get_current_time(); -+ else { -+ cur_time = rtw_get_current_time(); -+ -+ if (cur_time - psecuritypriv->last_mic_err_time < 60 * HZ) { -+ psecuritypriv->btkip_countermeasure = _TRUE; -+ psecuritypriv->last_mic_err_time = 0; -+ psecuritypriv->btkip_countermeasure_time = cur_time; -+ } else -+ psecuritypriv->last_mic_err_time = rtw_get_current_time(); -+ } -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (bgroup) -+ key_type |= NL80211_KEYTYPE_GROUP; -+ else -+ key_type |= NL80211_KEYTYPE_PAIRWISE; -+ -+ cfg80211_michael_mic_failure(padapter->pnetdev, sta->hwaddr, key_type, -1, NULL, GFP_ATOMIC); -+#endif -+ -+ _rtw_memset(&ev, 0x00, sizeof(ev)); -+ if (bgroup) -+ ev.flags |= IW_MICFAILURE_GROUP; -+ else -+ ev.flags |= IW_MICFAILURE_PAIRWISE; -+ -+ ev.src_addr.sa_family = ARPHRD_ETHER; -+ _rtw_memcpy(ev.src_addr.sa_data, sta->hwaddr, ETH_ALEN); -+ -+ _rtw_memset(&wrqu, 0x00, sizeof(wrqu)); -+ wrqu.data.length = sizeof(ev); -+ -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(padapter->pnetdev, IWEVMICHAELMICFAILURE, &wrqu, (char *) &ev); -+#endif -+} -+ -+void rtw_hostapd_mlme_rx(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_HOSTAPD_MLME -+ _pkt *skb; -+ struct hostapd_priv *phostapdpriv = padapter->phostapdpriv; -+ struct net_device *pmgnt_netdev = phostapdpriv->pmgnt_netdev; -+ -+ -+ skb = precv_frame->u.hdr.pkt; -+ -+ if (skb == NULL) -+ return; -+ -+ skb->data = precv_frame->u.hdr.rx_data; -+ skb->tail = precv_frame->u.hdr.rx_tail; -+ skb->len = precv_frame->u.hdr.len; -+ -+ /* pskb_copy = rtw_skb_copy(skb); -+ * if(skb == NULL) goto _exit; */ -+ -+ skb->dev = pmgnt_netdev; -+ skb->ip_summed = CHECKSUM_NONE; -+ skb->pkt_type = PACKET_OTHERHOST; -+ /* skb->protocol = __constant_htons(0x0019); ETH_P_80211_RAW */ -+ skb->protocol = __constant_htons(0x0003); /*ETH_P_80211_RAW*/ -+ -+ /* RTW_INFO("(1)data=0x%x, head=0x%x, tail=0x%x, mac_header=0x%x, len=%d\n", skb->data, skb->head, skb->tail, skb->mac_header, skb->len); */ -+ -+ /* skb->mac.raw = skb->data; */ -+ skb_reset_mac_header(skb); -+ -+ /* skb_pull(skb, 24); */ -+ _rtw_memset(skb->cb, 0, sizeof(skb->cb)); -+ -+ rtw_netif_rx(pmgnt_netdev, skb); -+ -+ precv_frame->u.hdr.pkt = NULL; /* set pointer to NULL before rtw_free_recvframe() if call rtw_netif_rx() */ -+#endif -+} -+ -+#ifdef CONFIG_AUTO_AP_MODE -+static void rtw_os_ksocket_send(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ _pkt *skb = precv_frame->u.hdr.pkt; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_info *psta = precv_frame->u.hdr.psta; -+ -+ RTW_INFO("eth rx: got eth_type=0x%x\n", pattrib->eth_type); -+ -+ if (psta && psta->isrc && psta->pid > 0) { -+ u16 rx_pid; -+ -+ rx_pid = *(u16 *)(skb->data + ETH_HLEN); -+ -+ RTW_INFO("eth rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", -+ rx_pid, MAC_ARG(psta->hwaddr), psta->pid); -+ -+ if (rx_pid == psta->pid) { -+ int i; -+ u16 len = *(u16 *)(skb->data + ETH_HLEN + 2); -+ /* u16 ctrl_type = *(u16*)(skb->data+ETH_HLEN+4); */ -+ -+ /* RTW_INFO("eth, RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); */ -+ RTW_INFO("eth, RC: len=0x%x\n", len); -+ -+ for (i = 0; i < len; i++) -+ RTW_INFO("0x%x\n", *(skb->data + ETH_HLEN + 4 + i)); -+ /* RTW_INFO("0x%x\n", *(skb->data+ETH_HLEN+6+i)); */ -+ -+ RTW_INFO("eth, RC-end\n"); -+ -+#if 0 -+ /* send_sz = ksocket_send(padapter->ksock_send, &padapter->kaddr_send, (skb->data+ETH_HLEN+2), len); */ -+ rtw_recv_ksocket_send_cmd(padapter, (skb->data + ETH_HLEN + 2), len); -+ -+ /* RTW_INFO("ksocket_send size=%d\n", send_sz); */ -+#endif -+ } -+ -+ } -+ -+} -+#endif /* CONFIG_AUTO_AP_MODE */ -+ -+int rtw_recv_monitor(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ int ret = _FAIL; -+ struct recv_priv *precvpriv; -+ _queue *pfree_recv_queue; -+ _pkt *skb; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct rx_pkt_attrib *pattrib; -+ -+ if (NULL == precv_frame) -+ goto _recv_drop; -+ -+ pattrib = &precv_frame->u.hdr.attrib; -+ precvpriv = &(padapter->recvpriv); -+ pfree_recv_queue = &(precvpriv->free_recv_queue); -+ -+ skb = precv_frame->u.hdr.pkt; -+ if (skb == NULL) { -+ RTW_INFO("%s :skb==NULL something wrong!!!!\n", __func__); -+ goto _recv_drop; -+ } -+ -+ skb->data = precv_frame->u.hdr.rx_data; -+ skb_set_tail_pointer(skb, precv_frame->u.hdr.len); -+ skb->len = precv_frame->u.hdr.len; -+ skb->ip_summed = CHECKSUM_NONE; -+ skb->pkt_type = PACKET_OTHERHOST; -+ skb->protocol = htons(0x0019); /* ETH_P_80211_RAW */ -+ -+ rtw_netif_rx(padapter->pnetdev, skb); -+ -+ /* pointers to NULL before rtw_free_recvframe() */ -+ precv_frame->u.hdr.pkt = NULL; -+ -+ ret = _SUCCESS; -+ -+_recv_drop: -+ -+ /* enqueue back to free_recv_queue */ -+ if (precv_frame) -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ -+ return ret; -+ -+} -+ -+int rtw_recv_indicatepkt(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct recv_priv *precvpriv; -+ _queue *pfree_recv_queue; -+ _pkt *skb; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct rx_pkt_attrib *pattrib; -+ -+ if (NULL == precv_frame) -+ goto _recv_indicatepkt_drop; -+ -+ DBG_COUNTER(padapter->rx_logs.os_indicate); -+ pattrib = &precv_frame->u.hdr.attrib; -+ precvpriv = &(padapter->recvpriv); -+ pfree_recv_queue = &(precvpriv->free_recv_queue); -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ if (drvext_rx_handler(padapter, precv_frame->u.hdr.rx_data, precv_frame->u.hdr.len) == _SUCCESS) -+ goto _recv_indicatepkt_drop; -+#endif -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (rtw_wapi_check_for_drop(padapter, precv_frame)) { -+ WAPI_TRACE(WAPI_ERR, "%s(): Rx Reorder Drop case!!\n", __FUNCTION__); -+ goto _recv_indicatepkt_drop; -+ } -+#endif -+ -+ skb = precv_frame->u.hdr.pkt; -+ if (skb == NULL) { -+ goto _recv_indicatepkt_drop; -+ } -+ -+ -+ skb->data = precv_frame->u.hdr.rx_data; -+ -+ skb_set_tail_pointer(skb, precv_frame->u.hdr.len); -+ -+ skb->len = precv_frame->u.hdr.len; -+ -+ -+ if (pattrib->eth_type == 0x888e) -+ RTW_PRINT("recv eapol packet\n"); -+ -+#ifdef CONFIG_AUTO_AP_MODE -+#if 1 /* for testing */ -+#if 1 -+ if (0x8899 == pattrib->eth_type) { -+ rtw_os_ksocket_send(padapter, precv_frame); -+ -+ /* goto _recv_indicatepkt_drop; */ -+ } -+#else -+ if (0x8899 == pattrib->eth_type) { -+ rtw_auto_ap_mode_rx(padapter, precv_frame); -+ -+ goto _recv_indicatepkt_end; -+ } -+#endif -+#endif -+#endif /* CONFIG_AUTO_AP_MODE */ -+ -+ /* TODO: move to core */ -+ { -+ _pkt *pkt = skb; -+ struct ethhdr *etherhdr = (struct ethhdr *)pkt->data; -+ struct sta_info *sta = precv_frame->u.hdr.psta; -+ -+ if (!sta) -+ goto bypass_session_tracker; -+ -+ if (ntohs(etherhdr->h_proto) == ETH_P_IP) { -+ u8 *ip = pkt->data + 14; -+ -+ if (GET_IPV4_PROTOCOL(ip) == 0x06 /* TCP */ -+ && rtw_st_ctl_chk_reg_s_proto(&sta->st_ctl, 0x06) == _TRUE -+ ) { -+ u8 *tcp = ip + GET_IPV4_IHL(ip) * 4; -+ -+ if (rtw_st_ctl_chk_reg_rule(&sta->st_ctl, padapter, IPV4_DST(ip), TCP_DST(tcp), IPV4_SRC(ip), TCP_SRC(tcp)) == _TRUE) { -+ if (GET_TCP_SYN(tcp) && GET_TCP_ACK(tcp)) { -+ session_tracker_add_cmd(padapter, sta -+ , IPV4_DST(ip), TCP_DST(tcp) -+ , IPV4_SRC(ip), TCP_SRC(tcp)); -+ if (DBG_SESSION_TRACKER) -+ RTW_INFO(FUNC_ADPT_FMT" local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT" SYN-ACK\n" -+ , FUNC_ADPT_ARG(padapter) -+ , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp)) -+ , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp))); -+ } -+ if (GET_TCP_FIN(tcp)) { -+ session_tracker_del_cmd(padapter, sta -+ , IPV4_DST(ip), TCP_DST(tcp) -+ , IPV4_SRC(ip), TCP_SRC(tcp)); -+ if (DBG_SESSION_TRACKER) -+ RTW_INFO(FUNC_ADPT_FMT" local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT" FIN\n" -+ , FUNC_ADPT_ARG(padapter) -+ , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp)) -+ , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp))); -+ } -+ } -+ -+ } -+ } -+bypass_session_tracker: -+ ; -+ } -+ -+ rtw_os_recv_indicate_pkt(padapter, skb, pattrib); -+ -+_recv_indicatepkt_end: -+ -+ precv_frame->u.hdr.pkt = NULL; /* pointers to NULL before rtw_free_recvframe() */ -+ -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ -+ -+ -+ return _SUCCESS; -+ -+_recv_indicatepkt_drop: -+ -+ /* enqueue back to free_recv_queue */ -+ if (precv_frame) -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ -+ DBG_COUNTER(padapter->rx_logs.os_indicate_err); -+ -+ return _FAIL; -+ -+} -+ -+void rtw_os_read_port(_adapter *padapter, struct recv_buf *precvbuf) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+#ifdef CONFIG_USB_HCI -+ -+ precvbuf->ref_cnt--; -+ -+ /* free skb in recv_buf */ -+ rtw_skb_free(precvbuf->pskb); -+ -+ precvbuf->pskb = NULL; -+ -+ if (precvbuf->irp_pending == _FALSE) -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ -+ -+#endif -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ precvbuf->pskb = NULL; -+#endif -+ -+} -+void _rtw_reordering_ctrl_timeout_handler(void *FunctionContext); -+void _rtw_reordering_ctrl_timeout_handler(void *FunctionContext) -+{ -+ struct recv_reorder_ctrl *preorder_ctrl = (struct recv_reorder_ctrl *)FunctionContext; -+ rtw_reordering_ctrl_timeout_handler(preorder_ctrl); -+} -+ -+void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl) -+{ -+ _adapter *padapter = preorder_ctrl->padapter; -+ -+ _init_timer(&(preorder_ctrl->reordering_ctrl_timer), padapter->pnetdev, _rtw_reordering_ctrl_timeout_handler, preorder_ctrl); -+ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_android.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_android.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_android.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_android.c 2018-02-11 21:44:27.176146528 +0200 -@@ -0,0 +1,1280 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#if defined(CONFIG_GPIO_WAKEUP) || defined(CONFIG_RTW_SDIO_OOB_INT) -+#include -+#endif -+ -+#include -+ -+#if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) -+#include -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ #include -+#else -+ #include -+#endif -+#endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -+#define strnicmp strncasecmp -+#endif /* Linux kernel >= 4.0.0 */ -+ -+#if defined(CONFIG_GPIO_WAKEUP) || defined(CONFIG_RTW_SDIO_OOB_INT) -+#include -+#include -+#endif -+ -+#include "rtw_version.h" -+ -+extern void macstr2num(u8 *dst, u8 *src); -+ -+const char *android_wifi_cmd_str[ANDROID_WIFI_CMD_MAX] = { -+ "START", -+ "STOP", -+ "SCAN-ACTIVE", -+ "SCAN-PASSIVE", -+ "RSSI", -+ "LINKSPEED", -+ "RXFILTER-START", -+ "RXFILTER-STOP", -+ "RXFILTER-ADD", -+ "RXFILTER-REMOVE", -+ "BTCOEXSCAN-START", -+ "BTCOEXSCAN-STOP", -+ "BTCOEXMODE", -+ "SETSUSPENDOPT", -+ "P2P_DEV_ADDR", -+ "SETFWPATH", -+ "SETBAND", -+ "GETBAND", -+ "COUNTRY", -+ "P2P_SET_NOA", -+ "P2P_GET_NOA", -+ "P2P_SET_PS", -+ "SET_AP_WPS_P2P_IE", -+ -+ "MIRACAST", -+ -+#ifdef CONFIG_PNO_SUPPORT -+ "PNOSSIDCLR", -+ "PNOSETUP", -+ "PNOFORCE", -+ "PNODEBUG", -+#endif -+ -+ "MACADDR", -+ -+ "BLOCK_SCAN", -+ "BLOCK", -+ "WFD-ENABLE", -+ "WFD-DISABLE", -+ "WFD-SET-TCPPORT", -+ "WFD-SET-MAXTPUT", -+ "WFD-SET-DEVTYPE", -+ "SET_DTIM", -+ "HOSTAPD_SET_MACADDR_ACL", -+ "HOSTAPD_ACL_ADD_STA", -+ "HOSTAPD_ACL_REMOVE_STA", -+#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 1, 0)) -+ "GTK_REKEY_OFFLOAD", -+#endif /* CONFIG_GTK_OL */ -+/* Private command for P2P disable*/ -+ "P2P_DISABLE", -+ "DRIVER_VERSION" -+}; -+ -+#ifdef CONFIG_PNO_SUPPORT -+#define PNO_TLV_PREFIX 'S' -+#define PNO_TLV_VERSION '1' -+#define PNO_TLV_SUBVERSION '2' -+#define PNO_TLV_RESERVED '0' -+#define PNO_TLV_TYPE_SSID_IE 'S' -+#define PNO_TLV_TYPE_TIME 'T' -+#define PNO_TLV_FREQ_REPEAT 'R' -+#define PNO_TLV_FREQ_EXPO_MAX 'M' -+ -+typedef struct cmd_tlv { -+ char prefix; -+ char version; -+ char subver; -+ char reserved; -+} cmd_tlv_t; -+ -+#ifdef CONFIG_PNO_SET_DEBUG -+char pno_in_example[] = { -+ 'P', 'N', 'O', 'S', 'E', 'T', 'U', 'P', ' ', -+ 'S', '1', '2', '0', -+ 'S', /* 1 */ -+ 0x05, -+ 'd', 'l', 'i', 'n', 'k', -+ 'S', /* 2 */ -+ 0x06, -+ 'B', 'U', 'F', 'B', 'U', 'F', -+ 'S', /* 3 */ -+ 0x20, -+ 'a', 'b', 'c', 'd', 'e', 'f', 'g', 'h', 'i', 'j', 'k', 'l', 'm', 'n', 'o', 'p', 'q', 'r', 's', 't', 'u', 'v', 'w', 'x', 'y', 'z', '!', '@', '#', '$', '%', '^', -+ 'S', /* 4 */ -+ 0x0a, -+ '!', '@', '#', '$', '%', '^', '&', '*', '(', ')', -+ 'T', -+ '0', '5', -+ 'R', -+ '2', -+ 'M', -+ '2', -+ 0x00 -+}; -+#endif /* CONFIG_PNO_SET_DEBUG */ -+#endif /* PNO_SUPPORT */ -+ -+typedef struct android_wifi_priv_cmd { -+ char *buf; -+ int used_len; -+ int total_len; -+} android_wifi_priv_cmd; -+ -+#ifdef CONFIG_COMPAT -+typedef struct compat_android_wifi_priv_cmd { -+ compat_uptr_t buf; -+ int used_len; -+ int total_len; -+} compat_android_wifi_priv_cmd; -+#endif /* CONFIG_COMPAT */ -+ -+/** -+ * Local (static) functions and variables -+ */ -+ -+/* Initialize g_wifi_on to 1 so dhd_bus_start will be called for the first -+ * time (only) in dhd_open, subsequential wifi on will be handled by -+ * wl_android_wifi_on -+ */ -+static int g_wifi_on = _TRUE; -+ -+unsigned int oob_irq = 0; -+unsigned int oob_gpio = 0; -+ -+#ifdef CONFIG_PNO_SUPPORT -+/* -+ * rtw_android_pno_setup -+ * Description: -+ * This is used for private command. -+ * -+ * Parameter: -+ * net: net_device -+ * command: parameters from private command -+ * total_len: the length of the command. -+ * -+ * */ -+static int rtw_android_pno_setup(struct net_device *net, char *command, int total_len) -+{ -+ pno_ssid_t pno_ssids_local[MAX_PNO_LIST_COUNT]; -+ int res = -1; -+ int nssid = 0; -+ cmd_tlv_t *cmd_tlv_temp; -+ char *str_ptr; -+ int tlv_size_left; -+ int pno_time = 0; -+ int pno_repeat = 0; -+ int pno_freq_expo_max = 0; -+ int cmdlen = strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_PNOSETUP_SET]) + 1; -+ -+#ifdef CONFIG_PNO_SET_DEBUG -+ int i; -+ char *p; -+ p = pno_in_example; -+ -+ total_len = sizeof(pno_in_example); -+ str_ptr = p + cmdlen; -+#else -+ str_ptr = command + cmdlen; -+#endif -+ -+ if (total_len < (cmdlen + sizeof(cmd_tlv_t))) { -+ RTW_INFO("%s argument=%d less min size\n", __func__, total_len); -+ goto exit_proc; -+ } -+ -+ tlv_size_left = total_len - cmdlen; -+ -+ cmd_tlv_temp = (cmd_tlv_t *)str_ptr; -+ memset(pno_ssids_local, 0, sizeof(pno_ssids_local)); -+ -+ if ((cmd_tlv_temp->prefix == PNO_TLV_PREFIX) && -+ (cmd_tlv_temp->version == PNO_TLV_VERSION) && -+ (cmd_tlv_temp->subver == PNO_TLV_SUBVERSION)) { -+ -+ str_ptr += sizeof(cmd_tlv_t); -+ tlv_size_left -= sizeof(cmd_tlv_t); -+ -+ nssid = rtw_parse_ssid_list_tlv(&str_ptr, pno_ssids_local, -+ MAX_PNO_LIST_COUNT, &tlv_size_left); -+ if (nssid <= 0) { -+ RTW_INFO("SSID is not presented or corrupted ret=%d\n", nssid); -+ goto exit_proc; -+ } else { -+ if ((str_ptr[0] != PNO_TLV_TYPE_TIME) || (tlv_size_left <= 1)) { -+ RTW_INFO("%s scan duration corrupted field size %d\n", -+ __func__, tlv_size_left); -+ goto exit_proc; -+ } -+ str_ptr++; -+ pno_time = simple_strtoul(str_ptr, &str_ptr, 16); -+ RTW_INFO("%s: pno_time=%d\n", __func__, pno_time); -+ -+ if (str_ptr[0] != 0) { -+ if ((str_ptr[0] != PNO_TLV_FREQ_REPEAT)) { -+ RTW_INFO("%s pno repeat : corrupted field\n", -+ __func__); -+ goto exit_proc; -+ } -+ str_ptr++; -+ pno_repeat = simple_strtoul(str_ptr, &str_ptr, 16); -+ RTW_INFO("%s :got pno_repeat=%d\n", __FUNCTION__, pno_repeat); -+ if (str_ptr[0] != PNO_TLV_FREQ_EXPO_MAX) { -+ RTW_INFO("%s FREQ_EXPO_MAX corrupted field size\n", -+ __func__); -+ goto exit_proc; -+ } -+ str_ptr++; -+ pno_freq_expo_max = simple_strtoul(str_ptr, &str_ptr, 16); -+ RTW_INFO("%s: pno_freq_expo_max=%d\n", -+ __func__, pno_freq_expo_max); -+ } -+ } -+ } else { -+ RTW_INFO("%s get wrong TLV command\n", __FUNCTION__); -+ goto exit_proc; -+ } -+ -+ res = rtw_dev_pno_set(net, pno_ssids_local, nssid, pno_time, pno_repeat, pno_freq_expo_max); -+ -+#ifdef CONFIG_PNO_SET_DEBUG -+ rtw_dev_pno_debug(net); -+#endif -+ -+exit_proc: -+ return res; -+} -+ -+/* -+ * rtw_android_cfg80211_pno_setup -+ * Description: -+ * This is used for cfg80211 sched_scan. -+ * -+ * Parameter: -+ * net: net_device -+ * request: cfg80211_request -+ * */ -+ -+int rtw_android_cfg80211_pno_setup(struct net_device *net, -+ struct cfg80211_ssid *ssids, int n_ssids, int interval) -+{ -+ int res = -1; -+ int nssid = 0; -+ int pno_time = 0; -+ int pno_repeat = 0; -+ int pno_freq_expo_max = 0; -+ int index = 0; -+ pno_ssid_t pno_ssids_local[MAX_PNO_LIST_COUNT]; -+ -+ if (n_ssids > MAX_PNO_LIST_COUNT || n_ssids < 0) { -+ RTW_INFO("%s: nssids(%d) is invalid.\n", __func__, n_ssids); -+ return -EINVAL; -+ } -+ -+ memset(pno_ssids_local, 0, sizeof(pno_ssids_local)); -+ -+ nssid = n_ssids; -+ -+ for (index = 0 ; index < nssid ; index++) { -+ pno_ssids_local[index].SSID_len = ssids[index].ssid_len; -+ memcpy(pno_ssids_local[index].SSID, ssids[index].ssid, -+ ssids[index].ssid_len); -+ } -+ -+ pno_time = (interval / 1000); -+ -+ RTW_INFO("%s: nssids: %d, pno_time=%d\n", __func__, nssid, pno_time); -+ -+ res = rtw_dev_pno_set(net, pno_ssids_local, nssid, pno_time, -+ pno_repeat, pno_freq_expo_max); -+ -+#ifdef CONFIG_PNO_SET_DEBUG -+ rtw_dev_pno_debug(net); -+#endif -+exit_proc: -+ return res; -+} -+ -+int rtw_android_pno_enable(struct net_device *net, int pno_enable) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); -+ -+ if (pwrctl) { -+ pwrctl->wowlan_pno_enable = pno_enable; -+ RTW_INFO("%s: wowlan_pno_enable: %d\n", __func__, pwrctl->wowlan_pno_enable); -+ if (pwrctl->wowlan_pno_enable == 0) { -+ if (pwrctl->pnlo_info != NULL) { -+ rtw_mfree((u8 *)pwrctl->pnlo_info, sizeof(pno_nlo_info_t)); -+ pwrctl->pnlo_info = NULL; -+ } -+ if (pwrctl->pno_ssid_list != NULL) { -+ rtw_mfree((u8 *)pwrctl->pno_ssid_list, sizeof(pno_ssid_list_t)); -+ pwrctl->pno_ssid_list = NULL; -+ } -+ if (pwrctl->pscan_info != NULL) { -+ rtw_mfree((u8 *)pwrctl->pscan_info, sizeof(pno_scan_info_t)); -+ pwrctl->pscan_info = NULL; -+ } -+ } -+ return 0; -+ } else -+ return -1; -+} -+#endif /* CONFIG_PNO_SUPPORT */ -+ -+int rtw_android_cmdstr_to_num(char *cmdstr) -+{ -+ int cmd_num; -+ for (cmd_num = 0 ; cmd_num < ANDROID_WIFI_CMD_MAX; cmd_num++) -+ if (0 == strnicmp(cmdstr , android_wifi_cmd_str[cmd_num], strlen(android_wifi_cmd_str[cmd_num]))) -+ break; -+ -+ return cmd_num; -+} -+ -+int rtw_android_get_rssi(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *pcur_network = &pmlmepriv->cur_network; -+ int bytes_written = 0; -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { -+ bytes_written += snprintf(&command[bytes_written], total_len, "%s rssi %d", -+ pcur_network->network.Ssid.Ssid, padapter->recvpriv.rssi); -+ } -+ -+ return bytes_written; -+} -+ -+int rtw_android_get_link_speed(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *pcur_network = &pmlmepriv->cur_network; -+ int bytes_written = 0; -+ u16 link_speed = 0; -+ -+ link_speed = rtw_get_cur_max_rate(padapter) / 10; -+ bytes_written = snprintf(command, total_len, "LinkSpeed %d", link_speed); -+ -+ return bytes_written; -+} -+ -+int rtw_android_get_macaddr(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ int bytes_written = 0; -+ -+ bytes_written = snprintf(command, total_len, "Macaddr = "MAC_FMT, MAC_ARG(net->dev_addr)); -+ return bytes_written; -+} -+ -+int rtw_android_set_country(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ char *country_code = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_COUNTRY]) + 1; -+ int ret = _FAIL; -+ -+ ret = rtw_set_country(adapter, country_code); -+ -+ return (ret == _SUCCESS) ? 0 : -1; -+} -+ -+int rtw_android_get_p2p_dev_addr(struct net_device *net, char *command, int total_len) -+{ -+ int bytes_written = 0; -+ -+ /* We use the same address as our HW MAC address */ -+ _rtw_memcpy(command, net->dev_addr, ETH_ALEN); -+ -+ bytes_written = ETH_ALEN; -+ return bytes_written; -+} -+ -+int rtw_android_set_block_scan(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ char *block_value = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_BLOCK_SCAN]) + 1; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ adapter_wdev_data(adapter)->block_scan = (*block_value == '0') ? _FALSE : _TRUE; -+#endif -+ -+ return 0; -+} -+ -+int rtw_android_set_block(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ char *block_value = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_BLOCK]) + 1; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ adapter_wdev_data(adapter)->block = (*block_value == '0') ? _FALSE : _TRUE; -+#endif -+ -+ return 0; -+} -+ -+int rtw_android_setband(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ char *arg = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_SETBAND]) + 1; -+ u32 band = WIFI_FREQUENCY_BAND_AUTO; -+ int ret = _FAIL; -+ -+ if (sscanf(arg, "%u", &band) >= 1) -+ ret = rtw_set_band(adapter, band); -+ -+ return (ret == _SUCCESS) ? 0 : -1; -+} -+ -+int rtw_android_getband(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ int bytes_written = 0; -+ -+ bytes_written = snprintf(command, total_len, "%u", adapter->setband); -+ -+ return bytes_written; -+} -+ -+#ifdef CONFIG_WFD -+int rtw_android_set_miracast_mode(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ struct wifi_display_info *wfd_info = &adapter->wfd_info; -+ char *arg = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_MIRACAST]) + 1; -+ u8 mode; -+ int num; -+ int ret = _FAIL; -+ -+ num = sscanf(arg, "%hhu", &mode); -+ -+ if (num < 1) -+ goto exit; -+ -+ switch (mode) { -+ case 1: /* soruce */ -+ mode = MIRACAST_SOURCE; -+ break; -+ case 2: /* sink */ -+ mode = MIRACAST_SINK; -+ break; -+ case 0: /* disabled */ -+ default: -+ mode = MIRACAST_DISABLED; -+ break; -+ } -+ wfd_info->stack_wfd_mode = mode; -+ RTW_INFO("stack miracast mode: %s\n", get_miracast_mode_str(wfd_info->stack_wfd_mode)); -+ -+ ret = _SUCCESS; -+ -+exit: -+ return (ret == _SUCCESS) ? 0 : -1; -+} -+#endif /* CONFIG_WFD */ -+ -+int get_int_from_command(char *pcmd) -+{ -+ int i = 0; -+ -+ for (i = 0; i < strlen(pcmd); i++) { -+ if (pcmd[i] == '=') { -+ /* Skip the '=' and space characters. */ -+ i += 2; -+ break; -+ } -+ } -+ return rtw_atoi(pcmd + i) ; -+} -+ -+#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 1, 0)) -+int rtw_gtk_offload(struct net_device *net, u8 *cmd_ptr) -+{ -+ int i; -+ /* u8 *cmd_ptr = priv_cmd.buf; */ -+ struct sta_info *psta; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct security_priv *psecuritypriv = &(padapter->securitypriv); -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ -+ -+ if (psta == NULL) -+ RTW_INFO("%s, : Obtain Sta_info fail\n", __func__); -+ else { -+ /* string command length of "GTK_REKEY_OFFLOAD" */ -+ cmd_ptr += 18; -+ -+ _rtw_memcpy(psta->kek, cmd_ptr, RTW_KEK_LEN); -+ cmd_ptr += RTW_KEK_LEN; -+ /* -+ printk("supplicant KEK: "); -+ for(i=0;ikek[i]); -+ printk("\n supplicant KCK: "); -+ */ -+ _rtw_memcpy(psta->kck, cmd_ptr, RTW_KCK_LEN); -+ cmd_ptr += RTW_KCK_LEN; -+ /* -+ for(i=0;ikck[i]); -+ */ -+ _rtw_memcpy(psta->replay_ctr, cmd_ptr, RTW_REPLAY_CTR_LEN); -+ psecuritypriv->binstallKCK_KEK = _TRUE; -+ -+ /* printk("\nREPLAY_CTR: "); */ -+ /* for(i=0;ireplay_ctr[i]); */ -+ } -+ -+ return _SUCCESS; -+} -+#endif /* CONFIG_GTK_OL */ -+ -+int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) -+{ -+ int ret = 0; -+ char *command = NULL; -+ int cmd_num; -+ int bytes_written = 0; -+#ifdef CONFIG_PNO_SUPPORT -+ uint cmdlen = 0; -+ uint pno_enable = 0; -+#endif -+ android_wifi_priv_cmd priv_cmd; -+ _adapter *padapter = (_adapter *) rtw_netdev_priv(net); -+#ifdef CONFIG_WFD -+ struct wifi_display_info *pwfd_info; -+#endif -+ -+ rtw_lock_suspend(); -+ -+ if (!ifr->ifr_data) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ if (padapter->registrypriv.mp_mode == 1) { -+ ret = -EINVAL; -+ goto exit; -+ } -+#ifdef CONFIG_COMPAT -+#if (KERNEL_VERSION(4, 6, 0) > LINUX_VERSION_CODE) -+ if (is_compat_task()) { -+#else -+ if (in_compat_syscall()) { -+#endif -+ /* User space is 32-bit, use compat ioctl */ -+ compat_android_wifi_priv_cmd compat_priv_cmd; -+ -+ if (copy_from_user(&compat_priv_cmd, ifr->ifr_data, sizeof(compat_android_wifi_priv_cmd))) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ priv_cmd.buf = compat_ptr(compat_priv_cmd.buf); -+ priv_cmd.used_len = compat_priv_cmd.used_len; -+ priv_cmd.total_len = compat_priv_cmd.total_len; -+ } else -+#endif /* CONFIG_COMPAT */ -+ if (copy_from_user(&priv_cmd, ifr->ifr_data, sizeof(android_wifi_priv_cmd))) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ if (padapter->registrypriv.mp_mode == 1) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ /*RTW_INFO("%s priv_cmd.buf=%p priv_cmd.total_len=%d priv_cmd.used_len=%d\n",__func__,priv_cmd.buf,priv_cmd.total_len,priv_cmd.used_len);*/ -+ command = rtw_zmalloc(priv_cmd.total_len); -+ if (!command) { -+ RTW_INFO("%s: failed to allocate memory\n", __FUNCTION__); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ if (!access_ok(VERIFY_READ, priv_cmd.buf, priv_cmd.total_len)) { -+ RTW_INFO("%s: failed to access memory\n", __FUNCTION__); -+ ret = -EFAULT; -+ goto exit; -+ } -+ if (copy_from_user(command, (void *)priv_cmd.buf, priv_cmd.total_len)) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ RTW_INFO("%s: Android private cmd \"%s\" on %s\n" -+ , __FUNCTION__, command, ifr->ifr_name); -+ -+ cmd_num = rtw_android_cmdstr_to_num(command); -+ -+ switch (cmd_num) { -+ case ANDROID_WIFI_CMD_START: -+ /* bytes_written = wl_android_wifi_on(net); */ -+ goto response; -+ case ANDROID_WIFI_CMD_SETFWPATH: -+ goto response; -+ } -+ -+ if (!g_wifi_on) { -+ RTW_INFO("%s: Ignore private cmd \"%s\" - iface %s is down\n" -+ , __FUNCTION__, command, ifr->ifr_name); -+ ret = 0; -+ goto exit; -+ } -+ -+ if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) { -+ switch (cmd_num) { -+ case ANDROID_WIFI_CMD_WFD_ENABLE: -+ case ANDROID_WIFI_CMD_WFD_DISABLE: -+ case ANDROID_WIFI_CMD_WFD_SET_TCPPORT: -+ case ANDROID_WIFI_CMD_WFD_SET_MAX_TPUT: -+ case ANDROID_WIFI_CMD_WFD_SET_DEVTYPE: -+ goto response; -+ } -+ } -+ -+ switch (cmd_num) { -+ -+ case ANDROID_WIFI_CMD_STOP: -+ /* bytes_written = wl_android_wifi_off(net); */ -+ break; -+ -+ case ANDROID_WIFI_CMD_SCAN_ACTIVE: -+ /* rtw_set_scan_mode((_adapter *)rtw_netdev_priv(net), SCAN_ACTIVE); */ -+#ifdef CONFIG_PLATFORM_MSTAR -+#ifdef CONFIG_IOCTL_CFG80211 -+ adapter_wdev_data((_adapter *)rtw_netdev_priv(net))->bandroid_scan = _TRUE; -+#endif /* CONFIG_IOCTL_CFG80211 */ -+#endif /* CONFIG_PLATFORM_MSTAR */ -+ break; -+ case ANDROID_WIFI_CMD_SCAN_PASSIVE: -+ /* rtw_set_scan_mode((_adapter *)rtw_netdev_priv(net), SCAN_PASSIVE); */ -+ break; -+ -+ case ANDROID_WIFI_CMD_RSSI: -+ bytes_written = rtw_android_get_rssi(net, command, priv_cmd.total_len); -+ break; -+ case ANDROID_WIFI_CMD_LINKSPEED: -+ bytes_written = rtw_android_get_link_speed(net, command, priv_cmd.total_len); -+ break; -+ -+ case ANDROID_WIFI_CMD_MACADDR: -+ bytes_written = rtw_android_get_macaddr(net, command, priv_cmd.total_len); -+ break; -+ -+ case ANDROID_WIFI_CMD_BLOCK_SCAN: -+ bytes_written = rtw_android_set_block_scan(net, command, priv_cmd.total_len); -+ break; -+ -+ case ANDROID_WIFI_CMD_BLOCK: -+ bytes_written = rtw_android_set_block(net, command, priv_cmd.total_len); -+ break; -+ -+ case ANDROID_WIFI_CMD_RXFILTER_START: -+ /* bytes_written = net_os_set_packet_filter(net, 1); */ -+ break; -+ case ANDROID_WIFI_CMD_RXFILTER_STOP: -+ /* bytes_written = net_os_set_packet_filter(net, 0); */ -+ break; -+ case ANDROID_WIFI_CMD_RXFILTER_ADD: -+ /* int filter_num = *(command + strlen(CMD_RXFILTER_ADD) + 1) - '0'; */ -+ /* bytes_written = net_os_rxfilter_add_remove(net, TRUE, filter_num); */ -+ break; -+ case ANDROID_WIFI_CMD_RXFILTER_REMOVE: -+ /* int filter_num = *(command + strlen(CMD_RXFILTER_REMOVE) + 1) - '0'; */ -+ /* bytes_written = net_os_rxfilter_add_remove(net, FALSE, filter_num); */ -+ break; -+ -+ case ANDROID_WIFI_CMD_BTCOEXSCAN_START: -+ /* TBD: BTCOEXSCAN-START */ -+ break; -+ case ANDROID_WIFI_CMD_BTCOEXSCAN_STOP: -+ /* TBD: BTCOEXSCAN-STOP */ -+ break; -+ case ANDROID_WIFI_CMD_BTCOEXMODE: -+#if 0 -+ uint mode = *(command + strlen(CMD_BTCOEXMODE) + 1) - '0'; -+ if (mode == 1) -+ net_os_set_packet_filter(net, 0); /* DHCP starts */ -+ else -+ net_os_set_packet_filter(net, 1); /* DHCP ends */ -+#ifdef WL_CFG80211 -+ bytes_written = wl_cfg80211_set_btcoex_dhcp(net, command); -+#endif -+#endif -+ break; -+ -+ case ANDROID_WIFI_CMD_SETSUSPENDOPT: -+ /* bytes_written = wl_android_set_suspendopt(net, command, priv_cmd.total_len); */ -+ break; -+ -+ case ANDROID_WIFI_CMD_SETBAND: -+ bytes_written = rtw_android_setband(net, command, priv_cmd.total_len); -+ break; -+ -+ case ANDROID_WIFI_CMD_GETBAND: -+ bytes_written = rtw_android_getband(net, command, priv_cmd.total_len); -+ break; -+ -+ case ANDROID_WIFI_CMD_COUNTRY: -+ bytes_written = rtw_android_set_country(net, command, priv_cmd.total_len); -+ break; -+ -+#ifdef CONFIG_PNO_SUPPORT -+ case ANDROID_WIFI_CMD_PNOSSIDCLR_SET: -+ /* bytes_written = dhd_dev_pno_reset(net); */ -+ break; -+ case ANDROID_WIFI_CMD_PNOSETUP_SET: -+ bytes_written = rtw_android_pno_setup(net, command, priv_cmd.total_len); -+ break; -+ case ANDROID_WIFI_CMD_PNOENABLE_SET: -+ cmdlen = strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_PNOENABLE_SET]); -+ pno_enable = *(command + cmdlen + 1) - '0'; -+ bytes_written = rtw_android_pno_enable(net, pno_enable); -+ break; -+#endif -+ -+ case ANDROID_WIFI_CMD_P2P_DEV_ADDR: -+ bytes_written = rtw_android_get_p2p_dev_addr(net, command, priv_cmd.total_len); -+ break; -+ case ANDROID_WIFI_CMD_P2P_SET_NOA: -+ /* int skip = strlen(CMD_P2P_SET_NOA) + 1; */ -+ /* bytes_written = wl_cfg80211_set_p2p_noa(net, command + skip, priv_cmd.total_len - skip); */ -+ break; -+ case ANDROID_WIFI_CMD_P2P_GET_NOA: -+ /* bytes_written = wl_cfg80211_get_p2p_noa(net, command, priv_cmd.total_len); */ -+ break; -+ case ANDROID_WIFI_CMD_P2P_SET_PS: -+ /* int skip = strlen(CMD_P2P_SET_PS) + 1; */ -+ /* bytes_written = wl_cfg80211_set_p2p_ps(net, command + skip, priv_cmd.total_len - skip); */ -+ break; -+ -+#if defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P) -+ case ANDROID_WIFI_CMD_SET_AP_WPS_P2P_IE: { -+ int skip = strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_SET_AP_WPS_P2P_IE]) + 3; -+ bytes_written = rtw_cfg80211_set_mgnt_wpsp2pie(net, command + skip, priv_cmd.total_len - skip, *(command + skip - 2) - '0'); -+ break; -+ } -+#endif /* CONFIG_IOCTL_CFG80211 && CONFIG_P2P */ -+ -+#ifdef CONFIG_WFD -+ -+ case ANDROID_WIFI_CMD_MIRACAST: -+ bytes_written = rtw_android_set_miracast_mode(net, command, priv_cmd.total_len); -+ break; -+ -+ case ANDROID_WIFI_CMD_WFD_ENABLE: { -+ /* Commented by Albert 2012/07/24 */ -+ /* We can enable the WFD function by using the following command: */ -+ /* wpa_cli driver wfd-enable */ -+ -+ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) -+ rtw_wfd_enable(padapter, 1); -+ break; -+ } -+ -+ case ANDROID_WIFI_CMD_WFD_DISABLE: { -+ /* Commented by Albert 2012/07/24 */ -+ /* We can disable the WFD function by using the following command: */ -+ /* wpa_cli driver wfd-disable */ -+ -+ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) -+ rtw_wfd_enable(padapter, 0); -+ break; -+ } -+ case ANDROID_WIFI_CMD_WFD_SET_TCPPORT: { -+ /* Commented by Albert 2012/07/24 */ -+ /* We can set the tcp port number by using the following command: */ -+ /* wpa_cli driver wfd-set-tcpport = 554 */ -+ -+ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) -+ rtw_wfd_set_ctrl_port(padapter, (u16)get_int_from_command(priv_cmd.buf)); -+ break; -+ } -+ case ANDROID_WIFI_CMD_WFD_SET_MAX_TPUT: { -+ break; -+ } -+ case ANDROID_WIFI_CMD_WFD_SET_DEVTYPE: { -+ /* Commented by Albert 2012/08/28 */ -+ /* Specify the WFD device type ( WFD source/primary sink ) */ -+ -+ pwfd_info = &padapter->wfd_info; -+ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) { -+ pwfd_info->wfd_device_type = (u8) get_int_from_command(priv_cmd.buf); -+ pwfd_info->wfd_device_type &= WFD_DEVINFO_DUAL; -+ } -+ break; -+ } -+#endif -+ case ANDROID_WIFI_CMD_CHANGE_DTIM: { -+#ifdef CONFIG_LPS -+ u8 dtim; -+ u8 *ptr = (u8 *) &priv_cmd.buf; -+ -+ ptr += 9;/* string command length of "SET_DTIM"; */ -+ -+ dtim = rtw_atoi(ptr); -+ -+ RTW_INFO("DTIM=%d\n", dtim); -+ -+ rtw_lps_change_dtim_cmd(padapter, dtim); -+#endif -+ } -+ break; -+ -+#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) -+ case ANDROID_WIFI_CMD_HOSTAPD_SET_MACADDR_ACL: { -+ rtw_set_macaddr_acl(padapter, get_int_from_command(command)); -+ break; -+ } -+ case ANDROID_WIFI_CMD_HOSTAPD_ACL_ADD_STA: { -+ u8 addr[ETH_ALEN] = {0x00}; -+ macstr2num(addr, command + strlen("HOSTAPD_ACL_ADD_STA") + 3); /* 3 is space bar + "=" + space bar these 3 chars */ -+ rtw_acl_add_sta(padapter, addr); -+ break; -+ } -+ case ANDROID_WIFI_CMD_HOSTAPD_ACL_REMOVE_STA: { -+ u8 addr[ETH_ALEN] = {0x00}; -+ macstr2num(addr, command + strlen("HOSTAPD_ACL_REMOVE_STA") + 3); /* 3 is space bar + "=" + space bar these 3 chars */ -+ rtw_acl_remove_sta(padapter, addr); -+ break; -+ } -+#endif /* CONFIG_RTW_MACADDR_ACL */ -+#if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE < KERNEL_VERSION(3, 1, 0)) -+ case ANDROID_WIFI_CMD_GTK_REKEY_OFFLOAD: -+ rtw_gtk_offload(net, (u8 *)command); -+ break; -+#endif /* CONFIG_GTK_OL */ -+ case ANDROID_WIFI_CMD_P2P_DISABLE: { -+#ifdef CONFIG_P2P -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u8 channel, ch_offset; -+ u16 bwmode; -+ -+ rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); -+#endif /* CONFIG_P2P */ -+ break; -+ } -+ case ANDROID_WIFI_CMD_DRIVERVERSION: { -+ bytes_written = strlen(DRIVERVERSION); -+ snprintf(command, bytes_written + 1, DRIVERVERSION); -+ break; -+ } -+ default: -+ RTW_INFO("Unknown PRIVATE command %s - ignored\n", command); -+ snprintf(command, 3, "OK"); -+ bytes_written = strlen("OK"); -+ } -+ -+response: -+ if (bytes_written >= 0) { -+ if ((bytes_written == 0) && (priv_cmd.total_len > 0)) -+ command[0] = '\0'; -+ if (bytes_written >= priv_cmd.total_len) { -+ RTW_INFO("%s: bytes_written = %d\n", __FUNCTION__, bytes_written); -+ bytes_written = priv_cmd.total_len; -+ } else -+ bytes_written++; -+ priv_cmd.used_len = bytes_written; -+ if (copy_to_user((void *)priv_cmd.buf, command, bytes_written)) { -+ RTW_INFO("%s: failed to copy data to user buffer\n", __FUNCTION__); -+ ret = -EFAULT; -+ } -+ } else -+ ret = bytes_written; -+ -+exit: -+ rtw_unlock_suspend(); -+ if (command) -+ rtw_mfree(command, priv_cmd.total_len); -+ -+ return ret; -+} -+ -+ -+/** -+ * Functions for Android WiFi card detection -+ */ -+#if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) -+ -+static int g_wifidev_registered = 0; -+static struct semaphore wifi_control_sem; -+static struct wifi_platform_data *wifi_control_data = NULL; -+static struct resource *wifi_irqres = NULL; -+ -+static int wifi_add_dev(void); -+static void wifi_del_dev(void); -+ -+int rtw_android_wifictrl_func_add(void) -+{ -+ int ret = 0; -+ sema_init(&wifi_control_sem, 0); -+ -+ ret = wifi_add_dev(); -+ if (ret) { -+ RTW_INFO("%s: platform_driver_register failed\n", __FUNCTION__); -+ return ret; -+ } -+ g_wifidev_registered = 1; -+ -+ /* Waiting callback after platform_driver_register is done or exit with error */ -+ if (down_timeout(&wifi_control_sem, msecs_to_jiffies(1000)) != 0) { -+ ret = -EINVAL; -+ RTW_INFO("%s: platform_driver_register timeout\n", __FUNCTION__); -+ } -+ -+ return ret; -+} -+ -+void rtw_android_wifictrl_func_del(void) -+{ -+ if (g_wifidev_registered) { -+ wifi_del_dev(); -+ g_wifidev_registered = 0; -+ } -+} -+ -+void *wl_android_prealloc(int section, unsigned long size) -+{ -+ void *alloc_ptr = NULL; -+ if (wifi_control_data && wifi_control_data->mem_prealloc) { -+ alloc_ptr = wifi_control_data->mem_prealloc(section, size); -+ if (alloc_ptr) { -+ RTW_INFO("success alloc section %d\n", section); -+ if (size != 0L) -+ memset(alloc_ptr, 0, size); -+ return alloc_ptr; -+ } -+ } -+ -+ RTW_INFO("can't alloc section %d\n", section); -+ return NULL; -+} -+ -+int wifi_get_irq_number(unsigned long *irq_flags_ptr) -+{ -+ if (wifi_irqres) { -+ *irq_flags_ptr = wifi_irqres->flags & IRQF_TRIGGER_MASK; -+ return (int)wifi_irqres->start; -+ } -+#ifdef CUSTOM_OOB_GPIO_NUM -+ return CUSTOM_OOB_GPIO_NUM; -+#else -+ return -1; -+#endif -+} -+ -+int wifi_set_power(int on, unsigned long msec) -+{ -+ RTW_INFO("%s = %d\n", __FUNCTION__, on); -+ if (wifi_control_data && wifi_control_data->set_power) -+ wifi_control_data->set_power(on); -+ if (msec) -+ msleep(msec); -+ return 0; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+int wifi_get_mac_addr(unsigned char *buf) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ if (!buf) -+ return -EINVAL; -+ if (wifi_control_data && wifi_control_data->get_mac_addr) -+ return wifi_control_data->get_mac_addr(buf); -+ return -EOPNOTSUPP; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) */ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39)) || defined(COMPAT_KERNEL_RELEASE) -+void *wifi_get_country_code(char *ccode) -+{ -+ RTW_INFO("%s\n", __FUNCTION__); -+ if (!ccode) -+ return NULL; -+ if (wifi_control_data && wifi_control_data->get_country_code) -+ return wifi_control_data->get_country_code(ccode); -+ return NULL; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39)) */ -+ -+static int wifi_set_carddetect(int on) -+{ -+ RTW_INFO("%s = %d\n", __FUNCTION__, on); -+ if (wifi_control_data && wifi_control_data->set_carddetect) -+ wifi_control_data->set_carddetect(on); -+ return 0; -+} -+ -+static int wifi_probe(struct platform_device *pdev) -+{ -+ struct wifi_platform_data *wifi_ctrl = -+ (struct wifi_platform_data *)(pdev->dev.platform_data); -+ int wifi_wake_gpio = 0; -+ -+ RTW_INFO("## %s\n", __FUNCTION__); -+ wifi_irqres = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "bcmdhd_wlan_irq"); -+ -+ if (wifi_irqres == NULL) -+ wifi_irqres = platform_get_resource_byname(pdev, -+ IORESOURCE_IRQ, "bcm4329_wlan_irq"); -+ else -+ wifi_wake_gpio = wifi_irqres->start; -+ -+#if defined(CONFIG_GPIO_WAKEUP) || defined(CONFIG_RTW_SDIO_OOB_INT) -+ RTW_INFO("%s: gpio:%d wifi_wake_gpio:%d\n", __func__, -+ (int)wifi_irqres->start, wifi_wake_gpio); -+ -+ if (wifi_wake_gpio > 0) { -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ wifi_configure_gpio(); -+#else /* CONFIG_PLATFORM_INTEL_BYT */ -+ gpio_request(wifi_wake_gpio, "oob_irq"); -+ gpio_direction_input(wifi_wake_gpio); -+ oob_irq = gpio_to_irq(wifi_wake_gpio); -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+ printk("%s oob_irq:%d\n", __func__, oob_irq); -+ } else if (wifi_irqres) { -+ oob_irq = wifi_irqres->start; -+ printk("%s oob_irq:%d\n", __func__, oob_irq); -+ } -+#endif -+ wifi_control_data = wifi_ctrl; -+ -+ wifi_set_power(1, 0); /* Power On */ -+ wifi_set_carddetect(1); /* CardDetect (0->1) */ -+ -+ if (oob_irq != 0) -+ enable_irq_wake(oob_irq); -+ -+ up(&wifi_control_sem); -+ return 0; -+} -+ -+#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -+extern PADAPTER g_test_adapter; -+ -+static void shutdown_card(void) -+{ -+ u32 addr; -+ u8 tmp8, cnt = 0; -+ -+ if (NULL == g_test_adapter) { -+ RTW_INFO("%s: padapter==NULL\n", __FUNCTION__); -+ return; -+ } -+ -+#ifdef CONFIG_FWLPS_IN_IPS -+ LeaveAllPowerSaveMode(g_test_adapter); -+#endif /* CONFIG_FWLPS_IN_IPS */ -+ -+ /* Leave SDIO HCI Suspend */ -+ addr = 0x10250086; -+ rtw_write8(g_test_adapter, addr, 0); -+ do { -+ tmp8 = rtw_read8(g_test_adapter, addr); -+ cnt++; -+ RTW_INFO(FUNC_ADPT_FMT ": polling SDIO_HSUS_CTRL(0x%x)=0x%x, cnt=%d\n", -+ FUNC_ADPT_ARG(g_test_adapter), addr, tmp8, cnt); -+ -+ if (tmp8 & BIT(1)) -+ break; -+ -+ if (cnt >= 100) { -+ RTW_INFO(FUNC_ADPT_FMT ": polling 0x%x[1]==1 FAIL!!\n", -+ FUNC_ADPT_ARG(g_test_adapter), addr); -+ break; -+ } -+ -+ rtw_mdelay_os(10); -+ } while (1); -+ -+ /* unlock register I/O */ -+ rtw_write8(g_test_adapter, 0x1C, 0); -+ -+ /* enable power down function */ -+ /* 0x04[4] = 1 */ -+ /* 0x05[7] = 1 */ -+ addr = 0x04; -+ tmp8 = rtw_read8(g_test_adapter, addr); -+ tmp8 |= BIT(4); -+ rtw_write8(g_test_adapter, addr, tmp8); -+ RTW_INFO(FUNC_ADPT_FMT ": read after write 0x%x=0x%x\n", -+ FUNC_ADPT_ARG(g_test_adapter), addr, rtw_read8(g_test_adapter, addr)); -+ -+ addr = 0x05; -+ tmp8 = rtw_read8(g_test_adapter, addr); -+ tmp8 |= BIT(7); -+ rtw_write8(g_test_adapter, addr, tmp8); -+ RTW_INFO(FUNC_ADPT_FMT ": read after write 0x%x=0x%x\n", -+ FUNC_ADPT_ARG(g_test_adapter), addr, rtw_read8(g_test_adapter, addr)); -+ -+ /* lock register page0 0x0~0xB read/write */ -+ rtw_write8(g_test_adapter, 0x1C, 0x0E); -+ -+ rtw_set_surprise_removed(g_test_adapter); -+ RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=%s\n", -+ FUNC_ADPT_ARG(g_test_adapter), rtw_is_surprise_removed(g_test_adapter) ? "True" : "False"); -+} -+#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ -+ -+static int wifi_remove(struct platform_device *pdev) -+{ -+ struct wifi_platform_data *wifi_ctrl = -+ (struct wifi_platform_data *)(pdev->dev.platform_data); -+ -+ RTW_INFO("## %s\n", __FUNCTION__); -+ wifi_control_data = wifi_ctrl; -+ -+ if (oob_irq != 0) -+ disable_irq_wake(oob_irq); -+ -+ wifi_set_power(0, 0); /* Power Off */ -+ wifi_set_carddetect(0); /* CardDetect (1->0) */ -+ -+ up(&wifi_control_sem); -+ return 0; -+} -+ -+#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -+static void wifi_shutdown(struct platform_device *pdev) -+{ -+ struct wifi_platform_data *wifi_ctrl = -+ (struct wifi_platform_data *)(pdev->dev.platform_data); -+ -+ -+ RTW_INFO("## %s\n", __FUNCTION__); -+ -+ wifi_control_data = wifi_ctrl; -+ -+ shutdown_card(); -+ wifi_set_power(0, 0); /* Power Off */ -+ wifi_set_carddetect(0); /* CardDetect (1->0) */ -+} -+#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ -+ -+static int wifi_suspend(struct platform_device *pdev, pm_message_t state) -+{ -+ RTW_INFO("##> %s\n", __FUNCTION__); -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 39)) && defined(OOB_INTR_ONLY) -+ bcmsdh_oob_intr_set(0); -+#endif -+ return 0; -+} -+ -+static int wifi_resume(struct platform_device *pdev) -+{ -+ RTW_INFO("##> %s\n", __FUNCTION__); -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 39)) && defined(OOB_INTR_ONLY) -+ if (dhd_os_check_if_up(bcmsdh_get_drvdata())) -+ bcmsdh_oob_intr_set(1); -+#endif -+ return 0; -+} -+ -+/* temporarily use these two */ -+static struct platform_driver wifi_device = { -+ .probe = wifi_probe, -+ .remove = wifi_remove, -+ .suspend = wifi_suspend, -+ .resume = wifi_resume, -+#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -+ .shutdown = wifi_shutdown, -+#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ -+ .driver = { -+ .name = "bcmdhd_wlan", -+ } -+}; -+ -+static struct platform_driver wifi_device_legacy = { -+ .probe = wifi_probe, -+ .remove = wifi_remove, -+ .suspend = wifi_suspend, -+ .resume = wifi_resume, -+ .driver = { -+ .name = "bcm4329_wlan", -+ } -+}; -+ -+static int wifi_add_dev(void) -+{ -+ RTW_INFO("## Calling platform_driver_register\n"); -+ platform_driver_register(&wifi_device); -+ platform_driver_register(&wifi_device_legacy); -+ return 0; -+} -+ -+static void wifi_del_dev(void) -+{ -+ RTW_INFO("## Unregister platform_driver_register\n"); -+ platform_driver_unregister(&wifi_device); -+ platform_driver_unregister(&wifi_device_legacy); -+} -+#endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ -+ -+#if defined (CONFIG_GPIO_WAKEUP) || defined (CONFIG_RTW_SDIO_OOB_INT) -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+int wifi_configure_gpio(void) -+{ -+ if (gpio_request(oob_gpio, "oob_irq")) { -+ RTW_INFO("## %s Cannot request GPIO\n", __FUNCTION__); -+ return -1; -+ } -+ gpio_export(oob_gpio, 0); -+ if (gpio_direction_input(oob_gpio)) { -+ RTW_INFO("## %s Cannot set GPIO direction input\n", __FUNCTION__); -+ return -1; -+ } -+ oob_irq = gpio_to_irq(oob_gpio); -+ if (oob_irq < 0) { -+ RTW_INFO("## %s Cannot convert GPIO to IRQ\n", __FUNCTION__); -+ return -1; -+ } -+ -+ RTW_INFO("## %s OOB_IRQ=%d\n", __FUNCTION__, oob_irq); -+ -+ return 0; -+} -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+void wifi_free_gpio(unsigned int gpio) -+{ -+#ifdef CONFIG_PLATFORM_INTEL_BYT -+ if (gpio) -+ gpio_free(gpio); -+#endif /* CONFIG_PLATFORM_INTEL_BYT */ -+} -+#endif /* CONFIG_GPIO_WAKEUP */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.c 2018-02-11 21:44:27.176146528 +0200 -@@ -0,0 +1,1328 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2014 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) -+ -+/* -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+*/ -+ -+#include -+ -+#ifdef DBG_MEM_ALLOC -+extern bool match_mstat_sniff_rules(const enum mstat_f flags, const size_t size); -+struct sk_buff *dbg_rtw_cfg80211_vendor_event_alloc(struct wiphy *wiphy, struct wireless_dev *wdev, int len, int event_id, gfp_t gfp -+ , const enum mstat_f flags, const char *func, const int line) -+{ -+ struct sk_buff *skb; -+ unsigned int truesize = 0; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 1, 0)) -+ skb = cfg80211_vendor_event_alloc(wiphy, len, event_id, gfp); -+#else -+ skb = cfg80211_vendor_event_alloc(wiphy, wdev, len, event_id, gfp); -+#endif -+ -+ if (skb) -+ truesize = skb->truesize; -+ -+ if (!skb || truesize < len || match_mstat_sniff_rules(flags, truesize)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d), skb:%p, truesize=%u\n", func, line, __FUNCTION__, len, skb, truesize); -+ -+ rtw_mstat_update( -+ flags -+ , skb ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , truesize -+ ); -+ -+ return skb; -+} -+ -+void dbg_rtw_cfg80211_vendor_event(struct sk_buff *skb, gfp_t gfp -+ , const enum mstat_f flags, const char *func, const int line) -+{ -+ unsigned int truesize = skb->truesize; -+ -+ if (match_mstat_sniff_rules(flags, truesize)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); -+ -+ cfg80211_vendor_event(skb, gfp); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , truesize -+ ); -+} -+ -+struct sk_buff *dbg_rtw_cfg80211_vendor_cmd_alloc_reply_skb(struct wiphy *wiphy, int len -+ , const enum mstat_f flags, const char *func, const int line) -+{ -+ struct sk_buff *skb; -+ unsigned int truesize = 0; -+ -+ skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len); -+ -+ if (skb) -+ truesize = skb->truesize; -+ -+ if (!skb || truesize < len || match_mstat_sniff_rules(flags, truesize)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d), skb:%p, truesize=%u\n", func, line, __FUNCTION__, len, skb, truesize); -+ -+ rtw_mstat_update( -+ flags -+ , skb ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , truesize -+ ); -+ -+ return skb; -+} -+ -+int dbg_rtw_cfg80211_vendor_cmd_reply(struct sk_buff *skb -+ , const enum mstat_f flags, const char *func, const int line) -+{ -+ unsigned int truesize = skb->truesize; -+ int ret; -+ -+ if (match_mstat_sniff_rules(flags, truesize)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); -+ -+ ret = cfg80211_vendor_cmd_reply(skb); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , truesize -+ ); -+ -+ return ret; -+} -+ -+#define rtw_cfg80211_vendor_event_alloc(wiphy, wdev, len, event_id, gfp) \ -+ dbg_rtw_cfg80211_vendor_event_alloc(wiphy, wdev, len, event_id, gfp, MSTAT_FUNC_CFG_VENDOR | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+ -+#define rtw_cfg80211_vendor_event(skb, gfp) \ -+ dbg_rtw_cfg80211_vendor_event(skb, gfp, MSTAT_FUNC_CFG_VENDOR | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+ -+#define rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len) \ -+ dbg_rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len, MSTAT_FUNC_CFG_VENDOR | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+ -+#define rtw_cfg80211_vendor_cmd_reply(skb) \ -+ dbg_rtw_cfg80211_vendor_cmd_reply(skb, MSTAT_FUNC_CFG_VENDOR | MSTAT_TYPE_SKB, __FUNCTION__, __LINE__) -+#else -+ -+struct sk_buff *rtw_cfg80211_vendor_event_alloc( -+ struct wiphy *wiphy, struct wireless_dev *wdev, int len, int event_id, gfp_t gfp) -+{ -+ struct sk_buff *skb; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 1, 0)) -+ skb = cfg80211_vendor_event_alloc(wiphy, len, event_id, gfp); -+#else -+ skb = cfg80211_vendor_event_alloc(wiphy, wdev, len, event_id, gfp); -+#endif -+ return skb; -+} -+ -+#define rtw_cfg80211_vendor_event(skb, gfp) \ -+ cfg80211_vendor_event(skb, gfp) -+ -+#define rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len) \ -+ cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len) -+ -+#define rtw_cfg80211_vendor_cmd_reply(skb) \ -+ cfg80211_vendor_cmd_reply(skb) -+#endif /* DBG_MEM_ALLOC */ -+ -+/* -+ * This API is to be used for asynchronous vendor events. This -+ * shouldn't be used in response to a vendor command from its -+ * do_it handler context (instead rtw_cfgvendor_send_cmd_reply should -+ * be used). -+ */ -+int rtw_cfgvendor_send_async_event(struct wiphy *wiphy, -+ struct net_device *dev, int event_id, const void *data, int len) -+{ -+ u16 kflags; -+ struct sk_buff *skb; -+ -+ kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; -+ -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_event_alloc(wiphy, ndev_to_wdev(dev), len, event_id, kflags); -+ if (!skb) { -+ RTW_ERR(FUNC_NDEV_FMT" skb alloc failed", FUNC_NDEV_ARG(dev)); -+ return -ENOMEM; -+ } -+ -+ /* Push the data to the skb */ -+ nla_put_nohdr(skb, len, data); -+ -+ rtw_cfg80211_vendor_event(skb, kflags); -+ -+ return 0; -+} -+ -+static int rtw_cfgvendor_send_cmd_reply(struct wiphy *wiphy, -+ struct net_device *dev, const void *data, int len) -+{ -+ struct sk_buff *skb; -+ -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, len); -+ if (unlikely(!skb)) { -+ RTW_ERR(FUNC_NDEV_FMT" skb alloc failed", FUNC_NDEV_ARG(dev)); -+ return -ENOMEM; -+ } -+ -+ /* Push the data to the skb */ -+ nla_put_nohdr(skb, len, data); -+ -+ return rtw_cfg80211_vendor_cmd_reply(skb); -+} -+ -+#define WIFI_FEATURE_INFRA 0x0001 /* Basic infrastructure mode */ -+#define WIFI_FEATURE_INFRA_5G 0x0002 /* Support for 5 GHz Band */ -+#define WIFI_FEATURE_HOTSPOT 0x0004 /* Support for GAS/ANQP */ -+#define WIFI_FEATURE_P2P 0x0008 /* Wifi-Direct */ -+#define WIFI_FEATURE_SOFT_AP 0x0010 /* Soft AP */ -+#define WIFI_FEATURE_GSCAN 0x0020 /* Google-Scan APIs */ -+#define WIFI_FEATURE_NAN 0x0040 /* Neighbor Awareness Networking */ -+#define WIFI_FEATURE_D2D_RTT 0x0080 /* Device-to-device RTT */ -+#define WIFI_FEATURE_D2AP_RTT 0x0100 /* Device-to-AP RTT */ -+#define WIFI_FEATURE_BATCH_SCAN 0x0200 /* Batched Scan (legacy) */ -+#define WIFI_FEATURE_PNO 0x0400 /* Preferred network offload */ -+#define WIFI_FEATURE_ADDITIONAL_STA 0x0800 /* Support for two STAs */ -+#define WIFI_FEATURE_TDLS 0x1000 /* Tunnel directed link setup */ -+#define WIFI_FEATURE_TDLS_OFFCHANNEL 0x2000 /* Support for TDLS off channel */ -+#define WIFI_FEATURE_EPR 0x4000 /* Enhanced power reporting */ -+#define WIFI_FEATURE_AP_STA 0x8000 /* Support for AP STA Concurrency */ -+ -+#define MAX_FEATURE_SET_CONCURRRENT_GROUPS 3 -+ -+#include -+int rtw_dev_get_feature_set(struct net_device *dev) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); -+ HAL_VERSION *hal_ver = &HalData->VersionID; -+ -+ int feature_set = 0; -+ -+ feature_set |= WIFI_FEATURE_INFRA; -+ -+ if (IS_8814A_SERIES(*hal_ver) || IS_8812_SERIES(*hal_ver) || -+ IS_8821_SERIES(*hal_ver)) -+ feature_set |= WIFI_FEATURE_INFRA_5G; -+ -+ feature_set |= WIFI_FEATURE_P2P; -+ feature_set |= WIFI_FEATURE_SOFT_AP; -+ -+ feature_set |= WIFI_FEATURE_ADDITIONAL_STA; -+ -+ return feature_set; -+} -+ -+int *rtw_dev_get_feature_set_matrix(struct net_device *dev, int *num) -+{ -+ int feature_set_full, mem_needed; -+ int *ret; -+ -+ *num = 0; -+ mem_needed = sizeof(int) * MAX_FEATURE_SET_CONCURRRENT_GROUPS; -+ ret = (int *)rtw_malloc(mem_needed); -+ -+ if (!ret) { -+ RTW_ERR(FUNC_NDEV_FMT" failed to allocate %d bytes\n" -+ , FUNC_NDEV_ARG(dev), mem_needed); -+ return ret; -+ } -+ -+ feature_set_full = rtw_dev_get_feature_set(dev); -+ -+ ret[0] = (feature_set_full & WIFI_FEATURE_INFRA) | -+ (feature_set_full & WIFI_FEATURE_INFRA_5G) | -+ (feature_set_full & WIFI_FEATURE_NAN) | -+ (feature_set_full & WIFI_FEATURE_D2D_RTT) | -+ (feature_set_full & WIFI_FEATURE_D2AP_RTT) | -+ (feature_set_full & WIFI_FEATURE_PNO) | -+ (feature_set_full & WIFI_FEATURE_BATCH_SCAN) | -+ (feature_set_full & WIFI_FEATURE_GSCAN) | -+ (feature_set_full & WIFI_FEATURE_HOTSPOT) | -+ (feature_set_full & WIFI_FEATURE_ADDITIONAL_STA) | -+ (feature_set_full & WIFI_FEATURE_EPR); -+ -+ ret[1] = (feature_set_full & WIFI_FEATURE_INFRA) | -+ (feature_set_full & WIFI_FEATURE_INFRA_5G) | -+ /* Not yet verified NAN with P2P */ -+ /* (feature_set_full & WIFI_FEATURE_NAN) | */ -+ (feature_set_full & WIFI_FEATURE_P2P) | -+ (feature_set_full & WIFI_FEATURE_D2AP_RTT) | -+ (feature_set_full & WIFI_FEATURE_D2D_RTT) | -+ (feature_set_full & WIFI_FEATURE_EPR); -+ -+ ret[2] = (feature_set_full & WIFI_FEATURE_INFRA) | -+ (feature_set_full & WIFI_FEATURE_INFRA_5G) | -+ (feature_set_full & WIFI_FEATURE_NAN) | -+ (feature_set_full & WIFI_FEATURE_D2D_RTT) | -+ (feature_set_full & WIFI_FEATURE_D2AP_RTT) | -+ (feature_set_full & WIFI_FEATURE_TDLS) | -+ (feature_set_full & WIFI_FEATURE_TDLS_OFFCHANNEL) | -+ (feature_set_full & WIFI_FEATURE_EPR); -+ *num = MAX_FEATURE_SET_CONCURRRENT_GROUPS; -+ -+ return ret; -+} -+ -+static int rtw_cfgvendor_get_feature_set(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ int reply; -+ -+ reply = rtw_dev_get_feature_set(wdev_to_ndev(wdev)); -+ -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, wdev_to_ndev(wdev), &reply, sizeof(int)); -+ -+ if (unlikely(err)) -+ RTW_ERR(FUNC_NDEV_FMT" Vendor Command reply failed ret:%d\n" -+ , FUNC_NDEV_ARG(wdev_to_ndev(wdev)), err); -+ -+ return err; -+} -+ -+static int rtw_cfgvendor_get_feature_set_matrix(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct sk_buff *skb; -+ int *reply; -+ int num, mem_needed, i; -+ -+ reply = rtw_dev_get_feature_set_matrix(wdev_to_ndev(wdev), &num); -+ -+ if (!reply) { -+ RTW_ERR(FUNC_NDEV_FMT" Could not get feature list matrix\n" -+ , FUNC_NDEV_ARG(wdev_to_ndev(wdev))); -+ err = -EINVAL; -+ return err; -+ } -+ -+ mem_needed = VENDOR_REPLY_OVERHEAD + (ATTRIBUTE_U32_LEN * num) + -+ ATTRIBUTE_U32_LEN; -+ -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, mem_needed); -+ if (unlikely(!skb)) { -+ RTW_ERR(FUNC_NDEV_FMT" skb alloc failed", FUNC_NDEV_ARG(wdev_to_ndev(wdev))); -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ nla_put_u32(skb, ANDR_WIFI_ATTRIBUTE_NUM_FEATURE_SET, num); -+ for (i = 0; i < num; i++) -+ nla_put_u32(skb, ANDR_WIFI_ATTRIBUTE_FEATURE_SET, reply[i]); -+ -+ err = rtw_cfg80211_vendor_cmd_reply(skb); -+ -+ if (unlikely(err)) -+ RTW_ERR(FUNC_NDEV_FMT" Vendor Command reply failed ret:%d\n" -+ , FUNC_NDEV_ARG(wdev_to_ndev(wdev)), err); -+exit: -+ rtw_mfree((u8 *)reply, sizeof(int) * num); -+ return err; -+} -+ -+#if defined(GSCAN_SUPPORT) && 0 -+int wl_cfgvendor_send_hotlist_event(struct wiphy *wiphy, -+ struct net_device *dev, void *data, int len, wl_vendor_event_t event) -+{ -+ u16 kflags; -+ const void *ptr; -+ struct sk_buff *skb; -+ int malloc_len, total, iter_cnt_to_send, cnt; -+ gscan_results_cache_t *cache = (gscan_results_cache_t *)data; -+ -+ total = len / sizeof(wifi_gscan_result_t); -+ while (total > 0) { -+ malloc_len = (total * sizeof(wifi_gscan_result_t)) + VENDOR_DATA_OVERHEAD; -+ if (malloc_len > NLMSG_DEFAULT_SIZE) -+ malloc_len = NLMSG_DEFAULT_SIZE; -+ iter_cnt_to_send = -+ (malloc_len - VENDOR_DATA_OVERHEAD) / sizeof(wifi_gscan_result_t); -+ total = total - iter_cnt_to_send; -+ -+ kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; -+ -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_event_alloc(wiphy, ndev_to_wdev(dev), malloc_len, event, kflags); -+ if (!skb) { -+ WL_ERR(("skb alloc failed")); -+ return -ENOMEM; -+ } -+ -+ while (cache && iter_cnt_to_send) { -+ ptr = (const void *) &cache->results[cache->tot_consumed]; -+ -+ if (iter_cnt_to_send < (cache->tot_count - cache->tot_consumed)) -+ cnt = iter_cnt_to_send; -+ else -+ cnt = (cache->tot_count - cache->tot_consumed); -+ -+ iter_cnt_to_send -= cnt; -+ cache->tot_consumed += cnt; -+ /* Push the data to the skb */ -+ nla_append(skb, cnt * sizeof(wifi_gscan_result_t), ptr); -+ if (cache->tot_consumed == cache->tot_count) -+ cache = cache->next; -+ -+ } -+ -+ rtw_cfg80211_vendor_event(skb, kflags); -+ } -+ -+ return 0; -+} -+ -+ -+static int wl_cfgvendor_gscan_get_capabilities(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ dhd_pno_gscan_capabilities_t *reply = NULL; -+ uint32 reply_len = 0; -+ -+ -+ reply = dhd_dev_pno_get_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_GET_CAPABILITIES, NULL, &reply_len); -+ if (!reply) { -+ WL_ERR(("Could not get capabilities\n")); -+ err = -EINVAL; -+ return err; -+ } -+ -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), -+ reply, reply_len); -+ -+ if (unlikely(err)) -+ WL_ERR(("Vendor Command reply failed ret:%d\n", err)); -+ -+ kfree(reply); -+ return err; -+} -+ -+static int wl_cfgvendor_gscan_get_channel_list(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0, type, band; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ uint16 *reply = NULL; -+ uint32 reply_len = 0, num_channels, mem_needed; -+ struct sk_buff *skb; -+ -+ type = nla_type(data); -+ -+ if (type == GSCAN_ATTRIBUTE_BAND) -+ band = nla_get_u32(data); -+ else -+ return -1; -+ -+ reply = dhd_dev_pno_get_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_GET_CHANNEL_LIST, &band, &reply_len); -+ -+ if (!reply) { -+ WL_ERR(("Could not get channel list\n")); -+ err = -EINVAL; -+ return err; -+ } -+ num_channels = reply_len / sizeof(uint32); -+ mem_needed = reply_len + VENDOR_REPLY_OVERHEAD + (ATTRIBUTE_U32_LEN * 2); -+ -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, mem_needed); -+ if (unlikely(!skb)) { -+ WL_ERR(("skb alloc failed")); -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ nla_put_u32(skb, GSCAN_ATTRIBUTE_NUM_CHANNELS, num_channels); -+ nla_put(skb, GSCAN_ATTRIBUTE_CHANNEL_LIST, reply_len, reply); -+ -+ err = rtw_cfg80211_vendor_cmd_reply(skb); -+ -+ if (unlikely(err)) -+ WL_ERR(("Vendor Command reply failed ret:%d\n", err)); -+exit: -+ kfree(reply); -+ return err; -+} -+ -+static int wl_cfgvendor_gscan_get_batch_results(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ gscan_results_cache_t *results, *iter; -+ uint32 reply_len, complete = 0, num_results_iter; -+ int32 mem_needed; -+ wifi_gscan_result_t *ptr; -+ uint16 num_scan_ids, num_results; -+ struct sk_buff *skb; -+ struct nlattr *scan_hdr; -+ -+ dhd_dev_wait_batch_results_complete(bcmcfg_to_prmry_ndev(cfg)); -+ dhd_dev_pno_lock_access_batch_results(bcmcfg_to_prmry_ndev(cfg)); -+ results = dhd_dev_pno_get_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_GET_BATCH_RESULTS, NULL, &reply_len); -+ -+ if (!results) { -+ WL_ERR(("No results to send %d\n", err)); -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), -+ results, 0); -+ -+ if (unlikely(err)) -+ WL_ERR(("Vendor Command reply failed ret:%d\n", err)); -+ dhd_dev_pno_unlock_access_batch_results(bcmcfg_to_prmry_ndev(cfg)); -+ return err; -+ } -+ num_scan_ids = reply_len & 0xFFFF; -+ num_results = (reply_len & 0xFFFF0000) >> 16; -+ mem_needed = (num_results * sizeof(wifi_gscan_result_t)) + -+ (num_scan_ids * GSCAN_BATCH_RESULT_HDR_LEN) + -+ VENDOR_REPLY_OVERHEAD + SCAN_RESULTS_COMPLETE_FLAG_LEN; -+ -+ if (mem_needed > (int32)NLMSG_DEFAULT_SIZE) { -+ mem_needed = (int32)NLMSG_DEFAULT_SIZE; -+ complete = 0; -+ } else -+ complete = 1; -+ -+ WL_TRACE(("complete %d mem_needed %d max_mem %d\n", complete, mem_needed, -+ (int)NLMSG_DEFAULT_SIZE)); -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_cmd_alloc_reply_skb(wiphy, mem_needed); -+ if (unlikely(!skb)) { -+ WL_ERR(("skb alloc failed")); -+ dhd_dev_pno_unlock_access_batch_results(bcmcfg_to_prmry_ndev(cfg)); -+ return -ENOMEM; -+ } -+ iter = results; -+ -+ nla_put_u32(skb, GSCAN_ATTRIBUTE_SCAN_RESULTS_COMPLETE, complete); -+ -+ mem_needed = mem_needed - (SCAN_RESULTS_COMPLETE_FLAG_LEN + VENDOR_REPLY_OVERHEAD); -+ -+ while (iter && ((mem_needed - GSCAN_BATCH_RESULT_HDR_LEN) > 0)) { -+ scan_hdr = nla_nest_start(skb, GSCAN_ATTRIBUTE_SCAN_RESULTS); -+ nla_put_u32(skb, GSCAN_ATTRIBUTE_SCAN_ID, iter->scan_id); -+ nla_put_u8(skb, GSCAN_ATTRIBUTE_SCAN_FLAGS, iter->flag); -+ num_results_iter = -+ (mem_needed - GSCAN_BATCH_RESULT_HDR_LEN) / sizeof(wifi_gscan_result_t); -+ -+ if ((iter->tot_count - iter->tot_consumed) < num_results_iter) -+ num_results_iter = iter->tot_count - iter->tot_consumed; -+ -+ nla_put_u32(skb, GSCAN_ATTRIBUTE_NUM_OF_RESULTS, num_results_iter); -+ if (num_results_iter) { -+ ptr = &iter->results[iter->tot_consumed]; -+ iter->tot_consumed += num_results_iter; -+ nla_put(skb, GSCAN_ATTRIBUTE_SCAN_RESULTS, -+ num_results_iter * sizeof(wifi_gscan_result_t), ptr); -+ } -+ nla_nest_end(skb, scan_hdr); -+ mem_needed -= GSCAN_BATCH_RESULT_HDR_LEN + -+ (num_results_iter * sizeof(wifi_gscan_result_t)); -+ iter = iter->next; -+ } -+ -+ dhd_dev_gscan_batch_cache_cleanup(bcmcfg_to_prmry_ndev(cfg)); -+ dhd_dev_pno_unlock_access_batch_results(bcmcfg_to_prmry_ndev(cfg)); -+ -+ return rtw_cfg80211_vendor_cmd_reply(skb); -+} -+ -+static int wl_cfgvendor_initiate_gscan(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ int type, tmp = len; -+ int run = 0xFF; -+ int flush = 0; -+ const struct nlattr *iter; -+ -+ nla_for_each_attr(iter, data, len, tmp) { -+ type = nla_type(iter); -+ if (type == GSCAN_ATTRIBUTE_ENABLE_FEATURE) -+ run = nla_get_u32(iter); -+ else if (type == GSCAN_ATTRIBUTE_FLUSH_FEATURE) -+ flush = nla_get_u32(iter); -+ } -+ -+ if (run != 0xFF) { -+ err = dhd_dev_pno_run_gscan(bcmcfg_to_prmry_ndev(cfg), run, flush); -+ -+ if (unlikely(err)) -+ WL_ERR(("Could not run gscan:%d\n", err)); -+ return err; -+ } else -+ return -1; -+ -+ -+} -+ -+static int wl_cfgvendor_enable_full_scan_result(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ int type; -+ bool real_time = FALSE; -+ -+ type = nla_type(data); -+ -+ if (type == GSCAN_ATTRIBUTE_ENABLE_FULL_SCAN_RESULTS) { -+ real_time = nla_get_u32(data); -+ -+ err = dhd_dev_pno_enable_full_scan_result(bcmcfg_to_prmry_ndev(cfg), real_time); -+ -+ if (unlikely(err)) -+ WL_ERR(("Could not run gscan:%d\n", err)); -+ -+ } else -+ err = -1; -+ -+ return err; -+} -+ -+static int wl_cfgvendor_set_scan_cfg(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ gscan_scan_params_t *scan_param; -+ int j = 0; -+ int type, tmp, tmp1, tmp2, k = 0; -+ const struct nlattr *iter, *iter1, *iter2; -+ struct dhd_pno_gscan_channel_bucket *ch_bucket; -+ -+ scan_param = kzalloc(sizeof(gscan_scan_params_t), GFP_KERNEL); -+ if (!scan_param) { -+ WL_ERR(("Could not set GSCAN scan cfg, mem alloc failure\n")); -+ err = -EINVAL; -+ return err; -+ -+ } -+ -+ scan_param->scan_fr = PNO_SCAN_MIN_FW_SEC; -+ nla_for_each_attr(iter, data, len, tmp) { -+ type = nla_type(iter); -+ -+ if (j >= GSCAN_MAX_CH_BUCKETS) -+ break; -+ -+ switch (type) { -+ case GSCAN_ATTRIBUTE_BASE_PERIOD: -+ scan_param->scan_fr = nla_get_u32(iter) / 1000; -+ break; -+ case GSCAN_ATTRIBUTE_NUM_BUCKETS: -+ scan_param->nchannel_buckets = nla_get_u32(iter); -+ break; -+ case GSCAN_ATTRIBUTE_CH_BUCKET_1: -+ case GSCAN_ATTRIBUTE_CH_BUCKET_2: -+ case GSCAN_ATTRIBUTE_CH_BUCKET_3: -+ case GSCAN_ATTRIBUTE_CH_BUCKET_4: -+ case GSCAN_ATTRIBUTE_CH_BUCKET_5: -+ case GSCAN_ATTRIBUTE_CH_BUCKET_6: -+ case GSCAN_ATTRIBUTE_CH_BUCKET_7: -+ nla_for_each_nested(iter1, iter, tmp1) { -+ type = nla_type(iter1); -+ ch_bucket = -+ scan_param->channel_bucket; -+ -+ switch (type) { -+ case GSCAN_ATTRIBUTE_BUCKET_ID: -+ break; -+ case GSCAN_ATTRIBUTE_BUCKET_PERIOD: -+ ch_bucket[j].bucket_freq_multiple = -+ nla_get_u32(iter1) / 1000; -+ break; -+ case GSCAN_ATTRIBUTE_BUCKET_NUM_CHANNELS: -+ ch_bucket[j].num_channels = -+ nla_get_u32(iter1); -+ break; -+ case GSCAN_ATTRIBUTE_BUCKET_CHANNELS: -+ nla_for_each_nested(iter2, iter1, tmp2) { -+ if (k >= PFN_SWC_RSSI_WINDOW_MAX) -+ break; -+ ch_bucket[j].chan_list[k] = -+ nla_get_u32(iter2); -+ k++; -+ } -+ k = 0; -+ break; -+ case GSCAN_ATTRIBUTE_BUCKETS_BAND: -+ ch_bucket[j].band = (uint16) -+ nla_get_u32(iter1); -+ break; -+ case GSCAN_ATTRIBUTE_REPORT_EVENTS: -+ ch_bucket[j].report_flag = (uint8) -+ nla_get_u32(iter1); -+ break; -+ } -+ } -+ j++; -+ break; -+ } -+ } -+ -+ if (dhd_dev_pno_set_cfg_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_SCAN_CFG_ID, scan_param, 0) < 0) { -+ WL_ERR(("Could not set GSCAN scan cfg\n")); -+ err = -EINVAL; -+ } -+ -+ kfree(scan_param); -+ return err; -+ -+} -+ -+static int wl_cfgvendor_hotlist_cfg(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ gscan_hotlist_scan_params_t *hotlist_params; -+ int tmp, tmp1, tmp2, type, j = 0, dummy; -+ const struct nlattr *outer, *inner, *iter; -+ uint8 flush = 0; -+ struct bssid_t *pbssid; -+ -+ hotlist_params = (gscan_hotlist_scan_params_t *)kzalloc(len, GFP_KERNEL); -+ if (!hotlist_params) { -+ WL_ERR(("Cannot Malloc mem to parse config commands size - %d bytes\n", len)); -+ return -1; -+ } -+ -+ hotlist_params->lost_ap_window = GSCAN_LOST_AP_WINDOW_DEFAULT; -+ -+ nla_for_each_attr(iter, data, len, tmp2) { -+ type = nla_type(iter); -+ switch (type) { -+ case GSCAN_ATTRIBUTE_HOTLIST_BSSIDS: -+ pbssid = hotlist_params->bssid; -+ nla_for_each_nested(outer, iter, tmp) { -+ nla_for_each_nested(inner, outer, tmp1) { -+ type = nla_type(inner); -+ -+ switch (type) { -+ case GSCAN_ATTRIBUTE_BSSID: -+ memcpy(&(pbssid[j].macaddr), -+ nla_data(inner), ETHER_ADDR_LEN); -+ break; -+ case GSCAN_ATTRIBUTE_RSSI_LOW: -+ pbssid[j].rssi_reporting_threshold = -+ (int8) nla_get_u8(inner); -+ break; -+ case GSCAN_ATTRIBUTE_RSSI_HIGH: -+ dummy = (int8) nla_get_u8(inner); -+ break; -+ } -+ } -+ j++; -+ } -+ hotlist_params->nbssid = j; -+ break; -+ case GSCAN_ATTRIBUTE_HOTLIST_FLUSH: -+ flush = nla_get_u8(iter); -+ break; -+ case GSCAN_ATTRIBUTE_LOST_AP_SAMPLE_SIZE: -+ hotlist_params->lost_ap_window = nla_get_u32(iter); -+ break; -+ } -+ -+ } -+ -+ if (dhd_dev_pno_set_cfg_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_GEOFENCE_SCAN_CFG_ID, hotlist_params, flush) < 0) { -+ WL_ERR(("Could not set GSCAN HOTLIST cfg\n")); -+ err = -EINVAL; -+ goto exit; -+ } -+exit: -+ kfree(hotlist_params); -+ return err; -+} -+static int wl_cfgvendor_set_batch_scan_cfg(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0, tmp, type; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ gscan_batch_params_t batch_param; -+ const struct nlattr *iter; -+ -+ batch_param.mscan = batch_param.bestn = 0; -+ batch_param.buffer_threshold = GSCAN_BATCH_NO_THR_SET; -+ -+ nla_for_each_attr(iter, data, len, tmp) { -+ type = nla_type(iter); -+ -+ switch (type) { -+ case GSCAN_ATTRIBUTE_NUM_AP_PER_SCAN: -+ batch_param.bestn = nla_get_u32(iter); -+ break; -+ case GSCAN_ATTRIBUTE_NUM_SCANS_TO_CACHE: -+ batch_param.mscan = nla_get_u32(iter); -+ break; -+ case GSCAN_ATTRIBUTE_REPORT_THRESHOLD: -+ batch_param.buffer_threshold = nla_get_u32(iter); -+ break; -+ } -+ } -+ -+ if (dhd_dev_pno_set_cfg_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_BATCH_SCAN_CFG_ID, &batch_param, 0) < 0) { -+ WL_ERR(("Could not set batch cfg\n")); -+ err = -EINVAL; -+ return err; -+ } -+ -+ return err; -+} -+ -+static int wl_cfgvendor_significant_change_cfg(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ gscan_swc_params_t *significant_params; -+ int tmp, tmp1, tmp2, type, j = 0; -+ const struct nlattr *outer, *inner, *iter; -+ uint8 flush = 0; -+ wl_pfn_significant_bssid_t *pbssid; -+ -+ significant_params = (gscan_swc_params_t *) kzalloc(len, GFP_KERNEL); -+ if (!significant_params) { -+ WL_ERR(("Cannot Malloc mem to parse config commands size - %d bytes\n", len)); -+ return -1; -+ } -+ -+ -+ nla_for_each_attr(iter, data, len, tmp2) { -+ type = nla_type(iter); -+ -+ switch (type) { -+ case GSCAN_ATTRIBUTE_SIGNIFICANT_CHANGE_FLUSH: -+ flush = nla_get_u8(iter); -+ break; -+ case GSCAN_ATTRIBUTE_RSSI_SAMPLE_SIZE: -+ significant_params->rssi_window = nla_get_u16(iter); -+ break; -+ case GSCAN_ATTRIBUTE_LOST_AP_SAMPLE_SIZE: -+ significant_params->lost_ap_window = nla_get_u16(iter); -+ break; -+ case GSCAN_ATTRIBUTE_MIN_BREACHING: -+ significant_params->swc_threshold = nla_get_u16(iter); -+ break; -+ case GSCAN_ATTRIBUTE_SIGNIFICANT_CHANGE_BSSIDS: -+ pbssid = significant_params->bssid_elem_list; -+ nla_for_each_nested(outer, iter, tmp) { -+ nla_for_each_nested(inner, outer, tmp1) { -+ switch (nla_type(inner)) { -+ case GSCAN_ATTRIBUTE_BSSID: -+ memcpy(&(pbssid[j].macaddr), -+ nla_data(inner), -+ ETHER_ADDR_LEN); -+ break; -+ case GSCAN_ATTRIBUTE_RSSI_HIGH: -+ pbssid[j].rssi_high_threshold = -+ (int8) nla_get_u8(inner); -+ break; -+ case GSCAN_ATTRIBUTE_RSSI_LOW: -+ pbssid[j].rssi_low_threshold = -+ (int8) nla_get_u8(inner); -+ break; -+ } -+ } -+ j++; -+ } -+ break; -+ } -+ } -+ significant_params->nbssid = j; -+ -+ if (dhd_dev_pno_set_cfg_gscan(bcmcfg_to_prmry_ndev(cfg), -+ DHD_PNO_SIGNIFICANT_SCAN_CFG_ID, significant_params, flush) < 0) { -+ WL_ERR(("Could not set GSCAN significant cfg\n")); -+ err = -EINVAL; -+ goto exit; -+ } -+exit: -+ kfree(significant_params); -+ return err; -+} -+#endif /* GSCAN_SUPPORT */ -+ -+#if defined(RTT_SUPPORT) && 0 -+void wl_cfgvendor_rtt_evt(void *ctx, void *rtt_data) -+{ -+ struct wireless_dev *wdev = (struct wireless_dev *)ctx; -+ struct wiphy *wiphy; -+ struct sk_buff *skb; -+ uint32 tot_len = NLMSG_DEFAULT_SIZE, entry_len = 0; -+ gfp_t kflags; -+ rtt_report_t *rtt_report = NULL; -+ rtt_result_t *rtt_result = NULL; -+ struct list_head *rtt_list; -+ wiphy = wdev->wiphy; -+ -+ WL_DBG(("In\n")); -+ /* Push the data to the skb */ -+ if (!rtt_data) { -+ WL_ERR(("rtt_data is NULL\n")); -+ goto exit; -+ } -+ rtt_list = (struct list_head *)rtt_data; -+ kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; -+ /* Alloc the SKB for vendor_event */ -+ skb = rtw_cfg80211_vendor_event_alloc(wiphy, wdev, tot_len, GOOGLE_RTT_COMPLETE_EVENT, kflags); -+ if (!skb) { -+ WL_ERR(("skb alloc failed")); -+ goto exit; -+ } -+ /* fill in the rtt results on each entry */ -+ list_for_each_entry(rtt_result, rtt_list, list) { -+ entry_len = 0; -+ if (rtt_result->TOF_type == TOF_TYPE_ONE_WAY) { -+ entry_len = sizeof(rtt_report_t); -+ rtt_report = kzalloc(entry_len, kflags); -+ if (!rtt_report) { -+ WL_ERR(("rtt_report alloc failed")); -+ goto exit; -+ } -+ rtt_report->addr = rtt_result->peer_mac; -+ rtt_report->num_measurement = 1; /* ONE SHOT */ -+ rtt_report->status = rtt_result->err_code; -+ rtt_report->type = (rtt_result->TOF_type == TOF_TYPE_ONE_WAY) ? RTT_ONE_WAY : RTT_TWO_WAY; -+ rtt_report->peer = rtt_result->target_info->peer; -+ rtt_report->channel = rtt_result->target_info->channel; -+ rtt_report->rssi = rtt_result->avg_rssi; -+ /* tx_rate */ -+ rtt_report->tx_rate = rtt_result->tx_rate; -+ /* RTT */ -+ rtt_report->rtt = rtt_result->meanrtt; -+ rtt_report->rtt_sd = rtt_result->sdrtt; -+ /* convert to centi meter */ -+ if (rtt_result->distance != 0xffffffff) -+ rtt_report->distance = (rtt_result->distance >> 2) * 25; -+ else /* invalid distance */ -+ rtt_report->distance = -1; -+ -+ rtt_report->ts = rtt_result->ts; -+ nla_append(skb, entry_len, rtt_report); -+ kfree(rtt_report); -+ } -+ } -+ rtw_cfg80211_vendor_event(skb, kflags); -+exit: -+ return; -+} -+ -+static int wl_cfgvendor_rtt_set_config(struct wiphy *wiphy, struct wireless_dev *wdev, -+ const void *data, int len) -+{ -+ int err = 0, rem, rem1, rem2, type; -+ rtt_config_params_t rtt_param; -+ rtt_target_info_t *rtt_target = NULL; -+ const struct nlattr *iter, *iter1, *iter2; -+ int8 eabuf[ETHER_ADDR_STR_LEN]; -+ int8 chanbuf[CHANSPEC_STR_LEN]; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ -+ WL_DBG(("In\n")); -+ err = dhd_dev_rtt_register_noti_callback(wdev->netdev, wdev, wl_cfgvendor_rtt_evt); -+ if (err < 0) { -+ WL_ERR(("failed to register rtt_noti_callback\n")); -+ goto exit; -+ } -+ memset(&rtt_param, 0, sizeof(rtt_param)); -+ nla_for_each_attr(iter, data, len, rem) { -+ type = nla_type(iter); -+ switch (type) { -+ case RTT_ATTRIBUTE_TARGET_CNT: -+ rtt_param.rtt_target_cnt = nla_get_u8(iter); -+ if (rtt_param.rtt_target_cnt > RTT_MAX_TARGET_CNT) { -+ WL_ERR(("exceed max target count : %d\n", -+ rtt_param.rtt_target_cnt)); -+ err = BCME_RANGE; -+ } -+ break; -+ case RTT_ATTRIBUTE_TARGET_INFO: -+ rtt_target = rtt_param.target_info; -+ nla_for_each_nested(iter1, iter, rem1) { -+ nla_for_each_nested(iter2, iter1, rem2) { -+ type = nla_type(iter2); -+ switch (type) { -+ case RTT_ATTRIBUTE_TARGET_MAC: -+ memcpy(&rtt_target->addr, nla_data(iter2), ETHER_ADDR_LEN); -+ break; -+ case RTT_ATTRIBUTE_TARGET_TYPE: -+ rtt_target->type = nla_get_u8(iter2); -+ break; -+ case RTT_ATTRIBUTE_TARGET_PEER: -+ rtt_target->peer = nla_get_u8(iter2); -+ break; -+ case RTT_ATTRIBUTE_TARGET_CHAN: -+ memcpy(&rtt_target->channel, nla_data(iter2), -+ sizeof(rtt_target->channel)); -+ break; -+ case RTT_ATTRIBUTE_TARGET_MODE: -+ rtt_target->continuous = nla_get_u8(iter2); -+ break; -+ case RTT_ATTRIBUTE_TARGET_INTERVAL: -+ rtt_target->interval = nla_get_u32(iter2); -+ break; -+ case RTT_ATTRIBUTE_TARGET_NUM_MEASUREMENT: -+ rtt_target->measure_cnt = nla_get_u32(iter2); -+ break; -+ case RTT_ATTRIBUTE_TARGET_NUM_PKT: -+ rtt_target->ftm_cnt = nla_get_u32(iter2); -+ break; -+ case RTT_ATTRIBUTE_TARGET_NUM_RETRY: -+ rtt_target->retry_cnt = nla_get_u32(iter2); -+ } -+ } -+ /* convert to chanspec value */ -+ rtt_target->chanspec = dhd_rtt_convert_to_chspec(rtt_target->channel); -+ if (rtt_target->chanspec == 0) { -+ WL_ERR(("Channel is not valid\n")); -+ goto exit; -+ } -+ WL_INFORM(("Target addr %s, Channel : %s for RTT\n", -+ bcm_ether_ntoa((const struct ether_addr *)&rtt_target->addr, eabuf), -+ wf_chspec_ntoa(rtt_target->chanspec, chanbuf))); -+ rtt_target++; -+ } -+ break; -+ } -+ } -+ WL_DBG(("leave :target_cnt : %d\n", rtt_param.rtt_target_cnt)); -+ if (dhd_dev_rtt_set_cfg(bcmcfg_to_prmry_ndev(cfg), &rtt_param) < 0) { -+ WL_ERR(("Could not set RTT configuration\n")); -+ err = -EINVAL; -+ } -+exit: -+ return err; -+} -+ -+static int wl_cfgvendor_rtt_cancel_config(struct wiphy *wiphy, struct wireless_dev *wdev, -+ const void *data, int len) -+{ -+ int err = 0, rem, type, target_cnt = 0; -+ const struct nlattr *iter; -+ struct ether_addr *mac_list = NULL, *mac_addr = NULL; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ -+ nla_for_each_attr(iter, data, len, rem) { -+ type = nla_type(iter); -+ switch (type) { -+ case RTT_ATTRIBUTE_TARGET_CNT: -+ target_cnt = nla_get_u8(iter); -+ mac_list = (struct ether_addr *)kzalloc(target_cnt * ETHER_ADDR_LEN , GFP_KERNEL); -+ if (mac_list == NULL) { -+ WL_ERR(("failed to allocate mem for mac list\n")); -+ goto exit; -+ } -+ mac_addr = &mac_list[0]; -+ break; -+ case RTT_ATTRIBUTE_TARGET_MAC: -+ if (mac_addr) -+ memcpy(mac_addr++, nla_data(iter), ETHER_ADDR_LEN); -+ else { -+ WL_ERR(("mac_list is NULL\n")); -+ goto exit; -+ } -+ break; -+ } -+ if (dhd_dev_rtt_cancel_cfg(bcmcfg_to_prmry_ndev(cfg), mac_list, target_cnt) < 0) { -+ WL_ERR(("Could not cancel RTT configuration\n")); -+ err = -EINVAL; -+ goto exit; -+ } -+ } -+exit: -+ if (mac_list) -+ kfree(mac_list); -+ return err; -+} -+static int wl_cfgvendor_rtt_get_capability(struct wiphy *wiphy, struct wireless_dev *wdev, -+ const void *data, int len) -+{ -+ int err = 0; -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ rtt_capabilities_t capability; -+ -+ err = dhd_dev_rtt_capability(bcmcfg_to_prmry_ndev(cfg), &capability); -+ if (unlikely(err)) { -+ WL_ERR(("Vendor Command reply failed ret:%d\n", err)); -+ goto exit; -+ } -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), -+ &capability, sizeof(capability)); -+ -+ if (unlikely(err)) -+ WL_ERR(("Vendor Command reply failed ret:%d\n", err)); -+exit: -+ return err; -+} -+ -+#endif /* RTT_SUPPORT */ -+static int wl_cfgvendor_priv_string_handler(struct wiphy *wiphy, -+ struct wireless_dev *wdev, const void *data, int len) -+{ -+ int err = 0; -+ u8 resp[1] = {'\0'}; -+ -+ RTW_PRINT(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char *)data); -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, wdev_to_ndev(wdev), resp, 1); -+ if (unlikely(err)) -+ RTW_ERR(FUNC_NDEV_FMT"Vendor Command reply failed ret:%d\n" -+ , FUNC_NDEV_ARG(wdev_to_ndev(wdev)), err); -+ -+ return err; -+#if 0 -+ struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); -+ int err = 0; -+ int data_len = 0; -+ -+ bzero(cfg->ioctl_buf, WLC_IOCTL_MAXLEN); -+ -+ if (strncmp((char *)data, BRCM_VENDOR_SCMD_CAPA, strlen(BRCM_VENDOR_SCMD_CAPA)) == 0) { -+ err = wldev_iovar_getbuf(bcmcfg_to_prmry_ndev(cfg), "cap", NULL, 0, -+ cfg->ioctl_buf, WLC_IOCTL_MAXLEN, &cfg->ioctl_buf_sync); -+ if (unlikely(err)) { -+ WL_ERR(("error (%d)\n", err)); -+ return err; -+ } -+ data_len = strlen(cfg->ioctl_buf); -+ cfg->ioctl_buf[data_len] = '\0'; -+ } -+ -+ err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), -+ cfg->ioctl_buf, data_len + 1); -+ if (unlikely(err)) -+ WL_ERR(("Vendor Command reply failed ret:%d\n", err)); -+ else -+ WL_INFORM(("Vendor Command reply sent successfully!\n")); -+ -+ return err; -+#endif -+} -+ -+static const struct wiphy_vendor_command rtw_vendor_cmds[] = { -+ { -+ { -+ .vendor_id = OUI_BRCM, -+ .subcmd = BRCM_VENDOR_SCMD_PRIV_STR -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_priv_string_handler -+ }, -+#if defined(GSCAN_SUPPORT) && 0 -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_GET_CAPABILITIES -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_gscan_get_capabilities -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_SET_CONFIG -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_set_scan_cfg -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_SET_SCAN_CONFIG -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_set_batch_scan_cfg -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_ENABLE_GSCAN -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_initiate_gscan -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_ENABLE_FULL_SCAN_RESULTS -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_enable_full_scan_result -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_SET_HOTLIST -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_hotlist_cfg -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_SET_SIGNIFICANT_CHANGE_CONFIG -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_significant_change_cfg -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_GET_SCAN_RESULTS -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_gscan_get_batch_results -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = GSCAN_SUBCMD_GET_CHANNEL_LIST -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_gscan_get_channel_list -+ }, -+#endif /* GSCAN_SUPPORT */ -+#if defined(RTT_SUPPORT) && 0 -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = RTT_SUBCMD_SET_CONFIG -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_rtt_set_config -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = RTT_SUBCMD_CANCEL_CONFIG -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_rtt_cancel_config -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = RTT_SUBCMD_GETCAPABILITY -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = wl_cfgvendor_rtt_get_capability -+ }, -+#endif /* RTT_SUPPORT */ -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = ANDR_WIFI_SUBCMD_GET_FEATURE_SET -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = rtw_cfgvendor_get_feature_set -+ }, -+ { -+ { -+ .vendor_id = OUI_GOOGLE, -+ .subcmd = ANDR_WIFI_SUBCMD_GET_FEATURE_SET_MATRIX -+ }, -+ .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, -+ .doit = rtw_cfgvendor_get_feature_set_matrix -+ } -+}; -+ -+static const struct nl80211_vendor_cmd_info rtw_vendor_events[] = { -+ { OUI_BRCM, BRCM_VENDOR_EVENT_UNSPEC }, -+ { OUI_BRCM, BRCM_VENDOR_EVENT_PRIV_STR }, -+#if defined(GSCAN_SUPPORT) && 0 -+ { OUI_GOOGLE, GOOGLE_GSCAN_SIGNIFICANT_EVENT }, -+ { OUI_GOOGLE, GOOGLE_GSCAN_GEOFENCE_FOUND_EVENT }, -+ { OUI_GOOGLE, GOOGLE_GSCAN_BATCH_SCAN_EVENT }, -+ { OUI_GOOGLE, GOOGLE_SCAN_FULL_RESULTS_EVENT }, -+#endif /* GSCAN_SUPPORT */ -+#if defined(RTT_SUPPORT) && 0 -+ { OUI_GOOGLE, GOOGLE_RTT_COMPLETE_EVENT }, -+#endif /* RTT_SUPPORT */ -+#if defined(GSCAN_SUPPORT) && 0 -+ { OUI_GOOGLE, GOOGLE_SCAN_COMPLETE_EVENT }, -+ { OUI_GOOGLE, GOOGLE_GSCAN_GEOFENCE_LOST_EVENT } -+#endif /* GSCAN_SUPPORT */ -+}; -+ -+int rtw_cfgvendor_attach(struct wiphy *wiphy) -+{ -+ -+ RTW_INFO("Register RTW cfg80211 vendor cmd(0x%x) interface\n", NL80211_CMD_VENDOR); -+ -+ wiphy->vendor_commands = rtw_vendor_cmds; -+ wiphy->n_vendor_commands = ARRAY_SIZE(rtw_vendor_cmds); -+ wiphy->vendor_events = rtw_vendor_events; -+ wiphy->n_vendor_events = ARRAY_SIZE(rtw_vendor_events); -+ -+ return 0; -+} -+ -+int rtw_cfgvendor_detach(struct wiphy *wiphy) -+{ -+ RTW_INFO("Vendor: Unregister RTW cfg80211 vendor interface\n"); -+ -+ wiphy->vendor_commands = NULL; -+ wiphy->vendor_events = NULL; -+ wiphy->n_vendor_commands = 0; -+ wiphy->n_vendor_events = 0; -+ -+ return 0; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) */ -+ -+#endif /* CONFIG_IOCTL_CFG80211 */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.h linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.h ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_cfgvendor.h 2018-02-11 21:44:27.176146528 +0200 -@@ -0,0 +1,245 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2014 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#ifndef _RTW_CFGVENDOR_H_ -+#define _RTW_CFGVENDOR_H_ -+ -+#define OUI_BRCM 0x001018 -+#define OUI_GOOGLE 0x001A11 -+#define BRCM_VENDOR_SUBCMD_PRIV_STR 1 -+#define ATTRIBUTE_U32_LEN (NLA_HDRLEN + 4) -+#define VENDOR_ID_OVERHEAD ATTRIBUTE_U32_LEN -+#define VENDOR_SUBCMD_OVERHEAD ATTRIBUTE_U32_LEN -+#define VENDOR_DATA_OVERHEAD (NLA_HDRLEN) -+ -+#define SCAN_RESULTS_COMPLETE_FLAG_LEN ATTRIBUTE_U32_LEN -+#define SCAN_INDEX_HDR_LEN (NLA_HDRLEN) -+#define SCAN_ID_HDR_LEN ATTRIBUTE_U32_LEN -+#define SCAN_FLAGS_HDR_LEN ATTRIBUTE_U32_LEN -+#define GSCAN_NUM_RESULTS_HDR_LEN ATTRIBUTE_U32_LEN -+#define GSCAN_RESULTS_HDR_LEN (NLA_HDRLEN) -+#define GSCAN_BATCH_RESULT_HDR_LEN (SCAN_INDEX_HDR_LEN + SCAN_ID_HDR_LEN + \ -+ SCAN_FLAGS_HDR_LEN + \ -+ GSCAN_NUM_RESULTS_HDR_LEN + \ -+ GSCAN_RESULTS_HDR_LEN) -+ -+#define VENDOR_REPLY_OVERHEAD (VENDOR_ID_OVERHEAD + \ -+ VENDOR_SUBCMD_OVERHEAD + \ -+ VENDOR_DATA_OVERHEAD) -+typedef enum { -+ /* don't use 0 as a valid subcommand */ -+ VENDOR_NL80211_SUBCMD_UNSPECIFIED, -+ -+ /* define all vendor startup commands between 0x0 and 0x0FFF */ -+ VENDOR_NL80211_SUBCMD_RANGE_START = 0x0001, -+ VENDOR_NL80211_SUBCMD_RANGE_END = 0x0FFF, -+ -+ /* define all GScan related commands between 0x1000 and 0x10FF */ -+ ANDROID_NL80211_SUBCMD_GSCAN_RANGE_START = 0x1000, -+ ANDROID_NL80211_SUBCMD_GSCAN_RANGE_END = 0x10FF, -+ -+ /* define all NearbyDiscovery related commands between 0x1100 and 0x11FF */ -+ ANDROID_NL80211_SUBCMD_NBD_RANGE_START = 0x1100, -+ ANDROID_NL80211_SUBCMD_NBD_RANGE_END = 0x11FF, -+ -+ /* define all RTT related commands between 0x1100 and 0x11FF */ -+ ANDROID_NL80211_SUBCMD_RTT_RANGE_START = 0x1100, -+ ANDROID_NL80211_SUBCMD_RTT_RANGE_END = 0x11FF, -+ -+ ANDROID_NL80211_SUBCMD_LSTATS_RANGE_START = 0x1200, -+ ANDROID_NL80211_SUBCMD_LSTATS_RANGE_END = 0x12FF, -+ -+ ANDROID_NL80211_SUBCMD_TDLS_RANGE_START = 0x1300, -+ ANDROID_NL80211_SUBCMD_TDLS_RANGE_END = 0x13FF, -+ /* This is reserved for future usage */ -+ -+} ANDROID_VENDOR_SUB_COMMAND; -+ -+enum wl_vendor_subcmd { -+ BRCM_VENDOR_SCMD_UNSPEC, -+ BRCM_VENDOR_SCMD_PRIV_STR, -+ GSCAN_SUBCMD_GET_CAPABILITIES = ANDROID_NL80211_SUBCMD_GSCAN_RANGE_START, -+ GSCAN_SUBCMD_SET_CONFIG, -+ GSCAN_SUBCMD_SET_SCAN_CONFIG, -+ GSCAN_SUBCMD_ENABLE_GSCAN, -+ GSCAN_SUBCMD_GET_SCAN_RESULTS, -+ GSCAN_SUBCMD_SCAN_RESULTS, -+ GSCAN_SUBCMD_SET_HOTLIST, -+ GSCAN_SUBCMD_SET_SIGNIFICANT_CHANGE_CONFIG, -+ GSCAN_SUBCMD_ENABLE_FULL_SCAN_RESULTS, -+ GSCAN_SUBCMD_GET_CHANNEL_LIST, -+ ANDR_WIFI_SUBCMD_GET_FEATURE_SET, -+ ANDR_WIFI_SUBCMD_GET_FEATURE_SET_MATRIX, -+ RTT_SUBCMD_SET_CONFIG = ANDROID_NL80211_SUBCMD_RTT_RANGE_START, -+ RTT_SUBCMD_CANCEL_CONFIG, -+ RTT_SUBCMD_GETCAPABILITY, -+ /* Add more sub commands here */ -+ VENDOR_SUBCMD_MAX -+}; -+ -+enum gscan_attributes { -+ GSCAN_ATTRIBUTE_NUM_BUCKETS = 10, -+ GSCAN_ATTRIBUTE_BASE_PERIOD, -+ GSCAN_ATTRIBUTE_BUCKETS_BAND, -+ GSCAN_ATTRIBUTE_BUCKET_ID, -+ GSCAN_ATTRIBUTE_BUCKET_PERIOD, -+ GSCAN_ATTRIBUTE_BUCKET_NUM_CHANNELS, -+ GSCAN_ATTRIBUTE_BUCKET_CHANNELS, -+ GSCAN_ATTRIBUTE_NUM_AP_PER_SCAN, -+ GSCAN_ATTRIBUTE_REPORT_THRESHOLD, -+ GSCAN_ATTRIBUTE_NUM_SCANS_TO_CACHE, -+ GSCAN_ATTRIBUTE_BAND = GSCAN_ATTRIBUTE_BUCKETS_BAND, -+ -+ GSCAN_ATTRIBUTE_ENABLE_FEATURE = 20, -+ GSCAN_ATTRIBUTE_SCAN_RESULTS_COMPLETE, -+ GSCAN_ATTRIBUTE_FLUSH_FEATURE, -+ GSCAN_ATTRIBUTE_ENABLE_FULL_SCAN_RESULTS, -+ GSCAN_ATTRIBUTE_REPORT_EVENTS, -+ /* remaining reserved for additional attributes */ -+ GSCAN_ATTRIBUTE_NUM_OF_RESULTS = 30, -+ GSCAN_ATTRIBUTE_FLUSH_RESULTS, -+ GSCAN_ATTRIBUTE_SCAN_RESULTS, /* flat array of wifi_scan_result */ -+ GSCAN_ATTRIBUTE_SCAN_ID, /* indicates scan number */ -+ GSCAN_ATTRIBUTE_SCAN_FLAGS, /* indicates if scan was aborted */ -+ GSCAN_ATTRIBUTE_AP_FLAGS, /* flags on significant change event */ -+ GSCAN_ATTRIBUTE_NUM_CHANNELS, -+ GSCAN_ATTRIBUTE_CHANNEL_LIST, -+ -+ /* remaining reserved for additional attributes */ -+ -+ GSCAN_ATTRIBUTE_SSID = 40, -+ GSCAN_ATTRIBUTE_BSSID, -+ GSCAN_ATTRIBUTE_CHANNEL, -+ GSCAN_ATTRIBUTE_RSSI, -+ GSCAN_ATTRIBUTE_TIMESTAMP, -+ GSCAN_ATTRIBUTE_RTT, -+ GSCAN_ATTRIBUTE_RTTSD, -+ -+ /* remaining reserved for additional attributes */ -+ -+ GSCAN_ATTRIBUTE_HOTLIST_BSSIDS = 50, -+ GSCAN_ATTRIBUTE_RSSI_LOW, -+ GSCAN_ATTRIBUTE_RSSI_HIGH, -+ GSCAN_ATTRIBUTE_HOSTLIST_BSSID_ELEM, -+ GSCAN_ATTRIBUTE_HOTLIST_FLUSH, -+ -+ /* remaining reserved for additional attributes */ -+ GSCAN_ATTRIBUTE_RSSI_SAMPLE_SIZE = 60, -+ GSCAN_ATTRIBUTE_LOST_AP_SAMPLE_SIZE, -+ GSCAN_ATTRIBUTE_MIN_BREACHING, -+ GSCAN_ATTRIBUTE_SIGNIFICANT_CHANGE_BSSIDS, -+ GSCAN_ATTRIBUTE_SIGNIFICANT_CHANGE_FLUSH, -+ GSCAN_ATTRIBUTE_MAX -+}; -+ -+enum gscan_bucket_attributes { -+ GSCAN_ATTRIBUTE_CH_BUCKET_1, -+ GSCAN_ATTRIBUTE_CH_BUCKET_2, -+ GSCAN_ATTRIBUTE_CH_BUCKET_3, -+ GSCAN_ATTRIBUTE_CH_BUCKET_4, -+ GSCAN_ATTRIBUTE_CH_BUCKET_5, -+ GSCAN_ATTRIBUTE_CH_BUCKET_6, -+ GSCAN_ATTRIBUTE_CH_BUCKET_7 -+}; -+ -+enum gscan_ch_attributes { -+ GSCAN_ATTRIBUTE_CH_ID_1, -+ GSCAN_ATTRIBUTE_CH_ID_2, -+ GSCAN_ATTRIBUTE_CH_ID_3, -+ GSCAN_ATTRIBUTE_CH_ID_4, -+ GSCAN_ATTRIBUTE_CH_ID_5, -+ GSCAN_ATTRIBUTE_CH_ID_6, -+ GSCAN_ATTRIBUTE_CH_ID_7 -+}; -+ -+enum rtt_attributes { -+ RTT_ATTRIBUTE_TARGET_CNT, -+ RTT_ATTRIBUTE_TARGET_INFO, -+ RTT_ATTRIBUTE_TARGET_MAC, -+ RTT_ATTRIBUTE_TARGET_TYPE, -+ RTT_ATTRIBUTE_TARGET_PEER, -+ RTT_ATTRIBUTE_TARGET_CHAN, -+ RTT_ATTRIBUTE_TARGET_MODE, -+ RTT_ATTRIBUTE_TARGET_INTERVAL, -+ RTT_ATTRIBUTE_TARGET_NUM_MEASUREMENT, -+ RTT_ATTRIBUTE_TARGET_NUM_PKT, -+ RTT_ATTRIBUTE_TARGET_NUM_RETRY -+}; -+ -+typedef enum wl_vendor_event { -+ BRCM_VENDOR_EVENT_UNSPEC, -+ BRCM_VENDOR_EVENT_PRIV_STR, -+ GOOGLE_GSCAN_SIGNIFICANT_EVENT, -+ GOOGLE_GSCAN_GEOFENCE_FOUND_EVENT, -+ GOOGLE_GSCAN_BATCH_SCAN_EVENT, -+ GOOGLE_SCAN_FULL_RESULTS_EVENT, -+ GOOGLE_RTT_COMPLETE_EVENT, -+ GOOGLE_SCAN_COMPLETE_EVENT, -+ GOOGLE_GSCAN_GEOFENCE_LOST_EVENT -+} wl_vendor_event_t; -+ -+enum andr_wifi_feature_set_attr { -+ ANDR_WIFI_ATTRIBUTE_NUM_FEATURE_SET, -+ ANDR_WIFI_ATTRIBUTE_FEATURE_SET -+}; -+ -+typedef enum wl_vendor_gscan_attribute { -+ ATTR_START_GSCAN, -+ ATTR_STOP_GSCAN, -+ ATTR_SET_SCAN_BATCH_CFG_ID, /* set batch scan params */ -+ ATTR_SET_SCAN_GEOFENCE_CFG_ID, /* set list of bssids to track */ -+ ATTR_SET_SCAN_SIGNIFICANT_CFG_ID, /* set list of bssids, rssi threshold etc.. */ -+ ATTR_SET_SCAN_CFG_ID, /* set common scan config params here */ -+ ATTR_GET_GSCAN_CAPABILITIES_ID, -+ /* Add more sub commands here */ -+ ATTR_GSCAN_MAX -+} wl_vendor_gscan_attribute_t; -+ -+typedef enum gscan_batch_attribute { -+ ATTR_GSCAN_BATCH_BESTN, -+ ATTR_GSCAN_BATCH_MSCAN, -+ ATTR_GSCAN_BATCH_BUFFER_THRESHOLD -+} gscan_batch_attribute_t; -+ -+typedef enum gscan_geofence_attribute { -+ ATTR_GSCAN_NUM_HOTLIST_BSSID, -+ ATTR_GSCAN_HOTLIST_BSSID -+} gscan_geofence_attribute_t; -+ -+typedef enum gscan_complete_event { -+ WIFI_SCAN_BUFFER_FULL, -+ WIFI_SCAN_COMPLETE -+} gscan_complete_event_t; -+ -+/* Capture the BRCM_VENDOR_SUBCMD_PRIV_STRINGS* here */ -+#define BRCM_VENDOR_SCMD_CAPA "cap" -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) -+extern int rtw_cfgvendor_attach(struct wiphy *wiphy); -+extern int rtw_cfgvendor_detach(struct wiphy *wiphy); -+extern int rtw_cfgvendor_send_async_event(struct wiphy *wiphy, -+ struct net_device *dev, int event_id, const void *data, int len); -+#if defined(GSCAN_SUPPORT) && 0 -+extern int wl_cfgvendor_send_hotlist_event(struct wiphy *wiphy, -+ struct net_device *dev, void *data, int len, wl_vendor_event_t event); -+#endif -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) */ -+ -+#endif /* _RTW_CFGVENDOR_H_ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_proc.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_proc.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_proc.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_proc.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,3004 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#include /* tolower() */ -+#include -+#include -+#include "rtw_proc.h" -+#ifdef CONFIG_BT_COEXIST -+#include -+#endif -+ -+#ifdef CONFIG_PROC_DEBUG -+ -+static struct proc_dir_entry *rtw_proc = NULL; -+ -+inline struct proc_dir_entry *get_rtw_drv_proc(void) -+{ -+ return rtw_proc; -+} -+ -+#define RTW_PROC_NAME DRV_NAME -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 9, 0)) -+#define file_inode(file) ((file)->f_dentry->d_inode) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 0)) -+#define PDE_DATA(inode) PDE((inode))->data -+#define proc_get_parent_data(inode) PDE((inode))->parent->data -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) -+#define get_proc_net proc_net -+#else -+#define get_proc_net init_net.proc_net -+#endif -+ -+inline struct proc_dir_entry *rtw_proc_create_dir(const char *name, struct proc_dir_entry *parent, void *data) -+{ -+ struct proc_dir_entry *entry; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) -+ entry = proc_mkdir_data(name, S_IRUGO | S_IXUGO, parent, data); -+#else -+ /* entry = proc_mkdir_mode(name, S_IRUGO|S_IXUGO, parent); */ -+ entry = proc_mkdir(name, parent); -+ if (entry) -+ entry->data = data; -+#endif -+ -+ return entry; -+} -+ -+inline struct proc_dir_entry *rtw_proc_create_entry(const char *name, struct proc_dir_entry *parent, -+ const struct file_operations *fops, void * data) -+{ -+ struct proc_dir_entry *entry; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)) -+ entry = proc_create_data(name, S_IFREG | S_IRUGO | S_IWUGO, parent, fops, data); -+#else -+ entry = create_proc_entry(name, S_IFREG | S_IRUGO | S_IWUGO, parent); -+ if (entry) { -+ entry->data = data; -+ entry->proc_fops = fops; -+ } -+#endif -+ -+ return entry; -+} -+ -+static int proc_get_dummy(struct seq_file *m, void *v) -+{ -+ return 0; -+} -+ -+static int proc_get_drv_version(struct seq_file *m, void *v) -+{ -+ dump_drv_version(m); -+ return 0; -+} -+ -+static int proc_get_log_level(struct seq_file *m, void *v) -+{ -+ dump_log_level(m); -+ return 0; -+} -+ -+static int proc_get_drv_cfg(struct seq_file *m, void *v) -+{ -+ dump_drv_cfg(m); -+ return 0; -+} -+ -+static ssize_t proc_set_log_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ char tmp[32]; -+ int log_level; -+ -+ if (count < 1) -+ return -EINVAL; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+#ifdef CONFIG_RTW_DEBUG -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d ", &log_level); -+ -+ if (log_level >= _DRV_NONE_ && log_level <= _DRV_MAX_) { -+ rtw_drv_log_level = log_level; -+ printk("rtw_drv_log_level:%d\n", rtw_drv_log_level); -+ } -+ } else -+ return -EFAULT; -+#else -+ printk("CONFIG_RTW_DEBUG is disabled\n"); -+#endif -+ -+ return count; -+} -+ -+#ifdef DBG_MEM_ALLOC -+static int proc_get_mstat(struct seq_file *m, void *v) -+{ -+ rtw_mstat_dump(m); -+ return 0; -+} -+#endif /* DBG_MEM_ALLOC */ -+ -+static int proc_get_country_chplan_map(struct seq_file *m, void *v) -+{ -+ dump_country_chplan_map(m); -+ return 0; -+} -+ -+static int proc_get_chplan_id_list(struct seq_file *m, void *v) -+{ -+ dump_chplan_id_list(m); -+ return 0; -+} -+ -+static int proc_get_chplan_test(struct seq_file *m, void *v) -+{ -+ dump_chplan_test(m); -+ return 0; -+} -+ -+/* -+* rtw_drv_proc: -+* init/deinit when register/unregister driver -+*/ -+const struct rtw_proc_hdl drv_proc_hdls[] = { -+ RTW_PROC_HDL_SSEQ("ver_info", proc_get_drv_version, NULL), -+ RTW_PROC_HDL_SSEQ("log_level", proc_get_log_level, proc_set_log_level), -+ RTW_PROC_HDL_SSEQ("drv_cfg", proc_get_drv_cfg, NULL), -+#ifdef DBG_MEM_ALLOC -+ RTW_PROC_HDL_SSEQ("mstat", proc_get_mstat, NULL), -+#endif /* DBG_MEM_ALLOC */ -+ RTW_PROC_HDL_SSEQ("country_chplan_map", proc_get_country_chplan_map, NULL), -+ RTW_PROC_HDL_SSEQ("chplan_id_list", proc_get_chplan_id_list, NULL), -+ RTW_PROC_HDL_SSEQ("chplan_test", proc_get_chplan_test, NULL), -+}; -+ -+const int drv_proc_hdls_num = sizeof(drv_proc_hdls) / sizeof(struct rtw_proc_hdl); -+ -+static int rtw_drv_proc_open(struct inode *inode, struct file *file) -+{ -+ /* struct net_device *dev = proc_get_parent_data(inode); */ -+ ssize_t index = (ssize_t)PDE_DATA(inode); -+ const struct rtw_proc_hdl *hdl = drv_proc_hdls + index; -+ void *private = NULL; -+ -+ if (hdl->type == RTW_PROC_HDL_TYPE_SEQ) { -+ int res = seq_open(file, hdl->u.seq_op); -+ -+ if (res == 0) -+ ((struct seq_file *)file->private_data)->private = private; -+ -+ return res; -+ } else if (hdl->type == RTW_PROC_HDL_TYPE_SSEQ) { -+ int (*show)(struct seq_file *, void *) = hdl->u.show ? hdl->u.show : proc_get_dummy; -+ -+ return single_open(file, show, private); -+ } else { -+ return -EROFS; -+ } -+} -+ -+static ssize_t rtw_drv_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); -+ const struct rtw_proc_hdl *hdl = drv_proc_hdls + index; -+ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; -+ -+ if (write) -+ return write(file, buffer, count, pos, NULL); -+ -+ return -EROFS; -+} -+ -+static const struct file_operations rtw_drv_proc_seq_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_drv_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = seq_release, -+ .write = rtw_drv_proc_write, -+}; -+ -+static const struct file_operations rtw_drv_proc_sseq_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_drv_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_drv_proc_write, -+}; -+ -+int rtw_drv_proc_init(void) -+{ -+ int ret = _FAIL; -+ ssize_t i; -+ struct proc_dir_entry *entry = NULL; -+ -+ if (rtw_proc != NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ rtw_proc = rtw_proc_create_dir(RTW_PROC_NAME, get_proc_net, NULL); -+ -+ if (rtw_proc == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ for (i = 0; i < drv_proc_hdls_num; i++) { -+ if (drv_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SEQ) -+ entry = rtw_proc_create_entry(drv_proc_hdls[i].name, rtw_proc, &rtw_drv_proc_seq_fops, (void *)i); -+ else if (drv_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SSEQ) -+ entry = rtw_proc_create_entry(drv_proc_hdls[i].name, rtw_proc, &rtw_drv_proc_sseq_fops, (void *)i); -+ else -+ entry = NULL; -+ -+ if (!entry) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ } -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+void rtw_drv_proc_deinit(void) -+{ -+ int i; -+ -+ if (rtw_proc == NULL) -+ return; -+ -+ for (i = 0; i < drv_proc_hdls_num; i++) -+ remove_proc_entry(drv_proc_hdls[i].name, rtw_proc); -+ -+ remove_proc_entry(RTW_PROC_NAME, get_proc_net); -+ rtw_proc = NULL; -+} -+ -+#ifndef RTW_SEQ_FILE_TEST -+#define RTW_SEQ_FILE_TEST 0 -+#endif -+ -+#if RTW_SEQ_FILE_TEST -+#define RTW_SEQ_FILE_TEST_SHOW_LIMIT 300 -+static void *proc_start_seq_file_test(struct seq_file *m, loff_t *pos) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+ if (*pos >= RTW_SEQ_FILE_TEST_SHOW_LIMIT) { -+ RTW_PRINT(FUNC_ADPT_FMT" pos:%llu, out of range return\n", FUNC_ADPT_ARG(adapter), *pos); -+ return NULL; -+ } -+ -+ RTW_PRINT(FUNC_ADPT_FMT" return pos:%lld\n", FUNC_ADPT_ARG(adapter), *pos); -+ return pos; -+} -+void proc_stop_seq_file_test(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+} -+ -+void *proc_next_seq_file_test(struct seq_file *m, void *v, loff_t *pos) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ (*pos)++; -+ if (*pos >= RTW_SEQ_FILE_TEST_SHOW_LIMIT) { -+ RTW_PRINT(FUNC_ADPT_FMT" pos:%lld, out of range return\n", FUNC_ADPT_ARG(adapter), *pos); -+ return NULL; -+ } -+ -+ RTW_PRINT(FUNC_ADPT_FMT" return pos:%lld\n", FUNC_ADPT_ARG(adapter), *pos); -+ return pos; -+} -+ -+static int proc_get_seq_file_test(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ u32 pos = *((loff_t *)(v)); -+ RTW_PRINT(FUNC_ADPT_FMT" pos:%d\n", FUNC_ADPT_ARG(adapter), pos); -+ RTW_PRINT_SEL(m, FUNC_ADPT_FMT" pos:%d\n", FUNC_ADPT_ARG(adapter), pos); -+ return 0; -+} -+ -+struct seq_operations seq_file_test = { -+ .start = proc_start_seq_file_test, -+ .stop = proc_stop_seq_file_test, -+ .next = proc_next_seq_file_test, -+ .show = proc_get_seq_file_test, -+}; -+#endif /* RTW_SEQ_FILE_TEST */ -+ -+#ifdef CONFIG_SDIO_HCI -+static int proc_get_sd_f0_reg_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ sd_f0_reg_dump(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_sdio_local_reg_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ sdio_local_reg_dump(m, adapter); -+ -+ return 0; -+} -+#endif /* CONFIG_SDIO_HCI */ -+ -+static int proc_get_mac_reg_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ mac_reg_dump(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_bb_reg_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ bb_reg_dump(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_rf_reg_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rf_reg_dump(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_dump_tx_rate_bmp(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_tx_rate_bmp(m, adapter_to_dvobj(adapter)); -+ -+ return 0; -+} -+ -+static int proc_get_dump_adapters_status(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_adapters_status(m, adapter_to_dvobj(adapter)); -+ -+ return 0; -+} -+ -+#ifdef CONFIG_RTW_CUSTOMER_STR -+static int proc_get_customer_str(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 cstr[RTW_CUSTOMER_STR_LEN]; -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ if (rtw_pwr_wakeup(adapter) == _FAIL) -+ goto exit; -+ -+ if (rtw_hal_customer_str_read(adapter, cstr) != _SUCCESS) -+ goto exit; -+ -+ RTW_PRINT_SEL(m, RTW_CUSTOMER_STR_FMT"\n", RTW_CUSTOMER_STR_ARG(cstr)); -+ -+exit: -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ return 0; -+} -+#endif /* CONFIG_RTW_CUSTOMER_STR */ -+ -+/* gpio setting */ -+#ifdef CONFIG_GPIO_API -+static ssize_t proc_set_config_gpio(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32] = {0}; -+ int num = 0, gpio_pin = 0, gpio_mode = 0; /* gpio_mode:0 input 1:output; */ -+ -+ if (count < 2) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ num = sscanf(tmp, "%d %d", &gpio_pin, &gpio_mode); -+ RTW_INFO("num=%d gpio_pin=%d mode=%d\n", num, gpio_pin, gpio_mode); -+ padapter->pre_gpio_pin = gpio_pin; -+ -+ if (gpio_mode == 0 || gpio_mode == 1) -+ rtw_hal_config_gpio(padapter, gpio_pin, gpio_mode); -+ } -+ return count; -+ -+} -+static ssize_t proc_set_gpio_output_value(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32] = {0}; -+ int num = 0, gpio_pin = 0, pin_mode = 0; /* pin_mode: 1 high 0:low */ -+ -+ if (count < 2) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ num = sscanf(tmp, "%d %d", &gpio_pin, &pin_mode); -+ RTW_INFO("num=%d gpio_pin=%d pin_high=%d\n", num, gpio_pin, pin_mode); -+ padapter->pre_gpio_pin = gpio_pin; -+ -+ if (pin_mode == 0 || pin_mode == 1) -+ rtw_hal_set_gpio_output_value(padapter, gpio_pin, pin_mode); -+ } -+ return count; -+} -+static int proc_get_gpio(struct seq_file *m, void *v) -+{ -+ u8 gpioreturnvalue = 0; -+ struct net_device *dev = m->private; -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ if (!padapter) -+ return -EFAULT; -+ gpioreturnvalue = rtw_hal_get_gpio(padapter, padapter->pre_gpio_pin); -+ RTW_PRINT_SEL(m, "get_gpio %d:%d\n", padapter->pre_gpio_pin, gpioreturnvalue); -+ -+ return 0; -+ -+} -+static ssize_t proc_set_gpio(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32] = {0}; -+ int num = 0, gpio_pin = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ num = sscanf(tmp, "%d", &gpio_pin); -+ RTW_INFO("num=%d gpio_pin=%d\n", num, gpio_pin); -+ padapter->pre_gpio_pin = gpio_pin; -+ -+ } -+ return count; -+} -+#endif -+static ssize_t proc_set_rx_info_msg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ char tmp[32] = {0}; -+ int phy_info_flag = 0; -+ -+ if (!padapter) -+ return -EFAULT; -+ -+ if (count < 1) { -+ RTW_INFO("argument size is less than 1\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%d", &phy_info_flag); -+ -+ precvpriv->store_law_data_flag = (BOOLEAN) phy_info_flag; -+ -+ /*RTW_INFO("precvpriv->store_law_data_flag = %d\n",( BOOLEAN )(precvpriv->store_law_data_flag));*/ -+ } -+ return count; -+} -+static int proc_get_rx_info_msg(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_RX_Dframe_INFO, m, _FALSE); -+ return 0; -+} -+static int proc_get_tx_info_msg(struct seq_file *m, void *v) -+{ -+ _irqL irqL; -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ struct sta_info *psta; -+ u8 bc_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 null_addr[6] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ int i; -+ _list *plist, *phead; -+ u8 current_rate_id = 0, current_sgi = 0; -+ -+ char *BW, *status; -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE)) -+ status = "station mode"; -+ else if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE)) -+ status = "AP mode"; -+ else -+ status = " "; -+ _RTW_PRINT_SEL(m, "status=%s\n", status); -+ for (i = 0; i < NUM_STA; i++) { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ plist = get_next(plist); -+ -+ if ((_rtw_memcmp(psta->hwaddr, bc_addr, 6) != _TRUE) -+ && (_rtw_memcmp(psta->hwaddr, null_addr, 6) != _TRUE) -+ && (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), 6) != _TRUE)) { -+ -+ switch (psta->bw_mode) { -+ -+ case CHANNEL_WIDTH_20: -+ BW = "20M"; -+ break; -+ -+ case CHANNEL_WIDTH_40: -+ BW = "40M"; -+ break; -+ -+ case CHANNEL_WIDTH_80: -+ BW = "80M"; -+ break; -+ -+ case CHANNEL_WIDTH_160: -+ BW = "160M"; -+ break; -+ -+ default: -+ BW = ""; -+ break; -+ } -+ current_rate_id = rtw_get_current_tx_rate(adapter, psta->mac_id); -+ current_sgi = rtw_get_current_tx_sgi(adapter, psta->mac_id); -+ -+ RTW_PRINT_SEL(m, "==============================\n"); -+ _RTW_PRINT_SEL(m, "macaddr=" MAC_FMT"\n", MAC_ARG(psta->hwaddr)); -+ _RTW_PRINT_SEL(m, "Tx_Data_Rate=%s\n", HDATA_RATE(current_rate_id)); -+ _RTW_PRINT_SEL(m, "BW=%s,sgi=%u\n", BW, current_sgi); -+ -+ } -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ return 0; -+ -+} -+ -+ -+static int proc_get_linked_info_dump(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ if (padapter) -+ RTW_PRINT_SEL(m, "linked_info_dump :%s\n", (padapter->bLinkInfoDump) ? "enable" : "disable"); -+ -+ return 0; -+} -+ -+ -+static ssize_t proc_set_linked_info_dump(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ char tmp[32] = {0}; -+ int mode = 0, pre_mode = 0; -+ int num = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ pre_mode = padapter->bLinkInfoDump; -+ RTW_INFO("pre_mode=%d\n", pre_mode); -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ num = sscanf(tmp, "%d ", &mode); -+ RTW_INFO("num=%d mode=%d\n", num, mode); -+ -+ if (num != 1) { -+ RTW_INFO("argument number is wrong\n"); -+ return -EFAULT; -+ } -+ -+ if (mode == 1 || (mode == 0 && pre_mode == 1)) /* not consider pwr_saving 0: */ -+ padapter->bLinkInfoDump = mode; -+ -+ else if ((mode == 2) || (mode == 0 && pre_mode == 2)) { /* consider power_saving */ -+ /* RTW_INFO("linked_info_dump =%s\n", (padapter->bLinkInfoDump)?"enable":"disable") */ -+ linked_info_dump(padapter, mode); -+ } -+ } -+ return count; -+} -+ -+static int proc_get_mac_qinfo(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_DUMP_MAC_QUEUE_INFO, (u8 *)m); -+ -+ return 0; -+} -+ -+int proc_get_wifi_spec(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ RTW_PRINT_SEL(m, "wifi_spec=%d\n", pregpriv->wifi_spec); -+ return 0; -+} -+ -+static int proc_get_chan_plan(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_cur_chset(m, adapter); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_chan_plan(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 chan_plan = RTW_CHPLAN_MAX; -+ -+ if (!padapter) -+ return -EFAULT; -+ -+ if (count < 1) { -+ RTW_INFO("argument size is less than 1\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = sscanf(tmp, "%hhx", &chan_plan); -+ if (num != 1) -+ return count; -+ } -+ -+ rtw_set_channel_plan(padapter, chan_plan); -+ -+ return count; -+} -+ -+static int proc_get_country_code(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ if (adapter->mlmepriv.country_ent) -+ dump_country_chplan(m, adapter->mlmepriv.country_ent); -+ else -+ RTW_PRINT_SEL(m, "unspecified\n"); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_country_code(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ char alpha2[2]; -+ int num; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (!buffer || copy_from_user(tmp, buffer, count)) -+ goto exit; -+ -+ num = sscanf(tmp, "%c%c", &alpha2[0], &alpha2[1]); -+ if (num != 2) -+ return count; -+ -+ rtw_set_country(padapter, alpha2); -+ -+exit: -+ return count; -+} -+ -+#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) -+static int proc_get_macaddr_acl(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_macaddr_acl(m, adapter); -+ return 0; -+} -+ -+ssize_t proc_set_macaddr_acl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ char tmp[17 * NUM_ACL + 32] = {0}; -+ u8 mode; -+ u8 addr[ETH_ALEN]; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ /* mode [] */ -+ char *c, *next; -+ -+ next = tmp; -+ c = strsep(&next, " \t"); -+ -+ if (sscanf(c, "%hhu", &mode) != 1) -+ return count; -+ -+ if (mode >= RTW_ACL_MODE_MAX) -+ mode = RTW_ACL_MODE_DISABLED; -+ -+ rtw_set_macaddr_acl(adapter, RTW_ACL_MODE_DISABLED); /* deinit first */ -+ if (mode == RTW_ACL_MODE_DISABLED) -+ return count; -+ -+ rtw_set_macaddr_acl(adapter, mode); -+ -+ /* macaddr list */ -+ c = strsep(&next, " \t"); -+ while (c != NULL) { -+ if (sscanf(c, MAC_SFMT, MAC_SARG(addr)) != 6) -+ break; -+ -+ if (rtw_check_invalid_mac_address(addr, 0) == _FALSE) -+ rtw_acl_add_sta(adapter, addr); -+ -+ c = strsep(&next, " \t"); -+ } -+ -+ } -+ -+exit: -+ return count; -+} -+#endif /* CONFIG_RTW_MACADDR_ACL && CONFIG_AP_MODE */ -+ -+#ifdef CONFIG_DFS_MASTER -+ssize_t proc_set_update_non_ocp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlme = &adapter->mlmepriv; -+ struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; -+ char tmp[32]; -+ u8 ch, bw = CHANNEL_WIDTH_20, offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ int ms = -1; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu %hhu %hhu %d", &ch, &bw, &offset, &ms); -+ -+ if (num < 1 || (bw != CHANNEL_WIDTH_20 && num < 3)) -+ goto exit; -+ -+ if (bw == CHANNEL_WIDTH_20) -+ rtw_chset_update_non_ocp_ms(mlmeext->channel_set -+ , ch, bw, HAL_PRIME_CHNL_OFFSET_DONT_CARE, ms); -+ else -+ rtw_chset_update_non_ocp_ms(mlmeext->channel_set -+ , ch, bw, offset, ms); -+ } -+ -+exit: -+ return count; -+} -+ -+ssize_t proc_set_radar_detect(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ char tmp[32]; -+ u8 fake_radar_detect_cnt = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu", &fake_radar_detect_cnt); -+ -+ if (num < 1) -+ goto exit; -+ -+ rfctl->dbg_dfs_master_fake_radar_detect_cnt = fake_radar_detect_cnt; -+ } -+ -+exit: -+ return count; -+} -+ -+static int proc_get_dfs_ch_sel_d_flags(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ -+ RTW_PRINT_SEL(m, "0x%02x\n", rfctl->dfs_ch_sel_d_flags); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_dfs_ch_sel_d_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); -+ char tmp[32]; -+ u8 d_flags; -+ int num; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (!buffer || copy_from_user(tmp, buffer, count)) -+ goto exit; -+ -+ num = sscanf(tmp, "%hhx", &d_flags); -+ if (num != 1) -+ goto exit; -+ -+ rfctl->dfs_ch_sel_d_flags = d_flags; -+ -+exit: -+ return count; -+} -+#endif /* CONFIG_DFS_MASTER */ -+ -+static int proc_get_udpport(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ -+ RTW_PRINT_SEL(m, "%d\n", precvpriv->sink_udpport); -+ return 0; -+} -+static ssize_t proc_set_udpport(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ int sink_udpport = 0; -+ char tmp[32]; -+ -+ -+ if (!padapter) -+ return -EFAULT; -+ -+ if (count < 1) { -+ RTW_INFO("argument size is less than 1\n"); -+ return -EFAULT; -+ } -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%d", &sink_udpport); -+ -+ if (num != 1) { -+ RTW_INFO("invalid input parameter number!\n"); -+ return count; -+ } -+ -+ } -+ precvpriv->sink_udpport = sink_udpport; -+ -+ return count; -+ -+} -+ -+static int proc_get_mi_ap_bc_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u8 i; -+ -+ for (i = 0; i < dvobj->iface_nums; i++) -+ RTW_PRINT_SEL(m, "iface_id:%d, mac_id && sec_cam_id = %d\n", i, macid_ctl->iface_bmc[i]); -+ -+ return 0; -+} -+static int proc_get_macid_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); -+ u8 chip_type = rtw_get_chip_type(adapter); -+ u8 i; -+ u8 null_addr[ETH_ALEN] = {0}; -+ u8 *macaddr; -+ -+ RTW_PRINT_SEL(m, "max_num:%u\n", macid_ctl->num); -+ RTW_PRINT_SEL(m, "\n"); -+ -+ RTW_PRINT_SEL(m, "used:\n"); -+ dump_macid_map(m, &macid_ctl->used, macid_ctl->num); -+ RTW_PRINT_SEL(m, "\n"); -+ -+ RTW_PRINT_SEL(m, "%-3s %-3s %-4s %-4s %-17s %-6s %-3s" -+ , "id", "bmc", "if_g", "ch_g", "macaddr", "bw", "vht"); -+ -+ if (chip_type == RTL8814A) -+ _RTW_PRINT_SEL(m, " %-10s", "rate_bmp1"); -+ -+ _RTW_PRINT_SEL(m, " %-10s %s\n", "rate_bmp0", "status"); -+ -+ for (i = 0; i < macid_ctl->num; i++) { -+ if (rtw_macid_is_used(macid_ctl, i) -+ || macid_ctl->h2c_msr[i] -+ ) { -+ if (macid_ctl->sta[i]) -+ macaddr = macid_ctl->sta[i]->hwaddr; -+ else -+ macaddr = null_addr; -+ -+ RTW_PRINT_SEL(m, "%3u %3u %4d %4d "MAC_FMT" %6s %3u" -+ , i -+ , rtw_macid_is_bmc(macid_ctl, i) -+ , rtw_macid_get_if_g(macid_ctl, i) -+ , rtw_macid_get_ch_g(macid_ctl, i) -+ , MAC_ARG(macaddr) -+ , ch_width_str(macid_ctl->bw[i]) -+ , macid_ctl->vht_en[i] -+ ); -+ -+ if (chip_type == RTL8814A) -+ _RTW_PRINT_SEL(m, " 0x%08X", macid_ctl->rate_bmp1[i]); -+ -+ _RTW_PRINT_SEL(m, " 0x%08X "H2C_MSR_FMT" %s\n" -+ , macid_ctl->rate_bmp0[i] -+ , H2C_MSR_ARG(&macid_ctl->h2c_msr[i]) -+ , rtw_macid_is_used(macid_ctl, i) ? "" : "[unused]" -+ ); -+ } -+ } -+ -+ return 0; -+} -+ -+static int proc_get_sec_cam(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ -+ RTW_PRINT_SEL(m, "sec_cap:0x%02x\n", cam_ctl->sec_cap); -+ RTW_PRINT_SEL(m, "flags:0x%08x\n", cam_ctl->flags); -+ RTW_PRINT_SEL(m, "\n"); -+ -+ RTW_PRINT_SEL(m, "max_num:%u\n", cam_ctl->num); -+ RTW_PRINT_SEL(m, "used:\n"); -+ dump_sec_cam_map(m, &cam_ctl->used, cam_ctl->num); -+ RTW_PRINT_SEL(m, "\n"); -+ -+ RTW_PRINT_SEL(m, "reg_scr:0x%04x\n", rtw_read16(adapter, 0x680)); -+ RTW_PRINT_SEL(m, "\n"); -+ -+ dump_sec_cam(m, adapter); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_sec_cam(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; -+ char tmp[32] = {0}; -+ char cmd[4]; -+ u8 id_1 = 0, id_2 = 0; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ /* c : clear specific cam entry */ -+ /* wfc : write specific cam entry from cam cache */ -+ /* sw : sec_cam 1/2 swap */ -+ -+ int num = sscanf(tmp, "%s %hhu %hhu", cmd, &id_1, &id_2); -+ -+ if (num < 2) -+ return count; -+ -+ if ((id_1 >= cam_ctl->num) || (id_2 >= cam_ctl->num)) { -+ RTW_ERR(FUNC_ADPT_FMT" invalid id_1:%u id_2:%u\n", FUNC_ADPT_ARG(adapter), id_1, id_2); -+ return count; -+ } -+ -+ if (strcmp("c", cmd) == 0) { -+ _clear_cam_entry(adapter, id_1); -+ adapter->securitypriv.hw_decrypted = _FALSE; /* temporarily set this for TX path to use SW enc */ -+ } else if (strcmp("wfc", cmd) == 0) -+ write_cam_from_cache(adapter, id_1); -+ else if (strcmp("sw", cmd) == 0) -+ rtw_sec_cam_swap(adapter, id_1, id_2); -+ else if (strcmp("cdk", cmd) == 0) -+ rtw_clean_dk_section(adapter); -+#ifdef DBG_SEC_CAM_MOVE -+ else if (strcmp("sgd", cmd) == 0) -+ rtw_hal_move_sta_gk_to_dk(adapter); -+ else if (strcmp("rsd", cmd) == 0) -+ rtw_hal_read_sta_dk_key(adapter, id_1); -+#endif -+ } -+ -+ return count; -+} -+ -+static int proc_get_sec_cam_cache(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_sec_cam_cache(m, adapter); -+ return 0; -+} -+ -+static ssize_t proc_set_change_bss_chbw(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlme = &(adapter->mlmepriv); -+ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); -+ char tmp[32]; -+ s16 ch; -+ s8 bw = -1, offset = -1; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hd %hhd %hhd", &ch, &bw, &offset); -+ -+ if (num < 1 || (bw != CHANNEL_WIDTH_20 && num < 3)) -+ goto exit; -+ -+ if (check_fwstate(mlme, WIFI_AP_STATE) && check_fwstate(mlme, WIFI_ASOC_STATE)) -+ rtw_change_bss_chbw_cmd(adapter, RTW_CMDF_WAIT_ACK, ch, bw, offset); -+ } -+ -+exit: -+ return count; -+} -+ -+#ifdef CONFIG_80211N_HT -+static int proc_get_tx_bw_mode(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "0x%02x\n", adapter->driver_tx_bw_mode); -+ RTW_PRINT_SEL(m, "2.4G:%s\n", ch_width_str(ADAPTER_TX_BW_2G(adapter))); -+ RTW_PRINT_SEL(m, "5G:%s\n", ch_width_str(ADAPTER_TX_BW_5G(adapter))); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_tx_bw_mode(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; -+ struct mlme_priv *mlme = &(adapter->mlmepriv); -+ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); -+ char tmp[32]; -+ u8 bw_mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ u8 update = _FALSE; -+ int num = sscanf(tmp, "%hhx", &bw_mode); -+ -+ if (num < 1 || bw_mode == adapter->driver_tx_bw_mode) -+ goto exit; -+ -+ if ((MLME_STATE(adapter) & WIFI_ASOC_STATE) -+ && ((mlmeext->cur_channel <= 14 && BW_MODE_2G(bw_mode) != ADAPTER_TX_BW_2G(adapter)) -+ || (mlmeext->cur_channel >= 36 && BW_MODE_5G(bw_mode) != ADAPTER_TX_BW_5G(adapter))) -+ ) { -+ /* RA mask update needed */ -+ update = _TRUE; -+ } -+ adapter->driver_tx_bw_mode = bw_mode; -+ -+ if (update == _TRUE) { -+ struct sta_info *sta; -+ int i; -+ -+ for (i = 0; i < MACID_NUM_SW_LIMIT; i++) { -+ sta = macid_ctl->sta[i]; -+ if (sta && !is_broadcast_mac_addr(sta->hwaddr)) -+ rtw_dm_ra_mask_wk_cmd(adapter, (u8 *)sta); -+ } -+ } -+ } -+ -+exit: -+ return count; -+} -+#endif /* CONFIG_80211N_HT */ -+ -+static int proc_get_hal_txpwr_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); -+ -+ if (hal_is_band_support(adapter, BAND_ON_2_4G)) -+ dump_hal_txpwr_info_2g(m, adapter, hal_spec->rfpath_num_2g, hal_spec->max_tx_cnt); -+ -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ if (hal_is_band_support(adapter, BAND_ON_5G)) -+ dump_hal_txpwr_info_5g(m, adapter, hal_spec->rfpath_num_5g, hal_spec->max_tx_cnt); -+#endif -+ -+ return 0; -+} -+ -+static int proc_get_target_tx_power(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_target_tx_power(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_tx_power_by_rate(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_tx_power_by_rate(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_tx_power_limit(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_tx_power_limit(m, adapter); -+ -+ return 0; -+} -+ -+static int proc_get_tx_power_ext_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_tx_power_ext_info(m, adapter); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_tx_power_ext_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ char tmp[32] = {0}; -+ char cmd[16] = {0}; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%s", cmd); -+ -+ if (num < 1) -+ return count; -+ -+ #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE -+ phy_free_filebuf_mask(adapter, LOAD_BB_PG_PARA_FILE | LOAD_RF_TXPWR_LMT_PARA_FILE); -+ #endif -+ -+ rtw_ps_deny(adapter, PS_DENY_IOCTL); -+ LeaveAllPowerSaveModeDirect(adapter); -+ -+ if (strcmp("default", cmd) == 0) -+ rtw_run_in_thread_cmd(adapter, ((void *)(phy_reload_default_tx_power_ext_info)), adapter); -+ else -+ rtw_run_in_thread_cmd(adapter, ((void *)(phy_reload_tx_power_ext_info)), adapter); -+ -+ rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); -+ } -+ -+ return count; -+} -+ -+static void *proc_start_tx_power_idx(struct seq_file *m, loff_t *pos) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 path = ((*pos) & 0xFF00) >> 8; -+ u8 rs = *pos & 0xFF; -+ -+ if (path >= RF_PATH_MAX) -+ return NULL; -+ -+ return pos; -+} -+static void proc_stop_tx_power_idx(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+} -+ -+static void *proc_next_tx_power_idx(struct seq_file *m, void *v, loff_t *pos) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 path = ((*pos) & 0xFF00) >> 8; -+ u8 rs = *pos & 0xFF; -+ -+ rs++; -+ if (rs >= RATE_SECTION_NUM) { -+ rs = 0; -+ path++; -+ } -+ -+ if (path >= RF_PATH_MAX) -+ return NULL; -+ -+ *pos = (path << 8) | rs; -+ -+ return pos; -+} -+ -+static int proc_get_tx_power_idx(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u32 pos = *((loff_t *)(v)); -+ u8 path = (pos & 0xFF00) >> 8; -+ u8 rs = pos & 0xFF; -+ -+ if (0) -+ RTW_INFO("%s path=%u, rs=%u\n", __func__, path, rs); -+ -+ if (path == RF_PATH_A && rs == CCK) -+ dump_tx_power_idx_title(m, adapter); -+ dump_tx_power_idx_by_path_rs(m, adapter, path, rs); -+ -+ return 0; -+} -+ -+static struct seq_operations seq_ops_tx_power_idx = { -+ .start = proc_start_tx_power_idx, -+ .stop = proc_stop_tx_power_idx, -+ .next = proc_next_tx_power_idx, -+ .show = proc_get_tx_power_idx, -+}; -+ -+#ifdef CONFIG_RF_POWER_TRIM -+static int proc_get_kfree_flag(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ -+ RTW_PRINT_SEL(m, "0x%02x\n", kfree_data->flag); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_kfree_flag(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ char tmp[32] = {0}; -+ u8 flag; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &flag); -+ -+ if (num < 1) -+ return count; -+ -+ kfree_data->flag = flag; -+ } -+ -+ return count; -+} -+ -+static int proc_get_kfree_bb_gain(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ u8 i, j; -+ -+ for (i = 0; i < BB_GAIN_NUM; i++) { -+ if (i == 0) -+ _RTW_PRINT_SEL(m, "2G: "); -+ else if (i == 1) -+ _RTW_PRINT_SEL(m, "5GLB1: "); -+ else if (i == 2) -+ _RTW_PRINT_SEL(m, "5GLB2: "); -+ else if (i == 3) -+ _RTW_PRINT_SEL(m, "5GMB1: "); -+ else if (i == 4) -+ _RTW_PRINT_SEL(m, "5GMB2: "); -+ else if (i == 5) -+ _RTW_PRINT_SEL(m, "5GHB: "); -+ -+ for (j = 0; j < hal_data->NumTotalRFPath; j++) -+ _RTW_PRINT_SEL(m, "%d ", kfree_data->bb_gain[i][j]); -+ _RTW_PRINT_SEL(m, "\n"); -+ } -+ -+ return 0; -+} -+ -+static ssize_t proc_set_kfree_bb_gain(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ char tmp[BB_GAIN_NUM * RF_PATH_MAX] = {0}; -+ u8 path, chidx; -+ s8 bb_gain[BB_GAIN_NUM]; -+ char ch_band_Group[6]; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ char *c, *next; -+ int i = 0; -+ -+ next = tmp; -+ c = strsep(&next, " \t"); -+ -+ if (sscanf(c, "%s", ch_band_Group) != 1) { -+ RTW_INFO("Error Head Format, channel Group select\n,Please input:\t 2G , 5GLB1 , 5GLB2 , 5GMB1 , 5GMB2 , 5GHB\n"); -+ return count; -+ } -+ if (strcmp("2G", ch_band_Group) == 0) -+ chidx = BB_GAIN_2G; -+#ifdef CONFIG_IEEE80211_BAND_5GHZ -+ else if (strcmp("5GLB1", ch_band_Group) == 0) -+ chidx = BB_GAIN_5GLB1; -+ else if (strcmp("5GLB2", ch_band_Group) == 0) -+ chidx = BB_GAIN_5GLB2; -+ else if (strcmp("5GMB1", ch_band_Group) == 0) -+ chidx = BB_GAIN_5GMB1; -+ else if (strcmp("5GMB2", ch_band_Group) == 0) -+ chidx = BB_GAIN_5GMB2; -+ else if (strcmp("5GHB", ch_band_Group) == 0) -+ chidx = BB_GAIN_5GHB; -+#endif /*CONFIG_IEEE80211_BAND_5GHZ*/ -+ else { -+ RTW_INFO("Error Head Format, channel Group select\n,Please input:\t 2G , 5GLB1 , 5GLB2 , 5GMB1 , 5GMB2 , 5GHB\n"); -+ return count; -+ } -+ c = strsep(&next, " \t"); -+ -+ while (c != NULL) { -+ if (sscanf(c, "%hhx", &bb_gain[i]) != 1) -+ break; -+ -+ kfree_data->bb_gain[chidx][i] = bb_gain[i]; -+ RTW_INFO("%s,kfree_data->bb_gain[%d][%d]=%x\n", __func__, chidx, i, kfree_data->bb_gain[chidx][i]); -+ -+ c = strsep(&next, " \t"); -+ i++; -+ } -+ -+ } -+ -+ return count; -+ -+} -+ -+static int proc_get_kfree_thermal(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ -+ _RTW_PRINT_SEL(m, "%d\n", kfree_data->thermal); -+ -+ return 0; -+} -+ -+static ssize_t proc_set_kfree_thermal(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); -+ char tmp[32] = {0}; -+ s8 thermal; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhd", &thermal); -+ -+ if (num < 1) -+ return count; -+ -+ kfree_data->thermal = thermal; -+ } -+ -+ return count; -+} -+ -+static ssize_t proc_set_tx_gain_offset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter; -+ char tmp[32] = {0}; -+ u8 rf_path; -+ s8 offset; -+ -+ adapter = (_adapter *)rtw_netdev_priv(dev); -+ if (!adapter) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ u8 write_value; -+ int num = sscanf(tmp, "%hhu %hhd", &rf_path, &offset); -+ -+ if (num < 2) -+ return count; -+ -+ RTW_INFO("write rf_path:%u tx gain offset:%d\n", rf_path, offset); -+ rtw_rf_set_tx_gain_offset(adapter, rf_path, offset); -+ } -+ -+ return count; -+} -+#endif /* CONFIG_RF_POWER_TRIM */ -+ -+#ifdef CONFIG_BT_COEXIST -+ssize_t proc_set_btinfo_evt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 btinfo[8]; -+ -+ if (count < 6) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ int num = 0; -+ -+ _rtw_memset(btinfo, 0, 8); -+ -+ num = sscanf(tmp, "%hhx %hhx %hhx %hhx %hhx %hhx %hhx %hhx" -+ , &btinfo[0], &btinfo[1], &btinfo[2], &btinfo[3] -+ , &btinfo[4], &btinfo[5], &btinfo[6], &btinfo[7]); -+ -+ if (num < 6) -+ return -EINVAL; -+ -+ btinfo[1] = num - 2; -+ -+ rtw_btinfo_cmd(padapter, btinfo, btinfo[1] + 2); -+ } -+ -+ return count; -+} -+ -+static u8 btreg_read_type = 0; -+static u16 btreg_read_addr = 0; -+static int btreg_read_error = 0; -+static u8 btreg_write_type = 0; -+static u16 btreg_write_addr = 0; -+static int btreg_write_error = 0; -+ -+static u8 *btreg_type[] = { -+ "rf", -+ "modem", -+ "bluewize", -+ "vendor", -+ "le" -+}; -+ -+static int btreg_parse_str(char const *input, u8 *type, u16 *addr, u16 *val) -+{ -+ u32 num; -+ u8 str[80] = {0}; -+ u8 t = 0; -+ u32 a, v; -+ u8 i, n; -+ u8 *p; -+ -+ -+ num = sscanf(input, "%s %x %x", str, &a, &v); -+ if (num < 2) { -+ RTW_INFO("%s: INVALID input!(%s)\n", __FUNCTION__, input); -+ return -EINVAL; -+ } -+ if ((num < 3) && val) { -+ RTW_INFO("%s: INVALID input!(%s)\n", __FUNCTION__, input); -+ return -EINVAL; -+ } -+ -+ /* convert to lower case for following type compare */ -+ p = str; -+ for (; *p; ++p) -+ *p = tolower(*p); -+ n = sizeof(btreg_type) / sizeof(btreg_type[0]); -+ for (i = 0; i < n; i++) { -+ if (!strcmp(str, btreg_type[i])) { -+ t = i; -+ break; -+ } -+ } -+ if (i == n) { -+ RTW_INFO("%s: unknown type(%s)!\n", __FUNCTION__, str); -+ return -EINVAL; -+ } -+ -+ switch (t) { -+ case 0: -+ /* RF */ -+ if (a & 0xFFFFFF80) { -+ RTW_INFO("%s: INVALID address(0x%X) for type %s(%d)!\n", -+ __FUNCTION__, a, btreg_type[t], t); -+ return -EINVAL; -+ } -+ break; -+ case 1: -+ /* Modem */ -+ if (a & 0xFFFFFE00) { -+ RTW_INFO("%s: INVALID address(0x%X) for type %s(%d)!\n", -+ __FUNCTION__, a, btreg_type[t], t); -+ return -EINVAL; -+ } -+ break; -+ default: -+ /* Others(Bluewize, Vendor, LE) */ -+ if (a & 0xFFFFF000) { -+ RTW_INFO("%s: INVALID address(0x%X) for type %s(%d)!\n", -+ __FUNCTION__, a, btreg_type[t], t); -+ return -EINVAL; -+ } -+ break; -+ } -+ -+ if (val) { -+ if (v & 0xFFFF0000) { -+ RTW_INFO("%s: INVALID value(0x%x)!\n", __FUNCTION__, v); -+ return -EINVAL; -+ } -+ *val = (u16)v; -+ } -+ -+ *type = (u8)t; -+ *addr = (u16)a; -+ -+ return 0; -+} -+ -+int proc_get_btreg_read(struct seq_file *m, void *v) -+{ -+ struct net_device *dev; -+ PADAPTER padapter; -+ u16 ret; -+ u32 data; -+ -+ -+ if (btreg_read_error) -+ return btreg_read_error; -+ -+ dev = m->private; -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+ ret = rtw_btcoex_btreg_read(padapter, btreg_read_type, btreg_read_addr, &data); -+ if (CHECK_STATUS_CODE_FROM_BT_MP_OPER_RET(ret, BT_STATUS_BT_OP_SUCCESS)) -+ RTW_PRINT_SEL(m, "BTREG read: (%s)0x%04X = 0x%08x\n", btreg_type[btreg_read_type], btreg_read_addr, data); -+ else -+ RTW_PRINT_SEL(m, "BTREG read: (%s)0x%04X read fail. error code = 0x%04x.\n", btreg_type[btreg_read_type], btreg_read_addr, ret); -+ -+ return 0; -+} -+ -+ssize_t proc_set_btreg_read(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ PADAPTER padapter; -+ u8 tmp[80] = {0}; -+ u32 num; -+ int err; -+ -+ -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+ if (NULL == buffer) { -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", -+ FUNC_ADPT_ARG(padapter)); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (count < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", -+ FUNC_ADPT_ARG(padapter)); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ num = count; -+ if (num > (sizeof(tmp) - 1)) -+ num = (sizeof(tmp) - 1); -+ -+ if (copy_from_user(tmp, buffer, num)) { -+ RTW_INFO(FUNC_ADPT_FMT ": copy buffer from user space FAIL!\n", -+ FUNC_ADPT_ARG(padapter)); -+ err = -EFAULT; -+ goto exit; -+ } -+ /* [Coverity] sure tmp end with '\0'(string terminal) */ -+ tmp[sizeof(tmp) - 1] = 0; -+ -+ err = btreg_parse_str(tmp, &btreg_read_type, &btreg_read_addr, NULL); -+ if (err) -+ goto exit; -+ -+ RTW_INFO(FUNC_ADPT_FMT ": addr=(%s)0x%X\n", -+ FUNC_ADPT_ARG(padapter), btreg_type[btreg_read_type], btreg_read_addr); -+ -+exit: -+ btreg_read_error = err; -+ -+ return count; -+} -+ -+int proc_get_btreg_write(struct seq_file *m, void *v) -+{ -+ struct net_device *dev; -+ PADAPTER padapter; -+ u16 ret; -+ u32 data; -+ -+ -+ if (btreg_write_error < 0) -+ return btreg_write_error; -+ else if (btreg_write_error > 0) { -+ RTW_PRINT_SEL(m, "BTREG write: (%s)0x%04X write fail. error code = 0x%04x.\n", btreg_type[btreg_write_type], btreg_write_addr, btreg_write_error); -+ return 0; -+ } -+ -+ dev = m->private; -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+ ret = rtw_btcoex_btreg_read(padapter, btreg_write_type, btreg_write_addr, &data); -+ if (CHECK_STATUS_CODE_FROM_BT_MP_OPER_RET(ret, BT_STATUS_BT_OP_SUCCESS)) -+ RTW_PRINT_SEL(m, "BTREG read: (%s)0x%04X = 0x%08x\n", btreg_type[btreg_write_type], btreg_write_addr, data); -+ else -+ RTW_PRINT_SEL(m, "BTREG read: (%s)0x%04X read fail. error code = 0x%04x.\n", btreg_type[btreg_write_type], btreg_write_addr, ret); -+ -+ return 0; -+} -+ -+ssize_t proc_set_btreg_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ PADAPTER padapter; -+ u8 tmp[80] = {0}; -+ u32 num; -+ u16 val; -+ u16 ret; -+ int err; -+ -+ -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+ if (NULL == buffer) { -+ RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", -+ FUNC_ADPT_ARG(padapter)); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (count < 1) { -+ RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", -+ FUNC_ADPT_ARG(padapter)); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ num = count; -+ if (num > (sizeof(tmp) - 1)) -+ num = (sizeof(tmp) - 1); -+ -+ if (copy_from_user(tmp, buffer, num)) { -+ RTW_INFO(FUNC_ADPT_FMT ": copy buffer from user space FAIL!\n", -+ FUNC_ADPT_ARG(padapter)); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ err = btreg_parse_str(tmp, &btreg_write_type, &btreg_write_addr, &val); -+ if (err) -+ goto exit; -+ -+ RTW_INFO(FUNC_ADPT_FMT ": Set (%s)0x%X = 0x%x\n", -+ FUNC_ADPT_ARG(padapter), btreg_type[btreg_write_type], btreg_write_addr, val); -+ -+ ret = rtw_btcoex_btreg_write(padapter, btreg_write_type, btreg_write_addr, val); -+ if (!CHECK_STATUS_CODE_FROM_BT_MP_OPER_RET(ret, BT_STATUS_BT_OP_SUCCESS)) -+ err = ret; -+ -+exit: -+ btreg_write_error = err; -+ -+ return count; -+} -+#endif /* CONFIG_BT_COEXIST */ -+ -+#ifdef CONFIG_MBSSID_CAM -+int proc_get_mbid_cam_cache(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_mbid_cam_cache_dump(m, __func__, adapter); -+ rtw_mbid_cam_dump(m, __func__, adapter); -+ return 0; -+} -+#endif /* CONFIG_MBSSID_CAM */ -+ -+int proc_get_mac_addr(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_hal_dump_macaddr(m, adapter); -+ return 0; -+} -+ -+static int proc_get_skip_band(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ int bandskip; -+ -+ bandskip = RTW_GET_SCAN_BAND_SKIP(adapter); -+ RTW_PRINT_SEL(m, "bandskip:0x%02x\n", bandskip); -+ return 0; -+} -+ -+static ssize_t proc_set_skip_band(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[6]; -+ u8 skip_band; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu", &skip_band); -+ -+ if (num < 1) -+ return -EINVAL; -+ -+ if (1 == skip_band) -+ RTW_SET_SCAN_BAND_SKIP(padapter, BAND_24G); -+ else if (2 == skip_band) -+ RTW_SET_SCAN_BAND_SKIP(padapter, BAND_5G); -+ else if (3 == skip_band) -+ RTW_CLR_SCAN_BAND_SKIP(padapter, BAND_24G); -+ else if (4 == skip_band) -+ RTW_CLR_SCAN_BAND_SKIP(padapter, BAND_5G); -+ } -+ return count; -+ -+} -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+static int proc_get_best_chan(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 best_24g_ch = 0, best_5g_ch = 0; -+ -+ rtw_hal_get_odm_var(adapter, HAL_ODM_AUTO_CHNL_SEL, &(best_24g_ch), &(best_5g_ch)); -+ -+ RTW_PRINT_SEL(m, "Best 2.4G CH:%u\n", best_24g_ch); -+ RTW_PRINT_SEL(m, "Best 5G CH:%u\n", best_5g_ch); -+ return 0; -+} -+ -+static ssize_t proc_set_acs(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 acs_satae = 0; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhu", &acs_satae); -+ -+ if (num < 1) -+ return -EINVAL; -+ -+ if (1 == acs_satae) -+ rtw_acs_start(padapter, _TRUE); -+ else -+ rtw_acs_start(padapter, _FALSE); -+ -+ } -+ return count; -+} -+#endif -+ -+static int proc_get_hal_spec(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_hal_spec(m, adapter); -+ return 0; -+} -+ -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+#include "../../hal/hal_halmac.h" -+static int proc_get_trx_share_mode(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ dump_trx_share_mode(m, adapter); -+ return 0; -+} -+#endif -+ -+static int proc_get_napi_info(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ u8 napi = 0, gro = 0; -+ u32 weight = 0; -+ -+ -+#ifdef CONFIG_RTW_NAPI -+ if (pregistrypriv->en_napi) { -+ napi = 1; -+ weight = RTL_NAPI_WEIGHT; -+ } -+ -+#ifdef CONFIG_RTW_GRO -+ if (pregistrypriv->en_gro) -+ gro = 1; -+#endif /* CONFIG_RTW_GRO */ -+#endif /* CONFIG_RTW_NAPI */ -+ -+ if (napi) -+ RTW_PRINT_SEL(m, "NAPI enable, weight=%d\n", weight); -+ else -+ RTW_PRINT_SEL(m, "NAPI disable\n"); -+ RTW_PRINT_SEL(m, "GRO %s\n", gro?"enable":"disable"); -+ -+ return 0; -+} -+ -+/* -+* rtw_adapter_proc: -+* init/deinit when register/unregister net_device -+*/ -+const struct rtw_proc_hdl adapter_proc_hdls[] = { -+#if RTW_SEQ_FILE_TEST -+ RTW_PROC_HDL_SEQ("seq_file_test", &seq_file_test, NULL), -+#endif -+ RTW_PROC_HDL_SSEQ("write_reg", NULL, proc_set_write_reg), -+ RTW_PROC_HDL_SSEQ("read_reg", proc_get_read_reg, proc_set_read_reg), -+ RTW_PROC_HDL_SSEQ("tx_rate_bmp", proc_get_dump_tx_rate_bmp, NULL), -+ RTW_PROC_HDL_SSEQ("adapters_status", proc_get_dump_adapters_status, NULL), -+#ifdef CONFIG_RTW_CUSTOMER_STR -+ RTW_PROC_HDL_SSEQ("customer_str", proc_get_customer_str, NULL), -+#endif -+ RTW_PROC_HDL_SSEQ("fwstate", proc_get_fwstate, NULL), -+ RTW_PROC_HDL_SSEQ("sec_info", proc_get_sec_info, NULL), -+ RTW_PROC_HDL_SSEQ("mlmext_state", proc_get_mlmext_state, NULL), -+ RTW_PROC_HDL_SSEQ("qos_option", proc_get_qos_option, NULL), -+ RTW_PROC_HDL_SSEQ("ht_option", proc_get_ht_option, NULL), -+ RTW_PROC_HDL_SSEQ("rf_info", proc_get_rf_info, NULL), -+ RTW_PROC_HDL_SSEQ("scan_param", proc_get_scan_param, proc_set_scan_param), -+ RTW_PROC_HDL_SSEQ("scan_abort", proc_get_scan_abort, NULL), -+#ifdef CONFIG_SCAN_BACKOP -+ RTW_PROC_HDL_SSEQ("backop_flags_sta", proc_get_backop_flags_sta, proc_set_backop_flags_sta), -+ RTW_PROC_HDL_SSEQ("backop_flags_ap", proc_get_backop_flags_ap, proc_set_backop_flags_ap), -+#endif -+ RTW_PROC_HDL_SSEQ("survey_info", proc_get_survey_info, proc_set_survey_info), -+ RTW_PROC_HDL_SSEQ("ap_info", proc_get_ap_info, NULL), -+ RTW_PROC_HDL_SSEQ("trx_info", proc_get_trx_info, proc_reset_trx_info), -+ RTW_PROC_HDL_SSEQ("rate_ctl", proc_get_rate_ctl, proc_set_rate_ctl), -+ RTW_PROC_HDL_SSEQ("bw_ctl", proc_get_bw_ctl, proc_set_bw_ctl), -+ RTW_PROC_HDL_SSEQ("dis_pwt_ctl", proc_get_dis_pwt, proc_set_dis_pwt), -+ RTW_PROC_HDL_SSEQ("mac_qinfo", proc_get_mac_qinfo, NULL), -+ RTW_PROC_HDL_SSEQ("macid_info", proc_get_macid_info, NULL), -+ RTW_PROC_HDL_SSEQ("bcmc_info", proc_get_mi_ap_bc_info, NULL), -+ RTW_PROC_HDL_SSEQ("sec_cam", proc_get_sec_cam, proc_set_sec_cam), -+ RTW_PROC_HDL_SSEQ("sec_cam_cache", proc_get_sec_cam_cache, NULL), -+ RTW_PROC_HDL_SSEQ("suspend_info", proc_get_suspend_resume_info, NULL), -+ RTW_PROC_HDL_SSEQ("wifi_spec", proc_get_wifi_spec, NULL), -+#ifdef CONFIG_LAYER2_ROAMING -+ RTW_PROC_HDL_SSEQ("roam_flags", proc_get_roam_flags, proc_set_roam_flags), -+ RTW_PROC_HDL_SSEQ("roam_param", proc_get_roam_param, proc_set_roam_param), -+ RTW_PROC_HDL_SSEQ("roam_tgt_addr", NULL, proc_set_roam_tgt_addr), -+#endif /* CONFIG_LAYER2_ROAMING */ -+ -+#ifdef CONFIG_RTW_80211R -+ RTW_PROC_HDL_SSEQ("ft_flags", proc_get_ft_flags, proc_set_ft_flags), -+#endif -+ -+#ifdef CONFIG_SDIO_HCI -+ RTW_PROC_HDL_SSEQ("sd_f0_reg_dump", proc_get_sd_f0_reg_dump, NULL), -+ RTW_PROC_HDL_SSEQ("sdio_local_reg_dump", proc_get_sdio_local_reg_dump, NULL), -+#endif /* CONFIG_SDIO_HCI */ -+ -+ RTW_PROC_HDL_SSEQ("fwdl_test_case", NULL, proc_set_fwdl_test_case), -+ RTW_PROC_HDL_SSEQ("del_rx_ampdu_test_case", NULL, proc_set_del_rx_ampdu_test_case), -+ RTW_PROC_HDL_SSEQ("wait_hiq_empty", NULL, proc_set_wait_hiq_empty), -+ -+ RTW_PROC_HDL_SSEQ("mac_reg_dump", proc_get_mac_reg_dump, NULL), -+ RTW_PROC_HDL_SSEQ("bb_reg_dump", proc_get_bb_reg_dump, NULL), -+ RTW_PROC_HDL_SSEQ("rf_reg_dump", proc_get_rf_reg_dump, NULL), -+ -+#ifdef CONFIG_AP_MODE -+ RTW_PROC_HDL_SSEQ("all_sta_info", proc_get_all_sta_info, NULL), -+#endif /* CONFIG_AP_MODE */ -+ -+#ifdef DBG_MEMORY_LEAK -+ RTW_PROC_HDL_SSEQ("_malloc_cnt", proc_get_malloc_cnt, NULL), -+#endif /* DBG_MEMORY_LEAK */ -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ RTW_PROC_HDL_SSEQ("best_channel", proc_get_best_channel, proc_set_best_channel), -+#endif -+ -+ RTW_PROC_HDL_SSEQ("rx_signal", proc_get_rx_signal, proc_set_rx_signal), -+ RTW_PROC_HDL_SSEQ("hw_info", proc_get_hw_status, proc_set_hw_status), -+ -+#ifdef CONFIG_80211N_HT -+ RTW_PROC_HDL_SSEQ("ht_enable", proc_get_ht_enable, proc_set_ht_enable), -+ RTW_PROC_HDL_SSEQ("bw_mode", proc_get_bw_mode, proc_set_bw_mode), -+ RTW_PROC_HDL_SSEQ("ampdu_enable", proc_get_ampdu_enable, proc_set_ampdu_enable), -+ RTW_PROC_HDL_SSEQ("rx_stbc", proc_get_rx_stbc, proc_set_rx_stbc), -+ RTW_PROC_HDL_SSEQ("rx_ampdu", proc_get_rx_ampdu, proc_set_rx_ampdu), -+ RTW_PROC_HDL_SSEQ("rx_ampdu_factor", proc_get_rx_ampdu_factor, proc_set_rx_ampdu_factor), -+ RTW_PROC_HDL_SSEQ("rx_ampdu_density", proc_get_rx_ampdu_density, proc_set_rx_ampdu_density), -+ RTW_PROC_HDL_SSEQ("tx_ampdu_density", proc_get_tx_ampdu_density, proc_set_tx_ampdu_density), -+#endif /* CONFIG_80211N_HT */ -+ -+ RTW_PROC_HDL_SSEQ("en_fwps", proc_get_en_fwps, proc_set_en_fwps), -+ RTW_PROC_HDL_SSEQ("mac_rptbuf", proc_get_mac_rptbuf, NULL), -+ -+ /* RTW_PROC_HDL_SSEQ("path_rssi", proc_get_two_path_rssi, NULL), -+ * RTW_PROC_HDL_SSEQ("rssi_disp",proc_get_rssi_disp, proc_set_rssi_disp), */ -+ -+#ifdef CONFIG_BT_COEXIST -+ RTW_PROC_HDL_SSEQ("btcoex_dbg", proc_get_btcoex_dbg, proc_set_btcoex_dbg), -+ RTW_PROC_HDL_SSEQ("btcoex", proc_get_btcoex_info, NULL), -+ RTW_PROC_HDL_SSEQ("btinfo_evt", NULL, proc_set_btinfo_evt), -+ RTW_PROC_HDL_SSEQ("btreg_read", proc_get_btreg_read, proc_set_btreg_read), -+ RTW_PROC_HDL_SSEQ("btreg_write", proc_get_btreg_write, proc_set_btreg_write), -+#endif /* CONFIG_BT_COEXIST */ -+ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ RTW_PROC_HDL_SSEQ("sreset", proc_get_sreset, proc_set_sreset), -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ RTW_PROC_HDL_SSEQ("trx_info_debug", proc_get_trx_info_debug, NULL), -+ RTW_PROC_HDL_SSEQ("linked_info_dump", proc_get_linked_info_dump, proc_set_linked_info_dump), -+ RTW_PROC_HDL_SSEQ("tx_info_msg", proc_get_tx_info_msg, NULL), -+ RTW_PROC_HDL_SSEQ("rx_info_msg", proc_get_rx_info_msg, proc_set_rx_info_msg), -+#ifdef CONFIG_GPIO_API -+ RTW_PROC_HDL_SSEQ("gpio_info", proc_get_gpio, proc_set_gpio), -+ RTW_PROC_HDL_SSEQ("gpio_set_output_value", NULL, proc_set_gpio_output_value), -+ RTW_PROC_HDL_SSEQ("gpio_set_direction", NULL, proc_set_config_gpio), -+#endif -+ -+#ifdef CONFIG_DBG_COUNTER -+ RTW_PROC_HDL_SSEQ("rx_logs", proc_get_rx_logs, NULL), -+ RTW_PROC_HDL_SSEQ("tx_logs", proc_get_tx_logs, NULL), -+ RTW_PROC_HDL_SSEQ("int_logs", proc_get_int_logs, NULL), -+#endif -+ -+#ifdef CONFIG_PCI_HCI -+ RTW_PROC_HDL_SSEQ("rx_ring", proc_get_rx_ring, NULL), -+ RTW_PROC_HDL_SSEQ("tx_ring", proc_get_tx_ring, NULL), -+#endif -+ -+#ifdef CONFIG_WOWLAN -+ RTW_PROC_HDL_SSEQ("wow_pattern_info", proc_get_pattern_info, proc_set_pattern_info), -+ RTW_PROC_HDL_SSEQ("wowlan_last_wake_reason", proc_get_wakeup_reason, NULL), -+#endif -+ -+#ifdef CONFIG_GPIO_WAKEUP -+ RTW_PROC_HDL_SSEQ("wowlan_gpio_info", proc_get_wowlan_gpio_info, proc_set_wowlan_gpio_info), -+#endif -+#ifdef CONFIG_P2P_WOWLAN -+ RTW_PROC_HDL_SSEQ("p2p_wowlan_info", proc_get_p2p_wowlan_info, NULL), -+#endif -+ RTW_PROC_HDL_SSEQ("country_code", proc_get_country_code, proc_set_country_code), -+ RTW_PROC_HDL_SSEQ("chan_plan", proc_get_chan_plan, proc_set_chan_plan), -+#if defined(CONFIG_RTW_MACADDR_ACL) && defined(CONFIG_AP_MODE) -+ RTW_PROC_HDL_SSEQ("macaddr_acl", proc_get_macaddr_acl, proc_set_macaddr_acl), -+#endif -+#ifdef CONFIG_DFS_MASTER -+ RTW_PROC_HDL_SSEQ("dfs_master_test_case", proc_get_dfs_master_test_case, proc_set_dfs_master_test_case), -+ RTW_PROC_HDL_SSEQ("update_non_ocp", NULL, proc_set_update_non_ocp), -+ RTW_PROC_HDL_SSEQ("radar_detect", NULL, proc_set_radar_detect), -+ RTW_PROC_HDL_SSEQ("dfs_ch_sel_d_flags", proc_get_dfs_ch_sel_d_flags, proc_set_dfs_ch_sel_d_flags), -+#endif -+ RTW_PROC_HDL_SSEQ("new_bcn_max", proc_get_new_bcn_max, proc_set_new_bcn_max), -+ RTW_PROC_HDL_SSEQ("sink_udpport", proc_get_udpport, proc_set_udpport), -+#ifdef DBG_RX_COUNTER_DUMP -+ RTW_PROC_HDL_SSEQ("dump_rx_cnt_mode", proc_get_rx_cnt_dump, proc_set_rx_cnt_dump), -+#endif -+ RTW_PROC_HDL_SSEQ("change_bss_chbw", NULL, proc_set_change_bss_chbw), -+#ifdef CONFIG_80211N_HT -+ RTW_PROC_HDL_SSEQ("tx_bw_mode", proc_get_tx_bw_mode, proc_set_tx_bw_mode), -+#endif /* CONFIG_80211N_HT */ -+ RTW_PROC_HDL_SSEQ("hal_txpwr_info", proc_get_hal_txpwr_info, NULL), -+ RTW_PROC_HDL_SSEQ("target_tx_power", proc_get_target_tx_power, NULL), -+ RTW_PROC_HDL_SSEQ("tx_power_by_rate", proc_get_tx_power_by_rate, NULL), -+ RTW_PROC_HDL_SSEQ("tx_power_limit", proc_get_tx_power_limit, NULL), -+ RTW_PROC_HDL_SSEQ("tx_power_ext_info", proc_get_tx_power_ext_info, proc_set_tx_power_ext_info), -+ RTW_PROC_HDL_SEQ("tx_power_idx", &seq_ops_tx_power_idx, NULL), -+#ifdef CONFIG_RF_POWER_TRIM -+ RTW_PROC_HDL_SSEQ("tx_gain_offset", NULL, proc_set_tx_gain_offset), -+ RTW_PROC_HDL_SSEQ("kfree_flag", proc_get_kfree_flag, proc_set_kfree_flag), -+ RTW_PROC_HDL_SSEQ("kfree_bb_gain", proc_get_kfree_bb_gain, proc_set_kfree_bb_gain), -+ RTW_PROC_HDL_SSEQ("kfree_thermal", proc_get_kfree_thermal, proc_set_kfree_thermal), -+#endif -+#ifdef CONFIG_POWER_SAVING -+ RTW_PROC_HDL_SSEQ("ps_info", proc_get_ps_info, NULL), -+#endif -+#ifdef CONFIG_TDLS -+ RTW_PROC_HDL_SSEQ("tdls_info", proc_get_tdls_info, NULL), -+#endif -+ RTW_PROC_HDL_SSEQ("monitor", proc_get_monitor, proc_set_monitor), -+ -+#ifdef CONFIG_AUTO_CHNL_SEL_NHM -+ RTW_PROC_HDL_SSEQ("acs", proc_get_best_chan, proc_set_acs), -+#endif -+#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER -+ RTW_PROC_HDL_SSEQ("rtkm_info", proc_get_rtkm_info, NULL), -+#endif -+ RTW_PROC_HDL_SSEQ("efuse_map", proc_get_efuse_map, NULL), -+#ifdef CONFIG_IEEE80211W -+ RTW_PROC_HDL_SSEQ("11w_tx_sa_query", proc_get_tx_sa_query, proc_set_tx_sa_query), -+ RTW_PROC_HDL_SSEQ("11w_tx_deauth", proc_get_tx_deauth, proc_set_tx_deauth), -+ RTW_PROC_HDL_SSEQ("11w_tx_auth", proc_get_tx_auth, proc_set_tx_auth), -+#endif /* CONFIG_IEEE80211W */ -+ -+#ifdef CONFIG_MBSSID_CAM -+ RTW_PROC_HDL_SSEQ("mbid_cam", proc_get_mbid_cam_cache, NULL), -+#endif -+ RTW_PROC_HDL_SSEQ("mac_addr", proc_get_mac_addr, NULL), -+ RTW_PROC_HDL_SSEQ("skip_band", proc_get_skip_band, proc_set_skip_band), -+ RTW_PROC_HDL_SSEQ("hal_spec", proc_get_hal_spec, NULL), -+#ifdef CONFIG_SUPPORT_TRX_SHARED -+ RTW_PROC_HDL_SSEQ("trx_share_mode", proc_get_trx_share_mode, NULL), -+#endif -+ RTW_PROC_HDL_SSEQ("napi_info", proc_get_napi_info, NULL), -+}; -+ -+const int adapter_proc_hdls_num = sizeof(adapter_proc_hdls) / sizeof(struct rtw_proc_hdl); -+ -+static int rtw_adapter_proc_open(struct inode *inode, struct file *file) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(inode); -+ const struct rtw_proc_hdl *hdl = adapter_proc_hdls + index; -+ void *private = proc_get_parent_data(inode); -+ -+ if (hdl->type == RTW_PROC_HDL_TYPE_SEQ) { -+ int res = seq_open(file, hdl->u.seq_op); -+ -+ if (res == 0) -+ ((struct seq_file *)file->private_data)->private = private; -+ -+ return res; -+ } else if (hdl->type == RTW_PROC_HDL_TYPE_SSEQ) { -+ int (*show)(struct seq_file *, void *) = hdl->u.show ? hdl->u.show : proc_get_dummy; -+ -+ return single_open(file, show, private); -+ } else { -+ return -EROFS; -+ } -+} -+ -+static ssize_t rtw_adapter_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); -+ const struct rtw_proc_hdl *hdl = adapter_proc_hdls + index; -+ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; -+ -+ if (write) -+ return write(file, buffer, count, pos, ((struct seq_file *)file->private_data)->private); -+ -+ return -EROFS; -+} -+ -+static const struct file_operations rtw_adapter_proc_seq_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_adapter_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = seq_release, -+ .write = rtw_adapter_proc_write, -+}; -+ -+static const struct file_operations rtw_adapter_proc_sseq_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_adapter_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_adapter_proc_write, -+}; -+ -+int proc_get_odm_dbg_comp(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_odm_dbg_comp_msg(m, adapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_odm_dbg_comp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ -+ u64 dbg_comp; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%llx", &dbg_comp); -+ -+ if (num != 1) -+ return count; -+ -+ rtw_odm_dbg_comp_set(adapter, dbg_comp); -+ } -+ -+ return count; -+} -+ -+int proc_get_odm_dbg_level(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_odm_dbg_level_msg(m, adapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_odm_dbg_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ -+ u32 dbg_level; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%u", &dbg_level); -+ -+ if (num != 1) -+ return count; -+ -+ rtw_odm_dbg_level_set(adapter, dbg_level); -+ } -+ -+ return count; -+} -+ -+int proc_get_odm_ability(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_odm_ability_msg(m, adapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_odm_ability(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ -+ u32 ability; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%x", &ability); -+ -+ if (num != 1) -+ return count; -+ -+ rtw_odm_ability_set(adapter, ability); -+ } -+ -+ return count; -+} -+ -+int proc_get_odm_force_igi_lb(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ RTW_PRINT_SEL(m, "force_igi_lb:0x%02x\n", rtw_odm_get_force_igi_lb(padapter)); -+ -+ return 0; -+} -+ -+ssize_t proc_set_odm_force_igi_lb(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u8 force_igi_lb; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%hhx", &force_igi_lb); -+ -+ if (num != 1) -+ return count; -+ -+ rtw_odm_set_force_igi_lb(padapter, force_igi_lb); -+ } -+ -+ return count; -+} -+ -+int proc_get_odm_adaptivity(struct seq_file *m, void *v) -+{ -+ struct net_device *dev = m->private; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ rtw_odm_adaptivity_parm_msg(m, padapter); -+ -+ return 0; -+} -+ -+ssize_t proc_set_odm_adaptivity(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 TH_L2H_ini; -+ u32 TH_L2H_ini_mode2; -+ s8 TH_EDCCA_HL_diff; -+ s8 TH_EDCCA_HL_diff_mode2; -+ u8 EDCCA_enable; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) { -+ rtw_warn_on(1); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ -+ int num = sscanf(tmp, "%x %hhd %x %hhd %hhu", &TH_L2H_ini, &TH_EDCCA_HL_diff, &TH_L2H_ini_mode2, &TH_EDCCA_HL_diff_mode2, &EDCCA_enable); -+ -+ if (num != 5) -+ return count; -+ -+ rtw_odm_adaptivity_parm_set(padapter, (s8)TH_L2H_ini, TH_EDCCA_HL_diff, (s8)TH_L2H_ini_mode2, TH_EDCCA_HL_diff_mode2, EDCCA_enable); -+ } -+ -+ return count; -+} -+ -+static char *phydm_msg = NULL; -+#define PHYDM_MSG_LEN 80*24 -+ -+int proc_get_phydm_cmd(struct seq_file *m, void *v) -+{ -+ struct net_device *netdev; -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ PDM_ODM_T phydm; -+ -+ -+ netdev = m->private; -+ padapter = (PADAPTER)rtw_netdev_priv(netdev); -+ pHalData = GET_HAL_DATA(padapter); -+ phydm = &pHalData->odmpriv; -+ -+ if (NULL == phydm_msg) { -+ phydm_msg = rtw_zmalloc(PHYDM_MSG_LEN); -+ if (NULL == phydm_msg) -+ return -ENOMEM; -+ -+ phydm_cmd(phydm, NULL, 0, 0, phydm_msg, PHYDM_MSG_LEN); -+ } -+ -+ _RTW_PRINT_SEL(m, "%s\n", phydm_msg); -+ -+ rtw_mfree(phydm_msg, PHYDM_MSG_LEN); -+ phydm_msg = NULL; -+ -+ return 0; -+} -+ -+ssize_t proc_set_phydm_cmd(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -+{ -+ struct net_device *netdev; -+ PADAPTER padapter; -+ PHAL_DATA_TYPE pHalData; -+ PDM_ODM_T phydm; -+ char tmp[64] = {0}; -+ -+ -+ netdev = (struct net_device *)data; -+ padapter = (PADAPTER)rtw_netdev_priv(netdev); -+ pHalData = GET_HAL_DATA(padapter); -+ phydm = &pHalData->odmpriv; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (count > sizeof(tmp)) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, count)) { -+ if (NULL == phydm_msg) { -+ phydm_msg = rtw_zmalloc(PHYDM_MSG_LEN); -+ if (NULL == phydm_msg) -+ return -ENOMEM; -+ } else -+ _rtw_memset(phydm_msg, 0, PHYDM_MSG_LEN); -+ -+ phydm_cmd(phydm, tmp, count, 1, phydm_msg, PHYDM_MSG_LEN); -+ -+ if (strlen(phydm_msg) == 0) { -+ rtw_mfree(phydm_msg, PHYDM_MSG_LEN); -+ phydm_msg = NULL; -+ } -+ } -+ -+ return count; -+} -+ -+/* -+* rtw_odm_proc: -+* init/deinit when register/unregister net_device, along with rtw_adapter_proc -+*/ -+const struct rtw_proc_hdl odm_proc_hdls[] = { -+ RTW_PROC_HDL_SSEQ("dbg_comp", proc_get_odm_dbg_comp, proc_set_odm_dbg_comp), -+ RTW_PROC_HDL_SSEQ("dbg_level", proc_get_odm_dbg_level, proc_set_odm_dbg_level), -+ RTW_PROC_HDL_SSEQ("ability", proc_get_odm_ability, proc_set_odm_ability), -+ RTW_PROC_HDL_SSEQ("adaptivity", proc_get_odm_adaptivity, proc_set_odm_adaptivity), -+ RTW_PROC_HDL_SSEQ("force_igi_lb", proc_get_odm_force_igi_lb, proc_set_odm_force_igi_lb), -+ RTW_PROC_HDL_SSEQ("cmd", proc_get_phydm_cmd, proc_set_phydm_cmd), -+}; -+ -+const int odm_proc_hdls_num = sizeof(odm_proc_hdls) / sizeof(struct rtw_proc_hdl); -+ -+static int rtw_odm_proc_open(struct inode *inode, struct file *file) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(inode); -+ const struct rtw_proc_hdl *hdl = odm_proc_hdls + index; -+ void *private = proc_get_parent_data(inode); -+ -+ if (hdl->type == RTW_PROC_HDL_TYPE_SEQ) { -+ int res = seq_open(file, hdl->u.seq_op); -+ -+ if (res == 0) -+ ((struct seq_file *)file->private_data)->private = private; -+ -+ return res; -+ } else if (hdl->type == RTW_PROC_HDL_TYPE_SSEQ) { -+ int (*show)(struct seq_file *, void *) = hdl->u.show ? hdl->u.show : proc_get_dummy; -+ -+ return single_open(file, show, private); -+ } else { -+ return -EROFS; -+ } -+} -+ -+static ssize_t rtw_odm_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); -+ const struct rtw_proc_hdl *hdl = odm_proc_hdls + index; -+ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; -+ -+ if (write) -+ return write(file, buffer, count, pos, ((struct seq_file *)file->private_data)->private); -+ -+ return -EROFS; -+} -+ -+static const struct file_operations rtw_odm_proc_seq_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_odm_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = seq_release, -+ .write = rtw_odm_proc_write, -+}; -+ -+static const struct file_operations rtw_odm_proc_sseq_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_odm_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_odm_proc_write, -+}; -+ -+struct proc_dir_entry *rtw_odm_proc_init(struct net_device *dev) -+{ -+ struct proc_dir_entry *dir_odm = NULL; -+ struct proc_dir_entry *entry = NULL; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ ssize_t i; -+ -+ if (adapter->dir_dev == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (adapter->dir_odm != NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ dir_odm = rtw_proc_create_dir("odm", adapter->dir_dev, dev); -+ if (dir_odm == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ adapter->dir_odm = dir_odm; -+ -+ for (i = 0; i < odm_proc_hdls_num; i++) { -+ if (odm_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SEQ) -+ entry = rtw_proc_create_entry(odm_proc_hdls[i].name, dir_odm, &rtw_odm_proc_seq_fops, (void *)i); -+ else if (odm_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SSEQ) -+ entry = rtw_proc_create_entry(odm_proc_hdls[i].name, dir_odm, &rtw_odm_proc_sseq_fops, (void *)i); -+ else -+ entry = NULL; -+ -+ if (!entry) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ } -+ -+exit: -+ return dir_odm; -+} -+ -+void rtw_odm_proc_deinit(_adapter *adapter) -+{ -+ struct proc_dir_entry *dir_odm = NULL; -+ int i; -+ -+ dir_odm = adapter->dir_odm; -+ -+ if (dir_odm == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ for (i = 0; i < odm_proc_hdls_num; i++) -+ remove_proc_entry(odm_proc_hdls[i].name, dir_odm); -+ -+ remove_proc_entry("odm", adapter->dir_dev); -+ -+ adapter->dir_odm = NULL; -+ -+ if (phydm_msg) { -+ rtw_mfree(phydm_msg, PHYDM_MSG_LEN); -+ phydm_msg = NULL; -+ } -+} -+ -+#ifdef CONFIG_MCC_MODE -+/* -+* rtw_mcc_proc: -+* init/deinit when register/unregister net_device, along with rtw_adapter_proc -+*/ -+const struct rtw_proc_hdl mcc_proc_hdls[] = { -+ RTW_PROC_HDL_SSEQ("mcc_info", proc_get_mcc_info, NULL), -+ RTW_PROC_HDL_SSEQ("mcc_enable", proc_get_mcc_info, proc_set_mcc_enable), -+ RTW_PROC_HDL_SSEQ("mcc_single_tx_criteria", proc_get_mcc_info, proc_set_mcc_single_tx_criteria), -+ RTW_PROC_HDL_SSEQ("mcc_ap_bw20_target_tp", proc_get_mcc_info, proc_set_mcc_ap_bw20_target_tp), -+ RTW_PROC_HDL_SSEQ("mcc_ap_bw40_target_tp", proc_get_mcc_info, proc_set_mcc_ap_bw40_target_tp), -+ RTW_PROC_HDL_SSEQ("mcc_ap_bw80_target_tp", proc_get_mcc_info, proc_set_mcc_ap_bw80_target_tp), -+ RTW_PROC_HDL_SSEQ("mcc_sta_bw20_target_tp", proc_get_mcc_info, proc_set_mcc_sta_bw20_target_tp), -+ RTW_PROC_HDL_SSEQ("mcc_sta_bw40_target_tp", proc_get_mcc_info, proc_set_mcc_sta_bw40_target_tp), -+ RTW_PROC_HDL_SSEQ("mcc_sta_bw80_target_tp", proc_get_mcc_info, proc_set_mcc_sta_bw80_target_tp), -+}; -+ -+const int mcc_proc_hdls_num = sizeof(mcc_proc_hdls) / sizeof(struct rtw_proc_hdl); -+ -+static int rtw_mcc_proc_open(struct inode *inode, struct file *file) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(inode); -+ const struct rtw_proc_hdl *hdl = mcc_proc_hdls + index; -+ void *private = proc_get_parent_data(inode); -+ -+ if (hdl->type == RTW_PROC_HDL_TYPE_SEQ) { -+ int res = seq_open(file, hdl->u.seq_op); -+ -+ if (res == 0) -+ ((struct seq_file *)file->private_data)->private = private; -+ -+ return res; -+ } else if (hdl->type == RTW_PROC_HDL_TYPE_SSEQ) { -+ int (*show)(struct seq_file *, void *) = hdl->u.show ? hdl->u.show : proc_get_dummy; -+ -+ return single_open(file, show, private); -+ } else { -+ return -EROFS; -+ } -+} -+ -+static ssize_t rtw_mcc_proc_write(struct file *file, const char __user *buffer, size_t count, loff_t *pos) -+{ -+ ssize_t index = (ssize_t)PDE_DATA(file_inode(file)); -+ const struct rtw_proc_hdl *hdl = mcc_proc_hdls + index; -+ ssize_t (*write)(struct file *, const char __user *, size_t, loff_t *, void *) = hdl->write; -+ -+ if (write) -+ return write(file, buffer, count, pos, ((struct seq_file *)file->private_data)->private); -+ -+ return -EROFS; -+} -+ -+static const struct file_operations rtw_mcc_proc_seq_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_mcc_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = seq_release, -+ .write = rtw_mcc_proc_write, -+}; -+ -+static const struct file_operations rtw_mcc_proc_sseq_fops = { -+ .owner = THIS_MODULE, -+ .open = rtw_mcc_proc_open, -+ .read = seq_read, -+ .llseek = seq_lseek, -+ .release = single_release, -+ .write = rtw_mcc_proc_write, -+}; -+ -+struct proc_dir_entry *rtw_mcc_proc_init(struct net_device *dev) -+{ -+ struct proc_dir_entry *dir_mcc = NULL; -+ struct proc_dir_entry *entry = NULL; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ ssize_t i; -+ -+ if (adapter->dir_dev == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (adapter->dir_mcc != NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ dir_mcc = rtw_proc_create_dir("mcc", adapter->dir_dev, dev); -+ if (dir_mcc == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ adapter->dir_mcc = dir_mcc; -+ -+ for (i = 0; i < mcc_proc_hdls_num; i++) { -+ if (mcc_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SEQ) -+ entry = rtw_proc_create_entry(mcc_proc_hdls[i].name, dir_mcc, &rtw_mcc_proc_seq_fops, (void *)i); -+ else if (mcc_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SSEQ) -+ entry = rtw_proc_create_entry(mcc_proc_hdls[i].name, dir_mcc, &rtw_mcc_proc_sseq_fops, (void *)i); -+ else -+ entry = NULL; -+ -+ if (!entry) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ } -+ -+exit: -+ return dir_mcc; -+} -+ -+void rtw_mcc_proc_deinit(_adapter *adapter) -+{ -+ struct proc_dir_entry *dir_mcc = NULL; -+ int i; -+ -+ dir_mcc = adapter->dir_mcc; -+ -+ if (dir_mcc == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ for (i = 0; i < mcc_proc_hdls_num; i++) -+ remove_proc_entry(mcc_proc_hdls[i].name, dir_mcc); -+ -+ remove_proc_entry("mcc", adapter->dir_dev); -+ -+ adapter->dir_mcc = NULL; -+} -+#endif /* CONFIG_MCC_MODE */ -+ -+struct proc_dir_entry *rtw_adapter_proc_init(struct net_device *dev) -+{ -+ struct proc_dir_entry *drv_proc = get_rtw_drv_proc(); -+ struct proc_dir_entry *dir_dev = NULL; -+ struct proc_dir_entry *entry = NULL; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ u8 rf_type; -+ ssize_t i; -+ -+ if (drv_proc == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (adapter->dir_dev != NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ dir_dev = rtw_proc_create_dir(dev->name, drv_proc, dev); -+ if (dir_dev == NULL) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ adapter->dir_dev = dir_dev; -+ -+ for (i = 0; i < adapter_proc_hdls_num; i++) { -+ if (adapter_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SEQ) -+ entry = rtw_proc_create_entry(adapter_proc_hdls[i].name, dir_dev, &rtw_adapter_proc_seq_fops, (void *)i); -+ else if (adapter_proc_hdls[i].type == RTW_PROC_HDL_TYPE_SSEQ) -+ entry = rtw_proc_create_entry(adapter_proc_hdls[i].name, dir_dev, &rtw_adapter_proc_sseq_fops, (void *)i); -+ else -+ entry = NULL; -+ -+ if (!entry) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ } -+ -+ rtw_odm_proc_init(dev); -+ -+#ifdef CONFIG_MCC_MODE -+ rtw_mcc_proc_init(dev); -+#endif /* CONFIG_MCC_MODE */ -+ -+exit: -+ return dir_dev; -+} -+ -+void rtw_adapter_proc_deinit(struct net_device *dev) -+{ -+ struct proc_dir_entry *drv_proc = get_rtw_drv_proc(); -+ struct proc_dir_entry *dir_dev = NULL; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ int i; -+ -+ dir_dev = adapter->dir_dev; -+ -+ if (dir_dev == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ for (i = 0; i < adapter_proc_hdls_num; i++) -+ remove_proc_entry(adapter_proc_hdls[i].name, dir_dev); -+ -+ rtw_odm_proc_deinit(adapter); -+ -+#ifdef CONFIG_MCC_MODE -+ rtw_mcc_proc_deinit(adapter); -+#endif /* CONFIG_MCC_MODE */ -+ -+ remove_proc_entry(dev->name, drv_proc); -+ -+ adapter->dir_dev = NULL; -+} -+ -+void rtw_adapter_proc_replace(struct net_device *dev) -+{ -+ struct proc_dir_entry *drv_proc = get_rtw_drv_proc(); -+ struct proc_dir_entry *dir_dev = NULL; -+ _adapter *adapter = rtw_netdev_priv(dev); -+ int i; -+ -+ dir_dev = adapter->dir_dev; -+ -+ if (dir_dev == NULL) { -+ rtw_warn_on(1); -+ return; -+ } -+ -+ for (i = 0; i < adapter_proc_hdls_num; i++) -+ remove_proc_entry(adapter_proc_hdls[i].name, dir_dev); -+ -+ rtw_odm_proc_deinit(adapter); -+ -+#ifdef CONFIG_MCC_MODE -+ rtw_mcc_proc_deinit(adapter); -+#endif /* CONIG_MCC_MODE */ -+ -+ remove_proc_entry(adapter->old_ifname, drv_proc); -+ -+ adapter->dir_dev = NULL; -+ -+ rtw_adapter_proc_init(dev); -+ -+} -+ -+#endif /* CONFIG_PROC_DEBUG */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_proc.h linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_proc.h ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/rtw_proc.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/rtw_proc.h 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,65 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __RTW_PROC_H__ -+#define __RTW_PROC_H__ -+ -+#include -+#include -+ -+#define RTW_PROC_HDL_TYPE_SEQ 0 -+#define RTW_PROC_HDL_TYPE_SSEQ 1 -+ -+struct rtw_proc_hdl { -+ char *name; -+ u8 type; -+ union { -+ int (*show)(struct seq_file *, void *); -+ struct seq_operations *seq_op; -+ } u; -+ ssize_t (*write)(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -+}; -+ -+#define RTW_PROC_HDL_SEQ(_name, _seq_op, _write) \ -+ { .name = _name, .type = RTW_PROC_HDL_TYPE_SEQ, .u.seq_op = _seq_op, .write = _write} -+ -+#define RTW_PROC_HDL_SSEQ(_name, _show, _write) \ -+ { .name = _name, .type = RTW_PROC_HDL_TYPE_SSEQ, .u.show = _show, .write = _write} -+ -+#ifdef CONFIG_PROC_DEBUG -+ -+struct proc_dir_entry *get_rtw_drv_proc(void); -+int rtw_drv_proc_init(void); -+void rtw_drv_proc_deinit(void); -+struct proc_dir_entry *rtw_adapter_proc_init(struct net_device *dev); -+void rtw_adapter_proc_deinit(struct net_device *dev); -+void rtw_adapter_proc_replace(struct net_device *dev); -+ -+#else /* !CONFIG_PROC_DEBUG */ -+ -+#define get_rtw_drv_proc() NULL -+#define rtw_drv_proc_init() 0 -+#define rtw_drv_proc_deinit() do {} while (0) -+#define rtw_adapter_proc_init(dev) NULL -+#define rtw_adapter_proc_deinit(dev) do {} while (0) -+#define rtw_adapter_proc_replace(dev) do {} while (0) -+ -+#endif /* !CONFIG_PROC_DEBUG */ -+ -+#endif /* __RTW_PROC_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/wifi_regd.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/wifi_regd.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/wifi_regd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/wifi_regd.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,545 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2009-2010 Realtek Corporation. -+ * -+ *****************************************************************************/ -+ -+#include -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ -+#include -+ -+static struct country_code_to_enum_rd allCountries[] = { -+ {COUNTRY_CODE_USER, "RD"}, -+}; -+ -+/* -+ * REG_RULE(freq start, freq end, bandwidth, max gain, eirp, reg_flags) -+ */ -+ -+/* -+ *Only these channels all allow active -+ *scan on all world regulatory domains -+ */ -+ -+/* 2G chan 01 - chan 11 */ -+#define RTW_2GHZ_CH01_11 \ -+ REG_RULE(2412-10, 2462+10, 40, 0, 20, 0) -+ -+/* -+ *We enable active scan on these a case -+ *by case basis by regulatory domain -+ */ -+ -+/* 2G chan 12 - chan 13, PASSIV SCAN */ -+#define RTW_2GHZ_CH12_13 \ -+ REG_RULE(2467-10, 2472+10, 40, 0, 20, \ -+ NL80211_RRF_PASSIVE_SCAN) -+ -+/* 2G chan 14, PASSIVS SCAN, NO OFDM (B only) */ -+#define RTW_2GHZ_CH14 \ -+ REG_RULE(2484-10, 2484+10, 40, 0, 20, \ -+ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_OFDM) -+ -+/* 5G chan 36 - chan 64 */ -+#define RTW_5GHZ_5150_5350 \ -+ REG_RULE(5150-10, 5350+10, 40, 0, 30, \ -+ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_IBSS) -+ -+/* 5G chan 100 - chan 165 */ -+#define RTW_5GHZ_5470_5850 \ -+ REG_RULE(5470-10, 5850+10, 40, 0, 30, \ -+ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_IBSS) -+ -+/* 5G chan 149 - chan 165 */ -+#define RTW_5GHZ_5725_5850 \ -+ REG_RULE(5725-10, 5850+10, 40, 0, 30, \ -+ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_IBSS) -+ -+/* 5G chan 36 - chan 165 */ -+#define RTW_5GHZ_5150_5850 \ -+ REG_RULE(5150-10, 5850+10, 40, 0, 30, \ -+ NL80211_RRF_PASSIVE_SCAN | NL80211_RRF_NO_IBSS) -+ -+static const struct ieee80211_regdomain rtw_regdom_rd = { -+ .n_reg_rules = 3, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_2GHZ_CH12_13, -+ RTW_5GHZ_5150_5850, -+ } -+}; -+ -+static const struct ieee80211_regdomain rtw_regdom_11 = { -+ .n_reg_rules = 1, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ } -+}; -+ -+static const struct ieee80211_regdomain rtw_regdom_12_13 = { -+ .n_reg_rules = 2, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_2GHZ_CH12_13, -+ } -+}; -+ -+static const struct ieee80211_regdomain rtw_regdom_no_midband = { -+ .n_reg_rules = 3, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_5GHZ_5150_5350, -+ RTW_5GHZ_5725_5850, -+ } -+}; -+ -+static const struct ieee80211_regdomain rtw_regdom_60_64 = { -+ .n_reg_rules = 3, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_2GHZ_CH12_13, -+ RTW_5GHZ_5725_5850, -+ } -+}; -+ -+static const struct ieee80211_regdomain rtw_regdom_14_60_64 = { -+ .n_reg_rules = 4, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_2GHZ_CH12_13, -+ RTW_2GHZ_CH14, -+ RTW_5GHZ_5725_5850, -+ } -+}; -+ -+static const struct ieee80211_regdomain rtw_regdom_14 = { -+ .n_reg_rules = 3, -+ .alpha2 = "99", -+ .reg_rules = { -+ RTW_2GHZ_CH01_11, -+ RTW_2GHZ_CH12_13, -+ RTW_2GHZ_CH14, -+ } -+}; -+ -+#if 0 -+static struct rtw_regulatory *rtw_regd; -+#endif -+ -+static bool _rtw_is_radar_freq(u16 center_freq) -+{ -+ return center_freq >= 5260 && center_freq <= 5700; -+} -+ -+#if 0 /* not_yet */ -+static void _rtw_reg_apply_beaconing_flags(struct wiphy *wiphy, -+ enum nl80211_reg_initiator initiator) -+{ -+ enum nl80211_band band; -+ struct ieee80211_supported_band *sband; -+ const struct ieee80211_reg_rule *reg_rule; -+ struct ieee80211_channel *ch; -+ unsigned int i; -+ u32 bandwidth = 0; -+ int r; -+ -+ for (band = 0; band < IEEE80211_NUM_BANDS; band++) { -+ -+ if (!wiphy->bands[band]) -+ continue; -+ -+ sband = wiphy->bands[band]; -+ -+ for (i = 0; i < sband->n_channels; i++) { -+ ch = &sband->channels[i]; -+ if (_rtw_is_radar_freq(ch->center_freq) || -+ (ch->flags & IEEE80211_CHAN_RADAR)) -+ continue; -+ if (initiator == NL80211_REGDOM_SET_BY_COUNTRY_IE) { -+ r = freq_reg_info(wiphy, ch->center_freq, -+ bandwidth, ®_rule); -+ if (r) -+ continue; -+ -+ /* -+ *If 11d had a rule for this channel ensure -+ *we enable adhoc/beaconing if it allows us to -+ *use it. Note that we would have disabled it -+ *by applying our static world regdomain by -+ *default during init, prior to calling our -+ *regulatory_hint(). -+ */ -+ -+ if (!(reg_rule->flags & NL80211_RRF_NO_IBSS)) -+ ch->flags &= ~IEEE80211_CHAN_NO_IBSS; -+ if (! -+ (reg_rule->flags & -+ NL80211_RRF_PASSIVE_SCAN)) -+ ch->flags &= -+ ~IEEE80211_CHAN_PASSIVE_SCAN; -+ } else { -+ if (ch->beacon_found) -+ ch->flags &= ~(IEEE80211_CHAN_NO_IBSS | -+ IEEE80211_CHAN_PASSIVE_SCAN); -+ } -+ } -+ } -+} -+ -+/* Allows active scan scan on Ch 12 and 13 */ -+static void _rtw_reg_apply_active_scan_flags(struct wiphy *wiphy, -+ enum nl80211_reg_initiator -+ initiator) -+{ -+ struct ieee80211_supported_band *sband; -+ struct ieee80211_channel *ch; -+ const struct ieee80211_reg_rule *reg_rule; -+ u32 bandwidth = 0; -+ int r; -+ -+ if (!wiphy->bands[NL80211_BAND_2GHZ]) -+ return; -+ sband = wiphy->bands[NL80211_BAND_2GHZ]; -+ -+ /* -+ * If no country IE has been received always enable active scan -+ * on these channels. This is only done for specific regulatory SKUs -+ */ -+ if (initiator != NL80211_REGDOM_SET_BY_COUNTRY_IE) { -+ ch = &sband->channels[11]; /* CH 12 */ -+ if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN) -+ ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN; -+ ch = &sband->channels[12]; /* CH 13 */ -+ if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN) -+ ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN; -+ return; -+ } -+ -+ /* -+ * If a country IE has been received check its rule for this -+ * channel first before enabling active scan. The passive scan -+ * would have been enforced by the initial processing of our -+ * custom regulatory domain. -+ */ -+ -+ ch = &sband->channels[11]; /* CH 12 */ -+ r = freq_reg_info(wiphy, ch->center_freq, bandwidth, ®_rule); -+ if (!r) { -+ if (!(reg_rule->flags & NL80211_RRF_PASSIVE_SCAN)) -+ if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN) -+ ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN; -+ } -+ -+ ch = &sband->channels[12]; /* CH 13 */ -+ r = freq_reg_info(wiphy, ch->center_freq, bandwidth, ®_rule); -+ if (!r) { -+ if (!(reg_rule->flags & NL80211_RRF_PASSIVE_SCAN)) -+ if (ch->flags & IEEE80211_CHAN_PASSIVE_SCAN) -+ ch->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN; -+ } -+} -+#endif -+ -+/* -+ * Always apply Radar/DFS rules on -+ * freq range 5260 MHz - 5700 MHz -+ */ -+static void _rtw_reg_apply_radar_flags(struct wiphy *wiphy) -+{ -+ struct ieee80211_supported_band *sband; -+ struct ieee80211_channel *ch; -+ unsigned int i; -+ -+ if (!wiphy->bands[NL80211_BAND_5GHZ]) -+ return; -+ -+ sband = wiphy->bands[NL80211_BAND_5GHZ]; -+ -+ for (i = 0; i < sband->n_channels; i++) { -+ ch = &sband->channels[i]; -+ if (!_rtw_is_radar_freq(ch->center_freq)) -+ continue; -+#ifdef CONFIG_DFS -+ #if !defined(CONFIG_DFS_MASTER) -+ if (!(ch->flags & IEEE80211_CHAN_DISABLED)) { -+ ch->flags |= IEEE80211_CHAN_RADAR; -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) -+ ch->flags |= (IEEE80211_CHAN_NO_IBSS | IEEE80211_CHAN_PASSIVE_SCAN); -+ #else -+ ch->flags |= IEEE80211_CHAN_NO_IR; -+ #endif -+ } -+ #endif -+#endif /* CONFIG_DFS */ -+ -+#if 0 -+ /* -+ * We always enable radar detection/DFS on this -+ * frequency range. Additionally we also apply on -+ * this frequency range: -+ * - If STA mode does not yet have DFS supports disable -+ * active scanning -+ * - If adhoc mode does not support DFS yet then disable -+ * adhoc in the frequency. -+ * - If AP mode does not yet support radar detection/DFS -+ * do not allow AP mode -+ */ -+ if (!(ch->flags & IEEE80211_CHAN_DISABLED)) -+ ch->flags |= IEEE80211_CHAN_RADAR | -+ IEEE80211_CHAN_NO_IBSS | -+ IEEE80211_CHAN_PASSIVE_SCAN; -+#endif -+ } -+} -+ -+static void _rtw_reg_apply_flags(struct wiphy *wiphy) -+{ -+#if 1 /* by channel plan */ -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ u8 channel_plan = padapter->mlmepriv.ChannelPlan; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ RT_CHANNEL_INFO *channel_set = pmlmeext->channel_set; -+ u8 max_chan_nums = pmlmeext->max_chan_nums; -+ -+ struct ieee80211_supported_band *sband; -+ struct ieee80211_channel *ch; -+ unsigned int i, j; -+ u16 channel; -+ u32 freq; -+ -+ /* all channels disable */ -+ for (i = 0; i < NUM_NL80211_BANDS; i++) { -+ sband = wiphy->bands[i]; -+ -+ if (sband) { -+ for (j = 0; j < sband->n_channels; j++) { -+ ch = &sband->channels[j]; -+ -+ if (ch) -+ ch->flags = IEEE80211_CHAN_DISABLED; -+ } -+ } -+ } -+ -+ /* channels apply by channel plans. */ -+ for (i = 0; i < max_chan_nums; i++) { -+ channel = channel_set[i].ChannelNum; -+ freq = rtw_ch2freq(channel); -+ -+ ch = ieee80211_get_channel(wiphy, freq); -+ if (ch) { -+ if (channel_set[i].ScanType == SCAN_PASSIVE) { -+ #if defined(CONFIG_DFS_MASTER) -+ ch->flags = 0; -+ #elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) -+ ch->flags = (IEEE80211_CHAN_NO_IBSS | IEEE80211_CHAN_PASSIVE_SCAN); -+ #else -+ ch->flags = IEEE80211_CHAN_NO_IR; -+ #endif -+ } else -+ ch->flags = 0; -+ } -+ } -+ -+#else -+ struct ieee80211_supported_band *sband; -+ struct ieee80211_channel *ch; -+ unsigned int i, j; -+ u16 channels[37] = { -+ 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, -+ 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, -+ 149, 153, -+ 157, 161, 165 -+ }; -+ u16 channel; -+ u32 freq; -+ -+ for (i = 0; i < NUM_NL80211_BANDS; i++) { -+ sband = wiphy->bands[i]; -+ -+ if (sband) -+ for (j = 0; j < sband->n_channels; j++) { -+ ch = &sband->channels[j]; -+ -+ if (ch) -+ ch->flags = IEEE80211_CHAN_DISABLED; -+ } -+ } -+ -+ for (i = 0; i < 37; i++) { -+ channel = channels[i]; -+ freq = rtw_ch2freq(channel); -+ -+ ch = ieee80211_get_channel(wiphy, freq); -+ if (ch) { -+ if (channel <= 11) -+ ch->flags = 0; -+ else -+ ch->flags = 0; /* IEEE80211_CHAN_PASSIVE_SCAN; */ -+ } -+ /* printk("%s: freq %d(%d) flag 0x%02X\n", __func__, freq, channel, ch->flags); */ -+ } -+#endif -+} -+ -+static void _rtw_reg_apply_world_flags(struct wiphy *wiphy, -+ enum nl80211_reg_initiator initiator, -+ struct rtw_regulatory *reg) -+{ -+ /* _rtw_reg_apply_beaconing_flags(wiphy, initiator); */ -+ /* _rtw_reg_apply_active_scan_flags(wiphy, initiator); */ -+ return; -+} -+ -+static int _rtw_reg_notifier_apply(struct wiphy *wiphy, -+ struct regulatory_request *request, -+ struct rtw_regulatory *reg) -+{ -+ -+ /* Hard code flags */ -+ _rtw_reg_apply_flags(wiphy); -+ -+ /* We always apply this */ -+ _rtw_reg_apply_radar_flags(wiphy); -+ -+ switch (request->initiator) { -+ case NL80211_REGDOM_SET_BY_DRIVER: -+ RTW_INFO("%s: %s\n", __func__, "NL80211_REGDOM_SET_BY_DRIVER"); -+ _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, -+ reg); -+ break; -+ case NL80211_REGDOM_SET_BY_CORE: -+ RTW_INFO("%s: %s\n", __func__, -+ "NL80211_REGDOM_SET_BY_CORE to DRV"); -+ _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, -+ reg); -+ break; -+ case NL80211_REGDOM_SET_BY_USER: -+ RTW_INFO("%s: %s\n", __func__, -+ "NL80211_REGDOM_SET_BY_USER to DRV"); -+ _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, -+ reg); -+ break; -+ case NL80211_REGDOM_SET_BY_COUNTRY_IE: -+ RTW_INFO("%s: %s\n", __func__, -+ "NL80211_REGDOM_SET_BY_COUNTRY_IE"); -+ _rtw_reg_apply_world_flags(wiphy, request->initiator, reg); -+ break; -+ } -+ -+ return 0; -+} -+ -+static const struct ieee80211_regdomain *_rtw_regdomain_select(struct -+ rtw_regulatory -+ *reg) -+{ -+#if 0 -+ switch (reg->country_code) { -+ case COUNTRY_CODE_USER: -+ default: -+ return &rtw_regdom_rd; -+ } -+#else -+ return &rtw_regdom_rd; -+#endif -+} -+ -+void _rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) -+{ -+ struct rtw_regulatory *reg = NULL; -+ -+ RTW_INFO("%s\n", __func__); -+ -+ _rtw_reg_notifier_apply(wiphy, request, reg); -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 9, 0)) -+int rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) -+#else -+void rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) -+#endif -+{ -+ _rtw_reg_notifier(wiphy, request); -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 9, 0)) -+ return 0; -+#endif -+} -+ -+void rtw_reg_notify_by_driver(_adapter *adapter) -+{ -+ if ((adapter->rtw_wdev != NULL) && (adapter->rtw_wdev->wiphy)) { -+ struct regulatory_request request; -+ request.initiator = NL80211_REGDOM_SET_BY_DRIVER; -+ rtw_reg_notifier(adapter->rtw_wdev->wiphy, &request); -+ } -+} -+ -+static void _rtw_regd_init_wiphy(struct rtw_regulatory *reg, struct wiphy *wiphy) -+{ -+ const struct ieee80211_regdomain *regd; -+ -+ wiphy->reg_notifier = rtw_reg_notifier; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) -+ wiphy->flags |= WIPHY_FLAG_CUSTOM_REGULATORY; -+ wiphy->flags &= ~WIPHY_FLAG_STRICT_REGULATORY; -+ wiphy->flags &= ~WIPHY_FLAG_DISABLE_BEACON_HINTS; -+#else -+ wiphy->regulatory_flags |= REGULATORY_CUSTOM_REG; -+ wiphy->regulatory_flags &= ~REGULATORY_STRICT_REG; -+ wiphy->regulatory_flags &= ~REGULATORY_DISABLE_BEACON_HINTS; -+#endif -+ -+ regd = _rtw_regdomain_select(reg); -+ wiphy_apply_custom_regulatory(wiphy, regd); -+ -+ /* Hard code flags */ -+ _rtw_reg_apply_flags(wiphy); -+ _rtw_reg_apply_radar_flags(wiphy); -+ _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, reg); -+} -+ -+static struct country_code_to_enum_rd *_rtw_regd_find_country(u16 countrycode) -+{ -+ int i; -+ -+ for (i = 0; i < ARRAY_SIZE(allCountries); i++) { -+ if (allCountries[i].countrycode == countrycode) -+ return &allCountries[i]; -+ } -+ return NULL; -+} -+ -+int rtw_regd_init(_adapter *padapter) -+{ -+ struct wiphy *wiphy = padapter->rtw_wdev->wiphy; -+ -+#if 0 -+ if (rtw_regd == NULL) { -+ rtw_regd = (struct rtw_regulatory *) -+ rtw_malloc(sizeof(struct rtw_regulatory)); -+ -+ rtw_regd->alpha2[0] = '9'; -+ rtw_regd->alpha2[1] = '9'; -+ -+ rtw_regd->country_code = COUNTRY_CODE_USER; -+ } -+ -+ RTW_INFO("%s: Country alpha2 being used: %c%c\n", -+ __func__, rtw_regd->alpha2[0], rtw_regd->alpha2[1]); -+#endif -+ -+ _rtw_regd_init_wiphy(NULL, wiphy); -+ -+ return 0; -+} -+#endif /* CONFIG_IOCTL_CFG80211 */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/xmit_linux.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/xmit_linux.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/linux/xmit_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/linux/xmit_linux.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,528 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#define _XMIT_OSDEP_C_ -+ -+#include -+ -+#define DBG_DUMP_OS_QUEUE_CTL 0 -+ -+uint rtw_remainder_len(struct pkt_file *pfile) -+{ -+ return pfile->buf_len - ((SIZE_PTR)(pfile->cur_addr) - (SIZE_PTR)(pfile->buf_start)); -+} -+ -+void _rtw_open_pktfile(_pkt *pktptr, struct pkt_file *pfile) -+{ -+ -+ pfile->pkt = pktptr; -+ pfile->cur_addr = pfile->buf_start = pktptr->data; -+ pfile->pkt_len = pfile->buf_len = pktptr->len; -+ -+ pfile->cur_buffer = pfile->buf_start ; -+ -+} -+ -+uint _rtw_pktfile_read(struct pkt_file *pfile, u8 *rmem, uint rlen) -+{ -+ uint len = 0; -+ -+ -+ len = rtw_remainder_len(pfile); -+ len = (rlen > len) ? len : rlen; -+ -+ if (rmem) -+ skb_copy_bits(pfile->pkt, pfile->buf_len - pfile->pkt_len, rmem, len); -+ -+ pfile->cur_addr += len; -+ pfile->pkt_len -= len; -+ -+ -+ return len; -+} -+ -+sint rtw_endofpktfile(struct pkt_file *pfile) -+{ -+ -+ if (pfile->pkt_len == 0) { -+ return _TRUE; -+ } -+ -+ -+ return _FALSE; -+} -+ -+void rtw_set_tx_chksum_offload(_pkt *pkt, struct pkt_attrib *pattrib) -+{ -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ struct sk_buff *skb = (struct sk_buff *)pkt; -+ pattrib->hw_tcp_csum = 0; -+ -+ if (skb->ip_summed == CHECKSUM_PARTIAL) { -+ if (skb_shinfo(skb)->nr_frags == 0) { -+ const struct iphdr *ip = ip_hdr(skb); -+ if (ip->protocol == IPPROTO_TCP) { -+ /* TCP checksum offload by HW */ -+ RTW_INFO("CHECKSUM_PARTIAL TCP\n"); -+ pattrib->hw_tcp_csum = 1; -+ /* skb_checksum_help(skb); */ -+ } else if (ip->protocol == IPPROTO_UDP) { -+ /* RTW_INFO("CHECKSUM_PARTIAL UDP\n"); */ -+#if 1 -+ skb_checksum_help(skb); -+#else -+ /* Set UDP checksum = 0 to skip checksum check */ -+ struct udphdr *udp = skb_transport_header(skb); -+ udp->check = 0; -+#endif -+ } else { -+ RTW_INFO("%s-%d TCP CSUM offload Error!!\n", __FUNCTION__, __LINE__); -+ WARN_ON(1); /* we need a WARN() */ -+ } -+ } else { /* IP fragmentation case */ -+ RTW_INFO("%s-%d nr_frags != 0, using skb_checksum_help(skb);!!\n", __FUNCTION__, __LINE__); -+ skb_checksum_help(skb); -+ } -+ } -+#endif -+ -+} -+ -+int rtw_os_xmit_resource_alloc(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 alloc_sz, u8 flag) -+{ -+ if (alloc_sz > 0) { -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct usb_device *pusbd = pdvobjpriv->pusbdev; -+ -+ pxmitbuf->pallocated_buf = rtw_usb_buffer_alloc(pusbd, (size_t)alloc_sz, &pxmitbuf->dma_transfer_addr); -+ pxmitbuf->pbuf = pxmitbuf->pallocated_buf; -+ if (pxmitbuf->pallocated_buf == NULL) -+ return _FAIL; -+#else /* CONFIG_USE_USB_BUFFER_ALLOC_TX */ -+ -+ pxmitbuf->pallocated_buf = rtw_zmalloc(alloc_sz); -+ if (pxmitbuf->pallocated_buf == NULL) -+ return _FAIL; -+ -+ pxmitbuf->pbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitbuf->pallocated_buf), XMITBUF_ALIGN_SZ); -+ -+#endif /* CONFIG_USE_USB_BUFFER_ALLOC_TX */ -+ } -+ -+ if (flag) { -+#ifdef CONFIG_USB_HCI -+ int i; -+ for (i = 0; i < 8; i++) { -+ pxmitbuf->pxmit_urb[i] = usb_alloc_urb(0, GFP_KERNEL); -+ if (pxmitbuf->pxmit_urb[i] == NULL) { -+ RTW_INFO("pxmitbuf->pxmit_urb[i]==NULL"); -+ return _FAIL; -+ } -+ } -+#endif -+ } -+ -+ return _SUCCESS; -+} -+ -+void rtw_os_xmit_resource_free(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 free_sz, u8 flag) -+{ -+ if (flag) { -+#ifdef CONFIG_USB_HCI -+ int i; -+ -+ for (i = 0; i < 8; i++) { -+ if (pxmitbuf->pxmit_urb[i]) { -+ /* usb_kill_urb(pxmitbuf->pxmit_urb[i]); */ -+ usb_free_urb(pxmitbuf->pxmit_urb[i]); -+ } -+ } -+#endif -+ } -+ -+ if (free_sz > 0) { -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct usb_device *pusbd = pdvobjpriv->pusbdev; -+ -+ rtw_usb_buffer_free(pusbd, (size_t)free_sz, pxmitbuf->pallocated_buf, pxmitbuf->dma_transfer_addr); -+ pxmitbuf->pallocated_buf = NULL; -+ pxmitbuf->dma_transfer_addr = 0; -+#else /* CONFIG_USE_USB_BUFFER_ALLOC_TX */ -+ if (pxmitbuf->pallocated_buf) -+ rtw_mfree(pxmitbuf->pallocated_buf, free_sz); -+#endif /* CONFIG_USE_USB_BUFFER_ALLOC_TX */ -+ } -+} -+ -+void dump_os_queue(void *sel, _adapter *padapter) -+{ -+ struct net_device *ndev = padapter->pnetdev; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ int i; -+ -+ for (i = 0; i < 4; i++) { -+ RTW_PRINT_SEL(sel, "os_queue[%d]:%s\n" -+ , i, __netif_subqueue_stopped(ndev, i) ? "stopped" : "waked"); -+ } -+#else -+ RTW_PRINT_SEL(sel, "os_queue:%s\n" -+ , netif_queue_stopped(ndev) ? "stopped" : "waked"); -+#endif -+} -+ -+#define WMM_XMIT_THRESHOLD (NR_XMITFRAME*2/5) -+ -+static inline bool rtw_os_need_wake_queue(_adapter *padapter, u16 qidx) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if (padapter->registrypriv.wifi_spec) { -+ if (pxmitpriv->hwxmits[qidx].accnt < WMM_XMIT_THRESHOLD) -+ return _TRUE; -+ } else { -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) { -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC) -+ && MCC_STOP(padapter)) -+ return _FALSE; -+ } -+#endif /* CONFIG_MCC_MODE */ -+ return _TRUE; -+ } -+ return _FALSE; -+#else -+#ifdef CONFIG_MCC_MODE -+ if (MCC_EN(padapter)) { -+ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC) -+ && MCC_STOP(padapter)) -+ return _FALSE; -+ } -+#endif /* CONFIG_MCC_MODE */ -+ return _TRUE; -+#endif -+} -+ -+static inline bool rtw_os_need_stop_queue(_adapter *padapter, u16 qidx) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ if (padapter->registrypriv.wifi_spec) { -+ /* No free space for Tx, tx_worker is too slow */ -+ if (pxmitpriv->hwxmits[qidx].accnt > WMM_XMIT_THRESHOLD) -+ return _TRUE; -+ } else { -+ if (pxmitpriv->free_xmitframe_cnt <= 4) -+ return _TRUE; -+ } -+#else -+ if (pxmitpriv->free_xmitframe_cnt <= 4) -+ return _TRUE; -+#endif -+ return _FALSE; -+} -+ -+void rtw_os_pkt_complete(_adapter *padapter, _pkt *pkt) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ u16 qidx; -+ -+ qidx = skb_get_queue_mapping(pkt); -+ if (rtw_os_need_wake_queue(padapter, qidx)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ RTW_INFO(FUNC_ADPT_FMT": netif_wake_subqueue[%d]\n", FUNC_ADPT_ARG(padapter), qidx); -+ netif_wake_subqueue(padapter->pnetdev, qidx); -+ } -+#else -+ if (rtw_os_need_wake_queue(padapter, 0)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ RTW_INFO(FUNC_ADPT_FMT": netif_wake_queue\n", FUNC_ADPT_ARG(padapter)); -+ netif_wake_queue(padapter->pnetdev); -+ } -+#endif -+ -+ rtw_skb_free(pkt); -+} -+ -+void rtw_os_xmit_complete(_adapter *padapter, struct xmit_frame *pxframe) -+{ -+ if (pxframe->pkt) -+ rtw_os_pkt_complete(padapter, pxframe->pkt); -+ -+ pxframe->pkt = NULL; -+} -+ -+void rtw_os_xmit_schedule(_adapter *padapter) -+{ -+#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) -+ _adapter *pri_adapter = GET_PRIMARY_ADAPTER(padapter); -+ -+ if (!padapter) -+ return; -+ -+ if (_rtw_queue_empty(&padapter->xmitpriv.pending_xmitbuf_queue) == _FALSE) -+ _rtw_up_sema(&pri_adapter->xmitpriv.xmit_sema); -+ -+ -+#else -+ _irqL irqL; -+ struct xmit_priv *pxmitpriv; -+ -+ if (!padapter) -+ return; -+ -+ pxmitpriv = &padapter->xmitpriv; -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ if (rtw_txframes_pending(padapter)) -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+#endif -+} -+ -+static bool rtw_check_xmit_resource(_adapter *padapter, _pkt *pkt) -+{ -+ bool busy = _FALSE; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ u16 qidx; -+ -+ qidx = skb_get_queue_mapping(pkt); -+ if (rtw_os_need_stop_queue(padapter, qidx)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ RTW_INFO(FUNC_ADPT_FMT": netif_stop_subqueue[%d]\n", FUNC_ADPT_ARG(padapter), qidx); -+ netif_stop_subqueue(padapter->pnetdev, qidx); -+ busy = _TRUE; -+ } -+#else -+ if (rtw_os_need_stop_queue(padapter, 0)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ RTW_INFO(FUNC_ADPT_FMT": netif_stop_queue\n", FUNC_ADPT_ARG(padapter)); -+ rtw_netif_stop_queue(padapter->pnetdev); -+ busy = _TRUE; -+ } -+#endif -+ return busy; -+} -+ -+void rtw_os_wake_queue_at_free_stainfo(_adapter *padapter, int *qcnt_freed) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ int i; -+ -+ for (i = 0; i < 4; i++) { -+ if (qcnt_freed[i] == 0) -+ continue; -+ -+ if (rtw_os_need_wake_queue(padapter, i)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ RTW_INFO(FUNC_ADPT_FMT": netif_wake_subqueue[%d]\n", FUNC_ADPT_ARG(padapter), i); -+ netif_wake_subqueue(padapter->pnetdev, i); -+ } -+ } -+#else -+ if (qcnt_freed[0] || qcnt_freed[1] || qcnt_freed[2] || qcnt_freed[3]) { -+ if (rtw_os_need_wake_queue(padapter, 0)) { -+ if (DBG_DUMP_OS_QUEUE_CTL) -+ RTW_INFO(FUNC_ADPT_FMT": netif_wake_queue\n", FUNC_ADPT_ARG(padapter)); -+ netif_wake_queue(padapter->pnetdev); -+ } -+ } -+#endif -+} -+ -+#ifdef CONFIG_TX_MCAST2UNI -+int rtw_mlcst2unicst(_adapter *padapter, struct sk_buff *skb) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _irqL irqL; -+ _list *phead, *plist; -+ struct sk_buff *newskb; -+ struct sta_info *psta = NULL; -+ u8 chk_alive_num = 0; -+ char chk_alive_list[NUM_STA]; -+ u8 bc_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 null_addr[6] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ -+ int i; -+ s32 res; -+ -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u); -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* free sta asoc_queue */ -+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { -+ int stainfo_offset; -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) -+ chk_alive_list[chk_alive_num++] = stainfo_offset; -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ for (i = 0; i < chk_alive_num; i++) { -+ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); -+ if (!(psta->state & _FW_LINKED)) { -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_ignore_fw_linked); -+ continue; -+ } -+ -+ /* avoid come from STA1 and send back STA1 */ -+ if (_rtw_memcmp(psta->hwaddr, &skb->data[6], 6) == _TRUE -+ || _rtw_memcmp(psta->hwaddr, null_addr, 6) == _TRUE -+ || _rtw_memcmp(psta->hwaddr, bc_addr, 6) == _TRUE -+ ) { -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_ignore_self); -+ continue; -+ } -+ -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry); -+ -+ newskb = rtw_skb_copy(skb); -+ -+ if (newskb) { -+ _rtw_memcpy(newskb->data, psta->hwaddr, 6); -+ res = rtw_xmit(padapter, &newskb); -+ if (res < 0) { -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry_err_xmit); -+ RTW_INFO("%s()-%d: rtw_xmit() return error! res=%d\n", __FUNCTION__, __LINE__, res); -+ pxmitpriv->tx_drop++; -+ rtw_skb_free(newskb); -+ } -+ } else { -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry_err_skb); -+ RTW_INFO("%s-%d: rtw_skb_copy() failed!\n", __FUNCTION__, __LINE__); -+ pxmitpriv->tx_drop++; -+ /* rtw_skb_free(skb); */ -+ return _FALSE; /* Caller shall tx this multicast frame via normal way. */ -+ } -+ } -+ -+ rtw_skb_free(skb); -+ return _TRUE; -+} -+#endif /* CONFIG_TX_MCAST2UNI */ -+ -+ -+int _rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+#ifdef CONFIG_TX_MCAST2UNI -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ extern int rtw_mc2u_disable; -+#endif /* CONFIG_TX_MCAST2UNI */ -+ s32 res = 0; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ u16 queue; -+#endif -+ -+ -+ if (padapter->registrypriv.mp_mode) { -+ RTW_INFO("MP_TX_DROP_OS_FRAME\n"); -+ goto drop_packet; -+ } -+ DBG_COUNTER(padapter->tx_logs.os_tx); -+ -+ if (rtw_if_up(padapter) == _FALSE) { -+ DBG_COUNTER(padapter->tx_logs.os_tx_err_up); -+ #ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s if_up fail\n", __FUNCTION__); -+ #endif -+ goto drop_packet; -+ } -+ -+ rtw_check_xmit_resource(padapter, pkt); -+ -+#ifdef CONFIG_TX_MCAST2UNI -+ if (!rtw_mc2u_disable -+ && check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE -+ && (IP_MCAST_MAC(pkt->data) -+ || ICMPV6_MCAST_MAC(pkt->data) -+ #ifdef CONFIG_TX_BCAST2UNI -+ || is_broadcast_mac_addr(pkt->data) -+ #endif -+ ) -+ && (padapter->registrypriv.wifi_spec == 0) -+ ) { -+ if (pxmitpriv->free_xmitframe_cnt > (NR_XMITFRAME / 4)) { -+ res = rtw_mlcst2unicst(padapter, pkt); -+ if (res == _TRUE) -+ goto exit; -+ } else { -+ /* RTW_INFO("Stop M2U(%d, %d)! ", pxmitpriv->free_xmitframe_cnt, pxmitpriv->free_xmitbuf_cnt); */ -+ /* RTW_INFO("!m2u ); */ -+ DBG_COUNTER(padapter->tx_logs.os_tx_m2u_stop); -+ } -+ } -+#endif /* CONFIG_TX_MCAST2UNI */ -+ -+ res = rtw_xmit(padapter, &pkt); -+ if (res < 0) { -+ #ifdef DBG_TX_DROP_FRAME -+ RTW_INFO("DBG_TX_DROP_FRAME %s rtw_xmit fail\n", __FUNCTION__); -+ #endif -+ goto drop_packet; -+ } -+ -+ goto exit; -+ -+drop_packet: -+ pxmitpriv->tx_drop++; -+ rtw_os_pkt_complete(padapter, pkt); -+ -+exit: -+ -+ -+ return 0; -+} -+ -+int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ int ret = 0; -+ -+ if (pkt) { -+ if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) == _TRUE) { -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) -+ rtw_monitor_xmit_entry((struct sk_buff *)pkt, pnetdev); -+#endif -+ } -+ else { -+ rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, pkt->truesize); -+ ret = _rtw_xmit_entry(pkt, pnetdev); -+ } -+ -+ } -+ -+ return ret; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/os_dep/osdep_service.c linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/osdep_service.c ---- linux-4.14.18/3rdparty/rtl8723de/os_dep/osdep_service.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/os_dep/osdep_service.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,2809 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+ -+#define _OSDEP_SERVICE_C_ -+ -+#include -+ -+#define RT_TAG '1178' -+ -+#ifdef DBG_MEMORY_LEAK -+#ifdef PLATFORM_LINUX -+atomic_t _malloc_cnt = ATOMIC_INIT(0); -+atomic_t _malloc_size = ATOMIC_INIT(0); -+#endif -+#endif /* DBG_MEMORY_LEAK */ -+ -+ -+#if defined(PLATFORM_LINUX) -+/* -+* Translate the OS dependent @param error_code to OS independent RTW_STATUS_CODE -+* @return: one of RTW_STATUS_CODE -+*/ -+inline int RTW_STATUS_CODE(int error_code) -+{ -+ if (error_code >= 0) -+ return _SUCCESS; -+ -+ switch (error_code) { -+ /* case -ETIMEDOUT: */ -+ /* return RTW_STATUS_TIMEDOUT; */ -+ default: -+ return _FAIL; -+ } -+} -+#else -+inline int RTW_STATUS_CODE(int error_code) -+{ -+ return error_code; -+} -+#endif -+ -+u32 rtw_atoi(u8 *s) -+{ -+ -+ int num = 0, flag = 0; -+ int i; -+ for (i = 0; i <= strlen(s); i++) { -+ if (s[i] >= '0' && s[i] <= '9') -+ num = num * 10 + s[i] - '0'; -+ else if (s[0] == '-' && i == 0) -+ flag = 1; -+ else -+ break; -+ } -+ -+ if (flag == 1) -+ num = num * -1; -+ -+ return num; -+ -+} -+ -+inline u8 *_rtw_vmalloc(u32 sz) -+{ -+ u8 *pbuf; -+#ifdef PLATFORM_LINUX -+ pbuf = vmalloc(sz); -+#endif -+#ifdef PLATFORM_FREEBSD -+ pbuf = malloc(sz, M_DEVBUF, M_NOWAIT); -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ NdisAllocateMemoryWithTag(&pbuf, sz, RT_TAG); -+#endif -+ -+#ifdef DBG_MEMORY_LEAK -+#ifdef PLATFORM_LINUX -+ if (pbuf != NULL) { -+ atomic_inc(&_malloc_cnt); -+ atomic_add(sz, &_malloc_size); -+ } -+#endif -+#endif /* DBG_MEMORY_LEAK */ -+ -+ return pbuf; -+} -+ -+inline u8 *_rtw_zvmalloc(u32 sz) -+{ -+ u8 *pbuf; -+#ifdef PLATFORM_LINUX -+ pbuf = _rtw_vmalloc(sz); -+ if (pbuf != NULL) -+ memset(pbuf, 0, sz); -+#endif -+#ifdef PLATFORM_FREEBSD -+ pbuf = malloc(sz, M_DEVBUF, M_ZERO | M_NOWAIT); -+#endif -+#ifdef PLATFORM_WINDOWS -+ NdisAllocateMemoryWithTag(&pbuf, sz, RT_TAG); -+ if (pbuf != NULL) -+ NdisFillMemory(pbuf, sz, 0); -+#endif -+ -+ return pbuf; -+} -+ -+inline void _rtw_vmfree(u8 *pbuf, u32 sz) -+{ -+#ifdef PLATFORM_LINUX -+ vfree(pbuf); -+#endif -+#ifdef PLATFORM_FREEBSD -+ free(pbuf, M_DEVBUF); -+#endif -+#ifdef PLATFORM_WINDOWS -+ NdisFreeMemory(pbuf, sz, 0); -+#endif -+ -+#ifdef DBG_MEMORY_LEAK -+#ifdef PLATFORM_LINUX -+ atomic_dec(&_malloc_cnt); -+ atomic_sub(sz, &_malloc_size); -+#endif -+#endif /* DBG_MEMORY_LEAK */ -+} -+ -+u8 *_rtw_malloc(u32 sz) -+{ -+ -+ u8 *pbuf = NULL; -+ -+#ifdef PLATFORM_LINUX -+#ifdef RTK_DMP_PLATFORM -+ if (sz > 0x4000) -+ pbuf = (u8 *)dvr_malloc(sz); -+ else -+#endif -+ pbuf = kmalloc(sz, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ pbuf = malloc(sz, M_DEVBUF, M_NOWAIT); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisAllocateMemoryWithTag(&pbuf, sz, RT_TAG); -+ -+#endif -+ -+#ifdef DBG_MEMORY_LEAK -+#ifdef PLATFORM_LINUX -+ if (pbuf != NULL) { -+ atomic_inc(&_malloc_cnt); -+ atomic_add(sz, &_malloc_size); -+ } -+#endif -+#endif /* DBG_MEMORY_LEAK */ -+ -+ return pbuf; -+ -+} -+ -+ -+u8 *_rtw_zmalloc(u32 sz) -+{ -+#ifdef PLATFORM_FREEBSD -+ return malloc(sz, M_DEVBUF, M_ZERO | M_NOWAIT); -+#else /* PLATFORM_FREEBSD */ -+ u8 *pbuf = _rtw_malloc(sz); -+ -+ if (pbuf != NULL) { -+ -+#ifdef PLATFORM_LINUX -+ memset(pbuf, 0, sz); -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ NdisFillMemory(pbuf, sz, 0); -+#endif -+ -+ } -+ -+ return pbuf; -+#endif /* PLATFORM_FREEBSD */ -+} -+ -+void _rtw_mfree(u8 *pbuf, u32 sz) -+{ -+ -+#ifdef PLATFORM_LINUX -+#ifdef RTK_DMP_PLATFORM -+ if (sz > 0x4000) -+ dvr_free(pbuf); -+ else -+#endif -+ kfree(pbuf); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ free(pbuf, M_DEVBUF); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisFreeMemory(pbuf, sz, 0); -+ -+#endif -+ -+#ifdef DBG_MEMORY_LEAK -+#ifdef PLATFORM_LINUX -+ atomic_dec(&_malloc_cnt); -+ atomic_sub(sz, &_malloc_size); -+#endif -+#endif /* DBG_MEMORY_LEAK */ -+ -+} -+ -+#ifdef PLATFORM_FREEBSD -+/* review again */ -+struct sk_buff *dev_alloc_skb(unsigned int size) -+{ -+ struct sk_buff *skb = NULL; -+ u8 *data = NULL; -+ -+ /* skb = (struct sk_buff *)_rtw_zmalloc(sizeof(struct sk_buff)); */ /* for skb->len, etc. */ -+ skb = (struct sk_buff *)_rtw_malloc(sizeof(struct sk_buff)); -+ if (!skb) -+ goto out; -+ data = _rtw_malloc(size); -+ if (!data) -+ goto nodata; -+ -+ skb->head = (unsigned char *)data; -+ skb->data = (unsigned char *)data; -+ skb->tail = (unsigned char *)data; -+ skb->end = (unsigned char *)data + size; -+ skb->len = 0; -+ /* printf("%s()-%d: skb=%p, skb->head = %p\n", __FUNCTION__, __LINE__, skb, skb->head); */ -+ -+out: -+ return skb; -+nodata: -+ _rtw_mfree((u8 *)skb, sizeof(struct sk_buff)); -+ skb = NULL; -+ goto out; -+ -+} -+ -+void dev_kfree_skb_any(struct sk_buff *skb) -+{ -+ /* printf("%s()-%d: skb->head = %p\n", __FUNCTION__, __LINE__, skb->head); */ -+ if (skb->head) -+ _rtw_mfree(skb->head, 0); -+ /* printf("%s()-%d: skb = %p\n", __FUNCTION__, __LINE__, skb); */ -+ if (skb) -+ _rtw_mfree((u8 *)skb, 0); -+} -+struct sk_buff *skb_clone(const struct sk_buff *skb) -+{ -+ return NULL; -+} -+ -+#endif /* PLATFORM_FREEBSD */ -+ -+inline struct sk_buff *_rtw_skb_alloc(u32 sz) -+{ -+#ifdef PLATFORM_LINUX -+ return __dev_alloc_skb(sz, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ return dev_alloc_skb(sz); -+#endif /* PLATFORM_FREEBSD */ -+} -+ -+inline void _rtw_skb_free(struct sk_buff *skb) -+{ -+ dev_kfree_skb_any(skb); -+} -+ -+inline struct sk_buff *_rtw_skb_copy(const struct sk_buff *skb) -+{ -+#ifdef PLATFORM_LINUX -+ return skb_copy(skb, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ return NULL; -+#endif /* PLATFORM_FREEBSD */ -+} -+ -+inline struct sk_buff *_rtw_skb_clone(struct sk_buff *skb) -+{ -+#ifdef PLATFORM_LINUX -+ return skb_clone(skb, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ return skb_clone(skb); -+#endif /* PLATFORM_FREEBSD */ -+} -+inline struct sk_buff *_rtw_pskb_copy(struct sk_buff *skb) -+{ -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) -+ return pskb_copy(skb, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+#else -+ return skb_clone(skb, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+#endif -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ return NULL; -+#endif /* PLATFORM_FREEBSD */ -+} -+ -+inline int _rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb) -+{ -+#if defined(PLATFORM_LINUX) -+ skb->dev = ndev; -+ return netif_rx(skb); -+#elif defined(PLATFORM_FREEBSD) -+ return (*ndev->if_input)(ndev, skb); -+#else -+ rtw_warn_on(1); -+ return -1; -+#endif -+} -+ -+#ifdef CONFIG_RTW_NAPI -+inline int _rtw_netif_receive_skb(_nic_hdl ndev, struct sk_buff *skb) -+{ -+#if defined(PLATFORM_LINUX) -+ skb->dev = ndev; -+ return netif_receive_skb(skb); -+#else -+ rtw_warn_on(1); -+ return -1; -+#endif -+} -+ -+#ifdef CONFIG_RTW_GRO -+inline gro_result_t _rtw_napi_gro_receive(struct napi_struct *napi, struct sk_buff *skb) -+{ -+#if defined(PLATFORM_LINUX) -+ return napi_gro_receive(napi, skb); -+#else -+ rtw_warn_on(1); -+ return -1; -+#endif -+} -+#endif /* CONFIG_RTW_GRO */ -+#endif /* CONFIG_RTW_NAPI */ -+ -+void _rtw_skb_queue_purge(struct sk_buff_head *list) -+{ -+ struct sk_buff *skb; -+ -+ while ((skb = skb_dequeue(list)) != NULL) -+ _rtw_skb_free(skb); -+} -+ -+#ifdef CONFIG_USB_HCI -+inline void *_rtw_usb_buffer_alloc(struct usb_device *dev, size_t size, dma_addr_t *dma) -+{ -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ return usb_alloc_coherent(dev, size, (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL), dma); -+#else -+ return usb_buffer_alloc(dev, size, (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL), dma); -+#endif -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ return malloc(size, M_USBDEV, M_NOWAIT | M_ZERO); -+#endif /* PLATFORM_FREEBSD */ -+} -+inline void _rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_addr_t dma) -+{ -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ usb_free_coherent(dev, size, addr, dma); -+#else -+ usb_buffer_free(dev, size, addr, dma); -+#endif -+#endif /* PLATFORM_LINUX */ -+ -+#ifdef PLATFORM_FREEBSD -+ free(addr, M_USBDEV); -+#endif /* PLATFORM_FREEBSD */ -+} -+#endif /* CONFIG_USB_HCI */ -+ -+#if defined(DBG_MEM_ALLOC) -+ -+struct rtw_mem_stat { -+ ATOMIC_T alloc; /* the memory bytes we allocate currently */ -+ ATOMIC_T peak; /* the peak memory bytes we allocate */ -+ ATOMIC_T alloc_cnt; /* the alloc count for alloc currently */ -+ ATOMIC_T alloc_err_cnt; /* the error times we fail to allocate memory */ -+}; -+ -+struct rtw_mem_stat rtw_mem_type_stat[mstat_tf_idx(MSTAT_TYPE_MAX)]; -+#ifdef RTW_MEM_FUNC_STAT -+struct rtw_mem_stat rtw_mem_func_stat[mstat_ff_idx(MSTAT_FUNC_MAX)]; -+#endif -+ -+char *MSTAT_TYPE_str[] = { -+ "VIR", -+ "PHY", -+ "SKB", -+ "USB", -+}; -+ -+#ifdef RTW_MEM_FUNC_STAT -+char *MSTAT_FUNC_str[] = { -+ "UNSP", -+ "IO", -+ "TXIO", -+ "RXIO", -+ "TX", -+ "RX", -+}; -+#endif -+ -+void rtw_mstat_dump(void *sel) -+{ -+ int i; -+ int value_t[4][mstat_tf_idx(MSTAT_TYPE_MAX)]; -+#ifdef RTW_MEM_FUNC_STAT -+ int value_f[4][mstat_ff_idx(MSTAT_FUNC_MAX)]; -+#endif -+ -+ int vir_alloc, vir_peak, vir_alloc_err, phy_alloc, phy_peak, phy_alloc_err; -+ int tx_alloc, tx_peak, tx_alloc_err, rx_alloc, rx_peak, rx_alloc_err; -+ -+ for (i = 0; i < mstat_tf_idx(MSTAT_TYPE_MAX); i++) { -+ value_t[0][i] = ATOMIC_READ(&(rtw_mem_type_stat[i].alloc)); -+ value_t[1][i] = ATOMIC_READ(&(rtw_mem_type_stat[i].peak)); -+ value_t[2][i] = ATOMIC_READ(&(rtw_mem_type_stat[i].alloc_cnt)); -+ value_t[3][i] = ATOMIC_READ(&(rtw_mem_type_stat[i].alloc_err_cnt)); -+ } -+ -+#ifdef RTW_MEM_FUNC_STAT -+ for (i = 0; i < mstat_ff_idx(MSTAT_FUNC_MAX); i++) { -+ value_f[0][i] = ATOMIC_READ(&(rtw_mem_func_stat[i].alloc)); -+ value_f[1][i] = ATOMIC_READ(&(rtw_mem_func_stat[i].peak)); -+ value_f[2][i] = ATOMIC_READ(&(rtw_mem_func_stat[i].alloc_cnt)); -+ value_f[3][i] = ATOMIC_READ(&(rtw_mem_func_stat[i].alloc_err_cnt)); -+ } -+#endif -+ -+ RTW_PRINT_SEL(sel, "===================== MSTAT =====================\n"); -+ RTW_PRINT_SEL(sel, "%4s %10s %10s %10s %10s\n", "TAG", "alloc", "peak", "aloc_cnt", "err_cnt"); -+ RTW_PRINT_SEL(sel, "-------------------------------------------------\n"); -+ for (i = 0; i < mstat_tf_idx(MSTAT_TYPE_MAX); i++) -+ RTW_PRINT_SEL(sel, "%4s %10d %10d %10d %10d\n", MSTAT_TYPE_str[i], value_t[0][i], value_t[1][i], value_t[2][i], value_t[3][i]); -+#ifdef RTW_MEM_FUNC_STAT -+ RTW_PRINT_SEL(sel, "-------------------------------------------------\n"); -+ for (i = 0; i < mstat_ff_idx(MSTAT_FUNC_MAX); i++) -+ RTW_PRINT_SEL(sel, "%4s %10d %10d %10d %10d\n", MSTAT_FUNC_str[i], value_f[0][i], value_f[1][i], value_f[2][i], value_f[3][i]); -+#endif -+} -+ -+void rtw_mstat_update(const enum mstat_f flags, const MSTAT_STATUS status, u32 sz) -+{ -+ static u32 update_time = 0; -+ int peak, alloc; -+ int i; -+ -+ /* initialization */ -+ if (!update_time) { -+ for (i = 0; i < mstat_tf_idx(MSTAT_TYPE_MAX); i++) { -+ ATOMIC_SET(&(rtw_mem_type_stat[i].alloc), 0); -+ ATOMIC_SET(&(rtw_mem_type_stat[i].peak), 0); -+ ATOMIC_SET(&(rtw_mem_type_stat[i].alloc_cnt), 0); -+ ATOMIC_SET(&(rtw_mem_type_stat[i].alloc_err_cnt), 0); -+ } -+ #ifdef RTW_MEM_FUNC_STAT -+ for (i = 0; i < mstat_ff_idx(MSTAT_FUNC_MAX); i++) { -+ ATOMIC_SET(&(rtw_mem_func_stat[i].alloc), 0); -+ ATOMIC_SET(&(rtw_mem_func_stat[i].peak), 0); -+ ATOMIC_SET(&(rtw_mem_func_stat[i].alloc_cnt), 0); -+ ATOMIC_SET(&(rtw_mem_func_stat[i].alloc_err_cnt), 0); -+ } -+ #endif -+ } -+ -+ switch (status) { -+ case MSTAT_ALLOC_SUCCESS: -+ ATOMIC_INC(&(rtw_mem_type_stat[mstat_tf_idx(flags)].alloc_cnt)); -+ alloc = ATOMIC_ADD_RETURN(&(rtw_mem_type_stat[mstat_tf_idx(flags)].alloc), sz); -+ peak = ATOMIC_READ(&(rtw_mem_type_stat[mstat_tf_idx(flags)].peak)); -+ if (peak < alloc) -+ ATOMIC_SET(&(rtw_mem_type_stat[mstat_tf_idx(flags)].peak), alloc); -+ -+ #ifdef RTW_MEM_FUNC_STAT -+ ATOMIC_INC(&(rtw_mem_func_stat[mstat_ff_idx(flags)].alloc_cnt)); -+ alloc = ATOMIC_ADD_RETURN(&(rtw_mem_func_stat[mstat_ff_idx(flags)].alloc), sz); -+ peak = ATOMIC_READ(&(rtw_mem_func_stat[mstat_ff_idx(flags)].peak)); -+ if (peak < alloc) -+ ATOMIC_SET(&(rtw_mem_func_stat[mstat_ff_idx(flags)].peak), alloc); -+ #endif -+ break; -+ -+ case MSTAT_ALLOC_FAIL: -+ ATOMIC_INC(&(rtw_mem_type_stat[mstat_tf_idx(flags)].alloc_err_cnt)); -+ #ifdef RTW_MEM_FUNC_STAT -+ ATOMIC_INC(&(rtw_mem_func_stat[mstat_ff_idx(flags)].alloc_err_cnt)); -+ #endif -+ break; -+ -+ case MSTAT_FREE: -+ ATOMIC_DEC(&(rtw_mem_type_stat[mstat_tf_idx(flags)].alloc_cnt)); -+ ATOMIC_SUB(&(rtw_mem_type_stat[mstat_tf_idx(flags)].alloc), sz); -+ #ifdef RTW_MEM_FUNC_STAT -+ ATOMIC_DEC(&(rtw_mem_func_stat[mstat_ff_idx(flags)].alloc_cnt)); -+ ATOMIC_SUB(&(rtw_mem_func_stat[mstat_ff_idx(flags)].alloc), sz); -+ #endif -+ break; -+ }; -+ -+ /* if (rtw_get_passing_time_ms(update_time) > 5000) { */ -+ /* rtw_mstat_dump(RTW_DBGDUMP); */ -+ update_time = rtw_get_current_time(); -+ /* } */ -+} -+ -+#ifndef SIZE_MAX -+ #define SIZE_MAX (~(size_t)0) -+#endif -+ -+struct mstat_sniff_rule { -+ enum mstat_f flags; -+ size_t lb; -+ size_t hb; -+}; -+ -+struct mstat_sniff_rule mstat_sniff_rules[] = { -+ {MSTAT_TYPE_PHY, 4097, SIZE_MAX}, -+}; -+ -+int mstat_sniff_rule_num = sizeof(mstat_sniff_rules) / sizeof(struct mstat_sniff_rule); -+ -+bool match_mstat_sniff_rules(const enum mstat_f flags, const size_t size) -+{ -+ int i; -+ for (i = 0; i < mstat_sniff_rule_num; i++) { -+ if (mstat_sniff_rules[i].flags == flags -+ && mstat_sniff_rules[i].lb <= size -+ && mstat_sniff_rules[i].hb >= size) -+ return _TRUE; -+ } -+ -+ return _FALSE; -+} -+ -+inline u8 *dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ u8 *p; -+ -+ if (match_mstat_sniff_rules(flags, sz)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ p = _rtw_vmalloc((sz)); -+ -+ rtw_mstat_update( -+ flags -+ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+} -+ -+inline u8 *dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ u8 *p; -+ -+ if (match_mstat_sniff_rules(flags, sz)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ p = _rtw_zvmalloc((sz)); -+ -+ rtw_mstat_update( -+ flags -+ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+} -+ -+inline void dbg_rtw_vmfree(u8 *pbuf, u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ -+ if (match_mstat_sniff_rules(flags, sz)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ _rtw_vmfree((pbuf), (sz)); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , sz -+ ); -+} -+ -+inline u8 *dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ u8 *p; -+ -+ if (match_mstat_sniff_rules(flags, sz)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ p = _rtw_malloc((sz)); -+ -+ rtw_mstat_update( -+ flags -+ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+} -+ -+inline u8 *dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ u8 *p; -+ -+ if (match_mstat_sniff_rules(flags, sz)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ p = _rtw_zmalloc((sz)); -+ -+ rtw_mstat_update( -+ flags -+ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+} -+ -+inline void dbg_rtw_mfree(u8 *pbuf, u32 sz, const enum mstat_f flags, const char *func, const int line) -+{ -+ if (match_mstat_sniff_rules(flags, sz)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ _rtw_mfree((pbuf), (sz)); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , sz -+ ); -+} -+ -+inline struct sk_buff *dbg_rtw_skb_alloc(unsigned int size, const enum mstat_f flags, const char *func, int line) -+{ -+ struct sk_buff *skb; -+ unsigned int truesize = 0; -+ -+ skb = _rtw_skb_alloc(size); -+ -+ if (skb) -+ truesize = skb->truesize; -+ -+ if (!skb || truesize < size || match_mstat_sniff_rules(flags, truesize)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d), skb:%p, truesize=%u\n", func, line, __FUNCTION__, size, skb, truesize); -+ -+ rtw_mstat_update( -+ flags -+ , skb ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , truesize -+ ); -+ -+ return skb; -+} -+ -+inline void dbg_rtw_skb_free(struct sk_buff *skb, const enum mstat_f flags, const char *func, int line) -+{ -+ unsigned int truesize = skb->truesize; -+ -+ if (match_mstat_sniff_rules(flags, truesize)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); -+ -+ _rtw_skb_free(skb); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , truesize -+ ); -+} -+ -+inline struct sk_buff *dbg_rtw_skb_copy(const struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line) -+{ -+ struct sk_buff *skb_cp; -+ unsigned int truesize = skb->truesize; -+ unsigned int cp_truesize = 0; -+ -+ skb_cp = _rtw_skb_copy(skb); -+ if (skb_cp) -+ cp_truesize = skb_cp->truesize; -+ -+ if (!skb_cp || cp_truesize < truesize || match_mstat_sniff_rules(flags, cp_truesize)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%u), skb_cp:%p, cp_truesize=%u\n", func, line, __FUNCTION__, truesize, skb_cp, cp_truesize); -+ -+ rtw_mstat_update( -+ flags -+ , skb_cp ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , cp_truesize -+ ); -+ -+ return skb_cp; -+} -+ -+inline struct sk_buff *dbg_rtw_skb_clone(struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line) -+{ -+ struct sk_buff *skb_cl; -+ unsigned int truesize = skb->truesize; -+ unsigned int cl_truesize = 0; -+ -+ skb_cl = _rtw_skb_clone(skb); -+ if (skb_cl) -+ cl_truesize = skb_cl->truesize; -+ -+ if (!skb_cl || cl_truesize < truesize || match_mstat_sniff_rules(flags, cl_truesize)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%u), skb_cl:%p, cl_truesize=%u\n", func, line, __FUNCTION__, truesize, skb_cl, cl_truesize); -+ -+ rtw_mstat_update( -+ flags -+ , skb_cl ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , cl_truesize -+ ); -+ -+ return skb_cl; -+} -+ -+inline int dbg_rtw_netif_rx(_nic_hdl ndev, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line) -+{ -+ int ret; -+ unsigned int truesize = skb->truesize; -+ -+ if (match_mstat_sniff_rules(flags, truesize)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); -+ -+ ret = _rtw_netif_rx(ndev, skb); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , truesize -+ ); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_RTW_NAPI -+inline int dbg_rtw_netif_receive_skb(_nic_hdl ndev, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line) -+{ -+ int ret; -+ unsigned int truesize = skb->truesize; -+ -+ if (match_mstat_sniff_rules(flags, truesize)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); -+ -+ ret = _rtw_netif_receive_skb(ndev, skb); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , truesize -+ ); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_RTW_GRO -+inline gro_result_t dbg_rtw_napi_gro_receive(struct napi_struct *napi, struct sk_buff *skb, const enum mstat_f flags, const char *func, int line) -+{ -+ int ret; -+ unsigned int truesize = skb->truesize; -+ -+ if (match_mstat_sniff_rules(flags, truesize)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s, truesize=%u\n", func, line, __FUNCTION__, truesize); -+ -+ ret = _rtw_napi_gro_receive(napi, skb); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , truesize -+ ); -+ -+ return ret; -+} -+#endif /* CONFIG_RTW_GRO */ -+#endif /* CONFIG_RTW_NAPI */ -+ -+inline void dbg_rtw_skb_queue_purge(struct sk_buff_head *list, enum mstat_f flags, const char *func, int line) -+{ -+ struct sk_buff *skb; -+ -+ while ((skb = skb_dequeue(list)) != NULL) -+ dbg_rtw_skb_free(skb, flags, func, line); -+} -+ -+#ifdef CONFIG_USB_HCI -+inline void *dbg_rtw_usb_buffer_alloc(struct usb_device *dev, size_t size, dma_addr_t *dma, const enum mstat_f flags, const char *func, int line) -+{ -+ void *p; -+ -+ if (match_mstat_sniff_rules(flags, size)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%zu)\n", func, line, __FUNCTION__, size); -+ -+ p = _rtw_usb_buffer_alloc(dev, size, dma); -+ -+ rtw_mstat_update( -+ flags -+ , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL -+ , size -+ ); -+ -+ return p; -+} -+ -+inline void dbg_rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_addr_t dma, const enum mstat_f flags, const char *func, int line) -+{ -+ -+ if (match_mstat_sniff_rules(flags, size)) -+ RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%zu)\n", func, line, __FUNCTION__, size); -+ -+ _rtw_usb_buffer_free(dev, size, addr, dma); -+ -+ rtw_mstat_update( -+ flags -+ , MSTAT_FREE -+ , size -+ ); -+} -+#endif /* CONFIG_USB_HCI */ -+ -+#endif /* defined(DBG_MEM_ALLOC) */ -+ -+void *rtw_malloc2d(int h, int w, size_t size) -+{ -+ int j; -+ -+ void **a = (void **) rtw_zmalloc(h * sizeof(void *) + h * w * size); -+ if (a == NULL) { -+ RTW_INFO("%s: alloc memory fail!\n", __FUNCTION__); -+ return NULL; -+ } -+ -+ for (j = 0; j < h; j++) -+ a[j] = ((char *)(a + h)) + j * w * size; -+ -+ return a; -+} -+ -+void rtw_mfree2d(void *pbuf, int h, int w, int size) -+{ -+ rtw_mfree((u8 *)pbuf, h * sizeof(void *) + w * h * size); -+} -+ -+void _rtw_memcpy(void *dst, const void *src, u32 sz) -+{ -+ -+#if defined(PLATFORM_LINUX) || defined (PLATFORM_FREEBSD) -+ -+ memcpy(dst, src, sz); -+ -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+ NdisMoveMemory(dst, src, sz); -+ -+#endif -+ -+} -+ -+inline void _rtw_memmove(void *dst, const void *src, u32 sz) -+{ -+#if defined(PLATFORM_LINUX) -+ memmove(dst, src, sz); -+#else -+ #warning "no implementation\n" -+#endif -+} -+ -+int _rtw_memcmp(const void *dst, const void *src, u32 sz) -+{ -+ -+#if defined(PLATFORM_LINUX) || defined (PLATFORM_FREEBSD) -+ /* under Linux/GNU/GLibc, the return value of memcmp for two same mem. chunk is 0 */ -+ -+ if (!(memcmp(dst, src, sz))) -+ return _TRUE; -+ else -+ return _FALSE; -+#endif -+ -+ -+#ifdef PLATFORM_WINDOWS -+ /* under Windows, the return value of NdisEqualMemory for two same mem. chunk is 1 */ -+ -+ if (NdisEqualMemory(dst, src, sz)) -+ return _TRUE; -+ else -+ return _FALSE; -+ -+#endif -+ -+ -+ -+} -+ -+void _rtw_memset(void *pbuf, int c, u32 sz) -+{ -+ -+#if defined(PLATFORM_LINUX) || defined (PLATFORM_FREEBSD) -+ -+ memset(pbuf, c, sz); -+ -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+#if 0 -+ NdisZeroMemory(pbuf, sz); -+ if (c != 0) -+ memset(pbuf, c, sz); -+#else -+ NdisFillMemory(pbuf, sz, c); -+#endif -+#endif -+ -+} -+ -+#ifdef PLATFORM_FREEBSD -+static inline void __list_add(_list *pnew, _list *pprev, _list *pnext) -+{ -+ pnext->prev = pnew; -+ pnew->next = pnext; -+ pnew->prev = pprev; -+ pprev->next = pnew; -+} -+#endif /* PLATFORM_FREEBSD */ -+ -+ -+void _rtw_init_listhead(_list *list) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ INIT_LIST_HEAD(list); -+ -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+ list->next = list; -+ list->prev = list; -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisInitializeListHead(list); -+ -+#endif -+ -+} -+ -+ -+/* -+For the following list_xxx operations, -+caller must guarantee the atomic context. -+Otherwise, there will be racing condition. -+*/ -+u32 rtw_is_list_empty(_list *phead) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ if (list_empty(phead)) -+ return _TRUE; -+ else -+ return _FALSE; -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ -+ if (phead->next == phead) -+ return _TRUE; -+ else -+ return _FALSE; -+ -+#endif -+ -+ -+#ifdef PLATFORM_WINDOWS -+ -+ if (IsListEmpty(phead)) -+ return _TRUE; -+ else -+ return _FALSE; -+ -+#endif -+ -+ -+} -+ -+void rtw_list_insert_head(_list *plist, _list *phead) -+{ -+ -+#ifdef PLATFORM_LINUX -+ list_add(plist, phead); -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+ __list_add(plist, phead, phead->next); -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ InsertHeadList(phead, plist); -+#endif -+} -+ -+void rtw_list_insert_tail(_list *plist, _list *phead) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ list_add_tail(plist, phead); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ -+ __list_add(plist, phead->prev, phead); -+ -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ InsertTailList(phead, plist); -+ -+#endif -+ -+} -+ -+void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc) -+{ -+ _adapter *adapter = (_adapter *)padapter; -+ -+#ifdef PLATFORM_LINUX -+ _init_timer(ptimer, adapter->pnetdev, pfunc, adapter); -+#endif -+#ifdef PLATFORM_FREEBSD -+ _init_timer(ptimer, adapter->pifp, pfunc, adapter->mlmepriv.nic_hdl); -+#endif -+#ifdef PLATFORM_WINDOWS -+ _init_timer(ptimer, adapter->hndis_adapter, pfunc, adapter->mlmepriv.nic_hdl); -+#endif -+} -+ -+/* -+ -+Caller must check if the list is empty before calling rtw_list_delete -+ -+*/ -+ -+ -+void _rtw_init_sema(_sema *sema, int init_val) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ sema_init(sema, init_val); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ sema_init(sema, init_val, "rtw_drv"); -+#endif -+#ifdef PLATFORM_OS_XP -+ -+ KeInitializeSemaphore(sema, init_val, SEMA_UPBND); /* count=0; */ -+ -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ if (*sema == NULL) -+ *sema = CreateSemaphore(NULL, init_val, SEMA_UPBND, NULL); -+#endif -+ -+} -+ -+void _rtw_free_sema(_sema *sema) -+{ -+#ifdef PLATFORM_FREEBSD -+ sema_destroy(sema); -+#endif -+#ifdef PLATFORM_OS_CE -+ CloseHandle(*sema); -+#endif -+ -+} -+ -+void _rtw_up_sema(_sema *sema) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ up(sema); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ sema_post(sema); -+#endif -+#ifdef PLATFORM_OS_XP -+ -+ KeReleaseSemaphore(sema, IO_NETWORK_INCREMENT, 1, FALSE); -+ -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ ReleaseSemaphore(*sema, 1, NULL); -+#endif -+} -+ -+u32 _rtw_down_sema(_sema *sema) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ if (down_interruptible(sema)) -+ return _FAIL; -+ else -+ return _SUCCESS; -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ sema_wait(sema); -+ return _SUCCESS; -+#endif -+#ifdef PLATFORM_OS_XP -+ -+ if (STATUS_SUCCESS == KeWaitForSingleObject(sema, Executive, KernelMode, TRUE, NULL)) -+ return _SUCCESS; -+ else -+ return _FAIL; -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ if (WAIT_OBJECT_0 == WaitForSingleObject(*sema, INFINITE)) -+ return _SUCCESS; -+ else -+ return _FAIL; -+#endif -+} -+ -+inline void thread_exit(_completion *comp) -+{ -+#ifdef PLATFORM_LINUX -+ complete_and_exit(comp, 0); -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+ printf("%s", "RTKTHREAD_exit"); -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ ExitThread(STATUS_SUCCESS); -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ PsTerminateSystemThread(STATUS_SUCCESS); -+#endif -+} -+ -+inline void _rtw_init_completion(_completion *comp) -+{ -+#ifdef PLATFORM_LINUX -+ init_completion(comp); -+#endif -+} -+inline void _rtw_wait_for_comp_timeout(_completion *comp) -+{ -+#ifdef PLATFORM_LINUX -+ wait_for_completion_timeout(comp, msecs_to_jiffies(3000)); -+#endif -+} -+inline void _rtw_wait_for_comp(_completion *comp) -+{ -+#ifdef PLATFORM_LINUX -+ wait_for_completion(comp); -+#endif -+} -+ -+inline bool rtw_thread_stop(_thread_hdl_ th) -+{ -+#ifdef PLATFORM_LINUX -+ return kthread_stop(th); -+#endif -+} -+ -+inline bool rtw_thread_should_stop(void) -+{ -+#ifdef PLATFORM_LINUX -+ return kthread_should_stop(); -+#endif -+} -+ -+void _rtw_mutex_init(_mutex *pmutex) -+{ -+#ifdef PLATFORM_LINUX -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) -+ mutex_init(pmutex); -+#else -+ init_MUTEX(pmutex); -+#endif -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ mtx_init(pmutex, "", NULL, MTX_DEF | MTX_RECURSE); -+#endif -+#ifdef PLATFORM_OS_XP -+ -+ KeInitializeMutex(pmutex, 0); -+ -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ *pmutex = CreateMutex(NULL, _FALSE, NULL); -+#endif -+} -+ -+void _rtw_mutex_free(_mutex *pmutex); -+void _rtw_mutex_free(_mutex *pmutex) -+{ -+#ifdef PLATFORM_LINUX -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) -+ mutex_destroy(pmutex); -+#else -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+ sema_destroy(pmutex); -+#endif -+ -+#endif -+ -+#ifdef PLATFORM_OS_XP -+ -+#endif -+ -+#ifdef PLATFORM_OS_CE -+ -+#endif -+} -+ -+void _rtw_spinlock_init(_lock *plock) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ spin_lock_init(plock); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ mtx_init(plock, "", NULL, MTX_DEF | MTX_RECURSE); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisAllocateSpinLock(plock); -+ -+#endif -+ -+} -+ -+void _rtw_spinlock_free(_lock *plock) -+{ -+#ifdef PLATFORM_FREEBSD -+ mtx_destroy(plock); -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+ NdisFreeSpinLock(plock); -+ -+#endif -+ -+} -+#ifdef PLATFORM_FREEBSD -+extern PADAPTER prtw_lock; -+ -+void rtw_mtx_lock(_lock *plock) -+{ -+ if (prtw_lock) -+ mtx_lock(&prtw_lock->glock); -+ else -+ printf("%s prtw_lock==NULL", __FUNCTION__); -+} -+void rtw_mtx_unlock(_lock *plock) -+{ -+ if (prtw_lock) -+ mtx_unlock(&prtw_lock->glock); -+ else -+ printf("%s prtw_lock==NULL", __FUNCTION__); -+ -+} -+#endif /* PLATFORM_FREEBSD */ -+ -+ -+void _rtw_spinlock(_lock *plock) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ spin_lock(plock); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ mtx_lock(plock); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisAcquireSpinLock(plock); -+ -+#endif -+ -+} -+ -+void _rtw_spinunlock(_lock *plock) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ spin_unlock(plock); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ mtx_unlock(plock); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisReleaseSpinLock(plock); -+ -+#endif -+} -+ -+ -+void _rtw_spinlock_ex(_lock *plock) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ spin_lock(plock); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ mtx_lock(plock); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisDprAcquireSpinLock(plock); -+ -+#endif -+ -+} -+ -+void _rtw_spinunlock_ex(_lock *plock) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ spin_unlock(plock); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ mtx_unlock(plock); -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisDprReleaseSpinLock(plock); -+ -+#endif -+} -+ -+ -+ -+void _rtw_init_queue(_queue *pqueue) -+{ -+ _rtw_init_listhead(&(pqueue->queue)); -+ _rtw_spinlock_init(&(pqueue->lock)); -+} -+ -+void _rtw_deinit_queue(_queue *pqueue) -+{ -+ _rtw_spinlock_free(&(pqueue->lock)); -+} -+ -+u32 _rtw_queue_empty(_queue *pqueue) -+{ -+ return rtw_is_list_empty(&(pqueue->queue)); -+} -+ -+ -+u32 rtw_end_of_queue_search(_list *head, _list *plist) -+{ -+ if (head == plist) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+ -+u32 rtw_get_current_time(void) -+{ -+ -+#ifdef PLATFORM_LINUX -+ return jiffies; -+#endif -+#ifdef PLATFORM_FREEBSD -+ struct timeval tvp; -+ getmicrotime(&tvp); -+ return tvp.tv_sec; -+#endif -+#ifdef PLATFORM_WINDOWS -+ LARGE_INTEGER SystemTime; -+ NdisGetCurrentSystemTime(&SystemTime); -+ return (u32)(SystemTime.LowPart);/* count of 100-nanosecond intervals */ -+#endif -+} -+ -+inline u32 rtw_systime_to_ms(u32 systime) -+{ -+#ifdef PLATFORM_LINUX -+ return systime * 1000 / HZ; -+#endif -+#ifdef PLATFORM_FREEBSD -+ return systime * 1000; -+#endif -+#ifdef PLATFORM_WINDOWS -+ return systime / 10000 ; -+#endif -+} -+ -+inline u32 rtw_ms_to_systime(u32 ms) -+{ -+#ifdef PLATFORM_LINUX -+ return ms * HZ / 1000; -+#endif -+#ifdef PLATFORM_FREEBSD -+ return ms / 1000; -+#endif -+#ifdef PLATFORM_WINDOWS -+ return ms * 10000 ; -+#endif -+} -+ -+/* the input parameter start use the same unit as returned by rtw_get_current_time */ -+inline s32 rtw_get_passing_time_ms(u32 start) -+{ -+#ifdef PLATFORM_LINUX -+ return rtw_systime_to_ms(jiffies - start); -+#endif -+#ifdef PLATFORM_FREEBSD -+ return rtw_systime_to_ms(rtw_get_current_time()); -+#endif -+#ifdef PLATFORM_WINDOWS -+ LARGE_INTEGER SystemTime; -+ NdisGetCurrentSystemTime(&SystemTime); -+ return rtw_systime_to_ms((u32)(SystemTime.LowPart) - start) ; -+#endif -+} -+ -+inline s32 rtw_get_time_interval_ms(u32 start, u32 end) -+{ -+#ifdef PLATFORM_LINUX -+ return rtw_systime_to_ms(end - start); -+#endif -+#ifdef PLATFORM_FREEBSD -+ return rtw_systime_to_ms(rtw_get_current_time()); -+#endif -+#ifdef PLATFORM_WINDOWS -+ return rtw_systime_to_ms(end - start); -+#endif -+} -+ -+ -+void rtw_sleep_schedulable(int ms) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ u32 delta; -+ -+ delta = (ms * HZ) / 1000; /* (ms) */ -+ if (delta == 0) { -+ delta = 1;/* 1 ms */ -+ } -+ set_current_state(TASK_INTERRUPTIBLE); -+ if (schedule_timeout(delta) != 0) -+ return ; -+ return; -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ DELAY(ms * 1000); -+ return ; -+#endif -+ -+#ifdef PLATFORM_WINDOWS -+ -+ NdisMSleep(ms * 1000); /* (us)*1000=(ms) */ -+ -+#endif -+ -+} -+ -+ -+void rtw_msleep_os(int ms) -+{ -+ -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) -+ if (ms < 20) { -+ unsigned long us = ms * 1000UL; -+ usleep_range(us, us + 1000UL); -+ } else -+#endif -+ msleep((unsigned int)ms); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ /* Delay for delay microseconds */ -+ DELAY(ms * 1000); -+ return ; -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisMSleep(ms * 1000); /* (us)*1000=(ms) */ -+ -+#endif -+ -+ -+} -+void rtw_usleep_os(int us) -+{ -+#ifdef PLATFORM_LINUX -+ -+ /* msleep((unsigned int)us); */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)) -+ usleep_range(us, us + 1); -+#else -+ if (1 < (us / 1000)) -+ msleep(1); -+ else -+ msleep((us / 1000) + 1); -+#endif -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+ /* Delay for delay microseconds */ -+ DELAY(us); -+ -+ return ; -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisMSleep(us); /* (us) */ -+ -+#endif -+ -+ -+} -+ -+ -+#ifdef DBG_DELAY_OS -+void _rtw_mdelay_os(int ms, const char *func, const int line) -+{ -+#if 0 -+ if (ms > 10) -+ RTW_INFO("%s:%d %s(%d)\n", func, line, __FUNCTION__, ms); -+ rtw_msleep_os(ms); -+ return; -+#endif -+ -+ -+ RTW_INFO("%s:%d %s(%d)\n", func, line, __FUNCTION__, ms); -+ -+#if defined(PLATFORM_LINUX) -+ -+ mdelay((unsigned long)ms); -+ -+#elif defined(PLATFORM_WINDOWS) -+ -+ NdisStallExecution(ms * 1000); /* (us)*1000=(ms) */ -+ -+#endif -+ -+ -+} -+void _rtw_udelay_os(int us, const char *func, const int line) -+{ -+ -+#if 0 -+ if (us > 1000) { -+ RTW_INFO("%s:%d %s(%d)\n", func, line, __FUNCTION__, us); -+ rtw_usleep_os(us); -+ return; -+ } -+#endif -+ -+ -+ RTW_INFO("%s:%d %s(%d)\n", func, line, __FUNCTION__, us); -+ -+ -+#if defined(PLATFORM_LINUX) -+ -+ udelay((unsigned long)us); -+ -+#elif defined(PLATFORM_WINDOWS) -+ -+ NdisStallExecution(us); /* (us) */ -+ -+#endif -+ -+} -+#else -+void rtw_mdelay_os(int ms) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ mdelay((unsigned long)ms); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ DELAY(ms * 1000); -+ return ; -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisStallExecution(ms * 1000); /* (us)*1000=(ms) */ -+ -+#endif -+ -+ -+} -+void rtw_udelay_os(int us) -+{ -+ -+#ifdef PLATFORM_LINUX -+ -+ udelay((unsigned long)us); -+ -+#endif -+#ifdef PLATFORM_FREEBSD -+ /* Delay for delay microseconds */ -+ DELAY(us); -+ return ; -+#endif -+#ifdef PLATFORM_WINDOWS -+ -+ NdisStallExecution(us); /* (us) */ -+ -+#endif -+ -+} -+#endif -+ -+void rtw_yield_os(void) -+{ -+#ifdef PLATFORM_LINUX -+ yield(); -+#endif -+#ifdef PLATFORM_FREEBSD -+ yield(); -+#endif -+#ifdef PLATFORM_WINDOWS -+ SwitchToThread(); -+#endif -+} -+ -+#define RTW_SUSPEND_LOCK_NAME "rtw_wifi" -+#define RTW_SUSPEND_EXT_LOCK_NAME "rtw_wifi_ext" -+#define RTW_SUSPEND_RX_LOCK_NAME "rtw_wifi_rx" -+#define RTW_SUSPEND_TRAFFIC_LOCK_NAME "rtw_wifi_traffic" -+#define RTW_SUSPEND_RESUME_LOCK_NAME "rtw_wifi_resume" -+#define RTW_RESUME_SCAN_LOCK_NAME "rtw_wifi_scan" -+#ifdef CONFIG_WAKELOCK -+static struct wake_lock rtw_suspend_lock; -+static struct wake_lock rtw_suspend_ext_lock; -+static struct wake_lock rtw_suspend_rx_lock; -+static struct wake_lock rtw_suspend_traffic_lock; -+static struct wake_lock rtw_suspend_resume_lock; -+static struct wake_lock rtw_resume_scan_lock; -+#elif defined(CONFIG_ANDROID_POWER) -+static android_suspend_lock_t rtw_suspend_lock = { -+ .name = RTW_SUSPEND_LOCK_NAME -+}; -+static android_suspend_lock_t rtw_suspend_ext_lock = { -+ .name = RTW_SUSPEND_EXT_LOCK_NAME -+}; -+static android_suspend_lock_t rtw_suspend_rx_lock = { -+ .name = RTW_SUSPEND_RX_LOCK_NAME -+}; -+static android_suspend_lock_t rtw_suspend_traffic_lock = { -+ .name = RTW_SUSPEND_TRAFFIC_LOCK_NAME -+}; -+static android_suspend_lock_t rtw_suspend_resume_lock = { -+ .name = RTW_SUSPEND_RESUME_LOCK_NAME -+}; -+static android_suspend_lock_t rtw_resume_scan_lock = { -+ .name = RTW_RESUME_SCAN_LOCK_NAME -+}; -+#endif -+ -+inline void rtw_suspend_lock_init(void) -+{ -+#ifdef CONFIG_WAKELOCK -+ wake_lock_init(&rtw_suspend_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_LOCK_NAME); -+ wake_lock_init(&rtw_suspend_ext_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_EXT_LOCK_NAME); -+ wake_lock_init(&rtw_suspend_rx_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_RX_LOCK_NAME); -+ wake_lock_init(&rtw_suspend_traffic_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_TRAFFIC_LOCK_NAME); -+ wake_lock_init(&rtw_suspend_resume_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_RESUME_LOCK_NAME); -+ wake_lock_init(&rtw_resume_scan_lock, WAKE_LOCK_SUSPEND, RTW_RESUME_SCAN_LOCK_NAME); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_init_suspend_lock(&rtw_suspend_lock); -+ android_init_suspend_lock(&rtw_suspend_ext_lock); -+ android_init_suspend_lock(&rtw_suspend_rx_lock); -+ android_init_suspend_lock(&rtw_suspend_traffic_lock); -+ android_init_suspend_lock(&rtw_suspend_resume_lock); -+ android_init_suspend_lock(&rtw_resume_scan_lock); -+#endif -+} -+ -+inline void rtw_suspend_lock_uninit(void) -+{ -+#ifdef CONFIG_WAKELOCK -+ wake_lock_destroy(&rtw_suspend_lock); -+ wake_lock_destroy(&rtw_suspend_ext_lock); -+ wake_lock_destroy(&rtw_suspend_rx_lock); -+ wake_lock_destroy(&rtw_suspend_traffic_lock); -+ wake_lock_destroy(&rtw_suspend_resume_lock); -+ wake_lock_destroy(&rtw_resume_scan_lock); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_uninit_suspend_lock(&rtw_suspend_lock); -+ android_uninit_suspend_lock(&rtw_suspend_ext_lock); -+ android_uninit_suspend_lock(&rtw_suspend_rx_lock); -+ android_uninit_suspend_lock(&rtw_suspend_traffic_lock); -+ android_uninit_suspend_lock(&rtw_suspend_resume_lock); -+ android_uninit_suspend_lock(&rtw_resume_scan_lock); -+#endif -+} -+ -+inline void rtw_lock_suspend(void) -+{ -+#ifdef CONFIG_WAKELOCK -+ wake_lock(&rtw_suspend_lock); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend(&rtw_suspend_lock); -+#endif -+ -+#if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) -+ /* RTW_INFO("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); */ -+#endif -+} -+ -+inline void rtw_unlock_suspend(void) -+{ -+#ifdef CONFIG_WAKELOCK -+ wake_unlock(&rtw_suspend_lock); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_unlock_suspend(&rtw_suspend_lock); -+#endif -+ -+#if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) -+ /* RTW_INFO("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); */ -+#endif -+} -+ -+inline void rtw_resume_lock_suspend(void) -+{ -+#ifdef CONFIG_WAKELOCK -+ wake_lock(&rtw_suspend_resume_lock); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend(&rtw_suspend_resume_lock); -+#endif -+ -+#if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) -+ /* RTW_INFO("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); */ -+#endif -+} -+ -+inline void rtw_resume_unlock_suspend(void) -+{ -+#ifdef CONFIG_WAKELOCK -+ wake_unlock(&rtw_suspend_resume_lock); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_unlock_suspend(&rtw_suspend_resume_lock); -+#endif -+ -+#if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) -+ /* RTW_INFO("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); */ -+#endif -+} -+ -+inline void rtw_lock_suspend_timeout(u32 timeout_ms) -+{ -+#ifdef CONFIG_WAKELOCK -+ wake_lock_timeout(&rtw_suspend_lock, rtw_ms_to_systime(timeout_ms)); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend_auto_expire(&rtw_suspend_lock, rtw_ms_to_systime(timeout_ms)); -+#endif -+} -+ -+inline void rtw_lock_ext_suspend_timeout(u32 timeout_ms) -+{ -+#ifdef CONFIG_WAKELOCK -+ wake_lock_timeout(&rtw_suspend_ext_lock, rtw_ms_to_systime(timeout_ms)); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend_auto_expire(&rtw_suspend_ext_lock, rtw_ms_to_systime(timeout_ms)); -+#endif -+ /* RTW_INFO("EXT lock timeout:%d\n", timeout_ms); */ -+} -+ -+inline void rtw_lock_rx_suspend_timeout(u32 timeout_ms) -+{ -+#ifdef CONFIG_WAKELOCK -+ wake_lock_timeout(&rtw_suspend_rx_lock, rtw_ms_to_systime(timeout_ms)); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend_auto_expire(&rtw_suspend_rx_lock, rtw_ms_to_systime(timeout_ms)); -+#endif -+ /* RTW_INFO("RX lock timeout:%d\n", timeout_ms); */ -+} -+ -+ -+inline void rtw_lock_traffic_suspend_timeout(u32 timeout_ms) -+{ -+#ifdef CONFIG_WAKELOCK -+ wake_lock_timeout(&rtw_suspend_traffic_lock, rtw_ms_to_systime(timeout_ms)); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend_auto_expire(&rtw_suspend_traffic_lock, rtw_ms_to_systime(timeout_ms)); -+#endif -+ /* RTW_INFO("traffic lock timeout:%d\n", timeout_ms); */ -+} -+ -+inline void rtw_lock_resume_scan_timeout(u32 timeout_ms) -+{ -+#ifdef CONFIG_WAKELOCK -+ wake_lock_timeout(&rtw_resume_scan_lock, rtw_ms_to_systime(timeout_ms)); -+#elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend_auto_expire(&rtw_resume_scan_lock, rtw_ms_to_systime(timeout_ms)); -+#endif -+ /* RTW_INFO("resume scan lock:%d\n", timeout_ms); */ -+} -+ -+inline void ATOMIC_SET(ATOMIC_T *v, int i) -+{ -+#ifdef PLATFORM_LINUX -+ atomic_set(v, i); -+#elif defined(PLATFORM_WINDOWS) -+ *v = i; /* other choice???? */ -+#elif defined(PLATFORM_FREEBSD) -+ atomic_set_int(v, i); -+#endif -+} -+ -+inline int ATOMIC_READ(ATOMIC_T *v) -+{ -+#ifdef PLATFORM_LINUX -+ return atomic_read(v); -+#elif defined(PLATFORM_WINDOWS) -+ return *v; /* other choice???? */ -+#elif defined(PLATFORM_FREEBSD) -+ return atomic_load_acq_32(v); -+#endif -+} -+ -+inline void ATOMIC_ADD(ATOMIC_T *v, int i) -+{ -+#ifdef PLATFORM_LINUX -+ atomic_add(i, v); -+#elif defined(PLATFORM_WINDOWS) -+ InterlockedAdd(v, i); -+#elif defined(PLATFORM_FREEBSD) -+ atomic_add_int(v, i); -+#endif -+} -+inline void ATOMIC_SUB(ATOMIC_T *v, int i) -+{ -+#ifdef PLATFORM_LINUX -+ atomic_sub(i, v); -+#elif defined(PLATFORM_WINDOWS) -+ InterlockedAdd(v, -i); -+#elif defined(PLATFORM_FREEBSD) -+ atomic_subtract_int(v, i); -+#endif -+} -+ -+inline void ATOMIC_INC(ATOMIC_T *v) -+{ -+#ifdef PLATFORM_LINUX -+ atomic_inc(v); -+#elif defined(PLATFORM_WINDOWS) -+ InterlockedIncrement(v); -+#elif defined(PLATFORM_FREEBSD) -+ atomic_add_int(v, 1); -+#endif -+} -+ -+inline void ATOMIC_DEC(ATOMIC_T *v) -+{ -+#ifdef PLATFORM_LINUX -+ atomic_dec(v); -+#elif defined(PLATFORM_WINDOWS) -+ InterlockedDecrement(v); -+#elif defined(PLATFORM_FREEBSD) -+ atomic_subtract_int(v, 1); -+#endif -+} -+ -+inline int ATOMIC_ADD_RETURN(ATOMIC_T *v, int i) -+{ -+#ifdef PLATFORM_LINUX -+ return atomic_add_return(i, v); -+#elif defined(PLATFORM_WINDOWS) -+ return InterlockedAdd(v, i); -+#elif defined(PLATFORM_FREEBSD) -+ atomic_add_int(v, i); -+ return atomic_load_acq_32(v); -+#endif -+} -+ -+inline int ATOMIC_SUB_RETURN(ATOMIC_T *v, int i) -+{ -+#ifdef PLATFORM_LINUX -+ return atomic_sub_return(i, v); -+#elif defined(PLATFORM_WINDOWS) -+ return InterlockedAdd(v, -i); -+#elif defined(PLATFORM_FREEBSD) -+ atomic_subtract_int(v, i); -+ return atomic_load_acq_32(v); -+#endif -+} -+ -+inline int ATOMIC_INC_RETURN(ATOMIC_T *v) -+{ -+#ifdef PLATFORM_LINUX -+ return atomic_inc_return(v); -+#elif defined(PLATFORM_WINDOWS) -+ return InterlockedIncrement(v); -+#elif defined(PLATFORM_FREEBSD) -+ atomic_add_int(v, 1); -+ return atomic_load_acq_32(v); -+#endif -+} -+ -+inline int ATOMIC_DEC_RETURN(ATOMIC_T *v) -+{ -+#ifdef PLATFORM_LINUX -+ return atomic_dec_return(v); -+#elif defined(PLATFORM_WINDOWS) -+ return InterlockedDecrement(v); -+#elif defined(PLATFORM_FREEBSD) -+ atomic_subtract_int(v, 1); -+ return atomic_load_acq_32(v); -+#endif -+} -+ -+ -+#ifdef PLATFORM_LINUX -+/* -+* Open a file with the specific @param path, @param flag, @param mode -+* @param fpp the pointer of struct file pointer to get struct file pointer while file opening is success -+* @param path the path of the file to open -+* @param flag file operation flags, please refer to linux document -+* @param mode please refer to linux document -+* @return Linux specific error code -+*/ -+static int openFile(struct file **fpp, const char *path, int flag, int mode) -+{ -+ struct file *fp; -+ -+ fp = filp_open(path, flag, mode); -+ if (IS_ERR(fp)) { -+ *fpp = NULL; -+ return PTR_ERR(fp); -+ } else { -+ *fpp = fp; -+ return 0; -+ } -+} -+ -+/* -+* Close the file with the specific @param fp -+* @param fp the pointer of struct file to close -+* @return always 0 -+*/ -+static int closeFile(struct file *fp) -+{ -+ filp_close(fp, NULL); -+ return 0; -+} -+ -+static int readFile(struct file *fp, char *buf, int len) -+{ -+ int rlen = 0, sum = 0; -+ -+ if (!fp->f_op || !fp->f_op->read) -+ return -EPERM; -+ -+ while (sum < len) { -+ rlen = fp->f_op->read(fp, buf + sum, len - sum, &fp->f_pos); -+ if (rlen > 0) -+ sum += rlen; -+ else if (0 != rlen) -+ return rlen; -+ else -+ break; -+ } -+ -+ return sum; -+ -+} -+ -+static int writeFile(struct file *fp, char *buf, int len) -+{ -+ int wlen = 0, sum = 0; -+ -+ if (!fp->f_op || !fp->f_op->write) -+ return -EPERM; -+ -+ while (sum < len) { -+ wlen = fp->f_op->write(fp, buf + sum, len - sum, &fp->f_pos); -+ if (wlen > 0) -+ sum += wlen; -+ else if (0 != wlen) -+ return wlen; -+ else -+ break; -+ } -+ -+ return sum; -+ -+} -+ -+/* -+* Test if the specifi @param path is a file and readable -+* If readable, @param sz is got -+* @param path the path of the file to test -+* @return Linux specific error code -+*/ -+static int isFileReadable(const char *path, u32 *sz) -+{ -+ struct file *fp; -+ int ret = 0; -+ mm_segment_t oldfs; -+ char buf; -+ -+ fp = filp_open(path, O_RDONLY, 0); -+ if (IS_ERR(fp)) -+ ret = PTR_ERR(fp); -+ else { -+ oldfs = get_fs(); -+ set_fs(get_ds()); -+ -+ if (1 != readFile(fp, &buf, 1)) -+ ret = PTR_ERR(fp); -+ -+ if (ret == 0 && sz) { -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) -+ *sz = i_size_read(fp->f_path.dentry->d_inode); -+ #else -+ *sz = i_size_read(fp->f_dentry->d_inode); -+ #endif -+ } -+ -+ set_fs(oldfs); -+ filp_close(fp, NULL); -+ } -+ return ret; -+} -+ -+/* -+* Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most -+* @param path the path of the file to open and read -+* @param buf the starting address of the buffer to store file content -+* @param sz how many bytes to read at most -+* @return the byte we've read, or Linux specific error code -+*/ -+static int retriveFromFile(const char *path, u8 *buf, u32 sz) -+{ -+ int ret = -1; -+ mm_segment_t oldfs; -+ struct file *fp; -+ -+ if (path && buf) { -+ ret = openFile(&fp, path, O_RDONLY, 0); -+ if (0 == ret) { -+ RTW_INFO("%s openFile path:%s fp=%p\n", __FUNCTION__, path , fp); -+ -+ oldfs = get_fs(); -+ set_fs(get_ds()); -+ ret = readFile(fp, buf, sz); -+ set_fs(oldfs); -+ closeFile(fp); -+ -+ RTW_INFO("%s readFile, ret:%d\n", __FUNCTION__, ret); -+ -+ } else -+ RTW_INFO("%s openFile path:%s Fail, ret:%d\n", __FUNCTION__, path, ret); -+ } else { -+ RTW_INFO("%s NULL pointer\n", __FUNCTION__); -+ ret = -EINVAL; -+ } -+ return ret; -+} -+ -+/* -+* Open the file with @param path and wirte @param sz byte of data starting from @param buf into the file -+* @param path the path of the file to open and write -+* @param buf the starting address of the data to write into file -+* @param sz how many bytes to write at most -+* @return the byte we've written, or Linux specific error code -+*/ -+static int storeToFile(const char *path, u8 *buf, u32 sz) -+{ -+ int ret = 0; -+ mm_segment_t oldfs; -+ struct file *fp; -+ -+ if (path && buf) { -+ ret = openFile(&fp, path, O_CREAT | O_WRONLY, 0666); -+ if (0 == ret) { -+ RTW_INFO("%s openFile path:%s fp=%p\n", __FUNCTION__, path , fp); -+ -+ oldfs = get_fs(); -+ set_fs(get_ds()); -+ ret = writeFile(fp, buf, sz); -+ set_fs(oldfs); -+ closeFile(fp); -+ -+ RTW_INFO("%s writeFile, ret:%d\n", __FUNCTION__, ret); -+ -+ } else -+ RTW_INFO("%s openFile path:%s Fail, ret:%d\n", __FUNCTION__, path, ret); -+ } else { -+ RTW_INFO("%s NULL pointer\n", __FUNCTION__); -+ ret = -EINVAL; -+ } -+ return ret; -+} -+#endif /* PLATFORM_LINUX */ -+ -+/* -+* Test if the specifi @param path is a file and readable -+* @param path the path of the file to test -+* @return _TRUE or _FALSE -+*/ -+int rtw_is_file_readable(const char *path) -+{ -+#ifdef PLATFORM_LINUX -+ if (isFileReadable(path, NULL) == 0) -+ return _TRUE; -+ else -+ return _FALSE; -+#else -+ /* Todo... */ -+ return _FALSE; -+#endif -+} -+ -+/* -+* Test if the specifi @param path is a file and readable. -+* If readable, @param sz is got -+* @param path the path of the file to test -+* @return _TRUE or _FALSE -+*/ -+int rtw_is_file_readable_with_size(const char *path, u32 *sz) -+{ -+#ifdef PLATFORM_LINUX -+ if (isFileReadable(path, sz) == 0) -+ return _TRUE; -+ else -+ return _FALSE; -+#else -+ /* Todo... */ -+ return _FALSE; -+#endif -+} -+ -+/* -+* Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most -+* @param path the path of the file to open and read -+* @param buf the starting address of the buffer to store file content -+* @param sz how many bytes to read at most -+* @return the byte we've read -+*/ -+int rtw_retrieve_from_file(const char *path, u8 *buf, u32 sz) -+{ -+#ifdef PLATFORM_LINUX -+ int ret = retriveFromFile(path, buf, sz); -+ return ret >= 0 ? ret : 0; -+#else -+ /* Todo... */ -+ return 0; -+#endif -+} -+ -+/* -+* Open the file with @param path and wirte @param sz byte of data starting from @param buf into the file -+* @param path the path of the file to open and write -+* @param buf the starting address of the data to write into file -+* @param sz how many bytes to write at most -+* @return the byte we've written -+*/ -+int rtw_store_to_file(const char *path, u8 *buf, u32 sz) -+{ -+#ifdef PLATFORM_LINUX -+ int ret = storeToFile(path, buf, sz); -+ return ret >= 0 ? ret : 0; -+#else -+ /* Todo... */ -+ return 0; -+#endif -+} -+ -+#ifdef PLATFORM_LINUX -+struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv) -+{ -+ struct net_device *pnetdev; -+ struct rtw_netdev_priv_indicator *pnpi; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); -+#else -+ pnetdev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); -+#endif -+ if (!pnetdev) -+ goto RETURN; -+ -+ pnpi = netdev_priv(pnetdev); -+ pnpi->priv = old_priv; -+ pnpi->sizeof_priv = sizeof_priv; -+ -+RETURN: -+ return pnetdev; -+} -+ -+struct net_device *rtw_alloc_etherdev(int sizeof_priv) -+{ -+ struct net_device *pnetdev; -+ struct rtw_netdev_priv_indicator *pnpi; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+ pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); -+#else -+ pnetdev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); -+#endif -+ if (!pnetdev) -+ goto RETURN; -+ -+ pnpi = netdev_priv(pnetdev); -+ -+ pnpi->priv = rtw_zvmalloc(sizeof_priv); -+ if (!pnpi->priv) { -+ free_netdev(pnetdev); -+ pnetdev = NULL; -+ goto RETURN; -+ } -+ -+ pnpi->sizeof_priv = sizeof_priv; -+RETURN: -+ return pnetdev; -+} -+ -+void rtw_free_netdev(struct net_device *netdev) -+{ -+ struct rtw_netdev_priv_indicator *pnpi; -+ -+ if (!netdev) -+ goto RETURN; -+ -+ pnpi = netdev_priv(netdev); -+ -+ if (!pnpi->priv) -+ goto RETURN; -+ -+ free_netdev(netdev); -+ -+RETURN: -+ return; -+} -+ -+int rtw_change_ifname(_adapter *padapter, const char *ifname) -+{ -+ struct dvobj_priv *dvobj; -+ struct net_device *pnetdev; -+ struct net_device *cur_pnetdev; -+ struct rereg_nd_name_data *rereg_priv; -+ int ret; -+ u8 rtnl_lock_needed; -+ -+ if (!padapter) -+ goto error; -+ -+ dvobj = adapter_to_dvobj(padapter); -+ cur_pnetdev = padapter->pnetdev; -+ rereg_priv = &padapter->rereg_nd_name_priv; -+ -+ /* free the old_pnetdev */ -+ if (rereg_priv->old_pnetdev) { -+ free_netdev(rereg_priv->old_pnetdev); -+ rereg_priv->old_pnetdev = NULL; -+ } -+ -+ rtnl_lock_needed = rtw_rtnl_lock_needed(dvobj); -+ -+ if (rtnl_lock_needed) -+ unregister_netdev(cur_pnetdev); -+ else -+ unregister_netdevice(cur_pnetdev); -+ -+ rereg_priv->old_pnetdev = cur_pnetdev; -+ -+ pnetdev = rtw_init_netdev(padapter); -+ if (!pnetdev) { -+ ret = -1; -+ goto error; -+ } -+ -+ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(adapter_to_dvobj(padapter))); -+ -+ rtw_init_netdev_name(pnetdev, ifname); -+ -+ _rtw_memcpy(pnetdev->dev_addr, adapter_mac_addr(padapter), ETH_ALEN); -+ -+ if (rtnl_lock_needed) -+ ret = register_netdev(pnetdev); -+ else -+ ret = register_netdevice(pnetdev); -+ -+ if (ret != 0) { -+ goto error; -+ } -+ -+ return 0; -+ -+error: -+ -+ return -1; -+ -+} -+#endif -+ -+#ifdef PLATFORM_FREEBSD -+/* -+ * Copy a buffer from userspace and write into kernel address -+ * space. -+ * -+ * This emulation just calls the FreeBSD copyin function (to -+ * copy data from user space buffer into a kernel space buffer) -+ * and is designed to be used with the above io_write_wrapper. -+ * -+ * This function should return the number of bytes not copied. -+ * I.e. success results in a zero value. -+ * Negative error values are not returned. -+ */ -+unsigned long -+copy_from_user(void *to, const void *from, unsigned long n) -+{ -+ if (copyin(from, to, n) != 0) { -+ /* Any errors will be treated as a failure -+ to copy any of the requested bytes */ -+ return n; -+ } -+ -+ return 0; -+} -+ -+unsigned long -+copy_to_user(void *to, const void *from, unsigned long n) -+{ -+ if (copyout(from, to, n) != 0) { -+ /* Any errors will be treated as a failure -+ to copy any of the requested bytes */ -+ return n; -+ } -+ -+ return 0; -+} -+ -+ -+/* -+ * The usb_register and usb_deregister functions are used to register -+ * usb drivers with the usb subsystem. In this compatibility layer -+ * emulation a list of drivers (struct usb_driver) is maintained -+ * and is used for probing/attaching etc. -+ * -+ * usb_register and usb_deregister simply call these functions. -+ */ -+int -+usb_register(struct usb_driver *driver) -+{ -+ rtw_usb_linux_register(driver); -+ return 0; -+} -+ -+ -+int -+usb_deregister(struct usb_driver *driver) -+{ -+ rtw_usb_linux_deregister(driver); -+ return 0; -+} -+ -+void module_init_exit_wrapper(void *arg) -+{ -+ int (*func)(void) = arg; -+ func(); -+ return; -+} -+ -+#endif /* PLATFORM_FREEBSD */ -+ -+#ifdef CONFIG_PLATFORM_SPRD -+ #ifdef do_div -+ #undef do_div -+ #endif -+ #include -+#endif -+ -+u64 rtw_modular64(u64 x, u64 y) -+{ -+#ifdef PLATFORM_LINUX -+ return do_div(x, y); -+#elif defined(PLATFORM_WINDOWS) -+ return x % y; -+#elif defined(PLATFORM_FREEBSD) -+ return x % y; -+#endif -+} -+ -+u64 rtw_division64(u64 x, u64 y) -+{ -+#ifdef PLATFORM_LINUX -+ do_div(x, y); -+ return x; -+#elif defined(PLATFORM_WINDOWS) -+ return x / y; -+#elif defined(PLATFORM_FREEBSD) -+ return x / y; -+#endif -+} -+ -+inline u32 rtw_random32(void) -+{ -+#ifdef PLATFORM_LINUX -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) -+ return prandom_u32(); -+#elif (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 18)) -+ u32 random_int; -+ get_random_bytes(&random_int , 4); -+ return random_int; -+#else -+ return random32(); -+#endif -+#elif defined(PLATFORM_WINDOWS) -+#error "to be implemented\n" -+#elif defined(PLATFORM_FREEBSD) -+#error "to be implemented\n" -+#endif -+} -+ -+void rtw_buf_free(u8 **buf, u32 *buf_len) -+{ -+ u32 ori_len; -+ -+ if (!buf || !buf_len) -+ return; -+ -+ ori_len = *buf_len; -+ -+ if (*buf) { -+ u32 tmp_buf_len = *buf_len; -+ *buf_len = 0; -+ rtw_mfree(*buf, tmp_buf_len); -+ *buf = NULL; -+ } -+} -+ -+void rtw_buf_update(u8 **buf, u32 *buf_len, u8 *src, u32 src_len) -+{ -+ u32 ori_len = 0, dup_len = 0; -+ u8 *ori = NULL; -+ u8 *dup = NULL; -+ -+ if (!buf || !buf_len) -+ return; -+ -+ if (!src || !src_len) -+ goto keep_ori; -+ -+ /* duplicate src */ -+ dup = rtw_malloc(src_len); -+ if (dup) { -+ dup_len = src_len; -+ _rtw_memcpy(dup, src, dup_len); -+ } -+ -+keep_ori: -+ ori = *buf; -+ ori_len = *buf_len; -+ -+ /* replace buf with dup */ -+ *buf_len = 0; -+ *buf = dup; -+ *buf_len = dup_len; -+ -+ /* free ori */ -+ if (ori && ori_len > 0) -+ rtw_mfree(ori, ori_len); -+} -+ -+ -+/** -+ * rtw_cbuf_full - test if cbuf is full -+ * @cbuf: pointer of struct rtw_cbuf -+ * -+ * Returns: _TRUE if cbuf is full -+ */ -+inline bool rtw_cbuf_full(struct rtw_cbuf *cbuf) -+{ -+ return (cbuf->write == cbuf->read - 1) ? _TRUE : _FALSE; -+} -+ -+/** -+ * rtw_cbuf_empty - test if cbuf is empty -+ * @cbuf: pointer of struct rtw_cbuf -+ * -+ * Returns: _TRUE if cbuf is empty -+ */ -+inline bool rtw_cbuf_empty(struct rtw_cbuf *cbuf) -+{ -+ return (cbuf->write == cbuf->read) ? _TRUE : _FALSE; -+} -+ -+/** -+ * rtw_cbuf_push - push a pointer into cbuf -+ * @cbuf: pointer of struct rtw_cbuf -+ * @buf: pointer to push in -+ * -+ * Lock free operation, be careful of the use scheme -+ * Returns: _TRUE push success -+ */ -+bool rtw_cbuf_push(struct rtw_cbuf *cbuf, void *buf) -+{ -+ if (rtw_cbuf_full(cbuf)) -+ return _FAIL; -+ -+ if (0) -+ RTW_INFO("%s on %u\n", __func__, cbuf->write); -+ cbuf->bufs[cbuf->write] = buf; -+ cbuf->write = (cbuf->write + 1) % cbuf->size; -+ -+ return _SUCCESS; -+} -+ -+/** -+ * rtw_cbuf_pop - pop a pointer from cbuf -+ * @cbuf: pointer of struct rtw_cbuf -+ * -+ * Lock free operation, be careful of the use scheme -+ * Returns: pointer popped out -+ */ -+void *rtw_cbuf_pop(struct rtw_cbuf *cbuf) -+{ -+ void *buf; -+ if (rtw_cbuf_empty(cbuf)) -+ return NULL; -+ -+ if (0) -+ RTW_INFO("%s on %u\n", __func__, cbuf->read); -+ buf = cbuf->bufs[cbuf->read]; -+ cbuf->read = (cbuf->read + 1) % cbuf->size; -+ -+ return buf; -+} -+ -+/** -+ * rtw_cbuf_alloc - allocte a rtw_cbuf with given size and do initialization -+ * @size: size of pointer -+ * -+ * Returns: pointer of srtuct rtw_cbuf, NULL for allocation failure -+ */ -+struct rtw_cbuf *rtw_cbuf_alloc(u32 size) -+{ -+ struct rtw_cbuf *cbuf; -+ -+ cbuf = (struct rtw_cbuf *)rtw_malloc(sizeof(*cbuf) + sizeof(void *) * size); -+ -+ if (cbuf) { -+ cbuf->write = cbuf->read = 0; -+ cbuf->size = size; -+ } -+ -+ return cbuf; -+} -+ -+/** -+ * rtw_cbuf_free - free the given rtw_cbuf -+ * @cbuf: pointer of struct rtw_cbuf to free -+ */ -+void rtw_cbuf_free(struct rtw_cbuf *cbuf) -+{ -+ rtw_mfree((u8 *)cbuf, sizeof(*cbuf) + sizeof(void *) * cbuf->size); -+} -+ -+/** -+ * map_readN - read a range of map data -+ * @map: map to read -+ * @offset: start address to read -+ * @len: length to read -+ * @buf: pointer of buffer to store data read -+ * -+ * Returns: _SUCCESS or _FAIL -+ */ -+int map_readN(const struct map_t *map, u16 offset, u16 len, u8 *buf) -+{ -+ const struct map_seg_t *seg; -+ int ret = _FAIL; -+ int i; -+ -+ if (len == 0) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ if (offset + len > map->len) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ _rtw_memset(buf, map->init_value, len); -+ -+ for (i = 0; i < map->seg_num; i++) { -+ u8 *c_dst, *c_src; -+ u16 c_len; -+ -+ seg = map->segs + i; -+ if (seg->sa + seg->len <= offset || seg->sa >= offset + len) -+ continue; -+ -+ if (seg->sa >= offset) { -+ c_dst = buf + (seg->sa - offset); -+ c_src = seg->c; -+ if (seg->sa + seg->len <= offset + len) -+ c_len = seg->len; -+ else -+ c_len = offset + len - seg->sa; -+ } else { -+ c_dst = buf; -+ c_src = seg->c + (offset - seg->sa); -+ if (seg->sa + seg->len >= offset + len) -+ c_len = len; -+ else -+ c_len = seg->sa + seg->len - offset; -+ } -+ -+ _rtw_memcpy(c_dst, c_src, c_len); -+ } -+ -+exit: -+ return ret; -+} -+ -+/** -+ * map_read8 - read 1 byte of map data -+ * @map: map to read -+ * @offset: address to read -+ * -+ * Returns: value of data of specified offset. map.init_value if offset is out of range -+ */ -+u8 map_read8(const struct map_t *map, u16 offset) -+{ -+ const struct map_seg_t *seg; -+ u8 val = map->init_value; -+ int i; -+ -+ if (offset + 1 > map->len) { -+ rtw_warn_on(1); -+ goto exit; -+ } -+ -+ for (i = 0; i < map->seg_num; i++) { -+ seg = map->segs + i; -+ if (seg->sa + seg->len <= offset || seg->sa >= offset + 1) -+ continue; -+ -+ val = *(seg->c + offset - seg->sa); -+ break; -+ } -+ -+exit: -+ return val; -+} -+ -+/** -+* is_null - -+* -+* Return TRUE if c is null character -+* FALSE otherwise. -+*/ -+inline BOOLEAN is_null(char c) -+{ -+ if (c == '\0') -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+/** -+* is_eol - -+* -+* Return TRUE if c is represent for EOL (end of line) -+* FALSE otherwise. -+*/ -+inline BOOLEAN is_eol(char c) -+{ -+ if (c == '\r' || c == '\n') -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+/** -+* is_space - -+* -+* Return TRUE if c is represent for space -+* FALSE otherwise. -+*/ -+inline BOOLEAN is_space(char c) -+{ -+ if (c == ' ' || c == '\t') -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+/** -+* IsHexDigit - -+* -+* Return TRUE if chTmp is represent for hex digit -+* FALSE otherwise. -+*/ -+inline BOOLEAN IsHexDigit(char chTmp) -+{ -+ if ((chTmp >= '0' && chTmp <= '9') || -+ (chTmp >= 'a' && chTmp <= 'f') || -+ (chTmp >= 'A' && chTmp <= 'F')) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+/** -+* is_alpha - -+* -+* Return TRUE if chTmp is represent for alphabet -+* FALSE otherwise. -+*/ -+inline BOOLEAN is_alpha(char chTmp) -+{ -+ if ((chTmp >= 'a' && chTmp <= 'z') || -+ (chTmp >= 'A' && chTmp <= 'Z')) -+ return _TRUE; -+ else -+ return _FALSE; -+} -+ -+inline char alpha_to_upper(char c) -+{ -+ if ((c >= 'a' && c <= 'z')) -+ c = 'A' + (c - 'a'); -+ return c; -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/custom_country_chplan.h linux-4.14.18-rtl/3rdparty/rtl8723de/platform/custom_country_chplan.h ---- linux-4.14.18/3rdparty/rtl8723de/platform/custom_country_chplan.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/custom_country_chplan.h 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+ -+#error "You have defined CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP to use a customized map of your own instead of the default one" -+#error "Before removing these error notifications, please make sure regulatory certification requirements of your target markets" -+ -+static const struct country_chplan CUSTOMIZED_country_chplan_map[] = { -+ COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0xFF), /* Taiwan */ -+}; -+ -+static const u16 CUSTOMIZED_country_chplan_map_sz = sizeof(CUSTOMIZED_country_chplan_map) / sizeof(struct country_chplan); -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_arm_act_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_arm_act_sdio.c ---- linux-4.14.18/3rdparty/rtl8723de/platform/platform_arm_act_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_arm_act_sdio.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,58 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/* -+ * Description: -+ * This file can be applied to following platforms: -+ * CONFIG_PLATFORM_ACTIONS_ATM703X -+ */ -+#include -+ -+#ifdef CONFIG_PLATFORM_ACTIONS_ATM705X -+extern int acts_wifi_init(void); -+extern void acts_wifi_cleanup(void); -+#endif -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_PLATFORM_ACTIONS_ATM705X -+ ret = acts_wifi_init(); -+ if (unlikely(ret < 0)) { -+ pr_err("%s Failed to register the power control driver.\n", __FUNCTION__); -+ goto exit; -+ } -+#endif -+ -+exit: -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+#ifdef CONFIG_PLATFORM_ACTIONS_ATM705X -+ acts_wifi_cleanup(); -+#endif -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUN50IW1P1_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUN50IW1P1_sdio.c ---- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUN50IW1P1_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUN50IW1P1_sdio.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,91 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/* -+ * Description: -+ * This file can be applied to following platforms: -+ * CONFIG_PLATFORM_ARM_SUN50IW1P1 -+ */ -+#include -+#ifdef CONFIG_GPIO_WAKEUP -+#include -+#endif -+ -+#ifdef CONFIG_MMC -+#if defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) -+extern void sunxi_mmc_rescan_card(unsigned ids); -+extern void sunxi_wlan_set_power(int on); -+extern int sunxi_wlan_get_bus_index(void); -+extern int sunxi_wlan_get_oob_irq(void); -+extern int sunxi_wlan_get_oob_irq_flags(void); -+#endif -+#ifdef CONFIG_GPIO_WAKEUP -+extern unsigned int oob_irq; -+#endif -+#endif /* CONFIG_MMC */ -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_MMC -+ { -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) -+ int wlan_bus_index = sunxi_wlan_get_bus_index(); -+ if (wlan_bus_index < 0) -+ return wlan_bus_index; -+ -+ sunxi_wlan_set_power(1); -+ mdelay(100); -+ sunxi_mmc_rescan_card(wlan_bus_index); -+#endif -+ RTW_INFO("%s: power up, rescan card.\n", __FUNCTION__); -+ -+#ifdef CONFIG_GPIO_WAKEUP -+#if defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) -+ oob_irq = sunxi_wlan_get_oob_irq(); -+#endif -+#endif /* CONFIG_GPIO_WAKEUP */ -+ } -+#endif /* CONFIG_MMC */ -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+#ifdef CONFIG_MMC -+#if defined(CONFIG_PLATFORM_ARM_SUN50IW1P1) -+ int wlan_bus_index = sunxi_wlan_get_bus_index(); -+ if (wlan_bus_index < 0) -+ return; -+ -+ sunxi_mmc_rescan_card(wlan_bus_index); -+ mdelay(100); -+ sunxi_wlan_set_power(0); -+#endif -+ RTW_INFO("%s: remove card, power off.\n", __FUNCTION__); -+#endif /* CONFIG_MMC */ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUNnI_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUNnI_sdio.c ---- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUNnI_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUNnI_sdio.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,135 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/* -+ * Description: -+ * This file can be applied to following platforms: -+ * CONFIG_PLATFORM_ARM_SUN6I -+ * CONFIG_PLATFORM_ARM_SUN7I -+ * CONFIG_PLATFORM_ARM_SUN8I -+ */ -+#include -+#include -+#ifdef CONFIG_GPIO_WAKEUP -+#include -+#endif -+ -+#ifdef CONFIG_MMC -+static int sdc_id = -1; -+static signed int gpio_eint_wlan = -1; -+static u32 eint_wlan_handle = 0; -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+extern void sw_mci_rescan_card(unsigned id, unsigned insert); -+#elif defined(CONFIG_PLATFORM_ARM_SUN8I) -+extern void sunxi_mci_rescan_card(unsigned id, unsigned insert); -+#endif -+ -+#ifdef CONFIG_PLATFORM_ARM_SUN8I_W5P1 -+extern int get_rf_mod_type(void); -+#else -+extern int wifi_pm_get_mod_type(void); -+#endif -+ -+extern void wifi_pm_power(int on); -+#ifdef CONFIG_GPIO_WAKEUP -+extern unsigned int oob_irq; -+#endif -+#endif /* CONFIG_MMC */ -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_MMC -+ { -+ script_item_u val; -+ script_item_value_type_e type; -+ -+#ifdef CONFIG_PLATFORM_ARM_SUN8I_W5P1 -+ unsigned int mod_sel = get_rf_mod_type(); -+#else -+ unsigned int mod_sel = wifi_pm_get_mod_type(); -+#endif -+ -+ type = script_get_item("wifi_para", "wifi_sdc_id", &val); -+ if (SCIRPT_ITEM_VALUE_TYPE_INT != type) { -+ RTW_INFO("get wifi_sdc_id failed\n"); -+ ret = -1; -+ } else { -+ sdc_id = val.val; -+ RTW_INFO("----- %s sdc_id: %d, mod_sel: %d\n", __FUNCTION__, sdc_id, mod_sel); -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+ sw_mci_rescan_card(sdc_id, 1); -+#elif defined(CONFIG_PLATFORM_ARM_SUN8I) -+ sunxi_mci_rescan_card(sdc_id, 1); -+#endif -+ mdelay(100); -+ wifi_pm_power(1); -+ -+ RTW_INFO("%s: power up, rescan card.\n", __FUNCTION__); -+ } -+ -+#ifdef CONFIG_GPIO_WAKEUP -+#ifdef CONFIG_PLATFORM_ARM_SUN8I_W5P1 -+ type = script_get_item("wifi_para", "wl_host_wake", &val); -+#else -+#ifdef CONFIG_RTL8723B -+ type = script_get_item("wifi_para", "rtl8723bs_wl_host_wake", &val); -+#endif -+#ifdef CONFIG_RTL8188E -+ type = script_get_item("wifi_para", "rtl8189es_host_wake", &val); -+#endif -+#endif /* CONFIG_PLATFORM_ARM_SUN8I_W5P1 */ -+ if (SCIRPT_ITEM_VALUE_TYPE_PIO != type) { -+ RTW_INFO("No definition of wake up host PIN\n"); -+ ret = -1; -+ } else { -+ gpio_eint_wlan = val.gpio.gpio; -+#ifdef CONFIG_PLATFORM_ARM_SUN8I -+ oob_irq = gpio_to_irq(gpio_eint_wlan); -+#endif -+ } -+#endif /* CONFIG_GPIO_WAKEUP */ -+ } -+#endif /* CONFIG_MMC */ -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+#ifdef CONFIG_MMC -+#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+ sw_mci_rescan_card(sdc_id, 0); -+#elif defined(CONFIG_PLATFORM_ARM_SUN8I) -+ sunxi_mci_rescan_card(sdc_id, 0); -+#endif -+ mdelay(100); -+ wifi_pm_power(0); -+ -+ RTW_INFO("%s: remove card, power off.\n", __FUNCTION__); -+#endif /* CONFIG_MMC */ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_sdio.c ---- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_sdio.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,95 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#include -+ -+#ifdef CONFIG_MMC_SUNXI_POWER_CONTROL -+#ifdef CONFIG_WITS_EVB_V13 -+ #define SDIOID 0 -+#else /* !CONFIG_WITS_EVB_V13 */ -+ #define SDIOID (CONFIG_CHIP_ID == 1123 ? 3 : 1) -+#endif /* !CONFIG_WITS_EVB_V13 */ -+ -+#define SUNXI_SDIO_WIFI_NUM_RTL8189ES 10 -+extern void sunximmc_rescan_card(unsigned id, unsigned insert); -+extern int mmc_pm_get_mod_type(void); -+extern int mmc_pm_gpio_ctrl(char *name, int level); -+/* -+ * rtl8189es_shdn = port:PH09<1><0> -+ * rtl8189es_wakeup = port:PH10<1><1> -+ * rtl8189es_vdd_en = port:PH11<1><0> -+ * rtl8189es_vcc_en = port:PH12<1><0> -+ */ -+ -+int rtl8189es_sdio_powerup(void) -+{ -+ mmc_pm_gpio_ctrl("rtl8189es_vdd_en", 1); -+ udelay(100); -+ mmc_pm_gpio_ctrl("rtl8189es_vcc_en", 1); -+ udelay(50); -+ mmc_pm_gpio_ctrl("rtl8189es_shdn", 1); -+ return 0; -+} -+ -+int rtl8189es_sdio_poweroff(void) -+{ -+ mmc_pm_gpio_ctrl("rtl8189es_shdn", 0); -+ mmc_pm_gpio_ctrl("rtl8189es_vcc_en", 0); -+ mmc_pm_gpio_ctrl("rtl8189es_vdd_en", 0); -+ return 0; -+} -+#endif /* CONFIG_MMC_SUNXI_POWER_CONTROL */ -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+#ifdef CONFIG_MMC_SUNXI_POWER_CONTROL -+ unsigned int mod_sel = mmc_pm_get_mod_type(); -+#endif /* CONFIG_MMC_SUNXI_POWER_CONTROL */ -+ -+ -+#ifdef CONFIG_MMC_SUNXI_POWER_CONTROL -+ if (mod_sel == SUNXI_SDIO_WIFI_NUM_RTL8189ES) { -+ rtl8189es_sdio_powerup(); -+ sunximmc_rescan_card(SDIOID, 1); -+ printk("[rtl8189es] %s: power up, rescan card.\n", __FUNCTION__); -+ } else { -+ ret = -1; -+ printk("[rtl8189es] %s: mod_sel = %d is incorrect.\n", __FUNCTION__, mod_sel); -+ } -+#endif /* CONFIG_MMC_SUNXI_POWER_CONTROL */ -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+#ifdef CONFIG_MMC_SUNXI_POWER_CONTROL -+ sunximmc_rescan_card(SDIOID, 0); -+#ifdef CONFIG_RTL8188E -+ rtl8189es_sdio_poweroff(); -+ printk("[rtl8189es] %s: remove card, power off.\n", __FUNCTION__); -+#endif /* CONFIG_RTL8188E */ -+#endif /* CONFIG_MMC_SUNXI_POWER_CONTROL */ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_usb.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_usb.c ---- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_usb.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_SUNxI_usb.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,141 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+/* -+ * Description: -+ * This file can be applied to following platforms: -+ * CONFIG_PLATFORM_ARM_SUNXI Series platform -+ * -+ */ -+ -+#include -+#include -+ -+#ifdef CONFIG_PLATFORM_ARM_SUNxI -+extern int sw_usb_disable_hcd(__u32 usbc_no); -+extern int sw_usb_enable_hcd(__u32 usbc_no); -+static int usb_wifi_host = 2; -+#endif -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+extern int sw_usb_disable_hcd(__u32 usbc_no); -+extern int sw_usb_enable_hcd(__u32 usbc_no); -+extern void wifi_pm_power(int on); -+static script_item_u item; -+#endif -+ -+#ifdef CONFIG_PLATFORM_ARM_SUN8I -+extern int sunxi_usb_disable_hcd(__u32 usbc_no); -+extern int sunxi_usb_enable_hcd(__u32 usbc_no); -+extern void wifi_pm_power(int on); -+static script_item_u item; -+#endif -+ -+ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_PLATFORM_ARM_SUNxI -+#ifndef CONFIG_RTL8723A -+ { -+ /* ----------get usb_wifi_usbc_num------------- */ -+ ret = script_parser_fetch("usb_wifi_para", "usb_wifi_usbc_num", (int *)&usb_wifi_host, 64); -+ if (ret != 0) { -+ RTW_INFO("ERR: script_parser_fetch usb_wifi_usbc_num failed\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ RTW_INFO("sw_usb_enable_hcd: usbc_num = %d\n", usb_wifi_host); -+ sw_usb_enable_hcd(usb_wifi_host); -+ } -+#endif /* CONFIG_RTL8723A */ -+#endif /* CONFIG_PLATFORM_ARM_SUNxI */ -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+ { -+ script_item_value_type_e type; -+ -+ type = script_get_item("wifi_para", "wifi_usbc_id", &item); -+ if (SCIRPT_ITEM_VALUE_TYPE_INT != type) { -+ printk("ERR: script_get_item wifi_usbc_id failed\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ printk("sw_usb_enable_hcd: usbc_num = %d\n", item.val); -+ wifi_pm_power(1); -+ mdelay(10); -+ -+#if !(defined(CONFIG_RTL8723A)) && !(defined(CONFIG_RTL8723B)) -+ sw_usb_enable_hcd(item.val); -+#endif -+ } -+#endif /* defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) */ -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN8I) -+ { -+ script_item_value_type_e type; -+ -+ type = script_get_item("wifi_para", "wifi_usbc_id", &item); -+ if (SCIRPT_ITEM_VALUE_TYPE_INT != type) { -+ printk("ERR: script_get_item wifi_usbc_id failed\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ printk("sw_usb_enable_hcd: usbc_num = %d\n", item.val); -+ wifi_pm_power(1); -+ mdelay(10); -+ -+#if !(defined(CONFIG_RTL8723A)) && !(defined(CONFIG_RTL8723B)) -+ sunxi_usb_enable_hcd(item.val); -+#endif -+ } -+#endif /* CONFIG_PLATFORM_ARM_SUN8I */ -+ -+exit: -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+ -+#ifdef CONFIG_PLATFORM_ARM_SUNxI -+#ifndef CONFIG_RTL8723A -+ RTW_INFO("sw_usb_disable_hcd: usbc_num = %d\n", usb_wifi_host); -+ sw_usb_disable_hcd(usb_wifi_host); -+#endif /* ifndef CONFIG_RTL8723A */ -+#endif /* CONFIG_PLATFORM_ARM_SUNxI */ -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) -+ #if !(defined(CONFIG_RTL8723A)) && !(defined(CONFIG_RTL8723B)) -+ sw_usb_disable_hcd(item.val); -+ #endif -+ wifi_pm_power(0); -+#endif /* defined(CONFIG_PLATFORM_ARM_SUN6I) || defined(CONFIG_PLATFORM_ARM_SUN7I) */ -+ -+#if defined(CONFIG_PLATFORM_ARM_SUN8I) -+ #if !(defined(CONFIG_RTL8723A)) && !(defined(CONFIG_RTL8723B)) -+ sunxi_usb_disable_hcd(item.val); -+ #endif -+ wifi_pm_power(0); -+#endif /* defined(CONFIG_PLATFORM_ARM_SUN8I) */ -+ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_WMT_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_WMT_sdio.c ---- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ARM_WMT_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ARM_WMT_sdio.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,51 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#include -+#include -+#include -+ -+extern void wmt_detect_sdio2(void); -+extern void force_remove_sdio2(void); -+ -+int platform_wifi_power_on(void) -+{ -+ int err = 0; -+ err = gpio_request(WMT_PIN_GP62_SUSGPIO1, "wifi_chip_en"); -+ if (err < 0) { -+ printk("request gpio for rtl8188eu failed!\n"); -+ return err; -+ } -+ gpio_direction_output(WMT_PIN_GP62_SUSGPIO1, 0);/* pull sus_gpio1 to 0 to open vcc_wifi. */ -+ printk("power on rtl8189.\n"); -+ msleep(500); -+ wmt_detect_sdio2(); -+ printk("[rtl8189es] %s: new card, power on.\n", __FUNCTION__); -+ return err; -+} -+ -+void platform_wifi_power_off(void) -+{ -+ force_remove_sdio2(); -+ -+ gpio_direction_output(WMT_PIN_GP62_SUSGPIO1, 1);/* pull sus_gpio1 to 1 to close vcc_wifi. */ -+ printk("power off rtl8189.\n"); -+ gpio_free(WMT_PIN_GP62_SUSGPIO1); -+ printk("[rtl8189es] %s: remove card, power off.\n", __FUNCTION__); -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ops.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ops.c ---- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ops.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ops.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,37 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef CONFIG_PLATFORM_OPS -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+} -+#endif /* !CONFIG_PLATFORM_OPS */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_ops.h linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ops.h ---- linux-4.14.18/3rdparty/rtl8723de/platform/platform_ops.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_ops.h 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#ifndef __PLATFORM_OPS_H__ -+#define __PLATFORM_OPS_H__ -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void); -+void platform_wifi_power_off(void); -+ -+#endif /* __PLATFORM_OPS_H__ */ -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_RTK_DMP_usb.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_RTK_DMP_usb.c ---- linux-4.14.18/3rdparty/rtl8723de/platform/platform_RTK_DMP_usb.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_RTK_DMP_usb.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,35 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#include -+ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ u32 tmp; -+ tmp = readl((volatile unsigned int *)0xb801a608); -+ tmp &= 0xffffff00; -+ tmp |= 0x55; -+ writel(tmp, (volatile unsigned int *)0xb801a608); /* write dummy register for 1055 */ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+} -diff -Nurp linux-4.14.18/3rdparty/rtl8723de/platform/platform_sprd_sdio.c linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_sprd_sdio.c ---- linux-4.14.18/3rdparty/rtl8723de/platform/platform_sprd_sdio.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.18-rtl/3rdparty/rtl8723de/platform/platform_sprd_sdio.c 2018-02-11 21:44:27.177146543 +0200 -@@ -0,0 +1,89 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ * You should have received a copy of the GNU General Public License along with -+ * this program; if not, write to the Free Software Foundation, Inc., -+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA -+ * -+ * -+ ******************************************************************************/ -+#include -+ -+extern void sdhci_bus_scan(void); -+#ifndef ANDROID_2X -+extern int sdhci_device_attached(void); -+#endif -+ -+/* -+ * Return: -+ * 0: power on successfully -+ * others: power on failed -+ */ -+int platform_wifi_power_on(void) -+{ -+ int ret = 0; -+ -+ -+#ifdef CONFIG_RTL8188E -+ rtw_wifi_gpio_wlan_ctrl(WLAN_POWER_ON); -+#endif /* CONFIG_RTL8188E */ -+ -+ /* Pull up pwd pin, make wifi leave power down mode. */ -+ rtw_wifi_gpio_init(); -+ rtw_wifi_gpio_wlan_ctrl(WLAN_PWDN_ON); -+ -+#if (MP_DRIVER == 1) && (defined(CONFIG_RTL8723A) || defined(CONFIG_RTL8723B)) -+ /* Pull up BT reset pin. */ -+ rtw_wifi_gpio_wlan_ctrl(WLAN_BT_PWDN_ON); -+#endif -+ rtw_mdelay_os(5); -+ -+ sdhci_bus_scan(); -+#ifdef CONFIG_RTL8723B -+ /* YJ,test,130305 */ -+ rtw_mdelay_os(1000); -+#endif -+#ifdef ANDROID_2X -+ rtw_mdelay_os(200); -+#else /* !ANDROID_2X */ -+ if (1) { -+ int i = 0; -+ -+ for (i = 0; i <= 50; i++) { -+ msleep(10); -+ if (sdhci_device_attached()) -+ break; -+ printk("%s delay times:%d\n", __func__, i); -+ } -+ } -+#endif /* !ANDROID_2X */ -+ -+ return ret; -+} -+ -+void platform_wifi_power_off(void) -+{ -+ /* Pull down pwd pin, make wifi enter power down mode. */ -+ rtw_wifi_gpio_wlan_ctrl(WLAN_PWDN_OFF); -+ rtw_mdelay_os(5); -+ rtw_wifi_gpio_deinit(); -+ -+#ifdef CONFIG_RTL8188E -+ rtw_wifi_gpio_wlan_ctrl(WLAN_POWER_OFF); -+#endif /* CONFIG_RTL8188E */ -+ -+#ifdef CONFIG_WOWLAN -+ if (mmc_host) -+ mmc_host->pm_flags &= ~MMC_PM_KEEP_POWER; -+#endif /* CONFIG_WOWLAN */ -+} diff --git a/kernel/kernel/files/patches/mageia/3rd-rtl8812au.patch b/kernel/kernel/files/patches/mageia/3rd-rtl8812au.patch deleted file mode 100644 index 23d622c1..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-rtl8812au.patch +++ /dev/null @@ -1,183101 +0,0 @@ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/efuse/rtw_efuse.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/efuse/rtw_efuse.c ---- linux-4.14.17/3rdparty/rtl8812au/core/efuse/rtw_efuse.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/efuse/rtw_efuse.c 2018-02-06 17:42:30.692966898 +0200 -@@ -0,0 +1,1304 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_EFUSE_C_ -+ -+#include -+ -+ -+ -+/*------------------------Define local variable------------------------------*/ -+u8 fakeEfuseBank=0; -+u32 fakeEfuseUsedBytes=0; -+u8 fakeEfuseContent[EFUSE_MAX_HW_SIZE]={0}; -+u8 fakeEfuseInitMap[EFUSE_MAX_MAP_LEN]={0}; -+u8 fakeEfuseModifiedMap[EFUSE_MAX_MAP_LEN]={0}; -+ -+u32 BTEfuseUsedBytes=0; -+u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+u8 BTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN]={0}; -+u8 BTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN]={0}; -+ -+u32 fakeBTEfuseUsedBytes=0; -+u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+u8 fakeBTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN]={0}; -+u8 fakeBTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN]={0}; -+/*------------------------Define local variable------------------------------*/ -+ -+//------------------------------------------------------------------------------ -+#define REG_EFUSE_CTRL 0x0030 -+#define EFUSE_CTRL REG_EFUSE_CTRL // E-Fuse Control. -+//------------------------------------------------------------------------------ -+ -+bool -+Efuse_Read1ByteFromFakeContent( -+ PADAPTER pAdapter, -+ u16 Offset, -+ u8 *Value ) -+{ -+ if(Offset >= EFUSE_MAX_HW_SIZE) -+ { -+ return false; -+ } -+ //DbgPrint("Read fake content, offset = %d\n", Offset); -+ if(fakeEfuseBank == 0) -+ *Value = fakeEfuseContent[Offset]; -+ else -+ *Value = fakeBTEfuseContent[fakeEfuseBank-1][Offset]; -+ return true; -+} -+ -+bool -+Efuse_Write1ByteToFakeContent( -+ PADAPTER pAdapter, -+ u16 Offset, -+ u8 Value ); -+bool -+Efuse_Write1ByteToFakeContent( -+ PADAPTER pAdapter, -+ u16 Offset, -+ u8 Value ) -+{ -+ if(Offset >= EFUSE_MAX_HW_SIZE) -+ { -+ return false; -+ } -+ if(fakeEfuseBank == 0) -+ fakeEfuseContent[Offset] = Value; -+ else -+ { -+ fakeBTEfuseContent[fakeEfuseBank-1][Offset] = Value; -+ } -+ return true; -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: Efuse_PowerSwitch -+ * -+ * Overview: When we want to enable write operation, we should change to -+ * pwr on state. When we stop write, we should switch to 500k mode -+ * and disable LDO 2.5V. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/17/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+Efuse_PowerSwitch( -+ PADAPTER pAdapter, -+ u8 bWrite, -+ u8 PwrState) -+{ -+ pAdapter->HalFunc.EfusePowerSwitch(pAdapter, bWrite, PwrState); -+} -+ -+ -+/*----------------------------------------------------------------------------- -+ * Function: efuse_GetCurrentSize -+ * -+ * Overview: Get current efuse size!!! -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/16/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+u16 -+Efuse_GetCurrentSize( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ bool bPseudoTest) -+{ -+ u16 ret=0; -+ -+ ret = pAdapter->HalFunc.EfuseGetCurrentSize(pAdapter, efuseType, bPseudoTest); -+ -+ return ret; -+} -+ -+/* 11/16/2008 MH Add description. Get current efuse area enabled word!!. */ -+u8 -+Efuse_CalculateWordCnts(u8 word_en) -+{ -+ u8 word_cnts = 0; -+ if(!(word_en & BIT(0))) word_cnts++; // 0 : write enable -+ if(!(word_en & BIT(1))) word_cnts++; -+ if(!(word_en & BIT(2))) word_cnts++; -+ if(!(word_en & BIT(3))) word_cnts++; -+ return word_cnts; -+} -+ -+// -+// Description: -+// Execute E-Fuse read byte operation. -+// Refered from SD1 Richard. -+// -+// Assumption: -+// 1. Boot from E-Fuse and successfully auto-load. -+// 2. PASSIVE_LEVEL (USB interface) -+// -+// Created by Roger, 2008.10.21. -+// -+void -+ReadEFuseByte( -+ PADAPTER Adapter, -+ u16 _offset, -+ u8 *pbuf, -+ bool bPseudoTest) -+{ -+ u32 value32; -+ u8 readbyte; -+ u16 retry; -+ //u32 start=rtw_get_current_time(); -+ -+ if(bPseudoTest) -+ { -+ Efuse_Read1ByteFromFakeContent(Adapter, _offset, pbuf); -+ return; -+ } -+ -+ //Write Address -+ rtw_write8(Adapter, EFUSE_CTRL+1, (_offset & 0xff)); -+ readbyte = rtw_read8(Adapter, EFUSE_CTRL+2); -+ rtw_write8(Adapter, EFUSE_CTRL+2, ((_offset >> 8) & 0x03) | (readbyte & 0xfc)); -+ -+ //Write bit 32 0 -+ readbyte = rtw_read8(Adapter, EFUSE_CTRL+3); -+ rtw_write8(Adapter, EFUSE_CTRL+3, (readbyte & 0x7f)); -+ -+ //Check bit 32 read-ready -+ retry = 0; -+ value32 = rtw_read32(Adapter, EFUSE_CTRL); -+ //while(!(((value32 >> 24) & 0xff) & 0x80) && (retry<10)) -+ while(!(((value32 >> 24) & 0xff) & 0x80) && (retry<10000)) -+ { -+ value32 = rtw_read32(Adapter, EFUSE_CTRL); -+ retry++; -+ } -+ -+ // 20100205 Joseph: Add delay suggested by SD1 Victor. -+ // This fix the problem that Efuse read error in high temperature condition. -+ // Designer says that there shall be some delay after ready bit is set, or the -+ // result will always stay on last data we read. -+ rtw_udelay_os(50); -+ value32 = rtw_read32(Adapter, EFUSE_CTRL); -+ -+ *pbuf = (u8)(value32 & 0xff); -+ //DBG_871X("ReadEFuseByte _offset:%08u, in %d ms\n",_offset ,rtw_get_passing_time_ms(start)); -+ -+} -+ -+ -+// -+// Description: -+// 1. Execute E-Fuse read byte operation according as map offset and -+// save to E-Fuse table. -+// 2. Refered from SD1 Richard. -+// -+// Assumption: -+// 1. Boot from E-Fuse and successfully auto-load. -+// 2. PASSIVE_LEVEL (USB interface) -+// -+// Created by Roger, 2008.10.21. -+// -+// 2008/12/12 MH 1. Reorganize code flow and reserve bytes. and add description. -+// 2. Add efuse utilization collect. -+// 2008/12/22 MH Read Efuse must check if we write section 1 data again!!! Sec1 -+// write addr must be after sec5. -+// -+ -+void -+efuse_ReadEFuse( -+ PADAPTER Adapter, -+ u8 efuseType, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ bool bPseudoTest -+ ); -+void -+efuse_ReadEFuse( -+ PADAPTER Adapter, -+ u8 efuseType, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ bool bPseudoTest -+ ) -+{ -+ Adapter->HalFunc.ReadEFuse(Adapter, efuseType, _offset, _size_byte, pbuf, bPseudoTest); -+} -+ -+void -+EFUSE_GetEfuseDefinition( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ u8 type, -+ void *pOut, -+ bool bPseudoTest -+ ) -+{ -+ pAdapter->HalFunc.EFUSEGetEfuseDefinition(pAdapter, efuseType, type, pOut, bPseudoTest); -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: EFUSE_Read1Byte -+ * -+ * Overview: Copy from WMAC fot EFUSE read 1 byte. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 09/23/2008 MHC Copy from WMAC. -+ * -+ *---------------------------------------------------------------------------*/ -+u8 -+EFUSE_Read1Byte( -+ PADAPTER Adapter, -+ u16 Address) -+{ -+ u8 data; -+ u8 Bytetemp = {0x00}; -+ u8 temp = {0x00}; -+ u32 k=0; -+ u16 contentLen=0; -+ -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI , TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&contentLen, false); -+ -+ if (Address < contentLen) //E-fuse 512Byte -+ { -+ //Write E-fuse Register address bit0~7 -+ temp = Address & 0xFF; -+ rtw_write8(Adapter, EFUSE_CTRL+1, temp); -+ Bytetemp = rtw_read8(Adapter, EFUSE_CTRL+2); -+ //Write E-fuse Register address bit8~9 -+ temp = ((Address >> 8) & 0x03) | (Bytetemp & 0xFC); -+ rtw_write8(Adapter, EFUSE_CTRL+2, temp); -+ -+ //Write 0x30[31]=0 -+ Bytetemp = rtw_read8(Adapter, EFUSE_CTRL+3); -+ temp = Bytetemp & 0x7F; -+ rtw_write8(Adapter, EFUSE_CTRL+3, temp); -+ -+ //Wait Write-ready (0x30[31]=1) -+ Bytetemp = rtw_read8(Adapter, EFUSE_CTRL+3); -+ while(!(Bytetemp & 0x80)) -+ { -+ Bytetemp = rtw_read8(Adapter, EFUSE_CTRL+3); -+ k++; -+ if(k==1000) -+ { -+ k=0; -+ break; -+ } -+ } -+ data=rtw_read8(Adapter, EFUSE_CTRL); -+ return data; -+ } -+ else -+ return 0xFF; -+ -+}/* EFUSE_Read1Byte */ -+ -+/*----------------------------------------------------------------------------- -+ * Function: EFUSE_Write1Byte -+ * -+ * Overview: Copy from WMAC fot EFUSE write 1 byte. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 09/23/2008 MHC Copy from WMAC. -+ * -+ *---------------------------------------------------------------------------*/ -+ -+void -+EFUSE_Write1Byte( -+ PADAPTER Adapter, -+ u16 Address, -+ u8 Value); -+void -+EFUSE_Write1Byte( -+ PADAPTER Adapter, -+ u16 Address, -+ u8 Value) -+{ -+ u8 Bytetemp = {0x00}; -+ u8 temp = {0x00}; -+ u32 k=0; -+ u16 contentLen=0; -+ -+ //RT_TRACE(COMP_EFUSE, DBG_LOUD, ("Addr=%x Data =%x\n", Address, Value)); -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI , TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&contentLen, false); -+ -+ if( Address < contentLen) //E-fuse 512Byte -+ { -+ rtw_write8(Adapter, EFUSE_CTRL, Value); -+ -+ //Write E-fuse Register address bit0~7 -+ temp = Address & 0xFF; -+ rtw_write8(Adapter, EFUSE_CTRL+1, temp); -+ Bytetemp = rtw_read8(Adapter, EFUSE_CTRL+2); -+ -+ //Write E-fuse Register address bit8~9 -+ temp = ((Address >> 8) & 0x03) | (Bytetemp & 0xFC); -+ rtw_write8(Adapter, EFUSE_CTRL+2, temp); -+ -+ //Write 0x30[31]=1 -+ Bytetemp = rtw_read8(Adapter, EFUSE_CTRL+3); -+ temp = Bytetemp | 0x80; -+ rtw_write8(Adapter, EFUSE_CTRL+3, temp); -+ -+ //Wait Write-ready (0x30[31]=0) -+ Bytetemp = rtw_read8(Adapter, EFUSE_CTRL+3); -+ while(Bytetemp & 0x80) -+ { -+ Bytetemp = rtw_read8(Adapter, EFUSE_CTRL+3); -+ k++; -+ if(k==100) -+ { -+ k=0; -+ break; -+ } -+ } -+ } -+}/* EFUSE_Write1Byte */ -+ -+ -+/* 11/16/2008 MH Read one byte from real Efuse. */ -+u8 -+efuse_OneByteRead( -+ PADAPTER pAdapter, -+ u16 addr, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ u8 tmpidx = 0; -+ u8 bResult; -+ -+ //DBG_871X("===> EFUSE_OneByteRead(), addr = %x\n", addr); -+ //DBG_871X("===> EFUSE_OneByteRead() start, 0x34 = 0x%X\n", rtw_read32(pAdapter, EFUSE_TEST)); -+ -+ if(bPseudoTest) -+ { -+ bResult = Efuse_Read1ByteFromFakeContent(pAdapter, addr, data); -+ return bResult; -+ } -+ -+ // <20130227, Kordan> 8192E MP chip A-cut had better not set 0x34[11] until B-Cut. -+/* -+ if ( IS_HARDWARE_TYPE_8723B(pAdapter)) -+ { -+ // <20130121, Kordan> For SMIC EFUSE specificatoin. -+ //0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) -+ //PHY_SetMacReg(pAdapter, 0x34, BIT11, 0); -+ rtw_write16(pAdapter, 0x34, rtw_read16(pAdapter,0x34)& (~BIT11) ); -+ } -+*/ -+ // -----------------e-fuse reg ctrl --------------------------------- -+ //address -+ rtw_write8(pAdapter, EFUSE_CTRL+1, (u8)(addr&0xff)); -+ rtw_write8(pAdapter, EFUSE_CTRL+2, ((u8)((addr>>8) &0x03) ) | -+ (rtw_read8(pAdapter, EFUSE_CTRL+2)&0xFC )); -+ -+ rtw_write8(pAdapter, EFUSE_CTRL+3, 0x72);//read cmd -+ -+ while(!(0x80 &rtw_read8(pAdapter, EFUSE_CTRL+3))&&(tmpidx<1000)) -+ { -+ rtw_mdelay_os(1); -+ tmpidx++; -+ } -+ if(tmpidx<1000) -+ { -+ *data=rtw_read8(pAdapter, EFUSE_CTRL); -+ bResult = true; -+ } -+ else -+ { -+ *data = 0xff; -+ bResult = false; -+ } -+ -+ return bResult; -+} -+ -+/* 11/16/2008 MH Write one byte to reald Efuse. */ -+u8 -+efuse_OneByteWrite( -+ PADAPTER pAdapter, -+ u16 addr, -+ u8 data, -+ bool bPseudoTest) -+{ -+ u8 tmpidx = 0; -+ u8 bResult=false; -+ u32 efuseValue = 0; -+ -+ //DBG_871X("===> EFUSE_OneByteWrite(), addr = %x data=%x\n", addr, data); -+ //DBG_871X("===> EFUSE_OneByteWrite() start, 0x34 = 0x%X\n", rtw_read32(pAdapter, EFUSE_TEST)); -+ -+ if(bPseudoTest) -+ { -+ bResult = Efuse_Write1ByteToFakeContent(pAdapter, addr, data); -+ return bResult; -+ } -+ -+ -+ // -----------------e-fuse reg ctrl --------------------------------- -+ //address -+ -+ // <20121213, Kordan> 8723BE SMIC TestChip workaround. -+/* -+ if (IS_HARDWARE_TYPE_8723B(pAdapter) && ! pHalData->bIsMPChip) -+ { -+ //PlatformEFIOWrite1Byte(pAdapter, REG_MULTI_FUNC_CTRL+1, 0x69); // Turn off EFUSE protection. -+ rtw_write16(pAdapter, REG_SYS_ISO_CTRL, rtw_read16(pAdapter, REG_SYS_ISO_CTRL)| BIT14); // Turn on power cut -+ -+ EFUSE_PowerSwitch(pAdapter,TRUE, TRUE); // LDO 2.6V, this must follows after power cut. -+ } -+*/ -+ -+ efuseValue = rtw_read32(pAdapter, EFUSE_CTRL); -+ efuseValue |= (BIT21|BIT31); -+ efuseValue &= ~(0x3FFFF); -+ efuseValue |= ((addr<<8 | data) & 0x3FFFF); -+ -+/* -+ // <20130227, Kordan> 8192E MP chip A-cut had better not set 0x34[11] until B-Cut. -+ if (IS_HARDWARE_TYPE_8723B(pAdapter) && pHalData->bIsMPChip) -+ { -+ // <20130121, Kordan> For SMIC EFUSE specificatoin. -+ //0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) -+ PHY_SetMacReg(pAdapter, 0x34, BIT11, 1); -+ PlatformEFIOWrite4Byte(pAdapter, EFUSE_CTRL, 0x90600000|((addr<<8 | data)) ); -+ } -+ else -+*/ -+ { -+ rtw_write32(pAdapter, EFUSE_CTRL, efuseValue); -+ } -+ -+ while((0x80 & rtw_read8(pAdapter, EFUSE_CTRL+3)) && (tmpidx<100) ){ -+ rtw_mdelay_os(1); -+ tmpidx++; -+ } -+ -+ if(tmpidx<100) -+ { -+ bResult = true; -+ } -+ else -+ { -+ bResult = false; -+ } -+ -+ return bResult; -+} -+ -+int -+Efuse_PgPacketRead(PADAPTER pAdapter, -+ u8 offset, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ int ret=0; -+ -+ ret = pAdapter->HalFunc.Efuse_PgPacketRead(pAdapter, offset, data, bPseudoTest); -+ -+ return ret; -+} -+ -+int -+Efuse_PgPacketWrite(PADAPTER pAdapter, -+ u8 offset, -+ u8 word_en, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ int ret; -+ -+ ret = pAdapter->HalFunc.Efuse_PgPacketWrite(pAdapter, offset, word_en, data, bPseudoTest); -+ -+ return ret; -+} -+ -+ -+int -+Efuse_PgPacketWrite_BT(PADAPTER pAdapter, -+ u8 offset, -+ u8 word_en, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ int ret; -+ -+ ret = pAdapter->HalFunc.Efuse_PgPacketWrite_BT(pAdapter, offset, word_en, data, bPseudoTest); -+ -+ return ret; -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: efuse_WordEnableDataRead -+ * -+ * Overview: Read allowed word in current efuse section data. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/16/2008 MHC Create Version 0. -+ * 11/21/2008 MHC Fix Write bug when we only enable late word. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+efuse_WordEnableDataRead(u8 word_en, -+ u8 *sourdata, -+ u8 *targetdata) -+{ -+ if (!(word_en&BIT(0))) -+ { -+ targetdata[0] = sourdata[0]; -+ targetdata[1] = sourdata[1]; -+ } -+ if (!(word_en&BIT(1))) -+ { -+ targetdata[2] = sourdata[2]; -+ targetdata[3] = sourdata[3]; -+ } -+ if (!(word_en&BIT(2))) -+ { -+ targetdata[4] = sourdata[4]; -+ targetdata[5] = sourdata[5]; -+ } -+ if (!(word_en&BIT(3))) -+ { -+ targetdata[6] = sourdata[6]; -+ targetdata[7] = sourdata[7]; -+ } -+} -+ -+ -+u8 -+Efuse_WordEnableDataWrite(PADAPTER pAdapter, -+ u16 efuse_addr, -+ u8 word_en, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ u8 ret=0; -+ -+ ret = pAdapter->HalFunc.Efuse_WordEnableDataWrite(pAdapter, efuse_addr, word_en, data, bPseudoTest); -+ -+ return ret; -+} -+ -+static u8 efuse_read8(PADAPTER padapter, u16 address, u8 *value) -+{ -+ return efuse_OneByteRead(padapter,address, value, false); -+} -+ -+static u8 efuse_write8(PADAPTER padapter, u16 address, u8 *value) -+{ -+ return efuse_OneByteWrite(padapter,address, *value, false); -+} -+ -+/* -+ * read/wirte raw efuse data -+ */ -+u8 rtw_efuse_access(PADAPTER padapter, u8 bWrite, u16 start_addr, u16 cnts, u8 *data) -+{ -+ int i = 0; -+ u16 real_content_len = 0, max_available_size = 0; -+ u8 res = _FAIL ; -+ u8 (*rw8)(PADAPTER, u16, u8*); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&real_content_len, false); -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); -+ -+ if (start_addr > real_content_len) -+ return _FAIL; -+ -+ if (true == bWrite) { -+ if ((start_addr + cnts) > max_available_size) -+ return _FAIL; -+ rw8 = &efuse_write8; -+ } else -+ rw8 = &efuse_read8; -+ -+ Efuse_PowerSwitch(padapter, bWrite, true); -+ -+ // e-fuse one byte read / write -+ for (i = 0; i < cnts; i++) { -+ if (start_addr >= real_content_len) { -+ res = _FAIL; -+ break; -+ } -+ -+ res = rw8(padapter, start_addr++, data++); -+ if (_FAIL == res) break; -+ } -+ -+ Efuse_PowerSwitch(padapter, bWrite, false); -+ -+ return res; -+} -+//------------------------------------------------------------------------------ -+u16 efuse_GetMaxSize(PADAPTER padapter) -+{ -+ u16 max_size; -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI , TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_size, false); -+ return max_size; -+} -+//------------------------------------------------------------------------------ -+u8 efuse_GetCurrentSize(PADAPTER padapter, u16 *size) -+{ -+ Efuse_PowerSwitch(padapter, false, true); -+ *size = Efuse_GetCurrentSize(padapter, EFUSE_WIFI, false); -+ Efuse_PowerSwitch(padapter, false, false); -+ -+ return _SUCCESS; -+} -+//------------------------------------------------------------------------------ -+u8 rtw_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -+{ -+ u16 mapLen=0; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, false); -+ -+ if ((addr + cnts) > mapLen) -+ return _FAIL; -+ -+ Efuse_PowerSwitch(padapter, false, true); -+ -+ efuse_ReadEFuse(padapter, EFUSE_WIFI, addr, cnts, data, false); -+ -+ Efuse_PowerSwitch(padapter, false, false); -+ -+ return _SUCCESS; -+} -+ -+u8 rtw_BT_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -+{ -+ u16 mapLen=0; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, false); -+ -+ if ((addr + cnts) > mapLen) -+ return _FAIL; -+ -+ Efuse_PowerSwitch(padapter, false, true); -+ -+ efuse_ReadEFuse(padapter, EFUSE_BT, addr, cnts, data, false); -+ -+ Efuse_PowerSwitch(padapter, false, false); -+ -+ return _SUCCESS; -+} -+//------------------------------------------------------------------------------ -+u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -+{ -+ u8 offset, word_en; -+ u8 *map; -+ u8 newdata[PGPKT_DATA_SIZE]; -+ s32 i, j, idx; -+ u8 ret = _SUCCESS; -+ u16 mapLen=0; -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, false); -+ -+ if ((addr + cnts) > mapLen) -+ return _FAIL; -+ -+ map = rtw_zmalloc(mapLen); -+ if(map == NULL){ -+ return _FAIL; -+ } -+ -+ ret = rtw_efuse_map_read(padapter, 0, mapLen, map); -+ if (ret == _FAIL) goto exit; -+ -+ Efuse_PowerSwitch(padapter, true, true); -+ -+ offset = (addr >> 3); -+ word_en = 0xF; -+ _rtw_memset(newdata, 0xFF, PGPKT_DATA_SIZE); -+ i = addr & 0x7; // index of one package -+ j = 0; // index of new package -+ idx = 0; // data index -+ -+ if (i & 0x1) { -+ // odd start -+ if (data[idx] != map[addr+idx]) { -+ word_en &= ~BIT(i >> 1); -+ newdata[i-1] = map[addr+idx-1]; -+ newdata[i] = data[idx]; -+ } -+ i++; -+ idx++; -+ } -+ do { -+ for (; i < PGPKT_DATA_SIZE; i += 2) -+ { -+ if (cnts == idx) break; -+ if ((cnts - idx) == 1) { -+ if (data[idx] != map[addr+idx]) { -+ word_en &= ~BIT(i >> 1); -+ newdata[i] = data[idx]; -+ newdata[i+1] = map[addr+idx+1]; -+ } -+ idx++; -+ break; -+ } else { -+ if ((data[idx] != map[addr+idx]) || -+ (data[idx+1] != map[addr+idx+1])) -+ { -+ word_en &= ~BIT(i >> 1); -+ newdata[i] = data[idx]; -+ newdata[i+1] = data[idx + 1]; -+ } -+ idx += 2; -+ } -+ if (idx == cnts) break; -+ } -+ -+ if (word_en != 0xF) { -+ ret = Efuse_PgPacketWrite(padapter, offset, word_en, newdata, false); -+ DBG_871X("offset=%x \n",offset); -+ DBG_871X("word_en=%x \n",word_en); -+ -+ for(i=0;i mapLen) -+ return _FAIL; -+ -+ map = rtw_zmalloc(mapLen); -+ if(map == NULL){ -+ return _FAIL; -+ } -+ -+ ret = rtw_BT_efuse_map_read(padapter, 0, mapLen, map); -+ if (ret == _FAIL) goto exit; -+ -+ Efuse_PowerSwitch(padapter, true, true); -+ -+ offset = (addr >> 3); -+ word_en = 0xF; -+ _rtw_memset(newdata, 0xFF, PGPKT_DATA_SIZE); -+ i = addr & 0x7; // index of one package -+ j = 0; // index of new package -+ idx = 0; // data index -+ -+ if (i & 0x1) { -+ // odd start -+ if (data[idx] != map[addr+idx]) { -+ word_en &= ~BIT(i >> 1); -+ newdata[i-1] = map[addr+idx-1]; -+ newdata[i] = data[idx]; -+ } -+ i++; -+ idx++; -+ } -+ do { -+ for (; i < PGPKT_DATA_SIZE; i += 2) -+ { -+ if (cnts == idx) break; -+ if ((cnts - idx) == 1) { -+ if (data[idx] != map[addr+idx]) { -+ word_en &= ~BIT(i >> 1); -+ newdata[i] = data[idx]; -+ newdata[i+1] = map[addr+idx+1]; -+ } -+ idx++; -+ break; -+ } else { -+ if ((data[idx] != map[addr+idx]) || -+ (data[idx+1] != map[addr+idx+1])) -+ { -+ word_en &= ~BIT(i >> 1); -+ newdata[i] = data[idx]; -+ newdata[i+1] = data[idx + 1]; -+ } -+ idx += 2; -+ } -+ if (idx == cnts) break; -+ } -+ -+ if (word_en != 0xF) -+ { -+ DBG_871X("%s: offset=%#X\n", __FUNCTION__, offset); -+ DBG_871X("%s: word_en=%#X\n", __FUNCTION__, word_en); -+ DBG_871X("%s: data=", __FUNCTION__); -+ for (i=0; iefuse_eeprom_data[Offset]; -+ -+} // EFUSE_ShadowRead1Byte -+ -+//---------------Read Two Bytes -+static void -+efuse_ShadowRead2Byte( -+ PADAPTER pAdapter, -+ u16 Offset, -+ u16 *Value) -+{ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); -+ -+ *Value = pEEPROM->efuse_eeprom_data[Offset]; -+ *Value |= pEEPROM->efuse_eeprom_data[Offset+1]<<8; -+ -+} // EFUSE_ShadowRead2Byte -+ -+//---------------Read Four Bytes -+static void -+efuse_ShadowRead4Byte( -+ PADAPTER pAdapter, -+ u16 Offset, -+ u32 *Value) -+{ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); -+ -+ *Value = pEEPROM->efuse_eeprom_data[Offset]; -+ *Value |= pEEPROM->efuse_eeprom_data[Offset+1]<<8; -+ *Value |= pEEPROM->efuse_eeprom_data[Offset+2]<<16; -+ *Value |= pEEPROM->efuse_eeprom_data[Offset+3]<<24; -+ -+} // efuse_ShadowRead4Byte -+ -+ -+/*----------------------------------------------------------------------------- -+ * Function: efuse_ShadowWrite1Byte -+ * efuse_ShadowWrite2Byte -+ * efuse_ShadowWrite4Byte -+ * -+ * Overview: Write efuse modify map by one/two/four byte. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/12/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+ -+static void -+efuse_ShadowWrite1Byte( -+ PADAPTER pAdapter, -+ u16 Offset, -+ u8 Value) -+{ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); -+ -+ pEEPROM->efuse_eeprom_data[Offset] = Value; -+ -+} // efuse_ShadowWrite1Byte -+ -+//---------------Write Two Bytes -+static void -+efuse_ShadowWrite2Byte( -+ PADAPTER pAdapter, -+ u16 Offset, -+ u16 Value) -+{ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); -+ -+ pEEPROM->efuse_eeprom_data[Offset] = Value&0x00FF; -+ pEEPROM->efuse_eeprom_data[Offset+1] = Value>>8; -+ -+} // efuse_ShadowWrite1Byte -+ -+//---------------Write Four Bytes -+static void -+efuse_ShadowWrite4Byte( -+ PADAPTER pAdapter, -+ u16 Offset, -+ u32 Value) -+{ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); -+ -+ pEEPROM->efuse_eeprom_data[Offset] = (u8)(Value&0x000000FF); -+ pEEPROM->efuse_eeprom_data[Offset+1] = (u8)((Value>>8)&0x0000FF); -+ pEEPROM->efuse_eeprom_data[Offset+2] = (u8)((Value>>16)&0x00FF); -+ pEEPROM->efuse_eeprom_data[Offset+3] = (u8)((Value>>24)&0xFF); -+ -+} // efuse_ShadowWrite1Byte -+ -+/*----------------------------------------------------------------------------- -+ * Function: EFUSE_ShadowMapUpdate -+ * -+ * Overview: Transfer current EFUSE content to shadow init and modify map. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/13/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void EFUSE_ShadowMapUpdate( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ bool bPseudoTest) -+{ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); -+ u16 mapLen=0; -+ -+ EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, bPseudoTest); -+ -+ if (pEEPROM->bautoload_fail_flag == true) -+ { -+ _rtw_memset(pEEPROM->efuse_eeprom_data, 0xFF, mapLen); -+ } -+ else -+ { -+ #ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+ if(_SUCCESS != retriveAdaptorInfoFile(pAdapter->registrypriv.adaptor_info_caching_file_path, pEEPROM)) { -+ #endif -+ -+ Efuse_ReadAllMap(pAdapter, efuseType, pEEPROM->efuse_eeprom_data, bPseudoTest); -+ -+ #ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+ storeAdaptorInfoFile(pAdapter->registrypriv.adaptor_info_caching_file_path, pEEPROM); -+ } -+ #endif -+ } -+ -+ //PlatformMoveMemory((void *)&pHalData->EfuseMap[EFUSE_MODIFY_MAP][0], -+ //(void *)&pHalData->EfuseMap[EFUSE_INIT_MAP][0], mapLen); -+}// EFUSE_ShadowMapUpdate -+ -+ -+/*----------------------------------------------------------------------------- -+ * Function: EFUSE_ShadowRead -+ * -+ * Overview: Read from efuse init map !!!!! -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/12/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+EFUSE_ShadowRead( -+ PADAPTER pAdapter, -+ u8 Type, -+ u16 Offset, -+ u32 *Value ) -+{ -+ if (Type == 1) -+ efuse_ShadowRead1Byte(pAdapter, Offset, (u8 *)Value); -+ else if (Type == 2) -+ efuse_ShadowRead2Byte(pAdapter, Offset, (u16 *)Value); -+ else if (Type == 4) -+ efuse_ShadowRead4Byte(pAdapter, Offset, (u32 *)Value); -+ -+} // EFUSE_ShadowRead -+ -+/*----------------------------------------------------------------------------- -+ * Function: EFUSE_ShadowWrite -+ * -+ * Overview: Write efuse modify map for later update operation to use!!!!! -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/12/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+EFUSE_ShadowWrite( -+ PADAPTER pAdapter, -+ u8 Type, -+ u16 Offset, -+ u32 Value); -+void -+EFUSE_ShadowWrite( -+ PADAPTER pAdapter, -+ u8 Type, -+ u16 Offset, -+ u32 Value) -+{ -+#if (MP_DRIVER == 0) -+ return; -+#endif -+ if ( pAdapter->registrypriv.mp_mode == 0) -+ return; -+ -+ -+ if (Type == 1) -+ efuse_ShadowWrite1Byte(pAdapter, Offset, (u8)Value); -+ else if (Type == 2) -+ efuse_ShadowWrite2Byte(pAdapter, Offset, (u16)Value); -+ else if (Type == 4) -+ efuse_ShadowWrite4Byte(pAdapter, Offset, (u32)Value); -+ -+} // EFUSE_ShadowWrite -+ -+void -+Efuse_InitSomeVar( -+ PADAPTER pAdapter -+ ); -+void -+Efuse_InitSomeVar( -+ PADAPTER pAdapter -+ ) -+{ -+ u8 i; -+ -+ _rtw_memset((void *)&fakeEfuseContent[0], 0xff, EFUSE_MAX_HW_SIZE); -+ _rtw_memset((void *)&fakeEfuseInitMap[0], 0xff, EFUSE_MAX_MAP_LEN); -+ _rtw_memset((void *)&fakeEfuseModifiedMap[0], 0xff, EFUSE_MAX_MAP_LEN); -+ -+ for(i=0; iefuse_eeprom_data, EEPROM_MAX_SIZE_512); -+ if(ret == EEPROM_MAX_SIZE) -+ ret = _SUCCESS; -+ else -+ ret = _FAIL; -+ } else { -+ DBG_871X("%s NULL pointer\n",__FUNCTION__); -+ ret = _FAIL; -+ } -+ return ret; -+} -+ -+int retriveAdaptorInfoFile(char *path, struct eeprom_priv * eeprom_priv) -+{ -+ int ret = _SUCCESS; -+ mm_segment_t oldfs; -+ struct file *fp; -+ -+ if(path && eeprom_priv) { -+ -+ ret = rtw_retrive_from_file(path, eeprom_priv->efuse_eeprom_data, EEPROM_MAX_SIZE); -+ -+ if(ret == EEPROM_MAX_SIZE) -+ ret = _SUCCESS; -+ else -+ ret = _FAIL; -+ -+ #if 0 -+ if(isAdaptorInfoFileValid()) { -+ return 0; -+ } else { -+ return _FAIL; -+ } -+ #endif -+ -+ } else { -+ DBG_871X("%s NULL pointer\n",__FUNCTION__); -+ ret = _FAIL; -+ } -+ return ret; -+} -+#endif //CONFIG_ADAPTOR_INFO_CACHING_FILE -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_ap.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ap.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_ap.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ap.c 2018-02-06 17:42:30.693966912 +0200 -@@ -0,0 +1,3158 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_AP_C_ -+ -+#include -+ -+ -+#ifdef CONFIG_AP_MODE -+ -+extern unsigned char RTW_WPA_OUI[]; -+extern unsigned char WMM_OUI[]; -+extern unsigned char WPS_OUI[]; -+extern unsigned char P2P_OUI[]; -+extern unsigned char WFD_OUI[]; -+ -+void init_mlme_ap_info(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ -+ -+ _rtw_spinlock_init(&pmlmepriv->bcn_update_lock); -+ -+ //for ACL -+ _rtw_init_queue(&pacl_list->acl_node_q); -+ -+ //pmlmeext->bstart_bss = false; -+ -+ start_ap_mode(padapter); -+} -+ -+void free_mlme_ap_info(_adapter *padapter) -+{ -+ _irqL irqL; -+ struct sta_info *psta=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ //stop_ap_mode(padapter); -+ -+ pmlmepriv->update_bcn = false; -+ pmlmeext->bstart_bss = false; -+ -+ rtw_sta_flush(padapter); -+ -+ pmlmeinfo->state = _HW_STATE_NOLINK_; -+ -+ //free_assoc_sta_resources -+ rtw_free_all_stainfo(padapter); -+ -+ //free bc/mc sta_info -+ psta = rtw_get_bcmc_stainfo(padapter); -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(padapter, psta); -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ -+ _rtw_spinlock_free(&pmlmepriv->bcn_update_lock); -+ -+} -+ -+static void update_BCNTIM(_adapter *padapter) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network); -+ unsigned char *pie = pnetwork_mlmeext->IEs; -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ //update TIM IE -+ //if(pstapriv->tim_bitmap) -+ if(true) -+ { -+ u8 *p, *dst_ie, *premainder_ie=NULL, *pbackup_remainder_ie=NULL; -+ u16 tim_bitmap_le; -+ uint offset, tmp_len, tim_ielen, tim_ie_offset, remainder_ielen; -+ -+ tim_bitmap_le = cpu_to_le16(pstapriv->tim_bitmap); -+ -+ p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, _TIM_IE_, &tim_ielen, pnetwork_mlmeext->IELength - _FIXED_IE_LENGTH_); -+ if (p != NULL && tim_ielen>0) -+ { -+ tim_ielen += 2; -+ -+ premainder_ie = p+tim_ielen; -+ -+ tim_ie_offset = (sint)(p -pie); -+ -+ remainder_ielen = pnetwork_mlmeext->IELength - tim_ie_offset - tim_ielen; -+ -+ //append TIM IE from dst_ie offset -+ dst_ie = p; -+ } -+ else -+ { -+ tim_ielen = 0; -+ -+ //calucate head_len -+ offset = _FIXED_IE_LENGTH_; -+ -+ /* get ssid_ie len */ -+ p = rtw_get_ie(pie + _BEACON_IE_OFFSET_, _SSID_IE_, &tmp_len, (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_)); -+ if (p != NULL) -+ offset += tmp_len+2; -+ -+ // get supported rates len -+ p = rtw_get_ie(pie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &tmp_len, (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_)); -+ if (p != NULL) -+ { -+ offset += tmp_len+2; -+ } -+ -+ //DS Parameter Set IE, len=3 -+ offset += 3; -+ -+ premainder_ie = pie + offset; -+ -+ remainder_ielen = pnetwork_mlmeext->IELength - offset - tim_ielen; -+ -+ //append TIM IE from offset -+ dst_ie = pie + offset; -+ -+ } -+ -+ -+ if(remainder_ielen>0) -+ { -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if(pbackup_remainder_ie && premainder_ie) -+ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ *dst_ie++=_TIM_IE_; -+ -+ if((pstapriv->tim_bitmap&0xff00) && (pstapriv->tim_bitmap&0x00fe)) -+ tim_ielen = 5; -+ else -+ tim_ielen = 4; -+ -+ *dst_ie++= tim_ielen; -+ -+ *dst_ie++=0;//DTIM count -+ *dst_ie++=1;//DTIM peroid -+ -+ if(pstapriv->tim_bitmap&BIT(0))//for bc/mc frames -+ *dst_ie++ = BIT(0);//bitmap ctrl -+ else -+ *dst_ie++ = 0; -+ -+ if(tim_ielen==4) -+ { -+ u8 pvb=0; -+ -+ if(pstapriv->tim_bitmap&0x00fe) -+ pvb = (u8)tim_bitmap_le; -+ else if(pstapriv->tim_bitmap&0xff00) -+ pvb = (u8)(tim_bitmap_le>>8); -+ else -+ pvb = (u8)tim_bitmap_le; -+ -+ *dst_ie++ = pvb; -+ -+ } -+ else if(tim_ielen==5) -+ { -+ _rtw_memcpy(dst_ie, &tim_bitmap_le, 2); -+ dst_ie+=2; -+ } -+ -+ //copy remainder IE -+ if(pbackup_remainder_ie) -+ { -+ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ rtw_mfree(pbackup_remainder_ie, remainder_ielen); -+ } -+ -+ offset = (uint)(dst_ie - pie); -+ pnetwork_mlmeext->IELength = offset + remainder_ielen; -+ -+ } -+ -+#ifndef CONFIG_INTERRUPT_BASED_TXBCN -+ set_tx_beacon_cmd(padapter); -+#endif //!CONFIG_INTERRUPT_BASED_TXBCN -+} -+ -+void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *data, u8 len) -+{ -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 bmatch = false; -+ u8 *pie = pnetwork->IEs; -+ u8 *p, *dst_ie, *premainder_ie=NULL, *pbackup_remainder_ie=NULL; -+ u32 i, offset, ielen, ie_offset, remainder_ielen = 0; -+ -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pnetwork->IELength;) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pnetwork->IEs + i); -+ -+ if (pIE->ElementID > index) -+ { -+ break; -+ } -+ else if(pIE->ElementID == index) // already exist the same IE -+ { -+ p = (u8 *)pIE; -+ ielen = pIE->Length; -+ bmatch = true; -+ break; -+ } -+ -+ p = (u8 *)pIE; -+ ielen = pIE->Length; -+ i += (pIE->Length + 2); -+ } -+ -+ if (p != NULL && ielen>0) -+ { -+ ielen += 2; -+ -+ premainder_ie = p+ielen; -+ -+ ie_offset = (sint)(p -pie); -+ -+ remainder_ielen = pnetwork->IELength - ie_offset - ielen; -+ -+ if(bmatch) -+ dst_ie = p; -+ else -+ dst_ie = (p+ielen); -+ } -+ -+ if(remainder_ielen>0) -+ { -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if(pbackup_remainder_ie && premainder_ie) -+ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ *dst_ie++=index; -+ *dst_ie++=len; -+ -+ _rtw_memcpy(dst_ie, data, len); -+ dst_ie+=len; -+ -+ //copy remainder IE -+ if(pbackup_remainder_ie) -+ { -+ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ rtw_mfree(pbackup_remainder_ie, remainder_ielen); -+ } -+ -+ offset = (uint)(dst_ie - pie); -+ pnetwork->IELength = offset + remainder_ielen; -+} -+ -+void rtw_remove_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index) -+{ -+ u8 *p, *dst_ie, *premainder_ie=NULL, *pbackup_remainder_ie=NULL; -+ uint offset, ielen, ie_offset, remainder_ielen = 0; -+ u8 *pie = pnetwork->IEs; -+ -+ p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, index, &ielen, pnetwork->IELength - _FIXED_IE_LENGTH_); -+ if (p != NULL && ielen>0) -+ { -+ ielen += 2; -+ -+ premainder_ie = p+ielen; -+ -+ ie_offset = (sint)(p -pie); -+ -+ remainder_ielen = pnetwork->IELength - ie_offset - ielen; -+ -+ dst_ie = p; -+ } -+ -+ if(remainder_ielen>0) -+ { -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if(pbackup_remainder_ie && premainder_ie) -+ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ //copy remainder IE -+ if(pbackup_remainder_ie) -+ { -+ _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ rtw_mfree(pbackup_remainder_ie, remainder_ielen); -+ } -+ -+ offset = (uint)(dst_ie - pie); -+ pnetwork->IELength = offset + remainder_ielen; -+} -+ -+ -+u8 chk_sta_is_alive(struct sta_info *psta); -+u8 chk_sta_is_alive(struct sta_info *psta) -+{ -+ u8 ret = false; -+ #ifdef DBG_EXPIRATION_CHK -+ DBG_871X("sta:"MAC_FMT", rssi:%d, rx:"STA_PKTS_FMT", expire_to:%u, %s%ssq_len:%u\n" -+ , MAC_ARG(psta->hwaddr) -+ , psta->rssi_stat.UndecoratedSmoothedPWDB -+ //, STA_RX_PKTS_ARG(psta) -+ , STA_RX_PKTS_DIFF_ARG(psta) -+ , psta->expire_to -+ , psta->state&WIFI_SLEEP_STATE?"PS, ":"" -+ , psta->state&WIFI_STA_ALIVE_CHK_STATE?"SAC, ":"" -+ , psta->sleepq_len -+ ); -+ #endif -+ -+ //if(sta_last_rx_pkts(psta) == sta_rx_pkts(psta)) -+ if((psta->sta_stats.last_rx_data_pkts + psta->sta_stats.last_rx_ctrl_pkts) == (psta->sta_stats.rx_data_pkts + psta->sta_stats.rx_ctrl_pkts)) -+ { -+ #if 0 -+ if(psta->state&WIFI_SLEEP_STATE) -+ ret = true; -+ #endif -+ } -+ else -+ { -+ ret = true; -+ } -+ -+ sta_update_last_rx_pkts(psta); -+ -+ return ret; -+} -+ -+void expire_timeout_chk(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ u8 updated; -+ struct sta_info *psta=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 chk_alive_num = 0; -+ char chk_alive_list[NUM_STA]; -+ int i; -+ -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ -+ phead = &pstapriv->auth_list; -+ plist = get_next(phead); -+ -+ //check auth_queue -+ #ifdef DBG_EXPIRATION_CHK -+ if (rtw_end_of_queue_search(phead, plist) == false) { -+ DBG_871X(FUNC_NDEV_FMT" auth_list, cnt:%u\n" -+ , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->auth_list_cnt); -+ } -+ #endif -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, auth_list); -+ plist = get_next(plist); -+ -+ if(psta->expire_to>0) -+ { -+ psta->expire_to--; -+ if (psta->expire_to == 0) -+ { -+ rtw_list_delete(&psta->auth_list); -+ pstapriv->auth_list_cnt--; -+ -+ DBG_871X("auth expire %02X%02X%02X%02X%02X%02X\n", -+ psta->hwaddr[0],psta->hwaddr[1],psta->hwaddr[2],psta->hwaddr[3],psta->hwaddr[4],psta->hwaddr[5]); -+ -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(padapter, psta); -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ } -+ } -+ -+ } -+ -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ -+ psta = NULL; -+ -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ //check asoc_queue -+ #ifdef DBG_EXPIRATION_CHK -+ if (rtw_end_of_queue_search(phead, plist) == false) { -+ DBG_871X(FUNC_NDEV_FMT" asoc_list, cnt:%u\n" -+ , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->asoc_list_cnt); -+ } -+ #endif -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if(psta->isrc) -+ continue; -+#endif -+ -+ if (chk_sta_is_alive(psta) || !psta->expire_to) { -+ psta->expire_to = pstapriv->expire_to; -+ psta->keep_alive_trycnt = 0; -+ #ifdef CONFIG_TX_MCAST2UNI -+ psta->under_exist_checking = 0; -+ #endif // CONFIG_TX_MCAST2UNI -+ } else { -+ psta->expire_to--; -+ } -+ -+#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+#ifdef CONFIG_TX_MCAST2UNI -+#ifdef CONFIG_80211N_HT -+ if ( (psta->flags & WLAN_STA_HT) && (psta->htpriv.agg_enable_bitmap || psta->under_exist_checking) ) { -+ // check sta by delba(addba) for 11n STA -+ // ToDo: use CCX report to check for all STAs -+ //DBG_871X("asoc check by DELBA/ADDBA! (pstapriv->expire_to=%d s)(psta->expire_to=%d s), [%02x, %d]\n", pstapriv->expire_to*2, psta->expire_to*2, psta->htpriv.agg_enable_bitmap, psta->under_exist_checking); -+ -+ if ( psta->expire_to <= (pstapriv->expire_to - 50 ) ) { -+ DBG_871X("asoc expire by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to-psta->expire_to)*2); -+ psta->under_exist_checking = 0; -+ psta->expire_to = 0; -+ } else if ( psta->expire_to <= (pstapriv->expire_to - 3) && (psta->under_exist_checking==0)) { -+ DBG_871X("asoc check by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to-psta->expire_to)*2); -+ psta->under_exist_checking = 1; -+ //tear down TX AMPDU -+ send_delba(padapter, 1, psta->hwaddr);// // originator -+ psta->htpriv.agg_enable_bitmap = 0x0;//reset -+ psta->htpriv.candidate_tid_bitmap = 0x0;//reset -+ } -+ } -+#endif //CONFIG_80211N_HT -+#endif // CONFIG_TX_MCAST2UNI -+#endif //CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ -+ if (psta->expire_to <= 0) -+ { -+ #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if (padapter->registrypriv.wifi_spec == 1) -+ { -+ psta->expire_to = pstapriv->expire_to; -+ continue; -+ } -+ -+ if (psta->state & WIFI_SLEEP_STATE) { -+ if (!(psta->state & WIFI_STA_ALIVE_CHK_STATE)) { -+ //to check if alive by another methods if staion is at ps mode. -+ psta->expire_to = pstapriv->expire_to; -+ psta->state |= WIFI_STA_ALIVE_CHK_STATE; -+ -+ //DBG_871X("alive chk, sta:" MAC_FMT " is at ps mode!\n", MAC_ARG(psta->hwaddr)); -+ -+ //to update bcn with tim_bitmap for this station -+ pstapriv->tim_bitmap |= BIT(psta->aid); -+ update_beacon(padapter, _TIM_IE_, NULL, false); -+ -+ if(!pmlmeext->active_keep_alive_check) -+ continue; -+ } -+ } -+ -+ if (pmlmeext->active_keep_alive_check) { -+ int stainfo_offset; -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) { -+ chk_alive_list[chk_alive_num++] = stainfo_offset; -+ } -+ -+ continue; -+ } -+ #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ -+ DBG_871X("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); -+ updated = ap_free_sta(padapter, psta, false, WLAN_REASON_DEAUTH_LEAVING); -+ } -+ else -+ { -+ /* TODO: Aging mechanism to digest frames in sleep_q to avoid running out of xmitframe */ -+ if (psta->sleepq_len > (NR_XMITFRAME/pstapriv->asoc_list_cnt) -+ && padapter->xmitpriv.free_xmitframe_cnt < ((NR_XMITFRAME/pstapriv->asoc_list_cnt)/2) -+ ){ -+ DBG_871X("%s sta:"MAC_FMT", sleepq_len:%u, free_xmitframe_cnt:%u, asoc_list_cnt:%u, clear sleep_q\n", __func__ -+ , MAC_ARG(psta->hwaddr) -+ , psta->sleepq_len, padapter->xmitpriv.free_xmitframe_cnt, pstapriv->asoc_list_cnt); -+ wakeup_sta_to_xmit(padapter, psta); -+ } -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+if (chk_alive_num) { -+ -+ u8 backup_oper_channel=0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ /* switch to correct channel of current network before issue keep-alive frames */ -+ if (rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { -+ backup_oper_channel = rtw_get_oper_ch(padapter); -+ SelectChannel(padapter, pmlmeext->cur_channel); -+ } -+ -+ /* issue null data to check sta alive*/ -+ for (i = 0; i < chk_alive_num; i++) { -+ -+ int ret = _FAIL; -+ -+ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); -+ if(!(psta->state &_FW_LINKED)) -+ continue; -+ -+ if (psta->state & WIFI_SLEEP_STATE) -+ ret = issue_nulldata(padapter, psta->hwaddr, 0, 1, 50); -+ else -+ ret = issue_nulldata(padapter, psta->hwaddr, 0, 3, 50); -+ -+ psta->keep_alive_trycnt++; -+ if (ret == _SUCCESS) -+ { -+ DBG_871X("asoc check, sta(" MAC_FMT ") is alive\n", MAC_ARG(psta->hwaddr)); -+ psta->expire_to = pstapriv->expire_to; -+ psta->keep_alive_trycnt = 0; -+ continue; -+ } -+ else if (psta->keep_alive_trycnt <= 3) -+ { -+ DBG_871X("ack check for asoc expire, keep_alive_trycnt=%d\n", psta->keep_alive_trycnt); -+ psta->expire_to = 1; -+ continue; -+ } -+ -+ psta->keep_alive_trycnt = 0; -+ -+ DBG_871X("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&psta->asoc_list)==false) { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, false, WLAN_REASON_DEAUTH_LEAVING); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ } -+ -+ if (backup_oper_channel>0) /* back to the original operation channel */ -+ SelectChannel(padapter, backup_oper_channel); -+} -+#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ -+ associated_clients_update(padapter, updated); -+} -+ -+void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level) -+{ -+ int i; -+ u8 rf_type; -+ u32 init_rate=0; -+ unsigned char sta_band = 0, raid, shortGIrate = false; -+ unsigned char limit; -+ unsigned int tx_ra_bitmap=0; -+ struct ht_priv *psta_ht = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ -+#ifdef CONFIG_80211N_HT -+ if(psta) -+ psta_ht = &psta->htpriv; -+ else -+ return; -+#endif //CONFIG_80211N_HT -+ -+ if(!(psta->state & _FW_LINKED)) -+ return; -+ -+ //b/g mode ra_bitmap -+ for (i=0; ibssrateset); i++) -+ { -+ if (psta->bssrateset[i]) -+ tx_ra_bitmap |= rtw_get_bit_value_from_ieee_value(psta->bssrateset[i]&0x7f); -+ } -+#ifdef CONFIG_80211N_HT -+#ifdef CONFIG_80211AC_VHT -+ //AC mode ra_bitmap -+ if(psta->vhtpriv.vht_option) -+ { -+ u32 vht_bitmap = 0; -+ -+ vht_bitmap = rtw_vht_rate_to_bitmap(psta->vhtpriv.vht_mcs_map); -+ tx_ra_bitmap |= (vht_bitmap << 12); -+ -+ //max short GI rate -+ shortGIrate = psta->vhtpriv.sgi; -+ } -+ else -+#endif //CONFIG_80211AC_VHT -+ { -+ //n mode ra_bitmap -+ if(psta_ht->ht_option) -+ { -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if(rf_type == RF_2T2R) -+ limit=16;// 2R -+ else -+ limit=8;// 1R -+ -+ for (i=0; iht_cap.supp_mcs_set[i/8] & BIT(i%8)) -+ tx_ra_bitmap |= BIT(i+12); -+ } -+ -+ //max short GI rate -+ shortGIrate = psta_ht->sgi; -+ } -+ } -+#endif //CONFIG_80211N_HT -+ -+#if 0//gtest -+ if(get_rf_mimo_mode(padapter) == RTL8712_RF_2T2R) -+ { -+ //is this a 2r STA? -+ if((pstat->tx_ra_bitmap & 0x0ff00000) != 0 && !(priv->pshare->has_2r_sta & BIT(pstat->aid))) -+ { -+ priv->pshare->has_2r_sta |= BIT(pstat->aid); -+ if(rtw_read16(padapter, 0x102501f6) != 0xffff) -+ { -+ rtw_write16(padapter, 0x102501f6, 0xffff); -+ reset_1r_sta_RA(priv, 0xffff); -+ Switch_1SS_Antenna(priv, 3); -+ } -+ } -+ else// bg or 1R STA? -+ { -+ if((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) && pstat->ht_cap_len && priv->pshare->has_2r_sta == 0) -+ { -+ if(rtw_read16(padapter, 0x102501f6) != 0x7777) -+ { // MCS7 SGI -+ rtw_write16(padapter, 0x102501f6,0x7777); -+ reset_1r_sta_RA(priv, 0x7777); -+ Switch_1SS_Antenna(priv, 2); -+ } -+ } -+ } -+ -+ } -+ -+ if ((pstat->rssi_level < 1) || (pstat->rssi_level > 3)) -+ { -+ if (pstat->rssi >= priv->pshare->rf_ft_var.raGoDownUpper) -+ pstat->rssi_level = 1; -+ else if ((pstat->rssi >= priv->pshare->rf_ft_var.raGoDown20MLower) || -+ ((priv->pshare->is_40m_bw) && (pstat->ht_cap_len) && -+ (pstat->rssi >= priv->pshare->rf_ft_var.raGoDown40MLower) && -+ (pstat->ht_cap_buf.ht_cap_info & cpu_to_le16(_HTCAP_SUPPORT_CH_WDTH_)))) -+ pstat->rssi_level = 2; -+ else -+ pstat->rssi_level = 3; -+ } -+ -+ // rate adaptive by rssi -+ if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) && pstat->ht_cap_len) -+ { -+ if ((get_rf_mimo_mode(priv) == MIMO_1T2R) || (get_rf_mimo_mode(priv) == MIMO_1T1R)) -+ { -+ switch (pstat->rssi_level) { -+ case 1: -+ pstat->tx_ra_bitmap &= 0x100f0000; -+ break; -+ case 2: -+ pstat->tx_ra_bitmap &= 0x100ff000; -+ break; -+ case 3: -+ if (priv->pshare->is_40m_bw) -+ pstat->tx_ra_bitmap &= 0x100ff005; -+ else -+ pstat->tx_ra_bitmap &= 0x100ff001; -+ -+ break; -+ } -+ } -+ else -+ { -+ switch (pstat->rssi_level) { -+ case 1: -+ pstat->tx_ra_bitmap &= 0x1f0f0000; -+ break; -+ case 2: -+ pstat->tx_ra_bitmap &= 0x1f0ff000; -+ break; -+ case 3: -+ if (priv->pshare->is_40m_bw) -+ pstat->tx_ra_bitmap &= 0x000ff005; -+ else -+ pstat->tx_ra_bitmap &= 0x000ff001; -+ -+ break; -+ } -+ -+ // Don't need to mask high rates due to new rate adaptive parameters -+ //if (pstat->is_broadcom_sta) // use MCS12 as the highest rate vs. Broadcom sta -+ // pstat->tx_ra_bitmap &= 0x81ffffff; -+ -+ // NIC driver will report not supporting MCS15 and MCS14 in asoc req -+ //if (pstat->is_rtl8190_sta && !pstat->is_2t_mimo_sta) -+ // pstat->tx_ra_bitmap &= 0x83ffffff; // if Realtek 1x2 sta, don't use MCS15 and MCS14 -+ } -+ } -+ else if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) && isErpSta(pstat)) -+ { -+ switch (pstat->rssi_level) { -+ case 1: -+ pstat->tx_ra_bitmap &= 0x00000f00; -+ break; -+ case 2: -+ pstat->tx_ra_bitmap &= 0x00000ff0; -+ break; -+ case 3: -+ pstat->tx_ra_bitmap &= 0x00000ff5; -+ break; -+ } -+ } -+ else -+ { -+ pstat->tx_ra_bitmap &= 0x0000000d; -+ } -+ -+ // disable tx short GI when station cannot rx MCS15(AP is 2T2R) -+ // disable tx short GI when station cannot rx MCS7 (AP is 1T2R or 1T1R) -+ // if there is only 1r STA and we are 2T2R, DO NOT mask SGI rate -+ if ((!(pstat->tx_ra_bitmap & 0x8000000) && (priv->pshare->has_2r_sta > 0) && (get_rf_mimo_mode(padapter) == RTL8712_RF_2T2R)) || -+ (!(pstat->tx_ra_bitmap & 0x80000) && (get_rf_mimo_mode(padapter) != RTL8712_RF_2T2R))) -+ { -+ pstat->tx_ra_bitmap &= ~BIT(28); -+ } -+#endif -+ -+ if ( pcur_network->Configuration.DSConfig > 14 ) { -+ // 5G band -+#ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) { -+ sta_band = WIRELESS_11_5AC; -+ } -+ else -+#endif -+ { -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_5N | WIRELESS_11A; -+ else -+ sta_band |= WIRELESS_11A; -+ } -+ } else { -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_24N | WIRELESS_11G | WIRELESS_11B; -+ else if (tx_ra_bitmap & 0xff0) -+ sta_band |= WIRELESS_11G |WIRELESS_11B; -+ else -+ sta_band |= WIRELESS_11B; -+ } -+ -+ psta->wireless_mode = sta_band; -+ -+ //raid = networktype_to_raid(sta_band); -+ raid = rtw_hal_networktype_to_raid(padapter,sta_band); -+ -+ init_rate = get_highest_rate_idx(tx_ra_bitmap)&0x3f; -+ -+ if (psta->aid < NUM_STA) -+ { -+ u8 arg[4] = {0}; -+ -+ //arg[0] = macid -+ //arg[1] = raid -+ //arg[2] = shortGIrate -+ //arg[3] = init_rate -+ -+ arg[0] = psta->mac_id; -+ arg[1] = raid; -+ arg[2] = shortGIrate; -+ arg[3] = init_rate; -+ -+ DBG_871X("%s=> mac_id:%d , raid:%d , shortGIrate=%d, bitmap=0x%x\n", -+ __FUNCTION__ , psta->mac_id, raid ,shortGIrate, tx_ra_bitmap); -+ -+ rtw_hal_add_ra_tid(padapter, tx_ra_bitmap, arg, rssi_level); -+ -+ if (shortGIrate==true) -+ init_rate |= BIT(6); -+ -+ //set ra_id, init_rate -+ psta->raid = raid; -+ psta->init_rate = init_rate; -+ } -+ else -+ { -+ DBG_871X("station aid %d exceed the max number\n", psta->aid); -+ } -+ -+} -+ -+static void update_bmc_sta(_adapter *padapter) -+{ -+ _irqL irqL; -+ u32 init_rate=0; -+ unsigned char network_type, raid; -+ int i, supportRateNum = 0; -+ unsigned int tx_ra_bitmap=0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ struct sta_info *psta = rtw_get_bcmc_stainfo(padapter); -+ -+ if(psta) -+ { -+ psta->aid = 0;//default set to 0 -+ //psta->mac_id = psta->aid+4; -+ psta->mac_id = psta->aid + 1;//mac_id=1 for bc/mc stainfo -+ -+ pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; -+ -+ psta->qos_option = 0; -+#ifdef CONFIG_80211N_HT -+ psta->htpriv.ht_option = false; -+#endif //CONFIG_80211N_HT -+ -+ psta->ieee8021x_blocked = 0; -+ -+ _rtw_memset((void*)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); -+ -+ //psta->dot118021XPrivacy = _NO_PRIVACY_;//!!! remove it, because it has been set before this. -+ -+ -+ -+ //prepare for add_RATid -+ supportRateNum = rtw_get_rateset_len((u8*)&pcur_network->SupportedRates); -+ network_type = rtw_check_network_type((u8*)&pcur_network->SupportedRates, supportRateNum, 1); -+ -+ _rtw_memcpy(psta->bssrateset, &pcur_network->SupportedRates, supportRateNum); -+ psta->bssratelen = supportRateNum; -+ -+ //b/g mode ra_bitmap -+ for (i=0; ibssrateset[i]) -+ tx_ra_bitmap |= rtw_get_bit_value_from_ieee_value(psta->bssrateset[i]&0x7f); -+ } -+ -+ if ( pcur_network->Configuration.DSConfig > 14 ) { -+ //force to A mode. 5G doesn't support CCK rates -+ network_type = WIRELESS_11A; -+ tx_ra_bitmap = 0x150; // 6, 12, 24 Mbps -+ } else { -+ //force to b mode -+ network_type = WIRELESS_11B; -+ tx_ra_bitmap = 0xf; -+ } -+ -+ //tx_ra_bitmap = update_basic_rate(pcur_network->SupportedRates, supportRateNum); -+ -+ //raid = networktype_to_raid(network_type); -+ raid = rtw_hal_networktype_to_raid(padapter,network_type); -+ -+ init_rate = get_highest_rate_idx(tx_ra_bitmap&0x0fffffff)&0x3f; -+ -+ //DBG_871X("Add id %d val %08x to ratr for bmc sta\n", psta->aid, tx_ra_bitmap); -+ //ap mode -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, true); -+ -+ //if(pHalData->fw_ractrl == true) -+ { -+ u8 arg[4] = {0}; -+ -+ //arg[0] = macid -+ //arg[1] = raid -+ //arg[2] = shortGIrate -+ //arg[3] = init_rate -+ -+ arg[0] = psta->mac_id; -+ arg[1] = raid; -+ arg[2] = 0; -+ arg[3] = init_rate; -+ -+ DBG_871X("%s=> mac_id:%d , raid:%d , bitmap=0x%x\n", -+ __FUNCTION__ , psta->mac_id, raid , tx_ra_bitmap); -+ -+ rtw_hal_add_ra_tid(padapter, tx_ra_bitmap, arg, 0); -+ } -+ -+ //set ra_id, init_rate -+ psta->raid = raid; -+ psta->init_rate = init_rate; -+ -+ rtw_stassoc_hw_rpt(padapter, psta); -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state = _FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ } -+ else -+ { -+ DBG_871X("add_RATid_bmc_sta error!\n"); -+ } -+ -+} -+ -+//notes: -+//AID: 1~MAX for sta and 0 for bc/mc in ap/adhoc mode -+//MAC_ID = AID+1 for sta in ap/adhoc mode -+//MAC_ID = 1 for bc/mc for sta/ap/adhoc -+//MAC_ID = 0 for bssid for sta/ap/adhoc -+//CAM_ID = //0~3 for default key, cmd_id=macid + 3, macid=aid+1; -+ -+void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+#ifdef CONFIG_80211N_HT -+ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; -+ struct ht_priv *phtpriv_sta = &psta->htpriv; -+#endif //CONFIG_80211N_HT -+ //set intf_tag to if1 -+ //psta->intf_tag = 0; -+ -+ DBG_871X("%s\n",__FUNCTION__); -+ -+ //psta->mac_id = psta->aid+4; -+ //psta->mac_id = psta->aid+1;//alloc macid when call rtw_alloc_stainfo(), -+ //release macid when call rtw_free_stainfo() -+ -+ //ap mode -+ rtw_hal_set_odm_var(padapter,HAL_ODM_STA_INFO,psta,true); -+ -+ if(psecuritypriv->dot11AuthAlgrthm==dot11AuthAlgrthm_8021X) -+ psta->ieee8021x_blocked = true; -+ else -+ psta->ieee8021x_blocked = false; -+ -+ -+ //update sta's cap -+ -+ //ERP -+ VCS_update(padapter, psta); -+#ifdef CONFIG_80211N_HT -+ //HT related cap -+ if(phtpriv_sta->ht_option) -+ { -+ //check if sta supports rx ampdu -+ phtpriv_sta->ampdu_enable = phtpriv_ap->ampdu_enable; -+ -+ //check if sta support s Short GI -+ if((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_20|IEEE80211_HT_CAP_SGI_40)) -+ { -+ phtpriv_sta->sgi = true; -+ } -+ -+ // bwmode -+ if((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) -+ { -+ //phtpriv_sta->bwmode = CHANNEL_WIDTH_40; -+ phtpriv_sta->bwmode = pmlmeext->cur_bwmode; -+ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; -+ -+ } -+ -+ psta->qos_option = true; -+ -+ } -+ else -+ { -+ phtpriv_sta->ampdu_enable = false; -+ -+ phtpriv_sta->sgi = false; -+ phtpriv_sta->bwmode = CHANNEL_WIDTH_20; -+ phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ //Rx AMPDU -+ send_delba(padapter, 0, psta->hwaddr);// recipient -+ -+ //TX AMPDU -+ send_delba(padapter, 1, psta->hwaddr);// // originator -+ phtpriv_sta->agg_enable_bitmap = 0x0;//reset -+ phtpriv_sta->candidate_tid_bitmap = 0x0;//reset -+#endif //CONFIG_80211N_HT -+ -+#ifdef CONFIG_80211AC_VHT -+ update_sta_vht_info_apmode(padapter, psta); -+#endif -+ -+ //todo: init other variables -+ -+ _rtw_memset((void*)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); -+ -+ -+ //add ratid -+ //add_RATid(padapter, psta);//move to ap_sta_info_defer_update() -+ -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state |= _FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ -+} -+ -+static void update_hw_ht_param(_adapter *padapter) -+{ -+ unsigned char max_AMPDU_len; -+ unsigned char min_MPDU_spacing; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ -+ //handle A-MPDU parameter field -+ /* -+ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k -+ AMPDU_para [4:2]:Min MPDU Start Spacing -+ */ -+ max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; -+ -+ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len)); -+ -+ // -+ // Config SM Power Save setting -+ // -+ pmlmeinfo->SM_PS = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & 0x0C) >> 2; -+ if(pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) -+ { -+ /*u8 i; -+ //update the MCS rates -+ for (i = 0; i < 16; i++) -+ { -+ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; -+ }*/ -+ DBG_871X("%s(): WLAN_HT_CAP_SM_PS_STATIC\n",__FUNCTION__); -+ } -+ -+ // -+ // Config current HT Protection mode. -+ // -+ //pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; -+ -+} -+ -+static void start_bss_network(_adapter *padapter, u8 *pbuf) -+{ -+ u8 *p; -+ u8 val8, cur_channel, cur_bwmode, cur_ch_offset; -+ u16 bcn_interval; -+ u32 acparm; -+ int ie_len; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network); -+ struct HT_info_element *pht_info=NULL; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif //CONFIG_P2P -+ u8 cbw40_enable=0; -+ u8 change_band = false; -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ bcn_interval = (u16)pnetwork->Configuration.BeaconPeriod; -+ cur_channel = pnetwork->Configuration.DSConfig; -+ cur_bwmode = CHANNEL_WIDTH_20; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ -+ //check if there is wps ie, -+ //if there is wpsie in beacon, the hostapd will update beacon twice when stating hostapd, -+ //and at first time the security ie ( RSN/WPA IE) will not include in beacon. -+ if(NULL == rtw_get_wps_ie(pnetwork->IEs+_FIXED_IE_LENGTH_, pnetwork->IELength-_FIXED_IE_LENGTH_, NULL, NULL)) -+ { -+ pmlmeext->bstart_bss = true; -+ } -+ -+ //todo: update wmm, ht cap -+ //pmlmeinfo->WMM_enable; -+ //pmlmeinfo->HT_enable; -+ if(pmlmepriv->qospriv.qos_option) -+ pmlmeinfo->WMM_enable = true; -+#ifdef CONFIG_80211N_HT -+ if(pmlmepriv->htpriv.ht_option) -+ { -+ pmlmeinfo->WMM_enable = true; -+ pmlmeinfo->HT_enable = true; -+ //pmlmeinfo->HT_info_enable = true; -+ //pmlmeinfo->HT_caps_enable = true; -+ -+ update_hw_ht_param(padapter); -+ } -+#endif //#CONFIG_80211N_HT -+ -+#ifdef CONFIG_80211AC_VHT -+ if(pmlmepriv->vhtpriv.vht_option) { -+ pmlmeinfo->VHT_enable = true; -+ update_hw_vht_param(padapter); -+ } -+#endif //CONFIG_80211AC_VHT -+ -+ if(pmlmepriv->cur_network.join_res != true) //setting only at first time -+ { -+ //WEP Key will be set before this function, do not clear CAM. -+ if ((psecuritypriv->dot11PrivacyAlgrthm != _WEP40_) && (psecuritypriv->dot11PrivacyAlgrthm != _WEP104_)) -+ flush_all_cam_entry(padapter); //clear CAM -+ } -+ -+ //set MSR to AP_Mode -+ Set_MSR(padapter, _HW_STATE_AP_); -+ -+ //Set BSSID REG -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pnetwork->MacAddress); -+ -+ //Set EDCA param reg -+#ifdef CONFIG_CONCURRENT_MODE -+ acparm = 0x005ea42b; -+#else -+ acparm = 0x002F3217; // VO -+#endif -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); -+ acparm = 0x005E4317; // VI -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); -+ //acparm = 0x00105320; // BE -+ acparm = 0x005ea42b; -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); -+ acparm = 0x0000A444; // BK -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); -+ -+ //Set Security -+ val8 = (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X)? 0xcc: 0xcf; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+ //Beacon Control related register -+ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&bcn_interval)); -+ -+ if(pmlmepriv->cur_network.join_res != true) //setting only at first time -+ { -+ //u32 initialgain; -+ -+ //initialgain = 0x1e; -+ -+ -+ //disable dynamic functions, such as high power, DIG -+ //Save_DM_Func_Flag(padapter); -+ //Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->adapter_type > PRIMARY_ADAPTER) -+ { -+ if(rtw_buddy_adapter_up(padapter)) -+ { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ -+ //turn on all dynamic functions on PRIMARY_ADAPTER, dynamic functions only runs at PRIMARY_ADAPTER -+ Switch_DM_Func(pbuddy_adapter, DYNAMIC_ALL_FUNC_ENABLE, true); -+ -+ //rtw_hal_set_hwreg(pbuddy_adapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); -+ } -+ } -+ else -+#endif -+ { -+ //turn on all dynamic functions -+ Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, true); -+ -+ //rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); -+ } -+ -+ } -+#ifdef CONFIG_80211N_HT -+ //set channel, bwmode -+ p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if( p && ie_len) -+ { -+ pht_info = (struct HT_info_element *)(p+2); -+ -+ if (cur_channel > 14) { -+ if ((pregpriv->bw_mode & 0xf0) > 0) -+ cbw40_enable = 1; -+ } else { -+ if ((pregpriv->bw_mode & 0x0f) > 0) -+ cbw40_enable = 1; -+ } -+ -+ if ((cbw40_enable) && (pht_info->infos[0] & BIT(2))) -+ { -+ //switch to the 40M Hz mode -+ //pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; -+ cur_bwmode = CHANNEL_WIDTH_40; -+ switch (pht_info->infos[0] & 0x3) -+ { -+ case 1: -+ //pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case 3: -+ //pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ //pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ -+ } -+ -+ } -+#endif //CONFIG_80211N_HT -+ -+#ifdef CONFIG_80211AC_VHT -+ p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_VHTOperation, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if( p && ie_len) -+ { -+ if(GET_VHT_OPERATION_ELE_CHL_WIDTH(p+2) >= 1) { -+ cur_bwmode = CHANNEL_WIDTH_80; -+ } -+ } -+#endif -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ dc_set_ap_channel_bandwidth(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+#else -+ //TODO: need to judge the phy parameters on concurrent mode for single phy -+ //set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+#ifdef CONFIG_CONCURRENT_MODE -+ if(!check_buddy_fwstate(padapter, _FW_LINKED|_FW_UNDER_LINKING|_FW_UNDER_SURVEY)) -+ { -+ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+ } -+ else if(check_buddy_fwstate(padapter, _FW_LINKED)==true)//only second adapter can enter AP Mode -+ { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ //To sync cur_channel/cur_bwmode/cur_ch_offset with primary adapter -+ DBG_871X("primary iface is at linked state, sync cur_channel/cur_bwmode/cur_ch_offset\n"); -+ DBG_871X("primary adapter, CH=%d, BW=%d, offset=%d\n", pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_bwmode, pbuddy_mlmeext->cur_ch_offset); -+ DBG_871X("second adapter, CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset); -+ -+ if((cur_channel <= 14 && pbuddy_mlmeext->cur_channel >= 36) || -+ (cur_channel >= 36 && pbuddy_mlmeext->cur_channel <= 14)) -+ change_band = true; -+ -+ cur_channel = pbuddy_mlmeext->cur_channel; -+ if(cur_bwmode == CHANNEL_WIDTH_40) -+ { -+ if(pht_info) -+ pht_info->infos[0] &= ~(BIT(0)|BIT(1)); -+ -+ if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) -+ { -+ cur_ch_offset = pbuddy_mlmeext->cur_ch_offset; -+ -+ //to update cur_ch_offset value in beacon -+ if(pht_info) -+ { -+ switch(cur_ch_offset) -+ { -+ case HAL_PRIME_CHNL_OFFSET_LOWER: -+ pht_info->infos[0] |= 0x1; -+ break; -+ case HAL_PRIME_CHNL_OFFSET_UPPER: -+ pht_info->infos[0] |= 0x3; -+ break; -+ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: -+ default: -+ break; -+ } -+ } -+ -+ } -+ else if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_20) -+ { -+ cur_bwmode = CHANNEL_WIDTH_20; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if(cur_channel>0 && cur_channel<5) -+ { -+ if(pht_info) -+ pht_info->infos[0] |= 0x1; -+ -+ cur_bwmode = CHANNEL_WIDTH_40; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ } -+ -+ if(cur_channel>7 && cur_channel<(14+1)) -+ { -+ if(pht_info) -+ pht_info->infos[0] |= 0x3; -+ -+ cur_bwmode = CHANNEL_WIDTH_40; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ } -+ } -+ -+ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+ -+ } -+ else -+ { -+ //follow buddy's ch/bw/ch_offset setting, needn't set ch_bw again. -+ //set_channel_bwmode(padapter, cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ } -+ -+ // to update channel value in beacon -+ pnetwork->Configuration.DSConfig = cur_channel; -+ p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if(p && ie_len>0) -+ *(p + 2) = cur_channel; -+ -+ if(pht_info) -+ pht_info->primary_channel = cur_channel; -+ } -+#else -+ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+#endif //CONFIG_CONCURRENT_MODE -+ -+ DBG_871X("CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset); -+ -+ pmlmeext->cur_channel = cur_channel; -+ pmlmeext->cur_bwmode = cur_bwmode; -+ pmlmeext->cur_ch_offset = cur_ch_offset; -+ -+ //buddy interface band is different from current interface, update ERP, support rate, ext support rate IE -+ if(change_band == true) -+ change_band_update_ie(padapter, pnetwork); -+#endif //CONFIG_DUALMAC_CONCURRENT -+ -+ pmlmeext->cur_wireless_mode = pmlmepriv->cur_network.network_type; -+ -+ //update cur_wireless_mode -+ update_wireless_mode(padapter); -+ -+ //update RRSR after set channel and bandwidth -+ UpdateBrateTbl(padapter, pnetwork->SupportedRates); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, pnetwork->SupportedRates); -+ -+ //udpate capability after cur_wireless_mode updated -+ update_capinfo(padapter, rtw_get_capability((WLAN_BSSID_EX *)pnetwork)); -+ -+ //let pnetwork_mlmeext == pnetwork_mlme. -+ _rtw_memcpy(pnetwork_mlmeext, pnetwork, pnetwork->Length); -+ -+#ifdef CONFIG_P2P -+ _rtw_memcpy(pwdinfo->p2p_group_ssid, pnetwork->Ssid.Ssid, pnetwork->Ssid.SsidLength); -+ pwdinfo->p2p_group_ssid_len = pnetwork->Ssid.SsidLength; -+#endif //CONFIG_P2P -+ -+ if(true == pmlmeext->bstart_bss) -+ { -+ update_beacon(padapter, _TIM_IE_, NULL, false); -+ -+#ifndef CONFIG_INTERRUPT_BASED_TXBCN //other case will tx beacon when bcn interrupt coming in. -+ //issue beacon frame -+ if(send_beacon(padapter)==_FAIL) -+ { -+ DBG_871X("issue_beacon, fail!\n"); -+ } -+#endif //!CONFIG_INTERRUPT_BASED_TXBCN -+ -+ } -+ -+ -+ //update bc/mc sta_info -+ update_bmc_sta(padapter); -+ -+ //pmlmeext->bstart_bss = true; -+ -+} -+ -+int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) -+{ -+ int ret=_SUCCESS; -+ u8 *p; -+ u8 *pHT_caps_ie=NULL; -+ u8 *pHT_info_ie=NULL; -+ struct sta_info *psta = NULL; -+ u16 cap, ht_cap=false; -+ uint ie_len = 0; -+ int group_cipher, pairwise_cipher; -+ u8 channel, network_type, supportRate[NDIS_802_11_LENGTH_RATES_EX]; -+ int supportRateNum = 0; -+ u8 OUI1[] = {0x00, 0x50, 0xf2,0x01}; -+ u8 wps_oui[4]={0x0,0x50,0xf2,0x04}; -+ u8 WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pbss_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *ie = pbss_network->IEs; -+ -+ -+ /* SSID */ -+ /* Supported rates */ -+ /* DS Params */ -+ /* WLAN_EID_COUNTRY */ -+ /* ERP Information element */ -+ /* Extended supported rates */ -+ /* WPA/WPA2 */ -+ /* Wi-Fi Wireless Multimedia Extensions */ -+ /* ht_capab, ht_oper */ -+ /* WPS IE */ -+ -+ DBG_871X("%s, len=%d\n", __FUNCTION__, len); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return _FAIL; -+ -+ -+ if(len>MAX_IE_SZ) -+ return _FAIL; -+ -+ pbss_network->IELength = len; -+ -+ _rtw_memset(ie, 0, MAX_IE_SZ); -+ -+ _rtw_memcpy(ie, pbuf, pbss_network->IELength); -+ -+ -+ if(pbss_network->InfrastructureMode!=Ndis802_11APMode) -+ return _FAIL; -+ -+ pbss_network->Rssi = 0; -+ -+ _rtw_memcpy(pbss_network->MacAddress, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ //beacon interval -+ p = rtw_get_beacon_interval_from_ie(ie);//ie + 8; // 8: TimeStamp, 2: Beacon Interval 2:Capability -+ //pbss_network->Configuration.BeaconPeriod = le16_to_cpu(*(unsigned short*)p); -+ pbss_network->Configuration.BeaconPeriod = RTW_GET_LE16(p); -+ -+ //capability -+ //cap = *(unsigned short *)rtw_get_capability_from_ie(ie); -+ //cap = le16_to_cpu(cap); -+ cap = RTW_GET_LE16(ie); -+ -+ //SSID -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SSID_IE_, &ie_len, (pbss_network->IELength -_BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ { -+ _rtw_memset(&pbss_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(pbss_network->Ssid.Ssid, (p + 2), ie_len); -+ pbss_network->Ssid.SsidLength = ie_len; -+ } -+ -+ //chnnel -+ channel = 0; -+ pbss_network->Configuration.Length = 0; -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _DSSET_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ channel = *(p + 2); -+ -+ pbss_network->Configuration.DSConfig = channel; -+ -+ -+ _rtw_memset(supportRate, 0, NDIS_802_11_LENGTH_RATES_EX); -+ // get supported rates -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if (p != NULL) -+ { -+ _rtw_memcpy(supportRate, p+2, ie_len); -+ supportRateNum = ie_len; -+ } -+ -+ //get ext_supported rates -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ie_len, pbss_network->IELength - _BEACON_IE_OFFSET_); -+ if (p != NULL) -+ { -+ _rtw_memcpy(supportRate+supportRateNum, p+2, ie_len); -+ supportRateNum += ie_len; -+ -+ } -+ -+ network_type = rtw_check_network_type(supportRate, supportRateNum, channel); -+ -+ rtw_set_supported_rate(pbss_network->SupportedRates, network_type); -+ -+ -+ //parsing ERP_IE -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ { -+ ERP_IE_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)p); -+ } -+ -+ //update privacy/security -+ if (cap & BIT(4)) -+ pbss_network->Privacy = 1; -+ else -+ pbss_network->Privacy = 0; -+ -+ psecuritypriv->wpa_psk = 0; -+ -+ //wpa2 -+ group_cipher = 0; pairwise_cipher = 0; -+ psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; -+ psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ { -+ if(rtw_parse_wpa2_ie(p, ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ psecuritypriv->dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; -+ -+ psecuritypriv->dot8021xalg = 1;//psk, todo:802.1x -+ psecuritypriv->wpa_psk |= BIT(1); -+ -+ psecuritypriv->wpa2_group_cipher = group_cipher; -+ psecuritypriv->wpa2_pairwise_cipher = pairwise_cipher; -+#if 0 -+ switch(group_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; -+ break; -+ case WPA_CIPHER_WEP40: -+ psecuritypriv->wpa2_group_cipher = _WEP40_; -+ break; -+ case WPA_CIPHER_TKIP: -+ psecuritypriv->wpa2_group_cipher = _TKIP_; -+ break; -+ case WPA_CIPHER_CCMP: -+ psecuritypriv->wpa2_group_cipher = _AES_; -+ break; -+ case WPA_CIPHER_WEP104: -+ psecuritypriv->wpa2_group_cipher = _WEP104_; -+ break; -+ } -+ -+ switch(pairwise_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; -+ break; -+ case WPA_CIPHER_WEP40: -+ psecuritypriv->wpa2_pairwise_cipher = _WEP40_; -+ break; -+ case WPA_CIPHER_TKIP: -+ psecuritypriv->wpa2_pairwise_cipher = _TKIP_; -+ break; -+ case WPA_CIPHER_CCMP: -+ psecuritypriv->wpa2_pairwise_cipher = _AES_; -+ break; -+ case WPA_CIPHER_WEP104: -+ psecuritypriv->wpa2_pairwise_cipher = _WEP104_; -+ break; -+ } -+#endif -+ } -+ -+ } -+ -+ //wpa -+ ie_len = 0; -+ group_cipher = 0; pairwise_cipher = 0; -+ psecuritypriv->wpa_group_cipher = _NO_PRIVACY_; -+ psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_; -+ for (p = ie + _BEACON_IE_OFFSET_; ;p += (ie_len + 2)) -+ { -+ p = rtw_get_ie(p, _SSN_IE_1_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); -+ if ((p) && (_rtw_memcmp(p+2, OUI1, 4))) -+ { -+ if(rtw_parse_wpa_ie(p, ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ psecuritypriv->dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; -+ -+ psecuritypriv->dot8021xalg = 1;//psk, todo:802.1x -+ -+ psecuritypriv->wpa_psk |= BIT(0); -+ -+ psecuritypriv->wpa_group_cipher = group_cipher; -+ psecuritypriv->wpa_pairwise_cipher = pairwise_cipher; -+ -+#if 0 -+ switch(group_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ psecuritypriv->wpa_group_cipher = _NO_PRIVACY_; -+ break; -+ case WPA_CIPHER_WEP40: -+ psecuritypriv->wpa_group_cipher = _WEP40_; -+ break; -+ case WPA_CIPHER_TKIP: -+ psecuritypriv->wpa_group_cipher = _TKIP_; -+ break; -+ case WPA_CIPHER_CCMP: -+ psecuritypriv->wpa_group_cipher = _AES_; -+ break; -+ case WPA_CIPHER_WEP104: -+ psecuritypriv->wpa_group_cipher = _WEP104_; -+ break; -+ } -+ -+ switch(pairwise_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_; -+ break; -+ case WPA_CIPHER_WEP40: -+ psecuritypriv->wpa_pairwise_cipher = _WEP40_; -+ break; -+ case WPA_CIPHER_TKIP: -+ psecuritypriv->wpa_pairwise_cipher = _TKIP_; -+ break; -+ case WPA_CIPHER_CCMP: -+ psecuritypriv->wpa_pairwise_cipher = _AES_; -+ break; -+ case WPA_CIPHER_WEP104: -+ psecuritypriv->wpa_pairwise_cipher = _WEP104_; -+ break; -+ } -+#endif -+ } -+ -+ break; -+ -+ } -+ -+ if ((p == NULL) || (ie_len == 0)) -+ { -+ break; -+ } -+ -+ } -+ -+ //wmm -+ ie_len = 0; -+ pmlmepriv->qospriv.qos_option = 0; -+ if(pregistrypriv->wmm_enable) -+ { -+ for (p = ie + _BEACON_IE_OFFSET_; ;p += (ie_len + 2)) -+ { -+ p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); -+ if((p) && _rtw_memcmp(p+2, WMM_PARA_IE, 6)) -+ { -+ pmlmepriv->qospriv.qos_option = 1; -+ -+ *(p+8) |= BIT(7);//QoS Info, support U-APSD -+ -+ /* disable all ACM bits since the WMM admission control is not supported */ -+ *(p + 10) &= ~BIT(4); /* BE */ -+ *(p + 14) &= ~BIT(4); /* BK */ -+ *(p + 18) &= ~BIT(4); /* VI */ -+ *(p + 22) &= ~BIT(4); /* VO */ -+ -+ break; -+ } -+ -+ if ((p == NULL) || (ie_len == 0)) -+ { -+ break; -+ } -+ } -+ } -+#ifdef CONFIG_80211N_HT -+ //parsing HT_CAP_IE -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ { -+ u8 rf_type; -+ -+ struct rtw_ieee80211_ht_cap *pht_cap = (struct rtw_ieee80211_ht_cap *)(p+2); -+ -+ pHT_caps_ie=p; -+ -+ -+ ht_cap = true; -+ network_type |= WIRELESS_11_24N; -+ -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ if((psecuritypriv->wpa_pairwise_cipher & WPA_CIPHER_CCMP) || -+ (psecuritypriv->wpa2_pairwise_cipher & WPA_CIPHER_CCMP)) -+ { -+ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&(0x07<<2)); -+ } -+ else -+ { -+ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&0x00); -+ } -+ -+ pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_FACTOR & 0x03); //set Max Rx AMPDU size to 64K -+ -+ if(rf_type == RF_1T1R) -+ { -+ pht_cap->supp_mcs_set[0] = 0xff; -+ pht_cap->supp_mcs_set[1] = 0x0; -+ } -+ -+ _rtw_memcpy(&pmlmepriv->htpriv.ht_cap, p+2, ie_len); -+ -+ } -+ -+ //parsing HT_INFO_IE -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); -+ if(p && ie_len>0) -+ { -+ pHT_info_ie=p; -+ } -+#endif //CONFIG_80211N_HT -+ switch(network_type) -+ { -+ case WIRELESS_11B: -+ pbss_network->NetworkTypeInUse = Ndis802_11DS; -+ break; -+ case WIRELESS_11G: -+ case WIRELESS_11BG: -+ case WIRELESS_11G_24N: -+ case WIRELESS_11BG_24N: -+ pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; -+ break; -+ case WIRELESS_11A: -+ pbss_network->NetworkTypeInUse = Ndis802_11OFDM5; -+ break; -+ default : -+ pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; -+ break; -+ } -+ -+ pmlmepriv->cur_network.network_type = network_type; -+ -+#ifdef CONFIG_80211N_HT -+ pmlmepriv->htpriv.ht_option = false; -+ -+ if( (psecuritypriv->wpa2_pairwise_cipher&WPA_CIPHER_TKIP) || -+ (psecuritypriv->wpa_pairwise_cipher&WPA_CIPHER_TKIP)) -+ { -+ //todo: -+ //ht_cap = false; -+ } -+ -+ //ht_cap -+ if(pregistrypriv->ht_enable && ht_cap==true) -+ { -+ pmlmepriv->htpriv.ht_option = true; -+ pmlmepriv->qospriv.qos_option = 1; -+ -+ if(pregistrypriv->ampdu_enable==1) -+ { -+ pmlmepriv->htpriv.ampdu_enable = true; -+ } -+ -+ HT_caps_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)pHT_caps_ie); -+ -+ HT_info_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)pHT_info_ie); -+ } -+#endif -+ -+//#ifdef CONFIG_80211AC_VHT -+#if 0 -+ // if channel in 5G band, then add vht ie . -+ if ((pbss_network->Configuration.DSConfig > 14) && -+ (pmlmepriv->htpriv.ht_option == true) && -+ (pregistrypriv->vht_enable)) { -+ u8 cap_len, operation_len; -+ -+ rtw_vht_use_default_setting(padapter); -+ -+ // VHT Capabilities element -+ cap_len = rtw_build_vht_cap_ie(padapter, pbss_network->IEs + pbss_network->IELength); -+ pbss_network->IELength += cap_len; -+ -+ // VHT Operation element -+ operation_len = rtw_build_vht_operation_ie(padapter, pbss_network->IEs + pbss_network->IELength, pbss_network->Configuration.DSConfig); -+ pbss_network->IELength += operation_len; -+ -+ pmlmepriv->vhtpriv.vht_option = true; -+ } -+#endif //CONFIG_80211AC_VHT -+ -+ pbss_network->Length = get_WLAN_BSSID_EX_sz((WLAN_BSSID_EX *)pbss_network); -+ -+ //issue beacon to start bss network -+ start_bss_network(padapter, (u8*)pbss_network); -+ -+ -+ //alloc sta_info for ap itself -+ psta = rtw_get_stainfo(&padapter->stapriv, pbss_network->MacAddress); -+ if(!psta) -+ { -+ psta = rtw_alloc_stainfo(&padapter->stapriv, pbss_network->MacAddress); -+ if (psta == NULL) -+ { -+ return _FAIL; -+ } -+ } -+ psta->state |= WIFI_AP_STATE; //Aries, add,fix bug of flush_cam_entry at STOP AP mode , 0724 -+ rtw_indicate_connect( padapter); -+ -+ pmlmepriv->cur_network.join_res = true;//for check if already set beacon -+ -+ //update bc/mc sta_info -+ //update_bmc_sta(padapter); -+ -+ return ret; -+ -+} -+ -+void rtw_set_macaddr_acl(_adapter *padapter, int mode) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ -+ DBG_871X("%s, mode=%d\n", __func__, mode); -+ -+ pacl_list->mode = mode; -+} -+ -+int rtw_acl_add_sta(_adapter *padapter, u8 *addr) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ u8 added = false; -+ int i, ret=0; -+ struct rtw_wlan_acl_node *paclnode; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ _queue *pacl_node_q =&pacl_list->acl_node_q; -+ -+ DBG_871X("%s(acl_num=%d)=" MAC_FMT "\n", __func__, pacl_list->num, MAC_ARG(addr)); -+ -+ if((NUM_ACL-1) < pacl_list->num) -+ return (-1); -+ -+ -+ _enter_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ phead = get_list_head(pacl_node_q); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); -+ plist = get_next(plist); -+ -+ if(_rtw_memcmp(paclnode->addr, addr, ETH_ALEN)) -+ { -+ if(paclnode->valid == true) -+ { -+ added = true; -+ DBG_871X("%s, sta has been added\n", __func__); -+ break; -+ } -+ } -+ } -+ -+ _exit_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ -+ if(added == true) -+ return ret; -+ -+ -+ _enter_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ for(i=0; i< NUM_ACL; i++) -+ { -+ paclnode = &pacl_list->aclnode[i]; -+ -+ if(paclnode->valid == false) -+ { -+ _rtw_init_listhead(&paclnode->list); -+ -+ _rtw_memcpy(paclnode->addr, addr, ETH_ALEN); -+ -+ paclnode->valid = true; -+ -+ rtw_list_insert_tail(&paclnode->list, get_list_head(pacl_node_q)); -+ -+ pacl_list->num++; -+ -+ break; -+ } -+ } -+ -+ DBG_871X("%s, acl_num=%d\n", __func__, pacl_list->num); -+ -+ _exit_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ return ret; -+} -+ -+int rtw_acl_remove_sta(_adapter *padapter, u8 *addr) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ int i, ret=0; -+ struct rtw_wlan_acl_node *paclnode; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ _queue *pacl_node_q =&pacl_list->acl_node_q; -+ -+ DBG_871X("%s(acl_num=%d)=" MAC_FMT "\n", __func__, pacl_list->num, MAC_ARG(addr)); -+ -+ _enter_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ phead = get_list_head(pacl_node_q); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); -+ plist = get_next(plist); -+ -+ if(_rtw_memcmp(paclnode->addr, addr, ETH_ALEN)) -+ { -+ if(paclnode->valid == true) -+ { -+ paclnode->valid = false; -+ -+ rtw_list_delete(&paclnode->list); -+ -+ pacl_list->num--; -+ } -+ } -+ } -+ -+ _exit_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ DBG_871X("%s, acl_num=%d\n", __func__, pacl_list->num); -+ -+ return ret; -+ -+} -+ -+u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta) -+{ -+ struct cmd_obj* ph2c; -+ struct set_stakey_parm *psetstakey_para; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if ( ph2c == NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ psetstakey_para = (struct set_stakey_parm*)rtw_zmalloc(sizeof(struct set_stakey_parm)); -+ if(psetstakey_para==NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res=_FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); -+ -+ -+ psetstakey_para->algorithm = (u8)psta->dot118021XPrivacy; -+ -+ _rtw_memcpy(psetstakey_para->addr, psta->hwaddr, ETH_ALEN); -+ -+ _rtw_memcpy(psetstakey_para->key, &psta->dot118021x_UncstKey, 16); -+ -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+ -+static int rtw_ap_set_key(_adapter *padapter, u8 *key, u8 alg, int keyid, u8 set_tx) -+{ -+ u8 keylen; -+ struct cmd_obj* pcmd; -+ struct setkey_parm *psetkeyparm; -+ struct cmd_priv *pcmdpriv=&(padapter->cmdpriv); -+ int res=_SUCCESS; -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmd==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ psetkeyparm=(struct setkey_parm*)rtw_zmalloc(sizeof(struct setkey_parm)); -+ if(psetkeyparm==NULL){ -+ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memset(psetkeyparm, 0, sizeof(struct setkey_parm)); -+ -+ psetkeyparm->keyid=(u8)keyid; -+ if (is_wep_enc(alg)) -+ padapter->mlmepriv.key_mask |= BIT(psetkeyparm->keyid); -+ -+ psetkeyparm->algorithm = alg; -+ -+ psetkeyparm->set_tx = set_tx; -+ -+ switch(alg) -+ { -+ case _WEP40_: -+ keylen = 5; -+ break; -+ case _WEP104_: -+ keylen = 13; -+ break; -+ case _TKIP_: -+ case _TKIP_WTMIC_: -+ case _AES_: -+ keylen = 16; -+ default: -+ keylen = 16; -+ } -+ -+ _rtw_memcpy(&(psetkeyparm->key[0]), key, keylen); -+ -+ pcmd->cmdcode = _SetKey_CMD_; -+ pcmd->parmbuf = (u8 *)psetkeyparm; -+ pcmd->cmdsz = (sizeof(struct setkey_parm)); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ -+ _rtw_init_listhead(&pcmd->list); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ -+ return res; -+} -+ -+int rtw_ap_set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ return rtw_ap_set_key(padapter, key, alg, keyid, 1); -+} -+ -+int rtw_ap_set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx) -+{ -+ u8 alg; -+ -+ switch(keylen) -+ { -+ case 5: -+ alg =_WEP40_; -+ break; -+ case 13: -+ alg =_WEP104_; -+ break; -+ default: -+ alg =_NO_PRIVACY_; -+ } -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ return rtw_ap_set_key(padapter, key, alg, keyid, set_tx); -+} -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ -+static void update_bcn_fixed_ie(_adapter *padapter) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_erpinfo_ie(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ unsigned char *p, *ie = pnetwork->IEs; -+ u32 len = 0; -+ -+ DBG_871X("%s, ERP_enable=%d\n", __FUNCTION__, pmlmeinfo->ERP_enable); -+ -+ if(!pmlmeinfo->ERP_enable) -+ return; -+ -+ //parsing ERP_IE -+ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if(p && len>0) -+ { -+ PNDIS_802_11_VARIABLE_IEs pIE = (PNDIS_802_11_VARIABLE_IEs)p; -+ -+ if (pmlmepriv->num_sta_non_erp == 1) -+ pIE->data[0] |= RTW_ERP_INFO_NON_ERP_PRESENT|RTW_ERP_INFO_USE_PROTECTION; -+ else -+ pIE->data[0] &= ~(RTW_ERP_INFO_NON_ERP_PRESENT|RTW_ERP_INFO_USE_PROTECTION); -+ -+ if(pmlmepriv->num_sta_no_short_preamble > 0) -+ pIE->data[0] |= RTW_ERP_INFO_BARKER_PREAMBLE_MODE; -+ else -+ pIE->data[0] &= ~(RTW_ERP_INFO_BARKER_PREAMBLE_MODE); -+ -+ ERP_IE_handler(padapter, pIE); -+ } -+ -+} -+ -+static void update_bcn_htcap_ie(_adapter *padapter) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_htinfo_ie(_adapter *padapter) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_rsn_ie(_adapter *padapter) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_wpa_ie(_adapter *padapter) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_wmm_ie(_adapter *padapter) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+} -+ -+static void update_bcn_wps_ie(_adapter *padapter) -+{ -+ u8 *pwps_ie=NULL, *pwps_ie_src, *premainder_ie, *pbackup_remainder_ie=NULL; -+ uint wps_ielen=0, wps_offset, remainder_ielen; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ unsigned char *ie = pnetwork->IEs; -+ u32 ielen = pnetwork->IELength; -+ -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ pwps_ie = rtw_get_wps_ie(ie+_FIXED_IE_LENGTH_, ielen-_FIXED_IE_LENGTH_, NULL, &wps_ielen); -+ -+ if(pwps_ie==NULL || wps_ielen==0) -+ return; -+ -+ wps_offset = (uint)(pwps_ie-ie); -+ -+ premainder_ie = pwps_ie + wps_ielen; -+ -+ remainder_ielen = ielen - wps_offset - wps_ielen; -+ -+ if(remainder_ielen>0) -+ { -+ pbackup_remainder_ie = rtw_malloc(remainder_ielen); -+ if(pbackup_remainder_ie) -+ _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); -+ } -+ -+ -+ pwps_ie_src = pmlmepriv->wps_beacon_ie; -+ if(pwps_ie_src == NULL) -+ return; -+ -+ -+ wps_ielen = (uint)pwps_ie_src[1];//to get ie data len -+ if((wps_offset+wps_ielen+2+remainder_ielen)<=MAX_IE_SZ) -+ { -+ _rtw_memcpy(pwps_ie, pwps_ie_src, wps_ielen+2); -+ pwps_ie += (wps_ielen+2); -+ -+ if(pbackup_remainder_ie) -+ _rtw_memcpy(pwps_ie, pbackup_remainder_ie, remainder_ielen); -+ -+ //update IELength -+ pnetwork->IELength = wps_offset + (wps_ielen+2) + remainder_ielen; -+ } -+ -+ if(pbackup_remainder_ie) -+ rtw_mfree(pbackup_remainder_ie, remainder_ielen); -+ -+} -+ -+static void update_bcn_p2p_ie(_adapter *padapter) -+{ -+ -+} -+ -+static void update_bcn_vendor_spec_ie(_adapter *padapter, u8*oui) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ if(_rtw_memcmp(RTW_WPA_OUI, oui, 4)) -+ { -+ update_bcn_wpa_ie(padapter); -+ } -+ else if(_rtw_memcmp(WMM_OUI, oui, 4)) -+ { -+ update_bcn_wmm_ie(padapter); -+ } -+ else if(_rtw_memcmp(WPS_OUI, oui, 4)) -+ { -+ update_bcn_wps_ie(padapter); -+ } -+ else if(_rtw_memcmp(P2P_OUI, oui, 4)) -+ { -+ update_bcn_p2p_ie(padapter); -+ } -+ else -+ { -+ DBG_871X("unknown OUI type!\n"); -+ } -+ -+ -+} -+ -+void update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv; -+ struct mlme_ext_priv *pmlmeext; -+ //struct mlme_ext_info *pmlmeinfo; -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ if(!padapter) -+ return; -+ -+ pmlmepriv = &(padapter->mlmepriv); -+ pmlmeext = &(padapter->mlmeextpriv); -+ //pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if(false == pmlmeext->bstart_bss) -+ return; -+ -+ _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+ -+ switch(ie_id) -+ { -+ case 0xFF: -+ -+ update_bcn_fixed_ie(padapter);//8: TimeStamp, 2: Beacon Interval 2:Capability -+ -+ break; -+ -+ case _TIM_IE_: -+ -+ update_BCNTIM(padapter); -+ -+ break; -+ -+ case _ERPINFO_IE_: -+ -+ update_bcn_erpinfo_ie(padapter); -+ -+ break; -+ -+ case _HT_CAPABILITY_IE_: -+ -+ update_bcn_htcap_ie(padapter); -+ -+ break; -+ -+ case _RSN_IE_2_: -+ -+ update_bcn_rsn_ie(padapter); -+ -+ break; -+ -+ case _HT_ADD_INFO_IE_: -+ -+ update_bcn_htinfo_ie(padapter); -+ -+ break; -+ -+ case _VENDOR_SPECIFIC_IE_: -+ -+ update_bcn_vendor_spec_ie(padapter, oui); -+ -+ break; -+ -+ default: -+ break; -+ } -+ -+ pmlmepriv->update_bcn = true; -+ -+ _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+ -+#ifndef CONFIG_INTERRUPT_BASED_TXBCN -+ if(tx) -+ set_tx_beacon_cmd(padapter); -+#endif //!CONFIG_INTERRUPT_BASED_TXBCN -+ -+} -+ -+#ifdef CONFIG_80211N_HT -+ -+/* -+op_mode -+Set to 0 (HT pure) under the followign conditions -+ - all STAs in the BSS are 20/40 MHz HT in 20/40 MHz BSS or -+ - all STAs in the BSS are 20 MHz HT in 20 MHz BSS -+Set to 1 (HT non-member protection) if there may be non-HT STAs -+ in both the primary and the secondary channel -+Set to 2 if only HT STAs are associated in BSS, -+ however and at least one 20 MHz HT STA is associated -+Set to 3 (HT mixed mode) when one or more non-HT STAs are associated -+ (currently non-GF HT station is considered as non-HT STA also) -+*/ -+static int rtw_ht_operation_update(_adapter *padapter) -+{ -+ u16 cur_op_mode, new_op_mode; -+ int op_mode_changes = 0; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; -+ -+ if(pmlmepriv->htpriv.ht_option == true) -+ return 0; -+ -+ //if (!iface->conf->ieee80211n || iface->conf->ht_op_mode_fixed) -+ // return 0; -+ -+ DBG_871X("%s current operation mode=0x%X\n", -+ __FUNCTION__, pmlmepriv->ht_op_mode); -+ -+ if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) -+ && pmlmepriv->num_sta_ht_no_gf) { -+ pmlmepriv->ht_op_mode |= -+ HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT; -+ op_mode_changes++; -+ } else if ((pmlmepriv->ht_op_mode & -+ HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) && -+ pmlmepriv->num_sta_ht_no_gf == 0) { -+ pmlmepriv->ht_op_mode &= -+ ~HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT; -+ op_mode_changes++; -+ } -+ -+ if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) && -+ (pmlmepriv->num_sta_no_ht || pmlmepriv->olbc_ht)) { -+ pmlmepriv->ht_op_mode |= HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT; -+ op_mode_changes++; -+ } else if ((pmlmepriv->ht_op_mode & -+ HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) && -+ (pmlmepriv->num_sta_no_ht == 0 && !pmlmepriv->olbc_ht)) { -+ pmlmepriv->ht_op_mode &= -+ ~HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT; -+ op_mode_changes++; -+ } -+ -+ /* Note: currently we switch to the MIXED op mode if HT non-greenfield -+ * station is associated. Probably it's a theoretical case, since -+ * it looks like all known HT STAs support greenfield. -+ */ -+ new_op_mode = 0; -+ if (pmlmepriv->num_sta_no_ht || -+ (pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT)) -+ new_op_mode = OP_MODE_MIXED; -+ else if ((phtpriv_ap->ht_cap.cap_info & IEEE80211_HT_CAP_SUP_WIDTH) -+ && pmlmepriv->num_sta_ht_20mhz) -+ new_op_mode = OP_MODE_20MHZ_HT_STA_ASSOCED; -+ else if (pmlmepriv->olbc_ht) -+ new_op_mode = OP_MODE_MAY_BE_LEGACY_STAS; -+ else -+ new_op_mode = OP_MODE_PURE; -+ -+ cur_op_mode = pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_OP_MODE_MASK; -+ if (cur_op_mode != new_op_mode) { -+ pmlmepriv->ht_op_mode &= ~HT_INFO_OPERATION_MODE_OP_MODE_MASK; -+ pmlmepriv->ht_op_mode |= new_op_mode; -+ op_mode_changes++; -+ } -+ -+ DBG_871X("%s new operation mode=0x%X changes=%d\n", -+ __FUNCTION__, pmlmepriv->ht_op_mode, op_mode_changes); -+ -+ return op_mode_changes; -+ -+} -+ -+#endif /* CONFIG_80211N_HT */ -+ -+void associated_clients_update(_adapter *padapter, u8 updated) -+{ -+ //update associcated stations cap. -+ if(updated == true) -+ { -+ _irqL irqL; -+ _list *phead, *plist; -+ struct sta_info *psta=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ //check asoc_queue -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ VCS_update(padapter, psta); -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ } -+ -+} -+ -+/* called > TSR LEVEL for USB or SDIO Interface*/ -+void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) -+{ -+ u8 beacon_updated = false; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ -+#if 0 -+ if (!(psta->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) && -+ !psta->no_short_preamble_set) { -+ psta->no_short_preamble_set = 1; -+ pmlmepriv->num_sta_no_short_preamble++; -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_preamble == 1)) -+ ieee802_11_set_beacons(hapd->iface); -+ } -+#endif -+ -+ -+ if(!(psta->flags & WLAN_STA_SHORT_PREAMBLE)) -+ { -+ if(!psta->no_short_preamble_set) -+ { -+ psta->no_short_preamble_set = 1; -+ -+ pmlmepriv->num_sta_no_short_preamble++; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_preamble == 1)) -+ { -+ beacon_updated = true; -+ update_beacon(padapter, 0xFF, NULL, true); -+ } -+ -+ } -+ } -+ else -+ { -+ if(psta->no_short_preamble_set) -+ { -+ psta->no_short_preamble_set = 0; -+ -+ pmlmepriv->num_sta_no_short_preamble--; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_preamble == 0)) -+ { -+ beacon_updated = true; -+ update_beacon(padapter, 0xFF, NULL, true); -+ } -+ -+ } -+ } -+ -+#if 0 -+ if (psta->flags & WLAN_STA_NONERP && !psta->nonerp_set) { -+ psta->nonerp_set = 1; -+ pmlmepriv->num_sta_non_erp++; -+ if (pmlmepriv->num_sta_non_erp == 1) -+ ieee802_11_set_beacons(hapd->iface); -+ } -+#endif -+ -+ if(psta->flags & WLAN_STA_NONERP) -+ { -+ if(!psta->nonerp_set) -+ { -+ psta->nonerp_set = 1; -+ -+ pmlmepriv->num_sta_non_erp++; -+ -+ if (pmlmepriv->num_sta_non_erp == 1) -+ { -+ beacon_updated = true; -+ update_beacon(padapter, _ERPINFO_IE_, NULL, true); -+ } -+ } -+ -+ } -+ else -+ { -+ if(psta->nonerp_set) -+ { -+ psta->nonerp_set = 0; -+ -+ pmlmepriv->num_sta_non_erp--; -+ -+ if (pmlmepriv->num_sta_non_erp == 0) -+ { -+ beacon_updated = true; -+ update_beacon(padapter, _ERPINFO_IE_, NULL, true); -+ } -+ } -+ -+ } -+ -+ -+#if 0 -+ if (!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT) && -+ !psta->no_short_slot_time_set) { -+ psta->no_short_slot_time_set = 1; -+ pmlmepriv->num_sta_no_short_slot_time++; -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_slot_time == 1)) -+ ieee802_11_set_beacons(hapd->iface); -+ } -+#endif -+ -+ if(!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT)) -+ { -+ if(!psta->no_short_slot_time_set) -+ { -+ psta->no_short_slot_time_set = 1; -+ -+ pmlmepriv->num_sta_no_short_slot_time++; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_slot_time == 1)) -+ { -+ beacon_updated = true; -+ update_beacon(padapter, 0xFF, NULL, true); -+ } -+ -+ } -+ } -+ else -+ { -+ if(psta->no_short_slot_time_set) -+ { -+ psta->no_short_slot_time_set = 0; -+ -+ pmlmepriv->num_sta_no_short_slot_time--; -+ -+ if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && -+ (pmlmepriv->num_sta_no_short_slot_time == 0)) -+ { -+ beacon_updated = true; -+ update_beacon(padapter, 0xFF, NULL, true); -+ } -+ } -+ } -+ -+#ifdef CONFIG_80211N_HT -+ -+ if (psta->flags & WLAN_STA_HT) -+ { -+ u16 ht_capab = le16_to_cpu(psta->htpriv.ht_cap.cap_info); -+ -+ DBG_871X("HT: STA " MAC_FMT " HT Capabilities " -+ "Info: 0x%04x\n", MAC_ARG(psta->hwaddr), ht_capab); -+ -+ if (psta->no_ht_set) { -+ psta->no_ht_set = 0; -+ pmlmepriv->num_sta_no_ht--; -+ } -+ -+ if ((ht_capab & IEEE80211_HT_CAP_GRN_FLD) == 0) { -+ if (!psta->no_ht_gf_set) { -+ psta->no_ht_gf_set = 1; -+ pmlmepriv->num_sta_ht_no_gf++; -+ } -+ DBG_871X("%s STA " MAC_FMT " - no " -+ "greenfield, num of non-gf stations %d\n", -+ __FUNCTION__, MAC_ARG(psta->hwaddr), -+ pmlmepriv->num_sta_ht_no_gf); -+ } -+ -+ if ((ht_capab & IEEE80211_HT_CAP_SUP_WIDTH) == 0) { -+ if (!psta->ht_20mhz_set) { -+ psta->ht_20mhz_set = 1; -+ pmlmepriv->num_sta_ht_20mhz++; -+ } -+ DBG_871X("%s STA " MAC_FMT " - 20 MHz HT, " -+ "num of 20MHz HT STAs %d\n", -+ __FUNCTION__, MAC_ARG(psta->hwaddr), -+ pmlmepriv->num_sta_ht_20mhz); -+ } -+ -+ } -+ else -+ { -+ if (!psta->no_ht_set) { -+ psta->no_ht_set = 1; -+ pmlmepriv->num_sta_no_ht++; -+ } -+ if(pmlmepriv->htpriv.ht_option == true) { -+ DBG_871X("%s STA " MAC_FMT -+ " - no HT, num of non-HT stations %d\n", -+ __FUNCTION__, MAC_ARG(psta->hwaddr), -+ pmlmepriv->num_sta_no_ht); -+ } -+ } -+ -+ if (rtw_ht_operation_update(padapter) > 0) -+ { -+ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, false); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, true); -+ } -+ -+#endif /* CONFIG_80211N_HT */ -+ -+ //update associcated stations cap. -+ associated_clients_update(padapter, beacon_updated); -+ -+ DBG_871X("%s, updated=%d\n", __func__, beacon_updated); -+ -+} -+ -+u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta) -+{ -+ u8 beacon_updated = false; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ if(!psta) -+ return beacon_updated; -+ -+ if (psta->no_short_preamble_set) { -+ psta->no_short_preamble_set = 0; -+ pmlmepriv->num_sta_no_short_preamble--; -+ if (pmlmeext->cur_wireless_mode > WIRELESS_11B -+ && pmlmepriv->num_sta_no_short_preamble == 0) -+ { -+ beacon_updated = true; -+ update_beacon(padapter, 0xFF, NULL, true); -+ } -+ } -+ -+ if (psta->nonerp_set) { -+ psta->nonerp_set = 0; -+ pmlmepriv->num_sta_non_erp--; -+ if (pmlmepriv->num_sta_non_erp == 0) -+ { -+ beacon_updated = true; -+ update_beacon(padapter, _ERPINFO_IE_, NULL, true); -+ } -+ } -+ -+ if (psta->no_short_slot_time_set) { -+ psta->no_short_slot_time_set = 0; -+ pmlmepriv->num_sta_no_short_slot_time--; -+ if (pmlmeext->cur_wireless_mode > WIRELESS_11B -+ && pmlmepriv->num_sta_no_short_slot_time == 0) -+ { -+ beacon_updated = true; -+ update_beacon(padapter, 0xFF, NULL, true); -+ } -+ } -+ -+#ifdef CONFIG_80211N_HT -+ -+ if (psta->no_ht_gf_set) { -+ psta->no_ht_gf_set = 0; -+ pmlmepriv->num_sta_ht_no_gf--; -+ } -+ -+ if (psta->no_ht_set) { -+ psta->no_ht_set = 0; -+ pmlmepriv->num_sta_no_ht--; -+ } -+ -+ if (psta->ht_20mhz_set) { -+ psta->ht_20mhz_set = 0; -+ pmlmepriv->num_sta_ht_20mhz--; -+ } -+ -+ if (rtw_ht_operation_update(padapter) > 0) -+ { -+ update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, false); -+ update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, true); -+ } -+ -+#endif /* CONFIG_80211N_HT */ -+ -+ //update associcated stations cap. -+ //associated_clients_update(padapter, beacon_updated); //move it to avoid deadlock -+ -+ DBG_871X("%s, updated=%d\n", __func__, beacon_updated); -+ -+ return beacon_updated; -+ -+} -+ -+u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reason) -+{ -+ _irqL irqL; -+ u8 beacon_updated = false; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ if(!psta) -+ return beacon_updated; -+ -+ if (active == true) -+ { -+#ifdef CONFIG_80211N_HT -+ //tear down Rx AMPDU -+ send_delba(padapter, 0, psta->hwaddr);// recipient -+ -+ //tear down TX AMPDU -+ send_delba(padapter, 1, psta->hwaddr);// // originator -+ -+#endif //CONFIG_80211N_HT -+ -+ issue_deauth(padapter, psta->hwaddr, reason); -+ } -+ -+ psta->htpriv.agg_enable_bitmap = 0x0;//reset -+ psta->htpriv.candidate_tid_bitmap = 0x0;//reset -+ -+ -+ //report_del_sta_event(padapter, psta->hwaddr, reason); -+ -+ //clear cam entry / key -+ //clear_cam_entry(padapter, (psta->mac_id + 3)); -+ rtw_clearstakey_cmd(padapter, (u8*)psta, (u8)rtw_get_camid(psta->mac_id), true); -+ -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state &= ~_FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ #ifdef CONFIG_IOCTL_CFG80211 -+ if (1) { -+ #ifdef COMPAT_KERNEL_RELEASE -+ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); -+ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); -+ #else //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ /* will call rtw_cfg80211_indicate_sta_disassoc() in cmd_thread for old API context */ -+ #endif //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ } else -+ #endif //CONFIG_IOCTL_CFG80211 -+ { -+ rtw_indicate_sta_disassoc_event(padapter, psta); -+ } -+ -+ report_del_sta_event(padapter, psta->hwaddr, reason); -+ -+ beacon_updated = bss_cap_update_on_sta_leave(padapter, psta); -+ -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(padapter, psta); -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ -+ return beacon_updated; -+ -+} -+ -+int rtw_ap_inform_ch_switch(_adapter *padapter, u8 new_ch, u8 ch_offset) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ int ret=0; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ -+ if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ return ret; -+ -+ DBG_871X(FUNC_NDEV_FMT" with ch:%u, offset:%u\n", -+ FUNC_NDEV_ARG(padapter->pnetdev), new_ch, ch_offset); -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ /* for each sta in asoc_queue */ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ issue_action_spct_ch_switch(padapter, psta->hwaddr, new_ch, ch_offset); -+ psta->expire_to = ((pstapriv->expire_to * 2) > 5) ? 5 : (pstapriv->expire_to * 2); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ issue_action_spct_ch_switch(padapter, bc_addr, new_ch, ch_offset); -+ -+ return ret; -+} -+ -+int rtw_sta_flush(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ int ret=0; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); -+ -+ if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ return ret; -+ -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ //free sta asoc_queue -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ -+ //_exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ ap_free_sta(padapter, psta, true, WLAN_REASON_DEAUTH_LEAVING); -+ //_enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ -+ issue_deauth(padapter, bc_addr, WLAN_REASON_DEAUTH_LEAVING); -+ -+ associated_clients_update(padapter, true); -+ -+ return ret; -+ -+} -+ -+/* called > TSR LEVEL for USB or SDIO Interface*/ -+void sta_info_update(_adapter *padapter, struct sta_info *psta) -+{ -+ int flags = psta->flags; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ -+ //update wmm cap. -+ if(WLAN_STA_WME&flags) -+ psta->qos_option = 1; -+ else -+ psta->qos_option = 0; -+ -+ if(pmlmepriv->qospriv.qos_option == 0) -+ psta->qos_option = 0; -+ -+ -+#ifdef CONFIG_80211N_HT -+ //update 802.11n ht cap. -+ if(WLAN_STA_HT&flags) -+ { -+ psta->htpriv.ht_option = true; -+ psta->qos_option = 1; -+ } -+ else -+ { -+ psta->htpriv.ht_option = false; -+ } -+ -+ if(pmlmepriv->htpriv.ht_option == false) -+ psta->htpriv.ht_option = false; -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ //update 802.11AC vht cap. -+ if(WLAN_STA_VHT&flags) -+ { -+ psta->vhtpriv.vht_option = true; -+ } -+ else -+ { -+ psta->vhtpriv.vht_option = false; -+ } -+ -+ if(pmlmepriv->vhtpriv.vht_option == false) -+ psta->vhtpriv.vht_option = false; -+#endif -+ -+ -+ update_sta_info_apmode(padapter, psta); -+ -+ -+} -+ -+/* called >= TSR LEVEL for USB or SDIO Interface*/ -+void ap_sta_info_defer_update(_adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if(psta->state & _FW_LINKED) -+ { -+ pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; -+ -+ //add ratid -+ add_RATid(padapter, psta, 0);//DM_RATR_STA_INIT -+ } -+} -+ -+/* restore hw setting from sw data structures */ -+void rtw_ap_restore_network(_adapter *padapter) -+{ -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv * pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ _irqL irqL; -+ _list *phead, *plist; -+ u8 chk_alive_num = 0; -+ char chk_alive_list[NUM_STA]; -+ int i; -+ -+ rtw_setopmode_cmd(padapter, Ndis802_11APMode); -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ start_bss_network(padapter, (u8*)&mlmepriv->cur_network.network); -+ -+ if((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) -+ { -+ /* restore group key, WEP keys is restored in ips_leave() */ -+ rtw_set_key(padapter, psecuritypriv, psecuritypriv->dot118021XGrpKeyid, 0); -+ } -+ -+ /* per sta pairwise key and settings */ -+ if((padapter->securitypriv.dot11PrivacyAlgrthm != _TKIP_) && -+ (padapter->securitypriv.dot11PrivacyAlgrthm != _AES_)) { -+ return; -+ } -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) { -+ int stainfo_offset; -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) { -+ chk_alive_list[chk_alive_num++] = stainfo_offset; -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ for (i = 0; i < chk_alive_num; i++) { -+ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); -+ -+ if (psta == NULL) { -+ DBG_871X(FUNC_ADPT_FMT" sta_info is null\n", FUNC_ADPT_ARG(padapter)); -+ } else if (psta->state &_FW_LINKED) { -+ Update_RA_Entry(padapter, psta); -+ //pairwise key -+ rtw_setstakey_cmd(padapter, (unsigned char *)psta, true); -+ } -+ } -+ -+} -+ -+void start_ap_mode(_adapter *padapter) -+{ -+ int i; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ -+ pmlmepriv->update_bcn = false; -+ -+ //init_mlme_ap_info(padapter); -+ pmlmeext->bstart_bss = false; -+ -+ pmlmepriv->num_sta_non_erp = 0; -+ -+ pmlmepriv->num_sta_no_short_slot_time = 0; -+ -+ pmlmepriv->num_sta_no_short_preamble = 0; -+ -+ pmlmepriv->num_sta_ht_no_gf = 0; -+#ifdef CONFIG_80211N_HT -+ pmlmepriv->num_sta_no_ht = 0; -+#endif //CONFIG_80211N_HT -+ pmlmepriv->num_sta_ht_20mhz = 0; -+ -+ pmlmepriv->olbc = false; -+ -+ pmlmepriv->olbc_ht = false; -+ -+#ifdef CONFIG_80211N_HT -+ pmlmepriv->ht_op_mode = 0; -+#endif -+ -+ for(i=0; ista_aid[i] = NULL; -+ -+ pmlmepriv->wps_beacon_ie = NULL; -+ pmlmepriv->wps_probe_resp_ie = NULL; -+ pmlmepriv->wps_assoc_resp_ie = NULL; -+ -+ pmlmepriv->p2p_beacon_ie = NULL; -+ pmlmepriv->p2p_probe_resp_ie = NULL; -+ -+ -+ //for ACL -+ _rtw_init_listhead(&(pacl_list->acl_node_q.queue)); -+ pacl_list->num = 0; -+ pacl_list->mode = 0; -+ for(i = 0; i < NUM_ACL; i++) -+ { -+ _rtw_init_listhead(&pacl_list->aclnode[i].list); -+ pacl_list->aclnode[i].valid = false; -+ } -+ -+} -+ -+void stop_ap_mode(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ struct rtw_wlan_acl_node *paclnode; -+ struct sta_info *psta=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ _queue *pacl_node_q =&pacl_list->acl_node_q; -+ -+ pmlmepriv->update_bcn = false; -+ pmlmeext->bstart_bss = false; -+ //_rtw_spinlock_free(&pmlmepriv->bcn_update_lock); -+ -+ //reset and init security priv , this can refine with rtw_reset_securitypriv -+ _rtw_memset((unsigned char *)&padapter->securitypriv, 0, sizeof (struct security_priv)); -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; -+ -+ //for ACL -+ _enter_critical_bh(&(pacl_node_q->lock), &irqL); -+ phead = get_list_head(pacl_node_q); -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); -+ plist = get_next(plist); -+ -+ if(paclnode->valid == true) -+ { -+ paclnode->valid = false; -+ -+ rtw_list_delete(&paclnode->list); -+ -+ pacl_list->num--; -+ } -+ } -+ _exit_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ DBG_871X("%s, free acl_node_queue, num=%d\n", __func__, pacl_list->num); -+ -+ rtw_sta_flush(padapter); -+ -+ //free_assoc_sta_resources -+ rtw_free_all_stainfo(padapter); -+ -+ psta = rtw_get_bcmc_stainfo(padapter); -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(padapter, psta); -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ rtw_init_bcmc_stainfo(padapter); -+ -+ rtw_free_mlme_priv_ie_data(pmlmepriv); -+ -+} -+ -+#endif //CONFIG_NATIVEAP_MLME -+#endif //CONFIG_AP_MODE -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_br_ext.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_br_ext.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_br_ext.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_br_ext.c 2018-02-06 17:42:30.693966912 +0200 -@@ -0,0 +1,1693 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_BR_EXT_C_ -+ -+#ifdef __KERNEL__ -+#include -+#include -+#include -+#include -+#include -+#include -+#endif -+ -+#if 1 // rtw_wifi_driver -+#include -+#else // rtw_wifi_driver -+#include "./8192cd_cfg.h" -+ -+#ifndef __KERNEL__ -+#include "./sys-support.h" -+#endif -+ -+#include "./8192cd.h" -+#include "./8192cd_headers.h" -+#include "./8192cd_br_ext.h" -+#include "./8192cd_debug.h" -+#endif // rtw_wifi_driver -+ -+#ifdef CL_IPV6_PASS -+#ifdef __KERNEL__ -+#include -+#include -+#include -+#include -+#include -+#endif -+#endif -+ -+#ifdef CONFIG_BR_EXT -+ -+//#define BR_EXT_DEBUG -+ -+#define NAT25_IPV4 01 -+#define NAT25_IPV6 02 -+#define NAT25_IPX 03 -+#define NAT25_APPLE 04 -+#define NAT25_PPPOE 05 -+ -+#define RTL_RELAY_TAG_LEN (ETH_ALEN) -+#define TAG_HDR_LEN 4 -+ -+#define MAGIC_CODE 0x8186 -+#define MAGIC_CODE_LEN 2 -+#define WAIT_TIME_PPPOE 5 // waiting time for pppoe server in sec -+ -+/*----------------------------------------------------------------- -+ How database records network address: -+ 0 1 2 3 4 5 6 7 8 9 10 -+ |----|----|----|----|----|----|----|----|----|----|----| -+ IPv4 |type| | IP addr | -+ IPX |type| Net addr | Node addr | -+ IPX |type| Net addr |Sckt addr| -+ Apple |type| Network |node| -+ PPPoE |type| SID | AC MAC | -+-----------------------------------------------------------------*/ -+ -+ -+//Find a tag in pppoe frame and return the pointer -+static __inline__ unsigned char *__nat25_find_pppoe_tag(struct pppoe_hdr *ph, unsigned short type) -+{ -+ unsigned char *cur_ptr, *start_ptr; -+ unsigned short tagLen, tagType; -+ -+ start_ptr = cur_ptr = (unsigned char *)ph->tag; -+ while((cur_ptr - start_ptr) < ntohs(ph->length)) { -+ // prevent un-alignment access -+ tagType = (unsigned short)((cur_ptr[0] << 8) + cur_ptr[1]); -+ tagLen = (unsigned short)((cur_ptr[2] << 8) + cur_ptr[3]); -+ if(tagType == type) -+ return cur_ptr; -+ cur_ptr = cur_ptr + TAG_HDR_LEN + tagLen; -+ } -+ return 0; -+} -+ -+ -+static __inline__ int __nat25_add_pppoe_tag(struct sk_buff *skb, struct pppoe_tag *tag) -+{ -+ struct pppoe_hdr *ph = (struct pppoe_hdr *)(skb->data + ETH_HLEN); -+ int data_len; -+ -+ data_len = tag->tag_len + TAG_HDR_LEN; -+ if (skb_tailroom(skb) < data_len) { -+ _DEBUG_ERR("skb_tailroom() failed in add SID tag!\n"); -+ return -1; -+ } -+ -+ skb_put(skb, data_len); -+ // have a room for new tag -+ memmove(((unsigned char *)ph->tag + data_len), (unsigned char *)ph->tag, ntohs(ph->length)); -+ ph->length = htons(ntohs(ph->length) + data_len); -+ memcpy((unsigned char *)ph->tag, tag, data_len); -+ return data_len; -+} -+ -+static int skb_pull_and_merge(struct sk_buff *skb, unsigned char *src, int len) -+{ -+ int tail_len; -+ unsigned long end, tail; -+ -+ if ((src+len) > skb_tail_pointer(skb) || skb->len < len) -+ return -1; -+ -+ tail = (unsigned long)skb_tail_pointer(skb); -+ end = (unsigned long)src+len; -+ if (tail < end) -+ return -1; -+ -+ tail_len = (int)(tail-end); -+ if (tail_len > 0) -+ memmove(src, src+len, tail_len); -+ -+ skb_trim(skb, skb->len-len); -+ return 0; -+} -+ -+static __inline__ unsigned long __nat25_timeout(_adapter *priv) -+{ -+ unsigned long timeout; -+ -+ timeout = jiffies - NAT25_AGEING_TIME*HZ; -+ -+ return timeout; -+} -+ -+ -+static __inline__ int __nat25_has_expired(_adapter *priv, -+ struct nat25_network_db_entry *fdb) -+{ -+ if(time_before_eq(fdb->ageing_timer, __nat25_timeout(priv))) -+ return 1; -+ -+ return 0; -+} -+ -+ -+static __inline__ void __nat25_generate_ipv4_network_addr(unsigned char *networkAddr, -+ unsigned int *ipAddr) -+{ -+ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); -+ -+ networkAddr[0] = NAT25_IPV4; -+ memcpy(networkAddr+7, (unsigned char *)ipAddr, 4); -+} -+ -+ -+static __inline__ void __nat25_generate_ipx_network_addr_with_node(unsigned char *networkAddr, -+ unsigned int *ipxNetAddr, unsigned char *ipxNodeAddr) -+{ -+ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); -+ -+ networkAddr[0] = NAT25_IPX; -+ memcpy(networkAddr+1, (unsigned char *)ipxNetAddr, 4); -+ memcpy(networkAddr+5, ipxNodeAddr, 6); -+} -+ -+ -+static __inline__ void __nat25_generate_ipx_network_addr_with_socket(unsigned char *networkAddr, -+ unsigned int *ipxNetAddr, unsigned short *ipxSocketAddr) -+{ -+ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); -+ -+ networkAddr[0] = NAT25_IPX; -+ memcpy(networkAddr+1, (unsigned char *)ipxNetAddr, 4); -+ memcpy(networkAddr+5, (unsigned char *)ipxSocketAddr, 2); -+} -+ -+ -+static __inline__ void __nat25_generate_apple_network_addr(unsigned char *networkAddr, -+ unsigned short *network, unsigned char *node) -+{ -+ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); -+ -+ networkAddr[0] = NAT25_APPLE; -+ memcpy(networkAddr+1, (unsigned char *)network, 2); -+ networkAddr[3] = *node; -+} -+ -+ -+static __inline__ void __nat25_generate_pppoe_network_addr(unsigned char *networkAddr, -+ unsigned char *ac_mac, unsigned short *sid) -+{ -+ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); -+ -+ networkAddr[0] = NAT25_PPPOE; -+ memcpy(networkAddr+1, (unsigned char *)sid, 2); -+ memcpy(networkAddr+3, (unsigned char *)ac_mac, 6); -+} -+ -+ -+#ifdef CL_IPV6_PASS -+static void __nat25_generate_ipv6_network_addr(unsigned char *networkAddr, -+ unsigned int *ipAddr) -+{ -+ memset(networkAddr, 0, MAX_NETWORK_ADDR_LEN); -+ -+ networkAddr[0] = NAT25_IPV6; -+ memcpy(networkAddr+1, (unsigned char *)ipAddr, 16); -+} -+ -+ -+static unsigned char *scan_tlv(unsigned char *data, int len, unsigned char tag, unsigned char len8b) -+{ -+ while (len > 0) { -+ if (*data == tag && *(data+1) == len8b && len >= len8b*8) -+ return data+2; -+ -+ len -= (*(data+1))*8; -+ data += (*(data+1))*8; -+ } -+ return NULL; -+} -+ -+ -+static int update_nd_link_layer_addr(unsigned char *data, int len, unsigned char *replace_mac) -+{ -+ struct icmp6hdr *icmphdr = (struct icmp6hdr *)data; -+ unsigned char *mac; -+ -+ if (icmphdr->icmp6_type == NDISC_ROUTER_SOLICITATION) { -+ if (len >= 8) { -+ mac = scan_tlv(&data[8], len-8, 1, 1); -+ if (mac) { -+ _DEBUG_INFO("Router Solicitation, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], -+ replace_mac[0],replace_mac[1],replace_mac[2],replace_mac[3],replace_mac[4],replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; -+ } -+ } -+ } -+ else if (icmphdr->icmp6_type == NDISC_ROUTER_ADVERTISEMENT) { -+ if (len >= 16) { -+ mac = scan_tlv(&data[16], len-16, 1, 1); -+ if (mac) { -+ _DEBUG_INFO("Router Advertisement, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], -+ replace_mac[0],replace_mac[1],replace_mac[2],replace_mac[3],replace_mac[4],replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; -+ } -+ } -+ } -+ else if (icmphdr->icmp6_type == NDISC_NEIGHBOUR_SOLICITATION) { -+ if (len >= 24) { -+ mac = scan_tlv(&data[24], len-24, 1, 1); -+ if (mac) { -+ _DEBUG_INFO("Neighbor Solicitation, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], -+ replace_mac[0],replace_mac[1],replace_mac[2],replace_mac[3],replace_mac[4],replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; -+ } -+ } -+ } -+ else if (icmphdr->icmp6_type == NDISC_NEIGHBOUR_ADVERTISEMENT) { -+ if (len >= 24) { -+ mac = scan_tlv(&data[24], len-24, 2, 1); -+ if (mac) { -+ _DEBUG_INFO("Neighbor Advertisement, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], -+ replace_mac[0],replace_mac[1],replace_mac[2],replace_mac[3],replace_mac[4],replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; -+ } -+ } -+ } -+ else if (icmphdr->icmp6_type == NDISC_REDIRECT) { -+ if (len >= 40) { -+ mac = scan_tlv(&data[40], len-40, 2, 1); -+ if (mac) { -+ _DEBUG_INFO("Redirect, replace MAC From: %02x:%02x:%02x:%02x:%02x:%02x, To: %02x:%02x:%02x:%02x:%02x:%02x\n", -+ mac[0],mac[1],mac[2],mac[3],mac[4],mac[5], -+ replace_mac[0],replace_mac[1],replace_mac[2],replace_mac[3],replace_mac[4],replace_mac[5]); -+ memcpy(mac, replace_mac, 6); -+ return 1; -+ } -+ } -+ } -+ return 0; -+} -+ -+ -+static void convert_ipv6_mac_to_mc(struct sk_buff *skb) -+{ -+ struct ipv6hdr *iph = (struct ipv6hdr *)(skb->data + ETH_HLEN); -+ unsigned char *dst_mac = skb->data; -+ -+ //dst_mac[0] = 0xff; -+ //dst_mac[1] = 0xff; -+ /*modified by qinjunjie,ipv6 multicast address ix 0x33-33-xx-xx-xx-xx*/ -+ dst_mac[0] = 0x33; -+ dst_mac[1] = 0x33; -+ memcpy(&dst_mac[2], &iph->daddr.s6_addr32[3], 4); -+ #if defined(__LINUX_2_6__) -+ /*modified by qinjunjie,warning:should not remove next line*/ -+ skb->pkt_type = PACKET_MULTICAST; -+ #endif -+} -+#endif /* CL_IPV6_PASS */ -+ -+ -+static __inline__ int __nat25_network_hash(unsigned char *networkAddr) -+{ -+ if(networkAddr[0] == NAT25_IPV4) -+ { -+ unsigned long x; -+ -+ x = networkAddr[7] ^ networkAddr[8] ^ networkAddr[9] ^ networkAddr[10]; -+ -+ return x & (NAT25_HASH_SIZE - 1); -+ } -+ else if(networkAddr[0] == NAT25_IPX) -+ { -+ unsigned long x; -+ -+ x = networkAddr[1] ^ networkAddr[2] ^ networkAddr[3] ^ networkAddr[4] ^ networkAddr[5] ^ -+ networkAddr[6] ^ networkAddr[7] ^ networkAddr[8] ^ networkAddr[9] ^ networkAddr[10]; -+ -+ return x & (NAT25_HASH_SIZE - 1); -+ } -+ else if(networkAddr[0] == NAT25_APPLE) -+ { -+ unsigned long x; -+ -+ x = networkAddr[1] ^ networkAddr[2] ^ networkAddr[3]; -+ -+ return x & (NAT25_HASH_SIZE - 1); -+ } -+ else if(networkAddr[0] == NAT25_PPPOE) -+ { -+ unsigned long x; -+ -+ x = networkAddr[0] ^ networkAddr[1] ^ networkAddr[2] ^ networkAddr[3] ^ networkAddr[4] ^ networkAddr[5] ^ networkAddr[6] ^ networkAddr[7] ^ networkAddr[8]; -+ -+ return x & (NAT25_HASH_SIZE - 1); -+ } -+#ifdef CL_IPV6_PASS -+ else if(networkAddr[0] == NAT25_IPV6) -+ { -+ unsigned long x; -+ -+ x = networkAddr[1] ^ networkAddr[2] ^ networkAddr[3] ^ networkAddr[4] ^ networkAddr[5] ^ -+ networkAddr[6] ^ networkAddr[7] ^ networkAddr[8] ^ networkAddr[9] ^ networkAddr[10] ^ -+ networkAddr[11] ^ networkAddr[12] ^ networkAddr[13] ^ networkAddr[14] ^ networkAddr[15] ^ -+ networkAddr[16]; -+ -+ return x & (NAT25_HASH_SIZE - 1); -+ } -+#endif -+ else -+ { -+ unsigned long x = 0; -+ int i; -+ -+ for (i=0; ibr_ext_lock, &irqL); -+ -+ ent->next_hash = priv->nethash[hash]; -+ if(ent->next_hash != NULL) -+ ent->next_hash->pprev_hash = &ent->next_hash; -+ priv->nethash[hash] = ent; -+ ent->pprev_hash = &priv->nethash[hash]; -+ -+ //_exit_critical_bh(&priv->br_ext_lock, &irqL); -+} -+ -+ -+static __inline__ void __network_hash_unlink(struct nat25_network_db_entry *ent) -+{ -+ // Caller must _enter_critical_bh already! -+ //_irqL irqL; -+ //_enter_critical_bh(&priv->br_ext_lock, &irqL); -+ -+ *(ent->pprev_hash) = ent->next_hash; -+ if(ent->next_hash != NULL) -+ ent->next_hash->pprev_hash = ent->pprev_hash; -+ ent->next_hash = NULL; -+ ent->pprev_hash = NULL; -+ -+ //_exit_critical_bh(&priv->br_ext_lock, &irqL); -+} -+ -+ -+static int __nat25_db_network_lookup_and_replace(_adapter *priv, -+ struct sk_buff *skb, unsigned char *networkAddr) -+{ -+ struct nat25_network_db_entry *db; -+ _irqL irqL; -+ _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ -+ db = priv->nethash[__nat25_network_hash(networkAddr)]; -+ while (db != NULL) -+ { -+ if(!memcmp(db->networkAddr, networkAddr, MAX_NETWORK_ADDR_LEN)) -+ { -+ if(!__nat25_has_expired(priv, db)) -+ { -+ // replace the destination mac address -+ memcpy(skb->data, db->macAddr, ETH_ALEN); -+ atomic_inc(&db->use_count); -+ -+#ifdef CL_IPV6_PASS -+ DEBUG_INFO("NAT25: Lookup M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" -+ "%02x%02x%02x%02x%02x%02x\n", -+ db->macAddr[0], -+ db->macAddr[1], -+ db->macAddr[2], -+ db->macAddr[3], -+ db->macAddr[4], -+ db->macAddr[5], -+ db->networkAddr[0], -+ db->networkAddr[1], -+ db->networkAddr[2], -+ db->networkAddr[3], -+ db->networkAddr[4], -+ db->networkAddr[5], -+ db->networkAddr[6], -+ db->networkAddr[7], -+ db->networkAddr[8], -+ db->networkAddr[9], -+ db->networkAddr[10], -+ db->networkAddr[11], -+ db->networkAddr[12], -+ db->networkAddr[13], -+ db->networkAddr[14], -+ db->networkAddr[15], -+ db->networkAddr[16]); -+#else -+ DEBUG_INFO("NAT25: Lookup M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", -+ db->macAddr[0], -+ db->macAddr[1], -+ db->macAddr[2], -+ db->macAddr[3], -+ db->macAddr[4], -+ db->macAddr[5], -+ db->networkAddr[0], -+ db->networkAddr[1], -+ db->networkAddr[2], -+ db->networkAddr[3], -+ db->networkAddr[4], -+ db->networkAddr[5], -+ db->networkAddr[6], -+ db->networkAddr[7], -+ db->networkAddr[8], -+ db->networkAddr[9], -+ db->networkAddr[10]); -+#endif -+ } -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ return 1; -+ } -+ -+ db = db->next_hash; -+ } -+ -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ return 0; -+} -+ -+ -+static void __nat25_db_network_insert(_adapter *priv, -+ unsigned char *macAddr, unsigned char *networkAddr) -+{ -+ struct nat25_network_db_entry *db; -+ int hash; -+ _irqL irqL; -+ _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ -+ hash = __nat25_network_hash(networkAddr); -+ db = priv->nethash[hash]; -+ while (db != NULL) -+ { -+ if(!memcmp(db->networkAddr, networkAddr, MAX_NETWORK_ADDR_LEN)) -+ { -+ memcpy(db->macAddr, macAddr, ETH_ALEN); -+ db->ageing_timer = jiffies; -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ return; -+ } -+ -+ db = db->next_hash; -+ } -+ -+ db = (struct nat25_network_db_entry *) rtw_malloc(sizeof(*db)); -+ if(db == NULL) { -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ return; -+ } -+ -+ memcpy(db->networkAddr, networkAddr, MAX_NETWORK_ADDR_LEN); -+ memcpy(db->macAddr, macAddr, ETH_ALEN); -+ atomic_set(&db->use_count, 1); -+ db->ageing_timer = jiffies; -+ -+ __network_hash_link(priv, db, hash); -+ -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+} -+ -+ -+static void __nat25_db_print(_adapter *priv) -+{ -+ _irqL irqL; -+ _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ -+#ifdef BR_EXT_DEBUG -+ static int counter = 0; -+ int i, j; -+ struct nat25_network_db_entry *db; -+ -+ counter++; -+ if((counter % 16) != 0) -+ return; -+ -+ for(i=0, j=0; inethash[i]; -+ -+ while (db != NULL) -+ { -+#ifdef CL_IPV6_PASS -+ panic_printk("NAT25: DB(%d) H(%02d) C(%d) M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" -+ "%02x%02x%02x%02x%02x%02x\n", -+ j, -+ i, -+ atomic_read(&db->use_count), -+ db->macAddr[0], -+ db->macAddr[1], -+ db->macAddr[2], -+ db->macAddr[3], -+ db->macAddr[4], -+ db->macAddr[5], -+ db->networkAddr[0], -+ db->networkAddr[1], -+ db->networkAddr[2], -+ db->networkAddr[3], -+ db->networkAddr[4], -+ db->networkAddr[5], -+ db->networkAddr[6], -+ db->networkAddr[7], -+ db->networkAddr[8], -+ db->networkAddr[9], -+ db->networkAddr[10], -+ db->networkAddr[11], -+ db->networkAddr[12], -+ db->networkAddr[13], -+ db->networkAddr[14], -+ db->networkAddr[15], -+ db->networkAddr[16]); -+#else -+ panic_printk("NAT25: DB(%d) H(%02d) C(%d) M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", -+ j, -+ i, -+ atomic_read(&db->use_count), -+ db->macAddr[0], -+ db->macAddr[1], -+ db->macAddr[2], -+ db->macAddr[3], -+ db->macAddr[4], -+ db->macAddr[5], -+ db->networkAddr[0], -+ db->networkAddr[1], -+ db->networkAddr[2], -+ db->networkAddr[3], -+ db->networkAddr[4], -+ db->networkAddr[5], -+ db->networkAddr[6], -+ db->networkAddr[7], -+ db->networkAddr[8], -+ db->networkAddr[9], -+ db->networkAddr[10]); -+#endif -+ j++; -+ -+ db = db->next_hash; -+ } -+ } -+#endif -+ -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+} -+ -+ -+ -+ -+/* -+ * NAT2.5 interface -+ */ -+ -+void nat25_db_cleanup(_adapter *priv) -+{ -+ int i; -+ _irqL irqL; -+ _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ -+ for(i=0; inethash[i]; -+ while (f != NULL) { -+ struct nat25_network_db_entry *g; -+ -+ g = f->next_hash; -+ if(priv->scdb_entry == f) -+ { -+ memset(priv->scdb_mac, 0, ETH_ALEN); -+ memset(priv->scdb_ip, 0, 4); -+ priv->scdb_entry = NULL; -+ } -+ __network_hash_unlink(f); -+ rtw_mfree((u8 *) f, sizeof(struct nat25_network_db_entry)); -+ -+ f = g; -+ } -+ } -+ -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+} -+ -+ -+void nat25_db_expire(_adapter *priv) -+{ -+ int i; -+ _irqL irqL; -+ _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ -+ //if(!priv->ethBrExtInfo.nat25_disable) -+ { -+ for (i=0; inethash[i]; -+ -+ while (f != NULL) -+ { -+ struct nat25_network_db_entry *g; -+ g = f->next_hash; -+ -+ if(__nat25_has_expired(priv, f)) -+ { -+ if(atomic_dec_and_test(&f->use_count)) -+ { -+#ifdef BR_EXT_DEBUG -+#ifdef CL_IPV6_PASS -+ panic_printk("NAT25 Expire H(%02d) M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x" -+ "%02x%02x%02x%02x%02x%02x\n", -+ i, -+ f->macAddr[0], -+ f->macAddr[1], -+ f->macAddr[2], -+ f->macAddr[3], -+ f->macAddr[4], -+ f->macAddr[5], -+ f->networkAddr[0], -+ f->networkAddr[1], -+ f->networkAddr[2], -+ f->networkAddr[3], -+ f->networkAddr[4], -+ f->networkAddr[5], -+ f->networkAddr[6], -+ f->networkAddr[7], -+ f->networkAddr[8], -+ f->networkAddr[9], -+ f->networkAddr[10], -+ f->networkAddr[11], -+ f->networkAddr[12], -+ f->networkAddr[13], -+ f->networkAddr[14], -+ f->networkAddr[15], -+ f->networkAddr[16]); -+#else -+ -+ panic_printk("NAT25 Expire H(%02d) M:%02x%02x%02x%02x%02x%02x N:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", -+ i, -+ f->macAddr[0], -+ f->macAddr[1], -+ f->macAddr[2], -+ f->macAddr[3], -+ f->macAddr[4], -+ f->macAddr[5], -+ f->networkAddr[0], -+ f->networkAddr[1], -+ f->networkAddr[2], -+ f->networkAddr[3], -+ f->networkAddr[4], -+ f->networkAddr[5], -+ f->networkAddr[6], -+ f->networkAddr[7], -+ f->networkAddr[8], -+ f->networkAddr[9], -+ f->networkAddr[10]); -+#endif -+#endif -+ if(priv->scdb_entry == f) -+ { -+ memset(priv->scdb_mac, 0, ETH_ALEN); -+ memset(priv->scdb_ip, 0, 4); -+ priv->scdb_entry = NULL; -+ } -+ __network_hash_unlink(f); -+ rtw_mfree((u8 *) f, sizeof(struct nat25_network_db_entry)); -+ } -+ } -+ -+ f = g; -+ } -+ } -+ } -+ -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+} -+ -+ -+#ifdef SUPPORT_TX_MCAST2UNI -+static int checkIPMcAndReplace(_adapter *priv, struct sk_buff *skb, unsigned int *dst_ip) -+{ -+ struct stat_info *pstat; -+ struct list_head *phead, *plist; -+ int i; -+ -+ phead = &priv->asoc_list; -+ plist = phead->next; -+ -+ while (plist != phead) { -+ pstat = list_entry(plist, struct stat_info, asoc_list); -+ plist = plist->next; -+ -+ if (pstat->ipmc_num == 0) -+ continue; -+ -+ for (i=0; iipmc[i].used && !memcmp(&pstat->ipmc[i].mcmac[3], ((unsigned char *)dst_ip)+1, 3)) { -+ memcpy(skb->data, pstat->ipmc[i].mcmac, ETH_ALEN); -+ return 1; -+ } -+ } -+ } -+ return 0; -+} -+#endif -+ -+int nat25_db_handle(_adapter *priv, struct sk_buff *skb, int method) -+{ -+ __be16 protocol; -+ unsigned char networkAddr[MAX_NETWORK_ADDR_LEN]; -+ -+ if(skb == NULL) -+ return -1; -+ -+ if((method <= NAT25_MIN) || (method >= NAT25_MAX)) -+ return -1; -+ -+ protocol = *((__be16 *)(skb->data + 2 * ETH_ALEN)); -+ -+ /*---------------------------------------------------*/ -+ /* Handle IP frame */ -+ /*---------------------------------------------------*/ -+ if(protocol == __constant_htons(ETH_P_IP)) -+ { -+ struct iphdr* iph = (struct iphdr *)(skb->data + ETH_HLEN); -+ -+ if(((unsigned char*)(iph) + (iph->ihl<<2)) >= (skb->data + ETH_HLEN + skb->len)) -+ { -+ DEBUG_WARN("NAT25: malformed IP packet !\n"); -+ return -1; -+ } -+ -+ switch(method) -+ { -+ case NAT25_CHECK: -+ return -1; -+ -+ case NAT25_INSERT: -+ { -+ //some muticast with source IP is all zero, maybe other case is illegal -+ //in class A, B, C, host address is all zero or all one is illegal -+ if (iph->saddr == 0) -+ return 0; -+ DEBUG_INFO("NAT25: Insert IP, SA=%08x, DA=%08x\n", iph->saddr, iph->daddr); -+ __nat25_generate_ipv4_network_addr(networkAddr, &iph->saddr); -+ //record source IP address and , source mac address into db -+ __nat25_db_network_insert(priv, skb->data+ETH_ALEN, networkAddr); -+ -+ __nat25_db_print(priv); -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: -+ { -+ DEBUG_INFO("NAT25: Lookup IP, SA=%08x, DA=%08x\n", iph->saddr, iph->daddr); -+#ifdef SUPPORT_TX_MCAST2UNI -+ if (priv->pshare->rf_ft_var.mc2u_disable || -+ ((((OPMODE & (WIFI_STATION_STATE|WIFI_ASOC_STATE)) -+ == (WIFI_STATION_STATE|WIFI_ASOC_STATE)) && -+ !checkIPMcAndReplace(priv, skb, &iph->daddr)) || -+ (OPMODE & WIFI_ADHOC_STATE))) -+#endif -+ { -+ __nat25_generate_ipv4_network_addr(networkAddr, &iph->daddr); -+ -+ if (!__nat25_db_network_lookup_and_replace(priv, skb, networkAddr)) { -+ if (*((unsigned char *)&iph->daddr + 3) == 0xff) { -+ // L2 is unicast but L3 is broadcast, make L2 bacome broadcast -+ DEBUG_INFO("NAT25: Set DA as boardcast\n"); -+ memset(skb->data, 0xff, ETH_ALEN); -+ } -+ else { -+ // forward unknow IP packet to upper TCP/IP -+ DEBUG_INFO("NAT25: Replace DA with BR's MAC\n"); -+ if ( (*(u32 *)priv->br_mac) == 0 && (*(u16 *)(priv->br_mac+4)) == 0 ) { -+ void netdev_br_init(struct net_device *netdev); -+ printk("Re-init netdev_br_init() due to br_mac==0!\n"); -+ netdev_br_init(priv->pnetdev); -+ } -+ memcpy(skb->data, priv->br_mac, ETH_ALEN); -+ } -+ } -+ } -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /*---------------------------------------------------*/ -+ /* Handle ARP frame */ -+ /*---------------------------------------------------*/ -+ else if(protocol == __constant_htons(ETH_P_ARP)) -+ { -+ struct arphdr *arp = (struct arphdr *)(skb->data + ETH_HLEN); -+ unsigned char *arp_ptr = (unsigned char *)(arp + 1); -+ unsigned int *sender, *target; -+ -+ if(arp->ar_pro != __constant_htons(ETH_P_IP)) -+ { -+ DEBUG_WARN("NAT25: arp protocol unknown (%4x)!\n", htons(arp->ar_pro)); -+ return -1; -+ } -+ -+ switch(method) -+ { -+ case NAT25_CHECK: -+ return 0; // skb_copy for all ARP frame -+ -+ case NAT25_INSERT: -+ { -+ DEBUG_INFO("NAT25: Insert ARP, MAC=%02x%02x%02x%02x%02x%02x\n", arp_ptr[0], -+ arp_ptr[1], arp_ptr[2], arp_ptr[3], arp_ptr[4], arp_ptr[5]); -+ -+ // change to ARP sender mac address to wlan STA address -+ memcpy(arp_ptr, GET_MY_HWADDR(priv), ETH_ALEN); -+ -+ arp_ptr += arp->ar_hln; -+ sender = (unsigned int *)arp_ptr; -+ -+ __nat25_generate_ipv4_network_addr(networkAddr, sender); -+ -+ __nat25_db_network_insert(priv, skb->data+ETH_ALEN, networkAddr); -+ -+ __nat25_db_print(priv); -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: -+ { -+ DEBUG_INFO("NAT25: Lookup ARP\n"); -+ -+ arp_ptr += arp->ar_hln; -+ sender = (unsigned int *)arp_ptr; -+ arp_ptr += (arp->ar_hln + arp->ar_pln); -+ target = (unsigned int *)arp_ptr; -+ -+ __nat25_generate_ipv4_network_addr(networkAddr, target); -+ -+ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); -+ -+ // change to ARP target mac address to Lookup result -+ arp_ptr = (unsigned char *)(arp + 1); -+ arp_ptr += (arp->ar_hln + arp->ar_pln); -+ memcpy(arp_ptr, skb->data, ETH_ALEN); -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /*---------------------------------------------------*/ -+ /* Handle IPX and Apple Talk frame */ -+ /*---------------------------------------------------*/ -+ else if((protocol == __constant_htons(ETH_P_IPX)) || -+ (protocol <= __constant_htons(ETH_FRAME_LEN))) -+ { -+ unsigned char ipx_header[2] = {0xFF, 0xFF}; -+ struct ipxhdr *ipx = NULL; -+ struct elapaarp *ea = NULL; -+ struct ddpehdr *ddp = NULL; -+ unsigned char *framePtr = skb->data + ETH_HLEN; -+ -+ if(protocol == __constant_htons(ETH_P_IPX)) -+ { -+ DEBUG_INFO("NAT25: Protocol=IPX (Ethernet II)\n"); -+ ipx = (struct ipxhdr *)framePtr; -+ } -+ else if(protocol <= __constant_htons(ETH_FRAME_LEN)) -+ { -+ if(!memcmp(ipx_header, framePtr, 2)) -+ { -+ DEBUG_INFO("NAT25: Protocol=IPX (Ethernet 802.3)\n"); -+ ipx = (struct ipxhdr *)framePtr; -+ } -+ else -+ { -+ unsigned char ipx_8022_type = 0xE0; -+ unsigned char snap_8022_type = 0xAA; -+ -+ if(*framePtr == snap_8022_type) -+ { -+ unsigned char ipx_snap_id[5] = {0x0, 0x0, 0x0, 0x81, 0x37}; // IPX SNAP ID -+ unsigned char aarp_snap_id[5] = {0x00, 0x00, 0x00, 0x80, 0xF3}; // Apple Talk AARP SNAP ID -+ unsigned char ddp_snap_id[5] = {0x08, 0x00, 0x07, 0x80, 0x9B}; // Apple Talk DDP SNAP ID -+ -+ framePtr += 3; // eliminate the 802.2 header -+ -+ if(!memcmp(ipx_snap_id, framePtr, 5)) -+ { -+ framePtr += 5; // eliminate the SNAP header -+ -+ DEBUG_INFO("NAT25: Protocol=IPX (Ethernet SNAP)\n"); -+ ipx = (struct ipxhdr *)framePtr; -+ } -+ else if(!memcmp(aarp_snap_id, framePtr, 5)) -+ { -+ framePtr += 5; // eliminate the SNAP header -+ -+ ea = (struct elapaarp *)framePtr; -+ } -+ else if(!memcmp(ddp_snap_id, framePtr, 5)) -+ { -+ framePtr += 5; // eliminate the SNAP header -+ -+ ddp = (struct ddpehdr *)framePtr; -+ } -+ else -+ { -+ DEBUG_WARN("NAT25: Protocol=Ethernet SNAP %02x%02x%02x%02x%02x\n", framePtr[0], -+ framePtr[1], framePtr[2], framePtr[3], framePtr[4]); -+ return -1; -+ } -+ } -+ else if(*framePtr == ipx_8022_type) -+ { -+ framePtr += 3; // eliminate the 802.2 header -+ -+ if(!memcmp(ipx_header, framePtr, 2)) -+ { -+ DEBUG_INFO("NAT25: Protocol=IPX (Ethernet 802.2)\n"); -+ ipx = (struct ipxhdr *)framePtr; -+ } -+ else -+ return -1; -+ } -+ else -+ return -1; -+ } -+ } -+ else -+ return -1; -+ -+ /* IPX */ -+ if(ipx != NULL) -+ { -+ switch(method) -+ { -+ case NAT25_CHECK: -+ if(!memcmp(skb->data+ETH_ALEN, ipx->ipx_source.node, ETH_ALEN)) -+ { -+ DEBUG_INFO("NAT25: Check IPX skb_copy\n"); -+ return 0; -+ } -+ return -1; -+ -+ case NAT25_INSERT: -+ { -+ DEBUG_INFO("NAT25: Insert IPX, Dest=%08x,%02x%02x%02x%02x%02x%02x,%04x Source=%08x,%02x%02x%02x%02x%02x%02x,%04x\n", -+ ipx->ipx_dest.net, -+ ipx->ipx_dest.node[0], -+ ipx->ipx_dest.node[1], -+ ipx->ipx_dest.node[2], -+ ipx->ipx_dest.node[3], -+ ipx->ipx_dest.node[4], -+ ipx->ipx_dest.node[5], -+ ipx->ipx_dest.sock, -+ ipx->ipx_source.net, -+ ipx->ipx_source.node[0], -+ ipx->ipx_source.node[1], -+ ipx->ipx_source.node[2], -+ ipx->ipx_source.node[3], -+ ipx->ipx_source.node[4], -+ ipx->ipx_source.node[5], -+ ipx->ipx_source.sock); -+ -+ if(!memcmp(skb->data+ETH_ALEN, ipx->ipx_source.node, ETH_ALEN)) -+ { -+ DEBUG_INFO("NAT25: Use IPX Net, and Socket as network addr\n"); -+ -+ __nat25_generate_ipx_network_addr_with_socket(networkAddr, &ipx->ipx_source.net, &ipx->ipx_source.sock); -+ -+ // change IPX source node addr to wlan STA address -+ memcpy(ipx->ipx_source.node, GET_MY_HWADDR(priv), ETH_ALEN); -+ } -+ else -+ { -+ __nat25_generate_ipx_network_addr_with_node(networkAddr, &ipx->ipx_source.net, ipx->ipx_source.node); -+ } -+ -+ __nat25_db_network_insert(priv, skb->data+ETH_ALEN, networkAddr); -+ -+ __nat25_db_print(priv); -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: -+ { -+ if(!memcmp(GET_MY_HWADDR(priv), ipx->ipx_dest.node, ETH_ALEN)) -+ { -+ DEBUG_INFO("NAT25: Lookup IPX, Modify Destination IPX Node addr\n"); -+ -+ __nat25_generate_ipx_network_addr_with_socket(networkAddr, &ipx->ipx_dest.net, &ipx->ipx_dest.sock); -+ -+ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); -+ -+ // replace IPX destination node addr with Lookup destination MAC addr -+ memcpy(ipx->ipx_dest.node, skb->data, ETH_ALEN); -+ } -+ else -+ { -+ __nat25_generate_ipx_network_addr_with_node(networkAddr, &ipx->ipx_dest.net, ipx->ipx_dest.node); -+ -+ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); -+ } -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /* AARP */ -+ else if(ea != NULL) -+ { -+ /* Sanity check fields. */ -+ if(ea->hw_len != ETH_ALEN || ea->pa_len != AARP_PA_ALEN) -+ { -+ DEBUG_WARN("NAT25: Appletalk AARP Sanity check fail!\n"); -+ return -1; -+ } -+ -+ switch(method) -+ { -+ case NAT25_CHECK: -+ return 0; -+ -+ case NAT25_INSERT: -+ { -+ // change to AARP source mac address to wlan STA address -+ memcpy(ea->hw_src, GET_MY_HWADDR(priv), ETH_ALEN); -+ -+ DEBUG_INFO("NAT25: Insert AARP, Source=%d,%d Destination=%d,%d\n", -+ ea->pa_src_net, -+ ea->pa_src_node, -+ ea->pa_dst_net, -+ ea->pa_dst_node); -+ -+ __nat25_generate_apple_network_addr(networkAddr, &ea->pa_src_net, &ea->pa_src_node); -+ -+ __nat25_db_network_insert(priv, skb->data+ETH_ALEN, networkAddr); -+ -+ __nat25_db_print(priv); -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: -+ { -+ DEBUG_INFO("NAT25: Lookup AARP, Source=%d,%d Destination=%d,%d\n", -+ ea->pa_src_net, -+ ea->pa_src_node, -+ ea->pa_dst_net, -+ ea->pa_dst_node); -+ -+ __nat25_generate_apple_network_addr(networkAddr, &ea->pa_dst_net, &ea->pa_dst_node); -+ -+ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); -+ -+ // change to AARP destination mac address to Lookup result -+ memcpy(ea->hw_dst, skb->data, ETH_ALEN); -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /* DDP */ -+ else if(ddp != NULL) -+ { -+ switch(method) -+ { -+ case NAT25_CHECK: -+ return -1; -+ -+ case NAT25_INSERT: -+ { -+ DEBUG_INFO("NAT25: Insert DDP, Source=%d,%d Destination=%d,%d\n", -+ ddp->deh_snet, -+ ddp->deh_snode, -+ ddp->deh_dnet, -+ ddp->deh_dnode); -+ -+ __nat25_generate_apple_network_addr(networkAddr, &ddp->deh_snet, &ddp->deh_snode); -+ -+ __nat25_db_network_insert(priv, skb->data+ETH_ALEN, networkAddr); -+ -+ __nat25_db_print(priv); -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: -+ { -+ DEBUG_INFO("NAT25: Lookup DDP, Source=%d,%d Destination=%d,%d\n", -+ ddp->deh_snet, -+ ddp->deh_snode, -+ ddp->deh_dnet, -+ ddp->deh_dnode); -+ -+ __nat25_generate_apple_network_addr(networkAddr, &ddp->deh_dnet, &ddp->deh_dnode); -+ -+ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ return -1; -+ } -+ -+ /*---------------------------------------------------*/ -+ /* Handle PPPoE frame */ -+ /*---------------------------------------------------*/ -+ else if((protocol == __constant_htons(ETH_P_PPP_DISC)) || -+ (protocol == __constant_htons(ETH_P_PPP_SES))) -+ { -+ struct pppoe_hdr *ph = (struct pppoe_hdr *)(skb->data + ETH_HLEN); -+ unsigned short *pMagic; -+ -+ switch(method) -+ { -+ case NAT25_CHECK: -+ if (ph->sid == 0) -+ return 0; -+ return 1; -+ -+ case NAT25_INSERT: -+ if(ph->sid == 0) // Discovery phase according to tag -+ { -+ if(ph->code == PADI_CODE || ph->code == PADR_CODE) -+ { -+ if (priv->ethBrExtInfo.addPPPoETag) { -+ struct pppoe_tag *tag, *pOldTag; -+ unsigned char tag_buf[40]; -+ int old_tag_len=0; -+ -+ tag = (struct pppoe_tag *)tag_buf; -+ pOldTag = (struct pppoe_tag *)__nat25_find_pppoe_tag(ph, ntohs(PTT_RELAY_SID)); -+ if (pOldTag) { // if SID existed, copy old value and delete it -+ old_tag_len = ntohs(pOldTag->tag_len); -+ if (old_tag_len+TAG_HDR_LEN+MAGIC_CODE_LEN+RTL_RELAY_TAG_LEN > sizeof(tag_buf)) { -+ DEBUG_ERR("SID tag length too long!\n"); -+ return -1; -+ } -+ -+ memcpy(tag->tag_data+MAGIC_CODE_LEN+RTL_RELAY_TAG_LEN, -+ pOldTag->tag_data, old_tag_len); -+ -+ if (skb_pull_and_merge(skb, (unsigned char *)pOldTag, TAG_HDR_LEN+old_tag_len) < 0) { -+ DEBUG_ERR("call skb_pull_and_merge() failed in PADI/R packet!\n"); -+ return -1; -+ } -+ ph->length = htons(ntohs(ph->length)-TAG_HDR_LEN-old_tag_len); -+ } -+ -+ tag->tag_type = PTT_RELAY_SID; -+ tag->tag_len = htons(MAGIC_CODE_LEN+RTL_RELAY_TAG_LEN+old_tag_len); -+ -+ // insert the magic_code+client mac in relay tag -+ pMagic = (unsigned short *)tag->tag_data; -+ *pMagic = htons(MAGIC_CODE); -+ memcpy(tag->tag_data+MAGIC_CODE_LEN, skb->data+ETH_ALEN, ETH_ALEN); -+ -+ //Add relay tag -+ if(__nat25_add_pppoe_tag(skb, tag) < 0) -+ return -1; -+ -+ DEBUG_INFO("NAT25: Insert PPPoE, forward %s packet\n", -+ (ph->code == PADI_CODE ? "PADI" : "PADR")); -+ } -+ else { // not add relay tag -+ if (priv->pppoe_connection_in_progress && -+ memcmp(skb->data+ETH_ALEN, priv->pppoe_addr, ETH_ALEN)) { -+ DEBUG_ERR("Discard PPPoE packet due to another PPPoE connection is in progress!\n"); -+ return -2; -+ } -+ -+ if (priv->pppoe_connection_in_progress == 0) -+ memcpy(priv->pppoe_addr, skb->data+ETH_ALEN, ETH_ALEN); -+ -+ priv->pppoe_connection_in_progress = WAIT_TIME_PPPOE; -+ } -+ } -+ else -+ return -1; -+ } -+ else // session phase -+ { -+ DEBUG_INFO("NAT25: Insert PPPoE, insert session packet to %s\n", skb->dev->name); -+ -+ __nat25_generate_pppoe_network_addr(networkAddr, skb->data, &(ph->sid)); -+ -+ __nat25_db_network_insert(priv, skb->data+ETH_ALEN, networkAddr); -+ -+ __nat25_db_print(priv); -+ -+ if (!priv->ethBrExtInfo.addPPPoETag && -+ priv->pppoe_connection_in_progress && -+ !memcmp(skb->data+ETH_ALEN, priv->pppoe_addr, ETH_ALEN)) -+ priv->pppoe_connection_in_progress = 0; -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: -+ if(ph->code == PADO_CODE || ph->code == PADS_CODE) -+ { -+ if (priv->ethBrExtInfo.addPPPoETag) { -+ struct pppoe_tag *tag; -+ unsigned char *ptr; -+ unsigned short tagType, tagLen; -+ int offset=0; -+ -+ if((ptr = __nat25_find_pppoe_tag(ph, ntohs(PTT_RELAY_SID))) == 0) { -+ DEBUG_ERR("Fail to find PTT_RELAY_SID in FADO!\n"); -+ return -1; -+ } -+ -+ tag = (struct pppoe_tag *)ptr; -+ tagType = (unsigned short)((ptr[0] << 8) + ptr[1]); -+ tagLen = (unsigned short)((ptr[2] << 8) + ptr[3]); -+ -+ if((tagType != ntohs(PTT_RELAY_SID)) || (tagLen < (MAGIC_CODE_LEN+RTL_RELAY_TAG_LEN))) { -+ DEBUG_ERR("Invalid PTT_RELAY_SID tag length [%d]!\n", tagLen); -+ return -1; -+ } -+ -+ pMagic = (unsigned short *)tag->tag_data; -+ if (ntohs(*pMagic) != MAGIC_CODE) { -+ DEBUG_ERR("Can't find MAGIC_CODE in %s packet!\n", -+ (ph->code == PADO_CODE ? "PADO" : "PADS")); -+ return -1; -+ } -+ -+ memcpy(skb->data, tag->tag_data+MAGIC_CODE_LEN, ETH_ALEN); -+ -+ if (tagLen > MAGIC_CODE_LEN+RTL_RELAY_TAG_LEN) -+ offset = TAG_HDR_LEN; -+ -+ if (skb_pull_and_merge(skb, ptr+offset, TAG_HDR_LEN+MAGIC_CODE_LEN+RTL_RELAY_TAG_LEN-offset) < 0) { -+ DEBUG_ERR("call skb_pull_and_merge() failed in PADO packet!\n"); -+ return -1; -+ } -+ ph->length = htons(ntohs(ph->length)-(TAG_HDR_LEN+MAGIC_CODE_LEN+RTL_RELAY_TAG_LEN-offset)); -+ if (offset > 0) -+ tag->tag_len = htons(tagLen-MAGIC_CODE_LEN-RTL_RELAY_TAG_LEN); -+ -+ DEBUG_INFO("NAT25: Lookup PPPoE, forward %s Packet from %s\n", -+ (ph->code == PADO_CODE ? "PADO" : "PADS"), skb->dev->name); -+ } -+ else { // not add relay tag -+ if (!priv->pppoe_connection_in_progress) { -+ DEBUG_ERR("Discard PPPoE packet due to no connection in progresss!\n"); -+ return -1; -+ } -+ memcpy(skb->data, priv->pppoe_addr, ETH_ALEN); -+ priv->pppoe_connection_in_progress = WAIT_TIME_PPPOE; -+ } -+ } -+ else { -+ if(ph->sid != 0) -+ { -+ DEBUG_INFO("NAT25: Lookup PPPoE, lookup session packet from %s\n", skb->dev->name); -+ __nat25_generate_pppoe_network_addr(networkAddr, skb->data+ETH_ALEN, &(ph->sid)); -+ -+ __nat25_db_network_lookup_and_replace(priv, skb, networkAddr); -+ -+ __nat25_db_print(priv); -+ } -+ else -+ return -1; -+ -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /*---------------------------------------------------*/ -+ /* Handle EAP frame */ -+ /*---------------------------------------------------*/ -+ else if(protocol == __constant_htons(0x888e)) -+ { -+ switch(method) -+ { -+ case NAT25_CHECK: -+ return -1; -+ -+ case NAT25_INSERT: -+ return 0; -+ -+ case NAT25_LOOKUP: -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /*---------------------------------------------------*/ -+ /* Handle C-Media proprietary frame */ -+ /*---------------------------------------------------*/ -+ else if((protocol == __constant_htons(0xe2ae)) || -+ (protocol == __constant_htons(0xe2af))) -+ { -+ switch(method) -+ { -+ case NAT25_CHECK: -+ return -1; -+ -+ case NAT25_INSERT: -+ return 0; -+ -+ case NAT25_LOOKUP: -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+ -+ /*---------------------------------------------------*/ -+ /* Handle IPV6 frame */ -+ /*---------------------------------------------------*/ -+#ifdef CL_IPV6_PASS -+ else if(protocol == __constant_htons(ETH_P_IPV6)) -+ { -+ struct ipv6hdr *iph = (struct ipv6hdr *)(skb->data + ETH_HLEN); -+ -+ if (sizeof(*iph) >= (skb->len - ETH_HLEN)) -+ { -+ DEBUG_WARN("NAT25: malformed IPv6 packet !\n"); -+ return -1; -+ } -+ -+ switch(method) -+ { -+ case NAT25_CHECK: -+ if (skb->data[0] & 1) -+ return 0; -+ return -1; -+ -+ case NAT25_INSERT: -+ { -+ DEBUG_INFO("NAT25: Insert IP, SA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x," -+ " DA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x\n", -+ iph->saddr.s6_addr16[0],iph->saddr.s6_addr16[1],iph->saddr.s6_addr16[2],iph->saddr.s6_addr16[3], -+ iph->saddr.s6_addr16[4],iph->saddr.s6_addr16[5],iph->saddr.s6_addr16[6],iph->saddr.s6_addr16[7], -+ iph->daddr.s6_addr16[0],iph->daddr.s6_addr16[1],iph->daddr.s6_addr16[2],iph->daddr.s6_addr16[3], -+ iph->daddr.s6_addr16[4],iph->daddr.s6_addr16[5],iph->daddr.s6_addr16[6],iph->daddr.s6_addr16[7]); -+ -+ if (memcmp(&iph->saddr, "\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0\x0", 16)) { -+ __nat25_generate_ipv6_network_addr(networkAddr, (unsigned int *)&iph->saddr); -+ __nat25_db_network_insert(priv, skb->data+ETH_ALEN, networkAddr); -+ __nat25_db_print(priv); -+ -+ if (iph->nexthdr == IPPROTO_ICMPV6 && -+ skb->len > (ETH_HLEN + sizeof(*iph) + 4)) { -+ if (update_nd_link_layer_addr(skb->data + ETH_HLEN + sizeof(*iph), -+ skb->len - ETH_HLEN - sizeof(*iph), GET_MY_HWADDR(priv))) { -+ struct icmp6hdr *hdr = (struct icmp6hdr *)(skb->data + ETH_HLEN + sizeof(*iph)); -+ hdr->icmp6_cksum = 0; -+ hdr->icmp6_cksum = csum_ipv6_magic(&iph->saddr, &iph->daddr, -+ iph->payload_len, -+ IPPROTO_ICMPV6, -+ csum_partial((__u8 *)hdr, iph->payload_len, 0)); -+ } -+ } -+ } -+ } -+ return 0; -+ -+ case NAT25_LOOKUP: -+ DEBUG_INFO("NAT25: Lookup IP, SA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x," -+ " DA=%4x:%4x:%4x:%4x:%4x:%4x:%4x:%4x\n", -+ iph->saddr.s6_addr16[0],iph->saddr.s6_addr16[1],iph->saddr.s6_addr16[2],iph->saddr.s6_addr16[3], -+ iph->saddr.s6_addr16[4],iph->saddr.s6_addr16[5],iph->saddr.s6_addr16[6],iph->saddr.s6_addr16[7], -+ iph->daddr.s6_addr16[0],iph->daddr.s6_addr16[1],iph->daddr.s6_addr16[2],iph->daddr.s6_addr16[3], -+ iph->daddr.s6_addr16[4],iph->daddr.s6_addr16[5],iph->daddr.s6_addr16[6],iph->daddr.s6_addr16[7]); -+ -+ -+ __nat25_generate_ipv6_network_addr(networkAddr, (unsigned int *)&iph->daddr); -+ if (!__nat25_db_network_lookup_and_replace(priv, skb, networkAddr)) { -+#ifdef SUPPORT_RX_UNI2MCAST -+ if (iph->daddr.s6_addr[0] == 0xff) -+ convert_ipv6_mac_to_mc(skb); -+#endif -+ } -+ return 0; -+ -+ default: -+ return -1; -+ } -+ } -+#endif // CL_IPV6_PASS -+ -+ return -1; -+} -+ -+ -+int nat25_handle_frame(_adapter *priv, struct sk_buff *skb) -+{ -+#ifdef BR_EXT_DEBUG -+ if((!priv->ethBrExtInfo.nat25_disable) && (!(skb->data[0] & 1))) -+ { -+ panic_printk("NAT25: Input Frame: DA=%02x%02x%02x%02x%02x%02x SA=%02x%02x%02x%02x%02x%02x\n", -+ skb->data[0], -+ skb->data[1], -+ skb->data[2], -+ skb->data[3], -+ skb->data[4], -+ skb->data[5], -+ skb->data[6], -+ skb->data[7], -+ skb->data[8], -+ skb->data[9], -+ skb->data[10], -+ skb->data[11]); -+ } -+#endif -+ -+ if(!(skb->data[0] & 1)) -+ { -+ int is_vlan_tag=0, i, retval=0; -+ unsigned short vlan_hdr=0; -+ -+ if (*((__be16 *)(skb->data+ETH_ALEN*2)) == __constant_htons(ETH_P_8021Q)) { -+ is_vlan_tag = 1; -+ vlan_hdr = *((unsigned short *)(skb->data+ETH_ALEN*2+2)); -+ for (i=0; i<6; i++) -+ *((unsigned short *)(skb->data+ETH_ALEN*2+2-i*2)) = *((unsigned short *)(skb->data+ETH_ALEN*2-2-i*2)); -+ skb_pull(skb, 4); -+ } -+ -+ if (!priv->ethBrExtInfo.nat25_disable) -+ { -+ _irqL irqL; -+ _enter_critical_bh(&priv->br_ext_lock, &irqL); -+ /* -+ * This function look up the destination network address from -+ * the NAT2.5 database. Return value = -1 means that the -+ * corresponding network protocol is NOT support. -+ */ -+ if (!priv->ethBrExtInfo.nat25sc_disable && -+ (*((unsigned short *)(skb->data+ETH_ALEN*2)) == __constant_htons(ETH_P_IP)) && -+ !memcmp(priv->scdb_ip, skb->data+ETH_HLEN+16, 4)) { -+ memcpy(skb->data, priv->scdb_mac, ETH_ALEN); -+ -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ } -+ else { -+ _exit_critical_bh(&priv->br_ext_lock, &irqL); -+ -+ retval = nat25_db_handle(priv, skb, NAT25_LOOKUP); -+ } -+ } -+ else { -+ if (((*((unsigned short *)(skb->data+ETH_ALEN*2)) == __constant_htons(ETH_P_IP)) && -+ !memcmp(priv->br_ip, skb->data+ETH_HLEN+16, 4)) || -+ ((*((unsigned short *)(skb->data+ETH_ALEN*2)) == __constant_htons(ETH_P_ARP)) && -+ !memcmp(priv->br_ip, skb->data+ETH_HLEN+24, 4))) { -+ // for traffic to upper TCP/IP -+ retval = nat25_db_handle(priv, skb, NAT25_LOOKUP); -+ } -+ } -+ -+ if (is_vlan_tag) { -+ skb_push(skb, 4); -+ for (i=0; i<6; i++) -+ *((unsigned short *)(skb->data+i*2)) = *((unsigned short *)(skb->data+4+i*2)); -+ *((__be16 *)(skb->data+ETH_ALEN*2)) = __constant_htons(ETH_P_8021Q); -+ *((__be16 *)(skb->data+ETH_ALEN*2+2)) = vlan_hdr; -+ } -+ -+ if(retval == -1) { -+ //DEBUG_ERR("NAT25: Lookup fail!\n"); -+ return -1; -+ } -+ } -+ -+ return 0; -+} -+ -+#if 0 -+void mac_clone(_adapter *priv, unsigned char *addr) -+{ -+ struct sockaddr sa; -+ -+ memcpy(sa.sa_data, addr, ETH_ALEN); -+ DEBUG_INFO("MAC Clone: Addr=%02x%02x%02x%02x%02x%02x\n", -+ addr[0], addr[1], addr[2], addr[3], addr[4], addr[5]); -+ rtl8192cd_set_hwaddr(priv->dev, &sa); -+} -+ -+ -+int mac_clone_handle_frame(_adapter *priv, struct sk_buff *skb) -+{ -+ if(priv->ethBrExtInfo.macclone_enable && !priv->macclone_completed) -+ { -+ if(!(skb->data[ETH_ALEN] & 1)) //// check any other particular MAC add -+ { -+ if(memcmp(skb->data+ETH_ALEN, GET_MY_HWADDR(priv), ETH_ALEN) && -+ ((priv->dev->br_port) && -+ memcmp(skb->data+ETH_ALEN, priv->br_mac, ETH_ALEN))) -+ { -+ mac_clone(priv, skb->data+ETH_ALEN); -+ priv->macclone_completed = 1; -+ } -+ } -+ } -+ -+ return 0; -+} -+#endif // 0 -+ -+#define SERVER_PORT 67 -+#define CLIENT_PORT 68 -+#define DHCP_MAGIC 0x63825363 -+#define BROADCAST_FLAG 0x8000 -+ -+struct dhcpMessage { -+ u_int8_t op; -+ u_int8_t htype; -+ u_int8_t hlen; -+ u_int8_t hops; -+ u_int32_t xid; -+ u_int16_t secs; -+ u_int16_t flags; -+ u_int32_t ciaddr; -+ u_int32_t yiaddr; -+ u_int32_t siaddr; -+ u_int32_t giaddr; -+ u_int8_t chaddr[16]; -+ u_int8_t sname[64]; -+ u_int8_t file[128]; -+ u_int32_t cookie; -+ u_int8_t options[308]; /* 312 - cookie */ -+}; -+ -+void dhcp_flag_bcast(_adapter *priv, struct sk_buff *skb) -+{ -+ if(skb == NULL) -+ return; -+ -+ if(!priv->ethBrExtInfo.dhcp_bcst_disable) -+ { -+ __be16 protocol = *((unsigned short *)(skb->data + 2 * ETH_ALEN)); -+ -+ if(protocol == __constant_htons(ETH_P_IP)) // IP -+ { -+ struct iphdr* iph = (struct iphdr *)(skb->data + ETH_HLEN); -+ -+ if(iph->protocol == IPPROTO_UDP) // UDP -+ { -+ struct udphdr *udph = (struct udphdr *)((SIZE_PTR)iph + (iph->ihl << 2)); -+ -+ if((udph->source == __constant_htons(CLIENT_PORT)) -+ && (udph->dest == __constant_htons(SERVER_PORT))) // DHCP request -+ { -+ struct dhcpMessage *dhcph = -+ (struct dhcpMessage *)((SIZE_PTR)udph + sizeof(struct udphdr)); -+ -+ if(dhcph->cookie == __constant_htonl(DHCP_MAGIC)) // match magic word -+ { -+ if(!(dhcph->flags & htons(BROADCAST_FLAG))) // if not broadcast -+ { -+ register int sum = 0; -+ -+ DEBUG_INFO("DHCP: change flag of DHCP request to broadcast.\n"); -+ // or BROADCAST flag -+ dhcph->flags |= htons(BROADCAST_FLAG); -+ // recalculate checksum -+ sum = ~(udph->check) & 0xffff; -+ sum += dhcph->flags; -+ while(sum >> 16) -+ sum = (sum & 0xffff) + (sum >> 16); -+ udph->check = ~sum; -+ } -+ } -+ } -+ } -+ } -+ } -+} -+ -+ -+void *scdb_findEntry(_adapter *priv, unsigned char *macAddr, -+ unsigned char *ipAddr) -+{ -+ unsigned char networkAddr[MAX_NETWORK_ADDR_LEN]; -+ struct nat25_network_db_entry *db; -+ int hash; -+ //_irqL irqL; -+ //_enter_critical_bh(&priv->br_ext_lock, &irqL); -+ -+ __nat25_generate_ipv4_network_addr(networkAddr, (unsigned int *)ipAddr); -+ hash = __nat25_network_hash(networkAddr); -+ db = priv->nethash[hash]; -+ while (db != NULL) -+ { -+ if(!memcmp(db->networkAddr, networkAddr, MAX_NETWORK_ADDR_LEN)) { -+ //_exit_critical_bh(&priv->br_ext_lock, &irqL); -+ return (void *)db; -+ } -+ -+ db = db->next_hash; -+ } -+ -+ //_exit_critical_bh(&priv->br_ext_lock, &irqL); -+ return NULL; -+} -+ -+#endif // CONFIG_BR_EXT -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_cmd.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_cmd.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_cmd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_cmd.c 2018-02-06 17:42:30.693966912 +0200 -@@ -0,0 +1,2960 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_CMD_C_ -+ -+#include -+ -+/* -+Caller and the rtw_cmd_thread can protect cmd_q by spin_lock. -+No irqsave is necessary. -+*/ -+ -+sint _rtw_init_cmd_priv (struct cmd_priv *pcmdpriv) -+{ -+ sint res=_SUCCESS; -+ -+ -+ -+ _rtw_init_sema(&(pcmdpriv->cmd_queue_sema), 0); -+ //_rtw_init_sema(&(pcmdpriv->cmd_done_sema), 0); -+ _rtw_init_sema(&(pcmdpriv->terminate_cmdthread_sema), 0); -+ -+ -+ _rtw_init_queue(&(pcmdpriv->cmd_queue)); -+ -+ //allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf -+ -+ pcmdpriv->cmd_seq = 1; -+ -+ pcmdpriv->cmd_allocated_buf = rtw_zmalloc(MAX_CMDSZ + CMDBUFF_ALIGN_SZ); -+ -+ if (pcmdpriv->cmd_allocated_buf == NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pcmdpriv->cmd_buf = pcmdpriv->cmd_allocated_buf + CMDBUFF_ALIGN_SZ - ( (SIZE_PTR)(pcmdpriv->cmd_allocated_buf) & (CMDBUFF_ALIGN_SZ-1)); -+ -+ pcmdpriv->rsp_allocated_buf = rtw_zmalloc(MAX_RSPSZ + 4); -+ -+ if (pcmdpriv->rsp_allocated_buf == NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pcmdpriv->rsp_buf = pcmdpriv->rsp_allocated_buf + 4 - ( (SIZE_PTR)(pcmdpriv->rsp_allocated_buf) & 3); -+ -+ pcmdpriv->cmd_issued_cnt = pcmdpriv->cmd_done_cnt = pcmdpriv->rsp_cnt = 0; -+ -+exit: -+ -+ -+ -+ return res; -+ -+} -+ -+#ifdef CONFIG_C2H_WK -+static void c2h_wk_callback(_workitem *work); -+#endif -+sint _rtw_init_evt_priv(struct evt_priv *pevtpriv) -+{ -+ sint res=_SUCCESS; -+ -+ -+ -+#ifdef CONFIG_H2CLBK -+ _rtw_init_sema(&(pevtpriv->lbkevt_done), 0); -+ pevtpriv->lbkevt_limit = 0; -+ pevtpriv->lbkevt_num = 0; -+ pevtpriv->cmdevt_parm = NULL; -+#endif -+ -+ //allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf -+ ATOMIC_SET(&pevtpriv->event_seq, 0); -+ pevtpriv->evt_done_cnt = 0; -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+ -+ _rtw_init_sema(&(pevtpriv->evt_notify), 0); -+ _rtw_init_sema(&(pevtpriv->terminate_evtthread_sema), 0); -+ -+ pevtpriv->evt_allocated_buf = rtw_zmalloc(MAX_EVTSZ + 4); -+ if (pevtpriv->evt_allocated_buf == NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ pevtpriv->evt_buf = pevtpriv->evt_allocated_buf + 4 - ((unsigned int)(pevtpriv->evt_allocated_buf) & 3); -+ -+ _rtw_init_queue(&(pevtpriv->evt_queue)); -+ -+exit: -+ -+#endif //end of CONFIG_EVENT_THREAD_MODE -+ -+#ifdef CONFIG_C2H_WK -+ _init_workitem(&pevtpriv->c2h_wk, c2h_wk_callback, NULL); -+ pevtpriv->c2h_wk_alive = false; -+ pevtpriv->c2h_queue = rtw_cbuf_alloc(C2H_QUEUE_MAX_LEN+1); -+#endif -+ -+ -+ -+ return res; -+} -+ -+void _rtw_free_evt_priv (struct evt_priv *pevtpriv) -+{ -+ -+ -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("+_rtw_free_evt_priv \n")); -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+ _rtw_free_sema(&(pevtpriv->evt_notify)); -+ _rtw_free_sema(&(pevtpriv->terminate_evtthread_sema)); -+ -+ -+ if (pevtpriv->evt_allocated_buf) -+ rtw_mfree(pevtpriv->evt_allocated_buf, MAX_EVTSZ + 4); -+#endif -+ -+#ifdef CONFIG_C2H_WK -+ _cancel_workitem_sync(&pevtpriv->c2h_wk); -+ while(pevtpriv->c2h_wk_alive) -+ rtw_msleep_os(10); -+ -+ while (!rtw_cbuf_empty(pevtpriv->c2h_queue)) { -+ void *c2h; -+ if ((c2h = rtw_cbuf_pop(pevtpriv->c2h_queue)) != NULL -+ && c2h != (void *)pevtpriv) { -+ rtw_mfree(c2h, 16); -+ } -+ } -+#endif -+ -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("-_rtw_free_evt_priv \n")); -+ -+ -+ -+} -+ -+void _rtw_free_cmd_priv (struct cmd_priv *pcmdpriv) -+{ -+ -+ -+ if(pcmdpriv){ -+ _rtw_spinlock_free(&(pcmdpriv->cmd_queue.lock)); -+ _rtw_free_sema(&(pcmdpriv->cmd_queue_sema)); -+ //_rtw_free_sema(&(pcmdpriv->cmd_done_sema)); -+ _rtw_free_sema(&(pcmdpriv->terminate_cmdthread_sema)); -+ -+ if (pcmdpriv->cmd_allocated_buf) -+ rtw_mfree(pcmdpriv->cmd_allocated_buf, MAX_CMDSZ + CMDBUFF_ALIGN_SZ); -+ -+ if (pcmdpriv->rsp_allocated_buf) -+ rtw_mfree(pcmdpriv->rsp_allocated_buf, MAX_RSPSZ + 4); -+ } -+ -+} -+ -+/* -+Calling Context: -+ -+rtw_enqueue_cmd can only be called between kernel thread, -+since only spin_lock is used. -+ -+ISR/Call-Back functions can't call this sub-function. -+ -+*/ -+ -+sint _rtw_enqueue_cmd(_queue *queue, struct cmd_obj *obj) -+{ -+ _irqL irqL; -+ -+ -+ -+ if (obj == NULL) -+ goto exit; -+ -+ //_enter_critical_bh(&queue->lock, &irqL); -+ _enter_critical(&queue->lock, &irqL); -+ -+ rtw_list_insert_tail(&obj->list, &queue->queue); -+ -+ //_exit_critical_bh(&queue->lock, &irqL); -+ _exit_critical(&queue->lock, &irqL); -+ -+exit: -+ -+ -+ -+ return _SUCCESS; -+} -+ -+struct cmd_obj *_rtw_dequeue_cmd(_queue *queue) -+{ -+ _irqL irqL; -+ struct cmd_obj *obj; -+ -+ -+ -+ //_enter_critical_bh(&(queue->lock), &irqL); -+ _enter_critical(&queue->lock, &irqL); -+ if (rtw_is_list_empty(&(queue->queue))) -+ obj = NULL; -+ else -+ { -+ obj = LIST_CONTAINOR(get_next(&(queue->queue)), struct cmd_obj, list); -+ rtw_list_delete(&obj->list); -+ } -+ -+ //_exit_critical_bh(&(queue->lock), &irqL); -+ _exit_critical(&queue->lock, &irqL); -+ -+ -+ -+ return obj; -+} -+ -+u32 rtw_init_cmd_priv(struct cmd_priv *pcmdpriv) -+{ -+ u32 res; -+ -+ res = _rtw_init_cmd_priv (pcmdpriv); -+ -+ return res; -+} -+ -+u32 rtw_init_evt_priv (struct evt_priv *pevtpriv) -+{ -+ int res; -+ -+ res = _rtw_init_evt_priv(pevtpriv); -+ -+ return res; -+} -+ -+void rtw_free_evt_priv (struct evt_priv *pevtpriv) -+{ -+ -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("rtw_free_evt_priv\n")); -+ _rtw_free_evt_priv(pevtpriv); -+ -+} -+ -+void rtw_free_cmd_priv (struct cmd_priv *pcmdpriv) -+{ -+ -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("rtw_free_cmd_priv\n")); -+ _rtw_free_cmd_priv(pcmdpriv); -+ -+} -+ -+int rtw_cmd_filter(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj); -+int rtw_cmd_filter(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj) -+{ -+ u8 bAllow = false; //set to true to allow enqueuing cmd when hw_init_completed is false -+ -+ #ifdef SUPPORT_HW_RFOFF_DETECTED -+ //To decide allow or not -+ if( (pcmdpriv->padapter->pwrctrlpriv.bHWPwrPindetect) -+ &&(!pcmdpriv->padapter->registrypriv.usbss_enable) -+ ) -+ { -+ if(cmd_obj->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra) ) -+ { -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)cmd_obj->parmbuf; -+ if(pdrvextra_cmd_parm->ec_id == POWER_SAVING_CTRL_WK_CID) -+ { -+ //DBG_871X("==>enqueue POWER_SAVING_CTRL_WK_CID\n"); -+ bAllow = true; -+ } -+ } -+ } -+ #endif -+ -+ if(cmd_obj->cmdcode == GEN_CMD_CODE(_SetChannelPlan)) -+ bAllow = true; -+ -+ if( (pcmdpriv->padapter->hw_init_completed ==false && bAllow == false) -+ || pcmdpriv->cmdthd_running== false //com_thread not running -+ ) -+ { -+ //DBG_871X("%s:%s: drop cmdcode:%u, hw_init_completed:%u, cmdthd_running:%u\n", caller_func, __FUNCTION__, -+ // cmd_obj->cmdcode, -+ // pcmdpriv->padapter->hw_init_completed, -+ // pcmdpriv->cmdthd_running -+ //); -+ -+ return _FAIL; -+ } -+ return _SUCCESS; -+} -+ -+ -+ -+u32 rtw_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj) -+{ -+ int res = _FAIL; -+ PADAPTER padapter = pcmdpriv->padapter; -+ -+ -+ -+ if (cmd_obj == NULL) { -+ goto exit; -+ } -+ -+ cmd_obj->padapter = padapter; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ //change pcmdpriv to primary's pcmdpriv -+ if (padapter->adapter_type != PRIMARY_ADAPTER && padapter->pbuddy_adapter) -+ pcmdpriv = &(padapter->pbuddy_adapter->cmdpriv); -+#endif -+ -+ if( _FAIL == (res=rtw_cmd_filter(pcmdpriv, cmd_obj)) ) { -+ rtw_free_cmd_obj(cmd_obj); -+ goto exit; -+ } -+ -+ res = _rtw_enqueue_cmd(&pcmdpriv->cmd_queue, cmd_obj); -+ -+ if(res == _SUCCESS) -+ _rtw_up_sema(&pcmdpriv->cmd_queue_sema); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+struct cmd_obj *rtw_dequeue_cmd(struct cmd_priv *pcmdpriv) -+{ -+ struct cmd_obj *cmd_obj; -+ -+ -+ -+ cmd_obj = _rtw_dequeue_cmd(&pcmdpriv->cmd_queue); -+ -+ -+ return cmd_obj; -+} -+ -+void rtw_cmd_clr_isr(struct cmd_priv *pcmdpriv) -+{ -+ -+ pcmdpriv->cmd_done_cnt++; -+ //_rtw_up_sema(&(pcmdpriv->cmd_done_sema)); -+ -+} -+ -+void rtw_free_cmd_obj(struct cmd_obj *pcmd) -+{ -+ -+ -+ if((pcmd->cmdcode!=_JoinBss_CMD_) &&(pcmd->cmdcode!= _CreateBss_CMD_)) -+ { -+ //free parmbuf in cmd_obj -+ rtw_mfree((unsigned char*)pcmd->parmbuf, pcmd->cmdsz); -+ } -+ -+ if(pcmd->rsp!=NULL) -+ { -+ if(pcmd->rspsz!= 0) -+ { -+ //free rsp in cmd_obj -+ rtw_mfree((unsigned char*)pcmd->rsp, pcmd->rspsz); -+ } -+ } -+ -+ //free cmd_obj -+ rtw_mfree((unsigned char*)pcmd, sizeof(struct cmd_obj)); -+ -+ -+} -+ -+thread_return rtw_cmd_thread(thread_context context) -+{ -+ u8 ret; -+ struct cmd_obj *pcmd; -+ u8 *pcmdbuf, *prspbuf; -+ u8 (*cmd_hdl)(_adapter *padapter, u8* pbuf); -+ void (*pcmd_callback)(_adapter *dev, struct cmd_obj *pcmd); -+ PADAPTER padapter = (PADAPTER)context; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ -+ -+ -+ thread_enter("RTW_CMD_THREAD"); -+ -+ pcmdbuf = pcmdpriv->cmd_buf; -+ prspbuf = pcmdpriv->rsp_buf; -+ -+ pcmdpriv->cmdthd_running=true; -+ _rtw_up_sema(&pcmdpriv->terminate_cmdthread_sema); -+ -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("start r871x rtw_cmd_thread !!!!\n")); -+ -+ while(1) -+ { -+ if (_rtw_down_sema(&pcmdpriv->cmd_queue_sema) == _FAIL) -+ break; -+ -+ if ((padapter->bDriverStopped == true)||(padapter->bSurpriseRemoved == true)) -+ { -+ DBG_871X("%s: DriverStopped(%d) SurpriseRemoved(%d) break at line %d\n", -+ __FUNCTION__, padapter->bDriverStopped, padapter->bSurpriseRemoved, __LINE__); -+ break; -+ } -+ -+#ifdef CONFIG_LPS_LCLK -+ if (rtw_register_cmd_alive(padapter) != _SUCCESS) -+ { -+ RT_TRACE(_module_hal_xmit_c_, _drv_notice_, -+ ("%s: wait to leave LPS_LCLK\n", __FUNCTION__)); -+ continue; -+ } -+#endif -+ -+_next: -+ if ((padapter->bDriverStopped == true)||(padapter->bSurpriseRemoved== true)) -+ { -+ DBG_871X("%s: DriverStopped(%d) SurpriseRemoved(%d) break at line %d\n", -+ __FUNCTION__, padapter->bDriverStopped, padapter->bSurpriseRemoved, __LINE__); -+ break; -+ } -+ -+ if(!(pcmd = rtw_dequeue_cmd(pcmdpriv))) { -+#ifdef CONFIG_LPS_LCLK -+ rtw_unregister_cmd_alive(padapter); -+#endif -+ continue; -+ } -+ -+ if( _FAIL == rtw_cmd_filter(pcmdpriv, pcmd) ) -+ { -+ pcmd->res = H2C_DROPPED; -+ goto post_process; -+ } -+ -+ pcmdpriv->cmd_issued_cnt++; -+ -+ pcmd->cmdsz = _RND4((pcmd->cmdsz));//_RND4 -+ -+ _rtw_memcpy(pcmdbuf, pcmd->parmbuf, pcmd->cmdsz); -+ -+ if(pcmd->cmdcode <= (sizeof(wlancmds) /sizeof(struct cmd_hdl))) -+ { -+ cmd_hdl = wlancmds[pcmd->cmdcode].h2cfuns; -+ -+ if (cmd_hdl) -+ { -+ ret = cmd_hdl(pcmd->padapter, pcmdbuf); -+ pcmd->res = ret; -+ } -+ -+ pcmdpriv->cmd_seq++; -+ } -+ else -+ { -+ pcmd->res = H2C_PARAMETERS_ERROR; -+ } -+ -+ cmd_hdl = NULL; -+ -+post_process: -+ -+ //call callback function for post-processed -+ if(pcmd->cmdcode <= (sizeof(rtw_cmd_callback) /sizeof(struct _cmd_callback))) -+ { -+ pcmd_callback = rtw_cmd_callback[pcmd->cmdcode].callback; -+ if(pcmd_callback == NULL) -+ { -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("mlme_cmd_hdl(): pcmd_callback=0x%p, cmdcode=0x%x\n", pcmd_callback, pcmd->cmdcode)); -+ rtw_free_cmd_obj(pcmd); -+ } -+ else -+ { -+ //todo: !!! fill rsp_buf to pcmd->rsp if (pcmd->rsp!=NULL) -+ pcmd_callback(pcmd->padapter, pcmd);//need conider that free cmd_obj in rtw_cmd_callback -+ } -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("%s: cmdcode=0x%x callback not defined!\n", __FUNCTION__, pcmd->cmdcode)); -+ rtw_free_cmd_obj(pcmd); -+ } -+ -+ flush_signals_thread(); -+ -+ goto _next; -+ -+ } -+ pcmdpriv->cmdthd_running=false; -+ -+ -+ // free all cmd_obj resources -+ do{ -+ pcmd = rtw_dequeue_cmd(pcmdpriv); -+ if(pcmd==NULL){ -+#ifdef CONFIG_LPS_LCLK -+ rtw_unregister_cmd_alive(padapter); -+#endif -+ break; -+ } -+ -+ //DBG_871X("%s: leaving... drop cmdcode:%u\n", __FUNCTION__, pcmd->cmdcode); -+ -+ rtw_free_cmd_obj(pcmd); -+ }while(1); -+ -+ _rtw_up_sema(&pcmdpriv->terminate_cmdthread_sema); -+ -+ -+ -+ thread_exit(); -+ -+} -+ -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+u32 rtw_enqueue_evt(struct evt_priv *pevtpriv, struct evt_obj *obj) -+{ -+ _irqL irqL; -+ int res; -+ _queue *queue = &pevtpriv->evt_queue; -+ -+ -+ -+ res = _SUCCESS; -+ -+ if (obj == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ rtw_list_insert_tail(&obj->list, &queue->queue); -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ //rtw_evt_notify_isr(pevtpriv); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+struct evt_obj *rtw_dequeue_evt(_queue *queue) -+{ -+ _irqL irqL; -+ struct evt_obj *pevtobj; -+ -+ -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ if (rtw_is_list_empty(&(queue->queue))) -+ pevtobj = NULL; -+ else -+ { -+ pevtobj = LIST_CONTAINOR(get_next(&(queue->queue)), struct evt_obj, list); -+ rtw_list_delete(&pevtobj->list); -+ } -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ -+ -+ return pevtobj; -+} -+ -+void rtw_free_evt_obj(struct evt_obj *pevtobj) -+{ -+ -+ -+ if(pevtobj->parmbuf) -+ rtw_mfree((unsigned char*)pevtobj->parmbuf, pevtobj->evtsz); -+ -+ rtw_mfree((unsigned char*)pevtobj, sizeof(struct evt_obj)); -+ -+ -+} -+ -+void rtw_evt_notify_isr(struct evt_priv *pevtpriv) -+{ -+ -+ pevtpriv->evt_done_cnt++; -+ _rtw_up_sema(&(pevtpriv->evt_notify)); -+ -+} -+#endif -+ -+ -+/* -+u8 rtw_setstandby_cmd(unsigned char *adapter) -+*/ -+u8 rtw_setstandby_cmd(_adapter *padapter, uint action) -+{ -+ struct cmd_obj* ph2c; -+ struct usb_suspend_parm* psetusbsuspend; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ -+ u8 ret = _SUCCESS; -+ -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ psetusbsuspend = (struct usb_suspend_parm*)rtw_zmalloc(sizeof(struct usb_suspend_parm)); -+ if (psetusbsuspend == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ psetusbsuspend->action = action; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetusbsuspend, GEN_CMD_CODE(_SetUsbSuspend)); -+ -+ ret = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ -+ return ret; -+} -+ -+/* -+rtw_sitesurvey_cmd(~) -+ ### NOTE:#### (!!!!) -+ MUST TAKE CARE THAT BEFORE CALLING THIS FUNC, YOU SHOULD HAVE LOCKED pmlmepriv->lock -+*/ -+u8 rtw_sitesurvey_cmd(_adapter *padapter, NDIS_802_11_SSID *ssid, int ssid_num, -+ struct rtw_ieee80211_channel *ch, int ch_num) -+{ -+ u8 res = _FAIL; -+ struct cmd_obj *ph2c; -+ struct sitesurvey_parm *psurveyPara; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif //CONFIG_P2P -+ -+ -+ -+#ifdef CONFIG_LPS -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == true){ -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SCAN, 1); -+ } -+#endif -+ -+#ifdef CONFIG_P2P_PS -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { -+ p2p_ps_wk_cmd(padapter, P2P_PS_SCAN, 1); -+ } -+#endif //CONFIG_P2P_PS -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) -+ return _FAIL; -+ -+ psurveyPara = (struct sitesurvey_parm*)rtw_zmalloc(sizeof(struct sitesurvey_parm)); -+ if (psurveyPara == NULL) { -+ rtw_mfree((unsigned char*) ph2c, sizeof(struct cmd_obj)); -+ return _FAIL; -+ } -+ -+ rtw_free_network_queue(padapter, false); -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, ("%s: flush network queue\n", __FUNCTION__)); -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psurveyPara, GEN_CMD_CODE(_SiteSurvey)); -+ -+ /* psurveyPara->bsslimit = 48; */ -+ psurveyPara->scan_mode = pmlmepriv->scan_mode; -+ -+ /* prepare ssid list */ -+ if (ssid) { -+ int i; -+ for (i=0; issid[i], &ssid[i], sizeof(NDIS_802_11_SSID)); -+ psurveyPara->ssid_num++; -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" ssid:(%s, %d)\n", FUNC_ADPT_ARG(padapter), -+ psurveyPara->ssid[i].Ssid, psurveyPara->ssid[i].SsidLength); -+ } -+ } -+ } -+ -+ /* prepare channel list */ -+ if (ch) { -+ int i; -+ for (i=0; ich[i], &ch[i], sizeof(struct rtw_ieee80211_channel)); -+ psurveyPara->ch_num++; -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT" ch:%u\n", FUNC_ADPT_ARG(padapter), -+ psurveyPara->ch[i].hw_value); -+ } -+ } -+ } -+ -+ set_fwstate(pmlmepriv, _FW_UNDER_SURVEY); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+ if(res == _SUCCESS) { -+ -+ pmlmepriv->scan_start_time = rtw_get_current_time(); -+ -+#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+ if((padapter->pbuddy_adapter->mlmeextpriv.mlmext_info.state&0x03) == WIFI_FW_AP_STATE) -+ _set_timer(&pmlmepriv->scan_to_timer, SURVEY_TO * ( 38 + ( 38 / RTW_SCAN_NUM_OF_CH ) * RTW_STAY_AP_CH_MILLISECOND ) + 1000 ); -+ else -+#endif //CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+ _set_timer(&pmlmepriv->scan_to_timer, SCANNING_TIMEOUT); -+ -+ rtw_led_control(padapter, LED_CTL_SITE_SURVEY); -+ -+ pmlmepriv->scan_interval = SCAN_INTERVAL;// 30*2 sec = 60sec -+ } else { -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ } -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_setdatarate_cmd(_adapter *padapter, u8 *rateset) -+{ -+ struct cmd_obj* ph2c; -+ struct setdatarate_parm* pbsetdataratepara; -+ struct cmd_priv* pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pbsetdataratepara = (struct setdatarate_parm*)rtw_zmalloc(sizeof(struct setdatarate_parm)); -+ if (pbsetdataratepara == NULL) { -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pbsetdataratepara, GEN_CMD_CODE(_SetDataRate)); -+#ifdef MP_FIRMWARE_OFFLOAD -+ pbsetdataratepara->curr_rateidx = *(u32*)rateset; -+// _rtw_memcpy(pbsetdataratepara, rateset, sizeof(u32)); -+#else -+ pbsetdataratepara->mac_id = 5; -+ _rtw_memcpy(pbsetdataratepara->datarates, rateset, NumRates); -+#endif -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_setbasicrate_cmd(_adapter *padapter, u8 *rateset) -+{ -+ struct cmd_obj* ph2c; -+ struct setbasicrate_parm* pssetbasicratepara; -+ struct cmd_priv* pcmdpriv=&padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res= _FAIL; -+ goto exit; -+ } -+ pssetbasicratepara = (struct setbasicrate_parm*)rtw_zmalloc(sizeof(struct setbasicrate_parm)); -+ -+ if (pssetbasicratepara == NULL) { -+ rtw_mfree((u8*) ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pssetbasicratepara, _SetBasicRate_CMD_); -+ -+ _rtw_memcpy(pssetbasicratepara->basicrates, rateset, NumRates); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ -+ -+ return res; -+} -+ -+ -+/* -+unsigned char rtw_setphy_cmd(unsigned char *adapter) -+ -+1. be called only after rtw_update_registrypriv_dev_network( ~) or mp testing program -+2. for AdHoc/Ap mode or mp mode? -+ -+*/ -+u8 rtw_setphy_cmd(_adapter *padapter, u8 modem, u8 ch) -+{ -+ struct cmd_obj* ph2c; -+ struct setphy_parm* psetphypara; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+// struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+// struct registry_priv* pregistry_priv = &padapter->registrypriv; -+ u8 res=_SUCCESS; -+ -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ psetphypara = (struct setphy_parm*)rtw_zmalloc(sizeof(struct setphy_parm)); -+ -+ if(psetphypara==NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetphypara, _SetPhy_CMD_); -+ -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("CH=%d, modem=%d", ch, modem)); -+ -+ psetphypara->modem = modem; -+ psetphypara->rfchannel = ch; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ return res; -+} -+ -+u8 rtw_setbbreg_cmd(_adapter*padapter, u8 offset, u8 val) -+{ -+ struct cmd_obj* ph2c; -+ struct writeBB_parm* pwritebbparm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ pwritebbparm = (struct writeBB_parm*)rtw_zmalloc(sizeof(struct writeBB_parm)); -+ -+ if(pwritebbparm==NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pwritebbparm, GEN_CMD_CODE(_SetBBReg)); -+ -+ pwritebbparm->offset = offset; -+ pwritebbparm->value = val; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ return res; -+} -+ -+u8 rtw_getbbreg_cmd(_adapter *padapter, u8 offset, u8 *pval) -+{ -+ struct cmd_obj* ph2c; -+ struct readBB_parm* prdbbparm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res=_FAIL; -+ goto exit; -+ } -+ prdbbparm = (struct readBB_parm*)rtw_zmalloc(sizeof(struct readBB_parm)); -+ -+ if(prdbbparm ==NULL){ -+ rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); -+ return _FAIL; -+ } -+ -+ _rtw_init_listhead(&ph2c->list); -+ ph2c->cmdcode =GEN_CMD_CODE(_GetBBReg); -+ ph2c->parmbuf = (unsigned char *)prdbbparm; -+ ph2c->cmdsz = sizeof(struct readBB_parm); -+ ph2c->rsp = pval; -+ ph2c->rspsz = sizeof(struct readBB_rsp); -+ -+ prdbbparm ->offset = offset; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ return res; -+} -+ -+u8 rtw_setrfreg_cmd(_adapter *padapter, u8 offset, u32 val) -+{ -+ struct cmd_obj* ph2c; -+ struct writeRF_parm* pwriterfparm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ pwriterfparm = (struct writeRF_parm*)rtw_zmalloc(sizeof(struct writeRF_parm)); -+ -+ if(pwriterfparm==NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pwriterfparm, GEN_CMD_CODE(_SetRFReg)); -+ -+ pwriterfparm->offset = offset; -+ pwriterfparm->value = val; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ return res; -+} -+ -+u8 rtw_getrfreg_cmd(_adapter *padapter, u8 offset, u8 *pval) -+{ -+ struct cmd_obj* ph2c; -+ struct readRF_parm* prdrfparm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ prdrfparm = (struct readRF_parm*)rtw_zmalloc(sizeof(struct readRF_parm)); -+ if(prdrfparm ==NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ _rtw_init_listhead(&ph2c->list); -+ ph2c->cmdcode =GEN_CMD_CODE(_GetRFReg); -+ ph2c->parmbuf = (unsigned char *)prdrfparm; -+ ph2c->cmdsz = sizeof(struct readRF_parm); -+ ph2c->rsp = pval; -+ ph2c->rspsz = sizeof(struct readRF_rsp); -+ -+ prdrfparm ->offset = offset; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+void rtw_getbbrfreg_cmdrsp_callback(_adapter* padapter, struct cmd_obj *pcmd) -+{ -+ -+ -+ //rtw_free_cmd_obj(pcmd); -+ rtw_mfree((unsigned char*) pcmd->parmbuf, pcmd->cmdsz); -+ rtw_mfree((unsigned char*) pcmd, sizeof(struct cmd_obj)); -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) -+ padapter->mppriv.workparam.bcompleted= true; -+#endif -+ -+} -+ -+void rtw_readtssi_cmdrsp_callback(_adapter* padapter, struct cmd_obj *pcmd) -+{ -+ -+ -+ rtw_mfree((unsigned char*) pcmd->parmbuf, pcmd->cmdsz); -+ rtw_mfree((unsigned char*) pcmd, sizeof(struct cmd_obj)); -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) -+ padapter->mppriv.workparam.bcompleted= true; -+#endif -+ -+ -+} -+ -+u8 rtw_createbss_cmd(_adapter *padapter) -+{ -+ struct cmd_obj* pcmd; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ WLAN_BSSID_EX *pdev_network = &padapter->registrypriv.dev_network; -+ u8 res=_SUCCESS; -+ -+ -+ -+ rtw_led_control(padapter, LED_CTL_START_TO_LINK); -+ -+ if (pmlmepriv->assoc_ssid.SsidLength == 0){ -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,(" createbss for Any SSid:%s\n",pmlmepriv->assoc_ssid.Ssid)); -+ } else { -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,(" createbss for SSid:%s\n", pmlmepriv->assoc_ssid.Ssid)); -+ } -+ -+ pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmd==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ _rtw_init_listhead(&pcmd->list); -+ pcmd->cmdcode = _CreateBss_CMD_; -+ pcmd->parmbuf = (unsigned char *)pdev_network; -+ pcmd->cmdsz = get_WLAN_BSSID_EX_sz((WLAN_BSSID_EX*)pdev_network); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ pdev_network->Length = pcmd->cmdsz; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ return res; -+} -+ -+u8 rtw_createbss_cmd_ex(_adapter *padapter, unsigned char *pbss, unsigned int sz) -+{ -+ struct cmd_obj* pcmd; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+ -+ -+ pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmd==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ _rtw_init_listhead(&pcmd->list); -+ pcmd->cmdcode = GEN_CMD_CODE(_CreateBss); -+ pcmd->parmbuf = pbss; -+ pcmd->cmdsz = sz; -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network* pnetwork) -+{ -+ u8 *auth, res = _SUCCESS; -+ uint t_len = 0; -+ WLAN_BSSID_EX *psecnetwork; -+ struct cmd_obj *pcmd; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv= &pmlmepriv->qospriv; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+#ifdef CONFIG_80211N_HT -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+#endif //CONFIG_80211N_HT -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+#endif //CONFIG_80211AC_VHT -+ NDIS_802_11_NETWORK_INFRASTRUCTURE ndis_network_mode = pnetwork->network.InfrastructureMode; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ -+ rtw_led_control(padapter, LED_CTL_START_TO_LINK); -+ -+ if (pmlmepriv->assoc_ssid.SsidLength == 0){ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_info_, ("+Join cmd: Any SSid\n")); -+ } else { -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+Join cmd: SSid=[%s]\n", pmlmepriv->assoc_ssid.Ssid)); -+ } -+ -+ pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmd==NULL){ -+ res=_FAIL; -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("rtw_joinbss_cmd: memory allocate for cmd_obj fail!!!\n")); -+ goto exit; -+ } -+ /* // for IEs is pointer -+ t_len = sizeof (u32) + sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + -+ sizeof (NDIS_802_11_SSID) + sizeof (u32) + -+ sizeof (NDIS_802_11_RSSI) + sizeof (NDIS_802_11_NETWORK_TYPE) + -+ sizeof (NDIS_802_11_CONFIGURATION) + -+ sizeof (NDIS_802_11_NETWORK_INFRASTRUCTURE) + -+ sizeof (NDIS_802_11_RATES_EX)+ sizeof(WLAN_PHY_INFO)+ sizeof (u32) + MAX_IE_SZ; -+ */ -+ //for IEs is fix buf size -+ t_len = sizeof(WLAN_BSSID_EX); -+ -+ -+ //for hidden ap to set fw_state here -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) != true) -+ { -+ switch(ndis_network_mode) -+ { -+ case Ndis802_11IBSS: -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ break; -+ -+ case Ndis802_11Infrastructure: -+ set_fwstate(pmlmepriv, WIFI_STATION_STATE); -+ break; -+ -+ case Ndis802_11APMode: -+ case Ndis802_11AutoUnknown: -+ case Ndis802_11InfrastructureMax: -+ break; -+ -+ } -+ } -+ -+ psecnetwork=(WLAN_BSSID_EX *)&psecuritypriv->sec_bss; -+ if(psecnetwork==NULL) -+ { -+ if(pcmd !=NULL) -+ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); -+ -+ res=_FAIL; -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_err_, ("rtw_joinbss_cmd :psecnetwork==NULL!!!\n")); -+ -+ goto exit; -+ } -+ -+ _rtw_memset(psecnetwork, 0, t_len); -+ -+ _rtw_memcpy(psecnetwork, &pnetwork->network, get_WLAN_BSSID_EX_sz(&pnetwork->network)); -+ -+ auth=&psecuritypriv->authenticator_ie[0]; -+ psecuritypriv->authenticator_ie[0]=(unsigned char)psecnetwork->IELength; -+ -+ if((psecnetwork->IELength-12) < (256-1)) { -+ _rtw_memcpy(&psecuritypriv->authenticator_ie[1], &psecnetwork->IEs[12], psecnetwork->IELength-12); -+ } else { -+ _rtw_memcpy(&psecuritypriv->authenticator_ie[1], &psecnetwork->IEs[12], (256-1)); -+ } -+ -+ psecnetwork->IELength = 0; -+ // Added by Albert 2009/02/18 -+ // If the the driver wants to use the bssid to create the connection. -+ // If not, we have to copy the connecting AP's MAC address to it so that -+ // the driver just has the bssid information for PMKIDList searching. -+ -+ if ( pmlmepriv->assoc_by_bssid == false ) -+ { -+ _rtw_memcpy( &pmlmepriv->assoc_bssid[ 0 ], &pnetwork->network.MacAddress[ 0 ], ETH_ALEN ); -+ } -+ -+ psecnetwork->IELength = rtw_restruct_sec_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength); -+ -+ -+ pqospriv->qos_option = 0; -+ -+ if(pregistrypriv->wmm_enable) -+ { -+ u32 tmp_len; -+ -+ tmp_len = rtw_restruct_wmm_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength, psecnetwork->IELength); -+ -+ if (psecnetwork->IELength != tmp_len) -+ { -+ psecnetwork->IELength = tmp_len; -+ pqospriv->qos_option = 1; //There is WMM IE in this corresp. beacon -+ } -+ else -+ { -+ pqospriv->qos_option = 0;//There is no WMM IE in this corresp. beacon -+ } -+ } -+ -+#ifdef CONFIG_80211N_HT -+ phtpriv->ht_option = false; -+ if(pregistrypriv->ht_enable) -+ { -+ // Added by Albert 2010/06/23 -+ // For the WEP mode, we will use the bg mode to do the connection to avoid some IOT issue. -+ // Especially for Realtek 8192u SoftAP. -+ if ( ( padapter->securitypriv.dot11PrivacyAlgrthm != _WEP40_ ) && -+ ( padapter->securitypriv.dot11PrivacyAlgrthm != _WEP104_ ) && -+ ( padapter->securitypriv.dot11PrivacyAlgrthm != _TKIP_ )) -+ { -+ //rtw_restructure_ht_ie -+ rtw_restructure_ht_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], -+ pnetwork->network.IELength, &psecnetwork->IELength); -+ } -+ } -+ -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ pvhtpriv->vht_option = false; -+ if (phtpriv->ht_option && pregistrypriv->vht_enable) { -+ rtw_restructure_vht_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], -+ pnetwork->network.IELength, &psecnetwork->IELength); -+ } -+#endif -+ -+ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->network.IEs, pnetwork->network.IELength); -+ -+ #if 0 -+ psecuritypriv->supplicant_ie[0]=(u8)psecnetwork->IELength; -+ -+ if(psecnetwork->IELength < (256-1)) -+ { -+ _rtw_memcpy(&psecuritypriv->supplicant_ie[1], &psecnetwork->IEs[0], psecnetwork->IELength); -+ } -+ else -+ { -+ _rtw_memcpy(&psecuritypriv->supplicant_ie[1], &psecnetwork->IEs[0], (256-1)); -+ } -+ #endif -+ -+ pcmd->cmdsz = get_WLAN_BSSID_EX_sz(psecnetwork);//get cmdsz before endian conversion -+ -+ _rtw_init_listhead(&pcmd->list); -+ pcmd->cmdcode = _JoinBss_CMD_;//GEN_CMD_CODE(_JoinBss) -+ pcmd->parmbuf = (unsigned char *)psecnetwork; -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ return res; -+} -+ -+u8 rtw_disassoc_cmd(_adapter*padapter, u32 deauth_timeout_ms, bool enqueue) /* for sta_mode */ -+{ -+ struct cmd_obj *cmdobj = NULL; -+ struct disconnect_parm *param = NULL; -+ struct cmd_priv *cmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+rtw_disassoc_cmd\n")); -+ -+ /* prepare cmd parameter */ -+ param = (struct disconnect_parm *)rtw_zmalloc(sizeof(*param)); -+ if (param == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ param->deauth_timeout_ms = deauth_timeout_ms; -+ -+ if (enqueue) { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); -+ if (cmdobj == NULL) { -+ res = _FAIL; -+ rtw_mfree((u8 *)param, sizeof(*param)); -+ goto exit; -+ } -+ init_h2fwcmd_w_parm_no_rsp(cmdobj, param, _DisConnect_CMD_); -+ res = rtw_enqueue_cmd(cmdpriv, cmdobj); -+ } else { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if (H2C_SUCCESS != disconnect_hdl(padapter, (u8 *)param)) -+ res = _FAIL; -+ rtw_mfree((u8 *)param, sizeof(*param)); -+ } -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype) -+{ -+ struct cmd_obj* ph2c; -+ struct setopmode_parm* psetop; -+ -+ struct cmd_priv *pcmdpriv= &padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= false; -+ goto exit; -+ } -+ psetop = (struct setopmode_parm*)rtw_zmalloc(sizeof(struct setopmode_parm)); -+ -+ if(psetop==NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res=false; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetop, _SetOpMode_CMD_); -+ psetop->mode = (u8)networktype; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_setstakey_cmd(_adapter *padapter, u8 *psta, u8 unicast_key) -+{ -+ struct cmd_obj* ph2c; -+ struct set_stakey_parm *psetstakey_para; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ struct set_stakey_rsp *psetstakey_rsp = NULL; -+ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct sta_info* sta = (struct sta_info* )psta; -+ u8 res=_SUCCESS; -+ -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if ( ph2c == NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ psetstakey_para = (struct set_stakey_parm*)rtw_zmalloc(sizeof(struct set_stakey_parm)); -+ if(psetstakey_para==NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res=_FAIL; -+ goto exit; -+ } -+ -+ psetstakey_rsp = (struct set_stakey_rsp*)rtw_zmalloc(sizeof(struct set_stakey_rsp)); -+ if(psetstakey_rsp == NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); -+ res=_FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); -+ ph2c->rsp = (u8 *) psetstakey_rsp; -+ ph2c->rspsz = sizeof(struct set_stakey_rsp); -+ -+ _rtw_memcpy(psetstakey_para->addr, sta->hwaddr,ETH_ALEN); -+ -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE)){ -+#ifdef CONFIG_TDLS -+ if(sta->tdls_sta_state&TDLS_LINKED_STATE) -+ psetstakey_para->algorithm=(u8)sta->dot118021XPrivacy; -+ else -+#endif //CONFIG_TDLS -+ psetstakey_para->algorithm =(unsigned char) psecuritypriv->dot11PrivacyAlgrthm; -+ }else{ -+ GET_ENCRY_ALGO(psecuritypriv, sta, psetstakey_para->algorithm, false); -+ } -+ -+ if (unicast_key == true) { -+#ifdef CONFIG_TDLS -+ if((sta->tdls_sta_state&TDLS_LINKED_STATE)==TDLS_LINKED_STATE) -+ _rtw_memcpy(&psetstakey_para->key, sta->tpk.tk, 16); -+ else -+#endif //CONFIG_TDLS -+ _rtw_memcpy(&psetstakey_para->key, &sta->dot118021x_UncstKey, 16); -+ } else { -+ _rtw_memcpy(&psetstakey_para->key, &psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey, 16); -+ } -+ -+ //jeff: set this becasue at least sw key is ready -+ padapter->securitypriv.busetkipkey=true; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_clearstakey_cmd(_adapter *padapter, u8 *psta, u8 entry, u8 enqueue) -+{ -+ struct cmd_obj* ph2c; -+ struct set_stakey_parm *psetstakey_para; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ struct set_stakey_rsp *psetstakey_rsp = NULL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct sta_info* sta = (struct sta_info* )psta; -+ u8 res=_SUCCESS; -+ -+ -+ -+ if(!enqueue) -+ { -+ clear_cam_entry(padapter, entry); -+ } -+ else -+ { -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if ( ph2c == NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ psetstakey_para = (struct set_stakey_parm*)rtw_zmalloc(sizeof(struct set_stakey_parm)); -+ if(psetstakey_para==NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res=_FAIL; -+ goto exit; -+ } -+ -+ psetstakey_rsp = (struct set_stakey_rsp*)rtw_zmalloc(sizeof(struct set_stakey_rsp)); -+ if(psetstakey_rsp == NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *) psetstakey_para, sizeof(struct set_stakey_parm)); -+ res=_FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); -+ ph2c->rsp = (u8 *) psetstakey_rsp; -+ ph2c->rspsz = sizeof(struct set_stakey_rsp); -+ -+ _rtw_memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN); -+ -+ psetstakey_para->algorithm = _NO_PRIVACY_; -+ -+ psetstakey_para->id = entry; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+ } -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_setrttbl_cmd(_adapter *padapter, struct setratable_parm *prate_table) -+{ -+ struct cmd_obj* ph2c; -+ struct setratable_parm * psetrttblparm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ psetrttblparm = (struct setratable_parm*)rtw_zmalloc(sizeof(struct setratable_parm)); -+ -+ if(psetrttblparm==NULL){ -+ rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetrttblparm, GEN_CMD_CODE(_SetRaTable)); -+ -+ _rtw_memcpy(psetrttblparm,prate_table,sizeof(struct setratable_parm)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ return res; -+ -+} -+ -+u8 rtw_getrttbl_cmd(_adapter *padapter, struct getratable_rsp *pval) -+{ -+ struct cmd_obj* ph2c; -+ struct getratable_parm * pgetrttblparm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ pgetrttblparm = (struct getratable_parm*)rtw_zmalloc(sizeof(struct getratable_parm)); -+ -+ if(pgetrttblparm==NULL){ -+ rtw_mfree((unsigned char *) ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+// init_h2fwcmd_w_parm_no_rsp(ph2c, psetrttblparm, GEN_CMD_CODE(_SetRaTable)); -+ -+ _rtw_init_listhead(&ph2c->list); -+ ph2c->cmdcode =GEN_CMD_CODE(_GetRaTable); -+ ph2c->parmbuf = (unsigned char *)pgetrttblparm; -+ ph2c->cmdsz = sizeof(struct getratable_parm); -+ ph2c->rsp = (u8*)pval; -+ ph2c->rspsz = sizeof(struct getratable_rsp); -+ -+ pgetrttblparm ->rsvd = 0x0; -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ return res; -+ -+} -+ -+u8 rtw_setassocsta_cmd(_adapter *padapter, u8 *mac_addr) -+{ -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct cmd_obj* ph2c; -+ struct set_assocsta_parm *psetassocsta_para; -+ struct set_stakey_rsp *psetassocsta_rsp = NULL; -+ -+ u8 res=_SUCCESS; -+ -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ psetassocsta_para = (struct set_assocsta_parm*)rtw_zmalloc(sizeof(struct set_assocsta_parm)); -+ if(psetassocsta_para==NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ res=_FAIL; -+ goto exit; -+ } -+ -+ psetassocsta_rsp = (struct set_stakey_rsp*)rtw_zmalloc(sizeof(struct set_assocsta_rsp)); -+ if(psetassocsta_rsp==NULL){ -+ rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *) psetassocsta_para, sizeof(struct set_assocsta_parm)); -+ return _FAIL; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psetassocsta_para, _SetAssocSta_CMD_); -+ ph2c->rsp = (u8 *) psetassocsta_rsp; -+ ph2c->rspsz = sizeof(struct set_assocsta_rsp); -+ -+ _rtw_memcpy(psetassocsta_para->addr, mac_addr,ETH_ALEN); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ -+ return res; -+ } -+ -+u8 rtw_addbareq_cmd(_adapter*padapter, u8 tid, u8 *addr) -+{ -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ struct cmd_obj* ph2c; -+ struct addBaReq_parm *paddbareq_parm; -+ -+ u8 res=_SUCCESS; -+ -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ paddbareq_parm = (struct addBaReq_parm*)rtw_zmalloc(sizeof(struct addBaReq_parm)); -+ if(paddbareq_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ paddbareq_parm->tid = tid; -+ _rtw_memcpy(paddbareq_parm->addr, addr, ETH_ALEN); -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, paddbareq_parm, GEN_CMD_CODE(_AddBAReq)); -+ -+ //DBG_871X("rtw_addbareq_cmd, tid=%d\n", tid); -+ -+ //rtw_enqueue_cmd(pcmdpriv, ph2c); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_dynamic_chk_wk_cmd(_adapter*padapter) -+{ -+ struct cmd_obj* ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ u8 res=_SUCCESS; -+ -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->adapter_type != PRIMARY_ADAPTER && padapter->pbuddy_adapter) -+ pcmdpriv = &(padapter->pbuddy_adapter->cmdpriv); -+#endif -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = DYNAMIC_CHK_WK_CID; -+ pdrvextra_cmd_parm->type_size = 0; -+ pdrvextra_cmd_parm->pbuf = (u8 *)padapter; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ -+ //rtw_enqueue_cmd(pcmdpriv, ph2c); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ -+ return res; -+ -+} -+ -+u8 rtw_set_ch_cmd(_adapter*padapter, u8 ch, u8 bw, u8 ch_offset, u8 enqueue) -+{ -+ struct cmd_obj *pcmdobj; -+ struct set_ch_parm *set_ch_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res=_SUCCESS; -+ -+ -+ -+ DBG_871X(FUNC_NDEV_FMT" ch:%u, bw:%u, ch_offset:%u\n", -+ FUNC_NDEV_ARG(padapter->pnetdev), ch, bw, ch_offset); -+ -+ /* check input parameter */ -+ -+ /* prepare cmd parameter */ -+ set_ch_parm = (struct set_ch_parm *)rtw_zmalloc(sizeof(*set_ch_parm)); -+ if (set_ch_parm == NULL) { -+ res= _FAIL; -+ goto exit; -+ } -+ set_ch_parm->ch = ch; -+ set_ch_parm->bw = bw; -+ set_ch_parm->ch_offset = ch_offset; -+ -+ if (enqueue) { -+ /* need enqueue, prepare cmd_obj and enqueue */ -+ pcmdobj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmdobj == NULL){ -+ rtw_mfree((u8 *)set_ch_parm, sizeof(*set_ch_parm)); -+ res=_FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(pcmdobj, set_ch_parm, GEN_CMD_CODE(_SetChannel)); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ } else { -+ /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ -+ if( H2C_SUCCESS !=set_ch_hdl(padapter, (u8 *)set_ch_parm) ) -+ res = _FAIL; -+ -+ rtw_mfree((u8 *)set_ch_parm, sizeof(*set_ch_parm)); -+ } -+ -+ /* do something based on res... */ -+ -+exit: -+ -+ DBG_871X(FUNC_NDEV_FMT" res:%u\n", FUNC_NDEV_ARG(padapter->pnetdev), res); -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_set_chplan_cmd(_adapter*padapter, u8 chplan, u8 enqueue) -+{ -+ struct cmd_obj* pcmdobj; -+ struct SetChannelPlan_param *setChannelPlan_param; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res=_SUCCESS; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+rtw_set_chplan_cmd\n")); -+ -+ //check input parameter -+ if(!rtw_is_channel_plan_valid(chplan)) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ //prepare cmd parameter -+ setChannelPlan_param = (struct SetChannelPlan_param *)rtw_zmalloc(sizeof(struct SetChannelPlan_param)); -+ if(setChannelPlan_param == NULL) { -+ res= _FAIL; -+ goto exit; -+ } -+ setChannelPlan_param->channel_plan=chplan; -+ -+ if(enqueue) -+ { -+ //need enqueue, prepare cmd_obj and enqueue -+ pcmdobj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmdobj == NULL){ -+ rtw_mfree((u8 *)setChannelPlan_param, sizeof(struct SetChannelPlan_param)); -+ res=_FAIL; -+ goto exit; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(pcmdobj, setChannelPlan_param, GEN_CMD_CODE(_SetChannelPlan)); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ } -+ else -+ { -+ //no need to enqueue, do the cmd hdl directly and free cmd parameter -+ if( H2C_SUCCESS !=set_chplan_hdl(padapter, (unsigned char *)setChannelPlan_param) ) -+ res = _FAIL; -+ -+ rtw_mfree((u8 *)setChannelPlan_param, sizeof(struct SetChannelPlan_param)); -+ } -+ -+ //do something based on res... -+ if(res == _SUCCESS) -+ padapter->mlmepriv.ChannelPlan = chplan; -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_led_blink_cmd(_adapter*padapter, void * pLed) -+{ -+ struct cmd_obj* pcmdobj; -+ struct LedBlink_param *ledBlink_param; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res=_SUCCESS; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+rtw_led_blink_cmd\n")); -+ -+ pcmdobj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmdobj == NULL){ -+ res=_FAIL; -+ goto exit; -+ } -+ -+ ledBlink_param = (struct LedBlink_param *)rtw_zmalloc(sizeof(struct LedBlink_param)); -+ if(ledBlink_param == NULL) { -+ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ ledBlink_param->pLed=pLed; -+ -+ init_h2fwcmd_w_parm_no_rsp(pcmdobj, ledBlink_param, GEN_CMD_CODE(_LedBlink)); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_set_csa_cmd(_adapter*padapter, u8 new_ch_no) -+{ -+ struct cmd_obj* pcmdobj; -+ struct SetChannelSwitch_param*setChannelSwitch_param; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res=_SUCCESS; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+rtw_set_csa_cmd\n")); -+ -+ pcmdobj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmdobj == NULL){ -+ res=_FAIL; -+ goto exit; -+ } -+ -+ setChannelSwitch_param = (struct SetChannelSwitch_param *)rtw_zmalloc(sizeof(struct SetChannelSwitch_param)); -+ if(setChannelSwitch_param == NULL) { -+ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ setChannelSwitch_param->new_ch_no=new_ch_no; -+ -+ init_h2fwcmd_w_parm_no_rsp(pcmdobj, setChannelSwitch_param, GEN_CMD_CODE(_SetChannelSwitch)); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_tdls_cmd(_adapter *padapter, u8 *addr, u8 option) -+{ -+ struct cmd_obj* pcmdobj; -+ struct TDLSoption_param *TDLSoption; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res=_SUCCESS; -+ -+ -+ -+#ifdef CONFIG_TDLS -+ -+ RT_TRACE(_module_rtl871x_cmd_c_, _drv_notice_, ("+rtw_set_tdls_cmd\n")); -+ -+ pcmdobj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmdobj == NULL){ -+ res=_FAIL; -+ goto exit; -+ } -+ -+ TDLSoption= (struct TDLSoption_param *)rtw_zmalloc(sizeof(struct TDLSoption_param)); -+ if(TDLSoption == NULL) { -+ rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ _rtw_spinlock(&(padapter->tdlsinfo.cmd_lock)); -+ _rtw_memcpy(TDLSoption->addr, addr, 6); -+ TDLSoption->option = option; -+ _rtw_spinunlock(&(padapter->tdlsinfo.cmd_lock)); -+ init_h2fwcmd_w_parm_no_rsp(pcmdobj, TDLSoption, GEN_CMD_CODE(_TDLS)); -+ res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -+ -+#endif //CONFIG_TDLS -+ -+exit: -+ -+ -+ -+ -+ return res; -+} -+ -+static void traffic_status_watchdog(_adapter *padapter) -+{ -+#ifdef CONFIG_LPS -+ u8 bEnterPS; -+#endif -+ u16 BusyThreshold = 100; -+ u8 bBusyTraffic = false, bTxBusyTraffic = false, bRxBusyTraffic = false; -+ u8 bHigherBusyTraffic = false, bHigherBusyRxTraffic = false, bHigherBusyTxTraffic = false; -+#ifdef CONFIG_FTP_PROTECT -+ u16 bPktCount = 0; -+#endif -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &(padapter->tdlsinfo); -+#endif //CONFIG_TDLS -+ -+ // -+ // Determine if our traffic is busy now -+ // -+ if((check_fwstate(pmlmepriv, _FW_LINKED)== true) -+ /*&& !MgntInitAdapterInProgress(pMgntInfo)*/) -+ { -+ -+#ifdef CONFIG_BT_COEXIST -+ if( pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > 50 || -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > 50 ) -+#else // !CONFIG_BT_COEXIST -+ // if we raise bBusyTraffic in last watchdog, using lower threshold. -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ BusyThreshold = 75; -+ if( pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > BusyThreshold || -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > BusyThreshold ) -+#endif // !CONFIG_BT_COEXIST -+ { -+ bBusyTraffic = true; -+ -+ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) -+ bRxBusyTraffic = true; -+ else -+ bTxBusyTraffic = true; -+ } -+ -+ // Higher Tx/Rx data. -+ if( pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > 4000 || -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > 4000 ) -+ { -+ bHigherBusyTraffic = true; -+ -+ if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) -+ bHigherBusyRxTraffic = true; -+ else -+ bHigherBusyTxTraffic = true; -+ } -+ -+#ifdef CONFIG_FTP_PROTECT -+ DBG_871X("RX in period:%d, TX in period:%d, ftp_lock_flag:%d\n", -+ pmlmepriv->LinkDetectInfo.NumRxOkInPeriod, -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, -+ pmlmepriv->ftp_lock_flag); -+ -+ bPktCount = pmlmepriv->LinkDetectInfo.NumRxOkInPeriod + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod; -+ if (bPktCount > 20 && !pmlmepriv->ftp_lock_flag) { -+ pmlmepriv->ftp_lock_flag = 1; -+ rtw_lock_suspend(); -+ } else if(bPktCount == 0 && pmlmepriv->ftp_lock_flag) { -+ pmlmepriv->ftp_lock_flag = 0; -+ rtw_unlock_suspend(); -+ } -+#endif //CONFIG_KEEP_FTP_TRANSMIT -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_TDLS_AUTOSETUP -+ if( ( ptdlsinfo->watchdog_count % TDLS_WATCHDOG_PERIOD ) == 0 ) //10 * 2sec, periodically sending -+ issue_tdls_dis_req( padapter, NULL ); -+ ptdlsinfo->watchdog_count++; -+#endif //CONFIG_TDLS_AUTOSETUP -+#endif //CONFIG_TDLS -+ -+#ifdef CONFIG_LPS -+#ifdef CONFIG_BT_COEXIST -+ if (BT_1Ant(padapter) == false) -+#endif -+ { -+ // check traffic for powersaving. -+ if( ((pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) > 8 ) || -+ (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 2) ) -+ { -+ //DBG_871X("Tx = %d, Rx = %d \n",pmlmepriv->LinkDetectInfo.NumTxOkInPeriod,pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); -+ bEnterPS= false; -+ } -+ else -+ { -+ bEnterPS= true; -+ } -+ -+ // LeisurePS only work in infra mode. -+ if(bEnterPS) -+ { -+ LPS_Enter(padapter); -+ } -+ else -+ { -+ LPS_Leave(padapter); -+ } -+ } -+#endif // CONFIG_LPS -+ } -+ else -+ { -+#ifdef CONFIG_LPS -+ LPS_Leave(padapter); -+#endif -+ } -+ -+ pmlmepriv->LinkDetectInfo.NumRxOkInPeriod = 0; -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod = 0; -+ pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod = 0; -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = bBusyTraffic; -+ pmlmepriv->LinkDetectInfo.bTxBusyTraffic = bTxBusyTraffic; -+ pmlmepriv->LinkDetectInfo.bRxBusyTraffic = bRxBusyTraffic; -+ pmlmepriv->LinkDetectInfo.bHigherBusyTraffic = bHigherBusyTraffic; -+ pmlmepriv->LinkDetectInfo.bHigherBusyRxTraffic = bHigherBusyRxTraffic; -+ pmlmepriv->LinkDetectInfo.bHigherBusyTxTraffic = bHigherBusyTxTraffic; -+} -+ -+void dynamic_chk_wk_hdl(_adapter *padapter, u8 *pbuf, int sz); -+void dynamic_chk_wk_hdl(_adapter *padapter, u8 *pbuf, int sz) -+{ -+ struct mlme_priv *pmlmepriv; -+ -+ padapter = (_adapter *)pbuf; -+ pmlmepriv = &(padapter->mlmepriv); -+ -+#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+#ifdef CONFIG_AP_MODE -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ expire_timeout_chk(padapter); -+ } -+#endif -+#endif //CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ rtw_hal_sreset_xmit_status_check(padapter); -+ #endif -+ -+ //if(check_fwstate(pmlmepriv, _FW_UNDER_LINKING|_FW_UNDER_SURVEY)==false) -+ { -+ linked_status_chk(padapter); -+ traffic_status_watchdog(padapter); -+ } -+ -+ rtw_hal_dm_watchdog(padapter); -+ -+ //check_hw_pbc(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->type_size); -+ -+#ifdef CONFIG_BT_COEXIST -+ // -+ // BT-Coexist -+ // -+ BT_CoexistMechanism(padapter); -+#endif -+} -+ -+#ifdef CONFIG_LPS -+ -+void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type); -+void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type) -+{ -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 mstatus; -+ -+ -+ -+ if((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) -+ || (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true)) -+ { -+ return; -+ } -+ -+ switch(lps_ctrl_type) -+ { -+ case LPS_CTRL_SCAN: -+ //DBG_871X("LPS_CTRL_SCAN \n"); -+#ifdef CONFIG_BT_COEXIST -+ BT_WifiScanNotify(padapter, true); -+ if (BT_1Ant(padapter) == false) -+#endif -+ { -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ { //connect -+ LPS_Leave(padapter); -+ } -+ } -+ break; -+ case LPS_CTRL_JOINBSS: -+ //DBG_871X("LPS_CTRL_JOINBSS \n"); -+ LPS_Leave(padapter); -+ break; -+ case LPS_CTRL_CONNECT: -+ //DBG_871X("LPS_CTRL_CONNECT \n"); -+ mstatus = 1;//connect -+ // Reset LPS Setting -+ padapter->pwrctrlpriv.LpsIdleCount = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); -+#ifdef CONFIG_BT_COEXIST -+ BT_WifiMediaStatusNotify(padapter, mstatus); -+#endif -+ break; -+ case LPS_CTRL_DISCONNECT: -+ //DBG_871X("LPS_CTRL_DISCONNECT \n"); -+ mstatus = 0;//disconnect -+#ifdef CONFIG_BT_COEXIST -+ BT_WifiMediaStatusNotify(padapter, mstatus); -+ if (BT_1Ant(padapter) == false) -+#endif -+ { -+ LPS_Leave(padapter); -+ } -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); -+ break; -+ case LPS_CTRL_SPECIAL_PACKET: -+ //DBG_871X("LPS_CTRL_SPECIAL_PACKET \n"); -+ pwrpriv->DelayLPSLastTimeStamp = rtw_get_current_time(); -+#ifdef CONFIG_BT_COEXIST -+ BT_SpecialPacketNotify(padapter); -+ if (BT_1Ant(padapter) == false) -+#endif -+ { -+ LPS_Leave(padapter); -+ } -+ break; -+ case LPS_CTRL_LEAVE: -+ //DBG_871X("LPS_CTRL_LEAVE \n"); -+#ifdef CONFIG_BT_COEXIST -+ BT_LpsLeave(padapter); -+ if (BT_1Ant(padapter) == false) -+#endif -+ { -+ LPS_Leave(padapter); -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ -+} -+ -+u8 rtw_lps_ctrl_wk_cmd(_adapter*padapter, u8 lps_ctrl_type, u8 enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ //struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; -+ u8 res = _SUCCESS; -+ -+ -+ -+ //if(!pwrctrlpriv->bLeisurePs) -+ // return res; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->iface_type != IFACE_PORT0) -+ return res; -+#endif -+ -+ if(enqueue) -+ { -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = LPS_CTRL_WK_CID; -+ pdrvextra_cmd_parm->type_size = lps_ctrl_type; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } -+ else -+ { -+ lps_ctrl_wk_hdl(padapter, lps_ctrl_type); -+ } -+ -+exit: -+ -+ -+ -+ return res; -+ -+} -+ -+#endif -+ -+#if (RATE_ADAPTIVE_SUPPORT==1) -+void rpt_timer_setting_wk_hdl(_adapter *padapter, u16 minRptTime) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_RPT_TIMER_SETTING, (u8 *)(&minRptTime)); -+} -+ -+u8 rtw_rpt_timer_cfg_cmd(_adapter*padapter, u16 minRptTime) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res = _SUCCESS; -+ -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = RTP_TIMER_CFG_WK_CID; -+ pdrvextra_cmd_parm->type_size = minRptTime; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+exit: -+ -+ -+ -+ return res; -+ -+} -+ -+#endif -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+void antenna_select_wk_hdl(_adapter *padapter, u8 antenna) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_ANTENNA_DIVERSITY_SELECT, (u8 *)(&antenna)); -+} -+ -+u8 rtw_antenna_select_cmd(_adapter*padapter, u8 antenna,u8 enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 bSupportAntDiv = false; -+ u8 res = _SUCCESS; -+ -+ -+ rtw_hal_get_def_var(padapter, HAL_DEF_IS_SUPPORT_ANT_DIV, &(bSupportAntDiv)); -+ if(false == bSupportAntDiv ) return res; -+ -+ if(true == enqueue) -+ { -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = ANT_SELECT_WK_CID; -+ pdrvextra_cmd_parm->type_size = antenna; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } -+ else{ -+ antenna_select_wk_hdl(padapter,antenna ); -+ } -+exit: -+ -+ -+ -+ return res; -+ -+} -+#endif -+ -+void power_saving_wk_hdl(_adapter *padapter, u8 *pbuf, int sz); -+void power_saving_wk_hdl(_adapter *padapter, u8 *pbuf, int sz) -+{ -+ rtw_ps_processor(padapter); -+} -+ -+#ifdef CONFIG_P2P -+u8 p2p_protocol_wk_cmd(_adapter*padapter, int intCmdType ) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ return res; -+ } -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = P2P_PROTO_WK_CID; -+ pdrvextra_cmd_parm->type_size = intCmdType; // As the command tppe. -+ pdrvextra_cmd_parm->pbuf = NULL; // Must be NULL here -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ -+ -+ return res; -+ -+} -+#endif //CONFIG_P2P -+ -+u8 rtw_ps_cmd(_adapter*padapter) -+{ -+ struct cmd_obj *ppscmd; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ u8 res = _SUCCESS; -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ goto exit; -+#endif -+ -+ ppscmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ppscmd==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ppscmd, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = POWER_SAVING_CTRL_WK_CID; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ init_h2fwcmd_w_parm_no_rsp(ppscmd, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ppscmd); -+ -+exit: -+ -+ -+ -+ return res; -+ -+} -+ -+#ifdef CONFIG_AP_MODE -+ -+static void rtw_chk_hi_queue_hdl(_adapter *padapter) -+{ -+ int cnt=0; -+ struct sta_info *psta_bmc; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ if(!psta_bmc) -+ return; -+ -+ if(psta_bmc->sleepq_len==0) -+ { -+ u8 val = 0; -+ -+ //while((rtw_read32(padapter, 0x414)&0x00ffff00)!=0) -+ //while((rtw_read32(padapter, 0x414)&0x0000ff00)!=0) -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &val); -+ -+ while(false == val) -+ { -+ rtw_msleep_os(100); -+ -+ cnt++; -+ -+ if(cnt>10) -+ break; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &val); -+ } -+ -+ if(cnt<=10) -+ { -+ pstapriv->tim_bitmap &= ~BIT(0); -+ pstapriv->sta_dz_bitmap &= ~BIT(0); -+ -+ update_beacon(padapter, _TIM_IE_, NULL, false); -+ } -+ else //re check again -+ { -+ rtw_chk_hi_queue_cmd(padapter); -+ } -+ -+ } -+ -+} -+ -+u8 rtw_chk_hi_queue_cmd(_adapter*padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = CHECK_HIQ_WK_CID; -+ pdrvextra_cmd_parm->type_size = 0; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+ -+} -+#endif -+ -+u8 rtw_c2h_wk_cmd(PADAPTER padapter, u8 *c2h_evt) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if (ph2c == NULL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if (pdrvextra_cmd_parm == NULL) { -+ rtw_mfree((u8*)ph2c, sizeof(struct cmd_obj)); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = C2H_WK_CID; -+ pdrvextra_cmd_parm->type_size = c2h_evt?16:0; -+ pdrvextra_cmd_parm->pbuf = c2h_evt; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+exit: -+ -+ return res; -+} -+ -+static s32 c2h_evt_hdl(_adapter *adapter, struct c2h_evt_hdr *c2h_evt, c2h_id_filter filter) -+{ -+ s32 ret = _FAIL; -+ u8 buf[16]; -+ -+ if (!c2h_evt) { -+ /* No c2h event in cmd_obj, read c2h event before handling*/ -+ if (c2h_evt_read(adapter, buf) == _SUCCESS) { -+ c2h_evt = (struct c2h_evt_hdr *)buf; -+ -+ if (filter && filter(c2h_evt->id) == false) -+ goto exit; -+ -+ ret = rtw_hal_c2h_handler(adapter, c2h_evt); -+ } -+ } else { -+ -+ if (filter && filter(c2h_evt->id) == false) -+ goto exit; -+ -+ ret = rtw_hal_c2h_handler(adapter, c2h_evt); -+ } -+exit: -+ return ret; -+} -+ -+#ifdef CONFIG_C2H_WK -+static void c2h_wk_callback(_workitem *work) -+{ -+ struct evt_priv *evtpriv = container_of(work, struct evt_priv, c2h_wk); -+ _adapter *adapter = container_of(evtpriv, _adapter, evtpriv); -+ struct c2h_evt_hdr *c2h_evt; -+ c2h_id_filter ccx_id_filter = rtw_hal_c2h_id_filter_ccx(adapter); -+ -+ evtpriv->c2h_wk_alive = true; -+ -+ while (!rtw_cbuf_empty(evtpriv->c2h_queue)) { -+ if ((c2h_evt = (struct c2h_evt_hdr *)rtw_cbuf_pop(evtpriv->c2h_queue)) != NULL) { -+ /* This C2H event is read, clear it */ -+ c2h_evt_clear(adapter); -+ } else if ((c2h_evt = (struct c2h_evt_hdr *)rtw_malloc(16)) != NULL) { -+ /* This C2H event is not read, read & clear now */ -+ if (c2h_evt_read(adapter, (u8*)c2h_evt) != _SUCCESS) -+ continue; -+ } -+ -+ /* Special pointer to trigger c2h_evt_clear only */ -+ if ((void *)c2h_evt == (void *)evtpriv) -+ continue; -+ -+ if (!c2h_evt_exist(c2h_evt)) { -+ rtw_mfree((u8*)c2h_evt, 16); -+ continue; -+ } -+ -+ if (ccx_id_filter(c2h_evt->id) == true) { -+ /* Handle CCX report here */ -+ rtw_hal_c2h_handler(adapter, c2h_evt); -+ rtw_mfree((u8*)c2h_evt, 16); -+ } else { -+ /* Enqueue into cmd_thread for others */ -+ rtw_c2h_wk_cmd(adapter, (u8 *)c2h_evt); -+ } -+ } -+ -+ evtpriv->c2h_wk_alive = false; -+} -+#endif -+ -+u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct drvextra_cmd_parm *pdrvextra_cmd; -+ -+ if(!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ pdrvextra_cmd = (struct drvextra_cmd_parm*)pbuf; -+ -+ switch(pdrvextra_cmd->ec_id) -+ { -+ case DYNAMIC_CHK_WK_CID: -+ dynamic_chk_wk_hdl(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->type_size); -+ break; -+ case POWER_SAVING_CTRL_WK_CID: -+ power_saving_wk_hdl(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->type_size); -+ break; -+#ifdef CONFIG_LPS -+ case LPS_CTRL_WK_CID: -+ lps_ctrl_wk_hdl(padapter, (u8)pdrvextra_cmd->type_size); -+ break; -+#endif -+#if (RATE_ADAPTIVE_SUPPORT==1) -+ case RTP_TIMER_CFG_WK_CID: -+ rpt_timer_setting_wk_hdl(padapter, pdrvextra_cmd->type_size); -+ break; -+#endif -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ case ANT_SELECT_WK_CID: -+ antenna_select_wk_hdl(padapter, pdrvextra_cmd->type_size); -+ break; -+#endif -+#ifdef CONFIG_P2P_PS -+ case P2P_PS_WK_CID: -+ p2p_ps_wk_hdl(padapter, pdrvextra_cmd->type_size); -+ break; -+#endif // CONFIG_P2P_PS -+ case P2P_PROTO_WK_CID: -+ // Commented by Albert 2011/07/01 -+ // I used the type_size as the type command -+ p2p_protocol_wk_hdl( padapter, pdrvextra_cmd->type_size ); -+ break; -+#ifdef CONFIG_AP_MODE -+ case CHECK_HIQ_WK_CID: -+ rtw_chk_hi_queue_hdl(padapter); -+ break; -+#endif //CONFIG_AP_MODE -+#ifdef CONFIG_INTEL_WIDI -+ case INTEl_WIDI_WK_CID: -+ intel_widi_wk_hdl(padapter, pdrvextra_cmd->type_size, pdrvextra_cmd->pbuf); -+ break; -+#endif //CONFIG_INTEL_WIDI -+ -+ case C2H_WK_CID: -+ c2h_evt_hdl(padapter, (struct c2h_evt_hdr *)pdrvextra_cmd->pbuf, NULL); -+ break; -+ -+ default: -+ break; -+ } -+ -+ if (pdrvextra_cmd->pbuf && pdrvextra_cmd->type_size>0) -+ { -+ rtw_mfree(pdrvextra_cmd->pbuf, pdrvextra_cmd->type_size); -+ } -+ -+ return H2C_SUCCESS; -+} -+ -+void rtw_survey_cmd_callback(_adapter* padapter , struct cmd_obj *pcmd) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ -+ if(pcmd->res == H2C_DROPPED) -+ { -+ //TODO: cancel timer and do timeout handler directly... -+ //need to make timeout handlerOS independent -+ _set_timer(&pmlmepriv->scan_to_timer, 1); -+ } -+ else if (pcmd->res != H2C_SUCCESS) { -+ _set_timer(&pmlmepriv->scan_to_timer, 1); -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\n ********Error: MgntActrtw_set_802_11_bssid_LIST_SCAN Fail ************\n\n.")); -+ } -+ -+ // free cmd -+ rtw_free_cmd_obj(pcmd); -+ -+ -+} -+void rtw_disassoc_cmd_callback(_adapter* padapter, struct cmd_obj *pcmd) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ -+ if (pcmd->res != H2C_SUCCESS) -+ { -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ set_fwstate(pmlmepriv, _FW_LINKED); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\n ***Error: disconnect_cmd_callback Fail ***\n.")); -+ -+ return; -+ } -+#ifdef CONFIG_BR_EXT -+ else //clear bridge database -+ nat25_db_cleanup(padapter); -+#endif //CONFIG_BR_EXT -+ -+ // free cmd -+ rtw_free_cmd_obj(pcmd); -+} -+ -+void rtw_joinbss_cmd_callback(_adapter* padapter, struct cmd_obj *pcmd) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ -+ if(pcmd->res == H2C_DROPPED) -+ { -+ //TODO: cancel timer and do timeout handler directly... -+ //need to make timeout handlerOS independent -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ } -+ else if(pcmd->res != H2C_SUCCESS) -+ { -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("********Error:rtw_select_and_join_from_scanned_queue Wait Sema Fail ************\n")); -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ } -+ -+ rtw_free_cmd_obj(pcmd); -+ -+ -+} -+ -+void rtw_createbss_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd) -+{ -+ _irqL irqL; -+ u8 timer_cancelled; -+ struct sta_info *psta = NULL; -+ struct wlan_network *pwlan = NULL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)pcmd->parmbuf; -+ struct wlan_network *tgt_network = &(pmlmepriv->cur_network); -+ -+ -+ -+ if((pcmd->res != H2C_SUCCESS)) -+ { -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\n ********Error: rtw_createbss_cmd_callback Fail ************\n\n.")); -+ _set_timer(&pmlmepriv->assoc_timer, 1 ); -+ } -+ -+ _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled); -+ -+#ifdef CONFIG_FW_MLMLE -+ //endian_convert -+ pnetwork->Length = le32_to_cpu(pnetwork->Length); -+ pnetwork->Ssid.SsidLength = le32_to_cpu(pnetwork->Ssid.SsidLength); -+ pnetwork->Privacy =le32_to_cpu(pnetwork->Privacy); -+ pnetwork->Rssi = le32_to_cpu(pnetwork->Rssi); -+ pnetwork->NetworkTypeInUse =le32_to_cpu(pnetwork->NetworkTypeInUse); -+ pnetwork->Configuration.ATIMWindow = le32_to_cpu(pnetwork->Configuration.ATIMWindow); -+ //pnetwork->Configuration.BeaconPeriod = le32_to_cpu(pnetwork->Configuration.BeaconPeriod); -+ pnetwork->Configuration.DSConfig =le32_to_cpu(pnetwork->Configuration.DSConfig); -+ pnetwork->Configuration.FHConfig.DwellTime=le32_to_cpu(pnetwork->Configuration.FHConfig.DwellTime); -+ pnetwork->Configuration.FHConfig.HopPattern=le32_to_cpu(pnetwork->Configuration.FHConfig.HopPattern); -+ pnetwork->Configuration.FHConfig.HopSet=le32_to_cpu(pnetwork->Configuration.FHConfig.HopSet); -+ pnetwork->Configuration.FHConfig.Length=le32_to_cpu(pnetwork->Configuration.FHConfig.Length); -+ pnetwork->Configuration.Length = le32_to_cpu(pnetwork->Configuration.Length); -+ pnetwork->InfrastructureMode = le32_to_cpu(pnetwork->InfrastructureMode); -+ pnetwork->IELength = le32_to_cpu(pnetwork->IELength); -+#endif -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) ) -+ { -+ psta = rtw_get_stainfo(&padapter->stapriv, pnetwork->MacAddress); -+ if(!psta) -+ { -+ psta = rtw_alloc_stainfo(&padapter->stapriv, pnetwork->MacAddress); -+ if (psta == NULL) -+ { -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\nCan't alloc sta_info when createbss_cmd_callback\n")); -+ goto createbss_cmd_fail ; -+ } -+ } -+ -+ rtw_indicate_connect( padapter); -+ } -+ else -+ { -+ _irqL irqL; -+ -+ pwlan = _rtw_alloc_network(pmlmepriv); -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ if ( pwlan == NULL) -+ { -+ pwlan = rtw_get_oldest_wlan_network(&pmlmepriv->scanned_queue); -+ if( pwlan == NULL) -+ { -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\n Error: can't get pwlan in rtw_joinbss_event_callback \n")); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ goto createbss_cmd_fail; -+ } -+ pwlan->last_scanned = rtw_get_current_time(); -+ } -+ else -+ { -+ rtw_list_insert_tail(&(pwlan->list), &pmlmepriv->scanned_queue.queue); -+ } -+ -+ pnetwork->Length = get_WLAN_BSSID_EX_sz(pnetwork); -+ _rtw_memcpy(&(pwlan->network), pnetwork, pnetwork->Length); -+ //pwlan->fixed = true; -+ -+ //rtw_list_insert_tail(&(pwlan->list), &pmlmepriv->scanned_queue.queue); -+ -+ // copy pdev_network information to pmlmepriv->cur_network -+ _rtw_memcpy(&tgt_network->network, pnetwork, (get_WLAN_BSSID_EX_sz(pnetwork))); -+ -+ // reset DSConfig -+ //tgt_network->network.Configuration.DSConfig = (u32)rtw_ch2freq(pnetwork->Configuration.DSConfig); -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+#if 0 -+ if((pmlmepriv->fw_state) & WIFI_AP_STATE) -+ { -+ psta = rtw_alloc_stainfo(&padapter->stapriv, pnetwork->MacAddress); -+ -+ if (psta == NULL) { // for AP Mode & Adhoc Master Mode -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\nCan't alloc sta_info when createbss_cmd_callback\n")); -+ goto createbss_cmd_fail ; -+ } -+ -+ rtw_indicate_connect( padapter); -+ } -+ else { -+ -+ //rtw_indicate_disconnect(dev); -+ } -+#endif -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ // we will set _FW_LINKED when there is one more sat to join us (rtw_stassoc_event_callback) -+ -+ } -+ -+createbss_cmd_fail: -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ rtw_free_cmd_obj(pcmd); -+ -+ -+ -+} -+ -+ -+ -+void rtw_setstaKey_cmdrsp_callback(_adapter* padapter , struct cmd_obj *pcmd) -+{ -+ -+ struct sta_priv * pstapriv = &padapter->stapriv; -+ struct set_stakey_rsp* psetstakey_rsp = (struct set_stakey_rsp*) (pcmd->rsp); -+ struct sta_info* psta = rtw_get_stainfo(pstapriv, psetstakey_rsp->addr); -+ -+ -+ -+ if(psta==NULL) -+ { -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\nERROR: rtw_setstaKey_cmdrsp_callback => can't get sta_info \n\n")); -+ goto exit; -+ } -+ -+ //psta->aid = psta->mac_id = psetstakey_rsp->keyid; //CAM_ID(CAM_ENTRY) -+ -+exit: -+ -+ rtw_free_cmd_obj(pcmd); -+ -+ -+ -+} -+void rtw_setassocsta_cmdrsp_callback(_adapter* padapter, struct cmd_obj *pcmd) -+{ -+ _irqL irqL; -+ struct sta_priv * pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct set_assocsta_parm* passocsta_parm = (struct set_assocsta_parm*)(pcmd->parmbuf); -+ struct set_assocsta_rsp* passocsta_rsp = (struct set_assocsta_rsp*) (pcmd->rsp); -+ struct sta_info* psta = rtw_get_stainfo(pstapriv, passocsta_parm->addr); -+ -+ -+ -+ if(psta==NULL) -+ { -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\nERROR: setassocsta_cmdrsp_callbac => can't get sta_info \n\n")); -+ goto exit; -+ } -+ -+ psta->aid = psta->mac_id = passocsta_rsp->cam_id; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) && (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true)) -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+ set_fwstate(pmlmepriv, _FW_LINKED); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+exit: -+ rtw_free_cmd_obj(pcmd); -+ -+ -+} -+ -+void rtw_getrttbl_cmd_cmdrsp_callback(_adapter* padapter, struct cmd_obj *pcmd); -+void rtw_getrttbl_cmd_cmdrsp_callback(_adapter* padapter, struct cmd_obj *pcmd) -+{ -+ -+ -+ rtw_free_cmd_obj(pcmd); -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) -+ padapter->mppriv.workparam.bcompleted=true; -+#endif -+ -+ -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_debug.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_debug.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_debug.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_debug.c 2018-02-06 17:42:30.693966912 +0200 -@@ -0,0 +1,1209 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_DEBUG_C_ -+ -+#include -+ -+#ifdef CONFIG_DEBUG_RTL871X -+ -+ u32 GlobalDebugLevel = _drv_err_; -+ -+ u64 GlobalDebugComponents = \ -+ _module_rtl871x_xmit_c_ | -+ _module_xmit_osdep_c_ | -+ _module_rtl871x_recv_c_ | -+ _module_recv_osdep_c_ | -+ _module_rtl871x_mlme_c_ | -+ _module_mlme_osdep_c_ | -+ _module_rtl871x_sta_mgt_c_ | -+ _module_rtl871x_cmd_c_ | -+ _module_cmd_osdep_c_ | -+ _module_rtl871x_io_c_ | -+ _module_io_osdep_c_ | -+ _module_os_intfs_c_| -+ _module_rtl871x_security_c_| -+ _module_rtl871x_eeprom_c_| -+ _module_hal_init_c_| -+ _module_hci_hal_init_c_| -+ _module_rtl871x_ioctl_c_| -+ _module_rtl871x_ioctl_set_c_| -+ _module_rtl871x_ioctl_query_c_| -+ _module_rtl871x_pwrctrl_c_| -+ _module_hci_intfs_c_| -+ _module_hci_ops_c_| -+ _module_hci_ops_os_c_| -+ _module_rtl871x_ioctl_os_c| -+ _module_rtl8712_cmd_c_| -+ _module_hal_xmit_c_| -+ _module_rtl8712_recv_c_ | -+ _module_mp_ | -+ _module_efuse_; -+ -+#endif -+ -+#ifdef CONFIG_PROC_DEBUG -+#include -+ -+int proc_get_drv_version(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ -+ int len = 0; -+ -+ len += snprintf(page + len, count - len, "%s\n", DRIVERVERSION); -+ -+ *eof = 1; -+ return len; -+} -+ -+int proc_get_write_reg(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ *eof = 1; -+ return 0; -+} -+ -+int proc_set_write_reg(struct file *file, const char *buffer, -+ unsigned long count, void *data) -+{ -+ struct net_device *dev = (struct net_device *)data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 addr, val, len; -+ -+ if (count < 3) -+ { -+ DBG_871X("argument size is less than 3\n"); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x %x %x", &addr, &val, &len); -+ -+ if (num != 3) { -+ DBG_871X("invalid write_reg parameter!\n"); -+ return count; -+ } -+ -+ switch(len) -+ { -+ case 1: -+ rtw_write8(padapter, addr, (u8)val); -+ break; -+ case 2: -+ rtw_write16(padapter, addr, (u16)val); -+ break; -+ case 4: -+ rtw_write32(padapter, addr, val); -+ break; -+ default: -+ DBG_871X("error write length=%d", len); -+ break; -+ } -+ -+ } -+ -+ return count; -+ -+} -+ -+static u32 proc_get_read_addr=0xeeeeeeee; -+static u32 proc_get_read_len=0x4; -+ -+int proc_get_read_reg(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ int len = 0; -+ -+ if(proc_get_read_addr==0xeeeeeeee) -+ { -+ *eof = 1; -+ return len; -+ } -+ -+ switch(proc_get_read_len) -+ { -+ case 1: -+ len += snprintf(page + len, count - len, "rtw_read8(0x%x)=0x%x\n", proc_get_read_addr, rtw_read8(padapter, proc_get_read_addr)); -+ break; -+ case 2: -+ len += snprintf(page + len, count - len, "rtw_read16(0x%x)=0x%x\n", proc_get_read_addr, rtw_read16(padapter, proc_get_read_addr)); -+ break; -+ case 4: -+ len += snprintf(page + len, count - len, "rtw_read32(0x%x)=0x%x\n", proc_get_read_addr, rtw_read32(padapter, proc_get_read_addr)); -+ break; -+ default: -+ len += snprintf(page + len, count - len, "error read length=%d\n", proc_get_read_len); -+ break; -+ } -+ -+ *eof = 1; -+ return len; -+ -+} -+ -+int proc_set_read_reg(struct file *file, const char *buffer, -+ unsigned long count, void *data) -+{ -+ char tmp[16]; -+ u32 addr, len; -+ -+ if (count < 2) -+ { -+ DBG_871X("argument size is less than 2\n"); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x %x", &addr, &len); -+ -+ if (num != 2) { -+ DBG_871X("invalid read_reg parameter!\n"); -+ return count; -+ } -+ -+ proc_get_read_addr = addr; -+ -+ proc_get_read_len = len; -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_fwstate(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ int len = 0; -+ -+ len += snprintf(page + len, count - len, "fwstate=0x%x\n", get_fwstate(pmlmepriv)); -+ -+ *eof = 1; -+ return len; -+} -+ -+int proc_get_sec_info(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ int len = 0; -+ -+ len += snprintf(page + len, count - len, "auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", -+ psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, -+ psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus); -+ -+ *eof = 1; -+ return len; -+} -+ -+int proc_get_mlmext_state(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ int len = 0; -+ -+ len += snprintf(page + len, count - len, "pmlmeinfo->state=0x%x\n", pmlmeinfo->state); -+ -+ *eof = 1; -+ return len; -+} -+ -+int proc_get_qos_option(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ int len = 0; -+ -+ len += snprintf(page + len, count - len, "qos_option=%d\n", pmlmepriv->qospriv.qos_option); -+ -+ *eof = 1; -+ return len; -+ -+} -+ -+int proc_get_ht_option(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ int len = 0; -+#ifdef CONFIG_80211N_HT -+ len += snprintf(page + len, count - len, "ht_option=%d\n", pmlmepriv->htpriv.ht_option); -+#endif //CONFIG_80211N_HT -+ *eof = 1; -+ return len; -+} -+ -+int proc_get_rf_info(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ int len = 0; -+ -+ len += snprintf(page + len, count - len, "cur_ch=%d, cur_bw=%d, cur_ch_offet=%d\n", -+ pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ -+ len += snprintf(page + len, count - len, "oper_ch=%d, oper_bw=%d, oper_ch_offet=%d\n", -+ rtw_get_oper_ch(padapter), rtw_get_oper_bw(padapter), rtw_get_oper_choffset(padapter)); -+ -+ *eof = 1; -+ return len; -+ -+} -+ -+int proc_get_ap_info(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct sta_info *psta; -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ int len = 0; -+ -+ psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); -+ if(psta) -+ { -+ int i; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ -+ len += snprintf(page + len, count - len, "SSID=%s\n", cur_network->network.Ssid.Ssid); -+ len += snprintf(page + len, count - len, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ len += snprintf(page + len, count - len, "cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ len += snprintf(page + len, count - len, "rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); -+ len += snprintf(page + len, count - len, "state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); -+#ifdef CONFIG_80211N_HT -+ len += snprintf(page + len, count - len, "qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ len += snprintf(page + len, count - len, "bwmode=%d, ch_offset=%d, sgi=%d\n", psta->htpriv.bwmode, psta->htpriv.ch_offset, psta->htpriv.sgi); -+ len += snprintf(page + len, count - len, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ len += snprintf(page + len, count - len, "agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); -+#endif //CONFIG_80211N_HT -+ -+ for(i=0;i<16;i++) -+ { -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ if(preorder_ctrl->enable) -+ { -+ len += snprintf(page + len, count - len, "tid=%d, indicate_seq=%d\n", i, preorder_ctrl->indicate_seq); -+ } -+ } -+ -+ } -+ else -+ { -+ len += snprintf(page + len, count - len, "can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); -+ } -+ -+ *eof = 1; -+ return len; -+ -+} -+ -+int proc_get_adapter_state(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ int len = 0; -+ -+ len += snprintf(page + len, count - len, "bSurpriseRemoved=%d, bDriverStopped=%d\n", -+ padapter->bSurpriseRemoved, padapter->bDriverStopped); -+ -+ *eof = 1; -+ return len; -+ -+} -+ -+int proc_get_trx_info(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ int i; -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct hw_xmit *phwxmit; -+ int len = 0; -+ -+ len += snprintf(page + len, count - len, "free_xmitbuf_cnt=%d, free_xmitframe_cnt=%d" -+ ", free_ext_xmitbuf_cnt=%d, free_xframe_ext_cnt=%d" -+ ", free_recvframe_cnt=%d\n", -+ pxmitpriv->free_xmitbuf_cnt, pxmitpriv->free_xmitframe_cnt, -+ pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xframe_ext_cnt, -+ precvpriv->free_recvframe_cnt); -+ -+ for(i = 0; i < 4; i++) -+ { -+ phwxmit = pxmitpriv->hwxmits + i; -+ len += snprintf(page + len, count - len, "%d, hwq.accnt=%d\n", i, phwxmit->accnt); -+ } -+ -+ len += snprintf(page + len, count - len, "rx_urb_pending_cn=%d\n", precvpriv->rx_pending_cnt); -+ -+ *eof = 1; -+ return len; -+ -+} -+ -+int proc_get_mac_reg_dump1(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ int len = 0; -+ int i,j=1; -+ -+ len += snprintf(page + len, count - len, "\n======= MAC REG =======\n"); -+ -+ for(i=0x0;i<0x300;i+=4) -+ { -+ if(j%4==1) len += snprintf(page + len, count - len,"0x%02x",i); -+ len += snprintf(page + len, count - len," 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) len += snprintf(page + len, count - len,"\n"); -+ } -+ -+ *eof = 1; -+ return len; -+ -+} -+ -+int proc_get_mac_reg_dump2(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ int len = 0; -+ int i,j=1; -+ -+ len += snprintf(page + len, count - len, "\n======= MAC REG =======\n"); -+ memset(page, 0, count); -+ for(i=0x300;i<0x600;i+=4) -+ { -+ if(j%4==1) len += snprintf(page + len, count - len,"0x%02x",i); -+ len += snprintf(page + len, count - len," 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) len += snprintf(page + len, count - len,"\n"); -+ } -+ -+ *eof = 1; -+ return len; -+ -+} -+ -+int proc_get_mac_reg_dump3(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ int len = 0; -+ int i,j=1; -+ -+ len += snprintf(page + len, count - len, "\n======= MAC REG =======\n"); -+ -+ for(i=0x600;i<0x800;i+=4) -+ { -+ if(j%4==1) len += snprintf(page + len, count - len,"0x%02x",i); -+ len += snprintf(page + len, count - len," 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) len += snprintf(page + len, count - len,"\n"); -+ } -+ -+ *eof = 1; -+ return len; -+ -+} -+ -+int proc_get_bb_reg_dump1(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ int len = 0; -+ int i,j=1; -+ -+ len += snprintf(page + len, count - len, "\n======= BB REG =======\n"); -+ for(i=0x800;i<0xB00;i+=4) -+ { -+ if(j%4==1) len += snprintf(page + len, count - len,"0x%02x",i); -+ len += snprintf(page + len, count - len," 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) len += snprintf(page + len, count - len,"\n"); -+ } -+ *eof = 1; -+ return len; -+} -+ -+int proc_get_bb_reg_dump2(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ int len = 0; -+ int i,j=1; -+ -+ len += snprintf(page + len, count - len, "\n======= BB REG =======\n"); -+ for(i=0xB00;i<0xE00;i+=4) -+ { -+ if(j%4==1) len += snprintf(page + len, count - len,"0x%02x",i); -+ len += snprintf(page + len, count - len," 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) len += snprintf(page + len, count - len,"\n"); -+ } -+ *eof = 1; -+ return len; -+} -+ -+int proc_get_bb_reg_dump3(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ int len = 0; -+ int i,j=1; -+ -+ len += snprintf(page + len, count - len, "\n======= BB REG =======\n"); -+ for(i=0xE00;i<0x1000;i+=4) -+ { -+ if(j%4==1) len += snprintf(page + len, count - len,"0x%02x",i); -+ len += snprintf(page + len, count - len," 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) len += snprintf(page + len, count - len,"\n"); -+ } -+ *eof = 1; -+ return len; -+} -+ -+int proc_get_rf_reg_dump1(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ int len = 0; -+ int i,j=1,path; -+ u32 value; -+ -+ len += snprintf(page + len, count - len, "\n======= RF REG =======\n"); -+ path = 1; -+ len += snprintf(page + len, count - len, "\nRF_Path(%x)\n",path); -+ for(i=0;i<0xC0;i++) -+ { -+ //value = PHY_QueryRFReg(padapter, (RF90_RADIO_PATH_E)path,i, bMaskDWord); -+ value = rtw_hal_read_rfreg(padapter, path, i, 0xffffffff); -+ if(j%4==1) len += snprintf(page + len, count - len, "0x%02x ",i); -+ len += snprintf(page + len, count - len, " 0x%08x ",value); -+ if((j++)%4==0) len += snprintf(page + len, count - len, "\n"); -+ } -+ -+ *eof = 1; -+ return len; -+} -+ -+ -+int proc_get_rf_reg_dump2(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ int len = 0; -+ int i,j=1,path; -+ u32 value; -+ -+ len += snprintf(page + len, count - len, "\n======= RF REG =======\n"); -+ path = 1; -+ len += snprintf(page + len, count - len, "\nRF_Path(%x)\n",path); -+ for(i=0xC0;i<0x100;i++) -+ { -+ //value = PHY_QueryRFReg(padapter, (RF90_RADIO_PATH_E)path,i, bMaskDWord); -+ value = rtw_hal_read_rfreg(padapter, path, i, 0xffffffff); -+ if(j%4==1) len += snprintf(page + len, count - len, "0x%02x ",i); -+ len += snprintf(page + len, count - len, " 0x%08x ",value); -+ if((j++)%4==0) len += snprintf(page + len, count - len, "\n"); -+ } -+ *eof = 1; -+ return len; -+} -+ -+ -+int proc_get_rf_reg_dump3(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ int len = 0; -+ int i,j=1,path; -+ u32 value; -+ -+ len += snprintf(page + len, count - len, "\n======= RF REG =======\n"); -+ path = 2; -+ len += snprintf(page + len, count - len, "\nRF_Path(%x)\n",path); -+ for(i=0;i<0xC0;i++) -+ { -+ //value = PHY_QueryRFReg(padapter, (RF90_RADIO_PATH_E)path,i, bMaskDWord); -+ value = rtw_hal_read_rfreg(padapter, path, i, 0xffffffff); -+ if(j%4==1) len += snprintf(page + len, count - len, "0x%02x ",i); -+ len += snprintf(page + len, count - len, " 0x%08x ",value); -+ if((j++)%4==0) len += snprintf(page + len, count - len, "\n"); -+ } -+ -+ *eof = 1; -+ return len; -+} -+ -+ -+int proc_get_rf_reg_dump4(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ int len = 0; -+ int i,j=1,path; -+ u32 value; -+ -+ len += snprintf(page + len, count - len, "\n======= RF REG =======\n"); -+ path = 2; -+ len += snprintf(page + len, count - len, "\nRF_Path(%x)\n",path); -+ for(i=0xC0;i<0x100;i++) -+ { -+ //value = PHY_QueryRFReg(padapter, (RF90_RADIO_PATH_E)path,i, bMaskDWord); -+ value = rtw_hal_read_rfreg(padapter, path, i, 0xffffffff); -+ if(j%4==1) len += snprintf(page + len, count - len, "0x%02x ",i); -+ len += snprintf(page + len, count - len, " 0x%08x ",value); -+ if((j++)%4==0) len += snprintf(page + len, count - len, "\n"); -+ } -+ *eof = 1; -+ return len; -+} -+ -+ -+ -+int proc_get_rx_signal(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ int len = 0; -+ -+ len += snprintf(page + len, count - len, -+ "rssi:%d\n" -+ "rxpwdb:%d\n" -+ "signal_strength:%u\n" -+ "signal_qual:%u\n" -+ "noise:%u\n", -+ padapter->recvpriv.rssi, -+ padapter->recvpriv.rxpwdb, -+ padapter->recvpriv.signal_strength, -+ padapter->recvpriv.signal_qual, -+ padapter->recvpriv.noise -+ ); -+ -+ *eof = 1; -+ return len; -+} -+ -+int proc_set_rx_signal(struct file *file, const char *buffer, -+ unsigned long count, void *data) -+{ -+ struct net_device *dev = (struct net_device *)data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 is_signal_dbg, signal_strength; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%u %u", &is_signal_dbg, &signal_strength); -+ -+ is_signal_dbg = is_signal_dbg==0?0:1; -+ -+ if(is_signal_dbg && num!=2) -+ return count; -+ -+ signal_strength = signal_strength>100?100:signal_strength; -+ signal_strength = signal_strength<0?0:signal_strength; -+ -+ padapter->recvpriv.is_signal_dbg = is_signal_dbg; -+ padapter->recvpriv.signal_strength_dbg=signal_strength; -+ -+ if(is_signal_dbg) -+ DBG_871X("set %s %u\n", "DBG_SIGNAL_STRENGTH", signal_strength); -+ else -+ DBG_871X("set %s\n", "HW_SIGNAL_STRENGTH"); -+ -+ } -+ -+ return count; -+ -+} -+#ifdef CONFIG_80211N_HT -+ -+int proc_get_ht_enable(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ int len = 0; -+ -+ if(pregpriv) -+ len += snprintf(page + len, count - len, -+ "%d\n", -+ pregpriv->ht_enable -+ ); -+ -+ *eof = 1; -+ return len; -+} -+ -+int proc_set_ht_enable(struct file *file, const char *buffer, -+ unsigned long count, void *data) -+{ -+ struct net_device *dev = (struct net_device *)data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%d ", &mode); -+ -+ if( pregpriv && mode >= 0 && mode < 2 ) -+ { -+ pregpriv->ht_enable= mode; -+ printk("ht_enable=%d\n", pregpriv->ht_enable); -+ } -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_bw_mode(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ int len = 0; -+ -+ if(pregpriv) -+ len += snprintf(page + len, count - len, -+ "%d\n", -+ pregpriv->bw_mode -+ ); -+ -+ *eof = 1; -+ return len; -+} -+ -+int proc_set_bw_mode(struct file *file, const char *buffer, -+ unsigned long count, void *data) -+{ -+ struct net_device *dev = (struct net_device *)data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%d ", &mode); -+ -+ if( pregpriv && mode >= 0 && mode < 2 ) -+ { -+ -+ pregpriv->bw_mode = mode; -+ printk("bw_mode=%d\n", mode); -+ -+ } -+ } -+ -+ return count; -+ -+} -+ -+int proc_get_ampdu_enable(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ int len = 0; -+ -+ if(pregpriv) -+ len += snprintf(page + len, count - len, -+ "%d\n", -+ pregpriv->ampdu_enable -+ ); -+ -+ *eof = 1; -+ return len; -+} -+ -+int proc_set_ampdu_enable(struct file *file, const char *buffer, -+ unsigned long count, void *data) -+{ -+ struct net_device *dev = (struct net_device *)data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%d ", &mode); -+ -+ if( pregpriv && mode >= 0 && mode < 3 ) -+ { -+ pregpriv->ampdu_enable= mode; -+ printk("ampdu_enable=%d\n", mode); -+ } -+ -+ } -+ -+ return count; -+ -+} -+#endif //CONFIG_80211N_HT -+ -+int proc_get_two_path_rssi(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ int len = 0; -+ -+ if(padapter) -+ len += snprintf(page + len, count - len, -+ "%d %d\n", -+ padapter->recvpriv.RxRssi[0], -+ padapter->recvpriv.RxRssi[1] -+ ); -+ -+ *eof = 1; -+ return len; -+} -+#ifdef CONFIG_80211N_HT -+int proc_get_rx_stbc(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ int len = 0; -+ -+ if(pregpriv) -+ len += snprintf(page + len, count - len, -+ "%d\n", -+ pregpriv->rx_stbc -+ ); -+ -+ *eof = 1; -+ return len; -+} -+ -+int proc_set_rx_stbc(struct file *file, const char *buffer, -+ unsigned long count, void *data) -+{ -+ struct net_device *dev = (struct net_device *)data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%d ", &mode); -+ -+ if( pregpriv && (mode == 0 || mode == 1|| mode == 2|| mode == 3)) -+ { -+ pregpriv->rx_stbc= mode; -+ printk("rx_stbc=%d\n", mode); -+ } -+ } -+ -+ return count; -+ -+} -+#endif //CONFIG_80211N_HT -+ -+int proc_get_rssi_disp(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ *eof = 1; -+ return 0; -+} -+ -+int proc_set_rssi_disp(struct file *file, const char *buffer, -+ unsigned long count, void *data) -+{ -+ struct net_device *dev = (struct net_device *)data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ u32 enable=0; -+ -+ if (count < 1) -+ { -+ DBG_8192C("argument size is less than 1\n"); -+ return -EFAULT; -+ } -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%x", &enable); -+ -+ if (num != 1) { -+ DBG_8192C("invalid set_rssi_disp parameter!\n"); -+ return count; -+ } -+ -+ if(enable) -+ { -+ DBG_8192C("Linked info Function Enable\n"); -+ padapter->bLinkInfoDump = enable ; -+ } -+ else -+ { -+ DBG_8192C("Linked info Function Disable\n"); -+ padapter->bLinkInfoDump = 0 ; -+ } -+ -+ } -+ -+ return count; -+ -+} -+ -+ -+#ifdef CONFIG_AP_MODE -+ -+int proc_get_all_sta_info(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ _irqL irqL; -+ struct sta_info *psta; -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ int i, j; -+ _list *plist, *phead; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ int len = 0; -+ -+ -+ len += snprintf(page + len, count - len, "sta_dz_bitmap=0x%x, tim_bitmap=0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for(i=0; i< NUM_STA; i++) -+ { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ plist = get_next(plist); -+ -+ //if(extra_arg == psta->aid) -+ { -+ len += snprintf(page + len, count - len, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ len += snprintf(page + len, count - len, "rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); -+ len += snprintf(page + len, count - len, "state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); -+#ifdef CONFIG_80211N_HT -+ len += snprintf(page + len, count - len, "qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ len += snprintf(page + len, count - len, "bwmode=%d, ch_offset=%d, sgi=%d\n", psta->htpriv.bwmode, psta->htpriv.ch_offset, psta->htpriv.sgi); -+ len += snprintf(page + len, count - len, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ len += snprintf(page + len, count - len, "agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); -+#endif //CONFIG_80211N_HT -+ len += snprintf(page + len, count - len, "sleepq_len=%d\n", psta->sleepq_len); -+ len += snprintf(page + len, count - len, "capability=0x%x\n", psta->capability); -+ len += snprintf(page + len, count - len, "flags=0x%x\n", psta->flags); -+ len += snprintf(page + len, count - len, "wpa_psk=0x%x\n", psta->wpa_psk); -+ len += snprintf(page + len, count - len, "wpa2_group_cipher=0x%x\n", psta->wpa2_group_cipher); -+ len += snprintf(page + len, count - len, "wpa2_pairwise_cipher=0x%x\n", psta->wpa2_pairwise_cipher); -+ len += snprintf(page + len, count - len, "qos_info=0x%x\n", psta->qos_info); -+ len += snprintf(page + len, count - len, "dot118021XPrivacy=0x%x\n", psta->dot118021XPrivacy); -+ -+ for(j=0;j<16;j++) -+ { -+ preorder_ctrl = &psta->recvreorder_ctrl[j]; -+ if(preorder_ctrl->enable) -+ { -+ len += snprintf(page + len, count - len, "tid=%d, indicate_seq=%d\n", j, preorder_ctrl->indicate_seq); -+ } -+ } -+ -+ } -+ -+ } -+ -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ *eof = 1; -+ return len; -+ -+} -+ -+#endif -+ -+#ifdef DBG_MEMORY_LEAK -+#include -+extern atomic_t _malloc_cnt;; -+extern atomic_t _malloc_size;; -+ -+int proc_get_malloc_cnt(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ -+ int len = 0; -+ -+ len += snprintf(page + len, count - len, "_malloc_cnt=%d\n", atomic_read(&_malloc_cnt)); -+ len += snprintf(page + len, count - len, "_malloc_size=%d\n", atomic_read(&_malloc_size)); -+ -+ *eof = 1; -+ return len; -+} -+#endif /* DBG_MEMORY_LEAK */ -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+int proc_get_best_channel(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ int len = 0; -+ u32 i, best_channel_24G = 1, best_channel_5G = 36, index_24G = 0, index_5G = 0; -+ -+ for (i=0; pmlmeext->channel_set[i].ChannelNum !=0; i++) { -+ if ( pmlmeext->channel_set[i].ChannelNum == 1) -+ index_24G = i; -+ if ( pmlmeext->channel_set[i].ChannelNum == 36) -+ index_5G = i; -+ } -+ -+ for (i=0; pmlmeext->channel_set[i].ChannelNum !=0; i++) { -+ // 2.4G -+ if ( pmlmeext->channel_set[i].ChannelNum == 6 ) { -+ if ( pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_24G].rx_count ) { -+ index_24G = i; -+ best_channel_24G = pmlmeext->channel_set[i].ChannelNum; -+ } -+ } -+ -+ // 5G -+ if ( pmlmeext->channel_set[i].ChannelNum >= 36 -+ && pmlmeext->channel_set[i].ChannelNum < 140 ) { -+ // Find primary channel -+ if ( (( pmlmeext->channel_set[i].ChannelNum - 36) % 8 == 0) -+ && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count) ) { -+ index_5G = i; -+ best_channel_5G = pmlmeext->channel_set[i].ChannelNum; -+ } -+ } -+ -+ if ( pmlmeext->channel_set[i].ChannelNum >= 149 -+ && pmlmeext->channel_set[i].ChannelNum < 165) { -+ // find primary channel -+ if ( (( pmlmeext->channel_set[i].ChannelNum - 149) % 8 == 0) -+ && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count) ) { -+ index_5G = i; -+ best_channel_5G = pmlmeext->channel_set[i].ChannelNum; -+ } -+ } -+#if 1 // debug -+ len += snprintf(page + len, count - len, "The rx cnt of channel %3d = %d\n", -+ pmlmeext->channel_set[i].ChannelNum, pmlmeext->channel_set[i].rx_count); -+#endif -+ } -+ -+ len += snprintf(page + len, count - len, "best_channel_5G = %d\n", best_channel_5G); -+ len += snprintf(page + len, count - len, "best_channel_24G = %d\n", best_channel_24G); -+ -+ *eof = 1; -+ return len; -+ -+} -+#endif /* CONFIG_FIND_BEST_CHANNEL */ -+#ifdef CONFIG_BT_COEXIST -+#define _bt_dbg_off_ 0 -+#define _bt_dbg_on_ 1 -+ -+extern u32 BTCoexDbgLevel; -+int proc_get_btcoex_dbg(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ int len = 0; -+ -+ if(pregpriv) -+ len += snprintf(page + len, count - len, -+ "%d\n", -+ BTCoexDbgLevel -+ ); -+ -+ *eof = 1; -+ return len; -+} -+ -+int proc_set_btcoex_dbg(struct file *file, const char *buffer, -+ unsigned long count, void *data) -+{ -+ struct net_device *dev = (struct net_device *)data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ char tmp[32]; -+ u32 mode; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%d ", &mode); -+ -+ if( pregpriv && (mode == 0 || mode == 1|| mode == 2|| mode == 3)) -+ { -+ BTCoexDbgLevel= mode; -+ printk("btcoex_dbg=%d\n", BTCoexDbgLevel); -+ } -+ } -+ -+ return count; -+ -+} -+#endif /* CONFIG_BT_COEXIST */ -+ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+int proc_get_sreset(char *page, char **start, off_t offset, int count, int *eof, void *data) -+{ -+ struct net_device *dev = data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ int len = 0; -+ -+ *eof = 1; -+ return len; -+} -+ -+int proc_set_sreset(struct file *file, const char *buffer, unsigned long count, void *data) -+{ -+ struct net_device *dev = (struct net_device *)data; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ char tmp[32]; -+ s32 trigger_point; -+ -+ if (count < 1) -+ return -EFAULT; -+ -+ if (buffer && !copy_from_user(tmp, buffer, sizeof(tmp))) { -+ -+ int num = sscanf(tmp, "%d", &trigger_point); -+ -+ if (trigger_point == SRESET_TGP_NULL) -+ rtw_hal_sreset_reset(padapter); -+ else -+ sreset_set_trigger_point(padapter, trigger_point); -+ } -+ -+ return count; -+ -+} -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_ieee80211.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ieee80211.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_ieee80211.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ieee80211.c 2018-02-06 17:42:30.694966927 +0200 -@@ -0,0 +1,2022 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _IEEE80211_C -+ -+#include -+ -+ -+u8 RTW_WPA_OUI_TYPE[] = { 0x00, 0x50, 0xf2, 1 }; -+u16 RTW_WPA_VERSION = 1; -+u8 WPA_AUTH_KEY_MGMT_NONE[] = { 0x00, 0x50, 0xf2, 0 }; -+u8 WPA_AUTH_KEY_MGMT_UNSPEC_802_1X[] = { 0x00, 0x50, 0xf2, 1 }; -+u8 WPA_AUTH_KEY_MGMT_PSK_OVER_802_1X[] = { 0x00, 0x50, 0xf2, 2 }; -+u8 WPA_CIPHER_SUITE_NONE[] = { 0x00, 0x50, 0xf2, 0 }; -+u8 WPA_CIPHER_SUITE_WEP40[] = { 0x00, 0x50, 0xf2, 1 }; -+u8 WPA_CIPHER_SUITE_TKIP[] = { 0x00, 0x50, 0xf2, 2 }; -+u8 WPA_CIPHER_SUITE_WRAP[] = { 0x00, 0x50, 0xf2, 3 }; -+u8 WPA_CIPHER_SUITE_CCMP[] = { 0x00, 0x50, 0xf2, 4 }; -+u8 WPA_CIPHER_SUITE_WEP104[] = { 0x00, 0x50, 0xf2, 5 }; -+ -+u16 RSN_VERSION_BSD = 1; -+u8 RSN_AUTH_KEY_MGMT_UNSPEC_802_1X[] = { 0x00, 0x0f, 0xac, 1 }; -+u8 RSN_AUTH_KEY_MGMT_PSK_OVER_802_1X[] = { 0x00, 0x0f, 0xac, 2 }; -+u8 RSN_CIPHER_SUITE_NONE[] = { 0x00, 0x0f, 0xac, 0 }; -+u8 RSN_CIPHER_SUITE_WEP40[] = { 0x00, 0x0f, 0xac, 1 }; -+u8 RSN_CIPHER_SUITE_TKIP[] = { 0x00, 0x0f, 0xac, 2 }; -+u8 RSN_CIPHER_SUITE_WRAP[] = { 0x00, 0x0f, 0xac, 3 }; -+u8 RSN_CIPHER_SUITE_CCMP[] = { 0x00, 0x0f, 0xac, 4 }; -+u8 RSN_CIPHER_SUITE_WEP104[] = { 0x00, 0x0f, 0xac, 5 }; -+//----------------------------------------------------------- -+// for adhoc-master to generate ie and provide supported-rate to fw -+//----------------------------------------------------------- -+ -+static u8 WIFI_CCKRATES[] = -+{(IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK), -+ (IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK), -+ (IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK), -+ (IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK)}; -+ -+static u8 WIFI_OFDMRATES[] = -+{(IEEE80211_OFDM_RATE_6MB), -+ (IEEE80211_OFDM_RATE_9MB), -+ (IEEE80211_OFDM_RATE_12MB), -+ (IEEE80211_OFDM_RATE_18MB), -+ (IEEE80211_OFDM_RATE_24MB), -+ IEEE80211_OFDM_RATE_36MB, -+ IEEE80211_OFDM_RATE_48MB, -+ IEEE80211_OFDM_RATE_54MB}; -+ -+ -+int rtw_get_bit_value_from_ieee_value(u8 val) -+{ -+ unsigned char dot11_rate_table[]={2,4,11,22,12,18,24,36,48,72,96,108,0}; // last element must be zero!! -+ -+ int i=0; -+ while(dot11_rate_table[i] != 0) { -+ if (dot11_rate_table[i] == val) -+ return BIT(i); -+ i++; -+ } -+ return 0; -+} -+ -+uint rtw_is_cckrates_included(u8 *rate) -+{ -+ u32 i = 0; -+ -+ while(rate[i]!=0) -+ { -+ if ( (((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || -+ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22) ) -+ return true; -+ i++; -+ } -+ -+ return false; -+} -+ -+uint rtw_is_cckratesonly_included(u8 *rate) -+{ -+ u32 i = 0; -+ -+ -+ while(rate[i]!=0) -+ { -+ if ( (((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && -+ (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22) ) -+ -+ return false; -+ -+ i++; -+ } -+ -+ return true; -+ -+} -+ -+int rtw_check_network_type(unsigned char *rate, int ratelen, int channel) -+{ -+ if (channel > 14) -+ { -+ if ((rtw_is_cckrates_included(rate)) == true) -+ return WIRELESS_INVALID; -+ else -+ return WIRELESS_11A; -+ } -+ else // could be pure B, pure G, or B/G -+ { -+ if ((rtw_is_cckratesonly_included(rate)) == true) -+ return WIRELESS_11B; -+ else if((rtw_is_cckrates_included(rate)) == true) -+ return WIRELESS_11BG; -+ else -+ return WIRELESS_11G; -+ } -+ -+} -+ -+u8 *rtw_set_fixed_ie(unsigned char *pbuf, unsigned int len, unsigned char *source, -+ unsigned int *frlen) -+{ -+ _rtw_memcpy((void *)pbuf, (void *)source, len); -+ *frlen = *frlen + len; -+ return (pbuf + len); -+} -+ -+// rtw_set_ie will update frame length -+u8 *rtw_set_ie -+( -+ u8 *pbuf, -+ sint index, -+ uint len, -+ u8 *source, -+ uint *frlen //frame length -+) -+{ -+ -+ *pbuf = (u8)index; -+ -+ *(pbuf + 1) = (u8)len; -+ -+ if (len > 0) -+ _rtw_memcpy((void *)(pbuf + 2), (void *)source, len); -+ -+ *frlen = *frlen + (len + 2); -+ -+ return (pbuf + len + 2); -+ -+} -+ -+inline u8 *rtw_set_ie_ch_switch(u8 *buf, u32 *buf_len, u8 ch_switch_mode, -+ u8 new_ch, u8 ch_switch_cnt) -+{ -+ u8 ie_data[3]; -+ -+ ie_data[0] = ch_switch_mode; -+ ie_data[1] = new_ch; -+ ie_data[2] = ch_switch_cnt; -+ return rtw_set_ie(buf, WLAN_EID_CHANNEL_SWITCH, 3, ie_data, buf_len); -+} -+ -+inline u8 secondary_ch_offset_to_hal_ch_offset(u8 ch_offset) -+{ -+ if (ch_offset == SCN) -+ return HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ else if(ch_offset == SCA) -+ return HAL_PRIME_CHNL_OFFSET_UPPER; -+ else if(ch_offset == SCB) -+ return HAL_PRIME_CHNL_OFFSET_LOWER; -+ -+ return HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+} -+ -+inline u8 hal_ch_offset_to_secondary_ch_offset(u8 ch_offset) -+{ -+ if (ch_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) -+ return SCN; -+ else if(ch_offset == HAL_PRIME_CHNL_OFFSET_LOWER) -+ return SCB; -+ else if(ch_offset == HAL_PRIME_CHNL_OFFSET_UPPER) -+ return SCA; -+ -+ return SCN; -+} -+ -+inline u8 *rtw_set_ie_secondary_ch_offset(u8 *buf, u32 *buf_len, u8 secondary_ch_offset) -+{ -+ return rtw_set_ie(buf, WLAN_EID_SECONDARY_CHANNEL_OFFSET, 1, &secondary_ch_offset, buf_len); -+} -+ -+inline u8 *rtw_set_ie_mesh_ch_switch_parm(u8 *buf, u32 *buf_len, u8 ttl, -+ u8 flags, u16 reason, u16 precedence) -+{ -+ u8 ie_data[6]; -+ -+ ie_data[0] = ttl; -+ ie_data[1] = flags; -+ RTW_PUT_LE16((u8*)&ie_data[2], reason); -+ RTW_PUT_LE16((u8*)&ie_data[4], precedence); -+ -+ return rtw_set_ie(buf, 0x118, 6, ie_data, buf_len); -+} -+ -+/*---------------------------------------------------------------------------- -+index: the information element id index, limit is the limit for search -+-----------------------------------------------------------------------------*/ -+u8 *rtw_get_ie(u8 *pbuf, sint index, sint *len, sint limit) -+{ -+ sint tmp,i; -+ u8 *p; -+ -+ if (limit < 1){ -+ -+ return NULL; -+ } -+ -+ p = pbuf; -+ i = 0; -+ *len = 0; -+ while(1) -+ { -+ if (*p == index) -+ { -+ *len = *(p + 1); -+ return (p); -+ } -+ else -+ { -+ tmp = *(p + 1); -+ p += (tmp + 2); -+ i += (tmp + 2); -+ } -+ if (i >= limit) -+ break; -+ } -+ -+ return NULL; -+} -+ -+/** -+ * rtw_get_ie_ex - Search specific IE from a series of IEs -+ * @in_ie: Address of IEs to search -+ * @in_len: Length limit from in_ie -+ * @eid: Element ID to match -+ * @oui: OUI to match -+ * @oui_len: OUI length -+ * @ie: If not NULL and the specific IE is found, the IE will be copied to the buf starting from the specific IE -+ * @ielen: If not NULL and the specific IE is found, will set to the length of the entire IE -+ * -+ * Returns: The address of the specific IE found, or NULL -+ */ -+u8 *rtw_get_ie_ex(u8 *in_ie, uint in_len, u8 eid, u8 *oui, u8 oui_len, u8 *ie, uint *ielen) -+{ -+ uint cnt; -+ u8 *target_ie = NULL; -+ -+ -+ if(ielen) -+ *ielen = 0; -+ -+ if(!in_ie || in_len<=0) -+ return target_ie; -+ -+ cnt = 0; -+ -+ while(cnt 12) -+ break; -+ -+ i++; -+ } -+ -+ return i; -+} -+ -+int rtw_generate_ie(struct registry_priv *pregistrypriv) -+{ -+ u8 wireless_mode; -+ int sz = 0, rateLen; -+ WLAN_BSSID_EX* pdev_network = &pregistrypriv->dev_network; -+ u8* ie = pdev_network->IEs; -+ -+ -+ -+ //timestamp will be inserted by hardware -+ sz += 8; -+ ie += sz; -+ -+ //beacon interval : 2bytes -+ *(__le16*)ie = cpu_to_le16((u16)pdev_network->Configuration.BeaconPeriod);//BCN_INTERVAL; -+ sz += 2; -+ ie += 2; -+ -+ //capability info -+ *(__le16*)ie = 0; -+ -+ *(__le16*)ie |= cpu_to_le16(cap_IBSS); -+ -+ if(pregistrypriv->preamble == PREAMBLE_SHORT) -+ *(__le16*)ie |= cpu_to_le16(cap_ShortPremble); -+ -+ if (pdev_network->Privacy) -+ *(__le16*)ie |= cpu_to_le16(cap_Privacy); -+ -+ sz += 2; -+ ie += 2; -+ -+ //SSID -+ ie = rtw_set_ie(ie, _SSID_IE_, pdev_network->Ssid.SsidLength, pdev_network->Ssid.Ssid, &sz); -+ -+ //supported rates -+ if(pregistrypriv->wireless_mode == WIRELESS_11ABGN) -+ { -+ if(pdev_network->Configuration.DSConfig > 14) -+ wireless_mode = WIRELESS_11A_5N; -+ else -+ wireless_mode = WIRELESS_11BG_24N; -+ } -+ else -+ { -+ wireless_mode = pregistrypriv->wireless_mode; -+ } -+ -+ rtw_set_supported_rate(pdev_network->SupportedRates, wireless_mode) ; -+ -+ rateLen = rtw_get_rateset_len(pdev_network->SupportedRates); -+ -+ if (rateLen > 8) -+ { -+ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, 8, pdev_network->SupportedRates, &sz); -+ //ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (pdev_network->SupportedRates + 8), &sz); -+ } -+ else -+ { -+ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, rateLen, pdev_network->SupportedRates, &sz); -+ } -+ -+ //DS parameter set -+ ie = rtw_set_ie(ie, _DSSET_IE_, 1, (u8 *)&(pdev_network->Configuration.DSConfig), &sz); -+ -+ -+ //IBSS Parameter Set -+ -+ ie = rtw_set_ie(ie, _IBSS_PARA_IE_, 2, (u8 *)&(pdev_network->Configuration.ATIMWindow), &sz); -+ -+ if (rateLen > 8) -+ { -+ ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (pdev_network->SupportedRates + 8), &sz); -+ } -+ -+#ifdef CONFIG_80211N_HT -+ //HT Cap. -+ if(((pregistrypriv->wireless_mode&WIRELESS_11_5N)||(pregistrypriv->wireless_mode&WIRELESS_11_24N)) -+ && (pregistrypriv->ht_enable==true)) -+ { -+ //todo: -+ } -+#endif //CONFIG_80211N_HT -+ -+ //pdev_network->IELength = sz; //update IELength -+ -+ -+ -+ //return _SUCCESS; -+ -+ return sz; -+ -+} -+ -+unsigned char *rtw_get_wpa_ie(unsigned char *pie, int *wpa_ie_len, int limit) -+{ -+ int len; -+ u16 val16; -+ unsigned char wpa_oui_type[] = {0x00, 0x50, 0xf2, 0x01}; -+ u8 *pbuf = pie; -+ int limit_new = limit; -+ -+ while(1) -+ { -+ pbuf = rtw_get_ie(pbuf, _WPA_IE_ID_, &len, limit_new); -+ -+ if (pbuf) { -+ -+ //check if oui matches... -+ if (_rtw_memcmp((pbuf + 2), wpa_oui_type, sizeof (wpa_oui_type)) == false) { -+ -+ goto check_next_ie; -+ } -+ -+ //check version... -+ _rtw_memcpy((u8 *)&val16, (pbuf + 6), sizeof(val16)); -+ -+ le16_to_cpup((__le16 *)&val16); -+ if (val16 != 0x0001) -+ goto check_next_ie; -+ -+ *wpa_ie_len = *(pbuf + 1); -+ -+ return pbuf; -+ -+ } -+ else { -+ -+ *wpa_ie_len = 0; -+ return NULL; -+ } -+ -+check_next_ie: -+ -+ limit_new = limit - (pbuf - pie) - 2 - len; -+ -+ if (limit_new <= 0) -+ break; -+ -+ pbuf += (2 + len); -+ -+ } -+ -+ *wpa_ie_len = 0; -+ -+ return NULL; -+ -+} -+ -+unsigned char *rtw_get_wpa2_ie(unsigned char *pie, int *rsn_ie_len, int limit) -+{ -+ -+ return rtw_get_ie(pie, _WPA2_IE_ID_,rsn_ie_len, limit); -+ -+} -+ -+int rtw_get_wpa_cipher_suite(u8 *s) -+{ -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_NONE, WPA_SELECTOR_LEN) == true) -+ return WPA_CIPHER_NONE; -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_WEP40, WPA_SELECTOR_LEN) == true) -+ return WPA_CIPHER_WEP40; -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_TKIP, WPA_SELECTOR_LEN) == true) -+ return WPA_CIPHER_TKIP; -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_CCMP, WPA_SELECTOR_LEN) == true) -+ return WPA_CIPHER_CCMP; -+ if (_rtw_memcmp(s, WPA_CIPHER_SUITE_WEP104, WPA_SELECTOR_LEN) == true) -+ return WPA_CIPHER_WEP104; -+ -+ return 0; -+} -+ -+int rtw_get_wpa2_cipher_suite(u8 *s) -+{ -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_NONE, RSN_SELECTOR_LEN) == true) -+ return WPA_CIPHER_NONE; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_WEP40, RSN_SELECTOR_LEN) == true) -+ return WPA_CIPHER_WEP40; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_TKIP, RSN_SELECTOR_LEN) == true) -+ return WPA_CIPHER_TKIP; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_CCMP, RSN_SELECTOR_LEN) == true) -+ return WPA_CIPHER_CCMP; -+ if (_rtw_memcmp(s, RSN_CIPHER_SUITE_WEP104, RSN_SELECTOR_LEN) == true) -+ return WPA_CIPHER_WEP104; -+ -+ return 0; -+} -+ -+ -+int rtw_parse_wpa_ie(u8* wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x) -+{ -+ int i, ret=_SUCCESS; -+ int left, count; -+ u8 *pos; -+ u8 SUITE_1X[4] = {0x00, 0x50, 0xf2, 1}; -+ -+ if (wpa_ie_len <= 0) { -+ /* No WPA IE - fail silently */ -+ return _FAIL; -+ } -+ -+ -+ if ((*wpa_ie != _WPA_IE_ID_) || (*(wpa_ie+1) != (u8)(wpa_ie_len - 2)) || -+ (_rtw_memcmp(wpa_ie+2, RTW_WPA_OUI_TYPE, WPA_SELECTOR_LEN) != true) ) -+ { -+ return _FAIL; -+ } -+ -+ pos = wpa_ie; -+ -+ pos += 8; -+ left = wpa_ie_len - 8; -+ -+ -+ //group_cipher -+ if (left >= WPA_SELECTOR_LEN) { -+ -+ *group_cipher = rtw_get_wpa_cipher_suite(pos); -+ -+ pos += WPA_SELECTOR_LEN; -+ left -= WPA_SELECTOR_LEN; -+ -+ } -+ else if (left > 0) -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s: ie length mismatch, %u too much", __FUNCTION__, left)); -+ -+ return _FAIL; -+ } -+ -+ -+ //pairwise_cipher -+ if (left >= 2) -+ { -+ //count = le16_to_cpu(*(u16*)pos); -+ count = RTW_GET_LE16(pos); -+ pos += 2; -+ left -= 2; -+ -+ if (count == 0 || left < count * WPA_SELECTOR_LEN) { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s: ie count botch (pairwise), " -+ "count %u left %u", __FUNCTION__, count, left)); -+ return _FAIL; -+ } -+ -+ for (i = 0; i < count; i++) -+ { -+ *pairwise_cipher |= rtw_get_wpa_cipher_suite(pos); -+ -+ pos += WPA_SELECTOR_LEN; -+ left -= WPA_SELECTOR_LEN; -+ } -+ -+ } -+ else if (left == 1) -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s: ie too short (for key mgmt)", __FUNCTION__)); -+ return _FAIL; -+ } -+ -+ if (is_8021x) { -+ if (left >= 6) { -+ pos += 2; -+ if (_rtw_memcmp(pos, SUITE_1X, 4) == 1) { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("%s : there has 802.1x auth\n", __FUNCTION__)); -+ *is_8021x = 1; -+ } -+ } -+ } -+ -+ return ret; -+ -+} -+ -+int rtw_parse_wpa2_ie(u8* rsn_ie, int rsn_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x) -+{ -+ int i, ret=_SUCCESS; -+ int left, count; -+ u8 *pos; -+ u8 SUITE_1X[4] = {0x00,0x0f, 0xac, 0x01}; -+ -+ if (rsn_ie_len <= 0) { -+ /* No RSN IE - fail silently */ -+ return _FAIL; -+ } -+ -+ -+ if ((*rsn_ie!= _WPA2_IE_ID_) || (*(rsn_ie+1) != (u8)(rsn_ie_len - 2))) -+ { -+ return _FAIL; -+ } -+ -+ pos = rsn_ie; -+ pos += 4; -+ left = rsn_ie_len - 4; -+ -+ //group_cipher -+ if (left >= RSN_SELECTOR_LEN) { -+ -+ *group_cipher = rtw_get_wpa2_cipher_suite(pos); -+ -+ pos += RSN_SELECTOR_LEN; -+ left -= RSN_SELECTOR_LEN; -+ -+ } else if (left > 0) { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s: ie length mismatch, %u too much", __FUNCTION__, left)); -+ return _FAIL; -+ } -+ -+ //pairwise_cipher -+ if (left >= 2) -+ { -+ //count = le16_to_cpu(*(u16*)pos); -+ count = RTW_GET_LE16(pos); -+ pos += 2; -+ left -= 2; -+ -+ if (count == 0 || left < count * RSN_SELECTOR_LEN) { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s: ie count botch (pairwise), " -+ "count %u left %u", __FUNCTION__, count, left)); -+ return _FAIL; -+ } -+ -+ for (i = 0; i < count; i++) -+ { -+ *pairwise_cipher |= rtw_get_wpa2_cipher_suite(pos); -+ -+ pos += RSN_SELECTOR_LEN; -+ left -= RSN_SELECTOR_LEN; -+ } -+ -+ } -+ else if (left == 1) -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s: ie too short (for key mgmt)", __FUNCTION__)); -+ -+ return _FAIL; -+ } -+ -+ if (is_8021x) { -+ if (left >= 6) { -+ pos += 2; -+ if (_rtw_memcmp(pos, SUITE_1X, 4) == 1) { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("%s (): there has 802.1x auth\n", __FUNCTION__)); -+ *is_8021x = 1; -+ } -+ } -+ } -+ -+ return ret; -+ -+} -+ -+#ifdef CONFIG_WAPI_SUPPORT -+int rtw_get_wapi_ie(u8 *in_ie,uint in_len,u8 *wapi_ie,u16 *wapi_len) -+{ -+ u8 authmode, i; -+ uint cnt; -+ u8 wapi_oui1[4]={0x0,0x14,0x72,0x01}; -+ u8 wapi_oui2[4]={0x0,0x14,0x72,0x02}; -+ -+ -+ cnt = (_TIMESTAMP_ + _BEACON_ITERVAL_ + _CAPABILITY_); -+ while(cnt found WPS_IE.....\n"); -+ *wps_ielen = ie_ptr[1]+2; -+ match=true; -+ } -+ return match; -+} -+ -+/** -+ * rtw_get_wps_ie - Search WPS IE from a series of IEs -+ * @in_ie: Address of IEs to search -+ * @in_len: Length limit from in_ie -+ * @wps_ie: If not NULL and WPS IE is found, WPS IE will be copied to the buf starting from wps_ie -+ * @wps_ielen: If not NULL and WPS IE is found, will set to the length of the entire WPS IE -+ * -+ * Returns: The address of the WPS IE found, or NULL -+ */ -+u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen) -+{ -+ uint cnt; -+ u8 *wpsie_ptr=NULL; -+ u8 eid, wps_oui[4]={0x0,0x50,0xf2,0x04}; -+ -+ if(wps_ielen) -+ *wps_ielen = 0; -+ -+ if(!in_ie || in_len<=0) -+ return wpsie_ptr; -+ -+ cnt = 0; -+ -+ while(cntwpa_ie = pos; -+ elems->wpa_ie_len = elen; -+ break; -+ case WME_OUI_TYPE: /* this is a Wi-Fi WME info. element */ -+ if (elen < 5) { -+ DBG_871X("short WME " -+ "information element ignored " -+ "(len=%lu)\n", -+ (unsigned long) elen); -+ return -1; -+ } -+ switch (pos[4]) { -+ case WME_OUI_SUBTYPE_INFORMATION_ELEMENT: -+ case WME_OUI_SUBTYPE_PARAMETER_ELEMENT: -+ elems->wme = pos; -+ elems->wme_len = elen; -+ break; -+ case WME_OUI_SUBTYPE_TSPEC_ELEMENT: -+ elems->wme_tspec = pos; -+ elems->wme_tspec_len = elen; -+ break; -+ default: -+ DBG_871X("unknown WME " -+ "information element ignored " -+ "(subtype=%d len=%lu)\n", -+ pos[4], (unsigned long) elen); -+ return -1; -+ } -+ break; -+ case 4: -+ /* Wi-Fi Protected Setup (WPS) IE */ -+ elems->wps_ie = pos; -+ elems->wps_ie_len = elen; -+ break; -+ default: -+ DBG_871X("Unknown Microsoft " -+ "information element ignored " -+ "(type=%d len=%lu)\n", -+ pos[3], (unsigned long) elen); -+ return -1; -+ } -+ break; -+ -+ case OUI_BROADCOM: -+ switch (pos[3]) { -+ case VENDOR_HT_CAPAB_OUI_TYPE: -+ elems->vendor_ht_cap = pos; -+ elems->vendor_ht_cap_len = elen; -+ break; -+ default: -+ DBG_871X("Unknown Broadcom " -+ "information element ignored " -+ "(type=%d len=%lu)\n", -+ pos[3], (unsigned long) elen); -+ return -1; -+ } -+ break; -+ -+ default: -+ DBG_871X("unknown vendor specific information " -+ "element ignored (vendor OUI %02x:%02x:%02x " -+ "len=%lu)\n", -+ pos[0], pos[1], pos[2], (unsigned long) elen); -+ return -1; -+ } -+ -+ return 0; -+ -+} -+ -+/** -+ * ieee802_11_parse_elems - Parse information elements in management frames -+ * @start: Pointer to the start of IEs -+ * @len: Length of IE buffer in octets -+ * @elems: Data structure for parsed elements -+ * @show_errors: Whether to show parsing errors in debug log -+ * Returns: Parsing result -+ */ -+ParseRes rtw_ieee802_11_parse_elems(u8 *start, uint len, -+ struct rtw_ieee802_11_elems *elems, -+ int show_errors) -+{ -+ uint left = len; -+ u8 *pos = start; -+ int unknown = 0; -+ -+ _rtw_memset(elems, 0, sizeof(*elems)); -+ -+ while (left >= 2) { -+ u8 id, elen; -+ -+ id = *pos++; -+ elen = *pos++; -+ left -= 2; -+ -+ if (elen > left) { -+ if (show_errors) { -+ DBG_871X("IEEE 802.11 element " -+ "parse failed (id=%d elen=%d " -+ "left=%lu)\n", -+ id, elen, (unsigned long) left); -+ } -+ return ParseFailed; -+ } -+ -+ switch (id) { -+ case WLAN_EID_SSID: -+ elems->ssid = pos; -+ elems->ssid_len = elen; -+ break; -+ case WLAN_EID_SUPP_RATES: -+ elems->supp_rates = pos; -+ elems->supp_rates_len = elen; -+ break; -+ case WLAN_EID_FH_PARAMS: -+ elems->fh_params = pos; -+ elems->fh_params_len = elen; -+ break; -+ case WLAN_EID_DS_PARAMS: -+ elems->ds_params = pos; -+ elems->ds_params_len = elen; -+ break; -+ case WLAN_EID_CF_PARAMS: -+ elems->cf_params = pos; -+ elems->cf_params_len = elen; -+ break; -+ case WLAN_EID_TIM: -+ elems->tim = pos; -+ elems->tim_len = elen; -+ break; -+ case WLAN_EID_IBSS_PARAMS: -+ elems->ibss_params = pos; -+ elems->ibss_params_len = elen; -+ break; -+ case WLAN_EID_CHALLENGE: -+ elems->challenge = pos; -+ elems->challenge_len = elen; -+ break; -+ case WLAN_EID_ERP_INFO: -+ elems->erp_info = pos; -+ elems->erp_info_len = elen; -+ break; -+ case WLAN_EID_EXT_SUPP_RATES: -+ elems->ext_supp_rates = pos; -+ elems->ext_supp_rates_len = elen; -+ break; -+ case WLAN_EID_VENDOR_SPECIFIC: -+ if (rtw_ieee802_11_parse_vendor_specific(pos, elen, -+ elems, -+ show_errors)) -+ unknown++; -+ break; -+ case WLAN_EID_RSN: -+ elems->rsn_ie = pos; -+ elems->rsn_ie_len = elen; -+ break; -+ case WLAN_EID_PWR_CAPABILITY: -+ elems->power_cap = pos; -+ elems->power_cap_len = elen; -+ break; -+ case WLAN_EID_SUPPORTED_CHANNELS: -+ elems->supp_channels = pos; -+ elems->supp_channels_len = elen; -+ break; -+ case WLAN_EID_MOBILITY_DOMAIN: -+ elems->mdie = pos; -+ elems->mdie_len = elen; -+ break; -+ case WLAN_EID_FAST_BSS_TRANSITION: -+ elems->ftie = pos; -+ elems->ftie_len = elen; -+ break; -+ case WLAN_EID_TIMEOUT_INTERVAL: -+ elems->timeout_int = pos; -+ elems->timeout_int_len = elen; -+ break; -+ case WLAN_EID_HT_CAP: -+ elems->ht_capabilities = pos; -+ elems->ht_capabilities_len = elen; -+ break; -+ case WLAN_EID_HT_OPERATION: -+ elems->ht_operation = pos; -+ elems->ht_operation_len = elen; -+ break; -+ case WLAN_EID_VHT_CAPABILITY: -+ elems->vht_capabilities = pos; -+ elems->vht_capabilities_len = elen; -+ break; -+ case WLAN_EID_VHT_OPERATION: -+ elems->vht_operation = pos; -+ elems->vht_operation_len = elen; -+ break; -+ case WLAN_EID_VHT_OP_MODE_NOTIFY: -+ elems->vht_op_mode_notify = pos; -+ elems->vht_op_mode_notify_len = elen; -+ break; -+ default: -+ unknown++; -+ if (!show_errors) -+ break; -+ DBG_871X("IEEE 802.11 element parse " -+ "ignored unknown element (id=%d elen=%d)\n", -+ id, elen); -+ break; -+ } -+ -+ left -= elen; -+ pos += elen; -+ } -+ -+ if (left) -+ return ParseFailed; -+ -+ return unknown ? ParseUnknown : ParseOK; -+ -+} -+ -+static u8 key_char2num(u8 ch); -+static u8 key_char2num(u8 ch) -+{ -+ if((ch>='0')&&(ch<='9')) -+ return ch - '0'; -+ else if ((ch>='a')&&(ch<='f')) -+ return ch - 'a' + 10; -+ else if ((ch>='A')&&(ch<='F')) -+ return ch - 'A' + 10; -+ else -+ return 0xff; -+} -+ -+u8 str_2char2num(u8 hch, u8 lch); -+u8 str_2char2num(u8 hch, u8 lch) -+{ -+ return ((key_char2num(hch) * 10 ) + key_char2num(lch)); -+} -+ -+u8 key_2char2num(u8 hch, u8 lch); -+u8 key_2char2num(u8 hch, u8 lch) -+{ -+ return ((key_char2num(hch) << 4) | key_char2num(lch)); -+} -+ -+static u8 convert_ip_addr(u8 hch, u8 mch, u8 lch) -+{ -+ return ((key_char2num(hch) * 100) + (key_char2num(mch) * 10 ) + key_char2num(lch)); -+} -+ -+extern char* rtw_initmac; -+void rtw_macaddr_cfg(u8 *mac_addr) -+{ -+ u8 mac[ETH_ALEN]; -+ if(mac_addr == NULL) return; -+ -+ if ( rtw_initmac ) -+ { // Users specify the mac address -+ int jj,kk; -+ -+ for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 ) -+ { -+ mac[jj] = key_2char2num(rtw_initmac[kk], rtw_initmac[kk+ 1]); -+ } -+ _rtw_memcpy(mac_addr, mac, ETH_ALEN); -+ } -+ else -+ { // Use the mac address stored in the Efuse -+ _rtw_memcpy(mac, mac_addr, ETH_ALEN); -+ } -+ -+ if (((mac[0]==0xff) &&(mac[1]==0xff) && (mac[2]==0xff) && -+ (mac[3]==0xff) && (mac[4]==0xff) &&(mac[5]==0xff)) || -+ ((mac[0]==0x0) && (mac[1]==0x0) && (mac[2]==0x0) && -+ (mac[3]==0x0) && (mac[4]==0x0) &&(mac[5]==0x0))) -+ { -+ mac[0] = 0x00; -+ mac[1] = 0xe0; -+ mac[2] = 0x4c; -+ mac[3] = 0x87; -+ mac[4] = 0x00; -+ mac[5] = 0x00; -+ // use default mac addresss -+ _rtw_memcpy(mac_addr, mac, ETH_ALEN); -+ DBG_871X("MAC Address from efuse error, assign default one !!!\n"); -+ } -+ -+ DBG_871X("rtw_macaddr_cfg MAC Address = "MAC_FMT"\n", MAC_ARG(mac_addr)); -+} -+ -+void dump_ies(u8 *buf, u32 buf_len) { -+ u8* pos = (u8*)buf; -+ u8 id, len; -+ -+ while(pos-buf<=buf_len){ -+ id = *pos; -+ len = *(pos+1); -+ -+ DBG_871X("%s ID:%u, LEN:%u\n", __FUNCTION__, id, len); -+ #ifdef CONFIG_P2P -+ dump_p2p_ie(pos, len); -+ #endif -+ dump_wps_ie(pos, len); -+ -+ pos+=(2+len); -+ } -+} -+ -+void dump_wps_ie(u8 *ie, u32 ie_len) { -+ u8* pos = (u8*)ie; -+ u16 id; -+ u16 len; -+ -+ u8 *wps_ie; -+ uint wps_ielen; -+ -+ wps_ie = rtw_get_wps_ie(ie, ie_len, NULL, &wps_ielen); -+ if(wps_ie != ie || wps_ielen == 0) -+ return; -+ -+ pos+=6; -+ while(pos-ie < ie_len){ -+ id = RTW_GET_BE16(pos); -+ len = RTW_GET_BE16(pos + 2); -+ -+ DBG_871X("%s ID:0x%04x, LEN:%u\n", __FUNCTION__, id, len); -+ -+ pos+=(4+len); -+ } -+} -+ -+#ifdef CONFIG_P2P -+void dump_p2p_ie(u8 *ie, u32 ie_len) { -+ u8* pos = (u8*)ie; -+ u8 id; -+ u16 len; -+ -+ u8 *p2p_ie; -+ uint p2p_ielen; -+ -+ p2p_ie = rtw_get_p2p_ie(ie, ie_len, NULL, &p2p_ielen); -+ if(p2p_ie != ie || p2p_ielen == 0) -+ return; -+ -+ pos+=6; -+ while(pos-ie < ie_len){ -+ id = *pos; -+ len = RTW_GET_LE16(pos+1); -+ -+ DBG_871X("%s ID:%u, LEN:%u\n", __FUNCTION__, id, len); -+ -+ pos+=(3+len); -+ } -+} -+ -+/** -+ * rtw_get_p2p_ie - Search P2P IE from a series of IEs -+ * @in_ie: Address of IEs to search -+ * @in_len: Length limit from in_ie -+ * @p2p_ie: If not NULL and P2P IE is found, P2P IE will be copied to the buf starting from p2p_ie -+ * @p2p_ielen: If not NULL and P2P IE is found, will set to the length of the entire P2P IE -+ * -+ * Returns: The address of the P2P IE found, or NULL -+ */ -+u8 *rtw_get_p2p_ie(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen) -+{ -+ uint cnt = 0; -+ u8 *p2p_ie_ptr; -+ u8 eid, p2p_oui[4]={0x50,0x6F,0x9A,0x09}; -+ -+ if ( p2p_ielen != NULL ) -+ *p2p_ielen = 0; -+ -+ while(cnt MAX_IE_SZ)) { -+ rtw_dump_stack(); -+ return NULL; -+ } -+ if( ( eid == _VENDOR_SPECIFIC_IE_ ) && ( _rtw_memcmp( &in_ie[cnt+2], p2p_oui, 4) == true ) ) -+ { -+ p2p_ie_ptr = in_ie + cnt; -+ -+ if ( p2p_ie != NULL ) -+ { -+ _rtw_memcpy( p2p_ie, &in_ie[ cnt ], in_ie[ cnt + 1 ] + 2 ); -+ } -+ -+ if ( p2p_ielen != NULL ) -+ { -+ *p2p_ielen = in_ie[ cnt + 1 ] + 2; -+ } -+ -+ return p2p_ie_ptr; -+ -+ break; -+ } -+ else -+ { -+ cnt += in_ie[ cnt + 1 ] +2; //goto next -+ } -+ -+ } -+ -+ return NULL; -+ -+} -+ -+/** -+ * rtw_get_p2p_attr - Search a specific P2P attribute from a given P2P IE -+ * @p2p_ie: Address of P2P IE to search -+ * @p2p_ielen: Length limit from p2p_ie -+ * @target_attr_id: The attribute ID of P2P attribute to search -+ * @buf_attr: If not NULL and the P2P attribute is found, P2P attribute will be copied to the buf starting from buf_attr -+ * @len_attr: If not NULL and the P2P attribute is found, will set to the length of the entire P2P attribute -+ * -+ * Returns: the address of the specific WPS attribute found, or NULL -+ */ -+u8 *rtw_get_p2p_attr(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id ,u8 *buf_attr, u32 *len_attr) -+{ -+ u8 *attr_ptr = NULL; -+ u8 *target_attr_ptr = NULL; -+ u8 p2p_oui[4]={0x50,0x6F,0x9A,0x09}; -+ -+ if(len_attr) -+ *len_attr = 0; -+ -+ if ( !p2p_ie || ( p2p_ie[0] != _VENDOR_SPECIFIC_IE_ ) || -+ ( _rtw_memcmp( p2p_ie + 2, p2p_oui , 4 ) != true ) ) -+ { -+ return attr_ptr; -+ } -+ -+ // 6 = 1(Element ID) + 1(Length) + 3 (OUI) + 1(OUI Type) -+ attr_ptr = p2p_ie + 6; //goto first attr -+ -+ while(attr_ptr - p2p_ie < p2p_ielen) -+ { -+ // 3 = 1(Attribute ID) + 2(Length) -+ u8 attr_id = *attr_ptr; -+ u16 attr_data_len = RTW_GET_LE16(attr_ptr + 1); -+ u16 attr_len = attr_data_len + 3; -+ -+ //DBG_871X("%s attr_ptr:%p, id:%u, length:%u\n", __FUNCTION__, attr_ptr, attr_id, attr_data_len); -+ if( attr_id == target_attr_id ) -+ { -+ target_attr_ptr = attr_ptr; -+ -+ if(buf_attr) -+ _rtw_memcpy(buf_attr, attr_ptr, attr_len); -+ -+ if(len_attr) -+ *len_attr = attr_len; -+ -+ break; -+ } -+ else -+ { -+ attr_ptr += attr_len; //goto next -+ } -+ -+ } -+ -+ return target_attr_ptr; -+} -+ -+/** -+ * rtw_get_p2p_attr_content - Search a specific P2P attribute content from a given P2P IE -+ * @p2p_ie: Address of P2P IE to search -+ * @p2p_ielen: Length limit from p2p_ie -+ * @target_attr_id: The attribute ID of P2P attribute to search -+ * @buf_content: If not NULL and the P2P attribute is found, P2P attribute content will be copied to the buf starting from buf_content -+ * @len_content: If not NULL and the P2P attribute is found, will set to the length of the P2P attribute content -+ * -+ * Returns: the address of the specific P2P attribute content found, or NULL -+ */ -+u8 *rtw_get_p2p_attr_content(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id ,u8 *buf_content, uint *len_content) -+{ -+ u8 *attr_ptr; -+ u32 attr_len; -+ -+ if(len_content) -+ *len_content = 0; -+ -+ attr_ptr = rtw_get_p2p_attr(p2p_ie, p2p_ielen, target_attr_id, NULL, &attr_len); -+ -+ if(attr_ptr && attr_len) -+ { -+ if(buf_content) -+ _rtw_memcpy(buf_content, attr_ptr+3, attr_len-3); -+ -+ if(len_content) -+ *len_content = attr_len-3; -+ -+ return attr_ptr+3; -+ } -+ -+ return NULL; -+} -+ -+u32 rtw_set_p2p_attr_content(u8 *pbuf, u8 attr_id, u16 attr_len, u8 *pdata_attr) -+{ -+ u32 a_len; -+ -+ *pbuf = attr_id; -+ -+ //*(u16*)(pbuf + 1) = cpu_to_le16(attr_len); -+ RTW_PUT_LE16(pbuf + 1, attr_len); -+ -+ if(pdata_attr) -+ _rtw_memcpy(pbuf + 3, pdata_attr, attr_len); -+ -+ a_len = attr_len + 3; -+ -+ return a_len; -+} -+ -+static uint rtw_p2p_attr_remove(u8 *ie, uint ielen_ori, u8 attr_id) -+{ -+ u8 *target_attr; -+ u32 target_attr_len; -+ uint ielen = ielen_ori; -+ int index=0; -+ -+ while(1) { -+ target_attr=rtw_get_p2p_attr(ie, ielen, attr_id, NULL, &target_attr_len); -+ if(target_attr && target_attr_len) -+ { -+ u8 *next_attr = target_attr+target_attr_len; -+ uint remain_len = ielen-(next_attr-ie); -+ //dump_ies(ie, ielen); -+ #if 0 -+ DBG_871X("[%d] ie:%p, ielen:%u\n" -+ "target_attr:%p, target_attr_len:%u\n" -+ "next_attr:%p, remain_len:%u\n" -+ , index++ -+ , ie, ielen -+ , target_attr, target_attr_len -+ , next_attr, remain_len -+ ); -+ #endif -+ -+ _rtw_memset(target_attr, 0, target_attr_len); -+ _rtw_memcpy(target_attr, next_attr, remain_len); -+ _rtw_memset(target_attr+remain_len, 0, target_attr_len); -+ *(ie+1) -= target_attr_len; -+ ielen-=target_attr_len; -+ } -+ else -+ { -+ //if(index>0) -+ // dump_ies(ie, ielen); -+ break; -+ } -+ } -+ -+ return ielen; -+} -+ -+void rtw_WLAN_BSSID_EX_remove_p2p_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id) -+{ -+ u8 *p2p_ie; -+ uint p2p_ielen, p2p_ielen_ori; -+ int cnt; -+ -+ if( (p2p_ie=rtw_get_p2p_ie(bss_ex->IEs+_FIXED_IE_LENGTH_, bss_ex->IELength-_FIXED_IE_LENGTH_, NULL, &p2p_ielen_ori)) ) -+ { -+ #if 0 -+ if(rtw_get_p2p_attr(p2p_ie, p2p_ielen_ori, attr_id, NULL, NULL)) { -+ DBG_871X("rtw_get_p2p_attr: GOT P2P_ATTR:%u!!!!!!!!\n", attr_id); -+ dump_ies(bss_ex->IEs+_FIXED_IE_LENGTH_, bss_ex->IELength-_FIXED_IE_LENGTH_); -+ } -+ #endif -+ -+ p2p_ielen=rtw_p2p_attr_remove(p2p_ie, p2p_ielen_ori, attr_id); -+ if(p2p_ielen != p2p_ielen_ori) { -+ -+ u8 *next_ie_ori = p2p_ie+p2p_ielen_ori; -+ u8 *next_ie = p2p_ie+p2p_ielen; -+ uint remain_len = bss_ex->IELength-(next_ie_ori-bss_ex->IEs); -+ -+ _rtw_memcpy(next_ie, next_ie_ori, remain_len); -+ _rtw_memset(next_ie+remain_len, 0, p2p_ielen_ori-p2p_ielen); -+ bss_ex->IELength -= p2p_ielen_ori-p2p_ielen; -+ -+ #if 0 -+ DBG_871X("remove P2P_ATTR:%u!\n", attr_id); -+ dump_ies(bss_ex->IEs+_FIXED_IE_LENGTH_, bss_ex->IELength-_FIXED_IE_LENGTH_); -+ #endif -+ } -+ } -+} -+ -+#endif //CONFIG_P2P -+ -+#ifdef CONFIG_WFD -+int rtw_get_wfd_ie(u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen) -+{ -+ int match; -+ uint cnt = 0; -+ u8 eid, wfd_oui[4]={0x50,0x6F,0x9A,0x0A}; -+ -+ -+ match=false; -+ -+ if ( in_len < 0 ) -+ { -+ return match; -+ } -+ -+ while(cnt 1 byte for attribute ID field, 2 bytes for length field -+ if(attr_content) -+ _rtw_memcpy( attr_content, &wfd_ie[ cnt + 3 ], attrlen ); -+ -+ if(attr_contentlen) -+ *attr_contentlen = attrlen; -+ -+ cnt += attrlen + 3; -+ -+ match = true; -+ break; -+ } -+ else -+ { -+ cnt += attrlen + 3; //goto next -+ } -+ -+ } -+ -+ return match; -+ -+} -+#endif // CONFIG_WFD -+ -+//Baron adds to avoid FreeBSD warning -+int ieee80211_is_empty_essid(const char *essid, int essid_len) -+{ -+ /* Single white space is for Linksys APs */ -+ if (essid_len == 1 && essid[0] == ' ') -+ return 1; -+ -+ /* Otherwise, if the entire essid is 0, we assume it is hidden */ -+ while (essid_len) { -+ essid_len--; -+ if (essid[essid_len] != '\0') -+ return 0; -+ } -+ -+ return 1; -+} -+ -+int ieee80211_get_hdrlen(u16 fc) -+{ -+ int hdrlen = 24; -+ -+ switch (WLAN_FC_GET_TYPE(fc)) { -+ case RTW_IEEE80211_FTYPE_DATA: -+ if (fc & RTW_IEEE80211_STYPE_QOS_DATA) -+ hdrlen += 2; -+ if ((fc & RTW_IEEE80211_FCTL_FROMDS) && (fc & RTW_IEEE80211_FCTL_TODS)) -+ hdrlen += 6; /* Addr4 */ -+ break; -+ case RTW_IEEE80211_FTYPE_CTL: -+ switch (WLAN_FC_GET_STYPE(fc)) { -+ case RTW_IEEE80211_STYPE_CTS: -+ case RTW_IEEE80211_STYPE_ACK: -+ hdrlen = 10; -+ break; -+ default: -+ hdrlen = 16; -+ break; -+ } -+ break; -+ } -+ -+ return hdrlen; -+} -+ -+static int rtw_get_cipher_info(struct wlan_network *pnetwork) -+{ -+ u32 wpa_ielen; -+ unsigned char *pbuf; -+ int group_cipher = 0, pairwise_cipher = 0, is8021x = 0; -+ int ret = _FAIL; -+ pbuf = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength-12); -+ -+ if(pbuf && (wpa_ielen>0)) { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_get_cipher_info: wpa_ielen: %d", wpa_ielen)); -+ if (_SUCCESS == rtw_parse_wpa_ie(pbuf, wpa_ielen+2, &group_cipher, &pairwise_cipher, &is8021x)) { -+ -+ pnetwork->BcnInfo.pairwise_cipher = pairwise_cipher; -+ pnetwork->BcnInfo.group_cipher = group_cipher; -+ pnetwork->BcnInfo.is_8021x = is8021x; -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("%s: pnetwork->pairwise_cipher: %d, is_8021x is %d", -+ __func__, pnetwork->BcnInfo.pairwise_cipher, pnetwork->BcnInfo.is_8021x)); -+ ret = _SUCCESS; -+ } -+ } else { -+ -+ pbuf = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength-12); -+ -+ if(pbuf && (wpa_ielen>0)) { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("get RSN IE\n")); -+ if (_SUCCESS == rtw_parse_wpa2_ie(pbuf, wpa_ielen+2, &group_cipher, &pairwise_cipher, &is8021x)) { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("get RSN IE OK!!!\n")); -+ pnetwork->BcnInfo.pairwise_cipher = pairwise_cipher; -+ pnetwork->BcnInfo.group_cipher = group_cipher; -+ pnetwork->BcnInfo.is_8021x = is8021x; -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("%s: pnetwork->pairwise_cipher: %d," -+ "pnetwork->group_cipher is %d, is_8021x is %d", __func__, pnetwork->BcnInfo.pairwise_cipher, -+ pnetwork->BcnInfo.group_cipher,pnetwork->BcnInfo.is_8021x)); -+ ret = _SUCCESS; -+ } -+ } -+ } -+ -+ return ret; -+} -+ -+void rtw_get_bcn_info(struct wlan_network *pnetwork) -+{ -+ unsigned short cap = 0; -+ u8 bencrypt = 0; -+ //u8 wpa_ie[255],rsn_ie[255]; -+ u16 wpa_len=0,rsn_len=0; -+ struct HT_info_element *pht_info = NULL; -+ struct rtw_ieee80211_ht_cap *pht_cap = NULL; -+ unsigned int len; -+ unsigned char *p; -+ -+ _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); -+ le16_to_cpup((__le16 *)&cap); -+ if (cap & WLAN_CAPABILITY_PRIVACY) { -+ bencrypt = 1; -+ pnetwork->network.Privacy = 1; -+ } else { -+ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_OPENSYS; -+ } -+ rtw_get_sec_ie(pnetwork->network.IEs ,pnetwork->network.IELength,NULL,&rsn_len,NULL,&wpa_len); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_get_bcn_info: ssid=%s\n",pnetwork->network.Ssid.Ssid)); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_get_bcn_info: wpa_len=%d rsn_len=%d\n",wpa_len,rsn_len)); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_get_bcn_info: ssid=%s\n",pnetwork->network.Ssid.Ssid)); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_get_bcn_info: wpa_len=%d rsn_len=%d\n",wpa_len,rsn_len)); -+ -+ if (rsn_len > 0) { -+ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_WPA2; -+ } else if (wpa_len > 0) { -+ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_WPA; -+ } else { -+ if (bencrypt) -+ pnetwork->BcnInfo.encryp_protocol = ENCRYP_PROTOCOL_WEP; -+ } -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_get_bcn_info: pnetwork->encryp_protocol is %x\n", -+ pnetwork->BcnInfo.encryp_protocol)); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_get_bcn_info: pnetwork->encryp_protocol is %x\n", -+ pnetwork->BcnInfo.encryp_protocol)); -+ rtw_get_cipher_info(pnetwork); -+ -+ /* get bwmode and ch_offset */ -+ /* parsing HT_CAP_IE */ -+ p = rtw_get_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, pnetwork->network.IELength - _FIXED_IE_LENGTH_); -+ if(p && len>0) { -+ pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); -+ pnetwork->BcnInfo.ht_cap_info = le16_to_cpu(pht_cap->cap_info); -+ } else { -+ pnetwork->BcnInfo.ht_cap_info = 0; -+ } -+ /* parsing HT_INFO_IE */ -+ p = rtw_get_ie(pnetwork->network.IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, pnetwork->network.IELength - _FIXED_IE_LENGTH_); -+ if(p && len>0) { -+ pht_info = (struct HT_info_element *)(p + 2); -+ pnetwork->BcnInfo.ht_info_infos_0 = pht_info->infos[0]; -+ } else { -+ pnetwork->BcnInfo.ht_info_infos_0 = 0; -+ } -+} -+ -+//show MCS rate, unit: 100Kbps -+u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI_20, u8 short_GI_40, unsigned char * MCS_rate) -+{ -+ u16 max_rate = 0; -+ -+ if(rf_type == RF_1T1R) -+ { -+ if(MCS_rate[0] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?1500:1350):((short_GI_20)?722:650); -+ else if(MCS_rate[0] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?1350:1215):((short_GI_20)?650:585); -+ else if(MCS_rate[0] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?1200:1080):((short_GI_20)?578:520); -+ else if(MCS_rate[0] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?900:810):((short_GI_20)?433:390); -+ else if(MCS_rate[0] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?600:540):((short_GI_20)?289:260); -+ else if(MCS_rate[0] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?450:405):((short_GI_20)?217:195); -+ else if(MCS_rate[0] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?300:270):((short_GI_20)?144:130); -+ else if(MCS_rate[0] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?150:135):((short_GI_20)?72:65); -+ } -+ else -+ { -+ if(MCS_rate[1]) -+ { -+ if(MCS_rate[1] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?3000:2700):((short_GI_20)?1444:1300); -+ else if(MCS_rate[1] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?2700:2430):((short_GI_20)?1300:1170); -+ else if(MCS_rate[1] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?2400:2160):((short_GI_20)?1156:1040); -+ else if(MCS_rate[1] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?1800:1620):((short_GI_20)?867:780); -+ else if(MCS_rate[1] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?1200:1080):((short_GI_20)?578:520); -+ else if(MCS_rate[1] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?900:810):((short_GI_20)?433:390); -+ else if(MCS_rate[1] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?600:540):((short_GI_20)?289:260); -+ else if(MCS_rate[1] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?300:270):((short_GI_20)?144:130); -+ } -+ else -+ { -+ if(MCS_rate[0] & BIT(7)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?1500:1350):((short_GI_20)?722:650); -+ else if(MCS_rate[0] & BIT(6)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?1350:1215):((short_GI_20)?650:585); -+ else if(MCS_rate[0] & BIT(5)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?1200:1080):((short_GI_20)?578:520); -+ else if(MCS_rate[0] & BIT(4)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?900:810):((short_GI_20)?433:390); -+ else if(MCS_rate[0] & BIT(3)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?600:540):((short_GI_20)?289:260); -+ else if(MCS_rate[0] & BIT(2)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?450:405):((short_GI_20)?217:195); -+ else if(MCS_rate[0] & BIT(1)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?300:270):((short_GI_20)?144:130); -+ else if(MCS_rate[0] & BIT(0)) -+ max_rate = (bw_40MHz) ? ((short_GI_40)?150:135):((short_GI_20)?72:65); -+ } -+ } -+ return max_rate; -+} -+ -+int rtw_action_frame_parse(const u8 *frame, u32 frame_len, u8* category, u8 *action) -+{ -+ const u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u16 fc; -+ u8 c, a; -+ -+ fc = le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)frame)->frame_ctl); -+ -+ if ((fc & (RTW_IEEE80211_FCTL_FTYPE|RTW_IEEE80211_FCTL_STYPE)) -+ != (RTW_IEEE80211_FTYPE_MGMT|RTW_IEEE80211_STYPE_ACTION) -+ ) -+ { -+ return false; -+ } -+ -+ c = frame_body[0]; -+ -+ switch(c) { -+ case RTW_WLAN_CATEGORY_P2P: /* vendor-specific */ -+ break; -+ default: -+ a = frame_body[1]; -+ } -+ -+ if (category) -+ *category = c; -+ if (action) -+ *action = a; -+ -+ return true; -+} -+ -+static const char *_action_public_str[] = { -+ "ACT_PUB_BSSCOEXIST", -+ "ACT_PUB_DSE_ENABLE", -+ "ACT_PUB_DSE_DEENABLE", -+ "ACT_PUB_DSE_REG_LOCATION", -+ "ACT_PUB_EXT_CHL_SWITCH", -+ "ACT_PUB_DSE_MSR_REQ", -+ "ACT_PUB_DSE_MSR_RPRT", -+ "ACT_PUB_MP", -+ "ACT_PUB_DSE_PWR_CONSTRAINT", -+ "ACT_PUB_VENDOR", -+ "ACT_PUB_GAS_INITIAL_REQ", -+ "ACT_PUB_GAS_INITIAL_RSP", -+ "ACT_PUB_GAS_COMEBACK_REQ", -+ "ACT_PUB_GAS_COMEBACK_RSP", -+ "ACT_PUB_TDLS_DISCOVERY_RSP", -+ "ACT_PUB_LOCATION_TRACK", -+ "ACT_PUB_RSVD", -+}; -+ -+const char *action_public_str(u8 action) -+{ -+ action = (action >= ACT_PUBLIC_MAX) ? ACT_PUBLIC_MAX : action; -+ return _action_public_str[action]; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_io.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_io.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_io.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_io.c 2018-02-06 17:42:30.694966927 +0200 -@@ -0,0 +1,426 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/* -+ -+The purpose of rtw_io.c -+ -+a. provides the API -+ -+b. provides the protocol engine -+ -+c. provides the software interface between caller and the hardware interface -+ -+ -+Compiler Flag Option: -+ -+USE_ASYNC_IRP: Both sync/async operations are provided. -+ -+Only sync read/rtw_write_mem operations are provided. -+ -+jackson@realtek.com.tw -+ -+*/ -+ -+#define _RTW_IO_C_ -+ -+#include -+ -+#define rtw_le16_to_cpu(val) le16_to_cpu(val) -+#define rtw_le32_to_cpu(val) le32_to_cpu(val) -+#define rtw_cpu_to_le16(val) cpu_to_le16(val) -+#define rtw_cpu_to_le32(val) cpu_to_le32(val) -+ -+u8 _rtw_read8(_adapter *adapter, u32 addr) -+{ -+ u8 r_val; -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u8 (*_read8)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _read8 = pintfhdl->io_ops._read8; -+ -+ r_val = _read8(pintfhdl, addr); -+ -+ return r_val; -+} -+ -+u16 _rtw_read16(_adapter *adapter, u32 addr) -+{ -+ u16 r_val; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u16 (*_read16)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _read16 = pintfhdl->io_ops._read16; -+ -+ r_val = _read16(pintfhdl, addr); -+ -+ return r_val; -+} -+ -+u32 _rtw_read32(_adapter *adapter, u32 addr) -+{ -+ u32 r_val; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u32 (*_read32)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ _read32 = pintfhdl->io_ops._read32; -+ -+ r_val = _read32(pintfhdl, addr); -+ -+ return r_val; -+} -+ -+int _rtw_write8(_adapter *adapter, u32 addr, u8 val) -+{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int ret; -+ -+ _write8 = pintfhdl->io_ops._write8; -+ -+ ret = _write8(pintfhdl, addr, val); -+ -+ -+ return RTW_STATUS_CODE(ret); -+} -+int _rtw_write16(_adapter *adapter, u32 addr, u16 val) -+{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int ret; -+ -+ _write16 = pintfhdl->io_ops._write16; -+ -+ ret = _write16(pintfhdl, addr, val); -+ -+ -+ return RTW_STATUS_CODE(ret); -+} -+int _rtw_write32(_adapter *adapter, u32 addr, u32 val) -+{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ int ret; -+ -+ _write32 = pintfhdl->io_ops._write32; -+ -+ ret = _write32(pintfhdl, addr, val); -+ -+ return RTW_STATUS_CODE(ret); -+} -+ -+int _rtw_writeN(_adapter *adapter, u32 addr ,u32 length , u8 *pdata) -+{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = (struct intf_hdl*)(&(pio_priv->intf)); -+ int (*_writeN)(struct intf_hdl *pintfhdl, u32 addr,u32 length, u8 *pdata); -+ int ret; -+ -+ _writeN = pintfhdl->io_ops._writeN; -+ -+ ret = _writeN(pintfhdl, addr,length,pdata); -+ -+ -+ return RTW_STATUS_CODE(ret); -+} -+int _rtw_write8_async(_adapter *adapter, u32 addr, u8 val) -+{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write8_async)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int ret; -+ -+ _write8_async = pintfhdl->io_ops._write8_async; -+ -+ ret = _write8_async(pintfhdl, addr, val); -+ -+ -+ return RTW_STATUS_CODE(ret); -+} -+int _rtw_write16_async(_adapter *adapter, u32 addr, u16 val) -+{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write16_async)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int ret; -+ -+ _write16_async = pintfhdl->io_ops._write16_async; -+ ret = _write16_async(pintfhdl, addr, val); -+ -+ return RTW_STATUS_CODE(ret); -+} -+ -+int _rtw_write32_async(_adapter *adapter, u32 addr, u32 val) -+{ -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ int (*_write32_async)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ int ret; -+ -+ _write32_async = pintfhdl->io_ops._write32_async; -+ ret = _write32_async(pintfhdl, addr, val); -+ -+ return RTW_STATUS_CODE(ret); -+} -+ -+void _rtw_read_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) -+{ -+ void (*_read_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ -+ -+ -+ if( (adapter->bDriverStopped ==true) || (adapter->bSurpriseRemoved == true)) -+ { -+ RT_TRACE(_module_rtl871x_io_c_, _drv_info_, ("rtw_read_mem:bDriverStopped(%d) OR bSurpriseRemoved(%d)", adapter->bDriverStopped, adapter->bSurpriseRemoved)); -+ return; -+ } -+ -+ _read_mem = pintfhdl->io_ops._read_mem; -+ -+ _read_mem(pintfhdl, addr, cnt, pmem); -+ -+ -+ -+} -+ -+void _rtw_write_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) -+{ -+ void (*_write_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ -+ -+ -+ _write_mem = pintfhdl->io_ops._write_mem; -+ -+ _write_mem(pintfhdl, addr, cnt, pmem); -+ -+ -+ -+} -+ -+void _rtw_read_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) -+{ -+ u32 (*_read_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ -+ -+ -+ if( (adapter->bDriverStopped ==true) || (adapter->bSurpriseRemoved == true)) -+ { -+ RT_TRACE(_module_rtl871x_io_c_, _drv_info_, ("rtw_read_port:bDriverStopped(%d) OR bSurpriseRemoved(%d)", adapter->bDriverStopped, adapter->bSurpriseRemoved)); -+ return; -+ } -+ -+ _read_port = pintfhdl->io_ops._read_port; -+ -+ _read_port(pintfhdl, addr, cnt, pmem); -+ -+ -+ -+} -+ -+void _rtw_read_port_cancel(_adapter *adapter) -+{ -+ void (*_read_port_cancel)(struct intf_hdl *pintfhdl); -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ -+ _read_port_cancel = pintfhdl->io_ops._read_port_cancel; -+ -+ if(_read_port_cancel) -+ _read_port_cancel(pintfhdl); -+ -+} -+ -+u32 _rtw_write_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem) -+{ -+ u32 (*_write_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ //struct io_queue *pio_queue = (struct io_queue *)adapter->pio_queue; -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ u32 ret = _SUCCESS; -+ -+ -+ -+ _write_port = pintfhdl->io_ops._write_port; -+ -+ ret = _write_port(pintfhdl, addr, cnt, pmem); -+ -+ -+ -+ return ret; -+} -+ -+u32 _rtw_write_port_and_wait(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem, int timeout_ms) -+{ -+ int ret = _SUCCESS; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)pmem; -+ struct submit_ctx sctx; -+ -+ rtw_sctx_init(&sctx, timeout_ms); -+ pxmitbuf->sctx = &sctx; -+ -+ ret = _rtw_write_port(adapter, addr, cnt, pmem); -+ -+ if (ret == _SUCCESS) -+ ret = rtw_sctx_wait(&sctx); -+ -+ return ret; -+} -+ -+void _rtw_write_port_cancel(_adapter *adapter) -+{ -+ void (*_write_port_cancel)(struct intf_hdl *pintfhdl); -+ struct io_priv *pio_priv = &adapter->iopriv; -+ struct intf_hdl *pintfhdl = &(pio_priv->intf); -+ -+ _write_port_cancel = pintfhdl->io_ops._write_port_cancel; -+ -+ if(_write_port_cancel) -+ _write_port_cancel(pintfhdl); -+ -+} -+int rtw_init_io_priv(_adapter *padapter, void (*set_intf_ops)(_adapter *padapter,struct _io_ops *pops)) -+{ -+ struct io_priv *piopriv = &padapter->iopriv; -+ struct intf_hdl *pintf = &piopriv->intf; -+ -+ if (set_intf_ops == NULL) -+ return _FAIL; -+ -+ piopriv->padapter = padapter; -+ pintf->padapter = padapter; -+ pintf->pintf_dev = adapter_to_dvobj(padapter); -+ -+ set_intf_ops(padapter,&pintf->io_ops); -+ -+ return _SUCCESS; -+} -+ -+#ifdef DBG_IO -+ -+u16 read_sniff_ranges[][2] = { -+ //{0x550, 0x551}, -+}; -+ -+u16 write_sniff_ranges[][2] = { -+ //{0x550, 0x551}, -+ //{0x4c, 0x4c}, -+}; -+ -+int read_sniff_num = sizeof(read_sniff_ranges)/sizeof(u16)/2; -+int write_sniff_num = sizeof(write_sniff_ranges)/sizeof(u16)/2; -+ -+bool match_read_sniff_ranges(u16 addr, u16 len) -+{ -+ int i; -+ for (i = 0; i read_sniff_ranges[i][0] && addr <= read_sniff_ranges[i][1]) -+ return true; -+ } -+ -+ return false; -+} -+ -+bool match_write_sniff_ranges(u16 addr, u16 len) -+{ -+ int i; -+ for (i = 0; i write_sniff_ranges[i][0] && addr <= write_sniff_ranges[i][1]) -+ return true; -+ } -+ -+ return false; -+} -+ -+u8 dbg_rtw_read8(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u8 val = _rtw_read8(adapter, addr); -+ -+ if (match_read_sniff_ranges(addr, 1)) -+ DBG_871X("DBG_IO %s:%d rtw_read8(0x%04x) return 0x%02x\n", caller, line, addr, val); -+ -+ return val; -+} -+ -+u16 dbg_rtw_read16(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u16 val = _rtw_read16(adapter, addr); -+ -+ if (match_read_sniff_ranges(addr, 2)) -+ DBG_871X("DBG_IO %s:%d rtw_read16(0x%04x) return 0x%04x\n", caller, line, addr, val); -+ -+ return val; -+} -+ -+u32 dbg_rtw_read32(_adapter *adapter, u32 addr, const char *caller, const int line) -+{ -+ u32 val = _rtw_read32(adapter, addr); -+ -+ if (match_read_sniff_ranges(addr, 4)) -+ DBG_871X("DBG_IO %s:%d rtw_read32(0x%04x) return 0x%08x\n", caller, line, addr, val); -+ -+ return val; -+} -+ -+int dbg_rtw_write8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 1)) -+ DBG_871X("DBG_IO %s:%d rtw_write8(0x%04x, 0x%02x)\n", caller, line, addr, val); -+ -+ return _rtw_write8(adapter, addr, val); -+} -+int dbg_rtw_write16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 2)) -+ DBG_871X("DBG_IO %s:%d rtw_write16(0x%04x, 0x%04x)\n", caller, line, addr, val); -+ -+ return _rtw_write16(adapter, addr, val); -+} -+int dbg_rtw_write32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 4)) -+ DBG_871X("DBG_IO %s:%d rtw_write32(0x%04x, 0x%08x)\n", caller, line, addr, val); -+ -+ return _rtw_write32(adapter, addr, val); -+} -+int dbg_rtw_writeN(_adapter *adapter, u32 addr ,u32 length , u8 *data, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, length)) -+ DBG_871X("DBG_IO %s:%d rtw_writeN(0x%04x, %u)\n", caller, line, addr, length); -+ -+ return _rtw_writeN(adapter, addr, length, data); -+} -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_ioctl_query.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ioctl_query.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_ioctl_query.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ioctl_query.c 2018-02-06 17:42:30.694966927 +0200 -@@ -0,0 +1,20 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_IOCTL_QUERY_C_ -+ -+#include -+ -+ -+ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ioctl_rtl.c 2018-02-06 17:42:30.694966927 +0200 -@@ -0,0 +1,1017 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_IOCTL_RTL_C_ -+ -+#include -+ -+#ifdef CONFIG_MP_INCLUDED -+#include -+#endif -+ -+struct oid_obj_priv oid_rtl_seg_01_01[] = -+{ -+ {1, &oid_null_function}, //0x80 -+ {1, &oid_null_function}, //0x81 -+ {1, &oid_null_function}, //0x82 -+ {1, &oid_null_function}, //0x83//OID_RT_SET_SNIFFER_MODE -+ {1, &oid_rt_get_signal_quality_hdl}, //0x84 -+ {1, &oid_rt_get_small_packet_crc_hdl}, //0x85 -+ {1, &oid_rt_get_middle_packet_crc_hdl}, //0x86 -+ {1, &oid_rt_get_large_packet_crc_hdl}, //0x87 -+ {1, &oid_rt_get_tx_retry_hdl}, //0x88 -+ {1, &oid_rt_get_rx_retry_hdl}, //0x89 -+ {1, &oid_rt_pro_set_fw_dig_state_hdl}, //0x8A -+ {1, &oid_rt_pro_set_fw_ra_state_hdl} , //0x8B -+ {1, &oid_null_function}, //0x8C -+ {1, &oid_null_function}, //0x8D -+ {1, &oid_null_function}, //0x8E -+ {1, &oid_null_function}, //0x8F -+ {1, &oid_rt_get_rx_total_packet_hdl}, //0x90 -+ {1, &oid_rt_get_tx_beacon_ok_hdl}, //0x91 -+ {1, &oid_rt_get_tx_beacon_err_hdl}, //0x92 -+ {1, &oid_rt_get_rx_icv_err_hdl}, //0x93 -+ {1, &oid_rt_set_encryption_algorithm_hdl}, //0x94 -+ {1, &oid_null_function}, //0x95 -+ {1, &oid_rt_get_preamble_mode_hdl}, //0x96 -+ {1, &oid_null_function}, //0x97 -+ {1, &oid_rt_get_ap_ip_hdl}, //0x98 -+ {1, &oid_rt_get_channelplan_hdl}, //0x99 -+ {1, &oid_rt_set_preamble_mode_hdl}, //0x9A -+ {1, &oid_rt_set_bcn_intvl_hdl}, //0x9B -+ {1, &oid_null_function}, //0x9C -+ {1, &oid_rt_dedicate_probe_hdl}, //0x9D -+ {1, &oid_null_function}, //0x9E -+ {1, &oid_null_function}, //0x9F -+ {1, &oid_null_function}, //0xA0 -+ {1, &oid_null_function}, //0xA1 -+ {1, &oid_null_function}, //0xA2 -+ {1, &oid_null_function}, //0xA3 -+ {1, &oid_null_function}, //0xA4 -+ {1, &oid_null_function}, //0xA5 -+ {1, &oid_null_function}, //0xA6 -+ {1, &oid_rt_get_total_tx_bytes_hdl}, //0xA7 -+ {1, &oid_rt_get_total_rx_bytes_hdl}, //0xA8 -+ {1, &oid_rt_current_tx_power_level_hdl}, //0xA9 -+ {1, &oid_rt_get_enc_key_mismatch_count_hdl}, //0xAA -+ {1, &oid_rt_get_enc_key_match_count_hdl}, //0xAB -+ {1, &oid_rt_get_channel_hdl}, //0xAC -+ {1, &oid_rt_set_channelplan_hdl}, //0xAD -+ {1, &oid_rt_get_hardware_radio_off_hdl}, //0xAE -+ {1, &oid_null_function}, //0xAF -+ {1, &oid_null_function}, //0xB0 -+ {1, &oid_null_function}, //0xB1 -+ {1, &oid_null_function}, //0xB2 -+ {1, &oid_null_function}, //0xB3 -+ {1, &oid_rt_get_key_mismatch_hdl}, //0xB4 -+ {1, &oid_null_function}, //0xB5 -+ {1, &oid_null_function}, //0xB6 -+ {1, &oid_null_function}, //0xB7 -+ {1, &oid_null_function}, //0xB8 -+ {1, &oid_null_function}, //0xB9 -+ {1, &oid_null_function}, //0xBA -+ {1, &oid_rt_supported_wireless_mode_hdl}, //0xBB -+ {1, &oid_rt_get_channel_list_hdl}, //0xBC -+ {1, &oid_rt_get_scan_in_progress_hdl}, //0xBD -+ {1, &oid_null_function}, //0xBE -+ {1, &oid_null_function}, //0xBF -+ {1, &oid_null_function}, //0xC0 -+ {1, &oid_rt_forced_data_rate_hdl}, //0xC1 -+ {1, &oid_rt_wireless_mode_for_scan_list_hdl}, //0xC2 -+ {1, &oid_rt_get_bss_wireless_mode_hdl}, //0xC3 -+ {1, &oid_rt_scan_with_magic_packet_hdl}, //0xC4 -+ {1, &oid_null_function}, //0xC5 -+ {1, &oid_null_function}, //0xC6 -+ {1, &oid_null_function}, //0xC7 -+ {1, &oid_null_function}, //0xC8 -+ {1, &oid_null_function}, //0xC9 -+ {1, &oid_null_function}, //0xCA -+ {1, &oid_null_function}, //0xCB -+ {1, &oid_null_function}, //0xCC -+ {1, &oid_null_function}, //0xCD -+ {1, &oid_null_function}, //0xCE -+ {1, &oid_null_function}, //0xCF -+ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_01_03[] = -+{ -+ {1, &oid_rt_ap_get_associated_station_list_hdl}, //0x00 -+ {1, &oid_null_function}, //0x01 -+ {1, &oid_rt_ap_switch_into_ap_mode_hdl}, //0x02 -+ {1, &oid_null_function}, //0x03 -+ {1, &oid_rt_ap_supported_hdl}, //0x04 -+ {1, &oid_rt_ap_set_passphrase_hdl}, //0x05 -+ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_01_11[] = -+{ -+ {1, &oid_null_function}, //0xC0 OID_RT_PRO_RX_FILTER -+ {1, &oid_null_function}, //0xC1 OID_CE_USB_WRITE_REGISTRY -+ {1, &oid_null_function}, //0xC2 OID_CE_USB_READ_REGISTRY -+ {1, &oid_null_function}, //0xC3 OID_RT_PRO_SET_INITIAL_GAIN -+ {1, &oid_null_function}, //0xC4 OID_RT_PRO_SET_BB_RF_STANDBY_MODE -+ {1, &oid_null_function}, //0xC5 OID_RT_PRO_SET_BB_RF_SHUTDOWN_MODE -+ {1, &oid_null_function}, //0xC6 OID_RT_PRO_SET_TX_CHARGE_PUMP -+ {1, &oid_null_function}, //0xC7 OID_RT_PRO_SET_RX_CHARGE_PUMP -+ {1, &oid_rt_pro_rf_write_registry_hdl}, //0xC8 -+ {1, &oid_rt_pro_rf_read_registry_hdl}, //0xC9 -+ {1, &oid_null_function} //0xCA OID_RT_PRO_QUERY_RF_TYPE -+ -+}; -+ -+struct oid_obj_priv oid_rtl_seg_03_00[] = -+{ -+ {1, &oid_null_function}, //0x00 -+ {1, &oid_rt_get_connect_state_hdl}, //0x01 -+ {1, &oid_null_function}, //0x02 -+ {1, &oid_null_function}, //0x03 -+ {1, &oid_rt_set_default_key_id_hdl}, //0x04 -+ -+ -+}; -+ -+ -+//************** oid_rtl_seg_01_01 section start ************** -+ -+uint oid_rt_pro_set_fw_dig_state_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ _irqL oldirql; -+ -+ -+ -+ if(poid_par_priv->type_of_oid != SET_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ _irqlevel_changed_(&oldirql,LOWER); -+ if(poid_par_priv->information_buf_len >= sizeof(struct setdig_parm)) -+ { -+ //DEBUG_ERR(("===> oid_rt_pro_set_fw_dig_state_hdl. type:0x%02x.\n",*((unsigned char*)poid_par_priv->information_buf ))); -+ if(!rtw_setfwdig_cmd(Adapter,*((unsigned char*)poid_par_priv->information_buf ))) -+ { -+ status = uint_NOT_ACCEPTED; -+ } -+ -+ } -+ else{ -+ status = uint_NOT_ACCEPTED; -+ } -+ _irqlevel_changed_(&oldirql,RAISE); -+ -+#endif -+ return status; -+} -+//----------------------------------------------------------------------------- -+uint oid_rt_pro_set_fw_ra_state_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ -+ uint status = uint_SUCCESS; -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ _irqL oldirql; -+ -+ -+ if(poid_par_priv->type_of_oid != SET_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ -+ _irqlevel_changed_(&oldirql,LOWER); -+ -+ if(poid_par_priv->information_buf_len >= sizeof(struct setra_parm)) -+ { -+ //DEBUG_ERR(("===> oid_rt_pro_set_fw_ra_state_hdl. type:0x%02x.\n",*((unsigned char*)poid_par_priv->information_buf ))); -+ if(!rtw_setfwra_cmd(Adapter,*((unsigned char*)poid_par_priv->information_buf ))) -+ { -+ status = uint_NOT_ACCEPTED; -+ } -+ -+ } -+ else{ -+ status = uint_NOT_ACCEPTED; -+ } -+ _irqlevel_changed_(&oldirql,RAISE); -+ -+#endif -+ return status; -+} -+//----------------------------------------------------------------------------- -+uint oid_rt_get_signal_quality_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ //DEBUG_ERR(("<**********************oid_rt_get_signal_quality_hdl \n")); -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+#if 0 -+ if(pMgntInfo->mAssoc || pMgntInfo->mIbss) -+ { -+ ulInfo = pAdapter->RxStats.SignalQuality; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } -+ else -+ { -+ ulInfo = 0xffffffff; // It stands for -1 in 4-byte integer. -+ } -+ break; -+#endif -+ -+ return status; -+} -+ -+//------------------------------------------------------------------------------ -+ -+uint oid_rt_get_small_packet_crc_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if(poid_par_priv->information_buf_len >= sizeof(u32) ) -+ { -+ *(u32 *)poid_par_priv->information_buf = padapter->recvpriv.rx_smallpacket_crcerr; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } -+ else -+ { -+ status = uint_INVALID_LENGTH; -+ } -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_middle_packet_crc_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if(poid_par_priv->information_buf_len >= sizeof(u32) ) -+ { -+ *(u32 *)poid_par_priv->information_buf = padapter->recvpriv.rx_middlepacket_crcerr; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } -+ else -+ { -+ status = uint_INVALID_LENGTH; -+ } -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_large_packet_crc_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if(poid_par_priv->information_buf_len >= sizeof(u32) ) -+ { -+ *(u32 *)poid_par_priv->information_buf = padapter->recvpriv.rx_largepacket_crcerr; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } -+ else -+ { -+ status = uint_INVALID_LENGTH; -+ } -+ -+ -+ return status; -+} -+ -+//------------------------------------------------------------------------------ -+uint oid_rt_get_tx_retry_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+uint oid_rt_get_rx_retry_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_rx_total_packet_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ if(poid_par_priv->information_buf_len >= sizeof(u32) ) -+ { -+ *(u64 *)poid_par_priv->information_buf = padapter->recvpriv.rx_pkts + padapter->recvpriv.rx_drop; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } -+ else -+ { -+ status = uint_INVALID_LENGTH; -+ } -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_tx_beacon_ok_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+uint oid_rt_get_tx_beacon_err_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_rx_icv_err_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ if(poid_par_priv->information_buf_len>= sizeof(u32)) -+ { -+ //_rtw_memcpy(*(uint *)poid_par_priv->information_buf,padapter->recvpriv.rx_icv_err,sizeof(u32)); -+ *(uint *)poid_par_priv->information_buf = padapter->recvpriv.rx_icv_err; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } -+ else -+ { -+ status = uint_INVALID_LENGTH ; -+ } -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_set_encryption_algorithm_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != SET_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_preamble_mode_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ u32 preamblemode = 0 ; -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ if(poid_par_priv->information_buf_len>= sizeof(u32)) -+ { -+ if(padapter->registrypriv.preamble == PREAMBLE_LONG) -+ preamblemode = 0; -+ else if (padapter->registrypriv.preamble == PREAMBLE_AUTO) -+ preamblemode = 1; -+ else if (padapter->registrypriv.preamble == PREAMBLE_SHORT) -+ preamblemode = 2; -+ -+ -+ *(u32 *)poid_par_priv->information_buf = preamblemode ; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } -+ else -+ { -+ status = uint_INVALID_LENGTH ; -+ } -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_ap_ip_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+ -+uint oid_rt_get_channelplan_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ struct eeprom_priv* peeprompriv = &padapter->eeprompriv; -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ *(u16 *)poid_par_priv->information_buf = peeprompriv->channel_plan ; -+ -+ return status; -+} -+uint oid_rt_set_channelplan_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ struct eeprom_priv* peeprompriv = &padapter->eeprompriv; -+ -+ if(poid_par_priv->type_of_oid != SET_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ peeprompriv->channel_plan = *(u16 *)poid_par_priv->information_buf ; -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_set_preamble_mode_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ u32 preamblemode = 0; -+ if(poid_par_priv->type_of_oid != SET_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if(poid_par_priv->information_buf_len>= sizeof(u32)) -+ { -+ preamblemode = *(u32 *)poid_par_priv->information_buf ; -+ if( preamblemode == 0) -+ padapter->registrypriv.preamble = PREAMBLE_LONG; -+ else if (preamblemode==1 ) -+ padapter->registrypriv.preamble = PREAMBLE_AUTO; -+ else if ( preamblemode==2 ) -+ padapter->registrypriv.preamble = PREAMBLE_SHORT; -+ -+ *(u32 *)poid_par_priv->information_buf = preamblemode ; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } -+ else -+ { -+ status = uint_INVALID_LENGTH ; -+ } -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_set_bcn_intvl_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != SET_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+uint oid_rt_dedicate_probe_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_total_tx_bytes_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ if(poid_par_priv->information_buf_len>= sizeof(u32)) -+ { -+ *(u64 *)poid_par_priv->information_buf = padapter->xmitpriv.tx_bytes; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } -+ else -+ { -+ status = uint_INVALID_LENGTH ; -+ } -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_total_rx_bytes_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ if(poid_par_priv->information_buf_len>= sizeof(u32)) -+ { -+ //_rtw_memcpy(*(uint *)poid_par_priv->information_buf,padapter->recvpriv.rx_icv_err,sizeof(u32)); -+ *(u64 *)poid_par_priv->information_buf = padapter->recvpriv.rx_bytes; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } -+ else -+ { -+ status = uint_INVALID_LENGTH ; -+ } -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_current_tx_power_level_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+uint oid_rt_get_enc_key_mismatch_count_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+uint oid_rt_get_enc_key_match_count_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+uint oid_rt_get_channel_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ NDIS_802_11_CONFIGURATION *pnic_Config; -+ -+ u32 channelnum; -+ -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if ( (check_fwstate(pmlmepriv, _FW_LINKED) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) -+ pnic_Config = &pmlmepriv->cur_network.network.Configuration; -+ else -+ pnic_Config = &padapter->registrypriv.dev_network.Configuration; -+ -+ channelnum = pnic_Config->DSConfig; -+ *(u32 *)poid_par_priv->information_buf = channelnum; -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ -+ -+ -+ -+ return status; -+} -+uint oid_rt_get_hardware_radio_off_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+uint oid_rt_get_key_mismatch_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+uint oid_rt_supported_wireless_mode_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ u32 ulInfo = 0 ; -+ //DEBUG_ERR(("<**********************oid_rt_supported_wireless_mode_hdl \n")); -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ if(poid_par_priv->information_buf_len >= sizeof(u32)){ -+ ulInfo |= 0x0100; //WIRELESS_MODE_B -+ ulInfo |= 0x0200; //WIRELESS_MODE_G -+ ulInfo |= 0x0400; //WIRELESS_MODE_A -+ -+ *(u32 *) poid_par_priv->information_buf = ulInfo; -+ //DEBUG_ERR(("<===oid_rt_supported_wireless_mode %x\n",ulInfo)); -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } -+ else{ -+ status = uint_INVALID_LENGTH; -+ } -+ -+ return status; -+} -+uint oid_rt_get_channel_list_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+uint oid_rt_get_scan_in_progress_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+ -+ -+uint oid_rt_forced_data_rate_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+uint oid_rt_wireless_mode_for_scan_list_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+uint oid_rt_get_bss_wireless_mode_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+ -+uint oid_rt_scan_with_magic_packet_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+//************** oid_rtl_seg_01_01 section end ************** -+ -+//************** oid_rtl_seg_01_03 section start ************** -+uint oid_rt_ap_get_associated_station_list_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+uint oid_rt_ap_switch_into_ap_mode_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+uint oid_rt_ap_supported_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ return status; -+} -+uint oid_rt_ap_set_passphrase_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != SET_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+ -+//************** oid_rtl_seg_01_03 section end ************** -+ -+//**************** oid_rtl_seg_01_11 section start **************** -+uint oid_rt_pro_rf_write_registry_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ _irqL oldirql; -+ -+ //DEBUG_ERR(("<**********************oid_rt_pro_rf_write_registry_hdl \n")); -+ if(poid_par_priv->type_of_oid != SET_OID) //QUERY_OID -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ _irqlevel_changed_(&oldirql,LOWER); -+ if(poid_par_priv->information_buf_len== (sizeof(unsigned long)*3)) -+ { -+ //RegOffsetValue - The offset of RF register to write. -+ //RegDataWidth - The data width of RF register to write. -+ //RegDataValue - The value to write. -+ //RegOffsetValue = *((unsigned long*)InformationBuffer); -+ //RegDataWidth = *((unsigned long*)InformationBuffer+1); -+ //RegDataValue = *((unsigned long*)InformationBuffer+2); -+ if(!rtw_setrfreg_cmd(Adapter, -+ *(unsigned char*)poid_par_priv->information_buf, -+ (unsigned long)(*((unsigned long*)poid_par_priv->information_buf+2)))) -+ { -+ status = uint_NOT_ACCEPTED; -+ } -+ -+ } -+ else{ -+ status = uint_INVALID_LENGTH; -+ } -+ _irqlevel_changed_(&oldirql,RAISE); -+ -+ -+ return status; -+} -+ -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_rf_read_registry_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+#if 0 -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ _irqL oldirql; -+ -+ -+ //DEBUG_ERR(("<**********************oid_rt_pro_rf_read_registry_hdl \n")); -+ if(poid_par_priv->type_of_oid != SET_OID) //QUERY_OID -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ _irqlevel_changed_(&oldirql,LOWER); -+ if(poid_par_priv->information_buf_len== (sizeof(unsigned long)*3)) -+ { -+ if(Adapter->mppriv.act_in_progress == true) -+ { -+ status = uint_NOT_ACCEPTED; -+ } -+ else -+ { -+ //init workparam -+ Adapter->mppriv.act_in_progress = true; -+ Adapter->mppriv.workparam.bcompleted= false; -+ Adapter->mppriv.workparam.act_type = MPT_READ_RF; -+ Adapter->mppriv.workparam.io_offset = *(unsigned long*)poid_par_priv->information_buf; -+ Adapter->mppriv.workparam.io_value = 0xcccccccc; -+ -+ //RegOffsetValue - The offset of RF register to read. -+ //RegDataWidth - The data width of RF register to read. -+ //RegDataValue - The value to read. -+ //RegOffsetValue = *((unsigned long*)InformationBuffer); -+ //RegDataWidth = *((unsigned long*)InformationBuffer+1); -+ //RegDataValue = *((unsigned long*)InformationBuffer+2); -+ if(!rtw_getrfreg_cmd(Adapter, -+ *(unsigned char*)poid_par_priv->information_buf, -+ (unsigned char*)&Adapter->mppriv.workparam.io_value)) -+ { -+ status = uint_NOT_ACCEPTED; -+ } -+ } -+ -+ -+ } -+ else { -+ status = uint_INVALID_LENGTH; -+ } -+ _irqlevel_changed_(&oldirql,RAISE); -+ -+#endif -+ return status; -+} -+ -+//**************** oid_rtl_seg_01_11 section end**************** -+ -+ -+//************** oid_rtl_seg_03_00 section start ************** -+enum _CONNECT_STATE_{ -+ CHECKINGSTATUS, -+ ASSOCIATED, -+ ADHOCMODE, -+ NOTASSOCIATED -+}; -+ -+uint oid_rt_get_connect_state_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ u32 ulInfo; -+ -+ if(poid_par_priv->type_of_oid != QUERY_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ // nStatus==0 CheckingStatus -+ // nStatus==1 Associated -+ // nStatus==2 AdHocMode -+ // nStatus==3 NotAssociated -+ -+ if(check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) -+ ulInfo = CHECKINGSTATUS; -+ else if(check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ ulInfo = ASSOCIATED; -+ else if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)== true) -+ ulInfo = ADHOCMODE; -+ else -+ ulInfo = NOTASSOCIATED ; -+ -+ *(u32 *)poid_par_priv->information_buf = ulInfo; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+#if 0 -+ // Rearrange the order to let the UI still shows connection when scan is in progress -+ RT_TRACE(COMP_OID_QUERY, DBG_LOUD, ("===> Query OID_RT_GET_CONNECT_STATE.\n")); -+ if(pMgntInfo->mAssoc) -+ ulInfo = 1; -+ else if(pMgntInfo->mIbss) -+ ulInfo = 2; -+ else if(pMgntInfo->bScanInProgress) -+ ulInfo = 0; -+ else -+ ulInfo = 3; -+ ulInfoLen = sizeof(u32); -+ RT_TRACE(COMP_OID_QUERY, DBG_LOUD, ("<=== Query OID_RT_GET_CONNECT_STATE: %d\n", ulInfo)); -+#endif -+ -+ return status; -+} -+ -+uint oid_rt_set_default_key_id_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if(poid_par_priv->type_of_oid != SET_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ return status; -+} -+//************** oid_rtl_seg_03_00 section end ************** -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_ioctl_set.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ioctl_set.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_ioctl_set.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_ioctl_set.c 2018-02-06 17:42:30.694966927 +0200 -@@ -0,0 +1,1292 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_IOCTL_SET_C_ -+ -+#include -+ -+ -+extern void indicate_wx_scan_complete_event(_adapter *padapter); -+ -+#define IS_MAC_ADDRESS_BROADCAST(addr) \ -+( \ -+ ( (addr[0] == 0xff) && (addr[1] == 0xff) && \ -+ (addr[2] == 0xff) && (addr[3] == 0xff) && \ -+ (addr[4] == 0xff) && (addr[5] == 0xff) ) ? true : false \ -+) -+ -+u8 rtw_validate_ssid(NDIS_802_11_SSID *ssid) -+{ -+ u8 i; -+ u8 ret=true; -+ -+ -+ -+ if (ssid->SsidLength > 32) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid length >32\n")); -+ ret= false; -+ goto exit; -+ } -+ -+ for(i = 0; i < ssid->SsidLength; i++) -+ { -+ //wifi, printable ascii code must be supported -+ if(!( (ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e) )){ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid has nonprintabl ascii\n")); -+ ret= false; -+ break; -+ } -+ } -+ -+exit: -+ -+ -+ -+ return ret; -+} -+ -+u8 rtw_do_join(_adapter * padapter); -+u8 rtw_do_join(_adapter * padapter) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ u8* pibss = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ u8 ret=_SUCCESS; -+ -+ -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("\n rtw_do_join: phead = %p; plist = %p \n\n\n", phead, plist)); -+ -+ pmlmepriv->cur_network.join_res = -2; -+ -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ -+ pmlmepriv->pscanned = plist; -+ -+ pmlmepriv->to_join = true; -+ -+ if(_rtw_queue_empty(queue)== true) -+ { -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+ //when set_ssid/set_bssid for rtw_do_join(), but scanning queue is empty -+ //we try to issue sitesurvey firstly -+ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic ==false -+ || rtw_to_roaming(padapter) > 0 -+ ) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_do_join(): site survey if scanned_queue is empty\n.")); -+ // submit site_survey_cmd -+ if(_SUCCESS!=(ret=rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0)) ) { -+ pmlmepriv->to_join = false; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_do_join(): site survey return error\n.")); -+ } -+ } -+ else -+ { -+ pmlmepriv->to_join = false; -+ ret = _FAIL; -+ } -+ -+ goto exit; -+ } -+ else -+ { -+ int select_ret; -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ if((select_ret=rtw_select_and_join_from_scanned_queue(pmlmepriv))==_SUCCESS) -+ { -+ pmlmepriv->to_join = false; -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ } -+ else -+ { -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==true) -+ { -+ // submit createbss_cmd to change to a ADHOC_MASTER -+ -+ //pmlmepriv->lock has been acquired by caller... -+ WLAN_BSSID_EX *pdev_network = &(padapter->registrypriv.dev_network); -+ -+ pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE; -+ -+ pibss = padapter->registrypriv.dev_network.MacAddress; -+ -+ _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); -+ -+ rtw_update_registrypriv_dev_network(padapter); -+ -+ rtw_generate_random_ibss(pibss); -+ -+ if(rtw_createbss_cmd(padapter)!=_SUCCESS) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("***Error=>do_goin: rtw_createbss_cmd status FAIL*** \n ")); -+ ret = false; -+ goto exit; -+ } -+ -+ pmlmepriv->to_join = false; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("***Error=> rtw_select_and_join_from_scanned_queue FAIL under STA_Mode*** \n ")); -+ -+ } -+ else -+ { -+ // can't associate ; reset under-linking -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+#if 0 -+ if((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true)) -+ { -+ if(_rtw_memcmp(pmlmepriv->cur_network.network.Ssid.Ssid, pmlmepriv->assoc_ssid.Ssid, pmlmepriv->assoc_ssid.SsidLength)) -+ { -+ // for funk to do roaming -+ // funk will reconnect, but funk will not sitesurvey before reconnect -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("for funk to do roaming")); -+ if(pmlmepriv->sitesurveyctrl.traffic_busy==false) -+ rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); -+ } -+ -+ } -+#endif -+ -+ //when set_ssid/set_bssid for rtw_do_join(), but there are no desired bss in scanning queue -+ //we try to issue sitesurvey firstly -+ if(pmlmepriv->LinkDetectInfo.bBusyTraffic==false -+ || rtw_to_roaming(padapter) > 0 -+ ) -+ { -+ //DBG_871X("rtw_do_join() when no desired bss in scanning queue \n"); -+ if( _SUCCESS!=(ret=rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0)) ){ -+ pmlmepriv->to_join = false; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("do_join(): site survey return error\n.")); -+ } -+ } -+ else -+ { -+ ret = _FAIL; -+ pmlmepriv->to_join = false; -+ } -+ } -+ -+ } -+ -+ } -+ -+exit: -+ -+ -+ -+ return ret; -+} -+ -+u8 rtw_set_802_11_bssid(_adapter* padapter, u8 *bssid) -+{ -+ _irqL irqL; -+ u8 status=_SUCCESS; -+ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ -+ DBG_871X_LEVEL(_drv_always_, "set bssid:%pM\n", bssid); -+ -+ if ((bssid[0]==0x00 && bssid[1]==0x00 && bssid[2]==0x00 && bssid[3]==0x00 && bssid[4]==0x00 &&bssid[5]==0x00) || -+ (bssid[0]==0xFF && bssid[1]==0xFF && bssid[2]==0xFF && bssid[3]==0xFF && bssid[4]==0xFF &&bssid[5]==0xFF)) -+ { -+ status = _FAIL; -+ goto exit; -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+ DBG_871X("Set BSSID under fw_state=0x%08x\n", get_fwstate(pmlmepriv)); -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ goto handle_tkip_countermeasure; -+ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) { -+ goto release_mlme_lock; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n")); -+ -+ if (_rtw_memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid, ETH_ALEN) == true) -+ { -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == false) -+ goto release_mlme_lock;//it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. -+ } else { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("Set BSSID not the same bssid\n")); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("set_bssid="MAC_FMT"\n", MAC_ARG(bssid) )); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("cur_bssid="MAC_FMT"\n", MAC_ARG(pmlmepriv->cur_network.network.MacAddress) )); -+ -+ rtw_disassoc_cmd(padapter, 0, true); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ rtw_indicate_disconnect(padapter); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) { -+ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ } -+ } -+ } -+ -+handle_tkip_countermeasure: -+ //should we add something here...? -+ if((status=rtw_handle_tkip_countermeasure(padapter)) == _FAIL) -+ goto release_mlme_lock; -+ -+ _rtw_memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN); -+ pmlmepriv->assoc_by_bssid=true; -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ pmlmepriv->to_join = true; -+ } -+ else { -+ status = rtw_do_join(padapter); -+ } -+ -+release_mlme_lock: -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+exit: -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, -+ ("rtw_set_802_11_bssid: status=%d\n", status)); -+ -+ -+ -+ return status; -+} -+ -+u8 rtw_set_802_11_ssid(_adapter* padapter, NDIS_802_11_SSID *ssid) -+{ -+ _irqL irqL; -+ u8 status = _SUCCESS; -+ u32 cur_time = 0; -+ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *pnetwork = &pmlmepriv->cur_network; -+ -+ -+ -+ DBG_871X_LEVEL(_drv_always_, "set ssid [%s] fw_state=0x%08x\n", -+ ssid->Ssid, get_fwstate(pmlmepriv)); -+ -+ if(padapter->hw_init_completed==false){ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, -+ ("set_ssid: hw_init_completed==false=>exit!!!\n")); -+ status = _FAIL; -+ goto exit; -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ DBG_871X("Set SSID under fw_state=0x%08x\n", get_fwstate(pmlmepriv)); -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ goto handle_tkip_countermeasure; -+ } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) { -+ goto release_mlme_lock; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, -+ ("set_ssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n")); -+ -+ if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) && -+ (_rtw_memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid, ssid->SsidLength) == true)) -+ { -+ if((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == false)) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, -+ ("Set SSID is the same ssid, fw_state=0x%08x\n", -+ get_fwstate(pmlmepriv))); -+ -+ if(rtw_is_same_ibss(padapter, pnetwork) == false) -+ { -+ //if in WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE, create bss or rejoin again -+ rtw_disassoc_cmd(padapter, 0, true); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ rtw_indicate_disconnect(padapter); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) { -+ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ } -+ } -+ else -+ { -+ goto release_mlme_lock;//it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. -+ } -+ } -+#ifdef CONFIG_LPS -+ else { -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_JOINBSS, 1); -+ } -+#endif -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("Set SSID not the same ssid\n")); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("set_ssid=[%s] len=0x%x\n", ssid->Ssid, (unsigned int)ssid->SsidLength)); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("assoc_ssid=[%s] len=0x%x\n", pmlmepriv->assoc_ssid.Ssid, (unsigned int)pmlmepriv->assoc_ssid.SsidLength)); -+ -+ rtw_disassoc_cmd(padapter, 0, true); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ rtw_indicate_disconnect(padapter); -+ -+ rtw_free_assoc_resources(padapter, 1); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) { -+ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ } -+ } -+ } -+ -+handle_tkip_countermeasure: -+ -+ if((status=rtw_handle_tkip_countermeasure(padapter)) == _FAIL) -+ goto release_mlme_lock; -+ -+ #ifdef CONFIG_VALIDATE_SSID -+ if (rtw_validate_ssid(ssid) == false) { -+ status = _FAIL; -+ goto release_mlme_lock; -+ } -+ #endif -+ -+ _rtw_memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(NDIS_802_11_SSID)); -+ pmlmepriv->assoc_by_bssid=false; -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ pmlmepriv->to_join = true; -+ } -+ else { -+ status = rtw_do_join(padapter); -+ } -+ -+release_mlme_lock: -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+exit: -+ RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, -+ ("-rtw_set_802_11_ssid: status=%d\n", status)); -+ -+ -+ -+ return status; -+ -+} -+ -+u8 rtw_set_802_11_infrastructure_mode(_adapter* padapter, -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networktype) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE* pold_state = &(cur_network->network.InfrastructureMode); -+ -+ -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_notice_, -+ ("+rtw_set_802_11_infrastructure_mode: old=%d new=%d fw_state=0x%08x\n", -+ *pold_state, networktype, get_fwstate(pmlmepriv))); -+ -+ if(*pold_state != networktype) -+ { -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,(" change mode!")); -+ //DBG_871X("change mode, old_mode=%d, new_mode=%d, fw_state=0x%x\n", *pold_state, networktype, get_fwstate(pmlmepriv)); -+ -+ if(*pold_state==Ndis802_11APMode) -+ { -+ //change to other mode from Ndis802_11APMode -+ cur_network->join_res = -1; -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ stop_ap_mode(padapter); -+#endif -+ } -+ -+ if((check_fwstate(pmlmepriv, _FW_LINKED)== true) ||(*pold_state==Ndis802_11IBSS)) -+ rtw_disassoc_cmd(padapter, 0, true); -+ -+ if((check_fwstate(pmlmepriv, _FW_LINKED)== true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)== true) ) -+ rtw_free_assoc_resources(padapter, 1); -+ -+ if((*pold_state == Ndis802_11Infrastructure) ||(*pold_state == Ndis802_11IBSS)) -+ { -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ { -+ rtw_indicate_disconnect(padapter); //will clr Linked_state; before this function, we must have chked whether issue dis-assoc_cmd or not -+ } -+ } -+ -+ *pold_state = networktype; -+ -+ _clr_fwstate_(pmlmepriv, ~WIFI_NULL_STATE); -+ -+ switch(networktype) -+ { -+ case Ndis802_11IBSS: -+ set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); -+ break; -+ -+ case Ndis802_11Infrastructure: -+ set_fwstate(pmlmepriv, WIFI_STATION_STATE); -+ break; -+ -+ case Ndis802_11APMode: -+ set_fwstate(pmlmepriv, WIFI_AP_STATE); -+#ifdef CONFIG_NATIVEAP_MLME -+ start_ap_mode(padapter); -+ //rtw_indicate_connect(padapter); -+#endif -+ -+ break; -+ -+ case Ndis802_11AutoUnknown: -+ case Ndis802_11InfrastructureMax: -+ break; -+ } -+ -+ //SecClearAllKeys(adapter); -+ -+ //RT_TRACE(COMP_OID_SET, DBG_LOUD, ("set_infrastructure: fw_state:%x after changing mode\n", -+ // get_fwstate(pmlmepriv) )); -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ } -+ -+ -+ -+ return true; -+} -+ -+ -+u8 rtw_set_802_11_disassociate(_adapter *padapter) -+{ -+ _irqL irqL; -+ struct mlme_priv * pmlmepriv = &padapter->mlmepriv; -+ -+ -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("MgntActrtw_set_802_11_disassociate: rtw_indicate_disconnect\n")); -+ -+ rtw_disassoc_cmd(padapter, 0, true); -+ rtw_indicate_disconnect(padapter); -+ rtw_free_assoc_resources(padapter, 1); -+ rtw_pwr_wakeup(padapter); -+ } -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+ -+ return true; -+} -+ -+u8 rtw_set_802_11_bssid_list_scan(_adapter* padapter, NDIS_802_11_SSID *pssid, int ssid_max_num) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv= &padapter->mlmepriv; -+ u8 res=true; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("+rtw_set_802_11_bssid_list_scan(), fw_state=%x\n", get_fwstate(pmlmepriv))); -+ -+ if (padapter == NULL) { -+ res=false; -+ goto exit; -+ } -+ if (padapter->hw_init_completed==false){ -+ res = false; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n===rtw_set_802_11_bssid_list_scan:hw_init_completed==false===\n")); -+ goto exit; -+ } -+ -+ if ((check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) || -+ (pmlmepriv->LinkDetectInfo.bBusyTraffic == true)) -+ { -+ // Scan or linking is in progress, do nothing. -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_set_802_11_bssid_list_scan fail since fw_state = %x\n", get_fwstate(pmlmepriv))); -+ res = true; -+ -+ if(check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))== true){ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n###_FW_UNDER_SURVEY|_FW_UNDER_LINKING\n\n")); -+ } else { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n###pmlmepriv->sitesurveyctrl.traffic_busy==true\n\n")); -+ } -+ } else { -+ if (rtw_is_scan_deny(padapter)) { -+ DBG_871X(FUNC_ADPT_FMT": scan deny\n", FUNC_ADPT_ARG(padapter)); -+ indicate_wx_scan_complete_event(padapter); -+ return _SUCCESS; -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, NULL, 0); -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ } -+exit: -+ -+ -+ -+ return res; -+} -+ -+u8 rtw_set_802_11_authentication_mode(_adapter* padapter, NDIS_802_11_AUTHENTICATION_MODE authmode) -+{ -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ int res; -+ u8 ret; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("set_802_11_auth.mode(): mode=%x\n", authmode)); -+ -+ psecuritypriv->ndisauthtype=authmode; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_authentication_mode:psecuritypriv->ndisauthtype=%d", psecuritypriv->ndisauthtype)); -+ -+ if(psecuritypriv->ndisauthtype>3) -+ psecuritypriv->dot11AuthAlgrthm=dot11AuthAlgrthm_8021X; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(psecuritypriv->ndisauthtype == 6) -+ psecuritypriv->dot11AuthAlgrthm=dot11AuthAlgrthm_WAPI; -+#endif -+ -+ res=rtw_set_auth(padapter,psecuritypriv); -+ -+ if(res==_SUCCESS) -+ ret=true; -+ else -+ ret=false; -+ -+ -+ -+ return ret; -+} -+ -+u8 rtw_set_802_11_add_wep(_adapter* padapter, NDIS_802_11_WEP *wep){ -+ -+ u8 bdefaultkey; -+ u8 btransmitkey; -+ sint keyid,res; -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ u8 ret=_SUCCESS; -+ -+ -+ -+ bdefaultkey=(wep->KeyIndex & 0x40000000) > 0 ? false : true; //for ??? -+ btransmitkey= (wep->KeyIndex & 0x80000000) > 0 ? true : false; //for ??? -+ keyid=wep->KeyIndex & 0x3fffffff; -+ -+ if(keyid>4) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("MgntActrtw_set_802_11_add_wep:keyid>4=>fail\n")); -+ ret=false; -+ goto exit; -+ } -+ -+ switch(wep->KeyLength) -+ { -+ case 5: -+ psecuritypriv->dot11PrivacyAlgrthm=_WEP40_; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("MgntActrtw_set_802_11_add_wep:wep->KeyLength=5\n")); -+ break; -+ case 13: -+ psecuritypriv->dot11PrivacyAlgrthm=_WEP104_; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("MgntActrtw_set_802_11_add_wep:wep->KeyLength=13\n")); -+ break; -+ default: -+ psecuritypriv->dot11PrivacyAlgrthm=_NO_PRIVACY_; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("MgntActrtw_set_802_11_add_wep:wep->KeyLength!=5 or 13\n")); -+ break; -+ } -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_wep:befor memcpy, wep->KeyLength=0x%x wep->KeyIndex=0x%x keyid =%x\n",wep->KeyLength,wep->KeyIndex,keyid)); -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[keyid].skey[0]),&(wep->KeyMaterial),wep->KeyLength); -+ -+ psecuritypriv->dot11DefKeylen[keyid]=wep->KeyLength; -+ -+ psecuritypriv->dot11PrivacyKeyIndex=keyid; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_wep:security key material : %x %x %x %x %x %x %x %x %x %x %x %x %x \n", -+ psecuritypriv->dot11DefKey[keyid].skey[0],psecuritypriv->dot11DefKey[keyid].skey[1],psecuritypriv->dot11DefKey[keyid].skey[2], -+ psecuritypriv->dot11DefKey[keyid].skey[3],psecuritypriv->dot11DefKey[keyid].skey[4],psecuritypriv->dot11DefKey[keyid].skey[5], -+ psecuritypriv->dot11DefKey[keyid].skey[6],psecuritypriv->dot11DefKey[keyid].skey[7],psecuritypriv->dot11DefKey[keyid].skey[8], -+ psecuritypriv->dot11DefKey[keyid].skey[9],psecuritypriv->dot11DefKey[keyid].skey[10],psecuritypriv->dot11DefKey[keyid].skey[11], -+ psecuritypriv->dot11DefKey[keyid].skey[12])); -+ -+ res=rtw_set_key(padapter,psecuritypriv, keyid, 1); -+ -+ if(res==_FAIL) -+ ret= false; -+exit: -+ -+ -+ -+ return ret; -+ -+} -+ -+u8 rtw_set_802_11_remove_wep(_adapter* padapter, u32 keyindex){ -+ -+ u8 ret=_SUCCESS; -+ -+ -+ -+ if (keyindex >= 0x80000000 || padapter == NULL){ -+ -+ ret=false; -+ goto exit; -+ -+ } -+ else -+ { -+ int res; -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ if( keyindex < 4 ){ -+ -+ _rtw_memset(&psecuritypriv->dot11DefKey[keyindex], 0, 16); -+ -+ res=rtw_set_key(padapter,psecuritypriv,keyindex, 0); -+ -+ psecuritypriv->dot11DefKeylen[keyindex]=0; -+ -+ if(res==_FAIL) -+ ret=_FAIL; -+ -+ } -+ else -+ { -+ ret=_FAIL; -+ } -+ -+ } -+ -+exit: -+ -+ -+ -+ return ret; -+ -+} -+ -+u8 rtw_set_802_11_add_key(_adapter* padapter, NDIS_802_11_KEY *key){ -+ -+ uint encryptionalgo; -+ u8 * pbssid; -+ struct sta_info *stainfo; -+ u8 bgroup = false; -+ u8 bgrouptkey = false;//can be remove later -+ u8 ret=_SUCCESS; -+ -+ -+ -+ if (((key->KeyIndex & 0x80000000) == 0) && ((key->KeyIndex & 0x40000000) > 0)){ -+ -+ // It is invalid to clear bit 31 and set bit 30. If the miniport driver encounters this combination, -+ // it must fail the request and return uint_INVALID_DATA. -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_key: ((key->KeyIndex & 0x80000000) == 0)[=%d] ",(int)(key->KeyIndex & 0x80000000) == 0)); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_key:((key->KeyIndex & 0x40000000) > 0)[=%d]" , (int)(key->KeyIndex & 0x40000000) > 0)); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_key: key->KeyIndex=%d \n" ,(int)key->KeyIndex)); -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ if(key->KeyIndex & 0x40000000) -+ { -+ // Pairwise key -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: +++++ Pairwise key +++++\n")); -+ -+ pbssid=get_bssid(&padapter->mlmepriv); -+ stainfo=rtw_get_stainfo(&padapter->stapriv, pbssid); -+ -+ if((stainfo!=NULL)&&(padapter->securitypriv.dot11AuthAlgrthm==dot11AuthAlgrthm_8021X)){ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY:( stainfo!=NULL)&&(Adapter->securitypriv.dot11AuthAlgrthm==dot11AuthAlgrthm_8021X)\n")); -+ encryptionalgo=stainfo->dot118021XPrivacy; -+ } -+ else{ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: stainfo==NULL)||(Adapter->securitypriv.dot11AuthAlgrthm!=dot11AuthAlgrthm_8021X)\n")); -+ encryptionalgo=padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_set_802_11_add_key: (encryptionalgo ==%d)!\n",encryptionalgo )); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_set_802_11_add_key: (Adapter->securitypriv.dot11PrivacyAlgrthm ==%d)!\n",padapter->securitypriv.dot11PrivacyAlgrthm)); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_set_802_11_add_key: (Adapter->securitypriv.dot11AuthAlgrthm ==%d)!\n",padapter->securitypriv.dot11AuthAlgrthm)); -+ -+ if((stainfo!=NULL)){ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_set_802_11_add_key: (stainfo->dot118021XPrivacy ==%d)!\n", stainfo->dot118021XPrivacy)); -+ } -+ -+ if(key->KeyIndex & 0x000000FF){ -+ // The key index is specified in the lower 8 bits by values of zero to 255. -+ // The key index should be set to zero for a Pairwise key, and the driver should fail with -+ // uint_INVALID_DATA if the lower 8 bits is not zero -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,(" key->KeyIndex & 0x000000FF.\n")); -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ // check BSSID -+ if (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == true){ -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("MacAddr_isBcst(key->BSSID)\n")); -+ ret= false; -+ goto exit; -+ } -+ -+ // Check key length for TKIP. -+ //if(encryptionAlgorithm == RT_ENC_TKIP_ENCRYPTION && key->KeyLength != 32) -+ if((encryptionalgo== _TKIP_)&& (key->KeyLength != 32)){ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("TKIP KeyLength:0x%x != 32\n", key->KeyLength)); -+ ret=_FAIL; -+ goto exit; -+ -+ } -+ -+ // Check key length for AES. -+ if((encryptionalgo== _AES_)&& (key->KeyLength != 16)) { -+ // For our supplicant, EAPPkt9x.vxd, cannot differentiate TKIP and AES case. -+ if(key->KeyLength == 32) { -+ key->KeyLength = 16; -+ } else { -+ ret= _FAIL; -+ goto exit; -+ } -+ } -+ -+ // Check key length for WEP. For NDTEST, 2005.01.27, by rcnjko. -+ if( (encryptionalgo== _WEP40_|| encryptionalgo== _WEP104_) && (key->KeyLength != 5 || key->KeyLength != 13)) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("WEP KeyLength:0x%x != 5 or 13\n", key->KeyLength)); -+ ret=_FAIL; -+ goto exit; -+ } -+ -+ bgroup = false; -+ -+ // Check the pairwise key. Added by Annie, 2005-07-06. -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n")); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("[Pairwise Key set]\n")); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n")); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("key index: 0x%8x(0x%8x)\n", key->KeyIndex,(key->KeyIndex&0x3))); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("key Length: %d\n", key->KeyLength)); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n")); -+ -+ } -+ else -+ { -+ // Group key - KeyIndex(BIT30==0) -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: +++++ Group key +++++\n")); -+ -+ -+ // when add wep key through add key and didn't assigned encryption type before -+ if((padapter->securitypriv.ndisauthtype<=3)&&(padapter->securitypriv.dot118021XGrpPrivacy==0)) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("keylen=%d( Adapter->securitypriv.dot11PrivacyAlgrthm=%x )padapter->securitypriv.dot118021XGrpPrivacy(%x)\n", key->KeyLength,padapter->securitypriv.dot11PrivacyAlgrthm,padapter->securitypriv.dot118021XGrpPrivacy)); -+ -+ switch(key->KeyLength) -+ { -+ case 5: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("Adapter->securitypriv.dot11PrivacyAlgrthm= %x key->KeyLength=%u\n", padapter->securitypriv.dot11PrivacyAlgrthm,key->KeyLength)); -+ break; -+ case 13: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("Adapter->securitypriv.dot11PrivacyAlgrthm= %x key->KeyLength=%u\n", padapter->securitypriv.dot11PrivacyAlgrthm,key->KeyLength)); -+ break; -+ default: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("Adapter->securitypriv.dot11PrivacyAlgrthm= %x key->KeyLength=%u \n", padapter->securitypriv.dot11PrivacyAlgrthm,key->KeyLength)); -+ break; -+ } -+ -+ encryptionalgo=padapter->securitypriv.dot11PrivacyAlgrthm; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,(" Adapter->securitypriv.dot11PrivacyAlgrthm=%x\n", padapter->securitypriv.dot11PrivacyAlgrthm)); -+ -+ } -+ else -+ { -+ encryptionalgo=padapter->securitypriv.dot118021XGrpPrivacy; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("( Adapter->securitypriv.dot11PrivacyAlgrthm=%x )encryptionalgo(%x)=padapter->securitypriv.dot118021XGrpPrivacy(%x)keylen=%d\n", padapter->securitypriv.dot11PrivacyAlgrthm,encryptionalgo,padapter->securitypriv.dot118021XGrpPrivacy,key->KeyLength)); -+ -+ } -+ -+ if((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE)==true) && (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == false)) { -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,(" IBSS but BSSID is not Broadcast Address.\n")); -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ // Check key length for TKIP -+ if((encryptionalgo== _TKIP_) && (key->KeyLength != 32)) { -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,(" TKIP GTK KeyLength:%u != 32\n", key->KeyLength)); -+ ret= _FAIL; -+ goto exit; -+ -+ } else if(encryptionalgo== _AES_ && (key->KeyLength != 16 && key->KeyLength != 32) ) { -+ -+ // Check key length for AES -+ // For NDTEST, we allow keylen=32 in this case. 2005.01.27, by rcnjko. -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("<=== SetInfo, OID_802_11_ADD_KEY: AES GTK KeyLength:%u != 16 or 32\n", key->KeyLength)); -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ // Change the key length for EAPPkt9x.vxd. Added by Annie, 2005-11-03. -+ if((encryptionalgo== _AES_) && (key->KeyLength == 32) ) { -+ key->KeyLength = 16; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("AES key length changed: %u\n", key->KeyLength) ); -+ } -+ -+ if(key->KeyIndex & 0x8000000) {//error ??? 0x8000_0000 -+ bgrouptkey = true; -+ } -+ -+ if((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE)==true)&&(check_fwstate(&padapter->mlmepriv, _FW_LINKED)==true)) -+ { -+ bgrouptkey = true; -+ } -+ -+ bgroup = true; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n") ); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("[Group Key set]\n") ); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n")) ; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("key index: 0x%8x(0x%8x)\n", key->KeyIndex,(key->KeyIndex&0x3))); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("key Length: %d\n", key->KeyLength)) ; -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n")); -+ -+ } -+ -+ // If WEP encryption algorithm, just call rtw_set_802_11_add_wep(). -+ if((padapter->securitypriv.dot11AuthAlgrthm !=dot11AuthAlgrthm_8021X)&&(encryptionalgo== _WEP40_ || encryptionalgo== _WEP104_)) -+ { -+ u8 ret; -+ u32 keyindex; -+ u32 len = FIELD_OFFSET(NDIS_802_11_KEY, KeyMaterial) + key->KeyLength; -+ NDIS_802_11_WEP *wep = &padapter->securitypriv.ndiswep; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: +++++ WEP key +++++\n")); -+ -+ wep->Length = len; -+ keyindex = key->KeyIndex&0x7fffffff; -+ wep->KeyIndex = keyindex ; -+ wep->KeyLength = key->KeyLength; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY:Before memcpy \n")); -+ -+ _rtw_memcpy(wep->KeyMaterial, key->KeyMaterial, key->KeyLength); -+ _rtw_memcpy(&(padapter->securitypriv.dot11DefKey[keyindex].skey[0]), key->KeyMaterial, key->KeyLength); -+ -+ padapter->securitypriv.dot11DefKeylen[keyindex]=key->KeyLength; -+ padapter->securitypriv.dot11PrivacyKeyIndex=keyindex; -+ -+ ret = rtw_set_802_11_add_wep(padapter, wep); -+ -+ goto exit; -+ -+ } -+ -+ if(key->KeyIndex & 0x20000000){ -+ // SetRSC -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: +++++ SetRSC+++++\n")); -+ if(bgroup == true) -+ { -+ NDIS_802_11_KEY_RSC keysrc=key->KeyRSC & 0x00FFFFFFFFFFFFULL; -+ _rtw_memcpy(&padapter->securitypriv.dot11Grprxpn, &keysrc, 8); -+ } -+ else -+ { -+ NDIS_802_11_KEY_RSC keysrc=key->KeyRSC & 0x00FFFFFFFFFFFFULL; -+ _rtw_memcpy(&padapter->securitypriv.dot11Grptxpn, &keysrc, 8); -+ } -+ -+ } -+ -+ // Indicate this key idx is used for TX -+ // Save the key in KeyMaterial -+ if(bgroup == true) // Group transmit key -+ { -+ int res; -+ -+ if(bgrouptkey == true) -+ { -+ padapter->securitypriv.dot118021XGrpKeyid=(u8)key->KeyIndex; -+ } -+ -+ if((key->KeyIndex&0x3) == 0){ -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memset(&padapter->securitypriv.dot118021XGrpKey[(u8)((key->KeyIndex) & 0x03)], 0, 16); -+ _rtw_memset(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], 0, 16); -+ _rtw_memset(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], 0, 16); -+ -+ if((key->KeyIndex & 0x10000000)) -+ { -+ _rtw_memcpy(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 16, 8); -+ _rtw_memcpy(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 24, 8); -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:rx mic :0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n", -+ padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[0],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[1], -+ padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[2],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[3], -+ padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[4],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[5], -+ padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[6],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[7])); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:set Group mic key!!!!!!!!\n")); -+ -+ } -+ else -+ { -+ _rtw_memcpy(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 24, 8); -+ _rtw_memcpy(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 16, 8); -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:rx mic :0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n", -+ padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[0],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[1], -+ padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[2],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[3], -+ padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[4],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[5], -+ padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[6],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[7])); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:set Group mic key!!!!!!!!\n")); -+ -+ } -+ -+ //set group key by index -+ _rtw_memcpy(&padapter->securitypriv.dot118021XGrpKey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial, key->KeyLength); -+ -+ key->KeyIndex=key->KeyIndex & 0x03; -+ -+ padapter->securitypriv.binstallGrpkey=true; -+ -+ padapter->securitypriv.bcheck_grpkey=false; -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("reset group key")); -+ -+ res=rtw_set_key(padapter,&padapter->securitypriv, key->KeyIndex, 1); -+ -+ if(res==_FAIL) -+ ret= _FAIL; -+ -+ goto exit; -+ -+ } -+ else // Pairwise Key -+ { -+ u8 res; -+ -+ pbssid=get_bssid(&padapter->mlmepriv); -+ stainfo=rtw_get_stainfo(&padapter->stapriv , pbssid ); -+ -+ if(stainfo!=NULL) -+ { -+ _rtw_memset( &stainfo->dot118021x_UncstKey, 0, 16);// clear keybuffer -+ -+ _rtw_memcpy(&stainfo->dot118021x_UncstKey, key->KeyMaterial, 16); -+ -+ if(encryptionalgo== _TKIP_) -+ { -+ padapter->securitypriv.busetkipkey=false; -+ -+ //_set_timer(&padapter->securitypriv.tkip_timer, 50); -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n ==========_set_timer\n")); -+ -+ // if TKIP, save the Receive/Transmit MIC key in KeyMaterial[128-255] -+ if((key->KeyIndex & 0x10000000)){ -+ _rtw_memcpy(&stainfo->dot11tkiptxmickey, key->KeyMaterial + 16, 8); -+ _rtw_memcpy(&stainfo->dot11tkiprxmickey, key->KeyMaterial + 24, 8); -+ -+ } else { -+ _rtw_memcpy(&stainfo->dot11tkiptxmickey, key->KeyMaterial + 24, 8); -+ _rtw_memcpy(&stainfo->dot11tkiprxmickey, key->KeyMaterial + 16, 8); -+ -+ } -+ -+ } -+ else if(encryptionalgo == _AES_) -+ { -+ -+ } -+ -+ -+ //Set key to CAM through H2C command -+ if(bgrouptkey)//never go to here -+ { -+ res=rtw_setstakey_cmd(padapter, (unsigned char *)stainfo, false); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:rtw_setstakey_cmd(group)\n")); -+ } -+ else{ -+ res=rtw_setstakey_cmd(padapter, (unsigned char *)stainfo, true); -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:rtw_setstakey_cmd(unicast)\n")); -+ } -+ -+ if(res ==false) -+ ret= _FAIL; -+ -+ } -+ -+ } -+ -+exit: -+ -+ -+ -+ return ret; -+} -+ -+u8 rtw_set_802_11_remove_key(_adapter* padapter, NDIS_802_11_REMOVE_KEY *key){ -+ -+ uint encryptionalgo; -+ u8 * pbssid; -+ struct sta_info *stainfo; -+ u8 bgroup = (key->KeyIndex & 0x4000000) > 0 ? false: true; -+ u8 keyIndex = (u8)key->KeyIndex & 0x03; -+ u8 ret=_SUCCESS; -+ -+ -+ -+ if ((key->KeyIndex & 0xbffffffc) > 0) { -+ ret=_FAIL; -+ goto exit; -+ } -+ -+ if (bgroup == true) { -+ encryptionalgo= padapter->securitypriv.dot118021XGrpPrivacy; -+ // clear group key by index -+ //NdisZeroMemory(Adapter->MgntInfo.SecurityInfo.KeyBuf[keyIndex], MAX_WEP_KEY_LEN); -+ //Adapter->MgntInfo.SecurityInfo.KeyLen[keyIndex] = 0; -+ -+ _rtw_memset(&padapter->securitypriv.dot118021XGrpKey[keyIndex], 0, 16); -+ -+ //! \todo Send a H2C Command to Firmware for removing this Key in CAM Entry. -+ -+ } else { -+ -+ pbssid=get_bssid(&padapter->mlmepriv); -+ stainfo=rtw_get_stainfo(&padapter->stapriv , pbssid ); -+ if(stainfo !=NULL){ -+ encryptionalgo=stainfo->dot118021XPrivacy; -+ -+ // clear key by BSSID -+ _rtw_memset(&stainfo->dot118021x_UncstKey, 0, 16); -+ -+ //! \todo Send a H2C Command to Firmware for disable this Key in CAM Entry. -+ -+ } -+ else{ -+ ret= _FAIL; -+ goto exit; -+ } -+ } -+ -+exit: -+ -+ -+ -+ return true; -+ -+} -+ -+/* -+* rtw_get_cur_max_rate - -+* @adapter: pointer to _adapter structure -+* -+* Return 0 or 100Kbps -+*/ -+u16 rtw_get_cur_max_rate(_adapter *adapter) -+{ -+ int i = 0; -+ u8 *p; -+ u16 rate = 0, max_rate = 0; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+#ifdef CONFIG_80211N_HT -+ struct rtw_ieee80211_ht_cap *pht_capie; -+ u8 rf_type = 0; -+ u8 bw_40MHz=0, short_GI_20=0, short_GI_40=0, cbw40_enable=0; -+ u16 mcs_rate=0; -+ u32 ht_ielen = 0; -+#endif -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+#endif -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (adapter->registrypriv.mp_mode == 1) -+ { -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) -+ return 0; -+ } -+#endif -+ -+ if((check_fwstate(pmlmepriv, _FW_LINKED) != true) -+ && (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != true)) -+ return 0; -+ -+#ifdef CONFIG_80211N_HT -+ if (IsSupportedTxHT(pmlmeext->cur_wireless_mode)) { -+ p = rtw_get_ie(&pcur_bss->IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pcur_bss->IELength-12); -+ if(p && ht_ielen>0) -+ { -+ pht_capie = (struct rtw_ieee80211_ht_cap *)(p+2); -+ -+ _rtw_memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2); -+ -+ //bw_40MHz = (pht_capie->cap_info&IEEE80211_HT_CAP_SUP_WIDTH) ? 1:0; -+ //cur_bwmod is updated by beacon, pmlmeinfo is updated by association response -+ bw_40MHz = (pmlmeext->cur_bwmode && (HT_INFO_HT_PARAM_REC_TRANS_CHNL_WIDTH & pmlmeinfo->HT_info.infos[0])) ? 1:0; -+ -+ //short_GI = (pht_capie->cap_info&(IEEE80211_HT_CAP_SGI_20|IEEE80211_HT_CAP_SGI_40)) ? 1:0; -+ short_GI_20 = (le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info)&IEEE80211_HT_CAP_SGI_20) ? 1:0; -+ short_GI_40 = (le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info)&IEEE80211_HT_CAP_SGI_40) ? 1:0; -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ if (pmlmeext->cur_channel > 14) { -+ if ((pregistrypriv->bw_mode & 0xf0) > 0) -+ cbw40_enable = 1; -+ } else { -+ if ((pregistrypriv->bw_mode & 0x0f) > 0) -+ cbw40_enable = 1; -+ } -+ -+ max_rate = rtw_mcs_rate( -+ rf_type, -+ bw_40MHz & cbw40_enable, -+ short_GI_20, -+ short_GI_40, -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate -+ ); -+ } -+ } -+#ifdef CONFIG_80211AC_VHT -+ else if (IsSupportedVHT(pmlmeext->cur_wireless_mode)) { -+ max_rate = ((rtw_vht_data_rate(pvhtpriv->bwmode, pvhtpriv->sgi, pvhtpriv->vht_highest_rate) + 1) >> 1) * 10; -+ } -+#endif //CONFIG_80211AC_VHT -+ else -+#endif //CONFIG_80211N_HT -+ { -+ while( (pcur_bss->SupportedRates[i]!=0) && (pcur_bss->SupportedRates[i]!=0xFF)) -+ { -+ rate = pcur_bss->SupportedRates[i]&0x7F; -+ if(rate>max_rate) -+ max_rate = rate; -+ i++; -+ } -+ -+ max_rate = max_rate*10/2; -+ } -+ -+ return max_rate; -+} -+ -+/* -+* rtw_set_scan_mode - -+* @adapter: pointer to _adapter structure -+* @scan_mode: -+* -+* Return _SUCCESS or _FAIL -+*/ -+int rtw_set_scan_mode(_adapter *adapter, RT_SCAN_TYPE scan_mode) -+{ -+ if(scan_mode != SCAN_ACTIVE && scan_mode != SCAN_PASSIVE) -+ return _FAIL; -+ -+ adapter->mlmepriv.scan_mode = scan_mode; -+ -+ return _SUCCESS; -+} -+ -+/* -+* rtw_set_channel_plan - -+* @adapter: pointer to _adapter structure -+* @channel_plan: -+* -+* Return _SUCCESS or _FAIL -+*/ -+int rtw_set_channel_plan(_adapter *adapter, u8 channel_plan) -+{ -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ //handle by cmd_thread to sync with scan operation -+ return rtw_set_chplan_cmd(adapter, channel_plan, 1); -+} -+ -+/* -+* rtw_set_country - -+* @adapter: pointer to _adapter structure -+* @country_code: string of country code -+* -+* Return _SUCCESS or _FAIL -+*/ -+int rtw_set_country(_adapter *adapter, const char *country_code) -+{ -+ int channel_plan = RT_CHANNEL_DOMAIN_WORLD_WIDE_5G; -+ -+ DBG_871X("%s country_code:%s\n", __func__, country_code); -+ -+ //TODO: should have a table to match country code and RT_CHANNEL_DOMAIN -+ //TODO: should consider 2-character and 3-character country code -+ if(0 == strcmp(country_code, "US")) -+ channel_plan = RT_CHANNEL_DOMAIN_FCC; -+ else if(0 == strcmp(country_code, "EU")) -+ channel_plan = RT_CHANNEL_DOMAIN_ETSI; -+ else if(0 == strcmp(country_code, "JP")) -+ channel_plan = RT_CHANNEL_DOMAIN_MKK; -+ else if(0 == strcmp(country_code, "CN")) -+ channel_plan = RT_CHANNEL_DOMAIN_CHINA; -+ else -+ DBG_871X("%s unknown country_code:%s\n", __FUNCTION__, country_code); -+ -+ return rtw_set_channel_plan(adapter, channel_plan); -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_iol.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_iol.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_iol.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_iol.c 2018-02-06 17:42:30.694966927 +0200 -@@ -0,0 +1,382 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include -+ -+#ifdef CONFIG_IOL -+struct xmit_frame *rtw_IOL_accquire_xmit_frame(ADAPTER *adapter) -+{ -+ struct xmit_frame *xmit_frame; -+ struct xmit_buf *xmitbuf; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv = &(adapter->xmitpriv); -+ -+#if 1 -+ if ((xmit_frame = rtw_alloc_xmitframe(pxmitpriv)) == NULL) -+ { -+ DBG_871X("%s rtw_alloc_xmitframe return null\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ if ((xmitbuf = rtw_alloc_xmitbuf(pxmitpriv)) == NULL) -+ { -+ DBG_871X("%s rtw_alloc_xmitbuf return null\n", __FUNCTION__); -+ rtw_free_xmitframe(pxmitpriv, xmit_frame); -+ xmit_frame=NULL; -+ goto exit; -+ } -+ -+ xmit_frame->frame_tag = MGNT_FRAMETAG; -+ xmit_frame->pxmitbuf = xmitbuf; -+ xmit_frame->buf_addr = xmitbuf->pbuf; -+ xmitbuf->priv_data = xmit_frame; -+ -+ pattrib = &xmit_frame->attrib; -+ update_mgntframe_attrib(adapter, pattrib); -+ pattrib->qsel = 0x10;//Beacon -+ pattrib->subtype = WIFI_BEACON; -+ pattrib->pktlen = pattrib->last_txcmdsz = 0; -+ -+#else -+ if ((xmit_frame = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ DBG_871X("%s alloc_mgtxmitframe return null\n", __FUNCTION__); -+ } -+ else { -+ pattrib = &xmit_frame->attrib; -+ update_mgntframe_attrib(adapter, pattrib); -+ pattrib->qsel = 0x10; -+ pattrib->pktlen = pattrib->last_txcmdsz = 0; -+ } -+#endif -+ -+exit: -+ return xmit_frame; -+} -+ -+ -+int rtw_IOL_append_cmds(struct xmit_frame *xmit_frame, u8 *IOL_cmds, u32 cmd_len) -+{ -+ struct pkt_attrib *pattrib = &xmit_frame->attrib; -+ u16 buf_offset; -+ u32 ori_len; -+ -+ buf_offset = TXDESC_OFFSET; -+ ori_len = buf_offset+pattrib->pktlen; -+ -+ //check if the io_buf can accommodate new cmds -+ if(ori_len + cmd_len + 8 > MAX_XMITBUF_SZ) { -+ DBG_871X("%s %u is large than MAX_XMITBUF_SZ:%u, can't accommodate new cmds\n", __FUNCTION__ -+ , ori_len + cmd_len + 8, MAX_XMITBUF_SZ); -+ return _FAIL; -+ } -+ -+ _rtw_memcpy(xmit_frame->buf_addr + buf_offset + pattrib->pktlen, IOL_cmds, cmd_len); -+ pattrib->pktlen += cmd_len; -+ pattrib->last_txcmdsz += cmd_len; -+ -+ //DBG_871X("%s ori:%u + cmd_len:%u = %u\n", __FUNCTION__, ori_len, cmd_len, buf_offset+pattrib->pktlen); -+ -+ return _SUCCESS; -+} -+ -+bool rtw_IOL_applied(ADAPTER *adapter) -+{ -+ if(1 == adapter->registrypriv.fw_iol) -+ return true; -+ -+ if((2 == adapter->registrypriv.fw_iol) && (IS_FULL_SPEED_USB(adapter))) -+ return true; -+ -+ return false; -+} -+ -+int rtw_IOL_exec_cmds_sync(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt) -+{ -+ return rtw_hal_iol_cmd(adapter, xmit_frame, max_wating_ms,bndy_cnt); -+} -+ -+#ifdef CONFIG_IOL_NEW_GENERATION -+int rtw_IOL_append_LLT_cmd(struct xmit_frame *xmit_frame, u8 page_boundary) -+{ -+ return _SUCCESS; -+} -+int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, u8 mask) -+{ -+ struct ioreg_cfg cmd = {8,IOREG_CMD_WB_REG,0x0, 0x0,0x0}; -+ -+ //RTW_PUT_LE16((u8*)&cmd.address, addr); -+ //RTW_PUT_LE32((u8*)&cmd.value, (u32)value); -+ cmd.address = cpu_to_le16(addr); -+ cmd.data = cpu_to_le32(value); -+ -+ if(mask!=0xFF) -+ { -+ cmd.length = 12; -+ //RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); -+ cmd.mask = cpu_to_le32(mask); -+ } -+ -+ //DBG_871X("%s addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FUNCTION__, addr,value,mask); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, cmd.length); -+ -+} -+int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, u16 mask) -+{ -+ struct ioreg_cfg cmd = {8,IOREG_CMD_WW_REG,0x0, 0x0,0x0}; -+ -+ //RTW_PUT_LE16((u8*)&cmd.address, addr); -+ //RTW_PUT_LE32((u8*)&cmd.value, (u32)value); -+ cmd.address = cpu_to_le16(addr); -+ cmd.data = cpu_to_le32(value); -+ -+ if(mask!=0xFFFF) -+ { -+ cmd.length = 12; -+ //RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); -+ cmd.mask = cpu_to_le32(mask); -+ } -+ -+ //DBG_871X("%s addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FUNCTION__, addr,value,mask); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, cmd.length); -+ -+} -+int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, u32 mask) -+{ -+ struct ioreg_cfg cmd = {8,IOREG_CMD_WD_REG,0x0, 0x0,0x0}; -+ -+ //RTW_PUT_LE16((u8*)&cmd.address, addr); -+ //RTW_PUT_LE32((u8*)&cmd.value, (u32)value); -+ cmd.address = cpu_to_le16(addr); -+ cmd.data = cpu_to_le32(value); -+ -+ if(mask!=0xFFFFFFFF) -+ { -+ cmd.length = 12; -+ //RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); -+ cmd.mask = cpu_to_le32(mask); -+ } -+ -+ //DBG_871X("%s addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FU2NCTION__, addr,value,mask); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, cmd.length); -+ -+} -+ -+int _rtw_IOL_append_WRF_cmd(struct xmit_frame *xmit_frame, u8 rf_path, u16 addr, u32 value, u32 mask) -+{ -+ struct ioreg_cfg cmd = {8,IOREG_CMD_W_RF,0x0, 0x0,0x0}; -+ -+ //RTW_PUT_LE16((u8*)&cmd.address, addr); -+ //RTW_PUT_LE32((u8*)&cmd.value, (u32)value); -+ cmd.address = (rf_path<<8) |((addr) &0xFF); -+ cmd.data = cpu_to_le32(value); -+ -+ if(mask!=0x000FFFFF) -+ { -+ cmd.length = 12; -+ //RTW_PUT_LE32((u8*)&cmd.mask, (u32)mask); -+ cmd.mask = cpu_to_le32(mask); -+ } -+ -+ //DBG_871X("%s rf_path:0x%02x addr:0x%04x,value:0x%08x,mask:0x%08x\n", __FU2NCTION__,rf_path, addr,value,mask); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, cmd.length); -+ -+} -+ -+ -+ -+int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us) -+{ -+ struct ioreg_cfg cmd = {4,IOREG_CMD_DELAY_US,0x0, 0x0,0x0}; -+ //RTW_PUT_LE16((u8*)&cmd.address, us); -+ cmd.address = cpu_to_le16(us); -+ -+ //DBG_871X("%s %u\n", __FUNCTION__, us); -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 4); -+} -+ -+int rtw_IOL_append_DELAY_MS_cmd(struct xmit_frame *xmit_frame, u16 ms) -+{ -+ struct ioreg_cfg cmd = {4,IOREG_CMD_DELAY_US,0x0, 0x0,0x0}; -+ -+ //RTW_PUT_LE16((u8*)&cmd.address, ms); -+ cmd.address = cpu_to_le16(ms); -+ -+ //DBG_871X("%s %u\n", __FUNCTION__, ms); -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 4); -+} -+int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame) -+{ -+ struct ioreg_cfg cmd = {4,IOREG_CMD_END,0xFFFF, 0xFF,0x0}; -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 4); -+ -+} -+ -+u8 rtw_IOL_cmd_boundary_handle(struct xmit_frame *pxmit_frame) -+{ -+ u8 is_cmd_bndy = false; -+ if(((pxmit_frame->attrib.pktlen+32)%256) + 8 >= 256){ -+ rtw_IOL_append_END_cmd(pxmit_frame); -+ pxmit_frame->attrib.pktlen = ((((pxmit_frame->attrib.pktlen+32)/256)+1)*256 ); -+ -+ //printk("==> %s, pktlen(%d)\n",__FUNCTION__,pxmit_frame->attrib.pktlen); -+ pxmit_frame->attrib.last_txcmdsz = pxmit_frame->attrib.pktlen; -+ is_cmd_bndy = true; -+ } -+ return is_cmd_bndy; -+} -+ -+void rtw_IOL_cmd_buf_dump(ADAPTER *Adapter,int buf_len,u8 *pbuf) -+{ -+ int i; -+ int j=1; -+ -+ printk("###### %s ######\n",__FUNCTION__); -+ for(i=0;i< buf_len;i++){ -+ printk("%02x-",*(pbuf+i)); -+ -+ if(j%32 ==0) printk("\n");j++; -+ } -+ printk("\n"); -+ printk("============= ioreg_cmd len = %d =============== \n",buf_len); -+} -+ -+ -+#else //CONFIG_IOL_NEW_GENERATION -+int rtw_IOL_append_LLT_cmd(struct xmit_frame *xmit_frame, u8 page_boundary) -+{ -+ IOL_CMD cmd = {0x0, IOL_CMD_LLT, 0x0, 0x0}; -+ -+ RTW_PUT_BE32((u8*)&cmd.value, (u32)page_boundary); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 8); -+} -+ -+int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value) -+{ -+ IOL_CMD cmd = {0x0, IOL_CMD_WB_REG, 0x0, 0x0}; -+ -+ RTW_PUT_BE16((u8*)&cmd.address, (u16)addr); -+ RTW_PUT_BE32((u8*)&cmd.value, (u32)value); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 8); -+} -+ -+int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value) -+{ -+ IOL_CMD cmd = {0x0, IOL_CMD_WW_REG, 0x0, 0x0}; -+ -+ RTW_PUT_BE16((u8*)&cmd.address, (u16)addr); -+ RTW_PUT_BE32((u8*)&cmd.value, (u32)value); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 8); -+} -+ -+int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value) -+{ -+ IOL_CMD cmd = {0x0, IOL_CMD_WD_REG, 0x0, 0x0}; -+ u8* pos = (u8 *)&cmd; -+ -+ RTW_PUT_BE16((u8*)&cmd.address, (u16)addr); -+ RTW_PUT_BE32((u8*)&cmd.value, (u32)value); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 8); -+} -+ -+#ifdef DBG_IO -+int dbg_rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 1)) -+ DBG_871X("DBG_IO %s:%d IOL_WB(0x%04x, 0x%02x)\n", caller, line, addr, value); -+ -+ return _rtw_IOL_append_WB_cmd(xmit_frame, addr, value); -+} -+ -+int dbg_rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 2)) -+ DBG_871X("DBG_IO %s:%d IOL_WW(0x%04x, 0x%04x)\n", caller, line, addr, value); -+ -+ return _rtw_IOL_append_WW_cmd(xmit_frame, addr, value); -+} -+ -+int dbg_rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, const char *caller, const int line) -+{ -+ if (match_write_sniff_ranges(addr, 4)) -+ DBG_871X("DBG_IO %s:%d IOL_WD(0x%04x, 0x%08x)\n", caller, line, addr, value); -+ -+ return _rtw_IOL_append_WD_cmd(xmit_frame, addr, value); -+} -+#endif -+ -+int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us) -+{ -+ IOL_CMD cmd = {0x0, IOL_CMD_DELAY_US, 0x0, 0x0}; -+ -+ RTW_PUT_BE32((u8*)&cmd.value, (u32)us); -+ -+ //DBG_871X("%s %u\n", __FUNCTION__, us); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 8); -+} -+ -+int rtw_IOL_append_DELAY_MS_cmd(struct xmit_frame *xmit_frame, u16 ms) -+{ -+ IOL_CMD cmd = {0x0, IOL_CMD_DELAY_MS, 0x0, 0x0}; -+ -+ RTW_PUT_BE32((u8*)&cmd.value, (u32)ms); -+ -+ //DBG_871X("%s %u\n", __FUNCTION__, ms); -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&cmd, 8); -+} -+ -+int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame) -+{ -+ IOL_CMD end_cmd = {0x0, IOL_CMD_END, 0x0, 0x0}; -+ -+ -+ return rtw_IOL_append_cmds(xmit_frame, (u8*)&end_cmd, 8); -+ -+} -+ -+int rtw_IOL_exec_cmd_array_sync(PADAPTER adapter, u8 *IOL_cmds, u32 cmd_num, u32 max_wating_ms) -+{ -+ struct xmit_frame *xmit_frame; -+ -+ if((xmit_frame=rtw_IOL_accquire_xmit_frame(adapter)) == NULL) -+ return _FAIL; -+ -+ if(rtw_IOL_append_cmds(xmit_frame, IOL_cmds, cmd_num<<3) == _FAIL) -+ return _FAIL; -+ -+ return rtw_IOL_exec_cmds_sync(adapter, xmit_frame, max_wating_ms,0); -+} -+ -+int rtw_IOL_exec_empty_cmds_sync(ADAPTER *adapter, u32 max_wating_ms) -+{ -+ IOL_CMD end_cmd = {0x0, IOL_CMD_END, 0x0, 0x0}; -+ return rtw_IOL_exec_cmd_array_sync(adapter, (u8*)&end_cmd, 1, max_wating_ms); -+} -+#endif //CONFIG_IOL_NEW_GENERATION -+ -+ -+ -+ -+#endif //CONFIG_IOL -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_mlme.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mlme.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_mlme.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mlme.c 2018-02-06 17:42:30.695966942 +0200 -@@ -0,0 +1,3626 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_MLME_C_ -+ -+#include -+#include "rtw_mlme.h" -+ -+sint _rtw_init_mlme_priv (_adapter* padapter) -+{ -+ sint i; -+ u8 *pbuf; -+ struct wlan_network *pnetwork; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ sint res = _SUCCESS; -+ -+ -+ -+ // We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). -+ //_rtw_memset((u8 *)pmlmepriv, 0, sizeof(struct mlme_priv)); -+ -+ pmlmepriv->nic_hdl = (u8 *)padapter; -+ -+ pmlmepriv->pscanned = NULL; -+ pmlmepriv->fw_state = 0; -+ pmlmepriv->cur_network.network.InfrastructureMode = Ndis802_11AutoUnknown; -+ pmlmepriv->scan_mode=SCAN_ACTIVE;// 1: active, 0: pasive. Maybe someday we should rename this varable to "active_mode" (Jeff) -+ -+ _rtw_spinlock_init(&(pmlmepriv->lock)); -+ _rtw_init_queue(&(pmlmepriv->free_bss_pool)); -+ _rtw_init_queue(&(pmlmepriv->scanned_queue)); -+ -+ set_scanned_network_val(pmlmepriv, 0); -+ -+ _rtw_memset(&pmlmepriv->assoc_ssid,0,sizeof(NDIS_802_11_SSID)); -+ -+ pbuf = rtw_zvmalloc(MAX_BSS_CNT * (sizeof(struct wlan_network))); -+ -+ if (pbuf == NULL){ -+ res=_FAIL; -+ goto exit; -+ } -+ pmlmepriv->free_bss_buf = pbuf; -+ -+ pnetwork = (struct wlan_network *)pbuf; -+ -+ for(i = 0; i < MAX_BSS_CNT; i++) -+ { -+ _rtw_init_listhead(&(pnetwork->list)); -+ -+ rtw_list_insert_tail(&(pnetwork->list), &(pmlmepriv->free_bss_pool.queue)); -+ -+ pnetwork++; -+ } -+ -+ //allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf -+ -+ rtw_clear_scan_deny(padapter); -+ -+ #ifdef CONFIG_FTP_PROTECT -+ pmlmepriv->ftp_lock_flag = 0; -+ #endif //CONFIG_FTP_PROTECT -+ -+ rtw_init_mlme_timer(padapter); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+void rtw_mfree_mlme_priv_lock (struct mlme_priv *pmlmepriv); -+void rtw_mfree_mlme_priv_lock (struct mlme_priv *pmlmepriv) -+{ -+ _rtw_spinlock_free(&pmlmepriv->lock); -+ _rtw_spinlock_free(&(pmlmepriv->free_bss_pool.lock)); -+ _rtw_spinlock_free(&(pmlmepriv->scanned_queue.lock)); -+} -+ -+static void rtw_free_mlme_ie_data(u8 **ppie, u32 *plen) -+{ -+ if(*ppie) -+ { -+ _rtw_mfree(*ppie, *plen); -+ *plen = 0; -+ *ppie=NULL; -+ } -+} -+ -+void rtw_free_mlme_priv_ie_data(struct mlme_priv *pmlmepriv) -+{ -+#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ rtw_buf_free(&pmlmepriv->assoc_req, &pmlmepriv->assoc_req_len); -+ rtw_buf_free(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wps_beacon_ie, &pmlmepriv->wps_beacon_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wps_probe_req_ie, &pmlmepriv->wps_probe_req_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wps_probe_resp_ie, &pmlmepriv->wps_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wps_assoc_resp_ie, &pmlmepriv->wps_assoc_resp_ie_len); -+ -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_beacon_ie, &pmlmepriv->p2p_beacon_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_probe_req_ie, &pmlmepriv->p2p_probe_req_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_probe_resp_ie, &pmlmepriv->p2p_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_go_probe_resp_ie, &pmlmepriv->p2p_go_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->p2p_assoc_req_ie, &pmlmepriv->p2p_assoc_req_ie_len); -+#endif -+ -+#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) -+ rtw_free_mlme_ie_data(&pmlmepriv->wfd_beacon_ie, &pmlmepriv->wfd_beacon_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wfd_probe_req_ie, &pmlmepriv->wfd_probe_req_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wfd_probe_resp_ie, &pmlmepriv->wfd_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wfd_go_probe_resp_ie, &pmlmepriv->wfd_go_probe_resp_ie_len); -+ rtw_free_mlme_ie_data(&pmlmepriv->wfd_assoc_req_ie, &pmlmepriv->wfd_assoc_req_ie_len); -+#endif -+ -+} -+ -+void _rtw_free_mlme_priv (struct mlme_priv *pmlmepriv) -+{ -+ -+ -+ rtw_free_mlme_priv_ie_data(pmlmepriv); -+ -+ if(pmlmepriv){ -+ rtw_mfree_mlme_priv_lock (pmlmepriv); -+ -+ if (pmlmepriv->free_bss_buf) { -+ rtw_vmfree(pmlmepriv->free_bss_buf, MAX_BSS_CNT * sizeof(struct wlan_network)); -+ } -+ } -+ -+} -+ -+sint _rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork) -+{ -+ _irqL irqL; -+ -+ -+ -+ if (pnetwork == NULL) -+ goto exit; -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ rtw_list_insert_tail(&pnetwork->list, &queue->queue); -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+exit: -+ -+ -+ -+ return _SUCCESS; -+} -+ -+/* -+struct wlan_network *_rtw_dequeue_network(_queue *queue) -+{ -+ _irqL irqL; -+ -+ struct wlan_network *pnetwork; -+ -+ -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ if (_rtw_queue_empty(queue) == true) -+ -+ pnetwork = NULL; -+ -+ else -+ { -+ pnetwork = LIST_CONTAINOR(get_next(&queue->queue), struct wlan_network, list); -+ -+ rtw_list_delete(&(pnetwork->list)); -+ } -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ -+ -+ return pnetwork; -+} -+*/ -+ -+struct wlan_network *_rtw_alloc_network(struct mlme_priv *pmlmepriv )//(_queue *free_queue) -+{ -+ _irqL irqL; -+ struct wlan_network *pnetwork; -+ _queue *free_queue = &pmlmepriv->free_bss_pool; -+ _list* plist = NULL; -+ -+ -+ -+ _enter_critical_bh(&free_queue->lock, &irqL); -+ -+ if (_rtw_queue_empty(free_queue) == true) { -+ pnetwork=NULL; -+ goto exit; -+ } -+ plist = get_next(&(free_queue->queue)); -+ -+ pnetwork = LIST_CONTAINOR(plist , struct wlan_network, list); -+ -+ rtw_list_delete(&pnetwork->list); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("_rtw_alloc_network: ptr=%p\n", plist)); -+ pnetwork->network_type = 0; -+ pnetwork->fixed = false; -+ pnetwork->last_scanned = rtw_get_current_time(); -+ pnetwork->aid=0; -+ pnetwork->join_res=0; -+ -+ pmlmepriv->num_of_scanned ++; -+ -+exit: -+ _exit_critical_bh(&free_queue->lock, &irqL); -+ -+ -+ -+ return pnetwork; -+} -+ -+void _rtw_free_network(struct mlme_priv *pmlmepriv ,struct wlan_network *pnetwork, u8 isfreeall) -+{ -+ u32 delta_time; -+ u32 lifetime = SCANQUEUE_LIFETIME; -+ _irqL irqL; -+ _queue *free_queue = &(pmlmepriv->free_bss_pool); -+ -+ if (pnetwork == NULL) -+ return; -+ -+ if (pnetwork->fixed == true) -+ return; -+ -+ if ( (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)==true ) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==true ) ) -+ lifetime = 1; -+ -+ if(!isfreeall) { -+ delta_time = (u32) rtw_get_passing_time_ms(pnetwork->last_scanned); -+ if(delta_time < lifetime)// unit:msec -+ return; -+ } -+ -+ _enter_critical_bh(&free_queue->lock, &irqL); -+ -+ rtw_list_delete(&(pnetwork->list)); -+ -+ rtw_list_insert_tail(&(pnetwork->list),&(free_queue->queue)); -+ -+ pmlmepriv->num_of_scanned --; -+ -+ -+ //DBG_871X("_rtw_free_network:SSID=%s\n", pnetwork->network.Ssid.Ssid); -+ -+ _exit_critical_bh(&free_queue->lock, &irqL); -+} -+ -+void _rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork) -+{ -+ _queue *free_queue = &(pmlmepriv->free_bss_pool); -+ -+ if (pnetwork == NULL) -+ return; -+ -+ if (pnetwork->fixed == true) -+ return; -+ -+ //_enter_critical(&free_queue->lock, &irqL); -+ -+ rtw_list_delete(&(pnetwork->list)); -+ -+ rtw_list_insert_tail(&(pnetwork->list), get_list_head(free_queue)); -+ -+ pmlmepriv->num_of_scanned --; -+} -+ -+ -+/* -+ return the wlan_network with the matching addr -+ -+ Shall be calle under atomic context... to avoid possible racing condition... -+*/ -+struct wlan_network *_rtw_find_network(_queue *scanned_queue, u8 *addr) -+{ -+ -+ //_irqL irqL; -+ _list *phead, *plist; -+ struct wlan_network *pnetwork = NULL; -+ u8 zero_addr[ETH_ALEN] = {0,0,0,0,0,0}; -+ -+ -+ -+ if(_rtw_memcmp(zero_addr, addr, ETH_ALEN)){ -+ pnetwork=NULL; -+ goto exit; -+ } -+ -+ //_enter_critical_bh(&scanned_queue->lock, &irqL); -+ -+ phead = get_list_head(scanned_queue); -+ plist = get_next(phead); -+ -+ while (plist != phead) -+ { -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network ,list); -+ -+ if (_rtw_memcmp(addr, pnetwork->network.MacAddress, ETH_ALEN) == true) -+ break; -+ -+ plist = get_next(plist); -+ } -+ -+ if(plist == phead) -+ pnetwork = NULL; -+ -+exit: -+ return pnetwork; -+} -+ -+ -+void _rtw_free_network_queue(_adapter *padapter, u8 isfreeall) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ struct wlan_network *pnetwork; -+ struct mlme_priv* pmlmepriv = &padapter->mlmepriv; -+ _queue *scanned_queue = &pmlmepriv->scanned_queue; -+ -+ -+ -+ -+ _enter_critical_bh(&scanned_queue->lock, &irqL); -+ -+ phead = get_list_head(scanned_queue); -+ plist = get_next(phead); -+ -+ while (rtw_end_of_queue_search(phead, plist) == false) -+ { -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ plist = get_next(plist); -+ -+ _rtw_free_network(pmlmepriv,pnetwork, isfreeall); -+ -+ } -+ -+ _exit_critical_bh(&scanned_queue->lock, &irqL); -+ -+ -+ -+} -+ -+ -+ -+ -+sint rtw_if_up(_adapter *padapter) { -+ -+ sint res; -+ -+ -+ if( padapter->bDriverStopped || padapter->bSurpriseRemoved || -+ (check_fwstate(&padapter->mlmepriv, _FW_LINKED)== false)){ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("rtw_if_up:bDriverStopped(%d) OR bSurpriseRemoved(%d)", padapter->bDriverStopped, padapter->bSurpriseRemoved)); -+ res=false; -+ } -+ else -+ res= true; -+ -+ -+ return res; -+} -+ -+ -+void rtw_generate_random_ibss(u8* pibss) -+{ -+ u32 curtime = rtw_get_current_time(); -+ -+ -+ pibss[0] = 0x02; //in ad-hoc mode bit1 must set to 1 -+ pibss[1] = 0x11; -+ pibss[2] = 0x87; -+ pibss[3] = (u8)(curtime & 0xff) ;//p[0]; -+ pibss[4] = (u8)((curtime>>8) & 0xff) ;//p[1]; -+ pibss[5] = (u8)((curtime>>16) & 0xff) ;//p[2]; -+ -+ return; -+} -+ -+u8 *rtw_get_capability_from_ie(u8 *ie) -+{ -+ return (ie + 8 + 2); -+} -+ -+ -+u16 rtw_get_capability(WLAN_BSSID_EX *bss) -+{ -+ u16 val; -+ -+ -+ _rtw_memcpy((u8 *)&val, rtw_get_capability_from_ie(bss->IEs), 2); -+ -+ -+ return le16_to_cpu(val); -+} -+ -+u8 *rtw_get_timestampe_from_ie(u8 *ie) -+{ -+ return (ie + 0); -+} -+ -+u8 *rtw_get_beacon_interval_from_ie(u8 *ie) -+{ -+ return (ie + 8); -+} -+ -+ -+int rtw_init_mlme_priv (_adapter *padapter)//(struct mlme_priv *pmlmepriv) -+{ -+ int res; -+ -+ res = _rtw_init_mlme_priv(padapter);// (pmlmepriv); -+ -+ return res; -+} -+ -+void rtw_free_mlme_priv (struct mlme_priv *pmlmepriv) -+{ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("rtw_free_mlme_priv\n")); -+ _rtw_free_mlme_priv (pmlmepriv); -+ -+} -+ -+int rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork); -+int rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork) -+{ -+ int res; -+ -+ res = _rtw_enqueue_network(queue, pnetwork); -+ -+ return res; -+} -+ -+/* -+static struct wlan_network *rtw_dequeue_network(_queue *queue) -+{ -+ struct wlan_network *pnetwork; -+ -+ pnetwork = _rtw_dequeue_network(queue); -+ -+ return pnetwork; -+} -+*/ -+ -+struct wlan_network *rtw_alloc_network(struct mlme_priv *pmlmepriv ); -+struct wlan_network *rtw_alloc_network(struct mlme_priv *pmlmepriv )//(_queue *free_queue) -+{ -+ struct wlan_network *pnetwork; -+ -+ pnetwork = _rtw_alloc_network(pmlmepriv); -+ -+ return pnetwork; -+} -+ -+void rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 is_freeall); -+void rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 is_freeall)//(struct wlan_network *pnetwork, _queue *free_queue) -+{ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("rtw_free_network==> ssid = %s \n\n" , pnetwork->network.Ssid.Ssid)); -+ _rtw_free_network(pmlmepriv, pnetwork, is_freeall); -+ -+} -+ -+void rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork ); -+void rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork ) -+{ -+ -+ //RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("rtw_free_network==> ssid = %s \n\n" , pnetwork->network.Ssid.Ssid)); -+ _rtw_free_network_nolock(pmlmepriv, pnetwork); -+ -+} -+ -+ -+void rtw_free_network_queue(_adapter* dev, u8 isfreeall) -+{ -+ -+ _rtw_free_network_queue(dev, isfreeall); -+ -+} -+ -+/* -+ return the wlan_network with the matching addr -+ -+ Shall be calle under atomic context... to avoid possible racing condition... -+*/ -+struct wlan_network *rtw_find_network(_queue *scanned_queue, u8 *addr) -+{ -+ struct wlan_network *pnetwork = _rtw_find_network(scanned_queue, addr); -+ -+ return pnetwork; -+} -+ -+int rtw_is_same_ibss(_adapter *adapter, struct wlan_network *pnetwork) -+{ -+ int ret=true; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ -+ if ( (psecuritypriv->dot11PrivacyAlgrthm != _NO_PRIVACY_ ) && -+ ( pnetwork->network.Privacy == 0 ) ) -+ { -+ ret=false; -+ } -+ else if((psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_ ) && -+ ( pnetwork->network.Privacy == 1 ) ) -+ { -+ ret=false; -+ } -+ else -+ { -+ ret=true; -+ } -+ -+ return ret; -+ -+} -+ -+inline int is_same_ess(WLAN_BSSID_EX *a, WLAN_BSSID_EX *b); -+inline int is_same_ess(WLAN_BSSID_EX *a, WLAN_BSSID_EX *b) -+{ -+ //RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("(%s,%d)(%s,%d)\n", -+ // a->Ssid.Ssid,a->Ssid.SsidLength,b->Ssid.Ssid,b->Ssid.SsidLength)); -+ return (a->Ssid.SsidLength == b->Ssid.SsidLength) -+ && _rtw_memcmp(a->Ssid.Ssid, b->Ssid.Ssid, a->Ssid.SsidLength)==true; -+} -+ -+int is_same_network(WLAN_BSSID_EX *src, WLAN_BSSID_EX *dst) -+{ -+ u16 s_cap, d_cap; -+ -+ -+ -+ if(rtw_bug_check(dst, src, &s_cap, &d_cap)==false) -+ return false; -+ -+ _rtw_memcpy((u8 *)&s_cap, rtw_get_capability_from_ie(src->IEs), 2); -+ _rtw_memcpy((u8 *)&d_cap, rtw_get_capability_from_ie(dst->IEs), 2); -+ -+ -+ s_cap = le16_to_cpu(s_cap); -+ d_cap = le16_to_cpu(d_cap); -+ -+ -+ -+ return ((src->Ssid.SsidLength == dst->Ssid.SsidLength) && -+ // (src->Configuration.DSConfig == dst->Configuration.DSConfig) && -+ ( (_rtw_memcmp(src->MacAddress, dst->MacAddress, ETH_ALEN)) == true) && -+ ( (_rtw_memcmp(src->Ssid.Ssid, dst->Ssid.Ssid, src->Ssid.SsidLength)) == true) && -+ ((s_cap & WLAN_CAPABILITY_IBSS) == -+ (d_cap & WLAN_CAPABILITY_IBSS)) && -+ ((s_cap & WLAN_CAPABILITY_BSS) == -+ (d_cap & WLAN_CAPABILITY_BSS))); -+ -+} -+ -+struct wlan_network * rtw_get_oldest_wlan_network(_queue *scanned_queue) -+{ -+ _list *plist, *phead; -+ -+ -+ struct wlan_network *pwlan = NULL; -+ struct wlan_network *oldest = NULL; -+ -+ phead = get_list_head(scanned_queue); -+ -+ plist = get_next(phead); -+ -+ while(1) -+ { -+ -+ if (rtw_end_of_queue_search(phead,plist)== true) -+ break; -+ -+ pwlan= LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ if(pwlan->fixed!=true) -+ { -+ if (oldest == NULL ||time_after(oldest->last_scanned, pwlan->last_scanned)) -+ oldest = pwlan; -+ } -+ -+ plist = get_next(plist); -+ } -+ -+ return oldest; -+ -+} -+ -+void update_network(WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src, -+ _adapter * padapter, bool update_ie) -+{ -+ u8 ss_ori = dst->PhyInfo.SignalStrength; -+ u8 sq_ori = dst->PhyInfo.SignalQuality; -+ long rssi_ori = dst->Rssi; -+ -+ u8 ss_smp = src->PhyInfo.SignalStrength; -+ u8 sq_smp = src->PhyInfo.SignalQuality; -+ long rssi_smp = src->Rssi; -+ -+ u8 ss_final; -+ u8 sq_final; -+ long rssi_final; -+ -+ -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ rtw_hal_antdiv_rssi_compared(padapter, dst, src); //this will update src.Rssi, need consider again -+#endif -+ -+ #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 -+ if(strcmp(dst->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { -+ DBG_871X("%s %s("MAC_FMT", ch%u) ss_ori:%3u, sq_ori:%3u, rssi_ori:%3ld, ss_smp:%3u, sq_smp:%3u, rssi_smp:%3ld\n" -+ , __FUNCTION__ -+ , src->Ssid.Ssid, MAC_ARG(src->MacAddress), src->Configuration.DSConfig -+ ,ss_ori, sq_ori, rssi_ori -+ ,ss_smp, sq_smp, rssi_smp -+ ); -+ } -+ #endif -+ -+ /* The rule below is 1/5 for sample value, 4/5 for history value */ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) && is_same_network(&(padapter->mlmepriv.cur_network.network), src)) { -+ /* Take the recvpriv's value for the connected AP*/ -+ ss_final = padapter->recvpriv.signal_strength; -+ sq_final = padapter->recvpriv.signal_qual; -+ /* the rssi value here is undecorated, and will be used for antenna diversity */ -+ if(sq_smp != 101) /* from the right channel */ -+ rssi_final = (src->Rssi+dst->Rssi*4)/5; -+ else -+ rssi_final = rssi_ori; -+ } -+ else { -+ if(sq_smp != 101) { /* from the right channel */ -+ ss_final = ((u32)(src->PhyInfo.SignalStrength)+(u32)(dst->PhyInfo.SignalStrength)*4)/5; -+ sq_final = ((u32)(src->PhyInfo.SignalQuality)+(u32)(dst->PhyInfo.SignalQuality)*4)/5; -+ rssi_final = (src->Rssi+dst->Rssi*4)/5; -+ } else { -+ /* bss info not receving from the right channel, use the original RX signal infos */ -+ ss_final = dst->PhyInfo.SignalStrength; -+ sq_final = dst->PhyInfo.SignalQuality; -+ rssi_final = dst->Rssi; -+ } -+ -+ } -+ -+ if (update_ie) -+ _rtw_memcpy((u8 *)dst, (u8 *)src, get_WLAN_BSSID_EX_sz(src)); -+ -+ dst->PhyInfo.SignalStrength = ss_final; -+ dst->PhyInfo.SignalQuality = sq_final; -+ dst->Rssi = rssi_final; -+ -+ #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 -+ if(strcmp(dst->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { -+ DBG_871X("%s %s("MAC_FMT"), SignalStrength:%u, SignalQuality:%u, RawRSSI:%ld\n" -+ , __FUNCTION__ -+ , dst->Ssid.Ssid, MAC_ARG(dst->MacAddress), dst->PhyInfo.SignalStrength, dst->PhyInfo.SignalQuality, dst->Rssi); -+ } -+ #endif -+ -+#if 0 // old codes, may be useful one day... -+// DBG_871X("update_network: rssi=0x%lx dst->Rssi=%d ,dst->Rssi=0x%lx , src->Rssi=0x%lx",(dst->Rssi+src->Rssi)/2,dst->Rssi,dst->Rssi,src->Rssi); -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) && is_same_network(&(padapter->mlmepriv.cur_network.network), src)) -+ { -+ -+ //DBG_871X("b:ssid=%s update_network: src->rssi=0x%d padapter->recvpriv.ui_rssi=%d\n",src->Ssid.Ssid,src->Rssi,padapter->recvpriv.signal); -+ if(padapter->recvpriv.signal_qual_data.total_num++ >= PHY_LINKQUALITY_SLID_WIN_MAX) -+ { -+ padapter->recvpriv.signal_qual_data.total_num = PHY_LINKQUALITY_SLID_WIN_MAX; -+ last_evm = padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index]; -+ padapter->recvpriv.signal_qual_data.total_val -= last_evm; -+ } -+ padapter->recvpriv.signal_qual_data.total_val += query_rx_pwr_percentage(src->Rssi); -+ -+ padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = query_rx_pwr_percentage(src->Rssi); -+ if(padapter->recvpriv.signal_qual_data.index >= PHY_LINKQUALITY_SLID_WIN_MAX) -+ padapter->recvpriv.signal_qual_data.index = 0; -+ -+ //DBG_871X("Total SQ=%d pattrib->signal_qual= %d\n", padapter->recvpriv.signal_qual_data.total_val, src->Rssi); -+ -+ // <1> Showed on UI for user,in percentage. -+ tmpVal = padapter->recvpriv.signal_qual_data.total_val/padapter->recvpriv.signal_qual_data.total_num; -+ padapter->recvpriv.signal=(u8)tmpVal;//Link quality -+ -+ src->Rssi= translate_percentage_to_dbm(padapter->recvpriv.signal) ; -+ } -+ else{ -+// DBG_871X("ELSE:ssid=%s update_network: src->rssi=0x%d dst->rssi=%d\n",src->Ssid.Ssid,src->Rssi,dst->Rssi); -+ src->Rssi=(src->Rssi +dst->Rssi)/2;//dBM -+ } -+ -+// DBG_871X("a:update_network: src->rssi=0x%d padapter->recvpriv.ui_rssi=%d\n",src->Rssi,padapter->recvpriv.signal); -+ -+#endif -+ -+ -+} -+ -+static void update_current_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork) -+{ -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ -+ -+ rtw_bug_check(&(pmlmepriv->cur_network.network), -+ &(pmlmepriv->cur_network.network), -+ &(pmlmepriv->cur_network.network), -+ &(pmlmepriv->cur_network.network)); -+ -+ if ( (check_fwstate(pmlmepriv, _FW_LINKED)== true) && (is_same_network(&(pmlmepriv->cur_network.network), pnetwork))) -+ { -+ //RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,"Same Network\n"); -+ -+ //if(pmlmepriv->cur_network.network.IELength<= pnetwork->IELength) -+ { -+ update_network(&(pmlmepriv->cur_network.network), pnetwork,adapter, true); -+ rtw_update_protection(adapter, (pmlmepriv->cur_network.network.IEs) + sizeof (NDIS_802_11_FIXED_IEs), -+ pmlmepriv->cur_network.network.IELength); -+ } -+ } -+ -+ -+ -+} -+ -+ -+/* -+ -+Caller must hold pmlmepriv->lock first. -+ -+ -+*/ -+void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ u32 bssid_ex_sz; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ struct wlan_network *oldest = NULL; -+ -+ -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while(1) -+ { -+ if (rtw_end_of_queue_search(phead,plist)== true) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ rtw_bug_check(pnetwork, pnetwork, pnetwork, pnetwork); -+ -+ if (is_same_network(&(pnetwork->network), target)) -+ break; -+ -+ if ((oldest == ((struct wlan_network *)0)) || -+ time_after(oldest->last_scanned, pnetwork->last_scanned)) -+ oldest = pnetwork; -+ -+ plist = get_next(plist); -+ -+ } -+ -+ -+ /* If we didn't find a match, then get a new network slot to initialize -+ * with this beacon's information */ -+ if (rtw_end_of_queue_search(phead,plist)== true) { -+ -+ if (_rtw_queue_empty(&(pmlmepriv->free_bss_pool)) == true) { -+ /* If there are no more slots, expire the oldest */ -+ //list_del_init(&oldest->list); -+ pnetwork = oldest; -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ //target->PhyInfo.Optimum_antenna = pHalData->CurAntenna;//optimum_antenna=>For antenna diversity -+ rtw_hal_get_def_var(adapter, HAL_DEF_CURRENT_ANTENNA, &(target->PhyInfo.Optimum_antenna)); -+#endif -+ _rtw_memcpy(&(pnetwork->network), target, get_WLAN_BSSID_EX_sz(target)); -+ //pnetwork->last_scanned = rtw_get_current_time(); -+ // variable initialize -+ pnetwork->fixed = false; -+ pnetwork->last_scanned = rtw_get_current_time(); -+ -+ pnetwork->network_type = 0; -+ pnetwork->aid=0; -+ pnetwork->join_res=0; -+ -+ /* bss info not receving from the right channel */ -+ if (pnetwork->network.PhyInfo.SignalQuality == 101) -+ pnetwork->network.PhyInfo.SignalQuality = 0; -+ } -+ else { -+ /* Otherwise just pull from the free list */ -+ -+ pnetwork = rtw_alloc_network(pmlmepriv); // will update scan_time -+ -+ if(pnetwork==NULL){ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n\n\nsomething wrong here\n\n\n")); -+ goto exit; -+ } -+ -+ bssid_ex_sz = get_WLAN_BSSID_EX_sz(target); -+ target->Length = bssid_ex_sz; -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ //target->PhyInfo.Optimum_antenna = pHalData->CurAntenna; -+ rtw_hal_get_def_var(adapter, HAL_DEF_CURRENT_ANTENNA, &(target->PhyInfo.Optimum_antenna)); -+#endif -+ _rtw_memcpy(&(pnetwork->network), target, bssid_ex_sz ); -+ -+ pnetwork->last_scanned = rtw_get_current_time(); -+ -+ /* bss info not receving from the right channel */ -+ if (pnetwork->network.PhyInfo.SignalQuality == 101) -+ pnetwork->network.PhyInfo.SignalQuality = 0; -+ -+ rtw_list_insert_tail(&(pnetwork->list),&(queue->queue)); -+ -+ } -+ } -+ else { -+ /* we have an entry and we are going to update it. But this entry may -+ * be already expired. In this case we do the same as we found a new -+ * net and call the new_net handler -+ */ -+ bool update_ie = true; -+ -+ pnetwork->last_scanned = rtw_get_current_time(); -+ -+ //target.Reserved[0]==1, means that scaned network is a bcn frame. -+ if((pnetwork->network.IELength>target->IELength) && (target->Reserved[0]==1)) -+ update_ie = false; -+ -+ update_network(&(pnetwork->network), target,adapter, update_ie); -+ } -+ -+exit: -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ -+} -+ -+void rtw_add_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork); -+void rtw_add_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &(((_adapter *)adapter)->mlmepriv); -+ //_queue *queue = &(pmlmepriv->scanned_queue); -+ -+ -+ -+ //_enter_critical_bh(&queue->lock, &irqL); -+ -+ #if defined(CONFIG_P2P) && defined(CONFIG_P2P_REMOVE_GROUP_INFO) -+ rtw_WLAN_BSSID_EX_remove_p2p_attr(pnetwork, P2P_ATTR_GROUP_INFO); -+ #endif -+ -+ update_current_network(adapter, pnetwork); -+ -+ rtw_update_scanned_network(adapter, pnetwork); -+ -+ //_exit_critical_bh(&queue->lock, &irqL); -+ -+ -+} -+ -+//select the desired network based on the capability of the (i)bss. -+// check items: (1) security -+// (2) network_type -+// (3) WMM -+// (4) HT -+// (5) others -+int rtw_is_desired_network(_adapter *adapter, struct wlan_network *pnetwork); -+int rtw_is_desired_network(_adapter *adapter, struct wlan_network *pnetwork) -+{ -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u32 desired_encmode; -+ u32 privacy; -+ -+ //u8 wps_ie[512]; -+ uint wps_ielen; -+ -+ int bselected = true; -+ -+ desired_encmode = psecuritypriv->ndisencryptstatus; -+ privacy = pnetwork->network.Privacy; -+ -+ if(check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) -+ { -+ if(rtw_get_wps_ie(pnetwork->network.IEs+_FIXED_IE_LENGTH_, pnetwork->network.IELength-_FIXED_IE_LENGTH_, NULL, &wps_ielen)!=NULL) -+ { -+ return true; -+ } -+ else -+ { -+ return false; -+ } -+ } -+ if (adapter->registrypriv.wifi_spec == 1) //for correct flow of 8021X to do.... -+ { -+ if ((desired_encmode == Ndis802_11EncryptionDisabled) && (privacy != 0)) -+ bselected = false; -+ } -+ -+ -+ if ((desired_encmode != Ndis802_11EncryptionDisabled) && (privacy == 0)) { -+ DBG_871X("desired_encmode: %d, privacy: %d\n", desired_encmode, privacy); -+ bselected = false; -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) -+ { -+ if(pnetwork->network.InfrastructureMode != pmlmepriv->cur_network.network.InfrastructureMode) -+ bselected = false; -+ } -+ -+ -+ return bselected; -+} -+ -+/* TODO: Perry : For Power Management */ -+void rtw_atimdone_event_callback(_adapter *adapter , u8 *pbuf) -+{ -+ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("receive atimdone_evet\n")); -+ -+ return; -+} -+ -+ -+void rtw_survey_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL; -+ u32 len; -+ WLAN_BSSID_EX *pnetwork; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ -+ -+ pnetwork = (WLAN_BSSID_EX *)pbuf; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_survey_event_callback, ssid=%s\n", pnetwork->Ssid.Ssid)); -+ -+ len = get_WLAN_BSSID_EX_sz(pnetwork); -+ if(len > (sizeof(WLAN_BSSID_EX))) -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n ****rtw_survey_event_callback: return a wrong bss ***\n")); -+ return; -+ } -+ -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ // update IBSS_network 's timestamp -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == true) -+ { -+ //RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,"rtw_survey_event_callback : WIFI_ADHOC_MASTER_STATE \n\n"); -+ if(_rtw_memcmp(&(pmlmepriv->cur_network.network.MacAddress), pnetwork->MacAddress, ETH_ALEN)) -+ { -+ struct wlan_network* ibss_wlan = NULL; -+ _irqL irqL; -+ -+ _rtw_memcpy(pmlmepriv->cur_network.network.IEs, pnetwork->IEs, 8); -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ ibss_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->MacAddress); -+ if(ibss_wlan) -+ { -+ _rtw_memcpy(ibss_wlan->network.IEs , pnetwork->IEs, 8); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ goto exit; -+ } -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ } -+ } -+ -+ // lock pmlmepriv->lock when you accessing network_q -+ if ((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == false) -+ { -+ if( pnetwork->Ssid.Ssid[0] == 0 ) -+ { -+ pnetwork->Ssid.SsidLength = 0; -+ } -+ rtw_add_network(adapter, pnetwork); -+ } -+ -+exit: -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+ -+ return; -+} -+ -+ -+ -+void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+#ifdef CONFIG_MLME_EXT -+ -+ mlmeext_surveydone_event_callback(adapter); -+ -+#endif -+ -+ -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if(pmlmepriv->wps_probe_req_ie) -+ { -+ u32 free_len = pmlmepriv->wps_probe_req_ie_len; -+ pmlmepriv->wps_probe_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); -+ pmlmepriv->wps_probe_req_ie = NULL; -+ } -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_surveydone_event_callback: fw_state:%x\n\n", get_fwstate(pmlmepriv))); -+ -+ if (check_fwstate(pmlmepriv,_FW_UNDER_SURVEY)) -+ { -+ u8 timer_cancelled; -+ -+ _cancel_timer(&pmlmepriv->scan_to_timer, &timer_cancelled); -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ } -+ else { -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("nic status =%x, survey done event comes too late!\n", get_fwstate(pmlmepriv))); -+ } -+ -+ #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ rtw_set_signal_stat_timer(&adapter->recvpriv); -+ #endif -+ -+ if(pmlmepriv->to_join == true) -+ { -+ if((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==true) ) -+ { -+ if(check_fwstate(pmlmepriv, _FW_LINKED)==false) -+ { -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ -+ if(rtw_select_and_join_from_scanned_queue(pmlmepriv)==_SUCCESS) -+ { -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT ); -+ } -+ else -+ { -+ WLAN_BSSID_EX *pdev_network = &(adapter->registrypriv.dev_network); -+ u8 *pibss = adapter->registrypriv.dev_network.MacAddress; -+ -+ //pmlmepriv->fw_state ^= _FW_UNDER_SURVEY;//because don't set assoc_timer -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("switching to adhoc master\n")); -+ -+ _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); -+ -+ rtw_update_registrypriv_dev_network(adapter); -+ rtw_generate_random_ibss(pibss); -+ -+ pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE; -+ -+ if(rtw_createbss_cmd(adapter)!=_SUCCESS) -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Error=>rtw_createbss_cmd status FAIL\n")); -+ } -+ -+ pmlmepriv->to_join = false; -+ } -+ } -+ } -+ else -+ { -+ int s_ret; -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ pmlmepriv->to_join = false; -+ if(_SUCCESS == (s_ret=rtw_select_and_join_from_scanned_queue(pmlmepriv))) -+ { -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ } -+ else if(s_ret == 2)//there is no need to wait for join -+ { -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ rtw_indicate_connect(adapter); -+ } -+ else -+ { -+ DBG_871X("try_to_join, but select scanning queue fail, to_roaming:%d\n", rtw_to_roaming(adapter)); -+ #ifdef CONFIG_LAYER2_ROAMING -+ if (rtw_to_roaming(adapter) != 0) { -+ if( --pmlmepriv->to_roaming == 0 -+ || _SUCCESS != rtw_sitesurvey_cmd(adapter, &pmlmepriv->assoc_ssid, 1, NULL, 0) -+ ) { -+ rtw_set_roaming(adapter, 0); -+#ifdef CONFIG_INTEL_WIDI -+ if(adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) -+ { -+ _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); -+ intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL); -+ DBG_871X("change to widi listen\n"); -+ } -+#endif // CONFIG_INTEL_WIDI -+ rtw_free_assoc_resources(adapter, 1); -+ rtw_indicate_disconnect(adapter); -+ } else { -+ pmlmepriv->to_join = true; -+ } -+ } -+ #endif -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ } -+ } -+ } -+ -+ indicate_wx_scan_complete_event(adapter); -+ //DBG_871X("scan complete in %dms\n",rtw_get_passing_time_ms(pmlmepriv->scan_start_time)); -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+#ifdef CONFIG_P2P_PS -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { -+ p2p_ps_wk_cmd(adapter, P2P_PS_SCAN_DONE, 0); -+ } -+#endif // CONFIG_P2P_PS -+ -+ rtw_os_xmit_schedule(adapter); -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_os_xmit_schedule(adapter->pbuddy_adapter); -+#endif -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ dc_resume_xmit(adapter); -+#endif -+ -+#ifdef CONFIG_DRVEXT_MODULE_WSC -+ drvext_surveydone_callback(&adapter->drvextpriv); -+#endif -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ { -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ if(pmlmeext->sitesurvey_res.bss_cnt == 0){ -+ rtw_hal_sreset_reset(adapter); -+ } -+ } -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_surveydone_event_callback(adapter); -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ -+ -+} -+ -+void rtw_dummy_event_callback(_adapter *adapter , u8 *pbuf) -+{ -+ -+} -+ -+void rtw_fwdbg_event_callback(_adapter *adapter , u8 *pbuf) -+{ -+ -+} -+ -+static void free_scanqueue(struct mlme_priv *pmlmepriv) -+{ -+ _irqL irqL, irqL0; -+ _queue *free_queue = &pmlmepriv->free_bss_pool; -+ _queue *scan_queue = &pmlmepriv->scanned_queue; -+ _list *plist, *phead, *ptemp; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, ("+free_scanqueue\n")); -+ _enter_critical_bh(&scan_queue->lock, &irqL0); -+ _enter_critical_bh(&free_queue->lock, &irqL); -+ -+ phead = get_list_head(scan_queue); -+ plist = get_next(phead); -+ -+ while (plist != phead) -+ { -+ ptemp = get_next(plist); -+ rtw_list_delete(plist); -+ rtw_list_insert_tail(plist, &free_queue->queue); -+ plist =ptemp; -+ pmlmepriv->num_of_scanned --; -+ } -+ -+ _exit_critical_bh(&free_queue->lock, &irqL); -+ _exit_critical_bh(&scan_queue->lock, &irqL0); -+ -+ -+} -+ -+/* -+*rtw_free_assoc_resources: the caller has to lock pmlmepriv->lock -+*/ -+void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue) -+{ -+ _irqL irqL; -+ struct wlan_network* pwlan = NULL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct wlan_network *tgt_network = &pmlmepriv->cur_network; -+ -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; -+#endif //CONFIG_TDLS -+ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, ("+rtw_free_assoc_resources\n")); -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("tgt_network->network.MacAddress="MAC_FMT" ssid=%s\n", -+ MAC_ARG(tgt_network->network.MacAddress), tgt_network->network.Ssid.Ssid)); -+ -+ if(check_fwstate( pmlmepriv, WIFI_STATION_STATE|WIFI_AP_STATE)) -+ { -+ struct sta_info* psta; -+ -+ psta = rtw_get_stainfo(&adapter->stapriv, tgt_network->network.MacAddress); -+ -+#ifdef CONFIG_TDLS -+ if(ptdlsinfo->setup_state != TDLS_STATE_NONE) -+ { -+ rtw_tdls_cmd(adapter, myid(&(adapter->eeprompriv)), TDLS_RS_RCR); -+ rtw_reset_tdls_info(adapter); -+ rtw_free_all_stainfo(adapter); -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ } -+ else -+#endif //CONFIG_TDLS -+ { -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(adapter, psta); -+ } -+ -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ } -+ -+ if(check_fwstate( pmlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE|WIFI_AP_STATE)) -+ { -+ struct sta_info* psta; -+ -+ rtw_free_all_stainfo(adapter); -+ -+ psta = rtw_get_bcmc_stainfo(adapter); -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(adapter, psta); -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ rtw_init_bcmc_stainfo(adapter); -+ } -+ -+ if(lock_scanned_queue) -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); -+ if(pwlan) -+ { -+ pwlan->fixed = false; -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("rtw_free_assoc_resources : pwlan== NULL \n\n")); -+ } -+ -+ -+ if((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) && (adapter->stapriv.asoc_sta_count== 1)) -+ /*||check_fwstate(pmlmepriv, WIFI_STATION_STATE)*/) -+ { -+ rtw_free_network_nolock(pmlmepriv, pwlan); -+ } -+ -+ if(lock_scanned_queue) -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ pmlmepriv->key_mask = 0; -+ -+ -+ -+} -+ -+/* -+*rtw_indicate_connect: the caller has to lock pmlmepriv->lock -+*/ -+void rtw_indicate_connect(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("+rtw_indicate_connect\n")); -+ -+ pmlmepriv->to_join = false; -+ -+ if(!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) -+ { -+ -+#ifdef CONFIG_SW_ANTENNA_DIVERSITY -+ rtw_hal_set_hwreg(padapter, HW_VAR_ANTENNA_DIVERSITY_LINK, 0); -+#endif -+ -+ set_fwstate(pmlmepriv, _FW_LINKED); -+ -+ rtw_led_control(padapter, LED_CTL_LINK); -+ -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ if(padapter->drvextpriv.enable_wpa) -+ { -+ indicate_l2_connect(padapter); -+ } -+ else -+#endif -+ { -+ rtw_os_indicate_connect(padapter); -+ } -+ -+ } -+ -+ rtw_set_roaming(padapter, 0); -+#ifdef CONFIG_INTEL_WIDI -+ if(padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) -+ { -+ _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_WK, NULL); -+ DBG_871X("change to widi listen\n"); -+ } -+#endif // CONFIG_INTEL_WIDI -+ -+ rtw_set_scan_deny(padapter, 3000); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("-rtw_indicate_connect: fw_state=0x%08x\n", get_fwstate(pmlmepriv))); -+ -+ -+ -+} -+ -+ -+/* -+*rtw_indicate_disconnect: the caller has to lock pmlmepriv->lock -+*/ -+void rtw_indicate_disconnect( _adapter *padapter ) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("+rtw_indicate_disconnect\n")); -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING|WIFI_UNDER_WPS); -+ -+ //DBG_871X("clear wps when %s\n", __func__); -+ -+ if(rtw_to_roaming(padapter) > 0) -+ _clr_fwstate_(pmlmepriv, _FW_LINKED); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ psta = rtw_get_stainfo(pstapriv,cur_network->MacAddress); -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ { -+ rtw_wapi_return_one_sta_info(padapter, psta->hwaddr); -+ } -+ else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || -+ check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) -+ { -+ rtw_wapi_return_all_sta_info(padapter); -+ } -+#endif -+ -+ if(check_fwstate(&padapter->mlmepriv, _FW_LINKED) -+ || (rtw_to_roaming(padapter) <= 0) -+ ) -+ { -+ rtw_os_indicate_disconnect(padapter); -+ -+ //set ips_deny_time to avoid enter IPS before LPS leave -+ padapter->pwrctrlpriv.ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(3000); -+ -+ _clr_fwstate_(pmlmepriv, _FW_LINKED); -+ -+ rtw_led_control(padapter, LED_CTL_NO_LINK); -+ -+ rtw_clear_scan_deny(padapter); -+ -+ } -+ -+#ifdef CONFIG_P2P_PS -+ p2p_ps_wk_cmd(padapter, P2P_PS_DISABLE, 1); -+#endif // CONFIG_P2P_PS -+ -+#ifdef CONFIG_LPS -+#ifdef CONFIG_WOWLAN -+ if(padapter->pwrctrlpriv.wowlan_mode==false) -+#endif //CONFIG_WOWLAN -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, 1); -+#endif -+ -+ -+} -+ -+inline void rtw_indicate_scan_done( _adapter *padapter, bool aborted) -+{ -+ rtw_os_indicate_scan_done(padapter, aborted); -+} -+ -+void rtw_scan_abort(_adapter *adapter) -+{ -+ u32 cnt=0; -+ u32 start; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ -+ start = rtw_get_current_time(); -+ pmlmeext->scan_abort = true; -+ while (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) -+ && rtw_get_passing_time_ms(start) <= 200) { -+ -+ if (adapter->bDriverStopped || adapter->bSurpriseRemoved) -+ break; -+ -+ DBG_871X(FUNC_NDEV_FMT"fw_state=_FW_UNDER_SURVEY!\n", FUNC_NDEV_ARG(adapter->pnetdev)); -+ rtw_msleep_os(20); -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { -+ if (!adapter->bDriverStopped && !adapter->bSurpriseRemoved) -+ DBG_871X(FUNC_NDEV_FMT"waiting for scan_abort time out!\n", FUNC_NDEV_ARG(adapter->pnetdev)); -+ rtw_indicate_scan_done(adapter, true); -+ } -+ pmlmeext->scan_abort = false; -+} -+ -+static struct sta_info *rtw_joinbss_update_stainfo(_adapter *padapter, struct wlan_network *pnetwork) -+{ -+ int i; -+ struct sta_info *bmc_sta, *psta=NULL; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ psta = rtw_get_stainfo(pstapriv, pnetwork->network.MacAddress); -+ if(psta==NULL) { -+ psta = rtw_alloc_stainfo(pstapriv, pnetwork->network.MacAddress); -+ } -+ -+ if(psta) //update ptarget_sta -+ { -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ psta->aid = pnetwork->join_res; -+ -+#if 0 //alloc macid when call rtw_alloc_stainfo(), and release macid when call rtw_free_stainfo() -+#ifdef CONFIG_CONCURRENT_MODE -+ -+ if(PRIMARY_ADAPTER == padapter->adapter_type) -+ psta->mac_id=0; -+ else -+ psta->mac_id=2; -+#else -+ psta->mac_id=0; -+#endif -+#endif //removed -+ //psta->raid = networktype_to_raid(pmlmeext->cur_wireless_mode); -+ psta->raid = rtw_hal_networktype_to_raid(padapter,pmlmeext->cur_wireless_mode); -+ -+ -+ //sta mode -+ rtw_hal_set_odm_var(padapter,HAL_ODM_STA_INFO,psta,true); -+ -+ //security related -+ if(padapter->securitypriv.dot11AuthAlgrthm== dot11AuthAlgrthm_8021X) -+ { -+ padapter->securitypriv.binstallGrpkey=false; -+ padapter->securitypriv.busetkipkey=false; -+ padapter->securitypriv.bgrpkey_handshake=false; -+ -+ psta->ieee8021x_blocked=true; -+ psta->dot118021XPrivacy=padapter->securitypriv.dot11PrivacyAlgrthm; -+ -+ _rtw_memset((u8 *)&psta->dot118021x_UncstKey, 0, sizeof (union Keytype)); -+ -+ _rtw_memset((u8 *)&psta->dot11tkiprxmickey, 0, sizeof (union Keytype)); -+ _rtw_memset((u8 *)&psta->dot11tkiptxmickey, 0, sizeof (union Keytype)); -+ -+ _rtw_memset((u8 *)&psta->dot11txpn, 0, sizeof (union pn48)); -+ _rtw_memset((u8 *)&psta->dot11rxpn, 0, sizeof (union pn48)); -+ } -+ -+ // Commented by Albert 2012/07/21 -+ // When doing the WPS, the wps_ie_len won't equal to 0 -+ // And the Wi-Fi driver shouldn't allow the data packet to be tramsmitted. -+ if ( padapter->securitypriv.wps_ie_len != 0 ) -+ { -+ psta->ieee8021x_blocked=true; -+ padapter->securitypriv.wps_ie_len = 0; -+ } -+ -+ -+ //for A-MPDU Rx reordering buffer control for bmc_sta & sta_info -+ //if A-MPDU Rx is enabled, reseting rx_ordering_ctrl wstart_b(indicate_seq) to default value=0xffff -+ //todo: check if AP can send A-MPDU packets -+ for(i=0; i < 16 ; i++) -+ { -+ //preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = false; -+ preorder_ctrl->indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u \n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq); -+ #endif -+ preorder_ctrl->wend_b= 0xffff; -+ preorder_ctrl->wsize_b = 64;//max_ampdu_sz;//ex. 32(kbytes) -> wsize_b=32 -+ } -+ -+ -+ bmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if(bmc_sta) -+ { -+ for(i=0; i < 16 ; i++) -+ { -+ //preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; -+ preorder_ctrl = &bmc_sta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = false; -+ preorder_ctrl->indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u \n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq); -+ #endif -+ preorder_ctrl->wend_b= 0xffff; -+ preorder_ctrl->wsize_b = 64;//max_ampdu_sz;//ex. 32(kbytes) -> wsize_b=32 -+ } -+ } -+ -+ -+ //misc. -+ update_sta_info(padapter, psta); -+ -+ } -+ -+ return psta; -+ -+} -+ -+//pnetwork : returns from rtw_joinbss_event_callback -+//ptarget_wlan: found from scanned_queue -+static void rtw_joinbss_update_network(_adapter *padapter, struct wlan_network *ptarget_wlan, struct wlan_network *pnetwork) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("\nfw_state:%x, BSSID:"MAC_FMT"\n" -+ ,get_fwstate(pmlmepriv), MAC_ARG(pnetwork->network.MacAddress))); -+ -+ -+ // why not use ptarget_wlan?? -+ _rtw_memcpy(&cur_network->network, &pnetwork->network, pnetwork->network.Length); -+ // some IEs in pnetwork is wrong, so we should use ptarget_wlan IEs -+ cur_network->network.IELength = ptarget_wlan->network.IELength; -+ _rtw_memcpy(&cur_network->network.IEs[0], &ptarget_wlan->network.IEs[0], MAX_IE_SZ); -+ -+ cur_network->aid = pnetwork->join_res; -+ -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ rtw_set_signal_stat_timer(&padapter->recvpriv); -+#endif -+ padapter->recvpriv.signal_strength = ptarget_wlan->network.PhyInfo.SignalStrength; -+ padapter->recvpriv.signal_qual = ptarget_wlan->network.PhyInfo.SignalQuality; -+ //the ptarget_wlan->network.Rssi is raw data, we use ptarget_wlan->network.PhyInfo.SignalStrength instead (has scaled) -+ padapter->recvpriv.rssi = translate_percentage_to_dbm(ptarget_wlan->network.PhyInfo.SignalStrength); -+ #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 -+ DBG_871X("%s signal_strength:%3u, rssi:%3d, signal_qual:%3u" -+ "\n" -+ , __FUNCTION__ -+ , padapter->recvpriv.signal_strength -+ , padapter->recvpriv.rssi -+ , padapter->recvpriv.signal_qual -+ ); -+ #endif -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ rtw_set_signal_stat_timer(&padapter->recvpriv); -+#endif -+ -+ //update fw_state //will clr _FW_UNDER_LINKING here indirectly -+ switch(pnetwork->network.InfrastructureMode) -+ { -+ case Ndis802_11Infrastructure: -+ -+ if(pmlmepriv->fw_state&WIFI_UNDER_WPS) -+ pmlmepriv->fw_state = WIFI_STATION_STATE|WIFI_UNDER_WPS; -+ else -+ pmlmepriv->fw_state = WIFI_STATION_STATE; -+ -+ break; -+ case Ndis802_11IBSS: -+ pmlmepriv->fw_state = WIFI_ADHOC_STATE; -+ break; -+ default: -+ pmlmepriv->fw_state = WIFI_NULL_STATE; -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Invalid network_mode\n")); -+ break; -+ } -+ -+ rtw_update_protection(padapter, (cur_network->network.IEs) + sizeof (NDIS_802_11_FIXED_IEs), -+ (cur_network->network.IELength)); -+ -+#ifdef CONFIG_80211N_HT -+ rtw_update_ht_cap(padapter, cur_network->network.IEs, cur_network->network.IELength, (u8) cur_network->network.Configuration.DSConfig); -+#endif -+} -+ -+//Notes: the fucntion could be > passive_level (the same context as Rx tasklet) -+//pnetwork : returns from rtw_joinbss_event_callback -+//ptarget_wlan: found from scanned_queue -+//if join_res > 0, for (fw_state==WIFI_STATION_STATE), we check if "ptarget_sta" & "ptarget_wlan" exist. -+//if join_res > 0, for (fw_state==WIFI_ADHOC_STATE), we only check if "ptarget_wlan" exist. -+//if join_res > 0, update "cur_network->network" from "pnetwork->network" if (ptarget_wlan !=NULL). -+// -+//#define REJOIN -+void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL,irqL2; -+ static u8 retry=0; -+ u8 timer_cancelled; -+ struct sta_info *ptarget_sta= NULL, *pcur_sta = NULL; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct wlan_network *pnetwork = (struct wlan_network *)pbuf; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wlan_network *pcur_wlan = NULL, *ptarget_wlan = NULL; -+ unsigned int the_same_macaddr = false; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("joinbss event call back received with res=%d\n", pnetwork->join_res)); -+ -+ rtw_get_encrypt_decrypt_from_registrypriv(adapter); -+ -+ -+ if (pmlmepriv->assoc_ssid.SsidLength == 0) -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("@@@@@ joinbss event call back for Any SSid\n")); -+ else -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("@@@@@ rtw_joinbss_event_callback for SSid:%s\n", pmlmepriv->assoc_ssid.Ssid)); -+ -+ the_same_macaddr = _rtw_memcmp(pnetwork->network.MacAddress, cur_network->network.MacAddress, ETH_ALEN); -+ -+ pnetwork->network.Length = get_WLAN_BSSID_EX_sz(&pnetwork->network); -+ if(pnetwork->network.Length > sizeof(WLAN_BSSID_EX)) -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n\n ***joinbss_evt_callback return a wrong bss ***\n\n")); -+ goto ignore_joinbss_callback; -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("\n rtw_joinbss_event_callback !! _enter_critical \n")); -+ -+ if(pnetwork->join_res > 0) -+ { -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ retry = 0; -+ if (check_fwstate(pmlmepriv,_FW_UNDER_LINKING) ) -+ { -+ //s1. find ptarget_wlan -+ if(check_fwstate(pmlmepriv, _FW_LINKED) ) -+ { -+ if(the_same_macaddr == true) -+ { -+ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); -+ } -+ else -+ { -+ pcur_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); -+ if(pcur_wlan) pcur_wlan->fixed = false; -+ -+ pcur_sta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); -+ if(pcur_sta){ -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); -+ rtw_free_stainfo(adapter, pcur_sta); -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); -+ } -+ -+ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->network.MacAddress); -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true){ -+ if(ptarget_wlan) ptarget_wlan->fixed = true; -+ } -+ } -+ -+ } -+ else -+ { -+ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->network.MacAddress); -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true){ -+ if(ptarget_wlan) ptarget_wlan->fixed = true; -+ } -+ } -+ -+ //s2. update cur_network -+ if(ptarget_wlan) -+ { -+ rtw_joinbss_update_network(adapter, ptarget_wlan, pnetwork); -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Can't find ptarget_wlan when joinbss_event callback\n")); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ goto ignore_joinbss_callback; -+ } -+ -+ -+ //s3. find ptarget_sta & update ptarget_sta after update cur_network only for station mode -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) -+ { -+ ptarget_sta = rtw_joinbss_update_stainfo(adapter, pnetwork); -+ if(ptarget_sta==NULL) -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Can't update stainfo when joinbss_event callback\n")); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ goto ignore_joinbss_callback; -+ } -+ } -+ -+ //s4. indicate connect -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) -+ { -+ rtw_indicate_connect(adapter); -+ } -+ else -+ { -+ //adhoc mode will rtw_indicate_connect when rtw_stassoc_event_callback -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("adhoc mode, fw_state:%x", get_fwstate(pmlmepriv))); -+ } -+ -+ -+ //s5. Cancle assoc_timer -+ _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("Cancle assoc_timer \n")); -+ -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("rtw_joinbss_event_callback err: fw_state:%x", get_fwstate(pmlmepriv))); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ goto ignore_joinbss_callback; -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ } -+ else if(pnetwork->join_res == -4) -+ { -+ rtw_reset_securitypriv(adapter); -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ -+ //rtw_free_assoc_resources(adapter, 1); -+ -+ if((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == true) -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("fail! clear _FW_UNDER_LINKING ^^^fw_state=%x\n", get_fwstate(pmlmepriv))); -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ } -+ -+ } -+ else //if join_res < 0 (join fails), then try again -+ { -+ -+ #ifdef REJOIN -+ res = _FAIL; -+ if(retry < 2) { -+ res = rtw_select_and_join_from_scanned_queue(pmlmepriv); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("rtw_select_and_join_from_scanned_queue again! res:%d\n",res)); -+ } -+ -+ if(res == _SUCCESS) -+ { -+ //extend time of assoc_timer -+ _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); -+ retry++; -+ } -+ else if(res == 2)//there is no need to wait for join -+ { -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ rtw_indicate_connect(adapter); -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Set Assoc_Timer = 1; can't find match ssid in scanned_q \n")); -+ #endif -+ -+ _set_timer(&pmlmepriv->assoc_timer, 1); -+ //rtw_free_assoc_resources(adapter, 1); -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+ #ifdef REJOIN -+ retry = 0; -+ } -+ #endif -+ } -+ -+ignore_joinbss_callback: -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+} -+ -+void rtw_joinbss_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ struct wlan_network *pnetwork = (struct wlan_network *)pbuf; -+ -+ -+ -+ mlmeext_joinbss_event_callback(adapter, pnetwork->join_res); -+ -+ rtw_os_xmit_schedule(adapter); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_os_xmit_schedule(adapter->pbuddy_adapter); -+#endif -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ dc_resume_xmit(adapter); -+#endif -+ -+ -+} -+ -+u8 search_max_mac_id(_adapter *padapter) -+{ -+ u8 mac_id, aid; -+#if (RATE_ADAPTIVE_SUPPORT==1) //for 88E RA -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)){ -+ -+#if 1 -+ _irqL irqL; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ -+ _enter_critical_bh(&pdvobj->lock, &irqL); -+ for(mac_id=(NUM_STA-1); mac_id>0; mac_id--) -+ if(pdvobj->macid[mac_id] == true) -+ break; -+ _exit_critical_bh(&pdvobj->lock, &irqL); -+ -+#else -+ for (aid = (pstapriv->max_num_sta); aid > 0; aid--) -+ { -+ if (pstapriv->sta_aid[aid-1] != NULL) -+ { -+ psta = pstapriv->sta_aid[aid-1]; -+ break; -+ } -+ } -+/* -+ for (mac_id = (pstapriv->max_num_sta-1); mac_id >= 0; mac_id--) -+ { -+ if (pstapriv->sta_aid[mac_id] != NULL) -+ break; -+ } -+*/ -+ mac_id = aid + 1; -+#endif -+ } -+ else -+#endif -+ {//adhoc id = 31~2 -+ for (mac_id = (NUM_STA-1); mac_id >= IBSS_START_MAC_ID ; mac_id--) -+ { -+ if (pmlmeinfo->FW_sta_info[mac_id].status == 1) -+ { -+ break; -+ } -+ } -+ } -+#endif -+ -+ DBG_871X("max mac_id=%d\n", mac_id); -+ -+ return mac_id; -+ -+} -+ -+//FOR AP ,AD-HOC mode -+void rtw_stassoc_hw_rpt(_adapter *adapter,struct sta_info *psta) -+{ -+ u16 media_status; -+ -+ if(psta==NULL) return; -+ -+ #if (RATE_ADAPTIVE_SUPPORT==1) //for 88E RA -+ { -+ u8 macid = search_max_mac_id(adapter); -+ rtw_hal_set_hwreg(adapter,HW_VAR_TX_RPT_MAX_MACID, (u8*)&macid); -+ } -+ #endif -+ media_status = (psta->mac_id<<8)|1; // MACID|OPMODE:1 connect -+ rtw_hal_set_hwreg(adapter,HW_VAR_H2C_MEDIA_STATUS_RPT,(u8 *)&media_status); -+} -+ -+void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL; -+ struct sta_info *psta; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct stassoc_event *pstassoc = (struct stassoc_event*)pbuf; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wlan_network *ptarget_wlan = NULL; -+ -+ if(rtw_access_ctrl(adapter, pstassoc->macaddr) == false) -+ return; -+ -+#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); -+ if(psta) { -+#ifdef CONFIG_AUTO_AP_MODE -+ rtw_stassoc_hw_rpt(adapter, psta); -+#else //CONFIG_AUTO_AP_MODE -+#ifdef CONFIG_IOCTL_CFG80211 -+ #ifdef COMPAT_KERNEL_RELEASE -+ -+ #elif (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)) || defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ u8 *passoc_req = NULL; -+ u32 assoc_req_len; -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ if(psta->passoc_req && psta->assoc_req_len>0) -+ { -+ passoc_req = rtw_zmalloc(psta->assoc_req_len); -+ if(passoc_req) -+ { -+ assoc_req_len = psta->assoc_req_len; -+ _rtw_memcpy(passoc_req, psta->passoc_req, assoc_req_len); -+ -+ _rtw_mfree(psta->passoc_req , psta->assoc_req_len); -+ psta->passoc_req = NULL; -+ psta->assoc_req_len = 0; -+ } -+ } -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ if(passoc_req && assoc_req_len>0) -+ { -+ rtw_cfg80211_indicate_sta_assoc(adapter, passoc_req, assoc_req_len); -+ -+ _rtw_mfree(passoc_req, assoc_req_len); -+ } -+ #endif //(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)) || defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ //bss_cap_update_on_sta_join(adapter, psta); -+ //sta_info_update(adapter, psta); -+ ap_sta_info_defer_update(adapter, psta); -+ -+ rtw_stassoc_hw_rpt(adapter,psta); -+#endif //CONFIG_AUTO_AP_MODE -+ } -+ return; -+ } -+#endif -+ //for AD-HOC mode -+ psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); -+ if( psta != NULL) -+ { -+ //the sta have been in sta_info_queue => do nothing -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Error: rtw_stassoc_event_callback: sta has been in sta_hash_queue \n")); -+ -+ return; //(between drv has received this event before and fw have not yet to set key to CAM_ENTRY) -+ } -+ -+ psta = rtw_alloc_stainfo(&adapter->stapriv, pstassoc->macaddr); -+ if (psta == NULL) { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Can't alloc sta_info when rtw_stassoc_event_callback\n")); -+ return; -+ } -+ -+ //to do : init sta_info variable -+ psta->qos_option = 0; -+ psta->mac_id = (uint)pstassoc->cam_id; -+ //psta->aid = (uint)pstassoc->cam_id; -+ DBG_871X("%s\n",__FUNCTION__); -+ //for ad-hoc mode -+ rtw_hal_set_odm_var(adapter,HAL_ODM_STA_INFO,psta,true); -+ -+ rtw_stassoc_hw_rpt(adapter,psta); -+ -+ if(adapter->securitypriv.dot11AuthAlgrthm==dot11AuthAlgrthm_8021X) -+ psta->dot118021XPrivacy = adapter->securitypriv.dot11PrivacyAlgrthm; -+ -+ -+ psta->ieee8021x_blocked = false; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if ( (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)==true ) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==true ) ) -+ { -+ if(adapter->stapriv.asoc_sta_count== 2) -+ { -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); -+ if(ptarget_wlan) ptarget_wlan->fixed = true; -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ // a sta + bc/mc_stainfo (not Ibss_stainfo) -+ rtw_indicate_connect(adapter); -+ } -+ } -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ mlmeext_sta_add_event_callback(adapter, psta); -+} -+ -+void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf) -+{ -+ _irqL irqL,irqL2; -+ int mac_id = (-1); -+ struct sta_info *psta; -+ struct wlan_network* pwlan = NULL; -+ WLAN_BSSID_EX *pdev_network=NULL; -+ u8* pibss = NULL; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct stadel_event *pstadel = (struct stadel_event*)pbuf; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct wlan_network *tgt_network = &(pmlmepriv->cur_network); -+ -+ -+ -+ psta = rtw_get_stainfo(&adapter->stapriv, pstadel->macaddr); -+ if(psta) -+ mac_id = psta->mac_id; -+ else -+ mac_id = pstadel->mac_id; -+ -+ DBG_871X("%s(mac_id=%d)=" MAC_FMT "\n", __func__, mac_id, MAC_ARG(pstadel->macaddr)); -+ -+ if(mac_id>=0){ -+ u16 media_status; -+ media_status = (mac_id<<8)|0; // MACID|OPMODE:0 means disconnect -+ //for STA,AP,ADHOC mode, report disconnect stauts to FW -+ rtw_hal_set_hwreg(adapter, HW_VAR_H2C_MEDIA_STATUS_RPT, (u8 *)&media_status); -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ { -+#ifdef CONFIG_IOCTL_CFG80211 -+ #ifdef COMPAT_KERNEL_RELEASE -+ -+ #elif (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)) || defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ rtw_cfg80211_indicate_sta_disassoc(adapter, pstadel->macaddr, *(u16*)pstadel->rsvd); -+ #endif //(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)) || defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ return; -+ } -+ -+ -+ mlmeext_sta_del_event_callback(adapter); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL2); -+ -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) ) -+ { -+ #ifdef CONFIG_LAYER2_ROAMING -+ if (rtw_to_roaming(adapter) > 0) -+ pmlmepriv->to_roaming--; /* this stadel_event is caused by roaming, decrease to_roaming */ -+ else if (rtw_to_roaming(adapter) == 0) -+ rtw_set_roaming(adapter, adapter->registrypriv.max_roaming_times); -+#ifdef CONFIG_INTEL_WIDI -+ if(adapter->mlmepriv.widi_state != INTEL_WIDI_STATE_CONNECTED) -+#endif // CONFIG_INTEL_WIDI -+ if(*((unsigned short *)(pstadel->rsvd)) != WLAN_REASON_EXPIRATION_CHK) -+ rtw_set_roaming(adapter, 0); /* don't roam */ -+ #endif -+ -+ rtw_free_uc_swdec_pending_queue(adapter); -+ -+ rtw_free_assoc_resources(adapter, 1); -+ rtw_indicate_disconnect(adapter); -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ // remove the network entry in scanned_queue -+ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); -+ if (pwlan) { -+ pwlan->fixed = false; -+ rtw_free_network_nolock(pmlmepriv, pwlan); -+ } -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ #ifdef CONFIG_LAYER2_ROAMING -+ _rtw_roaming(adapter, tgt_network); -+ #else -+#ifdef CONFIG_INTEL_WIDI -+ process_intel_widi_disconnect(adapter, 1); -+#endif // CONFIG_INTEL_WIDI -+ #endif //CONFIG_LAYER2_ROAMING -+ -+ } -+ -+ if ( check_fwstate(pmlmepriv,WIFI_ADHOC_MASTER_STATE) || -+ check_fwstate(pmlmepriv,WIFI_ADHOC_STATE)) -+ { -+ -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(adapter, psta); -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ if(adapter->stapriv.asoc_sta_count== 1) //a sta + bc/mc_stainfo (not Ibss_stainfo) -+ { -+ //rtw_indicate_disconnect(adapter);//removed@20091105 -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ //free old ibss network -+ //pwlan = rtw_find_network(&pmlmepriv->scanned_queue, pstadel->macaddr); -+ pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); -+ if(pwlan) -+ { -+ pwlan->fixed = false; -+ rtw_free_network_nolock(pmlmepriv, pwlan); -+ } -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ //re-create ibss -+ pdev_network = &(adapter->registrypriv.dev_network); -+ pibss = adapter->registrypriv.dev_network.MacAddress; -+ -+ _rtw_memcpy(pdev_network, &tgt_network->network, get_WLAN_BSSID_EX_sz(&tgt_network->network)); -+ -+ _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); -+ -+ rtw_update_registrypriv_dev_network(adapter); -+ -+ rtw_generate_random_ibss(pibss); -+ -+ if(check_fwstate(pmlmepriv,WIFI_ADHOC_STATE)) -+ { -+ set_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -+ _clr_fwstate_(pmlmepriv, WIFI_ADHOC_STATE); -+ } -+ -+ if(rtw_createbss_cmd(adapter)!=_SUCCESS) -+ { -+ -+ RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("***Error=>stadel_event_callback: rtw_createbss_cmd status FAIL*** \n ")); -+ -+ } -+ -+ -+ } -+ -+ } -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL2); -+ -+ -+ -+} -+ -+ -+void rtw_cpwm_event_callback(PADAPTER padapter, u8 *pbuf) -+{ -+#ifdef CONFIG_LPS_LCLK -+ struct reportpwrstate_parm *preportpwrstate; -+#endif -+ -+ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("+rtw_cpwm_event_callback !!!\n")); -+#ifdef CONFIG_LPS_LCLK -+ preportpwrstate = (struct reportpwrstate_parm*)pbuf; -+ preportpwrstate->state |= (u8)(padapter->pwrctrlpriv.cpwm_tog + 0x80); -+ cpwm_int_hdl(padapter, preportpwrstate); -+#endif -+ -+ -+ -+} -+ -+/* -+* _rtw_join_timeout_handler - Timeout/faliure handler for CMD JoinBss -+* @adapter: pointer to _adapter structure -+*/ -+void _rtw_join_timeout_handler (_adapter *adapter) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+#ifdef CONFIG_LAYER2_ROAMING -+ int do_join_r; -+#endif //CONFIG_LAYER2_ROAMING -+ -+#if 0 -+ if (adapter->bDriverStopped == true){ -+ _rtw_up_sema(&pmlmepriv->assoc_terminate); -+ return; -+ } -+#endif -+ -+ -+ -+ -+ DBG_871X("%s, fw_state=%x\n", __FUNCTION__, get_fwstate(pmlmepriv)); -+ -+ if(adapter->bDriverStopped ||adapter->bSurpriseRemoved) -+ return; -+ -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ #ifdef CONFIG_LAYER2_ROAMING -+ if (rtw_to_roaming(adapter) > 0) { /* join timeout caused by roaming */ -+ while(1) { -+ pmlmepriv->to_roaming--; -+ if (rtw_to_roaming(adapter) != 0) { /* try another */ -+ DBG_871X("%s try another roaming\n", __FUNCTION__); -+ if( _SUCCESS!=(do_join_r=rtw_do_join(adapter)) ) { -+ DBG_871X("%s roaming do_join return %d\n", __FUNCTION__ ,do_join_r); -+ continue; -+ } -+ break; -+ } else { -+#ifdef CONFIG_INTEL_WIDI -+ if(adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) -+ { -+ _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); -+ intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL); -+ DBG_871X("change to widi listen\n"); -+ } -+#endif // CONFIG_INTEL_WIDI -+ DBG_871X("%s We've try roaming but fail\n", __FUNCTION__); -+ rtw_indicate_disconnect(adapter); -+ break; -+ } -+ } -+ -+ } else -+ #endif -+ { -+ rtw_indicate_disconnect(adapter); -+ free_scanqueue(pmlmepriv);//??? -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ //indicate disconnect for the case that join_timeout and check_fwstate != FW_LINKED -+ rtw_cfg80211_indicate_disconnect(adapter); -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ } -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+#ifdef CONFIG_DRVEXT_MODULE_WSC -+ drvext_assoc_fail_indicate(&adapter->drvextpriv); -+#endif -+ -+ -+ -+ -+} -+ -+/* -+* rtw_scan_timeout_handler - Timeout/Faliure handler for CMD SiteSurvey -+* @adapter: pointer to _adapter structure -+*/ -+void rtw_scan_timeout_handler (_adapter *adapter) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ DBG_871X(FUNC_ADPT_FMT" fw_state=%x\n", FUNC_ADPT_ARG(adapter), get_fwstate(pmlmepriv)); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ rtw_indicate_scan_done(adapter, true); -+ -+} -+ -+static void rtw_auto_scan_handler(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; -+ -+ //auto site survey per 60sec -+ if(pmlmepriv->scan_interval >0) -+ { -+ pmlmepriv->scan_interval--; -+ if(pmlmepriv->scan_interval==0) -+ { -+/* -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) -+ { -+ DBG_871X("exit %s when _FW_UNDER_SURVEY|_FW_UNDER_LINKING -> \n", __FUNCTION__); -+ return; -+ } -+ -+ if(pmlmepriv->sitesurveyctrl.traffic_busy == true) -+ { -+ DBG_871X("%s exit cause traffic_busy(%x)\n",__FUNCTION__, pmlmepriv->sitesurveyctrl.traffic_busy); -+ return; -+ } -+*/ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (rtw_buddy_adapter_up(padapter)) -+ { -+ if ((check_buddy_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) || -+ (padapter->pbuddy_adapter->mlmepriv.LinkDetectInfo.bBusyTraffic == true)) -+ { -+ DBG_871X("%s, but buddy_intf is under scanning or linking or BusyTraffic\n", __FUNCTION__); -+ return; -+ } -+ } -+#endif -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ rtw_set_802_11_bssid_list_scan(padapter, NULL, 0); -+ -+ pmlmepriv->scan_interval = SCAN_INTERVAL;// 30*2 sec = 60sec -+ -+ } -+ -+ } -+ -+} -+ -+void rtw_dynamic_check_timer_handlder(_adapter *adapter) -+{ -+#ifdef CONFIG_AP_MODE -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+#endif //CONFIG_AP_MODE -+ struct registry_priv *pregistrypriv = &adapter->registrypriv; -+#ifdef CONFIG_CONCURRENT_MODE -+ PADAPTER pbuddy_adapter = adapter->pbuddy_adapter; -+#endif -+ -+ if(!adapter) -+ return; -+ -+ if(adapter->hw_init_completed == false) -+ return; -+ -+ if ((adapter->bDriverStopped == true)||(adapter->bSurpriseRemoved== true)) -+ return; -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(pbuddy_adapter) -+ { -+ if(adapter->net_closed == true && pbuddy_adapter->net_closed == true) -+ { -+ return; -+ } -+ } -+ else -+#endif //CONFIG_CONCURRENT_MODE -+ if(adapter->net_closed == true) -+ { -+ return; -+ } -+ -+ rtw_dynamic_chk_wk_cmd(adapter); -+ -+ if(pregistrypriv->wifi_spec==1) -+ { -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+#endif -+ { -+ //auto site survey -+ rtw_auto_scan_handler(adapter); -+ } -+ } -+ -+#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+#ifdef CONFIG_AP_MODE -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ expire_timeout_chk(adapter); -+ } -+#endif -+#endif //!CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ -+#ifdef CONFIG_BR_EXT -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+ rcu_read_lock(); -+#endif // (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+ -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ if( adapter->pnetdev->br_port -+#else // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ if( rcu_dereference(adapter->pnetdev->rx_handler_data) -+#endif // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ && (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == true) ) -+ { -+ // expire NAT2.5 entry -+ nat25_db_expire(adapter); -+ -+ if (adapter->pppoe_connection_in_progress > 0) { -+ adapter->pppoe_connection_in_progress--; -+ } -+ -+ // due to rtw_dynamic_check_timer_handlder() is called every 2 seconds -+ if (adapter->pppoe_connection_in_progress > 0) { -+ adapter->pppoe_connection_in_progress--; -+ } -+ } -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+ rcu_read_unlock(); -+#endif // (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+ -+#endif // CONFIG_BR_EXT -+ -+} -+ -+ -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+inline bool rtw_is_scan_deny(_adapter *adapter) -+{ -+ struct mlme_priv *mlmepriv = &adapter->mlmepriv; -+ return (ATOMIC_READ(&mlmepriv->set_scan_deny) != 0) ? true : false; -+} -+ -+inline void rtw_clear_scan_deny(_adapter *adapter) -+{ -+ struct mlme_priv *mlmepriv = &adapter->mlmepriv; -+ ATOMIC_SET(&mlmepriv->set_scan_deny, 0); -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+} -+ -+void rtw_set_scan_deny_timer_hdl(_adapter *adapter) -+{ -+ rtw_clear_scan_deny(adapter); -+} -+ -+void rtw_set_scan_deny(_adapter *adapter, u32 ms) -+{ -+ struct mlme_priv *mlmepriv = &adapter->mlmepriv; -+#ifdef CONFIG_CONCURRENT_MODE -+ struct mlme_priv *b_mlmepriv; -+#endif -+ -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); -+ ATOMIC_SET(&mlmepriv->set_scan_deny, 1); -+ _set_timer(&mlmepriv->set_scan_deny_timer, ms); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (!adapter->pbuddy_adapter) -+ return; -+ -+ if (0) -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter->pbuddy_adapter)); -+ b_mlmepriv = &adapter->pbuddy_adapter->mlmepriv; -+ ATOMIC_SET(&b_mlmepriv->set_scan_deny, 1); -+ _set_timer(&b_mlmepriv->set_scan_deny_timer, ms); -+#endif -+ -+} -+#endif -+ -+#if defined(IEEE80211_SCAN_RESULT_EXPIRE) -+#define RTW_SCAN_RESULT_EXPIRE IEEE80211_SCAN_RESULT_EXPIRE/HZ*1000 -1000 //3000 -1000 -+#else -+#define RTW_SCAN_RESULT_EXPIRE 2000 -+#endif -+ -+/* -+* Select a new join candidate from the original @param candidate and @param competitor -+* @return true: candidate is updated -+* @return false: candidate is not updated -+*/ -+static int rtw_check_join_candidate(struct mlme_priv *pmlmepriv -+ , struct wlan_network **candidate, struct wlan_network *competitor) -+{ -+ int updated = false; -+ _adapter *adapter = container_of(pmlmepriv, _adapter, mlmepriv); -+ -+ -+ //check bssid, if needed -+ if(pmlmepriv->assoc_by_bssid==true) { -+ if(_rtw_memcmp(competitor->network.MacAddress, pmlmepriv->assoc_bssid, ETH_ALEN) ==false) -+ goto exit; -+ } -+ -+ //check ssid, if needed -+ if(pmlmepriv->assoc_ssid.Ssid && pmlmepriv->assoc_ssid.SsidLength) { -+ if( competitor->network.Ssid.SsidLength != pmlmepriv->assoc_ssid.SsidLength -+ || _rtw_memcmp(competitor->network.Ssid.Ssid, pmlmepriv->assoc_ssid.Ssid, pmlmepriv->assoc_ssid.SsidLength) == false -+ ) -+ goto exit; -+ } -+ -+ if(rtw_is_desired_network(adapter, competitor) == false) -+ goto exit; -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ if(rtw_to_roaming(adapter) > 0) { -+ if( rtw_get_passing_time_ms((u32)competitor->last_scanned) >= RTW_SCAN_RESULT_EXPIRE -+ || is_same_ess(&competitor->network, &pmlmepriv->cur_network.network) == false -+ ) -+ goto exit; -+ } -+#endif -+ -+ if(*candidate == NULL ||(*candidate)->network.Rssinetwork.Rssi ) -+ { -+ *candidate = competitor; -+ updated = true; -+ } -+ -+ if(updated){ -+ DBG_871X("[by_bssid:%u][assoc_ssid:%s]" -+ #ifdef CONFIG_LAYER2_ROAMING -+ "[to_roaming:%u] " -+ #endif -+ "new candidate: %s("MAC_FMT") rssi:%d\n", -+ pmlmepriv->assoc_by_bssid, -+ pmlmepriv->assoc_ssid.Ssid, -+ #ifdef CONFIG_LAYER2_ROAMING -+ rtw_to_roaming(adapter), -+ #endif -+ (*candidate)->network.Ssid.Ssid, -+ MAC_ARG((*candidate)->network.MacAddress), -+ (int)(*candidate)->network.Rssi -+ ); -+ } -+ -+exit: -+ return updated; -+} -+ -+/* -+Calling context: -+The caller of the sub-routine will be in critical section... -+ -+The caller must hold the following spinlock -+ -+pmlmepriv->lock -+ -+ -+*/ -+ -+int rtw_select_and_join_from_scanned_queue(struct mlme_priv *pmlmepriv ) -+{ -+ _irqL irqL; -+ int ret; -+ _list *phead; -+ _adapter *adapter; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ struct wlan_network *candidate = NULL; -+ u8 bSupportAntDiv = false; -+ -+ -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ phead = get_list_head(queue); -+ adapter = (_adapter *)pmlmepriv->nic_hdl; -+ -+ pmlmepriv->pscanned = get_next( phead ); -+ -+ while (!rtw_end_of_queue_search(phead, pmlmepriv->pscanned)) { -+ -+ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); -+ if(pnetwork==NULL){ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("%s return _FAIL:(pnetwork==NULL)\n", __FUNCTION__)); -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); -+ -+ #if 0 -+ DBG_871X("MacAddress:"MAC_FMT" ssid:%s\n", MAC_ARG(pnetwork->network.MacAddress), pnetwork->network.Ssid.Ssid); -+ #endif -+ -+ rtw_check_join_candidate(pmlmepriv, &candidate, pnetwork); -+ -+ } -+ -+ if(candidate == NULL) { -+ DBG_871X("%s: return _FAIL(candidate == NULL)\n", __FUNCTION__); -+#ifdef CONFIG_WOWLAN -+ _clr_fwstate_(pmlmepriv, _FW_LINKED|_FW_UNDER_LINKING); -+#endif -+ ret = _FAIL; -+ goto exit; -+ } else { -+ DBG_871X("%s: candidate: %s("MAC_FMT", ch:%u)\n", __FUNCTION__, -+ candidate->network.Ssid.Ssid, MAC_ARG(candidate->network.MacAddress), -+ candidate->network.Configuration.DSConfig); -+ } -+ -+ -+ // check for situation of _FW_LINKED -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ { -+ DBG_871X("%s: _FW_LINKED while ask_for_joinbss!!!\n", __FUNCTION__); -+ -+ #if 0 // for WPA/WPA2 authentication, wpa_supplicant will expect authentication from AP, it is needed to reconnect AP... -+ if(is_same_network(&pmlmepriv->cur_network.network, &candidate->network)) -+ { -+ DBG_871X("%s: _FW_LINKED and is same network, it needn't join again\n", __FUNCTION__); -+ -+ rtw_indicate_connect(adapter);//rtw_indicate_connect again -+ -+ ret = 2; -+ goto exit; -+ } -+ else -+ #endif -+ { -+ rtw_disassoc_cmd(adapter, 0, true); -+ rtw_indicate_disconnect(adapter); -+ rtw_free_assoc_resources(adapter, 0); -+ } -+ } -+ -+ #ifdef CONFIG_ANTENNA_DIVERSITY -+ rtw_hal_get_def_var(adapter, HAL_DEF_IS_SUPPORT_ANT_DIV, &(bSupportAntDiv)); -+ if(true == bSupportAntDiv) -+ { -+ u8 CurrentAntenna; -+ rtw_hal_get_def_var(adapter, HAL_DEF_CURRENT_ANTENNA, &(CurrentAntenna)); -+ DBG_871X("#### Opt_Ant_(%s) , cur_Ant(%s)\n", -+ (2==candidate->network.PhyInfo.Optimum_antenna)?"A":"B", -+ (2==CurrentAntenna)?"A":"B" -+ ); -+ } -+ #endif -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ ret = rtw_joinbss_cmd(adapter, candidate); -+ -+exit: -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ return ret; -+} -+ -+sint rtw_set_auth(_adapter * adapter,struct security_priv *psecuritypriv) -+{ -+ struct cmd_obj* pcmd; -+ struct setauth_parm *psetauthparm; -+ struct cmd_priv *pcmdpriv=&(adapter->cmdpriv); -+ sint res=_SUCCESS; -+ -+ pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmd==NULL){ -+ res= _FAIL; //try again -+ goto exit; -+ } -+ -+ psetauthparm=(struct setauth_parm*)rtw_zmalloc(sizeof(struct setauth_parm)); -+ if(psetauthparm==NULL){ -+ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memset(psetauthparm, 0, sizeof(struct setauth_parm)); -+ psetauthparm->mode=(unsigned char)psecuritypriv->dot11AuthAlgrthm; -+ -+ pcmd->cmdcode = _SetAuth_CMD_; -+ pcmd->parmbuf = (unsigned char *)psetauthparm; -+ pcmd->cmdsz = (sizeof(struct setauth_parm)); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ -+ _rtw_init_listhead(&pcmd->list); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("after enqueue set_auth_cmd, auth_mode=%x\n", psecuritypriv->dot11AuthAlgrthm)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ -+ -+ -+ return res; -+ -+} -+ -+ -+sint rtw_set_key(_adapter * adapter,struct security_priv *psecuritypriv,sint keyid, u8 set_tx) -+{ -+ u8 keylen; -+ struct cmd_obj *pcmd; -+ struct setkey_parm *psetkeyparm; -+ struct cmd_priv *pcmdpriv = &(adapter->cmdpriv); -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ sint res=_SUCCESS; -+ -+ -+ -+ pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(pcmd==NULL){ -+ res= _FAIL; //try again -+ goto exit; -+ } -+ psetkeyparm=(struct setkey_parm*)rtw_zmalloc(sizeof(struct setkey_parm)); -+ if(psetkeyparm==NULL){ -+ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memset(psetkeyparm, 0, sizeof(struct setkey_parm)); -+ -+ if(psecuritypriv->dot11AuthAlgrthm ==dot11AuthAlgrthm_8021X){ -+ psetkeyparm->algorithm=(unsigned char)psecuritypriv->dot118021XGrpPrivacy; -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n rtw_set_key: psetkeyparm->algorithm=(unsigned char)psecuritypriv->dot118021XGrpPrivacy=%d \n", psetkeyparm->algorithm)); -+ } -+ else{ -+ psetkeyparm->algorithm=(u8)psecuritypriv->dot11PrivacyAlgrthm; -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n rtw_set_key: psetkeyparm->algorithm=(u8)psecuritypriv->dot11PrivacyAlgrthm=%d \n", psetkeyparm->algorithm)); -+ -+ } -+ psetkeyparm->keyid = (u8)keyid;//0~3 -+ psetkeyparm->set_tx = set_tx; -+ if (is_wep_enc(psetkeyparm->algorithm)) -+ pmlmepriv->key_mask |= BIT(psetkeyparm->keyid); -+ -+#ifdef CONFIG_AUTOSUSPEND -+ if( true == adapter->pwrctrlpriv.bInternalAutoSuspend) -+ { -+ adapter->pwrctrlpriv.wepkeymask = pmlmepriv->key_mask; -+ DBG_871X("....AutoSuspend pwrctrlpriv.wepkeymask(%x)\n",adapter->pwrctrlpriv.wepkeymask); -+ } -+#endif -+ DBG_871X("==> rtw_set_key algorithm(%x),keyid(%x),key_mask(%x)\n",psetkeyparm->algorithm,psetkeyparm->keyid,pmlmepriv->key_mask); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n rtw_set_key: psetkeyparm->algorithm=%d psetkeyparm->keyid=(u8)keyid=%d \n",psetkeyparm->algorithm, keyid)); -+ -+ switch(psetkeyparm->algorithm){ -+ -+ case _WEP40_: -+ keylen=5; -+ _rtw_memcpy(&(psetkeyparm->key[0]), &(psecuritypriv->dot11DefKey[keyid].skey[0]), keylen); -+ break; -+ case _WEP104_: -+ keylen=13; -+ _rtw_memcpy(&(psetkeyparm->key[0]), &(psecuritypriv->dot11DefKey[keyid].skey[0]), keylen); -+ break; -+ case _TKIP_: -+ keylen=16; -+ _rtw_memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); -+ psetkeyparm->grpkey=1; -+ break; -+ case _AES_: -+ keylen=16; -+ _rtw_memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); -+ psetkeyparm->grpkey=1; -+ break; -+ default: -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("\n rtw_set_key:psecuritypriv->dot11PrivacyAlgrthm = %x (must be 1 or 2 or 4 or 5)\n",psecuritypriv->dot11PrivacyAlgrthm)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ -+ pcmd->cmdcode = _SetKey_CMD_; -+ pcmd->parmbuf = (u8 *)psetkeyparm; -+ pcmd->cmdsz = (sizeof(struct setkey_parm)); -+ pcmd->rsp = NULL; -+ pcmd->rspsz = 0; -+ -+ -+ _rtw_init_listhead(&pcmd->list); -+ -+ //_rtw_init_sema(&(pcmd->cmd_sem), 0); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, pcmd); -+ -+exit: -+ -+ return res; -+ -+} -+ -+ -+//adjust IEs for rtw_joinbss_cmd in WMM -+int rtw_restruct_wmm_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len, uint initial_out_len) -+{ -+ unsigned int ielength=0; -+ unsigned int i, j; -+ -+ i = 12; //after the fixed IE -+ while(i=0 :if there is pre-auth key, and return the entry id -+// -+// -+ -+static int SecIsInPMKIDList(_adapter *Adapter, u8 *bssid) -+{ -+ struct security_priv *psecuritypriv=&Adapter->securitypriv; -+ int i=0; -+ -+ do -+ { -+ if( ( psecuritypriv->PMKIDList[i].bUsed ) && -+ ( _rtw_memcmp( psecuritypriv->PMKIDList[i].Bssid, bssid, ETH_ALEN ) == true ) ) -+ { -+ break; -+ } -+ else -+ { -+ i++; -+ //continue; -+ } -+ -+ }while(isecuritypriv; -+ -+ if(ie[13]<=20){ -+ // The RSN IE didn't include the PMK ID, append the PMK information -+ ie[ie_len]=1; -+ ie_len++; -+ ie[ie_len]=0; //PMKID count = 0x0100 -+ ie_len++; -+ _rtw_memcpy( &ie[ie_len], &psecuritypriv->PMKIDList[iEntry].PMKID, 16); -+ -+ ie_len+=16; -+ ie[13]+=18;//PMKID length = 2+16 -+ -+ } -+ return (ie_len); -+ -+} -+sint rtw_restruct_sec_ie(_adapter *adapter,u8 *in_ie, u8 *out_ie, uint in_len) -+{ -+ u8 authmode, securitytype, match; -+ u8 sec_ie[255], uncst_oui[4], bkup_ie[255]; -+ u8 wpa_oui[4]={0x0, 0x50, 0xf2, 0x01}; -+ uint ielength, cnt, remove_cnt; -+ int iEntry; -+ -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ struct security_priv *psecuritypriv=&adapter->securitypriv; -+ uint ndisauthmode=psecuritypriv->ndisauthtype; -+ uint ndissecuritytype = psecuritypriv->ndisencryptstatus; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, -+ ("+rtw_restruct_sec_ie: ndisauthmode=%d ndissecuritytype=%d\n", -+ ndisauthmode, ndissecuritytype)); -+ -+ //copy fixed ie only -+ _rtw_memcpy(out_ie, in_ie,12); -+ ielength=12; -+ if((ndisauthmode==Ndis802_11AuthModeWPA)||(ndisauthmode==Ndis802_11AuthModeWPAPSK)) -+ authmode=_WPA_IE_ID_; -+ if((ndisauthmode==Ndis802_11AuthModeWPA2)||(ndisauthmode==Ndis802_11AuthModeWPA2PSK)) -+ authmode=_WPA2_IE_ID_; -+ -+ if(check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) -+ { -+ _rtw_memcpy(out_ie+ielength, psecuritypriv->wps_ie, psecuritypriv->wps_ie_len); -+ -+ ielength += psecuritypriv->wps_ie_len; -+ } -+ else if((authmode==_WPA_IE_ID_)||(authmode==_WPA2_IE_ID_)) -+ { -+ //copy RSN or SSN -+ _rtw_memcpy(&out_ie[ielength], &psecuritypriv->supplicant_ie[0], psecuritypriv->supplicant_ie[1]+2); -+ ielength+=psecuritypriv->supplicant_ie[1]+2; -+ rtw_report_sec_ie(adapter, authmode, psecuritypriv->supplicant_ie); -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ drvext_report_sec_ie(&adapter->drvextpriv, authmode, sec_ie); -+#endif -+ } -+ -+ iEntry = SecIsInPMKIDList(adapter, pmlmepriv->assoc_bssid); -+ if(iEntry<0) -+ { -+ return ielength; -+ } -+ else -+ { -+ if(authmode == _WPA2_IE_ID_) -+ { -+ ielength=rtw_append_pmkid(adapter, iEntry, out_ie, ielength); -+ } -+ } -+ -+ -+ -+ return ielength; -+} -+ -+void rtw_init_registrypriv_dev_network( _adapter* adapter) -+{ -+ struct registry_priv* pregistrypriv = &adapter->registrypriv; -+ struct eeprom_priv* peepriv = &adapter->eeprompriv; -+ WLAN_BSSID_EX *pdev_network = &pregistrypriv->dev_network; -+ u8 *myhwaddr = myid(peepriv); -+ -+ -+ -+ _rtw_memcpy(pdev_network->MacAddress, myhwaddr, ETH_ALEN); -+ -+ _rtw_memcpy(&pdev_network->Ssid, &pregistrypriv->ssid, sizeof(NDIS_802_11_SSID)); -+ -+ pdev_network->Configuration.Length=sizeof(NDIS_802_11_CONFIGURATION); -+ pdev_network->Configuration.BeaconPeriod = 100; -+ pdev_network->Configuration.FHConfig.Length = 0; -+ pdev_network->Configuration.FHConfig.HopPattern = 0; -+ pdev_network->Configuration.FHConfig.HopSet = 0; -+ pdev_network->Configuration.FHConfig.DwellTime = 0; -+ -+ -+ -+ -+} -+ -+void rtw_update_registrypriv_dev_network(_adapter* adapter) -+{ -+ int sz=0; -+ struct registry_priv* pregistrypriv = &adapter->registrypriv; -+ WLAN_BSSID_EX *pdev_network = &pregistrypriv->dev_network; -+ struct security_priv* psecuritypriv = &adapter->securitypriv; -+ struct wlan_network *cur_network = &adapter->mlmepriv.cur_network; -+ //struct xmit_priv *pxmitpriv = &adapter->xmitpriv; -+ -+ -+ -+#if 0 -+ pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense; -+ pxmitpriv->vcs = pregistrypriv->vcs_type; -+ pxmitpriv->vcs_type = pregistrypriv->vcs_type; -+ //pxmitpriv->rts_thresh = pregistrypriv->rts_thresh; -+ pxmitpriv->frag_len = pregistrypriv->frag_thresh; -+ -+ adapter->qospriv.qos_option = pregistrypriv->wmm_enable; -+#endif -+ -+ pdev_network->Privacy = (psecuritypriv->dot11PrivacyAlgrthm > 0 ? 1 : 0) ; // adhoc no 802.1x -+ -+ pdev_network->Rssi = 0; -+ -+ switch(pregistrypriv->wireless_mode) -+ { -+ case WIRELESS_11B: -+ pdev_network->NetworkTypeInUse = (Ndis802_11DS); -+ break; -+ case WIRELESS_11G: -+ case WIRELESS_11BG: -+ case WIRELESS_11_24N: -+ case WIRELESS_11G_24N: -+ case WIRELESS_11BG_24N: -+ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM24); -+ break; -+ case WIRELESS_11A: -+ case WIRELESS_11A_5N: -+ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM5); -+ break; -+ case WIRELESS_11ABGN: -+ if(pregistrypriv->channel > 14) -+ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM5); -+ else -+ pdev_network->NetworkTypeInUse = (Ndis802_11OFDM24); -+ break; -+ default : -+ // TODO -+ break; -+ } -+ -+ pdev_network->Configuration.DSConfig = (pregistrypriv->channel); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("pregistrypriv->channel=%d, pdev_network->Configuration.DSConfig=0x%x\n", pregistrypriv->channel, pdev_network->Configuration.DSConfig)); -+ -+ if(cur_network->network.InfrastructureMode == Ndis802_11IBSS) -+ pdev_network->Configuration.ATIMWindow = (0); -+ -+ pdev_network->InfrastructureMode = (cur_network->network.InfrastructureMode); -+ -+ // 1. Supported rates -+ // 2. IE -+ -+ //rtw_set_supported_rate(pdev_network->SupportedRates, pregistrypriv->wireless_mode) ; // will be called in rtw_generate_ie -+ sz = rtw_generate_ie(pregistrypriv); -+ -+ pdev_network->IELength = sz; -+ -+ pdev_network->Length = get_WLAN_BSSID_EX_sz((WLAN_BSSID_EX *)pdev_network); -+ -+ //notes: translate IELength & Length after assign the Length to cmdsz in createbss_cmd(); -+ //pdev_network->IELength = cpu_to_le32(sz); -+ -+ -+ -+} -+ -+void rtw_get_encrypt_decrypt_from_registrypriv(_adapter* adapter) -+{ -+ -+ -+ -+ -+ -+} -+ -+//the fucntion is at passive_level -+void rtw_joinbss_reset(_adapter *padapter) -+{ -+ u8 threshold; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+#ifdef CONFIG_80211N_HT -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+#endif -+ -+ //todo: if you want to do something io/reg/hw setting before join_bss, please add code here -+ -+ -+ -+ -+#ifdef CONFIG_80211N_HT -+ -+ pmlmepriv->num_FortyMHzIntolerant = 0; -+ -+ pmlmepriv->num_sta_no_ht = 0; -+ -+ phtpriv->ampdu_enable = false;//reset to disabled -+ -+ // TH=1 => means that invalidate usb rx aggregation -+ // TH=0 => means that validate usb rx aggregation, use init value. -+ if(phtpriv->ht_option) -+ { -+ if(padapter->registrypriv.wifi_spec==1) -+ threshold = 1; -+ else -+ threshold = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); -+ } -+ else -+ { -+ threshold = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); -+ } -+ -+#endif -+ -+} -+ -+ -+#ifdef CONFIG_80211N_HT -+ -+//the fucntion is >= passive_level -+unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len) -+{ -+ u32 ielen, out_len; -+ HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor; -+ unsigned char *p, *pframe; -+ struct rtw_ieee80211_ht_cap ht_capie; -+ unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01, 0x00}; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv= &pmlmepriv->qospriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ -+ -+ phtpriv->ht_option = false; -+ -+ p = rtw_get_ie(in_ie+12, _HT_CAPABILITY_IE_, &ielen, in_len-12); -+ -+ if(p && ielen>0) -+ { -+ if(pqospriv->qos_option == 0) -+ { -+ out_len = *pout_len; -+ pframe = rtw_set_ie(out_ie+out_len, _VENDOR_SPECIFIC_IE_, -+ _WMM_IE_Length_, WMM_IE, pout_len); -+ -+ pqospriv->qos_option = 1; -+ } -+ -+ out_len = *pout_len; -+ -+ _rtw_memset(&ht_capie, 0, sizeof(struct rtw_ieee80211_ht_cap)); -+ -+ ht_capie.cap_info = IEEE80211_HT_CAP_SUP_WIDTH |IEEE80211_HT_CAP_SGI_20 | -+ IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_TX_STBC | -+ IEEE80211_HT_CAP_DSSSCCK40; -+ -+ -+ { -+ u32 rx_packet_offset, max_recvbuf_sz; -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_PACKET_OFFSET, &rx_packet_offset); -+ rtw_hal_get_def_var(padapter, HAL_DEF_MAX_RECVBUF_SZ, &max_recvbuf_sz); -+ //if(max_recvbuf_sz-rx_packet_offset>(8191-256)) { -+ // DBG_871X("%s IEEE80211_HT_CAP_MAX_AMSDU is set\n", __FUNCTION__); -+ // ht_capie.cap_info = ht_capie.cap_info |IEEE80211_HT_CAP_MAX_AMSDU; -+ //} -+ } -+ /* -+ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k -+ AMPDU_para [4:2]:Min MPDU Start Spacing -+ */ -+ -+ rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); -+ ht_capie.ampdu_params_info = (max_rx_ampdu_factor&0x03); -+ -+ if(padapter->securitypriv.dot11PrivacyAlgrthm == _AES_ ) -+ ht_capie.ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&(0x07<<2)); -+ else -+ ht_capie.ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&0x00); -+ -+ -+ pframe = rtw_set_ie(out_ie+out_len, _HT_CAPABILITY_IE_, -+ sizeof(struct rtw_ieee80211_ht_cap), (unsigned char*)&ht_capie, pout_len); -+ -+ phtpriv->ht_option = true; -+ -+ p = rtw_get_ie(in_ie+12, _HT_ADD_INFO_IE_, &ielen, in_len-12); -+ if(p && (ielen==sizeof(struct ieee80211_ht_addt_info))) -+ { -+ out_len = *pout_len; -+ pframe = rtw_set_ie(out_ie+out_len, _HT_ADD_INFO_IE_, ielen, p+2 , pout_len); -+ } -+ -+ } -+ -+ return (phtpriv->ht_option); -+ -+} -+ -+//the fucntion is > passive_level (in critical_section) -+void rtw_update_ht_cap(_adapter *padapter, u8 *pie, uint ie_len, u8 channel) -+{ -+ u8 *p, max_ampdu_sz; -+ int len; -+ //struct sta_info *bmc_sta, *psta; -+ struct rtw_ieee80211_ht_cap *pht_capie; -+ struct ieee80211_ht_addt_info *pht_addtinfo; -+ //struct recv_reorder_ctrl *preorder_ctrl; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ //struct recv_priv *precvpriv = &padapter->recvpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ //struct wlan_network *pcur_network = &(pmlmepriv->cur_network);; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 cbw40_enable=0; -+ -+ -+ if(!phtpriv->ht_option) -+ return; -+ -+ if ((!pmlmeinfo->HT_info_enable) || (!pmlmeinfo->HT_caps_enable)) -+ return; -+ -+ DBG_871X("+rtw_update_ht_cap()\n"); -+ -+ //maybe needs check if ap supports rx ampdu. -+ if((phtpriv->ampdu_enable==false) &&(pregistrypriv->ampdu_enable==1)) -+ { -+ if(pregistrypriv->wifi_spec==1) -+ { -+ phtpriv->ampdu_enable = false; -+ } -+ else -+ { -+ phtpriv->ampdu_enable = true; -+ } -+ } -+ else if(pregistrypriv->ampdu_enable==2) -+ { -+ phtpriv->ampdu_enable = true; -+ } -+ -+ -+ //check Max Rx A-MPDU Size -+ len = 0; -+ p = rtw_get_ie(pie+sizeof (NDIS_802_11_FIXED_IEs), _HT_CAPABILITY_IE_, &len, ie_len-sizeof (NDIS_802_11_FIXED_IEs)); -+ if(p && len>0) -+ { -+ pht_capie = (struct rtw_ieee80211_ht_cap *)(p+2); -+ max_ampdu_sz = (pht_capie->ampdu_params_info & IEEE80211_HT_CAP_AMPDU_FACTOR); -+ max_ampdu_sz = 1 << (max_ampdu_sz+3); // max_ampdu_sz (kbytes); -+ -+ //DBG_871X("rtw_update_ht_cap(): max_ampdu_sz=%d\n", max_ampdu_sz); -+ phtpriv->rx_ampdu_maxlen = max_ampdu_sz; -+ -+ } -+ -+ -+ len=0; -+ p = rtw_get_ie(pie+sizeof (NDIS_802_11_FIXED_IEs), _HT_ADD_INFO_IE_, &len, ie_len-sizeof (NDIS_802_11_FIXED_IEs)); -+ if(p && len>0) -+ { -+ pht_addtinfo = (struct ieee80211_ht_addt_info *)(p+2); -+ //todo: -+ } -+ -+ if (channel > 14) { -+ if ((pregistrypriv->bw_mode & 0xf0) > 0) -+ cbw40_enable = 1; -+ } else { -+ if ((pregistrypriv->bw_mode & 0x0f) > 0) -+ cbw40_enable = 1; -+ } -+ -+ //update cur_bwmode & cur_ch_offset -+ if ((cbw40_enable) && -+ (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & BIT(1)) && -+ (pmlmeinfo->HT_info.infos[0] & BIT(2))) -+ { -+ int i; -+ u8 rf_type; -+ -+ padapter->HalFunc.GetHwRegHandler(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ //update the MCS rates -+ for (i = 0; i < 16; i++) -+ { -+ if((rf_type == RF_1T1R) || (rf_type == RF_1T2R)) -+ { -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; -+ } -+ else -+ { -+ #ifdef CONFIG_DISABLE_MCS13TO15 -+ if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && pregistrypriv->wifi_spec != 1 ) -+ { -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R_MCS13TO15_OFF[i]; -+ } -+ else -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R[i]; -+ #else -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R[i]; -+ #endif //CONFIG_DISABLE_MCS13TO15 -+ } -+ #ifdef RTL8192C_RECONFIG_TO_1T1R -+ { -+ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; -+ } -+ #endif -+ } -+ //switch to the 40M Hz mode accoring to the AP -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; -+ switch ((pmlmeinfo->HT_info.infos[0] & 0x3)) -+ { -+ case EXTCHNL_OFFSET_UPPER: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case EXTCHNL_OFFSET_LOWER: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ } -+ -+ // -+ // Config SM Power Save setting -+ // -+ pmlmeinfo->SM_PS = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & 0x0C) >> 2; -+ if(pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) -+ { -+ /*u8 i; -+ //update the MCS rates -+ for (i = 0; i < 16; i++) -+ { -+ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; -+ }*/ -+ DBG_871X("%s(): WLAN_HT_CAP_SM_PS_STATIC\n",__FUNCTION__); -+ } -+ -+ // -+ // Config current HT Protection mode. -+ // -+ pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; -+ -+ -+ -+#if 0 //move to rtw_update_sta_info_client() -+ //for A-MPDU Rx reordering buffer control for bmc_sta & sta_info -+ //if A-MPDU Rx is enabled, reseting rx_ordering_ctrl wstart_b(indicate_seq) to default value=0xffff -+ //todo: check if AP can send A-MPDU packets -+ bmc_sta = rtw_get_bcmc_stainfo(padapter); -+ if(bmc_sta) -+ { -+ for(i=0; i < 16 ; i++) -+ { -+ //preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; -+ preorder_ctrl = &bmc_sta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = false; -+ preorder_ctrl->indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u \n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq); -+ #endif -+ preorder_ctrl->wend_b= 0xffff; -+ preorder_ctrl->wsize_b = 64;//max_ampdu_sz;//ex. 32(kbytes) -> wsize_b=32 -+ } -+ } -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, pcur_network->network.MacAddress); -+ if(psta) -+ { -+ for(i=0; i < 16 ; i++) -+ { -+ //preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ preorder_ctrl->enable = false; -+ preorder_ctrl->indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u \n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq); -+ #endif -+ preorder_ctrl->wend_b= 0xffff; -+ preorder_ctrl->wsize_b = 64;//max_ampdu_sz;//ex. 32(kbytes) -> wsize_b=32 -+ } -+ } -+#endif -+ -+} -+ -+void rtw_issue_addbareq_cmd(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ u8 issued; -+ int priority; -+ struct sta_info *psta=NULL; -+ struct ht_priv *phtpriv; -+ struct pkt_attrib *pattrib =&pxmitframe->attrib; -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ -+ //if(bmcst || (padapter->mlmepriv.LinkDetectInfo.bTxBusyTraffic == false)) -+ if(bmcst || (padapter->mlmepriv.LinkDetectInfo.NumTxOkInPeriod<100)) -+ return; -+ -+ priority = pattrib->priority; -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if(pattrib->psta != psta) -+ { -+ DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return; -+ } -+ -+ if(psta==NULL) -+ { -+ DBG_871X("%s, psta==NUL\n", __func__); -+ return; -+ } -+ -+ if(!(psta->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return; -+ } -+ -+ -+ phtpriv = &psta->htpriv; -+ -+ if((phtpriv->ht_option==true) && (phtpriv->ampdu_enable==true)) -+ { -+ issued = (phtpriv->agg_enable_bitmap>>priority)&0x1; -+ issued |= (phtpriv->candidate_tid_bitmap>>priority)&0x1; -+ -+ if(0==issued) -+ { -+ DBG_871X("rtw_issue_addbareq_cmd, p=%d\n", priority); -+ psta->htpriv.candidate_tid_bitmap |= BIT((u8)priority); -+ rtw_addbareq_cmd(padapter,(u8) priority, pattrib->ra); -+ } -+ } -+ -+} -+ -+#endif -+ -+#ifdef CONFIG_LAYER2_ROAMING -+inline void rtw_set_roaming(_adapter *adapter, u8 to_roaming) -+{ -+ if (to_roaming == 0) -+ adapter->mlmepriv.to_join = false; -+ adapter->mlmepriv.to_roaming = to_roaming; -+} -+ -+inline u8 rtw_to_roaming(_adapter *adapter) -+{ -+ return adapter->mlmepriv.to_roaming; -+} -+ -+void rtw_roaming(_adapter *padapter, struct wlan_network *tgt_network) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ _rtw_roaming(padapter, tgt_network); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+void _rtw_roaming(_adapter *padapter, struct wlan_network *tgt_network) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ int do_join_r; -+ -+ struct wlan_network *pnetwork; -+ -+ if(tgt_network != NULL) -+ pnetwork = tgt_network; -+ else -+ pnetwork = &pmlmepriv->cur_network; -+ -+ if(0 < rtw_to_roaming(padapter)) { -+ DBG_871X("roaming from %s("MAC_FMT"), length:%d\n", -+ pnetwork->network.Ssid.Ssid, MAC_ARG(pnetwork->network.MacAddress), -+ pnetwork->network.Ssid.SsidLength); -+ _rtw_memcpy(&pmlmepriv->assoc_ssid, &pnetwork->network.Ssid, sizeof(NDIS_802_11_SSID)); -+ -+ pmlmepriv->assoc_by_bssid = false; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_return_all_sta_info(padapter); -+#endif -+ -+ while(1) { -+ if( _SUCCESS==(do_join_r=rtw_do_join(padapter)) ) { -+ break; -+ } else { -+ DBG_871X("roaming do_join return %d\n", do_join_r); -+ pmlmepriv->to_roaming--; -+ -+ if(0< rtw_to_roaming(padapter)) { -+ continue; -+ } else { -+ DBG_871X("%s(%d) -to roaming fail, indicate_disconnect\n", __FUNCTION__,__LINE__); -+ rtw_indicate_disconnect(padapter); -+ break; -+ } -+ } -+ } -+ } -+ -+} -+#endif -+ -+sint rtw_linked_check(_adapter *padapter) -+{ -+ if( (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == true) || -+ (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE) == true)) -+ { -+ if(padapter->stapriv.asoc_sta_count > 2) -+ return true; -+ } -+ else -+ { //Station mode -+ if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)== true) -+ return true; -+ } -+ return false; -+} -+ -+#ifdef CONFIG_CONCURRENT_MODE -+sint rtw_buddy_adapter_up(_adapter *padapter) -+{ -+ sint res = false; -+ -+ if(padapter == NULL) -+ return res; -+ -+ -+ if(padapter->pbuddy_adapter == NULL) -+ { -+ res = false; -+ } -+ else if( (padapter->pbuddy_adapter->bDriverStopped) || (padapter->pbuddy_adapter->bSurpriseRemoved) || -+ (padapter->pbuddy_adapter->bup == false) || (padapter->pbuddy_adapter->hw_init_completed == false)) -+ { -+ res = false; -+ } -+ else -+ { -+ res = true; -+ } -+ -+ return res; -+ -+} -+ -+sint check_buddy_fwstate(_adapter *padapter, sint state) -+{ -+ if(padapter == NULL) -+ return false; -+ -+ if(padapter->pbuddy_adapter == NULL) -+ return false; -+ -+ if ((state == WIFI_FW_NULL_STATE) && -+ (padapter->pbuddy_adapter->mlmepriv.fw_state == WIFI_FW_NULL_STATE)) -+ return true; -+ -+ if (padapter->pbuddy_adapter->mlmepriv.fw_state & state) -+ return true; -+ -+ return false; -+} -+ -+#endif //CONFIG_CONCURRENT_MODE -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_mlme_ext.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mlme_ext.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_mlme_ext.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mlme_ext.c 2018-02-06 17:42:30.697966972 +0200 -@@ -0,0 +1,13271 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_MLME_EXT_C_ -+ -+#include -+#include "rtw_mlme.h" -+ -+static struct mlme_handler mlme_sta_tbl[]={ -+ {WIFI_ASSOCREQ, "OnAssocReq", &OnAssocReq}, -+ {WIFI_ASSOCRSP, "OnAssocRsp", &OnAssocRsp}, -+ {WIFI_REASSOCREQ, "OnReAssocReq", &OnAssocReq}, -+ {WIFI_REASSOCRSP, "OnReAssocRsp", &OnAssocRsp}, -+ {WIFI_PROBEREQ, "OnProbeReq", &OnProbeReq}, -+ {WIFI_PROBERSP, "OnProbeRsp", &OnProbeRsp}, -+ -+ /*---------------------------------------------------------- -+ below 2 are reserved -+ -----------------------------------------------------------*/ -+ {0, "DoReserved", &DoReserved}, -+ {0, "DoReserved", &DoReserved}, -+ {WIFI_BEACON, "OnBeacon", &OnBeacon}, -+ {WIFI_ATIM, "OnATIM", &OnAtim}, -+ {WIFI_DISASSOC, "OnDisassoc", &OnDisassoc}, -+ {WIFI_AUTH, "OnAuth", &OnAuthClient}, -+ {WIFI_DEAUTH, "OnDeAuth", &OnDeAuth}, -+ {WIFI_ACTION, "OnAction", &OnAction}, -+}; -+ -+#ifdef _CONFIG_NATIVEAP_MLME_ -+struct mlme_handler mlme_ap_tbl[]={ -+ {WIFI_ASSOCREQ, "OnAssocReq", &OnAssocReq}, -+ {WIFI_ASSOCRSP, "OnAssocRsp", &OnAssocRsp}, -+ {WIFI_REASSOCREQ, "OnReAssocReq", &OnAssocReq}, -+ {WIFI_REASSOCRSP, "OnReAssocRsp", &OnAssocRsp}, -+ {WIFI_PROBEREQ, "OnProbeReq", &OnProbeReq}, -+ {WIFI_PROBERSP, "OnProbeRsp", &OnProbeRsp}, -+ -+ /*---------------------------------------------------------- -+ below 2 are reserved -+ -----------------------------------------------------------*/ -+ {0, "DoReserved", &DoReserved}, -+ {0, "DoReserved", &DoReserved}, -+ {WIFI_BEACON, "OnBeacon", &OnBeacon}, -+ {WIFI_ATIM, "OnATIM", &OnAtim}, -+ {WIFI_DISASSOC, "OnDisassoc", &OnDisassoc}, -+ {WIFI_AUTH, "OnAuth", &OnAuth}, -+ {WIFI_DEAUTH, "OnDeAuth", &OnDeAuth}, -+ {WIFI_ACTION, "OnAction", &OnAction}, -+}; -+#endif -+ -+static struct action_handler OnAction_tbl[]={ -+ {RTW_WLAN_CATEGORY_SPECTRUM_MGMT, "ACTION_SPECTRUM_MGMT", on_action_spct}, -+ {RTW_WLAN_CATEGORY_QOS, "ACTION_QOS", &OnAction_qos}, -+ {RTW_WLAN_CATEGORY_DLS, "ACTION_DLS", &OnAction_dls}, -+ {RTW_WLAN_CATEGORY_BACK, "ACTION_BACK", &OnAction_back}, -+ {RTW_WLAN_CATEGORY_PUBLIC, "ACTION_PUBLIC", on_action_public}, -+ {RTW_WLAN_CATEGORY_RADIO_MEASUREMENT, "ACTION_RADIO_MEASUREMENT", &DoReserved}, -+ {RTW_WLAN_CATEGORY_FT, "ACTION_FT", &DoReserved}, -+ {RTW_WLAN_CATEGORY_HT, "ACTION_HT", &OnAction_ht}, -+ {RTW_WLAN_CATEGORY_SA_QUERY, "ACTION_SA_QUERY", &DoReserved}, -+ {RTW_WLAN_CATEGORY_WMM, "ACTION_WMM", &OnAction_wmm}, -+ {RTW_WLAN_CATEGORY_P2P, "ACTION_P2P", &OnAction_p2p}, -+}; -+ -+ -+static u8 null_addr[ETH_ALEN]= {0,0,0,0,0,0}; -+ -+/************************************************** -+OUI definitions for the vendor specific IE -+***************************************************/ -+unsigned char RTW_WPA_OUI[] = {0x00, 0x50, 0xf2, 0x01}; -+unsigned char WMM_OUI[] = {0x00, 0x50, 0xf2, 0x02}; -+unsigned char WPS_OUI[] = {0x00, 0x50, 0xf2, 0x04}; -+unsigned char P2P_OUI[] = {0x50,0x6F,0x9A,0x09}; -+unsigned char WFD_OUI[] = {0x50,0x6F,0x9A,0x0A}; -+ -+unsigned char WMM_INFO_OUI[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01}; -+unsigned char WMM_PARA_OUI[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; -+ -+unsigned char WPA_TKIP_CIPHER[4] = {0x00, 0x50, 0xf2, 0x02}; -+unsigned char RSN_TKIP_CIPHER[4] = {0x00, 0x0f, 0xac, 0x02}; -+ -+static unsigned char REALTEK_96B_IE[] = {0x00, 0xe0, 0x4c, 0x02, 0x01, 0x20}; -+ -+/******************************************************** -+MCS rate definitions -+*********************************************************/ -+#ifdef CONFIG_DISABLE_MCS13TO15 -+unsigned char MCS_rate_2R_MCS13TO15_OFF[16] = {0xff, 0x1f, 0x0, 0x0, 0x01, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; -+unsigned char MCS_rate_2R[16] = {0xff, 0xff, 0x0, 0x0, 0x01, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; -+#else //CONFIG_DISABLE_MCS13TO15 -+unsigned char MCS_rate_2R[16] = {0xff, 0xff, 0x0, 0x0, 0x01, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; -+#endif //CONFIG_DISABLE_MCS13TO15 -+unsigned char MCS_rate_1R[16] = {0xff, 0x00, 0x0, 0x0, 0x01, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; -+ -+/******************************************************** -+ChannelPlan definitions -+*********************************************************/ -+/*static RT_CHANNEL_PLAN DefaultChannelPlan[RT_CHANNEL_DOMAIN_MAX] = { -+ {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,52,56,60,64,100,104,108,112,116,132,136,140,149,153,157,161,165},32}, // 0x00, RT_CHANNEL_DOMAIN_FCC -+ {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165},31}, // 0x01, RT_CHANNEL_DOMAIN_IC -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140},32}, // 0x02, RT_CHANNEL_DOMAIN_ETSI -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x03, RT_CHANNEL_DOMAIN_SPAIN -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x04, RT_CHANNEL_DOMAIN_FRANCE -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x05, RT_CHANNEL_DOMAIN_MKK -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x06, RT_CHANNEL_DOMAIN_MKK1 -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64},21}, // 0x07, RT_CHANNEL_DOMAIN_ISRAEL -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,40,44,48,52,56,60,64},22}, // 0x08, RT_CHANNEL_DOMAIN_TELEC -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13,14},14}, // 0x09, RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x0A, RT_CHANNEL_DOMAIN_WORLD_WIDE_13 -+ {{1,2,3,4,5,6,7,8,9,10,11,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165},26}, // 0x0B, RT_CHANNEL_DOMAIN_TAIWAN -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13,149,153,157,161,165},18}, // 0x0C, RT_CHANNEL_DOMAIN_CHINA -+ {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,52,56,60,64,149,153,157,161,165},24}, // 0x0D, RT_CHANNEL_DOMAIN_SINGAPORE_INDIA_MEXICO -+ {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165},31}, // 0x0E, RT_CHANNEL_DOMAIN_KOREA -+ {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,52,56,60,64},19}, // 0x0F, RT_CHANNEL_DOMAIN_TURKEY -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140},32}, // 0x10, RT_CHANNEL_DOMAIN_JAPAN -+ {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,149,153,157,161,165},20}, // 0x11, RT_CHANNEL_DOMAIN_FCC_NO_DFS -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48},17}, // 0x12, RT_CHANNEL_DOMAIN_JAPAN_NO_DFS -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165},37}, // 0x13, RT_CHANNEL_DOMAIN_WORLD_WIDE_5G -+ {{1,2,3,4,5,6,7,8,9,10,11,56,60,64,149,153,157,161,165},19}, // 0x14, RT_CHANNEL_DOMAIN_TAIWAN_NO_DFS -+};*/ -+ -+static RT_CHANNEL_PLAN_2G RTW_ChannelPlan2G[RT_CHANNEL_DOMAIN_2G_MAX] = { -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x00, RT_CHANNEL_DOMAIN_2G_WORLD , Passive scan CH 12, 13 -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13},13}, // 0x01, RT_CHANNEL_DOMAIN_2G_ETSI1 -+ {{1,2,3,4,5,6,7,8,9,10,11},11}, // 0x02, RT_CHANNEL_DOMAIN_2G_FCC1 -+ {{1,2,3,4,5,6,7,8,9,10,11,12,13,14},14}, // 0x03, RT_CHANNEL_DOMAIN_2G_MIKK1 -+ {{10,11,12,13},4}, // 0x04, RT_CHANNEL_DOMAIN_2G_ETSI2 -+ {{},0}, // 0x05, RT_CHANNEL_DOMAIN_2G_NULL -+}; -+ -+static RT_CHANNEL_PLAN_5G RTW_ChannelPlan5G[RT_CHANNEL_DOMAIN_5G_MAX] = { -+ {{},0}, // 0x00, RT_CHANNEL_DOMAIN_5G_NULL -+ {{36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140},19}, // 0x01, RT_CHANNEL_DOMAIN_5G_ETSI1 -+ {{36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165},24}, // 0x02, RT_CHANNEL_DOMAIN_5G_ETSI2 -+ {{36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165},22}, // 0x03, RT_CHANNEL_DOMAIN_5G_ETSI3 -+ {{36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165},24}, // 0x04, RT_CHANNEL_DOMAIN_5G_FCC1 -+ {{36,40,44,48,149,153,157,161,165},9}, // 0x05, RT_CHANNEL_DOMAIN_5G_FCC2 -+ {{36,40,44,48,52,56,60,64,149,153,157,161,165},13}, // 0x06, RT_CHANNEL_DOMAIN_5G_FCC3 -+ {{36,40,44,48,52,56,60,64,149,153,157,161},12}, // 0x07, RT_CHANNEL_DOMAIN_5G_FCC4 -+ {{149,153,157,161,165},5}, // 0x08, RT_CHANNEL_DOMAIN_5G_FCC5 -+ {{36,40,44,48,52,56,60,64},8}, // 0x09, RT_CHANNEL_DOMAIN_5G_FCC6 -+ {{36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165},20}, // 0x0A, RT_CHANNEL_DOMAIN_5G_FCC7_IC1 -+ {{36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165},20}, // 0x0B, RT_CHANNEL_DOMAIN_5G_KCC1 -+ {{36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140},19}, // 0x0C, RT_CHANNEL_DOMAIN_5G_MKK1 -+ {{36,40,44,48,52,56,60,64},8}, // 0x0D, RT_CHANNEL_DOMAIN_5G_MKK2 -+ {{100,104,108,112,116,120,124,128,132,136,140},11}, // 0x0E, RT_CHANNEL_DOMAIN_5G_MKK3 -+ {{56,60,64,100,104,108,112,116,136,140,149,153,157,161,165},15}, // 0x0F, RT_CHANNEL_DOMAIN_5G_NCC1 -+ {{56,60,64,149,153,157,161,165},8}, // 0x10, RT_CHANNEL_DOMAIN_5G_NCC2 -+ -+ //===== Driver self defined for old channel plan Compatible ,Remember to modify if have new channel plan definition ===== -+ {{36,40,44,48,52,56,60,64,100,104,108,112,116,132,136,140,149,153,157,161,165},21}, // 0x11, RT_CHANNEL_DOMAIN_5G_FCC -+ {{36,40,44,48},4}, // 0x12, RT_CHANNEL_DOMAIN_5G_JAPAN_NO_DFS -+ {{36,40,44,48,149,153,157,161},8}, // 0x13, RT_CHANNEL_DOMAIN_5G_FCC4_NO_DFS -+}; -+ -+static RT_CHANNEL_PLAN_MAP RTW_ChannelPlanMap[RT_CHANNEL_DOMAIN_MAX] = { -+ //===== 0x00 ~ 0x1F , Old Define ===== -+ {0x02,0x11}, //0x00, RT_CHANNEL_DOMAIN_FCC -+ {0x02,0x0A}, //0x01, RT_CHANNEL_DOMAIN_IC -+ {0x01,0x01}, //0x02, RT_CHANNEL_DOMAIN_ETSI -+ {0x01,0x00}, //0x03, RT_CHANNEL_DOMAIN_SPAIN -+ {0x01,0x00}, //0x04, RT_CHANNEL_DOMAIN_FRANCE -+ {0x03,0x00}, //0x05, RT_CHANNEL_DOMAIN_MKK -+ {0x03,0x00}, //0x06, RT_CHANNEL_DOMAIN_MKK1 -+ {0x01,0x09}, //0x07, RT_CHANNEL_DOMAIN_ISRAEL -+ {0x03,0x09}, //0x08, RT_CHANNEL_DOMAIN_TELEC -+ {0x03,0x00}, //0x09, RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN -+ {0x00,0x00}, //0x0A, RT_CHANNEL_DOMAIN_WORLD_WIDE_13 -+ {0x02,0x0F}, //0x0B, RT_CHANNEL_DOMAIN_TAIWAN -+ {0x01,0x08}, //0x0C, RT_CHANNEL_DOMAIN_CHINA -+ {0x02,0x06}, //0x0D, RT_CHANNEL_DOMAIN_SINGAPORE_INDIA_MEXICO -+ {0x02,0x0B}, //0x0E, RT_CHANNEL_DOMAIN_KOREA -+ {0x02,0x09}, //0x0F, RT_CHANNEL_DOMAIN_TURKEY -+ {0x01,0x01}, //0x10, RT_CHANNEL_DOMAIN_JAPAN -+ {0x02,0x05}, //0x11, RT_CHANNEL_DOMAIN_FCC_NO_DFS -+ {0x01,0x12}, //0x12, RT_CHANNEL_DOMAIN_JAPAN_NO_DFS -+ {0x00,0x04}, //0x13, RT_CHANNEL_DOMAIN_WORLD_WIDE_5G -+ {0x02,0x10}, //0x14, RT_CHANNEL_DOMAIN_TAIWAN_NO_DFS -+ {0x00,0x12}, //0x15, RT_CHANNEL_DOMAIN_ETSI_NO_DFS -+ {0x00,0x13}, //0x16, RT_CHANNEL_DOMAIN_KOREA_NO_DFS -+ {0x03,0x12}, //0x17, RT_CHANNEL_DOMAIN_JAPAN_NO_DFS -+ {0x05,0x08}, //0x18, RT_CHANNEL_DOMAIN_PAKISTAN_NO_DFS -+ {0x02,0x08}, //0x19, RT_CHANNEL_DOMAIN_TAIWAN2_NO_DFS -+ {0x00,0x00}, //0x1A, -+ {0x00,0x00}, //0x1B, -+ {0x00,0x00}, //0x1C, -+ {0x00,0x00}, //0x1D, -+ {0x00,0x00}, //0x1E, -+ {0x05,0x04}, //0x1F, RT_CHANNEL_DOMAIN_WORLD_WIDE_ONLY_5G -+ //===== 0x20 ~ 0x7F ,New Define ===== -+ {0x00,0x00}, //0x20, RT_CHANNEL_DOMAIN_WORLD_NULL -+ {0x01,0x00}, //0x21, RT_CHANNEL_DOMAIN_ETSI1_NULL -+ {0x02,0x00}, //0x22, RT_CHANNEL_DOMAIN_FCC1_NULL -+ {0x03,0x00}, //0x23, RT_CHANNEL_DOMAIN_MKK1_NULL -+ {0x04,0x00}, //0x24, RT_CHANNEL_DOMAIN_ETSI2_NULL -+ {0x02,0x04}, //0x25, RT_CHANNEL_DOMAIN_FCC1_FCC1 -+ {0x00,0x01}, //0x26, RT_CHANNEL_DOMAIN_WORLD_ETSI1 -+ {0x03,0x0C}, //0x27, RT_CHANNEL_DOMAIN_MKK1_MKK1 -+ {0x00,0x0B}, //0x28, RT_CHANNEL_DOMAIN_WORLD_KCC1 -+ {0x00,0x05}, //0x29, RT_CHANNEL_DOMAIN_WORLD_FCC2 -+ {0x00,0x00}, //0x2A, -+ {0x00,0x00}, //0x2B, -+ {0x00,0x00}, //0x2C, -+ {0x00,0x00}, //0x2D, -+ {0x00,0x00}, //0x2E, -+ {0x00,0x00}, //0x2F, -+ {0x00,0x06}, //0x30, RT_CHANNEL_DOMAIN_WORLD_FCC3 -+ {0x00,0x07}, //0x31, RT_CHANNEL_DOMAIN_WORLD_FCC4 -+ {0x00,0x08}, //0x32, RT_CHANNEL_DOMAIN_WORLD_FCC5 -+ {0x00,0x09}, //0x33, RT_CHANNEL_DOMAIN_WORLD_FCC6 -+ {0x02,0x0A}, //0x34, RT_CHANNEL_DOMAIN_FCC1_FCC7 -+ {0x00,0x02}, //0x35, RT_CHANNEL_DOMAIN_WORLD_ETSI2 -+ {0x00,0x03}, //0x36, RT_CHANNEL_DOMAIN_WORLD_ETSI3 -+ {0x03,0x0D}, //0x37, RT_CHANNEL_DOMAIN_MKK1_MKK2 -+ {0x03,0x0E}, //0x38, RT_CHANNEL_DOMAIN_MKK1_MKK3 -+ {0x02,0x0F}, //0x39, RT_CHANNEL_DOMAIN_FCC1_NCC1 -+ {0x00,0x00}, //0x3A, -+ {0x00,0x00}, //0x3B, -+ {0x00,0x00}, //0x3C, -+ {0x00,0x00}, //0x3D, -+ {0x00,0x00}, //0x3E, -+ {0x00,0x00}, //0x3F, -+ {0x02,0x10}, //0x40, RT_CHANNEL_DOMAIN_FCC1_NCC2 -+ {0x03,0x00}, //0x41, RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN_2G -+}; -+ -+static RT_CHANNEL_PLAN_MAP RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE = {0x03,0x02}; //use the conbination for max channel numbers -+ -+/* -+ * Search the @param channel_num in given @param channel_set -+ * @ch_set: the given channel set -+ * @ch: the given channel number -+ * -+ * return the index of channel_num in channel_set, -1 if not found -+ */ -+int rtw_ch_set_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch) -+{ -+ int i; -+ for(i=0;ch_set[i].ChannelNum!=0;i++){ -+ if(ch == ch_set[i].ChannelNum) -+ break; -+ } -+ -+ if(i >= ch_set[i].ChannelNum) -+ return -1; -+ return i; -+} -+ -+/**************************************************************************** -+ -+Following are the initialization functions for WiFi MLME -+ -+*****************************************************************************/ -+ -+int init_hw_mlme_ext(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ //set_opmode_cmd(padapter, infra_client_with_mlme);//removed -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ return _SUCCESS; -+} -+ -+static void init_mlme_ext_priv_value(_adapter* padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+#ifdef CONFIG_TDLS -+ u8 i; -+#endif -+ -+ //unsigned char default_channel_set[MAX_CHANNEL_NUM] = {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 0, 0}; -+ unsigned char mixed_datarate[NumRates] = {_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_, _6M_RATE_,_9M_RATE_, _12M_RATE_, _18M_RATE_, _24M_RATE_, _36M_RATE_, _48M_RATE_, _54M_RATE_, 0xff}; -+ unsigned char mixed_basicrate[NumRates] ={_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_, _6M_RATE_, _12M_RATE_, _24M_RATE_, 0xff,}; -+ -+ ATOMIC_SET(&pmlmeext->event_seq, 0); -+ pmlmeext->mgnt_seq = 0;//reset to zero when disconnect at client mode -+ -+ pmlmeext->cur_channel = padapter->registrypriv.channel; -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ pmlmeext->retry = 0; -+ -+ pmlmeext->cur_wireless_mode = padapter->registrypriv.wireless_mode; -+ -+ //_rtw_memcpy(pmlmeext->channel_set, DefaultChannelPlan[padapter->mlmepriv.ChannelPlan].Channel, DefaultChannelPlan[padapter->mlmepriv.ChannelPlan].Len); -+ //_rtw_memcpy(pmlmeext->channel_set, default_channel_set, MAX_CHANNEL_NUM); -+ _rtw_memcpy(pmlmeext->datarate, mixed_datarate, NumRates); -+ _rtw_memcpy(pmlmeext->basicrate, mixed_basicrate, NumRates); -+ -+ if(pmlmeext->cur_channel > 14) -+ pmlmeext->tx_rate = IEEE80211_OFDM_RATE_6MB; -+ else -+ pmlmeext->tx_rate = IEEE80211_CCK_RATE_1MB; -+ -+ pmlmeext->sitesurvey_res.state = SCAN_DISABLE; -+ pmlmeext->sitesurvey_res.channel_idx = 0; -+ pmlmeext->sitesurvey_res.bss_cnt = 0; -+ pmlmeext->scan_abort = false; -+ -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ pmlmeinfo->reauth_count = 0; -+ pmlmeinfo->reassoc_count = 0; -+ pmlmeinfo->link_count = 0; -+ pmlmeinfo->auth_seq = 0; -+ pmlmeinfo->auth_algo = dot11AuthAlgrthm_Open; -+ pmlmeinfo->key_index = 0; -+ pmlmeinfo->iv = 0; -+ -+ pmlmeinfo->enc_algo = _NO_PRIVACY_; -+ pmlmeinfo->authModeToggle = 0; -+ -+ _rtw_memset(pmlmeinfo->chg_txt, 0, 128); -+ -+ pmlmeinfo->slotTime = SHORT_SLOT_TIME; -+ pmlmeinfo->preamble_mode = PREAMBLE_AUTO; -+ -+ pmlmeinfo->dialogToken = 0; -+ -+ pmlmeext->action_public_rxseq = 0xffff; -+ pmlmeext->action_public_dialog_token = 0xff; -+} -+ -+static int has_channel(RT_CHANNEL_INFO *channel_set, -+ u8 chanset_size, -+ u8 chan) { -+ int i; -+ -+ for (i = 0; i < chanset_size; i++) { -+ if (channel_set[i].ChannelNum == chan) { -+ return 1; -+ } -+ } -+ -+ return 0; -+} -+ -+static void init_channel_list(_adapter *padapter, RT_CHANNEL_INFO *channel_set, -+ u8 chanset_size, -+ struct p2p_channels *channel_list) { -+ -+ struct p2p_oper_class_map op_class[] = { -+ { IEEE80211G, 81, 1, 13, 1, BW20 }, -+ { IEEE80211G, 82, 14, 14, 1, BW20 }, -+#if 0 /* Do not enable HT40 on 2 GHz */ -+ { IEEE80211G, 83, 1, 9, 1, BW40PLUS }, -+ { IEEE80211G, 84, 5, 13, 1, BW40MINUS }, -+#endif -+ { IEEE80211A, 115, 36, 48, 4, BW20 }, -+ { IEEE80211A, 116, 36, 44, 8, BW40PLUS }, -+ { IEEE80211A, 117, 40, 48, 8, BW40MINUS }, -+ { IEEE80211A, 124, 149, 161, 4, BW20 }, -+ { IEEE80211A, 125, 149, 169, 4, BW20 }, -+ { IEEE80211A, 126, 149, 157, 8, BW40PLUS }, -+ { IEEE80211A, 127, 153, 161, 8, BW40MINUS }, -+ { -1, 0, 0, 0, 0, BW20 } -+ }; -+ -+ int cla, op; -+ -+ cla = 0; -+ -+ for (op = 0; op_class[op].op_class; op++) { -+ u8 ch; -+ struct p2p_oper_class_map *o = &op_class[op]; -+ struct p2p_reg_class *reg = NULL; -+ -+ for (ch = o->min_chan; ch <= o->max_chan; ch += o->inc) { -+ if (!has_channel(channel_set, chanset_size, ch)) { -+ continue; -+ } -+ -+ if ((0 == padapter->registrypriv.ht_enable) && (8 == o->inc)) -+ continue; -+ -+ if ((0 < (padapter->registrypriv.bw_mode & 0xf0)) && -+ ((BW40MINUS == o->bw) || (BW40PLUS == o->bw))) -+ continue; -+ -+ if (reg == NULL) { -+ reg = &channel_list->reg_class[cla]; -+ cla++; -+ reg->reg_class = o->op_class; -+ reg->channels = 0; -+ } -+ reg->channel[reg->channels] = ch; -+ reg->channels++; -+ } -+ } -+ channel_list->reg_classes = cla; -+ -+} -+ -+static u8 init_channel_set(_adapter* padapter, u8 ChannelPlan, RT_CHANNEL_INFO *channel_set) -+{ -+ u8 index,chanset_size = 0; -+ u8 b5GBand = false, b2_4GBand = false; -+ u8 Index2G = 0, Index5G=0; -+ -+ _rtw_memset(channel_set, 0, sizeof(RT_CHANNEL_INFO)*MAX_CHANNEL_NUM); -+ -+ if(ChannelPlan >= RT_CHANNEL_DOMAIN_MAX && ChannelPlan != RT_CHANNEL_DOMAIN_REALTEK_DEFINE) -+ { -+ DBG_871X("ChannelPlan ID %x error !!!!!\n",ChannelPlan); -+ return chanset_size; -+ } -+ -+ if(IsSupported24G(padapter->registrypriv.wireless_mode)) -+ { -+ b2_4GBand = true; -+ if(RT_CHANNEL_DOMAIN_REALTEK_DEFINE == ChannelPlan) -+ Index2G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index2G; -+ else -+ Index2G = RTW_ChannelPlanMap[ChannelPlan].Index2G; -+ } -+ -+ if(IsSupported5G(padapter->registrypriv.wireless_mode)) -+ { -+ b5GBand = true; -+ if(RT_CHANNEL_DOMAIN_REALTEK_DEFINE == ChannelPlan) -+ Index5G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index5G; -+ else -+ Index5G = RTW_ChannelPlanMap[ChannelPlan].Index5G; -+ } -+ -+ if(b2_4GBand) -+ { -+ for(index=0;index= 1 && channel_set[chanset_size].ChannelNum <= 11) -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ else if((channel_set[chanset_size].ChannelNum >= 12 && channel_set[chanset_size].ChannelNum <= 14)) -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ } -+ else if(RT_CHANNEL_DOMAIN_WORLD_WIDE_13 == ChannelPlan || -+ RT_CHANNEL_DOMAIN_WORLD_WIDE_5G == ChannelPlan || -+ RT_CHANNEL_DOMAIN_2G_WORLD == Index2G)// channel 12~13, passive scan -+ { -+ if(channel_set[chanset_size].ChannelNum <= 11) -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ else -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ } -+ else -+ { -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ } -+ -+ chanset_size++; -+ } -+ } -+ -+ if(b5GBand) -+ { -+ for(index=0;index= 149 ) -+ { -+ if(RT_CHANNEL_DOMAIN_WORLD_WIDE_5G == ChannelPlan)//passive scan for all 5G channels -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ else -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ } -+ else -+ { -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ } -+ chanset_size++; -+#else /* CONFIG_DFS */ -+ if ( RTW_ChannelPlan5G[Index5G].Channel[index] <= 48 -+ || RTW_ChannelPlan5G[Index5G].Channel[index] >= 149 ) { -+ channel_set[chanset_size].ChannelNum = RTW_ChannelPlan5G[Index5G].Channel[index]; -+ if(RT_CHANNEL_DOMAIN_WORLD_WIDE_5G == ChannelPlan)//passive scan for all 5G channels -+ channel_set[chanset_size].ScanType = SCAN_PASSIVE; -+ else -+ channel_set[chanset_size].ScanType = SCAN_ACTIVE; -+ DBG_871X("%s(): channel_set[%d].ChannelNum = %d\n", __FUNCTION__, chanset_size, channel_set[chanset_size].ChannelNum); -+ chanset_size++; -+ } -+#endif /* CONFIG_DFS */ -+ } -+ } -+ -+ DBG_871X("%s ChannelPlan ID %x Chan num:%d \n",__FUNCTION__,ChannelPlan,chanset_size); -+ return chanset_size; -+} -+ -+int init_mlme_ext_priv(_adapter* padapter) -+{ -+ int res = _SUCCESS; -+ struct registry_priv* pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ // We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). -+ //_rtw_memset((u8 *)pmlmeext, 0, sizeof(struct mlme_ext_priv)); -+ -+ pmlmeext->padapter = padapter; -+ -+ //fill_fwpriv(padapter, &(pmlmeext->fwpriv)); -+ -+ init_mlme_ext_priv_value(padapter); -+ pmlmeinfo->bAcceptAddbaReq = pregistrypriv->bAcceptAddbaReq; -+ -+ init_mlme_ext_timer(padapter); -+ -+#ifdef CONFIG_AP_MODE -+ init_mlme_ap_info(padapter); -+#endif -+ -+ pmlmeext->max_chan_nums = init_channel_set(padapter, pmlmepriv->ChannelPlan,pmlmeext->channel_set); -+ init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); -+ -+ pmlmeext->chan_scan_time = SURVEY_TO; -+ pmlmeext->mlmeext_init = true; -+ -+ -+#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ pmlmeext->active_keep_alive_check = true; -+#endif -+ -+#ifdef DBG_FIXED_CHAN -+ pmlmeext->fixed_chan = 0xFF; -+#endif -+ -+ return res; -+ -+} -+ -+void free_mlme_ext_priv (struct mlme_ext_priv *pmlmeext) -+{ -+ _adapter *padapter = pmlmeext->padapter; -+ -+ if (!padapter) -+ return; -+ -+ if (padapter->bDriverStopped == true) -+ { -+ _cancel_timer_ex(&pmlmeext->survey_timer); -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ //_cancel_timer_ex(&pmlmeext->ADDBA_timer); -+ } -+} -+ -+static u8 cmp_pkt_chnl_diff(_adapter *padapter,u8* pframe,uint packet_len) -+{ // if the channel is same, return 0. else return channel differential -+ uint len; -+ u8 channel; -+ u8 *p; -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_, _DSSET_IE_, &len, packet_len - _BEACON_IE_OFFSET_); -+ if (p) -+ { -+ channel = *(p + 2); -+ if(padapter->mlmeextpriv.cur_channel >= channel) -+ { -+ return (padapter->mlmeextpriv.cur_channel - channel); -+ } -+ else -+ { -+ return (channel-padapter->mlmeextpriv.cur_channel); -+ } -+ } -+ else -+ { -+ return 0; -+ } -+} -+ -+static void _mgt_dispatcher(_adapter *padapter, struct mlme_handler *ptable, union recv_frame *precv_frame) -+{ -+ u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ -+ if(ptable->func) -+ { -+ //receive the frames that ra(a1) is my address or ra(a1) is bc address. -+ if (!_rtw_memcmp(GetAddr1Ptr(pframe), myid(&padapter->eeprompriv), ETH_ALEN) && -+ !_rtw_memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) -+ { -+ return; -+ } -+ -+ ptable->func(padapter, precv_frame); -+ } -+ -+} -+ -+void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ int index; -+ struct mlme_handler *ptable; -+#ifdef CONFIG_AP_MODE -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#endif //CONFIG_AP_MODE -+ u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, GetAddr2Ptr(pframe)); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, -+ ("+mgt_dispatcher: type(0x%x) subtype(0x%x)\n", -+ GetFrameType(pframe), GetFrameSubType(pframe))); -+ -+#if 0 -+ { -+ u8 *pbuf; -+ pbuf = GetAddr1Ptr(pframe); -+ DBG_871X("A1-%x:%x:%x:%x:%x:%x\n", *pbuf, *(pbuf+1), *(pbuf+2), *(pbuf+3), *(pbuf+4), *(pbuf+5)); -+ pbuf = GetAddr2Ptr(pframe); -+ DBG_871X("A2-%x:%x:%x:%x:%x:%x\n", *pbuf, *(pbuf+1), *(pbuf+2), *(pbuf+3), *(pbuf+4), *(pbuf+5)); -+ pbuf = GetAddr3Ptr(pframe); -+ DBG_871X("A3-%x:%x:%x:%x:%x:%x\n", *pbuf, *(pbuf+1), *(pbuf+2), *(pbuf+3), *(pbuf+4), *(pbuf+5)); -+ } -+#endif -+ -+ if (GetFrameType(pframe) != WIFI_MGT_TYPE) -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_, ("mgt_dispatcher: type(0x%x) error!\n", GetFrameType(pframe))); -+ return; -+ } -+ -+ //receive the frames that ra(a1) is my address or ra(a1) is bc address. -+ if (!_rtw_memcmp(GetAddr1Ptr(pframe), myid(&padapter->eeprompriv), ETH_ALEN) && -+ !_rtw_memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) -+ { -+ return; -+ } -+ -+ ptable = mlme_sta_tbl; -+ -+ index = GetFrameSubType(pframe) >> 4; -+ -+#ifdef CONFIG_TDLS -+ if((index << 4)==WIFI_ACTION){ -+ //category==public (4), action==TDLS_DISCOVERY_RESPONSE -+ if(*(pframe+24)==0x04 && *(pframe+25)==TDLS_DISCOVERY_RESPONSE){ -+ DBG_871X("recv tdls discovery response frame\n"); -+ On_TDLS_Dis_Rsp(padapter, precv_frame); -+ } -+ } -+#endif //CONFIG_TDLS -+ -+ if (index > 13) -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("Currently we do not support reserved sub-fr-type=%d\n", index)); -+ return; -+ } -+ ptable += index; -+ -+#if 1 -+ if (psta != NULL) -+ { -+ if (GetRetry(pframe)) -+ { -+ if (precv_frame->u.hdr.attrib.seq_num == psta->RxMgmtFrameSeqNum) -+ { -+ /* drop the duplicate management frame */ -+ DBG_871X("Drop duplicate management frame with seq_num = %d.\n", precv_frame->u.hdr.attrib.seq_num); -+ return; -+ } -+ } -+ psta->RxMgmtFrameSeqNum = precv_frame->u.hdr.attrib.seq_num; -+ } -+#else -+ -+ if(GetRetry(pframe)) -+ { -+ //RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("drop due to decache!\n")); -+ //return; -+ } -+#endif -+ -+#ifdef CONFIG_AP_MODE -+ switch (GetFrameSubType(pframe)) -+ { -+ case WIFI_AUTH: -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ ptable->func = &OnAuth; -+ else -+ ptable->func = &OnAuthClient; -+ //pass through -+ case WIFI_ASSOCREQ: -+ case WIFI_REASSOCREQ: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+#ifdef CONFIG_HOSTAPD_MLME -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ rtw_hostapd_mlme_rx(padapter, precv_frame); -+#endif -+ break; -+ case WIFI_PROBEREQ: -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+#ifdef CONFIG_HOSTAPD_MLME -+ rtw_hostapd_mlme_rx(padapter, precv_frame); -+#else -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+#endif -+ } -+ else -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ case WIFI_BEACON: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ case WIFI_ACTION: -+ //if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ break; -+ default: -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ rtw_hostapd_mlme_rx(padapter, precv_frame); -+ break; -+ } -+#else -+ -+ _mgt_dispatcher(padapter, ptable, precv_frame); -+ -+#endif -+ -+} -+ -+#ifdef CONFIG_P2P -+static u32 p2p_listen_state_process(_adapter *padapter, unsigned char *da) -+{ -+ bool response = true; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) -+ { -+ if (wdev_to_priv(padapter->rtw_wdev)->p2p_enabled == false -+ || padapter->mlmepriv.wps_probe_resp_ie == NULL -+ || padapter->mlmepriv.p2p_probe_resp_ie == NULL -+ ) -+ { -+ DBG_871X("DON'T issue_probersp_p2p: p2p_enabled:%d, wps_probe_resp_ie:%p, p2p_probe_resp_ie:%p\n", -+ wdev_to_priv(padapter->rtw_wdev)->p2p_enabled, -+ padapter->mlmepriv.wps_probe_resp_ie, -+ padapter->mlmepriv.p2p_probe_resp_ie); -+ response = false; -+ } -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ if( padapter->wdinfo.driver_interface == DRIVER_WEXT ) -+ { -+ // do nothing if the device name is empty -+ if ( !padapter->wdinfo.device_name_len ) -+ { -+ response = false; -+ } -+ } -+ -+ if (response == true) -+ issue_probersp_p2p( padapter, da); -+ -+ return _SUCCESS; -+} -+#endif //CONFIG_P2P -+ -+ -+/**************************************************************************** -+ -+Following are the callback functions for each subtype of the management frames -+ -+*****************************************************************************/ -+ -+unsigned int OnProbeReq(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int ielen; -+ unsigned char *p; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur = &(pmlmeinfo->network); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ u8 is_valid_p2p_probereq = false; -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ u8 wifi_test_chk_rate = 1; -+ -+ if ( !rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && -+ !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE) && -+ !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && -+ !rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH) && -+ !rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) -+ ) -+ { -+ // Commented by Albert 2011/03/17 -+ // mcs_rate = 0 -> CCK 1M rate -+ // mcs_rate = 1 -> CCK 2M rate -+ // mcs_rate = 2 -> CCK 5.5M rate -+ // mcs_rate = 3 -> CCK 11M rate -+ // In the P2P mode, the driver should not support the CCK rate -+ -+ // Commented by Kurt 2012/10/16 -+ // IOT issue: Google Nexus7 use 1M rate to send p2p_probe_req after GO nego completed and Nexus7 is client -+#ifdef CONFIG_WIFI_TEST -+ if ( pattrib->mcs_rate <= 3 ) -+ { -+ wifi_test_chk_rate = 0; -+ } -+#endif //CONFIG_WIFI_TEST -+ -+ if( wifi_test_chk_rate == 1 ) -+ { -+ if((is_valid_p2p_probereq = process_probe_req_p2p_ie(pwdinfo, pframe, len)) == true) -+ { -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE)) -+ { -+ p2p_listen_state_process( padapter, get_sa(pframe)); -+ -+ return _SUCCESS; -+ } -+ -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ goto _continue; -+ } -+ } -+ } -+ } -+ -+_continue: -+#endif //CONFIG_P2P -+ -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ { -+ return _SUCCESS; -+ } -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == false && -+ check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE|WIFI_AP_STATE)==false) -+ { -+ return _SUCCESS; -+ } -+ -+ -+ //DBG_871X("+OnProbeReq\n"); -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == true && -+ pmlmepriv->cur_network.join_res == true) -+ { -+ _irqL irqL; -+ struct sta_info *psta; -+ u8 *mac_addr, *peer_addr; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 RC_OUI[4]={0x00,0xE0,0x4C,0x0A}; -+ //EID[1] + EID_LEN[1] + RC_OUI[4] + MAC[6] + PairingID[2] + ChannelNum[2] -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, (int *)&ielen, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); -+ -+ if(!p || ielen !=14) -+ goto _non_rc_device; -+ -+ if(!_rtw_memcmp(p+2, RC_OUI, sizeof(RC_OUI))) -+ goto _non_rc_device; -+ -+ if(!_rtw_memcmp(p+6, get_sa(pframe), ETH_ALEN)) -+ { -+ DBG_871X("%s, do rc pairing ("MAC_FMT"), but mac addr mismatch!("MAC_FMT")\n", __FUNCTION__, -+ MAC_ARG(get_sa(pframe)), MAC_ARG(p+6)); -+ -+ goto _non_rc_device; -+ } -+ -+ DBG_871X("%s, got the pairing device("MAC_FMT")\n", __FUNCTION__, MAC_ARG(get_sa(pframe))); -+ -+ //new a station -+ psta = rtw_get_stainfo(pstapriv, get_sa(pframe)); -+ if (psta == NULL) -+ { -+ // allocate a new one -+ DBG_871X("going to alloc stainfo for rc="MAC_FMT"\n", MAC_ARG(get_sa(pframe))); -+ psta = rtw_alloc_stainfo(pstapriv, get_sa(pframe)); -+ if (psta == NULL) -+ { -+ //TODO: -+ DBG_871X(" Exceed the upper limit of supported clients...\n"); -+ return _SUCCESS; -+ } -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&psta->asoc_list)) -+ { -+ psta->expire_to = pstapriv->expire_to; -+ rtw_list_insert_tail(&psta->asoc_list, &pstapriv->asoc_list); -+ pstapriv->asoc_list_cnt++; -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ //generate pairing ID -+ mac_addr = myid(&(padapter->eeprompriv)); -+ peer_addr = psta->hwaddr; -+ psta->pid = (u16)(((mac_addr[4]<<8) + mac_addr[5]) + ((peer_addr[4]<<8) + peer_addr[5])); -+ -+ //update peer stainfo -+ psta->isrc = true; -+ //psta->aid = 0; -+ //psta->mac_id = 2; -+ -+ /* get a unique AID */ -+ if (psta->aid > 0) { -+ DBG_871X("old AID %d\n", psta->aid); -+ } else { -+ for (psta->aid = 1; psta->aid <= NUM_STA; psta->aid++) -+ if (pstapriv->sta_aid[psta->aid - 1] == NULL) -+ break; -+ -+ if (psta->aid > pstapriv->max_num_sta) { -+ psta->aid = 0; -+ DBG_871X("no room for more AIDs\n"); -+ return _SUCCESS; -+ } else { -+ pstapriv->sta_aid[psta->aid - 1] = psta; -+ DBG_871X("allocate new AID = (%d)\n", psta->aid); -+ } -+ } -+ -+ psta->qos_option = 1; -+ psta->htpriv.ht_option = true; -+ psta->ieee8021x_blocked = false; -+ psta->htpriv.ampdu_enable = false; -+ psta->htpriv.sgi = false; -+ psta->htpriv.bwmode = CHANNEL_WIDTH_20; -+ psta->htpriv.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, true); -+ -+ psta->htpriv.agg_enable_bitmap = 0x0;//reset -+ psta->htpriv.candidate_tid_bitmap = 0x0;//reset -+ -+ _rtw_memset((void*)&psta->sta_stats, 0, sizeof(struct stainfo_stats)); -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state |= _FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+ report_add_sta_event(padapter, psta->hwaddr, psta->aid); -+ -+ } -+ -+ issue_probersp(padapter, get_sa(pframe), false); -+ -+ return _SUCCESS; -+ -+ } -+ -+_non_rc_device: -+ -+ return _SUCCESS; -+ -+#endif //CONFIG_AUTO_AP_MODE -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) && -+ check_buddy_fwstate(padapter, _FW_UNDER_LINKING|_FW_UNDER_SURVEY)) -+ { -+ //don't process probe req -+ return _SUCCESS; -+ } -+#endif -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _SSID_IE_, (int *)&ielen, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); -+ -+ -+ //check (wildcard) SSID -+ if (p != NULL) -+ { -+ if(is_valid_p2p_probereq == true) -+ { -+ goto _issue_probersp; -+ } -+ -+ if ( (ielen != 0 && false ==_rtw_memcmp((void *)(p+2), (void *)cur->Ssid.Ssid, cur->Ssid.SsidLength)) -+ || (ielen == 0 && pmlmeinfo->hidden_ssid_mode) -+ ) -+ { -+ return _SUCCESS; -+ } -+ -+_issue_probersp: -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == true && -+ pmlmepriv->cur_network.join_res == true) -+ { -+ //DBG_871X("+issue_probersp during ap mode\n"); -+ issue_probersp(padapter, get_sa(pframe), is_valid_p2p_probereq); -+ } -+ -+ } -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnProbeRsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct sta_info *psta; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif -+ -+ -+#ifdef CONFIG_P2P -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) -+ { -+ if ( true == pwdinfo->tx_prov_disc_info.benable ) -+ { -+ if( _rtw_memcmp( pwdinfo->tx_prov_disc_info.peerIFAddr, GetAddr2Ptr(pframe), ETH_ALEN ) ) -+ { -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) -+ { -+ pwdinfo->tx_prov_disc_info.benable = false; -+ issue_p2p_provision_request( padapter, -+ pwdinfo->tx_prov_disc_info.ssid.Ssid, -+ pwdinfo->tx_prov_disc_info.ssid.SsidLength, -+ pwdinfo->tx_prov_disc_info.peerDevAddr ); -+ } -+ else if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) ) -+ { -+ pwdinfo->tx_prov_disc_info.benable = false; -+ issue_p2p_provision_request( padapter, -+ NULL, -+ 0, -+ pwdinfo->tx_prov_disc_info.peerDevAddr ); -+ } -+ } -+ } -+ return _SUCCESS; -+ } -+ else if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) -+ { -+ if ( true == pwdinfo->nego_req_info.benable ) -+ { -+ DBG_871X( "[%s] P2P State is GONEGO ING!\n", __FUNCTION__ ); -+ if( _rtw_memcmp( pwdinfo->nego_req_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN ) ) -+ { -+ pwdinfo->nego_req_info.benable = false; -+ issue_p2p_GO_request( padapter, pwdinfo->nego_req_info.peerDevAddr); -+ } -+ } -+ } -+ else if( rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ ) ) -+ { -+ if ( true == pwdinfo->invitereq_info.benable ) -+ { -+ DBG_871X( "[%s] P2P_STATE_TX_INVITE_REQ!\n", __FUNCTION__ ); -+ if( _rtw_memcmp( pwdinfo->invitereq_info.peer_macaddr, GetAddr2Ptr(pframe), ETH_ALEN ) ) -+ { -+ pwdinfo->invitereq_info.benable = false; -+ issue_p2p_invitation_request( padapter, pwdinfo->invitereq_info.peer_macaddr ); -+ } -+ } -+ } -+#endif -+ -+ -+ if (pmlmeext->sitesurvey_res.state == SCAN_PROCESS) -+ { -+ report_survey_event(padapter, precv_frame); -+#ifdef CONFIG_CONCURRENT_MODE -+ report_survey_event(padapter->pbuddy_adapter, precv_frame); -+#endif -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ dc_report_survey_event(padapter, precv_frame); -+#endif -+ return _SUCCESS; -+ } -+ -+ #if 0 //move to validate_recv_mgnt_frame -+ if (_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN)) -+ { -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ { -+ if ((psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe))) != NULL) -+ { -+ psta->sta_stats.rx_mgnt_pkts++; -+ } -+ } -+ } -+ #endif -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ int cam_idx; -+ struct sta_info *psta; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ WLAN_BSSID_EX *pbss; -+ int ret = _SUCCESS; -+ u8 *p = NULL; -+ u32 ielen = 0; -+ -+#ifdef CONFIG_ATTEMPT_TO_FIX_AP_BEACON_ERROR -+ p = rtw_get_ie(pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ielen, precv_frame->u.hdr.len -sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_); -+ if ((p != NULL) && (ielen > 0)) -+ { -+ if ((*(p + 1 + ielen) == 0x2D) && (*(p + 2 + ielen) != 0x2D)) -+ { -+ /* Invalid value 0x2D is detected in Extended Supported Rates (ESR) IE. Try to fix the IE length to avoid failed Beacon parsing. */ -+ DBG_871X("[WIFIDBG] Error in ESR IE is detected in Beacon of BSSID:"MAC_FMT". Fix the length of ESR IE to avoid failed Beacon parsing.\n", MAC_ARG(GetAddr3Ptr(pframe))); -+ *(p + 1) = ielen - 1; -+ } -+ } -+#endif -+ -+ if (pmlmeext->sitesurvey_res.state == SCAN_PROCESS) -+ { -+ report_survey_event(padapter, precv_frame); -+#ifdef CONFIG_CONCURRENT_MODE -+ report_survey_event(padapter->pbuddy_adapter, precv_frame); -+#endif -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ dc_report_survey_event(padapter, precv_frame); -+#endif -+ -+ return _SUCCESS; -+ } -+ -+ if (_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN)) -+ { -+ if (pmlmeinfo->state & WIFI_FW_AUTH_NULL) -+ { -+ //we should update current network before auth, or some IE is wrong -+ pbss = (WLAN_BSSID_EX*)rtw_malloc(sizeof(WLAN_BSSID_EX)); -+ if (pbss) { -+ if (collect_bss_info(padapter, precv_frame, pbss) == _SUCCESS) { -+ update_network(&(pmlmepriv->cur_network.network), pbss, padapter, true); -+ rtw_get_bcn_info(&(pmlmepriv->cur_network)); -+ } -+ rtw_mfree((u8*)pbss, sizeof(WLAN_BSSID_EX)); -+ } -+ -+ //check the vendor of the assoc AP -+ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pframe+sizeof(struct rtw_ieee80211_hdr_3addr), len-sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ //update TSF Value -+ update_TSF(pmlmeext, pframe, len); -+ -+ //start auth -+ start_clnt_auth(padapter); -+ -+ return _SUCCESS; -+ } -+ -+ if(((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) && (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) -+ { -+ if ((psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe))) != NULL) -+ { -+ #ifdef CONFIG_PATCH_JOIN_WRONG_CHANNEL -+ //Merge from 8712 FW code -+ if (cmp_pkt_chnl_diff(padapter,pframe,len) != 0) -+ { // join wrong channel, deauth and reconnect -+ issue_deauth(padapter, (&(pmlmeinfo->network))->MacAddress, WLAN_REASON_DEAUTH_LEAVING); -+ -+ report_del_sta_event(padapter,(&(pmlmeinfo->network))->MacAddress, WLAN_REASON_JOIN_WRONG_CHANNEL); -+ pmlmeinfo->state &= (~WIFI_FW_ASSOC_SUCCESS); -+ return _SUCCESS; -+ } -+ #endif //CONFIG_PATCH_JOIN_WRONG_CHANNEL -+ -+ ret = rtw_check_bcn_info(padapter, pframe, len); -+ if (!ret) { -+ DBG_871X_LEVEL(_drv_always_, "ap has changed, disconnect now\n "); -+ receive_disconnect(padapter, pmlmeinfo->network.MacAddress , 65535); -+ return _SUCCESS; -+ } -+ //update WMM, ERP in the beacon -+ //todo: the timer is used instead of the number of the beacon received -+ if ((sta_rx_pkts(psta) & 0xf) == 0) -+ { -+ //DBG_871X("update_bcn_info\n"); -+ update_beacon_info(padapter, pframe, len, psta); -+ } -+ -+#ifdef CONFIG_DFS -+ process_csa_ie(padapter, pframe, len); //channel switch announcement -+#endif //CONFIG_DFS -+ -+#ifdef CONFIG_P2P_PS -+ process_p2p_ps_ie(padapter, (pframe + WLAN_HDR_A3_LEN), (len - WLAN_HDR_A3_LEN)); -+#endif //CONFIG_P2P_PS -+ -+ #if 0 //move to validate_recv_mgnt_frame -+ psta->sta_stats.rx_mgnt_pkts++; -+ #endif -+ } -+ } -+ else if((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) -+ { -+ if ((psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe))) != NULL) -+ { -+ //update WMM, ERP in the beacon -+ //todo: the timer is used instead of the number of the beacon received -+ if ((sta_rx_pkts(psta) & 0xf) == 0) -+ { -+ //DBG_871X("update_bcn_info\n"); -+ update_beacon_info(padapter, pframe, len, psta); -+ } -+ -+ #if 0 //move to validate_recv_mgnt_frame -+ psta->sta_stats.rx_mgnt_pkts++; -+ #endif -+ } -+ else -+ { -+ //allocate a new CAM entry for IBSS station -+ if ((cam_idx = allocate_fw_sta_entry(padapter)) == NUM_STA) -+ { -+ goto _END_ONBEACON_; -+ } -+ -+ //get supported rate -+ if (update_sta_support_rate(padapter, (pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_), (len - WLAN_HDR_A3_LEN - _BEACON_IE_OFFSET_), cam_idx) == _FAIL) -+ { -+ pmlmeinfo->FW_sta_info[cam_idx].status = 0; -+ goto _END_ONBEACON_; -+ } -+ -+ //update TSF Value -+ update_TSF(pmlmeext, pframe, len); -+ -+ //report sta add event -+ report_add_sta_event(padapter, GetAddr2Ptr(pframe), cam_idx); -+ } -+ } -+ } -+ -+_END_ONBEACON_: -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnAuth(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_AP_MODE -+ _irqL irqL; -+ unsigned int auth_mode, seq, ie_len; -+ unsigned char *sa, *p; -+ u16 algorithm; -+ int status; -+ static struct sta_info stat; -+ struct sta_info *pstat=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ u8 offset = 0; -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) && -+ check_buddy_fwstate(padapter, _FW_UNDER_LINKING|_FW_UNDER_SURVEY)) -+ { -+ //don't process auth request; -+ return _SUCCESS; -+ } -+#endif //CONFIG_CONCURRENT_MODE -+ -+ if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ return _FAIL; -+ -+ DBG_871X("+OnAuth\n"); -+ -+ sa = GetAddr2Ptr(pframe); -+ -+ auth_mode = psecuritypriv->dot11AuthAlgrthm; -+ -+ if (GetPrivacy(pframe)) -+ { -+ u8 *iv; -+ struct rx_pkt_attrib *prxattrib = &(precv_frame->u.hdr.attrib); -+ -+ prxattrib->hdrlen = WLAN_HDR_A3_LEN; -+ prxattrib->encrypt = _WEP40_; -+ -+ iv = pframe+prxattrib->hdrlen; -+ prxattrib->key_index = ((iv[3]>>6)&0x3); -+ -+ prxattrib->iv_len = 4; -+ prxattrib->icv_len = 4; -+ -+ rtw_wep_decrypt(padapter, (u8 *)precv_frame); -+ -+ offset = 4; -+ } -+ -+ algorithm = le16_to_cpu(*(__le16*)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset)); -+ seq = le16_to_cpu(*(__le16*)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 2)); -+ -+ DBG_871X("auth alg=%x, seq=%X\n", algorithm, seq); -+ -+ if (auth_mode == 2 && -+ psecuritypriv->dot11PrivacyAlgrthm != _WEP40_ && -+ psecuritypriv->dot11PrivacyAlgrthm != _WEP104_) -+ auth_mode = 0; -+ -+ if ((algorithm > 0 && auth_mode == 0) || // rx a shared-key auth but shared not enabled -+ (algorithm == 0 && auth_mode == 1) ) // rx a open-system auth but shared-key is enabled -+ { -+ DBG_871X("auth rejected due to bad alg [alg=%d, auth_mib=%d] %02X%02X%02X%02X%02X%02X\n", -+ algorithm, auth_mode, sa[0], sa[1], sa[2], sa[3], sa[4], sa[5]); -+ -+ status = _STATS_NO_SUPP_ALG_; -+ -+ goto auth_fail; -+ } -+ -+#if 0 //ACL control -+ phead = &priv->wlan_acl_list; -+ plist = phead->next; -+ //check sa -+ if (acl_mode == 1) // 1: positive check, only those on acl_list can be connected. -+ res = FAIL; -+ else -+ res = SUCCESS; -+ -+ while(plist != phead) -+ { -+ paclnode = list_entry(plist, struct rtw_wlan_acl_node, list); -+ plist = plist->next; -+ if (!memcmp((void *)sa, paclnode->addr, 6)) { -+ if (paclnode->mode & 2) { // deny -+ res = FAIL; -+ break; -+ } -+ else { -+ res = SUCCESS; -+ break; -+ } -+ } -+ } -+ -+ if (res != SUCCESS) { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,"auth abort because ACL!\n"); -+ return FAIL; -+ } -+#else -+ if(rtw_access_ctrl(padapter, sa) == false) -+ { -+ status = _STATS_UNABLE_HANDLE_STA_; -+ goto auth_fail; -+ } -+#endif -+ -+ pstat = rtw_get_stainfo(pstapriv, sa); -+ if (pstat == NULL) -+ { -+ // allocate a new one -+ DBG_871X("going to alloc stainfo for sa="MAC_FMT"\n", MAC_ARG(sa)); -+ pstat = rtw_alloc_stainfo(pstapriv, sa); -+ if (pstat == NULL) -+ { -+ DBG_871X(" Exceed the upper limit of supported clients...\n"); -+ status = _STATS_UNABLE_HANDLE_STA_; -+ goto auth_fail; -+ } -+ -+ pstat->state = WIFI_FW_AUTH_NULL; -+ pstat->auth_seq = 0; -+ -+ //pstat->flags = 0; -+ //pstat->capability = 0; -+ } -+ else -+ { -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if(rtw_is_list_empty(&pstat->asoc_list)==false) -+ { -+ rtw_list_delete(&pstat->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ if (pstat->expire_to > 0) -+ { -+ //TODO: STA re_auth within expire_to -+ } -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ if (seq==1) { -+ //TODO: STA re_auth and auth timeout -+ } -+ } -+ -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ if (rtw_is_list_empty(&pstat->auth_list)) -+ { -+ rtw_list_insert_tail(&pstat->auth_list, &pstapriv->auth_list); -+ pstapriv->auth_list_cnt++; -+ } -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ -+ if (pstat->auth_seq == 0) -+ pstat->expire_to = pstapriv->auth_to; -+ -+ if ((pstat->auth_seq + 1) != seq) -+ { -+ DBG_871X("(1)auth rejected because out of seq [rx_seq=%d, exp_seq=%d]!\n", -+ seq, pstat->auth_seq+1); -+ status = _STATS_OUT_OF_AUTH_SEQ_; -+ goto auth_fail; -+ } -+ -+ if (algorithm==0 && (auth_mode == 0 || auth_mode == 2 || auth_mode == 3)) -+ { -+ if (seq == 1) -+ { -+ pstat->state &= ~WIFI_FW_AUTH_NULL; -+ pstat->state |= WIFI_FW_AUTH_SUCCESS; -+ pstat->expire_to = pstapriv->assoc_to; -+ pstat->authalg = algorithm; -+ } -+ else -+ { -+ DBG_871X("(2)auth rejected because out of seq [rx_seq=%d, exp_seq=%d]!\n", -+ seq, pstat->auth_seq+1); -+ status = _STATS_OUT_OF_AUTH_SEQ_; -+ goto auth_fail; -+ } -+ } -+ else // shared system or auto authentication -+ { -+ if (seq == 1) -+ { -+ //prepare for the challenging txt... -+ -+ //get_random_bytes((void *)pstat->chg_txt, 128);//TODO: -+ _rtw_memset((void *)pstat->chg_txt, 78, 128); -+ -+ pstat->state &= ~WIFI_FW_AUTH_NULL; -+ pstat->state |= WIFI_FW_AUTH_STATE; -+ pstat->authalg = algorithm; -+ pstat->auth_seq = 2; -+ } -+ else if (seq == 3) -+ { -+ //checking for challenging txt... -+ DBG_871X("checking for challenging txt...\n"); -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + 4 + _AUTH_IE_OFFSET_ , _CHLGETXT_IE_, (int *)&ie_len, -+ len - WLAN_HDR_A3_LEN - _AUTH_IE_OFFSET_ - 4); -+ -+ if((p==NULL) || (ie_len<=0)) -+ { -+ DBG_871X("auth rejected because challenge failure!(1)\n"); -+ status = _STATS_CHALLENGE_FAIL_; -+ goto auth_fail; -+ } -+ -+ if (_rtw_memcmp((void *)(p + 2), pstat->chg_txt, 128)) -+ { -+ pstat->state &= (~WIFI_FW_AUTH_STATE); -+ pstat->state |= WIFI_FW_AUTH_SUCCESS; -+ // challenging txt is correct... -+ pstat->expire_to = pstapriv->assoc_to; -+ } -+ else -+ { -+ DBG_871X("auth rejected because challenge failure!\n"); -+ status = _STATS_CHALLENGE_FAIL_; -+ goto auth_fail; -+ } -+ } -+ else -+ { -+ DBG_871X("(3)auth rejected because out of seq [rx_seq=%d, exp_seq=%d]!\n", -+ seq, pstat->auth_seq+1); -+ status = _STATS_OUT_OF_AUTH_SEQ_; -+ goto auth_fail; -+ } -+ } -+ -+ -+ // Now, we are going to issue_auth... -+ pstat->auth_seq = seq + 1; -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ issue_auth(padapter, pstat, (unsigned short)(_STATS_SUCCESSFUL_)); -+#endif -+ -+ if (pstat->state & WIFI_FW_AUTH_SUCCESS) -+ pstat->auth_seq = 0; -+ -+ -+ return _SUCCESS; -+ -+auth_fail: -+ -+ if(pstat) -+ rtw_free_stainfo(padapter , pstat); -+ -+ pstat = &stat; -+ _rtw_memset((char *)pstat, '\0', sizeof(stat)); -+ pstat->auth_seq = 2; -+ _rtw_memcpy(pstat->hwaddr, sa, 6); -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ issue_auth(padapter, pstat, (unsigned short)status); -+#endif -+ -+#endif -+ return _FAIL; -+ -+} -+ -+unsigned int OnAuthClient(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int seq, len, status, algthm, offset; -+ unsigned char *p; -+ unsigned int go2asoc = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint pkt_len = precv_frame->u.hdr.len; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ //check A1 matches or not -+ if (!_rtw_memcmp(myid(&(padapter->eeprompriv)), get_da(pframe), ETH_ALEN)) -+ return _SUCCESS; -+ -+ if (!(pmlmeinfo->state & WIFI_FW_AUTH_STATE)) -+ return _SUCCESS; -+ -+ offset = (GetPrivacy(pframe))? 4: 0; -+ -+ algthm = le16_to_cpu(*(__le16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset)); -+ seq = le16_to_cpu(*(__le16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 2)); -+ status = le16_to_cpu(*(__le16 *)((SIZE_PTR)pframe + WLAN_HDR_A3_LEN + offset + 4)); -+ -+ if (status != 0) -+ { -+ DBG_871X("clnt auth fail, status: %d\n", status); -+ if(status == 13)//&& pmlmeinfo->auth_algo == dot11AuthAlgrthm_Auto) -+ { -+ if(pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) -+ pmlmeinfo->auth_algo = dot11AuthAlgrthm_Open; -+ else -+ pmlmeinfo->auth_algo = dot11AuthAlgrthm_Shared; -+ //pmlmeinfo->reauth_count = 0; -+ } -+ -+ set_link_timer(pmlmeext, 1); -+ goto authclnt_fail; -+ } -+ -+ if (seq == 2) -+ { -+ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) -+ { -+ // legendary shared system -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _AUTH_IE_OFFSET_, _CHLGETXT_IE_, (int *)&len, -+ pkt_len - WLAN_HDR_A3_LEN - _AUTH_IE_OFFSET_); -+ -+ if (p == NULL) -+ { -+ //DBG_871X("marc: no challenge text?\n"); -+ goto authclnt_fail; -+ } -+ -+ _rtw_memcpy((void *)(pmlmeinfo->chg_txt), (void *)(p + 2), len); -+ pmlmeinfo->auth_seq = 3; -+ issue_auth(padapter, NULL, 0); -+ set_link_timer(pmlmeext, REAUTH_TO); -+ -+ return _SUCCESS; -+ } -+ else -+ { -+ // open system -+ go2asoc = 1; -+ } -+ } -+ else if (seq == 4) -+ { -+ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared) -+ { -+ go2asoc = 1; -+ } -+ else -+ { -+ goto authclnt_fail; -+ } -+ } -+ else -+ { -+ // this is also illegal -+ //DBG_871X("marc: clnt auth failed due to illegal seq=%x\n", seq); -+ goto authclnt_fail; -+ } -+ -+ if (go2asoc) -+ { -+ DBG_871X_LEVEL(_drv_always_, "auth success, start assoc\n"); -+ start_clnt_assoc(padapter); -+ return _SUCCESS; -+ } -+ -+authclnt_fail: -+ -+ //pmlmeinfo->state &= ~(WIFI_FW_AUTH_STATE); -+ -+ return _FAIL; -+ -+} -+ -+unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_AP_MODE -+ _irqL irqL; -+ u16 capab_info, listen_interval; -+ struct rtw_ieee802_11_elems elems; -+ struct sta_info *pstat; -+ unsigned char reassoc, *p, *pos, *wpa_ie; -+ unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01}; -+ int i, ie_len, wpa_ie_len, left; -+ unsigned char supportRate[16]; -+ int supportRateNum; -+ unsigned short status = _STATS_SUCCESSFUL_; -+ unsigned short frame_type, ie_offset=0; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur = &(pmlmeinfo->network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint pkt_len = precv_frame->u.hdr.len; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 p2p_status_code = P2P_STATUS_SUCCESS; -+ u8 *p2pie; -+ u32 p2pielen = 0; -+#ifdef CONFIG_WFD -+ u8 wfd_ie[ 128 ] = { 0x00 }; -+ u32 wfd_ielen = 0; -+#endif // CONFIG_WFD -+#endif //CONFIG_P2P -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) && -+ check_buddy_fwstate(padapter, _FW_UNDER_LINKING|_FW_UNDER_SURVEY)) -+ { -+ //don't process assoc request; -+ return _SUCCESS; -+ } -+#endif //CONFIG_CONCURRENT_MODE -+ -+ if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ return _FAIL; -+ -+ frame_type = GetFrameSubType(pframe); -+ if (frame_type == WIFI_ASSOCREQ) -+ { -+ reassoc = 0; -+ ie_offset = _ASOCREQ_IE_OFFSET_; -+ } -+ else // WIFI_REASSOCREQ -+ { -+ reassoc = 1; -+ ie_offset = _REASOCREQ_IE_OFFSET_; -+ } -+ -+ -+ if (pkt_len < IEEE80211_3ADDR_LEN + ie_offset) { -+ DBG_871X("handle_assoc(reassoc=%d) - too short payload (len=%lu)" -+ "\n", reassoc, (unsigned long)pkt_len); -+ return _FAIL; -+ } -+ -+ pstat = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if (pstat == (struct sta_info *)NULL) -+ { -+ status = _RSON_CLS2_; -+ goto asoc_class2_error; -+ } -+ -+ capab_info = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN); -+ //capab_info = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); -+ //listen_interval = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN+2)); -+ listen_interval = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN+2); -+ -+ left = pkt_len - (IEEE80211_3ADDR_LEN + ie_offset); -+ pos = pframe + (IEEE80211_3ADDR_LEN + ie_offset); -+ -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ // check if this stat has been successfully authenticated/assocated -+ if (!((pstat->state) & WIFI_FW_AUTH_SUCCESS)) -+ { -+ if (!((pstat->state) & WIFI_FW_ASSOC_SUCCESS)) -+ { -+ status = _RSON_CLS2_; -+ goto asoc_class2_error; -+ } -+ else -+ { -+ pstat->state &= (~WIFI_FW_ASSOC_SUCCESS); -+ pstat->state |= WIFI_FW_ASSOC_STATE; -+ } -+ } -+ else -+ { -+ pstat->state &= (~WIFI_FW_AUTH_SUCCESS); -+ pstat->state |= WIFI_FW_ASSOC_STATE; -+ } -+ -+ -+#if 0// todo:tkip_countermeasures -+ if (hapd->tkip_countermeasures) { -+ resp = WLAN_REASON_MICHAEL_MIC_FAILURE; -+ goto fail; -+ } -+#endif -+ -+ pstat->capability = capab_info; -+ -+#if 0//todo: -+ //check listen_interval -+ if (listen_interval > hapd->conf->max_listen_interval) { -+ hostapd_logger(hapd, mgmt->sa, HOSTAPD_MODULE_IEEE80211, -+ HOSTAPD_LEVEL_DEBUG, -+ "Too large Listen Interval (%d)", -+ listen_interval); -+ resp = WLAN_STATUS_ASSOC_DENIED_LISTEN_INT_TOO_LARGE; -+ goto fail; -+ } -+ -+ pstat->listen_interval = listen_interval; -+#endif -+ -+ //now parse all ieee802_11 ie to point to elems -+ if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed || -+ !elems.ssid) { -+ DBG_871X("STA " MAC_FMT " sent invalid association request\n", -+ MAC_ARG(pstat->hwaddr)); -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } -+ -+ -+ // now we should check all the fields... -+ // checking SSID -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + ie_offset, _SSID_IE_, &ie_len, -+ pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ if (p == NULL) -+ { -+ status = _STATS_FAILURE_; -+ } -+ -+ if (ie_len == 0) // broadcast ssid, however it is not allowed in assocreq -+ status = _STATS_FAILURE_; -+ else -+ { -+ // check if ssid match -+ if (!_rtw_memcmp((void *)(p+2), cur->Ssid.Ssid, cur->Ssid.SsidLength)) -+ status = _STATS_FAILURE_; -+ -+ if (ie_len != cur->Ssid.SsidLength) -+ status = _STATS_FAILURE_; -+ } -+ -+ if(_STATS_SUCCESSFUL_ != status) -+ goto OnAssocReqFail; -+ -+ // check if the supported rate is ok -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + ie_offset, _SUPPORTEDRATES_IE_, &ie_len, pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ if (p == NULL) { -+ DBG_871X("Rx a sta assoc-req which supported rate is empty!\n"); -+ // use our own rate set as statoin used -+ //_rtw_memcpy(supportRate, AP_BSSRATE, AP_BSSRATE_LEN); -+ //supportRateNum = AP_BSSRATE_LEN; -+ -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } -+ else { -+ _rtw_memcpy(supportRate, p+2, ie_len); -+ supportRateNum = ie_len; -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + ie_offset, _EXT_SUPPORTEDRATES_IE_ , &ie_len, -+ pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ if (p != NULL) { -+ -+ if(supportRateNum<=sizeof(supportRate)) -+ { -+ _rtw_memcpy(supportRate+supportRateNum, p+2, ie_len); -+ supportRateNum += ie_len; -+ } -+ } -+ } -+ -+ //todo: mask supportRate between AP & STA -> move to update raid -+ //get_matched_rate(pmlmeext, supportRate, &supportRateNum, 0); -+ -+ //update station supportRate -+ pstat->bssratelen = supportRateNum; -+ _rtw_memcpy(pstat->bssrateset, supportRate, supportRateNum); -+ UpdateBrateTblForSoftAP(pstat->bssrateset, pstat->bssratelen); -+ -+ //check RSN/WPA/WPS -+ pstat->dot8021xalg = 0; -+ pstat->wpa_psk = 0; -+ pstat->wpa_group_cipher = 0; -+ pstat->wpa2_group_cipher = 0; -+ pstat->wpa_pairwise_cipher = 0; -+ pstat->wpa2_pairwise_cipher = 0; -+ _rtw_memset(pstat->wpa_ie, 0, sizeof(pstat->wpa_ie)); -+ if((psecuritypriv->wpa_psk & BIT(1)) && elems.rsn_ie) { -+ -+ int group_cipher=0, pairwise_cipher=0; -+ -+ wpa_ie = elems.rsn_ie; -+ wpa_ie_len = elems.rsn_ie_len; -+ -+ if(rtw_parse_wpa2_ie(wpa_ie-2, wpa_ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ pstat->dot8021xalg = 1;//psk, todo:802.1x -+ pstat->wpa_psk |= BIT(1); -+ -+ pstat->wpa2_group_cipher = group_cipher&psecuritypriv->wpa2_group_cipher; -+ pstat->wpa2_pairwise_cipher = pairwise_cipher&psecuritypriv->wpa2_pairwise_cipher; -+ -+ if(!pstat->wpa2_group_cipher) -+ status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; -+ -+ if(!pstat->wpa2_pairwise_cipher) -+ status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; -+ } -+ else -+ { -+ status = WLAN_STATUS_INVALID_IE; -+ } -+ -+ } else if ((psecuritypriv->wpa_psk & BIT(0)) && elems.wpa_ie) { -+ -+ int group_cipher=0, pairwise_cipher=0; -+ -+ wpa_ie = elems.wpa_ie; -+ wpa_ie_len = elems.wpa_ie_len; -+ -+ if(rtw_parse_wpa_ie(wpa_ie-2, wpa_ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ pstat->dot8021xalg = 1;//psk, todo:802.1x -+ pstat->wpa_psk |= BIT(0); -+ -+ pstat->wpa_group_cipher = group_cipher&psecuritypriv->wpa_group_cipher; -+ pstat->wpa_pairwise_cipher = pairwise_cipher&psecuritypriv->wpa_pairwise_cipher; -+ -+ if(!pstat->wpa_group_cipher) -+ status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; -+ -+ if(!pstat->wpa_pairwise_cipher) -+ status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; -+ -+ } -+ else -+ { -+ status = WLAN_STATUS_INVALID_IE; -+ } -+ -+ } else { -+ wpa_ie = NULL; -+ wpa_ie_len = 0; -+ } -+ -+ if(_STATS_SUCCESSFUL_ != status) -+ goto OnAssocReqFail; -+ -+ pstat->flags &= ~(WLAN_STA_WPS | WLAN_STA_MAYBE_WPS); -+ //if (hapd->conf->wps_state && wpa_ie == NULL) { //todo: to check ap if supporting WPS -+ if(wpa_ie == NULL) { -+ if (elems.wps_ie) { -+ DBG_871X("STA included WPS IE in " -+ "(Re)Association Request - assume WPS is " -+ "used\n"); -+ pstat->flags |= WLAN_STA_WPS; -+ //wpabuf_free(sta->wps_ie); -+ //sta->wps_ie = wpabuf_alloc_copy(elems.wps_ie + 4, -+ // elems.wps_ie_len - 4); -+ } else { -+ DBG_871X("STA did not include WPA/RSN IE " -+ "in (Re)Association Request - possible WPS " -+ "use\n"); -+ pstat->flags |= WLAN_STA_MAYBE_WPS; -+ } -+ -+ -+ // AP support WPA/RSN, and sta is going to do WPS, but AP is not ready -+ // that the selected registrar of AP is _FLASE -+ if((psecuritypriv->wpa_psk >0) -+ && (pstat->flags & (WLAN_STA_WPS|WLAN_STA_MAYBE_WPS))) -+ { -+ if(pmlmepriv->wps_beacon_ie) -+ { -+ u8 selected_registrar = 0; -+ -+ rtw_get_wps_attr_content(pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len, WPS_ATTR_SELECTED_REGISTRAR , &selected_registrar, NULL); -+ -+ if(!selected_registrar) -+ { -+ DBG_871X("selected_registrar is false , or AP is not ready to do WPS\n"); -+ -+ status = _STATS_UNABLE_HANDLE_STA_; -+ -+ goto OnAssocReqFail; -+ } -+ } -+ } -+ -+ } -+ else -+ { -+ int copy_len; -+ -+ if(psecuritypriv->wpa_psk == 0) -+ { -+ DBG_871X("STA " MAC_FMT ": WPA/RSN IE in association " -+ "request, but AP don't support WPA/RSN\n", MAC_ARG(pstat->hwaddr)); -+ -+ status = WLAN_STATUS_INVALID_IE; -+ -+ goto OnAssocReqFail; -+ -+ } -+ -+ if (elems.wps_ie) { -+ DBG_871X("STA included WPS IE in " -+ "(Re)Association Request - WPS is " -+ "used\n"); -+ pstat->flags |= WLAN_STA_WPS; -+ copy_len=0; -+ } -+ else -+ { -+ copy_len = ((wpa_ie_len+2) > sizeof(pstat->wpa_ie)) ? (sizeof(pstat->wpa_ie)):(wpa_ie_len+2); -+ } -+ -+ -+ if(copy_len>0) -+ _rtw_memcpy(pstat->wpa_ie, wpa_ie-2, copy_len); -+ -+ } -+ -+ -+ // check if there is WMM IE & support WWM-PS -+ pstat->flags &= ~WLAN_STA_WME; -+ pstat->qos_option = 0; -+ pstat->qos_info = 0; -+ pstat->has_legacy_ac = true; -+ pstat->uapsd_vo = 0; -+ pstat->uapsd_vi = 0; -+ pstat->uapsd_be = 0; -+ pstat->uapsd_bk = 0; -+ if (pmlmepriv->qospriv.qos_option) -+ { -+ p = pframe + WLAN_HDR_A3_LEN + ie_offset; ie_len = 0; -+ for (;;) -+ { -+ p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, pkt_len - WLAN_HDR_A3_LEN - ie_offset); -+ if (p != NULL) { -+ if (_rtw_memcmp(p+2, WMM_IE, 6)) { -+ -+ pstat->flags |= WLAN_STA_WME; -+ -+ pstat->qos_option = 1; -+ pstat->qos_info = *(p+8); -+ -+ pstat->max_sp_len = (pstat->qos_info>>5)&0x3; -+ -+ if((pstat->qos_info&0xf) !=0xf) -+ pstat->has_legacy_ac = true; -+ else -+ pstat->has_legacy_ac = false; -+ -+ if(pstat->qos_info&0xf) -+ { -+ if(pstat->qos_info&BIT(0)) -+ pstat->uapsd_vo = BIT(0)|BIT(1); -+ else -+ pstat->uapsd_vo = 0; -+ -+ if(pstat->qos_info&BIT(1)) -+ pstat->uapsd_vi = BIT(0)|BIT(1); -+ else -+ pstat->uapsd_vi = 0; -+ -+ if(pstat->qos_info&BIT(2)) -+ pstat->uapsd_bk = BIT(0)|BIT(1); -+ else -+ pstat->uapsd_bk = 0; -+ -+ if(pstat->qos_info&BIT(3)) -+ pstat->uapsd_be = BIT(0)|BIT(1); -+ else -+ pstat->uapsd_be = 0; -+ -+ } -+ -+ break; -+ } -+ } -+ else { -+ break; -+ } -+ p = p + ie_len + 2; -+ } -+ } -+ -+ -+#ifdef CONFIG_80211N_HT -+ /* save HT capabilities in the sta object */ -+ _rtw_memset(&pstat->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); -+ if (elems.ht_capabilities && elems.ht_capabilities_len >= sizeof(struct rtw_ieee80211_ht_cap)) -+ { -+ pstat->flags |= WLAN_STA_HT; -+ -+ pstat->flags |= WLAN_STA_WME; -+ -+ _rtw_memcpy(&pstat->htpriv.ht_cap, elems.ht_capabilities, sizeof(struct rtw_ieee80211_ht_cap)); -+ -+ } else -+ pstat->flags &= ~WLAN_STA_HT; -+ -+ -+ if((pmlmepriv->htpriv.ht_option == false) && (pstat->flags&WLAN_STA_HT)) -+ { -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } -+ -+ -+ if ((pstat->flags & WLAN_STA_HT) && -+ ((pstat->wpa2_pairwise_cipher&WPA_CIPHER_TKIP) || -+ (pstat->wpa_pairwise_cipher&WPA_CIPHER_TKIP))) -+ { -+ DBG_871X("HT: " MAC_FMT " tried to " -+ "use TKIP with HT association\n", MAC_ARG(pstat->hwaddr)); -+ -+ //status = WLAN_STATUS_CIPHER_REJECTED_PER_POLICY; -+ //goto OnAssocReqFail; -+ } -+#endif /* CONFIG_80211N_HT */ -+ -+#ifdef CONFIG_80211AC_VHT -+ _rtw_memset(&pstat->vhtpriv, 0, sizeof(struct vht_priv)); -+ if (elems.vht_capabilities && elems.vht_capabilities_len == 12) { -+ pstat->flags |= WLAN_STA_VHT; -+ -+ _rtw_memcpy(pstat->vhtpriv.vht_cap, elems.vht_capabilities, 12); -+ -+ if (elems.vht_op_mode_notify && elems.vht_op_mode_notify_len == 1) { -+ pstat->vhtpriv.bwmode = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(elems.vht_op_mode_notify); -+ } -+ } -+ else { -+ pstat->flags &= ~WLAN_STA_HT; -+ } -+ -+ if((pmlmepriv->vhtpriv.vht_option == false) && (pstat->flags&WLAN_STA_VHT)) -+ { -+ status = _STATS_FAILURE_; -+ goto OnAssocReqFail; -+ } -+#endif /* CONFIG_80211AC_VHT */ -+ -+ // -+ //if (hapd->iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G)//? -+ pstat->flags |= WLAN_STA_NONERP; -+ for (i = 0; i < pstat->bssratelen; i++) { -+ if ((pstat->bssrateset[i] & 0x7f) > 22) { -+ pstat->flags &= ~WLAN_STA_NONERP; -+ break; -+ } -+ } -+ -+ if (pstat->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) -+ pstat->flags |= WLAN_STA_SHORT_PREAMBLE; -+ else -+ pstat->flags &= ~WLAN_STA_SHORT_PREAMBLE; -+ -+ -+ -+ if (status != _STATS_SUCCESSFUL_) -+ goto OnAssocReqFail; -+ -+#ifdef CONFIG_P2P -+ pstat->is_p2p_device = false; -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ if( (p2pie=rtw_get_p2p_ie(pframe + WLAN_HDR_A3_LEN + ie_offset , pkt_len - WLAN_HDR_A3_LEN - ie_offset , NULL, &p2pielen))) -+ { -+ pstat->is_p2p_device = true; -+ if((p2p_status_code=(u8)process_assoc_req_p2p_ie(pwdinfo, pframe, pkt_len, pstat))>0) -+ { -+ pstat->p2p_status_code = p2p_status_code; -+ status = _STATS_CAP_FAIL_; -+ goto OnAssocReqFail; -+ } -+ } -+#ifdef CONFIG_WFD -+ if(rtw_get_wfd_ie(pframe + WLAN_HDR_A3_LEN + ie_offset , pkt_len - WLAN_HDR_A3_LEN - ie_offset , wfd_ie, &wfd_ielen )) -+ { -+ u8 attr_content[ 10 ] = { 0x00 }; -+ u32 attr_contentlen = 0; -+ -+ DBG_8192C( "[%s] WFD IE Found!!\n", __FUNCTION__ ); -+ rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, attr_content, &attr_contentlen); -+ if ( attr_contentlen ) -+ { -+ pwdinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16( attr_content + 2 ); -+ DBG_8192C( "[%s] Peer PORT NUM = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_rtsp_ctrlport ); -+ } -+ } -+#endif -+ } -+ pstat->p2p_status_code = p2p_status_code; -+#endif //CONFIG_P2P -+ -+ //TODO: identify_proprietary_vendor_ie(); -+ // Realtek proprietary IE -+ // identify if this is Broadcom sta -+ // identify if this is ralink sta -+ // Customer proprietary IE -+ -+ -+ -+ /* get a unique AID */ -+ if (pstat->aid > 0) { -+ DBG_871X(" old AID %d\n", pstat->aid); -+ } else { -+ for (pstat->aid = 1; pstat->aid <= NUM_STA; pstat->aid++) -+ if (pstapriv->sta_aid[pstat->aid - 1] == NULL) -+ break; -+ -+ //if (pstat->aid > NUM_STA) { -+ if (pstat->aid > pstapriv->max_num_sta) { -+ -+ pstat->aid = 0; -+ -+ DBG_871X(" no room for more AIDs\n"); -+ -+ status = WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA; -+ -+ goto OnAssocReqFail; -+ -+ -+ } else { -+ pstapriv->sta_aid[pstat->aid - 1] = pstat; -+ DBG_871X("allocate new AID = (%d)\n", pstat->aid); -+ } -+ } -+ -+ -+ pstat->state &= (~WIFI_FW_ASSOC_STATE); -+ pstat->state |= WIFI_FW_ASSOC_SUCCESS; -+ -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ if (!rtw_is_list_empty(&pstat->auth_list)) -+ { -+ rtw_list_delete(&pstat->auth_list); -+ pstapriv->auth_list_cnt--; -+ } -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if (rtw_is_list_empty(&pstat->asoc_list)) -+ { -+ pstat->expire_to = pstapriv->expire_to; -+ rtw_list_insert_tail(&pstat->asoc_list, &pstapriv->asoc_list); -+ pstapriv->asoc_list_cnt++; -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ // now the station is qualified to join our BSS... -+ if(pstat && (pstat->state & WIFI_FW_ASSOC_SUCCESS) && (_STATS_SUCCESSFUL_==status)) -+ { -+#ifdef CONFIG_NATIVEAP_MLME -+ //.1 bss_cap_update & sta_info_update -+ bss_cap_update_on_sta_join(padapter, pstat); -+ sta_info_update(padapter, pstat); -+ -+ //issue assoc rsp before notify station join event. -+ if (frame_type == WIFI_ASSOCREQ) -+ issue_asocrsp(padapter, status, pstat, WIFI_ASSOCRSP); -+ else -+ issue_asocrsp(padapter, status, pstat, WIFI_REASSOCRSP); -+ -+ //.2 - report to upper layer -+ DBG_871X("indicate_sta_join_event to upper layer - hostapd\n"); -+#ifdef CONFIG_IOCTL_CFG80211 -+ #ifdef COMPAT_KERNEL_RELEASE -+ rtw_cfg80211_indicate_sta_assoc(padapter, pframe, pkt_len); -+ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ rtw_cfg80211_indicate_sta_assoc(padapter, pframe, pkt_len); -+ #else //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ _enter_critical_bh(&pstat->lock, &irqL); -+ if(pstat->passoc_req) -+ { -+ rtw_mfree(pstat->passoc_req, pstat->assoc_req_len); -+ pstat->passoc_req = NULL; -+ pstat->assoc_req_len = 0; -+ } -+ -+ pstat->passoc_req = rtw_zmalloc(pkt_len); -+ if(pstat->passoc_req) -+ { -+ _rtw_memcpy(pstat->passoc_req, pframe, pkt_len); -+ pstat->assoc_req_len = pkt_len; -+ } -+ _exit_critical_bh(&pstat->lock, &irqL); -+ #endif //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+#else -+ rtw_indicate_sta_assoc_event(padapter, pstat); -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ //.3-(1) report sta add event -+ report_add_sta_event(padapter, pstat->hwaddr, pstat->aid); -+ -+/* -+ //issue assoc rsp before notify station join event. -+ if (frame_type == WIFI_ASSOCREQ) -+ issue_asocrsp(padapter, status, pstat, WIFI_ASSOCRSP); -+ else -+ issue_asocrsp(padapter, status, pstat, WIFI_REASSOCRSP); -+*/ -+ -+#endif -+ } -+ -+ return _SUCCESS; -+ -+asoc_class2_error: -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ issue_deauth(padapter, (void *)GetAddr2Ptr(pframe), status); -+#endif -+ -+ return _FAIL; -+ -+OnAssocReqFail: -+ -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ pstat->aid = 0; -+ if (frame_type == WIFI_ASSOCREQ) -+ issue_asocrsp(padapter, status, pstat, WIFI_ASSOCRSP); -+ else -+ issue_asocrsp(padapter, status, pstat, WIFI_REASSOCRSP); -+#endif -+ -+ -+#endif /* CONFIG_AP_MODE */ -+ -+ return _FAIL; -+ -+} -+ -+unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ uint i; -+ int res; -+ unsigned short status; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ //WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint pkt_len = precv_frame->u.hdr.len; -+ PNDIS_802_11_VARIABLE_IEs pWapiIE = NULL; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ //check A1 matches or not -+ if (!_rtw_memcmp(myid(&(padapter->eeprompriv)), get_da(pframe), ETH_ALEN)) -+ return _SUCCESS; -+ -+ if (!(pmlmeinfo->state & (WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE))) -+ return _SUCCESS; -+ -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ return _SUCCESS; -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ //status -+ if ((status = le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN + 2))) > 0) -+ { -+ DBG_871X("assoc reject, status code: %d\n", status); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ res = -4; -+ goto report_assoc_result; -+ } -+ -+ //get capabilities -+ pmlmeinfo->capability = le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN)); -+ -+ //set slot time -+ pmlmeinfo->slotTime = (pmlmeinfo->capability & BIT(10))? 9: 20; -+ -+ //AID -+ res = pmlmeinfo->aid = (int)(le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN + 4))&0x3fff); -+ -+ //following are moved to join event callback function -+ //to handle HT, WMM, rate adaptive, update MAC reg -+ //for not to handle the synchronous IO in the tasklet -+ for (i = (6 + WLAN_HDR_A3_LEN); i < pkt_len;) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + i); -+ -+ switch (pIE->ElementID) -+ { -+ case _VENDOR_SPECIFIC_IE_: -+ if (_rtw_memcmp(pIE->data, WMM_PARA_OUI, 6)) //WMM -+ { -+ WMM_param_handler(padapter, pIE); -+ } -+#if defined(CONFIG_P2P) && defined(CONFIG_WFD) -+ else if ( _rtw_memcmp(pIE->data, WFD_OUI, 4)) //WFD -+ { -+ DBG_871X( "[%s] Found WFD IE\n", __FUNCTION__ ); -+ WFD_info_handler( padapter, pIE ); -+ } -+#endif -+ break; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ case _WAPI_IE_: -+ pWapiIE = pIE; -+ break; -+#endif -+ -+ case _HT_CAPABILITY_IE_: //HT caps -+ HT_caps_handler(padapter, pIE); -+ break; -+ -+ case _HT_EXTRA_INFO_IE_: //HT info -+ HT_info_handler(padapter, pIE); -+ break; -+ -+#ifdef CONFIG_80211AC_VHT -+ case EID_VHTCapability: -+ VHT_caps_handler(padapter, pIE); -+ break; -+ -+ case EID_VHTOperation: -+ VHT_operation_handler(padapter, pIE); -+ break; -+#endif -+ -+ case _ERPINFO_IE_: -+ ERP_IE_handler(padapter, pIE); -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_on_assoc_ok(padapter, pIE); -+#endif -+ -+ pmlmeinfo->state &= (~WIFI_FW_ASSOC_STATE); -+ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ -+ //Update Basic Rate Table for spec, 2010-12-28 , by thomas -+ UpdateBrateTbl(padapter, pmlmeinfo->network.SupportedRates); -+ -+report_assoc_result: -+ if (res > 0) { -+ rtw_buf_update(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len, pframe, pkt_len); -+ } else { -+ rtw_buf_free(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len); -+ } -+ -+ report_join_res(padapter, res); -+ -+ return _SUCCESS; -+} -+ -+unsigned int OnDeAuth(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned short reason; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif //CONFIG_P2P -+ -+ //check A3 -+ if (!(_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) -+ return _SUCCESS; -+ -+#ifdef CONFIG_P2P -+ if ( pwdinfo->rx_invitereq_info.scan_op_ch_only ) -+ { -+ _cancel_timer_ex( &pwdinfo->reset_ch_sitesurvey ); -+ _set_timer( &pwdinfo->reset_ch_sitesurvey, 10 ); -+ } -+#endif //CONFIG_P2P -+ -+ reason = le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN)); -+ -+ DBG_871X("%s Reason code(%d)\n", __FUNCTION__,reason); -+ -+#ifdef CONFIG_AP_MODE -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ _irqL irqL; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ //rtw_free_stainfo(padapter, psta); -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ DBG_871X_LEVEL(_drv_always_, "ap recv deauth reason code(%d) sta:%pM\n", -+ reason, GetAddr2Ptr(pframe)); -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if(psta) -+ { -+ u8 updated; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if(rtw_is_list_empty(&psta->asoc_list)==false) -+ { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, false, reason); -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(padapter, updated); -+ } -+ -+ -+ return _SUCCESS; -+ } -+ else -+#endif -+ { -+ DBG_871X_LEVEL(_drv_always_, "sta recv deauth reason code(%d) sta:%pM\n", -+ reason, GetAddr3Ptr(pframe)); -+ -+ receive_disconnect(padapter, GetAddr3Ptr(pframe) ,reason); -+ } -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = false; -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnDisassoc(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned short reason; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif //CONFIG_P2P -+ -+ //check A3 -+ if (!(_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) -+ return _SUCCESS; -+ -+#ifdef CONFIG_P2P -+ if ( pwdinfo->rx_invitereq_info.scan_op_ch_only ) -+ { -+ _cancel_timer_ex( &pwdinfo->reset_ch_sitesurvey ); -+ _set_timer( &pwdinfo->reset_ch_sitesurvey, 10 ); -+ } -+#endif //CONFIG_P2P -+ -+ reason = le16_to_cpu(*(__le16 *)(pframe + WLAN_HDR_A3_LEN)); -+ -+ DBG_871X("%s Reason code(%d)\n", __FUNCTION__,reason); -+ -+#ifdef CONFIG_AP_MODE -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ _irqL irqL; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ //rtw_free_stainfo(padapter, psta); -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ DBG_871X_LEVEL(_drv_always_, "ap recv disassoc reason code(%d) sta:%pM\n", -+ reason, GetAddr2Ptr(pframe)); -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ if(psta) -+ { -+ u8 updated; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if(rtw_is_list_empty(&psta->asoc_list)==false) -+ { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, false, reason); -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(padapter, updated); -+ } -+ -+ return _SUCCESS; -+ } -+ else -+#endif -+ { -+ DBG_871X_LEVEL(_drv_always_, "ap recv disassoc reason code(%d) sta:%pM\n", -+ reason, GetAddr3Ptr(pframe)); -+ -+ receive_disconnect(padapter, GetAddr3Ptr(pframe), reason); -+ } -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = false; -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnAtim(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ return _SUCCESS; -+} -+ -+static unsigned int on_action_spct_ch_switch(_adapter *padapter, struct sta_info *psta, u8 *ies, uint ies_len) -+{ -+ unsigned int ret = _FAIL; -+ struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(mlmeext->mlmext_info); -+ -+ if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { -+ ret = _SUCCESS; -+ goto exit; -+ } -+ -+ if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { -+ -+ int ch_switch_mode = -1, ch = -1, ch_switch_cnt = -1; -+ int ch_offset = -1; -+ u8 bwmode; -+ struct ieee80211_info_element *ie; -+ -+ DBG_871X(FUNC_NDEV_FMT" from "MAC_FMT"\n", -+ FUNC_NDEV_ARG(padapter->pnetdev), MAC_ARG(psta->hwaddr)); -+ -+ for_each_ie(ie, ies, ies_len) { -+ if (ie->id == WLAN_EID_CHANNEL_SWITCH) { -+ ch_switch_mode = ie->data[0]; -+ ch = ie->data[1]; -+ ch_switch_cnt = ie->data[2]; -+ DBG_871X("ch_switch_mode:%d, ch:%d, ch_switch_cnt:%d\n", -+ ch_switch_mode, ch, ch_switch_cnt); -+ } -+ else if (ie->id == WLAN_EID_SECONDARY_CHANNEL_OFFSET) { -+ ch_offset = secondary_ch_offset_to_hal_ch_offset(ie->data[0]); -+ DBG_871X("ch_offset:%d\n", ch_offset); -+ } -+ } -+ -+ if (ch == -1) -+ return _SUCCESS; -+ -+ if (ch_offset == -1) -+ bwmode = mlmeext->cur_bwmode; -+ else -+ bwmode = (ch_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) ? -+ CHANNEL_WIDTH_20 : CHANNEL_WIDTH_40; -+ -+ ch_offset = (ch_offset == -1) ? mlmeext->cur_ch_offset : ch_offset; -+ -+ /* todo: -+ * 1. the decision of channel switching -+ * 2. things after channel switching -+ */ -+ -+ ret = rtw_set_ch_cmd(padapter, ch, bwmode, ch_offset, true); -+ } -+ -+exit: -+ return ret; -+} -+ -+unsigned int on_action_spct(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int ret = _FAIL; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ u8 *frame_body = (u8 *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ u8 category; -+ u8 action; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); -+ -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ -+ if (!psta) -+ goto exit; -+ -+ category = frame_body[0]; -+ if(category != RTW_WLAN_CATEGORY_SPECTRUM_MGMT) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case RTW_WLAN_ACTION_SPCT_MSR_REQ: -+ case RTW_WLAN_ACTION_SPCT_MSR_RPRT: -+ case RTW_WLAN_ACTION_SPCT_TPC_REQ: -+ case RTW_WLAN_ACTION_SPCT_TPC_RPRT: -+ break; -+ case RTW_WLAN_ACTION_SPCT_CHL_SWITCH: -+ #ifdef CONFIG_SPCT_CH_SWITCH -+ ret = on_action_spct_ch_switch(padapter, psta, &frame_body[2], -+ frame_len-(frame_body-pframe)-2); -+ #endif -+ break; -+ default: -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+unsigned int OnAction_qos(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ return _SUCCESS; -+} -+ -+unsigned int OnAction_dls(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ return _SUCCESS; -+} -+ -+unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ u8 *addr; -+ struct sta_info *psta=NULL; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ unsigned char *frame_body; -+ unsigned char category, action; -+ unsigned short tid, status, reason_code = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+#ifdef CONFIG_80211N_HT -+ //check RA matches or not -+ if (!_rtw_memcmp(myid(&(padapter->eeprompriv)), GetAddr1Ptr(pframe), ETH_ALEN))//for if1, sta/ap mode -+ return _SUCCESS; -+ -+/* -+ //check A1 matches or not -+ if (!_rtw_memcmp(myid(&(padapter->eeprompriv)), get_da(pframe), ETH_ALEN)) -+ return _SUCCESS; -+*/ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) -+ return _SUCCESS; -+ -+ addr = GetAddr2Ptr(pframe); -+ psta = rtw_get_stainfo(pstapriv, addr); -+ -+ if(psta==NULL) -+ return _SUCCESS; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ category = frame_body[0]; -+ if (category == RTW_WLAN_CATEGORY_BACK)// representing Block Ack -+ { -+#ifdef CONFIG_TDLS -+ if((psta->tdls_sta_state & TDLS_LINKED_STATE) && -+ (psta->htpriv.ht_option==true) && -+ (psta->htpriv.ampdu_enable==true) ) -+ { -+ //do nothing; just don't want to return _SUCCESS; -+ } -+ else -+#endif //CONFIG_TDLS -+ if (!pmlmeinfo->HT_enable) -+ { -+ return _SUCCESS; -+ } -+ -+ action = frame_body[1]; -+ DBG_871X("%s, action=%d\n", __FUNCTION__, action); -+ switch (action) -+ { -+ case RTW_WLAN_ACTION_ADDBA_REQ: //ADDBA request -+ -+ _rtw_memcpy(&(pmlmeinfo->ADDBA_req), &(frame_body[2]), sizeof(struct ADDBA_request)); -+ //process_addba_req(padapter, (u8*)&(pmlmeinfo->ADDBA_req), GetAddr3Ptr(pframe)); -+ process_addba_req(padapter, (u8*)&(pmlmeinfo->ADDBA_req), addr); -+ -+ if(pmlmeinfo->bAcceptAddbaReq == true) -+ { -+ issue_action_BA(padapter, addr, RTW_WLAN_ACTION_ADDBA_RESP, 0); -+ } -+ else -+ { -+ issue_action_BA(padapter, addr, RTW_WLAN_ACTION_ADDBA_RESP, 37);//reject ADDBA Req -+ } -+ -+ break; -+ -+ case RTW_WLAN_ACTION_ADDBA_RESP: //ADDBA response -+ -+ //status = frame_body[3] | (frame_body[4] << 8); //endian issue -+ status = RTW_GET_LE16(&frame_body[3]); -+ tid = ((frame_body[5] >> 2) & 0x7); -+ -+ if (status == 0) -+ { //successful -+ DBG_871X("agg_enable for TID=%d\n", tid); -+ psta->htpriv.agg_enable_bitmap |= 1 << tid; -+ psta->htpriv.candidate_tid_bitmap &= ~BIT(tid); -+ } -+ else -+ { -+ psta->htpriv.agg_enable_bitmap &= ~BIT(tid); -+ } -+ -+ //DBG_871X("marc: ADDBA RSP: %x\n", pmlmeinfo->agg_enable_bitmap); -+ break; -+ -+ case RTW_WLAN_ACTION_DELBA: //DELBA -+ if ((frame_body[3] & BIT(3)) == 0) -+ { -+ psta->htpriv.agg_enable_bitmap &= ~(1 << ((frame_body[3] >> 4) & 0xf)); -+ psta->htpriv.candidate_tid_bitmap &= ~(1 << ((frame_body[3] >> 4) & 0xf)); -+ -+ //reason_code = frame_body[4] | (frame_body[5] << 8); -+ reason_code = RTW_GET_LE16(&frame_body[4]); -+ } -+ else if((frame_body[3] & BIT(3)) == BIT(3)) -+ { -+ tid = (frame_body[3] >> 4) & 0x0F; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[tid]; -+ preorder_ctrl->enable = false; -+ preorder_ctrl->indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u \n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq); -+ #endif -+ } -+ -+ DBG_871X("%s(): DELBA: %x(%x)\n", __FUNCTION__,pmlmeinfo->agg_enable_bitmap, reason_code); -+ //todo: how to notify the host while receiving DELETE BA -+ break; -+ -+ default: -+ break; -+ } -+ } -+#endif //CONFIG_80211N_HT -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_P2P -+ -+static int get_reg_classes_full_count(struct p2p_channels channel_list) { -+ int cnt = 0; -+ int i; -+ -+ for (i = 0; i < channel_list.reg_classes; i++) { -+ cnt += channel_list.reg_class[i].channels; -+ } -+ -+ return cnt; -+} -+ -+static void get_channel_cnt_24g_5gl_5gh( struct mlme_ext_priv *pmlmeext, u8* p24g_cnt, u8* p5gl_cnt, u8* p5gh_cnt ) -+{ -+ int i = 0; -+ -+ *p24g_cnt = 0; -+ *p5gl_cnt = 0; -+ *p5gh_cnt = 0; -+ -+ for( i = 0; i < pmlmeext->max_chan_nums; i++ ) -+ { -+ if ( pmlmeext->channel_set[ i ].ChannelNum <= 14 ) -+ { -+ (*p24g_cnt)++; -+ } -+ else if ( ( pmlmeext->channel_set[ i ].ChannelNum > 14 ) && ( pmlmeext->channel_set[ i ].ChannelNum <= 48 ) ) -+ { -+ // Just include the channel 36, 40, 44, 48 channels for 5G low -+ (*p5gl_cnt)++; -+ } -+ else if ( ( pmlmeext->channel_set[ i ].ChannelNum >= 149 ) && ( pmlmeext->channel_set[ i ].ChannelNum <= 161 ) ) -+ { -+ // Just include the channel 149, 153, 157, 161 channels for 5G high -+ (*p5gh_cnt)++; -+ } -+ } -+} -+ -+void issue_p2p_GO_request(_adapter *padapter, u8* raddr) -+{ -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ __be32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_GO_NEGO_REQ; -+ u8 wpsie[ 255 ] = { 0x00 }, p2pie[ 255 ] = { 0x00 }; -+ u8 wpsielen = 0, p2pielen = 0, i; -+ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; -+ u16 len_channellist_attr = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo); -+ -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ DBG_871X( "[%s] In\n", __FUNCTION__ ); -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pwdinfo->negotiation_dialog_token = 1; // Initialize the dialog value -+ pframe = rtw_set_fixed_ie(pframe, 1, &pwdinfo->negotiation_dialog_token, &(pattrib->pktlen)); -+ -+ -+ -+ // WPS Section -+ wpsielen = 0; -+ // WPS OUI -+ *(__be32*) ( wpsie ) = cpu_to_be32( WPSOUI ); -+ wpsielen += 4; -+ -+ // WPS version -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_VERSION_1; // Version 1.0 -+ -+ // Device Password ID -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_PWID ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); -+ wpsielen += 2; -+ -+ // Value: -+ -+ if ( pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PEER_DISPLAY_PIN ) -+ { -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_USER_SPEC ); -+ } -+ else if ( pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_SELF_DISPLAY_PIN ) -+ { -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_REGISTRAR_SPEC ); -+ } -+ else if ( pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PBC ) -+ { -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_PBC ); -+ } -+ -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); -+ -+ -+ // P2P IE Section. -+ -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20110306 -+ // According to the P2P Specification, the group negoitation request frame should contain 9 P2P attributes -+ // 1. P2P Capability -+ // 2. Group Owner Intent -+ // 3. Configuration Timeout -+ // 4. Listen Channel -+ // 5. Extended Listen Timing -+ // 6. Intended P2P Interface Address -+ // 7. Channel List -+ // 8. P2P Device Info -+ // 9. Operating Channel -+ -+ -+ // P2P Capability -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Device Capability Bitmap, 1 byte -+ p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; -+ -+ // Group Capability Bitmap, 1 byte -+ if ( pwdinfo->persistent_supported ) -+ { -+ p2pie[ p2pielen++ ] = P2P_GRPCAP_CROSS_CONN | P2P_GRPCAP_PERSISTENT_GROUP; -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = P2P_GRPCAP_CROSS_CONN; -+ } -+ -+ -+ // Group Owner Intent -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_GO_INTENT; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Todo the tie breaker bit. -+ p2pie[ p2pielen++ ] = ( ( pwdinfo->intent << 1 ) | BIT(0) ); -+ -+ // Configuration Timeout -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CONF_TIMEOUT; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ p2pielen += 2; -+ -+ // Value: -+ p2pie[ p2pielen++ ] = 200; // 2 seconds needed to be the P2P GO -+ p2pie[ p2pielen++ ] = 200; // 2 seconds needed to be the P2P Client -+ -+ -+ // Listen Channel -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_LISTEN_CH; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x51; // Copy from SD7 -+ -+ // Channel Number -+ p2pie[ p2pielen++ ] = pwdinfo->listen_channel; // listening channel number -+ -+ -+ // Extended Listen Timing ATTR -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_EX_LISTEN_TIMING; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0004 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Availability Period -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); -+ p2pielen += 2; -+ -+ // Availability Interval -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); -+ p2pielen += 2; -+ -+ -+ // Intended P2P Interface Address -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_INTENTED_IF_ADDR; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ -+ // Channel List -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CH_LIST; -+ -+ // Length: -+ // Country String(3) -+ // + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) -+ // + number of channels in all classes -+ len_channellist_attr = 3 -+ + (1 + 1) * (u16)(pmlmeext->channel_list.reg_classes) -+ + get_reg_classes_full_count(pmlmeext->channel_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); -+ } -+ else -+ { -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); -+ } -+#else -+ -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); -+ -+#endif -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Channel Entry List -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ // Operating Class -+ if ( pbuddy_mlmeext->cur_channel > 14 ) -+ { -+ if ( pbuddy_mlmeext->cur_channel >= 149 ) -+ { -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ -+ // Number of Channels -+ // Just support 1 channel and this channel is AP's channel -+ p2pie[ p2pielen++ ] = 1; -+ -+ // Channel List -+ p2pie[ p2pielen++ ] = pbuddy_mlmeext->cur_channel; -+ } -+ else -+ { -+ int i,j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ // Operating Class -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ // Number of Channels -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ // Channel List -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) { -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+ } -+#else // CONFIG_CONCURRENT_MODE -+ { -+ int i,j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ // Operating Class -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ // Number of Channels -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ // Channel List -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) { -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ -+ // Device Info -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) -+ // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); -+ p2pielen += 2; -+ -+ // Value: -+ // P2P Device Address -+ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ // Config Method -+ // This field should be big endian. Noted by P2P specification. -+ -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); -+ -+ p2pielen += 2; -+ -+ // Primary Device Type -+ // Category ID -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ p2pielen += 2; -+ -+ // OUI -+ *(__be32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); -+ p2pielen += 4; -+ -+ // Sub Category ID -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ p2pielen += 2; -+ -+ // Number of Secondary Device Types -+ p2pie[ p2pielen++ ] = 0x00; // No Secondary Device Type List -+ -+ // Device Name -+ // Type: -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ p2pielen += 2; -+ -+ // Length: -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_name , pwdinfo->device_name_len ); -+ p2pielen += pwdinfo->device_name_len; -+ -+ -+ // Operating Channel -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Operating Class -+ if ( pwdinfo->operating_channel <= 14 ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ else if ( ( pwdinfo->operating_channel >= 36 ) && ( pwdinfo->operating_channel <= 48 ) ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ else -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ -+ // Channel Number -+ p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // operating channel number -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_nego_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif //CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+ -+static void issue_p2p_GO_response(_adapter *padapter, u8* raddr, u8* frame_body,uint len, u8 result) -+{ -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ __be32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_GO_NEGO_RESP; -+ u8 wpsie[ 255 ] = { 0x00 }, p2pie[ 255 ] = { 0x00 }; -+ u8 p2pielen = 0, i; -+ uint wpsielen = 0; -+ u16 wps_devicepassword_id = 0x0000; -+ __be16 be_tmp; -+ uint wps_devicepassword_id_len = 0; -+ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh; -+ u16 len_channellist_attr = 0; -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo); -+ -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ DBG_871X( "[%s] In, result = %d\n", __FUNCTION__, result ); -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pwdinfo->negotiation_dialog_token = frame_body[7]; // The Dialog Token of provisioning discovery request frame. -+ pframe = rtw_set_fixed_ie(pframe, 1, &(pwdinfo->negotiation_dialog_token), &(pattrib->pktlen)); -+ -+ // Commented by Albert 20110328 -+ // Try to get the device password ID from the WPS IE of group negotiation request frame -+ // WiFi Direct test plan 5.1.15 -+ rtw_get_wps_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, wpsie, &wpsielen); -+ rtw_get_wps_attr_content( wpsie, wpsielen, WPS_ATTR_DEVICE_PWID, (u8*) &be_tmp, &wps_devicepassword_id_len); -+ wps_devicepassword_id = be16_to_cpu(be_tmp); -+ -+ _rtw_memset( wpsie, 0x00, 255 ); -+ wpsielen = 0; -+ -+ // WPS Section -+ wpsielen = 0; -+ // WPS OUI -+ *(__be32*) ( wpsie ) = cpu_to_be32( WPSOUI ); -+ wpsielen += 4; -+ -+ // WPS version -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_VERSION_1; // Version 1.0 -+ -+ // Device Password ID -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_PWID ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); -+ wpsielen += 2; -+ -+ // Value: -+ if ( wps_devicepassword_id == WPS_DPID_USER_SPEC ) -+ { -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_REGISTRAR_SPEC ); -+ } -+ else if ( wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC ) -+ { -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_USER_SPEC ); -+ } -+ else -+ { -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_PBC ); -+ } -+ wpsielen += 2; -+ -+ // Commented by Kurt 20120113 -+ // If some device wants to do p2p handshake without sending prov_disc_req -+ // We have to get peer_req_cm from here. -+ if(_rtw_memcmp( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "000", 3) ) -+ { -+ if ( wps_devicepassword_id == WPS_DPID_USER_SPEC ) -+ { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "dis", 3 ); -+ } -+ else if ( wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC ) -+ { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3 ); -+ } -+ else -+ { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3 ); -+ } -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); -+ -+ -+ // P2P IE Section. -+ -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20100908 -+ // According to the P2P Specification, the group negoitation response frame should contain 9 P2P attributes -+ // 1. Status -+ // 2. P2P Capability -+ // 3. Group Owner Intent -+ // 4. Configuration Timeout -+ // 5. Operating Channel -+ // 6. Intended P2P Interface Address -+ // 7. Channel List -+ // 8. Device Info -+ // 9. Group ID ( Only GO ) -+ -+ -+ // ToDo: -+ -+ // P2P Status -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_STATUS; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); -+ p2pielen += 2; -+ -+ // Value: -+ p2pie[ p2pielen++ ] = result; -+ -+ // P2P Capability -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Device Capability Bitmap, 1 byte -+ -+ if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) ) -+ { -+ // Commented by Albert 2011/03/08 -+ // According to the P2P specification -+ // if the sending device will be client, the P2P Capability should be reserved of group negotation response frame -+ p2pie[ p2pielen++ ] = 0; -+ } -+ else -+ { -+ // Be group owner or meet the error case -+ p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; -+ } -+ -+ // Group Capability Bitmap, 1 byte -+ if ( pwdinfo->persistent_supported ) -+ { -+ p2pie[ p2pielen++ ] = P2P_GRPCAP_CROSS_CONN | P2P_GRPCAP_PERSISTENT_GROUP; -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = P2P_GRPCAP_CROSS_CONN; -+ } -+ -+ // Group Owner Intent -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_GO_INTENT; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); -+ p2pielen += 2; -+ -+ // Value: -+ if ( pwdinfo->peer_intent & 0x01 ) -+ { -+ // Peer's tie breaker bit is 1, our tie breaker bit should be 0 -+ p2pie[ p2pielen++ ] = ( pwdinfo->intent << 1 ); -+ } -+ else -+ { -+ // Peer's tie breaker bit is 0, our tie breaker bit should be 1 -+ p2pie[ p2pielen++ ] = ( ( pwdinfo->intent << 1 ) | BIT(0) ); -+ } -+ -+ -+ // Configuration Timeout -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CONF_TIMEOUT; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ p2pielen += 2; -+ -+ // Value: -+ p2pie[ p2pielen++ ] = 200; // 2 seconds needed to be the P2P GO -+ p2pie[ p2pielen++ ] = 200; // 2 seconds needed to be the P2P Client -+ -+ // Operating Channel -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Operating Class -+ if ( pwdinfo->operating_channel <= 14 ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ else if ( ( pwdinfo->operating_channel >= 36 ) && ( pwdinfo->operating_channel <= 48 ) ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ else -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ -+ // Channel Number -+ p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // operating channel number -+ -+ // Intended P2P Interface Address -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_INTENTED_IF_ADDR; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ // Channel List -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CH_LIST; -+ -+ // Country String(3) -+ // + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) -+ // + number of channels in all classes -+ len_channellist_attr = 3 -+ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes -+ + get_reg_classes_full_count(pmlmeext->channel_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); -+ } -+ else -+ { -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); -+ } -+#else -+ -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); -+ -+ #endif -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Channel Entry List -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ // Operating Class -+ if ( pbuddy_mlmeext->cur_channel > 14 ) -+ { -+ if ( pbuddy_mlmeext->cur_channel >= 149 ) -+ { -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ -+ // Number of Channels -+ // Just support 1 channel and this channel is AP's channel -+ p2pie[ p2pielen++ ] = 1; -+ -+ // Channel List -+ p2pie[ p2pielen++ ] = pbuddy_mlmeext->cur_channel; -+ } -+ else -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ // Operating Class -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ // Number of Channels -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ // Channel List -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) { -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+ } -+#else // CONFIG_CONCURRENT_MODE -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ // Operating Class -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ // Number of Channels -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ // Channel List -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) { -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ -+ -+ // Device Info -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) -+ // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); -+ p2pielen += 2; -+ -+ // Value: -+ // P2P Device Address -+ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ // Config Method -+ // This field should be big endian. Noted by P2P specification. -+ -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); -+ -+ p2pielen += 2; -+ -+ // Primary Device Type -+ // Category ID -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ p2pielen += 2; -+ -+ // OUI -+ *(__be32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); -+ p2pielen += 4; -+ -+ // Sub Category ID -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ p2pielen += 2; -+ -+ // Number of Secondary Device Types -+ p2pie[ p2pielen++ ] = 0x00; // No Secondary Device Type List -+ -+ // Device Name -+ // Type: -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ p2pielen += 2; -+ -+ // Length: -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_name , pwdinfo->device_name_len ); -+ p2pielen += pwdinfo->device_name_len; -+ -+ if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) ) -+ { -+ // Group ID Attribute -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_ID; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN + pwdinfo->nego_ssidlen ); -+ p2pielen += 2; -+ -+ // Value: -+ // p2P Device Address -+ _rtw_memcpy( p2pie + p2pielen , pwdinfo->device_addr, ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ // SSID -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen ); -+ p2pielen += pwdinfo->nego_ssidlen; -+ -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_nego_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif //CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+static void issue_p2p_GO_confirm(_adapter *padapter, u8* raddr, u8 result) -+{ -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ __be32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_GO_NEGO_CONF; -+ u8 wpsie[ 255 ] = { 0x00 }, p2pie[ 255 ] = { 0x00 }; -+ u8 wpsielen = 0, p2pielen = 0; -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo); -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ DBG_871X( "[%s] In\n", __FUNCTION__ ); -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(pwdinfo->negotiation_dialog_token), &(pattrib->pktlen)); -+ -+ -+ -+ // P2P IE Section. -+ -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20110306 -+ // According to the P2P Specification, the group negoitation request frame should contain 5 P2P attributes -+ // 1. Status -+ // 2. P2P Capability -+ // 3. Operating Channel -+ // 4. Channel List -+ // 5. Group ID ( if this WiFi is GO ) -+ -+ // P2P Status -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_STATUS; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); -+ p2pielen += 2; -+ -+ // Value: -+ p2pie[ p2pielen++ ] = result; -+ -+ // P2P Capability -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Device Capability Bitmap, 1 byte -+ p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; -+ -+ // Group Capability Bitmap, 1 byte -+ if ( pwdinfo->persistent_supported ) -+ { -+ p2pie[ p2pielen++ ] = P2P_GRPCAP_CROSS_CONN | P2P_GRPCAP_PERSISTENT_GROUP; -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = P2P_GRPCAP_CROSS_CONN; -+ } -+ -+ -+ // Operating Channel -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ -+ if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) ) -+ { -+ if ( pwdinfo->peer_operating_ch <= 14 ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ else if ( ( pwdinfo->peer_operating_ch >= 36 ) && ( pwdinfo->peer_operating_ch <= 48 ) ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ else -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ -+ p2pie[ p2pielen++ ] = pwdinfo->peer_operating_ch; -+ } -+ else -+ { -+ if ( pwdinfo->operating_channel <= 14 ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ else if ( ( pwdinfo->operating_channel >= 36 ) && ( pwdinfo->operating_channel <= 48 ) ) -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ else -+ { -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ -+ // Channel Number -+ p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // Use the listen channel as the operating channel -+ } -+ -+ -+ // Channel List -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CH_LIST; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( pwdinfo->channel_list_attr_len ); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->channel_list_attr, pwdinfo->channel_list_attr_len ); -+ p2pielen += pwdinfo->channel_list_attr_len; -+ -+ if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) ) -+ { -+ // Group ID Attribute -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_ID; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN + pwdinfo->nego_ssidlen ); -+ p2pielen += 2; -+ -+ // Value: -+ // p2P Device Address -+ _rtw_memcpy( p2pie + p2pielen , pwdinfo->device_addr, ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ // SSID -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen ); -+ p2pielen += pwdinfo->nego_ssidlen; -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_nego_confirm_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif //CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+void issue_p2p_invitation_request(_adapter *padapter, u8* raddr ) -+{ -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ __be32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_INVIT_REQ; -+ u8 p2pie[ 255 ] = { 0x00 }; -+ u8 p2pielen = 0, i; -+ u8 dialogToken = 3; -+ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; -+ u16 len_channellist_attr = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo; -+ struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo); -+ -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, raddr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ // P2P IE Section. -+ -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20101011 -+ // According to the P2P Specification, the P2P Invitation request frame should contain 7 P2P attributes -+ // 1. Configuration Timeout -+ // 2. Invitation Flags -+ // 3. Operating Channel ( Only GO ) -+ // 4. P2P Group BSSID ( Should be included if I am the GO ) -+ // 5. Channel List -+ // 6. P2P Group ID -+ // 7. P2P Device Info -+ -+ // Configuration Timeout -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CONF_TIMEOUT; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ p2pielen += 2; -+ -+ // Value: -+ p2pie[ p2pielen++ ] = 200; // 2 seconds needed to be the P2P GO -+ p2pie[ p2pielen++ ] = 200; // 2 seconds needed to be the P2P Client -+ -+ // Invitation Flags -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_INVITATION_FLAGS; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); -+ p2pielen += 2; -+ -+ // Value: -+ p2pie[ p2pielen++ ] = P2P_INVITATION_FLAGS_PERSISTENT; -+ -+ -+ // Operating Channel -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Operating Class -+ if ( pwdinfo->invitereq_info.operating_ch <= 14 ) -+ p2pie[ p2pielen++ ] = 0x51; -+ else if ( ( pwdinfo->invitereq_info.operating_ch >= 36 ) && ( pwdinfo->invitereq_info.operating_ch <= 48 ) ) -+ p2pie[ p2pielen++ ] = 0x73; -+ else -+ p2pie[ p2pielen++ ] = 0x7c; -+ -+ // Channel Number -+ p2pie[ p2pielen++ ] = pwdinfo->invitereq_info.operating_ch; // operating channel number -+ -+ if ( _rtw_memcmp( myid( &padapter->eeprompriv ), pwdinfo->invitereq_info.go_bssid, ETH_ALEN ) ) -+ { -+ // P2P Group BSSID -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_BSSID; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); -+ p2pielen += 2; -+ -+ // Value: -+ // P2P Device Address for GO -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->invitereq_info.go_bssid, ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ } -+ -+ // Channel List -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CH_LIST; -+ -+ -+ // Length: -+ // Country String(3) -+ // + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) -+ // + number of channels in all classes -+ len_channellist_attr = 3 -+ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes -+ + get_reg_classes_full_count(pmlmeext->channel_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); -+ } -+ else -+ { -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); -+ } -+#else -+ -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); -+ -+ #endif -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Channel Entry List -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ // Operating Class -+ if ( pbuddy_mlmeext->cur_channel > 14 ) -+ { -+ if ( pbuddy_mlmeext->cur_channel >= 149 ) -+ { -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ -+ // Number of Channels -+ // Just support 1 channel and this channel is AP's channel -+ p2pie[ p2pielen++ ] = 1; -+ -+ // Channel List -+ p2pie[ p2pielen++ ] = pbuddy_mlmeext->cur_channel; -+ } -+ else -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ // Operating Class -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ // Number of Channels -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ // Channel List -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) { -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+ } -+#else // CONFIG_CONCURRENT_MODE -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ // Operating Class -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ // Number of Channels -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ // Channel List -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) { -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ -+ -+ // P2P Group ID -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_ID; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 6 + pwdinfo->invitereq_info.ssidlen ); -+ p2pielen += 2; -+ -+ // Value: -+ // P2P Device Address for GO -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->invitereq_info.go_bssid, ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ // SSID -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->invitereq_info.go_ssid, pwdinfo->invitereq_info.ssidlen ); -+ p2pielen += pwdinfo->invitereq_info.ssidlen; -+ -+ -+ // Device Info -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) -+ // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); -+ p2pielen += 2; -+ -+ // Value: -+ // P2P Device Address -+ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ // Config Method -+ // This field should be big endian. Noted by P2P specification. -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_DISPLAY ); -+ p2pielen += 2; -+ -+ // Primary Device Type -+ // Category ID -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ p2pielen += 2; -+ -+ // OUI -+ *(__be32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); -+ p2pielen += 4; -+ -+ // Sub Category ID -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ p2pielen += 2; -+ -+ // Number of Secondary Device Types -+ p2pie[ p2pielen++ ] = 0x00; // No Secondary Device Type List -+ -+ // Device Name -+ // Type: -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ p2pielen += 2; -+ -+ // Length: -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len ); -+ p2pielen += pwdinfo->device_name_len; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_invitation_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif //CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+void issue_p2p_invitation_response(_adapter *padapter, u8* raddr, u8 dialogToken, u8 status_code) -+{ -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ __be32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_INVIT_RESP; -+ u8 p2pie[ 255 ] = { 0x00 }; -+ u8 p2pielen = 0, i; -+ u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; -+ u16 len_channellist_attr = 0; -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo; -+ struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo); -+ -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, raddr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ // P2P IE Section. -+ -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20101005 -+ // According to the P2P Specification, the P2P Invitation response frame should contain 5 P2P attributes -+ // 1. Status -+ // 2. Configuration Timeout -+ // 3. Operating Channel ( Only GO ) -+ // 4. P2P Group BSSID ( Only GO ) -+ // 5. Channel List -+ -+ // P2P Status -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_STATUS; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0001 ); -+ p2pielen += 2; -+ -+ // Value: -+ // When status code is P2P_STATUS_FAIL_INFO_UNAVAILABLE. -+ // Sent the event receiving the P2P Invitation Req frame to DMP UI. -+ // DMP had to compare the MAC address to find out the profile. -+ // So, the WiFi driver will send the P2P_STATUS_FAIL_INFO_UNAVAILABLE to NB. -+ // If the UI found the corresponding profile, the WiFi driver sends the P2P Invitation Req -+ // to NB to rebuild the persistent group. -+ p2pie[ p2pielen++ ] = status_code; -+ -+ // Configuration Timeout -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CONF_TIMEOUT; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ p2pielen += 2; -+ -+ // Value: -+ p2pie[ p2pielen++ ] = 200; // 2 seconds needed to be the P2P GO -+ p2pie[ p2pielen++ ] = 200; // 2 seconds needed to be the P2P Client -+ -+ if( status_code == P2P_STATUS_SUCCESS ) -+ { -+ if( rtw_p2p_chk_role( pwdinfo, P2P_ROLE_GO ) ) -+ { -+ // The P2P Invitation request frame asks this Wi-Fi device to be the P2P GO -+ // In this case, the P2P Invitation response frame should carry the two more P2P attributes. -+ // First one is operating channel attribute. -+ // Second one is P2P Group BSSID attribute. -+ -+ // Operating Channel -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x51; // Copy from SD7 -+ -+ // Channel Number -+ p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // operating channel number -+ -+ -+ // P2P Group BSSID -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_BSSID; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN ); -+ p2pielen += 2; -+ -+ // Value: -+ // P2P Device Address for GO -+ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ } -+ -+ // Channel List -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CH_LIST; -+ -+ // Length: -+ // Country String(3) -+ // + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) -+ // + number of channels in all classes -+ len_channellist_attr = 3 -+ + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes -+ + get_reg_classes_full_count(pmlmeext->channel_list); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 5 + 1 ); -+ } -+ else -+ { -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); -+ } -+#else -+ -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( len_channellist_attr ); -+ -+#endif -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Channel Entry List -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ // Operating Class -+ if ( pbuddy_mlmeext->cur_channel > 14 ) -+ { -+ if ( pbuddy_mlmeext->cur_channel >= 149 ) -+ { -+ p2pie[ p2pielen++ ] = 0x7c; -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = 0x73; -+ } -+ } -+ else -+ { -+ p2pie[ p2pielen++ ] = 0x51; -+ } -+ -+ // Number of Channels -+ // Just support 1 channel and this channel is AP's channel -+ p2pie[ p2pielen++ ] = 1; -+ -+ // Channel List -+ p2pie[ p2pielen++ ] = pbuddy_mlmeext->cur_channel; -+ } -+ else -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ // Operating Class -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ // Number of Channels -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ // Channel List -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) { -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+ } -+#else // CONFIG_CONCURRENT_MODE -+ { -+ int i, j; -+ for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { -+ // Operating Class -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; -+ -+ // Number of Channels -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; -+ -+ // Channel List -+ for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) { -+ p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; -+ } -+ } -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_invitation_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif //CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+void issue_p2p_provision_request(_adapter *padapter, u8* pssid, u8 ussidlen, u8* pdev_raddr ) -+{ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u8 dialogToken = 1; -+ __be32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_PROVISION_DISC_REQ; -+ u8 wpsie[ 100 ] = { 0x00 }; -+ u8 wpsielen = 0; -+ u32 p2pielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ DBG_871X( "[%s] In\n", __FUNCTION__ ); -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, pdev_raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pdev_raddr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ p2pielen = build_prov_disc_request_p2p_ie( pwdinfo, pframe, pssid, ussidlen, pdev_raddr ); -+ -+ pframe += p2pielen; -+ pattrib->pktlen += p2pielen; -+ -+ wpsielen = 0; -+ // WPS OUI -+ *(__be32*) ( wpsie ) = cpu_to_be32( WPSOUI ); -+ wpsielen += 4; -+ -+ // WPS version -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_VERSION_1; // Version 1.0 -+ -+ // Config Method -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); -+ wpsielen += 2; -+ -+ // Value: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->tx_prov_disc_info.wps_config_method_request ); -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); -+ -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_provdisc_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif //CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+ -+static u8 is_matched_in_profilelist( u8* peermacaddr, struct profile_info* profileinfo ) -+{ -+ u8 i, match_result = 0; -+ -+ DBG_871X( "[%s] peermac = %.2X %.2X %.2X %.2X %.2X %.2X\n", __FUNCTION__, -+ peermacaddr[0], peermacaddr[1],peermacaddr[2],peermacaddr[3],peermacaddr[4],peermacaddr[5]); -+ -+ for( i = 0; i < P2P_MAX_PERSISTENT_GROUP_NUM; i++, profileinfo++ ) -+ { -+ DBG_871X( "[%s] profileinfo_mac = %.2X %.2X %.2X %.2X %.2X %.2X\n", __FUNCTION__, -+ profileinfo->peermac[0], profileinfo->peermac[1],profileinfo->peermac[2],profileinfo->peermac[3],profileinfo->peermac[4],profileinfo->peermac[5]); -+ if ( _rtw_memcmp( peermacaddr, profileinfo->peermac, ETH_ALEN ) ) -+ { -+ match_result = 1; -+ DBG_871X( "[%s] Match!\n", __FUNCTION__ ); -+ break; -+ } -+ } -+ -+ return (match_result ); -+} -+ -+void issue_probersp_p2p(_adapter *padapter, unsigned char *da) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ unsigned char *mac; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ //WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u16 beacon_interval = 100; -+ u16 capInfo = 0; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 wpsie[255] = { 0x00 }; -+ u32 wpsielen = 0, p2pielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+ struct ieee80211_channel *ieee_ch = &pcfg80211_wdinfo->remain_on_ch_channel; -+ u8 listen_channel = (u8) ieee80211_frequency_to_channel(ieee_ch->center_freq); -+#endif //CONFIG_IOCTL_CFG80211 -+#ifdef CONFIG_INTEL_WIDI -+ u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; -+#endif //CONFIG_INTEL_WIDI -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = myid(&(padapter->eeprompriv)); -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ // Use the device address for BSSID field. -+ _rtw_memcpy(pwlanhdr->addr3, mac, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(fctrl, WIFI_PROBERSP); -+ -+ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = pattrib->hdrlen; -+ pframe += pattrib->hdrlen; -+ -+ //timestamp will be inserted by hardware -+ pframe += 8; -+ pattrib->pktlen += 8; -+ -+ // beacon interval: 2 bytes -+ _rtw_memcpy(pframe, (unsigned char *) &beacon_interval, 2); -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ // capability info: 2 bytes -+ // ESS and IBSS bits must be 0 (defined in the 3.1.2.1.1 of WiFi Direct Spec) -+ capInfo |= cap_ShortPremble; -+ capInfo |= cap_ShortSlot; -+ -+ _rtw_memcpy(pframe, (unsigned char *) &capInfo, 2); -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ -+ // SSID -+ pframe = rtw_set_ie(pframe, _SSID_IE_, 7, pwdinfo->p2p_wildcard_ssid, &pattrib->pktlen); -+ -+ // supported rates... -+ // Use the OFDM rate in the P2P probe response frame. ( 6(B), 9(B), 12, 18, 24, 36, 48, 54 ) -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pwdinfo->support_rate, &pattrib->pktlen); -+ -+ // DS parameter set -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && listen_channel !=0 && pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&listen_channel, &pattrib->pktlen); -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&pwdinfo->listen_channel, &pattrib->pktlen); -+ } -+ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if( pmlmepriv->wps_probe_resp_ie != NULL && pmlmepriv->p2p_probe_resp_ie != NULL ) -+ { -+ //WPS IE -+ _rtw_memcpy(pframe, pmlmepriv->wps_probe_resp_ie, pmlmepriv->wps_probe_resp_ie_len); -+ pattrib->pktlen += pmlmepriv->wps_probe_resp_ie_len; -+ pframe += pmlmepriv->wps_probe_resp_ie_len; -+ -+ //P2P IE -+ _rtw_memcpy(pframe, pmlmepriv->p2p_probe_resp_ie, pmlmepriv->p2p_probe_resp_ie_len); -+ pattrib->pktlen += pmlmepriv->p2p_probe_resp_ie_len; -+ pframe += pmlmepriv->p2p_probe_resp_ie_len; -+ } -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ -+ // Todo: WPS IE -+ // Noted by Albert 20100907 -+ // According to the WPS specification, all the WPS attribute is presented by Big Endian. -+ -+ wpsielen = 0; -+ // WPS OUI -+ *(__be32*) ( wpsie ) = cpu_to_be32( WPSOUI ); -+ wpsielen += 4; -+ -+ // WPS version -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_VERSION_1; // Version 1.0 -+ -+#ifdef CONFIG_INTEL_WIDI -+ // Commented by Kurt -+ // Appended WiDi info. only if we did issued_probereq_widi(), and then we saved ven. ext. in pmlmepriv->sa_ext. -+ if( _rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == false ) -+ { -+ //Sec dev type -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_SEC_DEV_TYPE_LIST ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0008 ); -+ wpsielen += 2; -+ -+ // Value: -+ // Category ID -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_CID_DISPLAYS ); -+ wpsielen += 2; -+ -+ // OUI -+ *(u32*) ( wpsie + wpsielen ) = cpu_to_be32( INTEL_DEV_TYPE_OUI ); -+ wpsielen += 4; -+ -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_SCID_WIDI_CONSUMER_SINK ); -+ wpsielen += 2; -+ -+ // Vendor Extension -+ _rtw_memcpy( wpsie + wpsielen, pmlmepriv->sa_ext, L2SDTA_SERVICE_VE_LEN ); -+ wpsielen += L2SDTA_SERVICE_VE_LEN; -+ } -+#endif //CONFIG_INTEL_WIDI -+ -+ // WiFi Simple Config State -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_SIMPLE_CONF_STATE ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_WSC_STATE_NOT_CONFIG; // Not Configured. -+ -+ // Response Type -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_RESP_TYPE ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_RESPONSE_TYPE_8021X; -+ -+ // UUID-E -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_UUID_E ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0010 ); -+ wpsielen += 2; -+ -+ // Value: -+ _rtw_memcpy( wpsie + wpsielen, myid( &padapter->eeprompriv ), ETH_ALEN ); -+ wpsielen += 0x10; -+ -+ // Manufacturer -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_MANUFACTURER ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0007 ); -+ wpsielen += 2; -+ -+ // Value: -+ _rtw_memcpy( wpsie + wpsielen, "Realtek", 7 ); -+ wpsielen += 7; -+ -+ // Model Name -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_MODEL_NAME ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0006 ); -+ wpsielen += 2; -+ -+ // Value: -+ _rtw_memcpy( wpsie + wpsielen, "8192CU", 6 ); -+ wpsielen += 6; -+ -+ // Model Number -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_MODEL_NUMBER ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[ wpsielen++ ] = 0x31; // character 1 -+ -+ // Serial Number -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_SERIAL_NUMBER ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( ETH_ALEN ); -+ wpsielen += 2; -+ -+ // Value: -+ _rtw_memcpy( wpsie + wpsielen, "123456" , ETH_ALEN ); -+ wpsielen += ETH_ALEN; -+ -+ // Primary Device Type -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_PRIMARY_DEV_TYPE ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0008 ); -+ wpsielen += 2; -+ -+ // Value: -+ // Category ID -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ wpsielen += 2; -+ -+ // OUI -+ *(__be32*) ( wpsie + wpsielen ) = cpu_to_be32( WPSOUI ); -+ wpsielen += 4; -+ -+ // Sub Category ID -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ wpsielen += 2; -+ -+ // Device Name -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->device_name_len ); -+ wpsielen += 2; -+ -+ // Value: -+ _rtw_memcpy( wpsie + wpsielen, pwdinfo->device_name, pwdinfo->device_name_len ); -+ wpsielen += pwdinfo->device_name_len; -+ -+ // Config Method -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); -+ wpsielen += 2; -+ -+ // Value: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); -+ wpsielen += 2; -+ -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); -+ -+ -+ p2pielen = build_probe_resp_p2p_ie(pwdinfo, pframe); -+ pframe += p2pielen; -+ pattrib->pktlen += p2pielen; -+ } -+ -+#ifdef CONFIG_WFD -+#ifdef CONFIG_IOCTL_CFG80211 -+ if ( true == pwdinfo->wfd_info->wfd_enable ) -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ wfdielen = build_probe_resp_wfd_ie(pwdinfo, pframe, 0); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+#ifdef CONFIG_IOCTL_CFG80211 -+ else if (pmlmepriv->wfd_probe_resp_ie != NULL && pmlmepriv->wfd_probe_resp_ie_len>0) -+ { -+ //WFD IE -+ _rtw_memcpy(pframe, pmlmepriv->wfd_probe_resp_ie, pmlmepriv->wfd_probe_resp_ie_len); -+ pattrib->pktlen += pmlmepriv->wfd_probe_resp_ie_len; -+ pframe += pmlmepriv->wfd_probe_resp_ie_len; -+ } -+#endif //CONFIG_IOCTL_CFG80211 -+#endif //CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+static int _issue_probereq_p2p(_adapter *padapter, u8 *da, int wait_ack) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ unsigned char *mac; -+ unsigned char bssrate[NumRates]; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int bssrate_len = 0; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 wpsie[255] = { 0x00 }, p2pie[ 255 ] = { 0x00 }; -+ u16 wpsielen = 0, p2pielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ goto exit; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = myid(&(padapter->eeprompriv)); -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ if (da) { -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, da, ETH_ALEN); -+ } else { -+ if ( ( pwdinfo->p2p_info.scan_op_ch_only ) || ( pwdinfo->rx_invitereq_info.scan_op_ch_only ) ) -+ { -+ // This two flags will be set when this is only the P2P client mode. -+ _rtw_memcpy(pwlanhdr->addr1, pwdinfo->p2p_peer_interface_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->p2p_peer_interface_addr, ETH_ALEN); -+ } -+ else -+ { -+ // broadcast probe request frame -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, bc_addr, ETH_ALEN); -+ } -+ } -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_PROBEREQ); -+ -+ pframe += sizeof (struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof (struct rtw_ieee80211_hdr_3addr); -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) -+ { -+ pframe = rtw_set_ie(pframe, _SSID_IE_, pwdinfo->tx_prov_disc_info.ssid.SsidLength, pwdinfo->tx_prov_disc_info.ssid.Ssid, &(pattrib->pktlen)); -+ } -+ else -+ { -+ pframe = rtw_set_ie(pframe, _SSID_IE_, P2P_WILDCARD_SSID_LEN, pwdinfo->p2p_wildcard_ssid, &(pattrib->pktlen)); -+ } -+ // Use the OFDM rate in the P2P probe request frame. ( 6(B), 9(B), 12(B), 24(B), 36, 48, 54 ) -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pwdinfo->support_rate, &pattrib->pktlen); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if( pmlmepriv->wps_probe_req_ie != NULL && pmlmepriv->p2p_probe_req_ie != NULL ) -+ { -+ //WPS IE -+ _rtw_memcpy(pframe, pmlmepriv->wps_probe_req_ie, pmlmepriv->wps_probe_req_ie_len); -+ pattrib->pktlen += pmlmepriv->wps_probe_req_ie_len; -+ pframe += pmlmepriv->wps_probe_req_ie_len; -+ -+ //P2P IE -+ _rtw_memcpy(pframe, pmlmepriv->p2p_probe_req_ie, pmlmepriv->p2p_probe_req_ie_len); -+ pattrib->pktlen += pmlmepriv->p2p_probe_req_ie_len; -+ pframe += pmlmepriv->p2p_probe_req_ie_len; -+ } -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ -+ // WPS IE -+ // Noted by Albert 20110221 -+ // According to the WPS specification, all the WPS attribute is presented by Big Endian. -+ -+ wpsielen = 0; -+ // WPS OUI -+ *(__be32*) ( wpsie ) = cpu_to_be32( WPSOUI ); -+ wpsielen += 4; -+ -+ // WPS version -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_VERSION_1; // Version 1.0 -+ -+ if( pmlmepriv->wps_probe_req_ie == NULL ) -+ { -+ // UUID-E -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_UUID_E ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0010 ); -+ wpsielen += 2; -+ -+ // Value: -+ _rtw_memcpy( wpsie + wpsielen, myid( &padapter->eeprompriv ), ETH_ALEN ); -+ wpsielen += 0x10; -+ -+ // Config Method -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); -+ wpsielen += 2; -+ -+ // Value: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); -+ wpsielen += 2; -+ } -+ -+ // Device Name -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->device_name_len ); -+ wpsielen += 2; -+ -+ // Value: -+ _rtw_memcpy( wpsie + wpsielen, pwdinfo->device_name, pwdinfo->device_name_len ); -+ wpsielen += pwdinfo->device_name_len; -+ -+ // Primary Device Type -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_PRIMARY_DEV_TYPE ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0008 ); -+ wpsielen += 2; -+ -+ // Value: -+ // Category ID -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_CID_RTK_WIDI ); -+ wpsielen += 2; -+ -+ // OUI -+ *(__be32 *) ( wpsie + wpsielen ) = cpu_to_be32( WPSOUI ); -+ wpsielen += 4; -+ -+ // Sub Category ID -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_PDT_SCID_RTK_DMP ); -+ wpsielen += 2; -+ -+ // Device Password ID -+ // Type: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_DEVICE_PWID ); -+ wpsielen += 2; -+ -+ // Length: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); -+ wpsielen += 2; -+ -+ // Value: -+ *(__be16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_DPID_REGISTRAR_SPEC ); // Registrar-specified -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); -+ -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20110221 -+ // According to the P2P Specification, the probe request frame should contain 5 P2P attributes -+ // 1. P2P Capability -+ // 2. P2P Device ID if this probe request wants to find the specific P2P device -+ // 3. Listen Channel -+ // 4. Extended Listen Timing -+ // 5. Operating Channel if this WiFi is working as the group owner now -+ -+ // P2P Capability -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Device Capability Bitmap, 1 byte -+ p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; -+ -+ // Group Capability Bitmap, 1 byte -+ if ( pwdinfo->persistent_supported ) -+ p2pie[ p2pielen++ ] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; -+ else -+ p2pie[ p2pielen++ ] = DMP_P2P_GRPCAP_SUPPORT; -+ -+ // Listen Channel -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_LISTEN_CH; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x51; // Copy from SD7 -+ -+ // Channel Number -+ p2pie[ p2pielen++ ] = pwdinfo->listen_channel; // listen channel -+ -+ -+ // Extended Listen Timing -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_EX_LISTEN_TIMING; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0004 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Availability Period -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); -+ p2pielen += 2; -+ -+ // Availability Interval -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); -+ p2pielen += 2; -+ -+ if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) ) -+ { -+ // Operating Channel (if this WiFi is working as the group owner now) -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_OPERATING_CH; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0005 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Country String -+ p2pie[ p2pielen++ ] = 'X'; -+ p2pie[ p2pielen++ ] = 'X'; -+ -+ // The third byte should be set to 0x04. -+ // Described in the "Operating Channel Attribute" section. -+ p2pie[ p2pielen++ ] = 0x04; -+ -+ // Operating Class -+ p2pie[ p2pielen++ ] = 0x51; // Copy from SD7 -+ -+ // Channel Number -+ p2pie[ p2pielen++ ] = pwdinfo->operating_channel; // operating channel number -+ -+ } -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); -+ -+ } -+ -+#ifdef CONFIG_WFD -+#ifdef CONFIG_IOCTL_CFG80211 -+ if ( true == pwdinfo->wfd_info->wfd_enable ) -+#endif -+ { -+ wfdielen = build_probe_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+#ifdef CONFIG_IOCTL_CFG80211 -+ else if (pmlmepriv->wfd_probe_req_ie != NULL && pmlmepriv->wfd_probe_req_ie_len>0) -+ { -+ //WFD IE -+ _rtw_memcpy(pframe, pmlmepriv->wfd_probe_req_ie, pmlmepriv->wfd_probe_req_ie_len); -+ pattrib->pktlen += pmlmepriv->wfd_probe_req_ie_len; -+ pframe += pmlmepriv->wfd_probe_req_ie_len; -+ } -+#endif //CONFIG_IOCTL_CFG80211 -+#endif //CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("issuing probe_req, tx_len=%d\n", pattrib->last_txcmdsz)); -+ -+ if (wait_ack) { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+inline void issue_probereq_p2p(_adapter *adapter, u8 *da) -+{ -+ _issue_probereq_p2p(adapter, da, false); -+} -+ -+int issue_probereq_p2p_ex(_adapter *adapter, u8 *da, int try_cnt, int wait_ms) -+{ -+ int ret; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ -+ do -+ { -+ ret = _issue_probereq_p2p(adapter, da, wait_ms>0?true:false); -+ -+ i++; -+ -+ if (adapter->bDriverStopped || adapter->bSurpriseRemoved) -+ break; -+ -+ if(i < try_cnt && wait_ms > 0 && ret==_FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ }while((iu.hdr.adapter; -+ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); -+ u8 *frame = recv_frame->u.hdr.rx_data; -+ u16 seq_ctrl = ( (recv_frame->u.hdr.attrib.seq_num&0xffff) << 4) | -+ (recv_frame->u.hdr.attrib.frag_num & 0xf); -+ -+ if (GetRetry(frame)) { -+ if (token >= 0) { -+ if ((seq_ctrl == mlmeext->action_public_rxseq) -+ && (token == mlmeext->action_public_dialog_token)) -+ { -+ DBG_871X(FUNC_ADPT_FMT" seq_ctrl=0x%x, rxseq=0x%x, token:%d\n", -+ FUNC_ADPT_ARG(adapter), seq_ctrl, mlmeext->action_public_rxseq, token); -+ return _FAIL; -+ } -+ } else { -+ if (seq_ctrl == mlmeext->action_public_rxseq) { -+ DBG_871X(FUNC_ADPT_FMT" seq_ctrl=0x%x, rxseq=0x%x\n", -+ FUNC_ADPT_ARG(adapter), seq_ctrl, mlmeext->action_public_rxseq); -+ return _FAIL; -+ } -+ } -+ } -+ -+ mlmeext->action_public_rxseq = seq_ctrl; -+ -+ if (token >= 0) -+ mlmeext->action_public_dialog_token = token; -+ -+ return _SUCCESS; -+} -+ -+static unsigned int on_action_public_p2p(union recv_frame *precv_frame) -+{ -+ _adapter *padapter = precv_frame->u.hdr.adapter; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ u8 *frame_body; -+ u8 dialogToken=0; -+#ifdef CONFIG_P2P -+ u8 *p2p_ie; -+ u32 p2p_ielen, wps_ielen; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ u8 result = P2P_STATUS_SUCCESS; -+ u8 empty_addr[ETH_ALEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; -+#endif //CONFIG_P2P -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ dialogToken = frame_body[7]; -+ -+ if (rtw_action_public_decache(precv_frame, dialogToken) == _FAIL) -+ return _FAIL; -+ -+#ifdef CONFIG_P2P -+ _cancel_timer_ex( &pwdinfo->reset_ch_sitesurvey ); -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211) -+ { -+ rtw_cfg80211_rx_p2p_action_public(padapter, pframe, len); -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ // Do nothing if the driver doesn't enable the P2P function. -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) -+ return _SUCCESS; -+ -+ len -= sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ switch( frame_body[ 6 ] )//OUI Subtype -+ { -+ case P2P_GO_NEGO_REQ: -+ { -+ DBG_871X( "[%s] Got GO Nego Req Frame\n", __FUNCTION__); -+ _rtw_memset( &pwdinfo->groupid_info, 0x00, sizeof( struct group_id_info ) ); -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ)) -+ { -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ } -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL)) -+ { -+ // Commented by Albert 20110526 -+ // In this case, this means the previous nego fail doesn't be reset yet. -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ // Restore the previous p2p state -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ DBG_871X( "[%s] Restore the previous p2p state to %d\n", __FUNCTION__, rtw_p2p_state(pwdinfo) ); -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ _cancel_timer_ex( &pwdinfo->ap_p2p_switch_timer ); -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ -+ // Commented by Kurt 20110902 -+ //Add if statement to avoid receiving duplicate prov disc req. such that pre_p2p_state would be covered. -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ -+ // Commented by Kurt 20120113 -+ // Get peer_dev_addr here if peer doesn't issue prov_disc frame. -+ if( _rtw_memcmp(pwdinfo->rx_prov_disc_info.peerDevAddr, empty_addr, ETH_ALEN) ) -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN); -+ -+ result = process_p2p_group_negotation_req( pwdinfo, frame_body, len ); -+ issue_p2p_GO_response( padapter, GetAddr2Ptr(pframe), frame_body, len, result ); -+#ifdef CONFIG_INTEL_WIDI -+ if( (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) && (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_WFD_CONNECTION) ) -+ { -+ padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; -+ _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL); -+ } -+#endif //CONFIG_INTEL_WIDI -+ -+ // Commented by Albert 20110718 -+ // No matter negotiating or negotiation failure, the driver should set up the restore P2P state timer. -+#ifdef CONFIG_CONCURRENT_MODE -+ // Commented by Albert 20120107 -+ _set_timer( &pwdinfo->restore_p2p_state_timer, 3000 ); -+#else // CONFIG_CONCURRENT_MODE -+ _set_timer( &pwdinfo->restore_p2p_state_timer, 5000 ); -+#endif // CONFIG_CONCURRENT_MODE -+ break; -+ } -+ case P2P_GO_NEGO_RESP: -+ { -+ DBG_871X( "[%s] Got GO Nego Resp Frame\n", __FUNCTION__); -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) -+ { -+ // Commented by Albert 20110425 -+ // The restore timer is enabled when issuing the nego request frame of rtw_p2p_connect function. -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ pwdinfo->nego_req_info.benable = false; -+ result = process_p2p_group_negotation_resp( pwdinfo, frame_body, len); -+ issue_p2p_GO_confirm( pwdinfo->padapter, GetAddr2Ptr(pframe), result); -+ if ( P2P_STATUS_SUCCESS == result ) -+ { -+ if ( rtw_p2p_role(pwdinfo) == P2P_ROLE_CLIENT ) -+ { -+ pwdinfo->p2p_info.operation_ch[ 0 ] = pwdinfo->peer_operating_ch; -+ pwdinfo->p2p_info.scan_op_ch_only = 1; -+ _set_timer( &pwdinfo->reset_ch_sitesurvey2, P2P_RESET_SCAN_CH ); -+ } -+ } -+ -+ // Reset the dialog token for group negotiation frames. -+ pwdinfo->negotiation_dialog_token = 1; -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL)) -+ { -+ _set_timer( &pwdinfo->restore_p2p_state_timer, 5000 ); -+ } -+ } -+ else -+ { -+ DBG_871X( "[%s] Skipped GO Nego Resp Frame (p2p_state != P2P_STATE_GONEGO_ING)\n", __FUNCTION__); -+ } -+ -+ break; -+ } -+ case P2P_GO_NEGO_CONF: -+ { -+ DBG_871X( "[%s] Got GO Nego Confirm Frame\n", __FUNCTION__); -+ result = process_p2p_group_negotation_confirm( pwdinfo, frame_body, len); -+ if ( P2P_STATUS_SUCCESS == result ) -+ { -+ if ( rtw_p2p_role(pwdinfo) == P2P_ROLE_CLIENT ) -+ { -+ pwdinfo->p2p_info.operation_ch[ 0 ] = pwdinfo->peer_operating_ch; -+ pwdinfo->p2p_info.scan_op_ch_only = 1; -+ _set_timer( &pwdinfo->reset_ch_sitesurvey2, P2P_RESET_SCAN_CH ); -+ } -+ } -+ break; -+ } -+ case P2P_INVIT_REQ: -+ { -+ // Added by Albert 2010/10/05 -+ // Received the P2P Invite Request frame. -+ -+ DBG_871X( "[%s] Got invite request frame!\n", __FUNCTION__ ); -+ if ( (p2p_ie=rtw_get_p2p_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen)) ) -+ { -+ // Parse the necessary information from the P2P Invitation Request frame. -+ // For example: The MAC address of sending this P2P Invitation Request frame. -+ u32 attr_contentlen = 0; -+ u8 status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ struct group_id_info group_id; -+ u8 invitation_flag = 0; -+ -+ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_INVITATION_FLAGS, &invitation_flag, &attr_contentlen); -+ if ( attr_contentlen ) -+ { -+ -+ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_GROUP_BSSID, pwdinfo->p2p_peer_interface_addr, &attr_contentlen); -+ // Commented by Albert 20120510 -+ // Copy to the pwdinfo->p2p_peer_interface_addr. -+ // So that the WFD UI ( or Sigma ) can get the peer interface address by using the following command. -+ // #> iwpriv wlan0 p2p_get peer_ifa -+ // After having the peer interface address, the sigma can find the correct conf file for wpa_supplicant. -+ -+ if ( attr_contentlen ) -+ { -+ DBG_871X( "[%s] GO's BSSID = %.2X %.2X %.2X %.2X %.2X %.2X\n", __FUNCTION__, -+ pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], -+ pwdinfo->p2p_peer_interface_addr[2], pwdinfo->p2p_peer_interface_addr[3], -+ pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5] ); -+ } -+ -+ if ( invitation_flag & P2P_INVITATION_FLAGS_PERSISTENT ) -+ { -+ // Re-invoke the persistent group. -+ -+ _rtw_memset( &group_id, 0x00, sizeof( struct group_id_info ) ); -+ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, ( u8* ) &group_id, &attr_contentlen); -+ if ( attr_contentlen ) -+ { -+ if ( _rtw_memcmp( group_id.go_device_addr, myid( &padapter->eeprompriv ), ETH_ALEN ) ) -+ { -+ // The p2p device sending this p2p invitation request wants this Wi-Fi device to be the persistent GO. -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_GO ); -+ rtw_p2p_set_role( pwdinfo, P2P_ROLE_GO ); -+ status_code = P2P_STATUS_SUCCESS; -+ } -+ else -+ { -+ // The p2p device sending this p2p invitation request wants to be the persistent GO. -+ if ( is_matched_in_profilelist( pwdinfo->p2p_peer_interface_addr, &pwdinfo->profileinfo[ 0 ] ) ) -+ { -+ u8 operatingch_info[5] = { 0x00 }; -+ if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen) ) -+ { -+ if( rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, (u32)operatingch_info[4] ) ) -+ { -+ // The operating channel is acceptable for this device. -+ pwdinfo->rx_invitereq_info.operation_ch[0]= operatingch_info[4]; -+ pwdinfo->rx_invitereq_info.scan_op_ch_only = 1; -+ _set_timer( &pwdinfo->reset_ch_sitesurvey, P2P_RESET_SCAN_CH ); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_MATCH ); -+ rtw_p2p_set_role( pwdinfo, P2P_ROLE_CLIENT ); -+ status_code = P2P_STATUS_SUCCESS; -+ } -+ else -+ { -+ // The operating channel isn't supported by this device. -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_DISMATCH ); -+ rtw_p2p_set_role( pwdinfo, P2P_ROLE_DEVICE ); -+ status_code = P2P_STATUS_FAIL_NO_COMMON_CH; -+ _set_timer( &pwdinfo->restore_p2p_state_timer, 3000 ); -+ } -+ } -+ else -+ { -+ // Commented by Albert 20121130 -+ // Intel will use the different P2P IE to store the operating channel information -+ // Workaround for Intel WiDi 3.5 -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_MATCH ); -+ rtw_p2p_set_role( pwdinfo, P2P_ROLE_CLIENT ); -+ status_code = P2P_STATUS_SUCCESS; -+ } -+ } -+ else -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_DISMATCH ); -+ #ifdef CONFIG_INTEL_WIDI -+ _rtw_memcpy( pwdinfo->p2p_peer_device_addr, group_id.go_device_addr , ETH_ALEN ); -+ rtw_p2p_set_role( pwdinfo, P2P_ROLE_CLIENT ); -+ #endif //CONFIG_INTEL_WIDI -+ -+ status_code = P2P_STATUS_FAIL_UNKNOWN_P2PGROUP; -+ } -+ } -+ } -+ else -+ { -+ DBG_871X( "[%s] P2P Group ID Attribute NOT FOUND!\n", __FUNCTION__ ); -+ status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ } -+ } -+ else -+ { -+ // Received the invitation to join a P2P group. -+ -+ _rtw_memset( &group_id, 0x00, sizeof( struct group_id_info ) ); -+ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, ( u8* ) &group_id, &attr_contentlen); -+ if ( attr_contentlen ) -+ { -+ if ( _rtw_memcmp( group_id.go_device_addr, myid( &padapter->eeprompriv ), ETH_ALEN ) ) -+ { -+ // In this case, the GO can't be myself. -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_DISMATCH ); -+ status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ } -+ else -+ { -+ // The p2p device sending this p2p invitation request wants to join an existing P2P group -+ // Commented by Albert 2012/06/28 -+ // In this case, this Wi-Fi device should use the iwpriv command to get the peer device address. -+ // The peer device address should be the destination address for the provisioning discovery request. -+ // Then, this Wi-Fi device should use the iwpriv command to get the peer interface address. -+ // The peer interface address should be the address for WPS mac address -+ _rtw_memcpy( pwdinfo->p2p_peer_device_addr, group_id.go_device_addr , ETH_ALEN ); -+ rtw_p2p_set_role( pwdinfo, P2P_ROLE_CLIENT ); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_JOIN ); -+ status_code = P2P_STATUS_SUCCESS; -+ } -+ } -+ else -+ { -+ DBG_871X( "[%s] P2P Group ID Attribute NOT FOUND!\n", __FUNCTION__ ); -+ status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ } -+ } -+ } -+ else -+ { -+ DBG_871X( "[%s] P2P Invitation Flags Attribute NOT FOUND!\n", __FUNCTION__ ); -+ status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ } -+ -+ DBG_871X( "[%s] status_code = %d\n", __FUNCTION__, status_code ); -+ -+ pwdinfo->inviteresp_info.token = frame_body[ 7 ]; -+ issue_p2p_invitation_response( padapter, GetAddr2Ptr(pframe), pwdinfo->inviteresp_info.token, status_code ); -+ } -+#ifdef CONFIG_INTEL_WIDI -+ if( (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) && (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_WFD_CONNECTION) ) -+ { -+ padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; -+ _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL); -+ } -+#endif //CONFIG_INTEL_WIDI -+ break; -+ } -+ case P2P_INVIT_RESP: -+ { -+ u8 attr_content = 0x00; -+ u32 attr_contentlen = 0; -+ -+ DBG_871X( "[%s] Got invite response frame!\n", __FUNCTION__ ); -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ if ( (p2p_ie=rtw_get_p2p_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen)) ) -+ { -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, &attr_content, &attr_contentlen); -+ -+ if ( attr_contentlen == 1 ) -+ { -+ DBG_871X( "[%s] Status = %d\n", __FUNCTION__, attr_content ); -+ pwdinfo->invitereq_info.benable = false; -+ -+ if ( attr_content == P2P_STATUS_SUCCESS ) -+ { -+ if ( _rtw_memcmp( pwdinfo->invitereq_info.go_bssid, myid( &padapter->eeprompriv ), ETH_ALEN )) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO ); -+ } -+ else -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ } -+ rtw_p2p_set_state( pwdinfo, P2P_STATE_RX_INVITE_RESP_OK ); -+ } -+ else -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ rtw_p2p_set_state( pwdinfo, P2P_STATE_RX_INVITE_RESP_FAIL ); -+ } -+ } -+ else -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ rtw_p2p_set_state( pwdinfo, P2P_STATE_RX_INVITE_RESP_FAIL ); -+ } -+ } -+ else -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ rtw_p2p_set_state( pwdinfo, P2P_STATE_RX_INVITE_RESP_FAIL ); -+ } -+ -+ if ( rtw_p2p_chk_state( pwdinfo, P2P_STATE_RX_INVITE_RESP_FAIL ) ) -+ { -+ _set_timer( &pwdinfo->restore_p2p_state_timer, 5000 ); -+ } -+ break; -+ } -+ case P2P_DEVDISC_REQ: -+ -+ process_p2p_devdisc_req(pwdinfo, pframe, len); -+ -+ break; -+ -+ case P2P_DEVDISC_RESP: -+ -+ process_p2p_devdisc_resp(pwdinfo, pframe, len); -+ -+ break; -+ -+ case P2P_PROVISION_DISC_REQ: -+ DBG_871X( "[%s] Got Provisioning Discovery Request Frame\n", __FUNCTION__ ); -+ process_p2p_provdisc_req(pwdinfo, pframe, len); -+ _rtw_memcpy(pwdinfo->rx_prov_disc_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN); -+ -+ //20110902 Kurt -+ //Add the following statement to avoid receiving duplicate prov disc req. such that pre_p2p_state would be covered. -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ)) -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ); -+ _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT ); -+#ifdef CONFIG_INTEL_WIDI -+ if( (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) && (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_WFD_CONNECTION) ) -+ { -+ padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; -+ _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL); -+ } -+#endif //CONFIG_INTEL_WIDI -+ break; -+ -+ case P2P_PROVISION_DISC_RESP: -+ // Commented by Albert 20110707 -+ // Should we check the pwdinfo->tx_prov_disc_info.bsent flag here?? -+ DBG_871X( "[%s] Got Provisioning Discovery Response Frame\n", __FUNCTION__ ); -+ // Commented by Albert 20110426 -+ // The restore timer is enabled when issuing the provisioing request frame in rtw_p2p_prov_disc function. -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_RSP); -+ process_p2p_provdisc_resp(pwdinfo, pframe); -+ _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT ); -+ break; -+ -+ } -+ } -+#endif //CONFIG_P2P -+ -+ return _SUCCESS; -+} -+ -+static unsigned int on_action_public_vendor(union recv_frame *precv_frame) -+{ -+ unsigned int ret = _FAIL; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if (_rtw_memcmp(frame_body + 2, P2P_OUI, 4) == true) { -+ ret = on_action_public_p2p(precv_frame); -+ } -+ -+ return ret; -+} -+ -+static unsigned int on_action_public_default(union recv_frame *precv_frame, u8 action) -+{ -+ unsigned int ret = _FAIL; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 token; -+ _adapter *adapter = precv_frame->u.hdr.adapter; -+ int cnt = 0; -+ char msg[64]; -+ -+ token = frame_body[2]; -+ -+ if (rtw_action_public_decache(precv_frame, token) == _FAIL) -+ goto exit; -+ -+ #ifdef CONFIG_IOCTL_CFG80211 -+ cnt += sprintf((msg+cnt), "%s(token:%u)", action_public_str(action), token); -+ rtw_cfg80211_rx_action(adapter, pframe, frame_len, msg); -+ #endif -+ -+ ret = _SUCCESS; -+ -+exit: -+ return ret; -+} -+ -+unsigned int on_action_public(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ unsigned int ret = _FAIL; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint frame_len = precv_frame->u.hdr.len; -+ u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 category, action; -+ -+ /* check RA matches or not */ -+ if (!_rtw_memcmp(myid(&(padapter->eeprompriv)), GetAddr1Ptr(pframe), ETH_ALEN)) -+ goto exit; -+ -+ category = frame_body[0]; -+ if(category != RTW_WLAN_CATEGORY_PUBLIC) -+ goto exit; -+ -+ action = frame_body[1]; -+ switch (action) { -+ case ACT_PUBLIC_VENDOR: -+ ret = on_action_public_vendor(precv_frame); -+ break; -+ default: -+ ret = on_action_public_default(precv_frame, action); -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+unsigned int OnAction_ht(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ return _SUCCESS; -+} -+ -+unsigned int OnAction_wmm(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ return _SUCCESS; -+} -+ -+unsigned int OnAction_p2p(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_P2P -+ u8 *frame_body; -+ u8 category, OUI_Subtype, dialogToken=0; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ uint len = precv_frame->u.hdr.len; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ //check RA matches or not -+ if (!_rtw_memcmp(myid(&(padapter->eeprompriv)), GetAddr1Ptr(pframe), ETH_ALEN))//for if1, sta/ap mode -+ return _SUCCESS; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ category = frame_body[0]; -+ if(category != RTW_WLAN_CATEGORY_P2P) -+ return _SUCCESS; -+ -+ if (be32_to_cpu(*((__be32 *)(frame_body + 1))) != P2POUI ) -+ return _SUCCESS; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ rtw_cfg80211_rx_action_p2p(padapter, pframe, len); -+ return _SUCCESS; -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ len -= sizeof(struct rtw_ieee80211_hdr_3addr); -+ OUI_Subtype = frame_body[5]; -+ dialogToken = frame_body[6]; -+ -+ switch(OUI_Subtype) -+ { -+ case P2P_NOTICE_OF_ABSENCE: -+ -+ break; -+ -+ case P2P_PRESENCE_REQUEST: -+ -+ process_p2p_presence_req(pwdinfo, pframe, len); -+ -+ break; -+ -+ case P2P_PRESENCE_RESPONSE: -+ -+ break; -+ -+ case P2P_GO_DISC_REQUEST: -+ -+ break; -+ -+ default: -+ break; -+ -+ } -+ } -+#endif //CONFIG_P2P -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int OnAction(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ int i; -+ unsigned char category; -+ struct action_handler *ptable; -+ unsigned char *frame_body; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ category = frame_body[0]; -+ -+ for(i = 0; i < sizeof(OnAction_tbl)/sizeof(struct action_handler); i++) -+ { -+ ptable = &OnAction_tbl[i]; -+ -+ if(category == ptable->num) -+ ptable->func(padapter, precv_frame); -+ -+ } -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int DoReserved(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ -+ //DBG_871X("rcvd mgt frame(%x, %x)\n", (GetFrameSubType(pframe) >> 4), *(unsigned int *)GetAddr1Ptr(pframe)); -+ return _SUCCESS; -+} -+ -+static struct xmit_frame *_alloc_mgtxmitframe(struct xmit_priv *pxmitpriv, bool once) -+{ -+ struct xmit_frame *pmgntframe; -+ struct xmit_buf *pxmitbuf; -+ -+ if (once) -+ pmgntframe = rtw_alloc_xmitframe_once(pxmitpriv); -+ else -+ pmgntframe = rtw_alloc_xmitframe_ext(pxmitpriv); -+ -+ if (pmgntframe == NULL) { -+ DBG_871X(FUNC_ADPT_FMT" alloc xmitframe fail, once:%d\n", FUNC_ADPT_ARG(pxmitpriv->adapter), once); -+ goto exit; -+ } -+ -+ if ((pxmitbuf = rtw_alloc_xmitbuf_ext(pxmitpriv)) == NULL) { -+ DBG_871X(FUNC_ADPT_FMT" alloc xmitbuf fail\n", FUNC_ADPT_ARG(pxmitpriv->adapter)); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ pmgntframe = NULL; -+ goto exit; -+ } -+ -+ pmgntframe->frame_tag = MGNT_FRAMETAG; -+ pmgntframe->pxmitbuf = pxmitbuf; -+ pmgntframe->buf_addr = pxmitbuf->pbuf; -+ pxmitbuf->priv_data = pmgntframe; -+ -+exit: -+ return pmgntframe; -+ -+} -+ -+inline struct xmit_frame *alloc_mgtxmitframe(struct xmit_priv *pxmitpriv) -+{ -+ return _alloc_mgtxmitframe(pxmitpriv, false); -+} -+ -+inline struct xmit_frame *alloc_mgtxmitframe_once(struct xmit_priv *pxmitpriv) -+{ -+ return _alloc_mgtxmitframe(pxmitpriv, true); -+} -+ -+ -+/**************************************************************************** -+ -+Following are some TX fuctions for WiFi MLME -+ -+*****************************************************************************/ -+ -+void update_mgnt_tx_rate(_adapter *padapter, u8 rate) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ pmlmeext->tx_rate = rate; -+ //DBG_871X("%s(): rate = %x\n",__FUNCTION__, rate); -+} -+ -+void update_mgntframe_attrib(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ u8 wireless_mode; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ //_rtw_memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); -+ -+ pattrib->hdrlen = 24; -+ pattrib->nr_frags = 1; -+ pattrib->priority = 7; -+ pattrib->mac_id = 0; -+ pattrib->qsel = 0x12; -+ -+ pattrib->pktlen = 0; -+ -+ if (pmlmeext->tx_rate == IEEE80211_CCK_RATE_1MB) -+ wireless_mode = WIRELESS_11B; -+ else -+ wireless_mode = WIRELESS_11G; -+ pattrib->raid = rtw_get_mgntframe_raid(padapter, wireless_mode); -+ -+ pattrib->encrypt = _NO_PRIVACY_; -+ pattrib->bswenc = false; -+ -+ pattrib->qos_en = false; -+ pattrib->ht_en = false; -+ pattrib->bwmode = CHANNEL_WIDTH_20; -+ pattrib->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pattrib->sgi = false; -+ -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ -+ pattrib->retry_ctrl = true; -+ -+ pattrib->mbssid = 0; -+ -+} -+ -+void update_mgntframe_attrib_addr(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ u8 *pframe; -+ struct pkt_attrib *pattrib = &pmgntframe->attrib; -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(pframe), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(pframe), ETH_ALEN); -+} -+ -+void dump_mgntframe(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ if(padapter->bSurpriseRemoved == true || -+ padapter->bDriverStopped == true) -+ return; -+ -+ rtw_hal_mgnt_xmit(padapter, pmgntframe); -+} -+ -+s32 dump_mgntframe_and_wait(_adapter *padapter, struct xmit_frame *pmgntframe, int timeout_ms) -+{ -+ s32 ret = _FAIL; -+ _irqL irqL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_buf *pxmitbuf = pmgntframe->pxmitbuf; -+ struct submit_ctx sctx; -+ -+ if(padapter->bSurpriseRemoved == true || -+ padapter->bDriverStopped == true) -+ return ret; -+ -+ rtw_sctx_init(&sctx, timeout_ms); -+ pxmitbuf->sctx = &sctx; -+ -+ ret = rtw_hal_mgnt_xmit(padapter, pmgntframe); -+ -+ if (ret == _SUCCESS) -+ ret = rtw_sctx_wait(&sctx); -+ -+ _enter_critical(&pxmitpriv->lock_sctx, &irqL); -+ pxmitbuf->sctx = NULL; -+ _exit_critical(&pxmitpriv->lock_sctx, &irqL); -+ -+ return ret; -+} -+ -+s32 dump_mgntframe_and_wait_ack(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+#ifdef CONFIG_XMIT_ACK -+ s32 ret = _FAIL; -+ u32 timeout_ms = 500;// 500ms -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->pbuddy_adapter && !padapter->isprimary) -+ pxmitpriv = &(padapter->pbuddy_adapter->xmitpriv); -+ #endif -+ -+ if(padapter->bSurpriseRemoved == true || -+ padapter->bDriverStopped == true) -+ return -1; -+ -+ _enter_critical_mutex(&pxmitpriv->ack_tx_mutex, NULL); -+ pxmitpriv->ack_tx = true; -+ -+ pmgntframe->ack_report = 1; -+ if (rtw_hal_mgnt_xmit(padapter, pmgntframe) == _SUCCESS) { -+ ret = rtw_ack_tx_wait(pxmitpriv, timeout_ms); -+ } -+ -+ pxmitpriv->ack_tx = false; -+ _exit_critical_mutex(&pxmitpriv->ack_tx_mutex, NULL); -+ -+ return ret; -+#else //!CONFIG_XMIT_ACK -+ dump_mgntframe(padapter, pmgntframe); -+ rtw_msleep_os(50); -+ return _SUCCESS; -+#endif //!CONFIG_XMIT_ACK -+} -+ -+static int update_hidden_ssid(u8 *ies, u32 ies_len, u8 hidden_ssid_mode) -+{ -+ u8 *ssid_ie; -+ sint ssid_len_ori; -+ int len_diff = 0; -+ -+ ssid_ie = rtw_get_ie(ies, WLAN_EID_SSID, &ssid_len_ori, ies_len); -+ -+ //DBG_871X("%s hidden_ssid_mode:%u, ssid_ie:%p, ssid_len_ori:%d\n", __FUNCTION__, hidden_ssid_mode, ssid_ie, ssid_len_ori); -+ -+ if(ssid_ie && ssid_len_ori>0) -+ { -+ switch(hidden_ssid_mode) -+ { -+ case 1: -+ { -+ u8 *next_ie = ssid_ie + 2 + ssid_len_ori; -+ u32 remain_len = 0; -+ -+ remain_len = ies_len -(next_ie-ies); -+ -+ ssid_ie[1] = 0; -+ _rtw_memcpy(ssid_ie+2, next_ie, remain_len); -+ len_diff -= ssid_len_ori; -+ -+ break; -+ } -+ case 2: -+ _rtw_memset(&ssid_ie[2], 0, ssid_len_ori); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ return len_diff; -+} -+ -+void issue_beacon(_adapter *padapter, int timeout_ms) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ unsigned int rate_len; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+#endif //#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#endif //CONFIG_P2P -+ -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ DBG_871X("%s, alloc mgnt frame fail\n", __FUNCTION__); -+ return; -+ } -+#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+#endif //#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->qsel = 0x10; -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->iface_type == IFACE_PORT1) -+ pattrib->mbssid = 1; -+ #endif -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ //pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof (struct rtw_ieee80211_hdr_3addr); -+ -+ if( (pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ { -+ //DBG_871X("ie len=%d\n", cur_network->IELength); -+#ifdef CONFIG_P2P -+ // for P2P : Primary Device Type & Device Name -+ u32 wpsielen=0, insert_len=0; -+ u8 *wpsie=NULL; -+ wpsie = rtw_get_wps_ie(cur_network->IEs+_FIXED_IE_LENGTH_, cur_network->IELength-_FIXED_IE_LENGTH_, NULL, &wpsielen); -+ -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && wpsie && wpsielen>0) -+ { -+ uint wps_offset, remainder_ielen; -+ u8 *premainder_ie, *pframe_wscie; -+ -+ wps_offset = (uint)(wpsie - cur_network->IEs); -+ -+ premainder_ie = wpsie + wpsielen; -+ -+ remainder_ielen = cur_network->IELength - wps_offset - wpsielen; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(pmlmepriv->wps_beacon_ie && pmlmepriv->wps_beacon_ie_len>0) -+ { -+ _rtw_memcpy(pframe, cur_network->IEs, wps_offset); -+ pframe += wps_offset; -+ pattrib->pktlen += wps_offset; -+ -+ _rtw_memcpy(pframe, pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len); -+ pframe += pmlmepriv->wps_beacon_ie_len; -+ pattrib->pktlen += pmlmepriv->wps_beacon_ie_len; -+ -+ //copy remainder_ie to pframe -+ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pattrib->pktlen += remainder_ielen; -+ } -+ else -+ { -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ pframe += cur_network->IELength; -+ pattrib->pktlen += cur_network->IELength; -+ } -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ pframe_wscie = pframe + wps_offset; -+ _rtw_memcpy(pframe, cur_network->IEs, wps_offset+wpsielen); -+ pframe += (wps_offset + wpsielen); -+ pattrib->pktlen += (wps_offset + wpsielen); -+ -+ //now pframe is end of wsc ie, insert Primary Device Type & Device Name -+ // Primary Device Type -+ // Type: -+ *(__be16*) ( pframe + insert_len) = cpu_to_be16( WPS_ATTR_PRIMARY_DEV_TYPE ); -+ insert_len += 2; -+ -+ // Length: -+ *(__be16*) ( pframe + insert_len ) = cpu_to_be16( 0x0008 ); -+ insert_len += 2; -+ -+ // Value: -+ // Category ID -+ *(__be16*) ( pframe + insert_len ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ insert_len += 2; -+ -+ // OUI -+ *(__be32*) ( pframe + insert_len ) = cpu_to_be32( WPSOUI ); -+ insert_len += 4; -+ -+ // Sub Category ID -+ *(__be16*) ( pframe + insert_len ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ insert_len += 2; -+ -+ -+ // Device Name -+ // Type: -+ *(__be16*) ( pframe + insert_len ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ insert_len += 2; -+ -+ // Length: -+ *(__be16*) ( pframe + insert_len ) = cpu_to_be16( pwdinfo->device_name_len ); -+ insert_len += 2; -+ -+ // Value: -+ _rtw_memcpy( pframe + insert_len, pwdinfo->device_name, pwdinfo->device_name_len ); -+ insert_len += pwdinfo->device_name_len; -+ -+ -+ //update wsc ie length -+ *(pframe_wscie+1) = (wpsielen -2) + insert_len; -+ -+ //pframe move to end -+ pframe+=insert_len; -+ pattrib->pktlen += insert_len; -+ -+ //copy remainder_ie to pframe -+ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pattrib->pktlen += remainder_ielen; -+ } -+ } -+ else -+#endif //CONFIG_P2P -+ { -+ int len_diff; -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ len_diff = update_hidden_ssid( -+ pframe+_BEACON_IE_OFFSET_ -+ , cur_network->IELength-_BEACON_IE_OFFSET_ -+ , pmlmeinfo->hidden_ssid_mode -+ ); -+ pframe += (cur_network->IELength+len_diff); -+ pattrib->pktlen += (cur_network->IELength+len_diff); -+ } -+ -+ { -+ u8 *wps_ie; -+ uint wps_ielen; -+ u8 sr = 0; -+ wps_ie = rtw_get_wps_ie(pmgntframe->buf_addr+TXDESC_OFFSET+sizeof (struct rtw_ieee80211_hdr_3addr)+_BEACON_IE_OFFSET_, -+ pattrib->pktlen-sizeof (struct rtw_ieee80211_hdr_3addr)-_BEACON_IE_OFFSET_, NULL, &wps_ielen); -+ if (wps_ie && wps_ielen>0) { -+ rtw_get_wps_attr_content(wps_ie, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8*)(&sr), NULL); -+ } -+ if (sr != 0) -+ set_fwstate(pmlmepriv, WIFI_UNDER_WPS); -+ else -+ _clr_fwstate_(pmlmepriv, WIFI_UNDER_WPS); -+ } -+ -+#ifdef CONFIG_P2P -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ u32 len; -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ len = pmlmepriv->p2p_beacon_ie_len; -+ if(pmlmepriv->p2p_beacon_ie && len>0) -+ _rtw_memcpy(pframe, pmlmepriv->p2p_beacon_ie, len); -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ len = build_beacon_p2p_ie(pwdinfo, pframe); -+ } -+ -+ pframe += len; -+ pattrib->pktlen += len; -+#ifdef CONFIG_WFD -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(true == pwdinfo->wfd_info->wfd_enable) -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ len = build_beacon_wfd_ie( pwdinfo, pframe ); -+ } -+#ifdef CONFIG_IOCTL_CFG80211 -+ else -+ { -+ len = 0; -+ if(pmlmepriv->wfd_beacon_ie && pmlmepriv->wfd_beacon_ie_len>0) -+ { -+ len = pmlmepriv->wfd_beacon_ie_len; -+ _rtw_memcpy(pframe, pmlmepriv->wfd_beacon_ie, len); -+ } -+ } -+#endif //CONFIG_IOCTL_CFG80211 -+ pframe += len; -+ pattrib->pktlen += len; -+#endif //CONFIG_WFD -+ } -+#endif //CONFIG_P2P -+ -+ goto _issue_bcn; -+ -+ } -+ -+ //below for ad-hoc mode -+ -+ //timestamp will be inserted by hardware -+ pframe += 8; -+ pattrib->pktlen += 8; -+ -+ // beacon interval: 2 bytes -+ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ // capability info: 2 bytes -+ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ // SSID -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pattrib->pktlen); -+ -+ // supported rates... -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8)? 8: rate_len), cur_network->SupportedRates, &pattrib->pktlen); -+ -+ // DS parameter set -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pattrib->pktlen); -+ -+ //if( (pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) -+ { -+ u8 erpinfo=0; -+ u32 ATIMWindow; -+ // IBSS Parameter Set... -+ //ATIMWindow = cur->Configuration.ATIMWindow; -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pattrib->pktlen); -+ -+ //ERP IE -+ pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pattrib->pktlen); -+ } -+ -+ -+ // EXTERNDED SUPPORTED RATE -+ if (rate_len > 8) -+ { -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pattrib->pktlen); -+ } -+ -+ -+ //todo:HT for adhoc -+ -+_issue_bcn: -+ -+#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ pmlmepriv->update_bcn = false; -+ -+ _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); -+#endif //#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ -+ if ((pattrib->pktlen + TXDESC_SIZE) > 512) -+ { -+ DBG_871X("beacon frame too large\n"); -+ return; -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ //DBG_871X("issue bcn_sz=%d\n", pattrib->last_txcmdsz); -+ if(timeout_ms > 0) -+ dump_mgntframe_and_wait(padapter, pmgntframe, timeout_ms); -+ else -+ dump_mgntframe(padapter, pmgntframe); -+ -+} -+ -+void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probereq) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ unsigned char *mac, *bssid; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ u8 *pwps_ie; -+ uint wps_ielen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#endif //#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ unsigned int rate_len; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+#endif //CONFIG_P2P -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ if(da == NULL) -+ return; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ DBG_871X("%s, alloc mgnt frame fail\n", __FUNCTION__); -+ return; -+ } -+ -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = myid(&(padapter->eeprompriv)); -+ bssid = cur_network->MacAddress; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(fctrl, WIFI_PROBERSP); -+ -+ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = pattrib->hdrlen; -+ pframe += pattrib->hdrlen; -+ -+ -+ if(cur_network->IELength>MAX_IE_SZ) -+ return; -+ -+#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ if( (pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ { -+ pwps_ie = rtw_get_wps_ie(cur_network->IEs+_FIXED_IE_LENGTH_, cur_network->IELength-_FIXED_IE_LENGTH_, NULL, &wps_ielen); -+ -+ //inerset & update wps_probe_resp_ie -+ if((pmlmepriv->wps_probe_resp_ie!=NULL) && pwps_ie && (wps_ielen>0)) -+ { -+ uint wps_offset, remainder_ielen; -+ u8 *premainder_ie; -+ -+ wps_offset = (uint)(pwps_ie - cur_network->IEs); -+ -+ premainder_ie = pwps_ie + wps_ielen; -+ -+ remainder_ielen = cur_network->IELength - wps_offset - wps_ielen; -+ -+ _rtw_memcpy(pframe, cur_network->IEs, wps_offset); -+ pframe += wps_offset; -+ pattrib->pktlen += wps_offset; -+ -+ wps_ielen = (uint)pmlmepriv->wps_probe_resp_ie[1];//to get ie data len -+ if((wps_offset+wps_ielen+2)<=MAX_IE_SZ) -+ { -+ _rtw_memcpy(pframe, pmlmepriv->wps_probe_resp_ie, wps_ielen+2); -+ pframe += wps_ielen+2; -+ pattrib->pktlen += wps_ielen+2; -+ } -+ -+ if((wps_offset+wps_ielen+2+remainder_ielen)<=MAX_IE_SZ) -+ { -+ _rtw_memcpy(pframe, premainder_ie, remainder_ielen); -+ pframe += remainder_ielen; -+ pattrib->pktlen += remainder_ielen; -+ } -+ } -+ else -+ { -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ pframe += cur_network->IELength; -+ pattrib->pktlen += cur_network->IELength; -+ } -+ -+ /* retrieve SSID IE from cur_network->Ssid */ -+ { -+ u8 *ssid_ie; -+ sint ssid_ielen; -+ sint ssid_ielen_diff; -+ u8 buf[MAX_IE_SZ]; -+ u8 *ies = pmgntframe->buf_addr+TXDESC_OFFSET+sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ ssid_ie = rtw_get_ie(ies+_FIXED_IE_LENGTH_, _SSID_IE_, &ssid_ielen, -+ (pframe-ies)-_FIXED_IE_LENGTH_); -+ -+ ssid_ielen_diff = cur_network->Ssid.SsidLength - ssid_ielen; -+ -+ if (ssid_ie && cur_network->Ssid.SsidLength) { -+ uint remainder_ielen; -+ u8 *remainder_ie; -+ remainder_ie = ssid_ie+2; -+ remainder_ielen = (pframe-remainder_ie); -+ -+ DBG_871X_LEVEL(_drv_warning_, FUNC_ADPT_FMT" remainder_ielen > MAX_IE_SZ\n", FUNC_ADPT_ARG(padapter)); -+ if (remainder_ielen > MAX_IE_SZ) { -+ remainder_ielen = MAX_IE_SZ; -+ } -+ -+ _rtw_memcpy(buf, remainder_ie, remainder_ielen); -+ _rtw_memcpy(remainder_ie+ssid_ielen_diff, buf, remainder_ielen); -+ *(ssid_ie+1) = cur_network->Ssid.SsidLength; -+ _rtw_memcpy(ssid_ie+2, cur_network->Ssid.Ssid, cur_network->Ssid.SsidLength); -+ -+ pframe += ssid_ielen_diff; -+ pattrib->pktlen += ssid_ielen_diff; -+ } -+ } -+ } -+ else -+#endif -+ { -+ -+ //timestamp will be inserted by hardware -+ pframe += 8; -+ pattrib->pktlen += 8; -+ -+ // beacon interval: 2 bytes -+ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ // capability info: 2 bytes -+ -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ //below for ad-hoc mode -+ -+ // SSID -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pattrib->pktlen); -+ -+ // supported rates... -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8)? 8: rate_len), cur_network->SupportedRates, &pattrib->pktlen); -+ -+ // DS parameter set -+ pframe =rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pattrib->pktlen); -+ -+ if( (pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) -+ { -+ u8 erpinfo=0; -+ u32 ATIMWindow; -+ // IBSS Parameter Set... -+ //ATIMWindow = cur->Configuration.ATIMWindow; -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pattrib->pktlen); -+ -+ //ERP IE -+ pframe = rtw_set_ie(pframe, _ERPINFO_IE_, 1, &erpinfo, &pattrib->pktlen); -+ } -+ -+ -+ // EXTERNDED SUPPORTED RATE -+ if (rate_len > 8) -+ { -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pattrib->pktlen); -+ } -+ -+ -+ //todo:HT for adhoc -+ -+ } -+ -+#ifdef CONFIG_P2P -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && is_valid_p2p_probereq) -+ { -+ u32 len; -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ //if pwdinfo->role == P2P_ROLE_DEVICE will call issue_probersp_p2p() -+ len = pmlmepriv->p2p_go_probe_resp_ie_len; -+ if(pmlmepriv->p2p_go_probe_resp_ie && len>0) -+ _rtw_memcpy(pframe, pmlmepriv->p2p_go_probe_resp_ie, len); -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ len = build_probe_resp_p2p_ie(pwdinfo, pframe); -+ } -+ -+ pframe += len; -+ pattrib->pktlen += len; -+ -+#ifdef CONFIG_WFD -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(true == pwdinfo->wfd_info->wfd_enable) -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ len = build_probe_resp_wfd_ie(pwdinfo, pframe, 0); -+ } -+#ifdef CONFIG_IOCTL_CFG80211 -+ else -+ { -+ len = 0; -+ if(pmlmepriv->wfd_probe_resp_ie && pmlmepriv->wfd_probe_resp_ie_len>0) -+ { -+ len = pmlmepriv->wfd_probe_resp_ie_len; -+ _rtw_memcpy(pframe, pmlmepriv->wfd_probe_resp_ie, len); -+ } -+ } -+#endif //CONFIG_IOCTL_CFG80211 -+ pframe += len; -+ pattrib->pktlen += len; -+#endif //CONFIG_WFD -+ -+ } -+#endif //CONFIG_P2P -+ -+ -+#ifdef CONFIG_AUTO_AP_MODE -+{ -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("(%s)\n", __FUNCTION__); -+ -+ //check rc station -+ psta = rtw_get_stainfo(pstapriv, da); -+ if (psta && psta->isrc && psta->pid>0) -+ { -+ u8 RC_OUI[4]={0x00,0xE0,0x4C,0x0A}; -+ u8 RC_INFO[14] = {0}; -+ //EID[1] + EID_LEN[1] + RC_OUI[4] + MAC[6] + PairingID[2] + ChannelNum[2] -+ u16 cu_ch = le16_to_cpu(cur_network->Configuration.DSConfig) -+ -+ DBG_871X("%s, reply rc(pid=0x%x) device "MAC_FMT" in ch=%d\n", __FUNCTION__, -+ psta->pid, MAC_ARG(psta->hwaddr), cu_ch); -+ -+ //append vendor specific ie -+ _rtw_memcpy(RC_INFO, RC_OUI, sizeof(RC_OUI)); -+ _rtw_memcpy(&RC_INFO[4], mac, ETH_ALEN); -+ _rtw_memcpy(&RC_INFO[10], (u8*)&psta->pid, 2); -+ _rtw_memcpy(&RC_INFO[12], (u8*)&cu_ch, 2); -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, sizeof(RC_INFO), RC_INFO, &pattrib->pktlen); -+ } -+} -+#endif //CONFIG_AUTO_AP_MODE -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+static int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, int wait_ack) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ unsigned char *mac; -+ unsigned char bssrate[NumRates]; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int bssrate_len = 0; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_notice_,("+issue_probereq\n")); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ goto exit; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = myid(&(padapter->eeprompriv)); -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ if (da) -+ { -+ // unicast probe request frame -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, da, ETH_ALEN); -+ } -+ else -+ { -+ // broadcast probe request frame -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, bc_addr, ETH_ALEN); -+ } -+ -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_PROBEREQ); -+ -+ pframe += sizeof (struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof (struct rtw_ieee80211_hdr_3addr); -+ -+ if(pssid) -+ pframe = rtw_set_ie(pframe, _SSID_IE_, pssid->SsidLength, pssid->Ssid, &(pattrib->pktlen)); -+ else -+ pframe = rtw_set_ie(pframe, _SSID_IE_, 0, NULL, &(pattrib->pktlen)); -+ -+ get_rate_set(padapter, bssrate, &bssrate_len); -+ -+ if (bssrate_len > 8) -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); -+ } -+ else -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); -+ } -+ -+#if 0 -+ //add wps_ie for wps2.0 -+ if(pmlmepriv->probereq_wpsie_len>0 && pmlmepriv->probereq_wpsie_lenprobereq_wpsie, pmlmepriv->probereq_wpsie_len); -+ pframe += pmlmepriv->probereq_wpsie_len; -+ pattrib->pktlen += pmlmepriv->probereq_wpsie_len; -+ //pmlmepriv->probereq_wpsie_len = 0 ;//reset to zero -+ } -+#else -+ //add wps_ie for wps2.0 -+ if(pmlmepriv->wps_probe_req_ie_len>0 && pmlmepriv->wps_probe_req_ie) -+ { -+ _rtw_memcpy(pframe, pmlmepriv->wps_probe_req_ie, pmlmepriv->wps_probe_req_ie_len); -+ pframe += pmlmepriv->wps_probe_req_ie_len; -+ pattrib->pktlen += pmlmepriv->wps_probe_req_ie_len; -+ //pmlmepriv->wps_probe_req_ie_len = 0 ;//reset to zero -+ } -+#endif -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_notice_,("issuing probe_req, tx_len=%d\n", pattrib->last_txcmdsz)); -+ -+ if (wait_ack) { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } else { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+inline void issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da) -+{ -+ _issue_probereq(padapter, pssid, da, false); -+} -+ -+int issue_probereq_ex(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, -+ int try_cnt, int wait_ms) -+{ -+ int ret; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ -+ do -+ { -+ ret = _issue_probereq(padapter, pssid, da, wait_ms>0?true:false); -+ -+ i++; -+ -+ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) -+ break; -+ -+ if(i < try_cnt && wait_ms > 0 && ret==_FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ }while((ixmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_AUTH); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ -+ if(psta)// for AP mode -+ { -+#ifdef CONFIG_NATIVEAP_MLME -+ -+ _rtw_memcpy(pwlanhdr->addr1, psta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ -+ // setting auth algo number -+ val16 = (u16)psta->authalg; -+ -+ if(status != _STATS_SUCCESSFUL_) -+ val16 = 0; -+ -+ if (val16) { -+ le_tmp = cpu_to_le16(val16); -+ use_shared_key = 1; -+ } else { -+ le_tmp = 0; -+ } -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_ALGM_NUM_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ // setting auth seq number -+ val16 =(u16)psta->auth_seq; -+ le_tmp = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_SEQ_NUM_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ // setting status code... -+ val16 = status; -+ le_tmp = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ // added challenging text... -+ if ((psta->auth_seq == 2) && (psta->state & WIFI_FW_AUTH_STATE) && (use_shared_key==1)) -+ { -+ pframe = rtw_set_ie(pframe, _CHLGETXT_IE_, 128, psta->chg_txt, &(pattrib->pktlen)); -+ } -+#endif -+ } -+ else -+ { -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&padapter->eeprompriv), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); -+ -+ // setting auth algo number -+ val16 = (pmlmeinfo->auth_algo == dot11AuthAlgrthm_Shared)? 1: 0;// 0:OPEN System, 1:Shared key -+ if (val16) { -+ le_tmp = cpu_to_le16(val16); -+ use_shared_key = 1; -+ } else { -+ le_tmp = 0; -+ } -+ //setting IV for auth seq #3 -+ if ((pmlmeinfo->auth_seq == 3) && (pmlmeinfo->state & WIFI_FW_AUTH_STATE) && (use_shared_key==1)) -+ { -+ //DBG_871X("==> iv(%d),key_index(%d)\n",pmlmeinfo->iv,pmlmeinfo->key_index); -+ val32 = cpu_to_le32(((pmlmeinfo->iv++) | (pmlmeinfo->key_index << 30))); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *)&val32, &(pattrib->pktlen)); -+ -+ pattrib->iv_len = 4; -+ } -+ -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_ALGM_NUM_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ // setting auth seq number -+ val16 = pmlmeinfo->auth_seq; -+ le_tmp = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _AUTH_SEQ_NUM_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ -+ // setting status code... -+ val16 = status; -+ le_tmp = cpu_to_le16(val16); -+ pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ // then checking to see if sending challenging text... -+ if ((pmlmeinfo->auth_seq == 3) && (pmlmeinfo->state & WIFI_FW_AUTH_STATE) && (use_shared_key==1)) -+ { -+ pframe = rtw_set_ie(pframe, _CHLGETXT_IE_, 128, pmlmeinfo->chg_txt, &(pattrib->pktlen)); -+ -+ SetPrivacy(fctrl); -+ -+ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pattrib->encrypt = _WEP40_; -+ -+ pattrib->icv_len = 4; -+ -+ pattrib->pktlen += pattrib->icv_len; -+ -+ } -+ -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ rtw_wep_encrypt(padapter, (u8 *)pmgntframe); -+ DBG_871X("%s\n", __FUNCTION__); -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+} -+ -+ -+void issue_asocrsp(_adapter *padapter, unsigned short status, struct sta_info *pstat, int pkt_type) -+{ -+#ifdef CONFIG_AP_MODE -+ struct xmit_frame *pmgntframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct pkt_attrib *pattrib; -+ unsigned char *pbuf, *pframe; -+ unsigned short val; -+ __le16 *fctrl, le_tmp; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network); -+ u8 *ie = pnetwork->IEs; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ -+#endif //CONFIG_P2P -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy((void *)GetAddr1Ptr(pwlanhdr), pstat->hwaddr, ETH_ALEN); -+ _rtw_memcpy((void *)GetAddr2Ptr(pwlanhdr), myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy((void *)GetAddr3Ptr(pwlanhdr), get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ if ((pkt_type == WIFI_ASSOCRSP) || (pkt_type == WIFI_REASSOCRSP)) -+ SetFrameSubType(pwlanhdr, pkt_type); -+ else -+ return; -+ -+ pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen += pattrib->hdrlen; -+ pframe += pattrib->hdrlen; -+ -+ //capability -+ val = *(unsigned short *)rtw_get_capability_from_ie(ie); -+ -+ pframe = rtw_set_fixed_ie(pframe, _CAPABILITY_ , (unsigned char *)&val, &(pattrib->pktlen)); -+ -+ le_tmp = cpu_to_le16(status); -+ pframe = rtw_set_fixed_ie(pframe , _STATUS_CODE_ , (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ le_tmp = cpu_to_le16(pstat->aid | BIT(14) | BIT(15)); -+ pframe = rtw_set_fixed_ie(pframe, _ASOC_ID_ , (unsigned char *)&le_tmp, &(pattrib->pktlen)); -+ -+ if (pstat->bssratelen <= 8) -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, pstat->bssratelen, pstat->bssrateset, &(pattrib->pktlen)); -+ } -+ else -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, 8, pstat->bssrateset, &(pattrib->pktlen)); -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (pstat->bssratelen-8), pstat->bssrateset+8, &(pattrib->pktlen)); -+ } -+ -+#ifdef CONFIG_80211N_HT -+ if ((pstat->flags & WLAN_STA_HT) && (pmlmepriv->htpriv.ht_option)) -+ { -+ uint ie_len=0; -+ -+ //FILL HT CAP INFO IE -+ //p = hostapd_eid_ht_capabilities_info(hapd, p); -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if(pbuf && ie_len>0) -+ { -+ _rtw_memcpy(pframe, pbuf, ie_len+2); -+ pframe += (ie_len+2); -+ pattrib->pktlen +=(ie_len+2); -+ } -+ -+ //FILL HT ADD INFO IE -+ //p = hostapd_eid_ht_operation(hapd, p); -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if(pbuf && ie_len>0) -+ { -+ _rtw_memcpy(pframe, pbuf, ie_len+2); -+ pframe += (ie_len+2); -+ pattrib->pktlen +=(ie_len+2); -+ } -+ -+ } -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ if ((pstat->flags & WLAN_STA_VHT) && (pmlmepriv->vhtpriv.vht_option)) -+ { -+ u32 ie_len=0; -+ -+ //FILL VHT CAP IE -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, EID_VHTCapability, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if(pbuf && ie_len>0) -+ { -+ _rtw_memcpy(pframe, pbuf, ie_len+2); -+ pframe += (ie_len+2); -+ pattrib->pktlen +=(ie_len+2); -+ } -+ -+ //FILL VHT OPERATION IE -+ pbuf = rtw_get_ie(ie + _BEACON_IE_OFFSET_, EID_VHTOperation, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_)); -+ if(pbuf && ie_len>0) -+ { -+ _rtw_memcpy(pframe, pbuf, ie_len+2); -+ pframe += (ie_len+2); -+ pattrib->pktlen +=(ie_len+2); -+ } -+ } -+#endif //CONFIG_80211AC_VHT -+ -+ //FILL WMM IE -+ if ((pstat->flags & WLAN_STA_WME) && (pmlmepriv->qospriv.qos_option)) -+ { -+ uint ie_len=0; -+ unsigned char WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; -+ -+ for (pbuf = ie + _BEACON_IE_OFFSET_; ;pbuf+= (ie_len + 2)) -+ { -+ pbuf = rtw_get_ie(pbuf, _VENDOR_SPECIFIC_IE_, &ie_len, (pnetwork->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); -+ if(pbuf && _rtw_memcmp(pbuf+2, WMM_PARA_IE, 6)) -+ { -+ _rtw_memcpy(pframe, pbuf, ie_len+2); -+ pframe += (ie_len+2); -+ pattrib->pktlen +=(ie_len+2); -+ -+ break; -+ } -+ -+ if ((pbuf == NULL) || (ie_len == 0)) -+ { -+ break; -+ } -+ } -+ -+ } -+ -+ -+ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK) -+ { -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 6 , REALTEK_96B_IE, &(pattrib->pktlen)); -+ } -+ -+ //add WPS IE ie for wps 2.0 -+ if(pmlmepriv->wps_assoc_resp_ie && pmlmepriv->wps_assoc_resp_ie_len>0) -+ { -+ _rtw_memcpy(pframe, pmlmepriv->wps_assoc_resp_ie, pmlmepriv->wps_assoc_resp_ie_len); -+ -+ pframe += pmlmepriv->wps_assoc_resp_ie_len; -+ pattrib->pktlen += pmlmepriv->wps_assoc_resp_ie_len; -+ } -+ -+#ifdef CONFIG_P2P -+ if( padapter->wdinfo.driver_interface == DRIVER_WEXT ) -+ { -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) && (pstat->is_p2p_device == true)) -+ { -+ u32 len; -+ -+ len = build_assoc_resp_p2p_ie(pwdinfo, pframe, pstat->p2p_status_code); -+ -+ pframe += len; -+ pattrib->pktlen += len; -+ } -+ } -+#ifdef CONFIG_WFD -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) -+#ifdef CONFIG_IOCTL_CFG80211 -+ && (true == pwdinfo->wfd_info->wfd_enable) -+#endif //CONFIG_IOCTL_CFG80211 -+ ) -+ { -+ wfdielen = build_assoc_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+#endif //CONFIG_WFD -+#endif //CONFIG_P2P -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+#endif -+} -+ -+void issue_assocreq(_adapter *padapter) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe, *p; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl, le_tmp; -+ unsigned short val16; -+ unsigned int i, j, ie_len, index=0; -+ unsigned char rf_type, bssrate[NumRates], sta_bssrate[NumRates]; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int bssrate_len = 0, sta_bssrate_len = 0; -+ u8 cbw40_enable = 0; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 p2pie[ 255 ] = { 0x00 }; -+ u16 p2pielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+#endif //CONFIG_P2P -+ -+#ifdef CONFIG_DFS -+ u16 cap; -+#endif //CONFIG_DFS -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ goto exit; -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ASSOCREQ); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ //caps -+ -+#ifdef CONFIG_DFS -+ _rtw_memcpy(&cap, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+ cap |= BIT(8); -+ _rtw_memcpy(pframe, &cap, 2); -+#else -+ _rtw_memcpy(pframe, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+#endif //CONFIG_DFS -+ -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ //listen interval -+ //todo: listen interval for power saving -+ le_tmp = cpu_to_le16(3); -+ _rtw_memcpy(pframe ,(unsigned char *)&le_tmp, 2); -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ //SSID -+ pframe = rtw_set_ie(pframe, _SSID_IE_, pmlmeinfo->network.Ssid.SsidLength, pmlmeinfo->network.Ssid.Ssid, &(pattrib->pktlen)); -+ -+ //supported rate & extended supported rate -+ -+#if 1 // Check if the AP's supported rates are also supported by STA. -+ get_rate_set(padapter, sta_bssrate, &sta_bssrate_len); -+ //DBG_871X("sta_bssrate_len=%d\n", sta_bssrate_len); -+ -+ if(pmlmeext->cur_channel == 14)// for JAPAN, channel 14 can only uses B Mode(CCK) -+ { -+ sta_bssrate_len = 4; -+ } -+ -+ -+ //for (i = 0; i < sta_bssrate_len; i++) { -+ // DBG_871X("sta_bssrate[%d]=%02X\n", i, sta_bssrate[i]); -+ //} -+ -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ if (pmlmeinfo->network.SupportedRates[i] == 0) break; -+ DBG_871X("network.SupportedRates[%d]=%02X\n", i, pmlmeinfo->network.SupportedRates[i]); -+ } -+ -+ -+ for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { -+ if (pmlmeinfo->network.SupportedRates[i] == 0) break; -+ -+ -+ // Check if the AP's supported rates are also supported by STA. -+ for (j=0; j < sta_bssrate_len; j++) { -+ // Avoid the proprietary data rate (22Mbps) of Handlink WSG-4000 AP -+ if ( (pmlmeinfo->network.SupportedRates[i]|IEEE80211_BASIC_RATE_MASK) -+ == (sta_bssrate[j]|IEEE80211_BASIC_RATE_MASK)) { -+ //DBG_871X("match i = %d, j=%d\n", i, j); -+ break; -+ } else { -+ //DBG_871X("not match: %02X != %02X\n", (pmlmeinfo->network.SupportedRates[i]|IEEE80211_BASIC_RATE_MASK), (sta_bssrate[j]|IEEE80211_BASIC_RATE_MASK)); -+ } -+ } -+ -+ if (j == sta_bssrate_len) { -+ // the rate is not supported by STA -+ DBG_871X("%s(): the rate[%d]=%02X is not supported by STA!\n",__FUNCTION__, i, pmlmeinfo->network.SupportedRates[i]); -+ } else { -+ // the rate is supported by STA -+ bssrate[index++] = pmlmeinfo->network.SupportedRates[i]; -+ } -+ } -+ -+ bssrate_len = index; -+ DBG_871X("bssrate_len = %d\n", bssrate_len); -+ -+#else // Check if the AP's supported rates are also supported by STA. -+#if 0 -+ get_rate_set(padapter, bssrate, &bssrate_len); -+#else -+ for (bssrate_len = 0; bssrate_len < NumRates; bssrate_len++) { -+ if (pmlmeinfo->network.SupportedRates[bssrate_len] == 0) break; -+ -+ if (pmlmeinfo->network.SupportedRates[bssrate_len] == 0x2C) // Avoid the proprietary data rate (22Mbps) of Handlink WSG-4000 AP -+ break; -+ -+ bssrate[bssrate_len] = pmlmeinfo->network.SupportedRates[bssrate_len]; -+ } -+#endif -+#endif // Check if the AP's supported rates are also supported by STA. -+ -+ if (bssrate_len == 0) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; //don't connect to AP if no joint supported rate -+ } -+ -+ -+ if (bssrate_len > 8) -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); -+ } -+ else -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); -+ } -+ -+ //RSN -+ p = rtw_get_ie((pmlmeinfo->network.IEs + sizeof(NDIS_802_11_FIXED_IEs)), _RSN_IE_2_, &ie_len, (pmlmeinfo->network.IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if (p != NULL) -+ { -+ pframe = rtw_set_ie(pframe, _RSN_IE_2_, ie_len, (p + 2), &(pattrib->pktlen)); -+ } -+ -+#ifdef CONFIG_80211N_HT -+ //HT caps -+ if(padapter->mlmepriv.htpriv.ht_option==true) -+ { -+ p = rtw_get_ie((pmlmeinfo->network.IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_CAPABILITY_IE_, &ie_len, (pmlmeinfo->network.IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if ((p != NULL) && (!(is_ap_in_tkip(padapter)))) -+ { -+ u16 HT_caps_info; -+ -+ _rtw_memcpy(&(pmlmeinfo->HT_caps), (p + 2), sizeof(struct HT_caps_element)); -+ HT_caps_info = le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info); -+ -+ //to disable 40M Hz support while gd_bw_40MHz_en = 0 -+ if (pmlmeext->cur_channel > 14) { -+ if ((pregpriv->bw_mode & 0xf0) > 0) -+ cbw40_enable = 1; -+ } else { -+ if ((pregpriv->bw_mode & 0x0f) > 0) -+ cbw40_enable = 1; -+ } -+ -+ if (cbw40_enable == 0) -+ { -+ HT_caps_info &= (~(BIT(6) | BIT(1))); -+ } -+ else -+ { -+ HT_caps_info |= BIT(1); -+ } -+ -+ //todo: disable SM power save mode -+ HT_caps_info |= 0x000c; -+ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info = cpu_to_le16(HT_caps_info); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ //switch (pregpriv->rf_config) -+ switch(rf_type) -+ { -+ case RF_1T1R: -+ -+ if(pregpriv->rx_stbc) -+ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info |= cpu_to_le16(0x0100);//RX STBC One spatial stream -+ -+ _rtw_memcpy(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_rate_1R, 16); -+ break; -+ -+ case RF_2T2R: -+ case RF_1T2R: -+ default: -+ -+ if((pregpriv->rx_stbc == 0x3) ||//enable for 2.4/5 GHz -+ ((pmlmeext->cur_wireless_mode & WIRELESS_11_24N) && (pregpriv->rx_stbc == 0x1)) || //enable for 2.4GHz -+ ((pmlmeext->cur_wireless_mode & WIRELESS_11_5N) && (pregpriv->rx_stbc == 0x2)) || //enable for 5GHz -+ (pregpriv->wifi_spec==1)) -+ { -+ DBG_871X("declare supporting RX STBC\n"); -+ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info |= cpu_to_le16(0x0200);//RX STBC two spatial stream -+ } -+ #ifdef CONFIG_DISABLE_MCS13TO15 -+ if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && (pregpriv->wifi_spec!=1)) -+ _rtw_memcpy(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_rate_2R_MCS13TO15_OFF, 16); -+ else -+ _rtw_memcpy(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_rate_2R, 16); -+ #else //CONFIG_DISABLE_MCS13TO15 -+ _rtw_memcpy(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_rate_2R, 16); -+ #endif //CONFIG_DISABLE_MCS13TO15 -+ break; -+ } -+#ifdef RTL8192C_RECONFIG_TO_1T1R -+ { -+ if(pregpriv->rx_stbc) -+ pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info |= cpu_to_le16(0x0100);//RX STBC One spatial stream -+ -+ _rtw_memcpy(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_rate_1R, 16); -+ } -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ if (BT_1Ant(padapter) == true) -+ { -+ // set to 8K -+ pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para &= (u8)~IEEE80211_HT_CAP_AMPDU_FACTOR; -+// pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para |= MAX_AMPDU_FACTOR_8K -+ } -+#endif -+ -+ pframe = rtw_set_ie(pframe, _HT_CAPABILITY_IE_, ie_len , (u8 *)(&(pmlmeinfo->HT_caps)), &(pattrib->pktlen)); -+ -+ } -+ } -+#endif -+ -+ //vendor specific IE, such as WPA, WMM, WPS -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pmlmeinfo->network.IELength;) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pmlmeinfo->network.IEs + i); -+ -+ switch (pIE->ElementID) -+ { -+ case _VENDOR_SPECIFIC_IE_: -+ if ((_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) || -+ (_rtw_memcmp(pIE->data, WMM_OUI, 4)) || -+ (_rtw_memcmp(pIE->data, WPS_OUI, 4))) -+ { -+ if(!padapter->registrypriv.wifi_spec) -+ { -+ //Commented by Kurt 20110629 -+ //In some older APs, WPS handshake -+ //would be fail if we append vender extensions informations to AP -+ if(_rtw_memcmp(pIE->data, WPS_OUI, 4)){ -+ pIE->Length=14; -+ } -+ } -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ } -+ break; -+#ifdef CONFIG_80211AC_VHT -+ case EID_VHTCapability: -+ if (padapter->mlmepriv.vhtpriv.vht_option ==true) { -+ pframe = rtw_set_ie(pframe, EID_VHTCapability, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ } -+ break; -+ -+ case EID_OpModeNotification: -+ if (padapter->mlmepriv.vhtpriv.vht_option ==true) { -+ pframe = rtw_set_ie(pframe, EID_OpModeNotification, pIE->Length, pIE->data, &(pattrib->pktlen)); -+ } -+ break; -+#endif // CONFIG_80211AC_VHT -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK) -+ { -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 6 , REALTEK_96B_IE, &(pattrib->pktlen)); -+ } -+ -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_build_assoc_req_wapi_ie(padapter, pframe, pattrib); -+#endif -+ -+ -+#ifdef CONFIG_P2P -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled && pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(pmlmepriv->p2p_assoc_req_ie && pmlmepriv->p2p_assoc_req_ie_len>0) -+ { -+ _rtw_memcpy(pframe, pmlmepriv->p2p_assoc_req_ie, pmlmepriv->p2p_assoc_req_ie_len); -+ pframe += pmlmepriv->p2p_assoc_req_ie_len; -+ pattrib->pktlen += pmlmepriv->p2p_assoc_req_ie_len; -+ } -+ } -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) -+ { -+ // Should add the P2P IE in the association request frame. -+ // P2P OUI -+ -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20101109 -+ // According to the P2P Specification, the association request frame should contain 3 P2P attributes -+ // 1. P2P Capability -+ // 2. Extended Listen Timing -+ // 3. Device Info -+ // Commented by Albert 20110516 -+ // 4. P2P Interface -+ -+ // P2P Capability -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Device Capability Bitmap, 1 byte -+ p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; -+ -+ // Group Capability Bitmap, 1 byte -+ if ( pwdinfo->persistent_supported ) -+ p2pie[ p2pielen++ ] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; -+ else -+ p2pie[ p2pielen++ ] = DMP_P2P_GRPCAP_SUPPORT; -+ -+ // Extended Listen Timing -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_EX_LISTEN_TIMING; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0004 ); -+ p2pielen += 2; -+ -+ // Value: -+ // Availability Period -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); -+ p2pielen += 2; -+ -+ // Availability Interval -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); -+ p2pielen += 2; -+ -+ // Device Info -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) -+ // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); -+ p2pielen += 2; -+ -+ // Value: -+ // P2P Device Address -+ _rtw_memcpy( p2pie + p2pielen, myid( &padapter->eeprompriv ), ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ // Config Method -+ // This field should be big endian. Noted by P2P specification. -+ if ( ( pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PEER_DISPLAY_PIN ) || -+ ( pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_SELF_DISPLAY_PIN ) ) -+ { -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_DISPLAY ); -+ } -+ else -+ { -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_PBC ); -+ } -+ -+ p2pielen += 2; -+ -+ // Primary Device Type -+ // Category ID -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ p2pielen += 2; -+ -+ // OUI -+ *(__be32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); -+ p2pielen += 4; -+ -+ // Sub Category ID -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ p2pielen += 2; -+ -+ // Number of Secondary Device Types -+ p2pie[ p2pielen++ ] = 0x00; // No Secondary Device Type List -+ -+ // Device Name -+ // Type: -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ p2pielen += 2; -+ -+ // Length: -+ *(__be16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len ); -+ p2pielen += pwdinfo->device_name_len; -+ -+ // P2P Interface -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_INTERFACE; -+ -+ // Length: -+ *(__le16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x000D ); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN ); // P2P Device Address -+ p2pielen += ETH_ALEN; -+ -+ p2pie[ p2pielen++ ] = 1; // P2P Interface Address Count -+ -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN ); // P2P Interface Address List -+ p2pielen += ETH_ALEN; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen ); -+ -+#ifdef CONFIG_WFD -+ //wfdielen = build_assoc_req_wfd_ie(pwdinfo, pframe); -+ //pframe += wfdielen; -+ //pattrib->pktlen += wfdielen; -+#endif //CONFIG_WFD -+ } -+ } -+ -+#endif //CONFIG_P2P -+ -+#ifdef CONFIG_WFD -+#ifdef CONFIG_IOCTL_CFG80211 -+ if ( true == pwdinfo->wfd_info->wfd_enable ) -+#endif //CONFIG_IOCTL_CFG80211 -+ { -+ wfdielen = build_assoc_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+#ifdef CONFIG_IOCTL_CFG80211 -+ else if (pmlmepriv->wfd_assoc_req_ie != NULL && pmlmepriv->wfd_assoc_req_ie_len>0) -+ { -+ //WFD IE -+ _rtw_memcpy(pframe, pmlmepriv->wfd_assoc_req_ie, pmlmepriv->wfd_assoc_req_ie_len); -+ pattrib->pktlen += pmlmepriv->wfd_assoc_req_ie_len; -+ pframe += pmlmepriv->wfd_assoc_req_ie_len; -+ } -+#endif //CONFIG_IOCTL_CFG80211 -+#endif //CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ -+ ret = _SUCCESS; -+ -+exit: -+ if (ret == _SUCCESS) -+ rtw_buf_update(&pmlmepriv->assoc_req, &pmlmepriv->assoc_req_len, (u8 *)pwlanhdr, pattrib->pktlen); -+ else -+ rtw_buf_free(&pmlmepriv->assoc_req, &pmlmepriv->assoc_req_len); -+ -+ return; -+} -+ -+//when wait_ack is ture, this function shoule be called at process context -+static int _issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int wait_ack) -+{ -+ int ret = _FAIL; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ -+ //DBG_871X("%s:%d\n", __FUNCTION__, power_mode); -+ -+ if(!padapter) -+ goto exit; -+ -+ pxmitpriv = &(padapter->xmitpriv); -+ pmlmeext = &(padapter->mlmeextpriv); -+ pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ goto exit; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = false; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ if((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ { -+ SetFrDs(fctrl); -+ } -+ else if((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) -+ { -+ SetToDs(fctrl); -+ } -+ -+ if (power_mode) -+ { -+ SetPwrMgt(fctrl); -+ } -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_DATA_NULL); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if(wait_ack) -+ { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } -+ else -+ { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+ -+//when wait_ms >0 , this function shoule be called at process context -+//da == NULL for station mode -+int issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) -+{ -+ int ret; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* da == NULL, assum it's null data for sta to ap*/ -+ if (da == NULL) -+ da = get_my_bssid(&(pmlmeinfo->network)); -+ -+ do -+ { -+ ret = _issue_nulldata(padapter, da, power_mode, wait_ms>0?true:false); -+ -+ i++; -+ -+ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) -+ break; -+ -+ if(i < try_cnt && wait_ms > 0 && ret==_FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ }while((ixmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ goto exit; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ pattrib->hdrlen +=2; -+ pattrib->qos_en = true; -+ pattrib->eosp = 1; -+ pattrib->ack_policy = 0; -+ pattrib->mdata = 0; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ if((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ { -+ SetFrDs(fctrl); -+ } -+ else if((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) -+ { -+ SetToDs(fctrl); -+ } -+ -+ if(pattrib->mdata) -+ SetMData(fctrl); -+ -+ qc = (__le16 *)(pframe + pattrib->hdrlen - 2); -+ -+ SetPriority(qc, tid); -+ -+ SetEOSP(qc, pattrib->eosp); -+ -+ SetAckpolicy(qc, pattrib->ack_policy); -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if(wait_ack) -+ { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } -+ else -+ { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+//when wait_ms >0 , this function shoule be called at process context -+//da == NULL for station mode -+int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int try_cnt, int wait_ms) -+{ -+ int ret; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ /* da == NULL, assum it's null data for sta to ap*/ -+ if (da == NULL) -+ da = get_my_bssid(&(pmlmeinfo->network)); -+ -+ do -+ { -+ ret = _issue_qos_nulldata(padapter, da, tid, wait_ms>0?true:false); -+ -+ i++; -+ -+ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) -+ break; -+ -+ if(i < try_cnt && wait_ms > 0 && ret==_FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ }while((ixmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int ret = _FAIL; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif //CONFIG_P2P -+ -+ //DBG_871X("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); -+ -+#ifdef CONFIG_P2P -+ if ( !( rtw_p2p_chk_state( pwdinfo, P2P_STATE_NONE ) ) && ( pwdinfo->rx_invitereq_info.scan_op_ch_only ) ) -+ { -+ _cancel_timer_ex( &pwdinfo->reset_ch_sitesurvey ); -+ _set_timer( &pwdinfo->reset_ch_sitesurvey, 10 ); -+ } -+#endif //CONFIG_P2P -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ goto exit; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = false; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_DEAUTH); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ cpu_to_le16p(&reason); -+ pframe = rtw_set_fixed_ie(pframe, _RSON_CODE_ , (unsigned char *)&reason, &(pattrib->pktlen)); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ -+ if(wait_ack) -+ { -+ ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); -+ } -+ else -+ { -+ dump_mgntframe(padapter, pmgntframe); -+ ret = _SUCCESS; -+ } -+ -+exit: -+ return ret; -+} -+ -+int issue_deauth(_adapter *padapter, unsigned char *da, unsigned short reason) -+{ -+ DBG_871X("%s to "MAC_FMT"\n", __func__, MAC_ARG(da)); -+ return _issue_deauth(padapter, da, reason, false); -+} -+ -+int issue_deauth_ex(_adapter *padapter, u8 *da, unsigned short reason, int try_cnt, -+ int wait_ms) -+{ -+ int ret; -+ int i = 0; -+ u32 start = rtw_get_current_time(); -+ -+ do -+ { -+ ret = _issue_deauth(padapter, da, reason, wait_ms>0?true:false); -+ -+ i++; -+ -+ if (padapter->bDriverStopped || padapter->bSurpriseRemoved) -+ break; -+ -+ if(i < try_cnt && wait_ms > 0 && ret==_FAIL) -+ rtw_msleep_os(wait_ms); -+ -+ }while((ixmitpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ DBG_871X(FUNC_NDEV_FMT" ra="MAC_FMT", ch:%u, offset:%u\n", -+ FUNC_NDEV_ARG(padapter->pnetdev), MAC_ARG(ra), new_ch, ch_offset); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ return; -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); /* RA */ -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); /* TA */ -+ _rtw_memcpy(pwlanhdr->addr3, ra, ETH_ALEN); /* DA = RA */ -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ /* category, action */ -+ { -+ u8 category, action; -+ category = RTW_WLAN_CATEGORY_SPECTRUM_MGMT; -+ action = RTW_WLAN_ACTION_SPCT_CHL_SWITCH; -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ } -+ -+ pframe = rtw_set_ie_ch_switch(pframe, &(pattrib->pktlen), 0, new_ch, 0); -+ pframe = rtw_set_ie_secondary_ch_offset(pframe, &(pattrib->pktlen), -+ hal_ch_offset_to_secondary_ch_offset(ch_offset)); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+} -+ -+void issue_action_BA(_adapter *padapter, unsigned char *raddr, unsigned char action, unsigned short status) -+{ -+ u8 category = RTW_WLAN_CATEGORY_BACK; -+ u16 start_seq; -+ u16 BA_para_set; -+ __le16 le_tmp; -+ u16 reason_code; -+ u16 BA_timeout_value; -+ u16 BA_starting_seqctrl; -+ HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ u8 *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl, le_status; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+#ifdef CONFIG_BT_COEXIST -+ u8 tendaAPMac[] = {0xC8, 0x3A, 0x35}; -+#endif -+ -+#ifdef CONFIG_80211N_HT -+ DBG_871X("%s, category=%d, action=%d, status=%d\n", __FUNCTION__, category, action, status); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ //_rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ -+ le32_to_cpup((__le32*)&status); -+ -+ -+ if (category == 3) -+ { -+ switch (action) -+ { -+ case 0: //ADDBA req -+ do { -+ pmlmeinfo->dialogToken++; -+ } while (pmlmeinfo->dialogToken == 0); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(pmlmeinfo->dialogToken), &(pattrib->pktlen)); -+ -+#ifdef CONFIG_BT_COEXIST -+ if ((BT_1Ant(padapter) == true) && -+ ((pmlmeinfo->assoc_AP_vendor != broadcomAP) || -+ (_rtw_memcmp(raddr, tendaAPMac, 3) == false))) -+ { -+ // A-MSDU NOT Supported -+ BA_para_set = 0; -+ // immediate Block Ack -+ BA_para_set |= (1 << 1) & IEEE80211_ADDBA_PARAM_POLICY_MASK; -+ // TID -+ BA_para_set |= (status << 2) & IEEE80211_ADDBA_PARAM_TID_MASK; -+ // max buffer size is 8 MSDU -+ BA_para_set |= (8 << 6) & RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; -+ } -+ else -+#endif -+ { -+ BA_para_set = (0x1002 | ((status & 0xf) << 2)); //immediate ack & 64 buffer size -+ } -+ //sys_mib.BA_para_set = 0x0802; //immediate ack & 32 buffer size -+ le_tmp = cpu_to_le16(BA_para_set); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); -+ -+ //BA_timeout_value = 0xffff;//max: 65535 TUs(~ 65 ms) -+ BA_timeout_value = 5000;//~ 5ms -+ le_tmp = cpu_to_le16(BA_timeout_value); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&le_tmp), &(pattrib->pktlen)); -+ -+ //if ((psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress)) != NULL) -+ if ((psta = rtw_get_stainfo(pstapriv, raddr)) != NULL) -+ { -+ start_seq = (psta->sta_xmitpriv.txseq_tid[status & 0x07]&0xfff) + 1; -+ -+ DBG_871X("BA_starting_seqctrl = %d for TID=%d\n", start_seq, status & 0x07); -+ -+ psta->BA_starting_seqctrl[status & 0x07] = start_seq; -+ -+ BA_starting_seqctrl = start_seq << 4; -+ } -+ -+ le_tmp = cpu_to_le16(BA_starting_seqctrl); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); -+ break; -+ -+ case 1: //ADDBA rsp -+ pframe = rtw_set_fixed_ie(pframe, 1, &(pmlmeinfo->ADDBA_req.dialog_token), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&status), &(pattrib->pktlen)); -+ rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); -+ if(MAX_AMPDU_FACTOR_64K == max_rx_ampdu_factor) -+ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x1000); //64 buffer size -+ else if(MAX_AMPDU_FACTOR_32K == max_rx_ampdu_factor) -+ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x0800); //32 buffer size -+ else if(MAX_AMPDU_FACTOR_16K == max_rx_ampdu_factor) -+ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x0400); //16 buffer size -+ else if(MAX_AMPDU_FACTOR_8K == max_rx_ampdu_factor) -+ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x0200); //8 buffer size -+ else -+ BA_para_set = ((le16_to_cpu(pmlmeinfo->ADDBA_req.BA_para_set) & 0x3f) | 0x1000); //64 buffer size -+ -+#ifdef CONFIG_BT_COEXIST -+ if ((BT_1Ant(padapter) == true) && -+ ((pmlmeinfo->assoc_AP_vendor != broadcomAP) || -+ (_rtw_memcmp(raddr, tendaAPMac, 3) == false))) -+ { -+ // max buffer size is 8 MSDU -+ BA_para_set &= ~RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; -+ BA_para_set |= (8 << 6) & RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; -+ } -+#endif -+ -+ if(pregpriv->ampdu_amsdu==0)//disabled -+ le_tmp = cpu_to_le16(BA_para_set & ~BIT(0)); -+ else if(pregpriv->ampdu_amsdu==1)//enabled -+ le_tmp = cpu_to_le16(BA_para_set | BIT(0)); -+ else //auto -+ le_tmp = cpu_to_le16(BA_para_set); -+ -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(pmlmeinfo->ADDBA_req.BA_timeout_value)), &(pattrib->pktlen)); -+ break; -+ case 2://DELBA -+ BA_para_set = (status & 0x1F) << 3; -+ le_tmp = cpu_to_le16(BA_para_set); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); -+ -+ reason_code = 37;//Requested from peer STA as it does not want to use the mechanism -+ le_tmp = cpu_to_le16(reason_code); -+ pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(le_tmp)), &(pattrib->pktlen)); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+#endif //CONFIG_80211N_HT -+} -+ -+static void issue_action_BSSCoexistPacket(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ unsigned char category, action; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct wlan_network *pnetwork = NULL; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ u8 InfoContent[16] = {0}; -+ u8 ICS[8][15]; -+#ifdef CONFIG_80211N_HT -+ if((pmlmepriv->num_FortyMHzIntolerant==0) || (pmlmepriv->num_sta_no_ht==0)) -+ return; -+ -+ if(true == pmlmeinfo->bwmode_updated) -+ return; -+ -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ -+ category = RTW_WLAN_CATEGORY_PUBLIC; -+ action = ACT_PUBLIC_BSSCOEXIST; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ -+ -+ // -+ if(pmlmepriv->num_FortyMHzIntolerant>0) -+ { -+ u8 iedata=0; -+ -+ iedata |= BIT(2);//20 MHz BSS Width Request -+ -+ pframe = rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); -+ -+ } -+ -+ -+ // -+ _rtw_memset(ICS, 0, sizeof(ICS)); -+ if(pmlmepriv->num_sta_no_ht>0) -+ { -+ int i; -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while(1) -+ { -+ int len; -+ u8 *p; -+ WLAN_BSSID_EX *pbss_network; -+ -+ if (rtw_end_of_queue_search(phead,plist)== true) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ plist = get_next(plist); -+ -+ pbss_network = (WLAN_BSSID_EX *)&pnetwork->network; -+ -+ p = rtw_get_ie(pbss_network->IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, pbss_network->IELength - _FIXED_IE_LENGTH_); -+ if((p==NULL) || (len==0))//non-HT -+ { -+ if((pbss_network->Configuration.DSConfig<=0) || (pbss_network->Configuration.DSConfig>14)) -+ continue; -+ -+ ICS[0][pbss_network->Configuration.DSConfig]=1; -+ -+ if(ICS[0][0] == 0) -+ ICS[0][0] = 1; -+ } -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ -+ for(i= 0;i<8;i++) -+ { -+ if(ICS[i][0] == 1) -+ { -+ int j, k = 0; -+ -+ InfoContent[k] = i; -+ //SET_BSS_INTOLERANT_ELE_REG_CLASS(InfoContent,i); -+ k++; -+ -+ for(j=1;j<=14;j++) -+ { -+ if(ICS[i][j]==1) -+ { -+ if(k<16) -+ { -+ InfoContent[k] = j; //channel number -+ //SET_BSS_INTOLERANT_ELE_CHANNEL(InfoContent+k, j); -+ k++; -+ } -+ } -+ } -+ -+ pframe = rtw_set_ie(pframe, EID_BSSIntolerantChlReport, k, InfoContent, &(pattrib->pktlen)); -+ -+ } -+ -+ } -+ -+ -+ } -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+#endif //CONFIG_80211N_HT -+} -+ -+unsigned int send_delba(_adapter *padapter, u8 initiator, u8 *addr) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta = NULL; -+ //struct recv_reorder_ctrl *preorder_ctrl; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u16 tid; -+ -+ if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE) -+ if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) -+ return _SUCCESS; -+ -+ psta = rtw_get_stainfo(pstapriv, addr); -+ if(psta==NULL) -+ return _SUCCESS; -+ -+ //DBG_871X("%s:%s\n", __FUNCTION__, (initiator==0)?"RX_DIR":"TX_DIR"); -+ -+ if(initiator==0) // recipient -+ { -+ for(tid = 0;tidrecvreorder_ctrl[tid].enable == true) -+ { -+ DBG_871X("rx agg disable tid(%d)\n",tid); -+ issue_action_BA(padapter, addr, RTW_WLAN_ACTION_DELBA, (((tid <<1) |initiator)&0x1F)); -+ psta->recvreorder_ctrl[tid].enable = false; -+ psta->recvreorder_ctrl[tid].indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d indicate_seq:%u \n", __FUNCTION__, __LINE__, -+ psta->recvreorder_ctrl[tid].indicate_seq); -+ #endif -+ } -+ } -+ } -+ else if(initiator == 1)// originator -+ { -+#ifdef CONFIG_80211N_HT -+ //DBG_871X("tx agg_enable_bitmap(0x%08x)\n", psta->htpriv.agg_enable_bitmap); -+ for(tid = 0;tidhtpriv.agg_enable_bitmap & BIT(tid)) -+ { -+ DBG_871X("tx agg disable tid(%d)\n",tid); -+ issue_action_BA(padapter, addr, RTW_WLAN_ACTION_DELBA, (((tid <<1) |initiator)&0x1F) ); -+ psta->htpriv.agg_enable_bitmap &= ~BIT(tid); -+ psta->htpriv.candidate_tid_bitmap &= ~BIT(tid); -+ -+ } -+ } -+#endif //CONFIG_80211N_HT -+ } -+ -+ return _SUCCESS; -+ -+} -+ -+unsigned int send_beacon(_adapter *padapter) -+{ -+ u8 bxmitok = false; -+ int issue=0; -+ int poll = 0; -+ -+ u32 start = rtw_get_current_time(); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); -+ do{ -+ issue_beacon(padapter, 100); -+ issue++; -+ do { -+ rtw_yield_os(); -+ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8 *)(&bxmitok)); -+ poll++; -+ }while((poll%10)!=0 && false == bxmitok && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); -+ -+ }while(false == bxmitok && issue<100 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); -+ -+ if(padapter->bSurpriseRemoved || padapter->bDriverStopped) -+ { -+ return _FAIL; -+ } -+ -+ -+ if(false == bxmitok) -+ { -+ DBG_871X("%s fail! %u ms\n", __FUNCTION__, rtw_get_passing_time_ms(start)); -+ return _FAIL; -+ } -+ else -+ { -+ u32 passing_time = rtw_get_passing_time_ms(start); -+ -+ if(passing_time > 100 || issue > 3) -+ DBG_871X("%s success, issue:%d, poll:%d, %u ms\n", __FUNCTION__, issue, poll, rtw_get_passing_time_ms(start)); -+ //else -+ // DBG_871X("%s success, issue:%d, poll:%d, %u ms\n", __FUNCTION__, issue, poll, rtw_get_passing_time_ms(start)); -+ -+ return _SUCCESS; -+ } -+} -+ -+/**************************************************************************** -+ -+Following are some utitity fuctions for WiFi MLME -+ -+*****************************************************************************/ -+ -+bool IsLegal5GChannel( -+ PADAPTER Adapter, -+ u8 channel) -+{ -+ -+ int i=0; -+ u8 Channel_5G[45] = {36,38,40,42,44,46,48,50,52,54,56,58, -+ 60,62,64,100,102,104,106,108,110,112,114,116,118,120,122, -+ 124,126,128,130,132,134,136,138,140,149,151,153,155,157,159, -+ 161,163,165}; -+ for(i=0;imlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u32 initialgain = 0; -+ -+#ifdef CONFIG_P2P -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ -+#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+ u8 stay_buddy_ch = 0; -+#endif //CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+#endif //CONFIG_CONCURRENT_MODE -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ static unsigned char prev_survey_channel = 0; -+ static unsigned int p2p_scan_count = 0; -+ -+ if ( ( pwdinfo->rx_invitereq_info.scan_op_ch_only ) || ( pwdinfo->p2p_info.scan_op_ch_only ) ) -+ { -+ if ( pwdinfo->rx_invitereq_info.scan_op_ch_only ) -+ { -+ survey_channel = pwdinfo->rx_invitereq_info.operation_ch[pmlmeext->sitesurvey_res.channel_idx]; -+ } -+ else -+ { -+ survey_channel = pwdinfo->p2p_info.operation_ch[pmlmeext->sitesurvey_res.channel_idx]; -+ } -+ ScanType = SCAN_ACTIVE; -+ } -+ else if(rtw_p2p_findphase_ex_is_social(pwdinfo)) -+ { -+ // Commented by Albert 2011/06/03 -+ // The driver is in the find phase, it should go through the social channel. -+ int ch_set_idx; -+ survey_channel = pwdinfo->social_chan[pmlmeext->sitesurvey_res.channel_idx]; -+ ch_set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, survey_channel); -+ if (ch_set_idx >= 0) -+ ScanType = pmlmeext->channel_set[ch_set_idx].ScanType; -+ else -+ ScanType = SCAN_ACTIVE; -+ } -+ else -+#endif //CONFIG_P2P -+ { -+ struct rtw_ieee80211_channel *ch; -+ if (pmlmeext->sitesurvey_res.channel_idx < pmlmeext->sitesurvey_res.ch_num) { -+ ch = &pmlmeext->sitesurvey_res.ch[pmlmeext->sitesurvey_res.channel_idx]; -+ survey_channel = ch->hw_value; -+ ScanType = (ch->flags & RTW_IEEE80211_CHAN_PASSIVE_SCAN) ? SCAN_PASSIVE : SCAN_ACTIVE; -+ } -+ } -+ -+ if (0){ -+ DBG_871X(FUNC_ADPT_FMT" ch:%u (cnt:%u,idx:%d) at %dms, %c%c%c\n" -+ , FUNC_ADPT_ARG(padapter) -+ , survey_channel -+ , pwdinfo->find_phase_state_exchange_cnt, pmlmeext->sitesurvey_res.channel_idx -+ , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) -+ , ScanType?'A':'P', pmlmeext->sitesurvey_res.scan_mode?'A':'P' -+ , pmlmeext->sitesurvey_res.ssid[0].SsidLength?'S':' ' -+ ); -+ #ifdef DBG_FIXED_CHAN -+ DBG_871X(FUNC_ADPT_FMT" fixed_chan:%u\n", pmlmeext->fixed_chan); -+ #endif -+ } -+ -+ if(survey_channel != 0) -+ { -+ //PAUSE 4-AC Queue when site_survey -+ //rtw_hal_get_hwreg(padapter, HW_VAR_TXPAUSE, (u8 *)(&val8)); -+ //val8 |= 0x0f; -+ //rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, (u8 *)(&val8)); -+#ifdef CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+ if((padapter->pbuddy_adapter->mlmeextpriv.mlmext_info.state&0x03) == WIFI_FW_AP_STATE) -+ { -+ if( pmlmeinfo->scan_cnt == RTW_SCAN_NUM_OF_CH ) -+ { -+ pmlmeinfo->scan_cnt = 0; -+ survey_channel = pbuddy_mlmeext->cur_channel; -+ ScanType = SCAN_ACTIVE; -+ stay_buddy_ch = 1; -+ } -+ else -+ { -+ if( pmlmeinfo->scan_cnt == 0 ) -+ stay_buddy_ch = 2; -+ pmlmeinfo->scan_cnt++; -+ } -+ } -+#endif //CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+#endif //CONFIG_CONCURRENT_MODE -+ if(pmlmeext->sitesurvey_res.channel_idx == 0) -+ { -+#ifdef DBG_FIXED_CHAN -+ if(pmlmeext->fixed_chan !=0xff) -+ set_channel_bwmode(padapter, pmlmeext->fixed_chan, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ else -+#endif -+ set_channel_bwmode(padapter, survey_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ else -+ { -+#ifdef DBG_FIXED_CHAN -+ if(pmlmeext->fixed_chan!=0xff) -+ SelectChannel(padapter, pmlmeext->fixed_chan); -+ else -+#endif -+ SelectChannel(padapter, survey_channel); -+ } -+ -+#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+ if( stay_buddy_ch == 1 ) -+ { -+ val8 = 0; //survey done -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ if(check_buddy_mlmeinfo_state(padapter, WIFI_FW_AP_STATE) && -+ check_buddy_fwstate(padapter, _FW_LINKED)) -+ { -+ update_beacon(padapter->pbuddy_adapter, 0, NULL, true); -+ } -+ } -+ else if( stay_buddy_ch == 2 ) -+ { -+ val8 = 1; //under site survey -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ } -+#endif //CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+ -+ if(ScanType == SCAN_ACTIVE) //obey the channel plan setting... -+ { -+ #ifdef CONFIG_P2P -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) || -+ rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH) -+ ) -+ { -+ issue_probereq_p2p(padapter, NULL); -+ issue_probereq_p2p(padapter, NULL); -+ issue_probereq_p2p(padapter, NULL); -+ } -+ else -+ #endif //CONFIG_P2P -+ { -+ int i; -+ for(i=0;isitesurvey_res.ssid[i].SsidLength) { -+ //todo: to issue two probe req??? -+ issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); -+ //rtw_msleep_os(SURVEY_TO>>1); -+ issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); -+ } -+ } -+ -+ if(pmlmeext->sitesurvey_res.scan_mode == SCAN_ACTIVE) { -+ //todo: to issue two probe req??? -+ issue_probereq(padapter, NULL, NULL); -+ //rtw_msleep_os(SURVEY_TO>>1); -+ issue_probereq(padapter, NULL, NULL); -+ } -+ } -+ } -+ -+#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+ if( stay_buddy_ch == 1 ) -+ set_survey_timer(pmlmeext, pmlmeext->chan_scan_time * RTW_STAY_AP_CH_MILLISECOND ); -+ else -+#endif //CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+ set_survey_timer(pmlmeext, pmlmeext->chan_scan_time); -+ -+ } -+ else -+ { -+ -+ // channel number is 0 or this channel is not valid. -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 cur_channel; -+ u8 cur_bwmode; -+ u8 cur_ch_offset; -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED)) -+ { -+ cur_channel = pmlmeext->cur_channel; -+ cur_bwmode = pmlmeext->cur_bwmode; -+ cur_ch_offset = pmlmeext->cur_ch_offset; -+ } -+ //else if((pbuddy_mlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ else if(check_buddy_fwstate(padapter, _FW_LINKED)) // for AP or STA -+ { -+ cur_channel = pbuddy_mlmeext->cur_channel; -+ cur_bwmode = pbuddy_mlmeext->cur_bwmode; -+ cur_ch_offset = pbuddy_mlmeext->cur_ch_offset; -+ } -+ else -+ { -+ cur_channel = pmlmeext->cur_channel; -+ cur_bwmode = pmlmeext->cur_bwmode; -+ cur_ch_offset = pmlmeext->cur_ch_offset; -+ } -+#endif -+ -+ -+#ifdef CONFIG_P2P -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH)) -+ { -+ if( ( pwdinfo->rx_invitereq_info.scan_op_ch_only ) || ( pwdinfo->p2p_info.scan_op_ch_only ) ) -+ { -+ // Set the find_phase_state_exchange_cnt to P2P_FINDPHASE_EX_CNT. -+ // This will let the following flow to run the scanning end. -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_MAX); -+ } -+ #ifdef CONFIG_DBG_P2P -+ DBG_871X( "[%s] find phase exchange cnt = %d\n", __FUNCTION__, pwdinfo->find_phase_state_exchange_cnt ); -+ #endif -+ } -+ -+ if(rtw_p2p_findphase_ex_is_needed(pwdinfo)) -+ { -+ // Set the P2P State to the listen state of find phase and set the current channel to the listen channel -+ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_LISTEN); -+ pmlmeext->sitesurvey_res.state = SCAN_DISABLE; -+ -+ initialgain = 0xff; //restore RX GAIN -+ rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); -+ //turn on dynamic functions -+ Restore_DM_Func_Flag(padapter); -+ //Switch_DM_Func(padapter, DYNAMIC_FUNC_DIG|DYNAMIC_FUNC_HP|DYNAMIC_FUNC_SS, true); -+ -+ _set_timer( &pwdinfo->find_phase_timer, ( u32 ) ( ( u32 ) ( pwdinfo->listen_dwell ) * 100 ) ); -+ } -+ else -+#endif //CONFIG_P2P -+ { -+ -+#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+ pmlmeinfo->scan_cnt = 0; -+#endif //CONFIG_DMP_STA_NODE_SCAN_UNDER_AP_MODE -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ // 20100721:Interrupt scan operation here. -+ // For SW antenna diversity before link, it needs to switch to another antenna and scan again. -+ // It compares the scan result and select beter one to do connection. -+ if(rtw_hal_antdiv_before_linked(padapter)) -+ { -+ pmlmeext->sitesurvey_res.bss_cnt = 0; -+ pmlmeext->sitesurvey_res.channel_idx = -1; -+ pmlmeext->chan_scan_time = SURVEY_TO /2; -+ set_survey_timer(pmlmeext, pmlmeext->chan_scan_time); -+ return; -+ } -+#endif -+ -+#ifdef CONFIG_P2P -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH)) -+ { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if( pwdinfo->driver_interface == DRIVER_WEXT ) -+ { -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ _set_timer( &pwdinfo->ap_p2p_switch_timer, 500 ); -+ } -+ } -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ #else -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ #endif -+ } -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+#endif //CONFIG_P2P -+ -+ pmlmeext->sitesurvey_res.state = SCAN_COMPLETE; -+ -+ //switch back to the original channel -+ //SelectChannel(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset); -+ -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+#else -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ dc_set_channel_bwmode_survey_done(padapter); -+#else -+ if( pwdinfo->driver_interface == DRIVER_WEXT ) -+ { -+ if( rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) ) -+ { -+ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ else -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ } -+ else if( pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ } -+#endif //CONFIG_DUALMAC_CONCURRENT -+#endif //CONFIG_CONCURRENT_MODE -+ } -+ -+ //flush 4-AC Queue after site_survey -+ //val8 = 0; -+ //rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, (u8 *)(&val8)); -+ -+ //config MSR -+ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); -+ -+ initialgain = 0xff; //restore RX GAIN -+ rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); -+ //turn on dynamic functions -+ Restore_DM_Func_Flag(padapter); -+ //Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, true); -+ -+ if (is_client_associated_to_ap(padapter) == true) -+ { -+ issue_nulldata(padapter, NULL, 0, 3, 500); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(is_client_associated_to_ap(padapter->pbuddy_adapter) == true) -+ { -+ DBG_871X("adapter is surveydone(buddy_adapter is linked), issue nulldata(pwrbit=0)\n"); -+ -+ issue_nulldata(padapter->pbuddy_adapter, NULL, 0, 3, 500); -+ } -+#endif -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ else if(is_client_associated_to_ap(padapter->pbuddy_adapter) == true) -+ { -+ issue_nulldata(padapter->pbuddy_adapter, NULL, 0, 3, 500); -+ } -+#endif -+ -+ val8 = 0; //survey done -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ report_surveydone_event(padapter); -+ -+ pmlmeext->chan_scan_time = SURVEY_TO; -+ pmlmeext->sitesurvey_res.state = SCAN_DISABLE; -+ -+ issue_action_BSSCoexistPacket(padapter); -+ issue_action_BSSCoexistPacket(padapter); -+ issue_action_BSSCoexistPacket(padapter); -+ -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_mlmeinfo_state(padapter, WIFI_FW_AP_STATE) && -+ check_buddy_fwstate(padapter, _FW_LINKED)) -+ { -+ -+ DBG_871X("survey done, current CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset); -+ -+ DBG_871X("restart pbuddy_adapter's beacon\n"); -+ -+ update_beacon(padapter->pbuddy_adapter, 0, NULL, true); -+ } -+#endif -+ -+ } -+ -+ return; -+ -+} -+ -+//collect bss info from Beacon and Probe response frames. -+u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSID_EX *bssid) -+{ -+ int i; -+ u32 len; -+ u8 *p; -+ u16 val16, subtype; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ u32 packet_len = precv_frame->u.hdr.len; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ len = packet_len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if (len > MAX_IE_SZ) -+ { -+ //DBG_871X("IE too long for survey event\n"); -+ return _FAIL; -+ } -+ -+ _rtw_memset(bssid, 0, sizeof(WLAN_BSSID_EX)); -+ -+ subtype = GetFrameSubType(pframe); -+ -+ if(subtype==WIFI_BEACON) -+ bssid->Reserved[0] = 1; -+ else -+ bssid->Reserved[0] = 0; -+ -+ bssid->Length = sizeof(WLAN_BSSID_EX) - MAX_IE_SZ + len; -+ -+ //below is to copy the information element -+ bssid->IELength = len; -+ _rtw_memcpy(bssid->IEs, (pframe + sizeof(struct rtw_ieee80211_hdr_3addr)), bssid->IELength); -+ -+ //get the signal strength -+ //bssid->Rssi = precv_frame->u.hdr.attrib.SignalStrength; // 0-100 index. -+ bssid->Rssi = precv_frame->u.hdr.attrib.phy_info.RecvSignalPower; // in dBM.raw data -+ bssid->PhyInfo.SignalQuality = precv_frame->u.hdr.attrib.phy_info.SignalQuality;//in percentage -+ bssid->PhyInfo.SignalStrength = precv_frame->u.hdr.attrib.phy_info.SignalStrength;//in percentage -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ //rtw_hal_get_hwreg(padapter, HW_VAR_CURRENT_ANTENNA, (u8 *)(&bssid->PhyInfo.Optimum_antenna)); -+ rtw_hal_get_def_var(padapter, HAL_DEF_CURRENT_ANTENNA, &bssid->PhyInfo.Optimum_antenna); -+#endif -+ -+ // checking SSID -+ if ((p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _SSID_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_)) == NULL) -+ { -+ DBG_871X("marc: cannot find SSID for survey event\n"); -+ return _FAIL; -+ } -+ -+ if (*(p + 1)) -+ { -+ if (len > NDIS_802_11_LENGTH_SSID) -+ { -+ DBG_871X("%s()-%d: IE too long (%d) for survey event\n", __FUNCTION__, __LINE__, len); -+ return _FAIL; -+ } -+ _rtw_memcpy(bssid->Ssid.Ssid, (p + 2), *(p + 1)); -+ bssid->Ssid.SsidLength = *(p + 1); -+ } -+ else -+ { -+ bssid->Ssid.SsidLength = 0; -+ } -+ -+ _rtw_memset(bssid->SupportedRates, 0, NDIS_802_11_LENGTH_RATES_EX); -+ -+ //checking rate info... -+ i = 0; -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _SUPPORTEDRATES_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (p != NULL) -+ { -+ if (len > NDIS_802_11_LENGTH_RATES_EX) -+ { -+ DBG_871X("%s()-%d: IE too long (%d) for survey event\n", __FUNCTION__, __LINE__, len); -+ return _FAIL; -+ } -+ _rtw_memcpy(bssid->SupportedRates, (p + 2), len); -+ i = len; -+ } -+ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _EXT_SUPPORTEDRATES_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (p != NULL) -+ { -+ if (len > (NDIS_802_11_LENGTH_RATES_EX-i)) -+ { -+ DBG_871X("%s()-%d: IE too long (%d) for survey event\n", __FUNCTION__, __LINE__, len); -+ return _FAIL; -+ } -+ _rtw_memcpy(bssid->SupportedRates + i, (p + 2), len); -+ } -+ -+ //todo: -+#if 0 -+ if (judge_network_type(bssid->SupportedRates, (len + i)) == WIRELESS_11B) -+ { -+ bssid->NetworkTypeInUse = Ndis802_11DS; -+ } -+ else -+#endif -+ { -+ bssid->NetworkTypeInUse = Ndis802_11OFDM24; -+ } -+ -+ if (bssid->IELength < 12) -+ return _FAIL; -+ -+ // Checking for DSConfig -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _DSSET_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ -+ bssid->Configuration.DSConfig = 0; -+ bssid->Configuration.Length = 0; -+ -+ if (p) -+ { -+ bssid->Configuration.DSConfig = *(p + 2); -+ } -+ else -+ {// In 5G, some ap do not have DSSET IE -+ // checking HT info for channel -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if(p) -+ { -+ struct HT_info_element *HT_info = (struct HT_info_element *)(p + 2); -+ bssid->Configuration.DSConfig = HT_info->primary_channel; -+ } -+ else -+ { // use current channel -+ bssid->Configuration.DSConfig = rtw_get_oper_ch(padapter); -+ } -+ } -+ -+ _rtw_memcpy(&bssid->Configuration.BeaconPeriod, rtw_get_beacon_interval_from_ie(bssid->IEs), 2); -+ le16_to_cpup((__le16 *)&bssid->Configuration.BeaconPeriod); -+ -+ val16 = rtw_get_capability((WLAN_BSSID_EX *)bssid); -+ -+ if (val16 & BIT(0)) -+ { -+ bssid->InfrastructureMode = Ndis802_11Infrastructure; -+ _rtw_memcpy(bssid->MacAddress, GetAddr2Ptr(pframe), ETH_ALEN); -+ } -+ else -+ { -+ bssid->InfrastructureMode = Ndis802_11IBSS; -+ _rtw_memcpy(bssid->MacAddress, GetAddr3Ptr(pframe), ETH_ALEN); -+ } -+ -+ if (val16 & BIT(4)) -+ bssid->Privacy = 1; -+ else -+ bssid->Privacy = 0; -+ -+ bssid->Configuration.ATIMWindow = 0; -+ -+ //20/40 BSS Coexistence check -+ if((pregistrypriv->wifi_spec==1) && (false == pmlmeinfo->bwmode_updated)) -+ { -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_80211N_HT -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if(p && len>0) { -+ struct HT_caps_element *pHT_caps; -+ pHT_caps = (struct HT_caps_element *)(p + 2); -+ -+ if(le16_to_cpu(pHT_caps->u.HT_cap_element.HT_caps_info) & BIT(14)) -+ pmlmepriv->num_FortyMHzIntolerant++; -+ } -+ else -+ { -+ pmlmepriv->num_sta_no_ht++; -+ } -+#endif //CONFIG_80211N_HT -+ -+ } -+ -+#ifdef CONFIG_INTEL_WIDI -+ //process_intel_widi_query_or_tigger(padapter, bssid); -+ if(process_intel_widi_query_or_tigger(padapter, bssid)) -+ { -+ return _FAIL; -+ } -+#endif // CONFIG_INTEL_WIDI -+ -+ #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) & 1 -+ if(strcmp(bssid->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { -+ DBG_871X("Receiving %s("MAC_FMT", DSConfig:%u) from ch%u with ss:%3u, sq:%3u, RawRSSI:%3ld\n" -+ , bssid->Ssid.Ssid, MAC_ARG(bssid->MacAddress), bssid->Configuration.DSConfig -+ , rtw_get_oper_ch(padapter) -+ , bssid->PhyInfo.SignalStrength, bssid->PhyInfo.SignalQuality, bssid->Rssi -+ ); -+ } -+ #endif -+ -+ // mark bss info receving from nearby channel as SignalQuality 101 -+ if(bssid->Configuration.DSConfig != rtw_get_oper_ch(padapter)) -+ { -+ bssid->PhyInfo.SignalQuality= 101; -+ } -+ -+ return _SUCCESS; -+} -+ -+void start_create_ibss(_adapter* padapter) -+{ -+ unsigned short caps; -+ u8 val8; -+ u8 join_type; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); -+ pmlmeext->cur_channel = (u8)pnetwork->Configuration.DSConfig; -+ pmlmeinfo->bcn_interval = get_beacon_interval(pnetwork); -+ -+ //update wireless mode -+ update_wireless_mode(padapter); -+ -+ //udpate capability -+ caps = rtw_get_capability((WLAN_BSSID_EX *)pnetwork); -+ update_capinfo(padapter, caps); -+ if(caps&cap_IBSS)//adhoc master -+ { -+ //set_opmode_cmd(padapter, adhoc);//removed -+ -+ val8 = 0xcf; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+ //switch channel -+ //SelectChannel(padapter, pmlmeext->cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE); -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ -+ beacon_timing_control(padapter); -+ -+ //set msr to WIFI_FW_ADHOC_STATE -+ pmlmeinfo->state = WIFI_FW_ADHOC_STATE; -+ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); -+ -+ //issue beacon -+ if(send_beacon(padapter)==_FAIL) -+ { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_,("issuing beacon frame fail....\n")); -+ -+ report_join_res(padapter, -1); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ } -+ else -+ { -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, padapter->registrypriv.dev_network.MacAddress); -+ join_type = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ -+ report_join_res(padapter, 1); -+ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ } -+ } -+ else -+ { -+ DBG_871X("start_create_ibss, invalid cap:%x\n", caps); -+ return; -+ } -+ -+} -+ -+void start_clnt_join(_adapter* padapter) -+{ -+ unsigned short caps; -+ u8 val8; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); -+ int beacon_timeout; -+ -+ pmlmeext->cur_channel = (u8)pnetwork->Configuration.DSConfig; -+ pmlmeinfo->bcn_interval = get_beacon_interval(pnetwork); -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ if(dc_handle_join_request(padapter) == _FAIL) -+ { -+ DBG_871X("dc_handle_join_request fail !!!\n"); -+ return; -+ } -+ //switch channel -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+#elif defined (CONFIG_CONCURRENT_MODE) -+ if(concurrent_chk_start_clnt_join(padapter) == _FAIL) -+ return; -+#else //NON CONCURRENT_MODE -+ //switch channel -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+#endif -+ -+ //update wireless mode -+ update_wireless_mode(padapter); -+ -+ //udpate capability -+ caps = rtw_get_capability((WLAN_BSSID_EX *)pnetwork); -+ update_capinfo(padapter, caps); -+ if (caps&cap_ESS) -+ { -+ Set_MSR(padapter, WIFI_FW_STATION_STATE); -+ -+ val8 = (pmlmeinfo->auth_algo == dot11AuthAlgrthm_8021X)? 0xcc: 0xcf; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (padapter->wapiInfo.bWapiEnable && pmlmeinfo->auth_algo == dot11AuthAlgrthm_WAPI) -+ { -+ //Disable TxUseDefaultKey, RxUseDefaultKey, RxBroadcastUseDefaultKey. -+ val8 = 0x4c; -+ } -+#endif -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+ //switch channel -+ //set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ //here wait for receiving the beacon to start auth -+ //and enable a timer -+ beacon_timeout = decide_wait_for_beacon_timeout(pmlmeinfo->bcn_interval); -+ set_link_timer(pmlmeext, beacon_timeout); -+ _set_timer( &padapter->mlmepriv.assoc_timer, -+ (REAUTH_TO * REAUTH_LIMIT) + (REASSOC_TO*REASSOC_LIMIT) +beacon_timeout); -+ -+ pmlmeinfo->state = WIFI_FW_AUTH_NULL | WIFI_FW_STATION_STATE; -+ } -+ else if (caps&cap_IBSS) //adhoc client -+ { -+ Set_MSR(padapter, WIFI_FW_ADHOC_STATE); -+ -+ val8 = 0xcf; -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ -+ //switch channel -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ beacon_timing_control(padapter); -+ -+ pmlmeinfo->state = WIFI_FW_ADHOC_STATE; -+ -+ report_join_res(padapter, 1); -+ } -+ else -+ { -+ //DBG_871X("marc: invalid cap:%x\n", caps); -+ return; -+ } -+ -+} -+ -+void start_clnt_auth(_adapter* padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ pmlmeinfo->state &= (~WIFI_FW_AUTH_NULL); -+ pmlmeinfo->state |= WIFI_FW_AUTH_STATE; -+ -+ pmlmeinfo->auth_seq = 1; -+ pmlmeinfo->reauth_count = 0; -+ pmlmeinfo->reassoc_count = 0; -+ pmlmeinfo->link_count = 0; -+ pmlmeext->retry = 0; -+ -+ -+ // Because of AP's not receiving deauth before -+ // AP may: 1)not response auth or 2)deauth us after link is complete -+ // issue deauth before issuing auth to deal with the situation -+ // Commented by Albert 2012/07/21 -+ // For the Win8 P2P connection, it will be hard to have a successful connection if this Wi-Fi doesn't connect to it. -+ issue_deauth(padapter, (&(pmlmeinfo->network))->MacAddress, WLAN_REASON_DEAUTH_LEAVING); -+ -+ DBG_871X_LEVEL(_drv_always_, "start auth\n"); -+ issue_auth(padapter, NULL, 0); -+ -+ set_link_timer(pmlmeext, REAUTH_TO); -+ -+} -+ -+ -+void start_clnt_assoc(_adapter* padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ pmlmeinfo->state &= (~(WIFI_FW_AUTH_NULL | WIFI_FW_AUTH_STATE)); -+ pmlmeinfo->state |= (WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE); -+ -+ issue_assocreq(padapter); -+ -+ set_link_timer(pmlmeext, REASSOC_TO); -+} -+ -+unsigned int receive_disconnect(_adapter *padapter, unsigned char *MacAddr, unsigned short reason) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ //check A3 -+ if (!(_rtw_memcmp(MacAddr, get_my_bssid(&pmlmeinfo->network), ETH_ALEN))) -+ return _SUCCESS; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ if((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) -+ { -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ { -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ report_del_sta_event(padapter, MacAddr, reason); -+ -+ } -+ else if (pmlmeinfo->state & WIFI_FW_LINKING_STATE) -+ { -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ report_join_res(padapter, -2); -+ } -+ } -+ -+ return _SUCCESS; -+} -+ -+#ifdef CONFIG_80211D -+static void process_80211d(PADAPTER padapter, WLAN_BSSID_EX *bssid) -+{ -+ struct registry_priv *pregistrypriv; -+ struct mlme_ext_priv *pmlmeext; -+ RT_CHANNEL_INFO *chplan_new; -+ u8 channel; -+ u8 i; -+ -+ -+ pregistrypriv = &padapter->registrypriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ -+ // Adjust channel plan by AP Country IE -+ if (pregistrypriv->enable80211d && -+ (!pmlmeext->update_channel_plan_by_ap_done)) -+ { -+ u8 *ie, *p; -+ u32 len; -+ RT_CHANNEL_PLAN chplan_ap; -+ RT_CHANNEL_INFO chplan_sta[MAX_CHANNEL_NUM]; -+ u8 country[4]; -+ u8 fcn; // first channel number -+ u8 noc; // number of channel -+ u8 j, k; -+ -+ ie = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _COUNTRY_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (!ie) return; -+ if (len < 6) return; -+ -+ ie += 2; -+ p = ie; -+ ie += len; -+ -+ _rtw_memset(country, 0, 4); -+ _rtw_memcpy(country, p, 3); -+ p += 3; -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, -+ ("%s: 802.11d country=%s\n", __FUNCTION__, country)); -+ -+ i = 0; -+ while ((ie - p) >= 3) -+ { -+ fcn = *(p++); -+ noc = *(p++); -+ p++; -+ -+ for (j = 0; j < noc; j++) -+ { -+ if (fcn <= 14) channel = fcn + j; // 2.4 GHz -+ else channel = fcn + j*4; // 5 GHz -+ -+ chplan_ap.Channel[i++] = channel; -+ } -+ } -+ chplan_ap.Len = i; -+ -+#ifdef CONFIG_DEBUG_RTL871X -+ i = 0; -+ DBG_871X("%s: AP[%s] channel plan {", __FUNCTION__, bssid->Ssid.Ssid); -+ while ((i < chplan_ap.Len) && (chplan_ap.Channel[i] != 0)) -+ { -+ DBG_8192C("%02d,", chplan_ap.Channel[i]); -+ i++; -+ } -+ DBG_871X("}\n"); -+#endif -+ -+ _rtw_memcpy(chplan_sta, pmlmeext->channel_set, sizeof(chplan_sta)); -+#ifdef CONFIG_DEBUG_RTL871X -+ i = 0; -+ DBG_871X("%s: STA channel plan {", __FUNCTION__); -+ while ((i < MAX_CHANNEL_NUM) && (chplan_sta[i].ChannelNum != 0)) -+ { -+ DBG_871X("%02d(%c),", chplan_sta[i].ChannelNum, chplan_sta[i].ScanType==SCAN_PASSIVE?'p':'a'); -+ i++; -+ } -+ DBG_871X("}\n"); -+#endif -+ -+ _rtw_memset(pmlmeext->channel_set, 0, sizeof(pmlmeext->channel_set)); -+ chplan_new = pmlmeext->channel_set; -+ -+ i = j = k = 0; -+ if (pregistrypriv->wireless_mode & WIRELESS_11G) -+ { -+ do { -+ if ((i == MAX_CHANNEL_NUM) || -+ (chplan_sta[i].ChannelNum == 0) || -+ (chplan_sta[i].ChannelNum > 14)) -+ break; -+ -+ if ((j == chplan_ap.Len) || (chplan_ap.Channel[j] > 14)) -+ break; -+ -+ if (chplan_sta[i].ChannelNum == chplan_ap.Channel[j]) -+ { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ i++; -+ j++; -+ k++; -+ } -+ else if (chplan_sta[i].ChannelNum < chplan_ap.Channel[j]) -+ { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+// chplan_new[k].ScanType = chplan_sta[i].ScanType; -+ chplan_new[k].ScanType = SCAN_PASSIVE; -+ i++; -+ k++; -+ } -+ else if (chplan_sta[i].ChannelNum > chplan_ap.Channel[j]) -+ { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ j++; -+ k++; -+ } -+ } while (1); -+ -+ // change AP not support channel to Passive scan -+ while ((i < MAX_CHANNEL_NUM) && -+ (chplan_sta[i].ChannelNum != 0) && -+ (chplan_sta[i].ChannelNum <= 14)) -+ { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+// chplan_new[k].ScanType = chplan_sta[i].ScanType; -+ chplan_new[k].ScanType = SCAN_PASSIVE; -+ i++; -+ k++; -+ } -+ -+ // add channel AP supported -+ while ((j < chplan_ap.Len) && (chplan_ap.Channel[j] <= 14)) -+ { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ j++; -+ k++; -+ } -+ } -+ else -+ { -+ // keep original STA 2.4G channel plan -+ while ((i < MAX_CHANNEL_NUM) && -+ (chplan_sta[i].ChannelNum != 0) && -+ (chplan_sta[i].ChannelNum <= 14)) -+ { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+ chplan_new[k].ScanType = chplan_sta[i].ScanType; -+ i++; -+ k++; -+ } -+ -+ // skip AP 2.4G channel plan -+ while ((j < chplan_ap.Len) && (chplan_ap.Channel[j] <= 14)) -+ { -+ j++; -+ } -+ } -+ -+ if (pregistrypriv->wireless_mode & WIRELESS_11A) -+ { -+ do { -+ if ((i == MAX_CHANNEL_NUM) || -+ (chplan_sta[i].ChannelNum == 0)) -+ break; -+ -+ if ((j == chplan_ap.Len) || (chplan_ap.Channel[j] == 0)) -+ break; -+ -+ if (chplan_sta[i].ChannelNum == chplan_ap.Channel[j]) -+ { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ i++; -+ j++; -+ k++; -+ } -+ else if (chplan_sta[i].ChannelNum < chplan_ap.Channel[j]) -+ { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+// chplan_new[k].ScanType = chplan_sta[i].ScanType; -+ chplan_new[k].ScanType = SCAN_PASSIVE; -+ i++; -+ k++; -+ } -+ else if (chplan_sta[i].ChannelNum > chplan_ap.Channel[j]) -+ { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ j++; -+ k++; -+ } -+ } while (1); -+ -+ // change AP not support channel to Passive scan -+ while ((i < MAX_CHANNEL_NUM) && (chplan_sta[i].ChannelNum != 0)) -+ { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+// chplan_new[k].ScanType = chplan_sta[i].ScanType; -+ chplan_new[k].ScanType = SCAN_PASSIVE; -+ i++; -+ k++; -+ } -+ -+ // add channel AP supported -+ while ((j < chplan_ap.Len) && (chplan_ap.Channel[j] != 0)) -+ { -+ chplan_new[k].ChannelNum = chplan_ap.Channel[j]; -+ chplan_new[k].ScanType = SCAN_ACTIVE; -+ j++; -+ k++; -+ } -+ } -+ else -+ { -+ // keep original STA 5G channel plan -+ while ((i < MAX_CHANNEL_NUM) && (chplan_sta[i].ChannelNum != 0)) -+ { -+ chplan_new[k].ChannelNum = chplan_sta[i].ChannelNum; -+ chplan_new[k].ScanType = chplan_sta[i].ScanType; -+ i++; -+ k++; -+ } -+ } -+ -+ pmlmeext->update_channel_plan_by_ap_done = 1; -+ -+#ifdef CONFIG_DEBUG_RTL871X -+ k = 0; -+ DBG_871X("%s: new STA channel plan {", __FUNCTION__); -+ while ((k < MAX_CHANNEL_NUM) && (chplan_new[k].ChannelNum != 0)) -+ { -+ DBG_871X("%02d(%c),", chplan_new[k].ChannelNum, chplan_new[k].ScanType==SCAN_PASSIVE?'p':'c'); -+ k++; -+ } -+ DBG_871X("}\n"); -+#endif -+ -+#if 0 -+ // recover the right channel index -+ channel = chplan_sta[pmlmeext->sitesurvey_res.channel_idx].ChannelNum; -+ k = 0; -+ while ((k < MAX_CHANNEL_NUM) && (chplan_new[k].ChannelNum != 0)) -+ { -+ if (chplan_new[k].ChannelNum == channel) { -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, -+ ("%s: change mlme_ext sitesurvey channel index from %d to %d\n", -+ __FUNCTION__, pmlmeext->sitesurvey_res.channel_idx, k)); -+ pmlmeext->sitesurvey_res.channel_idx = k; -+ break; -+ } -+ k++; -+ } -+#endif -+ } -+ -+ // If channel is used by AP, set channel scan type to active -+ channel = bssid->Configuration.DSConfig; -+ chplan_new = pmlmeext->channel_set; -+ i = 0; -+ while ((i < MAX_CHANNEL_NUM) && (chplan_new[i].ChannelNum != 0)) -+ { -+ if (chplan_new[i].ChannelNum == channel) -+ { -+ if (chplan_new[i].ScanType == SCAN_PASSIVE) -+ { -+ //5G Bnad 2, 3 (DFS) doesn't change to active scan -+ if(channel >= 52 && channel <= 144) -+ break; -+ -+ chplan_new[i].ScanType = SCAN_ACTIVE; -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, -+ ("%s: change channel %d scan type from passive to active\n", -+ __FUNCTION__, channel)); -+ } -+ break; -+ } -+ i++; -+ } -+} -+#endif -+ -+/**************************************************************************** -+ -+Following are the functions to report events -+ -+*****************************************************************************/ -+ -+void report_survey_event(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct survey_event *psurvey_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext; -+ struct cmd_priv *pcmdpriv; -+ //u8 *pframe = precv_frame->u.hdr.rx_data; -+ //uint len = precv_frame->u.hdr.len; -+ -+ if(!padapter) -+ return; -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pcmdpriv = &padapter->cmdpriv; -+ -+ -+ if ((pcmd_obj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) -+ { -+ return; -+ } -+ -+ cmdsz = (sizeof(struct survey_event) + sizeof(struct C2HEvent_Header)); -+ if ((pevtcmd = (u8*)rtw_zmalloc(cmdsz)) == NULL) -+ { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header*)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct survey_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_Survey); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ psurvey_evt = (struct survey_event*)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ -+ if (collect_bss_info(padapter, precv_frame, (WLAN_BSSID_EX *)&psurvey_evt->bss) == _FAIL) -+ { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ rtw_mfree((u8 *)pevtcmd, cmdsz); -+ return; -+ } -+ -+#ifdef CONFIG_80211D -+ process_80211d(padapter, &psurvey_evt->bss); -+#endif -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ pmlmeext->sitesurvey_res.bss_cnt++; -+ -+ return; -+ -+} -+ -+void report_surveydone_event(_adapter *padapter) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct surveydone_event *psurveydone_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ if ((pcmd_obj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) -+ { -+ return; -+ } -+ -+ cmdsz = (sizeof(struct surveydone_event) + sizeof(struct C2HEvent_Header)); -+ if ((pevtcmd = (u8*)rtw_zmalloc(cmdsz)) == NULL) -+ { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header*)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct surveydone_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_SurveyDone); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ psurveydone_evt = (struct surveydone_event*)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ psurveydone_evt->bss_cnt = pmlmeext->sitesurvey_res.bss_cnt; -+ -+ DBG_871X("survey done event(%x)\n", psurveydone_evt->bss_cnt); -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+ -+} -+ -+void report_join_res(_adapter *padapter, int res) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct joinbss_event *pjoinbss_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ if ((pcmd_obj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) -+ { -+ return; -+ } -+ -+ cmdsz = (sizeof(struct joinbss_event) + sizeof(struct C2HEvent_Header)); -+ if ((pevtcmd = (u8*)rtw_zmalloc(cmdsz)) == NULL) -+ { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header*)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct joinbss_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_JoinBss); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ pjoinbss_evt = (struct joinbss_event*)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ _rtw_memcpy((unsigned char *)(&(pjoinbss_evt->network.network)), &(pmlmeinfo->network), sizeof(WLAN_BSSID_EX)); -+ pjoinbss_evt->network.join_res = pjoinbss_evt->network.aid = res; -+ -+ DBG_871X("report_join_res(%d)\n", res); -+ -+ -+ rtw_joinbss_event_prehandle(padapter, (u8 *)&pjoinbss_evt->network); -+ -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+ -+} -+ -+void report_del_sta_event(_adapter *padapter, unsigned char* MacAddr, unsigned short reason) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct sta_info *psta; -+ int mac_id; -+ struct stadel_event *pdel_sta_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ if ((pcmd_obj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) -+ { -+ return; -+ } -+ -+ cmdsz = (sizeof(struct stadel_event) + sizeof(struct C2HEvent_Header)); -+ if ((pevtcmd = (u8*)rtw_zmalloc(cmdsz)) == NULL) -+ { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header*)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct stadel_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_DelSTA); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ pdel_sta_evt = (struct stadel_event*)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ _rtw_memcpy((unsigned char *)(&(pdel_sta_evt->macaddr)), MacAddr, ETH_ALEN); -+ _rtw_memcpy((unsigned char *)(pdel_sta_evt->rsvd),(unsigned char *)(&reason),2); -+ -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, MacAddr); -+ if(psta) -+ mac_id = (int)psta->mac_id; -+ else -+ mac_id = (-1); -+ -+ pdel_sta_evt->mac_id = mac_id; -+ -+ DBG_871X("report_del_sta_event: delete STA, mac_id=%d\n", mac_id); -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+} -+ -+void report_add_sta_event(_adapter *padapter, unsigned char* MacAddr, int cam_idx) -+{ -+ struct cmd_obj *pcmd_obj; -+ u8 *pevtcmd; -+ u32 cmdsz; -+ struct stassoc_event *padd_sta_evt; -+ struct C2HEvent_Header *pc2h_evt_hdr; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ -+ if ((pcmd_obj = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) -+ { -+ return; -+ } -+ -+ cmdsz = (sizeof(struct stassoc_event) + sizeof(struct C2HEvent_Header)); -+ if ((pevtcmd = (u8*)rtw_zmalloc(cmdsz)) == NULL) -+ { -+ rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ _rtw_init_listhead(&pcmd_obj->list); -+ -+ pcmd_obj->cmdcode = GEN_CMD_CODE(_Set_MLME_EVT); -+ pcmd_obj->cmdsz = cmdsz; -+ pcmd_obj->parmbuf = pevtcmd; -+ -+ pcmd_obj->rsp = NULL; -+ pcmd_obj->rspsz = 0; -+ -+ pc2h_evt_hdr = (struct C2HEvent_Header*)(pevtcmd); -+ pc2h_evt_hdr->len = sizeof(struct stassoc_event); -+ pc2h_evt_hdr->ID = GEN_EVT_CODE(_AddSTA); -+ pc2h_evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); -+ -+ padd_sta_evt = (struct stassoc_event*)(pevtcmd + sizeof(struct C2HEvent_Header)); -+ _rtw_memcpy((unsigned char *)(&(padd_sta_evt->macaddr)), MacAddr, ETH_ALEN); -+ padd_sta_evt->cam_id = cam_idx; -+ -+ DBG_871X("report_add_sta_event: add STA\n"); -+ -+ rtw_enqueue_cmd(pcmdpriv, pcmd_obj); -+ -+ return; -+} -+ -+ -+/**************************************************************************** -+ -+Following are the event callback functions -+ -+*****************************************************************************/ -+ -+//for sta/adhoc mode -+void update_sta_info(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ //ERP -+ VCS_update(padapter, psta); -+ -+#ifdef CONFIG_80211N_HT -+ //HT -+ if(pmlmepriv->htpriv.ht_option) -+ { -+ psta->htpriv.ht_option = true; -+ -+ psta->htpriv.ampdu_enable = pmlmepriv->htpriv.ampdu_enable; -+ -+ if (support_short_GI(padapter, &(pmlmeinfo->HT_caps))) -+ psta->htpriv.sgi = true; -+ -+ psta->qos_option = true; -+ -+ } -+ else -+#endif //CONFIG_80211N_HT -+ { -+#ifdef CONFIG_80211N_HT -+ psta->htpriv.ht_option = false; -+ -+ psta->htpriv.ampdu_enable = false; -+ -+ psta->htpriv.sgi = false; -+#endif //CONFIG_80211N_HT -+ psta->qos_option = false; -+ -+ } -+#ifdef CONFIG_80211N_HT -+ psta->htpriv.bwmode = pmlmeext->cur_bwmode; -+ psta->htpriv.ch_offset = pmlmeext->cur_ch_offset; -+ -+ psta->htpriv.agg_enable_bitmap = 0x0;//reset -+ psta->htpriv.candidate_tid_bitmap = 0x0;//reset -+#endif //CONFIG_80211N_HT -+ -+ //QoS -+ if(pmlmepriv->qospriv.qos_option) -+ psta->qos_option = true; -+ -+#ifdef CONFIG_80211AC_VHT -+ if (pmlmepriv->vhtpriv.bwmode < CHANNEL_WIDTH_80) -+ pmlmepriv->vhtpriv.sgi = psta->htpriv.sgi; -+ _rtw_memcpy(&psta->vhtpriv, &pmlmepriv->vhtpriv, sizeof(struct vht_priv)); -+#endif //CONFIG_80211AC_VHT -+ -+ _enter_critical_bh(&psta->lock, &irqL); -+ psta->state = _FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL); -+ -+} -+ -+void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) -+{ -+ struct sta_info *psta, *psta_bmc; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 join_type; -+ u16 media_status; -+ -+ if(join_res < 0) -+ { -+ join_type = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); -+ -+ goto exit_mlmeext_joinbss_event_callback; -+ } -+ -+ if((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) -+ { -+ //for bc/mc -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ if(psta_bmc) -+ { -+ pmlmeinfo->FW_sta_info[psta_bmc->mac_id].psta = psta_bmc; -+ update_bmc_sta_support_rate(padapter, psta_bmc->mac_id); -+ Update_RA_Entry(padapter, psta_bmc); -+ } -+ } -+ -+ -+ //turn on dynamic functions -+ Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, true); -+ -+ // update IOT-releated issue -+ update_IOT_info(padapter); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, cur_network->SupportedRates); -+ -+ //BCN interval -+ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&pmlmeinfo->bcn_interval)); -+ -+ //udpate capability -+ update_capinfo(padapter, pmlmeinfo->capability); -+ -+ //WMM, Update EDCA param -+ WMMOnAssocRsp(padapter); -+ -+ //HT -+ HTOnAssocRsp(padapter); -+ -+#ifdef CONFIG_80211AC_VHT -+ //VHT -+ VHTOnAssocRsp(padapter); -+#endif -+ -+#ifndef CONFIG_CONCURRENT_MODE -+ // Call set_channel_bwmode when the CONFIG_CONCURRENT_MODE doesn't be defined. -+ //Set cur_channel&cur_bwmode&cur_ch_offset -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+#endif -+ -+ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); -+ if (psta) //only for infra. mode -+ { -+ pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; -+ -+ //DBG_871X("set_sta_rate\n"); -+ -+ psta->wireless_mode = pmlmeext->cur_wireless_mode; -+ -+ //set per sta rate after updating HT cap. -+ set_sta_rate(padapter, psta); -+ -+ #if (RATE_ADAPTIVE_SUPPORT==1) //for 88E RA -+ rtw_hal_set_hwreg(padapter,HW_VAR_TX_RPT_MAX_MACID, (u8*)&psta->mac_id); -+ #endif -+ media_status = (psta->mac_id<<8)|1; // MACID|OPMODE: 1 means connect -+ rtw_hal_set_hwreg(padapter,HW_VAR_H2C_MEDIA_STATUS_RPT,(u8 *)&media_status); -+ } -+ -+ join_type = 2; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ -+ if((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) -+ { -+ // correcting TSF -+ correct_TSF(padapter, pmlmeext); -+ -+ //set_link_timer(pmlmeext, DISCONNECT_TO); -+ } -+ -+#ifdef CONFIG_LPS -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->iface_type == IFACE_PORT0) -+#endif -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_CONNECT, 0); -+#endif -+ -+exit_mlmeext_joinbss_event_callback: -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ dc_handle_join_done(padapter, join_res); -+#endif -+#ifdef CONFIG_CONCURRENT_MODE -+ concurrent_chk_joinbss_done(padapter, join_res); -+#endif -+ -+ DBG_871X("=>%s\n", __FUNCTION__); -+ -+} -+ -+//currently only adhoc mode will go here -+void mlmeext_sta_add_event_callback(_adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 join_type; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ if((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) -+ { -+ if(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)//adhoc master or sta_count>1 -+ { -+ //nothing to do -+ } -+ else//adhoc client -+ { -+ //update TSF Value -+ //update_TSF(pmlmeext, pframe, len); -+ -+ // correcting TSF -+ correct_TSF(padapter, pmlmeext); -+ -+ //start beacon -+ if(send_beacon(padapter)==_FAIL) -+ { -+ pmlmeinfo->FW_sta_info[psta->mac_id].status = 0; -+ -+ pmlmeinfo->state ^= WIFI_FW_ADHOC_STATE; -+ -+ return; -+ } -+ -+ pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; -+ -+ } -+ -+ join_type = 2; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ } -+ -+ pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta; -+ -+ //rate radaptive -+ Update_RA_Entry(padapter, psta); -+ -+ //update adhoc sta_info -+ update_sta_info(padapter, psta); -+ -+} -+ -+void mlmeext_sta_del_event_callback(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (is_client_associated_to_ap(padapter) || is_IBSS_empty(padapter)) -+ { -+ //set_opmode_cmd(padapter, infra_client_with_mlme); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ dc_set_channel_bwmode_disconnect(padapter); -+#else -+#ifdef CONFIG_CONCURRENT_MODE -+ if((check_buddy_fwstate(padapter, _FW_LINKED)) != true) -+ { -+#endif //CONFIG_CONCURRENT_MODE -+ -+ //switch to the 20M Hz mode after disconnect -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ //SelectChannel(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset); -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ } -+#endif //CONFIG_CONCURRENT_MODE -+#endif //CONFIG_DUALMAC_CONCURRENT -+ -+ flush_all_cam_entry(padapter); -+ -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+ //set MSR to no link state -> infra. mode -+ Set_MSR(padapter, _HW_STATE_STATION_); -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ } -+ -+} -+ -+/**************************************************************************** -+ -+Following are the functions for the timer handlers -+ -+*****************************************************************************/ -+void _linked_info_dump(_adapter *padapter); -+void _linked_info_dump(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 mac_id; -+ int UndecoratedSmoothedPWDB; -+ #if 0 -+ DBG_871X("============ linked status check ===================\n"); -+ DBG_871X("pathA Rx SNRdb:%d, pathB Rx SNRdb:%d\n",padapter->recvpriv.RxSNRdB[0], padapter->recvpriv.RxSNRdB[1]); -+ DBG_871X("pathA Rx PWDB:%d\n",padapter->recvpriv.rxpwdb); -+ rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); -+ DBG_871X("UndecoratedSmoothedPWDB:%d\n",UndecoratedSmoothedPWDB); -+ DBG_871X("Rx RSSI:%d\n",padapter->recvpriv.rssi); -+ DBG_871X("Rx Signal_strength:%d\n",padapter->recvpriv.signal_strength); -+ DBG_871X("Rx Signal_qual:%d \n",padapter->recvpriv.signal_qual); -+ if ( check_fwstate( &padapter->mlmepriv, _FW_LINKED ) ) -+ { -+ DBG_871X("bw mode: %d, channel: %d\n", padapter->mlmeextpriv.cur_bwmode, padapter->mlmeextpriv.cur_channel ); -+ DBG_871X("received bytes = %d\n", (u32) (padapter->recvpriv.rx_bytes - padapter->recvpriv.last_rx_bytes ) ); -+ } -+ DBG_871X("============ linked status check ===================\n"); -+ DBG_871X("============ RX GAIN / false ALARM ===================\n"); -+ DBG_871X(" DIG PATH-A(0x%02x), PATH-B(0x%02x)\n",rtw_read8(padapter,0xc50),rtw_read8(padapter,0xc58)); -+ DBG_871X(" OFDM -Alarm DA2(0x%04x),DA4(0x%04x),DA6(0x%04x),DA8(0x%04x)\n", -+ rtw_read16(padapter,0xDA2),rtw_read16(padapter,0xDA4),rtw_read16(padapter,0xDA6),rtw_read16(padapter,0xDA8)); -+ -+ DBG_871X(" CCK -Alarm A5B(0x%02x),A5C(0x%02x)\n",rtw_read8(padapter,0xA5B),rtw_read8(padapter,0xA5C)); -+ #endif -+ -+ if((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) -+ { -+ mac_id=0; -+ } -+ else if((pmlmeinfo->state&0x03) == _HW_STATE_AP_) -+ { -+ mac_id=2; -+ } -+ if(padapter->bLinkInfoDump){ -+ DBG_871X("\n============ linked status check ===================\n"); -+ rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); -+ DBG_871X("UndecoratedSmoothedPWDB:%d\n",UndecoratedSmoothedPWDB); -+ } -+ -+ //============ tx info ============ -+ rtw_hal_get_def_var(padapter, HW_DEF_RA_INFO_DUMP,&mac_id); -+ -+ //============ rx info ============ -+ rtw_hal_set_def_var(padapter, HW_DEF_FA_CNT_DUMP,&mac_id); -+ -+ -+ -+} -+ -+static u8 chk_ap_is_alive(_adapter *padapter, struct sta_info *psta) -+{ -+ u8 ret = false; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ #ifdef DBG_EXPIRATION_CHK -+ DBG_871X(FUNC_ADPT_FMT" rx:"STA_PKTS_FMT", beacon:%llu, probersp_to_self:%llu" -+ /*", probersp_bm:%llu, probersp_uo:%llu, probereq:%llu, BI:%u"*/ -+ ", retry:%u\n" -+ , FUNC_ADPT_ARG(padapter) -+ , STA_RX_PKTS_DIFF_ARG(psta) -+ , psta->sta_stats.rx_beacon_pkts - psta->sta_stats.last_rx_beacon_pkts -+ , psta->sta_stats.rx_probersp_pkts - psta->sta_stats.last_rx_probersp_pkts -+ /*, psta->sta_stats.rx_probersp_bm_pkts - psta->sta_stats.last_rx_probersp_bm_pkts -+ , psta->sta_stats.rx_probersp_uo_pkts - psta->sta_stats.last_rx_probersp_uo_pkts -+ , psta->sta_stats.rx_probereq_pkts - psta->sta_stats.last_rx_probereq_pkts -+ , pmlmeinfo->bcn_interval*/ -+ , pmlmeext->retry -+ ); -+ -+ DBG_871X(FUNC_ADPT_FMT" tx_pkts:%llu, link_count:%u\n", FUNC_ADPT_ARG(padapter) -+ , padapter->xmitpriv.tx_pkts -+ , pmlmeinfo->link_count -+ ); -+ #endif -+ -+ if((sta_rx_data_pkts(psta) == sta_last_rx_data_pkts(psta)) -+ && sta_rx_beacon_pkts(psta) == sta_last_rx_beacon_pkts(psta) -+ && sta_rx_probersp_pkts(psta) == sta_last_rx_probersp_pkts(psta) -+ ) -+ { -+ ret = false; -+ } -+ else -+ { -+ ret = true; -+ } -+ -+ sta_update_last_rx_pkts(psta); -+ -+ return ret; -+} -+ -+void linked_status_chk(_adapter *padapter) -+{ -+ u32 i; -+ struct sta_info *psta; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ _linked_info_dump(padapter); -+ -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ rtw_hal_sreset_linked_status_check(padapter); -+ #endif -+ -+ if (is_client_associated_to_ap(padapter)) -+ { -+ //linked infrastructure client mode -+ -+ int tx_chk = _SUCCESS, rx_chk = _SUCCESS; -+ int rx_chk_limit; -+ -+ #if defined(DBG_ROAMING_TEST) -+ rx_chk_limit = 1; -+ #elif defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) -+ rx_chk_limit = 4; -+ #else -+ rx_chk_limit = 8; -+ #endif -+ -+ #ifdef CONFIG_INTEL_WIDI -+ if (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_NONE) -+ rx_chk_limit = 1; -+ #endif -+ -+ if ((psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress)) != NULL) -+ { -+ bool is_p2p_enable = false; -+ #ifdef CONFIG_P2P -+ is_p2p_enable = !rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE); -+ #endif -+ -+ if (chk_ap_is_alive(padapter, psta) == false) -+ rx_chk = _FAIL; -+ -+ if (pxmitpriv->last_tx_pkts == pxmitpriv->tx_pkts) -+ tx_chk = _FAIL; -+ -+ #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ if (pmlmeext->active_keep_alive_check && (rx_chk == _FAIL || tx_chk == _FAIL)) { -+ u8 backup_oper_channel=0; -+ -+ /* switch to correct channel of current network before issue keep-alive frames */ -+ if (rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { -+ backup_oper_channel = rtw_get_oper_ch(padapter); -+ SelectChannel(padapter, pmlmeext->cur_channel); -+ } -+ -+ if (rx_chk != _SUCCESS) -+ issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, psta->hwaddr, 3, 1); -+ -+ if ((tx_chk != _SUCCESS && pmlmeinfo->link_count++ == 0xf) || rx_chk != _SUCCESS) { -+ tx_chk = issue_nulldata(padapter, psta->hwaddr, 0, 3, 1); -+ /* if tx acked and p2p disabled, set rx_chk _SUCCESS to reset retry count */ -+ if (tx_chk == _SUCCESS && !is_p2p_enable) -+ rx_chk = _SUCCESS; -+ } -+ -+ /* back to the original operation channel */ -+ if(backup_oper_channel>0) -+ SelectChannel(padapter, backup_oper_channel); -+ -+ } -+ else -+ #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ -+ { -+ if (rx_chk != _SUCCESS) { -+ if (pmlmeext->retry == 0) { -+ #ifdef DBG_EXPIRATION_CHK -+ DBG_871X("issue_probereq to trigger probersp, retry=%d\n", pmlmeext->retry); -+ #endif -+ issue_probereq(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress); -+ issue_probereq(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress); -+ issue_probereq(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress); -+ } -+ } -+ -+ if (tx_chk != _SUCCESS && pmlmeinfo->link_count++ == 0xf) { -+ #ifdef DBG_EXPIRATION_CHK -+ DBG_871X("%s issue_nulldata 0\n", __FUNCTION__); -+ #endif -+ tx_chk = issue_nulldata(padapter, NULL, 0, 1, 0); -+ } -+ } -+ -+ if (rx_chk == _FAIL) { -+ pmlmeext->retry++; -+ if (pmlmeext->retry > rx_chk_limit) { -+ DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" disconnect or roaming\n", -+ FUNC_ADPT_ARG(padapter)); -+ receive_disconnect(padapter, pmlmeinfo->network.MacAddress -+ , WLAN_REASON_EXPIRATION_CHK); -+ return; -+ } -+ } else { -+ pmlmeext->retry = 0; -+ } -+ -+ if (tx_chk == _FAIL) { -+ pmlmeinfo->link_count &= 0xf; -+ } else { -+ pxmitpriv->last_tx_pkts = pxmitpriv->tx_pkts; -+ pmlmeinfo->link_count = 0; -+ } -+ -+ } //end of if ((psta = rtw_get_stainfo(pstapriv, passoc_res->network.MacAddress)) != NULL) -+ } -+ else if (is_client_associated_to_ibss(padapter)) -+ { -+ //linked IBSS mode -+ //for each assoc list entry to check the rx pkt counter -+ for (i = IBSS_START_MAC_ID; i < NUM_STA; i++) -+ { -+ if (pmlmeinfo->FW_sta_info[i].status == 1) -+ { -+ psta = pmlmeinfo->FW_sta_info[i].psta; -+ -+ if(NULL==psta) continue; -+ -+ if (pmlmeinfo->FW_sta_info[i].rx_pkt == sta_rx_pkts(psta)) -+ { -+ -+ if(pmlmeinfo->FW_sta_info[i].retry<3) -+ { -+ pmlmeinfo->FW_sta_info[i].retry++; -+ } -+ else -+ { -+ pmlmeinfo->FW_sta_info[i].retry = 0; -+ pmlmeinfo->FW_sta_info[i].status = 0; -+ report_del_sta_event(padapter, psta->hwaddr -+ , 65535// indicate disconnect caused by no rx -+ ); -+ } -+ } -+ else -+ { -+ pmlmeinfo->FW_sta_info[i].retry = 0; -+ pmlmeinfo->FW_sta_info[i].rx_pkt = (u32)sta_rx_pkts(psta); -+ } -+ } -+ } -+ -+ //set_link_timer(pmlmeext, DISCONNECT_TO); -+ -+ } -+ -+} -+ -+void survey_timer_hdl(_adapter *padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct sitesurvey_parm *psurveyPara; -+ struct cmd_priv *pcmdpriv=&padapter->cmdpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif -+ -+ //DBG_871X("marc: survey timer\n"); -+ -+ //issue rtw_sitesurvey_cmd -+ if (pmlmeext->sitesurvey_res.state > SCAN_START) -+ { -+ if(pmlmeext->sitesurvey_res.state == SCAN_PROCESS) -+ { -+#ifdef CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+ if( padapter->mlmeextpriv.mlmext_info.scan_cnt != RTW_SCAN_NUM_OF_CH ) -+#endif //CONFIG_STA_MODE_SCAN_UNDER_AP_MODE -+ pmlmeext->sitesurvey_res.channel_idx++; -+ } -+ -+ if(pmlmeext->scan_abort == true) -+ { -+ #ifdef CONFIG_P2P -+ if(!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE)) -+ { -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_MAX); -+ pmlmeext->sitesurvey_res.channel_idx = 3; -+ DBG_871X("%s idx:%d, cnt:%u\n", __FUNCTION__ -+ , pmlmeext->sitesurvey_res.channel_idx -+ , pwdinfo->find_phase_state_exchange_cnt -+ ); -+ } -+ else -+ #endif -+ { -+ pmlmeext->sitesurvey_res.channel_idx = pmlmeext->sitesurvey_res.ch_num; -+ DBG_871X("%s idx:%d\n", __FUNCTION__ -+ , pmlmeext->sitesurvey_res.channel_idx -+ ); -+ } -+ -+ pmlmeext->scan_abort = false;//reset -+ } -+ -+ if ((ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) -+ { -+ goto exit_survey_timer_hdl; -+ } -+ -+ if ((psurveyPara = (struct sitesurvey_parm*)rtw_zmalloc(sizeof(struct sitesurvey_parm))) == NULL) -+ { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ goto exit_survey_timer_hdl; -+ } -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, psurveyPara, GEN_CMD_CODE(_SiteSurvey)); -+ rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } -+ -+ -+exit_survey_timer_hdl: -+ -+ return; -+} -+ -+void link_timer_hdl(_adapter *padapter) -+{ -+ //static unsigned int rx_pkt = 0; -+ //static u64 tx_cnt = 0; -+ //struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ //struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ -+ if (pmlmeinfo->state & WIFI_FW_AUTH_NULL) -+ { -+ DBG_871X("link_timer_hdl:no beacon while connecting\n"); -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ report_join_res(padapter, -3); -+ } -+ else if (pmlmeinfo->state & WIFI_FW_AUTH_STATE) -+ { -+ //re-auth timer -+ if (++pmlmeinfo->reauth_count > REAUTH_LIMIT) -+ { -+ //if (pmlmeinfo->auth_algo != dot11AuthAlgrthm_Auto) -+ //{ -+ pmlmeinfo->state = 0; -+ report_join_res(padapter, -1); -+ return; -+ //} -+ //else -+ //{ -+ // pmlmeinfo->auth_algo = dot11AuthAlgrthm_Shared; -+ // pmlmeinfo->reauth_count = 0; -+ //} -+ } -+ -+ DBG_871X("link_timer_hdl: auth timeout and try again\n"); -+ pmlmeinfo->auth_seq = 1; -+ issue_auth(padapter, NULL, 0); -+ set_link_timer(pmlmeext, REAUTH_TO); -+ } -+ else if (pmlmeinfo->state & WIFI_FW_ASSOC_STATE) -+ { -+ //re-assoc timer -+ if (++pmlmeinfo->reassoc_count > REASSOC_LIMIT) -+ { -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ report_join_res(padapter, -2); -+ return; -+ } -+ -+ DBG_871X("link_timer_hdl: assoc timeout and try again\n"); -+ issue_assocreq(padapter); -+ set_link_timer(pmlmeext, REASSOC_TO); -+ } -+#if 0 -+ else if (is_client_associated_to_ap(padapter)) -+ { -+ //linked infrastructure client mode -+ if ((psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress)) != NULL) -+ { -+ /*to monitor whether the AP is alive or not*/ -+ if (rx_pkt == psta->sta_stats.rx_pkts) -+ { -+ receive_disconnect(padapter, pmlmeinfo->network.MacAddress); -+ return; -+ } -+ else -+ { -+ rx_pkt = psta->sta_stats.rx_pkts; -+ set_link_timer(pmlmeext, DISCONNECT_TO); -+ } -+ -+ //update the EDCA paramter according to the Tx/RX mode -+ update_EDCA_param(padapter); -+ -+ /*to send the AP a nulldata if no frame is xmitted in order to keep alive*/ -+ if (pmlmeinfo->link_count++ == 0) -+ { -+ tx_cnt = pxmitpriv->tx_pkts; -+ } -+ else if ((pmlmeinfo->link_count & 0xf) == 0) -+ { -+ if (tx_cnt == pxmitpriv->tx_pkts) -+ { -+ issue_nulldata(padapter, NULL, 0, 0, 0); -+ } -+ -+ tx_cnt = pxmitpriv->tx_pkts; -+ } -+ } //end of if ((psta = rtw_get_stainfo(pstapriv, passoc_res->network.MacAddress)) != NULL) -+ } -+ else if (is_client_associated_to_ibss(padapter)) -+ { -+ //linked IBSS mode -+ //for each assoc list entry to check the rx pkt counter -+ for (i = IBSS_START_MAC_ID; i < NUM_STA; i++) -+ { -+ if (pmlmeinfo->FW_sta_info[i].status == 1) -+ { -+ psta = pmlmeinfo->FW_sta_info[i].psta; -+ -+ if (pmlmeinfo->FW_sta_info[i].rx_pkt == psta->sta_stats.rx_pkts) -+ { -+ pmlmeinfo->FW_sta_info[i].status = 0; -+ report_del_sta_event(padapter, psta->hwaddr); -+ } -+ else -+ { -+ pmlmeinfo->FW_sta_info[i].rx_pkt = psta->sta_stats.rx_pkts; -+ } -+ } -+ } -+ -+ set_link_timer(pmlmeext, DISCONNECT_TO); -+ } -+#endif -+ -+ return; -+} -+ -+void addba_timer_hdl(struct sta_info *psta) -+{ -+#ifdef CONFIG_80211N_HT -+ struct ht_priv *phtpriv; -+ -+ if(!psta) -+ return; -+ -+ phtpriv = &psta->htpriv; -+ -+ if((phtpriv->ht_option==true) && (phtpriv->ampdu_enable==true)) -+ { -+ if(phtpriv->candidate_tid_bitmap) -+ phtpriv->candidate_tid_bitmap=0x0; -+ -+ } -+#endif //CONFIG_80211N_HT -+} -+ -+u8 NULL_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ return H2C_SUCCESS; -+} -+ -+#ifdef CONFIG_AUTO_AP_MODE -+void rtw_start_auto_ap(_adapter *adapter) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ rtw_set_802_11_infrastructure_mode(adapter, Ndis802_11APMode); -+ -+ rtw_setopmode_cmd(adapter, Ndis802_11APMode); -+} -+ -+static int rtw_auto_ap_start_beacon(_adapter *adapter) -+{ -+ int ret=0; -+ u8 *pbuf = NULL; -+ uint len; -+ u8 supportRate[16]; -+ int sz = 0, rateLen; -+ u8 * ie; -+ u8 wireless_mode, oper_channel; -+ u8 ssid[3] = {0}; //hidden ssid -+ u32 ssid_len = sizeof(ssid); -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ -+ len = 128; -+ pbuf = rtw_zmalloc(len); -+ if(!pbuf) -+ return -ENOMEM; -+ -+ -+ //generate beacon -+ ie = pbuf; -+ -+ //timestamp will be inserted by hardware -+ sz += 8; -+ ie += sz; -+ -+ //beacon interval : 2bytes -+ *(__le16*)ie = cpu_to_le16((u16)100);//BCN_INTERVAL=100; -+ sz += 2; -+ ie += 2; -+ -+ //capability info -+ *(__le16*)ie = 0; -+ *(__le16*)ie |= cpu_to_le16(cap_ESS); -+ *(__le16*)ie |= cpu_to_le16(cap_ShortPremble); -+ //*(u16*)ie |= cpu_to_le16(cap_Privacy); -+ sz += 2; -+ ie += 2; -+ -+ //SSID -+ ie = rtw_set_ie(ie, _SSID_IE_, ssid_len, ssid, &sz); -+ -+ //supported rates -+ wireless_mode = WIRELESS_11BG_24N; -+ rtw_set_supported_rate(supportRate, wireless_mode) ; -+ rateLen = rtw_get_rateset_len(supportRate); -+ if (rateLen > 8) -+ { -+ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, 8, supportRate, &sz); -+ } -+ else -+ { -+ ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, rateLen, supportRate, &sz); -+ } -+ -+ -+ //DS parameter set -+ if(check_buddy_fwstate(adapter, _FW_LINKED) && -+ check_buddy_fwstate(adapter, WIFI_STATION_STATE)) -+ { -+ PADAPTER pbuddy_adapter = adapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ oper_channel = pbuddy_mlmeext->cur_channel; -+ } -+ else -+ { -+ oper_channel = adapter_to_dvobj(adapter)->oper_channel; -+ } -+ ie = rtw_set_ie(ie, _DSSET_IE_, 1, &oper_channel, &sz); -+ -+ //ext supported rates -+ if (rateLen > 8) -+ { -+ ie = rtw_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rateLen - 8), (supportRate + 8), &sz); -+ } -+ -+ DBG_871X("%s, start auto ap beacon sz=%d\n", __FUNCTION__, sz); -+ -+ //lunch ap mode & start to issue beacon -+ if(rtw_check_beacon_data(adapter, pbuf, sz) == _SUCCESS) -+ { -+ -+ } -+ else -+ { -+ ret = -EINVAL; -+ } -+ -+ -+ rtw_mfree(pbuf, len); -+ -+ return ret; -+ -+} -+#endif//CONFIG_AUTO_AP_MODE -+ -+u8 setopmode_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ u8 type; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct setopmode_parm *psetop = (struct setopmode_parm *)pbuf; -+ -+ if(psetop->mode == Ndis802_11APMode) -+ { -+ pmlmeinfo->state = WIFI_FW_AP_STATE; -+ type = _HW_STATE_AP_; -+#ifdef CONFIG_NATIVEAP_MLME -+ //start_ap_mode(padapter); -+#endif -+ } -+ else if(psetop->mode == Ndis802_11Infrastructure) -+ { -+ pmlmeinfo->state &= ~(BIT(0)|BIT(1));// clear state -+ pmlmeinfo->state |= WIFI_FW_STATION_STATE;//set to STATION_STATE -+ type = _HW_STATE_STATION_; -+ } -+ else if(psetop->mode == Ndis802_11IBSS) -+ { -+ type = _HW_STATE_ADHOC_; -+ } -+ else -+ { -+ type = _HW_STATE_NOLINK_; -+ } -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_OPMODE, (u8 *)(&type)); -+ //Set_NETYPE0_MSR(padapter, type); -+ -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if(psetop->mode == Ndis802_11APMode) -+ rtw_auto_ap_start_beacon(padapter); -+#endif -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 createbss_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); -+ struct joinbss_parm *pparm = (struct joinbss_parm *)pbuf; -+ //u32 initialgain; -+ -+ -+ if(pparm->network.InfrastructureMode == Ndis802_11APMode) -+ { -+#ifdef CONFIG_AP_MODE -+ -+ if(pmlmeinfo->state == WIFI_FW_AP_STATE) -+ { -+ //todo: -+ return H2C_SUCCESS; -+ } -+#endif -+ } -+ -+ //below is for ad-hoc master -+ if(pparm->network.InfrastructureMode == Ndis802_11IBSS) -+ { -+ rtw_joinbss_reset(padapter); -+ -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset= HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pmlmeinfo->ERP_enable = 0; -+ pmlmeinfo->WMM_enable = 0; -+ pmlmeinfo->HT_enable = 0; -+ pmlmeinfo->HT_caps_enable = 0; -+ pmlmeinfo->HT_info_enable = 0; -+ pmlmeinfo->agg_enable_bitmap = 0; -+ pmlmeinfo->candidate_tid_bitmap = 0; -+ -+ //disable dynamic functions, such as high power, DIG -+ Save_DM_Func_Flag(padapter); -+ Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); -+ -+ //config the initial gain under linking, need to write the BB registers -+ //initialgain = 0x1E; -+ //rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); -+ -+ //cancel link timer -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ //clear CAM -+ flush_all_cam_entry(padapter); -+ -+ _rtw_memcpy(pnetwork, pbuf, FIELD_OFFSET(WLAN_BSSID_EX, IELength)); -+ pnetwork->IELength = ((WLAN_BSSID_EX *)pbuf)->IELength; -+ -+ if(pnetwork->IELength>MAX_IE_SZ)//Check pbuf->IELength -+ return H2C_PARAMETERS_ERROR; -+ -+ _rtw_memcpy(pnetwork->IEs, ((WLAN_BSSID_EX *)pbuf)->IEs, pnetwork->IELength); -+ -+ start_create_ibss(padapter); -+ -+ } -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ u8 join_type; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ struct joinbss_parm *pparm = (struct joinbss_parm *)pbuf; -+#endif //CONFIG_ANTENNA_DIVERSITY -+ u32 i; -+ u8 cbw40_enable=0; -+ //u32 initialgain; -+ //u32 acparm; -+ -+ //check already connecting to AP or not -+ if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) -+ { -+ if (pmlmeinfo->state & WIFI_FW_STATION_STATE) -+ { -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 5, 100); -+ } -+ -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+ //clear CAM -+ flush_all_cam_entry(padapter); -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ //set MSR to nolink -> infra. mode -+ //Set_MSR(padapter, _HW_STATE_NOLINK_); -+ Set_MSR(padapter, _HW_STATE_STATION_); -+ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, NULL); -+ } -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ rtw_antenna_select_cmd(padapter, pparm->network.PhyInfo.Optimum_antenna, false); -+#endif -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_clear_all_cam_entry(padapter); -+#endif -+ -+ rtw_joinbss_reset(padapter); -+ -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset= HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pmlmeinfo->ERP_enable = 0; -+ pmlmeinfo->WMM_enable = 0; -+ pmlmeinfo->HT_enable = 0; -+ pmlmeinfo->HT_caps_enable = 0; -+ pmlmeinfo->HT_info_enable = 0; -+ pmlmeinfo->agg_enable_bitmap = 0; -+ pmlmeinfo->candidate_tid_bitmap = 0; -+ pmlmeinfo->bwmode_updated = false; -+ //pmlmeinfo->assoc_AP_vendor = HT_IOT_PEER_MAX; -+ pmlmeinfo->VHT_enable = 0; -+ -+ _rtw_memcpy(pnetwork, pbuf, FIELD_OFFSET(WLAN_BSSID_EX, IELength)); -+ pnetwork->IELength = ((WLAN_BSSID_EX *)pbuf)->IELength; -+ -+ if(pnetwork->IELength>MAX_IE_SZ)//Check pbuf->IELength -+ return H2C_PARAMETERS_ERROR; -+ -+ _rtw_memcpy(pnetwork->IEs, ((WLAN_BSSID_EX *)pbuf)->IEs, pnetwork->IELength); -+ -+ //Check AP vendor to move rtw_joinbss_cmd() -+ //pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->IEs, pnetwork->IELength); -+ -+ //sizeof(NDIS_802_11_FIXED_IEs) -+ for (i = _FIXED_IE_LENGTH_; i < pnetwork->IELength;) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pnetwork->IEs + i); -+ -+ switch (pIE->ElementID) -+ { -+ case _VENDOR_SPECIFIC_IE_://Get WMM IE. -+ if ( _rtw_memcmp(pIE->data, WMM_OUI, 4) ) -+ { -+ WMM_param_handler(padapter, pIE); -+ } -+ break; -+ -+ case _HT_CAPABILITY_IE_: //Get HT Cap IE. -+ pmlmeinfo->HT_caps_enable = 1; -+ break; -+ -+ case _HT_EXTRA_INFO_IE_: //Get HT Info IE. -+#ifdef CONFIG_80211N_HT -+ pmlmeinfo->HT_info_enable = 1; -+ -+ //spec case only for cisco's ap because cisco's ap issue assoc rsp using mcs rate @40MHz or @20MHz -+//#if !defined(CONFIG_CONCURRENT_MODE) && !defined(CONFIG_DUALMAC_CONCURRENT) -+// if(pmlmeinfo->assoc_AP_vendor == ciscoAP) -+//#endif -+ { -+ struct HT_info_element *pht_info = (struct HT_info_element *)(pIE->data); -+ -+ if (pnetwork->Configuration.DSConfig > 14) { -+ if ((pregpriv->bw_mode & 0xf0) > CHANNEL_WIDTH_20) -+ cbw40_enable = 1; -+ } else { -+ if ((pregpriv->bw_mode & 0x0f) > CHANNEL_WIDTH_20) -+ cbw40_enable = 1; -+ } -+ -+ if ((cbw40_enable) && (pht_info->infos[0] & BIT(2))) -+ { -+ //switch to the 40M Hz mode according to the AP -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; -+ switch (pht_info->infos[0] & 0x3) -+ { -+ case 1: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case 3: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ -+ DBG_871X("set HT ch/bw before connected\n"); -+ } -+ } -+#endif //CONFIG_80211N_HT -+ break; -+#ifdef CONFIG_80211AC_VHT -+ case EID_VHTCapability://Get VHT Cap IE. -+ pmlmeinfo->VHT_enable = 1; -+ break; -+ -+ case EID_VHTOperation://Get VHT Operation IE. -+ if (pmlmeext->cur_bwmode == CHANNEL_WIDTH_40) { -+ if((GET_VHT_OPERATION_ELE_CHL_WIDTH(pIE->data) >= 1) -+ && ((pregpriv->bw_mode & 0xf0) >= CHANNEL_WIDTH_80)) { -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_80; -+ DBG_871X("VHT center ch = %d\n", GET_VHT_OPERATION_ELE_CENTER_FREQ1(pIE->data)); -+ DBG_871X("set VHT ch/bw before connected\n"); -+ } -+ } -+ break; -+#endif -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+#if 0 -+ if (padapter->registrypriv.wifi_spec) { -+ // for WiFi test, follow WMM test plan spec -+ acparm = 0x002F431C; // VO -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); -+ acparm = 0x005E541C; // VI -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); -+ acparm = 0x0000A525; // BE -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); -+ acparm = 0x0000A549; // BK -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); -+ -+ // for WiFi test, mixed mode with intel STA under bg mode throughput issue -+ if (padapter->mlmepriv.htpriv.ht_option == false){ -+ acparm = 0x00004320; -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); -+ } -+ } -+ else { -+ acparm = 0x002F3217; // VO -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); -+ acparm = 0x005E4317; // VI -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); -+ acparm = 0x00105320; // BE -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); -+ acparm = 0x0000A444; // BK -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); -+ } -+#endif -+ //disable dynamic functions, such as high power, DIG -+ //Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); -+ -+ //config the initial gain under linking, need to write the BB registers -+ //initialgain = 0x1E; -+ //rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress); -+ join_type = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ -+ //cancel link timer -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ start_clnt_join(padapter); -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 disconnect_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct disconnect_parm *param = (struct disconnect_parm *)pbuf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); -+ u8 val8; -+ -+ if (is_client_associated_to_ap(padapter)) -+ { -+ issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, param->deauth_timeout_ms/100, 100); -+ } -+ -+ //set_opmode_cmd(padapter, infra_client_with_mlme); -+ -+ //pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, NULL); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); -+ -+ if(((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ { -+ //Stop BCN -+ val8 = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_FUNC, (u8 *)(&val8)); -+ } -+ -+ -+ //set MSR to no link state -> infra. mode -+ Set_MSR(padapter, _HW_STATE_STATION_); -+ -+ pmlmeinfo->state = WIFI_FW_NULL_STATE; -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ dc_set_channel_bwmode_disconnect(padapter); -+#else -+#ifdef CONFIG_CONCURRENT_MODE -+ if((check_buddy_fwstate(padapter, _FW_LINKED)) != true) -+ { -+#endif //CONFIG_CONCURRENT_MODE -+ //switch to the 20M Hz mode after disconnect -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+#ifdef CONFIG_CONCURRENT_MODE -+ } -+#endif //CONFIG_CONCURRENT_MODE -+#endif //CONFIG_DUALMAC_CONCURRENT -+ -+ flush_all_cam_entry(padapter); -+ -+ _cancel_timer_ex(&pmlmeext->link_timer); -+ -+ rtw_free_uc_swdec_pending_queue(padapter); -+ -+ return H2C_SUCCESS; -+} -+ -+static int rtw_scan_ch_decision(_adapter *padapter, struct rtw_ieee80211_channel *out, -+ u32 out_num, struct rtw_ieee80211_channel *in, u32 in_num) -+{ -+ int i, j; -+ int scan_ch_num = 0; -+ int set_idx; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ /* clear out first */ -+ _rtw_memset(out, 0, sizeof(struct rtw_ieee80211_channel)*out_num); -+ -+ /* acquire channels from in */ -+ j = 0; -+ for (i=0;ichannel_set, in[i].hw_value)) >=0 -+ ) -+ { -+ _rtw_memcpy(&out[j], &in[i], sizeof(struct rtw_ieee80211_channel)); -+ -+ if(pmlmeext->channel_set[set_idx].ScanType == SCAN_PASSIVE) -+ out[j].flags &= RTW_IEEE80211_CHAN_PASSIVE_SCAN; -+ -+ j++; -+ } -+ if(j>=out_num) -+ break; -+ } -+ -+ /* if out is empty, use channel_set as default */ -+ if(j == 0) { -+ for (i=0;imax_chan_nums;i++) { -+ out[i].hw_value = pmlmeext->channel_set[i].ChannelNum; -+ -+ if(pmlmeext->channel_set[i].ScanType == SCAN_PASSIVE) -+ out[i].flags &= RTW_IEEE80211_CHAN_PASSIVE_SCAN; -+ -+ j++; -+ } -+ } -+ -+ if (padapter->setband == GHZ_24) { // 2.4G -+ for (i=0; i < j ; i++) { -+ if (out[i].hw_value > 35) -+ _rtw_memset(&out[i], 0 , sizeof(struct rtw_ieee80211_channel)); -+ else -+ scan_ch_num++; -+ } -+ j = scan_ch_num; -+ } else if (padapter->setband == GHZ_50) { // 5G -+ for (i=0; i < j ; i++) { -+ if (out[i].hw_value > 35) { -+ _rtw_memcpy(&out[scan_ch_num++], &out[i], sizeof(struct rtw_ieee80211_channel)); -+ } -+ } -+ j = scan_ch_num; -+ } else -+ {} -+ -+ return j; -+} -+ -+u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct sitesurvey_parm *pparm = (struct sitesurvey_parm *)pbuf; -+ u8 bdelayscan = false; -+ u8 val8; -+ u32 initialgain; -+ u32 i; -+ -+#ifdef CONFIG_P2P -+ struct wifidirect_info* pwdinfo = &padapter->wdinfo; -+#endif -+ -+ if (pmlmeext->sitesurvey_res.state == SCAN_DISABLE) -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ //for first time sitesurvey_cmd -+ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); -+#endif //CONFIG_CONCURRENT_MODE -+ -+ pmlmeext->sitesurvey_res.state = SCAN_START; -+ pmlmeext->sitesurvey_res.bss_cnt = 0; -+ pmlmeext->sitesurvey_res.channel_idx = 0; -+ -+ for(i=0;issid[i].SsidLength) { -+ _rtw_memcpy(pmlmeext->sitesurvey_res.ssid[i].Ssid, pparm->ssid[i].Ssid, IW_ESSID_MAX_SIZE); -+ pmlmeext->sitesurvey_res.ssid[i].SsidLength= pparm->ssid[i].SsidLength; -+ } else { -+ pmlmeext->sitesurvey_res.ssid[i].SsidLength= 0; -+ } -+ } -+ -+ pmlmeext->sitesurvey_res.ch_num = rtw_scan_ch_decision(padapter -+ , pmlmeext->sitesurvey_res.ch, RTW_CHANNEL_SCAN_AMOUNT -+ , pparm->ch, pparm->ch_num -+ ); -+ -+ pmlmeext->sitesurvey_res.scan_mode = pparm->scan_mode; -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ bdelayscan = dc_handle_site_survey(padapter); -+#endif -+ -+ //issue null data if associating to the AP -+ if (is_client_associated_to_ap(padapter) == true) -+ { -+ pmlmeext->sitesurvey_res.state = SCAN_TXNULL; -+ -+ issue_nulldata(padapter, NULL, 1, 3, 500); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(is_client_associated_to_ap(padapter->pbuddy_adapter) == true) -+ { -+ DBG_871X("adapter is scanning(buddy_adapter is linked), issue nulldata(pwrbit=1)\n"); -+ -+ issue_nulldata(padapter->pbuddy_adapter, NULL, 1, 3, 500); -+ } -+#endif -+ bdelayscan = true; -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ else if(is_client_associated_to_ap(padapter->pbuddy_adapter) == true) -+ { -+ #ifdef CONFIG_TDLS -+ if(padapter->pbuddy_adapter->wdinfo.wfd_tdls_enable == 1) -+ { -+ issue_tunneled_probe_req(padapter->pbuddy_adapter); -+ } -+ #endif //CONFIG_TDLS -+ -+ pmlmeext->sitesurvey_res.state = SCAN_TXNULL; -+ -+ issue_nulldata(padapter->pbuddy_adapter, NULL, 1, 3, 500); -+ -+ bdelayscan = true; -+ } -+#endif -+ if(bdelayscan) -+ { -+ //delay 50ms to protect nulldata(1). -+ set_survey_timer(pmlmeext, 50); -+ return H2C_SUCCESS; -+ } -+ } -+ -+ if ((pmlmeext->sitesurvey_res.state == SCAN_START) || (pmlmeext->sitesurvey_res.state == SCAN_TXNULL)) -+ { -+#ifdef CONFIG_FIND_BEST_CHANNEL -+#if 0 -+ for (i=0; pmlmeext->channel_set[i].ChannelNum !=0; i++) { -+ pmlmeext->channel_set[i].rx_count = 0; -+ } -+#endif -+#endif /* CONFIG_FIND_BEST_CHANNEL */ -+ -+ //disable dynamic functions, such as high power, DIG -+ Save_DM_Func_Flag(padapter); -+ Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); -+ -+ //config the initial gain under scaning, need to write the BB registers -+#ifdef CONFIG_P2P -+#ifdef CONFIG_IOCTL_CFG80211 -+ if((wdev_to_priv(padapter->rtw_wdev))->p2p_enabled == true && pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ initialgain = 0x30; -+ else -+#endif //CONFIG_IOCTL_CFG80211 -+ if ( !rtw_p2p_chk_state( pwdinfo, P2P_STATE_NONE ) ) -+ initialgain = 0x28; -+ else -+#endif //CONFIG_P2P -+ initialgain = 0x1e; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain)); -+ -+ //set MSR to no link state -+ Set_MSR(padapter, _HW_STATE_NOLINK_); -+ -+ val8 = 1; //under site survey -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ pmlmeext->sitesurvey_res.state = SCAN_PROCESS; -+ } -+ -+ site_survey(padapter); -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 setauth_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct setauth_parm *pparm = (struct setauth_parm *)pbuf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (pparm->mode < 4) -+ { -+ pmlmeinfo->auth_algo = pparm->mode; -+ } -+ -+ return H2C_SUCCESS; -+} -+ -+u8 setkey_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ unsigned short ctrl; -+ struct setkey_parm *pparm = (struct setkey_parm *)pbuf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ unsigned char null_sta[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ -+ //main tx key for wep. -+ if(pparm->set_tx) -+ pmlmeinfo->key_index = pparm->keyid; -+ -+ //write cam -+ ctrl = BIT(15) | ((pparm->algorithm) << 2) | pparm->keyid; -+ -+ DBG_871X_LEVEL(_drv_always_, "set group key to hw: alg:%d(WEP40-1 WEP104-5 TKIP-2 AES-4) " -+ "keyid:%d\n", pparm->algorithm, pparm->keyid); -+ write_cam(padapter, pparm->keyid, ctrl, null_sta, pparm->key); -+ -+ //allow multicast packets to driver -+ padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_ON_RCR_AM, null_addr); -+ -+ return H2C_SUCCESS; -+} -+ -+u8 set_stakey_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ u16 ctrl=0; -+ u8 cam_id = 0;//cam_entry -+ u8 ret = H2C_SUCCESS; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct set_stakey_parm *pparm = (struct set_stakey_parm *)pbuf; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+#endif //CONFIG_TDLS -+ -+ //cam_entry: -+ //0~3 for default key -+ -+ //for concurrent mode (ap+sta, sta+sta): -+ //default key is disable, using sw encrypt/decrypt -+ //camid 0, 1, 2, 3 is default entry for default key/group key -+ //macid = 1 is for bc/mc stainfo, no mapping to camid -+ //macid = 0 mapping to camid 4 -+ //for macid >=2, camid = macid+3; -+ -+ -+ if(pparm->algorithm == _NO_PRIVACY_) // clear cam entry -+ { -+ clear_cam_entry(padapter, pparm->id); -+ ret = H2C_SUCCESS; -+ goto exit_set_stakey_hdl; -+ } -+ -+ if((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ { -+ psta = rtw_get_stainfo(pstapriv, pparm->addr); -+ if(psta) -+ { -+ ctrl = (BIT(15) | ((pparm->algorithm) << 2)); -+ -+ DBG_871X("r871x_set_stakey_hdl(): enc_algorithm=%d\n", pparm->algorithm); -+ -+ if((psta->mac_id == 1) || (psta->mac_id>(NUM_STA-4))) -+ { -+ DBG_871X("r871x_set_stakey_hdl():set_stakey failed, mac_id(aid)=%d\n", psta->mac_id); -+ ret = H2C_REJECTED; -+ goto exit_set_stakey_hdl; -+ } -+ -+ cam_id = (u8)rtw_get_camid(psta->mac_id);//0~3 for default key, cmd_id=macid + 3; -+ -+ DBG_871X("Write CAM, mac_addr=%x:%x:%x:%x:%x:%x, cam_entry=%d\n", pparm->addr[0], -+ pparm->addr[1], pparm->addr[2], pparm->addr[3], pparm->addr[4], -+ pparm->addr[5], cam_id); -+ -+ write_cam(padapter, cam_id, ctrl, pparm->addr, pparm->key); -+ -+ ret = H2C_SUCCESS_RSP; -+ goto exit_set_stakey_hdl; -+ -+ } -+ else -+ { -+ DBG_871X("r871x_set_stakey_hdl(): sta has been free\n"); -+ ret = H2C_REJECTED; -+ goto exit_set_stakey_hdl; -+ } -+ -+ } -+ -+ -+ //below for sta mode -+ -+ if((psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress))) -+ cam_id = (u8)rtw_get_camid(psta->mac_id); -+ else -+ cam_id = 4; -+ -+ ctrl = BIT(15) | ((pparm->algorithm) << 2); -+ -+#ifdef CONFIG_TDLS -+ if(ptdlsinfo->clear_cam!=0){ -+ clear_cam_entry(padapter, ptdlsinfo->clear_cam); -+ ptdlsinfo->clear_cam=0; -+ ret = H2C_SUCCESS; -+ goto exit_set_stakey_hdl; -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, pparm->addr);//Get TDLS Peer STA -+ if( psta->tdls_sta_state&TDLS_LINKED_STATE ){ -+ write_cam(padapter, psta->mac_id, ctrl, pparm->addr, pparm->key); -+ } -+ else -+#endif //CONFIG_TDLS -+ write_cam(padapter, cam_id, ctrl, pparm->addr, pparm->key); -+ -+ pmlmeinfo->enc_algo = pparm->algorithm; -+ -+exit_set_stakey_hdl: -+ -+ DBG_871X_LEVEL(_drv_always_, "set pairwise key to hw: alg:%d(WEP40-1 WEP104-5 TKIP-2 AES-4) camid:%d\n", -+ pparm->algorithm, cam_id); -+ -+ return ret; -+ -+} -+ -+u8 add_ba_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct addBaReq_parm *pparm = (struct addBaReq_parm *)pbuf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, pparm->addr); -+ -+ if(!psta) -+ return H2C_SUCCESS; -+ -+#ifdef CONFIG_80211N_HT -+ if (((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && (pmlmeinfo->HT_enable)) || -+ ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ { -+ //pmlmeinfo->ADDBA_retry_count = 0; -+ //pmlmeinfo->candidate_tid_bitmap |= (0x1 << pparm->tid); -+ //psta->htpriv.candidate_tid_bitmap |= BIT(pparm->tid); -+ issue_action_BA(padapter, pparm->addr, RTW_WLAN_ACTION_ADDBA_REQ, (u16)pparm->tid); -+ //_set_timer(&pmlmeext->ADDBA_timer, ADDBA_TO); -+ _set_timer(&psta->addba_retry_timer, ADDBA_TO); -+ } -+#ifdef CONFIG_TDLS -+ else if((psta->tdls_sta_state & TDLS_LINKED_STATE)&& -+ (psta->htpriv.ht_option==true) && -+ (psta->htpriv.ampdu_enable==true) ) -+ { -+ issue_action_BA(padapter, pparm->addr, RTW_WLAN_ACTION_ADDBA_REQ, (u16)pparm->tid); -+ //_set_timer(&pmlmeext->ADDBA_timer, ADDBA_TO); -+ _set_timer(&psta->addba_retry_timer, ADDBA_TO); -+ } -+#endif //CONFIG -+ else -+ { -+ psta->htpriv.candidate_tid_bitmap &= ~BIT(pparm->tid); -+ } -+#endif //CONFIG_80211N_HT -+ return H2C_SUCCESS; -+} -+ -+u8 set_tx_beacon_cmd(_adapter* padapter) -+{ -+ struct cmd_obj *ph2c; -+ struct Tx_Beacon_param *ptxBeacon_parm; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 res = _SUCCESS; -+ int len_diff = 0; -+ -+ -+ -+ if ((ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) -+ { -+ res= _FAIL; -+ goto exit; -+ } -+ -+ if ((ptxBeacon_parm = (struct Tx_Beacon_param *)rtw_zmalloc(sizeof(struct Tx_Beacon_param))) == NULL) -+ { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memcpy(&(ptxBeacon_parm->network), &(pmlmeinfo->network), sizeof(WLAN_BSSID_EX)); -+ -+ len_diff = update_hidden_ssid( -+ ptxBeacon_parm->network.IEs+_BEACON_IE_OFFSET_ -+ , ptxBeacon_parm->network.IELength-_BEACON_IE_OFFSET_ -+ , pmlmeinfo->hidden_ssid_mode -+ ); -+ ptxBeacon_parm->network.IELength += len_diff; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, ptxBeacon_parm, GEN_CMD_CODE(_TX_Beacon)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+ -+u8 mlme_evt_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ u8 evt_code, evt_seq; -+ u16 evt_sz; -+ uint *peventbuf; -+ void (*event_callback)(_adapter *dev, u8 *pbuf); -+ struct evt_priv *pevt_priv = &(padapter->evtpriv); -+ -+ peventbuf = (uint*)pbuf; -+ evt_sz = (u16)(*peventbuf&0xffff); -+ evt_seq = (u8)((*peventbuf>>24)&0x7f); -+ evt_code = (u8)((*peventbuf>>16)&0xff); -+ -+ -+ #ifdef CHECK_EVENT_SEQ -+ // checking event sequence... -+ if (evt_seq != (ATOMIC_READ(&pevt_priv->event_seq) & 0x7f) ) -+ { -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_info_,("Evetn Seq Error! %d vs %d\n", (evt_seq & 0x7f), (ATOMIC_READ(&pevt_priv->event_seq) & 0x7f))); -+ -+ pevt_priv->event_seq = (evt_seq+1)&0x7f; -+ -+ goto _abort_event_; -+ } -+ #endif -+ -+ // checking if event code is valid -+ if (evt_code >= MAX_C2HEVT) -+ { -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\nEvent Code(%d) mismatch!\n", evt_code)); -+ goto _abort_event_; -+ } -+ -+ // checking if event size match the event parm size -+ if ((wlanevents[evt_code].parmsize != 0) && -+ (wlanevents[evt_code].parmsize != evt_sz)) -+ { -+ -+ RT_TRACE(_module_rtl871x_cmd_c_,_drv_err_,("\nEvent(%d) Parm Size mismatch (%d vs %d)!\n", -+ evt_code, wlanevents[evt_code].parmsize, evt_sz)); -+ goto _abort_event_; -+ -+ } -+ -+ ATOMIC_INC(&pevt_priv->event_seq); -+ -+ peventbuf += 2; -+ -+ if(peventbuf) -+ { -+ event_callback = wlanevents[evt_code].event_callback; -+ event_callback(padapter, (u8*)peventbuf); -+ -+ pevt_priv->evt_done_cnt++; -+ } -+ -+ -+_abort_event_: -+ -+ -+ return H2C_SUCCESS; -+ -+} -+ -+u8 h2c_msg_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ if(!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ return H2C_SUCCESS; -+} -+ -+u8 tx_beacon_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ if(send_beacon(padapter)==_FAIL) -+ { -+ DBG_871X("issue_beacon, fail!\n"); -+ return H2C_PARAMETERS_ERROR; -+ } -+#ifdef CONFIG_AP_MODE -+ else //tx bc/mc frames after update TIM -+ { -+ _irqL irqL; -+ struct sta_info *psta_bmc; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe=NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ //for BC/MC Frames -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ if(!psta_bmc) -+ return H2C_SUCCESS; -+ -+ if((pstapriv->tim_bitmap&BIT(0)) && (psta_bmc->sleepq_len>0)) -+ { -+ rtw_msleep_os(10);// 10ms, ATIM(HIQ) Windows -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) -+ { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ psta_bmc->sleepq_len--; -+ if(psta_bmc->sleepq_len>0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ pxmitframe->attrib.triggered=1; -+ -+ pxmitframe->attrib.qsel = 0x11;//HIQ -+ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ } -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ } -+ -+ } -+#endif -+ -+ return H2C_SUCCESS; -+ -+} -+ -+void change_band_update_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork) -+{ -+ u8 network_type,rate_len, total_rate_len,remainder_rate_len; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 erpinfo=0x4; -+ -+ if(pmlmeext->cur_channel >= 36) -+ { -+ network_type = WIRELESS_11A; -+ total_rate_len = IEEE80211_NUM_OFDM_RATESLEN; -+ DBG_871X("%s(): change to 5G Band\n",__FUNCTION__); -+ rtw_remove_bcn_ie(padapter, pnetwork, _ERPINFO_IE_); -+ } -+ else -+ { -+ network_type = WIRELESS_11BG; -+ total_rate_len = IEEE80211_CCK_RATE_LEN+IEEE80211_NUM_OFDM_RATESLEN; -+ DBG_871X("%s(): change to 2.4G Band\n",__FUNCTION__); -+ rtw_add_bcn_ie(padapter, pnetwork, _ERPINFO_IE_, &erpinfo, 1); -+ } -+ -+ rtw_set_supported_rate(pnetwork->SupportedRates, network_type); -+ -+ UpdateBrateTbl(padapter, pnetwork->SupportedRates); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, pnetwork->SupportedRates); -+ -+ if(total_rate_len > 8) -+ { -+ rate_len = 8; -+ remainder_rate_len = total_rate_len - 8; -+ } -+ else -+ { -+ rate_len = total_rate_len; -+ remainder_rate_len = 0; -+ } -+ -+ rtw_add_bcn_ie(padapter, pnetwork, _SUPPORTEDRATES_IE_, pnetwork->SupportedRates, rate_len); -+ -+ if(remainder_rate_len) -+ { -+ rtw_add_bcn_ie(padapter, pnetwork, _EXT_SUPPORTEDRATES_IE_, (pnetwork->SupportedRates+8), remainder_rate_len); -+ } -+ else -+ { -+ rtw_remove_bcn_ie(padapter, pnetwork, _EXT_SUPPORTEDRATES_IE_); -+ } -+} -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+void dc_SelectChannel(_adapter *padapter, unsigned char channel) -+{ -+ PADAPTER ptarget_adapter; -+ -+ if( (padapter->pbuddy_adapter != NULL) && -+ (padapter->DualMacConcurrent == true) && -+ (padapter->adapter_type == SECONDARY_ADAPTER)) -+ { -+ // only mac0 could control BB&RF -+ ptarget_adapter = padapter->pbuddy_adapter; -+ } -+ else -+ { -+ ptarget_adapter = padapter; -+ } -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(ptarget_adapter)->setch_mutex), NULL); -+ -+ rtw_hal_set_chan(ptarget_adapter, channel); -+ -+ _exit_critical_mutex(&(adapter_to_dvobj(ptarget_adapter)->setch_mutex), NULL); -+} -+ -+void dc_SetBWMode(_adapter *padapter, unsigned short bwmode, unsigned char channel_offset) -+{ -+ PADAPTER ptarget_adapter; -+ -+ if( (padapter->pbuddy_adapter != NULL) && -+ (padapter->DualMacConcurrent == true) && -+ (padapter->adapter_type == SECONDARY_ADAPTER)) -+ { -+ // only mac0 could control BB&RF -+ ptarget_adapter = padapter->pbuddy_adapter; -+ } -+ else -+ { -+ ptarget_adapter = padapter; -+ } -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(ptarget_adapter)->setbw_mutex), NULL); -+ -+ rtw_hal_set_bwmode(ptarget_adapter, (CHANNEL_WIDTH)bwmode, channel_offset); -+ -+ _exit_critical_mutex(&(adapter_to_dvobj(ptarget_adapter)->setbw_mutex), NULL); -+} -+ -+void dc_set_channel_bwmode_disconnect(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_priv *pbuddy_mlmepriv = NULL; -+ -+ if(pbuddy_adapter != NULL && -+ padapter->DualMacConcurrent == true) -+ { -+ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+ if((check_fwstate(pbuddy_mlmepriv, _FW_LINKED)) != true) -+ { -+ //switch to the 20M Hz mode after disconnect -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ } -+ } -+ else -+ { -+ //switch to the 20M Hz mode after disconnect -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ } -+} -+ -+u8 dc_handle_join_request(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX*)(&(pmlmeinfo->network)); -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = NULL; -+ struct mlme_priv *pbuddy_mlmepriv = NULL; -+ u8 ret = _SUCCESS; -+ -+ if(pbuddy_adapter != NULL && -+ padapter->DualMacConcurrent == true) -+ { -+ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+ -+ if(pmlmeext->cur_channel != pbuddy_mlmeext->cur_channel || -+ pmlmeext->cur_bwmode != pbuddy_mlmeext->cur_bwmode || -+ pmlmeext->cur_ch_offset != pbuddy_mlmeext->cur_ch_offset) -+ { -+ if((check_fwstate(pbuddy_mlmepriv, WIFI_AP_STATE)) == true) -+ { -+ //issue deauth to all stas if if2 is at ap mode -+ rtw_sta_flush(pbuddy_adapter); -+ -+ //rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); -+ rtw_hal_set_hwreg(pbuddy_adapter, HW_VAR_CHECK_TXBUF, 0); -+ } -+ else if(check_fwstate(pbuddy_mlmepriv, _FW_LINKED) == true) -+ { -+ if(pmlmeext->cur_channel == pbuddy_mlmeext->cur_channel) -+ { -+ // CHANNEL_WIDTH_40 or CHANNEL_WIDTH_20 but channel offset is different -+ if((pmlmeext->cur_bwmode == pbuddy_mlmeext->cur_bwmode) && -+ (pmlmeext->cur_ch_offset != pbuddy_mlmeext->cur_ch_offset) ) -+ { -+ report_join_res(padapter, -4); -+ ret = _FAIL; -+ } -+ } -+ else -+ { -+ report_join_res(padapter, -4); -+ ret = _FAIL; -+ } -+ } -+ } -+ else if (is_client_associated_to_ap(pbuddy_adapter) == true) -+ { -+ issue_nulldata(pbuddy_adapter, NULL, 1, 0, 0); -+ } -+ } -+ -+ return ret; -+} -+ -+void dc_handle_join_done(_adapter *padapter, u8 join_res) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_priv *pbuddy_mlmepriv = NULL; -+ struct mlme_ext_priv *pbuddy_mlmeext = NULL; -+ struct mlme_ext_info *pbuddy_mlmeinfo = NULL; -+ WLAN_BSSID_EX *pbuddy_network_mlmeext = NULL; -+ u8 change_band = false; -+ -+ -+ if(pbuddy_adapter != NULL && -+ padapter->DualMacConcurrent == true) -+ { -+ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ pbuddy_mlmeinfo = &(pbuddy_mlmeext->mlmext_info); -+ pbuddy_network_mlmeext = &(pbuddy_mlmeinfo->network); -+ -+ if(((pbuddy_mlmeinfo->state&0x03) == WIFI_FW_AP_STATE) && -+ check_fwstate(pbuddy_mlmepriv, _FW_LINKED)) -+ { -+ //restart and update beacon -+ DBG_871X("after join, current adapter, CH=%d, BW=%d, offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ -+ if(join_res >= 0) -+ { -+ u8 *p; -+ int ie_len; -+ struct HT_info_element *pht_info=NULL; -+ -+ if((pbuddy_mlmeext->cur_channel <= 14 && pmlmeext->cur_channel >= 36) || -+ (pbuddy_mlmeext->cur_channel >= 36 && pmlmeext->cur_channel <= 14)) -+ { -+ change_band = true; -+ } -+ -+ //sync channel/bwmode/ch_offset with another adapter -+ pbuddy_mlmeext->cur_channel = pmlmeext->cur_channel; -+ -+ if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) -+ { -+ p = rtw_get_ie((pbuddy_network_mlmeext->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pbuddy_network_mlmeext->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if( p && ie_len) -+ { -+ pht_info = (struct HT_info_element *)(p+2); -+ pht_info->infos[0] &= ~(BIT(0)|BIT(1)); //no secondary channel is present -+ } -+ -+ if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40) -+ { -+ pbuddy_mlmeext->cur_ch_offset = pmlmeext->cur_ch_offset; -+ -+ //to update cur_ch_offset value in beacon -+ if( pht_info ) -+ { -+ switch(pmlmeext->cur_ch_offset) -+ { -+ case HAL_PRIME_CHNL_OFFSET_LOWER: -+ pht_info->infos[0] |= 0x1; -+ break; -+ case HAL_PRIME_CHNL_OFFSET_UPPER: -+ pht_info->infos[0] |= 0x3; -+ break; -+ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: -+ default: -+ break; -+ } -+ } -+ } -+ else if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_20) -+ { -+ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if(pmlmeext->cur_channel>0 && pmlmeext->cur_channel<5) -+ { -+ if(pht_info) -+ pht_info->infos[0] |= 0x1; -+ -+ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_40; -+ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ } -+ -+ if(pmlmeext->cur_channel>7 && pmlmeext->cur_channel<(14+1)) -+ { -+ if(pht_info) -+ pht_info->infos[0] |= 0x3; -+ -+ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_40; -+ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ } -+ -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ } -+ } -+ -+ // to update channel value in beacon -+ pbuddy_network_mlmeext->Configuration.DSConfig = pmlmeext->cur_channel; -+ p = rtw_get_ie((pbuddy_network_mlmeext->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (pbuddy_network_mlmeext->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if(p && ie_len>0) -+ *(p + 2) = pmlmeext->cur_channel; -+ -+ p = rtw_get_ie((pbuddy_network_mlmeext->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pbuddy_network_mlmeext->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if( p && ie_len) -+ { -+ pht_info = (struct HT_info_element *)(p+2); -+ pht_info->primary_channel = pmlmeext->cur_channel; -+ } -+ -+ // update mlmepriv's cur_network -+ _rtw_memcpy(&pbuddy_mlmepriv->cur_network.network, pbuddy_network_mlmeext, pbuddy_network_mlmeext->Length); -+ } -+ else -+ { -+ // switch back to original channel/bwmode/ch_offset; -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ } -+ -+ DBG_871X("after join, another adapter, CH=%d, BW=%d, offset=%d\n", pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_bwmode, pbuddy_mlmeext->cur_ch_offset); -+ -+ if(change_band == true) -+ change_band_update_ie(pbuddy_adapter, pbuddy_network_mlmeext); -+ -+ DBG_871X("update pbuddy_adapter's beacon\n"); -+ -+ update_beacon(pbuddy_adapter, 0, NULL, true); -+ } -+ else if (is_client_associated_to_ap(pbuddy_adapter) == true) -+ { -+ if((pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) && -+ (pmlmeext->cur_bwmode == CHANNEL_WIDTH_20)) -+ { -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ } -+ -+ issue_nulldata(pbuddy_adapter, NULL, 0, 0, 0); -+ } -+ } -+} -+ -+sint dc_check_fwstate(_adapter *padapter, sint fw_state) -+{ -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_priv *pbuddy_mlmepriv = NULL; -+ -+ if(padapter->pbuddy_adapter != NULL && -+ padapter->DualMacConcurrent == true) -+ -+ { -+ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+ -+ return check_fwstate(pbuddy_mlmepriv, fw_state); -+ } -+ -+ return false; -+} -+ -+u8 dc_handle_site_survey(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ -+ // only mac0 can do scan request, help issue nulldata(1) for mac1 -+ if(pbuddy_adapter != NULL && -+ padapter->DualMacConcurrent == true) -+ { -+ if (is_client_associated_to_ap(pbuddy_adapter) == true) -+ { -+ pmlmeext->sitesurvey_res.state = SCAN_TXNULL; -+ -+ issue_nulldata(pbuddy_adapter, NULL, 1, 2, 0); -+ -+ return true; -+ } -+ } -+ -+ return false; -+} -+ -+void dc_report_survey_event(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ if(padapter->pbuddy_adapter != NULL && -+ padapter->DualMacConcurrent == true) -+ { -+ report_survey_event(padapter->pbuddy_adapter, precv_frame); -+ } -+} -+ -+void dc_set_channel_bwmode_survey_done(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_priv *pbuddy_mlmepriv = NULL; -+ struct mlme_ext_priv *pbuddy_mlmeext = NULL; -+ struct mlme_ext_info *pbuddy_mlmeinfo = NULL; -+ u8 cur_channel; -+ u8 cur_bwmode; -+ u8 cur_ch_offset; -+ -+ if(pbuddy_adapter != NULL && -+ padapter->DualMacConcurrent == true) -+ { -+ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ pbuddy_mlmeinfo = &(pbuddy_mlmeext->mlmext_info); -+ -+ if(check_fwstate(pbuddy_mlmepriv, _FW_LINKED)) -+ { -+ if(check_fwstate(pmlmepriv, _FW_LINKED) && -+ (pmlmeext->cur_bwmode == CHANNEL_WIDTH_40)) -+ { -+ cur_channel = pmlmeext->cur_channel; -+ cur_bwmode = pmlmeext->cur_bwmode; -+ cur_ch_offset = pmlmeext->cur_ch_offset; -+ } -+ else -+ { -+ cur_channel = pbuddy_mlmeext->cur_channel; -+ cur_bwmode = pbuddy_mlmeext->cur_bwmode; -+ cur_ch_offset = pbuddy_mlmeext->cur_ch_offset; -+ } -+ } -+ else -+ { -+ cur_channel = pmlmeext->cur_channel; -+ cur_bwmode = pmlmeext->cur_bwmode; -+ cur_ch_offset = pmlmeext->cur_ch_offset; -+ } -+ -+ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+ -+ if (is_client_associated_to_ap(pbuddy_adapter) == true) -+ { -+ //issue null data -+ issue_nulldata(pbuddy_adapter, NULL, 0, 0, 0); -+ } -+ -+ if(((pbuddy_mlmeinfo->state&0x03) == WIFI_FW_AP_STATE) && -+ check_fwstate(pbuddy_mlmepriv, _FW_LINKED)) -+ { -+ -+ DBG_871X("survey done, current CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset); -+ -+ DBG_871X("restart pbuddy_adapter's beacon\n"); -+ -+ update_beacon(pbuddy_adapter, 0, NULL, true); -+ } -+ } -+ else -+ { -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ } -+} -+ -+void dc_set_ap_channel_bandwidth(_adapter *padapter, u8 channel, u8 channel_offset, u8 bwmode) -+{ -+ u8 *p; -+ u8 val8, cur_channel, cur_bwmode, cur_ch_offset, change_band; -+ int ie_len; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct HT_info_element *pht_info=NULL; -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_priv *pbuddy_mlmepriv = NULL; -+ struct mlme_ext_priv *pbuddy_mlmeext = NULL; -+ -+ DBG_871X("dualmac_concurrent_ap_set_channel_bwmode ==>\n"); -+ -+ cur_channel = channel; -+ cur_bwmode = bwmode; -+ cur_ch_offset = channel_offset; -+ change_band = false; -+ -+ p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if( p && ie_len) -+ { -+ pht_info = (struct HT_info_element *)(p+2); -+ } -+ -+ if(pbuddy_adapter != NULL && -+ padapter->DualMacConcurrent == true) -+ { -+ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ if(!check_fwstate(pbuddy_mlmepriv, _FW_LINKED|_FW_UNDER_LINKING|_FW_UNDER_SURVEY)) -+ { -+ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+ } -+ else if(check_fwstate(pbuddy_mlmepriv, _FW_LINKED)==true) -+ { -+ //To sync cur_channel/cur_bwmode/cur_ch_offset with another adapter -+ DBG_871X("Another iface is at linked state, sync cur_channel/cur_bwmode/cur_ch_offset\n"); -+ DBG_871X("Another adapter, CH=%d, BW=%d, offset=%d\n", pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_bwmode, pbuddy_mlmeext->cur_ch_offset); -+ DBG_871X("Current adapter, CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset); -+ -+ cur_channel = pbuddy_mlmeext->cur_channel; -+ if(cur_bwmode == CHANNEL_WIDTH_40) -+ { -+ if(pht_info) -+ pht_info->infos[0] &= ~(BIT(0)|BIT(1)); -+ -+ if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) -+ { -+ cur_ch_offset = pbuddy_mlmeext->cur_ch_offset; -+ -+ //to update cur_ch_offset value in beacon -+ if(pht_info) -+ { -+ switch(cur_ch_offset) -+ { -+ case HAL_PRIME_CHNL_OFFSET_LOWER: -+ pht_info->infos[0] |= 0x1; -+ break; -+ case HAL_PRIME_CHNL_OFFSET_UPPER: -+ pht_info->infos[0] |= 0x3; -+ break; -+ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: -+ default: -+ break; -+ } -+ } -+ } -+ else if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_20) -+ { -+ cur_bwmode = CHANNEL_WIDTH_20; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if(cur_channel>0 && cur_channel<5) -+ { -+ if(pht_info) -+ pht_info->infos[0] |= 0x1; -+ -+ cur_bwmode = CHANNEL_WIDTH_40; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ } -+ -+ if(cur_channel>7 && cur_channel<(14+1)) -+ { -+ if(pht_info) -+ pht_info->infos[0] |= 0x3; -+ -+ cur_bwmode = CHANNEL_WIDTH_40; -+ cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ } -+ -+ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+ } -+ } -+ -+ // to update channel value in beacon -+ pnetwork->Configuration.DSConfig = cur_channel; -+ p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if(p && ie_len>0) -+ *(p + 2) = cur_channel; -+ -+ if(pht_info) -+ pht_info->primary_channel = cur_channel; -+ } -+ } -+ else -+ { -+ set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); -+ } -+ -+ DBG_871X("CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset); -+ -+ if((channel <= 14 && cur_channel >= 36) || -+ (channel >= 36 && cur_channel <= 14)) -+ { -+ change_band = true; -+ } -+ -+ pmlmeext->cur_channel = cur_channel; -+ pmlmeext->cur_bwmode = cur_bwmode; -+ pmlmeext->cur_ch_offset = cur_ch_offset; -+ -+ if(change_band == true) -+ change_band_update_ie(padapter, pnetwork); -+ -+ DBG_871X("dualmac_concurrent_ap_set_channel_bwmode <==\n"); -+} -+ -+void dc_resume_xmit(_adapter *padapter) -+{ -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ -+ if(pbuddy_adapter != NULL && -+ padapter->DualMacConcurrent == true) -+ { -+ DBG_871X("dc_resume_xmit, resume pbuddy_adapter Tx\n"); -+ rtw_os_xmit_schedule(pbuddy_adapter); -+ } -+} -+ -+u8 dc_check_xmit(_adapter *padapter) -+{ -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_priv *pbuddy_mlmepriv = NULL; -+ -+ if(pbuddy_adapter != NULL && -+ padapter->DualMacConcurrent == true) -+ { -+ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+ if (check_fwstate(pbuddy_mlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) -+ { -+ DBG_871X("dc_check_xmit pbuddy_adapter is under survey or under linking\n"); -+ return false; -+ } -+ } -+ -+ return true; -+} -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+sint check_buddy_mlmeinfo_state(_adapter *padapter, u32 state) -+{ -+ PADAPTER pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext; -+ struct mlme_ext_info *pbuddy_mlmeinfo; -+ -+ if(padapter == NULL) -+ return false; -+ -+ pbuddy_adapter = padapter->pbuddy_adapter; -+ -+ if(pbuddy_adapter == NULL) -+ return false; -+ -+ -+ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ pbuddy_mlmeinfo = &(pbuddy_mlmeext->mlmext_info); -+ -+ if((pbuddy_mlmeinfo->state&0x03) == state) -+ return true; -+ -+ return false; -+ -+} -+ -+int concurrent_chk_start_clnt_join(_adapter *padapter) -+{ -+ int ret = _FAIL; -+ PADAPTER pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext; -+ struct mlme_ext_info *pbuddy_pmlmeinfo; -+ struct mlme_priv *pbuddy_mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ unsigned char cur_ch = pmlmeext->cur_channel; -+ unsigned char cur_bw = pmlmeext->cur_bwmode; -+ unsigned char cur_ch_offset = pmlmeext->cur_ch_offset; -+ -+ if(!rtw_buddy_adapter_up(padapter)) -+ { -+ goto start_join_set_ch_bw; -+ } -+ -+ pbuddy_adapter = padapter->pbuddy_adapter; -+ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ pbuddy_pmlmeinfo = &(pbuddy_mlmeext->mlmext_info); -+ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+ -+ if((pbuddy_pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)//for AP MODE -+ { -+ bool inform_ch_switch = false; -+ if(pmlmeext->cur_channel != pbuddy_mlmeext->cur_channel) -+ { -+ inform_ch_switch = true; -+ } -+ else if((pmlmeext->cur_bwmode == CHANNEL_WIDTH_40) && -+ (pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) && -+ (pmlmeext->cur_ch_offset != pbuddy_mlmeext->cur_ch_offset)) -+ { -+ inform_ch_switch = true; -+ } -+ else if((pmlmeext->cur_bwmode == CHANNEL_WIDTH_20) && -+ (pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40)) -+ { -+ inform_ch_switch = false; -+ cur_ch = pmlmeext->cur_channel; -+ cur_bw = pbuddy_mlmeext->cur_bwmode; -+ cur_ch_offset = pbuddy_mlmeext->cur_ch_offset; -+ } -+ -+ -+ if (inform_ch_switch) { -+ #ifdef CONFIG_SPCT_CH_SWITCH -+ if (1) { -+ rtw_ap_inform_ch_switch(pbuddy_adapter, pmlmeext->cur_channel , pmlmeext->cur_ch_offset); -+ } else -+ #endif -+ { -+ //issue deauth to all stas if if2 is at ap mode -+ rtw_sta_flush(pbuddy_adapter); -+ } -+ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); -+ } -+ } -+ else if(check_fwstate(pbuddy_mlmepriv, _FW_LINKED) == true && -+ check_fwstate(pbuddy_mlmepriv, WIFI_STATION_STATE) == true) //for Client Mode/p2p client -+ { -+#if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) -+ struct wifidirect_info *pbuddy_wdinfo = &(pbuddy_adapter->wdinfo); -+ if(!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE) && pbuddy_wdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ goto start_join_set_ch_bw;//wlan0-sta mode has higher priority than p2p0-p2p client -+ } -+#endif //CONFIG_P2P && CONFIG_IOCTL_CFG80211 -+ -+ if(pmlmeext->cur_channel != pbuddy_mlmeext->cur_channel) -+ { -+ DBG_871X("start_clnt_join(ch=%d), but channel mismatch with buddy(ch=%d) interface\n", -+ pmlmeext->cur_channel, pbuddy_mlmeext->cur_channel); -+ -+ report_join_res(padapter, (-4)); -+ -+ return ret; -+ } -+ -+ if((pmlmeext->cur_bwmode == CHANNEL_WIDTH_40) && -+ (pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) && -+ (pmlmeext->cur_ch_offset != pbuddy_mlmeext->cur_ch_offset)) -+ { -+ DBG_871X("start_clnt_join(bwmode=%d, ch_offset=%d), but bwmode & ch_offset mismatch with buddy(bwmode=%d, ch_offset=%d) interface\n", -+ pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode, pbuddy_mlmeext->cur_ch_offset); -+ -+ report_join_res(padapter, (-4)); -+ -+ return ret; -+ } -+ -+ } -+ -+ -+start_join_set_ch_bw: -+ -+ set_channel_bwmode(padapter, cur_ch, cur_ch_offset, cur_bw); -+ -+ return _SUCCESS; -+ -+} -+ -+void concurrent_chk_joinbss_done(_adapter *padapter, int join_res) -+{ -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ PADAPTER pbuddy_adapter; -+ struct mlme_priv *pbuddy_mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext; -+ struct mlme_ext_info *pbuddy_mlmeinfo; -+ WLAN_BSSID_EX *pbuddy_network_mlmeext; -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ if(!rtw_buddy_adapter_up(padapter)) -+ { -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ return; -+ } -+ -+ pbuddy_adapter = padapter->pbuddy_adapter; -+ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ pbuddy_mlmeinfo = &(pbuddy_mlmeext->mlmext_info); -+ pbuddy_network_mlmeext = &(pbuddy_mlmeinfo->network); -+ -+ if(((pbuddy_mlmeinfo->state&0x03) == WIFI_FW_AP_STATE) && -+ check_fwstate(pbuddy_mlmepriv, _FW_LINKED)) -+ { -+ //restart and update beacon -+ -+ DBG_871X("after join,primary adapter, CH=%d, BW=%d, offset=%d\n" -+ , pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ -+ -+ if(join_res >= 0) -+ { -+ u8 *p; -+ int ie_len; -+ u8 change_band = false; -+ struct HT_info_element *pht_info=NULL; -+ -+ if((pmlmeext->cur_channel <= 14 && pbuddy_mlmeext->cur_channel >= 36) || -+ (pmlmeext->cur_channel >= 36 && pbuddy_mlmeext->cur_channel <= 14)) -+ change_band = true; -+ -+ //sync channel/bwmode/ch_offset with primary adapter -+ pbuddy_mlmeext->cur_channel = pmlmeext->cur_channel; -+ if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) -+ { -+ p = rtw_get_ie((pbuddy_network_mlmeext->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pbuddy_network_mlmeext->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if( p && ie_len) -+ { -+ pht_info = (struct HT_info_element *)(p+2); -+ pht_info->infos[0] &= ~(BIT(0)|BIT(1)); //no secondary channel is present -+ } -+ -+ if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40) -+ { -+ pbuddy_mlmeext->cur_ch_offset = pmlmeext->cur_ch_offset; -+ -+ //to update cur_ch_offset value in beacon -+ if( pht_info ) -+ { -+ switch(pmlmeext->cur_ch_offset) -+ { -+ case HAL_PRIME_CHNL_OFFSET_LOWER: -+ pht_info->infos[0] |= 0x1; -+ break; -+ case HAL_PRIME_CHNL_OFFSET_UPPER: -+ pht_info->infos[0] |= 0x3; -+ break; -+ case HAL_PRIME_CHNL_OFFSET_DONT_CARE: -+ default: -+ break; -+ } -+ -+ } -+ -+ } -+ else if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_20) -+ { -+ if(pmlmeext->cur_channel>=1 && pmlmeext->cur_channel<=4) -+ { -+ if(pht_info) -+ pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE; -+ -+ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_40; -+ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ } -+ else if(pmlmeext->cur_channel>=5 && pmlmeext->cur_channel<=14) -+ { -+ if(pht_info) -+ pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW; -+ -+ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_40; -+ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ } -+ else -+ { -+ switch(pmlmeext->cur_channel) -+ { -+ case 36: -+ case 44: -+ case 52: -+ case 60: -+ case 100: -+ case 108: -+ case 116: -+ case 124: -+ case 132: -+ case 149: -+ case 157: -+ { -+ if(pht_info) -+ pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE; -+ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_40; -+ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ } -+ case 40: -+ case 48: -+ case 56: -+ case 64: -+ case 104: -+ case 112: -+ case 120: -+ case 128: -+ case 136: -+ case 153: -+ case 161: -+ { -+ if(pht_info) -+ pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW; -+ -+ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_40; -+ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ } -+ default: -+ if(pht_info) -+ pht_info->infos[0] &= ~HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW; -+ pbuddy_mlmeext->cur_bwmode = CHANNEL_WIDTH_20; -+ pbuddy_mlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ -+ } -+ -+ } -+ -+ } -+ -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ -+ } -+ else -+ { -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ } -+ -+ -+ // to update channel value in beacon -+ pbuddy_network_mlmeext->Configuration.DSConfig = pmlmeext->cur_channel; -+ p = rtw_get_ie((pbuddy_network_mlmeext->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (pbuddy_network_mlmeext->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if(p && ie_len>0) -+ *(p + 2) = pmlmeext->cur_channel; -+ -+ p = rtw_get_ie((pbuddy_network_mlmeext->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pbuddy_network_mlmeext->IELength - sizeof(NDIS_802_11_FIXED_IEs))); -+ if( p && ie_len) -+ { -+ pht_info = (struct HT_info_element *)(p+2); -+ pht_info->primary_channel = pmlmeext->cur_channel; -+ } -+ -+ //buddy interface band is different from current interface, update ERP, support rate, ext support rate IE -+ if(change_band == true) -+ change_band_update_ie(pbuddy_adapter, pbuddy_network_mlmeext); -+ } -+ else -+ { -+ // switch back to original channel/bwmode/ch_offset; -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ } -+ -+ DBG_871X("after join, second adapter, CH=%d, BW=%d, offset=%d\n", pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_bwmode, pbuddy_mlmeext->cur_ch_offset); -+ -+ DBG_871X("update pbuddy_adapter's beacon\n"); -+ -+ update_beacon(pbuddy_adapter, 0, NULL, true); -+ -+ } -+ else if(((pbuddy_mlmeinfo->state&0x03) == WIFI_FW_STATION_STATE) && -+ check_fwstate(pbuddy_mlmepriv, _FW_LINKED)) -+ { -+ if(join_res >= 0) -+ { -+ pbuddy_mlmeext->cur_channel = pmlmeext->cur_channel; -+ if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40) -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ else if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40) -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ else -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ else -+ { -+ // switch back to original channel/bwmode/ch_offset; -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ } -+ } -+ else -+ { -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ } -+ -+} -+#endif //CONFIG_CONCURRENT_MODE -+ -+u8 set_ch_hdl(_adapter *padapter, u8 *pbuf) -+{ -+ struct set_ch_parm *set_ch_parm; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if(!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ set_ch_parm = (struct set_ch_parm *)pbuf; -+ -+ DBG_871X(FUNC_NDEV_FMT" ch:%u, bw:%u, ch_offset:%u\n", -+ FUNC_NDEV_ARG(padapter->pnetdev), -+ set_ch_parm->ch, set_ch_parm->bw, set_ch_parm->ch_offset); -+ -+ pmlmeext->cur_channel = set_ch_parm->ch; -+ pmlmeext->cur_ch_offset = set_ch_parm->ch_offset; -+ pmlmeext->cur_bwmode = set_ch_parm->bw; -+ -+ set_channel_bwmode(padapter, set_ch_parm->ch, set_ch_parm->ch_offset, set_ch_parm->bw); -+ -+ return H2C_SUCCESS; -+} -+ -+u8 set_chplan_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct SetChannelPlan_param *setChannelPlan_param; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if(!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ setChannelPlan_param = (struct SetChannelPlan_param *)pbuf; -+ -+ pmlmeext->max_chan_nums = init_channel_set(padapter, setChannelPlan_param->channel_plan, pmlmeext->channel_set); -+ init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); -+ -+ return H2C_SUCCESS; -+} -+ -+u8 led_blink_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ struct LedBlink_param *ledBlink_param; -+ -+ if(!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ ledBlink_param = (struct LedBlink_param *)pbuf; -+ -+ #ifdef CONFIG_LED_HANDLED_BY_CMD_THREAD -+ BlinkHandler((PLED_DATA)ledBlink_param->pLed); -+ #endif -+ -+ return H2C_SUCCESS; -+} -+ -+u8 set_csa_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+#ifdef CONFIG_DFS -+ struct SetChannelSwitch_param *setChannelSwitch_param; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ u8 new_ch_no; -+ u8 gval8 = 0x00, sval8 = 0xff; -+ -+ if(!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ setChannelSwitch_param = (struct SetChannelSwitch_param *)pbuf; -+ new_ch_no = setChannelSwitch_param->new_ch_no; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_TXPAUSE, &gval8); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &sval8); -+ -+ DBG_871X("DFS detected! Swiching channel to %d!\n", new_ch_no); -+ SelectChannel(padapter, new_ch_no); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &gval8); -+ -+ rtw_free_network_queue(padapter, true); -+ rtw_indicate_disconnect(padapter); -+ -+ if ( ((new_ch_no >= 52) && (new_ch_no <= 64)) ||((new_ch_no >= 100) && (new_ch_no <= 140)) ) { -+ DBG_871X("Switched to DFS band (ch %02x) again!!\n", new_ch_no); -+ } -+ -+ return H2C_SUCCESS; -+#else -+ return H2C_REJECTED; -+#endif //CONFIG_DFS -+ -+} -+ -+// TDLS_WRCR : write RCR DATA BIT -+// TDLS_SD_PTI : issue peer traffic indication -+// TDLS_CS_OFF : go back to the channel linked with AP, terminating channel switch procedure -+// TDLS_INIT_CH_SEN : init channel sensing, receive all data and mgnt frame -+// TDLS_DONE_CH_SEN: channel sensing and report candidate channel -+// TDLS_OFF_CH : first time set channel to off channel -+// TDLS_BASE_CH : go back tp the channel linked with AP when set base channel as target channel -+// TDLS_P_OFF_CH : periodically go to off channel -+// TDLS_P_BASE_CH : periodically go back to base channel -+// TDLS_RS_RCR : restore RCR -+// TDLS_CKALV_PH1 : check alive timer phase1 -+// TDLS_CKALV_PH2 : check alive timer phase2 -+// TDLS_FREE_STA : free tdls sta -+u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+#ifdef CONFIG_TDLS -+ _irqL irqL; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct TDLSoption_param *TDLSoption; -+ struct sta_info *ptdls_sta; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ u8 survey_channel, i, min, option; -+ -+ if(!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ TDLSoption = (struct TDLSoption_param *)pbuf; -+ -+ ptdls_sta = rtw_get_stainfo( &(padapter->stapriv), TDLSoption->addr ); -+ option = TDLSoption->option; -+ -+ if( ptdls_sta == NULL ) -+ { -+ if( option != TDLS_RS_RCR ) -+ return H2C_REJECTED; -+ } -+ -+ //_enter_critical_bh(&(ptdlsinfo->hdl_lock), &irqL); -+ DBG_871X("[%s] option:%d\n", __FUNCTION__, option); -+ -+ switch(option){ -+ case TDLS_WRCR: -+ //As long as TDLS handshake success, we should set RCR_CBSSID_DATA bit to 0 -+ //such we can receive all kinds of data frames. -+ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_WRCR, 0); -+ DBG_871X("TDLS with "MAC_FMT"\n", MAC_ARG(ptdls_sta->hwaddr)); -+ -+ pmlmeinfo->FW_sta_info[ptdls_sta->mac_id].psta = ptdls_sta; -+ //set TDLS sta rate. -+ set_sta_rate(padapter, ptdls_sta); -+ break; -+ case TDLS_SD_PTI: -+ issue_tdls_peer_traffic_indication(padapter, ptdls_sta); -+ break; -+ case TDLS_CS_OFF: -+ _cancel_timer_ex(&ptdls_sta->base_ch_timer); -+ _cancel_timer_ex(&ptdls_sta->off_ch_timer); -+ SelectChannel(padapter, pmlmeext->cur_channel); -+ ptdls_sta->tdls_sta_state &= ~(TDLS_CH_SWITCH_ON_STATE | -+ TDLS_PEER_AT_OFF_STATE | -+ TDLS_AT_OFF_CH_STATE); -+ DBG_871X("go back to base channel\n "); -+ issue_nulldata(padapter, NULL, 0, 0, 0); -+ break; -+ case TDLS_INIT_CH_SEN: -+ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_INIT_CH_SEN, 0); -+ pmlmeext->sitesurvey_res.channel_idx = 0; -+ ptdls_sta->option = TDLS_DONE_CH_SEN; -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_DONE_CH_SEN); -+ break; -+ case TDLS_DONE_CH_SEN: -+ survey_channel = pmlmeext->channel_set[pmlmeext->sitesurvey_res.channel_idx].ChannelNum; -+ if(survey_channel){ -+ SelectChannel(padapter, survey_channel); -+ ptdlsinfo->cur_channel = survey_channel; -+ pmlmeext->sitesurvey_res.channel_idx++; -+ _set_timer(&ptdls_sta->option_timer, SURVEY_TO); -+ }else{ -+ SelectChannel(padapter, pmlmeext->cur_channel); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_DONE_CH_SEN, 0); -+ -+ if(ptdlsinfo->ch_sensing==1){ -+ ptdlsinfo->ch_sensing=0; -+ ptdlsinfo->cur_channel=1; -+ min=ptdlsinfo->collect_pkt_num[0]; -+ for(i=1; i ptdlsinfo->collect_pkt_num[i]){ -+ ptdlsinfo->cur_channel=i+1; -+ min=ptdlsinfo->collect_pkt_num[i]; -+ } -+ ptdlsinfo->collect_pkt_num[i]=0; -+ } -+ ptdlsinfo->collect_pkt_num[0]=0; -+ ptdlsinfo->candidate_ch=ptdlsinfo->cur_channel; -+ DBG_871X("TDLS channel sensing done, candidate channel: %02x\n", ptdlsinfo->candidate_ch); -+ ptdlsinfo->cur_channel=0; -+ -+ } -+ -+ if(ptdls_sta->tdls_sta_state & TDLS_PEER_SLEEP_STATE){ -+ ptdls_sta->tdls_sta_state |= TDLS_APSD_CHSW_STATE; -+ }else{ -+ //send null data with pwrbit==1 before send ch_switching_req to peer STA. -+ issue_nulldata(padapter, NULL, 1, 0, 0); -+ -+ ptdls_sta->tdls_sta_state |= TDLS_CH_SW_INITIATOR_STATE; -+ -+ issue_tdls_ch_switch_req(padapter, ptdls_sta->hwaddr); -+ DBG_871X("issue tdls ch switch req\n"); -+ } -+ } -+ break; -+ case TDLS_OFF_CH: -+ issue_nulldata(padapter, NULL, 1, 0, 0); -+ SelectChannel(padapter, ptdls_sta->off_ch); -+ -+ DBG_871X("change channel to tar ch:%02x\n", ptdls_sta->off_ch); -+ ptdls_sta->tdls_sta_state |= TDLS_AT_OFF_CH_STATE; -+ ptdls_sta->tdls_sta_state &= ~(TDLS_PEER_AT_OFF_STATE); -+ _set_timer(&ptdls_sta->option_timer, (u32)ptdls_sta->ch_switch_time); -+ break; -+ case TDLS_BASE_CH: -+ _cancel_timer_ex(&ptdls_sta->base_ch_timer); -+ _cancel_timer_ex(&ptdls_sta->off_ch_timer); -+ SelectChannel(padapter, pmlmeext->cur_channel); -+ ptdls_sta->tdls_sta_state &= ~(TDLS_CH_SWITCH_ON_STATE | -+ TDLS_PEER_AT_OFF_STATE | -+ TDLS_AT_OFF_CH_STATE); -+ DBG_871X("go back to base channel\n "); -+ issue_nulldata(padapter, NULL, 0, 0, 0); -+ _set_timer(&ptdls_sta->option_timer, (u32)ptdls_sta->ch_switch_time); -+ break; -+ case TDLS_P_OFF_CH: -+ SelectChannel(padapter, pmlmeext->cur_channel); -+ issue_nulldata(padapter, NULL, 0, 0, 0); -+ DBG_871X("change channel to base ch:%02x\n", pmlmeext->cur_channel); -+ ptdls_sta->tdls_sta_state &= ~(TDLS_PEER_AT_OFF_STATE| TDLS_AT_OFF_CH_STATE); -+ _set_timer(&ptdls_sta->off_ch_timer, TDLS_STAY_TIME); -+ break; -+ case TDLS_P_BASE_CH: -+ issue_nulldata(ptdls_sta->padapter, NULL, 1, 0, 0); -+ SelectChannel(padapter, ptdls_sta->off_ch); -+ DBG_871X("change channel to off ch:%02x\n", ptdls_sta->off_ch); -+ ptdls_sta->tdls_sta_state |= TDLS_AT_OFF_CH_STATE; -+ if((ptdls_sta->tdls_sta_state & TDLS_PEER_AT_OFF_STATE) != TDLS_PEER_AT_OFF_STATE){ -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta, 0); -+ } -+ _set_timer(&ptdls_sta->base_ch_timer, TDLS_STAY_TIME); -+ break; -+ case TDLS_RS_RCR: -+ rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_RS_RCR, 0); -+ DBG_871X("wirte REG_RCR, set bit6 on\n"); -+ break; -+ case TDLS_CKALV_PH1: -+ _set_timer(&ptdls_sta->alive_timer2, TDLS_ALIVE_TIMER_PH2); -+ break; -+ case TDLS_CKALV_PH2: -+ _set_timer(&ptdls_sta->alive_timer1, TDLS_ALIVE_TIMER_PH1); -+ break; -+ case TDLS_FREE_STA: -+ free_tdls_sta(padapter, ptdls_sta); -+ break; -+ -+ } -+ -+ //_exit_critical_bh(&(ptdlsinfo->hdl_lock), &irqL); -+ -+ return H2C_SUCCESS; -+#else -+ return H2C_REJECTED; -+#endif //CONFIG_TDLS -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_mp.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mp.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_mp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mp.c 2018-02-06 17:42:30.697966972 +0200 -@@ -0,0 +1,1642 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_MP_C_ -+ -+#include -+ -+#include "../hal/odm_precomp.h" -+ -+#ifdef CONFIG_MP_INCLUDED -+ -+u32 read_macreg(_adapter *padapter, u32 addr, u32 sz) -+{ -+ u32 val = 0; -+ -+ switch(sz) -+ { -+ case 1: -+ val = rtw_read8(padapter, addr); -+ break; -+ case 2: -+ val = rtw_read16(padapter, addr); -+ break; -+ case 4: -+ val = rtw_read32(padapter, addr); -+ break; -+ default: -+ val = 0xffffffff; -+ break; -+ } -+ -+ return val; -+ -+} -+ -+void write_macreg(_adapter *padapter, u32 addr, u32 val, u32 sz) -+{ -+ switch(sz) -+ { -+ case 1: -+ rtw_write8(padapter, addr, (u8)val); -+ break; -+ case 2: -+ rtw_write16(padapter, addr, (u16)val); -+ break; -+ case 4: -+ rtw_write32(padapter, addr, val); -+ break; -+ default: -+ break; -+ } -+ -+} -+ -+u32 read_bbreg(_adapter *padapter, u32 addr, u32 bitmask) -+{ -+ return rtw_hal_read_bbreg(padapter, addr, bitmask); -+} -+ -+void write_bbreg(_adapter *padapter, u32 addr, u32 bitmask, u32 val) -+{ -+ rtw_hal_write_bbreg(padapter, addr, bitmask, val); -+} -+ -+u32 _read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask) -+{ -+ return rtw_hal_read_rfreg(padapter, rfpath, addr, bitmask); -+} -+ -+void _write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask, u32 val) -+{ -+ rtw_hal_write_rfreg(padapter, rfpath, addr, bitmask, val); -+} -+ -+u32 read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr) -+{ -+ return _read_rfreg(padapter, rfpath, addr, bRFRegOffsetMask); -+} -+ -+void write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 val) -+{ -+ _write_rfreg(padapter, rfpath, addr, bRFRegOffsetMask, val); -+} -+ -+static void _init_mp_priv_(struct mp_priv *pmp_priv) -+{ -+ WLAN_BSSID_EX *pnetwork; -+ -+ _rtw_memset(pmp_priv, 0, sizeof(struct mp_priv)); -+ -+ pmp_priv->mode = MP_OFF; -+ -+ pmp_priv->channel = 1; -+ pmp_priv->bandwidth = CHANNEL_WIDTH_20; -+ pmp_priv->prime_channel_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ pmp_priv->rateidx = MPT_RATE_1M; -+ pmp_priv->txpoweridx = 0x2A; -+ -+ pmp_priv->antenna_tx = ANTENNA_A; -+ pmp_priv->antenna_rx = ANTENNA_AB; -+ -+ pmp_priv->check_mp_pkt = 0; -+ -+ pmp_priv->tx_pktcount = 0; -+ -+ pmp_priv->rx_pktcount = 0; -+ pmp_priv->rx_crcerrpktcount = 0; -+ -+ pmp_priv->network_macaddr[0] = 0x00; -+ pmp_priv->network_macaddr[1] = 0xE0; -+ pmp_priv->network_macaddr[2] = 0x4C; -+ pmp_priv->network_macaddr[3] = 0x87; -+ pmp_priv->network_macaddr[4] = 0x66; -+ pmp_priv->network_macaddr[5] = 0x55; -+ -+ pnetwork = &pmp_priv->mp_network.network; -+ _rtw_memcpy(pnetwork->MacAddress, pmp_priv->network_macaddr, ETH_ALEN); -+ -+ pnetwork->Ssid.SsidLength = 8; -+ _rtw_memcpy(pnetwork->Ssid.Ssid, "mp_871x", pnetwork->Ssid.SsidLength); -+} -+ -+static int init_mp_priv_by_os(struct mp_priv *pmp_priv) -+{ -+ int i, res; -+ struct mp_xmit_frame *pmp_xmitframe; -+ -+ if (pmp_priv == NULL) return _FAIL; -+ -+ _rtw_init_queue(&pmp_priv->free_mp_xmitqueue); -+ -+ pmp_priv->pallocated_mp_xmitframe_buf = NULL; -+ pmp_priv->pallocated_mp_xmitframe_buf = rtw_zmalloc(NR_MP_XMITFRAME * sizeof(struct mp_xmit_frame) + 4); -+ if (pmp_priv->pallocated_mp_xmitframe_buf == NULL) { -+ res = _FAIL; -+ goto _exit_init_mp_priv; -+ } -+ -+ pmp_priv->pmp_xmtframe_buf = pmp_priv->pallocated_mp_xmitframe_buf + 4 - ((SIZE_PTR) (pmp_priv->pallocated_mp_xmitframe_buf) & 3); -+ -+ pmp_xmitframe = (struct mp_xmit_frame*)pmp_priv->pmp_xmtframe_buf; -+ -+ for (i = 0; i < NR_MP_XMITFRAME; i++) -+ { -+ _rtw_init_listhead(&pmp_xmitframe->list); -+ rtw_list_insert_tail(&pmp_xmitframe->list, &pmp_priv->free_mp_xmitqueue.queue); -+ -+ pmp_xmitframe->pkt = NULL; -+ pmp_xmitframe->frame_tag = MP_FRAMETAG; -+ pmp_xmitframe->padapter = pmp_priv->papdater; -+ -+ pmp_xmitframe++; -+ } -+ -+ pmp_priv->free_mp_xmitframe_cnt = NR_MP_XMITFRAME; -+ -+ res = _SUCCESS; -+ -+_exit_init_mp_priv: -+ -+ return res; -+} -+ -+static void mp_init_xmit_attrib(struct mp_tx *pmptx, PADAPTER padapter) -+{ -+ struct pkt_attrib *pattrib; -+ struct tx_desc *desc; -+ -+ // init xmitframe attribute -+ pattrib = &pmptx->attrib; -+ _rtw_memset(pattrib, 0, sizeof(struct pkt_attrib)); -+ desc = &pmptx->desc; -+ _rtw_memset(desc, 0, TXDESC_SIZE); -+ -+ pattrib->ether_type = 0x8712; -+ //_rtw_memcpy(pattrib->src, padapter->eeprompriv.mac_addr, ETH_ALEN); -+// _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ _rtw_memset(pattrib->dst, 0xFF, ETH_ALEN); -+ -+// pattrib->dhcp_pkt = 0; -+// pattrib->pktlen = 0; -+ pattrib->ack_policy = 0; -+// pattrib->pkt_hdrlen = ETH_HLEN; -+ pattrib->hdrlen = WLAN_HDR_A3_LEN; -+ pattrib->subtype = WIFI_DATA; -+ pattrib->priority = 0; -+ pattrib->qsel = pattrib->priority; -+// do_queue_select(padapter, pattrib); -+ pattrib->nr_frags = 1; -+ pattrib->encrypt = 0; -+ pattrib->bswenc = false; -+ pattrib->qos_en = false; -+} -+ -+s32 init_mp_priv(PADAPTER padapter) -+{ -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ -+ _init_mp_priv_(pmppriv); -+ pmppriv->papdater = padapter; -+ -+ pmppriv->tx.stop = 1; -+ mp_init_xmit_attrib(&pmppriv->tx, padapter); -+ -+ switch (padapter->registrypriv.rf_config) { -+ case RF_1T1R: -+ pmppriv->antenna_tx = ANTENNA_A; -+ pmppriv->antenna_rx = ANTENNA_A; -+ break; -+ case RF_1T2R: -+ default: -+ pmppriv->antenna_tx = ANTENNA_A; -+ pmppriv->antenna_rx = ANTENNA_AB; -+ break; -+ case RF_2T2R: -+ case RF_2T2R_GREEN: -+ pmppriv->antenna_tx = ANTENNA_AB; -+ pmppriv->antenna_rx = ANTENNA_AB; -+ break; -+ case RF_2T4R: -+ pmppriv->antenna_tx = ANTENNA_AB; -+ pmppriv->antenna_rx = ANTENNA_ABCD; -+ break; -+ } -+ -+ return _SUCCESS; -+} -+ -+void free_mp_priv(struct mp_priv *pmp_priv) -+{ -+ if (pmp_priv->pallocated_mp_xmitframe_buf) { -+ rtw_mfree(pmp_priv->pallocated_mp_xmitframe_buf, 0); -+ pmp_priv->pallocated_mp_xmitframe_buf = NULL; -+ } -+ pmp_priv->pmp_xmtframe_buf = NULL; -+} -+ -+ -+static void PHY_IQCalibrate_default( -+ PADAPTER pAdapter, -+ bool bReCovery -+ ) -+{ -+ DBG_871X("%s\n", __func__); -+} -+ -+static void PHY_LCCalibrate_default( -+ PADAPTER pAdapter -+ ) -+{ -+ DBG_871X("%s\n", __func__); -+} -+ -+static void PHY_SetRFPathSwitch_default( -+ PADAPTER pAdapter, -+ bool bMain -+ ) -+{ -+ DBG_871X("%s\n", __func__); -+} -+ -+#define PHY_IQCalibrate(_Adapter, b) \ -+ IS_HARDWARE_TYPE_8812(_Adapter) ? PHY_IQCalibrate_8812A(_Adapter, b) : \ -+ IS_HARDWARE_TYPE_8821(_Adapter) ? PHY_IQCalibrate_8821A(_Adapter, b) : \ -+ PHY_IQCalibrate_default(_Adapter, b) -+ -+#define PHY_LCCalibrate(_Adapter) \ -+ IS_HARDWARE_TYPE_8812(_Adapter) ? PHY_LCCalibrate_8812A(&(GET_HAL_DATA(_Adapter)->odmpriv)) : \ -+ IS_HARDWARE_TYPE_8821(_Adapter) ? PHY_LCCalibrate_8821A(&(GET_HAL_DATA(_Adapter)->odmpriv)) : \ -+ PHY_LCCalibrate_default(_Adapter) -+ -+#define PHY_SetRFPathSwitch(_Adapter, b) \ -+ (IS_HARDWARE_TYPE_JAGUAR(_Adapter)) ? PHY_SetRFPathSwitch_8812A(_Adapter, b) : \ -+ PHY_SetRFPathSwitch_default(_Adapter, b) -+ -+s32 -+MPT_InitializeAdapter( -+ PADAPTER pAdapter, -+ u8 Channel -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ s32 rtStatus = _SUCCESS; -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; -+ u32 ledsetting; -+ struct mlme_priv *pmlmepriv = &pAdapter->mlmepriv; -+ -+ //------------------------------------------------------------------------- -+ // HW Initialization for 8190 MPT. -+ //------------------------------------------------------------------------- -+ //------------------------------------------------------------------------- -+ // SW Initialization for 8190 MP. -+ //------------------------------------------------------------------------- -+ pMptCtx->bMptDrvUnload = false; -+ pMptCtx->bMassProdTest = false; -+ pMptCtx->bMptIndexEven = true; //default gain index is -6.0db -+ pMptCtx->h2cReqNum = 0x0; -+ /* Init mpt event. */ -+#if 0 // for Windows -+ NdisInitializeEvent( &(pMptCtx->MptWorkItemEvent) ); -+ NdisAllocateSpinLock( &(pMptCtx->MptWorkItemSpinLock) ); -+ -+ PlatformInitializeWorkItem( -+ Adapter, -+ &(pMptCtx->MptWorkItem), -+ (RT_WORKITEM_CALL_BACK)MPT_WorkItemCallback, -+ (void *)Adapter, -+ "MptWorkItem"); -+#endif -+ //init for BT MP -+ -+ pMptCtx->bMptWorkItemInProgress = false; -+ pMptCtx->CurrMptAct = NULL; -+ //------------------------------------------------------------------------- -+ -+ // Don't accept any packets -+ rtw_write32(pAdapter, REG_RCR, 0); -+ -+ if(IS_HARDWARE_TYPE_8192DU(pAdapter)) -+ { -+ rtw_write32(pAdapter, REG_LEDCFG0, 0x8888); -+ } -+ else -+ { -+ //rtw_write32(pAdapter, REG_LEDCFG0, 0x08080); -+ ledsetting = rtw_read32(pAdapter, REG_LEDCFG0); -+ } -+ -+ PHY_IQCalibrate(pAdapter, false); -+ dm_CheckTXPowerTracking(&pHalData->odmpriv); //trigger thermal meter -+ PHY_LCCalibrate(pAdapter); -+ -+ pMptCtx->backup0xc50 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_XAAGCCore1, bMaskByte0); -+ pMptCtx->backup0xc58 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_XBAGCCore1, bMaskByte0); -+ pMptCtx->backup0xc30 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_RxDetector1, bMaskByte0); -+ -+ //set ant to wifi side in mp mode -+ rtw_write16(pAdapter, 0x870, 0x300); -+ rtw_write16(pAdapter, 0x860, 0x110); -+ -+ if (pAdapter->registrypriv.mp_mode == 1) -+ pmlmepriv->fw_state = WIFI_MP_STATE; -+ -+ return rtStatus; -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: MPT_DeInitAdapter() -+ * -+ * Overview: Extra DeInitialization for Mass Production Test. -+ * -+ * Input: PADAPTER pAdapter -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 05/08/2007 MHC Create Version 0. -+ * 05/18/2007 MHC Add normal driver MPHalt code. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+MPT_DeInitAdapter( -+ PADAPTER pAdapter -+ ) -+{ -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; -+ -+ pMptCtx->bMptDrvUnload = true; -+} -+ -+static u8 mpt_ProStartTest(PADAPTER padapter) -+{ -+ PMPT_CONTEXT pMptCtx = &padapter->mppriv.MptCtx; -+ -+ pMptCtx->bMassProdTest = true; -+ pMptCtx->bStartContTx = false; -+ pMptCtx->bCckContTx = false; -+ pMptCtx->bOfdmContTx = false; -+ pMptCtx->bSingleCarrier = false; -+ pMptCtx->bCarrierSuppression = false; -+ pMptCtx->bSingleTone = false; -+ -+ return _SUCCESS; -+} -+ -+/* -+ * General use -+ */ -+s32 SetPowerTracking(PADAPTER padapter, u8 enable) -+{ -+ -+ Hal_SetPowerTracking( padapter, enable ); -+ return 0; -+} -+ -+void GetPowerTracking(PADAPTER padapter, u8 *enable) -+{ -+ Hal_GetPowerTracking( padapter, enable ); -+} -+ -+static void disable_dm(PADAPTER padapter) -+{ -+ u8 v8; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ -+ -+ //3 1. disable firmware dynamic mechanism -+ // disable Power Training, Rate Adaptive -+ v8 = rtw_read8(padapter, REG_BCN_CTRL); -+ v8 &= ~EN_BCN_FUNCTION; -+ rtw_write8(padapter, REG_BCN_CTRL, v8); -+ -+ //3 2. disable driver dynamic mechanism -+ // disable Dynamic Initial Gain -+ // disable High Power -+ // disable Power Tracking -+ Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); -+ -+ // enable APK, LCK and IQK but disable power tracking -+ Switch_DM_Func(padapter, DYNAMIC_RF_CALIBRATION, true); -+} -+ -+//This function initializes the DUT to the MP test mode -+s32 mp_start_test(PADAPTER padapter) -+{ -+ WLAN_BSSID_EX bssid; -+ struct sta_info *psta; -+ u32 length; -+ u8 val8; -+ -+ _irqL irqL; -+ s32 res = _SUCCESS; -+ -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *tgt_network = &pmlmepriv->cur_network; -+ -+ padapter->registrypriv.mp_mode = 1; -+ pmppriv->bSetTxPower=0; //for manually set tx power -+ -+ //3 disable dynamic mechanism -+ disable_dm(padapter); -+ rtl8812_InitHalDm(padapter); -+ //3 0. update mp_priv -+ -+ if (padapter->registrypriv.rf_config == RF_MAX_TYPE) { -+// switch (phal->rf_type) { -+ switch (GET_RF_TYPE(padapter)) { -+ case RF_1T1R: -+ pmppriv->antenna_tx = ANTENNA_A; -+ pmppriv->antenna_rx = ANTENNA_A; -+ break; -+ case RF_1T2R: -+ default: -+ pmppriv->antenna_tx = ANTENNA_A; -+ pmppriv->antenna_rx = ANTENNA_AB; -+ break; -+ case RF_2T2R: -+ case RF_2T2R_GREEN: -+ pmppriv->antenna_tx = ANTENNA_AB; -+ pmppriv->antenna_rx = ANTENNA_AB; -+ break; -+ case RF_2T4R: -+ pmppriv->antenna_tx = ANTENNA_AB; -+ pmppriv->antenna_rx = ANTENNA_ABCD; -+ break; -+ } -+ } -+ -+ mpt_ProStartTest(padapter); -+ -+ //3 1. initialize a new WLAN_BSSID_EX -+// _rtw_memset(&bssid, 0, sizeof(WLAN_BSSID_EX)); -+ _rtw_memcpy(bssid.MacAddress, pmppriv->network_macaddr, ETH_ALEN); -+ bssid.Ssid.SsidLength = strlen("mp_pseudo_adhoc"); -+ _rtw_memcpy(bssid.Ssid.Ssid, (u8*)"mp_pseudo_adhoc", bssid.Ssid.SsidLength); -+ bssid.InfrastructureMode = Ndis802_11IBSS; -+ bssid.NetworkTypeInUse = Ndis802_11DS; -+ bssid.IELength = 0; -+ -+ length = get_WLAN_BSSID_EX_sz(&bssid); -+ if (length % 4) -+ bssid.Length = ((length >> 2) + 1) << 2; //round up to multiple of 4 bytes. -+ else -+ bssid.Length = length; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) -+ goto end_of_mp_start_test; -+ -+ //init mp_start_test status -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { -+ rtw_disassoc_cmd(padapter, 500, true); -+ rtw_indicate_disconnect(padapter); -+ rtw_free_assoc_resources(padapter, 1); -+ } -+ pmppriv->prev_fw_state = get_fwstate(pmlmepriv); -+ if (padapter->registrypriv.mp_mode == 1) -+ pmlmepriv->fw_state = WIFI_MP_STATE; -+#if 0 -+ if (pmppriv->mode == _LOOPBOOK_MODE_) { -+ set_fwstate(pmlmepriv, WIFI_MP_LPBK_STATE); //append txdesc -+ RT_TRACE(_module_mp_, _drv_notice_, ("+start mp in Lookback mode\n")); -+ } else { -+ RT_TRACE(_module_mp_, _drv_notice_, ("+start mp in normal mode\n")); -+ } -+#endif -+ set_fwstate(pmlmepriv, _FW_UNDER_LINKING); -+ -+ //3 2. create a new psta for mp driver -+ //clear psta in the cur_network, if any -+ psta = rtw_get_stainfo(&padapter->stapriv, tgt_network->network.MacAddress); -+ if (psta) rtw_free_stainfo(padapter, psta); -+ -+ psta = rtw_alloc_stainfo(&padapter->stapriv, bssid.MacAddress); -+ if (psta == NULL) { -+ RT_TRACE(_module_mp_, _drv_err_, ("mp_start_test: Can't alloc sta_info!\n")); -+ pmlmepriv->fw_state = pmppriv->prev_fw_state; -+ res = _FAIL; -+ goto end_of_mp_start_test; -+ } -+ -+ //3 3. join psudo AdHoc -+ tgt_network->join_res = 1; -+ tgt_network->aid = psta->aid = 1; -+ _rtw_memcpy(&tgt_network->network, &bssid, length); -+ -+ rtw_indicate_connect(padapter); -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -+ -+end_of_mp_start_test: -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ if (res == _SUCCESS) { -+ // set MSR to WIFI_FW_ADHOC_STATE -+ val8 = rtw_read8(padapter, MSR) & 0xFC; // 0x0102 -+ val8 |= WIFI_FW_ADHOC_STATE; -+ rtw_write8(padapter, MSR, val8); // Link in ad hoc network -+ } -+ -+ return res; -+} -+//------------------------------------------------------------------------------ -+//This function change the DUT from the MP test mode into normal mode -+void mp_stop_test(PADAPTER padapter) -+{ -+ struct mp_priv *pmppriv = &padapter->mppriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *tgt_network = &pmlmepriv->cur_network; -+ struct sta_info *psta; -+ -+ _irqL irqL; -+ -+ if(pmppriv->mode==MP_ON) -+ { -+ pmppriv->bSetTxPower=0; -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == false) -+ goto end_of_mp_stop_test; -+ -+ //3 1. disconnect psudo AdHoc -+ rtw_indicate_disconnect(padapter); -+ -+ //3 2. clear psta used in mp test mode. -+// rtw_free_assoc_resources(padapter, 1); -+ psta = rtw_get_stainfo(&padapter->stapriv, tgt_network->network.MacAddress); -+ if (psta) rtw_free_stainfo(padapter, psta); -+ -+ //3 3. return to normal state (default:station mode) -+ pmlmepriv->fw_state = pmppriv->prev_fw_state; // WIFI_STATION_STATE; -+ -+ //flush the cur_network -+ _rtw_memset(tgt_network, 0, sizeof(struct wlan_network)); -+ -+ _clr_fwstate_(pmlmepriv, WIFI_MP_STATE); -+ -+end_of_mp_stop_test: -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ } -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: mpt_SwitchRfSetting -+ * -+ * Overview: Change RF Setting when we siwthc channel/rate/BW for MP. -+ * -+ * Input: PADAPTER pAdapter -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 01/08/2009 MHC Suggestion from SD3 Willis for 92S series. -+ * 01/09/2009 MHC Add CCK modification for 40MHZ. Suggestion from SD3. -+ * -+ *---------------------------------------------------------------------------*/ -+static void mpt_SwitchRfSetting(PADAPTER pAdapter) -+{ -+ Hal_mpt_SwitchRfSetting(pAdapter); -+ } -+ -+/*---------------------------hal\rtl8192c\MPT_Phy.c---------------------------*/ -+/*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ -+static void MPT_CCKTxPowerAdjust(PADAPTER Adapter, bool bInCH14) -+{ -+ Hal_MPT_CCKTxPowerAdjust(Adapter,bInCH14); -+} -+ -+static void MPT_CCKTxPowerAdjustbyIndex(PADAPTER pAdapter, bool beven) -+{ -+ Hal_MPT_CCKTxPowerAdjustbyIndex(pAdapter,beven); -+ } -+ -+/*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ -+ -+/* -+ * SetChannel -+ * Description -+ * Use H2C command to change channel, -+ * not only modify rf register, but also other setting need to be done. -+ */ -+void SetChannel(PADAPTER pAdapter) -+{ -+ Hal_SetChannel(pAdapter); -+} -+ -+/* -+ * Notice -+ * Switch bandwitdth may change center frequency(channel) -+ */ -+void SetBandwidth(PADAPTER pAdapter) -+{ -+ Hal_SetBandwidth(pAdapter); -+ -+} -+ -+static void SetCCKTxPower(PADAPTER pAdapter, u8 *TxPower) -+{ -+ Hal_SetCCKTxPower(pAdapter,TxPower); -+} -+ -+static void SetOFDMTxPower(PADAPTER pAdapter, u8 *TxPower) -+{ -+ Hal_SetOFDMTxPower(pAdapter,TxPower); -+ } -+ -+ -+void SetAntenna(PADAPTER pAdapter) -+ { -+ Hal_SetAntenna(pAdapter); -+} -+ -+void SetAntennaPathPower(PADAPTER pAdapter) -+{ -+ Hal_SetAntennaPathPower(pAdapter); -+} -+ -+int SetTxPower(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u1Byte CurrChannel; -+ bool bResult = true; -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u1Byte rf, TxPower[2]; -+ -+ u8 u1TxPower = pAdapter->mppriv.txpoweridx; -+ CurrChannel = pMptCtx->MptChannelToSw; -+ -+ if(HAL_IsLegalChannel(pAdapter, CurrChannel) == false) -+ { -+ DBG_871X("SetTxPower(): CurrentChannel:%d is not valid\n", CurrChannel); -+ return false; -+ } -+ -+ TxPower[ODM_RF_PATH_A] = (u1Byte)(u1TxPower&0xff); -+ TxPower[ODM_RF_PATH_B] = (u1Byte)((u1TxPower&0xff00)>>8); -+ DBG_871X("TxPower(A, B) = (0x%x, 0x%x)\n", TxPower[ODM_RF_PATH_A], TxPower[ODM_RF_PATH_B]); -+ -+ for(rf=0; rf<2; rf++) -+ { -+ if(TxPower[rf] > MAX_TX_PWR_INDEX_N_MODE) { -+ DBG_871X("===> SetTxPower: The power index is too large.\n"); -+ return false; -+ } -+ pMptCtx->TxPwrLevel[rf] = TxPower[rf]; -+ } -+ Hal_SetTxPower(pAdapter); -+ return true; -+} -+ -+static void SetTxAGCOffset(PADAPTER pAdapter, u32 ulTxAGCOffset) -+{ -+ u32 TxAGCOffset_B, TxAGCOffset_C, TxAGCOffset_D,tmpAGC; -+ -+ TxAGCOffset_B = (ulTxAGCOffset&0x000000ff); -+ TxAGCOffset_C = ((ulTxAGCOffset&0x0000ff00)>>8); -+ TxAGCOffset_D = ((ulTxAGCOffset&0x00ff0000)>>16); -+ -+ tmpAGC = (TxAGCOffset_D<<8 | TxAGCOffset_C<<4 | TxAGCOffset_B); -+ write_bbreg(pAdapter, rFPGA0_TxGainStage, -+ (bXBTxAGC|bXCTxAGC|bXDTxAGC), tmpAGC); -+} -+ -+void SetDataRate(PADAPTER pAdapter) -+{ -+ Hal_SetDataRate(pAdapter); -+} -+ -+void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter ,bool bMain) -+{ -+ -+ PHY_SetRFPathSwitch(pAdapter,bMain); -+ -+} -+ -+ -+s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther) -+{ -+ return Hal_SetThermalMeter( pAdapter, target_ther); -+} -+ -+static void TriggerRFThermalMeter(PADAPTER pAdapter) -+{ -+ Hal_TriggerRFThermalMeter(pAdapter); -+} -+ -+static u8 ReadRFThermalMeter(PADAPTER pAdapter) -+{ -+ return Hal_ReadRFThermalMeter(pAdapter); -+} -+ -+void GetThermalMeter(PADAPTER pAdapter, u8 *value) -+{ -+ Hal_GetThermalMeter(pAdapter,value); -+} -+ -+void SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) -+{ -+ PhySetTxPowerLevel(pAdapter); -+ Hal_SetSingleCarrierTx(pAdapter,bStart); -+} -+ -+void SetSingleToneTx(PADAPTER pAdapter, u8 bStart) -+{ -+ PhySetTxPowerLevel(pAdapter); -+ Hal_SetSingleToneTx(pAdapter,bStart); -+} -+ -+void SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) -+{ -+ PhySetTxPowerLevel(pAdapter); -+ Hal_SetCarrierSuppressionTx(pAdapter, bStart); -+} -+ -+static void SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ PhySetTxPowerLevel(pAdapter); -+ Hal_SetCCKContinuousTx(pAdapter,bStart); -+} -+ -+static void SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ PhySetTxPowerLevel(pAdapter); -+ Hal_SetOFDMContinuousTx( pAdapter, bStart); -+}/* mpt_StartOfdmContTx */ -+ -+void SetContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ PhySetTxPowerLevel(pAdapter); -+ Hal_SetContinuousTx(pAdapter,bStart); -+} -+ -+ -+void PhySetTxPowerLevel(PADAPTER pAdapter) -+{ -+ struct mp_priv *pmp_priv = &pAdapter->mppriv; -+ -+ if (pmp_priv->bSetTxPower==0) // for NO manually set power index -+ PHY_SetTxPowerLevel8812(pAdapter,pmp_priv->channel); -+} -+ -+//------------------------------------------------------------------------------ -+static void dump_mpframe(PADAPTER padapter, struct xmit_frame *pmpframe) -+{ -+ rtw_hal_mgnt_xmit(padapter, pmpframe); -+} -+ -+static struct xmit_frame *alloc_mp_xmitframe(struct xmit_priv *pxmitpriv) -+{ -+ struct xmit_frame *pmpframe; -+ struct xmit_buf *pxmitbuf; -+ -+ if ((pmpframe = rtw_alloc_xmitframe(pxmitpriv)) == NULL) -+ { -+ return NULL; -+ } -+ -+ if ((pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv)) == NULL) -+ { -+ rtw_free_xmitframe(pxmitpriv, pmpframe); -+ return NULL; -+ } -+ -+ pmpframe->frame_tag = MP_FRAMETAG; -+ -+ pmpframe->pxmitbuf = pxmitbuf; -+ -+ pmpframe->buf_addr = pxmitbuf->pbuf; -+ -+ pxmitbuf->priv_data = pmpframe; -+ -+ return pmpframe; -+ -+} -+ -+static thread_return mp_xmit_packet_thread(thread_context context) -+{ -+ struct xmit_frame *pxmitframe; -+ struct mp_tx *pmptx; -+ struct mp_priv *pmp_priv; -+ struct xmit_priv *pxmitpriv; -+ PADAPTER padapter; -+ -+ pmp_priv = (struct mp_priv *)context; -+ pmptx = &pmp_priv->tx; -+ padapter = pmp_priv->papdater; -+ pxmitpriv = &(padapter->xmitpriv); -+ -+ thread_enter("RTW_MP_THREAD"); -+ -+ DBG_871X("%s:pkTx Start\n", __func__); -+ while (1) { -+ pxmitframe = alloc_mp_xmitframe(pxmitpriv); -+ if (pxmitframe == NULL) { -+ if (pmptx->stop || -+ padapter->bSurpriseRemoved || -+ padapter->bDriverStopped) { -+ goto exit; -+ } -+ else { -+ rtw_msleep_os(1); -+ continue; -+ } -+ } -+ _rtw_memcpy((u8 *)(pxmitframe->buf_addr+TXDESC_OFFSET), pmptx->buf, pmptx->write_size); -+ _rtw_memcpy(&(pxmitframe->attrib), &(pmptx->attrib), sizeof(struct pkt_attrib)); -+ -+ dump_mpframe(padapter, pxmitframe); -+ pmptx->sended++; -+ pmp_priv->tx_pktcount++; -+ -+ if (pmptx->stop || -+ padapter->bSurpriseRemoved || -+ padapter->bDriverStopped) -+ goto exit; -+ if ((pmptx->count != 0) && -+ (pmptx->count == pmptx->sended)) -+ goto exit; -+ -+ flush_signals_thread(); -+ } -+ -+exit: -+ //DBG_871X("%s:pkTx Exit\n", __func__); -+ rtw_mfree(pmptx->pallocated_buf, pmptx->buf_size); -+ pmptx->pallocated_buf = NULL; -+ pmptx->stop = 1; -+ -+ thread_exit(); -+} -+ -+void fill_txdesc_for_mp(PADAPTER padapter, struct tx_desc *ptxdesc) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ _rtw_memcpy(ptxdesc, &(pmp_priv->tx.desc), TXDESC_SIZE); -+} -+ -+static void fill_tx_desc_8812a(PADAPTER padapter) -+{ -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ //struct tx_desc *pDesc = &(pmp_priv->tx.desc); -+ u8 *pDesc = (u8 *)&(pmp_priv->tx.desc); -+ struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); -+ -+ u32 pkt_size = pattrib->last_txcmdsz; -+ s32 bmcast = IS_MCAST(pattrib->ra); -+ u8 data_rate,pwr_status,offset; -+ -+ SET_TX_DESC_FIRST_SEG_8812(pDesc, 1); -+ SET_TX_DESC_LAST_SEG_8812(pDesc, 1); -+ SET_TX_DESC_OWN_8812(pDesc, 1); -+ -+ SET_TX_DESC_PKT_SIZE_8812(pDesc, pkt_size); -+ -+ offset = TXDESC_SIZE + OFFSET_SZ; -+ -+ SET_TX_DESC_OFFSET_8812(pDesc, offset); -+ SET_TX_DESC_PKT_OFFSET_8812(pDesc, 1); -+ -+ if (bmcast) { -+ SET_TX_DESC_BMC_8812(pDesc, 1); -+ } -+ -+ SET_TX_DESC_MACID_8812(pDesc, pattrib->mac_id); -+ SET_TX_DESC_RATE_ID_8812(pDesc, pattrib->raid); -+ -+ //SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_G); -+ SET_TX_DESC_QUEUE_SEL_8812(pDesc, pattrib->qsel); -+ //SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); -+ -+ if (!pattrib->qos_en) { -+ SET_TX_DESC_HWSEQ_EN_8812(pDesc, 1); // Hw set sequence number -+ } else { -+ SET_TX_DESC_SEQ_8812(pDesc, pattrib->seqnum); -+ } -+ -+ SET_TX_DESC_DISABLE_FB_8812(pDesc, 1); -+ SET_TX_DESC_USE_RATE_8812(pDesc, 1); -+ SET_TX_DESC_TX_RATE_8812(pDesc, pmp_priv->rateidx); -+ -+} -+ -+void SetPacketTx(PADAPTER padapter) -+{ -+ u8 *ptr, *pkt_start, *pkt_end; -+ u32 pkt_size,offset; -+ struct tx_desc *desc; -+ struct rtw_ieee80211_hdr *hdr; -+ u8 payload; -+ s32 bmcast; -+ struct pkt_attrib *pattrib; -+ struct mp_priv *pmp_priv; -+ -+ pmp_priv = &padapter->mppriv; -+ -+ if (pmp_priv->tx.stop) return; -+ pmp_priv->tx.sended = 0; -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx_pktcount = 0; -+ -+ //3 1. update_attrib() -+ pattrib = &pmp_priv->tx.attrib; -+ _rtw_memcpy(pattrib->src, padapter->eeprompriv.mac_addr, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ bmcast = IS_MCAST(pattrib->ra); -+ if (bmcast) { -+ pattrib->mac_id = 1; -+ pattrib->psta = rtw_get_bcmc_stainfo(padapter); -+ } else { -+ pattrib->mac_id = 0; -+ pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); -+ } -+ -+ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->pktlen; -+ -+ //3 2. allocate xmit buffer -+ pkt_size = pattrib->last_txcmdsz; -+ -+ if (pmp_priv->tx.pallocated_buf) -+ rtw_mfree(pmp_priv->tx.pallocated_buf, pmp_priv->tx.buf_size); -+ pmp_priv->tx.write_size = pkt_size; -+ pmp_priv->tx.buf_size = pkt_size + XMITBUF_ALIGN_SZ; -+ pmp_priv->tx.pallocated_buf = rtw_zmalloc(pmp_priv->tx.buf_size); -+ if (pmp_priv->tx.pallocated_buf == NULL) { -+ DBG_871X("%s: malloc(%d) fail!!\n", __func__, pmp_priv->tx.buf_size); -+ return; -+ } -+ pmp_priv->tx.buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pmp_priv->tx.pallocated_buf), XMITBUF_ALIGN_SZ); -+ ptr = pmp_priv->tx.buf; -+ -+ desc = &(pmp_priv->tx.desc); -+ _rtw_memset(desc, 0, TXDESC_SIZE); -+ pkt_start = ptr; -+ pkt_end = pkt_start + pkt_size; -+ -+ //3 3. init TX descriptor -+ if(IS_HARDWARE_TYPE_8812(padapter)) -+ fill_tx_desc_8812a(padapter); -+ -+ //3 4. make wlan header, make_wlanhdr() -+ hdr = (struct rtw_ieee80211_hdr *)pkt_start; -+ SetFrameSubType(&hdr->frame_ctl, pattrib->subtype); -+ _rtw_memcpy(hdr->addr1, pattrib->dst, ETH_ALEN); // DA -+ _rtw_memcpy(hdr->addr2, pattrib->src, ETH_ALEN); // SA -+ _rtw_memcpy(hdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); // RA, BSSID -+ -+ //3 5. make payload -+ ptr = pkt_start + pattrib->hdrlen; -+ -+ switch (pmp_priv->tx.payload) { -+ case 0: -+ payload = 0x00; -+ break; -+ case 1: -+ payload = 0x5a; -+ break; -+ case 2: -+ payload = 0xa5; -+ break; -+ case 3: -+ payload = 0xff; -+ break; -+ default: -+ payload = 0x00; -+ break; -+ } -+ -+ _rtw_memset(ptr, payload, pkt_end - ptr); -+ -+ //3 6. start thread -+ pmp_priv->tx.PktTxThread = kthread_run(mp_xmit_packet_thread, pmp_priv, "RTW_MP_THREAD"); -+ if (IS_ERR(pmp_priv->tx.PktTxThread)) -+ DBG_871X("Create PktTx Thread Fail !!!!!\n"); -+} -+ -+void SetPacketRx(PADAPTER pAdapter, u8 bStartRx) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ if(bStartRx) -+ { -+ // Accept CRC error and destination address -+ pHalData->ReceiveConfig = AAP | APM | AM | AB | APP_ICV | ADF | AMF | HTC_LOC_CTRL | APP_MIC | APP_PHYSTS; -+ -+ pHalData->ReceiveConfig |= ACRC32; -+ -+ rtw_write32(pAdapter, REG_RCR, pHalData->ReceiveConfig); -+ -+ // Accept all data frames -+ rtw_write16(pAdapter, REG_RXFLTMAP2, 0xFFFF); -+ } -+ else -+ { -+ rtw_write32(pAdapter, REG_RCR, 0); -+ } -+} -+ -+void ResetPhyRxPktCount(PADAPTER pAdapter) -+{ -+ u32 i, phyrx_set = 0; -+ -+ for (i = 0; i <= 0xF; i++) { -+ phyrx_set = 0; -+ phyrx_set |= _RXERR_RPT_SEL(i); //select -+ phyrx_set |= RXERR_RPT_RST; // set counter to zero -+ rtw_write32(pAdapter, REG_RXERR_RPT, phyrx_set); -+ } -+} -+ -+static u32 GetPhyRxPktCounts(PADAPTER pAdapter, u32 selbit) -+{ -+ //selection -+ u32 phyrx_set = 0, count = 0; -+ -+ phyrx_set = _RXERR_RPT_SEL(selbit & 0xF); -+ rtw_write32(pAdapter, REG_RXERR_RPT, phyrx_set); -+ -+ //Read packet count -+ count = rtw_read32(pAdapter, REG_RXERR_RPT) & RXERR_COUNTER_MASK; -+ -+ return count; -+} -+ -+u32 GetPhyRxPktReceived(PADAPTER pAdapter) -+{ -+ u32 OFDM_cnt = 0, CCK_cnt = 0, HT_cnt = 0; -+ -+ OFDM_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_OFDM_MPDU_OK); -+ CCK_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_CCK_MPDU_OK); -+ HT_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_HT_MPDU_OK); -+ -+ return OFDM_cnt + CCK_cnt + HT_cnt; -+} -+ -+u32 GetPhyRxPktCRC32Error(PADAPTER pAdapter) -+{ -+ u32 OFDM_cnt = 0, CCK_cnt = 0, HT_cnt = 0; -+ -+ OFDM_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_OFDM_MPDU_FAIL); -+ CCK_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_CCK_MPDU_FAIL); -+ HT_cnt = GetPhyRxPktCounts(pAdapter, RXERR_TYPE_HT_MPDU_FAIL); -+ -+ return OFDM_cnt + CCK_cnt + HT_cnt; -+} -+ -+//reg 0x808[9:0]: FFT data x -+//reg 0x808[22]: 0 --> 1 to get 1 FFT data y -+//reg 0x8B4[15:0]: FFT data y report -+static u32 rtw_GetPSDData(PADAPTER pAdapter, u32 point) -+{ -+ u32 psd_val=0; -+ -+ u16 psd_reg = 0x910; -+ u16 psd_regL= 0xF44; -+ -+ psd_val = rtw_read32(pAdapter, psd_reg); -+ -+ psd_val &= 0xFFBFFC00; -+ psd_val |= point; -+ -+ rtw_write32(pAdapter, psd_reg, psd_val); -+ rtw_mdelay_os(1); -+ psd_val |= 0x00400000; -+ -+ rtw_write32(pAdapter, psd_reg, psd_val); -+ rtw_mdelay_os(1); -+ -+ psd_val = rtw_read32(pAdapter, psd_regL); -+ psd_val &= 0x0000FFFF; -+ -+ return psd_val; -+} -+ -+/* -+ * pts start_point_min stop_point_max -+ * 128 64 64 + 128 = 192 -+ * 256 128 128 + 256 = 384 -+ * 512 256 256 + 512 = 768 -+ * 1024 512 512 + 1024 = 1536 -+ * -+ */ -+u32 mp_query_psd(PADAPTER pAdapter, u8 *data) -+{ -+ u32 i, psd_pts=0, psd_start=0, psd_stop=0; -+ u32 psd_data=0; -+ -+ -+ if (!netif_running(pAdapter->pnetdev)) { -+ RT_TRACE(_module_mp_, _drv_warning_, ("mp_query_psd: Fail! interface not opened!\n")); -+ return 0; -+ } -+ -+ if (check_fwstate(&pAdapter->mlmepriv, WIFI_MP_STATE) == false) { -+ RT_TRACE(_module_mp_, _drv_warning_, ("mp_query_psd: Fail! not in MP mode!\n")); -+ return 0; -+ } -+ -+ if (strlen(data) == 0) { //default value -+ psd_pts = 128; -+ psd_start = 64; -+ psd_stop = 128; -+ } else { -+ sscanf(data, "pts=%d,start=%d,stop=%d", &psd_pts, &psd_start, &psd_stop); -+ } -+ -+ _rtw_memset(data, '\0', sizeof(data)); -+ -+ i = psd_start; -+ while (i < psd_stop) -+ { -+ if (i >= psd_pts) { -+ psd_data = rtw_GetPSDData(pAdapter, i-psd_pts); -+ } else { -+ psd_data = rtw_GetPSDData(pAdapter, i); -+ } -+ sprintf(data, "%s%x ", data, psd_data); -+ i++; -+ } -+ -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ rtw_msleep_os(100); -+ #else -+ rtw_mdelay_os(100); -+ #endif -+ -+ return strlen(data)+1; -+} -+ -+ -+ -+void _rtw_mp_xmit_priv (struct xmit_priv *pxmitpriv) -+{ -+ int i,res; -+ _adapter *padapter = pxmitpriv->adapter; -+ struct xmit_frame *pxmitframe = (struct xmit_frame*) pxmitpriv->pxmit_frame_buf; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf; -+ -+ u32 max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; -+ u32 num_xmit_extbuf = NR_XMIT_EXTBUFF; -+ if(padapter->registrypriv.mp_mode ==0) -+ { -+ max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; -+ num_xmit_extbuf = NR_XMIT_EXTBUFF; -+ } -+ else -+ { -+ max_xmit_extbuf_size = 20000; -+ num_xmit_extbuf = 1; -+ } -+ -+ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; -+ for(i=0; ipallocated_xmit_extbuf) { -+ rtw_vmfree(pxmitpriv->pallocated_xmit_extbuf, num_xmit_extbuf * sizeof(struct xmit_buf) + 4); -+ } -+ -+ if(padapter->registrypriv.mp_mode ==0) -+ { -+ max_xmit_extbuf_size = 20000; -+ num_xmit_extbuf = 1; -+ } -+ else -+ { -+ max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; -+ num_xmit_extbuf = NR_XMIT_EXTBUFF; -+ } -+ -+ // Init xmit extension buff -+ _rtw_init_queue(&pxmitpriv->free_xmit_extbuf_queue); -+ -+ pxmitpriv->pallocated_xmit_extbuf = rtw_zvmalloc(num_xmit_extbuf * sizeof(struct xmit_buf) + 4); -+ -+ if (pxmitpriv->pallocated_xmit_extbuf == NULL){ -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("alloc xmit_extbuf fail!\n")); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pxmitpriv->pxmit_extbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_xmit_extbuf), 4); -+ -+ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; -+ -+ for (i = 0; i < num_xmit_extbuf; i++) -+ { -+ _rtw_init_listhead(&pxmitbuf->list); -+ -+ pxmitbuf->priv_data = NULL; -+ pxmitbuf->padapter = padapter; -+ pxmitbuf->buf_tag = XMITBUF_MGNT; -+ -+ if((res=rtw_os_xmit_resource_alloc(padapter, pxmitbuf,max_xmit_extbuf_size + XMITBUF_ALIGN_SZ, false)) == _FAIL) { -+ res= _FAIL; -+ goto exit; -+ } -+ -+ rtw_list_insert_tail(&pxmitbuf->list, &(pxmitpriv->free_xmit_extbuf_queue.queue)); -+ #ifdef DBG_XMIT_BUF_EXT -+ pxmitbuf->no=i; -+ #endif -+ pxmitbuf++; -+ -+ } -+ -+ pxmitpriv->free_xmit_extbuf_cnt = num_xmit_extbuf; -+ -+exit: -+ ; -+} -+ -+ -+ -+static u32 getPowerDiffByRate8188E( -+ PADAPTER pAdapter, -+ u1Byte CurrChannel, -+ u32 RfPath -+ ) -+{ -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u32 PwrGroup=0; -+ u32 TxPower=0, Limit=0; -+ u32 Pathmapping = (RfPath == ODM_RF_PATH_A?0:8); -+ -+ switch(pHalData->EEPROMRegulatory) -+ { -+ case 0: // driver-defined maximum power offset for longer communication range -+ // refer to power by rate table -+ PwrGroup = 0; -+ Limit = 0xff; -+ break; -+ case 1: // Power-limit table-defined maximum power offset range -+ // choosed by min(power by rate, power limit). -+ { -+ if(pHalData->pwrGroupCnt == 1) -+ PwrGroup = 0; -+ if(pHalData->pwrGroupCnt >= 3) -+ { -+ if(CurrChannel <= 3) -+ PwrGroup = 0; -+ else if(CurrChannel >= 4 && CurrChannel <= 9) -+ PwrGroup = 1; -+ else if(CurrChannel > 9) -+ PwrGroup = 2; -+ -+ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) -+ PwrGroup++; -+ else -+ PwrGroup+=4; -+ } -+ Limit = 0xff; -+ } -+ break; -+ case 2: // not support power offset by rate. -+ // don't increase any power diff -+ PwrGroup = 0; -+ Limit = 0; -+ break; -+ default: -+ PwrGroup = 0; -+ Limit = 0xff; -+ break; -+ } -+ -+ -+ { -+ switch(pMptCtx->MptRateIndex) -+ { -+ case MPT_RATE_1M: -+ case MPT_RATE_2M: -+ case MPT_RATE_55M: -+ case MPT_RATE_11M: -+ //CCK rates, don't add any tx power index. -+ //RT_DISP(FPHY, PHY_TXPWR,("CCK rates!\n")); -+ break; -+ case MPT_RATE_6M: //0xe00 [31:0] = 18M,12M,09M,06M -+ TxPower += ((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0+Pathmapping])&0xff); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, OFDM 6M, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0], TxPower)); -+ break; -+ case MPT_RATE_9M: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0+Pathmapping])&0xff00)>>8); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, OFDM 9M, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0], TxPower)); -+ break; -+ case MPT_RATE_12M: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0+Pathmapping])&0xff0000)>>16); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, OFDM 12M, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0], TxPower)); -+ break; -+ case MPT_RATE_18M: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0+Pathmapping])&0xff000000)>>24); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, OFDM 24M, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][0], TxPower)); -+ break; -+ case MPT_RATE_24M: //0xe04[31:0] = 54M,48M,36M,24M -+ TxPower += ((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1+Pathmapping])&0xff); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, OFDM 24M, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1], TxPower)); -+ break; -+ case MPT_RATE_36M: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1+Pathmapping])&0xff00)>>8); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, OFDM 36M, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1], TxPower)); -+ break; -+ case MPT_RATE_48M: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1+Pathmapping])&0xff0000)>>16); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, OFDM 48M, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1], TxPower)); -+ break; -+ case MPT_RATE_54M: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1+Pathmapping])&0xff000000)>>24); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, OFDM 54M, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][1], TxPower)); -+ break; -+ case MPT_RATE_MCS0: //0xe10[31:0]= MCS=03,02,01,00 -+ TxPower += ((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2+Pathmapping])&0xff); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, MCS0, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2], TxPower)); -+ break; -+ case MPT_RATE_MCS1: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2+Pathmapping])&0xff00)>>8); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, MCS1, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2], TxPower)); -+ break; -+ case MPT_RATE_MCS2: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2+Pathmapping])&0xff0000)>>16); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, MCS2, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2], TxPower)); -+ break; -+ case MPT_RATE_MCS3: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2+Pathmapping])&0xff000000)>>24); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, MCS3, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][2], TxPower)); -+ break; -+ case MPT_RATE_MCS4: //0xe14[31:0]= MCS=07,06,05,04 -+ TxPower += ((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3+Pathmapping])&0xff); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, MCS4, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3], TxPower)); -+ break; -+ case MPT_RATE_MCS5: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3+Pathmapping])&0xff00)>>8); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, MCS5, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3], TxPower)); -+ break; -+ case MPT_RATE_MCS6: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3+Pathmapping])&0xff0000)>>16); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, MCS6, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3], TxPower)); -+ break; -+ case MPT_RATE_MCS7: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3+Pathmapping])&0xff000000)>>24); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, MCS7, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][3], TxPower)); -+ break; -+ -+ case MPT_RATE_MCS8: //0xe18[31:0]= MCS=11,10,09,08 -+ TxPower += ((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4+Pathmapping])&0xff); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, MCS8, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4], TxPower)); -+ break; -+ case MPT_RATE_MCS9: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4+Pathmapping])&0xff00)>>8); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, MCS9, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4], TxPower)); -+ break; -+ case MPT_RATE_MCS10: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4+Pathmapping])&0xff0000)>>16); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, MCS10, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4], TxPower)); -+ break; -+ case MPT_RATE_MCS11: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4+Pathmapping])&0xff000000)>>24); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, MCS11, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][4], TxPower)); -+ break; -+ case MPT_RATE_MCS12: //0xe1c[31:0]= MCS=15,14,13,12 -+ TxPower += ((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5+Pathmapping])&0xff); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, MCS12, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5], TxPower)); -+ break; -+ case MPT_RATE_MCS13: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5+Pathmapping])&0xff00)>>8); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, MCS13, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5], TxPower)); -+ break; -+ case MPT_RATE_MCS14: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5+Pathmapping])&0xff0000)>>16); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, MCS14, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5], TxPower)); -+ break; -+ case MPT_RATE_MCS15: -+ TxPower += (((pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5+Pathmapping])&0xff000000)>>24); -+ //RT_DISP(FPHY, PHY_TXPWR,("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, MCS15, TxPower = %d\n", -+ // PwrGroup, pHalData->MCSTxPowerLevelOriginalOffset[PwrGroup][5], TxPower)); -+ break; -+ default: -+ break; -+ } -+ } -+ -+ if(TxPower > Limit) -+ TxPower = Limit; -+ -+ return TxPower; -+} -+ -+ -+ -+static u32 -+mpt_ProQueryCalTxPower_8188E( -+ PADAPTER pAdapter, -+ u1Byte RfPath -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u1Byte TxCount=TX_1S, i = 0; //default set to 1S -+ //PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); -+ u32 TxPower = 1, PwrGroup=0, PowerDiffByRate=0; -+ u32 TxPowerCCK = 1, TxPowerOFDM = 1, TxPowerBW20 = 1, TxPowerBW40 = 1 ; -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u1Byte CurrChannel = pHalData->CurrentChannel; -+ u1Byte index = (CurrChannel -1); -+ u1Byte rf_path=(RfPath), rfPath; -+ u1Byte limit = 0, rate = 0; -+ -+ if(HAL_IsLegalChannel(pAdapter, CurrChannel) == false) -+ { -+ CurrChannel = 1; -+ } -+ -+ if( pMptCtx->MptRateIndex >= MPT_RATE_1M && -+ pMptCtx->MptRateIndex <= MPT_RATE_11M ) -+ { -+ TxPower = pHalData->Index24G_CCK_Base[rf_path][index]; -+ } -+ else if(pMptCtx->MptRateIndex >= MPT_RATE_6M && -+ pMptCtx->MptRateIndex <= MPT_RATE_54M ) -+ { -+ TxPower = pHalData->Index24G_BW40_Base[rf_path][index]; -+ } -+ else if(pMptCtx->MptRateIndex >= MPT_RATE_MCS0 && -+ pMptCtx->MptRateIndex <= MPT_RATE_MCS7 ) -+ { -+ TxPower = pHalData->Index24G_BW40_Base[rf_path][index]; -+ } -+ -+ //RT_DISP(FPHY, PHY_TXPWR, ("HT40 rate(%d) Tx power(RF-%c) = 0x%x\n", pMptCtx->MptRateIndex, ((rf_path==0)?'A':'B'), TxPower)); -+ -+ -+ if(pMptCtx->MptRateIndex >= MPT_RATE_6M && -+ pMptCtx->MptRateIndex <= MPT_RATE_54M ) -+ { -+ TxPower += pHalData->OFDM_24G_Diff[rf_path][TxCount]; -+ ///RT_DISP(FPHY, PHY_TXPWR, ("+OFDM_PowerDiff(RF-%c) = 0x%x\n", ((rf_path==0)?'A':'B'), -+ // pHalData->OFDM_24G_Diff[rf_path][TxCount])); -+ } -+ -+ if(pMptCtx->MptRateIndex >= MPT_RATE_MCS0) -+ { -+ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) -+ { -+ TxPower += pHalData->BW20_24G_Diff[rf_path][TxCount]; -+ // RT_DISP(FPHY, PHY_TXPWR, ("+HT20_PowerDiff(RF-%c) = 0x%x\n", ((rf_path==0)?'A':'B'), -+ // pHalData->BW20_24G_Diff[rf_path][TxCount])); -+ } -+ } -+ -+ -+#ifdef ENABLE_POWER_BY_RATE -+ PowerDiffByRate = getPowerDiffByRate8188E(pAdapter, CurrChannel, RfPath); -+#else -+ PowerDiffByRate = 0; -+#endif -+ -+ -+ //RT_DISP(FPHY, PHY_TXPWR, ("+PowerDiffByRate(RF-%c) = 0x%x\n", ((rf_path==0)?'A':'B'), -+ // PowerDiffByRate)); -+ TxPower += PowerDiffByRate; -+// RT_DISP(FPHY, PHY_TXPWR, ("Final TxPower(RF-%c) = %d(0x%x)\n", ((rf_path==0)?'A':'B'), -+ // TxPower, TxPower)); -+ -+ /* -+ if(TxPower > 0x3f) -+ TxPower = 0x3f; -+ */ -+ -+ // 2012/11/02 Awk: add power limit mechansim -+ if( pMptCtx->MptRateIndex >= MPT_RATE_1M && -+ pMptCtx->MptRateIndex <= MPT_RATE_11M ) -+ { -+ rate = MGN_1M; -+ } -+ else if(pMptCtx->MptRateIndex >= MPT_RATE_6M && -+ pMptCtx->MptRateIndex <= MPT_RATE_54M ) -+ { -+ rate = MGN_54M; -+ } -+ else if(pMptCtx->MptRateIndex >= MPT_RATE_MCS0 && -+ pMptCtx->MptRateIndex <= MPT_RATE_MCS7 ) -+ { -+ rate = MGN_MCS7; -+ } -+ #ifdef CONFIG_8192E -+ limit = PHY_GetPowerLimitValue(pAdapter, pMptCtx->RegTxPwrLimit, -+ pHalData->CurrentBandType, -+ pHalData->CurrentChannelBW,RfPath, -+ rate, CurrChannel); -+ #endif -+ TxPower = TxPower > limit ? limit : TxPower; -+ -+ return TxPower; -+} -+ -+ -+u32 mpt_ProQueryCalTxPower( -+ PADAPTER pAdapter, -+ u8 RfPath -+ ) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u32 TxPower = 1, PwrGroup=0, PowerDiffByRate=0; -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u1Byte limit = 0, rate = 0; -+ rate=pMptCtx->MptRateIndex; -+ -+ if ( IS_HARDWARE_TYPE_8188E(pAdapter) || IS_HARDWARE_TYPE_8192E(pAdapter) )//|| IS_HARDWARE_TYPE_8723B(pAdapter)) -+ { -+ return mpt_ProQueryCalTxPower_8188E(pAdapter, RfPath); -+ } -+ else -+ { -+ #ifdef CONFIG_8812A -+ TxPower = PHY_GetTxPowerIndex_8812A(pAdapter, RfPath, rate,pHalData->CurrentChannelBW, pHalData->CurrentChannel); -+ #endif -+ return TxPower; -+ } -+} -+ -+ -+void Hal_ProSetCrystalCap (PADAPTER pAdapter , u32 CrystalCapVal) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ CrystalCapVal = pHalData->CrystalCap & 0x3F; -+ -+ if(IS_HARDWARE_TYPE_8192D(pAdapter)) -+ { -+ PHY_SetBBReg(pAdapter, REG_AFE_XTAL_CTRL, 0xF0, CrystalCapVal & 0x0F); -+ PHY_SetBBReg(pAdapter, REG_AFE_PLL_CTRL, 0xF0000000, (CrystalCapVal & 0xF0) >> 4); -+ } -+ else if(IS_HARDWARE_TYPE_8188E(pAdapter)) -+ { -+ // write 0x24[16:11] = 0x24[22:17] = CrystalCap -+ PHY_SetBBReg(pAdapter, REG_AFE_XTAL_CTRL, 0x7FF800, (CrystalCapVal | (CrystalCapVal << 6))); -+ } -+ else if(IS_HARDWARE_TYPE_8812(pAdapter)) -+ { -+ // write 0x2C[30:25] = 0x2C[24:19] = CrystalCap -+ PHY_SetBBReg(pAdapter, REG_MAC_PHY_CTRL, 0x7FF80000, (CrystalCapVal | (CrystalCapVal << 6))); -+ } -+ else if(IS_HARDWARE_TYPE_8821(pAdapter) || IS_HARDWARE_TYPE_8192E(pAdapter)) -+ { -+ // write 0x2C[23:18] = 0x2C[17:12] = CrystalCap -+ PHY_SetBBReg(pAdapter, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCapVal | (CrystalCapVal << 6))); -+ } -+ else -+ { -+ PHY_SetBBReg(pAdapter, 0x2c, 0xFFF000, (CrystalCapVal | (CrystalCapVal << 6))); -+ } -+} -+ -+ -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_mp_ioctl.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mp_ioctl.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_mp_ioctl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_mp_ioctl.c 2018-02-06 17:42:30.697966972 +0200 -@@ -0,0 +1,1637 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_MP_IOCTL_C_ -+ -+#include -+#include -+#include "../hal/odm_precomp.h" -+ -+//**************** oid_rtl_seg_81_85 section start **************** -+uint oid_rt_wireless_mode_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->information_buf_len < sizeof(u8)) -+ return uint_INVALID_LENGTH; -+ -+ if (poid_par_priv->type_of_oid == SET_OID) { -+ Adapter->registrypriv.wireless_mode = *(u8*)poid_par_priv->information_buf; -+ } else if (poid_par_priv->type_of_oid == QUERY_OID) { -+ *(u8*)poid_par_priv->information_buf = Adapter->registrypriv.wireless_mode; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ RT_TRACE(_module_mp_, _drv_info_, ("-query Wireless Mode=%d\n", Adapter->registrypriv.wireless_mode)); -+ } else { -+ status = uint_NOT_ACCEPTED; -+ } -+ -+ -+ -+ return status; -+} -+//**************** oid_rtl_seg_81_87_80 section start **************** -+uint oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ struct bb_reg_param *pbbreg; -+ u16 offset; -+ u32 value; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_write_bb_reg_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param)) -+ return uint_INVALID_LENGTH; -+ -+ pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf); -+ -+ offset = (u16)(pbbreg->offset) & 0xFFF; //0ffset :0x800~0xfff -+ if (offset < BB_REG_BASE_ADDR) offset |= BB_REG_BASE_ADDR; -+ -+ value = pbbreg->value; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("oid_rt_pro_write_bb_reg_hdl: offset=0x%03X value=0x%08X\n", -+ offset, value)); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ write_bbreg(Adapter, offset, 0xFFFFFFFF, value); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ struct bb_reg_param *pbbreg; -+ u16 offset; -+ u32 value; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_read_bb_reg_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param)) -+ return uint_INVALID_LENGTH; -+ -+ pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf); -+ -+ offset = (u16)(pbbreg->offset) & 0xFFF; //0ffset :0x800~0xfff -+ if (offset < BB_REG_BASE_ADDR) offset |= BB_REG_BASE_ADDR; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ value = read_bbreg(Adapter, offset, 0xFFFFFFFF); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ pbbreg->value = value; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("-oid_rt_pro_read_bb_reg_hdl: offset=0x%03X value:0x%08X\n", -+ offset, value)); -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ struct rf_reg_param *pbbreg; -+ u8 path; -+ u8 offset; -+ u32 value; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_write_rf_reg_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param)) -+ return uint_INVALID_LENGTH; -+ -+ pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf); -+ -+ if (pbbreg->path >= MAX_RF_PATH_NUMS) -+ return uint_NOT_ACCEPTED; -+ if (pbbreg->offset > 0xFF) -+ return uint_NOT_ACCEPTED; -+ if (pbbreg->value > 0xFFFFF) -+ return uint_NOT_ACCEPTED; -+ -+ path = (u8)pbbreg->path; -+ offset = (u8)pbbreg->offset; -+ value = pbbreg->value; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("oid_rt_pro_write_rf_reg_hdl: path=%d offset=0x%02X value=0x%05X\n", -+ path, offset, value)); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ write_rfreg(Adapter, path, offset, value); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ struct rf_reg_param *pbbreg; -+ u8 path; -+ u8 offset; -+ u32 value; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ uint status = uint_SUCCESS; -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_read_rf_reg_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param)) -+ return uint_INVALID_LENGTH; -+ -+ pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf); -+ -+ if (pbbreg->path >= MAX_RF_PATH_NUMS) -+ return uint_NOT_ACCEPTED; -+ if (pbbreg->offset > 0xFF) -+ return uint_NOT_ACCEPTED; -+ -+ path = (u8)pbbreg->path; -+ offset = (u8)pbbreg->offset; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ value = read_rfreg(Adapter, path, offset); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ pbbreg->value = value; -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("-oid_rt_pro_read_rf_reg_hdl: path=%d offset=0x%02X value=0x%05X\n", -+ path, offset, value)); -+ -+ -+ -+ return status; -+} -+//**************** oid_rtl_seg_81_87_00 section end**************** -+//------------------------------------------------------------------------------ -+ -+//**************** oid_rtl_seg_81_80_00 section start **************** -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_set_data_rate_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u32 ratevalue;//4 -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("+oid_rt_pro_set_data_rate_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return uint_INVALID_LENGTH; -+ -+ ratevalue = *((u32*)poid_par_priv->information_buf);//4 -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("oid_rt_pro_set_data_rate_hdl: data rate idx=%d\n", ratevalue)); -+ if (ratevalue >= MPT_RATE_LAST) -+ return uint_INVALID_DATA; -+ -+ Adapter->mppriv.rateidx = ratevalue; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetDataRate(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_start_test_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u32 mode; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_start_test_hdl\n")); -+ -+ if (Adapter->registrypriv.mp_mode == 0) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ //IQCalibrateBcut(Adapter); -+ -+ mode = *((u32*)poid_par_priv->information_buf); -+ Adapter->mppriv.mode = mode;// 1 for loopback -+ -+ if (mp_start_test(Adapter) == _FAIL) { -+ status = uint_NOT_ACCEPTED; -+ goto exit; -+ } -+ -+exit: -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("-oid_rt_pro_start_test_hdl: mp_mode=%d\n", Adapter->mppriv.mode)); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_stop_test_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+Set OID_RT_PRO_STOP_TEST\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ mp_stop_test(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("-Set OID_RT_PRO_STOP_TEST\n")); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u32 Channel; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_set_channel_direct_call_hdl\n")); -+ -+ if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return uint_INVALID_LENGTH; -+ -+ if (poid_par_priv->type_of_oid == QUERY_OID) { -+ *((u32*)poid_par_priv->information_buf) = Adapter->mppriv.channel; -+ return uint_SUCCESS; -+ } -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ Channel = *((u32*)poid_par_priv->information_buf); -+ RT_TRACE(_module_mp_, _drv_notice_, ("oid_rt_pro_set_channel_direct_call_hdl: Channel=%d\n", Channel)); -+ if (Channel > 14) -+ return uint_NOT_ACCEPTED; -+ Adapter->mppriv.channel = Channel; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetChannel(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_set_bandwidth_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u16 bandwidth; -+ u16 channel_offset; -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("+oid_rt_set_bandwidth_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return uint_INVALID_LENGTH; -+ -+ bandwidth = *((u32*)poid_par_priv->information_buf);//4 -+ channel_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if (bandwidth != CHANNEL_WIDTH_40) -+ bandwidth = CHANNEL_WIDTH_20; -+ padapter->mppriv.bandwidth = (u8)bandwidth; -+ padapter->mppriv.prime_channel_offset = (u8)channel_offset; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetBandwidth(padapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("-oid_rt_set_bandwidth_hdl: bandwidth=%d channel_offset=%d\n", -+ bandwidth, channel_offset)); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u32 antenna; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_set_antenna_bb_hdl\n")); -+ -+ if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return uint_INVALID_LENGTH; -+ -+ if (poid_par_priv->type_of_oid == SET_OID) -+ { -+ antenna = *(u32*)poid_par_priv->information_buf; -+ -+ Adapter->mppriv.antenna_tx = (u16)((antenna & 0xFFFF0000) >> 16); -+ Adapter->mppriv.antenna_rx = (u16)(antenna & 0x0000FFFF); -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("oid_rt_pro_set_antenna_bb_hdl: tx_ant=0x%04x rx_ant=0x%04x\n", -+ Adapter->mppriv.antenna_tx, Adapter->mppriv.antenna_rx)); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetAntenna(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ } else { -+ antenna = (Adapter->mppriv.antenna_tx << 16)|Adapter->mppriv.antenna_rx; -+ *(u32*)poid_par_priv->information_buf = antenna; -+ } -+ -+ -+ -+ return status; -+} -+ -+uint oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u32 tx_pwr_idx; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("+oid_rt_pro_set_tx_power_control_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return uint_INVALID_LENGTH; -+ -+ tx_pwr_idx = *((u32*)poid_par_priv->information_buf); -+ if (tx_pwr_idx > MAX_TX_PWR_INDEX_N_MODE) -+ return uint_NOT_ACCEPTED; -+ -+ Adapter->mppriv.txpoweridx = (u8)tx_pwr_idx; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("oid_rt_pro_set_tx_power_control_hdl: idx=0x%2x\n", -+ Adapter->mppriv.txpoweridx)); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetTxPower(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+ -+//------------------------------------------------------------------------------ -+//**************** oid_rtl_seg_81_80_20 section start **************** -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid !=QUERY_OID) { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if (poid_par_priv->information_buf_len == sizeof(u32)) { -+ *(u32*)poid_par_priv->information_buf = Adapter->mppriv.tx_pktcount; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else { -+ status = uint_INVALID_LENGTH; -+ } -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ RT_TRACE(_module_mp_, _drv_alert_, ("===> oid_rt_pro_query_rx_packet_received_hdl.\n")); -+ if (poid_par_priv->information_buf_len == sizeof(u32)) { -+ *(u32*)poid_par_priv->information_buf = Adapter->mppriv.rx_pktcount; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ RT_TRACE(_module_mp_, _drv_alert_, ("recv_ok:%d \n",Adapter->mppriv.rx_pktcount)); -+ } else { -+ status = uint_INVALID_LENGTH; -+ } -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ RT_TRACE(_module_mp_, _drv_alert_, ("===> oid_rt_pro_query_rx_packet_crc32_error_hdl.\n")); -+ if (poid_par_priv->information_buf_len == sizeof(u32)) { -+ *(u32*)poid_par_priv->information_buf = Adapter->mppriv.rx_crcerrpktcount; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ RT_TRACE(_module_mp_, _drv_alert_, ("recv_err:%d \n",Adapter->mppriv.rx_crcerrpktcount)); -+ } else { -+ status = uint_INVALID_LENGTH; -+ } -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+ -+uint oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ RT_TRACE(_module_mp_, _drv_alert_, ("===> oid_rt_pro_reset_tx_packet_sent_hdl.\n")); -+ Adapter->mppriv.tx_pktcount = 0; -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ if (poid_par_priv->information_buf_len == sizeof(u32)) { -+ Adapter->mppriv.rx_pktcount = 0; -+ Adapter->mppriv.rx_crcerrpktcount = 0; -+ } else { -+ status = uint_INVALID_LENGTH; -+ } -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ ResetPhyRxPktCount(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("+oid_rt_get_phy_rx_packet_received_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return uint_INVALID_LENGTH; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ *(u32*)poid_par_priv->information_buf = GetPhyRxPktReceived(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("-oid_rt_get_phy_rx_packet_received_hdl: recv_ok=%d\n", *(u32*)poid_par_priv->information_buf)); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("+oid_rt_get_phy_rx_packet_crc32_error_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return uint_NOT_ACCEPTED; -+ -+ -+ if (poid_par_priv->information_buf_len != sizeof(u32)) -+ return uint_INVALID_LENGTH; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ *(u32*)poid_par_priv->information_buf = GetPhyRxPktCRC32Error(Adapter); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("-oid_rt_get_phy_rx_packet_crc32_error_hdl: recv_err=%d\n", *(u32*)poid_par_priv->information_buf)); -+ -+ -+ -+ return status; -+} -+//**************** oid_rtl_seg_81_80_20 section end **************** -+uint oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u32 bStartTest; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_set_continuous_tx_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ bStartTest = *((u32*)poid_par_priv->information_buf); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetContinuousTx(Adapter,(u8)bStartTest); -+ if (bStartTest) { -+ struct mp_priv *pmp_priv = &Adapter->mppriv; -+ if (pmp_priv->tx.stop == 0) { -+ pmp_priv->tx.stop = 1; -+ DBG_871X("%s: pkt tx is running...\n", __func__); -+ rtw_msleep_os(5); -+ } -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx.count = 1; -+ SetPacketTx(Adapter); -+ } -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+ -+uint oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u32 bStartTest; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_alert_, ("+oid_rt_pro_set_single_carrier_tx_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ bStartTest = *((u32*)poid_par_priv->information_buf); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetSingleCarrierTx(Adapter, (u8)bStartTest); -+ if (bStartTest) { -+ struct mp_priv *pmp_priv = &Adapter->mppriv; -+ if (pmp_priv->tx.stop == 0) { -+ pmp_priv->tx.stop = 1; -+ DBG_871X("%s: pkt tx is running...\n", __func__); -+ rtw_msleep_os(5); -+ } -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx.count = 1; -+ SetPacketTx(Adapter); -+ } -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+ -+uint oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u32 bStartTest; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_set_carrier_suppression_tx_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ bStartTest = *((u32*)poid_par_priv->information_buf); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetCarrierSuppressionTx(Adapter, (u8)bStartTest); -+ if (bStartTest) { -+ struct mp_priv *pmp_priv = &Adapter->mppriv; -+ if (pmp_priv->tx.stop == 0) { -+ pmp_priv->tx.stop = 1; -+ DBG_871X("%s: pkt tx is running...\n", __func__); -+ rtw_msleep_os(5); -+ } -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx.count = 1; -+ SetPacketTx(Adapter); -+ } -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+ -+uint oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u32 bStartTest; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_alert_, ("+oid_rt_pro_set_single_tone_tx_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ bStartTest = *((u32*)poid_par_priv->information_buf); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ SetSingleToneTx(Adapter,(u8)bStartTest); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+ -+uint oid_rt_pro_set_modulation_hdl(struct oid_par_priv* poid_par_priv) -+{ -+ return 0; -+} -+ -+uint oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ uint status = uint_SUCCESS; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ rtw_hal_set_hwreg(Adapter, HW_VAR_TRIGGER_GPIO_0, NULL); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ return status; -+} -+//**************** oid_rtl_seg_81_80_00 section end **************** -+//------------------------------------------------------------------------------ -+uint oid_rt_pro8711_join_bss_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_read_register_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ pRW_Reg RegRWStruct; -+ u32 offset, width; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("+oid_rt_pro_read_register_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return uint_NOT_ACCEPTED; -+ -+ RegRWStruct = (pRW_Reg)poid_par_priv->information_buf; -+ offset = RegRWStruct->offset; -+ width = RegRWStruct->width; -+ -+ if (offset > 0xFFF) -+ return uint_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ switch (width) { -+ case 1: -+ RegRWStruct->value = rtw_read8(Adapter, offset); -+ break; -+ case 2: -+ RegRWStruct->value = rtw_read16(Adapter, offset); -+ break; -+ default: -+ width = 4; -+ RegRWStruct->value = rtw_read32(Adapter, offset); -+ break; -+ } -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("oid_rt_pro_read_register_hdl: offset:0x%04X value:0x%X\n", -+ offset, RegRWStruct->value)); -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *poid_par_priv->bytes_rw = width; -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_write_register_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ pRW_Reg RegRWStruct; -+ u32 offset, width, value; -+ uint status = uint_SUCCESS; -+ PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("+oid_rt_pro_write_register_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ RegRWStruct = (pRW_Reg)poid_par_priv->information_buf; -+ offset = RegRWStruct->offset; -+ width = RegRWStruct->width; -+ value = RegRWStruct->value; -+ -+ if (offset > 0xFFF) -+ return uint_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ switch (RegRWStruct->width) -+ { -+ case 1: -+ if (value > 0xFF) { -+ status = uint_NOT_ACCEPTED; -+ break; -+ } -+ rtw_write8(padapter, offset, (u8)value); -+ break; -+ case 2: -+ if (value > 0xFFFF) { -+ status = uint_NOT_ACCEPTED; -+ break; -+ } -+ rtw_write16(padapter, offset, (u16)value); -+ break; -+ case 4: -+ rtw_write32(padapter, offset, value); -+ break; -+ default: -+ status = uint_NOT_ACCEPTED; -+ break; -+ } -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("-oid_rt_pro_write_register_hdl: offset=0x%08X width=%d value=0x%X\n", -+ offset, width, value)); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_burst_read_register_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_burst_write_register_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_write_txcmd_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+ -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+ -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_write16_eeprom_hdl (struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_rd_attrib_mem_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_wr_attrib_mem_hdl (struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_poll_rx_status_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ uint status = uint_SUCCESS; -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+OID_RT_PRO_SET_DATA_RATE_EX\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (rtw_setdatarate_cmd(Adapter, poid_par_priv->information_buf) !=_SUCCESS) -+ status = uint_NOT_ACCEPTED; -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+//----------------------------------------------------------------------------- -+uint oid_rt_get_thermal_meter_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ u8 thermal = 0; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_get_thermal_meter_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return uint_INVALID_LENGTH; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ GetThermalMeter(Adapter, &thermal); -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ *(u32*)poid_par_priv->information_buf = (u32)thermal; -+ *poid_par_priv->bytes_rw = sizeof(u32); -+ -+ -+ -+ return status; -+} -+//----------------------------------------------------------------------------- -+uint oid_rt_pro_read_tssi_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ if (poid_par_priv->information_buf_len < sizeof(u8)) -+ return uint_INVALID_LENGTH; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ if (poid_par_priv->type_of_oid == SET_OID) { -+ u8 enable; -+ -+ enable = *(u8*)poid_par_priv->information_buf; -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("+oid_rt_pro_set_power_tracking_hdl: enable=%d\n", enable)); -+ -+ SetPowerTracking(Adapter, enable); -+ } else { -+ GetPowerTracking(Adapter, (u8*)poid_par_priv->information_buf); -+ } -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+//----------------------------------------------------------------------------- -+uint oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+ -+//**************** oid_rtl_seg_87_12_00 section start **************** -+uint oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_add_sta_info_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+ -+uint oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return uint_SUCCESS; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ PEFUSE_ACCESS_STRUCT pefuse; -+ u8 *data; -+ u16 addr = 0, cnts = 0, max_available_size = 0; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(EFUSE_ACCESS_STRUCT)) -+ return uint_INVALID_LENGTH; -+ -+ pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf; -+ addr = pefuse->start_addr; -+ cnts = pefuse->cnts; -+ data = pefuse->data; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("+oid_rt_pro_read_efuse_hd: buf_len=%d addr=%d cnts=%d\n", -+ poid_par_priv->information_buf_len, addr, cnts)); -+ -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); -+ -+ if ((addr + cnts) > max_available_size) { -+ RT_TRACE(_module_mp_, _drv_err_, ("!oid_rt_pro_read_efuse_hdl: parameter error!\n")); -+ return uint_NOT_ACCEPTED; -+ } -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ if (rtw_efuse_access(Adapter, false, addr, cnts, data) == _FAIL) { -+ RT_TRACE(_module_mp_, _drv_err_, ("!oid_rt_pro_read_efuse_hdl: rtw_efuse_access FAIL!\n")); -+ status = uint_FAILURE; -+ } else -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ PEFUSE_ACCESS_STRUCT pefuse; -+ u8 *data; -+ u16 addr = 0, cnts = 0, max_available_size = 0; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf; -+ addr = pefuse->start_addr; -+ cnts = pefuse->cnts; -+ data = pefuse->data; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("+oid_rt_pro_write_efuse_hdl: buf_len=%d addr=0x%04x cnts=%d\n", -+ poid_par_priv->information_buf_len, addr, cnts)); -+ -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); -+ -+ if ((addr + cnts) > max_available_size) { -+ RT_TRACE(_module_mp_, _drv_err_, ("!oid_rt_pro_write_efuse_hdl: parameter error")); -+ return uint_NOT_ACCEPTED; -+ } -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ if (rtw_efuse_access(Adapter, true, addr, cnts, data) == _FAIL) -+ status = uint_FAILURE; -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ PPGPKT_STRUCT ppgpkt; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ *poid_par_priv->bytes_rw = 0; -+ -+ if (poid_par_priv->information_buf_len < sizeof(PGPKT_STRUCT)) -+ return uint_INVALID_LENGTH; -+ -+ ppgpkt = (PPGPKT_STRUCT)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (poid_par_priv->type_of_oid == QUERY_OID) -+ { -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("oid_rt_pro_rw_efuse_pgpkt_hdl: Read offset=0x%x\n",\ -+ ppgpkt->offset)); -+ -+ Efuse_PowerSwitch(Adapter, false, true); -+ if (Efuse_PgPacketRead(Adapter, ppgpkt->offset, ppgpkt->data, false) == true) -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ else -+ status = uint_FAILURE; -+ Efuse_PowerSwitch(Adapter, false, false); -+ } else { -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("oid_rt_pro_rw_efuse_pgpkt_hdl: Write offset=0x%x word_en=0x%x\n",\ -+ ppgpkt->offset, ppgpkt->word_en)); -+ -+ Efuse_PowerSwitch(Adapter, true, true); -+ if (Efuse_PgPacketWrite(Adapter, ppgpkt->offset, ppgpkt->word_en, ppgpkt->data, false) == true) -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ else -+ status = uint_FAILURE; -+ Efuse_PowerSwitch(Adapter, true, false); -+ } -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("-oid_rt_pro_rw_efuse_pgpkt_hdl: status=0x%08X\n", status)); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u16 size; -+ u8 ret; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len information_buf = size; -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ } else -+ status = uint_FAILURE; -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_efuse_max_size_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ if (poid_par_priv->type_of_oid != QUERY_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u32)) -+ return uint_INVALID_LENGTH; -+ -+ *(u32*)poid_par_priv->information_buf = efuse_GetMaxSize(Adapter); -+ *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; -+ -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("-oid_rt_get_efuse_max_size_hdl: size=%d status=0x%08X\n", -+ *(int*)poid_par_priv->information_buf, status)); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status; -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("+oid_rt_pro_efuse_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid == QUERY_OID) -+ status = oid_rt_pro_read_efuse_hdl(poid_par_priv); -+ else -+ status = oid_rt_pro_write_efuse_hdl(poid_par_priv); -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("-oid_rt_pro_efuse_hdl: status=0x%08X\n", status)); -+ -+ -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u8 *data; -+ uint status = uint_SUCCESS; -+ PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); -+ u16 mapLen=0; -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_pro_efuse_map_hdl\n")); -+ -+ EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, false); -+ -+ *poid_par_priv->bytes_rw = 0; -+ -+ if (poid_par_priv->information_buf_len < mapLen) -+ return uint_INVALID_LENGTH; -+ -+ data = (u8*)poid_par_priv->information_buf; -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ if (poid_par_priv->type_of_oid == QUERY_OID) -+ { -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("oid_rt_pro_efuse_map_hdl: READ\n")); -+ -+ if (rtw_efuse_map_read(Adapter, 0, mapLen, data) == _SUCCESS) -+ *poid_par_priv->bytes_rw = mapLen; -+ else { -+ RT_TRACE(_module_mp_, _drv_err_, -+ ("oid_rt_pro_efuse_map_hdl: READ fail\n")); -+ status = uint_FAILURE; -+ } -+ } else { -+ // SET_OID -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("oid_rt_pro_efuse_map_hdl: WRITE\n")); -+ -+ if (rtw_efuse_map_write(Adapter, 0, mapLen, data) == _SUCCESS) -+ *poid_par_priv->bytes_rw = mapLen; -+ else { -+ RT_TRACE(_module_mp_, _drv_err_, -+ ("oid_rt_pro_efuse_map_hdl: WRITE fail\n")); -+ status = uint_FAILURE; -+ } -+ } -+ -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("-oid_rt_pro_efuse_map_hdl: status=0x%08X\n", status)); -+ -+ -+ -+ return status; -+} -+ -+uint oid_rt_set_crystal_cap_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ uint status = uint_SUCCESS; -+ return status; -+} -+ -+uint oid_rt_set_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u8 rx_pkt_type; -+// u32 rcr_val32; -+ uint status = uint_SUCCESS; -+// PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -+ -+ -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+oid_rt_set_rx_packet_type_hdl\n")); -+ -+ if (poid_par_priv->type_of_oid != SET_OID) -+ return uint_NOT_ACCEPTED; -+ -+ if (poid_par_priv->information_buf_len < sizeof(u8)) -+ return uint_INVALID_LENGTH; -+ -+ rx_pkt_type = *((u8*)poid_par_priv->information_buf);//4 -+ -+ RT_TRACE(_module_mp_, _drv_info_, ("rx_pkt_type: %x\n",rx_pkt_type )); -+#if 0 -+ _irqlevel_changed_(&oldirql, LOWER); -+#if 0 -+ rcr_val8 = rtw_read8(Adapter, 0x10250048);//RCR -+ rcr_val8 &= ~(RCR_AB|RCR_AM|RCR_APM|RCR_AAP); -+ -+ if(rx_pkt_type == RX_PKT_BROADCAST){ -+ rcr_val8 |= (RCR_AB | RCR_ACRC32 ); -+ } -+ else if(rx_pkt_type == RX_PKT_DEST_ADDR){ -+ rcr_val8 |= (RCR_AAP| RCR_AM |RCR_ACRC32); -+ } -+ else if(rx_pkt_type == RX_PKT_PHY_MATCH){ -+ rcr_val8 |= (RCR_APM|RCR_ACRC32); -+ } -+ else{ -+ rcr_val8 &= ~(RCR_AAP|RCR_APM|RCR_AM|RCR_AB|RCR_ACRC32); -+ } -+ rtw_write8(padapter, 0x10250048,rcr_val8); -+#else -+ rcr_val32 = rtw_read32(padapter, RCR);//RCR = 0x10250048 -+ rcr_val32 &= ~(RCR_CBSSID|RCR_AB|RCR_AM|RCR_APM|RCR_AAP); -+#if 0 -+ if(rx_pkt_type == RX_PKT_BROADCAST){ -+ rcr_val32 |= (RCR_AB|RCR_AM|RCR_APM|RCR_AAP|RCR_ACRC32); -+ } -+ else if(rx_pkt_type == RX_PKT_DEST_ADDR){ -+ //rcr_val32 |= (RCR_CBSSID|RCR_AAP|RCR_AM|RCR_ACRC32); -+ rcr_val32 |= (RCR_CBSSID|RCR_APM|RCR_ACRC32); -+ } -+ else if(rx_pkt_type == RX_PKT_PHY_MATCH){ -+ rcr_val32 |= (RCR_APM|RCR_ACRC32); -+ //rcr_val32 |= (RCR_AAP|RCR_ACRC32); -+ } -+ else{ -+ rcr_val32 &= ~(RCR_AAP|RCR_APM|RCR_AM|RCR_AB|RCR_ACRC32); -+ } -+#else -+ switch (rx_pkt_type) -+ { -+ case RX_PKT_BROADCAST : -+ rcr_val32 |= (RCR_AB|RCR_AM|RCR_APM|RCR_AAP|RCR_ACRC32); -+ break; -+ case RX_PKT_DEST_ADDR : -+ rcr_val32 |= (RCR_AB|RCR_AM|RCR_APM|RCR_AAP|RCR_ACRC32); -+ break; -+ case RX_PKT_PHY_MATCH: -+ rcr_val32 |= (RCR_APM|RCR_ACRC32); -+ break; -+ default: -+ rcr_val32 &= ~(RCR_AAP|RCR_APM|RCR_AM|RCR_AB|RCR_ACRC32); -+ break; -+ } -+ -+ if (rx_pkt_type == RX_PKT_DEST_ADDR) { -+ padapter->mppriv.check_mp_pkt = 1; -+ } else { -+ padapter->mppriv.check_mp_pkt = 0; -+ } -+#endif -+ rtw_write32(padapter, RCR, rcr_val32); -+ -+#endif -+ _irqlevel_changed_(&oldirql, RAISE); -+#endif -+ -+ -+ return status; -+} -+ -+uint oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+ -+uint oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -+ -+unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ PMP_XMIT_PARM pparm; -+ PADAPTER padapter; -+ struct mp_priv *pmp_priv; -+ struct pkt_attrib *pattrib; -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("+%s\n", __func__)); -+ -+ pparm = (PMP_XMIT_PARM)poid_par_priv->information_buf; -+ padapter = (PADAPTER)poid_par_priv->adapter_context; -+ pmp_priv = &padapter->mppriv; -+ -+ if (poid_par_priv->type_of_oid == QUERY_OID) { -+ pparm->enable = !pmp_priv->tx.stop; -+ pparm->count = pmp_priv->tx.sended; -+ } else { -+ if (pparm->enable == 0) { -+ pmp_priv->tx.stop = 1; -+ } else if (pmp_priv->tx.stop == 1) { -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx.count = pparm->count; -+ pmp_priv->tx.payload = pparm->payload_type; -+ pattrib = &pmp_priv->tx.attrib; -+ pattrib->pktlen = pparm->length; -+ _rtw_memcpy(pattrib->dst, pparm->da, ETH_ALEN); -+ SetPacketTx(padapter); -+ } else -+ return uint_FAILURE; -+ } -+ -+ return uint_SUCCESS; -+} -+ -+#if 0 -+unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ unsigned char *pframe, *pmp_pkt; -+ struct ethhdr *pethhdr; -+ struct pkt_attrib *pattrib; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ int llc_sz, payload_len; -+ struct mp_xmit_frame *pxframe= NULL; -+ struct mp_xmit_packet *pmp_xmitpkt = (struct mp_xmit_packet*)param; -+ u8 addr3[] = {0x02, 0xE0, 0x4C, 0x87, 0x66, 0x55}; -+ -+// DBG_871X("+mp_ioctl_xmit_packet_hdl\n"); -+ -+ pxframe = alloc_mp_xmitframe(&padapter->mppriv); -+ if (pxframe == NULL) -+ { -+ DEBUG_ERR(("Can't alloc pmpframe %d:%s\n", __LINE__, __FILE__)); -+ return -1; -+ } -+ -+ //mp_xmit_pkt -+ payload_len = pmp_xmitpkt->len - 14; -+ pmp_pkt = (unsigned char*)pmp_xmitpkt->mem; -+ pethhdr = (struct ethhdr *)pmp_pkt; -+ -+ //DBG_871X("payload_len=%d, pkt_mem=0x%x\n", pmp_xmitpkt->len, (void*)pmp_xmitpkt->mem); -+ -+ //DBG_871X("pxframe=0x%x\n", (void*)pxframe); -+ //DBG_871X("pxframe->mem=0x%x\n", (void*)pxframe->mem); -+ -+ //update attribute -+ pattrib = &pxframe->attrib; -+ memset((u8 *)(pattrib), 0, sizeof (struct pkt_attrib)); -+ pattrib->pktlen = pmp_xmitpkt->len; -+ pattrib->ether_type = ntohs(pethhdr->h_proto); -+ pattrib->hdrlen = 24; -+ pattrib->nr_frags = 1; -+ pattrib->priority = 0; -+#ifndef CONFIG_MP_LINUX -+ if(IS_MCAST(pethhdr->h_dest)) -+ pattrib->mac_id = 4; -+ else -+ pattrib->mac_id = 5; -+#else -+ pattrib->mac_id = 5; -+#endif -+ -+ // -+ memset(pxframe->mem, 0 , WLANHDR_OFFSET); -+ pframe = (u8 *)(pxframe->mem) + WLANHDR_OFFSET; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ SetFrameSubType(pframe, WIFI_DATA); -+ -+ _rtw_memcpy(pwlanhdr->addr1, pethhdr->h_dest, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pethhdr->h_source, ETH_ALEN); -+ -+ _rtw_memcpy(pwlanhdr->addr3, addr3, ETH_ALEN); -+ -+ pwlanhdr->seq_ctl = 0; -+ pframe += pattrib->hdrlen; -+ -+ llc_sz= rtw_put_snap(pframe, pattrib->ether_type); -+ pframe += llc_sz; -+ -+ _rtw_memcpy(pframe, (void*)(pmp_pkt+14), payload_len); -+ -+ pattrib->last_txcmdsz = pattrib->hdrlen + llc_sz + payload_len; -+ -+ DEBUG_INFO(("issuing mp_xmit_frame, tx_len=%d, ether_type=0x%x\n", pattrib->last_txcmdsz, pattrib->ether_type)); -+ xmit_mp_frame(padapter, pxframe); -+ -+ return _SUCCESS; -+} -+#endif -+//------------------------------------------------------------------------------ -+uint oid_rt_set_power_down_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ u8 bpwrup; -+ uint status = uint_SUCCESS; -+ -+ if (poid_par_priv->type_of_oid != SET_OID) { -+ status = uint_NOT_ACCEPTED; -+ return status; -+ } -+ -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("\n ===> Setoid_rt_set_power_down_hdl.\n")); -+ -+ _irqlevel_changed_(&oldirql, LOWER); -+ -+ bpwrup = *(u8 *)poid_par_priv->information_buf; -+ //CALL the power_down function -+ _irqlevel_changed_(&oldirql, RAISE); -+ -+ return status; -+} -+//------------------------------------------------------------------------------ -+uint oid_rt_get_power_mode_hdl(struct oid_par_priv *poid_par_priv) -+{ -+ return 0; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_p2p.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_p2p.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_p2p.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_p2p.c 2018-02-06 17:42:30.698966987 +0200 -@@ -0,0 +1,5130 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_P2P_C_ -+ -+#include -+ -+#ifdef CONFIG_P2P -+ -+static int rtw_p2p_is_channel_list_ok( u8 desired_ch, u8* ch_list, u8 ch_cnt ) -+{ -+ int found = 0, i = 0; -+ -+ for( i = 0; i < ch_cnt; i++ ) -+ { -+ if ( ch_list[ i ] == desired_ch ) -+ { -+ found = 1; -+ break; -+ } -+ } -+ return( found ); -+} -+ -+static int is_any_client_associated(_adapter *padapter) -+{ -+ return padapter->stapriv.asoc_list_cnt ? true : false; -+} -+ -+static u32 go_add_group_info_attr(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ u32 len=0; -+ u16 attr_len = 0; -+ u8 tmplen, *pdata_attr, *pstart, *pcur; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = pwdinfo->padapter; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ pdata_attr = rtw_zmalloc(MAX_P2P_IE_LEN); -+ -+ pstart = pdata_attr; -+ pcur = pdata_attr; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ //look up sta asoc_queue -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ -+ if(psta->is_p2p_device) -+ { -+ tmplen = 0; -+ -+ pcur++; -+ -+ //P2P device address -+ _rtw_memcpy(pcur, psta->dev_addr, ETH_ALEN); -+ pcur += ETH_ALEN; -+ -+ //P2P interface address -+ _rtw_memcpy(pcur, psta->hwaddr, ETH_ALEN); -+ pcur += ETH_ALEN; -+ -+ *pcur = psta->dev_cap; -+ pcur++; -+ -+ //*(u16*)(pcur) = cpu_to_be16(psta->config_methods); -+ RTW_PUT_BE16(pcur, psta->config_methods); -+ pcur += 2; -+ -+ _rtw_memcpy(pcur, psta->primary_dev_type, 8); -+ pcur += 8; -+ -+ *pcur = psta->num_of_secdev_type; -+ pcur++; -+ -+ _rtw_memcpy(pcur, psta->secdev_types_list, psta->num_of_secdev_type*8); -+ pcur += psta->num_of_secdev_type*8; -+ -+ if(psta->dev_name_len>0) -+ { -+ //*(u16*)(pcur) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ RTW_PUT_BE16(pcur, WPS_ATTR_DEVICE_NAME); -+ pcur += 2; -+ -+ //*(u16*)(pcur) = cpu_to_be16( psta->dev_name_len ); -+ RTW_PUT_BE16(pcur, psta->dev_name_len); -+ pcur += 2; -+ -+ _rtw_memcpy(pcur, psta->dev_name, psta->dev_name_len); -+ pcur += psta->dev_name_len; -+ } -+ -+ -+ tmplen = (u8)(pcur-pstart); -+ -+ *pstart = (tmplen-1); -+ -+ attr_len += tmplen; -+ -+ //pstart += tmplen; -+ pstart = pcur; -+ -+ } -+ -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ if(attr_len>0) -+ { -+ len = rtw_set_p2p_attr_content(pbuf, P2P_ATTR_GROUP_INFO, attr_len, pdata_attr); -+ } -+ -+ rtw_mfree(pdata_attr, MAX_P2P_IE_LEN); -+ -+ return len; -+ -+} -+ -+static void issue_group_disc_req(struct wifidirect_info *pwdinfo, u8 *da) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ _adapter *padapter = pwdinfo->padapter; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ unsigned char category = RTW_WLAN_CATEGORY_P2P;//P2P action frame -+ __be32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_GO_DISC_REQUEST; -+ u8 dialogToken=0; -+ -+ DBG_871X("[%s]\n", __FUNCTION__); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pwdinfo->interface_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->interface_addr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ //Build P2P action frame header -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ //there is no IE in this P2P action frame -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+} -+ -+static void issue_p2p_devdisc_resp(struct wifidirect_info *pwdinfo, u8 *da, u8 status, u8 dialogToken) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ _adapter *padapter = pwdinfo->padapter; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ __be32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_DEVDISC_RESP; -+ u8 p2pie[8] = { 0x00 }; -+ u32 p2pielen = 0; -+ -+ DBG_871X("[%s]\n", __FUNCTION__); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pwdinfo->device_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->device_addr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ //Build P2P public action frame header -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ -+ //Build P2P IE -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // P2P_ATTR_STATUS -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_STATUS, 1, &status); -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, p2pie, &pattrib->pktlen); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+} -+ -+static void issue_p2p_provision_resp(struct wifidirect_info *pwdinfo, u8* raddr, u8* frame_body, u16 config_method) -+{ -+ _adapter *padapter = pwdinfo->padapter; -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u8 dialogToken = frame_body[7]; // The Dialog Token of provisioning discovery request frame. -+ __be32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_PROVISION_DISC_RESP; -+ u8 wpsie[ 100 ] = { 0x00 }; -+ u8 wpsielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, raddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ wpsielen = 0; -+ // WPS OUI -+ //*(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); -+ RTW_PUT_BE32(wpsie, WPSOUI); -+ wpsielen += 4; -+ -+#if 0 -+ // WPS version -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_VERSION_1; // Version 1.0 -+#endif -+ -+ // Config Method -+ // Type: -+ //*(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); -+ RTW_PUT_BE16(wpsie + wpsielen, WPS_ATTR_CONF_METHOD); -+ wpsielen += 2; -+ -+ // Length: -+ //*(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); -+ RTW_PUT_BE16(wpsie + wpsielen, 0x0002); -+ wpsielen += 2; -+ -+ // Value: -+ //*(u16*) ( wpsie + wpsielen ) = cpu_to_be16( config_method ); -+ RTW_PUT_BE16(wpsie + wpsielen, config_method); -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_provdisc_resp_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif //CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+ -+} -+ -+static void issue_p2p_presence_resp(struct wifidirect_info *pwdinfo, u8 *da, u8 status, u8 dialogToken) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ _adapter *padapter = pwdinfo->padapter; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ unsigned char category = RTW_WLAN_CATEGORY_P2P;//P2P action frame -+ __be32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_PRESENCE_RESPONSE; -+ u8 p2pie[ MAX_P2P_IE_LEN] = { 0x00 }; -+ u8 noa_attr_content[32] = { 0x00 }; -+ u32 p2pielen = 0; -+ -+ DBG_871X("[%s]\n", __FUNCTION__); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pwdinfo->interface_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->interface_addr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ //Build P2P action frame header -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ -+ //Add P2P IE header -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ //Add Status attribute in P2P IE -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_STATUS, 1, &status); -+ -+ //Add NoA attribute in P2P IE -+ noa_attr_content[0] = 0x1;//index -+ noa_attr_content[1] = 0x0;//CTWindow and OppPS Parameters -+ -+ //todo: Notice of Absence Descriptor(s) -+ -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_NOA, 2, noa_attr_content); -+ -+ -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, p2pie, &(pattrib->pktlen)); -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+} -+ -+u32 build_beacon_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 p2pie[ MAX_P2P_IE_LEN] = { 0x00 }; -+ u16 capability=0; -+ u32 len=0, p2pielen = 0; -+ __le16 le_tmp; -+ -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ -+ // According to the P2P Specification, the beacon frame should contain 3 P2P attributes -+ // 1. P2P Capability -+ // 2. P2P Device ID -+ // 3. Notice of Absence ( NOA ) -+ -+ // P2P Capability ATTR -+ // Type: -+ // Length: -+ // Value: -+ // Device Capability Bitmap, 1 byte -+ // Be able to participate in additional P2P Groups and -+ // support the P2P Invitation Procedure -+ // Group Capability Bitmap, 1 byte -+ capability = P2P_DEVCAP_INVITATION_PROC|P2P_DEVCAP_CLIENT_DISCOVERABILITY; -+ capability |= ((P2P_GRPCAP_GO | P2P_GRPCAP_INTRABSS) << 8); -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) -+ capability |= (P2P_GRPCAP_GROUP_FORMATION<<8); -+ -+ le_tmp = cpu_to_le16(capability); -+ -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_CAPABILITY, 2, (u8*)&le_tmp); -+ -+ // P2P Device ID ATTR -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_DEVICE_ID, ETH_ALEN, pwdinfo->device_addr); -+ -+ // Notice of Absence ATTR -+ // Type: -+ // Length: -+ // Value: -+ -+ //go_add_noa_attr(pwdinfo); -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); -+ -+ return len; -+} -+ -+#ifdef CONFIG_WFD -+u32 build_beacon_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110812 -+ // According to the WFD Specification, the beacon frame should contain 4 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID -+ // 3. Coupled Sink Information -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ -+ if ( P2P_ROLE_GO == pwdinfo->role ) -+ { -+ if ( is_any_client_associated( pwdinfo->padapter ) ) -+ { -+ // WFD primary sink + WiFi Direct mode + WSD (WFD Service Discovery) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD ); -+ } -+ else -+ { -+ // WFD primary sink + available for WFD session + WiFi Direct mode + WSD (WFD Service Discovery) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); -+ } -+ -+ } -+ else -+ { -+ // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); -+ } -+ -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_probe_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110812 -+ // According to the WFD Specification, the probe request frame should contain 4 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID -+ // 3. Coupled Sink Information -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ -+ if ( 1 == pwdinfo->wfd_tdls_enable ) -+ { -+ // WFD primary sink + available for WFD session + WiFi TDLS mode + WSC ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | -+ WFD_DEVINFO_SESSION_AVAIL | -+ WFD_DEVINFO_WSD | -+ WFD_DEVINFO_PC_TDLS ); -+ } -+ else -+ { -+ // WFD primary sink + available for WFD session + WiFi Direct mode + WSC ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | -+ WFD_DEVINFO_SESSION_AVAIL | -+ WFD_DEVINFO_WSD ); -+ } -+ -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_probe_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 tunneled) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110812 -+ // According to the WFD Specification, the probe response frame should contain 4 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID -+ // 3. Coupled Sink Information -+ // 4. WFD Session Information -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ // WFD primary sink + available for WFD session + WiFi Direct mode -+ -+ if ( true == pwdinfo->session_available ) -+ { -+ if ( P2P_ROLE_GO == pwdinfo->role ) -+ { -+ if ( is_any_client_associated( pwdinfo->padapter ) ) -+ { -+ if ( pwdinfo->wfd_tdls_enable ) -+ { -+ // TDLS mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); -+ } -+ else -+ { -+ // WiFi Direct mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); -+ } -+ } -+ else -+ { -+ if ( pwdinfo->wfd_tdls_enable ) -+ { -+ // available for WFD session + TDLS mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); -+ } -+ else -+ { -+ // available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); -+ } -+ } -+ } -+ else -+ { -+ if ( pwdinfo->wfd_tdls_enable ) -+ { -+ // available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); -+ } -+ else -+ { -+ -+ // available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); -+ } -+ } -+ } -+ else -+ { -+ if ( pwdinfo->wfd_tdls_enable ) -+ { -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD |WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); -+ } -+ else -+ { -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); -+ } -+ -+ } -+ -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ // WFD Session Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_SESSION_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0000); -+ wfdielen += 2; -+ -+ // Todo: to add the list of WFD device info descriptor in WFD group. -+ -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_TDLS -+ if ( ( tunneled == 0 ) && ( padapter->pbuddy_adapter->wdinfo.wfd_tdls_enable == 1 ) ) -+ { -+ // Alternative MAC Address ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ALTER_MAC; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, ETH_ALEN ); -+ wfdielen += 2; -+ -+ // Value: -+ // Alternative MAC Address -+ _rtw_memcpy( wfdie + wfdielen, &padapter->pbuddy_adapter->eeprompriv.mac_addr[ 0 ], ETH_ALEN ); -+ // This mac address is used to make the WFD session when TDLS is enable. -+ -+ wfdielen += ETH_ALEN; -+ } -+#endif // CONFIG_TDLS -+#endif // CONFIG_CONCURRENT_MODE -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_assoc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ _adapter *padapter = NULL; -+ struct mlme_priv *pmlmepriv = NULL; -+ struct wifi_display_info *pwfd_info = NULL; -+ -+ // WFD OUI -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) -+ { -+ return 0; -+ } -+ -+ padapter = pwdinfo->padapter; -+ pmlmepriv = &padapter->mlmepriv; -+ pwfd_info = padapter->wdinfo.wfd_info; -+ -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110812 -+ // According to the WFD Specification, the probe request frame should contain 4 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID -+ // 3. Coupled Sink Information -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_assoc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110812 -+ // According to the WFD Specification, the probe request frame should contain 4 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID -+ // 3. Coupled Sink Information -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_nego_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110825 -+ // According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID ( Optional ) -+ // 3. Local IP Adress ( Optional ) -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ // WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL); -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_nego_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110825 -+ // According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID ( Optional ) -+ // 3. Local IP Adress ( Optional ) -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ // WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL); -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_nego_confirm_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110825 -+ // According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID ( Optional ) -+ // 3. Local IP Adress ( Optional ) -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ // WFD primary sink + WiFi Direct mode + WSD ( WFD Service Discovery ) + WFD Session Available -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_SESSION_AVAIL); -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_invitation_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110825 -+ // According to the WFD Specification, the provision discovery request frame should contain 3 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID ( Optional ) -+ // 3. Local IP Adress ( Optional ) -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ if ( P2P_ROLE_GO == pwdinfo->role ) -+ { -+ // WFD Session Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_SESSION_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0000); -+ wfdielen += 2; -+ -+ // Todo: to add the list of WFD device info descriptor in WFD group. -+ -+ } -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_invitation_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110825 -+ // According to the WFD Specification, the provision discovery request frame should contain 3 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID ( Optional ) -+ // 3. Local IP Adress ( Optional ) -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ if ( P2P_ROLE_GO == pwdinfo->role ) -+ { -+ // WFD Session Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_SESSION_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0000); -+ wfdielen += 2; -+ -+ // Todo: to add the list of WFD device info descriptor in WFD group. -+ -+ } -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_provdisc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110825 -+ // According to the WFD Specification, the provision discovery request frame should contain 3 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID ( Optional ) -+ // 3. Local IP Adress ( Optional ) -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_provdisc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 len=0, wfdielen = 0; -+ _adapter *padapter = pwdinfo->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info* pwfd_info = padapter->wdinfo.wfd_info; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110825 -+ // According to the WFD Specification, the provision discovery response frame should contain 3 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID ( Optional ) -+ // 3. Local IP Adress ( Optional ) -+ -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ // WFD primary sink + available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD ); -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate(pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ wfdielen += ETH_ALEN; -+ -+ // Coupled Sink Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_COUPLED_SINK_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0007); -+ wfdielen += 2; -+ -+ // Value: -+ // Coupled Sink Status bitmap -+ // Not coupled/available for Coupling -+ wfdie[ wfdielen++ ] = 0; -+ // MAC Addr. -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ wfdie[ wfdielen++ ] = 0; -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, &len); -+ -+ return len; -+ -+} -+ -+ -+#endif //CONFIG_WFD -+ -+u32 build_probe_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u8 p2pie[ MAX_P2P_IE_LEN] = { 0x00 }; -+ u32 len=0, p2pielen = 0; -+#ifdef CONFIG_INTEL_WIDI -+ u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; -+#endif //CONFIG_INTEL_WIDI -+ -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20100907 -+ // According to the P2P Specification, the probe response frame should contain 5 P2P attributes -+ // 1. P2P Capability -+ // 2. Extended Listen Timing -+ // 3. Notice of Absence ( NOA ) ( Only GO needs this ) -+ // 4. Device Info -+ // 5. Group Info ( Only GO need this ) -+ -+ // P2P Capability ATTR -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; -+ -+ // Length: -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ RTW_PUT_LE16(p2pie + p2pielen, 0x0002); -+ p2pielen += 2; -+ -+ // Value: -+ // Device Capability Bitmap, 1 byte -+ p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; -+ -+ // Group Capability Bitmap, 1 byte -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ p2pie[ p2pielen ] = (P2P_GRPCAP_GO | P2P_GRPCAP_INTRABSS); -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) -+ p2pie[ p2pielen ] |= P2P_GRPCAP_GROUP_FORMATION; -+ -+ p2pielen++; -+ } -+ else if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) ) -+ { -+ // Group Capability Bitmap, 1 byte -+ if ( pwdinfo->persistent_supported ) -+ p2pie[ p2pielen++ ] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; -+ else -+ p2pie[ p2pielen++ ] = DMP_P2P_GRPCAP_SUPPORT; -+ } -+ -+ // Extended Listen Timing ATTR -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_EX_LISTEN_TIMING; -+ -+ // Length: -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0004 ); -+ RTW_PUT_LE16(p2pie + p2pielen, 0x0004); -+ p2pielen += 2; -+ -+ // Value: -+ // Availability Period -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); -+ RTW_PUT_LE16(p2pie + p2pielen, 0xFFFF); -+ p2pielen += 2; -+ -+ // Availability Interval -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0xFFFF ); -+ RTW_PUT_LE16(p2pie + p2pielen, 0xFFFF); -+ p2pielen += 2; -+ -+ -+ // Notice of Absence ATTR -+ // Type: -+ // Length: -+ // Value: -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ //go_add_noa_attr(pwdinfo); -+ } -+ -+ // Device Info ATTR -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) -+ // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); -+#ifdef CONFIG_INTEL_WIDI -+ if( _rtw_memcmp( pwdinfo->padapter->mlmepriv.sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN ) == false ) -+ { -+ RTW_PUT_LE16(p2pie + p2pielen, 21 + 8 + pwdinfo->device_name_len); -+ } -+ else -+#endif //CONFIG_INTEL_WIDI -+ RTW_PUT_LE16(p2pie + p2pielen, 21 + pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ // Value: -+ // P2P Device Address -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ // Config Method -+ // This field should be big endian. Noted by P2P specification. -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->supported_wps_cm ); -+ RTW_PUT_BE16(p2pie + p2pielen, pwdinfo->supported_wps_cm); -+ p2pielen += 2; -+ -+ // Primary Device Type -+ // Category ID -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_MULIT_MEDIA); -+ p2pielen += 2; -+ -+ // OUI -+ //*(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); -+ RTW_PUT_BE32(p2pie + p2pielen, WPSOUI); -+ p2pielen += 4; -+ -+ // Sub Category ID -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_SCID_MEDIA_SERVER); -+ p2pielen += 2; -+ -+ // Number of Secondary Device Types -+#ifdef CONFIG_INTEL_WIDI -+ if( _rtw_memcmp( pwdinfo->padapter->mlmepriv.sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN ) == false ) -+ { -+ p2pie[ p2pielen++ ] = 0x01; -+ -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_DISPLAYS); -+ p2pielen += 2; -+ -+ RTW_PUT_BE32(p2pie + p2pielen, INTEL_DEV_TYPE_OUI); -+ p2pielen += 4; -+ -+ RTW_PUT_BE16(p2pie + p2pielen, P2P_SCID_WIDI_CONSUMER_SINK); -+ p2pielen += 2; -+ } -+ else -+#endif //CONFIG_INTEL_WIDI -+ p2pie[ p2pielen++ ] = 0x00; // No Secondary Device Type List -+ -+ // Device Name -+ // Type: -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_ATTR_DEVICE_NAME); -+ p2pielen += 2; -+ -+ // Length: -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); -+ RTW_PUT_BE16(p2pie + p2pielen, pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len ); -+ p2pielen += pwdinfo->device_name_len; -+ -+ // Group Info ATTR -+ // Type: -+ // Length: -+ // Value: -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ p2pielen += go_add_group_info_attr(pwdinfo, p2pie + p2pielen); -+ } -+ -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); -+ -+ -+ return len; -+ -+} -+ -+u32 build_prov_disc_request_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8* pssid, u8 ussidlen, u8* pdev_raddr ) -+{ -+ u8 p2pie[ MAX_P2P_IE_LEN] = { 0x00 }; -+ u32 len=0, p2pielen = 0; -+ -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20110301 -+ // According to the P2P Specification, the provision discovery request frame should contain 3 P2P attributes -+ // 1. P2P Capability -+ // 2. Device Info -+ // 3. Group ID ( When joining an operating P2P Group ) -+ -+ // P2P Capability ATTR -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; -+ -+ // Length: -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ RTW_PUT_LE16(p2pie + p2pielen, 0x0002); -+ p2pielen += 2; -+ -+ // Value: -+ // Device Capability Bitmap, 1 byte -+ p2pie[ p2pielen++ ] = DMP_P2P_DEVCAP_SUPPORT; -+ -+ // Group Capability Bitmap, 1 byte -+ if ( pwdinfo->persistent_supported ) -+ p2pie[ p2pielen++ ] = P2P_GRPCAP_PERSISTENT_GROUP | DMP_P2P_GRPCAP_SUPPORT; -+ else -+ p2pie[ p2pielen++ ] = DMP_P2P_GRPCAP_SUPPORT; -+ -+ -+ // Device Info ATTR -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) -+ // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); -+ RTW_PUT_LE16(p2pie + p2pielen, 21 + pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ // Value: -+ // P2P Device Address -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_addr, ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ // Config Method -+ // This field should be big endian. Noted by P2P specification. -+ if ( pwdinfo->ui_got_wps_info == P2P_GOT_WPSINFO_PBC ) -+ { -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_PBC ); -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_CONFIG_METHOD_PBC); -+ } -+ else -+ { -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_CONFIG_METHOD_DISPLAY ); -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_CONFIG_METHOD_DISPLAY); -+ } -+ -+ p2pielen += 2; -+ -+ // Primary Device Type -+ // Category ID -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_MULIT_MEDIA); -+ p2pielen += 2; -+ -+ // OUI -+ //*(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); -+ RTW_PUT_BE32(p2pie + p2pielen, WPSOUI); -+ p2pielen += 4; -+ -+ // Sub Category ID -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_SCID_MEDIA_SERVER); -+ p2pielen += 2; -+ -+ // Number of Secondary Device Types -+ p2pie[ p2pielen++ ] = 0x00; // No Secondary Device Type List -+ -+ // Device Name -+ // Type: -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_ATTR_DEVICE_NAME ); -+ RTW_PUT_BE16(p2pie + p2pielen, WPS_ATTR_DEVICE_NAME); -+ p2pielen += 2; -+ -+ // Length: -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_be16( pwdinfo->device_name_len ); -+ RTW_PUT_BE16(p2pie + p2pielen, pwdinfo->device_name_len); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy( p2pie + p2pielen, pwdinfo->device_name, pwdinfo->device_name_len ); -+ p2pielen += pwdinfo->device_name_len; -+ -+ if ( rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) ) -+ { -+ // Added by Albert 2011/05/19 -+ // In this case, the pdev_raddr is the device address of the group owner. -+ -+ // P2P Group ID ATTR -+ // Type: -+ p2pie[ p2pielen++ ] = P2P_ATTR_GROUP_ID; -+ -+ // Length: -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( ETH_ALEN + ussidlen ); -+ RTW_PUT_LE16(p2pie + p2pielen, ETH_ALEN + ussidlen); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy( p2pie + p2pielen, pdev_raddr, ETH_ALEN ); -+ p2pielen += ETH_ALEN; -+ -+ _rtw_memcpy( p2pie + p2pielen, pssid, ussidlen ); -+ p2pielen += ussidlen; -+ -+ } -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); -+ -+ -+ return len; -+ -+} -+ -+ -+u32 build_assoc_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 status_code) -+{ -+ u8 p2pie[ MAX_P2P_IE_LEN] = { 0x00 }; -+ u32 len=0, p2pielen = 0; -+ -+ // P2P OUI -+ p2pielen = 0; -+ p2pie[ p2pielen++ ] = 0x50; -+ p2pie[ p2pielen++ ] = 0x6F; -+ p2pie[ p2pielen++ ] = 0x9A; -+ p2pie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // According to the P2P Specification, the Association response frame should contain 2 P2P attributes -+ // 1. Status -+ // 2. Extended Listen Timing (optional) -+ -+ -+ // Status ATTR -+ p2pielen += rtw_set_p2p_attr_content(&p2pie[p2pielen], P2P_ATTR_STATUS, 1, &status_code); -+ -+ -+ // Extended Listen Timing ATTR -+ // Type: -+ // Length: -+ // Value: -+ -+ -+ pbuf = rtw_set_ie(pbuf, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &len); -+ -+ return len; -+ -+} -+ -+u32 build_deauth_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) -+{ -+ u32 len=0; -+ -+ return len; -+} -+ -+u32 process_probe_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ -+ u8 *p; -+ u32 ret=false; -+ u8 *p2pie; -+ u32 p2pielen = 0; -+ int ssid_len=0, rate_cnt = 0; -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _SUPPORTEDRATES_IE_, (int *)&rate_cnt, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); -+ -+ if ( rate_cnt <= 4 ) -+ { -+ int i, g_rate =0; -+ -+ for( i = 0; i < rate_cnt; i++ ) -+ { -+ if ( ( ( *( p + 2 + i ) & 0xff ) != 0x02 ) && -+ ( ( *( p + 2 + i ) & 0xff ) != 0x04 ) && -+ ( ( *( p + 2 + i ) & 0xff ) != 0x0B ) && -+ ( ( *( p + 2 + i ) & 0xff ) != 0x16 ) ) -+ { -+ g_rate = 1; -+ } -+ } -+ -+ if ( g_rate == 0 ) -+ { -+ // There is no OFDM rate included in SupportedRates IE of this probe request frame -+ // The driver should response this probe request. -+ return ret; -+ } -+ } -+ else -+ { -+ // rate_cnt > 4 means the SupportRates IE contains the OFDM rate because the count of CCK rates are 4. -+ // We should proceed the following check for this probe request. -+ } -+ -+ // Added comments by Albert 20100906 -+ // There are several items we should check here. -+ // 1. This probe request frame must contain the P2P IE. (Done) -+ // 2. This probe request frame must contain the wildcard SSID. (Done) -+ // 3. Wildcard BSSID. (Todo) -+ // 4. Destination Address. ( Done in mgt_dispatcher function ) -+ // 5. Requested Device Type in WSC IE. (Todo) -+ // 6. Device ID attribute in P2P IE. (Todo) -+ -+ p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, _SSID_IE_, (int *)&ssid_len, -+ len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); -+ -+ ssid_len &= 0xff; // Just last 1 byte is valid for ssid len of the probe request -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ if((p2pie=rtw_get_p2p_ie( pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_ , len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_ , NULL, &p2pielen))) -+ { -+ if ( (p != NULL) && _rtw_memcmp( ( void * ) ( p+2 ), ( void * ) pwdinfo->p2p_wildcard_ssid , 7 )) -+ { -+ //todo: -+ //Check Requested Device Type attributes in WSC IE. -+ //Check Device ID attribute in P2P IE -+ -+ ret = true; -+ } -+ else if ( (p != NULL) && ( ssid_len == 0 ) ) -+ { -+ ret = true; -+ } -+ } -+ else -+ { -+ //non -p2p device -+ } -+ -+ } -+ -+ -+ return ret; -+ -+} -+ -+u32 process_assoc_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len, struct sta_info *psta) -+{ -+ u8 status_code = P2P_STATUS_SUCCESS; -+ u8 *pbuf, *pattr_content=NULL; -+ u32 attr_contentlen = 0; -+ u16 cap_attr=0; -+ unsigned short frame_type, ie_offset=0; -+ u8 * ies; -+ u32 ies_len; -+ u8 * p2p_ie; -+ u32 p2p_ielen = 0; -+ -+ if(!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ return P2P_STATUS_FAIL_REQUEST_UNABLE; -+ -+ frame_type = GetFrameSubType(pframe); -+ if (frame_type == WIFI_ASSOCREQ) -+ { -+ ie_offset = _ASOCREQ_IE_OFFSET_; -+ } -+ else // WIFI_REASSOCREQ -+ { -+ ie_offset = _REASOCREQ_IE_OFFSET_; -+ } -+ -+ ies = pframe + WLAN_HDR_A3_LEN + ie_offset; -+ ies_len = len - WLAN_HDR_A3_LEN - ie_offset; -+ -+ p2p_ie = rtw_get_p2p_ie(ies , ies_len , NULL, &p2p_ielen); -+ -+ if ( !p2p_ie ) -+ { -+ DBG_8192C( "[%s] P2P IE not Found!!\n", __FUNCTION__ ); -+ status_code = P2P_STATUS_FAIL_INVALID_PARAM; -+ } -+ else -+ { -+ DBG_8192C( "[%s] P2P IE Found!!\n", __FUNCTION__ ); -+ } -+ -+ while ( p2p_ie ) -+ { -+ //Check P2P Capability ATTR -+ if( rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8*)&cap_attr, (uint*) &attr_contentlen) ) -+ { -+ DBG_8192C( "[%s] Got P2P Capability Attr!!\n", __FUNCTION__ ); -+ le16_to_cpup((__le16 *)&cap_attr); -+ psta->dev_cap = cap_attr&0xff; -+ } -+ -+ //Check Extended Listen Timing ATTR -+ -+ -+ //Check P2P Device Info ATTR -+ if(rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO, NULL, (uint*)&attr_contentlen)) -+ { -+ DBG_8192C( "[%s] Got P2P DEVICE INFO Attr!!\n", __FUNCTION__ ); -+ pattr_content = pbuf = rtw_zmalloc(attr_contentlen); -+ if(pattr_content) -+ { -+ u8 num_of_secdev_type; -+ u16 dev_name_len; -+ -+ -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO , pattr_content, (uint*)&attr_contentlen); -+ -+ _rtw_memcpy(psta->dev_addr, pattr_content, ETH_ALEN);//P2P Device Address -+ -+ pattr_content += ETH_ALEN; -+ -+ _rtw_memcpy(&psta->config_methods, pattr_content, 2);//Config Methods -+ be16_to_cpup((__be16 *)&psta->config_methods); -+ -+ pattr_content += 2; -+ -+ _rtw_memcpy(psta->primary_dev_type, pattr_content, 8); -+ -+ pattr_content += 8; -+ -+ num_of_secdev_type = *pattr_content; -+ pattr_content += 1; -+ -+ if(num_of_secdev_type==0) -+ { -+ psta->num_of_secdev_type = 0; -+ } -+ else -+ { -+ u32 len; -+ -+ psta->num_of_secdev_type = num_of_secdev_type; -+ -+ len = (sizeof(psta->secdev_types_list)<(num_of_secdev_type*8)) ? (sizeof(psta->secdev_types_list)) : (num_of_secdev_type*8); -+ -+ _rtw_memcpy(psta->secdev_types_list, pattr_content, len); -+ -+ pattr_content += (num_of_secdev_type*8); -+ } -+ -+ -+ //dev_name_len = attr_contentlen - ETH_ALEN - 2 - 8 - 1 - (num_of_secdev_type*8); -+ psta->dev_name_len=0; -+ if(WPS_ATTR_DEVICE_NAME == be16_to_cpu(*(__be16*)pattr_content)) -+ { -+ dev_name_len = be16_to_cpu(*(__be16*)(pattr_content+2)); -+ -+ psta->dev_name_len = (sizeof(psta->dev_name)dev_name):dev_name_len; -+ -+ _rtw_memcpy(psta->dev_name, pattr_content+4, psta->dev_name_len); -+ } -+ -+ rtw_mfree(pbuf, attr_contentlen); -+ -+ } -+ -+ } -+ -+ //Get the next P2P IE -+ p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); -+ -+ } -+ -+ return status_code; -+ -+} -+ -+u32 process_p2p_devdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ -+ u8 *frame_body; -+ u8 status, dialogToken; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = pwdinfo->padapter; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *p2p_ie; -+ u32 p2p_ielen = 0; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ dialogToken = frame_body[7]; -+ status = P2P_STATUS_FAIL_UNKNOWN_P2PGROUP; -+ -+ if ( (p2p_ie=rtw_get_p2p_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen)) ) -+ { -+ u8 groupid[ 38 ] = { 0x00 }; -+ u8 dev_addr[ETH_ALEN] = { 0x00 }; -+ u32 attr_contentlen = 0; -+ -+ if(rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, groupid, &attr_contentlen)) -+ { -+ if(_rtw_memcmp(pwdinfo->device_addr, groupid, ETH_ALEN) && -+ _rtw_memcmp(pwdinfo->p2p_group_ssid, groupid+ETH_ALEN, pwdinfo->p2p_group_ssid_len)) -+ { -+ attr_contentlen=0; -+ if(rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_ID, dev_addr, &attr_contentlen)) -+ { -+ _irqL irqL; -+ _list *phead, *plist; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ //look up sta asoc_queue -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ if(psta->is_p2p_device && (psta->dev_cap&P2P_DEVCAP_CLIENT_DISCOVERABILITY) && -+ _rtw_memcmp(psta->dev_addr, dev_addr, ETH_ALEN)) -+ { -+ -+ //_exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ //issue GO Discoverability Request -+ issue_group_disc_req(pwdinfo, psta->hwaddr); -+ //_enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ status = P2P_STATUS_SUCCESS; -+ -+ break; -+ } -+ else -+ { -+ status = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ } -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ } -+ else -+ { -+ status = P2P_STATUS_FAIL_INVALID_PARAM; -+ } -+ -+ } -+ else -+ { -+ status = P2P_STATUS_FAIL_INVALID_PARAM; -+ } -+ -+ } -+ -+ } -+ -+ -+ //issue Device Discoverability Response -+ issue_p2p_devdisc_resp(pwdinfo, GetAddr2Ptr(pframe), status, dialogToken); -+ -+ -+ return (status==P2P_STATUS_SUCCESS) ? true:false; -+ -+} -+ -+u32 process_p2p_devdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ -+ return true; -+} -+ -+u8 process_p2p_provdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len ) -+{ -+ u8 *frame_body; -+ u8 *wpsie; -+ uint wps_ielen = 0, attr_contentlen = 0; -+ u16 uconfig_method = 0; -+ -+ -+ frame_body = (pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ if ( (wpsie=rtw_get_wps_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &wps_ielen)) ) -+ { -+ if ( rtw_get_wps_attr_content( wpsie, wps_ielen, WPS_ATTR_CONF_METHOD , ( u8* ) &uconfig_method, &attr_contentlen) ) -+ { -+ be16_to_cpup((__be16 *)&uconfig_method); -+ switch( uconfig_method ) -+ { -+ case WPS_CM_DISPLYA: -+ { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "dis", 3 ); -+ break; -+ } -+ case WPS_CM_LABEL: -+ { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "lab", 3 ); -+ break; -+ } -+ case WPS_CM_PUSH_BUTTON: -+ { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3 ); -+ break; -+ } -+ case WPS_CM_KEYPAD: -+ { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3 ); -+ break; -+ } -+ } -+ issue_p2p_provision_resp( pwdinfo, GetAddr2Ptr(pframe), frame_body, uconfig_method); -+ } -+ } -+ DBG_871X( "[%s] config method = %s\n", __FUNCTION__, pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req ); -+ return true; -+ -+} -+ -+u8 process_p2p_provdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe) -+{ -+ -+ return true; -+} -+ -+static u8 rtw_p2p_get_peer_ch_list(struct wifidirect_info *pwdinfo, u8 *ch_content, u8 ch_cnt, u8 *peer_ch_list) -+{ -+ u8 i = 0, j = 0; -+ u8 temp = 0; -+ u8 ch_no = 0; -+ ch_content += 3; -+ ch_cnt -= 3; -+ -+ while( ch_cnt > 0) -+ { -+ ch_content += 1; -+ ch_cnt -= 1; -+ temp = *ch_content; -+ for( i = 0 ; i < temp ; i++, j++ ) -+ { -+ peer_ch_list[j] = *( ch_content + 1 + i ); -+ } -+ ch_content += (temp + 1); -+ ch_cnt -= (temp + 1); -+ ch_no += temp ; -+ } -+ -+ return ch_no; -+} -+ -+static u8 rtw_p2p_check_peer_oper_ch(struct mlme_ext_priv *pmlmeext, u8 ch) -+{ -+ u8 i = 0; -+ -+ for( i = 0; i < pmlmeext->max_chan_nums; i++ ) -+ { -+ if ( pmlmeext->channel_set[ i ].ChannelNum == ch ) -+ { -+ return _SUCCESS; -+ } -+ } -+ -+ return _FAIL; -+} -+ -+static u8 rtw_p2p_ch_inclusion(struct mlme_ext_priv *pmlmeext, u8 *peer_ch_list, u8 peer_ch_num, u8 *ch_list_inclusioned) -+{ -+ int i = 0, j = 0, temp = 0; -+ u8 ch_no = 0; -+ -+ for( i = 0; i < peer_ch_num; i++ ) -+ { -+ for( j = temp; j < pmlmeext->max_chan_nums; j++ ) -+ { -+ if( *( peer_ch_list + i ) == pmlmeext->channel_set[ j ].ChannelNum ) -+ { -+ ch_list_inclusioned[ ch_no++ ] = *( peer_ch_list + i ); -+ temp = j; -+ break; -+ } -+ } -+ } -+ -+ return ch_no; -+} -+ -+u8 process_p2p_group_negotation_req( struct wifidirect_info *pwdinfo, u8 *pframe, uint len ) -+{ -+ _adapter *padapter = pwdinfo->padapter; -+ u8 result = P2P_STATUS_SUCCESS; -+ u32 p2p_ielen = 0, wps_ielen = 0; -+ u8 * ies; -+ u32 ies_len; -+ u8 *p2p_ie; -+ u8 *wpsie; -+ u16 wps_devicepassword_id = 0x0000; -+ uint wps_devicepassword_id_len = 0; -+#ifdef CONFIG_WFD -+ u8 wfd_ie[ 128 ] = { 0x00 }; -+ u32 wfd_ielen = 0; -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+#endif // CONFIG_TDLS -+#endif // CONFIG_WFD -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = pwdinfo->padapter->pbuddy_adapter; -+ struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo; -+ struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif -+ -+ if ( (wpsie=rtw_get_wps_ie( pframe + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &wps_ielen)) ) -+ { -+ // Commented by Kurt 20120113 -+ // If some device wants to do p2p handshake without sending prov_disc_req -+ // We have to get peer_req_cm from here. -+ if(_rtw_memcmp( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "000", 3) ) -+ { -+ rtw_get_wps_attr_content( wpsie, wps_ielen, WPS_ATTR_DEVICE_PWID, (u8*) &wps_devicepassword_id, &wps_devicepassword_id_len); -+ be16_to_cpup((__be16 *)&wps_devicepassword_id); -+ -+ if ( wps_devicepassword_id == WPS_DPID_USER_SPEC ) -+ { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "dis", 3 ); -+ } -+ else if ( wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC ) -+ { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pad", 3 ); -+ } -+ else -+ { -+ _rtw_memcpy( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, "pbc", 3 ); -+ } -+ } -+ } -+ else -+ { -+ DBG_871X( "[%s] WPS IE not Found!!\n", __FUNCTION__ ); -+ result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ return( result ); -+ } -+ -+ if ( pwdinfo->ui_got_wps_info == P2P_NO_WPSINFO ) -+ { -+ result = P2P_STATUS_FAIL_INFO_UNAVAILABLE; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_INFOR_NOREADY); -+ return( result ); -+ } -+ -+ ies = pframe + _PUBLIC_ACTION_IE_OFFSET_; -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen ); -+ -+ if ( !p2p_ie ) -+ { -+ DBG_871X( "[%s] P2P IE not Found!!\n", __FUNCTION__ ); -+ result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ } -+ -+ while ( p2p_ie ) -+ { -+ u8 attr_content = 0x00; -+ u32 attr_contentlen = 0; -+ u8 ch_content[100] = { 0x00 }; -+ uint ch_cnt = 0; -+ u8 peer_ch_list[100] = { 0x00 }; -+ u8 peer_ch_num = 0; -+ u8 ch_list_inclusioned[100] = { 0x00 }; -+ u8 ch_num_inclusioned = 0; -+ u16 cap_attr; -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_ING); -+ -+ //Check P2P Capability ATTR -+ if(rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8*)&cap_attr, (uint*)&attr_contentlen) ) -+ { -+ le16_to_cpup((__le16 *)&cap_attr); -+ -+#if defined(CONFIG_WFD) && defined(CONFIG_TDLS) -+ if(!(cap_attr & P2P_GRPCAP_INTRABSS) ) -+ ptdlsinfo->ap_prohibited = true; -+#endif //defined(CONFIG_WFD) && defined(CONFIG_TDLS) -+ } -+ -+ if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT , &attr_content, &attr_contentlen) ) -+ { -+ DBG_871X( "[%s] GO Intent = %d, tie = %d\n", __FUNCTION__, attr_content >> 1, attr_content & 0x01 ); -+ pwdinfo->peer_intent = attr_content; // include both intent and tie breaker values. -+ -+ if ( pwdinfo->intent == ( pwdinfo->peer_intent >> 1 ) ) -+ { -+ // Try to match the tie breaker value -+ if ( pwdinfo->intent == P2P_MAX_INTENT ) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ result = P2P_STATUS_FAIL_BOTH_GOINTENT_15; -+ } -+ else -+ { -+ if ( attr_content & 0x01 ) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ } -+ else -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } -+ } -+ } -+ else if ( pwdinfo->intent > ( pwdinfo->peer_intent >> 1 ) ) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } -+ else -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ } -+ -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ // Store the group id information. -+ _rtw_memcpy( pwdinfo->groupid_info.go_device_addr, pwdinfo->device_addr, ETH_ALEN ); -+ _rtw_memcpy( pwdinfo->groupid_info.ssid, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen ); -+ } -+ } -+ -+ -+ attr_contentlen = 0; -+ if ( rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_INTENTED_IF_ADDR, pwdinfo->p2p_peer_interface_addr, &attr_contentlen ) ) -+ { -+ if ( attr_contentlen != ETH_ALEN ) -+ { -+ _rtw_memset( pwdinfo->p2p_peer_interface_addr, 0x00, ETH_ALEN ); -+ } -+ } -+ -+ if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, ch_content, &ch_cnt) ) -+ { -+ peer_ch_num = rtw_p2p_get_peer_ch_list(pwdinfo, ch_content, ch_cnt, peer_ch_list); -+ ch_num_inclusioned = rtw_p2p_ch_inclusion(&padapter->mlmeextpriv, peer_ch_list, peer_ch_num, ch_list_inclusioned); -+ -+ if( ch_num_inclusioned == 0) -+ { -+ DBG_871X( "[%s] No common channel in channel list!\n", __FUNCTION__ ); -+ result = P2P_STATUS_FAIL_NO_COMMON_CH; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ break; -+ } -+ -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ if ( !rtw_p2p_is_channel_list_ok( pwdinfo->operating_channel, -+ ch_list_inclusioned, ch_num_inclusioned) ) -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ DBG_871X( "[%s] desired channel NOT Found!\n", __FUNCTION__ ); -+ result = P2P_STATUS_FAIL_NO_COMMON_CH; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ break; -+ } -+ else -+#endif //CONFIG_CONCURRENT_MODE -+ { -+ u8 operatingch_info[5] = { 0x00 }, peer_operating_ch = 0; -+ attr_contentlen = 0; -+ -+ if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen) ) -+ { -+ peer_operating_ch = operatingch_info[4]; -+ } -+ -+ if ( rtw_p2p_is_channel_list_ok( peer_operating_ch, -+ ch_list_inclusioned, ch_num_inclusioned) ) -+ { -+ /** -+ * Change our operating channel as peer's for compatibility. -+ */ -+ pwdinfo->operating_channel = peer_operating_ch; -+ DBG_871X( "[%s] Change op ch to %02x as peer's\n", __FUNCTION__, pwdinfo->operating_channel); -+ } -+ else -+ { -+ // Take first channel of ch_list_inclusioned as operating channel -+ pwdinfo->operating_channel = ch_list_inclusioned[0]; -+ DBG_871X( "[%s] Change op ch to %02x\n", __FUNCTION__, pwdinfo->operating_channel); -+ } -+ } -+ -+ } -+ } -+ } -+ -+ //Get the next P2P IE -+ p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); -+ } -+ -+#ifdef CONFIG_WFD -+ // Added by Albert 20110823 -+ // Try to get the TCP port information when receiving the negotiation request. -+ if ( rtw_get_wfd_ie( pframe + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, wfd_ie, &wfd_ielen ) ) -+ { -+ u8 attr_content[ 10 ] = { 0x00 }; -+ u32 attr_contentlen = 0; -+ -+ DBG_871X( "[%s] WFD IE Found!!\n", __FUNCTION__ ); -+ rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, attr_content, &attr_contentlen); -+ if ( attr_contentlen ) -+ { -+ pwdinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16( attr_content + 2 ); -+ DBG_871X( "[%s] Peer PORT NUM = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_rtsp_ctrlport ); -+ } -+ } -+#endif // CONFIG_WFD -+ -+ return( result ); -+} -+ -+u8 process_p2p_group_negotation_resp( struct wifidirect_info *pwdinfo, u8 *pframe, uint len ) -+{ -+ _adapter *padapter = pwdinfo->padapter; -+ u8 result = P2P_STATUS_SUCCESS; -+ u32 p2p_ielen, wps_ielen; -+ u8 * ies; -+ u32 ies_len; -+ u8 * p2p_ie; -+#ifdef CONFIG_WFD -+ u8 wfd_ie[ 128 ] = { 0x00 }; -+ u32 wfd_ielen = 0; -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+#endif // CONFIG_TDLS -+#endif // CONFIG_WFD -+ -+ ies = pframe + _PUBLIC_ACTION_IE_OFFSET_; -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ // Be able to know which one is the P2P GO and which one is P2P client. -+ -+ if ( rtw_get_wps_ie( ies, ies_len, NULL, &wps_ielen) ) -+ { -+ -+ } -+ else -+ { -+ DBG_871X( "[%s] WPS IE not Found!!\n", __FUNCTION__ ); -+ result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ } -+ -+ p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen ); -+ if ( !p2p_ie ) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ result = P2P_STATUS_FAIL_INCOMPATIBLE_PARAM; -+ } -+ else -+ { -+ -+ u8 attr_content = 0x00; -+ u32 attr_contentlen = 0; -+ u8 operatingch_info[5] = { 0x00 }; -+ uint ch_cnt = 0; -+ u8 ch_content[100] = { 0x00 }; -+ u8 groupid[ 38 ]; -+ u16 cap_attr; -+ u8 peer_ch_list[100] = { 0x00 }; -+ u8 peer_ch_num = 0; -+ u8 ch_list_inclusioned[100] = { 0x00 }; -+ u8 ch_num_inclusioned = 0; -+ -+ while ( p2p_ie ) // Found the P2P IE. -+ { -+ -+ //Check P2P Capability ATTR -+ if(rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8*)&cap_attr, (uint*)&attr_contentlen) ) -+ { -+ le16_to_cpup((__le16 *)&cap_attr); -+#ifdef CONFIG_TDLS -+ if(!(cap_attr & P2P_GRPCAP_INTRABSS) ) -+ ptdlsinfo->ap_prohibited = true; -+#endif // CONFIG_TDLS -+ } -+ -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, &attr_content, &attr_contentlen); -+ if ( attr_contentlen == 1 ) -+ { -+ DBG_871X( "[%s] Status = %d\n", __FUNCTION__, attr_content ); -+ if ( attr_content == P2P_STATUS_SUCCESS ) -+ { -+ // Do nothing. -+ } -+ else -+ { -+ if ( P2P_STATUS_FAIL_INFO_UNAVAILABLE == attr_content ) { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_INFOR_NOREADY); -+ } else { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ } -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ result = attr_content; -+ break; -+ } -+ } -+ -+ // Try to get the peer's interface address -+ attr_contentlen = 0; -+ if ( rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_INTENTED_IF_ADDR, pwdinfo->p2p_peer_interface_addr, &attr_contentlen ) ) -+ { -+ if ( attr_contentlen != ETH_ALEN ) -+ { -+ _rtw_memset( pwdinfo->p2p_peer_interface_addr, 0x00, ETH_ALEN ); -+ } -+ } -+ -+ // Try to get the peer's intent and tie breaker value. -+ attr_content = 0x00; -+ attr_contentlen = 0; -+ if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT , &attr_content, &attr_contentlen) ) -+ { -+ DBG_871X( "[%s] GO Intent = %d, tie = %d\n", __FUNCTION__, attr_content >> 1, attr_content & 0x01 ); -+ pwdinfo->peer_intent = attr_content; // include both intent and tie breaker values. -+ -+ if ( pwdinfo->intent == ( pwdinfo->peer_intent >> 1 ) ) -+ { -+ // Try to match the tie breaker value -+ if ( pwdinfo->intent == P2P_MAX_INTENT ) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ result = P2P_STATUS_FAIL_BOTH_GOINTENT_15; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ } -+ else -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ if ( attr_content & 0x01 ) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ } -+ else -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } -+ } -+ } -+ else if ( pwdinfo->intent > ( pwdinfo->peer_intent >> 1 ) ) -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } -+ else -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ } -+ -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ // Store the group id information. -+ _rtw_memcpy( pwdinfo->groupid_info.go_device_addr, pwdinfo->device_addr, ETH_ALEN ); -+ _rtw_memcpy( pwdinfo->groupid_info.ssid, pwdinfo->nego_ssid, pwdinfo->nego_ssidlen ); -+ -+ } -+ } -+ -+ // Try to get the operation channel information -+ -+ attr_contentlen = 0; -+ if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen)) -+ { -+ DBG_871X( "[%s] Peer's operating channel = %d\n", __FUNCTION__, operatingch_info[4] ); -+ pwdinfo->peer_operating_ch = operatingch_info[4]; -+ } -+ -+ // Try to get the channel list information -+ if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, pwdinfo->channel_list_attr, &pwdinfo->channel_list_attr_len ) ) -+ { -+ DBG_871X( "[%s] channel list attribute found, len = %d\n", __FUNCTION__, pwdinfo->channel_list_attr_len ); -+ -+ peer_ch_num = rtw_p2p_get_peer_ch_list(pwdinfo, pwdinfo->channel_list_attr, pwdinfo->channel_list_attr_len, peer_ch_list); -+ ch_num_inclusioned = rtw_p2p_ch_inclusion(&padapter->mlmeextpriv, peer_ch_list, peer_ch_num, ch_list_inclusioned); -+ -+ if( ch_num_inclusioned == 0) -+ { -+ DBG_871X( "[%s] No common channel in channel list!\n", __FUNCTION__ ); -+ result = P2P_STATUS_FAIL_NO_COMMON_CH; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ break; -+ } -+ -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ if ( !rtw_p2p_is_channel_list_ok( pwdinfo->operating_channel, -+ ch_list_inclusioned, ch_num_inclusioned) ) -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ DBG_871X( "[%s] desired channel NOT Found!\n", __FUNCTION__ ); -+ result = P2P_STATUS_FAIL_NO_COMMON_CH; -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ break; -+ } -+ else -+#endif //CONFIG_CONCURRENT_MODE -+ { -+ u8 operatingch_info[5] = { 0x00 }, peer_operating_ch = 0; -+ attr_contentlen = 0; -+ -+ if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen) ) -+ { -+ peer_operating_ch = operatingch_info[4]; -+ } -+ -+ if ( rtw_p2p_is_channel_list_ok( peer_operating_ch, -+ ch_list_inclusioned, ch_num_inclusioned) ) -+ { -+ /** -+ * Change our operating channel as peer's for compatibility. -+ */ -+ pwdinfo->operating_channel = peer_operating_ch; -+ DBG_871X( "[%s] Change op ch to %02x as peer's\n", __FUNCTION__, pwdinfo->operating_channel); -+ } -+ else -+ { -+ // Take first channel of ch_list_inclusioned as operating channel -+ pwdinfo->operating_channel = ch_list_inclusioned[0]; -+ DBG_871X( "[%s] Change op ch to %02x\n", __FUNCTION__, pwdinfo->operating_channel); -+ } -+ } -+ -+ } -+ } -+ -+ } -+ else -+ { -+ DBG_871X( "[%s] channel list attribute not found!\n", __FUNCTION__); -+ } -+ -+ // Try to get the group id information if peer is GO -+ attr_contentlen = 0; -+ _rtw_memset( groupid, 0x00, 38 ); -+ if ( rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, groupid, &attr_contentlen) ) -+ { -+ _rtw_memcpy( pwdinfo->groupid_info.go_device_addr, &groupid[0], ETH_ALEN ); -+ _rtw_memcpy( pwdinfo->groupid_info.ssid, &groupid[6], attr_contentlen - ETH_ALEN ); -+ } -+ -+ //Get the next P2P IE -+ p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); -+ } -+ -+ } -+ -+#ifdef CONFIG_WFD -+ // Added by Albert 20111122 -+ // Try to get the TCP port information when receiving the negotiation response. -+ if ( rtw_get_wfd_ie( pframe + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_, wfd_ie, &wfd_ielen ) ) -+ { -+ u8 attr_content[ 10 ] = { 0x00 }; -+ u32 attr_contentlen = 0; -+ -+ DBG_8192C( "[%s] WFD IE Found!!\n", __FUNCTION__ ); -+ rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, attr_content, &attr_contentlen); -+ if ( attr_contentlen ) -+ { -+ pwdinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16( attr_content + 2 ); -+ DBG_8192C( "[%s] Peer PORT NUM = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_rtsp_ctrlport ); -+ } -+ } -+#endif // CONFIG_WFD -+ -+ return( result ); -+ -+} -+ -+u8 process_p2p_group_negotation_confirm( struct wifidirect_info *pwdinfo, u8 *pframe, uint len ) -+{ -+ u8 * ies; -+ u32 ies_len; -+ u8 * p2p_ie; -+ u32 p2p_ielen = 0; -+ u8 result = P2P_STATUS_SUCCESS; -+ ies = pframe + _PUBLIC_ACTION_IE_OFFSET_; -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen ); -+ while ( p2p_ie ) // Found the P2P IE. -+ { -+ u8 attr_content = 0x00, operatingch_info[5] = { 0x00 }; -+ u8 groupid[ 38 ] = { 0x00 }; -+ u32 attr_contentlen = 0; -+ -+ pwdinfo->negotiation_dialog_token = 1; -+ rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, &attr_content, &attr_contentlen); -+ if ( attr_contentlen == 1 ) -+ { -+ DBG_871X( "[%s] Status = %d\n", __FUNCTION__, attr_content ); -+ result = attr_content; -+ -+ if ( attr_content == P2P_STATUS_SUCCESS ) -+ { -+ u8 bcancelled = 0; -+ -+ _cancel_timer( &pwdinfo->restore_p2p_state_timer, &bcancelled ); -+ -+ // Commented by Albert 20100911 -+ // Todo: Need to handle the case which both Intents are the same. -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ if ( ( pwdinfo->intent ) > ( pwdinfo->peer_intent >> 1 ) ) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } -+ else if ( ( pwdinfo->intent ) < ( pwdinfo->peer_intent >> 1 ) ) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ } -+ else -+ { -+ // Have to compare the Tie Breaker -+ if ( pwdinfo->peer_intent & 0x01 ) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ } -+ else -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(pwdinfo->padapter , _FW_LINKED ) ) -+ { -+ // Switch back to the AP channel soon. -+ _set_timer( &pwdinfo->ap_p2p_switch_timer, 100 ); -+ } -+#endif -+ } -+ else -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_FAIL); -+ break; -+ } -+ } -+ -+ // Try to get the group id information -+ attr_contentlen = 0; -+ _rtw_memset( groupid, 0x00, 38 ); -+ if ( rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, groupid, &attr_contentlen) ) -+ { -+ DBG_871X( "[%s] Ssid = %s, ssidlen = %zu\n", __FUNCTION__, &groupid[ETH_ALEN], strlen(&groupid[ETH_ALEN]) ); -+ _rtw_memcpy( pwdinfo->groupid_info.go_device_addr, &groupid[0], ETH_ALEN ); -+ _rtw_memcpy( pwdinfo->groupid_info.ssid, &groupid[6], attr_contentlen - ETH_ALEN ); -+ } -+ -+ attr_contentlen = 0; -+ if ( rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen) ) -+ { -+ DBG_871X( "[%s] Peer's operating channel = %d\n", __FUNCTION__, operatingch_info[4] ); -+ pwdinfo->peer_operating_ch = operatingch_info[4]; -+ } -+ -+ //Get the next P2P IE -+ p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); -+ -+ } -+ -+ return( result ); -+} -+ -+u8 process_p2p_presence_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) -+{ -+ u8 *frame_body; -+ u8 dialogToken=0; -+ u8 status = P2P_STATUS_SUCCESS; -+ -+ frame_body = (unsigned char *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ -+ dialogToken = frame_body[6]; -+ -+ //todo: check NoA attribute -+ -+ issue_p2p_presence_resp(pwdinfo, GetAddr2Ptr(pframe), status, dialogToken); -+ -+ return true; -+} -+ -+static void find_phase_handler( _adapter* padapter ) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ NDIS_802_11_SSID ssid; -+ _irqL irqL; -+ u8 _status = 0; -+ -+ -+ -+ _rtw_memset((unsigned char*)&ssid, 0, sizeof(NDIS_802_11_SSID)); -+ _rtw_memcpy(ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN ); -+ ssid.SsidLength = P2P_WILDCARD_SSID_LEN; -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ _status = rtw_sitesurvey_cmd(padapter, &ssid, 1, NULL, 0); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+ -+} -+ -+void p2p_concurrent_handler( _adapter* padapter ); -+ -+static void restore_p2p_state_handler( _adapter* padapter ) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL)) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_RSP)) -+ { -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ -+ issue_nulldata(pbuddy_adapter, NULL, 0, 3, 500); -+ } -+ } -+#endif -+ -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE)) -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ p2p_concurrent_handler( padapter ); -+#else -+ // In the P2P client mode, the driver should not switch back to its listen channel -+ // because this P2P client should stay at the operating channel of P2P GO. -+ set_channel_bwmode( padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+#endif -+ } -+ -+} -+ -+static void pre_tx_invitereq_handler( _adapter* padapter ) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ u8 val8 = 1; -+ -+ -+ set_channel_bwmode(padapter, pwdinfo->invitereq_info.peer_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq_p2p(padapter, NULL); -+ _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ -+ -+} -+ -+static void pre_tx_provdisc_handler( _adapter* padapter ) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ u8 val8 = 1; -+ -+ -+ set_channel_bwmode(padapter, pwdinfo->tx_prov_disc_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq_p2p(padapter, NULL); -+ _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ -+ -+} -+ -+static void pre_tx_negoreq_handler( _adapter* padapter ) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ u8 val8 = 1; -+ -+ -+ set_channel_bwmode(padapter, pwdinfo->nego_req_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq_p2p(padapter, NULL); -+ _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ -+ -+} -+ -+#ifdef CONFIG_CONCURRENT_MODE -+void p2p_concurrent_handler( _adapter* padapter ) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ //_adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ //struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo; -+ //struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ //struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ u8 val8; -+ -+ -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ pwdinfo->operating_channel = pbuddy_mlmeext->cur_channel; -+ -+ if( pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ DBG_871X("%s, switch ch back to buddy's cur_channel=%d\n", __func__, pbuddy_mlmeext->cur_channel); -+ -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ -+ issue_nulldata(pbuddy_adapter, NULL, 0, 3, 500); -+ } -+ else if( pwdinfo->driver_interface == DRIVER_WEXT ) -+ { -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) -+ { -+ // Now, the driver stays on the AP's channel. -+ // If the pwdinfo->ext_listen_period = 0, that means the P2P listen state is not available on listen channel. -+ if ( pwdinfo->ext_listen_period > 0 ) -+ { -+ DBG_8192C( "[%s] P2P_STATE_IDLE, ext_listen_period = %d\n", __FUNCTION__, pwdinfo->ext_listen_period ); -+ -+ if ( pbuddy_mlmeext->cur_channel != pwdinfo->listen_channel ) -+ { -+ // Will switch to listen channel so that need to send the NULL data with PW bit to AP. -+ issue_nulldata(pbuddy_adapter, NULL, 1, 3, 500); -+ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+ val8 = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ -+ // Todo: To check the value of pwdinfo->ext_listen_period is equal to 0 or not. -+ _set_timer( &pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period ); -+ } -+ } -+ else if ( rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) || -+ rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL) || -+ ( rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) && pwdinfo->nego_req_info.benable == false ) || -+ rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ) ) -+ { -+ // Now, the driver is in the listen state of P2P mode. -+ DBG_8192C( "[%s] P2P_STATE_IDLE, ext_listen_interval = %d\n", __FUNCTION__, pwdinfo->ext_listen_interval ); -+ -+ // Commented by Albert 2012/11/01 -+ // If the AP's channel is the same as the listen channel, we should still be in the listen state -+ // Other P2P device is still able to find this device out even this device is in the AP's channel. -+ // So, configure this device to be able to receive the probe request frame and set it to listen state. -+ if ( pbuddy_mlmeext->cur_channel != pwdinfo->listen_channel ) -+ { -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ val8 = 0; -+ padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_IDLE); -+ issue_nulldata(pbuddy_adapter, NULL, 0, 3, 500); -+ } -+ -+ // Todo: To check the value of pwdinfo->ext_listen_interval is equal to 0 or not. -+ _set_timer( &pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_interval ); -+ } -+ else if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_OK)) -+ { -+ // The driver had finished the P2P handshake successfully. -+ val8 = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ issue_nulldata(pbuddy_adapter, NULL, 0, 3, 500); -+ } -+ else if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) -+ { -+ val8 = 1; -+ set_channel_bwmode(padapter, pwdinfo->tx_prov_disc_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq_p2p(padapter, NULL); -+ _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ } -+ else if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) && pwdinfo->nego_req_info.benable == true) -+ { -+ val8 = 1; -+ set_channel_bwmode(padapter, pwdinfo->nego_req_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq_p2p(padapter, NULL); -+ _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ } -+ else if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ ) && pwdinfo->invitereq_info.benable == true) -+ { -+ /* -+ val8 = 1; -+ set_channel_bwmode(padapter, , HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); -+ issue_probereq_p2p(padapter, NULL); -+ _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ */ -+ } -+ } -+ } -+ else -+ { -+ set_channel_bwmode( padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ -+ -+} -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+static void ro_ch_handler(_adapter *padapter) -+{ -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ -+ { -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ DBG_871X("%s, switch ch back to buddy's cur_channel=%d\n", __func__, pbuddy_mlmeext->cur_channel); -+ -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ -+ pmlmeext->cur_channel = pbuddy_mlmeext->cur_channel; -+ -+ }else -+#endif //CONFIG_CONCURRENT_MODE -+ if( pcfg80211_wdinfo->restore_channel != pmlmeext->cur_channel ) -+ { -+ if ( !check_fwstate(&padapter->mlmepriv, _FW_LINKED ) ) -+ pmlmeext->cur_channel = pcfg80211_wdinfo->restore_channel; -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); -+#endif -+ } -+ -+ pcfg80211_wdinfo->is_ro_ch = false; -+ -+ DBG_871X("cfg80211_remain_on_channel_expired\n"); -+ -+ rtw_cfg80211_remain_on_channel_expired(padapter, -+ pcfg80211_wdinfo->remain_on_ch_cookie, -+ &pcfg80211_wdinfo->remain_on_ch_channel, -+ pcfg80211_wdinfo->remain_on_ch_type, GFP_KERNEL); -+ -+ -+} -+ -+static void ro_ch_timer_process (void *FunctionContext) -+{ -+ _adapter *adapter = (_adapter *)FunctionContext; -+ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(adapter->rtw_wdev); -+ -+ //printk("%s \n", __FUNCTION__); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_SET(&pwdev_priv->ro_ch_to, 1); -+#endif -+ -+ p2p_protocol_wk_cmd( adapter, P2P_RO_CH_WK); -+} -+ -+static void rtw_change_p2pie_op_ch(_adapter *padapter, const u8 *frame_body, u32 len, u8 ch) -+{ -+ u8 *ies, *p2p_ie; -+ u32 ies_len, p2p_ielen; -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ ies = (u8*)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen ); -+ -+ while ( p2p_ie ) { -+ u32 attr_contentlen = 0; -+ u8 *pattr = NULL; -+ -+ //Check P2P_ATTR_OPERATING_CH -+ attr_contentlen = 0; -+ pattr = NULL; -+ if((pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, (uint*)&attr_contentlen))!=NULL) -+ { -+ *(pattr+4) = ch; -+ } -+ -+ //Get the next P2P IE -+ p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); -+ } -+} -+ -+static void rtw_change_p2pie_ch_list(_adapter *padapter, const u8 *frame_body, u32 len, u8 ch) -+{ -+ u8 *ies, *p2p_ie; -+ u32 ies_len, p2p_ielen; -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ ies = (u8*)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen ); -+ -+ while (p2p_ie) { -+ u32 attr_contentlen = 0; -+ u8 *pattr = NULL; -+ -+ //Check P2P_ATTR_CH_LIST -+ if ((pattr=rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, (uint*)&attr_contentlen))!=NULL) { -+ int i; -+ u32 num_of_ch; -+ u8 *pattr_temp = pattr + 3 ; -+ -+ attr_contentlen -= 3; -+ -+ while (attr_contentlen>0) { -+ num_of_ch = *(pattr_temp+1); -+ -+ for(i=0; ipbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ u8 buddy_ch = pbuddy_mlmeext->cur_channel; -+ -+ ies = (u8*)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen ); -+ -+ while (p2p_ie) { -+ u32 attr_contentlen = 0; -+ u8 *pattr = NULL; -+ -+ //Check P2P_ATTR_CH_LIST -+ if ((pattr=rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, (uint*)&attr_contentlen))!=NULL) { -+ int i; -+ u32 num_of_ch; -+ u8 *pattr_temp = pattr + 3 ; -+ -+ attr_contentlen -= 3; -+ -+ while (attr_contentlen>0) { -+ num_of_ch = *(pattr_temp+1); -+ -+ for(i=0; ipbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ u8 buddy_ch = pbuddy_mlmeext->cur_channel; -+ -+ ies = (u8*)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen ); -+ -+ while (p2p_ie) { -+ u32 attr_contentlen = 0; -+ u8 *pattr = NULL; -+ -+ //Check P2P_ATTR_OPERATING_CH -+ attr_contentlen = 0; -+ pattr = NULL; -+ if((pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, (uint*)&attr_contentlen))!=NULL) { -+ if (*(pattr+4) == buddy_ch) { -+ DBG_871X(FUNC_ADPT_FMT" op_ch fit buddy_ch:%u\n", FUNC_ADPT_ARG(padapter), buddy_ch); -+ } -+ } -+ -+ //Get the next P2P IE -+ p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); -+ } -+#endif -+ return fit; -+} -+ -+static void rtw_cfg80211_adjust_p2pie_channel(_adapter *padapter, const u8 *frame_body, u32 len) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 *ies, *p2p_ie; -+ u32 ies_len, p2p_ielen; -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ ies = (u8*)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); -+ ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen ); -+ -+ while ( p2p_ie ) -+ { -+ u32 attr_contentlen = 0; -+ u8 *pattr = NULL; -+ -+ //Check P2P_ATTR_CH_LIST -+ if((pattr=rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, (uint*)&attr_contentlen))!=NULL) -+ { -+ int i; -+ u32 num_of_ch; -+ u8 *pattr_temp = pattr + 3 ; -+ -+ attr_contentlen -= 3; -+ -+ while(attr_contentlen>0) -+ { -+ num_of_ch = *(pattr_temp+1); -+ -+ for(i=0; icur_channel;//forcing to the same channel -+ -+ pattr_temp += (2+num_of_ch); -+ attr_contentlen -= (2+num_of_ch); -+ } -+ } -+ -+ //Check P2P_ATTR_OPERATING_CH -+ attr_contentlen = 0; -+ pattr = NULL; -+ if((pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, (uint*)&attr_contentlen))!=NULL) -+ { -+ *(pattr+4) = pbuddy_mlmeext->cur_channel;//forcing to the same channel -+ } -+ -+ //Get the next P2P IE -+ p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); -+ -+ } -+ -+#endif -+} -+ -+#ifdef CONFIG_WFD -+void rtw_append_wfd_ie(_adapter *padapter, u8 *buf, u32* len) -+{ -+ unsigned char *frame_body; -+ u8 category, action, OUI_Subtype, dialogToken=0; -+ u32 wfdielen = 0; -+ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); -+ -+ frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ category = frame_body[0]; -+ -+ if(category == RTW_WLAN_CATEGORY_PUBLIC) -+ { -+ action = frame_body[1]; -+ if (action == ACT_PUBLIC_VENDOR -+ && _rtw_memcmp(frame_body+2, P2P_OUI, 4) == true -+ ) -+ { -+ OUI_Subtype = frame_body[6]; -+ dialogToken = frame_body[7]; -+ switch( OUI_Subtype )//OUI Subtype -+ { -+ case P2P_GO_NEGO_REQ: -+ { -+ wfdielen = build_nego_req_wfd_ie( &padapter->wdinfo, buf + ( *len ) ); -+ (*len) += wfdielen; -+ break; -+ } -+ case P2P_GO_NEGO_RESP: -+ { -+ wfdielen = build_nego_resp_wfd_ie( &padapter->wdinfo, buf + ( *len ) ); -+ (*len) += wfdielen; -+ break; -+ } -+ case P2P_GO_NEGO_CONF: -+ { -+ wfdielen = build_nego_confirm_wfd_ie( &padapter->wdinfo, buf + ( *len ) ); -+ (*len) += wfdielen; -+ break; -+ } -+ case P2P_INVIT_REQ: -+ { -+ wfdielen = build_invitation_req_wfd_ie( &padapter->wdinfo, buf + ( *len ) ); -+ (*len) += wfdielen; -+ break; -+ } -+ case P2P_INVIT_RESP: -+ { -+ wfdielen = build_invitation_resp_wfd_ie( &padapter->wdinfo, buf + ( *len ) ); -+ (*len) += wfdielen; -+ break; -+ } -+ case P2P_DEVDISC_REQ: -+ break; -+ case P2P_DEVDISC_RESP: -+ -+ break; -+ case P2P_PROVISION_DISC_REQ: -+ { -+ wfdielen = build_provdisc_req_wfd_ie( &padapter->wdinfo, buf + ( *len ) ); -+ (*len) += wfdielen; -+ break; -+ } -+ case P2P_PROVISION_DISC_RESP: -+ { -+ wfdielen = build_provdisc_resp_wfd_ie( &padapter->wdinfo, buf + ( *len ) ); -+ (*len) += wfdielen; -+ break; -+ } -+ default: -+ -+ break; -+ } -+ -+ } -+ -+ } -+ else if(category == RTW_WLAN_CATEGORY_P2P) -+ { -+ OUI_Subtype = frame_body[5]; -+ dialogToken = frame_body[6]; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("ACTION_CATEGORY_P2P: OUI=0x%x, OUI_Subtype=%d, dialogToken=%d\n", -+ cpu_to_be32( *( ( u32* ) ( frame_body + 1 ) ) ), OUI_Subtype, dialogToken); -+#endif -+ -+ switch(OUI_Subtype) -+ { -+ case P2P_NOTICE_OF_ABSENCE: -+ -+ break; -+ case P2P_PRESENCE_REQUEST: -+ -+ break; -+ case P2P_PRESENCE_RESPONSE: -+ -+ break; -+ case P2P_GO_DISC_REQUEST: -+ -+ break; -+ default: -+ -+ break; -+ } -+ -+ } -+ else -+ { -+ DBG_871X("%s, action frame category=%d\n", __func__, category); -+ //is_p2p_frame = (-1); -+ } -+ -+ return; -+} -+#endif -+ -+u8 *dump_p2p_attr_ch_list(u8 *p2p_ie, uint p2p_ielen, u8 *buf, u32 buf_len) -+{ -+ uint attr_contentlen = 0; -+ u8 *pattr = NULL; -+ int w_sz = 0; -+ u8 ch_cnt = 0; -+ u8 ch_list[40]; -+ bool continuous = false; -+ -+ if ((pattr=rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, &attr_contentlen))!=NULL) { -+ int i, j; -+ u32 num_of_ch; -+ u8 *pattr_temp = pattr + 3 ; -+ -+ attr_contentlen -= 3; -+ -+ _rtw_memset(ch_list, 0, 40); -+ -+ while (attr_contentlen>0) { -+ num_of_ch = *(pattr_temp+1); -+ -+ for(i=0; i=ch_cnt) -+ ch_list[ch_cnt++] = *(pattr_temp+2+i); -+ -+ } -+ -+ pattr_temp += (2+num_of_ch); -+ attr_contentlen -= (2+num_of_ch); -+ } -+ -+ -+ for (j=0;jrtw_wdev); -+ int status = -1; -+ u8 ch_list_buf[128] = {'\0'}; -+ int op_ch = -1; -+ u8 intent = 0; -+ -+ frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ category = frame_body[0]; -+ //just for check -+ if(category == RTW_WLAN_CATEGORY_PUBLIC) -+ { -+ action = frame_body[1]; -+ if (action == ACT_PUBLIC_VENDOR -+ && _rtw_memcmp(frame_body+2, P2P_OUI, 4) == true -+ ) -+ { -+ OUI_Subtype = frame_body[6]; -+ dialogToken = frame_body[7]; -+ is_p2p_frame = OUI_Subtype; -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("ACTION_CATEGORY_PUBLIC: ACT_PUBLIC_VENDOR, OUI=0x%x, OUI_Subtype=%d, dialogToken=%d\n", -+ cpu_to_be32( *( ( u32* ) ( frame_body + 2 ) ) ), OUI_Subtype, dialogToken); -+ #endif -+ -+ p2p_ie = rtw_get_p2p_ie( -+ (u8 *)buf+sizeof(struct rtw_ieee80211_hdr_3addr)+_PUBLIC_ACTION_IE_OFFSET_, -+ len-sizeof(struct rtw_ieee80211_hdr_3addr)-_PUBLIC_ACTION_IE_OFFSET_, -+ NULL, &p2p_ielen); -+ -+ switch( OUI_Subtype )//OUI Subtype -+ { -+ u8 *cont; -+ uint cont_len; -+ case P2P_GO_NEGO_REQ: -+ if (tx) { -+ #ifdef CONFIG_DRV_ISSUE_PROV_REQ // IOT FOR S2 -+ if(pwdev_priv->provdisc_req_issued == false) -+ rtw_cfg80211_issue_p2p_provision_request(padapter, buf, len); -+ #endif //CONFIG_DRV_ISSUE_PROV_REQ -+ -+ //pwdev_priv->provdisc_req_issued = false; -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(padapter, _FW_LINKED)) -+ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)); -+ #endif -+ } -+ -+ if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len))) -+ op_ch = *(cont+4); -+ if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT, NULL, &cont_len))) -+ intent = *cont; -+ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); -+ DBG_871X("RTW_%s:P2P_GO_NEGO_REQ, dialogToken=%d, intent:%u%s, op_ch:%d, ch_list:%s\n", -+ (tx==true)?"Tx":"Rx", dialogToken, (intent>>1), intent&0x1 ? "+" : "-", op_ch, ch_list_buf); -+ -+ if (!tx) { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(padapter, _FW_LINKED) -+ && rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)) == false) -+ { -+ DBG_871X(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); -+ rtw_change_p2pie_ch_list(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr), 0); -+ } -+ #endif -+ } -+ -+ break; -+ case P2P_GO_NEGO_RESP: -+ if (tx) { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(padapter, _FW_LINKED)) -+ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)); -+ #endif -+ } -+ -+ if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len))) -+ op_ch = *(cont+4); -+ if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_GO_INTENT, NULL, &cont_len))) -+ intent = *cont; -+ if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len))) -+ status = *cont; -+ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); -+ DBG_871X("RTW_%s:P2P_GO_NEGO_RESP, dialogToken=%d, intent:%u%s, status:%d, op_ch:%d, ch_list:%s\n", -+ (tx==true)?"Tx":"Rx", dialogToken, (intent>>1), intent&0x1 ? "+" : "-", status, op_ch, ch_list_buf); -+ -+ if (!tx) { -+ pwdev_priv->provdisc_req_issued = false; -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(padapter, _FW_LINKED) -+ && rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)) == false) -+ { -+ DBG_871X(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); -+ rtw_change_p2pie_ch_list(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr), 0); -+ } -+ #endif -+ } -+ -+ break; -+ case P2P_GO_NEGO_CONF: -+ if (tx) { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(padapter, _FW_LINKED)) -+ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)); -+ #endif -+ } -+ -+ if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len))) -+ op_ch = *(cont+4); -+ if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len))) -+ status = *cont; -+ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); -+ DBG_871X("RTW_%s:P2P_GO_NEGO_CONF, dialogToken=%d, status:%d, op_ch:%d, ch_list:%s\n", -+ (tx==true)?"Tx":"Rx", dialogToken, status, op_ch, ch_list_buf); -+ -+ if (!tx) { -+ } -+ -+ break; -+ case P2P_INVIT_REQ: -+ { -+ struct rtw_wdev_invit_info* invit_info = &pwdev_priv->invit_info; -+ int flags = -1; -+ -+ if (tx) { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(padapter, _FW_LINKED)) -+ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)); -+ #endif -+ } -+ -+ if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_INVITATION_FLAGS, NULL, &cont_len))) -+ flags = *cont; -+ if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len))) -+ op_ch = *(cont+4); -+ -+ if (invit_info->token != dialogToken) -+ rtw_wdev_invit_info_init(invit_info); -+ -+ invit_info->token = dialogToken; -+ invit_info->flags = (flags==-1) ? 0x0 : flags; -+ invit_info->req_op_ch= op_ch; -+ -+ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); -+ DBG_871X("RTW_%s:P2P_INVIT_REQ, dialogToken=%d, flags:0x%02x, op_ch:%d, ch_list:%s\n", -+ (tx==true)?"Tx":"Rx", dialogToken, flags, op_ch, ch_list_buf); -+ -+ if (!tx) { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(padapter, _FW_LINKED) -+ && rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)) == false) -+ { -+ DBG_871X(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); -+ rtw_change_p2pie_ch_list(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr), 0); -+ } -+ #endif -+ } -+ -+ break; -+ } -+ case P2P_INVIT_RESP: -+ { -+ struct rtw_wdev_invit_info* invit_info = &pwdev_priv->invit_info; -+ -+ if (tx) { -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(padapter, _FW_LINKED)) -+ rtw_cfg80211_adjust_p2pie_channel(padapter, frame_body, len-sizeof(struct rtw_ieee80211_hdr_3addr)); -+ #endif -+ } -+ -+ if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len))) -+ status = *cont; -+ if ((cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_OPERATING_CH, NULL, &cont_len))) -+ op_ch = *(cont+4); -+ -+ if (invit_info->token != dialogToken) { -+ rtw_wdev_invit_info_init(invit_info); -+ } else { -+ invit_info->token = 0; -+ invit_info->status = (status==-1) ? 0xff : status; -+ invit_info->rsp_op_ch= op_ch; -+ } -+ -+ dump_p2p_attr_ch_list(p2p_ie, p2p_ielen, ch_list_buf, 128); -+ DBG_871X("RTW_%s:P2P_INVIT_RESP, dialogToken=%d, status:%d, op_ch:%d, ch_list:%s\n", -+ (tx==true)?"Tx":"Rx", dialogToken, status, op_ch, ch_list_buf); -+ -+ if (!tx) { -+ } -+ -+ break; -+ } -+ case P2P_DEVDISC_REQ: -+ DBG_871X("RTW_%s:P2P_DEVDISC_REQ, dialogToken=%d\n", (tx==true)?"Tx":"Rx", dialogToken); -+ break; -+ case P2P_DEVDISC_RESP: -+ cont = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_STATUS, NULL, &cont_len); -+ DBG_871X("RTW_%s:P2P_DEVDISC_RESP, dialogToken=%d, status:%d\n", (tx==true)?"Tx":"Rx", dialogToken, cont?*cont:-1); -+ break; -+ case P2P_PROVISION_DISC_REQ: -+ { -+ size_t frame_body_len = len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ u8 *p2p_ie; -+ uint p2p_ielen = 0; -+ uint contentlen = 0; -+ -+ DBG_871X("RTW_%s:P2P_PROVISION_DISC_REQ, dialogToken=%d\n", (tx==true)?"Tx":"Rx", dialogToken); -+ -+ //if(tx) -+ { -+ pwdev_priv->provdisc_req_issued = false; -+ -+ if( (p2p_ie=rtw_get_p2p_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, NULL, &p2p_ielen))) -+ { -+ -+ if(rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_GROUP_ID, NULL, &contentlen)) -+ { -+ pwdev_priv->provdisc_req_issued = false;//case: p2p_client join p2p GO -+ } -+ else -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("provdisc_req_issued is true\n"); -+ #endif //CONFIG_DEBUG_CFG80211 -+ pwdev_priv->provdisc_req_issued = true;//case: p2p_devices connection before Nego req. -+ } -+ -+ } -+ } -+ } -+ break; -+ case P2P_PROVISION_DISC_RESP: -+ DBG_871X("RTW_%s:P2P_PROVISION_DISC_RESP, dialogToken=%d\n", (tx==true)?"Tx":"Rx", dialogToken); -+ break; -+ default: -+ DBG_871X("RTW_%s:OUI_Subtype=%d, dialogToken=%d\n", (tx==true)?"Tx":"Rx", OUI_Subtype, dialogToken); -+ break; -+ } -+ -+ } -+ -+ } -+ else if(category == RTW_WLAN_CATEGORY_P2P) -+ { -+ OUI_Subtype = frame_body[5]; -+ dialogToken = frame_body[6]; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("ACTION_CATEGORY_P2P: OUI=0x%x, OUI_Subtype=%d, dialogToken=%d\n", -+ cpu_to_be32( *( ( u32* ) ( frame_body + 1 ) ) ), OUI_Subtype, dialogToken); -+ #endif -+ -+ is_p2p_frame = OUI_Subtype; -+ -+ switch(OUI_Subtype) -+ { -+ case P2P_NOTICE_OF_ABSENCE: -+ DBG_871X("RTW_%s:P2P_NOTICE_OF_ABSENCE, dialogToken=%d\n", (tx==true)?"TX":"RX", dialogToken); -+ break; -+ case P2P_PRESENCE_REQUEST: -+ DBG_871X("RTW_%s:P2P_PRESENCE_REQUEST, dialogToken=%d\n", (tx==true)?"TX":"RX", dialogToken); -+ break; -+ case P2P_PRESENCE_RESPONSE: -+ DBG_871X("RTW_%s:P2P_PRESENCE_RESPONSE, dialogToken=%d\n", (tx==true)?"TX":"RX", dialogToken); -+ break; -+ case P2P_GO_DISC_REQUEST: -+ DBG_871X("RTW_%s:P2P_GO_DISC_REQUEST, dialogToken=%d\n", (tx==true)?"TX":"RX", dialogToken); -+ break; -+ default: -+ DBG_871X("RTW_%s:OUI_Subtype=%d, dialogToken=%d\n", (tx==true)?"TX":"RX", OUI_Subtype, dialogToken); -+ break; -+ } -+ -+ } -+ else -+ { -+ DBG_871X("RTW_%s:action frame category=%d\n", (tx==true)?"TX":"RX", category); -+ //is_p2p_frame = (-1); -+ } -+ -+ return is_p2p_frame; -+} -+ -+void rtw_init_cfg80211_wifidirect_info( _adapter* padapter) -+{ -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+ -+ _rtw_memset(pcfg80211_wdinfo, 0x00, sizeof(struct cfg80211_wifidirect_info) ); -+ -+ _init_timer( &pcfg80211_wdinfo->remain_on_ch_timer, padapter->pnetdev, ro_ch_timer_process, padapter ); -+} -+#endif //CONFIG_IOCTL_CFG80211 -+ -+void p2p_protocol_wk_hdl(_adapter *padapter, int intCmdType) -+{ -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ -+ -+ -+ switch(intCmdType) -+ { -+ case P2P_FIND_PHASE_WK: -+ { -+ find_phase_handler( padapter ); -+ break; -+ } -+ case P2P_RESTORE_STATE_WK: -+ { -+ restore_p2p_state_handler( padapter ); -+ break; -+ } -+ case P2P_PRE_TX_PROVDISC_PROCESS_WK: -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ p2p_concurrent_handler( padapter ); -+ } -+ else -+ { -+ pre_tx_provdisc_handler( padapter ); -+ } -+#else -+ pre_tx_provdisc_handler( padapter ); -+#endif -+ break; -+ } -+ case P2P_PRE_TX_INVITEREQ_PROCESS_WK: -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ p2p_concurrent_handler( padapter ); -+ } -+ else -+ { -+ pre_tx_invitereq_handler( padapter ); -+ } -+#else -+ pre_tx_invitereq_handler( padapter ); -+#endif -+ break; -+ } -+ case P2P_PRE_TX_NEGOREQ_PROCESS_WK: -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ p2p_concurrent_handler( padapter ); -+ } -+ else -+ { -+ pre_tx_negoreq_handler( padapter ); -+ } -+#else -+ pre_tx_negoreq_handler( padapter ); -+#endif -+ break; -+ } -+#ifdef CONFIG_P2P -+#ifdef CONFIG_CONCURRENT_MODE -+ case P2P_AP_P2P_CH_SWITCH_PROCESS_WK: -+ { -+ p2p_concurrent_handler( padapter ); -+ break; -+ } -+#endif -+#endif -+#ifdef CONFIG_IOCTL_CFG80211 -+ case P2P_RO_CH_WK: -+ { -+ ro_ch_handler( padapter ); -+ break; -+ } -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ } -+ -+ -+} -+ -+#ifdef CONFIG_P2P_PS -+void process_p2p_ps_ie(PADAPTER padapter, u8 *IEs, u32 IELength) -+{ -+ u8 * ies; -+ u32 ies_len; -+ u8 * p2p_ie; -+ u32 p2p_ielen = 0; -+ u8 noa_attr[MAX_P2P_IE_LEN] = { 0x00 };// NoA length should be n*(13) + 2 -+ u32 attr_contentlen = 0; -+ -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ u8 find_p2p = false, find_p2p_ps = false; -+ u8 noa_offset, noa_num, noa_index; -+ -+ -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ return; -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->iface_type != IFACE_PORT0) -+ return; -+#endif -+ if(IELength <= _BEACON_IE_OFFSET_) -+ return; -+ -+ ies = IEs + _BEACON_IE_OFFSET_; -+ ies_len = IELength - _BEACON_IE_OFFSET_; -+ -+ p2p_ie = rtw_get_p2p_ie( ies, ies_len, NULL, &p2p_ielen); -+ -+ while(p2p_ie) -+ { -+ find_p2p = true; -+ // Get Notice of Absence IE. -+ if(rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_NOA, noa_attr, &attr_contentlen)) -+ { -+ find_p2p_ps = true; -+ noa_index = noa_attr[0]; -+ -+ if( (pwdinfo->p2p_ps_mode == P2P_PS_NONE) || -+ (noa_index != pwdinfo->noa_index) )// if index change, driver should reconfigure related setting. -+ { -+ pwdinfo->noa_index = noa_index; -+ pwdinfo->opp_ps = noa_attr[1] >> 7; -+ pwdinfo->ctwindow = noa_attr[1] & 0x7F; -+ -+ noa_offset = 2; -+ noa_num = 0; -+ // NoA length should be n*(13) + 2 -+ if(attr_contentlen > 2) -+ { -+ while(noa_offset < attr_contentlen) -+ { -+ //_rtw_memcpy(&wifidirect_info->noa_count[noa_num], &noa_attr[noa_offset], 1); -+ pwdinfo->noa_count[noa_num] = noa_attr[noa_offset]; -+ noa_offset += 1; -+ -+ _rtw_memcpy(&pwdinfo->noa_duration[noa_num], &noa_attr[noa_offset], 4); -+ noa_offset += 4; -+ -+ _rtw_memcpy(&pwdinfo->noa_interval[noa_num], &noa_attr[noa_offset], 4); -+ noa_offset += 4; -+ -+ _rtw_memcpy(&pwdinfo->noa_start_time[noa_num], &noa_attr[noa_offset], 4); -+ noa_offset += 4; -+ -+ noa_num++; -+ } -+ } -+ pwdinfo->noa_num = noa_num; -+ -+ if( pwdinfo->opp_ps == 1 ) -+ { -+ pwdinfo->p2p_ps_mode = P2P_PS_CTWINDOW; -+ // driver should wait LPS for entering CTWindow -+ if(padapter->pwrctrlpriv.bFwCurrentInPSMode == true) -+ { -+ p2p_ps_wk_cmd(padapter, P2P_PS_ENABLE, 1); -+ } -+ } -+ else if( pwdinfo->noa_num > 0 ) -+ { -+ pwdinfo->p2p_ps_mode = P2P_PS_NOA; -+ p2p_ps_wk_cmd(padapter, P2P_PS_ENABLE, 1); -+ } -+ else if( pwdinfo->p2p_ps_mode > P2P_PS_NONE) -+ { -+ p2p_ps_wk_cmd(padapter, P2P_PS_DISABLE, 1); -+ } -+ } -+ -+ break; // find target, just break. -+ } -+ -+ //Get the next P2P IE -+ p2p_ie = rtw_get_p2p_ie(p2p_ie+p2p_ielen, ies_len -(p2p_ie -ies + p2p_ielen), NULL, &p2p_ielen); -+ -+ } -+ -+ if(find_p2p == true) -+ { -+ if( (pwdinfo->p2p_ps_mode > P2P_PS_NONE) && (find_p2p_ps == false) ) -+ { -+ p2p_ps_wk_cmd(padapter, P2P_PS_DISABLE, 1); -+ } -+ } -+ -+ -+} -+ -+void p2p_ps_wk_hdl(_adapter *padapter, u8 p2p_ps_state) -+{ -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ -+ -+ -+ // Pre action for p2p state -+ switch(p2p_ps_state) -+ { -+ case P2P_PS_DISABLE: -+ pwdinfo->p2p_ps_state = p2p_ps_state; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_P2P_PS_OFFLOAD, (u8 *)(&p2p_ps_state)); -+ -+ pwdinfo->noa_index = 0; -+ pwdinfo->ctwindow = 0; -+ pwdinfo->opp_ps = 0; -+ pwdinfo->noa_num = 0; -+ pwdinfo->p2p_ps_mode = P2P_PS_NONE; -+ if(padapter->pwrctrlpriv.bFwCurrentInPSMode == true) -+ { -+ if(pwrpriv->smart_ps == 0) -+ { -+ pwrpriv->smart_ps = 2; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&(padapter->pwrctrlpriv.pwr_mode))); -+ } -+ } -+ break; -+ case P2P_PS_ENABLE: -+ if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) { -+ pwdinfo->p2p_ps_state = p2p_ps_state; -+ -+ if( pwdinfo->ctwindow > 0 ) -+ { -+ if(pwrpriv->smart_ps != 0) -+ { -+ pwrpriv->smart_ps = 0; -+ DBG_871X("%s(): Enter CTW, change SmartPS\n", __FUNCTION__); -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&(padapter->pwrctrlpriv.pwr_mode))); -+ } -+ } -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_P2P_PS_OFFLOAD, (u8 *)(&p2p_ps_state)); -+ } -+ break; -+ case P2P_PS_SCAN: -+ case P2P_PS_SCAN_DONE: -+ case P2P_PS_ALLSTASLEEP: -+ if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) { -+ pwdinfo->p2p_ps_state = p2p_ps_state; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_P2P_PS_OFFLOAD, (u8 *)(&p2p_ps_state)); -+ } -+ break; -+ default: -+ break; -+ } -+ -+ -+} -+ -+u8 p2p_ps_wk_cmd(_adapter*padapter, u8 p2p_ps_state, u8 enqueue) -+{ -+ struct cmd_obj *ph2c; -+ struct drvextra_cmd_parm *pdrvextra_cmd_parm; -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ struct cmd_priv *pcmdpriv = &padapter->cmdpriv; -+ u8 res = _SUCCESS; -+ -+ -+ -+ if ( rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) -+#ifdef CONFIG_CONCURRENT_MODE -+ || (padapter->iface_type != IFACE_PORT0) -+#endif -+ ) -+ { -+ return res; -+ } -+ -+ if(enqueue) -+ { -+ ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj)); -+ if(ph2c==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm = (struct drvextra_cmd_parm*)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); -+ if(pdrvextra_cmd_parm==NULL){ -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pdrvextra_cmd_parm->ec_id = P2P_PS_WK_CID; -+ pdrvextra_cmd_parm->type_size = p2p_ps_state; -+ pdrvextra_cmd_parm->pbuf = NULL; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); -+ -+ res = rtw_enqueue_cmd(pcmdpriv, ph2c); -+ } -+ else -+ { -+ p2p_ps_wk_hdl(padapter, p2p_ps_state); -+ } -+ -+exit: -+ -+ -+ -+ return res; -+ -+} -+#endif // CONFIG_P2P_PS -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+static void reset_ch_sitesurvey_timer_process (void *FunctionContext) -+#else -+static void reset_ch_sitesurvey_timer_process(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *adapter = (_adapter *)FunctionContext; -+#else -+ _adapter *adapter = from_timer(adapter, t, wdinfo.reset_ch_sitesurvey); -+#endif -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ -+ DBG_871X( "[%s] In\n", __FUNCTION__ ); -+ // Reset the operation channel information -+ pwdinfo->rx_invitereq_info.operation_ch[0] = 0; -+ pwdinfo->rx_invitereq_info.scan_op_ch_only = 0; -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+static void reset_ch_sitesurvey_timer_process2(void *FunctionContext) -+#else -+static void reset_ch_sitesurvey_timer_process2(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *adapter = (_adapter *)FunctionContext; -+#else -+ _adapter *adapter = from_timer(adapter, t, wdinfo.reset_ch_sitesurvey2); -+#endif -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ -+ DBG_871X( "[%s] In\n", __FUNCTION__ ); -+ // Reset the operation channel information -+ pwdinfo->p2p_info.operation_ch[0] = 0; -+ pwdinfo->p2p_info.scan_op_ch_only = 0; -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+static void restore_p2p_state_timer_process (void *FunctionContext) -+#else -+static void restore_p2p_state_timer_process(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *adapter = (_adapter *)FunctionContext; -+#else -+ _adapter *adapter = from_timer(adapter, t, wdinfo.restore_p2p_state_timer); -+#endif -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ -+ p2p_protocol_wk_cmd( adapter, P2P_RESTORE_STATE_WK ); -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+static void pre_tx_scan_timer_process (void *FunctionContext) -+#else -+static void pre_tx_scan_timer_process(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *adapter = (_adapter *) FunctionContext; -+#else -+ _adapter *adapter = from_timer(adapter, t, wdinfo.pre_tx_scan_timer); -+#endif -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ _irqL irqL; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u8 _status = 0; -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) -+ { -+ if ( true == pwdinfo->tx_prov_disc_info.benable ) // the provision discovery request frame is trigger to send or not -+ { -+ p2p_protocol_wk_cmd( adapter, P2P_PRE_TX_PROVDISC_PROCESS_WK ); -+ //issue_probereq_p2p(adapter, NULL); -+ //_set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ } -+ } -+ else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) -+ { -+ if ( true == pwdinfo->nego_req_info.benable ) -+ { -+ p2p_protocol_wk_cmd( adapter, P2P_PRE_TX_NEGOREQ_PROCESS_WK ); -+ } -+ } -+ else if ( rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ ) ) -+ { -+ if ( true == pwdinfo->invitereq_info.benable ) -+ { -+ p2p_protocol_wk_cmd( adapter, P2P_PRE_TX_INVITEREQ_PROCESS_WK ); -+ } -+ } -+ else -+ { -+ DBG_8192C( "[%s] p2p_state is %d, ignore!!\n", __FUNCTION__, rtw_p2p_state(pwdinfo) ); -+ } -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+static void find_phase_timer_process (void *FunctionContext) -+#else -+static void find_phase_timer_process(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *adapter = (_adapter *)FunctionContext; -+#else -+ _adapter *adapter = from_timer(adapter, t, wdinfo.find_phase_timer); -+#endif -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ -+ adapter->wdinfo.find_phase_state_exchange_cnt++; -+ -+ p2p_protocol_wk_cmd( adapter, P2P_FIND_PHASE_WK ); -+} -+ -+#ifdef CONFIG_CONCURRENT_MODE -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+void ap_p2p_switch_timer_process (void *FunctionContext) -+#else -+void ap_p2p_switch_timer_process(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *adapter = (_adapter *)FunctionContext; -+#else -+ _adapter *adapter = from_timer(adapter, t, wdinfo.ap_p2p_switch_timer); -+#endif -+ struct wifidirect_info *pwdinfo = &adapter->wdinfo; -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(adapter->rtw_wdev); -+#endif -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); -+#endif -+ -+ p2p_protocol_wk_cmd( adapter, P2P_AP_P2P_CH_SWITCH_PROCESS_WK ); -+} -+#endif -+ -+void reset_global_wifidirect_info( _adapter* padapter ) -+{ -+ struct wifidirect_info *pwdinfo; -+ -+ pwdinfo = &padapter->wdinfo; -+ pwdinfo->persistent_supported = 0; -+ pwdinfo->session_available = true; -+ pwdinfo->wfd_tdls_enable = 0; -+ pwdinfo->wfd_tdls_weaksec = 0; -+} -+ -+#ifdef CONFIG_WFD -+int rtw_init_wifi_display_info(_adapter* padapter) -+{ -+ int res = _SUCCESS; -+ struct wifi_display_info *pwfd_info = &padapter->wfd_info; -+ -+ // Used in P2P and TDLS -+ pwfd_info->rtsp_ctrlport = 554; -+ pwfd_info->peer_rtsp_ctrlport = 0; // Reset to 0 -+ pwfd_info->wfd_enable = false; -+ pwfd_info->wfd_device_type = WFD_DEVINFO_PSINK; -+ pwfd_info->scan_result_type = SCAN_RESULT_P2P_ONLY; -+ -+ // Used in P2P -+ pwfd_info->peer_session_avail = true; -+ pwfd_info->wfd_pc = false; -+ -+ // Used in TDLS -+ _rtw_memset( pwfd_info->ip_address, 0x00, 4 ); -+ _rtw_memset( pwfd_info->peer_ip_address, 0x00, 4 ); -+ return res; -+ -+} -+#endif //CONFIG_WFD -+ -+void rtw_init_wifidirect_timers(_adapter* padapter) -+{ -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _init_timer( &pwdinfo->find_phase_timer, padapter->pnetdev, find_phase_timer_process, padapter ); -+ _init_timer( &pwdinfo->restore_p2p_state_timer, padapter->pnetdev, restore_p2p_state_timer_process, padapter ); -+ _init_timer( &pwdinfo->pre_tx_scan_timer, padapter->pnetdev, pre_tx_scan_timer_process, padapter ); -+ _init_timer( &pwdinfo->reset_ch_sitesurvey, padapter->pnetdev, reset_ch_sitesurvey_timer_process, padapter ); -+ _init_timer( &pwdinfo->reset_ch_sitesurvey2, padapter->pnetdev, reset_ch_sitesurvey_timer_process2, padapter ); -+#ifdef CONFIG_CONCURRENT_MODE -+ _init_timer( &pwdinfo->ap_p2p_switch_timer, padapter->pnetdev, ap_p2p_switch_timer_process, padapter ); -+#endif -+#else -+ timer_setup(&pwdinfo->find_phase_timer, find_phase_timer_process, 0); -+ timer_setup(&pwdinfo->restore_p2p_state_timer, restore_p2p_state_timer_process, 0); -+ timer_setup(&pwdinfo->pre_tx_scan_timer, pre_tx_scan_timer_process, 0); -+ timer_setup(&pwdinfo->reset_ch_sitesurvey, reset_ch_sitesurvey_timer_process, 0); -+ timer_setup(&pwdinfo->reset_ch_sitesurvey2, reset_ch_sitesurvey_timer_process2, 0); -+#endif -+#ifdef CONFIG_CONCURRENT_MODE -+ timer_setup(&pwdinfo->ap_p2p_switch_timer, ap_p2p_switch_timer_process, 0); -+#endif -+} -+ -+void rtw_init_wifidirect_addrs(_adapter* padapter, u8 *dev_addr, u8 *iface_addr) -+{ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ -+ /*init device&interface address */ -+ if (dev_addr) { -+ _rtw_memcpy(pwdinfo->device_addr, dev_addr, ETH_ALEN); -+ } -+ if (iface_addr) { -+ _rtw_memcpy(pwdinfo->interface_addr, iface_addr, ETH_ALEN); -+ } -+#endif -+} -+ -+void init_wifidirect_info( _adapter* padapter, enum P2P_ROLE role) -+{ -+ struct wifidirect_info *pwdinfo; -+#ifdef CONFIG_WFD -+ struct wifi_display_info *pwfd_info = &padapter->wfd_info; -+#endif -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct wifidirect_info *pbuddy_wdinfo; -+ struct mlme_priv *pbuddy_mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext; -+#endif -+ -+ pwdinfo = &padapter->wdinfo; -+ -+ pwdinfo->padapter = padapter; -+ -+ // 1, 6, 11 are the social channel defined in the WiFi Direct specification. -+ pwdinfo->social_chan[0] = 1; -+ pwdinfo->social_chan[1] = 6; -+ pwdinfo->social_chan[2] = 11; -+ pwdinfo->social_chan[3] = 0; // channel 0 for scanning ending in site survey function. -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (pbuddy_adapter) { -+ pbuddy_wdinfo = &pbuddy_adapter->wdinfo; -+ pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ } -+ -+ if ( ( check_buddy_fwstate(padapter, _FW_LINKED ) == true ) && -+ ( ( pbuddy_mlmeext->cur_channel == 1) || ( pbuddy_mlmeext->cur_channel == 6 ) || ( pbuddy_mlmeext->cur_channel == 11 ) ) -+ ) -+ { -+ // Use the AP's channel as the listen channel -+ // This will avoid the channel switch between AP's channel and listen channel. -+ pwdinfo->listen_channel = pbuddy_mlmeext->cur_channel; -+ } -+ else -+#endif //CONFIG_CONCURRENT_MODE -+ { -+ // Use the channel 11 as the listen channel -+ pwdinfo->listen_channel = 11; -+ } -+ -+ if (role == P2P_ROLE_DEVICE) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ #ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) == true ) -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_IDLE); -+ } -+ else -+ #endif -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+ } -+ pwdinfo->intent = 1; -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_LISTEN); -+ } -+ else if (role == P2P_ROLE_CLIENT) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ pwdinfo->intent = 1; -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ } -+ else if (role == P2P_ROLE_GO) -+ { -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ pwdinfo->intent = 15; -+ rtw_p2p_set_pre_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ } -+ -+// Use the OFDM rate in the P2P probe response frame. ( 6(B), 9(B), 12, 18, 24, 36, 48, 54 ) -+ pwdinfo->support_rate[0] = 0x8c; // 6(B) -+ pwdinfo->support_rate[1] = 0x92; // 9(B) -+ pwdinfo->support_rate[2] = 0x18; // 12 -+ pwdinfo->support_rate[3] = 0x24; // 18 -+ pwdinfo->support_rate[4] = 0x30; // 24 -+ pwdinfo->support_rate[5] = 0x48; // 36 -+ pwdinfo->support_rate[6] = 0x60; // 48 -+ pwdinfo->support_rate[7] = 0x6c; // 54 -+ -+ _rtw_memcpy( ( void* ) pwdinfo->p2p_wildcard_ssid, "DIRECT-", 7 ); -+ -+ _rtw_memset( pwdinfo->device_name, 0x00, WPS_MAX_DEVICE_NAME_LEN ); -+ pwdinfo->device_name_len = 0; -+ -+ _rtw_memset( &pwdinfo->invitereq_info, 0x00, sizeof( struct tx_invite_req_info ) ); -+ pwdinfo->invitereq_info.token = 3; // Token used for P2P invitation request frame. -+ -+ _rtw_memset( &pwdinfo->inviteresp_info, 0x00, sizeof( struct tx_invite_resp_info ) ); -+ pwdinfo->inviteresp_info.token = 0; -+ -+ pwdinfo->profileindex = 0; -+ _rtw_memset( &pwdinfo->profileinfo[ 0 ], 0x00, sizeof( struct profile_info ) * P2P_MAX_PERSISTENT_GROUP_NUM ); -+ -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+ -+ pwdinfo->listen_dwell = ( u8 ) (( rtw_get_current_time() % 3 ) + 1); -+ //DBG_8192C( "[%s] listen_dwell time is %d00ms\n", __FUNCTION__, pwdinfo->listen_dwell ); -+ -+ _rtw_memset( &pwdinfo->tx_prov_disc_info, 0x00, sizeof( struct tx_provdisc_req_info ) ); -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_NONE; -+ -+ _rtw_memset( &pwdinfo->nego_req_info, 0x00, sizeof( struct tx_nego_req_info ) ); -+ -+ pwdinfo->device_password_id_for_nego = WPS_DPID_PBC; -+ pwdinfo->negotiation_dialog_token = 1; -+ -+ _rtw_memset( pwdinfo->nego_ssid, 0x00, WLAN_SSID_MAXLEN ); -+ pwdinfo->nego_ssidlen = 0; -+ -+ pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO; -+#ifdef CONFIG_WFD -+ pwdinfo->supported_wps_cm = WPS_CONFIG_METHOD_DISPLAY | WPS_CONFIG_METHOD_PBC; -+ pwdinfo->wfd_info = pwfd_info; -+#else -+ pwdinfo->supported_wps_cm = WPS_CONFIG_METHOD_DISPLAY | WPS_CONFIG_METHOD_PBC | WPS_CONFIG_METHOD_KEYPAD; -+#endif //CONFIG_WFD -+ pwdinfo->channel_list_attr_len = 0; -+ _rtw_memset( pwdinfo->channel_list_attr, 0x00, 100 ); -+ -+ _rtw_memset( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, 0x00, 4 ); -+ _rtw_memset( pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req, '0', 3 ); -+ _rtw_memset( &pwdinfo->groupid_info, 0x00, sizeof( struct group_id_info ) ); -+#ifdef CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_IOCTL_CFG80211 -+ pwdinfo->ext_listen_interval = 1000; //The interval to be available with legacy AP during p2p0-find/scan -+ pwdinfo->ext_listen_period = 3000; //The time period to be available for P2P during nego -+#else //!CONFIG_IOCTL_CFG80211 -+ //pwdinfo->ext_listen_interval = 3000; -+ //pwdinfo->ext_listen_period = 400; -+ pwdinfo->ext_listen_interval = 1000; -+ pwdinfo->ext_listen_period = 1000; -+#endif //!CONFIG_IOCTL_CFG80211 -+#endif -+ -+// Commented by Kurt 20130319 -+// For WiDi purpose: Use CFG80211 interface but controled WFD/RDS frame by driver itself. -+#ifdef CONFIG_IOCTL_CFG80211 -+ pwdinfo->driver_interface = DRIVER_CFG80211; -+#else -+ pwdinfo->driver_interface = DRIVER_WEXT; -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ pwdinfo->wfd_tdls_enable = 0; -+ _rtw_memset( pwdinfo->p2p_peer_interface_addr, 0x00, ETH_ALEN ); -+ _rtw_memset( pwdinfo->p2p_peer_device_addr, 0x00, ETH_ALEN ); -+ -+ pwdinfo->rx_invitereq_info.operation_ch[0] = 0; -+ pwdinfo->rx_invitereq_info.operation_ch[1] = 0; // Used to indicate the scan end in site survey function -+ pwdinfo->rx_invitereq_info.scan_op_ch_only = 0; -+ pwdinfo->p2p_info.operation_ch[0] = 0; -+ pwdinfo->p2p_info.operation_ch[1] = 0; // Used to indicate the scan end in site survey function -+ pwdinfo->p2p_info.scan_op_ch_only = 0; -+} -+ -+#ifdef CONFIG_DBG_P2P -+char * p2p_role_str[] = { -+ "P2P_ROLE_DISABLE", -+ "P2P_ROLE_DEVICE", -+ "P2P_ROLE_CLIENT", -+ "P2P_ROLE_GO" -+}; -+ -+char * p2p_state_str[] = { -+ "P2P_STATE_NONE", -+ "P2P_STATE_IDLE", -+ "P2P_STATE_LISTEN", -+ "P2P_STATE_SCAN", -+ "P2P_STATE_FIND_PHASE_LISTEN", -+ "P2P_STATE_FIND_PHASE_SEARCH", -+ "P2P_STATE_TX_PROVISION_DIS_REQ", -+ "P2P_STATE_RX_PROVISION_DIS_RSP", -+ "P2P_STATE_RX_PROVISION_DIS_REQ", -+ "P2P_STATE_GONEGO_ING", -+ "P2P_STATE_GONEGO_OK", -+ "P2P_STATE_GONEGO_FAIL", -+ "P2P_STATE_RECV_INVITE_REQ_MATCH", -+ "P2P_STATE_PROVISIONING_ING", -+ "P2P_STATE_PROVISIONING_DONE", -+ "P2P_STATE_RECV_INVITE_REQ_DISMATCH", -+ "P2P_STATE_RECV_INVITE_REQ_GO" -+}; -+ -+void dbg_rtw_p2p_set_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line) -+{ -+ if(!_rtw_p2p_chk_state(wdinfo, state)) { -+ enum P2P_STATE old_state = _rtw_p2p_state(wdinfo); -+ _rtw_p2p_set_state(wdinfo, state); -+ DBG_871X("[CONFIG_DBG_P2P]%s:%d set_state from %s to %s\n", caller, line -+ , p2p_state_str[old_state], p2p_state_str[_rtw_p2p_state(wdinfo)] -+ ); -+ } else { -+ DBG_871X("[CONFIG_DBG_P2P]%s:%d set_state to same state %s\n", caller, line -+ , p2p_state_str[_rtw_p2p_state(wdinfo)] -+ ); -+ } -+} -+void dbg_rtw_p2p_set_pre_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line) -+{ -+ if(_rtw_p2p_pre_state(wdinfo) != state) { -+ enum P2P_STATE old_state = _rtw_p2p_pre_state(wdinfo); -+ _rtw_p2p_set_pre_state(wdinfo, state); -+ DBG_871X("[CONFIG_DBG_P2P]%s:%d set_pre_state from %s to %s\n", caller, line -+ , p2p_state_str[old_state], p2p_state_str[_rtw_p2p_pre_state(wdinfo)] -+ ); -+ } else { -+ DBG_871X("[CONFIG_DBG_P2P]%s:%d set_pre_state to same state %s\n", caller, line -+ , p2p_state_str[_rtw_p2p_pre_state(wdinfo)] -+ ); -+ } -+} -+#if 0 -+void dbg_rtw_p2p_restore_state(struct wifidirect_info *wdinfo, const char *caller, int line) -+{ -+ if(wdinfo->pre_p2p_state != -1) { -+ DBG_871X("[CONFIG_DBG_P2P]%s:%d restore from %s to %s\n", caller, line -+ , p2p_state_str[wdinfo->p2p_state], p2p_state_str[wdinfo->pre_p2p_state] -+ ); -+ _rtw_p2p_restore_state(wdinfo); -+ } else { -+ DBG_871X("[CONFIG_DBG_P2P]%s:%d restore no pre state, cur state %s\n", caller, line -+ , p2p_state_str[wdinfo->p2p_state] -+ ); -+ } -+} -+#endif -+void dbg_rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role, const char *caller, int line) -+{ -+ if(wdinfo->role != role) { -+ enum P2P_ROLE old_role = wdinfo->role; -+ _rtw_p2p_set_role(wdinfo, role); -+ DBG_871X("[CONFIG_DBG_P2P]%s:%d set_role from %s to %s\n", caller, line -+ , p2p_role_str[old_role], p2p_role_str[wdinfo->role] -+ ); -+ } else { -+ DBG_871X("[CONFIG_DBG_P2P]%s:%d set_role to same role %s\n", caller, line -+ , p2p_role_str[wdinfo->role] -+ ); -+ } -+} -+#endif //CONFIG_DBG_P2P -+ -+ -+int rtw_p2p_enable(_adapter *padapter, enum P2P_ROLE role) -+{ -+ int ret = _SUCCESS; -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ -+ if (role == P2P_ROLE_DEVICE || role == P2P_ROLE_CLIENT|| role == P2P_ROLE_GO) -+ { -+ u8 channel, ch_offset; -+ u16 bwmode; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo; -+ // Commented by Albert 2011/12/30 -+ // The driver just supports 1 P2P group operation. -+ // So, this function will do nothing if the buddy adapter had enabled the P2P function. -+ if(!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE)) -+ { -+ // The buddy adapter had enabled the P2P function. -+ return ret; -+ } -+#endif //CONFIG_CONCURRENT_MODE -+ -+ //leave IPS/Autosuspend -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ // Added by Albert 2011/03/22 -+ // In the P2P mode, the driver should not support the b mode. -+ // So, the Tx packet shouldn't use the CCK rate -+ update_tx_basic_rate(padapter, WIRELESS_11AGN); -+ -+ //Enable P2P function -+ init_wifidirect_info(padapter, role); -+ -+ rtw_hal_set_odm_var(padapter,HAL_ODM_P2P_STATE,NULL,true); -+ #ifdef CONFIG_WFD -+ rtw_hal_set_odm_var(padapter,HAL_ODM_WIFI_DISPLAY_STATE,NULL,true); -+ #endif -+ -+ } -+ else if (role == P2P_ROLE_DISABLE) -+ { -+ if (_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ //Disable P2P function -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ _cancel_timer_ex( &pwdinfo->find_phase_timer ); -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ _cancel_timer_ex( &pwdinfo->pre_tx_scan_timer); -+ _cancel_timer_ex( &pwdinfo->reset_ch_sitesurvey); -+ _cancel_timer_ex( &pwdinfo->reset_ch_sitesurvey2); -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ reset_ch_sitesurvey_timer_process( padapter ); -+ reset_ch_sitesurvey_timer_process2( padapter ); -+#else -+ reset_ch_sitesurvey_timer_process(&padapter->wdinfo.reset_ch_sitesurvey); -+ reset_ch_sitesurvey_timer_process(&padapter->wdinfo.reset_ch_sitesurvey2); -+#endif -+ #ifdef CONFIG_CONCURRENT_MODE -+ _cancel_timer_ex( &pwdinfo->ap_p2p_switch_timer); -+ #endif -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DISABLE); -+ _rtw_memset(&pwdinfo->rx_prov_disc_info, 0x00, sizeof(struct rx_provdisc_req_info)); -+ } -+ -+ rtw_hal_set_odm_var(padapter,HAL_ODM_P2P_STATE,NULL,false); -+ #ifdef CONFIG_WFD -+ rtw_hal_set_odm_var(padapter,HAL_ODM_WIFI_DISPLAY_STATE,NULL,false); -+ #endif -+ -+ //Restore to initial setting. -+ update_tx_basic_rate(padapter, padapter->registrypriv.wireless_mode); -+ -+ //For WiDi purpose. -+#ifdef CONFIG_IOCTL_CFG80211 -+ pwdinfo->driver_interface = DRIVER_CFG80211; -+#else -+ pwdinfo->driver_interface = DRIVER_WEXT; -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ } -+ -+exit: -+ return ret; -+} -+ -+#endif //CONFIG_P2P -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_pwrctrl.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_pwrctrl.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_pwrctrl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_pwrctrl.c 2018-02-06 17:42:30.698966987 +0200 -@@ -0,0 +1,1815 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_PWRCTRL_C_ -+ -+#include -+ -+// Should not include hal dependent herader here, it will remove later. Lucas@20130123 -+#ifdef CONFIG_BT_COEXIST -+#include -+#endif -+ -+#ifdef CONFIG_IPS -+void ips_enter(_adapter * padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ -+ pwrpriv->bips_processing = true; -+ -+ // syn ips_mode with request -+ pwrpriv->ips_mode = pwrpriv->ips_mode_req; -+ -+ pwrpriv->ips_enter_cnts++; -+ DBG_871X("==>ips_enter cnts:%d\n",pwrpriv->ips_enter_cnts); -+#ifdef CONFIG_BT_COEXIST -+ BTDM_TurnOffBtCoexistBeforeEnterIPS(padapter); -+#endif -+ if(rf_off == pwrpriv->change_rfpwrstate ) -+ { -+ pwrpriv->bpower_saving = true; -+ DBG_871X_LEVEL(_drv_always_, "nolinked power save enter\n"); -+ -+ if(pwrpriv->ips_mode == IPS_LEVEL_2) -+ pwrpriv->bkeepfwalive = true; -+ -+ rtw_ips_pwr_down(padapter); -+ pwrpriv->rf_pwrstate = rf_off; -+ } -+ pwrpriv->bips_processing = false; -+ -+ _exit_pwrlock(&pwrpriv->lock); -+ -+} -+ -+int ips_leave(_adapter * padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ int result = _SUCCESS; -+ sint keyid; -+ -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ -+ if((pwrpriv->rf_pwrstate == rf_off) &&(!pwrpriv->bips_processing)) -+ { -+ pwrpriv->bips_processing = true; -+ pwrpriv->change_rfpwrstate = rf_on; -+ pwrpriv->ips_leave_cnts++; -+ DBG_871X("==>ips_leave cnts:%d\n",pwrpriv->ips_leave_cnts); -+ -+ if ((result = rtw_ips_pwr_up(padapter)) == _SUCCESS) { -+ pwrpriv->rf_pwrstate = rf_on; -+ } -+ DBG_871X_LEVEL(_drv_always_, "nolinked power save leave\n"); -+ -+ if((_WEP40_ == psecuritypriv->dot11PrivacyAlgrthm) ||(_WEP104_ == psecuritypriv->dot11PrivacyAlgrthm)) -+ { -+ DBG_871X("==>%s,channel(%d),processing(%x)\n",__FUNCTION__,padapter->mlmeextpriv.cur_channel,pwrpriv->bips_processing); -+ set_channel_bwmode(padapter, padapter->mlmeextpriv.cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ for(keyid=0;keyid<4;keyid++){ -+ if(pmlmepriv->key_mask & BIT(keyid)){ -+ if(keyid == psecuritypriv->dot11PrivacyKeyIndex) -+ result=rtw_set_key(padapter,psecuritypriv, keyid, 1); -+ else -+ result=rtw_set_key(padapter,psecuritypriv, keyid, 0); -+ } -+ } -+ } -+ -+ DBG_871X("==> ips_leave.....LED(0x%08x)...\n",rtw_read32(padapter,0x4c)); -+ pwrpriv->bips_processing = false; -+ -+ pwrpriv->bkeepfwalive = false; -+ pwrpriv->bpower_saving = false; -+ } -+ -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ return result; -+} -+ -+ -+#endif -+ -+#ifdef CONFIG_AUTOSUSPEND -+extern void autosuspend_enter(_adapter* padapter); -+extern int autoresume_enter(_adapter* padapter); -+#endif -+ -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+int rtw_hw_suspend(_adapter *padapter ); -+int rtw_hw_resume(_adapter *padapter); -+#endif -+ -+bool rtw_pwr_unassociated_idle(_adapter *adapter) -+{ -+ _adapter *buddy = adapter->pbuddy_adapter; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct xmit_priv *pxmit_priv = &adapter->xmitpriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &(adapter->wdinfo); -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &adapter->cfg80211_wdinfo; -+#endif -+#endif -+ -+ bool ret = false; -+ -+ if (adapter->pwrctrlpriv.ips_deny_time >= rtw_get_current_time()) { -+ //DBG_871X("%s ips_deny_time\n", __func__); -+ goto exit; -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE|WIFI_SITE_MONITOR) -+ || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING|WIFI_UNDER_WPS) -+ || check_fwstate(pmlmepriv, WIFI_AP_STATE) -+ || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE|WIFI_ADHOC_STATE) -+ #if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P_IPS) -+ || pcfg80211_wdinfo->is_ro_ch -+ #elif defined(CONFIG_P2P) -+ || !rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) -+ #endif -+ ) { -+ goto exit; -+ } -+ -+ /* consider buddy, if exist */ -+ if (buddy) { -+ struct mlme_priv *b_pmlmepriv = &(buddy->mlmepriv); -+ #ifdef CONFIG_P2P -+ struct wifidirect_info *b_pwdinfo = &(buddy->wdinfo); -+ #ifdef CONFIG_IOCTL_CFG80211 -+ struct cfg80211_wifidirect_info *b_pcfg80211_wdinfo = &buddy->cfg80211_wdinfo; -+ #endif -+ #endif -+ -+ if (check_fwstate(b_pmlmepriv, WIFI_ASOC_STATE|WIFI_SITE_MONITOR) -+ || check_fwstate(b_pmlmepriv, WIFI_UNDER_LINKING|WIFI_UNDER_WPS) -+ || check_fwstate(b_pmlmepriv, WIFI_AP_STATE) -+ || check_fwstate(b_pmlmepriv, WIFI_ADHOC_MASTER_STATE|WIFI_ADHOC_STATE) -+ #if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P_IPS) -+ || b_pcfg80211_wdinfo->is_ro_ch -+ #elif defined(CONFIG_P2P) -+ || !rtw_p2p_chk_state(b_pwdinfo, P2P_STATE_NONE) -+ #endif -+ ) { -+ goto exit; -+ } -+ } -+ -+#if (MP_DRIVER == 1) -+ if (adapter->registrypriv.mp_mode == 1) -+ goto exit; -+#endif -+ -+#ifdef CONFIG_INTEL_PROXIM -+ if(adapter->proximity.proxim_on==true){ -+ return; -+ } -+#endif -+ -+ if (pxmit_priv->free_xmitbuf_cnt != NR_XMITBUFF || -+ pxmit_priv->free_xmit_extbuf_cnt != NR_XMIT_EXTBUFF) { -+ DBG_871X_LEVEL(_drv_always_, "There are some pkts to transmit\n"); -+ DBG_871X_LEVEL(_drv_info_, "free_xmitbuf_cnt: %d, free_xmit_extbuf_cnt: %d\n", -+ pxmit_priv->free_xmitbuf_cnt, pxmit_priv->free_xmit_extbuf_cnt); -+ goto exit; -+ } -+ -+ ret = true; -+ -+exit: -+ return ret; -+} -+ -+void rtw_ps_processor(_adapter*padapter) -+{ -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+#endif //CONFIG_P2P -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+ rt_rf_power_state rfpwrstate; -+#endif //SUPPORT_HW_RFOFF_DETECTED -+ -+ pwrpriv->ps_processing = true; -+ -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+ if(pwrpriv->bips_processing == true) -+ goto exit; -+ -+ //DBG_871X("==> fw report state(0x%x)\n",rtw_read8(padapter,0x1ca)); -+ if(padapter->pwrctrlpriv.bHWPwrPindetect) -+ { -+ #ifdef CONFIG_AUTOSUSPEND -+ if(padapter->registrypriv.usbss_enable) -+ { -+ if(pwrpriv->rf_pwrstate == rf_on) -+ { -+ if(padapter->net_closed == true) -+ pwrpriv->ps_flag = true; -+ -+ rfpwrstate = RfOnOffDetect(padapter); -+ DBG_871X("@@@@- #1 %s==> rfstate:%s \n",__FUNCTION__,(rfpwrstate==rf_on)?"rf_on":"rf_off"); -+ if(rfpwrstate!= pwrpriv->rf_pwrstate) -+ { -+ if(rfpwrstate == rf_off) -+ { -+ pwrpriv->change_rfpwrstate = rf_off; -+ -+ pwrpriv->bkeepfwalive = true; -+ pwrpriv->brfoffbyhw = true; -+ -+ autosuspend_enter(padapter); -+ } -+ } -+ } -+ } -+ else -+ #endif //CONFIG_AUTOSUSPEND -+ { -+ rfpwrstate = RfOnOffDetect(padapter); -+ DBG_871X("@@@@- #2 %s==> rfstate:%s \n",__FUNCTION__,(rfpwrstate==rf_on)?"rf_on":"rf_off"); -+ -+ if(rfpwrstate!= pwrpriv->rf_pwrstate) -+ { -+ if(rfpwrstate == rf_off) -+ { -+ pwrpriv->change_rfpwrstate = rf_off; -+ pwrpriv->brfoffbyhw = true; -+ padapter->bCardDisableWOHSM = true; -+ rtw_hw_suspend(padapter ); -+ } -+ else -+ { -+ pwrpriv->change_rfpwrstate = rf_on; -+ rtw_hw_resume(padapter ); -+ } -+ DBG_871X("current rf_pwrstate(%s)\n",(pwrpriv->rf_pwrstate == rf_off)?"rf_off":"rf_on"); -+ } -+ } -+ pwrpriv->pwr_state_check_cnts ++; -+ } -+#endif //SUPPORT_HW_RFOFF_DETECTED -+ -+ if (pwrpriv->ips_mode_req == IPS_NONE -+ #ifdef CONFIG_CONCURRENT_MODE -+ || padapter->pbuddy_adapter->pwrctrlpriv.ips_mode_req == IPS_NONE -+ #endif -+ ) -+ goto exit; -+ -+ if (rtw_pwr_unassociated_idle(padapter) == false) -+ goto exit; -+ -+ if((pwrpriv->rf_pwrstate == rf_on) && ((pwrpriv->pwr_state_check_cnts%4)==0)) -+ { -+ DBG_871X("==>%s .fw_state(%x)\n",__FUNCTION__,get_fwstate(pmlmepriv)); -+ #if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ #else -+ pwrpriv->change_rfpwrstate = rf_off; -+ #endif -+ #ifdef CONFIG_AUTOSUSPEND -+ if(padapter->registrypriv.usbss_enable) -+ { -+ if(pwrpriv->bHWPwrPindetect) -+ pwrpriv->bkeepfwalive = true; -+ -+ if(padapter->net_closed == true) -+ pwrpriv->ps_flag = true; -+ -+ #if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ if (true==pwrpriv->bInternalAutoSuspend) { -+ DBG_871X("<==%s .pwrpriv->bInternalAutoSuspend)(%x)\n",__FUNCTION__,pwrpriv->bInternalAutoSuspend); -+ } else { -+ pwrpriv->change_rfpwrstate = rf_off; -+ padapter->bCardDisableWOHSM = true; -+ DBG_871X("<==%s .pwrpriv->bInternalAutoSuspend)(%x) call autosuspend_enter\n",__FUNCTION__,pwrpriv->bInternalAutoSuspend); -+ autosuspend_enter(padapter); -+ } -+ #else -+ padapter->bCardDisableWOHSM = true; -+ autosuspend_enter(padapter); -+ #endif //if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ } -+ else if(pwrpriv->bHWPwrPindetect) -+ { -+ } -+ else -+ #endif //CONFIG_AUTOSUSPEND -+ { -+ #if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ pwrpriv->change_rfpwrstate = rf_off; -+ #endif //defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ -+ #ifdef CONFIG_IPS -+ ips_enter(padapter); -+ #endif -+ } -+ } -+exit: -+ rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv); -+ pwrpriv->ps_processing = false; -+ return; -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+void pwr_state_check_handler(RTW_TIMER_HDL_ARGS) -+#else -+void pwr_state_check_handler(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *padapter = (_adapter *)FunctionContext; -+#else -+ _adapter *padapter = from_timer(padapter, t, pwrctrlpriv.pwr_state_check_timer); -+#endif -+ rtw_ps_cmd(padapter); -+} -+ -+ -+#ifdef CONFIG_LPS -+/* -+ * -+ * Parameters -+ * padapter -+ * pslv power state level, only could be PS_STATE_S0 ~ PS_STATE_S4 -+ * -+ */ -+void rtw_set_rpwm(PADAPTER padapter, u8 pslv) -+{ -+ u8 rpwm; -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ -+ -+ -+ pslv = PS_STATE(pslv); -+ -+ -+ if (true == pwrpriv->btcoex_rfon) -+ { -+ if (pslv < PS_STATE_S4) -+ pslv = PS_STATE_S3; -+ } -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+ if (pwrpriv->brpwmtimeout == true) -+ { -+ DBG_871X("%s: RPWM timeout, force to set RPWM(0x%02X) again!\n", __FUNCTION__, pslv); -+ } -+ else -+#endif // CONFIG_LPS_RPWM_TIMER -+ { -+ if ( (pwrpriv->rpwm == pslv) -+#ifdef CONFIG_LPS_LCLK -+ || ((pwrpriv->rpwm >= PS_STATE_S2)&&(pslv >= PS_STATE_S2)) -+#endif -+ ) -+ { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_,_drv_err_, -+ ("%s: Already set rpwm[0x%02X], new=0x%02X!\n", __FUNCTION__, pwrpriv->rpwm, pslv)); -+ return; -+ } -+ } -+ -+ if ((padapter->bSurpriseRemoved == true) || -+ (padapter->hw_init_completed == false)) -+ { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_err_, -+ ("%s: SurpriseRemoved(%d) hw_init_completed(%d)\n", -+ __FUNCTION__, padapter->bSurpriseRemoved, padapter->hw_init_completed)); -+ -+ pwrpriv->cpwm = PS_STATE_S4; -+ -+ return; -+ } -+ -+ if (padapter->bDriverStopped == true) -+ { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_err_, -+ ("%s: change power state(0x%02X) when DriverStopped\n", __FUNCTION__, pslv)); -+ -+ if (pslv < PS_STATE_S2) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_err_, -+ ("%s: Reject to enter PS_STATE(0x%02X) lower than S2 when DriverStopped!!\n", __FUNCTION__, pslv)); -+ return; -+ } -+ } -+ -+ rpwm = pslv | pwrpriv->tog; -+#ifdef CONFIG_LPS_LCLK -+ // only when from PS_STATE S0/S1 to S2 and higher needs ACK -+ if ((pwrpriv->cpwm < PS_STATE_S2) && (pslv >= PS_STATE_S2)) -+ rpwm |= PS_ACK; -+#endif -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("rtw_set_rpwm: rpwm=0x%02x cpwm=0x%02x\n", rpwm, pwrpriv->cpwm)); -+ -+ pwrpriv->rpwm = pslv; -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+ if (rpwm & PS_ACK) -+ _set_timer(&pwrpriv->pwr_rpwm_timer, LPS_RPWM_WAIT_MS); -+#endif // CONFIG_LPS_RPWM_TIMER -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); -+ -+ pwrpriv->tog += 0x80; -+ -+#ifdef CONFIG_LPS_LCLK -+ // No LPS 32K, No Ack -+ if (!(rpwm & PS_ACK)) -+#endif -+ { -+ pwrpriv->cpwm = pslv; -+ } -+ -+ -+} -+ -+u8 PS_RDY_CHECK(_adapter * padapter); -+u8 PS_RDY_CHECK(_adapter * padapter) -+{ -+ u32 curr_time, delta_time; -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ curr_time = rtw_get_current_time(); -+ -+ delta_time = curr_time -pwrpriv->DelayLPSLastTimeStamp; -+ -+ if(delta_time < LPS_DELAY_TIME) -+ { -+ return false; -+ } -+ -+ if ((check_fwstate(pmlmepriv, _FW_LINKED) == false) || -+ (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) || -+ (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) ) -+ return false; -+#ifdef CONFIG_WOWLAN -+ if(true == pwrpriv->bInSuspend && pwrpriv->wowlan_mode) -+ return true; -+ else -+ return false; -+#else -+ if(true == pwrpriv->bInSuspend ) -+ return false; -+#endif -+ if( (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) && (padapter->securitypriv.binstallGrpkey == false) ) -+ { -+ DBG_871X("Group handshake still in progress !!!\n"); -+ return false; -+ } -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (!rtw_cfg80211_pwr_mgmt(padapter)) -+ return false; -+#endif -+ -+ return true; -+} -+ -+void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode) -+{ -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+#endif //CONFIG_P2P -+#ifdef CONFIG_TDLS -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ _irqL irqL; -+ int i, j; -+ _list *plist, *phead; -+ struct sta_info *ptdls_sta; -+#endif //CONFIG_TDLS -+ -+ -+ -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("%s: PowerMode=%d Smart_PS=%d\n", -+ __FUNCTION__, ps_mode, smart_ps)); -+ -+ if(ps_mode > PM_Card_Disable) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_,_drv_err_,("ps_mode:%d error\n", ps_mode)); -+ return; -+ } -+ -+ if (pwrpriv->pwr_mode == ps_mode) -+ { -+ if (PS_MODE_ACTIVE == ps_mode) return; -+ -+ if ((pwrpriv->smart_ps == smart_ps) && -+ (pwrpriv->bcn_ant_mode == bcn_ant_mode)) -+ { -+ return; -+ } -+ } -+ -+#ifdef CONFIG_LPS_LCLK -+ _enter_pwrlock(&pwrpriv->lock); -+#endif -+ -+ //if(pwrpriv->pwr_mode == PS_MODE_ACTIVE) -+ if(ps_mode == PS_MODE_ACTIVE) -+ { -+#ifdef CONFIG_P2P_PS -+ if(pwdinfo->opp_ps == 0) -+#endif //CONFIG_P2P_PS -+ { -+ DBG_871X("rtw_set_ps_mode: Leave 802.11 power save\n"); -+ -+#ifdef CONFIG_TDLS -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for(i=0; i< NUM_STA; i++) -+ { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ ptdls_sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ if( ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE ) -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta, 0); -+ plist = get_next(plist); -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+#endif //CONFIG_TDLS -+ -+ pwrpriv->pwr_mode = ps_mode; -+ rtw_set_rpwm(padapter, PS_STATE_S4); -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); -+ pwrpriv->bFwCurrentInPSMode = false; -+ } -+ } -+ else -+ { -+ if (PS_RDY_CHECK(padapter) -+#ifdef CONFIG_BT_COEXIST -+ || (BT_1Ant(padapter) == true) -+#endif -+ ) -+ { -+ DBG_871X("%s: Enter 802.11 power save\n", __FUNCTION__); -+ -+#ifdef CONFIG_TDLS -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for(i=0; i< NUM_STA; i++) -+ { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ ptdls_sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ if( ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE ) -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta, 1); -+ plist = get_next(plist); -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+#endif //CONFIG_TDLS -+ -+ pwrpriv->bFwCurrentInPSMode = true; -+ pwrpriv->pwr_mode = ps_mode; -+ pwrpriv->smart_ps = smart_ps; -+ pwrpriv->bcn_ant_mode = bcn_ant_mode; -+ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); -+ -+#ifdef CONFIG_P2P_PS -+ // Set CTWindow after LPS -+ if(pwdinfo->opp_ps == 1) -+ p2p_ps_wk_cmd(padapter, P2P_PS_ENABLE, 0); -+#endif //CONFIG_P2P_PS -+ -+#ifdef CONFIG_LPS_LCLK -+ if (pwrpriv->alives == 0) -+ rtw_set_rpwm(padapter, PS_STATE_S0); -+#else -+ rtw_set_rpwm(padapter, PS_STATE_S2); -+#endif -+ } -+ } -+ -+#ifdef CONFIG_LPS_LCLK -+ _exit_pwrlock(&pwrpriv->lock); -+#endif -+ -+ -+} -+ -+/* -+ * Return: -+ * 0: Leave OK -+ * -1: Timeout -+ * -2: Other error -+ */ -+s32 LPS_RF_ON_check(PADAPTER padapter, u32 delay_ms) -+{ -+ u32 start_time; -+ u8 bAwake = false; -+ s32 err = 0; -+ -+ -+ start_time = rtw_get_current_time(); -+ while (1) -+ { -+ rtw_hal_get_hwreg(padapter, HW_VAR_FWLPS_RF_ON, &bAwake); -+ if (true == bAwake) -+ break; -+ -+ if (true == padapter->bSurpriseRemoved) -+ { -+ err = -2; -+ DBG_871X("%s: device surprise removed!!\n", __FUNCTION__); -+ break; -+ } -+ -+ if (rtw_get_passing_time_ms(start_time) > delay_ms) -+ { -+ err = -1; -+ DBG_871X("%s: Wait for FW LPS leave more than %u ms!!!\n", __FUNCTION__, delay_ms); -+ break; -+ } -+ rtw_usleep_os(100); -+ } -+ -+ return err; -+} -+ -+// -+// Description: -+// Enter the leisure power save mode. -+// -+void LPS_Enter(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _adapter *buddy = padapter->pbuddy_adapter; -+ -+ -+ -+// DBG_871X("+LeisurePSEnter\n"); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->iface_type != IFACE_PORT0) -+ return; /* Skip power saving for concurrent mode port 1*/ -+ -+ /* consider buddy, if exist */ -+ if (buddy) { -+ struct mlme_priv *b_pmlmepriv = &(buddy->mlmepriv); -+ #ifdef CONFIG_P2P -+ struct wifidirect_info *b_pwdinfo = &(buddy->wdinfo); -+ #ifdef CONFIG_IOCTL_CFG80211 -+ struct cfg80211_wifidirect_info *b_pcfg80211_wdinfo = &buddy->cfg80211_wdinfo; -+ #endif -+ #endif -+ -+ if (check_fwstate(b_pmlmepriv, WIFI_ASOC_STATE|WIFI_SITE_MONITOR) -+ || check_fwstate(b_pmlmepriv, WIFI_UNDER_LINKING|WIFI_UNDER_WPS) -+ || check_fwstate(b_pmlmepriv, WIFI_AP_STATE) -+ || check_fwstate(b_pmlmepriv, WIFI_ADHOC_MASTER_STATE|WIFI_ADHOC_STATE) -+ #if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P_IPS) -+ || b_pcfg80211_wdinfo->is_ro_ch -+ #elif defined(CONFIG_P2P) -+ || !rtw_p2p_chk_state(b_pwdinfo, P2P_STATE_NONE) -+ #endif -+ || rtw_is_scan_deny(buddy) -+ ) { -+ return; -+ } -+ } -+#endif -+ -+ if (PS_RDY_CHECK(padapter) == false) -+ return; -+ -+ if (pwrpriv->bLeisurePs) -+ { -+ // Idle for a while if we connect to AP a while ago. -+ if(pwrpriv->LpsIdleCount >= 2) // 4 Sec -+ { -+ if(pwrpriv->pwr_mode == PS_MODE_ACTIVE) -+ { -+ pwrpriv->bpower_saving = true; -+ rtw_set_ps_mode(padapter, pwrpriv->power_mgnt, padapter->registrypriv.smart_ps, 0); -+ } -+ } -+ else -+ pwrpriv->LpsIdleCount++; -+ } -+ -+// DBG_871X("-LeisurePSEnter\n"); -+ -+ -+} -+ -+// -+// Description: -+// Leave the leisure power save mode. -+// -+void LPS_Leave(PADAPTER padapter) -+{ -+#define LPS_LEAVE_TIMEOUT_MS 100 -+ -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ u32 start_time; -+ u8 bAwake = false; -+ -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->iface_type != IFACE_PORT0) -+ return; /* Skip power saving for concurrent mode port 1*/ -+#endif -+ -+// DBG_871X("+LeisurePSLeave\n"); -+ -+ if (pwrpriv->bLeisurePs) -+ { -+ if(pwrpriv->pwr_mode != PS_MODE_ACTIVE) -+ { -+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0); -+ -+ if(pwrpriv->pwr_mode == PS_MODE_ACTIVE) -+ LPS_RF_ON_check(padapter, LPS_LEAVE_TIMEOUT_MS); -+ } -+ } -+ -+ pwrpriv->bpower_saving = false; -+ -+// DBG_871X("-LeisurePSLeave\n"); -+ -+ -+} -+#endif -+ -+// -+// Description: Leave all power save mode: LPS, FwLPS, IPS if needed. -+// Move code to function by tynli. 2010.03.26. -+// -+void LeaveAllPowerSaveMode(PADAPTER Adapter) -+{ -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ u8 enqueue = 0; -+ -+ -+ -+ //DBG_871X("%s.....\n",__FUNCTION__); -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ { //connect -+#ifdef CONFIG_LPS_LCLK -+ enqueue = 1; -+#endif -+ -+#ifdef CONFIG_P2P_PS -+ p2p_ps_wk_cmd(Adapter, P2P_PS_DISABLE, enqueue); -+#endif //CONFIG_P2P_PS -+ -+#ifdef CONFIG_LPS -+ rtw_lps_ctrl_wk_cmd(Adapter, LPS_CTRL_LEAVE, enqueue); -+#endif -+ -+#ifdef CONFIG_LPS_LCLK -+ LPS_Leave_check(Adapter); -+#endif -+ } -+ else -+ { -+ if(Adapter->pwrctrlpriv.rf_pwrstate== rf_off) -+ { -+ #ifdef CONFIG_AUTOSUSPEND -+ if(Adapter->registrypriv.usbss_enable) -+ { -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ usb_disable_autosuspend(adapter_to_dvobj(Adapter)->pusbdev); -+ #elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,22) && LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,34)) -+ adapter_to_dvobj(Adapter)->pusbdev->autosuspend_disabled = Adapter->bDisableAutosuspend;//autosuspend disabled by the user -+ #endif -+ } -+ else -+ #endif -+ { -+ } -+ } -+ } -+ -+ -+} -+ -+#ifdef CONFIG_LPS_LCLK -+void LPS_Leave_check( -+ PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ u32 start_time; -+ u8 bReady; -+ -+ -+ -+ pwrpriv = &padapter->pwrctrlpriv; -+ -+ bReady = false; -+ start_time = rtw_get_current_time(); -+ -+ rtw_yield_os(); -+ -+ while(1) -+ { -+ _enter_pwrlock(&pwrpriv->lock); -+ -+ if ((padapter->bSurpriseRemoved == true) -+ || (padapter->hw_init_completed == false) -+ || (padapter->bDriverStopped== true) -+ || (pwrpriv->pwr_mode == PS_MODE_ACTIVE) -+ ) -+ { -+ bReady = true; -+ } -+ -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ if(true == bReady) -+ break; -+ -+ if(rtw_get_passing_time_ms(start_time)>100) -+ { -+ DBG_871X("Wait for cpwm event than 100 ms!!!\n"); -+ break; -+ } -+ rtw_msleep_os(1); -+ } -+ -+ -+} -+ -+/* -+ * Caller:ISR handler... -+ * -+ * This will be called when CPWM interrupt is up. -+ * -+ * using to update cpwn of drv; and drv willl make a decision to up or down pwr level -+ */ -+void cpwm_int_hdl( -+ PADAPTER padapter, -+ struct reportpwrstate_parm *preportpwrstate) -+{ -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+ -+ pwrpriv = &padapter->pwrctrlpriv; -+#if 0 -+ if (pwrpriv->cpwm_tog == (preportpwrstate->state & PS_TOGGLE)) { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_err_, -+ ("cpwm_int_hdl: tog(old)=0x%02x cpwm(new)=0x%02x toggle bit didn't change!?\n", -+ pwrpriv->cpwm_tog, preportpwrstate->state)); -+ goto exit; -+ } -+#endif -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+ if (pwrpriv->rpwm < PS_STATE_S2) -+ { -+ DBG_871X("%s: Redundant CPWM Int. RPWM=0x%02X CPWM=0x%02x\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); -+ _exit_pwrlock(&pwrpriv->lock); -+ goto exit; -+ } -+#endif // CONFIG_LPS_RPWM_TIMER -+ -+ pwrpriv->cpwm = PS_STATE(preportpwrstate->state); -+ pwrpriv->cpwm_tog = preportpwrstate->state & PS_TOGGLE; -+ -+ if (pwrpriv->cpwm >= PS_STATE_S2) -+ { -+ if (pwrpriv->alives & CMD_ALIVE) -+ _rtw_up_sema(&padapter->cmdpriv.cmd_queue_sema); -+ -+ if (pwrpriv->alives & XMIT_ALIVE) -+ _rtw_up_sema(&padapter->xmitpriv.xmit_sema); -+ } -+ -+ _exit_pwrlock(&pwrpriv->lock); -+ -+exit: -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("cpwm_int_hdl: cpwm=0x%02x\n", pwrpriv->cpwm)); -+ -+ -+} -+ -+static void cpwm_event_callback(struct work_struct *work) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, cpwm_event); -+ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); -+ struct reportpwrstate_parm report; -+ -+ //DBG_871X("%s\n",__FUNCTION__); -+ -+ report.state = PS_STATE_S2; -+ cpwm_int_hdl(adapter, &report); -+} -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+static void rpwmtimeout_workitem_callback(struct work_struct *work) -+{ -+ PADAPTER padapter; -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+ pwrpriv = container_of(work, struct pwrctrl_priv, rpwmtimeoutwi); -+ padapter = container_of(pwrpriv, _adapter, pwrctrlpriv); -+// DBG_871X("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) -+ { -+ DBG_871X("%s: rpwm=0x%02X cpwm=0x%02X CPWM done!\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); -+ goto exit; -+ } -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ if (rtw_read8(padapter, 0x100) != 0xEA) -+ { -+#if 1 -+ struct reportpwrstate_parm report; -+ -+ report.state = PS_STATE_S2; -+ DBG_871X("\n%s: FW already leave 32K!\n\n", __func__); -+ cpwm_int_hdl(padapter, &report); -+#else -+ DBG_871X("\n%s: FW already leave 32K!\n\n", __func__); -+ cpwm_event_callback(&pwrpriv->cpwm_event); -+#endif -+ return; -+ } -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ -+ if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) -+ { -+ DBG_871X("%s: cpwm=%d, nothing to do!\n", __func__, pwrpriv->cpwm); -+ goto exit; -+ } -+ pwrpriv->brpwmtimeout = true; -+ rtw_set_rpwm(padapter, pwrpriv->rpwm); -+ pwrpriv->brpwmtimeout = false; -+ -+exit: -+ _exit_pwrlock(&pwrpriv->lock); -+} -+ -+/* -+ * This function is a timer handler, can't do any IO in it. -+ */ -+static void pwr_rpwm_timeout_handler(void *FunctionContext) -+{ -+ PADAPTER padapter; -+ struct pwrctrl_priv *pwrpriv; -+ -+ -+ padapter = (PADAPTER)FunctionContext; -+ pwrpriv = &padapter->pwrctrlpriv; -+// DBG_871X("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); -+ -+ if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) -+ { -+ DBG_871X("+%s: cpwm=%d, nothing to do!\n", __func__, pwrpriv->cpwm); -+ return; -+ } -+ -+ _set_workitem(&pwrpriv->rpwmtimeoutwi); -+} -+#endif // CONFIG_LPS_RPWM_TIMER -+ -+__inline static void register_task_alive(struct pwrctrl_priv *pwrctrl, u32 tag) -+{ -+ pwrctrl->alives |= tag; -+} -+ -+__inline static void unregister_task_alive(struct pwrctrl_priv *pwrctrl, u32 tag) -+{ -+ pwrctrl->alives &= ~tag; -+} -+ -+/* -+ * Caller: rtw_xmit_thread -+ * -+ * Check if the fw_pwrstate is okay for xmit. -+ * If not (cpwm is less than S3), then the sub-routine -+ * will raise the cpwm to be greater than or equal to S3. -+ * -+ * Calling Context: Passive -+ * -+ * Return Value: -+ * _SUCCESS rtw_xmit_thread can write fifo/txcmd afterwards. -+ * _FAIL rtw_xmit_thread can not do anything. -+ */ -+s32 rtw_register_tx_alive(PADAPTER padapter) -+{ -+ s32 res; -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+ -+ -+ res = _SUCCESS; -+ pwrctrl = &padapter->pwrctrlpriv; -+#ifdef CONFIG_BT_COEXIST -+ if (true == pwrctrl->btcoex_rfon) -+ pslv = PS_STATE_S3; -+ else -+#endif -+ { -+ pslv = PS_STATE_S2; -+ } -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, XMIT_ALIVE); -+ -+ if (pwrctrl->bFwCurrentInPSMode == true) -+ { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("rtw_register_tx_alive: cpwm=0x%02x alives=0x%08x\n", -+ pwrctrl->cpwm, pwrctrl->alives)); -+ -+ if (pwrctrl->cpwm < pslv) -+ { -+ if (pwrctrl->cpwm < PS_STATE_S2) -+ res = _FAIL; -+ if (pwrctrl->rpwm < pslv) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+ -+ -+ return res; -+} -+ -+/* -+ * Caller: rtw_cmd_thread -+ * -+ * Check if the fw_pwrstate is okay for issuing cmd. -+ * If not (cpwm should be is less than S2), then the sub-routine -+ * will raise the cpwm to be greater than or equal to S2. -+ * -+ * Calling Context: Passive -+ * -+ * Return Value: -+ * _SUCCESS rtw_cmd_thread can issue cmds to firmware afterwards. -+ * _FAIL rtw_cmd_thread can not do anything. -+ */ -+s32 rtw_register_cmd_alive(PADAPTER padapter) -+{ -+ s32 res; -+ struct pwrctrl_priv *pwrctrl; -+ u8 pslv; -+ -+ -+ -+ res = _SUCCESS; -+ pwrctrl = &padapter->pwrctrlpriv; -+#ifdef CONFIG_BT_COEXIST -+ if (true == pwrctrl->btcoex_rfon) -+ pslv = PS_STATE_S3; -+ else -+#endif -+ { -+ pslv = PS_STATE_S2; -+ } -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, CMD_ALIVE); -+ -+ if (pwrctrl->bFwCurrentInPSMode == true) -+ { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_info_, -+ ("rtw_register_cmd_alive: cpwm=0x%02x alives=0x%08x\n", -+ pwrctrl->cpwm, pwrctrl->alives)); -+ -+ if (pwrctrl->cpwm < pslv) -+ { -+ if (pwrctrl->cpwm < PS_STATE_S2) -+ res = _FAIL; -+ if (pwrctrl->rpwm < pslv) -+ rtw_set_rpwm(padapter, pslv); -+ } -+ } -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+ -+ -+ return res; -+} -+ -+/* -+ * Caller: rx_isr -+ * -+ * Calling Context: Dispatch/ISR -+ * -+ * Return Value: -+ * _SUCCESS -+ * _FAIL -+ */ -+s32 rtw_register_rx_alive(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ -+ -+ -+ pwrctrl = &padapter->pwrctrlpriv; -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, RECV_ALIVE); -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("rtw_register_rx_alive: cpwm=0x%02x alives=0x%08x\n", -+ pwrctrl->cpwm, pwrctrl->alives)); -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+ -+ -+ return _SUCCESS; -+} -+ -+/* -+ * Caller: evt_isr or evt_thread -+ * -+ * Calling Context: Dispatch/ISR or Passive -+ * -+ * Return Value: -+ * _SUCCESS -+ * _FAIL -+ */ -+s32 rtw_register_evt_alive(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ -+ -+ -+ pwrctrl = &padapter->pwrctrlpriv; -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ register_task_alive(pwrctrl, EVT_ALIVE); -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("rtw_register_evt_alive: cpwm=0x%02x alives=0x%08x\n", -+ pwrctrl->cpwm, pwrctrl->alives)); -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+ -+ -+ return _SUCCESS; -+} -+ -+/* -+ * Caller: ISR -+ * -+ * If ISR's txdone, -+ * No more pkts for TX, -+ * Then driver shall call this fun. to power down firmware again. -+ */ -+void rtw_unregister_tx_alive(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ -+ -+ -+ pwrctrl = &padapter->pwrctrlpriv; -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ unregister_task_alive(pwrctrl, XMIT_ALIVE); -+ -+ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) && -+ (pwrctrl->bFwCurrentInPSMode == true)) -+ { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("%s: cpwm=0x%02x alives=0x%08x\n", -+ __FUNCTION__, pwrctrl->cpwm, pwrctrl->alives)); -+ -+ if ((pwrctrl->alives == 0) && -+ (pwrctrl->cpwm > PS_STATE_S0)) -+ { -+ rtw_set_rpwm(padapter, PS_STATE_S0); -+ } -+ } -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+ -+} -+ -+/* -+ * Caller: ISR -+ * -+ * If all commands have been done, -+ * and no more command to do, -+ * then driver shall call this fun. to power down firmware again. -+ */ -+void rtw_unregister_cmd_alive(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ -+ -+ -+ pwrctrl = &padapter->pwrctrlpriv; -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ unregister_task_alive(pwrctrl, CMD_ALIVE); -+ -+ if ((pwrctrl->pwr_mode != PS_MODE_ACTIVE) && -+ (pwrctrl->bFwCurrentInPSMode == true)) -+ { -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_info_, -+ ("%s: cpwm=0x%02x alives=0x%08x\n", -+ __FUNCTION__, pwrctrl->cpwm, pwrctrl->alives)); -+ -+ if ((pwrctrl->alives == 0) && -+ (pwrctrl->cpwm > PS_STATE_S0)) -+ { -+ rtw_set_rpwm(padapter, PS_STATE_S0); -+ } -+ } -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+ -+} -+ -+/* -+ * Caller: ISR -+ */ -+void rtw_unregister_rx_alive(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ -+ -+ -+ pwrctrl = &padapter->pwrctrlpriv; -+ -+ _enter_pwrlock(&pwrctrl->lock); -+ -+ unregister_task_alive(pwrctrl, RECV_ALIVE); -+ -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("rtw_unregister_rx_alive: cpwm=0x%02x alives=0x%08x\n", -+ pwrctrl->cpwm, pwrctrl->alives)); -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+ -+} -+ -+void rtw_unregister_evt_alive(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrl; -+ -+ -+ -+ pwrctrl = &padapter->pwrctrlpriv; -+ -+ unregister_task_alive(pwrctrl, EVT_ALIVE); -+ -+ RT_TRACE(_module_rtl871x_pwrctrl_c_, _drv_notice_, -+ ("rtw_unregister_evt_alive: cpwm=0x%02x alives=0x%08x\n", -+ pwrctrl->cpwm, pwrctrl->alives)); -+ -+ _exit_pwrlock(&pwrctrl->lock); -+ -+ -+} -+#endif /* CONFIG_LPS_LCLK */ -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+static void resume_workitem_callback(struct work_struct *work); -+#endif //CONFIG_RESUME_IN_WORKQUEUE -+ -+void rtw_init_pwrctrl_priv(PADAPTER padapter) -+{ -+ struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; -+ -+ _init_pwrlock(&pwrctrlpriv->lock); -+ pwrctrlpriv->rf_pwrstate = rf_on; -+ pwrctrlpriv->ips_enter_cnts=0; -+ pwrctrlpriv->ips_leave_cnts=0; -+ pwrctrlpriv->bips_processing = false; -+ -+ pwrctrlpriv->ips_mode = padapter->registrypriv.ips_mode; -+ pwrctrlpriv->ips_mode_req = padapter->registrypriv.ips_mode; -+ -+ pwrctrlpriv->pwr_state_check_interval = RTW_PWR_STATE_CHK_INTERVAL; -+ pwrctrlpriv->pwr_state_check_cnts = 0; -+ pwrctrlpriv->bInternalAutoSuspend = false; -+ pwrctrlpriv->bInSuspend = false; -+ pwrctrlpriv->bkeepfwalive = false; -+ -+#ifdef CONFIG_AUTOSUSPEND -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+ pwrctrlpriv->pwr_state_check_interval = (pwrctrlpriv->bHWPwrPindetect) ?1000:2000; -+#endif -+#endif -+ -+ pwrctrlpriv->LpsIdleCount = 0; -+ //pwrctrlpriv->FWCtrlPSMode =padapter->registrypriv.power_mgnt;// PS_MODE_MIN; -+ if (padapter->registrypriv.mp_mode == 1) -+ pwrctrlpriv->power_mgnt =PS_MODE_ACTIVE ; -+ else -+ pwrctrlpriv->power_mgnt =padapter->registrypriv.power_mgnt;// PS_MODE_MIN; -+ pwrctrlpriv->bLeisurePs = (PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt)?true:false; -+ -+ pwrctrlpriv->bFwCurrentInPSMode = false; -+ -+ pwrctrlpriv->rpwm = 0; -+ pwrctrlpriv->cpwm = PS_STATE_S4; -+ -+ pwrctrlpriv->pwr_mode = PS_MODE_ACTIVE; -+ pwrctrlpriv->smart_ps = padapter->registrypriv.smart_ps; -+ pwrctrlpriv->bcn_ant_mode = 0; -+ -+ pwrctrlpriv->tog = 0x80; -+ -+ pwrctrlpriv->btcoex_rfon = false; -+ -+#ifdef CONFIG_LPS_LCLK -+ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&pwrctrlpriv->rpwm)); -+ -+ _init_workitem(&pwrctrlpriv->cpwm_event, cpwm_event_callback, NULL); -+ -+#ifdef CONFIG_LPS_RPWM_TIMER -+ pwrctrlpriv->brpwmtimeout = false; -+ _init_workitem(&pwrctrlpriv->rpwmtimeoutwi, rpwmtimeout_workitem_callback, NULL); -+ _init_timer(&pwrctrlpriv->pwr_rpwm_timer, padapter->pnetdev, pwr_rpwm_timeout_handler, padapter); -+#endif // CONFIG_LPS_RPWM_TIMER -+#endif // CONFIG_LPS_LCLK -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ rtw_init_timer(&pwrctrlpriv->pwr_state_check_timer, padapter, pwr_state_check_handler); -+#else -+ timer_setup(&pwrctrlpriv->pwr_state_check_timer, pwr_state_check_handler, 0); -+#endif -+ #ifdef CONFIG_RESUME_IN_WORKQUEUE -+ _init_workitem(&pwrctrlpriv->resume_work, resume_workitem_callback, NULL); -+ pwrctrlpriv->rtw_workqueue = create_singlethread_workqueue("rtw_workqueue"); -+ #endif //CONFIG_RESUME_IN_WORKQUEUE -+ -+ #if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) -+ pwrctrlpriv->early_suspend.suspend = NULL; -+ rtw_register_early_suspend(pwrctrlpriv); -+ #endif //CONFIG_HAS_EARLYSUSPEND || CONFIG_ANDROID_POWER -+ -+ -+ -+ -+} -+ -+ -+void rtw_free_pwrctrl_priv(PADAPTER adapter) -+{ -+ struct pwrctrl_priv *pwrctrlpriv = &adapter->pwrctrlpriv; -+ -+ -+ -+ //_rtw_memset((unsigned char *)pwrctrlpriv, 0, sizeof(struct pwrctrl_priv)); -+ -+ -+ #ifdef CONFIG_RESUME_IN_WORKQUEUE -+ if (pwrctrlpriv->rtw_workqueue) { -+ flush_workqueue(pwrctrlpriv->rtw_workqueue); -+ destroy_workqueue(pwrctrlpriv->rtw_workqueue); -+ } -+ #endif -+ -+ -+ #if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) -+ rtw_unregister_early_suspend(pwrctrlpriv); -+ #endif //CONFIG_HAS_EARLYSUSPEND || CONFIG_ANDROID_POWER -+ -+ _free_pwrlock(&pwrctrlpriv->lock); -+ -+ -+} -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+extern int rtw_resume_process(_adapter *padapter); -+static void resume_workitem_callback(struct work_struct *work) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, resume_work); -+ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); -+ -+ DBG_871X("%s\n",__FUNCTION__); -+ -+ rtw_resume_process(adapter); -+} -+ -+void rtw_resume_in_workqueue(struct pwrctrl_priv *pwrpriv) -+{ -+ // accquire system's suspend lock preventing from falliing asleep while resume in workqueue -+ rtw_lock_suspend(); -+ -+ #if 1 -+ queue_work(pwrpriv->rtw_workqueue, &pwrpriv->resume_work); -+ #else -+ _set_workitem(&pwrpriv->resume_work); -+ #endif -+} -+#endif //CONFIG_RESUME_IN_WORKQUEUE -+ -+#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) -+inline bool rtw_is_earlysuspend_registered(struct pwrctrl_priv *pwrpriv) -+{ -+ return (pwrpriv->early_suspend.suspend) ? true : false; -+} -+ -+inline bool rtw_is_do_late_resume(struct pwrctrl_priv *pwrpriv) -+{ -+ return (pwrpriv->do_late_resume) ? true : false; -+} -+ -+inline void rtw_set_do_late_resume(struct pwrctrl_priv *pwrpriv, bool enable) -+{ -+ pwrpriv->do_late_resume = enable; -+} -+#endif -+ -+#ifdef CONFIG_HAS_EARLYSUSPEND -+extern int rtw_resume_process(_adapter *padapter); -+static void rtw_early_suspend(struct early_suspend *h) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); -+ DBG_871X("%s\n",__FUNCTION__); -+ -+ rtw_set_do_late_resume(pwrpriv, false); -+} -+ -+static void rtw_late_resume(struct early_suspend *h) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); -+ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); -+ -+ DBG_871X("%s\n",__FUNCTION__); -+ if(pwrpriv->do_late_resume) { -+ rtw_set_do_late_resume(pwrpriv, false); -+ rtw_resume_process(adapter); -+ } -+} -+ -+void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv) -+{ -+ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (adapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ //jeff: set the early suspend level before blank screen, so we wll do late resume after scree is lit -+ pwrpriv->early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20; -+ pwrpriv->early_suspend.suspend = rtw_early_suspend; -+ pwrpriv->early_suspend.resume = rtw_late_resume; -+ register_early_suspend(&pwrpriv->early_suspend); -+ -+ -+} -+ -+void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv) -+{ -+ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (adapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ rtw_set_do_late_resume(pwrpriv, false); -+ -+ if (pwrpriv->early_suspend.suspend) -+ unregister_early_suspend(&pwrpriv->early_suspend); -+ -+ pwrpriv->early_suspend.suspend = NULL; -+ pwrpriv->early_suspend.resume = NULL; -+} -+#endif //CONFIG_HAS_EARLYSUSPEND -+ -+#ifdef CONFIG_ANDROID_POWER -+extern int rtw_resume_process(PADAPTER padapter); -+static void rtw_early_suspend(android_early_suspend_t *h) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); -+ DBG_871X("%s\n",__FUNCTION__); -+ -+ rtw_set_do_late_resume(pwrpriv, false); -+} -+ -+static void rtw_late_resume(android_early_suspend_t *h) -+{ -+ struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); -+ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); -+ -+ DBG_871X("%s\n",__FUNCTION__); -+ if(pwrpriv->do_late_resume) { -+ rtw_set_do_late_resume(pwrpriv, false); -+ rtw_resume_process(adapter); -+ } -+} -+ -+void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv) -+{ -+ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (adapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ //jeff: set the early suspend level before blank screen, so we wll do late resume after scree is lit -+ pwrpriv->early_suspend.level = ANDROID_EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20; -+ pwrpriv->early_suspend.suspend = rtw_early_suspend; -+ pwrpriv->early_suspend.resume = rtw_late_resume; -+ android_register_early_suspend(&pwrpriv->early_suspend); -+} -+ -+void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv) -+{ -+ _adapter *adapter = container_of(pwrpriv, _adapter, pwrctrlpriv); -+ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (adapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ rtw_set_do_late_resume(pwrpriv, false); -+ -+ if (pwrpriv->early_suspend.suspend) -+ android_unregister_early_suspend(&pwrpriv->early_suspend); -+ -+ pwrpriv->early_suspend.suspend = NULL; -+ pwrpriv->early_suspend.resume = NULL; -+} -+#endif //CONFIG_ANDROID_POWER -+ -+u8 rtw_interface_ps_func(_adapter *padapter,HAL_INTF_PS_FUNC efunc_id,u8* val) -+{ -+ u8 bResult = true; -+ rtw_hal_intf_ps_func(padapter,efunc_id,val); -+ -+ return bResult; -+} -+ -+ -+inline void rtw_set_ips_deny(_adapter *padapter, u32 ms) -+{ -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ms); -+} -+ -+/* -+* rtw_pwr_wakeup - Wake the NIC up from: 1)IPS. 2)USB autosuspend -+* @adapter: pointer to _adapter structure -+* @ips_deffer_ms: the ms wiil prevent from falling into IPS after wakeup -+* Return _SUCCESS or _FAIL -+*/ -+ -+int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller) -+{ -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ int ret = _SUCCESS; -+ u32 start = rtw_get_current_time(); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->pbuddy_adapter) -+ LeaveAllPowerSaveMode(padapter->pbuddy_adapter); -+ -+ if ((padapter->isprimary == false) && padapter->pbuddy_adapter){ -+ padapter = padapter->pbuddy_adapter; -+ pwrpriv = &padapter->pwrctrlpriv; -+ pmlmepriv = &padapter->mlmepriv; -+ } -+#endif -+ -+ if (pwrpriv->ips_deny_time < rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms)) -+ pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms); -+ -+ -+ if (pwrpriv->ps_processing) { -+ DBG_871X("%s wait ps_processing...\n", __func__); -+ while (pwrpriv->ps_processing && rtw_get_passing_time_ms(start) <= 3000) -+ rtw_msleep_os(10); -+ if (pwrpriv->ps_processing) -+ DBG_871X("%s wait ps_processing timeout\n", __func__); -+ else -+ DBG_871X("%s wait ps_processing done\n", __func__); -+ } -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ if (rtw_hal_sreset_inprogress(padapter)) { -+ DBG_871X("%s wait sreset_inprogress...\n", __func__); -+ while (rtw_hal_sreset_inprogress(padapter) && rtw_get_passing_time_ms(start) <= 4000) -+ rtw_msleep_os(10); -+ if (rtw_hal_sreset_inprogress(padapter)) -+ DBG_871X("%s wait sreset_inprogress timeout\n", __func__); -+ else -+ DBG_871X("%s wait sreset_inprogress done\n", __func__); -+ } -+#endif -+ -+ if (pwrpriv->bInternalAutoSuspend == false && pwrpriv->bInSuspend) { -+ DBG_871X("%s wait bInSuspend...\n", __func__); -+ while (pwrpriv->bInSuspend -+ && ((rtw_get_passing_time_ms(start) <= 3000 && !rtw_is_do_late_resume(pwrpriv)) -+ || (rtw_get_passing_time_ms(start) <= 500 && rtw_is_do_late_resume(pwrpriv))) -+ ) { -+ rtw_msleep_os(10); -+ } -+ if (pwrpriv->bInSuspend) -+ DBG_871X("%s wait bInSuspend timeout\n", __func__); -+ else -+ DBG_871X("%s wait bInSuspend done\n", __func__); -+ } -+ -+ //System suspend is not allowed to wakeup -+ if((pwrpriv->bInternalAutoSuspend == false) && (true == pwrpriv->bInSuspend )){ -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ //block??? -+ if((pwrpriv->bInternalAutoSuspend == true) && (padapter->net_closed == true)) { -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ //I think this should be check in IPS, LPS, autosuspend functions... -+ if (check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ { -+#if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ if(true==pwrpriv->bInternalAutoSuspend){ -+ if(0==pwrpriv->autopm_cnt){ -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,33)) -+ if (usb_autopm_get_interface(adapter_to_dvobj(padapter)->pusbintf) < 0) -+ { -+ DBG_871X( "can't get autopm: \n"); -+ } -+ #elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,20)) -+ usb_autopm_disable(adapter_to_dvobj(padapter)->pusbintf); -+ #else -+ usb_autoresume_device(adapter_to_dvobj(padapter)->pusbdev, 1); -+ #endif -+ pwrpriv->autopm_cnt++; -+ } -+#endif //#if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ ret = _SUCCESS; -+ goto exit; -+#if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ } -+#endif //#if defined (CONFIG_BT_COEXIST)&& defined (CONFIG_AUTOSUSPEND) -+ } -+ -+ if(rf_off == pwrpriv->rf_pwrstate ) -+ { -+#ifdef CONFIG_AUTOSUSPEND -+ if(pwrpriv->brfoffbyhw==true) -+ { -+ DBG_8192C("hw still in rf_off state ...........\n"); -+ ret = _FAIL; -+ goto exit; -+ } -+ else if(padapter->registrypriv.usbss_enable) -+ { -+ DBG_8192C("%s call autoresume_enter....\n",__FUNCTION__); -+ if(_FAIL == autoresume_enter(padapter)) -+ { -+ DBG_8192C("======> autoresume fail.............\n"); -+ ret = _FAIL; -+ goto exit; -+ } -+ } -+ else -+#endif -+ { -+#ifdef CONFIG_IPS -+ DBG_8192C("%s call ips_leave....\n",__FUNCTION__); -+ if(_FAIL == ips_leave(padapter)) -+ { -+ DBG_8192C("======> ips_leave fail.............\n"); -+ ret = _FAIL; -+ goto exit; -+ } -+#endif -+ } -+ } -+ -+ //TODO: the following checking need to be merged... -+ if(padapter->bDriverStopped -+ || !padapter->bup -+ || !padapter->hw_init_completed -+ ){ -+ DBG_8192C("%s: bDriverStopped=%d, bup=%d, hw_init_completed=%u\n" -+ , caller -+ , padapter->bDriverStopped -+ , padapter->bup -+ , padapter->hw_init_completed); -+ ret= false; -+ goto exit; -+ } -+ -+exit: -+ if (pwrpriv->ips_deny_time < rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms)) -+ pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms); -+ return ret; -+ -+} -+ -+int rtw_pm_set_lps(_adapter *padapter, u8 mode) -+{ -+ int ret = 0; -+ struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; -+ -+ if ( mode < PS_MODE_NUM ) -+ { -+ if(pwrctrlpriv->power_mgnt !=mode) -+ { -+ if(PS_MODE_ACTIVE == mode) -+ { -+ LeaveAllPowerSaveMode(padapter); -+ } -+ else -+ { -+ pwrctrlpriv->LpsIdleCount = 2; -+ } -+ pwrctrlpriv->power_mgnt = mode; -+ pwrctrlpriv->bLeisurePs = (PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt)?true:false; -+ } -+ } -+ else -+ { -+ ret = -EINVAL; -+ } -+ -+ return ret; -+} -+ -+int rtw_pm_set_ips(_adapter *padapter, u8 mode) -+{ -+ struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; -+ -+ if( mode == IPS_NORMAL || mode == IPS_LEVEL_2 ) { -+ rtw_ips_mode_req(pwrctrlpriv, mode); -+ DBG_871X("%s %s\n", __FUNCTION__, mode == IPS_NORMAL?"IPS_NORMAL":"IPS_LEVEL_2"); -+ return 0; -+ } -+ else if(mode ==IPS_NONE){ -+ rtw_ips_mode_req(pwrctrlpriv, mode); -+ DBG_871X("%s %s\n", __FUNCTION__, "IPS_NONE"); -+ if((padapter->bSurpriseRemoved ==0)&&(_FAIL == rtw_pwr_wakeup(padapter)) ) -+ return -EFAULT; -+ } -+ else { -+ return -EINVAL; -+ } -+ return 0; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_recv.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_recv.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_recv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_recv.c 2018-02-06 17:42:30.699967001 +0200 -@@ -0,0 +1,3627 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_RECV_C_ -+ -+#include -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS); -+#else -+void rtw_signal_stat_timer_hdl(struct timer_list *t); -+#endif -+#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+ -+void _rtw_init_sta_recv_priv(struct sta_recv_priv *psta_recvpriv) -+{ -+ -+ -+ -+ -+ _rtw_memset((u8 *)psta_recvpriv, 0, sizeof (struct sta_recv_priv)); -+ -+ _rtw_spinlock_init(&psta_recvpriv->lock); -+ -+ //for(i=0; iblk_strms[i]); -+ -+ _rtw_init_queue(&psta_recvpriv->defrag_q); -+ -+ -+ -+} -+ -+sint _rtw_init_recv_priv(struct recv_priv *precvpriv, _adapter *padapter) -+{ -+ sint i; -+ -+ union recv_frame *precvframe; -+ -+ sint res=_SUCCESS; -+ -+ -+ -+ // We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). -+ //_rtw_memset((unsigned char *)precvpriv, 0, sizeof (struct recv_priv)); -+ -+ _rtw_spinlock_init(&precvpriv->lock); -+ -+ _rtw_init_queue(&precvpriv->free_recv_queue); -+ _rtw_init_queue(&precvpriv->recv_pending_queue); -+ _rtw_init_queue(&precvpriv->uc_swdec_pending_queue); -+ -+ precvpriv->adapter = padapter; -+ -+ precvpriv->free_recvframe_cnt = NR_RECVFRAME; -+ -+ rtw_os_recv_resource_init(precvpriv, padapter); -+ -+ precvpriv->pallocated_frame_buf = rtw_zvmalloc(NR_RECVFRAME * sizeof(union recv_frame) + RXFRAME_ALIGN_SZ); -+ -+ if(precvpriv->pallocated_frame_buf==NULL){ -+ res= _FAIL; -+ goto exit; -+ } -+ //_rtw_memset(precvpriv->pallocated_frame_buf, 0, NR_RECVFRAME * sizeof(union recv_frame) + RXFRAME_ALIGN_SZ); -+ -+ precvpriv->precv_frame_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(precvpriv->pallocated_frame_buf), RXFRAME_ALIGN_SZ); -+ //precvpriv->precv_frame_buf = precvpriv->pallocated_frame_buf + RXFRAME_ALIGN_SZ - -+ // ((SIZE_PTR) (precvpriv->pallocated_frame_buf) &(RXFRAME_ALIGN_SZ-1)); -+ -+ precvframe = (union recv_frame*) precvpriv->precv_frame_buf; -+ -+ -+ for(i=0; i < NR_RECVFRAME ; i++) -+ { -+ _rtw_init_listhead(&(precvframe->u.list)); -+ -+ rtw_list_insert_tail(&(precvframe->u.list), &(precvpriv->free_recv_queue.queue)); -+ -+ res = rtw_os_recv_resource_alloc(padapter, precvframe); -+ -+ precvframe->u.hdr.len = 0; -+ -+ precvframe->u.hdr.adapter =padapter; -+ precvframe++; -+ -+ } -+ -+ precvpriv->rx_pending_cnt=1; -+ -+ _rtw_init_sema(&precvpriv->allrxreturnevt, 0); -+ -+ res = rtw_hal_init_recv_priv(padapter); -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ rtw_init_timer(&precvpriv->signal_stat_timer, padapter, RTW_TIMER_HDL_NAME(signal_stat)); -+#else -+ timer_setup(&precvpriv->signal_stat_timer, RTW_TIMER_HDL_NAME(signal_stat), 0); -+#endif -+ -+ precvpriv->signal_stat_sampling_interval = 1000; //ms -+ //precvpriv->signal_stat_converging_constant = 5000; //ms -+ -+ rtw_set_signal_stat_timer(precvpriv); -+#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+exit: -+ -+ -+ -+ return res; -+ -+} -+ -+void rtw_mfree_recv_priv_lock(struct recv_priv *precvpriv); -+void rtw_mfree_recv_priv_lock(struct recv_priv *precvpriv) -+{ -+ _rtw_spinlock_free(&precvpriv->lock); -+#ifdef CONFIG_RECV_THREAD_MODE -+ _rtw_free_sema(&precvpriv->recv_sema); -+ _rtw_free_sema(&precvpriv->terminate_recvthread_sema); -+#endif -+ -+ _rtw_spinlock_free(&precvpriv->free_recv_queue.lock); -+ _rtw_spinlock_free(&precvpriv->recv_pending_queue.lock); -+ -+ _rtw_spinlock_free(&precvpriv->free_recv_buf_queue.lock); -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ _rtw_spinlock_free(&precvpriv->recv_buf_pending_queue.lock); -+#endif // CONFIG_USE_USB_BUFFER_ALLOC_RX -+} -+ -+void _rtw_free_recv_priv (struct recv_priv *precvpriv) -+{ -+ _adapter *padapter = precvpriv->adapter; -+ -+ -+ -+ rtw_free_uc_swdec_pending_queue(padapter); -+ -+ rtw_mfree_recv_priv_lock(precvpriv); -+ -+ rtw_os_recv_resource_free(precvpriv); -+ -+ if(precvpriv->pallocated_frame_buf) { -+ rtw_vmfree(precvpriv->pallocated_frame_buf, NR_RECVFRAME * sizeof(union recv_frame) + RXFRAME_ALIGN_SZ); -+ } -+ -+ rtw_hal_free_recv_priv(padapter); -+ -+ -+ -+} -+ -+union recv_frame *_rtw_alloc_recvframe (_queue *pfree_recv_queue) -+{ -+ -+ union recv_frame *precvframe; -+ _list *plist, *phead; -+ _adapter *padapter; -+ struct recv_priv *precvpriv; -+ -+ -+ if(_rtw_queue_empty(pfree_recv_queue) == true) -+ { -+ precvframe = NULL; -+ } -+ else -+ { -+ phead = get_list_head(pfree_recv_queue); -+ -+ plist = get_next(phead); -+ -+ precvframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ -+ rtw_list_delete(&precvframe->u.hdr.list); -+ padapter=precvframe->u.hdr.adapter; -+ if(padapter !=NULL){ -+ precvpriv=&padapter->recvpriv; -+ if(pfree_recv_queue == &precvpriv->free_recv_queue) -+ precvpriv->free_recvframe_cnt--; -+ } -+ } -+ -+ -+ -+ return precvframe; -+ -+} -+ -+union recv_frame *rtw_alloc_recvframe (_queue *pfree_recv_queue) -+{ -+ _irqL irqL; -+ union recv_frame *precvframe; -+ -+ _enter_critical_bh(&pfree_recv_queue->lock, &irqL); -+ -+ precvframe = _rtw_alloc_recvframe(pfree_recv_queue); -+ -+ _exit_critical_bh(&pfree_recv_queue->lock, &irqL); -+ -+ return precvframe; -+} -+ -+void rtw_init_recvframe(union recv_frame *precvframe, struct recv_priv *precvpriv) -+{ -+ /* Perry: This can be removed */ -+ _rtw_init_listhead(&precvframe->u.hdr.list); -+ -+ precvframe->u.hdr.len=0; -+} -+ -+int rtw_free_recvframe(union recv_frame *precvframe, _queue *pfree_recv_queue) -+{ -+ _irqL irqL; -+ _adapter *padapter=precvframe->u.hdr.adapter; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->adapter_type > PRIMARY_ADAPTER) -+ { -+ padapter = padapter->pbuddy_adapter;//get primary_padapter -+ precvpriv = &padapter->recvpriv; -+ pfree_recv_queue = &precvpriv->free_recv_queue; -+ precvframe->u.hdr.adapter = padapter; -+ } -+#endif -+ -+ rtw_os_free_recvframe(precvframe); -+ -+ -+ _enter_critical_bh(&pfree_recv_queue->lock, &irqL); -+ -+ rtw_list_delete(&(precvframe->u.hdr.list)); -+ -+ precvframe->u.hdr.len = 0; -+ -+ rtw_list_insert_tail(&(precvframe->u.hdr.list), get_list_head(pfree_recv_queue)); -+ -+ if(padapter !=NULL){ -+ if(pfree_recv_queue == &precvpriv->free_recv_queue) -+ precvpriv->free_recvframe_cnt++; -+ } -+ -+ _exit_critical_bh(&pfree_recv_queue->lock, &irqL); -+ -+ -+ -+ return _SUCCESS; -+ -+} -+ -+ -+ -+ -+sint _rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue) -+{ -+ -+ _adapter *padapter=precvframe->u.hdr.adapter; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ -+ -+ //_rtw_init_listhead(&(precvframe->u.hdr.list)); -+ rtw_list_delete(&(precvframe->u.hdr.list)); -+ -+ -+ rtw_list_insert_tail(&(precvframe->u.hdr.list), get_list_head(queue)); -+ -+ if (padapter != NULL) { -+ if (queue == &precvpriv->free_recv_queue) -+ precvpriv->free_recvframe_cnt++; -+ } -+ -+ -+ -+ return _SUCCESS; -+} -+ -+sint rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue) -+{ -+ sint ret; -+ _irqL irqL; -+ -+ //_spinlock(&pfree_recv_queue->lock); -+ _enter_critical_bh(&queue->lock, &irqL); -+ ret = _rtw_enqueue_recvframe(precvframe, queue); -+ //_rtw_spinunlock(&pfree_recv_queue->lock); -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ return ret; -+} -+ -+/* -+sint rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue) -+{ -+ return rtw_free_recvframe(precvframe, queue); -+} -+*/ -+ -+ -+ -+ -+/* -+caller : defrag ; recvframe_chk_defrag in recv_thread (passive) -+pframequeue: defrag_queue : will be accessed in recv_thread (passive) -+ -+using spinlock to protect -+ -+*/ -+ -+void rtw_free_recvframe_queue(_queue *pframequeue, _queue *pfree_recv_queue) -+{ -+ union recv_frame *precvframe; -+ _list *plist, *phead; -+ -+ -+ _rtw_spinlock(&pframequeue->lock); -+ -+ phead = get_list_head(pframequeue); -+ plist = get_next(phead); -+ -+ while(rtw_end_of_queue_search(phead, plist) == false) -+ { -+ precvframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ -+ plist = get_next(plist); -+ -+ //rtw_list_delete(&precvframe->u.hdr.list); // will do this in rtw_free_recvframe() -+ -+ rtw_free_recvframe(precvframe, pfree_recv_queue); -+ } -+ -+ _rtw_spinunlock(&pframequeue->lock); -+ -+ -+ -+} -+ -+u32 rtw_free_uc_swdec_pending_queue(_adapter *adapter) -+{ -+ u32 cnt = 0; -+ union recv_frame *pending_frame; -+ while((pending_frame=rtw_alloc_recvframe(&adapter->recvpriv.uc_swdec_pending_queue))) { -+ rtw_free_recvframe(pending_frame, &adapter->recvpriv.free_recv_queue); -+ DBG_871X("%s: dequeue uc_swdec_pending_queue\n", __func__); -+ cnt++; -+ } -+ -+ return cnt; -+} -+ -+ -+sint rtw_enqueue_recvbuf_to_head(struct recv_buf *precvbuf, _queue *queue) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ rtw_list_delete(&precvbuf->list); -+ rtw_list_insert_head(&precvbuf->list, get_list_head(queue)); -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ return _SUCCESS; -+} -+ -+sint rtw_enqueue_recvbuf(struct recv_buf *precvbuf, _queue *queue) -+{ -+ _irqL irqL; -+ _enter_critical_ex(&queue->lock, &irqL); -+ -+ rtw_list_delete(&precvbuf->list); -+ -+ rtw_list_insert_tail(&precvbuf->list, get_list_head(queue)); -+ _exit_critical_ex(&queue->lock, &irqL); -+ return _SUCCESS; -+} -+ -+struct recv_buf *rtw_dequeue_recvbuf (_queue *queue) -+{ -+ _irqL irqL; -+ struct recv_buf *precvbuf; -+ _list *plist, *phead; -+ -+ _enter_critical_ex(&queue->lock, &irqL); -+ -+ if(_rtw_queue_empty(queue) == true) -+ { -+ precvbuf = NULL; -+ } -+ else -+ { -+ phead = get_list_head(queue); -+ -+ plist = get_next(phead); -+ -+ precvbuf = LIST_CONTAINOR(plist, struct recv_buf, list); -+ -+ rtw_list_delete(&precvbuf->list); -+ -+ } -+ -+ _exit_critical_ex(&queue->lock, &irqL); -+ return precvbuf; -+} -+ -+sint recvframe_chkmic(_adapter *adapter, union recv_frame *precvframe); -+sint recvframe_chkmic(_adapter *adapter, union recv_frame *precvframe){ -+ -+ sint i,res=_SUCCESS; -+ u32 datalen; -+ u8 miccode[8]; -+ u8 bmic_err=false,brpt_micerror = true; -+ u8 *pframe, *payload,*pframemic; -+ u8 *mickey; -+ //u8 *iv,rxdata_key_idx=0; -+ struct sta_info *stainfo; -+ struct rx_pkt_attrib *prxattrib=&precvframe->u.hdr.attrib; -+ struct security_priv *psecuritypriv=&adapter->securitypriv; -+ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ stainfo=rtw_get_stainfo(&adapter->stapriv ,&prxattrib->ta[0]); -+ -+ if(prxattrib->encrypt ==_TKIP_) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("\n recvframe_chkmic:prxattrib->encrypt ==_TKIP_\n")); -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("\n recvframe_chkmic:da=0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n", -+ prxattrib->ra[0],prxattrib->ra[1],prxattrib->ra[2],prxattrib->ra[3],prxattrib->ra[4],prxattrib->ra[5])); -+ -+ //calculate mic code -+ if(stainfo!= NULL) -+ { -+ if(IS_MCAST(prxattrib->ra)) -+ { -+ //mickey=&psecuritypriv->dot118021XGrprxmickey.skey[0]; -+ //iv = precvframe->u.hdr.rx_data+prxattrib->hdrlen; -+ //rxdata_key_idx =( ((iv[3])>>6)&0x3) ; -+ mickey=&psecuritypriv->dot118021XGrprxmickey[prxattrib->key_index].skey[0]; -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("\n recvframe_chkmic: bcmc key \n")); -+ //DBG_871X("\n recvframe_chkmic: bcmc key psecuritypriv->dot118021XGrpKeyid(%d),pmlmeinfo->key_index(%d) ,recv key_id(%d)\n", -+ // psecuritypriv->dot118021XGrpKeyid,pmlmeinfo->key_index,rxdata_key_idx); -+ -+ if(psecuritypriv->binstallGrpkey==false) -+ { -+ res=_FAIL; -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("\n recvframe_chkmic:didn't install group key!!!!!!!!!!\n")); -+ DBG_871X("\n recvframe_chkmic:didn't install group key!!!!!!!!!!\n"); -+ goto exit; -+ } -+ } -+ else{ -+ mickey=&stainfo->dot11tkiprxmickey.skey[0]; -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("\n recvframe_chkmic: unicast key \n")); -+ } -+ -+ datalen=precvframe->u.hdr.len-prxattrib->hdrlen-prxattrib->iv_len-prxattrib->icv_len-8;//icv_len included the mic code -+ pframe=precvframe->u.hdr.rx_data; -+ payload=pframe+prxattrib->hdrlen+prxattrib->iv_len; -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("\n prxattrib->iv_len=%d prxattrib->icv_len=%d\n",prxattrib->iv_len,prxattrib->icv_len)); -+ -+ //rtw_seccalctkipmic(&stainfo->dot11tkiprxmickey.skey[0],pframe,payload, datalen ,&miccode[0],(unsigned char)prxattrib->priority); //care the length of the data -+ -+ rtw_seccalctkipmic(mickey,pframe,payload, datalen ,&miccode[0],(unsigned char)prxattrib->priority); //care the length of the data -+ -+ pframemic=payload+datalen; -+ -+ bmic_err=false; -+ -+ for(i=0;i<8;i++){ -+ if(miccode[i] != *(pframemic+i)){ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("recvframe_chkmic:miccode[%d](%02x) != *(pframemic+%d)(%02x) ",i,miccode[i],i,*(pframemic+i))); -+ bmic_err=true; -+ } -+ } -+ -+ -+ if(bmic_err==true){ -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("\n *(pframemic-8)-*(pframemic-1)=0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n", -+ *(pframemic-8),*(pframemic-7),*(pframemic-6),*(pframemic-5),*(pframemic-4),*(pframemic-3),*(pframemic-2),*(pframemic-1))); -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("\n *(pframemic-16)-*(pframemic-9)=0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n", -+ *(pframemic-16),*(pframemic-15),*(pframemic-14),*(pframemic-13),*(pframemic-12),*(pframemic-11),*(pframemic-10),*(pframemic-9))); -+ -+ { -+ uint i; -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("\n ======demp packet (len=%d)======\n",precvframe->u.hdr.len)); -+ for(i=0;iu.hdr.len;i=i+8){ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x", -+ *(precvframe->u.hdr.rx_data+i),*(precvframe->u.hdr.rx_data+i+1), -+ *(precvframe->u.hdr.rx_data+i+2),*(precvframe->u.hdr.rx_data+i+3), -+ *(precvframe->u.hdr.rx_data+i+4),*(precvframe->u.hdr.rx_data+i+5), -+ *(precvframe->u.hdr.rx_data+i+6),*(precvframe->u.hdr.rx_data+i+7))); -+ } -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("\n ======demp packet end [len=%d]======\n",precvframe->u.hdr.len)); -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("\n hrdlen=%d, \n",prxattrib->hdrlen)); -+ } -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("ra=0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x psecuritypriv->binstallGrpkey=%d ", -+ prxattrib->ra[0],prxattrib->ra[1],prxattrib->ra[2], -+ prxattrib->ra[3],prxattrib->ra[4],prxattrib->ra[5],psecuritypriv->binstallGrpkey)); -+ -+ // double check key_index for some timing issue , -+ // cannot compare with psecuritypriv->dot118021XGrpKeyid also cause timing issue -+ if((IS_MCAST(prxattrib->ra)==true) && (prxattrib->key_index != pmlmeinfo->key_index )) -+ brpt_micerror = false; -+ -+ if((prxattrib->bdecrypted ==true)&& (brpt_micerror == true)) -+ { -+ rtw_handle_tkip_mic_err(adapter,(u8)IS_MCAST(prxattrib->ra)); -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" mic error :prxattrib->bdecrypted=%d ",prxattrib->bdecrypted)); -+ DBG_871X(" mic error :prxattrib->bdecrypted=%d\n",prxattrib->bdecrypted); -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" mic error :prxattrib->bdecrypted=%d ",prxattrib->bdecrypted)); -+ DBG_871X(" mic error :prxattrib->bdecrypted=%d\n",prxattrib->bdecrypted); -+ } -+ -+ res=_FAIL; -+ -+ } -+ else{ -+ //mic checked ok -+ if((psecuritypriv->bcheck_grpkey ==false)&&(IS_MCAST(prxattrib->ra)==true)){ -+ psecuritypriv->bcheck_grpkey =true; -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("psecuritypriv->bcheck_grpkey =true")); -+ } -+ } -+ -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("recvframe_chkmic: rtw_get_stainfo==NULL!!!\n")); -+ } -+ -+ recvframe_pull_tail(precvframe, 8); -+ -+ } -+ -+exit: -+ -+ -+ -+ return res; -+ -+} -+ -+//decrypt and set the ivlen,icvlen of the recv_frame -+union recv_frame * decryptor(_adapter *padapter,union recv_frame *precv_frame); -+union recv_frame * decryptor(_adapter *padapter,union recv_frame *precv_frame) -+{ -+ -+ struct rx_pkt_attrib *prxattrib = &precv_frame->u.hdr.attrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; -+ union recv_frame *return_packet=precv_frame; -+ u32 res=_SUCCESS; -+ -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("prxstat->decrypted=%x prxattrib->encrypt = 0x%03x\n",prxattrib->bdecrypted,prxattrib->encrypt)); -+ -+ if(prxattrib->encrypt>0) -+ { -+ u8 *iv = precv_frame->u.hdr.rx_data+prxattrib->hdrlen; -+ prxattrib->key_index = ( ((iv[3])>>6)&0x3) ; -+ -+ if(prxattrib->key_index > WEP_KEYS) -+ { -+ DBG_871X("prxattrib->key_index(%d) > WEP_KEYS \n", prxattrib->key_index); -+ -+ switch(prxattrib->encrypt){ -+ case _WEP40_: -+ case _WEP104_: -+ prxattrib->key_index = psecuritypriv->dot11PrivacyKeyIndex; -+ break; -+ case _TKIP_: -+ case _AES_: -+ default: -+ prxattrib->key_index = psecuritypriv->dot118021XGrpKeyid; -+ break; -+ } -+ } -+ } -+ -+ if((prxattrib->encrypt>0) && ((prxattrib->bdecrypted==0) ||(psecuritypriv->sw_decrypt==true))) -+ { -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(!IS_MCAST(prxattrib->ra))//bc/mc packets use sw decryption for concurrent mode -+#endif -+ psecuritypriv->hw_decrypted=false; -+ -+ #ifdef DBG_RX_DECRYPTOR -+ DBG_871X("prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n" -+ , prxattrib->bdecrypted ,prxattrib->encrypt, psecuritypriv->hw_decrypted); -+ #endif -+ -+ switch(prxattrib->encrypt){ -+ case _WEP40_: -+ case _WEP104_: -+ rtw_wep_decrypt(padapter, (u8 *)precv_frame); -+ break; -+ case _TKIP_: -+ res = rtw_tkip_decrypt(padapter, (u8 *)precv_frame); -+ break; -+ case _AES_: -+ res = rtw_aes_decrypt(padapter, (u8 * )precv_frame); -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ rtw_sms4_decrypt(padapter, (u8 * )precv_frame); -+ break; -+#endif -+ default: -+ break; -+ } -+ } -+ else if(prxattrib->bdecrypted==1 -+ && prxattrib->encrypt >0 -+ && (psecuritypriv->busetkipkey==1 || prxattrib->encrypt !=_TKIP_ ) -+ ) -+ { -+#if 0 -+ if((prxstat->icv==1)&&(prxattrib->encrypt!=_AES_)) -+ { -+ psecuritypriv->hw_decrypted=false; -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("psecuritypriv->hw_decrypted=false")); -+ -+ rtw_free_recvframe(precv_frame, &padapter->recvpriv.free_recv_queue); -+ -+ return_packet=NULL; -+ -+ } -+ else -+#endif -+ { -+ psecuritypriv->hw_decrypted=true; -+ #ifdef DBG_RX_DECRYPTOR -+ DBG_871X("prxstat->bdecrypted:%d, prxattrib->encrypt:%d, Setting psecuritypriv->hw_decrypted = %d\n" -+ , prxattrib->bdecrypted ,prxattrib->encrypt, psecuritypriv->hw_decrypted); -+ #endif -+ -+ } -+ } -+ else { -+ #ifdef DBG_RX_DECRYPTOR -+ DBG_871X("prxstat->bdecrypted:%d, prxattrib->encrypt:%d, psecuritypriv->hw_decrypted:%d\n" -+ , prxattrib->bdecrypted ,prxattrib->encrypt, psecuritypriv->hw_decrypted); -+ #endif -+ } -+ -+ if(res == _FAIL) -+ { -+ rtw_free_recvframe(return_packet,&padapter->recvpriv.free_recv_queue); -+ return_packet = NULL; -+ -+ } -+ //recvframe_chkmic(adapter, precv_frame); //move to recvframme_defrag function -+ -+ -+ -+ return return_packet; -+ -+} -+//###set the security information in the recv_frame -+union recv_frame * portctrl(_adapter *adapter,union recv_frame * precv_frame); -+union recv_frame * portctrl(_adapter *adapter,union recv_frame * precv_frame) -+{ -+ u8 *psta_addr, *ptr; -+ uint auth_alg; -+ struct recv_frame_hdr *pfhdr; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv ; -+ union recv_frame *prtnframe; -+ u16 ether_type=0; -+ u16 eapol_type = 0x888e;//for Funia BD's WPA issue -+ struct rx_pkt_attrib *pattrib; -+ __be16 be_tmp; -+ -+ pstapriv = &adapter->stapriv; -+ psta = rtw_get_stainfo(pstapriv, psta_addr); -+ -+ auth_alg = adapter->securitypriv.dot11AuthAlgrthm; -+ -+ ptr = get_recvframe_data(precv_frame); -+ pfhdr = &precv_frame->u.hdr; -+ pattrib = &pfhdr->attrib; -+ psta_addr = pattrib->ta; -+ -+ prtnframe = NULL; -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("########portctrl:adapter->securitypriv.dot11AuthAlgrthm=%d\n",adapter->securitypriv.dot11AuthAlgrthm)); -+ -+ if(auth_alg==2) -+ { -+ if ((psta!=NULL) && (psta->ieee8021x_blocked)) -+ { -+ //blocked -+ //only accept EAPOL frame -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("########portctrl:psta->ieee8021x_blocked==1\n")); -+ -+ prtnframe=precv_frame; -+ -+ //get ether_type -+ ptr=ptr+pfhdr->attrib.hdrlen+pfhdr->attrib.iv_len+LLC_HEADER_SIZE; -+ _rtw_memcpy(&be_tmp,ptr, 2); -+ ether_type= ntohs(be_tmp); -+ -+ if (ether_type == eapol_type) { -+ prtnframe=precv_frame; -+ } else { -+ //free this frame -+ rtw_free_recvframe(precv_frame, &adapter->recvpriv.free_recv_queue); -+ prtnframe=NULL; -+ } -+ } -+ else -+ { -+ //allowed -+ //check decryption status, and decrypt the frame if needed -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("########portctrl:psta->ieee8021x_blocked==0\n")); -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("portctrl:precv_frame->hdr.attrib.privacy=%x\n",precv_frame->u.hdr.attrib.privacy)); -+ -+ if (pattrib->bdecrypted == 0) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("portctrl:prxstat->decrypted=%x\n", pattrib->bdecrypted)); -+ } -+ -+ prtnframe=precv_frame; -+ //check is the EAPOL frame or not (Rekey) -+ if(ether_type == eapol_type){ -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_notice_,("########portctrl:ether_type == 0x888e\n")); -+ //check Rekey -+ -+ prtnframe=precv_frame; -+ } -+ else{ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("########portctrl:ether_type=0x%04x\n", ether_type)); -+ } -+ } -+ } -+ else -+ { -+ prtnframe=precv_frame; -+ } -+ -+ -+ -+ return prtnframe; -+ -+} -+ -+sint recv_decache(union recv_frame *precv_frame, u8 bretry, struct stainfo_rxcache *prxcache); -+sint recv_decache(union recv_frame *precv_frame, u8 bretry, struct stainfo_rxcache *prxcache) -+{ -+ sint tid = precv_frame->u.hdr.attrib.priority; -+ -+ u16 seq_ctrl = ( (precv_frame->u.hdr.attrib.seq_num&0xffff) << 4) | -+ (precv_frame->u.hdr.attrib.frag_num & 0xf); -+ -+ -+ -+ if(tid>15) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("recv_decache, (tid>15)! seq_ctrl=0x%x, tid=0x%x\n", seq_ctrl, tid)); -+ -+ return _FAIL; -+ } -+ -+ if(1)//if(bretry) -+ { -+ if(seq_ctrl == prxcache->tid_rxseq[tid]) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("recv_decache, seq_ctrl=0x%x, tid=0x%x, tid_rxseq=0x%x\n", seq_ctrl, tid, prxcache->tid_rxseq[tid])); -+ -+ return _FAIL; -+ } -+ } -+ -+ prxcache->tid_rxseq[tid] = seq_ctrl; -+ -+ -+ -+ return _SUCCESS; -+ -+} -+ -+void process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame); -+void process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_AP_MODE -+ unsigned char pwrbit; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta=NULL; -+ -+ psta = rtw_get_stainfo(pstapriv, pattrib->src); -+ -+ pwrbit = GetPwrMgt(ptr); -+ -+ if(psta) -+ { -+ if(pwrbit) -+ { -+ if(!(psta->state & WIFI_SLEEP_STATE)) -+ { -+ //psta->state |= WIFI_SLEEP_STATE; -+ //pstapriv->sta_dz_bitmap |= BIT(psta->aid); -+ -+ stop_sta_xmit(padapter, psta); -+ -+ //DBG_871X("to sleep, sta_dz_bitmap=%x\n", pstapriv->sta_dz_bitmap); -+ } -+ } -+ else -+ { -+ if(psta->state & WIFI_SLEEP_STATE) -+ { -+ //psta->state ^= WIFI_SLEEP_STATE; -+ //pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); -+ -+ wakeup_sta_to_xmit(padapter, psta); -+ -+ //DBG_871X("to wakeup, sta_dz_bitmap=%x\n", pstapriv->sta_dz_bitmap); -+ } -+ } -+ -+ } -+ -+#endif -+} -+ -+void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame); -+void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_AP_MODE -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta=NULL; -+ -+ psta = rtw_get_stainfo(pstapriv, pattrib->src); -+ -+ if(!psta) return; -+ -+#ifdef CONFIG_TDLS -+ if( !(psta->tdls_sta_state & TDLS_LINKED_STATE ) ) -+ { -+#endif //CONFIG_TDLS -+ -+ if(!psta->qos_option) -+ return; -+ -+ if(!(psta->qos_info&0xf)) -+ return; -+ -+#ifdef CONFIG_TDLS -+ } -+#endif //CONFIG_TDLS -+ -+ if(psta->state&WIFI_SLEEP_STATE) -+ { -+ u8 wmmps_ac=0; -+ -+ switch(pattrib->priority) -+ { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk&BIT(1); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi&BIT(1); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo&BIT(1); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be&BIT(1); -+ break; -+ } -+ -+ if(wmmps_ac) -+ { -+ if(psta->sleepq_ac_len>0) -+ { -+ //process received triggered frame -+ xmit_delivery_enabled_frames(padapter, psta); -+ } -+ else -+ { -+ //issue one qos null frame with More data bit = 0 and the EOSP bit set (=1) -+ issue_qos_nulldata(padapter, psta->hwaddr, (u16)pattrib->priority, 0, 0); -+ } -+ } -+ -+ } -+ -+ -+#endif -+ -+} -+ -+#ifdef CONFIG_TDLS -+sint OnTDLS(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; -+ sint ret = _SUCCESS; -+ u8 *paction = get_recvframe_data(precv_frame); -+ u8 category_field = 1; -+#ifdef CONFIG_WFD -+ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a }; -+#endif //CONFIG_WFD -+ struct tdls_info *ptdlsinfo = &(adapter->tdlsinfo); -+ -+ //point to action field -+ paction+=pattrib->hdrlen -+ + pattrib->iv_len -+ + SNAP_SIZE -+ + ETH_TYPE_LEN -+ + PAYLOAD_TYPE_LEN -+ + category_field; -+ -+ if(ptdlsinfo->enable == 0) -+ { -+ DBG_871X("recv tdls frame, " -+ "but tdls haven't enabled\n"); -+ ret = _FAIL; -+ return ret; -+ } -+ -+ switch(*paction){ -+ case TDLS_SETUP_REQUEST: -+ DBG_871X("recv tdls setup request frame\n"); -+ ret=On_TDLS_Setup_Req(adapter, precv_frame); -+ break; -+ case TDLS_SETUP_RESPONSE: -+ DBG_871X("recv tdls setup response frame\n"); -+ ret=On_TDLS_Setup_Rsp(adapter, precv_frame); -+ break; -+ case TDLS_SETUP_CONFIRM: -+ DBG_871X("recv tdls setup confirm frame\n"); -+ ret=On_TDLS_Setup_Cfm(adapter, precv_frame); -+ break; -+ case TDLS_TEARDOWN: -+ DBG_871X("recv tdls teardown, free sta_info\n"); -+ ret=On_TDLS_Teardown(adapter, precv_frame); -+ break; -+ case TDLS_DISCOVERY_REQUEST: -+ DBG_871X("recv tdls discovery request frame\n"); -+ ret=On_TDLS_Dis_Req(adapter, precv_frame); -+ break; -+ case TDLS_PEER_TRAFFIC_RESPONSE: -+ DBG_871X("recv tdls peer traffic response frame\n"); -+ ret=On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame); -+ break; -+ case TDLS_CHANNEL_SWITCH_REQUEST: -+ DBG_871X("recv tdls channel switch request frame\n"); -+ ret=On_TDLS_Ch_Switch_Req(adapter, precv_frame); -+ break; -+ case TDLS_CHANNEL_SWITCH_RESPONSE: -+ DBG_871X("recv tdls channel switch response frame\n"); -+ ret=On_TDLS_Ch_Switch_Rsp(adapter, precv_frame); -+ break; -+#ifdef CONFIG_WFD -+ case 0x50: //First byte of WFA OUI -+ if( _rtw_memcmp(WFA_OUI, (paction), 3) ) -+ { -+ if( *(paction + 3) == 0x04) //Probe request frame -+ { -+ //WFDTDLS: for sigma test, do not setup direct link automatically -+ ptdlsinfo->dev_discovered = 1; -+ DBG_871X("recv tunneled probe request frame\n"); -+ issue_tunneled_probe_rsp(adapter, precv_frame); -+ } -+ if( *(paction + 3) == 0x05) //Probe response frame -+ { -+ //WFDTDLS: for sigma test, do not setup direct link automatically -+ ptdlsinfo->dev_discovered = 1; -+ DBG_871X("recv tunneled probe response frame\n"); -+ } -+ } -+ break; -+#endif //CONFIG_WFD -+ default: -+ DBG_871X("receive TDLS frame but not supported\n"); -+ ret=_FAIL; -+ break; -+ } -+ -+exit: -+ return ret; -+ -+} -+#endif -+ -+void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_info*sta); -+void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_info*sta) -+{ -+ int sz; -+ struct sta_info *psta = NULL; -+ struct stainfo_stats *pstats = NULL; -+ struct rx_pkt_attrib *pattrib = & prframe->u.hdr.attrib; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ sz = get_recvframe_len(prframe); -+ precvpriv->rx_bytes += sz; -+ -+ padapter->mlmepriv.LinkDetectInfo.NumRxOkInPeriod++; -+ -+ if( (!MacAddr_isBcst(pattrib->dst)) && (!IS_MCAST(pattrib->dst))){ -+ padapter->mlmepriv.LinkDetectInfo.NumRxUnicastOkInPeriod++; -+ } -+ -+ if(sta) -+ psta = sta; -+ else -+ psta = prframe->u.hdr.psta; -+ -+ if(psta) -+ { -+ pstats = &psta->sta_stats; -+ -+ pstats->rx_data_pkts++; -+ pstats->rx_bytes += sz; -+ } -+ -+} -+ -+sint sta2sta_data_frame( -+ _adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info**psta -+); -+sint sta2sta_data_frame( -+ _adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info**psta -+) -+{ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ sint ret = _SUCCESS; -+ struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u8 *mybssid = get_bssid(pmlmepriv); -+ u8 *myhwaddr = myid(&adapter->eeprompriv); -+ u8 * sta_addr = NULL; -+ sint bmcast = IS_MCAST(pattrib->dst); -+ -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; -+ struct sta_info *ptdls_sta=NULL; -+ u8 *psnap_type=ptr+pattrib->hdrlen + pattrib->iv_len+SNAP_SIZE; -+ //frame body located after [+2]: ether-type, [+1]: payload type -+ u8 *pframe_body = psnap_type+2+1; -+#endif -+ -+ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) -+ { -+ -+ // filter packets that SA is myself or multicast or broadcast -+ if (_rtw_memcmp(myhwaddr, pattrib->src, ETH_ALEN)){ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" SA==myself \n")); -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ if( (!_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN)) && (!bmcast) ){ -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ if( _rtw_memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ _rtw_memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN)) ) { -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ sta_addr = pattrib->src; -+ -+ } -+ else if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) -+ { -+#ifdef CONFIG_TDLS -+ -+ //direct link data transfer -+ if(ptdlsinfo->setup_state == TDLS_LINKED_STATE){ -+ ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->src); -+ if(ptdls_sta==NULL) -+ { -+ ret=_FAIL; -+ goto exit; -+ } -+ else if(ptdls_sta->tdls_sta_state&TDLS_LINKED_STATE) -+ { -+ -+ //drop QoS-SubType Data, including QoS NULL, excluding QoS-Data -+ if( (GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE )== WIFI_QOS_DATA_TYPE) -+ { -+ if(GetFrameSubType(ptr)&(BIT(4)|BIT(5)|BIT(6))) -+ { -+ DBG_871X("drop QoS-Sybtype Data\n"); -+ ret= _FAIL; -+ goto exit; -+ } -+ } -+ // filter packets that SA is myself or multicast or broadcast -+ if (_rtw_memcmp(myhwaddr, pattrib->src, ETH_ALEN)){ -+ ret= _FAIL; -+ goto exit; -+ } -+ // da should be for me -+ if((!_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN))&& (!bmcast)) -+ { -+ ret= _FAIL; -+ goto exit; -+ } -+ // check BSSID -+ if( _rtw_memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ _rtw_memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN)) ) -+ { -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ //process UAPSD tdls sta -+ process_pwrbit_data(adapter, precv_frame); -+ -+ // if NULL-frame, check pwrbit -+ if ((GetFrameSubType(ptr)) == WIFI_DATA_NULL) -+ { -+ //NULL-frame with pwrbit=1, buffer_STA should buffer frames for sleep_STA -+ if(GetPwrMgt(ptr)) -+ { -+ DBG_871X("TDLS: recv peer null frame with pwr bit 1\n"); -+ ptdls_sta->tdls_sta_state|=TDLS_PEER_SLEEP_STATE; -+ // it would be triggered when we are off channel and receiving NULL DATA -+ // we can confirm that peer STA is at off channel -+ } -+ else if(ptdls_sta->tdls_sta_state&TDLS_CH_SWITCH_ON_STATE) -+ { -+ if((ptdls_sta->tdls_sta_state & TDLS_PEER_AT_OFF_STATE) != TDLS_PEER_AT_OFF_STATE) -+ { -+ issue_nulldata_to_TDLS_peer_STA(adapter, ptdls_sta, 0); -+ ptdls_sta->tdls_sta_state |= TDLS_PEER_AT_OFF_STATE; -+ On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame); -+ } -+ } -+ -+ ret= _FAIL; -+ goto exit; -+ } -+ //receive some of all TDLS management frames, process it at ON_TDLS -+ if((_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_TDLS, 2))){ -+ ret= OnTDLS(adapter, precv_frame); -+ goto exit; -+ } -+ -+ } -+ -+ sta_addr = pattrib->src; -+ -+ } -+ else -+#endif //CONFIG_TDLS -+ { -+ // For Station mode, sa and bssid should always be BSSID, and DA is my mac-address -+ if(!_rtw_memcmp(pattrib->bssid, pattrib->src, ETH_ALEN) ) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("bssid != TA under STATION_MODE; drop pkt\n")); -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ sta_addr = pattrib->bssid; -+ } -+ -+ } -+ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ if (bmcast) -+ { -+ // For AP mode, if DA == MCAST, then BSSID should be also MCAST -+ if (!IS_MCAST(pattrib->bssid)){ -+ ret= _FAIL; -+ goto exit; -+ } -+ } -+ else // not mc-frame -+ { -+ // For AP mode, if DA is non-MCAST, then it must be BSSID, and bssid == BSSID -+ if(!_rtw_memcmp(pattrib->bssid, pattrib->dst, ETH_ALEN)) { -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ sta_addr = pattrib->src; -+ } -+ -+ } -+ else if(check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) -+ { -+ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ sta_addr = mybssid; -+ } -+ else -+ { -+ ret = _FAIL; -+ } -+ -+ -+ -+ if(bmcast) -+ *psta = rtw_get_bcmc_stainfo(adapter); -+ else -+ *psta = rtw_get_stainfo(pstapriv, sta_addr); // get ap_info -+ -+#ifdef CONFIG_TDLS -+ if(ptdls_sta != NULL) -+ *psta = ptdls_sta; -+#endif //CONFIG_TDLS -+ -+ if (*psta == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("can't get psta under sta2sta_data_frame ; drop pkt\n")); -+#ifdef CONFIG_MP_INCLUDED -+ if (adapter->registrypriv.mp_mode == 1) -+ { -+ if(check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) -+ adapter->mppriv.rx_pktloss++; -+ } -+#endif -+ ret= _FAIL; -+ goto exit; -+ } -+ -+exit: -+ -+ return ret; -+ -+} -+ -+sint ap2sta_data_frame( -+ _adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info**psta ); -+sint ap2sta_data_frame( -+ _adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info**psta ) -+{ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; -+ sint ret = _SUCCESS; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ u8 *mybssid = get_bssid(pmlmepriv); -+ u8 *myhwaddr = myid(&adapter->eeprompriv); -+ sint bmcast = IS_MCAST(pattrib->dst); -+ -+ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) -+ && (check_fwstate(pmlmepriv, _FW_LINKED) == true -+ || check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true ) -+ ) -+ { -+ -+ // filter packets that SA is myself or multicast or broadcast -+ if (_rtw_memcmp(myhwaddr, pattrib->src, ETH_ALEN)){ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" SA==myself \n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s SA="MAC_FMT", myhwaddr="MAC_FMT"\n", -+ __FUNCTION__, MAC_ARG(pattrib->src), MAC_ARG(myhwaddr)); -+ #endif -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ // da should be for me -+ if((!_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN))&& (!bmcast)) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_, -+ (" ap2sta_data_frame: compare DA fail; DA="MAC_FMT"\n", MAC_ARG(pattrib->dst))); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s DA="MAC_FMT"\n", __func__, MAC_ARG(pattrib->dst)); -+ #endif -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ -+ // check BSSID -+ if( _rtw_memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ _rtw_memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || -+ (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN)) ) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_, -+ (" ap2sta_data_frame: compare BSSID fail ; BSSID="MAC_FMT"\n", MAC_ARG(pattrib->bssid))); -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("mybssid="MAC_FMT"\n", MAC_ARG(mybssid))); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s BSSID="MAC_FMT", mybssid="MAC_FMT"\n", -+ __FUNCTION__, MAC_ARG(pattrib->bssid), MAC_ARG(mybssid)); -+ DBG_871X( "this adapter = %d, buddy adapter = %d\n", adapter->adapter_type, adapter->pbuddy_adapter->adapter_type ); -+ #endif -+ -+ if(!bmcast) -+ { -+ DBG_871X("issue_deauth to the nonassociated ap=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->bssid)); -+ issue_deauth(adapter, pattrib->bssid, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ } -+ -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ if(bmcast) -+ *psta = rtw_get_bcmc_stainfo(adapter); -+ else -+ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); // get ap_info -+ -+ if (*psta == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("ap2sta: can't get psta under STATION_MODE ; drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s can't get psta under STATION_MODE ; drop pkt\n", __FUNCTION__); -+ #endif -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) { -+ } -+ -+ if (GetFrameSubType(ptr) & BIT(6)) { -+ /* No data, will not indicate to upper layer, temporily count it here */ -+ count_rx_stats(adapter, precv_frame, *psta); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+ } -+ else if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) && -+ (check_fwstate(pmlmepriv, _FW_LINKED) == true) ) -+ { -+ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ // -+ _rtw_memcpy(pattrib->bssid, mybssid, ETH_ALEN); -+ -+ -+ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); // get sta_info -+ if (*psta == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("can't get psta under MP_MODE ; drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s can't get psta under WIFI_MP_STATE ; drop pkt\n", __FUNCTION__); -+ #endif -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ -+ } -+ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ /* Special case */ -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ else -+ { -+ if(_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN)&& (!bmcast)) -+ { -+ *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); // get sta_info -+ if (*psta == NULL) -+ { -+ DBG_871X("issue_deauth to the ap=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->bssid)); -+ -+ issue_deauth(adapter, pattrib->bssid, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ } -+ } -+ -+ ret = _FAIL; -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s fw_state:0x%x\n", __FUNCTION__, get_fwstate(pmlmepriv)); -+ #endif -+ } -+ -+exit: -+ -+ -+ -+ return ret; -+ -+} -+ -+sint sta2ap_data_frame( -+ _adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info**psta ); -+sint sta2ap_data_frame( -+ _adapter *adapter, -+ union recv_frame *precv_frame, -+ struct sta_info**psta ) -+{ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ unsigned char *mybssid = get_bssid(pmlmepriv); -+ sint ret=_SUCCESS; -+ -+ -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ //For AP mode, RA=BSSID, TX=STA(SRC_ADDR), A3=DST_ADDR -+ if(!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN)) -+ { -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ *psta = rtw_get_stainfo(pstapriv, pattrib->src); -+ if (*psta == NULL) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("can't get psta under AP_MODE; drop pkt\n")); -+ DBG_871X("issue_deauth to sta=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->src)); -+ -+ issue_deauth(adapter, pattrib->src, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+ process_pwrbit_data(adapter, precv_frame); -+ -+ if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) { -+ process_wmmps_data(adapter, precv_frame); -+ } -+ -+ if (GetFrameSubType(ptr) & BIT(6)) { -+ /* No data, will not indicate to upper layer, temporily count it here */ -+ count_rx_stats(adapter, precv_frame, *psta); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ } -+ else { -+ u8 *myhwaddr = myid(&adapter->eeprompriv); -+ if (!_rtw_memcmp(pattrib->ra, myhwaddr, ETH_ALEN)) { -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ DBG_871X("issue_deauth to sta=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->src)); -+ issue_deauth(adapter, pattrib->src, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); -+ ret = RTW_RX_HANDLED; -+ goto exit; -+ } -+ -+exit: -+ -+ -+ -+ return ret; -+ -+} -+ -+sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame); -+sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_AP_MODE -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 *pframe = precv_frame->u.hdr.rx_data; -+ //uint len = precv_frame->u.hdr.len; -+ -+ //DBG_871X("+validate_recv_ctrl_frame\n"); -+ -+ if (GetFrameType(pframe) != WIFI_CTRL_TYPE) -+ { -+ return _FAIL; -+ } -+ -+ //receive the frames that ra(a1) is my address -+ if (!_rtw_memcmp(GetAddr1Ptr(pframe), myid(&padapter->eeprompriv), ETH_ALEN)) -+ { -+ return _FAIL; -+ } -+ -+ //only handle ps-poll -+ if(GetFrameSubType(pframe) == WIFI_PSPOLL) -+ { -+ u16 aid; -+ u8 wmmps_ac=0; -+ struct sta_info *psta=NULL; -+ -+ aid = GetAid(pframe); -+ psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); -+ -+ if((psta==NULL) || (psta->aid!=aid)) -+ { -+ return _FAIL; -+ } -+ -+ //for rx pkt statistics -+ psta->sta_stats.rx_ctrl_pkts++; -+ -+ switch(pattrib->priority) -+ { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk&BIT(0); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi&BIT(0); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo&BIT(0); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be&BIT(0); -+ break; -+ } -+ -+ if(wmmps_ac) -+ return _FAIL; -+ -+ if(psta->state & WIFI_STA_ALIVE_CHK_STATE) -+ { -+ DBG_871X("%s alive check-rx ps-poll\n", __func__); -+ psta->expire_to = pstapriv->expire_to; -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ } -+ -+ if((psta->state&WIFI_SLEEP_STATE) && (pstapriv->sta_dz_bitmap&BIT(psta->aid))) -+ { -+ _irqL irqL; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe=NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ //_enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&psta->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ if ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) -+ { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ psta->sleepq_len--; -+ -+ if(psta->sleepq_len>0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ pxmitframe->attrib.triggered = 1; -+ -+ //DBG_871X("handling ps-poll, q_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); -+ -+#if 0 -+ _exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ if(rtw_hal_xmit(padapter, pxmitframe) == true) -+ { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ } -+ _enter_critical_bh(&psta->sleep_q.lock, &irqL); -+#endif -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ if(psta->sleepq_len==0) -+ { -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ //DBG_871X("after handling ps-poll, tim=%x\n", pstapriv->tim_bitmap); -+ -+ //upate BCN for TIM IE -+ //update_BCNTIM(padapter); -+ update_beacon(padapter, _TIM_IE_, NULL, false); -+ } -+ -+ //_exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ } -+ else -+ { -+ //_exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ //DBG_871X("no buffered packets to xmit\n"); -+ if(pstapriv->tim_bitmap&BIT(psta->aid)) -+ { -+ if(psta->sleepq_len==0) -+ { -+ DBG_871X("no buffered packets to xmit\n"); -+ -+ //issue nulldata with More data bit = 0 to indicate we have no buffered packets -+ issue_nulldata(padapter, psta->hwaddr, 0, 0, 0); -+ } -+ else -+ { -+ DBG_871X("error!psta->sleepq_len=%d\n", psta->sleepq_len); -+ psta->sleepq_len=0; -+ } -+ -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ //upate BCN for TIM IE -+ //update_BCNTIM(padapter); -+ update_beacon(padapter, _TIM_IE_, NULL, false); -+ } -+ -+ } -+ -+ } -+ -+ } -+ -+#endif -+ -+ return _FAIL; -+ -+} -+ -+union recv_frame* recvframe_chk_defrag(PADAPTER padapter, union recv_frame *precv_frame); -+sint validate_recv_mgnt_frame(PADAPTER padapter, union recv_frame *precv_frame); -+sint validate_recv_mgnt_frame(PADAPTER padapter, union recv_frame *precv_frame) -+{ -+ //struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("+validate_recv_mgnt_frame\n")); -+ -+#if 0 -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+#ifdef CONFIG_NATIVEAP_MLME -+ mgt_dispatcher(padapter, precv_frame); -+#else -+ rtw_hostapd_mlme_rx(padapter, precv_frame); -+#endif -+ } -+ else -+ { -+ mgt_dispatcher(padapter, precv_frame); -+ } -+#endif -+ -+ precv_frame = recvframe_chk_defrag(padapter, precv_frame); -+ if (precv_frame == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_,("%s: fragment packet\n",__FUNCTION__)); -+ return _SUCCESS; -+ } -+ -+ { -+ //for rx pkt statistics -+ struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, GetAddr2Ptr(precv_frame->u.hdr.rx_data)); -+ if (psta) { -+ psta->sta_stats.rx_mgnt_pkts++; -+ if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_BEACON) -+ psta->sta_stats.rx_beacon_pkts++; -+ else if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_PROBEREQ) -+ psta->sta_stats.rx_probereq_pkts++; -+ else if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_PROBERSP) { -+ if (_rtw_memcmp(padapter->eeprompriv.mac_addr, GetAddr1Ptr(precv_frame->u.hdr.rx_data), ETH_ALEN) == true) -+ psta->sta_stats.rx_probersp_pkts++; -+ else if (is_broadcast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data)) -+ || is_multicast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data))) -+ psta->sta_stats.rx_probersp_bm_pkts++; -+ else -+ psta->sta_stats.rx_probersp_uo_pkts++; -+ } -+ } -+ } -+ -+#ifdef CONFIG_INTEL_PROXIM -+ if(padapter->proximity.proxim_on==true) -+ { -+ struct rx_pkt_attrib * pattrib=&precv_frame->u.hdr.attrib; -+ struct recv_stat* prxstat=( struct recv_stat * ) precv_frame->u.hdr.rx_head ; -+ u8 * pda,*psa,*pbssid,*ptr; -+ ptr=precv_frame->u.hdr.rx_data; -+ pda = get_da(ptr); -+ psa = get_sa(ptr); -+ pbssid = get_hdr_bssid(ptr); -+ -+ -+ _rtw_memcpy(pattrib->dst, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, psa, ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->bssid, pbssid, ETH_ALEN); -+ -+ switch(pattrib->to_fr_ds) -+ { -+ case 0: -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ break; -+ -+ case 1: -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pbssid, ETH_ALEN); -+ break; -+ -+ case 2: -+ _rtw_memcpy(pattrib->ra, pbssid, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ break; -+ -+ case 3: -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" case 3\n")); -+ break; -+ -+ default: -+ break; -+ -+ } -+ pattrib->priority=0; -+ pattrib->hdrlen = pattrib->to_fr_ds==3 ? 30 : 24; -+ -+ padapter->proximity.proxim_rx(padapter,precv_frame); -+ } -+#endif -+ mgt_dispatcher(padapter, precv_frame); -+ -+ return _SUCCESS; -+ -+} -+ -+sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame); -+sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ u8 bretry; -+ u8 *psa, *pda, *pbssid; -+ struct sta_info *psta = NULL; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ sint ret = _SUCCESS; -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; -+#endif //CONFIG_TDLS -+ -+ -+ -+ bretry = GetRetry(ptr); -+ pda = get_da(ptr); -+ psa = get_sa(ptr); -+ pbssid = get_hdr_bssid(ptr); -+ -+ if(pbssid == NULL){ -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s pbssid == NULL\n", __func__); -+ #endif -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ _rtw_memcpy(pattrib->dst, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, psa, ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->bssid, pbssid, ETH_ALEN); -+ -+ switch(pattrib->to_fr_ds) -+ { -+ case 0: -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ ret = sta2sta_data_frame(adapter, precv_frame, &psta); -+ break; -+ -+ case 1: -+ _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pbssid, ETH_ALEN); -+ ret = ap2sta_data_frame(adapter, precv_frame, &psta); -+ break; -+ -+ case 2: -+ _rtw_memcpy(pattrib->ra, pbssid, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); -+ ret = sta2ap_data_frame(adapter, precv_frame, &psta); -+ break; -+ -+ case 3: -+ _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); -+ ret =_FAIL; -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" case 3\n")); -+ break; -+ -+ default: -+ ret =_FAIL; -+ break; -+ -+ } -+ -+ if(ret ==_FAIL){ -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s case:%d, res:%d\n", __FUNCTION__, pattrib->to_fr_ds, ret); -+ #endif -+ goto exit; -+ } else if (ret == RTW_RX_HANDLED) { -+ goto exit; -+ } -+ -+ -+ if(psta==NULL){ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" after to_fr_ds_chk; psta==NULL \n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s psta == NULL\n", __func__); -+ #endif -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ //psta->rssi = prxcmd->rssi; -+ //psta->signal_quality= prxcmd->sq; -+ precv_frame->u.hdr.psta = psta; -+ -+ -+ pattrib->amsdu=0; -+ pattrib->ack_policy = 0; -+ //parsing QC field -+ if(pattrib->qos == 1) -+ { -+ pattrib->priority = GetPriority((ptr + 24)); -+ pattrib->ack_policy = GetAckpolicy((ptr + 24)); -+ pattrib->amsdu = GetAMsdu((ptr + 24)); -+ pattrib->hdrlen = pattrib->to_fr_ds==3 ? 32 : 26; -+ -+ if(pattrib->priority!=0 && pattrib->priority!=3) -+ { -+ adapter->recvpriv.bIsAnyNonBEPkts = true; -+ } -+ } -+ else -+ { -+ pattrib->priority=0; -+ pattrib->hdrlen = pattrib->to_fr_ds==3 ? 30 : 24; -+ } -+ -+ -+ if(pattrib->order)//HT-CTRL 11n -+ { -+ pattrib->hdrlen += 4; -+ } -+ -+ precv_frame->u.hdr.preorder_ctrl = &psta->recvreorder_ctrl[pattrib->priority]; -+ -+ // decache, drop duplicate recv packets -+ if(recv_decache(precv_frame, bretry, &psta->sta_recvpriv.rxcache) == _FAIL) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("decache : drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s recv_decache return _FAIL\n", __func__); -+ #endif -+ ret= _FAIL; -+ goto exit; -+ } -+ -+#if 0 -+ if(psta->tdls_sta_state & TDLS_LINKED_STATE ) -+ { -+ if(psta->dot118021XPrivacy==_AES_) -+ pattrib->encrypt=psta->dot118021XPrivacy; -+ } -+#endif //CONFIG_TDLS -+ -+ if(pattrib->privacy){ -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("validate_recv_data_frame:pattrib->privacy=%x\n", pattrib->privacy)); -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("\n ^^^^^^^^^^^IS_MCAST(pattrib->ra(0x%02x))=%d^^^^^^^^^^^^^^^6\n", pattrib->ra[0],IS_MCAST(pattrib->ra))); -+ -+#ifdef CONFIG_TDLS -+ if((psta->tdls_sta_state & TDLS_LINKED_STATE) && (psta->dot118021XPrivacy==_AES_)) -+ { -+ pattrib->encrypt=psta->dot118021XPrivacy; -+ } -+ else -+#endif //CONFIG_TDLS -+ GET_ENCRY_ALGO(psecuritypriv, psta, pattrib->encrypt, IS_MCAST(pattrib->ra)); -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("\n pattrib->encrypt=%d\n",pattrib->encrypt)); -+ -+ SET_ICE_IV_LEN(pattrib->iv_len, pattrib->icv_len, pattrib->encrypt); -+ } -+ else -+ { -+ pattrib->encrypt = 0; -+ pattrib->iv_len = pattrib->icv_len = 0; -+ } -+ -+exit: -+ -+ -+ -+ return ret; -+} -+ -+sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame); -+sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ //shall check frame subtype, to / from ds, da, bssid -+ -+ //then call check if rx seq/frag. duplicated. -+ -+ u8 type; -+ u8 subtype; -+ sint retval = _SUCCESS; -+ -+ struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; -+ -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ u8 ver =(unsigned char) (*ptr)&0x3 ; -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+#endif -+ -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; -+#endif //CONFIG_TDLS -+#ifdef CONFIG_WAPI_SUPPORT -+ PRT_WAPI_T pWapiInfo = &adapter->wapiInfo; -+ struct recv_frame_hdr *phdr = &precv_frame->u.hdr; -+ u8 wai_pkt = 0; -+ u16 sc; -+ u8 external_len = 0; -+#endif -+ -+ -+ -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ if (pmlmeext->sitesurvey_res.state == SCAN_PROCESS) { -+ int ch_set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, rtw_get_oper_ch(adapter)); -+ if (ch_set_idx >= 0) -+ pmlmeext->channel_set[ch_set_idx].rx_count++; -+ } -+#endif -+ -+#ifdef CONFIG_TDLS -+ if(ptdlsinfo->ch_sensing==1 && ptdlsinfo->cur_channel !=0){ -+ ptdlsinfo->collect_pkt_num[ptdlsinfo->cur_channel-1]++; -+ } -+#endif //CONFIG_TDLS -+ -+ //add version chk -+ if(ver!=0){ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("validate_recv_data_frame fail! (ver!=0)\n")); -+ retval= _FAIL; -+ goto exit; -+ } -+ -+ type = GetFrameType(ptr); -+ subtype = GetFrameSubType(ptr); //bit(7)~bit(2) -+ -+ pattrib->to_fr_ds = get_tofr_ds(ptr); -+ -+ pattrib->frag_num = GetFragNum(ptr); -+ pattrib->seq_num = GetSequence(ptr); -+ -+ pattrib->pw_save = GetPwrMgt(ptr); -+ pattrib->mfrag = GetMFrag(ptr); -+ pattrib->mdata = GetMData(ptr); -+ pattrib->privacy = GetPrivacy(ptr); -+ pattrib->order = GetOrder(ptr); -+#ifdef CONFIG_WAPI_SUPPORT -+ sc = (pattrib->seq_num<<4) | pattrib->frag_num; -+#endif -+ -+#if 1 //Dump rx packets -+{ -+ u8 bDumpRxPkt; -+ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); -+ if(bDumpRxPkt ==1){//dump all rx packets -+ int i; -+ DBG_871X("############################# \n"); -+ -+ for(i=0; i<64;i=i+8) -+ DBG_871X("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr+i), -+ *(ptr+i+1), *(ptr+i+2) ,*(ptr+i+3) ,*(ptr+i+4),*(ptr+i+5), *(ptr+i+6), *(ptr+i+7)); -+ DBG_871X("############################# \n"); -+ } -+ else if(bDumpRxPkt ==2){ -+ if(type== WIFI_MGT_TYPE){ -+ int i; -+ DBG_871X("############################# \n"); -+ -+ for(i=0; i<64;i=i+8) -+ DBG_871X("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr+i), -+ *(ptr+i+1), *(ptr+i+2) ,*(ptr+i+3) ,*(ptr+i+4),*(ptr+i+5), *(ptr+i+6), *(ptr+i+7)); -+ DBG_871X("############################# \n"); -+ } -+ } -+ else if(bDumpRxPkt ==3){ -+ if(type== WIFI_DATA_TYPE){ -+ int i; -+ DBG_871X("############################# \n"); -+ -+ for(i=0; i<64;i=i+8) -+ DBG_871X("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr+i), -+ *(ptr+i+1), *(ptr+i+2) ,*(ptr+i+3) ,*(ptr+i+4),*(ptr+i+5), *(ptr+i+6), *(ptr+i+7)); -+ DBG_871X("############################# \n"); -+ } -+ } -+} -+#endif -+ switch (type) -+ { -+ case WIFI_MGT_TYPE: //mgnt -+ retval = validate_recv_mgnt_frame(adapter, precv_frame); -+ if (retval == _FAIL) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("validate_recv_mgnt_frame fail\n")); -+ } -+ retval = _FAIL; // only data frame return _SUCCESS -+ break; -+ case WIFI_CTRL_TYPE: //ctrl -+ retval = validate_recv_ctrl_frame(adapter, precv_frame); -+ if (retval == _FAIL) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("validate_recv_ctrl_frame fail\n")); -+ } -+ retval = _FAIL; // only data frame return _SUCCESS -+ break; -+ case WIFI_DATA_TYPE: //data -+#ifdef CONFIG_WAPI_SUPPORT -+ if(pattrib->qos) -+ external_len = 2; -+ else -+ external_len= 0; -+ -+ wai_pkt = rtw_wapi_is_wai_packet(adapter,ptr); -+ -+ phdr->bIsWaiPacket = wai_pkt; -+ -+ if(wai_pkt !=0){ -+ if(sc != adapter->wapiInfo.wapiSeqnumAndFragNum) -+ { -+ adapter->wapiInfo.wapiSeqnumAndFragNum = sc; -+ } -+ else -+ { -+ retval = _FAIL; -+ break; -+ } -+ } -+ else{ -+ -+ if(rtw_wapi_drop_for_key_absent(adapter,GetAddr2Ptr(ptr))){ -+ retval=_FAIL; -+ WAPI_TRACE(WAPI_RX,"drop for key absent for rx \n"); -+ break; -+ } -+ } -+ -+#endif -+ -+ pattrib->qos = (subtype & BIT(7))? 1:0; -+ retval = validate_recv_data_frame(adapter, precv_frame); -+ if (retval == _FAIL) -+ { -+ struct recv_priv *precvpriv = &adapter->recvpriv; -+ //RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("validate_recv_data_frame fail\n")); -+ precvpriv->rx_drop++; -+ } -+ break; -+ default: -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("validate_recv_data_frame fail! type=0x%x\n", type)); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME validate_recv_data_frame fail! type=0x%x\n", type); -+ #endif -+ retval = _FAIL; -+ break; -+ } -+ -+exit: -+ -+ -+ -+ return retval; -+} -+ -+ -+//remove the wlanhdr and add the eth_hdr -+#if 1 -+ -+sint wlanhdr_to_ethhdr ( union recv_frame *precvframe); -+sint wlanhdr_to_ethhdr ( union recv_frame *precvframe) -+{ -+ sint rmv_len; -+ u16 eth_type; -+ u16 len; -+ u8 bsnaphdr; -+ u8 *psnap_type; -+ struct ieee80211_snap_hdr *psnap; -+ __be16 be_tmp; -+ -+ sint ret=_SUCCESS; -+ _adapter *adapter =precvframe->u.hdr.adapter; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ u8 *ptr = get_recvframe_data(precvframe) ; // point to frame_ctrl field -+ struct rx_pkt_attrib *pattrib = & precvframe->u.hdr.attrib; -+ -+ -+ -+ if(pattrib->encrypt){ -+ recvframe_pull_tail(precvframe, pattrib->icv_len); -+ } -+ -+ psnap=(struct ieee80211_snap_hdr *)(ptr+pattrib->hdrlen + pattrib->iv_len); -+ psnap_type=ptr+pattrib->hdrlen + pattrib->iv_len+SNAP_SIZE; -+ /* convert hdr + possible LLC headers into Ethernet header */ -+ //eth_type = (psnap_type[0] << 8) | psnap_type[1]; -+ if((_rtw_memcmp(psnap, rtw_rfc1042_header, SNAP_SIZE) && -+ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_IPX, 2) == false) && -+ (_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_AARP, 2)==false) )|| -+ //eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || -+ _rtw_memcmp(psnap, rtw_bridge_tunnel_header, SNAP_SIZE)){ -+ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ -+ bsnaphdr = true; -+ } -+ else { -+ /* Leave Ethernet header part of hdr and full payload */ -+ bsnaphdr = false; -+ } -+ -+ rmv_len = pattrib->hdrlen + pattrib->iv_len +(bsnaphdr?SNAP_SIZE:0); -+ len = precvframe->u.hdr.len - rmv_len; -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("\n===pattrib->hdrlen: %x, pattrib->iv_len:%x ===\n\n", pattrib->hdrlen, pattrib->iv_len)); -+ -+ _rtw_memcpy(&be_tmp, ptr+rmv_len, 2); -+ eth_type= ntohs(be_tmp); //pattrib->ether_type -+ pattrib->eth_type = eth_type; -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if (0x8899 == pattrib->eth_type) -+ { -+ struct sta_info *psta = precvframe->u.hdr.psta; -+ -+ DBG_871X("wlan rx: got eth_type=0x%x\n", pattrib->eth_type); -+ -+ if (psta && psta->isrc && psta->pid>0) -+ { -+ u16 rx_pid; -+ -+ rx_pid = *(u16*)(ptr+rmv_len+2); -+ -+ DBG_871X("wlan rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", -+ rx_pid, MAC_ARG(psta->hwaddr), psta->pid); -+ -+ if(rx_pid == psta->pid) -+ { -+ int i; -+ u16 len = *(u16*)(ptr+rmv_len+4); -+ //u16 ctrl_type = *(u16*)(ptr+rmv_len+6); -+ -+ //DBG_871X("RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); -+ DBG_871X("RC: len=0x%x\n", len); -+ -+ for(i=0;idst, ETH_ALEN); -+ _rtw_memcpy(ptr+ETH_ALEN, pattrib->src, ETH_ALEN); -+ -+ if(!bsnaphdr) { -+ __be16 be_len = htons(len); -+ -+ _rtw_memcpy(ptr+12, &be_len, 2); -+ } -+ -+ -+ return ret; -+ -+} -+ -+#else -+ -+sint wlanhdr_to_ethhdr ( union recv_frame *precvframe) -+{ -+ sint rmv_len; -+ u16 eth_type; -+ u8 bsnaphdr; -+ u8 *psnap_type; -+ struct ieee80211_snap_hdr *psnap; -+ -+ sint ret=_SUCCESS; -+ _adapter *adapter =precvframe->u.hdr.adapter; -+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv; -+ -+ u8* ptr = get_recvframe_data(precvframe) ; // point to frame_ctrl field -+ struct rx_pkt_attrib *pattrib = & precvframe->u.hdr.attrib; -+ struct _vlan *pvlan = NULL; -+ -+ -+ -+ psnap=(struct ieee80211_snap_hdr *)(ptr+pattrib->hdrlen + pattrib->iv_len); -+ psnap_type=ptr+pattrib->hdrlen + pattrib->iv_len+SNAP_SIZE; -+ if (psnap->dsap==0xaa && psnap->ssap==0xaa && psnap->ctrl==0x03) -+ { -+ if (_rtw_memcmp(psnap->oui, oui_rfc1042, WLAN_IEEE_OUI_LEN)) -+ bsnaphdr=true;//wlan_pkt_format = WLAN_PKT_FORMAT_SNAP_RFC1042; -+ else if (_rtw_memcmp(psnap->oui, SNAP_HDR_APPLETALK_DDP, WLAN_IEEE_OUI_LEN) && -+ _rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_DDP, 2) ) -+ bsnaphdr=true; //wlan_pkt_format = WLAN_PKT_FORMAT_APPLETALK; -+ else if (_rtw_memcmp( psnap->oui, oui_8021h, WLAN_IEEE_OUI_LEN)) -+ bsnaphdr=true; //wlan_pkt_format = WLAN_PKT_FORMAT_SNAP_TUNNEL; -+ else { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("drop pkt due to invalid frame format!\n")); -+ ret= _FAIL; -+ goto exit; -+ } -+ -+ } else -+ bsnaphdr=false;//wlan_pkt_format = WLAN_PKT_FORMAT_OTHERS; -+ -+ rmv_len = pattrib->hdrlen + pattrib->iv_len +(bsnaphdr?SNAP_SIZE:0); -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("===pattrib->hdrlen: %x, pattrib->iv_len:%x ===\n", pattrib->hdrlen, pattrib->iv_len)); -+ -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) -+ { -+ ptr += rmv_len ; -+ *ptr = 0x87; -+ *(ptr+1) = 0x12; -+ -+ //back to original pointer -+ ptr -= rmv_len; -+ } -+ -+ ptr += rmv_len ; -+ -+ _rtw_memcpy(ð_type, ptr, 2); -+ eth_type= ntohs((unsigned short )eth_type); //pattrib->ether_type -+ ptr +=2; -+ -+ if(pattrib->encrypt){ -+ recvframe_pull_tail(precvframe, pattrib->icv_len); -+ } -+ -+ if(eth_type == 0x8100) //vlan -+ { -+ pvlan = (struct _vlan *) ptr; -+ -+ //eth_type = get_vlan_encap_proto(pvlan); -+ //eth_type = pvlan->h_vlan_encapsulated_proto;//? -+ rmv_len += 4; -+ ptr+=4; -+ } -+ -+ if(eth_type==0x0800)//ip -+ { -+ //struct iphdr* piphdr = (struct iphdr*) ptr; -+ //__u8 tos = (unsigned char)(pattrib->priority & 0xff); -+ -+ //piphdr->tos = tos; -+ -+ //if (piphdr->protocol == 0x06) -+ //{ -+ // RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("@@@===recv tcp len:%d @@@===\n", precvframe->u.hdr.len)); -+ //} -+ } -+ else if(eth_type==0x8712)// append rx status for mp test packets -+ { -+ //ptr -= 16; -+ //_rtw_memcpy(ptr, get_rxmem(precvframe), 16); -+ } -+ else -+ { -+ } -+ -+ if(eth_type==0x8712)// append rx status for mp test packets -+ { -+ ptr = recvframe_pull(precvframe, (rmv_len-sizeof(struct ethhdr)+2)-24); -+ _rtw_memcpy(ptr, get_rxmem(precvframe), 24); -+ ptr+=24; -+ } -+ else -+ ptr = recvframe_pull(precvframe, (rmv_len-sizeof(struct ethhdr)+2)); -+ -+ _rtw_memcpy(ptr, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(ptr+ETH_ALEN, pattrib->src, ETH_ALEN); -+ -+ eth_type = htons((unsigned short)eth_type) ; -+ _rtw_memcpy(ptr+12, ð_type, 2); -+ -+exit: -+ -+ -+ -+ return ret; -+} -+#endif -+ -+//perform defrag -+static union recv_frame * recvframe_defrag(_adapter *adapter,_queue *defrag_q) -+{ -+ _list *plist, *phead; -+ u8 *data,wlanhdr_offset; -+ u8 curfragnum; -+ struct recv_frame_hdr *pfhdr,*pnfhdr; -+ union recv_frame* prframe, *pnextrframe; -+ _queue *pfree_recv_queue; -+ -+ -+ -+ curfragnum=0; -+ pfree_recv_queue=&adapter->recvpriv.free_recv_queue; -+ -+ phead = get_list_head(defrag_q); -+ plist = get_next(phead); -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pfhdr=&prframe->u.hdr; -+ rtw_list_delete(&(prframe->u.list)); -+ -+ if(curfragnum!=pfhdr->attrib.frag_num) -+ { -+ //the first fragment number must be 0 -+ //free the whole queue -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); -+ -+ return NULL; -+ } -+ -+ curfragnum++; -+ -+ plist= get_list_head(defrag_q); -+ -+ plist = get_next(plist); -+ -+ data=get_recvframe_data(prframe); -+ -+ while(rtw_end_of_queue_search(phead, plist) == false) -+ { -+ pnextrframe = LIST_CONTAINOR(plist, union recv_frame , u); -+ pnfhdr=&pnextrframe->u.hdr; -+ -+ -+ //check the fragment sequence (2nd ~n fragment frame) -+ -+ if(curfragnum!=pnfhdr->attrib.frag_num) -+ { -+ //the fragment number must be increasing (after decache) -+ //release the defrag_q & prframe -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); -+ return NULL; -+ } -+ -+ curfragnum++; -+ -+ //copy the 2nd~n fragment frame's payload to the first fragment -+ //get the 2nd~last fragment frame's payload -+ -+ wlanhdr_offset = pnfhdr->attrib.hdrlen + pnfhdr->attrib.iv_len; -+ -+ recvframe_pull(pnextrframe, wlanhdr_offset); -+ -+ //append to first fragment frame's tail (if privacy frame, pull the ICV) -+ recvframe_pull_tail(prframe, pfhdr->attrib.icv_len); -+ -+ //memcpy -+ _rtw_memcpy(pfhdr->rx_tail, pnfhdr->rx_data, pnfhdr->len); -+ -+ recvframe_put(prframe, pnfhdr->len); -+ -+ pfhdr->attrib.icv_len=pnfhdr->attrib.icv_len; -+ plist = get_next(plist); -+ -+ }; -+ -+ //free the defrag_q queue and return the prframe -+ rtw_free_recvframe_queue(defrag_q, pfree_recv_queue); -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("Performance defrag!!!!!\n")); -+ -+ -+ -+ return prframe; -+} -+ -+//check if need to defrag, if needed queue the frame to defrag_q -+union recv_frame* recvframe_chk_defrag(PADAPTER padapter, union recv_frame *precv_frame) -+{ -+ u8 ismfrag; -+ u8 fragnum; -+ u8 *psta_addr; -+ struct recv_frame_hdr *pfhdr; -+ struct sta_info *psta; -+ struct sta_priv *pstapriv; -+ _list *phead; -+ union recv_frame *prtnframe = NULL; -+ _queue *pfree_recv_queue, *pdefrag_q; -+ -+ -+ -+ pstapriv = &padapter->stapriv; -+ -+ pfhdr = &precv_frame->u.hdr; -+ -+ pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+ //need to define struct of wlan header frame ctrl -+ ismfrag = pfhdr->attrib.mfrag; -+ fragnum = pfhdr->attrib.frag_num; -+ -+ psta_addr = pfhdr->attrib.ta; -+ psta = rtw_get_stainfo(pstapriv, psta_addr); -+ if (psta == NULL) -+ { -+ u8 type = GetFrameType(pfhdr->rx_data); -+ if (type != WIFI_DATA_TYPE) { -+ psta = rtw_get_bcmc_stainfo(padapter); -+ pdefrag_q = &psta->sta_recvpriv.defrag_q; -+ } else -+ pdefrag_q = NULL; -+ } -+ else -+ pdefrag_q = &psta->sta_recvpriv.defrag_q; -+ -+ if ((ismfrag==0) && (fragnum==0)) -+ { -+ prtnframe = precv_frame;//isn't a fragment frame -+ } -+ -+ if (ismfrag==1) -+ { -+ //0~(n-1) fragment frame -+ //enqueue to defraf_g -+ if(pdefrag_q != NULL) -+ { -+ if(fragnum==0) -+ { -+ //the first fragment -+ if(_rtw_queue_empty(pdefrag_q) == false) -+ { -+ //free current defrag_q -+ rtw_free_recvframe_queue(pdefrag_q, pfree_recv_queue); -+ } -+ } -+ -+ -+ //Then enqueue the 0~(n-1) fragment into the defrag_q -+ -+ //_rtw_spinlock(&pdefrag_q->lock); -+ phead = get_list_head(pdefrag_q); -+ rtw_list_insert_tail(&pfhdr->list, phead); -+ //_rtw_spinunlock(&pdefrag_q->lock); -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("Enqueuq: ismfrag = %d, fragnum= %d\n", ismfrag,fragnum)); -+ -+ prtnframe=NULL; -+ -+ } -+ else -+ { -+ //can't find this ta's defrag_queue, so free this recv_frame -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ prtnframe=NULL; -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("Free because pdefrag_q ==NULL: ismfrag = %d, fragnum= %d\n", ismfrag, fragnum)); -+ } -+ -+ } -+ -+ if((ismfrag==0)&&(fragnum!=0)) -+ { -+ //the last fragment frame -+ //enqueue the last fragment -+ if(pdefrag_q != NULL) -+ { -+ //_rtw_spinlock(&pdefrag_q->lock); -+ phead = get_list_head(pdefrag_q); -+ rtw_list_insert_tail(&pfhdr->list,phead); -+ //_rtw_spinunlock(&pdefrag_q->lock); -+ -+ //call recvframe_defrag to defrag -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("defrag: ismfrag = %d, fragnum= %d\n", ismfrag, fragnum)); -+ precv_frame = recvframe_defrag(padapter, pdefrag_q); -+ prtnframe=precv_frame; -+ -+ } -+ else -+ { -+ //can't find this ta's defrag_queue, so free this recv_frame -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ prtnframe=NULL; -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("Free because pdefrag_q ==NULL: ismfrag = %d, fragnum= %d\n", ismfrag,fragnum)); -+ } -+ -+ } -+ -+ -+ if((prtnframe!=NULL)&&(prtnframe->u.hdr.attrib.privacy)) -+ { -+ //after defrag we must check tkip mic code -+ if(recvframe_chkmic(padapter, prtnframe)==_FAIL) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("recvframe_chkmic(padapter, prtnframe)==_FAIL\n")); -+ rtw_free_recvframe(prtnframe,pfree_recv_queue); -+ prtnframe=NULL; -+ } -+ } -+ -+ -+ -+ return prtnframe; -+ -+} -+ -+static int amsdu_to_msdu(_adapter *padapter, union recv_frame *prframe) -+{ -+ int a_len, padding_len; -+ u16 nSubframe_Length; -+ u8 nr_subframes, i; -+ u8 *pdata; -+ _pkt *sub_pkt,*subframes[MAX_SUBFRAME_COUNT]; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *pfree_recv_queue = &(precvpriv->free_recv_queue); -+ int ret = _SUCCESS; -+ -+ nr_subframes = 0; -+ -+ recvframe_pull(prframe, prframe->u.hdr.attrib.hdrlen); -+ -+ if(prframe->u.hdr.attrib.iv_len >0) -+ { -+ recvframe_pull(prframe, prframe->u.hdr.attrib.iv_len); -+ } -+ -+ a_len = prframe->u.hdr.len; -+ -+ pdata = prframe->u.hdr.rx_data; -+ -+ while(a_len > ETH_HLEN) { -+ -+ /* Offset 12 denote 2 mac address */ -+ nSubframe_Length = RTW_GET_BE16(pdata + 12); -+ -+ if( a_len < (ETHERNET_HEADER_SIZE + nSubframe_Length) ) { -+ DBG_871X("nRemain_Length is %d and nSubframe_Length is : %d\n",a_len,nSubframe_Length); -+ break; -+ } -+ -+ sub_pkt = rtw_os_alloc_msdu_pkt(prframe, nSubframe_Length, pdata); -+ if (sub_pkt == NULL) { -+ DBG_871X("%s(): allocate sub packet fail !!!\n",__FUNCTION__); -+ break; -+ } -+ -+ /* move the data point to data content */ -+ pdata += ETH_HLEN; -+ a_len -= ETH_HLEN; -+ -+ subframes[nr_subframes++] = sub_pkt; -+ -+ if(nr_subframes >= MAX_SUBFRAME_COUNT) { -+ DBG_871X("ParseSubframe(): Too many Subframes! Packets dropped!\n"); -+ break; -+ } -+ -+ pdata += nSubframe_Length; -+ a_len -= nSubframe_Length; -+ if(a_len != 0) { -+ padding_len = 4 - ((nSubframe_Length + ETH_HLEN) & (4-1)); -+ if(padding_len == 4) { -+ padding_len = 0; -+ } -+ -+ if(a_len < padding_len) { -+ DBG_871X("ParseSubframe(): a_len < padding_len !\n"); -+ break; -+ } -+ pdata += padding_len; -+ a_len -= padding_len; -+ } -+ } -+ -+ for(i=0; iu.hdr.attrib); -+ } -+ } -+ -+ prframe->u.hdr.len = 0; -+ rtw_free_recvframe(prframe, pfree_recv_queue);//free this recv_frame -+ -+ return ret; -+} -+ -+int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num); -+int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num) -+{ -+ u8 wsize = preorder_ctrl->wsize_b; -+ u16 wend = (preorder_ctrl->indicate_seq + wsize -1) & 0xFFF;//% 4096; -+ -+ // Rx Reorder initialize condition. -+ if (preorder_ctrl->indicate_seq == 0xFFFF) -+ { -+ preorder_ctrl->indicate_seq = seq_num; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d init IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, seq_num); -+ #endif -+ -+ //DbgPrint("check_indicate_seq, 1st->indicate_seq=%d\n", precvpriv->indicate_seq); -+ } -+ -+ //DbgPrint("enter->check_indicate_seq(): IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); -+ -+ // Drop out the packet which SeqNum is smaller than WinStart -+ if( SN_LESS(seq_num, preorder_ctrl->indicate_seq) ) -+ { -+ //RT_TRACE(COMP_RX_REORDER, DBG_LOUD, ("CheckRxTsIndicateSeq(): Packet Drop! IndicateSeq: %d, NewSeq: %d\n", pTS->RxIndicateSeq, NewSeqNum)); -+ //DbgPrint("CheckRxTsIndicateSeq(): Packet Drop! IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); -+ -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("%s IndicateSeq: %d > NewSeq: %d\n", __FUNCTION__, -+ preorder_ctrl->indicate_seq, seq_num); -+ #endif -+ -+ -+ return false; -+ } -+ -+ // -+ // Sliding window manipulation. Conditions includes: -+ // 1. Incoming SeqNum is equal to WinStart =>Window shift 1 -+ // 2. Incoming SeqNum is larger than the WinEnd => Window shift N -+ // -+ if( SN_EQUAL(seq_num, preorder_ctrl->indicate_seq) ) -+ { -+ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) & 0xFFF; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d SN_EQUAL IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, seq_num); -+ #endif -+ } -+ else if(SN_LESS(wend, seq_num)) -+ { -+ //RT_TRACE(COMP_RX_REORDER, DBG_LOUD, ("CheckRxTsIndicateSeq(): Window Shift! IndicateSeq: %d, NewSeq: %d\n", pTS->RxIndicateSeq, NewSeqNum)); -+ //DbgPrint("CheckRxTsIndicateSeq(): Window Shift! IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); -+ -+ // boundary situation, when seq_num cross 0xFFF -+ if(seq_num >= (wsize - 1)) -+ preorder_ctrl->indicate_seq = seq_num + 1 -wsize; -+ else -+ preorder_ctrl->indicate_seq = 0xFFF - (wsize - (seq_num + 1)) + 1; -+ -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d SN_LESS(wend, seq_num) IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, seq_num); -+ #endif -+ } -+ -+ //DbgPrint("exit->check_indicate_seq(): IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); -+ -+ return true; -+} -+ -+int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union recv_frame *prframe); -+int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union recv_frame *prframe) -+{ -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ _list *phead, *plist; -+ union recv_frame *pnextrframe; -+ struct rx_pkt_attrib *pnextattrib; -+ -+ //DbgPrint("+enqueue_reorder_recvframe()\n"); -+ -+ //_enter_critical_ex(&ppending_recvframe_queue->lock, &irql); -+ //_rtw_spinlock_ex(&ppending_recvframe_queue->lock); -+ -+ -+ phead = get_list_head(ppending_recvframe_queue); -+ plist = get_next(phead); -+ -+ while(rtw_end_of_queue_search(phead, plist) == false) -+ { -+ pnextrframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pnextattrib = &pnextrframe->u.hdr.attrib; -+ -+ if(SN_LESS(pnextattrib->seq_num, pattrib->seq_num)) -+ { -+ plist = get_next(plist); -+ } -+ else if( SN_EQUAL(pnextattrib->seq_num, pattrib->seq_num)) -+ { -+ //Duplicate entry is found!! Do not insert current entry. -+ //RT_TRACE(COMP_RX_REORDER, DBG_TRACE, ("InsertRxReorderList(): Duplicate packet is dropped!! IndicateSeq: %d, NewSeq: %d\n", pTS->RxIndicateSeq, SeqNum)); -+ -+ //_exit_critical_ex(&ppending_recvframe_queue->lock, &irql); -+ -+ return false; -+ } -+ else -+ { -+ break; -+ } -+ -+ //DbgPrint("enqueue_reorder_recvframe():while\n"); -+ -+ } -+ -+ -+ //_enter_critical_ex(&ppending_recvframe_queue->lock, &irql); -+ //_rtw_spinlock_ex(&ppending_recvframe_queue->lock); -+ -+ rtw_list_delete(&(prframe->u.hdr.list)); -+ -+ rtw_list_insert_tail(&(prframe->u.hdr.list), plist); -+ -+ //_rtw_spinunlock_ex(&ppending_recvframe_queue->lock); -+ //_exit_critical_ex(&ppending_recvframe_queue->lock, &irql); -+ -+ -+ //RT_TRACE(COMP_RX_REORDER, DBG_TRACE, ("InsertRxReorderList(): Pkt insert into buffer!! IndicateSeq: %d, NewSeq: %d\n", pTS->RxIndicateSeq, SeqNum)); -+ return true; -+ -+} -+ -+int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced); -+int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced) -+{ -+ //_irqL irql; -+ //u8 bcancelled; -+ _list *phead, *plist; -+ union recv_frame *prframe; -+ struct rx_pkt_attrib *pattrib; -+ //u8 index = 0; -+ int bPktInBuf = false; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ -+ //DbgPrint("+recv_indicatepkts_in_order\n"); -+ -+ //_enter_critical_ex(&ppending_recvframe_queue->lock, &irql); -+ //_rtw_spinlock_ex(&ppending_recvframe_queue->lock); -+ -+ phead = get_list_head(ppending_recvframe_queue); -+ plist = get_next(phead); -+ -+#if 0 -+ // Check if there is any other indication thread running. -+ if(pTS->RxIndicateState == RXTS_INDICATE_PROCESSING) -+ return; -+#endif -+ -+ // Handling some condition for forced indicate case. -+ if(bforced==true) -+ { -+ if(rtw_is_list_empty(phead)) -+ { -+ // _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); -+ //_rtw_spinunlock_ex(&ppending_recvframe_queue->lock); -+ return true; -+ } -+ -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pattrib = &prframe->u.hdr.attrib; -+ preorder_ctrl->indicate_seq = pattrib->seq_num; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ } -+ -+ // Prepare indication list and indication. -+ // Check if there is any packet need indicate. -+ while(!rtw_is_list_empty(phead)) -+ { -+ -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ pattrib = &prframe->u.hdr.attrib; -+ -+ if(!SN_LESS(preorder_ctrl->indicate_seq, pattrib->seq_num)) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, -+ ("recv_indicatepkts_in_order: indicate=%d seq=%d amsdu=%d\n", -+ preorder_ctrl->indicate_seq, pattrib->seq_num, pattrib->amsdu)); -+ -+#if 0 -+ // This protect buffer from overflow. -+ if(index >= REORDER_WIN_SIZE) -+ { -+ RT_ASSERT(false, ("IndicateRxReorderList(): Buffer overflow!! \n")); -+ bPktInBuf = true; -+ break; -+ } -+#endif -+ -+ plist = get_next(plist); -+ rtw_list_delete(&(prframe->u.hdr.list)); -+ -+ if(SN_EQUAL(preorder_ctrl->indicate_seq, pattrib->seq_num)) -+ { -+ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) & 0xFFF; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ } -+ -+#if 0 -+ index++; -+ if(index==1) -+ { -+ //Cancel previous pending timer. -+ //PlatformCancelTimer(Adapter, &pTS->RxPktPendingTimer); -+ if(bforced!=true) -+ { -+ //DBG_871X("_cancel_timer(&preorder_ctrl->reordering_ctrl_timer, &bcancelled);\n"); -+ _cancel_timer(&preorder_ctrl->reordering_ctrl_timer, &bcancelled); -+ } -+ } -+#endif -+ -+ //Set this as a lock to make sure that only one thread is indicating packet. -+ //pTS->RxIndicateState = RXTS_INDICATE_PROCESSING; -+ -+ // Indicate packets -+ //RT_ASSERT((index<=REORDER_WIN_SIZE), ("RxReorderIndicatePacket(): Rx Reorder buffer full!! \n")); -+ -+ -+ //indicate this recv_frame -+ //DbgPrint("recv_indicatepkts_in_order, indicate_seq=%d, seq_num=%d\n", precvpriv->indicate_seq, pattrib->seq_num); -+ if(!pattrib->amsdu) -+ { -+ //DBG_871X("recv_indicatepkts_in_order, amsdu!=1, indicate_seq=%d, seq_num=%d\n", preorder_ctrl->indicate_seq, pattrib->seq_num); -+ -+ if ((padapter->bDriverStopped == false) && -+ (padapter->bSurpriseRemoved == false)) -+ { -+ -+ rtw_recv_indicatepkt(padapter, prframe);//indicate this recv_frame -+ -+ } -+ } -+ else if(pattrib->amsdu==1) -+ { -+ if(amsdu_to_msdu(padapter, prframe)!=_SUCCESS) -+ { -+ rtw_free_recvframe(prframe, &precvpriv->free_recv_queue); -+ } -+ } -+ else -+ { -+ //error condition; -+ } -+ -+ -+ //Update local variables. -+ bPktInBuf = false; -+ -+ } -+ else -+ { -+ bPktInBuf = true; -+ break; -+ } -+ -+ //DbgPrint("recv_indicatepkts_in_order():while\n"); -+ -+ } -+ -+ //_rtw_spinunlock_ex(&ppending_recvframe_queue->lock); -+ //_exit_critical_ex(&ppending_recvframe_queue->lock, &irql); -+ -+/* -+ //Release the indication lock and set to new indication step. -+ if(bPktInBuf) -+ { -+ // Set new pending timer. -+ //pTS->RxIndicateState = RXTS_INDICATE_REORDER; -+ //PlatformSetTimer(Adapter, &pTS->RxPktPendingTimer, pHTInfo->RxReorderPendingTime); -+ //DBG_871X("_set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME)\n"); -+ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); -+ } -+ else -+ { -+ //pTS->RxIndicateState = RXTS_INDICATE_IDLE; -+ } -+*/ -+ //_exit_critical_ex(&ppending_recvframe_queue->lock, &irql); -+ -+ //return true; -+ return bPktInBuf; -+ -+} -+ -+int recv_indicatepkt_reorder(_adapter *padapter, union recv_frame *prframe); -+int recv_indicatepkt_reorder(_adapter *padapter, union recv_frame *prframe) -+{ -+ _irqL irql; -+ int retval = _SUCCESS; -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ struct recv_reorder_ctrl *preorder_ctrl = prframe->u.hdr.preorder_ctrl; -+ _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ -+ if(!pattrib->amsdu) -+ { -+ //s1. -+ wlanhdr_to_ethhdr(prframe); -+ -+ if ((pattrib->qos!=1) /*|| pattrib->priority!=0 || IS_MCAST(pattrib->ra)*/ -+ || (pattrib->eth_type==0x0806) || (pattrib->ack_policy!=0)) -+ { -+ if ((padapter->bDriverStopped == false) && -+ (padapter->bSurpriseRemoved == false)) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("@@@@ recv_indicatepkt_reorder -recv_func recv_indicatepkt\n" )); -+ -+ rtw_recv_indicatepkt(padapter, prframe); -+ return _SUCCESS; -+ -+ } -+ -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s pattrib->qos !=1\n", __FUNCTION__); -+ #endif -+ -+ return _FAIL; -+ -+ } -+ -+ if (preorder_ctrl->enable == false) -+ { -+ //indicate this recv_frame -+ preorder_ctrl->indicate_seq = pattrib->seq_num; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ -+ rtw_recv_indicatepkt(padapter, prframe); -+ -+ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1)%4096; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ -+ return _SUCCESS; -+ } -+ -+#ifndef CONFIG_RECV_REORDERING_CTRL -+ //indicate this recv_frame -+ rtw_recv_indicatepkt(padapter, prframe); -+ return _SUCCESS; -+#endif -+ -+ } -+ else if(pattrib->amsdu==1) //temp filter -> means didn't support A-MSDUs in a A-MPDU -+ { -+ if (preorder_ctrl->enable == false) -+ { -+ preorder_ctrl->indicate_seq = pattrib->seq_num; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ -+ retval = amsdu_to_msdu(padapter, prframe); -+ -+ preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1)%4096; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, pattrib->seq_num); -+ #endif -+ -+ if(retval != _SUCCESS){ -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s amsdu_to_msdu fail\n", __FUNCTION__); -+ #endif -+ } -+ -+ return retval; -+ } -+ } -+ else -+ { -+ -+ } -+ -+ _enter_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, -+ ("recv_indicatepkt_reorder: indicate=%d seq=%d\n", -+ preorder_ctrl->indicate_seq, pattrib->seq_num)); -+ -+ //s2. check if winstart_b(indicate_seq) needs to been updated -+ if(!check_indicate_seq(preorder_ctrl, pattrib->seq_num)) -+ { -+ //pHTInfo->RxReorderDropCounter++; -+ //ReturnRFDList(Adapter, pRfd); -+ //RT_TRACE(COMP_RX_REORDER, DBG_TRACE, ("RxReorderIndicatePacket() ==> Packet Drop!!\n")); -+ //_exit_critical_ex(&ppending_recvframe_queue->lock, &irql); -+ //return _FAIL; -+ -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s check_indicate_seq fail\n", __FUNCTION__); -+ #endif -+#if 0 -+ rtw_recv_indicatepkt(padapter, prframe); -+ -+ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ -+ goto _success_exit; -+#else -+ goto _err_exit; -+#endif -+ } -+ -+ -+ //s3. Insert all packet into Reorder Queue to maintain its ordering. -+ if(!enqueue_reorder_recvframe(preorder_ctrl, prframe)) -+ { -+ //DbgPrint("recv_indicatepkt_reorder, enqueue_reorder_recvframe fail!\n"); -+ //_exit_critical_ex(&ppending_recvframe_queue->lock, &irql); -+ //return _FAIL; -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s enqueue_reorder_recvframe fail\n", __FUNCTION__); -+ #endif -+ goto _err_exit; -+ } -+ -+ -+ //s4. -+ // Indication process. -+ // After Packet dropping and Sliding Window shifting as above, we can now just indicate the packets -+ // with the SeqNum smaller than latest WinStart and buffer other packets. -+ // -+ // For Rx Reorder condition: -+ // 1. All packets with SeqNum smaller than WinStart => Indicate -+ // 2. All packets with SeqNum larger than or equal to WinStart => Buffer it. -+ // -+ -+ //recv_indicatepkts_in_order(padapter, preorder_ctrl, true); -+ if(recv_indicatepkts_in_order(padapter, preorder_ctrl, false)==true) -+ { -+ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); -+ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ } -+ else -+ { -+ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); -+ } -+ -+ -+_success_exit: -+ -+ return _SUCCESS; -+ -+_err_exit: -+ -+ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ -+ return _FAIL; -+} -+ -+ -+void rtw_reordering_ctrl_timeout_handler(void *pcontext) -+{ -+ _irqL irql; -+ struct recv_reorder_ctrl *preorder_ctrl = (struct recv_reorder_ctrl *)pcontext; -+ _adapter *padapter = preorder_ctrl->padapter; -+ _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ -+ -+ if(padapter->bDriverStopped ||padapter->bSurpriseRemoved) -+ { -+ return; -+ } -+ -+ //DBG_871X("+rtw_reordering_ctrl_timeout_handler()=>\n"); -+ -+ _enter_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ -+ if(recv_indicatepkts_in_order(padapter, preorder_ctrl, true)==true) -+ { -+ _set_timer(&preorder_ctrl->reordering_ctrl_timer, REORDER_WAIT_TIME); -+ } -+ -+ _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); -+ -+} -+ -+int process_recv_indicatepkts(_adapter *padapter, union recv_frame *prframe); -+int process_recv_indicatepkts(_adapter *padapter, union recv_frame *prframe) -+{ -+ int retval = _SUCCESS; -+ //struct recv_priv *precvpriv = &padapter->recvpriv; -+ //struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_TDLS -+ struct sta_info *psta = prframe->u.hdr.psta; -+#endif //CONFIG_TDLS -+ -+#ifdef CONFIG_80211N_HT -+ -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ -+#ifdef CONFIG_TDLS -+ if( (phtpriv->ht_option==true) || -+ ((psta->tdls_sta_state & TDLS_LINKED_STATE) && -+ (psta->htpriv.ht_option==true) && -+ (psta->htpriv.ampdu_enable==true))) //B/G/N Mode -+#else -+ if(phtpriv->ht_option==true) //B/G/N Mode -+#endif //CONFIG_TDLS -+ { -+ //prframe->u.hdr.preorder_ctrl = &precvpriv->recvreorder_ctrl[pattrib->priority]; -+ -+ if(recv_indicatepkt_reorder(padapter, prframe)!=_SUCCESS)// including perform A-MPDU Rx Ordering Buffer Control -+ { -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s recv_indicatepkt_reorder error!\n", __FUNCTION__); -+ #endif -+ -+ if ((padapter->bDriverStopped == false) && -+ (padapter->bSurpriseRemoved == false)) -+ { -+ retval = _FAIL; -+ return retval; -+ } -+ } -+ } -+ else //B/G mode -+#endif -+ { -+ retval=wlanhdr_to_ethhdr (prframe); -+ if(retval != _SUCCESS) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("wlanhdr_to_ethhdr: drop pkt \n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr error!\n", __FUNCTION__); -+ #endif -+ return retval; -+ } -+ -+ if ((padapter->bDriverStopped ==false)&&( padapter->bSurpriseRemoved==false)) -+ { -+ //indicate this recv_frame -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("@@@@ process_recv_indicatepkts- recv_func recv_indicatepkt\n" )); -+ rtw_recv_indicatepkt(padapter, prframe); -+ -+ -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("@@@@ process_recv_indicatepkts- recv_func free_indicatepkt\n" )); -+ -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_notice_, ("recv_func:bDriverStopped(%d) OR bSurpriseRemoved(%d)", padapter->bDriverStopped, padapter->bSurpriseRemoved)); -+ retval = _FAIL; -+ return retval; -+ } -+ -+ } -+ -+ return retval; -+ -+} -+ -+static int recv_func_prehandle(_adapter *padapter, union recv_frame *rframe) -+{ -+ int ret = _SUCCESS; -+ struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+#ifdef CONFIG_MP_INCLUDED -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+#endif //CONFIG_MP_INCLUDED -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) -+ { -+ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == true))//&&(padapter->mppriv.check_mp_pkt == 0)) -+ { -+ if (pattrib->crc_err == 1) -+ padapter->mppriv.rx_crcerrpktcount++; -+ else -+ padapter->mppriv.rx_pktcount++; -+ -+ if (check_fwstate(pmlmepriv, WIFI_MP_LPBK_STATE) == false) { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_alert_, ("MP - Not in loopback mode , drop pkt \n")); -+ ret = _FAIL; -+ rtw_free_recvframe(rframe, pfree_recv_queue);//free this recv_frame -+ goto exit; -+ } -+ } -+ } -+#endif -+ -+ //check the frame crtl field and decache -+ ret = validate_recv_frame(padapter, rframe); -+ if (ret != _SUCCESS) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, ("recv_func: validate_recv_frame fail! drop pkt\n")); -+ rtw_free_recvframe(rframe, pfree_recv_queue);//free this recv_frame -+ goto exit; -+ } -+ -+exit: -+ return ret; -+} -+ -+static int recv_func_posthandle(_adapter *padapter, union recv_frame *prframe) -+{ -+ int ret = _SUCCESS; -+ union recv_frame *orig_prframe = prframe; -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+ -+#ifdef CONFIG_TDLS -+ u8 *psnap_type, *pcategory; -+ struct sta_info *ptdls_sta = NULL; -+#endif //CONFIG_TDLS -+ -+ -+ // DATA FRAME -+ rtw_led_control(padapter, LED_CTL_RX); -+ -+ prframe = decryptor(padapter, prframe); -+ if (prframe == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("decryptor: drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s decryptor: drop pkt\n", __FUNCTION__); -+ #endif -+ ret = _FAIL; -+ goto _recv_data_drop; -+ } -+ -+#if 0 -+ if ( padapter->adapter_type == PRIMARY_ADAPTER ) -+ { -+ DBG_871X("+++\n"); -+ { -+ int i; -+ u8 *ptr = get_recvframe_data(prframe); -+ for(i=0; i<140;i=i+8) -+ DBG_871X("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:", *(ptr+i), -+ *(ptr+i+1), *(ptr+i+2) ,*(ptr+i+3) ,*(ptr+i+4),*(ptr+i+5), *(ptr+i+6), *(ptr+i+7)); -+ -+ } -+ DBG_871X("---\n"); -+ } -+#endif -+ -+#ifdef CONFIG_TDLS -+ //check TDLS frame -+ psnap_type = get_recvframe_data(orig_prframe); -+ psnap_type+=pattrib->hdrlen + pattrib->iv_len+SNAP_SIZE; -+ pcategory = psnap_type + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; -+ -+ if((_rtw_memcmp(psnap_type, SNAP_ETH_TYPE_TDLS, ETH_TYPE_LEN)) && -+ ((*pcategory==RTW_WLAN_CATEGORY_TDLS) || (*pcategory==RTW_WLAN_CATEGORY_P2P))){ -+ ret = OnTDLS(padapter, prframe); //all of functions will return _FAIL -+ goto _exit_recv_func; -+ } -+#endif //CONFIG_TDLS -+ -+ prframe = recvframe_chk_defrag(padapter, prframe); -+ if(prframe==NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("recvframe_chk_defrag: drop pkt\n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s recvframe_chk_defrag: drop pkt\n", __FUNCTION__); -+ #endif -+ goto _recv_data_drop; -+ } -+ -+ prframe=portctrl(padapter, prframe); -+ if (prframe == NULL) { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("portctrl: drop pkt \n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s portctrl: drop pkt\n", __FUNCTION__); -+ #endif -+ ret = _FAIL; -+ goto _recv_data_drop; -+ } -+ -+#ifdef CONFIG_TDLS -+ if(padapter->tdlsinfo.setup_state == TDLS_LINKED_STATE) -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->src); -+ count_rx_stats(padapter, prframe, ptdls_sta); -+#else -+ count_rx_stats(padapter, prframe, NULL); -+#endif //CONFIG_TDLS -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_update_info(padapter, prframe); -+#endif -+ -+#ifdef CONFIG_80211N_HT -+ ret = process_recv_indicatepkts(padapter, prframe); -+ if (ret != _SUCCESS) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("recv_func: process_recv_indicatepkts fail! \n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s process_recv_indicatepkts fail!\n", __FUNCTION__); -+ #endif -+ rtw_free_recvframe(orig_prframe, pfree_recv_queue);//free this recv_frame -+ goto _recv_data_drop; -+ } -+#else // CONFIG_80211N_HT -+ if (!pattrib->amsdu) -+ { -+ ret = wlanhdr_to_ethhdr (prframe); -+ if (ret != _SUCCESS) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("wlanhdr_to_ethhdr: drop pkt \n")); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr: drop pkt\n", __FUNCTION__); -+ #endif -+ rtw_free_recvframe(orig_prframe, pfree_recv_queue);//free this recv_frame -+ goto _recv_data_drop; -+ } -+ -+ if ((padapter->bDriverStopped == false) && (padapter->bSurpriseRemoved == false)) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_alert_, ("@@@@ recv_func: recv_func rtw_recv_indicatepkt\n" )); -+ //indicate this recv_frame -+ ret = rtw_recv_indicatepkt(padapter, prframe); -+ if (ret != _SUCCESS) -+ { -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s rtw_recv_indicatepkt fail!\n", __FUNCTION__); -+ #endif -+ goto _recv_data_drop; -+ } -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_alert_, ("@@@@ recv_func: rtw_free_recvframe\n" )); -+ RT_TRACE(_module_rtl871x_recv_c_, _drv_debug_, ("recv_func:bDriverStopped(%d) OR bSurpriseRemoved(%d)", padapter->bDriverStopped, padapter->bSurpriseRemoved)); -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s ecv_func:bDriverStopped(%d) OR bSurpriseRemoved(%d)\n", __FUNCTION__, -+ padapter->bDriverStopped, padapter->bSurpriseRemoved); -+ #endif -+ ret = _FAIL; -+ rtw_free_recvframe(orig_prframe, pfree_recv_queue); //free this recv_frame -+ } -+ -+ } -+ else if(pattrib->amsdu==1) -+ { -+ -+ ret = amsdu_to_msdu(padapter, prframe); -+ if(ret != _SUCCESS) -+ { -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s amsdu_to_msdu fail\n", __FUNCTION__); -+ #endif -+ rtw_free_recvframe(orig_prframe, pfree_recv_queue); -+ goto _recv_data_drop; -+ } -+ } -+ else -+ { -+ #ifdef DBG_RX_DROP_FRAME -+ DBG_871X("DBG_RX_DROP_FRAME %s what is this condition??\n", __FUNCTION__); -+ #endif -+ goto _recv_data_drop; -+ } -+#endif // CONFIG_80211N_HT -+ -+_exit_recv_func: -+ return ret; -+ -+_recv_data_drop: -+ precvpriv->rx_drop++; -+ return ret; -+} -+ -+ -+int recv_func(_adapter *padapter, union recv_frame *rframe); -+int recv_func(_adapter *padapter, union recv_frame *rframe) -+{ -+ int ret; -+ struct rx_pkt_attrib *prxattrib = &rframe->u.hdr.attrib; -+ struct recv_priv *recvpriv = &padapter->recvpriv; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ -+ /* check if need to handle uc_swdec_pending_queue*/ -+ if (check_fwstate(mlmepriv, WIFI_STATION_STATE) && psecuritypriv->busetkipkey) -+ { -+ union recv_frame *pending_frame; -+ _irqL irqL; -+ -+ while((pending_frame=rtw_alloc_recvframe(&padapter->recvpriv.uc_swdec_pending_queue))) { -+ if (recv_func_posthandle(padapter, pending_frame) == _SUCCESS) -+ DBG_871X("%s: dequeue uc_swdec_pending_queue\n", __func__); -+ } -+ } -+ -+ ret = recv_func_prehandle(padapter, rframe); -+ -+ if(ret == _SUCCESS) { -+ -+ /* check if need to enqueue into uc_swdec_pending_queue*/ -+ if (check_fwstate(mlmepriv, WIFI_STATION_STATE) && -+ !IS_MCAST(prxattrib->ra) && prxattrib->encrypt>0 && -+ (prxattrib->bdecrypted == 0 ||psecuritypriv->sw_decrypt == true) && -+ !is_wep_enc(psecuritypriv->dot11PrivacyAlgrthm) && -+ !psecuritypriv->busetkipkey) { -+ rtw_enqueue_recvframe(rframe, &padapter->recvpriv.uc_swdec_pending_queue); -+ DBG_871X("%s: no key, enqueue uc_swdec_pending_queue\n", __func__); -+ goto exit; -+ } -+ -+ ret = recv_func_posthandle(padapter, rframe); -+ } -+ -+exit: -+ return ret; -+} -+ -+ -+s32 rtw_recv_entry(union recv_frame *precvframe) -+{ -+ _adapter *padapter; -+ struct recv_priv *precvpriv; -+ s32 ret=_SUCCESS; -+ -+ -+ -+// RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("+rtw_recv_entry\n")); -+ -+ padapter = precvframe->u.hdr.adapter; -+ -+ precvpriv = &padapter->recvpriv; -+ -+ -+ if ((ret = recv_func(padapter, precvframe)) == _FAIL) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("rtw_recv_entry: recv_func return fail!!!\n")); -+ goto _recv_entry_drop; -+ } -+ -+ -+ precvpriv->rx_pkts++; -+ -+ -+ -+ return ret; -+ -+_recv_entry_drop: -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (padapter->registrypriv.mp_mode == 1) -+ padapter->mppriv.rx_pktloss = precvpriv->rx_drop; -+#endif -+ -+ //RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("_recv_entry_drop\n")); -+ -+ -+ -+ return ret; -+} -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS) -+#else -+void rtw_signal_stat_timer_hdl(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *adapter = (_adapter *)FunctionContext; -+#else -+ _adapter *adapter = from_timer(adapter, t, recvpriv.signal_stat_timer); -+#endif -+ struct recv_priv *recvpriv = &adapter->recvpriv; -+ -+ u32 tmp_s, tmp_q; -+ u8 avg_signal_strength = 0; -+ u8 avg_signal_qual = 0; -+ u32 num_signal_strength = 0; -+ u32 num_signal_qual = 0; -+ u8 _alpha = 3; // this value is based on converging_constant = 5000 and sampling_interval = 1000 -+ -+ if(adapter->recvpriv.is_signal_dbg) { -+ //update the user specific value, signal_strength_dbg, to signal_strength, rssi -+ adapter->recvpriv.signal_strength= adapter->recvpriv.signal_strength_dbg; -+ adapter->recvpriv.rssi=(s8)translate_percentage_to_dbm((u8)adapter->recvpriv.signal_strength_dbg); -+ } else { -+ -+ if(recvpriv->signal_strength_data.update_req == 0) {// update_req is clear, means we got rx -+ avg_signal_strength = recvpriv->signal_strength_data.avg_val; -+ num_signal_strength = recvpriv->signal_strength_data.total_num; -+ // after avg_vals are accquired, we can re-stat the signal values -+ recvpriv->signal_strength_data.update_req = 1; -+ } -+ -+ if(recvpriv->signal_qual_data.update_req == 0) {// update_req is clear, means we got rx -+ avg_signal_qual = recvpriv->signal_qual_data.avg_val; -+ num_signal_qual = recvpriv->signal_qual_data.total_num; -+ // after avg_vals are accquired, we can re-stat the signal values -+ recvpriv->signal_qual_data.update_req = 1; -+ } -+ -+ //update value of signal_strength, rssi, signal_qual -+ if(check_fwstate(&adapter->mlmepriv, _FW_UNDER_SURVEY) == false) { -+ tmp_s = (avg_signal_strength+(_alpha-1)*recvpriv->signal_strength); -+ if(tmp_s %_alpha) -+ tmp_s = tmp_s/_alpha + 1; -+ else -+ tmp_s = tmp_s/_alpha; -+ if(tmp_s>100) -+ tmp_s = 100; -+ -+ tmp_q = (avg_signal_qual+(_alpha-1)*recvpriv->signal_qual); -+ if(tmp_q %_alpha) -+ tmp_q = tmp_q/_alpha + 1; -+ else -+ tmp_q = tmp_q/_alpha; -+ if(tmp_q>100) -+ tmp_q = 100; -+ -+ recvpriv->signal_strength = tmp_s; -+ recvpriv->rssi = (s8)translate_percentage_to_dbm(tmp_s); -+ recvpriv->signal_qual = tmp_q; -+ -+ #if defined(DBG_RX_SIGNAL_DISPLAY_PROCESSING) && 1 -+ DBG_871X("%s signal_strength:%3u, rssi:%3d, signal_qual:%3u" -+ ", num_signal_strength:%u, num_signal_qual:%u" -+ "\n" -+ , __FUNCTION__ -+ , recvpriv->signal_strength -+ , recvpriv->rssi -+ , recvpriv->signal_qual -+ , num_signal_strength, num_signal_qual -+ ); -+ #endif -+ } -+ } -+ rtw_set_signal_stat_timer(recvpriv); -+ -+} -+#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_rf.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_rf.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_rf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_rf.c 2018-02-06 17:42:30.699967001 +0200 -@@ -0,0 +1,85 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_RF_C_ -+ -+#include -+ -+ -+struct ch_freq { -+ u32 channel; -+ u32 frequency; -+}; -+ -+struct ch_freq ch_freq_map[] = { -+ {1, 2412},{2, 2417},{3, 2422},{4, 2427},{5, 2432}, -+ {6, 2437},{7, 2442},{8, 2447},{9, 2452},{10, 2457}, -+ {11, 2462},{12, 2467},{13, 2472},{14, 2484}, -+ /* UNII */ -+ {36, 5180},{40, 5200},{44, 5220},{48, 5240},{52, 5260}, -+ {56, 5280},{60, 5300},{64, 5320},{149, 5745},{153, 5765}, -+ {157, 5785},{161, 5805},{165, 5825},{167, 5835},{169, 5845}, -+ {171, 5855},{173, 5865}, -+ /* HiperLAN2 */ -+ {100, 5500},{104, 5520},{108, 5540},{112, 5560},{116, 5580}, -+ {120, 5600},{124, 5620},{128, 5640},{132, 5660},{136, 5680}, -+ {140, 5700}, -+ /* Japan MMAC */ -+ {34, 5170},{38, 5190},{42, 5210},{46, 5230}, -+ /* Japan */ -+ {184, 4920},{188, 4940},{192, 4960},{196, 4980}, -+ {208, 5040},/* Japan, means J08 */ -+ {212, 5060},/* Japan, means J12 */ -+ {216, 5080},/* Japan, means J16 */ -+}; -+ -+int ch_freq_map_num = (sizeof(ch_freq_map) / sizeof(struct ch_freq)); -+ -+u32 rtw_ch2freq(u32 channel) -+{ -+ u8 i; -+ u32 freq = 0; -+ -+ for (i = 0; i < ch_freq_map_num; i++) -+ { -+ if (channel == ch_freq_map[i].channel) -+ { -+ freq = ch_freq_map[i].frequency; -+ break; -+ } -+ } -+ if (i == ch_freq_map_num) -+ freq = 2412; -+ -+ return freq; -+} -+ -+u32 rtw_freq2ch(u32 freq) -+{ -+ u8 i; -+ u32 ch = 0; -+ -+ for (i = 0; i < ch_freq_map_num; i++) -+ { -+ if (freq == ch_freq_map[i].frequency) -+ { -+ ch = ch_freq_map[i].channel; -+ break; -+ } -+ } -+ if (i == ch_freq_map_num) -+ ch = 1; -+ -+ return ch; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_security.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_security.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_security.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_security.c 2018-02-06 17:42:30.699967001 +0200 -@@ -0,0 +1,2864 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_SECURITY_C_ -+ -+#include -+ -+ -+//=====WEP related===== -+ -+#define CRC32_POLY 0x04c11db7 -+ -+struct arc4context -+{ -+ u32 x; -+ u32 y; -+ u8 state[256]; -+}; -+ -+ -+static void arcfour_init(struct arc4context *parc4ctx, u8 * key,u32 key_len) -+{ -+ u32 t, u; -+ u32 keyindex; -+ u32 stateindex; -+ u8 * state; -+ u32 counter; -+ -+ state = parc4ctx->state; -+ parc4ctx->x = 0; -+ parc4ctx->y = 0; -+ for (counter = 0; counter < 256; counter++) -+ state[counter] = (u8)counter; -+ keyindex = 0; -+ stateindex = 0; -+ for (counter = 0; counter < 256; counter++) -+ { -+ t = state[counter]; -+ stateindex = (stateindex + key[keyindex] + t) & 0xff; -+ u = state[stateindex]; -+ state[stateindex] = (u8)t; -+ state[counter] = (u8)u; -+ if (++keyindex >= key_len) -+ keyindex = 0; -+ } -+ -+} -+static u32 arcfour_byte( struct arc4context *parc4ctx) -+{ -+ u32 x; -+ u32 y; -+ u32 sx, sy; -+ u8 * state; -+ -+ state = parc4ctx->state; -+ x = (parc4ctx->x + 1) & 0xff; -+ sx = state[x]; -+ y = (sx + parc4ctx->y) & 0xff; -+ sy = state[y]; -+ parc4ctx->x = x; -+ parc4ctx->y = y; -+ state[y] = (u8)sx; -+ state[x] = (u8)sy; -+ -+ return state[(sx + sy) & 0xff]; -+} -+ -+ -+static void arcfour_encrypt( struct arc4context *parc4ctx, -+ u8 * dest, -+ u8 * src, -+ u32 len) -+{ -+ u32 i; -+ -+ for (i = 0; i < len; i++) -+ dest[i] = src[i] ^ (unsigned char)arcfour_byte(parc4ctx); -+ -+} -+ -+static sint bcrc32initialized = 0; -+static u32 crc32_table[256]; -+ -+ -+static u8 crc32_reverseBit( u8 data) -+{ -+ return( (u8)((data<<7)&0x80) | ((data<<5)&0x40) | ((data<<3)&0x20) | ((data<<1)&0x10) | ((data>>1)&0x08) | ((data>>3)&0x04) | ((data>>5)&0x02) | ((data>>7)&0x01) ); -+} -+ -+static void crc32_init(void) -+{ -+ -+ if (bcrc32initialized == 1) -+ return; -+ else{ -+ sint i, j; -+ u32 c; -+ u8 *p=(u8 *)&c, *p1; -+ u8 k; -+ -+ c = 0x12340000; -+ -+ for (i = 0; i < 256; ++i) -+ { -+ k = crc32_reverseBit((u8)i); -+ for (c = ((u32)k) << 24, j = 8; j > 0; --j){ -+ c = c & 0x80000000 ? (c << 1) ^ CRC32_POLY : (c << 1); -+ } -+ p1 = (u8 *)&crc32_table[i]; -+ -+ p1[0] = crc32_reverseBit(p[3]); -+ p1[1] = crc32_reverseBit(p[2]); -+ p1[2] = crc32_reverseBit(p[1]); -+ p1[3] = crc32_reverseBit(p[0]); -+ } -+ bcrc32initialized= 1; -+ } -+} -+ -+static __le32 getcrc32(u8 *buf, sint len) -+{ -+ u8 *p; -+ u32 crc; -+ -+ if (bcrc32initialized == 0) -+ crc32_init(); -+ -+ crc = 0xffffffff; /* preload shift register, per CRC-32 spec */ -+ -+ for (p = buf; len > 0; ++p, --len) -+ crc = crc32_table[(crc ^ *p) & 0xff] ^ (crc >> 8); -+ -+ return cpu_to_le32(~crc); /* transmit complement, per CRC-32 spec */ -+} -+ -+/* -+ Need to consider the fragment situation -+*/ -+void rtw_wep_encrypt(_adapter *padapter, u8 *pxmitframe) -+{ // exclude ICV -+ -+ unsigned char crc[4]; -+ struct arc4context mycontext; -+ -+ sint curfragnum,length; -+ u32 keylength; -+ -+ u8 *pframe, *payload,*iv; //,*wepkey -+ u8 wepkey[16]; -+ u8 hw_hdr_offset=0; -+ struct pkt_attrib *pattrib = &((struct xmit_frame*)pxmitframe)->attrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; -+ struct xmit_priv *pxmitpriv=&padapter->xmitpriv; -+ -+ -+ -+ -+ if(((struct xmit_frame*)pxmitframe)->buf_addr==NULL) -+ return; -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ hw_hdr_offset = TXDESC_SIZE + -+ (((struct xmit_frame*)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); -+#else -+ #ifdef CONFIG_TX_EARLY_MODE -+ hw_hdr_offset = TXDESC_OFFSET+EARLY_MODE_INFO_SIZE; -+ #else -+ hw_hdr_offset = TXDESC_OFFSET; -+ #endif -+#endif -+ -+ pframe = ((struct xmit_frame*)pxmitframe)->buf_addr + hw_hdr_offset; -+ -+ //start to encrypt each fragment -+ if((pattrib->encrypt==_WEP40_)||(pattrib->encrypt==_WEP104_)) -+ { -+ keylength=psecuritypriv->dot11DefKeylen[psecuritypriv->dot11PrivacyKeyIndex]; -+ -+ for(curfragnum=0;curfragnumnr_frags;curfragnum++) -+ { -+ iv=pframe+pattrib->hdrlen; -+ _rtw_memcpy(&wepkey[0], iv, 3); -+ _rtw_memcpy(&wepkey[3], &psecuritypriv->dot11DefKey[psecuritypriv->dot11PrivacyKeyIndex].skey[0],keylength); -+ payload=pframe+pattrib->iv_len+pattrib->hdrlen; -+ -+ if((curfragnum+1)==pattrib->nr_frags) -+ { //the last fragment -+ -+ length=pattrib->last_txcmdsz-pattrib->hdrlen-pattrib->iv_len- pattrib->icv_len; -+ -+ *((u32 *)crc)=le32_to_cpu(getcrc32(payload,length)); -+ -+ arcfour_init(&mycontext, wepkey,3+keylength); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ arcfour_encrypt(&mycontext, payload+length, crc, 4); -+ -+ } -+ else -+ { -+ length=pxmitpriv->frag_len-pattrib->hdrlen-pattrib->iv_len-pattrib->icv_len ; -+ *((u32 *)crc)=le32_to_cpu(getcrc32(payload,length)); -+ arcfour_init(&mycontext, wepkey,3+keylength); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ arcfour_encrypt(&mycontext, payload+length, crc, 4); -+ -+ pframe+=pxmitpriv->frag_len; -+ pframe=(u8 *)RND4((SIZE_PTR)(pframe)); -+ -+ } -+ -+ } -+ -+ } -+ -+ -+ -+} -+ -+void rtw_wep_decrypt(_adapter *padapter, u8 *precvframe) -+{ -+ // exclude ICV -+ u8 crc[4]; -+ struct arc4context mycontext; -+ sint length; -+ u32 keylength; -+ u8 *pframe, *payload,*iv,wepkey[16]; -+ u8 keyindex; -+ struct rx_pkt_attrib *prxattrib = &(((union recv_frame*)precvframe)->u.hdr.attrib); -+ struct security_priv *psecuritypriv=&padapter->securitypriv; -+ -+ -+ -+ pframe=(unsigned char *)((union recv_frame*)precvframe)->u.hdr.rx_data; -+ -+ //start to decrypt recvframe -+ if((prxattrib->encrypt==_WEP40_)||(prxattrib->encrypt==_WEP104_)) -+ { -+ iv=pframe+prxattrib->hdrlen; -+ //keyindex=(iv[3]&0x3); -+ keyindex = prxattrib->key_index; -+ keylength=psecuritypriv->dot11DefKeylen[keyindex]; -+ _rtw_memcpy(&wepkey[0], iv, 3); -+ //_rtw_memcpy(&wepkey[3], &psecuritypriv->dot11DefKey[psecuritypriv->dot11PrivacyKeyIndex].skey[0],keylength); -+ _rtw_memcpy(&wepkey[3], &psecuritypriv->dot11DefKey[keyindex].skey[0],keylength); -+ length= ((union recv_frame *)precvframe)->u.hdr.len-prxattrib->hdrlen-prxattrib->iv_len; -+ -+ payload=pframe+prxattrib->iv_len+prxattrib->hdrlen; -+ -+ //decrypt payload include icv -+ arcfour_init(&mycontext, wepkey,3+keylength); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ -+ //calculate icv and compare the icv -+ *((u32 *)crc)=le32_to_cpu(getcrc32(payload,length-4)); -+ -+ if(crc[3]!=payload[length-1] || crc[2]!=payload[length-2] || crc[1]!=payload[length-3] || crc[0]!=payload[length-4]) -+ { -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_wep_decrypt:icv error crc[3](%x)!=payload[length-1](%x) || crc[2](%x)!=payload[length-2](%x) || crc[1](%x)!=payload[length-3](%x) || crc[0](%x)!=payload[length-4](%x)\n", -+ crc[3],payload[length-1],crc[2],payload[length-2],crc[1],payload[length-3],crc[0],payload[length-4])); -+ } -+ -+ } -+ -+ -+ -+ return; -+ -+} -+ -+//3 =====TKIP related===== -+ -+static u32 secmicgetuint32( u8 * p ) -+// Convert from Byte[] to Us4Byte32 in a portable way -+{ -+ s32 i; -+ u32 res = 0; -+ -+ for( i=0; i<4; i++ ) -+ { -+ res |= ((u32)(*p++)) << (8*i); -+ } -+ -+ return res; -+} -+ -+static void secmicputuint32( u8 * p, u32 val ) -+// Convert from Us4Byte32 to Byte[] in a portable way -+{ -+ long i; -+ -+ for( i=0; i<4; i++ ) -+ { -+ *p++ = (u8) (val & 0xff); -+ val >>= 8; -+ } -+ -+} -+ -+static void secmicclear(struct mic_data *pmicdata) -+{ -+// Reset the state to the empty message. -+ -+ pmicdata->L = pmicdata->K0; -+ pmicdata->R = pmicdata->K1; -+ pmicdata->nBytesInM = 0; -+ pmicdata->M = 0; -+ -+} -+ -+void rtw_secmicsetkey(struct mic_data *pmicdata, u8 * key ) -+{ -+ // Set the key -+ -+ pmicdata->K0 = secmicgetuint32( key ); -+ pmicdata->K1 = secmicgetuint32( key + 4 ); -+ // and reset the message -+ secmicclear(pmicdata); -+ -+} -+ -+void rtw_secmicappendbyte(struct mic_data *pmicdata, u8 b ) -+{ -+ -+ // Append the byte to our word-sized buffer -+ pmicdata->M |= ((unsigned long)b) << (8*pmicdata->nBytesInM); -+ pmicdata->nBytesInM++; -+ // Process the word if it is full. -+ if( pmicdata->nBytesInM >= 4 ) -+ { -+ pmicdata->L ^= pmicdata->M; -+ pmicdata->R ^= ROL32( pmicdata->L, 17 ); -+ pmicdata->L += pmicdata->R; -+ pmicdata->R ^= ((pmicdata->L & 0xff00ff00) >> 8) | ((pmicdata->L & 0x00ff00ff) << 8); -+ pmicdata->L += pmicdata->R; -+ pmicdata->R ^= ROL32( pmicdata->L, 3 ); -+ pmicdata->L += pmicdata->R; -+ pmicdata->R ^= ROR32( pmicdata->L, 2 ); -+ pmicdata->L += pmicdata->R; -+ // Clear the buffer -+ pmicdata->M = 0; -+ pmicdata->nBytesInM = 0; -+ } -+ -+} -+ -+void rtw_secmicappend(struct mic_data *pmicdata, u8 * src, u32 nbytes ) -+{ -+ -+ // This is simple -+ while( nbytes > 0 ) -+ { -+ rtw_secmicappendbyte(pmicdata, *src++ ); -+ nbytes--; -+ } -+ -+} -+ -+void rtw_secgetmic(struct mic_data *pmicdata, u8 * dst ) -+{ -+ -+ // Append the minimum padding -+ rtw_secmicappendbyte(pmicdata, 0x5a ); -+ rtw_secmicappendbyte(pmicdata, 0 ); -+ rtw_secmicappendbyte(pmicdata, 0 ); -+ rtw_secmicappendbyte(pmicdata, 0 ); -+ rtw_secmicappendbyte(pmicdata, 0 ); -+ // and then zeroes until the length is a multiple of 4 -+ while( pmicdata->nBytesInM != 0 ) -+ { -+ rtw_secmicappendbyte(pmicdata, 0 ); -+ } -+ // The appendByte function has already computed the result. -+ secmicputuint32( dst, pmicdata->L ); -+ secmicputuint32( dst+4, pmicdata->R ); -+ // Reset to the empty message. -+ secmicclear(pmicdata); -+ -+} -+ -+ -+void rtw_seccalctkipmic(u8 * key,u8 *header,u8 *data,u32 data_len,u8 *mic_code, u8 pri) -+{ -+ -+ struct mic_data micdata; -+ u8 priority[4]={0x0,0x0,0x0,0x0}; -+ -+ rtw_secmicsetkey(&micdata, key); -+ priority[0]=pri; -+ -+ /* Michael MIC pseudo header: DA, SA, 3 x 0, Priority */ -+ if(header[1]&1){ //ToDS==1 -+ rtw_secmicappend(&micdata, &header[16], 6); //DA -+ if(header[1]&2) //From Ds==1 -+ rtw_secmicappend(&micdata, &header[24], 6); -+ else -+ rtw_secmicappend(&micdata, &header[10], 6); -+ } -+ else{ //ToDS==0 -+ rtw_secmicappend(&micdata, &header[4], 6); //DA -+ if(header[1]&2) //From Ds==1 -+ rtw_secmicappend(&micdata, &header[16], 6); -+ else -+ rtw_secmicappend(&micdata, &header[10], 6); -+ -+ } -+ rtw_secmicappend(&micdata, &priority[0], 4); -+ -+ -+ rtw_secmicappend(&micdata, data, data_len); -+ -+ rtw_secgetmic(&micdata,mic_code); -+ -+} -+ -+ -+ -+ -+/* macros for extraction/creation of unsigned char/unsigned short values */ -+#define RotR1(v16) ((((v16) >> 1) & 0x7FFF) ^ (((v16) & 1) << 15)) -+#define Lo8(v16) ((u8)( (v16) & 0x00FF)) -+#define Hi8(v16) ((u8)(((v16) >> 8) & 0x00FF)) -+#define Lo16(v32) ((u16)( (v32) & 0xFFFF)) -+#define Hi16(v32) ((u16)(((v32) >>16) & 0xFFFF)) -+#define Mk16(hi,lo) ((lo) ^ (((u16)(hi)) << 8)) -+ -+/* select the Nth 16-bit word of the temporal key unsigned char array TK[] */ -+#define TK16(N) Mk16(tk[2*(N)+1],tk[2*(N)]) -+ -+/* S-box lookup: 16 bits --> 16 bits */ -+#define _S_(v16) (Sbox1[0][Lo8(v16)] ^ Sbox1[1][Hi8(v16)]) -+ -+/* fixed algorithm "parameters" */ -+#define PHASE1_LOOP_CNT 8 /* this needs to be "big enough" */ -+#define TA_SIZE 6 /* 48-bit transmitter address */ -+#define TK_SIZE 16 /* 128-bit temporal key */ -+#define P1K_SIZE 10 /* 80-bit Phase1 key */ -+#define RC4_KEY_SIZE 16 /* 128-bit RC4KEY (104 bits unknown) */ -+ -+ -+/* 2-unsigned char by 2-unsigned char subset of the full AES S-box table */ -+static const unsigned short Sbox1[2][256]= /* Sbox for hash (can be in ROM) */ -+{ { -+ 0xC6A5,0xF884,0xEE99,0xF68D,0xFF0D,0xD6BD,0xDEB1,0x9154, -+ 0x6050,0x0203,0xCEA9,0x567D,0xE719,0xB562,0x4DE6,0xEC9A, -+ 0x8F45,0x1F9D,0x8940,0xFA87,0xEF15,0xB2EB,0x8EC9,0xFB0B, -+ 0x41EC,0xB367,0x5FFD,0x45EA,0x23BF,0x53F7,0xE496,0x9B5B, -+ 0x75C2,0xE11C,0x3DAE,0x4C6A,0x6C5A,0x7E41,0xF502,0x834F, -+ 0x685C,0x51F4,0xD134,0xF908,0xE293,0xAB73,0x6253,0x2A3F, -+ 0x080C,0x9552,0x4665,0x9D5E,0x3028,0x37A1,0x0A0F,0x2FB5, -+ 0x0E09,0x2436,0x1B9B,0xDF3D,0xCD26,0x4E69,0x7FCD,0xEA9F, -+ 0x121B,0x1D9E,0x5874,0x342E,0x362D,0xDCB2,0xB4EE,0x5BFB, -+ 0xA4F6,0x764D,0xB761,0x7DCE,0x527B,0xDD3E,0x5E71,0x1397, -+ 0xA6F5,0xB968,0x0000,0xC12C,0x4060,0xE31F,0x79C8,0xB6ED, -+ 0xD4BE,0x8D46,0x67D9,0x724B,0x94DE,0x98D4,0xB0E8,0x854A, -+ 0xBB6B,0xC52A,0x4FE5,0xED16,0x86C5,0x9AD7,0x6655,0x1194, -+ 0x8ACF,0xE910,0x0406,0xFE81,0xA0F0,0x7844,0x25BA,0x4BE3, -+ 0xA2F3,0x5DFE,0x80C0,0x058A,0x3FAD,0x21BC,0x7048,0xF104, -+ 0x63DF,0x77C1,0xAF75,0x4263,0x2030,0xE51A,0xFD0E,0xBF6D, -+ 0x814C,0x1814,0x2635,0xC32F,0xBEE1,0x35A2,0x88CC,0x2E39, -+ 0x9357,0x55F2,0xFC82,0x7A47,0xC8AC,0xBAE7,0x322B,0xE695, -+ 0xC0A0,0x1998,0x9ED1,0xA37F,0x4466,0x547E,0x3BAB,0x0B83, -+ 0x8CCA,0xC729,0x6BD3,0x283C,0xA779,0xBCE2,0x161D,0xAD76, -+ 0xDB3B,0x6456,0x744E,0x141E,0x92DB,0x0C0A,0x486C,0xB8E4, -+ 0x9F5D,0xBD6E,0x43EF,0xC4A6,0x39A8,0x31A4,0xD337,0xF28B, -+ 0xD532,0x8B43,0x6E59,0xDAB7,0x018C,0xB164,0x9CD2,0x49E0, -+ 0xD8B4,0xACFA,0xF307,0xCF25,0xCAAF,0xF48E,0x47E9,0x1018, -+ 0x6FD5,0xF088,0x4A6F,0x5C72,0x3824,0x57F1,0x73C7,0x9751, -+ 0xCB23,0xA17C,0xE89C,0x3E21,0x96DD,0x61DC,0x0D86,0x0F85, -+ 0xE090,0x7C42,0x71C4,0xCCAA,0x90D8,0x0605,0xF701,0x1C12, -+ 0xC2A3,0x6A5F,0xAEF9,0x69D0,0x1791,0x9958,0x3A27,0x27B9, -+ 0xD938,0xEB13,0x2BB3,0x2233,0xD2BB,0xA970,0x0789,0x33A7, -+ 0x2DB6,0x3C22,0x1592,0xC920,0x8749,0xAAFF,0x5078,0xA57A, -+ 0x038F,0x59F8,0x0980,0x1A17,0x65DA,0xD731,0x84C6,0xD0B8, -+ 0x82C3,0x29B0,0x5A77,0x1E11,0x7BCB,0xA8FC,0x6DD6,0x2C3A, -+ }, -+ -+ -+ { /* second half of table is unsigned char-reversed version of first! */ -+ 0xA5C6,0x84F8,0x99EE,0x8DF6,0x0DFF,0xBDD6,0xB1DE,0x5491, -+ 0x5060,0x0302,0xA9CE,0x7D56,0x19E7,0x62B5,0xE64D,0x9AEC, -+ 0x458F,0x9D1F,0x4089,0x87FA,0x15EF,0xEBB2,0xC98E,0x0BFB, -+ 0xEC41,0x67B3,0xFD5F,0xEA45,0xBF23,0xF753,0x96E4,0x5B9B, -+ 0xC275,0x1CE1,0xAE3D,0x6A4C,0x5A6C,0x417E,0x02F5,0x4F83, -+ 0x5C68,0xF451,0x34D1,0x08F9,0x93E2,0x73AB,0x5362,0x3F2A, -+ 0x0C08,0x5295,0x6546,0x5E9D,0x2830,0xA137,0x0F0A,0xB52F, -+ 0x090E,0x3624,0x9B1B,0x3DDF,0x26CD,0x694E,0xCD7F,0x9FEA, -+ 0x1B12,0x9E1D,0x7458,0x2E34,0x2D36,0xB2DC,0xEEB4,0xFB5B, -+ 0xF6A4,0x4D76,0x61B7,0xCE7D,0x7B52,0x3EDD,0x715E,0x9713, -+ 0xF5A6,0x68B9,0x0000,0x2CC1,0x6040,0x1FE3,0xC879,0xEDB6, -+ 0xBED4,0x468D,0xD967,0x4B72,0xDE94,0xD498,0xE8B0,0x4A85, -+ 0x6BBB,0x2AC5,0xE54F,0x16ED,0xC586,0xD79A,0x5566,0x9411, -+ 0xCF8A,0x10E9,0x0604,0x81FE,0xF0A0,0x4478,0xBA25,0xE34B, -+ 0xF3A2,0xFE5D,0xC080,0x8A05,0xAD3F,0xBC21,0x4870,0x04F1, -+ 0xDF63,0xC177,0x75AF,0x6342,0x3020,0x1AE5,0x0EFD,0x6DBF, -+ 0x4C81,0x1418,0x3526,0x2FC3,0xE1BE,0xA235,0xCC88,0x392E, -+ 0x5793,0xF255,0x82FC,0x477A,0xACC8,0xE7BA,0x2B32,0x95E6, -+ 0xA0C0,0x9819,0xD19E,0x7FA3,0x6644,0x7E54,0xAB3B,0x830B, -+ 0xCA8C,0x29C7,0xD36B,0x3C28,0x79A7,0xE2BC,0x1D16,0x76AD, -+ 0x3BDB,0x5664,0x4E74,0x1E14,0xDB92,0x0A0C,0x6C48,0xE4B8, -+ 0x5D9F,0x6EBD,0xEF43,0xA6C4,0xA839,0xA431,0x37D3,0x8BF2, -+ 0x32D5,0x438B,0x596E,0xB7DA,0x8C01,0x64B1,0xD29C,0xE049, -+ 0xB4D8,0xFAAC,0x07F3,0x25CF,0xAFCA,0x8EF4,0xE947,0x1810, -+ 0xD56F,0x88F0,0x6F4A,0x725C,0x2438,0xF157,0xC773,0x5197, -+ 0x23CB,0x7CA1,0x9CE8,0x213E,0xDD96,0xDC61,0x860D,0x850F, -+ 0x90E0,0x427C,0xC471,0xAACC,0xD890,0x0506,0x01F7,0x121C, -+ 0xA3C2,0x5F6A,0xF9AE,0xD069,0x9117,0x5899,0x273A,0xB927, -+ 0x38D9,0x13EB,0xB32B,0x3322,0xBBD2,0x70A9,0x8907,0xA733, -+ 0xB62D,0x223C,0x9215,0x20C9,0x4987,0xFFAA,0x7850,0x7AA5, -+ 0x8F03,0xF859,0x8009,0x171A,0xDA65,0x31D7,0xC684,0xB8D0, -+ 0xC382,0xB029,0x775A,0x111E,0xCB7B,0xFCA8,0xD66D,0x3A2C, -+ } -+}; -+ -+ /* -+********************************************************************** -+* Routine: Phase 1 -- generate P1K, given TA, TK, IV32 -+* -+* Inputs: -+* tk[] = temporal key [128 bits] -+* ta[] = transmitter's MAC address [ 48 bits] -+* iv32 = upper 32 bits of IV [ 32 bits] -+* Output: -+* p1k[] = Phase 1 key [ 80 bits] -+* -+* Note: -+* This function only needs to be called every 2**16 packets, -+* although in theory it could be called every packet. -+* -+********************************************************************** -+*/ -+static void phase1(u16 *p1k,const u8 *tk,const u8 *ta,u32 iv32) -+{ -+ sint i; -+ -+ /* Initialize the 80 bits of P1K[] from IV32 and TA[0..5] */ -+ p1k[0] = Lo16(iv32); -+ p1k[1] = Hi16(iv32); -+ p1k[2] = Mk16(ta[1],ta[0]); /* use TA[] as little-endian */ -+ p1k[3] = Mk16(ta[3],ta[2]); -+ p1k[4] = Mk16(ta[5],ta[4]); -+ -+ /* Now compute an unbalanced Feistel cipher with 80-bit block */ -+ /* size on the 80-bit block P1K[], using the 128-bit key TK[] */ -+ for (i=0; i < PHASE1_LOOP_CNT ;i++) -+ { /* Each add operation here is mod 2**16 */ -+ p1k[0] += _S_(p1k[4] ^ TK16((i&1)+0)); -+ p1k[1] += _S_(p1k[0] ^ TK16((i&1)+2)); -+ p1k[2] += _S_(p1k[1] ^ TK16((i&1)+4)); -+ p1k[3] += _S_(p1k[2] ^ TK16((i&1)+6)); -+ p1k[4] += _S_(p1k[3] ^ TK16((i&1)+0)); -+ p1k[4] += (unsigned short)i; /* avoid "slide attacks" */ -+ } -+ -+} -+ -+ -+/* -+********************************************************************** -+* Routine: Phase 2 -- generate RC4KEY, given TK, P1K, IV16 -+* -+* Inputs: -+* tk[] = Temporal key [128 bits] -+* p1k[] = Phase 1 output key [ 80 bits] -+* iv16 = low 16 bits of IV counter [ 16 bits] -+* Output: -+* rc4key[] = the key used to encrypt the packet [128 bits] -+* -+* Note: -+* The value {TA,IV32,IV16} for Phase1/Phase2 must be unique -+* across all packets using the same key TK value. Then, for a -+* given value of TK[], this TKIP48 construction guarantees that -+* the final RC4KEY value is unique across all packets. -+* -+* Suggested implementation optimization: if PPK[] is "overlaid" -+* appropriately on RC4KEY[], there is no need for the final -+* for loop below that copies the PPK[] result into RC4KEY[]. -+* -+********************************************************************** -+*/ -+static void phase2(u8 *rc4key,const u8 *tk,const u16 *p1k,u16 iv16) -+{ -+ sint i; -+ u16 PPK[6]; /* temporary key for mixing */ -+ -+ /* Note: all adds in the PPK[] equations below are mod 2**16 */ -+ for (i=0;i<5;i++) PPK[i]=p1k[i]; /* first, copy P1K to PPK */ -+ PPK[5] = p1k[4] +iv16; /* next, add in IV16 */ -+ -+ /* Bijective non-linear mixing of the 96 bits of PPK[0..5] */ -+ PPK[0] += _S_(PPK[5] ^ TK16(0)); /* Mix key in each "round" */ -+ PPK[1] += _S_(PPK[0] ^ TK16(1)); -+ PPK[2] += _S_(PPK[1] ^ TK16(2)); -+ PPK[3] += _S_(PPK[2] ^ TK16(3)); -+ PPK[4] += _S_(PPK[3] ^ TK16(4)); -+ PPK[5] += _S_(PPK[4] ^ TK16(5)); /* Total # S-box lookups == 6 */ -+ -+ /* Final sweep: bijective, "linear". Rotates kill LSB correlations */ -+ PPK[0] += RotR1(PPK[5] ^ TK16(6)); -+ PPK[1] += RotR1(PPK[0] ^ TK16(7)); /* Use all of TK[] in Phase2 */ -+ PPK[2] += RotR1(PPK[1]); -+ PPK[3] += RotR1(PPK[2]); -+ PPK[4] += RotR1(PPK[3]); -+ PPK[5] += RotR1(PPK[4]); -+ /* Note: At this point, for a given key TK[0..15], the 96-bit output */ -+ /* value PPK[0..5] is guaranteed to be unique, as a function */ -+ /* of the 96-bit "input" value {TA,IV32,IV16}. That is, P1K */ -+ /* is now a keyed permutation of {TA,IV32,IV16}. */ -+ -+ /* Set RC4KEY[0..3], which includes "cleartext" portion of RC4 key */ -+ rc4key[0] = Hi8(iv16); /* RC4KEY[0..2] is the WEP IV */ -+ rc4key[1] =(Hi8(iv16) | 0x20) & 0x7F; /* Help avoid weak (FMS) keys */ -+ rc4key[2] = Lo8(iv16); -+ rc4key[3] = Lo8((PPK[5] ^ TK16(0)) >> 1); -+ -+ -+ /* Copy 96 bits of PPK[0..5] to RC4KEY[4..15] (little-endian) */ -+ for (i=0;i<6;i++) -+ { -+ rc4key[4+2*i] = Lo8(PPK[i]); -+ rc4key[5+2*i] = Hi8(PPK[i]); -+ } -+ -+} -+ -+ -+//The hlen isn't include the IV -+u32 rtw_tkip_encrypt(_adapter *padapter, u8 *pxmitframe) -+{ // exclude ICV -+ u16 pnl; -+ u32 pnh; -+ u8 rc4key[16]; -+ u8 ttkey[16]; -+ u8 crc[4]; -+ u8 hw_hdr_offset = 0; -+ struct arc4context mycontext; -+ sint curfragnum,length; -+ u32 prwskeylen; -+ -+ u8 *pframe, *payload,*iv,*prwskey; -+ union pn48 dot11txpn; -+ //struct sta_info *stainfo; -+ struct pkt_attrib *pattrib = &((struct xmit_frame *)pxmitframe)->attrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; -+ struct xmit_priv *pxmitpriv=&padapter->xmitpriv; -+ u32 res=_SUCCESS; -+ -+ -+ if(((struct xmit_frame*)pxmitframe)->buf_addr==NULL) -+ return _FAIL; -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ hw_hdr_offset = TXDESC_SIZE + -+ (((struct xmit_frame*)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); -+#else -+ #ifdef CONFIG_TX_EARLY_MODE -+ hw_hdr_offset = TXDESC_OFFSET+EARLY_MODE_INFO_SIZE; -+ #else -+ hw_hdr_offset = TXDESC_OFFSET; -+ #endif -+#endif -+ -+ pframe = ((struct xmit_frame*)pxmitframe)->buf_addr + hw_hdr_offset; -+ //4 start to encrypt each fragment -+ if(pattrib->encrypt==_TKIP_){ -+ -+/* -+ if(pattrib->psta) -+ { -+ stainfo = pattrib->psta; -+ } -+ else -+ { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ stainfo=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0] ); -+ } -+*/ -+ //if (stainfo!=NULL) -+ { -+/* -+ if(!(stainfo->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, stainfo->state); -+ return _FAIL; -+ } -+*/ -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_tkip_encrypt: stainfo!=NULL!!!\n")); -+ -+ if(IS_MCAST(pattrib->ra)) -+ { -+ prwskey=psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; -+ } -+ else -+ { -+ //prwskey=&stainfo->dot118021x_UncstKey.skey[0]; -+ prwskey=pattrib->dot118021x_UncstKey.skey; -+ } -+ -+ prwskeylen=16; -+ -+ for(curfragnum=0;curfragnumnr_frags;curfragnum++){ -+ iv=pframe+pattrib->hdrlen; -+ payload=pframe+pattrib->iv_len+pattrib->hdrlen; -+ -+ GET_TKIP_PN(iv, dot11txpn); -+ -+ pnl=(u16)(dot11txpn.val); -+ pnh=(u32)(dot11txpn.val>>16); -+ -+ phase1((u16 *)&ttkey[0],prwskey,&pattrib->ta[0],pnh); -+ -+ phase2(&rc4key[0],prwskey,(u16 *)&ttkey[0],pnl); -+ -+ if((curfragnum+1)==pattrib->nr_frags){ //4 the last fragment -+ length=pattrib->last_txcmdsz-pattrib->hdrlen-pattrib->iv_len- pattrib->icv_len; -+ RT_TRACE(_module_rtl871x_security_c_,_drv_info_,("pattrib->iv_len =%x, pattrib->icv_len =%x\n", pattrib->iv_len,pattrib->icv_len)); -+ *((u32 *)crc)=le32_to_cpu(getcrc32(payload,length));/* modified by Amy*/ -+ -+ arcfour_init(&mycontext, rc4key,16); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ arcfour_encrypt(&mycontext, payload+length, crc, 4); -+ -+ } -+ else{ -+ length=pxmitpriv->frag_len-pattrib->hdrlen-pattrib->iv_len-pattrib->icv_len ; -+ *((u32 *)crc)=le32_to_cpu(getcrc32(payload,length));/* modified by Amy*/ -+ arcfour_init(&mycontext,rc4key,16); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ arcfour_encrypt(&mycontext, payload+length, crc, 4); -+ -+ pframe+=pxmitpriv->frag_len; -+ pframe=(u8 *)RND4((SIZE_PTR)(pframe)); -+ -+ } -+ } -+ -+ -+ } -+/* -+ else{ -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_tkip_encrypt: stainfo==NULL!!!\n")); -+ DBG_871X("%s, psta==NUL\n", __func__); -+ res=_FAIL; -+ } -+*/ -+ -+ } -+ -+ return res; -+ -+} -+ -+ -+//The hlen isn't include the IV -+u32 rtw_tkip_decrypt(_adapter *padapter, u8 *precvframe) -+{ // exclude ICV -+ u16 pnl; -+ u32 pnh; -+ u8 rc4key[16]; -+ u8 ttkey[16]; -+ u8 crc[4]; -+ struct arc4context mycontext; -+ sint length; -+ u32 prwskeylen; -+ -+ u8 *pframe, *payload,*iv,*prwskey; -+ union pn48 dot11txpn; -+ struct sta_info *stainfo; -+ struct rx_pkt_attrib *prxattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; -+// struct recv_priv *precvpriv=&padapter->recvpriv; -+ u32 res=_SUCCESS; -+ -+ -+ -+ pframe=(unsigned char *)((union recv_frame*)precvframe)->u.hdr.rx_data; -+ -+ //4 start to decrypt recvframe -+ if(prxattrib->encrypt==_TKIP_){ -+ -+ stainfo=rtw_get_stainfo(&padapter->stapriv ,&prxattrib->ta[0] ); -+ if (stainfo!=NULL){ -+ -+ if(IS_MCAST(prxattrib->ra)) -+ { -+ if(psecuritypriv->binstallGrpkey==false) -+ { -+ res=_FAIL; -+ DBG_8192C("%s:rx bc/mc packets,but didn't install group key!!!!!!!!!!\n",__FUNCTION__); -+ goto exit; -+ } -+ //DBG_871X("rx bc/mc packets, to perform sw rtw_tkip_decrypt\n"); -+ //prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; -+ prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; -+ prwskeylen=16; -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_tkip_decrypt: stainfo!=NULL!!!\n")); -+ prwskey=&stainfo->dot118021x_UncstKey.skey[0]; -+ prwskeylen=16; -+ } -+ -+ iv=pframe+prxattrib->hdrlen; -+ payload=pframe+prxattrib->iv_len+prxattrib->hdrlen; -+ length= ((union recv_frame *)precvframe)->u.hdr.len-prxattrib->hdrlen-prxattrib->iv_len; -+ -+ GET_TKIP_PN(iv, dot11txpn); -+ -+ pnl=(u16)(dot11txpn.val); -+ pnh=(u32)(dot11txpn.val>>16); -+ -+ phase1((u16 *)&ttkey[0],prwskey,&prxattrib->ta[0],pnh); -+ phase2(&rc4key[0],prwskey,(unsigned short *)&ttkey[0],pnl); -+ -+ //4 decrypt payload include icv -+ -+ arcfour_init(&mycontext, rc4key,16); -+ arcfour_encrypt(&mycontext, payload, payload, length); -+ -+ *((u32 *)crc)=le32_to_cpu(getcrc32(payload,length-4)); -+ -+ if(crc[3]!=payload[length-1] || crc[2]!=payload[length-2] || crc[1]!=payload[length-3] || crc[0]!=payload[length-4]) -+ { -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_wep_decrypt:icv error crc[3](%x)!=payload[length-1](%x) || crc[2](%x)!=payload[length-2](%x) || crc[1](%x)!=payload[length-3](%x) || crc[0](%x)!=payload[length-4](%x)\n", -+ crc[3],payload[length-1],crc[2],payload[length-2],crc[1],payload[length-3],crc[0],payload[length-4])); -+ res=_FAIL; -+ } -+ -+ -+ } -+ else{ -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_tkip_decrypt: stainfo==NULL!!!\n")); -+ res=_FAIL; -+ } -+ -+ } -+ -+exit: -+ return res; -+ -+} -+ -+ -+//3 =====AES related===== -+ -+ -+ -+#define MAX_MSG_SIZE 2048 -+/*****************************/ -+/******** SBOX Table *********/ -+/*****************************/ -+ -+ static u8 sbox_table[256] = -+ { -+ 0x63, 0x7c, 0x77, 0x7b, 0xf2, 0x6b, 0x6f, 0xc5, -+ 0x30, 0x01, 0x67, 0x2b, 0xfe, 0xd7, 0xab, 0x76, -+ 0xca, 0x82, 0xc9, 0x7d, 0xfa, 0x59, 0x47, 0xf0, -+ 0xad, 0xd4, 0xa2, 0xaf, 0x9c, 0xa4, 0x72, 0xc0, -+ 0xb7, 0xfd, 0x93, 0x26, 0x36, 0x3f, 0xf7, 0xcc, -+ 0x34, 0xa5, 0xe5, 0xf1, 0x71, 0xd8, 0x31, 0x15, -+ 0x04, 0xc7, 0x23, 0xc3, 0x18, 0x96, 0x05, 0x9a, -+ 0x07, 0x12, 0x80, 0xe2, 0xeb, 0x27, 0xb2, 0x75, -+ 0x09, 0x83, 0x2c, 0x1a, 0x1b, 0x6e, 0x5a, 0xa0, -+ 0x52, 0x3b, 0xd6, 0xb3, 0x29, 0xe3, 0x2f, 0x84, -+ 0x53, 0xd1, 0x00, 0xed, 0x20, 0xfc, 0xb1, 0x5b, -+ 0x6a, 0xcb, 0xbe, 0x39, 0x4a, 0x4c, 0x58, 0xcf, -+ 0xd0, 0xef, 0xaa, 0xfb, 0x43, 0x4d, 0x33, 0x85, -+ 0x45, 0xf9, 0x02, 0x7f, 0x50, 0x3c, 0x9f, 0xa8, -+ 0x51, 0xa3, 0x40, 0x8f, 0x92, 0x9d, 0x38, 0xf5, -+ 0xbc, 0xb6, 0xda, 0x21, 0x10, 0xff, 0xf3, 0xd2, -+ 0xcd, 0x0c, 0x13, 0xec, 0x5f, 0x97, 0x44, 0x17, -+ 0xc4, 0xa7, 0x7e, 0x3d, 0x64, 0x5d, 0x19, 0x73, -+ 0x60, 0x81, 0x4f, 0xdc, 0x22, 0x2a, 0x90, 0x88, -+ 0x46, 0xee, 0xb8, 0x14, 0xde, 0x5e, 0x0b, 0xdb, -+ 0xe0, 0x32, 0x3a, 0x0a, 0x49, 0x06, 0x24, 0x5c, -+ 0xc2, 0xd3, 0xac, 0x62, 0x91, 0x95, 0xe4, 0x79, -+ 0xe7, 0xc8, 0x37, 0x6d, 0x8d, 0xd5, 0x4e, 0xa9, -+ 0x6c, 0x56, 0xf4, 0xea, 0x65, 0x7a, 0xae, 0x08, -+ 0xba, 0x78, 0x25, 0x2e, 0x1c, 0xa6, 0xb4, 0xc6, -+ 0xe8, 0xdd, 0x74, 0x1f, 0x4b, 0xbd, 0x8b, 0x8a, -+ 0x70, 0x3e, 0xb5, 0x66, 0x48, 0x03, 0xf6, 0x0e, -+ 0x61, 0x35, 0x57, 0xb9, 0x86, 0xc1, 0x1d, 0x9e, -+ 0xe1, 0xf8, 0x98, 0x11, 0x69, 0xd9, 0x8e, 0x94, -+ 0x9b, 0x1e, 0x87, 0xe9, 0xce, 0x55, 0x28, 0xdf, -+ 0x8c, 0xa1, 0x89, 0x0d, 0xbf, 0xe6, 0x42, 0x68, -+ 0x41, 0x99, 0x2d, 0x0f, 0xb0, 0x54, 0xbb, 0x16 -+ }; -+ -+/*****************************/ -+/**** Function Prototypes ****/ -+/*****************************/ -+ -+static void bitwise_xor(u8 *ina, u8 *inb, u8 *out); -+static void construct_mic_iv( -+ u8 *mic_header1, -+ sint qc_exists, -+ sint a4_exists, -+ u8 *mpdu, -+ uint payload_length, -+ u8 * pn_vector); -+static void construct_mic_header1( -+ u8 *mic_header1, -+ sint header_length, -+ u8 *mpdu); -+static void construct_mic_header2( -+ u8 *mic_header2, -+ u8 *mpdu, -+ sint a4_exists, -+ sint qc_exists); -+static void construct_ctr_preload( -+ u8 *ctr_preload, -+ sint a4_exists, -+ sint qc_exists, -+ u8 *mpdu, -+ u8 *pn_vector, -+ sint c); -+static void xor_128(u8 *a, u8 *b, u8 *out); -+static void xor_32(u8 *a, u8 *b, u8 *out); -+static u8 sbox(u8 a); -+static void next_key(u8 *key, sint round); -+static void byte_sub(u8 *in, u8 *out); -+static void shift_row(u8 *in, u8 *out); -+static void mix_column(u8 *in, u8 *out); -+static void add_round_key( u8 *shiftrow_in, -+ u8 *mcol_in, -+ u8 *block_in, -+ sint round, -+ u8 *out); -+static void aes128k128d(u8 *key, u8 *data, u8 *ciphertext); -+ -+ -+/****************************************/ -+/* aes128k128d() */ -+/* Performs a 128 bit AES encrypt with */ -+/* 128 bit data. */ -+/****************************************/ -+static void xor_128(u8 *a, u8 *b, u8 *out) -+{ -+ sint i; -+ -+ for (i=0;i<16; i++) -+ { -+ out[i] = a[i] ^ b[i]; -+ } -+ -+} -+ -+ -+static void xor_32(u8 *a, u8 *b, u8 *out) -+{ -+ sint i; -+ -+ for (i=0;i<4; i++) -+ { -+ out[i] = a[i] ^ b[i]; -+ } -+ -+} -+ -+ -+static u8 sbox(u8 a) -+{ -+ return sbox_table[(sint)a]; -+} -+ -+ -+static void next_key(u8 *key, sint round) -+{ -+ u8 rcon; -+ u8 sbox_key[4]; -+ u8 rcon_table[12] = -+ { -+ 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, -+ 0x1b, 0x36, 0x36, 0x36 -+ }; -+ -+ sbox_key[0] = sbox(key[13]); -+ sbox_key[1] = sbox(key[14]); -+ sbox_key[2] = sbox(key[15]); -+ sbox_key[3] = sbox(key[12]); -+ -+ rcon = rcon_table[round]; -+ -+ xor_32(&key[0], sbox_key, &key[0]); -+ key[0] = key[0] ^ rcon; -+ -+ xor_32(&key[4], &key[0], &key[4]); -+ xor_32(&key[8], &key[4], &key[8]); -+ xor_32(&key[12], &key[8], &key[12]); -+ -+} -+ -+ -+static void byte_sub(u8 *in, u8 *out) -+{ -+ sint i; -+ -+ for (i=0; i< 16; i++) -+ { -+ out[i] = sbox(in[i]); -+ } -+ -+} -+ -+ -+static void shift_row(u8 *in, u8 *out) -+{ -+ -+ out[0] = in[0]; -+ out[1] = in[5]; -+ out[2] = in[10]; -+ out[3] = in[15]; -+ out[4] = in[4]; -+ out[5] = in[9]; -+ out[6] = in[14]; -+ out[7] = in[3]; -+ out[8] = in[8]; -+ out[9] = in[13]; -+ out[10] = in[2]; -+ out[11] = in[7]; -+ out[12] = in[12]; -+ out[13] = in[1]; -+ out[14] = in[6]; -+ out[15] = in[11]; -+ -+} -+ -+ -+static void mix_column(u8 *in, u8 *out) -+{ -+ sint i; -+ u8 add1b[4]; -+ u8 add1bf7[4]; -+ u8 rotl[4]; -+ u8 swap_halfs[4]; -+ u8 andf7[4]; -+ u8 rotr[4]; -+ u8 temp[4]; -+ u8 tempb[4]; -+ -+ for (i=0 ; i<4; i++) -+ { -+ if ((in[i] & 0x80)== 0x80) -+ add1b[i] = 0x1b; -+ else -+ add1b[i] = 0x00; -+ } -+ -+ swap_halfs[0] = in[2]; /* Swap halfs */ -+ swap_halfs[1] = in[3]; -+ swap_halfs[2] = in[0]; -+ swap_halfs[3] = in[1]; -+ -+ rotl[0] = in[3]; /* Rotate left 8 bits */ -+ rotl[1] = in[0]; -+ rotl[2] = in[1]; -+ rotl[3] = in[2]; -+ -+ andf7[0] = in[0] & 0x7f; -+ andf7[1] = in[1] & 0x7f; -+ andf7[2] = in[2] & 0x7f; -+ andf7[3] = in[3] & 0x7f; -+ -+ for (i = 3; i>0; i--) /* logical shift left 1 bit */ -+ { -+ andf7[i] = andf7[i] << 1; -+ if ((andf7[i-1] & 0x80) == 0x80) -+ { -+ andf7[i] = (andf7[i] | 0x01); -+ } -+ } -+ andf7[0] = andf7[0] << 1; -+ andf7[0] = andf7[0] & 0xfe; -+ -+ xor_32(add1b, andf7, add1bf7); -+ -+ xor_32(in, add1bf7, rotr); -+ -+ temp[0] = rotr[0]; /* Rotate right 8 bits */ -+ rotr[0] = rotr[1]; -+ rotr[1] = rotr[2]; -+ rotr[2] = rotr[3]; -+ rotr[3] = temp[0]; -+ -+ xor_32(add1bf7, rotr, temp); -+ xor_32(swap_halfs, rotl,tempb); -+ xor_32(temp, tempb, out); -+ -+} -+ -+ -+static void aes128k128d(u8 *key, u8 *data, u8 *ciphertext) -+{ -+ sint round; -+ sint i; -+ u8 intermediatea[16]; -+ u8 intermediateb[16]; -+ u8 round_key[16]; -+ -+ for(i=0; i<16; i++) round_key[i] = key[i]; -+ -+ for (round = 0; round < 11; round++) -+ { -+ if (round == 0) -+ { -+ xor_128(round_key, data, ciphertext); -+ next_key(round_key, round); -+ } -+ else if (round == 10) -+ { -+ byte_sub(ciphertext, intermediatea); -+ shift_row(intermediatea, intermediateb); -+ xor_128(intermediateb, round_key, ciphertext); -+ } -+ else /* 1 - 9 */ -+ { -+ byte_sub(ciphertext, intermediatea); -+ shift_row(intermediatea, intermediateb); -+ mix_column(&intermediateb[0], &intermediatea[0]); -+ mix_column(&intermediateb[4], &intermediatea[4]); -+ mix_column(&intermediateb[8], &intermediatea[8]); -+ mix_column(&intermediateb[12], &intermediatea[12]); -+ xor_128(intermediatea, round_key, ciphertext); -+ next_key(round_key, round); -+ } -+ } -+ -+} -+ -+ -+/************************************************/ -+/* construct_mic_iv() */ -+/* Builds the MIC IV from header fields and PN */ -+/************************************************/ -+static void construct_mic_iv( -+ u8 *mic_iv, -+ sint qc_exists, -+ sint a4_exists, -+ u8 *mpdu, -+ uint payload_length, -+ u8 *pn_vector -+ ) -+{ -+ sint i; -+ -+ mic_iv[0] = 0x59; -+ if (qc_exists && a4_exists) mic_iv[1] = mpdu[30] & 0x0f; /* QoS_TC */ -+ if (qc_exists && !a4_exists) mic_iv[1] = mpdu[24] & 0x0f; /* mute bits 7-4 */ -+ if (!qc_exists) mic_iv[1] = 0x00; -+ for (i = 2; i < 8; i++) -+ mic_iv[i] = mpdu[i + 8]; /* mic_iv[2:7] = A2[0:5] = mpdu[10:15] */ -+ #ifdef CONSISTENT_PN_ORDER -+ for (i = 8; i < 14; i++) -+ mic_iv[i] = pn_vector[i - 8]; /* mic_iv[8:13] = PN[0:5] */ -+ #else -+ for (i = 8; i < 14; i++) -+ mic_iv[i] = pn_vector[13 - i]; /* mic_iv[8:13] = PN[5:0] */ -+ #endif -+ mic_iv[14] = (unsigned char) (payload_length / 256); -+ mic_iv[15] = (unsigned char) (payload_length % 256); -+ -+} -+ -+ -+/************************************************/ -+/* construct_mic_header1() */ -+/* Builds the first MIC header block from */ -+/* header fields. */ -+/************************************************/ -+static void construct_mic_header1( -+ u8 *mic_header1, -+ sint header_length, -+ u8 *mpdu -+ ) -+{ -+ -+ mic_header1[0] = (u8)((header_length - 2) / 256); -+ mic_header1[1] = (u8)((header_length - 2) % 256); -+ mic_header1[2] = mpdu[0] & 0xcf; /* Mute CF poll & CF ack bits */ -+ mic_header1[3] = mpdu[1] & 0xc7; /* Mute retry, more data and pwr mgt bits */ -+ mic_header1[4] = mpdu[4]; /* A1 */ -+ mic_header1[5] = mpdu[5]; -+ mic_header1[6] = mpdu[6]; -+ mic_header1[7] = mpdu[7]; -+ mic_header1[8] = mpdu[8]; -+ mic_header1[9] = mpdu[9]; -+ mic_header1[10] = mpdu[10]; /* A2 */ -+ mic_header1[11] = mpdu[11]; -+ mic_header1[12] = mpdu[12]; -+ mic_header1[13] = mpdu[13]; -+ mic_header1[14] = mpdu[14]; -+ mic_header1[15] = mpdu[15]; -+ -+} -+ -+ -+/************************************************/ -+/* construct_mic_header2() */ -+/* Builds the last MIC header block from */ -+/* header fields. */ -+/************************************************/ -+static void construct_mic_header2( -+ u8 *mic_header2, -+ u8 *mpdu, -+ sint a4_exists, -+ sint qc_exists -+ ) -+{ -+ sint i; -+ -+ for (i = 0; i<16; i++) mic_header2[i]=0x00; -+ -+ mic_header2[0] = mpdu[16]; /* A3 */ -+ mic_header2[1] = mpdu[17]; -+ mic_header2[2] = mpdu[18]; -+ mic_header2[3] = mpdu[19]; -+ mic_header2[4] = mpdu[20]; -+ mic_header2[5] = mpdu[21]; -+ -+ //mic_header2[6] = mpdu[22] & 0xf0; /* SC */ -+ mic_header2[6] = 0x00; -+ mic_header2[7] = 0x00; /* mpdu[23]; */ -+ -+ -+ if (!qc_exists && a4_exists) -+ { -+ for (i=0;i<6;i++) mic_header2[8+i] = mpdu[24+i]; /* A4 */ -+ -+ } -+ -+ if (qc_exists && !a4_exists) -+ { -+ mic_header2[8] = mpdu[24] & 0x0f; /* mute bits 15 - 4 */ -+ mic_header2[9] = mpdu[25] & 0x00; -+ } -+ -+ if (qc_exists && a4_exists) -+ { -+ for (i=0;i<6;i++) mic_header2[8+i] = mpdu[24+i]; /* A4 */ -+ -+ mic_header2[14] = mpdu[30] & 0x0f; -+ mic_header2[15] = mpdu[31] & 0x00; -+ } -+ -+ -+} -+ -+ -+/************************************************/ -+/* construct_mic_header2() */ -+/* Builds the last MIC header block from */ -+/* header fields. */ -+/************************************************/ -+static void construct_ctr_preload( -+ u8 *ctr_preload, -+ sint a4_exists, -+ sint qc_exists, -+ u8 *mpdu, -+ u8 *pn_vector, -+ sint c -+ ) -+{ -+ sint i = 0; -+ -+ for (i=0; i<16; i++) ctr_preload[i] = 0x00; -+ i = 0; -+ -+ ctr_preload[0] = 0x01; /* flag */ -+ if (qc_exists && a4_exists) -+ ctr_preload[1] = mpdu[30] & 0x0f; /* QoC_Control */ -+ if (qc_exists && !a4_exists) -+ ctr_preload[1] = mpdu[24] & 0x0f; -+ -+ for (i = 2; i < 8; i++) -+ ctr_preload[i] = mpdu[i + 8]; /* ctr_preload[2:7] = A2[0:5] = mpdu[10:15] */ -+ #ifdef CONSISTENT_PN_ORDER -+ for (i = 8; i < 14; i++) -+ ctr_preload[i] = pn_vector[i - 8]; /* ctr_preload[8:13] = PN[0:5] */ -+ #else -+ for (i = 8; i < 14; i++) -+ ctr_preload[i] = pn_vector[13 - i]; /* ctr_preload[8:13] = PN[5:0] */ -+ #endif -+ ctr_preload[14] = (unsigned char) (c / 256); /* Ctr */ -+ ctr_preload[15] = (unsigned char) (c % 256); -+ -+} -+ -+ -+/************************************/ -+/* bitwise_xor() */ -+/* A 128 bit, bitwise exclusive or */ -+/************************************/ -+static void bitwise_xor(u8 *ina, u8 *inb, u8 *out) -+{ -+ sint i; -+ -+ for (i=0; i<16; i++) -+ { -+ out[i] = ina[i] ^ inb[i]; -+ } -+ -+} -+ -+ -+static sint aes_cipher(u8 *key, uint hdrlen, -+ u8 *pframe, uint plen) -+{ -+// /*static*/ unsigned char message[MAX_MSG_SIZE]; -+ uint qc_exists, a4_exists, i, j, payload_remainder, -+ num_blocks, payload_index; -+ -+ u8 pn_vector[6]; -+ u8 mic_iv[16]; -+ u8 mic_header1[16]; -+ u8 mic_header2[16]; -+ u8 ctr_preload[16]; -+ -+ /* Intermediate Buffers */ -+ u8 chain_buffer[16]; -+ u8 aes_out[16]; -+ u8 padded_buffer[16]; -+ u8 mic[8]; -+// uint offset = 0; -+ uint frtype = GetFrameType(pframe); -+ uint frsubtype = GetFrameSubType(pframe); -+ -+ -+ frsubtype=frsubtype>>4; -+ -+ -+ _rtw_memset((void *)mic_iv, 0, 16); -+ _rtw_memset((void *)mic_header1, 0, 16); -+ _rtw_memset((void *)mic_header2, 0, 16); -+ _rtw_memset((void *)ctr_preload, 0, 16); -+ _rtw_memset((void *)chain_buffer, 0, 16); -+ _rtw_memset((void *)aes_out, 0, 16); -+ _rtw_memset((void *)padded_buffer, 0, 16); -+ -+ if ((hdrlen == WLAN_HDR_A3_LEN )||(hdrlen == WLAN_HDR_A3_QOS_LEN)) -+ a4_exists = 0; -+ else -+ a4_exists = 1; -+ -+ if ( -+ (frtype == WIFI_DATA_CFACK) || -+ (frtype == WIFI_DATA_CFPOLL)|| -+ (frtype == WIFI_DATA_CFACKPOLL)) -+ { -+ qc_exists = 1; -+ if(hdrlen != WLAN_HDR_A3_QOS_LEN){ -+ -+ hdrlen += 2; -+ } -+ } -+ else if ( -+ (frsubtype == 0x08) || -+ (frsubtype == 0x09)|| -+ (frsubtype == 0x0a)|| -+ (frsubtype == 0x0b)) -+ { -+ if(hdrlen != WLAN_HDR_A3_QOS_LEN){ -+ -+ hdrlen += 2; -+ } -+ qc_exists = 1; -+ } -+ else -+ qc_exists = 0; -+ -+ pn_vector[0]=pframe[hdrlen]; -+ pn_vector[1]=pframe[hdrlen+1]; -+ pn_vector[2]=pframe[hdrlen+4]; -+ pn_vector[3]=pframe[hdrlen+5]; -+ pn_vector[4]=pframe[hdrlen+6]; -+ pn_vector[5]=pframe[hdrlen+7]; -+ -+ construct_mic_iv( -+ mic_iv, -+ qc_exists, -+ a4_exists, -+ pframe, //message, -+ plen, -+ pn_vector -+ ); -+ -+ construct_mic_header1( -+ mic_header1, -+ hdrlen, -+ pframe //message -+ ); -+ construct_mic_header2( -+ mic_header2, -+ pframe, //message, -+ a4_exists, -+ qc_exists -+ ); -+ -+ -+ payload_remainder = plen % 16; -+ num_blocks = plen / 16; -+ -+ /* Find start of payload */ -+ payload_index = (hdrlen + 8); -+ -+ /* Calculate MIC */ -+ aes128k128d(key, mic_iv, aes_out); -+ bitwise_xor(aes_out, mic_header1, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ bitwise_xor(aes_out, mic_header2, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ -+ for (i = 0; i < num_blocks; i++) -+ { -+ bitwise_xor(aes_out, &pframe[payload_index], chain_buffer);//bitwise_xor(aes_out, &message[payload_index], chain_buffer); -+ -+ payload_index += 16; -+ aes128k128d(key, chain_buffer, aes_out); -+ } -+ -+ /* Add on the final payload block if it needs padding */ -+ if (payload_remainder > 0) -+ { -+ for (j = 0; j < 16; j++) padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) -+ { -+ padded_buffer[j] = pframe[payload_index++];//padded_buffer[j] = message[payload_index++]; -+ } -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ -+ } -+ -+ for (j = 0 ; j < 8; j++) mic[j] = aes_out[j]; -+ -+ /* Insert MIC into payload */ -+ for (j = 0; j < 8; j++) -+ pframe[payload_index+j] = mic[j]; //message[payload_index+j] = mic[j]; -+ -+ payload_index = hdrlen + 8; -+ for (i=0; i< num_blocks; i++) { -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ pframe, //message, -+ pn_vector, -+ i+1); -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, &pframe[payload_index], chain_buffer);//bitwise_xor(aes_out, &message[payload_index], chain_buffer); -+ for (j=0; j<16;j++) pframe[payload_index++] = chain_buffer[j];//for (j=0; j<16;j++) message[payload_index++] = chain_buffer[j]; -+ } -+ -+ if (payload_remainder > 0) /* If there is a short final block, then pad it,*/ -+ { /* encrypt it and copy the unpadded part back */ -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ pframe, //message, -+ pn_vector, -+ num_blocks+1); -+ -+ for (j = 0; j < 16; j++) padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) -+ { -+ padded_buffer[j] = pframe[payload_index+j];//padded_buffer[j] = message[payload_index+j]; -+ } -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ for (j=0; jattrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; -+ struct xmit_priv *pxmitpriv=&padapter->xmitpriv; -+ -+// uint offset = 0; -+ u32 res=_SUCCESS; -+ -+ -+ if(((struct xmit_frame*)pxmitframe)->buf_addr==NULL) -+ return _FAIL; -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ hw_hdr_offset = TXDESC_SIZE + -+ (((struct xmit_frame*)pxmitframe)->pkt_offset * PACKET_OFFSET_SZ); -+#else -+ #ifdef CONFIG_TX_EARLY_MODE -+ hw_hdr_offset = TXDESC_OFFSET+EARLY_MODE_INFO_SIZE; -+ #else -+ hw_hdr_offset = TXDESC_OFFSET; -+ #endif -+#endif -+ -+ pframe = ((struct xmit_frame*)pxmitframe)->buf_addr + hw_hdr_offset; -+ -+ //4 start to encrypt each fragment -+ if((pattrib->encrypt==_AES_)){ -+/* -+ if(pattrib->psta) -+ { -+ stainfo = pattrib->psta; -+ } -+ else -+ { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ stainfo=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0] ); -+ } -+*/ -+ //if (stainfo!=NULL) -+ { -+/* -+ if(!(stainfo->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, stainfo->state); -+ return _FAIL; -+ } -+*/ -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_aes_encrypt: stainfo!=NULL!!!\n")); -+ -+ if(IS_MCAST(pattrib->ra)) -+ { -+ prwskey=psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; -+ } -+ else -+ { -+ //prwskey=&stainfo->dot118021x_UncstKey.skey[0]; -+ prwskey=pattrib->dot118021x_UncstKey.skey; -+ } -+ -+#ifdef CONFIG_TDLS //swencryption -+ { -+ struct sta_info *ptdls_sta; -+ ptdls_sta=rtw_get_stainfo(&padapter->stapriv ,&pattrib->dst[0] ); -+ if((ptdls_sta != NULL) && (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) ) -+ { -+ DBG_871X("[%s] for tdls link\n", __FUNCTION__); -+ prwskey=&ptdls_sta->tpk.tk[0]; -+ } -+ } -+#endif //CONFIG_TDLS -+ -+ prwskeylen=16; -+ -+ for(curfragnum=0;curfragnumnr_frags;curfragnum++){ -+ -+ if((curfragnum+1)==pattrib->nr_frags){ //4 the last fragment -+ length=pattrib->last_txcmdsz-pattrib->hdrlen-pattrib->iv_len- pattrib->icv_len; -+ -+ aes_cipher(prwskey,pattrib->hdrlen,pframe, length); -+ } -+ else{ -+ length=pxmitpriv->frag_len-pattrib->hdrlen-pattrib->iv_len-pattrib->icv_len ; -+ -+ aes_cipher(prwskey,pattrib->hdrlen,pframe, length); -+ pframe+=pxmitpriv->frag_len; -+ pframe=(u8*)RND4((SIZE_PTR)(pframe)); -+ -+ } -+ } -+ -+ -+ } -+/* -+ else{ -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_aes_encrypt: stainfo==NULL!!!\n")); -+ DBG_871X("%s, psta==NUL\n", __func__); -+ res=_FAIL; -+ } -+*/ -+ -+ } -+ -+ -+ -+ -+ return res; -+} -+ -+static sint aes_decipher(u8 *key, uint hdrlen, -+ u8 *pframe, uint plen) -+{ -+ static u8 message[MAX_MSG_SIZE]; -+ uint qc_exists, a4_exists, i, j, payload_remainder, -+ num_blocks, payload_index; -+ sint res = _SUCCESS; -+ u8 pn_vector[6]; -+ u8 mic_iv[16]; -+ u8 mic_header1[16]; -+ u8 mic_header2[16]; -+ u8 ctr_preload[16]; -+ -+ /* Intermediate Buffers */ -+ u8 chain_buffer[16]; -+ u8 aes_out[16]; -+ u8 padded_buffer[16]; -+ u8 mic[8]; -+ -+ -+// uint offset = 0; -+ uint frtype = GetFrameType(pframe); -+ uint frsubtype = GetFrameSubType(pframe); -+ -+ frsubtype=frsubtype>>4; -+ -+ -+ _rtw_memset((void *)mic_iv, 0, 16); -+ _rtw_memset((void *)mic_header1, 0, 16); -+ _rtw_memset((void *)mic_header2, 0, 16); -+ _rtw_memset((void *)ctr_preload, 0, 16); -+ _rtw_memset((void *)chain_buffer, 0, 16); -+ _rtw_memset((void *)aes_out, 0, 16); -+ _rtw_memset((void *)padded_buffer, 0, 16); -+ -+ //start to decrypt the payload -+ -+ num_blocks = (plen-8) / 16; //(plen including llc, payload_length and mic ) -+ -+ payload_remainder = (plen-8) % 16; -+ -+ pn_vector[0] = pframe[hdrlen]; -+ pn_vector[1] = pframe[hdrlen+1]; -+ pn_vector[2] = pframe[hdrlen+4]; -+ pn_vector[3] = pframe[hdrlen+5]; -+ pn_vector[4] = pframe[hdrlen+6]; -+ pn_vector[5] = pframe[hdrlen+7]; -+ -+ if ((hdrlen == WLAN_HDR_A3_LEN )||(hdrlen == WLAN_HDR_A3_QOS_LEN)) -+ a4_exists = 0; -+ else -+ a4_exists = 1; -+ -+ if ( -+ (frtype == WIFI_DATA_CFACK) || -+ (frtype == WIFI_DATA_CFPOLL)|| -+ (frtype == WIFI_DATA_CFACKPOLL)) -+ { -+ qc_exists = 1; -+ if(hdrlen != WLAN_HDR_A3_QOS_LEN){ -+ -+ hdrlen += 2; -+ } -+ } -+ else if ( -+ (frsubtype == 0x08) || -+ (frsubtype == 0x09)|| -+ (frsubtype == 0x0a)|| -+ (frsubtype == 0x0b)) -+ { -+ if(hdrlen != WLAN_HDR_A3_QOS_LEN){ -+ -+ hdrlen += 2; -+ } -+ qc_exists = 1; -+ } -+ else -+ qc_exists = 0; -+ -+ -+ // now, decrypt pframe with hdrlen offset and plen long -+ -+ payload_index = hdrlen + 8; // 8 is for extiv -+ -+ for (i=0; i< num_blocks; i++) -+ { -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ pframe, -+ pn_vector, -+ i+1 -+ ); -+ -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, &pframe[payload_index], chain_buffer); -+ -+ for (j=0; j<16;j++) pframe[payload_index++] = chain_buffer[j]; -+ } -+ -+ if (payload_remainder > 0) /* If there is a short final block, then pad it,*/ -+ { /* encrypt it and copy the unpadded part back */ -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ pframe, -+ pn_vector, -+ num_blocks+1 -+ ); -+ -+ for (j = 0; j < 16; j++) padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) -+ { -+ padded_buffer[j] = pframe[payload_index+j]; -+ } -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ for (j=0; j 0) -+ { -+ for (j = 0; j < 16; j++) padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) -+ { -+ padded_buffer[j] = message[payload_index++]; -+ } -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ aes128k128d(key, chain_buffer, aes_out); -+ -+ } -+ -+ for (j = 0 ; j < 8; j++) mic[j] = aes_out[j]; -+ -+ /* Insert MIC into payload */ -+ for (j = 0; j < 8; j++) -+ message[payload_index+j] = mic[j]; -+ -+ payload_index = hdrlen + 8; -+ for (i=0; i< num_blocks; i++) { -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ message, -+ pn_vector, -+ i+1); -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, &message[payload_index], chain_buffer); -+ for (j=0; j<16;j++) message[payload_index++] = chain_buffer[j]; -+ } -+ -+ if (payload_remainder > 0) /* If there is a short final block, then pad it,*/ -+ { /* encrypt it and copy the unpadded part back */ -+ construct_ctr_preload( -+ ctr_preload, -+ a4_exists, -+ qc_exists, -+ message, -+ pn_vector, -+ num_blocks+1); -+ -+ for (j = 0; j < 16; j++) padded_buffer[j] = 0x00; -+ for (j = 0; j < payload_remainder; j++) -+ { -+ padded_buffer[j] = message[payload_index+j]; -+ } -+ aes128k128d(key, ctr_preload, aes_out); -+ bitwise_xor(aes_out, padded_buffer, chain_buffer); -+ for (j=0; ju.hdr.attrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; -+// struct recv_priv *precvpriv=&padapter->recvpriv; -+ u32 res=_SUCCESS; -+ -+ pframe=(unsigned char *)((union recv_frame*)precvframe)->u.hdr.rx_data; -+ //4 start to encrypt each fragment -+ if((prxattrib->encrypt==_AES_)){ -+ -+ stainfo=rtw_get_stainfo(&padapter->stapriv ,&prxattrib->ta[0] ); -+ if (stainfo!=NULL){ -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_aes_decrypt: stainfo!=NULL!!!\n")); -+ -+ if(IS_MCAST(prxattrib->ra)) -+ { -+ //in concurrent we should use sw descrypt in group key, so we remove this message -+ //DBG_871X("rx bc/mc packets, to perform sw rtw_aes_decrypt\n"); -+ //prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; -+ if(psecuritypriv->binstallGrpkey==false) -+ { -+ res=_FAIL; -+ DBG_8192C("%s:rx bc/mc packets,but didn't install group key!!!!!!!!!!\n",__FUNCTION__); -+ goto exit; -+ } -+ prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; -+ if(psecuritypriv->dot118021XGrpKeyid != prxattrib->key_index) -+ { -+ DBG_871X("not match packet_index=%d, install_index=%d \n" -+ , prxattrib->key_index, psecuritypriv->dot118021XGrpKeyid); -+ res=_FAIL; -+ goto exit; -+ } -+ } -+ else -+ { -+ prwskey=&stainfo->dot118021x_UncstKey.skey[0]; -+ } -+ -+ length= ((union recv_frame *)precvframe)->u.hdr.len-prxattrib->hdrlen-prxattrib->iv_len; -+ -+ res= aes_decipher(prwskey,prxattrib->hdrlen,pframe, length); -+ -+ -+ } -+ else{ -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("rtw_aes_encrypt: stainfo==NULL!!!\n")); -+ res=_FAIL; -+ } -+ -+ } -+ -+exit: -+ return res; -+} -+/* compress 512-bits */ -+static int sha256_compress(struct sha256_state *md, unsigned char *buf) -+{ -+ u32 S[8], W[64], t0, t1; -+ u32 t; -+ int i; -+ -+ /* copy state into S */ -+ for (i = 0; i < 8; i++) { -+ S[i] = md->state[i]; -+ } -+ -+ /* copy the state into 512-bits into W[0..15] */ -+ for (i = 0; i < 16; i++) -+ W[i] = WPA_GET_BE32(buf + (4 * i)); -+ -+ /* fill W[16..63] */ -+ for (i = 16; i < 64; i++) { -+ W[i] = Gamma1(W[i - 2]) + W[i - 7] + Gamma0(W[i - 15]) + -+ W[i - 16]; -+ } -+ -+ /* Compress */ -+#define RND(a,b,c,d,e,f,g,h,i) \ -+ t0 = h + Sigma1(e) + Ch(e, f, g) + K[i] + W[i]; \ -+ t1 = Sigma0(a) + Maj(a, b, c); \ -+ d += t0; \ -+ h = t0 + t1; -+ -+ for (i = 0; i < 64; ++i) { -+ RND(S[0], S[1], S[2], S[3], S[4], S[5], S[6], S[7], i); -+ t = S[7]; S[7] = S[6]; S[6] = S[5]; S[5] = S[4]; -+ S[4] = S[3]; S[3] = S[2]; S[2] = S[1]; S[1] = S[0]; S[0] = t; -+ } -+ -+ /* feedback */ -+ for (i = 0; i < 8; i++) { -+ md->state[i] = md->state[i] + S[i]; -+ } -+ return 0; -+} -+ -+/* Initialize the hash state */ -+static void sha256_init(struct sha256_state *md) -+{ -+ md->curlen = 0; -+ md->length = 0; -+ md->state[0] = 0x6A09E667UL; -+ md->state[1] = 0xBB67AE85UL; -+ md->state[2] = 0x3C6EF372UL; -+ md->state[3] = 0xA54FF53AUL; -+ md->state[4] = 0x510E527FUL; -+ md->state[5] = 0x9B05688CUL; -+ md->state[6] = 0x1F83D9ABUL; -+ md->state[7] = 0x5BE0CD19UL; -+} -+ -+/** -+ Process a block of memory though the hash -+ @param md The hash state -+ @param in The data to hash -+ @param inlen The length of the data (octets) -+ @return CRYPT_OK if successful -+*/ -+static int sha256_process(struct sha256_state *md, unsigned char *in, -+ unsigned long inlen) -+{ -+ unsigned long n; -+#define block_size 64 -+ -+ if (md->curlen > sizeof(md->buf)) -+ return -1; -+ -+ while (inlen > 0) { -+ if (md->curlen == 0 && inlen >= block_size) { -+ if (sha256_compress(md, (unsigned char *) in) < 0) -+ return -1; -+ md->length += block_size * 8; -+ in += block_size; -+ inlen -= block_size; -+ } else { -+ n = MIN(inlen, (block_size - md->curlen)); -+ _rtw_memcpy(md->buf + md->curlen, in, n); -+ md->curlen += n; -+ in += n; -+ inlen -= n; -+ if (md->curlen == block_size) { -+ if (sha256_compress(md, md->buf) < 0) -+ return -1; -+ md->length += 8 * block_size; -+ md->curlen = 0; -+ } -+ } -+ } -+ -+ return 0; -+} -+ -+ -+/** -+ Terminate the hash to get the digest -+ @param md The hash state -+ @param out [out] The destination of the hash (32 bytes) -+ @return CRYPT_OK if successful -+*/ -+static int sha256_done(struct sha256_state *md, unsigned char *out) -+{ -+ int i; -+ -+ if (md->curlen >= sizeof(md->buf)) -+ return -1; -+ -+ /* increase the length of the message */ -+ md->length += md->curlen * 8; -+ -+ /* append the '1' bit */ -+ md->buf[md->curlen++] = (unsigned char) 0x80; -+ -+ /* if the length is currently above 56 bytes we append zeros -+ * then compress. Then we can fall back to padding zeros and length -+ * encoding like normal. -+ */ -+ if (md->curlen > 56) { -+ while (md->curlen < 64) { -+ md->buf[md->curlen++] = (unsigned char) 0; -+ } -+ sha256_compress(md, md->buf); -+ md->curlen = 0; -+ } -+ -+ /* pad upto 56 bytes of zeroes */ -+ while (md->curlen < 56) { -+ md->buf[md->curlen++] = (unsigned char) 0; -+ } -+ -+ /* store length */ -+ WPA_PUT_BE64(md->buf + 56, md->length); -+ sha256_compress(md, md->buf); -+ -+ /* copy output */ -+ for (i = 0; i < 8; i++) -+ WPA_PUT_BE32(out + (4 * i), md->state[i]); -+ -+ return 0; -+} -+ -+/** -+ * sha256_vector - SHA256 hash for data vector -+ * @num_elem: Number of elements in the data vector -+ * @addr: Pointers to the data areas -+ * @len: Lengths of the data blocks -+ * @mac: Buffer for the hash -+ * Returns: 0 on success, -1 of failure -+ */ -+static int sha256_vector(size_t num_elem, u8 *addr[], size_t *len, -+ u8 *mac) -+{ -+ struct sha256_state ctx; -+ size_t i; -+ -+ sha256_init(&ctx); -+ for (i = 0; i < num_elem; i++) -+ if (sha256_process(&ctx, addr[i], len[i])) -+ return -1; -+ if (sha256_done(&ctx, mac)) -+ return -1; -+ return 0; -+} -+ -+static u8 os_strlen(const char *s) -+{ -+ const char *p = s; -+ while (*p) -+ p++; -+ return p - s; -+} -+ -+static int os_memcmp(void *s1, void *s2, u8 n) -+{ -+ unsigned char *p1 = s1, *p2 = s2; -+ -+ if (n == 0) -+ return 0; -+ -+ while (*p1 == *p2) { -+ p1++; -+ p2++; -+ n--; -+ if (n == 0) -+ return 0; -+ } -+ -+ return *p1 - *p2; -+} -+ -+/** -+ * hmac_sha256_vector - HMAC-SHA256 over data vector (RFC 2104) -+ * @key: Key for HMAC operations -+ * @key_len: Length of the key in bytes -+ * @num_elem: Number of elements in the data vector -+ * @addr: Pointers to the data areas -+ * @len: Lengths of the data blocks -+ * @mac: Buffer for the hash (32 bytes) -+ */ -+static void hmac_sha256_vector(u8 *key, size_t key_len, size_t num_elem, -+ u8 *addr[], size_t *len, u8 *mac) -+{ -+ unsigned char k_pad[64]; /* padding - key XORd with ipad/opad */ -+ unsigned char tk[32]; -+ u8 *_addr[6]; -+ size_t _len[6], i; -+ -+ if (num_elem > 5) { -+ /* -+ * Fixed limit on the number of fragments to avoid having to -+ * allocate memory (which could fail). -+ */ -+ return; -+ } -+ -+ /* if key is longer than 64 bytes reset it to key = SHA256(key) */ -+ if (key_len > 64) { -+ sha256_vector(1, &key, &key_len, tk); -+ key = tk; -+ key_len = 32; -+ } -+ -+ /* the HMAC_SHA256 transform looks like: -+ * -+ * SHA256(K XOR opad, SHA256(K XOR ipad, text)) -+ * -+ * where K is an n byte key -+ * ipad is the byte 0x36 repeated 64 times -+ * opad is the byte 0x5c repeated 64 times -+ * and text is the data being protected */ -+ -+ /* start out by storing key in ipad */ -+ _rtw_memset(k_pad, 0, sizeof(k_pad)); -+ _rtw_memcpy(k_pad, key, key_len); -+ /* XOR key with ipad values */ -+ for (i = 0; i < 64; i++) -+ k_pad[i] ^= 0x36; -+ -+ /* perform inner SHA256 */ -+ _addr[0] = k_pad; -+ _len[0] = 64; -+ for (i = 0; i < num_elem; i++) { -+ _addr[i + 1] = addr[i]; -+ _len[i + 1] = len[i]; -+ } -+ sha256_vector(1 + num_elem, _addr, _len, mac); -+ -+ _rtw_memset(k_pad, 0, sizeof(k_pad)); -+ _rtw_memcpy(k_pad, key, key_len); -+ /* XOR key with opad values */ -+ for (i = 0; i < 64; i++) -+ k_pad[i] ^= 0x5c; -+ -+ /* perform outer SHA256 */ -+ _addr[0] = k_pad; -+ _len[0] = 64; -+ _addr[1] = mac; -+ _len[1] = 32; -+ sha256_vector(2, _addr, _len, mac); -+} -+ -+/** -+ * sha256_prf - SHA256-based Pseudo-Random Function (IEEE 802.11r, 8.5.1.5.2) -+ * @key: Key for PRF -+ * @key_len: Length of the key in bytes -+ * @label: A unique label for each purpose of the PRF -+ * @data: Extra data to bind into the key -+ * @data_len: Length of the data -+ * @buf: Buffer for the generated pseudo-random key -+ * @buf_len: Number of bytes of key to generate -+ * -+ * This function is used to derive new, cryptographically separate keys from a -+ * given key. -+ */ -+static void sha256_prf(u8 *key, size_t key_len, char *label, -+ u8 *data, size_t data_len, u8 *buf, size_t buf_len) -+{ -+ u16 counter = 1; -+ size_t pos, plen; -+ u8 hash[SHA256_MAC_LEN]; -+ u8 *addr[4]; -+ size_t len[4]; -+ u8 counter_le[2], length_le[2]; -+ -+ addr[0] = counter_le; -+ len[0] = 2; -+ addr[1] = (u8 *) label; -+ len[1] = os_strlen(label); -+ addr[2] = data; -+ len[2] = data_len; -+ addr[3] = length_le; -+ len[3] = sizeof(length_le); -+ -+ WPA_PUT_LE16(length_le, buf_len * 8); -+ pos = 0; -+ while (pos < buf_len) { -+ plen = buf_len - pos; -+ WPA_PUT_LE16(counter_le, counter); -+ if (plen >= SHA256_MAC_LEN) { -+ hmac_sha256_vector(key, key_len, 4, addr, len, -+ &buf[pos]); -+ pos += SHA256_MAC_LEN; -+ } else { -+ hmac_sha256_vector(key, key_len, 4, addr, len, hash); -+ _rtw_memcpy(&buf[pos], hash, plen); -+ break; -+ } -+ counter++; -+ } -+} -+ -+/* AES tables*/ -+const u32 Te0[256] = { -+ 0xc66363a5U, 0xf87c7c84U, 0xee777799U, 0xf67b7b8dU, -+ 0xfff2f20dU, 0xd66b6bbdU, 0xde6f6fb1U, 0x91c5c554U, -+ 0x60303050U, 0x02010103U, 0xce6767a9U, 0x562b2b7dU, -+ 0xe7fefe19U, 0xb5d7d762U, 0x4dababe6U, 0xec76769aU, -+ 0x8fcaca45U, 0x1f82829dU, 0x89c9c940U, 0xfa7d7d87U, -+ 0xeffafa15U, 0xb25959ebU, 0x8e4747c9U, 0xfbf0f00bU, -+ 0x41adadecU, 0xb3d4d467U, 0x5fa2a2fdU, 0x45afafeaU, -+ 0x239c9cbfU, 0x53a4a4f7U, 0xe4727296U, 0x9bc0c05bU, -+ 0x75b7b7c2U, 0xe1fdfd1cU, 0x3d9393aeU, 0x4c26266aU, -+ 0x6c36365aU, 0x7e3f3f41U, 0xf5f7f702U, 0x83cccc4fU, -+ 0x6834345cU, 0x51a5a5f4U, 0xd1e5e534U, 0xf9f1f108U, -+ 0xe2717193U, 0xabd8d873U, 0x62313153U, 0x2a15153fU, -+ 0x0804040cU, 0x95c7c752U, 0x46232365U, 0x9dc3c35eU, -+ 0x30181828U, 0x379696a1U, 0x0a05050fU, 0x2f9a9ab5U, -+ 0x0e070709U, 0x24121236U, 0x1b80809bU, 0xdfe2e23dU, -+ 0xcdebeb26U, 0x4e272769U, 0x7fb2b2cdU, 0xea75759fU, -+ 0x1209091bU, 0x1d83839eU, 0x582c2c74U, 0x341a1a2eU, -+ 0x361b1b2dU, 0xdc6e6eb2U, 0xb45a5aeeU, 0x5ba0a0fbU, -+ 0xa45252f6U, 0x763b3b4dU, 0xb7d6d661U, 0x7db3b3ceU, -+ 0x5229297bU, 0xdde3e33eU, 0x5e2f2f71U, 0x13848497U, -+ 0xa65353f5U, 0xb9d1d168U, 0x00000000U, 0xc1eded2cU, -+ 0x40202060U, 0xe3fcfc1fU, 0x79b1b1c8U, 0xb65b5bedU, -+ 0xd46a6abeU, 0x8dcbcb46U, 0x67bebed9U, 0x7239394bU, -+ 0x944a4adeU, 0x984c4cd4U, 0xb05858e8U, 0x85cfcf4aU, -+ 0xbbd0d06bU, 0xc5efef2aU, 0x4faaaae5U, 0xedfbfb16U, -+ 0x864343c5U, 0x9a4d4dd7U, 0x66333355U, 0x11858594U, -+ 0x8a4545cfU, 0xe9f9f910U, 0x04020206U, 0xfe7f7f81U, -+ 0xa05050f0U, 0x783c3c44U, 0x259f9fbaU, 0x4ba8a8e3U, -+ 0xa25151f3U, 0x5da3a3feU, 0x804040c0U, 0x058f8f8aU, -+ 0x3f9292adU, 0x219d9dbcU, 0x70383848U, 0xf1f5f504U, -+ 0x63bcbcdfU, 0x77b6b6c1U, 0xafdada75U, 0x42212163U, -+ 0x20101030U, 0xe5ffff1aU, 0xfdf3f30eU, 0xbfd2d26dU, -+ 0x81cdcd4cU, 0x180c0c14U, 0x26131335U, 0xc3ecec2fU, -+ 0xbe5f5fe1U, 0x359797a2U, 0x884444ccU, 0x2e171739U, -+ 0x93c4c457U, 0x55a7a7f2U, 0xfc7e7e82U, 0x7a3d3d47U, -+ 0xc86464acU, 0xba5d5de7U, 0x3219192bU, 0xe6737395U, -+ 0xc06060a0U, 0x19818198U, 0x9e4f4fd1U, 0xa3dcdc7fU, -+ 0x44222266U, 0x542a2a7eU, 0x3b9090abU, 0x0b888883U, -+ 0x8c4646caU, 0xc7eeee29U, 0x6bb8b8d3U, 0x2814143cU, -+ 0xa7dede79U, 0xbc5e5ee2U, 0x160b0b1dU, 0xaddbdb76U, -+ 0xdbe0e03bU, 0x64323256U, 0x743a3a4eU, 0x140a0a1eU, -+ 0x924949dbU, 0x0c06060aU, 0x4824246cU, 0xb85c5ce4U, -+ 0x9fc2c25dU, 0xbdd3d36eU, 0x43acacefU, 0xc46262a6U, -+ 0x399191a8U, 0x319595a4U, 0xd3e4e437U, 0xf279798bU, -+ 0xd5e7e732U, 0x8bc8c843U, 0x6e373759U, 0xda6d6db7U, -+ 0x018d8d8cU, 0xb1d5d564U, 0x9c4e4ed2U, 0x49a9a9e0U, -+ 0xd86c6cb4U, 0xac5656faU, 0xf3f4f407U, 0xcfeaea25U, -+ 0xca6565afU, 0xf47a7a8eU, 0x47aeaee9U, 0x10080818U, -+ 0x6fbabad5U, 0xf0787888U, 0x4a25256fU, 0x5c2e2e72U, -+ 0x381c1c24U, 0x57a6a6f1U, 0x73b4b4c7U, 0x97c6c651U, -+ 0xcbe8e823U, 0xa1dddd7cU, 0xe874749cU, 0x3e1f1f21U, -+ 0x964b4bddU, 0x61bdbddcU, 0x0d8b8b86U, 0x0f8a8a85U, -+ 0xe0707090U, 0x7c3e3e42U, 0x71b5b5c4U, 0xcc6666aaU, -+ 0x904848d8U, 0x06030305U, 0xf7f6f601U, 0x1c0e0e12U, -+ 0xc26161a3U, 0x6a35355fU, 0xae5757f9U, 0x69b9b9d0U, -+ 0x17868691U, 0x99c1c158U, 0x3a1d1d27U, 0x279e9eb9U, -+ 0xd9e1e138U, 0xebf8f813U, 0x2b9898b3U, 0x22111133U, -+ 0xd26969bbU, 0xa9d9d970U, 0x078e8e89U, 0x339494a7U, -+ 0x2d9b9bb6U, 0x3c1e1e22U, 0x15878792U, 0xc9e9e920U, -+ 0x87cece49U, 0xaa5555ffU, 0x50282878U, 0xa5dfdf7aU, -+ 0x038c8c8fU, 0x59a1a1f8U, 0x09898980U, 0x1a0d0d17U, -+ 0x65bfbfdaU, 0xd7e6e631U, 0x844242c6U, 0xd06868b8U, -+ 0x824141c3U, 0x299999b0U, 0x5a2d2d77U, 0x1e0f0f11U, -+ 0x7bb0b0cbU, 0xa85454fcU, 0x6dbbbbd6U, 0x2c16163aU, -+}; -+const u32 Td0[256] = { -+ 0x51f4a750U, 0x7e416553U, 0x1a17a4c3U, 0x3a275e96U, -+ 0x3bab6bcbU, 0x1f9d45f1U, 0xacfa58abU, 0x4be30393U, -+ 0x2030fa55U, 0xad766df6U, 0x88cc7691U, 0xf5024c25U, -+ 0x4fe5d7fcU, 0xc52acbd7U, 0x26354480U, 0xb562a38fU, -+ 0xdeb15a49U, 0x25ba1b67U, 0x45ea0e98U, 0x5dfec0e1U, -+ 0xc32f7502U, 0x814cf012U, 0x8d4697a3U, 0x6bd3f9c6U, -+ 0x038f5fe7U, 0x15929c95U, 0xbf6d7aebU, 0x955259daU, -+ 0xd4be832dU, 0x587421d3U, 0x49e06929U, 0x8ec9c844U, -+ 0x75c2896aU, 0xf48e7978U, 0x99583e6bU, 0x27b971ddU, -+ 0xbee14fb6U, 0xf088ad17U, 0xc920ac66U, 0x7dce3ab4U, -+ 0x63df4a18U, 0xe51a3182U, 0x97513360U, 0x62537f45U, -+ 0xb16477e0U, 0xbb6bae84U, 0xfe81a01cU, 0xf9082b94U, -+ 0x70486858U, 0x8f45fd19U, 0x94de6c87U, 0x527bf8b7U, -+ 0xab73d323U, 0x724b02e2U, 0xe31f8f57U, 0x6655ab2aU, -+ 0xb2eb2807U, 0x2fb5c203U, 0x86c57b9aU, 0xd33708a5U, -+ 0x302887f2U, 0x23bfa5b2U, 0x02036abaU, 0xed16825cU, -+ 0x8acf1c2bU, 0xa779b492U, 0xf307f2f0U, 0x4e69e2a1U, -+ 0x65daf4cdU, 0x0605bed5U, 0xd134621fU, 0xc4a6fe8aU, -+ 0x342e539dU, 0xa2f355a0U, 0x058ae132U, 0xa4f6eb75U, -+ 0x0b83ec39U, 0x4060efaaU, 0x5e719f06U, 0xbd6e1051U, -+ 0x3e218af9U, 0x96dd063dU, 0xdd3e05aeU, 0x4de6bd46U, -+ 0x91548db5U, 0x71c45d05U, 0x0406d46fU, 0x605015ffU, -+ 0x1998fb24U, 0xd6bde997U, 0x894043ccU, 0x67d99e77U, -+ 0xb0e842bdU, 0x07898b88U, 0xe7195b38U, 0x79c8eedbU, -+ 0xa17c0a47U, 0x7c420fe9U, 0xf8841ec9U, 0x00000000U, -+ 0x09808683U, 0x322bed48U, 0x1e1170acU, 0x6c5a724eU, -+ 0xfd0efffbU, 0x0f853856U, 0x3daed51eU, 0x362d3927U, -+ 0x0a0fd964U, 0x685ca621U, 0x9b5b54d1U, 0x24362e3aU, -+ 0x0c0a67b1U, 0x9357e70fU, 0xb4ee96d2U, 0x1b9b919eU, -+ 0x80c0c54fU, 0x61dc20a2U, 0x5a774b69U, 0x1c121a16U, -+ 0xe293ba0aU, 0xc0a02ae5U, 0x3c22e043U, 0x121b171dU, -+ 0x0e090d0bU, 0xf28bc7adU, 0x2db6a8b9U, 0x141ea9c8U, -+ 0x57f11985U, 0xaf75074cU, 0xee99ddbbU, 0xa37f60fdU, -+ 0xf701269fU, 0x5c72f5bcU, 0x44663bc5U, 0x5bfb7e34U, -+ 0x8b432976U, 0xcb23c6dcU, 0xb6edfc68U, 0xb8e4f163U, -+ 0xd731dccaU, 0x42638510U, 0x13972240U, 0x84c61120U, -+ 0x854a247dU, 0xd2bb3df8U, 0xaef93211U, 0xc729a16dU, -+ 0x1d9e2f4bU, 0xdcb230f3U, 0x0d8652ecU, 0x77c1e3d0U, -+ 0x2bb3166cU, 0xa970b999U, 0x119448faU, 0x47e96422U, -+ 0xa8fc8cc4U, 0xa0f03f1aU, 0x567d2cd8U, 0x223390efU, -+ 0x87494ec7U, 0xd938d1c1U, 0x8ccaa2feU, 0x98d40b36U, -+ 0xa6f581cfU, 0xa57ade28U, 0xdab78e26U, 0x3fadbfa4U, -+ 0x2c3a9de4U, 0x5078920dU, 0x6a5fcc9bU, 0x547e4662U, -+ 0xf68d13c2U, 0x90d8b8e8U, 0x2e39f75eU, 0x82c3aff5U, -+ 0x9f5d80beU, 0x69d0937cU, 0x6fd52da9U, 0xcf2512b3U, -+ 0xc8ac993bU, 0x10187da7U, 0xe89c636eU, 0xdb3bbb7bU, -+ 0xcd267809U, 0x6e5918f4U, 0xec9ab701U, 0x834f9aa8U, -+ 0xe6956e65U, 0xaaffe67eU, 0x21bccf08U, 0xef15e8e6U, -+ 0xbae79bd9U, 0x4a6f36ceU, 0xea9f09d4U, 0x29b07cd6U, -+ 0x31a4b2afU, 0x2a3f2331U, 0xc6a59430U, 0x35a266c0U, -+ 0x744ebc37U, 0xfc82caa6U, 0xe090d0b0U, 0x33a7d815U, -+ 0xf104984aU, 0x41ecdaf7U, 0x7fcd500eU, 0x1791f62fU, -+ 0x764dd68dU, 0x43efb04dU, 0xccaa4d54U, 0xe49604dfU, -+ 0x9ed1b5e3U, 0x4c6a881bU, 0xc12c1fb8U, 0x4665517fU, -+ 0x9d5eea04U, 0x018c355dU, 0xfa877473U, 0xfb0b412eU, -+ 0xb3671d5aU, 0x92dbd252U, 0xe9105633U, 0x6dd64713U, -+ 0x9ad7618cU, 0x37a10c7aU, 0x59f8148eU, 0xeb133c89U, -+ 0xcea927eeU, 0xb761c935U, 0xe11ce5edU, 0x7a47b13cU, -+ 0x9cd2df59U, 0x55f2733fU, 0x1814ce79U, 0x73c737bfU, -+ 0x53f7cdeaU, 0x5ffdaa5bU, 0xdf3d6f14U, 0x7844db86U, -+ 0xcaaff381U, 0xb968c43eU, 0x3824342cU, 0xc2a3405fU, -+ 0x161dc372U, 0xbce2250cU, 0x283c498bU, 0xff0d9541U, -+ 0x39a80171U, 0x080cb3deU, 0xd8b4e49cU, 0x6456c190U, -+ 0x7bcb8461U, 0xd532b670U, 0x486c5c74U, 0xd0b85742U, -+}; -+const u8 Td4s[256] = { -+ 0x52U, 0x09U, 0x6aU, 0xd5U, 0x30U, 0x36U, 0xa5U, 0x38U, -+ 0xbfU, 0x40U, 0xa3U, 0x9eU, 0x81U, 0xf3U, 0xd7U, 0xfbU, -+ 0x7cU, 0xe3U, 0x39U, 0x82U, 0x9bU, 0x2fU, 0xffU, 0x87U, -+ 0x34U, 0x8eU, 0x43U, 0x44U, 0xc4U, 0xdeU, 0xe9U, 0xcbU, -+ 0x54U, 0x7bU, 0x94U, 0x32U, 0xa6U, 0xc2U, 0x23U, 0x3dU, -+ 0xeeU, 0x4cU, 0x95U, 0x0bU, 0x42U, 0xfaU, 0xc3U, 0x4eU, -+ 0x08U, 0x2eU, 0xa1U, 0x66U, 0x28U, 0xd9U, 0x24U, 0xb2U, -+ 0x76U, 0x5bU, 0xa2U, 0x49U, 0x6dU, 0x8bU, 0xd1U, 0x25U, -+ 0x72U, 0xf8U, 0xf6U, 0x64U, 0x86U, 0x68U, 0x98U, 0x16U, -+ 0xd4U, 0xa4U, 0x5cU, 0xccU, 0x5dU, 0x65U, 0xb6U, 0x92U, -+ 0x6cU, 0x70U, 0x48U, 0x50U, 0xfdU, 0xedU, 0xb9U, 0xdaU, -+ 0x5eU, 0x15U, 0x46U, 0x57U, 0xa7U, 0x8dU, 0x9dU, 0x84U, -+ 0x90U, 0xd8U, 0xabU, 0x00U, 0x8cU, 0xbcU, 0xd3U, 0x0aU, -+ 0xf7U, 0xe4U, 0x58U, 0x05U, 0xb8U, 0xb3U, 0x45U, 0x06U, -+ 0xd0U, 0x2cU, 0x1eU, 0x8fU, 0xcaU, 0x3fU, 0x0fU, 0x02U, -+ 0xc1U, 0xafU, 0xbdU, 0x03U, 0x01U, 0x13U, 0x8aU, 0x6bU, -+ 0x3aU, 0x91U, 0x11U, 0x41U, 0x4fU, 0x67U, 0xdcU, 0xeaU, -+ 0x97U, 0xf2U, 0xcfU, 0xceU, 0xf0U, 0xb4U, 0xe6U, 0x73U, -+ 0x96U, 0xacU, 0x74U, 0x22U, 0xe7U, 0xadU, 0x35U, 0x85U, -+ 0xe2U, 0xf9U, 0x37U, 0xe8U, 0x1cU, 0x75U, 0xdfU, 0x6eU, -+ 0x47U, 0xf1U, 0x1aU, 0x71U, 0x1dU, 0x29U, 0xc5U, 0x89U, -+ 0x6fU, 0xb7U, 0x62U, 0x0eU, 0xaaU, 0x18U, 0xbeU, 0x1bU, -+ 0xfcU, 0x56U, 0x3eU, 0x4bU, 0xc6U, 0xd2U, 0x79U, 0x20U, -+ 0x9aU, 0xdbU, 0xc0U, 0xfeU, 0x78U, 0xcdU, 0x5aU, 0xf4U, -+ 0x1fU, 0xddU, 0xa8U, 0x33U, 0x88U, 0x07U, 0xc7U, 0x31U, -+ 0xb1U, 0x12U, 0x10U, 0x59U, 0x27U, 0x80U, 0xecU, 0x5fU, -+ 0x60U, 0x51U, 0x7fU, 0xa9U, 0x19U, 0xb5U, 0x4aU, 0x0dU, -+ 0x2dU, 0xe5U, 0x7aU, 0x9fU, 0x93U, 0xc9U, 0x9cU, 0xefU, -+ 0xa0U, 0xe0U, 0x3bU, 0x4dU, 0xaeU, 0x2aU, 0xf5U, 0xb0U, -+ 0xc8U, 0xebU, 0xbbU, 0x3cU, 0x83U, 0x53U, 0x99U, 0x61U, -+ 0x17U, 0x2bU, 0x04U, 0x7eU, 0xbaU, 0x77U, 0xd6U, 0x26U, -+ 0xe1U, 0x69U, 0x14U, 0x63U, 0x55U, 0x21U, 0x0cU, 0x7dU, -+}; -+const u8 rcons[] = { -+ 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x1B, 0x36 -+ /* for 128-bit blocks, Rijndael never uses more than 10 rcon values */ -+}; -+ -+/** -+ * Expand the cipher key into the encryption key schedule. -+ * -+ * @return the number of rounds for the given cipher key size. -+ */ -+static void rijndaelKeySetupEnc(u32 rk[/*44*/], const u8 cipherKey[]) -+{ -+ int i; -+ u32 temp; -+ -+ rk[0] = GETU32(cipherKey ); -+ rk[1] = GETU32(cipherKey + 4); -+ rk[2] = GETU32(cipherKey + 8); -+ rk[3] = GETU32(cipherKey + 12); -+ for (i = 0; i < 10; i++) { -+ temp = rk[3]; -+ rk[4] = rk[0] ^ -+ TE421(temp) ^ TE432(temp) ^ TE443(temp) ^ TE414(temp) ^ -+ RCON(i); -+ rk[5] = rk[1] ^ rk[4]; -+ rk[6] = rk[2] ^ rk[5]; -+ rk[7] = rk[3] ^ rk[6]; -+ rk += 4; -+ } -+} -+ -+static void rijndaelEncrypt(u32 rk[/*44*/], u8 pt[16], u8 ct[16]) -+{ -+ u32 s0, s1, s2, s3, t0, t1, t2, t3; -+ int Nr = 10; -+#ifndef FULL_UNROLL -+ int r; -+#endif /* ?FULL_UNROLL */ -+ -+ /* -+ * map byte array block to cipher state -+ * and add initial round key: -+ */ -+ s0 = GETU32(pt ) ^ rk[0]; -+ s1 = GETU32(pt + 4) ^ rk[1]; -+ s2 = GETU32(pt + 8) ^ rk[2]; -+ s3 = GETU32(pt + 12) ^ rk[3]; -+ -+#define ROUND(i,d,s) \ -+d##0 = TE0(s##0) ^ TE1(s##1) ^ TE2(s##2) ^ TE3(s##3) ^ rk[4 * i]; \ -+d##1 = TE0(s##1) ^ TE1(s##2) ^ TE2(s##3) ^ TE3(s##0) ^ rk[4 * i + 1]; \ -+d##2 = TE0(s##2) ^ TE1(s##3) ^ TE2(s##0) ^ TE3(s##1) ^ rk[4 * i + 2]; \ -+d##3 = TE0(s##3) ^ TE1(s##0) ^ TE2(s##1) ^ TE3(s##2) ^ rk[4 * i + 3] -+ -+#ifdef FULL_UNROLL -+ -+ ROUND(1,t,s); -+ ROUND(2,s,t); -+ ROUND(3,t,s); -+ ROUND(4,s,t); -+ ROUND(5,t,s); -+ ROUND(6,s,t); -+ ROUND(7,t,s); -+ ROUND(8,s,t); -+ ROUND(9,t,s); -+ -+ rk += Nr << 2; -+ -+#else /* !FULL_UNROLL */ -+ -+ /* Nr - 1 full rounds: */ -+ r = Nr >> 1; -+ for (;;) { -+ ROUND(1,t,s); -+ rk += 8; -+ if (--r == 0) -+ break; -+ ROUND(0,s,t); -+ } -+ -+#endif /* ?FULL_UNROLL */ -+ -+#undef ROUND -+ -+ /* -+ * apply last round and -+ * map cipher state to byte array block: -+ */ -+ s0 = TE41(t0) ^ TE42(t1) ^ TE43(t2) ^ TE44(t3) ^ rk[0]; -+ PUTU32(ct , s0); -+ s1 = TE41(t1) ^ TE42(t2) ^ TE43(t3) ^ TE44(t0) ^ rk[1]; -+ PUTU32(ct + 4, s1); -+ s2 = TE41(t2) ^ TE42(t3) ^ TE43(t0) ^ TE44(t1) ^ rk[2]; -+ PUTU32(ct + 8, s2); -+ s3 = TE41(t3) ^ TE42(t0) ^ TE43(t1) ^ TE44(t2) ^ rk[3]; -+ PUTU32(ct + 12, s3); -+} -+ -+static void * aes_encrypt_init(u8 *key, size_t len) -+{ -+ u32 *rk; -+ if (len != 16) -+ return NULL; -+ rk = (u32*)rtw_malloc(AES_PRIV_SIZE); -+ if (rk == NULL) -+ return NULL; -+ rijndaelKeySetupEnc(rk, key); -+ return rk; -+} -+ -+static void aes_128_encrypt(void *ctx, u8 *plain, u8 *crypt) -+{ -+ rijndaelEncrypt(ctx, plain, crypt); -+} -+ -+ -+static void gf_mulx(u8 *pad) -+{ -+ int i, carry; -+ -+ carry = pad[0] & 0x80; -+ for (i = 0; i < AES_BLOCK_SIZE - 1; i++) -+ pad[i] = (pad[i] << 1) | (pad[i + 1] >> 7); -+ pad[AES_BLOCK_SIZE - 1] <<= 1; -+ if (carry) -+ pad[AES_BLOCK_SIZE - 1] ^= 0x87; -+} -+ -+static void aes_encrypt_deinit(void *ctx) -+{ -+ _rtw_memset(ctx, 0, AES_PRIV_SIZE); -+ rtw_mfree(ctx, AES_PRIV_SIZE); -+} -+ -+/** -+ * omac1_aes_128_vector - One-Key CBC MAC (OMAC1) hash with AES-128 -+ * @key: 128-bit key for the hash operation -+ * @num_elem: Number of elements in the data vector -+ * @addr: Pointers to the data areas -+ * @len: Lengths of the data blocks -+ * @mac: Buffer for MAC (128 bits, i.e., 16 bytes) -+ * Returns: 0 on success, -1 on failure -+ * -+ * This is a mode for using block cipher (AES in this case) for authentication. -+ * OMAC1 was standardized with the name CMAC by NIST in a Special Publication -+ * (SP) 800-38B. -+ */ -+static int omac1_aes_128_vector(u8 *key, size_t num_elem, -+ u8 *addr[], size_t *len, u8 *mac) -+{ -+ void *ctx; -+ u8 cbc[AES_BLOCK_SIZE], pad[AES_BLOCK_SIZE]; -+ u8 *pos, *end; -+ size_t i, e, left, total_len; -+ -+ ctx = aes_encrypt_init(key, 16); -+ if (ctx == NULL) -+ return -1; -+ _rtw_memset(cbc, 0, AES_BLOCK_SIZE); -+ -+ total_len = 0; -+ for (e = 0; e < num_elem; e++) -+ total_len += len[e]; -+ left = total_len; -+ -+ e = 0; -+ pos = addr[0]; -+ end = pos + len[0]; -+ -+ while (left >= AES_BLOCK_SIZE) { -+ for (i = 0; i < AES_BLOCK_SIZE; i++) { -+ cbc[i] ^= *pos++; -+ if (pos >= end) { -+ e++; -+ pos = addr[e]; -+ end = pos + len[e]; -+ } -+ } -+ if (left > AES_BLOCK_SIZE) -+ aes_128_encrypt(ctx, cbc, cbc); -+ left -= AES_BLOCK_SIZE; -+ } -+ -+ _rtw_memset(pad, 0, AES_BLOCK_SIZE); -+ aes_128_encrypt(ctx, pad, pad); -+ gf_mulx(pad); -+ -+ if (left || total_len == 0) { -+ for (i = 0; i < left; i++) { -+ cbc[i] ^= *pos++; -+ if (pos >= end) { -+ e++; -+ pos = addr[e]; -+ end = pos + len[e]; -+ } -+ } -+ cbc[left] ^= 0x80; -+ gf_mulx(pad); -+ } -+ -+ for (i = 0; i < AES_BLOCK_SIZE; i++) -+ pad[i] ^= cbc[i]; -+ aes_128_encrypt(ctx, pad, mac); -+ aes_encrypt_deinit(ctx); -+ return 0; -+} -+ -+/** -+ * omac1_aes_128 - One-Key CBC MAC (OMAC1) hash with AES-128 (aka AES-CMAC) -+ * @key: 128-bit key for the hash operation -+ * @data: Data buffer for which a MAC is determined -+ * @data_len: Length of data buffer in bytes -+ * @mac: Buffer for MAC (128 bits, i.e., 16 bytes) -+ * Returns: 0 on success, -1 on failure -+ * -+ * This is a mode for using block cipher (AES in this case) for authentication. -+ * OMAC1 was standardized with the name CMAC by NIST in a Special Publication -+ * (SP) 800-38B. -+ */ -+static int omac1_aes_128(u8 *key, u8 *data, size_t data_len, u8 *mac) -+{ -+ return omac1_aes_128_vector(key, 1, &data, &data_len, mac); -+} -+ -+#ifdef CONFIG_TDLS -+void wpa_tdls_generate_tpk(_adapter *padapter, struct sta_info *psta) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 *SNonce = psta->SNonce; -+ u8 *ANonce = psta->ANonce; -+ -+ u8 key_input[SHA256_MAC_LEN]; -+ u8 *nonce[2]; -+ size_t len[2]; -+ u8 data[3 * ETH_ALEN]; -+ -+ /* IEEE Std 802.11z-2010 8.5.9.1: -+ * TPK-Key-Input = SHA-256(min(SNonce, ANonce) || max(SNonce, ANonce)) -+ */ -+ len[0] = 32; -+ len[1] = 32; -+ if (os_memcmp(SNonce, ANonce, 32) < 0) { -+ nonce[0] = SNonce; -+ nonce[1] = ANonce; -+ } else { -+ nonce[0] = ANonce; -+ nonce[1] = SNonce; -+ } -+ -+ sha256_vector(2, nonce, len, key_input); -+ -+ /* -+ * TPK-Key-Data = KDF-N_KEY(TPK-Key-Input, "TDLS PMK", -+ * min(MAC_I, MAC_R) || max(MAC_I, MAC_R) || BSSID || N_KEY) -+ * TODO: is N_KEY really included in KDF Context and if so, in which -+ * presentation format (little endian 16-bit?) is it used? It gets -+ * added by the KDF anyway.. -+ */ -+ -+ if (os_memcmp(myid(&(padapter->eeprompriv)), psta->hwaddr, ETH_ALEN) < 0) { -+ _rtw_memcpy(data, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(data + ETH_ALEN, psta->hwaddr, ETH_ALEN); -+ } else { -+ _rtw_memcpy(data, psta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(data + ETH_ALEN, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ } -+ _rtw_memcpy(data + 2 * ETH_ALEN, get_bssid(pmlmepriv), ETH_ALEN); -+ -+ sha256_prf(key_input, SHA256_MAC_LEN, "TDLS PMK", data, sizeof(data), (u8 *) &psta->tpk, sizeof(psta->tpk)); -+ -+ -+} -+ -+/** -+ * wpa_tdls_ftie_mic - Calculate TDLS FTIE MIC -+ * @kck: TPK-KCK -+ * @lnkid: Pointer to the beginning of Link Identifier IE -+ * @rsnie: Pointer to the beginning of RSN IE used for handshake -+ * @timeoutie: Pointer to the beginning of Timeout IE used for handshake -+ * @ftie: Pointer to the beginning of FT IE -+ * @mic: Pointer for writing MIC -+ * -+ * Calculate MIC for TDLS frame. -+ */ -+int wpa_tdls_ftie_mic(u8 *kck, u8 trans_seq, -+ u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie, -+ u8 *mic) -+{ -+ u8 *buf, *pos; -+ struct wpa_tdls_ftie *_ftie; -+ struct wpa_tdls_lnkid *_lnkid; -+ int ret; -+ int len = 2 * ETH_ALEN + 1 + 2 + lnkid[1] + 2 + rsnie[1] + -+ 2 + timeoutie[1] + 2 + ftie[1]; -+ buf = rtw_zmalloc(len); -+ if (!buf) { -+ DBG_871X("TDLS: No memory for MIC calculation\n"); -+ return -1; -+ } -+ -+ pos = buf; -+ _lnkid = (struct wpa_tdls_lnkid *) lnkid; -+ /* 1) TDLS initiator STA MAC address */ -+ _rtw_memcpy(pos, _lnkid->init_sta, ETH_ALEN); -+ pos += ETH_ALEN; -+ /* 2) TDLS responder STA MAC address */ -+ _rtw_memcpy(pos, _lnkid->resp_sta, ETH_ALEN); -+ pos += ETH_ALEN; -+ /* 3) Transaction Sequence number */ -+ *pos++ = trans_seq; -+ /* 4) Link Identifier IE */ -+ _rtw_memcpy(pos, lnkid, 2 + lnkid[1]); -+ pos += 2 + lnkid[1]; -+ /* 5) RSN IE */ -+ _rtw_memcpy(pos, rsnie, 2 + rsnie[1]); -+ pos += 2 + rsnie[1]; -+ /* 6) Timeout Interval IE */ -+ _rtw_memcpy(pos, timeoutie, 2 + timeoutie[1]); -+ pos += 2 + timeoutie[1]; -+ /* 7) FTIE, with the MIC field of the FTIE set to 0 */ -+ _rtw_memcpy(pos, ftie, 2 + ftie[1]); -+ _ftie = (struct wpa_tdls_ftie *) pos; -+ _rtw_memset(_ftie->mic, 0, TDLS_MIC_LEN); -+ pos += 2 + ftie[1]; -+ -+ ret = omac1_aes_128(kck, buf, pos - buf, mic); -+ rtw_mfree(buf, len); -+ return ret; -+ -+} -+ -+int tdls_verify_mic(u8 *kck, u8 trans_seq, -+ u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie) -+{ -+ u8 *buf, *pos; -+ int len; -+ u8 mic[16]; -+ int ret; -+ u8 *rx_ftie, *tmp_ftie; -+ -+ if (lnkid == NULL || rsnie == NULL || -+ timeoutie == NULL || ftie == NULL){ -+ return 0; -+ } -+ -+ len = 2 * ETH_ALEN + 1 + 2 + 18 + 2 + *(rsnie+1) + 2 + *(timeoutie+1) + 2 + *(ftie+1); -+ -+ buf = rtw_zmalloc(len); -+ if (buf == NULL) -+ return 0; -+ -+ pos = buf; -+ /* 1) TDLS initiator STA MAC address */ -+ _rtw_memcpy(pos, lnkid + ETH_ALEN + 2, ETH_ALEN); -+ pos += ETH_ALEN; -+ /* 2) TDLS responder STA MAC address */ -+ _rtw_memcpy(pos, lnkid + 2 * ETH_ALEN + 2, ETH_ALEN); -+ pos += ETH_ALEN; -+ /* 3) Transaction Sequence number */ -+ *pos++ = trans_seq; -+ /* 4) Link Identifier IE */ -+ _rtw_memcpy(pos, lnkid, 2 + 18); -+ pos += 2 + 18; -+ /* 5) RSN IE */ -+ _rtw_memcpy(pos, rsnie, 2 + *(rsnie+1)); -+ pos += 2 + *(rsnie+1); -+ /* 6) Timeout Interval IE */ -+ _rtw_memcpy(pos, timeoutie, 2 + *(timeoutie+1)); -+ pos += 2 + *(timeoutie+1); -+ /* 7) FTIE, with the MIC field of the FTIE set to 0 */ -+ _rtw_memcpy(pos, ftie, 2 + *(ftie+1)); -+ pos += 2; -+ tmp_ftie = (u8 *) (pos+2); -+ _rtw_memset(tmp_ftie, 0, 16); -+ pos += *(ftie+1); -+ -+ ret = omac1_aes_128(kck, buf, pos - buf, mic); -+ rtw_mfree(buf, len); -+ if (ret) -+ return 0; -+ rx_ftie = ftie+4; -+ -+ if (os_memcmp(mic, rx_ftie, 16) == 0) { -+ //Valid MIC -+ return 1; -+ } -+ -+ //Invalid MIC -+ DBG_871X( "[%s] Invalid MIC\n", __FUNCTION__); -+ return 0; -+ -+} -+#endif //CONFIG_TDLS -+ -+void rtw_use_tkipkey_handler(RTW_TIMER_HDL_ARGS) -+{ -+ _adapter *padapter = (_adapter *)FunctionContext; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("^^^rtw_use_tkipkey_handler ^^^\n")); -+ -+/* -+ if(padapter->bDriverStopped ||padapter->bSurpriseRemoved){ -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("^^^rtw_use_tkipkey_handler (padapter->bDriverStopped %d)(padapter->bSurpriseRemoved %d)^^^\n",padapter->bDriverStopped,padapter->bSurpriseRemoved)); -+ -+ return; -+ } -+ */ -+ -+ padapter->securitypriv.busetkipkey=true; -+ -+ RT_TRACE(_module_rtl871x_security_c_,_drv_err_,("^^^rtw_use_tkipkey_handler padapter->securitypriv.busetkipkey=%d^^^\n",padapter->securitypriv.busetkipkey)); -+ -+ -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_sreset.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_sreset.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_sreset.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_sreset.c 2018-02-06 17:42:30.699967001 +0200 -@@ -0,0 +1,340 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+#include -+ -+void sreset_init_value(_adapter *padapter) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ _rtw_mutex_init(&psrtpriv->silentreset_mutex); -+ psrtpriv->silent_reset_inprogress = false; -+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; -+ psrtpriv->last_tx_time =0; -+ psrtpriv->last_tx_complete_time =0; -+#endif -+} -+void sreset_reset_value(_adapter *padapter) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ psrtpriv->silent_reset_inprogress = false; -+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; -+ psrtpriv->last_tx_time =0; -+ psrtpriv->last_tx_complete_time =0; -+#endif -+} -+ -+u8 sreset_get_wifi_status(_adapter *padapter) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ u8 status = WIFI_STATUS_SUCCESS; -+ u32 val32 = 0; -+ _irqL irqL; -+ if(psrtpriv->silent_reset_inprogress == true) -+ { -+ return status; -+ } -+ val32 =rtw_read32(padapter,REG_TXDMA_STATUS); -+ if(val32==0xeaeaeaea){ -+ psrtpriv->Wifi_Error_Status = WIFI_IF_NOT_EXIST; -+ } -+ else if(val32!=0){ -+ DBG_8192C("txdmastatu(%x)\n",val32); -+ psrtpriv->Wifi_Error_Status = WIFI_MAC_TXDMA_ERROR; -+ } -+ -+ if(WIFI_STATUS_SUCCESS !=psrtpriv->Wifi_Error_Status) -+ { -+ DBG_8192C("==>%s error_status(0x%x) \n",__FUNCTION__,psrtpriv->Wifi_Error_Status); -+ status = (psrtpriv->Wifi_Error_Status &( ~(USB_READ_PORT_FAIL|USB_WRITE_PORT_FAIL))); -+ } -+ DBG_8192C("==> %s wifi_status(0x%x)\n",__FUNCTION__,status); -+ -+ //status restore -+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; -+ -+ return status; -+#else -+ return WIFI_STATUS_SUCCESS; -+#endif -+} -+ -+void sreset_set_wifi_error_status(_adapter *padapter, u32 status) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.Wifi_Error_Status = status; -+#endif -+} -+ -+void sreset_set_trigger_point(_adapter *padapter, s32 tgp) -+{ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.dbg_trigger_point = tgp; -+#endif -+} -+ -+bool sreset_inprogress(_adapter *padapter) -+{ -+#if defined(DBG_CONFIG_ERROR_RESET) -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ return pHalData->srestpriv.silent_reset_inprogress; -+#else -+ return false; -+#endif -+} -+ -+void sreset_restore_security_station(_adapter *padapter) -+{ -+ u8 EntryId = 0; -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct sta_priv * pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ struct mlme_ext_info *pmlmeinfo = &padapter->mlmeextpriv.mlmext_info; -+ -+ { -+ u8 val8; -+ -+ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_8021X) { -+ val8 = 0xcc; -+ #ifdef CONFIG_WAPI_SUPPORT -+ } else if (padapter->wapiInfo.bWapiEnable && pmlmeinfo->auth_algo == dot11AuthAlgrthm_WAPI) { -+ //Disable TxUseDefaultKey, RxUseDefaultKey, RxBroadcastUseDefaultKey. -+ val8 = 0x4c; -+ #endif -+ } else { -+ val8 = 0xcf; -+ } -+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); -+ } -+ -+ #if 0 -+ if ( ( padapter->securitypriv.dot11PrivacyAlgrthm == _WEP40_ ) || -+ ( padapter->securitypriv.dot11PrivacyAlgrthm == _WEP104_ )) -+ { -+ -+ for(EntryId=0; EntryId<4; EntryId++) -+ { -+ if(EntryId == psecuritypriv->dot11PrivacyKeyIndex) -+ rtw_set_key(padapter,&padapter->securitypriv, EntryId, 1); -+ else -+ rtw_set_key(padapter,&padapter->securitypriv, EntryId, 0); -+ } -+ -+ } -+ else -+ #endif -+ if((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) -+ { -+ psta = rtw_get_stainfo(pstapriv, get_bssid(mlmepriv)); -+ if (psta == NULL) { -+ //DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail \n")); -+ } -+ else -+ { -+ //pairwise key -+ rtw_setstakey_cmd(padapter, (unsigned char *)psta, true); -+ //group key -+ rtw_set_key(padapter,&padapter->securitypriv,padapter->securitypriv.dot118021XGrpKeyid, 0); -+ } -+ } -+} -+ -+void sreset_restore_network_station(_adapter *padapter) -+{ -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ #if 0 -+ { -+ //======================================================= -+ // reset related register of Beacon control -+ -+ //set MSR to nolink -+ Set_MSR(padapter, _HW_STATE_NOLINK_); -+ // reject all data frame -+ rtw_write16(padapter, REG_RXFLTMAP2,0x00); -+ //reset TSF -+ rtw_write8(padapter, REG_DUAL_TSF_RST, (BIT(0)|BIT(1))); -+ -+ // disable update TSF -+ SetBcnCtrlReg(padapter, BIT(4), 0); -+ -+ //======================================================= -+ } -+ #endif -+ -+ rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure); -+ -+ { -+ u8 threshold; -+ // TH=1 => means that invalidate usb rx aggregation -+ // TH=0 => means that validate usb rx aggregation, use init value. -+ if(mlmepriv->htpriv.ht_option) { -+ if(padapter->registrypriv.wifi_spec==1) -+ threshold = 1; -+ else -+ threshold = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); -+ } else { -+ threshold = 1; -+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); -+ } -+ } -+ -+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ //disable dynamic functions, such as high power, DIG -+ //Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress); -+ -+ { -+ u8 join_type = 0; -+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); -+ } -+ -+ Set_MSR(padapter, (pmlmeinfo->state & 0x3)); -+ -+ mlmeext_joinbss_event_callback(padapter, 1); -+ //restore Sequence No. -+ rtw_write8(padapter,0x4dc,padapter->xmitpriv.nqos_ssn); -+ -+ sreset_restore_security_station(padapter); -+} -+ -+void sreset_restore_network_status(_adapter *padapter) -+{ -+ struct mlme_priv *mlmepriv = &padapter->mlmepriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (check_fwstate(mlmepriv, WIFI_STATION_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); -+ sreset_restore_network_station(padapter); -+ } else if (check_fwstate(mlmepriv, WIFI_AP_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); -+ rtw_ap_restore_network(padapter); -+ } else if (check_fwstate(mlmepriv, WIFI_ADHOC_STATE)) { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); -+ } else { -+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); -+ } -+} -+ -+void sreset_stop_adapter(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if (padapter == NULL) -+ return; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (!rtw_netif_queue_stopped(padapter->pnetdev)) -+ rtw_netif_stop_queue(padapter->pnetdev); -+ -+ rtw_cancel_all_timer(padapter); -+ -+ /* TODO: OS and HCI independent */ -+ tasklet_kill(&pxmitpriv->xmit_tasklet); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) -+ rtw_scan_abort(padapter); -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) -+ _rtw_join_timeout_handler(padapter); -+ -+} -+ -+void sreset_start_adapter(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if (padapter == NULL) -+ return; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) { -+ sreset_restore_network_status(padapter); -+ } -+ -+ /* TODO: OS and HCI independent */ -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+ -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); -+ -+ if (rtw_netif_queue_stopped(padapter->pnetdev)) -+ rtw_netif_wake_queue(padapter->pnetdev); -+ -+} -+ -+void sreset_reset(_adapter *padapter) -+{ -+#ifdef DBG_CONFIG_ERROR_RESET -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _irqL irqL; -+ u32 start = rtw_get_current_time(); -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS; -+ -+ _enter_critical_mutex(&psrtpriv->silentreset_mutex, &irqL); -+ psrtpriv->silent_reset_inprogress = true; -+ pwrpriv->change_rfpwrstate = rf_off; -+ -+ sreset_stop_adapter(padapter); -+ #ifdef CONFIG_CONCURRENT_MODE -+ sreset_stop_adapter(padapter->pbuddy_adapter); -+ #endif -+ -+ #ifdef CONFIG_IPS -+ ips_enter(padapter); -+ ips_leave(padapter); -+ #endif -+ -+ sreset_start_adapter(padapter); -+ #ifdef CONFIG_CONCURRENT_MODE -+ sreset_start_adapter(padapter->pbuddy_adapter); -+ #endif -+ -+ psrtpriv->silent_reset_inprogress = false; -+ _exit_critical_mutex(&psrtpriv->silentreset_mutex, &irqL); -+ -+ DBG_871X("%s done in %d ms\n", __FUNCTION__, rtw_get_passing_time_ms(start)); -+#endif -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_sta_mgt.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_sta_mgt.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_sta_mgt.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_sta_mgt.c 2018-02-06 17:42:30.699967001 +0200 -@@ -0,0 +1,824 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_STA_MGT_C_ -+ -+#include -+ -+void _rtw_init_stainfo(struct sta_info *psta) -+{ -+ _rtw_memset((u8 *)psta, 0, sizeof (struct sta_info)); -+ -+ _rtw_spinlock_init(&psta->lock); -+ _rtw_init_listhead(&psta->list); -+ _rtw_init_listhead(&psta->hash_list); -+ -+ _rtw_init_queue(&psta->sleep_q); -+ psta->sleepq_len = 0; -+ -+ _rtw_init_sta_xmit_priv(&psta->sta_xmitpriv); -+ _rtw_init_sta_recv_priv(&psta->sta_recvpriv); -+ -+#ifdef CONFIG_AP_MODE -+ -+ _rtw_init_listhead(&psta->asoc_list); -+ -+ _rtw_init_listhead(&psta->auth_list); -+ -+ psta->expire_to = 0; -+ -+ psta->flags = 0; -+ -+ psta->capability = 0; -+ -+ psta->bpairwise_key_installed = false; -+ -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ psta->nonerp_set = 0; -+ psta->no_short_slot_time_set = 0; -+ psta->no_short_preamble_set = 0; -+ psta->no_ht_gf_set = 0; -+ psta->no_ht_set = 0; -+ psta->ht_20mhz_set = 0; -+#endif -+ -+#ifdef CONFIG_TX_MCAST2UNI -+ psta->under_exist_checking = 0; -+#endif // CONFIG_TX_MCAST2UNI -+ -+ psta->keep_alive_trycnt = 0; -+ -+#endif // CONFIG_AP_MODE -+ -+ -+ -+} -+ -+u32 _rtw_init_sta_priv(struct sta_priv *pstapriv) -+{ -+ struct sta_info *psta; -+ s32 i; -+ -+ -+ -+ pstapriv->pallocated_stainfo_buf = rtw_zvmalloc (sizeof(struct sta_info) * NUM_STA+ 4); -+ -+ if(!pstapriv->pallocated_stainfo_buf) -+ return _FAIL; -+ -+ pstapriv->pstainfo_buf = pstapriv->pallocated_stainfo_buf + 4 - -+ ((SIZE_PTR)(pstapriv->pallocated_stainfo_buf ) & 3); -+ -+ _rtw_init_queue(&pstapriv->free_sta_queue); -+ -+ _rtw_spinlock_init(&pstapriv->sta_hash_lock); -+ -+ //_rtw_init_queue(&pstapriv->asoc_q); -+ pstapriv->asoc_sta_count = 0; -+ _rtw_init_queue(&pstapriv->sleep_q); -+ _rtw_init_queue(&pstapriv->wakeup_q); -+ -+ psta = (struct sta_info *)(pstapriv->pstainfo_buf); -+ -+ -+ for(i = 0; i < NUM_STA; i++) -+ { -+ _rtw_init_stainfo(psta); -+ -+ _rtw_init_listhead(&(pstapriv->sta_hash[i])); -+ -+ rtw_list_insert_tail(&psta->list, get_list_head(&pstapriv->free_sta_queue)); -+ -+ psta++; -+ } -+ -+ -+ -+#ifdef CONFIG_AP_MODE -+ -+ pstapriv->sta_dz_bitmap = 0; -+ pstapriv->tim_bitmap = 0; -+ -+ _rtw_init_listhead(&pstapriv->asoc_list); -+ _rtw_init_listhead(&pstapriv->auth_list); -+ _rtw_spinlock_init(&pstapriv->asoc_list_lock); -+ _rtw_spinlock_init(&pstapriv->auth_list_lock); -+ pstapriv->asoc_list_cnt = 0; -+ pstapriv->auth_list_cnt = 0; -+ -+ pstapriv->auth_to = 3; // 3*2 = 6 sec -+ pstapriv->assoc_to = 3; -+ //pstapriv->expire_to = 900;// 900*2 = 1800 sec = 30 min, expire after no any traffic. -+ //pstapriv->expire_to = 30;// 30*2 = 60 sec = 1 min, expire after no any traffic. -+#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK -+ pstapriv->expire_to = 3; // 3*2 = 6 sec -+#else -+ pstapriv->expire_to = 60;// 60*2 = 120 sec = 2 min, expire after no any traffic. -+#endif -+ pstapriv->max_num_sta = NUM_STA; -+ -+#endif -+ -+ -+ -+ return _SUCCESS; -+ -+} -+ -+inline int rtw_stainfo_offset(struct sta_priv *stapriv, struct sta_info *sta) -+{ -+ int offset = (((u8 *)sta) - stapriv->pstainfo_buf)/sizeof(struct sta_info); -+ -+ if (!stainfo_offset_valid(offset)) -+ DBG_871X("%s invalid offset(%d), out of range!!!", __func__, offset); -+ -+ return offset; -+} -+ -+inline struct sta_info *rtw_get_stainfo_by_offset(struct sta_priv *stapriv, int offset) -+{ -+ if (!stainfo_offset_valid(offset)) -+ DBG_871X("%s invalid offset(%d), out of range!!!", __func__, offset); -+ -+ return (struct sta_info *)(stapriv->pstainfo_buf + offset * sizeof(struct sta_info)); -+} -+ -+void _rtw_free_sta_xmit_priv_lock(struct sta_xmit_priv *psta_xmitpriv); -+void _rtw_free_sta_xmit_priv_lock(struct sta_xmit_priv *psta_xmitpriv) -+{ -+ -+ -+ _rtw_spinlock_free(&psta_xmitpriv->lock); -+ -+ _rtw_spinlock_free(&(psta_xmitpriv->be_q.sta_pending.lock)); -+ _rtw_spinlock_free(&(psta_xmitpriv->bk_q.sta_pending.lock)); -+ _rtw_spinlock_free(&(psta_xmitpriv->vi_q.sta_pending.lock)); -+ _rtw_spinlock_free(&(psta_xmitpriv->vo_q.sta_pending.lock)); -+ -+} -+ -+static void _rtw_free_sta_recv_priv_lock(struct sta_recv_priv *psta_recvpriv) -+{ -+ -+ -+ _rtw_spinlock_free(&psta_recvpriv->lock); -+ -+ _rtw_spinlock_free(&(psta_recvpriv->defrag_q.lock)); -+ -+ -+ -+} -+ -+void rtw_mfree_stainfo(struct sta_info *psta); -+void rtw_mfree_stainfo(struct sta_info *psta) -+{ -+ -+ -+ if(&psta->lock != NULL) -+ _rtw_spinlock_free(&psta->lock); -+ -+ _rtw_free_sta_xmit_priv_lock(&psta->sta_xmitpriv); -+ _rtw_free_sta_recv_priv_lock(&psta->sta_recvpriv); -+ -+ -+} -+ -+ -+// this function is used to free the memory of lock || sema for all stainfos -+void rtw_mfree_all_stainfo(struct sta_priv *pstapriv ); -+void rtw_mfree_all_stainfo(struct sta_priv *pstapriv ) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct sta_info *psta = NULL; -+ -+ -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ phead = get_list_head(&pstapriv->free_sta_queue); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info ,list); -+ plist = get_next(plist); -+ -+ rtw_mfree_stainfo(psta); -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ -+ -+} -+ -+void rtw_mfree_sta_priv_lock(struct sta_priv *pstapriv); -+void rtw_mfree_sta_priv_lock(struct sta_priv *pstapriv) -+{ -+#ifdef CONFIG_AP_MODE -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+#endif -+ -+ rtw_mfree_all_stainfo(pstapriv); //be done before free sta_hash_lock -+ -+ _rtw_spinlock_free(&pstapriv->free_sta_queue.lock); -+ -+ _rtw_spinlock_free(&pstapriv->sta_hash_lock); -+ _rtw_spinlock_free(&pstapriv->wakeup_q.lock); -+ _rtw_spinlock_free(&pstapriv->sleep_q.lock); -+ -+#ifdef CONFIG_AP_MODE -+ _rtw_spinlock_free(&pstapriv->asoc_list_lock); -+ _rtw_spinlock_free(&pstapriv->auth_list_lock); -+ _rtw_spinlock_free(&pacl_list->acl_node_q.lock); -+#endif -+ -+} -+ -+u32 _rtw_free_sta_priv(struct sta_priv *pstapriv) -+{ -+ _irqL irqL; -+ _list *phead, *plist; -+ struct sta_info *psta = NULL; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ int index; -+ -+ -+ if(pstapriv){ -+ -+ /* delete all reordering_ctrl_timer */ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for(index = 0; index < NUM_STA; index++) -+ { -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ int i; -+ psta = LIST_CONTAINOR(plist, struct sta_info ,hash_list); -+ plist = get_next(plist); -+ -+ for(i=0; i < 16 ; i++) -+ { -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); -+ } -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ /*===============================*/ -+ -+ rtw_mfree_sta_priv_lock(pstapriv); -+ -+ if(pstapriv->pallocated_stainfo_buf) { -+ rtw_vmfree(pstapriv->pallocated_stainfo_buf, sizeof(struct sta_info)*NUM_STA+4); -+ } -+ } -+ -+ -+ return _SUCCESS; -+} -+ -+ -+//struct sta_info *rtw_alloc_stainfo(_queue *pfree_sta_queue, unsigned char *hwaddr) -+struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) -+{ -+ _irqL irqL, irqL2; -+ uint tmp_aid; -+ s32 index; -+ _list *phash_list; -+ struct sta_info *psta; -+ _queue *pfree_sta_queue; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ int i = 0; -+ u16 wRxSeqInitialValue = 0xffff; -+ -+ -+ -+ pfree_sta_queue = &pstapriv->free_sta_queue; -+ -+ //_enter_critical_bh(&(pfree_sta_queue->lock), &irqL); -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); -+ -+ if (_rtw_queue_empty(pfree_sta_queue) == true) -+ { -+ //_exit_critical_bh(&(pfree_sta_queue->lock), &irqL); -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); -+ psta = NULL; -+ } -+ else -+ { -+ psta = LIST_CONTAINOR(get_next(&pfree_sta_queue->queue), struct sta_info, list); -+ -+ rtw_list_delete(&(psta->list)); -+ -+ //_exit_critical_bh(&(pfree_sta_queue->lock), &irqL); -+ -+ tmp_aid = psta->aid; -+ -+ _rtw_init_stainfo(psta); -+ -+ psta->padapter = pstapriv->padapter; -+ -+ _rtw_memcpy(psta->hwaddr, hwaddr, ETH_ALEN); -+ -+ index = wifi_mac_hash(hwaddr); -+ -+ RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_info_,("rtw_alloc_stainfo: index = %x", index)); -+ -+ if(index >= NUM_STA){ -+ RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_err_,("ERROR=> rtw_alloc_stainfo: index >= NUM_STA")); -+ psta= NULL; -+ goto exit; -+ } -+ phash_list = &(pstapriv->sta_hash[index]); -+ -+ //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); -+ -+ rtw_list_insert_tail(&psta->hash_list, phash_list); -+ -+ pstapriv->asoc_sta_count ++ ; -+ -+ //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); -+ -+// Commented by Albert 2009/08/13 -+// For the SMC router, the sequence number of first packet of WPS handshake will be 0. -+// In this case, this packet will be dropped by recv_decache function if we use the 0x00 as the default value for tid_rxseq variable. -+// So, we initialize the tid_rxseq variable as the 0xffff. -+ -+ for( i = 0; i < 16; i++ ) -+ { -+ _rtw_memcpy( &psta->sta_recvpriv.rxcache.tid_rxseq[ i ], &wRxSeqInitialValue, 2 ); -+ } -+ -+ RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_info_,("alloc number_%d stainfo with hwaddr = %x %x %x %x %x %x \n", -+ pstapriv->asoc_sta_count , hwaddr[0], hwaddr[1], hwaddr[2],hwaddr[3],hwaddr[4],hwaddr[5])); -+ -+ init_addba_retry_timer(pstapriv->padapter, psta); -+ -+#ifdef CONFIG_TDLS -+ psta->padapter = pstapriv->padapter; -+ init_TPK_timer(pstapriv->padapter, psta); -+ init_ch_switch_timer(pstapriv->padapter, psta); -+ init_base_ch_timer(pstapriv->padapter, psta); -+ init_off_ch_timer(pstapriv->padapter, psta); -+ init_handshake_timer(pstapriv->padapter, psta); -+ init_tdls_alive_timer(pstapriv->padapter, psta); -+#endif //CONFIG_TDLS -+ -+ //for A-MPDU Rx reordering buffer control -+ for(i=0; i < 16 ; i++) -+ { -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ -+ preorder_ctrl->padapter = pstapriv->padapter; -+ -+ preorder_ctrl->enable = false; -+ -+ preorder_ctrl->indicate_seq = 0xffff; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq); -+ #endif -+ preorder_ctrl->wend_b= 0xffff; -+ //preorder_ctrl->wsize_b = (NR_RECVBUFF-2); -+ preorder_ctrl->wsize_b = 64;//64; -+ -+ _rtw_init_queue(&preorder_ctrl->pending_recvframe_queue); -+ -+ rtw_init_recv_timer(preorder_ctrl); -+ } -+ -+ -+ //init for DM -+ psta->rssi_stat.UndecoratedSmoothedPWDB = (-1); -+ psta->rssi_stat.UndecoratedSmoothedCCK = (-1); -+ -+ /* init for the sequence number of received management frame */ -+ psta->RxMgmtFrameSeqNum = 0xffff; -+ -+ //alloc mac id for non-bc/mc station, -+ rtw_alloc_macid(pstapriv->padapter, psta); -+ -+ } -+ -+exit: -+ -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); -+ -+ -+ -+ return psta; -+ -+ -+} -+ -+ -+// using pstapriv->sta_hash_lock to protect -+u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta) -+{ -+ int i; -+ _irqL irqL0; -+ _queue *pfree_sta_queue; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct sta_xmit_priv *pstaxmitpriv; -+ struct xmit_priv *pxmitpriv= &padapter->xmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct hw_xmit *phwxmit; -+ -+ -+ -+ -+ if (psta == NULL) -+ goto exit; -+ -+ -+ _enter_critical_bh(&psta->lock, &irqL0); -+ psta->state &= ~_FW_LINKED; -+ _exit_critical_bh(&psta->lock, &irqL0); -+ -+ pfree_sta_queue = &pstapriv->free_sta_queue; -+ -+ -+ pstaxmitpriv = &psta->sta_xmitpriv; -+ -+ //rtw_list_delete(&psta->sleep_list); -+ -+ //rtw_list_delete(&psta->wakeup_list); -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ rtw_free_xmitframe_queue(pxmitpriv, &psta->sleep_q); -+ psta->sleepq_len = 0; -+ -+ //vo -+ //_enter_critical_bh(&(pxmitpriv->vo_pending.lock), &irqL0); -+ rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->vo_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits; -+ phwxmit->accnt -= pstaxmitpriv->vo_q.qcnt; -+ pstaxmitpriv->vo_q.qcnt = 0; -+ //_exit_critical_bh(&(pxmitpriv->vo_pending.lock), &irqL0); -+ -+ //vi -+ //_enter_critical_bh(&(pxmitpriv->vi_pending.lock), &irqL0); -+ rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->vi_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->vi_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits+1; -+ phwxmit->accnt -= pstaxmitpriv->vi_q.qcnt; -+ pstaxmitpriv->vi_q.qcnt = 0; -+ //_exit_critical_bh(&(pxmitpriv->vi_pending.lock), &irqL0); -+ -+ //be -+ //_enter_critical_bh(&(pxmitpriv->be_pending.lock), &irqL0); -+ rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->be_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits+2; -+ phwxmit->accnt -= pstaxmitpriv->be_q.qcnt; -+ pstaxmitpriv->be_q.qcnt = 0; -+ //_exit_critical_bh(&(pxmitpriv->be_pending.lock), &irqL0); -+ -+ //bk -+ //_enter_critical_bh(&(pxmitpriv->bk_pending.lock), &irqL0); -+ rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->bk_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending)); -+ phwxmit = pxmitpriv->hwxmits+3; -+ phwxmit->accnt -= pstaxmitpriv->bk_q.qcnt; -+ pstaxmitpriv->bk_q.qcnt = 0; -+ //_exit_critical_bh(&(pxmitpriv->bk_pending.lock), &irqL0); -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ rtw_list_delete(&psta->hash_list); -+ RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_err_,("\n free number_%d stainfo with hwaddr = 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x \n",pstapriv->asoc_sta_count , psta->hwaddr[0], psta->hwaddr[1], psta->hwaddr[2],psta->hwaddr[3],psta->hwaddr[4],psta->hwaddr[5])); -+ pstapriv->asoc_sta_count --; -+ -+ -+ // re-init sta_info; 20061114 // will be init in alloc_stainfo -+ //_rtw_init_sta_xmit_priv(&psta->sta_xmitpriv); -+ //_rtw_init_sta_recv_priv(&psta->sta_recvpriv); -+ -+ _cancel_timer_ex(&psta->addba_retry_timer); -+ -+#ifdef CONFIG_TDLS -+ _cancel_timer_ex(&psta->TPK_timer); -+ _cancel_timer_ex(&psta->option_timer); -+ _cancel_timer_ex(&psta->base_ch_timer); -+ _cancel_timer_ex(&psta->off_ch_timer); -+ _cancel_timer_ex(&psta->alive_timer1); -+ _cancel_timer_ex(&psta->alive_timer2); -+#endif //CONFIG_TDLS -+ -+ //for A-MPDU Rx reordering buffer control, cancel reordering_ctrl_timer -+ for(i=0; i < 16 ; i++) -+ { -+ _irqL irqL; -+ _list *phead, *plist; -+ union recv_frame *prframe; -+ _queue *ppending_recvframe_queue; -+ _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ -+ _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); -+ -+ -+ ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; -+ -+ _enter_critical_bh(&ppending_recvframe_queue->lock, &irqL); -+ -+ phead = get_list_head(ppending_recvframe_queue); -+ plist = get_next(phead); -+ -+ while(!rtw_is_list_empty(phead)) -+ { -+ prframe = LIST_CONTAINOR(plist, union recv_frame, u); -+ -+ plist = get_next(plist); -+ -+ rtw_list_delete(&(prframe->u.hdr.list)); -+ -+ rtw_free_recvframe(prframe, pfree_recv_queue); -+ } -+ -+ _exit_critical_bh(&ppending_recvframe_queue->lock, &irqL); -+ -+ } -+ -+ if (!(psta->state & WIFI_AP_STATE)) -+ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, false); -+ -+ -+ //release mac id for non-bc/mc station, -+ rtw_release_macid(pstapriv->padapter, psta); -+ -+#ifdef CONFIG_AP_MODE -+ -+/* -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL0); -+ rtw_list_delete(&psta->asoc_list); -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL0); -+*/ -+ _enter_critical_bh(&pstapriv->auth_list_lock, &irqL0); -+ if (!rtw_is_list_empty(&psta->auth_list)) { -+ rtw_list_delete(&psta->auth_list); -+ pstapriv->auth_list_cnt--; -+ } -+ _exit_critical_bh(&pstapriv->auth_list_lock, &irqL0); -+ -+ psta->expire_to = 0; -+ -+ psta->sleepq_ac_len = 0; -+ psta->qos_info = 0; -+ -+ psta->max_sp_len = 0; -+ psta->uapsd_bk = 0; -+ psta->uapsd_be = 0; -+ psta->uapsd_vi = 0; -+ psta->uapsd_vo = 0; -+ -+ psta->has_legacy_ac = 0; -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ -+ pstapriv->sta_dz_bitmap &=~BIT(psta->aid); -+ pstapriv->tim_bitmap &=~BIT(psta->aid); -+ -+ //rtw_indicate_sta_disassoc_event(padapter, psta); -+ -+ if ((psta->aid >0)&&(pstapriv->sta_aid[psta->aid - 1] == psta)) -+ { -+ pstapriv->sta_aid[psta->aid - 1] = NULL; -+ psta->aid = 0; -+ } -+ -+#endif // CONFIG_NATIVEAP_MLME -+ -+#ifdef CONFIG_TX_MCAST2UNI -+ psta->under_exist_checking = 0; -+#endif // CONFIG_TX_MCAST2UNI -+ -+#endif // CONFIG_AP_MODE -+ -+ _rtw_spinlock_free(&psta->lock); -+ -+ //_enter_critical_bh(&(pfree_sta_queue->lock), &irqL0); -+ rtw_list_insert_tail(&psta->list, get_list_head(pfree_sta_queue)); -+ //_exit_critical_bh(&(pfree_sta_queue->lock), &irqL0); -+ -+exit: -+ -+ -+ -+ return _SUCCESS; -+ -+} -+ -+// free all stainfo which in sta_hash[all] -+void rtw_free_all_stainfo(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ s32 index; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info* pbcmc_stainfo =rtw_get_bcmc_stainfo( padapter); -+ -+ if(pstapriv->asoc_sta_count==1) -+ return; -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for(index=0; index< NUM_STA; index++) { -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) { -+ psta = LIST_CONTAINOR(plist, struct sta_info ,hash_list); -+ -+ plist = get_next(plist); -+ -+ if(pbcmc_stainfo!=psta) -+ rtw_free_stainfo(padapter , psta); -+ -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+} -+ -+/* any station allocated can be searched by hash list */ -+struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) -+{ -+ -+ _irqL irqL; -+ -+ _list *plist, *phead; -+ -+ struct sta_info *psta = NULL; -+ -+ u32 index; -+ -+ u8 *addr; -+ -+ u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ -+ -+ -+ if(hwaddr==NULL) -+ return NULL; -+ -+ if(IS_MCAST(hwaddr)) -+ { -+ addr = bc_addr; -+ } -+ else -+ { -+ addr = hwaddr; -+ } -+ -+ index = wifi_mac_hash(addr); -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ if ((_rtw_memcmp(psta->hwaddr, addr, ETH_ALEN))== true) -+ { // if found the matched address -+ break; -+ } -+ psta=NULL; -+ plist = get_next(plist); -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ return psta; -+ -+} -+ -+u32 rtw_init_bcmc_stainfo(_adapter* padapter) -+{ -+ -+ struct sta_info *psta; -+ struct tx_servq *ptxservq; -+ u32 res=_SUCCESS; -+ NDIS_802_11_MAC_ADDRESS bcast_addr= {0xff,0xff,0xff,0xff,0xff,0xff}; -+ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ //_queue *pstapending = &padapter->xmitpriv.bm_pending; -+ -+ -+ -+ psta = rtw_alloc_stainfo(pstapriv, bcast_addr); -+ -+ if(psta==NULL){ -+ res=_FAIL; -+ RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_err_,("rtw_alloc_stainfo fail")); -+ goto exit; -+ } -+ -+ // default broadcast & multicast use macid 1 -+ psta->mac_id = 1; -+ -+ ptxservq= &(psta->sta_xmitpriv.be_q); -+ -+/* -+ _enter_critical(&pstapending->lock, &irqL0); -+ -+ if (rtw_is_list_empty(&ptxservq->tx_pending)) -+ rtw_list_insert_tail(&ptxservq->tx_pending, get_list_head(pstapending)); -+ -+ _exit_critical(&pstapending->lock, &irqL0); -+*/ -+ -+exit: -+ -+ return _SUCCESS; -+ -+} -+ -+ -+struct sta_info* rtw_get_bcmc_stainfo(_adapter* padapter) -+{ -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ -+ psta = rtw_get_stainfo(pstapriv, bc_addr); -+ -+ return psta; -+ -+} -+ -+u8 rtw_access_ctrl(_adapter *padapter, u8 *mac_addr) -+{ -+ u8 res = true; -+#ifdef CONFIG_AP_MODE -+ _irqL irqL; -+ _list *plist, *phead; -+ struct rtw_wlan_acl_node *paclnode; -+ u8 match = false; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct wlan_acl_pool *pacl_list = &pstapriv->acl_list; -+ _queue *pacl_node_q =&pacl_list->acl_node_q; -+ -+ _enter_critical_bh(&(pacl_node_q->lock), &irqL); -+ phead = get_list_head(pacl_node_q); -+ plist = get_next(phead); -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list); -+ plist = get_next(plist); -+ -+ if(_rtw_memcmp(paclnode->addr, mac_addr, ETH_ALEN)) -+ { -+ if(paclnode->valid == true) -+ { -+ match = true; -+ break; -+ } -+ } -+ } -+ _exit_critical_bh(&(pacl_node_q->lock), &irqL); -+ -+ -+ if(pacl_list->mode == 1)//accept unless in deny list -+ { -+ res = (match == true) ? false:true; -+ } -+ else if(pacl_list->mode == 2)//deny unless in accept list -+ { -+ res = (match == true) ? true:false; -+ } -+ else -+ { -+ res = true; -+ } -+ -+#endif -+ -+ return res; -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_tdls.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_tdls.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_tdls.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_tdls.c 2018-02-06 17:42:30.700967016 +0200 -@@ -0,0 +1,2922 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_TDLS_C_ -+ -+#include -+#include "rtw_mlme.h" -+ -+#ifdef CONFIG_TDLS -+extern void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame); -+extern s32 rtw_dump_xframe(_adapter *padapter, struct xmit_frame *pxmitframe); -+ -+void rtw_reset_tdls_info(_adapter* padapter) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ ptdlsinfo->ap_prohibited = false; -+ ptdlsinfo->setup_state = TDLS_STATE_NONE; -+ ptdlsinfo->sta_cnt = 0; -+ ptdlsinfo->sta_maximum = false; -+ ptdlsinfo->macid_index= 6; -+ ptdlsinfo->clear_cam= 0; -+ ptdlsinfo->ch_sensing = 0; -+ ptdlsinfo->cur_channel = 0; -+ ptdlsinfo->candidate_ch = 1; //when inplement channel switching, default candidate channel is 1 -+ ptdlsinfo->watchdog_count = 0; -+ ptdlsinfo->dev_discovered = 0; -+ -+#ifdef CONFIG_WFD -+ ptdlsinfo->wfd_info = &padapter->wfd_info; -+#endif //CONFIG_WFD -+} -+ -+int rtw_init_tdls_info(_adapter* padapter) -+{ -+ int res = _SUCCESS; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ ptdlsinfo->enable = 1; -+ rtw_reset_tdls_info(padapter); -+ -+ _rtw_spinlock_init(&ptdlsinfo->cmd_lock); -+ _rtw_spinlock_init(&ptdlsinfo->hdl_lock); -+ -+ return res; -+ -+} -+ -+void rtw_free_tdls_info(struct tdls_info *ptdlsinfo) -+{ -+ _rtw_spinlock_free(&ptdlsinfo->cmd_lock); -+ _rtw_spinlock_free(&ptdlsinfo->hdl_lock); -+ -+ _rtw_memset(ptdlsinfo, 0, sizeof(struct tdls_info) ); -+ -+} -+ -+void issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, struct sta_info *ptdls_sta, unsigned int power_mode) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+// SetToDs(fctrl); -+ if (power_mode) -+ { -+ SetPwrMgt(fctrl); -+ } -+ -+ _rtw_memcpy(pwlanhdr->addr1, ptdls_sta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority]++; -+ ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; -+ pattrib->seqnum = ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority]; -+ SetSeqNum(pwlanhdr, pattrib->seqnum); -+ -+ SetFrameSubType(pframe, WIFI_DATA_NULL); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+} -+ -+s32 update_tdls_attrib(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv= &pmlmepriv->qospriv; -+ -+ s32 res=_SUCCESS; -+ sint bmcast; -+ -+ bmcast = IS_MCAST(pattrib->ra); -+ -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ if (psta == NULL) { -+ res =_FAIL; -+ goto exit; -+ } -+ -+ pattrib->mac_id = psta->mac_id; -+ -+ pattrib->psta = psta; -+ -+ pattrib->ack_policy = 0; -+ // get ether_hdr_len -+ pattrib->pkt_hdrlen = ETH_HLEN;//(pattrib->ether_type == 0x8100) ? (14 + 4 ): 14; //vlan tag -+ -+ if (pqospriv->qos_option && psta->qos_option) { -+ pattrib->priority = 1; //tdls management frame should be AC_BK -+ pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN; -+ pattrib->subtype = WIFI_QOS_DATA_TYPE; -+ } else { -+ pattrib->hdrlen = WLAN_HDR_A3_LEN; -+ pattrib->subtype = WIFI_DATA_TYPE; -+ pattrib->priority = 0; -+ } -+ -+ if (psta->ieee8021x_blocked == true) -+ { -+ pattrib->encrypt = 0; -+ } -+ else -+ { -+ GET_ENCRY_ALGO(psecuritypriv, psta, pattrib->encrypt, bmcast); -+ -+ switch(psecuritypriv->dot11AuthAlgrthm) -+ { -+ case dot11AuthAlgrthm_Open: -+ case dot11AuthAlgrthm_Shared: -+ case dot11AuthAlgrthm_Auto: -+ pattrib->key_idx = (u8)psecuritypriv->dot11PrivacyKeyIndex; -+ break; -+ case dot11AuthAlgrthm_8021X: -+ pattrib->key_idx = 0; -+ break; -+ default: -+ pattrib->key_idx = 0; -+ break; -+ } -+ } -+ -+ switch (pattrib->encrypt) -+ { -+ case _WEP40_: -+ case _WEP104_: -+ pattrib->iv_len = 4; -+ pattrib->icv_len = 4; -+ break; -+ case _TKIP_: -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 4; -+ if(padapter->securitypriv.busetkipkey==_FAIL) -+ { -+ res =_FAIL; -+ goto exit; -+ } -+ break; -+ case _AES_: -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 8; -+ break; -+ default: -+ pattrib->iv_len = 0; -+ pattrib->icv_len = 0; -+ break; -+ } -+ -+ if (pattrib->encrypt && -+ ((padapter->securitypriv.sw_encrypt == true) || (psecuritypriv->hw_decrypted == false))) -+ { -+ pattrib->bswenc = true; -+ } else { -+ pattrib->bswenc = false; -+ } -+ -+ //qos_en, ht_en, init rate, ,bw, ch_offset, sgi -+ pattrib->qos_en = psta->qos_option; -+ pattrib->ht_en = psta->htpriv.ht_option; -+ pattrib->raid = psta->raid; -+ pattrib->bwmode = psta->htpriv.bwmode; -+ pattrib->ch_offset = psta->htpriv.ch_offset; -+ pattrib->sgi= psta->htpriv.sgi; -+ pattrib->ampdu_en = false; -+ -+ //if(pattrib->ht_en && psta->htpriv.ampdu_enable) -+ //{ -+ // if(psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) -+ // pattrib->ampdu_en = true; -+ //} -+ -+exit: -+ -+ return res; -+} -+ -+void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ _irqL irqL; -+ -+ //free peer sta_info -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ if(ptdlsinfo->sta_cnt != 0) -+ ptdlsinfo->sta_cnt--; -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ if( ptdlsinfo->sta_cnt < (NUM_STA - 2) ) // -2: AP + BC/MC sta -+ { -+ ptdlsinfo->sta_maximum = false; -+ _rtw_memset( &ptdlsinfo->ss_record, 0x00, sizeof(struct tdls_ss_record) ); -+ } -+ //ready to clear cam -+ if(ptdls_sta->mac_id!=0){ -+ ptdlsinfo->clear_cam=ptdls_sta->mac_id; -+ rtw_setstakey_cmd(padapter, (u8 *)ptdls_sta, true); -+ } -+ -+ if(ptdlsinfo->sta_cnt==0){ -+ rtw_tdls_cmd(padapter, myid(&(padapter->eeprompriv)), TDLS_RS_RCR); -+ ptdlsinfo->setup_state=TDLS_STATE_NONE; -+ } -+ else -+ DBG_871X("Remain tdls sta:%02x\n", ptdlsinfo->sta_cnt); -+ -+ rtw_free_stainfo(padapter, ptdls_sta); -+ -+} -+ -+// cam entry will be the same as mac_id -+void rtw_tdls_set_mac_id(struct tdls_info *ptdlsinfo, struct sta_info *ptdls_sta) -+{ -+ if(ptdls_sta->mac_id==0) -+ { -+ ptdls_sta->mac_id = ptdlsinfo->macid_index; -+ if( (++ptdlsinfo->macid_index) > (NUM_STA -2) ) -+ ptdlsinfo->macid_index= TDLS_INI_MACID_ENTRY; -+ } -+} -+ -+//TDLS encryption(if needed) will always be CCMP -+void rtw_tdls_set_key(_adapter *adapter, struct rx_pkt_attrib *prx_pkt_attrib, struct sta_info *ptdls_sta) -+{ -+ if(prx_pkt_attrib->encrypt) -+ { -+ ptdls_sta->dot118021XPrivacy=_AES_; -+ rtw_setstakey_cmd(adapter, (u8*)ptdls_sta, true); -+ } -+} -+ -+void rtw_tdls_process_ht_cap(_adapter *adapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) -+{ -+ /* save HT capabilities in the sta object */ -+ _rtw_memset(&ptdls_sta->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); -+ if (data && Length >= sizeof(struct rtw_ieee80211_ht_cap) ) -+ { -+ ptdls_sta->flags |= WLAN_STA_HT; -+ -+ ptdls_sta->flags |= WLAN_STA_WME; -+ -+ _rtw_memcpy(&ptdls_sta->htpriv.ht_cap, data, sizeof(struct rtw_ieee80211_ht_cap)); -+ -+ } else -+ ptdls_sta->flags &= ~WLAN_STA_HT; -+ -+ if(ptdls_sta->flags & WLAN_STA_HT) -+ { -+ if(adapter->registrypriv.ht_enable == true) -+ { -+ ptdls_sta->htpriv.ht_option = true; -+ } -+ else -+ { -+ ptdls_sta->htpriv.ht_option = false; -+ ptdls_sta->stat_code = _STATS_FAILURE_; -+ } -+ } -+ -+ //HT related cap -+ if(ptdls_sta->htpriv.ht_option) -+ { -+ //check if sta supports rx ampdu -+ if(adapter->registrypriv.ampdu_enable==1) -+ ptdls_sta->htpriv.ampdu_enable = true; -+ -+ //check if sta support s Short GI -+ if(ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_20|IEEE80211_HT_CAP_SGI_40)) -+ { -+ ptdls_sta->htpriv.sgi = true; -+ } -+ -+ // bwmode would still followed AP's setting -+ if(ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) -+ { -+ ptdls_sta->htpriv.bwmode = adapter->mlmeextpriv.cur_bwmode; -+ ptdls_sta->htpriv.ch_offset = adapter->mlmeextpriv.cur_ch_offset; -+ } -+ } -+} -+ -+u8 *rtw_tdls_set_ht_cap(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ struct rtw_ieee80211_ht_cap ht_capie; -+ u8 rf_type; -+ -+ //HT capabilities -+ _rtw_memset(&ht_capie, 0, sizeof(struct rtw_ieee80211_ht_cap)); -+ -+ ht_capie.cap_info = IEEE80211_HT_CAP_SUP_WIDTH |IEEE80211_HT_CAP_SGI_20 |IEEE80211_HT_CAP_SM_PS | -+ IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_TX_STBC |IEEE80211_HT_CAP_DSSSCCK40; -+ -+ { -+ u32 rx_packet_offset, max_recvbuf_sz; -+ padapter->HalFunc.GetHalDefVarHandler(padapter, HAL_DEF_RX_PACKET_OFFSET, &rx_packet_offset); -+ padapter->HalFunc.GetHalDefVarHandler(padapter, HAL_DEF_MAX_RECVBUF_SZ, &max_recvbuf_sz); -+ if(max_recvbuf_sz-rx_packet_offset>(8191-256)) -+ ht_capie.cap_info = ht_capie.cap_info |IEEE80211_HT_CAP_MAX_AMSDU; -+ } -+ -+ ht_capie.ampdu_params_info = (IEEE80211_HT_CAP_AMPDU_FACTOR&0x03); -+ -+ padapter->HalFunc.GetHwRegHandler(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ switch(rf_type) -+ { -+ case RF_1T1R: -+ ht_capie.cap_info |= 0x0100;//RX STBC One spatial stream -+ _rtw_memcpy(ht_capie.supp_mcs_set, MCS_rate_1R, 16); -+ break; -+ -+ case RF_2T2R: -+ case RF_1T2R: -+ default: -+ ht_capie.cap_info|= 0x0200;//RX STBC two spatial stream -+ _rtw_memcpy(ht_capie.supp_mcs_set, MCS_rate_2R, 16); -+ break; -+ } -+ -+ return(rtw_set_ie(pframe, _HT_CAPABILITY_IE_, -+ sizeof(struct rtw_ieee80211_ht_cap), (unsigned char*)&ht_capie, &(pattrib->pktlen))); -+} -+ -+u8 *rtw_tdls_set_sup_ch(struct mlme_ext_priv *pmlmeext, u8 *pframe, struct pkt_attrib *pattrib) -+{ -+ u8 sup_ch[ 30 * 2 ] = { 0x00 }, sup_ch_idx = 0, idx_5g = 2; //For supported channel -+ do{ -+ if( pmlmeext->channel_set[sup_ch_idx].ChannelNum <= 14 ) -+ { -+ sup_ch[0] = 1; //First channel number -+ sup_ch[1] = pmlmeext->channel_set[sup_ch_idx].ChannelNum; //Number of channel -+ } -+ else -+ { -+ sup_ch[idx_5g++] = pmlmeext->channel_set[sup_ch_idx].ChannelNum; -+ sup_ch[idx_5g++] = 1; -+ } -+ -+ sup_ch_idx++; -+ } -+ while( pmlmeext->channel_set[sup_ch_idx].ChannelNum != 0 ); -+ return(rtw_set_ie(pframe, _SUPPORTED_CH_IE_, idx_5g, sup_ch, &(pattrib->pktlen))); -+} -+ -+#ifdef CONFIG_WFD -+void rtw_tdls_process_wfd_ie(struct tdls_info *ptdlsinfo, u8 *ptr, u8 length) -+{ -+ u8 wfd_ie[ 128 ] = { 0x00 }; -+ u32 wfd_ielen = 0; -+ u32 wfd_offset = 0; -+ // Try to get the TCP port information when receiving the negotiation response. -+ // -+ -+ wfd_offset = 0; -+ wfd_offset = rtw_get_wfd_ie( ptr + wfd_offset, length - wfd_offset, wfd_ie, &wfd_ielen ); -+ while( wfd_offset ) -+ { -+ u8 attr_content[ 10 ] = { 0x00 }; -+ u32 attr_contentlen = 0; -+ int i; -+ -+ DBG_871X( "[%s] WFD IE Found!!\n", __FUNCTION__ ); -+ rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, attr_content, &attr_contentlen); -+ if ( attr_contentlen ) -+ { -+ ptdlsinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16( attr_content + 2 ); -+ DBG_871X( "[%s] Peer PORT NUM = %d\n", __FUNCTION__, ptdlsinfo->wfd_info->peer_rtsp_ctrlport ); -+ } -+ -+ _rtw_memset( attr_content, 0x00, 10); -+ attr_contentlen = 0; -+ rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_LOCAL_IP_ADDR, attr_content, &attr_contentlen); -+ if ( attr_contentlen ) -+ { -+ _rtw_memcpy(ptdlsinfo->wfd_info->peer_ip_address, ( attr_content + 1 ), 4); -+ DBG_871X( "[%s] Peer IP = %02u.%02u.%02u.%02u \n", __FUNCTION__, -+ ptdlsinfo->wfd_info->peer_ip_address[0], ptdlsinfo->wfd_info->peer_ip_address[1], -+ ptdlsinfo->wfd_info->peer_ip_address[2], ptdlsinfo->wfd_info->peer_ip_address[3] -+ ); -+ } -+ wfd_offset = rtw_get_wfd_ie( ptr + wfd_offset, length - wfd_offset, wfd_ie, &wfd_ielen ); -+ } -+} -+ -+void issue_tunneled_probe_req(_adapter *padapter) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ u8 baddr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ DBG_871X("[%s]\n", __FUNCTION__); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, baddr, ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel=pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TUNNELED_PROBE_REQ) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ rtw_dump_xframe(padapter, pmgntframe); -+ -+exit: -+ -+ return; -+} -+ -+void issue_tunneled_probe_rsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct rx_pkt_attrib *rx_pkt_pattrib = &precv_frame->u.hdr.attrib; -+ -+ DBG_871X("[%s]\n", __FUNCTION__); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, rx_pkt_pattrib->src, ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel=pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TUNNELED_PROBE_RSP) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ rtw_dump_xframe(padapter, pmgntframe); -+ -+exit: -+ -+ return; -+} -+#endif //CONFIG_WFD -+ -+void issue_tdls_setup_req(_adapter *padapter, u8 *mac_addr) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta= NULL; -+ _irqL irqL; -+ static u8 dialogtoken = 0; -+ u32 timeout_interval= TPK_RESEND_COUNT * 1000; //retry timer should set at least 301 sec, using TPK_count counting 301 times. -+ -+ if(ptdlsinfo->ap_prohibited == true) -+ goto exit; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, mac_addr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ -+ //init peer sta_info -+ ptdls_sta = rtw_get_stainfo(pstapriv, mac_addr); -+ if(ptdls_sta==NULL) -+ { -+ ptdls_sta = rtw_alloc_stainfo(pstapriv, mac_addr); -+ if(ptdls_sta) -+ { -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ if(!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) -+ ptdlsinfo->sta_cnt++; -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ if( ptdlsinfo->sta_cnt == (NUM_STA - 2) ) // -2: AP + BC/MC sta -+ { -+ ptdlsinfo->sta_maximum = true; -+ } -+ } -+ else -+ { -+ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ } -+ -+ if(ptdls_sta){ -+ ptdls_sta->tdls_sta_state |= TDLS_RESPONDER_STATE; -+ //for tdls; ptdls_sta->aid is used to fill dialogtoken -+ ptdls_sta->dialog = dialogtoken; -+ dialogtoken = (dialogtoken+1)%256; -+ ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; -+ _set_timer( &ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME ); -+ } -+ -+ pattrib->qsel=pattrib->priority; -+ if(rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_SETUP_REQUEST) !=_SUCCESS ){ -+ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ rtw_dump_xframe(padapter, pmgntframe); -+ -+exit: -+ -+ return; -+} -+ -+void issue_tdls_teardown(_adapter *padapter, u8 *mac_addr) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta=NULL; -+ _irqL irqL; -+ -+ ptdls_sta = rtw_get_stainfo(pstapriv, mac_addr); -+ if(ptdls_sta==NULL){ -+ DBG_871X("issue tdls teardown unsuccessful\n"); -+ return; -+ }else{ -+ ptdls_sta->tdls_sta_state=TDLS_STATE_NONE; -+ } -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, mac_addr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel=pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_TEARDOWN) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ rtw_dump_xframe(padapter, pmgntframe); -+ -+ if(ptdls_sta->tdls_sta_state & TDLS_CH_SWITCH_ON_STATE){ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CS_OFF); -+ } -+ -+ if( ptdls_sta->timer_flag == 1 ) -+ { -+ _enter_critical_bh(&(padapter->tdlsinfo.hdl_lock), &irqL); -+ ptdls_sta->timer_flag = 2; -+ _exit_critical_bh(&(padapter->tdlsinfo.hdl_lock), &irqL); -+ } -+ else -+ rtw_tdls_cmd(padapter, mac_addr, TDLS_FREE_STA ); -+ -+ -+exit: -+ -+ return; -+} -+ -+void issue_tdls_dis_req(_adapter *padapter, u8 *mac_addr) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ u8 baddr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ if(mac_addr == NULL) -+ _rtw_memcpy(pattrib->dst, baddr, ETH_ALEN); -+ else -+ _rtw_memcpy(pattrib->dst, mac_addr, ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel=pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_DISCOVERY_REQUEST) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ rtw_dump_xframe(padapter, pmgntframe); -+ DBG_871X("issue tdls dis req\n"); -+ -+exit: -+ -+ return; -+} -+ -+void issue_tdls_setup_rsp(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct rx_pkt_attrib *rx_pkt_pattrib = &precv_frame->u.hdr.attrib; -+ _irqL irqL; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, rx_pkt_pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->ra, rx_pkt_pattrib->bssid, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel=pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_SETUP_RESPONSE) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ rtw_dump_xframe(padapter, pmgntframe); -+ -+exit: -+ -+ return; -+ -+} -+ -+void issue_tdls_setup_cfm(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct sta_info *ptdls_sta=NULL; -+ _irqL irqL; -+ -+ struct rx_pkt_attrib *rx_pkt_pattrib = & precv_frame->u.hdr.attrib; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, rx_pkt_pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->ra, rx_pkt_pattrib->bssid, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel=pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_SETUP_CONFIRM) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ -+ rtw_dump_xframe(padapter, pmgntframe); -+ -+exit: -+ -+ return; -+ -+} -+ -+//TDLS Discovery Response frame is a management action frame -+void issue_tdls_dis_rsp(_adapter *padapter, union recv_frame *precv_frame, u8 dialog) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ struct rx_pkt_attrib *rx_pkt_pattrib = &precv_frame->u.hdr.attrib; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ // unicast probe request frame -+ _rtw_memcpy(pwlanhdr->addr1, rx_pkt_pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pattrib->dst, pwlanhdr->addr1, ETH_ALEN); -+ -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pattrib->src, pwlanhdr->addr2, ETH_ALEN); -+ -+ _rtw_memcpy(pwlanhdr->addr3, rx_pkt_pattrib->bssid, ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pwlanhdr->addr3, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof (struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof (struct rtw_ieee80211_hdr_3addr); -+ -+ rtw_build_tdls_dis_rsp_ies(padapter, pmgntframe, pframe, dialog); -+ -+ pattrib->nr_frags = 1; -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ return; -+} -+ -+void issue_tdls_peer_traffic_indication(_adapter *padapter, struct sta_info *ptdls_sta) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ -+ static u8 dialogtoken=0; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ //for tdls; pattrib->nr_frags is used to fill dialogtoken -+ ptdls_sta->dialog = dialogtoken; -+ dialogtoken = (dialogtoken+1)%256; -+ //PTI frame's priority should be AC_VO -+ pattrib->priority = 7; -+ -+ update_tdls_attrib(padapter, pattrib); -+ pattrib->qsel=pattrib->priority; -+ if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_PEER_TRAFFIC_INDICATION) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ rtw_dump_xframe(padapter, pmgntframe); -+ -+exit: -+ -+ return; -+} -+ -+void issue_tdls_ch_switch_req(_adapter *padapter, u8 *mac_addr) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, mac_addr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ -+ pattrib->qsel=pattrib->priority; -+ if(rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_CHANNEL_SWITCH_REQUEST) !=_SUCCESS ){ -+ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ rtw_dump_xframe(padapter, pmgntframe); -+ -+exit: -+ -+ return; -+} -+ -+void issue_tdls_ch_switch_rsp(_adapter *padapter, u8 *mac_addr) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ -+ _irqL irqL; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ -+ pmgntframe->frame_tag = DATA_FRAMETAG; -+ pattrib->ether_type = 0x890d; -+ -+ _rtw_memcpy(pattrib->dst, mac_addr, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ -+ update_tdls_attrib(padapter, pattrib); -+ -+ pattrib->qsel=pattrib->priority; -+/* -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ if(xmitframe_enqueue_for_tdls_sleeping_sta(padapter, pmgntframe)==true){ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ return false; -+ } -+*/ -+ if(rtw_xmit_tdls_coalesce(padapter, pmgntframe, TDLS_CHANNEL_SWITCH_RESPONSE) !=_SUCCESS ){ -+ rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pmgntframe); -+ goto exit; -+ } -+ rtw_dump_xframe(padapter, pmgntframe); -+ -+exit: -+ -+ return; -+} -+ -+sint On_TDLS_Dis_Rsp(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct sta_info *ptdls_sta = NULL, *psta = rtw_get_stainfo(&(adapter->stapriv), get_bssid(&(adapter->mlmepriv))); -+ struct recv_priv *precvpriv = &(adapter->recvpriv); -+ u8 *ptr = precv_frame->u.hdr.rx_data, *psa; -+ struct rx_pkt_attrib *pattrib = &(precv_frame->u.hdr.attrib); -+ struct tdls_info *ptdlsinfo = &(adapter->tdlsinfo); -+ u8 empty_addr[ETH_ALEN] = { 0x00 }; -+ int UndecoratedSmoothedPWDB; -+ -+ -+ //WFDTDLS: for sigma test, not to setup direct link automatically -+ ptdlsinfo->dev_discovered = 1; -+ -+#ifdef CONFIG_TDLS_AUTOSETUP -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(&(adapter->stapriv), psa); -+ -+ if(ptdls_sta != NULL) -+ { -+ ptdls_sta->tdls_sta_state |= TDLS_ALIVE_STATE; -+ -+ //Record the tdls sta with lowest signal strength -+ if( (ptdlsinfo->sta_maximum == true) && (ptdls_sta->alive_count >= 1) ) -+ { -+ if( _rtw_memcmp(ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN) ) -+ { -+ _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); -+ ptdlsinfo->ss_record.RxPWDBAll = pattrib->RxPWDBAll; -+ } -+ else -+ { -+ if( ptdlsinfo->ss_record.RxPWDBAll < pattrib->RxPWDBAll ) -+ { -+ _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); -+ ptdlsinfo->ss_record.RxPWDBAll = pattrib->RxPWDBAll; -+ } -+ } -+ } -+ -+ } -+ else -+ { -+ if( ptdlsinfo->sta_maximum == true) -+ { -+ if( _rtw_memcmp( ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN ) ) -+ { -+ //All traffics are busy, do not set up another direct link. -+ return _FAIL; -+ } -+ else -+ { -+ if( pattrib->RxPWDBAll > ptdlsinfo->ss_record.RxPWDBAll ) -+ { -+ issue_tdls_teardown(adapter, ptdlsinfo->ss_record.macaddr); -+ } -+ else -+ { -+ return _FAIL; -+ } -+ } -+ } -+ -+ adapter->HalFunc.GetHalDefVarHandler(adapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); -+ -+ if( pattrib->RxPWDBAll + TDLS_SIGNAL_THRESH >= UndecoratedSmoothedPWDB); -+ { -+ DBG_871X("pattrib->RxPWDBAll=%d, pdmpriv->UndecoratedSmoothedPWDB=%d\n", pattrib->RxPWDBAll, UndecoratedSmoothedPWDB); -+ issue_tdls_setup_req(adapter, psa); -+ } -+ } -+#endif //CONFIG_TDLS_AUTOSETUP -+ -+ return _SUCCESS; -+} -+ -+sint On_TDLS_Setup_Req(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; -+ u8 *psa, *pmyid; -+ struct sta_info *ptdls_sta= NULL; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ struct security_priv *psecuritypriv = &adapter->securitypriv; -+ _irqL irqL; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *prsnie, *ppairwise_cipher; -+ u8 i, k, pairwise_count; -+ u8 ccmp_have=0, rsnie_have=0; -+ u16 j; -+ u8 SNonce[32]; -+ u32 *timeout_interval; -+ sint parsing_length; //frame body length, without icv_len -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 5; -+ unsigned char supportRate[16]; -+ int supportRateNum = 0; -+ -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ pmyid=myid(&(adapter->eeprompriv)); -+ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+TYPE_LENGTH_FIELD_SIZE+1; -+ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len -+ -prx_pkt_attrib->hdrlen -+ -prx_pkt_attrib->iv_len -+ -prx_pkt_attrib->icv_len -+ -LLC_HEADER_SIZE -+ -ETH_TYPE_LEN -+ -PAYLOAD_TYPE_LEN -+ -FIXED_IE; -+ -+ if(ptdlsinfo->ap_prohibited == true) -+ { -+ goto exit; -+ } -+ -+ if(ptdls_sta==NULL){ -+ ptdls_sta = rtw_alloc_stainfo(pstapriv, psa); -+ }else{ -+ if(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE){ -+ //If the direct link is already set up -+ //Process as re-setup after tear down -+ DBG_871X("re-setup a direct link\n"); -+ } -+ //already receiving TDLS setup request -+ else if(ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE){ -+ DBG_871X("receive duplicated TDLS setup request frame in handshaking\n"); -+ goto exit; -+ } -+ //When receiving and sending setup_req to the same link at the same time, STA with higher MAC_addr would be initiator -+ //following is to check out MAC_addr -+ else if(ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE){ -+ DBG_871X("receive setup_req after sending setup_req\n"); -+ for (i=0;i<6;i++){ -+ if(*(pmyid+i)==*(psa+i)){ -+ } -+ else if(*(pmyid+i)>*(psa+i)){ -+ goto exit; -+ }else if(*(pmyid+i)<*(psa+i)){ -+ ptdls_sta->tdls_sta_state=TDLS_INITIATOR_STATE; -+ break; -+ } -+ } -+ } -+ } -+ -+ if(ptdls_sta) -+ { -+ ptdls_sta->dialog = *(ptr+2); //copy dialog token -+ ptdls_sta->stat_code = 0; -+ -+ //parsing information element -+ for(j=FIXED_IE; jElementID) -+ { -+ case _SUPPORTEDRATES_IE_: -+ _rtw_memcpy(supportRate, pIE->data, pIE->Length); -+ supportRateNum = pIE->Length; -+ break; -+ case _COUNTRY_IE_: -+ break; -+ case _EXT_SUPPORTEDRATES_IE_: -+ if(supportRateNum<=sizeof(supportRate)) -+ { -+ _rtw_memcpy(supportRate+supportRateNum, pIE->data, pIE->Length); -+ supportRateNum += pIE->Length; -+ } -+ break; -+ case _SUPPORTED_CH_IE_: -+ break; -+ case _RSN_IE_2_: -+ rsnie_have=1; -+ if(prx_pkt_attrib->encrypt){ -+ prsnie=(u8*)pIE; -+ //check whether initiator STA has CCMP pairwise_cipher. -+ ppairwise_cipher=prsnie+10; -+ _rtw_memcpy(&pairwise_count, (u16*)(ppairwise_cipher-2), 1); -+ for(k=0;kstat_code=72; -+ } -+ } -+ break; -+ case _EXT_CAP_IE_: -+ break; -+ case _VENDOR_SPECIFIC_IE_: -+ break; -+ case _FTIE_: -+ if(prx_pkt_attrib->encrypt) -+ _rtw_memcpy(SNonce, (ptr+j+52), 32); -+ break; -+ case _TIMEOUT_ITVL_IE_: -+ if(prx_pkt_attrib->encrypt) -+ timeout_interval = (u32 *)(ptr+j+3); -+ break; -+ case _RIC_Descriptor_IE_: -+ break; -+ case _HT_CAPABILITY_IE_: -+ rtw_tdls_process_ht_cap(adapter, ptdls_sta, pIE->data, pIE->Length); -+ break; -+ case EID_BSSCoexistence: -+ break; -+ case _LINK_ID_IE_: -+ if(_rtw_memcmp(get_bssid(pmlmepriv), pIE->data, 6) == false) -+ { -+ //not in the same BSS -+ ptdls_sta->stat_code=7; -+ } -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ //update station supportRate -+ ptdls_sta->bssratelen = supportRateNum; -+ _rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum); -+ -+ //check status code -+ //if responder STA has/hasn't security on AP, but request hasn't/has RSNIE, it should reject -+ if(ptdls_sta->stat_code == 0 ) -+ { -+ if(rsnie_have && (prx_pkt_attrib->encrypt==0)){ -+ //security disabled -+ ptdls_sta->stat_code = 5; -+ }else if(rsnie_have==0 && (prx_pkt_attrib->encrypt)){ -+ //request haven't RSNIE -+ ptdls_sta->stat_code = 38; -+ } -+ -+#ifdef CONFIG_WFD -+ //WFD test plan version 0.18.2 test item 5.1.5 -+ //SoUT does not use TDLS if AP uses weak security -+ if ( adapter->wdinfo.wfd_tdls_enable ) -+ { -+ if(rsnie_have && (prx_pkt_attrib->encrypt != _AES_)) -+ { -+ ptdls_sta->stat_code = 5; -+ } -+ } -+#endif //CONFIG_WFD -+ } -+ -+ ptdls_sta->tdls_sta_state|= TDLS_INITIATOR_STATE; -+ if(prx_pkt_attrib->encrypt){ -+ _rtw_memcpy(ptdls_sta->SNonce, SNonce, 32); -+ _rtw_memcpy(&(ptdls_sta->TDLS_PeerKey_Lifetime), timeout_interval, 4); -+ } -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ if(!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) -+ ptdlsinfo->sta_cnt++; -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ if( ptdlsinfo->sta_cnt == (NUM_STA - 2) ) // -2: AP + BC/MC sta -+ { -+ ptdlsinfo->sta_maximum = true; -+ } -+ -+#ifdef CONFIG_WFD -+ rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length - FIXED_IE); -+#endif // CONFIG_WFD -+ -+ } -+ else -+ { -+ goto exit; -+ } -+ -+ issue_tdls_setup_rsp(adapter, precv_frame); -+ -+ if(ptdls_sta->stat_code==0) -+ { -+ _set_timer( &ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME); -+ } -+ else //status code!=0 ; setup unsuccess -+ { -+ free_tdls_sta(adapter, ptdls_sta); -+ } -+ -+exit: -+ -+ return _FAIL; -+} -+ -+sint On_TDLS_Setup_Rsp(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; -+ struct sta_info *ptdls_sta= NULL; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ _irqL irqL; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *psa; -+ u16 stat_code; -+ sint parsing_length; //frame body length, without icv_len -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE =7; -+ u8 *pftie, *ptimeout_ie, *plinkid_ie, *prsnie, *pftie_mic, *ppairwise_cipher; -+ u16 pairwise_count, j, k; -+ u8 verify_ccmp=0; -+ unsigned char supportRate[16]; -+ int supportRateNum = 0; -+ -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ if ( NULL == ptdls_sta ) -+ { -+ return _FAIL; -+ } -+ -+ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+TYPE_LENGTH_FIELD_SIZE+1; -+ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len -+ -prx_pkt_attrib->hdrlen -+ -prx_pkt_attrib->iv_len -+ -prx_pkt_attrib->icv_len -+ -LLC_HEADER_SIZE -+ -TYPE_LENGTH_FIELD_SIZE -+ -1 -+ -FIXED_IE; -+ -+ _rtw_memcpy(&stat_code, ptr+2, 2); -+ -+ if(stat_code!=0) -+ { -+ DBG_871X( "[%s] status_code = %d, free_tdls_sta\n", __FUNCTION__, stat_code ); -+ free_tdls_sta(adapter, ptdls_sta); -+ return _FAIL; -+ } -+ -+ stat_code = 0; -+ -+ //parsing information element -+ for(j=FIXED_IE; jElementID) -+ { -+ case _SUPPORTEDRATES_IE_: -+ _rtw_memcpy(supportRate, pIE->data, pIE->Length); -+ supportRateNum = pIE->Length; -+ break; -+ case _COUNTRY_IE_: -+ break; -+ case _EXT_SUPPORTEDRATES_IE_: -+ if(supportRateNum<=sizeof(supportRate)) -+ { -+ _rtw_memcpy(supportRate+supportRateNum, pIE->data, pIE->Length); -+ supportRateNum += pIE->Length; -+ } -+ break; -+ case _SUPPORTED_CH_IE_: -+ break; -+ case _RSN_IE_2_: -+ prsnie=(u8*)pIE; -+ //check whether responder STA has CCMP pairwise_cipher. -+ ppairwise_cipher=prsnie+10; -+ _rtw_memcpy(&pairwise_count, (u16*)(ppairwise_cipher-2), 2); -+ for(k=0;kANonce, (ptr+j+20), 32); -+ break; -+ case _TIMEOUT_ITVL_IE_: -+ ptimeout_ie=(u8*)pIE; -+ break; -+ case _RIC_Descriptor_IE_: -+ break; -+ case _HT_CAPABILITY_IE_: -+ rtw_tdls_process_ht_cap(adapter, ptdls_sta, pIE->data, pIE->Length); -+ break; -+ case EID_BSSCoexistence: -+ break; -+ case _LINK_ID_IE_: -+ plinkid_ie=(u8*)pIE; -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ //update station supportRate -+ ptdls_sta->bssratelen = supportRateNum; -+ _rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum); -+ -+#ifdef CONFIG_WFD -+ rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length - FIXED_IE); -+#endif // CONFIG_WFD -+ -+ if(stat_code != 0) -+ { -+ ptdls_sta->stat_code = stat_code; -+ } -+ else -+ { -+ if(prx_pkt_attrib->encrypt) -+ { -+ if(verify_ccmp==1) -+ { -+ wpa_tdls_generate_tpk(adapter, ptdls_sta); -+ ptdls_sta->stat_code=0; -+ if(tdls_verify_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie)==0) //0: Invalid, 1: valid -+ { -+ free_tdls_sta(adapter, ptdls_sta); -+ return _FAIL; -+ } -+ } -+ else -+ { -+ ptdls_sta->stat_code=72; //invalide contents of RSNIE -+ } -+ -+ }else{ -+ ptdls_sta->stat_code=0; -+ } -+ } -+ -+ DBG_871X("issue_tdls_setup_cfm\n"); -+ issue_tdls_setup_cfm(adapter, precv_frame); -+ -+ if(ptdls_sta->stat_code==0) -+ { -+ ptdlsinfo->setup_state = TDLS_LINKED_STATE; -+ -+ if( ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE ) -+ { -+ ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; -+ _cancel_timer_ex( &ptdls_sta->handshake_timer); -+#ifdef CONFIG_TDLS_AUTOCHECKALIVE -+ _set_timer( &ptdls_sta->alive_timer1, TDLS_ALIVE_TIMER_PH1); -+#endif //CONFIG_TDLS_AUTOSETUP -+ } -+ -+ rtw_tdls_set_mac_id(ptdlsinfo, ptdls_sta); -+ rtw_tdls_set_key(adapter, prx_pkt_attrib, ptdls_sta); -+ -+ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_WRCR); -+ -+ } -+ else //status code!=0 ; setup unsuccessful -+ { -+ free_tdls_sta(adapter, ptdls_sta); -+ } -+ -+ return _FAIL; -+ -+} -+ -+sint On_TDLS_Setup_Cfm(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; -+ struct sta_info *ptdls_sta= NULL; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ _irqL irqL; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *psa; -+ u16 stat_code; -+ sint parsing_length; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE =5; -+ u8 *pftie, *ptimeout_ie, *plinkid_ie, *prsnie, *pftie_mic, *ppairwise_cipher; -+ u16 j, pairwise_count; -+ -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+TYPE_LENGTH_FIELD_SIZE+1; -+ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len -+ -prx_pkt_attrib->hdrlen -+ -prx_pkt_attrib->iv_len -+ -prx_pkt_attrib->icv_len -+ -LLC_HEADER_SIZE -+ -ETH_TYPE_LEN -+ -PAYLOAD_TYPE_LEN -+ -FIXED_IE; -+ _rtw_memcpy(&stat_code, ptr+2, 2); -+ -+ if(stat_code!=0){ -+ DBG_871X( "[%s] stat_code = %d\n, free_tdls_sta", __FUNCTION__, stat_code ); -+ free_tdls_sta(adapter, ptdls_sta); -+ return _FAIL; -+ } -+ -+ if(prx_pkt_attrib->encrypt){ -+ //parsing information element -+ for(j=FIXED_IE; jElementID) -+ { -+ case _RSN_IE_2_: -+ prsnie=(u8*)pIE; -+ break; -+ case _VENDOR_SPECIFIC_IE_: -+ break; -+ case _FTIE_: -+ pftie=(u8*)pIE; -+ break; -+ case _TIMEOUT_ITVL_IE_: -+ ptimeout_ie=(u8*)pIE; -+ break; -+ case _HT_EXTRA_INFO_IE_: -+ break; -+ case _LINK_ID_IE_: -+ plinkid_ie=(u8*)pIE; -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ //verify mic in FTIE MIC field -+ if(tdls_verify_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie)==0){ //0: Invalid, 1: Valid -+ free_tdls_sta(adapter, ptdls_sta); -+ return _FAIL; -+ } -+ -+ } -+ -+ ptdlsinfo->setup_state = TDLS_LINKED_STATE; -+ if( ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE ) -+ { -+ ptdls_sta->tdls_sta_state|=TDLS_LINKED_STATE; -+ _cancel_timer_ex( &ptdls_sta->handshake_timer); -+#ifdef CONFIG_TDLS_AUTOCHECKALIVE -+ _set_timer( &ptdls_sta->alive_timer1, TDLS_ALIVE_TIMER_PH1); -+#endif //CONFIG_TDLS_AUTOCHECKALIVE -+ } -+ -+ rtw_tdls_set_mac_id(ptdlsinfo, ptdls_sta); -+ rtw_tdls_set_key(adapter, prx_pkt_attrib, ptdls_sta); -+ -+ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_WRCR); -+ -+ return _FAIL; -+ -+} -+ -+sint On_TDLS_Dis_Req(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *psta_ap; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ sint parsing_length; //frame body length, without icv_len -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE = 3, *dst, *pdialog = NULL; -+ u16 j; -+ -+ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE+TYPE_LENGTH_FIELD_SIZE + 1; -+ pdialog=ptr+2; -+ -+ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len -+ -prx_pkt_attrib->hdrlen -+ -prx_pkt_attrib->iv_len -+ -prx_pkt_attrib->icv_len -+ -LLC_HEADER_SIZE -+ -TYPE_LENGTH_FIELD_SIZE -+ -1 -+ -FIXED_IE; -+ -+ //parsing information element -+ for(j=FIXED_IE; jElementID) -+ { -+ case _LINK_ID_IE_: -+ psta_ap = rtw_get_stainfo(pstapriv, pIE->data); -+ if(psta_ap == NULL) -+ { -+ goto exit; -+ } -+ dst = pIE->data + 12; -+ if( (MacAddr_isBcst(dst) == false) && (_rtw_memcmp(myid(&(adapter->eeprompriv)), dst, 6) == false) ) -+ { -+ goto exit; -+ } -+ break; -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ //check frame contents -+ -+ issue_tdls_dis_rsp(adapter, precv_frame, *(pdialog) ); -+ -+exit: -+ -+ return _FAIL; -+ -+} -+ -+sint On_TDLS_Teardown(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ u8 *psa; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ struct sta_info *ptdls_sta= NULL; -+ _irqL irqL; -+ -+ psa = get_sa(ptr); -+ -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ if(ptdls_sta!=NULL){ -+ if(ptdls_sta->tdls_sta_state & TDLS_CH_SWITCH_ON_STATE){ -+ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_CS_OFF); -+ } -+ free_tdls_sta(adapter, ptdls_sta); -+ } -+ -+ return _FAIL; -+ -+} -+ -+u8 TDLS_check_ch_state(uint state){ -+ if( (state & TDLS_CH_SWITCH_ON_STATE) && -+ (state & TDLS_AT_OFF_CH_STATE) && -+ (state & TDLS_PEER_AT_OFF_STATE) ){ -+ -+ if(state & TDLS_PEER_SLEEP_STATE) -+ return 2; //U-APSD + ch. switch -+ else -+ return 1; //ch. switch -+ }else -+ return 0; -+} -+ -+//we process buffered data for 1. U-APSD, 2. ch. switch, 3. U-APSD + ch. switch here -+sint On_TDLS_Peer_Traffic_Rsp(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct tdls_info *ptdlsinfo = &adapter->tdlsinfo; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ //get peer sta infomation -+ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->src); -+ u8 wmmps_ac=0, state=TDLS_check_ch_state(ptdls_sta->tdls_sta_state); -+ int i; -+ -+ ptdls_sta->sta_stats.rx_data_pkts++; -+ -+ //receive peer traffic response frame, sleeping STA wakes up -+ //ptdls_sta->tdls_sta_state &= ~(TDLS_PEER_SLEEP_STATE); -+ process_wmmps_data( adapter, precv_frame); -+ -+ // if noticed peer STA wakes up by receiving peer traffic response -+ // and we want to do channel swtiching, then we will transmit channel switch request first -+ if(ptdls_sta->tdls_sta_state & TDLS_APSD_CHSW_STATE){ -+ issue_tdls_ch_switch_req(adapter, pattrib->src); -+ ptdls_sta->tdls_sta_state &= ~(TDLS_APSD_CHSW_STATE); -+ return _FAIL; -+ } -+ -+ //check 4-AC queue bit -+ if(ptdls_sta->uapsd_vo || ptdls_sta->uapsd_vi || ptdls_sta->uapsd_be || ptdls_sta->uapsd_bk) -+ wmmps_ac=1; -+ -+ //if it's a direct link and have buffered frame -+ if(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE){ -+ if(wmmps_ac && state) -+ { -+ _irqL irqL; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe=NULL; -+ -+ _enter_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&ptdls_sta->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ //transmit buffered frames -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) -+ { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ xmitframe_plist = get_next(xmitframe_plist); -+ rtw_list_delete(&pxmitframe->list); -+ -+ ptdls_sta->sleepq_len--; -+ if(ptdls_sta->sleepq_len>0){ -+ pxmitframe->attrib.mdata = 1; -+ pxmitframe->attrib.eosp = 0; -+ }else{ -+ pxmitframe->attrib.mdata = 0; -+ pxmitframe->attrib.eosp = 1; -+ } -+ //pxmitframe->attrib.triggered = 1; //maybe doesn't need in TDLS -+ if(adapter->HalFunc.hal_xmit(adapter, pxmitframe) == true) -+ { -+ rtw_os_xmit_complete(adapter, pxmitframe); -+ } -+ -+ } -+ -+ if(ptdls_sta->sleepq_len==0) -+ { -+ DBG_871X("no buffered packets for tdls to xmit\n"); -+ //on U-APSD + CH. switch state, when there is no buffered date to xmit, -+ // we should go back to base channel -+ if(state==2){ -+ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_CS_OFF); -+ }else if(ptdls_sta->tdls_sta_state&TDLS_SW_OFF_STATE){ -+ ptdls_sta->tdls_sta_state &= ~(TDLS_SW_OFF_STATE); -+ ptdlsinfo->candidate_ch= pmlmeext->cur_channel; -+ issue_tdls_ch_switch_req(adapter, pattrib->src); -+ DBG_871X("issue tdls ch switch req back to base channel\n"); -+ } -+ -+ } -+ else -+ { -+ DBG_871X("error!psta->sleepq_len=%d\n", ptdls_sta->sleepq_len); -+ ptdls_sta->sleepq_len=0; -+ } -+ -+ _exit_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); -+ -+ } -+ -+ } -+ -+ return _FAIL; -+} -+ -+sint On_TDLS_Ch_Switch_Req(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct sta_info *ptdls_sta= NULL; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *psa; -+ sint parsing_length; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE =3; -+ u16 j; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+TYPE_LENGTH_FIELD_SIZE+1; -+ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len -+ -prx_pkt_attrib->hdrlen -+ -prx_pkt_attrib->iv_len -+ -prx_pkt_attrib->icv_len -+ -LLC_HEADER_SIZE -+ -ETH_TYPE_LEN -+ -PAYLOAD_TYPE_LEN -+ -FIXED_IE; -+ -+ ptdls_sta->off_ch = *(ptr+2); -+ -+ //parsing information element -+ for(j=FIXED_IE; jElementID) -+ { -+ case _COUNTRY_IE_: -+ break; -+ case _CH_SWTICH_ANNOUNCE_: -+ break; -+ case _LINK_ID_IE_: -+ break; -+ case _CH_SWITCH_TIMING_: -+ _rtw_memcpy(&ptdls_sta->ch_switch_time, pIE->data, 2); -+ _rtw_memcpy(&ptdls_sta->ch_switch_timeout, pIE->data+2, 2); -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ //todo: check status -+ ptdls_sta->stat_code=0; -+ ptdls_sta->tdls_sta_state |= TDLS_CH_SWITCH_ON_STATE; -+ -+ issue_nulldata(adapter, NULL, 1, 0, 0); -+ -+ issue_tdls_ch_switch_rsp(adapter, psa); -+ -+ DBG_871X("issue tdls channel switch response\n"); -+ -+ if((ptdls_sta->tdls_sta_state & TDLS_CH_SWITCH_ON_STATE) && ptdls_sta->off_ch==pmlmeext->cur_channel){ -+ DBG_871X("back to base channel %x\n", pmlmeext->cur_channel); -+ ptdls_sta->option=7; -+ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_BASE_CH); -+ }else{ -+ ptdls_sta->option=6; -+ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_OFF_CH); -+ } -+ return _FAIL; -+} -+ -+sint On_TDLS_Ch_Switch_Rsp(_adapter *adapter, union recv_frame *precv_frame) -+{ -+ struct sta_info *ptdls_sta= NULL; -+ struct sta_priv *pstapriv = &adapter->stapriv; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; -+ u8 *psa; -+ sint parsing_length; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 FIXED_IE =4; -+ u16 stat_code, j, switch_time, switch_timeout; -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ -+ psa = get_sa(ptr); -+ ptdls_sta = rtw_get_stainfo(pstapriv, psa); -+ -+ //if channel switch is running and receiving Unsolicited TDLS Channel Switch Response, -+ //it will go back to base channel and terminate this channel switch procedure -+ if(ptdls_sta->tdls_sta_state & TDLS_CH_SWITCH_ON_STATE ){ -+ if(pmlmeext->cur_channel==ptdls_sta->off_ch){ -+ DBG_871X("back to base channel %x\n", pmlmeext->cur_channel); -+ ptdls_sta->option=7; -+ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_OFF_CH); -+ }else{ -+ DBG_871X("receive unsolicited channel switch response \n"); -+ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_CS_OFF); -+ } -+ return _FAIL; -+ } -+ -+ //avoiding duplicated or unconditional ch. switch. rsp -+ if((ptdls_sta->tdls_sta_state & TDLS_CH_SW_INITIATOR_STATE) != TDLS_CH_SW_INITIATOR_STATE) -+ return _FAIL; -+ -+ ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+TYPE_LENGTH_FIELD_SIZE+1; -+ parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len -+ -prx_pkt_attrib->hdrlen -+ -prx_pkt_attrib->iv_len -+ -prx_pkt_attrib->icv_len -+ -LLC_HEADER_SIZE -+ -ETH_TYPE_LEN -+ -PAYLOAD_TYPE_LEN -+ -FIXED_IE; -+ -+ _rtw_memcpy(&stat_code, ptr+2, 2); -+ -+ if(stat_code!=0){ -+ return _FAIL; -+ } -+ -+ //parsing information element -+ for(j=FIXED_IE; jElementID) -+ { -+ case _LINK_ID_IE_: -+ break; -+ case _CH_SWITCH_TIMING_: -+ _rtw_memcpy(&switch_time, pIE->data, 2); -+ if(switch_time > ptdls_sta->ch_switch_time) -+ _rtw_memcpy(&ptdls_sta->ch_switch_time, &switch_time, 2); -+ -+ _rtw_memcpy(&switch_timeout, pIE->data+2, 2); -+ if(switch_timeout > ptdls_sta->ch_switch_timeout) -+ _rtw_memcpy(&ptdls_sta->ch_switch_timeout, &switch_timeout, 2); -+ -+ default: -+ break; -+ } -+ -+ j += (pIE->Length + 2); -+ -+ } -+ -+ ptdls_sta->tdls_sta_state &= ~(TDLS_CH_SW_INITIATOR_STATE); -+ ptdls_sta->tdls_sta_state |=TDLS_CH_SWITCH_ON_STATE; -+ -+ //goto set_channel_workitem_callback() -+ ptdls_sta->option=6; -+ rtw_tdls_cmd(adapter, ptdls_sta->hwaddr, TDLS_OFF_CH); -+ -+ return _FAIL; -+} -+ -+#ifdef CONFIG_WFD -+void wfd_ie_tdls(_adapter * padapter, u8 *pframe, u32 *pktlen ) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wifi_display_info *pwfd_info = padapter->tdlsinfo.wfd_info; -+ u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 }; -+ u32 wfdielen = 0; -+ -+ // WFD OUI -+ wfdielen = 0; -+ wfdie[ wfdielen++ ] = 0x50; -+ wfdie[ wfdielen++ ] = 0x6F; -+ wfdie[ wfdielen++ ] = 0x9A; -+ wfdie[ wfdielen++ ] = 0x0A; // WFA WFD v1.0 -+ -+ // Commented by Albert 20110825 -+ // According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes -+ // 1. WFD Device Information -+ // 2. Associated BSSID ( Optional ) -+ // 3. Local IP Adress ( Optional ) -+ -+ // WFD Device Information ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value1: -+ // WFD device information -+ // available for WFD session + Preferred TDLS + WSD ( WFD Service Discovery ) -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL -+ | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_WSD); -+ wfdielen += 2; -+ -+ // Value2: -+ // Session Management Control Port -+ // Default TCP port for RTSP messages is 554 -+ RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->rtsp_ctrlport ); -+ wfdielen += 2; -+ -+ // Value3: -+ // WFD Device Maximum Throughput -+ // 300Mbps is the maximum throughput -+ RTW_PUT_BE16(wfdie + wfdielen, 300); -+ wfdielen += 2; -+ -+ // Associated BSSID ATTR -+ // Type: -+ wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0006); -+ wfdielen += 2; -+ -+ // Value: -+ // Associated BSSID -+ if ( check_fwstate( pmlmepriv, _FW_LINKED) == true ) -+ { -+ _rtw_memcpy( wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ } -+ else -+ { -+ _rtw_memset( wfdie + wfdielen, 0x00, ETH_ALEN ); -+ } -+ -+ // Local IP Address ATTR -+ wfdie[ wfdielen++ ] = WFD_ATTR_LOCAL_IP_ADDR; -+ -+ // Length: -+ // Note: In the WFD specification, the size of length field is 2. -+ RTW_PUT_BE16(wfdie + wfdielen, 0x0005); -+ wfdielen += 2; -+ -+ // Version: -+ // 0x01: Version1;IPv4 -+ wfdie[ wfdielen++ ] = 0x01; -+ -+ // IPv4 Address -+ _rtw_memcpy( wfdie + wfdielen, pwfd_info->ip_address, 4 ); -+ wfdielen += 4; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, pktlen); -+ -+} -+#endif //CONFIG_WFD -+ -+void rtw_build_tdls_setup_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct sta_info *ptdls_sta=rtw_get_stainfo( (&padapter->stapriv) , pattrib->dst); -+ -+ u8 payload_type = 0x02; -+ u8 category = RTW_WLAN_CATEGORY_TDLS; -+ u8 action = TDLS_SETUP_REQUEST; -+ u8 bssrate[NDIS_802_11_LENGTH_RATES_EX]; //Use NDIS_802_11_LENGTH_RATES_EX in order to call func.rtw_set_supported_rate -+ int bssrate_len = 0, i = 0 ; -+ u8 more_supportedrates = 0; -+ unsigned int ie_len; -+ u8 *p; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 link_id_addr[18] = {0}; -+ u8 iedata=0; -+ u8 sup_ch[ 30 * 2 ] = {0x00 }, sup_ch_idx = 0, idx_5g = 2; //For supported channel -+ u8 timeout_itvl[5]; //set timeout interval to maximum value -+ u32 time; -+ -+ //SNonce -+ if(pattrib->encrypt){ -+ for(i=0;i<8;i++){ -+ time=rtw_get_current_time(); -+ _rtw_memcpy(&ptdls_sta->SNonce[4*i], (u8 *)&time, 4); -+ } -+ } -+ -+ //payload type -+ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); -+ //category, action, dialog token -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(ptdls_sta->dialog), &(pattrib->pktlen)); -+ -+ //capability -+ _rtw_memcpy(pframe, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+ -+ if(pattrib->encrypt) -+ *pframe =*pframe | BIT(4); -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ //supported rates -+ rtw_set_supported_rate(bssrate, WIRELESS_11BG_24N); -+ bssrate_len = IEEE80211_CCK_RATE_LEN + IEEE80211_NUM_OFDM_RATESLEN; -+ -+ if (bssrate_len > 8) -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); -+ more_supportedrates = 1; -+ } -+ else -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); -+ } -+ -+ //country(optional) -+ //extended supported rates -+ if(more_supportedrates==1){ -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); -+ } -+ -+ //supported channels -+ pframe = rtw_tdls_set_sup_ch(pmlmeext, pframe, pattrib); -+ -+ // SRC IE -+ pframe = rtw_set_ie( pframe, _SRC_IE_, 16, TDLS_SRC, &(pattrib->pktlen)); -+ -+ //RSNIE -+ if(pattrib->encrypt) -+ pframe = rtw_set_ie(pframe, _RSN_IE_2_, 20, TDLS_RSNIE, &(pattrib->pktlen)); -+ -+ //extended capabilities -+ pframe = rtw_set_ie(pframe, _EXT_CAP_IE_ , 5, TDLS_EXT_CAPIE, &(pattrib->pktlen)); -+ -+ //QoS capability(WMM_IE) -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 7, TDLS_WMMIE, &(pattrib->pktlen)); -+ -+ -+ if(pattrib->encrypt){ -+ //FTIE -+ _rtw_memset(pframe, 0, 84); //All fields except SNonce shall be set to 0 -+ _rtw_memset(pframe, _FTIE_, 1); //version -+ _rtw_memset((pframe+1), 82, 1); //length -+ _rtw_memcpy((pframe+52), ptdls_sta->SNonce, 32); -+ pframe += 84; -+ pattrib->pktlen += 84; -+ -+ //Timeout interval -+ timeout_itvl[0]=0x02; -+ _rtw_memcpy(timeout_itvl+1, (u8 *)(&ptdls_sta->TDLS_PeerKey_Lifetime), 4); -+ pframe = rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); -+ } -+ -+ //Sup_reg_classes(optional) -+ //HT capabilities -+ pframe = rtw_tdls_set_ht_cap(padapter, pframe, pattrib); -+ -+ //20/40 BSS coexistence -+ if(pmlmepriv->num_FortyMHzIntolerant>0) -+ iedata |= BIT(2);//20 MHz BSS Width Request -+ pframe = rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); -+ -+ //Link identifier -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); -+ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); -+ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); -+ -+#ifdef CONFIG_WFD -+ wfd_ie_tdls( padapter, pframe, &(pattrib->pktlen) ); -+#endif //CONFIG_WFD -+ -+} -+ -+void rtw_build_tdls_setup_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ u8 payload_type = 0x02; -+ unsigned char category = RTW_WLAN_CATEGORY_TDLS; -+ unsigned char action = TDLS_SETUP_RESPONSE; -+ unsigned char bssrate[NDIS_802_11_LENGTH_RATES_EX]; -+ int bssrate_len = 0; -+ u8 more_supportedrates = 0; -+ unsigned int ie_len; -+ unsigned char *p; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 link_id_addr[18] = {0}; -+ u8 iedata=0; -+ u8 timeout_itvl[5]; //setup response timeout interval will copy from request -+ u8 ANonce[32]; //maybe it can put in ontdls_req -+ u8 k; //for random ANonce -+ u8 *pftie, *ptimeout_ie, *plinkid_ie, *prsnie, *pftie_mic; -+ u32 time; -+ -+ ptdls_sta = rtw_get_stainfo( &(padapter->stapriv) , pattrib->dst); -+ -+ if(ptdls_sta == NULL ) -+ { -+ DBG_871X("[%s] %d\n", __FUNCTION__, __LINE__); -+ return; -+ } -+ -+ if(pattrib->encrypt){ -+ for(k=0;k<8;k++){ -+ time=rtw_get_current_time(); -+ _rtw_memcpy(&ptdls_sta->ANonce[4*k], (u8*)&time, 4); -+ } -+ } -+ -+ //payload type -+ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); -+ //category, action, status code -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&ptdls_sta->stat_code, &(pattrib->pktlen)); -+ -+ if(ptdls_sta->stat_code!=0) //invalid setup request -+ { -+ DBG_871X("ptdls_sta->stat_code:%04x \n", ptdls_sta->stat_code); -+ return; -+ } -+ -+ //dialog token -+ pframe = rtw_set_fixed_ie(pframe, 1, &(ptdls_sta->dialog), &(pattrib->pktlen)); -+ -+ //capability -+ _rtw_memcpy(pframe, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+ -+ if(pattrib->encrypt ) -+ *pframe =*pframe | BIT(4); -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ //supported rates -+ rtw_set_supported_rate(bssrate, WIRELESS_11BG_24N); -+ bssrate_len = IEEE80211_CCK_RATE_LEN + IEEE80211_NUM_OFDM_RATESLEN; -+ -+ if (bssrate_len > 8) -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); -+ more_supportedrates = 1; -+ } -+ else -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); -+ } -+ -+ //country(optional) -+ //extended supported rates -+ if(more_supportedrates==1){ -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); -+ } -+ -+ //supported channels -+ pframe = rtw_tdls_set_sup_ch(pmlmeext, pframe, pattrib); -+ -+ // SRC IE -+ pframe = rtw_set_ie(pframe, _SRC_IE_ , 16, TDLS_SRC, &(pattrib->pktlen)); -+ -+ //RSNIE -+ if(pattrib->encrypt){ -+ prsnie = pframe; -+ pframe = rtw_set_ie(pframe, _RSN_IE_2_, 20, TDLS_RSNIE, &(pattrib->pktlen)); -+ } -+ -+ //extended capabilities -+ pframe = rtw_set_ie(pframe, _EXT_CAP_IE_ , 5, TDLS_EXT_CAPIE, &(pattrib->pktlen)); -+ -+ //QoS capability(WMM_IE) -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 7, TDLS_WMMIE, &(pattrib->pktlen)); -+ -+ if(pattrib->encrypt){ -+ wpa_tdls_generate_tpk(padapter, ptdls_sta); -+ -+ //FTIE -+ pftie = pframe; -+ pftie_mic = pframe+4; -+ _rtw_memset(pframe, 0, 84); //All fields except SNonce shall be set to 0 -+ _rtw_memset(pframe, _FTIE_, 1); //version -+ _rtw_memset((pframe+1), 82, 1); //length -+ _rtw_memcpy((pframe+20), ptdls_sta->ANonce, 32); -+ _rtw_memcpy((pframe+52), ptdls_sta->SNonce, 32); -+ pframe += 84; -+ pattrib->pktlen += 84; -+ -+ //Timeout interval -+ ptimeout_ie = pframe; -+ timeout_itvl[0]=0x02; -+ _rtw_memcpy(timeout_itvl+1, (u8 *)(&ptdls_sta->TDLS_PeerKey_Lifetime), 4); -+ pframe = rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); -+ } -+ -+ //Sup_reg_classes(optional) -+ //HT capabilities -+ pframe = rtw_tdls_set_ht_cap(padapter, pframe, pattrib); -+ -+ //20/40 BSS coexistence -+ if(pmlmepriv->num_FortyMHzIntolerant>0) -+ iedata |= BIT(2);//20 MHz BSS Width Request -+ pframe = rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); -+ -+ //Link identifier -+ plinkid_ie = pframe; -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr+6), pattrib->dst, 6); -+ _rtw_memcpy((link_id_addr+12), pattrib->src, 6); -+ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); -+ -+ //fill FTIE mic -+ if(pattrib->encrypt) -+ wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic); -+ -+#ifdef CONFIG_WFD -+ wfd_ie_tdls( padapter, pframe, &(pattrib->pktlen) ); -+#endif //CONFIG_WFD -+ -+} -+ -+void rtw_build_tdls_setup_cfm_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) -+{ -+ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_info *ptdls_sta=rtw_get_stainfo( (&padapter->stapriv) , pattrib->dst); -+ -+ u8 payload_type = 0x02; -+ unsigned char category = RTW_WLAN_CATEGORY_TDLS; -+ unsigned char action = TDLS_SETUP_CONFIRM; -+ u8 more_supportedrates = 0; -+ unsigned int ie_len; -+ unsigned char *p; -+ u8 timeout_itvl[5]; //set timeout interval to maximum value -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 link_id_addr[18] = {0}; -+ u8 *pftie, *ptimeout_ie, *plinkid_ie, *prsnie, *pftie_mic; -+ -+ //payload type -+ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); -+ //category, action, status code, dialog token -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&ptdls_sta->stat_code, &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(ptdls_sta->dialog), &(pattrib->pktlen)); -+ -+ if(ptdls_sta->stat_code!=0) //invalid setup request -+ return; -+ -+ //RSNIE -+ if(pattrib->encrypt){ -+ prsnie = pframe; -+ pframe = rtw_set_ie(pframe, _RSN_IE_2_, 20, TDLS_RSNIE, &(pattrib->pktlen)); -+ } -+ -+ //EDCA param set; WMM param ele. -+ if(pattrib->encrypt){ -+ //FTIE -+ pftie = pframe; -+ pftie_mic = pframe+4; -+ _rtw_memset(pframe, 0, 84); //All fields except SNonce shall be set to 0 -+ _rtw_memset(pframe, _FTIE_, 1); //version -+ _rtw_memset((pframe+1), 82, 1); //length -+ _rtw_memcpy((pframe+20), ptdls_sta->ANonce, 32); -+ _rtw_memcpy((pframe+52), ptdls_sta->SNonce, 32); -+ pframe += 84; -+ pattrib->pktlen += 84; -+ -+ //Timeout interval -+ ptimeout_ie = pframe; -+ timeout_itvl[0]=0x02; -+ _rtw_memcpy(timeout_itvl+1, (u8 *)(&ptdls_sta->TDLS_PeerKey_Lifetime), 4); -+ ptdls_sta->TPK_count=0; -+ _set_timer(&ptdls_sta->TPK_timer, ptdls_sta->TDLS_PeerKey_Lifetime/TPK_RESEND_COUNT); -+ pframe = rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); -+ } -+ -+ //HT operation; todo -+ //Link identifier -+ plinkid_ie = pframe; -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); -+ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); -+ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); -+ -+ //fill FTIE mic -+ if(pattrib->encrypt) -+ wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic); -+ -+} -+ -+void rtw_build_tdls_teardown_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 payload_type = 0x02; -+ unsigned char category = RTW_WLAN_CATEGORY_TDLS; -+ unsigned char action = TDLS_TEARDOWN; -+ u8 link_id_addr[18] = {0}; -+ -+ struct sta_info *ptdls_sta = rtw_get_stainfo( &(padapter->stapriv) , pattrib->dst); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ //payload type -+ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); -+ //category, action, reason code -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, (u8 *)&ptdls_sta->stat_code, &(pattrib->pktlen)); -+ -+ //Link identifier -+ if(ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE){ -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); -+ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); -+ }else if(ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE){ -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr+6), pattrib->dst, 6); -+ _rtw_memcpy((link_id_addr+12), pattrib->src, 6); -+ } -+ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); -+ -+} -+ -+void rtw_build_tdls_dis_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 payload_type = 0x02; -+ u8 category = RTW_WLAN_CATEGORY_TDLS; -+ u8 action = TDLS_DISCOVERY_REQUEST; -+ u8 link_id_addr[18] = {0}; -+ static u8 dialogtoken=0; -+ -+ //payload type -+ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); -+ //category, action, reason code -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogtoken), &(pattrib->pktlen)); -+ dialogtoken = (dialogtoken+1)%256; -+ -+ //Link identifier -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); -+ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); -+ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); -+ -+} -+ -+void rtw_build_tdls_dis_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, u8 dialog) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ u8 category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = TDLS_DISCOVERY_RESPONSE; -+ u8 bssrate[NDIS_802_11_LENGTH_RATES_EX]; -+ int bssrate_len = 0; -+ u8 more_supportedrates = 0; -+ u8 *p; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ u8 link_id_addr[18] = {0}; -+ u8 iedata=0; -+ u8 timeout_itvl[5]; //set timeout interval to maximum value -+ u32 timeout_interval= TPK_RESEND_COUNT * 1000; -+ -+ //category, action, dialog token -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialog), &(pattrib->pktlen)); -+ -+ //capability -+ _rtw_memcpy(pframe, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2); -+ -+ if(pattrib->encrypt) -+ *pframe =*pframe | BIT(4); -+ pframe += 2; -+ pattrib->pktlen += 2; -+ -+ //supported rates -+ rtw_set_supported_rate(bssrate, WIRELESS_11BG_24N); -+ bssrate_len = IEEE80211_CCK_RATE_LEN + IEEE80211_NUM_OFDM_RATESLEN; -+ -+ if (bssrate_len > 8) -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen)); -+ more_supportedrates = 1; -+ } -+ else -+ { -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen)); -+ } -+ -+ //extended supported rates -+ if(more_supportedrates==1){ -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen)); -+ } -+ -+ //supported channels -+ pframe = rtw_tdls_set_sup_ch(pmlmeext, pframe, pattrib); -+ -+ //RSNIE -+ if(pattrib->encrypt) -+ pframe = rtw_set_ie(pframe, _RSN_IE_2_, 20, TDLS_RSNIE, &(pattrib->pktlen)); -+ -+ //extended capability -+ pframe = rtw_set_ie(pframe, _EXT_CAP_IE_ , 5, TDLS_EXT_CAPIE, &(pattrib->pktlen)); -+ -+ if(pattrib->encrypt){ -+ //FTIE -+ _rtw_memset(pframe, 0, 84); //All fields shall be set to 0 -+ _rtw_memset(pframe, _FTIE_, 1); //version -+ _rtw_memset((pframe+1), 82, 1); //length -+ pframe += 84; -+ pattrib->pktlen += 84; -+ -+ //Timeout interval -+ timeout_itvl[0]=0x02; -+ _rtw_memcpy(timeout_itvl+1, &timeout_interval, 4); -+ pframe = rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen)); -+ } -+ -+ //Sup_reg_classes(optional) -+ //HT capabilities -+ pframe = rtw_tdls_set_ht_cap(padapter, pframe, pattrib); -+ -+ //20/40 BSS coexistence -+ if(pmlmepriv->num_FortyMHzIntolerant>0) -+ iedata |= BIT(2);//20 MHz BSS Width Request -+ pframe = rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); -+ -+ //Link identifier -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr+6), pattrib->dst, 6); -+ _rtw_memcpy((link_id_addr+12), pattrib->src, 6); -+ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); -+ -+} -+ -+void rtw_build_tdls_peer_traffic_indication_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 payload_type = 0x02; -+ unsigned char category = RTW_WLAN_CATEGORY_TDLS; -+ unsigned char action = TDLS_PEER_TRAFFIC_INDICATION; -+ -+ u8 link_id_addr[18] = {0}; -+ u8 AC_queue=0; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ -+ //payload type -+ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); -+ //category, action, reason code -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(ptdls_sta->dialog), &(pattrib->pktlen)); -+ -+ //Link identifier -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); -+ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); -+ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); -+ -+ //PTI control -+ //PU buffer status -+ if(ptdls_sta->uapsd_bk&BIT(1)) -+ AC_queue=BIT(0); -+ if(ptdls_sta->uapsd_be&BIT(1)) -+ AC_queue=BIT(1); -+ if(ptdls_sta->uapsd_vi&BIT(1)) -+ AC_queue=BIT(2); -+ if(ptdls_sta->uapsd_vo&BIT(1)) -+ AC_queue=BIT(3); -+ pframe = rtw_set_ie(pframe, _PTI_BUFFER_STATUS_, 1, &AC_queue, &(pattrib->pktlen)); -+ -+} -+ -+void rtw_build_tdls_ch_switch_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ u8 payload_type = 0x02; -+ unsigned char category = RTW_WLAN_CATEGORY_TDLS; -+ unsigned char action = TDLS_CHANNEL_SWITCH_REQUEST; -+ u8 link_id_addr[18] = {0}; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ u8 ch_switch_timing[4] = {0}; -+ u16 switch_time= CH_SWITCH_TIME, switch_timeout=CH_SWITCH_TIMEOUT; -+ -+ //payload type -+ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); -+ //category, action, target_ch -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(ptdlsinfo->candidate_ch), &(pattrib->pktlen)); -+ -+ //Link identifier -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); -+ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); -+ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); -+ -+ //ch switch timing -+ _rtw_memcpy(ch_switch_timing, &switch_time, 2); -+ _rtw_memcpy(ch_switch_timing+2, &switch_timeout, 2); -+ pframe = rtw_set_ie(pframe, _CH_SWITCH_TIMING_, 4, ch_switch_timing, &(pattrib->pktlen)); -+ -+ //update ch switch attrib to sta_info -+ ptdls_sta->off_ch=ptdlsinfo->candidate_ch; -+ ptdls_sta->ch_switch_time=switch_time; -+ ptdls_sta->ch_switch_timeout=switch_timeout; -+ -+} -+ -+void rtw_build_tdls_ch_switch_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 payload_type = 0x02; -+ unsigned char category = RTW_WLAN_CATEGORY_TDLS; -+ unsigned char action = TDLS_CHANNEL_SWITCH_RESPONSE; -+ u8 link_id_addr[18] = {0}; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; -+ u8 ch_switch_timing[4] = {0}; -+ -+ //payload type -+ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); -+ //category, action, status_code -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&ptdls_sta->stat_code, &(pattrib->pktlen)); -+ -+ //Link identifier -+ _rtw_memcpy(link_id_addr, pattrib->ra, 6); -+ _rtw_memcpy((link_id_addr+6), pattrib->src, 6); -+ _rtw_memcpy((link_id_addr+12), pattrib->dst, 6); -+ pframe = rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen)); -+ -+ //ch switch timing -+ _rtw_memcpy(ch_switch_timing, &ptdls_sta->ch_switch_time, 2); -+ _rtw_memcpy(ch_switch_timing+2, &ptdls_sta->ch_switch_timeout, 2); -+ pframe = rtw_set_ie(pframe, _CH_SWITCH_TIMING_, 4, ch_switch_timing, &(pattrib->pktlen)); -+ -+} -+ -+#ifdef CONFIG_WFD -+void rtw_build_tunneled_probe_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct wifidirect_info *pbuddy_wdinfo = &padapter->pbuddy_adapter->wdinfo; -+ u8 payload_type = 0x02; -+ u8 category = RTW_WLAN_CATEGORY_P2P; -+ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a}; -+ u8 probe_req = 4; -+ u8 wfdielen = 0; -+ -+ //payload type -+ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); -+ //category, OUI, frame_body_type -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 3, WFA_OUI, &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(probe_req), &(pattrib->pktlen)); -+ -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ wfdielen = build_probe_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+ else if(!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE)) -+ { -+ wfdielen = build_probe_req_wfd_ie(pbuddy_wdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+ -+} -+ -+void rtw_build_tunneled_probe_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe) -+{ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct wifidirect_info *pbuddy_wdinfo = &padapter->pbuddy_adapter->wdinfo; -+ u8 payload_type = 0x02; -+ u8 category = RTW_WLAN_CATEGORY_P2P; -+ u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a}; -+ u8 probe_rsp = 5; -+ u8 wfdielen = 0; -+ -+ //payload type -+ pframe = rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen)); -+ //category, OUI, frame_body_type -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 3, WFA_OUI, &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(probe_rsp), &(pattrib->pktlen)); -+ -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ wfdielen = build_probe_resp_wfd_ie(pwdinfo, pframe, 1); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+ else if(!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE)) -+ { -+ wfdielen = build_probe_resp_wfd_ie(pbuddy_wdinfo, pframe, 1); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+ } -+ -+} -+#endif //CONFIG_WFD -+ -+void _TPK_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ -+ ptdls_sta->TPK_count++; -+ //TPK_timer set 1000 as default -+ //retry timer should set at least 301 sec. -+ if(ptdls_sta->TPK_count==TPK_RESEND_COUNT){ -+ ptdls_sta->TPK_count=0; -+ issue_tdls_setup_req(ptdls_sta->padapter, ptdls_sta->hwaddr); -+ } -+ -+ _set_timer(&ptdls_sta->TPK_timer, ptdls_sta->TDLS_PeerKey_Lifetime/TPK_RESEND_COUNT); -+} -+ -+void init_TPK_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ psta->padapter=padapter; -+ -+ _init_timer(&psta->TPK_timer, padapter->pnetdev, _TPK_timer_hdl, psta); -+} -+ -+// TDLS_DONE_CH_SEN: channel sensing and report candidate channel -+// TDLS_OFF_CH: first time set channel to off channel -+// TDLS_BASE_CH: when go back to the channel linked with AP, send null data to peer STA as an indication -+void _ch_switch_timer_hdl(void *FunctionContext) -+{ -+ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ -+ if( ptdls_sta->option == TDLS_DONE_CH_SEN ){ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_DONE_CH_SEN); -+ }else if( ptdls_sta->option == TDLS_OFF_CH ){ -+ issue_nulldata_to_TDLS_peer_STA(ptdls_sta->padapter, ptdls_sta, 0); -+ _set_timer(&ptdls_sta->base_ch_timer, 500); -+ }else if( ptdls_sta->option == TDLS_BASE_CH){ -+ issue_nulldata_to_TDLS_peer_STA(ptdls_sta->padapter, ptdls_sta, 0); -+ } -+} -+ -+void init_ch_switch_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ psta->padapter=padapter; -+ _init_timer(&psta->option_timer, padapter->pnetdev, _ch_switch_timer_hdl, psta); -+} -+ -+void _base_ch_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ rtw_tdls_cmd(ptdls_sta->padapter, ptdls_sta->hwaddr, TDLS_P_OFF_CH); -+} -+ -+void init_base_ch_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ psta->padapter=padapter; -+ _init_timer(&psta->base_ch_timer, padapter->pnetdev, _base_ch_timer_hdl, psta); -+} -+ -+void _off_ch_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ rtw_tdls_cmd(ptdls_sta->padapter, ptdls_sta->hwaddr, TDLS_P_BASE_CH ); -+} -+ -+void init_off_ch_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ psta->padapter=padapter; -+ _init_timer(&psta->off_ch_timer, padapter->pnetdev, _off_ch_timer_hdl, psta); -+} -+ -+void _tdls_handshake_timer_hdl(void *FunctionContext) -+{ -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ -+ if(ptdls_sta != NULL) -+ { -+ if( !(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) ) -+ { -+ DBG_871X("tdls handshake time out\n"); -+ free_tdls_sta(ptdls_sta->padapter, ptdls_sta); -+ } -+ } -+} -+ -+void init_handshake_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ psta->padapter=padapter; -+ _init_timer(&psta->handshake_timer, padapter->pnetdev, _tdls_handshake_timer_hdl, psta); -+} -+ -+//Check tdls peer sta alive. -+void _tdls_alive_timer_phase1_hdl(void *FunctionContext) -+{ -+ _irqL irqL; -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ _enter_critical_bh(&ptdlsinfo->hdl_lock, &irqL); -+ ptdls_sta->timer_flag = 1; -+ _exit_critical_bh(&ptdlsinfo->hdl_lock, &irqL); -+ -+ ptdls_sta->tdls_sta_state &= (~TDLS_ALIVE_STATE); -+ -+ DBG_871X("issue_tdls_dis_req to check alive\n"); -+ issue_tdls_dis_req( padapter, ptdls_sta->hwaddr); -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CKALV_PH1); -+ sta_update_last_rx_pkts(ptdls_sta); -+ -+ if ( ptdls_sta->timer_flag == 2 ) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_FREE_STA); -+ else -+ { -+ _enter_critical_bh(&ptdlsinfo->hdl_lock, &irqL); -+ ptdls_sta->timer_flag = 0; -+ _exit_critical_bh(&ptdlsinfo->hdl_lock, &irqL); -+ } -+ -+} -+ -+void _tdls_alive_timer_phase2_hdl(void *FunctionContext) -+{ -+ _irqL irqL; -+ struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; -+ _adapter *padapter = ptdls_sta->padapter; -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ _enter_critical_bh(&(ptdlsinfo->hdl_lock), &irqL); -+ ptdls_sta->timer_flag = 1; -+ _exit_critical_bh(&ptdlsinfo->hdl_lock, &irqL); -+ -+ if( (ptdls_sta->tdls_sta_state & TDLS_ALIVE_STATE) && -+ (sta_last_rx_pkts(ptdls_sta) + 3 <= sta_rx_pkts(ptdls_sta)) ) -+ { -+ DBG_871X("TDLS STA ALIVE, ptdls_sta->sta_stats.last_rx_pkts:%llu, ptdls_sta->sta_stats.rx_pkts:%llu\n", -+ sta_last_rx_pkts(ptdls_sta), sta_rx_pkts(ptdls_sta)); -+ -+ ptdls_sta->alive_count = 0; -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CKALV_PH2); -+ } -+ else -+ { -+ if( !(ptdls_sta->tdls_sta_state & TDLS_ALIVE_STATE) ) -+ DBG_871X("TDLS STA TOO FAR\n"); -+ if( !(sta_last_rx_pkts(ptdls_sta) + 3 <= sta_rx_pkts(ptdls_sta))) -+ DBG_871X("TDLS LINK WITH LOW TRAFFIC, ptdls_sta->sta_stats.last_rx_pkts:%llu, ptdls_sta->sta_stats.rx_pkts:%llu\n", -+ sta_last_rx_pkts(ptdls_sta), sta_rx_pkts(ptdls_sta)); -+ -+ ptdls_sta->alive_count++; -+ if( ptdls_sta->alive_count == TDLS_ALIVE_COUNT ) -+ { -+ ptdls_sta->stat_code = _RSON_TDLS_TEAR_TOOFAR_; -+ issue_tdls_teardown(padapter, ptdls_sta->hwaddr); -+ } -+ else -+ { -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CKALV_PH2); -+ } -+ } -+ -+ if ( ptdls_sta->timer_flag == 2 ) -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_FREE_STA); -+ else -+ { -+ _enter_critical_bh(&(ptdlsinfo->hdl_lock), &irqL); -+ ptdls_sta->timer_flag = 0; -+ _exit_critical_bh(&ptdlsinfo->hdl_lock, &irqL); -+} -+ -+} -+ -+void init_tdls_alive_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ psta->padapter=padapter; -+ _init_timer(&psta->alive_timer1, padapter->pnetdev, _tdls_alive_timer_phase1_hdl, psta); -+ _init_timer(&psta->alive_timer2, padapter->pnetdev, _tdls_alive_timer_phase2_hdl, psta); -+} -+ -+int update_sgi_tdls(_adapter *padapter, struct sta_info *psta) -+{ -+ struct ht_priv *psta_ht = NULL; -+ psta_ht = &psta->htpriv; -+ -+ if(psta_ht->ht_option) -+ { -+ return psta_ht->sgi; -+ } -+ else -+ return false; -+} -+ -+u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta) -+{ -+ int i; -+ u8 rf_type, id; -+ unsigned char sta_band = 0; -+ unsigned char limit; -+ unsigned int tx_ra_bitmap=0; -+ struct ht_priv *psta_ht = NULL; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -+ -+ psta_ht = &psta->htpriv; -+ //b/g mode ra_bitmap -+ for (i=0; ibssrateset); i++) -+ { -+ if (psta->bssrateset[i]) -+ tx_ra_bitmap |= rtw_get_bit_value_from_ieee_value(psta->bssrateset[i]&0x7f); -+ } -+ -+ //n mode ra_bitmap -+ if(psta_ht->ht_option) -+ { -+ padapter->HalFunc.GetHwRegHandler(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if(rf_type == RF_2T2R) -+ limit=16;// 2R -+ else -+ limit=8;// 1R -+ -+ for (i=0; iht_cap.supp_mcs_set[i/8] & BIT(i%8)) -+ tx_ra_bitmap |= BIT(i+12); -+ } -+ } -+ -+ if ( pcur_network->Configuration.DSConfig > 14 ) { -+ // 5G band -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_5N | WIRELESS_11A; -+ else -+ sta_band |= WIRELESS_11A; -+ } else { -+ if (tx_ra_bitmap & 0xffff000) -+ sta_band |= WIRELESS_11_24N | WIRELESS_11G | WIRELESS_11B; -+ else if (tx_ra_bitmap & 0xff0) -+ sta_band |= WIRELESS_11G |WIRELESS_11B; -+ else -+ sta_band |= WIRELESS_11B; -+ } -+ -+ //id = networktype_to_raid(sta_band); -+ id = rtw_hal_networktype_to_raid(padapter,sta_band); -+ tx_ra_bitmap |= ((id<<28)&0xf0000000); -+ return tx_ra_bitmap; -+} -+ -+#endif //CONFIG_TDLS -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_vht.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_vht.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_vht.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_vht.c 2018-02-06 17:42:30.700967016 +0200 -@@ -0,0 +1,607 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_VHT_C -+ -+#include -+ -+#ifdef CONFIG_80211AC_VHT -+// 20/40/80, ShortGI, MCS Rate -+const u16 VHT_MCS_DATA_RATE[3][2][20] = -+ { { {13, 26, 39, 52, 78, 104, 117, 130, 156, 156, -+ 26, 52, 78, 104, 156, 208, 234, 260, 312, 312}, // Long GI, 20MHz -+ {14, 29, 43, 58, 87, 116, 130, 144, 173, 173, -+ 29, 58, 87, 116, 173, 231, 260, 289, 347, 347} }, // Short GI, 20MHz -+ { {27, 54, 81, 108, 162, 216, 243, 270, 324, 360, -+ 54, 108, 162, 216, 324, 432, 486, 540, 648, 720}, // Long GI, 40MHz -+ {30, 60, 90, 120, 180, 240, 270, 300,360, 400, -+ 60, 120, 180, 240, 360, 480, 540, 600, 720, 800}}, // Short GI, 40MHz -+ { {59, 117, 176, 234, 351, 468, 527, 585, 702, 780, -+ 117, 234, 351, 468, 702, 936, 1053, 1170, 1404, 1560}, // Long GI, 80MHz -+ {65, 130, 195, 260, 390, 520, 585, 650, 780, 867, -+ 130, 260, 390, 520, 780, 1040, 1170, 1300, 1560,1734} } // Short GI, 80MHz -+ }; -+ -+u8 rtw_get_vht_highest_rate(_adapter *padapter, u8 *pvht_mcs_map) -+{ -+ u8 i, j; -+ u8 bit_map; -+ u8 vht_mcs_rate = 0; -+ -+ for(i = 0; i < 2; i++) -+ { -+ if(pvht_mcs_map[i] != 0xff) -+ { -+ for(j = 0; j < 8; j += 2) -+ { -+ bit_map = (pvht_mcs_map[i] >> j) & 3; -+ -+ if(bit_map != 3) -+ vht_mcs_rate = MGN_VHT1SS_MCS7 + 10*j/2 + i*40 + bit_map; //VHT rate indications begin from 0x90 -+ } -+ } -+ } -+ -+ //DBG_871X("HighestVHTMCSRate is %x\n", vht_mcs_rate); -+ return vht_mcs_rate; -+} -+ -+u16 rtw_vht_data_rate(u8 bw, u8 short_GI, u8 vht_mcs_rate) -+{ -+ if(vht_mcs_rate > MGN_VHT2SS_MCS9) -+ vht_mcs_rate = MGN_VHT2SS_MCS9; -+ -+ return VHT_MCS_DATA_RATE[bw][short_GI][((vht_mcs_rate - MGN_VHT1SS_MCS0)&0x3f)]; -+} -+ -+void rtw_vht_use_default_setting(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ bool bHwLDPCSupport = false, bHwSTBCSupport = false; -+ u8 rf_type = 0; -+ -+ pvhtpriv->bwmode = (pregistrypriv->bw_mode & 0xF0) >> 4; -+ if (pvhtpriv->bwmode > CHANNEL_WIDTH_80) { -+ pvhtpriv->sgi = TEST_FLAG(pregistrypriv->short_gi, BIT3) ? true : false; -+ } else { -+ pvhtpriv->sgi = TEST_FLAG(pregistrypriv->short_gi, BIT2) ? true : false; -+ } -+ -+ // LDPC support -+ rtw_hal_get_def_var(padapter, HAL_DEF_LDPC, (u8 *)&bHwLDPCSupport); -+ CLEAR_FLAGS(pvhtpriv->ldpc_cap); -+ if(bHwLDPCSupport) -+ { -+ if(TEST_FLAG(pregistrypriv->ldpc_cap, BIT0)) -+ SET_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_RX); -+ if(TEST_FLAG(pregistrypriv->ldpc_cap, BIT1)) -+ SET_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX); -+ -+ DBG_871X("[VHT] Support LDPC = 0x%02X\n", pvhtpriv->ldpc_cap); -+ } -+ -+ // STBC -+ rtw_hal_get_def_var(padapter, HAL_DEF_TX_STBC, (u8 *)&bHwSTBCSupport); -+ CLEAR_FLAGS(pvhtpriv->stbc_cap); -+ if(bHwSTBCSupport) -+ { -+ if(TEST_FLAG(pregistrypriv->stbc_cap, BIT1)) -+ SET_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX); -+ } -+ rtw_hal_get_def_var(padapter, HAL_DEF_RX_STBC, (u8 *)&bHwSTBCSupport); -+ if(bHwSTBCSupport) -+ { -+ if(TEST_FLAG(pregistrypriv->stbc_cap, BIT0)) -+ SET_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_RX); -+ } -+ DBG_871X("[VHT] Support STBC = 0x%02X\n", pvhtpriv->stbc_cap); -+ -+ pvhtpriv->ampdu_len = pregistrypriv->ampdu_factor; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ if (rf_type == RF_1T1R) -+ pvhtpriv->vht_mcs_map[0] = 0xfe; // Only support 1SS MCS 0~9; -+ else -+ pvhtpriv->vht_mcs_map[0] = 0xfa; //support 1SS MCS 0~9 2SS MCS 0~9 -+ pvhtpriv->vht_mcs_map[1] = 0xff; -+ -+ if(pregistrypriv->vht_rate_sel == 1) -+ { -+ pvhtpriv->vht_mcs_map[0] = 0xfc; // support 1SS MCS 0~7 -+ } -+ else if(pregistrypriv->vht_rate_sel == 2) -+ { -+ pvhtpriv->vht_mcs_map[0] = 0xfd; // Support 1SS MCS 0~8 -+ } -+ else if(pregistrypriv->vht_rate_sel == 3) -+ { -+ pvhtpriv->vht_mcs_map[0] = 0xfe; // Support 1SS MCS 0~9 -+ } -+ else if(pregistrypriv->vht_rate_sel == 4) -+ { -+ pvhtpriv->vht_mcs_map[0] = 0xf0; // support 1SS MCS 0~7 2SS MCS 0~7 -+ } -+ else if(pregistrypriv->vht_rate_sel == 5) -+ { -+ pvhtpriv->vht_mcs_map[0] = 0xf5; // support 1SS MCS 0~8 2SS MCS 0~8 -+ } -+ else if(pregistrypriv->vht_rate_sel == 6) -+ { -+ pvhtpriv->vht_mcs_map[0] = 0xfa; // support 1SS MCS 0~9 2SS MCS 0~9 -+ } -+ else if(pregistrypriv->vht_rate_sel == 7) -+ { -+ pvhtpriv->vht_mcs_map[0] = 0xf8; // support 1SS MCS 0-7 2SS MCS 0~9 -+ } -+ else if(pregistrypriv->vht_rate_sel == 8) -+ { -+ pvhtpriv->vht_mcs_map[0] = 0xf9; // support 1SS MCS 0-8 2SS MCS 0~9 -+ } -+ else if(pregistrypriv->vht_rate_sel == 9) -+ { -+ pvhtpriv->vht_mcs_map[0] = 0xf4; // support 1SS MCS 0-7 2SS MCS 0~8 -+ } -+ -+ pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(padapter, pvhtpriv->vht_mcs_map); -+} -+ -+u32 rtw_vht_rate_to_bitmap(u8 *pVHTRate) -+{ -+ -+ u8 i,j , tmpRate; -+ u32 RateBitmap = 0; -+ -+ for(i = j= 0; i < 4; i+=2, j+=10) -+ { -+ tmpRate = (pVHTRate[0] >> i) & 3; -+ -+ switch(tmpRate){ -+ case 2: -+ RateBitmap = RateBitmap | (0x03ff << j); -+ break; -+ case 1: -+ RateBitmap = RateBitmap | (0x01ff << j); -+ break; -+ -+ case 0: -+ RateBitmap = RateBitmap | (0x00ff << j); -+ break; -+ -+ default: -+ break; -+ } -+ } -+ -+ return RateBitmap; -+} -+ -+void update_sta_vht_info_apmode(_adapter *padapter, void * psta) -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct vht_priv *pvhtpriv_ap = &pmlmepriv->vhtpriv; -+ struct vht_priv *pvhtpriv_sta = &((struct sta_info *)psta)->vhtpriv; -+ struct ht_priv *phtpriv_sta = &((struct sta_info *)psta)->htpriv; -+ u8 cur_ldpc_cap=0, cur_stbc_cap=0, cur_beamform_cap=0; -+ u8 *pcap_mcs; -+ -+ if (pvhtpriv_sta->vht_option == false) { -+ return; -+ } -+ -+ // B4 Rx LDPC -+ if (TEST_FLAG(pvhtpriv_ap->ldpc_cap, LDPC_VHT_ENABLE_TX)) { -+ SET_FLAG(cur_ldpc_cap, GET_VHT_CAPABILITY_ELE_RX_LDPC(pvhtpriv_sta->vht_cap) ? (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX) : 0); -+ } -+ pvhtpriv_sta->ldpc_cap = cur_ldpc_cap; -+ DBG_871X("Current STA VHT LDPC = %02X\n", cur_ldpc_cap); -+ -+ if (pvhtpriv_sta->bwmode > pvhtpriv_ap->bwmode) -+ pvhtpriv_sta->bwmode = pvhtpriv_ap->bwmode; -+ -+ if (pvhtpriv_sta->bwmode == CHANNEL_WIDTH_80) { -+ // B5 Short GI for 80 MHz -+ pvhtpriv_sta->sgi = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi) ? true : false; -+ DBG_871X("Current STA ShortGI80MHz = %d\n", pvhtpriv_sta->sgi); -+ } else if (pvhtpriv_sta->bwmode >= CHANNEL_WIDTH_160) { -+ // B5 Short GI for 80 MHz -+ pvhtpriv_sta->sgi = (GET_VHT_CAPABILITY_ELE_SHORT_GI160M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi) ? true : false; -+ DBG_871X("Current STA ShortGI160MHz = %d\n", pvhtpriv_sta->sgi); -+ } else { -+ pvhtpriv_sta->sgi = phtpriv_sta->sgi; -+ } -+ -+ // B8 B9 B10 Rx STBC -+ if (TEST_FLAG(pvhtpriv_ap->stbc_cap, STBC_VHT_ENABLE_TX) && -+ GET_VHT_CAPABILITY_ELE_RX_STBC(pvhtpriv_sta->vht_cap)) -+ { -+ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); -+ } -+ pvhtpriv_sta->stbc_cap = cur_stbc_cap; -+ DBG_871X("Current STA VHT STBC = %02X\n", cur_stbc_cap); -+ -+ // B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee -+ if (TEST_FLAG(pvhtpriv_ap->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && -+ GET_VHT_CAPABILITY_ELE_SU_BFEE(pvhtpriv_sta->vht_cap)) -+ { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); -+ } -+ -+ // B12 SU Beamformee Capable, the target supports Beamformee and we are Beamformer -+ if (TEST_FLAG(pvhtpriv_ap->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) && -+ GET_VHT_CAPABILITY_ELE_SU_BFER(pvhtpriv_sta->vht_cap)) -+ { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ } -+ pvhtpriv_sta->beamform_cap = cur_beamform_cap; -+ DBG_871X("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap); -+ -+ // B23 B24 B25 Maximum A-MPDU Length Exponent -+ pvhtpriv_sta->ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pvhtpriv_sta->vht_cap); -+ -+ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pvhtpriv_sta->vht_cap); -+ _rtw_memcpy(pvhtpriv_sta->vht_mcs_map, pcap_mcs, 2); -+ -+ pvhtpriv_sta->vht_highest_rate = rtw_get_vht_highest_rate(padapter, pvhtpriv_sta->vht_mcs_map); -+ -+} -+ -+void update_hw_vht_param(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 ht_AMPDU_len; -+ -+ ht_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; -+ -+ if(pvhtpriv->ampdu_len > ht_AMPDU_len) -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&pvhtpriv->ampdu_len)); -+} -+ -+void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 cur_ldpc_cap=0, cur_stbc_cap=0, cur_beamform_cap=0, rf_type = RF_1T1R; -+ u8 *pcap_mcs; -+ u8 vht_mcs[2]; -+ -+ if(pIE==NULL) return; -+ -+ if(pvhtpriv->vht_option == false) return; -+ -+ pmlmeinfo->VHT_enable = 1; -+ -+ // B4 Rx LDPC -+ if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX)) { -+ SET_FLAG(cur_ldpc_cap, GET_VHT_CAPABILITY_ELE_RX_LDPC(pIE->data) ? (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX) : 0); -+ } -+ pvhtpriv->ldpc_cap = cur_ldpc_cap; -+ DBG_871X("Current VHT LDPC Setting = %02X\n", cur_ldpc_cap); -+ -+ // B5 Short GI for 80 MHz -+ pvhtpriv->sgi = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(pIE->data) & pvhtpriv->sgi) ? true : false; -+ DBG_871X("Current ShortGI80MHz = %d\n", pvhtpriv->sgi); -+ -+ // B8 B9 B10 Rx STBC -+ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX) && -+ GET_VHT_CAPABILITY_ELE_RX_STBC(pIE->data)) -+ { -+ SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); -+ } -+ pvhtpriv->stbc_cap = cur_stbc_cap; -+ DBG_871X("Current VHT STBC Setting = %02X\n", cur_stbc_cap); -+ -+ // B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && -+ GET_VHT_CAPABILITY_ELE_SU_BFEE(pIE->data)) -+ { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); -+ } -+ -+ // B12 SU Beamformee Capable, the target supports Beamformee and we are Beamformer -+ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) && -+ GET_VHT_CAPABILITY_ELE_SU_BFER(pIE->data)) -+ { -+ SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); -+ } -+ pvhtpriv->beamform_cap = cur_beamform_cap; -+ DBG_871X("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap); -+ -+ // B23 B24 B25 Maximum A-MPDU Length Exponent -+ pvhtpriv->ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pIE->data); -+ -+ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pIE->data); -+ _rtw_memcpy(vht_mcs, pcap_mcs, 2); -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if ((rf_type == RF_1T1R) || (rf_type == RF_1T2R)) -+ vht_mcs[0] |= 0xfc; -+ else if (rf_type == RF_2T2R) -+ vht_mcs[0] |= 0xf0; -+ -+ _rtw_memcpy(pvhtpriv->vht_mcs_map, vht_mcs, 2); -+ -+ pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(padapter, pvhtpriv->vht_mcs_map); -+} -+ -+void VHT_operation_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if(pIE==NULL) return; -+ -+ if(pvhtpriv->vht_option == false) return; -+ -+ if ((GET_VHT_OPERATION_ELE_CHL_WIDTH(pIE->data) >= 1) -+ && ((pregistrypriv->bw_mode & 0xf0) >= CHANNEL_WIDTH_80)) { -+ pvhtpriv->bwmode = CHANNEL_WIDTH_80; -+ } else { -+ pvhtpriv->bwmode = phtpriv->bwmode; -+ } -+} -+ -+u32 rtw_build_vht_operation_ie(_adapter *padapter, u8 *pbuf, u8 channel) -+{ -+ //struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ u8 ChnlWidth, center_freq; -+ u32 len = 0; -+ u8 operation[5]; -+ -+ if (pvhtpriv->bwmode >= CHANNEL_WIDTH_80) -+ ChnlWidth = 1; -+ else -+ ChnlWidth = 0; -+ -+ center_freq = rtw_get_center_ch(channel, pvhtpriv->bwmode, HAL_PRIME_CHNL_OFFSET_LOWER); -+ -+ SET_VHT_OPERATION_ELE_CHL_WIDTH(operation, ChnlWidth); -+ //center frequency -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(operation, center_freq);//Todo: need to set correct center channel -+ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(operation,0); -+ SET_VHT_OPERATION_ELE_BASIC_MCS_SET(operation, 0xFFFF); -+ -+ pbuf = rtw_set_ie(pbuf, EID_VHTOperation, 12, operation, &len); -+ -+ return len; -+} -+ -+u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf) -+{ -+ //struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ u32 len = 0; -+ u8 opmode = 0, rf_type = 0; -+ u8 chnl_width, rx_nss; -+ -+ chnl_width = pvhtpriv->bwmode; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if(rf_type == RF_1T1R) -+ rx_nss = 1; -+ else -+ rx_nss = 2; -+ -+ SET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(&opmode, chnl_width); -+ SET_VHT_OPERATING_MODE_FIELD_RX_NSS(&opmode, (rx_nss-1)); -+ SET_VHT_OPERATING_MODE_FIELD_RX_NSS_TYPE(&opmode, 0); //Todo -+ -+ pbuf = rtw_set_ie(pbuf, EID_OpModeNotification, 1, &opmode, &len); -+ -+ return len; -+} -+ -+u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf) -+{ -+ u8 bw, rf_type; -+ u16 HighestRate; -+ u8 *pcap, *pcap_mcs; -+ u32 len = 0; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ -+ pcap = pvhtpriv->vht_cap; -+ _rtw_memset(pcap, 0, 32); -+ -+ // B2 B3 Supported Channel Width Set -+ SET_VHT_CAPABILITY_ELE_CHL_WIDTH(pcap, 0); //indicate we don't support neither 160M nor 80+80M bandwidth. -+ -+ // B4 Rx LDPC -+ if(TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_RX)) -+ { -+ SET_VHT_CAPABILITY_ELE_RX_LDPC(pcap, 1); -+ } -+ -+ // B5 ShortGI for 80MHz -+ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(pcap, pvhtpriv->sgi? 1 : 0); // We can receive Short GI of 80M -+ -+ // B6 ShortGI for 160MHz -+ if (pvhtpriv->bwmode > CHANNEL_WIDTH_80) { -+ SET_VHT_CAPABILITY_ELE_SHORT_GI160M(pcap, pvhtpriv->sgi? 1 : 0); -+ } -+ -+ // B7 Tx STBC -+ if(TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX)) -+ { -+ SET_VHT_CAPABILITY_ELE_TX_STBC(pcap, 1); -+ } -+ -+ // B8 B9 B10 Rx STBC -+ if(TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_RX)) -+ { -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if ((rf_type == RF_2T2R) || (rf_type == RF_1T2R)) { -+ SET_VHT_CAPABILITY_ELE_RX_STBC(pcap, 2); -+ } -+ else if (rf_type == RF_1T1R) { -+ SET_VHT_CAPABILITY_ELE_RX_STBC(pcap, 1); -+ } -+ } -+ -+ // B11 SU Beamformer Capable -+ if(TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) -+ { -+ SET_VHT_CAPABILITY_ELE_SU_BFER(pcap, 1); -+ } -+ -+ // B12 SU Beamformee Capable -+ if(TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) -+ { -+ SET_VHT_CAPABILITY_ELE_SU_BFEE(pcap, 1); -+ } -+ -+ // B13 14 15 Compressed Steering Number of Beamformer Antennas Supported -+ SET_VHT_CAPABILITY_ELE_BFER_ANT_SUPP(pcap, 1);// TODO -+ // B16 17 18 Number of Sounding Dimensions -+ SET_VHT_CAPABILITY_ELE_SOUNDING_DIMENSIONS(pcap, 1); -+ -+ // B19 MU Beamformer Capable -+ SET_VHT_CAPABILITY_ELE_MU_BFER(pcap, 0); //HW don't support mu bfee/bfer -+ // B20 MU Beamformee Capable -+ SET_VHT_CAPABILITY_ELE_MU_BFEE(pcap, 0); -+ // B21 VHT TXOP PS -+ SET_VHT_CAPABILITY_ELE_TXOP_PS(pcap, 0); -+ // B22 +HTC-VHT Capable -+ SET_VHT_CAPABILITY_ELE_HTC_VHT(pcap, 1); -+ // B23 24 25 Maximum A-MPDU Length Exponent -+ if (pregistrypriv->ampdu_factor != 0xFE) -+ { -+ SET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pcap, pregistrypriv->ampdu_factor); -+ } -+ else -+ { -+ SET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pcap, 7); -+ } -+ // B26 27 VHT Link Adaptation Capable -+ SET_VHT_CAPABILITY_ELE_LINK_ADAPTION(pcap, 0); -+ -+ pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pcap); -+ _rtw_memcpy(pcap_mcs, pvhtpriv->vht_mcs_map, 2); -+ -+ pcap_mcs = GET_VHT_CAPABILITY_ELE_TX_MCS(pcap); -+ _rtw_memcpy(pcap_mcs, pvhtpriv->vht_mcs_map, 2); -+ -+ bw = (pregistrypriv->bw_mode >> 4) & 0xf; -+ HighestRate = VHT_MCS_DATA_RATE[bw][pvhtpriv->sgi][((pvhtpriv->vht_highest_rate - MGN_VHT1SS_MCS0)&0x3f)]; -+ HighestRate = (HighestRate+1) >> 1; -+ -+ SET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(pcap, HighestRate); //indicate we support highest rx rate is 600Mbps. -+ SET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(pcap, HighestRate); //indicate we support highest tx rate is 600Mbps. -+ -+ pbuf = rtw_set_ie(pbuf, EID_VHTCapability, 12, pcap, &len); -+ -+ return len; -+} -+ -+u32 rtw_restructure_vht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len) -+{ -+ u32 ielen, out_len; -+ u8 cap_len, notify_len, operation_bw, supported_chnl_width; -+ u8 *p, *pframe; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ -+ rtw_vht_use_default_setting(padapter); -+ -+ p = rtw_get_ie(in_ie+12, EID_VHTCapability, &ielen, in_len-12); -+ if (p && ielen>0) { -+ supported_chnl_width = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p+2); -+ -+ // VHT Capabilities element -+ cap_len = rtw_build_vht_cap_ie(padapter, out_ie+*pout_len); -+ *pout_len += cap_len; -+ -+ // Get HT BW -+ p = rtw_get_ie(in_ie+12, _HT_EXTRA_INFO_IE_, &ielen, in_len-12); -+ if (p && ielen>0) { -+ struct HT_info_element *pht_info = (struct HT_info_element *)(p+2); -+ if (pht_info->infos[0] & BIT(2)) -+ operation_bw = CHANNEL_WIDTH_40; -+ else -+ operation_bw = CHANNEL_WIDTH_20; -+ } -+ -+ // VHT Operation element -+ p = rtw_get_ie(in_ie+12, EID_VHTOperation, &ielen, in_len-12); -+ if (p && ielen>0) { -+ out_len = *pout_len; -+ if (GET_VHT_OPERATION_ELE_CHL_WIDTH(p+2) >= 1) { -+ if (supported_chnl_width == 2) -+ operation_bw = CHANNEL_WIDTH_80_80; -+ else if (supported_chnl_width == 1) -+ operation_bw = CHANNEL_WIDTH_160; -+ else -+ operation_bw = CHANNEL_WIDTH_80; -+ } -+ pframe = rtw_set_ie(out_ie+out_len, EID_VHTOperation, ielen, p+2 , pout_len); -+ } -+ -+ if (pvhtpriv->bwmode > operation_bw) -+ pvhtpriv->bwmode = operation_bw; -+ -+ // Operating Mode Notification element -+ notify_len = rtw_build_vht_op_mode_notify_ie(padapter, out_ie+*pout_len); -+ *pout_len += notify_len; -+ -+ pvhtpriv->vht_option = true; -+ } -+ -+ return (pvhtpriv->vht_option); -+ -+} -+ -+void VHTOnAssocRsp(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 ht_AMPDU_len; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ if (!pmlmeinfo->HT_enable) -+ return; -+ -+ if (!pmlmeinfo->VHT_enable) -+ return; -+ -+ if(pvhtpriv->bwmode >= CHANNEL_WIDTH_80) -+ pmlmeext->cur_bwmode = pvhtpriv->bwmode; -+ -+ ht_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; -+ -+ if(pvhtpriv->ampdu_len > ht_AMPDU_len) -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&pvhtpriv->ampdu_len)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MAX_TIME, (u8 *)(&pvhtpriv->vht_highest_rate)); -+} -+ -+#endif //CONFIG_80211AC_VHT -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_wapi.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_wapi.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_wapi.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_wapi.c 2018-02-06 17:42:30.700967016 +0200 -@@ -0,0 +1,1326 @@ -+#ifdef CONFIG_WAPI_SUPPORT -+ -+#include -+#include -+#include -+#include -+ -+ -+u32 wapi_debug_component = -+// WAPI_INIT | -+// WAPI_API | -+// WAPI_TX | -+// WAPI_RX | -+ WAPI_ERR ; //always open err flags on -+ -+void WapiFreeAllStaInfo(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo; -+ PRT_WAPI_STA_INFO pWapiStaInfo; -+ PRT_WAPI_BKID pWapiBkid; -+ -+ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); -+ pWapiInfo = &padapter->wapiInfo; -+ -+ //Pust to Idle List -+ rtw_wapi_return_all_sta_info(padapter); -+ -+ //Sta Info List -+ while(!list_empty(&(pWapiInfo->wapiSTAIdleList))) -+ { -+ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAIdleList.next, RT_WAPI_STA_INFO, list); -+ list_del_init(&pWapiStaInfo->list); -+ } -+ -+ //BKID List -+ while(!list_empty(&(pWapiInfo->wapiBKIDIdleList))) -+ { -+ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDIdleList.next, RT_WAPI_BKID, list); -+ list_del_init(&pWapiBkid->list); -+ } -+ WAPI_TRACE(WAPI_INIT, "<=========== %s\n", __FUNCTION__); -+ return; -+} -+ -+void WapiSetIE(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ //PRT_WAPI_BKID pWapiBkid; -+ u16 protocolVer = 1; -+ u16 akmCnt = 1; -+ u16 suiteCnt = 1; -+ u16 capability = 0; -+ u8 OUI[3]; -+ -+ OUI[0] = 0x00; -+ OUI[1] = 0x14; -+ OUI[2] = 0x72; -+ -+ pWapiInfo->wapiIELength = 0; -+//protocol version -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength, &protocolVer, 2); -+ pWapiInfo->wapiIELength +=2; -+//akm -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength, &akmCnt, 2); -+ pWapiInfo->wapiIELength +=2; -+ -+ if(pWapiInfo->bWapiPSK){ -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength,OUI, 3); -+ pWapiInfo->wapiIELength +=3; -+ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x2; -+ pWapiInfo->wapiIELength +=1; -+ }else{ -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength,OUI, 3); -+ pWapiInfo->wapiIELength +=3; -+ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; -+ pWapiInfo->wapiIELength +=1; -+ } -+ -+//usk -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength, &suiteCnt, 2); -+ pWapiInfo->wapiIELength +=2; -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength,OUI, 3); -+ pWapiInfo->wapiIELength +=3; -+ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; -+ pWapiInfo->wapiIELength +=1; -+ -+//msk -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength,OUI, 3); -+ pWapiInfo->wapiIELength +=3; -+ pWapiInfo->wapiIE[pWapiInfo->wapiIELength] = 0x1; -+ pWapiInfo->wapiIELength +=1; -+ -+//Capbility -+ memcpy(pWapiInfo->wapiIE+pWapiInfo->wapiIELength, &capability, 2); -+ pWapiInfo->wapiIELength +=2; -+} -+ -+ -+/* PN1 > PN2, return 1, -+ * else return 0. -+ */ -+u32 WapiComparePN(u8 *PN1, u8 *PN2) -+{ -+ char i; -+ -+ if ((NULL == PN1) || (NULL == PN2)) -+ return 1; -+ -+ // overflow case -+ if ((PN2[15] - PN1[15]) & 0x80) -+ return 1; -+ -+ for (i=16; i>0; i--) -+ { -+ if(PN1[i-1] == PN2[i-1]) -+ continue; -+ else if(PN1[i-1] > PN2[i-1]) -+ return 1; -+ else -+ return 0; -+ } -+ -+ return 0; -+} -+ -+u8 -+WapiGetEntryForCamWrite(_adapter *padapter,u8 *pMacAddr,u8 KID,bool IsMsk) -+{ -+ PRT_WAPI_T pWapiInfo=NULL; -+ //PRT_WAPI_CAM_ENTRY pEntry=NULL; -+ u8 i=0; -+ u8 ret = 0xff; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ //exist? -+ for(i=0;iwapiCamEntry[i].IsUsed -+ && (_rtw_memcmp(pMacAddr, pWapiInfo->wapiCamEntry[i].PeerMacAddr, ETH_ALEN) == true) -+ && pWapiInfo->wapiCamEntry[i].keyidx == KID -+ && pWapiInfo->wapiCamEntry[i].type == IsMsk) -+ { -+ ret = pWapiInfo->wapiCamEntry[i].entry_idx; //cover it -+ break; -+ } -+ } -+ -+ if(i == WAPI_CAM_ENTRY_NUM) //not found -+ { -+ for(i=0;iwapiCamEntry[i].IsUsed == 0) -+ { -+ pWapiInfo->wapiCamEntry[i].IsUsed = 1; -+ pWapiInfo->wapiCamEntry[i].type = IsMsk; -+ pWapiInfo->wapiCamEntry[i].keyidx = KID; -+ _rtw_memcpy(pWapiInfo->wapiCamEntry[i].PeerMacAddr, pMacAddr,ETH_ALEN); -+ ret = pWapiInfo->wapiCamEntry[i].entry_idx; -+ break; -+ } -+ } -+ } -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+ return ret; -+ -+/* -+ if(RTIsListEmpty(&pWapiInfo->wapiCamIdleList)){ -+ RT_TRACE(COMP_SEC,DBG_LOUD,("No Entry for wapi!!!\n")); -+ return 0; -+ } -+ -+ pEntry = (PRT_WAPI_CAM_ENTRY)RTRemoveHeadList(&pWapiInfo->wapiCamIdleList); -+ RTInsertTailList(&pWapiInfo->wapiCamUsedList, &pEntry->list); -+ -+ RT_TRACE(COMP_SEC,DBG_LOUD,("<====WapiGetCamEntry(),Get Entry Idx:%d.but we just return 4 for test\n",pEntry->entry_idx)); -+ -+ return pEntry->entry_idx;*/ -+} -+ -+u8 WapiGetEntryForCamClear(_adapter *padapter,u8 *pPeerMac,u8 keyid,u8 IsMsk) -+{ -+ PRT_WAPI_T pWapiInfo=NULL; -+ u8 i=0; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ for(i=0;iwapiCamEntry[i].IsUsed -+ && (_rtw_memcmp(pPeerMac, pWapiInfo->wapiCamEntry[i].PeerMacAddr, ETH_ALEN) == true) -+ && pWapiInfo->wapiCamEntry[i].keyidx == keyid -+ && pWapiInfo->wapiCamEntry[i].type == IsMsk) -+ { -+ pWapiInfo->wapiCamEntry[i].IsUsed = 0; -+ pWapiInfo->wapiCamEntry[i].keyidx = 2; -+ _rtw_memset(pWapiInfo->wapiCamEntry[i].PeerMacAddr,0,ETH_ALEN); -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+ return pWapiInfo->wapiCamEntry[i].entry_idx; -+ } -+ } -+ -+ WAPI_TRACE(WAPI_API,"<====WapiGetReturnCamEntry(), No this cam entry.\n"); -+ return 0xff; -+/* -+ if(RTIsListEmpty(&pWapiInfo->wapiCamUsedList)){ -+ RT_TRACE(COMP_SEC,DBG_LOUD,("No Entry for wapi!!!\n")); -+ return false; -+ } -+ -+ pList = &pWapiInfo->wapiCamUsedList; -+ while(pList->Flink != &pWapiInfo->wapiCamUsedList) -+ { -+ pEntry = (PRT_WAPI_CAM_ENTRY)pList->Flink; -+ if(PlatformCompareMemory(pPeerMac,pEntry->PeerMacAddr, ETHER_ADDRLEN)== 0 -+ && keyid == pEntry->keyidx) -+ { -+ RTRemoveEntryList(pList); -+ RTInsertHeadList(&pWapiInfo->wapiCamIdleList, pList); -+ return pEntry->entry_idx; -+ } -+ pList = pList->Flink; -+ } -+ -+ return 0; -+*/ -+} -+ -+void -+WapiResetAllCamEntry(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo; -+ int i; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ for (i=0;iwapiCamEntry[i].PeerMacAddr, 0, ETH_ALEN); -+ pWapiInfo->wapiCamEntry[i].IsUsed = 0; -+ pWapiInfo->wapiCamEntry[i].keyidx = 2; //invalid -+ pWapiInfo->wapiCamEntry[i].entry_idx = 4+i*2; -+ } -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+ -+ return; -+} -+ -+u8 WapiWriteOneCamEntry( -+ _adapter *padapter, -+ u8 *pMacAddr, -+ u8 KeyId, -+ u8 EntryId, -+ u8 EncAlg, -+ u8 bGroupKey, -+ u8 *pKey -+) -+{ -+ u8 retVal = 0; -+ u16 usConfig = 0; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ if(EntryId >= 32) -+ { -+ WAPI_TRACE(WAPI_ERR, "<=== CamAddOneEntry(): ulKeyId exceed!\n"); -+ return retVal; -+ } -+ -+ usConfig=usConfig|(0x01<<15)|((u16)(EncAlg)<<2)|(KeyId); -+ -+ if(EncAlg == _SMS4_ ) -+ { -+ if(bGroupKey == 1) -+ usConfig |= (0x01<<6); -+ if((EntryId % 2)==1) // ==0 sec key; == 1mic key -+ usConfig |= (0x01<<5); -+ } -+ -+ write_cam(padapter, EntryId, usConfig, pMacAddr, pKey); -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ return 1; -+} -+ -+void rtw_wapi_init(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo; -+ int i; -+ -+ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); -+ RT_ASSERT_RET(padapter); -+ -+ if (!padapter->WapiSupport) -+ { -+ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ pWapiInfo = &padapter->wapiInfo; -+ pWapiInfo->bWapiEnable = false; -+ -+ //Init BKID List -+ INIT_LIST_HEAD(&pWapiInfo->wapiBKIDIdleList); -+ INIT_LIST_HEAD(&pWapiInfo->wapiBKIDStoreList); -+ for(i=0;iwapiBKID[i].list, &pWapiInfo->wapiBKIDIdleList); -+ } -+ -+ //Init STA List -+ INIT_LIST_HEAD(&pWapiInfo->wapiSTAIdleList); -+ INIT_LIST_HEAD(&pWapiInfo->wapiSTAUsedList); -+ for(i=0;iwapiSta[i].list, &pWapiInfo->wapiSTAIdleList); -+ } -+ -+ for (i=0;iwapiCamEntry[i].IsUsed = 0; -+ pWapiInfo->wapiCamEntry[i].keyidx = 2; //invalid -+ pWapiInfo->wapiCamEntry[i].entry_idx = 4+i*2; -+ } -+ -+ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_free(_adapter *padapter) -+{ -+ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); -+ RT_ASSERT_RET(padapter); -+ -+ if (!padapter->WapiSupport) -+ { -+ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ WapiFreeAllStaInfo(padapter); -+ -+ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_disable_tx(_adapter *padapter) -+{ -+ WAPI_TRACE(WAPI_INIT, "===========> %s\n", __FUNCTION__); -+ RT_ASSERT_RET(padapter); -+ -+ if (!padapter->WapiSupport) -+ { -+ WAPI_TRACE(WAPI_INIT, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ padapter->wapiInfo.wapiTxMsk.bTxEnable = false; -+ padapter->wapiInfo.wapiTxMsk.bSet = false; -+ -+ WAPI_TRACE(WAPI_INIT, "<========== %s\n", __FUNCTION__); -+} -+ -+u8 rtw_wapi_is_wai_packet(_adapter* padapter,u8 *pkt_data) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ u8 WaiPkt = 0, *pTaddr, bFind = false; -+ u8 Offset_TypeWAI = 0 ; // (mac header len + llc length) -+ -+ WAPI_TRACE(WAPI_TX|WAPI_RX, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return 0; -+ } -+ -+ Offset_TypeWAI = 24 + 6 ; -+ -+ //YJ,add,091103. Data frame may also have skb->data[30]=0x88 and skb->data[31]=0xb4. -+ if ((pkt_data[1]&0x40) !=0) -+ { -+ DBG_871X("data is privacy \n"); -+ return 0; -+ } -+ -+ pTaddr = GetAddr2Ptr(pkt_data); -+ if(list_empty(&pWapiInfo->wapiSTAUsedList)){ -+ bFind = false; -+ }else{ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list){ -+ if (_rtw_memcmp(pTaddr, pWapiSta->PeerMacAddr, 6) == true) { -+ bFind = true; -+ break; -+ } -+ } -+ } -+ -+ WAPI_TRACE(WAPI_TX|WAPI_RX, "%s: bFind=%d pTaddr="MAC_FMT"\n", __FUNCTION__, bFind, MAC_ARG(pTaddr)); -+ -+ if (pkt_data[0] == WIFI_QOS_DATA_TYPE) -+ { -+ Offset_TypeWAI += 2; -+ } -+ -+ // 88b4? -+ if( (pkt_data[Offset_TypeWAI]==0x88) && (pkt_data[Offset_TypeWAI+1]==0xb4) ){ -+ WaiPkt = pkt_data[Offset_TypeWAI+5]; -+ -+ psecuritypriv->hw_decrypted = true; -+ }else{ -+ WAPI_TRACE(WAPI_TX|WAPI_RX, "%s(): non wai packet\n",__FUNCTION__); -+ } -+ -+ WAPI_TRACE(WAPI_TX|WAPI_RX, "%s(): Recvd WAI frame. IsWAIPkt(%d)\n",__FUNCTION__, WaiPkt); -+ -+ return WaiPkt; -+} -+ -+ -+void rtw_wapi_update_info(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ struct recv_frame_hdr *precv_hdr; -+ u8 *ptr; -+ u8 *pTA; -+ u8 *pRecvPN; -+ -+ -+ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ precv_hdr = &precv_frame->u.hdr; -+ ptr = precv_hdr->rx_data; -+ -+ if (precv_hdr->attrib.qos == 1) -+ { -+ precv_hdr->UserPriority = GetTid(ptr); -+ } -+ else -+ { -+ precv_hdr->UserPriority = 0; -+ } -+ -+ pTA = GetAddr2Ptr(ptr); -+ _rtw_memcpy((u8 *)precv_hdr->WapiSrcAddr, pTA, 6); -+ pRecvPN = ptr + precv_hdr->attrib.hdrlen + 2; -+ _rtw_memcpy((u8 *)precv_hdr->WapiTempPN, pRecvPN, 16); -+ -+ WAPI_TRACE(WAPI_RX, "<========== %s\n", __FUNCTION__); -+} -+ -+/**************************************************************************** -+true-----------------Drop -+false---------------- handle -+add to support WAPI to N-mode -+*****************************************************************************/ -+u8 rtw_wapi_check_for_drop( -+ _adapter *padapter, -+ union recv_frame *precv_frame -+) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ u8 *pLastRecvPN = NULL; -+ u8 bFind = false; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ u8 bDrop = false; -+ struct recv_frame_hdr *precv_hdr = &precv_frame->u.hdr; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 *ptr = precv_frame->u.hdr.rx_data; -+ int i; -+ -+ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return false; -+ } -+ -+ if(precv_hdr->bIsWaiPacket !=0) -+ { -+ if(precv_hdr->bIsWaiPacket== 0x8) -+ { -+ -+ DBG_871X("rtw_wapi_check_for_drop: dump packet \n"); -+ for(i=0;i<50;i++) -+ { -+ DBG_871X("%02X ",ptr[i]); -+ if((i+1) %8 ==0) -+ DBG_871X("\n"); -+ } -+ DBG_871X("\n rtw_wapi_check_for_drop: dump packet \n"); -+ -+ for(i=0;i<16;i++) -+ { -+ if(ptr[i+27] !=0) -+ break; -+ } -+ -+ if(i== 16) -+ { -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_check_for_drop: drop with zero BKID \n"); -+ return true; -+ } -+ else -+ { -+ return false; -+ } -+ } -+ else -+ return false; -+ } -+ -+ if(list_empty(&pWapiInfo->wapiSTAUsedList)){ -+ bFind = false; -+ }else{ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (_rtw_memcmp(precv_hdr->WapiSrcAddr, pWapiSta->PeerMacAddr, ETH_ALEN) == true) { -+ bFind = true; -+ break; -+ } -+ } -+ } -+ WAPI_TRACE(WAPI_RX, "%s: bFind=%d prxb->WapiSrcAddr="MAC_FMT"\n", __FUNCTION__, bFind, MAC_ARG(precv_hdr->WapiSrcAddr)); -+ -+ if(bFind) -+ { -+ if(IS_MCAST(precv_hdr->attrib.ra)) -+ { -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_check_for_drop: multicast case \n"); -+ pLastRecvPN = pWapiSta->lastRxMulticastPN; -+ } -+ else -+ { -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_check_for_drop: unicast case \n"); -+ switch(precv_hdr->UserPriority) -+ { -+ case 0: -+ case 3: -+ pLastRecvPN = pWapiSta->lastRxUnicastPNBEQueue; -+ break; -+ case 1: -+ case 2: -+ pLastRecvPN = pWapiSta->lastRxUnicastPNBKQueue; -+ break; -+ case 4: -+ case 5: -+ pLastRecvPN = pWapiSta->lastRxUnicastPNVIQueue; -+ break; -+ case 6: -+ case 7: -+ pLastRecvPN = pWapiSta->lastRxUnicastPNVOQueue; -+ break; -+ default: -+ WAPI_TRACE(WAPI_ERR,"%s: Unknown TID \n",__FUNCTION__); -+ break; -+ } -+ } -+ -+ if(!WapiComparePN(precv_hdr->WapiTempPN,pLastRecvPN)) -+ { -+ WAPI_TRACE(WAPI_RX,"%s: Equal PN!!\n",__FUNCTION__); -+ if(IS_MCAST(precv_hdr->attrib.ra)) -+ _rtw_memcpy(pLastRecvPN,WapiAEMultiCastPNInitialValueSrc,16); -+ else -+ _rtw_memcpy(pLastRecvPN,WapiAEPNInitialValueSrc,16); -+ bDrop = true; -+ } -+ else -+ { -+ _rtw_memcpy(pLastRecvPN,precv_hdr->WapiTempPN,16); -+ } -+ } -+ -+ WAPI_TRACE(WAPI_RX, "<========== %s\n", __FUNCTION__); -+ return bDrop; -+} -+ -+void rtw_build_probe_resp_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ u8 WapiIELength = 0; -+ -+ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ WapiSetIE(padapter); -+ WapiIELength = pWapiInfo->wapiIELength; -+ pframe[0] = _WAPI_IE_; -+ pframe[1] = WapiIELength; -+ _rtw_memcpy(pframe+2, pWapiInfo->wapiIE, WapiIELength); -+ pframe += WapiIELength+2; -+ pattrib->pktlen += WapiIELength+2; -+ -+ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_build_beacon_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ u8 WapiIELength = 0; -+ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ WapiSetIE(padapter); -+ WapiIELength = pWapiInfo->wapiIELength; -+ pframe[0] = _WAPI_IE_; -+ pframe[1] = WapiIELength; -+ _rtw_memcpy(pframe+2, pWapiInfo->wapiIE, WapiIELength); -+ pframe += WapiIELength+2; -+ pattrib->pktlen += WapiIELength+2; -+ -+ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_build_assoc_req_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib) -+{ -+ PRT_WAPI_BKID pWapiBKID; -+ u16 bkidNum; -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ u8 WapiIELength = 0; -+ -+ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported!\n", __FUNCTION__); -+ return; -+ } -+ -+ WapiSetIE(padapter); -+ WapiIELength = pWapiInfo->wapiIELength; -+ bkidNum = 0; -+ if(!list_empty(&(pWapiInfo->wapiBKIDStoreList))){ -+ list_for_each_entry(pWapiBKID, &pWapiInfo->wapiBKIDStoreList, list) { -+ bkidNum ++; -+ _rtw_memcpy(pWapiInfo->wapiIE+WapiIELength+2, pWapiBKID->bkid,16); -+ WapiIELength += 16; -+ } -+ } -+ _rtw_memcpy(pWapiInfo->wapiIE+WapiIELength, &bkidNum, 2); -+ WapiIELength += 2; -+ -+ pframe[0] = _WAPI_IE_; -+ pframe[1] = WapiIELength; -+ _rtw_memcpy(pframe+2, pWapiInfo->wapiIE, WapiIELength); -+ pframe += WapiIELength+2; -+ pattrib->pktlen += WapiIELength+2; -+ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_on_assoc_ok(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); -+ PRT_WAPI_STA_INFO pWapiSta; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ //u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ -+ WAPI_TRACE(WAPI_MLME, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ pWapiSta =(PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAIdleList.next, RT_WAPI_STA_INFO, list); -+ list_del_init(&pWapiSta->list); -+ list_add_tail(&pWapiSta->list, &pWapiInfo->wapiSTAUsedList); -+ _rtw_memcpy(pWapiSta->PeerMacAddr,padapter->mlmeextpriv.mlmext_info.network.MacAddress,6); -+ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPN, WapiAEPNInitialValueSrc, 16); -+ -+ //For chenk PN error with Qos Data after s3: add by ylb 20111114 -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiAEPNInitialValueSrc,16); -+ -+ WAPI_TRACE(WAPI_MLME, "<========== %s\n", __FUNCTION__); -+} -+ -+ -+void rtw_wapi_return_one_sta_info(_adapter *padapter, u8 *MacAddr) -+{ -+ PRT_WAPI_T pWapiInfo; -+ PRT_WAPI_STA_INFO pWapiStaInfo = NULL; -+ PRT_WAPI_BKID pWapiBkid = NULL; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ WAPI_TRACE(WAPI_API, "==========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ { -+ while(!list_empty(&(pWapiInfo->wapiBKIDStoreList))) -+ { -+ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDStoreList.next, RT_WAPI_BKID, list); -+ list_del_init(&pWapiBkid->list); -+ _rtw_memset(pWapiBkid->bkid,0,16); -+ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDIdleList); -+ } -+ } -+ -+ -+ WAPI_TRACE(WAPI_API, " %s: after clear bkid \n", __FUNCTION__); -+ -+ -+ //Remove STA info -+ if(list_empty(&(pWapiInfo->wapiSTAUsedList))){ -+ WAPI_TRACE(WAPI_API, " %s: wapiSTAUsedList is null \n", __FUNCTION__); -+ return; -+ }else{ -+ -+ WAPI_TRACE(WAPI_API, " %s: wapiSTAUsedList is not null \n", __FUNCTION__); -+#if 0 -+ pWapiStaInfo=(PRT_WAPI_STA_INFO)list_entry((pWapiInfo->wapiSTAUsedList.next),RT_WAPI_STA_INFO,list); -+ -+ list_for_each_entry(pWapiStaInfo, &(pWapiInfo->wapiSTAUsedList), list) { -+ -+ DBG_871X("MAC Addr %02x-%02x-%02x-%02x-%02x-%02x \n",MacAddr[0],MacAddr[1],MacAddr[2],MacAddr[3],MacAddr[4],MacAddr[5]); -+ -+ -+ DBG_871X("peer Addr %02x-%02x-%02x-%02x-%02x-%02x \n",pWapiStaInfo->PeerMacAddr[0],pWapiStaInfo->PeerMacAddr[1],pWapiStaInfo->PeerMacAddr[2],pWapiStaInfo->PeerMacAddr[3],pWapiStaInfo->PeerMacAddr[4],pWapiStaInfo->PeerMacAddr[5]); -+ -+ if(pWapiStaInfo == NULL) -+ { -+ WAPI_TRACE(WAPI_API, " %s: pWapiStaInfo == NULL Case \n", __FUNCTION__); -+ return; -+ } -+ -+ if(pWapiStaInfo->PeerMacAddr == NULL) -+ { -+ WAPI_TRACE(WAPI_API, " %s: pWapiStaInfo->PeerMacAddr == NULL Case \n", __FUNCTION__); -+ return; -+ } -+ -+ if(MacAddr == NULL) -+ { -+ WAPI_TRACE(WAPI_API, " %s: MacAddr == NULL Case \n", __FUNCTION__); -+ return; -+ } -+ -+ if (_rtw_memcmp(pWapiStaInfo->PeerMacAddr, MacAddr, ETH_ALEN) == true) { -+ pWapiStaInfo->bAuthenticateInProgress = false; -+ pWapiStaInfo->bSetkeyOk = false; -+ _rtw_memset(pWapiStaInfo->PeerMacAddr,0,ETH_ALEN); -+ list_del_init(&pWapiStaInfo->list); -+ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); -+ break; -+ } -+ -+ } -+#endif -+ -+ while(!list_empty(&(pWapiInfo->wapiSTAUsedList))) -+ { -+ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAUsedList.next, RT_WAPI_STA_INFO, list); -+ -+ DBG_871X("peer Addr %02x-%02x-%02x-%02x-%02x-%02x \n",pWapiStaInfo->PeerMacAddr[0],pWapiStaInfo->PeerMacAddr[1],pWapiStaInfo->PeerMacAddr[2],pWapiStaInfo->PeerMacAddr[3],pWapiStaInfo->PeerMacAddr[4],pWapiStaInfo->PeerMacAddr[5]); -+ -+ list_del_init(&pWapiStaInfo->list); -+ memset(pWapiStaInfo->PeerMacAddr,0,ETH_ALEN); -+ pWapiStaInfo->bSetkeyOk = 0; -+ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); -+ } -+ -+ } -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+ return; -+} -+ -+void rtw_wapi_return_all_sta_info(_adapter *padapter) -+{ -+ PRT_WAPI_T pWapiInfo; -+ PRT_WAPI_STA_INFO pWapiStaInfo; -+ PRT_WAPI_BKID pWapiBkid; -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ pWapiInfo = &padapter->wapiInfo; -+ -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ //Sta Info List -+ while(!list_empty(&(pWapiInfo->wapiSTAUsedList))) -+ { -+ pWapiStaInfo = (PRT_WAPI_STA_INFO)list_entry(pWapiInfo->wapiSTAUsedList.next, RT_WAPI_STA_INFO, list); -+ list_del_init(&pWapiStaInfo->list); -+ memset(pWapiStaInfo->PeerMacAddr,0,ETH_ALEN); -+ pWapiStaInfo->bSetkeyOk = 0; -+ list_add_tail(&pWapiStaInfo->list, &pWapiInfo->wapiSTAIdleList); -+ } -+ -+ //BKID List -+ while(!list_empty(&(pWapiInfo->wapiBKIDStoreList))) -+ { -+ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDStoreList.next, RT_WAPI_BKID, list); -+ list_del_init(&pWapiBkid->list); -+ memset(pWapiBkid->bkid,0,16); -+ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDIdleList); -+ } -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_clear_cam_entry(_adapter *padapter, u8 *pMacAddr) -+{ -+ u8 UcIndex = 0; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 0, 0); -+ if(UcIndex != 0xff){ -+ //CAM_mark_invalid(Adapter, UcIndex); -+ CAM_empty_entry(padapter, UcIndex); -+ } -+ -+ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 1, 0); -+ if(UcIndex != 0xff){ -+ //CAM_mark_invalid(Adapter, UcIndex); -+ CAM_empty_entry(padapter, UcIndex); -+ } -+ -+ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 0, 1); -+ if(UcIndex != 0xff){ -+ //CAM_mark_invalid(Adapter, UcIndex); -+ CAM_empty_entry(padapter, UcIndex); -+ } -+ -+ UcIndex = WapiGetEntryForCamClear(padapter, pMacAddr, 1, 1); -+ if(UcIndex != 0xff){ -+ //CAM_mark_invalid(padapter, UcIndex); -+ CAM_empty_entry(padapter, UcIndex); -+ } -+ -+ WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_clear_all_cam_entry(_adapter *padapter) -+{ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_MLME, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ invalidate_cam_all(padapter); // is this ok? -+ WapiResetAllCamEntry(padapter); -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+} -+ -+void rtw_wapi_set_key(_adapter *padapter, RT_WAPI_KEY *pWapiKey, RT_WAPI_STA_INFO *pWapiSta, u8 bGroupKey, u8 bUseDefaultKey) -+{ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ u8 *pMacAddr = pWapiSta->PeerMacAddr; -+ u32 EntryId = 0; -+ bool IsPairWise = false ; -+ u8 EncAlgo; -+ -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_API, "<========== %s, WAPI not supported or not enabled!\n", __FUNCTION__); -+ return; -+ } -+ -+ EncAlgo = _SMS4_; -+ -+ //For Tx bc/mc pkt,use defualt key entry -+ if(bUseDefaultKey) -+ { -+ // when WAPI update key, keyid will be 0 or 1 by turns. -+ if (pWapiKey->keyId == 0) -+ EntryId = 0; -+ else -+ EntryId = 2; -+ } -+ else -+ { -+ // tx/rx unicast pkt, or rx broadcast, find the key entry by peer's MacAddr -+ EntryId = WapiGetEntryForCamWrite(padapter,pMacAddr,pWapiKey->keyId,bGroupKey); -+ } -+ -+ if(EntryId == 0xff){ -+ WAPI_TRACE(WAPI_API, "===>No entry for WAPI setkey! !!\n"); -+ return; -+ } -+ -+ //EntryId is also used to diff Sec key and Mic key -+ //Sec Key -+ WapiWriteOneCamEntry(padapter, -+ pMacAddr, -+ pWapiKey->keyId, //keyid -+ EntryId, //entry -+ EncAlgo, //type -+ bGroupKey, //pairwise or group key -+ pWapiKey->dataKey); -+ //MIC key -+ WapiWriteOneCamEntry(padapter, -+ pMacAddr, -+ pWapiKey->keyId, //keyid -+ EntryId+1, //entry -+ EncAlgo, //type -+ bGroupKey, //pairwise or group key -+ pWapiKey->micKey); -+ -+ WAPI_TRACE(WAPI_API, "Set Wapi Key :KeyId:%d,EntryId:%d,PairwiseKey:%d.\n",pWapiKey->keyId,EntryId,!bGroupKey); -+ WAPI_TRACE(WAPI_API, "===========> %s\n", __FUNCTION__); -+ -+} -+ -+#if 0 -+//YJ,test,091013 -+void wapi_test_set_key(struct _adapter *padapter, u8* buf) -+{ /*Data: keyType(1) + bTxEnable(1) + bAuthenticator(1) + bUpdate(1) + PeerAddr(6) + DataKey(16) + MicKey(16) + KeyId(1)*/ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_BKID pWapiBkid; -+ PRT_WAPI_STA_INFO pWapiSta; -+ u8 data[43]; -+ bool bTxEnable; -+ bool bUpdate; -+ bool bAuthenticator; -+ u8 PeerAddr[6]; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ -+ WAPI_TRACE(WAPI_INIT, "===========>%s\n", __FUNCTION__); -+ -+ if (!padapter->WapiSupport){ -+ return; -+ } -+ -+ copy_from_user(data, buf, 43); -+ bTxEnable = data[1]; -+ bAuthenticator = data[2]; -+ bUpdate = data[3]; -+ memcpy(PeerAddr,data+4,6); -+ -+ if(data[0] == 0x3){ -+ if(!list_empty(&(pWapiInfo->wapiBKIDIdleList))){ -+ pWapiBkid = (PRT_WAPI_BKID)list_entry(pWapiInfo->wapiBKIDIdleList.next, RT_WAPI_BKID, list); -+ list_del_init(&pWapiBkid->list); -+ memcpy(pWapiBkid->bkid, data+10, 16); -+ WAPI_DATA(WAPI_INIT, "SetKey - BKID", pWapiBkid->bkid, 16); -+ list_add_tail(&pWapiBkid->list, &pWapiInfo->wapiBKIDStoreList); -+ } -+ }else{ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if(!memcmp(pWapiSta->PeerMacAddr,PeerAddr,6)){ -+ pWapiSta->bAuthenticatorInUpdata = false; -+ switch(data[0]){ -+ case 1: //usk -+ if(bAuthenticator){ //authenticator -+ memcpy(pWapiSta->lastTxUnicastPN,WapiAEPNInitialValueSrc,16); -+ if(!bUpdate) { //first -+ WAPI_TRACE(WAPI_INIT,"AE fisrt set usk \n"); -+ pWapiSta->wapiUsk.bSet = true; -+ memcpy(pWapiSta->wapiUsk.dataKey,data+10,16); -+ memcpy(pWapiSta->wapiUsk.micKey,data+26,16); -+ pWapiSta->wapiUsk.keyId = *(data+42); -+ pWapiSta->wapiUsk.bTxEnable = true; -+ WAPI_DATA(WAPI_INIT, "SetKey - AE USK Data Key", pWapiSta->wapiUsk.dataKey, 16); -+ WAPI_DATA(WAPI_INIT, "SetKey - AE USK Mic Key", pWapiSta->wapiUsk.micKey, 16); -+ } -+ else //update -+ { -+ WAPI_TRACE(WAPI_INIT, "AE update usk \n"); -+ pWapiSta->wapiUskUpdate.bSet = true; -+ pWapiSta->bAuthenticatorInUpdata = true; -+ memcpy(pWapiSta->wapiUskUpdate.dataKey,data+10,16); -+ memcpy(pWapiSta->wapiUskUpdate.micKey,data+26,16); -+ memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPN,WapiASUEPNInitialValueSrc,16); -+ pWapiSta->wapiUskUpdate.keyId = *(data+42); -+ pWapiSta->wapiUskUpdate.bTxEnable = true; -+ } -+ } -+ else{ -+ if(!bUpdate){ -+ WAPI_TRACE(WAPI_INIT,"ASUE fisrt set usk \n"); -+ if(bTxEnable){ -+ pWapiSta->wapiUsk.bTxEnable = true; -+ memcpy(pWapiSta->lastTxUnicastPN,WapiASUEPNInitialValueSrc,16); -+ }else{ -+ pWapiSta->wapiUsk.bSet = true; -+ memcpy(pWapiSta->wapiUsk.dataKey,data+10,16); -+ memcpy(pWapiSta->wapiUsk.micKey,data+26,16); -+ pWapiSta->wapiUsk.keyId = *(data+42); -+ pWapiSta->wapiUsk.bTxEnable = false; -+ } -+ }else{ -+ WAPI_TRACE(WAPI_INIT,"ASUE update usk \n"); -+ if(bTxEnable){ -+ pWapiSta->wapiUskUpdate.bTxEnable = true; -+ if(pWapiSta->wapiUskUpdate.bSet){ -+ memcpy(pWapiSta->wapiUsk.dataKey,pWapiSta->wapiUskUpdate.dataKey,16); -+ memcpy(pWapiSta->wapiUsk.micKey,pWapiSta->wapiUskUpdate.micKey,16); -+ pWapiSta->wapiUsk.keyId=pWapiSta->wapiUskUpdate.keyId; -+ memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiASUEPNInitialValueSrc,16); -+ memcpy(pWapiSta->lastRxUnicastPN,WapiASUEPNInitialValueSrc,16); -+ pWapiSta->wapiUskUpdate.bTxEnable = false; -+ pWapiSta->wapiUskUpdate.bSet = false; -+ } -+ memcpy(pWapiSta->lastTxUnicastPN,WapiASUEPNInitialValueSrc,16); -+ }else{ -+ pWapiSta->wapiUskUpdate.bSet = true; -+ memcpy(pWapiSta->wapiUskUpdate.dataKey,data+10,16); -+ memcpy(pWapiSta->wapiUskUpdate.micKey,data+26,16); -+ pWapiSta->wapiUskUpdate.keyId = *(data+42); -+ pWapiSta->wapiUskUpdate.bTxEnable = false; -+ } -+ } -+ } -+ break; -+ case 2: //msk -+ if(bAuthenticator){ //authenticator -+ pWapiInfo->wapiTxMsk.bSet = true; -+ memcpy(pWapiInfo->wapiTxMsk.dataKey,data+10,16); -+ memcpy(pWapiInfo->wapiTxMsk.micKey,data+26,16); -+ pWapiInfo->wapiTxMsk.keyId = *(data+42); -+ pWapiInfo->wapiTxMsk.bTxEnable = true; -+ memcpy(pWapiInfo->lastTxMulticastPN,WapiAEMultiCastPNInitialValueSrc,16); -+ -+ if(!bUpdate){ //first -+ WAPI_TRACE(WAPI_INIT, "AE fisrt set msk \n"); -+ if(!pWapiSta->bSetkeyOk) -+ pWapiSta->bSetkeyOk = true; -+ pWapiInfo->bFirstAuthentiateInProgress= false; -+ }else{ //update -+ WAPI_TRACE(WAPI_INIT,"AE update msk \n"); -+ } -+ -+ WAPI_DATA(WAPI_INIT, "SetKey - AE MSK Data Key", pWapiInfo->wapiTxMsk.dataKey, 16); -+ WAPI_DATA(WAPI_INIT, "SetKey - AE MSK Mic Key", pWapiInfo->wapiTxMsk.micKey, 16); -+ } -+ else{ -+ if(!bUpdate){ -+ WAPI_TRACE(WAPI_INIT,"ASUE fisrt set msk \n"); -+ pWapiSta->wapiMsk.bSet = true; -+ memcpy(pWapiSta->wapiMsk.dataKey,data+10,16); -+ memcpy(pWapiSta->wapiMsk.micKey,data+26,16); -+ pWapiSta->wapiMsk.keyId = *(data+42); -+ pWapiSta->wapiMsk.bTxEnable = false; -+ if(!pWapiSta->bSetkeyOk) -+ pWapiSta->bSetkeyOk = true; -+ pWapiInfo->bFirstAuthentiateInProgress= false; -+ WAPI_DATA(WAPI_INIT, "SetKey - ASUE MSK Data Key", pWapiSta->wapiMsk.dataKey, 16); -+ WAPI_DATA(WAPI_INIT, "SetKey - ASUE MSK Mic Key", pWapiSta->wapiMsk.micKey, 16); -+ }else{ -+ WAPI_TRACE(WAPI_INIT,"ASUE update msk \n"); -+ pWapiSta->wapiMskUpdate.bSet = true; -+ memcpy(pWapiSta->wapiMskUpdate.dataKey,data+10,16); -+ memcpy(pWapiSta->wapiMskUpdate.micKey,data+26,16); -+ pWapiSta->wapiMskUpdate.keyId = *(data+42); -+ pWapiSta->wapiMskUpdate.bTxEnable = false; -+ } -+ } -+ break; -+ default: -+ WAPI_TRACE(WAPI_ERR,"Unknown Flag \n"); -+ break; -+ } -+ } -+ } -+ } -+ WAPI_TRACE(WAPI_INIT, "<===========%s\n", __FUNCTION__); -+} -+ -+ -+void wapi_test_init(struct _adapter *padapter) -+{ -+ u8 keybuf[100]; -+ u8 mac_addr[6]={0x00,0xe0,0x4c,0x72,0x04,0x70}; -+ u8 UskDataKey[16]={0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,0x09,0x0a,0x0b,0x0c,0x0d,0x0e,0x0f}; -+ u8 UskMicKey[16]={0x10,0x11,0x12,0x13,0x14,0x15,0x16,0x17,0x18,0x19,0x1a,0x1b,0x1c,0x1d,0x1e,0x1f}; -+ u8 UskId = 0; -+ u8 MskDataKey[16]={0x20,0x21,0x22,0x23,0x24,0x25,0x26,0x27,0x28,0x29,0x2a,0x2b,0x2c,0x2d,0x2e,0x2f}; -+ u8 MskMicKey[16]={0x30,0x31,0x32,0x33,0x34,0x35,0x36,0x37,0x38,0x39,0x3a,0x3b,0x3c,0x3d,0x3e,0x3f}; -+ u8 MskId = 0; -+ -+ WAPI_TRACE(WAPI_INIT, "===========>%s\n", __FUNCTION__); -+ -+ //Enable Wapi -+ WAPI_TRACE(WAPI_INIT, "%s: Enable wapi!!!!\n", __FUNCTION__); -+ padapter->wapiInfo.bWapiEnable = true; -+ padapter->pairwise_key_type = KEY_TYPE_SMS4; -+ ieee->group_key_type = KEY_TYPE_SMS4; -+ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; -+ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; -+ -+ //set usk -+ WAPI_TRACE(WAPI_INIT, "%s: Set USK!!!!\n", __FUNCTION__); -+ memset(keybuf,0,100); -+ keybuf[0] = 1; //set usk -+ keybuf[1] = 1; //enable tx -+ keybuf[2] = 1; //AE -+ keybuf[3] = 0; //not update -+ -+ memcpy(keybuf+4,mac_addr,6); -+ memcpy(keybuf+10,UskDataKey,16); -+ memcpy(keybuf+26,UskMicKey,16); -+ keybuf[42]=UskId; -+ wapi_test_set_key(padapter, keybuf); -+ -+ memset(keybuf,0,100); -+ keybuf[0] = 1; //set usk -+ keybuf[1] = 1; //enable tx -+ keybuf[2] = 0; //AE -+ keybuf[3] = 0; //not update -+ -+ memcpy(keybuf+4,mac_addr,6); -+ memcpy(keybuf+10,UskDataKey,16); -+ memcpy(keybuf+26,UskMicKey,16); -+ keybuf[42]=UskId; -+ wapi_test_set_key(padapter, keybuf); -+ -+ //set msk -+ WAPI_TRACE(WAPI_INIT, "%s: Set MSK!!!!\n", __FUNCTION__); -+ memset(keybuf,0,100); -+ keybuf[0] = 2; //set msk -+ keybuf[1] = 1; //Enable TX -+ keybuf[2] = 1; //AE -+ keybuf[3] = 0; //not update -+ memcpy(keybuf+4,mac_addr,6); -+ memcpy(keybuf+10,MskDataKey,16); -+ memcpy(keybuf+26,MskMicKey,16); -+ keybuf[42] = MskId; -+ wapi_test_set_key(padapter, keybuf); -+ -+ memset(keybuf,0,100); -+ keybuf[0] = 2; //set msk -+ keybuf[1] = 1; //Enable TX -+ keybuf[2] = 0; //AE -+ keybuf[3] = 0; //not update -+ memcpy(keybuf+4,mac_addr,6); -+ memcpy(keybuf+10,MskDataKey,16); -+ memcpy(keybuf+26,MskMicKey,16); -+ keybuf[42] = MskId; -+ wapi_test_set_key(padapter, keybuf); -+ WAPI_TRACE(WAPI_INIT, "<===========%s\n", __FUNCTION__); -+} -+#endif -+ -+void rtw_wapi_get_iv(_adapter *padapter,u8 *pRA, u8*IV) -+{ -+ PWLAN_HEADER_WAPI_EXTENSION pWapiExt = NULL; -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ bool bPNOverflow = false; -+ bool bFindMatchPeer = false; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ -+ pWapiExt = (PWLAN_HEADER_WAPI_EXTENSION)IV; -+ -+ WAPI_DATA(WAPI_RX,"wapi_get_iv: pra",pRA,6); -+ -+ if(IS_MCAST(pRA)){ -+ if(!pWapiInfo->wapiTxMsk.bTxEnable){ -+ WAPI_TRACE(WAPI_ERR,"%s: bTxEnable = 0!!\n",__FUNCTION__); -+ return; -+ } -+ -+ if(pWapiInfo->wapiTxMsk.keyId <= 1){ -+ pWapiExt->KeyIdx = pWapiInfo->wapiTxMsk.keyId; -+ pWapiExt->Reserved = 0; -+ bPNOverflow = WapiIncreasePN(pWapiInfo->lastTxMulticastPN, 1); -+ memcpy(pWapiExt->PN, pWapiInfo->lastTxMulticastPN, 16); -+ } -+ } -+ else -+ { -+ if(list_empty(&pWapiInfo->wapiSTAUsedList)){ -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_get_iv: list is empty \n"); -+ _rtw_memset(IV,10,18); -+ return; -+ } -+ else{ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list){ -+ WAPI_DATA(WAPI_RX,"rtw_wapi_get_iv: peermacaddr ",pWapiSta->PeerMacAddr,6); -+ if (_rtw_memcmp((u8*)pWapiSta->PeerMacAddr, pRA, 6) == true) { -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ -+ WAPI_TRACE(WAPI_RX,"bFindMatchPeer: %d \n",bFindMatchPeer); -+ WAPI_DATA(WAPI_RX,"Addr",pRA,6); -+ -+ if (bFindMatchPeer){ -+ if((!pWapiSta->wapiUskUpdate.bTxEnable) && (!pWapiSta->wapiUsk.bTxEnable)) -+ return; -+ -+ if (pWapiSta->wapiUsk.keyId <= 1){ -+ if(pWapiSta->wapiUskUpdate.bTxEnable) -+ pWapiExt->KeyIdx = pWapiSta->wapiUskUpdate.keyId; -+ else -+ pWapiExt->KeyIdx = pWapiSta->wapiUsk.keyId; -+ -+ pWapiExt->Reserved = 0; -+ bPNOverflow = WapiIncreasePN(pWapiSta->lastTxUnicastPN, 2); -+ _rtw_memcpy(pWapiExt->PN, pWapiSta->lastTxUnicastPN, 16); -+ -+ } -+ } -+ } -+ -+ } -+ -+} -+ -+bool rtw_wapi_drop_for_key_absent(_adapter *padapter,u8 *pRA) -+{ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ bool bFindMatchPeer = false; -+ bool bDrop = false; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ WAPI_DATA(WAPI_RX,"rtw_wapi_drop_for_key_absent: ra ",pRA,6); -+ -+ if(psecuritypriv->dot11PrivacyAlgrthm == _SMS4_) -+ { -+ if ((!padapter->WapiSupport) || (!pWapiInfo->bWapiEnable)) -+ return true; -+ -+ if(IS_MCAST(pRA)){ -+ if(!pWapiInfo->wapiTxMsk.bTxEnable){ -+ bDrop = true; -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_drop_for_key_absent: multicast key is absent \n"); -+ return bDrop; -+ } -+ } -+ else{ -+ if(!list_empty(&pWapiInfo->wapiSTAUsedList)){ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list){ -+ WAPI_DATA(WAPI_RX,"rtw_wapi_drop_for_key_absent: pWapiSta->PeerMacAddr ",pWapiSta->PeerMacAddr,6); -+ if (_rtw_memcmp(pRA, pWapiSta->PeerMacAddr, 6) == true){ -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ if (bFindMatchPeer) { -+ if (!pWapiSta->wapiUsk.bTxEnable){ -+ bDrop = true; -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_drop_for_key_absent: unicast key is absent \n"); -+ return bDrop; -+ } -+ } -+ else{ -+ bDrop = true; -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_drop_for_key_absent: no peer find \n"); -+ return bDrop; -+ } -+ -+ } -+ else{ -+ bDrop = true; -+ WAPI_TRACE(WAPI_RX,"rtw_wapi_drop_for_key_absent: no sta exist \n"); -+ return bDrop; -+ } -+ } -+ } -+ else -+ { -+ return bDrop; -+ } -+ -+ return bDrop; -+} -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_wapi_sms4.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_wapi_sms4.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_wapi_sms4.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_wapi_sms4.c 2018-02-06 17:42:30.700967016 +0200 -@@ -0,0 +1,920 @@ -+#ifdef CONFIG_WAPI_SUPPORT -+ -+#include -+#include -+#include -+#include -+ -+ -+#ifdef CONFIG_WAPI_SW_SMS4 -+ -+#define ENCRYPT 0 -+#define DECRYPT 1 -+ -+/********************************************************** -+ **********************************************************/ -+const u8 Sbox[256] = { -+0xd6,0x90,0xe9,0xfe,0xcc,0xe1,0x3d,0xb7,0x16,0xb6,0x14,0xc2,0x28,0xfb,0x2c,0x05, -+0x2b,0x67,0x9a,0x76,0x2a,0xbe,0x04,0xc3,0xaa,0x44,0x13,0x26,0x49,0x86,0x06,0x99, -+0x9c,0x42,0x50,0xf4,0x91,0xef,0x98,0x7a,0x33,0x54,0x0b,0x43,0xed,0xcf,0xac,0x62, -+0xe4,0xb3,0x1c,0xa9,0xc9,0x08,0xe8,0x95,0x80,0xdf,0x94,0xfa,0x75,0x8f,0x3f,0xa6, -+0x47,0x07,0xa7,0xfc,0xf3,0x73,0x17,0xba,0x83,0x59,0x3c,0x19,0xe6,0x85,0x4f,0xa8, -+0x68,0x6b,0x81,0xb2,0x71,0x64,0xda,0x8b,0xf8,0xeb,0x0f,0x4b,0x70,0x56,0x9d,0x35, -+0x1e,0x24,0x0e,0x5e,0x63,0x58,0xd1,0xa2,0x25,0x22,0x7c,0x3b,0x01,0x21,0x78,0x87, -+0xd4,0x00,0x46,0x57,0x9f,0xd3,0x27,0x52,0x4c,0x36,0x02,0xe7,0xa0,0xc4,0xc8,0x9e, -+0xea,0xbf,0x8a,0xd2,0x40,0xc7,0x38,0xb5,0xa3,0xf7,0xf2,0xce,0xf9,0x61,0x15,0xa1, -+0xe0,0xae,0x5d,0xa4,0x9b,0x34,0x1a,0x55,0xad,0x93,0x32,0x30,0xf5,0x8c,0xb1,0xe3, -+0x1d,0xf6,0xe2,0x2e,0x82,0x66,0xca,0x60,0xc0,0x29,0x23,0xab,0x0d,0x53,0x4e,0x6f, -+0xd5,0xdb,0x37,0x45,0xde,0xfd,0x8e,0x2f,0x03,0xff,0x6a,0x72,0x6d,0x6c,0x5b,0x51, -+0x8d,0x1b,0xaf,0x92,0xbb,0xdd,0xbc,0x7f,0x11,0xd9,0x5c,0x41,0x1f,0x10,0x5a,0xd8, -+0x0a,0xc1,0x31,0x88,0xa5,0xcd,0x7b,0xbd,0x2d,0x74,0xd0,0x12,0xb8,0xe5,0xb4,0xb0, -+0x89,0x69,0x97,0x4a,0x0c,0x96,0x77,0x7e,0x65,0xb9,0xf1,0x09,0xc5,0x6e,0xc6,0x84, -+0x18,0xf0,0x7d,0xec,0x3a,0xdc,0x4d,0x20,0x79,0xee,0x5f,0x3e,0xd7,0xcb,0x39,0x48 -+}; -+ -+const u32 CK[32] = { -+ 0x00070e15, 0x1c232a31, 0x383f464d, 0x545b6269, -+ 0x70777e85, 0x8c939aa1, 0xa8afb6bd, 0xc4cbd2d9, -+ 0xe0e7eef5, 0xfc030a11, 0x181f262d, 0x343b4249, -+ 0x50575e65, 0x6c737a81, 0x888f969d, 0xa4abb2b9, -+ 0xc0c7ced5, 0xdce3eaf1, 0xf8ff060d, 0x141b2229, -+ 0x30373e45, 0x4c535a61, 0x686f767d, 0x848b9299, -+ 0xa0a7aeb5, 0xbcc3cad1, 0xd8dfe6ed, 0xf4fb0209, -+ 0x10171e25, 0x2c333a41, 0x484f565d, 0x646b7279 }; -+ -+#define Rotl(_x, _y) (((_x) << (_y)) | ((_x) >> (32 - (_y)))) -+ -+#define ByteSub(_A) (Sbox[(_A) >> 24 & 0xFF] << 24 | \ -+ Sbox[(_A) >> 16 & 0xFF] << 16 | \ -+ Sbox[(_A) >> 8 & 0xFF] << 8 | \ -+ Sbox[(_A) & 0xFF]) -+ -+#define L1(_B) ((_B) ^ Rotl(_B, 2) ^ Rotl(_B, 10) ^ Rotl(_B, 18) ^ Rotl(_B, 24)) -+#define L2(_B) ((_B) ^ Rotl(_B, 13) ^ Rotl(_B, 23)) -+ -+static void -+xor_block(void *dst, void *src1, void *src2) -+/* 128-bit xor: *dst = *src1 xor *src2. Pointers must be 32-bit aligned */ -+{ -+ ((u32 *)dst)[0] = ((u32 *)src1)[0] ^ ((u32 *)src2)[0]; -+ ((u32 *)dst)[1] = ((u32 *)src1)[1] ^ ((u32 *)src2)[1]; -+ ((u32 *)dst)[2] = ((u32 *)src1)[2] ^ ((u32 *)src2)[2]; -+ ((u32 *)dst)[3] = ((u32 *)src1)[3] ^ ((u32 *)src2)[3]; -+} -+ -+ -+void SMS4Crypt(u8 *Input, u8 *Output, u32 *rk) -+{ -+ u32 r, mid, x0, x1, x2, x3, *p; -+ p = (u32 *)Input; -+ x0 = p[0]; -+ x1 = p[1]; -+ x2 = p[2]; -+ x3 = p[3]; -+#ifdef __LITTLE_ENDIAN -+ x0 = Rotl(x0, 16); x0 = ((x0 & 0x00FF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); -+ x1 = Rotl(x1, 16); x1 = ((x1 & 0x00FF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); -+ x2 = Rotl(x2, 16); x2 = ((x2 & 0x00FF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); -+ x3 = Rotl(x3, 16); x3 = ((x3 & 0x00FF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); -+#endif -+ for (r = 0; r < 32; r += 4) -+ { -+ mid = x1 ^ x2 ^ x3 ^ rk[r + 0]; -+ mid = ByteSub(mid); -+ x0 ^= L1(mid); -+ mid = x2 ^ x3 ^ x0 ^ rk[r + 1]; -+ mid = ByteSub(mid); -+ x1 ^= L1(mid); -+ mid = x3 ^ x0 ^ x1 ^ rk[r + 2]; -+ mid = ByteSub(mid); -+ x2 ^= L1(mid); -+ mid = x0 ^ x1 ^ x2 ^ rk[r + 3]; -+ mid = ByteSub(mid); -+ x3 ^= L1(mid); -+ } -+#ifdef __LITTLE_ENDIAN -+ x0 = Rotl(x0, 16); x0 = ((x0 & 0x00FF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); -+ x1 = Rotl(x1, 16); x1 = ((x1 & 0x00FF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); -+ x2 = Rotl(x2, 16); x2 = ((x2 & 0x00FF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); -+ x3 = Rotl(x3, 16); x3 = ((x3 & 0x00FF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); -+#endif -+ p = (u32 *)Output; -+ p[0] = x3; -+ p[1] = x2; -+ p[2] = x1; -+ p[3] = x0; -+} -+ -+ -+ -+void SMS4KeyExt(u8 *Key, u32 *rk, u32 CryptFlag) -+{ -+ u32 r, mid, x0, x1, x2, x3, *p; -+ -+ p = (u32 *)Key; -+ x0 = p[0]; -+ x1 = p[1]; -+ x2 = p[2]; -+ x3 = p[3]; -+#ifdef __LITTLE_ENDIAN -+ x0 = Rotl(x0, 16); x0 = ((x0 & 0xFF00FF) << 8) | ((x0 & 0xFF00FF00) >> 8); -+ x1 = Rotl(x1, 16); x1 = ((x1 & 0xFF00FF) << 8) | ((x1 & 0xFF00FF00) >> 8); -+ x2 = Rotl(x2, 16); x2 = ((x2 & 0xFF00FF) << 8) | ((x2 & 0xFF00FF00) >> 8); -+ x3 = Rotl(x3, 16); x3 = ((x3 & 0xFF00FF) << 8) | ((x3 & 0xFF00FF00) >> 8); -+#endif -+ -+ x0 ^= 0xa3b1bac6; -+ x1 ^= 0x56aa3350; -+ x2 ^= 0x677d9197; -+ x3 ^= 0xb27022dc; -+ for (r = 0; r < 32; r += 4) -+ { -+ mid = x1 ^ x2 ^ x3 ^ CK[r + 0]; -+ mid = ByteSub(mid); -+ rk[r + 0] = x0 ^= L2(mid); -+ mid = x2 ^ x3 ^ x0 ^ CK[r + 1]; -+ mid = ByteSub(mid); -+ rk[r + 1] = x1 ^= L2(mid); -+ mid = x3 ^ x0 ^ x1 ^ CK[r + 2]; -+ mid = ByteSub(mid); -+ rk[r + 2] = x2 ^= L2(mid); -+ mid = x0 ^ x1 ^ x2 ^ CK[r + 3]; -+ mid = ByteSub(mid); -+ rk[r + 3] = x3 ^= L2(mid); -+ } -+ if (CryptFlag == DECRYPT) -+ { -+ for (r = 0; r < 16; r++) -+ mid = rk[r], rk[r] = rk[31 - r], rk[31 - r] = mid; -+ } -+} -+ -+ -+void WapiSMS4Cryption(u8 *Key, u8 *IV, u8 *Input, u16 InputLength, -+ u8 *Output, u16 *OutputLength, u32 CryptFlag) -+{ -+ u32 blockNum,i,j, rk[32]; -+ u16 remainder; -+ u8 blockIn[16],blockOut[16], tempIV[16], k; -+ -+ *OutputLength = 0; -+ remainder = InputLength & 0x0F; -+ blockNum = InputLength >> 4; -+ if(remainder !=0) -+ blockNum++; -+ else -+ remainder = 16; -+ -+ for(k=0;k<16;k++) -+ tempIV[k] = IV[15-k]; -+ -+ memcpy(blockIn, tempIV, 16); -+ -+ SMS4KeyExt((u8 *)Key, rk,CryptFlag); -+ -+ for(i=0; i> 4; -+ -+ for(k=0;k<16;k++) -+ tempIV[k] = IV[15-k]; -+ -+ memcpy(BlockIn, tempIV, 16); -+ -+ SMS4KeyExt((u8 *)Key, rk, ENCRYPT); -+ -+ SMS4Crypt((u8 *)BlockIn, BlockOut, rk); -+ -+ for(i=0; i> 4; -+ -+ for(i=0; i%s\n", __FUNCTION__); -+ -+ header = (struct ieee80211_hdr_3addr_qos *)pHeader; -+ memset(TempBuf, 0, 34); -+ memcpy(TempBuf, pHeader, 2); //FrameCtrl -+ pTemp = (u16*)TempBuf; -+ *pTemp &= 0xc78f; //bit4,5,6,11,12,13 -+ -+ memcpy((TempBuf+2), (pHeader+4), 12); //Addr1, Addr2 -+ memcpy((TempBuf+14), (pHeader+22), 2); // SeqCtrl -+ pTemp = (u16*)(TempBuf + 14); -+ *pTemp &= 0x000f; -+ -+ memcpy((TempBuf+16), (pHeader+16), 6); //Addr3 -+ -+ fc = le16_to_cpu(header->frame_ctl); -+ -+ -+ -+ if (GetFrDs((u16*)&fc) && GetToDs((u16 *)&fc)) -+ { -+ memcpy((TempBuf+22), (pHeader+24), 6); -+ QosOffset = 30; -+ }else{ -+ memset((TempBuf+22), 0, 6); -+ QosOffset = 24; -+ } -+ -+ if((fc & 0x0088) == 0x0088){ -+ memcpy((TempBuf+28), (pHeader+QosOffset), 2); -+ TempLen += 2; -+ //IV = pHeader + QosOffset + 2 + SNAP_SIZE + sizeof(u16) + 2; -+ IV = pHeader + QosOffset + 2 + 2; -+ }else{ -+ IV = pHeader + QosOffset + 2; -+ //IV = pHeader + QosOffset + SNAP_SIZE + sizeof(u16) + 2; -+ } -+ -+ TempBuf[TempLen-1] = (u8)(DataLen & 0xff); -+ TempBuf[TempLen-2] = (u8)((DataLen & 0xff00)>>8); -+ TempBuf[TempLen-4] = KeyIdx; -+ -+ WAPI_DATA(WAPI_TX, "CalculateMic - KEY", MicKey, 16); -+ WAPI_DATA(WAPI_TX, "CalculateMic - IV", IV, 16); -+ WAPI_DATA(WAPI_TX, "CalculateMic - TempBuf", TempBuf, TempLen); -+ WAPI_DATA(WAPI_TX, "CalculateMic - pData", pData, DataLen); -+ -+ WapiSMS4CalculateMic(MicKey, IV, TempBuf, TempLen, -+ pData, DataLen, MicBuffer, &MicLen); -+ -+ if (MicLen != 16) -+ WAPI_TRACE(WAPI_ERR,"%s: MIC Length Error!!\n",__FUNCTION__); -+ -+ WAPI_TRACE(WAPI_TX|WAPI_RX, "<=========%s\n", __FUNCTION__); -+#endif -+} -+ -+/* AddCount: 1 or 2. -+ * If overflow, return 1, -+ * else return 0. -+ */ -+u8 WapiIncreasePN(u8 *PN, u8 AddCount) -+{ -+ u8 i; -+ -+ if (NULL == PN) -+ return 1; -+ //YJ,test,091102 -+ /* -+ if(AddCount == 2){ -+ DBG_8192C("############################%s(): PN[0]=0x%x\n", __FUNCTION__, PN[0]); -+ if(PN[0] == 0x48){ -+ PN[0] += AddCount; -+ return 1; -+ }else{ -+ PN[0] += AddCount; -+ return 0; -+ } -+ } -+ */ -+ //YJ,test,091102,end -+ -+ for (i=0; i<16; i++) -+ { -+ if (PN[i] + AddCount <= 0xff) -+ { -+ PN[i] += AddCount; -+ return 0; -+ } -+ else -+ { -+ PN[i] += AddCount; -+ AddCount = 1; -+ } -+ } -+ return 1; -+} -+ -+ -+void WapiGetLastRxUnicastPNForQoSData( -+ u8 UserPriority, -+ PRT_WAPI_STA_INFO pWapiStaInfo, -+ u8 *PNOut -+) -+{ -+ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); -+ switch(UserPriority) -+ { -+ case 0: -+ case 3: -+ memcpy(PNOut,pWapiStaInfo->lastRxUnicastPNBEQueue,16); -+ break; -+ case 1: -+ case 2: -+ memcpy(PNOut,pWapiStaInfo->lastRxUnicastPNBKQueue,16); -+ break; -+ case 4: -+ case 5: -+ memcpy(PNOut,pWapiStaInfo->lastRxUnicastPNVIQueue,16); -+ break; -+ case 6: -+ case 7: -+ memcpy(PNOut,pWapiStaInfo->lastRxUnicastPNVOQueue,16); -+ break; -+ default: -+ WAPI_TRACE(WAPI_ERR, "%s: Unknown TID \n", __FUNCTION__); -+ break; -+ } -+ WAPI_TRACE(WAPI_RX, "<=========== %s\n", __FUNCTION__); -+} -+ -+ -+void WapiSetLastRxUnicastPNForQoSData( -+ u8 UserPriority, -+ u8 *PNIn, -+ PRT_WAPI_STA_INFO pWapiStaInfo -+) -+{ -+ WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); -+ switch(UserPriority) -+ { -+ case 0: -+ case 3: -+ memcpy(pWapiStaInfo->lastRxUnicastPNBEQueue,PNIn,16); -+ break; -+ case 1: -+ case 2: -+ memcpy(pWapiStaInfo->lastRxUnicastPNBKQueue,PNIn,16); -+ break; -+ case 4: -+ case 5: -+ memcpy(pWapiStaInfo->lastRxUnicastPNVIQueue,PNIn,16); -+ break; -+ case 6: -+ case 7: -+ memcpy(pWapiStaInfo->lastRxUnicastPNVOQueue,PNIn,16); -+ break; -+ default: -+ WAPI_TRACE(WAPI_ERR, "%s: Unknown TID \n", __FUNCTION__); -+ break; -+ } -+ WAPI_TRACE(WAPI_RX, "<=========== %s\n", __FUNCTION__); -+} -+ -+ -+/**************************************************************************** -+ false not RX-Reorder -+ true do RX Reorder -+add to support WAPI to N-mode -+*****************************************************************************/ -+u8 WapiCheckPnInSwDecrypt( -+ _adapter *padapter, -+ struct sk_buff *pskb -+) -+{ -+ u8 ret = false; -+ -+#if 0 -+ struct ieee80211_hdr_3addr_qos *header; -+ u16 fc; -+ u8 *pDaddr, *pTaddr, *pRaddr; -+ -+ header = (struct ieee80211_hdr_3addr_qos *)pskb->data; -+ pTaddr = header->addr2; -+ pRaddr = header->addr1; -+ fc = le16_to_cpu(header->frame_ctl); -+ -+ if(GetToDs(&fc)) -+ pDaddr = header->addr3; -+ else -+ pDaddr = header->addr1; -+ -+ if ((_rtw_memcmp(pRaddr, padapter->pnetdev->dev_addr, ETH_ALEN) == 0) -+ && ! (pDaddr) -+ && (GetFrameType(&fc) == WIFI_QOS_DATA_TYPE)) -+ //&& ieee->pHTInfo->bCurrentHTSupport && -+ //ieee->pHTInfo->bCurRxReorderEnable) -+ ret = false; -+ else -+ ret = true; -+#endif -+ WAPI_TRACE(WAPI_RX, "%s: return %d\n", __FUNCTION__, ret); -+ return ret; -+} -+ -+int SecSMS4HeaderFillIV(_adapter *padapter, u8 *pxmitframe) -+{ -+ struct pkt_attrib *pattrib = &((struct xmit_frame*)pxmitframe)->attrib; -+ u8 * frame = ((struct xmit_frame *)pxmitframe)->buf_addr + TXDESC_OFFSET; -+ u8 *pSecHeader = NULL, *pos = NULL, *pRA = NULL; -+ u8 bPNOverflow = false, bFindMatchPeer = false, hdr_len = 0; -+ PWLAN_HEADER_WAPI_EXTENSION pWapiExt = NULL; -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ int ret = 0; -+ -+ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); -+ -+ return ret; -+#if 0 -+ hdr_len = sMacHdrLng; -+ if (GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE) -+ { -+ hdr_len += 2; -+ } -+ //hdr_len += SNAP_SIZE + sizeof(u16); -+ -+ pos = skb_push(pskb, padapter->wapiInfo.extra_prefix_len); -+ memmove(pos, pos+padapter->wapiInfo.extra_prefix_len, hdr_len); -+ -+ pSecHeader = pskb->data + hdr_len; -+ pWapiExt = (PWLAN_HEADER_WAPI_EXTENSION)pSecHeader; -+ pRA = pskb->data + 4; -+ -+ WAPI_DATA(WAPI_TX, "FillIV - Before Fill IV", pskb->data, pskb->len); -+ -+ //Address 1 is always receiver's address -+ if( IS_MCAST(pRA) ){ -+ if(!pWapiInfo->wapiTxMsk.bTxEnable){ -+ WAPI_TRACE(WAPI_ERR,"%s: bTxEnable = 0!!\n",__FUNCTION__); -+ return -2; -+ } -+ if(pWapiInfo->wapiTxMsk.keyId <= 1){ -+ pWapiExt->KeyIdx = pWapiInfo->wapiTxMsk.keyId; -+ pWapiExt->Reserved = 0; -+ bPNOverflow = WapiIncreasePN(pWapiInfo->lastTxMulticastPN, 1); -+ memcpy(pWapiExt->PN, pWapiInfo->lastTxMulticastPN, 16); -+ if (bPNOverflow){ -+ // Update MSK Notification. -+ WAPI_TRACE(WAPI_ERR,"===============>%s():multicast PN overflow\n",__FUNCTION__); -+ rtw_wapi_app_event_handler(padapter,NULL,0,pRA, false, false, true, 0, false); -+ } -+ }else{ -+ WAPI_TRACE(WAPI_ERR,"%s: Invalid Wapi Multicast KeyIdx!!\n",__FUNCTION__); -+ ret = -3; -+ } -+ } -+ else{ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if(!memcmp(pWapiSta->PeerMacAddr,pRA,6)){ -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ if (bFindMatchPeer){ -+ if((!pWapiSta->wapiUskUpdate.bTxEnable) && (!pWapiSta->wapiUsk.bTxEnable)){ -+ WAPI_TRACE(WAPI_ERR,"%s: bTxEnable = 0!!\n",__FUNCTION__); -+ return -4; -+ } -+ if (pWapiSta->wapiUsk.keyId <= 1){ -+ if(pWapiSta->wapiUskUpdate.bTxEnable) -+ pWapiExt->KeyIdx = pWapiSta->wapiUskUpdate.keyId; -+ else -+ pWapiExt->KeyIdx = pWapiSta->wapiUsk.keyId; -+ -+ pWapiExt->Reserved = 0; -+ bPNOverflow = WapiIncreasePN(pWapiSta->lastTxUnicastPN, 2); -+ memcpy(pWapiExt->PN, pWapiSta->lastTxUnicastPN, 16); -+ if (bPNOverflow){ -+ // Update USK Notification. -+ WAPI_TRACE(WAPI_ERR,"===============>%s():unicast PN overflow\n",__FUNCTION__); -+ rtw_wapi_app_event_handler(padapter,NULL,0,pWapiSta->PeerMacAddr, false, true, false, 0, false); -+ } -+ }else{ -+ WAPI_TRACE(WAPI_ERR,"%s: Invalid Wapi Unicast KeyIdx!!\n",__FUNCTION__); -+ ret = -5; -+ } -+ } -+ else{ -+ WAPI_TRACE(WAPI_ERR,"%s: Can not find Peer Sta "MAC_FMT"!!\n",__FUNCTION__, MAC_ARG(pRA)); -+ ret = -6; -+ } -+ } -+ -+ WAPI_DATA(WAPI_TX, "FillIV - After Fill IV", pskb->data, pskb->len); -+ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); -+ return ret; -+#endif -+} -+ -+// WAPI SW Enc: must have done Coalesce! -+void SecSWSMS4Encryption( -+ _adapter *padapter, -+ u8 * pxmitframe -+ ) -+{ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ u8 *pframe = ((struct xmit_frame*)pxmitframe)->buf_addr + TXDESC_SIZE; -+ struct pkt_attrib *pattrib = &((struct xmit_frame*)pxmitframe)->attrib; -+ -+ u8 *SecPtr = NULL, *pRA, *pMicKey = NULL, *pDataKey = NULL, *pIV = NULL; -+ u8 IVOffset, DataOffset, bFindMatchPeer = false, KeyIdx = 0, MicBuffer[16]; -+ u16 OutputLength; -+ -+ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); -+ -+ WAPI_TRACE(WAPI_TX,"hdrlen: %d \n",pattrib->hdrlen); -+ -+ return; -+ -+ DataOffset = pattrib->hdrlen + pattrib->iv_len; -+ -+ pRA = pframe + 4; -+ -+ -+ if( IS_MCAST(pRA) ){ -+ KeyIdx = pWapiInfo->wapiTxMsk.keyId; -+ pIV = pWapiInfo->lastTxMulticastPN; -+ pMicKey = pWapiInfo->wapiTxMsk.micKey; -+ pDataKey = pWapiInfo->wapiTxMsk.dataKey; -+ }else{ -+ if (!list_empty(&(pWapiInfo->wapiSTAUsedList))){ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (0 == memcmp(pWapiSta->PeerMacAddr, pRA, 6)){ -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ -+ if (bFindMatchPeer){ -+ if (pWapiSta->wapiUskUpdate.bTxEnable){ -+ KeyIdx = pWapiSta->wapiUskUpdate.keyId; -+ WAPI_TRACE(WAPI_TX, "%s(): Use update USK!! KeyIdx=%d\n", __FUNCTION__, KeyIdx); -+ pIV = pWapiSta->lastTxUnicastPN; -+ pMicKey = pWapiSta->wapiUskUpdate.micKey; -+ pDataKey = pWapiSta->wapiUskUpdate.dataKey; -+ }else{ -+ KeyIdx = pWapiSta->wapiUsk.keyId; -+ WAPI_TRACE(WAPI_TX, "%s(): Use USK!! KeyIdx=%d\n", __FUNCTION__, KeyIdx); -+ pIV = pWapiSta->lastTxUnicastPN; -+ pMicKey = pWapiSta->wapiUsk.micKey; -+ pDataKey = pWapiSta->wapiUsk.dataKey; -+ } -+ }else{ -+ WAPI_TRACE(WAPI_ERR,"%s: Can not find Peer Sta!!\n",__FUNCTION__); -+ return; -+ } -+ }else{ -+ WAPI_TRACE(WAPI_ERR,"%s: wapiSTAUsedList is empty!!\n",__FUNCTION__); -+ return; -+ } -+ } -+ -+ SecPtr = pframe; -+ SecCalculateMicSMS4(KeyIdx, pMicKey, SecPtr, (SecPtr+DataOffset), pattrib->pktlen, MicBuffer); -+ -+ WAPI_DATA(WAPI_TX, "Encryption - MIC", MicBuffer, padapter->wapiInfo.extra_postfix_len); -+ -+ memcpy(pframe+pattrib->hdrlen+pattrib->iv_len+pattrib->pktlen-pattrib->icv_len, -+ (u8 *)MicBuffer, -+ padapter->wapiInfo.extra_postfix_len -+ ); -+ -+ -+ WapiSMS4Encryption(pDataKey, pIV, (SecPtr+DataOffset),pattrib->pktlen+pattrib->icv_len, (SecPtr+DataOffset), &OutputLength); -+ -+ WAPI_DATA(WAPI_TX, "Encryption - After SMS4 encryption",pframe,pattrib->hdrlen+pattrib->iv_len+pattrib->pktlen); -+ -+ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); -+} -+ -+u8 SecSWSMS4Decryption( -+ _adapter *padapter, -+ u8 *precv_frame, -+ struct recv_priv *precv_priv -+ ) -+{ -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ struct recv_frame_hdr *precv_hdr; -+ PRT_WAPI_STA_INFO pWapiSta = NULL; -+ u8 IVOffset, DataOffset, bFindMatchPeer = false, bUseUpdatedKey = false; -+ u8 KeyIdx, MicBuffer[16], lastRxPNforQoS[16]; -+ u8 *pRA, *pTA, *pMicKey, *pDataKey, *pLastRxPN, *pRecvPN, *pSecData, *pRecvMic, *pos; -+ u8 TID = 0; -+ u16 OutputLength, DataLen; -+ u8 bQosData; -+ struct sk_buff * pskb; -+ -+ WAPI_TRACE(WAPI_RX, "=========>%s\n", __FUNCTION__); -+ -+ return 0; -+ -+ precv_hdr = &((union recv_frame*)precv_frame)->u.hdr; -+ pskb = (struct sk_buff *)(precv_hdr->rx_data); -+ precv_hdr->bWapiCheckPNInDecrypt = WapiCheckPnInSwDecrypt(padapter, pskb); -+ WAPI_TRACE(WAPI_RX, "=========>%s: check PN %d\n", __FUNCTION__,precv_hdr->bWapiCheckPNInDecrypt); -+ WAPI_DATA(WAPI_RX, "Decryption - Before decryption", pskb->data, pskb->len); -+ -+ IVOffset = sMacHdrLng; -+ bQosData = GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE; -+ if (bQosData){ -+ IVOffset += 2; -+ } -+ -+ //if(GetHTC()) -+ // IVOffset += 4; -+ -+ //IVOffset += SNAP_SIZE + sizeof(u16); -+ -+ DataOffset = IVOffset + padapter->wapiInfo.extra_prefix_len; -+ -+ pRA = pskb->data + 4; -+ pTA = pskb->data + 10; -+ KeyIdx = *(pskb->data + IVOffset); -+ pRecvPN = pskb->data + IVOffset + 2; -+ pSecData = pskb->data + DataOffset; -+ DataLen = pskb->len - DataOffset; -+ pRecvMic = pskb->data + pskb->len - padapter->wapiInfo.extra_postfix_len; -+ TID = GetTid(pskb->data); -+ -+ if (!list_empty(&(pWapiInfo->wapiSTAUsedList))){ -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if (0 == memcmp(pWapiSta->PeerMacAddr, pTA, 6)){ -+ bFindMatchPeer = true; -+ break; -+ } -+ } -+ } -+ -+ if (!bFindMatchPeer){ -+ WAPI_TRACE(WAPI_ERR, "%s: Can not find Peer Sta "MAC_FMT" for Key Info!!!\n", __FUNCTION__, MAC_ARG(pTA)); -+ return false; -+ } -+ -+ if( IS_MCAST(pRA) ){ -+ WAPI_TRACE(WAPI_RX, "%s: Multicast decryption !!!\n", __FUNCTION__); -+ if (pWapiSta->wapiMsk.keyId == KeyIdx && pWapiSta->wapiMsk.bSet){ -+ pLastRxPN = pWapiSta->lastRxMulticastPN; -+ if (!WapiComparePN(pRecvPN, pLastRxPN)){ -+ WAPI_TRACE(WAPI_ERR, "%s: MSK PN is not larger than last, Dropped!!!\n", __FUNCTION__); -+ WAPI_DATA(WAPI_ERR, "pRecvPN:", pRecvPN, 16); -+ WAPI_DATA(WAPI_ERR, "pLastRxPN:", pLastRxPN, 16); -+ return false; -+ } -+ -+ memcpy(pLastRxPN, pRecvPN, 16); -+ pMicKey = pWapiSta->wapiMsk.micKey; -+ pDataKey = pWapiSta->wapiMsk.dataKey; -+ }else if (pWapiSta->wapiMskUpdate.keyId == KeyIdx && pWapiSta->wapiMskUpdate.bSet){ -+ WAPI_TRACE(WAPI_RX, "%s: Use Updated MSK for Decryption !!!\n", __FUNCTION__); -+ bUseUpdatedKey = true; -+ memcpy(pWapiSta->lastRxMulticastPN, pRecvPN, 16); -+ pMicKey = pWapiSta->wapiMskUpdate.micKey; -+ pDataKey = pWapiSta->wapiMskUpdate.dataKey; -+ }else{ -+ WAPI_TRACE(WAPI_ERR, "%s: Can not find MSK with matched KeyIdx(%d), Dropped !!!\n", __FUNCTION__,KeyIdx); -+ return false; -+ } -+ } -+ else{ -+ WAPI_TRACE(WAPI_RX, "%s: Unicast decryption !!!\n", __FUNCTION__); -+ if (pWapiSta->wapiUsk.keyId == KeyIdx && pWapiSta->wapiUsk.bSet){ -+ WAPI_TRACE(WAPI_RX, "%s: Use USK for Decryption!!!\n", __FUNCTION__); -+ if(precv_hdr->bWapiCheckPNInDecrypt){ -+ if(GetFrameType(pskb->data) == WIFI_QOS_DATA_TYPE){ -+ WapiGetLastRxUnicastPNForQoSData(TID, pWapiSta, lastRxPNforQoS); -+ pLastRxPN = lastRxPNforQoS; -+ }else{ -+ pLastRxPN = pWapiSta->lastRxUnicastPN; -+ } -+ if (!WapiComparePN(pRecvPN, pLastRxPN)){ -+ return false; -+ } -+ if(bQosData){ -+ WapiSetLastRxUnicastPNForQoSData(TID, pRecvPN, pWapiSta); -+ }else{ -+ memcpy(pWapiSta->lastRxUnicastPN, pRecvPN, 16); -+ } -+ }else{ -+ memcpy(precv_hdr->WapiTempPN,pRecvPN,16); -+ } -+ -+ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE)) -+ { -+ if ((pRecvPN[0] & 0x1) == 0){ -+ WAPI_TRACE(WAPI_ERR, "%s: Rx USK PN is not odd when Infra STA mode, Dropped !!!\n", __FUNCTION__); -+ return false; -+ } -+ } -+ -+ pMicKey = pWapiSta->wapiUsk.micKey; -+ pDataKey = pWapiSta->wapiUsk.dataKey; -+ } -+ else if (pWapiSta->wapiUskUpdate.keyId == KeyIdx && pWapiSta->wapiUskUpdate.bSet ){ -+ WAPI_TRACE(WAPI_RX, "%s: Use Updated USK for Decryption!!!\n", __FUNCTION__); -+ if(pWapiSta->bAuthenticatorInUpdata) -+ bUseUpdatedKey = true; -+ else -+ bUseUpdatedKey = false; -+ -+ if(bQosData){ -+ WapiSetLastRxUnicastPNForQoSData(TID, pRecvPN, pWapiSta); -+ }else{ -+ memcpy(pWapiSta->lastRxUnicastPN, pRecvPN, 16); -+ } -+ pMicKey = pWapiSta->wapiUskUpdate.micKey; -+ pDataKey = pWapiSta->wapiUskUpdate.dataKey; -+ }else{ -+ WAPI_TRACE(WAPI_ERR, "%s: No valid USK!!!KeyIdx=%d pWapiSta->wapiUsk.keyId=%d pWapiSta->wapiUskUpdate.keyId=%d\n", __FUNCTION__, KeyIdx, pWapiSta->wapiUsk.keyId, pWapiSta->wapiUskUpdate.keyId); -+ //dump_buf(pskb->data,pskb->len); -+ return false; -+ } -+ } -+ -+ WAPI_DATA(WAPI_RX, "Decryption - DataKey", pDataKey, 16); -+ WAPI_DATA(WAPI_RX, "Decryption - IV", pRecvPN, 16); -+ WapiSMS4Decryption(pDataKey, pRecvPN, pSecData, DataLen, pSecData, &OutputLength); -+ -+ if (OutputLength != DataLen) -+ WAPI_TRACE(WAPI_ERR, "%s: Output Length Error!!!!\n", __FUNCTION__); -+ -+ WAPI_DATA(WAPI_RX, "Decryption - After decryption", pskb->data, pskb->len); -+ -+ DataLen -= padapter->wapiInfo.extra_postfix_len; -+ -+ SecCalculateMicSMS4(KeyIdx, pMicKey, pskb->data, pSecData, DataLen, MicBuffer); -+ -+ WAPI_DATA(WAPI_RX, "Decryption - MIC received", pRecvMic, SMS4_MIC_LEN); -+ WAPI_DATA(WAPI_RX, "Decryption - MIC calculated", MicBuffer, SMS4_MIC_LEN); -+ -+ if (0 == memcmp(MicBuffer, pRecvMic, padapter->wapiInfo.extra_postfix_len)){ -+ WAPI_TRACE(WAPI_RX, "%s: Check MIC OK!!\n", __FUNCTION__); -+ if (bUseUpdatedKey){ -+ // delete the old key -+ if ( IS_MCAST(pRA) ){ -+ WAPI_TRACE(WAPI_API, "%s(): AE use new update MSK!!\n", __FUNCTION__); -+ pWapiSta->wapiMsk.keyId = pWapiSta->wapiMskUpdate.keyId; -+ memcpy(pWapiSta->wapiMsk.dataKey, pWapiSta->wapiMskUpdate.dataKey, 16); -+ memcpy(pWapiSta->wapiMsk.micKey, pWapiSta->wapiMskUpdate.micKey, 16); -+ pWapiSta->wapiMskUpdate.bTxEnable = pWapiSta->wapiMskUpdate.bSet = false; -+ }else{ -+ WAPI_TRACE(WAPI_API, "%s(): AE use new update USK!!\n", __FUNCTION__); -+ pWapiSta->wapiUsk.keyId = pWapiSta->wapiUskUpdate.keyId; -+ memcpy(pWapiSta->wapiUsk.dataKey, pWapiSta->wapiUskUpdate.dataKey, 16); -+ memcpy(pWapiSta->wapiUsk.micKey, pWapiSta->wapiUskUpdate.micKey, 16); -+ pWapiSta->wapiUskUpdate.bTxEnable = pWapiSta->wapiUskUpdate.bSet = false; -+ } -+ } -+ }else{ -+ WAPI_TRACE(WAPI_ERR, "%s: Check MIC Error, Dropped !!!!\n", __FUNCTION__); -+ return false; -+ } -+ -+ pos = pskb->data; -+ memmove(pos+padapter->wapiInfo.extra_prefix_len, pos, IVOffset); -+ skb_pull(pskb, padapter->wapiInfo.extra_prefix_len); -+ -+ WAPI_TRACE(WAPI_RX, "<=========%s\n", __FUNCTION__); -+ -+ return true; -+} -+ -+u32 rtw_sms4_encrypt(_adapter *padapter, u8 *pxmitframe) -+{ -+ -+ u8 *pframe; -+ u32 res = _SUCCESS; -+ -+ WAPI_TRACE(WAPI_TX, "=========>%s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_TX, "<========== %s, WAPI not supported or enabled!\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+ if(((struct xmit_frame*)pxmitframe)->buf_addr==NULL) -+ return _FAIL; -+ -+ pframe = ((struct xmit_frame*)pxmitframe)->buf_addr + TXDESC_OFFSET; -+ -+ SecSWSMS4Encryption(padapter, pxmitframe); -+ -+ WAPI_TRACE(WAPI_TX, "<=========%s\n", __FUNCTION__); -+ return res; -+} -+ -+u32 rtw_sms4_decrypt(_adapter *padapter, u8 *precvframe) -+{ -+ u8 *pframe; -+ u32 res = _SUCCESS; -+ -+ WAPI_TRACE(WAPI_RX, "=========>%s\n", __FUNCTION__); -+ -+ if ((!padapter->WapiSupport) || (!padapter->wapiInfo.bWapiEnable)) -+ { -+ WAPI_TRACE(WAPI_RX, "<========== %s, WAPI not supported or enabled!\n", __FUNCTION__); -+ return _FAIL; -+ } -+ -+ -+ //drop packet when hw decrypt fail -+ //return tempraily -+ return _FAIL; -+ -+ //pframe=(unsigned char *)((union recv_frame*)precvframe)->u.hdr.rx_data; -+ -+ if (false == SecSWSMS4Decryption(padapter, precvframe, &padapter->recvpriv)) -+ { -+ WAPI_TRACE(WAPI_ERR, "%s():SMS4 decrypt frame error\n",__FUNCTION__); -+ return _FAIL; -+ } -+ -+ WAPI_TRACE(WAPI_RX, "<=========%s\n", __FUNCTION__); -+ return res; -+} -+ -+#else -+ -+u32 rtw_sms4_encrypt(_adapter *padapter, u8 *pxmitframe) -+{ -+ WAPI_TRACE(WAPI_TX, "=========>Dummy %s\n", __FUNCTION__); -+ WAPI_TRACE(WAPI_TX, "<=========Dummy %s\n", __FUNCTION__); -+ return _SUCCESS; -+} -+ -+u32 rtw_sms4_decrypt(_adapter *padapter, u8 *precvframe) -+{ -+ WAPI_TRACE(WAPI_RX, "=========>Dummy %s\n", __FUNCTION__); -+ WAPI_TRACE(WAPI_RX, "<=========Dummy %s\n", __FUNCTION__); -+ return _SUCCESS; -+} -+ -+#endif -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_wlan_util.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_wlan_util.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_wlan_util.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_wlan_util.c 2018-02-06 17:42:30.701967031 +0200 -@@ -0,0 +1,2797 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_WLAN_UTIL_C_ -+ -+#include -+#include "rtw_mlme.h" -+ -+static unsigned char ARTHEROS_OUI1[] = {0x00, 0x03, 0x7f}; -+static unsigned char ARTHEROS_OUI2[] = {0x00, 0x13, 0x74}; -+ -+static unsigned char BROADCOM_OUI1[] = {0x00, 0x10, 0x18}; -+static unsigned char BROADCOM_OUI2[] = {0x00, 0x0a, 0xf7}; -+static unsigned char BROADCOM_OUI3[] = {0x00, 0x05, 0xb5}; -+ -+static unsigned char CISCO_OUI[] = {0x00, 0x40, 0x96}; -+static unsigned char MARVELL_OUI[] = {0x00, 0x50, 0x43}; -+static unsigned char RALINK_OUI[] = {0x00, 0x0c, 0x43}; -+static unsigned char REALTEK_OUI[] = {0x00, 0xe0, 0x4c}; -+static unsigned char AIRGOCAP_OUI[] = {0x00, 0x0a, 0xf5}; -+ -+extern unsigned char RTW_WPA_OUI[]; -+ -+#define R2T_PHY_DELAY (0) -+ -+//#define WAIT_FOR_BCN_TO_MIN (3000) -+#define WAIT_FOR_BCN_TO_MIN (6000) -+#define WAIT_FOR_BCN_TO_MAX (20000) -+ -+static u8 rtw_basic_rate_cck[4] = { -+ IEEE80211_CCK_RATE_1MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_2MB|IEEE80211_BASIC_RATE_MASK, -+ IEEE80211_CCK_RATE_5MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_11MB|IEEE80211_BASIC_RATE_MASK -+}; -+ -+static u8 rtw_basic_rate_ofdm[3] = { -+ IEEE80211_OFDM_RATE_6MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_OFDM_RATE_12MB|IEEE80211_BASIC_RATE_MASK, -+ IEEE80211_OFDM_RATE_24MB|IEEE80211_BASIC_RATE_MASK -+}; -+ -+static u8 rtw_basic_rate_mix[7] = { -+ IEEE80211_CCK_RATE_1MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_2MB|IEEE80211_BASIC_RATE_MASK, -+ IEEE80211_CCK_RATE_5MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_11MB|IEEE80211_BASIC_RATE_MASK, -+ IEEE80211_OFDM_RATE_6MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_OFDM_RATE_12MB|IEEE80211_BASIC_RATE_MASK, -+ IEEE80211_OFDM_RATE_24MB|IEEE80211_BASIC_RATE_MASK -+}; -+ -+ -+int cckrates_included(unsigned char *rate, int ratelen) -+{ -+ int i; -+ -+ for(i = 0; i < ratelen; i++) -+ { -+ if ( (((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || -+ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22) ) -+ return true; -+ } -+ -+ return false; -+ -+} -+ -+int cckratesonly_included(unsigned char *rate, int ratelen) -+{ -+ int i; -+ -+ for(i = 0; i < ratelen; i++) -+ { -+ if ( (((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && -+ (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22) ) -+ return false; -+ } -+ -+ return true; -+} -+ -+u8 networktype_to_raid(_adapter *adapter,unsigned char network_type) -+{ -+ unsigned char raid; -+ switch(network_type) -+ { -+ case WIRELESS_11B: -+ raid = RATR_INX_WIRELESS_B; -+ break; -+ case WIRELESS_11A: -+ case WIRELESS_11G: -+ raid = RATR_INX_WIRELESS_G; -+ break; -+ case WIRELESS_11BG: -+ raid = RATR_INX_WIRELESS_GB; -+ break; -+ case WIRELESS_11_24N: -+ case WIRELESS_11_5N: -+ raid = RATR_INX_WIRELESS_N; -+ break; -+ case WIRELESS_11A_5N: -+ case WIRELESS_11G_24N: -+ raid = RATR_INX_WIRELESS_NG; -+ break; -+ case WIRELESS_11BG_24N: -+ raid = RATR_INX_WIRELESS_NGB; -+ break; -+ default: -+ raid = RATR_INX_WIRELESS_GB; -+ break; -+ -+ } -+ return raid; -+ -+} -+ -+u8 networktype_to_raid_ex(_adapter *adapter,unsigned char network_type) -+{ -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ u8 raid, rf_type; -+ -+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ switch(network_type) -+ { -+ case WIRELESS_11B: -+ raid = RATEID_IDX_B; -+ break; -+ case WIRELESS_11A: -+ case WIRELESS_11G: -+ raid = RATEID_IDX_G; -+ break; -+ case WIRELESS_11BG: -+ raid = RATEID_IDX_BG; -+ break; -+ case WIRELESS_11_24N: -+ case WIRELESS_11_5N: -+ case WIRELESS_11A_5N: -+ case WIRELESS_11G_24N: -+ if (rf_type == 2) -+ raid = RATEID_IDX_GN_N2SS; -+ else -+ raid = RATEID_IDX_GN_N1SS; -+ break; -+ case WIRELESS_11B_24N: -+ case WIRELESS_11BG_24N: -+ if (pmlmeext->cur_bwmode == CHANNEL_WIDTH_20) { -+ if (rf_type == RF_2T2R) -+ raid = RATEID_IDX_BGN_20M_2SS_BN; -+ else -+ raid = RATEID_IDX_BGN_20M_1SS_BN; -+ } else { -+ if (rf_type == RF_2T2R) -+ raid = RATEID_IDX_BGN_40M_2SS; -+ else -+ raid = RATEID_IDX_BGN_40M_1SS; -+ } -+ break; -+#ifdef CONFIG_80211AC_VHT -+ case WIRELESS_11_5AC: -+ case WIRELESS_11_24AC: -+ if ((rf_type == RF_1T1R) || (adapter->mlmepriv.vhtpriv.vht_highest_rate <= MGN_VHT1SS_MCS9)) -+ raid = RATEID_IDX_VHT_1SS; -+ else -+ raid = RATEID_IDX_VHT_2SS; -+ break; -+#endif -+ default: -+ raid = RATEID_IDX_BGN_40M_2SS; -+ break; -+ -+ } -+ return raid; -+ -+} -+ -+u8 judge_network_type(_adapter *padapter, unsigned char *rate, int ratelen) -+{ -+ u8 network_type = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ if(pmlmeext->cur_channel > 14) -+ { -+ if (pmlmeinfo->VHT_enable) -+ network_type = WIRELESS_11AC; -+ else if (pmlmeinfo->HT_enable) -+ network_type = WIRELESS_11_5N; -+ -+ network_type |= WIRELESS_11A; -+ } -+ else -+ { -+ if (pmlmeinfo->HT_enable) -+ { -+ network_type = WIRELESS_11_24N; -+ } -+ -+ if ((cckratesonly_included(rate, ratelen)) == true) -+ { -+ network_type |= WIRELESS_11B; -+ } -+ else if((cckrates_included(rate, ratelen)) == true) -+ { -+ network_type |= WIRELESS_11BG; -+ } -+ else -+ { -+ network_type |= WIRELESS_11G; -+ } -+ } -+ -+ return network_type; -+} -+ -+unsigned char ratetbl_val_2wifirate(unsigned char rate); -+unsigned char ratetbl_val_2wifirate(unsigned char rate) -+{ -+ unsigned char val = 0; -+ -+ switch (rate & 0x7f) -+ { -+ case 0: -+ val = IEEE80211_CCK_RATE_1MB; -+ break; -+ -+ case 1: -+ val = IEEE80211_CCK_RATE_2MB; -+ break; -+ -+ case 2: -+ val = IEEE80211_CCK_RATE_5MB; -+ break; -+ -+ case 3: -+ val = IEEE80211_CCK_RATE_11MB; -+ break; -+ -+ case 4: -+ val = IEEE80211_OFDM_RATE_6MB; -+ break; -+ -+ case 5: -+ val = IEEE80211_OFDM_RATE_9MB; -+ break; -+ -+ case 6: -+ val = IEEE80211_OFDM_RATE_12MB; -+ break; -+ -+ case 7: -+ val = IEEE80211_OFDM_RATE_18MB; -+ break; -+ -+ case 8: -+ val = IEEE80211_OFDM_RATE_24MB; -+ break; -+ -+ case 9: -+ val = IEEE80211_OFDM_RATE_36MB; -+ break; -+ -+ case 10: -+ val = IEEE80211_OFDM_RATE_48MB; -+ break; -+ -+ case 11: -+ val = IEEE80211_OFDM_RATE_54MB; -+ break; -+ -+ } -+ -+ return val; -+ -+} -+ -+int is_basicrate(_adapter *padapter, unsigned char rate); -+int is_basicrate(_adapter *padapter, unsigned char rate) -+{ -+ int i; -+ unsigned char val; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ for(i = 0; i < NumRates; i++) -+ { -+ val = pmlmeext->basicrate[i]; -+ -+ if ((val != 0xff) && (val != 0xfe)) -+ { -+ if (rate == ratetbl_val_2wifirate(val)) -+ { -+ return true; -+ } -+ } -+ } -+ -+ return false; -+} -+ -+unsigned int ratetbl2rateset(_adapter *padapter, unsigned char *rateset); -+unsigned int ratetbl2rateset(_adapter *padapter, unsigned char *rateset) -+{ -+ int i; -+ unsigned char rate; -+ unsigned int len = 0; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ for (i = 0; i < NumRates; i++) -+ { -+ rate = pmlmeext->datarate[i]; -+ -+ switch (rate) -+ { -+ case 0xff: -+ return len; -+ -+ case 0xfe: -+ continue; -+ -+ default: -+ rate = ratetbl_val_2wifirate(rate); -+ -+ if (is_basicrate(padapter, rate) == true) -+ { -+ rate |= IEEE80211_BASIC_RATE_MASK; -+ } -+ -+ rateset[len] = rate; -+ len++; -+ break; -+ } -+ } -+ return len; -+} -+ -+void get_rate_set(_adapter *padapter, unsigned char *pbssrate, int *bssrate_len) -+{ -+ unsigned char supportedrates[NumRates]; -+ -+ _rtw_memset(supportedrates, 0, NumRates); -+ *bssrate_len = ratetbl2rateset(padapter, supportedrates); -+ _rtw_memcpy(pbssrate, supportedrates, *bssrate_len); -+} -+ -+void UpdateBrateTbl( -+ PADAPTER Adapter, -+ u8 *mBratesOS -+) -+{ -+ u8 i; -+ u8 rate; -+ -+ // 1M, 2M, 5.5M, 11M, 6M, 12M, 24M are mandatory. -+ for(i=0;ipbuddy_adapter; -+ if(pbuddy_adapter) -+ rtw_hal_set_hwreg(pbuddy_adapter, HW_VAR_DM_FUNC_OP, (u8 *)(&bSaveFlag)); -+#endif -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_OP, (u8 *)(&bSaveFlag)); -+ -+} -+ -+void Restore_DM_Func_Flag(_adapter *padapter) -+{ -+ u8 bSaveFlag = false; -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ if(pbuddy_adapter) -+ rtw_hal_set_hwreg(pbuddy_adapter, HW_VAR_DM_FUNC_OP, (u8 *)(&bSaveFlag)); -+#endif -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_OP, (u8 *)(&bSaveFlag)); -+} -+ -+void Switch_DM_Func(_adapter *padapter, u32 mode, u8 enable) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+#endif -+ -+ if(enable == true) -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if(pbuddy_adapter) -+ rtw_hal_set_hwreg(pbuddy_adapter, HW_VAR_DM_FUNC_SET, (u8 *)(&mode)); -+#endif -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_SET, (u8 *)(&mode)); -+ } -+ else -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if(pbuddy_adapter) -+ rtw_hal_set_hwreg(pbuddy_adapter, HW_VAR_DM_FUNC_CLR, (u8 *)(&mode)); -+#endif -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_CLR, (u8 *)(&mode)); -+ } -+ -+#if 0 -+ u8 val8; -+ -+ val8 = rtw_read8(padapter, FW_DYNAMIC_FUN_SWITCH); -+ -+ if(enable == true) -+ { -+ rtw_write8(padapter, FW_DYNAMIC_FUN_SWITCH, (val8 | mode)); -+ } -+ else -+ { -+ rtw_write8(padapter, FW_DYNAMIC_FUN_SWITCH, (val8 & mode)); -+ } -+#endif -+ -+} -+ -+static void Set_NETYPE1_MSR(_adapter *padapter, u8 type) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MEDIA_STATUS1, (u8 *)(&type)); -+} -+ -+static void Set_NETYPE0_MSR(_adapter *padapter, u8 type) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_MEDIA_STATUS, (u8 *)(&type)); -+} -+ -+void Set_MSR(_adapter *padapter, u8 type) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->iface_type == IFACE_PORT1) -+ { -+ Set_NETYPE1_MSR(padapter, type); -+ } -+ else -+#endif -+ { -+ Set_NETYPE0_MSR(padapter, type); -+ } -+} -+ -+inline u8 rtw_get_oper_ch(_adapter *adapter) -+{ -+ return adapter_to_dvobj(adapter)->oper_channel; -+} -+ -+inline void rtw_set_oper_ch(_adapter *adapter, u8 ch) -+{ -+ adapter_to_dvobj(adapter)->oper_channel = ch; -+} -+ -+inline u8 rtw_get_oper_bw(_adapter *adapter) -+{ -+ return adapter_to_dvobj(adapter)->oper_bwmode; -+} -+ -+inline void rtw_set_oper_bw(_adapter *adapter, u8 bw) -+{ -+ adapter_to_dvobj(adapter)->oper_bwmode = bw; -+} -+ -+inline u8 rtw_get_oper_choffset(_adapter *adapter) -+{ -+ return adapter_to_dvobj(adapter)->oper_ch_offset; -+} -+ -+inline void rtw_set_oper_choffset(_adapter *adapter, u8 offset) -+{ -+ adapter_to_dvobj(adapter)->oper_ch_offset = offset; -+} -+ -+u8 rtw_get_center_ch(u8 channel, u8 chnl_bw, u8 chnl_offset) -+{ -+ u8 center_ch = channel; -+ -+ if(chnl_bw == CHANNEL_WIDTH_80) -+ { -+ if((channel == 36) || (channel == 40) || (channel == 44) || (channel == 48) ) -+ center_ch = 42; -+ if((channel == 52) || (channel == 56) || (channel == 60) || (channel == 64) ) -+ center_ch = 58; -+ if((channel == 100) || (channel == 104) || (channel == 108) || (channel == 112) ) -+ center_ch = 106; -+ if((channel == 116) || (channel == 120) || (channel == 124) || (channel == 128) ) -+ center_ch = 122; -+ if((channel == 132) || (channel == 136) || (channel == 140) || (channel == 144) ) -+ center_ch = 138; -+ if((channel == 149) || (channel == 153) || (channel == 157) || (channel == 161) ) -+ center_ch = 155; -+ else if(channel <= 14) -+ center_ch = 7; -+ } -+ else if(chnl_bw == CHANNEL_WIDTH_40) -+ { -+ if (chnl_offset == HAL_PRIME_CHNL_OFFSET_LOWER) -+ center_ch = channel + 2; -+ else -+ center_ch = channel - 2; -+ } -+ -+ return center_ch; -+} -+ -+void SelectChannel(_adapter *padapter, unsigned char channel) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ //saved channel info -+ rtw_set_oper_ch(padapter, channel); -+ dc_SelectChannel(padapter, channel); -+#else //CONFIG_DUALMAC_CONCURRENT -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); -+ -+ //saved channel info -+ rtw_set_oper_ch(padapter, channel); -+ -+ rtw_hal_set_chan(padapter, channel); -+ -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); -+ -+#endif // CONFIG_DUALMAC_CONCURRENT -+} -+ -+void SetBWMode(_adapter *padapter, unsigned short bwmode, unsigned char channel_offset) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ //saved bw info -+ rtw_set_oper_bw(padapter, bwmode); -+ rtw_set_oper_choffset(padapter, channel_offset); -+ dc_SetBWMode(padapter, bwmode, channel_offset); -+#else //CONFIG_DUALMAC_CONCURRENT -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->setbw_mutex), NULL); -+ -+ //saved bw info -+ rtw_set_oper_bw(padapter, bwmode); -+ rtw_set_oper_choffset(padapter, channel_offset); -+ -+ rtw_hal_set_bwmode(padapter, (CHANNEL_WIDTH)bwmode, channel_offset); -+ -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->setbw_mutex), NULL); -+ -+#endif // CONFIG_DUALMAC_CONCURRENT -+} -+ -+void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char channel_offset, unsigned short bwmode) -+{ -+ u8 center_ch, chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if ( padapter->bNotifyChannelChange ) -+ { -+ DBG_871X( "[%s] ch = %d, offset = %d, bwmode = %d\n", __FUNCTION__, channel, channel_offset, bwmode ); -+ } -+ -+ center_ch = rtw_get_center_ch(channel, bwmode, channel_offset); -+ -+ if(bwmode == CHANNEL_WIDTH_80) -+ { -+ if(center_ch > channel) -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else if(center_ch < channel) -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else -+ chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ //set Channel -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ //saved channel/bw info -+ rtw_set_oper_ch(padapter, channel); -+ rtw_set_oper_bw(padapter, bwmode); -+ rtw_set_oper_choffset(padapter, channel_offset); -+ SelectChannel(padapter, channel); -+ SetBWMode(padapter, bwmode, channel_offset); -+#else //CONFIG_DUALMAC_CONCURRENT -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); -+ -+ //saved channel/bw info -+ rtw_set_oper_ch(padapter, channel); -+ rtw_set_oper_bw(padapter, bwmode); -+ rtw_set_oper_choffset(padapter, channel_offset); -+ -+ rtw_hal_set_chnl_bw(padapter, center_ch, bwmode, channel_offset, chnl_offset80); // set center channel -+ -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); -+ -+#endif // CONFIG_DUALMAC_CONCURRENT -+} -+ -+int get_bsstype(unsigned short capability) -+{ -+ if (capability & BIT(0)) -+ { -+ return WIFI_FW_AP_STATE; -+ } -+ else if (capability & BIT(1)) -+ { -+ return WIFI_FW_ADHOC_STATE; -+ } -+ else -+ { -+ return 0; -+ } -+} -+ -+__inline u8 *get_my_bssid(WLAN_BSSID_EX *pnetwork) -+{ -+ return (pnetwork->MacAddress); -+} -+ -+u16 get_beacon_interval(WLAN_BSSID_EX *bss) -+{ -+ __le16 val; -+ _rtw_memcpy((unsigned char *)&val, rtw_get_beacon_interval_from_ie(bss->IEs), 2); -+ -+ return le16_to_cpu(val); -+ -+} -+ -+int is_client_associated_to_ap(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ -+ if(!padapter) -+ return _FAIL; -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE)) -+ { -+ return true; -+ } -+ else -+ { -+ return _FAIL; -+ } -+} -+ -+int is_client_associated_to_ibss(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE)) -+ { -+ return true; -+ } -+ else -+ { -+ return _FAIL; -+ } -+} -+ -+int is_IBSS_empty(_adapter *padapter) -+{ -+ unsigned int i; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ for (i = IBSS_START_MAC_ID; i < NUM_STA; i++) -+ { -+ if (pmlmeinfo->FW_sta_info[i].status == 1) -+ { -+ return _FAIL; -+ } -+ } -+ -+ return true; -+ -+} -+ -+unsigned int decide_wait_for_beacon_timeout(unsigned int bcn_interval) -+{ -+ if ((bcn_interval << 2) < WAIT_FOR_BCN_TO_MIN) -+ { -+ return WAIT_FOR_BCN_TO_MIN; -+ } -+ else if ((bcn_interval << 2) > WAIT_FOR_BCN_TO_MAX) -+ { -+ return WAIT_FOR_BCN_TO_MAX; -+ } -+ else -+ { -+ return ((bcn_interval << 2)); -+ } -+} -+ -+void CAM_empty_entry( -+ PADAPTER Adapter, -+ u8 ucIndex -+) -+{ -+ rtw_hal_set_hwreg(Adapter, HW_VAR_CAM_EMPTY_ENTRY, (u8 *)(&ucIndex)); -+} -+ -+void invalidate_cam_all(_adapter *padapter) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_INVALID_ALL, NULL); -+} -+#if 0 -+static u32 _ReadCAM(_adapter *padapter ,u32 addr) -+{ -+ u32 count = 0, cmd; -+ cmd = CAM_POLLINIG |addr ; -+ rtw_write32(padapter, RWCAM, cmd); -+ -+ do{ -+ if(0 == (rtw_read32(padapter,REG_CAMCMD) & CAM_POLLINIG)){ -+ break; -+ } -+ }while(count++ < 100); -+ -+ return rtw_read32(padapter,REG_CAMREAD); -+} -+void read_cam(_adapter *padapter ,u8 entry) -+{ -+ u32 j,count = 0, addr, cmd; -+ addr = entry << 3; -+ -+ DBG_8192C("********* DUMP CAM Entry_#%02d***************\n",entry); -+ for (j = 0; j < 6; j++) -+ { -+ cmd = _ReadCAM(padapter ,addr+j); -+ DBG_8192C("offset:0x%02x => 0x%08x \n",addr+j,cmd); -+ } -+ DBG_8192C("*********************************\n"); -+} -+#endif -+ -+void write_cam(_adapter *padapter, u8 entry, u16 ctrl, u8 *mac, u8 *key) -+{ -+ unsigned int i, val, addr; -+ //unsigned int cmd; -+ int j; -+ u32 cam_val[2]; -+ -+ addr = entry << 3; -+ -+ for (j = 5; j >= 0; j--) -+ { -+ switch (j) -+ { -+ case 0: -+ val = (ctrl | (mac[0] << 16) | (mac[1] << 24) ); -+ break; -+ -+ case 1: -+ val = (mac[2] | ( mac[3] << 8) | (mac[4] << 16) | (mac[5] << 24)); -+ break; -+ -+ default: -+ i = (j - 2) << 2; -+ val = (key[i] | (key[i+1] << 8) | (key[i+2] << 16) | (key[i+3] << 24)); -+ break; -+ -+ } -+ -+ cam_val[0] = val; -+ cam_val[1] = addr + (unsigned int)j; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_WRITE, (u8 *)cam_val); -+ -+ //rtw_write32(padapter, WCAMI, val); -+ -+ //cmd = CAM_POLLINIG | CAM_WRITE | (addr + j); -+ //rtw_write32(padapter, RWCAM, cmd); -+ -+ //DBG_871X("%s=> cam write: %x, %x\n",__FUNCTION__, cmd, val); -+ -+ } -+ -+} -+ -+void clear_cam_entry(_adapter *padapter, u8 entry) -+{ -+#if 0 -+ u32 addr, val=0; -+ u32 cam_val[2]; -+ -+ addr = entry << 3; -+ -+ -+ cam_val[0] = val; -+ cam_val[1] = addr + (unsigned int)0; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_WRITE, (u8 *)cam_val); -+ -+ -+ -+ cam_val[0] = val; -+ cam_val[1] = addr + (unsigned int)1; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_WRITE, (u8 *)cam_val); -+#else -+ -+ unsigned char null_sta[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ -+ unsigned char null_key[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,0x00, 0x00, 0x00, 0x00,0x00, 0x00, 0x00, 0x00}; -+ -+ write_cam(padapter, entry, 0, null_sta, null_key); -+ -+#endif -+} -+ -+int allocate_fw_sta_entry(_adapter *padapter) -+{ -+ unsigned int mac_id; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ for (mac_id = IBSS_START_MAC_ID; mac_id < NUM_STA; mac_id++) -+ { -+ if (pmlmeinfo->FW_sta_info[mac_id].status == 0) -+ { -+ pmlmeinfo->FW_sta_info[mac_id].status = 1; -+ pmlmeinfo->FW_sta_info[mac_id].retry = 0; -+ break; -+ } -+ } -+ -+ return mac_id; -+} -+ -+void flush_all_cam_entry(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ //if(check_buddy_mlmeinfo_state(padapter, _HW_STATE_NOLINK_)) -+ if(check_buddy_fwstate(padapter, _FW_LINKED) == false) -+ { -+ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_INVALID_ALL, 0); -+ } -+ else -+ { -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ { -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta; -+ u8 cam_id;//cam_entry -+ -+ psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); -+ if(psta) { -+ if(psta->state & WIFI_AP_STATE) -+ {} //clear cam when ap free per sta_info -+ else { -+ -+ cam_id = (u8)rtw_get_camid(psta->mac_id); -+ -+ //clear_cam_entry(padapter, cam_id); -+ rtw_clearstakey_cmd(padapter, (u8*)psta, cam_id, false); -+ } -+ } -+ } -+ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ //clear cam when ap free per sta_info -+ } -+ } -+#else //CONFIG_CONCURRENT_MODE -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CAM_INVALID_ALL, NULL); -+ -+#endif //CONFIG_CONCURRENT_MODE -+ -+ _rtw_memset((u8 *)(pmlmeinfo->FW_sta_info), 0, sizeof(pmlmeinfo->FW_sta_info)); -+ -+} -+ -+#if defined(CONFIG_P2P) && defined(CONFIG_WFD) -+int WFD_info_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct wifidirect_info *pwdinfo; -+ u8 wfd_ie[ 128 ] = { 0x00 }; -+ u32 wfd_ielen = 0; -+ -+ -+ pwdinfo = &padapter->wdinfo; -+ if ( rtw_get_wfd_ie( ( u8* ) pIE, pIE->Length, wfd_ie, &wfd_ielen ) ) -+ { -+ u8 attr_content[ 10 ] = { 0x00 }; -+ u32 attr_contentlen = 0; -+ -+ DBG_871X( "[%s] Found WFD IE\n", __FUNCTION__ ); -+ rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, attr_content, &attr_contentlen); -+ if ( attr_contentlen ) -+ { -+ pwdinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16( attr_content + 2 ); -+ DBG_8192C( "[%s] Peer PORT NUM = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_rtsp_ctrlport ); -+ return( true ); -+ } -+ } -+ else -+ { -+ DBG_871X( "[%s] NO WFD IE\n", __FUNCTION__ ); -+ -+ } -+ return( _FAIL ); -+} -+#endif -+ -+int WMM_param_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ //struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if(pmlmepriv->qospriv.qos_option==0) -+ { -+ pmlmeinfo->WMM_enable = 0; -+ return _FAIL; -+ } -+ -+ pmlmeinfo->WMM_enable = 1; -+ _rtw_memcpy(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element)); -+ return true; -+ -+ /*if (pregpriv->wifi_spec == 1) -+ { -+ if (pmlmeinfo->WMM_enable == 1) -+ { -+ //todo: compare the parameter set count & decide wheher to update or not -+ return _FAIL; -+ } -+ else -+ { -+ pmlmeinfo->WMM_enable = 1; -+ _rtw_rtw_memcpy(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element)); -+ return true; -+ } -+ } -+ else -+ { -+ pmlmeinfo->WMM_enable = 0; -+ return _FAIL; -+ }*/ -+ -+} -+ -+void WMMOnAssocRsp(_adapter *padapter) -+{ -+ u8 ACI, ACM, AIFS, ECWMin, ECWMax, aSifsTime; -+ u8 acm_mask; -+ u16 TXOP; -+ u32 acParm, i; -+ u32 edca[4], inx[4]; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ -+ acm_mask = 0; -+ -+ if (IsSupported5G(pmlmeext->cur_wireless_mode) || -+ (pmlmeext->cur_wireless_mode & WIRELESS_11_24N) ) -+ aSifsTime = 16; -+ else -+ aSifsTime = 10; -+ -+ if (pmlmeinfo->WMM_enable == 0) -+ { -+ padapter->mlmepriv.acm_mask = 0; -+ -+ AIFS = aSifsTime + (2 * pmlmeinfo->slotTime); -+ -+ if (pmlmeext->cur_wireless_mode & (WIRELESS_11G |WIRELESS_11A)) { -+ ECWMin = 4; -+ ECWMax = 10; -+ } else if (pmlmeext->cur_wireless_mode & WIRELESS_11B) { -+ ECWMin = 5; -+ ECWMax = 10; -+ } -+ -+ TXOP = 0; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); -+ -+ ECWMin = 2; -+ ECWMax = 3; -+ TXOP = 0x2f; -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); -+ } -+ else -+ { -+ for (i = 0; i < 4; i++) -+ { -+ ACI = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 5) & 0x03; -+ ACM = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 4) & 0x01; -+ -+ //AIFS = AIFSN * slot time + SIFS - r2t phy delay -+ AIFS = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN & 0x0f) * pmlmeinfo->slotTime + aSifsTime; -+ -+ ECWMin = (pmlmeinfo->WMM_param.ac_param[i].CW & 0x0f); -+ ECWMax = (pmlmeinfo->WMM_param.ac_param[i].CW & 0xf0) >> 4; -+ TXOP = le16_to_cpu(pmlmeinfo->WMM_param.ac_param[i].TXOP_limit); -+ -+ acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); -+ -+ switch (ACI) -+ { -+ case 0x0: -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); -+ acm_mask |= (ACM? BIT(1):0); -+ edca[XMIT_BE_QUEUE] = acParm; -+ break; -+ -+ case 0x1: -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); -+ //acm_mask |= (ACM? BIT(0):0); -+ edca[XMIT_BK_QUEUE] = acParm; -+ break; -+ -+ case 0x2: -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); -+ acm_mask |= (ACM? BIT(2):0); -+ edca[XMIT_VI_QUEUE] = acParm; -+ break; -+ -+ case 0x3: -+ rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); -+ acm_mask |= (ACM? BIT(3):0); -+ edca[XMIT_VO_QUEUE] = acParm; -+ break; -+ } -+ -+ DBG_871X("WMM(%x): %x, %x\n", ACI, ACM, acParm); -+ } -+ -+ if(padapter->registrypriv.acm_method == 1) -+ rtw_hal_set_hwreg(padapter, HW_VAR_ACM_CTRL, (u8 *)(&acm_mask)); -+ else -+ padapter->mlmepriv.acm_mask = acm_mask; -+ -+ inx[0] = 0; inx[1] = 1; inx[2] = 2; inx[3] = 3; -+ -+ if(pregpriv->wifi_spec==1) -+ { -+ u32 j, tmp, change_inx; -+ -+ //entry indx: 0->vo, 1->vi, 2->be, 3->bk. -+ for(i=0; i<4; i++) -+ { -+ for(j=i+1; j<4; j++) -+ { -+ //compare CW and AIFS -+ if((edca[j] & 0xFFFF) < (edca[i] & 0xFFFF)) -+ { -+ change_inx = true; -+ } -+ else if((edca[j] & 0xFFFF) == (edca[i] & 0xFFFF)) -+ { -+ //compare TXOP -+ if((edca[j] >> 16) > (edca[i] >> 16)) -+ change_inx = true; -+ } -+ -+ if(change_inx) -+ { -+ tmp = edca[i]; -+ edca[i] = edca[j]; -+ edca[j] = tmp; -+ -+ tmp = inx[i]; -+ inx[i] = inx[j]; -+ inx[j] = tmp; -+ -+ change_inx = false; -+ } -+ } -+ } -+ } -+ -+ for(i=0; i<4; i++) { -+ pxmitpriv->wmm_para_seq[i] = inx[i]; -+ DBG_871X("wmm_para_seq(%d): %d\n", i, pxmitpriv->wmm_para_seq[i]); -+ } -+ } -+} -+ -+static void bwmode_update_check(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+#ifdef CONFIG_80211N_HT -+ unsigned char new_bwmode; -+ unsigned char new_ch_offset; -+ struct HT_info_element *pHT_info; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ u8 cbw40_enable=0; -+ -+ if(!pIE) -+ return; -+ -+ if(phtpriv->ht_option == false) return; -+ -+ if(pmlmeext->cur_bwmode >= CHANNEL_WIDTH_80) return; -+ -+ if(pIE->Length > sizeof(struct HT_info_element)) -+ return; -+ -+ pHT_info = (struct HT_info_element *)pIE->data; -+ -+ if (pmlmeext->cur_channel > 14) { -+ if ((pregistrypriv->bw_mode & 0xf0) > 0) -+ cbw40_enable = 1; -+ } else { -+ if ((pregistrypriv->bw_mode & 0x0f) > 0) -+ cbw40_enable = 1; -+ } -+ -+ if((pHT_info->infos[0] & BIT(2)) && cbw40_enable) -+ { -+ new_bwmode = CHANNEL_WIDTH_40; -+ -+ switch (pHT_info->infos[0] & 0x3) -+ { -+ case 1: -+ new_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case 3: -+ new_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ } -+ else -+ { -+ new_bwmode = CHANNEL_WIDTH_20; -+ new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ -+ if((new_bwmode!= pmlmeext->cur_bwmode) || (new_ch_offset!=pmlmeext->cur_ch_offset)) -+ { -+ pmlmeinfo->bwmode_updated = true; -+ -+ pmlmeext->cur_bwmode = new_bwmode; -+ pmlmeext->cur_ch_offset = new_ch_offset; -+ -+ //update HT info also -+ HT_info_handler(padapter, pIE); -+ } -+ else -+ { -+ pmlmeinfo->bwmode_updated = false; -+ } -+ -+ -+ if(true == pmlmeinfo->bwmode_updated) -+ { -+ struct sta_info *psta; -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ //set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+ -+ //update ap's stainfo -+ psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); -+ if(psta) -+ { -+ struct ht_priv *phtpriv_sta = &psta->htpriv; -+ -+ if(phtpriv_sta->ht_option) -+ { -+ // bwmode -+ phtpriv_sta->bwmode = pmlmeext->cur_bwmode; -+ phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; -+ } -+ else -+ { -+ phtpriv_sta->bwmode = CHANNEL_WIDTH_20; -+ phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ } -+ -+ } -+ -+ //pmlmeinfo->bwmode_updated = false;//bwmode_updated done, reset it! -+ -+ } -+#endif //CONFIG_80211N_HT -+} -+ -+void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+#ifdef CONFIG_80211N_HT -+ unsigned int i; -+ u8 rf_type; -+ u8 max_AMPDU_len, min_MPDU_spacing; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ if(pIE==NULL) return; -+ -+ if(phtpriv->ht_option == false) return; -+ -+ pmlmeinfo->HT_caps_enable = 1; -+ -+ for (i = 0; i < (pIE->Length); i++) -+ { -+ if (i != 2) -+ { -+ // Commented by Albert 2010/07/12 -+ // Got the endian issue here. -+ pmlmeinfo->HT_caps.u.HT_cap[i] &= (pIE->data[i]); -+ } -+ else -+ { -+ //modify from fw by Thomas 2010/11/17 -+ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3) > (pIE->data[i] & 0x3)) -+ { -+ max_AMPDU_len = (pIE->data[i] & 0x3); -+ } -+ else -+ { -+ max_AMPDU_len = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3); -+ } -+ -+ if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) > (pIE->data[i] & 0x1c)) -+ { -+ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c); -+ } -+ else -+ { -+ min_MPDU_spacing = (pIE->data[i] & 0x1c); -+ } -+ -+ pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para = max_AMPDU_len | min_MPDU_spacing; -+ } -+ } -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ //update the MCS rates -+ for (i = 0; i < 16; i++) -+ { -+ if((rf_type == RF_1T1R) || (rf_type == RF_1T2R)) -+ { -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; -+ } -+ else -+ { -+ #ifdef CONFIG_DISABLE_MCS13TO15 -+ if(pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && (pregistrypriv->wifi_spec!=1)) -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R_MCS13TO15_OFF[i]; -+ else -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R[i]; -+ #else -+ pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R[i]; -+ #endif //CONFIG_DISABLE_MCS13TO15 -+ } -+ #ifdef RTL8192C_RECONFIG_TO_1T1R -+ { -+ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; -+ } -+ #endif -+ } -+#endif //CONFIG_80211N_HT -+ return; -+} -+ -+void HT_info_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+#ifdef CONFIG_80211N_HT -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct ht_priv *phtpriv = &pmlmepriv->htpriv; -+ -+ if(pIE==NULL) return; -+ -+ if(phtpriv->ht_option == false) return; -+ -+ -+ if(pIE->Length > sizeof(struct HT_info_element)) -+ return; -+ -+ pmlmeinfo->HT_info_enable = 1; -+ _rtw_memcpy(&(pmlmeinfo->HT_info), pIE->data, pIE->Length); -+#endif //CONFIG_80211N_HT -+ return; -+} -+ -+void HTOnAssocRsp(_adapter *padapter) -+{ -+ unsigned char max_AMPDU_len; -+ unsigned char min_MPDU_spacing; -+ //struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable)) -+ { -+ pmlmeinfo->HT_enable = 1; -+ } -+ else -+ { -+ pmlmeinfo->HT_enable = 0; -+ //set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ return; -+ } -+ -+ //handle A-MPDU parameter field -+ /* -+ AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k -+ AMPDU_para [4:2]:Min MPDU Start Spacing -+ */ -+ max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03; -+ -+ min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2; -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing)); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len)); -+ -+#if 0 //move to rtw_update_ht_cap() -+ if ((pregpriv->bw_mode > 0) && -+ (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & BIT(1)) && -+ (pmlmeinfo->HT_info.infos[0] & BIT(2))) -+ { -+ //switch to the 40M Hz mode accoring to the AP -+ pmlmeext->cur_bwmode = CHANNEL_WIDTH_40; -+ switch ((pmlmeinfo->HT_info.infos[0] & 0x3)) -+ { -+ case EXTCHNL_OFFSET_UPPER: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER; -+ break; -+ -+ case EXTCHNL_OFFSET_LOWER: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER; -+ break; -+ -+ default: -+ pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ break; -+ } -+ -+ //SelectChannel(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset); -+ } -+#endif -+ -+ //set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); -+ -+#if 0 //move to rtw_update_ht_cap() -+ // -+ // Config SM Power Save setting -+ // -+ pmlmeinfo->SM_PS = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & 0x0C) >> 2; -+ if(pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC) -+ { -+ /*u8 i; -+ //update the MCS rates -+ for (i = 0; i < 16; i++) -+ { -+ pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i]; -+ }*/ -+ DBG_871X("%s(): WLAN_HT_CAP_SM_PS_STATIC\n",__FUNCTION__); -+ } -+ -+ // -+ // Config current HT Protection mode. -+ // -+ pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; -+#endif -+ -+} -+ -+void ERP_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if(pIE->Length>1) -+ return; -+ -+ pmlmeinfo->ERP_enable = 1; -+ _rtw_memcpy(&(pmlmeinfo->ERP_IE), pIE->data, pIE->Length); -+} -+ -+void VCS_update(_adapter *padapter, struct sta_info *psta) -+{ -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ switch (pregpriv->vrtl_carrier_sense)/* 0:off 1:on 2:auto */ -+ { -+ case 0: //off -+ psta->rtsen = 0; -+ psta->cts2self = 0; -+ break; -+ -+ case 1: //on -+ if (pregpriv->vcs_type == 1) /* 1:RTS/CTS 2:CTS to self */ -+ { -+ psta->rtsen = 1; -+ psta->cts2self = 0; -+ } -+ else -+ { -+ psta->rtsen = 0; -+ psta->cts2self = 1; -+ } -+ break; -+ -+ case 2: //auto -+ default: -+ if ((pmlmeinfo->ERP_enable) && (pmlmeinfo->ERP_IE & BIT(1))) -+ { -+ if (pregpriv->vcs_type == 1) -+ { -+ psta->rtsen = 1; -+ psta->cts2self = 0; -+ } -+ else -+ { -+ psta->rtsen = 0; -+ psta->cts2self = 1; -+ } -+ } -+ else -+ { -+ psta->rtsen = 0; -+ psta->cts2self = 0; -+ } -+ break; -+ } -+} -+ -+#ifdef CONFIG_TDLS -+int check_ap_tdls_prohibited(u8 *pframe, u8 pkt_len) -+{ -+ u8 tdls_prohibited_bit = 0x40; //bit(38); TDLS_prohibited -+ -+ if(pkt_len < 5) -+ { -+ return false; -+ } -+ -+ pframe += 4; -+ if( (*pframe) & tdls_prohibited_bit ) -+ return true; -+ -+ return false; -+} -+#endif //CONFIG_TDLS -+ -+int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) -+{ -+ unsigned int len; -+ unsigned char *p; -+ unsigned short val16, subtype; -+ struct wlan_network *cur_network = &(Adapter->mlmepriv.cur_network); -+ //u8 wpa_ie[255],rsn_ie[255]; -+ u16 wpa_len=0,rsn_len=0; -+ u8 encryp_protocol = 0; -+ WLAN_BSSID_EX *bssid; -+ int group_cipher = 0, pairwise_cipher = 0, is_8021x = 0; -+ unsigned char *pbuf; -+ u32 wpa_ielen = 0; -+ u8 *pbssid = GetAddr3Ptr(pframe); -+ u32 hidden_ssid = 0; -+ u8 cur_network_type, network_type=0; -+ struct HT_info_element *pht_info = NULL; -+ struct rtw_ieee80211_ht_cap *pht_cap = NULL; -+ u32 bcn_channel; -+ unsigned short ht_cap_info; -+ unsigned char ht_info_infos_0; -+ -+ if (is_client_associated_to_ap(Adapter) == false) -+ return true; -+ -+ len = packet_len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ if (len > MAX_IE_SZ) { -+ DBG_871X("%s IE too long for survey event\n", __func__); -+ return _FAIL; -+ } -+ -+ if (_rtw_memcmp(cur_network->network.MacAddress, pbssid, 6) == false) { -+ DBG_871X("Oops: rtw_check_network_encrypt linked but recv other bssid bcn\n" MAC_FMT MAC_FMT, -+ MAC_ARG(pbssid), MAC_ARG(cur_network->network.MacAddress)); -+ return true; -+ } -+ -+ bssid = (WLAN_BSSID_EX *)rtw_zmalloc(sizeof(WLAN_BSSID_EX)); -+ -+ subtype = GetFrameSubType(pframe) >> 4; -+ -+ if(subtype==WIFI_BEACON) -+ bssid->Reserved[0] = 1; -+ -+ bssid->Length = sizeof(WLAN_BSSID_EX) - MAX_IE_SZ + len; -+ -+ /* below is to copy the information element */ -+ bssid->IELength = len; -+ _rtw_memcpy(bssid->IEs, (pframe + sizeof(struct rtw_ieee80211_hdr_3addr)), bssid->IELength); -+ -+ /* check bw and channel offset */ -+ /* parsing HT_CAP_IE */ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if(p && len>0) { -+ pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); -+ ht_cap_info = le16_to_cpu(pht_cap->cap_info); -+ } else { -+ ht_cap_info = 0; -+ } -+ /* parsing HT_INFO_IE */ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if(p && len>0) { -+ pht_info = (struct HT_info_element *)(p + 2); -+ ht_info_infos_0 = pht_info->infos[0]; -+ } else { -+ ht_info_infos_0 = 0; -+ } -+ if (ht_cap_info != cur_network->BcnInfo.ht_cap_info || -+ ((ht_info_infos_0&0x03) != (cur_network->BcnInfo.ht_info_infos_0&0x03))) { -+ DBG_871X("%s bcn now: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, -+ ht_cap_info, ht_info_infos_0); -+ DBG_871X("%s bcn link: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, -+ cur_network->BcnInfo.ht_cap_info, cur_network->BcnInfo.ht_info_infos_0); -+ DBG_871X("%s bw mode change, disconnect\n", __func__); -+ { -+ //bcn_info_update -+ cur_network->BcnInfo.ht_cap_info = ht_cap_info; -+ cur_network->BcnInfo.ht_info_infos_0 = ht_info_infos_0; -+ //to do : need to check that whether modify related register of BB or not -+ } -+ //goto _mismatch; -+ } -+ -+ /* Checking for channel */ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _DSSET_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if (p) { -+ bcn_channel = *(p + 2); -+ } else {/* In 5G, some ap do not have DSSET IE checking HT info for channel */ -+ p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); -+ if(pht_info) { -+ bcn_channel = pht_info->primary_channel; -+ } else { /* we don't find channel IE, so don't check it */ -+ //DBG_871X("Oops: %s we don't find channel IE, so don't check it \n", __func__); -+ bcn_channel = Adapter->mlmeextpriv.cur_channel; -+ } -+ } -+ if (bcn_channel != Adapter->mlmeextpriv.cur_channel) { -+ DBG_871X("%s beacon channel:%d cur channel:%d disconnect\n", __func__, -+ bcn_channel, Adapter->mlmeextpriv.cur_channel); -+ goto _mismatch; -+ } -+ -+ /* checking SSID */ -+ if ((p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _SSID_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_)) == NULL) { -+ DBG_871X("%s marc: cannot find SSID for survey event\n", __func__); -+ hidden_ssid = true; -+ } else { -+ hidden_ssid = false; -+ } -+ -+ if((NULL != p) && (false == hidden_ssid && (*(p + 1)))) { -+ _rtw_memcpy(bssid->Ssid.Ssid, (p + 2), *(p + 1)); -+ bssid->Ssid.SsidLength = *(p + 1); -+ } else { -+ bssid->Ssid.SsidLength = 0; -+ bssid->Ssid.Ssid[0] = '\0'; -+ } -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("%s bssid.Ssid.Ssid:%s bssid.Ssid.SsidLength:%d " -+ "cur_network->network.Ssid.Ssid:%s len:%d\n", __func__, bssid->Ssid.Ssid, -+ bssid->Ssid.SsidLength, cur_network->network.Ssid.Ssid, -+ cur_network->network.Ssid.SsidLength)); -+ -+ if (_rtw_memcmp(bssid->Ssid.Ssid, cur_network->network.Ssid.Ssid, 32) == false || -+ bssid->Ssid.SsidLength != cur_network->network.Ssid.SsidLength) { -+ if (bssid->Ssid.Ssid[0] != '\0' && bssid->Ssid.SsidLength != 0) { /* not hidden ssid */ -+ DBG_871X("%s(), SSID is not match return FAIL\n", __func__); -+ goto _mismatch; -+ } -+ } -+ -+ /* check encryption info */ -+ val16 = rtw_get_capability((WLAN_BSSID_EX *)bssid); -+ -+ if (val16 & BIT(4)) -+ bssid->Privacy = 1; -+ else -+ bssid->Privacy = 0; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_, -+ ("%s(): cur_network->network.Privacy is %d, bssid.Privacy is %d\n", -+ __func__, cur_network->network.Privacy,bssid->Privacy)); -+ if (cur_network->network.Privacy != bssid->Privacy) { -+ DBG_871X("%s(), privacy is not match return FAIL\n",__func__); -+ goto _mismatch; -+ } -+ -+ rtw_get_sec_ie(bssid->IEs, bssid->IELength, NULL,&rsn_len,NULL,&wpa_len); -+ -+ if (rsn_len > 0) { -+ encryp_protocol = ENCRYP_PROTOCOL_WPA2; -+ } else if (wpa_len > 0) { -+ encryp_protocol = ENCRYP_PROTOCOL_WPA; -+ } else { -+ if (bssid->Privacy) -+ encryp_protocol = ENCRYP_PROTOCOL_WEP; -+ } -+ -+ if (cur_network->BcnInfo.encryp_protocol != encryp_protocol) { -+ DBG_871X("%s(): enctyp is not match ,return FAIL\n",__func__); -+ goto _mismatch; -+ } -+ -+ if (encryp_protocol == ENCRYP_PROTOCOL_WPA || encryp_protocol == ENCRYP_PROTOCOL_WPA2) { -+ pbuf = rtw_get_wpa_ie(&bssid->IEs[12], &wpa_ielen, bssid->IELength-12); -+ if(pbuf && (wpa_ielen>0)) { -+ if (_SUCCESS == rtw_parse_wpa_ie(pbuf, wpa_ielen+2, &group_cipher, &pairwise_cipher, &is_8021x)) { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_, -+ ("%s pnetwork->pairwise_cipher: %d, group_cipher is %d, is_8021x is %d\n", __func__, -+ pairwise_cipher, group_cipher, is_8021x)); -+ } -+ } else { -+ pbuf = rtw_get_wpa2_ie(&bssid->IEs[12], &wpa_ielen, bssid->IELength-12); -+ -+ if(pbuf && (wpa_ielen>0)) { -+ if (_SUCCESS == rtw_parse_wpa2_ie(pbuf, wpa_ielen+2, &group_cipher, &pairwise_cipher, &is_8021x)) { -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_, -+ ("%s pnetwork->pairwise_cipher: %d, pnetwork->group_cipher is %d, is_802x is %d\n", -+ __func__, pairwise_cipher, group_cipher, is_8021x)); -+ } -+ } -+ } -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_err_, -+ ("%s cur_network->group_cipher is %d: %d\n",__func__, cur_network->BcnInfo.group_cipher, group_cipher)); -+ if (pairwise_cipher != cur_network->BcnInfo.pairwise_cipher || group_cipher != cur_network->BcnInfo.group_cipher) { -+ DBG_871X("%s pairwise_cipher(%x:%x) or group_cipher(%x:%x) is not match ,return FAIL\n",__func__, -+ pairwise_cipher, cur_network->BcnInfo.pairwise_cipher, -+ group_cipher, cur_network->BcnInfo.group_cipher); -+ goto _mismatch; -+ } -+ -+ if (is_8021x != cur_network->BcnInfo.is_8021x) { -+ DBG_871X("%s authentication is not match ,return FAIL\n", __func__); -+ goto _mismatch; -+ } -+ } -+ -+ rtw_mfree((u8 *)bssid, sizeof(WLAN_BSSID_EX)); -+ return _SUCCESS; -+ -+_mismatch: -+ rtw_mfree((u8 *)bssid, sizeof(WLAN_BSSID_EX)); -+ return _FAIL; -+ -+ -+} -+ -+void update_beacon_info(_adapter *padapter, u8 *pframe, uint pkt_len, struct sta_info *psta) -+{ -+ unsigned int i; -+ unsigned int len; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ u8 tdls_prohibited[] = { 0x00, 0x00, 0x00, 0x00, 0x10 }; //bit(38): TDLS_prohibited -+#endif //CONFIG_TDLS -+ -+ len = pkt_len - (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN); -+ -+ for (i = 0; i < len;) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN) + i); -+ -+ switch (pIE->ElementID) -+ { -+#if 0 -+ case _VENDOR_SPECIFIC_IE_: -+ //todo: to update WMM paramter set while receiving beacon -+ if (_rtw_memcmp(pIE->data, WMM_PARA_OUI, 6)) //WMM -+ { -+ (WMM_param_handler(padapter, pIE))? WMMOnAssocRsp(padapter): 0; -+ } -+ break; -+#endif -+ -+ case _HT_EXTRA_INFO_IE_: //HT info -+ //HT_info_handler(padapter, pIE); -+ bwmode_update_check(padapter, pIE); -+ break; -+ -+ case _ERPINFO_IE_: -+ ERP_IE_handler(padapter, pIE); -+ VCS_update(padapter, psta); -+ break; -+ -+#ifdef CONFIG_TDLS -+ case _EXT_CAP_IE_: -+ if( check_ap_tdls_prohibited(pIE->data, pIE->Length) == true ) -+ ptdlsinfo->ap_prohibited = true; -+ break; -+#endif //CONFIG_TDLS -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+} -+ -+#ifdef CONFIG_DFS -+void process_csa_ie(_adapter *padapter, u8 *pframe, uint pkt_len) -+{ -+ unsigned int i; -+ unsigned int len; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ u8 new_ch_no = 0; -+ -+ len = pkt_len - (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN); -+ -+ for (i = 0; i < len;) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN) + i); -+ -+ switch (pIE->ElementID) -+ { -+ case _CH_SWTICH_ANNOUNCE_: -+ _rtw_memcpy(&new_ch_no, pIE->data+1, 1); -+ rtw_set_csa_cmd(padapter, new_ch_no); -+ break; -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+} -+#endif //CONFIG_DFS -+ -+unsigned int is_ap_in_tkip(_adapter *padapter) -+{ -+ u32 i; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ -+ if (rtw_get_capability((WLAN_BSSID_EX *)cur_network) & WLAN_CAPABILITY_PRIVACY) -+ { -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pmlmeinfo->network.IELength;) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pmlmeinfo->network.IEs + i); -+ -+ switch (pIE->ElementID) -+ { -+ case _VENDOR_SPECIFIC_IE_: -+ if ((_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) && (_rtw_memcmp((pIE->data + 12), WPA_TKIP_CIPHER, 4))) -+ { -+ return true; -+ } -+ break; -+ -+ case _RSN_IE_2_: -+ if (_rtw_memcmp((pIE->data + 8), RSN_TKIP_CIPHER, 4)) -+ { -+ return true; -+ } -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ return false; -+ } -+ else -+ { -+ return false; -+ } -+ -+} -+ -+unsigned int should_forbid_n_rate(_adapter * padapter) -+{ -+ u32 i; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ WLAN_BSSID_EX *cur_network = &pmlmepriv->cur_network.network; -+ -+ if (rtw_get_capability((WLAN_BSSID_EX *)cur_network) & WLAN_CAPABILITY_PRIVACY) -+ { -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < cur_network->IELength;) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(cur_network->IEs + i); -+ -+ switch (pIE->ElementID) -+ { -+ case _VENDOR_SPECIFIC_IE_: -+ if (_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4) && -+ ((_rtw_memcmp((pIE->data + 12), WPA_CIPHER_SUITE_CCMP, 4)) || -+ (_rtw_memcmp((pIE->data + 16), WPA_CIPHER_SUITE_CCMP, 4)))) -+ return false; -+ break; -+ -+ case _RSN_IE_2_: -+ if ((_rtw_memcmp((pIE->data + 8), RSN_CIPHER_SUITE_CCMP, 4)) || -+ (_rtw_memcmp((pIE->data + 12), RSN_CIPHER_SUITE_CCMP, 4))) -+ return false; -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ return true; -+ } -+ else -+ { -+ return false; -+ } -+ -+} -+ -+ -+unsigned int is_ap_in_wep(_adapter *padapter) -+{ -+ u32 i; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ -+ if (rtw_get_capability((WLAN_BSSID_EX *)cur_network) & WLAN_CAPABILITY_PRIVACY) -+ { -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pmlmeinfo->network.IELength;) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pmlmeinfo->network.IEs + i); -+ -+ switch (pIE->ElementID) -+ { -+ case _VENDOR_SPECIFIC_IE_: -+ if (_rtw_memcmp(pIE->data, RTW_WPA_OUI, 4)) -+ return false; -+ break; -+ -+ case _RSN_IE_2_: -+ return false; -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ return true; -+ } -+ else -+ { -+ return false; -+ } -+ -+} -+ -+int wifirate2_ratetbl_inx(unsigned char rate); -+int wifirate2_ratetbl_inx(unsigned char rate) -+{ -+ int inx = 0; -+ rate = rate & 0x7f; -+ -+ switch (rate) -+ { -+ case 54*2: -+ inx = 11; -+ break; -+ -+ case 48*2: -+ inx = 10; -+ break; -+ -+ case 36*2: -+ inx = 9; -+ break; -+ -+ case 24*2: -+ inx = 8; -+ break; -+ -+ case 18*2: -+ inx = 7; -+ break; -+ -+ case 12*2: -+ inx = 6; -+ break; -+ -+ case 9*2: -+ inx = 5; -+ break; -+ -+ case 6*2: -+ inx = 4; -+ break; -+ -+ case 11*2: -+ inx = 3; -+ break; -+ case 11: -+ inx = 2; -+ break; -+ -+ case 2*2: -+ inx = 1; -+ break; -+ -+ case 1*2: -+ inx = 0; -+ break; -+ -+ } -+ return inx; -+} -+ -+unsigned int update_basic_rate(unsigned char *ptn, unsigned int ptn_sz) -+{ -+ unsigned int i, num_of_rate; -+ unsigned int mask = 0; -+ -+ num_of_rate = (ptn_sz > NumRates)? NumRates: ptn_sz; -+ -+ for (i = 0; i < num_of_rate; i++) -+ { -+ if ((*(ptn + i)) & 0x80) -+ { -+ mask |= 0x1 << wifirate2_ratetbl_inx(*(ptn + i)); -+ } -+ } -+ return mask; -+} -+ -+unsigned int update_supported_rate(unsigned char *ptn, unsigned int ptn_sz) -+{ -+ unsigned int i, num_of_rate; -+ unsigned int mask = 0; -+ -+ num_of_rate = (ptn_sz > NumRates)? NumRates: ptn_sz; -+ -+ for (i = 0; i < num_of_rate; i++) -+ { -+ mask |= 0x1 << wifirate2_ratetbl_inx(*(ptn + i)); -+ } -+ -+ return mask; -+} -+ -+unsigned int update_MCS_rate(struct HT_caps_element *pHT_caps) -+{ -+ unsigned int mask = 0; -+ -+ mask = ((pHT_caps->u.HT_cap_element.MCS_rate[0] << 12) | (pHT_caps->u.HT_cap_element.MCS_rate[1] << 20)); -+ -+ return mask; -+} -+ -+int support_short_GI(_adapter *padapter, struct HT_caps_element *pHT_caps) -+{ -+ unsigned char bit_offset; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if (!(pmlmeinfo->HT_enable)) -+ return _FAIL; -+ -+ if ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_RALINK)) -+ return _FAIL; -+ -+ bit_offset = (pmlmeext->cur_bwmode & CHANNEL_WIDTH_40)? 6: 5; -+ -+ if (le16_to_cpu(pHT_caps->u.HT_cap_element.HT_caps_info) & (0x1 << bit_offset)) -+ return _SUCCESS; -+ else -+ return _FAIL; -+} -+ -+unsigned char get_highest_rate_idx(u32 mask) -+{ -+ int i; -+ unsigned char rate_idx=0; -+ -+ for(i=31; i>=0; i--) -+ { -+ if(mask & BIT(i)) -+ { -+ rate_idx = i; -+ break; -+ } -+ } -+ -+ return rate_idx; -+} -+ -+unsigned char get_highest_mcs_rate(struct HT_caps_element *pHT_caps); -+unsigned char get_highest_mcs_rate(struct HT_caps_element *pHT_caps) -+{ -+ int i, mcs_rate; -+ -+ mcs_rate = (pHT_caps->u.HT_cap_element.MCS_rate[0] | (pHT_caps->u.HT_cap_element.MCS_rate[1] << 8)); -+ -+ for (i = 15; i >= 0; i--) -+ { -+ if (mcs_rate & (0x1 << i)) -+ { -+ break; -+ } -+ } -+ -+ return i; -+} -+ -+void Update_RA_Entry(_adapter *padapter, struct sta_info *psta) -+{ -+ rtw_hal_update_ra_mask(psta, 0); -+} -+ -+void enable_rate_adaptive(_adapter *padapter, struct sta_info *psta); -+void enable_rate_adaptive(_adapter *padapter, struct sta_info *psta) -+{ -+ Update_RA_Entry(padapter, psta); -+} -+ -+void set_sta_rate(_adapter *padapter, struct sta_info *psta) -+{ -+ //rate adaptive -+ enable_rate_adaptive(padapter, psta); -+} -+ -+// Update RRSR and Rate for USERATE -+void update_tx_basic_rate(_adapter *padapter, u8 wirelessmode) -+{ -+ NDIS_802_11_RATES_EX supported_rates; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info* pwdinfo = &padapter->wdinfo; -+ -+ // Added by Albert 2011/03/22 -+ // In the P2P mode, the driver should not support the b mode. -+ // So, the Tx packet shouldn't use the CCK rate -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ return; -+#endif //CONFIG_P2P -+#ifdef CONFIG_INTEL_WIDI -+ if (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_NONE) -+ return; -+#endif //CONFIG_INTEL_WIDI -+ -+ _rtw_memset(supported_rates, 0, NDIS_802_11_LENGTH_RATES_EX); -+ -+ //clear B mod if current channel is in 5G band, avoid tx cck rate in 5G band. -+ if(pmlmeext->cur_channel > 14) -+ wirelessmode &= ~(WIRELESS_11B); -+ -+ if ((wirelessmode & WIRELESS_11B) && (wirelessmode == WIRELESS_11B)) { -+ _rtw_memcpy(supported_rates, rtw_basic_rate_cck, 4); -+ } else if (wirelessmode & WIRELESS_11B) { -+ _rtw_memcpy(supported_rates, rtw_basic_rate_mix, 7); -+ } else { -+ _rtw_memcpy(supported_rates, rtw_basic_rate_ofdm, 3); -+ } -+ -+ if (wirelessmode & WIRELESS_11B) -+ update_mgnt_tx_rate(padapter, IEEE80211_CCK_RATE_1MB); -+ else -+ update_mgnt_tx_rate(padapter, IEEE80211_OFDM_RATE_6MB); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, supported_rates); -+} -+ -+unsigned char check_assoc_AP(u8 *pframe, uint len) -+{ -+ unsigned int i; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ -+ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < len;) -+ { -+ pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + i); -+ -+ switch (pIE->ElementID) -+ { -+ case _VENDOR_SPECIFIC_IE_: -+ if ((_rtw_memcmp(pIE->data, ARTHEROS_OUI1, 3)) || (_rtw_memcmp(pIE->data, ARTHEROS_OUI2, 3))) -+ { -+ DBG_871X("link to Artheros AP\n"); -+ return HT_IOT_PEER_ATHEROS; -+ } -+ else if ((_rtw_memcmp(pIE->data, BROADCOM_OUI1, 3)) -+ || (_rtw_memcmp(pIE->data, BROADCOM_OUI2, 3)) -+ || (_rtw_memcmp(pIE->data, BROADCOM_OUI2, 3))) -+ { -+ DBG_871X("link to Broadcom AP\n"); -+ return HT_IOT_PEER_BROADCOM; -+ } -+ else if (_rtw_memcmp(pIE->data, MARVELL_OUI, 3)) -+ { -+ DBG_871X("link to Marvell AP\n"); -+ return HT_IOT_PEER_MARVELL; -+ } -+ else if (_rtw_memcmp(pIE->data, RALINK_OUI, 3)) -+ { -+ DBG_871X("link to Ralink AP\n"); -+ return HT_IOT_PEER_RALINK; -+ } -+ else if (_rtw_memcmp(pIE->data, CISCO_OUI, 3)) -+ { -+ DBG_871X("link to Cisco AP\n"); -+ return HT_IOT_PEER_CISCO; -+ } -+ else if (_rtw_memcmp(pIE->data, REALTEK_OUI, 3)) -+ { -+ u32 Vender = HT_IOT_PEER_REALTEK; -+ -+ if(pIE->Length >= 5) { -+ if(pIE->data[4]==1) -+ { -+ //if(pIE->data[5] & RT_HT_CAP_USE_LONG_PREAMBLE) -+ // bssDesc->BssHT.RT2RT_HT_Mode |= RT_HT_CAP_USE_LONG_PREAMBLE; -+ -+ if(pIE->data[5] & RT_HT_CAP_USE_92SE) -+ { -+ //bssDesc->BssHT.RT2RT_HT_Mode |= RT_HT_CAP_USE_92SE; -+ Vender = HT_IOT_PEER_REALTEK_92SE; -+ } -+ } -+ -+ if(pIE->data[5] & RT_HT_CAP_USE_SOFTAP) -+ Vender = HT_IOT_PEER_REALTEK_SOFTAP; -+ -+ if(pIE->data[4] == 2) -+ { -+ if(pIE->data[6] & RT_HT_CAP_USE_JAGUAR_BCUT) { -+ Vender = HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP; -+ DBG_871X("link to Realtek JAGUAR_BCUTAP\n"); -+ } -+ if(pIE->data[6] & RT_HT_CAP_USE_JAGUAR_CCUT) { -+ Vender = HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP; -+ DBG_871X("link to Realtek JAGUAR_CCUTAP\n"); -+ } -+ } -+ } -+ -+ DBG_871X("link to Realtek AP\n"); -+ return Vender; -+ } -+ else if (_rtw_memcmp(pIE->data, AIRGOCAP_OUI,3)) -+ { -+ DBG_871X("link to Airgo Cap\n"); -+ return HT_IOT_PEER_AIRGO; -+ } -+ else -+ { -+ break; -+ } -+ -+ default: -+ break; -+ } -+ -+ i += (pIE->Length + 2); -+ } -+ -+ DBG_871X("link to new AP\n"); -+ return HT_IOT_PEER_UNKNOWN; -+} -+ -+void update_IOT_info(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ switch (pmlmeinfo->assoc_AP_vendor) -+ { -+ case HT_IOT_PEER_MARVELL: -+ pmlmeinfo->turboMode_cts2self = 1; -+ pmlmeinfo->turboMode_rtsen = 0; -+ break; -+ -+ case HT_IOT_PEER_RALINK: -+ pmlmeinfo->turboMode_cts2self = 0; -+ pmlmeinfo->turboMode_rtsen = 1; -+ //disable high power -+ Switch_DM_Func(padapter, (~DYNAMIC_BB_DYNAMIC_TXPWR), false); -+ break; -+ case HT_IOT_PEER_REALTEK: -+ //rtw_write16(padapter, 0x4cc, 0xffff); -+ //rtw_write16(padapter, 0x546, 0x01c0); -+ //disable high power -+ Switch_DM_Func(padapter, (~DYNAMIC_BB_DYNAMIC_TXPWR), false); -+ break; -+ default: -+ pmlmeinfo->turboMode_cts2self = 0; -+ pmlmeinfo->turboMode_rtsen = 1; -+ break; -+ } -+ -+} -+ -+void update_capinfo(PADAPTER Adapter, u16 updateCap) -+{ -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ bool ShortPreamble; -+ -+ // Check preamble mode, 2005.01.06, by rcnjko. -+ // Mark to update preamble value forever, 2008.03.18 by lanhsin -+ //if( pMgntInfo->RegPreambleMode == PREAMBLE_AUTO ) -+ { -+ -+ if(updateCap & cShortPreamble) -+ { // Short Preamble -+ if(pmlmeinfo->preamble_mode != PREAMBLE_SHORT) // PREAMBLE_LONG or PREAMBLE_AUTO -+ { -+ ShortPreamble = true; -+ pmlmeinfo->preamble_mode = PREAMBLE_SHORT; -+ rtw_hal_set_hwreg( Adapter, HW_VAR_ACK_PREAMBLE, (u8 *)&ShortPreamble ); -+ } -+ } -+ else -+ { // Long Preamble -+ if(pmlmeinfo->preamble_mode != PREAMBLE_LONG) // PREAMBLE_SHORT or PREAMBLE_AUTO -+ { -+ ShortPreamble = false; -+ pmlmeinfo->preamble_mode = PREAMBLE_LONG; -+ rtw_hal_set_hwreg( Adapter, HW_VAR_ACK_PREAMBLE, (u8 *)&ShortPreamble ); -+ } -+ } -+ } -+ -+ if ( updateCap & cIBSS ) { -+ //Filen: See 802.11-2007 p.91 -+ pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; -+ } -+ else -+ { -+ //Filen: See 802.11-2007 p.90 -+ if( pmlmeext->cur_wireless_mode & (WIRELESS_11G)) -+ { -+ if( (updateCap & cShortSlotTime) /* && (!(pMgntInfo->pHTInfo->RT2RT_HT_Mode & RT_HT_CAP_USE_LONG_PREAMBLE)) */) -+ { // Short Slot Time -+ pmlmeinfo->slotTime = SHORT_SLOT_TIME; -+ } -+ else -+ { // Long Slot Time -+ pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; -+ } -+ } -+ else if( pmlmeext->cur_wireless_mode & (WIRELESS_11_24N | WIRELESS_11A | WIRELESS_11_5N | WIRELESS_11AC)) -+ { -+ pmlmeinfo->slotTime = SHORT_SLOT_TIME; -+ } -+ else -+ { -+ //B Mode -+ pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME; -+ } -+ } -+ -+ rtw_hal_set_hwreg( Adapter, HW_VAR_SLOT_TIME, &pmlmeinfo->slotTime ); -+ -+} -+ -+void update_wireless_mode(_adapter *padapter) -+{ -+ int ratelen, network_type = 0; -+ u32 SIFS_Timer; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ unsigned char *rate = cur_network->SupportedRates; -+ -+ ratelen = rtw_get_rateset_len(cur_network->SupportedRates); -+ -+ if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable)) -+ { -+ pmlmeinfo->HT_enable = 1; -+ } -+ -+ if(pmlmeext->cur_channel > 14) -+ { -+ if (pmlmeinfo->VHT_enable) -+ network_type = WIRELESS_11AC; -+ else if (pmlmeinfo->HT_enable) -+ network_type = WIRELESS_11_5N; -+ -+ network_type |= WIRELESS_11A; -+ } -+ else -+ { -+ if (pmlmeinfo->VHT_enable) -+ network_type = WIRELESS_11AC; -+ else if (pmlmeinfo->HT_enable) -+ network_type = WIRELESS_11_24N; -+ -+ if ((cckratesonly_included(rate, ratelen)) == true) -+ { -+ network_type |= WIRELESS_11B; -+ } -+ else if((cckrates_included(rate, ratelen)) == true) -+ { -+ network_type |= WIRELESS_11BG; -+ } -+ else -+ { -+ network_type |= WIRELESS_11G; -+ } -+ } -+ -+ pmlmeext->cur_wireless_mode = network_type & padapter->registrypriv.wireless_mode; -+/* -+ if((pmlmeext->cur_wireless_mode==WIRELESS_11G) || -+ (pmlmeext->cur_wireless_mode==WIRELESS_11BG))//WIRELESS_MODE_G) -+ SIFS_Timer = 0x0a0a;//CCK -+ else -+ SIFS_Timer = 0x0e0e;//pHalData->SifsTime; //OFDM -+*/ -+ -+ SIFS_Timer = 0x0a0a0808; //0x0808 -> for CCK, 0x0a0a -> for OFDM -+ //change this value if having IOT issues. -+ -+ padapter->HalFunc.SetHwRegHandler( padapter, HW_VAR_RESP_SIFS, (u8 *)&SIFS_Timer); -+ -+ padapter->HalFunc.SetHwRegHandler( padapter, HW_VAR_WIRELESS_MODE, (u8 *)&(pmlmeext->cur_wireless_mode)); -+ -+ if (pmlmeext->cur_wireless_mode & WIRELESS_11B) -+ update_mgnt_tx_rate(padapter, IEEE80211_CCK_RATE_1MB); -+ else -+ update_mgnt_tx_rate(padapter, IEEE80211_OFDM_RATE_6MB); -+} -+ -+void fire_write_MAC_cmd(_adapter *padapter, unsigned int addr, unsigned int value); -+void fire_write_MAC_cmd(_adapter *padapter, unsigned int addr, unsigned int value) -+{ -+#if 0 -+ struct cmd_obj *ph2c; -+ struct reg_rw_parm *pwriteMacPara; -+ struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); -+ -+ if ((ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj))) == NULL) -+ { -+ return; -+ } -+ -+ if ((pwriteMacPara = (struct reg_rw_parm*)rtw_malloc(sizeof(struct reg_rw_parm))) == NULL) -+ { -+ rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); -+ return; -+ } -+ -+ pwriteMacPara->rw = 1; -+ pwriteMacPara->addr = addr; -+ pwriteMacPara->value = value; -+ -+ init_h2fwcmd_w_parm_no_rsp(ph2c, pwriteMacPara, GEN_CMD_CODE(_Write_MACREG)); -+ rtw_enqueue_cmd(pcmdpriv, ph2c); -+#endif -+} -+ -+void update_bmc_sta_support_rate(_adapter *padapter, u32 mac_id) -+{ -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if(pmlmeext->cur_wireless_mode & WIRELESS_11B) -+ { -+ // Only B, B/G, and B/G/N AP could use CCK rate -+ _rtw_memcpy((pmlmeinfo->FW_sta_info[mac_id].SupportedRates), rtw_basic_rate_cck, 4); -+ } -+ else -+ { -+ _rtw_memcpy((pmlmeinfo->FW_sta_info[mac_id].SupportedRates), rtw_basic_rate_ofdm, 4); -+ } -+} -+ -+int update_sta_support_rate(_adapter *padapter, u8* pvar_ie, uint var_ie_len, int cam_idx) -+{ -+ unsigned int ie_len; -+ PNDIS_802_11_VARIABLE_IEs pIE; -+ int supportRateNum = 0; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ pIE = (PNDIS_802_11_VARIABLE_IEs)rtw_get_ie(pvar_ie, _SUPPORTEDRATES_IE_, &ie_len, var_ie_len); -+ if (pIE == NULL) -+ { -+ return _FAIL; -+ } -+ -+ _rtw_memcpy(pmlmeinfo->FW_sta_info[cam_idx].SupportedRates, pIE->data, ie_len); -+ supportRateNum = ie_len; -+ -+ pIE = (PNDIS_802_11_VARIABLE_IEs)rtw_get_ie(pvar_ie, _EXT_SUPPORTEDRATES_IE_, &ie_len, var_ie_len); -+ if (pIE) -+ { -+ _rtw_memcpy((pmlmeinfo->FW_sta_info[cam_idx].SupportedRates + supportRateNum), pIE->data, ie_len); -+ } -+ -+ return _SUCCESS; -+ -+} -+ -+void process_addba_req(_adapter *padapter, u8 *paddba_req, u8 *addr) -+{ -+ struct sta_info *psta; -+ u16 tid, start_seq, param; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct ADDBA_request *preq = (struct ADDBA_request*)paddba_req; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ psta = rtw_get_stainfo(pstapriv, addr); -+ -+ if(psta) -+ { -+ start_seq = le16_to_cpu(preq->BA_starting_seqctrl) >> 4; -+ -+ param = le16_to_cpu(preq->BA_para_set); -+ tid = (param>>2)&0x0f; -+ -+ preorder_ctrl = &psta->recvreorder_ctrl[tid]; -+ -+ #ifdef CONFIG_UPDATE_INDICATE_SEQ_WHILE_PROCESS_ADDBA_REQ -+ preorder_ctrl->indicate_seq = start_seq; -+ #ifdef DBG_RX_SEQ -+ DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d, start_seq: %d\n", __FUNCTION__, __LINE__, -+ preorder_ctrl->indicate_seq, start_seq); -+ #endif -+ #else -+ preorder_ctrl->indicate_seq = 0xffff; -+ #endif -+ -+ preorder_ctrl->enable =(pmlmeinfo->bAcceptAddbaReq == true)? true :false; -+ } -+ -+} -+ -+void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len) -+{ -+ u8* pIE; -+ __le32 *pbuf; -+ -+ pIE = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); -+ pbuf = ((__le32*)pIE); -+ -+ pmlmeext->TSFValue = le32_to_cpu(*(pbuf+1)); -+ -+ pmlmeext->TSFValue = pmlmeext->TSFValue << 32; -+ -+ pmlmeext->TSFValue |= le32_to_cpu(*pbuf); -+} -+ -+void correct_TSF(_adapter *padapter, struct mlme_ext_priv *pmlmeext) -+{ -+ rtw_hal_set_hwreg(padapter, HW_VAR_CORRECT_TSF, NULL); -+} -+ -+void beacon_timing_control(_adapter *padapter) -+{ -+ rtw_hal_bcn_related_reg_setting(padapter); -+} -+ -+uint rtw_get_camid(uint macid) -+{ -+ uint camid; -+ -+ //camid 0, 1, 2, 3 is default entry for default key/group key -+ //macid = 1 is for bc/mc stainfo, no mapping to camid -+ //macid = 0 mapping to camid 4 -+ //for macid >=2, camid = macid+3; -+ -+ if(macid==0) -+ camid = 4; -+ else if(macid >=2) -+ camid = macid + 3; -+ else -+ camid = 4; -+ -+ return camid; -+} -+ -+void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta) -+{ -+ int i; -+ _irqL irqL; -+ u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ -+ -+ if(_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) -+ return; -+ -+ if(_rtw_memcmp(psta->hwaddr, myid(&padapter->eeprompriv), ETH_ALEN)) -+ { -+ psta->mac_id = NUM_STA; -+ return; -+ } -+ -+ _enter_critical_bh(&pdvobj->lock, &irqL); -+ for(i=0; imacid[i] == false) -+ { -+ pdvobj->macid[i] = true; -+ break; -+ } -+ } -+ _exit_critical_bh(&pdvobj->lock, &irqL); -+ -+ if( i > (NUM_STA-1)) -+ { -+ psta->mac_id = NUM_STA; -+ DBG_871X(" no room for more MACIDs\n"); -+ } -+ else -+ { -+ psta->mac_id = i; -+ DBG_871X("%s = %d\n", __FUNCTION__, psta->mac_id); -+ } -+ -+} -+ -+void rtw_release_macid(_adapter *padapter, struct sta_info *psta) -+{ -+ int i; -+ _irqL irqL; -+ u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff}; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ -+ -+ if(_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) -+ return; -+ -+ if(_rtw_memcmp(psta->hwaddr, myid(&padapter->eeprompriv), ETH_ALEN)) -+ { -+ return; -+ } -+ -+ _enter_critical_bh(&pdvobj->lock, &irqL); -+ if(psta->mac_idmac_id !=1 ) -+ { -+ if(pdvobj->macid[psta->mac_id] == true) -+ { -+ DBG_871X("%s = %d\n", __FUNCTION__, psta->mac_id); -+ pdvobj->macid[psta->mac_id] = false; -+ psta->mac_id = NUM_STA; -+ } -+ -+ } -+ _exit_critical_bh(&pdvobj->lock, &irqL); -+ -+} -+ -+#if 0 -+unsigned int setup_beacon_frame(_adapter *padapter, unsigned char *beacon_frame) -+{ -+ unsigned short ATIMWindow; -+ unsigned char *pframe; -+ struct tx_desc *ptxdesc; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ unsigned int rate_len, len = 0; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ _rtw_memset(beacon_frame, 0, 256); -+ -+ pframe = beacon_frame + TXDESC_SIZE; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ -+ SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ len = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ //timestamp will be inserted by hardware -+ pframe += 8; -+ len += 8; -+ -+ // beacon interval: 2 bytes -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ len += 2; -+ -+ // capability info: 2 bytes -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ len += 2; -+ -+ // SSID -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &len); -+ -+ // supported rates... -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8)? 8: rate_len), cur_network->SupportedRates, &len); -+ -+ // DS parameter set -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &len); -+ -+ // IBSS Parameter Set... -+ //ATIMWindow = cur->Configuration.ATIMWindow; -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &len); -+ -+ //todo: ERP IE -+ -+ // EXTERNDED SUPPORTED RATE -+ if (rate_len > 8) -+ { -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &len); -+ } -+ -+ if ((len + TXDESC_SIZE) > 256) -+ { -+ //DBG_871X("marc: beacon frame too large\n"); -+ return 0; -+ } -+ -+ //fill the tx descriptor -+ ptxdesc = (struct tx_desc *)beacon_frame; -+ -+ //offset 0 -+ ptxdesc->txdw0 |= cpu_to_le32(len & 0x0000ffff); -+ ptxdesc->txdw0 |= cpu_to_le32(((TXDESC_SIZE + OFFSET_SZ) << OFFSET_SHT) & 0x00ff0000); //default = 32 bytes for TX Desc -+ -+ //offset 4 -+ ptxdesc->txdw1 |= cpu_to_le32((0x10 << QSEL_SHT) & 0x00001f00); -+ -+ //offset 8 -+ ptxdesc->txdw2 |= cpu_to_le32(BMC); -+ ptxdesc->txdw2 |= cpu_to_le32(BK); -+ -+ //offset 16 -+ ptxdesc->txdw4 = 0x80000000; -+ -+ //offset 20 -+ ptxdesc->txdw5 = 0x00000000; //1M -+ -+ return (len + TXDESC_SIZE); -+} -+#endif -+ -+static _adapter *pbuddy_padapter = NULL; -+ -+int rtw_handle_dualmac(_adapter *adapter, bool init) -+{ -+ int status = _SUCCESS; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); -+ -+ if(adapter->chip_type != RTL8192D) -+ goto exit; -+ -+ if (init) { -+ #if 0 -+ /* For SMSP on 92DU-VC, driver do not probe another Interface. */ -+ if(dvobj->NumInterfaces == 2 && dvobj->InterfaceNumber != 0 && -+ adapter->registrypriv.mac_phy_mode == 1) { -+ DBG_871X("%s(): Do not init another USB Interface because SMSP\n",__FUNCTION__); -+ status = _FAIL; -+ goto exit; -+ } -+ #endif -+ -+ if (pbuddy_padapter == NULL) { -+ pbuddy_padapter = adapter; -+ DBG_871X("%s(): pbuddy_padapter == NULL, Set pbuddy_padapter\n",__FUNCTION__); -+ } else { -+ adapter->pbuddy_adapter = pbuddy_padapter; -+ pbuddy_padapter->pbuddy_adapter = adapter; -+ // clear global value -+ pbuddy_padapter = NULL; -+ DBG_871X("%s(): pbuddy_padapter exist, Exchange Information\n",__FUNCTION__); -+ } -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ if (dvobj->InterfaceNumber == 0) { -+ //set adapter_type/iface type -+ adapter->isprimary = true; -+ adapter->adapter_type = PRIMARY_ADAPTER; -+ adapter->iface_type = IFACE_PORT0; -+ DBG_871X("%s(): PRIMARY_ADAPTER\n",__FUNCTION__); -+ } else { -+ //set adapter_type/iface type -+ adapter->isprimary = false; -+ adapter->adapter_type = SECONDARY_ADAPTER; -+ adapter->iface_type = IFACE_PORT1; -+ DBG_871X("%s(): SECONDARY_ADAPTER\n",__FUNCTION__); -+ } -+#endif -+ }else { -+ pbuddy_padapter = NULL; -+ } -+exit: -+ return status; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/core/rtw_xmit.c linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_xmit.c ---- linux-4.14.17/3rdparty/rtl8812au/core/rtw_xmit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/core/rtw_xmit.c 2018-02-06 17:42:30.701967031 +0200 -@@ -0,0 +1,4131 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTW_XMIT_C_ -+ -+#include -+ -+static u8 P802_1H_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0xf8 }; -+static u8 RFC1042_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0x00 }; -+ -+static void _init_txservq(struct tx_servq *ptxservq) -+{ -+ -+ _rtw_init_listhead(&ptxservq->tx_pending); -+ _rtw_init_queue(&ptxservq->sta_pending); -+ ptxservq->qcnt = 0; -+} -+ -+void _rtw_init_sta_xmit_priv(struct sta_xmit_priv *psta_xmitpriv) -+{ -+ _rtw_memset((unsigned char *)psta_xmitpriv, 0, sizeof (struct sta_xmit_priv)); -+ -+ _rtw_spinlock_init(&psta_xmitpriv->lock); -+ -+ _init_txservq(&psta_xmitpriv->be_q); -+ _init_txservq(&psta_xmitpriv->bk_q); -+ _init_txservq(&psta_xmitpriv->vi_q); -+ _init_txservq(&psta_xmitpriv->vo_q); -+ _rtw_init_listhead(&psta_xmitpriv->legacy_dz); -+ _rtw_init_listhead(&psta_xmitpriv->apsd); -+ -+ -+ -+} -+ -+s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, _adapter *padapter) -+{ -+ int i; -+ struct xmit_buf *pxmitbuf; -+ struct xmit_frame *pxframe; -+ sint res=_SUCCESS; -+ u32 max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; -+ u32 num_xmit_extbuf = NR_XMIT_EXTBUFF; -+ -+ -+ -+ // We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). -+ //_rtw_memset((unsigned char *)pxmitpriv, 0, sizeof(struct xmit_priv)); -+ -+ _rtw_spinlock_init(&pxmitpriv->lock); -+ _rtw_spinlock_init(&pxmitpriv->lock_sctx); -+ _rtw_init_sema(&pxmitpriv->xmit_sema, 0); -+ _rtw_init_sema(&pxmitpriv->terminate_xmitthread_sema, 0); -+ -+ /* -+ Please insert all the queue initializaiton using _rtw_init_queue below -+ */ -+ -+ pxmitpriv->adapter = padapter; -+ -+ //for(i = 0 ; i < MAX_NUMBLKS; i++) -+ // _rtw_init_queue(&pxmitpriv->blk_strms[i]); -+ -+ _rtw_init_queue(&pxmitpriv->be_pending); -+ _rtw_init_queue(&pxmitpriv->bk_pending); -+ _rtw_init_queue(&pxmitpriv->vi_pending); -+ _rtw_init_queue(&pxmitpriv->vo_pending); -+ _rtw_init_queue(&pxmitpriv->bm_pending); -+ -+ //_rtw_init_queue(&pxmitpriv->legacy_dz_queue); -+ //_rtw_init_queue(&pxmitpriv->apsd_queue); -+ -+ _rtw_init_queue(&pxmitpriv->free_xmit_queue); -+ -+ /* -+ Please allocate memory with the sz = (struct xmit_frame) * NR_XMITFRAME, -+ and initialize free_xmit_frame below. -+ Please also apply free_txobj to link_up all the xmit_frames... -+ */ -+ -+ pxmitpriv->pallocated_frame_buf = rtw_zvmalloc(NR_XMITFRAME * sizeof(struct xmit_frame) + 4); -+ -+ if (pxmitpriv->pallocated_frame_buf == NULL){ -+ pxmitpriv->pxmit_frame_buf =NULL; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("alloc xmit_frame fail!\n")); -+ res= _FAIL; -+ goto exit; -+ } -+ pxmitpriv->pxmit_frame_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_frame_buf), 4); -+ //pxmitpriv->pxmit_frame_buf = pxmitpriv->pallocated_frame_buf + 4 - -+ // ((SIZE_PTR) (pxmitpriv->pallocated_frame_buf) &3); -+ -+ pxframe = (struct xmit_frame*) pxmitpriv->pxmit_frame_buf; -+ -+ for (i = 0; i < NR_XMITFRAME; i++) -+ { -+ _rtw_init_listhead(&(pxframe->list)); -+ -+ pxframe->padapter = padapter; -+ pxframe->frame_tag = NULL_FRAMETAG; -+ -+ pxframe->pkt = NULL; -+ -+ pxframe->buf_addr = NULL; -+ pxframe->pxmitbuf = NULL; -+ -+ rtw_list_insert_tail(&(pxframe->list), &(pxmitpriv->free_xmit_queue.queue)); -+ -+ pxframe++; -+ } -+ -+ pxmitpriv->free_xmitframe_cnt = NR_XMITFRAME; -+ -+ pxmitpriv->frag_len = MAX_FRAG_THRESHOLD; -+ -+ -+ //init xmit_buf -+ _rtw_init_queue(&pxmitpriv->free_xmitbuf_queue); -+ _rtw_init_queue(&pxmitpriv->pending_xmitbuf_queue); -+ -+ pxmitpriv->pallocated_xmitbuf = rtw_zvmalloc(NR_XMITBUFF * sizeof(struct xmit_buf) + 4); -+ -+ if (pxmitpriv->pallocated_xmitbuf == NULL){ -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("alloc xmit_buf fail!\n")); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pxmitpriv->pxmitbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_xmitbuf), 4); -+ //pxmitpriv->pxmitbuf = pxmitpriv->pallocated_xmitbuf + 4 - -+ // ((SIZE_PTR) (pxmitpriv->pallocated_xmitbuf) &3); -+ -+ pxmitbuf = (struct xmit_buf*)pxmitpriv->pxmitbuf; -+ -+ for (i = 0; i < NR_XMITBUFF; i++) -+ { -+ _rtw_init_listhead(&pxmitbuf->list); -+ -+ pxmitbuf->priv_data = NULL; -+ pxmitbuf->padapter = padapter; -+ pxmitbuf->buf_tag = XMITBUF_DATA; -+ -+ /* Tx buf allocation may fail sometimes, so sleep and retry. */ -+ if((res=rtw_os_xmit_resource_alloc(padapter, pxmitbuf,(MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), true)) == _FAIL) { -+ rtw_msleep_os(10); -+ res = rtw_os_xmit_resource_alloc(padapter, pxmitbuf,(MAX_XMITBUF_SZ + XMITBUF_ALIGN_SZ), true); -+ if (res == _FAIL) { -+ goto exit; -+ } -+ } -+ -+ pxmitbuf->flags = XMIT_VO_QUEUE; -+ -+ rtw_list_insert_tail(&pxmitbuf->list, &(pxmitpriv->free_xmitbuf_queue.queue)); -+ #ifdef DBG_XMIT_BUF -+ pxmitbuf->no=i; -+ #endif -+ -+ pxmitbuf++; -+ -+ } -+ -+ pxmitpriv->free_xmitbuf_cnt = NR_XMITBUFF; -+ -+ /* init xframe_ext queue, the same count as extbuf */ -+ _rtw_init_queue(&pxmitpriv->free_xframe_ext_queue); -+ -+ pxmitpriv->xframe_ext_alloc_addr = rtw_zvmalloc(num_xmit_extbuf * sizeof(struct xmit_frame) + 4); -+ -+ if (pxmitpriv->xframe_ext_alloc_addr == NULL){ -+ pxmitpriv->xframe_ext = NULL; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("alloc xframe_ext fail!\n")); -+ res= _FAIL; -+ goto exit; -+ } -+ pxmitpriv->xframe_ext = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->xframe_ext_alloc_addr), 4); -+ pxframe = (struct xmit_frame*)pxmitpriv->xframe_ext; -+ -+ for (i = 0; i < num_xmit_extbuf; i++) { -+ _rtw_init_listhead(&(pxframe->list)); -+ -+ pxframe->padapter = padapter; -+ pxframe->frame_tag = NULL_FRAMETAG; -+ -+ pxframe->pkt = NULL; -+ -+ pxframe->buf_addr = NULL; -+ pxframe->pxmitbuf = NULL; -+ -+ pxframe->ext_tag = 1; -+ -+ rtw_list_insert_tail(&(pxframe->list), &(pxmitpriv->free_xframe_ext_queue.queue)); -+ -+ pxframe++; -+ } -+ pxmitpriv->free_xframe_ext_cnt = num_xmit_extbuf; -+ -+ // Init xmit extension buff -+ _rtw_init_queue(&pxmitpriv->free_xmit_extbuf_queue); -+ -+ pxmitpriv->pallocated_xmit_extbuf = rtw_zvmalloc(num_xmit_extbuf * sizeof(struct xmit_buf) + 4); -+ -+ if (pxmitpriv->pallocated_xmit_extbuf == NULL){ -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("alloc xmit_extbuf fail!\n")); -+ res= _FAIL; -+ goto exit; -+ } -+ -+ pxmitpriv->pxmit_extbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitpriv->pallocated_xmit_extbuf), 4); -+ -+ pxmitbuf = (struct xmit_buf*)pxmitpriv->pxmit_extbuf; -+ -+ for (i = 0; i < num_xmit_extbuf; i++) -+ { -+ _rtw_init_listhead(&pxmitbuf->list); -+ -+ pxmitbuf->priv_data = NULL; -+ pxmitbuf->padapter = padapter; -+ pxmitbuf->buf_tag = XMITBUF_MGNT; -+ -+ if((res=rtw_os_xmit_resource_alloc(padapter, pxmitbuf,max_xmit_extbuf_size + XMITBUF_ALIGN_SZ, true)) == _FAIL) { -+ res= _FAIL; -+ goto exit; -+ } -+ -+ rtw_list_insert_tail(&pxmitbuf->list, &(pxmitpriv->free_xmit_extbuf_queue.queue)); -+ #ifdef DBG_XMIT_BUF_EXT -+ pxmitbuf->no=i; -+ #endif -+ pxmitbuf++; -+ -+ } -+ -+ pxmitpriv->free_xmit_extbuf_cnt = num_xmit_extbuf; -+ -+ -+ pxmitbuf = &pxmitpriv->pcmd_xmitbuf; -+ if (pxmitbuf) { -+ _rtw_init_listhead(&pxmitbuf->list); -+ -+ pxmitbuf->priv_data = NULL; -+ pxmitbuf->padapter = padapter; -+ pxmitbuf->buf_tag = XMITBUF_CMD; -+ -+ if((res=rtw_os_xmit_resource_alloc(padapter, pxmitbuf, 0, true)) == _FAIL) { -+ res= _FAIL; -+ goto exit; -+ } -+ } -+ -+ rtw_alloc_hwxmits(padapter); -+ rtw_init_hwxmits(pxmitpriv->hwxmits, pxmitpriv->hwxmit_entry); -+ -+ for (i = 0; i < 4; i ++) -+ { -+ pxmitpriv->wmm_para_seq[i] = i; -+ } -+ -+ pxmitpriv->txirp_cnt=1; -+ -+ _rtw_init_sema(&(pxmitpriv->tx_retevt), 0); -+ -+ //per AC pending irp -+ pxmitpriv->beq_cnt = 0; -+ pxmitpriv->bkq_cnt = 0; -+ pxmitpriv->viq_cnt = 0; -+ pxmitpriv->voq_cnt = 0; -+ -+ -+#ifdef CONFIG_XMIT_ACK -+ pxmitpriv->ack_tx = false; -+ _rtw_mutex_init(&pxmitpriv->ack_tx_mutex); -+ rtw_sctx_init(&pxmitpriv->ack_tx_ops, 0); -+#endif -+ -+ rtw_hal_init_xmit_priv(padapter); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+void rtw_mfree_xmit_priv_lock (struct xmit_priv *pxmitpriv); -+void rtw_mfree_xmit_priv_lock (struct xmit_priv *pxmitpriv) -+{ -+ _rtw_spinlock_free(&pxmitpriv->lock); -+ _rtw_free_sema(&pxmitpriv->xmit_sema); -+ _rtw_free_sema(&pxmitpriv->terminate_xmitthread_sema); -+ -+ _rtw_spinlock_free(&pxmitpriv->be_pending.lock); -+ _rtw_spinlock_free(&pxmitpriv->bk_pending.lock); -+ _rtw_spinlock_free(&pxmitpriv->vi_pending.lock); -+ _rtw_spinlock_free(&pxmitpriv->vo_pending.lock); -+ _rtw_spinlock_free(&pxmitpriv->bm_pending.lock); -+ -+ //_rtw_spinlock_free(&pxmitpriv->legacy_dz_queue.lock); -+ //_rtw_spinlock_free(&pxmitpriv->apsd_queue.lock); -+ -+ _rtw_spinlock_free(&pxmitpriv->free_xmit_queue.lock); -+ _rtw_spinlock_free(&pxmitpriv->free_xmitbuf_queue.lock); -+ _rtw_spinlock_free(&pxmitpriv->pending_xmitbuf_queue.lock); -+} -+ -+ -+void _rtw_free_xmit_priv (struct xmit_priv *pxmitpriv) -+{ -+ int i; -+ _adapter *padapter = pxmitpriv->adapter; -+ struct xmit_frame *pxmitframe = (struct xmit_frame*) pxmitpriv->pxmit_frame_buf; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf; -+ u32 max_xmit_extbuf_size = MAX_XMIT_EXTBUF_SZ; -+ u32 num_xmit_extbuf = NR_XMIT_EXTBUFF; -+ -+ rtw_hal_free_xmit_priv(padapter); -+ -+ rtw_mfree_xmit_priv_lock(pxmitpriv); -+ -+ if(pxmitpriv->pxmit_frame_buf==NULL) -+ return; -+ -+ for(i=0; ipallocated_frame_buf) { -+ rtw_vmfree(pxmitpriv->pallocated_frame_buf, NR_XMITFRAME * sizeof(struct xmit_frame) + 4); -+ } -+ -+ -+ if(pxmitpriv->pallocated_xmitbuf) { -+ rtw_vmfree(pxmitpriv->pallocated_xmitbuf, NR_XMITBUFF * sizeof(struct xmit_buf) + 4); -+ } -+ -+ /* free xframe_ext queue, the same count as extbuf */ -+ if ((pxmitframe = (struct xmit_frame*)pxmitpriv->xframe_ext)) { -+ for (i=0; ixframe_ext_alloc_addr) -+ rtw_vmfree(pxmitpriv->xframe_ext_alloc_addr, num_xmit_extbuf * sizeof(struct xmit_frame) + 4); -+ _rtw_spinlock_free(&pxmitpriv->free_xframe_ext_queue.lock); -+ -+ // free xmit extension buff -+ _rtw_spinlock_free(&pxmitpriv->free_xmit_extbuf_queue.lock); -+ -+ pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmit_extbuf; -+ for(i=0; ipallocated_xmit_extbuf) { -+ rtw_vmfree(pxmitpriv->pallocated_xmit_extbuf, num_xmit_extbuf * sizeof(struct xmit_buf) + 4); -+ } -+ -+ pxmitbuf = &pxmitpriv->pcmd_xmitbuf; -+ rtw_os_xmit_resource_free(padapter, pxmitbuf, 0, true); -+ -+ rtw_free_hwxmits(padapter); -+ -+#ifdef CONFIG_XMIT_ACK -+ _rtw_mutex_free(&pxmitpriv->ack_tx_mutex); -+#endif -+} -+ -+static void update_attrib_vcs_info(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ u32 sz; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ //struct sta_info *psta = pattrib->psta; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+/* -+ if(pattrib->psta) -+ { -+ psta = pattrib->psta; -+ } -+ else -+ { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ psta=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0] ); -+ } -+ -+ if(psta==NULL) -+ { -+ DBG_871X("%s, psta==NUL\n", __func__); -+ return; -+ } -+ -+ if(!(psta->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return; -+ } -+*/ -+ -+ if (pattrib->nr_frags != 1) -+ { -+ sz = padapter->xmitpriv.frag_len; -+ } -+ else //no frag -+ { -+ sz = pattrib->last_txcmdsz; -+ } -+ -+ // (1) RTS_Threshold is compared to the MPDU, not MSDU. -+ // (2) If there are more than one frag in this MSDU, only the first frag uses protection frame. -+ // Other fragments are protected by previous fragment. -+ // So we only need to check the length of first fragment. -+ if(pmlmeext->cur_wireless_mode < WIRELESS_11_24N || padapter->registrypriv.wifi_spec) -+ { -+ if(sz > padapter->registrypriv.rts_thresh) -+ { -+ pattrib->vcs_mode = RTS_CTS; -+ } -+ else -+ { -+ if(pattrib->rtsen) -+ pattrib->vcs_mode = RTS_CTS; -+ else if(pattrib->cts2self) -+ pattrib->vcs_mode = CTS_TO_SELF; -+ else -+ pattrib->vcs_mode = NONE_VCS; -+ } -+ } -+ else -+ { -+ while (true) -+ { -+#if 0 //Todo -+ //check IOT action -+ if(pHTInfo->IOTAction & HT_IOT_ACT_FORCED_CTS2SELF) -+ { -+ pattrib->vcs_mode = CTS_TO_SELF; -+ pattrib->rts_rate = MGN_24M; -+ break; -+ } -+ else if(pHTInfo->IOTAction & (HT_IOT_ACT_FORCED_RTS|HT_IOT_ACT_PURE_N_MODE)) -+ { -+ pattrib->vcs_mode = RTS_CTS; -+ pattrib->rts_rate = MGN_24M; -+ break; -+ } -+#endif -+ -+ //IOT action -+ if((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_ATHEROS) && (pattrib->ampdu_en==true) && -+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_ )) -+ { -+ pattrib->vcs_mode = CTS_TO_SELF; -+ break; -+ } -+ -+ -+ //check ERP protection -+ if(pattrib->rtsen || pattrib->cts2self) -+ { -+ if(pattrib->rtsen) -+ pattrib->vcs_mode = RTS_CTS; -+ else if(pattrib->cts2self) -+ pattrib->vcs_mode = CTS_TO_SELF; -+ -+ break; -+ } -+ -+ //check HT op mode -+ if(pattrib->ht_en) -+ { -+ u8 HTOpMode = pmlmeinfo->HT_protection; -+ if((pmlmeext->cur_bwmode && (HTOpMode == 2 || HTOpMode == 3)) || -+ (!pmlmeext->cur_bwmode && HTOpMode == 3) ) -+ { -+ pattrib->vcs_mode = RTS_CTS; -+ break; -+ } -+ } -+ -+ //check rts -+ if(sz > padapter->registrypriv.rts_thresh) -+ { -+ pattrib->vcs_mode = RTS_CTS; -+ break; -+ } -+ -+ //to do list: check MIMO power save condition. -+ -+ //check AMPDU aggregation for TXOP -+ if((pattrib->ampdu_en==true) && (!IS_HARDWARE_TYPE_JAGUAR(padapter))) -+ { -+ pattrib->vcs_mode = RTS_CTS; -+ break; -+ } -+ -+ pattrib->vcs_mode = NONE_VCS; -+ break; -+ } -+ } -+} -+ -+static void update_attrib_phy_info(struct pkt_attrib *pattrib, struct sta_info *psta) -+{ -+ pattrib->rtsen = psta->rtsen; -+ pattrib->cts2self = psta->cts2self; -+ -+ pattrib->mdata = 0; -+ pattrib->eosp = 0; -+ pattrib->triggered=0; -+ -+ //qos_en, ht_en, init rate, ,bw, ch_offset, sgi -+ pattrib->qos_en = psta->qos_option; -+ -+ pattrib->raid = psta->raid; -+#ifdef CONFIG_80211N_HT -+#ifdef CONFIG_80211AC_VHT -+ if (psta->vhtpriv.vht_option) { -+ pattrib->bwmode = psta->vhtpriv.bwmode; -+ pattrib->sgi= psta->vhtpriv.sgi; -+ -+ if(TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX)) -+ pattrib->ldpc = 1; -+ -+ if(TEST_FLAG(psta->vhtpriv.stbc_cap, STBC_VHT_ENABLE_TX)) -+ pattrib->stbc = 1; -+ } -+ else -+#endif //CONFIG_80211AC_VHT -+ { -+ pattrib->bwmode = psta->htpriv.bwmode; -+ pattrib->sgi= psta->htpriv.sgi; -+ } -+ -+ pattrib->ht_en = psta->htpriv.ht_option; -+ pattrib->ch_offset = psta->htpriv.ch_offset; -+ pattrib->ampdu_en = false; -+#endif //CONFIG_80211N_HT -+ //if(pattrib->ht_en && psta->htpriv.ampdu_enable) -+ //{ -+ // if(psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) -+ // pattrib->ampdu_en = true; -+ //} -+ -+ -+ pattrib->retry_ctrl = false; -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ if(psta->isrc && psta->pid>0) -+ pattrib->pctrl = true; -+#endif -+ -+} -+ -+static s32 update_attrib_sec_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) -+{ -+ sint res = _SUCCESS; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ sint bmcast = IS_MCAST(pattrib->ra); -+ -+ _rtw_memset(pattrib->dot118021x_UncstKey.skey, 0, 16); -+ _rtw_memset(pattrib->dot11tkiptxmickey.skey, 0, 16); -+ -+ if (psta->ieee8021x_blocked == true) -+ { -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("\n psta->ieee8021x_blocked == true \n")); -+ -+ pattrib->encrypt = 0; -+ -+ if((pattrib->ether_type != 0x888e) && (check_fwstate(pmlmepriv, WIFI_MP_STATE) == false)) -+ { -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("\npsta->ieee8021x_blocked == true, pattrib->ether_type(%.4x) != 0x888e\n",pattrib->ether_type)); -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s psta->ieee8021x_blocked == true, pattrib->ether_type(%04x) != 0x888e\n", __FUNCTION__,pattrib->ether_type); -+ #endif -+ res = _FAIL; -+ goto exit; -+ } -+ } -+ else -+ { -+ GET_ENCRY_ALGO(psecuritypriv, psta, pattrib->encrypt, bmcast); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(pattrib->ether_type == 0x88B4) -+ pattrib->encrypt=_NO_PRIVACY_; -+#endif -+ -+ switch(psecuritypriv->dot11AuthAlgrthm) -+ { -+ case dot11AuthAlgrthm_Open: -+ case dot11AuthAlgrthm_Shared: -+ case dot11AuthAlgrthm_Auto: -+ pattrib->key_idx = (u8)psecuritypriv->dot11PrivacyKeyIndex; -+ break; -+ case dot11AuthAlgrthm_8021X: -+ if(bmcast) -+ pattrib->key_idx = (u8)psecuritypriv->dot118021XGrpKeyid; -+ else -+ pattrib->key_idx = 0; -+ break; -+ default: -+ pattrib->key_idx = 0; -+ break; -+ } -+ -+ //For WPS 1.0 WEP, driver should not encrypt EAPOL Packet for WPS handshake. -+ if (((pattrib->encrypt ==_WEP40_)||(pattrib->encrypt ==_WEP104_)) && (pattrib->ether_type == 0x888e)) -+ pattrib->encrypt=_NO_PRIVACY_; -+ -+ } -+ -+ switch (pattrib->encrypt) -+ { -+ case _WEP40_: -+ case _WEP104_: -+ pattrib->iv_len = 4; -+ pattrib->icv_len = 4; -+ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ break; -+ -+ case _TKIP_: -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 4; -+ -+ if(psecuritypriv->busetkipkey==_FAIL) -+ { -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s psecuritypriv->busetkipkey(%d)==_FAIL drop packet\n", __FUNCTION__, psecuritypriv->busetkipkey); -+ #endif -+ res =_FAIL; -+ goto exit; -+ } -+ -+ if(bmcast) -+ TKIP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ TKIP_IV(pattrib->iv, psta->dot11txpn, 0); -+ -+ -+ _rtw_memcpy(pattrib->dot11tkiptxmickey.skey, psta->dot11tkiptxmickey.skey, 16); -+ -+ break; -+ -+ case _AES_: -+ -+ pattrib->iv_len = 8; -+ pattrib->icv_len = 8; -+ -+ if(bmcast) -+ AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ AES_IV(pattrib->iv, psta->dot11txpn, 0); -+ -+ break; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ pattrib->iv_len = 18; -+ pattrib->icv_len = 16; -+ rtw_wapi_get_iv(padapter,pattrib->ra,pattrib->iv); -+ break; -+#endif -+ default: -+ pattrib->iv_len = 0; -+ pattrib->icv_len = 0; -+ break; -+ } -+ -+ if(pattrib->encrypt>0) -+ _rtw_memcpy(pattrib->dot118021x_UncstKey.skey, psta->dot118021x_UncstKey.skey, 16); -+ -+exit: -+ -+ return res; -+ -+} -+ -+u8 qos_acm(u8 acm_mask, u8 priority) -+{ -+ u8 change_priority = priority; -+ -+ switch (priority) -+ { -+ case 0: -+ case 3: -+ if(acm_mask & BIT(1)) -+ change_priority = 1; -+ break; -+ case 1: -+ case 2: -+ break; -+ case 4: -+ case 5: -+ if(acm_mask & BIT(2)) -+ change_priority = 0; -+ break; -+ case 6: -+ case 7: -+ if(acm_mask & BIT(3)) -+ change_priority = 5; -+ break; -+ default: -+ DBG_871X("qos_acm(): invalid pattrib->priority: %d!!!\n", priority); -+ break; -+ } -+ -+ return change_priority; -+} -+ -+static void set_qos(struct pkt_file *ppktfile, struct pkt_attrib *pattrib) -+{ -+ struct ethhdr etherhdr; -+ struct iphdr ip_hdr; -+ s32 UserPriority = 0; -+ -+ -+ _rtw_open_pktfile(ppktfile->pkt, ppktfile); -+ _rtw_pktfile_read(ppktfile, (unsigned char*)ðerhdr, ETH_HLEN); -+ -+ // get UserPriority from IP hdr -+ if (pattrib->ether_type == 0x0800) { -+ _rtw_pktfile_read(ppktfile, (u8*)&ip_hdr, sizeof(ip_hdr)); -+// UserPriority = (ntohs(ip_hdr.tos) >> 5) & 0x3; -+ UserPriority = ip_hdr.tos >> 5; -+ } else if (pattrib->ether_type == 0x888e) { -+ // "When priority processing of data frames is supported, -+ // a STA's SME should send EAPOL-Key frames at the highest priority." -+ UserPriority = 7; -+ } -+ -+ pattrib->priority = UserPriority; -+ pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN; -+ pattrib->subtype = WIFI_QOS_DATA_TYPE; -+} -+ -+static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattrib) -+{ -+ uint i; -+ struct pkt_file pktfile; -+ struct sta_info *psta = NULL; -+ struct ethhdr etherhdr; -+ -+ sint bmcast; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv= &pmlmepriv->qospriv; -+ sint res = _SUCCESS; -+ -+ -+ -+ _rtw_open_pktfile(pkt, &pktfile); -+ i = _rtw_pktfile_read(&pktfile, (u8*)ðerhdr, ETH_HLEN); -+ -+ pattrib->ether_type = ntohs(etherhdr.h_proto); -+ -+ -+ _rtw_memcpy(pattrib->dst, ðerhdr.h_dest, ETH_ALEN); -+ _rtw_memcpy(pattrib->src, ðerhdr.h_source, ETH_ALEN); -+ -+ -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) { -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ } -+ else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { -+ _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ } -+ else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, get_bssid(pmlmepriv), ETH_ALEN); -+ } -+ -+ pattrib->pktlen = pktfile.pkt_len; -+ -+ if (ETH_P_IP == pattrib->ether_type) -+ { -+ // The following is for DHCP and ARP packet, we use cck1M to tx these packets and let LPS awake some time -+ // to prevent DHCP protocol fail -+ u8 tmp[24]; -+ _rtw_pktfile_read(&pktfile, &tmp[0], 24); -+ pattrib->dhcp_pkt = 0; -+ if (pktfile.pkt_len > 282) {//MINIMUM_DHCP_PACKET_SIZE) { -+ if (ETH_P_IP == pattrib->ether_type) {// IP header -+ if (((tmp[21] == 68) && (tmp[23] == 67)) || -+ ((tmp[21] == 67) && (tmp[23] == 68))) { -+ // 68 : UDP BOOTP client -+ // 67 : UDP BOOTP server -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("======================update_attrib: get DHCP Packet \n")); -+ // Use low rate to send DHCP packet. -+ //if(pMgntInfo->IOTAction & HT_IOT_ACT_WA_IOT_Broadcom) -+ //{ -+ // tcb_desc->DataRate = MgntQuery_TxRateExcludeCCKRates(ieee);//0xc;//ofdm 6m -+ // tcb_desc->bTxDisableRateFallBack = false; -+ //} -+ //else -+ // pTcb->DataRate = Adapter->MgntInfo.LowestBasicRate; -+ //RTPRINT(FDM, WA_IOT, ("DHCP TranslateHeader(), pTcb->DataRate = 0x%x\n", pTcb->DataRate)); -+ pattrib->dhcp_pkt = 1; -+ } -+ } -+ } -+ } else if (0x888e == pattrib->ether_type) { -+ DBG_871X_LEVEL(_drv_always_, "send eapol packet\n"); -+ } -+ -+ if ( (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1) ) -+ { -+ rtw_set_scan_deny(padapter, 3000); -+ } -+ -+#ifdef CONFIG_LPS -+ // If EAPOL , ARP , OR DHCP packet, driver must be in active mode. -+#ifdef CONFIG_WAPI_SUPPORT -+ if ( (pattrib->ether_type == 0x88B4) || (pattrib->ether_type == 0x0806) || (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1) ) -+#else -+ if ( (pattrib->ether_type == 0x0806) || (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1) ) -+#endif -+ { -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SPECIAL_PACKET, 1); -+ } -+#endif -+ -+ bmcast = IS_MCAST(pattrib->ra); -+ -+ // get sta_info -+ if (bmcast) { -+ psta = rtw_get_bcmc_stainfo(padapter); -+ } else { -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ if (psta == NULL) { // if we cannot get psta => drrp the pkt -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_alert_, ("\nupdate_attrib => get sta_info fail, ra:" MAC_FMT"\n", MAC_ARG(pattrib->ra))); -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s get sta_info fail, ra:" MAC_FMT"\n", __FUNCTION__, MAC_ARG(pattrib->ra)); -+ #endif -+ res =_FAIL; -+ goto exit; -+ } -+ else if((check_fwstate(pmlmepriv, WIFI_AP_STATE)==true)&&(!(psta->state & _FW_LINKED))) -+ { -+ res =_FAIL; -+ goto exit; -+ } -+ } -+ -+ if(psta == NULL) -+ { // if we cannot get psta => drop the pkt -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_alert_, ("\nupdate_attrib => get sta_info fail, ra:" MAC_FMT "\n", MAC_ARG(pattrib->ra))); -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s get sta_info fail, ra:" MAC_FMT"\n", __FUNCTION__, MAC_ARG(pattrib->ra)); -+ #endif -+ res = _FAIL; -+ goto exit; -+ } -+ -+ if(!(psta->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta("MAC_FMT")->state(0x%x) != _FW_LINKED\n", __func__, MAC_ARG(psta->hwaddr), psta->state); -+ return _FAIL; -+ } -+ -+ -+ -+ //TODO:_lock -+ if(update_attrib_sec_info(padapter, pattrib, psta) == _FAIL) -+ { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ update_attrib_phy_info(pattrib, psta); -+ -+ pattrib->mac_id = psta->mac_id; -+ //DBG_8192C("%s ==> mac_id(%d)\n",__FUNCTION__,pattrib->mac_id ); -+ -+ pattrib->psta = psta; -+ //TODO:_unlock -+ -+ pattrib->pctrl = 0; -+ -+ pattrib->ack_policy = 0; -+ // get ether_hdr_len -+ pattrib->pkt_hdrlen = ETH_HLEN;//(pattrib->ether_type == 0x8100) ? (14 + 4 ): 14; //vlan tag -+ -+ pattrib->hdrlen = WLAN_HDR_A3_LEN; -+ pattrib->subtype = WIFI_DATA_TYPE; -+ pattrib->priority = 0; -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE|WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE)) -+ { -+ if(pattrib->qos_en) -+ set_qos(&pktfile, pattrib); -+ } -+ else -+ { -+ if(pqospriv->qos_option) -+ { -+ set_qos(&pktfile, pattrib); -+ -+ if(pmlmepriv->acm_mask != 0) -+ { -+ pattrib->priority = qos_acm(pmlmepriv->acm_mask, pattrib->priority); -+ } -+ } -+ } -+ -+ //pattrib->priority = 5; //force to used VI queue, for testing -+ -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, -+ ("update_attrib: encrypt=%d securitypriv.sw_encrypt=%d\n", -+ pattrib->encrypt, padapter->securitypriv.sw_encrypt)); -+ -+ if (pattrib->encrypt && -+ ((padapter->securitypriv.sw_encrypt == true) || (psecuritypriv->hw_decrypted == false))) -+ { -+ pattrib->bswenc = true; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_, -+ ("update_attrib: encrypt=%d securitypriv.hw_decrypted=%d bswenc=true\n", -+ pattrib->encrypt, padapter->securitypriv.sw_encrypt)); -+ } else { -+ pattrib->bswenc = false; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("update_attrib: bswenc=false\n")); -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if((pattrib->encrypt && bmcast) || (pattrib->encrypt ==_WEP40_) || (pattrib->encrypt ==_WEP104_)) -+ { -+ pattrib->bswenc = true;//force using sw enc. -+ } -+#endif -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(pattrib->encrypt == _SMS4_) -+ pattrib->bswenc = false; -+#endif -+ -+ rtw_set_tx_chksum_offload(pkt, pattrib); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+static s32 xmitframe_addmic(_adapter *padapter, struct xmit_frame *pxmitframe){ -+ sint curfragnum,length; -+ u8 *pframe, *payload,mic[8]; -+ struct mic_data micdata; -+ //struct sta_info *stainfo; -+ struct qos_priv *pqospriv= &(padapter->mlmepriv.qospriv); -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct security_priv *psecuritypriv=&padapter->securitypriv; -+ struct xmit_priv *pxmitpriv=&padapter->xmitpriv; -+ u8 priority[4]={0x0,0x0,0x0,0x0}; -+ u8 hw_hdr_offset = 0; -+ sint bmcst = IS_MCAST(pattrib->ra); -+ -+/* -+ if(pattrib->psta) -+ { -+ stainfo = pattrib->psta; -+ } -+ else -+ { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ stainfo=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0]); -+ } -+ -+ if(stainfo==NULL) -+ { -+ DBG_871X("%s, psta==NUL\n", __func__); -+ return _FAIL; -+ } -+ -+ if(!(stainfo->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, stainfo->state); -+ return _FAIL; -+ } -+*/ -+ -+ -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ hw_hdr_offset = TXDESC_SIZE + (pxmitframe->pkt_offset * PACKET_OFFSET_SZ);; -+#else -+ #ifdef CONFIG_TX_EARLY_MODE -+ hw_hdr_offset = TXDESC_OFFSET+ EARLY_MODE_INFO_SIZE; -+ #else -+ hw_hdr_offset = TXDESC_OFFSET; -+ #endif -+#endif -+ -+ if(pattrib->encrypt ==_TKIP_)//if(psecuritypriv->dot11PrivacyAlgrthm==_TKIP_PRIVACY_) -+ { -+ //encode mic code -+ //if(stainfo!= NULL) -+ { -+ u8 null_key[16]={0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0,0x0}; -+ -+ pframe = pxmitframe->buf_addr + hw_hdr_offset; -+ -+ if(bmcst) -+ { -+ if(_rtw_memcmp(psecuritypriv->dot118021XGrptxmickey[psecuritypriv->dot118021XGrpKeyid].skey, null_key, 16)==true){ -+ //DbgPrint("\nxmitframe_addmic:stainfo->dot11tkiptxmickey==0\n"); -+ //rtw_msleep_os(10); -+ return _FAIL; -+ } -+ //start to calculate the mic code -+ rtw_secmicsetkey(&micdata, psecuritypriv->dot118021XGrptxmickey[psecuritypriv->dot118021XGrpKeyid].skey); -+ } -+ else -+ { -+ if(_rtw_memcmp(&pattrib->dot11tkiptxmickey.skey[0],null_key, 16)==true){ -+ //DbgPrint("\nxmitframe_addmic:stainfo->dot11tkiptxmickey==0\n"); -+ //rtw_msleep_os(10); -+ return _FAIL; -+ } -+ //start to calculate the mic code -+ rtw_secmicsetkey(&micdata, &pattrib->dot11tkiptxmickey.skey[0]); -+ } -+ -+ if(pframe[1]&1){ //ToDS==1 -+ rtw_secmicappend(&micdata, &pframe[16], 6); //DA -+ if(pframe[1]&2) //From Ds==1 -+ rtw_secmicappend(&micdata, &pframe[24], 6); -+ else -+ rtw_secmicappend(&micdata, &pframe[10], 6); -+ } -+ else{ //ToDS==0 -+ rtw_secmicappend(&micdata, &pframe[4], 6); //DA -+ if(pframe[1]&2) //From Ds==1 -+ rtw_secmicappend(&micdata, &pframe[16], 6); -+ else -+ rtw_secmicappend(&micdata, &pframe[10], 6); -+ -+ } -+ -+ //if(pqospriv->qos_option==1) -+ if(pattrib->qos_en) -+ priority[0]=(u8)pxmitframe->attrib.priority; -+ -+ -+ rtw_secmicappend(&micdata, &priority[0], 4); -+ -+ payload=pframe; -+ -+ for(curfragnum=0;curfragnumnr_frags;curfragnum++){ -+ payload=(u8 *)RND4((SIZE_PTR)(payload)); -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("===curfragnum=%d, pframe= 0x%.2x, 0x%.2x, 0x%.2x, 0x%.2x, 0x%.2x, 0x%.2x, 0x%.2x, 0x%.2x,!!!\n", -+ curfragnum,*payload, *(payload+1),*(payload+2),*(payload+3),*(payload+4),*(payload+5),*(payload+6),*(payload+7))); -+ -+ payload=payload+pattrib->hdrlen+pattrib->iv_len; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("curfragnum=%d pattrib->hdrlen=%d pattrib->iv_len=%d",curfragnum,pattrib->hdrlen,pattrib->iv_len)); -+ if((curfragnum+1)==pattrib->nr_frags){ -+ length=pattrib->last_txcmdsz-pattrib->hdrlen-pattrib->iv_len-( (pattrib->bswenc) ? pattrib->icv_len : 0); -+ rtw_secmicappend(&micdata, payload,length); -+ payload=payload+length; -+ } -+ else{ -+ length=pxmitpriv->frag_len-pattrib->hdrlen-pattrib->iv_len-( (pattrib->bswenc) ? pattrib->icv_len : 0); -+ rtw_secmicappend(&micdata, payload, length); -+ payload=payload+length+pattrib->icv_len; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("curfragnum=%d length=%d pattrib->icv_len=%d",curfragnum,length,pattrib->icv_len)); -+ } -+ } -+ rtw_secgetmic(&micdata,&(mic[0])); -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("xmitframe_addmic: before add mic code!!!\n")); -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("xmitframe_addmic: pattrib->last_txcmdsz=%d!!!\n",pattrib->last_txcmdsz)); -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("xmitframe_addmic: mic[0]=0x%.2x ,mic[1]=0x%.2x ,mic[2]=0x%.2x ,mic[3]=0x%.2x \n\ -+ mic[4]=0x%.2x ,mic[5]=0x%.2x ,mic[6]=0x%.2x ,mic[7]=0x%.2x !!!!\n", -+ mic[0],mic[1],mic[2],mic[3],mic[4],mic[5],mic[6],mic[7])); -+ //add mic code and add the mic code length in last_txcmdsz -+ -+ _rtw_memcpy(payload, &(mic[0]),8); -+ pattrib->last_txcmdsz+=8; -+ -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("\n ========last pkt========\n")); -+ payload=payload-pattrib->last_txcmdsz+8; -+ for(curfragnum=0;curfragnumlast_txcmdsz;curfragnum=curfragnum+8) -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,(" %.2x, %.2x, %.2x, %.2x, %.2x, %.2x, %.2x, %.2x ", -+ *(payload+curfragnum), *(payload+curfragnum+1), *(payload+curfragnum+2),*(payload+curfragnum+3), -+ *(payload+curfragnum+4),*(payload+curfragnum+5),*(payload+curfragnum+6),*(payload+curfragnum+7))); -+ } -+/* -+ else{ -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("xmitframe_addmic: rtw_get_stainfo==NULL!!!\n")); -+ } -+*/ -+ } -+ -+ -+ -+ return _SUCCESS; -+} -+ -+static s32 xmitframe_swencrypt(_adapter *padapter, struct xmit_frame *pxmitframe){ -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ //struct security_priv *psecuritypriv=&padapter->securitypriv; -+ -+ -+ -+ //if((psecuritypriv->sw_encrypt)||(pattrib->bswenc)) -+ if(pattrib->bswenc) -+ { -+ //DBG_871X("start xmitframe_swencrypt\n"); -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_alert_,("### xmitframe_swencrypt\n")); -+ switch(pattrib->encrypt){ -+ case _WEP40_: -+ case _WEP104_: -+ rtw_wep_encrypt(padapter, (u8 *)pxmitframe); -+ break; -+ case _TKIP_: -+ rtw_tkip_encrypt(padapter, (u8 *)pxmitframe); -+ break; -+ case _AES_: -+ rtw_aes_encrypt(padapter, (u8 * )pxmitframe); -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ rtw_sms4_encrypt(padapter, (u8 * )pxmitframe); -+#endif -+ default: -+ break; -+ } -+ -+ } else { -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_notice_,("### xmitframe_hwencrypt\n")); -+ } -+ -+ -+ -+ return _SUCCESS; -+} -+ -+s32 rtw_make_wlanhdr (_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib) -+{ -+ u16 *qc; -+ -+ struct rtw_ieee80211_hdr *pwlanhdr = (struct rtw_ieee80211_hdr *)hdr; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ u8 qos_option = false; -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *ptdls_sta=NULL, *psta_backup=NULL; -+ u8 direct_link=0; -+#endif //CONFIG_TDLS -+ sint res = _SUCCESS; -+ __le16 *fctrl = &pwlanhdr->frame_ctl; -+ -+ _rtw_memset(hdr, 0, WLANHDR_OFFSET); -+ -+ SetFrameSubType(fctrl, pattrib->subtype); -+ -+ if (pattrib->subtype & WIFI_DATA_TYPE) { -+ if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true)) { -+ //to_ds = 1, fr_ds = 0; -+#ifdef CONFIG_TDLS -+ if((ptdlsinfo->setup_state == TDLS_LINKED_STATE)){ -+ ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ if((ptdls_sta!=NULL)&&(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)&&(pattrib->ether_type!=0x0806)){ -+ //TDLS data transfer, ToDS=0, FrDs=0 -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); -+ direct_link=1; -+ }else{ -+ // 1.Data transfer to AP -+ // 2.Arp pkt will relayed by AP -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); -+ } -+ }else -+#endif //CONFIG_TDLS -+ { -+ //Data transfer to AP -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); -+ } -+ -+ if (pqospriv->qos_option) -+ qos_option = true; -+ -+ } -+ else if ((check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) ) { -+ //to_ds = 0, fr_ds = 1; -+ SetFrDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pattrib->src, ETH_ALEN); -+ -+ if(pattrib->qos_en) -+ qos_option = true; -+ } -+ else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) { -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); -+ -+ if(pattrib->qos_en) -+ qos_option = true; -+ } -+ else { -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("fw_state:%x is not allowed to xmit frame\n", get_fwstate(pmlmepriv))); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ if(pattrib->mdata) -+ SetMData(fctrl); -+ -+ if (pattrib->encrypt) -+ SetPrivacy(fctrl); -+ -+ if (qos_option) -+ { -+ qc = (unsigned short *)(hdr + pattrib->hdrlen - 2); -+ -+ if (pattrib->priority) -+ SetPriority(qc, pattrib->priority); -+ -+ SetEOSP(qc, pattrib->eosp); -+ -+ SetAckpolicy(qc, pattrib->ack_policy); -+ } -+ -+ //TODO: fill HT Control Field -+ -+ //Update Seq Num will be handled by f/w -+ { -+ struct sta_info *psta; -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if(pattrib->psta != psta) -+ { -+ DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return _FAIL; -+ } -+ -+ if(psta==NULL) -+ { -+ DBG_871X("%s, psta==NUL\n", __func__); -+ return _FAIL; -+ } -+ -+ if(!(psta->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FAIL; -+ } -+ -+ //if(psta) -+ { -+#ifdef CONFIG_TDLS -+ if(direct_link==1) -+ { -+ psta_backup = psta; -+ psta = ptdls_sta; -+ } -+#endif //CONFIG_TDLS -+ -+ psta->sta_xmitpriv.txseq_tid[pattrib->priority]++; -+ psta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; -+ -+ pattrib->seqnum = psta->sta_xmitpriv.txseq_tid[pattrib->priority]; -+ -+ SetSeqNum(hdr, pattrib->seqnum); -+ -+#ifdef CONFIG_80211N_HT -+ //check if enable ampdu -+ if(pattrib->ht_en && psta->htpriv.ampdu_enable) -+ { -+ if(psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) -+ pattrib->ampdu_en = true; -+ } -+ -+ //re-check if enable ampdu by BA_starting_seqctrl -+ if(pattrib->ampdu_en == true) -+ { -+ u16 tx_seq; -+ -+ tx_seq = psta->BA_starting_seqctrl[pattrib->priority & 0x0f]; -+ -+ //check BA_starting_seqctrl -+ if(SN_LESS(pattrib->seqnum, tx_seq)) -+ { -+ //DBG_871X("tx ampdu seqnum(%d) < tx_seq(%d)\n", pattrib->seqnum, tx_seq); -+ pattrib->ampdu_en = false;//AGG BK -+ } -+ else if(SN_EQUAL(pattrib->seqnum, tx_seq)) -+ { -+ psta->BA_starting_seqctrl[pattrib->priority & 0x0f] = (tx_seq+1)&0xfff; -+ -+ pattrib->ampdu_en = true;//AGG EN -+ } -+ else -+ { -+ //DBG_871X("tx ampdu over run\n"); -+ psta->BA_starting_seqctrl[pattrib->priority & 0x0f] = (pattrib->seqnum+1)&0xfff; -+ pattrib->ampdu_en = true;//AGG EN -+ } -+ -+ } -+#endif //CONFIG_80211N_HT -+#ifdef CONFIG_TDLS -+ if(direct_link==1) -+ { -+ if (pattrib->encrypt){ -+ pattrib->encrypt= _AES_; -+ pattrib->iv_len=8; -+ pattrib->icv_len=8; -+ } -+ -+ //qos_en, ht_en, init rate, ,bw, ch_offset, sgi -+ //pattrib->qos_en = ptdls_sta->qos_option; -+ -+ pattrib->raid = ptdls_sta->raid; -+#ifdef CONFIG_80211N_HT -+ pattrib->bwmode = ptdls_sta->htpriv.bwmode; -+ pattrib->ht_en = ptdls_sta->htpriv.ht_option; -+ pattrib->ch_offset = ptdls_sta->htpriv.ch_offset; -+ pattrib->sgi= ptdls_sta->htpriv.sgi; -+#endif //CONFIG_80211N_HT -+ pattrib->mac_id = ptdls_sta->mac_id; -+ -+ psta = psta_backup; -+ } -+#endif //CONFIG_TDLS -+ -+ } -+ } -+ -+ } -+ else -+ { -+ -+ } -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+s32 rtw_txframes_pending(_adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ return ((_rtw_queue_empty(&pxmitpriv->be_pending) == false) || -+ (_rtw_queue_empty(&pxmitpriv->bk_pending) == false) || -+ (_rtw_queue_empty(&pxmitpriv->vi_pending) == false) || -+ (_rtw_queue_empty(&pxmitpriv->vo_pending) == false)); -+} -+ -+s32 rtw_txframes_sta_ac_pending(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ struct sta_info *psta; -+ struct tx_servq *ptxservq; -+ int priority = pattrib->priority; -+/* -+ if(pattrib->psta) -+ { -+ psta = pattrib->psta; -+ } -+ else -+ { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ psta=rtw_get_stainfo(&padapter->stapriv ,&pattrib->ra[0]); -+ } -+*/ -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if(pattrib->psta != psta) -+ { -+ DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return 0; -+ } -+ -+ if(psta==NULL) -+ { -+ DBG_871X("%s, psta==NUL\n", __func__); -+ return 0; -+ } -+ -+ if(!(psta->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return 0; -+ } -+ -+ switch(priority) -+ { -+ case 1: -+ case 2: -+ ptxservq = &(psta->sta_xmitpriv.bk_q); -+ break; -+ case 4: -+ case 5: -+ ptxservq = &(psta->sta_xmitpriv.vi_q); -+ break; -+ case 6: -+ case 7: -+ ptxservq = &(psta->sta_xmitpriv.vo_q); -+ break; -+ case 0: -+ case 3: -+ default: -+ ptxservq = &(psta->sta_xmitpriv.be_q); -+ break; -+ -+ } -+ -+ return ptxservq->qcnt; -+} -+ -+#ifdef CONFIG_TDLS -+ -+int rtw_build_tdls_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, u8 action) -+{ -+ int res=_SUCCESS; -+ -+ switch(action){ -+ case TDLS_SETUP_REQUEST: -+ rtw_build_tdls_setup_req_ies(padapter, pxmitframe, pframe); -+ break; -+ case TDLS_SETUP_RESPONSE: -+ rtw_build_tdls_setup_rsp_ies(padapter, pxmitframe, pframe); -+ break; -+ case TDLS_SETUP_CONFIRM: -+ rtw_build_tdls_setup_cfm_ies(padapter, pxmitframe, pframe); -+ break; -+ case TDLS_TEARDOWN: -+ rtw_build_tdls_teardown_ies(padapter, pxmitframe, pframe); -+ break; -+ case TDLS_DISCOVERY_REQUEST: -+ rtw_build_tdls_dis_req_ies(padapter, pxmitframe, pframe); -+ break; -+ case TDLS_PEER_TRAFFIC_INDICATION: -+ rtw_build_tdls_peer_traffic_indication_ies(padapter, pxmitframe, pframe); -+ break; -+ case TDLS_CHANNEL_SWITCH_REQUEST: -+ rtw_build_tdls_ch_switch_req_ies(padapter, pxmitframe, pframe); -+ break; -+ case TDLS_CHANNEL_SWITCH_RESPONSE: -+ rtw_build_tdls_ch_switch_rsp_ies(padapter, pxmitframe, pframe); -+ break; -+#ifdef CONFIG_WFD -+ case TUNNELED_PROBE_REQ: -+ rtw_build_tunneled_probe_req_ies(padapter, pxmitframe, pframe); -+ break; -+ case TUNNELED_PROBE_RSP: -+ rtw_build_tunneled_probe_rsp_ies(padapter, pxmitframe, pframe); -+ break; -+#endif //CONFIG_WFD -+ default: -+ res=_FAIL; -+ break; -+ } -+ -+ return res; -+} -+ -+s32 rtw_make_tdls_wlanhdr (_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib, u8 action) -+{ -+ u16 *qc; -+ struct rtw_ieee80211_hdr *pwlanhdr = (struct rtw_ieee80211_hdr *)hdr; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct qos_priv *pqospriv = &pmlmepriv->qospriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct sta_info *psta=NULL, *ptdls_sta=NULL; -+ u8 tdls_seq=0, baddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; -+ -+ sint res = _SUCCESS; -+ u16 *fctrl = &pwlanhdr->frame_ctl; -+ -+ -+ -+ _rtw_memset(hdr, 0, WLANHDR_OFFSET); -+ -+ SetFrameSubType(fctrl, pattrib->subtype); -+ -+ switch(action){ -+ case TDLS_SETUP_REQUEST: -+ case TDLS_SETUP_RESPONSE: -+ case TDLS_SETUP_CONFIRM: -+ case TDLS_TEARDOWN: //directly to peer STA or via AP -+ case TDLS_PEER_TRAFFIC_INDICATION: -+ case TDLS_PEER_PSM_REQUEST: //directly to peer STA or via AP -+ case TUNNELED_PROBE_REQ: -+ case TUNNELED_PROBE_RSP: -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); -+ break; -+ case TDLS_CHANNEL_SWITCH_REQUEST: -+ case TDLS_CHANNEL_SWITCH_RESPONSE: -+ case TDLS_PEER_PSM_RESPONSE: -+ case TDLS_PEER_TRAFFIC_RESPONSE: -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); -+ tdls_seq=1; -+ break; -+ case TDLS_DISCOVERY_REQUEST: //unicast: directly to peer sta, Bcast: via AP -+ if(_rtw_memcmp(pattrib->dst, baddr, ETH_ALEN) ) -+ { -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN); -+ } -+ else -+ { -+ _rtw_memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv), ETH_ALEN); -+ tdls_seq=1; -+ } -+ break; -+ } -+ -+ if (pattrib->encrypt) -+ SetPrivacy(fctrl); -+ -+ if (pqospriv->qos_option) -+ { -+ qc = (unsigned short *)(hdr + pattrib->hdrlen - 2); -+ if (pattrib->priority) -+ SetPriority(qc, pattrib->priority); -+ SetAckpolicy(qc, pattrib->ack_policy); -+ } -+ -+ psta = pattrib->psta; -+ -+ // 1. update seq_num per link by sta_info -+ // 2. rewrite encrypt to _AES_, also rewrite iv_len, icv_len -+ if(tdls_seq==1){ -+ ptdls_sta=rtw_get_stainfo(pstapriv, pattrib->dst); -+ if(ptdls_sta){ -+ ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority]++; -+ ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; -+ pattrib->seqnum = ptdls_sta->sta_xmitpriv.txseq_tid[pattrib->priority]; -+ SetSeqNum(hdr, pattrib->seqnum); -+ -+ if (pattrib->encrypt){ -+ pattrib->encrypt= _AES_; -+ pattrib->iv_len=8; -+ pattrib->icv_len=8; -+ } -+ }else{ -+ res=_FAIL; -+ goto exit; -+ } -+ }else if(psta){ -+ psta->sta_xmitpriv.txseq_tid[pattrib->priority]++; -+ psta->sta_xmitpriv.txseq_tid[pattrib->priority] &= 0xFFF; -+ pattrib->seqnum = psta->sta_xmitpriv.txseq_tid[pattrib->priority]; -+ SetSeqNum(hdr, pattrib->seqnum); -+ } -+ -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+s32 rtw_xmit_tdls_coalesce(_adapter * padapter, struct xmit_frame * pxmitframe, u8 action) -+{ -+ s32 llc_sz; -+ -+ u8 *pframe, *mem_start; -+ -+ struct sta_info *psta; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ u8 *pbuf_start; -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ s32 res = _SUCCESS; -+ -+ -+ -+ if (pattrib->psta) { -+ psta = pattrib->psta; -+ } else { -+ if(bmcst) { -+ psta = rtw_get_bcmc_stainfo(padapter); -+ } else { -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ } -+ } -+ -+ if(psta==NULL) -+ return _FAIL; -+ -+ if (pxmitframe->buf_addr == NULL) -+ return _FAIL; -+ -+ pbuf_start = pxmitframe->buf_addr; -+ mem_start = pbuf_start + TXDESC_OFFSET; -+ -+ if (rtw_make_tdls_wlanhdr(padapter, mem_start, pattrib, action) == _FAIL) { -+ res = _FAIL; -+ goto exit; -+ } -+ -+ pframe = mem_start; -+ pframe += pattrib->hdrlen; -+ -+ //adding icv, if necessary... -+ if (pattrib->iv_len) -+ { -+ if (psta != NULL) -+ { -+ switch(pattrib->encrypt) -+ { -+ case _WEP40_: -+ case _WEP104_: -+ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ break; -+ case _TKIP_: -+ if(bmcst) -+ TKIP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ TKIP_IV(pattrib->iv, psta->dot11txpn, 0); -+ break; -+ case _AES_: -+ if(bmcst) -+ AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ AES_IV(pattrib->iv, psta->dot11txpn, 0); -+ break; -+ } -+ } -+ -+ _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); -+ pframe += pattrib->iv_len; -+ -+ } -+ -+ llc_sz = rtw_put_snap(pframe, pattrib->ether_type); -+ pframe += llc_sz; -+ -+ //pattrib->pktlen will be counted in rtw_build_tdls_ies -+ pattrib->pktlen = 0; -+ -+ rtw_build_tdls_ies(padapter, pxmitframe, pframe, action); -+ -+ if ((pattrib->icv_len >0 )&& (pattrib->bswenc)) { -+ pframe += pattrib->pktlen; -+ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); -+ pframe += pattrib->icv_len; -+ } -+ -+ pattrib->nr_frags = 1; -+ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + llc_sz + -+ ((pattrib->bswenc) ? pattrib->icv_len : 0) + pattrib->pktlen; -+ -+ if (xmitframe_addmic(padapter, pxmitframe) == _FAIL) -+ { -+ goto exit; -+ } -+ -+ xmitframe_swencrypt(padapter, pxmitframe); -+ -+ update_attrib_vcs_info(padapter, pxmitframe); -+ -+exit: -+ -+ -+ -+ return res; -+} -+#endif //CONFIG_TDLS -+ -+/* -+ * Calculate wlan 802.11 packet MAX size from pkt_attrib -+ * This function doesn't consider fragment case -+ */ -+u32 rtw_calculate_wlan_pkt_size_by_attribue(struct pkt_attrib *pattrib) -+{ -+ u32 len = 0; -+ -+ len = pattrib->hdrlen + pattrib->iv_len; // WLAN Header and IV -+ len += SNAP_SIZE + sizeof(u16); // LLC -+ len += pattrib->pktlen; -+ if (pattrib->encrypt == _TKIP_) len += 8; // MIC -+ len += ((pattrib->bswenc) ? pattrib->icv_len : 0); // ICV -+ -+ return len; -+} -+ -+/* -+ -+This sub-routine will perform all the following: -+ -+1. remove 802.3 header. -+2. create wlan_header, based on the info in pxmitframe -+3. append sta's iv/ext-iv -+4. append LLC -+5. move frag chunk from pframe to pxmitframe->mem -+6. apply sw-encrypt, if necessary. -+ -+*/ -+s32 rtw_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe) -+{ -+ struct pkt_file pktfile; -+ -+ s32 frg_inx, frg_len, mpdu_len, llc_sz, mem_sz; -+ -+ SIZE_PTR addr; -+ -+ u8 *pframe, *mem_start; -+ u8 hw_hdr_offset; -+ -+ //struct sta_info *psta; -+ //struct sta_priv *pstapriv = &padapter->stapriv; -+ //struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+ u8 *pbuf_start; -+ -+ s32 bmcst = IS_MCAST(pattrib->ra); -+ s32 res = _SUCCESS; -+ -+ -+ -+/* -+ if (pattrib->psta) -+ { -+ psta = pattrib->psta; -+ } else -+ { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ } -+ -+ if(psta==NULL) -+ { -+ -+ DBG_871X("%s, psta==NUL\n", __func__); -+ return _FAIL; -+ } -+ -+ -+ if(!(psta->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FAIL; -+ } -+*/ -+ if (pxmitframe->buf_addr == NULL){ -+ DBG_8192C("==> %s buf_addr==NULL \n",__FUNCTION__); -+ return _FAIL; -+ } -+ -+ pbuf_start = pxmitframe->buf_addr; -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ hw_hdr_offset = TXDESC_SIZE + (pxmitframe->pkt_offset * PACKET_OFFSET_SZ); -+#else -+ #ifdef CONFIG_TX_EARLY_MODE //for SDIO && Tx Agg -+ hw_hdr_offset = TXDESC_OFFSET + EARLY_MODE_INFO_SIZE; -+ #else -+ hw_hdr_offset = TXDESC_OFFSET; -+ #endif -+#endif -+ -+ mem_start = pbuf_start + hw_hdr_offset; -+ -+ if (rtw_make_wlanhdr(padapter, mem_start, pattrib) == _FAIL) { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("rtw_xmitframe_coalesce: rtw_make_wlanhdr fail; drop pkt\n")); -+ DBG_8192C("rtw_xmitframe_coalesce: rtw_make_wlanhdr fail; drop pkt\n"); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ _rtw_open_pktfile(pkt, &pktfile); -+ _rtw_pktfile_read(&pktfile, NULL, pattrib->pkt_hdrlen); -+ -+ frg_inx = 0; -+ frg_len = pxmitpriv->frag_len - 4;//2346-4 = 2342 -+ -+ while (1) -+ { -+ llc_sz = 0; -+ -+ mpdu_len = frg_len; -+ -+ pframe = mem_start; -+ -+ SetMFrag(mem_start); -+ -+ pframe += pattrib->hdrlen; -+ mpdu_len -= pattrib->hdrlen; -+ -+ //adding icv, if necessary... -+ if (pattrib->iv_len) -+ { -+/* -+ //if (check_fwstate(pmlmepriv, WIFI_MP_STATE)) -+ // psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ //else -+ // psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ -+ if (psta != NULL) -+ { -+ switch(pattrib->encrypt) -+ { -+ case _WEP40_: -+ case _WEP104_: -+ WEP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ break; -+ case _TKIP_: -+ if(bmcst) -+ TKIP_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ TKIP_IV(pattrib->iv, psta->dot11txpn, 0); -+ break; -+ case _AES_: -+ if(bmcst) -+ AES_IV(pattrib->iv, psta->dot11txpn, pattrib->key_idx); -+ else -+ AES_IV(pattrib->iv, psta->dot11txpn, 0); -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ rtw_wapi_get_iv(padapter,pattrib->ra,pattrib->iv); -+ break; -+#endif -+ } -+ } -+*/ -+ _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); -+ -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_notice_, -+ ("rtw_xmitframe_coalesce: keyid=%d pattrib->iv[3]=%.2x pframe=%.2x %.2x %.2x %.2x\n", -+ padapter->securitypriv.dot11PrivacyKeyIndex, pattrib->iv[3], *pframe, *(pframe+1), *(pframe+2), *(pframe+3))); -+ -+ pframe += pattrib->iv_len; -+ -+ mpdu_len -= pattrib->iv_len; -+ } -+ -+ if (frg_inx == 0) { -+ llc_sz = rtw_put_snap(pframe, pattrib->ether_type); -+ pframe += llc_sz; -+ mpdu_len -= llc_sz; -+ } -+ -+ if ((pattrib->icv_len >0) && (pattrib->bswenc)) { -+ mpdu_len -= pattrib->icv_len; -+ } -+ -+ -+ if (bmcst) { -+ // don't do fragment to broadcat/multicast packets -+ mem_sz = _rtw_pktfile_read(&pktfile, pframe, pattrib->pktlen); -+ } else { -+ mem_sz = _rtw_pktfile_read(&pktfile, pframe, mpdu_len); -+ } -+ -+ pframe += mem_sz; -+ -+ if ((pattrib->icv_len >0 )&& (pattrib->bswenc)) { -+ _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); -+ pframe += pattrib->icv_len; -+ } -+ -+ frg_inx++; -+ -+ if (bmcst || (rtw_endofpktfile(&pktfile) == true)) -+ { -+ pattrib->nr_frags = frg_inx; -+ -+ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + ((pattrib->nr_frags==1)? llc_sz:0) + -+ ((pattrib->bswenc) ? pattrib->icv_len : 0) + mem_sz; -+ -+ ClearMFrag(mem_start); -+ -+ break; -+ } else { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("%s: There're still something in packet!\n", __FUNCTION__)); -+ } -+ -+ addr = (SIZE_PTR)(pframe); -+ -+ mem_start = (unsigned char *)RND4(addr) + hw_hdr_offset; -+ _rtw_memcpy(mem_start, pbuf_start + hw_hdr_offset, pattrib->hdrlen); -+ -+ } -+ -+ if (xmitframe_addmic(padapter, pxmitframe) == _FAIL) -+ { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("xmitframe_addmic(padapter, pxmitframe)==_FAIL\n")); -+ DBG_8192C("xmitframe_addmic(padapter, pxmitframe)==_FAIL\n"); -+ res = _FAIL; -+ goto exit; -+ } -+ -+ xmitframe_swencrypt(padapter, pxmitframe); -+ -+ if(bmcst == false) -+ update_attrib_vcs_info(padapter, pxmitframe); -+ else -+ pattrib->vcs_mode = NONE_VCS; -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+/* Logical Link Control(LLC) SubNetwork Attachment Point(SNAP) header -+ * IEEE LLC/SNAP header contains 8 octets -+ * First 3 octets comprise the LLC portion -+ * SNAP portion, 5 octets, is divided into two fields: -+ * Organizationally Unique Identifier(OUI), 3 octets, -+ * type, defined by that organization, 2 octets. -+ */ -+s32 rtw_put_snap(u8 *data, u16 h_proto) -+{ -+ struct ieee80211_snap_hdr *snap; -+ u8 *oui; -+ -+ -+ -+ snap = (struct ieee80211_snap_hdr *)data; -+ snap->dsap = 0xaa; -+ snap->ssap = 0xaa; -+ snap->ctrl = 0x03; -+ -+ if (h_proto == 0x8137 || h_proto == 0x80f3) -+ oui = P802_1H_OUI; -+ else -+ oui = RFC1042_OUI; -+ -+ snap->oui[0] = oui[0]; -+ snap->oui[1] = oui[1]; -+ snap->oui[2] = oui[2]; -+ -+ *(__be16 *)(data + SNAP_SIZE) = htons(h_proto); -+ -+ -+ -+ return SNAP_SIZE + sizeof(u16); -+} -+ -+void rtw_update_protection(_adapter *padapter, u8 *ie, uint ie_len) -+{ -+ -+ uint protection; -+ u8 *perp; -+ sint erp_len; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ -+ -+ -+ switch(pxmitpriv->vcs_setting) -+ { -+ case DISABLE_VCS: -+ pxmitpriv->vcs = NONE_VCS; -+ break; -+ -+ case ENABLE_VCS: -+ break; -+ -+ case AUTO_VCS: -+ default: -+ perp = rtw_get_ie(ie, _ERPINFO_IE_, &erp_len, ie_len); -+ if(perp == NULL) -+ { -+ pxmitpriv->vcs = NONE_VCS; -+ } -+ else -+ { -+ protection = (*(perp + 2)) & BIT(1); -+ if (protection) -+ { -+ if(pregistrypriv->vcs_type == RTS_CTS) -+ pxmitpriv->vcs = RTS_CTS; -+ else -+ pxmitpriv->vcs = CTS_TO_SELF; -+ } -+ else -+ pxmitpriv->vcs = NONE_VCS; -+ } -+ -+ break; -+ -+ } -+ -+ -+ -+} -+ -+void rtw_count_tx_stats(PADAPTER padapter, struct xmit_frame *pxmitframe, int sz) -+{ -+ struct sta_info *psta = NULL; -+ struct stainfo_stats *pstats = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if ((pxmitframe->frame_tag&0x0f) == DATA_FRAMETAG) -+ { -+ pxmitpriv->tx_bytes += sz; -+#if defined(CONFIG_USB_TX_AGGREGATION) -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod += pxmitframe->agg_num; -+#else -+ pmlmepriv->LinkDetectInfo.NumTxOkInPeriod++; -+#endif -+ -+ psta = pxmitframe->attrib.psta; -+ if (psta) -+ { -+ pstats = &psta->sta_stats; -+#if defined(CONFIG_USB_TX_AGGREGATION) -+ pstats->tx_pkts += pxmitframe->agg_num; -+#else -+ pstats->tx_pkts++; -+#endif -+ pstats->tx_bytes += sz; -+ } -+ } -+} -+ -+struct xmit_buf *rtw_alloc_cmd_xmitbuf(struct xmit_priv *pxmitpriv, u32 buffsize) -+{ -+ struct xmit_buf *pxmitbuf = NULL; -+ -+ -+ -+ pxmitbuf = &pxmitpriv->pcmd_xmitbuf; -+ if (pxmitbuf != NULL) { -+ if(rtw_os_xmit_resource_alloc(pxmitpriv->adapter, pxmitbuf,(buffsize + XMITBUF_ALIGN_SZ), false) == _FAIL) { -+ return NULL; -+ } -+ -+ pxmitbuf->alloc_sz = buffsize + XMITBUF_ALIGN_SZ; -+ -+ pxmitbuf->priv_data = NULL; -+ -+ if (pxmitbuf->sctx) { -+ DBG_871X("%s pxmitbuf->sctx is not NULL\n", __func__); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); -+ } -+ } else { -+ DBG_871X("%s fail, no xmitbuf available !!!\n", __func__); -+ } -+ -+ -+ -+ return pxmitbuf; -+} -+ -+s32 rtw_free_cmd_xmitbuf(struct xmit_priv *pxmitpriv) -+{ -+ struct xmit_buf *pxmitbuf = NULL; -+ -+ -+ -+ pxmitbuf = &pxmitpriv->pcmd_xmitbuf; -+ if (pxmitbuf==NULL) { -+ DBG_871X("%s fail, no xmitbuf available !!!\n", __func__); -+ return _FAIL; -+ } else { -+ rtw_os_xmit_resource_free(pxmitbuf->padapter, pxmitbuf, pxmitbuf->alloc_sz, false); -+ } -+ -+ -+ -+ return _SUCCESS; -+} -+ -+struct xmit_frame *rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, u32 buffsize) -+{ -+ struct xmit_frame *pcmdframe; -+ struct xmit_buf *pxmitbuf; -+ -+ if ((pcmdframe = rtw_alloc_xmitframe(pxmitpriv)) == NULL) -+ { -+ DBG_871X("%s, alloc xmitframe fail\n", __FUNCTION__); -+ return NULL; -+ } -+ -+ if ((pxmitbuf = rtw_alloc_cmd_xmitbuf(pxmitpriv, buffsize)) == NULL) { -+ DBG_871X("%s, alloc xmitbuf fail\n", __FUNCTION__); -+ rtw_free_xmitframe(pxmitpriv, pcmdframe); -+ return NULL; -+ } -+ -+ pcmdframe->frame_tag = MGNT_FRAMETAG; -+ -+ pcmdframe->pxmitbuf = pxmitbuf; -+ -+ pcmdframe->buf_addr = pxmitbuf->pbuf; -+ -+ pxmitbuf->priv_data = pcmdframe; -+ -+ return pcmdframe; -+ -+} -+ -+void rtw_free_cmdxmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe) -+{ -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ rtw_free_cmd_xmitbuf(pxmitpriv); -+} -+ -+struct xmit_buf *rtw_alloc_xmitbuf_ext(struct xmit_priv *pxmitpriv) -+{ -+ _irqL irqL; -+ struct xmit_buf *pxmitbuf = NULL; -+ _list *plist, *phead; -+ _queue *pfree_queue = &pxmitpriv->free_xmit_extbuf_queue; -+ -+ -+ -+ _enter_critical(&pfree_queue->lock, &irqL); -+ -+ if(_rtw_queue_empty(pfree_queue) == true) { -+ pxmitbuf = NULL; -+ } else { -+ -+ phead = get_list_head(pfree_queue); -+ -+ plist = get_next(phead); -+ -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ -+ rtw_list_delete(&(pxmitbuf->list)); -+ } -+ -+ if (pxmitbuf != NULL) -+ { -+ pxmitpriv->free_xmit_extbuf_cnt--; -+ #ifdef DBG_XMIT_BUF_EXT -+ DBG_871X("DBG_XMIT_BUF_EXT ALLOC no=%d, free_xmit_extbuf_cnt=%d\n",pxmitbuf->no, pxmitpriv->free_xmit_extbuf_cnt); -+ #endif -+ -+ -+ pxmitbuf->priv_data = NULL; -+ -+ if (pxmitbuf->sctx) { -+ DBG_871X("%s pxmitbuf->sctx is not NULL\n", __func__); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); -+ } -+ -+ } -+ -+ _exit_critical(&pfree_queue->lock, &irqL); -+ -+ -+ -+ return pxmitbuf; -+} -+ -+s32 rtw_free_xmitbuf_ext(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf) -+{ -+ _irqL irqL; -+ _queue *pfree_queue = &pxmitpriv->free_xmit_extbuf_queue; -+ -+ -+ -+ if(pxmitbuf==NULL) -+ { -+ return _FAIL; -+ } -+ -+ _enter_critical(&pfree_queue->lock, &irqL); -+ -+ rtw_list_delete(&pxmitbuf->list); -+ -+ rtw_list_insert_tail(&(pxmitbuf->list), get_list_head(pfree_queue)); -+ pxmitpriv->free_xmit_extbuf_cnt++; -+ #ifdef DBG_XMIT_BUF_EXT -+ DBG_871X("DBG_XMIT_BUF_EXT FREE no=%d, free_xmit_extbuf_cnt=%d\n",pxmitbuf->no ,pxmitpriv->free_xmit_extbuf_cnt); -+ #endif -+ -+ _exit_critical(&pfree_queue->lock, &irqL); -+ -+ -+ -+ return _SUCCESS; -+} -+ -+struct xmit_buf *rtw_alloc_xmitbuf(struct xmit_priv *pxmitpriv) -+{ -+ _irqL irqL; -+ struct xmit_buf *pxmitbuf = NULL; -+ _list *plist, *phead; -+ _queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue; -+ -+ -+ -+ //DBG_871X("+rtw_alloc_xmitbuf\n"); -+ -+ _enter_critical(&pfree_xmitbuf_queue->lock, &irqL); -+ -+ if(_rtw_queue_empty(pfree_xmitbuf_queue) == true) { -+ pxmitbuf = NULL; -+ } else { -+ -+ phead = get_list_head(pfree_xmitbuf_queue); -+ -+ plist = get_next(phead); -+ -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ -+ rtw_list_delete(&(pxmitbuf->list)); -+ } -+ -+ if (pxmitbuf != NULL) -+ { -+ pxmitpriv->free_xmitbuf_cnt--; -+ #ifdef DBG_XMIT_BUF -+ DBG_871X("DBG_XMIT_BUF ALLOC no=%d, free_xmitbuf_cnt=%d\n",pxmitbuf->no, pxmitpriv->free_xmitbuf_cnt); -+ #endif -+ //DBG_871X("alloc, free_xmitbuf_cnt=%d\n", pxmitpriv->free_xmitbuf_cnt); -+ -+ pxmitbuf->priv_data = NULL; -+ -+ if (pxmitbuf->sctx) { -+ DBG_871X("%s pxmitbuf->sctx is not NULL\n", __func__); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_ALLOC); -+ } -+ } -+ #ifdef DBG_XMIT_BUF -+ else -+ { -+ DBG_871X("DBG_XMIT_BUF rtw_alloc_xmitbuf return NULL\n"); -+ } -+ #endif -+ -+ _exit_critical(&pfree_xmitbuf_queue->lock, &irqL); -+ -+ -+ -+ return pxmitbuf; -+} -+ -+s32 rtw_free_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf) -+{ -+ _irqL irqL; -+ _queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue; -+ -+ -+ -+ //DBG_871X("+rtw_free_xmitbuf\n"); -+ -+ if(pxmitbuf==NULL) -+ { -+ return _FAIL; -+ } -+ -+ if (pxmitbuf->sctx) { -+ DBG_871X("%s pxmitbuf->sctx is not NULL\n", __func__); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_BUF_FREE); -+ } -+ -+ if(pxmitbuf->buf_tag == XMITBUF_CMD) { -+ } -+ else if(pxmitbuf->buf_tag == XMITBUF_MGNT) { -+ rtw_free_xmitbuf_ext(pxmitpriv, pxmitbuf); -+ } -+ else -+ { -+ _enter_critical(&pfree_xmitbuf_queue->lock, &irqL); -+ -+ rtw_list_delete(&pxmitbuf->list); -+ -+ rtw_list_insert_tail(&(pxmitbuf->list), get_list_head(pfree_xmitbuf_queue)); -+ -+ pxmitpriv->free_xmitbuf_cnt++; -+ //DBG_871X("FREE, free_xmitbuf_cnt=%d\n", pxmitpriv->free_xmitbuf_cnt); -+ #ifdef DBG_XMIT_BUF -+ DBG_871X("DBG_XMIT_BUF FREE no=%d, free_xmitbuf_cnt=%d\n",pxmitbuf->no ,pxmitpriv->free_xmitbuf_cnt); -+ #endif -+ _exit_critical(&pfree_xmitbuf_queue->lock, &irqL); -+ } -+ -+ -+ -+ return _SUCCESS; -+} -+ -+static void rtw_init_xmitframe(struct xmit_frame *pxframe) -+{ -+ if (pxframe != NULL)//default value setting -+ { -+ pxframe->buf_addr = NULL; -+ pxframe->pxmitbuf = NULL; -+ -+ _rtw_memset(&pxframe->attrib, 0, sizeof(struct pkt_attrib)); -+ //pxframe->attrib.psta = NULL; -+ -+ pxframe->frame_tag = DATA_FRAMETAG; -+ -+ pxframe->pkt = NULL; -+ pxframe->pkt_offset = 1;//default use pkt_offset to fill tx desc -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ pxframe->agg_num = 1; -+#endif -+ -+#ifdef CONFIG_XMIT_ACK -+ pxframe->ack_report = 0; -+#endif -+ -+ } -+} -+ -+/* -+Calling context: -+1. OS_TXENTRY -+2. RXENTRY (rx_thread or RX_ISR/RX_CallBack) -+ -+If we turn on USE_RXTHREAD, then, no need for critical section. -+Otherwise, we must use _enter/_exit critical to protect free_xmit_queue... -+ -+Must be very very cautious... -+ -+*/ -+struct xmit_frame *rtw_alloc_xmitframe(struct xmit_priv *pxmitpriv)//(_queue *pfree_xmit_queue) -+{ -+ /* -+ Please remember to use all the osdep_service api, -+ and lock/unlock or _enter/_exit critical to protect -+ pfree_xmit_queue -+ */ -+ -+ _irqL irqL; -+ struct xmit_frame *pxframe = NULL; -+ _list *plist, *phead; -+ _queue *pfree_xmit_queue = &pxmitpriv->free_xmit_queue; -+ -+ -+ -+ _enter_critical_bh(&pfree_xmit_queue->lock, &irqL); -+ -+ if (_rtw_queue_empty(pfree_xmit_queue) == true) { -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_alloc_xmitframe:%d\n", pxmitpriv->free_xmitframe_cnt)); -+ pxframe = NULL; -+ } else { -+ phead = get_list_head(pfree_xmit_queue); -+ -+ plist = get_next(phead); -+ -+ pxframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ -+ rtw_list_delete(&(pxframe->list)); -+ pxmitpriv->free_xmitframe_cnt--; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("rtw_alloc_xmitframe():free_xmitframe_cnt=%d\n", pxmitpriv->free_xmitframe_cnt)); -+ } -+ -+ _exit_critical_bh(&pfree_xmit_queue->lock, &irqL); -+ -+ rtw_init_xmitframe(pxframe); -+ -+ -+ -+ return pxframe; -+} -+ -+struct xmit_frame *rtw_alloc_xmitframe_ext(struct xmit_priv *pxmitpriv) -+{ -+ _irqL irqL; -+ struct xmit_frame *pxframe = NULL; -+ _list *plist, *phead; -+ _queue *queue = &pxmitpriv->free_xframe_ext_queue; -+ -+ -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ if (_rtw_queue_empty(queue) == true) { -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_alloc_xmitframe_ext:%d\n", pxmitpriv->free_xframe_ext_cnt)); -+ pxframe = NULL; -+ } else { -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ pxframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ -+ rtw_list_delete(&(pxframe->list)); -+ pxmitpriv->free_xframe_ext_cnt--; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_info_, ("rtw_alloc_xmitframe_ext():free_xmitframe_cnt=%d\n", pxmitpriv->free_xframe_ext_cnt)); -+ } -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ rtw_init_xmitframe(pxframe); -+ -+ -+ -+ return pxframe; -+} -+ -+struct xmit_frame *rtw_alloc_xmitframe_once(struct xmit_priv *pxmitpriv) -+{ -+ struct xmit_frame *pxframe = NULL; -+ u8 *alloc_addr; -+ -+ alloc_addr = rtw_zmalloc(sizeof(struct xmit_frame) + 4); -+ -+ if (alloc_addr == NULL) -+ goto exit; -+ -+ pxframe = (struct xmit_frame *)N_BYTE_ALIGMENT((SIZE_PTR)(alloc_addr), 4); -+ pxframe->alloc_addr = alloc_addr; -+ -+ pxframe->padapter = pxmitpriv->adapter; -+ pxframe->frame_tag = NULL_FRAMETAG; -+ -+ pxframe->pkt = NULL; -+ -+ pxframe->buf_addr = NULL; -+ pxframe->pxmitbuf = NULL; -+ -+ rtw_init_xmitframe(pxframe); -+ -+ DBG_871X("################## %s ##################\n", __func__); -+ -+exit: -+ return pxframe; -+} -+ -+s32 rtw_free_xmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe) -+{ -+ _irqL irqL; -+ _queue *queue; -+ _adapter *padapter = pxmitpriv->adapter; -+ _pkt *pndis_pkt = NULL; -+ -+ -+ -+ if (pxmitframe == NULL) { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("======rtw_free_xmitframe():pxmitframe==NULL!!!!!!!!!!\n")); -+ goto exit; -+ } -+ -+ if (pxmitframe->pkt){ -+ pndis_pkt = pxmitframe->pkt; -+ pxmitframe->pkt = NULL; -+ } -+ -+ if (pxmitframe->alloc_addr) { -+ DBG_871X("################## %s with alloc_addr ##################\n", __func__); -+ rtw_mfree(pxmitframe->alloc_addr, sizeof(struct xmit_frame) + 4); -+ goto check_pkt_complete; -+ } -+ -+ if (pxmitframe->ext_tag == 0) -+ queue = &pxmitpriv->free_xmit_queue; -+ else if(pxmitframe->ext_tag == 1) -+ queue = &pxmitpriv->free_xframe_ext_queue; -+ else -+ {} -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ rtw_list_delete(&pxmitframe->list); -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(queue)); -+ if (pxmitframe->ext_tag == 0) { -+ pxmitpriv->free_xmitframe_cnt++; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_debug_, ("rtw_free_xmitframe():free_xmitframe_cnt=%d\n", pxmitpriv->free_xmitframe_cnt)); -+ } else if(pxmitframe->ext_tag == 1) { -+ pxmitpriv->free_xframe_ext_cnt++; -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_debug_, ("rtw_free_xmitframe():free_xframe_ext_cnt=%d\n", pxmitpriv->free_xframe_ext_cnt)); -+ } else { -+ } -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+check_pkt_complete: -+ -+ if(pndis_pkt) -+ rtw_os_pkt_complete(padapter, pndis_pkt); -+ -+exit: -+ -+ -+ -+ return _SUCCESS; -+} -+ -+void rtw_free_xmitframe_queue(struct xmit_priv *pxmitpriv, _queue *pframequeue) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct xmit_frame *pxmitframe; -+ -+ -+ -+ _enter_critical_bh(&(pframequeue->lock), &irqL); -+ -+ phead = get_list_head(pframequeue); -+ plist = get_next(phead); -+ -+ while (rtw_end_of_queue_search(phead, plist) == false) -+ { -+ -+ pxmitframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ -+ plist = get_next(plist); -+ -+ rtw_free_xmitframe(pxmitpriv,pxmitframe); -+ -+ } -+ _exit_critical_bh(&(pframequeue->lock), &irqL); -+ -+ -+} -+ -+s32 rtw_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ if (rtw_xmit_classifier(padapter, pxmitframe) == _FAIL) -+ { -+ RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, -+ ("rtw_xmitframe_enqueue: drop xmit pkt for classifier fail\n")); -+// pxmitframe->pkt = NULL; -+ return _FAIL; -+ } -+ -+ return _SUCCESS; -+} -+ -+static struct xmit_frame *dequeue_one_xmitframe(struct xmit_priv *pxmitpriv, struct hw_xmit *phwxmit, struct tx_servq *ptxservq, _queue *pframe_queue) -+{ -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe=NULL; -+ -+ xmitframe_phead = get_list_head(pframe_queue); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) -+ { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ ptxservq->qcnt--; -+ -+ break; -+ -+ pxmitframe = NULL; -+ } -+ -+ return pxmitframe; -+} -+ -+struct xmit_frame* rtw_dequeue_xframe(struct xmit_priv *pxmitpriv, struct hw_xmit *phwxmit_i, sint entry) -+{ -+ _irqL irqL0; -+ _list *sta_plist, *sta_phead; -+ struct hw_xmit *phwxmit; -+ struct tx_servq *ptxservq = NULL; -+ _queue *pframe_queue = NULL; -+ struct xmit_frame *pxmitframe = NULL; -+ _adapter *padapter = pxmitpriv->adapter; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ int i, inx[4]; -+ -+ -+ -+ inx[0] = 0; inx[1] = 1; inx[2] = 2; inx[3] = 3; -+ -+ if(pregpriv->wifi_spec==1) -+ { -+ int j, tmp, acirp_cnt[4]; -+#if 0 -+ if(flagswmm_para_seq[j]; -+ } -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ for(i = 0; i < entry; i++) -+ { -+ phwxmit = phwxmit_i + inx[i]; -+ -+ //_enter_critical_ex(&phwxmit->sta_queue->lock, &irqL0); -+ -+ sta_phead = get_list_head(phwxmit->sta_queue); -+ sta_plist = get_next(sta_phead); -+ -+ while ((rtw_end_of_queue_search(sta_phead, sta_plist)) == false) -+ { -+ -+ ptxservq= LIST_CONTAINOR(sta_plist, struct tx_servq, tx_pending); -+ -+ pframe_queue = &ptxservq->sta_pending; -+ -+ pxmitframe = dequeue_one_xmitframe(pxmitpriv, phwxmit, ptxservq, pframe_queue); -+ -+ if(pxmitframe) -+ { -+ phwxmit->accnt--; -+ -+ //Remove sta node when there is no pending packets. -+ if(_rtw_queue_empty(pframe_queue)) //must be done after get_next and before break -+ rtw_list_delete(&ptxservq->tx_pending); -+ -+ //_exit_critical_ex(&phwxmit->sta_queue->lock, &irqL0); -+ -+ goto exit; -+ } -+ -+ sta_plist = get_next(sta_plist); -+ -+ } -+ -+ //_exit_critical_ex(&phwxmit->sta_queue->lock, &irqL0); -+ -+ } -+ -+exit: -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ -+ -+ return pxmitframe; -+} -+ -+struct tx_servq *rtw_get_sta_pending(_adapter *padapter, struct sta_info *psta, sint up, u8 *ac) -+{ -+ struct tx_servq *ptxservq=NULL; -+ -+ -+ -+ switch (up) -+ { -+ case 1: -+ case 2: -+ ptxservq = &(psta->sta_xmitpriv.bk_q); -+ *(ac) = 3; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_get_sta_pending : BK \n")); -+ break; -+ -+ case 4: -+ case 5: -+ ptxservq = &(psta->sta_xmitpriv.vi_q); -+ *(ac) = 1; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_get_sta_pending : VI\n")); -+ break; -+ -+ case 6: -+ case 7: -+ ptxservq = &(psta->sta_xmitpriv.vo_q); -+ *(ac) = 0; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_get_sta_pending : VO \n")); -+ break; -+ -+ case 0: -+ case 3: -+ default: -+ ptxservq = &(psta->sta_xmitpriv.be_q); -+ *(ac) = 2; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_get_sta_pending : BE \n")); -+ break; -+ -+ } -+ -+ -+ -+ return ptxservq; -+} -+ -+/* -+ * Will enqueue pxmitframe to the proper queue, -+ * and indicate it to xx_pending list..... -+ */ -+s32 rtw_xmit_classifier(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ //_irqL irqL0; -+ u8 ac_index; -+ struct sta_info *psta; -+ struct tx_servq *ptxservq; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; -+ sint res = _SUCCESS; -+ -+ -+ -+/* -+ if (pattrib->psta) { -+ psta = pattrib->psta; -+ } else { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ psta = rtw_get_stainfo(pstapriv, pattrib->ra); -+ } -+*/ -+ -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if(pattrib->psta != psta) -+ { -+ DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return _FAIL; -+ } -+ -+ if (psta == NULL) { -+ res = _FAIL; -+ DBG_8192C("rtw_xmit_classifier: psta == NULL\n"); -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("rtw_xmit_classifier: psta == NULL\n")); -+ goto exit; -+ } -+ -+ if(!(psta->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return _FAIL; -+ } -+ -+ ptxservq = rtw_get_sta_pending(padapter, psta, pattrib->priority, (u8 *)(&ac_index)); -+ -+ //_enter_critical(&pstapending->lock, &irqL0); -+ -+ if (rtw_is_list_empty(&ptxservq->tx_pending)) { -+ rtw_list_insert_tail(&ptxservq->tx_pending, get_list_head(phwxmits[ac_index].sta_queue)); -+ } -+ -+ //_enter_critical(&ptxservq->sta_pending.lock, &irqL1); -+ -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&ptxservq->sta_pending)); -+ ptxservq->qcnt++; -+ phwxmits[ac_index].accnt++; -+ -+ //_exit_critical(&ptxservq->sta_pending.lock, &irqL1); -+ -+ //_exit_critical(&pstapending->lock, &irqL0); -+ -+exit: -+ -+ -+ -+ return res; -+} -+ -+void rtw_alloc_hwxmits(_adapter *padapter) -+{ -+ struct hw_xmit *hwxmits; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ pxmitpriv->hwxmit_entry = HWXMIT_ENTRY; -+ -+ pxmitpriv->hwxmits = (struct hw_xmit *)rtw_zmalloc(sizeof (struct hw_xmit) * pxmitpriv->hwxmit_entry); -+ -+ hwxmits = pxmitpriv->hwxmits; -+ -+ if(pxmitpriv->hwxmit_entry == 5) -+ { -+ //pxmitpriv->bmc_txqueue.head = 0; -+ //hwxmits[0] .phwtxqueue = &pxmitpriv->bmc_txqueue; -+ hwxmits[0] .sta_queue = &pxmitpriv->bm_pending; -+ -+ //pxmitpriv->vo_txqueue.head = 0; -+ //hwxmits[1] .phwtxqueue = &pxmitpriv->vo_txqueue; -+ hwxmits[1] .sta_queue = &pxmitpriv->vo_pending; -+ -+ //pxmitpriv->vi_txqueue.head = 0; -+ //hwxmits[2] .phwtxqueue = &pxmitpriv->vi_txqueue; -+ hwxmits[2] .sta_queue = &pxmitpriv->vi_pending; -+ -+ //pxmitpriv->bk_txqueue.head = 0; -+ //hwxmits[3] .phwtxqueue = &pxmitpriv->bk_txqueue; -+ hwxmits[3] .sta_queue = &pxmitpriv->bk_pending; -+ -+ //pxmitpriv->be_txqueue.head = 0; -+ //hwxmits[4] .phwtxqueue = &pxmitpriv->be_txqueue; -+ hwxmits[4] .sta_queue = &pxmitpriv->be_pending; -+ -+ } -+ else if(pxmitpriv->hwxmit_entry == 4) -+ { -+ -+ //pxmitpriv->vo_txqueue.head = 0; -+ //hwxmits[0] .phwtxqueue = &pxmitpriv->vo_txqueue; -+ hwxmits[0] .sta_queue = &pxmitpriv->vo_pending; -+ -+ //pxmitpriv->vi_txqueue.head = 0; -+ //hwxmits[1] .phwtxqueue = &pxmitpriv->vi_txqueue; -+ hwxmits[1] .sta_queue = &pxmitpriv->vi_pending; -+ -+ //pxmitpriv->be_txqueue.head = 0; -+ //hwxmits[2] .phwtxqueue = &pxmitpriv->be_txqueue; -+ hwxmits[2] .sta_queue = &pxmitpriv->be_pending; -+ -+ //pxmitpriv->bk_txqueue.head = 0; -+ //hwxmits[3] .phwtxqueue = &pxmitpriv->bk_txqueue; -+ hwxmits[3] .sta_queue = &pxmitpriv->bk_pending; -+ } -+ else -+ { -+ -+ -+ } -+ -+ -+} -+ -+void rtw_free_hwxmits(_adapter *padapter) -+{ -+ struct hw_xmit *hwxmits; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ hwxmits = pxmitpriv->hwxmits; -+ if(hwxmits) -+ rtw_mfree((u8 *)hwxmits, (sizeof (struct hw_xmit) * pxmitpriv->hwxmit_entry)); -+} -+ -+void rtw_init_hwxmits(struct hw_xmit *phwxmit, sint entry) -+{ -+ sint i; -+ -+ for(i = 0; i < entry; i++, phwxmit++) -+ { -+ //_rtw_spinlock_init(&phwxmit->xmit_lock); -+ //_rtw_init_listhead(&phwxmit->pending); -+ //phwxmit->txcmdcnt = 0; -+ phwxmit->accnt = 0; -+ } -+ -+} -+ -+#ifdef CONFIG_BR_EXT -+static int rtw_br_client_tx(_adapter *padapter, struct sk_buff **pskb) -+{ -+ struct sk_buff *skb = *pskb; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _irqL irqL; -+ //if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == true) -+ { -+ int res, is_vlan_tag=0, i, do_nat25=1; -+ unsigned short vlan_hdr=0; -+ void *br_port = NULL; -+ -+ //mac_clone_handle_frame(priv, skb); -+ -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ br_port = padapter->pnetdev->br_port; -+#else // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ rcu_read_lock(); -+ br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); -+ rcu_read_unlock(); -+#endif // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ _enter_critical_bh(&padapter->br_ext_lock, &irqL); -+ if ( !(skb->data[0] & 1) && -+ br_port && -+ memcmp(skb->data+MACADDRLEN, padapter->br_mac, MACADDRLEN) && -+ *((__be16 *)(skb->data+MACADDRLEN*2)) != __constant_htons(ETH_P_8021Q) && -+ *((__be16 *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_IP) && -+ !memcmp(padapter->scdb_mac, skb->data+MACADDRLEN, MACADDRLEN) && padapter->scdb_entry) { -+ memcpy(skb->data+MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); -+ padapter->scdb_entry->ageing_timer = jiffies; -+ _exit_critical_bh(&padapter->br_ext_lock, &irqL); -+ } -+ else -+ //if (!priv->pmib->ethBrExtInfo.nat25_disable) -+ { -+// if (priv->dev->br_port && -+// !memcmp(skb->data+MACADDRLEN, priv->br_mac, MACADDRLEN)) { -+#if 1 -+ if (*((__be16 *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_8021Q)) { -+ is_vlan_tag = 1; -+ vlan_hdr = *((unsigned short *)(skb->data+MACADDRLEN*2+2)); -+ for (i=0; i<6; i++) -+ *((unsigned short *)(skb->data+MACADDRLEN*2+2-i*2)) = *((unsigned short *)(skb->data+MACADDRLEN*2-2-i*2)); -+ skb_pull(skb, 4); -+ } -+ //if SA == br_mac && skb== IP => copy SIP to br_ip ?? why -+ if (!memcmp(skb->data+MACADDRLEN, padapter->br_mac, MACADDRLEN) && -+ (*((__be16 *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_IP))) -+ memcpy(padapter->br_ip, skb->data+WLAN_ETHHDR_LEN+12, 4); -+ -+ if (*((__be16 *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_IP)) { -+ if (memcmp(padapter->scdb_mac, skb->data+MACADDRLEN, MACADDRLEN)) { -+ if ((padapter->scdb_entry = (struct nat25_network_db_entry *)scdb_findEntry(padapter, -+ skb->data+MACADDRLEN, skb->data+WLAN_ETHHDR_LEN+12)) != NULL) { -+ memcpy(padapter->scdb_mac, skb->data+MACADDRLEN, MACADDRLEN); -+ memcpy(padapter->scdb_ip, skb->data+WLAN_ETHHDR_LEN+12, 4); -+ padapter->scdb_entry->ageing_timer = jiffies; -+ do_nat25 = 0; -+ } -+ } -+ else { -+ if (padapter->scdb_entry) { -+ padapter->scdb_entry->ageing_timer = jiffies; -+ do_nat25 = 0; -+ } -+ else { -+ memset(padapter->scdb_mac, 0, MACADDRLEN); -+ memset(padapter->scdb_ip, 0, 4); -+ } -+ } -+ } -+ _exit_critical_bh(&padapter->br_ext_lock, &irqL); -+#endif // 1 -+ if (do_nat25) -+ { -+ if (nat25_db_handle(padapter, skb, NAT25_CHECK) == 0) { -+ struct sk_buff *newskb; -+ -+ if (is_vlan_tag) { -+ skb_push(skb, 4); -+ for (i=0; i<6; i++) -+ *((unsigned short *)(skb->data+i*2)) = *((unsigned short *)(skb->data+4+i*2)); -+ *((__be16 *)(skb->data+MACADDRLEN*2)) = __constant_htons(ETH_P_8021Q); -+ *((unsigned short *)(skb->data+MACADDRLEN*2+2)) = vlan_hdr; -+ } -+ -+ newskb = skb_copy(skb, GFP_ATOMIC); -+ if (newskb == NULL) { -+ //priv->ext_stats.tx_drops++; -+ DEBUG_ERR("TX DROP: skb_copy fail!\n"); -+ //goto stop_proc; -+ return -1; -+ } -+ dev_kfree_skb_any(skb); -+ -+ *pskb = skb = newskb; -+ if (is_vlan_tag) { -+ vlan_hdr = *((unsigned short *)(skb->data+MACADDRLEN*2+2)); -+ for (i=0; i<6; i++) -+ *((unsigned short *)(skb->data+MACADDRLEN*2+2-i*2)) = *((unsigned short *)(skb->data+MACADDRLEN*2-2-i*2)); -+ skb_pull(skb, 4); -+ } -+ } -+ -+ if (skb_is_nonlinear(skb)) -+ DEBUG_ERR("%s(): skb_is_nonlinear!!\n", __FUNCTION__); -+ -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 18)) -+ res = skb_linearize(skb, GFP_ATOMIC); -+#else // (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 18)) -+ res = skb_linearize(skb); -+#endif // (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 18)) -+ if (res < 0) { -+ DEBUG_ERR("TX DROP: skb_linearize fail!\n"); -+ //goto free_and_stop; -+ return -1; -+ } -+ -+ res = nat25_db_handle(padapter, skb, NAT25_INSERT); -+ if (res < 0) { -+ if (res == -2) { -+ //priv->ext_stats.tx_drops++; -+ DEBUG_ERR("TX DROP: nat25_db_handle fail!\n"); -+ //goto free_and_stop; -+ return -1; -+ -+ } -+ // we just print warning message and let it go -+ //DEBUG_WARN("%s()-%d: nat25_db_handle INSERT Warning!\n", __FUNCTION__, __LINE__); -+ //return -1; // return -1 will cause system crash on 2011/08/30! -+ return 0; -+ } -+ } -+ -+ memcpy(skb->data+MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); -+ -+ dhcp_flag_bcast(padapter, skb); -+ -+ if (is_vlan_tag) { -+ skb_push(skb, 4); -+ for (i=0; i<6; i++) -+ *((unsigned short *)(skb->data+i*2)) = *((unsigned short *)(skb->data+4+i*2)); -+ *((__be16 *)(skb->data+MACADDRLEN*2)) = __constant_htons(ETH_P_8021Q); -+ *((unsigned short *)(skb->data+MACADDRLEN*2+2)) = vlan_hdr; -+ } -+ } -+#if 0 -+ else{ -+ if (*((unsigned short *)(skb->data+MACADDRLEN*2)) == __constant_htons(ETH_P_8021Q)) { -+ is_vlan_tag = 1; -+ } -+ -+ if(is_vlan_tag){ -+ if(ICMPV6_MCAST_MAC(skb->data) && ICMPV6_PROTO1A_VALN(skb->data)){ -+ memcpy(skb->data+MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); -+ } -+ }else -+ { -+ if(ICMPV6_MCAST_MAC(skb->data) && ICMPV6_PROTO1A(skb->data)){ -+ memcpy(skb->data+MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN); -+ } -+ } -+ } -+#endif // 0 -+ -+ // check if SA is equal to our MAC -+ if (memcmp(skb->data+MACADDRLEN, GET_MY_HWADDR(padapter), MACADDRLEN)) { -+ //priv->ext_stats.tx_drops++; -+ DEBUG_ERR("TX DROP: untransformed frame SA:%02X%02X%02X%02X%02X%02X!\n", -+ skb->data[6],skb->data[7],skb->data[8],skb->data[9],skb->data[10],skb->data[11]); -+ //goto free_and_stop; -+ return -1; -+ } -+ } -+ return 0; -+} -+#endif // CONFIG_BR_EXT -+ -+u32 rtw_get_ff_hwaddr(struct xmit_frame *pxmitframe) -+{ -+ u32 addr; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+ switch(pattrib->qsel) -+ { -+ case 0: -+ case 3: -+ addr = BE_QUEUE_INX; -+ break; -+ case 1: -+ case 2: -+ addr = BK_QUEUE_INX; -+ break; -+ case 4: -+ case 5: -+ addr = VI_QUEUE_INX; -+ break; -+ case 6: -+ case 7: -+ addr = VO_QUEUE_INX; -+ break; -+ case 0x10: -+ addr = BCN_QUEUE_INX; -+ break; -+ case 0x11://BC/MC in PS (HIQ) -+ addr = HIGH_QUEUE_INX; -+ break; -+ case 0x12: -+ default: -+ addr = MGT_QUEUE_INX; -+ break; -+ -+ } -+ -+ return addr; -+ -+} -+ -+static void do_queue_select(_adapter *padapter, struct pkt_attrib *pattrib) -+{ -+ u8 qsel; -+ -+ qsel = pattrib->priority; -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("### do_queue_select priority=%d ,qsel = %d\n",pattrib->priority ,qsel)); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+// if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == true) -+// qsel = 7;// -+#endif -+ -+ pattrib->qsel = qsel; -+} -+ -+/* -+ * The main transmit(tx) entry -+ * -+ * Return -+ * 1 enqueue -+ * 0 success, hardware will handle this xmit frame(packet) -+ * <0 fail -+ */ -+s32 rtw_xmit(_adapter *padapter, _pkt **ppkt) -+{ -+ static u32 start = 0; -+ static u32 drop_cnt = 0; -+#ifdef CONFIG_AP_MODE -+ _irqL irqL0; -+#endif -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_frame *pxmitframe = NULL; -+#ifdef CONFIG_BR_EXT -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ void *br_port = NULL; -+#endif // CONFIG_BR_EXT -+ -+ s32 res; -+ -+ if (start == 0) -+ start = rtw_get_current_time(); -+ -+ pxmitframe = rtw_alloc_xmitframe(pxmitpriv); -+ -+ if (rtw_get_passing_time_ms(start) > 2000) { -+ if (drop_cnt) -+ DBG_871X("DBG_TX_DROP_FRAME %s no more pxmitframe, drop_cnt:%u\n", __FUNCTION__, drop_cnt); -+ start = rtw_get_current_time(); -+ drop_cnt = 0; -+ } -+ -+ if (pxmitframe == NULL) { -+ drop_cnt ++; -+ RT_TRACE(_module_xmit_osdep_c_, _drv_err_, ("rtw_xmit: no more pxmitframe\n")); -+ return -1; -+ } -+ -+#ifdef CONFIG_BR_EXT -+ -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ br_port = padapter->pnetdev->br_port; -+#else // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ rcu_read_lock(); -+ br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); -+ rcu_read_unlock(); -+#endif // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ -+ if( br_port && check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == true) -+ { -+ res = rtw_br_client_tx(padapter, ppkt); -+ if (res == -1) -+ { -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ return -1; -+ } -+ } -+ -+#endif // CONFIG_BR_EXT -+ -+ res = update_attrib(padapter, *ppkt, &pxmitframe->attrib); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(pxmitframe->attrib.ether_type != 0x88B4) -+ { -+ if(rtw_wapi_drop_for_key_absent(padapter, pxmitframe->attrib.ra)) -+ { -+ WAPI_TRACE(WAPI_RX,"drop for key absend when tx \n"); -+ res = _FAIL; -+ } -+ } -+#endif -+ if (res == _FAIL) { -+ RT_TRACE(_module_xmit_osdep_c_, _drv_err_, ("rtw_xmit: update attrib fail\n")); -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s update attrib fail\n", __FUNCTION__); -+ #endif -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ return -1; -+ } -+ pxmitframe->pkt = *ppkt; -+ -+ rtw_led_control(padapter, LED_CTL_TX); -+ -+ do_queue_select(padapter, &pxmitframe->attrib); -+ -+#ifdef CONFIG_AP_MODE -+ _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ if(xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe) == true) -+ { -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ return 1; -+ } -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+#endif -+ -+ if (rtw_hal_xmit(padapter, pxmitframe) == false) -+ return 1; -+ -+ return 0; -+} -+ -+#ifdef CONFIG_TDLS -+sint xmitframe_enqueue_for_tdls_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ sint ret=false; -+ -+ _irqL irqL; -+ struct sta_info *ptdls_sta=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ int i; -+ -+ ptdls_sta=rtw_get_stainfo(pstapriv, pattrib->dst); -+ if(ptdls_sta==NULL){ -+ return ret; -+ }else if(ptdls_sta->tdls_sta_state&TDLS_LINKED_STATE){ -+ -+ if(pattrib->triggered==1) -+ { -+ ret = true; -+ return ret; -+ } -+ -+ _enter_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); -+ -+ if(ptdls_sta->state&WIFI_SLEEP_STATE) -+ { -+ rtw_list_delete(&pxmitframe->list); -+ -+ //_enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&ptdls_sta->sleep_q)); -+ -+ ptdls_sta->sleepq_len++; -+ ptdls_sta->sleepq_ac_len++; -+ -+ //indicate 4-AC queue bit in TDLS peer traffic indication -+ switch(pattrib->priority) -+ { -+ case 1: -+ case 2: -+ ptdls_sta->uapsd_bk = ptdls_sta->uapsd_bk | BIT(1); -+ break; -+ case 4: -+ case 5: -+ ptdls_sta->uapsd_vi = ptdls_sta->uapsd_vi | BIT(1); -+ break; -+ case 6: -+ case 7: -+ ptdls_sta->uapsd_vo = ptdls_sta->uapsd_vo | BIT(1); -+ break; -+ case 0: -+ case 3: -+ default: -+ ptdls_sta->uapsd_be = ptdls_sta->uapsd_be | BIT(1); -+ break; -+ } -+ -+ if(ptdls_sta->sleepq_len==1) -+ { -+ //transmit TDLS PTI via AP -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_SD_PTI); -+ } -+ ret = true; -+ -+ } -+ -+ _exit_critical_bh(&ptdls_sta->sleep_q.lock, &irqL); -+ } -+ -+ return ret; -+ -+} -+#endif //CONFIG_TDLS -+ -+#if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) -+ -+sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ _irqL irqL; -+ sint ret=false; -+ struct sta_info *psta=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ sint bmcst = IS_MCAST(pattrib->ra); -+#ifdef CONFIG_TDLS -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ -+ if( ptdlsinfo->setup_state == TDLS_LINKED_STATE ) -+ { -+ ret = xmitframe_enqueue_for_tdls_sleeping_sta(padapter, pxmitframe); -+ return ret; -+ } -+#endif //CONFIG_TDLS -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == false) -+ return ret; -+/* -+ if(pattrib->psta) -+ { -+ psta = pattrib->psta; -+ } -+ else -+ { -+ DBG_871X("%s, call rtw_get_stainfo()\n", __func__); -+ psta=rtw_get_stainfo(pstapriv, pattrib->ra); -+ } -+*/ -+ psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); -+ if(pattrib->psta != psta) -+ { -+ DBG_871X("%s, pattrib->psta(%p) != psta(%p)\n", __func__, pattrib->psta, psta); -+ return false; -+ } -+ -+ if(psta==NULL) -+ { -+ DBG_871X("%s, psta==NUL\n", __func__); -+ return false; -+ } -+ -+ if(!(psta->state &_FW_LINKED)) -+ { -+ DBG_871X("%s, psta->state(0x%x) != _FW_LINKED\n", __func__, psta->state); -+ return false; -+ } -+ -+ if(pattrib->triggered==1) -+ { -+ //DBG_871X("directly xmit pspoll_triggered packet\n"); -+ -+ //pattrib->triggered=0; -+ -+ if(bmcst) -+ pattrib->qsel = 0x11;//HIQ -+ -+ -+ return ret; -+ } -+ -+ -+ if(bmcst) -+ { -+ _enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ if(pstapriv->sta_dz_bitmap)//if anyone sta is in ps mode -+ { -+ //pattrib->qsel = 0x11;//HIQ -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ //_enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&psta->sleep_q)); -+ -+ psta->sleepq_len++; -+ -+ pstapriv->tim_bitmap |= BIT(0);// -+ pstapriv->sta_dz_bitmap |= BIT(0); -+ -+ //DBG_871X("enqueue, sq_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); -+ -+ update_beacon(padapter, _TIM_IE_, NULL, false);//tx bc/mc packets after upate bcn -+ -+ //_exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ ret = true; -+ -+ } -+ -+ _exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ return ret; -+ -+ } -+ -+ -+ _enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ if(psta->state&WIFI_SLEEP_STATE) -+ { -+ u8 wmmps_ac=0; -+ -+ if(pstapriv->sta_dz_bitmap&BIT(psta->aid)) -+ { -+ rtw_list_delete(&pxmitframe->list); -+ -+ //_enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ rtw_list_insert_tail(&pxmitframe->list, get_list_head(&psta->sleep_q)); -+ -+ psta->sleepq_len++; -+ -+ switch(pattrib->priority) -+ { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk&BIT(0); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi&BIT(0); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo&BIT(0); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be&BIT(0); -+ break; -+ } -+ -+ if(wmmps_ac) -+ psta->sleepq_ac_len++; -+ -+ if(((psta->has_legacy_ac) && (!wmmps_ac)) ||((!psta->has_legacy_ac)&&(wmmps_ac))) -+ { -+ pstapriv->tim_bitmap |= BIT(psta->aid); -+ -+ //DBG_871X("enqueue, sq_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); -+ -+ if(psta->sleepq_len==1) -+ { -+ //DBG_871X("sleepq_len==1, update BCNTIM\n"); -+ //upate BCN for TIM IE -+ update_beacon(padapter, _TIM_IE_, NULL, false); -+ } -+ } -+ -+ //_exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ //if(psta->sleepq_len > (NR_XMITFRAME>>3)) -+ //{ -+ // wakeup_sta_to_xmit(padapter, psta); -+ //} -+ -+ ret = true; -+ -+ } -+ -+ } -+ -+ _exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ -+ return ret; -+ -+} -+ -+static void dequeue_xmitframes_to_sleeping_queue(_adapter *padapter, struct sta_info *psta, _queue *pframequeue) -+{ -+ sint ret; -+ _list *plist, *phead; -+ u8 ac_index; -+ struct tx_servq *ptxservq; -+ struct pkt_attrib *pattrib; -+ struct xmit_frame *pxmitframe; -+ struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; -+ -+ phead = get_list_head(pframequeue); -+ plist = get_next(phead); -+ -+ while (rtw_end_of_queue_search(phead, plist) == false) -+ { -+ pxmitframe = LIST_CONTAINOR(plist, struct xmit_frame, list); -+ -+ plist = get_next(plist); -+ -+ ret = xmitframe_enqueue_for_sleeping_sta(padapter, pxmitframe); -+ -+ if(true == ret) -+ { -+ pattrib = &pxmitframe->attrib; -+ -+ ptxservq = rtw_get_sta_pending(padapter, psta, pattrib->priority, (u8 *)(&ac_index)); -+ -+ ptxservq->qcnt--; -+ phwxmits[ac_index].accnt--; -+ } -+ else -+ { -+ //DBG_871X("xmitframe_enqueue_for_sleeping_sta return false\n"); -+ } -+ -+ } -+ -+} -+ -+void stop_sta_xmit(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL0; -+ struct sta_info *psta_bmc; -+ struct sta_xmit_priv *pstaxmitpriv; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ pstaxmitpriv = &psta->sta_xmitpriv; -+ -+ //for BC/MC Frames -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ psta->state |= WIFI_SLEEP_STATE; -+ -+#ifdef CONFIG_TDLS -+ if( !(psta->tdls_sta_state & TDLS_LINKED_STATE) ) -+#endif //CONFIG_TDLS -+ pstapriv->sta_dz_bitmap |= BIT(psta->aid); -+ -+ -+ -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->vo_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending)); -+ -+ -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->vi_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->vi_q.tx_pending)); -+ -+ -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->be_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); -+ -+ -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->bk_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending)); -+ -+#ifdef CONFIG_TDLS -+ if( !(psta->tdls_sta_state & TDLS_LINKED_STATE) ) -+ { -+ if( psta_bmc != NULL ) -+ { -+#endif //CONFIG_TDLS -+ -+ -+ //for BC/MC Frames -+ pstaxmitpriv = &psta_bmc->sta_xmitpriv; -+ dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->be_q.sta_pending); -+ rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); -+ -+ -+#ifdef CONFIG_TDLS -+ } -+ } -+#endif //CONFIG_TDLS -+ _exit_critical_bh(&pxmitpriv->lock, &irqL0); -+ -+ -+} -+ -+void wakeup_sta_to_xmit(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL; -+ u8 update_mask=0, wmmps_ac=0; -+ struct sta_info *psta_bmc; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ psta_bmc = rtw_get_bcmc_stainfo(padapter); -+ -+ -+ //_enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&psta->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) -+ { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ switch(pxmitframe->attrib.priority) -+ { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk&BIT(1); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi&BIT(1); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo&BIT(1); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be&BIT(1); -+ break; -+ } -+ -+ psta->sleepq_len--; -+ if(psta->sleepq_len>0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ if(wmmps_ac) -+ { -+ psta->sleepq_ac_len--; -+ if(psta->sleepq_ac_len>0) -+ { -+ pxmitframe->attrib.mdata = 1; -+ pxmitframe->attrib.eosp = 0; -+ } -+ else -+ { -+ pxmitframe->attrib.mdata = 0; -+ pxmitframe->attrib.eosp = 1; -+ } -+ } -+ -+ pxmitframe->attrib.triggered = 1; -+ -+/* -+ _exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ if(rtw_hal_xmit(padapter, pxmitframe) == true) -+ { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ } -+ _enter_critical_bh(&psta->sleep_q.lock, &irqL); -+*/ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ -+ } -+ -+ //for BC/MC Frames -+ if(!psta_bmc) -+ goto _exit; -+ -+ if((pstapriv->sta_dz_bitmap&0xfffe) == 0x0)//no any sta in ps mode -+ { -+ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) -+ { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ psta_bmc->sleepq_len--; -+ if(psta_bmc->sleepq_len>0) -+ pxmitframe->attrib.mdata = 1; -+ else -+ pxmitframe->attrib.mdata = 0; -+ -+ -+ pxmitframe->attrib.triggered = 1; -+/* -+ _exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); -+ if(rtw_hal_xmit(padapter, pxmitframe) == true) -+ { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ } -+ _enter_critical_bh(&psta_bmc->sleep_q.lock, &irqL); -+ -+*/ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ } -+ -+ if(psta_bmc->sleepq_len==0) -+ { -+ pstapriv->tim_bitmap &= ~BIT(0); -+ pstapriv->sta_dz_bitmap &= ~BIT(0); -+ -+ //DBG_871X("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); -+ //upate BCN for TIM IE -+ //update_BCNTIM(padapter); -+ update_mask |= BIT(1); -+ } -+ -+ } -+ -+ if(psta->sleepq_len==0) -+ { -+#ifdef CONFIG_TDLS -+ if( psta->tdls_sta_state & TDLS_LINKED_STATE ) -+ { -+ if(psta->state&WIFI_SLEEP_STATE) -+ psta->state ^= WIFI_SLEEP_STATE; -+ -+ goto _exit; -+ } -+#endif //CONFIG_TDLS -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ //DBG_871X("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); -+ //upate BCN for TIM IE -+ //update_BCNTIM(padapter); -+ update_mask = BIT(0); -+ -+ if(psta->state&WIFI_SLEEP_STATE) -+ psta->state ^= WIFI_SLEEP_STATE; -+ -+ if(psta->state & WIFI_STA_ALIVE_CHK_STATE) -+ { -+ psta->expire_to = pstapriv->expire_to; -+ psta->state ^= WIFI_STA_ALIVE_CHK_STATE; -+ } -+ -+ pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); -+ } -+ -+_exit: -+ -+ //_exit_critical_bh(&psta_bmc->sleep_q.lock, &irqL); -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ if(update_mask) -+ { -+ //update_BCNTIM(padapter); -+ //printk("%s => call update_beacon\n",__FUNCTION__); -+ update_beacon(padapter, _TIM_IE_, NULL, false); -+ } -+ -+} -+ -+void xmit_delivery_enabled_frames(_adapter *padapter, struct sta_info *psta) -+{ -+ _irqL irqL; -+ u8 wmmps_ac=0; -+ _list *xmitframe_plist, *xmitframe_phead; -+ struct xmit_frame *pxmitframe=NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ -+ //_enter_critical_bh(&psta->sleep_q.lock, &irqL); -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&psta->sleep_q); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == false) -+ { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ switch(pxmitframe->attrib.priority) -+ { -+ case 1: -+ case 2: -+ wmmps_ac = psta->uapsd_bk&BIT(1); -+ break; -+ case 4: -+ case 5: -+ wmmps_ac = psta->uapsd_vi&BIT(1); -+ break; -+ case 6: -+ case 7: -+ wmmps_ac = psta->uapsd_vo&BIT(1); -+ break; -+ case 0: -+ case 3: -+ default: -+ wmmps_ac = psta->uapsd_be&BIT(1); -+ break; -+ } -+ -+ if(!wmmps_ac) -+ continue; -+ -+ rtw_list_delete(&pxmitframe->list); -+ -+ psta->sleepq_len--; -+ psta->sleepq_ac_len--; -+ -+ if(psta->sleepq_ac_len>0) -+ { -+ pxmitframe->attrib.mdata = 1; -+ pxmitframe->attrib.eosp = 0; -+ } -+ else -+ { -+ pxmitframe->attrib.mdata = 0; -+ pxmitframe->attrib.eosp = 1; -+ } -+ -+ pxmitframe->attrib.triggered = 1; -+ -+/* -+ if(rtw_hal_xmit(padapter, pxmitframe) == true) -+ { -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ } -+*/ -+ rtw_hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ if((psta->sleepq_ac_len==0) && (!psta->has_legacy_ac) && (wmmps_ac)) -+ { -+#ifdef CONFIG_TDLS -+ if(psta->tdls_sta_state & TDLS_LINKED_STATE ) -+ { -+ //_exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ return; -+ } -+#endif //CONFIG_TDLS -+ pstapriv->tim_bitmap &= ~BIT(psta->aid); -+ -+ //DBG_871X("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); -+ //upate BCN for TIM IE -+ //update_BCNTIM(padapter); -+ update_beacon(padapter, _TIM_IE_, NULL, false); -+ //update_mask = BIT(0); -+ } -+ -+ } -+ -+ //_exit_critical_bh(&psta->sleep_q.lock, &irqL); -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+} -+ -+#endif -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+void enqueue_pending_xmitbuf( -+ struct xmit_priv *pxmitpriv, -+ struct xmit_buf *pxmitbuf) -+{ -+ _irqL irql; -+ _queue *pqueue; -+ _adapter *pri_adapter = pxmitpriv->adapter; -+ -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ _enter_critical_bh(&pqueue->lock, &irql); -+ rtw_list_delete(&pxmitbuf->list); -+ rtw_list_insert_tail(&pxmitbuf->list, get_list_head(pqueue)); -+ _exit_critical_bh(&pqueue->lock, &irql); -+ -+ -+ -+ if (pri_adapter->adapter_type > PRIMARY_ADAPTER) -+ pri_adapter = pri_adapter->pbuddy_adapter; -+ _rtw_up_sema(&(pri_adapter->xmitpriv.xmit_sema)); -+ -+} -+ -+struct xmit_buf* dequeue_pending_xmitbuf( -+ struct xmit_priv *pxmitpriv) -+{ -+ _irqL irql; -+ struct xmit_buf *pxmitbuf; -+ _queue *pqueue; -+ -+ -+ pxmitbuf = NULL; -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ _enter_critical_bh(&pqueue->lock, &irql); -+ -+ if (_rtw_queue_empty(pqueue) == false) -+ { -+ _list *plist, *phead; -+ -+ phead = get_list_head(pqueue); -+ plist = get_next(phead); -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ rtw_list_delete(&pxmitbuf->list); -+ } -+ -+ _exit_critical_bh(&pqueue->lock, &irql); -+ -+ return pxmitbuf; -+} -+ -+struct xmit_buf* dequeue_pending_xmitbuf_under_survey( -+ struct xmit_priv *pxmitpriv) -+{ -+ _irqL irql; -+ struct xmit_buf *pxmitbuf; -+ struct xmit_frame *pxmitframe; -+ _queue *pqueue; -+ -+ -+ pxmitbuf = NULL; -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ _enter_critical_bh(&pqueue->lock, &irql); -+ -+ if (_rtw_queue_empty(pqueue) == false) -+ { -+ _list *plist, *phead; -+ u8 type; -+ -+ phead = get_list_head(pqueue); -+ plist = phead; -+ do { -+ plist = get_next(plist); -+ if (plist == phead) break; -+ -+ pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); -+ -+ pxmitframe = (struct xmit_frame*)pxmitbuf->priv_data; -+ if(pxmitframe) -+ { -+ type = GetFrameSubType(pxmitbuf->pbuf + TXDESC_SIZE + pxmitframe->pkt_offset * PACKET_OFFSET_SZ); -+ } -+ else -+ { -+ DBG_871X("%s, !!!ERROR!!! For USB, TODO ITEM \n", __FUNCTION__); -+ } -+ -+ if ((type == WIFI_PROBEREQ) || -+ (type == WIFI_DATA_NULL) || -+ (type == WIFI_QOS_DATA_NULL)) -+ { -+ rtw_list_delete(&pxmitbuf->list); -+ break; -+ } -+ pxmitbuf = NULL; -+ } while (1); -+ } -+ -+ _exit_critical_bh(&pqueue->lock, &irql); -+ -+ return pxmitbuf; -+} -+ -+sint check_pending_xmitbuf( -+ struct xmit_priv *pxmitpriv) -+{ -+ _queue *pqueue; -+ -+ pqueue = &pxmitpriv->pending_xmitbuf_queue; -+ -+ if(_rtw_queue_empty(pqueue) == false) -+ return true; -+ else -+ return false; -+} -+ -+thread_return rtw_xmit_thread(thread_context context) -+{ -+ s32 err; -+ PADAPTER padapter; -+ -+ -+ err = _SUCCESS; -+ padapter = (PADAPTER)context; -+ -+ thread_enter("RTW_XMIT_THREAD"); -+ -+ do { -+ err = rtw_hal_xmit_thread_handler(padapter); -+ flush_signals_thread(); -+ } while (_SUCCESS == err); -+ -+ _rtw_up_sema(&padapter->xmitpriv.terminate_xmitthread_sema); -+ -+ thread_exit(); -+} -+#endif -+ -+void rtw_sctx_init(struct submit_ctx *sctx, int timeout_ms) -+{ -+ sctx->timeout_ms = timeout_ms; -+ sctx->submit_time= rtw_get_current_time(); -+ init_completion(&sctx->done); -+ sctx->status = RTW_SCTX_SUBMITTED; -+} -+ -+int rtw_sctx_wait(struct submit_ctx *sctx) -+{ -+ int ret = _FAIL; -+ unsigned long expire; -+ int status = 0; -+ -+ expire= sctx->timeout_ms ? msecs_to_jiffies(sctx->timeout_ms) : MAX_SCHEDULE_TIMEOUT; -+ if (!wait_for_completion_timeout(&sctx->done, expire)) { -+ /* timeout, do something?? */ -+ status = RTW_SCTX_DONE_TIMEOUT; -+ DBG_871X("%s timeout\n", __func__); -+ } else { -+ status = sctx->status; -+ } -+ if (status == RTW_SCTX_DONE_SUCCESS) { -+ ret = _SUCCESS; -+ } -+ -+ return ret; -+} -+ -+static bool rtw_sctx_chk_waring_status(int status) -+{ -+ switch(status) { -+ case RTW_SCTX_DONE_UNKNOWN: -+ case RTW_SCTX_DONE_BUF_ALLOC: -+ case RTW_SCTX_DONE_BUF_FREE: -+ -+ case RTW_SCTX_DONE_DRV_STOP: -+ case RTW_SCTX_DONE_DEV_REMOVE: -+ return true; -+ default: -+ return false; -+ } -+} -+ -+void rtw_sctx_done_err(struct submit_ctx **sctx, int status) -+{ -+ if (*sctx) { -+ if (rtw_sctx_chk_waring_status(status)) -+ DBG_871X("%s status:%d\n", __func__, status); -+ (*sctx)->status = status; -+ complete(&((*sctx)->done)); -+ *sctx = NULL; -+ } -+} -+ -+void rtw_sctx_done(struct submit_ctx **sctx) -+{ -+ rtw_sctx_done_err(sctx, RTW_SCTX_DONE_SUCCESS); -+} -+ -+#ifdef CONFIG_XMIT_ACK -+ -+#ifdef CONFIG_XMIT_ACK_POLLING -+s32 c2h_evt_hdl(_adapter *adapter, struct c2h_evt_hdr *c2h_evt, c2h_id_filter filter); -+ -+/** -+ * rtw_ack_tx_polling - -+ * @pxmitpriv: xmit_priv to address ack_tx_ops -+ * @timeout_ms: timeout msec -+ * -+ * Init ack_tx_ops and then do c2h_evt_hdl() and polling ack_tx_ops repeatedly -+ * till tx report or timeout -+ * Returns: _SUCCESS if TX report ok, _FAIL for others -+ */ -+int rtw_ack_tx_polling(struct xmit_priv *pxmitpriv, u32 timeout_ms) -+{ -+ int ret = _FAIL; -+ struct submit_ctx *pack_tx_ops = &pxmitpriv->ack_tx_ops; -+ _adapter *adapter = container_of(pxmitpriv, _adapter, xmitpriv); -+ -+ pack_tx_ops->submit_time = rtw_get_current_time(); -+ pack_tx_ops->timeout_ms = timeout_ms; -+ pack_tx_ops->status = RTW_SCTX_SUBMITTED; -+ -+ do { -+ c2h_evt_hdl(adapter, NULL, rtw_hal_c2h_id_filter_ccx(adapter)); -+ if (pack_tx_ops->status != RTW_SCTX_SUBMITTED) -+ break; -+ -+ if (adapter->bDriverStopped) { -+ pack_tx_ops->status = RTW_SCTX_DONE_DRV_STOP; -+ break; -+ } -+ if (adapter->bSurpriseRemoved) { -+ pack_tx_ops->status = RTW_SCTX_DONE_DEV_REMOVE; -+ break; -+ } -+ -+ rtw_msleep_os(10); -+ } while (rtw_get_passing_time_ms(pack_tx_ops->submit_time) < timeout_ms); -+ -+ if (pack_tx_ops->status == RTW_SCTX_SUBMITTED) { -+ pack_tx_ops->status = RTW_SCTX_DONE_TIMEOUT; -+ DBG_871X("%s timeout\n", __func__); -+ } -+ -+ if (pack_tx_ops->status == RTW_SCTX_DONE_SUCCESS) -+ ret = _SUCCESS; -+ -+ return ret; -+} -+#endif -+ -+int rtw_ack_tx_wait(struct xmit_priv *pxmitpriv, u32 timeout_ms) -+{ -+#ifdef CONFIG_XMIT_ACK_POLLING -+ return rtw_ack_tx_polling(pxmitpriv, timeout_ms); -+#else -+ struct submit_ctx *pack_tx_ops = &pxmitpriv->ack_tx_ops; -+ -+ pack_tx_ops->submit_time = rtw_get_current_time(); -+ pack_tx_ops->timeout_ms = timeout_ms; -+ pack_tx_ops->status = RTW_SCTX_SUBMITTED; -+ -+ return rtw_sctx_wait(pack_tx_ops); -+#endif -+} -+ -+void rtw_ack_tx_done(struct xmit_priv *pxmitpriv, int status) -+{ -+ struct submit_ctx *pack_tx_ops = &pxmitpriv->ack_tx_ops; -+ -+ if (pxmitpriv->ack_tx) { -+ rtw_sctx_done_err(&pack_tx_ops, status); -+ } else { -+ DBG_871X("%s ack_tx not set\n", __func__); -+ } -+} -+#endif //CONFIG_XMIT_ACK -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/Hal8812PwrSeq.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/Hal8812PwrSeq.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/Hal8812PwrSeq.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/Hal8812PwrSeq.c 2018-02-06 17:42:30.701967031 +0200 -@@ -0,0 +1,92 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "Hal8812PwrSeq.h" -+#include -+ -+/* -+ drivers should parse below arrays and do the corresponding actions -+*/ -+//3 Power on Array -+WLAN_PWR_CFG rtl8812_power_on_flow[RTL8812_TRANS_CARDEMU_TO_ACT_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_CARDEMU_TO_ACT -+ RTL8812_TRANS_END -+}; -+ -+//3Radio off GPIO Array -+WLAN_PWR_CFG rtl8812_radio_off_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_ACT_TO_CARDEMU -+ RTL8812_TRANS_END -+}; -+ -+//3Card Disable Array -+WLAN_PWR_CFG rtl8812_card_disable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_ACT_TO_CARDEMU -+ RTL8812_TRANS_CARDEMU_TO_CARDDIS -+ RTL8812_TRANS_END -+}; -+ -+//3 Card Enable Array -+WLAN_PWR_CFG rtl8812_card_enable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_CARDDIS_TO_CARDEMU -+ RTL8812_TRANS_CARDEMU_TO_ACT -+ RTL8812_TRANS_END -+}; -+ -+//3Suspend Array -+WLAN_PWR_CFG rtl8812_suspend_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_SUS_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_ACT_TO_CARDEMU -+ RTL8812_TRANS_CARDEMU_TO_SUS -+ RTL8812_TRANS_END -+}; -+ -+//3 Resume Array -+WLAN_PWR_CFG rtl8812_resume_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_SUS_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_SUS_TO_CARDEMU -+ RTL8812_TRANS_CARDEMU_TO_ACT -+ RTL8812_TRANS_END -+}; -+ -+ -+ -+//3HWPDN Array -+WLAN_PWR_CFG rtl8812_hwpdn_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ RTL8812_TRANS_ACT_TO_CARDEMU -+ RTL8812_TRANS_CARDEMU_TO_PDN -+ RTL8812_TRANS_END -+}; -+ -+//3 Enter LPS -+WLAN_PWR_CFG rtl8812_enter_lps_flow[RTL8812_TRANS_ACT_TO_LPS_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ //FW behavior -+ RTL8812_TRANS_ACT_TO_LPS -+ RTL8812_TRANS_END -+}; -+ -+//3 Leave LPS -+WLAN_PWR_CFG rtl8812_leave_lps_flow[RTL8812_TRANS_LPS_TO_ACT_STEPS+RTL8812_TRANS_END_STEPS]= -+{ -+ //FW behavior -+ RTL8812_TRANS_LPS_TO_ACT -+ RTL8812_TRANS_END -+}; -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/Hal8821APwrSeq.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/Hal8821APwrSeq.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/Hal8821APwrSeq.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/Hal8821APwrSeq.c 2018-02-06 17:42:30.701967031 +0200 -@@ -0,0 +1,96 @@ -+ -+/*++ -+Copyright (c) Realtek Semiconductor Corp. All rights reserved. -+ -+Module Name: -+ Hal8821PwrSeq.c -+ -+Abstract: -+ This file includes all kinds of Power Action event for RTL8821A and corresponding hardware configurtions which are released from HW SD. -+ -+Major Change History: -+ When Who What -+ ---------- --------------- ------------------------------- -+ 2011-08-08 Roger Create. -+ -+--*/ -+ -+ -+#include "Hal8821APwrSeq.h" -+#include -+ -+ -+/* -+ drivers should parse below arrays and do the corresponding actions -+*/ -+//3 Power on Array -+WLAN_PWR_CFG rtl8821A_power_on_flow[RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_CARDEMU_TO_ACT -+ RTL8821A_TRANS_END -+}; -+ -+//3Radio off GPIO Array -+WLAN_PWR_CFG rtl8821A_radio_off_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_ACT_TO_CARDEMU -+ RTL8821A_TRANS_END -+}; -+ -+//3Card Disable Array -+WLAN_PWR_CFG rtl8821A_card_disable_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_ACT_TO_CARDEMU -+ RTL8821A_TRANS_CARDEMU_TO_CARDDIS -+ RTL8821A_TRANS_END -+}; -+ -+//3 Card Enable Array -+WLAN_PWR_CFG rtl8821A_card_enable_flow[RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_CARDDIS_TO_CARDEMU -+ RTL8821A_TRANS_CARDEMU_TO_ACT -+ RTL8821A_TRANS_END -+}; -+ -+//3Suspend Array -+WLAN_PWR_CFG rtl8821A_suspend_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_ACT_TO_CARDEMU -+ RTL8821A_TRANS_CARDEMU_TO_SUS -+ RTL8821A_TRANS_END -+}; -+ -+//3 Resume Array -+WLAN_PWR_CFG rtl8821A_resume_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_SUS_TO_CARDEMU -+ RTL8821A_TRANS_CARDEMU_TO_ACT -+ RTL8821A_TRANS_END -+}; -+ -+ -+ -+//3HWPDN Array -+WLAN_PWR_CFG rtl8821A_hwpdn_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ RTL8821A_TRANS_ACT_TO_CARDEMU -+ RTL8821A_TRANS_CARDEMU_TO_PDN -+ RTL8821A_TRANS_END -+}; -+ -+//3 Enter LPS -+WLAN_PWR_CFG rtl8821A_enter_lps_flow[RTL8821A_TRANS_ACT_TO_LPS_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ //FW behavior -+ RTL8821A_TRANS_ACT_TO_LPS -+ RTL8821A_TRANS_END -+}; -+ -+//3 Leave LPS -+WLAN_PWR_CFG rtl8821A_leave_lps_flow[RTL8821A_TRANS_LPS_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]= -+{ -+ //FW behavior -+ RTL8821A_TRANS_LPS_TO_ACT -+ RTL8821A_TRANS_END -+}; -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/hal_com.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_com.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/hal_com.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_com.c 2018-02-06 17:42:30.709967150 +0200 -@@ -0,0 +1,486 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _HAL_COM_C_ -+ -+#include -+ -+#include "../hal/odm_precomp.h" -+ -+ -+void dump_chip_info(HAL_VERSION ChipVersion) -+{ -+ int cnt = 0; -+ u8 buf[128]; -+ -+ if(IS_81XXC(ChipVersion)){ -+ cnt += sprintf((buf+cnt), "Chip Version Info: %s_", IS_92C_SERIAL(ChipVersion)?"CHIP_8192C":"CHIP_8188C"); -+ } -+ else if(IS_92D(ChipVersion)){ -+ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8192D_"); -+ } -+ else if(IS_8723_SERIES(ChipVersion)){ -+ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8723A_"); -+ } -+ else if(IS_8188E(ChipVersion)){ -+ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8188E_"); -+ } -+ else if(IS_8812_SERIES(ChipVersion)){ -+ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8812_"); -+ } -+ else if(IS_8192E(ChipVersion)){ -+ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8192E_"); -+ } -+ else if(IS_8821_SERIES(ChipVersion)){ -+ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8821_"); -+ } -+ else if(IS_8723B_SERIES(ChipVersion)){ -+ cnt += sprintf((buf+cnt), "Chip Version Info: CHIP_8723B_"); -+ } -+ -+ cnt += sprintf((buf+cnt), "%s_", IS_NORMAL_CHIP(ChipVersion)?"Normal_Chip":"Test_Chip"); -+ if(IS_CHIP_VENDOR_TSMC(ChipVersion)) -+ cnt += sprintf((buf+cnt), "%s_","TSMC"); -+ else if(IS_CHIP_VENDOR_UMC(ChipVersion)) -+ cnt += sprintf((buf+cnt), "%s_","UMC"); -+ else if(IS_CHIP_VENDOR_SMIC(ChipVersion)) -+ cnt += sprintf((buf+cnt), "%s_","SMIC"); -+ -+ if(IS_A_CUT(ChipVersion)) cnt += sprintf((buf+cnt), "A_CUT_"); -+ else if(IS_B_CUT(ChipVersion)) cnt += sprintf((buf+cnt), "B_CUT_"); -+ else if(IS_C_CUT(ChipVersion)) cnt += sprintf((buf+cnt), "C_CUT_"); -+ else if(IS_D_CUT(ChipVersion)) cnt += sprintf((buf+cnt), "D_CUT_"); -+ else if(IS_E_CUT(ChipVersion)) cnt += sprintf((buf+cnt), "E_CUT_"); -+ else cnt += sprintf((buf+cnt), "UNKNOWN_CUT(%d)_", ChipVersion.CUTVersion); -+ -+ if(IS_1T1R(ChipVersion)) cnt += sprintf((buf+cnt), "1T1R_"); -+ else if(IS_1T2R(ChipVersion)) cnt += sprintf((buf+cnt), "1T2R_"); -+ else if(IS_2T2R(ChipVersion)) cnt += sprintf((buf+cnt), "2T2R_"); -+ else cnt += sprintf((buf+cnt), "UNKNOWN_RFTYPE(%d)_", ChipVersion.RFType); -+ -+ cnt += sprintf((buf+cnt), "RomVer(%d)\n", ChipVersion.ROMVer); -+ -+ DBG_871X("%s", buf); -+} -+ -+ -+#define EEPROM_CHANNEL_PLAN_BY_HW_MASK 0x80 -+ -+u8 //return the final channel plan decision -+hal_com_get_channel_plan( -+ PADAPTER padapter, -+ u8 hw_channel_plan, //channel plan from HW (efuse/eeprom) -+ u8 sw_channel_plan, //channel plan from SW (registry/module param) -+ u8 def_channel_plan, //channel plan used when the former two is invalid -+ bool AutoLoadFail -+ ) -+{ -+ u8 swConfig; -+ u8 chnlPlan; -+ -+ swConfig = true; -+ if (!AutoLoadFail) -+ { -+ if (!rtw_is_channel_plan_valid(sw_channel_plan)) -+ swConfig = false; -+ if (hw_channel_plan & EEPROM_CHANNEL_PLAN_BY_HW_MASK) -+ swConfig = false; -+ } -+ -+ if (swConfig == true) -+ chnlPlan = sw_channel_plan; -+ else -+ chnlPlan = hw_channel_plan & (~EEPROM_CHANNEL_PLAN_BY_HW_MASK); -+ -+ if (!rtw_is_channel_plan_valid(chnlPlan)) -+ chnlPlan = def_channel_plan; -+ -+ return chnlPlan; -+} -+ -+bool -+HAL_IsLegalChannel( -+ PADAPTER Adapter, -+ u32 Channel -+ ) -+{ -+ bool bLegalChannel = true; -+ -+ if (Channel > 14) { -+ if(IsSupported5G(Adapter->registrypriv.wireless_mode) == false) { -+ bLegalChannel = false; -+ DBG_871X("Channel > 14 but wireless_mode do not support 5G\n"); -+ } -+ } else if ((Channel <= 14) && (Channel >=1)){ -+ if(IsSupported24G(Adapter->registrypriv.wireless_mode) == false) { -+ bLegalChannel = false; -+ DBG_871X("(Channel <= 14) && (Channel >=1) but wireless_mode do not support 2.4G\n"); -+ } -+ } else { -+ bLegalChannel = false; -+ DBG_871X("Channel is Invalid !!!\n"); -+ } -+ -+ return bLegalChannel; -+} -+ -+u8 MRateToHwRate(u8 rate) -+{ -+ u8 ret = DESC_RATE1M; -+ -+ switch(rate) -+ { -+ // CCK and OFDM non-HT rates -+ case IEEE80211_CCK_RATE_1MB: ret = DESC_RATE1M; break; -+ case IEEE80211_CCK_RATE_2MB: ret = DESC_RATE2M; break; -+ case IEEE80211_CCK_RATE_5MB: ret = DESC_RATE5_5M; break; -+ case IEEE80211_CCK_RATE_11MB: ret = DESC_RATE11M; break; -+ case IEEE80211_OFDM_RATE_6MB: ret = DESC_RATE6M; break; -+ case IEEE80211_OFDM_RATE_9MB: ret = DESC_RATE9M; break; -+ case IEEE80211_OFDM_RATE_12MB: ret = DESC_RATE12M; break; -+ case IEEE80211_OFDM_RATE_18MB: ret = DESC_RATE18M; break; -+ case IEEE80211_OFDM_RATE_24MB: ret = DESC_RATE24M; break; -+ case IEEE80211_OFDM_RATE_36MB: ret = DESC_RATE36M; break; -+ case IEEE80211_OFDM_RATE_48MB: ret = DESC_RATE48M; break; -+ case IEEE80211_OFDM_RATE_54MB: ret = DESC_RATE54M; break; -+ -+ // HT rates since here -+ //case MGN_MCS0: ret = DESC_RATEMCS0; break; -+ //case MGN_MCS1: ret = DESC_RATEMCS1; break; -+ //case MGN_MCS2: ret = DESC_RATEMCS2; break; -+ //case MGN_MCS3: ret = DESC_RATEMCS3; break; -+ //case MGN_MCS4: ret = DESC_RATEMCS4; break; -+ //case MGN_MCS5: ret = DESC_RATEMCS5; break; -+ //case MGN_MCS6: ret = DESC_RATEMCS6; break; -+ //case MGN_MCS7: ret = DESC_RATEMCS7; break; -+ -+ default: break; -+ } -+ -+ return ret; -+} -+ -+void HalSetBrateCfg( -+ PADAPTER Adapter, -+ u8 *mBratesOS, -+ u16 *pBrateCfg) -+{ -+ u8 i, is_brate, brate; -+ -+ for(i=0;iQueue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];//VI -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[0];//BE -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[0];//BK -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];//HIGH -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD -+} -+ -+static void -+_TwoOutPipeMapping( -+ PADAPTER pAdapter, -+ bool bWIFICfg -+ ) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); -+ -+ if(bWIFICfg){ //WMM -+ -+ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA -+ //{ 0, 1, 0, 1, 0, 0, 0, 0, 0 }; -+ //0:H, 1:N -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[1];//VO -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];//VI -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[1];//BE -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[0];//BK -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];//HIGH -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD -+ -+ } -+ else{//typical setting -+ -+ -+ //BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA -+ //{ 1, 1, 0, 0, 0, 0, 0, 0, 0 }; -+ //0:H, 1:N -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[0];//VI -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[1];//BE -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];//BK -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];//HIGH -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD -+ -+ } -+ -+} -+ -+static void _ThreeOutPipeMapping( -+ PADAPTER pAdapter, -+ bool bWIFICfg -+ ) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); -+ -+ if(bWIFICfg){//for WMM -+ -+ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA -+ //{ 1, 2, 1, 0, 0, 0, 0, 0, 0 }; -+ //0:H, 1:N, 2:L -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];//VI -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];//BE -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];//BK -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];//HIGH -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD -+ -+ } -+ else{//typical setting -+ -+ -+ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA -+ //{ 2, 2, 1, 0, 0, 0, 0, 0, 0 }; -+ //0:H, 1:N, 2:L -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];//VI -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];//BE -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[2];//BK -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[0];//HIGH -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD -+ } -+ -+} -+static void _FourOutPipeMapping( -+ PADAPTER pAdapter, -+ bool bWIFICfg -+ ) -+{ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); -+ -+ if(bWIFICfg){//for WMM -+ -+ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA -+ //{ 1, 2, 1, 0, 0, 0, 0, 0, 0 }; -+ //0:H, 1:N, 2:L ,3:E -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];//VI -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];//BE -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[1];//BK -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[3];//HIGH -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD -+ -+ } -+ else{//typical setting -+ -+ -+ // BK, BE, VI, VO, BCN, CMD,MGT,HIGH,HCCA -+ //{ 2, 2, 1, 0, 0, 0, 0, 0, 0 }; -+ //0:H, 1:N, 2:L -+ -+ pdvobjpriv->Queue2Pipe[0] = pdvobjpriv->RtOutPipe[0];//VO -+ pdvobjpriv->Queue2Pipe[1] = pdvobjpriv->RtOutPipe[1];//VI -+ pdvobjpriv->Queue2Pipe[2] = pdvobjpriv->RtOutPipe[2];//BE -+ pdvobjpriv->Queue2Pipe[3] = pdvobjpriv->RtOutPipe[2];//BK -+ -+ pdvobjpriv->Queue2Pipe[4] = pdvobjpriv->RtOutPipe[0];//BCN -+ pdvobjpriv->Queue2Pipe[5] = pdvobjpriv->RtOutPipe[0];//MGT -+ pdvobjpriv->Queue2Pipe[6] = pdvobjpriv->RtOutPipe[3];//HIGH -+ pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];//TXCMD -+ } -+ -+} -+bool -+Hal_MappingOutPipe( -+ PADAPTER pAdapter, -+ u8 NumOutPipe -+ ) -+{ -+ struct registry_priv *pregistrypriv = &pAdapter->registrypriv; -+ -+ bool bWIFICfg = (pregistrypriv->wifi_spec) ?true:false; -+ -+ bool result = true; -+ -+ switch(NumOutPipe) -+ { -+ case 2: -+ _TwoOutPipeMapping(pAdapter, bWIFICfg); -+ break; -+ case 3: -+ case 4: -+ _ThreeOutPipeMapping(pAdapter, bWIFICfg); -+ break; -+ case 1: -+ _OneOutPipeMapping(pAdapter); -+ break; -+ default: -+ result = false; -+ break; -+ } -+ -+ return result; -+ -+} -+ -+void hal_init_macaddr(_adapter *adapter) -+{ -+ rtw_hal_set_hwreg(adapter, HW_VAR_MAC_ADDR, adapter->eeprompriv.mac_addr); -+#ifdef CONFIG_CONCURRENT_MODE -+ if (adapter->pbuddy_adapter) -+ rtw_hal_set_hwreg(adapter->pbuddy_adapter, HW_VAR_MAC_ADDR, adapter->pbuddy_adapter->eeprompriv.mac_addr); -+#endif -+} -+ -+/* -+* C2H event format: -+* Field TRIGGER CONTENT CMD_SEQ CMD_LEN CMD_ID -+* BITS [127:120] [119:16] [15:8] [7:4] [3:0] -+*/ -+ -+void c2h_evt_clear(_adapter *adapter) -+{ -+ rtw_write8(adapter, REG_C2HEVT_CLEAR, C2H_EVT_HOST_CLOSE); -+} -+ -+s32 c2h_evt_read(_adapter *adapter, u8 *buf) -+{ -+ s32 ret = _FAIL; -+ struct c2h_evt_hdr *c2h_evt; -+ int i; -+ u8 trigger; -+ -+ if (buf == NULL) -+ goto exit; -+ -+ trigger = rtw_read8(adapter, REG_C2HEVT_CLEAR); -+ -+ if (trigger == C2H_EVT_HOST_CLOSE) { -+ goto exit; /* Not ready */ -+ } else if (trigger != C2H_EVT_FW_CLOSE) { -+ goto clear_evt; /* Not a valid value */ -+ } -+ -+ c2h_evt = (struct c2h_evt_hdr *)buf; -+ -+ _rtw_memset(c2h_evt, 0, 16); -+ -+ *buf = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL); -+ *(buf+1) = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + 1); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_info_, "c2h_evt_read(): ", -+ &c2h_evt , sizeof(c2h_evt)); -+ -+ if (0) { -+ DBG_871X("%s id:%u, len:%u, seq:%u, trigger:0x%02x\n", __func__ -+ , c2h_evt->id, c2h_evt->plen, c2h_evt->seq, trigger); -+ } -+ -+ /* Read the content */ -+ for (i = 0; i < c2h_evt->plen; i++) -+ c2h_evt->payload[i] = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + sizeof(*c2h_evt) + i); -+ -+ RT_PRINT_DATA(_module_hal_init_c_, _drv_info_, "c2h_evt_read(): Command Content:\n", -+ c2h_evt->payload, c2h_evt->plen); -+ -+ ret = _SUCCESS; -+ -+clear_evt: -+ /* -+ * Clear event to notify FW we have read the command. -+ * If this field isn't clear, the FW won't update the next command message. -+ */ -+ c2h_evt_clear(adapter); -+exit: -+ return ret; -+} -+ -+u8 rtw_hal_networktype_to_raid(_adapter *adapter,unsigned char network_type) -+{ -+ if(IS_NEW_GENERATION_IC(adapter)){ -+ return networktype_to_raid_ex(adapter,network_type); -+ } -+ else{ -+ return networktype_to_raid(adapter,network_type); -+ } -+ -+} -+u8 rtw_get_mgntframe_raid(_adapter *adapter,unsigned char network_type) -+{ -+ -+ u8 raid; -+ if(IS_NEW_GENERATION_IC(adapter)){ -+ -+ raid = (network_type & WIRELESS_11B) ?RATEID_IDX_B -+ :RATEID_IDX_G; -+ } -+ else{ -+ raid = (network_type & WIRELESS_11B) ?RATR_INX_WIRELESS_B -+ :RATR_INX_WIRELESS_G; -+ } -+ return raid; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/hal_com_phycfg.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_com_phycfg.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/hal_com_phycfg.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_com_phycfg.c 2018-02-06 17:42:30.709967150 +0200 -@@ -0,0 +1,97 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _HAL_COM_PHYCFG_C_ -+ -+#include -+ -+ -+#ifndef CONFIG_EMBEDDED_FWIMG -+int -+phy_ConfigMACWithParaFile( -+ IN PADAPTER Adapter, -+ IN u8* pFileName -+) -+{ -+ int rtStatus = _FAIL; -+ -+ return rtStatus; -+} -+ -+int -+PHY_ConfigBBWithPowerLimitTableParaFile( -+ IN PADAPTER Adapter, -+ IN s8* pFileName -+) -+{ -+ int rtStatus = _SUCCESS; -+ -+ return rtStatus; -+} -+ -+int -+phy_ConfigBBWithParaFile( -+ IN PADAPTER Adapter, -+ IN u8* pFileName -+) -+{ -+ int rtStatus = _SUCCESS; -+ -+ return rtStatus; -+} -+ -+int -+phy_ConfigBBWithPgParaFile( -+ IN PADAPTER Adapter, -+ IN u8* pFileName) -+{ -+ int rtStatus = _SUCCESS; -+ -+ return rtStatus; -+} -+ -+int -+phy_ConfigBBWithMpParaFile( -+ IN PADAPTER Adapter, -+ IN u8* pFileName -+) -+{ -+ int rtStatus = _SUCCESS; -+ -+ return rtStatus; -+} -+ -+int -+PHY_ConfigRFWithParaFile( -+ IN PADAPTER Adapter, -+ IN u8* pFileName, -+ IN u8 eRFPath -+) -+{ -+ int rtStatus = _SUCCESS; -+ -+ return rtStatus; -+} -+ -+int -+PHY_ConfigRFWithTxPwrTrackParaFile( -+ IN PADAPTER Adapter, -+ IN u8* pFileName -+) -+{ -+ int rtStatus = _SUCCESS; -+ -+ return rtStatus; -+} -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.c 2018-02-06 17:42:30.702967046 +0200 -@@ -0,0 +1,1429 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+static bool -+CheckCondition( -+ const u4Byte Condition, -+ const u4Byte Hex -+ ) -+{ -+ u4Byte _board = (Hex & 0x000000FF); -+ u4Byte _interface = (Hex & 0x0000FF00) >> 8; -+ u4Byte _platform = (Hex & 0x00FF0000) >> 16; -+ u4Byte cond = Condition; -+ -+ if ( Condition == 0xCDCDCDCD ) -+ return true; -+ -+ cond = Condition & 0x000000FF; -+ if ( (_board != cond) && (cond != 0xFF) ) -+ return false; -+ -+ cond = Condition & 0x0000FF00; -+ cond = cond >> 8; -+ if ( ((_interface & cond) == 0) && (cond != 0x07) ) -+ return false; -+ -+ cond = Condition & 0x00FF0000; -+ cond = cond >> 16; -+ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) -+ return false; -+ return true; -+} -+ -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_AGC_TAB[] = { -+ 0xFF0F07D8, 0xABCD, -+ 0x81C, 0xFF000001, -+ 0x81C, 0xFF020001, -+ 0x81C, 0xFF040001, -+ 0x81C, 0xFE060001, -+ 0x81C, 0xFD080001, -+ 0x81C, 0xFC0A0001, -+ 0x81C, 0xFB0C0001, -+ 0x81C, 0xFA0E0001, -+ 0x81C, 0xF9100001, -+ 0x81C, 0xF8120001, -+ 0x81C, 0xF7140001, -+ 0x81C, 0xF6160001, -+ 0x81C, 0xF5180001, -+ 0x81C, 0xF41A0001, -+ 0x81C, 0xF31C0001, -+ 0x81C, 0xF21E0001, -+ 0x81C, 0xF1200001, -+ 0x81C, 0xF0220001, -+ 0x81C, 0xEF240001, -+ 0x81C, 0xEE260001, -+ 0x81C, 0xED280001, -+ 0x81C, 0xEC2A0001, -+ 0x81C, 0xEB2C0001, -+ 0x81C, 0xEA2E0001, -+ 0x81C, 0xE9300001, -+ 0x81C, 0xE8320001, -+ 0x81C, 0xC7340001, -+ 0x81C, 0xC6360001, -+ 0x81C, 0xC5380001, -+ 0x81C, 0xC43A0001, -+ 0x81C, 0xC33C0001, -+ 0x81C, 0xC23E0001, -+ 0x81C, 0xC1400001, -+ 0x81C, 0xA6420001, -+ 0x81C, 0xA5440001, -+ 0x81C, 0xA4460001, -+ 0x81C, 0x69480001, -+ 0x81C, 0x684A0001, -+ 0x81C, 0x674C0001, -+ 0x81C, 0x664E0001, -+ 0x81C, 0x65500001, -+ 0x81C, 0x64520001, -+ 0x81C, 0x63540001, -+ 0x81C, 0x62560001, -+ 0x81C, 0x48580001, -+ 0x81C, 0x475A0001, -+ 0x81C, 0x465C0001, -+ 0x81C, 0x455E0001, -+ 0x81C, 0x44600001, -+ 0x81C, 0x43620001, -+ 0x81C, 0x42640001, -+ 0x81C, 0x41660001, -+ 0x81C, 0x41680001, -+ 0x81C, 0x416A0001, -+ 0x81C, 0x416C0001, -+ 0x81C, 0x416E0001, -+ 0x81C, 0x41700001, -+ 0x81C, 0x41720001, -+ 0x81C, 0x41740001, -+ 0x81C, 0x41760001, -+ 0x81C, 0x41780001, -+ 0x81C, 0x417A0001, -+ 0x81C, 0x417C0001, -+ 0x81C, 0x417E0001, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x81C, 0xFF000001, -+ 0x81C, 0xFF020001, -+ 0x81C, 0xFF040001, -+ 0x81C, 0xFF060001, -+ 0x81C, 0xFF080001, -+ 0x81C, 0xFE0A0001, -+ 0x81C, 0xFD0C0001, -+ 0x81C, 0xFC0E0001, -+ 0x81C, 0xFB100001, -+ 0x81C, 0xFA120001, -+ 0x81C, 0xF9140001, -+ 0x81C, 0xF8160001, -+ 0x81C, 0xF7180001, -+ 0x81C, 0xF61A0001, -+ 0x81C, 0xF51C0001, -+ 0x81C, 0xF41E0001, -+ 0x81C, 0xF3200001, -+ 0x81C, 0xF2220001, -+ 0x81C, 0xF1240001, -+ 0x81C, 0xF0260001, -+ 0x81C, 0xEF280001, -+ 0x81C, 0xEE2A0001, -+ 0x81C, 0xED2C0001, -+ 0x81C, 0xEC2E0001, -+ 0x81C, 0xEB300001, -+ 0x81C, 0xEA320001, -+ 0x81C, 0xE9340001, -+ 0x81C, 0xE8360001, -+ 0x81C, 0xE7380001, -+ 0x81C, 0xE63A0001, -+ 0x81C, 0xE53C0001, -+ 0x81C, 0xC73E0001, -+ 0x81C, 0xC6400001, -+ 0x81C, 0xC5420001, -+ 0x81C, 0xC4440001, -+ 0x81C, 0xC3460001, -+ 0x81C, 0xC2480001, -+ 0x81C, 0xC14A0001, -+ 0x81C, 0xA74C0001, -+ 0x81C, 0xA64E0001, -+ 0x81C, 0xA5500001, -+ 0x81C, 0xA4520001, -+ 0x81C, 0xA3540001, -+ 0x81C, 0xA2560001, -+ 0x81C, 0xA1580001, -+ 0x81C, 0x675A0001, -+ 0x81C, 0x665C0001, -+ 0x81C, 0x655E0001, -+ 0x81C, 0x64600001, -+ 0x81C, 0x63620001, -+ 0x81C, 0x48640001, -+ 0x81C, 0x47660001, -+ 0x81C, 0x46680001, -+ 0x81C, 0x456A0001, -+ 0x81C, 0x446C0001, -+ 0x81C, 0x436E0001, -+ 0x81C, 0x42700001, -+ 0x81C, 0x41720001, -+ 0x81C, 0x41740001, -+ 0x81C, 0x41760001, -+ 0x81C, 0x41780001, -+ 0x81C, 0x417A0001, -+ 0x81C, 0x417C0001, -+ 0x81C, 0x417E0001, -+ 0xFF0F07D8, 0xDEAD, -+ 0xFF0F0780, 0xABCD, -+ 0x81C, 0xFC800001, -+ 0x81C, 0xFB820001, -+ 0x81C, 0xFA840001, -+ 0x81C, 0xF9860001, -+ 0x81C, 0xF8880001, -+ 0x81C, 0xF78A0001, -+ 0x81C, 0xF68C0001, -+ 0x81C, 0xF58E0001, -+ 0x81C, 0xF4900001, -+ 0x81C, 0xF3920001, -+ 0x81C, 0xF2940001, -+ 0x81C, 0xF1960001, -+ 0x81C, 0xF0980001, -+ 0x81C, 0xEF9A0001, -+ 0x81C, 0xEE9C0001, -+ 0x81C, 0xED9E0001, -+ 0x81C, 0xECA00001, -+ 0x81C, 0xEBA20001, -+ 0x81C, 0xEAA40001, -+ 0x81C, 0xE9A60001, -+ 0x81C, 0xE8A80001, -+ 0x81C, 0xE7AA0001, -+ 0x81C, 0xE6AC0001, -+ 0x81C, 0xE5AE0001, -+ 0x81C, 0xE4B00001, -+ 0x81C, 0xE3B20001, -+ 0x81C, 0xA8B40001, -+ 0x81C, 0xA7B60001, -+ 0x81C, 0xA6B80001, -+ 0x81C, 0xA5BA0001, -+ 0x81C, 0xA4BC0001, -+ 0x81C, 0xA3BE0001, -+ 0x81C, 0xA2C00001, -+ 0x81C, 0xA1C20001, -+ 0x81C, 0x68C40001, -+ 0x81C, 0x67C60001, -+ 0x81C, 0x66C80001, -+ 0x81C, 0x65CA0001, -+ 0x81C, 0x64CC0001, -+ 0x81C, 0x47CE0001, -+ 0x81C, 0x46D00001, -+ 0x81C, 0x45D20001, -+ 0x81C, 0x44D40001, -+ 0x81C, 0x43D60001, -+ 0x81C, 0x42D80001, -+ 0x81C, 0x08DA0001, -+ 0x81C, 0x07DC0001, -+ 0x81C, 0x06DE0001, -+ 0x81C, 0x05E00001, -+ 0x81C, 0x04E20001, -+ 0x81C, 0x03E40001, -+ 0x81C, 0x02E60001, -+ 0x81C, 0x01E80001, -+ 0x81C, 0x01EA0001, -+ 0x81C, 0x01EC0001, -+ 0x81C, 0x01EE0001, -+ 0x81C, 0x01F00001, -+ 0x81C, 0x01F20001, -+ 0x81C, 0x01F40001, -+ 0x81C, 0x01F60001, -+ 0x81C, 0x01F80001, -+ 0x81C, 0x01FA0001, -+ 0x81C, 0x01FC0001, -+ 0x81C, 0x01FE0001, -+ 0xFF0F07C0, 0xCDEF, -+ 0x81C, 0xFC800001, -+ 0x81C, 0xFB820001, -+ 0x81C, 0xFA840001, -+ 0x81C, 0xF9860001, -+ 0x81C, 0xF8880001, -+ 0x81C, 0xF78A0001, -+ 0x81C, 0xF68C0001, -+ 0x81C, 0xF58E0001, -+ 0x81C, 0xF4900001, -+ 0x81C, 0xF3920001, -+ 0x81C, 0xF2940001, -+ 0x81C, 0xF1960001, -+ 0x81C, 0xF0980001, -+ 0x81C, 0xEF9A0001, -+ 0x81C, 0xEE9C0001, -+ 0x81C, 0xED9E0001, -+ 0x81C, 0xECA00001, -+ 0x81C, 0xEBA20001, -+ 0x81C, 0xEAA40001, -+ 0x81C, 0xE9A60001, -+ 0x81C, 0xE8A80001, -+ 0x81C, 0xE7AA0001, -+ 0x81C, 0xE6AC0001, -+ 0x81C, 0xE5AE0001, -+ 0x81C, 0xE4B00001, -+ 0x81C, 0xE3B20001, -+ 0x81C, 0xA8B40001, -+ 0x81C, 0xA7B60001, -+ 0x81C, 0xA6B80001, -+ 0x81C, 0xA5BA0001, -+ 0x81C, 0xA4BC0001, -+ 0x81C, 0xA3BE0001, -+ 0x81C, 0xA2C00001, -+ 0x81C, 0xA1C20001, -+ 0x81C, 0x68C40001, -+ 0x81C, 0x67C60001, -+ 0x81C, 0x66C80001, -+ 0x81C, 0x65CA0001, -+ 0x81C, 0x64CC0001, -+ 0x81C, 0x47CE0001, -+ 0x81C, 0x46D00001, -+ 0x81C, 0x45D20001, -+ 0x81C, 0x44D40001, -+ 0x81C, 0x43D60001, -+ 0x81C, 0x42D80001, -+ 0x81C, 0x08DA0001, -+ 0x81C, 0x07DC0001, -+ 0x81C, 0x06DE0001, -+ 0x81C, 0x05E00001, -+ 0x81C, 0x04E20001, -+ 0x81C, 0x03E40001, -+ 0x81C, 0x02E60001, -+ 0x81C, 0x01E80001, -+ 0x81C, 0x01EA0001, -+ 0x81C, 0x01EC0001, -+ 0x81C, 0x01EE0001, -+ 0x81C, 0x01F00001, -+ 0x81C, 0x01F20001, -+ 0x81C, 0x01F40001, -+ 0x81C, 0x01F60001, -+ 0x81C, 0x01F80001, -+ 0x81C, 0x01FA0001, -+ 0x81C, 0x01FC0001, -+ 0x81C, 0x01FE0001, -+ 0xFF0F07D8, 0xCDEF, -+ 0x81C, 0xFC800001, -+ 0x81C, 0xFB820001, -+ 0x81C, 0xFA840001, -+ 0x81C, 0xF9860001, -+ 0x81C, 0xF8880001, -+ 0x81C, 0xF78A0001, -+ 0x81C, 0xF68C0001, -+ 0x81C, 0xF58E0001, -+ 0x81C, 0xF4900001, -+ 0x81C, 0xF3920001, -+ 0x81C, 0xF2940001, -+ 0x81C, 0xF1960001, -+ 0x81C, 0xF0980001, -+ 0x81C, 0xEF9A0001, -+ 0x81C, 0xEE9C0001, -+ 0x81C, 0xED9E0001, -+ 0x81C, 0xECA00001, -+ 0x81C, 0xEBA20001, -+ 0x81C, 0xEAA40001, -+ 0x81C, 0xE9A60001, -+ 0x81C, 0xE8A80001, -+ 0x81C, 0xE7AA0001, -+ 0x81C, 0xE6AC0001, -+ 0x81C, 0xE5AE0001, -+ 0x81C, 0xE4B00001, -+ 0x81C, 0xE3B20001, -+ 0x81C, 0xA8B40001, -+ 0x81C, 0xA7B60001, -+ 0x81C, 0xA6B80001, -+ 0x81C, 0xA5BA0001, -+ 0x81C, 0xA4BC0001, -+ 0x81C, 0xA3BE0001, -+ 0x81C, 0xA2C00001, -+ 0x81C, 0xA1C20001, -+ 0x81C, 0x68C40001, -+ 0x81C, 0x67C60001, -+ 0x81C, 0x66C80001, -+ 0x81C, 0x65CA0001, -+ 0x81C, 0x64CC0001, -+ 0x81C, 0x47CE0001, -+ 0x81C, 0x46D00001, -+ 0x81C, 0x45D20001, -+ 0x81C, 0x44D40001, -+ 0x81C, 0x43D60001, -+ 0x81C, 0x42D80001, -+ 0x81C, 0x08DA0001, -+ 0x81C, 0x07DC0001, -+ 0x81C, 0x06DE0001, -+ 0x81C, 0x05E00001, -+ 0x81C, 0x04E20001, -+ 0x81C, 0x03E40001, -+ 0x81C, 0x02E60001, -+ 0x81C, 0x01E80001, -+ 0x81C, 0x01EA0001, -+ 0x81C, 0x01EC0001, -+ 0x81C, 0x01EE0001, -+ 0x81C, 0x01F00001, -+ 0x81C, 0x01F20001, -+ 0x81C, 0x01F40001, -+ 0x81C, 0x01F60001, -+ 0x81C, 0x01F80001, -+ 0x81C, 0x01FA0001, -+ 0x81C, 0x01FC0001, -+ 0x81C, 0x01FE0001, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x81C, 0xFF800001, -+ 0x81C, 0xFF820001, -+ 0x81C, 0xFF840001, -+ 0x81C, 0xFE860001, -+ 0x81C, 0xFD880001, -+ 0x81C, 0xFC8A0001, -+ 0x81C, 0xFB8C0001, -+ 0x81C, 0xFA8E0001, -+ 0x81C, 0xF9900001, -+ 0x81C, 0xF8920001, -+ 0x81C, 0xF7940001, -+ 0x81C, 0xF6960001, -+ 0x81C, 0xF5980001, -+ 0x81C, 0xF49A0001, -+ 0x81C, 0xF39C0001, -+ 0x81C, 0xF29E0001, -+ 0x81C, 0xF1A00001, -+ 0x81C, 0xF0A20001, -+ 0x81C, 0xEFA40001, -+ 0x81C, 0xEEA60001, -+ 0x81C, 0xEDA80001, -+ 0x81C, 0xECAA0001, -+ 0x81C, 0xEBAC0001, -+ 0x81C, 0xEAAE0001, -+ 0x81C, 0xE9B00001, -+ 0x81C, 0xE8B20001, -+ 0x81C, 0xE7B40001, -+ 0x81C, 0xE6B60001, -+ 0x81C, 0xE5B80001, -+ 0x81C, 0xE4BA0001, -+ 0x81C, 0xE3BC0001, -+ 0x81C, 0xA8BE0001, -+ 0x81C, 0xA7C00001, -+ 0x81C, 0xA6C20001, -+ 0x81C, 0xA5C40001, -+ 0x81C, 0xA4C60001, -+ 0x81C, 0xA3C80001, -+ 0x81C, 0xA2CA0001, -+ 0x81C, 0xA1CC0001, -+ 0x81C, 0x68CE0001, -+ 0x81C, 0x67D00001, -+ 0x81C, 0x66D20001, -+ 0x81C, 0x65D40001, -+ 0x81C, 0x64D60001, -+ 0x81C, 0x47D80001, -+ 0x81C, 0x46DA0001, -+ 0x81C, 0x45DC0001, -+ 0x81C, 0x44DE0001, -+ 0x81C, 0x43E00001, -+ 0x81C, 0x42E20001, -+ 0x81C, 0x08E40001, -+ 0x81C, 0x07E60001, -+ 0x81C, 0x06E80001, -+ 0x81C, 0x05EA0001, -+ 0x81C, 0x04EC0001, -+ 0x81C, 0x03EE0001, -+ 0x81C, 0x02F00001, -+ 0x81C, 0x01F20001, -+ 0x81C, 0x01F40001, -+ 0x81C, 0x01F60001, -+ 0x81C, 0x01F80001, -+ 0x81C, 0x01FA0001, -+ 0x81C, 0x01FC0001, -+ 0x81C, 0x01FE0001, -+ 0xFF0F0780, 0xDEAD, -+ 0xC50, 0x00000022, -+ 0xC50, 0x00000020, -+ 0xE50, 0x00000022, -+ 0xE50, 0x00000020, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_AGC_TAB( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_AGC_TAB)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_AGC_TAB; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_AGC_TAB, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* AGC_TAB_DIFF.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_AGC_TAB_DIFF_LB[] = { -+ 0xFF0F0780, 0xABCD, -+ 0x81C, 0x47CE0001, -+ 0x81C, 0x46D00001, -+ 0x81C, 0x45D20001, -+ 0x81C, 0x44D40001, -+ 0x81C, 0x43D60001, -+ 0x81C, 0x42D80001, -+ 0x81C, 0x08DA0001, -+ 0x81C, 0x07DC0001, -+ 0x81C, 0x06DE0001, -+ 0x81C, 0x05E00001, -+ 0x81C, 0x04E20001, -+ 0x81C, 0x03E40001, -+ 0x81C, 0x02E60001, -+ 0xFF0F07C0, 0xCDEF, -+ 0x81C, 0x47CE0001, -+ 0x81C, 0x46D00001, -+ 0x81C, 0x45D20001, -+ 0x81C, 0x44D40001, -+ 0x81C, 0x43D60001, -+ 0x81C, 0x42D80001, -+ 0x81C, 0x08DA0001, -+ 0x81C, 0x07DC0001, -+ 0x81C, 0x06DE0001, -+ 0x81C, 0x05E00001, -+ 0x81C, 0x04E20001, -+ 0x81C, 0x03E40001, -+ 0x81C, 0x02E60001, -+ 0xFF0F07D8, 0xCDEF, -+ 0x81C, 0x47CE0001, -+ 0x81C, 0x46D00001, -+ 0x81C, 0x45D20001, -+ 0x81C, 0x44D40001, -+ 0x81C, 0x43D60001, -+ 0x81C, 0x42D80001, -+ 0x81C, 0x08DA0001, -+ 0x81C, 0x07DC0001, -+ 0x81C, 0x06DE0001, -+ 0x81C, 0x05E00001, -+ 0x81C, 0x04E20001, -+ 0x81C, 0x03E40001, -+ 0x81C, 0x02E60001, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x81C, 0x47D80001, -+ 0x81C, 0x46DA0001, -+ 0x81C, 0x45DC0001, -+ 0x81C, 0x44DE0001, -+ 0x81C, 0x43E00001, -+ 0x81C, 0x42E20001, -+ 0x81C, 0x08E40001, -+ 0x81C, 0x07E60001, -+ 0x81C, 0x06E80001, -+ 0x81C, 0x05EA0001, -+ 0x81C, 0x04EC0001, -+ 0x81C, 0x03EE0001, -+ 0x81C, 0x02F00001, -+ 0xFF0F0780, 0xDEAD, -+}; -+ -+u4Byte Array_MP_8812A_AGC_TAB_DIFF_HB[] = { -+ 0xFF0F0780, 0xABCD, -+ 0x81C, 0x45CE0001, -+ 0x81C, 0x44D00001, -+ 0x81C, 0x43D20001, -+ 0x81C, 0x42D40001, -+ 0x81C, 0x08D60001, -+ 0x81C, 0x07D80001, -+ 0x81C, 0x06DA0001, -+ 0x81C, 0x05DC0001, -+ 0x81C, 0x04DE0001, -+ 0x81C, 0x03E00001, -+ 0x81C, 0x02E20001, -+ 0x81C, 0x01E40001, -+ 0x81C, 0x01E60001, -+ 0xFF0F07C0, 0xCDEF, -+ 0x81C, 0x45CE0001, -+ 0x81C, 0x44D00001, -+ 0x81C, 0x43D20001, -+ 0x81C, 0x42D40001, -+ 0x81C, 0x08D60001, -+ 0x81C, 0x07D80001, -+ 0x81C, 0x06DA0001, -+ 0x81C, 0x05DC0001, -+ 0x81C, 0x04DE0001, -+ 0x81C, 0x03E00001, -+ 0x81C, 0x02E20001, -+ 0x81C, 0x01E40001, -+ 0x81C, 0x01E60001, -+ 0xFF0F07D8, 0xCDEF, -+ 0x81C, 0x45CE0001, -+ 0x81C, 0x44D00001, -+ 0x81C, 0x43D20001, -+ 0x81C, 0x42D40001, -+ 0x81C, 0x08D60001, -+ 0x81C, 0x07D80001, -+ 0x81C, 0x06DA0001, -+ 0x81C, 0x05DC0001, -+ 0x81C, 0x04DE0001, -+ 0x81C, 0x03E00001, -+ 0x81C, 0x02E20001, -+ 0x81C, 0x01E40001, -+ 0x81C, 0x01E60001, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x81C, 0x45D80001, -+ 0x81C, 0x44DA0001, -+ 0x81C, 0x43DC0001, -+ 0x81C, 0x42DE0001, -+ 0x81C, 0x08E00001, -+ 0x81C, 0x07E20001, -+ 0x81C, 0x06E40001, -+ 0x81C, 0x05E60001, -+ 0x81C, 0x04E80001, -+ 0x81C, 0x03EA0001, -+ 0x81C, 0x02EC0001, -+ 0x81C, 0x01EE0001, -+ 0x81C, 0x01F00001, -+ 0xFF0F0780, 0xDEAD, -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_AGC_TAB_DIFF( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Array[], -+ u4Byte ArrayLen -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_AGC_TAB_DIFF, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_PHY_REG[] = { -+ 0x800, 0x8020D010, -+ 0x804, 0x080112E0, -+ 0x808, 0x0E028233, -+ 0x80C, 0x12131113, -+ 0x810, 0x20101263, -+ 0x814, 0x020C3D10, -+ 0x818, 0x03A00385, -+ 0x820, 0x00000000, -+ 0x824, 0x00030FE0, -+ 0x828, 0x00000000, -+ 0x82C, 0x002083DD, -+ 0x830, 0x2AAA6C86, -+ 0x834, 0x0037A706, -+ 0x838, 0x06C89B44, -+ 0x83C, 0x0000095B, -+ 0x840, 0xC0000001, -+ 0x844, 0x40003CDE, -+ 0x848, 0x6210FF8B, -+ 0x84C, 0x6CFDFFB8, -+ 0x850, 0x28874706, -+ 0x854, 0x0001520C, -+ 0x858, 0x8060E000, -+ 0x85C, 0x74210168, -+ 0x860, 0x6929C321, -+ 0x864, 0x796A7432, -+ 0x868, 0x8CA7A314, -+ 0x86C, 0x338C2878, -+ 0x870, 0x03333333, -+ 0x874, 0x31602C2E, -+ 0x878, 0x00003152, -+ 0x87C, 0x000FC000, -+ 0x8A0, 0x00000013, -+ 0x8A4, 0x7F7F7F7F, -+ 0x8A8, 0xA202033E, -+ 0x8AC, 0x0FF0FA0A, -+ 0x8B0, 0x00000600, -+ 0x8B4, 0x000FC080, -+ 0x8B8, 0x7C0057FF, -+ 0x8BC, 0x4CA520A3, -+ 0x8C0, 0x27F00020, -+ 0x8C4, 0x00000000, -+ 0x8C8, 0x00013169, -+ 0x8CC, 0x08248492, -+ 0x8D0, 0x0000B800, -+ 0x8DC, 0x00000000, -+ 0x8D4, 0x940008A0, -+ 0x8D8, 0x290B1612, -+ 0x8F8, 0x400002C0, -+ 0x8FC, 0x00000000, -+ 0xFF0F07D8, 0xABCD, -+ 0x900, 0x00000701, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x900, 0x00000700, -+ 0xFF0F07D8, 0xDEAD, -+ 0x90C, 0x00000000, -+ 0x910, 0x0000FC00, -+ 0x914, 0x00000404, -+ 0x918, 0x1C1028C0, -+ 0x91C, 0x64B11A1C, -+ 0x920, 0xE0767233, -+ 0x924, 0x055AA500, -+ 0x928, 0x00000004, -+ 0x92C, 0xFFFE0000, -+ 0x930, 0xFFFFFFFE, -+ 0x934, 0x001FFFFF, -+ 0x960, 0x00000000, -+ 0x964, 0x00000000, -+ 0x968, 0x00000000, -+ 0x96C, 0x00000000, -+ 0x970, 0x801FFFFF, -+ 0x978, 0x00000000, -+ 0x97C, 0x00000000, -+ 0x980, 0x00000000, -+ 0x984, 0x00000000, -+ 0x988, 0x00000000, -+ 0x9A4, 0x00080080, -+ 0x9A8, 0x00000000, -+ 0x9AC, 0x00000000, -+ 0x9B0, 0x01081008, -+ 0x9B4, 0x00000000, -+ 0x9B8, 0x01081008, -+ 0x9BC, 0x01081008, -+ 0x9D0, 0x00000000, -+ 0x9D4, 0x00000000, -+ 0x9D8, 0x00000000, -+ 0x9DC, 0x00000000, -+ 0x9E4, 0x00000002, -+ 0x9E8, 0x000002D4, -+ 0xA00, 0x00D047C8, -+ 0xA04, 0x01FF000C, -+ 0xA08, 0x8C8A8300, -+ 0xA0C, 0x2E7F000F, -+ 0xA10, 0x9500BB78, -+ 0xA14, 0x11144028, -+ 0xA18, 0x00881117, -+ 0xA1C, 0x89140F00, -+ 0xA20, 0x1A1B0000, -+ 0xA24, 0x090E1317, -+ 0xA28, 0x00000204, -+ 0xA2C, 0x00900000, -+ 0xA70, 0x101FFF00, -+ 0xA74, 0x00000008, -+ 0xA78, 0x00000900, -+ 0xA7C, 0x225B0606, -+ 0xA80, 0x218075B2, -+ 0xA84, 0x001F8C80, -+ 0xB00, 0x03100000, -+ 0xB04, 0x0000B000, -+ 0xB08, 0xAE0201EB, -+ 0xB0C, 0x01003207, -+ 0xB10, 0x00009807, -+ 0xB14, 0x01000000, -+ 0xB18, 0x00000002, -+ 0xB1C, 0x00000002, -+ 0xB20, 0x0000001F, -+ 0xB24, 0x03020100, -+ 0xB28, 0x07060504, -+ 0xB2C, 0x0B0A0908, -+ 0xB30, 0x0F0E0D0C, -+ 0xB34, 0x13121110, -+ 0xB38, 0x17161514, -+ 0xB3C, 0x0000003A, -+ 0xB40, 0x00000000, -+ 0xB44, 0x00000000, -+ 0xB48, 0x13000032, -+ 0xB4C, 0x48080000, -+ 0xB50, 0x00000000, -+ 0xB54, 0x00000000, -+ 0xB58, 0x00000000, -+ 0xB5C, 0x00000000, -+ 0xC00, 0x00000007, -+ 0xC04, 0x00042020, -+ 0xC08, 0x80410231, -+ 0xC0C, 0x00000000, -+ 0xC10, 0x00000100, -+ 0xC14, 0x01000000, -+ 0xC1C, 0x40000003, -+ 0xC20, 0x12121212, -+ 0xC24, 0x12121212, -+ 0xC28, 0x12121212, -+ 0xC2C, 0x12121212, -+ 0xC30, 0x12121212, -+ 0xC34, 0x12121212, -+ 0xC38, 0x12121212, -+ 0xC3C, 0x12121212, -+ 0xC40, 0x12121212, -+ 0xC44, 0x12121212, -+ 0xC48, 0x12121212, -+ 0xC4C, 0x12121212, -+ 0xC50, 0x00000020, -+ 0xC54, 0x0008121C, -+ 0xC58, 0x30000C1C, -+ 0xC5C, 0x00000058, -+ 0xC60, 0x34344443, -+ 0xC64, 0x07003333, -+ 0xC68, 0x59791979, -+ 0xC6C, 0x59795979, -+ 0xC70, 0x19795979, -+ 0xC74, 0x19795979, -+ 0xC78, 0x19791979, -+ 0xC7C, 0x19791979, -+ 0xC80, 0x19791979, -+ 0xC84, 0x19791979, -+ 0xC94, 0x0100005C, -+ 0xC98, 0x00000000, -+ 0xC9C, 0x00000000, -+ 0xCA0, 0x00000029, -+ 0xCA4, 0x08040201, -+ 0xCA8, 0x80402010, -+ 0xFF0F0740, 0xABCD, -+ 0xCB0, 0x77547717, -+ 0xFF0F07C0, 0xCDEF, -+ 0xCB0, 0x77547717, -+ 0xFF0F07D8, 0xCDEF, -+ 0xCB0, 0x54547710, -+ 0xCDCDCDCD, 0xCDCD, -+ 0xCB0, 0x77547777, -+ 0xFF0F0740, 0xDEAD, -+ 0xCB4, 0x00000077, -+ 0xCB8, 0x00508242, -+ 0xE00, 0x00000007, -+ 0xE04, 0x00042020, -+ 0xE08, 0x80410231, -+ 0xE0C, 0x00000000, -+ 0xE10, 0x00000100, -+ 0xE14, 0x01000000, -+ 0xE1C, 0x40000003, -+ 0xE20, 0x12121212, -+ 0xE24, 0x12121212, -+ 0xE28, 0x12121212, -+ 0xE2C, 0x12121212, -+ 0xE30, 0x12121212, -+ 0xE34, 0x12121212, -+ 0xE38, 0x12121212, -+ 0xE3C, 0x12121212, -+ 0xE40, 0x12121212, -+ 0xE44, 0x12121212, -+ 0xE48, 0x12121212, -+ 0xE4C, 0x12121212, -+ 0xE50, 0x00000020, -+ 0xE54, 0x0008121C, -+ 0xE58, 0x30000C1C, -+ 0xE5C, 0x00000058, -+ 0xE60, 0x34344443, -+ 0xE64, 0x07003333, -+ 0xE68, 0x59791979, -+ 0xE6C, 0x59795979, -+ 0xE70, 0x19795979, -+ 0xE74, 0x19795979, -+ 0xE78, 0x19791979, -+ 0xE7C, 0x19791979, -+ 0xE80, 0x19791979, -+ 0xE84, 0x19791979, -+ 0xE94, 0x0100005C, -+ 0xE98, 0x00000000, -+ 0xE9C, 0x00000000, -+ 0xEA0, 0x00000029, -+ 0xEA4, 0x08040201, -+ 0xEA8, 0x80402010, -+ 0xFF0F0740, 0xABCD, -+ 0xEB0, 0x77547717, -+ 0xFF0F07C0, 0xCDEF, -+ 0xEB0, 0x77547717, -+ 0xFF0F07D8, 0xCDEF, -+ 0xEB0, 0x54547710, -+ 0xCDCDCDCD, 0xCDCD, -+ 0xEB0, 0x77547777, -+ 0xFF0F0740, 0xDEAD, -+ 0xEB4, 0x00000077, -+ 0xEB8, 0x00508242, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_PHY_REG; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* PHY_REG_MP.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_PHY_REG_MP[] = { -+ 0x800, 0x8020D410, -+ 0x830, 0x2EAA8EB6, -+ 0xC90, 0x01E00000, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_MP( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG_MP)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_PHY_REG_MP; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG_MP, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_PHY_REG_PG[] = { -+ 0xC20, 0x00000000, 0x34363840, -+ 0xC24, 0x00000000, 0x42424444, -+ 0xC28, 0x00000000, 0x30323638, -+ 0xC2C, 0x00000000, 0x40424444, -+ 0xC30, 0x00000000, 0x28303236, -+ 0xC34, 0x00000000, 0x38404242, -+ 0xC38, 0x00000000, 0x26283034, -+ 0xE20, 0x00000000, 0x34363840, -+ 0xE24, 0x00000000, 0x42424444, -+ 0xE28, 0x00000000, 0x30323638, -+ 0xE2C, 0x00000000, 0x40424444, -+ 0xE30, 0x00000000, 0x28303236, -+ 0xE34, 0x00000000, 0x38404242, -+ 0xE38, 0x00000000, 0x26283034, -+ 0xC24, 0x00000000, 0x42424444, -+ 0xC28, 0x00000000, 0x30323640, -+ 0xC2C, 0x00000000, 0x40424444, -+ 0xC30, 0x00000000, 0x28303236, -+ 0xC34, 0x00000000, 0x38404242, -+ 0xC38, 0x00000000, 0x26283034, -+ 0xC3C, 0x00000000, 0x40424444, -+ 0xC40, 0x00000000, 0x28303236, -+ 0xC44, 0x00000000, 0x42422426, -+ 0xC48, 0x00000000, 0x30343840, -+ 0xC4C, 0x00000000, 0x22242628, -+ 0xE24, 0x00000000, 0x42424444, -+ 0xE28, 0x00000000, 0x30323640, -+ 0xE2C, 0x00000000, 0x40424444, -+ 0xE30, 0x00000000, 0x28303236, -+ 0xE34, 0x00000000, 0x38404242, -+ 0xE38, 0x00000000, 0x26283034, -+ 0xE3C, 0x00000000, 0x40424444, -+ 0xE40, 0x00000000, 0x28303236, -+ 0xE44, 0x00000000, 0x42422426, -+ 0xE48, 0x00000000, 0x30343840, -+ 0xE4C, 0x00000000, 0x22242628, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_PG( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG_PG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_PHY_REG_PG; -+ -+ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ for (i = 0; i < ArrayLen; i += 3 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ u4Byte v3 = Array[i+2]; -+ -+ // this line is a line of pure_body -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_PHY_REG_PG_8812A(pDM_Odm, v1, v2, v3); -+ continue; -+ } -+ else -+ { // this line is the start of branch -+ if ( !CheckCondition(Array[i], hex) ) -+ { // don't need the hw_body -+ i += 2; // skip the pair of expression -+ v1 = Array[i]; -+ v2 = Array[i+1]; -+ v3 = Array[i+2]; -+ while (v2 != 0xDEAD) -+ { -+ i += 3; -+ v1 = Array[i]; -+ v2 = Array[i+1]; -+ v3 = Array[i+1]; -+ } -+ } -+ } -+ } -+} -+ -+ -+ -+/****************************************************************************** -+* PHY_REG_PG_ASUS.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_PHY_REG_PG_ASUS[] = { -+ 0xC20, 0x00000000, 0x34343434, -+ 0xC24, 0x00000000, 0x32323232, -+ 0xC28, 0x00000000, 0x28303232, -+ 0xC2C, 0x00000000, 0x32323232, -+ 0xC30, 0x00000000, 0x24283032, -+ 0xC34, 0x00000000, 0x32323232, -+ 0xC38, 0x00000000, 0x24283032, -+ 0xE20, 0x00000000, 0x34343434, -+ 0xE24, 0x00000000, 0x32323232, -+ 0xE28, 0x00000000, 0x28303232, -+ 0xE2C, 0x00000000, 0x32323232, -+ 0xE30, 0x00000000, 0x24283032, -+ 0xE34, 0x00000000, 0x32323232, -+ 0xE38, 0x00000000, 0x24283032, -+ 0xC24, 0x00000000, 0x32323232, -+ 0xC28, 0x00000000, 0x28303232, -+ 0xC2C, 0x00000000, 0x32323232, -+ 0xC30, 0x00000000, 0x24283032, -+ 0xC34, 0x00000000, 0x32323232, -+ 0xC38, 0x00000000, 0x24283032, -+ 0xC3C, 0x00000000, 0x32323232, -+ 0xC40, 0x00000000, 0x24283032, -+ 0xC44, 0x00000000, 0x32322222, -+ 0xC48, 0x00000000, 0x30323232, -+ 0xC4C, 0x00000000, 0x22222428, -+ 0xE24, 0x00000000, 0x32323232, -+ 0xE28, 0x00000000, 0x28303232, -+ 0xE2C, 0x00000000, 0x32323232, -+ 0xE30, 0x00000000, 0x24283032, -+ 0xE34, 0x00000000, 0x32323232, -+ 0xE38, 0x00000000, 0x24283032, -+ 0xE3C, 0x00000000, 0x32323232, -+ 0xE40, 0x00000000, 0x24283032, -+ 0xE44, 0x00000000, 0x32322222, -+ 0xE48, 0x00000000, 0x30323232, -+ 0xE4C, 0x00000000, 0x22222428, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_ASUS( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG_PG_ASUS)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_PHY_REG_PG_ASUS; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_ASUS, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* PHY_REG_PG_NEC.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_PHY_REG_PG_NEC[] = { -+ 0xC20, 0x00000000, 0x32323232, -+ 0xC24, 0x00000000, 0x32343434, -+ 0xC28, 0x00000000, 0x24262830, -+ 0xC2C, 0x00000000, 0x32343434, -+ 0xC30, 0x00000000, 0x24262830, -+ 0xC34, 0x00000000, 0x32343434, -+ 0xC38, 0x00000000, 0x24262830, -+ 0xE20, 0x00000000, 0x32323232, -+ 0xE24, 0x00000000, 0x32343434, -+ 0xE28, 0x00000000, 0x24262830, -+ 0xE2C, 0x00000000, 0x32343434, -+ 0xE30, 0x00000000, 0x24262830, -+ 0xE34, 0x00000000, 0x32343434, -+ 0xE38, 0x00000000, 0x24262830, -+ 0xC24, 0x00000000, 0x32343434, -+ 0xC28, 0x00000000, 0x24262830, -+ 0xC2C, 0x00000000, 0x32343434, -+ 0xC30, 0x00000000, 0x24262830, -+ 0xC34, 0x00000000, 0x28282828, -+ 0xC38, 0x00000000, 0x24262828, -+ 0xC3C, 0x00000000, 0x32343434, -+ 0xC40, 0x00000000, 0x24262830, -+ 0xC44, 0x00000000, 0x28282022, -+ 0xC48, 0x00000000, 0x28282828, -+ 0xC4C, 0x00000000, 0x20222426, -+ 0xE24, 0x00000000, 0x32343434, -+ 0xE28, 0x00000000, 0x24262830, -+ 0xE2C, 0x00000000, 0x32343434, -+ 0xE30, 0x00000000, 0x24262830, -+ 0xE34, 0x00000000, 0x28282828, -+ 0xE38, 0x00000000, 0x24262828, -+ 0xE3C, 0x00000000, 0x32343434, -+ 0xE40, 0x00000000, 0x24262830, -+ 0xE44, 0x00000000, 0x28282022, -+ 0xE48, 0x00000000, 0x28282828, -+ 0xE4C, 0x00000000, 0x20222426, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_NEC( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_PHY_REG_PG_NEC)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_PHY_REG_PG_NEC; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_NEC, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_BB.h 2018-02-06 17:42:30.702967046 +0200 -@@ -0,0 +1,88 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_MP_BB_HW_IMG_8812A_H -+#define __INC_MP_BB_HW_IMG_8812A_H -+ -+static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_AGC_TAB( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* AGC_TAB_DIFF.TXT -+******************************************************************************/ -+ -+extern u4Byte Array_MP_8812A_AGC_TAB_DIFF_LB[116]; -+extern u4Byte Array_MP_8812A_AGC_TAB_DIFF_HB[116]; -+void -+ODM_ReadAndConfig_MP_8812A_AGC_TAB_DIFF( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Array[], -+ u4Byte ArrayLen -+); -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* PHY_REG_MP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_MP( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_PG( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* PHY_REG_PG_ASUS.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_ASUS( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* PHY_REG_PG_NEC.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_PHY_REG_PG_NEC( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.c 2018-02-06 17:42:30.704967075 +0200 -@@ -0,0 +1,5303 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+u1Byte Array_MP_8812A_FW_NIC[] = { -+0x01, 0x95, 0x10, 0x00, 0x0F, 0x00, 0x00, 0x00, 0x05, 0x14, 0x10, 0x48, 0x84, 0x7A, 0x00, 0x00, -+0xCC, 0xCC, 0xCC, 0xCC, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x4C, 0xB1, 0x02, 0x60, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x61, 0x0E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x70, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x60, 0x85, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x6F, 0x7E, 0x00, 0x00, -+0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, -+0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, -+0xF0, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x0A, 0x08, 0x03, -+0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, 0x04, 0x08, -+0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, 0x04, 0x00, -+0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, 0x0A, 0x03, -+0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, 0x10, 0x24, -+0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, 0x06, 0x00, -+0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, 0x21, 0x0C, -+0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, 0x20, 0x21, -+0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, 0x10, 0x00, -+0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, 0x28, 0x14, -+0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, 0x30, 0x04, -+0x04, 0x04, 0x05, 0x04, 0x04, 0x05, 0x07, 0x07, 0x07, 0x08, 0x0A, 0x01, 0x02, 0x03, 0x06, 0x07, -+0x0A, 0x0B, 0x0D, 0x03, 0x04, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, -+0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x07, 0x08, 0x08, 0x0A, 0x0A, -+0x0C, 0x0E, 0x10, 0x11, 0x11, 0x07, 0x09, 0x09, 0x0B, 0x0B, 0x0D, 0x0F, 0x11, 0x12, 0x12, 0x05, -+0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, -+0x0F, 0x0F, 0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, 0x07, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x04, -+0x06, 0x07, 0x07, 0x09, 0x0B, 0x11, 0x13, 0x07, 0x0A, 0x0C, 0x0D, 0x0D, 0x0F, 0x11, 0x13, 0x09, -+0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x05, -+0x06, 0x08, 0x09, 0x0C, 0x0E, 0x12, 0x12, 0x13, 0x14, 0x07, 0x08, 0x0A, 0x0B, 0x0D, 0x10, 0x12, -+0x13, 0x15, 0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x09, 0x09, 0x09, -+0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, 0x25, 0x27, 0x28, 0x00, 0x00, 0x00, 0x00, 0x23, -+0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, -+0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, -+0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x2A, -+0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x04, 0x00, -+0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00, 0x18, 0x00, -+0x00, 0x00, 0x24, 0x00, 0x00, 0x00, 0x30, 0x00, 0x00, 0x00, 0x48, 0x00, 0x00, 0x00, 0x60, 0x00, -+0x00, 0x00, 0x90, 0x00, 0x00, 0x00, 0xC0, 0x00, 0x00, 0x00, 0xD8, 0x00, 0x00, 0x00, 0x3C, 0x00, -+0x00, 0x00, 0x64, 0x00, 0x00, 0x00, 0x78, 0x00, 0x00, 0x00, 0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, -+0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x00, 0xA0, 0x00, -+0x00, 0x00, 0xF0, 0x00, 0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x02, 0x58, 0x00, -+0x00, 0x03, 0x20, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x00, 0xC8, 0x00, -+0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, -+0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, -+0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, -+0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0x64, 0x00, -+0x00, 0x00, 0x78, 0x00, 0x00, 0x00, 0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, 0x00, 0x01, 0x40, 0x00, -+0x00, 0x01, 0x90, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0x30, 0x00, 0x00, 0x02, 0x80, 0x00, -+0x00, 0x02, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x2C, 0x00, 0x00, 0x01, 0x90, 0x00, -+0x00, 0x02, 0x58, 0x00, 0x00, 0x03, 0xC0, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, -+0x00, 0x07, 0xD0, 0x00, 0x00, 0x0A, 0xF0, 0x00, 0x00, 0x0E, 0x10, 0x00, 0x00, 0x00, 0xC8, 0x00, -+0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, -+0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, -+0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, -+0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, -+0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, -+0x04, 0x00, 0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x48, 0x00, -+0x60, 0x00, 0x6C, 0x00, 0x1E, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, -+0xC8, 0x00, 0xF0, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0x90, 0x02, -+0x58, 0x03, 0x20, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, -+0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, -+0x20, 0x03, 0xE8, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x00, -+0xF0, 0x01, 0x18, 0x01, 0x40, 0x01, 0x68, 0x00, 0x64, 0x00, 0x96, 0x00, 0xC8, 0x01, 0x2C, 0x01, -+0xE0, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x05, 0x78, 0x07, 0x08, 0x00, 0x64, 0x00, 0x8C, 0x00, -+0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x00, -+0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, -+0xE8, 0x03, 0xE8, 0x02, 0x04, 0x06, 0x08, 0x0A, 0x0C, 0x10, 0x18, 0x20, 0x30, 0x40, 0x50, 0x02, -+0x02, 0x02, 0x02, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x04, 0x05, 0x05, 0x05, 0x06, -+0x07, 0x08, 0x08, 0x06, 0x06, 0x06, 0x07, 0x09, 0x09, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, -+0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, -+0x07, 0x08, 0x08, 0x0A, 0x0A, 0x06, 0x06, 0x06, 0x07, 0x07, 0x07, 0x08, 0x08, 0x0A, 0x0B, 0x05, -+0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x0A, 0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x01, -+0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x05, 0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, -+0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x05, -+0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, -+0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, -+0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x05, 0x22, 0x05, -+0x50, 0x05, 0x51, 0x08, 0x08, 0x08, 0x38, 0x09, 0x0C, 0x0B, 0x00, 0x0C, 0x00, 0x0E, 0x00, 0x08, -+0xC4, 0x08, 0x2C, 0x0C, 0x5C, 0x0C, 0x60, 0x0C, 0x64, 0x0C, 0x68, 0x0C, 0xB8, 0x0C, 0xB0, 0x0C, -+0xB4, 0x0E, 0x5C, 0x0E, 0x60, 0x0E, 0x64, 0x0E, 0x68, 0x0E, 0xB8, 0x0E, 0xB0, 0x0E, 0xB4, 0x0C, -+0x00, 0x0C, 0x94, 0x0C, 0x88, 0x0C, 0x8C, 0x0C, 0xE8, 0x0C, 0x10, 0x0D, 0x00, 0x0C, 0x90, 0x0C, -+0xC4, 0x0C, 0xC8, 0x0C, 0xCC, 0x0C, 0xD4, 0x0C, 0x80, 0x0C, 0x84, 0x0E, 0x00, 0x0E, 0x94, 0x0E, -+0x88, 0x0E, 0x8C, 0x0E, 0xE8, 0x0E, 0x10, 0x0D, 0x40, 0x0E, 0x90, 0x0E, 0xC4, 0x0E, 0xC8, 0x0E, -+0xCC, 0x0E, 0xD4, 0x0E, 0x80, 0x0E, 0x84, 0x00, 0x01, 0x04, 0x02, 0x03, 0x05, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, -+0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, -+0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, -+0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, -+0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, -+0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, -+0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, -+0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, -+0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, -+0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, -+0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, -+0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, -+0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, -+0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, -+0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, -+0x82, 0x23, 0x90, 0x47, 0x50, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, -+0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 0x22, 0xBB, 0x01, 0x0A, 0x89, -+0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE0, 0x22, 0x50, 0x06, 0x87, 0xF0, 0x09, 0xE7, 0x19, -+0x22, 0xBB, 0xFE, 0x07, 0xE3, 0xF5, 0xF0, 0x09, 0xE3, 0x19, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xE4, -+0x93, 0xF5, 0xF0, 0x74, 0x01, 0x93, 0x22, 0xBB, 0x01, 0x10, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, -+0x83, 0x3A, 0xF5, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE0, 0x22, 0x50, 0x09, 0xE9, 0x25, 0x82, 0xF8, -+0x86, 0xF0, 0x08, 0xE6, 0x22, 0xBB, 0xFE, 0x0A, 0xE9, 0x25, 0x82, 0xF8, 0xE2, 0xF5, 0xF0, 0x08, -+0xE2, 0x22, 0xE5, 0x83, 0x2A, 0xF5, 0x83, 0xE9, 0x93, 0xF5, 0xF0, 0xA3, 0xE9, 0x93, 0x22, 0xEF, -+0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, -+0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, -+0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, -+0x42, 0xF0, 0xEC, 0x64, 0x80, 0xC8, 0x64, 0x80, 0x98, 0x45, 0xF0, 0x22, 0xEB, 0x9F, 0xF5, 0xF0, -+0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, 0xF0, 0x22, 0xBB, 0x01, 0x07, -+0x89, 0x82, 0x8A, 0x83, 0x02, 0x49, 0x4B, 0x50, 0x05, 0xE9, 0xF8, 0x02, 0x49, 0xEC, 0xBB, 0xFE, -+0x05, 0xE9, 0xF8, 0x02, 0x49, 0x57, 0x89, 0x82, 0x8A, 0x83, 0x02, 0x49, 0x63, 0xBB, 0x01, 0x0D, -+0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0x02, 0x49, 0x4B, 0x50, 0x07, 0xE9, -+0x25, 0x82, 0xF8, 0x02, 0x49, 0xEC, 0xBB, 0xFE, 0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, 0x49, 0x57, -+0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0x02, 0x49, 0x63, 0xBB, 0x01, 0x07, -+0x89, 0x82, 0x8A, 0x83, 0x02, 0x27, 0x48, 0x50, 0x05, 0xE9, 0xF8, 0x02, 0x49, 0xF8, 0xBB, 0xFE, -+0x05, 0xE9, 0xF8, 0x02, 0x49, 0x9C, 0x22, 0xBB, 0x01, 0x0D, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, -+0x83, 0x3A, 0xF5, 0x83, 0x02, 0x27, 0x48, 0x50, 0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, 0x49, 0xF8, -+0xBB, 0xFE, 0x07, 0xE9, 0x25, 0x82, 0xF8, 0x02, 0x49, 0x9C, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, -+0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE2, 0xFC, 0x08, 0xE2, 0xFD, 0x08, 0xE2, 0xFE, 0x08, -+0xE2, 0xFF, 0x22, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, 0xFD, 0x74, 0x02, 0x93, 0xFE, 0x74, 0x03, -+0x93, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE2, -+0xFB, 0x08, 0xE2, 0xF9, 0x08, 0xE2, 0xFA, 0x08, 0xE2, 0xCB, 0xF8, 0x22, 0xE4, 0x93, 0xF8, 0x74, -+0x01, 0x93, 0xF9, 0x74, 0x02, 0x93, 0xFA, 0x74, 0x03, 0x93, 0xFB, 0x22, 0xEC, 0xF2, 0x08, 0xED, -+0xF2, 0x08, 0xEE, 0xF2, 0x08, 0xEF, 0xF2, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, -+0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, -+0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, -+0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, -+0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xE6, 0xFC, 0x08, 0xE6, -+0xFD, 0x08, 0xE6, 0xFE, 0x08, 0xE6, 0xFF, 0x22, 0xEC, 0xF6, 0x08, 0xED, 0xF6, 0x08, 0xEE, 0xF6, -+0x08, 0xEF, 0xF6, 0x22, 0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x4A, 0x08, 0x85, 0xD0, 0x0B, 0x75, -+0xD0, 0x08, 0xAA, 0xE0, 0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, -+0xF5, 0x8C, 0xD2, 0x8C, 0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, -+0x81, 0xB4, 0x40, 0x00, 0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, -+0xAF, 0xE6, 0x30, 0xE1, 0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, -+0x22, 0xE5, 0x0C, 0xFF, 0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, -+0x78, 0x81, 0xE6, 0x30, 0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, -+0x86, 0x25, 0x0C, 0xF8, 0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, -+0xFF, 0xCD, 0xF8, 0xE8, 0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, -+0x9F, 0x40, 0x27, 0xE5, 0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, -+0xFD, 0x18, 0xE6, 0xCD, 0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, -+0xE5, 0x0C, 0x24, 0x86, 0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, -+0x7F, 0x04, 0xC2, 0xAF, 0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, -+0x30, 0xE3, 0x04, 0x7F, 0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, -+0x22, 0x78, 0x86, 0xA6, 0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, -+0x03, 0xE4, 0x78, 0x80, 0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4D, -+0x73, 0x74, 0x01, 0x93, 0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, -+0x75, 0x8C, 0x79, 0xD2, 0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, -+0xFF, 0x22, 0x74, 0x81, 0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, -+0xF6, 0xD2, 0xAF, 0xAE, 0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, -+0xF9, 0x08, 0xE6, 0x18, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, -+0x19, 0x19, 0xF7, 0x09, 0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, -+0x05, 0x81, 0x05, 0x81, 0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, -+0xEE, 0xB5, 0x0C, 0x02, 0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, -+0x19, 0xE7, 0x09, 0x09, 0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, -+0x04, 0xF8, 0xEF, 0x2F, 0x04, 0x90, 0x4D, 0x73, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, -+0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, -+0xE6, 0x30, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, -+0x0A, 0x74, 0x86, 0x2F, 0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x4A, 0x51, 0x50, 0x2E, 0x74, 0x87, 0x2F, -+0xF8, 0xE6, 0xBF, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, -+0xE6, 0xFC, 0xE9, 0x6C, 0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, -+0xA6, 0x05, 0x1F, 0xE5, 0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, -+0xFD, 0x18, 0x86, 0x01, 0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, -+0xB5, 0x07, 0x02, 0xAC, 0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, -+0xF4, 0xE5, 0x0C, 0xB5, 0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, -+0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, -+0xE0, 0x02, 0xD2, 0xE4, 0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, -+0x4A, 0x50, 0x8F, 0xF0, 0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, -+0xF7, 0x0D, 0x7F, 0x08, 0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, -+0xF1, 0x06, 0xED, 0xF6, 0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, -+0xE7, 0x25, 0x0E, 0x30, 0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, -+0xE7, 0x15, 0x54, 0xEC, 0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x4A, 0x51, 0x7F, 0x08, 0x08, -+0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, -+0x22, 0x02, 0x4C, 0xEF, 0x02, 0x4A, 0xE1, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, -+0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, -+0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, -+0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, -+0x4D, 0x34, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, -+0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, -+0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, -+0xDE, 0xE7, 0x80, 0xBE, 0x00, 0x41, 0xA4, 0xA2, 0x00, 0x41, 0xA4, 0xA3, 0x00, 0x41, 0xA4, 0xA4, -+0x00, 0x60, 0x26, 0xA4, 0x27, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, -+0x0C, 0x0D, 0x0E, 0x24, 0x28, 0x2C, 0x30, 0x34, 0x38, 0x3C, 0x40, 0x64, 0x68, 0x6C, 0x70, 0x74, -+0x78, 0x7C, 0x80, 0x84, 0x88, 0x8C, 0x95, 0x99, 0x9D, 0xA1, 0xA5, 0x41, 0xA4, 0xB9, 0x00, 0x41, -+0xA4, 0xBC, 0x00, 0x4E, 0x7D, 0x4F, 0xA9, 0x4F, 0xFA, 0x90, 0x00, 0xF0, 0xE0, 0x7F, 0x01, 0x20, -+0xE2, 0x02, 0x7F, 0x03, 0x22, 0xB1, 0x79, 0x90, 0xA0, 0x8B, 0xEF, 0xF0, 0xB1, 0x97, 0x90, 0x01, -+0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, 0x95, 0xD1, 0x1C, 0xD1, 0x4C, 0xB1, 0xB9, 0xB1, 0xD8, 0xB1, -+0xF7, 0xE4, 0xF5, 0x51, 0x75, 0x52, 0x58, 0xAB, 0x51, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x39, 0x04, -+0xAB, 0x52, 0x7D, 0x03, 0x7F, 0x01, 0x02, 0x39, 0x04, 0x75, 0x5D, 0x12, 0xE4, 0xF5, 0x5E, 0x75, -+0x5F, 0x07, 0x75, 0x60, 0x72, 0x90, 0x01, 0x30, 0xE5, 0x5D, 0xF0, 0xA3, 0xE5, 0x5E, 0xF0, 0xA3, -+0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, 0x75, 0x65, 0x0E, 0x75, 0x66, 0x01, 0x75, 0x67, -+0x03, 0x75, 0x68, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, -+0x67, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x22, 0xE4, 0xF5, 0x55, 0xF5, 0x56, 0xF5, 0x57, 0xF5, 0x58, -+0xAD, 0x55, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xAD, 0x56, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xAD, 0x57, -+0x7F, 0x52, 0x12, 0x3A, 0x96, 0xAD, 0x58, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x30, 0xE4, -+0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x38, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, -+0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xE4, 0xFD, -+0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x34, 0x74, -+0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x3C, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, -+0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0x7D, -+0xFF, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x3A, 0x96, 0x90, 0x00, 0x80, -+0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, 0xF1, 0x1A, 0x12, 0x3A, 0xB8, 0xF1, 0x79, -+0xD1, 0xFF, 0x7F, 0x01, 0x71, 0x19, 0x90, 0xA1, 0xCE, 0x74, 0x02, 0xF0, 0xFF, 0x71, 0x19, 0x90, -+0xA1, 0xCE, 0xE0, 0x04, 0xF0, 0xB1, 0x85, 0xD1, 0xDB, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, -+0x7F, 0x80, 0x12, 0x3A, 0x96, 0x75, 0x28, 0xFF, 0xF1, 0x0B, 0x12, 0x7A, 0xFE, 0x90, 0x00, 0xF1, -+0xE0, 0x54, 0xF0, 0xD3, 0x94, 0x10, 0x40, 0x08, 0x90, 0xA2, 0xE8, 0x74, 0x01, 0xF0, 0x80, 0x05, -+0xE4, 0x90, 0xA2, 0xE8, 0xF0, 0xF1, 0x22, 0xE4, 0xFF, 0x61, 0xA2, 0xF1, 0x05, 0xF1, 0x12, 0x12, -+0x81, 0x44, 0x12, 0x9A, 0x89, 0x12, 0xB7, 0x8F, 0xF1, 0x2C, 0xF1, 0x3B, 0x90, 0xA1, 0xD2, 0xE0, -+0x54, 0xFE, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xE4, -+0x90, 0xA0, 0x8A, 0xF0, 0x22, 0xE4, 0x90, 0xA1, 0x2D, 0xF0, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, -+0x85, 0x22, 0xE4, 0x90, 0xA1, 0x27, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, -+0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x0F, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0xA1, 0xCA, 0xE0, -+0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0xA1, 0xCF, 0xE0, 0x54, -+0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xD1, 0xEC, 0x12, -+0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0xA1, 0xD2, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, -+0x13, 0x30, 0xE0, 0x14, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xD3, 0xF0, 0x90, 0x00, -+0x02, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xD4, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, -+0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, -+0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, -+0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0xA2, 0xEC, 0xF0, 0x90, 0xA2, -+0xEC, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0xA9, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x4F, 0xA3, 0xF0, 0x12, -+0x3A, 0xEB, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x69, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x0E, 0x90, 0xA1, -+0xB4, 0xE0, 0xFF, 0x90, 0xA1, 0xB3, 0xE0, 0x6F, 0x60, 0x02, 0xF1, 0xF0, 0xC2, 0xAF, 0x12, 0x7B, -+0x54, 0xBF, 0x01, 0x03, 0x12, 0x81, 0x06, 0xD2, 0xAF, 0x12, 0x58, 0x5D, 0x51, 0x51, 0x80, 0xBE, -+0x90, 0xA1, 0xB3, 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x62, 0x53, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, -+0x12, 0x4C, 0x52, 0x90, 0xA2, 0xF0, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0xA0, 0x8A, 0xE0, 0x60, 0xEA, -+0xC2, 0xAF, 0x30, 0xE0, 0x11, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x66, 0xA4, 0x12, 0x8E, 0x47, -+0x90, 0xA1, 0xED, 0xE0, 0x04, 0xF0, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0xA0, 0x8A, 0xE0, 0xFF, 0x30, -+0xE1, 0x0B, 0x54, 0xFD, 0xF0, 0x90, 0xA1, 0xEF, 0xE0, 0x04, 0xF0, 0x31, 0xEE, 0xD2, 0xAF, 0xC2, -+0xAF, 0x90, 0xA0, 0x8A, 0xE0, 0xFF, 0x30, 0xE2, 0x05, 0x54, 0xFB, 0xF0, 0x11, 0x52, 0xD2, 0xAF, -+0x80, 0xB8, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA1, 0x28, 0xE0, 0xFE, -+0x90, 0xA1, 0x27, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, -+0x01, 0x60, 0x48, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x13, 0xED, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x91, -+0xF9, 0x74, 0xA0, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x11, 0xC0, 0x7F, 0x01, 0x90, 0xA1, 0x27, 0xE0, -+0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x91, 0xF9, 0x74, 0xA0, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x31, 0x23, -+0x7F, 0x01, 0xEF, 0x60, 0x16, 0x90, 0xA1, 0x27, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, -+0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA1, 0x27, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0xF1, 0x12, 0x49, 0xBD, 0x90, 0xA4, 0xA4, -+0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, 0x7F, 0xAF, 0x7E, 0x01, 0x31, -+0x98, 0xEF, 0x60, 0x3A, 0x90, 0xA2, 0xF1, 0x12, 0x49, 0xB4, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, -+0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, -+0x12, 0x34, 0x2C, 0x90, 0xA2, 0xF1, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x90, -+0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x9E, 0x12, 0x49, 0xBD, -+0x7F, 0x96, 0x7E, 0x02, 0x31, 0x98, 0xEF, 0x60, 0x5A, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, -+0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, -+0xFE, 0x90, 0xA4, 0xA1, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0xA4, 0xA1, 0xE0, -+0xFD, 0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA4, 0x9E, 0x12, 0x49, 0xB4, 0x90, 0x00, -+0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0x12, 0x7A, 0x2A, 0x90, 0xA4, 0xA1, -+0xE0, 0x24, 0x18, 0xFF, 0x90, 0xA4, 0x9E, 0x12, 0x49, 0xB4, 0x12, 0x7A, 0x85, 0x90, 0x02, 0x96, -+0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0xA4, 0x96, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x96, 0xE0, -+0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x2D, 0xC3, 0x90, 0xA4, 0x99, 0xE0, 0x94, -+0xE8, 0x90, 0xA4, 0x98, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, -+0x7F, 0x00, 0x80, 0x15, 0x90, 0xA4, 0x98, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x7F, 0x0A, -+0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x80, 0xC5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA2, 0xF1, 0xF0, 0x90, -+0xA2, 0xF1, 0xE0, 0xFD, 0x70, 0x02, 0x61, 0x18, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x01, 0x7E, -+0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, -+0x70, 0x02, 0x61, 0x11, 0x90, 0xA4, 0xA2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x49, -+0xA8, 0xE0, 0x90, 0xA2, 0xF2, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, 0xA2, 0x75, 0x42, 0xF2, 0x75, -+0x43, 0x01, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xF3, 0x12, 0x34, 0x2C, 0x90, 0xA4, 0xA2, 0xE0, 0x75, -+0xF0, 0x04, 0x90, 0x01, 0xD1, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xF4, 0xF0, 0x90, 0xA4, 0xA2, -+0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD2, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xF5, 0xF0, 0x90, -+0xA4, 0xA2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD3, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xF6, -+0xF0, 0x90, 0xA4, 0xA2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF0, 0x12, 0x49, 0xA8, 0xE0, 0x90, -+0xA2, 0xF7, 0xF0, 0x90, 0xA4, 0xA2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF1, 0x12, 0x49, 0xA8, -+0xE0, 0x90, 0xA2, 0xF8, 0xF0, 0x90, 0xA4, 0xA2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF2, 0x12, -+0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xF9, 0xF0, 0x90, 0xA4, 0xA2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, -+0xF3, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xFA, 0xF0, 0x90, 0xA2, 0xF1, 0xE0, 0xFF, 0x90, 0xA4, -+0xA2, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, -+0x90, 0xA2, 0xF1, 0xF0, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0xA2, 0xF3, 0xE0, 0xFF, 0x7B, 0x01, 0x7A, -+0xA2, 0x79, 0xF4, 0x71, 0x1D, 0x90, 0xA4, 0xA2, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x21, -+0xFF, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0xFB, -+0x12, 0x49, 0xBD, 0xEF, 0x12, 0x49, 0xC6, 0x53, 0x58, 0x00, 0x53, 0x61, 0x01, 0x53, 0x6A, 0x02, -+0x53, 0x73, 0x03, 0x53, 0x7C, 0x04, 0x53, 0x85, 0x20, 0x53, 0x8E, 0x21, 0x53, 0x97, 0x23, 0x53, -+0x9F, 0x25, 0x53, 0xA8, 0x27, 0x53, 0xB1, 0x40, 0x53, 0xC0, 0x42, 0x53, 0xC9, 0x43, 0x53, 0xD2, -+0x45, 0x53, 0xDA, 0x87, 0x00, 0x00, 0x53, 0xE2, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x70, -+0x41, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x70, 0x89, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, -+0x02, 0x71, 0x62, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0xB7, 0x3A, 0x90, 0xA2, 0xFB, 0x12, -+0x49, 0xB4, 0x02, 0x4F, 0x4D, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x71, 0x9A, 0x90, 0xA2, -+0xFB, 0x12, 0x49, 0xB4, 0x02, 0x77, 0xE6, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0xE1, 0xE4, 0x90, -+0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x78, 0x2C, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x78, -+0x3C, 0x90, 0xA1, 0xF0, 0xE0, 0x04, 0xF0, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x97, 0x5D, -+0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, 0x98, 0xE7, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x02, -+0x99, 0x88, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, 0x80, 0x10, 0x90, 0xA2, 0xFB, 0x12, 0x49, 0xB4, -+0x80, 0x50, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, -+0x90, 0xA1, 0xF7, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xF8, 0xF0, 0x12, 0xA2, -+0x61, 0x7F, 0x01, 0x90, 0xA2, 0xFE, 0x74, 0x11, 0xF0, 0x90, 0xA3, 0x0C, 0x74, 0x01, 0xF0, 0x90, -+0xA3, 0x00, 0xEF, 0xF1, 0xEC, 0x7F, 0x04, 0x90, 0xA4, 0xB7, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x4C, -+0x2B, 0x90, 0xA0, 0x8A, 0xE0, 0xFF, 0x90, 0xA4, 0xB7, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0xA0, 0x8A, -+0xF0, 0x22, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xBD, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0xA2, 0xFE, 0x12, -+0x49, 0xB4, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA3, 0x13, 0xF0, 0xE4, 0xFB, 0xFD, 0x91, -+0x76, 0x90, 0xA3, 0x01, 0x74, 0x10, 0xF0, 0x90, 0xA3, 0x0F, 0x74, 0x07, 0xF0, 0x90, 0xA2, 0xFE, -+0x12, 0x49, 0xB4, 0x12, 0x26, 0x1E, 0x90, 0xA3, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x01, -+0xF1, 0xF3, 0x7F, 0x04, 0x80, 0xA1, 0x90, 0xA3, 0x11, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA3, -+0x10, 0xEF, 0xF0, 0x90, 0xA3, 0x13, 0xE0, 0xFD, 0x12, 0x9A, 0xE8, 0x90, 0xA3, 0x10, 0xE0, 0xC3, -+0x94, 0x0E, 0x50, 0x46, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, -+0x86, 0x12, 0x27, 0x54, 0x12, 0xD4, 0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0xF1, 0x99, 0x90, 0xA3, -+0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0xF1, 0x0F, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, -+0x7E, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xC1, 0x23, 0x90, 0xA3, 0x10, 0xE0, 0xFF, 0x74, -+0x24, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x30, 0x50, 0x16, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, -+0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x09, 0x28, 0x00, 0x00, 0x80, 0x70, -+0x90, 0xA3, 0x10, 0xE0, 0xFF, 0x74, 0x32, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, 0x50, 0x16, -+0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, -+0x08, 0xA6, 0x00, 0x00, 0x80, 0x4A, 0x90, 0xA3, 0x10, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, -+0x1B, 0xEF, 0x94, 0x74, 0x50, 0x16, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, -+0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x08, 0xA4, 0x00, 0x00, 0x80, 0x24, 0x90, 0xA3, 0x10, 0xE0, -+0xFF, 0x74, 0x76, 0xD3, 0x9F, 0x50, 0x1F, 0xEF, 0x94, 0xA5, 0x50, 0x1A, 0x90, 0xA3, 0x82, 0x12, -+0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x08, 0x24, 0x00, 0x00, -+0x7F, 0x60, 0x7E, 0x08, 0xF1, 0x99, 0x90, 0xA3, 0x10, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, -+0x31, 0xEF, 0x94, 0x40, 0x50, 0x2C, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, -+0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0xF1, 0x0F, 0x90, 0xA3, 0x7A, 0x12, -+0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, -+0x80, 0x71, 0x90, 0xA3, 0x10, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x31, 0xEF, 0x94, 0x8C, -+0x50, 0x2C, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x7E, 0x12, -+0x27, 0x54, 0x00, 0x03, 0x01, 0x00, 0xF1, 0x0F, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, -+0x03, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, 0x03, 0x01, 0x00, 0x80, 0x35, 0x90, 0xA3, -+0x10, 0xE0, 0xFF, 0x74, 0x8C, 0xC3, 0x9F, 0x50, 0x32, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, -+0x07, 0x03, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, 0x05, 0x01, 0x00, 0xF1, 0x0F, 0x90, -+0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, -+0x05, 0x01, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0xF1, 0x15, 0x90, 0xA3, 0x11, 0xE0, 0x64, -+0x02, 0x70, 0x66, 0x90, 0xA3, 0x10, 0xE0, 0xFF, 0xD3, 0x94, 0x30, 0x50, 0x08, 0x90, 0xA3, 0x14, -+0x74, 0x2A, 0xF0, 0x80, 0x70, 0xEF, 0xD3, 0x94, 0x40, 0x50, 0x08, 0x90, 0xA3, 0x14, 0x74, 0x3A, -+0xF0, 0x80, 0x62, 0xEF, 0xD3, 0x94, 0x70, 0x50, 0x08, 0x90, 0xA3, 0x14, 0x74, 0x6A, 0xF0, 0x80, -+0x54, 0xEF, 0xD3, 0x94, 0x80, 0x50, 0x08, 0x90, 0xA3, 0x14, 0x74, 0x7A, 0xF0, 0x80, 0x46, 0xEF, -+0xD3, 0x94, 0x90, 0x50, 0x08, 0x90, 0xA3, 0x14, 0x74, 0x8A, 0xF0, 0x80, 0x38, 0xEF, 0xD3, 0x94, -+0xA1, 0x50, 0x08, 0x90, 0xA3, 0x14, 0x74, 0x9B, 0xF0, 0x80, 0x2A, 0xEF, 0xD3, 0x94, 0xB1, 0x50, -+0x24, 0x90, 0xA3, 0x14, 0x74, 0xAB, 0xF0, 0x80, 0x1C, 0x90, 0xA3, 0x11, 0xE0, 0x64, 0x01, 0x70, -+0x32, 0xA3, 0xE0, 0x90, 0xA3, 0x10, 0xB4, 0x01, 0x05, 0xE0, 0x24, 0x02, 0x80, 0x03, 0xE0, 0x24, -+0xFE, 0x90, 0xA3, 0x14, 0xF0, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, -+0xA3, 0x14, 0xF1, 0x03, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA3, -+0x14, 0x80, 0x1C, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA3, 0x10, -+0xF1, 0x03, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA3, 0x10, 0xE0, -+0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, 0x00, 0x7F, -+0x01, 0x80, 0x12, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x48, 0x7D, -+0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x90, 0xA3, 0x78, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA3, 0x77, -+0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x3A, 0xA9, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x48, 0x90, -+0xA3, 0x7A, 0x12, 0x49, 0x4B, 0x12, 0x27, 0x15, 0x90, 0xA3, 0x82, 0x12, 0x49, 0x73, 0x12, 0x48, -+0x7C, 0x90, 0xA3, 0x7E, 0x12, 0x49, 0x73, 0x12, 0x48, 0x89, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x48, -+0x90, 0xA3, 0x78, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0xA3, 0x86, 0x12, 0x49, 0x4B, 0x90, 0xAC, -+0x96, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x77, 0xE0, 0xFF, 0xD0, 0x05, 0x02, 0x39, 0xBA, 0x90, 0x07, -+0x1F, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, 0xA3, 0x94, 0xF0, 0x90, -+0xA3, 0x92, 0x74, 0x02, 0xF0, 0x90, 0xA3, 0xA0, 0x14, 0xF0, 0xFB, 0x7A, 0xA3, 0x79, 0x92, 0xF1, -+0xF3, 0x7F, 0x04, 0x81, 0x17, 0x7F, 0x2C, 0x7E, 0x08, 0x90, 0xA3, 0x80, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0x12, 0x36, 0xCE, 0x90, 0xA3, 0x8A, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x82, 0x12, 0x49, 0x4B, -+0x12, 0x27, 0x15, 0x90, 0xA3, 0x8A, 0x12, 0x49, 0x73, 0x12, 0x48, 0x7C, 0x90, 0xA3, 0x86, 0x12, -+0x49, 0x73, 0x12, 0x48, 0x89, 0x90, 0xA3, 0x8E, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x8E, 0x12, 0x49, -+0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x80, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x02, -+0x37, 0x5D, 0x80, 0x8A, 0x12, 0x26, 0x1E, 0x90, 0xA1, 0xBB, 0xF0, 0x22, 0xF0, 0x7B, 0x01, 0x7A, -+0xA2, 0x79, 0xFE, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA1, 0x27, 0xE0, 0xFF, 0x70, -+0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA1, 0x28, 0xE0, 0xB5, 0x07, -+0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, -+0xF0, 0x80, 0x35, 0xC0, 0x01, 0x90, 0xA1, 0x28, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x91, 0xF9, -+0x74, 0xA0, 0x35, 0xF0, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, -+0x47, 0xD0, 0x90, 0xA1, 0x28, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, -+0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA1, 0x28, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD1, 0x38, 0xB1, -+0x79, 0x11, 0xB4, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA4, 0x61, 0xF0, -+0x90, 0x01, 0xC7, 0xE0, 0x64, 0xAD, 0x70, 0x37, 0xF0, 0x90, 0xA4, 0x6E, 0x74, 0x0F, 0xF0, 0x90, -+0xA4, 0x60, 0x74, 0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x61, 0xE0, 0x2F, 0xFE, 0x74, -+0x62, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x0F, 0xE9, -+0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x60, 0x12, 0x51, 0x23, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x00, 0x8F, 0xE0, 0x20, -+0xE6, 0x02, 0x81, 0x7E, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA4, 0xA5, 0xF0, 0x90, 0x00, 0x8D, 0xE0, -+0x90, 0xA4, 0xA6, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0xA4, 0xA7, 0xF0, 0x90, 0xA4, 0xA6, 0xE0, -+0x12, 0x49, 0xC6, 0x58, 0xFC, 0x01, 0x59, 0x05, 0x02, 0x59, 0x0E, 0x03, 0x59, 0x17, 0x04, 0x5A, -+0x33, 0x05, 0x5B, 0x2C, 0x06, 0x5B, 0xB4, 0x08, 0x00, 0x00, 0x5C, 0x70, 0x90, 0xA4, 0xA5, 0xE0, -+0xFF, 0xB1, 0xD8, 0x81, 0x70, 0x90, 0xA4, 0xA5, 0xE0, 0xFF, 0x91, 0xB1, 0x81, 0x70, 0x90, 0xA4, -+0xA5, 0xE0, 0xFF, 0xB1, 0x21, 0x81, 0x70, 0x90, 0xA4, 0xA5, 0xE0, 0x24, 0x0A, 0xF5, 0x82, 0xE4, -+0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, -+0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, -+0xFF, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, -+0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0xE4, 0xFF, 0x91, 0x89, 0x90, 0xA4, 0xA5, -+0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x54, 0x03, 0xFB, 0x0D, -+0xE4, 0xFF, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0A, 0x12, 0x49, -+0xA8, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x04, 0x90, -+0x95, 0x0B, 0x91, 0x83, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0C, 0x12, 0x49, -+0xA8, 0xE0, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, -+0x75, 0xF0, 0x04, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x1F, 0xFB, 0x0D, 0x91, 0x89, -+0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0xFB, 0xE4, -+0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x01, 0x91, 0x83, -+0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x91, 0x83, 0x90, 0xA4, 0xA5, 0xE0, -+0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x91, 0x83, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x08, 0x90, -+0x89, 0x04, 0x12, 0x49, 0xA8, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, -+0x75, 0xF0, 0x08, 0x90, 0x89, 0x05, 0x91, 0x83, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x08, 0x90, -+0x89, 0x06, 0x91, 0x83, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x07, 0x12, 0x49, -+0xA8, 0x61, 0xAF, 0x90, 0xA4, 0xA5, 0xE0, 0x25, 0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x92, -+0xF5, 0x83, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x25, 0xE0, -+0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA4, -+0xA5, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x79, 0x12, 0x49, 0xA8, 0xA3, 0xE0, 0xFB, 0x0D, 0x91, -+0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x79, 0x91, 0x83, 0x90, 0xA4, 0xA5, -+0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x7B, 0x12, 0x49, 0xA8, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, -+0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x7D, 0x12, 0x49, 0xA8, 0xA3, -+0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x7F, 0x12, -+0x49, 0xA8, 0xA3, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x75, 0xF0, 0x0A, 0x90, -+0x8D, 0x81, 0x12, 0x49, 0xA8, 0xA3, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x24, -+0x0A, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0xE4, -+0xFB, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, -+0xF5, 0x83, 0xA3, 0xE0, 0xFB, 0x7D, 0x02, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x25, 0xE0, 0x24, -+0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xD7, -+0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA1, 0xD8, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, -+0xA1, 0xD9, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xDA, 0x61, 0xAF, 0x90, 0xA1, 0xDF, 0xE0, -+0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x89, 0x90, 0xA1, 0xE0, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, -+0xE1, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xE2, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, -+0xE3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA1, 0xE4, 0xE0, 0xFB, 0x0D, 0x91, 0x89, -+0x90, 0xA1, 0xE5, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xE6, 0xE0, 0xFB, 0x0D, 0x91, 0x89, -+0x90, 0xA1, 0xE7, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA1, 0xE8, 0xE0, 0xFB, 0x0D, -+0x91, 0x89, 0x90, 0xA1, 0xE9, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xEA, 0xE0, 0xFB, 0x0D, -+0x91, 0x89, 0x90, 0xA1, 0xEB, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA1, 0xEC, 0xE0, -+0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xED, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xEE, 0xE0, -+0xFB, 0x0D, 0x81, 0x6E, 0x90, 0xA1, 0xB1, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x89, 0x90, 0xA1, -+0xB0, 0xE0, 0x54, 0x0F, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xB3, 0xE0, 0xFB, 0x0D, 0x91, 0x89, -+0x90, 0xA1, 0xB4, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA4, 0xA5, 0xE0, 0x24, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, 0xA1, 0xAE, 0xE0, -+0x54, 0x01, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xAE, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFB, -+0x0D, 0x7F, 0x01, 0x91, 0x89, 0x90, 0xA1, 0xAE, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, -+0x0D, 0x7F, 0x01, 0x91, 0x89, 0x90, 0xA1, 0xC9, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x89, 0x90, -+0xA1, 0xB9, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xB8, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, -+0xA1, 0xB7, 0xE0, 0xFB, 0x0D, 0x91, 0x89, 0x90, 0xA1, 0xB0, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, 0xE4, -+0xFD, 0x7F, 0x03, 0x91, 0x89, 0x90, 0xA1, 0xAF, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, -+0x03, 0x91, 0x89, 0x90, 0xA1, 0xAF, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, -+0x91, 0x89, 0x90, 0xA1, 0xAE, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0x91, 0x89, -+0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x12, 0x49, 0xA8, 0xE0, 0xFB, 0x0D, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, -+0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, -+0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, -+0x22, 0x90, 0xA4, 0xB5, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x63, 0x90, 0x00, 0x8D, -+0xE0, 0x64, 0x02, 0x70, 0x5B, 0x90, 0xA4, 0xB6, 0xF0, 0x90, 0xA4, 0xB6, 0xE0, 0xFD, 0x90, 0xA4, -+0xB5, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, -+0x82, 0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x91, 0x89, 0x90, -+0xA4, 0xB6, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x08, 0x40, 0xCE, 0x90, 0xA4, 0xB6, 0xE0, 0xFD, -+0xC3, 0x94, 0x10, 0x50, 0x0D, 0xE4, 0xFB, 0xFF, 0x91, 0x89, 0x90, 0xA4, 0xB6, 0xE0, 0x04, 0xF0, -+0x80, 0xE9, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, -+0x22, 0x90, 0xA2, 0xED, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x4B, 0x90, 0x00, 0x8D, -+0xE0, 0x64, 0x03, 0x70, 0x43, 0x90, 0xA2, 0xEE, 0xF0, 0x90, 0xA2, 0xEE, 0xE0, 0xFD, 0x90, 0xA2, -+0xED, 0xE0, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, -+0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x91, 0x89, 0x90, 0xA2, -+0xEE, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCF, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, -+0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x57, -+0x90, 0x00, 0x8D, 0xE0, 0x64, 0x03, 0x70, 0x4F, 0x90, 0x00, 0x8F, 0xE0, 0xFE, 0x90, 0x00, 0x8E, -+0xE0, 0xFD, 0xED, 0xFF, 0x90, 0xA2, 0xEE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0xA2, 0xED, -+0xF0, 0x90, 0xA2, 0xED, 0xE0, 0xFD, 0xFF, 0x90, 0xA2, 0xEF, 0xE0, 0x2F, 0xFF, 0x90, 0xA2, 0xEE, -+0xE0, 0x34, 0x00, 0x8F, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x91, 0x89, 0x90, 0xA2, 0xED, -+0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD8, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, -+0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0xA4, 0xB3, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x48, 0x90, 0x00, 0x8D, 0xE0, 0x64, -+0x01, 0x70, 0x40, 0x90, 0xA4, 0xB4, 0xF0, 0x90, 0xA4, 0xB4, 0xE0, 0xFD, 0x90, 0xA4, 0xB3, 0xE0, -+0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2D, 0xF5, 0x82, 0xE4, 0x35, -+0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x91, 0x89, 0x90, 0xA4, 0xB4, 0xE0, 0x04, 0xF0, 0xE0, -+0xC3, 0x94, 0x10, 0x40, 0xD2, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, -+0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE5, 0x2A, 0x90, -+0x00, 0x8E, 0xE0, 0x64, 0x05, 0x70, 0x22, 0xA3, 0xE0, 0xFF, 0x90, 0x00, 0x8E, 0xE0, 0xFE, 0x74, -+0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, -+0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8E, 0x12, 0x3A, 0x96, 0x22, 0x90, 0xA3, 0x77, 0xEF, 0xF0, 0xA3, -+0xED, 0xF0, 0xFB, 0xA3, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xE4, 0x90, 0xA3, 0x81, 0xF0, -+0xEB, 0x90, 0xA3, 0x78, 0xF0, 0x90, 0xA2, 0xE8, 0xE0, 0x70, 0x3D, 0x90, 0xA3, 0x77, 0xE0, 0x70, -+0x17, 0xFF, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x04, 0xFF, 0xEC, 0x90, 0xAC, 0xB9, 0x12, -+0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x80, 0x1D, 0x90, 0xA3, 0x77, 0xE0, 0xB4, 0x01, 0x19, 0x7F, -+0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x04, 0xFF, 0xEC, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x78, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, -+0xFE, 0x90, 0xA3, 0x7D, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x7D, 0x12, 0x49, 0x4B, 0x90, 0xAC, 0xB9, -+0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0xA2, 0xE8, 0xE0, 0x70, 0x26, -+0x90, 0xA3, 0x7D, 0x12, 0x49, 0x4B, 0xEE, 0x44, 0x01, 0xFE, 0xEC, 0x90, 0xA3, 0x7D, 0x12, 0x27, -+0x48, 0x90, 0xA3, 0x7D, 0x12, 0x49, 0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, -+0x08, 0x12, 0x37, 0x5D, 0x80, 0x07, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA3, 0x77, -+0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, 0xF5, 0x83, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0x12, 0x36, 0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x90, 0xA3, 0x79, 0x12, -+0x27, 0x48, 0x90, 0xA3, 0x79, 0x02, 0x49, 0x4B, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD1, -+0x6A, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xBD, 0x90, 0xA3, 0x82, 0x12, -+0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, -+0x12, 0x57, 0x95, 0x7D, 0x65, 0xE4, 0xFF, 0xF1, 0x48, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xB4, 0x12, -+0x49, 0x0D, 0x7D, 0x8F, 0xE4, 0xFF, 0xF1, 0x48, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xB4, 0x90, 0x00, -+0x04, 0x12, 0x49, 0x27, 0xE4, 0xFD, 0xFF, 0xF1, 0x48, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xB4, 0x90, -+0x00, 0x08, 0x12, 0x49, 0x27, 0x7D, 0x65, 0x7F, 0x01, 0xF1, 0x48, 0x90, 0xA3, 0x74, 0x12, 0x49, -+0xB4, 0x12, 0x49, 0x0D, 0x7D, 0x8F, 0x7F, 0x01, 0xF1, 0x48, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xB4, -+0x90, 0x00, 0x04, 0x12, 0x49, 0x27, 0xE4, 0xFD, 0x7F, 0x01, 0xF1, 0x48, 0x90, 0xA3, 0x74, 0x12, -+0x49, 0xB4, 0x90, 0x00, 0x08, 0x02, 0x49, 0x27, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0xEF, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0xA3, 0x79, 0x12, 0x49, 0x4B, -+0x90, 0xAC, 0x9C, 0x12, 0x27, 0x48, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0x32, 0x65, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -+0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x01, 0xC4, 0x74, 0x02, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0x11, 0x51, 0x74, 0x02, 0x04, 0x90, 0x01, -+0xC4, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, -+0x32, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x51, -+0x52, 0x53, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, -+0x52, 0x52, 0x54, 0xAB, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x54, 0x7D, 0x01, -+0x7F, 0x01, 0x02, 0x39, 0x04, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -+0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x85, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0x11, 0xD4, 0x74, 0x85, -+0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, -+0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, -+0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x00, 0x54, 0xE0, 0x55, 0x55, 0xF5, 0x59, 0xA3, 0xE0, 0x55, 0x56, -+0xF5, 0x5A, 0xA3, 0xE0, 0x55, 0x57, 0xF5, 0x5B, 0xA3, 0xE0, 0x55, 0x58, 0xF5, 0x5C, 0xAD, 0x59, -+0x7F, 0x54, 0x12, 0x3A, 0x96, 0xAD, 0x5A, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0xAD, 0x5B, 0x7F, 0x56, -+0x12, 0x3A, 0x96, 0xAD, 0x5C, 0x7F, 0x57, 0x12, 0x3A, 0x96, 0x53, 0x91, 0xEF, 0x22, 0xC0, 0xE0, -+0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, -+0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x0E, -+0xF0, 0x74, 0x61, 0xA3, 0xF0, 0x12, 0x7B, 0x7B, 0xE5, 0x61, 0x30, 0xE1, 0x02, 0x91, 0x9A, 0xE5, -+0x61, 0x30, 0xE4, 0x05, 0x7F, 0x02, 0x12, 0x77, 0xD7, 0xE5, 0x63, 0x30, 0xE0, 0x02, 0x31, 0xC3, -+0xE5, 0x63, 0x30, 0xE1, 0x03, 0x12, 0x73, 0xA4, 0xE5, 0x63, 0x30, 0xE2, 0x03, 0x12, 0x73, 0x2B, -+0xE5, 0x63, 0x30, 0xE3, 0x03, 0x12, 0x7B, 0xD8, 0xE5, 0x63, 0x30, 0xE4, 0x03, 0x12, 0x7C, 0x0B, -+0xE5, 0x63, 0x30, 0xE5, 0x03, 0x12, 0x7C, 0x3A, 0xE5, 0x63, 0x30, 0xE6, 0x03, 0x12, 0x7D, 0x3D, -+0xE5, 0x64, 0x30, 0xE1, 0x02, 0xD1, 0x3E, 0xE5, 0x64, 0x30, 0xE4, 0x02, 0xD1, 0x9C, 0xE5, 0x64, -+0x30, 0xE5, 0x02, 0xB1, 0x20, 0xE5, 0x64, 0x30, 0xE6, 0x03, 0x12, 0x57, 0xE2, 0x74, 0x0E, 0x04, -+0x90, 0x01, 0xC4, 0xF0, 0x74, 0x61, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, -+0xD0, 0xE0, 0x32, 0xE4, 0xFF, 0x90, 0xA1, 0xB1, 0xE0, 0x70, 0x02, 0x41, 0x4E, 0x90, 0xA1, 0x2D, -+0xE0, 0x64, 0x01, 0x70, 0x79, 0x90, 0xA1, 0xB0, 0xE0, 0xC4, 0x54, 0x0F, 0x60, 0x24, 0x24, 0xFE, -+0x60, 0x03, 0x04, 0x70, 0x1F, 0x90, 0xA1, 0xB8, 0xE0, 0x14, 0xF0, 0xE0, 0xFE, 0x60, 0x06, 0x90, -+0xA1, 0xBA, 0xE0, 0x60, 0x0F, 0xEE, 0x70, 0x06, 0x90, 0xA1, 0xB7, 0xE0, 0xA3, 0xF0, 0x7F, 0x01, -+0x80, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x47, 0x90, 0xA1, 0xB5, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA1, -+0xBA, 0xE0, 0x60, 0x03, 0xB4, 0x01, 0x09, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0xBA, 0xE0, 0x80, 0x0D, -+0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0xBA, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0xA1, -+0xB9, 0xE0, 0x2F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, -+0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0xB4, 0xE0, 0x20, 0xE2, 0x02, 0x51, 0x4F, 0x22, 0x7D, -+0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xBB, 0xED, 0xF0, 0x90, -+0xA1, 0xAE, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x61, 0xA0, 0xEE, 0xC4, -+0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x02, 0x61, 0xA0, 0x90, 0xA1, 0xB4, 0xE0, 0xFE, 0x6F, -+0x70, 0x02, 0x61, 0xA0, 0xEF, 0x70, 0x02, 0x61, 0x15, 0x24, 0xFE, 0x70, 0x02, 0x61, 0x4F, 0x24, -+0xFE, 0x60, 0x4A, 0x24, 0xFC, 0x70, 0x02, 0x61, 0x8A, 0x24, 0xFC, 0x60, 0x02, 0x61, 0xA0, 0xEE, -+0xB4, 0x0E, 0x02, 0x91, 0x21, 0x90, 0xA1, 0xB4, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x91, 0x49, 0x90, -+0xA1, 0xB4, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0xFB, 0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x04, 0x0F, 0x90, -+0xA4, 0xBB, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0xB9, 0x3E, 0x80, 0x03, 0x12, 0x71, 0x4F, 0x90, 0xA1, -+0xB4, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x61, 0xA0, 0x12, 0x78, 0x9C, 0x61, 0xA0, 0x90, 0xA1, 0xB4, -+0xE0, 0x70, 0x04, 0x7F, 0x01, 0x91, 0x49, 0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0xFB, -+0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x0E, 0x07, 0x71, 0xA5, 0xBF, 0x01, 0x02, 0x91, 0x21, 0x90, 0xA1, -+0xB4, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x61, 0xA0, 0x71, 0xA5, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x61, -+0xA0, 0x91, 0x63, 0x61, 0xA0, 0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x0E, 0x07, 0x71, 0xA5, 0xBF, 0x01, -+0x02, 0x91, 0x21, 0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0xFB, 0x90, 0xA1, 0xB4, 0xE0, -+0xB4, 0x0C, 0x07, 0x71, 0xA5, 0xBF, 0x01, 0x02, 0x91, 0x63, 0x90, 0xA1, 0xB4, 0xE0, 0x64, 0x04, -+0x70, 0x5E, 0x12, 0xB8, 0x8E, 0xEF, 0x64, 0x01, 0x70, 0x56, 0x12, 0x76, 0x7B, 0x80, 0x51, 0x90, -+0xA1, 0xB4, 0xE0, 0xB4, 0x0E, 0x07, 0x71, 0xA5, 0xBF, 0x01, 0x02, 0x91, 0x21, 0x90, 0xA1, 0xB4, -+0xE0, 0xB4, 0x06, 0x02, 0x71, 0xFB, 0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x0C, 0x07, 0x71, 0xA5, 0xBF, -+0x01, 0x02, 0x91, 0x63, 0x90, 0xA1, 0xB4, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x91, 0x49, 0x90, 0xA1, -+0xB4, 0xE0, 0xB4, 0x04, 0x1B, 0x12, 0xB9, 0x80, 0x80, 0x16, 0x90, 0xA1, 0xB4, 0xE0, 0xB4, 0x0C, -+0x0F, 0x90, 0xA1, 0xAF, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x76, 0x6C, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0xB8, 0x75, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, -+0x74, 0x01, 0xF0, 0x80, 0x3D, 0x90, 0xA1, 0xAE, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, -+0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x28, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -+0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x19, 0x90, 0xA1, 0xB3, 0xE0, 0xD3, 0x94, 0x04, -+0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, -+0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0xA1, 0xAF, 0xE0, 0x90, -+0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x04, 0xF0, 0x80, -+0x0A, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x0C, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, -+0x22, 0x90, 0xA1, 0xAF, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0x90, 0xA1, 0xB4, 0x74, 0x0C, 0xF0, -+0x80, 0x11, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA1, 0xB4, -+0x74, 0x04, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0xA4, 0xBA, 0xEF, 0xF0, 0x12, 0x78, -+0xAA, 0x90, 0xA4, 0xBA, 0xE0, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0xB4, 0x74, -+0x04, 0xF0, 0x22, 0x90, 0xA1, 0x2D, 0xE0, 0x64, 0x01, 0x70, 0x2E, 0x90, 0xA1, 0xAF, 0xE0, 0x54, -+0xFD, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x7F, 0x01, 0x12, 0x74, 0xDD, 0xBF, 0x01, 0x0E, -+0x90, 0xA1, 0xAE, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x0E, 0xF0, 0x22, 0x90, 0x01, -+0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x22, 0xE4, 0xFF, 0x90, 0xA3, 0x92, 0xEF, -+0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x1B, 0xA3, 0xE0, 0xF5, 0x1C, 0x65, 0x1B, 0x60, 0x70, 0x90, -+0xA3, 0x93, 0x74, 0x03, 0xF0, 0x90, 0xA3, 0xA1, 0x74, 0x08, 0xF0, 0xE5, 0x1C, 0x04, 0x54, 0x0F, -+0xF5, 0x1D, 0xE4, 0xF5, 0x1A, 0xE5, 0x1D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, -+0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, -+0xFF, 0x74, 0x95, 0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x1A, -+0xE5, 0x1A, 0xB4, 0x08, 0xD0, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x93, 0x12, 0x57, 0xF3, 0xE5, 0x1C, -+0x04, 0x54, 0x0F, 0xF5, 0x1C, 0xB4, 0x0F, 0x03, 0xE4, 0xF5, 0x1C, 0x90, 0x04, 0x7F, 0xE5, 0x1C, -+0xF0, 0x90, 0xA3, 0x92, 0xE0, 0x7F, 0x04, 0x70, 0x03, 0x02, 0x77, 0xD7, 0x12, 0x54, 0x17, 0x22, -+0x90, 0xA1, 0xEC, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x1A, 0x90, 0x04, 0x30, 0xE0, 0xB4, 0x01, 0x06, -+0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0x74, 0x2D, 0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, -+0x83, 0xE0, 0x70, 0x02, 0xC1, 0x32, 0xE5, 0x1A, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0xE5, 0x1A, -+0x54, 0x07, 0xFE, 0x74, 0x79, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFD, 0xAF, -+0x06, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0xC1, 0x32, 0x75, 0xF0, 0x10, 0xE5, 0x1A, 0x90, 0x81, 0x01, -+0x12, 0x49, 0xA8, 0xE0, 0x20, 0xE7, 0x02, 0x80, 0x10, 0x75, 0xF0, 0x10, 0xE5, 0x1A, 0x90, 0x81, -+0x02, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0x20, 0xE7, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x20, 0xF0, -+0xC1, 0x32, 0xEF, 0x30, 0xE6, 0x2B, 0x90, 0xA1, 0xE9, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x10, 0xE5, -+0x1A, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x90, 0x95, -+0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA4, 0x80, 0xF0, 0xE4, 0xFB, 0x80, -+0x5C, 0x90, 0xA1, 0xEA, 0xE0, 0x04, 0xF0, 0x74, 0x0A, 0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0x9F, -+0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x74, 0x0A, 0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, -+0xE0, 0xD3, 0x94, 0x02, 0x40, 0x14, 0xAF, 0x1A, 0x12, 0x6E, 0x8A, 0x74, 0x0A, 0x25, 0x1A, 0xF5, -+0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x28, 0x75, 0xF0, 0x10, 0xE5, 0x1A, 0x90, -+0x81, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x90, 0x95, 0x0D, 0x12, -+0x49, 0xA8, 0xE0, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA4, 0x80, 0xF0, 0x7B, 0x01, 0xAF, 0x1A, 0x12, -+0x68, 0xFD, 0x05, 0x1A, 0xE5, 0x1A, 0xC3, 0x94, 0x80, 0x50, 0x02, 0xA1, 0x29, 0x22, 0x90, 0xA1, -+0xB1, 0xE0, 0x60, 0x02, 0xD1, 0x47, 0x22, 0x90, 0xA1, 0xB1, 0xE0, 0x64, 0x01, 0x70, 0x4C, 0x90, -+0xA1, 0xB0, 0xE0, 0x54, 0x0F, 0x60, 0x3C, 0xE4, 0xFD, 0x7F, 0x0C, 0x51, 0x53, 0x90, 0x01, 0x5B, -+0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0xC4, 0xE0, 0xC3, -+0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, -+0x01, 0x5B, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x44, -+0x08, 0xF0, 0x22, 0x90, 0xA1, 0xB4, 0xE0, 0x70, 0x02, 0x51, 0x4F, 0x22, 0x90, 0xA1, 0xEB, 0xE0, -+0x04, 0xF0, 0xE4, 0xFF, 0x90, 0xA3, 0xA6, 0xEF, 0xF0, 0xE4, 0xF5, 0x24, 0x74, 0xA7, 0x25, 0x24, -+0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, -+0x03, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0x30, 0xE7, 0x10, 0xE5, 0x24, 0x70, 0x1F, 0xEF, 0x30, 0xE6, -+0x1B, 0x90, 0xA1, 0xE8, 0xE0, 0x04, 0xF0, 0x80, 0x13, 0xAF, 0x24, 0x12, 0x9A, 0x7A, 0x74, 0xA7, -+0x25, 0x24, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x05, 0x24, 0xE5, 0x24, -+0xC3, 0x94, 0x80, 0x40, 0xB7, 0x7F, 0x0C, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xE4, 0xF5, 0x24, 0x74, -+0xA7, 0x25, 0x24, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, 0x68, 0x63, -+0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x06, 0x12, 0x49, 0xA8, 0xE0, 0xF5, 0x22, 0x75, 0xF0, -+0x10, 0xE5, 0x24, 0x90, 0x81, 0x07, 0x12, 0x49, 0xA8, 0xE0, 0xF5, 0x23, 0xFE, 0xE5, 0x22, 0xFF, -+0xE5, 0x24, 0x25, 0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x0A, 0x12, 0x49, 0xA8, 0xE0, 0xF5, 0x22, -+0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x0B, 0x12, 0x49, 0xA8, 0xE0, 0xF5, 0x23, 0xFE, 0xE5, -+0x22, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x24, 0x90, 0x8D, 0x79, 0x12, 0x49, 0xA8, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0x75, -+0xF0, 0x0A, 0xE5, 0x24, 0x90, 0x8D, 0x7B, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, -+0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, -+0x24, 0x90, 0x8D, 0x7D, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, -+0x24, 0x90, 0x81, 0x0E, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x24, 0x90, 0x8D, -+0x7F, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, -+0x0F, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x24, 0x90, 0x8D, 0x81, 0x12, 0x49, -+0xA8, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, 0x09, 0x12, 0x49, -+0xA8, 0xE0, 0xFF, 0x74, 0x0A, 0x25, 0x24, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xEF, 0xF0, -+0xE5, 0x24, 0x70, 0x56, 0xE5, 0x23, 0x30, 0xE7, 0x05, 0x90, 0xA1, 0xE7, 0x80, 0x49, 0xE5, 0x23, -+0x30, 0xE6, 0x05, 0x90, 0xA1, 0xE6, 0x80, 0x3F, 0xE5, 0x23, 0x30, 0xE5, 0x05, 0x90, 0xA1, 0xE5, -+0x80, 0x35, 0xE5, 0x23, 0x30, 0xE4, 0x05, 0x90, 0xA1, 0xE4, 0x80, 0x2B, 0xE5, 0x23, 0x30, 0xE3, -+0x05, 0x90, 0xA1, 0xE3, 0x80, 0x21, 0xE5, 0x23, 0x30, 0xE2, 0x05, 0x90, 0xA1, 0xE2, 0x80, 0x17, -+0xE5, 0x23, 0x30, 0xE1, 0x05, 0x90, 0xA1, 0xE1, 0x80, 0x0D, 0xE5, 0x23, 0x30, 0xE0, 0x05, 0x90, -+0xA1, 0xE0, 0x80, 0x03, 0x90, 0xA1, 0xDF, 0xE0, 0x04, 0xF0, 0x90, 0xA3, 0xA6, 0xE0, 0xFD, 0xAF, -+0x24, 0x11, 0x70, 0x05, 0x24, 0xE5, 0x24, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x66, 0xFF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x62, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, -+0x79, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x7B, 0x12, -+0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x7D, 0x12, 0x49, 0xA8, -+0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x7F, 0x12, 0x49, 0xA8, 0xE4, 0xF0, -+0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x81, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, -+0xEF, 0x25, 0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, -+0x74, 0x0A, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xEF, -+0x90, 0x81, 0x03, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0x75, 0xF0, 0x10, 0xEF, -+0x90, 0x81, 0x03, 0x12, 0x49, 0xA8, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x7F, 0xEB, 0xF0, 0x90, 0xA4, 0x7D, 0xEF, 0xF0, 0xFC, 0xA3, -+0xED, 0xF0, 0xF9, 0x90, 0xA4, 0x7D, 0xE0, 0xFE, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA4, 0x81, -+0xF0, 0xEE, 0x54, 0x07, 0x90, 0xA4, 0x83, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x01, 0x12, -+0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x84, 0xF0, 0xE4, 0x90, 0xA4, 0x86, 0xF0, 0xE9, 0x54, 0x7F, 0x90, -+0xA4, 0x82, 0xF0, 0xFB, 0x25, 0xE0, 0x24, 0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xE4, -+0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, 0x04, 0xEB, 0x90, 0x42, 0x3B, -+0x12, 0x49, 0xA8, 0x12, 0x49, 0x8C, 0x12, 0x48, 0x6F, 0x78, 0x01, 0x12, 0x27, 0x22, 0x90, 0xA4, -+0x7D, 0xE0, 0xFD, 0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0x90, 0xA4, 0x7E, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0x90, 0xA4, 0x82, 0xF0, 0xEF, -+0x54, 0x80, 0x90, 0xA4, 0x85, 0xF0, 0xEE, 0xD3, 0x94, 0x35, 0x50, 0x0B, 0x90, 0xA4, 0x82, 0xE0, -+0xC3, 0x94, 0x2C, 0x40, 0x02, 0x80, 0x10, 0x90, 0xA4, 0x82, 0xE0, 0xFF, 0xD3, 0x94, 0x13, 0x50, -+0x0E, 0xEF, 0xC3, 0x94, 0x0C, 0x40, 0x08, 0x90, 0xA4, 0x86, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, -+0x90, 0xA4, 0x86, 0xF0, 0xED, 0x70, 0x10, 0x90, 0xA4, 0x7D, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0xA4, -+0x50, 0xF0, 0xE4, 0xFD, 0xFF, 0xD1, 0x2B, 0x90, 0xA4, 0x7D, 0xE0, 0xFF, 0x90, 0xA4, 0x82, 0xE0, -+0xFD, 0xB1, 0xEC, 0x90, 0xA4, 0x7F, 0xE0, 0x70, 0x39, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0x90, -+0xA4, 0x81, 0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, -+0xE0, 0xFF, 0x90, 0xA4, 0x83, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, -+0xD8, 0xFC, 0xF4, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA4, 0x84, 0xE0, 0x54, 0x7F, 0xF0, -+0x80, 0x6C, 0x90, 0xA4, 0x7D, 0xE0, 0xFF, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, -+0xE0, 0x90, 0x04, 0xCF, 0x30, 0xE0, 0x05, 0x74, 0x20, 0xF0, 0x80, 0x02, 0xE4, 0xF0, 0x90, 0xA4, -+0x81, 0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, -+0xFE, 0x90, 0xA4, 0x83, 0xE0, 0xFD, 0x74, 0x01, 0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x01, 0x12, 0x49, -+0xA8, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0xA4, 0x84, 0xF0, 0x90, 0xA4, 0x82, 0xE0, 0x90, 0x44, 0x3F, -+0x93, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x4F, 0x90, 0xA4, 0x84, 0xF0, 0x44, 0x80, 0xF0, 0x90, 0xA4, -+0x7E, 0xE0, 0xFF, 0x90, 0xA4, 0x7D, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, -+0xA8, 0xEF, 0xF0, 0x90, 0xA4, 0x84, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x01, 0x12, -+0x49, 0xA8, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x05, 0x12, 0x49, 0xA8, 0xE0, 0x54, -+0xFC, 0xFF, 0x90, 0xA4, 0x80, 0xE0, 0x4F, 0xFE, 0x90, 0xA4, 0x7D, 0xE0, 0xFF, 0x75, 0xF0, 0x10, -+0x90, 0x81, 0x05, 0x12, 0x49, 0xA8, 0xEE, 0xF0, 0x7D, 0x01, 0x11, 0x70, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x25, 0x90, 0xA1, 0xEE, 0xE0, 0x04, 0xF0, -+0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x1F, 0x90, 0xA4, 0x93, -+0xF0, 0x24, 0xF5, 0x50, 0x0D, 0x60, 0x52, 0x14, 0x60, 0x55, 0x14, 0x60, 0x58, 0x14, 0x60, 0x5B, -+0x80, 0x62, 0xE4, 0xF5, 0x26, 0x90, 0xA4, 0x93, 0xE0, 0x75, 0xF0, 0x07, 0xA4, 0x24, 0x50, 0xF5, -+0x82, 0xE4, 0x34, 0x40, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, -+0x83, 0xE4, 0x93, 0xFF, 0x90, 0xA4, 0x95, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x25, 0x90, 0x89, 0x00, -+0x12, 0x49, 0xA8, 0xE5, 0x82, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, -+0x05, 0x26, 0xE5, 0x26, 0xB4, 0x07, 0xBE, 0x80, 0x1B, 0xAD, 0x25, 0x7F, 0x8C, 0x80, 0x10, 0xAD, -+0x25, 0x7F, 0x94, 0x80, 0x0A, 0xAD, 0x25, 0x7F, 0x9C, 0x80, 0x04, 0xAD, 0x25, 0x7F, 0xA4, 0x7E, -+0x04, 0x12, 0x87, 0x7D, 0x75, 0xF0, 0x04, 0xE5, 0x25, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, -+0xFF, 0xC4, 0x54, 0x03, 0xFD, 0xE4, 0x90, 0xA4, 0x91, 0xF0, 0x7C, 0x06, 0x75, 0xF0, 0x08, 0xE5, -+0x25, 0x90, 0x89, 0x00, 0xBC, 0x06, 0x12, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, -+0x35, 0x83, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x80, 0x0E, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2C, 0xF5, -+0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x90, 0xA4, 0x94, 0xF0, 0x90, 0xA4, 0x94, 0xE0, 0x60, -+0x64, 0x75, 0x26, 0x07, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x26, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, -+0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0xA4, 0x94, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x3E, 0xEC, 0x75, -+0xF0, 0x08, 0xA4, 0x25, 0x26, 0x90, 0xA4, 0x91, 0xF0, 0xBD, 0x01, 0x0C, 0xE0, 0xD3, 0x94, 0x0B, -+0x40, 0x06, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x39, 0xBD, 0x02, 0x0F, 0x90, 0xA4, 0x91, 0xE0, 0xD3, -+0x94, 0x1B, 0x40, 0x06, 0xE0, 0x24, 0x18, 0xF0, 0x80, 0x27, 0xBD, 0x03, 0x24, 0x90, 0xA4, 0x91, -+0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x1B, 0xE0, 0x24, 0x22, 0xF0, 0x80, 0x15, 0x15, 0x26, 0xE5, 0x26, -+0xC3, 0x94, 0x00, 0x50, 0x9F, 0xEC, 0x60, 0x09, 0x1C, 0xEC, 0xC3, 0x94, 0x00, 0x40, 0x02, 0x61, -+0x8C, 0xE4, 0x90, 0xA4, 0x92, 0xF0, 0xFC, 0x75, 0xF0, 0x08, 0xE5, 0x25, 0x90, 0x89, 0x00, 0xBC, -+0x06, 0x12, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, -+0x54, 0x0F, 0x80, 0x0E, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, -+0x83, 0xE0, 0x90, 0xA4, 0x94, 0xF0, 0x90, 0xA4, 0x94, 0xE0, 0x60, 0x63, 0xE4, 0xF5, 0x26, 0x74, -+0x01, 0x7E, 0x00, 0xA8, 0x26, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -+0x90, 0xA4, 0x94, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x3E, 0xEC, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x26, -+0x90, 0xA4, 0x92, 0xF0, 0xBD, 0x01, 0x0C, 0xE0, 0xD3, 0x94, 0x0B, 0x40, 0x06, 0xE0, 0x24, 0x20, -+0xF0, 0x80, 0x34, 0xBD, 0x02, 0x0F, 0x90, 0xA4, 0x92, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x06, 0xE0, -+0x24, 0x18, 0xF0, 0x80, 0x22, 0xBD, 0x03, 0x1F, 0x90, 0xA4, 0x92, 0xE0, 0xD3, 0x94, 0x1B, 0x40, -+0x16, 0xE0, 0x24, 0x22, 0xF0, 0x80, 0x10, 0x05, 0x26, 0xE5, 0x26, 0x64, 0x08, 0x70, 0xA0, 0x0C, -+0xEC, 0x64, 0x07, 0x60, 0x02, 0x81, 0x37, 0x90, 0xA4, 0x91, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xE5, -+0x25, 0x90, 0x95, 0x0A, 0x12, 0x49, 0xA8, 0xEF, 0xF0, 0x90, 0xA4, 0x92, 0xE0, 0xFE, 0x75, 0xF0, -+0x04, 0xE5, 0x25, 0x90, 0x95, 0x0B, 0x12, 0x49, 0xA8, 0xEE, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x25, -+0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0xFC, 0x54, 0x7F, 0xFD, 0xEC, 0x54, 0x80, 0xFC, 0xED, -+0xD3, 0x9F, 0x40, 0x05, 0x90, 0xA4, 0x91, 0x80, 0x08, 0xED, 0xC3, 0x9E, 0x50, 0x06, 0x90, 0xA4, -+0x92, 0xE0, 0x4C, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x25, 0x90, 0x98, 0x8B, 0x12, 0x49, 0xA8, 0xED, -+0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x25, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x13, 0x13, 0x54, -+0x03, 0x90, 0xA4, 0x80, 0xF0, 0xE4, 0xFB, 0xAF, 0x25, 0x11, 0xFD, 0x75, 0xF0, 0x10, 0xE5, 0x25, -+0x90, 0x81, 0x03, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0x90, 0xA4, 0x91, 0xE0, 0xFF, 0xC3, 0x94, 0x36, -+0x40, 0x13, 0x75, 0xF0, 0x04, 0xE5, 0x25, 0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF1, -+0x44, 0x0A, 0xF0, 0x80, 0x72, 0xEF, 0xC3, 0x94, 0x2C, 0x40, 0x13, 0x75, 0xF0, 0x04, 0xE5, 0x25, -+0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF1, 0x44, 0x08, 0xF0, 0x80, 0x59, 0x90, 0xA4, -+0x91, 0xE0, 0xFF, 0xC3, 0x94, 0x14, 0x40, 0x13, 0x75, 0xF0, 0x04, 0xE5, 0x25, 0x90, 0x98, 0x8D, -+0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF1, 0x44, 0x06, 0xF0, 0x80, 0x3C, 0xEF, 0xC3, 0x94, 0x0C, 0x40, -+0x13, 0x75, 0xF0, 0x04, 0xE5, 0x25, 0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF1, 0x44, -+0x04, 0xF0, 0x80, 0x23, 0x90, 0xA4, 0x91, 0xE0, 0xC3, 0x94, 0x04, 0x75, 0xF0, 0x04, 0xE5, 0x25, -+0x90, 0x98, 0x8D, 0x40, 0x0B, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF1, 0x44, 0x02, 0xF0, 0x80, 0x07, -+0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF1, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x04, 0xEF, -+0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x54, 0x03, 0x70, 0x2E, 0xED, 0xC3, 0x94, 0x14, -+0x40, 0x15, 0xED, 0xD3, 0x94, 0x18, 0x50, 0x0F, 0x90, 0x04, 0x33, 0x74, 0x06, 0xF0, 0xA3, 0x04, -+0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x80, 0x0F, 0x90, 0x04, 0x33, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, -+0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0x22, 0x90, 0xA4, 0x4F, 0xEB, 0xF0, -+0x70, 0x57, 0x90, 0xA4, 0x4F, 0xE0, 0xFE, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, -+0xE0, 0xFC, 0x90, 0xA4, 0x50, 0xE0, 0xFB, 0xEC, 0x6B, 0x60, 0x3E, 0x90, 0xA4, 0x53, 0xEB, 0xF0, -+0xA3, 0xEE, 0xF0, 0xAE, 0x05, 0xEE, 0x25, 0xE0, 0x4F, 0xA3, 0xF0, 0x90, 0xA4, 0x51, 0x74, 0x0C, -+0xF0, 0x90, 0xA4, 0x5F, 0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x51, 0x12, 0x57, 0xF3, -+0x7F, 0x04, 0x12, 0x54, 0x17, 0x90, 0xA4, 0x50, 0xE0, 0xFF, 0x90, 0xA4, 0x4F, 0xE0, 0x24, 0x8A, -+0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0xAD, 0x07, 0x90, 0x01, 0xC4, 0x74, -+0x8A, 0xF0, 0x74, 0x6E, 0xA3, 0xF0, 0x90, 0x9C, 0x8A, 0x74, 0x05, 0xF0, 0x74, 0x8A, 0x2D, 0xF5, -+0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x74, 0x8A, 0x2D, 0xF5, 0x82, 0xE4, 0x34, -+0x9F, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0x03, 0x40, 0x40, 0x74, 0x8A, 0x2D, 0xF5, 0x82, 0xE4, 0x34, -+0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x0A, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, -+0xFF, 0x74, 0x89, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x0A, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x25, 0xE0, 0x24, 0x1E, 0xFF, 0x74, 0x8A, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, 0x81, 0x05, -+0x12, 0x49, 0xA8, 0xE0, 0x54, 0x03, 0xF5, 0x1C, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0A, 0x12, -+0x49, 0xA8, 0xE0, 0xF5, 0x1D, 0x74, 0x0A, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, -+0x54, 0x7F, 0xF5, 0x1B, 0x64, 0x2C, 0x70, 0x2C, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0D, 0x12, -+0x49, 0xA8, 0xE0, 0xFF, 0x54, 0x03, 0x65, 0x1C, 0x60, 0x1A, 0x15, 0x1C, 0xE5, 0x1C, 0x54, 0x03, -+0x25, 0xE0, 0x25, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xEF, -+0x54, 0xF3, 0x4E, 0xF0, 0xE5, 0x1B, 0xD3, 0x95, 0x1D, 0x40, 0x03, 0x85, 0x1D, 0x1B, 0x74, 0x0A, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0x54, 0x80, 0x42, 0x1B, 0xAF, 0x05, 0x90, -+0xA4, 0x80, 0xE5, 0x1C, 0xF0, 0xE4, 0xFB, 0xAD, 0x1B, 0x11, 0xFD, 0xAF, 0x1B, 0x22, 0xC0, 0xE0, -+0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, -+0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x7E, -+0xF0, 0x74, 0x6F, 0xA3, 0xF0, 0x12, 0x7B, 0xA8, 0xE5, 0x69, 0x30, 0xE1, 0x03, 0x12, 0x7D, 0x59, -+0xE5, 0x69, 0x30, 0xE2, 0x03, 0x12, 0x7D, 0xC0, 0xE5, 0x69, 0x30, 0xE3, 0x03, 0x12, 0x7D, 0xFC, -+0xE5, 0x6A, 0x30, 0xE0, 0x03, 0x12, 0x7E, 0x38, 0xE5, 0x6C, 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, -+0x77, 0xD7, 0xE5, 0x6C, 0x30, 0xE4, 0x03, 0x12, 0x73, 0x92, 0xE5, 0x6C, 0x30, 0xE5, 0x03, 0x12, -+0x7E, 0xC8, 0xE5, 0x6C, 0x30, 0xE6, 0x03, 0x12, 0x7F, 0x5E, 0x74, 0x7E, 0x04, 0x90, 0x01, 0xC4, -+0xF0, 0x74, 0x6F, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, -+0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, -+0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, -+0x10, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x70, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, -+0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, -+0x32, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0xA0, -+0x8C, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA0, 0x8D, 0xF0, 0x90, -+0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA0, 0x8E, 0xF0, 0x90, 0x00, 0x03, 0x12, -+0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA0, 0x8F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, -+0xAE, 0x05, 0xED, 0x2F, 0x90, 0xA0, 0x90, 0xF0, 0x22, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xBD, 0x90, -+0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xFE, 0x12, 0x26, 0x1E, 0xFD, 0xC3, 0x13, 0x30, 0xE0, 0x12, -+0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA3, 0x02, 0xF0, -+0x80, 0x05, 0x90, 0xA3, 0x02, 0xEF, 0xF0, 0x90, 0xA3, 0x01, 0xEE, 0xF0, 0x90, 0xA3, 0x02, 0xE0, -+0xFE, 0x90, 0xA3, 0x01, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x38, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, -+0x12, 0x26, 0x1E, 0x54, 0x01, 0xFE, 0x74, 0x2D, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, -+0xEE, 0xF0, 0x74, 0x2D, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0x70, 0x04, 0x31, -+0x3E, 0x80, 0x07, 0x90, 0xA3, 0x01, 0xE0, 0xFF, 0x31, 0x2D, 0x90, 0xA3, 0x01, 0xE0, 0x04, 0xF0, -+0x80, 0xBA, 0x90, 0xA1, 0x2D, 0xE0, 0x70, 0x24, 0x90, 0xA1, 0xB4, 0xE0, 0x70, 0x04, 0xFF, 0x12, -+0x64, 0x49, 0x90, 0xA1, 0xB4, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x31, 0x4F, 0x90, 0xA1, 0xAE, 0xE0, -+0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x8F, 0x0F, 0x75, -+0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x8F, 0x0F, -+0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x49, 0xA8, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, -+0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x0C, -+0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0xA1, 0xAD, -+0xF0, 0xBF, 0x01, 0x12, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x64, 0x01, 0x60, 0x17, 0x90, 0x05, -+0x22, 0x74, 0x6F, 0xF0, 0x80, 0x0F, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x64, 0x01, 0x60, 0x05, -+0x90, 0x05, 0x22, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xBD, -+0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, 0x90, 0xA3, 0x01, 0x12, 0x49, 0xBD, 0x90, 0xA2, 0xFE, 0x12, -+0x49, 0xB4, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xC9, 0xF0, 0x90, 0xA3, 0x01, 0x12, -+0x49, 0xB4, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x7F, 0x90, 0xA1, 0xB1, 0xF0, 0xEF, 0xC4, 0x13, 0x13, -+0x13, 0x54, 0x01, 0xA3, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0x54, 0xF0, 0xC4, 0x54, -+0x0F, 0xFE, 0x90, 0xA1, 0xB0, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, -+0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, -+0xC4, 0x54, 0xF0, 0xFF, 0x90, 0xA1, 0xB0, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, -+0x26, 0x37, 0x90, 0xA1, 0xB3, 0xF0, 0x51, 0x3D, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, -+0xB8, 0xF0, 0x90, 0xA1, 0xB1, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0xA1, 0xB3, 0xE0, 0x90, 0x01, -+0xBB, 0xF0, 0x90, 0xA1, 0xB0, 0xE0, 0x54, 0x0F, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, 0xA3, 0x04, -+0x12, 0x49, 0xBD, 0x12, 0xB8, 0x64, 0x90, 0xA1, 0xB1, 0xE0, 0xFF, 0x51, 0x6D, 0x90, 0xA1, 0xB1, -+0xE0, 0x60, 0x19, 0x90, 0xA3, 0x04, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x54, -+0x0F, 0xFF, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x12, 0xB9, 0x0D, 0x22, 0xEF, 0x70, 0x37, -+0x7D, 0x78, 0x7F, 0x02, 0x71, 0x13, 0x7D, 0x02, 0x7F, 0x03, 0x71, 0x13, 0x7D, 0xC8, 0x7F, 0x02, -+0x12, 0x79, 0xE3, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x7D, 0x01, -+0x7F, 0x0C, 0x12, 0x62, 0x53, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x90, -+0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, -+0xF0, 0x7D, 0x78, 0xFF, 0x51, 0xF4, 0x7D, 0x02, 0x7F, 0x03, 0x51, 0xF4, 0x90, 0x06, 0x0A, 0xE0, -+0x44, 0x07, 0xF0, 0x90, 0xA1, 0xBC, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0xA1, 0x2D, 0xE0, -+0xB4, 0x01, 0x15, 0x90, 0xA1, 0xAF, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA1, 0xB4, 0xE0, 0x20, 0xE2, -+0x0E, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x62, 0x53, 0x90, 0xA1, 0xAF, 0xE0, 0x44, 0x04, 0xF0, 0x22, -+0x7D, 0x02, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x71, 0x13, 0x7D, -+0x01, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x30, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0xA1, 0xB4, 0xE0, 0x64, -+0x02, 0x60, 0x28, 0x91, 0x46, 0x90, 0xA1, 0xAF, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, -+0x14, 0x90, 0xA1, 0xB7, 0xE0, 0xFF, 0xA3, 0xE0, 0x6F, 0x70, 0x0A, 0xF1, 0xB3, 0x71, 0x09, 0x90, -+0xA1, 0xB8, 0xE0, 0x14, 0xF0, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0xCA, 0xE0, -+0x30, 0xE0, 0x2E, 0x90, 0xA1, 0xCC, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x90, 0xA1, 0xCD, 0xE0, 0x60, -+0x04, 0x14, 0xF0, 0xC1, 0x6C, 0x90, 0xA1, 0xCB, 0xE0, 0x14, 0x90, 0xA1, 0xCD, 0xF0, 0x90, 0x05, -+0x73, 0x74, 0x01, 0xF0, 0xE4, 0xFF, 0x12, 0x78, 0x6D, 0x51, 0xF0, 0x7D, 0x01, 0x7F, 0x02, 0x51, -+0xF4, 0x22, 0x12, 0xB9, 0x99, 0x90, 0xA1, 0xB7, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x51, 0xF0, -+0x91, 0x11, 0x80, 0xB8, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x45, 0x90, 0xA1, 0xAF, 0xE0, 0xFF, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x12, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0B, 0x71, 0x09, -+0x90, 0xA1, 0xB7, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0xA4, 0xAB, 0xE4, 0x75, 0xF0, 0x01, -+0x12, 0x47, 0xF6, 0xC3, 0x90, 0xA4, 0xAC, 0xE0, 0x94, 0x80, 0x90, 0xA4, 0xAB, 0xE0, 0x64, 0x80, -+0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x12, -+0xB7, 0x5A, 0x91, 0x11, 0x7F, 0x01, 0xF1, 0xD7, 0x90, 0xA1, 0xCA, 0xE0, 0x30, 0xE0, 0x11, 0x90, -+0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0A, 0x71, 0x09, 0x90, 0xA1, 0xCC, 0xE0, 0x90, 0x05, 0x73, 0xF0, -+0x22, 0x90, 0xA1, 0xCF, 0xE0, 0x30, 0xE0, 0x2D, 0x90, 0xA1, 0x2D, 0xE0, 0xB4, 0x01, 0x26, 0x90, -+0xA4, 0xB9, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0xA1, 0xD1, 0xE0, 0x04, 0xF0, 0xE4, -+0x90, 0xA4, 0xB9, 0xF0, 0x90, 0xA1, 0xD1, 0xE0, 0xFF, 0x90, 0xA1, 0xD0, 0xE0, 0xB5, 0x07, 0x05, -+0xE4, 0xA3, 0xF0, 0x91, 0xDB, 0x22, 0x90, 0xA1, 0x2D, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x81, 0xDA, -+0x90, 0xA1, 0xB1, 0xE0, 0x70, 0x02, 0x81, 0xDA, 0x90, 0xA1, 0xB0, 0xE0, 0xC4, 0x54, 0x0F, 0x64, -+0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0xA1, 0xB8, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, -+0xA1, 0xB7, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0xA1, 0xB7, 0xE0, 0xFE, 0xFF, 0x80, 0x00, -+0x90, 0xA1, 0xB8, 0xEF, 0xF0, 0x90, 0xA1, 0xAF, 0xE0, 0x44, 0x04, 0xF0, 0xE4, 0x90, 0xA1, 0xBA, -+0xF0, 0x90, 0xA1, 0xBC, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, -+0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0xB5, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x90, -+0xA1, 0xB0, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x03, 0x12, 0x7C, 0x71, -+0x90, 0xA1, 0xAF, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0E, 0x90, 0xA1, 0xB7, 0xE0, -+0xFF, 0xA3, 0xE0, 0xB5, 0x07, 0x04, 0xF1, 0xB3, 0x71, 0x0F, 0x22, 0xE4, 0xFF, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x1E, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1D, 0x90, 0x05, 0x22, 0xE0, -+0xF5, 0x21, 0x74, 0xFF, 0xF0, 0xF1, 0x6B, 0xBF, 0x01, 0x07, 0xAF, 0x1E, 0x12, 0xB9, 0xD9, 0xB1, -+0x63, 0x90, 0x05, 0x22, 0xE5, 0x21, 0xF0, 0x80, 0x02, 0xB1, 0x63, 0x90, 0x04, 0x1F, 0x74, 0x20, -+0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x1D, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x54, 0xEF, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, -+0x40, 0xF0, 0x22, 0x90, 0xA0, 0x8E, 0xE0, 0xFF, 0x7D, 0x01, 0xD1, 0x00, 0x8E, 0x1F, 0x8F, 0x20, -+0xAD, 0x20, 0xAC, 0x1F, 0xAF, 0x1E, 0xB1, 0x18, 0xAF, 0x20, 0xAE, 0x1F, 0x90, 0x81, 0x00, 0xE0, -+0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -+0x44, 0x01, 0xF0, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xFB, -+0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0xFA, -+0xF0, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, -+0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, -+0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, -+0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, -+0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xED, 0xF0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xAE, 0xED, 0xF0, 0x90, 0xA4, 0xAD, 0xEF, -+0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xBA, 0x26, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0xA4, 0xAD, 0xE0, 0x90, -+0x04, 0x25, 0xF0, 0x90, 0xA4, 0xAE, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -+0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, 0x22, 0x74, -+0xFF, 0xF0, 0xD1, 0x96, 0x90, 0xA1, 0xB4, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, -+0xF0, 0xF1, 0x6B, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, 0x03, 0x51, 0xF4, 0xD1, 0x96, -+0xE4, 0x90, 0xA1, 0xB4, 0xF0, 0x22, 0xF1, 0x6B, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, -+0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA4, 0x8D, 0x12, 0x27, 0x48, 0x90, 0xA4, 0x8D, 0x12, 0x49, 0x4B, -+0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, -+0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA4, 0x8D, 0x12, 0x27, 0x48, 0x90, -+0xA4, 0x8D, 0x12, 0x49, 0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, -+0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x54, 0xFE, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, -+0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0xA4, 0x8D, 0x12, 0x27, 0x48, 0x90, 0xA4, 0x8D, 0x12, 0x49, -+0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x01, -+0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, -+0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x90, 0xA1, 0xBE, 0x12, 0x27, 0x48, 0x90, 0xAC, 0xB9, -+0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, -+0x00, 0xFF, 0xE0, 0x70, 0x15, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x8C, 0x12, 0x79, 0xB0, 0x90, 0xA4, -+0x8C, 0xE0, 0x44, 0x18, 0xFB, 0x7F, 0x01, 0x12, 0x79, 0xFB, 0x22, 0xE4, 0x90, 0xA4, 0xAF, 0xF0, -+0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, -+0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0xA4, 0xB0, 0xE0, 0x94, 0xE8, 0x90, 0xA4, -+0xAF, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, -+0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA4, 0xAF, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, -+0xF6, 0x80, 0xBF, 0xEF, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, -+0x7F, 0x03, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x8F, 0x27, 0x7F, 0x02, 0x12, 0x4C, 0x2B, 0x90, 0xA0, -+0x8A, 0xE0, 0x45, 0x27, 0xF0, 0x22, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x30, 0xE0, 0x26, -+0x12, 0x26, 0x1E, 0x90, 0xA1, 0xC2, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xC3, -+0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xA3, 0xE0, 0x54, 0x01, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, -+0x37, 0x90, 0xA1, 0xC5, 0xF0, 0x22, 0x90, 0xA1, 0xC2, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, -+0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, -+0xA1, 0xC8, 0xF0, 0x90, 0xA1, 0xC8, 0xE0, 0x90, 0x01, 0xE7, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x54, -+0x01, 0xFF, 0x90, 0xA1, 0xCA, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, -+0x90, 0xA1, 0xCB, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xCC, 0xF0, 0x90, 0xA1, -+0xCB, 0xE0, 0x90, 0xA1, 0xCD, 0xF0, 0x90, 0xA1, 0xCA, 0xE0, 0x54, 0x01, 0xFF, 0xAC, 0x07, 0xEF, -+0x54, 0x01, 0xFE, 0x90, 0xA1, 0xCA, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0x90, 0x01, 0x53, 0xB4, -+0x01, 0x12, 0xE4, 0xF0, 0x7D, 0x10, 0x7F, 0x03, 0x12, 0x77, 0xC2, 0x90, 0xA1, 0xCC, 0xE0, 0x90, -+0x05, 0x73, 0xF0, 0x22, 0x74, 0x03, 0xF0, 0x7D, 0x10, 0xFF, 0x31, 0xE3, 0x11, 0xAA, 0x90, 0x05, -+0x22, 0xE4, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x0C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA1, 0xBE, 0x12, 0x49, 0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, -+0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA1, 0xBE, 0x12, 0x49, 0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, -+0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x10, 0xE0, 0x44, 0x0C, 0xFD, 0x7F, 0x10, -+0x12, 0x3A, 0x96, 0x90, 0x00, 0x72, 0xE0, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x3A, 0x96, 0x90, -+0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, -+0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, -+0x54, 0xBF, 0xFF, 0xEC, 0x90, 0xA4, 0x87, 0x12, 0x27, 0x48, 0x90, 0xA4, 0x87, 0x12, 0x49, 0x4B, -+0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, -+0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, -+0x90, 0xA4, 0x87, 0x12, 0x27, 0x48, 0x90, 0xA4, 0x87, 0x12, 0x49, 0x4B, 0x90, 0xAC, 0xB9, 0x12, -+0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, -+0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0xA4, 0x87, 0x12, 0x27, 0x48, 0x90, 0xA4, 0x87, 0x12, 0x49, -+0x4B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, -+0xFF, 0xE0, 0x70, 0x27, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x8B, 0x31, 0xB0, 0x90, 0xA4, 0x8B, 0xE0, -+0x54, 0xE7, 0xFB, 0x7F, 0x01, 0x31, 0xFB, 0x7B, 0x01, 0x7F, 0x01, 0x31, 0xB4, 0x90, 0xA4, 0x8B, -+0xE0, 0x54, 0x18, 0x70, 0x06, 0x90, 0x01, 0xBF, 0xE0, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x7D, 0x08, 0x7F, 0x01, 0xEF, 0x70, 0x04, 0x7E, 0x01, 0x80, 0x07, 0xEF, 0x64, 0x01, 0x70, 0x19, -+0x7E, 0x40, 0x90, 0x00, 0xE2, 0xED, 0xF0, 0xA3, 0xEE, 0xF0, 0x90, 0x00, 0xE1, 0xE0, 0x12, 0x26, -+0x64, 0x90, 0x00, 0xE3, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, -+0x7F, 0x00, 0x22, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x38, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0xEF, 0x70, 0x04, 0x7E, 0x03, -+0x80, 0x07, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x7E, 0x42, 0x90, 0x00, 0xE2, 0xED, 0xF0, 0x90, 0x00, -+0xE0, 0xEB, 0xF0, 0x90, 0x00, 0xE3, 0xEE, 0xF0, 0x54, 0xFD, 0xF0, 0xE4, 0xF0, 0x7F, 0x01, 0x22, -+0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, -+0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xEE, 0x74, 0x00, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, -+0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, -+0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA4, 0x9A, 0xEF, 0xF0, 0xA3, 0x12, 0x49, 0xBD, 0x90, 0xA4, -+0xA3, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, 0x76, 0x74, 0x00, 0x2F, 0xF9, -+0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0xA4, 0x9B, 0x12, -+0x49, 0xB4, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, -+0x03, 0x12, 0x34, 0x2C, 0x90, 0xA4, 0x9A, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, -+0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x49, 0xB4, 0xE9, 0x24, 0x02, 0xF9, 0xE4, -+0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0xA4, 0x9B, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x0E, -+0x12, 0x26, 0x37, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x2C, 0xE4, 0x90, -+0xA2, 0xE9, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, -+0xEF, 0x64, 0x01, 0x60, 0x3E, 0xC3, 0x90, 0xA2, 0xEA, 0xE0, 0x94, 0x88, 0x90, 0xA2, 0xE9, 0xE0, -+0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA2, 0xE9, 0xE4, -+0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0xA2, -+0xEA, 0xE0, 0x94, 0x32, 0x90, 0xA2, 0xE9, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, -+0x30, 0xE3, 0xB2, 0x22, 0x7F, 0x02, 0x90, 0xA1, 0xCE, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, -+0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, -+0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, -+0x5D, 0xF5, 0x61, 0xA3, 0xE0, 0x55, 0x5E, 0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, 0xF5, 0x63, 0xA3, -+0xE0, 0x55, 0x60, 0xF5, 0x64, 0x90, 0x01, 0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, -+0xE5, 0x63, 0xF0, 0xA3, 0xE5, 0x64, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x65, 0xF5, 0x69, -+0xA3, 0xE0, 0x55, 0x66, 0xF5, 0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, 0xE0, 0x55, 0x68, -+0xF5, 0x6C, 0x90, 0x01, 0x3C, 0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, 0x6B, 0xF0, -+0xA3, 0xE5, 0x6C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0xA1, 0x2D, 0xE0, 0x64, 0x01, 0x70, 0x2A, -+0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, -+0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0xC3, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, -+0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x22, 0x90, 0xA1, 0x2D, 0xE0, 0x64, -+0x01, 0x70, 0x26, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x20, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, -+0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA1, 0xB5, 0xE0, 0x54, -+0xFD, 0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x4F, 0xF0, 0x22, 0x90, 0xA1, 0x2D, 0xE0, 0xB4, 0x01, -+0x14, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x0E, 0x90, 0xA1, 0xB0, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, -+0x02, 0x80, 0x03, 0x91, 0xF3, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x14, 0x90, 0xA0, 0x8D, 0xE0, -+0xFF, 0xE4, 0xFD, 0x12, 0x76, 0x00, 0x8E, 0x1A, 0x8F, 0x1B, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, -+0x22, 0xE4, 0x90, 0xA3, 0x92, 0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x90, 0xA3, 0x92, 0xF0, 0xE0, 0x54, -+0xC0, 0x70, 0x0D, 0x90, 0xA1, 0xB5, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x02, 0x4F, 0xF0, -+0x90, 0xA3, 0x92, 0xE0, 0x30, 0xE6, 0x21, 0x90, 0xA1, 0xB1, 0xE0, 0x64, 0x01, 0x70, 0x20, 0x90, -+0xA1, 0xB5, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0xA1, 0xB0, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x04, -+0x91, 0x56, 0x80, 0x0B, 0x91, 0xF3, 0x80, 0x07, 0x90, 0xA1, 0xB5, 0xE0, 0x54, 0xFE, 0xF0, 0x90, -+0xA3, 0x92, 0xE0, 0x90, 0xA1, 0xB5, 0x30, 0xE7, 0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, -+0x90, 0xA1, 0xC3, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, -+0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, -+0xFD, 0xF0, 0x22, 0x90, 0x01, 0x5F, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x08, 0xF0, 0xE4, 0xF5, -+0x3B, 0x90, 0xA1, 0xC4, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x5C, -+0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5F, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, -+0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA1, 0xB4, 0xE0, 0x64, 0x0C, 0x60, 0x0C, -+0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x62, 0x53, 0xE4, 0xFF, 0x12, 0x74, 0xDD, 0x22, 0x90, 0xA1, 0x2D, -+0xE0, 0xB4, 0x01, 0x14, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x0E, 0x90, 0xA1, 0xB5, 0xE0, 0x54, 0xFE, -+0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x4F, 0xF0, 0x22, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x02, 0xB1, -+0x62, 0x22, 0x90, 0xA1, 0xAE, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x11, 0xEF, 0x54, -+0xFB, 0xF0, 0x90, 0xA1, 0xB5, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x42, 0x80, 0x3D, 0x90, -+0xA1, 0xBA, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0xB5, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0xA1, 0xBA, 0xE0, -+0xFF, 0xB4, 0x01, 0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, 0x06, 0x90, 0x05, 0x58, 0xE0, 0x04, 0xF0, -+0x90, 0xA1, 0xC2, 0xE0, 0xFF, 0x90, 0xA1, 0xBA, 0xE0, 0xD3, 0x9F, 0x40, 0x0F, 0x90, 0xA1, 0x2D, -+0xE0, 0xB4, 0x01, 0x0B, 0x90, 0xA1, 0xAF, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x12, 0x4F, 0xF0, 0x22, -+0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x35, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE0, 0x24, 0xE4, 0xF5, 0x3B, -+0x90, 0xA1, 0xC4, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, -+0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5B, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x01, 0xF0, -+0x22, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xF7, 0xF0, 0x12, 0x4F, 0xF0, 0x22, 0x90, 0xA1, 0xB1, 0xE0, -+0x60, 0x35, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x24, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0xC4, 0xE0, -+0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x5C, 0x7E, 0x01, 0x12, 0x34, 0x8C, -+0x90, 0x01, 0x5F, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x22, 0x90, 0xA1, 0xAE, -+0xE0, 0x54, 0xEF, 0xF0, 0x12, 0x4F, 0xF0, 0x22, 0xD1, 0x81, 0x90, 0xA3, 0xA2, 0xEF, 0xF0, 0x90, -+0xA1, 0xAE, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, -+0xA3, 0xA2, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, -+0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0xA1, -+0xBC, 0xE4, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0xBC, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, -+0x22, 0xE4, 0x90, 0xA3, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, 0xA3, -+0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0xA3, 0xA3, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, -+0xC3, 0x90, 0xA3, 0xA5, 0xE0, 0x94, 0x64, 0x90, 0xA3, 0xA4, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, -+0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA3, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0xA3, 0xA4, 0xE4, -+0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x80, 0xC2, 0x90, 0xA1, 0xAE, 0xE0, 0xFF, 0xC4, 0x13, 0x13, -+0x54, 0x03, 0x30, 0xE0, 0x27, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA1, 0xAF, -+0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xB9, -+0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x12, 0x4F, 0xF0, 0xE4, 0xFF, 0x90, 0xA1, -+0xD2, 0xE0, 0x30, 0xE0, 0x48, 0x90, 0xA1, 0xD6, 0xE0, 0xFD, 0x60, 0x41, 0x74, 0x01, 0x7E, 0x00, -+0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, -+0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x06, 0xE4, 0x90, 0xA1, 0xD6, 0xF0, 0x22, 0x90, 0xA1, 0xD4, 0xE0, -+0xD3, 0x9D, 0x50, 0x10, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0xF1, 0x4E, 0x90, 0xA1, 0xD2, 0xE0, -+0x54, 0xFE, 0xF0, 0x22, 0x12, 0x74, 0xDB, 0x90, 0xA1, 0xD6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA0, -+0x8B, 0xE0, 0x64, 0x02, 0x60, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0xA1, -+0xAE, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x2C, 0xEF, 0x54, 0x7F, 0xF0, -+0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA1, 0xAF, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x0F, -+0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x90, -+0xA1, 0xB1, 0xE0, 0x60, 0x03, 0x12, 0x4F, 0xF0, 0x7F, 0x01, 0xC1, 0xFE, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x90, 0x60, -+0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE1, 0xE4, 0x7F, -+0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x0A, -+0x0D, 0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, -+0x1E, 0x90, 0xFD, 0x11, 0xE0, 0xB5, 0x05, 0x14, 0x90, 0x01, 0x17, 0xE0, 0xB5, 0x05, 0x07, 0x90, -+0xFD, 0x11, 0xE4, 0xF0, 0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, 0x11, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, -+0x8F, 0x6E, 0xE4, 0x90, 0xA4, 0xB1, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, -+0xE7, 0x02, 0x7F, 0x01, 0xEF, 0x65, 0x6E, 0x60, 0x3E, 0xC3, 0x90, 0xA4, 0xB2, 0xE0, 0x94, 0x88, -+0x90, 0xA4, 0xB1, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, -+0x90, 0xA4, 0xB1, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, -+0xF7, 0xD3, 0x90, 0xA4, 0xB2, 0xE0, 0x94, 0x32, 0x90, 0xA4, 0xB1, 0xE0, 0x94, 0x00, 0x40, 0xB9, -+0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB2, 0x22, 0x11, 0xFE, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, -+0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0xE4, 0xFF, 0x11, 0x00, 0x90, 0xA0, 0x8B, 0xE0, 0xB4, 0x03, -+0x0C, 0x90, 0x00, 0x70, 0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0xA6, 0x11, 0x58, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, -+0xB4, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, 0x31, 0x10, 0xBF, 0x01, 0x08, 0x11, 0x7E, 0x90, -+0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA0, 0x8B, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, -+0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0xA1, 0xBB, 0xE0, 0xFD, 0x7F, 0x93, -+0x12, 0x3A, 0x96, 0x90, 0xA1, 0xB2, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, -+0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, -+0x10, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0x7F, 0x01, 0x11, 0x00, 0x90, 0x00, 0x90, 0xE0, 0x44, -+0x01, 0xFD, 0x7F, 0x90, 0x12, 0x3A, 0x96, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0x90, 0x00, -+0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x22, 0x90, 0xA1, 0xAE, 0xE0, 0x30, 0xE0, 0x02, 0x11, 0x8E, 0x22, -+0x90, 0x02, 0x96, 0xE0, 0xFF, 0x90, 0x02, 0x87, 0xE0, 0x4F, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, -+0x01, 0xF0, 0x80, 0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, -+0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, -+0xF0, 0x7F, 0x00, 0x22, 0xE4, 0x90, 0xA2, 0xE9, 0xF0, 0xE4, 0x90, 0xA2, 0xEA, 0xF0, 0x90, 0xA2, -+0xEA, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x50, 0x75, 0x90, 0xA2, 0xE9, 0xE0, 0xFE, 0x24, 0x8A, 0xF5, -+0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x90, 0xA2, 0xEA, 0xB4, 0x03, -+0x1B, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2F, -+0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x74, 0x80, 0xF0, 0x80, 0x1B, 0xE0, 0xFF, 0x90, 0xA2, -+0xE9, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2F, 0xF5, 0x82, -+0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0xEA, 0xE0, 0xFF, 0x90, 0xA2, 0xE9, 0xE0, -+0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, -+0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0xEA, 0xE0, 0x04, 0xF0, 0x80, 0x81, 0x90, 0xA2, 0xE9, -+0xE0, 0x04, 0xF0, 0xE0, 0x64, 0x80, 0x60, 0x02, 0x21, 0x49, 0xE4, 0x90, 0xAF, 0x7D, 0xF0, 0x90, -+0xA2, 0xE9, 0xF0, 0x90, 0xA2, 0xE9, 0xE0, 0xFF, 0xC3, 0x94, 0x80, 0x40, 0x02, 0x61, 0x60, 0xE0, -+0xFE, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x79, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, -+0x0A, 0xEE, 0x90, 0x8D, 0x7B, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEE, -+0x90, 0x8D, 0x7D, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEE, 0x90, 0x8D, -+0x7F, 0x12, 0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEE, 0x90, 0x8D, 0x81, 0x12, -+0x49, 0xA8, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x9C, 0x8A, 0xF0, 0x90, 0xA0, 0x0A, 0xF0, 0x75, 0xF0, -+0x04, 0xEE, 0x90, 0x98, 0x8B, 0x12, 0x49, 0xA8, 0x74, 0x3F, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, -+0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x0F, 0xF0, 0x90, 0xA2, 0xE9, 0xE0, 0xFE, 0x75, 0xF0, -+0x04, 0x90, 0x98, 0x8A, 0x12, 0x49, 0xA8, 0x74, 0xC0, 0xF0, 0xEE, 0x25, 0xE0, 0x24, 0x79, 0xF5, -+0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x0A, 0x2E, 0xF5, 0x82, 0xE4, -+0x34, 0x97, 0xF5, 0x83, 0xE4, 0xF0, 0xEE, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9C, -+0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEE, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9D, -+0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x0A, 0x12, 0x49, 0xA8, -+0x74, 0x3F, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x0B, 0x12, 0x49, 0xA8, 0x74, 0x03, 0xF0, -+0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xE0, 0x44, 0x09, 0xF0, -+0x90, 0xA2, 0xE9, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, -+0xF3, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xFC, 0xF0, -+0x90, 0xA2, 0xE9, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0x44, -+0x20, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xCF, 0xF0, -+0x90, 0xA2, 0xE9, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x44, -+0x40, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x7F, 0xF0, -+0x90, 0xA2, 0xE9, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0A, 0x12, 0x49, 0xA8, 0xE0, 0xFD, -+0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xED, 0xF0, 0x74, 0x8A, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0xE9, 0xE0, 0x04, 0xF0, 0x21, 0xE3, -+0xE4, 0x90, 0xA2, 0xEB, 0xF0, 0x90, 0xA2, 0xEB, 0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x50, 0x14, 0x74, -+0xD7, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0xEB, 0xE0, 0x04, -+0xF0, 0x80, 0xE2, 0x90, 0x04, 0x49, 0x74, 0xF0, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, -+0x90, 0x04, 0x33, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, -+0xA3, 0x04, 0xF0, 0x90, 0xA2, 0xE9, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, -+0x74, 0xFF, 0xF0, 0x22, 0xED, 0xB4, 0x3E, 0x04, 0x7E, 0xBD, 0x80, 0x1E, 0xED, 0xB4, 0x3F, 0x18, -+0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x7E, -+0xFF, 0x30, 0xE0, 0x06, 0x7E, 0xBE, 0x80, 0x02, 0x7E, 0xFF, 0xAF, 0x06, 0x22, 0x8F, 0x19, 0xAC, -+0x05, 0x90, 0x01, 0xC4, 0x74, 0xDD, 0xF0, 0x74, 0x83, 0xA3, 0xF0, 0x74, 0x8A, 0x25, 0x19, 0xF5, -+0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x19, 0x90, 0x81, 0x00, -+0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA3, 0x06, 0xF0, 0x54, 0x7F, 0x90, 0xA3, 0x0E, 0xF0, 0x75, 0xF0, -+0x04, 0xE5, 0x19, 0x90, 0x95, 0x0B, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA3, 0x10, 0xF0, 0x75, 0xF0, -+0x04, 0xE5, 0x19, 0x90, 0x95, 0x0A, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA3, 0x11, 0xF0, 0x75, 0xF0, -+0x10, 0xE5, 0x19, 0x90, 0x81, 0x05, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x03, 0x90, 0xA3, 0x0A, 0xF0, -+0x90, 0xA3, 0x0E, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, -+0xE4, 0x93, 0xFA, 0x74, 0x01, 0x93, 0xFB, 0xE5, 0x19, 0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, -+0x34, 0x94, 0xF5, 0x83, 0xEA, 0xF0, 0xA3, 0xEB, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x19, 0x90, 0x95, -+0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xFE, 0xC4, 0x54, 0x03, 0x90, 0xA3, 0x0B, 0xF0, 0x74, 0x0A, 0x25, -+0x19, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xEF, 0xF0, 0xE5, 0x19, 0x70, 0x06, 0x90, 0x04, -+0x97, 0xE0, 0x04, 0xF0, 0x90, 0xA3, 0x11, 0xE0, 0xFF, 0x90, 0xA3, 0x0E, 0xE0, 0xD3, 0x9F, 0x40, -+0x13, 0xEF, 0xF0, 0x90, 0xA3, 0x06, 0xF0, 0x74, 0x0A, 0x25, 0x19, 0xF5, 0x82, 0xE4, 0x34, 0xA0, -+0xF5, 0x83, 0xEF, 0xF0, 0xEC, 0x70, 0x02, 0xC1, 0x39, 0x90, 0xA3, 0x0F, 0xEC, 0xF0, 0x90, 0xA3, -+0x06, 0xE0, 0x30, 0xE7, 0x0E, 0x90, 0xA3, 0x0E, 0xE0, 0x90, 0xA3, 0x06, 0xF0, 0x90, 0xA3, 0x0F, -+0xE0, 0x14, 0xF0, 0x90, 0xA3, 0x0F, 0xE0, 0x70, 0x02, 0xC1, 0x39, 0x90, 0xA3, 0x06, 0xE0, 0xFD, -+0xAF, 0x19, 0x71, 0xB4, 0x90, 0xA3, 0x09, 0xEF, 0xF0, 0xF4, 0x60, 0x15, 0xE0, 0x90, 0xA3, 0x06, -+0xF0, 0x90, 0xA3, 0x0F, 0xE0, 0x14, 0xF0, 0xE0, 0xFD, 0x70, 0x02, 0xC1, 0x39, 0xAF, 0x19, 0x71, -+0xDD, 0x90, 0xA3, 0x0E, 0xE0, 0xFF, 0x64, 0x2C, 0x70, 0x38, 0x75, 0xF0, 0x04, 0xE5, 0x19, 0x90, -+0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xFE, 0x54, 0x03, 0xFD, 0x90, 0xA3, 0x0A, 0xE0, 0x6D, 0x60, -+0x21, 0xE0, 0x14, 0xF0, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, -+0x19, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xEE, 0x54, 0xF3, 0x4D, 0xF0, 0x90, 0xA3, 0x0F, 0xE0, -+0x14, 0xF0, 0x90, 0xA3, 0x0F, 0xE0, 0x70, 0x02, 0xC1, 0x39, 0x90, 0xA3, 0x10, 0xE0, 0xF9, 0xEF, -+0xD3, 0x99, 0x50, 0x02, 0xC1, 0x34, 0xE4, 0x90, 0xA3, 0x0D, 0xF0, 0x90, 0xA3, 0x0B, 0xE0, 0xFF, -+0x90, 0xA3, 0x0E, 0xE0, 0xFD, 0xD1, 0x67, 0xEF, 0xF0, 0x90, 0xA3, 0x06, 0xF0, 0x90, 0xA3, 0x0B, -+0xE0, 0xFF, 0x90, 0xA3, 0x10, 0xE0, 0xFD, 0xD1, 0x67, 0xEF, 0xF0, 0x90, 0xA3, 0x06, 0xE0, 0x90, -+0xA3, 0x08, 0xF0, 0x90, 0xA3, 0x0E, 0xE0, 0x14, 0x90, 0xA3, 0x0C, 0xF0, 0x90, 0xA3, 0x10, 0xE0, -+0xFF, 0x90, 0xA3, 0x0C, 0xE0, 0xFD, 0xC3, 0x9F, 0x40, 0x74, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, -+0x1F, 0xFE, 0x75, 0xF0, 0x08, 0xE5, 0x19, 0x90, 0x89, 0x00, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2E, -+0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0x7A, 0x00, 0xEF, 0x54, 0x07, 0xFF, 0x74, -+0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -+0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x26, 0x90, 0xA3, 0x0D, 0xE0, 0x04, 0xF0, 0x90, 0xA3, -+0x08, 0xED, 0xF0, 0x90, 0xA3, 0x0F, 0xE0, 0xFF, 0x90, 0xA3, 0x0D, 0xE0, 0x6F, 0x60, 0x1F, 0x90, -+0xA3, 0x10, 0xE0, 0xFF, 0x90, 0xA3, 0x08, 0xE0, 0xD3, 0x9F, 0x50, 0x0A, 0x80, 0x10, 0x90, 0xA3, -+0x10, 0xE0, 0x90, 0xA3, 0x08, 0xF0, 0x90, 0xA3, 0x0C, 0xE0, 0x14, 0xF0, 0xA1, 0x8C, 0x90, 0xA3, -+0x10, 0xE0, 0xFF, 0x90, 0xA3, 0x08, 0xE0, 0xC3, 0x9F, 0x50, 0x02, 0xEF, 0xF0, 0x90, 0xA3, 0x08, -+0xE0, 0x90, 0xA3, 0x06, 0xF0, 0xFD, 0x90, 0xA3, 0x0B, 0xE0, 0xFF, 0xD1, 0x98, 0x90, 0xA3, 0x06, -+0xEF, 0xF0, 0x80, 0x05, 0x90, 0xA3, 0x06, 0xE9, 0xF0, 0xE5, 0x19, 0x70, 0x10, 0x74, 0x0A, 0x25, -+0x19, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0x90, 0x04, 0x96, 0xF0, 0x90, 0xA3, 0x06, -+0xE0, 0xFD, 0x90, 0xA3, 0x0A, 0xE0, 0x90, 0xA4, 0x80, 0xF0, 0xE4, 0xFB, 0xAF, 0x19, 0x12, 0x68, -+0xFD, 0x90, 0xA3, 0x06, 0xE0, 0xFF, 0x22, 0xEF, 0xB4, 0x01, 0x0A, 0xED, 0xC3, 0x94, 0x2C, 0x40, -+0x04, 0x7E, 0x20, 0x80, 0x1E, 0xEF, 0xB4, 0x02, 0x0A, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x7E, -+0x18, 0x80, 0x10, 0xEF, 0xB4, 0x03, 0x0A, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x7E, 0x22, 0x80, -+0x02, 0xE4, 0xFE, 0xC3, 0xED, 0x9E, 0xFF, 0x22, 0xEF, 0xB4, 0x01, 0x0F, 0xED, 0xD3, 0x94, 0x0B, -+0x40, 0x09, 0xED, 0x94, 0x34, 0x50, 0x04, 0x7E, 0x20, 0x80, 0x1E, 0xEF, 0xB4, 0x02, 0x0A, 0xED, -+0xD3, 0x94, 0x1B, 0x40, 0x04, 0x7E, 0x18, 0x80, 0x10, 0xEF, 0xB4, 0x03, 0x0A, 0xED, 0xD3, 0x94, -+0x1B, 0x40, 0x04, 0x7E, 0x22, 0x80, 0x02, 0xE4, 0xFE, 0xED, 0x2E, 0xFF, 0x22, 0xED, 0x54, 0x7F, -+0xFC, 0xED, 0x54, 0x80, 0x60, 0x03, 0xAF, 0x04, 0x22, 0xEC, 0xB4, 0x3D, 0x02, 0x80, 0x1F, 0xEC, -+0xC3, 0x94, 0x3E, 0x40, 0x22, 0xEC, 0xD3, 0x94, 0x3F, 0x50, 0x1C, 0x75, 0xF0, 0x04, 0xEF, 0x90, -+0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x06, 0xEC, 0x44, 0x80, -+0xFE, 0x80, 0x06, 0x7E, 0xFF, 0x80, 0x02, 0x7E, 0xFF, 0xAF, 0x06, 0x22, 0xE4, 0xFE, 0x75, 0xF0, -+0x04, 0xEF, 0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0xF9, 0xC3, 0x13, 0x54, 0x07, 0xFC, 0xBC, -+0x05, 0x09, 0xED, 0xC3, 0x94, 0x3B, 0x40, 0x52, 0x0E, 0x80, 0x4F, 0xBC, 0x04, 0x0A, 0xED, 0xC3, -+0x94, 0x31, 0x40, 0x46, 0x7E, 0x01, 0x80, 0x42, 0xE9, 0xC3, 0x13, 0x54, 0x07, 0xFC, 0xBC, 0x03, -+0x0A, 0xED, 0xC3, 0x94, 0x19, 0x40, 0x33, 0x7E, 0x01, 0x80, 0x2F, 0xBC, 0x02, 0x0A, 0xED, 0xC3, -+0x94, 0x11, 0x40, 0x26, 0x7E, 0x01, 0x80, 0x22, 0xE9, 0xC3, 0x13, 0x54, 0x07, 0xFC, 0xBC, 0x01, -+0x0A, 0xED, 0xC3, 0x94, 0x0A, 0x40, 0x13, 0x7E, 0x01, 0x80, 0x0F, 0xEC, 0x70, 0x0A, 0xED, 0xC3, -+0x94, 0x03, 0x40, 0x06, 0x7E, 0x01, 0x80, 0x02, 0xE4, 0xFE, 0xAF, 0x06, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x6F, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xE4, -+0xA3, 0xF0, 0x90, 0xA4, 0x72, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x14, 0x74, 0x74, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA4, 0x72, 0xE0, 0x04, 0xF0, 0x80, 0xE2, -+0x90, 0xA4, 0x71, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x54, -+0x03, 0x90, 0xA4, 0x7C, 0xF0, 0x64, 0x01, 0x70, 0x52, 0x90, 0xA4, 0x71, 0xE0, 0xFF, 0x75, 0xF0, -+0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x74, 0xF0, 0x75, 0xF0, 0x08, 0xEF, -+0x90, 0x89, 0x01, 0x12, 0x49, 0xA8, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA4, 0x75, 0xF0, 0xE4, 0xA3, -+0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xEE, 0x54, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x71, 0xE0, 0x75, 0xF0, -+0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x7A, 0xF0, 0x75, 0xF0, 0x08, 0xEF, -+0x90, 0x89, 0x03, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x7B, 0xF0, 0x90, 0xA4, 0x7C, 0xE0, 0xFC, -+0xC3, 0x94, 0x02, 0x40, 0x64, 0x90, 0xA4, 0x71, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, -+0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x74, 0xF0, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x89, 0x01, 0x12, -+0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x75, 0xF0, 0x90, 0xA4, 0x71, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, -+0x02, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA4, 0x76, 0xF0, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x89, 0x03, -+0x12, 0x49, 0xA8, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA4, 0x77, 0xF0, 0xEE, 0x54, 0xF0, 0x90, 0xA4, -+0x73, 0xF0, 0xEC, 0xB4, 0x03, 0x0B, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x90, 0xA4, 0x7B, 0xF0, 0x80, -+0x08, 0x90, 0xA4, 0x73, 0xE0, 0x90, 0xA4, 0x7A, 0xF0, 0xE4, 0x90, 0xA4, 0x72, 0xF0, 0x90, 0xA4, -+0x72, 0xE0, 0xFF, 0x24, 0x74, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, -+0xE0, 0xFE, 0xEF, 0xFD, 0x90, 0xA4, 0x70, 0xE0, 0x2D, 0xFD, 0x90, 0xA4, 0x6F, 0xE0, 0x34, 0x00, -+0x8D, 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA4, 0x72, -+0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xC7, 0x90, 0xA4, 0x79, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x70, -+0x08, 0xA3, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x37, 0x90, 0xA4, 0x7C, 0xE0, 0x64, 0x01, 0x70, -+0x2F, 0x90, 0xA4, 0x75, 0xE0, 0x54, 0x0F, 0xFE, 0x90, 0xA4, 0x73, 0xF0, 0xEF, 0x54, 0xF0, 0x4E, -+0xF0, 0x90, 0xA4, 0x75, 0xF0, 0x90, 0xA4, 0x7A, 0xE0, 0x90, 0xA4, 0x76, 0xF0, 0x90, 0xA4, 0x7B, -+0xE0, 0x90, 0xA4, 0x77, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x80, 0xF0, -+0x90, 0xA4, 0x7C, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, 0x26, 0xEF, 0x90, 0xA4, 0x77, 0xB4, 0x02, -+0x08, 0xE0, 0xFF, 0x90, 0xA4, 0x7A, 0xE0, 0x80, 0x0A, 0xE0, 0xFF, 0x90, 0xA4, 0x7B, 0xE0, 0x13, -+0x13, 0x54, 0x3F, 0xFE, 0xEF, 0x4E, 0x90, 0xA4, 0x77, 0xF0, 0x90, 0xA4, 0x7B, 0x74, 0x80, 0xF0, -+0xE4, 0x90, 0xA4, 0x72, 0xF0, 0x90, 0xA4, 0x72, 0xE0, 0xFF, 0x24, 0x74, 0xF5, 0x82, 0xE4, 0x34, -+0xA4, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0xA4, 0x71, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, -+0x49, 0xA8, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0xA4, -+0x72, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xCD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0x06, -+0xEF, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0x7D, 0xF0, 0x74, 0x89, 0xA3, 0xF0, 0x90, 0xA3, 0x06, 0xE0, -+0xFD, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA3, 0x07, 0xF0, 0xE4, -+0x90, 0xA3, 0x0D, 0xF0, 0x90, 0xA3, 0x07, 0xE0, 0xFE, 0x54, 0x7F, 0xA3, 0xF0, 0xEE, 0x54, 0x80, -+0xA3, 0xF0, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0A, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA3, 0x0B, -+0xF0, 0x90, 0xA3, 0x06, 0xE0, 0xFC, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, -+0xFE, 0xC4, 0x54, 0x03, 0x90, 0xA3, 0x0C, 0xF0, 0xEE, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA3, 0x0A, -+0xF0, 0xEC, 0x70, 0x06, 0x90, 0x04, 0x93, 0xE0, 0x04, 0xF0, 0x90, 0xA3, 0x08, 0xE0, 0xFB, 0x75, -+0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x49, 0xA8, 0x12, 0x49, 0x63, 0xAD, 0x07, 0x90, 0xA3, 0x06, -+0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, -+0xED, 0xF0, 0x90, 0xA3, 0x09, 0xE0, 0xFE, 0x90, 0xA3, 0x07, 0xE0, 0x4E, 0xFE, 0x74, 0x0A, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x8A, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x9A, 0xF5, 0x83, 0xE0, 0x30, 0xE0, 0x3F, 0xEB, 0x64, 0x3F, 0x70, 0x3A, 0x90, 0xA3, 0x08, 0x74, -+0x3E, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0xFE, 0xC4, 0x13, -+0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0xA3, 0x07, 0x74, 0xBE, 0xF0, 0x80, 0x08, 0x90, 0xA3, 0x08, -+0xE0, 0x90, 0xA3, 0x07, 0xF0, 0x90, 0xA3, 0x07, 0xE0, 0xFD, 0x90, 0xA3, 0x0A, 0xE0, 0x90, 0xA4, -+0x80, 0xF0, 0xE4, 0xFB, 0xC1, 0x3E, 0x90, 0xA3, 0x06, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x86, -+0xCD, 0xEF, 0xF4, 0x60, 0x10, 0x90, 0xA3, 0x07, 0xEF, 0xF0, 0x30, 0xE7, 0x02, 0xC1, 0x2C, 0x90, -+0xA3, 0x07, 0xE0, 0xA3, 0xF0, 0x90, 0xA3, 0x0B, 0xE0, 0xFF, 0x90, 0xA3, 0x08, 0xE0, 0xFE, 0xC3, -+0x9F, 0x40, 0x02, 0xA1, 0xBB, 0xEE, 0x64, 0x2C, 0x70, 0x36, 0x90, 0xA3, 0x06, 0xE0, 0xFF, 0x75, -+0xF0, 0x04, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xFE, 0x54, 0x03, 0xFD, 0x90, 0xA3, 0x0A, -+0xE0, 0x6D, 0x60, 0x1C, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFD, 0x75, -+0xF0, 0x04, 0xEF, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xEE, 0x54, 0xF3, 0x4D, 0xF0, 0xA1, 0xB5, -+0x90, 0xA3, 0x08, 0xE0, 0xFF, 0xC3, 0x94, 0x0C, 0x40, 0x1F, 0xEF, 0x94, 0x13, 0x50, 0x1A, 0x90, -+0xA3, 0x06, 0xE0, 0xFF, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFE, 0x20, -+0xE3, 0x07, 0x90, 0xA3, 0x0D, 0x74, 0x01, 0x80, 0x27, 0x90, 0xA3, 0x08, 0xE0, 0xFF, 0xC3, 0x94, -+0x2C, 0x40, 0x2E, 0xEF, 0x94, 0x35, 0x50, 0x29, 0x90, 0xA3, 0x06, 0xE0, 0xFF, 0x24, 0x8A, 0xF5, -+0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFE, 0x20, 0xE3, 0x16, 0x90, 0xA3, 0x0D, 0x74, 0x02, -+0xF0, 0x74, 0x8A, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEE, 0x44, 0x08, 0xF0, 0x80, -+0x16, 0xE4, 0x90, 0xA3, 0x0D, 0xF0, 0x90, 0xA3, 0x06, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, -+0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0xA3, 0x0D, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x61, -+0xF0, 0x90, 0xA3, 0x06, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0xA8, 0xE0, 0x20, -+0xE7, 0x1A, 0x20, 0xE6, 0x17, 0x20, 0xE5, 0x14, 0x20, 0xE4, 0x11, 0x90, 0xA3, 0x06, 0xE0, 0x75, -+0xF0, 0x08, 0x90, 0x89, 0x03, 0x12, 0x49, 0xA8, 0xE0, 0x30, 0xE0, 0x64, 0x90, 0xA3, 0x06, 0xE0, -+0xFF, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0xA3, -+0x08, 0xE0, 0xFE, 0xB4, 0x0C, 0x05, 0x74, 0x14, 0xF0, 0x80, 0x2F, 0xEE, 0xB4, 0x0D, 0x02, 0x80, -+0x04, 0xEE, 0xB4, 0x0E, 0x08, 0x90, 0xA3, 0x08, 0x74, 0x15, 0xF0, 0x80, 0x1D, 0xEE, 0xB4, 0x0F, -+0x08, 0x90, 0xA3, 0x08, 0x74, 0x16, 0xF0, 0x80, 0x11, 0xEE, 0xC3, 0x94, 0x10, 0x90, 0xA3, 0x08, -+0x40, 0x05, 0x74, 0x17, 0xF0, 0x80, 0x03, 0x74, 0x18, 0xF0, 0x90, 0xA3, 0x08, 0xE0, 0xFE, 0x90, -+0xA3, 0x07, 0xF0, 0xFD, 0x90, 0xA3, 0x0A, 0xE0, 0x90, 0xA4, 0x80, 0xF0, 0x7B, 0x01, 0xC1, 0x3E, -+0x90, 0xA3, 0x0D, 0xE0, 0x64, 0x02, 0x60, 0x02, 0x81, 0xA7, 0x90, 0xA3, 0x06, 0xE0, 0x75, 0xF0, -+0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0xA8, 0xE0, 0x20, 0xE6, 0x1C, 0x20, 0xE7, 0x19, 0x90, 0xA3, -+0x06, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x12, 0x49, 0xA8, 0xE0, 0x20, 0xE0, 0x08, 0x20, -+0xE1, 0x05, 0x20, 0xE2, 0x02, 0x81, 0xA7, 0x90, 0xA3, 0x06, 0xE0, 0xFF, 0x24, 0x8A, 0xF5, 0x82, -+0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0xA3, 0x08, 0xE0, 0xFE, 0x64, 0x2C, -+0x60, 0x04, 0xEE, 0xB4, 0x2D, 0x08, 0x90, 0xA3, 0x08, 0x74, 0x36, 0xF0, 0x80, 0x43, 0xEE, 0x64, -+0x2E, 0x60, 0x04, 0xEE, 0xB4, 0x2F, 0x08, 0x90, 0xA3, 0x08, 0x74, 0x37, 0xF0, 0x80, 0x32, 0xEE, -+0xB4, 0x30, 0x08, 0x90, 0xA3, 0x08, 0x74, 0x38, 0xF0, 0x80, 0x26, 0xEE, 0xB4, 0x31, 0x08, 0x90, -+0xA3, 0x08, 0x74, 0x39, 0xF0, 0x80, 0x1A, 0xEE, 0xC3, 0x94, 0x32, 0x40, 0x0E, 0xEE, 0xD3, 0x94, -+0x34, 0x50, 0x08, 0x90, 0xA3, 0x08, 0x74, 0x3A, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0x08, 0x74, 0x3B, -+0xF0, 0x90, 0xA3, 0x08, 0xE0, 0xFE, 0x90, 0xA3, 0x07, 0xF0, 0xFD, 0x90, 0xA3, 0x0A, 0xE0, 0x90, -+0xA4, 0x80, 0xF0, 0x7B, 0x01, 0xC1, 0x3E, 0x90, 0xA3, 0x06, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, -+0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA3, 0x0C, 0xE0, 0xFF, 0x90, 0xA3, 0x08, -+0xE0, 0xFD, 0x12, 0x86, 0x67, 0xEF, 0xF0, 0x90, 0xA3, 0x0C, 0xE0, 0xFF, 0x90, 0xA3, 0x0B, 0xE0, -+0xFD, 0x12, 0x86, 0x67, 0xEF, 0xF0, 0x90, 0xA3, 0x08, 0xE0, 0x04, 0xFD, 0x90, 0xA3, 0x0B, 0xE0, -+0xFF, 0xED, 0xD3, 0x9F, 0x50, 0x76, 0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0x90, 0xA3, 0x06, -+0xE0, 0xFC, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0xA8, 0xE5, 0x82, 0x2F, 0xF5, 0x82, -+0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0x7A, 0x00, 0xED, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, -+0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5A, -+0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x33, 0x74, 0x0A, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, -+0xE0, 0x90, 0xA3, 0x08, 0xB4, 0x13, 0x1A, 0x74, 0x18, 0xF0, 0x90, 0xA3, 0x07, 0xF0, 0x90, 0xA3, -+0x06, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x44, 0x04, 0xF0, 0x80, -+0x0B, 0xED, 0xF0, 0x90, 0xA3, 0x07, 0xF0, 0x80, 0x03, 0x0D, 0x80, 0x80, 0x90, 0xA3, 0x0B, 0xE0, -+0xFF, 0x90, 0xA3, 0x07, 0xE0, 0xD3, 0x9F, 0x40, 0x02, 0xEF, 0xF0, 0x90, 0xA3, 0x0C, 0xE0, 0xFF, -+0x90, 0xA3, 0x07, 0xE0, 0xFD, 0x12, 0x86, 0x98, 0xEF, 0xF0, 0x90, 0xA3, 0x06, 0xE0, 0xFF, 0x24, -+0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0x2C, 0x90, 0xA3, -+0x08, 0xE0, 0x64, 0x3F, 0x60, 0x02, 0xC1, 0x2C, 0x74, 0x3E, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, -+0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0xA3, 0x07, -+0x74, 0xBE, 0xF0, 0x80, 0x77, 0x90, 0xA3, 0x08, 0xE0, 0x80, 0x6D, 0x90, 0xA3, 0x0B, 0xE0, 0xFF, -+0x90, 0xA3, 0x08, 0xE0, 0xFE, 0x6F, 0x70, 0x47, 0x90, 0xA3, 0x06, 0xE0, 0xFB, 0x75, 0xF0, 0x04, -+0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0D, 0x90, -+0xA3, 0x09, 0xE0, 0x64, 0x80, 0x60, 0x05, 0xEE, 0x44, 0x80, 0x80, 0x3C, 0x90, 0xA3, 0x08, 0xE0, -+0x75, 0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x49, 0xA8, 0x12, 0x49, 0x63, 0xEB, 0x25, 0xE0, 0x24, -+0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x80, 0x32, 0x90, -+0xA3, 0x0B, 0xE0, 0xFF, 0x90, 0xA3, 0x06, 0xE0, 0x24, 0x0A, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, -+0x83, 0xEF, 0xF0, 0x90, 0xA3, 0x08, 0xEF, 0xF0, 0x90, 0xA3, 0x07, 0xF0, 0x90, 0xA3, 0x06, 0xE0, -+0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA3, 0x0A, 0xE0, 0x90, 0xA4, 0x80, 0xF0, 0x7B, 0x01, 0x12, 0x68, -+0xFD, 0x90, 0xA3, 0x07, 0xE0, 0xFF, 0x22, 0x90, 0x01, 0xC4, 0x74, 0x47, 0xF0, 0x74, 0x8E, 0xA3, -+0xF0, 0xE4, 0xF5, 0x0F, 0x74, 0x2D, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, -+0x70, 0x03, 0x02, 0x97, 0x50, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, -+0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x03, 0x02, 0x97, 0x50, 0xE5, 0x0F, 0x25, -+0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xD3, 0x94, -+0x00, 0xEE, 0x94, 0x00, 0x50, 0x03, 0x02, 0x97, 0x50, 0xE5, 0x0F, 0x75, 0xF0, 0x0A, 0xA4, 0x24, -+0x79, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x8B, 0x13, 0xF5, 0x14, 0x89, 0x15, 0xE5, -+0x0F, 0x25, 0xE0, 0x24, 0x79, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFF, 0xA3, 0xE0, -+0x90, 0xA2, 0xF4, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, -+0x97, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA2, 0xF6, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x00, 0x02, -+0x12, 0x48, 0x37, 0xFF, 0xAE, 0xF0, 0x12, 0x48, 0x0C, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, 0x90, -+0x00, 0x04, 0x12, 0x48, 0x37, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, 0x12, 0x48, -+0x37, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x08, 0x12, 0x48, 0x37, 0x2F, 0xFF, 0xEE, -+0x35, 0xF0, 0x90, 0xA2, 0xF8, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, -+0x00, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xF3, 0xF0, 0x90, 0xA2, 0xF1, 0xF0, 0x54, 0x7F, 0xA3, -+0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x95, 0x0A, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA2, 0xFB, -+0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x13, 0x13, 0x54, -+0x03, 0x90, 0xA2, 0xFD, 0xF0, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, -+0xE0, 0xC3, 0x94, 0x05, 0x40, 0x03, 0x02, 0x93, 0x47, 0x90, 0xA2, 0xFB, 0xE0, 0xFF, 0x90, 0xA2, -+0xF2, 0xE0, 0x9F, 0x40, 0x06, 0xEF, 0xF0, 0x90, 0xA2, 0xF1, 0xF0, 0x90, 0xA2, 0xF2, 0xE0, 0xFF, -+0x90, 0x41, 0xE7, 0x93, 0xFE, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, -+0xE0, 0xC3, 0x9E, 0x40, 0x06, 0xEF, 0x90, 0x41, 0x3F, 0x80, 0x07, 0x90, 0xA2, 0xF2, 0xE0, 0x90, -+0x41, 0x93, 0x93, 0x90, 0xA2, 0xFA, 0xF0, 0x90, 0xA2, 0xFA, 0xE0, 0x75, 0xF0, 0x06, 0xA4, 0x24, -+0x9D, 0xF9, 0x74, 0x40, 0x35, 0xF0, 0x75, 0x10, 0xFF, 0xF5, 0x11, 0x89, 0x12, 0x90, 0xA2, 0xF1, -+0xE0, 0x90, 0x44, 0x93, 0x93, 0xFF, 0xD3, 0x90, 0xA2, 0xF7, 0xE0, 0x9F, 0x90, 0xA2, 0xF6, 0xE0, -+0x94, 0x00, 0x40, 0x05, 0x7D, 0x01, 0x02, 0x93, 0x40, 0xC3, 0x90, 0xA2, 0xF5, 0xE0, 0x94, 0x0F, -+0x90, 0xA2, 0xF4, 0xE0, 0x94, 0x00, 0x50, 0x6C, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x90, 0x00, -+0x06, 0x12, 0x48, 0x37, 0xFF, 0xAE, 0xF0, 0x90, 0x00, 0x08, 0x12, 0x48, 0x37, 0x2F, 0xFD, 0xE5, -+0xF0, 0x3E, 0xFC, 0x90, 0xA2, 0xF4, 0xE0, 0xC3, 0x13, 0xFE, 0xA3, 0xE0, 0x13, 0xFF, 0xD3, 0xED, -+0x9F, 0xEC, 0x9E, 0x40, 0x09, 0x7D, 0x01, 0xAF, 0x0F, 0x12, 0x83, 0xDD, 0x80, 0x36, 0x90, 0xA2, -+0xF4, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xAE, 0x04, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, -+0xF9, 0xFB, 0xAA, 0x06, 0xEC, 0xC3, 0x13, 0xFE, 0xED, 0x13, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xAB, -+0x13, 0xAA, 0x14, 0xA9, 0x15, 0x12, 0x48, 0x0C, 0xD3, 0x9F, 0xE5, 0xF0, 0x9E, 0x40, 0x05, 0xAF, -+0x0F, 0x12, 0x89, 0x7D, 0x90, 0xA2, 0xF4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x94, 0xE8, 0xEE, -+0x94, 0x03, 0x40, 0x08, 0x90, 0xA2, 0xFC, 0x74, 0x05, 0xF0, 0x80, 0x16, 0xD3, 0xEF, 0x94, 0xC8, -+0xEE, 0x94, 0x00, 0x40, 0x08, 0x90, 0xA2, 0xFC, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, -+0xFC, 0xF0, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, -+0xF5, 0x16, 0xA3, 0xE0, 0xF5, 0x17, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x12, 0x48, 0x0C, 0xFF, -+0xAE, 0xF0, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, -+0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, 0xAA, 0x11, 0xA9, 0x12, 0x12, 0x26, 0x1E, 0xFD, 0x7C, -+0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, -+0xAA, 0x14, 0xA9, 0x15, 0x90, 0x00, 0x02, 0x12, 0x48, 0x37, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0xFC, -+0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, -+0xAB, 0x10, 0xAA, 0x11, 0xA9, 0x12, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, -+0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, 0xAA, 0x14, -+0xA9, 0x15, 0x90, 0x00, 0x04, 0x12, 0x48, 0x37, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, -+0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, -+0xAA, 0x11, 0xA9, 0x12, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, -+0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, -+0x90, 0x00, 0x06, 0x12, 0x48, 0x37, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, 0xEF, 0xA8, -+0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, 0xAA, 0x11, -+0xA9, 0x12, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, -+0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x90, 0x00, -+0x08, 0x12, 0x48, 0x37, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, -+0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, 0xAA, 0x11, 0xA9, 0x12, -+0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, -+0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFD, 0x90, 0xA2, 0xFC, -+0xE0, 0xFF, 0x90, 0xA2, 0xF4, 0xE0, 0xFE, 0xA3, 0xE0, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x26, 0x98, 0xD3, 0xE5, 0x17, 0x9F, 0xE5, 0x16, 0x9E, -+0x40, 0x0C, 0xE5, 0x17, 0x9F, 0xF5, 0x17, 0xE5, 0x16, 0x9E, 0xF5, 0x16, 0x80, 0x05, 0xE4, 0xF5, -+0x16, 0xF5, 0x17, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xD3, -+0x94, 0x00, 0x40, 0x10, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, -+0x14, 0xF0, 0xC1, 0x83, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, -+0x83, 0xE5, 0x16, 0xF0, 0xA3, 0xE5, 0x17, 0xF0, 0xE5, 0x0F, 0x70, 0x0A, 0xE5, 0x17, 0x90, 0x04, -+0x90, 0xF0, 0xE5, 0x16, 0xA3, 0xF0, 0xAE, 0x16, 0xAF, 0x17, 0xE4, 0xFC, 0xFD, 0x90, 0xA2, 0xF2, -+0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x49, 0xA8, 0x12, 0x49, 0x8C, 0xC3, 0x12, 0x48, -+0xAC, 0x40, 0x02, 0x61, 0x17, 0x74, 0x89, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0xE0, 0xFF, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFE, 0xD3, -+0x9F, 0x40, 0x03, 0xEE, 0x80, 0x1A, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, -+0x83, 0xE0, 0xFF, 0x74, 0x89, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xC3, -+0x9F, 0x90, 0xA2, 0xFE, 0xF0, 0x90, 0xA2, 0xFE, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x04, 0x74, 0x8A, -+0x80, 0x21, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xD3, 0x94, -+0x00, 0x74, 0x8A, 0x40, 0x0E, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x14, -+0xF0, 0x80, 0x0B, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, -+0xF2, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x49, 0xA8, 0x12, 0x49, 0x63, 0xE5, 0x0F, -+0x25, 0xE0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x60, 0x02, 0xC1, 0x83, -+0xAF, 0x0F, 0x12, 0x89, 0x7D, 0xC1, 0x83, 0x90, 0xA2, 0xF2, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x8B, -+0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xD3, 0x74, 0x01, 0x93, 0x95, 0x17, 0xE4, 0x93, 0x95, -+0x16, 0x50, 0x02, 0xC1, 0x83, 0xEF, 0x64, 0x36, 0x60, 0x04, 0x7D, 0x01, 0x80, 0x02, 0x7D, 0x09, -+0xAF, 0x0F, 0x12, 0x83, 0xDD, 0xC1, 0x83, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, -+0xF5, 0x83, 0xE0, 0xFB, 0x64, 0x05, 0x60, 0x02, 0x81, 0xE7, 0x90, 0xA2, 0xF2, 0xE0, 0xFD, 0xAF, -+0x0F, 0x12, 0x87, 0x0C, 0xEF, 0x54, 0x01, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8D, -+0x12, 0x49, 0xA8, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, -+0x12, 0x49, 0xA8, 0xE0, 0x54, 0x07, 0x90, 0xA2, 0xFF, 0xF0, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, -+0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFF, 0xC3, 0x94, 0x30, 0x50, 0x13, 0xE4, 0x90, 0xA2, 0xFF, -+0xF0, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0x81, 0x4B, 0x75, -+0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0x20, 0xE0, 0x02, 0x81, 0x8A, -+0xC4, 0x54, 0x0F, 0x64, 0x0A, 0x60, 0x51, 0xEF, 0x24, 0x05, 0xFF, 0xE4, 0x33, 0xFE, 0x75, 0xF0, -+0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8C, 0x12, 0x49, 0xA8, 0xE0, 0xFD, 0xD3, 0x9F, 0xEE, 0x64, 0x80, -+0xF8, 0x74, 0x80, 0x98, 0x50, 0x32, 0xED, 0x24, 0x05, 0xFF, 0xE4, 0x33, 0xFE, 0x74, 0x0A, 0x25, -+0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xD3, 0x9F, 0xEE, 0x64, 0x80, 0xF8, 0x74, -+0x80, 0x98, 0x50, 0x14, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8B, 0x12, 0x49, 0xA8, 0xE0, -+0xFF, 0x90, 0xA2, 0xF2, 0xE0, 0x6F, 0x60, 0x45, 0x90, 0xA2, 0xFF, 0xE0, 0xFF, 0x70, 0x04, 0x04, -+0xF0, 0x80, 0x0F, 0xEF, 0x90, 0xA2, 0xFF, 0xB4, 0x01, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, -+0x05, 0xF0, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFF, 0x75, -+0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8C, 0x12, 0x49, 0xA8, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0xE5, -+0x0F, 0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x0F, 0xF0, 0x80, 0x3F, 0x74, 0x8A, 0x25, -+0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, -+0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0xFE, 0xEF, 0x54, 0x0F, 0xFF, 0xEE, -+0x04, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0x4F, 0xF0, 0x80, 0x12, 0xE4, 0x90, 0xA2, 0xFF, 0xF0, 0x74, -+0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0xF2, 0xE0, -+0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8B, 0x12, 0x49, 0xA8, 0xEF, 0xF0, 0x75, 0xF0, -+0x04, 0xE5, 0x0F, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, -+0xE0, 0x02, 0xC1, 0x59, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8D, 0x12, 0x49, 0xA8, 0xE0, -+0x54, 0x0F, 0xF0, 0xE4, 0x90, 0xA2, 0xFF, 0xF0, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, -+0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xC1, 0x59, 0xEB, 0x64, 0x06, 0x60, 0x02, 0xC1, 0x83, 0xF5, 0x16, -+0xF5, 0x17, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x07, -+0x90, 0xA2, 0xFF, 0xF0, 0x90, 0xA2, 0xF4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x94, 0xE8, 0xEE, -+0x94, 0x03, 0x40, 0x08, 0x90, 0xA2, 0xFC, 0x74, 0x05, 0xF0, 0x80, 0x16, 0xD3, 0xEF, 0x94, 0xFA, -+0xEE, 0x94, 0x00, 0x40, 0x08, 0x90, 0xA2, 0xFC, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, -+0xFC, 0xF0, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, -+0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x44, 0xEC, 0xE4, 0x93, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, -+0x90, 0xA3, 0x00, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xF5, 0x18, 0xAB, 0x13, 0xAA, 0x14, 0xA9, -+0x15, 0x75, 0xF0, 0x02, 0xE5, 0x18, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x48, 0x37, 0xFF, -+0xAE, 0xF0, 0x90, 0xA2, 0xFC, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, -+0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xE5, 0x18, 0x90, 0x44, 0xE7, 0x93, 0xFD, 0x7C, 0x00, 0x12, 0x26, -+0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xC3, 0x90, 0xA3, 0x01, 0xE0, -+0x95, 0x17, 0x90, 0xA3, 0x00, 0xE0, 0x95, 0x16, 0x40, 0x07, 0x05, 0x18, 0xE5, 0x18, 0xB4, 0x05, -+0xAA, 0xE5, 0x18, 0xC3, 0x13, 0xF5, 0x18, 0x90, 0xA2, 0xFF, 0xE0, 0x24, 0x01, 0xFF, 0xE4, 0x33, -+0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x90, 0xA3, 0x03, 0xF0, 0xD3, 0x95, 0x18, 0x40, 0x06, 0xE0, 0x95, -+0x18, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA3, 0x03, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, -+0x8A, 0x12, 0x49, 0xA8, 0xE0, 0xC3, 0x13, 0xFF, 0x90, 0xA3, 0x03, 0xE0, 0xC4, 0x33, 0x54, 0xE0, -+0x2F, 0x04, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8A, 0x12, 0x49, 0xA8, 0xEF, 0xF0, -+0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8A, 0x12, 0x49, 0xA8, 0xE0, 0xC3, 0x94, 0xC0, 0x40, -+0x0E, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8A, 0x12, 0x49, 0xA8, 0x74, 0xC0, 0xF0, 0x75, -+0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x98, 0x8A, 0x12, 0x49, 0xA8, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x90, 0xA3, 0x03, 0xF0, 0xE0, 0x25, 0xE0, 0xF0, 0x70, 0x02, 0x80, 0x05, 0x90, 0xA3, 0x03, 0xE0, -+0x14, 0x90, 0xA2, 0xFF, 0xF0, 0xD3, 0x90, 0xA2, 0xF7, 0xE0, 0x94, 0x03, 0x90, 0xA2, 0xF6, 0xE0, -+0x94, 0x00, 0x40, 0x05, 0xE4, 0x90, 0xA2, 0xFF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, -+0x01, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF8, 0xFF, 0x90, 0xA3, 0x02, 0xF0, 0x90, 0xA2, 0xFF, 0xE0, -+0x4F, 0xFF, 0x90, 0xA3, 0x02, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x12, 0x49, -+0xA8, 0xEF, 0xF0, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xD3, -+0x94, 0x05, 0x74, 0x8A, 0x50, 0x0E, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, -+0x04, 0xF0, 0x80, 0x0B, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0x90, -+0xA2, 0xF6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, 0x9E, 0xFC, -+0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFA, 0xA3, -+0xE0, 0xD3, 0x9D, 0xEA, 0x9C, 0xE5, 0x0F, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, -+0x34, 0x9C, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x47, 0xF6, 0x80, 0x10, 0x25, 0xE0, 0x24, 0x8A, -+0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0x90, 0xA2, 0xF8, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, 0x9E, 0xFC, 0xE5, 0x0F, 0x25, -+0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0xFA, 0xA3, 0xE0, 0xD3, 0x9D, -+0xEA, 0x9C, 0xE5, 0x0F, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, -+0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x47, 0xF6, 0x80, 0x10, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, -+0x34, 0x9D, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xE4, 0xFD, 0xAF, 0x0F, 0x12, 0x68, 0x70, -+0x05, 0x0F, 0xE5, 0x0F, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x8E, 0x54, 0x22, 0x90, 0xA2, 0xFE, -+0x12, 0x49, 0xBD, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, 0x12, 0x26, 0x1E, 0x54, 0x7F, 0xFD, 0x90, -+0x00, 0x01, 0x12, 0x26, 0x37, 0xFE, 0x54, 0x1F, 0x90, 0xA3, 0x02, 0xF0, 0xEE, 0x54, 0x80, 0xC4, -+0x13, 0x13, 0x13, 0x54, 0x01, 0x90, 0xA3, 0x01, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFE, -+0x54, 0x03, 0xFF, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0xA3, 0x04, 0xF0, 0x90, 0x00, 0x02, -+0x12, 0x26, 0x37, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA3, 0x03, 0xF0, 0xEE, -+0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFE, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFB, -+0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFC, 0x90, 0xA3, 0x05, 0xF0, 0xEB, 0x54, 0x04, 0x13, -+0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEE, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0xFE, 0x75, -+0xF0, 0x04, 0xED, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0x7F, 0x4E, 0xF0, 0x90, 0xA3, -+0x03, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, -+0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, 0xEC, 0x60, 0x02, 0x01, 0xE6, 0x90, 0xA3, -+0x02, 0xE0, 0x54, 0x1F, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0C, 0x12, 0x49, 0xA8, 0xE0, -+0x54, 0xE0, 0x4E, 0xF0, 0xEF, 0x54, 0x03, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0D, 0x12, -+0x49, 0xA8, 0xE0, 0x54, 0xFC, 0x4E, 0xF0, 0xEF, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x75, -+0xF0, 0x04, 0xED, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xF3, 0x4F, 0xF0, 0x90, 0xA3, -+0x01, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0C, -+0x12, 0x49, 0xA8, 0xE0, 0x54, 0xDF, 0x4F, 0xF0, 0x90, 0xA3, 0x04, 0xE0, 0x54, 0x03, 0xC4, 0x54, -+0xF0, 0xFF, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x0D, 0x12, 0x49, 0xA8, 0xE0, 0x54, 0xCF, 0x4F, -+0xF0, 0x74, 0x8A, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0x74, -+0x8A, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, -+0xA3, 0x06, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xE4, -+0xFC, 0xEC, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, 0x8F, 0x82, -+0x8E, 0x83, 0x12, 0x26, 0x37, 0xFF, 0x75, 0xF0, 0x08, 0xED, 0x90, 0x89, 0x00, 0x12, 0x49, 0xA8, -+0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x0C, 0xEC, 0xB4, 0x04, -+0xD0, 0xAF, 0x05, 0x12, 0x6A, 0xE1, 0x22, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xBD, 0x12, 0x26, 0x1E, -+0xF5, 0x0F, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFE, 0xF0, 0x74, -+0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, -+0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x54, 0x01, 0xFE, 0xEF, -+0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, -+0x83, 0xE0, 0x54, 0xFD, 0xF0, 0x74, 0x8A, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, -+0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA2, 0xFE, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x03, 0x12, -+0x26, 0x37, 0x54, 0x02, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xE5, 0x0F, 0xC3, 0x94, -+0x80, 0x50, 0x15, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x74, 0x0A, 0x25, 0x0F, 0xF5, 0x82, -+0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0xE5, 0x0F, 0xB4, 0x80, 0x0A, 0x90, 0x00, 0x02, -+0x12, 0x26, 0x37, 0x90, 0x95, 0x09, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0xFD, 0x90, 0x00, 0x01, 0x12, -+0x26, 0x37, 0xFC, 0xED, 0xC3, 0x94, 0x80, 0x90, 0xA3, 0x00, 0xED, 0x50, 0x3F, 0xF0, 0x25, 0xE0, -+0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA3, 0x01, -+0xF0, 0xEE, 0xA3, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, -+0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA3, 0x03, 0xF0, 0xEE, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, -+0x81, 0x00, 0x12, 0x49, 0xA8, 0xE0, 0x90, 0xA3, 0x05, 0xF0, 0x80, 0x01, 0xF0, 0xEC, 0xC3, 0x94, -+0x80, 0x90, 0xA3, 0x06, 0xEC, 0x50, 0x3F, 0xF0, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, -+0x9D, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA3, 0x07, 0xF0, 0xEE, 0xA3, 0xF0, 0xEC, 0x25, -+0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA3, -+0x09, 0xF0, 0xEE, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x00, 0x12, 0x49, 0xA8, 0xE0, -+0x90, 0xA3, 0x0B, 0xF0, 0x80, 0x01, 0xF0, 0x90, 0xA2, 0xFE, 0x74, 0x04, 0xF0, 0x90, 0xA3, 0x0C, -+0x74, 0x0C, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, -+0xF0, 0xA3, 0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, -+0xF0, 0xA3, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, -+0xF0, 0xA3, 0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x8A, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, -+0xF0, 0xA3, 0x12, 0x57, 0xEC, 0x7F, 0x04, 0x02, 0x54, 0x17, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, -+0x03, 0x12, 0x49, 0xA8, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0xE4, 0xF5, 0x0D, 0xE4, 0xF5, 0x0E, 0xE5, -+0x0E, 0xB4, 0x03, 0x1E, 0xFF, 0xE5, 0x0D, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, -+0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x74, 0x40, 0xF0, -+0x80, 0x1B, 0xE5, 0x0D, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, -+0xE5, 0x82, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x05, 0x0E, 0xE5, -+0x0E, 0xB4, 0x10, 0xBB, 0x05, 0x0D, 0xE5, 0x0D, 0xB4, 0x08, 0xB1, 0x22, 0x90, 0x04, 0x54, 0xE0, -+0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x90, 0xA3, 0x16, 0xED, 0xF0, 0x90, 0xA3, 0x15, -+0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x15, 0x51, 0xDC, 0xEF, 0x60, 0x29, 0x51, 0xDC, 0xEF, 0x64, -+0x01, 0x70, 0x22, 0x90, 0xA3, 0x16, 0xE0, 0xFD, 0xE4, 0xFF, 0x80, 0x15, 0x90, 0xA3, 0x15, 0xE0, -+0xD3, 0x94, 0x0E, 0x40, 0x10, 0x51, 0xDC, 0xEF, 0x70, 0x09, 0x90, 0xA3, 0x16, 0xE0, 0xFD, 0x7F, -+0x01, 0x80, 0x03, 0x51, 0xDC, 0x22, 0x90, 0xA3, 0x18, 0xED, 0xF0, 0x90, 0xA3, 0x17, 0xEF, 0xF0, -+0x60, 0x02, 0x61, 0xC2, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA3, -+0x86, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, 0x57, 0x99, 0x90, -+0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0F, 0x00, -+0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x91, 0x75, 0x90, 0xA3, 0x82, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, -+0x7F, 0x0C, 0x7E, 0x08, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x0F, 0x00, 0x00, -+0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0x04, 0x7E, 0x0A, 0x12, -+0x57, 0x99, 0x90, 0x04, 0x54, 0xE0, 0x54, 0x7F, 0x90, 0xA3, 0x19, 0xF0, 0xE0, 0x90, 0x04, 0x54, -+0xF0, 0x22, 0x90, 0xA3, 0x17, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x81, 0x74, 0x90, 0x04, 0x54, 0xE0, -+0x44, 0x80, 0x90, 0xA3, 0x19, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x90, 0xA3, 0x82, 0x12, 0x27, -+0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, -+0x08, 0xFF, 0xFE, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, -+0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x82, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x0F, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, -+0x00, 0x91, 0x75, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA3, 0x86, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x0C, 0x7E, 0x08, 0x12, 0x57, 0x99, 0x90, 0xA3, -+0x82, 0x12, 0x27, 0x54, 0x0F, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x0F, 0x00, -+0x00, 0x00, 0x7F, 0x04, 0x7E, 0x0A, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x30, -+0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, -+0xFE, 0x12, 0x57, 0x99, 0x22, 0x7F, 0x1C, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x17, 0xE0, -+0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA3, 0x1A, 0xED, 0xF0, 0xEF, 0x60, 0x02, 0xA1, 0x63, 0xE0, 0x24, -+0xFD, 0x50, 0x07, 0x60, 0x36, 0x14, 0x60, 0x64, 0xE1, 0x3F, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, -+0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, -+0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, -+0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0xC1, 0x15, 0x90, 0xA3, 0x82, 0x12, 0x27, -+0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0x7F, -+0xB0, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, -+0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0xC1, 0xE7, 0x90, 0xA3, 0x82, 0x12, -+0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, -+0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, -+0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, -+0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, -+0x27, 0x54, 0x00, 0x10, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, -+0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x10, 0x00, -+0x00, 0xC1, 0xB2, 0x90, 0xA3, 0x1A, 0xE0, 0x14, 0x60, 0x7C, 0x14, 0x70, 0x02, 0xC1, 0x4D, 0x14, -+0x70, 0x02, 0xC1, 0xB8, 0x14, 0x70, 0x02, 0xC1, 0x4D, 0x24, 0x04, 0x60, 0x02, 0xE1, 0x3F, 0x90, -+0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, -+0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, -+0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, -+0x7E, 0x0E, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, -+0xA3, 0x86, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x57, 0x99, -+0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, -+0x01, 0x00, 0x00, 0x00, 0xC1, 0xB2, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, -+0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x57, -+0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, -+0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, -+0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, -+0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, -+0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x80, 0x65, 0x90, 0xA3, 0x82, -+0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, -+0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, -+0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, -+0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, -+0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, -+0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x01, 0x00, -+0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0E, 0xE1, 0x3C, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, -+0xFF, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, -+0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA3, 0x86, -+0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x57, 0x99, 0x90, 0xA3, -+0x82, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x01, 0x00, -+0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x3F, -+0xF0, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, -+0x0E, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0x03, 0x90, 0xA3, -+0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, 0x12, 0x57, 0x99, 0x22, -+0x90, 0xA4, 0xA9, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA4, 0xA8, 0xEF, 0xF0, 0xE4, 0xFE, 0xF1, -+0xED, 0x90, 0xA4, 0xA8, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0x12, 0xA1, 0x61, 0xAE, -+0x07, 0x90, 0x04, 0x83, 0xEE, 0xF0, 0x90, 0xA4, 0xA8, 0xE0, 0xFF, 0xAD, 0x06, 0x12, 0xA0, 0x20, -+0x90, 0xA4, 0xA8, 0xE0, 0xFF, 0xEF, 0x14, 0x60, 0x3A, 0x14, 0x60, 0x53, 0x24, 0x02, 0x70, 0x6C, -+0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x0C, 0x00, 0x12, 0x57, 0x0F, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, -+0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0x7F, -+0x01, 0x80, 0x36, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA3, 0x7E, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x04, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x80, 0x1A, 0x90, -+0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA3, 0x7E, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0x57, 0x15, 0x22, 0xA9, 0x07, 0x90, -+0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0xFE, -+0xE9, 0x14, 0x60, 0x13, 0x14, 0x60, 0x10, 0x24, 0x02, 0x70, 0x14, 0xEE, 0x54, 0xFE, 0xFE, 0xEF, -+0x54, 0x7F, 0x90, 0x06, 0x68, 0x80, 0x04, 0x90, 0x06, 0x68, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, -+0x90, 0xA4, 0xB8, 0xED, 0xF0, 0xEF, 0x14, 0x60, 0x23, 0x14, 0x70, 0x02, 0x01, 0xF0, 0x24, 0x02, -+0x60, 0x02, 0x21, 0x60, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA3, -+0x86, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x00, 0x7F, 0xAC, 0x21, 0x5B, 0x90, 0xA3, 0x82, 0x12, -+0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x01, -+0x7F, 0xAC, 0x7E, 0x08, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x3C, 0x90, 0xA4, 0xB8, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xFF, 0xAE, 0xF0, 0xEE, 0x33, 0x95, 0xE0, -+0xFD, 0xFC, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x48, 0x7F, 0xAC, 0x7E, 0x08, 0x12, 0x57, 0x99, 0x90, -+0xA3, 0x82, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xB8, 0xE0, 0x7E, 0x00, 0x78, -+0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, -+0xA3, 0x86, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x12, 0x57, 0x99, 0x90, 0xA4, 0xB8, 0xE0, -+0x90, 0xA3, 0x82, 0xB4, 0x01, 0x13, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0xA3, 0x86, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x80, 0x11, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, -+0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x0A, 0x80, 0x6D, -+0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, -+0x00, 0x30, 0x02, 0x02, 0x7F, 0xAC, 0x7E, 0x08, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x3C, 0x90, 0xA4, 0xB8, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xFF, 0xAE, 0xF0, -+0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x48, 0x7F, 0xAC, 0x7E, 0x08, -+0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA4, 0xB8, -+0xE0, 0x7E, 0x00, 0x78, 0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, -+0xE0, 0xFD, 0xFC, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x12, 0x57, 0x99, -+0x22, 0xE4, 0xFE, 0xFC, 0xEF, 0x64, 0x02, 0x70, 0x40, 0xED, 0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, -+0x06, 0xED, 0xB4, 0x02, 0x02, 0x7E, 0x09, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, -+0x04, 0x80, 0x38, 0xEB, 0xB4, 0x02, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, -+0xB4, 0x01, 0x08, 0xED, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, -+0xED, 0x64, 0x02, 0x70, 0x16, 0x7C, 0x03, 0x80, 0x12, 0xEF, 0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, -+0x04, 0x7C, 0x01, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7C, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, -+0xF0, 0x4C, 0xFF, 0x22, 0x90, 0x01, 0xC3, 0xE0, 0xD3, 0x9F, 0x40, 0xF8, 0x22, 0x90, 0xA3, 0x71, -+0x12, 0x49, 0xBD, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0xE4, 0x78, 0x00, 0xF2, 0x78, 0x00, -+0xE2, 0xFF, 0x25, 0xE0, 0x24, 0xED, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xF5, 0x83, 0xE4, 0x93, 0xFC, -+0x74, 0x01, 0x93, 0xF5, 0x82, 0x8C, 0x83, 0xE0, 0xFE, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xB4, 0x8F, -+0x82, 0x75, 0x83, 0x00, 0xEE, 0x12, 0x26, 0x76, 0x78, 0x00, 0xE2, 0x04, 0xF2, 0xE2, 0xB4, 0x03, -+0xCD, 0xE4, 0x78, 0x00, 0xF2, 0x78, 0x00, 0xE2, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x32, 0xEF, 0x25, -+0xE0, 0x24, 0xF3, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, -+0xFF, 0x12, 0x36, 0xCE, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xB4, 0x78, 0x00, 0xE2, 0x75, 0xF0, 0x04, -+0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x49, 0x27, 0x78, 0x00, 0xE2, 0x04, 0xF2, 0x80, 0xC5, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x01, 0x90, 0xA3, -+0x74, 0x12, 0x49, 0xBD, 0x7A, 0xA2, 0x79, 0xFE, 0x31, 0xCD, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x3D, -+0x90, 0xA3, 0x74, 0x12, 0x49, 0xBD, 0x7A, 0xA3, 0x79, 0x21, 0x71, 0xE7, 0x7B, 0x01, 0x7A, 0xA3, -+0x79, 0x65, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xBD, 0x7A, 0xA3, 0x79, 0x59, 0x12, 0x5F, 0x56, 0x71, -+0x6D, 0xE4, 0xFF, 0x12, 0xAB, 0xE4, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x59, 0xE4, 0xFF, 0x51, 0xE8, -+0x7F, 0x01, 0x12, 0xAB, 0xE4, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x65, 0x7F, 0x01, 0x51, 0xE8, 0x7B, -+0x01, 0x7A, 0xA3, 0x79, 0x3D, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xBD, 0x7A, 0xA3, 0x79, 0x21, 0xB1, -+0x10, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x01, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xBD, 0x7A, 0xA2, 0x79, -+0xFE, 0x91, 0x71, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA3, 0x71, 0xEF, 0xF0, 0xA3, 0x12, 0x49, -+0xBD, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x72, 0x12, 0x49, 0xB4, 0x12, 0x48, -+0xBD, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x48, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x65, 0x12, 0x5F, -+0xDF, 0x90, 0xA3, 0x72, 0x12, 0x49, 0xB4, 0x90, 0x00, 0x04, 0x12, 0x48, 0xDD, 0x90, 0xA3, 0x79, -+0x12, 0x27, 0x48, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x8F, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x72, -+0x12, 0x49, 0xB4, 0x90, 0x00, 0x08, 0x12, 0x48, 0xDD, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x48, 0x90, -+0xA3, 0x71, 0xE0, 0xFF, 0xE4, 0xFD, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x00, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0xEF, 0x02, 0x5F, 0xDF, 0x90, 0xA3, 0x82, -+0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x00, 0x12, 0x57, 0x95, 0x90, 0x05, 0x22, 0x74, 0x3F, 0xF0, 0x90, 0x05, 0x50, 0xE0, 0x54, 0xF7, -+0xF0, 0xA3, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x10, 0x00, 0x00, 0x00, -+0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, 0x57, -+0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x00, 0x0F, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x0C, -+0x7F, 0x38, 0x7E, 0x08, 0x02, 0x57, 0x99, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xBD, 0x90, 0xA3, 0x82, -+0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x00, 0x12, 0x57, 0x95, 0xE4, 0x78, 0x00, 0xF2, 0x78, 0x00, 0xE2, 0xFF, 0xC3, 0x94, 0x07, 0x50, -+0x5F, 0xEF, 0x25, 0xE0, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, -+0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xB4, 0x78, 0x00, 0xE2, -+0x75, 0xF0, 0x04, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x49, 0x27, 0x78, 0x00, 0xE2, 0x25, -+0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, -+0xFF, 0x12, 0x36, 0xCE, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xB4, 0x78, 0x00, 0xE2, 0x75, 0xF0, 0x04, -+0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x49, 0x27, 0x78, 0x00, 0xE2, 0x04, 0xF2, 0x80, 0x98, -+0x22, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xBD, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, -+0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0xE4, 0x78, -+0x00, 0xF2, 0x90, 0xA3, 0x71, 0x12, 0x49, 0xB4, 0x78, 0x00, 0xE2, 0xFF, 0xF5, 0x82, 0x75, 0x83, -+0x00, 0x12, 0x26, 0x37, 0xFE, 0xEF, 0x25, 0xE0, 0x24, 0xED, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xF5, -+0x83, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x8C, 0x83, 0xEE, 0xF0, 0x78, 0x00, 0xE2, -+0x04, 0xF2, 0xE2, 0xB4, 0x03, 0xCC, 0xE4, 0x78, 0x00, 0xF2, 0x78, 0x00, 0xE2, 0xFD, 0x25, 0xE0, -+0x24, 0xF3, 0xF5, 0x82, 0xE4, 0x34, 0x44, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xB4, 0x75, 0xF0, 0x04, 0xED, 0xA4, 0xF5, -+0x82, 0x85, 0xF0, 0x83, 0x12, 0x48, 0xDD, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0xD0, 0x07, 0xD0, -+0x06, 0x12, 0x37, 0x5D, 0x78, 0x00, 0xE2, 0x04, 0xF2, 0xE2, 0xC3, 0x94, 0x08, 0x40, 0xBB, 0x22, -+0x90, 0xA3, 0x71, 0x12, 0x49, 0xBD, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, -+0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0xE4, 0x78, 0x00, -+0xF2, 0x78, 0x00, 0xE2, 0xFD, 0x25, 0xE0, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, -+0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x71, 0x12, 0x49, -+0xB4, 0x75, 0xF0, 0x04, 0xED, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x48, 0xDD, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x48, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x78, 0x00, 0xE2, 0xFD, 0x25, -+0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, -+0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x74, 0x12, 0x49, 0xB4, 0x75, 0xF0, 0x04, 0xED, 0xA4, -+0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x48, 0xDD, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0xD0, 0x07, -+0xD0, 0x06, 0x12, 0x37, 0x5D, 0x78, 0x00, 0xE2, 0x04, 0xF2, 0xE2, 0xC3, 0x94, 0x07, 0x40, 0x81, -+0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, -+0x80, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x00, 0x7F, 0x80, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x7F, 0x84, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x00, 0x7F, 0x88, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, -+0x3C, 0x00, 0x00, 0x00, 0x7F, 0x8C, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB8, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x80, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x84, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x88, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, -+0xAC, 0xB9, 0x12, 0x27, 0x54, 0x3C, 0x00, 0x00, 0x00, 0x7F, 0x8C, 0x7E, 0x0E, 0x12, 0x37, 0x5D, -+0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB8, 0x7E, 0x0E, 0x02, 0x37, -+0x5D, 0x90, 0xA3, 0x77, 0xEF, 0xF0, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, -+0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x78, -+0x12, 0x49, 0x4B, 0x78, 0x01, 0x12, 0x27, 0x22, 0xE4, 0x7B, 0x12, 0x7A, 0x01, 0xF9, 0xF8, 0xC3, -+0x12, 0x48, 0xAC, 0x60, 0x17, 0x90, 0xA3, 0x7C, 0x12, 0x49, 0x4B, 0x78, 0x01, 0x12, 0x27, 0x22, -+0xE4, 0x7B, 0xEE, 0x7A, 0x03, 0xF8, 0xC3, 0x12, 0x48, 0xAC, 0x70, 0x69, 0x90, 0xA3, 0x77, 0xE0, -+0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x29, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, -+0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x03, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, 0xD0, 0x07, 0xD0, 0x06, -+0x12, 0x57, 0x99, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x29, 0xF5, 0x82, 0xE4, -+0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0xA3, 0x82, 0x12, 0x27, 0x54, 0x03, 0xFF, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x00, 0x80, 0x70, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x29, 0xF5, -+0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0xFF, 0x90, 0xA3, 0x78, 0x12, 0x49, -+0x4B, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x48, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0x90, 0xA3, -+0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x29, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, -+0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, -+0x03, 0xFF, 0x00, 0x00, 0x90, 0xA3, 0x7C, 0x12, 0x49, 0x4B, 0x78, 0x10, 0x12, 0x27, 0x35, 0x90, -+0xA3, 0x86, 0x12, 0x27, 0x48, 0xD0, 0x07, 0xD0, 0x06, 0x02, 0x57, 0x99, 0x90, 0xA3, 0x77, 0xEF, -+0xF0, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, -+0x54, 0x80, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, -+0x24, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x80, 0xD0, 0x07, -+0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x20, 0x04, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, -+0x37, 0x5D, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x31, 0xF5, 0x82, 0xE4, 0x34, -+0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, -+0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x33, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, -+0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x07, 0xFF, 0x90, 0xA3, 0x7C, 0x12, 0x49, 0x4B, 0x90, 0xA3, 0x86, 0x12, 0x27, -+0x48, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, -+0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x07, 0xFF, 0x90, 0xA3, -+0x78, 0x12, 0x49, 0x4B, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x48, 0xD0, 0x07, 0xD0, 0x06, 0x02, 0x57, -+0x99, 0x90, 0xA3, 0x77, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xE4, 0x78, 0x3C, 0xF2, 0x90, 0xA3, 0x77, -+0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x0B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, -+0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, -+0x10, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, -+0xFA, 0x00, 0x00, 0x00, 0x7F, 0x80, 0x7E, 0x09, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0xF8, 0x00, 0x00, 0x00, 0x7F, 0x80, 0x7E, 0x09, 0x12, 0x37, 0x5D, 0x7F, 0x03, 0x7E, 0x00, -+0x12, 0x3A, 0x69, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x0B, 0xF5, 0x82, 0xE4, -+0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, -+0xE4, 0x78, 0x3D, 0xF2, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x2B, 0xF5, 0x82, -+0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, -+0xFF, 0xEE, 0x54, 0x04, 0xFE, 0xE4, 0xFD, 0xFC, 0x78, 0x0A, 0x12, 0x27, 0x22, 0x78, 0x3E, 0xEF, -+0xF2, 0x70, 0x15, 0x18, 0xE2, 0xD3, 0x94, 0x14, 0x50, 0x0E, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, -+0x69, 0x78, 0x3D, 0xE2, 0x04, 0xF2, 0x80, 0xBC, 0x78, 0x3D, 0xE2, 0xC3, 0x94, 0x14, 0x40, 0x02, -+0x61, 0xCF, 0x90, 0xA3, 0x78, 0xE0, 0x60, 0x02, 0x41, 0x63, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, -+0x1C, 0xA4, 0x24, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, -+0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, 0xFF, 0xEE, 0x54, 0x10, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, 0xA3, -+0x79, 0x12, 0x27, 0x48, 0xE4, 0xFF, 0xFE, 0xFD, 0xFC, 0x90, 0xA3, 0x79, 0x12, 0x49, 0x73, 0xC3, -+0x12, 0x48, 0xAC, 0x70, 0x7C, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x0B, 0xF5, -+0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x02, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, -+0x37, 0x5D, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x2B, 0xF5, 0x82, 0xE4, 0x34, -+0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, 0xFF, 0xFE, -+0xEC, 0x54, 0x07, 0xFC, 0x78, 0x70, 0x12, 0x49, 0x9C, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x0E, -+0xA4, 0x24, 0x0B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, -+0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x04, 0x00, 0x00, 0x00, 0x61, -+0x1A, 0xE4, 0x78, 0x3F, 0xF2, 0x78, 0x3C, 0xE2, 0x04, 0xF2, 0xE2, 0x64, 0x0A, 0x60, 0x02, 0x01, -+0xBD, 0x61, 0xDF, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x2B, 0xF5, 0x82, 0xE4, -+0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, 0xFF, -+0xEE, 0x54, 0x08, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x48, 0xE4, 0xFF, 0xFE, -+0xFD, 0xFC, 0x90, 0xA3, 0x79, 0x12, 0x49, 0x73, 0xC3, 0x12, 0x48, 0xAC, 0x60, 0x02, 0x61, 0x4F, -+0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x0B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, -+0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, -+0x27, 0x54, 0x06, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x77, -+0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, -+0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, 0xFF, 0xFE, 0xEC, 0x54, 0x07, 0xFC, 0x78, -+0x70, 0x12, 0x49, 0x9C, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x0B, 0xF5, 0x82, -+0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x08, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, -+0x5D, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0x45, -+0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x36, 0xCE, 0xE4, 0xFF, 0xFE, 0xEC, -+0x54, 0x07, 0xFC, 0x78, 0x74, 0x12, 0x49, 0x9C, 0x78, 0x3F, 0x74, 0x01, 0xF2, 0x61, 0xDF, 0x90, -+0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x29, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, -+0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x03, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, 0xD0, -+0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x77, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x29, -+0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x03, 0xFF, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0xE4, 0x78, 0x3F, -+0xF2, 0x78, 0x3C, 0xE2, 0x04, 0xF2, 0xE2, 0x64, 0x0A, 0x60, 0x02, 0x01, 0xBD, 0x80, 0x10, 0xE4, -+0x78, 0x3F, 0xF2, 0x78, 0x3C, 0xE2, 0x04, 0xF2, 0xE2, 0x64, 0x0A, 0x60, 0x02, 0x01, 0xBD, 0x78, -+0x3F, 0xE2, 0xFF, 0x22, 0x90, 0xA3, 0x71, 0xEF, 0xF0, 0xE4, 0x78, 0x00, 0xF2, 0xA3, 0xF0, 0xA3, -+0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x78, 0x1E, 0x7C, 0x8D, 0x7D, 0xFE, 0x7B, 0xFF, 0x7A, 0x45, 0x79, -+0x57, 0xFE, 0x7F, 0x06, 0x12, 0x47, 0xD0, 0xE4, 0x78, 0x1C, 0xF2, 0x08, 0xF2, 0x90, 0xA1, 0xF7, -+0xE0, 0x90, 0xA3, 0x76, 0xF0, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, -+0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x71, 0xE0, -+0x90, 0xAC, 0xB9, 0x70, 0x4E, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x90, 0x45, 0x05, 0xE4, -+0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, -+0x77, 0x77, 0x77, 0x90, 0x45, 0x07, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x37, 0x5D, -+0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0x45, 0x13, 0xE4, 0x93, 0xFE, -+0x74, 0x01, 0x93, 0xFF, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x00, 0x80, 0x4C, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0x45, 0x05, 0xE4, 0x93, 0xFE, -+0x74, 0x01, 0x93, 0xFF, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x00, 0x90, 0x45, 0x07, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x37, 0x5D, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x90, 0x45, 0x13, 0xE4, 0x93, 0xFE, 0x74, 0x01, -+0x93, 0xFF, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x90, -+0x45, 0x15, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, -+0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, -+0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x19, 0x79, -+0x19, 0x79, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, -+0xA4, 0x24, 0x1F, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, -+0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x0F, 0x90, -+0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x04, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, -+0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, -+0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, 0x82, 0x12, -+0x27, 0x54, 0x07, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x07, 0x00, 0x00, 0x00, -+0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, -+0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x40, 0x00, 0x00, 0x00, 0x7F, 0xC4, 0x7E, 0x08, 0x12, -+0x57, 0x99, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x0E, 0xA4, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, -+0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, -+0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x04, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, -+0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, -+0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x08, 0x00, 0x02, 0x12, 0x5F, 0xD8, 0x90, 0xA3, 0x79, -+0x12, 0x27, 0x54, 0x00, 0x02, 0x00, 0x00, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x30, 0x12, 0x5F, -+0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x03, 0xFF, 0xFD, 0x90, 0xA3, 0x71, 0xE0, 0xFF, -+0x7D, 0x31, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x0F, 0xE8, 0x3F, 0x90, -+0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x32, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, -+0x09, 0x31, 0xD5, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x65, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, -+0x12, 0x27, 0x54, 0x00, 0x08, 0xA0, 0x01, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x8F, 0x12, 0x5F, -+0xDF, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x80, 0x00, 0x7F, 0x0C, 0x7E, 0x09, 0x12, -+0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x21, 0xF5, 0x82, 0xE4, 0x34, -+0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA3, -+0x82, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x01, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x57, 0x99, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x29, -+0x00, 0x20, 0x00, 0x7F, 0x78, 0x7E, 0x09, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, -+0xA9, 0x00, 0x20, 0x00, 0x7F, 0x7C, 0x7E, 0x09, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0x00, 0x46, 0x29, 0x10, 0x7F, 0x84, 0x7E, 0x09, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x82, 0x12, -+0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, -+0x12, 0x57, 0x95, 0x90, 0xA1, 0xF8, 0xE0, 0x90, 0xA3, 0x71, 0x30, 0xE0, 0x25, 0xE0, 0x75, 0xF0, -+0x1C, 0xA4, 0x24, 0x23, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, -+0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x82, 0x14, 0x03, 0xF7, -+0x80, 0x23, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x23, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, -+0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0x82, 0x14, 0x03, 0xF1, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA1, 0xF7, 0xE0, -+0x30, 0xE5, 0x28, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x25, 0xF5, 0x82, 0xE4, -+0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0xAC, 0xB9, 0x12, 0x27, 0x54, 0x68, 0x16, 0x3E, 0x96, 0x80, 0x2D, 0x90, 0xA1, 0xF7, 0xE0, 0x30, -+0xE4, 0x2D, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x25, 0xF5, 0x82, 0xE4, 0x34, -+0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x54, 0x28, 0x16, 0x3E, 0x96, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, -+0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x37, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, -+0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x54, 0x18, 0x00, 0x8C, 0x10, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, -+0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x39, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, -+0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x38, 0x00, -+0x8C, 0x10, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, -+0xA4, 0x24, 0x27, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, -+0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xD0, -+0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0xE4, 0x78, 0x00, 0xF2, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0xE4, -+0xFD, 0x12, 0xA8, 0xB1, 0x78, 0x1C, 0xEF, 0xF2, 0xFB, 0x78, 0x70, 0x12, 0x49, 0x57, 0x78, 0x00, -+0xE2, 0xFA, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x40, 0xF8, 0x12, 0x49, 0x9C, 0x78, 0x74, 0x12, 0x49, -+0x57, 0xEA, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x4C, 0xF8, 0x12, 0x49, 0x9C, 0xEB, 0x60, 0x06, 0x90, -+0xA3, 0x72, 0xE0, 0x04, 0xF0, 0x78, 0x00, 0xE2, 0x04, 0xF2, 0xE2, 0xC3, 0x94, 0x03, 0x40, 0xBA, -+0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x08, 0x12, 0x5F, -+0x48, 0xE4, 0xFF, 0xEE, 0x54, 0xFC, 0xFE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x90, 0xA3, 0x7E, -+0x12, 0x27, 0x48, 0x90, 0xA3, 0x7A, 0x12, 0x27, 0x54, 0x00, 0x07, 0xFE, 0x00, 0x90, 0xA3, 0x71, -+0xE0, 0xFF, 0x7D, 0x58, 0x7C, 0x00, 0x12, 0x57, 0x15, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, -+0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, -+0x78, 0x1C, 0xE2, 0x70, 0x02, 0x61, 0x98, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, -+0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, -+0x79, 0x12, 0x27, 0x54, 0x00, 0x08, 0x00, 0x00, 0x12, 0x5F, 0xD8, 0x90, 0xA3, 0x79, 0x12, 0x27, -+0x54, 0x00, 0x03, 0x00, 0x00, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x30, 0x12, 0x5F, 0xDF, 0x90, -+0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x03, 0xF7, 0xFF, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x31, -+0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x0F, 0xE7, 0xBF, 0x90, 0xA3, 0x71, -+0xE0, 0xFF, 0x7D, 0x32, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x08, 0x80, -+0x01, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x8F, 0x12, 0x5F, 0xDF, 0x90, 0xA3, 0x79, 0x12, 0x27, -+0x54, 0x00, 0x09, 0x31, 0xD0, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x65, 0x12, 0x5F, 0xDF, 0x90, -+0xA3, 0x79, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0x5F, 0xD8, 0x90, 0xA3, 0x82, 0x12, -+0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, -+0x7F, 0x78, 0x7E, 0x09, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, -+0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x7C, 0x7E, 0x09, 0x12, -+0x57, 0x99, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x00, 0x80, 0x00, 0x7F, 0x0C, 0x7E, 0x09, -+0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x00, 0x46, 0xA8, 0x91, 0x7F, 0x84, 0x7E, -+0x09, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, -+0x86, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x71, 0xE0, 0x75, -+0xF0, 0x1C, 0xA4, 0x24, 0x37, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, -+0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x38, 0x00, 0x8C, -+0x10, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, -+0x24, 0x39, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, -+0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x18, 0x00, 0x8C, 0x10, 0xD0, 0x07, -+0xD0, 0x06, 0x12, 0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x23, 0xF5, -+0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x02, 0x14, 0x01, 0x19, 0xD0, 0x07, 0xD0, 0x06, 0x12, -+0x37, 0x5D, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x70, 0x25, 0xEF, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x25, -+0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x28, 0x16, 0x0D, 0x40, 0x80, 0x26, 0x90, 0xA3, -+0x71, 0xE0, 0x75, 0xF0, 0x1C, 0xA4, 0x24, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0x45, 0xF5, 0x83, 0xE4, -+0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, -+0x28, 0x16, 0x11, 0x80, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x37, 0x5D, 0xE4, 0x78, 0x02, 0xF2, 0x90, -+0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x00, 0x12, 0x57, 0x95, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x03, 0xFF, 0x80, 0x00, -+0x78, 0x02, 0xE2, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x40, 0xF8, 0x12, 0x49, 0x57, 0x78, 0x01, 0x12, -+0x27, 0x22, 0xE4, 0xFF, 0xEE, 0x54, 0x80, 0xFE, 0xEC, 0x54, 0x03, 0xFC, 0x90, 0xA3, 0x86, 0x12, -+0x27, 0x48, 0x7F, 0x78, 0x7E, 0x09, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x07, 0xFF, 0x78, 0x02, 0xE2, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x4C, 0xF8, 0x12, 0x49, 0x57, -+0x78, 0x10, 0x12, 0x27, 0x22, 0xEE, 0x54, 0x07, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, 0xA3, 0x86, 0x12, -+0x27, 0x48, 0x7F, 0x78, 0x7E, 0x09, 0x12, 0x57, 0x99, 0x90, 0xA3, 0x82, 0x12, 0x27, 0x54, 0x80, -+0x00, 0x00, 0x00, 0x90, 0xA3, 0x86, 0x12, 0x27, 0x54, 0x80, 0x00, 0x00, 0x00, 0x12, 0x57, 0x95, -+0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0xA8, 0xB1, 0x78, 0x1D, 0xEF, 0xF2, 0xFB, 0x78, -+0x70, 0x12, 0x49, 0x57, 0x78, 0x02, 0xE2, 0xFA, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x58, 0xF8, 0x12, -+0x49, 0x9C, 0x78, 0x74, 0x12, 0x49, 0x57, 0xEA, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x64, 0xF8, 0x12, -+0x49, 0x9C, 0xEB, 0x60, 0x06, 0x90, 0xA3, 0x73, 0xE0, 0x04, 0xF0, 0x78, 0x02, 0xE2, 0x04, 0xF2, -+0xE2, 0xC3, 0x94, 0x03, 0x50, 0x02, 0x41, 0xBF, 0x90, 0xA3, 0x72, 0xE0, 0x70, 0x1C, 0x90, 0xA3, -+0x78, 0x12, 0x27, 0x54, 0x00, 0x00, 0x02, 0x00, 0x90, 0xA3, 0x7C, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x02, 0xA7, 0x9C, 0xE4, 0x78, 0x02, 0xF2, 0x78, 0x02, -+0xE2, 0xFB, 0x25, 0xE0, 0x25, 0xE0, 0x24, 0x40, 0xF8, 0x12, 0x49, 0x57, 0x78, 0x10, 0x12, 0x27, -+0x22, 0xEB, 0x25, 0xE0, 0x24, 0x24, 0xF8, 0xEE, 0xF2, 0x08, 0xEF, 0xF2, 0x78, 0x02, 0xE2, 0xFB, -+0x25, 0xE0, 0x25, 0xE0, 0x24, 0x4C, 0xF8, 0x12, 0x49, 0x57, 0x78, 0x10, 0x12, 0x27, 0x22, 0xEB, -+0x25, 0xE0, 0x24, 0x2A, 0xF8, 0xEE, 0xF2, 0x08, 0xEF, 0xF2, 0x78, 0x02, 0xE2, 0xFB, 0x25, 0xE0, -+0x25, 0xE0, 0x24, 0x58, 0xF8, 0x12, 0x49, 0x57, 0x78, 0x11, 0x12, 0x27, 0x22, 0xEB, 0x25, 0xE0, -+0x24, 0x30, 0xF8, 0xEE, 0xF2, 0x08, 0xEF, 0xF2, 0x78, 0x02, 0xE2, 0xFB, 0x25, 0xE0, 0x25, 0xE0, -+0x24, 0x64, 0xF8, 0x12, 0x49, 0x57, 0x78, 0x11, 0x12, 0x27, 0x22, 0xEB, 0x25, 0xE0, 0x24, 0x36, -+0xF8, 0xEE, 0xF2, 0x08, 0xEF, 0xF2, 0x78, 0x02, 0xE2, 0x04, 0xF2, 0xE2, 0x64, 0x03, 0x60, 0x02, -+0x61, 0xBE, 0xE4, 0x78, 0x01, 0xF2, 0x90, 0xA3, 0x72, 0xE0, 0xFF, 0x78, 0x01, 0xE2, 0xFE, 0xC3, -+0x9F, 0x40, 0x02, 0xA1, 0x75, 0xEE, 0x04, 0x78, 0x03, 0xF2, 0x90, 0xA3, 0x72, 0xE0, 0xFF, 0x78, -+0x03, 0xE2, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0xA1, 0x66, 0xEE, 0x25, 0xE0, 0x24, 0x24, 0xF8, 0xE2, -+0xFE, 0x08, 0xE2, 0xFF, 0x78, 0x01, 0xE2, 0x25, 0xE0, 0x24, 0x25, 0xF8, 0xC3, 0xE2, 0x9F, 0xFF, -+0x18, 0xE2, 0x9E, 0xFE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x78, 0x14, 0x12, 0x49, 0x9C, 0xE4, 0x7F, -+0x04, 0xFE, 0xFD, 0xFC, 0x78, 0x14, 0x12, 0x49, 0x7F, 0xC3, 0x12, 0x48, 0x96, 0x40, 0x02, 0xA1, -+0x5F, 0x74, 0xFF, 0x7F, 0xFC, 0xFE, 0xFD, 0xFC, 0x78, 0x14, 0x12, 0x49, 0x7F, 0xD3, 0x12, 0x48, -+0x96, 0x50, 0x02, 0xA1, 0x5F, 0x78, 0x03, 0xE2, 0x25, 0xE0, 0x24, 0x2A, 0xF8, 0xE2, 0xFE, 0x08, -+0xE2, 0xFF, 0x78, 0x01, 0xE2, 0x25, 0xE0, 0x24, 0x2B, 0xF8, 0xC3, 0xE2, 0x9F, 0xFF, 0x18, 0xE2, -+0x9E, 0xFE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x78, 0x18, 0x12, 0x49, 0x9C, 0xE4, 0x7F, 0x04, 0xFE, -+0xFD, 0xFC, 0x78, 0x18, 0x12, 0x49, 0x7F, 0xC3, 0x12, 0x48, 0x96, 0x50, 0x72, 0x74, 0xFF, 0x7F, -+0xFC, 0xFE, 0xFD, 0xFC, 0x78, 0x18, 0x12, 0x49, 0x7F, 0xD3, 0x12, 0x48, 0x96, 0x40, 0x60, 0x78, -+0x03, 0xE2, 0xFB, 0x25, 0xE0, 0x24, 0x24, 0xF8, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x78, 0x01, 0xE2, -+0xFA, 0x25, 0xE0, 0x24, 0x25, 0xF8, 0xE2, 0x2F, 0xFF, 0x18, 0xE2, 0x3E, 0xA2, 0xE7, 0x13, 0xFE, -+0xEF, 0x13, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x78, 0x04, 0x12, 0x49, 0x9C, 0xEB, 0x25, -+0xE0, 0x24, 0x2A, 0xF8, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0xEA, 0x25, 0xE0, 0x24, 0x2B, 0xF8, 0xE2, -+0x2F, 0xFF, 0x18, 0xE2, 0x3E, 0xA2, 0xE7, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xEE, 0x33, 0x95, 0xE0, -+0xFD, 0xFC, 0x78, 0x08, 0x12, 0x49, 0x9C, 0x90, 0xA3, 0x74, 0x74, 0x01, 0xF0, 0x80, 0x07, 0x78, -+0x03, 0xE2, 0x04, 0xF2, 0x81, 0x5A, 0x90, 0xA3, 0x74, 0xE0, 0x64, 0x01, 0x60, 0x07, 0x78, 0x01, -+0xE2, 0x04, 0xF2, 0x81, 0x46, 0x90, 0xA3, 0x74, 0xE0, 0xB4, 0x01, 0x18, 0x78, 0x04, 0x12, 0x49, -+0x57, 0x90, 0xA3, 0x78, 0x12, 0x27, 0x48, 0x78, 0x08, 0x12, 0x49, 0x57, 0x90, 0xA3, 0x7C, 0x12, -+0x27, 0x48, 0x80, 0x14, 0x90, 0xA3, 0x78, 0x12, 0x27, 0x54, 0x00, 0x00, 0x02, 0x00, 0x90, 0xA3, -+0x7C, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x12, 0xA7, 0x9C, -+0x90, 0xA3, 0x73, 0xE0, 0x70, 0x16, 0x90, 0xA3, 0x78, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, -+0x90, 0xA3, 0x7C, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xE1, 0x32, 0xE4, 0x78, 0x01, 0xF2, -+0x90, 0xA3, 0x73, 0xE0, 0xFF, 0x78, 0x01, 0xE2, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0xC1, 0xFF, 0xEE, -+0x04, 0x78, 0x03, 0xF2, 0x90, 0xA3, 0x73, 0xE0, 0xFF, 0x78, 0x03, 0xE2, 0xFE, 0xC3, 0x9F, 0x40, -+0x02, 0xC1, 0xF0, 0xEE, 0x25, 0xE0, 0x24, 0x30, 0xF8, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x78, 0x01, -+0xE2, 0x25, 0xE0, 0x24, 0x31, 0xF8, 0xC3, 0xE2, 0x9F, 0xFF, 0x18, 0xE2, 0x9E, 0xFE, 0x33, 0x95, -+0xE0, 0xFD, 0xFC, 0x78, 0x14, 0x12, 0x49, 0x9C, 0xE4, 0x7F, 0x04, 0xFE, 0xFD, 0xFC, 0x78, 0x14, -+0x12, 0x49, 0x7F, 0xC3, 0x12, 0x48, 0x96, 0x40, 0x02, 0xC1, 0xE9, 0x74, 0xFF, 0x7F, 0xFC, 0xFE, -+0xFD, 0xFC, 0x78, 0x14, 0x12, 0x49, 0x7F, 0xD3, 0x12, 0x48, 0x96, 0x50, 0x02, 0xC1, 0xE9, 0x78, -+0x03, 0xE2, 0x25, 0xE0, 0x24, 0x36, 0xF8, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x78, 0x01, 0xE2, 0x25, -+0xE0, 0x24, 0x37, 0xF8, 0xC3, 0xE2, 0x9F, 0xFF, 0x18, 0xE2, 0x9E, 0xFE, 0x33, 0x95, 0xE0, 0xFD, -+0xFC, 0x78, 0x18, 0x12, 0x49, 0x9C, 0xE4, 0x7F, 0x04, 0xFE, 0xFD, 0xFC, 0x78, 0x18, 0x12, 0x49, -+0x7F, 0xC3, 0x12, 0x48, 0x96, 0x50, 0x72, 0x74, 0xFF, 0x7F, 0xFC, 0xFE, 0xFD, 0xFC, 0x78, 0x18, -+0x12, 0x49, 0x7F, 0xD3, 0x12, 0x48, 0x96, 0x40, 0x60, 0x78, 0x03, 0xE2, 0xFB, 0x25, 0xE0, 0x24, -+0x30, 0xF8, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x78, 0x01, 0xE2, 0xFA, 0x25, 0xE0, 0x24, 0x31, 0xF8, -+0xE2, 0x2F, 0xFF, 0x18, 0xE2, 0x3E, 0xA2, 0xE7, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xEE, 0x33, 0x95, -+0xE0, 0xFD, 0xFC, 0x78, 0x0C, 0x12, 0x49, 0x9C, 0xEB, 0x25, 0xE0, 0x24, 0x36, 0xF8, 0xE2, 0xFE, -+0x08, 0xE2, 0xFF, 0xEA, 0x25, 0xE0, 0x24, 0x37, 0xF8, 0xE2, 0x2F, 0xFF, 0x18, 0xE2, 0x3E, 0xA2, -+0xE7, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x78, 0x10, 0x12, 0x49, -+0x9C, 0x90, 0xA3, 0x75, 0x74, 0x01, 0xF0, 0x80, 0x07, 0x78, 0x03, 0xE2, 0x04, 0xF2, 0xA1, 0xE4, -+0x90, 0xA3, 0x75, 0xE0, 0x64, 0x01, 0x60, 0x07, 0x78, 0x01, 0xE2, 0x04, 0xF2, 0xA1, 0xD0, 0x90, -+0xA3, 0x75, 0xE0, 0xB4, 0x01, 0x18, 0x78, 0x0C, 0x12, 0x49, 0x57, 0x90, 0xA3, 0x78, 0x12, 0x27, -+0x48, 0x78, 0x10, 0x12, 0x49, 0x57, 0x90, 0xA3, 0x7C, 0x12, 0x27, 0x48, 0x80, 0x14, 0x90, 0xA3, -+0x78, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, 0x90, 0xA3, 0x7C, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x90, 0xA3, 0x71, 0xE0, 0xFF, 0x02, 0xA6, 0x71, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, -+0xFE, 0x90, 0xA1, 0xCF, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, -+0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA1, 0xD0, 0xF0, 0x22, 0x90, 0xA1, 0xD2, 0xE0, 0x30, 0xE0, -+0x2D, 0x90, 0xA1, 0xD5, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x90, 0xA1, 0xD3, 0xE0, 0xB5, 0x07, 0x1E, -+0x90, 0x06, 0x92, 0xE0, 0x54, 0x1C, 0x70, 0x0B, 0x12, 0x74, 0xDB, 0x90, 0xA1, 0xD6, 0xE0, 0x04, -+0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, 0x74, 0x1C, 0xF0, 0xE4, 0x90, 0xA1, 0xD5, 0xF0, 0x22, 0xE4, -+0x90, 0xA1, 0xB1, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0xB0, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, 0xF0, -+0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x90, 0xA1, 0xB7, -+0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, -+0xF0, 0xE4, 0x90, 0xA1, 0xBA, 0xF0, 0x90, 0xA1, 0xB9, 0x74, 0x07, 0xF0, 0x90, 0xA1, 0xBC, 0xE4, -+0xF0, 0xA3, 0x74, 0x02, 0xF0, 0xE4, 0x90, 0xA1, 0xB5, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xFE, -+0xF0, 0x90, 0xA1, 0xB3, 0x74, 0x0C, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0xA1, -+0xB4, 0x74, 0x0C, 0xF0, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, -+0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0xA1, 0xBE, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x00, 0x90, 0xA0, 0x8B, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0xA1, 0xBB, 0x74, 0xFF, 0xF0, -+0x80, 0x12, 0x90, 0xA0, 0x8B, 0xE0, 0x90, 0xA1, 0xBB, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, -+0x03, 0x74, 0x41, 0xF0, 0x90, 0xA1, 0xC2, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, -+0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, -+0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, -+0xE4, 0xA3, 0xF0, 0x22, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA1, 0xBA, 0xF0, -+0x90, 0xA1, 0xB5, 0xF0, 0x22, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, -+0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x11, 0x75, -+0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x67, 0x90, 0xA1, 0xB5, -+0xE0, 0xFF, 0x54, 0x03, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x56, 0x90, 0xA1, -+0xB3, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x44, -+0xEF, 0x30, 0xE2, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x38, 0x90, 0xA1, 0xB5, 0xE0, -+0x30, 0xE4, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x29, 0x90, 0xA1, 0xAF, 0xE0, 0x13, -+0x13, 0x54, 0x3F, 0x20, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x20, 0xF0, 0x80, 0x16, 0x90, 0xA1, -+0xC8, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x80, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, -+0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0xEF, 0x24, 0xFE, -+0x60, 0x0C, 0x04, 0x70, 0x28, 0x90, 0xA1, 0xB7, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x22, 0xED, 0x70, -+0x0A, 0x90, 0xA1, 0xC5, 0xE0, 0x90, 0xA1, 0xB7, 0xF0, 0x80, 0x05, 0x90, 0xA1, 0xB7, 0xED, 0xF0, -+0x90, 0xA1, 0xB7, 0xE0, 0xA3, 0xF0, 0x90, 0xA1, 0xAF, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0xEF, 0x60, -+0x3E, 0x90, 0xA1, 0x2D, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, 0xA1, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, -+0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE4, 0xFF, 0x12, -+0x74, 0xDD, 0xBF, 0x01, 0x0E, 0x90, 0xA1, 0xAE, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA1, 0xB4, 0x74, -+0x06, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x22, -+0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x05, 0x22, -+0xE4, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0xB1, 0xE0, 0x60, 0x39, 0x90, -+0xA1, 0x2D, 0xE0, 0x64, 0x01, 0x70, 0x31, 0x90, 0xA1, 0xB8, 0xF0, 0x04, 0x60, 0x2A, 0x90, 0xA1, -+0xB5, 0xE0, 0x44, 0x10, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0xB9, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, -+0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA1, -+0xB4, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x62, 0x4F, 0x22, 0x90, 0xA0, 0x8E, 0xE0, 0xFE, 0x90, 0x04, -+0x1C, 0xE0, 0x6E, 0x70, 0x40, 0x90, 0xA1, 0xB4, 0xE0, 0xFE, 0x64, 0x0E, 0x70, 0x1C, 0xEF, 0x70, -+0x34, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE0, -+0x44, 0x80, 0xF0, 0x90, 0xA1, 0xB4, 0x74, 0x04, 0xF0, 0x22, 0xEE, 0xB4, 0x06, 0x17, 0xEF, 0x60, -+0x14, 0x90, 0xA1, 0xAE, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, -+0xA1, 0xB4, 0x74, 0x0C, 0xF0, 0x22, 0xE4, 0xFE, 0xEF, 0x25, 0xE0, 0xFD, 0xEF, 0xC3, 0x94, 0x80, -+0x90, 0xFD, 0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xFD, 0x10, 0xED, -+0xF0, 0xAF, 0x06, 0x22, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, -+0xA1, 0x2A, 0xE0, 0x9B, 0x90, 0xA1, 0x29, 0xE0, 0x9A, 0x50, 0x13, 0xA3, 0xE0, 0x24, 0x01, 0xFF, -+0x90, 0xA1, 0x29, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, -+0xFD, 0x11, 0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, -+0xFF, 0x22, 0xE3, 0xAC, -+}; -+u4Byte ArrayLength_MP_8812A_FW_NIC = 31396; -+ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_NIC( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+) -+{ -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8812A_FW_NIC; -+ *pFirmwareSize = ArrayLength_MP_8812A_FW_NIC; -+} -+ -+u1Byte Array_MP_8812A_FW_NIC_BT[] = { -+0x01, 0x95, 0x10, 0x00, 0x12, 0x00, 0x00, 0x00, 0x04, 0x29, 0x18, 0x19, 0x32, 0x7C, 0x00, 0x00, -+0x7D, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x4B, 0xCC, 0x02, 0x61, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x62, 0x41, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x78, 0x0B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x61, 0xB8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x6F, 0xC0, 0x00, 0x00, -+0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, -+0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, -+0xF0, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x0A, 0x08, 0x03, -+0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, 0x04, 0x08, -+0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, 0x04, 0x00, -+0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, 0x0A, 0x03, -+0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, 0x10, 0x24, -+0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, 0x06, 0x00, -+0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, 0x21, 0x0C, -+0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, 0x20, 0x21, -+0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, 0x10, 0x00, -+0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, 0x28, 0x14, -+0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, 0x30, 0x04, -+0x04, 0x04, 0x05, 0x04, 0x04, 0x05, 0x07, 0x07, 0x07, 0x08, 0x0A, 0x04, 0x07, 0x0A, 0x0E, 0x11, -+0x13, 0x14, 0x15, 0x03, 0x04, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, -+0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x07, 0x08, 0x08, 0x0A, 0x0A, -+0x0C, 0x0E, 0x10, 0x11, 0x11, 0x07, 0x09, 0x09, 0x0B, 0x0B, 0x0D, 0x0F, 0x11, 0x11, 0x12, 0x05, -+0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, -+0x0F, 0x0F, 0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, 0x07, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x05, -+0x06, 0x07, 0x0D, 0x10, 0x11, 0x12, 0x12, 0x07, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, -+0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x05, -+0x06, 0x08, 0x09, 0x0C, 0x0E, 0x12, 0x12, 0x13, 0x14, 0x07, 0x08, 0x0A, 0x0B, 0x0D, 0x10, 0x11, -+0x11, 0x14, 0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x09, 0x09, 0x09, -+0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, 0x25, 0x27, 0x28, 0x00, 0x00, 0x00, 0x00, 0x23, -+0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, -+0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, -+0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x2A, -+0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x04, 0x00, -+0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00, 0x18, 0x00, -+0x00, 0x00, 0x24, 0x00, 0x00, 0x00, 0x30, 0x00, 0x00, 0x00, 0x48, 0x00, 0x00, 0x00, 0x60, 0x00, -+0x00, 0x00, 0x90, 0x00, 0x00, 0x00, 0xC0, 0x00, 0x00, 0x00, 0xD8, 0x00, 0x00, 0x00, 0x3C, 0x00, -+0x00, 0x00, 0x64, 0x00, 0x00, 0x00, 0x78, 0x00, 0x00, 0x00, 0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, -+0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x00, 0xA0, 0x00, -+0x00, 0x00, 0xF0, 0x00, 0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x02, 0x58, 0x00, -+0x00, 0x03, 0x20, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x00, 0xC8, 0x00, -+0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, -+0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, -+0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, -+0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0x3C, 0x00, -+0x00, 0x00, 0x64, 0x00, 0x00, 0x00, 0x78, 0x00, 0x00, 0x00, 0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, -+0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0x58, 0x00, -+0x00, 0x03, 0x20, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, -+0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x0B, 0xB8, 0x00, -+0x00, 0x13, 0x88, 0x00, 0x00, 0x17, 0x70, 0x00, 0x00, 0x1F, 0x40, 0x00, 0x00, 0x00, 0xC8, 0x00, -+0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, -+0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, -+0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, -+0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, -+0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, -+0x04, 0x00, 0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x48, 0x00, -+0x60, 0x00, 0x6C, 0x00, 0x14, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, -+0xC8, 0x00, 0xF0, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x01, 0x2C, 0x01, 0x90, 0x02, -+0x58, 0x03, 0x20, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, -+0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, -+0x20, 0x03, 0xE8, 0x00, 0x1E, 0x00, 0x32, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, -+0xC8, 0x00, 0xF0, 0x01, 0x2C, 0x01, 0x90, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, -+0xF4, 0x03, 0xE8, 0x05, 0xDC, 0x09, 0xC4, 0x0B, 0xB8, 0x0F, 0xA0, 0x00, 0x64, 0x00, 0x8C, 0x00, -+0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x00, -+0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, -+0xE8, 0x03, 0xE8, 0x02, 0x04, 0x06, 0x08, 0x0A, 0x0C, 0x10, 0x18, 0x20, 0x30, 0x40, 0x50, 0x02, -+0x02, 0x02, 0x02, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x02, 0x06, 0x06, 0x07, 0x07, -+0x08, 0x08, 0x08, 0x02, 0x02, 0x03, 0x03, 0x05, 0x05, 0x06, 0x06, 0x05, 0x06, 0x06, 0x07, 0x07, -+0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, -+0x07, 0x08, 0x08, 0x0A, 0x0A, 0x06, 0x06, 0x06, 0x07, 0x07, 0x07, 0x08, 0x08, 0x0A, 0x0B, 0x05, -+0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x0A, 0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x01, -+0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x05, 0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, -+0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x05, -+0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, -+0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, -+0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x47, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4C, 0x68, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x4C, 0x68, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x47, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x47, 0x4C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, 0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x47, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, -+0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, -+0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, 0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, -+0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, -+0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, -+0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, -+0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, 0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, -+0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, 0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, -+0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, -+0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, -+0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, 0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, -+0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, -+0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, 0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, -+0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, -+0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, -+0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x49, 0xF9, 0x73, 0xC5, -+0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, -+0x83, 0xE0, 0x38, 0xF0, 0x22, 0xBB, 0x01, 0x0A, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, -+0xE0, 0x22, 0x50, 0x06, 0x87, 0xF0, 0x09, 0xE7, 0x19, 0x22, 0xBB, 0xFE, 0x07, 0xE3, 0xF5, 0xF0, -+0x09, 0xE3, 0x19, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0x74, 0x01, 0x93, 0x22, -+0xBB, 0x01, 0x10, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0xE0, 0xF5, 0xF0, -+0xA3, 0xE0, 0x22, 0x50, 0x09, 0xE9, 0x25, 0x82, 0xF8, 0x86, 0xF0, 0x08, 0xE6, 0x22, 0xBB, 0xFE, -+0x0A, 0xE9, 0x25, 0x82, 0xF8, 0xE2, 0xF5, 0xF0, 0x08, 0xE2, 0x22, 0xE5, 0x83, 0x2A, 0xF5, 0x83, -+0xE9, 0x93, 0xF5, 0xF0, 0xA3, 0xE9, 0x93, 0x22, 0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, -+0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, -+0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xEB, -+0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, 0xF0, 0x22, -+0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE4, 0x93, 0xFC, 0x74, -+0x01, 0x93, 0xFD, 0x74, 0x02, 0x93, 0xFE, 0x74, 0x03, 0x93, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, -+0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE4, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF9, 0x74, -+0x02, 0x93, 0xFA, 0x74, 0x03, 0x93, 0xFB, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, -+0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, -+0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, -+0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, -+0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x02, 0x4C, 0x0A, 0x02, -+0x47, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, -+0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, -+0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, -+0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4C, 0x4F, 0xE4, 0x7E, 0x01, -+0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, -+0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, -+0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, -+0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x00, -+0x41, 0xA6, 0x2B, 0x00, 0x41, 0xA6, 0x2C, 0x00, 0x41, 0xA6, 0x2D, 0x00, 0x41, 0xA6, 0x2E, 0x00, -+0x41, 0xA6, 0x61, 0x00, 0x41, 0xA6, 0x64, 0x00, 0x4D, 0x75, 0x4F, 0xC8, 0x58, 0x26, 0x90, 0x00, -+0xF0, 0xE0, 0x7F, 0x01, 0x20, 0xE2, 0x02, 0x7F, 0x03, 0x22, 0x91, 0x6E, 0x90, 0xA2, 0x95, 0xEF, -+0xF0, 0x91, 0x8C, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, 0x95, 0xB1, 0x14, 0xB1, 0x44, -+0x91, 0xAE, 0x91, 0xCD, 0x91, 0xEF, 0xE4, 0xF5, 0x51, 0x75, 0x52, 0x58, 0xAB, 0x51, 0x7D, 0x02, -+0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x52, 0x7D, 0x03, 0x7F, 0x01, 0x02, 0x39, 0x04, 0x75, 0x5D, -+0x12, 0xE4, 0xF5, 0x5E, 0x75, 0x5F, 0x07, 0x75, 0x60, 0x72, 0x90, 0x01, 0x30, 0xE5, 0x5D, 0xF0, -+0xA3, 0xE5, 0x5E, 0xF0, 0xA3, 0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, 0x75, 0x65, 0x06, -+0x75, 0x66, 0x01, 0x75, 0x67, 0x03, 0x75, 0x68, 0x62, 0x43, 0x65, 0x01, 0x90, 0x01, 0x38, 0xE5, -+0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, 0x67, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x22, 0xE4, -+0xF5, 0x55, 0xF5, 0x56, 0xF5, 0x57, 0xF5, 0x58, 0xAD, 0x55, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xAD, -+0x56, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xAD, 0x57, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xAD, 0x58, 0x7F, -+0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x30, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, -+0x01, 0x38, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xE4, -+0xFD, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, -+0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x34, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, -+0x90, 0x01, 0x3C, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, 0x3A, 0x96, -+0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0x7D, 0xFF, -+0x7F, 0x57, 0x02, 0x3A, 0x96, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x3A, -+0x96, 0xD1, 0x66, 0x12, 0x3A, 0xB8, 0xD1, 0xE3, 0xD1, 0x52, 0x7F, 0x01, 0x11, 0x15, 0x90, 0xA4, -+0x6D, 0x74, 0x02, 0xF0, 0xFF, 0x11, 0x15, 0x90, 0xA4, 0x6D, 0xE0, 0x04, 0xF0, 0x91, 0x7A, 0xB1, -+0xD2, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, 0x75, 0x28, 0xFF, -+0xD1, 0x4B, 0xF1, 0x66, 0x90, 0x00, 0xF1, 0xE0, 0x54, 0xF0, 0xD3, 0x94, 0x10, 0x40, 0x08, 0x90, -+0xA4, 0xB7, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA4, 0xB7, 0xF0, 0xD1, 0x5C, 0xE4, 0xFF, -+0x01, 0x9E, 0xD1, 0x45, 0xD1, 0x73, 0x12, 0x8B, 0xFE, 0xF1, 0x13, 0x12, 0xB8, 0x30, 0xD1, 0x81, -+0xD1, 0x90, 0xD1, 0xA2, 0x90, 0xA4, 0x55, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xFD, -+0xF0, 0x54, 0xF7, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x36, 0xCE, -+0x90, 0xA4, 0x5C, 0x12, 0x27, 0x48, 0x90, 0xA4, 0x5C, 0x71, 0x50, 0x90, 0xA4, 0x58, 0x12, 0x27, -+0x48, 0xE4, 0x90, 0xA4, 0x62, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x65, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, -+0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xFD, 0x68, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x07, 0x78, 0x74, 0x03, -+0xF0, 0x12, 0xB6, 0xCE, 0x90, 0xA4, 0x3F, 0x74, 0x01, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0xA4, 0x49, -+0xF0, 0xA3, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0xA3, 0x87, 0xF0, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, -+0x85, 0x22, 0xE4, 0x90, 0xA2, 0x92, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, -+0x12, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, -+0xE4, 0xF0, 0x22, 0xE4, 0x90, 0xA3, 0x83, 0xF0, 0xA3, 0xF0, 0x90, 0xA2, 0xEB, 0xF0, 0xA3, 0xF0, -+0x22, 0x90, 0xA4, 0x23, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, -+0x90, 0xA4, 0x6E, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, -+0xF0, 0x22, 0x90, 0xA4, 0x71, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, -+0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xD1, 0xA2, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, -+0x90, 0xA4, 0x71, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x14, 0x90, 0x00, -+0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x72, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA4, -+0x73, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, -+0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, -+0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, -+0x04, 0xF0, 0x22, 0xE4, 0xF5, 0x0D, 0xE4, 0xF5, 0x0E, 0xE5, 0x0E, 0xB4, 0x03, 0x1E, 0xFF, 0xE5, -+0x0D, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2F, -+0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x74, 0x40, 0xF0, 0x80, 0x1B, 0xE5, 0x0D, 0xC4, 0x54, -+0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x0E, 0xF5, 0x82, -+0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x05, 0x0E, 0xE5, 0x0E, 0xB4, 0x10, 0xBB, 0x05, 0x0D, -+0xE5, 0x0D, 0xB4, 0x08, 0xB1, 0x22, 0xE4, 0x90, 0xA5, 0x39, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, -+0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x44, 0xC3, 0x90, 0xA5, -+0x3A, 0xE0, 0x94, 0x88, 0x90, 0xA5, 0x39, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, -+0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x03, 0xF0, 0x80, 0x26, 0x90, 0xA5, 0x39, 0xE4, 0x75, -+0xF0, 0x01, 0x51, 0x9F, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0xA5, 0x3A, 0xE0, -+0x94, 0x32, 0x90, 0xA5, 0x39, 0xE0, 0x94, 0x00, 0x40, 0xB3, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, -+0xAC, 0x90, 0x01, 0xC7, 0x74, 0x05, 0xF0, 0x22, 0xE4, 0x90, 0xA5, 0x3C, 0xF0, 0x90, 0xA5, 0x3C, -+0xE0, 0x64, 0x01, 0xF0, 0x24, 0xC8, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x4F, 0xA3, 0xF0, 0x12, 0x3A, -+0xEB, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x69, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x0F, 0x90, 0xA4, 0x0E, -+0xE0, 0xFF, 0x90, 0xA4, 0x0D, 0xE0, 0x6F, 0x60, 0x03, 0x12, 0x77, 0xBF, 0xC2, 0xAF, 0xF1, 0xA7, -+0xBF, 0x01, 0x02, 0x11, 0x0E, 0xD2, 0xAF, 0x11, 0x18, 0x12, 0x47, 0x4D, 0x80, 0xBF, 0x90, 0xA4, -+0x08, 0xE0, 0x30, 0xE0, 0x02, 0xD1, 0xF8, 0x22, 0x12, 0xAC, 0x9F, 0x12, 0xAB, 0xDE, 0x11, 0x71, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA5, 0xB5, 0xF0, 0x90, 0x01, 0xC7, -+0xE0, 0x64, 0xAD, 0x70, 0x37, 0xF0, 0x90, 0xA5, 0xC2, 0x74, 0x0F, 0xF0, 0x90, 0xA5, 0xB4, 0x74, -+0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0xA5, 0xB5, 0xE0, 0x2F, 0xFE, 0x74, 0xB6, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x0F, 0xE9, 0x90, 0x01, 0x3F, -+0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0xB4, 0x12, 0x59, 0xB1, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x00, 0x8F, 0xE0, 0x20, 0xE6, 0x02, 0xC1, -+0x55, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA6, 0x3B, 0xF0, 0x90, 0x00, 0x8D, 0xE0, 0x90, 0xA6, 0x3C, -+0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0xA6, 0x3D, 0xF0, 0x90, 0xA6, 0x3C, 0xE0, 0x12, 0x4B, 0xA6, -+0x50, 0xC5, 0x01, 0x50, 0xCF, 0x02, 0x50, 0xD8, 0x03, 0x50, 0xE2, 0x04, 0x51, 0xFE, 0x05, 0x52, -+0xF7, 0x06, 0x53, 0x7C, 0x08, 0x54, 0x38, 0x09, 0x54, 0xC0, 0x0A, 0x55, 0x48, 0x0B, 0x55, 0xBB, -+0x0C, 0x00, 0x00, 0x56, 0x47, 0x90, 0xA6, 0x3B, 0xE0, 0xFF, 0x12, 0xAC, 0x3E, 0xC1, 0x47, 0x90, -+0xA6, 0x3B, 0xE0, 0xFF, 0xD1, 0x88, 0xC1, 0x47, 0x90, 0xA6, 0x3B, 0xE0, 0xFF, 0x12, 0xAC, 0xD1, -+0xC1, 0x47, 0x90, 0xA6, 0x3B, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, -+0xFB, 0xE4, 0xFD, 0xFF, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, -+0x12, 0x4B, 0x88, 0xE0, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0xD1, 0x60, 0x90, 0xA6, -+0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x13, 0x13, -+0x54, 0x01, 0xFB, 0x0D, 0xE4, 0xFF, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, -+0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0xD1, 0x60, 0x90, -+0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x92, 0x12, 0x4B, 0x88, 0xE0, 0xFB, 0xE4, 0xFD, -+0x0F, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x93, 0xD1, 0x5A, 0x90, -+0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x54, -+0x01, 0xFB, 0x0D, 0x7F, 0x01, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, -+0x94, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0x1F, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, -+0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x4B, 0x88, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, -+0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x01, 0xD1, 0x5A, 0x90, 0xA6, 0x3B, 0xE0, 0x75, -+0xF0, 0x08, 0x90, 0x89, 0x02, 0xD1, 0x5A, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, -+0x03, 0xD1, 0x5A, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x04, 0x12, 0x4B, 0x88, -+0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, -+0x05, 0xD1, 0x5A, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x06, 0xD1, 0x5A, 0x90, -+0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x07, 0x12, 0x4B, 0x88, 0x81, 0xBB, 0x90, 0xA6, -+0x3B, 0xE0, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xA3, 0xE0, 0xFB, -+0xE4, 0xFD, 0xFF, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, -+0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x0A, -+0x90, 0x8D, 0x01, 0x12, 0x4B, 0x88, 0xA3, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, -+0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0xD1, 0x5A, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x0A, 0x90, -+0x8D, 0x03, 0x12, 0x4B, 0x88, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA6, 0x3B, -+0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x05, 0x12, 0x4B, 0x88, 0xA3, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, -+0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x07, 0x12, 0x4B, 0x88, 0xA3, 0xE0, 0xFB, -+0x0D, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x09, 0x12, 0x4B, 0x88, -+0xA3, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, -+0x99, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0xE4, 0xFB, 0xD1, 0x60, 0x90, 0xA6, -+0x3B, 0xE0, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xA3, 0xE0, 0xFB, -+0x7D, 0x02, 0xD1, 0x60, 0x90, 0xA6, 0x3B, 0xE0, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, -+0x95, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x77, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, -+0xD1, 0x60, 0x90, 0xA4, 0x78, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x79, 0xE0, 0xFB, 0x0D, -+0xD1, 0x60, 0x90, 0xA4, 0x7A, 0x81, 0xBB, 0x90, 0xA4, 0x7F, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0xD1, -+0x60, 0x90, 0xA4, 0x80, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x81, 0xE0, 0xFB, 0x0D, 0xD1, -+0x60, 0x90, 0xA4, 0x82, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, -+0x0F, 0xD1, 0x60, 0x90, 0xA4, 0x84, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x85, 0xE0, 0xFB, -+0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x86, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x87, 0xE0, 0xFB, -+0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0x88, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x89, -+0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x8A, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x8B, -+0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0x8C, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, -+0xA4, 0x8D, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x8E, 0x81, 0xBB, 0x90, 0xA4, 0x0B, 0xE0, -+0xFB, 0xE4, 0xFD, 0xFF, 0xD1, 0x60, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, 0xFB, 0x0D, 0xD1, 0x60, -+0x90, 0xA4, 0x0D, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x0E, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, -+0x90, 0xA6, 0x3B, 0xE0, 0x24, 0x87, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, -+0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0x01, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, -+0x08, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0xD1, 0x60, 0x90, 0xA4, 0x08, -+0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0xD1, 0x60, 0x90, 0xA2, 0x93, -+0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA2, 0x94, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, -+0xA4, 0x12, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x11, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, -+0xA4, 0x0A, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, 0xE4, 0xFD, 0x7F, 0x03, 0xD1, 0x60, 0x90, 0xA4, 0x09, -+0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0xD1, 0x60, 0x90, 0xA4, 0x09, 0xE0, 0x13, -+0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0xD1, 0x60, 0x90, 0xA4, 0x08, 0xE0, 0x13, 0x13, -+0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0xC1, 0x45, 0x90, 0xA4, 0x97, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, -+0xD1, 0x60, 0x90, 0xA4, 0x98, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x99, 0xE0, 0xFB, 0x0D, -+0xD1, 0x60, 0x90, 0xA4, 0x9A, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x9B, 0xE0, 0xFB, 0xE4, -+0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0x9C, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x9D, 0xE0, -+0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x9E, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x9F, 0xE0, -+0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0xA0, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, -+0xA1, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xA2, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, -+0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0xA4, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, -+0x90, 0xA4, 0xA5, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xA6, 0xE0, 0xFB, 0x0D, 0xC1, 0x45, -+0x90, 0xA4, 0xA7, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0xD1, 0x60, 0x90, 0xA4, 0xA8, 0xE0, 0xFB, 0x0D, -+0xD1, 0x60, 0x90, 0xA4, 0xA9, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xAA, 0xE0, 0xFB, 0x0D, -+0xD1, 0x60, 0x90, 0xA4, 0xAB, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0xAC, 0xE0, -+0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xAD, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xAE, 0xE0, -+0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xAF, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, -+0xB0, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xB1, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, -+0xB2, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xB3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, -+0x90, 0xA4, 0xB4, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0xB5, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, -+0x90, 0xA4, 0xB6, 0xE0, 0xFB, 0x0D, 0xC1, 0x45, 0x90, 0xA4, 0x55, 0xE0, 0xC3, 0x13, 0x54, 0x01, -+0xFB, 0xE4, 0xFD, 0xFF, 0xD1, 0x60, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x78, 0x18, 0x12, -+0x27, 0x22, 0x90, 0xA6, 0x3E, 0xEF, 0xF0, 0xE0, 0xC3, 0x13, 0xF0, 0x54, 0x1F, 0xF0, 0xFB, 0x7D, -+0x01, 0xE4, 0xFF, 0xD1, 0x60, 0x90, 0xA4, 0x5C, 0x12, 0x4B, 0x50, 0x78, 0x18, 0x12, 0x27, 0x22, -+0x90, 0xA6, 0x3E, 0xEF, 0xF0, 0xE0, 0xC3, 0x13, 0xF0, 0x54, 0x1F, 0xF0, 0xFB, 0x7D, 0x02, 0xE4, -+0xFF, 0xD1, 0x60, 0x90, 0xA4, 0x58, 0x12, 0x4B, 0x50, 0x78, 0x18, 0x12, 0x27, 0x22, 0x90, 0xA6, -+0x3E, 0xEF, 0xF0, 0xE0, 0xC3, 0x13, 0xF0, 0x54, 0x1F, 0xF0, 0xFB, 0x7D, 0x03, 0xE4, 0xFF, 0xD1, -+0x60, 0x90, 0xA4, 0x64, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xC1, 0x45, 0x90, 0xA4, 0x2D, 0xE0, 0xC4, -+0x13, 0x54, 0x01, 0xFB, 0xE4, 0xFD, 0xFF, 0xD1, 0x60, 0x90, 0xA4, 0x38, 0xE0, 0xFB, 0x0D, 0xD1, -+0x60, 0x90, 0xA4, 0x39, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x2F, 0xE0, 0xFB, 0x0D, 0xD1, -+0x60, 0x90, 0xA4, 0x3C, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0x07, 0x78, 0xE0, 0xFB, -+0x0D, 0xD1, 0x60, 0x90, 0x05, 0x22, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, -+0x36, 0xCE, 0x78, 0x18, 0x12, 0x27, 0x22, 0x90, 0xA6, 0x3E, 0xEF, 0xF0, 0xFB, 0x7D, 0x03, 0x7F, -+0x01, 0xD1, 0x60, 0x90, 0xA4, 0x30, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, 0xA4, 0x31, -+0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x32, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x33, -+0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0xA4, 0x34, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x60, 0x90, -+0xA4, 0x0D, 0xE0, 0xFB, 0x0D, 0xD1, 0x60, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, -+0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x4B, 0x88, 0xE0, 0xFB, 0x0D, -+0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, -+0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0x90, 0xA6, 0x58, 0xEF, 0xF0, 0x90, 0x00, 0x8F, -+0xE0, 0x30, 0xE6, 0x63, 0x90, 0x00, 0x8D, 0xE0, 0x64, 0x02, 0x70, 0x5B, 0x90, 0xA6, 0x59, 0xF0, -+0x90, 0xA6, 0x59, 0xE0, 0xFD, 0x90, 0xA6, 0x58, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, -+0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, -+0xE0, 0xFB, 0xE4, 0xFF, 0xD1, 0x60, 0x90, 0xA6, 0x59, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x08, -+0x40, 0xCE, 0x90, 0xA6, 0x59, 0xE0, 0xFD, 0xC3, 0x94, 0x10, 0x50, 0x0D, 0xE4, 0xFB, 0xFF, 0xD1, -+0x60, 0x90, 0xA6, 0x59, 0xE0, 0x04, 0xF0, 0x80, 0xE9, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, -+0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0x90, 0xA4, 0x0E, 0xE0, 0xFF, 0x60, 0x03, 0xB4, -+0x08, 0x0E, 0x12, 0xB9, 0xC2, 0xBF, 0x01, 0x08, 0xF1, 0x11, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0x47, 0xF1, 0x21, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xF1, 0x9F, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0xE4, -+0xFF, 0xF1, 0xCE, 0x90, 0xA2, 0x95, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x54, 0x7F, -+0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x22, 0x90, 0xA2, 0x95, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, -+0x70, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0xA4, 0x15, 0xE0, 0xFD, 0x7F, -+0x93, 0x12, 0x3A, 0x96, 0x90, 0xA4, 0x0C, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, -+0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, -+0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0x7F, 0x01, 0xF1, 0xCE, 0x90, 0x00, 0x90, 0xE0, -+0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x3A, 0x96, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0x90, -+0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x22, 0x7F, 0x02, 0x90, 0xA4, 0x6D, 0xE0, 0xFE, 0xEF, 0xC3, -+0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, -+0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0x8F, 0x71, -+0xE4, 0x90, 0xA6, 0x54, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, -+0x7F, 0x01, 0xEF, 0x65, 0x71, 0x60, 0x3E, 0xC3, 0x90, 0xA6, 0x55, 0xE0, 0x94, 0x88, 0x90, 0xA6, -+0x54, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA6, -+0x54, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x4A, 0x9F, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, -+0x90, 0xA6, 0x55, 0xE0, 0x94, 0x32, 0x90, 0xA6, 0x54, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, -+0xC6, 0xE0, 0x30, 0xE0, 0xB2, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x49, 0x4E, 0x90, -+0xA5, 0x40, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0xA2, 0x92, 0xE0, 0x60, 0xEA, 0xC2, 0xAF, 0x30, 0xE0, -+0x11, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x66, 0x74, 0x12, 0x9A, 0x61, 0x90, 0xA4, 0x8D, 0xE0, -+0x04, 0xF0, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0xA2, 0x92, 0xE0, 0xFF, 0x30, 0xE1, 0x0B, 0x54, 0xFD, -+0xF0, 0x90, 0xA4, 0x8F, 0xE0, 0x04, 0xF0, 0x11, 0x7E, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0xA2, 0x92, -+0xE0, 0xFF, 0x30, 0xE2, 0x05, 0x54, 0xFB, 0xF0, 0x11, 0xE0, 0xD2, 0xAF, 0x80, 0xB8, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0xEC, 0xE0, 0xFF, 0x90, 0xA2, 0xEB, 0xE0, 0xB5, 0x07, -+0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x41, 0x90, 0xA2, 0xEB, 0xE0, 0xFE, 0x75, -+0xF0, 0x08, 0x90, 0xA2, 0x9B, 0x12, 0x4B, 0x88, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, -+0x9C, 0xF9, 0x74, 0xA2, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x51, 0x7C, 0x90, 0xA2, 0xEB, -+0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, -+0xA2, 0xEB, 0xF0, 0x12, 0x80, 0x45, 0x7F, 0x02, 0x12, 0x63, 0x18, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA3, 0x84, 0xE0, 0xFE, 0x90, 0xA3, -+0x83, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, -+0x48, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x13, 0xED, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xED, 0xF9, 0x74, -+0xA2, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x31, 0x4E, 0x7F, 0x01, 0x90, 0xA3, 0x83, 0xE0, 0x75, 0xF0, -+0x0F, 0xA4, 0x24, 0xED, 0xF9, 0x74, 0xA2, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x31, 0xB1, 0x7F, 0x01, -+0xEF, 0x60, 0x16, 0x90, 0xA3, 0x83, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, 0x02, 0x7F, -+0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA3, 0x83, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x9D, 0x90, 0xA6, 0x2E, 0xE0, 0xFF, -+0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, 0x7F, 0xAF, 0x7E, 0x01, 0x51, 0x26, 0xEF, -+0x60, 0x3A, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x90, 0x00, -+0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x34, -+0x2C, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x90, 0x01, 0xAE, -+0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x37, 0x12, 0x4B, 0x9D, 0x7F, 0x96, -+0x7E, 0x02, 0x51, 0x26, 0xEF, 0x60, 0x5A, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, -+0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, -+0xA6, 0x3A, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0xA6, 0x3A, 0xE0, 0xFD, 0x90, -+0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA6, 0x37, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x0E, 0x12, -+0x26, 0x37, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0x12, 0x81, 0xFA, 0x90, 0xA6, 0x3A, 0xE0, 0x24, -+0x18, 0xFF, 0x90, 0xA6, 0x37, 0x12, 0x4B, 0x94, 0x12, 0x82, 0x55, 0x90, 0x02, 0x96, 0x74, 0x01, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x2F, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xA6, 0x2F, 0xE0, 0xFE, 0xA3, -+0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x2D, 0xC3, 0x90, 0xA6, 0x32, 0xE0, 0x94, 0xE8, 0x90, -+0xA6, 0x31, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, -+0x80, 0x15, 0x90, 0xA6, 0x31, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x4A, 0x9F, 0x7F, 0x0A, 0x7E, 0x00, -+0x12, 0x3A, 0xF7, 0x80, 0xC5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA5, 0x41, 0x12, -+0x4B, 0x9D, 0xEF, 0x12, 0x4B, 0xA6, 0x5A, 0xBD, 0x00, 0x5A, 0xC6, 0x01, 0x5A, 0xCF, 0x02, 0x5A, -+0xD8, 0x03, 0x5A, 0xE1, 0x04, 0x5A, 0xEA, 0x20, 0x5A, 0xF3, 0x21, 0x5A, 0xFC, 0x23, 0x5B, 0x04, -+0x25, 0x5B, 0x0D, 0x27, 0x5B, 0x15, 0x40, 0x5B, 0x24, 0x42, 0x5B, 0x2D, 0x43, 0x5B, 0x36, 0x60, -+0x5B, 0x3F, 0x64, 0x5B, 0x48, 0x65, 0x5B, 0x50, 0x87, 0x00, 0x00, 0x5B, 0x59, 0x90, 0xA5, 0x41, -+0x12, 0x4B, 0x94, 0x02, 0x78, 0x3C, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x78, 0x84, 0x90, -+0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x79, 0x5A, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0xB8, -+0x10, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x4E, 0xB7, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, -+0x02, 0x79, 0x92, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x7B, 0x21, 0x90, 0xA5, 0x41, 0x12, -+0x4B, 0x94, 0xE1, 0xDC, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x7B, 0x67, 0x90, 0xA5, 0x41, -+0x12, 0x4B, 0x94, 0x80, 0x4C, 0x90, 0xA4, 0x90, 0xE0, 0x04, 0xF0, 0x90, 0xA5, 0x41, 0x12, 0x4B, -+0x94, 0x02, 0xA8, 0xAB, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0xAA, 0x35, 0x90, 0xA5, 0x41, -+0x12, 0x4B, 0x94, 0x02, 0xAA, 0xD6, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x7B, 0xB0, 0x90, -+0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x7F, 0xDC, 0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0xE1, 0xE4, -+0x90, 0xA5, 0x41, 0x12, 0x4B, 0x94, 0x02, 0x6C, 0xCB, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, -+0x22, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFF, 0x90, 0xA4, 0x23, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x90, -+0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x24, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, -+0xA4, 0x25, 0xF0, 0x90, 0xA4, 0x24, 0xE0, 0x90, 0xA4, 0x26, 0xF0, 0x90, 0xA4, 0x23, 0xE0, 0x54, -+0x01, 0xFF, 0xAC, 0x07, 0xEF, 0x54, 0x01, 0xFE, 0x90, 0xA4, 0x23, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, -+0xEF, 0x90, 0x01, 0x53, 0xB4, 0x01, 0x12, 0xE4, 0xF0, 0x7D, 0x10, 0x7F, 0x03, 0x12, 0x7E, 0xF9, -+0x90, 0xA4, 0x25, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x74, 0x03, 0xF0, 0x7D, 0x10, 0xFF, 0xF1, -+0xC4, 0x12, 0x8A, 0xAC, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x0C, 0xF0, 0x22, -+0x90, 0xA4, 0x23, 0xE0, 0x30, 0xE0, 0x2D, 0x90, 0xA4, 0x25, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x90, -+0xA4, 0x26, 0xE0, 0x60, 0x04, 0x14, 0xF0, 0x81, 0x7B, 0x90, 0xA4, 0x24, 0xE0, 0x14, 0x90, 0xA4, -+0x26, 0xF0, 0x90, 0x05, 0x73, 0x74, 0x01, 0xF0, 0xE4, 0xFF, 0x71, 0x92, 0x91, 0x05, 0x7D, 0x01, -+0x7F, 0x02, 0x91, 0x09, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, -+0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0xF1, 0x7F, -+0x90, 0xA4, 0x11, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x91, 0x05, 0x12, 0x63, 0xBA, 0x12, 0x86, -+0xFF, 0x80, 0x9D, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, -+0x91, 0x09, 0x7D, 0x02, 0x7F, 0x03, 0x91, 0x09, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0xF0, 0x90, -+0xA4, 0x16, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0xA3, 0x87, 0xE0, 0xB4, 0x01, 0x14, 0x90, -+0xA4, 0x09, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA4, 0x0E, 0xE0, 0x20, 0xE2, 0x0D, 0x7D, 0x01, 0x7F, -+0x04, 0x80, 0x1F, 0x90, 0xA4, 0x09, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, -+0xF0, 0x12, 0x88, 0xCA, 0x90, 0xA4, 0x0E, 0x74, 0x08, 0xF0, 0x22, 0x90, 0xA4, 0x0D, 0xE0, 0xFF, -+0xE4, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x63, 0xED, 0xF0, 0x90, 0xA4, -+0x08, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xA1, 0xDC, 0xEE, 0xC4, 0x13, -+0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x02, 0xA1, 0xDC, 0x90, 0xA4, 0x0E, 0xE0, 0xFE, 0x6F, 0x70, -+0x02, 0xA1, 0xDC, 0xEF, 0x70, 0x02, 0xA1, 0x53, 0x24, 0xFE, 0x70, 0x02, 0xA1, 0x8C, 0x24, 0xFE, -+0x60, 0x49, 0x24, 0xFC, 0x70, 0x02, 0xA1, 0xC7, 0x24, 0xFC, 0x60, 0x02, 0xA1, 0xDC, 0xEE, 0xB4, -+0x0E, 0x02, 0xD1, 0x67, 0x90, 0xA4, 0x0E, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xD1, 0x8F, 0x90, 0xA4, -+0x0E, 0xE0, 0xB4, 0x06, 0x02, 0xD1, 0x41, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x04, 0x0F, 0x90, 0xA6, -+0x63, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x87, 0x71, 0x80, 0x03, 0x12, 0x79, 0x47, 0x90, 0xA4, 0x0E, -+0xE0, 0x64, 0x08, 0x60, 0x02, 0xA1, 0xDC, 0x71, 0xC1, 0xA1, 0xDC, 0x90, 0xA4, 0x0E, 0xE0, 0x70, -+0x04, 0x7F, 0x01, 0xD1, 0x8F, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x06, 0x02, 0xD1, 0x41, 0x90, 0xA4, -+0x0E, 0xE0, 0xB4, 0x0E, 0x07, 0xB1, 0xE1, 0xBF, 0x01, 0x02, 0xD1, 0x67, 0x90, 0xA4, 0x0E, 0xE0, -+0x64, 0x0C, 0x60, 0x02, 0xA1, 0xDC, 0xB1, 0xE1, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xA1, 0xDC, 0xD1, -+0xA9, 0xA1, 0xDC, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x0E, 0x07, 0xB1, 0xE1, 0xBF, 0x01, 0x02, 0xD1, -+0x67, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x06, 0x02, 0xD1, 0x41, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x0C, -+0x07, 0xB1, 0xE1, 0xBF, 0x01, 0x02, 0xD1, 0xA9, 0x90, 0xA4, 0x0E, 0xE0, 0x64, 0x04, 0x70, 0x5C, -+0x12, 0xB9, 0x1B, 0xEF, 0x64, 0x01, 0x70, 0x54, 0xD1, 0xE0, 0x80, 0x50, 0x90, 0xA4, 0x0E, 0xE0, -+0xB4, 0x0E, 0x07, 0xB1, 0xE1, 0xBF, 0x01, 0x02, 0xD1, 0x67, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x06, -+0x02, 0xD1, 0x41, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x0C, 0x07, 0xB1, 0xE1, 0xBF, 0x01, 0x02, 0xD1, -+0xA9, 0x90, 0xA4, 0x0E, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xD1, 0x8F, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, -+0x04, 0x1A, 0x12, 0xB9, 0xF6, 0x80, 0x15, 0x90, 0xA4, 0x0E, 0xE0, 0xB4, 0x0C, 0x0E, 0x90, 0xA4, -+0x09, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0x91, 0x7B, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0xA4, 0x27, 0xE0, 0x30, 0xE0, 0x13, 0x90, 0xA4, 0x2D, 0xE0, 0xC4, 0x13, 0x54, 0x07, -+0x30, 0xE0, 0x18, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x3D, 0x12, 0xB9, 0x02, 0xEF, 0x64, -+0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2D, 0x90, 0xA4, 0x08, 0xE0, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x19, 0x90, -+0xA4, 0x0D, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, -+0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, -+0x22, 0x90, 0xA4, 0x09, 0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, -+0xA4, 0x0E, 0x74, 0x04, 0xF0, 0x80, 0x0A, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x0C, -+0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0xA4, 0x09, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, -+0x90, 0xA4, 0x0E, 0x74, 0x0C, 0xF0, 0x80, 0x11, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, -+0x44, 0x80, 0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, -+0xA6, 0x62, 0xEF, 0xF0, 0x12, 0x8A, 0xAC, 0x90, 0xA6, 0x62, 0xE0, 0x60, 0x05, 0x90, 0x05, 0x22, -+0xE4, 0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x04, 0xF0, 0x22, 0x90, 0xA3, 0x87, 0xE0, 0x64, 0x01, 0x70, -+0x2E, 0x90, 0xA4, 0x09, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x7F, 0x01, -+0x12, 0x84, 0xEB, 0xBF, 0x01, 0x0E, 0x90, 0xA4, 0x08, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA4, 0x0E, -+0x74, 0x0E, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x22, -+0x12, 0x8A, 0x07, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, 0x03, 0x91, 0x09, 0x12, 0x88, -+0xCA, 0xE4, 0x90, 0xA4, 0x0E, 0xF0, 0x22, 0x90, 0xA4, 0x27, 0xE0, 0x20, 0xE0, 0x27, 0x90, 0xA4, -+0x0B, 0xE0, 0x64, 0x01, 0x70, 0x1F, 0xF1, 0xEC, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, 0x60, 0x09, -+0xE4, 0xFD, 0x7F, 0x0C, 0x91, 0x92, 0x02, 0x77, 0xC9, 0x90, 0xA4, 0x0E, 0xE0, 0x70, 0x06, 0x7D, -+0x01, 0x7F, 0x04, 0x91, 0x92, 0x22, 0xEF, 0x70, 0x32, 0x7D, 0x78, 0x7F, 0x02, 0xF1, 0x67, 0x7D, -+0x02, 0x7F, 0x03, 0xF1, 0x67, 0x7D, 0xC8, 0x7F, 0x02, 0xF1, 0xC4, 0x90, 0x01, 0x57, 0xE4, 0xF0, -+0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x7D, 0x01, 0x7F, 0x0C, 0x91, 0x92, 0x90, 0xA4, 0x08, 0xE0, -+0x54, 0xF7, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x81, 0x33, 0x7D, 0x02, 0x7F, -+0x02, 0xF1, 0x67, 0x7D, 0x01, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, -+0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, -+0xA4, 0x0B, 0xE0, 0x60, 0x3E, 0x90, 0xA3, 0x87, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, 0xA4, 0x12, -+0xF0, 0x04, 0x60, 0x2F, 0x90, 0xA4, 0x0F, 0xE0, 0x44, 0x10, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, -+0x13, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, -+0x57, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x0E, 0xE0, 0x20, 0xE2, 0x06, 0x7D, 0x01, 0x7F, 0x04, 0x91, -+0x92, 0xF1, 0xEC, 0x22, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, -+0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, -+0xA4, 0x15, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0xA4, 0x64, 0xF0, 0x22, 0x90, 0xA4, 0x21, 0xE0, -+0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x2F, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x26, 0x90, -+0xA4, 0x2A, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x07, 0x90, 0x07, 0x78, 0x74, 0x03, 0xF0, 0x22, -+0x90, 0xA4, 0x21, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x04, 0x74, 0x0D, -+0xF0, 0x22, 0x74, 0x09, 0xF0, 0x22, 0x90, 0xA5, 0xEF, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xFB, 0xA3, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xE4, 0x90, 0xA5, 0xF9, 0xF0, 0xEB, 0x90, 0xA5, 0xF0, -+0xF0, 0x90, 0xA4, 0xB7, 0xE0, 0x70, 0x3D, 0x90, 0xA5, 0xEF, 0xE0, 0x70, 0x17, 0xFF, 0x7E, 0x0C, -+0x12, 0x36, 0xCE, 0xEF, 0x44, 0x04, 0xFF, 0xEC, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, -+0x7E, 0x0C, 0x80, 0x1D, 0x90, 0xA5, 0xEF, 0xE0, 0xB4, 0x01, 0x19, 0x7F, 0x00, 0x7E, 0x0E, 0x12, -+0x36, 0xCE, 0xEF, 0x44, 0x04, 0xFF, 0xEC, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, -+0x0E, 0x12, 0x37, 0x5D, 0x90, 0xA5, 0xF0, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA5, 0xF5, -+0x12, 0x27, 0x48, 0x90, 0xA5, 0xF5, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, -+0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0xA4, 0xB7, 0xE0, 0x70, 0x26, 0x90, 0xA5, 0xF5, 0x12, -+0x4B, 0x50, 0xEE, 0x44, 0x01, 0xFE, 0xEC, 0x90, 0xA5, 0xF5, 0x12, 0x27, 0x48, 0x90, 0xA5, 0xF5, -+0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, -+0x80, 0x07, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA5, 0xEF, 0xE0, 0x75, 0xF0, 0x08, -+0xA4, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, -+0x36, 0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x90, 0xA5, 0xF1, 0x12, 0x27, 0x48, 0x90, 0xA5, -+0xF1, 0x02, 0x4B, 0x50, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0x26, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0xA6, 0x1D, -+0x12, 0x4B, 0x50, 0x90, 0xAC, 0x9C, 0x12, 0x27, 0x48, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0x32, 0x65, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -+0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x35, 0xF0, 0x74, 0x61, 0xA3, 0xF0, 0x31, 0x84, 0x74, 0x35, -+0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x61, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, -+0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, -+0xF0, 0xD0, 0xE0, 0x32, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, -+0x33, 0xE5, 0x51, 0x52, 0x53, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x12, -+0x39, 0x33, 0xE5, 0x52, 0x52, 0x54, 0xAB, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, -+0x54, 0x7D, 0x01, 0x7F, 0x01, 0x02, 0x39, 0x04, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, -+0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xB8, 0xF0, 0x74, 0x61, 0xA3, 0xF0, 0x51, -+0x07, 0x74, 0xB8, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x61, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, -+0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, -+0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x00, 0x54, 0xE0, 0x55, 0x55, 0xF5, 0x59, 0xA3, -+0xE0, 0x55, 0x56, 0xF5, 0x5A, 0xA3, 0xE0, 0x55, 0x57, 0xF5, 0x5B, 0xA3, 0xE0, 0x55, 0x58, 0xF5, -+0x5C, 0xAD, 0x59, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0xAD, 0x5A, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0xAD, -+0x5B, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0xAD, 0x5C, 0x7F, 0x57, 0x12, 0x3A, 0x96, 0x53, 0x91, 0xEF, -+0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, -+0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, -+0xC4, 0x74, 0x41, 0xF0, 0x74, 0x62, 0xA3, 0xF0, 0x12, 0x82, 0xCE, 0xE5, 0x61, 0x30, 0xE1, 0x02, -+0x71, 0x33, 0xE5, 0x61, 0x30, 0xE4, 0x02, 0x91, 0xC1, 0xE5, 0x63, 0x30, 0xE0, 0x02, 0x71, 0xB7, -+0xE5, 0x63, 0x30, 0xE1, 0x02, 0x91, 0xD5, 0xE5, 0x63, 0x30, 0xE2, 0x03, 0x12, 0x7F, 0x0E, 0xE5, -+0x63, 0x30, 0xE3, 0x03, 0x12, 0x83, 0x2B, 0xE5, 0x63, 0x30, 0xE4, 0x03, 0x12, 0x83, 0x5E, 0xE5, -+0x63, 0x30, 0xE5, 0x03, 0x12, 0x76, 0xE8, 0xE5, 0x63, 0x30, 0xE6, 0x03, 0x12, 0x83, 0x8D, 0xE5, -+0x64, 0x30, 0xE1, 0x03, 0x12, 0x83, 0xA9, 0xE5, 0x64, 0x30, 0xE4, 0x02, 0xD1, 0x6C, 0xE5, 0x64, -+0x30, 0xE5, 0x02, 0xB1, 0x48, 0xE5, 0x64, 0x30, 0xE6, 0x02, 0x51, 0xF2, 0x74, 0x41, 0x04, 0x90, -+0x01, 0xC4, 0xF0, 0x74, 0x62, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, -+0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, -+0xE0, 0x32, 0x90, 0x07, 0x1F, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, -+0xA5, 0x60, 0xF0, 0x90, 0xA5, 0x5E, 0x74, 0x02, 0xF0, 0x90, 0xA5, 0x6C, 0x14, 0xF0, 0xFB, 0x7A, -+0xA5, 0x79, 0x5E, 0x12, 0x6C, 0x61, 0x7F, 0x04, 0x90, 0xA6, 0x5E, 0xEF, 0xF0, 0x7F, 0x02, 0x12, -+0x49, 0x27, 0x90, 0xA2, 0x92, 0xE0, 0xFF, 0x90, 0xA6, 0x5E, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0xA2, -+0x92, 0xF0, 0x22, 0xE4, 0xFF, 0x90, 0xA5, 0x5E, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x1C, -+0xA3, 0xE0, 0xF5, 0x1D, 0x65, 0x1C, 0x60, 0x6E, 0x90, 0xA5, 0x5F, 0x74, 0x03, 0xF0, 0x90, 0xA5, -+0x6D, 0x74, 0x08, 0xF0, 0xE5, 0x1D, 0x04, 0x54, 0x0F, 0xF5, 0x1E, 0xE4, 0xF5, 0x1B, 0xE5, 0x1E, -+0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, -+0x1B, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x61, 0x25, 0x1B, 0xF5, 0x82, -+0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x1B, 0xE5, 0x1B, 0xB4, 0x08, 0xD0, 0x7B, 0x01, -+0x7A, 0xA5, 0x79, 0x5F, 0x12, 0x6C, 0x61, 0xE5, 0x1D, 0x04, 0x54, 0x0F, 0xF5, 0x1D, 0xB4, 0x0F, -+0x03, 0xE4, 0xF5, 0x1D, 0x90, 0x04, 0x7F, 0xE5, 0x1D, 0xF0, 0x90, 0xA5, 0x5E, 0xE0, 0x7F, 0x04, -+0x70, 0x02, 0x81, 0xC6, 0x71, 0x18, 0x22, 0x12, 0xBA, 0x93, 0x90, 0xA6, 0x5C, 0x74, 0x02, 0xF0, -+0x90, 0xA4, 0x27, 0xE0, 0x20, 0xE0, 0x02, 0x81, 0xC0, 0xE4, 0xFF, 0x12, 0x75, 0x89, 0x90, 0xA4, -+0x2B, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x8A, 0xAC, 0x90, 0xA4, 0x27, -+0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x08, 0x90, 0x07, 0x78, 0x74, 0x0D, 0xF0, -+0x80, 0x2D, 0x90, 0xA4, 0x2A, 0xE0, 0xFE, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x0D, 0xEE, 0x13, 0x13, -+0x54, 0x3F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x0F, 0x80, 0x12, 0x90, 0xA4, 0x2A, 0xE0, 0xFE, 0xC3, -+0x13, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x09, 0xF0, 0xEF, -+0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA6, 0x5D, 0xF0, 0x80, 0x06, -+0x90, 0xA6, 0x5D, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, -+0x13, 0x90, 0xA4, 0x64, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0xA6, 0x5C, 0xF0, 0x80, 0x06, 0x90, 0xA6, -+0x5C, 0x74, 0x01, 0xF0, 0x90, 0xA6, 0x5C, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x75, 0xCC, 0x90, -+0xA4, 0x38, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, -+0x07, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x80, 0x26, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1F, 0x90, -+0xA4, 0x2D, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0xA4, 0x22, 0xE0, 0x60, 0x06, 0x7D, 0x01, 0x7F, 0x04, -+0x80, 0x09, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x5C, 0x92, 0x90, 0xA4, -+0x22, 0xE0, 0x90, 0x05, 0x22, 0x60, 0x05, 0x74, 0x6F, 0xF0, 0x80, 0x02, 0xE4, 0xF0, 0x90, 0xA4, -+0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0xB4, 0xA0, -+0x22, 0x12, 0x80, 0x45, 0x7F, 0x02, 0x8F, 0x70, 0x7F, 0x02, 0x12, 0x49, 0x27, 0x90, 0xA2, 0x92, -+0xE0, 0x45, 0x70, 0xF0, 0x22, 0x12, 0xB7, 0x75, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x46, 0x90, 0xA4, -+0x09, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x13, 0x90, 0x01, 0x3B, 0xE0, 0x30, -+0xE4, 0x0C, 0x12, 0x5F, 0x5D, 0x90, 0xA4, 0x11, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0xA6, -+0x4C, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x4A, 0x9F, 0xC3, 0x90, 0xA6, 0x4D, 0xE0, 0x94, 0x80, 0x90, -+0xA6, 0x4C, 0xE0, 0x64, 0x80, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, -+0xE0, 0x44, 0x01, 0xF0, 0x12, 0x87, 0x34, 0x12, 0x86, 0xFF, 0x7F, 0x01, 0x91, 0xC6, 0x90, 0xA4, -+0x23, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0B, 0x12, 0x5F, 0x5D, 0x90, -+0xA4, 0x25, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x90, 0xA4, 0x8C, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, -+0x1B, 0x90, 0x04, 0x30, 0xE0, 0xB4, 0x01, 0x06, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0x74, 0x87, -+0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0x70, 0x02, 0xC1, 0x60, 0xE5, 0x1B, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0xE5, 0x1B, 0x54, 0x07, 0xFE, 0x74, 0x81, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0xFD, 0xAF, 0x06, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, -+0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0xC1, 0x60, -+0x75, 0xF0, 0x10, 0xE5, 0x1B, 0x90, 0x81, 0x01, 0x12, 0x4B, 0x88, 0xE0, 0x20, 0xE7, 0x02, 0x80, -+0x10, 0x75, 0xF0, 0x10, 0xE5, 0x1B, 0x90, 0x81, 0x02, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x20, 0xE7, -+0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x20, 0xF0, 0xC1, 0x60, 0xEF, 0x30, 0xE6, 0x2B, 0x90, 0xA4, -+0x89, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x1B, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE0, -+0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x1B, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0x13, 0x13, 0x54, -+0x03, 0x90, 0xA6, 0x07, 0xF0, 0xE4, 0xFB, 0x80, 0x62, 0x90, 0xA4, 0x8A, 0xE0, 0x04, 0xF0, 0x74, -+0x12, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x74, 0x12, 0x25, -+0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xD3, 0x94, 0x03, 0x40, 0x14, 0xAF, 0x1B, -+0x12, 0x96, 0x52, 0x74, 0x12, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE4, 0xF0, -+0x80, 0x2E, 0x90, 0x9D, 0x92, 0x74, 0x03, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x1B, 0x90, 0x81, 0x00, -+0x12, 0x4B, 0x88, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x1B, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, -+0xE0, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA6, 0x07, 0xF0, 0x7B, 0x01, 0xAF, 0x1B, 0x12, 0x68, 0xCD, -+0x05, 0x1B, 0xE5, 0x1B, 0xC3, 0x94, 0x80, 0x50, 0x02, 0xA1, 0x51, 0x22, 0x90, 0xA4, 0x8B, 0xE0, -+0x04, 0xF0, 0xE4, 0xFF, 0x90, 0xA4, 0xB8, 0xEF, 0xF0, 0xE4, 0xF5, 0x25, 0x74, 0xB9, 0x25, 0x25, -+0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, -+0x03, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x30, 0xE7, 0x10, 0xE5, 0x25, 0x70, 0x1F, 0xEF, 0x30, 0xE6, -+0x1B, 0x90, 0xA4, 0x88, 0xE0, 0x04, 0xF0, 0x80, 0x13, 0xAF, 0x25, 0x12, 0xAB, 0xCF, 0x74, 0xB9, -+0x25, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x05, 0x25, 0xE5, 0x25, -+0xC3, 0x94, 0x80, 0x40, 0xB7, 0x7F, 0x0C, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xE4, 0xF5, 0x25, 0x74, -+0xB9, 0x25, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, 0x68, 0x33, -+0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, 0x06, 0x12, 0x4B, 0x88, 0xE0, 0xF5, 0x23, 0x75, 0xF0, -+0x10, 0xE5, 0x25, 0x90, 0x81, 0x07, 0x12, 0x4B, 0x88, 0xE0, 0xF5, 0x24, 0xFE, 0xE5, 0x23, 0xFF, -+0xE5, 0x25, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, 0x0A, 0x12, 0x4B, 0x88, 0xE0, 0xF5, 0x23, -+0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, 0x0B, 0x12, 0x4B, 0x88, 0xE0, 0xF5, 0x24, 0xFE, 0xE5, -+0x23, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x25, 0x90, 0x8D, 0x01, 0x12, 0x4B, 0x88, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, 0x0C, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, -+0xF0, 0x0A, 0xE5, 0x25, 0x90, 0x8D, 0x03, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, -+0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, 0x0D, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, -+0x25, 0x90, 0x8D, 0x05, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, -+0x25, 0x90, 0x81, 0x0E, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x25, 0x90, 0x8D, -+0x07, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, -+0x0F, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x25, 0x90, 0x8D, 0x09, 0x12, 0x4B, -+0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x25, 0x90, 0x81, 0x09, 0x12, 0x4B, -+0x88, 0xE0, 0xFF, 0x74, 0x12, 0x25, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xEF, 0xF0, -+0xE5, 0x25, 0x70, 0x56, 0xE5, 0x24, 0x30, 0xE7, 0x05, 0x90, 0xA4, 0x87, 0x80, 0x49, 0xE5, 0x24, -+0x30, 0xE6, 0x05, 0x90, 0xA4, 0x86, 0x80, 0x3F, 0xE5, 0x24, 0x30, 0xE5, 0x05, 0x90, 0xA4, 0x85, -+0x80, 0x35, 0xE5, 0x24, 0x30, 0xE4, 0x05, 0x90, 0xA4, 0x84, 0x80, 0x2B, 0xE5, 0x24, 0x30, 0xE3, -+0x05, 0x90, 0xA4, 0x83, 0x80, 0x21, 0xE5, 0x24, 0x30, 0xE2, 0x05, 0x90, 0xA4, 0x82, 0x80, 0x17, -+0xE5, 0x24, 0x30, 0xE1, 0x05, 0x90, 0xA4, 0x81, 0x80, 0x0D, 0xE5, 0x24, 0x30, 0xE0, 0x05, 0x90, -+0xA4, 0x80, 0x80, 0x03, 0x90, 0xA4, 0x7F, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0xB8, 0xE0, 0xFD, 0xAF, -+0x25, 0x11, 0x40, 0x05, 0x25, 0xE5, 0x25, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x66, 0xCF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x62, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, -+0x01, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, -+0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x12, 0x4B, 0x88, -+0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x07, 0x12, 0x4B, 0x88, 0xE4, 0xF0, -+0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, -+0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, -+0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xEF, -+0x90, 0x81, 0x03, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0x75, 0xF0, 0x10, 0xEF, -+0x90, 0x81, 0x03, 0x12, 0x4B, 0x88, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x04, 0xEF, 0xF0, 0x90, 0xA6, 0x06, 0xEB, 0xF0, 0x90, 0xA6, -+0x05, 0xED, 0xF0, 0xE4, 0x90, 0xA6, 0x0C, 0xF0, 0x90, 0xA6, 0x04, 0xE0, 0xFF, 0x13, 0x13, 0x13, -+0x54, 0x1F, 0x90, 0xA6, 0x08, 0xF0, 0xEF, 0x54, 0x07, 0x90, 0xA6, 0x0A, 0xF0, 0x90, 0xA6, 0x04, -+0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x01, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA6, 0x0B, 0xF0, 0xED, -+0x54, 0x7F, 0x90, 0xA6, 0x09, 0xF0, 0xFB, 0x25, 0xE0, 0x24, 0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x43, -+0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, 0x04, 0xEB, -+0x90, 0x42, 0x3B, 0x12, 0x4B, 0x88, 0x12, 0x4B, 0x78, 0x12, 0x4B, 0x18, 0x78, 0x01, 0x12, 0x27, -+0x22, 0x90, 0xA6, 0x04, 0xE0, 0xFD, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, -+0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA6, 0x05, 0xE0, 0xB4, 0x3F, 0x18, 0x75, 0xF0, 0x04, -+0xED, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x06, 0x90, -+0xA6, 0x05, 0x74, 0xBE, 0xF0, 0x90, 0xA6, 0x05, 0xE0, 0xB4, 0x34, 0x18, 0x75, 0xF0, 0x04, 0xED, -+0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x06, 0x90, 0xA6, -+0x05, 0x74, 0xB3, 0xF0, 0x90, 0xA6, 0x05, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0x90, 0xA6, 0x09, 0xF0, -+0xEF, 0x54, 0x80, 0xFF, 0xEE, 0xD3, 0x94, 0x35, 0x50, 0x08, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x02, -+0x80, 0x10, 0x90, 0xA6, 0x09, 0xE0, 0xFE, 0xD3, 0x94, 0x13, 0x50, 0x0E, 0xEE, 0xC3, 0x94, 0x0C, -+0x40, 0x08, 0x90, 0xA6, 0x0C, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA6, 0x0C, 0xF0, 0x90, -+0xA6, 0x04, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFE, 0x20, 0xE2, -+0x02, 0x41, 0xAC, 0x90, 0xA6, 0x06, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x41, 0xAC, 0xEE, 0x30, 0xE7, -+0x02, 0x41, 0x99, 0x90, 0xA6, 0x09, 0xE0, 0xFE, 0x64, 0x3F, 0x60, 0x05, 0xEE, 0x64, 0x3E, 0x70, -+0x64, 0xEF, 0x60, 0x61, 0x90, 0xA6, 0x04, 0xE0, 0xFB, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x94, 0x12, -+0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x4B, 0x90, 0xA6, 0x0C, 0xE0, 0xFD, 0x90, -+0xA6, 0x05, 0xE0, 0x90, 0xA5, 0x7F, 0xF0, 0xE4, 0xFF, 0x91, 0x03, 0x90, 0xA6, 0x04, 0xE0, 0xFF, -+0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA6, 0x05, -+0xE0, 0xFE, 0x74, 0x01, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0xA6, -+0x04, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0x90, 0xA6, 0x05, 0xF0, -+0xE4, 0xA3, 0xF0, 0x80, 0x5B, 0x90, 0xA6, 0x04, 0xE0, 0xFB, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, -+0x9A, 0xF5, 0x83, 0xE0, 0x90, 0xA6, 0x0C, 0x30, 0xE2, 0x0E, 0xE0, 0xFD, 0x90, 0xA6, 0x05, 0xE0, -+0x90, 0xA5, 0x7F, 0xF0, 0x7F, 0x01, 0x80, 0x36, 0xE0, 0xFD, 0x90, 0xA6, 0x04, 0xE0, 0xFB, 0xA3, -+0xE0, 0x90, 0xA5, 0x7F, 0xF0, 0xE4, 0xFF, 0x80, 0x25, 0x90, 0xA6, 0x04, 0xE0, 0x24, 0x92, 0xF5, -+0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x14, 0x90, 0xA6, 0x0C, 0xE0, -+0xFD, 0x90, 0xA6, 0x04, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0xA5, 0x7F, 0xF0, 0xE4, 0xFF, 0x91, 0x03, -+0x90, 0xA6, 0x04, 0xE0, 0xFC, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xC4, -+0x54, 0x03, 0x70, 0x32, 0x90, 0xA6, 0x09, 0xE0, 0xFE, 0xC3, 0x94, 0x14, 0x40, 0x15, 0xEE, 0xD3, -+0x94, 0x18, 0x50, 0x0F, 0x90, 0x04, 0x33, 0x74, 0x06, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, -+0xA3, 0x80, 0x0F, 0x90, 0x04, 0x33, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0xA3, 0x04, 0xF0, -+0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0x90, 0xA6, 0x06, 0xE0, 0x70, 0x39, 0x90, 0x04, 0xCF, 0x74, -+0x30, 0xF0, 0x90, 0xA6, 0x08, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xC0, -+0x83, 0xC0, 0x82, 0xE0, 0xFE, 0x90, 0xA6, 0x0A, 0xE0, 0xFD, 0x74, 0x01, 0xA8, 0x05, 0x08, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA6, 0x0B, 0xE0, -+0x54, 0x7F, 0xF0, 0x80, 0x6B, 0x74, 0x92, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, -+0x90, 0x04, 0xCF, 0x30, 0xE0, 0x05, 0x74, 0x20, 0xF0, 0x80, 0x02, 0xE4, 0xF0, 0x90, 0xA6, 0x08, -+0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, -+0x90, 0xA6, 0x0A, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -+0x4F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA6, 0x04, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x01, -+0x12, 0x4B, 0x88, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0xA6, 0x0B, 0xF0, 0x90, 0xA6, 0x09, 0xE0, 0x90, -+0x44, 0x3F, 0x93, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x4F, 0x90, 0xA6, 0x0B, 0xF0, 0x44, 0x80, 0xF0, -+0x90, 0xA6, 0x05, 0xE0, 0xFF, 0x90, 0xA6, 0x04, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, -+0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x90, 0xA6, 0x0B, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, -+0x01, 0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x05, 0x12, 0x4B, 0x88, -+0xE0, 0x54, 0xFC, 0xFF, 0x90, 0xA6, 0x07, 0xE0, 0x4F, 0xFE, 0x90, 0xA6, 0x04, 0xE0, 0xFF, 0x75, -+0xF0, 0x10, 0x90, 0x81, 0x05, 0x12, 0x4B, 0x88, 0xEE, 0xF0, 0x7D, 0x01, 0x11, 0x40, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0xA5, 0x7E, 0xEB, 0xF0, 0x70, 0x56, 0x90, 0xA5, 0x7E, 0xE0, 0xFE, 0x24, -+0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0xFC, 0x90, 0xA5, 0x7F, 0xE0, 0xFB, 0xEC, -+0x6B, 0x60, 0x3D, 0x90, 0xA5, 0x82, 0xEB, 0xF0, 0xA3, 0xEE, 0xF0, 0xAE, 0x05, 0xEE, 0x25, 0xE0, -+0x4F, 0xA3, 0xF0, 0x90, 0xA5, 0x80, 0x74, 0x0C, 0xF0, 0x90, 0xA5, 0x8E, 0x74, 0x03, 0xF0, 0x7B, -+0x01, 0x7A, 0xA5, 0x79, 0x80, 0x91, 0x61, 0x7F, 0x04, 0x12, 0x63, 0x18, 0x90, 0xA5, 0x7F, 0xE0, -+0xFF, 0x90, 0xA5, 0x7E, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xEF, 0xF0, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x83, 0xE0, 0xFF, 0x70, 0x06, 0xA3, -+0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA3, 0x84, 0xE0, 0xB5, 0x07, 0x04, 0x7F, -+0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, -+0x35, 0xC0, 0x01, 0x90, 0xA3, 0x84, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xED, 0xF9, 0x74, 0xA2, -+0x35, 0xF0, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x4A, 0x79, -+0x90, 0xA3, 0x84, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, -+0x05, 0xE4, 0x90, 0xA3, 0x84, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA5, 0x44, 0x12, 0x4B, -+0x9D, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x02, 0x12, 0x26, -+0x37, 0x90, 0xA6, 0x29, 0xF0, 0xE4, 0xFB, 0xFD, 0xB1, 0x10, 0x90, 0xA5, 0x47, 0x74, 0x10, 0xF0, -+0x90, 0xA5, 0x55, 0x74, 0x07, 0xF0, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x12, 0x26, 0x1E, 0x90, -+0xA5, 0x49, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x47, 0x91, 0x61, 0x7F, 0x04, 0x02, 0x63, 0x18, -+0x90, 0xA6, 0x27, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA6, 0x26, 0xEF, 0xF0, 0x90, 0xA6, 0x29, -+0xE0, 0xFD, 0x12, 0xB1, 0x96, 0x90, 0xA6, 0x26, 0xE0, 0xC3, 0x94, 0x0E, 0x50, 0x48, 0x90, 0xA5, -+0xA4, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x12, 0xD4, -+0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, -+0x07, 0x03, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x12, 0xAF, 0xE7, -+0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0x00, 0xC1, 0xC3, 0x90, 0xA6, 0x26, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, -+0x1B, 0xEF, 0x94, 0x30, 0x50, 0x16, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, -+0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x09, 0x28, 0x00, 0x00, 0x80, 0x70, 0x90, 0xA6, 0x26, 0xE0, -+0xFF, 0x74, 0x32, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, 0x50, 0x16, 0x90, 0xA5, 0xA4, 0x12, -+0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x08, 0xA6, 0x00, 0x00, -+0x80, 0x4A, 0x90, 0xA6, 0x26, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x74, -+0x50, 0x16, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, -+0x27, 0x54, 0x08, 0xA4, 0x00, 0x00, 0x80, 0x24, 0x90, 0xA6, 0x26, 0xE0, 0xFF, 0x74, 0x76, 0xD3, -+0x9F, 0x50, 0x20, 0xEF, 0x94, 0xA5, 0x50, 0x1B, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x1F, 0xFE, -+0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x08, 0x24, 0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, -+0x12, 0xAD, 0x45, 0x90, 0xA6, 0x26, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, 0x32, 0xEF, 0x94, -+0x40, 0x50, 0x2D, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0x96, -+0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0x12, 0xAF, 0xE7, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, -+0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0x80, 0x73, -+0x90, 0xA6, 0x26, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x32, 0xEF, 0x94, 0x8C, 0x50, 0x2D, -+0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, -+0x00, 0x03, 0x01, 0x00, 0x12, 0xAF, 0xE7, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, -+0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, 0x00, 0x03, 0x01, 0x00, 0x80, 0x36, 0x90, 0xA6, 0x26, -+0xE0, 0xFF, 0x74, 0x8C, 0xC3, 0x9F, 0x50, 0x34, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x07, -+0x03, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, 0x00, 0x05, 0x01, 0x00, 0x12, 0xAF, 0xE7, 0x90, -+0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, 0x00, -+0x05, 0x01, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0x12, 0xAF, 0xED, 0x90, 0xA6, 0x27, 0xE0, -+0x64, 0x02, 0x70, 0x66, 0x90, 0xA6, 0x26, 0xE0, 0xFF, 0xD3, 0x94, 0x30, 0x50, 0x08, 0x90, 0xA6, -+0x2A, 0x74, 0x2A, 0xF0, 0x80, 0x70, 0xEF, 0xD3, 0x94, 0x40, 0x50, 0x08, 0x90, 0xA6, 0x2A, 0x74, -+0x3A, 0xF0, 0x80, 0x62, 0xEF, 0xD3, 0x94, 0x70, 0x50, 0x08, 0x90, 0xA6, 0x2A, 0x74, 0x6A, 0xF0, -+0x80, 0x54, 0xEF, 0xD3, 0x94, 0x80, 0x50, 0x08, 0x90, 0xA6, 0x2A, 0x74, 0x7A, 0xF0, 0x80, 0x46, -+0xEF, 0xD3, 0x94, 0x90, 0x50, 0x08, 0x90, 0xA6, 0x2A, 0x74, 0x8A, 0xF0, 0x80, 0x38, 0xEF, 0xD3, -+0x94, 0xA1, 0x50, 0x08, 0x90, 0xA6, 0x2A, 0x74, 0x9B, 0xF0, 0x80, 0x2A, 0xEF, 0xD3, 0x94, 0xB1, -+0x50, 0x24, 0x90, 0xA6, 0x2A, 0x74, 0xAB, 0xF0, 0x80, 0x1C, 0x90, 0xA6, 0x27, 0xE0, 0x64, 0x01, -+0x70, 0x33, 0xA3, 0xE0, 0x90, 0xA6, 0x26, 0xB4, 0x01, 0x05, 0xE0, 0x24, 0x02, 0x80, 0x03, 0xE0, -+0x24, 0xFE, 0x90, 0xA6, 0x2A, 0xF0, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, -+0x90, 0xA6, 0x2A, 0x12, 0xAF, 0xDB, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, -+0x90, 0xA6, 0x2A, 0x80, 0x1D, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, -+0xA6, 0x26, 0x12, 0xAF, 0xDB, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, -+0xA6, 0x26, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x48, 0x7D, 0x18, -+0x7C, 0x00, 0x7F, 0x01, 0x02, 0xAF, 0xED, 0x90, 0xA5, 0xC3, 0x74, 0x08, 0xF0, 0x90, 0xA5, 0xD1, -+0x74, 0x01, 0xF0, 0x90, 0xA5, 0xC5, 0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0xC3, 0x81, 0x61, -+0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, -+0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, -+0x74, 0xC0, 0xF0, 0x74, 0x6F, 0xA3, 0xF0, 0x12, 0x82, 0xFB, 0xE5, 0x69, 0x30, 0xE0, 0x03, 0x12, -+0x70, 0x51, 0xE5, 0x69, 0x30, 0xE1, 0x03, 0x12, 0x76, 0xA1, 0xE5, 0x69, 0x30, 0xE2, 0x02, 0xD1, -+0xAB, 0xE5, 0x6A, 0x30, 0xE0, 0x03, 0x12, 0x83, 0xB3, 0xE5, 0x6C, 0x30, 0xE1, 0x05, 0x7F, 0x04, -+0x12, 0x64, 0xC6, 0xE5, 0x6C, 0x30, 0xE4, 0x03, 0x12, 0x5C, 0x1E, 0xE5, 0x6C, 0x30, 0xE5, 0x03, -+0x12, 0x84, 0x44, 0xE5, 0x6C, 0x30, 0xE6, 0x03, 0x12, 0x87, 0xB2, 0x74, 0xC0, 0x04, 0x90, 0x01, -+0xC4, 0xF0, 0x74, 0x6F, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, -+0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, -+0x32, 0x90, 0xA5, 0x6F, 0x74, 0x02, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0x88, -+0x12, 0xB5, 0x3B, 0x90, 0xA4, 0x39, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x21, 0x3E, 0xF5, 0x3B, 0x75, -+0x3C, 0x03, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x53, 0x74, 0x05, -+0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x54, 0x0F, 0x90, 0xA4, 0x39, 0x30, 0xE0, 0x05, 0x74, 0x05, -+0xF0, 0x80, 0x03, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, -+0x0F, 0x90, 0xA4, 0x28, 0xE0, 0xFF, 0x90, 0xA4, 0x37, 0xE0, 0xC3, 0x9F, 0x90, 0xA4, 0x3D, 0xF0, -+0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x28, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, -+0x13, 0x54, 0x07, 0x30, 0xE0, 0x6D, 0x90, 0xA4, 0x3D, 0xE0, 0xC3, 0x94, 0x20, 0x50, 0x0A, 0xE0, -+0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xE4, 0xFD, 0x80, 0x05, 0x7B, 0x7F, 0x7D, 0xFF, 0xE4, 0xFF, 0xF1, -+0x1B, 0x80, 0x50, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x40, 0x90, 0xA4, 0x2D, -+0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x5C, 0x92, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, -+0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x26, 0x90, 0xA4, 0x2E, 0xE0, 0x44, 0x02, 0xF0, 0x54, 0xFB, -+0xF0, 0xE4, 0x90, 0xA4, 0x3C, 0xF0, 0x90, 0xA4, 0x39, 0xF0, 0x90, 0xA4, 0x2F, 0x74, 0x06, 0xF0, -+0x90, 0xA4, 0x22, 0xE0, 0x60, 0x07, 0x90, 0xA4, 0x2E, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x05, 0x22, -+0x74, 0x6F, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0x88, 0x81, 0xB0, 0x90, 0xA4, -+0x39, 0xE0, 0x64, 0x02, 0x60, 0x02, 0x41, 0x33, 0x7F, 0x01, 0xB1, 0x89, 0x90, 0xA4, 0x2B, 0xE0, -+0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x09, 0x12, 0x8A, 0x07, 0xBF, 0x01, 0x03, 0x12, 0x88, -+0xCA, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x90, 0x07, 0x78, 0x30, 0xE0, -+0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x28, 0xE0, -+0x24, 0x03, 0xFF, 0x90, 0xA4, 0x37, 0xE0, 0xC3, 0x9F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x50, -+0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x53, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xC3, -+0x13, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA5, 0x6E, 0xF0, 0x80, 0x06, 0x90, 0xA5, 0x6E, 0x74, 0x01, -+0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x13, 0x90, 0xA4, 0x64, 0xE0, -+0x60, 0x08, 0x90, 0xA5, 0x6F, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA5, 0x6F, 0xF0, 0xB1, -+0xC2, 0xE4, 0x90, 0xA4, 0x38, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x13, -+0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x29, 0x90, 0xA4, 0x27, -+0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x10, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, -+0xE0, 0x0E, 0x12, 0x5C, 0x8B, 0x80, 0x09, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x09, 0x12, 0x5C, 0x8B, -+0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x05, 0x22, -+0xE4, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x20, 0xE0, 0x02, 0xA1, -+0x88, 0xA1, 0x83, 0x90, 0xA4, 0x39, 0xE0, 0x64, 0x03, 0x60, 0x02, 0x61, 0xE6, 0xFF, 0xB1, 0x89, -+0x90, 0xA4, 0x2B, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x8A, 0xAC, 0x90, -+0xA4, 0x27, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x08, 0x90, 0x07, 0x78, 0x74, 0x0D, -+0xF0, 0x80, 0x14, 0x90, 0xA4, 0x2A, 0xE0, 0xC3, 0x13, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, -+0x03, 0xF0, 0x80, 0x03, 0x74, 0x09, 0xF0, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x20, 0xE0, 0x02, 0x61, 0x0A, 0x90, 0xA4, 0x31, 0xE0, 0xFF, 0x90, 0xA4, 0x3B, 0xE0, 0xD3, 0x9F, -+0x40, 0x4D, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0xFF, 0x90, 0xA4, 0x33, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, -+0xFF, 0x24, 0x03, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0xA4, 0x29, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, -+0xF8, 0x74, 0x80, 0x98, 0x40, 0x08, 0xE0, 0x9F, 0x90, 0xA5, 0x70, 0xF0, 0x80, 0x06, 0x90, 0xA5, -+0x70, 0x74, 0x03, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA5, 0x70, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, -+0x7F, 0x50, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0xA4, 0x39, 0xE0, 0x04, 0xF0, 0x80, 0x24, 0xE4, -+0xF5, 0x3B, 0x90, 0xA4, 0x34, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, -+0x34, 0x8C, 0x90, 0xA4, 0x2F, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA4, 0x39, 0xF0, 0x90, 0x06, 0x92, -+0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA4, 0x3B, 0xF0, 0x80, 0x19, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x29, -+0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0xA4, 0x39, -+0xE0, 0x04, 0xF0, 0x90, 0x01, 0x53, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x13, 0x13, -+0x13, 0x54, 0x01, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA5, 0x6E, 0xF0, 0x80, 0x06, 0x90, 0xA5, 0x6E, -+0x74, 0x01, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x13, 0x90, 0xA4, -+0x64, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0xA5, 0x6F, 0xF0, 0x80, 0x06, 0x90, 0xA5, 0x6F, 0x74, 0x01, -+0xF0, 0xB1, 0xC2, 0x90, 0xA4, 0x38, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x13, 0x54, -+0x07, 0x20, 0xE0, 0x33, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1C, 0x90, 0xA4, -+0x2D, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0xA4, 0x22, 0xE0, 0x60, 0x04, 0x7D, 0x01, 0x80, 0x13, 0x90, -+0x05, 0x22, 0xE4, 0xF0, 0x7D, 0x01, 0x7F, 0x0C, 0x80, 0x0A, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x07, -+0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x5C, 0x92, 0x90, 0xA4, 0x22, 0xE0, 0x60, 0x08, 0x90, 0x05, 0x22, -+0x74, 0x6F, 0xF0, 0x80, 0x1E, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x0E, -+0x90, 0xA4, 0x27, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0xD1, 0xC4, 0x90, 0x05, -+0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x20, 0xE0, 0x02, -+0xA1, 0x88, 0x7F, 0x01, 0xA1, 0x85, 0x90, 0xA4, 0x39, 0xE0, 0x64, 0x04, 0x60, 0x02, 0x81, 0xB6, -+0xF5, 0x3B, 0x75, 0x3C, 0x03, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, -+0x53, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x39, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, -+0x54, 0x07, 0x30, 0xE0, 0x0F, 0x90, 0xA4, 0x29, 0xE0, 0xFF, 0x90, 0xA4, 0x37, 0xE0, 0xC3, 0x9F, -+0x90, 0xA4, 0x3D, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x28, 0x90, -+0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x6D, 0x90, 0xA4, 0x3D, 0xE0, 0xC3, 0x94, -+0x20, 0x50, 0x0A, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xE4, 0xFD, 0x80, 0x05, 0x7B, 0x7F, 0x7D, -+0xFF, 0xE4, 0xFF, 0xF1, 0x1B, 0x80, 0x50, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -+0x40, 0x90, 0xA4, 0x2D, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x5C, 0x92, 0x90, -+0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x26, 0x90, 0xA4, 0x2E, 0xE0, 0x44, -+0x02, 0xF0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA4, 0x3C, 0xF0, 0x90, 0xA4, 0x39, 0xF0, 0x90, 0xA4, -+0x2F, 0x74, 0x07, 0xF0, 0x90, 0xA4, 0x22, 0xE0, 0x60, 0x07, 0x90, 0xA4, 0x2E, 0xE0, 0x44, 0x04, -+0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0x88, -+0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x64, 0x05, 0x60, 0x02, 0xA1, 0x88, -+0x7F, 0x01, 0xB1, 0x89, 0x90, 0xA4, 0x2B, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x09, -+0x12, 0x8A, 0x07, 0xBF, 0x01, 0x03, 0x12, 0x88, 0xCA, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x13, -+0x13, 0x54, 0x01, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x01, -+0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA5, 0x6E, 0xF0, 0x80, -+0x06, 0x90, 0xA5, 0x6E, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, -+0xE0, 0x13, 0x90, 0xA4, 0x64, 0xE0, 0x60, 0x08, 0x90, 0xA5, 0x6F, 0x74, 0x01, 0xF0, 0x80, 0x05, -+0xE4, 0x90, 0xA5, 0x6F, 0xF0, 0xB1, 0xC2, 0xE4, 0x90, 0xA4, 0x38, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, -+0x27, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, -+0x29, 0x90, 0xA4, 0x27, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x10, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, -+0x13, 0x54, 0x07, 0x20, 0xE0, 0x0E, 0x12, 0x5C, 0x8B, 0x80, 0x09, 0x90, 0xA4, 0x0B, 0xE0, 0x60, -+0x09, 0x12, 0x5C, 0x8B, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0x30, 0xE0, -+0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, -+0x30, 0xE0, 0x05, 0xE4, 0xFF, 0x12, 0xB4, 0xA0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0xEF, 0xB4, 0x03, 0x13, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0x06, 0xCC, -+0x30, 0xE0, 0x17, 0xE4, 0xF0, 0x80, 0x16, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -+0x0C, 0xEF, 0x90, 0x06, 0xCC, 0x70, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x03, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0xA5, 0x6F, 0xE0, 0xFF, 0x90, 0xA5, 0x6E, 0xE0, 0xFD, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0xFB, 0xED, 0xF0, 0x90, 0xA5, 0xFA, 0xEF, 0xF0, 0x64, 0x02, 0x60, -+0x43, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEC, 0x54, 0xF3, 0xFC, 0x90, 0xA5, 0xFC, 0x12, -+0x27, 0x48, 0x90, 0xA5, 0xFA, 0xE0, 0x90, 0xA5, 0xFC, 0xB4, 0x01, 0x08, 0x12, 0x4B, 0x50, 0xEC, -+0x44, 0x08, 0x80, 0x06, 0x12, 0x4B, 0x50, 0xEC, 0x44, 0x04, 0xFC, 0x90, 0xA5, 0xFC, 0x12, 0x27, -+0x48, 0x90, 0xA5, 0xFC, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB4, 0x7E, -+0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA5, 0xFB, 0xE0, 0x64, 0x02, 0x60, 0x70, 0x7F, 0xB0, 0x7E, 0x0C, -+0x12, 0x36, 0xCE, 0xE4, 0xFC, 0x90, 0xA5, 0xFC, 0x12, 0x27, 0x48, 0x90, 0xA5, 0xFB, 0xE0, 0x70, -+0x10, 0xA3, 0x12, 0x4B, 0x50, 0xEC, 0x44, 0x77, 0xFC, 0x90, 0xA5, 0xFC, 0x12, 0x27, 0x48, 0x80, -+0x38, 0x90, 0xA5, 0xFC, 0x12, 0x4B, 0x50, 0xEC, 0x44, 0x66, 0xFC, 0x90, 0xA5, 0xFC, 0x12, 0x27, -+0x48, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEC, 0x54, 0xF3, 0xFC, 0xEC, 0x44, 0x08, 0xFC, -+0x90, 0xA6, 0x00, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x00, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, -+0x27, 0x48, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA5, 0xFC, 0x12, 0x4B, 0x50, 0x90, -+0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x03, 0x12, 0xBB, 0x29, 0x22, 0x90, 0xA4, 0x0B, 0xE0, 0x60, -+0x12, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x02, 0xE1, 0xC9, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xF7, -+0xF0, 0xF1, 0xBF, 0x22, 0x90, 0xA4, 0x21, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x19, 0x90, 0x04, -+0x1D, 0xE0, 0x70, 0x13, 0x90, 0xA2, 0x97, 0xE0, 0xFF, 0xE4, 0xFD, 0xF1, 0x51, 0x8E, 0x6E, 0x8F, -+0x6F, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x90, 0xA3, 0x87, 0xE0, 0xB4, 0x01, 0x14, 0x90, -+0xA4, 0x0B, 0xE0, 0x60, 0x0E, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x02, 0x80, -+0xC3, 0xF1, 0x04, 0x22, 0xF1, 0xC9, 0x90, 0xA4, 0x0E, 0xE0, 0x64, 0x0C, 0x60, 0x0C, 0xE4, 0xFD, -+0x7F, 0x0C, 0x12, 0x5C, 0x92, 0xE4, 0xFF, 0x12, 0x84, 0xEB, 0x22, 0x90, 0xA5, 0x71, 0xEF, 0xF0, -+0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1B, 0x90, 0x05, 0x22, 0xE0, -+0x90, 0xA5, 0x76, 0xF0, 0x12, 0x8A, 0x07, 0xBF, 0x01, 0x03, 0x12, 0x86, 0x45, 0x90, 0xA5, 0x76, -+0xE0, 0x90, 0x05, 0x22, 0xF0, 0x80, 0x03, 0x12, 0x86, 0x45, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x4F, 0xED, 0xF0, 0x90, 0xA6, 0x4E, -+0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xBB, 0xD4, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0xA6, 0x4E, 0xE0, -+0x90, 0x04, 0x25, 0xF0, 0x90, 0xA6, 0x4F, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x01, 0x51, 0x90, -+0xA4, 0x0D, 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x5C, 0x92, 0x90, 0xA4, 0x08, 0xE0, 0x13, 0x13, 0x13, -+0x54, 0x1F, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, -+0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x1E, 0xE0, 0xC3, 0x13, 0x54, -+0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5B, -+0x74, 0x05, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, -+0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x0B, 0x90, 0x01, 0xC4, 0xED, -+0xF0, 0x74, 0x78, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, -+0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x02, 0x09, 0xE0, -+0xFD, 0x12, 0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0xA2, 0x96, 0xF0, 0x90, 0x00, 0x01, -+0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA2, 0x97, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, -+0xFF, 0xED, 0x2F, 0x90, 0xA2, 0x98, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, -+0x90, 0xA2, 0x99, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, -+0xA2, 0x9A, 0xF0, 0x22, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x9D, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, -+0xFF, 0xFE, 0x12, 0x26, 0x1E, 0xFD, 0xC3, 0x13, 0x30, 0xE0, 0x12, 0x90, 0xA5, 0x44, 0x12, 0x4B, -+0x94, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA5, 0x48, 0xF0, 0x80, 0x05, 0x90, 0xA5, 0x48, -+0xEF, 0xF0, 0x90, 0xA5, 0x47, 0xEE, 0xF0, 0x90, 0xA5, 0x48, 0xE0, 0xFE, 0x90, 0xA5, 0x47, 0xE0, -+0xFF, 0xD3, 0x9E, 0x50, 0x38, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x12, 0x26, 0x1E, 0x54, 0x01, -+0xFE, 0x74, 0x87, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x87, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0x70, 0x04, 0x31, 0x36, 0x80, 0x07, 0x90, 0xA5, -+0x47, 0xE0, 0xFF, 0x31, 0x25, 0x90, 0xA5, 0x47, 0xE0, 0x04, 0xF0, 0x80, 0xBA, 0x90, 0xA3, 0x87, -+0xE0, 0x70, 0x21, 0x90, 0xA4, 0x0E, 0xE0, 0x70, 0x04, 0xFF, 0x12, 0x5E, 0x8F, 0x90, 0xA4, 0x0E, -+0xE0, 0x64, 0x0C, 0x60, 0x02, 0x31, 0x47, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, -+0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x8F, 0x0F, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x4B, -+0x88, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x8F, 0x0F, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, -+0x4B, 0x88, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x05, -+0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x0C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0xA4, 0x07, 0xF0, 0xBF, 0x01, 0x12, 0x90, 0x00, 0x01, 0x12, -+0x26, 0x37, 0x64, 0x01, 0x60, 0x17, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x0F, 0x90, 0x00, -+0x01, 0x12, 0x26, 0x37, 0x64, 0x01, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x9D, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x7F, 0x90, 0xA4, -+0x0B, 0xF0, 0xEF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xA3, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, -+0x37, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, -+0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0xA4, 0x08, 0xE0, 0x54, -+0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, -+0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x0D, 0xF0, 0x90, 0x00, 0x05, 0x12, -+0x26, 0x37, 0xFF, 0x54, 0x02, 0xFE, 0x90, 0xA4, 0x21, 0xE0, 0x54, 0xFD, 0x4E, 0xFE, 0xF0, 0xEF, -+0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFE, -+0x54, 0x08, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xFF, 0x90, 0xA4, 0x21, 0xF0, 0xEE, 0x54, 0x10, 0xFE, -+0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFE, 0x54, 0x20, 0xFD, -+0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0xA4, 0x21, 0xF0, 0xEE, 0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, -+0x4E, 0xF0, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x37, 0xEF, 0xC3, 0x13, 0x20, -+0xE0, 0x0E, 0x90, 0xA5, 0x48, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x64, 0xE0, 0x60, 0x0D, 0x80, 0x12, -+0xE4, 0x90, 0xA5, 0x48, 0xF0, 0x90, 0xA4, 0x64, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0xA5, 0x47, 0xF0, -+0x80, 0x06, 0x90, 0xA5, 0x47, 0x74, 0x01, 0xF0, 0x90, 0xA5, 0x47, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, -+0x12, 0x75, 0xCC, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x51, 0xB0, 0x90, 0x01, 0xB9, 0x74, 0x01, -+0xF0, 0x90, 0x01, 0xB8, 0xF0, 0x90, 0xA4, 0x0B, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0xA4, 0x0D, -+0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, 0x90, 0x01, 0xBE, 0xF0, 0x22, -+0x90, 0xA5, 0x49, 0x12, 0x4B, 0x9D, 0x51, 0xDF, 0x90, 0xA4, 0x0B, 0xE0, 0xFF, 0x12, 0x5F, 0x26, -+0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x18, 0x90, 0xA5, 0x49, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x01, 0x12, -+0x26, 0x37, 0x54, 0x0F, 0xFF, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x51, 0xF0, 0x22, 0x90, -+0xA4, 0x08, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA4, 0x14, 0xF0, 0x90, 0xA4, 0x0F, 0xF0, 0x22, -+0xEF, 0x24, 0xFE, 0x60, 0x0C, 0x04, 0x70, 0x28, 0x90, 0xA4, 0x11, 0x74, 0x01, 0xF0, 0xA3, 0xF0, -+0x22, 0xED, 0x70, 0x0A, 0x90, 0xA4, 0x1F, 0xE0, 0x90, 0xA4, 0x11, 0xF0, 0x80, 0x05, 0x90, 0xA4, -+0x11, 0xED, 0xF0, 0x90, 0xA4, 0x11, 0xE0, 0xA3, 0xF0, 0x90, 0xA4, 0x09, 0xE0, 0x44, 0x08, 0xF0, -+0x22, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x30, 0xE0, 0x26, 0x12, 0x26, 0x1E, 0x90, 0xA4, -+0x1C, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x1D, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, -+0xA3, 0xE0, 0x54, 0x01, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x1F, 0xF0, -+0x22, 0x90, 0xA4, 0x1C, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, -+0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0xA4, 0x22, 0xF0, 0x60, 0x37, -+0x90, 0xA4, 0x27, 0xE0, 0x20, 0xE0, 0x30, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x5C, 0x92, 0x90, 0xA4, -+0x21, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x1F, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, -+0x16, 0x90, 0xA4, 0x21, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, -+0x0D, 0xF0, 0x80, 0x03, 0x74, 0x09, 0xF0, 0x90, 0xA4, 0x22, 0xE0, 0x90, 0x01, 0xE7, 0xF0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x46, 0x12, 0x4B, 0x9D, 0x12, 0x26, 0x1E, -+0xFF, 0x54, 0x01, 0xFE, 0x90, 0xA4, 0x27, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, -+0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, -+0xFB, 0x4D, 0xFF, 0x90, 0xA4, 0x27, 0xF0, 0xEE, 0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, -+0xF0, 0x12, 0x26, 0x1E, 0xFE, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0xA4, 0x27, -+0xF0, 0xEE, 0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFE, 0x54, -+0x80, 0xFD, 0xEF, 0x54, 0x7F, 0x4D, 0x90, 0xA4, 0x27, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, -+0xFF, 0x54, 0x01, 0xFD, 0x90, 0xA4, 0x2A, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEF, 0x54, 0x02, -+0xFF, 0xED, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFD, 0x54, 0x04, -+0xFC, 0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0xA4, 0x2A, 0xF0, 0xED, 0x54, 0x10, 0xFD, 0xEF, 0x54, -+0xEF, 0x4D, 0xFF, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFD, 0x54, 0x20, 0xFC, 0xEF, 0x54, -+0xDF, 0x4C, 0xFF, 0x90, 0xA4, 0x2A, 0xF0, 0xED, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, 0x4D, 0xFF, -+0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x54, 0x80, 0xFD, 0xEF, 0x54, 0x7F, 0x4D, 0x90, 0xA4, -+0x2A, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, 0x54, 0x20, 0xFD, 0x90, 0xA4, 0x2B, 0xE0, -+0x54, 0xDF, 0x4D, 0xFD, 0xF0, 0xEF, 0x54, 0x40, 0xFF, 0xED, 0x54, 0xBF, 0x4F, 0xFF, 0xF0, 0x90, -+0x00, 0x04, 0x12, 0x26, 0x37, 0xFD, 0x54, 0x80, 0xFC, 0xEF, 0x54, 0x7F, 0x4C, 0xFF, 0x90, 0xA4, -+0x2B, 0xF0, 0xED, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0xF0, 0x90, 0x00, 0x04, 0x12, -+0x26, 0x37, 0xFD, 0x54, 0x10, 0xFC, 0xEF, 0x54, 0xEF, 0x4C, 0xFF, 0x90, 0xA4, 0x2B, 0xF0, 0xED, -+0x54, 0x08, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xF0, 0xEE, 0x20, 0xE0, 0x02, 0xC1, 0x51, 0x90, 0x05, -+0x54, 0xE0, 0xC3, 0x13, 0x90, 0xA4, 0x37, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x54, 0x0F, 0x30, -+0xE0, 0x1C, 0x90, 0xA5, 0x46, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, -+0x28, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x29, 0xF0, 0x80, 0x4E, 0x90, 0xA5, -+0x46, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, -+0xEF, 0xC3, 0x94, 0x03, 0x90, 0xA4, 0x28, 0x50, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, -+0x80, 0x06, 0x90, 0xA4, 0x28, 0x74, 0x2A, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xC3, -+0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, 0x94, 0x03, 0x90, 0xA4, 0x29, 0x50, 0x05, 0x74, 0x03, 0xF0, -+0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, 0x90, 0xA4, 0x29, 0x74, 0x2A, 0xF0, 0x90, 0xA4, 0x2B, 0xE0, -+0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x3C, 0x90, 0xA4, 0x28, 0xE0, 0x75, 0xF0, 0x03, 0x84, -+0x90, 0xA4, 0x30, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0xA4, 0x29, 0xE0, 0x75, 0xF0, 0x03, -+0x84, 0x90, 0xA4, 0x32, 0xF0, 0x90, 0xA4, 0x28, 0xE0, 0xC3, 0x13, 0x90, 0xA4, 0x33, 0xF0, 0x90, -+0xA4, 0x29, 0xE0, 0xC3, 0x13, 0x90, 0xA4, 0x34, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, -+0x7F, 0x02, 0xD1, 0xF9, 0xE4, 0x90, 0xA4, 0x62, 0xF0, 0x90, 0xA5, 0x46, 0x12, 0x4B, 0x94, 0x90, -+0x00, 0x03, 0x12, 0x26, 0x37, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x30, 0x12, 0x26, 0x1E, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x08, 0x90, 0xA4, 0x64, 0xE0, 0x60, 0x08, 0x80, 0x0E, -+0x90, 0xA4, 0x64, 0xE0, 0x60, 0x08, 0x90, 0xA5, 0x44, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, -+0xA5, 0x44, 0xF0, 0x90, 0xA5, 0x44, 0xE0, 0xFF, 0x7D, 0x02, 0x12, 0x75, 0xCC, 0x90, 0xA4, 0x27, -+0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1B, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, -+0xE0, 0x06, 0x90, 0xA4, 0x0D, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x74, -+0x11, 0xF0, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0xA4, 0x2F, 0xE0, 0xFF, 0xB4, 0x01, 0x08, -+0x90, 0xA4, 0x39, 0x74, 0x01, 0xF0, 0x80, 0x22, 0xEF, 0xB4, 0x04, 0x08, 0x90, 0xA4, 0x39, 0x74, -+0x04, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x06, 0x08, 0x90, 0xA4, 0x39, 0x74, 0x02, 0xF0, 0x80, 0x0A, -+0xEF, 0xB4, 0x07, 0x06, 0x90, 0xA4, 0x39, 0x74, 0x05, 0xF0, 0xE4, 0x90, 0xA4, 0x2F, 0xF0, 0x80, -+0x61, 0x90, 0xA5, 0x46, 0x12, 0x4B, 0x94, 0x12, 0x26, 0x1E, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0x30, 0xE0, 0x08, 0x90, 0xA5, 0x45, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA5, 0x45, 0xF0, -+0x12, 0xB6, 0xCE, 0x7D, 0x20, 0x7F, 0x40, 0x12, 0x3A, 0x96, 0x90, 0xA5, 0x46, 0x12, 0x4B, 0x94, -+0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0x07, 0x78, 0x30, 0xE0, -+0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xA5, 0x45, 0xE0, 0xFD, 0x7F, 0x02, -+0x12, 0x75, 0xCC, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x74, -+0x43, 0xF0, 0x90, 0xA4, 0x2D, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0xA4, 0x38, 0xF0, 0x90, 0xA4, -+0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x09, 0x90, 0xA4, 0x55, 0xE0, 0x44, -+0x02, 0xF0, 0x80, 0x0C, 0x7F, 0x01, 0x12, 0xB4, 0xA0, 0x90, 0xA4, 0x55, 0xE0, 0x54, 0xFD, 0xF0, -+0x7F, 0x03, 0x12, 0x75, 0x89, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x14, 0x90, 0x05, 0x73, 0xF0, -+0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, -+0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0xA4, -+0x76, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x0E, 0xE0, 0x64, 0x02, 0x60, 0x29, 0xF1, 0x46, 0x90, 0xA4, -+0x09, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x15, 0x90, 0xA4, 0x11, 0xE0, 0xFF, 0xA3, -+0xE0, 0x6F, 0x70, 0x0B, 0xD1, 0xEA, 0x12, 0x5F, 0x5D, 0x90, 0xA4, 0x12, 0xE0, 0x14, 0xF0, 0x90, -+0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA3, 0x87, 0xE0, 0x64, 0x01, 0x60, 0x02, 0xE1, 0xDB, -+0x90, 0xA4, 0x0B, 0xE0, 0x70, 0x02, 0xE1, 0xDB, 0x90, 0xA4, 0x0A, 0xE0, 0xC4, 0x54, 0x0F, 0x64, -+0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0xA4, 0x12, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, -+0xA4, 0x11, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0xA4, 0x11, 0xE0, 0xFE, 0xFF, 0x80, 0x00, -+0x90, 0xA4, 0x12, 0xEF, 0xF0, 0x90, 0xA4, 0x09, 0xE0, 0x44, 0x04, 0xF0, 0xE4, 0x90, 0xA4, 0x14, -+0xF0, 0x90, 0xA4, 0x16, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, -+0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA4, 0x0F, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x90, -+0xA4, 0x0A, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x03, 0x12, 0xBA, 0x0F, -+0x90, 0xA4, 0x09, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0F, 0x90, 0xA4, 0x11, 0xE0, -+0xFF, 0xA3, 0xE0, 0xB5, 0x07, 0x05, 0xD1, 0xEA, 0x12, 0x5F, 0x63, 0x22, 0x90, 0xA5, 0x44, 0x12, -+0x4B, 0x9D, 0x90, 0xA6, 0x2B, 0xE0, 0x70, 0x13, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x90, -+0xA4, 0x5C, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x2B, 0x74, 0x01, 0xF0, 0x90, 0xA5, 0x44, 0x12, 0x4B, -+0x94, 0x12, 0x26, 0x1E, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA5, 0x47, 0x12, 0x27, 0x48, 0x90, -+0xA4, 0x5C, 0x12, 0x4B, 0x50, 0xEC, 0x54, 0xC1, 0xFC, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -+0x07, 0x90, 0xA5, 0x47, 0x12, 0x4B, 0x50, 0x78, 0x19, 0x12, 0x27, 0x35, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0x12, 0x4B, 0x32, 0x90, 0xA4, 0x58, 0x02, 0x27, 0x48, 0x12, 0x26, 0x1E, -+0x90, 0xA4, 0x4A, 0xF0, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA6, 0x43, 0xF0, 0x90, -+0xA6, 0x43, 0xE0, 0xFD, 0x70, 0x02, 0x21, 0xF9, 0x90, 0xA2, 0xEB, 0xE0, 0xFF, 0x70, 0x06, 0xA3, -+0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA2, 0xEC, 0xE0, 0xB5, 0x07, 0x04, 0x7F, -+0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, -+0x90, 0xA6, 0x2C, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, -+0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, 0xF2, 0x90, 0xA6, 0x2C, 0xE0, -+0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA6, 0x44, 0xF0, 0x75, 0x40, -+0x01, 0x75, 0x41, 0xA6, 0x75, 0x42, 0x44, 0x75, 0x43, 0x01, 0x7B, 0x01, 0x7A, 0xA6, 0x79, 0x45, -+0x12, 0x34, 0x2C, 0x90, 0xA6, 0x2C, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x4B, 0x88, -+0xE0, 0xFF, 0x90, 0xA2, 0xEC, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0xA2, 0x9B, 0x12, 0x4B, 0x88, -+0xEF, 0xF0, 0x90, 0xA6, 0x2C, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD1, 0x12, 0x4B, 0x88, 0xE0, -+0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0xA2, 0x9C, 0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x90, 0xA6, 0x2C, -+0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD2, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, -+0x90, 0xA2, 0x9D, 0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x90, 0xA6, 0x2C, 0xE0, 0x75, 0xF0, 0x04, 0x90, -+0x01, 0xD3, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0xA2, 0x9E, 0x12, 0x4B, -+0x88, 0xEF, 0xF0, 0x90, 0xA6, 0x2C, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF0, 0x12, 0x4B, 0x88, -+0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0xA2, 0x9F, 0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x90, 0xA6, -+0x2C, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF1, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x08, -+0xEE, 0x90, 0xA2, 0xA0, 0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x90, 0xA6, 0x2C, 0xE0, 0x75, 0xF0, 0x04, -+0x90, 0x01, 0xF2, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0xA2, 0xA1, 0x12, -+0x4B, 0x88, 0xEF, 0xF0, 0x90, 0xA6, 0x2C, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF3, 0x12, 0x4B, -+0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0xA2, 0xA2, 0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x90, -+0xA6, 0x43, 0xE0, 0xFF, 0x90, 0xA6, 0x2C, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0xA6, 0x43, 0xF0, 0x90, 0xA6, 0x2C, 0xE0, 0xFF, 0x74, -+0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0xA6, -+0x2C, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0xA2, 0xEC, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, -+0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x01, 0x4F, 0xE4, 0x90, 0xA2, 0xEC, 0xF0, -+0x01, 0x4F, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, -+0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xEE, 0x74, 0x00, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, -+0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, -+0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA6, 0x33, 0xEF, 0xF0, 0xA3, 0x12, 0x4B, 0x9D, 0x90, 0xA6, -+0x2D, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, 0x76, 0x74, 0x00, 0x2F, 0xF9, -+0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0xA6, 0x34, 0x12, -+0x4B, 0x94, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, -+0x03, 0x12, 0x34, 0x2C, 0x90, 0xA6, 0x33, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, -+0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x4B, 0x94, 0xE9, 0x24, 0x02, 0xF9, 0xE4, -+0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0xA6, 0x34, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x0E, -+0x12, 0x26, 0x37, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x2C, 0x90, 0x01, -+0x34, 0xE0, 0x55, 0x5D, 0xF5, 0x61, 0xA3, 0xE0, 0x55, 0x5E, 0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, -+0xF5, 0x63, 0xA3, 0xE0, 0x55, 0x60, 0xF5, 0x64, 0x90, 0x01, 0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, -+0x62, 0xF0, 0xA3, 0xE5, 0x63, 0xF0, 0xA3, 0xE5, 0x64, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, -+0x65, 0xF5, 0x69, 0xA3, 0xE0, 0x55, 0x66, 0xF5, 0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, -+0xE0, 0x55, 0x68, 0xF5, 0x6C, 0x90, 0x01, 0x3C, 0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, -+0xE5, 0x6B, 0xF0, 0xA3, 0xE5, 0x6C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0xA3, 0x87, 0xE0, 0x64, -+0x01, 0x70, 0x2A, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, -+0x3C, 0x74, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x1D, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, -+0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x22, 0x90, 0xA3, -+0x87, 0xE0, 0x64, 0x01, 0x70, 0x26, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x20, 0x90, 0x01, 0x57, 0xE4, -+0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA4, -+0x0F, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x77, 0xBF, 0x22, 0x90, 0xA3, 0x87, -+0xE0, 0xB4, 0x01, 0x14, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x0E, 0x90, 0xA4, 0x0F, 0xE0, 0x54, 0xFE, -+0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x77, 0xBF, 0x22, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x03, 0x12, -+0x5E, 0xF7, 0x22, 0x71, 0xFC, 0x90, 0xA5, 0x6E, 0xEF, 0xF0, 0x90, 0xA4, 0x08, 0x30, 0xE0, 0x06, -+0xE0, 0x44, 0x01, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA5, 0x6E, 0xE0, 0x30, 0xE6, -+0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, -+0x80, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0xA4, 0x16, 0xE4, 0xF0, 0xA3, 0x74, -+0x05, 0xF0, 0x90, 0xA4, 0x16, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0xE4, 0x90, 0xA5, 0x6F, -+0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, 0xA5, 0x6F, 0xF0, 0x90, 0x00, 0x83, -+0xE0, 0xFE, 0x90, 0xA5, 0x6F, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0xA5, 0x71, 0xE0, -+0x94, 0x64, 0x90, 0xA5, 0x70, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, -+0xF0, 0x90, 0xA5, 0x6F, 0xE0, 0xFF, 0x22, 0x90, 0xA5, 0x70, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x4A, -+0x9F, 0x80, 0xC2, 0x22, 0x90, 0xA4, 0x08, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, -+0x3C, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA4, 0x09, 0x30, 0xE0, 0x06, 0xE0, -+0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, -+0x01, 0xB8, 0x74, 0x04, 0xF0, 0x90, 0xA4, 0x2D, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, -+0x09, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x5C, 0x92, 0x80, 0x03, 0x12, 0x77, 0xBF, 0xE4, 0xFF, 0x90, -+0xA4, 0x71, 0xE0, 0x30, 0xE0, 0x47, 0x90, 0xA4, 0x75, 0xE0, 0xFD, 0x60, 0x40, 0x74, 0x01, 0x7E, -+0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, -+0xE0, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x06, 0xE4, 0x90, 0xA4, 0x75, 0xF0, 0x22, 0x90, 0xA4, 0x73, -+0xE0, 0xD3, 0x9D, 0x50, 0x10, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0xD1, 0xEF, 0x90, 0xA4, 0x71, -+0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x91, 0xDE, 0x90, 0xA4, 0x75, 0xE0, 0x04, 0xF0, 0x22, 0xE4, 0xFF, -+0x80, 0x09, 0x90, 0xA4, 0x2E, 0xE0, 0x44, 0x02, 0xF0, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x8F, 0x1F, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1E, 0x90, 0x05, 0x22, 0xE0, 0xF5, 0x22, -+0x74, 0xFF, 0xF0, 0x12, 0x8A, 0x0D, 0xBF, 0x01, 0x07, 0xAF, 0x1F, 0x12, 0xBB, 0x87, 0xB1, 0xA7, -+0x90, 0x05, 0x22, 0xE5, 0x22, 0xF0, 0x80, 0x02, 0xB1, 0xA7, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, -+0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x52, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x47, 0x90, -+0xA4, 0x3D, 0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x50, 0x13, 0xEF, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x74, -+0x2B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0x74, 0x2B, 0x2D, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x7F, 0xF0, 0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xEF, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x90, 0xA2, 0x98, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x77, -+0x51, 0x8E, 0x20, 0x8F, 0x21, 0xAD, 0x21, 0xAC, 0x20, 0xAF, 0x1F, 0xB1, 0x27, 0xAF, 0x21, 0xAE, -+0x20, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x01, 0xF0, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, -+0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xED, 0xF0, 0x22, 0x90, 0xA2, 0x9A, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x77, 0x51, 0x90, -+0xA5, 0x74, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA5, 0x71, 0xE0, 0xFF, 0xA3, 0xE0, -+0xFB, 0xA3, 0xE0, 0x90, 0xA5, 0x7B, 0xF0, 0x90, 0xA5, 0x78, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, -+0xEB, 0xF0, 0x90, 0xA5, 0x78, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xB1, 0x27, 0x90, 0xA5, 0x78, 0xA3, -+0xE0, 0xFF, 0xFD, 0x24, 0x0D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, -+0x74, 0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xEF, 0xF0, 0x74, 0x12, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x02, 0xF0, 0x74, 0x12, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0xA5, 0x7A, 0xE0, 0xFF, 0x90, -+0xA5, 0x78, 0xA3, 0xE0, 0xFE, 0x24, 0x2A, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, -+0x90, 0xA5, 0x7B, 0xE0, 0xFF, 0x74, 0x2B, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, -+0xF0, 0x74, 0x2C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x22, 0x90, -+0xA2, 0x95, 0xE0, 0x64, 0x02, 0x60, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, -+0xA4, 0x6E, 0xE0, 0x30, 0xE0, 0x2D, 0x90, 0xA3, 0x87, 0xE0, 0xB4, 0x01, 0x26, 0x90, 0xA6, 0x61, -+0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0xA4, 0x70, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0xA6, -+0x61, 0xF0, 0x90, 0xA4, 0x70, 0xE0, 0xFF, 0x90, 0xA4, 0x6F, 0xE0, 0xB5, 0x07, 0x05, 0xE4, 0xA3, -+0xF0, 0x91, 0xDE, 0x22, 0x90, 0xA4, 0x71, 0xE0, 0x30, 0xE0, 0x35, 0x90, 0xA4, 0x74, 0xE0, 0x04, -+0xF0, 0xE0, 0xFF, 0x90, 0xA4, 0x72, 0xE0, 0x6F, 0x70, 0x26, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, -+0x10, 0x90, 0xA4, 0x76, 0xE0, 0x70, 0x0A, 0x91, 0xDE, 0x90, 0xA4, 0x75, 0xE0, 0x04, 0xF0, 0x80, -+0x06, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA4, 0x74, 0xF0, 0x90, 0xA4, 0x76, 0xF0, -+0x22, 0xEF, 0x60, 0x3D, 0x90, 0xA3, 0x87, 0xE0, 0x64, 0x01, 0x70, 0x35, 0x90, 0xA4, 0x09, 0xE0, -+0x54, 0xFE, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, -+0xE4, 0xFF, 0x91, 0xEB, 0xBF, 0x01, 0x0E, 0x90, 0xA4, 0x08, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA4, -+0x0E, 0x74, 0x06, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x08, -+0xF0, 0x22, 0x90, 0xA4, 0x08, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x4A, -+0xEF, 0x54, 0x7F, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA4, 0x09, 0x30, 0xE1, 0x06, 0xE0, 0x44, -+0x02, 0xF0, 0x80, 0x0F, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, -+0xB8, 0x04, 0xF0, 0x90, 0xA4, 0x2B, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x11, -+0x90, 0xA4, 0x2E, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xEF, 0x44, 0x04, 0xF0, 0x54, 0xFD, -+0xF0, 0x90, 0xA4, 0x0B, 0xE0, 0x60, 0x03, 0x12, 0x77, 0xBF, 0x7F, 0x01, 0x02, 0x84, 0x8F, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, 0xE0, -+0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, 0xC6, 0xE0, 0x30, -+0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC3, 0xEE, 0x94, -+0x01, 0x40, 0x0A, 0x0D, 0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xC3, 0xEE, -+0x94, 0x01, 0x40, 0x1E, 0x90, 0xFD, 0x11, 0xE0, 0xB5, 0x05, 0x14, 0x90, 0x01, 0x17, 0xE0, 0xB5, -+0x05, 0x07, 0x90, 0xFD, 0x11, 0xE4, 0xF0, 0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, 0x11, 0xF0, 0xE4, -+0x2F, 0xFF, 0x22, 0xFB, 0x7D, 0x08, 0x7F, 0x01, 0x90, 0xA6, 0x50, 0xEB, 0xF0, 0xEF, 0x70, 0x06, -+0xA3, 0x74, 0x03, 0xF0, 0x80, 0x0B, 0xEF, 0x64, 0x01, 0x70, 0x35, 0x90, 0xA6, 0x51, 0x74, 0x42, -+0xF0, 0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, 0xA6, 0x50, 0xE0, 0xFD, 0x7F, 0xE0, 0x12, 0x3A, 0x96, -+0x90, 0xA6, 0x51, 0xE0, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x90, 0xA6, 0x51, 0xE0, 0x54, 0xFD, -+0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x7F, 0x01, 0x22, -+0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x51, 0x0D, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, -+0xA6, 0x15, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x15, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, -+0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA6, 0x15, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x15, 0x12, 0x4B, 0x50, -+0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, -+0xE0, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x3A, 0x96, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, -+0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0xA6, 0x15, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x15, 0x12, 0x4B, -+0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x01, -+0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, -+0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x90, 0xA4, 0x18, 0x12, 0x27, 0x48, 0x90, 0xAC, 0xB9, -+0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, -+0xA4, 0x21, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x06, 0x90, 0x07, 0x78, 0x74, -+0x01, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x3C, 0x90, 0xA4, 0x64, 0xE0, 0x60, 0x08, 0x90, 0xA6, -+0x19, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA6, 0x19, 0xF0, 0x90, 0xA4, 0x21, 0xE0, 0xC4, -+0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA6, 0x1A, 0xF0, 0x80, 0x06, 0x90, 0xA6, 0x1A, -+0x74, 0x02, 0xF0, 0x90, 0xA6, 0x19, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x75, 0xCC, 0x90, 0x07, -+0x78, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x20, 0xE0, 0x60, 0x02, 0xE4, 0xF0, 0x90, 0x00, 0xFF, 0xE0, -+0x70, 0x10, 0x7B, 0x01, 0x7A, 0xA6, 0x79, 0x14, 0x51, 0x5B, 0x90, 0xA6, 0x14, 0xE0, 0x44, 0x18, -+0x11, 0x73, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0xE4, 0x90, 0xA6, -+0x52, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, -+0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0xA6, 0x53, 0xE0, 0x94, 0xE8, -+0x90, 0xA6, 0x52, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x7F, -+0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA6, 0x52, 0xE4, 0x75, 0xF0, 0x01, -+0x12, 0x4A, 0x9F, 0x80, 0xBF, 0x7B, 0x01, 0x7A, 0xA6, 0x79, 0x13, 0x7D, 0x08, 0x7F, 0x01, 0x90, -+0xA6, 0x3F, 0x12, 0x4B, 0x9D, 0xEF, 0x70, 0x07, 0x90, 0xA6, 0x42, 0x04, 0xF0, 0x80, 0x0B, 0xEF, -+0x64, 0x01, 0x70, 0x2E, 0x90, 0xA6, 0x42, 0x74, 0x40, 0xF0, 0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, -+0xA6, 0x42, 0xE0, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x90, 0x00, 0xE1, 0xE0, 0xFF, 0x90, 0xA6, -+0x3F, 0x12, 0x4B, 0x94, 0xEF, 0x12, 0x26, 0x64, 0xE4, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x7F, -+0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x18, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, -+0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA4, 0x18, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, -+0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x10, 0xE0, 0x44, 0x0C, 0xFD, -+0x7F, 0x10, 0x12, 0x3A, 0x96, 0x90, 0x00, 0x72, 0xE0, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x3A, -+0x96, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0xA4, -+0x21, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x06, 0x90, 0x07, 0x78, 0x74, 0x03, -+0xF0, 0x90, 0xA4, 0x41, 0xE0, 0x20, 0xE0, 0x3A, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x34, 0x90, 0xA4, -+0x64, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0xA6, 0x11, 0xF0, 0x80, 0x06, 0x90, 0xA6, 0x11, 0x74, 0x01, -+0xF0, 0x90, 0xA4, 0x21, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0xA6, 0x12, 0x30, 0xE0, 0x05, 0x74, -+0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0xA6, 0x11, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, -+0x75, 0xCC, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x7F, 0xB4, -+0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xBF, 0xFF, 0xEC, 0x90, 0xA6, 0x0D, 0x12, 0x27, 0x48, -+0x90, 0xA6, 0x0D, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB4, 0x7E, 0x08, -+0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x12, 0x3A, 0x96, 0x7F, -+0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0xA6, 0x0D, 0x12, 0x27, -+0x48, 0x90, 0xA6, 0x0D, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, -+0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, -+0x90, 0xA6, 0x0D, 0x12, 0x27, 0x48, 0x90, 0xA6, 0x0D, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, -+0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x1A, 0x51, -+0x55, 0x90, 0xA6, 0x13, 0xE0, 0x54, 0xE7, 0x11, 0x73, 0x51, 0x55, 0x90, 0xA6, 0x13, 0xE0, 0x54, -+0x18, 0x70, 0x06, 0x90, 0x01, 0xBF, 0xE0, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, -+0xA5, 0x39, 0xF0, 0xE4, 0x90, 0xA5, 0x3A, 0xF0, 0x90, 0xA5, 0x3A, 0xE0, 0xFF, 0xC3, 0x94, 0x10, -+0x50, 0x75, 0x90, 0xA5, 0x39, 0xE0, 0xFE, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, -+0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x90, 0xA5, 0x3A, 0xB4, 0x03, 0x1B, 0xE0, 0xFF, 0x75, 0xF0, 0x10, -+0xEE, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, -+0x83, 0x74, 0x80, 0xF0, 0x80, 0x1B, 0xE0, 0xFF, 0x90, 0xA5, 0x39, 0xE0, 0x75, 0xF0, 0x10, 0x90, -+0x81, 0x00, 0x12, 0x4B, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, -+0xF0, 0x90, 0xA5, 0x3A, 0xE0, 0xFF, 0x90, 0xA5, 0x39, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, -+0x12, 0x4B, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x90, -+0xA5, 0x3A, 0xE0, 0x04, 0xF0, 0x80, 0x81, 0x90, 0xA5, 0x39, 0xE0, 0x04, 0xF0, 0xE0, 0x64, 0x80, -+0x60, 0x02, 0x81, 0x03, 0xE4, 0x90, 0xAF, 0x7D, 0xF0, 0x90, 0xA5, 0x39, 0xF0, 0x90, 0xA5, 0x39, -+0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, -+0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, -+0xEF, 0x90, 0x8D, 0x05, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, -+0x8D, 0x07, 0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, -+0x12, 0x4B, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x9D, 0x92, 0xF0, 0x74, 0x92, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0xA0, 0xF5, 0x83, 0x74, 0x3F, 0xF0, 0x74, 0x92, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, -+0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x92, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE4, 0xF0, -+0x74, 0x81, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x74, 0xC0, 0xF0, 0xEF, 0x25, 0xE0, -+0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x12, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE4, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, -+0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, -+0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x92, -+0x12, 0x4B, 0x88, 0x74, 0x3F, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x93, 0x12, 0x4B, 0x88, -+0x74, 0x03, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0xE0, -+0x44, 0x09, 0xF0, 0x90, 0xA5, 0x39, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, 0x12, 0x4B, -+0x88, 0xE0, 0x54, 0xF3, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, -+0x54, 0xFC, 0xF0, 0x90, 0xA5, 0x39, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x94, 0x12, 0x4B, -+0x88, 0xE0, 0x44, 0x20, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, -+0x54, 0xCF, 0xF0, 0x90, 0xA5, 0x39, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, 0x12, 0x4B, -+0x88, 0xE0, 0x44, 0x40, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, -+0x54, 0x7F, 0xF0, 0x90, 0xA5, 0x39, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x92, 0x12, 0x4B, -+0x88, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xEE, 0xF0, 0x90, -+0xA5, 0x39, 0xE0, 0xFF, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0x74, 0x05, 0xF0, -+0x74, 0x92, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA5, 0x39, 0xE0, -+0x04, 0xF0, 0xE0, 0x64, 0x80, 0x60, 0x02, 0x81, 0x9D, 0xE4, 0x90, 0xA5, 0x3B, 0xF0, 0x90, 0xA5, -+0x3B, 0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x50, 0x14, 0x74, 0x77, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA4, -+0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA5, 0x3B, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x90, 0x04, 0x49, 0x74, -+0xF0, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0x33, 0x74, 0x02, 0xF0, 0xA3, -+0x74, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0x90, 0xA5, 0x39, 0xE0, -+0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0xE1, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xE4, -+0xA3, 0xF0, 0x90, 0xA5, 0xE4, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x14, 0x74, 0xE6, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA5, 0xE4, 0xE0, 0x04, 0xF0, 0x80, 0xE2, -+0x90, 0xA5, 0xE3, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x54, -+0x03, 0x90, 0xA5, 0xEE, 0xF0, 0x64, 0x01, 0x70, 0x52, 0x90, 0xA5, 0xE3, 0xE0, 0xFF, 0x75, 0xF0, -+0x08, 0x90, 0x89, 0x00, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0xE6, 0xF0, 0x75, 0xF0, 0x08, 0xEF, -+0x90, 0x89, 0x01, 0x12, 0x4B, 0x88, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA5, 0xE7, 0xF0, 0xE4, 0xA3, -+0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xEE, 0x54, 0xF0, 0xA3, 0xF0, 0x90, 0xA5, 0xE3, 0xE0, 0x75, 0xF0, -+0x08, 0x90, 0x89, 0x02, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0xEC, 0xF0, 0x75, 0xF0, 0x08, 0xEF, -+0x90, 0x89, 0x03, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0xED, 0xF0, 0x90, 0xA5, 0xEE, 0xE0, 0xFC, -+0xC3, 0x94, 0x02, 0x40, 0x64, 0x90, 0xA5, 0xE3, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, -+0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0xE6, 0xF0, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x89, 0x01, 0x12, -+0x4B, 0x88, 0xE0, 0x90, 0xA5, 0xE7, 0xF0, 0x90, 0xA5, 0xE3, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, -+0x02, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0xE8, 0xF0, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x89, 0x03, -+0x12, 0x4B, 0x88, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA5, 0xE9, 0xF0, 0xEE, 0x54, 0xF0, 0x90, 0xA5, -+0xE5, 0xF0, 0xEC, 0xB4, 0x03, 0x0B, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x90, 0xA5, 0xED, 0xF0, 0x80, -+0x08, 0x90, 0xA5, 0xE5, 0xE0, 0x90, 0xA5, 0xEC, 0xF0, 0xE4, 0x90, 0xA5, 0xE4, 0xF0, 0x90, 0xA5, -+0xE4, 0xE0, 0xFF, 0x24, 0xE6, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, -+0xE0, 0xFE, 0xEF, 0xFD, 0x90, 0xA5, 0xE2, 0xE0, 0x2D, 0xFD, 0x90, 0xA5, 0xE1, 0xE0, 0x34, 0x00, -+0x8D, 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA5, 0xE4, -+0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xC7, 0x90, 0xA5, 0xEB, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x70, -+0x08, 0xA3, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x37, 0x90, 0xA5, 0xEE, 0xE0, 0x64, 0x01, 0x70, -+0x2F, 0x90, 0xA5, 0xE7, 0xE0, 0x54, 0x0F, 0xFE, 0x90, 0xA5, 0xE5, 0xF0, 0xEF, 0x54, 0xF0, 0x4E, -+0xF0, 0x90, 0xA5, 0xE7, 0xF0, 0x90, 0xA5, 0xEC, 0xE0, 0x90, 0xA5, 0xE8, 0xF0, 0x90, 0xA5, 0xED, -+0xE0, 0x90, 0xA5, 0xE9, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x80, 0xF0, -+0x90, 0xA5, 0xEE, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, 0x26, 0xEF, 0x90, 0xA5, 0xE9, 0xB4, 0x02, -+0x08, 0xE0, 0xFF, 0x90, 0xA5, 0xEC, 0xE0, 0x80, 0x0A, 0xE0, 0xFF, 0x90, 0xA5, 0xED, 0xE0, 0x13, -+0x13, 0x54, 0x3F, 0xFE, 0xEF, 0x4E, 0x90, 0xA5, 0xE9, 0xF0, 0x90, 0xA5, 0xED, 0x74, 0x80, 0xF0, -+0xE4, 0x90, 0xA5, 0xE4, 0xF0, 0x90, 0xA5, 0xE4, 0xE0, 0xFF, 0x24, 0xE6, 0xF5, 0x82, 0xE4, 0x34, -+0xA5, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0xA5, 0xE3, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, -+0x4B, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0xA5, -+0xE4, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xCD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA5, 0x54, -+0xEF, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0x7D, 0xF0, 0x74, 0x90, 0xA3, 0xF0, 0x90, 0xA5, 0x54, 0xE0, -+0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0xB4, 0xBE, 0x02, 0x7F, 0x3F, -+0xEF, 0xB4, 0xB3, 0x02, 0x7F, 0x34, 0x90, 0xA5, 0x55, 0xEF, 0xF0, 0xE4, 0x90, 0xA5, 0x5B, 0xF0, -+0x90, 0xA5, 0x55, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xA3, 0xF0, 0xEF, 0x54, 0x80, 0xA3, 0xF0, 0x90, -+0xA5, 0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x92, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, -+0x59, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0xC4, 0x54, -+0x03, 0x90, 0xA5, 0x5A, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x42, 0x3B, 0x12, 0x4B, 0x88, 0x12, -+0x4B, 0x5C, 0xAD, 0x07, 0x90, 0xA5, 0x54, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, -+0x34, 0x95, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xED, 0xF0, 0x75, 0xF0, 0x04, 0xEB, 0x90, 0x96, 0x95, -+0x12, 0x4B, 0x88, 0xE0, 0xFE, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA5, 0x58, 0xF0, 0x74, 0x92, 0x2B, -+0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x30, 0xE0, 0x40, 0x90, 0xA5, 0x56, 0xE0, 0x64, -+0x3F, 0x70, 0x38, 0x74, 0x3E, 0xF0, 0x75, 0xF0, 0x04, 0xEB, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, -+0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0xA5, 0x55, 0x74, 0xBE, 0xF0, 0x80, 0x08, -+0x90, 0xA5, 0x56, 0xE0, 0x90, 0xA5, 0x55, 0xF0, 0xAF, 0x03, 0x90, 0xA5, 0x55, 0xE0, 0xFD, 0x90, -+0xA5, 0x58, 0xE0, 0x90, 0xA6, 0x07, 0xF0, 0xE4, 0xFB, 0xC1, 0x49, 0x90, 0xA5, 0x59, 0xE0, 0xFF, -+0x90, 0xA5, 0x56, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0xA1, 0xB4, 0xE0, 0xFF, 0x90, 0xA5, 0x54, 0xE0, -+0xFE, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEF, 0xF0, 0xEF, 0x64, 0x2C, 0x70, -+0x35, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x54, 0x03, 0xFE, -+0x90, 0xA5, 0x58, 0xE0, 0x6E, 0x60, 0x1F, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, -+0xE0, 0xFE, 0x90, 0xA5, 0x54, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xEF, -+0x54, 0xF3, 0x4E, 0xF0, 0xA1, 0xAE, 0x90, 0xA5, 0x56, 0xE0, 0xFF, 0xC3, 0x94, 0x3D, 0x40, 0x22, -+0xEF, 0xD3, 0x94, 0x3F, 0x50, 0x1C, 0xA3, 0xE0, 0x70, 0x18, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0x90, -+0xA5, 0x56, 0xE0, 0x44, 0x80, 0xFD, 0x90, 0xA5, 0x58, 0xE0, 0x90, 0xA6, 0x07, 0xF0, 0x7B, 0x01, -+0xC1, 0x49, 0x90, 0xA5, 0x56, 0xE0, 0xFF, 0xC3, 0x94, 0x0C, 0x40, 0x1F, 0xEF, 0x94, 0x13, 0x50, -+0x1A, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, -+0xFE, 0x20, 0xE3, 0x07, 0x90, 0xA5, 0x5B, 0x74, 0x01, 0x80, 0x27, 0x90, 0xA5, 0x56, 0xE0, 0xFF, -+0xC3, 0x94, 0x2C, 0x40, 0x2E, 0xEF, 0x94, 0x35, 0x50, 0x29, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0x24, -+0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFE, 0x20, 0xE3, 0x16, 0x90, 0xA5, 0x5B, -+0x74, 0x02, 0xF0, 0x74, 0x92, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEE, 0x44, 0x08, -+0xF0, 0x80, 0x16, 0xE4, 0x90, 0xA5, 0x5B, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0x24, 0x92, 0xF5, 0x82, -+0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0xA5, 0x5B, 0xE0, 0x64, 0x01, 0x60, -+0x02, 0x61, 0x59, 0x90, 0xA5, 0x54, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x4B, 0x88, -+0xE0, 0x20, 0xE7, 0x1C, 0x20, 0xE6, 0x19, 0x20, 0xE5, 0x16, 0x20, 0xE4, 0x13, 0x90, 0xA5, 0x54, -+0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x12, 0x4B, 0x88, 0xE0, 0x20, 0xE0, 0x02, 0x61, 0x59, -+0x90, 0xA5, 0x54, 0xE0, 0xFF, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x44, -+0x04, 0xF0, 0x90, 0xA5, 0x56, 0xE0, 0xFE, 0xB4, 0x0C, 0x0C, 0x74, 0x14, 0xF0, 0x90, 0xA5, 0x55, -+0xF0, 0x74, 0x12, 0x2F, 0x80, 0x14, 0xEE, 0xB4, 0x0D, 0x1C, 0x90, 0xA5, 0x56, 0x74, 0x15, 0xF0, -+0x90, 0xA5, 0x55, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, -+0x83, 0x74, 0x05, 0xF0, 0x80, 0x5F, 0x90, 0xA5, 0x56, 0xE0, 0xFF, 0xB4, 0x0E, 0x04, 0x74, 0x15, -+0x80, 0x09, 0xEF, 0xB4, 0x0F, 0x1C, 0x90, 0xA5, 0x56, 0x74, 0x16, 0xF0, 0x90, 0xA5, 0x55, 0xF0, -+0x90, 0xA5, 0x54, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0x74, 0x03, 0xF0, -+0x80, 0x33, 0x90, 0xA5, 0x56, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x40, 0x04, 0x74, 0x17, 0x80, 0x10, -+0xEF, 0xC3, 0x94, 0x11, 0x40, 0x1F, 0x90, 0xA5, 0x56, 0xE0, 0x94, 0x13, 0x50, 0x17, 0x74, 0x18, -+0xF0, 0x90, 0xA5, 0x55, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, -+0xF5, 0x83, 0x74, 0x02, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA5, 0x58, -+0xE0, 0x90, 0xA6, 0x07, 0xF0, 0x7B, 0x01, 0xC1, 0x49, 0x90, 0xA5, 0x5B, 0xE0, 0x64, 0x02, 0x60, -+0x02, 0x61, 0xFD, 0x90, 0xA5, 0x54, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x4B, 0x88, -+0xE0, 0x20, 0xE6, 0x1A, 0x20, 0xE7, 0x17, 0x90, 0xA5, 0x54, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, -+0x03, 0x12, 0x4B, 0x88, 0xE0, 0x20, 0xE0, 0x06, 0x20, 0xE1, 0x03, 0x30, 0xE2, 0x6F, 0x90, 0xA5, -+0x56, 0xE0, 0xFF, 0x64, 0x2C, 0x60, 0x04, 0xEF, 0xB4, 0x2D, 0x07, 0x90, 0xA5, 0x56, 0x74, 0x36, -+0x80, 0x42, 0xEF, 0x64, 0x2E, 0x60, 0x04, 0xEF, 0xB4, 0x2F, 0x07, 0x90, 0xA5, 0x56, 0x74, 0x37, -+0x80, 0x32, 0xEF, 0xB4, 0x30, 0x07, 0x90, 0xA5, 0x56, 0x74, 0x38, 0x80, 0x27, 0xEF, 0xB4, 0x31, -+0x07, 0x90, 0xA5, 0x56, 0x74, 0x39, 0x80, 0x1C, 0xEF, 0xC3, 0x94, 0x32, 0x40, 0x0D, 0xEF, 0xD3, -+0x94, 0x34, 0x50, 0x07, 0x90, 0xA5, 0x56, 0x74, 0x3A, 0x80, 0x09, 0xEF, 0xB4, 0x35, 0x0A, 0x90, -+0xA5, 0x56, 0x74, 0x3B, 0xF0, 0x90, 0xA5, 0x55, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0xA3, 0xE0, -+0xFD, 0x90, 0xA5, 0x58, 0xE0, 0x90, 0xA6, 0x07, 0xF0, 0x7B, 0x01, 0xC1, 0x49, 0x90, 0xA5, 0x54, -+0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA5, -+0x5A, 0xE0, 0xFF, 0xB4, 0x01, 0x0F, 0x90, 0xA5, 0x56, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, -+0x24, 0xE0, 0xF0, 0x80, 0x27, 0xEF, 0xB4, 0x02, 0x0F, 0x90, 0xA5, 0x56, 0xE0, 0xC3, 0x94, 0x2C, -+0x40, 0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, 0x90, 0xA5, 0x5A, 0xE0, 0xB4, 0x03, 0x0D, 0x90, -+0xA5, 0x56, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, -+0xFF, 0xB4, 0x01, 0x0F, 0x90, 0xA5, 0x59, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE0, -+0xF0, 0x80, 0x27, 0xEF, 0xB4, 0x02, 0x0F, 0x90, 0xA5, 0x59, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, -+0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, 0x90, 0xA5, 0x5A, 0xE0, 0xB4, 0x03, 0x0D, 0x90, 0xA5, 0x59, -+0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA5, 0x56, 0xE0, 0x04, 0xFD, -+0x90, 0xA5, 0x59, 0xE0, 0xFF, 0xED, 0xD3, 0x9F, 0x40, 0x02, 0xA1, 0x20, 0xED, 0x13, 0x13, 0x13, -+0x54, 0x1F, 0xFF, 0x90, 0xA5, 0x54, 0xE0, 0xFC, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x4B, -+0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0x7A, 0x00, 0xED, -+0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -+0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x41, 0x74, 0x12, 0x2C, 0xF5, -+0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0x90, 0xA5, 0x56, 0xB4, 0x13, 0x28, 0x74, 0x18, 0xF0, -+0x90, 0xA5, 0x55, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, -+0xF5, 0x83, 0xE0, 0x44, 0x04, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, -+0x74, 0x05, 0xF0, 0x80, 0x0B, 0xED, 0xF0, 0x90, 0xA5, 0x55, 0xF0, 0x80, 0x03, 0x0D, 0x81, 0x90, -+0x90, 0xA5, 0x5A, 0xE0, 0xFF, 0xB4, 0x01, 0x1A, 0x90, 0xA5, 0x55, 0xE0, 0xFE, 0xD3, 0x94, 0x0B, -+0x40, 0x10, 0xEE, 0x94, 0x34, 0x50, 0x0B, 0xE0, 0x24, 0x20, 0xF0, 0xA3, 0xE0, 0x24, 0x20, 0xF0, -+0x80, 0x31, 0xEF, 0xB4, 0x02, 0x14, 0x90, 0xA5, 0x55, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x0B, 0xE0, -+0x24, 0x18, 0xF0, 0xA3, 0xE0, 0x24, 0x18, 0xF0, 0x80, 0x19, 0x90, 0xA5, 0x5A, 0xE0, 0xB4, 0x03, -+0x12, 0x90, 0xA5, 0x55, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x09, 0xE0, 0x24, 0x22, 0xF0, 0xA3, 0xE0, -+0x24, 0x22, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, -+0x83, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0x37, 0x90, 0xA5, 0x56, 0xE0, 0x64, 0x3F, 0x60, 0x02, 0xC1, -+0x37, 0x74, 0x3E, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0xC4, -+0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0xA5, 0x55, 0x74, 0xBE, 0xF0, 0xC1, 0x37, 0x90, 0xA5, -+0x56, 0xE0, 0x80, 0x7F, 0x90, 0xA5, 0x59, 0xE0, 0xFF, 0x90, 0xA5, 0x56, 0xE0, 0xFE, 0x6F, 0x70, -+0x57, 0x90, 0xA5, 0x55, 0xE0, 0xFF, 0x90, 0xA5, 0x54, 0xE0, 0xFD, 0x24, 0x12, 0xF5, 0x82, 0xE4, -+0x34, 0xA2, 0xF5, 0x83, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, -+0xE0, 0xFD, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x09, 0xEF, 0x20, 0xE7, 0x05, 0xEE, 0x44, 0x80, -+0x80, 0x41, 0x90, 0xA5, 0x56, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x4B, 0x88, 0x12, -+0x4B, 0x5C, 0x90, 0xA5, 0x54, 0xE0, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, -+0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x80, 0x34, 0x90, 0xA5, 0x59, 0xE0, 0xFF, 0x90, 0xA5, 0x54, -+0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0xA5, 0x56, 0xEF, -+0xF0, 0x54, 0x80, 0x90, 0xA5, 0x55, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, -+0xA5, 0x58, 0xE0, 0x90, 0xA6, 0x07, 0xF0, 0x7B, 0x01, 0x12, 0x68, 0xCD, 0x90, 0xA5, 0x55, 0xE0, -+0xFF, 0x22, 0xAD, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x52, 0xF0, 0x74, 0x96, 0xA3, 0xF0, 0x74, 0x92, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x74, 0x92, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0x03, 0x40, 0x46, 0x74, 0x92, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x12, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, -+0x83, 0xE0, 0xFF, 0x74, 0x91, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEF, 0xF0, 0x74, -+0x12, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x24, 0x1E, 0xFF, 0xE4, 0x33, 0xFE, -+0xED, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, 0x81, 0x05, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0x03, 0xF5, 0x1D, -+0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x92, 0x12, 0x4B, 0x88, 0xE0, 0xF5, 0x1E, 0x74, 0x12, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0x54, 0x7F, 0xF5, 0x1C, 0x64, 0x2C, 0x70, 0x2C, -+0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x54, 0x03, 0x65, 0x1D, -+0x60, 0x1A, 0x15, 0x1D, 0xE5, 0x1D, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0x75, 0xF0, 0x04, -+0xED, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xEF, 0x54, 0xF3, 0x4E, 0xF0, 0xE5, 0x1C, 0xD3, 0x95, -+0x1E, 0x40, 0x03, 0x85, 0x1E, 0x1C, 0x74, 0x12, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, -+0xE0, 0x54, 0x80, 0x42, 0x1C, 0xAF, 0x05, 0x90, 0xA6, 0x07, 0xE5, 0x1D, 0xF0, 0xE4, 0xFB, 0xAD, -+0x1C, 0x12, 0x68, 0xCD, 0xAF, 0x1C, 0x22, 0x7D, 0x01, 0xAF, 0x0F, 0x8F, 0x1A, 0xAC, 0x05, 0x90, -+0x01, 0xC4, 0x74, 0x4B, 0xF0, 0x74, 0x97, 0xA3, 0xF0, 0xE5, 0x1A, 0x25, 0xE0, 0x24, 0x12, 0xF5, -+0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x1A, 0x90, -+0x81, 0x00, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0x90, 0xA5, 0x55, 0xF0, 0xBF, 0xBE, 0x03, 0x74, 0x3F, -+0xF0, 0x90, 0xA5, 0x55, 0xE0, 0xB4, 0xB3, 0x03, 0x74, 0x34, 0xF0, 0x90, 0xA5, 0x55, 0xE0, 0x54, -+0x7F, 0x90, 0xA5, 0x54, 0xF0, 0x54, 0x7F, 0xF9, 0x90, 0xA5, 0x5A, 0xF0, 0x75, 0xF0, 0x04, 0xE5, -+0x1A, 0x90, 0x96, 0x93, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0x5C, 0xF0, 0x75, 0xF0, 0x04, 0xE5, -+0x1A, 0x90, 0x96, 0x92, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0x5D, 0xF0, 0xFA, 0x75, 0xF0, 0x10, -+0xE5, 0x1A, 0x90, 0x81, 0x05, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0x03, 0x90, 0xA5, 0x56, 0xF0, 0x90, -+0xA5, 0x5A, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xE4, -+0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE5, 0x1A, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, -+0x95, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x90, 0x96, 0x95, -+0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x54, 0x03, 0x90, 0xA5, 0x57, 0xF0, 0x74, 0x12, 0x25, 0x1A, 0xF5, -+0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEB, 0xF0, 0xE9, 0xD3, 0x9A, 0x40, 0x0C, 0x90, 0xA5, 0x5D, -+0xE0, 0x90, 0xA5, 0x5A, 0xF0, 0x90, 0xA5, 0x54, 0xF0, 0xEC, 0x70, 0x02, 0x41, 0x47, 0x90, 0xA5, -+0x5B, 0xEC, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0x30, 0xE7, 0x0E, 0x90, 0xA5, 0x5A, 0xE0, 0x90, 0xA5, -+0x54, 0xF0, 0x90, 0xA5, 0x5B, 0xE0, 0x14, 0xF0, 0x90, 0xA5, 0x5B, 0xE0, 0x70, 0x02, 0x41, 0x47, -+0x90, 0xA5, 0x5A, 0xE0, 0xFC, 0x64, 0x2C, 0x70, 0x38, 0x75, 0xF0, 0x04, 0xE5, 0x1A, 0x90, 0x96, -+0x95, 0x12, 0x4B, 0x88, 0xE0, 0xFD, 0x54, 0x03, 0xFF, 0x90, 0xA5, 0x56, 0xE0, 0x6F, 0x60, 0x21, -+0xE0, 0x14, 0xF0, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x1A, -+0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xED, 0x54, 0xF3, 0x4F, 0xF0, 0x90, 0xA5, 0x5B, 0xE0, 0x14, -+0xF0, 0x90, 0xA5, 0x5B, 0xE0, 0x70, 0x02, 0x41, 0x47, 0x90, 0xA5, 0x5C, 0xE0, 0xFD, 0xEC, 0xD3, -+0x9D, 0x50, 0x02, 0x41, 0x3F, 0xE4, 0x90, 0xA5, 0x59, 0xF0, 0x90, 0xA5, 0x57, 0xE0, 0xFE, 0xB4, -+0x01, 0x16, 0x90, 0xA5, 0x5A, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x0D, 0xE0, 0x24, 0xE0, 0xF0, 0x90, -+0xA5, 0x54, 0xE0, 0x24, 0xE0, 0xF0, 0x80, 0x35, 0xEE, 0xB4, 0x02, 0x16, 0x90, 0xA5, 0x5A, 0xE0, -+0xC3, 0x94, 0x2C, 0x40, 0x0D, 0xE0, 0x24, 0xE8, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0x24, 0xE8, 0xF0, -+0x80, 0x1B, 0x90, 0xA5, 0x57, 0xE0, 0xB4, 0x03, 0x14, 0x90, 0xA5, 0x5A, 0xE0, 0xC3, 0x94, 0x2C, -+0x40, 0x0B, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA5, 0x57, -+0xE0, 0xFF, 0xB4, 0x01, 0x0F, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x09, 0x90, 0xA5, 0x5C, 0xE0, 0x24, -+0xE0, 0xF0, 0x80, 0x27, 0xEF, 0xB4, 0x02, 0x0F, 0x90, 0xA5, 0x5C, 0xE0, 0xC3, 0x94, 0x2C, 0x40, -+0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, 0x90, 0xA5, 0x57, 0xE0, 0xB4, 0x03, 0x0D, 0x90, 0xA5, -+0x5C, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, 0x14, -+0x90, 0xA5, 0x58, 0xF0, 0x90, 0xA5, 0x5C, 0xE0, 0xFF, 0x90, 0xA5, 0x58, 0xE0, 0xC3, 0x9F, 0x50, -+0x02, 0x21, 0xD7, 0xE0, 0xFB, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0x75, 0xF0, 0x08, 0xE5, 0x1A, -+0x90, 0x89, 0x00, 0x12, 0x4B, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, -+0xE0, 0xFD, 0x7C, 0x00, 0xEB, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, -+0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x60, -+0x3E, 0x74, 0x12, 0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0xB4, 0x14, 0x08, -+0x90, 0xA5, 0x54, 0x74, 0x0C, 0xF0, 0x80, 0x08, 0x90, 0xA5, 0x58, 0xE0, 0x90, 0xA5, 0x54, 0xF0, -+0x90, 0xA5, 0x59, 0xE0, 0x04, 0xF0, 0x90, 0xA5, 0x5B, 0xE0, 0xFF, 0x90, 0xA5, 0x59, 0xE0, 0x6F, -+0x60, 0x15, 0x90, 0xA5, 0x5C, 0xE0, 0xFF, 0x90, 0xA5, 0x54, 0xE0, 0xD3, 0x9F, 0x40, 0x08, 0x90, -+0xA5, 0x58, 0xE0, 0x14, 0xF0, 0x21, 0x44, 0x90, 0xA5, 0x57, 0xE0, 0xFE, 0xB4, 0x01, 0x1B, 0x90, -+0xA5, 0x54, 0xE0, 0xFF, 0xD3, 0x94, 0x0B, 0x40, 0x11, 0xEF, 0x94, 0x34, 0x50, 0x0C, 0xE0, 0x24, -+0x20, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, 0x24, 0x20, 0x80, 0x33, 0xEE, 0xB4, 0x02, 0x15, 0x90, 0xA5, -+0x54, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x0C, 0xE0, 0x24, 0x18, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, 0x24, -+0x18, 0x80, 0x1A, 0x90, 0xA5, 0x57, 0xE0, 0xB4, 0x03, 0x2D, 0x90, 0xA5, 0x54, 0xE0, 0xD3, 0x94, -+0x1B, 0x40, 0x24, 0xE0, 0x24, 0x22, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, 0x24, 0x22, 0xF0, 0x74, 0x12, -+0x25, 0x1A, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x08, 0x90, -+0xA5, 0x5C, 0xE0, 0x90, 0xA5, 0x54, 0xF0, 0x90, 0xA5, 0x54, 0xE0, 0xFD, 0x90, 0xA5, 0x56, 0xE0, -+0x90, 0xA6, 0x07, 0xF0, 0xE4, 0xFB, 0xAF, 0x1A, 0x12, 0x68, 0xCD, 0x90, 0xA5, 0x54, 0xE0, 0xFF, -+0x22, 0x90, 0x01, 0xC4, 0x74, 0x61, 0xF0, 0x74, 0x9A, 0xA3, 0xF0, 0xE4, 0xF5, 0x0F, 0x74, 0x87, -+0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, 0xA5, 0x82, 0x75, -+0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, -+0x01, 0x30, 0xE0, 0x03, 0x02, 0xA5, 0x82, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, -+0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xD3, 0x94, 0x00, 0xEE, 0x94, 0x00, 0x50, 0x03, -+0x02, 0xA5, 0x82, 0xE5, 0x0F, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x01, 0xF9, 0x74, 0x8D, 0x35, 0xF0, -+0xFA, 0x7B, 0x01, 0x8B, 0x13, 0xF5, 0x14, 0x89, 0x15, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x81, 0xF5, -+0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0xA5, 0x44, 0xCF, 0xF0, 0xA3, -+0xEF, 0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0xFF, 0x90, -+0xA5, 0x46, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, -+0x12, 0x4A, 0xB5, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, 0x90, 0x00, 0x04, 0x12, 0x4A, 0xE0, 0x2F, -+0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, 0x12, 0x4A, 0xE0, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, -+0xFE, 0x90, 0x00, 0x08, 0x12, 0x4A, 0xE0, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x90, 0xA5, 0x48, 0xF0, -+0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE0, 0xFF, -+0x90, 0xA5, 0x43, 0xF0, 0xBF, 0xBE, 0x03, 0x74, 0x3F, 0xF0, 0x90, 0xA5, 0x43, 0xE0, 0xB4, 0xB3, -+0x03, 0x74, 0x34, 0xF0, 0x90, 0xA5, 0x43, 0xE0, 0x90, 0xA5, 0x41, 0xF0, 0x54, 0x7F, 0xA3, 0xF0, -+0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x96, 0x92, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0x4B, 0xF0, -+0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0x13, 0x13, 0x54, 0x03, -+0x90, 0xA5, 0x4D, 0xF0, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, -+0x20, 0xE2, 0x02, 0x81, 0x13, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, -+0xE0, 0x60, 0x70, 0x90, 0xA5, 0x42, 0xE0, 0xFF, 0xC3, 0x94, 0x0C, 0x40, 0x66, 0xEF, 0xD3, 0x94, -+0x13, 0x50, 0x60, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x14, -+0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x60, 0x03, 0x02, -+0xA5, 0x8E, 0x90, 0xA5, 0x42, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x43, -+0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, 0x04, 0xEB, -+0x90, 0x42, 0x3B, 0x12, 0x4B, 0x88, 0x12, 0x4B, 0x78, 0x12, 0x4B, 0x18, 0x78, 0x01, 0x12, 0x27, -+0x22, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0xC3, -+0x94, 0x05, 0x40, 0x03, 0x02, 0xA0, 0xBD, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, -+0xF5, 0x83, 0xE0, 0x30, 0xE7, 0x1F, 0x74, 0x01, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, -+0x83, 0xE0, 0xFD, 0x90, 0xA5, 0x4D, 0xE0, 0x90, 0xA6, 0x07, 0xF0, 0x7B, 0x01, 0xAF, 0x0F, 0x12, -+0x68, 0xCD, 0x02, 0xA0, 0x9B, 0x90, 0xA5, 0x4B, 0xE0, 0xFF, 0x90, 0xA5, 0x42, 0xE0, 0xD3, 0x9F, -+0x40, 0x13, 0x90, 0xA5, 0x4B, 0xE0, 0x90, 0xA5, 0x42, 0xF0, 0x90, 0xA5, 0x41, 0xE0, 0x54, 0x80, -+0xFE, 0xF0, 0xEF, 0x4E, 0xF0, 0x90, 0xA5, 0x42, 0xE0, 0xFF, 0x90, 0x41, 0xE7, 0x93, 0xFE, 0x74, -+0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFD, 0xC3, 0x9E, 0x40, 0x06, -+0xEF, 0x90, 0x41, 0x3F, 0x80, 0x07, 0x90, 0xA5, 0x42, 0xE0, 0x90, 0x41, 0x93, 0x93, 0x90, 0xA5, -+0x4A, 0xF0, 0x90, 0xA4, 0x65, 0xE0, 0x60, 0x54, 0x90, 0xA5, 0x42, 0xE0, 0xFF, 0x64, 0x13, 0x60, -+0x04, 0xEF, 0xB4, 0x0B, 0x05, 0x90, 0xA4, 0x67, 0x80, 0x27, 0x90, 0xA5, 0x42, 0xE0, 0xFF, 0x64, -+0x12, 0x60, 0x04, 0xEF, 0xB4, 0x0A, 0x05, 0x90, 0xA4, 0x68, 0x80, 0x15, 0x90, 0xA5, 0x42, 0xE0, -+0xFF, 0x64, 0x11, 0x60, 0x04, 0xEF, 0xB4, 0x09, 0x05, 0x90, 0xA4, 0x69, 0x80, 0x03, 0x90, 0xA4, -+0x66, 0xE0, 0xF5, 0x19, 0xED, 0xC3, 0x9E, 0x90, 0xA5, 0x42, 0xE0, 0x40, 0x05, 0x90, 0x41, 0x3F, -+0x80, 0x03, 0x90, 0x41, 0x93, 0x93, 0x25, 0x19, 0x90, 0xA5, 0x4A, 0xF0, 0x90, 0xA5, 0x4A, 0xE0, -+0x75, 0xF0, 0x06, 0xA4, 0x24, 0x9D, 0xF9, 0x74, 0x40, 0x35, 0xF0, 0x75, 0x10, 0xFF, 0xF5, 0x11, -+0x89, 0x12, 0x90, 0xA5, 0x41, 0xE0, 0x90, 0x44, 0x93, 0x93, 0xFF, 0xD3, 0x90, 0xA5, 0x47, 0xE0, -+0x9F, 0x90, 0xA5, 0x46, 0xE0, 0x94, 0x00, 0x40, 0x06, 0x12, 0x97, 0x47, 0x02, 0xA4, 0xE1, 0xC3, -+0x90, 0xA5, 0x45, 0xE0, 0x94, 0x0F, 0x90, 0xA5, 0x44, 0xE0, 0x94, 0x00, 0x50, 0x68, 0xAB, 0x13, -+0xAA, 0x14, 0xA9, 0x15, 0x90, 0x00, 0x06, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, 0x90, 0x00, 0x08, -+0x12, 0x4A, 0xE0, 0x2F, 0xFD, 0xE5, 0xF0, 0x3E, 0xFC, 0x90, 0xA5, 0x44, 0xE0, 0xC3, 0x13, 0xFE, -+0xA3, 0xE0, 0x13, 0xFF, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x05, 0x12, 0x97, 0x47, 0x80, 0x36, -+0x90, 0xA5, 0x44, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xAE, 0x04, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, -+0x13, 0xD8, 0xF9, 0xFB, 0xAA, 0x06, 0xEC, 0xC3, 0x13, 0xFE, 0xED, 0x13, 0x2B, 0xFF, 0xEE, 0x3A, -+0xFE, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x12, 0x4A, 0xB5, 0xD3, 0x9F, 0xE5, 0xF0, 0x9E, 0x40, -+0x05, 0xAF, 0x0F, 0x12, 0x90, 0x7D, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, -+0x95, 0xF5, 0x83, 0xE0, 0xF5, 0x16, 0xA3, 0xE0, 0xF5, 0x17, 0x90, 0xA5, 0x44, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0xD3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x08, 0x90, 0xA5, 0x4C, 0x74, 0x05, 0xF0, -+0x80, 0x16, 0xD3, 0xEF, 0x94, 0xC8, 0xEE, 0x94, 0x00, 0x40, 0x08, 0x90, 0xA5, 0x4C, 0x74, 0x02, -+0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA5, 0x4C, 0xF0, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x12, 0x4A, -+0xB5, 0xFF, 0xAE, 0xF0, 0x90, 0xA5, 0x4C, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, -+0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, 0xAA, 0x11, 0xA9, 0x12, 0x12, 0x26, 0x1E, -+0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, -+0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x90, 0x00, 0x02, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, 0x90, -+0xA5, 0x4C, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, -+0xF9, 0xFF, 0xAB, 0x10, 0xAA, 0x11, 0xA9, 0x12, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFD, 0x7C, -+0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, -+0xAA, 0x14, 0xA9, 0x15, 0x90, 0x00, 0x04, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, 0x90, 0xA5, 0x4C, -+0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, -+0xAB, 0x10, 0xAA, 0x11, 0xA9, 0x12, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, -+0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, 0xAA, 0x14, -+0xA9, 0x15, 0x90, 0x00, 0x06, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, 0x90, 0xA5, 0x4C, 0xE0, 0xFD, -+0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, -+0xAA, 0x11, 0xA9, 0x12, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, -+0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, -+0x90, 0x00, 0x08, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, 0x90, 0xA5, 0x4C, 0xE0, 0xFD, 0xEF, 0xA8, -+0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x10, 0xAA, 0x11, -+0xA9, 0x12, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, -+0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, 0x16, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFD, 0x90, -+0xA5, 0x4C, 0xE0, 0xFF, 0x90, 0xA5, 0x44, 0xE0, 0xFE, 0xA3, 0xE0, 0xA8, 0x07, 0x08, 0x80, 0x05, -+0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x26, 0x98, 0xD3, 0xE5, 0x17, 0x9F, 0xE5, -+0x16, 0x9E, 0x40, 0x0C, 0xE5, 0x17, 0x9F, 0xF5, 0x17, 0xE5, 0x16, 0x9E, 0xF5, 0x16, 0x80, 0x05, -+0xE4, 0xF5, 0x16, 0xF5, 0x17, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, -+0xE0, 0x60, 0x10, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0x14, -+0xF0, 0x80, 0x14, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -+0xE5, 0x16, 0xF0, 0xA3, 0xE5, 0x17, 0xF0, 0xAE, 0x16, 0xAF, 0x17, 0xE4, 0xFC, 0xFD, 0x90, 0xA5, -+0x42, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x4B, 0x88, 0x12, 0x4B, 0x78, 0xC3, 0x12, -+0x4B, 0x3F, 0x40, 0x03, 0x02, 0xA0, 0x6F, 0x74, 0x91, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x94, -+0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, -+0xFE, 0xD3, 0x9F, 0x40, 0x03, 0xEE, 0x80, 0x1A, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, -+0x9B, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x91, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, -+0xE0, 0xC3, 0x9F, 0x90, 0xA5, 0x4E, 0xF0, 0x90, 0xA5, 0x4E, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x04, -+0xE5, 0x0F, 0x80, 0x2F, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, -+0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xD3, 0x94, 0x01, 0xEE, 0x94, 0x00, 0xE5, 0x0F, 0x40, 0x14, 0x25, -+0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x74, 0xFF, 0xF5, 0xF0, 0x12, 0x4A, -+0x9F, 0x80, 0x0F, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, 0xF0, -+0xA3, 0xF0, 0x90, 0xA5, 0x42, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x3B, 0x12, 0x4B, 0x88, 0x12, -+0x4B, 0x5C, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, -+0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x70, 0x33, 0xAF, 0x0F, 0x12, 0x90, 0x7D, 0x80, 0x2C, 0x90, -+0xA5, 0x42, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xD3, -+0x74, 0x01, 0x93, 0x95, 0x17, 0xE4, 0x93, 0x95, 0x16, 0x40, 0x10, 0xEF, 0x64, 0x36, 0x60, 0x04, -+0x7D, 0x01, 0x80, 0x02, 0x7D, 0x09, 0xAF, 0x0F, 0x12, 0x97, 0x4B, 0x74, 0x92, 0x25, 0x0F, 0xF5, -+0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x20, 0xE0, 0x02, 0x81, 0xB5, 0x90, 0xA5, 0x42, 0xE0, -+0x64, 0x3F, 0x60, 0x02, 0x81, 0xB5, 0xAF, 0x0F, 0x12, 0x90, 0x7D, 0x81, 0xB5, 0x74, 0x12, 0x25, -+0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0xFF, 0x64, 0x05, 0x60, 0x02, 0x61, 0x0F, -+0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x12, 0x25, -+0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0xE0, 0xFE, 0xB4, 0x05, 0x0D, 0x90, 0xA5, 0x42, -+0xE0, 0xC3, 0x94, 0x3B, 0x50, 0x02, 0x21, 0x77, 0x80, 0x60, 0xEE, 0xB4, 0x04, 0x0B, 0x90, 0xA5, -+0x42, 0xE0, 0xC3, 0x94, 0x31, 0x40, 0x70, 0x80, 0x51, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, -+0x34, 0x96, 0xF5, 0x83, 0xE0, 0xFE, 0xB4, 0x03, 0x0B, 0x90, 0xA5, 0x42, 0xE0, 0xC3, 0x94, 0x19, -+0x40, 0x55, 0x80, 0x36, 0xEE, 0xB4, 0x02, 0x0B, 0x90, 0xA5, 0x42, 0xE0, 0xC3, 0x94, 0x11, 0x40, -+0x46, 0x80, 0x27, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0xE0, 0xFE, -+0xB4, 0x01, 0x0B, 0x90, 0xA5, 0x42, 0xE0, 0xC3, 0x94, 0x0A, 0x40, 0x2B, 0x80, 0x0C, 0xEE, 0x70, -+0x19, 0x90, 0xA5, 0x42, 0xE0, 0xC3, 0x94, 0x03, 0x40, 0x1D, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, -+0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x80, 0x0D, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, -+0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x98, -+0xF5, 0x83, 0xE0, 0x90, 0xA5, 0x4F, 0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, -+0xF5, 0x83, 0xE0, 0xFE, 0xC3, 0x94, 0x30, 0x50, 0x13, 0xE4, 0x90, 0xA5, 0x4F, 0xF0, 0x74, 0x12, -+0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE4, 0x41, 0x52, 0x74, 0x92, 0x25, 0x0F, -+0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x41, 0x7B, 0x74, 0x92, -+0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0x64, 0x0A, 0x60, 0x51, 0xEE, 0x24, -+0x05, 0xFD, 0xE4, 0x33, 0xFC, 0x74, 0x01, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, -+0xE0, 0xFE, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x50, 0x32, 0xEE, 0x24, 0x05, -+0xFD, 0xE4, 0x33, 0xFC, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, -+0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x50, 0x14, 0x74, 0x92, 0x25, 0x0F, 0xF5, -+0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0xA5, 0x42, 0xE0, 0x6E, 0x60, 0x3F, 0x90, -+0xA5, 0x4F, 0xE0, 0xFE, 0x70, 0x04, 0x04, 0xF0, 0x80, 0x0F, 0xEE, 0x90, 0xA5, 0x4F, 0xB4, 0x01, -+0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x05, 0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, -+0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x01, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, -+0x83, 0xEE, 0xF0, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0x80, 0x2B, 0x74, 0x12, -+0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x92, 0x25, 0x0F, 0xF5, -+0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x12, 0xE4, 0x90, 0xA5, 0x4F, 0xF0, -+0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA5, 0x42, -+0xE0, 0xFE, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xEE, 0xF0, 0x90, -+0xA5, 0x4F, 0xE0, 0xFE, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xEE, -+0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x0F, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xC4, 0x13, 0x13, -+0x54, 0x03, 0x30, 0xE0, 0x1E, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, -+0xE4, 0xF0, 0x90, 0xA5, 0x4F, 0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, -+0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x12, 0x4B, 0x88, 0xE0, 0x54, -+0xF8, 0xFE, 0x90, 0xA5, 0x52, 0xF0, 0x90, 0xA5, 0x4F, 0xE0, 0x4E, 0xFE, 0x90, 0xA5, 0x52, 0xF0, -+0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x12, 0x4B, 0x88, 0xEE, 0xF0, 0x81, 0xB5, 0xEF, -+0x64, 0x06, 0x60, 0x02, 0x81, 0xB5, 0xF5, 0x16, 0xF5, 0x17, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, -+0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE0, 0x90, 0xA5, 0x4F, 0xF0, 0x90, 0xA5, 0x44, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0xD3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x08, 0x90, 0xA5, 0x4C, 0x74, 0x05, 0xF0, -+0x80, 0x16, 0xD3, 0xEF, 0x94, 0xFA, 0xEE, 0x94, 0x00, 0x40, 0x08, 0x90, 0xA5, 0x4C, 0x74, 0x02, -+0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA5, 0x4C, 0xF0, 0x90, 0xA5, 0x4C, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, -+0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x44, 0xEC, 0xE4, 0x93, -+0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0x90, 0xA5, 0x50, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xF5, -+0x18, 0xAB, 0x13, 0xAA, 0x14, 0xA9, 0x15, 0x75, 0xF0, 0x02, 0xE5, 0x18, 0xA4, 0xF5, 0x82, 0x85, -+0xF0, 0x83, 0x12, 0x4A, 0xE0, 0xFF, 0xAE, 0xF0, 0x90, 0xA5, 0x4C, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, -+0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xE5, 0x18, 0x90, 0x44, 0xE7, -+0x93, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x17, 0xF5, 0x17, 0xEE, 0x35, 0x16, 0xF5, -+0x16, 0xC3, 0x90, 0xA5, 0x51, 0xE0, 0x95, 0x17, 0x90, 0xA5, 0x50, 0xE0, 0x95, 0x16, 0x40, 0x07, -+0x05, 0x18, 0xE5, 0x18, 0xB4, 0x05, 0xAA, 0xE5, 0x18, 0xC3, 0x13, 0xF5, 0x18, 0x90, 0xA5, 0x4F, -+0xE0, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x90, 0xA5, 0x53, 0xF0, 0xD3, -+0x95, 0x18, 0x40, 0x06, 0xE0, 0x95, 0x18, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA5, 0x53, 0xF0, 0x74, -+0x81, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xC3, 0x13, 0xFF, 0x90, 0xA5, -+0x53, 0xE0, 0xC4, 0x33, 0x54, 0xE0, 0x2F, 0x04, 0xFF, 0x74, 0x81, 0x25, 0x0F, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x81, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -+0x83, 0xE0, 0xC3, 0x94, 0xC0, 0x40, 0x0E, 0x74, 0x81, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, -+0xF5, 0x83, 0x74, 0xC0, 0xF0, 0x74, 0x81, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA5, 0x53, 0xF0, 0xE0, 0x25, 0xE0, 0xF0, 0x70, 0x02, -+0x80, 0x05, 0x90, 0xA5, 0x53, 0xE0, 0x14, 0x90, 0xA5, 0x4F, 0xF0, 0xD3, 0x90, 0xA5, 0x47, 0xE0, -+0x94, 0x03, 0x90, 0xA5, 0x46, 0xE0, 0x94, 0x00, 0x40, 0x05, 0xE4, 0x90, 0xA5, 0x4F, 0xF0, 0x90, -+0xA5, 0x4F, 0xE0, 0xFF, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xEF, -+0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0xF8, 0xFE, -+0x90, 0xA5, 0x52, 0xF0, 0xEF, 0x4E, 0xFF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x0F, 0x90, 0x81, 0x01, -+0x12, 0x4B, 0x88, 0xEF, 0xF0, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, -+0xE0, 0xD3, 0x94, 0x05, 0x74, 0x12, 0x50, 0x0E, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, -+0x83, 0xE0, 0x04, 0xF0, 0x80, 0x0B, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE4, -+0xF0, 0x90, 0xA5, 0x46, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, -+0x9E, 0xFC, 0xE5, 0x0F, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, -+0xFA, 0xA3, 0xE0, 0xD3, 0x9D, 0xEA, 0x9C, 0xE5, 0x0F, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x12, 0xF5, -+0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x4A, 0x9F, 0x80, 0x10, 0x25, 0xE0, -+0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0x90, 0xA5, -+0x48, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, 0x9E, 0xFC, 0xE5, -+0x0F, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xFA, 0xA3, 0xE0, -+0xD3, 0x9D, 0xEA, 0x9C, 0xE5, 0x0F, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, -+0x9F, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x4A, 0x9F, 0x80, 0x10, 0x25, 0xE0, 0x24, 0x12, 0xF5, -+0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xE4, 0xFD, 0xAF, 0x0F, 0x12, -+0x68, 0x40, 0x05, 0x0F, 0xE5, 0x0F, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x9A, 0x6E, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x26, 0x90, 0xA4, 0x8E, 0xE0, 0x04, 0xF0, 0x75, 0xF0, -+0x04, 0xEF, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0x1F, 0x90, 0xA6, 0x23, 0xF0, 0x24, -+0xF5, 0x50, 0x0D, 0x60, 0x6D, 0x14, 0x60, 0x70, 0x14, 0x60, 0x73, 0x14, 0x60, 0x76, 0x80, 0x7D, -+0xE4, 0xF5, 0x27, 0x75, 0xF0, 0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0x12, 0x4B, 0x88, 0xE5, 0x82, -+0x25, 0x27, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA6, 0x23, 0xE0, 0x75, -+0xF0, 0x07, 0xA4, 0x24, 0x50, 0xF5, 0x82, 0xE4, 0x34, 0x40, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x27, -+0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0xEF, 0x5E, 0xFF, 0x90, 0xA6, 0x25, -+0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0x12, 0x4B, 0x88, 0xE5, 0x82, 0x25, 0x27, -+0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x27, 0xE5, 0x27, 0xB4, 0x07, 0xA3, -+0x80, 0x1B, 0xAD, 0x26, 0x7F, 0x8C, 0x80, 0x10, 0xAD, 0x26, 0x7F, 0x94, 0x80, 0x0A, 0xAD, 0x26, -+0x7F, 0x9C, 0x80, 0x04, 0xAD, 0x26, 0x7F, 0xA4, 0x7E, 0x04, 0x12, 0x8E, 0x7D, 0x75, 0xF0, 0x04, -+0xE5, 0x26, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0xFF, 0xC4, 0x54, 0x03, 0xFD, 0xE4, 0x90, -+0xA6, 0x21, 0xF0, 0x7C, 0x06, 0x75, 0xF0, 0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0xBC, 0x06, 0x12, -+0x12, 0x4B, 0x88, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x54, 0x0F, -+0x80, 0x0E, 0x12, 0x4B, 0x88, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, -+0x90, 0xA6, 0x24, 0xF0, 0x90, 0xA6, 0x24, 0xE0, 0x60, 0x64, 0x75, 0x27, 0x07, 0x74, 0x01, 0x7E, -+0x00, 0xA8, 0x27, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0xA6, -+0x24, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x3E, 0xEC, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x27, 0x90, 0xA6, -+0x21, 0xF0, 0xBD, 0x01, 0x0C, 0xE0, 0xD3, 0x94, 0x0B, 0x40, 0x06, 0xE0, 0x24, 0x20, 0xF0, 0x80, -+0x39, 0xBD, 0x02, 0x0F, 0x90, 0xA6, 0x21, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x06, 0xE0, 0x24, 0x18, -+0xF0, 0x80, 0x27, 0xBD, 0x03, 0x24, 0x90, 0xA6, 0x21, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x1B, 0xE0, -+0x24, 0x22, 0xF0, 0x80, 0x15, 0x15, 0x27, 0xE5, 0x27, 0xC3, 0x94, 0x00, 0x50, 0x9F, 0xEC, 0x60, -+0x09, 0x1C, 0xEC, 0xC3, 0x94, 0x00, 0x40, 0x02, 0xC1, 0x55, 0xE4, 0x90, 0xA6, 0x22, 0xF0, 0xFC, -+0x75, 0xF0, 0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0xBC, 0x06, 0x12, 0x12, 0x4B, 0x88, 0xE5, 0x82, -+0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x80, 0x0E, 0x12, 0x4B, 0x88, -+0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x90, 0xA6, 0x24, 0xF0, 0x90, -+0xA6, 0x24, 0xE0, 0x60, 0x63, 0xE4, 0xF5, 0x27, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x27, 0x08, 0x80, -+0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0xA6, 0x24, 0xE0, 0xFB, 0xEF, 0x5B, -+0x60, 0x3E, 0xEC, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x27, 0x90, 0xA6, 0x22, 0xF0, 0xBD, 0x01, 0x0C, -+0xE0, 0xD3, 0x94, 0x0B, 0x40, 0x06, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x34, 0xBD, 0x02, 0x0F, 0x90, -+0xA6, 0x22, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x06, 0xE0, 0x24, 0x18, 0xF0, 0x80, 0x22, 0xBD, 0x03, -+0x1F, 0x90, 0xA6, 0x22, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x16, 0xE0, 0x24, 0x22, 0xF0, 0x80, 0x10, -+0x05, 0x27, 0xE5, 0x27, 0x64, 0x08, 0x70, 0xA0, 0x0C, 0xEC, 0x64, 0x07, 0x60, 0x02, 0xE1, 0x00, -+0x90, 0xA6, 0x21, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, 0x96, 0x92, 0x12, 0x4B, 0x88, -+0xEF, 0xF0, 0x90, 0xA6, 0x22, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, 0x96, 0x93, 0x12, -+0x4B, 0x88, 0xEE, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x26, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE0, -+0xFC, 0x54, 0x7F, 0xFD, 0xEC, 0x54, 0x80, 0xFC, 0xED, 0xD3, 0x9F, 0x40, 0x05, 0x90, 0xA6, 0x21, -+0x80, 0x08, 0xED, 0xC3, 0x9E, 0x50, 0x06, 0x90, 0xA6, 0x22, 0xE0, 0x4C, 0xFD, 0x74, 0x92, 0x25, -+0x26, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xED, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, -+0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA6, 0x07, 0xF0, 0xE4, 0xFB, -+0xAF, 0x26, 0x12, 0x68, 0xCD, 0x75, 0xF0, 0x10, 0xE5, 0x26, 0x90, 0x81, 0x03, 0x12, 0x4B, 0x88, -+0xE4, 0xF0, 0x90, 0xA6, 0x21, 0xE0, 0xFF, 0xC3, 0x94, 0x36, 0x40, 0x10, 0x74, 0x12, 0x25, 0x26, -+0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x80, 0x6A, 0xEF, 0xC3, 0x94, 0x2C, -+0x40, 0x10, 0x74, 0x12, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x74, 0x04, 0xF0, -+0x80, 0x54, 0x90, 0xA6, 0x21, 0xE0, 0xFF, 0xC3, 0x94, 0x14, 0x40, 0x10, 0x74, 0x12, 0x25, 0x26, -+0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x74, 0x03, 0xF0, 0x80, 0x3A, 0xEF, 0xC3, 0x94, 0x0C, -+0x40, 0x10, 0x74, 0x12, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x74, 0x02, 0xF0, -+0x80, 0x24, 0x90, 0xA6, 0x21, 0xE0, 0xC3, 0x94, 0x04, 0x74, 0x12, 0x40, 0x0E, 0x25, 0x26, 0xF5, -+0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x80, 0x0B, 0x25, 0x26, 0xF5, 0x82, 0xE4, -+0x34, 0x96, 0xF5, 0x83, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA5, 0x44, 0x12, 0x4B, -+0x9D, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x12, 0x26, 0x1E, 0x54, 0x7F, 0xFD, 0x90, 0x00, 0x01, -+0x12, 0x26, 0x37, 0xFE, 0x54, 0x1F, 0x90, 0xA5, 0x48, 0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, -+0x13, 0x54, 0x01, 0x90, 0xA5, 0x47, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFE, 0x54, 0x03, -+0xFF, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0xA5, 0x4A, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, -+0x37, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA5, 0x49, 0xF0, 0xEE, 0x54, 0x80, -+0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFE, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFB, 0x54, 0x08, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0xFC, 0x90, 0xA5, 0x4B, 0xF0, 0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, -+0x3F, 0xA3, 0xF0, 0xEE, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0xFE, 0x75, 0xF0, 0x04, -+0xED, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0x7F, 0x4E, 0xF0, 0x90, 0xA5, 0x49, 0xE0, -+0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x95, 0x12, -+0x4B, 0x88, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, 0xEC, 0x60, 0x02, 0x41, 0x34, 0x90, 0xA5, 0x48, 0xE0, -+0x54, 0x1F, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x94, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0xE0, -+0x4E, 0xF0, 0xEF, 0x54, 0x03, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, -+0xE0, 0x54, 0xFC, 0x4E, 0xF0, 0xEF, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x75, 0xF0, 0x04, -+0xED, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0xF3, 0x4F, 0xF0, 0x90, 0xA5, 0x47, 0xE0, -+0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x94, 0x12, 0x4B, -+0x88, 0xE0, 0x54, 0xDF, 0x4F, 0xF0, 0x90, 0xA5, 0x4A, 0xE0, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0xFF, -+0x75, 0xF0, 0x04, 0xED, 0x90, 0x96, 0x95, 0x12, 0x4B, 0x88, 0xE0, 0x54, 0xCF, 0x4F, 0xF0, 0x74, -+0x92, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0x74, 0x92, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA5, 0x4C, -+0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xE4, 0xFC, 0xEC, -+0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x8F, 0x82, 0x8E, 0x83, -+0x12, 0x26, 0x37, 0xFF, 0x75, 0xF0, 0x08, 0xED, 0x90, 0x89, 0x00, 0x12, 0x4B, 0x88, 0xE5, 0x82, -+0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x0C, 0xEC, 0xB4, 0x04, 0xD0, 0xAF, -+0x05, 0x12, 0xA5, 0x8F, 0x22, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x9D, 0x12, 0x26, 0x1E, 0xF5, 0x0F, -+0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x54, 0xFE, 0xF0, 0x74, 0x92, 0x25, -+0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA5, -+0x44, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x54, 0x01, 0xFE, 0xEF, 0x4E, 0xD0, -+0x82, 0xD0, 0x83, 0xF0, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, -+0x54, 0xFD, 0xF0, 0x74, 0x92, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xC0, 0x83, -+0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA5, 0x44, 0x12, 0x4B, 0x94, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, -+0x54, 0x02, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0xE5, 0x0F, 0xC3, 0x94, 0x80, 0x50, -+0x15, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x74, 0x12, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, -+0x9B, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0xE5, 0x0F, 0xB4, 0x80, 0x0A, 0x90, 0x00, 0x02, 0x12, 0x26, -+0x37, 0x90, 0x96, 0x11, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0xFD, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, -+0xFC, 0xED, 0xC3, 0x94, 0x80, 0x90, 0xA5, 0x46, 0xED, 0x50, 0x3F, 0xF0, 0x25, 0xE0, 0x24, 0x12, -+0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA5, 0x47, 0xF0, 0xEE, -+0xA3, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xFE, -+0xA3, 0xE0, 0x90, 0xA5, 0x49, 0xF0, 0xEE, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, 0x81, 0x00, -+0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, 0x4B, 0xF0, 0x80, 0x01, 0xF0, 0xEC, 0xC3, 0x94, 0x80, 0x90, -+0xA5, 0x4C, 0xEC, 0x50, 0x3F, 0xF0, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, -+0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA5, 0x4D, 0xF0, 0xEE, 0xA3, 0xF0, 0xEC, 0x25, 0xE0, 0x24, -+0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA5, 0x4F, 0xF0, -+0xEE, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE0, 0x90, 0xA5, -+0x51, 0xF0, 0x80, 0x01, 0xF0, 0x90, 0xA5, 0x44, 0x74, 0x04, 0xF0, 0x90, 0xA5, 0x52, 0x74, 0x0C, -+0xF0, 0xED, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, -+0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, -+0xF0, 0xED, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, -+0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, -+0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0x44, 0x12, 0x6C, 0x61, 0x7F, 0x04, 0x02, 0x63, 0x18, 0x75, -+0xF0, 0x10, 0xEF, 0x90, 0x81, 0x03, 0x12, 0x4B, 0x88, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x90, 0x00, -+0x8F, 0xE0, 0x30, 0xE6, 0x58, 0x90, 0x00, 0x8D, 0xE0, 0x64, 0x03, 0x70, 0x50, 0x90, 0x00, 0x8F, -+0xE0, 0xFE, 0x90, 0x00, 0x8E, 0xE0, 0xFD, 0xED, 0xFF, 0x90, 0xA5, 0x3E, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0xE4, 0x90, 0xA5, 0x3D, 0xF0, 0x90, 0xA5, 0x3D, 0xE0, 0xFD, 0xFF, 0x90, 0xA5, 0x3F, 0xE0, -+0x2F, 0xFF, 0x90, 0xA5, 0x3E, 0xE0, 0x34, 0x00, 0x8F, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, -+0x12, 0x56, 0x60, 0x90, 0xA5, 0x3D, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD7, 0x90, -+0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA6, 0x56, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, -+0x49, 0x90, 0x00, 0x8D, 0xE0, 0x64, 0x01, 0x70, 0x41, 0x90, 0xA6, 0x57, 0xF0, 0x90, 0xA6, 0x57, -+0xE0, 0xFD, 0x90, 0xA6, 0x56, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x4B, 0x88, 0xE5, -+0x82, 0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x56, 0x60, -+0x90, 0xA6, 0x57, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD1, 0x90, 0x00, 0x8F, 0xE0, -+0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0x00, 0x8F, 0xE0, 0x30, 0xE5, 0x2A, 0x90, 0x00, 0x8E, 0xE0, 0x64, 0x05, 0x70, 0x22, 0xA3, 0xE0, -+0xFF, 0x90, 0x00, 0x8E, 0xE0, 0xFE, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -+0xEE, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8E, 0x12, 0x3A, 0x96, -+0x22, 0x90, 0xA5, 0x3D, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x4C, 0x90, 0x00, 0x8D, -+0xE0, 0x64, 0x03, 0x70, 0x44, 0x90, 0xA5, 0x3E, 0xF0, 0x90, 0xA5, 0x3E, 0xE0, 0xFD, 0x90, 0xA5, -+0x3D, 0xE0, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, -+0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x56, 0x60, 0x90, -+0xA5, 0x3E, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCE, 0x90, 0x00, 0x8F, 0xE0, 0x30, -+0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0x90, 0xA6, 0x5F, 0xE0, 0x75, 0xF0, -+0x04, 0xA4, 0xFF, 0xAE, 0xF0, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0xA5, 0xA8, 0x12, 0x27, -+0x48, 0x7F, 0xAC, 0x7E, 0x08, 0x90, 0xA5, 0xA2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x36, 0xCE, -+0x90, 0xA5, 0xAC, 0x12, 0x27, 0x48, 0x90, 0xA5, 0xA4, 0x12, 0x4B, 0x50, 0x12, 0x27, 0x15, 0x90, -+0xA5, 0xAC, 0x12, 0x4B, 0x6C, 0x12, 0x4B, 0x25, 0x90, 0xA5, 0xA8, 0x12, 0x4B, 0x6C, 0x12, 0x4B, -+0x32, 0x90, 0xA5, 0xB0, 0x12, 0x27, 0x48, 0x90, 0xA5, 0xB0, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, -+0x12, 0x27, 0x48, 0x90, 0xA5, 0xA2, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x02, 0x37, 0x5D, 0x90, 0xA6, -+0x4A, 0xED, 0xF0, 0x90, 0xA6, 0x49, 0xEF, 0xF0, 0x60, 0x02, 0xC1, 0x2B, 0x90, 0xA5, 0xA4, 0x12, -+0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, -+0x74, 0x08, 0xFF, 0xFE, 0xB1, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, -+0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x2C, 0x7E, 0x08, 0xB1, 0x45, -+0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0F, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0x00, 0x12, 0xB1, 0xD5, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0xF0, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x7F, 0x0C, 0x7E, 0x08, 0xB1, -+0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x0F, 0x00, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, -+0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0x04, 0x7E, 0x0A, 0xB1, 0x45, 0x90, 0x04, 0x54, 0xE0, 0x54, -+0x7F, 0x90, 0xA6, 0x4B, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x22, 0x90, 0xA6, 0x49, 0xE0, 0x64, -+0x01, 0x60, 0x02, 0xC1, 0xDD, 0x90, 0x04, 0x54, 0xE0, 0x44, 0x80, 0x90, 0xA6, 0x4B, 0xF0, 0xE0, -+0x90, 0x04, 0x54, 0xF0, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA5, -+0xA8, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0xB1, 0x45, 0x90, 0xA5, -+0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x01, 0x7F, 0x2C, 0x7E, 0x08, 0xB1, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x0F, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, 0x12, 0xB1, 0xD5, 0x90, -+0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x00, 0x7F, 0x0C, 0x7E, 0x08, 0xB1, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x0F, -+0x00, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x0F, 0x00, 0x00, 0x00, 0x7F, 0x04, 0x7E, -+0x0A, 0xB1, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0xA5, 0xA8, -+0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0xB1, 0x45, 0x22, 0x90, 0xA6, -+0x5F, 0xED, 0xF0, 0xEF, 0x14, 0x60, 0x23, 0x14, 0x70, 0x02, 0xE1, 0x8C, 0x24, 0x02, 0x60, 0x02, -+0xE1, 0xDA, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA5, 0xA8, 0x12, -+0x27, 0x54, 0x00, 0x30, 0x02, 0x00, 0x7F, 0xAC, 0xE1, 0xD6, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, -+0x00, 0x30, 0x03, 0xC3, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x01, 0xB1, 0x41, -+0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, 0xB1, 0x2A, 0x90, 0xA5, 0xA4, 0x12, -+0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x5F, 0xE0, 0x7E, 0x00, 0x78, 0x1C, 0xC3, 0x33, -+0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0xA5, 0xA8, 0x12, -+0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0xB1, 0x45, 0x90, 0xA6, 0x5F, 0xE0, 0x90, 0xA5, 0xA4, 0xB4, -+0x01, 0x13, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x10, 0x80, 0x11, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0xA5, 0xA8, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x0A, 0x80, 0x4C, 0x90, 0xA5, 0xA4, 0x12, -+0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x02, -+0xB1, 0x41, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, 0xB1, 0x2A, 0x90, 0xA5, -+0xA4, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA6, 0x5F, 0xE0, 0x7E, 0x00, 0x78, 0x1C, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0xA5, -+0xA8, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0xB1, 0x45, 0x22, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, -+0xFE, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x90, 0xA5, 0x90, -+0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA5, 0x8F, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x3A, -+0xA9, 0x90, 0xA5, 0x9A, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x92, 0x12, 0x4B, 0x50, 0x12, 0x27, 0x15, -+0x90, 0xA5, 0x9A, 0x12, 0x4B, 0x6C, 0x12, 0x4B, 0x25, 0x90, 0xA5, 0x96, 0x12, 0x4B, 0x6C, 0x12, -+0x4B, 0x32, 0x90, 0xA5, 0x9E, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x90, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, -+0x90, 0xA5, 0x9E, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0x96, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x8F, 0xE0, -+0xFF, 0xD0, 0x05, 0x02, 0x39, 0xBA, 0xEF, 0x14, 0x60, 0x3A, 0x14, 0x60, 0x53, 0x24, 0x02, 0x70, -+0x6C, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x0C, 0x00, 0x12, 0xAF, 0xE7, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x0C, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, -+0x7F, 0x01, 0x80, 0x36, 0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA5, -+0x96, 0x12, 0x27, 0x54, 0x00, 0x00, 0x04, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x80, 0x1A, -+0x90, 0xA5, 0x92, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA5, 0x96, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0xAF, 0xED, 0x22, 0x90, 0xA6, -+0x47, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA6, 0x46, 0xEF, 0xF0, 0xE4, 0xFE, 0x11, 0xF4, 0x90, -+0xA6, 0x46, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0x31, 0x27, 0xAE, 0x07, 0x90, 0x04, -+0x83, 0xEE, 0xF0, 0x90, 0xA6, 0x46, 0xE0, 0xFF, 0xAD, 0x06, 0x12, 0xAE, 0xDE, 0x90, 0xA6, 0x46, -+0xE0, 0xFF, 0x01, 0x46, 0xA9, 0x07, 0x90, 0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, 0xE0, 0x7A, -+0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0xFE, 0xE9, 0x14, 0x60, 0x13, 0x14, 0x60, 0x10, 0x24, 0x02, -+0x70, 0x14, 0xEE, 0x54, 0xFE, 0xFE, 0xEF, 0x54, 0x7F, 0x90, 0x06, 0x68, 0x80, 0x04, 0x90, 0x06, -+0x68, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xE4, 0xFE, 0xFC, 0xEF, 0x64, 0x02, 0x70, 0x40, 0xED, -+0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, 0xB4, 0x02, 0x02, 0x7E, 0x09, 0xEB, 0xB4, 0x01, -+0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, 0x38, 0xEB, 0xB4, 0x02, 0x08, 0xED, 0xB4, 0x01, -+0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, -+0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, 0x02, 0x70, 0x16, 0x7C, 0x03, 0x80, 0x12, 0xEF, -+0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7C, -+0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, 0xFF, 0x22, 0x90, 0x04, 0x54, 0xE0, 0x7F, 0x00, -+0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x90, 0xA6, 0x5B, 0xED, 0xF0, 0x90, 0xA6, 0x5A, 0xEF, 0xF0, -+0xD3, 0x94, 0x0E, 0x50, 0x15, 0x31, 0x8A, 0xEF, 0x60, 0x2A, 0x31, 0x8A, 0xEF, 0x64, 0x01, 0x70, -+0x23, 0x90, 0xA6, 0x5B, 0xE0, 0xFD, 0xE4, 0xFF, 0x80, 0x15, 0x90, 0xA6, 0x5A, 0xE0, 0xD3, 0x94, -+0x0E, 0x40, 0x11, 0x31, 0x8A, 0xEF, 0x70, 0x0A, 0x90, 0xA6, 0x5B, 0xE0, 0xFD, 0x7F, 0x01, 0x02, -+0xAD, 0x8E, 0x31, 0x8A, 0x22, 0x7F, 0x1C, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA6, 0x49, 0xE0, -+0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA6, 0x60, 0xED, 0xF0, 0xEF, 0x60, 0x02, 0x41, 0xC3, 0xE0, 0x24, -+0xFD, 0x50, 0x07, 0x60, 0x36, 0x14, 0x60, 0x64, 0x81, 0x9F, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, -+0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, -+0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, -+0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x61, 0x75, 0x90, 0xA5, 0xA4, 0x12, 0x27, -+0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0x7F, -+0xB0, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, -+0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0x81, 0x47, 0x90, 0xA5, 0xA4, 0x12, -+0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, -+0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, -+0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, -+0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, -+0x27, 0x54, 0x00, 0x10, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, -+0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x10, 0x00, -+0x00, 0x81, 0x12, 0x90, 0xA6, 0x60, 0xE0, 0x14, 0x60, 0x7C, 0x14, 0x70, 0x02, 0x61, 0xAD, 0x14, -+0x70, 0x02, 0x81, 0x18, 0x14, 0x70, 0x02, 0x61, 0xAD, 0x24, 0x04, 0x60, 0x02, 0x81, 0x9F, 0x90, -+0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, -+0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, -+0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, -+0x7E, 0x0E, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, -+0xA5, 0xA8, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0xAD, 0x45, -+0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, -+0x01, 0x00, 0x00, 0x00, 0x81, 0x12, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, -+0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0xAD, -+0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, -+0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, -+0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, -+0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, -+0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x80, 0x65, 0x90, 0xA5, 0xA4, -+0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, -+0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, -+0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, -+0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, -+0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, -+0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x01, 0x00, -+0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0E, 0x81, 0x9C, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, -+0xFF, 0xFF, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, -+0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0xA5, 0xA8, -+0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0xAD, 0x45, 0x90, 0xA5, -+0xA4, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x01, 0x00, -+0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x3F, -+0xF0, 0x00, 0x00, 0x90, 0xA5, 0xA8, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, -+0x0E, 0x12, 0xAD, 0x45, 0x90, 0xA5, 0xA4, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, 0x03, 0x90, 0xA5, -+0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, 0x12, 0xAD, 0x45, 0x22, -+0x90, 0xA4, 0x55, 0xE0, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x42, 0xEF, 0xB4, 0x01, 0x18, 0x90, 0xA4, -+0x5C, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x37, -+0x5D, 0x90, 0xA4, 0x5C, 0x80, 0x16, 0x90, 0xA4, 0x58, 0x12, 0x4B, 0x50, 0x90, 0xAC, 0xB9, 0x12, -+0x27, 0x48, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA4, 0x58, 0x12, 0x4B, 0x50, 0x90, -+0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x58, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x22, 0x90, 0xA5, 0xD2, -+0x74, 0x0A, 0xF0, 0x90, 0xA5, 0xE0, 0x74, 0x06, 0xF0, 0x12, 0x26, 0x1E, 0x90, 0xA5, 0xD4, 0xF0, -+0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA5, 0xD5, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, -+0x90, 0xA5, 0xD6, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x90, 0xA5, 0xD7, 0xF0, 0x90, 0x00, -+0x04, 0x12, 0x26, 0x37, 0x90, 0xA5, 0xD8, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0x90, 0xA5, -+0xD9, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, 0xD2, 0x02, 0x6C, 0x61, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, -+0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x02, 0xC1, 0xCD, 0x90, 0xA4, 0x2F, 0xE0, 0x64, 0x01, 0x70, -+0x34, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x06, 0x90, 0x04, 0xE3, 0xE0, 0x60, 0x1C, 0x90, 0x06, -+0x92, 0x74, 0x04, 0xF0, 0x90, 0xA4, 0x3B, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x30, 0xE0, 0xFF, 0x90, -+0xA4, 0x3B, 0xE0, 0xB5, 0x07, 0x02, 0x80, 0x02, 0xC1, 0xB8, 0xE4, 0x90, 0xA4, 0x2F, 0xF0, 0x90, -+0xA4, 0x39, 0x04, 0xF0, 0x22, 0x90, 0xA4, 0x2F, 0xE0, 0x64, 0x04, 0x70, 0x35, 0x90, 0x06, 0x92, -+0xE0, 0x20, 0xE2, 0x06, 0x90, 0x04, 0xE3, 0xE0, 0x60, 0x1C, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, -+0x90, 0xA4, 0x3B, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x32, 0xE0, 0xFF, 0x90, 0xA4, 0x3B, 0xE0, 0xB5, -+0x07, 0x02, 0x80, 0x02, 0xC1, 0xB8, 0xE4, 0x90, 0xA4, 0x2F, 0xF0, 0x90, 0xA4, 0x39, 0x74, 0x04, -+0xF0, 0x22, 0x90, 0xA4, 0x2F, 0xE0, 0x64, 0x06, 0x60, 0x02, 0xC1, 0x81, 0x90, 0xA4, 0x3C, 0xE0, -+0xB4, 0x04, 0x0F, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x54, 0x0F, 0x90, 0xA4, 0x39, 0x30, 0xE0, 0x4F, -+0xC1, 0xAB, 0x90, 0xA4, 0x2E, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x45, 0xEF, 0x54, -+0xFB, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0xA4, 0x2A, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, 0xC1, -+0x90, 0x90, 0xA4, 0x3C, 0xE0, 0xFF, 0x90, 0xA4, 0x3B, 0xE0, 0x2F, 0xFF, 0xE4, 0x33, 0xFE, 0x7C, -+0x00, 0x7D, 0x03, 0x12, 0x26, 0x98, 0x90, 0xA4, 0x33, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xC3, -+0xEF, 0x94, 0x32, 0xEE, 0x64, 0x80, 0x94, 0x80, 0x90, 0xA4, 0x39, 0x40, 0x02, 0x80, 0x7C, 0x74, -+0x02, 0xF0, 0x22, 0x12, 0x84, 0xE2, 0x90, 0xA4, 0x3C, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x75, -+0x3C, 0x03, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x53, 0x74, 0x05, -+0xF0, 0x90, 0xA4, 0x3C, 0xE0, 0xFF, 0x90, 0xA4, 0x3B, 0xE0, 0x2F, 0xFF, 0xE4, 0x33, 0xFE, 0x7C, -+0x00, 0x7D, 0x03, 0x12, 0x26, 0x98, 0x90, 0xA4, 0x33, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xC3, -+0xEF, 0x94, 0x32, 0xEE, 0x64, 0x80, 0x94, 0x80, 0x40, 0x53, 0x90, 0x07, 0x78, 0x74, 0x03, 0xF0, -+0x22, 0x90, 0xA4, 0x2F, 0xE0, 0x64, 0x07, 0x70, 0x44, 0x90, 0xA4, 0x3C, 0xE0, 0xB4, 0x04, 0x05, -+0x90, 0xA4, 0x39, 0x80, 0x16, 0x90, 0xA4, 0x2E, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, -+0x0E, 0xEF, 0x54, 0xFB, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0xA4, 0x39, 0x74, 0x05, 0xF0, 0x22, 0x12, -+0x84, 0xE2, 0x90, 0xA4, 0x3C, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x75, 0x3C, 0x03, 0xFB, 0xFD, -+0x7F, 0x50, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x53, 0x74, 0x05, 0xF0, 0x22, 0x90, 0xA4, -+0x27, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, -+0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, -+0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, -+0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, -+0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x90, 0xA4, 0x2D, 0xE0, 0x54, 0xDF, -+0xF0, 0xE4, 0x90, 0xA4, 0x2C, 0xF0, 0x90, 0xA4, 0x2E, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, -+0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA4, 0x35, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, -+0xA3, 0x74, 0x02, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x41, 0xE0, 0x54, 0xFE, 0xF0, -+0x54, 0xE1, 0xF0, 0xE4, 0x90, 0xA4, 0x3E, 0xF0, 0x90, 0xA4, 0x4B, 0xE0, 0x54, 0xFE, 0xF0, 0x54, -+0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x54, 0xEF, -+0xF0, 0x54, 0xDF, 0xF0, 0x22, 0xE4, 0x90, 0xA5, 0x5E, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0x20, 0xE0, -+0x03, 0x02, 0xB8, 0x0F, 0x90, 0xA4, 0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x2A, -+0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x33, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, -+0x12, 0x34, 0x8C, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0x90, 0xA4, 0x2F, 0x74, 0x01, 0xF0, 0xE4, -+0x90, 0xA4, 0x3B, 0xF0, 0x90, 0xA4, 0x39, 0xF0, 0x80, 0x20, 0xE4, 0xF5, 0x3B, 0x90, 0xA5, 0x5E, -+0xE0, 0xFF, 0x90, 0xA4, 0x28, 0xE0, 0xC3, 0x9F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, -+0x01, 0x12, 0x34, 0x8C, 0x90, 0xA4, 0x39, 0x74, 0x01, 0xF0, 0x90, 0x01, 0x53, 0x74, 0x05, 0xF0, -+0x90, 0xA4, 0x38, 0x74, 0x01, 0xF0, 0x90, 0xA4, 0x22, 0xE0, 0x60, 0x07, 0x90, 0x05, 0x22, 0x74, -+0x6F, 0xF0, 0x22, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x27, 0xE0, 0xFF, 0xC4, 0x13, 0x54, -+0x07, 0x20, 0xE0, 0x0B, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x76, 0xC4, 0x22, -+0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0xA4, 0x6E, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, -+0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x6F, 0xF0, 0x22, -+0xE4, 0x90, 0xA4, 0x0B, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, -+0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0xA4, 0x11, 0x74, 0x01, -+0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, -+0x90, 0xA4, 0x14, 0xF0, 0x90, 0xA4, 0x13, 0x74, 0x07, 0xF0, 0x90, 0xA4, 0x16, 0xE4, 0xF0, 0xA3, -+0x74, 0x02, 0xF0, 0xE4, 0x90, 0xA4, 0x0F, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xFE, 0xF0, 0x90, -+0xA4, 0x0D, 0x74, 0x0C, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0xA4, 0x0E, 0x74, -+0x0C, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, -+0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0xA4, 0x18, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x00, 0x90, 0xA2, 0x95, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0xA4, 0x15, 0x74, 0xFF, 0xF0, 0x80, 0x12, -+0x90, 0xA2, 0x95, 0xE0, 0x90, 0xA4, 0x15, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, -+0x41, 0xF0, 0x90, 0xA4, 0x1C, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, -+0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x54, -+0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0xE4, 0xA3, -+0xF0, 0x22, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, -+0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x90, 0xA4, 0x27, 0xE0, 0x30, -+0xE0, 0x21, 0x90, 0xA4, 0x38, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x40, 0xF0, 0x21, 0xB9, -+0x90, 0xA4, 0x0D, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x32, 0x90, 0xA4, 0x22, 0xE0, 0x60, -+0x70, 0x80, 0x66, 0x31, 0x02, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, -+0x80, 0x67, 0x90, 0xA4, 0x0F, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, -+0xF0, 0x80, 0x56, 0x90, 0xA4, 0x0D, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x08, 0x90, 0x01, 0xB8, -+0x74, 0x04, 0xF0, 0x80, 0x44, 0xEF, 0x30, 0xE2, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, -+0x38, 0x90, 0xA4, 0x0F, 0xE0, 0x30, 0xE4, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x29, -+0x90, 0xA4, 0x09, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x20, -+0xF0, 0x80, 0x16, 0x90, 0xA4, 0x22, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x80, 0xF0, 0x80, -+0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x7F, -+0x00, 0x22, 0x90, 0x02, 0x96, 0xE0, 0xFF, 0x90, 0x02, 0x87, 0xE0, 0x4F, 0x60, 0x08, 0x90, 0x01, -+0xB8, 0x74, 0x01, 0xF0, 0x80, 0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, -+0x74, 0x04, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, -+0x74, 0x08, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0xA4, 0x0E, 0x74, -+0x02, 0xF0, 0x22, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x04, 0xF0, 0x22, 0xE4, -+0x90, 0xA5, 0x5E, 0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x90, 0xA5, 0x5E, 0xF0, 0xE0, 0x54, 0xC0, 0x70, -+0x0D, 0x90, 0xA4, 0x0F, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x02, 0x77, 0xBF, 0x90, 0xA5, -+0x5E, 0xE0, 0x30, 0xE6, 0x23, 0x90, 0xA4, 0x0B, 0xE0, 0x64, 0x01, 0x70, 0x22, 0x90, 0xA4, 0x0F, -+0xE0, 0x44, 0x01, 0xF0, 0x90, 0xA4, 0x0A, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x05, 0x12, 0x76, -+0xC4, 0x80, 0x0C, 0x12, 0x77, 0x04, 0x80, 0x07, 0x90, 0xA4, 0x0F, 0xE0, 0x54, 0xFE, 0xF0, 0x90, -+0xA5, 0x5E, 0xE0, 0x90, 0xA4, 0x0F, 0x30, 0xE7, 0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, -+0x90, 0xA4, 0x1D, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, -+0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x08, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, -+0xFD, 0xF0, 0x22, 0xE4, 0xFF, 0x90, 0xA4, 0x0B, 0xE0, 0x70, 0x02, 0x61, 0x28, 0x90, 0xA3, 0x87, -+0xE0, 0x64, 0x01, 0x60, 0x02, 0x61, 0x28, 0x90, 0xA4, 0x0A, 0xE0, 0xC4, 0x54, 0x0F, 0x60, 0x24, -+0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1F, 0x90, 0xA4, 0x12, 0xE0, 0x14, 0xF0, 0xE0, 0xFE, 0x60, -+0x06, 0x90, 0xA4, 0x14, 0xE0, 0x60, 0x0F, 0xEE, 0x70, 0x06, 0x90, 0xA4, 0x11, 0xE0, 0xA3, 0xF0, -+0x7F, 0x01, 0x80, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x4F, 0x90, 0xA4, 0x0F, 0xE0, 0x44, 0x10, 0xF0, -+0x90, 0xA4, 0x14, 0xE0, 0x60, 0x03, 0xB4, 0x01, 0x09, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x14, 0xE0, -+0x80, 0x0D, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x14, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, -+0x90, 0xA4, 0x13, 0xE0, 0x2F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, -+0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x0E, 0xE0, 0x20, 0xE2, 0x07, 0x7D, 0x01, -+0x7F, 0x04, 0x12, 0x5C, 0x92, 0x12, 0x5F, 0xEC, 0x22, 0x90, 0xA4, 0x08, 0xE0, 0xFF, 0x13, 0x13, -+0x54, 0x3F, 0x30, 0xE0, 0x11, 0xEF, 0x54, 0xFB, 0xF0, 0x90, 0xA4, 0x0F, 0xE0, 0x54, 0xFD, 0xF0, -+0x54, 0x07, 0x70, 0x42, 0x80, 0x3D, 0x90, 0xA4, 0x14, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x0F, 0xE0, -+0x54, 0xEF, 0xF0, 0x90, 0xA4, 0x14, 0xE0, 0xFF, 0xB4, 0x01, 0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, -+0x06, 0x90, 0x05, 0x58, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x1C, 0xE0, 0xFF, 0x90, 0xA4, 0x14, 0xE0, -+0xD3, 0x9F, 0x40, 0x0F, 0x90, 0xA3, 0x87, 0xE0, 0xB4, 0x01, 0x0B, 0x90, 0xA4, 0x09, 0xE0, 0x54, -+0xFB, 0xF0, 0x22, 0x12, 0x77, 0xBF, 0x22, 0x90, 0xA2, 0x98, 0xE0, 0xFE, 0x90, 0x04, 0x1C, 0xE0, -+0x6E, 0x70, 0x40, 0x90, 0xA4, 0x0E, 0xE0, 0xFE, 0x64, 0x0E, 0x70, 0x1C, 0xEF, 0x70, 0x34, 0x90, -+0xA4, 0x08, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE0, 0x44, 0x80, -+0xF0, 0x90, 0xA4, 0x0E, 0x74, 0x04, 0xF0, 0x22, 0xEE, 0xB4, 0x06, 0x17, 0xEF, 0x60, 0x14, 0x90, -+0xA4, 0x08, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA4, 0x0E, -+0x74, 0x0C, 0xF0, 0x22, 0xE4, 0xFE, 0xEF, 0x25, 0xE0, 0xFD, 0xEF, 0xC3, 0x94, 0x80, 0x90, 0xFD, -+0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, -+0x06, 0x22, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0xA3, 0x86, -+0xE0, 0x9B, 0x90, 0xA3, 0x85, 0xE0, 0x9A, 0x50, 0x13, 0xA3, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0xA3, -+0x85, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, -+0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFF, 0x22, -+0x24, 0xCF, -+}; -+u4Byte ArrayLength_MP_8812A_FW_NIC_BT = 31826; -+ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_NIC_BT( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+) -+{ -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8812A_FW_NIC_BT; -+ *pFirmwareSize = ArrayLength_MP_8812A_FW_NIC_BT; -+} -+ -+u1Byte Array_MP_8812A_FW_WoWLAN[] = { -+0x01, 0x95, 0x30, 0x00, 0x12, 0x00, 0x00, 0x00, 0x04, 0x25, 0x11, 0x07, 0x3A, 0x50, 0x00, 0x00, -+0x7D, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x4C, 0xD5, 0x02, 0x5B, 0xBD, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x5C, 0xC9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x6E, 0xDE, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x5C, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x68, 0x02, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, -+0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, -+0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, -+0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, -+0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, -+0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, -+0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, -+0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, -+0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, -+0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, -+0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, -+0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, -+0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, -+0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, -+0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, -+0x82, 0x23, 0x90, 0x47, 0x50, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, -+0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, -+0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, -+0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, -+0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, 0x25, -+0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, -+0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, -+0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, -+0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, -+0x80, 0xDF, 0xE3, 0xF5, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, 0xDF, 0xF5, 0x80, 0x67, 0xE3, -+0xF5, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, 0x5A, 0x87, 0xF0, 0x09, 0xE6, -+0x08, 0xB5, 0xF0, 0x52, 0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x46, -+0xDF, 0xF6, 0x80, 0x42, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x36, -+0xDF, 0xF6, 0x80, 0x32, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, -+0x25, 0xDF, 0xF5, 0x80, 0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE0, 0xA3, 0xB5, -+0xF0, 0x14, 0xDF, 0xF5, 0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE4, 0x93, -+0xA3, 0xB5, 0xF0, 0x02, 0xDF, 0xF4, 0x02, 0x49, 0xB1, 0x80, 0x87, 0x80, 0xE9, 0x80, 0x90, 0x80, -+0xD4, 0x80, 0x3E, 0x80, 0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, 0x80, 0xB7, 0x80, 0x8D, 0x80, -+0xA3, 0x80, 0x51, 0x80, 0x74, 0x80, 0x3C, 0x02, 0x49, 0xBD, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, -+0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, -+0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, 0xDF, 0xE3, 0xDE, 0xE1, 0x80, -+0x70, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, 0xB5, 0xF0, 0x62, 0xDF, -+0xF4, 0x80, 0x5E, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x51, -+0xDF, 0xF5, 0x80, 0x4D, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, 0xB5, 0xF0, -+0x40, 0xDF, 0xF5, 0x80, 0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE6, 0x08, -+0xB5, 0xF0, 0x2E, 0xDF, 0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, 0x89, 0x82, 0x8A, 0x83, 0xEC, -+0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE0, 0xA3, -+0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, -+0x00, 0x7F, 0xFF, 0xB5, 0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x89, 0x82, 0x8A, -+0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE0, -+0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xD5, 0xDF, 0xE5, 0xDE, 0xE3, -+0x80, 0xCF, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, -+0xF0, 0xAF, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, -+0xAB, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, -+0x00, 0x50, 0x8E, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x48, 0xF9, 0x73, 0xC2, 0xAF, 0x80, 0xFE, -+0x32, 0x12, 0x4A, 0x30, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, 0xC2, 0x8C, 0xE5, 0x8A, -+0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, 0xEC, 0x24, 0x87, 0xF8, -+0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, 0x40, 0xCE, 0x79, 0x03, -+0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, 0x03, 0x44, 0x18, 0xF6, -+0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, 0x23, 0x24, 0x81, 0xF8, -+0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, 0xE4, 0xF2, 0x00, 0xE5, -+0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, 0xE6, 0xFD, 0xA6, 0x81, -+0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, 0x6D, 0x60, 0xE0, 0x08, -+0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, 0x0C, 0x24, 0x87, 0xF8, -+0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, 0xF8, 0xE5, 0x81, 0x6D, -+0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, 0xC8, 0xF6, 0x15, 0x0C, -+0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, 0xE6, 0x30, 0xE0, 0x03, -+0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, 0x08, 0x54, 0xF4, 0x54, -+0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, 0x81, 0x74, 0x02, 0x60, -+0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, 0xF6, 0x08, 0xF6, 0x08, -+0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4D, 0x6D, 0x74, 0x01, 0x93, 0xC0, 0xE0, 0xE4, 0x93, -+0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, 0x8C, 0xD2, 0xAF, 0x22, -+0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, 0x2F, 0x2F, 0xF8, 0xE6, -+0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, 0x0C, 0xEE, 0xC3, 0x9F, -+0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, 0xBE, 0x02, 0x02, 0x74, -+0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, 0x09, 0x80, 0xF3, 0x16, -+0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, 0xEE, 0xD3, 0x9F, 0x40, -+0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, 0xA9, 0x81, 0x18, 0x06, -+0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, 0xF7, 0x19, 0x80, 0xF3, -+0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, 0x04, 0x90, 0x4D, 0x6D, -+0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, -+0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x54, -+0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, 0xF8, 0xE6, 0xF5, 0x81, -+0x02, 0x4A, 0x79, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, 0x02, 0x74, 0xFF, 0xFD, -+0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, 0x60, 0x08, 0xA8, 0x05, -+0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, 0x0C, 0xB5, 0x07, 0xE3, -+0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, 0x0F, 0x74, 0x86, 0x2F, -+0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, 0x81, 0xED, 0x6C, 0x60, -+0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, 0x07, 0xDE, 0x89, 0x81, -+0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, -+0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, 0xD2, 0xE2, 0xC6, 0xD2, -+0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x4A, 0x78, 0x8F, 0xF0, 0xE4, 0xFF, 0xFE, 0xE5, -+0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, 0xE6, 0x60, 0x0B, 0x2D, -+0xF6, 0x60, 0x30, 0x50, 0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, 0x60, 0x25, 0x7E, 0x02, -+0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, 0xE2, 0x0C, 0xD2, 0xAF, -+0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, 0x4E, 0xF6, 0xD2, 0xAF, -+0x02, 0x4A, 0x79, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, -+0x54, 0x80, 0x4F, 0xFF, 0x22, 0x02, 0x4D, 0x13, 0x02, 0x4B, 0x09, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, -+0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, -+0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, -+0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, -+0x20, 0x40, 0x80, 0x90, 0x4D, 0x58, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, -+0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, -+0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, -+0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, -+0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x00, 0x41, 0x90, 0xDA, 0x00, 0x41, 0x90, 0xDB, -+0x00, 0x41, 0x90, 0xDC, 0x00, 0x41, 0x90, 0xF8, 0x00, 0x41, 0x90, 0xFB, 0x00, 0x4E, 0x77, 0x4F, -+0xAE, 0x4F, 0xF6, 0x90, 0x00, 0xF0, 0xE0, 0x7F, 0x01, 0x20, 0xE2, 0x02, 0x7F, 0x03, 0x22, 0xB1, -+0x73, 0x90, 0x8D, 0x04, 0xEF, 0xF0, 0xB1, 0x91, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, -+0x95, 0xD1, 0x16, 0xD1, 0x46, 0xB1, 0xB3, 0xB1, 0xD2, 0xB1, 0xF1, 0xE4, 0xF5, 0x51, 0x75, 0x52, -+0x58, 0xAB, 0x51, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x52, 0x7D, 0x03, 0x7F, 0x01, -+0x02, 0x39, 0x04, 0x75, 0x5D, 0x10, 0xE4, 0xF5, 0x5E, 0x75, 0x5F, 0x07, 0x75, 0x60, 0x42, 0x90, -+0x01, 0x30, 0xE5, 0x5D, 0xF0, 0xA3, 0xE5, 0x5E, 0xF0, 0xA3, 0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, -+0xF0, 0x22, 0x75, 0x65, 0x06, 0x75, 0x66, 0x01, 0x75, 0x67, 0x03, 0x75, 0x68, 0x62, 0x90, 0x01, -+0x38, 0xE5, 0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, 0x67, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, -+0x22, 0xE4, 0xF5, 0x55, 0xF5, 0x56, 0xF5, 0x57, 0xF5, 0x58, 0xAD, 0x55, 0x7F, 0x50, 0x12, 0x3A, -+0x96, 0xAD, 0x56, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xAD, 0x57, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xAD, -+0x58, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x30, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, -+0xF0, 0x90, 0x01, 0x38, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x3A, -+0x96, 0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, -+0xFD, 0x7F, 0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x34, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, -+0xA3, 0xF0, 0x90, 0x01, 0x3C, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, -+0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x3A, 0x96, -+0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x3A, 0x96, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, -+0x12, 0x3A, 0x96, 0xF1, 0x16, 0x12, 0x3A, 0xB8, 0xF1, 0x7E, 0xF1, 0x02, 0x7F, 0x01, 0x71, 0x41, -+0x90, 0x8F, 0xA3, 0x74, 0x02, 0xF0, 0xFF, 0x71, 0x41, 0x90, 0x8F, 0xA3, 0xE0, 0x04, 0xF0, 0xB1, -+0x7F, 0xD1, 0xD5, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, 0x75, -+0x28, 0xFF, 0xD1, 0xFB, 0x12, 0x74, 0x4A, 0x90, 0x00, 0xF1, 0xE0, 0x54, 0xF0, 0xD3, 0x94, 0x10, -+0x40, 0x08, 0x90, 0x8F, 0xAD, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x8F, 0xAD, 0xF0, 0xF1, -+0x0C, 0xE4, 0xFF, 0x61, 0xCA, 0xD1, 0xF5, 0xF1, 0x23, 0x12, 0x86, 0x1C, 0xF1, 0x31, 0xF1, 0x40, -+0x90, 0x8F, 0xA7, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, -+0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xE4, 0x90, 0x8D, 0xF6, 0xF0, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, -+0x85, 0x22, 0xE4, 0x90, 0x8D, 0x01, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, -+0x12, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, -+0xE4, 0xF0, 0x22, 0xE4, 0x90, 0x8D, 0xF2, 0xF0, 0xA3, 0xF0, 0x90, 0x8D, 0x5A, 0xF0, 0xA3, 0xF0, -+0x22, 0x90, 0x8E, 0x92, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, -+0x90, 0x8F, 0xA4, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, -+0xF0, 0x22, 0xD1, 0xE0, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8F, 0xA7, 0xE0, 0x54, -+0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x14, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, -+0x8F, 0xA8, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0x8F, 0xA9, 0xF0, 0x22, 0x90, 0x01, -+0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, -+0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, -+0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0xE4, 0x90, -+0x90, 0x02, 0xF0, 0x90, 0x90, 0x02, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0xAE, 0x90, 0x01, 0xC4, 0xF0, -+0x74, 0x4F, 0xA3, 0xF0, 0x12, 0x3A, 0xEB, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x69, 0x90, 0x8E, 0x7A, -+0xE0, 0x60, 0x0F, 0x90, 0x8E, 0x7D, 0xE0, 0xFF, 0x90, 0x8E, 0x7C, 0xE0, 0x6F, 0x60, 0x03, 0x12, -+0x68, 0xDF, 0xC2, 0xAF, 0x12, 0x74, 0xAD, 0xBF, 0x01, 0x03, 0x12, 0x77, 0xC4, 0xD2, 0xAF, 0x12, -+0x57, 0xED, 0x51, 0x79, 0x80, 0xBD, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x91, 0x7A, 0x90, 0x90, -+0x03, 0xEF, 0xF0, 0x60, 0xF1, 0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x60, 0xEA, 0xC2, 0xAF, 0x30, 0xE1, -+0x06, 0x54, 0xFD, 0xF0, 0x12, 0x60, 0x2C, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x8D, 0x01, 0xE0, 0xFF, -+0x30, 0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, 0x58, 0xB3, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x8D, 0x01, -+0xE0, 0xFF, 0x30, 0xE4, 0x0B, 0x54, 0xEF, 0xF0, 0x12, 0x83, 0x33, 0xBF, 0x01, 0x02, 0x11, 0x44, -+0xD2, 0xAF, 0x80, 0xC1, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x90, 0x0E, 0xF0, -+0xA3, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, -+0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, -+0x90, 0x04, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x82, 0xE0, 0x90, 0x90, 0x0D, 0xF0, 0x90, 0x8E, -+0x96, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x85, 0x90, 0x8E, 0x9B, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x01, -+0x3F, 0xE0, 0x30, 0xE2, 0x02, 0xB1, 0x23, 0xE4, 0x90, 0x90, 0x0C, 0xF0, 0x90, 0x90, 0x0D, 0xE0, -+0xFF, 0x90, 0x90, 0x0C, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0x41, 0x85, 0x90, 0x90, 0x04, 0xE0, 0xFC, -+0xA3, 0xE0, 0xFD, 0xEC, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x90, 0x14, 0xEF, 0xF0, 0x74, 0x01, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0xFE, 0x90, -+0x90, 0x06, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x90, 0x12, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x02, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, -+0x90, 0x90, 0x0A, 0xF0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x90, 0x05, 0xE0, 0x2F, 0xFF, -+0x90, 0x90, 0x04, 0xE0, 0x3E, 0xFE, 0x90, 0x90, 0x08, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xFD, 0x51, -+0x98, 0xC0, 0x07, 0x90, 0x90, 0x08, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7D, 0x04, 0x51, 0x98, 0xAD, -+0x07, 0xD0, 0x07, 0xB1, 0x64, 0x90, 0x90, 0x0E, 0xEF, 0xF0, 0x90, 0x90, 0x08, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0xE4, 0xFD, 0x51, 0x98, 0xEF, 0x54, 0xFC, 0x90, 0x90, 0x0B, 0xF0, 0x90, 0x90, 0x0A, -+0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0x90, 0x90, 0x06, 0x8F, 0xF0, 0x12, 0x47, 0xF6, 0x90, 0x90, -+0x06, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x83, 0x0A, 0x90, 0x90, 0x06, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0x90, 0x04, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7D, 0x0F, 0x51, 0x98, 0x90, 0x90, 0x06, -+0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x90, 0x90, 0x04, 0xEC, 0x8D, 0xF0, 0x12, 0x47, 0xF6, 0x90, 0x8D, -+0xF4, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x90, 0x90, 0x05, 0xE0, 0x9D, 0x90, 0x90, 0x04, 0xE0, -+0x9C, 0x40, 0x1B, 0x90, 0x8D, 0xF5, 0xE0, 0x24, 0x01, 0xFD, 0x90, 0x8D, 0xF4, 0xE0, 0x34, 0x00, -+0xFC, 0xC3, 0x90, 0x90, 0x05, 0xE0, 0x9D, 0xF0, 0x90, 0x90, 0x04, 0xE0, 0x9C, 0xF0, 0xEF, 0x30, -+0xE7, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x21, 0xF0, 0xEF, 0x30, 0xE6, 0x06, 0x90, 0x01, 0xC7, 0x74, -+0x22, 0xF0, 0xEF, 0x30, 0xE5, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x23, 0xF0, 0x90, 0x90, 0x0B, 0xE0, -+0x24, 0x40, 0x60, 0x04, 0x24, 0x20, 0x70, 0x32, 0x90, 0x8E, 0x97, 0xE0, 0xFF, 0xC4, 0x13, 0x13, -+0x13, 0x54, 0x01, 0x30, 0xE0, 0x59, 0x90, 0x8E, 0xA8, 0xE0, 0x04, 0xF0, 0x90, 0x90, 0x08, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x84, 0x8F, 0xEF, 0x60, 0x45, 0x90, 0x90, 0x0B, 0xE0, 0xFF, 0x12, -+0x84, 0x78, 0x90, 0x8E, 0xA9, 0xE0, 0x04, 0xF0, 0x80, 0x35, 0x90, 0x90, 0x08, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x90, 0x90, 0x0E, 0xE0, 0xFD, 0x90, 0x90, 0x11, 0xE0, 0xFB, 0x90, 0x90, 0x14, 0xE0, -+0x90, 0x90, 0x19, 0xF0, 0x91, 0x98, 0x90, 0x8E, 0x96, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x0F, -+0x90, 0x90, 0x08, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x90, 0x0E, 0xE0, 0xFD, 0x51, 0xD6, 0x12, -+0x84, 0xE9, 0xEF, 0x64, 0x01, 0x60, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x02, 0xB1, 0x23, -+0x12, 0x84, 0x52, 0xBF, 0x01, 0x0E, 0x90, 0x8E, 0xAA, 0xE0, 0x04, 0xF0, 0x90, 0x90, 0x04, 0x12, -+0x82, 0x36, 0x80, 0x09, 0x90, 0x8E, 0x96, 0xE0, 0x54, 0xFE, 0xF0, 0x80, 0x08, 0x90, 0x90, 0x0C, -+0xE0, 0x04, 0xF0, 0x01, 0x9C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xCD, 0x34, 0x00, 0xFC, 0x7E, 0x00, -+0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0xE4, 0xFD, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, -+0x3A, 0xFA, 0xC3, 0x90, 0x8D, 0xF5, 0xE0, 0x9B, 0x90, 0x8D, 0xF4, 0xE0, 0x9A, 0x50, 0x13, 0xA3, -+0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8D, 0xF4, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, -+0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0xFB, 0xF5, 0x83, 0xE0, 0xFF, 0x22, 0x90, 0x90, 0x15, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, -+0xF0, 0x78, 0x1E, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x50, 0x7E, 0x00, 0x7F, -+0x06, 0x12, 0x47, 0xD0, 0x78, 0x24, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x56, -+0x7E, 0x00, 0x7F, 0x04, 0x12, 0x47, 0xD0, 0x78, 0x28, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, -+0x40, 0x79, 0x5A, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x47, 0xD0, 0x90, 0x90, 0x17, 0xE0, 0xFF, 0x90, -+0x90, 0x16, 0xE0, 0x2F, 0xFF, 0x90, 0x90, 0x15, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x06, 0xCF, 0x34, -+0x00, 0xFE, 0xE4, 0xFD, 0x51, 0x98, 0xEF, 0x64, 0x08, 0x60, 0x02, 0x81, 0x97, 0x90, 0x90, 0x17, -+0xE0, 0xFF, 0x90, 0x90, 0x16, 0xE0, 0x2F, 0xFF, 0x90, 0x90, 0x15, 0xE0, 0x34, 0x00, 0xCF, 0x24, -+0x07, 0xCF, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0x98, 0xEF, 0x64, 0x06, 0x60, 0x02, 0x81, 0x97, -+0x90, 0x90, 0x2C, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x50, 0x24, 0x90, 0x90, -+0x16, 0xE0, 0x24, 0x0A, 0xFD, 0x90, 0x90, 0x15, 0xE0, 0x51, 0x8B, 0x90, 0x90, 0x2C, 0xE0, 0x24, -+0x18, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0x04, 0xF0, -+0x80, 0xD2, 0xE4, 0x90, 0x90, 0x2C, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x50, -+0x2D, 0x90, 0x90, 0x17, 0xE0, 0xFD, 0x90, 0x90, 0x16, 0xE0, 0x2D, 0xFD, 0x90, 0x90, 0x15, 0xE0, -+0x34, 0x00, 0xCD, 0x24, 0x10, 0x51, 0x8A, 0x90, 0x90, 0x2C, 0xE0, 0x24, 0x1E, 0xF5, 0x82, 0xE4, -+0x34, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0x04, 0xF0, 0x80, 0xC9, 0xE4, 0x90, -+0x90, 0x2C, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x2D, 0x90, 0x90, 0x17, -+0xE0, 0xFD, 0x90, 0x90, 0x16, 0xE0, 0x2D, 0xFD, 0x90, 0x90, 0x15, 0xE0, 0x34, 0x00, 0xCD, 0x24, -+0x16, 0x51, 0x8A, 0x90, 0x90, 0x2C, 0xE0, 0x24, 0x24, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, -+0xEF, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0x04, 0xF0, 0x80, 0xC9, 0x78, 0x18, 0x7C, 0x90, 0x7D, 0x01, -+0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xA2, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x4A, 0x08, 0xEF, 0x70, 0x77, -+0x90, 0x90, 0x2C, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x2D, 0x90, 0x90, -+0x17, 0xE0, 0xFD, 0x90, 0x90, 0x16, 0xE0, 0x2D, 0xFD, 0x90, 0x90, 0x15, 0xE0, 0x34, 0x00, 0xCD, -+0x24, 0x20, 0x51, 0x8A, 0x90, 0x90, 0x2C, 0xE0, 0x24, 0x28, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, -+0x83, 0xEF, 0xF0, 0x90, 0x90, 0x2C, 0xE0, 0x04, 0xF0, 0x80, 0xC9, 0x78, 0x28, 0x7C, 0x90, 0x7D, -+0x01, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xAB, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x4A, 0x08, 0xEF, 0x90, -+0x06, 0x30, 0x70, 0x1D, 0xE0, 0x44, 0x01, 0x54, 0xDF, 0xF0, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x1E, -+0x90, 0x90, 0x30, 0x12, 0x48, 0x53, 0xE4, 0x90, 0x90, 0x33, 0xF0, 0x7A, 0x90, 0x79, 0x24, 0xA1, -+0x7C, 0xE0, 0x44, 0x21, 0x54, 0xEF, 0xF0, 0x22, 0x90, 0x90, 0x17, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, -+0x90, 0x90, 0x15, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xFD, 0x51, 0x98, 0xEF, 0x54, 0x0C, 0x64, -+0x08, 0x70, 0x6F, 0x90, 0x90, 0x15, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0x06, 0xFD, -+0x51, 0x98, 0xEF, 0x64, 0x88, 0x70, 0x5B, 0x90, 0x90, 0x15, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, -+0xE0, 0x24, 0x07, 0xFD, 0x51, 0x98, 0xEF, 0x64, 0x8E, 0x70, 0x47, 0x90, 0x90, 0x15, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0x90, 0x90, 0x18, 0xE0, 0xFD, 0x90, 0x90, 0x17, 0xE0, 0x2D, 0x04, 0xFD, 0x51, -+0x98, 0xEF, 0x64, 0x03, 0x70, 0x2C, 0x90, 0x90, 0x15, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x90, -+0x18, 0xE0, 0xFD, 0x90, 0x90, 0x17, 0xE0, 0x2D, 0x24, 0x06, 0xFD, 0x51, 0x98, 0xEF, 0x90, 0x01, -+0xC7, 0x30, 0xE3, 0x04, 0x74, 0x01, 0x80, 0x02, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x9B, 0xE0, 0x44, -+0x01, 0xF0, 0x22, 0x90, 0x8D, 0x04, 0xE0, 0xB4, 0x02, 0x15, 0x90, 0x8E, 0x98, 0xE0, 0xC4, 0x13, -+0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x0F, 0x90, 0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x22, 0x90, -+0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xFE, 0x24, 0x28, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x2C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0xFD, 0xE4, 0xFE, 0xEF, 0x30, 0xE7, 0x04, 0x7C, 0x02, 0x80, 0x02, 0xE4, 0xFC, -+0xAF, 0x05, 0xF1, 0x1F, 0xAE, 0x07, 0xEC, 0x24, 0x18, 0x2E, 0xFF, 0x22, 0x90, 0x90, 0x2D, 0x12, -+0x48, 0x53, 0x90, 0x8F, 0x97, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x6A, 0xDD, 0x90, 0x90, 0x34, 0xB1, -+0x47, 0x90, 0x90, 0x36, 0xEF, 0xF0, 0x90, 0x90, 0x34, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, 0x34, -+0xFC, 0xFA, 0x7B, 0x01, 0x90, 0x90, 0x33, 0xE0, 0xFD, 0xD1, 0x53, 0x90, 0x90, 0x34, 0xA3, 0xE0, -+0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, -+0x90, 0x30, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0xD0, 0x01, -+0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x34, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, -+0x24, 0x42, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, -+0x90, 0x30, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0xD0, 0x01, -+0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x34, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, -+0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, -+0x90, 0x2D, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0xD0, 0x01, -+0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x10, 0xF0, 0x12, 0x76, -+0x12, 0xBF, 0x01, 0x0E, 0x90, 0x8F, 0x97, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x04, 0x1F, 0x74, -+0x20, 0xF0, 0x22, 0x90, 0x90, 0xB8, 0xED, 0xF0, 0x90, 0x90, 0xB5, 0x12, 0x48, 0x53, 0xE4, 0x90, -+0x90, 0xB9, 0xF0, 0xA3, 0xF0, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFD, -+0xB1, 0x64, 0x90, 0x90, 0xB9, 0xEF, 0xF0, 0x90, 0x90, 0xB5, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x04, -+0x12, 0x26, 0x37, 0xFF, 0xF1, 0x1F, 0x90, 0x90, 0xBA, 0xEF, 0xF0, 0x90, 0x8E, 0xAF, 0xE0, 0x24, -+0xFE, 0x60, 0x1E, 0x24, 0xFE, 0x60, 0x1A, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, -+0x54, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xB0, 0x90, 0x90, 0xB8, 0xE0, 0xFD, 0x12, 0x8F, 0xBE, 0x80, -+0x16, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xB0, 0x90, 0x90, 0xB8, 0xE0, 0xFD, 0x90, 0x8E, 0xAF, 0xE0, -+0x90, 0x90, 0x92, 0xF0, 0x12, 0x8E, 0x9C, 0x90, 0x90, 0xBA, 0xE0, 0xFF, 0x90, 0x90, 0xB5, 0x12, -+0x48, 0x4A, 0x90, 0x90, 0xB9, 0xE0, 0x7C, 0x00, 0x29, 0xF9, 0xEC, 0x3A, 0xFA, 0xC3, 0xE9, 0x9F, -+0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x40, 0x01, 0x75, 0x41, 0x8E, 0x75, 0x42, 0xB0, 0xA3, 0xE0, -+0xF5, 0x43, 0x12, 0x34, 0x2C, 0x22, 0x12, 0x6C, 0x6D, 0x7E, 0x00, 0x90, 0x90, 0x07, 0xB1, 0x47, -+0x90, 0x90, 0x07, 0xA3, 0xE0, 0x2F, 0x24, 0x3E, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, 0xF5, -+0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xAB, 0x02, 0x34, 0x2C, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x20, 0xE0, 0x05, 0x90, 0x8F, 0x94, 0x80, 0x03, 0x90, -+0x8F, 0x95, 0xE0, 0x90, 0x8E, 0xAF, 0xF0, 0x90, 0x8E, 0xAF, 0xE0, 0x14, 0x60, 0x13, 0x14, 0x60, -+0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, 0x60, 0x09, 0x14, 0x60, 0x06, 0x24, 0x06, 0xE4, 0xFE, 0x80, -+0x06, 0x7E, 0x04, 0x80, 0x02, 0x7E, 0x08, 0xAF, 0x06, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8F, -+0xA7, 0xE0, 0x30, 0xE0, 0x47, 0x90, 0x8F, 0xAB, 0xE0, 0xFD, 0x60, 0x40, 0x74, 0x01, 0x7E, 0x00, -+0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, -+0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x06, 0xE4, 0x90, 0x8F, 0xAB, 0xF0, 0x22, 0x90, 0x8F, 0xA9, 0xE0, -+0xD3, 0x9D, 0x50, 0x10, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0xB1, 0x23, 0x90, 0x8F, 0xA7, 0xE0, -+0x54, 0xFE, 0xF0, 0x22, 0xF1, 0xAD, 0x90, 0x8F, 0xAB, 0xE0, 0x04, 0xF0, 0x22, 0xE4, 0xFF, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x11, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1F, 0x90, 0x05, -+0x22, 0xE0, 0xF5, 0x14, 0x74, 0xFF, 0xF0, 0x12, 0x76, 0xCD, 0xBF, 0x01, 0x08, 0xAF, 0x11, 0x12, -+0x88, 0xB4, 0x12, 0x6B, 0x48, 0x90, 0x05, 0x22, 0xE5, 0x14, 0xF0, 0x80, 0x03, 0x12, 0x6B, 0x48, -+0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x72, 0xED, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x90, 0x80, 0xF0, 0x90, 0x01, 0xC7, -+0xE0, 0x64, 0xAD, 0x70, 0x36, 0xF0, 0x90, 0x90, 0x8D, 0x74, 0x0F, 0xF0, 0x90, 0x90, 0x7F, 0x74, -+0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x90, 0x80, 0xE0, 0x2F, 0xFE, 0x74, 0x81, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x0F, 0xE9, 0x90, 0x01, 0x3F, -+0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x7F, 0x11, 0x40, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0xD2, 0x12, 0x48, 0x53, 0x7F, 0x96, 0x7E, -+0x02, 0x31, 0x84, 0xEF, 0x60, 0x58, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, -+0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x90, -+0xD5, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x90, 0xD5, 0xE0, 0xFD, 0x90, 0x02, -+0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x90, 0xD2, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x0E, 0x12, 0x26, -+0x37, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0x31, 0xDA, 0x90, 0x90, 0xD5, 0xE0, 0x24, 0x18, 0xFF, -+0x90, 0x90, 0xD2, 0x12, 0x48, 0x4A, 0x51, 0x35, 0x90, 0x02, 0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x8D, 0xF3, 0xE0, -+0xFE, 0x90, 0x8D, 0xF2, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, -+0x64, 0x01, 0x60, 0x48, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x13, 0xED, 0x75, 0xF0, 0x0F, 0xA4, 0x24, -+0x5C, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x31, 0x21, 0x7F, 0x01, 0x90, 0x8D, 0xF2, -+0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x5C, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x11, -+0x40, 0x7F, 0x01, 0xEF, 0x60, 0x16, 0x90, 0x8D, 0xF2, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, -+0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8D, 0xF2, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0x04, 0x12, 0x48, 0x53, 0x90, 0x90, -+0xDC, 0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, 0x7F, 0xAF, 0x7E, 0x01, -+0x31, 0x84, 0xEF, 0x60, 0x3A, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, -+0x42, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x01, 0x79, -+0xA0, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, -+0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0xCA, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x90, 0xCA, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, -+0x82, 0x8E, 0x83, 0xE0, 0x60, 0x2D, 0xC3, 0x90, 0x90, 0xCD, 0xE0, 0x94, 0xE8, 0x90, 0x90, 0xCC, -+0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x15, -+0x90, 0x90, 0xCC, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3A, -+0xF7, 0x80, 0xC5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, -+0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xEE, 0x74, 0x00, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, -+0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, -+0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x90, 0xCE, 0xEF, 0xF0, 0xA3, 0x12, 0x48, 0x53, 0x90, 0x90, -+0xDB, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, 0x76, 0x74, 0x00, 0x2F, 0xF9, -+0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x90, 0xCF, 0x12, -+0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, -+0x03, 0x12, 0x34, 0x2C, 0x90, 0x90, 0xCE, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, -+0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x48, 0x4A, 0xE9, 0x24, 0x02, 0xF9, 0xE4, -+0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0x90, 0xCF, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x0E, -+0x12, 0x26, 0x37, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x2C, 0x90, 0x90, -+0x9C, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xFB, 0xA3, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xE4, -+0x90, 0x90, 0xA6, 0xF0, 0xEB, 0x90, 0x90, 0x9D, 0xF0, 0x90, 0x8F, 0xAD, 0xE0, 0x70, 0x3D, 0x90, -+0x90, 0x9C, 0xE0, 0x70, 0x17, 0xFF, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x04, 0xFF, 0xEC, -+0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x80, 0x1D, 0x90, 0x90, 0x9C, 0xE0, -+0xB4, 0x01, 0x19, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x04, 0xFF, 0xEC, 0x90, -+0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x90, 0x9D, 0xE0, -+0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x90, 0xA2, 0x12, 0x27, 0x48, 0x90, 0x90, 0xA2, 0x12, 0x48, -+0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x8F, -+0xAD, 0xE0, 0x70, 0x26, 0x90, 0x90, 0xA2, 0x12, 0x48, 0x26, 0xEE, 0x44, 0x01, 0xFE, 0xEC, 0x90, -+0x90, 0xA2, 0x12, 0x27, 0x48, 0x90, 0x90, 0xA2, 0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x48, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x80, 0x07, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, -+0xF7, 0x90, 0x90, 0x9C, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, -+0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x36, 0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, -+0x90, 0x90, 0x9E, 0x12, 0x27, 0x48, 0x90, 0x90, 0x9E, 0x02, 0x48, 0x26, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x51, 0xAE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0x90, 0xB1, 0x12, 0x48, 0x26, 0x90, 0xAC, 0x9C, 0x12, 0x27, -+0x48, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0x32, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, -+0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, -+0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xBD, 0xF0, -+0x74, 0x5B, 0xA3, 0xF0, 0x91, 0x0C, 0x74, 0xBD, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x5B, 0xA3, -+0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x7B, 0x00, 0x7A, 0x00, -+0x79, 0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x51, 0x52, 0x53, 0x7B, 0x00, 0x7A, -+0x00, 0x79, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x52, 0x52, 0x54, 0xAB, 0x53, -+0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x02, 0x39, 0x04, -+0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, -+0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, -+0x74, 0x40, 0xF0, 0x74, 0x5C, 0xA3, 0xF0, 0x91, 0x8F, 0x74, 0x40, 0x04, 0x90, 0x01, 0xC4, 0xF0, -+0x74, 0x5C, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, -+0x00, 0x54, 0xE0, 0x55, 0x55, 0xF5, 0x59, 0xA3, 0xE0, 0x55, 0x56, 0xF5, 0x5A, 0xA3, 0xE0, 0x55, -+0x57, 0xF5, 0x5B, 0xA3, 0xE0, 0x55, 0x58, 0xF5, 0x5C, 0xAD, 0x59, 0x7F, 0x54, 0x12, 0x3A, 0x96, -+0xAD, 0x5A, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0xAD, 0x5B, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0xAD, 0x5C, -+0x7F, 0x57, 0x12, 0x3A, 0x96, 0x53, 0x91, 0xEF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, -+0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xC9, 0xF0, 0x74, 0x5C, 0xA3, 0xF0, -+0x12, 0x74, 0xD4, 0xE5, 0x61, 0x30, 0xE3, 0x03, 0x12, 0x6C, 0x46, 0xE5, 0x61, 0x30, 0xE4, 0x03, -+0x12, 0x6C, 0x3F, 0xE5, 0x63, 0x30, 0xE0, 0x02, 0xB1, 0x6F, 0xE5, 0x63, 0x30, 0xE1, 0x03, 0x12, -+0x75, 0x01, 0xE5, 0x63, 0x30, 0xE2, 0x03, 0x12, 0x66, 0xF9, 0xE5, 0x63, 0x30, 0xE3, 0x03, 0x12, -+0x75, 0xDF, 0xE5, 0x63, 0x30, 0xE4, 0x03, 0x12, 0x6C, 0xB7, 0xE5, 0x63, 0x30, 0xE5, 0x03, 0x12, -+0x6A, 0x7F, 0xE5, 0x63, 0x30, 0xE6, 0x03, 0x12, 0x6C, 0x52, 0xE5, 0x64, 0x30, 0xE1, 0x03, 0x12, -+0x6C, 0xAE, 0xE5, 0x64, 0x30, 0xE6, 0x02, 0xF1, 0xEB, 0x74, 0xC9, 0x04, 0x90, 0x01, 0xC4, 0xF0, -+0x74, 0x5C, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, -+0xFF, 0x90, 0x8E, 0x7A, 0xE0, 0x70, 0x02, 0xA1, 0xFA, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, -+0x79, 0x90, 0x8E, 0x79, 0xE0, 0xC4, 0x54, 0x0F, 0x60, 0x24, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, -+0x1F, 0x90, 0x8E, 0x81, 0xE0, 0x14, 0xF0, 0xE0, 0xFE, 0x60, 0x06, 0x90, 0x8E, 0x83, 0xE0, 0x60, -+0x0F, 0xEE, 0x70, 0x06, 0x90, 0x8E, 0x80, 0xE0, 0xA3, 0xF0, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x01, -+0xEF, 0x60, 0x47, 0x90, 0x8E, 0x7E, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x8E, 0x83, 0xE0, 0x60, 0x03, -+0xB4, 0x01, 0x09, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x83, 0xE0, 0x80, 0x0D, 0xE4, 0xF5, 0x3B, 0x90, -+0x8E, 0x83, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0x8E, 0x82, 0xE0, 0x2F, 0xF5, -+0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, -+0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x20, 0xE2, 0x02, 0xB1, 0xFB, 0x22, 0x7D, 0x01, 0x7F, 0x04, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0xFA, 0xED, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0xFE, -+0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xE1, 0x52, 0xEE, 0xC4, 0x13, 0x13, 0x13, 0x54, -+0x01, 0x30, 0xE0, 0x02, 0xE1, 0x52, 0x90, 0x8E, 0x7D, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0xE1, 0x52, -+0xEF, 0x70, 0x02, 0xC1, 0xC4, 0x24, 0xFE, 0x70, 0x02, 0xC1, 0xFF, 0x24, 0xFE, 0x60, 0x4B, 0x24, -+0xFC, 0x70, 0x02, 0xE1, 0x3C, 0x24, 0xFC, 0x60, 0x02, 0xE1, 0x52, 0xEE, 0xB4, 0x0E, 0x02, 0xF1, -+0xC3, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x65, 0xFC, 0x90, 0x8E, 0x7D, 0xE0, -+0xB4, 0x06, 0x02, 0xF1, 0x9D, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x04, 0x0F, 0x90, 0x90, 0xFA, 0xE0, -+0xFF, 0x60, 0x05, 0x12, 0x87, 0xCF, 0x80, 0x03, 0x12, 0x88, 0x11, 0x90, 0x8E, 0x7D, 0xE0, 0x64, -+0x08, 0x60, 0x02, 0xE1, 0x52, 0x12, 0x61, 0xB2, 0xE1, 0x52, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x05, -+0x7F, 0x01, 0x12, 0x65, 0xFC, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x06, 0x02, 0xF1, 0x9D, 0x90, 0x8E, -+0x7D, 0xE0, 0xB4, 0x0E, 0x07, 0xF1, 0x57, 0xBF, 0x01, 0x02, 0xF1, 0xC3, 0x90, 0x8E, 0x7D, 0xE0, -+0x64, 0x0C, 0x60, 0x02, 0xE1, 0x52, 0xF1, 0x57, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xE1, 0x52, 0x12, -+0x88, 0x24, 0xE1, 0x52, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x0E, 0x07, 0xF1, 0x57, 0xBF, 0x01, 0x02, -+0xF1, 0xC3, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x06, 0x02, 0xF1, 0x9D, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, -+0x0C, 0x08, 0xF1, 0x57, 0xBF, 0x01, 0x03, 0x12, 0x88, 0x24, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x04, -+0x70, 0x60, 0x12, 0x87, 0x07, 0xEF, 0x64, 0x01, 0x70, 0x58, 0x12, 0x62, 0x2A, 0x80, 0x53, 0x90, -+0x8E, 0x7D, 0xE0, 0xB4, 0x0E, 0x07, 0xF1, 0x57, 0xBF, 0x01, 0x02, 0xF1, 0xC3, 0x90, 0x8E, 0x7D, -+0xE0, 0xB4, 0x06, 0x02, 0xF1, 0x9D, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x0C, 0x08, 0xF1, 0x57, 0xBF, -+0x01, 0x03, 0x12, 0x88, 0x24, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x65, 0xFC, -+0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x04, 0x1B, 0x12, 0x88, 0x5B, 0x80, 0x16, 0x90, 0x8E, 0x7D, 0xE0, -+0xB4, 0x0C, 0x0F, 0x90, 0x8E, 0x78, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, -+0x62, 0x21, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x86, 0xEE, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, -+0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2D, 0x90, 0x8E, 0x77, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x19, 0x90, 0x8E, 0x7C, 0xE0, 0xD3, -+0x94, 0x04, 0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, -+0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x8E, 0x78, -+0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x04, -+0xF0, 0x80, 0x0A, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x90, 0x05, 0x22, -+0xE4, 0xF0, 0x22, 0x90, 0x8E, 0x78, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0x90, 0x8E, 0x7D, 0x74, -+0x0C, 0xF0, 0x80, 0x11, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, -+0x8E, 0x7D, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0x07, 0x1F, 0xE0, 0x54, -+0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, 0x90, 0x39, 0xF0, 0x90, 0x90, 0x37, 0x74, -+0x02, 0xF0, 0x90, 0x90, 0x45, 0x14, 0xF0, 0xFB, 0x7A, 0x90, 0x79, 0x37, 0x12, 0x6D, 0xDE, 0x7F, -+0x04, 0x90, 0x90, 0xF5, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x4C, 0x53, 0x90, 0x8D, 0x01, 0xE0, 0xFF, -+0x90, 0x90, 0xF5, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x8D, 0x01, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x8D, 0x5B, 0xE0, 0xFF, 0x90, 0x8D, 0x5A, 0xE0, 0xB5, 0x07, 0x04, 0x7F, -+0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x40, 0x90, 0x8D, 0x5A, 0xE0, 0xFE, 0x75, 0xF0, 0x08, -+0x90, 0x8D, 0x0A, 0x12, 0x48, 0x3E, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x0B, 0xF9, -+0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x11, 0x8D, 0x90, 0x8D, 0x5A, 0xE0, 0x04, -+0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8D, 0x5A, -+0xF0, 0x12, 0x70, 0xE2, 0x7F, 0x02, 0x11, 0x11, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x90, 0x04, -+0x12, 0x48, 0x53, 0xEF, 0x12, 0x48, 0x5C, 0x60, 0xC8, 0x00, 0x60, 0xD1, 0x01, 0x60, 0xD9, 0x02, -+0x60, 0xE2, 0x03, 0x60, 0xEB, 0x04, 0x60, 0xF4, 0x20, 0x60, 0xFD, 0x21, 0x61, 0x06, 0x23, 0x61, -+0x0E, 0x25, 0x61, 0x17, 0x27, 0x61, 0x27, 0x80, 0x61, 0x1F, 0x81, 0x61, 0x30, 0x82, 0x61, 0x39, -+0x83, 0x61, 0x42, 0x84, 0x00, 0x00, 0x61, 0x4B, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, 0x6F, -+0x0F, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0xC1, 0x15, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, -+0x6F, 0x57, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, 0x82, 0x16, 0x90, 0x90, 0x04, 0x12, 0x48, -+0x4A, 0x02, 0x4F, 0x52, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, 0x6F, 0x8F, 0x90, 0x90, 0x04, -+0x12, 0x48, 0x4A, 0x02, 0x70, 0x8C, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0xE1, 0xD6, 0x90, 0x90, -+0x04, 0x12, 0x48, 0x4A, 0x02, 0x70, 0xD2, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x80, 0x34, 0x90, -+0x90, 0x04, 0x12, 0x48, 0x4A, 0x61, 0xEC, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, 0x83, 0x94, -+0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, 0x85, 0x07, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, -+0x85, 0x21, 0x90, 0x90, 0x04, 0x12, 0x48, 0x4A, 0x02, 0x85, 0x76, 0x90, 0x01, 0xC0, 0xE0, 0x44, -+0x01, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFF, 0x90, 0x8E, 0x92, 0xE0, 0x54, 0xFE, 0x4F, -+0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0x8E, 0x93, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, -+0x37, 0x90, 0x8E, 0x94, 0xF0, 0x90, 0x8E, 0x93, 0xE0, 0x90, 0x8E, 0x95, 0xF0, 0x90, 0x8E, 0x92, -+0xE0, 0x54, 0x01, 0xFF, 0xAC, 0x07, 0xEF, 0x54, 0x01, 0xFE, 0x90, 0x8E, 0x92, 0xE0, 0x54, 0xFE, -+0x4E, 0xF0, 0xEF, 0x90, 0x01, 0x53, 0xB4, 0x01, 0x11, 0xE4, 0xF0, 0x7D, 0x10, 0x7F, 0x03, 0xF1, -+0xED, 0x90, 0x8E, 0x94, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x74, 0x03, 0xF0, 0x7D, 0x10, 0xFF, -+0xF1, 0xB0, 0x91, 0x95, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x22, -+0x90, 0x8E, 0x92, 0xE0, 0x30, 0xE0, 0x2D, 0x90, 0x8E, 0x94, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x90, -+0x8E, 0x95, 0xE0, 0x60, 0x04, 0x14, 0xF0, 0x80, 0x48, 0x90, 0x8E, 0x93, 0xE0, 0x14, 0x90, 0x8E, -+0x95, 0xF0, 0x90, 0x05, 0x73, 0x74, 0x01, 0xF0, 0xE4, 0xFF, 0x31, 0x84, 0x31, 0xF5, 0x7D, 0x01, -+0x7F, 0x02, 0x31, 0xF9, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, -+0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x12, 0x88, -+0x74, 0x90, 0x8E, 0x80, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x31, 0xF5, 0x12, 0x75, 0x6B, 0x80, -+0x9F, 0x51, 0x46, 0x90, 0x8E, 0x7D, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, -+0x12, 0x76, 0xCD, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, 0x03, 0x31, 0xF9, 0x51, 0x4C, -+0xE4, 0x90, 0x8E, 0x7D, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x12, 0x76, 0xCD, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, -+0xFF, 0xEC, 0x90, 0x90, 0xC1, 0x12, 0x27, 0x48, 0x90, 0x90, 0xC1, 0x12, 0x48, 0x26, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, -+0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0x90, 0xC1, 0x12, 0x27, 0x48, 0x90, 0x90, 0xC1, -+0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, -+0x90, 0x00, 0x02, 0xE0, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x3A, 0x96, 0x7F, 0xB4, 0x7E, 0x08, -+0x12, 0x36, 0xCE, 0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0x90, 0xC1, 0x12, 0x27, 0x48, 0x90, 0x90, -+0xC1, 0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, -+0x5D, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, -+0x44, 0x20, 0xF0, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x90, 0x8E, 0x87, 0x12, 0x27, 0x48, -+0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, -+0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, -+0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x11, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xC0, 0xB1, 0x9A, -+0x90, 0x90, 0xC0, 0xE0, 0x44, 0x18, 0x12, 0x76, 0x76, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x60, -+0x4E, 0x90, 0x8F, 0x96, 0xE0, 0xFF, 0x60, 0x02, 0xD1, 0xB8, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x90, -+0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, -+0x8D, 0xF4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF0, 0x51, 0x46, 0x90, -+0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0xB1, 0xEB, 0xF1, 0xC8, 0x91, 0x95, 0x90, 0x05, 0x22, 0xE4, -+0xF0, 0x12, 0x85, 0xD8, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, 0xFF, 0x21, 0xF9, 0x7D, -+0x08, 0xE4, 0xFF, 0xD1, 0xE1, 0x90, 0x06, 0x90, 0xE4, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x54, 0xFB, -+0xF0, 0x12, 0x83, 0x70, 0xF1, 0xC9, 0x90, 0x8E, 0x96, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x9B, -+0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0x90, 0x8E, 0xA8, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x06, 0x90, -+0xE0, 0x44, 0x20, 0xF0, 0x90, 0x8E, 0x97, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, -+0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, -+0xA3, 0xE0, 0x54, 0x80, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x98, -+0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x8E, 0x9A, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8E, 0x96, 0xE0, 0x54, 0xFE, -+0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x26, 0x1E, -+0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x90, 0x8E, 0x96, 0xF0, 0xEE, 0x54, 0x08, -+0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, -+0xEF, 0x4D, 0xFF, 0x90, 0x8E, 0x96, 0xF0, 0xEE, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, -+0xF0, 0x12, 0x26, 0x1E, 0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, 0x8E, 0x96, 0xF0, 0x90, -+0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, -+0x8D, 0xF4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x8E, 0x96, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, 0x12, -+0x86, 0x10, 0x90, 0x8E, 0x96, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFF, 0xF1, 0xCA, 0x90, 0x8E, 0x96, -+0xE0, 0xC4, 0x54, 0x01, 0xFF, 0xF1, 0xD0, 0x90, 0x8E, 0x96, 0xE0, 0x54, 0x01, 0xFF, 0x71, 0x2E, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8E, 0x87, 0x12, -+0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, -+0x8E, 0x87, 0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, -+0x37, 0x5D, 0x90, 0x00, 0x10, 0xE0, 0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x12, 0x3A, 0x96, 0x90, 0x00, -+0x72, 0xE0, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x3A, 0x96, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, -+0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, -+0x74, 0x86, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xBF, 0xFF, 0xEC, 0x90, -+0x90, 0xBB, 0x12, 0x27, 0x48, 0x90, 0x90, 0xBB, 0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x48, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x01, 0xFD, 0x7F, -+0x02, 0x12, 0x3A, 0x96, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, -+0x90, 0x90, 0xBB, 0x12, 0x27, 0x48, 0x90, 0x90, 0xBB, 0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, -+0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, -+0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0x90, 0xBB, 0x12, 0x27, 0x48, 0x90, 0x90, 0xBB, 0x12, 0x48, -+0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, -+0xFF, 0xE0, 0x70, 0x1B, 0xB1, 0x94, 0x90, 0x90, 0xBF, 0xE0, 0x54, 0xE7, 0x12, 0x76, 0x76, 0xB1, -+0x94, 0x90, 0x90, 0xBF, 0xE0, 0x54, 0x18, 0x70, 0x06, 0x90, 0x01, 0xBF, 0xE0, 0x04, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xBF, 0x7D, 0x08, 0x7F, 0x01, 0x90, 0x90, -+0xD6, 0x12, 0x48, 0x53, 0xEF, 0x70, 0x07, 0x90, 0x90, 0xD9, 0x04, 0xF0, 0x80, 0x0B, 0xEF, 0x64, -+0x01, 0x70, 0x2E, 0x90, 0x90, 0xD9, 0x74, 0x40, 0xF0, 0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, 0x90, -+0xD9, 0xE0, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x90, 0x00, 0xE1, 0xE0, 0xFF, 0x90, 0x90, 0xD6, -+0x12, 0x48, 0x4A, 0xEF, 0x12, 0x26, 0x64, 0xE4, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x7F, 0x01, -+0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0x12, 0x82, 0x49, 0x90, 0x02, -+0x87, 0xE0, 0x70, 0xF7, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0x90, 0x90, 0xF9, 0xEF, -+0xF0, 0x91, 0x95, 0x90, 0x90, 0xF9, 0xE0, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, -+0x7D, 0x74, 0x04, 0xF0, 0x22, 0x90, 0x90, 0x07, 0x12, 0x48, 0x53, 0x90, 0x00, 0x01, 0x12, 0x26, -+0x37, 0xFF, 0xFE, 0x12, 0x26, 0x1E, 0xFD, 0xC3, 0x13, 0x30, 0xE0, 0x12, 0x90, 0x90, 0x07, 0x12, -+0x48, 0x4A, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0x90, 0x0B, 0xF0, 0x80, 0x05, 0x90, 0x90, -+0x0B, 0xEF, 0xF0, 0x90, 0x90, 0x0A, 0xEE, 0xF0, 0x90, 0x90, 0x0B, 0xE0, 0xFE, 0x90, 0x90, 0x0A, -+0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x3A, 0x90, 0x90, 0x07, 0x12, 0x48, 0x4A, 0x12, 0x26, 0x1E, 0x54, -+0x01, 0xFE, 0x74, 0xF6, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0xF6, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xE0, 0x70, 0x05, 0x12, 0x72, 0xA8, 0x80, 0x08, -+0x90, 0x90, 0x0A, 0xE0, 0xFF, 0x12, 0x72, 0x97, 0x90, 0x90, 0x0A, 0xE0, 0x04, 0xF0, 0x80, 0xB8, -+0x90, 0x8D, 0xF6, 0xE0, 0x70, 0x21, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x03, 0xFF, 0xB1, 0xFC, 0x90, -+0x8E, 0x7D, 0xE0, 0x64, 0x0C, 0x60, 0x03, 0x12, 0x88, 0x11, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xF7, -+0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x12, 0x6C, 0x6D, 0x7E, 0x00, 0x74, 0x00, 0x2F, -+0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x08, 0x7B, 0x01, -+0x7A, 0x8E, 0x79, 0xB0, 0x02, 0x34, 0x2C, 0x7D, 0x02, 0x7F, 0x02, 0xD1, 0xE1, 0x7D, 0x01, 0x7F, -+0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0x8F, 0xAC, 0xE0, 0x04, 0xF0, 0x90, -+0x8E, 0x7D, 0xE0, 0x64, 0x02, 0x60, 0x29, 0x12, 0x6E, 0x48, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, -+0x13, 0x54, 0x1F, 0x30, 0xE0, 0x14, 0x90, 0x8E, 0x80, 0xE0, 0xFF, 0xA3, 0xE0, 0x6F, 0x70, 0x0A, -+0xF1, 0xDE, 0xD1, 0xD7, 0x90, 0x8E, 0x81, 0xE0, 0x14, 0xF0, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, -+0x22, 0xEF, 0x70, 0x33, 0x7D, 0x78, 0x7F, 0x02, 0xD1, 0xE1, 0x7D, 0x02, 0x7F, 0x03, 0xD1, 0xE1, -+0x7D, 0xC8, 0x7F, 0x02, 0xF1, 0xB0, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, -+0xF0, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x5D, 0xFF, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xF7, 0xF0, 0x90, -+0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, -+0xF0, 0x7D, 0x78, 0xFF, 0x31, 0xF9, 0x7D, 0x02, 0x7F, 0x03, 0x31, 0xF9, 0x90, 0x06, 0x0A, 0xE0, -+0x44, 0x07, 0xF0, 0x90, 0x8E, 0x85, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x8D, 0xF6, 0xE0, -+0xB4, 0x01, 0x15, 0x90, 0x8E, 0x78, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x20, 0xE2, -+0x0E, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x5D, 0xFF, 0x90, 0x8E, 0x78, 0xE0, 0x44, 0x04, 0xF0, 0x22, -+0x74, 0x65, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x22, 0x22, 0x90, 0x90, 0x07, 0xEF, 0xF0, 0x22, -+0x90, 0x90, 0x07, 0xEF, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0x8E, 0x84, 0xF0, 0x22, 0xEF, 0x14, -+0x90, 0x05, 0x73, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x74, 0x65, 0x2F, -+0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, -+0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -+0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -+0x01, 0xC4, 0x74, 0x02, 0xF0, 0x74, 0x68, 0xA3, 0xF0, 0x91, 0xE5, 0xE5, 0x69, 0x30, 0xE1, 0x02, -+0x11, 0x85, 0xE5, 0x69, 0x30, 0xE2, 0x02, 0x11, 0x8E, 0xE5, 0x6A, 0x30, 0xE0, 0x02, 0x31, 0x27, -+0xE5, 0x6C, 0x30, 0xE1, 0x04, 0x7F, 0x04, 0x91, 0x30, 0xE5, 0x6C, 0x30, 0xE4, 0x03, 0x12, 0x62, -+0x0E, 0xE5, 0x6C, 0x30, 0xE5, 0x02, 0x11, 0xA7, 0xE5, 0x6C, 0x30, 0xE6, 0x02, 0x11, 0xE9, 0x74, -+0x02, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x68, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, -+0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, -+0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x02, 0x31, 0x70, 0x22, 0x90, 0x8E, -+0x7A, 0xE0, 0x60, 0x12, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x02, 0x41, 0x9B, 0x90, 0x8E, 0x77, -+0xE0, 0x54, 0xF7, 0xF0, 0x11, 0xDF, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, -+0x03, 0x30, 0xE0, 0x26, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x8E, 0x78, 0x30, -+0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xB9, 0x74, -+0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x11, 0xDF, 0xE4, 0xFF, 0x02, 0x57, 0x5E, 0x90, -+0x8E, 0x7C, 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x5D, 0xFF, 0x90, 0x8E, 0x77, 0xE0, 0xFF, 0xC4, 0x13, -+0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x2B, 0xEF, 0x54, 0x7F, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, -+0x8E, 0x78, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x0F, 0xE0, 0x54, 0xFD, 0xF0, 0x90, -+0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x02, -+0x11, 0xDF, 0x7F, 0x01, 0x02, 0x57, 0x5E, 0xB1, 0x15, 0x90, 0x90, 0x46, 0xEF, 0xF0, 0x90, 0x8E, -+0x77, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x90, -+0x46, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, -+0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0x8E, 0x85, -+0xE4, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x90, 0x8E, 0x85, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, -+0x90, 0x8E, 0x77, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x11, 0xEF, 0x54, 0xFB, 0xF0, -+0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x41, 0x80, 0x3D, 0x90, 0x8E, 0x83, -+0xE0, 0x04, 0xF0, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x8E, 0x83, 0xE0, 0xFF, 0xB4, -+0x01, 0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, 0x06, 0x90, 0x05, 0x58, 0xE0, 0x04, 0xF0, 0x90, 0x8E, -+0x8B, 0xE0, 0xFF, 0x90, 0x8E, 0x83, 0xE0, 0xD3, 0x9F, 0x40, 0x0F, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, -+0x01, 0x0A, 0x90, 0x8E, 0x78, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x11, 0xDF, 0x22, 0xE4, 0x90, 0x90, -+0x37, 0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x90, 0x90, 0x37, 0xF0, 0xE0, 0x54, 0xC0, 0x70, 0x0C, 0x90, -+0x8E, 0x7E, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x01, 0xDF, 0x90, 0x90, 0x37, 0xE0, 0x30, -+0xE6, 0x21, 0x90, 0x8E, 0x7A, 0xE0, 0x64, 0x01, 0x70, 0x20, 0x90, 0x8E, 0x7E, 0xE0, 0x44, 0x01, -+0xF0, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x04, 0x51, 0x65, 0x80, 0x0B, 0x51, -+0x4E, 0x80, 0x07, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x90, 0x37, 0xE0, 0x90, 0x8E, -+0x7E, 0x30, 0xE7, 0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x8C, 0xE0, 0xF5, -+0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, -+0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x51, 0x9B, -+0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x0C, 0x60, 0x0C, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x5D, 0xFF, 0xE4, -+0xFF, 0x12, 0x57, 0xAF, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x13, 0x90, 0x8D, 0x06, 0xE0, 0xFF, -+0xE4, 0xFD, 0x51, 0xDD, 0x8E, 0x15, 0x8F, 0x16, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x90, -+0x8D, 0xF6, 0xE0, 0xB4, 0x01, 0x14, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x0E, 0x90, 0x8E, 0x79, 0xE0, -+0x54, 0x0F, 0x64, 0x02, 0x60, 0x02, 0x80, 0xCD, 0x51, 0x4E, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, -+0x02, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x8D, 0xE0, 0xC3, -+0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, -+0x01, 0x5B, 0x74, 0x05, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0xEC, 0xED, 0xF0, 0x90, 0x90, 0xEB, 0xEF, 0xF0, 0xE4, 0xFD, -+0xFC, 0x91, 0x6D, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x90, 0xEB, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, -+0x90, 0xEC, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -+0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -+0x54, 0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, -+0xF0, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0xAE, -+0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8D, 0x07, 0xE0, 0xFF, 0x7D, 0x01, 0x51, -+0xDD, 0x8E, 0x12, 0x8F, 0x13, 0xAD, 0x13, 0xAC, 0x12, 0xAF, 0x11, 0x71, 0xE5, 0xAF, 0x13, 0xAE, -+0x12, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x01, 0xF0, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, -+0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xED, 0xF0, 0x22, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -+0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x1D, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x44, 0x10, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, -+0x80, 0xF0, 0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xEF, -+0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x40, 0xF0, 0x22, -+0x8F, 0x17, 0x7F, 0x02, 0x12, 0x4C, 0x53, 0x90, 0x8D, 0x01, 0xE0, 0x45, 0x17, 0xF0, 0x22, 0x12, -+0x70, 0xE2, 0x7F, 0x02, 0x80, 0xEA, 0x90, 0x8E, 0x96, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x10, 0x91, -+0x30, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, 0x01, 0x13, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x0D, 0x90, -+0x8E, 0x7E, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x07, 0x70, 0x02, 0x11, 0xDF, 0x22, 0xE4, 0xFE, 0xEF, -+0x25, 0xE0, 0xFD, 0xEF, 0xC3, 0x94, 0x80, 0x90, 0xFD, 0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, 0x03, -+0x74, 0x01, 0xF0, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x90, 0x8E, 0x7A, 0xE0, 0x64, -+0x01, 0x70, 0x1A, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x60, 0x09, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, -+0x5D, 0xFF, 0x41, 0x9B, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x03, 0x12, 0x5D, 0xFB, 0x22, 0x90, 0x8E, -+0x7A, 0xE0, 0x60, 0x02, 0x91, 0x8B, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x25, 0x90, -+0x8E, 0x7A, 0xE0, 0x60, 0x1F, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, -+0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, -+0x70, 0x02, 0x11, 0xDF, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x65, 0xF5, 0x69, 0xA3, 0xE0, 0x55, -+0x66, 0xF5, 0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, 0xE0, 0x55, 0x68, 0xF5, 0x6C, 0x90, -+0x01, 0x3C, 0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, 0x6B, 0xF0, 0xA3, 0xE5, 0x6C, -+0xF0, 0x53, 0x91, 0xDF, 0x22, 0xE4, 0x90, 0x90, 0x47, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x00, -+0x83, 0xE0, 0x90, 0x90, 0x47, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0x90, 0x47, 0xE0, 0xFF, -+0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x90, 0x49, 0xE0, 0x94, 0x64, 0x90, 0x90, 0x48, 0xE0, 0x94, -+0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x90, 0x47, 0xE0, 0xFF, 0x22, -+0x90, 0x90, 0x48, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x80, 0xC2, 0x90, 0x90, 0x6F, 0xEF, -+0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x0E, 0xA3, 0xE0, 0xF5, 0x0F, 0x65, 0x0E, 0x60, 0x6E, 0x90, -+0x90, 0x70, 0x74, 0x03, 0xF0, 0x90, 0x90, 0x7E, 0x74, 0x08, 0xF0, 0xE5, 0x0F, 0x04, 0x54, 0x0F, -+0xF5, 0x10, 0xE4, 0xF5, 0x0D, 0xE5, 0x10, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, -+0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x0D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, -+0xFF, 0x74, 0x72, 0x25, 0x0D, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x0D, -+0xE5, 0x0D, 0xB4, 0x08, 0xD0, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x70, 0xB1, 0xDE, 0xE5, 0x0F, 0x04, -+0x54, 0x0F, 0xF5, 0x0F, 0xB4, 0x0F, 0x03, 0xE4, 0xF5, 0x0F, 0x90, 0x04, 0x7F, 0xE5, 0x0F, 0xF0, -+0x90, 0x90, 0x6F, 0xE0, 0x7F, 0x04, 0x70, 0x02, 0x81, 0x30, 0x12, 0x60, 0x11, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8D, 0xF2, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, -+0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x8D, 0xF3, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, -+0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x35, 0xC0, 0x01, -+0x90, 0x8D, 0xF3, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x5C, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xA8, -+0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x47, 0xD0, 0x90, 0x8D, 0xF3, -+0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, -+0x8D, 0xF3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x60, 0x02, -+0xC1, 0xDD, 0x90, 0x8E, 0x7A, 0xE0, 0x70, 0x02, 0xC1, 0xDD, 0x90, 0x8E, 0x79, 0xE0, 0xC4, 0x54, -+0x0F, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x8E, 0x81, 0xF0, 0x90, 0x06, 0xAA, -+0xE0, 0x90, 0x8E, 0x80, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x8E, 0x80, 0xE0, 0xFE, 0xFF, -+0x80, 0x00, 0x90, 0x8E, 0x81, 0xEF, 0xF0, 0x90, 0x8E, 0x78, 0xE0, 0x44, 0x04, 0xF0, 0xE4, 0x90, -+0x8E, 0x83, 0xF0, 0x90, 0x8E, 0x85, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x01, 0x57, 0xE4, -+0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, -+0xF0, 0x90, 0x8E, 0x79, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x02, 0x31, -+0xCD, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x10, 0x90, 0x8E, 0x80, -+0xE0, 0xFF, 0xA3, 0xE0, 0xB5, 0x07, 0x06, 0x12, 0x67, 0xDE, 0x12, 0x66, 0xDD, 0x22, 0xC0, 0xE0, -+0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xDE, 0x90, -+0x01, 0xC4, 0xED, 0xF0, 0x74, 0x6E, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, -+0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, -+0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8D, 0x05, 0xF0, -+0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8D, 0x06, 0xF0, 0x90, 0x00, 0x02, -+0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8D, 0x07, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, -+0xFF, 0xED, 0x2F, 0x90, 0x8D, 0x08, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, 0xAE, 0x05, -+0xED, 0x2F, 0x90, 0x8D, 0x09, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x26, -+0x1E, 0xFF, 0x90, 0x8E, 0x76, 0xF0, 0xBF, 0x01, 0x12, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x64, -+0x01, 0x60, 0x17, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x0F, 0x90, 0x00, 0x01, 0x12, 0x26, -+0x37, 0x64, 0x01, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, -+0x26, 0x1E, 0xFF, 0x54, 0x7F, 0x90, 0x8E, 0x7A, 0xF0, 0xEF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, -+0xA3, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, -+0x8E, 0x79, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x54, 0x01, 0x25, -+0xE0, 0xFE, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0x90, 0x8E, 0x96, 0xE0, 0x30, 0xE0, -+0x09, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0xF0, 0x80, 0x0F, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, -+0xFF, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0x90, -+0x8E, 0x7C, 0xF0, 0x12, 0x70, 0x1B, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0xF0, -+0x90, 0x8E, 0x7A, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x8E, 0x7C, 0xE0, 0x90, 0x01, 0xBB, 0xF0, -+0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, 0x90, 0x07, 0x12, 0x48, -+0x53, 0x11, 0x4A, 0x90, 0x8E, 0x7A, 0xE0, 0xFF, 0x12, 0x67, 0x31, 0x90, 0x8E, 0x7A, 0xE0, 0x60, -+0x18, 0x90, 0x90, 0x07, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x54, 0x0F, 0xFF, -+0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x11, 0x5B, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFB, -+0xF0, 0xE4, 0x90, 0x8E, 0x83, 0xF0, 0x90, 0x8E, 0x7E, 0xF0, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0C, -+0x04, 0x70, 0x28, 0x90, 0x8E, 0x80, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x22, 0xED, 0x70, 0x0A, 0x90, -+0x8E, 0x8E, 0xE0, 0x90, 0x8E, 0x80, 0xF0, 0x80, 0x05, 0x90, 0x8E, 0x80, 0xED, 0xF0, 0x90, 0x8E, -+0x80, 0xE0, 0xA3, 0xF0, 0x90, 0x8E, 0x78, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x00, 0x02, 0x12, -+0x26, 0x37, 0xFF, 0x30, 0xE0, 0x26, 0x12, 0x26, 0x1E, 0x90, 0x8E, 0x8B, 0xF0, 0x90, 0x00, 0x01, -+0x12, 0x26, 0x37, 0x90, 0x8E, 0x8C, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xA3, 0xE0, 0x54, 0x01, 0x4F, -+0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x90, 0x8E, 0x8E, 0xF0, 0x22, 0x90, 0x8E, 0x8B, 0x74, -+0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, -+0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0x8E, 0x91, 0xF0, 0x90, 0x8E, 0x91, 0xE0, 0x90, 0x01, 0xE7, -+0xF0, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0x90, 0xDD, 0xF0, 0x90, 0x90, 0xDD, 0xE0, -+0xFD, 0x70, 0x02, 0x41, 0x96, 0x90, 0x8D, 0x5A, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, -+0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x8D, 0x5B, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, -+0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x90, 0xDA, -+0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -+0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x41, 0x8F, 0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, -+0x90, 0x01, 0xD0, 0x12, 0x48, 0x3E, 0xE0, 0x90, 0x90, 0xDE, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, -+0x90, 0x75, 0x42, 0xDE, 0x75, 0x43, 0x01, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xDF, 0x12, 0x34, 0x2C, -+0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x48, 0x3E, 0xE0, 0xFF, 0x90, -+0x8D, 0x5B, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0x8D, 0x0A, 0x12, 0x48, 0x3E, 0xEF, 0xF0, 0x90, -+0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD1, 0x12, 0x48, 0x3E, 0xE0, 0xFF, 0x75, 0xF0, -+0x08, 0xEE, 0x90, 0x8D, 0x0B, 0x12, 0x48, 0x3E, 0xEF, 0xF0, 0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, -+0x04, 0x90, 0x01, 0xD2, 0x12, 0x48, 0x3E, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0C, -+0x12, 0x48, 0x3E, 0xEF, 0xF0, 0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD3, 0x12, -+0x48, 0x3E, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0D, 0x12, 0x48, 0x3E, 0xEF, 0xF0, -+0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF0, 0x12, 0x48, 0x3E, 0xE0, 0xFF, 0x75, -+0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0E, 0x12, 0x48, 0x3E, 0xEF, 0xF0, 0x90, 0x90, 0xDA, 0xE0, 0x75, -+0xF0, 0x04, 0x90, 0x01, 0xF1, 0x12, 0x48, 0x3E, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, -+0x0F, 0x12, 0x48, 0x3E, 0xEF, 0xF0, 0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF2, -+0x12, 0x48, 0x3E, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x10, 0x12, 0x48, 0x3E, 0xEF, -+0xF0, 0x90, 0x90, 0xDA, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF3, 0x12, 0x48, 0x3E, 0xE0, 0xFF, -+0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x11, 0x12, 0x48, 0x3E, 0xEF, 0xF0, 0x90, 0x90, 0xDD, 0xE0, -+0xFF, 0x90, 0x90, 0xDA, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0xF4, 0x5F, 0x90, 0x90, 0xDD, 0xF0, 0x90, 0x90, 0xDA, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, -+0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0x90, 0xDA, 0xE0, 0x04, -+0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x8D, 0x5B, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, -+0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x01, 0xEC, 0xE4, 0x90, 0x8D, 0x5B, 0xF0, 0x01, 0xEC, 0x90, -+0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0x8F, 0x19, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, -+0x12, 0x48, 0x3E, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x8F, 0x19, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, -+0x05, 0x12, 0x48, 0x3E, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x0D, 0x51, 0xC5, 0xE4, 0xFD, 0x0F, 0x51, -+0xC5, 0x0D, 0x51, 0xC5, 0x0D, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, -+0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, -+0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x00, 0x8F, 0xE0, 0x20, 0xE6, 0x02, 0x81, 0x45, 0x90, 0x00, 0x8C, -+0xE0, 0x90, 0x90, 0xE0, 0xF0, 0x90, 0x00, 0x8D, 0xE0, 0x90, 0x90, 0xE1, 0xF0, 0x90, 0x00, 0x8E, -+0xE0, 0x90, 0x90, 0xE2, 0xF0, 0x90, 0x90, 0xE1, 0xE0, 0x24, 0xF1, 0x70, 0x02, 0x61, 0xE1, 0x24, -+0x07, 0x60, 0x02, 0x81, 0x37, 0x90, 0x8E, 0x7A, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x51, 0xC5, 0x90, -+0x8E, 0x79, 0xE0, 0x54, 0x0F, 0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x8E, 0x7C, 0xE0, 0xFB, 0x0D, 0x51, -+0xC5, 0x90, 0x8E, 0x7D, 0xE0, 0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x90, 0xE0, 0xE0, 0x24, 0xF6, 0xF5, -+0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xC5, 0x90, 0x8E, 0x77, -+0xE0, 0x54, 0x01, 0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x8E, 0x77, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, -+0xFB, 0x0D, 0x7F, 0x01, 0x51, 0xC5, 0x90, 0x8E, 0x77, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, -+0xFB, 0x0D, 0x7F, 0x01, 0x51, 0xC5, 0x90, 0x8D, 0x02, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xC5, -+0x90, 0x8D, 0x03, 0xE0, 0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x8E, 0x81, 0xE0, 0xFB, 0x0D, 0x51, 0xC5, -+0x90, 0x8E, 0x80, 0xE0, 0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x8E, 0x79, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, -+0xE4, 0xFD, 0x7F, 0x03, 0x51, 0xC5, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, -+0x7F, 0x03, 0x51, 0xC5, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, -+0x03, 0x51, 0xC5, 0x90, 0x8E, 0x77, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0x80, -+0x54, 0x90, 0x8E, 0x96, 0xE0, 0x54, 0x01, 0xFB, 0xE4, 0xFD, 0xFF, 0x51, 0xC5, 0x90, 0x8E, 0x97, -+0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0xE4, 0xFF, 0x51, 0xC5, 0x90, 0x8E, 0x97, -+0xE0, 0xC4, 0x54, 0x01, 0xFB, 0x0D, 0xE4, 0xFF, 0x51, 0xC5, 0x90, 0x8E, 0x9B, 0xE0, 0x54, 0x01, -+0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x8E, 0xA8, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xC5, 0x90, 0x8E, -+0xA9, 0xE0, 0xFB, 0x0D, 0x51, 0xC5, 0x90, 0x8E, 0xAA, 0xE0, 0xFB, 0x0D, 0x51, 0xC5, 0xE4, 0xFB, -+0x51, 0xB9, 0x51, 0xB9, 0x0D, 0x51, 0xC5, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, -+0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x90, 0x00, 0xF0, 0xA3, -+0xF0, 0x90, 0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, -+0x45, 0xC3, 0x90, 0x90, 0x01, 0xE0, 0x94, 0x88, 0x90, 0x90, 0x00, 0xE0, 0x94, 0x13, 0x40, 0x0F, -+0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x03, 0xF0, 0x80, 0x27, 0x90, -+0x90, 0x00, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, -+0xD3, 0x90, 0x90, 0x01, 0xE0, 0x94, 0x32, 0x90, 0x90, 0x00, 0xE0, 0x94, 0x00, 0x40, 0xB2, 0x90, -+0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xAB, 0x90, 0x01, 0xC7, 0x74, 0x05, 0xF0, 0x22, 0x7F, 0x02, 0x90, -+0x8F, 0xA3, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, -+0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, -+0xDE, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x5D, 0xF5, 0x61, 0xA3, 0xE0, 0x55, 0x5E, -+0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, 0xF5, 0x63, 0xA3, 0xE0, 0x55, 0x60, 0xF5, 0x64, 0x90, 0x01, -+0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, 0xE5, 0x63, 0xF0, 0xA3, 0xE5, 0x64, 0xF0, -+0x22, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x46, 0x90, 0x8E, 0x78, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, -+0x1F, 0x30, 0xE0, 0x13, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0C, 0x12, 0x66, 0xD7, 0x90, 0x8E, -+0x80, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0x90, 0xE9, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, -+0xF6, 0xC3, 0x90, 0x90, 0xEA, 0xE0, 0x94, 0x80, 0x90, 0x90, 0xE9, 0xE0, 0x64, 0x80, 0x94, 0x80, -+0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0xB1, 0xA1, 0xB1, -+0x6B, 0x90, 0x8E, 0x92, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0B, 0x12, -+0x66, 0xD7, 0x90, 0x8E, 0x94, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x90, 0x8F, 0xA4, 0xE0, 0x30, -+0xE0, 0x2E, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, 0x01, 0x27, 0x90, 0x90, 0xF8, 0xE0, 0x04, 0xF0, 0xE0, -+0xB4, 0x0A, 0x0B, 0x90, 0x8F, 0xA6, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x90, 0xF8, 0xF0, 0x90, 0x8F, -+0xA6, 0xE0, 0xFF, 0x90, 0x8F, 0xA5, 0xE0, 0xB5, 0x07, 0x06, 0xE4, 0xA3, 0xF0, 0x12, 0x57, 0xAD, -+0x22, 0x90, 0x8F, 0xA7, 0xE0, 0x30, 0xE0, 0x36, 0x90, 0x8F, 0xAA, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, -+0x90, 0x8F, 0xA8, 0xE0, 0x6F, 0x70, 0x27, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x11, 0x90, 0x8F, -+0xAC, 0xE0, 0x70, 0x0B, 0x12, 0x57, 0xAD, 0x90, 0x8F, 0xAB, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, -+0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0x8F, 0xAA, 0xF0, 0x90, 0x8F, 0xAC, 0xF0, 0x22, 0x90, -+0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x2A, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, -+0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x8C, 0xE0, 0xF5, -+0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, -+0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, -+0x05, 0x22, 0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, -+0xC6, 0xE0, 0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xC3, 0xEE, 0x94, 0x01, 0x40, 0x0A, 0x0D, 0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, -+0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x1E, 0x90, 0xFD, 0x11, 0xE0, 0xB5, 0x05, 0x14, 0x90, 0x01, -+0x17, 0xE0, 0xB5, 0x05, 0x07, 0x90, 0xFD, 0x11, 0xE4, 0xF0, 0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, -+0x11, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xFB, 0x7D, 0x08, 0x7F, 0x01, 0x90, 0x90, 0xED, 0xEB, 0xF0, -+0xEF, 0x70, 0x06, 0xA3, 0x74, 0x03, 0xF0, 0x80, 0x0B, 0xEF, 0x64, 0x01, 0x70, 0x35, 0x90, 0x90, -+0xEE, 0x74, 0x42, 0xF0, 0x7F, 0xE2, 0x12, 0x3A, 0x96, 0x90, 0x90, 0xED, 0xE0, 0xFD, 0x7F, 0xE0, -+0x12, 0x3A, 0x96, 0x90, 0x90, 0xEE, 0xE0, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0x90, 0x90, 0xEE, -+0xE0, 0x54, 0xFD, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0xE3, 0x12, 0x3A, 0x96, -+0x7F, 0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0xE4, 0x90, 0x90, -+0xEF, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, -+0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0x90, 0xF0, 0xE0, 0x94, 0xE8, -+0x90, 0x90, 0xEF, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x7F, -+0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x90, 0xEF, 0xE4, 0x75, 0xF0, 0x01, -+0x12, 0x47, 0xF6, 0x80, 0xBF, 0x8F, 0x18, 0xE4, 0x90, 0x90, 0xF1, 0xF0, 0xA3, 0xF0, 0x90, 0x01, -+0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0xEF, 0x65, 0x18, 0x60, 0x3E, 0xC3, 0x90, -+0x90, 0xF2, 0xE0, 0x94, 0x88, 0x90, 0x90, 0xF1, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, -+0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x90, 0xF1, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x7F, -+0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0x90, 0xF2, 0xE0, 0x94, 0x32, 0x90, 0x90, 0xF1, -+0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB2, 0x22, 0xF1, 0xBC, 0x90, -+0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0xE4, 0xFF, 0xF1, 0x15, 0x90, -+0x8D, 0x04, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x70, 0x12, -+0x3A, 0x96, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0xCE, 0xF1, 0x6D, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x90, 0x8E, 0x7D, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0E, 0x12, 0x87, 0x86, -+0xBF, 0x01, 0x08, 0xF1, 0x93, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x00, 0x90, 0xE0, -+0x20, 0xE0, 0xF9, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0x30, 0xE0, 0x02, 0xF1, 0xA3, 0x22, 0x90, 0x8D, -+0x04, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x70, 0x12, 0x3A, -+0x96, 0x90, 0x8E, 0x84, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x3A, 0x96, 0x90, 0x8E, 0x7B, 0xE0, 0x60, -+0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, -+0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0x7F, -+0x01, 0x12, 0x77, 0x15, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x3A, 0x96, -+0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0x90, 0x90, 0xF6, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xFF, -+0xAE, 0xF0, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0x90, 0x63, 0x12, 0x27, 0x48, 0x7F, 0xAC, -+0x7E, 0x08, 0x90, 0x90, 0x5D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x36, 0xCE, 0x90, 0x90, 0x67, -+0x12, 0x27, 0x48, 0x90, 0x90, 0x5F, 0x12, 0x48, 0x26, 0x12, 0x27, 0x15, 0x90, 0x90, 0x67, 0x12, -+0x48, 0x32, 0x12, 0x48, 0x0C, 0x90, 0x90, 0x63, 0x12, 0x48, 0x32, 0x12, 0x48, 0x19, 0x90, 0x90, -+0x6B, 0x12, 0x27, 0x48, 0x90, 0x90, 0x6B, 0x12, 0x48, 0x26, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, -+0x90, 0x90, 0x5D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x02, 0x37, 0x5D, 0x7F, 0x1C, 0x7E, 0x0C, 0x11, -+0x42, 0x90, 0x90, 0xE6, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x90, 0xF7, 0xED, 0xF0, 0xEF, 0x60, -+0x02, 0x21, 0x73, 0xE0, 0x24, 0xFD, 0x50, 0x07, 0x60, 0x35, 0x14, 0x60, 0x62, 0x61, 0x41, 0x90, -+0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, -+0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, -+0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x41, 0x21, 0x90, -+0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x54, -+0x33, 0x77, 0x70, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, -+0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x70, 0x41, 0xED, 0x90, -+0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, -+0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, -+0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, 0xB0, 0x7E, -+0x0E, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, -+0x12, 0x27, 0x54, 0x00, 0x10, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, -+0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x10, 0x00, -+0x00, 0x41, 0xB9, 0x90, 0x90, 0xF7, 0xE0, 0x14, 0x60, 0x79, 0x14, 0x70, 0x02, 0x41, 0x57, 0x14, -+0x70, 0x02, 0x41, 0xBF, 0x14, 0x70, 0x02, 0x41, 0x57, 0x24, 0x04, 0x60, 0x02, 0x61, 0x41, 0x90, -+0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, -+0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, -+0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, -+0x0E, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, -+0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, -+0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, -+0x00, 0x41, 0xB9, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, -+0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, -+0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, -+0x17, 0x7F, 0xB0, 0x7E, 0x0E, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, -+0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x11, -+0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x00, 0x80, 0x62, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, -+0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x77, 0x33, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, -+0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, -+0x54, 0x77, 0x33, 0x77, 0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, -+0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, -+0xB4, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, -+0x90, 0x63, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0E, 0x61, 0x3F, 0x90, -+0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, 0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x54, -+0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xFF, -+0xFF, 0xFF, 0xFF, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x54, 0x33, 0x77, 0x17, 0x7F, 0xB0, 0x7E, -+0x0E, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, -+0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0xB4, 0x7E, 0x0C, 0x11, 0x42, 0x90, 0x90, 0x5F, -+0x12, 0x27, 0x54, 0x3F, 0xF0, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, -+0x00, 0x7F, 0xB4, 0x7E, 0x0E, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x00, 0x03, -+0x03, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, 0x11, -+0x42, 0x22, 0x90, 0x90, 0xE7, 0xED, 0xF0, 0x90, 0x90, 0xE6, 0xEF, 0xF0, 0x60, 0x02, 0x61, 0xDE, -+0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, -+0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0x03, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x2C, -+0x7E, 0x08, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0F, 0x00, 0x90, 0x90, -+0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x11, 0x8B, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0xF0, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x7F, 0x0C, -+0x7E, 0x08, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x0F, 0x00, 0x00, 0x00, 0x90, 0x90, -+0x63, 0x12, 0x27, 0x54, 0x01, 0x00, 0x00, 0x00, 0x7F, 0x04, 0x7E, 0x0A, 0x11, 0x42, 0x90, 0x04, -+0x54, 0xE0, 0x54, 0x7F, 0x90, 0x90, 0xE8, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x22, 0x90, 0x90, -+0xE6, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x81, 0x8F, 0x90, 0x04, 0x54, 0xE0, 0x44, 0x80, 0x90, 0x90, -+0xE8, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, -+0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x11, -+0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0x90, 0x63, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x2C, 0x7E, 0x08, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x0F, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x01, 0x00, 0x11, -+0x8B, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0x90, 0x63, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x0C, 0x7E, 0x08, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, -+0x54, 0x0F, 0x00, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x0F, 0x00, 0x00, 0x00, 0x7F, -+0x04, 0x7E, 0x0A, 0x11, 0x42, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, -+0x90, 0x63, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x11, 0x42, 0x22, -+0x90, 0x90, 0xF6, 0xED, 0xF0, 0xEF, 0x14, 0x60, 0x23, 0x14, 0x70, 0x02, 0xA1, 0x3E, 0x24, 0x02, -+0x60, 0x02, 0xA1, 0x8C, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0x90, -+0x63, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x00, 0x7F, 0xAC, 0xA1, 0x88, 0x90, 0x90, 0x5F, 0x12, -+0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x01, -+0x11, 0x3E, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, 0x11, 0x27, 0x90, 0x90, -+0x5F, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0x90, 0xF6, 0xE0, 0x7E, 0x00, 0x78, 0x1C, -+0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0x90, -+0x63, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x11, 0x42, 0x90, 0x90, 0xF6, 0xE0, 0x90, 0x90, -+0x5F, 0xB4, 0x01, 0x13, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0x90, 0x63, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x10, 0x80, 0x11, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x90, 0x90, -+0x63, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x0A, 0x80, 0x4C, 0x90, 0x90, -+0x5F, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x00, 0x30, -+0x02, 0x02, 0x11, 0x3E, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, 0x11, 0x27, -+0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0x90, 0xF6, 0xE0, 0x7E, 0x00, -+0x78, 0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, -+0x90, 0x90, 0x63, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x11, 0x42, 0x22, 0x90, 0x90, 0xF4, -+0xED, 0xF0, 0x90, 0x90, 0xF3, 0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x15, 0xB1, 0xCB, 0xEF, 0x60, -+0x29, 0xB1, 0xCB, 0xEF, 0x64, 0x01, 0x70, 0x22, 0x90, 0x90, 0xF4, 0xE0, 0xFD, 0xE4, 0xFF, 0x80, -+0x15, 0x90, 0x90, 0xF3, 0xE0, 0xD3, 0x94, 0x0E, 0x40, 0x10, 0xB1, 0xCB, 0xEF, 0x70, 0x09, 0x90, -+0x90, 0xF4, 0xE0, 0xFD, 0x7F, 0x01, 0x61, 0x42, 0xB1, 0xCB, 0x22, 0x90, 0x04, 0x54, 0xE0, 0x7F, -+0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x90, 0xE4, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, -+0x90, 0xE3, 0xEF, 0xF0, 0xE4, 0xFE, 0xD1, 0xEB, 0x90, 0x90, 0xE3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, -+0xA3, 0xE0, 0xFB, 0xF1, 0x1E, 0xAE, 0x07, 0x90, 0x04, 0x83, 0xEE, 0xF0, 0x90, 0x90, 0xE3, 0xE0, -+0xFF, 0xAD, 0x06, 0x91, 0x90, 0x90, 0x90, 0xE3, 0xE0, 0xFF, 0xEF, 0x14, 0x60, 0x39, 0x14, 0x60, -+0x52, 0x24, 0x02, 0x70, 0x6A, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, -+0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0xD1, 0x8C, 0x90, 0x90, 0x4D, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x7D, -+0x18, 0x7C, 0x00, 0x7F, 0x01, 0x80, 0x36, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, -+0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x00, 0x04, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, -+0xFF, 0x80, 0x1A, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x90, 0x51, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0xD1, 0x92, 0x22, -+0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x90, 0x51, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, 0x00, -+0xE4, 0xFF, 0x90, 0x90, 0x4B, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x90, 0x4A, 0xEF, 0xF0, 0xA3, -+0xA3, 0xE0, 0xFD, 0x12, 0x3A, 0xA9, 0x90, 0x90, 0x55, 0x12, 0x27, 0x48, 0x90, 0x90, 0x4D, 0x12, -+0x48, 0x26, 0x12, 0x27, 0x15, 0x90, 0x90, 0x55, 0x12, 0x48, 0x32, 0x12, 0x48, 0x0C, 0x90, 0x90, -+0x51, 0x12, 0x48, 0x32, 0x12, 0x48, 0x19, 0x90, 0x90, 0x59, 0x12, 0x27, 0x48, 0x90, 0x90, 0x4B, -+0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x90, 0x59, 0x12, 0x48, 0x26, 0x90, 0xAC, 0x96, 0x12, 0x27, -+0x48, 0x90, 0x90, 0x4A, 0xE0, 0xFF, 0xD0, 0x05, 0x02, 0x39, 0xBA, 0xA9, 0x07, 0x90, 0x06, 0x69, -+0xE0, 0xFE, 0x90, 0x06, 0x68, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0xFE, 0xE9, 0x14, -+0x60, 0x13, 0x14, 0x60, 0x10, 0x24, 0x02, 0x70, 0x14, 0xEE, 0x54, 0xFE, 0xFE, 0xEF, 0x54, 0x7F, -+0x90, 0x06, 0x68, 0x80, 0x04, 0x90, 0x06, 0x68, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xE4, 0xFE, -+0xFC, 0xEF, 0x64, 0x02, 0x70, 0x40, 0xED, 0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, 0xB4, -+0x02, 0x02, 0x7E, 0x09, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, 0x38, -+0xEB, 0xB4, 0x02, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, 0x08, -+0xED, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, 0x02, -+0x70, 0x16, 0x7C, 0x03, 0x80, 0x12, 0xEF, 0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, 0x01, -+0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7C, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, 0xFF, -+0x22, 0x90, 0x90, 0xC6, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x90, 0xC5, 0xEF, 0xF0, 0x90, 0x90, -+0xC8, 0xE0, 0xFD, 0xB1, 0x8D, 0x90, 0x90, 0xC5, 0xE0, 0xC3, 0x94, 0x0E, 0x50, 0x47, 0x90, 0x90, -+0x5F, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x12, 0xD4, -+0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0x11, 0x42, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, -+0x03, 0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0xD1, 0x8C, 0x90, 0x90, -+0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x00, 0x02, 0x81, 0x32, 0x90, 0x90, 0xC5, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, 0x1B, -+0xEF, 0x94, 0x30, 0x50, 0x16, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, -+0x90, 0x63, 0x12, 0x27, 0x54, 0x09, 0x28, 0x00, 0x00, 0x80, 0x70, 0x90, 0x90, 0xC5, 0xE0, 0xFF, -+0x74, 0x32, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, 0x50, 0x16, 0x90, 0x90, 0x5F, 0x12, 0x27, -+0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x08, 0xA6, 0x00, 0x00, 0x80, -+0x4A, 0x90, 0x90, 0xC5, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x74, 0x50, -+0x16, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, 0x63, 0x12, 0x27, -+0x54, 0x08, 0xA4, 0x00, 0x00, 0x80, 0x24, 0x90, 0x90, 0xC5, 0xE0, 0xFF, 0x74, 0x76, 0xD3, 0x9F, -+0x50, 0x20, 0xEF, 0x94, 0xA5, 0x50, 0x1B, 0x90, 0x90, 0x5F, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, -+0x00, 0x90, 0x90, 0x63, 0x12, 0x27, 0x54, 0x08, 0x24, 0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0x12, -+0x78, 0x42, 0x90, 0x90, 0xC5, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, 0x32, 0xEF, 0x94, 0x40, -+0x50, 0x2D, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0x90, 0x51, 0x12, -+0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0x12, 0x7E, 0x8C, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, -+0x07, 0x03, 0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x01, 0x01, 0x00, 0x80, 0x73, 0x90, -+0x90, 0xC5, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x32, 0xEF, 0x94, 0x8C, 0x50, 0x2D, 0x90, -+0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, -+0x03, 0x01, 0x00, 0x12, 0x7E, 0x8C, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, -+0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x03, 0x01, 0x00, 0x80, 0x36, 0x90, 0x90, 0xC5, 0xE0, -+0xFF, 0x74, 0x8C, 0xC3, 0x9F, 0x50, 0x34, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, -+0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x05, 0x01, 0x00, 0x12, 0x7E, 0x8C, 0x90, 0x90, -+0x4D, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0x00, 0x90, 0x90, 0x51, 0x12, 0x27, 0x54, 0x00, 0x05, -+0x01, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0x12, 0x7E, 0x92, 0x90, 0x90, 0xC6, 0xE0, 0x64, -+0x02, 0x70, 0x66, 0x90, 0x90, 0xC5, 0xE0, 0xFF, 0xD3, 0x94, 0x30, 0x50, 0x08, 0x90, 0x90, 0xC9, -+0x74, 0x2A, 0xF0, 0x80, 0x70, 0xEF, 0xD3, 0x94, 0x40, 0x50, 0x08, 0x90, 0x90, 0xC9, 0x74, 0x3A, -+0xF0, 0x80, 0x62, 0xEF, 0xD3, 0x94, 0x70, 0x50, 0x08, 0x90, 0x90, 0xC9, 0x74, 0x6A, 0xF0, 0x80, -+0x54, 0xEF, 0xD3, 0x94, 0x80, 0x50, 0x08, 0x90, 0x90, 0xC9, 0x74, 0x7A, 0xF0, 0x80, 0x46, 0xEF, -+0xD3, 0x94, 0x90, 0x50, 0x08, 0x90, 0x90, 0xC9, 0x74, 0x8A, 0xF0, 0x80, 0x38, 0xEF, 0xD3, 0x94, -+0xA1, 0x50, 0x08, 0x90, 0x90, 0xC9, 0x74, 0x9B, 0xF0, 0x80, 0x2A, 0xEF, 0xD3, 0x94, 0xB1, 0x50, -+0x24, 0x90, 0x90, 0xC9, 0x74, 0xAB, 0xF0, 0x80, 0x1C, 0x90, 0x90, 0xC6, 0xE0, 0x64, 0x01, 0x70, -+0x33, 0xA3, 0xE0, 0x90, 0x90, 0xC5, 0xB4, 0x01, 0x05, 0xE0, 0x24, 0x02, 0x80, 0x03, 0xE0, 0x24, -+0xFE, 0x90, 0x90, 0xC9, 0xF0, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, -+0x90, 0xC9, 0x12, 0x7E, 0x80, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, -+0x90, 0xC9, 0x80, 0x1D, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x90, -+0xC5, 0x12, 0x7E, 0x80, 0x90, 0x90, 0x4D, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x90, -+0xC5, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x90, 0x51, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, -+0x00, 0x7F, 0x01, 0x02, 0x7E, 0x92, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8F, 0xA4, -+0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, 0x00, 0x01, 0x12, 0x26, -+0x37, 0x90, 0x8F, 0xA5, 0xF0, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, -+0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, -+0x1E, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x90, 0x07, 0xF0, 0xA3, 0xEF, 0xF0, -+0x90, 0x02, 0x87, 0xE0, 0xF9, 0x90, 0x8E, 0x96, 0xE0, 0x20, 0xE0, 0x02, 0x61, 0x09, 0xEC, 0xC3, -+0x99, 0x40, 0x02, 0x61, 0x09, 0x90, 0x90, 0x07, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, 0xFD, -+0x11, 0xF0, 0xAF, 0x03, 0xAD, 0x07, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, -+0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, 0x24, -+0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0xFE, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -+0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFD, 0x24, 0x18, 0xFB, 0xEA, 0x33, 0xFA, -+0xEB, 0x2F, 0xFF, 0xEA, 0x3E, 0xFE, 0x71, 0x0A, 0x90, 0x90, 0x07, 0xEE, 0x8F, 0xF0, 0x12, 0x47, -+0xF6, 0x90, 0x8D, 0xF4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x90, 0x90, 0x08, 0xE0, 0x9F, 0x90, -+0x90, 0x07, 0xE0, 0x9E, 0x40, 0x1B, 0x90, 0x8D, 0xF5, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8D, 0xF4, -+0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x90, 0x90, 0x08, 0xE0, 0x9F, 0xF0, 0x90, 0x90, 0x07, 0xE0, 0x9E, -+0xF0, 0x90, 0x90, 0x07, 0x51, 0x36, 0x0C, 0x41, 0x6E, 0x22, 0x7D, 0x07, 0xEF, 0x5D, 0xC3, 0x60, -+0x14, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, 0x24, 0x08, 0xFF, -+0xE4, 0x3E, 0xFE, 0x80, 0x0D, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, -+0x5F, 0xFF, 0x22, 0xE4, 0x90, 0x90, 0x04, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, -+0x2C, 0xC3, 0x90, 0x90, 0x05, 0xE0, 0x94, 0xD0, 0x90, 0x90, 0x04, 0xE0, 0x94, 0x07, 0x40, 0x0A, -+0x90, 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x90, 0x04, 0xE4, 0x75, 0xF0, -+0x01, 0x12, 0x47, 0xF6, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x80, 0xCD, 0x7F, 0x01, 0x22, -+0x12, 0x63, 0xB4, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x90, 0x8D, 0x04, 0xE0, 0xFF, 0xB4, 0x01, -+0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, -+0x54, 0xFB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x26, 0x1E, 0xFE, 0x20, -+0xE0, 0x04, 0x71, 0x70, 0x81, 0x4D, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFD, 0x90, 0x8E, 0x97, -+0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xED, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, -+0x12, 0x26, 0x1E, 0xFD, 0x54, 0x04, 0xFC, 0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0x8E, 0x97, 0xF0, -+0xED, 0x54, 0x08, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFD, 0x54, 0x10, -+0xFC, 0xEF, 0x54, 0xEF, 0x4C, 0xFF, 0x90, 0x8E, 0x97, 0xF0, 0xED, 0x54, 0x20, 0xFD, 0xEF, 0x54, -+0xDF, 0x4D, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFD, 0x54, 0x40, 0xFC, 0xEF, 0x54, 0xBF, 0x4C, 0xFF, -+0x90, 0x8E, 0x97, 0xF0, 0xED, 0x54, 0x80, 0xFD, 0xEF, 0x54, 0x7F, 0x4D, 0xF0, 0x90, 0x00, 0x01, -+0x12, 0x26, 0x37, 0x54, 0x80, 0xFF, 0x90, 0x8E, 0x98, 0xE0, 0x54, 0x7F, 0x4F, 0xF0, 0xEE, 0x13, -+0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x04, 0xF0, 0x12, 0x26, 0x1E, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, 0x90, -+0x8D, 0x04, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x8E, 0x9B, 0xE0, 0xFF, 0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, -+0x14, 0xEF, 0x44, 0x01, 0x90, 0x8E, 0x9B, 0xF0, 0x90, 0x8E, 0x97, 0xE0, 0xC4, 0x54, 0x0F, 0x20, -+0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, 0x01, 0x22, 0xEF, 0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, 0x74, -+0x04, 0xF0, 0x80, 0x03, 0x74, 0x08, 0xF0, 0x90, 0x8E, 0x9B, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, -+0x90, 0x15, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x90, 0x1D, 0xF0, 0x90, 0x90, 0x1D, 0xE0, -+0xFD, 0xC3, 0x94, 0x06, 0x50, 0x28, 0x90, 0x90, 0x16, 0xE0, 0x24, 0x04, 0xFF, 0x90, 0x90, 0x15, -+0xE0, 0x34, 0x00, 0xFE, 0x12, 0x52, 0x98, 0x90, 0x90, 0x1D, 0xE0, 0x24, 0x17, 0xF5, 0x82, 0xE4, -+0x34, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x90, 0x1D, 0xE0, 0x04, 0xF0, 0x80, 0xCE, 0x78, 0x9C, -+0x7C, 0x8E, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x17, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x4A, -+0x08, 0xEF, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x8E, 0x9B, 0xE0, 0x30, 0xE0, 0x03, -+0x7F, 0x01, 0x22, 0x90, 0x06, 0x90, 0xE0, 0x20, 0xE5, 0x0A, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, -+0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x90, 0x07, 0xF0, 0x12, -+0x26, 0x1E, 0x90, 0x8F, 0x94, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0x8F, 0x95, 0xF0, -+0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8F, -+0x96, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x97, 0xF0, 0x90, -+0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x98, 0xF0, 0x90, 0x00, 0x03, 0x12, -+0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x99, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, -+0xED, 0x2F, 0x90, 0x8F, 0x9A, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFF, 0xAE, 0x05, 0xED, -+0x2F, 0x90, 0x8F, 0x9B, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, 0xFE, 0xAF, -+0x05, 0xED, 0x2E, 0x90, 0x8F, 0x9C, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, -+0x90, 0x8F, 0x9D, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x9E, -+0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x9F, 0xF0, 0x90, 0x00, -+0x04, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0xA0, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x26, -+0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0xA1, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x26, 0x37, 0xFF, 0xAE, -+0x05, 0xED, 0x2F, 0x90, 0x8F, 0xA2, 0xF0, 0x22, 0xE4, 0xFF, 0x74, 0x18, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0xA2, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, -+0xEE, 0xF0, 0x74, 0x10, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x9C, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x06, 0xCB, 0x22, -+0xEF, 0x60, 0x08, 0x90, 0x8F, 0x97, 0xE0, 0xFF, 0x12, 0x56, 0xF6, 0x22, 0xE4, 0x90, 0x8E, 0x7A, -+0xF0, 0xA3, 0xF0, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, 0xF0, 0x90, 0x8E, 0x77, -+0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0x8E, 0x80, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x90, -+0x8E, 0x77, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x8E, 0x83, 0xF0, -+0x90, 0x8E, 0x82, 0x74, 0x07, 0xF0, 0x90, 0x8E, 0x85, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0xE4, -+0x90, 0x8E, 0x7E, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x7C, 0x74, 0x0C, -+0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x90, 0x8E, -+0x77, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, -+0x54, 0xF7, 0xF0, 0x90, 0x8E, 0x87, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0x8D, 0x04, -+0xE0, 0xB4, 0x01, 0x08, 0x90, 0x8E, 0x84, 0x74, 0xFF, 0xF0, 0x80, 0x12, 0x90, 0x8D, 0x04, 0xE0, -+0x90, 0x8E, 0x84, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x41, 0xF0, 0x90, 0x8E, -+0x8B, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, -+0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, -+0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x90, 0x04, -+0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, -+0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0xD1, 0xEE, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, -+0xB8, 0x74, 0x01, 0xF0, 0x80, 0x67, 0x90, 0x8E, 0x7E, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x08, 0x90, -+0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x56, 0x90, 0x8E, 0x7C, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, -+0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x44, 0xEF, 0x30, 0xE2, 0x08, 0x90, 0x01, 0xB8, -+0x74, 0x08, 0xF0, 0x80, 0x38, 0x90, 0x8E, 0x7E, 0xE0, 0x30, 0xE4, 0x08, 0x90, 0x01, 0xB8, 0x74, -+0x10, 0xF0, 0x80, 0x29, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x08, 0x90, -+0x01, 0xB8, 0x74, 0x20, 0xF0, 0x80, 0x16, 0x90, 0x8E, 0x91, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, -+0x74, 0x80, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, -+0x74, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x02, 0x96, 0xE0, 0xFF, 0x90, 0x02, 0x87, 0xE0, 0x4F, -+0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2C, 0x90, 0x8E, 0x96, 0xE0, 0x30, 0xE0, -+0x0E, 0x90, 0x02, 0x82, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x17, 0x90, -+0x02, 0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x08, 0x90, 0x01, -+0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x7F, 0x00, 0x22, 0xEF, -+0x60, 0x3E, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, 0x8E, 0x78, 0xE0, 0x54, 0xFE, -+0xF0, 0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE4, 0xFF, -+0x12, 0x57, 0xAF, 0xBF, 0x01, 0x0E, 0x90, 0x8E, 0x77, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x8E, 0x7D, -+0x74, 0x06, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, -+0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x7D, -+0x74, 0x0C, 0xF0, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x2E, 0x90, 0x8E, 0x78, 0xE0, -+0x54, 0xFD, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x7F, 0x01, 0x12, 0x57, 0xAF, 0xBF, 0x01, -+0x0E, 0x90, 0x8E, 0x77, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0E, 0xF0, 0x22, 0x90, -+0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0x6F, -+0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x7D, -+0x74, 0x04, 0xF0, 0x22, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x39, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, -+0x70, 0x31, 0x90, 0x8E, 0x81, 0xF0, 0x04, 0x60, 0x2A, 0x90, 0x8E, 0x7E, 0xE0, 0x44, 0x10, 0xF0, -+0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x82, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, -+0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x20, 0xE2, 0x03, -+0x12, 0x5D, 0xFB, 0x22, 0x90, 0x8D, 0x07, 0xE0, 0xFE, 0x90, 0x04, 0x1C, 0xE0, 0x6E, 0x70, 0x40, -+0x90, 0x8E, 0x7D, 0xE0, 0xFE, 0x64, 0x0E, 0x70, 0x1C, 0xEF, 0x70, 0x34, 0x90, 0x8E, 0x77, 0xE0, -+0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8E, -+0x7D, 0x74, 0x04, 0xF0, 0x22, 0xEE, 0xB4, 0x06, 0x17, 0xEF, 0x60, 0x14, 0x90, 0x8E, 0x77, 0xE0, -+0x54, 0xBF, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8F, 0xAE, 0x12, 0x48, 0x53, 0x90, 0x8F, -+0xB1, 0xED, 0xF0, 0xE4, 0x90, 0x8F, 0xFD, 0xF0, 0x90, 0x8F, 0xFD, 0xE0, 0xFF, 0xC3, 0x94, 0x40, -+0x50, 0x14, 0x74, 0xBA, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x8F, -+0xFD, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x90, 0x8F, 0xAE, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, -+0x89, 0x42, 0x90, 0x8F, 0xB1, 0xE0, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xBA, 0x12, 0x34, -+0x2C, 0xE4, 0x90, 0x8F, 0xB9, 0xF0, 0x90, 0x8F, 0xB9, 0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x16, -+0x74, 0xBA, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE0, 0x64, 0x36, 0xF0, 0x90, 0x8F, -+0xB9, 0xE0, 0x04, 0xF0, 0x80, 0xE0, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xB5, 0xE0, -+0xFF, 0xF5, 0x82, 0x75, 0x83, 0x00, 0x74, 0x80, 0x12, 0x26, 0x76, 0xEF, 0x75, 0xF0, 0x08, 0xA4, -+0x24, 0x00, 0xFF, 0xE5, 0xF0, 0x34, 0x02, 0xFC, 0x90, 0x00, 0x7E, 0x12, 0x26, 0x76, 0xEF, 0x90, -+0x00, 0x7F, 0x12, 0x26, 0x76, 0xE4, 0x90, 0x8F, 0xFA, 0xF0, 0xA3, 0xF0, 0x90, 0x8F, 0xFA, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xC0, 0xEE, 0x94, 0x00, 0x40, 0x02, 0x61, 0x5B, 0xC3, 0xEF, -+0x94, 0x40, 0xEE, 0x94, 0x00, 0x50, 0x52, 0xA3, 0x74, 0x40, 0xF0, 0x74, 0xBA, 0x2F, 0xF9, 0xE4, -+0x34, 0x8F, 0xFA, 0x7B, 0x01, 0x74, 0x40, 0x44, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFA, -+0xA3, 0xE0, 0x24, 0xBE, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x89, 0xFD, -+0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFA, 0xA3, 0xE0, 0x24, 0xC2, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, -+0x01, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFA, 0xA3, 0xE0, 0x24, 0xC6, -+0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0x41, 0x9C, 0xE4, 0x90, 0x8F, 0xFC, 0xF0, 0x90, 0x8F, -+0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, -+0xE9, 0x24, 0xC0, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0x74, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, -+0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, -+0xE9, 0x24, 0xC4, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, -+0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, -+0x3E, 0xFA, 0xE9, 0x24, 0xC8, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, -+0x30, 0xA4, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, -+0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xCC, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8B, -+0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFC, 0xE0, 0x44, 0x90, 0x90, 0x01, 0x8C, 0xF0, 0xE4, 0x90, -+0x8F, 0xFE, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x30, 0xE4, 0x22, 0xC3, 0x90, 0x8F, 0xFF, -+0xE0, 0x94, 0xE8, 0x90, 0x8F, 0xFE, 0xE0, 0x94, 0x03, 0x50, 0x13, 0x7F, 0x01, 0x7E, 0x00, 0x12, -+0x3A, 0xF7, 0x90, 0x8F, 0xFE, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x80, 0xD7, 0x90, 0x8F, -+0xFE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x06, -+0x31, 0xE0, 0x44, 0x01, 0xF0, 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x90, 0x8F, 0xFB, 0xE0, 0x54, 0x3F, -+0x64, 0x30, 0x70, 0x4B, 0x90, 0x8F, 0xFE, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x20, 0xE5, -+0x22, 0xC3, 0x90, 0x8F, 0xFF, 0xE0, 0x94, 0xE8, 0x90, 0x8F, 0xFE, 0xE0, 0x94, 0x03, 0x50, 0x13, -+0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x8F, 0xFE, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, -+0xF6, 0x80, 0xD7, 0x90, 0x8F, 0xFE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xE8, 0xEE, 0x94, -+0x03, 0x40, 0x0C, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x02, 0xF0, 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x90, -+0x8F, 0xFA, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x47, 0xF6, 0x21, 0xAC, 0x90, 0x8F, 0xB6, 0x12, 0x48, -+0x4A, 0xE9, 0x24, 0x10, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x80, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xB6, -+0x12, 0x48, 0x4A, 0xE9, 0x24, 0x0C, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x81, 0x12, 0x33, 0x2F, 0x90, -+0x8F, 0xB6, 0x12, 0x48, 0x4A, 0xE9, 0x24, 0x08, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x82, 0x12, 0x33, -+0x2F, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, 0xE9, 0x24, 0x04, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x83, -+0x12, 0x33, 0x2F, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, 0x7D, 0x84, 0x12, 0x33, 0x2F, 0xE4, 0x90, -+0x8F, 0xFD, 0xF0, 0x90, 0x8F, 0xFD, 0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x14, 0x74, 0xBA, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x8F, 0xFD, 0xE0, 0x04, 0xF0, 0x80, -+0xE2, 0x90, 0x8F, 0xAE, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x90, 0x8F, 0xB1, -+0xE0, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xBA, 0x12, 0x34, 0x2C, 0xE4, 0x90, 0x8F, 0xB9, -+0xF0, 0x90, 0x8F, 0xB9, 0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x16, 0x74, 0xBA, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE0, 0x64, 0x5C, 0xF0, 0x90, 0x8F, 0xB9, 0xE0, 0x04, 0xF0, 0x80, -+0xE0, 0xE4, 0x90, 0x8F, 0xB9, 0xF0, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xB9, 0xE0, -+0xFF, 0xF5, 0x82, 0x75, 0x83, 0x00, 0x12, 0x26, 0x37, 0xFE, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, -+0x8F, 0x82, 0x75, 0x83, 0x00, 0xEE, 0x12, 0x26, 0x76, 0x90, 0x8F, 0xB9, 0xE0, 0x04, 0xF0, 0xE0, -+0xB4, 0x14, 0xD3, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x14, 0x74, 0x80, 0x12, 0x26, -+0x76, 0x90, 0x8F, 0xB9, 0x74, 0x15, 0xF0, 0x90, 0x8F, 0xB9, 0xE0, 0xFF, 0xC3, 0x94, 0x3E, 0x50, -+0x17, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xE4, 0x12, 0x26, 0x76, -+0x90, 0x8F, 0xB9, 0xE0, 0x04, 0xF0, 0x80, 0xDF, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x00, -+0x3E, 0x74, 0x02, 0x12, 0x26, 0x76, 0x90, 0x00, 0x3F, 0x74, 0xA0, 0x12, 0x26, 0x76, 0xE4, 0x90, -+0x8F, 0xFA, 0xF0, 0xA3, 0xF0, 0x90, 0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0x80, -+0xEE, 0x94, 0x00, 0x40, 0x02, 0xC1, 0x44, 0xC3, 0xEF, 0x94, 0x40, 0xEE, 0x94, 0x00, 0x50, 0x52, -+0xA3, 0x74, 0x40, 0xF0, 0x74, 0xBA, 0x2F, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0x74, 0x40, -+0x44, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFA, 0xA3, 0xE0, 0x24, 0xBE, 0xF9, 0xE4, 0x34, -+0x8F, 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFA, 0xA3, -+0xE0, 0x24, 0xC2, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, -+0x30, 0xA4, 0x90, 0x8F, 0xFA, 0xA3, 0xE0, 0x24, 0xC6, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, -+0xA1, 0x85, 0xE4, 0x90, 0x8F, 0xFC, 0xF0, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xFA, -+0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC0, 0xF9, 0xEA, 0x34, 0xFF, -+0xFA, 0x74, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, 0x8F, 0xFA, -+0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC4, 0xF9, 0xEA, 0x34, 0xFF, -+0xFA, 0xA3, 0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xB2, 0x12, 0x48, 0x4A, 0x90, -+0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC8, 0xF9, 0xEA, -+0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xB2, 0x12, 0x48, -+0x4A, 0x90, 0x8F, 0xFA, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xCC, -+0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8B, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xFC, -+0xE0, 0x44, 0x90, 0x90, 0x01, 0x8C, 0xF0, 0xE4, 0x90, 0x8F, 0xFE, 0xF0, 0xA3, 0xF0, 0x90, 0x01, -+0x8C, 0xE0, 0x30, 0xE4, 0x22, 0xC3, 0x90, 0x8F, 0xFF, 0xE0, 0x94, 0xE8, 0x90, 0x8F, 0xFE, 0xE0, -+0x94, 0x03, 0x50, 0x13, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x8F, 0xFE, 0xE4, 0x75, -+0xF0, 0x01, 0x12, 0x47, 0xF6, 0x80, 0xD7, 0x90, 0x8F, 0xFE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, -+0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x01, 0xF0, 0xEE, 0x90, -+0x06, 0x36, 0xF0, 0x90, 0x8F, 0xFB, 0xE0, 0x54, 0x3F, 0x64, 0x30, 0x70, 0x4B, 0x90, 0x8F, 0xFE, -+0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x20, 0xE5, 0x22, 0xC3, 0x90, 0x8F, 0xFF, 0xE0, 0x94, -+0xE8, 0x90, 0x8F, 0xFE, 0xE0, 0x94, 0x03, 0x50, 0x13, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, -+0x90, 0x8F, 0xFE, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x47, 0xF6, 0x80, 0xD7, 0x90, 0x8F, 0xFE, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x06, 0x31, 0xE0, -+0x44, 0x02, 0xF0, 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x90, 0x8F, 0xFA, 0xE4, 0x75, 0xF0, 0x10, 0x12, -+0x47, 0xF6, 0x81, 0x95, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, 0xE9, 0x24, 0x10, 0xF9, 0xE4, 0x3A, -+0xFA, 0x7D, 0x80, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, 0xE9, 0x24, 0x0C, 0xF9, -+0xE4, 0x3A, 0xFA, 0x7D, 0x81, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, 0xE9, 0x24, -+0x08, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x82, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xB6, 0x12, 0x48, 0x4A, -+0xE9, 0x24, 0x04, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x83, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xB6, 0x12, -+0x48, 0x4A, 0x7D, 0x84, 0x12, 0x33, 0x2F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x90, 0x8E, 0x12, -+0x48, 0x53, 0x12, 0x26, 0x1E, 0x90, 0x90, 0x93, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, -+0x90, 0x94, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0x90, 0x90, 0x95, 0xF0, 0x90, 0x00, 0x05, -+0x12, 0x26, 0x37, 0x90, 0x90, 0x96, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x26, 0x37, 0x90, 0x90, 0x97, -+0xF0, 0x90, 0x00, 0x07, 0x12, 0x26, 0x37, 0x90, 0x90, 0x98, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, -+0x37, 0x90, 0x90, 0x9B, 0xF0, 0xED, 0x70, 0x31, 0xFF, 0x74, 0x93, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x90, 0xF5, 0x83, 0xE0, 0xB4, 0xFF, 0x0E, 0x74, 0x93, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, -+0x83, 0xE4, 0xF0, 0x80, 0x0F, 0x74, 0x93, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, -+0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x06, 0xD0, 0x90, 0x90, 0x92, 0xE0, 0xFF, 0xB4, 0x04, -+0x25, 0xA3, 0xE0, 0xFE, 0x90, 0x90, 0x8E, 0x12, 0x48, 0x4A, 0xEE, 0x12, 0x26, 0x64, 0x90, 0x90, -+0x94, 0xE0, 0xFE, 0x90, 0x90, 0x8E, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, 0x76, -+0x90, 0x00, 0x02, 0xE4, 0x80, 0x30, 0xEF, 0xB4, 0x02, 0x2F, 0x90, 0x90, 0x94, 0xE0, 0xFF, 0x90, -+0x90, 0x8E, 0x12, 0x48, 0x4A, 0xEF, 0x12, 0x26, 0x64, 0x90, 0x90, 0x94, 0xE0, 0x44, 0x20, 0x54, -+0x7F, 0xFF, 0x90, 0x90, 0x8E, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, 0x90, -+0x90, 0x93, 0xE0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x76, 0x90, 0x90, 0x8E, 0x12, 0x48, 0x4A, 0xE9, -+0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x26, 0x1E, 0x44, 0x20, 0x12, 0x26, 0x64, 0x90, 0x90, -+0x95, 0xE0, 0xFF, 0x90, 0x90, 0x8E, 0x12, 0x48, 0x4A, 0x90, 0x00, 0x04, 0xEF, 0x12, 0x26, 0x76, -+0x90, 0x90, 0x96, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x26, 0x76, 0x90, 0x90, 0x97, 0xE0, 0x90, 0x00, -+0x06, 0x12, 0x26, 0x76, 0x90, 0x90, 0x98, 0xE0, 0x90, 0x00, 0x07, 0x02, 0x26, 0x76, 0x90, 0x90, -+0xAA, 0xED, 0xF0, 0x90, 0x90, 0xA7, 0x12, 0x48, 0x53, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x90, -+0x90, 0xAE, 0xF0, 0x90, 0x90, 0xA7, 0x12, 0x48, 0x4A, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, -+0x43, 0x03, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xAB, 0x12, 0x34, 0x2C, 0x90, 0x90, 0xAA, 0xE0, 0x70, -+0x46, 0xFF, 0x74, 0xAB, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, 0xB4, 0xFF, 0x0E, -+0x74, 0xAB, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x0F, 0x74, 0xAB, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, -+0x03, 0xD0, 0x75, 0x40, 0x01, 0x75, 0x41, 0x90, 0x75, 0x42, 0xAB, 0x75, 0x43, 0x03, 0x90, 0x90, -+0xA7, 0x12, 0x48, 0x4A, 0x12, 0x34, 0x2C, 0x22, 0x09, 0xD8, -+}; -+u4Byte ArrayLength_MP_8812A_FW_WoWLAN = 20570; -+ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_WoWLAN( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+) -+{ -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8812A_FW_WoWLAN; -+ *pFirmwareSize = ArrayLength_MP_8812A_FW_WoWLAN; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_FW.h 2018-02-06 17:42:30.704967075 +0200 -@@ -0,0 +1,53 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_MP_FW_HW_IMG_8812A_H -+#define __INC_MP_FW_HW_IMG_8812A_H -+ -+ -+/****************************************************************************** -+* FW_NIC.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_NIC( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_NIC_BT.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_NIC_BT( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_WoWLAN.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8812A_FW_WoWLAN( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.c 2018-02-06 17:42:30.704967075 +0200 -@@ -0,0 +1,224 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+static bool -+CheckCondition( -+ const u4Byte Condition, -+ const u4Byte Hex -+ ) -+{ -+ u4Byte _board = (Hex & 0x000000FF); -+ u4Byte _interface = (Hex & 0x0000FF00) >> 8; -+ u4Byte _platform = (Hex & 0x00FF0000) >> 16; -+ u4Byte cond = Condition; -+ -+ if ( Condition == 0xCDCDCDCD ) -+ return true; -+ -+ cond = Condition & 0x000000FF; -+ if ( (_board != cond) && (cond != 0xFF) ) -+ return false; -+ -+ cond = Condition & 0x0000FF00; -+ cond = cond >> 8; -+ if ( ((_interface & cond) == 0) && (cond != 0x07) ) -+ return false; -+ -+ cond = Condition & 0x00FF0000; -+ cond = cond >> 16; -+ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) -+ return false; -+ return true; -+} -+ -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+u4Byte Array_MP_8812A_MAC_REG[] = { -+ 0x010, 0x0000000C, -+ 0x072, 0x00000000, -+ 0x428, 0x0000000A, -+ 0x429, 0x00000010, -+ 0x430, 0x00000000, -+ 0x431, 0x00000000, -+ 0x432, 0x00000000, -+ 0x433, 0x00000001, -+ 0x434, 0x00000004, -+ 0x435, 0x00000005, -+ 0x436, 0x00000007, -+ 0x437, 0x00000008, -+ 0x43C, 0x00000004, -+ 0x43D, 0x00000005, -+ 0x43E, 0x00000007, -+ 0x43F, 0x00000008, -+ 0x440, 0x0000005D, -+ 0x441, 0x00000001, -+ 0x442, 0x00000000, -+ 0x444, 0x00000010, -+ 0x445, 0x00000000, -+ 0x446, 0x00000000, -+ 0x447, 0x00000000, -+ 0x448, 0x00000000, -+ 0x449, 0x000000F0, -+ 0x44A, 0x0000000F, -+ 0x44B, 0x0000003E, -+ 0x44C, 0x00000010, -+ 0x44D, 0x00000000, -+ 0x44E, 0x00000000, -+ 0x44F, 0x00000000, -+ 0x450, 0x00000000, -+ 0x451, 0x000000F0, -+ 0x452, 0x0000000F, -+ 0x453, 0x00000000, -+ 0x45B, 0x00000080, -+ 0x460, 0x00000066, -+ 0x461, 0x00000066, -+ 0x4C8, 0x000000FF, -+ 0x4C9, 0x00000008, -+ 0x4CC, 0x000000FF, -+ 0x4CD, 0x000000FF, -+ 0x4CE, 0x00000001, -+ 0x500, 0x00000026, -+ 0x501, 0x000000A2, -+ 0x502, 0x0000002F, -+ 0x503, 0x00000000, -+ 0x504, 0x00000028, -+ 0x505, 0x000000A3, -+ 0x506, 0x0000005E, -+ 0x507, 0x00000000, -+ 0x508, 0x0000002B, -+ 0x509, 0x000000A4, -+ 0x50A, 0x0000005E, -+ 0x50B, 0x00000000, -+ 0x50C, 0x0000004F, -+ 0x50D, 0x000000A4, -+ 0x50E, 0x00000000, -+ 0x50F, 0x00000000, -+ 0x512, 0x0000001C, -+ 0x514, 0x0000000A, -+ 0x516, 0x0000000A, -+ 0x525, 0x0000004F, -+ 0x550, 0x00000010, -+ 0x551, 0x00000010, -+ 0x559, 0x00000002, -+ 0x55C, 0x00000050, -+ 0x55D, 0x000000FF, -+ 0x604, 0x00000009, -+ 0x605, 0x00000030, -+ 0x607, 0x00000007, -+ 0x608, 0x0000000E, -+ 0x609, 0x0000002A, -+ 0x620, 0x000000FF, -+ 0x621, 0x000000FF, -+ 0x622, 0x000000FF, -+ 0x623, 0x000000FF, -+ 0x624, 0x000000FF, -+ 0x625, 0x000000FF, -+ 0x626, 0x000000FF, -+ 0x627, 0x000000FF, -+ 0x638, 0x00000050, -+ 0x63C, 0x0000000A, -+ 0x63D, 0x0000000A, -+ 0x63E, 0x0000000E, -+ 0x63F, 0x0000000E, -+ 0x640, 0x00000040, -+ 0x642, 0x00000040, -+ 0x643, 0x00000000, -+ 0x66E, 0x00000005, -+ 0x700, 0x00000021, -+ 0x701, 0x00000043, -+ 0x702, 0x00000065, -+ 0x703, 0x00000087, -+ 0x708, 0x00000021, -+ 0x709, 0x00000043, -+ 0x70A, 0x00000065, -+ 0x70B, 0x00000087, -+ 0x718, 0x00000040, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_MAC_REG( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_MAC_REG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_MAC_REG; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_MAC_REG, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigMAC_8812A(pDM_Odm, v1, (u1Byte)v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigMAC_8812A(pDM_Odm, v1, (u1Byte)v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_MAC.h 2018-02-06 17:42:30.704967075 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_MP_MAC_HW_IMG_8812A_H -+#define __INC_MP_MAC_HW_IMG_8812A_H -+ -+static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_MAC_REG( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.c 2018-02-06 17:42:30.704967075 +0200 -@@ -0,0 +1,1954 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+ -+#include "odm_precomp.h" -+ -+static bool -+CheckCondition( -+ const u4Byte Condition, -+ const u4Byte Hex -+ ) -+{ -+ u4Byte _board = (Hex & 0x000000FF); -+ u4Byte _interface = (Hex & 0x0000FF00) >> 8; -+ u4Byte _platform = (Hex & 0x00FF0000) >> 16; -+ u4Byte cond = Condition; -+ -+ if ( Condition == 0xCDCDCDCD ) -+ return true; -+ -+ cond = Condition & 0x000000FF; -+ if ( (_board != cond) && (cond != 0xFF) ) -+ return false; -+ -+ cond = Condition & 0x0000FF00; -+ cond = cond >> 8; -+ if ( ((_interface & cond) == 0) && (cond != 0x07) ) -+ return false; -+ -+ cond = Condition & 0x00FF0000; -+ cond = cond >> 16; -+ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) -+ return false; -+ return true; -+} -+ -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+static u4Byte Array_MP_8812A_RadioA[] = { -+ 0x000, 0x00010000, -+ 0x018, 0x0001712A, -+ 0x056, 0x00051CF2, -+ 0x066, 0x00040000, -+ 0x01E, 0x00080000, -+ 0x089, 0x00000080, -+ 0xFF0F0740, 0xABCD, -+ 0x086, 0x00014B38, -+ 0xFF0F07C0, 0xCDEF, -+ 0x086, 0x00014B38, -+ 0xFF0F07D8, 0xCDEF, -+ 0x086, 0x00014B3C, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x086, 0x00014B38, -+ 0xFF0F0740, 0xDEAD, -+ 0x0B1, 0x0001FC1A, -+ 0x0B3, 0x000F0810, -+ 0x0B4, 0x0001A78D, -+ 0x0BA, 0x00086180, -+ 0x018, 0x00000006, -+ 0x0EF, 0x00002000, -+ 0x03B, 0x00038A58, -+ 0x03B, 0x00037A58, -+ 0x03B, 0x0002A590, -+ 0x03B, 0x00027A50, -+ 0x03B, 0x00018248, -+ 0x03B, 0x00010240, -+ 0x03B, 0x00008240, -+ 0x03B, 0x00000240, -+ 0x0EF, 0x00000100, -+ 0xFF0F07D8, 0xABCD, -+ 0x034, 0x0000A4EE, -+ 0x034, 0x00009076, -+ 0x034, 0x00008073, -+ 0x034, 0x00007070, -+ 0x034, 0x0000606D, -+ 0x034, 0x0000506A, -+ 0x034, 0x00004049, -+ 0x034, 0x00003046, -+ 0x034, 0x00002028, -+ 0x034, 0x00001025, -+ 0x034, 0x00000022, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0000ADF4, -+ 0x034, 0x00009DF1, -+ 0x034, 0x00008DEE, -+ 0x034, 0x00007DEB, -+ 0x034, 0x00006DE8, -+ 0x034, 0x00005CEC, -+ 0x034, 0x00004CE9, -+ 0x034, 0x000034EA, -+ 0x034, 0x000024E7, -+ 0x034, 0x0000146B, -+ 0x034, 0x0000006D, -+ 0xFF0F07D8, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x000020A2, -+ 0x0DF, 0x00000080, -+ 0x035, 0x00000192, -+ 0x035, 0x00008192, -+ 0x035, 0x00010192, -+ 0x036, 0x00000024, -+ 0x036, 0x00008024, -+ 0x036, 0x00010024, -+ 0x036, 0x00018024, -+ 0x0EF, 0x00000000, -+ 0x051, 0x00000C21, -+ 0x052, 0x000006D9, -+ 0x053, 0x000FC649, -+ 0x054, 0x0000017E, -+ 0x0EF, 0x00000002, -+ 0x008, 0x00008400, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00001000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x0003A02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x0003202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x0002B064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x00023070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0001B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00012085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0000A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00002080, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x0007A02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x0007202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x0006B064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x00023070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0005B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00052085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0004A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00042080, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x000BA02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x000B202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x000AB064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x000A3070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0009B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00092085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0008A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00082080, -+ 0x03C, 0x00010000, -+ 0x0EF, 0x00001100, -+ 0xFF0F0740, 0xABCD, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0xFF0F07C0, 0xCDEF, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0xFF0F07D8, 0xCDEF, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0004ADF5, -+ 0x034, 0x00049DF2, -+ 0x034, 0x00048DEF, -+ 0x034, 0x00047DEC, -+ 0x034, 0x00046DE9, -+ 0x034, 0x00045DC9, -+ 0x034, 0x00044CE8, -+ 0x034, 0x000438CA, -+ 0x034, 0x00042889, -+ 0x034, 0x0004184A, -+ 0x034, 0x0004044A, -+ 0xFF0F0740, 0xDEAD, -+ 0xFF0F0740, 0xABCD, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0xFF0F07C0, 0xCDEF, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0xFF0F07D8, 0xCDEF, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0002ADF5, -+ 0x034, 0x00029DF2, -+ 0x034, 0x00028DEF, -+ 0x034, 0x00027DEC, -+ 0x034, 0x00026DE9, -+ 0x034, 0x00025DC9, -+ 0x034, 0x00024CE8, -+ 0x034, 0x000238CA, -+ 0x034, 0x00022889, -+ 0x034, 0x0002184A, -+ 0x034, 0x0002044A, -+ 0xFF0F0740, 0xDEAD, -+ 0xFF0F0740, 0xABCD, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0xFF0F07C0, 0xCDEF, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0xFF0F07D8, 0xCDEF, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0000AFF7, -+ 0x034, 0x00009DF7, -+ 0x034, 0x00008DF4, -+ 0x034, 0x00007DF1, -+ 0x034, 0x00006DEE, -+ 0x034, 0x00005DCD, -+ 0x034, 0x00004CEB, -+ 0x034, 0x000038CC, -+ 0x034, 0x0000288B, -+ 0x034, 0x0000184C, -+ 0x034, 0x0000044C, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0xFF0F0740, 0xABCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001D4, -+ 0x035, 0x000081D4, -+ 0x035, 0x000101D4, -+ 0x035, 0x000201B4, -+ 0x035, 0x000281B4, -+ 0x035, 0x000301B4, -+ 0x035, 0x000401B4, -+ 0x035, 0x000481B4, -+ 0x035, 0x000501B4, -+ 0xFF0F07C0, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001D4, -+ 0x035, 0x000081D4, -+ 0x035, 0x000101D4, -+ 0x035, 0x000201B4, -+ 0x035, 0x000281B4, -+ 0x035, 0x000301B4, -+ 0x035, 0x000401B4, -+ 0x035, 0x000481B4, -+ 0x035, 0x000501B4, -+ 0xFF0F07D8, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001D4, -+ 0x035, 0x000081D4, -+ 0x035, 0x000101D4, -+ 0x035, 0x000201B4, -+ 0x035, 0x000281B4, -+ 0x035, 0x000301B4, -+ 0x035, 0x000401B4, -+ 0x035, 0x000481B4, -+ 0x035, 0x000501B4, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x00000188, -+ 0x035, 0x00008188, -+ 0x035, 0x00010185, -+ 0x035, 0x000201D7, -+ 0x035, 0x000281D7, -+ 0x035, 0x000301D5, -+ 0x035, 0x000401D8, -+ 0x035, 0x000481D8, -+ 0x035, 0x000501D5, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0xFF0F0740, 0xABCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00004BFB, -+ 0x036, 0x0000CBFB, -+ 0x036, 0x00014BFB, -+ 0x036, 0x0001CBFB, -+ 0x036, 0x00024F4B, -+ 0x036, 0x0002CF4B, -+ 0x036, 0x00034F4B, -+ 0x036, 0x0003CF4B, -+ 0x036, 0x00044F4B, -+ 0x036, 0x0004CF4B, -+ 0x036, 0x00054F4B, -+ 0x036, 0x0005CF4B, -+ 0xFF0F07C0, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00004BFB, -+ 0x036, 0x0000CBFB, -+ 0x036, 0x00014BFB, -+ 0x036, 0x0001CBFB, -+ 0x036, 0x00024F4B, -+ 0x036, 0x0002CF4B, -+ 0x036, 0x00034F4B, -+ 0x036, 0x0003CF4B, -+ 0x036, 0x00044F4B, -+ 0x036, 0x0004CF4B, -+ 0x036, 0x00054F4B, -+ 0x036, 0x0005CF4B, -+ 0xFF0F07D8, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00004BFB, -+ 0x036, 0x0000CBFB, -+ 0x036, 0x00014BFB, -+ 0x036, 0x0001CBFB, -+ 0x036, 0x00024F4B, -+ 0x036, 0x0002CF4B, -+ 0x036, 0x00034F4B, -+ 0x036, 0x0003CF4B, -+ 0x036, 0x00044F4B, -+ 0x036, 0x0004CF4B, -+ 0x036, 0x00054F4B, -+ 0x036, 0x0005CF4B, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00084EB4, -+ 0x036, 0x0008C9B4, -+ 0x036, 0x000949B4, -+ 0x036, 0x0009C9B4, -+ 0x036, 0x000A4935, -+ 0x036, 0x000AC935, -+ 0x036, 0x000B4935, -+ 0x036, 0x000BC935, -+ 0x036, 0x000C4EB4, -+ 0x036, 0x000CCEB4, -+ 0x036, 0x000D4EB4, -+ 0x036, 0x000DCEB4, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000008, -+ 0xFF0F0740, 0xABCD, -+ 0x03C, 0x000002CC, -+ 0x03C, 0x00000522, -+ 0x03C, 0x00000902, -+ 0xFF0F07C0, 0xCDEF, -+ 0x03C, 0x000002CC, -+ 0x03C, 0x00000522, -+ 0x03C, 0x00000902, -+ 0xFF0F07D8, 0xCDEF, -+ 0x03C, 0x000002CC, -+ 0x03C, 0x00000522, -+ 0x03C, 0x00000902, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x03C, 0x000002AA, -+ 0x03C, 0x000005A2, -+ 0x03C, 0x00000880, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000002, -+ 0x0DF, 0x00000080, -+ 0x01F, 0x00040064, -+ 0xFF0F0740, 0xABCD, -+ 0x061, 0x000FDD43, -+ 0x062, 0x00038F4B, -+ 0x063, 0x00032117, -+ 0x064, 0x000194AC, -+ 0x065, 0x000931D1, -+ 0xFF0F07C0, 0xCDEF, -+ 0x061, 0x000FDD43, -+ 0x062, 0x00038F4B, -+ 0x063, 0x00032117, -+ 0x064, 0x000194AC, -+ 0x065, 0x000931D1, -+ 0xFF0F07D8, 0xCDEF, -+ 0x061, 0x000FDD43, -+ 0x062, 0x00038F4B, -+ 0x063, 0x00032117, -+ 0x064, 0x000194AC, -+ 0x065, 0x000931D1, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x061, 0x000E5D53, -+ 0x062, 0x00038FCD, -+ 0x063, 0x000314EB, -+ 0x064, 0x000196AC, -+ 0x065, 0x000931D7, -+ 0xFF0F0740, 0xDEAD, -+ 0x008, 0x00008400, -+ 0x01C, 0x000739D2, -+ 0x0B4, 0x0001E78D, -+ 0x018, 0x0001F12A, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0B4, 0x0001A78D, -+ 0x018, 0x0001712A, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_RadioA( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_RadioA)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_RadioA; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_RadioA, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigRF_RadioA_8812A(pDM_Odm, v1, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigRF_RadioA_8812A(pDM_Odm, v1, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* RadioB.TXT -+******************************************************************************/ -+ -+static u4Byte Array_MP_8812A_RadioB[] = { -+ 0x056, 0x00051CF2, -+ 0x066, 0x00040000, -+ 0x089, 0x00000080, -+ 0xFF0F0740, 0xABCD, -+ 0x086, 0x00014B38, -+ 0xFF0F07C0, 0xCDEF, -+ 0x086, 0x00014B38, -+ 0xFF0F07D8, 0xCDEF, -+ 0x086, 0x00014B3C, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x086, 0x00014B38, -+ 0xFF0F0740, 0xDEAD, -+ 0x018, 0x00000006, -+ 0x0EF, 0x00002000, -+ 0x03B, 0x00038A58, -+ 0x03B, 0x00037A58, -+ 0x03B, 0x0002A590, -+ 0x03B, 0x00027A50, -+ 0x03B, 0x00018248, -+ 0x03B, 0x00010240, -+ 0x03B, 0x00008240, -+ 0x03B, 0x00000240, -+ 0x0EF, 0x00000100, -+ 0xFF0F07D8, 0xABCD, -+ 0x034, 0x0000A4EE, -+ 0x034, 0x00009076, -+ 0x034, 0x00008073, -+ 0x034, 0x00007070, -+ 0x034, 0x0000606D, -+ 0x034, 0x0000506A, -+ 0x034, 0x00004049, -+ 0x034, 0x00003046, -+ 0x034, 0x00002028, -+ 0x034, 0x00001025, -+ 0x034, 0x00000022, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0000ADF4, -+ 0x034, 0x00009DF1, -+ 0x034, 0x00008DEE, -+ 0x034, 0x00007DEB, -+ 0x034, 0x00006DE8, -+ 0x034, 0x00005CEC, -+ 0x034, 0x00004CE9, -+ 0x034, 0x000034EA, -+ 0x034, 0x000024E7, -+ 0x034, 0x0000146B, -+ 0x034, 0x0000006D, -+ 0xFF0F07D8, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x000020A2, -+ 0x0DF, 0x00000080, -+ 0x035, 0x00000192, -+ 0x035, 0x00008192, -+ 0x035, 0x00010192, -+ 0x036, 0x00000024, -+ 0x036, 0x00008024, -+ 0x036, 0x00010024, -+ 0x036, 0x00018024, -+ 0x0EF, 0x00000000, -+ 0x051, 0x00000C21, -+ 0x052, 0x000006D9, -+ 0x053, 0x000FC649, -+ 0x054, 0x0000017E, -+ 0x0EF, 0x00000002, -+ 0x008, 0x00008400, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00001000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x0003A02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x0003202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x0002B064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x00023070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0001B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00012085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0000A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00002080, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x0007A02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x0007202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x0006B064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x00063070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0005B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00052085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0004A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00042080, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x000BA02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x000B202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x000AB064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x000A3070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0009B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00092085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0008A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00082080, -+ 0x03C, 0x00010000, -+ 0x0EF, 0x00001100, -+ 0xFF0F0740, 0xABCD, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0xFF0F07C0, 0xCDEF, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0xFF0F07D8, 0xCDEF, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0004ADF5, -+ 0x034, 0x00049DF2, -+ 0x034, 0x00048DEF, -+ 0x034, 0x00047DEC, -+ 0x034, 0x00046DE9, -+ 0x034, 0x00045DC9, -+ 0x034, 0x00044CE8, -+ 0x034, 0x000438CA, -+ 0x034, 0x00042889, -+ 0x034, 0x0004184A, -+ 0x034, 0x0004044A, -+ 0xFF0F0740, 0xDEAD, -+ 0xFF0F0740, 0xABCD, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0xFF0F07C0, 0xCDEF, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0xFF0F07D8, 0xCDEF, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0002ADF5, -+ 0x034, 0x00029DF2, -+ 0x034, 0x00028DEF, -+ 0x034, 0x00027DEC, -+ 0x034, 0x00026DE9, -+ 0x034, 0x00025DC9, -+ 0x034, 0x00024CE8, -+ 0x034, 0x000238CA, -+ 0x034, 0x00022889, -+ 0x034, 0x0002184A, -+ 0x034, 0x0002044A, -+ 0xFF0F0740, 0xDEAD, -+ 0xFF0F0740, 0xABCD, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0xFF0F07C0, 0xCDEF, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0xFF0F07D8, 0xCDEF, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0000AFF7, -+ 0x034, 0x00009DF7, -+ 0x034, 0x00008DF4, -+ 0x034, 0x00007DF1, -+ 0x034, 0x00006DEE, -+ 0x034, 0x00005DCD, -+ 0x034, 0x00004CEB, -+ 0x034, 0x000038CC, -+ 0x034, 0x0000288B, -+ 0x034, 0x0000184C, -+ 0x034, 0x0000044C, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0xFF0F0740, 0xABCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001C5, -+ 0x035, 0x000081C5, -+ 0x035, 0x000101C5, -+ 0x035, 0x00020174, -+ 0x035, 0x00028174, -+ 0x035, 0x00030174, -+ 0x035, 0x00040185, -+ 0x035, 0x00048185, -+ 0x035, 0x00050185, -+ 0x0EF, 0x00000000, -+ 0xFF0F07C0, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001C5, -+ 0x035, 0x000081C5, -+ 0x035, 0x000101C5, -+ 0x035, 0x00020174, -+ 0x035, 0x00028174, -+ 0x035, 0x00030174, -+ 0x035, 0x00040185, -+ 0x035, 0x00048185, -+ 0x035, 0x00050185, -+ 0x0EF, 0x00000000, -+ 0xFF0F07D8, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001C5, -+ 0x035, 0x000081C5, -+ 0x035, 0x000101C5, -+ 0x035, 0x00020174, -+ 0x035, 0x00028174, -+ 0x035, 0x00030174, -+ 0x035, 0x00040185, -+ 0x035, 0x00048185, -+ 0x035, 0x00050185, -+ 0x0EF, 0x00000000, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x00000186, -+ 0x035, 0x00008186, -+ 0x035, 0x00010185, -+ 0x035, 0x000201D5, -+ 0x035, 0x000281D5, -+ 0x035, 0x000301D5, -+ 0x035, 0x000401D5, -+ 0x035, 0x000481D5, -+ 0x035, 0x000501D5, -+ 0x0EF, 0x00000000, -+ 0xFF0F0740, 0xDEAD, -+ 0xFF0F0740, 0xABCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00005B8B, -+ 0x036, 0x0000DB8B, -+ 0x036, 0x00015B8B, -+ 0x036, 0x0001DB8B, -+ 0x036, 0x000262DB, -+ 0x036, 0x0002E2DB, -+ 0x036, 0x000362DB, -+ 0x036, 0x0003E2DB, -+ 0x036, 0x0004553B, -+ 0x036, 0x0004D53B, -+ 0x036, 0x0005553B, -+ 0x036, 0x0005D53B, -+ 0xFF0F07C0, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00005B8B, -+ 0x036, 0x0000DB8B, -+ 0x036, 0x00015B8B, -+ 0x036, 0x0001DB8B, -+ 0x036, 0x000262DB, -+ 0x036, 0x0002E2DB, -+ 0x036, 0x000362DB, -+ 0x036, 0x0003E2DB, -+ 0x036, 0x0004553B, -+ 0x036, 0x0004D53B, -+ 0x036, 0x0005553B, -+ 0x036, 0x0005D53B, -+ 0xFF0F07D8, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00005B8B, -+ 0x036, 0x0000DB8B, -+ 0x036, 0x00015B8B, -+ 0x036, 0x0001DB8B, -+ 0x036, 0x000262DB, -+ 0x036, 0x0002E2DB, -+ 0x036, 0x000362DB, -+ 0x036, 0x0003E2DB, -+ 0x036, 0x0004553B, -+ 0x036, 0x0004D53B, -+ 0x036, 0x0005553B, -+ 0x036, 0x0005D53B, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00084EB4, -+ 0x036, 0x0008C9B4, -+ 0x036, 0x000949B4, -+ 0x036, 0x0009C9B4, -+ 0x036, 0x000A4935, -+ 0x036, 0x000AC935, -+ 0x036, 0x000B4935, -+ 0x036, 0x000BC935, -+ 0x036, 0x000C4EB4, -+ 0x036, 0x000CCEB4, -+ 0x036, 0x000D4EB4, -+ 0x036, 0x000DCEB4, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000008, -+ 0xFF0F0740, 0xABCD, -+ 0x03C, 0x000002DC, -+ 0x03C, 0x00000524, -+ 0x03C, 0x00000902, -+ 0xFF0F07C0, 0xCDEF, -+ 0x03C, 0x000002DC, -+ 0x03C, 0x00000524, -+ 0x03C, 0x00000902, -+ 0xFF0F07D8, 0xCDEF, -+ 0x03C, 0x000002DC, -+ 0x03C, 0x00000524, -+ 0x03C, 0x00000902, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x03C, 0x000002AA, -+ 0x03C, 0x000005A2, -+ 0x03C, 0x00000880, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000002, -+ 0x0DF, 0x00000080, -+ 0xFF0F0740, 0xABCD, -+ 0x061, 0x000EAC43, -+ 0x062, 0x00038F47, -+ 0x063, 0x00031157, -+ 0x064, 0x0001C4AC, -+ 0x065, 0x000931D1, -+ 0xFF0F07C0, 0xCDEF, -+ 0x061, 0x000EAC43, -+ 0x062, 0x00038F47, -+ 0x063, 0x00031157, -+ 0x064, 0x0001C4AC, -+ 0x065, 0x000931D1, -+ 0xFF0F07D8, 0xCDEF, -+ 0x061, 0x000EAC43, -+ 0x062, 0x00038F47, -+ 0x063, 0x00031157, -+ 0x064, 0x0001C4AC, -+ 0x065, 0x000931D1, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x061, 0x000E5D53, -+ 0x062, 0x00038FCD, -+ 0x063, 0x000314EB, -+ 0x064, 0x000196AC, -+ 0x065, 0x000931D7, -+ 0xFF0F0740, 0xDEAD, -+ 0x008, 0x00008400, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_RadioB( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_RadioB)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8812A_RadioB; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_RadioB, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigRF_RadioB_8812A(pDM_Odm, v1, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigRF_RadioB_8812A(pDM_Odm, v1, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* TxPowerTrack_AP.TXT -+******************************************************************************/ -+ -+static u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_AP_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_AP_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 17, 17, 18, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_AP_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 4, 4, 5, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 13, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_AP_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 7, 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 18, 19, 19, 19}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_AP_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_AP_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_AP_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_AP_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_AP_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_AP_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_AP_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_AP_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_AP( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_AP_8812A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+static u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 13, 13, 13}, -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 11, 12, 12, 12, 12, 12, 13, 13}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 8, 8, 9, 10, 11, 12, 13, 14, 14, 15, 15, 15, 16, 16, 16, 17, 17, 18, 18}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_PCIE( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+static u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 12, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+static u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; -+static u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_USB( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8812A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+/****************************************************************************** -+* TxPowerTrack_USB_RFE3.TXT -+******************************************************************************/ -+ -+static u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_RFE3_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 12, 13, 13, 14, 15, 16, 16, 17, 17, 18, 18}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_RFE3_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_RFE3_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 15, 16, 16, 17, 17, 18, 18}, -+ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 16, 16, 17, 17}, -+ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 12, 13, 13, 14, 14, 15, 15, 16, 17, 18, 18}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_RFE3_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 2, 3, 4, 4, 5, 5, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 2, 3, 4, 4, 5, 5, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_RFE3_8812A[] = {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15}; -+static u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_RFE3_8812A[] = {0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 9, 10, 10, 10, 10, 11, 11, 11, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_RFE3_8812A[] = {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 10, 11, 11, 12, 12, 13, 13, 13, 13, 14, 14, 15, 15}; -+static u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_RFE3_8812A[] = {0, 0, 1, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_RFE3_8812A[] = {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_RFE3_8812A[] = {0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 9, 10, 10, 10, 10, 11, 11, 11, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_RFE3_8812A[] = {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 10, 11, 11, 12, 12, 13, 13, 13, 13, 14, 14, 15, 15}; -+static u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_RFE3_8812A[] = {0, 0, 1, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_USB_RFE3( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8812A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_RFE3_8812A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+static pu1Byte Array_MP_8812A_TXPWR_LMT[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "114", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "114", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "32", -+ "MKK", "5G", "20M", "HT", "1T", "36", "32", -+ "FCC", "5G", "20M", "HT", "1T", "40", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "32", -+ "MKK", "5G", "20M", "HT", "1T", "40", "32", -+ "FCC", "5G", "20M", "HT", "1T", "44", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "32", -+ "MKK", "5G", "20M", "HT", "1T", "44", "32", -+ "FCC", "5G", "20M", "HT", "1T", "48", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "32", -+ "MKK", "5G", "20M", "HT", "1T", "48", "32", -+ "FCC", "5G", "20M", "HT", "1T", "52", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "32", -+ "MKK", "5G", "20M", "HT", "1T", "52", "32", -+ "FCC", "5G", "20M", "HT", "1T", "56", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "32", -+ "MKK", "5G", "20M", "HT", "1T", "56", "32", -+ "FCC", "5G", "20M", "HT", "1T", "60", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "32", -+ "MKK", "5G", "20M", "HT", "1T", "60", "32", -+ "FCC", "5G", "20M", "HT", "1T", "64", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "32", -+ "MKK", "5G", "20M", "HT", "1T", "64", "32", -+ "FCC", "5G", "20M", "HT", "1T", "100", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "32", -+ "MKK", "5G", "20M", "HT", "1T", "100", "32", -+ "FCC", "5G", "20M", "HT", "1T", "114", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "114", "32", -+ "MKK", "5G", "20M", "HT", "1T", "114", "32", -+ "FCC", "5G", "20M", "HT", "1T", "108", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "32", -+ "MKK", "5G", "20M", "HT", "1T", "108", "32", -+ "FCC", "5G", "20M", "HT", "1T", "112", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "32", -+ "MKK", "5G", "20M", "HT", "1T", "112", "32", -+ "FCC", "5G", "20M", "HT", "1T", "116", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "32", -+ "MKK", "5G", "20M", "HT", "1T", "116", "32", -+ "FCC", "5G", "20M", "HT", "1T", "120", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "32", -+ "MKK", "5G", "20M", "HT", "1T", "120", "32", -+ "FCC", "5G", "20M", "HT", "1T", "124", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "32", -+ "MKK", "5G", "20M", "HT", "1T", "124", "32", -+ "FCC", "5G", "20M", "HT", "1T", "128", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "32", -+ "MKK", "5G", "20M", "HT", "1T", "128", "32", -+ "FCC", "5G", "20M", "HT", "1T", "132", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "32", -+ "MKK", "5G", "20M", "HT", "1T", "132", "32", -+ "FCC", "5G", "20M", "HT", "1T", "136", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "32", -+ "MKK", "5G", "20M", "HT", "1T", "136", "32", -+ "FCC", "5G", "20M", "HT", "1T", "140", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "32", -+ "MKK", "5G", "20M", "HT", "1T", "140", "32", -+ "FCC", "5G", "20M", "HT", "1T", "149", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "32", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "32", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "32", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "32", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "32", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "30", -+ "MKK", "5G", "20M", "HT", "2T", "36", "30", -+ "FCC", "5G", "20M", "HT", "2T", "40", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "30", -+ "MKK", "5G", "20M", "HT", "2T", "40", "30", -+ "FCC", "5G", "20M", "HT", "2T", "44", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "30", -+ "MKK", "5G", "20M", "HT", "2T", "44", "30", -+ "FCC", "5G", "20M", "HT", "2T", "48", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "30", -+ "MKK", "5G", "20M", "HT", "2T", "48", "30", -+ "FCC", "5G", "20M", "HT", "2T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "30", -+ "MKK", "5G", "20M", "HT", "2T", "52", "30", -+ "FCC", "5G", "20M", "HT", "2T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "30", -+ "MKK", "5G", "20M", "HT", "2T", "56", "30", -+ "FCC", "5G", "20M", "HT", "2T", "60", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "30", -+ "MKK", "5G", "20M", "HT", "2T", "60", "30", -+ "FCC", "5G", "20M", "HT", "2T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "30", -+ "MKK", "5G", "20M", "HT", "2T", "64", "30", -+ "FCC", "5G", "20M", "HT", "2T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "30", -+ "MKK", "5G", "20M", "HT", "2T", "100", "30", -+ "FCC", "5G", "20M", "HT", "2T", "114", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "114", "30", -+ "MKK", "5G", "20M", "HT", "2T", "114", "30", -+ "FCC", "5G", "20M", "HT", "2T", "108", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "30", -+ "MKK", "5G", "20M", "HT", "2T", "108", "30", -+ "FCC", "5G", "20M", "HT", "2T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "30", -+ "MKK", "5G", "20M", "HT", "2T", "112", "30", -+ "FCC", "5G", "20M", "HT", "2T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "30", -+ "MKK", "5G", "20M", "HT", "2T", "116", "30", -+ "FCC", "5G", "20M", "HT", "2T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "30", -+ "MKK", "5G", "20M", "HT", "2T", "120", "30", -+ "FCC", "5G", "20M", "HT", "2T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "30", -+ "MKK", "5G", "20M", "HT", "2T", "124", "30", -+ "FCC", "5G", "20M", "HT", "2T", "128", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "30", -+ "MKK", "5G", "20M", "HT", "2T", "128", "30", -+ "FCC", "5G", "20M", "HT", "2T", "132", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "30", -+ "MKK", "5G", "20M", "HT", "2T", "132", "30", -+ "FCC", "5G", "20M", "HT", "2T", "136", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "30", -+ "MKK", "5G", "20M", "HT", "2T", "136", "30", -+ "FCC", "5G", "20M", "HT", "2T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "30", -+ "MKK", "5G", "20M", "HT", "2T", "140", "30", -+ "FCC", "5G", "20M", "HT", "2T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "30", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "30", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "30", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "30", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "30", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "32", -+ "MKK", "5G", "40M", "HT", "1T", "38", "32", -+ "FCC", "5G", "40M", "HT", "1T", "46", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "32", -+ "MKK", "5G", "40M", "HT", "1T", "46", "32", -+ "FCC", "5G", "40M", "HT", "1T", "54", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "32", -+ "MKK", "5G", "40M", "HT", "1T", "54", "32", -+ "FCC", "5G", "40M", "HT", "1T", "62", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "32", -+ "MKK", "5G", "40M", "HT", "1T", "62", "32", -+ "FCC", "5G", "40M", "HT", "1T", "102", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "32", -+ "MKK", "5G", "40M", "HT", "1T", "102", "32", -+ "FCC", "5G", "40M", "HT", "1T", "110", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "32", -+ "MKK", "5G", "40M", "HT", "1T", "110", "32", -+ "FCC", "5G", "40M", "HT", "1T", "118", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "32", -+ "MKK", "5G", "40M", "HT", "1T", "118", "32", -+ "FCC", "5G", "40M", "HT", "1T", "126", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "32", -+ "MKK", "5G", "40M", "HT", "1T", "126", "32", -+ "FCC", "5G", "40M", "HT", "1T", "134", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "32", -+ "MKK", "5G", "40M", "HT", "1T", "134", "32", -+ "FCC", "5G", "40M", "HT", "1T", "151", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "32", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "32", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "30", -+ "MKK", "5G", "40M", "HT", "2T", "38", "30", -+ "FCC", "5G", "40M", "HT", "2T", "46", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "30", -+ "MKK", "5G", "40M", "HT", "2T", "46", "30", -+ "FCC", "5G", "40M", "HT", "2T", "54", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "30", -+ "MKK", "5G", "40M", "HT", "2T", "54", "30", -+ "FCC", "5G", "40M", "HT", "2T", "62", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "30", -+ "MKK", "5G", "40M", "HT", "2T", "62", "30", -+ "FCC", "5G", "40M", "HT", "2T", "102", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "30", -+ "MKK", "5G", "40M", "HT", "2T", "102", "30", -+ "FCC", "5G", "40M", "HT", "2T", "110", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "30", -+ "MKK", "5G", "40M", "HT", "2T", "110", "30", -+ "FCC", "5G", "40M", "HT", "2T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "30", -+ "MKK", "5G", "40M", "HT", "2T", "118", "30", -+ "FCC", "5G", "40M", "HT", "2T", "126", "32", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "30", -+ "MKK", "5G", "40M", "HT", "2T", "126", "30", -+ "FCC", "5G", "40M", "HT", "2T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "30", -+ "MKK", "5G", "40M", "HT", "2T", "134", "30", -+ "FCC", "5G", "40M", "HT", "2T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "30", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "30", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "28", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "36", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "32", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+void -+ODM_ReadAndConfig_MP_8812A_TXPWR_LMT( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8812A_TXPWR_LMT)/sizeof(pu1Byte); -+ pu1Byte *Array = Array_MP_8812A_TXPWR_LMT; -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8812A_TXPWR_LMT\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7 ) -+ { -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8812A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+ } -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_RF.h 2018-02-06 17:42:30.704967075 +0200 -@@ -0,0 +1,84 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_MP_RF_HW_IMG_8812A_H -+#define __INC_MP_RF_HW_IMG_8812A_H -+ -+static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_RadioA( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* RadioB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_RadioB( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_AP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_AP( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_PCIE( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_USB( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_USB_RFE3.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TxPowerTrack_USB_RFE3( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8812A_TXPWR_LMT( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.c 2018-02-06 17:42:30.705967090 +0200 -@@ -0,0 +1,1123 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+static bool -+CheckCondition( -+ const u4Byte Condition, -+ const u4Byte Hex -+ ) -+{ -+ u4Byte _board = (Hex & 0x000000FF); -+ u4Byte _interface = (Hex & 0x0000FF00) >> 8; -+ u4Byte _platform = (Hex & 0x00FF0000) >> 16; -+ u4Byte cond = Condition; -+ -+ if ( Condition == 0xCDCDCDCD ) -+ return true; -+ -+ cond = Condition & 0x000000FF; -+ if ( (_board != cond) && (cond != 0xFF) ) -+ return false; -+ -+ cond = Condition & 0x0000FF00; -+ cond = cond >> 8; -+ if ( ((_interface & cond) == 0) && (cond != 0x07) ) -+ return false; -+ -+ cond = Condition & 0x00FF0000; -+ cond = cond >> 16; -+ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) -+ return false; -+ return true; -+} -+ -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+static u4Byte Array_TC_8812A_AGC_TAB[] = { -+ 0xFF0F07D8, 0xABCD, -+ 0x81C, 0xFF000001, -+ 0x81C, 0xFF020001, -+ 0x81C, 0xFF040001, -+ 0x81C, 0xFE060001, -+ 0x81C, 0xFD080001, -+ 0x81C, 0xFC0A0001, -+ 0x81C, 0xFB0C0001, -+ 0x81C, 0xFA0E0001, -+ 0x81C, 0xF9100001, -+ 0x81C, 0xF8120001, -+ 0x81C, 0xF7140001, -+ 0x81C, 0xF6160001, -+ 0x81C, 0xF5180001, -+ 0x81C, 0xF41A0001, -+ 0x81C, 0xF31C0001, -+ 0x81C, 0xF21E0001, -+ 0x81C, 0xF1200001, -+ 0x81C, 0xF0220001, -+ 0x81C, 0xEF240001, -+ 0x81C, 0xEE260001, -+ 0x81C, 0xED280001, -+ 0x81C, 0xEC2A0001, -+ 0x81C, 0xEB2C0001, -+ 0x81C, 0xEA2E0001, -+ 0x81C, 0xE9300001, -+ 0x81C, 0xE8320001, -+ 0x81C, 0xC7340001, -+ 0x81C, 0xC6360001, -+ 0x81C, 0xC5380001, -+ 0x81C, 0xC43A0001, -+ 0x81C, 0xC33C0001, -+ 0x81C, 0xC23E0001, -+ 0x81C, 0xC1400001, -+ 0x81C, 0xA6420001, -+ 0x81C, 0xA5440001, -+ 0x81C, 0xA4460001, -+ 0x81C, 0x69480001, -+ 0x81C, 0x684A0001, -+ 0x81C, 0x674C0001, -+ 0x81C, 0x664E0001, -+ 0x81C, 0x65500001, -+ 0x81C, 0x64520001, -+ 0x81C, 0x63540001, -+ 0x81C, 0x62560001, -+ 0x81C, 0x48580001, -+ 0x81C, 0x475A0001, -+ 0x81C, 0x465C0001, -+ 0x81C, 0x455E0001, -+ 0x81C, 0x44600001, -+ 0x81C, 0x43620001, -+ 0x81C, 0x42640001, -+ 0x81C, 0x41660001, -+ 0x81C, 0x41680001, -+ 0x81C, 0x416A0001, -+ 0x81C, 0x416C0001, -+ 0x81C, 0x416E0001, -+ 0x81C, 0x41700001, -+ 0x81C, 0x41720001, -+ 0x81C, 0x41740001, -+ 0x81C, 0x41760001, -+ 0x81C, 0x41780001, -+ 0x81C, 0x417A0001, -+ 0x81C, 0x417C0001, -+ 0x81C, 0x417E0001, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x81C, 0xFF000001, -+ 0x81C, 0xFF020001, -+ 0x81C, 0xFF040001, -+ 0x81C, 0xFF060001, -+ 0x81C, 0xFF080001, -+ 0x81C, 0xFE0A0001, -+ 0x81C, 0xFD0C0001, -+ 0x81C, 0xFC0E0001, -+ 0x81C, 0xFB100001, -+ 0x81C, 0xFA120001, -+ 0x81C, 0xF9140001, -+ 0x81C, 0xF8160001, -+ 0x81C, 0xF7180001, -+ 0x81C, 0xF61A0001, -+ 0x81C, 0xF51C0001, -+ 0x81C, 0xF41E0001, -+ 0x81C, 0xF3200001, -+ 0x81C, 0xF2220001, -+ 0x81C, 0xF1240001, -+ 0x81C, 0xF0260001, -+ 0x81C, 0xEF280001, -+ 0x81C, 0xEE2A0001, -+ 0x81C, 0xED2C0001, -+ 0x81C, 0xEC2E0001, -+ 0x81C, 0xEB300001, -+ 0x81C, 0xEA320001, -+ 0x81C, 0xE9340001, -+ 0x81C, 0xE8360001, -+ 0x81C, 0xE7380001, -+ 0x81C, 0xE63A0001, -+ 0x81C, 0xE53C0001, -+ 0x81C, 0xC73E0001, -+ 0x81C, 0xC6400001, -+ 0x81C, 0xC5420001, -+ 0x81C, 0xC4440001, -+ 0x81C, 0xC3460001, -+ 0x81C, 0xC2480001, -+ 0x81C, 0xC14A0001, -+ 0x81C, 0xA74C0001, -+ 0x81C, 0xA64E0001, -+ 0x81C, 0xA5500001, -+ 0x81C, 0xA4520001, -+ 0x81C, 0xA3540001, -+ 0x81C, 0xA2560001, -+ 0x81C, 0xA1580001, -+ 0x81C, 0x675A0001, -+ 0x81C, 0x665C0001, -+ 0x81C, 0x655E0001, -+ 0x81C, 0x64600001, -+ 0x81C, 0x63620001, -+ 0x81C, 0x48640001, -+ 0x81C, 0x47660001, -+ 0x81C, 0x46680001, -+ 0x81C, 0x456A0001, -+ 0x81C, 0x446C0001, -+ 0x81C, 0x436E0001, -+ 0x81C, 0x42700001, -+ 0x81C, 0x41720001, -+ 0x81C, 0x41740001, -+ 0x81C, 0x41760001, -+ 0x81C, 0x41780001, -+ 0x81C, 0x417A0001, -+ 0x81C, 0x417C0001, -+ 0x81C, 0x417E0001, -+ 0xFF0F07D8, 0xDEAD, -+ 0xFF0F0780, 0xABCD, -+ 0x81C, 0xFC800001, -+ 0x81C, 0xFB820001, -+ 0x81C, 0xFA840001, -+ 0x81C, 0xF9860001, -+ 0x81C, 0xF8880001, -+ 0x81C, 0xF78A0001, -+ 0x81C, 0xF68C0001, -+ 0x81C, 0xF58E0001, -+ 0x81C, 0xF4900001, -+ 0x81C, 0xF3920001, -+ 0x81C, 0xF2940001, -+ 0x81C, 0xF1960001, -+ 0x81C, 0xF0980001, -+ 0x81C, 0xEF9A0001, -+ 0x81C, 0xEE9C0001, -+ 0x81C, 0xED9E0001, -+ 0x81C, 0xECA00001, -+ 0x81C, 0xEBA20001, -+ 0x81C, 0xEAA40001, -+ 0x81C, 0xE9A60001, -+ 0x81C, 0xE8A80001, -+ 0x81C, 0xE7AA0001, -+ 0x81C, 0xE6AC0001, -+ 0x81C, 0xE5AE0001, -+ 0x81C, 0xE4B00001, -+ 0x81C, 0xE3B20001, -+ 0x81C, 0xA8B40001, -+ 0x81C, 0xA7B60001, -+ 0x81C, 0xA6B80001, -+ 0x81C, 0xA5BA0001, -+ 0x81C, 0xA4BC0001, -+ 0x81C, 0xA3BE0001, -+ 0x81C, 0xA2C00001, -+ 0x81C, 0xA1C20001, -+ 0x81C, 0x68C40001, -+ 0x81C, 0x67C60001, -+ 0x81C, 0x66C80001, -+ 0x81C, 0x65CA0001, -+ 0x81C, 0x47CC0001, -+ 0x81C, 0x46CE0001, -+ 0x81C, 0x45D00001, -+ 0x81C, 0x44D20001, -+ 0x81C, 0x43D40001, -+ 0x81C, 0x42D60001, -+ 0x81C, 0x08D80001, -+ 0x81C, 0x07DA0001, -+ 0x81C, 0x06DC0001, -+ 0x81C, 0x05DE0001, -+ 0x81C, 0x04E00001, -+ 0x81C, 0x03E20001, -+ 0x81C, 0x02E40001, -+ 0x81C, 0x01E60001, -+ 0x81C, 0x01E80001, -+ 0x81C, 0x01EA0001, -+ 0x81C, 0x01EC0001, -+ 0x81C, 0x01EE0001, -+ 0x81C, 0x01F00001, -+ 0x81C, 0x01F20001, -+ 0x81C, 0x01F40001, -+ 0x81C, 0x01F60001, -+ 0x81C, 0x01F80001, -+ 0x81C, 0x01FA0001, -+ 0x81C, 0x01FC0001, -+ 0x81C, 0x01FE0001, -+ 0xFF0F07C0, 0xCDEF, -+ 0x81C, 0xFC800001, -+ 0x81C, 0xFB820001, -+ 0x81C, 0xFA840001, -+ 0x81C, 0xF9860001, -+ 0x81C, 0xF8880001, -+ 0x81C, 0xF78A0001, -+ 0x81C, 0xF68C0001, -+ 0x81C, 0xF58E0001, -+ 0x81C, 0xF4900001, -+ 0x81C, 0xF3920001, -+ 0x81C, 0xF2940001, -+ 0x81C, 0xF1960001, -+ 0x81C, 0xF0980001, -+ 0x81C, 0xEF9A0001, -+ 0x81C, 0xEE9C0001, -+ 0x81C, 0xED9E0001, -+ 0x81C, 0xECA00001, -+ 0x81C, 0xEBA20001, -+ 0x81C, 0xEAA40001, -+ 0x81C, 0xE9A60001, -+ 0x81C, 0xE8A80001, -+ 0x81C, 0xE7AA0001, -+ 0x81C, 0xE6AC0001, -+ 0x81C, 0xE5AE0001, -+ 0x81C, 0xE4B00001, -+ 0x81C, 0xE3B20001, -+ 0x81C, 0xA8B40001, -+ 0x81C, 0xA7B60001, -+ 0x81C, 0xA6B80001, -+ 0x81C, 0xA5BA0001, -+ 0x81C, 0xA4BC0001, -+ 0x81C, 0xA3BE0001, -+ 0x81C, 0xA2C00001, -+ 0x81C, 0xA1C20001, -+ 0x81C, 0x68C40001, -+ 0x81C, 0x67C60001, -+ 0x81C, 0x66C80001, -+ 0x81C, 0x65CA0001, -+ 0x81C, 0x47CC0001, -+ 0x81C, 0x46CE0001, -+ 0x81C, 0x45D00001, -+ 0x81C, 0x44D20001, -+ 0x81C, 0x43D40001, -+ 0x81C, 0x42D60001, -+ 0x81C, 0x08D80001, -+ 0x81C, 0x07DA0001, -+ 0x81C, 0x06DC0001, -+ 0x81C, 0x05DE0001, -+ 0x81C, 0x04E00001, -+ 0x81C, 0x03E20001, -+ 0x81C, 0x02E40001, -+ 0x81C, 0x01E60001, -+ 0x81C, 0x01E80001, -+ 0x81C, 0x01EA0001, -+ 0x81C, 0x01EC0001, -+ 0x81C, 0x01EE0001, -+ 0x81C, 0x01F00001, -+ 0x81C, 0x01F20001, -+ 0x81C, 0x01F40001, -+ 0x81C, 0x01F60001, -+ 0x81C, 0x01F80001, -+ 0x81C, 0x01FA0001, -+ 0x81C, 0x01FC0001, -+ 0x81C, 0x01FE0001, -+ 0xFF0F07D8, 0xCDEF, -+ 0x81C, 0xFC800001, -+ 0x81C, 0xFB820001, -+ 0x81C, 0xFA840001, -+ 0x81C, 0xF9860001, -+ 0x81C, 0xF8880001, -+ 0x81C, 0xF78A0001, -+ 0x81C, 0xF68C0001, -+ 0x81C, 0xF58E0001, -+ 0x81C, 0xF4900001, -+ 0x81C, 0xF3920001, -+ 0x81C, 0xF2940001, -+ 0x81C, 0xF1960001, -+ 0x81C, 0xF0980001, -+ 0x81C, 0xEF9A0001, -+ 0x81C, 0xEE9C0001, -+ 0x81C, 0xED9E0001, -+ 0x81C, 0xECA00001, -+ 0x81C, 0xEBA20001, -+ 0x81C, 0xEAA40001, -+ 0x81C, 0xE9A60001, -+ 0x81C, 0xE8A80001, -+ 0x81C, 0xE7AA0001, -+ 0x81C, 0xE6AC0001, -+ 0x81C, 0xE5AE0001, -+ 0x81C, 0xE4B00001, -+ 0x81C, 0xE3B20001, -+ 0x81C, 0xA8B40001, -+ 0x81C, 0xA7B60001, -+ 0x81C, 0xA6B80001, -+ 0x81C, 0xA5BA0001, -+ 0x81C, 0xA4BC0001, -+ 0x81C, 0xA3BE0001, -+ 0x81C, 0xA2C00001, -+ 0x81C, 0xA1C20001, -+ 0x81C, 0x68C40001, -+ 0x81C, 0x67C60001, -+ 0x81C, 0x66C80001, -+ 0x81C, 0x65CA0001, -+ 0x81C, 0x47CC0001, -+ 0x81C, 0x46CE0001, -+ 0x81C, 0x45D00001, -+ 0x81C, 0x44D20001, -+ 0x81C, 0x43D40001, -+ 0x81C, 0x42D60001, -+ 0x81C, 0x08D80001, -+ 0x81C, 0x07DA0001, -+ 0x81C, 0x06DC0001, -+ 0x81C, 0x05DE0001, -+ 0x81C, 0x04E00001, -+ 0x81C, 0x03E20001, -+ 0x81C, 0x02E40001, -+ 0x81C, 0x01E60001, -+ 0x81C, 0x01E80001, -+ 0x81C, 0x01EA0001, -+ 0x81C, 0x01EC0001, -+ 0x81C, 0x01EE0001, -+ 0x81C, 0x01F00001, -+ 0x81C, 0x01F20001, -+ 0x81C, 0x01F40001, -+ 0x81C, 0x01F60001, -+ 0x81C, 0x01F80001, -+ 0x81C, 0x01FA0001, -+ 0x81C, 0x01FC0001, -+ 0x81C, 0x01FE0001, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x81C, 0xFF800001, -+ 0x81C, 0xFF820001, -+ 0x81C, 0xFF840001, -+ 0x81C, 0xFE860001, -+ 0x81C, 0xFD880001, -+ 0x81C, 0xFC8A0001, -+ 0x81C, 0xFB8C0001, -+ 0x81C, 0xFA8E0001, -+ 0x81C, 0xF9900001, -+ 0x81C, 0xF8920001, -+ 0x81C, 0xF7940001, -+ 0x81C, 0xF6960001, -+ 0x81C, 0xF5980001, -+ 0x81C, 0xF49A0001, -+ 0x81C, 0xF39C0001, -+ 0x81C, 0xF29E0001, -+ 0x81C, 0xF1A00001, -+ 0x81C, 0xF0A20001, -+ 0x81C, 0xEFA40001, -+ 0x81C, 0xEEA60001, -+ 0x81C, 0xEDA80001, -+ 0x81C, 0xECAA0001, -+ 0x81C, 0xEBAC0001, -+ 0x81C, 0xEAAE0001, -+ 0x81C, 0xE9B00001, -+ 0x81C, 0xE8B20001, -+ 0x81C, 0xE7B40001, -+ 0x81C, 0xE6B60001, -+ 0x81C, 0xE5B80001, -+ 0x81C, 0xE4BA0001, -+ 0x81C, 0xE3BC0001, -+ 0x81C, 0xA8BE0001, -+ 0x81C, 0xA7C00001, -+ 0x81C, 0xA6C20001, -+ 0x81C, 0xA5C40001, -+ 0x81C, 0xA4C60001, -+ 0x81C, 0xA3C80001, -+ 0x81C, 0xA2CA0001, -+ 0x81C, 0xA1CC0001, -+ 0x81C, 0x68CE0001, -+ 0x81C, 0x67D00001, -+ 0x81C, 0x66D20001, -+ 0x81C, 0x65D40001, -+ 0x81C, 0x47D60001, -+ 0x81C, 0x46D80001, -+ 0x81C, 0x45DA0001, -+ 0x81C, 0x44DC0001, -+ 0x81C, 0x43DE0001, -+ 0x81C, 0x42E00001, -+ 0x81C, 0x08E20001, -+ 0x81C, 0x07E40001, -+ 0x81C, 0x06E60001, -+ 0x81C, 0x05E80001, -+ 0x81C, 0x04EA0001, -+ 0x81C, 0x03EC0001, -+ 0x81C, 0x02EE0001, -+ 0x81C, 0x01F00001, -+ 0x81C, 0x01F20001, -+ 0x81C, 0x01F40001, -+ 0x81C, 0x01F60001, -+ 0x81C, 0x01F80001, -+ 0x81C, 0x01FA0001, -+ 0x81C, 0x01FC0001, -+ 0x81C, 0x01FE0001, -+ 0xFF0F0780, 0xDEAD, -+ -+}; -+ -+static void -+ODM_ReadAndConfig_TC_8812A_AGC_TAB( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_TC_8812A_AGC_TAB)/sizeof(u4Byte); -+ pu4Byte Array = Array_TC_8812A_AGC_TAB; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_AGC_TAB, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* AGC_TAB_DIFF.TXT -+******************************************************************************/ -+ -+static u4Byte Array_TC_8812A_AGC_TAB_DIFF_MB[] = { -+ 0x111, 0x47CE0003, -+ 0x81C, 0x46D00001, -+ 0x81C, 0x45D20001, -+ 0x81C, 0x44D40001, -+ 0x81C, 0x43D60001, -+ 0x81C, 0x42D80001, -+ 0x81C, 0x08DA0001, -+ 0x81C, 0x07DC0001, -+ 0x81C, 0x06DE0001, -+ 0x81C, 0x05E00001, -+ 0x81C, 0x04E20001, -+ 0x81C, 0x03E40001, -+ 0x222, 0x02E60001, -+}; -+ -+static u4Byte Array_TC_8812A_AGC_TAB_DIFF_HB[] = { -+ 0x333, 0x47CE0003, -+ 0x81C, 0x46D00001, -+ 0x81C, 0x45D20001, -+ 0x81C, 0x44D40001, -+ 0x81C, 0x43D60001, -+ 0x81C, 0x42D80001, -+ 0x81C, 0x08DA0001, -+ 0x81C, 0x07DC0001, -+ 0x81C, 0x06DE0001, -+ 0x81C, 0x05E00001, -+ 0x81C, 0x04E20001, -+ 0x81C, 0x03E40001, -+ 0x444, 0x02E60001, -+}; -+ -+static u4Byte Array_TC_8812A_AGC_TAB_DIFF_LB[] = { -+ 0x555, 0x08DA0001, -+ 0x81B, 0x07DC0001, -+ 0x81C, 0x06DE0001, -+ 0x666, 0x05E00001, -+ 0xFF0F07D8, 0xABCD, -+ 0x81C, 0xFF000001, -+ 0xFF0F0708, 0xCDEF, -+ 0x81C, 0xFF000002, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x81C, 0xFF000003, -+ 0xFF0F07D8, 0xDEAD, -+ 0x777, 0x08DA0001, -+ 0x81C, 0x07DC0001, -+ 0x81C, 0x06DE0001, -+ 0x888, 0x05E00001, -+}; -+ -+static void -+ODM_ReadAndConfig_TC_8812A_AGC_TAB_DIFF( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Array[], -+ u4Byte ArrayLen -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_AGC_TAB_DIFF, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_AGC_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+static u4Byte Array_TC_8812A_PHY_REG[] = { -+ 0x800, 0x8020D010, -+ 0x804, 0x080112E0, -+ 0x808, 0x0E028233, -+ 0x80C, 0x12131113, -+ 0x810, 0x20101263, -+ 0x814, 0x020C3D10, -+ 0x818, 0x03A00385, -+ 0x820, 0x00000000, -+ 0x824, 0x00030FE0, -+ 0x828, 0x00000000, -+ 0x82C, 0x002083DD, -+ 0x830, 0x2AAA6C86, -+ 0x834, 0x0037A706, -+ 0x838, 0x06C89B44, -+ 0x83C, 0x0000095B, -+ 0x840, 0xC0000001, -+ 0x844, 0x40003CDE, -+ 0x848, 0x6210FF8B, -+ 0x84C, 0x6CFDFFB8, -+ 0x850, 0x28874706, -+ 0x854, 0x0001520C, -+ 0x858, 0x8060E000, -+ 0x85C, 0x74210168, -+ 0x860, 0x6929C321, -+ 0x864, 0x796A7432, -+ 0x868, 0x8CA7A314, -+ 0x86C, 0x338C2878, -+ 0x870, 0x03333333, -+ 0x874, 0x31602C2E, -+ 0x878, 0x00003152, -+ 0x87C, 0x000FC000, -+ 0x8A0, 0x00000013, -+ 0x8A4, 0x7F7F7F7F, -+ 0x8A8, 0xA202033E, -+ 0x8AC, 0x0FF0FA0A, -+ 0x8B0, 0x00000600, -+ 0x8B4, 0x000FC080, -+ 0x8B8, 0x7C0057FF, -+ 0x8BC, 0x8CA520A3, -+ 0x8C0, 0x27F00020, -+ 0x8C4, 0x00000000, -+ 0x8C8, 0x00013169, -+ 0x8CC, 0x08248492, -+ 0x8D0, 0x0000B800, -+ 0x8DC, 0x00000000, -+ 0x8D4, 0x940008A0, -+ 0x8D8, 0x290B1612, -+ 0x8F8, 0x400002C0, -+ 0x8FC, 0x00000000, -+ 0xFF0F07D8, 0xABCD, -+ 0x900, 0x00000701, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x900, 0x00000700, -+ 0xFF0F07D8, 0xDEAD, -+ 0x90C, 0x00000000, -+ 0x910, 0x0000FC00, -+ 0x914, 0x00000404, -+ 0x918, 0x1C1028C0, -+ 0x91C, 0x64B11A1C, -+ 0x920, 0xE0767233, -+ 0x924, 0x055AA500, -+ 0x928, 0x00000004, -+ 0x92C, 0xFFFE0000, -+ 0x930, 0xFFFFFFFE, -+ 0x934, 0x001FFFFF, -+ 0x960, 0x00000000, -+ 0x964, 0x00000000, -+ 0x968, 0x00000000, -+ 0x96C, 0x00000000, -+ 0x970, 0x801FFFFF, -+ 0x978, 0x00000000, -+ 0x97C, 0x00000000, -+ 0x980, 0x00000000, -+ 0x984, 0x00000000, -+ 0x988, 0x00000000, -+ 0x9A4, 0x00000080, -+ 0x9A8, 0x00000000, -+ 0x9AC, 0x00000000, -+ 0x9B0, 0x01081008, -+ 0x9B4, 0x01081008, -+ 0x9B8, 0x01081008, -+ 0x9BC, 0x01081008, -+ 0x9D0, 0x00000000, -+ 0x9D4, 0x00000000, -+ 0x9D8, 0x00000000, -+ 0x9DC, 0x00000000, -+ 0x9E4, 0x00000002, -+ 0x9E8, 0x000002D4, -+ 0xA00, 0x00D047C8, -+ 0xA04, 0x01FF000C, -+ 0xA08, 0x8C8A8300, -+ 0xA0C, 0x2E7F000F, -+ 0xA10, 0x9500BB78, -+ 0xA14, 0x11144028, -+ 0xA18, 0x00881117, -+ 0xA1C, 0x89140F00, -+ 0xA20, 0x1A1B0000, -+ 0xA24, 0x090E1317, -+ 0xA28, 0x00000204, -+ 0xA2C, 0x00910000, -+ 0xA70, 0x101FFF00, -+ 0xA74, 0x00000008, -+ 0xA78, 0x00000900, -+ 0xA7C, 0x225B0606, -+ 0xA80, 0x218075B2, -+ 0xA84, 0x001F8C80, -+ 0xB00, 0x03100200, -+ 0xB04, 0x0000B000, -+ 0xB08, 0xAE0201EB, -+ 0xB0C, 0x01003207, -+ 0xB10, 0x00009807, -+ 0xB14, 0x01000000, -+ 0xB18, 0x00000002, -+ 0xB1C, 0x00000002, -+ 0xB20, 0x0000001F, -+ 0xB24, 0x03020100, -+ 0xB28, 0x07060504, -+ 0xB2C, 0x0B0A0908, -+ 0xB30, 0x0F0E0D0C, -+ 0xB34, 0x13121110, -+ 0xB38, 0x17161514, -+ 0xB3C, 0x0000003A, -+ 0xB40, 0x00000000, -+ 0xB44, 0x00000000, -+ 0xB48, 0x13000032, -+ 0xB4C, 0x48080000, -+ 0xB50, 0x00000000, -+ 0xB54, 0x00000000, -+ 0xB58, 0x00000000, -+ 0xB5C, 0x00000000, -+ 0xC00, 0x00000007, -+ 0xC04, 0x00042020, -+ 0xC08, 0x80410231, -+ 0xC0C, 0x00000000, -+ 0xC10, 0x00000100, -+ 0xC14, 0x01000000, -+ 0xC1C, 0x40000003, -+ 0xC20, 0x12121212, -+ 0xC24, 0x12121212, -+ 0xC28, 0x12121212, -+ 0xC2C, 0x12121212, -+ 0xC30, 0x12121212, -+ 0xC34, 0x12121212, -+ 0xC38, 0x12121212, -+ 0xC3C, 0x12121212, -+ 0xC40, 0x12121212, -+ 0xC44, 0x12121212, -+ 0xC48, 0x12121212, -+ 0xC4C, 0x12121212, -+ 0xC50, 0x00000020, -+ 0xC54, 0x001C1208, -+ 0xC58, 0x30000C1C, -+ 0xC5C, 0x00000058, -+ 0xC60, 0x34344443, -+ 0xC64, 0x07003333, -+ 0xC68, 0x59791979, -+ 0xC6C, 0x59795979, -+ 0xC70, 0x19795979, -+ 0xC74, 0x19795979, -+ 0xC78, 0x19791979, -+ 0xC7C, 0x19791979, -+ 0xC80, 0x19791979, -+ 0xC84, 0x19791979, -+ 0xC94, 0x0100005C, -+ 0xC98, 0x00000000, -+ 0xC9C, 0x00000000, -+ 0xCA0, 0x00000029, -+ 0xCA4, 0x08040201, -+ 0xCA8, 0x80402010, -+ 0xFF0F0740, 0xABCD, -+ 0xCB0, 0x77547717, -+ 0xFF0F07C0, 0xCDEF, -+ 0xCB0, 0x77547717, -+ 0xFF0F07D8, 0xCDEF, -+ 0xCB0, 0x54547710, -+ 0xCDCDCDCD, 0xCDCD, -+ 0xCB0, 0x77547777, -+ 0xFF0F0740, 0xDEAD, -+ 0xCB4, 0x00000077, -+ 0xCB8, 0x00508242, -+ 0xE00, 0x00000007, -+ 0xE04, 0x00042020, -+ 0xE08, 0x80410231, -+ 0xE0C, 0x00000000, -+ 0xE10, 0x00000100, -+ 0xE14, 0x01000000, -+ 0xE1C, 0x40000003, -+ 0xE20, 0x12121212, -+ 0xE24, 0x12121212, -+ 0xE28, 0x12121212, -+ 0xE2C, 0x12121212, -+ 0xE30, 0x12121212, -+ 0xE34, 0x12121212, -+ 0xE38, 0x12121212, -+ 0xE3C, 0x12121212, -+ 0xE40, 0x12121212, -+ 0xE44, 0x12121212, -+ 0xE48, 0x12121212, -+ 0xE4C, 0x12121212, -+ 0xE50, 0x00000020, -+ 0xE54, 0x001C1208, -+ 0xE58, 0x30000C1C, -+ 0xE5C, 0x00000058, -+ 0xE60, 0x34344443, -+ 0xE64, 0x07003333, -+ 0xE68, 0x59791979, -+ 0xE6C, 0x59795979, -+ 0xE70, 0x19795979, -+ 0xE74, 0x19795979, -+ 0xE78, 0x19791979, -+ 0xE7C, 0x19791979, -+ 0xE80, 0x19791979, -+ 0xE84, 0x19791979, -+ 0xE94, 0x0100005C, -+ 0xE98, 0x00000000, -+ 0xE9C, 0x00000000, -+ 0xEA0, 0x00000029, -+ 0xEA4, 0x08040201, -+ 0xEA8, 0x80402010, -+ 0xFF0F0740, 0xABCD, -+ 0xEB0, 0x77547717, -+ 0xFF0F07C0, 0xCDEF, -+ 0xEB0, 0x77547717, -+ 0xFF0F07D8, 0xCDEF, -+ 0xEB0, 0x54547710, -+ 0xCDCDCDCD, 0xCDCD, -+ 0xEB0, 0x77547777, -+ 0xFF0F0740, 0xDEAD, -+ 0xEB4, 0x00000077, -+ 0xEB8, 0x00508242, -+ -+}; -+ -+static void -+ODM_ReadAndConfig_TC_8812A_PHY_REG( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_TC_8812A_PHY_REG)/sizeof(u4Byte); -+ pu4Byte Array = Array_TC_8812A_PHY_REG; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_PHY_REG, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* PHY_REG_MP.TXT -+******************************************************************************/ -+ -+static u4Byte Array_TC_8812A_PHY_REG_MP[] = { -+ 0x800, 0x8020D410, -+ -+}; -+ -+static void -+ODM_ReadAndConfig_TC_8812A_PHY_REG_MP( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_TC_8812A_PHY_REG_MP)/sizeof(u4Byte); -+ pu4Byte Array = Array_TC_8812A_PHY_REG_MP; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_PHY_REG_MP, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_PHY_8812A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+static u4Byte Array_TC_8812A_PHY_REG_PG[] = { -+ 0xC20, 0x00000000, 0x34363840, -+ 0xC24, 0x00000000, 0x42424444, -+ 0xC28, 0x00000000, 0x30323638, -+ 0xC2C, 0x00000000, 0x40424444, -+ 0xC30, 0x00000000, 0x28303236, -+ 0xC34, 0x00000000, 0x38404242, -+ 0xC38, 0x00000000, 0x26283034, -+ 0xE20, 0x00000000, 0x34363840, -+ 0xE24, 0x00000000, 0x42424444, -+ 0xE28, 0x00000000, 0x30323638, -+ 0xE2C, 0x00000000, 0x40424444, -+ 0xE30, 0x00000000, 0x28303236, -+ 0xE34, 0x00000000, 0x38404242, -+ 0xE38, 0x00000000, 0x26283034, -+ 0xC24, 0x00000000, 0x42424444, -+ 0xC28, 0x00000000, 0x30323640, -+ 0xC2C, 0x00000000, 0x40424444, -+ 0xC30, 0x00000000, 0x28303236, -+ 0xC34, 0x00000000, 0x38404242, -+ 0xC38, 0x00000000, 0x26283034, -+ 0xC3C, 0x00000000, 0x40424444, -+ 0xC40, 0x00000000, 0x28303236, -+ 0xC44, 0x00000000, 0x42422426, -+ 0xC48, 0x00000000, 0x30343840, -+ 0xC4C, 0x00000000, 0x22242628, -+ 0xE24, 0x00000000, 0x42424444, -+ 0xE28, 0x00000000, 0x30323640, -+ 0xE2C, 0x00000000, 0x40424444, -+ 0xE30, 0x00000000, 0x28303236, -+ 0xE34, 0x00000000, 0x38404242, -+ 0xE38, 0x00000000, 0x26283034, -+ 0xE3C, 0x00000000, 0x40424444, -+ 0xE40, 0x00000000, 0x28303236, -+ 0xE44, 0x00000000, 0x42422426, -+ 0xE48, 0x00000000, 0x30343840, -+ 0xE4C, 0x00000000, 0x22242628, -+ -+}; -+ -+static void -+ODM_ReadAndConfig_TC_8812A_PHY_REG_PG( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_TC_8812A_PHY_REG_PG)/sizeof(u4Byte); -+ pu4Byte Array = Array_TC_8812A_PHY_REG_PG; -+ -+ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ for (i = 0; i < ArrayLen; i += 3 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ u4Byte v3 = Array[i+2]; -+ -+ // this line is a line of pure_body -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_PHY_REG_PG_8812A(pDM_Odm, v1, v2, v3); -+ continue; -+ } -+ else -+ { // this line is the start of branch -+ if ( !CheckCondition(Array[i], hex) ) -+ { // don't need the hw_body -+ i += 2; // skip the pair of expression -+ v1 = Array[i]; -+ v2 = Array[i+1]; -+ v3 = Array[i+2]; -+ while (v2 != 0xDEAD) -+ { -+ i += 3; -+ v1 = Array[i]; -+ v2 = Array[i+1]; -+ v3 = Array[i+1]; -+ } -+ } -+ } -+ } -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_BB.h 2018-02-06 17:42:30.705967090 +0200 -@@ -0,0 +1,71 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_TC_BB_HW_IMG_8812A_H -+#define __INC_TC_BB_HW_IMG_8812A_H -+ -+static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8812A_AGC_TAB( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* AGC_TAB_DIFF.TXT -+******************************************************************************/ -+ -+extern u4Byte Array_TC_8812A_AGC_TAB_DIFF_MB[26]; -+extern u4Byte Array_TC_8812A_AGC_TAB_DIFF_HB[26]; -+extern u4Byte Array_TC_8812A_AGC_TAB_DIFF_LB[32]; -+void -+ODM_ReadAndConfig_TC_8812A_AGC_TAB_DIFF( -+ IN PDM_ODM_T pDM_Odm, -+ IN u4Byte Array[], -+ IN u4Byte ArrayLen -+); -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8812A_PHY_REG( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* PHY_REG_MP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8812A_PHY_REG_MP( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8812A_PHY_REG_PG( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.c 2018-02-06 17:42:30.706967105 +0200 -@@ -0,0 +1,2552 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+static u1Byte Array_TC_8812A_FW_NIC[] = { -+0x01, 0x95, 0x10, 0x00, 0x0A, 0x00, 0x00, 0x00, 0x12, 0x11, 0x21, 0x12, 0x22, 0x54, 0x00, 0x00, -+0x39, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x49, 0xCC, 0x02, 0x5C, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x5D, 0x75, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x67, 0xEF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x5C, 0xEC, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x67, 0x0C, 0x00, 0x00, -+0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, -+0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, -+0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, -+0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, -+0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, -+0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, -+0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, -+0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, -+0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, -+0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, -+0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, -+0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, -+0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, -+0x30, 0x04, 0x04, 0x04, 0x05, 0x04, 0x04, 0x05, 0x07, 0x07, 0x07, 0x08, 0x0A, 0x02, 0x03, 0x04, -+0x04, 0x06, 0x0A, 0x0B, 0x0D, 0x03, 0x04, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, -+0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x01, 0x02, 0x03, -+0x06, 0x07, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x02, 0x03, 0x04, 0x07, 0x08, 0x0B, 0x0C, 0x0D, 0x0E, -+0x10, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, -+0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, 0x07, 0x09, 0x09, 0x0C, 0x0E, 0x10, -+0x12, 0x04, 0x04, 0x05, 0x05, 0x06, 0x0A, 0x11, 0x13, 0x07, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x11, -+0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, -+0x13, 0x04, 0x08, 0x09, 0x0A, 0x0C, 0x0E, 0x10, 0x12, 0x13, 0x14, 0x04, 0x08, 0x0A, 0x0C, 0x0E, -+0x10, 0x11, 0x13, 0x14, 0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x09, -+0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, 0x25, 0x27, 0x28, 0x00, 0x00, 0x00, -+0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, -+0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, -+0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, -+0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, -+0x04, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00, -+0x18, 0x00, 0x00, 0x00, 0x24, 0x00, 0x00, 0x00, 0x30, 0x00, 0x00, 0x00, 0x48, 0x00, 0x00, 0x00, -+0x60, 0x00, 0x00, 0x00, 0x90, 0x00, 0x00, 0x00, 0xC0, 0x00, 0x00, 0x00, 0xD8, 0x00, 0x00, 0x00, -+0x50, 0x00, 0x00, 0x00, 0x78, 0x00, 0x00, 0x00, 0xA0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, -+0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0x30, 0x00, 0x00, 0x00, -+0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, -+0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, -+0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, -+0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, -+0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, -+0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, -+0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, -+0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x0C, -+0x80, 0x00, 0x00, 0x0F, 0xA0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, -+0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x07, -+0xD0, 0x00, 0x00, 0x0B, 0xB8, 0x00, 0x00, 0x0F, 0xA0, 0x00, 0x00, 0x17, 0x70, 0x00, 0x00, 0x00, -+0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, -+0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, -+0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, -+0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, -+0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x02, 0x00, -+0x02, 0x00, 0x04, 0x00, 0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, -+0x48, 0x00, 0x60, 0x00, 0x6C, 0x00, 0x28, 0x00, 0x3C, 0x00, 0x50, 0x00, 0x64, 0x00, 0xA0, 0x00, -+0xC8, 0x00, 0xF0, 0x01, 0x18, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, -+0x58, 0x03, 0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, -+0x58, 0x03, 0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, -+0x58, 0x03, 0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, -+0x58, 0x03, 0x20, 0x03, 0xE8, 0x06, 0x40, 0x07, 0xD0, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, -+0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0xE8, 0x05, 0xDC, 0x07, 0xD0, 0x0B, 0xB8, 0x00, 0x64, 0x00, -+0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, -+0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, -+0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x02, 0x04, 0x06, 0x08, 0x0A, 0x0C, 0x10, 0x18, 0x20, 0x30, 0x40, -+0x50, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x02, 0x03, 0x03, -+0x04, 0x04, 0x05, 0x05, 0x06, 0x03, 0x03, 0x04, 0x04, 0x05, 0x06, 0x06, 0x07, 0x05, 0x06, 0x06, -+0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x01, 0x01, 0x02, -+0x02, 0x04, 0x04, 0x05, 0x05, 0x06, 0x07, 0x02, 0x02, 0x03, 0x03, 0x05, 0x05, 0x06, 0x06, 0x08, -+0x09, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, -+0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, -+0x08, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x05, 0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, -+0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, -+0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, -+0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, -+0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x20, 0x1E, 0x1C, 0x18, 0x10, 0x18, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x45, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x89, 0xF8, 0xE6, 0xBC, 0x03, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x04, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x04, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x88, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x03, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x89, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x03, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x88, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x88, 0xA6, -+0x81, 0x74, 0x03, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x04, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4A, 0x65, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x03, 0xEF, 0xD3, 0x94, 0x03, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x88, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x03, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x88, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x88, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x4A, 0x65, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x03, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x88, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x45, 0x4D, 0x50, 0x2E, 0x74, 0x89, 0x2F, 0xF8, 0xE6, 0xBF, 0x03, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x88, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x89, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x88, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x03, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x45, 0x4C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, 0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x45, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, -+0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, -+0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, 0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, -+0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, -+0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, -+0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, -+0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, 0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, -+0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, 0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, -+0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, -+0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, -+0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, 0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, -+0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, -+0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, 0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, -+0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, -+0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, -+0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x47, 0xF9, 0x73, 0xC5, -+0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, -+0x83, 0xE0, 0x38, 0xF0, 0x22, 0xBB, 0x01, 0x0A, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, -+0xE0, 0x22, 0x50, 0x06, 0x87, 0xF0, 0x09, 0xE7, 0x19, 0x22, 0xBB, 0xFE, 0x07, 0xE3, 0xF5, 0xF0, -+0x09, 0xE3, 0x19, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0x74, 0x01, 0x93, 0x22, -+0xBB, 0x01, 0x10, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0xE0, 0xF5, 0xF0, -+0xA3, 0xE0, 0x22, 0x50, 0x09, 0xE9, 0x25, 0x82, 0xF8, 0x86, 0xF0, 0x08, 0xE6, 0x22, 0xBB, 0xFE, -+0x0A, 0xE9, 0x25, 0x82, 0xF8, 0xE2, 0xF5, 0xF0, 0x08, 0xE2, 0x22, 0xE5, 0x83, 0x2A, 0xF5, 0x83, -+0xE9, 0x93, 0xF5, 0xF0, 0xA3, 0xE9, 0x93, 0x22, 0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, -+0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, -+0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xEB, -+0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, 0xF0, 0x22, -+0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE4, 0x93, 0xFC, 0x74, -+0x01, 0x93, 0xFD, 0x74, 0x02, 0x93, 0xFE, 0x74, 0x03, 0x93, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, -+0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE4, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF9, 0x74, -+0x02, 0x93, 0xFA, 0x74, 0x03, 0x93, 0xFB, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, -+0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, -+0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, -+0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, -+0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x02, 0x4A, 0x0A, 0x02, -+0x45, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, -+0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, -+0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, -+0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4A, 0x4F, 0xE4, 0x7E, 0x01, -+0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, -+0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, -+0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, -+0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x00, -+0x41, 0xA5, 0x86, 0x00, 0x41, 0xA5, 0x87, 0x00, 0x41, 0xA5, 0x88, 0x00, 0x42, 0xA5, 0x97, 0x00, -+0x00, 0x41, 0xA5, 0x9C, 0x00, 0x4B, 0x71, 0x4F, 0xF7, 0x58, 0x17, 0x59, 0x61, 0x90, 0x00, 0xF0, -+0xE0, 0x7F, 0x01, 0x20, 0xE2, 0x02, 0x7F, 0x03, 0x22, 0x51, 0x6D, 0x90, 0xA3, 0x14, 0xEF, 0xF0, -+0x51, 0x8B, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, 0x95, 0x71, 0x10, 0x71, 0x40, 0x51, -+0xAD, 0x51, 0xCC, 0x51, 0xEB, 0xE4, 0xF5, 0x51, 0x75, 0x52, 0x58, 0xAB, 0x51, 0x7D, 0x02, 0x7F, -+0x01, 0x12, 0x39, 0x04, 0xAB, 0x52, 0x7D, 0x03, 0x7F, 0x01, 0x02, 0x39, 0x04, 0x75, 0x5D, 0x12, -+0xE4, 0xF5, 0x5E, 0x75, 0x5F, 0x07, 0x75, 0x60, 0x72, 0x90, 0x01, 0x30, 0xE5, 0x5D, 0xF0, 0xA3, -+0xE5, 0x5E, 0xF0, 0xA3, 0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, 0x75, 0x65, 0x0E, 0x75, -+0x66, 0x01, 0x75, 0x67, 0x03, 0x75, 0x68, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x65, 0xF0, 0xA3, 0xE5, -+0x66, 0xF0, 0xA3, 0xE5, 0x67, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x22, 0xE4, 0xF5, 0x55, 0xF5, 0x56, -+0xF5, 0x57, 0xF5, 0x58, 0xAD, 0x55, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xAD, 0x56, 0x7F, 0x51, 0x12, -+0x3A, 0x96, 0xAD, 0x57, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xAD, 0x58, 0x7F, 0x53, 0x02, 0x3A, 0x96, -+0x90, 0x01, 0x30, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x38, 0xF0, 0xA3, -+0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x51, 0x12, -+0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x53, 0x02, 0x3A, 0x96, -+0x90, 0x01, 0x34, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x3C, 0xF0, -+0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x55, -+0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x3A, -+0x96, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, 0x71, 0xFA, 0x12, -+0x3A, 0xB8, 0xF1, 0xC7, 0x7F, 0x01, 0x12, 0x46, 0x15, 0x90, 0xA4, 0x52, 0x74, 0x02, 0xF0, 0xFF, -+0x12, 0x46, 0x15, 0x90, 0xA4, 0x52, 0xE0, 0x04, 0xF0, 0x7F, 0x03, 0x12, 0x46, 0x15, 0x90, 0xA4, -+0x52, 0xE0, 0x04, 0xF0, 0x51, 0x79, 0x71, 0xC3, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, -+0x80, 0x12, 0x3A, 0x96, 0x75, 0x28, 0xFF, 0x71, 0xEB, 0x12, 0x6F, 0xE9, 0x91, 0x02, 0xE4, 0xFF, -+0x02, 0x46, 0x9E, 0x71, 0xE5, 0x71, 0xF2, 0x12, 0x7A, 0x9E, 0x12, 0x8D, 0xAD, 0x12, 0x91, 0xEC, -+0x91, 0x0C, 0x90, 0xA4, 0x56, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, -+0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xE4, 0x90, 0xA3, 0xB6, 0xF0, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, -+0x85, 0x22, 0xE4, 0x90, 0xA3, 0xB0, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, -+0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x0A, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0xA4, 0x53, 0xE0, -+0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x71, 0xD2, -+0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0xA4, 0x56, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, -+0xC3, 0x13, 0x30, 0xE0, 0x14, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x57, 0xF0, 0x90, -+0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x58, 0xF0, 0x22, 0x90, 0xA4, 0x8D, 0x31, 0x9D, 0xEF, -+0x31, 0xA6, 0x4C, 0x7A, 0x00, 0x4C, 0x82, 0x01, 0x4C, 0x8A, 0x03, 0x4C, 0x91, 0x04, 0x4C, 0x98, -+0x20, 0x4C, 0xA0, 0x21, 0x4C, 0xA8, 0x23, 0x4C, 0xAF, 0x25, 0x4C, 0xB6, 0x40, 0x4C, 0xC4, 0x42, -+0x4C, 0xCC, 0x43, 0x4C, 0xD4, 0x87, 0x00, 0x00, 0x4C, 0xDB, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0x02, -+0x68, 0x20, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0x02, 0x55, 0xAC, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0xE1, -+0xA7, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0x80, 0x86, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0x02, 0x68, 0x68, -+0x90, 0xA4, 0x8D, 0x31, 0x94, 0x02, 0x69, 0x54, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0xE1, 0x8F, 0x90, -+0xA4, 0x8D, 0x31, 0x94, 0xE1, 0x97, 0x90, 0xA4, 0x74, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x8D, 0x31, -+0x94, 0x02, 0x8B, 0x5E, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0x02, 0x8C, 0x5D, 0x90, 0xA4, 0x8D, 0x31, -+0x94, 0x12, 0x6A, 0x04, 0x90, 0xA4, 0x8D, 0x31, 0x94, 0x80, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, -+0x01, 0xF0, 0x22, 0x90, 0xA4, 0x90, 0x31, 0x9D, 0x12, 0x26, 0x1E, 0xFF, 0xB1, 0x14, 0x90, 0xA4, -+0x93, 0x74, 0x10, 0xF0, 0x90, 0xA4, 0xA1, 0x74, 0x07, 0xF0, 0x90, 0xA4, 0x90, 0x31, 0x94, 0x12, -+0x26, 0x1E, 0x90, 0xA4, 0x95, 0xF0, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x93, 0x12, 0x69, 0x9A, 0x7F, -+0x03, 0x02, 0x47, 0x27, 0x90, 0xA4, 0xA2, 0xEF, 0xF0, 0x12, 0x8F, 0xAE, 0x90, 0xA4, 0xA2, 0xE0, -+0xC3, 0x94, 0x0E, 0x50, 0x44, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, -+0xA4, 0xAC, 0x12, 0x27, 0x54, 0x12, 0xD4, 0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0xF1, 0x4C, 0x90, -+0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0xE4, 0xFC, -+0xFD, 0xFE, 0xD1, 0xD2, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0xA4, -+0xA2, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0xC1, 0xC1, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x24, -+0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x30, 0x50, 0x16, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x1F, -+0xFE, 0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x09, 0x28, 0x00, 0x00, 0x80, 0x70, 0x90, -+0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x32, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, 0x50, 0x16, 0x90, -+0xA4, 0xA8, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x08, -+0xA6, 0x00, 0x00, 0x80, 0x4A, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x1B, -+0xEF, 0x94, 0x74, 0x50, 0x16, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, -+0xA4, 0xAC, 0x12, 0x27, 0x54, 0x08, 0xA4, 0x00, 0x00, 0x80, 0x24, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, -+0x74, 0x76, 0xD3, 0x9F, 0x50, 0x1F, 0xEF, 0x94, 0xA5, 0x50, 0x1A, 0x90, 0xA4, 0xA8, 0x12, 0x27, -+0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x08, 0x24, 0x00, 0x00, 0x7F, -+0x60, 0x7E, 0x08, 0xF1, 0x4C, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, 0x37, -+0xEF, 0x94, 0x40, 0x50, 0x32, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, -+0xA4, 0xA2, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0x74, 0x01, 0xFE, 0x0D, 0x14, 0xD1, 0xD2, 0x90, 0xA4, -+0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, -+0x74, 0x01, 0xFE, 0x0D, 0x14, 0x80, 0x7A, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, -+0x50, 0x37, 0xEF, 0x94, 0x8C, 0x50, 0x32, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, -+0xFF, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0xE4, 0xFC, 0x74, 0x01, 0xFE, 0x74, 0x03, 0xD1, 0xD0, 0x90, -+0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0xE4, 0xFC, -+0x74, 0x01, 0xFE, 0x74, 0x03, 0xFD, 0xE4, 0x80, 0x38, 0x90, 0xA4, 0xA2, 0xE0, 0xFB, 0x74, 0x8C, -+0xC3, 0x9B, 0x50, 0x3B, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0xAF, 0x03, -+0xE4, 0xFC, 0x74, 0x01, 0xFE, 0x74, 0x05, 0xD1, 0xD0, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, -+0x07, 0x03, 0xFF, 0x90, 0xA4, 0xA2, 0xE0, 0xFF, 0xE4, 0xFC, 0x74, 0x01, 0xFE, 0x74, 0x05, 0xFD, -+0xE4, 0x90, 0xA4, 0xAA, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0xD1, 0xDE, 0x22, -+0xFD, 0xE4, 0x90, 0xA4, 0xAA, 0x12, 0x27, 0x48, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x90, 0xA4, -+0xA4, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA4, 0xA3, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, -+0x3A, 0xA9, 0x90, 0xA4, 0xAE, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xA6, 0x31, 0x50, 0x12, 0x27, 0x15, -+0x90, 0xA4, 0xAE, 0x31, 0x6C, 0x31, 0x25, 0x90, 0xA4, 0xAA, 0x31, 0x6C, 0x31, 0x32, 0x90, 0xA4, -+0xB2, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xA4, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0xA4, 0xB2, 0x31, -+0x50, 0x90, 0xAC, 0x96, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xA3, 0xE0, 0xFF, 0xD0, 0x05, 0x02, 0x39, -+0xBA, 0x90, 0xA5, 0x9B, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xFF, 0xAE, 0xF0, 0xEE, 0x33, 0x95, 0xE0, -+0xFD, 0xFC, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x48, 0x7F, 0xAC, 0x7E, 0x08, 0x90, 0xA4, 0xA6, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x36, 0xCE, 0x90, 0xA4, 0xB0, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xA8, -+0x31, 0x50, 0x12, 0x27, 0x15, 0x90, 0xA4, 0xB0, 0x31, 0x6C, 0x31, 0x25, 0x90, 0xA4, 0xAC, 0x31, -+0x6C, 0x31, 0x32, 0x90, 0xA4, 0xB4, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xB4, 0x31, 0x50, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x48, 0x90, 0xA4, 0xA6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x02, 0x37, 0x5D, 0x12, -+0x26, 0x1E, 0x90, 0xA4, 0x43, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0xA4, 0x51, 0xF0, 0x90, 0xA4, -+0x51, 0xE0, 0x90, 0x01, 0xE7, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0xA4, -+0x53, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, 0x00, 0x01, 0x12, -+0x26, 0x37, 0x90, 0xA4, 0x54, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, -+0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, -+0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, -+0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0xA4, 0x7E, 0xF0, 0x90, 0xA4, 0x7E, 0xE0, -+0x64, 0x01, 0xF0, 0x24, 0xF7, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x4F, 0xA3, 0xF0, 0x12, 0x3A, 0xEB, -+0xBF, 0x01, 0x03, 0x12, 0x31, 0x69, 0x90, 0xA4, 0x3C, 0xE0, 0xFF, 0x90, 0xA4, 0x3B, 0xE0, 0x6F, -+0x60, 0x02, 0x11, 0x44, 0x12, 0x70, 0x3F, 0xBF, 0x01, 0x03, 0x12, 0x7A, 0x5B, 0x90, 0xA4, 0x3C, -+0xE0, 0x90, 0x01, 0xBC, 0xF0, 0x90, 0xA3, 0xB6, 0xE0, 0x90, 0x01, 0xBD, 0xF0, 0xB1, 0x3F, 0x12, -+0x45, 0x4D, 0x80, 0xB8, 0x90, 0xA4, 0x3B, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x04, 0x7D, 0x01, 0x7F, -+0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x99, 0xED, 0xF0, 0x90, 0xA4, 0x3C, -+0xE0, 0x90, 0xA5, 0x9A, 0xF0, 0x90, 0xA4, 0x36, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, -+0xE0, 0x02, 0x21, 0xA2, 0xEE, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x02, 0x21, 0xA2, -+0x90, 0xA5, 0x9A, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x21, 0xA2, 0xEF, 0x70, 0x02, 0x21, 0x19, 0x24, -+0xFE, 0x70, 0x02, 0x21, 0x52, 0x24, 0xFE, 0x60, 0x48, 0x24, 0xFC, 0x70, 0x02, 0x21, 0x8D, 0x24, -+0xFC, 0x60, 0x02, 0x21, 0xA2, 0xEE, 0xB4, 0x0E, 0x02, 0x51, 0x22, 0x90, 0xA5, 0x9A, 0xE0, 0x70, -+0x04, 0x7F, 0x01, 0x51, 0x4A, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x06, 0x02, 0x31, 0xFC, 0x90, 0xA5, -+0x9A, 0xE0, 0xB4, 0x04, 0x0E, 0x90, 0xA5, 0x99, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x76, 0xB1, 0x80, -+0x02, 0xB1, 0x99, 0x90, 0xA5, 0x9A, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x21, 0xA2, 0x71, 0x0B, 0x21, -+0xA2, 0x90, 0xA5, 0x9A, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, 0x4A, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, -+0x06, 0x02, 0x31, 0xFC, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x0E, 0x07, 0x31, 0xA7, 0xBF, 0x01, 0x02, -+0x51, 0x22, 0x90, 0xA5, 0x9A, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x21, 0xA2, 0x31, 0xA7, 0xEF, 0x64, -+0x01, 0x60, 0x02, 0x21, 0xA2, 0x51, 0x63, 0x21, 0xA2, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x0E, 0x07, -+0x31, 0xA7, 0xBF, 0x01, 0x02, 0x51, 0x22, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x06, 0x02, 0x31, 0xFC, -+0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x0C, 0x07, 0x31, 0xA7, 0xBF, 0x01, 0x02, 0x51, 0x63, 0x90, 0xA5, -+0x9A, 0xE0, 0x64, 0x04, 0x70, 0x5C, 0x12, 0x92, 0xB0, 0xEF, 0x64, 0x01, 0x70, 0x54, 0xB1, 0x23, -+0x80, 0x50, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x0E, 0x07, 0x31, 0xA7, 0xBF, 0x01, 0x02, 0x51, 0x22, -+0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x06, 0x02, 0x31, 0xFC, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x0C, 0x07, -+0x31, 0xA7, 0xBF, 0x01, 0x02, 0x51, 0x63, 0x90, 0xA5, 0x9A, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, -+0x4A, 0x90, 0xA5, 0x9A, 0xE0, 0xB4, 0x04, 0x1A, 0x12, 0x93, 0x30, 0x80, 0x15, 0x90, 0xA5, 0x9A, -+0xE0, 0xB4, 0x0C, 0x0E, 0x90, 0xA4, 0x37, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x02, -+0x71, 0x02, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0xD1, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, -+0xB8, 0x74, 0x01, 0xF0, 0x80, 0x3D, 0x90, 0xA4, 0x36, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x28, 0xEF, 0xC4, 0x54, 0x0F, 0x30, -+0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x19, 0x90, 0xA4, 0x3B, 0xE0, 0xD3, 0x94, -+0x04, 0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, -+0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0xA4, 0x37, 0xE0, -+0x90, 0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA4, 0x3C, 0x74, 0x04, 0xF0, -+0x80, 0x0A, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA4, 0x3C, 0x74, 0x0C, 0xF0, 0x90, 0x05, 0x22, 0xE4, -+0xF0, 0x22, 0x90, 0xA4, 0x37, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0x90, 0xA4, 0x3C, 0x74, 0x0C, -+0xF0, 0x80, 0x11, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA4, -+0x3C, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0xA5, 0x9D, 0xEF, 0xF0, 0x71, -+0x14, 0x90, 0xA5, 0x9D, 0xE0, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x3C, 0x74, -+0x04, 0xF0, 0x22, 0x90, 0xA3, 0xB6, 0xE0, 0x64, 0x01, 0x70, 0x2E, 0x90, 0xA4, 0x37, 0xE0, 0x54, -+0xFD, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x7F, 0x01, 0x12, 0x71, 0x5C, 0xBF, 0x01, 0x0E, -+0x90, 0xA4, 0x36, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA4, 0x3C, 0x74, 0x0E, 0xF0, 0x22, 0x90, 0x01, -+0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x64, 0x01, -+0x70, 0x5F, 0x90, 0xA4, 0x38, 0xE0, 0x54, 0x0F, 0x60, 0x4F, 0x90, 0xA4, 0x3C, 0xE0, 0x70, 0x03, -+0xFF, 0x51, 0x4A, 0x90, 0xA4, 0x3C, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xB1, 0x99, 0x90, 0x01, 0x5B, -+0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xF1, 0xD1, 0xEF, 0x64, 0x01, 0x70, 0x32, 0xF5, -+0x3B, 0x90, 0xA4, 0x4C, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, -+0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5B, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x01, -+0xF0, 0x90, 0xA4, 0x36, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0xA4, 0x3C, 0xE0, 0x70, 0x02, 0x11, -+0x4D, 0x22, 0x91, 0x4E, 0x90, 0xA4, 0x3C, 0x74, 0x08, 0xF0, 0x22, 0x71, 0x14, 0x90, 0xA4, 0x3C, -+0x74, 0x0C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0x46, 0x12, 0x49, -+0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xA4, -+0x46, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, -+0x5D, 0x90, 0x00, 0x10, 0xE0, 0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x12, 0x3A, 0x96, 0x90, 0x00, 0x72, -+0xE0, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x3A, 0x96, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, -+0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, -+0x86, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xBF, 0xFF, 0xEC, 0x90, 0xA5, -+0x67, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x67, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, -+0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, -+0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0xA5, 0x67, 0x12, 0x27, 0x48, -+0x90, 0xA5, 0x67, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, -+0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, -+0xA5, 0x67, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x67, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x28, 0x7B, 0x01, -+0x7A, 0xA5, 0x79, 0x6B, 0x91, 0x1B, 0x90, 0xA5, 0x6B, 0xE0, 0x54, 0xE7, 0xFB, 0x7F, 0x01, 0x12, -+0x79, 0x2A, 0x7B, 0x01, 0x7F, 0x01, 0x91, 0x1F, 0x90, 0xA5, 0x6B, 0xE0, 0x54, 0x18, 0x70, 0x06, -+0x90, 0x01, 0xBF, 0xE0, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x08, 0x7F, 0x01, 0xEF, -+0x70, 0x04, 0x7E, 0x01, 0x80, 0x07, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x7E, 0x40, 0x90, 0x00, 0xE2, -+0xED, 0xF0, 0xA3, 0xEE, 0xF0, 0x90, 0x00, 0xE1, 0xE0, 0x12, 0x26, 0x64, 0x90, 0x00, 0xE3, 0xE4, -+0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0x12, 0x76, -+0xF2, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA5, 0x6D, -+0x12, 0x27, 0x48, 0x90, 0xA5, 0x6D, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, -+0x00, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, -+0xFF, 0xEC, 0x90, 0xA5, 0x6D, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x6D, 0x12, 0x49, 0x50, 0x90, 0xAC, -+0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x54, -+0xFE, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0xA5, -+0x6D, 0x12, 0x27, 0x48, 0x90, 0xA5, 0x6D, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, -+0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, -+0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x36, 0xCE, -+0x90, 0xA4, 0x46, 0x12, 0x27, 0x48, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, -+0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, -+0x77, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x14, 0x7B, 0x01, -+0x7A, 0xA5, 0x79, 0x6C, 0x91, 0x1B, 0x90, 0xA5, 0x6C, 0xE0, 0x44, 0x18, 0xFB, 0x7F, 0x01, 0x12, -+0x79, 0x2A, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x12, 0x76, 0xF2, 0x90, 0x01, 0x37, 0x74, -+0x02, 0xF0, 0xFD, 0x7F, 0x03, 0xD1, 0x51, 0x91, 0x4E, 0xE4, 0x90, 0xA4, 0x3C, 0xF0, 0x22, 0x12, -+0x8D, 0x7B, 0x12, 0x8C, 0xBA, 0x12, 0x6B, 0x4C, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, -+0xFF, 0x90, 0xA5, 0x42, 0xF0, 0x90, 0x01, 0xC7, 0xE0, 0x64, 0xAD, 0x70, 0x37, 0xF0, 0x90, 0xA5, -+0x4F, 0x74, 0x0F, 0xF0, 0x90, 0xA5, 0x41, 0x74, 0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0xA5, -+0x42, 0xE0, 0x2F, 0xFE, 0x74, 0x43, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xEE, 0xF0, -+0x0F, 0xEF, 0xB4, 0x0F, 0xE9, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA5, 0x79, -+0x41, 0x12, 0x5A, 0x46, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, -+0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA4, 0x3C, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0xA4, 0x90, 0x12, -+0x49, 0x9D, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xFE, 0x12, 0x26, 0x1E, 0xFD, 0xC3, 0x13, -+0x30, 0xE0, 0x12, 0x90, 0xA4, 0x90, 0x12, 0x49, 0x94, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, -+0xA4, 0x94, 0xF0, 0x80, 0x05, 0x90, 0xA4, 0x94, 0xEF, 0xF0, 0x90, 0xA4, 0x93, 0xEE, 0xF0, 0x90, -+0xA4, 0x94, 0xE0, 0xFE, 0x90, 0xA4, 0x93, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x3A, 0x90, 0xA4, 0x90, -+0x12, 0x49, 0x94, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFE, 0x74, 0xB6, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0xA3, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0xB6, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, -+0x70, 0x05, 0x12, 0x6B, 0x0D, 0x80, 0x08, 0x90, 0xA4, 0x93, 0xE0, 0xFF, 0x12, 0x6A, 0xFC, 0x90, -+0xA4, 0x93, 0xE0, 0x04, 0xF0, 0x80, 0xB8, 0x90, 0xA3, 0xB6, 0xE0, 0x70, 0x23, 0x90, 0xA4, 0x3C, -+0xE0, 0x70, 0x03, 0xFF, 0x51, 0x4A, 0x90, 0xA4, 0x3C, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xB1, 0x99, -+0x90, 0xA4, 0x36, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, -+0x22, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, -+0x7D, 0x78, 0xFF, 0xD1, 0x51, 0x7D, 0x02, 0x7F, 0x03, 0xD1, 0x51, 0x90, 0x06, 0x0A, 0xE0, 0x44, -+0x07, 0xF0, 0x90, 0xA4, 0x44, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0xA3, 0xB6, 0xE0, 0xB4, -+0x01, 0x14, 0x90, 0xA4, 0x37, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA4, 0x3C, 0xE0, 0x20, 0xE2, 0x0D, -+0x7D, 0x01, 0x7F, 0x04, 0x01, 0x51, 0x90, 0xA4, 0x37, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xEF, 0x70, -+0x36, 0x7D, 0x78, 0x7F, 0x02, 0xD1, 0xF3, 0x7D, 0x02, 0x7F, 0x03, 0xD1, 0xF3, 0x7D, 0xC8, 0x7F, -+0x02, 0x12, 0x8C, 0xA2, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x7D, -+0x01, 0x7F, 0x0C, 0x11, 0x51, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x90, -+0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0xC1, 0x66, 0x7D, 0x02, 0x7F, 0x02, 0xD1, 0xF3, 0x7D, -+0x01, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x30, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0xA4, 0x3C, 0xE0, 0x64, -+0x02, 0x60, 0x28, 0xF1, 0x3C, 0x90, 0xA4, 0x37, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, -+0x14, 0x90, 0xA4, 0x3F, 0xE0, 0xFF, 0xA3, 0xE0, 0x6F, 0x70, 0x0A, 0xF1, 0xF3, 0xD1, 0xE9, 0x90, -+0xA4, 0x40, 0xE0, 0x14, 0xF0, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA3, 0xB6, 0xE0, -+0x64, 0x01, 0x60, 0x02, 0xE1, 0xD0, 0x90, 0xA4, 0x39, 0xE0, 0x70, 0x02, 0xE1, 0xD0, 0x90, 0xA4, -+0x38, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0xA4, 0x40, -+0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0xA4, 0x3F, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0xA4, -+0x3F, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0xA4, 0x40, 0xEF, 0xF0, 0x90, 0xA4, 0x37, 0xE0, 0x44, -+0x04, 0xF0, 0xE4, 0x90, 0xA4, 0x42, 0xF0, 0x90, 0xA4, 0x44, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, -+0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA4, 0x3D, 0xE0, 0x54, -+0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x90, 0xA4, 0x38, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, -+0x02, 0x80, 0x03, 0x12, 0x75, 0x9B, 0x90, 0xA4, 0x37, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, -+0xE0, 0x0E, 0x90, 0xA4, 0x3F, 0xE0, 0xFF, 0xA3, 0xE0, 0xB5, 0x07, 0x04, 0xF1, 0xF3, 0xD1, 0xEF, -+0x22, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, -+0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x02, -+0x51, 0x9A, 0x22, 0xEF, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, -+0x7F, 0x03, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x47, 0x4E, -+0x90, 0xA4, 0x82, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0xA4, 0x73, 0xE0, 0x04, 0xF0, 0x11, 0x31, 0x80, -+0xE6, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA4, -+0x83, 0xF0, 0x90, 0xA4, 0x83, 0xE0, 0xFD, 0x70, 0x02, 0x21, 0x5C, 0x90, 0xA5, 0x86, 0xE0, 0xFF, -+0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, 0x55, 0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, -+0xD0, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0x84, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, 0xA4, 0x75, -+0x42, 0x84, 0x75, 0x43, 0x01, 0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x85, 0x12, 0x34, 0x2C, 0x90, 0xA5, -+0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD1, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0x86, 0xF0, -+0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD2, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, -+0x87, 0xF0, 0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD3, 0x12, 0x49, 0x88, 0xE0, -+0x90, 0xA4, 0x88, 0xF0, 0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF0, 0x12, 0x49, -+0x88, 0xE0, 0x90, 0xA4, 0x89, 0xF0, 0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF1, -+0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0x8A, 0xF0, 0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, 0x04, 0x90, -+0x01, 0xF2, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0x8B, 0xF0, 0x90, 0xA5, 0x86, 0xE0, 0x75, 0xF0, -+0x04, 0x90, 0x01, 0xF3, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0x8C, 0xF0, 0x90, 0xA4, 0x83, 0xE0, -+0xFF, 0x90, 0xA5, 0x86, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0xF4, 0x5F, 0x90, 0xA4, 0x83, 0xF0, 0x90, 0xA5, 0x86, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, -+0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0xA4, 0x85, 0xE0, 0xFF, -+0x7B, 0x01, 0x7A, 0xA4, 0x79, 0x86, 0x12, 0x4C, 0x4A, 0x90, 0xA5, 0x86, 0xE0, 0x04, 0xF0, 0xE0, -+0x54, 0x03, 0xF0, 0x01, 0x42, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x47, 0x4E, 0x90, 0xA4, 0xB8, 0xEF, 0xF0, 0x60, -+0xF0, 0x31, 0x75, 0x80, 0xEC, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA3, -+0xB1, 0xE0, 0xFE, 0x90, 0xA3, 0xB0, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, -+0x00, 0xEE, 0x64, 0x01, 0x60, 0x48, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x13, 0xED, 0x75, 0xF0, 0x0F, -+0xA4, 0x24, 0x1A, 0xF9, 0x74, 0xA3, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x31, 0xE3, 0x7F, 0x01, 0x90, -+0xA3, 0xB0, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x1A, 0xF9, 0x74, 0xA3, 0x35, 0xF0, 0xFA, 0x7B, -+0x01, 0x51, 0x46, 0x7F, 0x01, 0xEF, 0x60, 0x16, 0x90, 0xA3, 0xB0, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, -+0x0A, 0x02, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA3, 0xB0, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA4, 0xB9, 0x12, 0x49, 0x9D, -+0x90, 0xA5, 0x88, 0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, 0x7F, 0xAF, -+0x7E, 0x01, 0x51, 0xB9, 0xEF, 0x60, 0x3A, 0x90, 0xA4, 0xB9, 0x12, 0x49, 0x94, 0x8B, 0x40, 0x8A, -+0x41, 0x89, 0x42, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xF5, 0x43, 0x7B, 0x01, 0x7A, -+0x01, 0x79, 0xA0, 0x12, 0x34, 0x2C, 0x90, 0xA4, 0xB9, 0x12, 0x49, 0x94, 0x90, 0x00, 0x0E, 0x12, -+0x26, 0x37, 0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x7E, -+0x12, 0x49, 0x9D, 0x7F, 0x96, 0x7E, 0x02, 0x51, 0xB9, 0xEF, 0x60, 0x58, 0x90, 0x01, 0x17, 0xE0, -+0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, -+0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0xA5, 0x81, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, -+0xA5, 0x81, 0xE0, 0xFD, 0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA5, 0x7E, 0x12, 0x49, -+0x94, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0x71, 0x0F, 0x90, -+0xA5, 0x81, 0xE0, 0x24, 0x18, 0xFF, 0x90, 0xA5, 0x7E, 0x12, 0x49, 0x94, 0x71, 0x6A, 0x90, 0x02, -+0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA5, 0x76, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xA5, 0x76, -+0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x2D, 0xC3, 0x90, 0xA5, 0x79, 0xE0, -+0x94, 0xE8, 0x90, 0xA5, 0x78, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, -+0xF0, 0x7F, 0x00, 0x80, 0x15, 0x90, 0xA5, 0x78, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x48, 0x9F, 0x7F, -+0x0A, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x80, 0xC5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, -+0xFC, 0xED, 0x2C, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE4, 0xF0, 0x0C, 0xEC, -+0xB4, 0x18, 0xEE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0xEE, -+0x54, 0x3F, 0xFF, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, -+0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA5, 0x7A, 0xEF, 0xF0, 0xA3, -+0x12, 0x49, 0x9D, 0x90, 0xA5, 0x87, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, -+0x76, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, -+0x01, 0x90, 0xA5, 0x7B, 0x12, 0x49, 0x94, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, -+0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0xA5, 0x7A, 0xE0, 0x24, 0x02, 0xF9, -+0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x49, 0x94, -+0xE9, 0x24, 0x02, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0xA5, 0x7B, 0x12, -+0x49, 0x94, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, -+0x02, 0x34, 0x2C, 0x90, 0xA5, 0x5B, 0xEF, 0xF0, 0xAB, 0x05, 0x7E, 0x00, 0x7D, 0x00, 0x7C, 0x00, -+0xE4, 0x90, 0xA5, 0x60, 0xF0, 0xEB, 0xFF, 0xE4, 0x90, 0xA5, 0x5C, 0x12, 0x27, 0x48, 0x90, 0xA5, -+0x5C, 0x12, 0x49, 0x50, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x37, -+0x5D, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA5, 0x5B, 0xE0, 0x75, 0xF0, 0x08, 0xA4, -+0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x36, -+0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x71, -+0xE3, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, -+0x05, 0x90, 0xA5, 0x63, 0x12, 0x49, 0x50, 0x90, 0xAC, 0x9C, 0x12, 0x27, 0x48, 0xD0, 0x05, 0xD0, -+0x07, 0x12, 0x32, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, -+0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x69, 0xF0, 0x74, 0x5C, 0xA3, 0xF0, -+0x91, 0xB8, 0x74, 0x69, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x5C, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, -+0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, -+0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x53, 0xE4, 0xFD, -+0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x51, 0x52, 0x53, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x54, 0x7D, -+0x01, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x52, 0x52, 0x54, 0xAB, 0x53, 0xE4, 0xFD, 0x7F, 0x01, -+0x12, 0x39, 0x04, 0xAB, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x02, 0x39, 0x04, 0xC0, 0xE0, 0xC0, 0xF0, -+0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, -+0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xEC, 0xF0, 0x74, -+0x5C, 0xA3, 0xF0, 0xB1, 0x3B, 0x74, 0xEC, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x5C, 0xA3, 0xF0, -+0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x00, 0x54, 0xE0, 0x55, -+0x55, 0xF5, 0x59, 0xA3, 0xE0, 0x55, 0x56, 0xF5, 0x5A, 0xA3, 0xE0, 0x55, 0x57, 0xF5, 0x5B, 0xA3, -+0xE0, 0x55, 0x58, 0xF5, 0x5C, 0xAD, 0x59, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0xAD, 0x5A, 0x7F, 0x55, -+0x12, 0x3A, 0x96, 0xAD, 0x5B, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0xAD, 0x5C, 0x7F, 0x57, 0x12, 0x3A, -+0x96, 0x53, 0x91, 0xEF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -+0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -+0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x75, 0xF0, 0x74, 0x5D, 0xA3, 0xF0, 0x12, 0x70, 0x6A, 0xE5, -+0x61, 0x30, 0xE1, 0x02, 0xD1, 0xE1, 0xE5, 0x61, 0x30, 0xE4, 0x05, 0x7F, 0x02, 0x12, 0x47, 0x27, -+0xE5, 0x63, 0x30, 0xE0, 0x02, 0xD1, 0x2B, 0xE5, 0x63, 0x30, 0xE1, 0x03, 0x12, 0x70, 0xC7, 0xE5, -+0x63, 0x30, 0xE2, 0x03, 0x12, 0x57, 0x0B, 0xE5, 0x63, 0x30, 0xE3, 0x03, 0x12, 0x77, 0x3A, 0xE5, -+0x63, 0x30, 0xE4, 0x03, 0x12, 0x77, 0x6D, 0xE5, 0x63, 0x30, 0xE5, 0x03, 0x12, 0x75, 0x36, 0xE5, -+0x63, 0x30, 0xE6, 0x03, 0x12, 0x77, 0x9C, 0xE5, 0x64, 0x30, 0xE1, 0x03, 0x12, 0x57, 0xEA, 0xE5, -+0x64, 0x30, 0xE4, 0x03, 0x12, 0x74, 0xF3, 0xE5, 0x64, 0x30, 0xE5, 0x02, 0xF1, 0x67, 0xE5, 0x64, -+0x30, 0xE6, 0x02, 0xD1, 0xB8, 0x74, 0x75, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x5D, 0xA3, 0xF0, -+0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, 0xFF, 0x90, 0xA4, 0x39, -+0xE0, 0x70, 0x02, 0xC1, 0xB7, 0x90, 0xA3, 0xB6, 0xE0, 0x64, 0x01, 0x70, 0x7A, 0x90, 0xA4, 0x38, -+0xE0, 0xC4, 0x54, 0x0F, 0x60, 0x24, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1F, 0x90, 0xA4, 0x40, -+0xE0, 0x14, 0xF0, 0xE0, 0xFE, 0x60, 0x06, 0x90, 0xA4, 0x42, 0xE0, 0x60, 0x0F, 0xEE, 0x70, 0x06, -+0x90, 0xA4, 0x3F, 0xE0, 0xA3, 0xF0, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x48, 0x90, -+0xA4, 0x3D, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA4, 0x42, 0xE0, 0x60, 0x03, 0xB4, 0x01, 0x09, 0xE4, -+0xF5, 0x3B, 0x90, 0xA4, 0x42, 0xE0, 0x80, 0x0D, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x42, 0xE0, 0x75, -+0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0xA4, 0x41, 0xE0, 0x2F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, -+0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x3C, -+0xE0, 0x20, 0xE2, 0x03, 0x12, 0x50, 0x4D, 0x22, 0x90, 0x07, 0x1F, 0xE0, 0x54, 0x7F, 0xF0, 0x90, -+0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, 0xA4, 0xBE, 0xF0, 0x90, 0xA4, 0xBC, 0x74, 0x02, 0xF0, 0x90, -+0xA4, 0xCA, 0x14, 0xF0, 0xFB, 0x7A, 0xA4, 0x79, 0xBC, 0x12, 0x69, 0x9A, 0x7F, 0x03, 0x02, 0x47, -+0x27, 0xE4, 0xFF, 0x90, 0xA4, 0xBC, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x11, 0xA3, 0xE0, -+0xF5, 0x12, 0x65, 0x11, 0x60, 0x70, 0x90, 0xA4, 0xBD, 0x74, 0x03, 0xF0, 0x90, 0xA4, 0xCB, 0x74, -+0x08, 0xF0, 0xE5, 0x12, 0x04, 0x54, 0x0F, 0xF5, 0x13, 0xE4, 0xF5, 0x10, 0xE5, 0x13, 0x75, 0xF0, -+0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x10, 0xF5, -+0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0xBF, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, -+0xA4, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x10, 0xE5, 0x10, 0xB4, 0x08, 0xD0, 0x7B, 0x01, 0x7A, 0xA4, -+0x79, 0xBD, 0x12, 0x69, 0x9A, 0xE5, 0x12, 0x04, 0x54, 0x0F, 0xF5, 0x12, 0xB4, 0x0F, 0x03, 0xE4, -+0xF5, 0x12, 0x90, 0x04, 0x7F, 0xE5, 0x12, 0xF0, 0x90, 0xA4, 0xBC, 0xE0, 0x7F, 0x03, 0x70, 0x03, -+0x02, 0x47, 0x27, 0x12, 0x47, 0x27, 0x22, 0x90, 0xA4, 0x70, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x10, -+0x90, 0x04, 0x30, 0xE0, 0xB4, 0x01, 0x06, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0x74, 0xB6, 0x25, -+0x10, 0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, 0x60, 0x6E, 0xE5, 0x10, -+0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0xE5, 0x10, 0x54, 0x07, 0xFE, 0x74, 0x81, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFD, 0xAF, 0x06, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, -+0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x03, 0x02, 0x60, -+0x6E, 0x75, 0xF0, 0x10, 0xE5, 0x10, 0x90, 0x81, 0x01, 0x12, 0x49, 0x88, 0xE0, 0x20, 0xE7, 0x02, -+0x80, 0x10, 0x75, 0xF0, 0x10, 0xE5, 0x10, 0x90, 0x81, 0x02, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x20, -+0xE7, 0x0A, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x20, 0xF0, 0x02, 0x60, 0x6E, 0xEF, 0x30, 0xE6, 0x25, -+0x90, 0xA4, 0x6D, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, -+0x88, 0xE0, 0xFD, 0x75, 0xF0, 0x09, 0xE5, 0x10, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xE0, 0xF5, -+0x23, 0xE4, 0xFB, 0x80, 0x55, 0x90, 0xA4, 0x6E, 0xE0, 0x04, 0xF0, 0x74, 0x94, 0x25, 0x10, 0xF5, -+0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x74, 0x94, 0x25, 0x10, 0xF5, 0x82, 0xE4, -+0x34, 0xA1, 0xF5, 0x83, 0xE0, 0xD3, 0x94, 0x03, 0x40, 0x13, 0xAF, 0x10, 0x11, 0x7B, 0x74, 0x94, -+0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x21, 0x75, 0xF0, 0x10, -+0xE5, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE0, 0xFD, 0x75, 0xF0, 0x09, 0xE5, 0x10, 0x90, -+0x95, 0x96, 0x12, 0x49, 0x88, 0xE0, 0xF5, 0x23, 0x7B, 0x01, 0xAF, 0x10, 0x31, 0x84, 0x05, 0x10, -+0xE5, 0x10, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x5F, 0x70, 0x22, 0xAD, 0x07, 0x90, 0x01, 0xC4, -+0x74, 0x7B, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0x74, 0x94, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, -+0x83, 0xE0, 0x64, 0x13, 0x70, 0x6E, 0x74, 0x14, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, -+0xE0, 0x04, 0xF0, 0x74, 0x14, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0xC3, 0x94, -+0x03, 0x40, 0x51, 0x74, 0x14, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE4, 0xF0, 0x74, -+0x93, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x91, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x93, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, -+0x83, 0xE0, 0x24, 0x1E, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x02, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -+0xD8, 0xF9, 0xFF, 0xED, 0x25, 0xE0, 0x24, 0x14, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xEE, -+0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, 0x81, 0x05, 0x12, 0x49, 0x88, 0xE0, 0x54, -+0x03, 0xFE, 0x75, 0xF0, 0x09, 0xED, 0x90, 0x95, 0x93, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x74, 0x94, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0x54, 0x7F, 0xF5, 0x11, 0xB4, 0x2C, 0x1B, -+0x75, 0xF0, 0x09, 0xED, 0x90, 0x95, 0x97, 0x12, 0x49, 0x88, 0xE0, 0x6E, 0x60, 0x0D, 0x1E, 0x75, -+0xF0, 0x09, 0xED, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0xE5, 0x11, 0xD3, 0x9F, 0x40, -+0x02, 0x8F, 0x11, 0xAF, 0x05, 0x8E, 0x23, 0xE4, 0xFB, 0xAD, 0x11, 0x31, 0x84, 0xAF, 0x11, 0x22, -+0xF5, 0x26, 0x74, 0x14, 0x25, 0x24, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE5, 0x26, 0xF0, -+0x75, 0xF0, 0x09, 0xE5, 0x24, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xE0, 0xF5, 0x23, 0xE4, 0xFB, -+0xAD, 0x26, 0xAF, 0x24, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x20, 0x8D, 0x21, 0xE5, -+0x20, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA5, 0x82, 0xF0, 0xE5, 0x20, 0x54, 0x07, 0x90, 0xA5, -+0x84, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x01, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA5, 0x85, -+0xF0, 0xE5, 0x21, 0xB4, 0x3F, 0x11, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x98, 0x12, 0x49, 0x88, -+0xE0, 0xB4, 0x01, 0x03, 0x75, 0x21, 0xBE, 0xE5, 0x21, 0x54, 0x7F, 0x90, 0xA5, 0x83, 0xF0, 0x75, -+0xF0, 0x09, 0xE5, 0x20, 0x90, 0x95, 0x99, 0x12, 0x49, 0x88, 0xE0, 0x70, 0x40, 0x90, 0xA5, 0x83, -+0xE0, 0xFF, 0xC3, 0x94, 0x14, 0x40, 0x0D, 0xEF, 0xD3, 0x94, 0x16, 0x50, 0x07, 0x90, 0x04, 0x33, -+0x74, 0x08, 0x80, 0x36, 0xEF, 0xC3, 0x94, 0x17, 0x40, 0x15, 0xEF, 0xD3, 0x94, 0x18, 0x50, 0x0F, -+0x90, 0x04, 0x33, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x0A, 0x41, 0x98, 0x90, -+0x04, 0x33, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0xA3, 0x04, 0x80, 0x7B, 0x90, 0xA5, 0x83, -+0xE0, 0xFF, 0xB4, 0x36, 0x0D, 0x90, 0x04, 0x33, 0x74, 0x09, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, -+0x80, 0x66, 0xEF, 0xC3, 0x94, 0x37, 0x40, 0x14, 0xEF, 0xD3, 0x94, 0x38, 0x50, 0x0E, 0x90, 0x04, -+0x33, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xA3, 0x04, 0x80, 0x4C, 0xEF, 0xB4, 0x39, 0x0F, -+0x90, 0x04, 0x33, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x0B, 0x80, 0x39, 0xEF, -+0xB4, 0x3A, 0x12, 0x90, 0x04, 0x33, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0x04, 0xF0, -+0xA3, 0x74, 0x0C, 0x80, 0x26, 0xEF, 0x90, 0x04, 0x33, 0xB4, 0x3B, 0x13, 0x74, 0x01, 0xF0, 0xA3, -+0x74, 0x03, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x0D, 0xF0, 0x80, 0x10, 0x74, -+0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xEB, -+0x70, 0x3F, 0x90, 0x04, 0x30, 0xE0, 0x70, 0x06, 0x90, 0x04, 0xCF, 0x74, 0x30, 0xF0, 0x90, 0xA5, -+0x82, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, -+0xFF, 0x90, 0xA5, 0x84, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0xF4, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA5, 0x85, 0xE0, 0x54, 0x7F, 0xF0, 0x80, -+0x70, 0x90, 0x04, 0x30, 0xE0, 0x70, 0x19, 0x74, 0x13, 0x25, 0x20, 0xF5, 0x82, 0xE4, 0x34, 0x9B, -+0xF5, 0x83, 0xE0, 0x90, 0x04, 0xCF, 0xB4, 0x01, 0x05, 0x74, 0x20, 0xF0, 0x80, 0x02, 0xE4, 0xF0, -+0x90, 0xA5, 0x82, 0xE0, 0x24, 0x81, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xC0, 0x83, 0xC0, -+0x82, 0xE0, 0xFF, 0x90, 0xA5, 0x84, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, -+0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x20, 0x90, 0x81, -+0x01, 0x12, 0x49, 0x88, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0xA5, 0x85, 0xF0, 0x90, 0xA5, 0x83, 0xE0, -+0x90, 0x44, 0x31, 0x93, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x4F, 0x90, 0xA5, 0x85, 0xF0, 0x44, 0x80, -+0xF0, 0x90, 0xA5, 0x83, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x7D, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, -+0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, 0x04, 0xEB, 0x90, -+0x42, 0x2D, 0x12, 0x49, 0x88, 0x12, 0x49, 0x78, 0x12, 0x49, 0x18, 0x78, 0x01, 0x12, 0x27, 0x22, -+0xE5, 0x20, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x20, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x21, 0xF0, -+0x90, 0xA5, 0x85, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x20, 0x90, 0x81, 0x01, 0x12, 0x49, 0x88, -+0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x20, 0x90, 0x81, 0x05, 0x12, 0x49, 0x88, 0xE0, 0x54, 0xFC, -+0x45, 0x23, 0xFF, 0x75, 0xF0, 0x10, 0xE5, 0x20, 0x90, 0x81, 0x05, 0x12, 0x49, 0x88, 0xEF, 0xF0, -+0x7D, 0x01, 0xAF, 0x20, 0xD1, 0x7F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x8F, 0x24, 0x90, 0xA4, 0x72, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, -+0x95, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA5, 0x73, 0xF0, 0x12, 0x49, 0xA6, 0x64, 0x2D, 0x00, 0x64, -+0x2D, 0x01, 0x64, 0x2D, 0x02, 0x64, 0x2D, 0x03, 0x64, 0x2D, 0x04, 0x64, 0x2D, 0x05, 0x64, 0x2D, -+0x06, 0x64, 0x2D, 0x07, 0x64, 0x2D, 0x08, 0x64, 0x8F, 0x09, 0x64, 0x95, 0x0A, 0x64, 0x9B, 0x0B, -+0x64, 0xA1, 0x0C, 0x64, 0xA7, 0x0D, 0x64, 0xAD, 0x0E, 0x00, 0x00, 0x64, 0xB6, 0xE4, 0xF5, 0x25, -+0x75, 0xF0, 0x08, 0xE5, 0x24, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x25, 0x25, 0xF5, -+0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA5, 0x73, 0xE0, 0x75, 0xF0, 0x07, 0xA4, -+0x24, 0x50, 0xF5, 0x82, 0xE4, 0x34, 0x40, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x25, 0xF5, 0x82, 0xE4, -+0x35, 0x83, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0xEF, 0x5E, 0xFF, 0x90, 0xA5, 0x75, 0xF0, 0x75, 0xF0, -+0x08, 0xE5, 0x24, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x25, 0x25, 0xF5, 0x82, 0xE4, -+0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x25, 0xE5, 0x25, 0xB4, 0x07, 0xA3, 0x80, 0x27, 0xAD, -+0x24, 0x7F, 0x44, 0x80, 0x1C, 0xAD, 0x24, 0x7F, 0x4C, 0x80, 0x16, 0xAD, 0x24, 0x7F, 0x8C, 0x80, -+0x10, 0xAD, 0x24, 0x7F, 0x94, 0x80, 0x0A, 0xAD, 0x24, 0x7F, 0x9C, 0x80, 0x04, 0xAD, 0x24, 0x7F, -+0xA4, 0x7E, 0x04, 0x12, 0x7C, 0xA7, 0x75, 0xF0, 0x09, 0xE5, 0x24, 0x90, 0x95, 0x99, 0x12, 0x49, -+0x88, 0xE0, 0xFD, 0xE4, 0x90, 0xA5, 0x71, 0xF0, 0x7C, 0x06, 0x75, 0xF0, 0x08, 0xE5, 0x24, 0x90, -+0x89, 0x00, 0xBC, 0x06, 0x12, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, -+0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x80, 0x0E, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, -+0x35, 0x83, 0xF5, 0x83, 0xE0, 0x90, 0xA5, 0x74, 0xF0, 0x90, 0xA5, 0x74, 0xE0, 0x60, 0x64, 0x75, -+0x25, 0x07, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x25, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -+0xD8, 0xF9, 0xFF, 0x90, 0xA5, 0x74, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x3E, 0xEC, 0x75, 0xF0, 0x08, -+0xA4, 0x25, 0x25, 0x90, 0xA5, 0x71, 0xF0, 0xBD, 0x01, 0x0C, 0xE0, 0xD3, 0x94, 0x0B, 0x40, 0x06, -+0xE0, 0x24, 0x20, 0xF0, 0x80, 0x39, 0xBD, 0x02, 0x0F, 0x90, 0xA5, 0x71, 0xE0, 0xD3, 0x94, 0x1B, -+0x40, 0x06, 0xE0, 0x24, 0x18, 0xF0, 0x80, 0x27, 0xBD, 0x03, 0x24, 0x90, 0xA5, 0x71, 0xE0, 0xD3, -+0x94, 0x1B, 0x40, 0x1B, 0xE0, 0x24, 0x22, 0xF0, 0x80, 0x15, 0x15, 0x25, 0xE5, 0x25, 0xC3, 0x94, -+0x00, 0x50, 0x9F, 0xEC, 0x60, 0x09, 0x1C, 0xEC, 0xC3, 0x94, 0x00, 0x40, 0x02, 0x81, 0xCA, 0xE4, -+0x90, 0xA5, 0x72, 0xF0, 0xFC, 0x75, 0xF0, 0x08, 0xE5, 0x24, 0x90, 0x89, 0x00, 0xBC, 0x06, 0x12, -+0x12, 0x49, 0x88, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x54, 0x0F, -+0x80, 0x0E, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, -+0x90, 0xA5, 0x74, 0xF0, 0x90, 0xA5, 0x74, 0xE0, 0x60, 0x63, 0xE4, 0xF5, 0x25, 0x74, 0x01, 0x7E, -+0x00, 0xA8, 0x25, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0xA5, -+0x74, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x3E, 0xEC, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x25, 0x90, 0xA5, -+0x72, 0xF0, 0xBD, 0x01, 0x0C, 0xE0, 0xD3, 0x94, 0x0B, 0x40, 0x06, 0xE0, 0x24, 0x20, 0xF0, 0x80, -+0x34, 0xBD, 0x02, 0x0F, 0x90, 0xA5, 0x72, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x06, 0xE0, 0x24, 0x18, -+0xF0, 0x80, 0x22, 0xBD, 0x03, 0x1F, 0x90, 0xA5, 0x72, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x16, 0xE0, -+0x24, 0x22, 0xF0, 0x80, 0x10, 0x05, 0x25, 0xE5, 0x25, 0x64, 0x08, 0x70, 0xA0, 0x0C, 0xEC, 0x64, -+0x07, 0x60, 0x02, 0xA1, 0x75, 0x90, 0xA5, 0x71, 0xE0, 0xFF, 0x75, 0xF0, 0x09, 0xE5, 0x24, 0x90, -+0x95, 0x93, 0x12, 0x49, 0x88, 0xEF, 0xF0, 0x90, 0xA5, 0x72, 0xE0, 0xFE, 0x75, 0xF0, 0x09, 0xE5, -+0x24, 0x90, 0x95, 0x94, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x24, 0x90, 0x81, -+0x00, 0x12, 0x49, 0x88, 0xE0, 0xFE, 0x54, 0x7F, 0xF5, 0x26, 0xEE, 0x54, 0x80, 0xF5, 0x27, 0xE5, -+0x26, 0xD3, 0x9F, 0x40, 0x08, 0x90, 0xA5, 0x71, 0xE0, 0x45, 0x27, 0x31, 0x60, 0x90, 0xA5, 0x72, -+0xE0, 0xFF, 0xE5, 0x26, 0xC3, 0x9F, 0x50, 0x05, 0xE5, 0x27, 0x4F, 0x31, 0x60, 0x75, 0xF0, 0x10, -+0xE5, 0x24, 0x90, 0x81, 0x03, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x62, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x01, -+0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, 0x49, -+0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x12, 0x49, 0x88, 0xE4, -+0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x07, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, -+0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, -+0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, -+0x93, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x90, -+0x81, 0x03, 0x12, 0x49, 0x88, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0x75, 0xF0, 0x10, 0xEF, 0x90, -+0x81, 0x03, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, -+0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, -+0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x0C, 0xF0, 0x74, -+0x67, 0xA3, 0xF0, 0x12, 0x70, 0x97, 0xE5, 0x69, 0x30, 0xE1, 0x02, 0xF1, 0x9C, 0xE5, 0x69, 0x30, -+0xE2, 0x03, 0x12, 0x77, 0xB8, 0xE5, 0x69, 0x30, 0xE3, 0x03, 0x12, 0x77, 0xF4, 0xE5, 0x6A, 0x30, -+0xE0, 0x03, 0x12, 0x78, 0x30, 0xE5, 0x6C, 0x30, 0xE1, 0x05, 0x7F, 0x03, 0x12, 0x47, 0x27, 0xE5, -+0x6C, 0x30, 0xE4, 0x02, 0xF1, 0xA6, 0xE5, 0x6C, 0x30, 0xE5, 0x03, 0x12, 0x76, 0x3B, 0xE5, 0x6C, -+0x30, 0xE6, 0x03, 0x12, 0x76, 0x73, 0x74, 0x0C, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x67, 0xA3, -+0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0xA4, 0x39, 0xE0, -+0x60, 0x03, 0x12, 0x93, 0x84, 0x22, 0x12, 0x93, 0x44, 0x90, 0xA4, 0x3F, 0xE0, 0x14, 0x90, 0x05, -+0x73, 0xF0, 0x7D, 0x02, 0x7F, 0x02, 0x12, 0x56, 0x51, 0x90, 0xA4, 0x53, 0xE0, 0x30, 0xE0, 0x2E, -+0x90, 0xA3, 0xB6, 0xE0, 0xB4, 0x01, 0x27, 0x90, 0xA5, 0x9C, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, -+0x0B, 0x90, 0xA4, 0x55, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0xA5, 0x9C, 0xF0, 0x90, 0xA4, 0x55, 0xE0, -+0xFF, 0x90, 0xA4, 0x54, 0xE0, 0xB5, 0x07, 0x06, 0xE4, 0xA3, 0xF0, 0x12, 0x71, 0x5A, 0x22, 0xC0, -+0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xEF, -+0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x67, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, -+0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, -+0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0xA3, 0x15, -+0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA3, 0x16, 0xF0, 0x90, 0x00, -+0x02, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA3, 0x17, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, -+0x37, 0xFF, 0xED, 0x2F, 0x90, 0xA3, 0x18, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, 0xAE, -+0x05, 0xED, 0x2F, 0x90, 0xA3, 0x19, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x7F, 0x90, 0xA4, -+0x39, 0xF0, 0xEF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xA3, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, -+0x37, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0xA4, 0x38, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, -+0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0xA4, 0x36, 0xE0, 0x54, -+0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0x90, 0xA4, 0x38, 0xE0, 0x54, 0x0F, -+0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x3B, 0xF0, 0x11, 0xE3, 0x90, 0x01, -+0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0xF0, 0x90, 0xA4, 0x39, 0xE0, 0x90, 0x01, 0xBA, 0xF0, -+0x90, 0xA4, 0x3B, 0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x90, 0xA4, 0x38, 0xE0, 0x54, 0x0F, 0x90, 0x01, -+0xBE, 0xF0, 0x22, 0x90, 0xA4, 0x90, 0x12, 0x49, 0x9D, 0x31, 0x12, 0x90, 0xA4, 0x39, 0xE0, 0xFF, -+0x12, 0x56, 0xAE, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x18, 0x90, 0xA4, 0x90, 0x12, 0x49, 0x94, 0x90, -+0x00, 0x01, 0x12, 0x26, 0x37, 0x54, 0x0F, 0xFF, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x31, -+0x23, 0x22, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA4, 0x42, 0xF0, 0x90, 0xA4, -+0x3D, 0xF0, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0C, 0x04, 0x70, 0x28, 0x90, 0xA4, 0x3F, 0x74, 0x01, -+0xF0, 0xA3, 0xF0, 0x22, 0xED, 0x70, 0x0A, 0x90, 0xA4, 0x4D, 0xE0, 0x90, 0xA4, 0x3F, 0xF0, 0x80, -+0x05, 0x90, 0xA4, 0x3F, 0xED, 0xF0, 0x90, 0xA4, 0x3F, 0xE0, 0xA3, 0xF0, 0x90, 0xA4, 0x37, 0xE0, -+0x44, 0x08, 0xF0, 0x22, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x30, 0xE0, 0x26, 0x12, 0x26, -+0x1E, 0x90, 0xA4, 0x4A, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0xA4, 0x4B, 0xF0, 0xEF, -+0x54, 0xFE, 0xFF, 0xA3, 0xE0, 0x54, 0x01, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x90, -+0xA4, 0x4D, 0xF0, 0x22, 0x90, 0xA4, 0x4A, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x07, 0xF0, 0xA3, 0xE0, -+0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA3, 0xB0, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, -+0xFF, 0x90, 0xA3, 0xB1, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, -+0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x35, 0xC0, 0x01, 0x90, 0xA3, 0xB1, 0xE0, -+0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x1A, 0xF9, 0x74, 0xA3, 0x35, 0xF0, 0xA8, 0x01, 0xFC, 0x7D, 0x01, -+0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x48, 0x79, 0x90, 0xA3, 0xB1, 0xE0, 0x04, 0xF0, 0xE0, -+0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0xA3, 0xB1, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0x12, 0x26, 0x1E, 0xFD, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFC, 0xED, -+0xC3, 0x94, 0x80, 0x90, 0xA4, 0x92, 0xED, 0x50, 0x3F, 0xF0, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, -+0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA4, 0x93, 0xF0, 0xEE, 0xA3, 0xF0, -+0xED, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, -+0x90, 0xA4, 0x95, 0xF0, 0xEE, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, 0x81, 0x00, 0x12, 0x49, -+0x88, 0xE0, 0x90, 0xA4, 0x97, 0xF0, 0x80, 0x01, 0xF0, 0xEC, 0xC3, 0x94, 0x80, 0x90, 0xA4, 0x98, -+0xEC, 0x50, 0x3F, 0xF0, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, -+0xFE, 0xA3, 0xE0, 0x90, 0xA4, 0x99, 0xF0, 0xEE, 0xA3, 0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x94, 0xF5, -+0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA4, 0x9B, 0xF0, 0xEE, 0xA3, -+0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0x9D, 0xF0, -+0x80, 0x01, 0xF0, 0x90, 0xA4, 0x90, 0x74, 0x04, 0xF0, 0x90, 0xA4, 0x9E, 0x74, 0x0C, 0xF0, 0xED, -+0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEC, -+0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, -+0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEC, -+0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x7B, -+0x01, 0x7A, 0xA4, 0x79, 0x90, 0x31, 0x9A, 0x7F, 0x03, 0x02, 0x47, 0x27, 0x8F, 0x0F, 0x75, 0xF0, -+0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x49, 0x88, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x8F, 0x0F, 0x75, -+0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x49, 0x88, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x12, 0x49, -+0x88, 0xE0, 0xFB, 0x0D, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, -+0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, -+0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0xA5, 0x8A, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x20, 0xE6, 0x02, 0xE1, -+0x1C, 0x90, 0x00, 0x8D, 0xE0, 0x90, 0xA5, 0x89, 0xF0, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA5, 0x8A, -+0xF0, 0x90, 0xA5, 0x89, 0xE0, 0x12, 0x49, 0xA6, 0x6B, 0x94, 0x01, 0x6B, 0x9E, 0x02, 0x6B, 0xA7, -+0x03, 0x6B, 0xB0, 0x04, 0x6C, 0x93, 0x05, 0x6D, 0x8C, 0x06, 0x6E, 0x11, 0x07, 0x6E, 0x55, 0x08, -+0x00, 0x00, 0x6F, 0x0E, 0x90, 0xA5, 0x8A, 0xE0, 0xFF, 0x12, 0x8D, 0x1A, 0xE1, 0x0E, 0x90, 0xA5, -+0x8A, 0xE0, 0xFF, 0xF1, 0x21, 0xE1, 0x0E, 0x90, 0xA5, 0x8A, 0xE0, 0xFF, 0xF1, 0x91, 0xE1, 0x0E, -+0x90, 0xA5, 0x8A, 0xE0, 0x24, 0x93, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, -+0xFD, 0xFF, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x09, 0x90, 0x95, 0x96, 0x71, 0x1E, -+0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x09, 0x90, 0x95, 0x9B, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, -+0x75, 0xF0, 0x09, 0x90, 0x95, 0x99, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x09, 0x90, -+0x95, 0x93, 0x12, 0x49, 0x88, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, -+0x75, 0xF0, 0x09, 0x90, 0x95, 0x94, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x09, 0x90, -+0x95, 0x98, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x09, 0x90, 0x95, 0x95, 0x71, 0x1E, -+0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE0, 0xFB, 0xE4, -+0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x01, 0x71, 0x1E, -+0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, -+0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x08, 0x90, -+0x89, 0x04, 0x12, 0x49, 0x88, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, -+0x75, 0xF0, 0x08, 0x90, 0x89, 0x05, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x08, 0x90, -+0x89, 0x06, 0x71, 0x1E, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x07, 0x12, 0x49, -+0x88, 0xC1, 0x50, 0x90, 0xA5, 0x8A, 0xE0, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, -+0xF5, 0x83, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x25, 0xE0, -+0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA5, -+0x8A, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x12, 0x49, 0x88, 0xA3, 0xE0, 0xFB, 0x0D, 0x71, -+0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x71, 0x1E, 0x90, 0xA5, 0x8A, -+0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x03, 0x12, 0x49, 0x88, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, -+0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x05, 0x12, 0x49, 0x88, 0xA3, -+0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x07, 0x12, -+0x49, 0x88, 0xA3, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x75, 0xF0, 0x0A, 0x90, -+0x8D, 0x09, 0x12, 0x49, 0x88, 0xA3, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x24, -+0x93, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0xE4, -+0xFB, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, -+0xF5, 0x83, 0xA3, 0xE0, 0xFB, 0x7D, 0x02, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x25, 0xE0, 0x24, -+0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x5B, -+0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x5C, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, -+0xA4, 0x5D, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x5E, 0xC1, 0x50, 0x90, 0xA4, 0x63, 0xE0, -+0xFB, 0xE4, 0xFD, 0xFF, 0x71, 0x24, 0x90, 0xA4, 0x64, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, -+0x65, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x66, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, -+0x67, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x68, 0xE0, 0xFB, 0x0D, 0x71, 0x24, -+0x90, 0xA4, 0x69, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x6A, 0xE0, 0xFB, 0x0D, 0x71, 0x24, -+0x90, 0xA4, 0x6B, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x6C, 0xE0, 0xFB, 0x0D, -+0x71, 0x24, 0x90, 0xA4, 0x6D, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x6E, 0xE0, 0xFB, 0x0D, -+0x71, 0x24, 0x90, 0xA4, 0x6F, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x70, 0xE0, -+0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x71, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x72, 0x80, -+0x3F, 0x90, 0xA4, 0x73, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x71, 0x24, 0x90, 0xA4, 0x74, 0xE0, 0xFB, -+0x0D, 0x71, 0x24, 0x90, 0xA4, 0x75, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x76, 0xE0, 0xFB, -+0x0D, 0x71, 0x24, 0x90, 0xA4, 0x77, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x78, -+0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x79, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x7A, -+0xE0, 0xFB, 0x0D, 0xE1, 0x0C, 0x90, 0xA4, 0x39, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x71, 0x24, 0x90, -+0xA4, 0x38, 0xE0, 0x54, 0x0F, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x3B, 0xE0, 0xFB, 0x0D, 0x71, -+0x24, 0x90, 0xA4, 0x3C, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA5, 0x8A, 0xE0, 0x24, 0xB6, 0xF5, -+0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x36, -+0xE0, 0x54, 0x01, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x36, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, -+0xFB, 0x0D, 0x7F, 0x01, 0x71, 0x24, 0x90, 0xA4, 0x36, 0xE0, 0xC4, 0x54, 0x01, 0xFB, 0x0D, 0x7F, -+0x01, 0x71, 0x24, 0x90, 0xA4, 0x42, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x24, 0x90, 0xA4, 0x41, -+0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x40, 0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x3F, -+0xE0, 0xFB, 0x0D, 0x71, 0x24, 0x90, 0xA4, 0x38, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, 0xE4, 0xFD, 0x7F, -+0x03, 0x71, 0x24, 0x90, 0xA4, 0x37, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0x71, -+0x24, 0x90, 0xA4, 0x37, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0x71, 0x24, -+0x90, 0xA4, 0x36, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0x71, 0x24, 0x90, 0x00, -+0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0xA5, 0x95, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x63, 0x90, 0x00, 0x8D, -+0xE0, 0x64, 0x02, 0x70, 0x5B, 0x90, 0xA5, 0x96, 0xF0, 0x90, 0xA5, 0x96, 0xE0, 0xFD, 0x90, 0xA5, -+0x95, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, -+0x82, 0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x71, 0x24, 0x90, -+0xA5, 0x96, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x08, 0x40, 0xCE, 0x90, 0xA5, 0x96, 0xE0, 0xFD, -+0xC3, 0x94, 0x10, 0x50, 0x0D, 0xE4, 0xFB, 0xFF, 0x71, 0x24, 0x90, 0xA5, 0x96, 0xE0, 0x04, 0xF0, -+0x80, 0xE9, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, -+0x22, 0x90, 0xA4, 0x7F, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x4B, 0x90, 0x00, 0x8D, -+0xE0, 0x64, 0x03, 0x70, 0x43, 0x90, 0xA4, 0x80, 0xF0, 0x90, 0xA4, 0x80, 0xE0, 0xFD, 0x90, 0xA4, -+0x7F, 0xE0, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, -+0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x71, 0x24, 0x90, 0xA4, -+0x80, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCF, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, -+0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0xE4, 0x90, 0xA4, 0x7B, 0xF0, 0xA3, 0xF0, -+0x90, 0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3E, -+0xC3, 0x90, 0xA4, 0x7C, 0xE0, 0x94, 0x88, 0x90, 0xA4, 0x7B, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, -+0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA4, 0x7B, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x48, -+0x9F, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0xA4, 0x7C, 0xE0, 0x94, 0x32, 0x90, -+0xA4, 0x7B, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB2, 0x22, 0x7F, -+0x02, 0x90, 0xA4, 0x52, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, -+0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, -+0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0xE4, 0xF5, 0x6D, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x5D, -+0xF5, 0x61, 0xA3, 0xE0, 0x55, 0x5E, 0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, 0xF5, 0x63, 0xA3, 0xE0, -+0x55, 0x60, 0xF5, 0x64, 0x90, 0x01, 0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, 0xE5, -+0x63, 0xF0, 0xA3, 0xE5, 0x64, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x65, 0xF5, 0x69, 0xA3, -+0xE0, 0x55, 0x66, 0xF5, 0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, 0xE0, 0x55, 0x68, 0xF5, -+0x6C, 0x90, 0x01, 0x3C, 0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, 0x6B, 0xF0, 0xA3, -+0xE5, 0x6C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x46, 0x90, 0xA4, 0x37, -+0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x13, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, -+0x0C, 0x12, 0x56, 0xE9, 0x90, 0xA4, 0x3F, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0xA5, 0x8B, -+0xE4, 0x75, 0xF0, 0x01, 0x12, 0x48, 0x9F, 0xC3, 0x90, 0xA5, 0x8C, 0xE0, 0x94, 0x80, 0x90, 0xA5, -+0x8B, 0xE0, 0x64, 0x80, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, -+0x44, 0x01, 0xF0, 0x31, 0x26, 0x12, 0x67, 0xB9, 0xE4, 0xFF, 0x71, 0x29, 0x12, 0x85, 0xCF, 0x90, -+0xA4, 0x71, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA4, 0x56, 0xE0, 0x30, 0xE0, 0x2C, 0x90, 0xA4, 0x59, -+0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x90, 0xA4, 0x57, 0xE0, 0xB5, 0x07, 0x1D, 0x90, 0x06, 0x92, 0xE0, -+0x54, 0x1C, 0x70, 0x0A, 0x31, 0x5A, 0x90, 0xA4, 0x5A, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, -+0x92, 0x74, 0x1C, 0xF0, 0xE4, 0x90, 0xA4, 0x59, 0xF0, 0x22, 0xE4, 0xFF, 0x8F, 0x6E, 0x90, 0x04, -+0x1D, 0xE0, 0x60, 0x18, 0x90, 0x05, 0x22, 0xE0, 0xF5, 0x71, 0x74, 0xFF, 0xF0, 0xD1, 0xF2, 0xBF, -+0x01, 0x02, 0x31, 0xD2, 0x90, 0x05, 0x22, 0xE5, 0x71, 0xF0, 0x80, 0x02, 0x31, 0xD2, 0x90, 0x04, -+0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0x22, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x1D, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x44, 0x80, 0xF0, 0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -+0x54, 0xEF, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x40, -+0xF0, 0x22, 0x90, 0xA3, 0x17, 0xE0, 0xFF, 0x7D, 0x01, 0x51, 0x6F, 0x8E, 0x6F, 0x8F, 0x70, 0xAD, -+0x70, 0xAC, 0x6F, 0xAF, 0x6E, 0x31, 0x87, 0xAF, 0x70, 0xAE, 0x6F, 0x90, 0x81, 0x00, 0xE0, 0x54, -+0x0F, 0xFD, 0xAC, 0x07, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, -+0x01, 0xF0, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, -+0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0xFA, 0xF0, -+0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, -+0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, -+0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, -+0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, -+0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xED, 0xF0, 0x22, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA5, 0x8E, 0xED, 0xF0, 0x90, 0xA5, 0x8D, 0xEF, 0xF0, -+0xE4, 0xFD, 0xFC, 0xD1, 0x1D, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0xA5, 0x8D, 0xE0, 0x90, 0x04, 0x25, -+0xF0, 0x90, 0xA5, 0x8E, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -+0x54, 0xC0, 0xF0, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, -+0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA4, 0x56, 0xE0, 0x30, 0xE0, -+0x47, 0x90, 0xA4, 0x5A, 0xE0, 0xFD, 0x60, 0x40, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, -+0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, -+0x60, 0x06, 0xE4, 0x90, 0xA4, 0x5A, 0xF0, 0x22, 0x90, 0xA4, 0x58, 0xE0, 0xD3, 0x9D, 0x50, 0x10, -+0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0xB1, 0x0C, 0x90, 0xA4, 0x56, 0xE0, 0x54, 0xFE, 0xF0, 0x22, -+0x31, 0x5A, 0x90, 0xA4, 0x5A, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA4, 0xBC, 0xEF, 0xF0, 0xE4, 0xF5, -+0x12, 0x74, 0xBD, 0x25, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, -+0x10, 0xE5, 0x12, 0x90, 0x81, 0x03, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x30, 0xE7, 0x10, 0xE5, 0x12, -+0x70, 0x1E, 0xEF, 0x30, 0xE6, 0x1A, 0x90, 0xA4, 0x6C, 0xE0, 0x04, 0xF0, 0x80, 0x12, 0xAF, 0x12, -+0x91, 0xFD, 0x74, 0xBD, 0x25, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0x74, 0x01, 0xF0, -+0x05, 0x12, 0xE5, 0x12, 0xC3, 0x94, 0x80, 0x40, 0xB8, 0x7F, 0x0C, 0x7E, 0x00, 0x12, 0x3A, 0xF7, -+0xE4, 0xF5, 0x12, 0x74, 0xBD, 0x25, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xE0, 0x70, -+0x02, 0x81, 0xE7, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x06, 0x12, 0x49, 0x88, 0xE0, 0xF5, -+0x10, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x07, 0x12, 0x49, 0x88, 0xE0, 0xF5, 0x11, 0xFE, -+0xE5, 0x10, 0xFF, 0xE5, 0x12, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x0A, 0x12, 0x49, 0x88, -+0xE0, 0xF5, 0x10, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x0B, 0x12, 0x49, 0x88, 0xE0, 0xF5, -+0x11, 0xFE, 0xE5, 0x10, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x12, 0x90, 0x8D, 0x01, 0x12, 0x49, 0x88, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x0C, 0x12, 0x49, 0x88, -+0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x12, 0x90, 0x8D, 0x03, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, -+0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x0D, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x75, -+0xF0, 0x0A, 0xE5, 0x12, 0x90, 0x8D, 0x05, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, -+0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, 0x0E, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, -+0x12, 0x90, 0x8D, 0x07, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, -+0x12, 0x90, 0x81, 0x0F, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x12, 0x90, 0x8D, -+0x09, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x12, 0x90, 0x81, -+0x09, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x74, 0x93, 0x25, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, -+0x83, 0xEF, 0xF0, 0xE5, 0x12, 0x70, 0x56, 0xE5, 0x11, 0x30, 0xE7, 0x05, 0x90, 0xA4, 0x6B, 0x80, -+0x49, 0xE5, 0x11, 0x30, 0xE6, 0x05, 0x90, 0xA4, 0x6A, 0x80, 0x3F, 0xE5, 0x11, 0x30, 0xE5, 0x05, -+0x90, 0xA4, 0x69, 0x80, 0x35, 0xE5, 0x11, 0x30, 0xE4, 0x05, 0x90, 0xA4, 0x68, 0x80, 0x2B, 0xE5, -+0x11, 0x30, 0xE3, 0x05, 0x90, 0xA4, 0x67, 0x80, 0x21, 0xE5, 0x11, 0x30, 0xE2, 0x05, 0x90, 0xA4, -+0x66, 0x80, 0x17, 0xE5, 0x11, 0x30, 0xE1, 0x05, 0x90, 0xA4, 0x65, 0x80, 0x0D, 0xE5, 0x11, 0x30, -+0xE0, 0x05, 0x90, 0xA4, 0x64, 0x80, 0x03, 0x90, 0xA4, 0x63, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0xBC, -+0xE0, 0xFD, 0xAF, 0x12, 0x12, 0x66, 0x7F, 0x05, 0x12, 0xE5, 0x12, 0xC3, 0x94, 0x80, 0x50, 0x02, -+0x61, 0x83, 0x22, 0x90, 0xA4, 0x6F, 0xE0, 0x04, 0xF0, 0xE4, 0xFF, 0x61, 0x29, 0x75, 0xF0, 0x10, -+0xEF, 0x90, 0x81, 0x03, 0x12, 0x49, 0x88, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x90, 0xA3, 0x14, 0xE0, -+0x64, 0x02, 0x60, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x04, 0x1D, 0xE0, -+0x70, 0x13, 0x90, 0xA3, 0x16, 0xE0, 0xFF, 0xE4, 0xFD, 0x51, 0x6F, 0x8E, 0x10, 0x8F, 0x11, 0x90, -+0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x90, 0xA3, 0xB6, 0xE0, 0xB4, 0x01, 0x14, 0x90, 0xA4, 0x39, -+0xE0, 0x60, 0x0E, 0x90, 0xA4, 0x38, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x02, 0x80, 0xCD, 0xB1, -+0x52, 0x22, 0x90, 0x01, 0x5F, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x08, 0xF0, 0xE4, 0xF5, 0x3B, -+0x90, 0xA4, 0x4C, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x5C, 0x7E, -+0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5F, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, -+0x90, 0xA4, 0x36, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA4, 0x3C, 0xE0, 0x64, 0x0C, 0x60, 0x0B, 0xE4, -+0xFD, 0x7F, 0x0C, 0x12, 0x50, 0x51, 0xE4, 0xFF, 0x31, 0x5C, 0x22, 0xE4, 0x90, 0xA4, 0xBC, 0xF0, -+0x90, 0x06, 0xA9, 0xE0, 0x90, 0xA4, 0xBC, 0xF0, 0xE0, 0x54, 0xC0, 0x70, 0x0D, 0x90, 0xA4, 0x3D, -+0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x02, 0x50, 0x44, 0x90, 0xA4, 0xBC, 0xE0, 0x30, 0xE6, -+0x21, 0x90, 0xA4, 0x39, 0xE0, 0x64, 0x01, 0x70, 0x20, 0x90, 0xA4, 0x3D, 0xE0, 0x44, 0x01, 0xF0, -+0x90, 0xA4, 0x38, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x04, 0xB1, 0x1C, 0x80, 0x0B, 0xB1, 0x52, -+0x80, 0x07, 0x90, 0xA4, 0x3D, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA4, 0xBC, 0xE0, 0x90, 0xA4, 0x3D, -+0x30, 0xE7, 0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x4B, 0xE0, 0xF5, 0x3C, -+0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, -+0x90, 0xA4, 0x36, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xE4, 0xFE, 0xEF, -+0x25, 0xE0, 0xFD, 0xEF, 0xC3, 0x94, 0x80, 0x90, 0xFD, 0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, 0x03, -+0x74, 0x01, 0xF0, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x90, 0xA4, 0x36, 0xE0, 0xFF, -+0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x27, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, -+0x90, 0xA4, 0x37, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, 0xF0, -+0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x12, 0x50, 0x44, 0xE4, -+0xFF, 0x41, 0xDA, 0x90, 0xA4, 0x36, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, -+0x2C, 0xEF, 0x54, 0x7F, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA4, 0x37, 0x30, 0xE1, 0x06, 0xE0, -+0x44, 0x02, 0xF0, 0x80, 0x0F, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, -+0x01, 0xB8, 0x04, 0xF0, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x03, 0x12, 0x50, 0x44, 0x7F, 0x01, 0x41, -+0xDA, 0xEF, 0x60, 0x3D, 0x90, 0xA3, 0xB6, 0xE0, 0x64, 0x01, 0x70, 0x35, 0x90, 0xA4, 0x37, 0xE0, -+0x54, 0xFE, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, -+0xE4, 0xFF, 0x31, 0x5C, 0xBF, 0x01, 0x0E, 0x90, 0xA4, 0x36, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA4, -+0x3C, 0x74, 0x06, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x08, -+0xF0, 0x22, 0xE4, 0x90, 0xA5, 0x8F, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, -+0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, -+0xA5, 0x90, 0xE0, 0x94, 0xE8, 0x90, 0xA5, 0x8F, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, -+0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0xA5, -+0x8F, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x48, 0x9F, 0x80, 0xBF, 0x90, 0xA3, 0xB6, 0xE0, 0x64, 0x01, -+0x70, 0x2A, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, -+0x74, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x4B, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, -+0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x22, 0x90, 0xA3, 0xB6, -+0xE0, 0x64, 0x01, 0x70, 0x26, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x20, 0x90, 0x01, 0x57, 0xE4, 0xF0, -+0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA4, 0x3D, -+0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x50, 0x44, 0x22, 0x90, 0xA3, 0xB6, 0xE0, -+0xB4, 0x01, 0x14, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x0E, 0x90, 0xA4, 0x3D, 0xE0, 0x54, 0xFE, 0xF0, -+0x54, 0x07, 0x70, 0x03, 0x12, 0x50, 0x44, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x35, 0x90, 0x06, -+0x92, 0xE0, 0x30, 0xE0, 0x24, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x4C, 0xE0, 0xC3, 0x13, 0x54, 0x7F, -+0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5B, 0x74, -+0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x01, 0xF0, 0x22, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xF7, 0xF0, -+0x12, 0x50, 0x44, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x35, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, -+0x24, 0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x4C, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, -+0xFD, 0x7F, 0x5C, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5F, 0x74, 0x05, 0xF0, 0x90, 0x06, -+0x92, 0x74, 0x02, 0xF0, 0x22, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xEF, 0xF0, 0x12, 0x50, 0x44, 0x22, -+0x11, 0x79, 0x90, 0xA5, 0x3D, 0xEF, 0xF0, 0x90, 0xA4, 0x36, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, -+0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA5, 0x3D, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, -+0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, -+0xA4, 0x36, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0xA4, 0x44, 0xE4, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x90, -+0xA4, 0x44, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0xE4, 0x90, 0xA5, 0x3E, 0xF0, 0xA3, 0xF0, -+0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, 0xA5, 0x3E, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, -+0xA5, 0x3E, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0xA5, 0x40, 0xE0, 0x94, 0x64, 0x90, -+0xA5, 0x3F, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA5, -+0x3E, 0xE0, 0xFF, 0x22, 0x90, 0xA5, 0x3F, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x48, 0x9F, 0x80, 0xC2, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, -+0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, 0xC6, 0xE0, -+0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC3, 0xEE, -+0x94, 0x01, 0x40, 0x0A, 0x0D, 0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xC3, -+0xEE, 0x94, 0x01, 0x40, 0x24, 0x90, 0xFD, 0x11, 0xE0, 0x6D, 0x70, 0x1A, 0x90, 0x01, 0x17, 0xE0, -+0xB5, 0x05, 0x0D, 0x90, 0x01, 0xE4, 0x74, 0x77, 0xF0, 0x90, 0xFD, 0x11, 0xE4, 0xF0, 0x80, 0x06, -+0xED, 0x04, 0x90, 0xFD, 0x11, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xEF, 0x70, 0x04, 0x7E, 0x03, 0x80, -+0x07, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x7E, 0x42, 0x90, 0x00, 0xE2, 0xED, 0xF0, 0x90, 0x00, 0xE0, -+0xEB, 0xF0, 0x90, 0x00, 0xE3, 0xEE, 0xF0, 0x54, 0xFD, 0xF0, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, -+0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0x8F, 0x75, 0xE4, 0x90, 0xA5, 0x91, 0xF0, -+0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0xEF, 0x65, 0x75, -+0x60, 0x3E, 0xC3, 0x90, 0xA5, 0x92, 0xE0, 0x94, 0x88, 0x90, 0xA5, 0x91, 0xE0, 0x94, 0x13, 0x40, -+0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0xA5, 0x91, 0xE4, 0x75, 0xF0, 0x01, -+0x12, 0x48, 0x9F, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0xA5, 0x92, 0xE0, 0x94, -+0x32, 0x90, 0xA5, 0x91, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB2, -+0x22, 0x51, 0x53, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0xE4, -+0xFF, 0x31, 0x59, 0x90, 0xA3, 0x14, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x54, 0x7F, -+0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0xFB, -+0x31, 0xB1, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA4, 0x3C, 0xE0, 0x70, 0x0D, 0x51, 0x70, 0xBF, -+0x01, 0x08, 0x31, 0xD7, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA3, 0x14, 0xE0, 0xB4, -+0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0xA4, -+0x43, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x3A, 0x96, 0x90, 0xA4, 0x3A, 0xE0, 0x60, 0x12, 0x90, 0x01, -+0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, -+0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0x7F, 0x01, 0x31, 0x59, -+0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x3A, 0x96, 0x7F, 0x14, 0x7E, 0x00, -+0x02, 0x3A, 0xF7, 0x90, 0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0xA4, 0x36, 0xE0, 0x30, 0xE0, 0x02, 0x31, 0xE7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0x02, 0x87, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x17, 0x90, 0x02, -+0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, -+0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x7F, 0x00, 0x22, 0xE4, 0x90, -+0xA4, 0x7B, 0xF0, 0xE4, 0x90, 0xA4, 0x7C, 0xF0, 0x90, 0xA4, 0x7C, 0xE0, 0xFF, 0xC3, 0x94, 0x10, -+0x50, 0x74, 0x90, 0xA4, 0x7B, 0xE0, 0xFE, 0x24, 0x13, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, -+0x74, 0x03, 0xF0, 0xEF, 0x90, 0xA4, 0x7C, 0xB4, 0x03, 0x1B, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xEE, -+0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, -+0x74, 0x80, 0xF0, 0x80, 0x1B, 0xE0, 0xFF, 0x90, 0xA4, 0x7B, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, -+0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, -+0x90, 0xA4, 0x7C, 0xE0, 0xFF, 0x90, 0xA4, 0x7B, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, -+0x49, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA4, -+0x7C, 0xE0, 0x04, 0xF0, 0x80, 0x82, 0x90, 0xA4, 0x7B, 0xE0, 0x04, 0xF0, 0xE0, 0x64, 0x80, 0x60, -+0x02, 0x41, 0xA3, 0xE4, 0x90, 0xAF, 0x7D, 0xF0, 0x90, 0xA4, 0x7B, 0xF0, 0x90, 0xA4, 0x7B, 0xE0, -+0xFF, 0xC3, 0x94, 0x80, 0x40, 0x02, 0x81, 0x83, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x01, 0x12, -+0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, 0x49, 0x88, -+0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x12, 0x49, 0x88, 0xE4, 0xF0, -+0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x07, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, -+0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, -+0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x93, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE4, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x94, 0xF5, -+0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x94, 0xF5, -+0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, -+0x93, 0x12, 0x49, 0x88, 0x74, 0x3F, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x94, 0x12, 0x49, -+0x88, 0x74, 0x03, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x95, 0x12, 0x49, 0x88, 0x74, 0x09, -+0xF0, 0xF5, 0xF0, 0xEF, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0x75, 0xF0, 0x09, 0xEF, -+0x90, 0x95, 0x97, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x98, 0x12, -+0x49, 0x88, 0x74, 0x01, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x99, 0x12, 0x49, 0x88, 0xE4, -+0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x9A, 0x12, 0x49, 0x88, 0x74, 0x01, 0xF0, 0x75, 0xF0, -+0x09, 0xEF, 0x90, 0x95, 0x9B, 0x12, 0x49, 0x88, 0xE4, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, -+0x93, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x90, 0xA4, 0x7B, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x90, 0x81, -+0x00, 0x12, 0x49, 0x88, 0xEF, 0xF0, 0x74, 0x11, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -+0xE4, 0xF0, 0x74, 0x13, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x93, -+0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x7B, 0xE0, 0x04, -+0xF0, 0x61, 0x3C, 0xE4, 0x90, 0xA4, 0x7D, 0xF0, 0x90, 0xA4, 0x7D, 0xE0, 0xFF, 0xC3, 0x94, 0x20, -+0x50, 0x14, 0x74, 0x5B, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA4, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA4, -+0x7D, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x72, -+0x8F, 0x73, 0x8D, 0x74, 0xE4, 0x90, 0xA5, 0x50, 0xF0, 0x90, 0xA5, 0x50, 0xE0, 0xFF, 0xC3, 0x94, -+0x08, 0x50, 0x14, 0x74, 0x52, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xE4, 0xF0, 0x90, -+0xA5, 0x50, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x75, 0xF0, 0x09, 0xE5, 0x74, 0x90, 0x95, 0x99, 0x12, -+0x49, 0x88, 0xE0, 0x90, 0xA5, 0x5A, 0xF0, 0x64, 0x01, 0x70, 0x4F, 0x75, 0xF0, 0x08, 0xE5, 0x74, -+0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA5, 0x52, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x74, -+0x90, 0x89, 0x01, 0x12, 0x49, 0x88, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA5, 0x53, 0xF0, 0xE4, 0xA3, -+0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xEE, 0x54, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x74, 0x90, -+0x89, 0x02, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA5, 0x58, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x74, 0x90, -+0x89, 0x03, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA5, 0x59, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, 0xFD, 0xC3, -+0x94, 0x02, 0x40, 0x61, 0x75, 0xF0, 0x08, 0xE5, 0x74, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE0, -+0x90, 0xA5, 0x52, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x74, 0x90, 0x89, 0x01, 0x12, 0x49, 0x88, 0xE0, -+0x90, 0xA5, 0x53, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x74, 0x90, 0x89, 0x02, 0x12, 0x49, 0x88, 0xE0, -+0x90, 0xA5, 0x54, 0xF0, 0x75, 0xF0, 0x08, 0xE5, 0x74, 0x90, 0x89, 0x03, 0x12, 0x49, 0x88, 0xE0, -+0xFE, 0x54, 0x0F, 0x90, 0xA5, 0x55, 0xF0, 0xEE, 0x54, 0xF0, 0x90, 0xA5, 0x51, 0xF0, 0xED, 0xB4, -+0x03, 0x0B, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x90, 0xA5, 0x59, 0xF0, 0x80, 0x08, 0x90, 0xA5, 0x51, -+0xE0, 0x90, 0xA5, 0x58, 0xF0, 0xE4, 0x90, 0xA5, 0x50, 0xF0, 0x90, 0xA5, 0x50, 0xE0, 0xFF, 0x24, -+0x52, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFE, 0xEF, 0x7C, -+0x00, 0x25, 0x73, 0xFD, 0xEC, 0x35, 0x72, 0x8D, 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, 0x5F, 0xD0, -+0x82, 0xD0, 0x83, 0xF0, 0x90, 0xA5, 0x50, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xCC, 0x90, 0xA5, -+0x57, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x70, 0x08, 0xA3, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x37, -+0x90, 0xA5, 0x5A, 0xE0, 0x64, 0x01, 0x70, 0x2F, 0x90, 0xA5, 0x53, 0xE0, 0x54, 0x0F, 0xFE, 0x90, -+0xA5, 0x51, 0xF0, 0xEF, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0xA5, 0x53, 0xF0, 0x90, 0xA5, 0x58, 0xE0, -+0x90, 0xA5, 0x54, 0xF0, 0x90, 0xA5, 0x59, 0xE0, 0x90, 0xA5, 0x55, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, -+0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0x90, 0xA5, 0x5A, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, -+0x26, 0xEF, 0x90, 0xA5, 0x55, 0xB4, 0x02, 0x08, 0xE0, 0xFF, 0x90, 0xA5, 0x58, 0xE0, 0x80, 0x0A, -+0xE0, 0xFF, 0x90, 0xA5, 0x59, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0xFE, 0xEF, 0x4E, 0x90, 0xA5, 0x55, -+0xF0, 0x90, 0xA5, 0x59, 0x74, 0x80, 0xF0, 0xE4, 0x90, 0xA5, 0x50, 0xF0, 0x90, 0xA5, 0x50, 0xE0, -+0xFF, 0x24, 0x52, 0xF5, 0x82, 0xE4, 0x34, 0xA5, 0xF5, 0x83, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0xE5, -+0x74, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, -+0x83, 0xEE, 0xF0, 0x90, 0xA5, 0x50, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xCF, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x8F, 0x1B, 0x90, 0x01, 0xC4, 0x74, 0x92, 0xF0, 0x74, 0x7E, 0xA3, 0xF0, 0x75, 0xF0, -+0x10, 0xE5, 0x1B, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0xBF, 0xBE, 0x02, 0x7F, 0x3F, -+0x8F, 0x1C, 0xE4, 0xF5, 0x1F, 0xE5, 0x1C, 0x54, 0x7F, 0xF5, 0x1D, 0x75, 0xF0, 0x09, 0xE5, 0x1B, -+0x90, 0x95, 0x93, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0xC7, 0xF0, 0x75, 0xF0, 0x09, 0xE5, 0x1B, -+0x90, 0x95, 0x99, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0xC8, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x1D, -+0x90, 0x42, 0x2D, 0x12, 0x49, 0x88, 0x12, 0x49, 0x5C, 0xE5, 0x1B, 0x25, 0xE0, 0x24, 0x11, 0xF5, -+0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x09, 0xE5, 0x1B, -+0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xE0, 0xF5, 0x1E, 0x74, 0x13, 0x25, 0x1B, 0xF5, 0x82, 0xE4, -+0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x64, 0x01, 0x70, 0x28, 0xE5, 0x1D, 0x64, 0x3F, 0x70, 0x22, 0x75, -+0x1D, 0x3E, 0x75, 0xF0, 0x09, 0xE5, 0x1B, 0x90, 0x95, 0x98, 0x12, 0x49, 0x88, 0xE0, 0xB4, 0x01, -+0x05, 0x75, 0x1C, 0xBE, 0x80, 0x03, 0x85, 0x1D, 0x1C, 0x85, 0x1E, 0x23, 0xE4, 0xFB, 0x02, 0x83, -+0x38, 0x90, 0xA4, 0xC7, 0xE0, 0xFF, 0xE5, 0x1D, 0xC3, 0x9F, 0x40, 0x03, 0x02, 0x82, 0xC5, 0x74, -+0x94, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE5, 0x1D, 0xF0, 0xB4, 0x2C, 0x23, -+0x75, 0xF0, 0x09, 0xE5, 0x1B, 0x90, 0x95, 0x97, 0x12, 0x49, 0x88, 0xE0, 0x65, 0x1E, 0x60, 0x13, -+0x05, 0x1E, 0x75, 0xF0, 0x09, 0xE5, 0x1B, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xE5, 0x1E, 0xF0, -+0x02, 0x82, 0xC0, 0xE5, 0x1D, 0xC3, 0x94, 0x0C, 0x40, 0x19, 0xE5, 0x1D, 0x94, 0x13, 0x50, 0x13, -+0x74, 0x11, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0x70, 0x05, 0x75, 0x1F, -+0x01, 0x80, 0x1E, 0xE5, 0x1D, 0xC3, 0x94, 0x2C, 0x40, 0x27, 0xE5, 0x1D, 0x94, 0x35, 0x50, 0x21, -+0x74, 0x11, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0x70, 0x13, 0x75, 0x1F, -+0x02, 0x74, 0x11, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x80, -+0x10, 0xE4, 0xF5, 0x1F, 0x74, 0x11, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE4, -+0xF0, 0xE5, 0x1F, 0x64, 0x01, 0x60, 0x03, 0x02, 0x80, 0xA8, 0x75, 0xF0, 0x08, 0xE5, 0x1B, 0x90, -+0x89, 0x02, 0x12, 0x49, 0x88, 0xE0, 0x20, 0xE7, 0x1A, 0x20, 0xE6, 0x17, 0x20, 0xE5, 0x14, 0x20, -+0xE4, 0x11, 0x75, 0xF0, 0x08, 0xE5, 0x1B, 0x90, 0x89, 0x03, 0x12, 0x49, 0x88, 0xE0, 0x20, 0xE0, -+0x02, 0x01, 0xA8, 0x74, 0x13, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x74, 0x01, -+0xF0, 0xE5, 0x1D, 0xB4, 0x0C, 0x08, 0x75, 0x1D, 0x14, 0x75, 0x1C, 0x14, 0x80, 0x0B, 0xE5, 0x1D, -+0xB4, 0x0D, 0x16, 0x75, 0x1D, 0x15, 0x75, 0x1C, 0x15, 0x74, 0x93, 0x25, 0x1B, 0xF5, 0x82, 0xE4, -+0x34, 0x9B, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x80, 0x58, 0xE5, 0x1D, 0xB4, 0x0E, 0x08, 0x75, 0x1D, -+0x15, 0x75, 0x1C, 0x15, 0x80, 0x0B, 0xE5, 0x1D, 0xB4, 0x0F, 0x16, 0x75, 0x1D, 0x16, 0x75, 0x1C, -+0x16, 0x74, 0x93, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x74, 0x03, 0xF0, 0x80, -+0x30, 0xE5, 0x1D, 0xC3, 0x94, 0x10, 0x40, 0x08, 0x75, 0x1D, 0x17, 0x75, 0x1C, 0x17, 0x80, 0x13, -+0xE5, 0x1D, 0xC3, 0x94, 0x11, 0x40, 0x1A, 0xE5, 0x1D, 0x94, 0x13, 0x50, 0x14, 0x75, 0x1D, 0x18, -+0x75, 0x1C, 0x18, 0x74, 0x93, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x74, 0x02, -+0xF0, 0x85, 0x1E, 0x23, 0x7B, 0x01, 0x61, 0x38, 0xE5, 0x1F, 0x64, 0x02, 0x60, 0x02, 0x21, 0x3F, -+0x75, 0xF0, 0x08, 0xE5, 0x1B, 0x90, 0x89, 0x02, 0x12, 0x49, 0x88, 0xE0, 0x20, 0xE6, 0x18, 0x20, -+0xE7, 0x15, 0x75, 0xF0, 0x08, 0xE5, 0x1B, 0x90, 0x89, 0x03, 0x12, 0x49, 0x88, 0xE0, 0x20, 0xE0, -+0x06, 0x20, 0xE1, 0x03, 0x30, 0xE2, 0x68, 0xE5, 0x1D, 0x64, 0x2C, 0x60, 0x05, 0xE5, 0x1D, 0xB4, -+0x2D, 0x08, 0x75, 0x1D, 0x36, 0x75, 0x1C, 0x36, 0x80, 0x4E, 0xE5, 0x1D, 0x64, 0x2E, 0x60, 0x05, -+0xE5, 0x1D, 0xB4, 0x2F, 0x08, 0x75, 0x1D, 0x37, 0x75, 0x1C, 0x37, 0x80, 0x3B, 0xE5, 0x1D, 0xB4, -+0x30, 0x08, 0x75, 0x1D, 0x38, 0x75, 0x1C, 0x38, 0x80, 0x2E, 0xE5, 0x1D, 0xB4, 0x31, 0x08, 0x75, -+0x1D, 0x39, 0x75, 0x1C, 0x39, 0x80, 0x21, 0xE5, 0x1D, 0xC3, 0x94, 0x32, 0x40, 0x0F, 0xE5, 0x1D, -+0xD3, 0x94, 0x34, 0x50, 0x08, 0x75, 0x1D, 0x3A, 0x75, 0x1C, 0x3A, 0x80, 0x0B, 0xE5, 0x1D, 0xB4, -+0x35, 0x06, 0x75, 0x1D, 0x3B, 0x75, 0x1C, 0x3B, 0x85, 0x1E, 0x23, 0x7B, 0x01, 0x61, 0x38, 0x74, -+0x13, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA4, 0xC8, 0xE0, -+0xFF, 0xB4, 0x01, 0x0B, 0xE5, 0x1D, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x74, 0xE0, 0x80, 0x1C, 0xEF, -+0xB4, 0x02, 0x0B, 0xE5, 0x1D, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0x74, 0xE8, 0x80, 0x0D, 0xEF, 0xB4, -+0x03, 0x0D, 0xE5, 0x1D, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0x74, 0xDE, 0x25, 0x1D, 0xF5, 0x1D, 0xEF, -+0xB4, 0x01, 0x0F, 0x90, 0xA4, 0xC7, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE0, 0xF0, -+0x80, 0x2A, 0x90, 0xA4, 0xC8, 0xE0, 0xB4, 0x02, 0x0F, 0x90, 0xA4, 0xC7, 0xE0, 0xC3, 0x94, 0x2C, -+0x40, 0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, 0x90, 0xA4, 0xC8, 0xE0, 0xB4, 0x03, 0x0D, 0x90, -+0xA4, 0xC7, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, 0xDE, 0xF0, 0xE5, 0x1D, 0x04, 0xFD, -+0x90, 0xA4, 0xC7, 0xE0, 0xFF, 0xED, 0xD3, 0x9F, 0x50, 0x7A, 0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0xFF, 0x75, 0xF0, 0x08, 0xE5, 0x1B, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2F, 0xF5, -+0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0x7A, 0x00, 0xED, 0x54, 0x07, 0xFF, 0x74, 0x01, -+0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, -+0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x3A, 0x74, 0x94, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA2, -+0xF5, 0x83, 0xE0, 0xB4, 0x13, 0x24, 0x75, 0x1D, 0x18, 0x85, 0x1D, 0x1C, 0x74, 0x13, 0x25, 0x1B, -+0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x74, 0x93, 0x25, 0x1B, 0xF5, 0x82, -+0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x80, 0x0A, 0x8D, 0x1D, 0x85, 0x1D, 0x1C, 0x80, -+0x03, 0x0D, 0x21, 0xC0, 0x90, 0xA4, 0xC8, 0xE0, 0xFF, 0xB4, 0x01, 0x17, 0xE5, 0x1C, 0xD3, 0x94, -+0x0B, 0x40, 0x10, 0xE5, 0x1C, 0x94, 0x34, 0x50, 0x0A, 0x74, 0x20, 0x25, 0x1C, 0xF5, 0x1C, 0x74, -+0x20, 0x80, 0x28, 0xEF, 0xB4, 0x02, 0x11, 0xE5, 0x1C, 0xD3, 0x94, 0x1B, 0x40, 0x0A, 0x74, 0x18, -+0x25, 0x1C, 0xF5, 0x1C, 0x74, 0x18, 0x80, 0x13, 0xEF, 0xB4, 0x03, 0x13, 0xE5, 0x1C, 0xD3, 0x94, -+0x1B, 0x40, 0x0C, 0x74, 0x22, 0x25, 0x1C, 0xF5, 0x1C, 0x74, 0x22, 0x25, 0x1D, 0xF5, 0x1D, 0x74, -+0x13, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x61, -+0x33, 0xE5, 0x1D, 0x64, 0x3F, 0x60, 0x02, 0x61, 0x33, 0x75, 0x1D, 0x3E, 0x75, 0xF0, 0x09, 0xE5, -+0x1B, 0x90, 0x95, 0x98, 0x12, 0x49, 0x88, 0xE0, 0xB4, 0x01, 0x05, 0x75, 0x1C, 0xBE, 0x80, 0x73, -+0x85, 0x1D, 0x1C, 0x80, 0x6E, 0x90, 0xA4, 0xC7, 0xE0, 0x65, 0x1D, 0x70, 0x4D, 0x74, 0x94, 0x25, -+0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE5, 0x1C, 0xF0, 0x75, 0xF0, 0x09, 0xE5, 0x1B, -+0x90, 0x95, 0x98, 0x12, 0x49, 0x88, 0xE0, 0xB4, 0x01, 0x0D, 0xE5, 0x1C, 0x20, 0xE7, 0x08, 0xE5, -+0x1D, 0x44, 0x80, 0xF5, 0x1C, 0x80, 0x3C, 0x75, 0xF0, 0x04, 0xE5, 0x1D, 0x90, 0x42, 0x2D, 0x12, -+0x49, 0x88, 0x12, 0x49, 0x5C, 0xE5, 0x1B, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, -+0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xAF, 0x1C, 0x22, 0x90, 0xA4, 0xC7, 0xE0, 0xFF, 0x74, -+0x94, 0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEF, 0xF0, 0x8F, 0x1D, 0xEF, 0x54, -+0x80, 0xF5, 0x1C, 0x85, 0x1E, 0x23, 0x7B, 0x01, 0xAD, 0x1C, 0xAF, 0x1B, 0x12, 0x61, 0x84, 0xAF, -+0x1C, 0x22, 0x8F, 0x1B, 0x90, 0x01, 0xC4, 0x74, 0x42, 0xF0, 0x74, 0x83, 0xA3, 0xF0, 0xE5, 0x1B, -+0x25, 0xE0, 0x24, 0x14, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, -+0xF0, 0x10, 0xE5, 0x1B, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0xBF, 0xBE, 0x02, 0x7F, -+0x3F, 0xEF, 0x54, 0x7F, 0xF5, 0x1C, 0x54, 0x7F, 0xF9, 0x90, 0xA4, 0xC9, 0xF0, 0x75, 0xF0, 0x09, -+0xE5, 0x1B, 0x90, 0x95, 0x94, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0xCB, 0xF0, 0x75, 0xF0, 0x09, -+0xE5, 0x1B, 0x90, 0x95, 0x93, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0xCC, 0xF0, 0x75, 0xF0, 0x10, -+0xE5, 0x1B, 0x90, 0x81, 0x05, 0x12, 0x49, 0x88, 0xE0, 0x54, 0x03, 0xFC, 0xE9, 0x25, 0xE0, 0x24, -+0x7D, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE5, -+0x1B, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0x75, 0xF0, 0x09, 0xE5, 0x1B, 0x90, 0x95, 0x99, 0x12, 0x49, 0x88, 0xE0, 0xFB, 0x74, 0x94, -+0x25, 0x1B, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE9, 0xF0, 0x90, 0xA4, 0xCC, 0xE0, 0xFF, -+0xE9, 0xD3, 0x9F, 0x40, 0x07, 0x90, 0xA4, 0xC9, 0xEF, 0xF0, 0xF5, 0x1C, 0xED, 0x70, 0x02, 0xA1, -+0xC1, 0x90, 0xA4, 0xCA, 0xED, 0xF0, 0xE5, 0x1C, 0x30, 0xE7, 0x0A, 0x90, 0xA4, 0xC9, 0xE0, 0xF5, -+0x1C, 0xA3, 0xE0, 0x14, 0xF0, 0x90, 0xA4, 0xCA, 0xE0, 0x70, 0x02, 0xA1, 0xC1, 0x90, 0xA4, 0xC9, -+0xE0, 0xFF, 0xB4, 0x2C, 0x23, 0x75, 0xF0, 0x09, 0xE5, 0x1B, 0x90, 0x95, 0x97, 0x12, 0x49, 0x88, -+0xE0, 0x6C, 0x60, 0x14, 0x1C, 0x75, 0xF0, 0x09, 0xE5, 0x1B, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, -+0xEC, 0xF0, 0x90, 0xA4, 0xCA, 0xE0, 0x14, 0xF0, 0x90, 0xA4, 0xCA, 0xE0, 0x70, 0x02, 0xA1, 0xC1, -+0x90, 0xA4, 0xCB, 0xE0, 0xFE, 0xEF, 0xD3, 0x9E, 0x50, 0x02, 0xA1, 0xBB, 0xE4, 0x90, 0xA4, 0xC8, -+0xF0, 0xBB, 0x01, 0x0F, 0xA3, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x08, 0xE0, 0x24, 0xE0, 0xF0, 0x74, -+0xE0, 0x80, 0x26, 0xBB, 0x02, 0x11, 0x90, 0xA4, 0xC9, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x08, 0xE0, -+0x24, 0xE8, 0xF0, 0x74, 0xE8, 0x80, 0x12, 0xBB, 0x03, 0x13, 0x90, 0xA4, 0xC9, 0xE0, 0xC3, 0x94, -+0x2C, 0x40, 0x0A, 0xE0, 0x24, 0xDE, 0xF0, 0x74, 0xDE, 0x25, 0x1C, 0xF5, 0x1C, 0xBB, 0x01, 0x0F, -+0xEE, 0xC3, 0x94, 0x2C, 0x40, 0x09, 0x90, 0xA4, 0xCB, 0xE0, 0x24, 0xE0, 0xF0, 0x80, 0x22, 0xBB, -+0x02, 0x0F, 0x90, 0xA4, 0xCB, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, -+0x10, 0xBB, 0x03, 0x0D, 0x90, 0xA4, 0xCB, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, 0xDE, -+0xF0, 0x90, 0xA4, 0xC9, 0xE0, 0x14, 0x90, 0xA4, 0xC7, 0xF0, 0x90, 0xA4, 0xCB, 0xE0, 0xFF, 0x90, -+0xA4, 0xC7, 0xE0, 0xF9, 0xC3, 0x9F, 0x50, 0x02, 0xA1, 0x6A, 0xE9, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0xFF, 0x75, 0xF0, 0x08, 0xE5, 0x1B, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2F, 0xF5, -+0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xF5, 0x82, 0x75, 0x83, 0x00, 0xE9, 0x54, 0x07, 0xFF, -+0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x60, 0x37, 0x74, 0x94, 0x25, 0x1B, 0xF5, -+0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0xB4, 0x14, 0x05, 0x75, 0x1C, 0x0C, 0x80, 0x06, 0x90, -+0xA4, 0xC7, 0xE0, 0xF5, 0x1C, 0x90, 0xA4, 0xC8, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0xCA, 0xE0, 0xFF, -+0x90, 0xA4, 0xC8, 0xE0, 0x6F, 0x60, 0x13, 0x90, 0xA4, 0xCB, 0xE0, 0xFF, 0xE5, 0x1C, 0xD3, 0x9F, -+0x40, 0x08, 0x90, 0xA4, 0xC7, 0xE0, 0x14, 0xF0, 0x81, 0xDA, 0xBB, 0x01, 0x1C, 0xE5, 0x1C, 0xD3, -+0x94, 0x0B, 0x40, 0x15, 0xE5, 0x1C, 0x94, 0x34, 0x50, 0x0F, 0x74, 0x20, 0x25, 0x1C, 0xF5, 0x1C, -+0x90, 0xA4, 0xC9, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x38, 0xBB, 0x02, 0x16, 0xE5, 0x1C, 0xD3, 0x94, -+0x1B, 0x40, 0x0F, 0x74, 0x18, 0x25, 0x1C, 0xF5, 0x1C, 0x90, 0xA4, 0xC9, 0xE0, 0x24, 0x18, 0xF0, -+0x80, 0x1F, 0xBB, 0x03, 0x1C, 0xE5, 0x1C, 0xD3, 0x94, 0x1B, 0x40, 0x15, 0x74, 0x22, 0x25, 0x1C, -+0xF5, 0x1C, 0x90, 0xA4, 0xC9, 0xE0, 0x24, 0x22, 0xF0, 0x80, 0x06, 0x90, 0xA4, 0xCB, 0xE0, 0xF5, -+0x1C, 0x8C, 0x23, 0xE4, 0xFB, 0xAD, 0x1C, 0xAF, 0x1B, 0x12, 0x61, 0x84, 0xAF, 0x1C, 0x22, 0x90, -+0x01, 0xC4, 0x74, 0xCF, 0xF0, 0x74, 0x85, 0xA3, 0xF0, 0xE4, 0xF5, 0x10, 0x74, 0xB6, 0x25, 0x10, -+0xF5, 0x82, 0xE4, 0x34, 0xA3, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, 0x8B, 0x51, 0x75, 0xF0, 0x09, -+0xE5, 0x10, 0x90, 0x95, 0x9B, 0x12, 0x49, 0x88, 0xE0, 0x64, 0x01, 0x70, 0x03, 0x02, 0x8B, 0x51, -+0xE5, 0x10, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, -+0xE0, 0xD3, 0x94, 0x00, 0xEE, 0x94, 0x00, 0x50, 0x03, 0x02, 0x8B, 0x51, 0xE5, 0x10, 0x75, 0xF0, -+0x0A, 0xA4, 0x24, 0x01, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x8B, 0x14, 0xF5, 0x15, -+0x89, 0x16, 0xE5, 0x10, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, -+0xFF, 0xA3, 0xE0, 0x90, 0xA4, 0xBF, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x93, 0x25, 0x10, 0xF5, -+0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA4, 0xC1, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, -+0x90, 0x00, 0x02, 0x12, 0x48, 0xE0, 0xFF, 0xAE, 0xF0, 0x12, 0x48, 0xB5, 0x2F, 0xFF, 0xE5, 0xF0, -+0x3E, 0xFE, 0x90, 0x00, 0x04, 0x12, 0x48, 0xE0, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, -+0x06, 0x12, 0x48, 0xE0, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x08, 0x12, 0x48, 0xE0, -+0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x90, 0xA4, 0xC3, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, -+0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE0, 0xFF, 0x90, 0xA4, 0xBE, 0xF0, 0xBF, 0xBE, 0x03, -+0x74, 0x3F, 0xF0, 0x90, 0xA4, 0xBE, 0xE0, 0x90, 0xA4, 0xBC, 0xF0, 0x54, 0x7F, 0xA3, 0xF0, 0x75, -+0xF0, 0x09, 0xE5, 0x10, 0x90, 0x95, 0x93, 0x12, 0x49, 0x88, 0xE0, 0x90, 0xA4, 0xC6, 0xF0, 0x74, -+0x13, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0x64, 0x01, 0x60, 0x02, 0xE1, -+0x5F, 0x74, 0x93, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x60, 0x70, 0x90, -+0xA4, 0xBD, 0xE0, 0xFF, 0xC3, 0x94, 0x0C, 0x40, 0x66, 0xEF, 0xD3, 0x94, 0x13, 0x50, 0x60, 0x74, -+0x93, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x14, 0xF0, 0x74, 0x93, 0x25, -+0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x60, 0x03, 0x02, 0x8B, 0x5D, 0x90, 0xA4, -+0xBD, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x7D, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xE4, 0x93, -+0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, 0x04, 0xEB, 0x90, 0x42, 0x2D, 0x12, -+0x49, 0x88, 0x12, 0x49, 0x78, 0x12, 0x49, 0x18, 0x78, 0x01, 0x12, 0x27, 0x22, 0xE5, 0x10, 0x25, -+0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, -+0x94, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0x05, 0x40, 0x03, -+0x02, 0x8A, 0xB0, 0x90, 0xA4, 0xC6, 0xE0, 0xFF, 0x90, 0xA4, 0xBD, 0xE0, 0x9F, 0x40, 0x13, 0x90, -+0xA4, 0xC6, 0xE0, 0x90, 0xA4, 0xBD, 0xF0, 0x90, 0xA4, 0xBC, 0xE0, 0x54, 0x80, 0xFE, 0xF0, 0xEF, -+0x4E, 0xF0, 0x90, 0xA4, 0xBD, 0xE0, 0xFF, 0x90, 0x41, 0xD9, 0x93, 0xFE, 0x74, 0x93, 0x25, 0x10, -+0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xC3, 0x9E, 0x40, 0x06, 0xEF, 0x90, 0x41, 0x31, -+0x80, 0x07, 0x90, 0xA4, 0xBD, 0xE0, 0x90, 0x41, 0x85, 0x93, 0x90, 0xA4, 0xC5, 0xF0, 0x90, 0xA4, -+0xC5, 0xE0, 0x75, 0xF0, 0x06, 0xA4, 0x24, 0x8F, 0xF9, 0x74, 0x40, 0x35, 0xF0, 0x75, 0x11, 0xFF, -+0xF5, 0x12, 0x89, 0x13, 0x90, 0xA4, 0xBC, 0xE0, 0x90, 0x44, 0x85, 0x93, 0xFF, 0xD3, 0x90, 0xA4, -+0xC2, 0xE0, 0x9F, 0x90, 0xA4, 0xC1, 0xE0, 0x94, 0x00, 0x40, 0x09, 0x7D, 0x01, 0xAF, 0x10, 0x71, -+0x42, 0x02, 0x8A, 0xB0, 0xE5, 0x10, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, -+0x83, 0xE0, 0xF5, 0x17, 0xA3, 0xE0, 0xF5, 0x18, 0x90, 0xA4, 0xBF, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0xD3, 0x94, 0xFA, 0xEE, 0x94, 0x00, 0x40, 0x05, 0x75, 0x1A, 0x02, 0x80, 0x11, 0xD3, 0xEF, 0x94, -+0xE8, 0xEE, 0x94, 0x03, 0x40, 0x05, 0x75, 0x1A, 0x05, 0x80, 0x03, 0xE4, 0xF5, 0x1A, 0xAB, 0x14, -+0xAA, 0x15, 0xA9, 0x16, 0x12, 0x48, 0xB5, 0xAE, 0xF0, 0xA8, 0x1A, 0x08, 0x80, 0x05, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x11, 0xAA, 0x12, 0xA9, 0x13, 0x12, 0x26, 0x1E, 0xFD, -+0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x18, 0xF5, 0x18, 0xEE, 0x35, 0x17, 0xF5, 0x17, 0xAB, -+0x14, 0xAA, 0x15, 0xA9, 0x16, 0x90, 0x00, 0x02, 0x12, 0x48, 0xE0, 0xAE, 0xF0, 0xA8, 0x1A, 0x08, -+0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x11, 0xAA, 0x12, 0xA9, 0x13, -+0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x18, 0xF5, -+0x18, 0xEE, 0x35, 0x17, 0xF5, 0x17, 0xAB, 0x14, 0xAA, 0x15, 0xA9, 0x16, 0x90, 0x00, 0x04, 0x12, -+0x48, 0xE0, 0xAE, 0xF0, 0xA8, 0x1A, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, -+0xFF, 0xAB, 0x11, 0xAA, 0x12, 0xA9, 0x13, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, -+0x12, 0x26, 0x98, 0xEF, 0x25, 0x18, 0xF5, 0x18, 0xEE, 0x35, 0x17, 0xF5, 0x17, 0xAB, 0x14, 0xAA, -+0x15, 0xA9, 0x16, 0x90, 0x00, 0x06, 0x12, 0x48, 0xE0, 0xAE, 0xF0, 0xA8, 0x1A, 0x08, 0x80, 0x05, -+0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x11, 0xAA, 0x12, 0xA9, 0x13, 0x90, 0x00, -+0x03, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, 0x98, 0xEF, 0x25, 0x18, 0xF5, 0x18, 0xEE, -+0x35, 0x17, 0xF5, 0x17, 0xAB, 0x14, 0xAA, 0x15, 0xA9, 0x16, 0x90, 0x00, 0x08, 0x12, 0x48, 0xE0, -+0xAE, 0xF0, 0xA8, 0x1A, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, -+0x11, 0xAA, 0x12, 0xA9, 0x13, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFD, 0x7C, 0x00, 0x12, 0x26, -+0x98, 0xEF, 0x25, 0x18, 0xF5, 0x18, 0xEE, 0x35, 0x17, 0xF5, 0x17, 0x90, 0x00, 0x05, 0x12, 0x26, -+0x37, 0xFD, 0x90, 0xA4, 0xBF, 0xE0, 0xFE, 0xA3, 0xE0, 0xA8, 0x1A, 0x08, 0x80, 0x05, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x26, 0x98, 0xD3, 0xE5, 0x18, 0x9F, 0xE5, 0x17, 0x9E, -+0x40, 0x0C, 0xE5, 0x18, 0x9F, 0xF5, 0x18, 0xE5, 0x17, 0x9E, 0xF5, 0x17, 0x80, 0x05, 0xE4, 0xF5, -+0x17, 0xF5, 0x18, 0xE5, 0x10, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, -+0xE5, 0x17, 0xF0, 0xA3, 0xE5, 0x18, 0xF0, 0xAE, 0x17, 0xFF, 0xE4, 0xFC, 0xFD, 0x90, 0xA4, 0xBD, -+0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x2D, 0x12, 0x49, 0x88, 0x12, 0x49, 0x78, 0xC3, 0x12, 0x49, -+0x3F, 0x40, 0x02, 0x41, 0x69, 0x74, 0x91, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -+0xE0, 0xFF, 0x74, 0x93, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFE, 0xD3, -+0x9F, 0x40, 0x03, 0xEE, 0x80, 0x1A, 0x74, 0x93, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, -+0x83, 0xE0, 0xFF, 0x74, 0x91, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xC3, -+0x9F, 0xF5, 0x19, 0xE5, 0x19, 0xD3, 0x94, 0x04, 0x40, 0x04, 0xE5, 0x10, 0x80, 0x2F, 0xE5, 0x10, -+0x25, 0xE0, 0x24, 0x14, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xD3, -+0x94, 0x01, 0xEE, 0x94, 0x00, 0xE5, 0x10, 0x40, 0x14, 0x25, 0xE0, 0x24, 0x14, 0xF5, 0x82, 0xE4, -+0x34, 0x9D, 0xF5, 0x83, 0x74, 0xFF, 0xF5, 0xF0, 0x12, 0x48, 0x9F, 0x80, 0x0F, 0x25, 0xE0, 0x24, -+0x14, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0xBD, 0xE0, -+0x75, 0xF0, 0x04, 0x90, 0x42, 0x2D, 0x12, 0x49, 0x88, 0x12, 0x49, 0x5C, 0xE5, 0x10, 0x25, 0xE0, -+0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE5, 0x10, -+0x25, 0xE0, 0x24, 0x14, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, -+0x70, 0x33, 0xAF, 0x10, 0x12, 0x7E, 0x92, 0x80, 0x2C, 0x90, 0xA4, 0xBD, 0xE0, 0xFF, 0x25, 0xE0, -+0x24, 0x7D, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xD3, 0x74, 0x01, 0x93, 0x95, 0x18, 0xE4, -+0x93, 0x95, 0x17, 0x40, 0x10, 0xEF, 0x64, 0x36, 0x60, 0x04, 0x7D, 0x01, 0x80, 0x02, 0x7D, 0x09, -+0xAF, 0x10, 0x12, 0x83, 0x42, 0x74, 0x13, 0x25, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, -+0xE0, 0xB4, 0x01, 0x0C, 0x90, 0xA4, 0xBD, 0xE0, 0xB4, 0x3F, 0x05, 0xAF, 0x10, 0x12, 0x7E, 0x92, -+0x90, 0xA4, 0xC1, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, 0x9E, -+0xFC, 0xE5, 0x10, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xFA, -+0xA3, 0xE0, 0xD3, 0x9D, 0xEA, 0x9C, 0xE5, 0x10, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, -+0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x48, 0x9F, 0x80, 0x10, 0x25, 0xE0, 0x24, -+0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0xC3, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, 0x9E, 0xFC, 0xE5, 0x10, -+0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xFA, 0xA3, 0xE0, 0xD3, -+0x9D, 0xEA, 0x9C, 0xE5, 0x10, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, 0xE4, 0x34, 0x9F, -+0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x48, 0x9F, 0x80, 0x10, 0x25, 0xE0, 0x24, 0x94, 0xF5, 0x82, -+0xE4, 0x34, 0x9F, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xE4, 0xFD, 0xAF, 0x10, 0x12, 0x66, -+0x7F, 0x05, 0x10, 0xE5, 0x10, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x85, 0xDC, 0x22, 0x12, 0x26, -+0x1E, 0x54, 0x7F, 0xFF, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFE, 0x54, 0x1F, 0x90, 0xA4, 0x91, -+0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x90, 0xA4, 0x90, 0xF0, 0x90, 0x00, -+0x02, 0x12, 0x26, 0x37, 0xFE, 0x54, 0x03, 0xFD, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0xA4, -+0x93, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x90, 0xA4, 0x92, 0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFE, 0x90, 0x00, -+0x02, 0x12, 0x26, 0x37, 0x54, 0x08, 0xFC, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0xA4, 0x94, 0xF0, -+0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x9B, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0x90, 0xA4, 0x92, 0xE0, -+0xFE, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x9A, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0x90, 0xA4, 0x94, -+0xE0, 0x70, 0x79, 0x90, 0xA4, 0x91, 0xE0, 0xFE, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x95, 0x12, -+0x49, 0x88, 0xEE, 0xF0, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x97, 0x12, 0x49, 0x88, 0xED, 0xF0, -+0xFE, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x96, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0x90, 0xA4, 0x90, -+0xE0, 0xFE, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x98, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0x90, 0xA4, -+0x93, 0xE0, 0xFE, 0x75, 0xF0, 0x09, 0xEF, 0x90, 0x95, 0x99, 0x12, 0x49, 0x88, 0xEE, 0xF0, 0xE4, -+0xFE, 0xEE, 0xF5, 0x82, 0x75, 0x83, 0x00, 0xA3, 0xA3, 0xA3, 0x12, 0x26, 0x37, 0xFD, 0x75, 0xF0, -+0x08, 0xEF, 0x90, 0x89, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2E, 0xF5, 0x82, 0xE4, 0x35, 0x83, -+0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x04, 0xD8, 0x12, 0x63, 0xDB, 0x22, 0x12, 0x26, 0x1E, -+0xF5, 0x0F, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFF, 0x74, 0x13, 0x25, 0x0F, 0xF5, 0x82, 0xE4, -+0x34, 0x9B, 0xF5, 0x83, 0xEF, 0xF0, 0xE5, 0x0F, 0xC3, 0x94, 0x80, 0x50, 0x15, 0x90, 0x00, 0x02, -+0x12, 0x26, 0x37, 0xFF, 0x74, 0x93, 0x25, 0x0F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xEF, -+0xF0, 0x22, 0xE5, 0x0F, 0xB4, 0x80, 0x0A, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0x95, 0x91, -+0xF0, 0x22, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x38, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, -+0x58, 0x90, 0x00, 0x8D, 0xE0, 0x64, 0x03, 0x70, 0x50, 0x90, 0x00, 0x8F, 0xE0, 0xFE, 0x90, 0x00, -+0x8E, 0xE0, 0xFD, 0xED, 0xFF, 0x90, 0xA4, 0x80, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0xA4, -+0x7F, 0xF0, 0x90, 0xA4, 0x7F, 0xE0, 0xFD, 0xFF, 0x90, 0xA4, 0x81, 0xE0, 0x2F, 0xFF, 0x90, 0xA4, -+0x80, 0xE0, 0x34, 0x00, 0x8F, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x6B, 0x24, 0x90, -+0xA4, 0x7F, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD7, 0x90, 0x00, 0x8F, 0xE0, 0x30, -+0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA5, 0x93, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x49, 0x90, 0x00, 0x8D, -+0xE0, 0x64, 0x01, 0x70, 0x41, 0x90, 0xA5, 0x94, 0xF0, 0x90, 0xA5, 0x94, 0xE0, 0xFD, 0x90, 0xA5, -+0x93, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0x88, 0xE5, 0x82, 0x2D, 0xF5, 0x82, -+0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x6B, 0x24, 0x90, 0xA5, 0x94, 0xE0, -+0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD1, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, -+0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x00, 0x8F, 0xE0, 0x30, -+0xE5, 0x2A, 0x90, 0x00, 0x8E, 0xE0, 0x64, 0x05, 0x70, 0x22, 0xA3, 0xE0, 0xFF, 0x90, 0x00, 0x8E, -+0xE0, 0xFE, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0x00, -+0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8E, 0x12, 0x3A, 0x96, 0x22, 0xE4, 0xF5, 0x0D, -+0xE4, 0xF5, 0x0E, 0xE5, 0x0E, 0xB4, 0x03, 0x1E, 0xFF, 0xE5, 0x0D, 0xC4, 0x54, 0xF0, 0x24, 0x80, -+0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, -+0x83, 0x74, 0x40, 0xF0, 0x80, 0x1B, 0xE5, 0x0D, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, -+0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, -+0xF0, 0x05, 0x0E, 0xE5, 0x0E, 0xB4, 0x10, 0xBB, 0x05, 0x0D, 0xE5, 0x0D, 0xB4, 0x08, 0xB1, 0x22, -+0xA9, 0x07, 0x90, 0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, -+0xEA, 0x3E, 0xFE, 0xE9, 0x14, 0x60, 0x13, 0x14, 0x60, 0x10, 0x24, 0x02, 0x70, 0x14, 0xEE, 0x54, -+0xFE, 0xFE, 0xEF, 0x54, 0x7F, 0x90, 0x06, 0x68, 0x80, 0x04, 0x90, 0x06, 0x68, 0xEF, 0xF0, 0xEE, -+0xA3, 0xF0, 0x22, 0x90, 0xA5, 0x9B, 0xED, 0xF0, 0xEF, 0x14, 0x60, 0x23, 0x14, 0x70, 0x02, 0xC1, -+0xE4, 0x24, 0x02, 0x60, 0x02, 0xE1, 0x35, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, -+0xC3, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x00, 0x7F, 0xAC, 0xE1, 0x30, 0x90, -+0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, -+0x30, 0x02, 0x01, 0x12, 0x4F, 0x48, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x3C, -+0x12, 0x4F, 0x31, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0xA5, 0x9B, -+0xE0, 0x7E, 0x00, 0x78, 0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, -+0xE0, 0xFD, 0xFC, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x12, 0x4F, 0x4C, -+0x90, 0xA5, 0x9B, 0xE0, 0x90, 0xA4, 0xA8, 0xB4, 0x01, 0x13, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x10, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x80, 0x11, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0x10, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, -+0x7E, 0x0A, 0x80, 0x4E, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0xA4, -+0xAC, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x02, 0x12, 0x4F, 0x48, 0x90, 0xA4, 0xA8, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x3C, 0x12, 0x4F, 0x31, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0xF0, 0x00, -+0x00, 0x00, 0x90, 0xA5, 0x9B, 0xE0, 0x7E, 0x00, 0x78, 0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -+0xF9, 0xFF, 0xEE, 0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x48, 0x7F, 0x38, -+0x7E, 0x08, 0x12, 0x4F, 0x4C, 0x22, 0xEF, 0x14, 0x60, 0x3A, 0x14, 0x60, 0x53, 0x24, 0x02, 0x70, -+0x6C, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0xAA, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x0C, 0x00, 0x12, 0x4E, 0xD8, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x0C, 0x00, 0x90, 0xA4, 0xAA, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, -+0x7F, 0x01, 0x80, 0x36, 0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, -+0xAA, 0x12, 0x27, 0x54, 0x00, 0x00, 0x04, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x80, 0x1A, -+0x90, 0xA4, 0xA6, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0xA4, 0xAA, 0x12, 0x27, 0x54, -+0x00, 0x00, 0x00, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0x4E, 0xDE, 0x22, 0x90, 0xA4, -+0xA3, 0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x14, 0x90, 0xA5, 0x97, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x4E, 0x60, 0x20, 0xEF, 0x64, 0x01, 0x4E, 0x70, 0x1A, 0xFF, 0x80, 0x18, 0x90, 0xA4, 0xA3, 0xE0, -+0xD3, 0x94, 0x0E, 0x40, 0x0E, 0x90, 0xA5, 0x97, 0xE0, 0x70, 0x02, 0xA3, 0xE0, 0x70, 0x04, 0x7F, -+0x01, 0xF1, 0xE4, 0x22, 0x90, 0xA4, 0xA4, 0xEF, 0xF0, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x30, -+0x00, 0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, -+0xFE, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA4, 0xE0, 0x60, 0x02, 0x01, 0xC5, 0x90, 0xA4, 0xA8, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, -+0x7F, 0x2C, 0x7E, 0x08, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, -+0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, -+0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA4, 0xAC, 0x12, -+0x27, 0x54, 0x00, 0x00, 0x00, 0x70, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x70, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0xFF, -+0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x77, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, -+0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, 0x00, 0x90, 0xA4, 0xAC, -+0x12, 0x27, 0x54, 0x00, 0x77, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x4F, 0x4C, 0x90, 0x04, -+0x54, 0xE0, 0x54, 0x7F, 0x90, 0xA4, 0xA5, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0xE4, 0x90, 0xA5, -+0x97, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0xA4, 0xA4, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x21, 0x88, 0x90, -+0x04, 0x54, 0xE0, 0x44, 0x80, 0x90, 0xA4, 0xA5, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x90, 0xA4, -+0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, -+0x00, 0x01, 0x7F, 0x2C, 0x7E, 0x08, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0xF0, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x7F, 0xB0, 0x7E, -+0x0C, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0xA4, -+0xAC, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x4F, 0x4C, 0x90, -+0xA4, 0xA8, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, -+0x54, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, -+0x00, 0xFF, 0x00, 0x00, 0x90, 0xA4, 0xAC, 0x12, 0x27, 0x54, 0x00, 0x54, 0x00, 0x00, 0x7F, 0xB0, -+0x7E, 0x0E, 0x12, 0x4F, 0x4C, 0x90, 0xA4, 0xA8, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x90, -+0xA4, 0xAC, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x12, 0x4F, 0x4C, -+0x90, 0xA5, 0x97, 0xE4, 0xF0, 0xA3, 0x04, 0xF0, 0x22, 0xE4, 0xFE, 0xFC, 0xEF, 0x64, 0x02, 0x70, -+0x40, 0xED, 0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, 0xB4, 0x02, 0x02, 0x7E, 0x09, 0xEB, -+0xB4, 0x01, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, 0x38, 0xEB, 0xB4, 0x02, 0x08, 0xED, -+0xB4, 0x01, 0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x02, 0x04, 0x7C, -+0x01, 0x80, 0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, 0x02, 0x70, 0x16, 0x7C, 0x03, 0x80, -+0x12, 0xEF, 0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x06, 0xEB, 0xB4, 0x01, -+0x02, 0x7C, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, 0xFF, 0x22, 0xE4, 0x90, 0xA4, 0x39, -+0xF0, 0xA3, 0xF0, 0x90, 0xA4, 0x38, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, 0xF0, 0x90, 0xA4, 0x36, -+0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x90, 0xA4, 0x3F, 0x74, 0x01, 0xF0, -+0xA3, 0xF0, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, -+0xA4, 0x42, 0xF0, 0x90, 0xA4, 0x41, 0x74, 0x07, 0xF0, 0x90, 0xA4, 0x44, 0xE4, 0xF0, 0xA3, 0x74, -+0x02, 0xF0, 0xE4, 0x90, 0xA4, 0x3D, 0xF0, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA4, -+0x3B, 0x74, 0x0C, 0xF0, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0xA4, 0x3C, 0x74, 0x0C, -+0xF0, 0x90, 0xA4, 0x36, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, -+0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0xA4, 0x46, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, -+0x90, 0xA3, 0x14, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0xA4, 0x43, 0x74, 0xFF, 0xF0, 0x80, 0x12, 0x90, -+0xA3, 0x14, 0xE0, 0x90, 0xA4, 0x43, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x41, -+0xF0, 0x90, 0xA4, 0x4A, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x07, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, -+0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, -+0x12, 0x57, 0xD1, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x67, -+0x90, 0xA4, 0x3D, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, -+0x56, 0x90, 0xA4, 0x3B, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, -+0xF0, 0x80, 0x44, 0xEF, 0x30, 0xE2, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x38, 0x90, -+0xA4, 0x3D, 0xE0, 0x30, 0xE4, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x29, 0x90, 0xA4, -+0x37, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x20, 0xF0, 0x80, -+0x16, 0x90, 0xA4, 0x51, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x80, 0xF0, 0x80, 0x08, 0x90, -+0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x7F, 0x00, 0x22, -+0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0xA4, 0x3C, -+0x74, 0x02, 0xF0, 0x22, 0x90, 0xA4, 0x39, 0xE0, 0x60, 0x39, 0x90, 0xA3, 0xB6, 0xE0, 0x64, 0x01, -+0x70, 0x31, 0x90, 0xA4, 0x40, 0xF0, 0x04, 0x60, 0x2A, 0x90, 0xA4, 0x3D, 0xE0, 0x44, 0x10, 0xF0, -+0xE4, 0xF5, 0x3B, 0x90, 0xA4, 0x41, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, -+0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA4, 0x3C, 0xE0, 0x20, 0xE2, 0x03, -+0x12, 0x50, 0x4D, 0x22, 0x90, 0xA4, 0x36, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x11, -+0xEF, 0x54, 0xFB, 0xF0, 0x90, 0xA4, 0x3D, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x42, 0x80, -+0x3D, 0x90, 0xA4, 0x42, 0xE0, 0x04, 0xF0, 0x90, 0xA4, 0x3D, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0xA4, -+0x42, 0xE0, 0xFF, 0xB4, 0x01, 0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, 0x06, 0x90, 0x05, 0x58, 0xE0, -+0x04, 0xF0, 0x90, 0xA4, 0x4A, 0xE0, 0xFF, 0x90, 0xA4, 0x42, 0xE0, 0xD3, 0x9F, 0x40, 0x0F, 0x90, -+0xA3, 0xB6, 0xE0, 0xB4, 0x01, 0x0B, 0x90, 0xA4, 0x37, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x12, 0x50, -+0x44, 0x22, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0xA3, 0xB3, -+0xE0, 0x9B, 0x90, 0xA3, 0xB2, 0xE0, 0x9A, 0x50, 0x13, 0xA3, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0xA3, -+0xB2, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, -+0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFF, 0x22, -+0x4D, 0xC2, -+}; -+ -+static u4Byte ArrayLength_TC_8812A_FW_NIC = 21570; -+ -+static void -+ODM_ReadFirmware_TC_8812A_FW_NIC( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+) -+{ -+ ODM_MoveMemory(pDM_Odm, pFirmware, Array_TC_8812A_FW_NIC, ArrayLength_TC_8812A_FW_NIC); -+ *pFirmwareSize = ArrayLength_TC_8812A_FW_NIC; -+} -+ -+ -+static u1Byte Array_TC_8812A_FW_WoWLAN[] = { -+0x01, 0x95, 0xFF, 0x00, 0x0A, 0x00, 0x00, 0x00, 0x12, 0x11, 0x21, 0x11, 0xF6, 0x47, 0x00, 0x00, -+0x39, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x4B, 0x2A, 0x02, 0x68, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x5C, 0xD8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x6C, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x68, 0xAF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x69, 0x38, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, -+0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, -+0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, -+0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, -+0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, -+0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, -+0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, -+0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, -+0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, -+0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, -+0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, -+0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, -+0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, -+0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, -+0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, -+0x82, 0x23, 0x90, 0x45, 0x50, 0x73, 0xBB, 0x01, 0x09, 0x89, 0x82, 0x8A, 0x83, 0xF8, 0xE0, 0x28, -+0xF0, 0x22, 0x50, 0x03, 0x27, 0xF7, 0x22, 0xBB, 0xFE, 0x05, 0xF8, 0xE3, 0x28, 0xF3, 0x22, 0x8A, -+0x83, 0x89, 0x82, 0xF8, 0xE4, 0x93, 0x28, 0x22, 0xBB, 0x01, 0x0F, 0xF8, 0xE5, 0x82, 0x29, 0xF5, -+0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0xE0, 0x28, 0xF0, 0x22, 0x50, 0x09, 0xC5, 0x82, 0x29, 0xF8, -+0xE5, 0x82, 0x26, 0xF6, 0x22, 0xBB, 0xFE, 0x09, 0xC5, 0x82, 0x29, 0xF8, 0xE2, 0x25, 0x82, 0xF2, -+0x22, 0xF8, 0xEA, 0x25, 0x83, 0xF5, 0x83, 0xE9, 0x93, 0x28, 0x22, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, -+0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, -+0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, -+0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, -+0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, -+0xE0, 0xFB, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, -+0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, -+0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, -+0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, -+0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xE3, 0xF5, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, -+0xDF, 0xF5, 0x80, 0x67, 0xE3, 0xF5, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, -+0x5A, 0x87, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x52, 0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, -+0xE2, 0x08, 0xB5, 0xF0, 0x46, 0xDF, 0xF6, 0x80, 0x42, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, -+0xE0, 0xA3, 0xB5, 0xF0, 0x36, 0xDF, 0xF6, 0x80, 0x32, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, -+0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x25, 0xDF, 0xF5, 0x80, 0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, -+0xF0, 0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x14, 0xDF, 0xF5, 0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, -+0xF5, 0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x02, 0xDF, 0xF4, 0x02, 0x48, 0x06, 0x80, 0x87, -+0x80, 0xE9, 0x80, 0x90, 0x80, 0xD4, 0x80, 0x3E, 0x80, 0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, -+0x80, 0xB7, 0x80, 0x8D, 0x80, 0xA3, 0x80, 0x51, 0x80, 0x74, 0x80, 0x3C, 0x02, 0x48, 0x12, 0x89, -+0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, -+0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, -+0xDF, 0xE3, 0xDE, 0xE1, 0x80, 0x70, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, -+0x08, 0xB5, 0xF0, 0x62, 0xDF, 0xF4, 0x80, 0x5E, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, -+0xE6, 0x08, 0xB5, 0xF0, 0x51, 0xDF, 0xF5, 0x80, 0x4D, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, -+0xA3, 0xE2, 0x08, 0xB5, 0xF0, 0x40, 0xDF, 0xF5, 0x80, 0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, -+0xF5, 0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x2E, 0xDF, 0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, -+0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, -+0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, -+0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0x00, 0x7F, 0xFF, 0xB5, 0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, -+0x01, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, -+0xD5, 0xDF, 0xE5, 0xDE, 0xE3, 0x80, 0xCF, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, -+0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xAF, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, -+0x60, 0x01, 0x0E, 0x4E, 0x60, 0xAB, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, -+0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x8E, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x47, 0x4E, -+0x73, 0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x48, 0x85, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, -+0xE0, 0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, -+0x8C, 0xEC, 0x24, 0x8B, 0xF8, 0xE6, 0xBC, 0x04, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, -+0x00, 0x40, 0xCE, 0x79, 0x05, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, -+0xE1, 0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, -+0xFF, 0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x05, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, -+0x30, 0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x8A, 0x25, 0x0C, -+0xF8, 0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x04, 0x02, 0x74, 0xFF, 0xCD, 0xF8, -+0xE8, 0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, -+0xE5, 0x0C, 0x24, 0x8B, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x04, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, -+0xCD, 0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, -+0x8A, 0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, -+0xAF, 0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, -+0x7F, 0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x8A, -+0xA6, 0x81, 0x74, 0x04, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x05, 0xE4, 0x78, -+0x80, 0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4B, 0xC7, 0x74, 0x01, -+0x93, 0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, -+0xD2, 0x8C, 0xD2, 0xAF, 0x22, 0x04, 0xEF, 0xD3, 0x94, 0x04, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, -+0x81, 0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, -+0xAE, 0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x8A, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, -+0x18, 0xBE, 0x04, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, -+0x09, 0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, -+0x81, 0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x8A, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, -+0x02, 0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, -+0x09, 0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x8A, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, -+0x2F, 0x04, 0x90, 0x4B, 0xC7, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, -+0xD3, 0x94, 0x04, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, -+0xF4, 0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x8A, -+0x2F, 0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x48, 0xCE, 0x50, 0x2E, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xBF, -+0x04, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x8A, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, -+0x6C, 0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, -+0xE5, 0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, -+0x01, 0x0F, 0x74, 0x8A, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, -+0xAC, 0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, -+0xB5, 0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x04, 0x40, 0x03, 0x7F, 0xFF, -+0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, -+0xE4, 0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x48, 0xCD, 0x8F, -+0xF0, 0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, -+0x08, 0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, 0x2E, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, -+0xF6, 0x60, 0x25, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, -+0x30, 0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, -+0xEC, 0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x48, 0xCE, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, -+0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0x02, 0x4B, 0x68, 0x02, 0x49, 0x5E, -+0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, -+0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, -+0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, -+0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4B, 0xAD, 0xE4, 0x7E, 0x01, 0x93, 0x60, -+0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, -+0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, -+0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, -+0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0x00, 0x41, 0x90, -+0x93, 0x00, 0x41, 0x90, 0x94, 0x00, 0x41, 0x90, 0x95, 0x00, 0x42, 0x90, 0xA2, 0x00, 0x00, 0x41, -+0x90, 0xA4, 0x00, 0x41, 0x90, 0xA5, 0x00, 0x4C, 0xD5, 0x4F, 0xF3, 0x58, 0x15, 0x5F, 0xED, 0x62, -+0x70, 0x90, 0x00, 0xF0, 0xE0, 0x7F, 0x01, 0x20, 0xE2, 0x02, 0x7F, 0x03, 0x22, 0x71, 0xD1, 0x90, -+0x8D, 0x01, 0xEF, 0xF0, 0x71, 0xEF, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x02, 0x35, 0x95, 0x91, -+0x74, 0x91, 0xA4, 0x91, 0x11, 0x91, 0x30, 0x91, 0x4F, 0xE4, 0xF5, 0x51, 0x75, 0x52, 0x58, 0xAB, -+0x51, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x52, 0x7D, 0x03, 0x7F, 0x01, 0x02, 0x39, -+0x04, 0x75, 0x5D, 0x10, 0xE4, 0xF5, 0x5E, 0x75, 0x5F, 0x07, 0x75, 0x60, 0x42, 0x90, 0x01, 0x30, -+0xE5, 0x5D, 0xF0, 0xA3, 0xE5, 0x5E, 0xF0, 0xA3, 0xE5, 0x5F, 0xF0, 0xA3, 0xE5, 0x60, 0xF0, 0x22, -+0x75, 0x65, 0x0E, 0x75, 0x66, 0x01, 0x75, 0x67, 0x03, 0x75, 0x68, 0x62, 0x90, 0x01, 0x38, 0xE5, -+0x65, 0xF0, 0xA3, 0xE5, 0x66, 0xF0, 0xA3, 0xE5, 0x67, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x22, 0xE4, -+0xF5, 0x55, 0xF5, 0x56, 0xF5, 0x57, 0xF5, 0x58, 0xAD, 0x55, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xAD, -+0x56, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xAD, 0x57, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xAD, 0x58, 0x7F, -+0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x30, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, -+0x01, 0x38, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x3A, 0x96, 0xE4, -+0xFD, 0x7F, 0x51, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x3A, 0x96, 0xE4, 0xFD, 0x7F, -+0x53, 0x02, 0x3A, 0x96, 0x90, 0x01, 0x34, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, -+0x90, 0x01, 0x3C, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, 0x3A, 0x96, -+0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0x7D, 0xFF, -+0x7F, 0x57, 0x02, 0x3A, 0x96, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x3A, -+0x96, 0xF1, 0xE1, 0x12, 0x3A, 0xB8, 0x12, 0x6D, 0x88, 0x7F, 0x01, 0x31, 0x96, 0x90, 0x8F, 0x57, -+0x74, 0x02, 0xF0, 0xFF, 0x31, 0x96, 0x90, 0x8F, 0x57, 0xE0, 0x04, 0xF0, 0x7F, 0x03, 0x31, 0x96, -+0x90, 0x8F, 0x57, 0xE0, 0x04, 0xF0, 0x7F, 0x04, 0x31, 0x96, 0x90, 0x8F, 0x57, 0xE0, 0x04, 0xF0, -+0x71, 0xDD, 0xB1, 0x2E, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x3A, 0x96, -+0x75, 0x28, 0xFF, 0xF1, 0xD2, 0x12, 0x6D, 0xB8, 0xF1, 0xE9, 0xE4, 0xFF, 0x41, 0x1F, 0xF1, 0xCC, -+0xF1, 0xD9, 0x12, 0x7F, 0x5A, 0xB1, 0x4D, 0x12, 0x77, 0x8F, 0x90, 0x8F, 0x5B, 0xE0, 0x54, 0xFE, -+0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x8E, 0x40, -+0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x45, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x06, 0x90, 0xE0, 0x44, -+0x20, 0xF0, 0x90, 0x8E, 0x41, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, -+0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, -+0x54, 0x80, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x42, 0xE0, 0x54, -+0x7F, 0xF0, 0x90, 0x8E, 0x44, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xEF, 0x60, 0x54, 0x90, 0x8F, 0x4D, -+0xE0, 0xFF, 0x60, 0x03, 0x12, 0x7C, 0x8B, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x90, 0x01, 0x17, 0xE0, -+0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8D, 0x9F, 0xF0, -+0xA3, 0xEF, 0xF0, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, -+0x12, 0x55, 0xAD, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0xD1, 0x0A, 0xF1, 0xCA, 0x12, 0x54, -+0x74, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, 0xFF, 0x80, -+0x2A, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x5B, 0x04, 0x90, 0x06, 0x90, 0xE4, 0xF0, 0x90, 0x02, 0x86, -+0xE0, 0x54, 0xFB, 0xF0, 0xF1, 0xA7, 0xF1, 0xCB, 0xA1, 0x4D, 0x12, 0x66, 0x7A, 0x90, 0x02, 0x87, -+0xE0, 0x70, 0xF7, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, -+0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, -+0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, 0xD1, 0x1B, 0x7D, -+0x02, 0x7F, 0x03, 0xD1, 0x1B, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0xF0, 0x90, 0x8E, 0x32, 0xA3, -+0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x8D, 0xA3, 0xE0, 0xB4, 0x01, 0x15, 0x90, 0x8E, 0x25, 0xE0, -+0x54, 0xFB, 0xF0, 0x90, 0x8E, 0x2A, 0xE0, 0x20, 0xE2, 0x0E, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x51, -+0xB1, 0x90, 0x8E, 0x25, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x12, 0x81, 0x79, 0x90, 0x8E, 0x2D, 0xE0, -+0x14, 0x90, 0x05, 0x73, 0xF0, 0x7D, 0x02, 0x7F, 0x02, 0xD1, 0x1B, 0x90, 0x8F, 0x58, 0xE0, 0x30, -+0xE0, 0x2D, 0x90, 0x8D, 0xA3, 0xE0, 0xB4, 0x01, 0x26, 0x90, 0x90, 0xA4, 0xE0, 0x04, 0xF0, 0xE0, -+0xB4, 0x0A, 0x0B, 0x90, 0x8F, 0x5A, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x90, 0xA4, 0xF0, 0x90, 0x8F, -+0x5A, 0xE0, 0xFF, 0x90, 0x8F, 0x59, 0xE0, 0xB5, 0x07, 0x05, 0xE4, 0xA3, 0xF0, 0xD1, 0xC0, 0x22, -+0xE4, 0xFF, 0x8F, 0x0D, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, 0xE0, 0xF5, 0x10, -+0x74, 0xFF, 0xF0, 0x12, 0x70, 0x22, 0xBF, 0x01, 0x03, 0x12, 0x81, 0xB9, 0x90, 0x05, 0x22, 0xE5, -+0x10, 0xF0, 0x80, 0x03, 0x12, 0x81, 0xB9, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0x22, -+0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0x3F, 0xF0, 0xEF, 0x60, -+0x1D, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x74, -+0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x74, 0x29, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xEF, 0xF0, 0x74, 0x09, 0x2D, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x90, 0x9B, 0xED, 0xF0, 0x90, 0x90, 0x9A, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, -+0x7C, 0xEA, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x90, 0x9A, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x90, -+0x9B, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, -+0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, -+0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, -+0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0xAE, 0x04, -+0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xB1, 0x62, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x90, -+0x8D, 0x01, 0xE0, 0xFF, 0xB4, 0x01, 0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xEF, 0xF0, 0xEF, 0xB4, -+0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x22, 0x22, 0xE4, 0x90, 0x8D, 0xA3, -+0xF0, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, 0x85, 0x22, 0xE4, 0x90, 0x8D, 0x9D, 0xF0, 0xA3, 0xF0, -+0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x0A, 0xF0, 0xA3, -+0xE4, 0xF0, 0x22, 0xE4, 0x90, 0x8F, 0x62, 0xF0, 0x90, 0x8F, 0x62, 0xE0, 0x64, 0x01, 0xF0, 0x24, -+0xF3, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x4F, 0xA3, 0xF0, 0x12, 0x3A, 0xEB, 0xBF, 0x01, 0x03, 0x12, -+0x31, 0x69, 0x90, 0x8E, 0x2A, 0xE0, 0xFF, 0x90, 0x8E, 0x29, 0xE0, 0x6F, 0x60, 0x02, 0x31, 0xA4, -+0x12, 0x6E, 0x0E, 0xBF, 0x01, 0x02, 0xF1, 0x54, 0x90, 0x8E, 0x2A, 0xE0, 0x90, 0x01, 0xBC, 0xF0, -+0x90, 0x8D, 0xA3, 0xE0, 0x90, 0x01, 0xBD, 0xF0, 0x11, 0x3F, 0x12, 0x48, 0xCE, 0x80, 0xB9, 0x11, -+0x92, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x90, 0x43, 0xF0, 0x90, 0x01, -+0xC7, 0xE0, 0x64, 0xAD, 0x70, 0x37, 0xF0, 0x90, 0x90, 0x50, 0x74, 0x0F, 0xF0, 0x90, 0x90, 0x42, -+0x74, 0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x90, 0x43, 0xE0, 0x2F, 0xFE, 0x74, 0x44, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x0F, 0xE9, 0x90, 0x01, -+0x3F, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x42, 0x12, 0x60, 0xD3, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x90, 0x97, 0xF0, 0x90, 0x00, -+0x8F, 0xE0, 0x20, 0xE6, 0x02, 0x21, 0x6E, 0x90, 0x00, 0x8D, 0xE0, 0x90, 0x90, 0x96, 0xF0, 0x90, -+0x00, 0x8C, 0xE0, 0x90, 0x90, 0x97, 0xF0, 0x90, 0x90, 0x96, 0xE0, 0x24, 0xF8, 0x60, 0x02, 0x21, -+0x60, 0x90, 0x8E, 0x27, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x31, 0x7C, 0x90, 0x8E, 0x26, 0xE0, 0x54, -+0x0F, 0xFB, 0x0D, 0x31, 0x7C, 0x90, 0x8E, 0x29, 0xE0, 0xFB, 0x0D, 0x31, 0x7C, 0x90, 0x8E, 0x2A, -+0xE0, 0xFB, 0x0D, 0x31, 0x7C, 0x90, 0x90, 0x97, 0xE0, 0x24, 0xA3, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -+0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x31, 0x7C, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0x01, 0xFB, -+0x0D, 0x31, 0x7C, 0x90, 0x8E, 0x24, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, -+0x31, 0x7C, 0x90, 0x8E, 0x24, 0xE0, 0xC4, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0x31, 0x7C, 0x90, -+0x8E, 0x30, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x31, 0x7C, 0x90, 0x8E, 0x2F, 0xE0, 0xFB, 0x0D, 0x31, -+0x7C, 0x90, 0x8E, 0x2E, 0xE0, 0xFB, 0x0D, 0x31, 0x7C, 0x90, 0x8E, 0x2D, 0xE0, 0xFB, 0x0D, 0x31, -+0x7C, 0x90, 0x8E, 0x26, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, 0xE4, 0xFD, 0x7F, 0x03, 0x31, 0x7C, 0x90, -+0x8E, 0x25, 0x31, 0x73, 0x90, 0x8E, 0x25, 0xE0, 0x13, 0x31, 0x74, 0x90, 0x8E, 0x24, 0x31, 0x73, -+0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x3A, 0x96, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0xEF, 0x70, 0x04, 0x74, -+0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, -+0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, -+0x83, 0xEB, 0xF0, 0x22, 0x90, 0x8E, 0x29, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x04, 0x7D, 0x01, 0x7F, -+0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0xA6, 0xED, 0xF0, 0x90, 0x8E, 0x2A, -+0xE0, 0x90, 0x90, 0xA7, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, -+0xE0, 0x02, 0x61, 0x02, 0xEE, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x02, 0x61, 0x02, -+0x90, 0x90, 0xA7, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x61, 0x02, 0xEF, 0x70, 0x02, 0x41, 0x79, 0x24, -+0xFE, 0x70, 0x02, 0x41, 0xB2, 0x24, 0xFE, 0x60, 0x48, 0x24, 0xFC, 0x70, 0x02, 0x41, 0xED, 0x24, -+0xFC, 0x60, 0x02, 0x61, 0x02, 0xEE, 0xB4, 0x0E, 0x02, 0x71, 0x82, 0x90, 0x90, 0xA7, 0xE0, 0x70, -+0x04, 0x7F, 0x01, 0x71, 0xAA, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x5C, 0x90, 0x90, -+0xA7, 0xE0, 0xB4, 0x04, 0x0E, 0x90, 0x90, 0xA6, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x81, 0x23, 0x80, -+0x02, 0xD1, 0x9E, 0x90, 0x90, 0xA7, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x61, 0x02, 0x91, 0x6B, 0x61, -+0x02, 0x90, 0x90, 0xA7, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x71, 0xAA, 0x90, 0x90, 0xA7, 0xE0, 0xB4, -+0x06, 0x02, 0x71, 0x5C, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x0E, 0x07, 0x71, 0x07, 0xBF, 0x01, 0x02, -+0x71, 0x82, 0x90, 0x90, 0xA7, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x61, 0x02, 0x71, 0x07, 0xEF, 0x64, -+0x01, 0x60, 0x02, 0x61, 0x02, 0x71, 0xC3, 0x61, 0x02, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x0E, 0x07, -+0x71, 0x07, 0xBF, 0x01, 0x02, 0x71, 0x82, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x5C, -+0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x0C, 0x07, 0x71, 0x07, 0xBF, 0x01, 0x02, 0x71, 0xC3, 0x90, 0x90, -+0xA7, 0xE0, 0x64, 0x04, 0x70, 0x5C, 0x12, 0x80, 0x60, 0xEF, 0x64, 0x01, 0x70, 0x54, 0xD1, 0x81, -+0x80, 0x50, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x0E, 0x07, 0x71, 0x07, 0xBF, 0x01, 0x02, 0x71, 0x82, -+0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x5C, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x0C, 0x07, -+0x71, 0x07, 0xBF, 0x01, 0x02, 0x71, 0xC3, 0x90, 0x90, 0xA7, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x71, -+0xAA, 0x90, 0x90, 0xA7, 0xE0, 0xB4, 0x04, 0x1A, 0x12, 0x81, 0x65, 0x80, 0x15, 0x90, 0x90, 0xA7, -+0xE0, 0xB4, 0x0C, 0x0E, 0x90, 0x8E, 0x25, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x02, -+0x91, 0x62, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0x8F, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, -+0xB8, 0x74, 0x01, 0xF0, 0x80, 0x3D, 0x90, 0x8E, 0x24, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x28, 0xEF, 0xC4, 0x54, 0x0F, 0x30, -+0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x19, 0x90, 0x8E, 0x29, 0xE0, 0xD3, 0x94, -+0x04, 0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, -+0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x8E, 0x25, 0xE0, -+0x90, 0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x04, 0xF0, -+0x80, 0x0A, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x0C, 0xF0, 0x90, 0x05, 0x22, 0xE4, -+0xF0, 0x22, 0x90, 0x8E, 0x25, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0x90, 0x8E, 0x2A, 0x74, 0x0C, -+0xF0, 0x80, 0x11, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8E, -+0x2A, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0x90, 0xAB, 0xEF, 0xF0, 0x91, -+0x74, 0x90, 0x90, 0xAB, 0xE0, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x2A, 0x74, -+0x04, 0xF0, 0x22, 0x90, 0x8D, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x2E, 0x90, 0x8E, 0x25, 0xE0, 0x54, -+0xFD, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x7F, 0x01, 0x12, 0x4E, 0xC2, 0xBF, 0x01, 0x0E, -+0x90, 0x8E, 0x24, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x0E, 0xF0, 0x22, 0x90, 0x01, -+0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x22, 0x90, 0x8E, 0x27, 0xE0, 0x64, 0x01, -+0x70, 0x5F, 0x90, 0x8E, 0x26, 0xE0, 0x54, 0x0F, 0x60, 0x4F, 0x90, 0x8E, 0x2A, 0xE0, 0x70, 0x03, -+0xFF, 0x71, 0xAA, 0x90, 0x8E, 0x2A, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xD1, 0x9E, 0x90, 0x01, 0x5B, -+0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xF1, 0x8F, 0xEF, 0x64, 0x01, 0x70, 0x32, 0xF5, -+0x3B, 0x90, 0x8E, 0x3A, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, -+0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5B, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x01, -+0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x8E, 0x2A, 0xE0, 0x70, 0x02, 0x31, -+0xAD, 0x22, 0xB1, 0xAD, 0x90, 0x8E, 0x2A, 0x74, 0x08, 0xF0, 0x22, 0x91, 0x74, 0x90, 0x8E, 0x2A, -+0x74, 0x0C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8E, 0x34, 0x12, 0x46, -+0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0x8E, -+0x34, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, -+0x5D, 0x90, 0x00, 0x10, 0xE0, 0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x12, 0x3A, 0x96, 0x90, 0x00, 0x72, -+0xE0, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x3A, 0x96, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, -+0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, -+0x86, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xBF, 0xFF, 0xEC, 0x90, 0x90, -+0x7D, 0x12, 0x27, 0x48, 0x90, 0x90, 0x7D, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, -+0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, -+0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0x90, 0x7D, 0x12, 0x27, 0x48, -+0x90, 0x90, 0x7D, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0C, -+0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, -+0x90, 0x7D, 0x12, 0x27, 0x48, 0x90, 0x90, 0x7D, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, -+0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x27, 0x7B, 0x01, -+0x7A, 0x90, 0x79, 0x81, 0xB1, 0x7A, 0x90, 0x90, 0x81, 0xE0, 0x54, 0xE7, 0xFB, 0x7F, 0x01, 0xF1, -+0xE6, 0x7B, 0x01, 0x7F, 0x01, 0xB1, 0x7E, 0x90, 0x90, 0x81, 0xE0, 0x54, 0x18, 0x70, 0x06, 0x90, -+0x01, 0xBF, 0xE0, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x08, 0x7F, 0x01, 0xEF, 0x70, -+0x04, 0x7E, 0x01, 0x80, 0x07, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x7E, 0x40, 0x90, 0x00, 0xE2, 0xED, -+0xF0, 0xA3, 0xEE, 0xF0, 0x90, 0x00, 0xE1, 0xE0, 0x12, 0x26, 0x64, 0x90, 0x00, 0xE3, 0xE4, 0xF0, -+0x7F, 0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x00, 0x22, 0x12, 0x70, 0x22, -+0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0x90, 0x83, 0x12, -+0x27, 0x48, 0x90, 0x90, 0x83, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0x00, -+0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x36, 0xCE, 0xEF, 0x54, 0xFC, 0xFF, -+0xEC, 0x90, 0x90, 0x83, 0x12, 0x27, 0x48, 0x90, 0x90, 0x83, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, -+0x12, 0x27, 0x48, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0x02, 0xE0, 0x54, 0xFE, -+0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x36, 0xCE, 0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0x90, 0x83, -+0x12, 0x27, 0x48, 0x90, 0x90, 0x83, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, -+0xB4, 0x7E, 0x08, 0x12, 0x37, 0x5D, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, -+0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x7F, 0xB0, 0x7E, 0x0C, 0x12, 0x36, 0xCE, 0x90, -+0x8E, 0x34, 0x12, 0x27, 0x48, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, 0x7F, -+0xB0, 0x7E, 0x0C, 0x12, 0x37, 0x5D, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x54, 0x77, 0x77, 0x77, 0x77, -+0x7F, 0xB0, 0x7E, 0x0E, 0x12, 0x37, 0x5D, 0x90, 0x00, 0xFF, 0xE0, 0x70, 0x13, 0x7B, 0x01, 0x7A, -+0x90, 0x79, 0x82, 0xB1, 0x7A, 0x90, 0x90, 0x82, 0xE0, 0x44, 0x18, 0xFB, 0x7F, 0x01, 0xF1, 0xE6, -+0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x12, 0x70, 0x22, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, -+0xFD, 0x7F, 0x03, 0x12, 0x4E, 0x1B, 0xB1, 0xAD, 0xE4, 0x90, 0x8E, 0x2A, 0xF0, 0x22, 0x90, 0x06, -+0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x0C, 0xF0, -+0x22, 0x90, 0x8F, 0x71, 0x12, 0x46, 0xA8, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0xFE, 0x12, -+0x26, 0x1E, 0xFD, 0xC3, 0x13, 0x30, 0xE0, 0x12, 0x90, 0x8F, 0x71, 0x12, 0x46, 0x9F, 0x90, 0x00, -+0x02, 0x12, 0x26, 0x37, 0x90, 0x8F, 0x75, 0xF0, 0x80, 0x05, 0x90, 0x8F, 0x75, 0xEF, 0xF0, 0x90, -+0x8F, 0x74, 0xEE, 0xF0, 0x90, 0x8F, 0x75, 0xE0, 0xFE, 0x90, 0x8F, 0x74, 0xE0, 0xFF, 0xD3, 0x9E, -+0x50, 0x38, 0x90, 0x8F, 0x71, 0x12, 0x46, 0x9F, 0x12, 0x26, 0x1E, 0x54, 0x01, 0xFE, 0x74, 0xA3, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0xA3, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x8D, 0xF5, 0x83, 0xE0, 0x70, 0x04, 0xF1, 0xD2, 0x80, 0x07, 0x90, 0x8F, 0x74, 0xE0, 0xFF, -+0xF1, 0xCF, 0x90, 0x8F, 0x74, 0xE0, 0x04, 0xF0, 0x80, 0xBA, 0x90, 0x8D, 0xA3, 0xE0, 0x70, 0x23, -+0x90, 0x8E, 0x2A, 0xE0, 0x70, 0x03, 0xFF, 0x71, 0xAA, 0x90, 0x8E, 0x2A, 0xE0, 0x64, 0x0C, 0x60, -+0x02, 0xD1, 0x9E, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xBF, 0xF0, -+0x54, 0x7F, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8E, 0x24, 0xE0, 0x30, -+0xE0, 0x02, 0xF1, 0x69, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8E, 0x2A, 0xE0, 0x70, 0x0E, 0x12, -+0x80, 0xE0, 0xBF, 0x01, 0x08, 0xF1, 0x7E, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x70, 0xC2, 0xF1, 0xA8, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, -+0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0xF1, 0xD5, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, -+0xFD, 0x7F, 0x08, 0x12, 0x3A, 0x96, 0xE4, 0xFF, 0x12, 0x70, 0x6A, 0x90, 0x8D, 0x01, 0xE0, 0xB4, -+0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x70, 0x12, 0x3A, 0x96, 0x22, 0x8F, -+0x11, 0x22, 0x8F, 0x11, 0x22, 0x90, 0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x22, 0x90, 0x8E, 0x27, -+0xE0, 0x60, 0x02, 0x71, 0xFA, 0x22, 0xEF, 0x70, 0x04, 0x7E, 0x03, 0x80, 0x07, 0xEF, 0x64, 0x01, -+0x70, 0x19, 0x7E, 0x42, 0x90, 0x00, 0xE2, 0xED, 0xF0, 0x90, 0x00, 0xE0, 0xEB, 0xF0, 0x90, 0x00, -+0xE3, 0xEE, 0xF0, 0x54, 0xFD, 0xF0, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC2, 0xE0, 0x44, -+0x01, 0xF0, 0x7F, 0x00, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x4A, 0xCF, 0x90, 0x8F, -+0x63, 0xEF, 0xF0, 0x60, 0xF0, 0x11, 0x29, 0x80, 0xEC, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0x8F, 0x64, 0xF0, 0x90, 0x8F, 0x64, 0xE0, 0xFD, 0x70, -+0x02, 0x21, 0x53, 0x90, 0x90, 0x93, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, -+0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, 0x4C, 0x90, -+0x90, 0x93, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, 0x65, -+0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, 0x8F, 0x75, 0x42, 0x65, 0x75, 0x43, 0x01, 0x7B, 0x01, 0x7A, -+0x8F, 0x79, 0x66, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x93, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD1, -+0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, 0x67, 0xF0, 0x90, 0x90, 0x93, 0xE0, 0x75, 0xF0, 0x04, 0x90, -+0x01, 0xD2, 0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, 0x68, 0xF0, 0x90, 0x90, 0x93, 0xE0, 0x75, 0xF0, -+0x04, 0x90, 0x01, 0xD3, 0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, 0x69, 0xF0, 0x90, 0x90, 0x93, 0xE0, -+0x75, 0xF0, 0x04, 0x90, 0x01, 0xF0, 0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, 0x6A, 0xF0, 0x90, 0x90, -+0x93, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF1, 0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, 0x6B, 0xF0, -+0x90, 0x90, 0x93, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF2, 0x12, 0x46, 0x93, 0xE0, 0x90, 0x8F, -+0x6C, 0xF0, 0x90, 0x90, 0x93, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF3, 0x12, 0x46, 0x93, 0xE0, -+0x90, 0x8F, 0x6D, 0xF0, 0x90, 0x8F, 0x64, 0xE0, 0xFF, 0x90, 0x90, 0x93, 0xE0, 0xFE, 0x74, 0x01, -+0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0x8F, 0x64, 0xF0, 0x90, -+0x90, 0x93, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, -+0x01, 0xCC, 0xF0, 0x90, 0x8F, 0x66, 0xE0, 0xFF, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x67, 0x31, 0x58, -+0x90, 0x90, 0x93, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x01, 0x3A, 0x90, 0x01, 0xC0, 0xE0, -+0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0xA8, 0xEF, 0x12, -+0x46, 0xB1, 0x59, 0x90, 0x00, 0x59, 0x99, 0x01, 0x59, 0xA2, 0x02, 0x59, 0xAB, 0x03, 0x59, 0xB4, -+0x04, 0x59, 0xBD, 0x20, 0x59, 0xC5, 0x21, 0x59, 0xCE, 0x23, 0x59, 0xD6, 0x25, 0x59, 0xE6, 0x80, -+0x59, 0xDE, 0x81, 0x59, 0xEF, 0x82, 0x59, 0xF8, 0x83, 0x5A, 0x01, 0x84, 0x00, 0x00, 0x5A, 0x0A, -+0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x6C, 0x58, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, -+0x56, 0xB1, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x6C, 0xA0, 0x90, 0x8F, 0x6E, 0x12, 0x46, -+0x9F, 0x02, 0x77, 0xA1, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x7F, 0x2D, 0x90, 0x8F, 0x6E, -+0x12, 0x46, 0x9F, 0x80, 0x4D, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x6C, 0xD8, 0x90, 0x8F, -+0x6E, 0x12, 0x46, 0x9F, 0xE1, 0xC8, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0xE1, 0xDD, 0x90, 0x8F, -+0x6E, 0x12, 0x46, 0x9F, 0xC1, 0xB3, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x77, 0xC1, 0x90, -+0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x7E, 0x4E, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x7E, -+0x68, 0x90, 0x8F, 0x6E, 0x12, 0x46, 0x9F, 0x02, 0x7E, 0xCA, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, -+0xF0, 0x22, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x7F, 0x90, 0x8E, 0x27, 0xF0, 0xEF, 0xC4, 0x13, 0x13, -+0x13, 0x54, 0x01, 0xA3, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0x54, 0xF0, 0xC4, 0x54, -+0x0F, 0xFE, 0x90, 0x8E, 0x26, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, -+0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, -+0xC4, 0x54, 0xF0, 0xFF, 0x90, 0x8E, 0x26, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, -+0x26, 0x37, 0x90, 0x8E, 0x29, 0xF0, 0x51, 0x8D, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, -+0xB8, 0xF0, 0x90, 0x8E, 0x27, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x8E, 0x29, 0xE0, 0x90, 0x01, -+0xBB, 0xF0, 0x90, 0x8E, 0x26, 0xE0, 0x54, 0x0F, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, 0x8F, 0x71, -+0x12, 0x46, 0xA8, 0x12, 0x80, 0x1E, 0x90, 0x8E, 0x27, 0xE0, 0xFF, 0x51, 0xBD, 0x90, 0x8E, 0x27, -+0xE0, 0x60, 0x19, 0x90, 0x8F, 0x71, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x54, -+0x0F, 0xFF, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFD, 0x12, 0x80, 0x2F, 0x22, 0xEF, 0x70, 0x37, -+0x7D, 0x78, 0x7F, 0x02, 0x71, 0x04, 0x7D, 0x02, 0x7F, 0x03, 0x71, 0x04, 0x7D, 0xC8, 0x7F, 0x02, -+0x12, 0x71, 0x1A, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x7D, 0x01, -+0x7F, 0x0C, 0x12, 0x51, 0xB1, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x90, -+0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x02, 0x4E, 0x30, 0x7D, 0x02, 0x7F, 0x02, 0x71, 0x04, -+0x7D, 0x01, 0x7F, 0x02, 0x74, 0x5D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, -+0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0x8E, 0x2A, 0xE0, -+0x64, 0x02, 0x60, 0x28, 0x71, 0x9E, 0x90, 0x8E, 0x25, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, -+0xE0, 0x14, 0x90, 0x8E, 0x2D, 0xE0, 0xFF, 0xA3, 0xE0, 0x6F, 0x70, 0x0A, 0x91, 0x32, 0x51, 0xFA, -+0x90, 0x8E, 0x2E, 0xE0, 0x14, 0xF0, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x8E, 0x27, -+0xE0, 0x60, 0x45, 0x90, 0x8E, 0x25, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x12, -+0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0B, 0x51, 0xFA, 0x90, 0x8E, 0x2D, 0xE0, 0x14, 0x90, 0x05, -+0x73, 0xF0, 0x90, 0x90, 0x98, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0xC3, 0x90, 0x90, 0x99, -+0xE0, 0x94, 0x80, 0x90, 0x90, 0x98, 0xE0, 0x64, 0x80, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, -+0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x12, 0x7E, 0xF8, 0x02, 0x4E, 0x8B, 0x90, 0x8D, -+0xA3, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x81, 0x31, 0x90, 0x8E, 0x27, 0xE0, 0x70, 0x02, 0x81, 0x31, -+0x90, 0x8E, 0x26, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, -+0x8E, 0x2E, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x8E, 0x2D, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, -+0x90, 0x8E, 0x2D, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x8E, 0x2E, 0xEF, 0xF0, 0x90, 0x8E, 0x25, -+0xE0, 0x44, 0x04, 0xF0, 0xE4, 0x90, 0x8E, 0x30, 0xF0, 0x90, 0x8E, 0x32, 0xA3, 0xE0, 0x90, 0x05, -+0x58, 0xF0, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x2B, -+0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x90, 0x8E, 0x26, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, -+0xFD, 0x50, 0x02, 0x80, 0x02, 0x91, 0x56, 0x90, 0x8E, 0x25, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, -+0x30, 0xE0, 0x0E, 0x90, 0x8E, 0x2D, 0xE0, 0xFF, 0xA3, 0xE0, 0xB5, 0x07, 0x04, 0x91, 0x32, 0x71, -+0x00, 0x22, 0xEF, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, -+0x03, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0xE4, 0x90, 0x8F, 0xA2, 0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x90, -+0x8F, 0xA2, 0xF0, 0xE0, 0x54, 0xC0, 0x70, 0x0D, 0x90, 0x8E, 0x2B, 0xE0, 0x54, 0xFE, 0xF0, 0x54, -+0xFD, 0xF0, 0x02, 0x51, 0xA4, 0x90, 0x8F, 0xA2, 0xE0, 0x30, 0xE6, 0x21, 0x90, 0x8E, 0x27, 0xE0, -+0x64, 0x01, 0x70, 0x20, 0x90, 0x8E, 0x2B, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8E, 0x26, 0xE0, 0x54, -+0x0F, 0x64, 0x02, 0x60, 0x04, 0xD1, 0x4E, 0x80, 0x0B, 0xD1, 0x69, 0x80, 0x07, 0x90, 0x8E, 0x2B, -+0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8F, 0xA2, 0xE0, 0x90, 0x8E, 0x2B, 0x30, 0xE7, 0x25, 0xE0, 0x44, -+0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x39, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, -+0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x44, -+0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, -+0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xD8, 0xF0, 0x74, 0x5C, 0xA3, 0xF0, 0x12, -+0x6E, 0x39, 0xE5, 0x61, 0x30, 0xE3, 0x02, 0xF1, 0xD0, 0xE5, 0x61, 0x30, 0xE4, 0x05, 0x7F, 0x02, -+0x12, 0x4A, 0xA8, 0xE5, 0x63, 0x30, 0xE0, 0x02, 0xB1, 0x7C, 0xE5, 0x63, 0x30, 0xE1, 0x02, 0x71, -+0x4D, 0xE5, 0x63, 0x30, 0xE2, 0x02, 0x71, 0x1C, 0xE5, 0x63, 0x30, 0xE3, 0x03, 0x12, 0x6E, 0x66, -+0xE5, 0x63, 0x30, 0xE4, 0x03, 0x12, 0x6E, 0x99, 0xE5, 0x63, 0x30, 0xE5, 0x02, 0xD1, 0x32, 0xE5, -+0x63, 0x30, 0xE6, 0x03, 0x12, 0x6E, 0xC8, 0xE5, 0x64, 0x30, 0xE1, 0x03, 0x12, 0x57, 0xDD, 0xE5, -+0x64, 0x30, 0xE6, 0x02, 0xD1, 0x09, 0x74, 0xD8, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x5C, 0xA3, -+0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, 0xFF, 0x90, 0x8E, -+0x27, 0xE0, 0x70, 0x02, 0xC1, 0x08, 0x90, 0x8D, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x7A, 0x90, 0x8E, -+0x26, 0xE0, 0xC4, 0x54, 0x0F, 0x60, 0x24, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1F, 0x90, 0x8E, -+0x2E, 0xE0, 0x14, 0xF0, 0xE0, 0xFE, 0x60, 0x06, 0x90, 0x8E, 0x30, 0xE0, 0x60, 0x0F, 0xEE, 0x70, -+0x06, 0x90, 0x8E, 0x2D, 0xE0, 0xA3, 0xF0, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x48, -+0x90, 0x8E, 0x2B, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x8E, 0x30, 0xE0, 0x60, 0x03, 0xB4, 0x01, 0x09, -+0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x30, 0xE0, 0x80, 0x0D, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x30, 0xE0, -+0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0x8E, 0x2F, 0xE0, 0x2F, 0xF5, 0x3C, 0xE4, 0xFB, -+0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0x8E, -+0x2A, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x51, 0xAD, 0x22, 0x90, 0x07, 0x1F, 0xE0, 0x54, 0x7F, 0xF0, -+0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, 0x8F, 0xA4, 0xF0, 0x90, 0x8F, 0xA2, 0x74, 0x02, 0xF0, -+0x90, 0x8F, 0xB0, 0x14, 0xF0, 0xFB, 0x7A, 0x8F, 0x79, 0xA2, 0x12, 0x6D, 0x1E, 0x7F, 0x03, 0x02, -+0x4A, 0xA8, 0x90, 0x8D, 0xA3, 0xE0, 0xB4, 0x01, 0x14, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x0E, 0x90, -+0x8E, 0x26, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x02, 0x80, 0x03, 0xD1, 0x69, 0x22, 0x90, 0x04, -+0x1D, 0xE0, 0x70, 0x14, 0x90, 0x8D, 0x03, 0xE0, 0xFF, 0xE4, 0xFD, 0x12, 0x4F, 0x3B, 0x8E, 0x12, -+0x8F, 0x13, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x90, 0x01, 0x5F, 0xE4, 0xF0, 0x90, 0x01, -+0x3C, 0x74, 0x08, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x3A, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, -+0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x5C, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5F, 0x74, 0x05, -+0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x8E, -+0x2A, 0xE0, 0x64, 0x0C, 0x60, 0x0C, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x51, 0xB1, 0xE4, 0xFF, 0x12, -+0x4E, 0xC2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, -+0xFE, 0x90, 0x8E, 0x40, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, -+0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, -+0x90, 0x8E, 0x40, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0xFF, 0xF0, 0x12, 0x26, -+0x1E, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x90, 0x8E, 0x40, 0xF0, 0xEE, 0x54, -+0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xF0, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, -+0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8D, 0x9F, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x01, -+0xC2, 0x74, 0x01, 0xF0, 0x90, 0x8E, 0x40, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, 0xF1, 0x67, 0x90, -+0x8E, 0x40, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFF, 0xF1, 0xBC, 0x90, 0x01, 0xC2, 0x74, 0x02, 0xF0, -+0x90, 0x8E, 0x40, 0xE0, 0xC4, 0x54, 0x01, 0xFF, 0xF1, 0xC2, 0x90, 0x01, 0xC2, 0x74, 0x03, 0xF0, -+0x04, 0xF0, 0x90, 0x8E, 0x40, 0xE0, 0x54, 0x01, 0xFF, 0x12, 0x4D, 0x9A, 0x90, 0x01, 0xC2, 0x74, -+0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x60, 0x07, 0x90, 0x8F, 0x4E, 0xE0, 0xFF, 0xF1, -+0x72, 0x22, 0x12, 0x7C, 0xEA, 0x7E, 0x00, 0x90, 0x8F, 0x71, 0x12, 0x79, 0x98, 0x90, 0x8F, 0x71, -+0xA3, 0xE0, 0x2F, 0x24, 0x3E, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, -+0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0x52, 0x12, 0x34, 0x2C, 0xE4, 0xFF, 0x74, 0x18, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x46, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x8E, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x06, 0xE3, 0x22, 0x90, 0x8F, 0x71, 0xEF, -+0xF0, 0x22, 0x90, 0x8F, 0x71, 0xEF, 0xF0, 0x22, 0x12, 0x26, 0x1E, 0x90, 0x8E, 0x31, 0xF0, 0x22, -+0x90, 0x8E, 0x40, 0xE0, 0x30, 0xE0, 0x05, 0x7F, 0x04, 0x12, 0x4A, 0xA8, 0x22, 0x12, 0x26, 0x1E, -+0x90, 0x8E, 0x3F, 0xF0, 0x90, 0x8E, 0x3F, 0xE0, 0x90, 0x01, 0xE7, 0xF0, 0x22, 0xE4, 0xFB, 0xFA, -+0xFD, 0x7F, 0x01, 0x12, 0x4A, 0xCF, 0x90, 0x8F, 0x7E, 0xEF, 0xF0, 0x60, 0xF0, 0x12, 0x60, 0x02, -+0x80, 0xEB, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x8D, 0x9E, 0xE0, 0xFE, -+0x90, 0x8D, 0x9D, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, -+0x01, 0x60, 0x48, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x13, 0xED, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x07, -+0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x11, 0x70, 0x7F, 0x01, 0x90, 0x8D, 0x9D, 0xE0, -+0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x07, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x11, 0xD3, -+0x7F, 0x01, 0xEF, 0x60, 0x16, 0x90, 0x8D, 0x9D, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, -+0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8D, 0x9D, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8F, 0x7F, 0x12, 0x46, 0xA8, 0x90, 0x90, 0x95, -+0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, 0x7F, 0xAF, 0x7E, 0x01, 0x31, -+0x46, 0xEF, 0x60, 0x3A, 0x90, 0x8F, 0x7F, 0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, -+0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, -+0x12, 0x34, 0x2C, 0x90, 0x8F, 0x7F, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x0E, 0x12, 0x26, 0x37, 0x90, -+0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0x8F, 0x12, 0x46, 0xA8, -+0x7F, 0x96, 0x7E, 0x02, 0x31, 0x46, 0xEF, 0x60, 0x58, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, -+0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, -+0xFE, 0x90, 0x90, 0x92, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x90, 0x92, 0xE0, -+0xFD, 0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x90, 0x8F, 0x12, 0x46, 0x9F, 0x90, 0x00, -+0x0E, 0x12, 0x26, 0x37, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0x31, 0x9C, 0x90, 0x90, 0x92, 0xE0, -+0x24, 0x18, 0xFF, 0x90, 0x90, 0x8F, 0x12, 0x46, 0x9F, 0x31, 0xF7, 0x90, 0x02, 0x96, 0x74, 0x01, -+0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0x87, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x90, 0x87, 0xE0, 0xFE, 0xA3, -+0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x2D, 0xC3, 0x90, 0x90, 0x8A, 0xE0, 0x94, 0xE8, 0x90, -+0x90, 0x89, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, -+0x80, 0x15, 0x90, 0x90, 0x89, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0x7F, 0x0A, 0x7E, 0x00, -+0x12, 0x3A, 0xF7, 0x80, 0xC5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFC, 0xED, 0x2C, -+0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xEE, -+0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, -+0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, -+0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, -+0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x90, 0x8B, 0xEF, 0xF0, 0xA3, 0x12, 0x46, 0xA8, -+0x90, 0x90, 0x94, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, 0x76, 0x74, 0x00, -+0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x90, -+0x8C, 0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, -+0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x8B, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, -+0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x02, -+0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0x90, 0x8C, 0x12, 0x46, 0x9F, 0x90, -+0x00, 0x0E, 0x12, 0x26, 0x37, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x2C, -+0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x4A, 0xCF, 0x90, 0x8F, 0x82, 0xEF, 0xF0, 0x60, 0xF0, -+0xF1, 0x68, 0xBF, 0x01, 0xEB, 0x51, 0x89, 0x80, 0xE7, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0xE4, 0x90, 0x8F, 0x8D, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0xE4, 0xFF, 0x74, 0x10, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x90, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x8F, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x06, 0xE3, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, -+0x01, 0x1E, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8F, 0x83, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0x02, 0x82, 0xE0, 0x90, 0x8F, 0x8C, 0xF0, 0x90, 0x8E, 0x40, 0xE0, 0x20, 0xE0, 0x02, -+0x81, 0x87, 0x90, 0x8E, 0x45, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x0A, -+0xB1, 0x75, 0x90, 0x90, 0xA5, 0xE0, 0x90, 0x01, 0xC7, 0xF0, 0xE4, 0x90, 0x8F, 0x8B, 0xF0, 0x90, -+0x8F, 0x8C, 0xE0, 0xFF, 0x90, 0x8F, 0x8B, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0x81, 0x87, 0x90, 0x8F, -+0x83, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0x90, 0xFD, 0x11, 0xF0, 0x74, 0x01, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -+0x83, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0x90, 0x8F, 0x85, 0xF0, 0xA3, -+0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, -+0x33, 0x33, 0x54, 0xF8, 0x90, 0x8F, 0x89, 0xF0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x8F, -+0x84, 0xE0, 0x2F, 0xFF, 0x90, 0x8F, 0x83, 0xE0, 0x3E, 0xFE, 0x90, 0x8F, 0x87, 0x91, 0x8C, 0xEF, -+0x54, 0xFC, 0x90, 0x8F, 0x8A, 0xF0, 0x90, 0x8F, 0x89, 0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0x90, -+0x8F, 0x85, 0x8F, 0xF0, 0x12, 0x46, 0x4B, 0x90, 0x8F, 0x85, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD1, -+0x51, 0x90, 0x8F, 0x85, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x8F, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, -+0xFF, 0x7D, 0x0F, 0x91, 0x92, 0x90, 0x8F, 0x85, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x90, 0x8F, 0x83, -+0xEC, 0x8D, 0xF0, 0x12, 0x46, 0x4B, 0x90, 0x8D, 0x9F, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x90, -+0x8F, 0x84, 0xE0, 0x9D, 0x90, 0x8F, 0x83, 0xE0, 0x9C, 0x40, 0x1B, 0x90, 0x8D, 0xA0, 0xE0, 0x24, -+0x01, 0xFD, 0x90, 0x8D, 0x9F, 0xE0, 0x34, 0x00, 0xFC, 0xC3, 0x90, 0x8F, 0x84, 0xE0, 0x9D, 0xF0, -+0x90, 0x8F, 0x83, 0xE0, 0x9C, 0xF0, 0xEF, 0x54, 0xE0, 0x60, 0x1F, 0xEF, 0x30, 0xE7, 0x07, 0x90, -+0x01, 0xC7, 0x74, 0x21, 0x80, 0x0D, 0xEF, 0x90, 0x01, 0xC7, 0x30, 0xE6, 0x04, 0x74, 0x22, 0x80, -+0x02, 0x74, 0x23, 0xF0, 0x90, 0x90, 0xA5, 0xF0, 0x80, 0x5B, 0x90, 0x8F, 0x8A, 0xE0, 0x24, 0x40, -+0x60, 0x04, 0x24, 0x20, 0x70, 0x2A, 0x90, 0x8E, 0x41, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, -+0x01, 0x30, 0xE0, 0x41, 0x90, 0x8F, 0x87, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7B, 0x01, 0x7A, 0x8F, -+0x79, 0x90, 0xB1, 0x99, 0xEF, 0x60, 0x2E, 0x90, 0x8F, 0x8A, 0xE0, 0xFF, 0xB1, 0xF6, 0x80, 0x25, -+0x90, 0x8E, 0x41, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x18, 0x90, 0x8F, 0x87, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8F, 0x8D, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, -+0x8F, 0x9A, 0xF0, 0x91, 0xD0, 0xD1, 0x0D, 0xEF, 0x64, 0x01, 0x60, 0x07, 0x90, 0x01, 0x3F, 0xE0, -+0x30, 0xE2, 0x02, 0xB1, 0x75, 0xD1, 0x2B, 0xBF, 0x01, 0x0D, 0x90, 0x8F, 0x83, 0xF1, 0x3B, 0x90, -+0x8F, 0x8B, 0xE0, 0x04, 0xF0, 0x41, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, -+0xE4, 0xFD, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0x8D, 0xA0, -+0xE0, 0x9B, 0x90, 0x8D, 0x9F, 0xE0, 0x9A, 0x50, 0x13, 0xA3, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8D, -+0x9F, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, -+0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFF, 0x22, -+0x90, 0x8F, 0x98, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x8F, 0x96, 0xEE, 0x91, 0x8C, 0xEF, 0x54, -+0x0C, 0x64, 0x08, 0x60, 0x02, 0xA1, 0x74, 0x90, 0x8F, 0x96, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, -+0x8F, 0x99, 0xE0, 0xFD, 0x90, 0x8F, 0x98, 0xE0, 0x2D, 0x24, 0x1E, 0xFD, 0x91, 0x92, 0xEF, 0x64, -+0x88, 0x70, 0x71, 0x90, 0x8F, 0x96, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8F, 0x99, 0xE0, 0xFD, -+0x90, 0x8F, 0x98, 0xE0, 0x2D, 0x24, 0x1F, 0xFD, 0x91, 0x92, 0xEF, 0x64, 0x8E, 0x70, 0x55, 0x90, -+0x8F, 0x96, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8F, 0x99, 0xE0, 0xFD, 0x90, 0x8F, 0x98, 0xE0, -+0x2D, 0xFD, 0x90, 0x8F, 0x9A, 0xE0, 0x2D, 0x24, 0x19, 0xFD, 0x91, 0x92, 0xEF, 0x64, 0x03, 0x70, -+0x33, 0x90, 0x8F, 0x96, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8F, 0x99, 0xE0, 0xFD, 0x90, 0x8F, -+0x98, 0xE0, 0x2D, 0xFD, 0x90, 0x8F, 0x9A, 0xE0, 0x2D, 0x24, 0x1E, 0xFD, 0x91, 0x92, 0xEF, 0x90, -+0x01, 0xC7, 0x30, 0xE3, 0x05, 0x74, 0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x45, -+0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x8D, 0x01, 0xE0, 0xB4, 0x02, 0x15, 0x90, 0x8E, 0x42, 0xE0, -+0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x0F, 0x90, 0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, -+0x22, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x8F, 0x96, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0xA3, 0x12, 0x46, 0xA8, 0xE4, 0x90, 0x8F, 0xA1, 0xF0, 0x90, 0x8F, 0xA1, 0xE0, 0xFD, 0xC3, -+0x94, 0x06, 0x50, 0x27, 0x90, 0x8F, 0x97, 0xE0, 0x24, 0x04, 0xFF, 0x90, 0x8F, 0x96, 0xE0, 0x34, -+0x00, 0xFE, 0x91, 0x92, 0x90, 0x8F, 0xA1, 0xE0, 0x24, 0x9B, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, -+0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xA1, 0xE0, 0x04, 0xF0, 0x80, 0xCF, 0x78, 0x98, 0x7C, 0x8F, 0x7D, -+0x01, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x9B, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x48, 0x5D, 0xEF, 0x7F, -+0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0xEF, 0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, 0x74, 0x04, 0xF0, -+0x80, 0x03, 0x74, 0x08, 0xF0, 0x90, 0x8E, 0x45, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x8E, 0x45, -+0xE0, 0x30, 0xE0, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x06, 0x90, 0xE0, 0x20, 0xE5, 0x0A, 0x90, 0x01, -+0x3F, 0xE0, 0x30, 0xE2, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x8E, 0x45, 0xE0, 0xFF, -+0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x14, 0xEF, 0x44, 0x01, 0x90, 0x8E, 0x45, -+0xF0, 0x90, 0x8E, 0x41, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, 0x01, -+0x22, 0x7D, 0x07, 0xEF, 0x5D, 0xC3, 0x60, 0x14, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, -+0x5E, 0xFE, 0xED, 0x5F, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x0D, 0x74, 0xFF, 0x9D, 0xFD, -+0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, 0xFF, 0x22, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, -+0x01, 0x1E, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8F, 0x71, 0xF0, 0xA3, 0xEF, -+0xF0, 0x90, 0x02, 0x87, 0xE0, 0xF9, 0x90, 0x8E, 0x40, 0xE0, 0x20, 0xE0, 0x02, 0xE1, 0x3A, 0xEC, -+0xC3, 0x99, 0x40, 0x02, 0xE1, 0x3A, 0x90, 0x8F, 0x71, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, -+0xFD, 0x11, 0xF0, 0xAF, 0x03, 0xAD, 0x07, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -+0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, -+0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0xFE, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, -+0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFD, 0x24, 0x18, 0xFB, 0xEA, 0x33, -+0xFA, 0xEB, 0x2F, 0xFF, 0xEA, 0x3E, 0xFE, 0xD1, 0x51, 0x90, 0x8F, 0x71, 0xEE, 0x8F, 0xF0, 0x12, -+0x46, 0x4B, 0x90, 0x8D, 0x9F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x90, 0x8F, 0x72, 0xE0, 0x9F, -+0x90, 0x8F, 0x71, 0xE0, 0x9E, 0x40, 0x1B, 0x90, 0x8D, 0xA0, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8D, -+0x9F, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x90, 0x8F, 0x72, 0xE0, 0x9F, 0xF0, 0x90, 0x8F, 0x71, 0xE0, -+0x9E, 0xF0, 0x90, 0x8F, 0x71, 0xF1, 0x3B, 0x0C, 0xC1, 0x9F, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x06, 0x90, -+0xE0, 0x20, 0xE1, 0x06, 0x90, 0x01, 0xBC, 0xE0, 0x04, 0xF0, 0x90, 0x06, 0x90, 0xE0, 0x30, 0xE1, -+0x06, 0x90, 0x01, 0xBD, 0xE0, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0x8F, 0x83, 0xF0, 0xA3, 0xF0, 0x90, -+0x02, 0x86, 0xE0, 0x20, 0xE1, 0x2C, 0xC3, 0x90, 0x8F, 0x84, 0xE0, 0x94, 0xD0, 0x90, 0x8F, 0x83, -+0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, -+0x8F, 0x83, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3A, 0xF7, -+0x80, 0xCD, 0x7F, 0x01, 0x22, 0x90, 0x90, 0x6B, 0xEF, 0xF0, 0xAB, 0x05, 0x7E, 0x00, 0x7D, 0x00, -+0x7C, 0x00, 0xE4, 0x90, 0x90, 0x70, 0xF0, 0xEB, 0xFF, 0xE4, 0x90, 0x90, 0x6C, 0x12, 0x27, 0x48, -+0x90, 0x90, 0x6C, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x7F, 0xB0, 0x7E, 0x08, -+0x12, 0x37, 0x5D, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x90, 0x6B, 0xE0, 0x75, 0xF0, -+0x08, 0xA4, 0x24, 0x73, 0xF5, 0x82, 0xE4, 0x34, 0xAF, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x12, 0x36, 0xCE, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x12, 0x67, 0xA5, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0xC0, 0x07, 0xC0, 0x05, 0x90, 0x90, 0x73, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0x9C, 0x12, 0x27, 0x48, -+0xD0, 0x05, 0xD0, 0x07, 0x12, 0x32, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, -+0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, -+0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x2C, 0xF0, 0x74, -+0x68, 0xA3, 0xF0, 0x11, 0x7B, 0x74, 0x2C, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x68, 0xA3, 0xF0, -+0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x7B, 0x00, 0x7A, 0x00, 0x79, -+0x53, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x51, 0x52, 0x53, 0x7B, 0x00, 0x7A, 0x00, -+0x79, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x12, 0x39, 0x33, 0xE5, 0x52, 0x52, 0x54, 0xAB, 0x53, 0xE4, -+0xFD, 0x7F, 0x01, 0x12, 0x39, 0x04, 0xAB, 0x54, 0x7D, 0x01, 0x7F, 0x01, 0x02, 0x39, 0x04, 0xC0, -+0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, -+0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, -+0xAF, 0xF0, 0x74, 0x68, 0xA3, 0xF0, 0x11, 0xFE, 0x74, 0xAF, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -+0x68, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -+0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x00, -+0x54, 0xE0, 0x55, 0x55, 0xF5, 0x59, 0xA3, 0xE0, 0x55, 0x56, 0xF5, 0x5A, 0xA3, 0xE0, 0x55, 0x57, -+0xF5, 0x5B, 0xA3, 0xE0, 0x55, 0x58, 0xF5, 0x5C, 0xAD, 0x59, 0x7F, 0x54, 0x12, 0x3A, 0x96, 0xAD, -+0x5A, 0x7F, 0x55, 0x12, 0x3A, 0x96, 0xAD, 0x5B, 0x7F, 0x56, 0x12, 0x3A, 0x96, 0xAD, 0x5C, 0x7F, -+0x57, 0x12, 0x3A, 0x96, 0x53, 0x91, 0xEF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, -+0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x38, 0xF0, 0x74, 0x69, 0xA3, 0xF0, 0x51, -+0xDA, 0xE5, 0x69, 0x30, 0xE1, 0x02, 0x31, 0xC3, 0xE5, 0x69, 0x30, 0xE2, 0x02, 0x71, 0x0A, 0xE5, -+0x69, 0x30, 0xE3, 0x02, 0x71, 0x46, 0xE5, 0x6A, 0x30, 0xE0, 0x02, 0x51, 0x91, 0xE5, 0x6C, 0x30, -+0xE1, 0x05, 0x7F, 0x03, 0x12, 0x4A, 0xA8, 0xE5, 0x6C, 0x30, 0xE4, 0x03, 0x12, 0x4E, 0x79, 0xE5, -+0x6C, 0x30, 0xE5, 0x02, 0x31, 0xCC, 0xE5, 0x6C, 0x30, 0xE6, 0x02, 0x51, 0x53, 0x74, 0x38, 0x04, -+0x90, 0x01, 0xC4, 0xF0, 0x74, 0x69, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, -+0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, -+0xD0, 0xE0, 0x32, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x02, 0x71, 0xC9, 0x22, 0x90, 0x8E, 0x24, 0xE0, -+0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x27, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, -+0xE0, 0x90, 0x8E, 0x25, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, -+0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x12, 0x51, 0xA4, -+0xE4, 0xFF, 0x90, 0x8F, 0x5B, 0xE0, 0x30, 0xE0, 0x49, 0x90, 0x8F, 0x5F, 0xE0, 0xFD, 0x60, 0x42, -+0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x06, 0xE4, 0x90, 0x8F, 0x5F, 0xF0, 0x22, -+0x90, 0x8F, 0x5D, 0xE0, 0xD3, 0x9D, 0x50, 0x11, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0x12, 0x65, -+0x75, 0x90, 0x8F, 0x5B, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x12, 0x4E, 0xC0, 0x90, 0x8F, 0x5F, 0xE0, -+0x04, 0xF0, 0x22, 0x90, 0x8E, 0x24, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, -+0x2C, 0xEF, 0x54, 0x7F, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x8E, 0x25, 0x30, 0xE1, 0x06, 0xE0, -+0x44, 0x02, 0xF0, 0x80, 0x0F, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, -+0x01, 0xB8, 0x04, 0xF0, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x03, 0x12, 0x51, 0xA4, 0x7F, 0x01, 0x41, -+0x02, 0x71, 0x82, 0x90, 0x8F, 0xB1, 0xEF, 0xF0, 0x90, 0x8E, 0x24, 0x30, 0xE0, 0x06, 0xE0, 0x44, -+0x01, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8F, 0xB1, 0xE0, 0x30, 0xE6, 0x11, 0x90, -+0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, -+0x90, 0x8E, 0x24, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0x8E, 0x32, 0xE4, 0xF0, 0xA3, 0x74, 0x05, 0xF0, -+0x90, 0x8E, 0x32, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x65, -+0xF5, 0x69, 0xA3, 0xE0, 0x55, 0x66, 0xF5, 0x6A, 0xA3, 0xE0, 0x55, 0x67, 0xF5, 0x6B, 0xA3, 0xE0, -+0x55, 0x68, 0xF5, 0x6C, 0x90, 0x01, 0x3C, 0xE5, 0x69, 0xF0, 0xA3, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, -+0x6B, 0xF0, 0xA3, 0xE5, 0x6C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x35, -+0x90, 0x06, 0x92, 0xE0, 0x30, 0xE0, 0x24, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x3A, 0xE0, 0xC3, 0x13, -+0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, -+0x5B, 0x74, 0x05, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x8E, 0x24, 0xE0, 0x54, -+0xF7, 0xF0, 0x12, 0x51, 0xA4, 0x22, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x35, 0x90, 0x06, 0x92, 0xE0, -+0x30, 0xE1, 0x24, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x3A, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x3C, -+0xE4, 0xFB, 0xFD, 0x7F, 0x5C, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x5F, 0x74, 0x05, 0xF0, -+0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xEF, 0xF0, 0x12, 0x51, -+0xA4, 0x22, 0xE4, 0x90, 0x8F, 0xB2, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, -+0x8F, 0xB2, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0x8F, 0xB2, 0xE0, 0xFF, 0xB5, 0x06, 0x01, -+0x22, 0xC3, 0x90, 0x8F, 0xB4, 0xE0, 0x94, 0x64, 0x90, 0x8F, 0xB3, 0xE0, 0x94, 0x00, 0x40, 0x0D, -+0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x8F, 0xB2, 0xE0, 0xFF, 0x22, 0x90, 0x8F, 0xB3, -+0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0x80, 0xC2, 0x90, 0x8E, 0x24, 0xE0, 0xFF, 0x13, 0x13, -+0x54, 0x3F, 0x30, 0xE0, 0x11, 0xEF, 0x54, 0xFB, 0xF0, 0x90, 0x8E, 0x2B, 0xE0, 0x54, 0xFD, 0xF0, -+0x54, 0x07, 0x70, 0x42, 0x80, 0x3D, 0x90, 0x8E, 0x30, 0xE0, 0x04, 0xF0, 0x90, 0x8E, 0x2B, 0xE0, -+0x54, 0xEF, 0xF0, 0x90, 0x8E, 0x30, 0xE0, 0xFF, 0xB4, 0x01, 0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, -+0x06, 0x90, 0x05, 0x58, 0xE0, 0x04, 0xF0, 0x90, 0x8E, 0x38, 0xE0, 0xFF, 0x90, 0x8E, 0x30, 0xE0, -+0xD3, 0x9F, 0x40, 0x0F, 0x90, 0x8D, 0xA3, 0xE0, 0xB4, 0x01, 0x0B, 0x90, 0x8E, 0x25, 0xE0, 0x54, -+0xFB, 0xF0, 0x22, 0x12, 0x51, 0xA4, 0x22, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -+0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x27, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x6C, 0xFF, -+0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, -+0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, -+0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8D, 0x02, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, -+0xED, 0x2F, 0x90, 0x8D, 0x03, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, -+0x8D, 0x04, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8D, 0x05, 0xF0, -+0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x8D, 0x06, 0xF0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0x8E, 0x23, 0xF0, 0xBF, -+0x01, 0x12, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x64, 0x01, 0x60, 0x17, 0x90, 0x05, 0x22, 0x74, -+0x6F, 0xF0, 0x80, 0x0F, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x64, 0x01, 0x60, 0x05, 0x90, 0x05, -+0x22, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x30, -+0xE0, 0x26, 0x12, 0x26, 0x1E, 0x90, 0x8E, 0x38, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, -+0x8E, 0x39, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xA3, 0xE0, 0x54, 0x01, 0x4F, 0xF0, 0x90, 0x00, 0x03, -+0x12, 0x26, 0x37, 0x90, 0x8E, 0x3B, 0xF0, 0x22, 0x90, 0x8E, 0x38, 0x74, 0x01, 0xF0, 0xA3, 0x74, -+0x07, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8D, 0x9D, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, -+0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x8D, 0x9E, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, -+0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x35, 0xC0, 0x01, -+0x90, 0x8D, 0x9E, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x07, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xA8, -+0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x45, 0xD0, 0x90, 0x8D, 0x9E, -+0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, -+0x8D, 0x9E, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, -+0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, -+0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, -+0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0x8F, 0x60, 0xF0, 0xA3, 0xF0, 0x90, -+0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3E, 0xC3, -+0x90, 0x8F, 0x61, 0xE0, 0x94, 0x88, 0x90, 0x8F, 0x60, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, -+0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x8F, 0x60, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, -+0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0x8F, 0x61, 0xE0, 0x94, 0x32, 0x90, 0x8F, -+0x60, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB2, 0x22, 0x7F, 0x02, -+0x90, 0x8F, 0x57, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, -+0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, -+0x80, 0xDE, 0x7F, 0x01, 0x22, 0xE4, 0xF5, 0x6D, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x5D, 0xF5, -+0x61, 0xA3, 0xE0, 0x55, 0x5E, 0xF5, 0x62, 0xA3, 0xE0, 0x55, 0x5F, 0xF5, 0x63, 0xA3, 0xE0, 0x55, -+0x60, 0xF5, 0x64, 0x90, 0x01, 0x34, 0xE5, 0x61, 0xF0, 0xA3, 0xE5, 0x62, 0xF0, 0xA3, 0xE5, 0x63, -+0xF0, 0xA3, 0xE5, 0x64, 0xF0, 0x22, 0x90, 0x8D, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x2A, 0x90, 0x8E, -+0x27, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0xE4, -+0xF5, 0x3B, 0x90, 0x8E, 0x39, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, -+0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x22, 0x90, 0x8D, 0xA3, 0xE0, 0x64, 0x01, 0x70, -+0x26, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x20, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, -+0x02, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8E, 0x2B, 0xE0, 0x54, 0xFD, 0xF0, -+0x54, 0x07, 0x70, 0x03, 0x12, 0x51, 0xA4, 0x22, 0x90, 0x8D, 0xA3, 0xE0, 0xB4, 0x01, 0x14, 0x90, -+0x8E, 0x27, 0xE0, 0x60, 0x0E, 0x90, 0x8E, 0x2B, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x07, 0x70, 0x03, -+0x12, 0x51, 0xA4, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, -+0x1A, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, -+0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x90, 0x90, 0x51, 0x12, 0x46, 0xA8, 0xD1, 0xE4, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xE1, -+0xE5, 0x90, 0x8F, 0x4E, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x4F, 0x3B, 0x90, 0x90, 0x58, 0x12, 0x79, -+0x98, 0x90, 0x90, 0x5A, 0xEF, 0xF0, 0x90, 0x90, 0x58, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, 0x34, -+0xFC, 0xFA, 0x7B, 0x01, 0x90, 0x90, 0x57, 0xE0, 0xFD, 0x12, 0x78, 0xFC, 0x90, 0x90, 0x58, 0xA3, -+0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, -+0x90, 0x90, 0x54, 0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0xD0, -+0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x58, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, -+0x2F, 0x24, 0x42, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, -+0x90, 0x90, 0x54, 0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0xD0, -+0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x58, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, -+0x2F, 0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, -+0x90, 0x90, 0x51, 0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0xD0, -+0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x2C, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x10, 0xF0, 0x90, -+0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x0A, 0x0D, 0xED, 0x13, 0x90, -+0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x24, 0x90, 0xFD, 0x11, -+0xE0, 0x6D, 0x70, 0x1A, 0x90, 0x01, 0x17, 0xE0, 0xB5, 0x05, 0x0D, 0x90, 0x01, 0xE4, 0x74, 0x77, -+0xF0, 0x90, 0xFD, 0x11, 0xE4, 0xF0, 0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, 0x11, 0xF0, 0xE4, 0x2F, -+0xFF, 0x22, 0xE4, 0x90, 0x90, 0x9C, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, -+0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, -+0x90, 0x9D, 0xE0, 0x94, 0xE8, 0x90, 0x90, 0x9C, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, -+0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x90, -+0x9C, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0x80, 0xBF, 0x8F, 0x14, 0xE4, 0x90, 0x90, 0x9E, -+0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0xEF, 0x65, -+0x14, 0x60, 0x3E, 0xC3, 0x90, 0x90, 0x9F, 0xE0, 0x94, 0x88, 0x90, 0x90, 0x9E, 0xE0, 0x94, 0x13, -+0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x90, 0x9E, 0xE4, 0x75, 0xF0, -+0x01, 0x12, 0x46, 0x4B, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0xD3, 0x90, 0x90, 0x9F, 0xE0, -+0x94, 0x32, 0x90, 0x90, 0x9E, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, -+0xB2, 0x22, 0x90, 0x8D, 0x01, 0xE0, 0xB4, 0x03, 0x0C, 0x90, 0x00, 0x70, 0xE0, 0x44, 0x80, 0xFD, -+0x7F, 0x70, 0x12, 0x3A, 0x96, 0x90, 0x8E, 0x31, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x3A, 0x96, 0x90, -+0x8E, 0x28, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, -+0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, 0x7F, 0x08, -+0x12, 0x3A, 0x96, 0x7F, 0x01, 0x11, 0x6A, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x90, -+0x12, 0x3A, 0x96, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3A, 0xF7, 0x74, 0x65, 0x2F, 0xF8, 0xE6, 0xFE, -+0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, -+0xF0, 0x22, 0xA9, 0x07, 0x90, 0x06, 0x69, 0xE0, 0xFE, 0x90, 0x06, 0x68, 0xE0, 0x7A, 0x00, 0x24, -+0x00, 0xFF, 0xEA, 0x3E, 0xFE, 0xE9, 0x14, 0x60, 0x13, 0x14, 0x60, 0x10, 0x24, 0x02, 0x70, 0x14, -+0xEE, 0x54, 0xFE, 0xFE, 0xEF, 0x54, 0x7F, 0x90, 0x06, 0x68, 0x80, 0x04, 0x90, 0x06, 0x68, 0xEF, -+0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0x90, 0x90, 0xA8, 0xED, 0xF0, 0xEF, 0x14, 0x60, 0x23, 0x14, 0x70, -+0x02, 0x41, 0x13, 0x24, 0x02, 0x60, 0x02, 0x41, 0x61, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, -+0x30, 0x03, 0xC3, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x00, 0x7F, 0xAC, 0x41, -+0x5D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0x90, 0x36, 0x12, 0x27, -+0x54, 0x00, 0x30, 0x02, 0x01, 0x51, 0x79, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x3C, 0x51, 0x62, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, 0x90, 0xA8, -+0xE0, 0x7E, 0x00, 0x78, 0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x33, 0x95, -+0xE0, 0xFD, 0xFC, 0x90, 0x90, 0x36, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x51, 0x7D, 0x90, -+0x90, 0xA8, 0xE0, 0x90, 0x90, 0x32, 0xB4, 0x01, 0x13, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, -+0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x80, 0x11, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x10, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, -+0x0A, 0x80, 0x4C, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0x30, 0x03, 0xC3, 0x90, 0x90, 0x36, -+0x12, 0x27, 0x54, 0x00, 0x30, 0x02, 0x02, 0x51, 0x79, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x3C, 0x51, 0x62, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0xF0, 0x00, 0x00, 0x00, 0x90, -+0x90, 0xA8, 0xE0, 0x7E, 0x00, 0x78, 0x1C, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, -+0x33, 0x95, 0xE0, 0xFD, 0xFC, 0x90, 0x90, 0x36, 0x12, 0x27, 0x48, 0x7F, 0x38, 0x7E, 0x08, 0x51, -+0x7D, 0x22, 0x90, 0x90, 0xA8, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0xFF, 0xAE, 0xF0, 0xEE, 0x33, 0x95, -+0xE0, 0xFD, 0xFC, 0x90, 0x90, 0x36, 0x12, 0x27, 0x48, 0x7F, 0xAC, 0x7E, 0x08, 0x90, 0x90, 0x30, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x36, 0xCE, 0x90, 0x90, 0x3A, 0x12, 0x27, 0x48, 0x90, 0x90, -+0x32, 0x12, 0x46, 0x7B, 0x12, 0x27, 0x15, 0x90, 0x90, 0x3A, 0x12, 0x46, 0x87, 0x12, 0x46, 0x61, -+0x90, 0x90, 0x36, 0x12, 0x46, 0x87, 0x12, 0x46, 0x6E, 0x90, 0x90, 0x3E, 0x12, 0x27, 0x48, 0x90, -+0x90, 0x3E, 0x12, 0x46, 0x7B, 0x90, 0xAC, 0xB9, 0x12, 0x27, 0x48, 0x90, 0x90, 0x30, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0x02, 0x37, 0x5D, 0x90, 0x90, 0xA0, 0xEF, 0xF0, 0x90, 0x90, 0x32, 0x12, 0x27, -+0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x74, -+0x08, 0xFF, 0xFE, 0x51, 0x7D, 0x90, 0x90, 0xA0, 0xE0, 0x60, 0x02, 0x61, 0xA0, 0x90, 0x90, 0x32, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x03, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x00, 0x7F, 0x2C, 0x7E, 0x08, 0x51, 0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, -+0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x30, 0x00, 0x00, 0x00, 0x74, 0x08, 0xFF, 0xFE, 0x51, -+0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0x90, 0x36, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0x70, 0x7F, 0xB0, 0x7E, 0x0C, 0x51, 0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x70, 0x7F, -+0xB0, 0x7E, 0x0E, 0x51, 0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, 0x00, 0x90, -+0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x77, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0x51, 0x7D, 0x90, -+0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, -+0x77, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0E, 0x51, 0x7D, 0x90, 0x04, 0x54, 0xE0, 0x54, 0x7F, 0x90, -+0x90, 0xA1, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0xE4, 0x90, 0x90, 0xA2, 0xF0, 0xA3, 0xF0, 0x22, -+0x90, 0x90, 0xA0, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x81, 0x5D, 0x90, 0x04, 0x54, 0xE0, 0x44, 0x80, -+0x90, 0x90, 0xA1, 0xF0, 0xE0, 0x90, 0x04, 0x54, 0xF0, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x03, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x2C, 0x7E, -+0x08, 0x51, 0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0x90, 0x36, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x10, 0x7F, 0xB0, 0x7E, 0x0C, 0x51, 0x7D, 0x90, 0x90, 0x32, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0xF0, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, -+0x10, 0x7F, 0xB0, 0x7E, 0x0E, 0x51, 0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, -+0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x00, 0x54, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0C, 0x51, -+0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x00, 0xFF, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, -+0x54, 0x00, 0x54, 0x00, 0x00, 0x7F, 0xB0, 0x7E, 0x0E, 0x51, 0x7D, 0x90, 0x90, 0x32, 0x12, 0x27, -+0x54, 0x30, 0x00, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x20, 0x00, 0x00, 0x00, 0x74, -+0x08, 0xFF, 0xFE, 0x51, 0x7D, 0x90, 0x90, 0xA2, 0xE4, 0xF0, 0xA3, 0x04, 0xF0, 0x22, 0x90, 0x90, -+0xA9, 0xEF, 0xF0, 0xD1, 0x80, 0x90, 0x90, 0xA9, 0xE0, 0xC3, 0x94, 0x0E, 0x50, 0x44, 0x90, 0x90, -+0x32, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x12, 0xD4, -+0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0x51, 0x7D, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x07, -+0x03, 0xFF, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0xD1, 0x1B, 0x90, 0x90, 0x20, -+0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, -+0xC1, 0x0A, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x30, -+0x50, 0x16, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, -+0x27, 0x54, 0x09, 0x28, 0x00, 0x00, 0x80, 0x70, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0x74, 0x32, 0xD3, -+0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x40, 0x50, 0x16, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x1F, 0xFE, -+0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x08, 0xA6, 0x00, 0x00, 0x80, 0x4A, 0x90, 0x90, -+0xA9, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x1B, 0xEF, 0x94, 0x74, 0x50, 0x16, 0x90, 0x90, -+0x32, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, 0x36, 0x12, 0x27, 0x54, 0x08, 0xA4, -+0x00, 0x00, 0x80, 0x24, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0x74, 0x76, 0xD3, 0x9F, 0x50, 0x1F, 0xEF, -+0x94, 0xA5, 0x50, 0x1A, 0x90, 0x90, 0x32, 0x12, 0x27, 0x54, 0x1F, 0xFE, 0x00, 0x00, 0x90, 0x90, -+0x36, 0x12, 0x27, 0x54, 0x08, 0x24, 0x00, 0x00, 0x7F, 0x60, 0x7E, 0x08, 0x51, 0x7D, 0x90, 0x90, -+0xA9, 0xE0, 0xFF, 0x74, 0x24, 0xD3, 0x9F, 0x50, 0x37, 0xEF, 0x94, 0x40, 0x50, 0x32, 0x90, 0x90, -+0x20, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, -+0x74, 0x01, 0xFE, 0x0D, 0x14, 0xD1, 0x1B, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, -+0xFF, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0x74, 0x01, 0xFE, 0x0D, 0x14, 0x80, 0x7A, -+0x90, 0x90, 0xA9, 0xE0, 0xFF, 0x74, 0x64, 0xD3, 0x9F, 0x50, 0x37, 0xEF, 0x94, 0x8C, 0x50, 0x32, -+0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0xE4, -+0xFC, 0x74, 0x01, 0xFE, 0x74, 0x03, 0xD1, 0x19, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x07, -+0x03, 0xFF, 0x90, 0x90, 0xA9, 0xE0, 0xFF, 0xE4, 0xFC, 0x74, 0x01, 0xFE, 0x74, 0x03, 0xFD, 0xE4, -+0x80, 0x38, 0x90, 0x90, 0xA9, 0xE0, 0xFB, 0x74, 0x8C, 0xC3, 0x9B, 0x50, 0x3B, 0x90, 0x90, 0x20, -+0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0xAF, 0x03, 0xE4, 0xFC, 0x74, 0x01, 0xFE, 0x74, 0x05, -+0xD1, 0x19, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x07, 0x03, 0xFF, 0x90, 0x90, 0xA9, 0xE0, -+0xFF, 0xE4, 0xFC, 0x74, 0x01, 0xFE, 0x74, 0x05, 0xFD, 0xE4, 0x90, 0x90, 0x24, 0x12, 0x27, 0x48, -+0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0xD1, 0x27, 0x22, 0xFD, 0xE4, 0x90, 0x90, 0x24, 0x12, 0x27, -+0x48, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x90, 0x90, 0x1E, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, -+0x90, 0x1D, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x3A, 0xA9, 0x90, 0x90, 0x28, 0x12, 0x27, -+0x48, 0x90, 0x90, 0x20, 0x12, 0x46, 0x7B, 0x12, 0x27, 0x15, 0x90, 0x90, 0x28, 0x12, 0x46, 0x87, -+0x12, 0x46, 0x61, 0x90, 0x90, 0x24, 0x12, 0x46, 0x87, 0x12, 0x46, 0x6E, 0x90, 0x90, 0x2C, 0x12, -+0x27, 0x48, 0x90, 0x90, 0x1E, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x90, 0x2C, 0x12, 0x46, 0x7B, -+0x90, 0xAC, 0x96, 0x12, 0x27, 0x48, 0x90, 0x90, 0x1D, 0xE0, 0xFF, 0xD0, 0x05, 0x02, 0x39, 0xBA, -+0x90, 0x90, 0xAA, 0xEF, 0xF0, 0xD3, 0x94, 0x0E, 0x50, 0x14, 0x90, 0x90, 0xA2, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x4E, 0x60, 0x20, 0xEF, 0x64, 0x01, 0x4E, 0x70, 0x1A, 0xFF, 0x41, 0xC6, 0x90, 0x90, -+0xAA, 0xE0, 0xD3, 0x94, 0x0E, 0x40, 0x0E, 0x90, 0x90, 0xA2, 0xE0, 0x70, 0x02, 0xA3, 0xE0, 0x70, -+0x04, 0x7F, 0x01, 0x51, 0xC6, 0x22, 0xEF, 0x14, 0x60, 0x39, 0x14, 0x60, 0x52, 0x24, 0x02, 0x70, -+0x6A, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x90, 0x24, 0x12, 0x27, -+0x54, 0x00, 0x00, 0x0C, 0x00, 0xD1, 0x21, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, -+0x00, 0x90, 0x90, 0x24, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0x7F, -+0x01, 0x80, 0x36, 0x90, 0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x90, 0x24, -+0x12, 0x27, 0x54, 0x00, 0x00, 0x04, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x80, 0x1A, 0x90, -+0x90, 0x20, 0x12, 0x27, 0x54, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x90, 0x24, 0x12, 0x27, 0x54, 0x00, -+0x00, 0x00, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0xD1, 0x27, 0x22, 0xE4, 0xFE, 0xFC, 0xEF, -+0x64, 0x02, 0x70, 0x40, 0xED, 0xB4, 0x01, 0x04, 0x7E, 0x0A, 0x80, 0x06, 0xED, 0xB4, 0x02, 0x02, -+0x7E, 0x09, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x04, 0x80, 0x38, 0xEB, 0xB4, -+0x02, 0x08, 0xED, 0xB4, 0x01, 0x04, 0x7C, 0x02, 0x80, 0x2C, 0xEB, 0xB4, 0x01, 0x08, 0xED, 0xB4, -+0x02, 0x04, 0x7C, 0x01, 0x80, 0x20, 0xEB, 0x64, 0x02, 0x70, 0x1B, 0xED, 0x64, 0x02, 0x70, 0x16, -+0x7C, 0x03, 0x80, 0x12, 0xEF, 0xB4, 0x01, 0x0E, 0xEB, 0xB4, 0x02, 0x04, 0x7C, 0x01, 0x80, 0x06, -+0xEB, 0xB4, 0x01, 0x02, 0x7C, 0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4C, 0xFF, 0x22, 0x90, -+0x8F, 0x58, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, -+0x22, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8F, 0x58, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, -+0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0x8F, 0x59, 0xF0, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x26, 0x1E, 0xFE, 0x20, 0xE0, 0x06, 0x12, -+0x4F, 0xA7, 0x02, 0x78, 0x7C, 0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFD, 0x90, 0x8E, 0x41, 0xE0, -+0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xED, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, -+0x26, 0x1E, 0xFD, 0x54, 0x04, 0xFC, 0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0x8E, 0x41, 0xF0, 0xED, -+0x54, 0x08, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFD, 0x54, 0x10, 0xFC, -+0xEF, 0x54, 0xEF, 0x4C, 0xFF, 0x90, 0x8E, 0x41, 0xF0, 0xED, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, -+0x4D, 0xFF, 0xF0, 0x12, 0x26, 0x1E, 0xFD, 0x54, 0x40, 0xFC, 0xEF, 0x54, 0xBF, 0x4C, 0xFF, 0x90, -+0x8E, 0x41, 0xF0, 0xED, 0x54, 0x80, 0xFD, 0xEF, 0x54, 0x7F, 0x4D, 0xF0, 0x90, 0x00, 0x01, 0x12, -+0x26, 0x37, 0x54, 0x80, 0xFF, 0x90, 0x8E, 0x42, 0xE0, 0x54, 0x7F, 0x4F, 0xF0, 0xEE, 0x13, 0x13, -+0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x04, 0xF0, 0x12, 0x26, 0x1E, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x8D, -+0x01, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8F, 0x74, 0x12, 0x46, 0xA8, 0xE4, 0x90, -+0x8F, 0x77, 0xF0, 0x90, 0x8F, 0x74, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x04, 0xF9, 0xE4, 0x3A, 0x8B, -+0x40, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x78, 0x12, 0x34, -+0x2C, 0x90, 0x8F, 0x78, 0xE0, 0x20, 0xE0, 0x05, 0x90, 0x8F, 0x4B, 0x80, 0x03, 0x90, 0x8F, 0x4C, -+0xE0, 0x90, 0x8E, 0x56, 0xF0, 0x90, 0x8E, 0x56, 0xE0, 0x14, 0x60, 0x11, 0x14, 0x60, 0x16, 0x24, -+0xFE, 0x60, 0x12, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x06, 0x80, 0x10, 0x90, 0x8F, 0x77, -+0x74, 0x04, 0xF0, 0x80, 0x0D, 0x90, 0x8F, 0x77, 0x74, 0x08, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x8F, -+0x77, 0xF0, 0x90, 0x8F, 0x77, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x90, 0x7A, 0xED, -+0xF0, 0x90, 0x90, 0x77, 0x12, 0x46, 0xA8, 0xE4, 0x90, 0x90, 0x7B, 0xF0, 0xA3, 0xF0, 0x31, 0xA6, -+0x90, 0x90, 0x7B, 0xEF, 0xF0, 0x90, 0x90, 0x77, 0x12, 0x46, 0x9F, 0x11, 0x81, 0x90, 0x90, 0x7C, -+0xEF, 0xF0, 0x90, 0x8E, 0x56, 0xE0, 0x24, 0xFE, 0x60, 0x1D, 0x24, 0xFE, 0x60, 0x19, 0x14, 0x60, -+0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, 0x5F, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0x57, 0x90, 0x90, -+0x7A, 0xE0, 0xFD, 0x31, 0xCA, 0x80, 0x22, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0x5F, 0x90, 0x90, 0x5E, -+0x12, 0x46, 0xA8, 0x90, 0x90, 0x7A, 0xE0, 0x90, 0x90, 0x61, 0xF0, 0x90, 0x8E, 0x56, 0xE0, 0x90, -+0x90, 0x62, 0xF0, 0x7A, 0x8E, 0x79, 0x57, 0x51, 0x44, 0x90, 0x90, 0x7C, 0xE0, 0xFF, 0x90, 0x90, -+0x77, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x7B, 0xE0, 0x7C, 0x00, 0x29, 0xF9, 0xEC, 0x3A, 0xFA, 0xC3, -+0xE9, 0x9F, 0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x40, 0x01, 0x75, 0x41, 0x8E, 0x75, 0x42, 0x57, -+0xA3, 0xE0, 0xF5, 0x43, 0x12, 0x34, 0x2C, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x24, 0x28, 0xF9, -+0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xE4, 0x90, 0x8F, 0x73, 0xF0, 0xFF, 0x12, 0x26, 0x1E, 0x30, -+0xE7, 0x08, 0x90, 0x8F, 0x73, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x8F, 0x73, 0xF0, 0x11, -+0x81, 0x90, 0x8F, 0x73, 0xE0, 0x24, 0x18, 0x2F, 0xFF, 0x22, 0x90, 0x90, 0x66, 0xED, 0xF0, 0x90, -+0x90, 0x63, 0x12, 0x46, 0xA8, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0x90, 0x90, 0x6A, 0xF0, 0x90, -+0x90, 0x63, 0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x03, 0x7B, 0x01, -+0x7A, 0x90, 0x79, 0x67, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x66, 0xE0, 0x70, 0x46, 0xFF, 0x74, 0x67, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, 0xB4, 0xFF, 0x0E, 0x74, 0x67, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x0F, 0x74, 0x67, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x90, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x03, 0xD0, 0x75, 0x40, -+0x01, 0x75, 0x41, 0x90, 0x75, 0x42, 0x67, 0x75, 0x43, 0x03, 0x90, 0x90, 0x63, 0x12, 0x46, 0x9F, -+0x12, 0x34, 0x2C, 0x22, 0x90, 0x90, 0x5B, 0x12, 0x46, 0xA8, 0x90, 0x90, 0x61, 0xE0, 0x60, 0x02, -+0x61, 0x18, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x12, 0x26, 0x1E, 0xF4, 0x60, 0x02, 0x61, 0x0D, -+0x12, 0x26, 0x64, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xF4, -+0x60, 0x02, 0x41, 0xFD, 0x90, 0x00, 0x01, 0x12, 0x26, 0x76, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, -+0xF4, 0x70, 0x6F, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x02, 0xE4, 0x12, 0x26, 0x76, -+0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xF4, 0x70, 0x4E, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, -+0x00, 0x03, 0xE4, 0x12, 0x26, 0x76, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xF4, 0x70, 0x2D, 0x90, -+0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x04, 0xE4, 0x12, 0x26, 0x76, 0x90, 0x00, 0x05, 0x12, -+0x26, 0x37, 0x90, 0x90, 0x5E, 0xB4, 0xFF, 0x0C, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x05, 0xE4, 0x12, -+0x26, 0x76, 0x80, 0x44, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x05, 0x80, 0x2A, 0x90, 0x90, 0x5E, 0x12, -+0x46, 0x9F, 0x90, 0x00, 0x04, 0x80, 0x1F, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x03, -+0x80, 0x14, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x02, 0x80, 0x09, 0x90, 0x90, 0x5E, -+0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0x74, 0x01, 0x12, 0x46, 0x18, 0x80, 0x0B, 0x90, 0x90, 0x5E, -+0x12, 0x46, 0x9F, 0x74, 0x01, 0x12, 0x45, 0xF6, 0x90, 0x90, 0x62, 0xE0, 0xFF, 0x64, 0x04, 0x60, -+0x02, 0x61, 0xC7, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x12, 0x26, 0x1E, 0xFE, 0x90, 0x90, 0x5B, -+0x12, 0x46, 0x9F, 0xEE, 0x12, 0x26, 0x64, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, -+0x12, 0x26, 0x37, 0xFE, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x26, -+0x76, 0x90, 0x00, 0x02, 0xE4, 0x12, 0x26, 0x76, 0x90, 0x00, 0x03, 0x74, 0x20, 0x12, 0x26, 0x76, -+0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFE, 0x90, 0x90, 0x5B, -+0x12, 0x46, 0x9F, 0x90, 0x00, 0x04, 0xEE, 0x12, 0x26, 0x76, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, -+0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFE, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x05, -+0xEE, 0x12, 0x26, 0x76, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x04, 0x12, 0x26, 0x37, -+0xFE, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x06, 0xEE, 0x12, 0x26, 0x76, 0x90, 0x90, -+0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFE, 0x90, 0x90, 0x5B, 0x12, 0x46, -+0x9F, 0x90, 0x00, 0x07, 0xEE, 0x81, 0x87, 0xEF, 0x64, 0x02, 0x60, 0x02, 0x81, 0x8A, 0x90, 0x90, -+0x5E, 0x12, 0x46, 0x9F, 0x12, 0x26, 0x1E, 0xFF, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0xEF, 0x12, -+0x26, 0x64, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x44, 0x20, -+0x54, 0x7F, 0xFF, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x26, 0x76, -+0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, 0x90, 0x90, 0x5B, -+0x12, 0x46, 0x9F, 0x90, 0x00, 0x02, 0xEF, 0x12, 0x26, 0x76, 0x90, 0x00, 0x03, 0x74, 0x20, 0x12, -+0x26, 0x76, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0x90, -+0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x04, 0xEF, 0x12, 0x26, 0x76, 0x90, 0x90, 0x5E, 0x12, -+0x46, 0x9F, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFF, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, -+0x00, 0x05, 0xEF, 0x12, 0x26, 0x76, 0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x04, 0x12, -+0x26, 0x37, 0xFF, 0x90, 0x90, 0x5B, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x06, 0xEF, 0x12, 0x26, 0x76, -+0x90, 0x90, 0x5E, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x05, 0x12, 0x26, 0x37, 0xFF, 0x90, 0x90, 0x5B, -+0x12, 0x46, 0x9F, 0x90, 0x00, 0x07, 0xEF, 0x12, 0x26, 0x76, 0x22, 0x91, 0xEA, 0x7E, 0x00, 0x74, -+0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x08, -+0x7B, 0x01, 0x7A, 0x8E, 0x79, 0x57, 0x12, 0x34, 0x2C, 0x90, 0x8E, 0x57, 0xE0, 0x90, 0x8E, 0x5F, -+0xF0, 0x90, 0x8E, 0x58, 0xE0, 0x90, 0x8E, 0x60, 0xF0, 0x90, 0x8E, 0x59, 0xE0, 0x90, 0x8E, 0x61, -+0xF0, 0x90, 0x8E, 0x5A, 0xE0, 0x90, 0x8E, 0x62, 0xF0, 0x90, 0x8E, 0x5B, 0xE0, 0x90, 0x8E, 0x63, -+0xF0, 0x90, 0x8E, 0x5C, 0xE0, 0x90, 0x8E, 0x64, 0xF0, 0x90, 0x8E, 0x5D, 0xE0, 0x90, 0x8E, 0x65, -+0xF0, 0x90, 0x8E, 0x5E, 0xE0, 0x90, 0x8E, 0x66, 0xF0, 0x22, 0xE4, 0xFE, 0xEF, 0x25, 0xE0, 0xFD, -+0xEF, 0xC3, 0x94, 0x80, 0x90, 0xFD, 0x12, 0x50, 0x04, 0xE4, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, -+0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x90, 0x90, 0x07, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, -+0x78, 0x0F, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x50, 0x7E, 0x00, 0x7F, 0x06, -+0x12, 0x45, 0xD0, 0x78, 0x15, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x56, 0x7E, -+0x00, 0x7F, 0x04, 0x12, 0x45, 0xD0, 0x78, 0x19, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, -+0x79, 0x5A, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x45, 0xD0, 0x90, 0x90, 0x08, 0xE0, 0xFF, 0x90, 0x90, -+0x07, 0xE0, 0x2F, 0xFF, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x64, 0x08, -+0x60, 0x02, 0xC1, 0x4D, 0x74, 0x07, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x64, -+0x06, 0x60, 0x02, 0xC1, 0x4D, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x90, 0x07, 0xE0, -+0x24, 0x0A, 0xF9, 0xE4, 0x34, 0xFB, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, -+0x7B, 0x01, 0x7A, 0x90, 0x79, 0x09, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x08, 0xE0, 0xFF, 0x90, 0x90, -+0x07, 0xE0, 0x2F, 0x24, 0x10, 0xF9, 0xE4, 0x34, 0xFB, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, -+0x75, 0x43, 0x06, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x0F, 0x12, 0x34, 0x2C, 0x90, 0x90, 0x08, 0xE0, -+0xFF, 0x90, 0x90, 0x07, 0xE0, 0x2F, 0x24, 0x16, 0xF9, 0xE4, 0x34, 0xFB, 0x75, 0x40, 0x01, 0xF5, -+0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x15, 0x12, 0x34, 0x2C, 0x78, -+0x09, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0x46, 0x7E, 0x00, 0x7F, 0x06, 0x12, -+0x48, 0x5D, 0xEF, 0x70, 0x58, 0x90, 0x90, 0x08, 0xE0, 0xFF, 0x90, 0x90, 0x07, 0xE0, 0x2F, 0x24, -+0x20, 0xF9, 0xE4, 0x34, 0xFB, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, -+0x01, 0x7A, 0x90, 0x79, 0x19, 0x12, 0x34, 0x2C, 0x78, 0x19, 0x7C, 0x90, 0x7D, 0x01, 0x7B, 0x01, -+0x7A, 0x8E, 0x79, 0x52, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x48, 0x5D, 0xEF, 0x70, 0x18, 0x7B, 0x01, -+0x7A, 0x90, 0x79, 0x0F, 0x90, 0x90, 0x54, 0x12, 0x46, 0xA8, 0xE4, 0x90, 0x90, 0x57, 0xF0, 0x7A, -+0x90, 0x79, 0x15, 0x02, 0x6F, 0x12, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x02, -+0x09, 0xE0, 0x90, 0x8F, 0x71, 0xF0, 0x12, 0x26, 0x1E, 0x90, 0x8F, 0x4B, 0xF0, 0x90, 0x00, 0x01, -+0x12, 0x26, 0x37, 0x90, 0x8F, 0x4C, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x26, 0x1E, -+0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8F, 0x4D, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0xFF, -+0xED, 0x2F, 0x90, 0x8F, 0x4E, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, -+0x8F, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x50, 0xF0, -+0x90, 0x00, 0x04, 0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x51, 0xF0, 0x90, 0x00, 0x05, -+0x12, 0x26, 0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x52, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x26, 0x37, -+0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x8F, 0x53, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, -+0x26, 0x1E, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8F, 0x54, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x26, -+0x37, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x55, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x26, 0x37, 0xFF, 0xAE, -+0x05, 0xED, 0x2F, 0x90, 0x8F, 0x56, 0xF0, 0x22, 0x90, 0x8F, 0x5B, 0xE0, 0x30, 0xE0, 0x2D, 0x90, -+0x8F, 0x5E, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x90, 0x8F, 0x5C, 0xE0, 0xB5, 0x07, 0x1E, 0x90, 0x06, -+0x92, 0xE0, 0x54, 0x1C, 0x70, 0x0B, 0x12, 0x4E, 0xC0, 0x90, 0x8F, 0x5F, 0xE0, 0x04, 0xF0, 0x80, -+0x06, 0x90, 0x06, 0x92, 0x74, 0x1C, 0xF0, 0xE4, 0x90, 0x8F, 0x5E, 0xF0, 0x22, 0x12, 0x4D, 0x3A, -+0x12, 0x26, 0x1E, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8F, 0x5B, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, -+0xC3, 0x13, 0x30, 0xE0, 0x14, 0x90, 0x00, 0x01, 0x12, 0x26, 0x37, 0x90, 0x8F, 0x5C, 0xF0, 0x90, -+0x00, 0x02, 0x12, 0x26, 0x37, 0x90, 0x8F, 0x5D, 0xF0, 0x22, 0xE4, 0x90, 0x8E, 0x27, 0xF0, 0xA3, -+0xF0, 0x90, 0x8E, 0x26, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x54, -+0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x90, 0x8E, 0x2D, 0x74, 0x01, 0xF0, 0xA3, 0xF0, -+0x90, 0x8E, 0x24, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x8E, 0x30, -+0xF0, 0x90, 0x8E, 0x2F, 0x74, 0x07, 0xF0, 0x90, 0x8E, 0x32, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF0, -+0xE4, 0x90, 0x8E, 0x2B, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x29, 0x74, -+0x0C, 0xF0, 0x90, 0x8E, 0x24, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x0C, 0xF0, 0x90, -+0x8E, 0x24, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, -+0xF0, 0x54, 0xF7, 0xF0, 0x90, 0x8E, 0x34, 0x12, 0x27, 0x54, 0x00, 0x00, 0x00, 0x00, 0x90, 0x8D, -+0x01, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0x8E, 0x31, 0x74, 0xFF, 0xF0, 0x80, 0x12, 0x90, 0x8D, 0x01, -+0xE0, 0x90, 0x8E, 0x31, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x41, 0xF0, 0x90, -+0x8E, 0x38, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x07, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, -+0xA3, 0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x8E, -+0x24, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x8E, 0x30, 0xF0, 0x90, 0x8E, 0x2B, 0xF0, 0x22, 0xEF, -+0x24, 0xFE, 0x60, 0x0C, 0x04, 0x70, 0x28, 0x90, 0x8E, 0x2D, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x22, -+0xED, 0x70, 0x0A, 0x90, 0x8E, 0x3B, 0xE0, 0x90, 0x8E, 0x2D, 0xF0, 0x80, 0x05, 0x90, 0x8E, 0x2D, -+0xED, 0xF0, 0x90, 0x8E, 0x2D, 0xE0, 0xA3, 0xF0, 0x90, 0x8E, 0x25, 0xE0, 0x44, 0x08, 0xF0, 0x22, -+0x12, 0x57, 0x8F, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x67, -+0x90, 0x8E, 0x2B, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, -+0x56, 0x90, 0x8E, 0x29, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, -+0xF0, 0x80, 0x44, 0xEF, 0x30, 0xE2, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x38, 0x90, -+0x8E, 0x2B, 0xE0, 0x30, 0xE4, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x29, 0x90, 0x8E, -+0x25, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x20, 0xF0, 0x80, -+0x16, 0x90, 0x8E, 0x3F, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x80, 0xF0, 0x80, 0x08, 0x90, -+0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x7F, 0x00, 0x22, -+0x90, 0x02, 0x87, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2C, 0x90, 0x8E, -+0x40, 0xE0, 0x30, 0xE0, 0x0E, 0x90, 0x02, 0x82, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, -+0xF0, 0x80, 0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, -+0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, -+0x7F, 0x00, 0x22, 0xEF, 0x60, 0x3E, 0x90, 0x8D, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, 0x8E, -+0x25, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, -+0xBF, 0xF0, 0xE4, 0xFF, 0x12, 0x4E, 0xC2, 0xBF, 0x01, 0x0E, 0x90, 0x8E, 0x24, 0xE0, 0x44, 0x40, -+0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x06, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, -+0xB8, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x54, -+0xBF, 0xF0, 0x90, 0x8E, 0x2A, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x8E, 0x27, 0xE0, 0x60, 0x39, 0x90, -+0x8D, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x31, 0x90, 0x8E, 0x2E, 0xF0, 0x04, 0x60, 0x2A, 0x90, 0x8E, -+0x2B, 0xE0, 0x44, 0x10, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x2F, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, -+0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x34, 0x8C, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0x8E, -+0x2A, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x51, 0xAD, 0x22, 0x90, 0x8D, 0x04, 0xE0, 0xFF, 0x7D, 0x01, -+0x12, 0x4F, 0x3B, 0x8E, 0x0E, 0x8F, 0x0F, 0xAD, 0x0F, 0xAC, 0x0E, 0xAF, 0x0D, 0x12, 0x4E, 0xF0, -+0xAF, 0x0F, 0xAE, 0x0E, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x74, 0x0D, 0x2C, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x01, 0xF0, 0x74, 0x0D, 0x2C, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, -+0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xED, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0x8F, 0xB5, 0x12, 0x46, 0xA8, 0x90, 0x8F, 0xB8, 0xED, 0xF0, 0xE4, 0x90, 0x90, 0x04, 0xF0, 0x90, -+0x90, 0x04, 0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x14, 0x74, 0xC1, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x8F, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x90, 0x04, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x90, 0x8F, 0xB5, -+0x12, 0x46, 0x9F, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x90, 0x8F, 0xB8, 0xE0, 0xF5, 0x43, 0x7B, -+0x01, 0x7A, 0x8F, 0x79, 0xC1, 0x12, 0x34, 0x2C, 0xE4, 0x90, 0x8F, 0xC0, 0xF0, 0x90, 0x8F, 0xC0, -+0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x16, 0x74, 0xC1, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, -+0x83, 0xE0, 0x64, 0x36, 0xF0, 0x90, 0x8F, 0xC0, 0xE0, 0x04, 0xF0, 0x80, 0xE0, 0x90, 0x8F, 0xB9, -+0x12, 0x46, 0x9F, 0x90, 0x8F, 0xBC, 0xE0, 0xFF, 0xF5, 0x82, 0x75, 0x83, 0x00, 0x74, 0x80, 0x12, -+0x26, 0x76, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xFF, 0xE5, 0xF0, 0x34, 0x02, 0xFC, 0x90, -+0x00, 0x7E, 0x12, 0x26, 0x76, 0xEF, 0x90, 0x00, 0x7F, 0x12, 0x26, 0x76, 0xE4, 0x90, 0x90, 0x01, -+0xF0, 0xA3, 0xF0, 0x90, 0x90, 0x01, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xC0, 0xEE, 0x94, -+0x00, 0x40, 0x02, 0x81, 0xB2, 0xC3, 0xEF, 0x94, 0x40, 0xEE, 0x94, 0x00, 0x50, 0x52, 0xA3, 0x74, -+0x40, 0xF0, 0x74, 0xC1, 0x2F, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0x74, 0x40, 0x44, 0x88, -+0xFD, 0x12, 0x30, 0xA4, 0x90, 0x90, 0x01, 0xA3, 0xE0, 0x24, 0xC5, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, -+0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x90, 0x01, 0xA3, 0xE0, 0x24, -+0xC9, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x30, 0xA4, -+0x90, 0x90, 0x01, 0xA3, 0xE0, 0x24, 0xCD, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0x61, 0xF3, -+0xE4, 0x90, 0x90, 0x03, 0xF0, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, 0xE0, 0xFE, -+0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC0, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0x74, -+0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, 0xE0, 0xFE, -+0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC4, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, -+0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, -+0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC8, 0xF9, 0xEA, 0x34, 0xFF, -+0xFA, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, -+0x90, 0x01, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xCC, 0xF9, 0xEA, -+0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8B, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x90, 0x03, 0xE0, 0x44, -+0x90, 0x90, 0x01, 0x8C, 0xF0, 0xE4, 0x90, 0x90, 0x05, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, -+0x30, 0xE4, 0x22, 0xC3, 0x90, 0x90, 0x06, 0xE0, 0x94, 0xE8, 0x90, 0x90, 0x05, 0xE0, 0x94, 0x03, -+0x50, 0x13, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x90, 0x05, 0xE4, 0x75, 0xF0, 0x01, -+0x12, 0x46, 0x4B, 0x80, 0xD7, 0x90, 0x90, 0x05, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xE8, -+0xEE, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x01, 0xF0, 0xEE, 0x90, 0x06, 0x36, -+0xF0, 0x90, 0x90, 0x02, 0xE0, 0x54, 0x3F, 0x64, 0x30, 0x70, 0x4B, 0x90, 0x90, 0x05, 0xF0, 0xA3, -+0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x20, 0xE5, 0x22, 0xC3, 0x90, 0x90, 0x06, 0xE0, 0x94, 0xE8, 0x90, -+0x90, 0x05, 0xE0, 0x94, 0x03, 0x50, 0x13, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x90, -+0x05, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0x80, 0xD7, 0x90, 0x90, 0x05, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0xC3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x02, -+0xF0, 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x90, 0x90, 0x01, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x46, 0x4B, -+0x61, 0x03, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x10, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, -+0x80, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x0C, 0xF9, 0xE4, 0x3A, -+0xFA, 0x7D, 0x81, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x08, 0xF9, -+0xE4, 0x3A, 0xFA, 0x7D, 0x82, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, 0xE9, 0x24, -+0x04, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x83, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, -+0x7D, 0x84, 0x12, 0x33, 0x2F, 0xE4, 0x90, 0x90, 0x04, 0xF0, 0x90, 0x90, 0x04, 0xE0, 0xFF, 0xC3, -+0x94, 0x40, 0x50, 0x14, 0x74, 0xC1, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE4, 0xF0, -+0x90, 0x90, 0x04, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x90, 0x8F, 0xB5, 0x12, 0x46, 0x9F, 0x8B, 0x40, -+0x8A, 0x41, 0x89, 0x42, 0x90, 0x8F, 0xB8, 0xE0, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xC1, -+0x12, 0x34, 0x2C, 0xE4, 0x90, 0x8F, 0xC0, 0xF0, 0x90, 0x8F, 0xC0, 0xE0, 0xFF, 0xC3, 0x94, 0x40, -+0x50, 0x16, 0x74, 0xC1, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE0, 0x64, 0x5C, 0xF0, -+0x90, 0x8F, 0xC0, 0xE0, 0x04, 0xF0, 0x80, 0xE0, 0xE4, 0x90, 0x8F, 0xC0, 0xF0, 0x90, 0x8F, 0xBD, -+0x12, 0x46, 0x9F, 0x90, 0x8F, 0xC0, 0xE0, 0xFF, 0xF5, 0x82, 0x75, 0x83, 0x00, 0x12, 0x26, 0x37, -+0xFE, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xEE, 0x12, 0x26, 0x76, -+0x90, 0x8F, 0xC0, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0xD3, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, -+0x90, 0x00, 0x14, 0x74, 0x80, 0x12, 0x26, 0x76, 0x90, 0x8F, 0xC0, 0x74, 0x15, 0xF0, 0x90, 0x8F, -+0xC0, 0xE0, 0xFF, 0xC3, 0x94, 0x3E, 0x50, 0x17, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x8F, 0x82, -+0x75, 0x83, 0x00, 0xE4, 0x12, 0x26, 0x76, 0x90, 0x8F, 0xC0, 0xE0, 0x04, 0xF0, 0x80, 0xDF, 0x90, -+0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, 0x00, 0x3E, 0x74, 0x02, 0x12, 0x26, 0x76, 0x90, 0x00, 0x3F, -+0x74, 0xA0, 0x12, 0x26, 0x76, 0xE4, 0x90, 0x90, 0x01, 0xF0, 0xA3, 0xF0, 0x90, 0x90, 0x01, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0x80, 0xEE, 0x94, 0x00, 0x40, 0x02, 0xE1, 0x9B, 0xC3, 0xEF, -+0x94, 0x40, 0xEE, 0x94, 0x00, 0x50, 0x52, 0xA3, 0x74, 0x40, 0xF0, 0x74, 0xC1, 0x2F, 0xF9, 0xE4, -+0x34, 0x8F, 0xFA, 0x7B, 0x01, 0x74, 0x40, 0x44, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x90, 0x01, -+0xA3, 0xE0, 0x24, 0xC5, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x89, 0xFD, -+0x12, 0x30, 0xA4, 0x90, 0x90, 0x01, 0xA3, 0xE0, 0x24, 0xC9, 0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, -+0x01, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x90, 0x01, 0xA3, 0xE0, 0x24, 0xCD, -+0xF9, 0xE4, 0x34, 0x8F, 0xFA, 0x7B, 0x01, 0xC1, 0xDC, 0xE4, 0x90, 0x90, 0x03, 0xF0, 0x90, 0x8F, -+0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, -+0xE9, 0x24, 0xC0, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0x74, 0x88, 0xFD, 0x12, 0x30, 0xA4, 0x90, 0x8F, -+0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, -+0xE9, 0x24, 0xC4, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x89, 0xFD, 0x12, 0x30, 0xA4, -+0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, -+0x3E, 0xFA, 0xE9, 0x24, 0xC8, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, -+0x30, 0xA4, 0x90, 0x8F, 0xB9, 0x12, 0x46, 0x9F, 0x90, 0x90, 0x01, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, -+0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xCC, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x8B, -+0xFD, 0x12, 0x30, 0xA4, 0x90, 0x90, 0x03, 0xE0, 0x44, 0x90, 0x90, 0x01, 0x8C, 0xF0, 0xE4, 0x90, -+0x90, 0x05, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x30, 0xE4, 0x22, 0xC3, 0x90, 0x90, 0x06, -+0xE0, 0x94, 0xE8, 0x90, 0x90, 0x05, 0xE0, 0x94, 0x03, 0x50, 0x13, 0x7F, 0x01, 0x7E, 0x00, 0x12, -+0x3A, 0xF7, 0x90, 0x90, 0x05, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, 0x4B, 0x80, 0xD7, 0x90, 0x90, -+0x05, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x06, -+0x31, 0xE0, 0x44, 0x01, 0xF0, 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x90, 0x90, 0x02, 0xE0, 0x54, 0x3F, -+0x64, 0x30, 0x70, 0x4B, 0x90, 0x90, 0x05, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x20, 0xE5, -+0x22, 0xC3, 0x90, 0x90, 0x06, 0xE0, 0x94, 0xE8, 0x90, 0x90, 0x05, 0xE0, 0x94, 0x03, 0x50, 0x13, -+0x7F, 0x01, 0x7E, 0x00, 0x12, 0x3A, 0xF7, 0x90, 0x90, 0x05, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x46, -+0x4B, 0x80, 0xD7, 0x90, 0x90, 0x05, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, 0xE8, 0xEE, 0x94, -+0x03, 0x40, 0x0C, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x02, 0xF0, 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x90, -+0x90, 0x01, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x46, 0x4B, 0xA1, 0xEC, 0x90, 0x8F, 0xBD, 0x12, 0x46, -+0x9F, 0xE9, 0x24, 0x10, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x80, 0x12, 0x33, 0x2F, 0x90, 0x8F, 0xBD, -+0x12, 0x46, 0x9F, 0xE9, 0x24, 0x0C, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x81, 0x12, 0x33, 0x2F, 0x90, -+0x8F, 0xBD, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x08, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x82, 0x12, 0x33, -+0x2F, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, 0xE9, 0x24, 0x04, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x83, -+0x12, 0x33, 0x2F, 0x90, 0x8F, 0xBD, 0x12, 0x46, 0x9F, 0x7D, 0x84, 0x12, 0x33, 0x2F, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x00, 0xFD, 0x15, -+}; -+ -+static u4Byte ArrayLength_TC_8812A_FW_WoWLAN = 18454; -+ -+static void -+ODM_ReadFirmware_TC_8812A_FW_WoWLAN( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+) -+{ -+ ODM_MoveMemory(pDM_Odm, pFirmware, Array_TC_8812A_FW_WoWLAN, ArrayLength_TC_8812A_FW_WoWLAN); -+ *pFirmwareSize = ArrayLength_TC_8812A_FW_WoWLAN; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_FW.h 2018-02-06 17:42:30.706967105 +0200 -@@ -0,0 +1,42 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_TC_FW_HW_IMG_8812A_H -+#define __INC_TC_FW_HW_IMG_8812A_H -+ -+ -+/****************************************************************************** -+* FW_NIC.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_TC_8812A_FW_NIC( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_WoWLAN.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_TC_8812A_FW_WoWLAN( -+ IN PDM_ODM_T pDM_Odm, -+ OUT u1Byte *pFirmware, -+ OUT u4Byte *pFirmwareSize -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.c 2018-02-06 17:42:30.706967105 +0200 -@@ -0,0 +1,224 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+static bool -+CheckCondition( -+ const u4Byte Condition, -+ const u4Byte Hex -+ ) -+{ -+ u4Byte _board = (Hex & 0x000000FF); -+ u4Byte _interface = (Hex & 0x0000FF00) >> 8; -+ u4Byte _platform = (Hex & 0x00FF0000) >> 16; -+ u4Byte cond = Condition; -+ -+ if ( Condition == 0xCDCDCDCD ) -+ return true; -+ -+ cond = Condition & 0x000000FF; -+ if ( (_board != cond) && (cond != 0xFF) ) -+ return false; -+ -+ cond = Condition & 0x0000FF00; -+ cond = cond >> 8; -+ if ( ((_interface & cond) == 0) && (cond != 0x07) ) -+ return false; -+ -+ cond = Condition & 0x00FF0000; -+ cond = cond >> 16; -+ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) -+ return false; -+ return true; -+} -+ -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+static u4Byte Array_TC_8812A_MAC_REG[] = { -+ 0x010, 0x0000000C, -+ 0x072, 0x00000000, -+ 0x428, 0x0000000A, -+ 0x429, 0x00000010, -+ 0x430, 0x00000000, -+ 0x431, 0x00000000, -+ 0x432, 0x00000000, -+ 0x433, 0x00000001, -+ 0x434, 0x00000004, -+ 0x435, 0x00000005, -+ 0x436, 0x00000007, -+ 0x437, 0x00000008, -+ 0x43C, 0x00000004, -+ 0x43D, 0x00000005, -+ 0x43E, 0x00000007, -+ 0x43F, 0x00000008, -+ 0x440, 0x0000005D, -+ 0x441, 0x00000001, -+ 0x442, 0x00000000, -+ 0x444, 0x00000010, -+ 0x445, 0x00000000, -+ 0x446, 0x00000000, -+ 0x447, 0x00000000, -+ 0x448, 0x00000000, -+ 0x449, 0x000000F0, -+ 0x44A, 0x0000000F, -+ 0x44B, 0x0000003E, -+ 0x44C, 0x00000010, -+ 0x44D, 0x00000000, -+ 0x44E, 0x00000000, -+ 0x44F, 0x00000000, -+ 0x450, 0x00000000, -+ 0x451, 0x000000F0, -+ 0x452, 0x0000000F, -+ 0x453, 0x00000000, -+ 0x45B, 0x00000080, -+ 0x460, 0x00000066, -+ 0x461, 0x00000066, -+ 0x4C8, 0x000000FF, -+ 0x4C9, 0x00000008, -+ 0x4CC, 0x000000FF, -+ 0x4CD, 0x000000FF, -+ 0x4CE, 0x00000001, -+ 0x500, 0x00000026, -+ 0x501, 0x000000A2, -+ 0x502, 0x0000002F, -+ 0x503, 0x00000000, -+ 0x504, 0x00000028, -+ 0x505, 0x000000A3, -+ 0x506, 0x0000005E, -+ 0x507, 0x00000000, -+ 0x508, 0x0000002B, -+ 0x509, 0x000000A4, -+ 0x50A, 0x0000005E, -+ 0x50B, 0x00000000, -+ 0x50C, 0x0000004F, -+ 0x50D, 0x000000A4, -+ 0x50E, 0x00000000, -+ 0x50F, 0x00000000, -+ 0x512, 0x0000001C, -+ 0x514, 0x0000000A, -+ 0x516, 0x0000000A, -+ 0x525, 0x0000004F, -+ 0x550, 0x00000010, -+ 0x551, 0x00000010, -+ 0x559, 0x00000002, -+ 0x55C, 0x00000050, -+ 0x55D, 0x000000FF, -+ 0x604, 0x00000009, -+ 0x605, 0x00000030, -+ 0x607, 0x00000007, -+ 0x608, 0x0000000E, -+ 0x609, 0x0000002A, -+ 0x620, 0x000000FF, -+ 0x621, 0x000000FF, -+ 0x622, 0x000000FF, -+ 0x623, 0x000000FF, -+ 0x624, 0x000000FF, -+ 0x625, 0x000000FF, -+ 0x626, 0x000000FF, -+ 0x627, 0x000000FF, -+ 0x638, 0x00000050, -+ 0x63C, 0x0000000A, -+ 0x63D, 0x0000000A, -+ 0x63E, 0x0000000E, -+ 0x63F, 0x0000000E, -+ 0x640, 0x00000040, -+ 0x642, 0x00000040, -+ 0x643, 0x00000000, -+ 0x66E, 0x00000005, -+ 0x700, 0x00000021, -+ 0x701, 0x00000043, -+ 0x702, 0x00000065, -+ 0x703, 0x00000087, -+ 0x708, 0x00000021, -+ 0x709, 0x00000043, -+ 0x70A, 0x00000065, -+ 0x70B, 0x00000087, -+ 0x718, 0x00000040, -+ -+}; -+ -+static void -+ODM_ReadAndConfig_TC_8812A_MAC_REG( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_TC_8812A_MAC_REG)/sizeof(u4Byte); -+ pu4Byte Array = Array_TC_8812A_MAC_REG; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_MAC_REG, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigMAC_8812A(pDM_Odm, v1, (u1Byte)v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigMAC_8812A(pDM_Odm, v1, (u1Byte)v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_MAC.h 2018-02-06 17:42:30.706967105 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_TC_MAC_HW_IMG_8812A_H -+#define __INC_TC_MAC_HW_IMG_8812A_H -+ -+static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8812A_MAC_REG( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.c 2018-02-06 17:42:30.706967105 +0200 -@@ -0,0 +1,1893 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+static bool -+CheckCondition( -+ u4Byte Condition, -+ u4Byte Hex -+ ) -+{ -+ u4Byte _board = (Hex & 0x000000FF); -+ u4Byte _interface = (Hex & 0x0000FF00) >> 8; -+ u4Byte _platform = (Hex & 0x00FF0000) >> 16; -+ u4Byte cond = Condition; -+ -+ if ( Condition == 0xCDCDCDCD ) -+ return true; -+ -+ cond = Condition & 0x000000FF; -+ if ( (_board != cond) && (cond != 0xFF) ) -+ return false; -+ -+ cond = Condition & 0x0000FF00; -+ cond = cond >> 8; -+ if ( ((_interface & cond) == 0) && (cond != 0x07) ) -+ return false; -+ -+ cond = Condition & 0x00FF0000; -+ cond = cond >> 16; -+ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) -+ return false; -+ return true; -+} -+ -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+static u4Byte Array_TC_8812A_RadioA[] = { -+ 0x000, 0x00010000, -+ 0x018, 0x0001712A, -+ 0x056, 0x00051CF2, -+ 0x066, 0x00040000, -+ 0x01E, 0x000F8000, -+ 0x089, 0x00000080, -+ 0xFF0F0740, 0xABCD, -+ 0x086, 0x00014B38, -+ 0xFF0F07C0, 0xCDEF, -+ 0x086, 0x00014B38, -+ 0xFF0F07D8, 0xCDEF, -+ 0x086, 0x00014B3C, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x086, 0x00014B38, -+ 0xFF0F0740, 0xDEAD, -+ 0x0B1, 0x0001FC1A, -+ 0x0B3, 0x000F0810, -+ 0x0B4, 0x0001A78D, -+ 0x0BA, 0x00086180, -+ 0x018, 0x00000006, -+ 0x0EF, 0x00002000, -+ 0x03B, 0x00038A58, -+ 0x03B, 0x00037A58, -+ 0x03B, 0x0002A590, -+ 0x03B, 0x00027A50, -+ 0x03B, 0x00018248, -+ 0x03B, 0x00010240, -+ 0x03B, 0x00008240, -+ 0x03B, 0x00000240, -+ 0x0EF, 0x00000100, -+ 0xFF0F07D8, 0xABCD, -+ 0x034, 0x0000A4EE, -+ 0x034, 0x00009076, -+ 0x034, 0x00008073, -+ 0x034, 0x00007070, -+ 0x034, 0x0000606D, -+ 0x034, 0x0000506A, -+ 0x034, 0x00004049, -+ 0x034, 0x00003046, -+ 0x034, 0x00002028, -+ 0x034, 0x00001025, -+ 0x034, 0x00000022, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0000ADF4, -+ 0x034, 0x00009DF1, -+ 0x034, 0x00008DEE, -+ 0x034, 0x00007DEB, -+ 0x034, 0x00006DE8, -+ 0x034, 0x00005CEC, -+ 0x034, 0x00004CE9, -+ 0x034, 0x000034EA, -+ 0x034, 0x000024E7, -+ 0x034, 0x0000146B, -+ 0x034, 0x0000006D, -+ 0xFF0F07D8, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x000020A2, -+ 0x0DF, 0x00000080, -+ 0x035, 0x00000192, -+ 0x035, 0x00008192, -+ 0x035, 0x00010192, -+ 0x036, 0x00000024, -+ 0x036, 0x00008024, -+ 0x036, 0x00010024, -+ 0x036, 0x00018024, -+ 0x0EF, 0x00000000, -+ 0x051, 0x00000C21, -+ 0x052, 0x000006D9, -+ 0x053, 0x000FC649, -+ 0x054, 0x0000017E, -+ 0x0EF, 0x00000002, -+ 0x008, 0x00008400, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00001000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x0003A02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x0003202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x0002B064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x00023070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0001B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00012085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0000A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00002080, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x0007A02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x0007202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x0006B064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x00023070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0005B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00052085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0004A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00042080, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x000BA02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x000B202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x000AB064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x000A3070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0009B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00092085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0008A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00082080, -+ 0x03C, 0x00010000, -+ 0x0EF, 0x00001100, -+ 0xFF0F0740, 0xABCD, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0xFF0F07C0, 0xCDEF, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0xFF0F07D8, 0xCDEF, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0004ADF5, -+ 0x034, 0x00049DF2, -+ 0x034, 0x00048DEF, -+ 0x034, 0x00047DEC, -+ 0x034, 0x00046DE9, -+ 0x034, 0x00045DC9, -+ 0x034, 0x00044CE8, -+ 0x034, 0x000438CA, -+ 0x034, 0x00042889, -+ 0x034, 0x0004184A, -+ 0x034, 0x0004044A, -+ 0xFF0F0740, 0xDEAD, -+ 0xFF0F0740, 0xABCD, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0xFF0F07C0, 0xCDEF, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0xFF0F07D8, 0xCDEF, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0002ADF5, -+ 0x034, 0x00029DF2, -+ 0x034, 0x00028DEF, -+ 0x034, 0x00027DEC, -+ 0x034, 0x00026DE9, -+ 0x034, 0x00025DC9, -+ 0x034, 0x00024CE8, -+ 0x034, 0x000238CA, -+ 0x034, 0x00022889, -+ 0x034, 0x0002184A, -+ 0x034, 0x0002044A, -+ 0xFF0F0740, 0xDEAD, -+ 0xFF0F0740, 0xABCD, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0xFF0F07C0, 0xCDEF, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0xFF0F07D8, 0xCDEF, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0000AFF7, -+ 0x034, 0x00009DF7, -+ 0x034, 0x00008DF4, -+ 0x034, 0x00007DF1, -+ 0x034, 0x00006DEE, -+ 0x034, 0x00005DCD, -+ 0x034, 0x00004CEB, -+ 0x034, 0x000038CC, -+ 0x034, 0x0000288B, -+ 0x034, 0x0000184C, -+ 0x034, 0x0000044C, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0xFF0F0740, 0xABCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001D4, -+ 0x035, 0x000081D4, -+ 0x035, 0x000101D4, -+ 0x035, 0x000201B4, -+ 0x035, 0x000281B4, -+ 0x035, 0x000301B4, -+ 0x035, 0x000401B4, -+ 0x035, 0x000481B4, -+ 0x035, 0x000501B4, -+ 0xFF0F07C0, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001D4, -+ 0x035, 0x000081D4, -+ 0x035, 0x000101D4, -+ 0x035, 0x000201B4, -+ 0x035, 0x000281B4, -+ 0x035, 0x000301B4, -+ 0x035, 0x000401B4, -+ 0x035, 0x000481B4, -+ 0x035, 0x000501B4, -+ 0xFF0F07D8, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001D4, -+ 0x035, 0x000081D4, -+ 0x035, 0x000101D4, -+ 0x035, 0x000201B4, -+ 0x035, 0x000281B4, -+ 0x035, 0x000301B4, -+ 0x035, 0x000401B4, -+ 0x035, 0x000481B4, -+ 0x035, 0x000501B4, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x00000188, -+ 0x035, 0x00008188, -+ 0x035, 0x00010185, -+ 0x035, 0x000201D7, -+ 0x035, 0x000281D7, -+ 0x035, 0x000301D5, -+ 0x035, 0x000401D8, -+ 0x035, 0x000481D8, -+ 0x035, 0x000501D5, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0xFF0F0740, 0xABCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00004BFB, -+ 0x036, 0x0000CBFB, -+ 0x036, 0x00014BFB, -+ 0x036, 0x0001CBFB, -+ 0x036, 0x00024F4B, -+ 0x036, 0x0002CF4B, -+ 0x036, 0x00034F4B, -+ 0x036, 0x0003CF4B, -+ 0x036, 0x00044F4B, -+ 0x036, 0x0004CF4B, -+ 0x036, 0x00054F4B, -+ 0x036, 0x0005CF4B, -+ 0xFF0F07C0, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00004BFB, -+ 0x036, 0x0000CBFB, -+ 0x036, 0x00014BFB, -+ 0x036, 0x0001CBFB, -+ 0x036, 0x00024F4B, -+ 0x036, 0x0002CF4B, -+ 0x036, 0x00034F4B, -+ 0x036, 0x0003CF4B, -+ 0x036, 0x00044F4B, -+ 0x036, 0x0004CF4B, -+ 0x036, 0x00054F4B, -+ 0x036, 0x0005CF4B, -+ 0xFF0F07D8, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00004BFB, -+ 0x036, 0x0000CBFB, -+ 0x036, 0x00014BFB, -+ 0x036, 0x0001CBFB, -+ 0x036, 0x00024F4B, -+ 0x036, 0x0002CF4B, -+ 0x036, 0x00034F4B, -+ 0x036, 0x0003CF4B, -+ 0x036, 0x00044F4B, -+ 0x036, 0x0004CF4B, -+ 0x036, 0x00054F4B, -+ 0x036, 0x0005CF4B, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00084EB4, -+ 0x036, 0x0008C9B4, -+ 0x036, 0x000949B4, -+ 0x036, 0x0009C9B4, -+ 0x036, 0x000A4935, -+ 0x036, 0x000AC935, -+ 0x036, 0x000B4935, -+ 0x036, 0x000BC935, -+ 0x036, 0x000C4EB4, -+ 0x036, 0x000CCEB4, -+ 0x036, 0x000D4EB4, -+ 0x036, 0x000DCEB4, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000008, -+ 0xFF0F0740, 0xABCD, -+ 0x03C, 0x000002CC, -+ 0x03C, 0x00000522, -+ 0x03C, 0x00000902, -+ 0xFF0F07C0, 0xCDEF, -+ 0x03C, 0x000002CC, -+ 0x03C, 0x00000522, -+ 0x03C, 0x00000902, -+ 0xFF0F07D8, 0xCDEF, -+ 0x03C, 0x000002CC, -+ 0x03C, 0x00000522, -+ 0x03C, 0x00000902, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x03C, 0x000002AA, -+ 0x03C, 0x000005A2, -+ 0x03C, 0x00000880, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000002, -+ 0x0DF, 0x00000080, -+ 0x01F, 0x00040064, -+ 0xFF0F0740, 0xABCD, -+ 0x061, 0x000FDD43, -+ 0x062, 0x00038F4B, -+ 0x063, 0x00032117, -+ 0x064, 0x000194AC, -+ 0x065, 0x000931D1, -+ 0xFF0F07C0, 0xCDEF, -+ 0x061, 0x000FDD43, -+ 0x062, 0x00038F4B, -+ 0x063, 0x00032117, -+ 0x064, 0x000194AC, -+ 0x065, 0x000931D1, -+ 0xFF0F07D8, 0xCDEF, -+ 0x061, 0x000FDD43, -+ 0x062, 0x00038F4B, -+ 0x063, 0x00032117, -+ 0x064, 0x000194AC, -+ 0x065, 0x000931D1, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x061, 0x000E5D53, -+ 0x062, 0x00038FCD, -+ 0x063, 0x000314EB, -+ 0x064, 0x000196AC, -+ 0x065, 0x000931D7, -+ 0xFF0F0740, 0xDEAD, -+ 0x008, 0x00008400, -+ 0x01C, 0x000739D2, -+ 0x0B4, 0x0001E78D, -+ 0x018, 0x0001F12A, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0B4, 0x0001A78D, -+ -+}; -+ -+static void -+ODM_ReadAndConfig_TC_8812A_RadioA( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_TC_8812A_RadioA)/sizeof(u4Byte); -+ static pu4Byte Array = Array_TC_8812A_RadioA; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_RadioA, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigRF_RadioA_8812A(pDM_Odm, v1, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigRF_RadioA_8812A(pDM_Odm, v1, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* RadioB.TXT -+******************************************************************************/ -+ -+static u4Byte Array_TC_8812A_RadioB[] = { -+ 0x056, 0x00051CF2, -+ 0x066, 0x00040000, -+ 0x089, 0x00000080, -+ 0xFF0F0740, 0xABCD, -+ 0x086, 0x00014B38, -+ 0xFF0F07C0, 0xCDEF, -+ 0x086, 0x00014B38, -+ 0xFF0F07D8, 0xCDEF, -+ 0x086, 0x00014B3C, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x086, 0x00014B38, -+ 0xFF0F0740, 0xDEAD, -+ 0x018, 0x00000006, -+ 0x0EF, 0x00002000, -+ 0x03B, 0x00038A58, -+ 0x03B, 0x00037A58, -+ 0x03B, 0x0002A590, -+ 0x03B, 0x00027A50, -+ 0x03B, 0x00018248, -+ 0x03B, 0x00010240, -+ 0x03B, 0x00008240, -+ 0x03B, 0x00000240, -+ 0x0EF, 0x00000100, -+ 0xFF0F07D8, 0xABCD, -+ 0x034, 0x0000A4EE, -+ 0x034, 0x00009076, -+ 0x034, 0x00008073, -+ 0x034, 0x00007070, -+ 0x034, 0x0000606D, -+ 0x034, 0x0000506A, -+ 0x034, 0x00004049, -+ 0x034, 0x00003046, -+ 0x034, 0x00002028, -+ 0x034, 0x00001025, -+ 0x034, 0x00000022, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0000ADF4, -+ 0x034, 0x00009DF1, -+ 0x034, 0x00008DEE, -+ 0x034, 0x00007DEB, -+ 0x034, 0x00006DE8, -+ 0x034, 0x00005CEC, -+ 0x034, 0x00004CE9, -+ 0x034, 0x000034EA, -+ 0x034, 0x000024E7, -+ 0x034, 0x0000146B, -+ 0x034, 0x0000006D, -+ 0xFF0F07D8, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x000020A2, -+ 0x0DF, 0x00000080, -+ 0x035, 0x00000192, -+ 0x035, 0x00008192, -+ 0x035, 0x00010192, -+ 0x036, 0x00000024, -+ 0x036, 0x00008024, -+ 0x036, 0x00010024, -+ 0x036, 0x00018024, -+ 0x0EF, 0x00000000, -+ 0x051, 0x00000C21, -+ 0x052, 0x000006D9, -+ 0x053, 0x000FC649, -+ 0x054, 0x0000017E, -+ 0x0EF, 0x00000002, -+ 0x008, 0x00008400, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00001000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x0003A02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x0003202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x0002B064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x00023070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0001B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00012085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0000A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00002080, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x0007A02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x0007202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x0006B064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x00063070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0005B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00052085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0004A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00042080, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000080, -+ 0x03B, 0x000BA02C, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000400, -+ 0x03B, 0x000B202C, -+ 0x03C, 0x00010000, -+ 0x03A, 0x000000A0, -+ 0x03B, 0x000AB064, -+ 0x03C, 0x00004000, -+ 0x03A, 0x000000D8, -+ 0x03B, 0x000A3070, -+ 0x03C, 0x00004000, -+ 0x03A, 0x00000468, -+ 0x03B, 0x0009B870, -+ 0x03C, 0x00010000, -+ 0x03A, 0x00000098, -+ 0x03B, 0x00092085, -+ 0x03C, 0x000E4000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x0008A080, -+ 0x03C, 0x000F0000, -+ 0x03A, 0x00000418, -+ 0x03B, 0x00082080, -+ 0x03C, 0x00010000, -+ 0x0EF, 0x00001100, -+ 0xFF0F0740, 0xABCD, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0xFF0F07C0, 0xCDEF, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0xFF0F07D8, 0xCDEF, -+ 0x034, 0x0004A0B2, -+ 0x034, 0x000490AF, -+ 0x034, 0x00048070, -+ 0x034, 0x0004706D, -+ 0x034, 0x00046050, -+ 0x034, 0x0004504D, -+ 0x034, 0x0004404A, -+ 0x034, 0x00043047, -+ 0x034, 0x0004200A, -+ 0x034, 0x00041007, -+ 0x034, 0x00040004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0004ADF5, -+ 0x034, 0x00049DF2, -+ 0x034, 0x00048DEF, -+ 0x034, 0x00047DEC, -+ 0x034, 0x00046DE9, -+ 0x034, 0x00045DC9, -+ 0x034, 0x00044CE8, -+ 0x034, 0x000438CA, -+ 0x034, 0x00042889, -+ 0x034, 0x0004184A, -+ 0x034, 0x0004044A, -+ 0xFF0F0740, 0xDEAD, -+ 0xFF0F0740, 0xABCD, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0xFF0F07C0, 0xCDEF, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0xFF0F07D8, 0xCDEF, -+ 0x034, 0x0002A0B2, -+ 0x034, 0x000290AF, -+ 0x034, 0x00028070, -+ 0x034, 0x0002706D, -+ 0x034, 0x00026050, -+ 0x034, 0x0002504D, -+ 0x034, 0x0002404A, -+ 0x034, 0x00023047, -+ 0x034, 0x0002200A, -+ 0x034, 0x00021007, -+ 0x034, 0x00020004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0002ADF5, -+ 0x034, 0x00029DF2, -+ 0x034, 0x00028DEF, -+ 0x034, 0x00027DEC, -+ 0x034, 0x00026DE9, -+ 0x034, 0x00025DC9, -+ 0x034, 0x00024CE8, -+ 0x034, 0x000238CA, -+ 0x034, 0x00022889, -+ 0x034, 0x0002184A, -+ 0x034, 0x0002044A, -+ 0xFF0F0740, 0xDEAD, -+ 0xFF0F0740, 0xABCD, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0xFF0F07C0, 0xCDEF, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0xFF0F07D8, 0xCDEF, -+ 0x034, 0x0000A0B2, -+ 0x034, 0x000090AF, -+ 0x034, 0x00008070, -+ 0x034, 0x0000706D, -+ 0x034, 0x00006050, -+ 0x034, 0x0000504D, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x0000200A, -+ 0x034, 0x00001007, -+ 0x034, 0x00000004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0000AFF7, -+ 0x034, 0x00009DF7, -+ 0x034, 0x00008DF4, -+ 0x034, 0x00007DF1, -+ 0x034, 0x00006DEE, -+ 0x034, 0x00005DCD, -+ 0x034, 0x00004CEB, -+ 0x034, 0x000038CC, -+ 0x034, 0x0000288B, -+ 0x034, 0x0000184C, -+ 0x034, 0x0000044C, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0xFF0F0740, 0xABCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001C5, -+ 0x035, 0x000081C5, -+ 0x035, 0x000101C5, -+ 0x035, 0x00020174, -+ 0x035, 0x00028174, -+ 0x035, 0x00030174, -+ 0x035, 0x00040185, -+ 0x035, 0x00048185, -+ 0x035, 0x00050185, -+ 0x0EF, 0x00000000, -+ 0xFF0F07C0, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001C5, -+ 0x035, 0x000081C5, -+ 0x035, 0x000101C5, -+ 0x035, 0x00020174, -+ 0x035, 0x00028174, -+ 0x035, 0x00030174, -+ 0x035, 0x00040185, -+ 0x035, 0x00048185, -+ 0x035, 0x00050185, -+ 0x0EF, 0x00000000, -+ 0xFF0F07D8, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x000001C5, -+ 0x035, 0x000081C5, -+ 0x035, 0x000101C5, -+ 0x035, 0x00020174, -+ 0x035, 0x00028174, -+ 0x035, 0x00030174, -+ 0x035, 0x00040185, -+ 0x035, 0x00048185, -+ 0x035, 0x00050185, -+ 0x0EF, 0x00000000, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x00000186, -+ 0x035, 0x00008186, -+ 0x035, 0x00010185, -+ 0x035, 0x000201D5, -+ 0x035, 0x000281D5, -+ 0x035, 0x000301D5, -+ 0x035, 0x000401D5, -+ 0x035, 0x000481D5, -+ 0x035, 0x000501D5, -+ 0x0EF, 0x00000000, -+ 0xFF0F0740, 0xDEAD, -+ 0xFF0F0740, 0xABCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00005B8B, -+ 0x036, 0x0000DB8B, -+ 0x036, 0x00015B8B, -+ 0x036, 0x0001DB8B, -+ 0x036, 0x000262DB, -+ 0x036, 0x0002E2DB, -+ 0x036, 0x000362DB, -+ 0x036, 0x0003E2DB, -+ 0x036, 0x0004553B, -+ 0x036, 0x0004D53B, -+ 0x036, 0x0005553B, -+ 0x036, 0x0005D53B, -+ 0xFF0F07C0, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00005B8B, -+ 0x036, 0x0000DB8B, -+ 0x036, 0x00015B8B, -+ 0x036, 0x0001DB8B, -+ 0x036, 0x000262DB, -+ 0x036, 0x0002E2DB, -+ 0x036, 0x000362DB, -+ 0x036, 0x0003E2DB, -+ 0x036, 0x0004553B, -+ 0x036, 0x0004D53B, -+ 0x036, 0x0005553B, -+ 0x036, 0x0005D53B, -+ 0xFF0F07D8, 0xCDEF, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00005B8B, -+ 0x036, 0x0000DB8B, -+ 0x036, 0x00015B8B, -+ 0x036, 0x0001DB8B, -+ 0x036, 0x000262DB, -+ 0x036, 0x0002E2DB, -+ 0x036, 0x000362DB, -+ 0x036, 0x0003E2DB, -+ 0x036, 0x0004553B, -+ 0x036, 0x0004D53B, -+ 0x036, 0x0005553B, -+ 0x036, 0x0005D53B, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x00084EB4, -+ 0x036, 0x0008C9B4, -+ 0x036, 0x000949B4, -+ 0x036, 0x0009C9B4, -+ 0x036, 0x000A4935, -+ 0x036, 0x000AC935, -+ 0x036, 0x000B4935, -+ 0x036, 0x000BC935, -+ 0x036, 0x000C4EB4, -+ 0x036, 0x000CCEB4, -+ 0x036, 0x000D4EB4, -+ 0x036, 0x000DCEB4, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000008, -+ 0xFF0F0740, 0xABCD, -+ 0x03C, 0x000002DC, -+ 0x03C, 0x00000524, -+ 0x03C, 0x00000902, -+ 0xFF0F07C0, 0xCDEF, -+ 0x03C, 0x000002DC, -+ 0x03C, 0x00000524, -+ 0x03C, 0x00000902, -+ 0xFF0F07D8, 0xCDEF, -+ 0x03C, 0x000002DC, -+ 0x03C, 0x00000524, -+ 0x03C, 0x00000902, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x03C, 0x000002AA, -+ 0x03C, 0x000005A2, -+ 0x03C, 0x00000880, -+ 0xFF0F0740, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000002, -+ 0x0DF, 0x00000080, -+ 0xFF0F0740, 0xABCD, -+ 0x061, 0x000EAC43, -+ 0x062, 0x00038F47, -+ 0x063, 0x00031157, -+ 0x064, 0x0001C4AC, -+ 0x065, 0x000931D1, -+ 0xFF0F07C0, 0xCDEF, -+ 0x061, 0x000EAC43, -+ 0x062, 0x00038F47, -+ 0x063, 0x00031157, -+ 0x064, 0x0001C4AC, -+ 0x065, 0x000931D1, -+ 0xFF0F07D8, 0xCDEF, -+ 0x061, 0x000EAC43, -+ 0x062, 0x00038F47, -+ 0x063, 0x00031157, -+ 0x064, 0x0001C4AC, -+ 0x065, 0x000931D1, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x061, 0x000E5D53, -+ 0x062, 0x00038FCD, -+ 0x063, 0x000314EB, -+ 0x064, 0x000196AC, -+ 0x065, 0x000931D7, -+ 0xFF0F0740, 0xDEAD, -+ 0x008, 0x00008400, -+ -+}; -+ -+static void -+ODM_ReadAndConfig_TC_8812A_RadioB( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_TC_8812A_RadioB)/sizeof(u4Byte); -+ pu4Byte Array = Array_TC_8812A_RadioB; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_RadioB, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigRF_RadioB_8812A(pDM_Odm, v1, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigRF_RadioB_8812A(pDM_Odm, v1, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* TxPowerTrack_AP.TXT -+******************************************************************************/ -+ -+static u1Byte gDeltaSwingTableIdx_TC_5GB_N__8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+static u1Byte gDeltaSwingTableIdx_TC_5GB_P__8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 17, 17, 18, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+static u1Byte gDeltaSwingTableIdx_TC_5GA_N__8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 4, 4, 5, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 13, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16}, -+}; -+static u1Byte gDeltaSwingTableIdx_TC_5GA_P__8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 7, 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 18, 19, 19, 19}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+static u1Byte gDeltaSwingTableIdx_TC_2GB_N__8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_TC_2GB_P__8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static u1Byte gDeltaSwingTableIdx_TC_2GA_N__8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_TC_2GA_P__8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static u1Byte gDeltaSwingTableIdx_TC_2GCCKB_N__8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_TC_2GCCKB_P__8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static u1Byte gDeltaSwingTableIdx_TC_2GCCKA_N__8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_TC_2GCCKA_P__8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+ -+static void -+ODM_ReadAndConfig_TC_8812A_TxPowerTrack_AP( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_TC_8812A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_TC_2GA_P__8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_TC_2GA_N__8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_TC_2GB_P__8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_TC_2GB_N__8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_TC_2GCCKA_P__8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_TC_2GCCKA_N__8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_TC_2GCCKB_P__8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_TC_2GCCKB_N__8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_TC_5GA_P__8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_TC_5GA_N__8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_TC_5GB_P__8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_TC_5GB_N__8812A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+static u1Byte gDeltaSwingTableIdx_TC_5GB_N_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_TC_5GB_P_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_TC_5GA_N_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 13, 13, 13}, -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 11, 12, 12, 12, 12, 12, 13, 13}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 8, 8, 9, 10, 11, 12, 13, 14, 14, 15, 15, 15, 16, 16, 16, 17, 17, 18, 18}, -+}; -+static u1Byte gDeltaSwingTableIdx_TC_5GA_P_PCIE_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_TC_2GB_N_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_TC_2GB_P_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static u1Byte gDeltaSwingTableIdx_TC_2GA_N_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_TC_2GA_P_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static u1Byte gDeltaSwingTableIdx_TC_2GCCKB_N_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_TC_2GCCKB_P_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static u1Byte gDeltaSwingTableIdx_TC_2GCCKA_N_PCIE_8812A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_TC_2GCCKA_P_PCIE_8812A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+ -+static void -+ODM_ReadAndConfig_TC_8812A_TxPowerTrack_PCIE( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_TC_8812A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_TC_2GA_P_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_TC_2GA_N_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_TC_2GB_P_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_TC_2GB_N_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_TC_2GCCKA_P_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_TC_2GCCKA_N_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_TC_2GCCKB_P_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_TC_2GCCKB_N_PCIE_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_TC_5GA_P_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_TC_5GA_N_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_TC_5GB_P_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_TC_5GB_N_PCIE_8812A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+static u1Byte gDeltaSwingTableIdx_TC_5GB_N_USB_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_TC_5GB_P_USB_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_TC_5GA_N_USB_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, -+}; -+static u1Byte gDeltaSwingTableIdx_TC_5GA_P_USB_8812A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 12, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static u1Byte gDeltaSwingTableIdx_TC_2GB_N_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_TC_2GB_P_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+static u1Byte gDeltaSwingTableIdx_TC_2GA_N_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; -+static u1Byte gDeltaSwingTableIdx_TC_2GA_P_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+static u1Byte gDeltaSwingTableIdx_TC_2GCCKB_N_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; -+static u1Byte gDeltaSwingTableIdx_TC_2GCCKB_P_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+static u1Byte gDeltaSwingTableIdx_TC_2GCCKA_N_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; -+static u1Byte gDeltaSwingTableIdx_TC_2GCCKA_P_USB_8812A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+ -+static void -+ODM_ReadAndConfig_TC_8812A_TxPowerTrack_USB( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_TC_8812A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_TC_2GA_P_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_TC_2GA_N_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_TC_2GB_P_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_TC_2GB_N_USB_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_TC_2GCCKA_P_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_TC_2GCCKA_N_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_TC_2GCCKB_P_USB_8812A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_TC_2GCCKB_N_USB_8812A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_TC_5GA_P_USB_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_TC_5GA_N_USB_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_TC_5GB_P_USB_8812A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_TC_5GB_N_USB_8812A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+static pu1Byte Array_TC_8812A_TXPWR_LMT[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "36", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "36", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "36", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "34", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "36", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "34", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "114", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "114", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "36", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "32", -+ "MKK", "5G", "20M", "HT", "1T", "36", "32", -+ "FCC", "5G", "20M", "HT", "1T", "40", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "32", -+ "MKK", "5G", "20M", "HT", "1T", "40", "32", -+ "FCC", "5G", "20M", "HT", "1T", "44", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "32", -+ "MKK", "5G", "20M", "HT", "1T", "44", "32", -+ "FCC", "5G", "20M", "HT", "1T", "48", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "32", -+ "MKK", "5G", "20M", "HT", "1T", "48", "32", -+ "FCC", "5G", "20M", "HT", "1T", "52", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "32", -+ "MKK", "5G", "20M", "HT", "1T", "52", "32", -+ "FCC", "5G", "20M", "HT", "1T", "56", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "32", -+ "MKK", "5G", "20M", "HT", "1T", "56", "32", -+ "FCC", "5G", "20M", "HT", "1T", "60", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "32", -+ "MKK", "5G", "20M", "HT", "1T", "60", "32", -+ "FCC", "5G", "20M", "HT", "1T", "64", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "32", -+ "MKK", "5G", "20M", "HT", "1T", "64", "32", -+ "FCC", "5G", "20M", "HT", "1T", "100", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "32", -+ "MKK", "5G", "20M", "HT", "1T", "100", "32", -+ "FCC", "5G", "20M", "HT", "1T", "114", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "114", "32", -+ "MKK", "5G", "20M", "HT", "1T", "114", "32", -+ "FCC", "5G", "20M", "HT", "1T", "108", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "32", -+ "MKK", "5G", "20M", "HT", "1T", "108", "32", -+ "FCC", "5G", "20M", "HT", "1T", "112", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "32", -+ "MKK", "5G", "20M", "HT", "1T", "112", "32", -+ "FCC", "5G", "20M", "HT", "1T", "116", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "32", -+ "MKK", "5G", "20M", "HT", "1T", "116", "32", -+ "FCC", "5G", "20M", "HT", "1T", "120", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "32", -+ "MKK", "5G", "20M", "HT", "1T", "120", "32", -+ "FCC", "5G", "20M", "HT", "1T", "124", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "32", -+ "MKK", "5G", "20M", "HT", "1T", "124", "32", -+ "FCC", "5G", "20M", "HT", "1T", "128", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "32", -+ "MKK", "5G", "20M", "HT", "1T", "128", "32", -+ "FCC", "5G", "20M", "HT", "1T", "132", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "32", -+ "MKK", "5G", "20M", "HT", "1T", "132", "32", -+ "FCC", "5G", "20M", "HT", "1T", "136", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "32", -+ "MKK", "5G", "20M", "HT", "1T", "136", "32", -+ "FCC", "5G", "20M", "HT", "1T", "140", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "32", -+ "MKK", "5G", "20M", "HT", "1T", "140", "32", -+ "FCC", "5G", "20M", "HT", "1T", "149", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "32", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "32", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "32", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "32", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "36", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "32", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "30", -+ "MKK", "5G", "20M", "HT", "2T", "36", "30", -+ "FCC", "5G", "20M", "HT", "2T", "40", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "30", -+ "MKK", "5G", "20M", "HT", "2T", "40", "30", -+ "FCC", "5G", "20M", "HT", "2T", "44", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "30", -+ "MKK", "5G", "20M", "HT", "2T", "44", "30", -+ "FCC", "5G", "20M", "HT", "2T", "48", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "30", -+ "MKK", "5G", "20M", "HT", "2T", "48", "30", -+ "FCC", "5G", "20M", "HT", "2T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "30", -+ "MKK", "5G", "20M", "HT", "2T", "52", "30", -+ "FCC", "5G", "20M", "HT", "2T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "30", -+ "MKK", "5G", "20M", "HT", "2T", "56", "30", -+ "FCC", "5G", "20M", "HT", "2T", "60", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "30", -+ "MKK", "5G", "20M", "HT", "2T", "60", "30", -+ "FCC", "5G", "20M", "HT", "2T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "30", -+ "MKK", "5G", "20M", "HT", "2T", "64", "30", -+ "FCC", "5G", "20M", "HT", "2T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "30", -+ "MKK", "5G", "20M", "HT", "2T", "100", "30", -+ "FCC", "5G", "20M", "HT", "2T", "114", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "114", "30", -+ "MKK", "5G", "20M", "HT", "2T", "114", "30", -+ "FCC", "5G", "20M", "HT", "2T", "108", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "30", -+ "MKK", "5G", "20M", "HT", "2T", "108", "30", -+ "FCC", "5G", "20M", "HT", "2T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "30", -+ "MKK", "5G", "20M", "HT", "2T", "112", "30", -+ "FCC", "5G", "20M", "HT", "2T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "30", -+ "MKK", "5G", "20M", "HT", "2T", "116", "30", -+ "FCC", "5G", "20M", "HT", "2T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "30", -+ "MKK", "5G", "20M", "HT", "2T", "120", "30", -+ "FCC", "5G", "20M", "HT", "2T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "30", -+ "MKK", "5G", "20M", "HT", "2T", "124", "30", -+ "FCC", "5G", "20M", "HT", "2T", "128", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "30", -+ "MKK", "5G", "20M", "HT", "2T", "128", "30", -+ "FCC", "5G", "20M", "HT", "2T", "132", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "30", -+ "MKK", "5G", "20M", "HT", "2T", "132", "30", -+ "FCC", "5G", "20M", "HT", "2T", "136", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "30", -+ "MKK", "5G", "20M", "HT", "2T", "136", "30", -+ "FCC", "5G", "20M", "HT", "2T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "30", -+ "MKK", "5G", "20M", "HT", "2T", "140", "30", -+ "FCC", "5G", "20M", "HT", "2T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "30", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "30", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "30", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "30", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "30", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "32", -+ "MKK", "5G", "40M", "HT", "1T", "38", "32", -+ "FCC", "5G", "40M", "HT", "1T", "46", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "32", -+ "MKK", "5G", "40M", "HT", "1T", "46", "32", -+ "FCC", "5G", "40M", "HT", "1T", "54", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "32", -+ "MKK", "5G", "40M", "HT", "1T", "54", "32", -+ "FCC", "5G", "40M", "HT", "1T", "62", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "32", -+ "MKK", "5G", "40M", "HT", "1T", "62", "32", -+ "FCC", "5G", "40M", "HT", "1T", "102", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "32", -+ "MKK", "5G", "40M", "HT", "1T", "102", "32", -+ "FCC", "5G", "40M", "HT", "1T", "110", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "32", -+ "MKK", "5G", "40M", "HT", "1T", "110", "32", -+ "FCC", "5G", "40M", "HT", "1T", "118", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "32", -+ "MKK", "5G", "40M", "HT", "1T", "118", "32", -+ "FCC", "5G", "40M", "HT", "1T", "126", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "32", -+ "MKK", "5G", "40M", "HT", "1T", "126", "32", -+ "FCC", "5G", "40M", "HT", "1T", "134", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "32", -+ "MKK", "5G", "40M", "HT", "1T", "134", "32", -+ "FCC", "5G", "40M", "HT", "1T", "151", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "32", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "36", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "32", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "30", -+ "MKK", "5G", "40M", "HT", "2T", "38", "30", -+ "FCC", "5G", "40M", "HT", "2T", "46", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "30", -+ "MKK", "5G", "40M", "HT", "2T", "46", "30", -+ "FCC", "5G", "40M", "HT", "2T", "54", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "30", -+ "MKK", "5G", "40M", "HT", "2T", "54", "30", -+ "FCC", "5G", "40M", "HT", "2T", "62", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "30", -+ "MKK", "5G", "40M", "HT", "2T", "62", "30", -+ "FCC", "5G", "40M", "HT", "2T", "102", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "30", -+ "MKK", "5G", "40M", "HT", "2T", "102", "30", -+ "FCC", "5G", "40M", "HT", "2T", "110", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "30", -+ "MKK", "5G", "40M", "HT", "2T", "110", "30", -+ "FCC", "5G", "40M", "HT", "2T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "30", -+ "MKK", "5G", "40M", "HT", "2T", "118", "30", -+ "FCC", "5G", "40M", "HT", "2T", "126", "32", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "30", -+ "MKK", "5G", "40M", "HT", "2T", "126", "30", -+ "FCC", "5G", "40M", "HT", "2T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "30", -+ "MKK", "5G", "40M", "HT", "2T", "134", "30", -+ "FCC", "5G", "40M", "HT", "2T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "30", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "30", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "28", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "36", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "32", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+static void -+ODM_ReadAndConfig_TC_8812A_TXPWR_LMT( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_TC_8812A_TXPWR_LMT)/sizeof(pu1Byte); -+ pu1Byte *Array = Array_TC_8812A_TXPWR_LMT; -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8812A_TXPWR_LMT\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7 ) -+ { -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8812A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+ } -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8812A_TestChip_RF.h 2018-02-06 17:42:30.706967105 +0200 -@@ -0,0 +1,76 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* -+******************************************************************************/ -+ -+#ifndef __INC_TC_RF_HW_IMG_8812A_H -+#define __INC_TC_RF_HW_IMG_8812A_H -+ -+static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8812A_RadioA( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* RadioB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8812A_RadioB( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_AP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8812A_TxPowerTrack_AP( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8812A_TxPowerTrack_PCIE( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8812A_TxPowerTrack_USB( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8812A_TXPWR_LMT( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.c 2018-02-06 17:42:30.706967105 +0200 -@@ -0,0 +1,658 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+//#include "Mp_Precomp.h" -+#include "odm_precomp.h" -+ -+static bool -+CheckCondition( -+ const u4Byte Condition, -+ const u4Byte Hex -+ ) -+{ -+ u4Byte _board = (Hex & 0x000000FF); -+ u4Byte _interface = (Hex & 0x0000FF00) >> 8; -+ u4Byte _platform = (Hex & 0x00FF0000) >> 16; -+ u4Byte cond = Condition; -+ -+ if ( Condition == 0xCDCDCDCD ) -+ return true; -+ -+ cond = Condition & 0x000000FF; -+ if ( (_board != cond) && (cond != 0xFF) ) -+ return false; -+ -+ cond = Condition & 0x0000FF00; -+ cond = cond >> 8; -+ if ( ((_interface & cond) == 0) && (cond != 0x07) ) -+ return false; -+ -+ cond = Condition & 0x00FF0000; -+ cond = cond >> 16; -+ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) -+ return false; -+ return true; -+} -+ -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+static const u4Byte Array_MP_8821A_AGC_TAB[] = { -+ 0x81C, 0xBF000001, -+ 0x81C, 0xBF020001, -+ 0x81C, 0xBF040001, -+ 0x81C, 0xBF060001, -+ 0x81C, 0xBE080001, -+ 0x81C, 0xBD0A0001, -+ 0x81C, 0xBC0C0001, -+ 0x81C, 0xBA0E0001, -+ 0x81C, 0xB9100001, -+ 0x81C, 0xB8120001, -+ 0x81C, 0xB7140001, -+ 0x81C, 0xB6160001, -+ 0x81C, 0xB5180001, -+ 0x81C, 0xB41A0001, -+ 0x81C, 0xB31C0001, -+ 0x81C, 0xB21E0001, -+ 0x81C, 0xB1200001, -+ 0x81C, 0xB0220001, -+ 0x81C, 0xAF240001, -+ 0x81C, 0xAE260001, -+ 0x81C, 0xAD280001, -+ 0x81C, 0xAC2A0001, -+ 0x81C, 0xAB2C0001, -+ 0x81C, 0xAA2E0001, -+ 0x81C, 0xA9300001, -+ 0x81C, 0xA8320001, -+ 0x81C, 0xA7340001, -+ 0x81C, 0xA6360001, -+ 0x81C, 0xA5380001, -+ 0x81C, 0xA43A0001, -+ 0x81C, 0xA33C0001, -+ 0x81C, 0x673E0001, -+ 0x81C, 0x66400001, -+ 0x81C, 0x65420001, -+ 0x81C, 0x64440001, -+ 0x81C, 0x63460001, -+ 0x81C, 0x62480001, -+ 0x81C, 0x614A0001, -+ 0x81C, 0x474C0001, -+ 0x81C, 0x464E0001, -+ 0x81C, 0x45500001, -+ 0x81C, 0x44520001, -+ 0x81C, 0x43540001, -+ 0x81C, 0x42560001, -+ 0x81C, 0x41580001, -+ 0x81C, 0x285A0001, -+ 0x81C, 0x275C0001, -+ 0x81C, 0x265E0001, -+ 0x81C, 0x25600001, -+ 0x81C, 0x24620001, -+ 0x81C, 0x0A640001, -+ 0x81C, 0x09660001, -+ 0x81C, 0x08680001, -+ 0x81C, 0x076A0001, -+ 0x81C, 0x066C0001, -+ 0x81C, 0x056E0001, -+ 0x81C, 0x04700001, -+ 0x81C, 0x03720001, -+ 0x81C, 0x02740001, -+ 0x81C, 0x01760001, -+ 0x81C, 0x01780001, -+ 0x81C, 0x017A0001, -+ 0x81C, 0x017C0001, -+ 0x81C, 0x017E0001, -+ 0xFF0F02C0, 0xABCD, -+ 0x81C, 0xFB000101, -+ 0x81C, 0xFA020101, -+ 0x81C, 0xF9040101, -+ 0x81C, 0xF8060101, -+ 0x81C, 0xF7080101, -+ 0x81C, 0xF60A0101, -+ 0x81C, 0xF50C0101, -+ 0x81C, 0xF40E0101, -+ 0x81C, 0xF3100101, -+ 0x81C, 0xF2120101, -+ 0x81C, 0xF1140101, -+ 0x81C, 0xF0160101, -+ 0x81C, 0xEF180101, -+ 0x81C, 0xEE1A0101, -+ 0x81C, 0xED1C0101, -+ 0x81C, 0xEC1E0101, -+ 0x81C, 0xEB200101, -+ 0x81C, 0xEA220101, -+ 0x81C, 0xE9240101, -+ 0x81C, 0xE8260101, -+ 0x81C, 0xE7280101, -+ 0x81C, 0xE62A0101, -+ 0x81C, 0xE52C0101, -+ 0x81C, 0xE42E0101, -+ 0x81C, 0xE3300101, -+ 0x81C, 0xA5320101, -+ 0x81C, 0xA4340101, -+ 0x81C, 0xA3360101, -+ 0x81C, 0x87380101, -+ 0x81C, 0x863A0101, -+ 0x81C, 0x853C0101, -+ 0x81C, 0x843E0101, -+ 0x81C, 0x69400101, -+ 0x81C, 0x68420101, -+ 0x81C, 0x67440101, -+ 0x81C, 0x66460101, -+ 0x81C, 0x49480101, -+ 0x81C, 0x484A0101, -+ 0x81C, 0x474C0101, -+ 0x81C, 0x2A4E0101, -+ 0x81C, 0x29500101, -+ 0x81C, 0x28520101, -+ 0x81C, 0x27540101, -+ 0x81C, 0x26560101, -+ 0x81C, 0x25580101, -+ 0x81C, 0x245A0101, -+ 0x81C, 0x235C0101, -+ 0x81C, 0x055E0101, -+ 0x81C, 0x04600101, -+ 0x81C, 0x03620101, -+ 0x81C, 0x02640101, -+ 0x81C, 0x01660101, -+ 0x81C, 0x01680101, -+ 0x81C, 0x016A0101, -+ 0x81C, 0x016C0101, -+ 0x81C, 0x016E0101, -+ 0x81C, 0x01700101, -+ 0x81C, 0x01720101, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x81C, 0xFF000101, -+ 0x81C, 0xFF020101, -+ 0x81C, 0xFE040101, -+ 0x81C, 0xFD060101, -+ 0x81C, 0xFC080101, -+ 0x81C, 0xFD0A0101, -+ 0x81C, 0xFC0C0101, -+ 0x81C, 0xFB0E0101, -+ 0x81C, 0xFA100101, -+ 0x81C, 0xF9120101, -+ 0x81C, 0xF8140101, -+ 0x81C, 0xF7160101, -+ 0x81C, 0xF6180101, -+ 0x81C, 0xF51A0101, -+ 0x81C, 0xF41C0101, -+ 0x81C, 0xF31E0101, -+ 0x81C, 0xF2200101, -+ 0x81C, 0xF1220101, -+ 0x81C, 0xF0240101, -+ 0x81C, 0xEF260101, -+ 0x81C, 0xEE280101, -+ 0x81C, 0xED2A0101, -+ 0x81C, 0xEC2C0101, -+ 0x81C, 0xEB2E0101, -+ 0x81C, 0xEA300101, -+ 0x81C, 0xE9320101, -+ 0x81C, 0xE8340101, -+ 0x81C, 0xE7360101, -+ 0x81C, 0xE6380101, -+ 0x81C, 0xE53A0101, -+ 0x81C, 0xE43C0101, -+ 0x81C, 0xE33E0101, -+ 0x81C, 0xA5400101, -+ 0x81C, 0xA4420101, -+ 0x81C, 0xA3440101, -+ 0x81C, 0x87460101, -+ 0x81C, 0x86480101, -+ 0x81C, 0x854A0101, -+ 0x81C, 0x844C0101, -+ 0x81C, 0x694E0101, -+ 0x81C, 0x68500101, -+ 0x81C, 0x67520101, -+ 0x81C, 0x66540101, -+ 0x81C, 0x49560101, -+ 0x81C, 0x48580101, -+ 0x81C, 0x475A0101, -+ 0x81C, 0x2A5C0101, -+ 0x81C, 0x295E0101, -+ 0x81C, 0x28600101, -+ 0x81C, 0x27620101, -+ 0x81C, 0x26640101, -+ 0x81C, 0x25660101, -+ 0x81C, 0x24680101, -+ 0x81C, 0x236A0101, -+ 0x81C, 0x056C0101, -+ 0x81C, 0x046E0101, -+ 0x81C, 0x03700101, -+ 0x81C, 0x02720101, -+ 0xFF0F02C0, 0xDEAD, -+ 0x81C, 0x01740101, -+ 0x81C, 0x01760101, -+ 0x81C, 0x01780101, -+ 0x81C, 0x017A0101, -+ 0x81C, 0x017C0101, -+ 0x81C, 0x017E0101, -+ 0xC50, 0x00000022, -+ 0xC50, 0x00000020, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_AGC_TAB( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_AGC_TAB)/sizeof(u4Byte); -+ const pu4Byte Array = Array_MP_8821A_AGC_TAB; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8821A_AGC_TAB, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_AGC_8821A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_AGC_8821A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+static const u4Byte Array_MP_8821A_PHY_REG[] = { -+ 0x800, 0x0020D090, -+ 0x804, 0x080112E0, -+ 0x808, 0x0E028211, -+ 0x80C, 0x92131111, -+ 0x810, 0x20101261, -+ 0x814, 0x020C3D10, -+ 0x818, 0x03A00385, -+ 0x820, 0x00000000, -+ 0x824, 0x00030FE0, -+ 0x828, 0x00000000, -+ 0x82C, 0x002081DD, -+ 0x830, 0x2AAA8E24, -+ 0x834, 0x0037A706, -+ 0x838, 0x06489B44, -+ 0x83C, 0x0000095B, -+ 0x840, 0xC0000001, -+ 0x844, 0x40003CDE, -+ 0x848, 0x62103F8B, -+ 0x84C, 0x6CFDFFB8, -+ 0x850, 0x28874706, -+ 0x854, 0x0001520C, -+ 0x858, 0x8060E000, -+ 0x85C, 0x74210168, -+ 0x860, 0x6929C321, -+ 0x864, 0x79727432, -+ 0x868, 0x8CA7A314, -+ 0x86C, 0x888C2878, -+ 0x870, 0x08888888, -+ 0x874, 0x31612C2E, -+ 0x878, 0x00000152, -+ 0x87C, 0x000FD000, -+ 0x8A0, 0x00000013, -+ 0x8A4, 0x7F7F7F7F, -+ 0x8A8, 0xA2000338, -+ 0x8AC, 0x0FF0FA0A, -+ 0x8B4, 0x000FC080, -+ 0x8B8, 0x7C0057FF, -+ 0x8BC, 0x0CA52090, -+ 0x8C0, 0x1BF00020, -+ 0x8C4, 0x00000000, -+ 0x8C8, 0x00013169, -+ 0x8CC, 0x08248492, -+ 0x8D4, 0x940008A0, -+ 0x8D8, 0x290B5612, -+ 0x8F8, 0x400002C0, -+ 0x8FC, 0x00000000, -+ 0x900, 0x00000700, -+ 0x90C, 0x00000000, -+ 0x910, 0x0000FC00, -+ 0x914, 0x00000404, -+ 0x918, 0x1C1028C0, -+ 0x91C, 0x64B11A1C, -+ 0x920, 0xE0767233, -+ 0x924, 0x055AA500, -+ 0x928, 0x00000004, -+ 0x92C, 0xFFFE0000, -+ 0x930, 0xFFFFFFFE, -+ 0x934, 0x001FFFFF, -+ 0x960, 0x00000000, -+ 0x964, 0x00000000, -+ 0x968, 0x00000000, -+ 0x96C, 0x00000000, -+ 0x970, 0x801FFFFF, -+ 0x974, 0x000003FF, -+ 0x978, 0x00000000, -+ 0x97C, 0x00000000, -+ 0x980, 0x00000000, -+ 0x984, 0x00000000, -+ 0x988, 0x00000000, -+ 0x9A4, 0x00480080, -+ 0x9A8, 0x00000000, -+ 0x9AC, 0x00000000, -+ 0x9B0, 0x81081008, -+ 0x9B4, 0x01081008, -+ 0x9B8, 0x01081008, -+ 0x9BC, 0x01081008, -+ 0x9D0, 0x00000000, -+ 0x9D4, 0x00000000, -+ 0x9D8, 0x00000000, -+ 0x9DC, 0x00000000, -+ 0x9E0, 0x00005D00, -+ 0x9E4, 0x00000002, -+ 0x9E8, 0x00000000, -+ 0xA00, 0x00D047C8, -+ 0xA04, 0x01FF000C, -+ 0xA08, 0x8C8A8300, -+ 0xA0C, 0x2E68000F, -+ 0xA10, 0x9500BB78, -+ 0xA14, 0x11144028, -+ 0xA18, 0x00881117, -+ 0xA1C, 0x89140F00, -+ 0xA20, 0x1A1B0000, -+ 0xA24, 0x090E1317, -+ 0xA28, 0x00000204, -+ 0xA2C, 0x00900000, -+ 0xA70, 0x101FFF00, -+ 0xA74, 0x00000008, -+ 0xA78, 0x00000900, -+ 0xA7C, 0x225B0606, -+ 0xA80, 0x21805490, -+ 0xA84, 0x001F0000, -+ 0xB00, 0x03100040, -+ 0xB04, 0x0000B000, -+ 0xB08, 0xAE0201EB, -+ 0xB0C, 0x01003207, -+ 0xB10, 0x00009807, -+ 0xB14, 0x01000000, -+ 0xB18, 0x00000002, -+ 0xB1C, 0x00000002, -+ 0xB20, 0x0000001F, -+ 0xB24, 0x03020100, -+ 0xB28, 0x07060504, -+ 0xB2C, 0x0B0A0908, -+ 0xB30, 0x0F0E0D0C, -+ 0xB34, 0x13121110, -+ 0xB38, 0x17161514, -+ 0xB3C, 0x0000003A, -+ 0xB40, 0x00000000, -+ 0xB44, 0x00000000, -+ 0xB48, 0x13000032, -+ 0xB4C, 0x48080000, -+ 0xB50, 0x00000000, -+ 0xB54, 0x00000000, -+ 0xB58, 0x00000000, -+ 0xB5C, 0x00000000, -+ 0xC00, 0x00000007, -+ 0xC04, 0x00042020, -+ 0xC08, 0x80410231, -+ 0xC0C, 0x00000000, -+ 0xC10, 0x00000100, -+ 0xC14, 0x01000000, -+ 0xC1C, 0x40000003, -+ 0xC20, 0x2C2C2C2C, -+ 0xC24, 0x30303030, -+ 0xC28, 0x30303030, -+ 0xC2C, 0x2C2C2C2C, -+ 0xC30, 0x2C2C2C2C, -+ 0xC34, 0x2C2C2C2C, -+ 0xC38, 0x2C2C2C2C, -+ 0xC3C, 0x2A2A2A2A, -+ 0xC40, 0x2A2A2A2A, -+ 0xC44, 0x2A2A2A2A, -+ 0xC48, 0x2A2A2A2A, -+ 0xC4C, 0x2A2A2A2A, -+ 0xC50, 0x00000020, -+ 0xC54, 0x001C1208, -+ 0xC58, 0x30000C1C, -+ 0xC5C, 0x00000058, -+ 0xC60, 0x34344443, -+ 0xC64, 0x07003333, -+ 0xC68, 0x19791979, -+ 0xC6C, 0x19791979, -+ 0xC70, 0x19791979, -+ 0xC74, 0x19791979, -+ 0xC78, 0x19791979, -+ 0xC7C, 0x19791979, -+ 0xC80, 0x19791979, -+ 0xC84, 0x19791979, -+ 0xC94, 0x0100005C, -+ 0xC98, 0x00000000, -+ 0xC9C, 0x00000000, -+ 0xCA0, 0x00000029, -+ 0xCA4, 0x08040201, -+ 0xCA8, 0x80402010, -+ 0xCB0, 0x77775747, -+ 0xCB4, 0x10000077, -+ 0xCB8, 0x00508240, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_PHY_REG( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_PHY_REG)/sizeof(u4Byte); -+ const pu4Byte Array = Array_MP_8821A_PHY_REG; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8821A_PHY_REG, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_PHY_8821A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_PHY_8821A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+static const u4Byte Array_MP_8821A_PHY_REG_PG[] = { -+ 0xC20, 0x00000000, 0x32343638, -+ 0xC24, 0x00000000, 0x36363838, -+ 0xC28, 0x00000000, 0x28303234, -+ 0xC2C, 0x00000000, 0x34363838, -+ 0xC30, 0x00000000, 0x26283032, -+ 0xC34, 0x00000000, 0x34363838, -+ 0xC38, 0x00000000, 0x26283032, -+ 0xE20, 0x00000000, 0x32343638, -+ 0xE24, 0x00000000, 0x36363838, -+ 0xE28, 0x00000000, 0x28303234, -+ 0xE2C, 0x00000000, 0x34363838, -+ 0xE30, 0x00000000, 0x26283032, -+ 0xE34, 0x00000000, 0x34363838, -+ 0xE38, 0x00000000, 0x26283032, -+ 0xC24, 0x00000000, 0x34343636, -+ 0xC28, 0x00000000, 0x26283032, -+ 0xC2C, 0x00000000, 0x32343636, -+ 0xC30, 0x00000000, 0x24262830, -+ 0xC34, 0x00000000, 0x32343636, -+ 0xC38, 0x00000000, 0x24262830, -+ 0xC3C, 0x00000000, 0x32343636, -+ 0xC40, 0x00000000, 0x24262830, -+ 0xC44, 0x00000000, 0x36362022, -+ 0xC48, 0x00000000, 0x28303234, -+ 0xC4C, 0x00000000, 0x20222426, -+ 0xE24, 0x00000000, 0x34343636, -+ 0xE28, 0x00000000, 0x26283032, -+ 0xE2C, 0x00000000, 0x32343636, -+ 0xE30, 0x00000000, 0x24262830, -+ 0xE34, 0x00000000, 0x32343636, -+ 0xE38, 0x00000000, 0x24262830, -+ 0xE3C, 0x00000000, 0x32343636, -+ 0xE40, 0x00000000, 0x24262830, -+ 0xE44, 0x00000000, 0x36362022, -+ 0xE48, 0x00000000, 0x28303234, -+ 0xE4C, 0x00000000, 0x20222426, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_PHY_REG_PG( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_PHY_REG_PG)/sizeof(u4Byte); -+ const pu4Byte Array = Array_MP_8821A_PHY_REG_PG; -+ -+ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ for (i = 0; i < ArrayLen; i += 3 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ u4Byte v3 = Array[i+2]; -+ -+ // this line is a line of pure_body -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_PHY_REG_PG_8821A(pDM_Odm, v1, v2, v3); -+ continue; -+ } -+ else -+ { // this line is the start of branch -+ if ( !CheckCondition(Array[i], hex) ) -+ { // don't need the hw_body -+ i += 2; // skip the pair of expression -+ v1 = Array[i]; -+ v2 = Array[i+1]; -+ v3 = Array[i+2]; -+ while (v2 != 0xDEAD) -+ { -+ i += 3; -+ v1 = Array[i]; -+ v2 = Array[i+1]; -+ v3 = Array[i+1]; -+ } -+ } -+ } -+ } -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_BB.h 2018-02-06 17:42:30.706967105 +0200 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_MP_BB_HW_IMG_8821A_H -+#define __INC_MP_BB_HW_IMG_8821A_H -+ -+static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_AGC_TAB( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_PHY_REG( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_PHY_REG_PG( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.c 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,3709 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+//#include "Mp_Precomp.h" -+#include "odm_precomp.h" -+ -+static const u1Byte Array_MP_8821A_FW_BT[] = { -+0xFC, 0x63, 0x07, 0x62, 0xCF, 0xF7, 0x12, 0x6B, 0x6B, 0xEB, 0x2C, 0xB2, 0x60, 0xCA, 0x48, 0xF7, -+0x11, 0x6B, 0x2B, 0xB2, 0x80, 0x18, 0x39, 0x2D, 0x60, 0xCA, 0x2A, 0xB3, 0x2A, 0xB2, 0x60, 0xDA, -+0x2A, 0xB3, 0x2B, 0xB2, 0x60, 0xDA, 0x2B, 0xB2, 0x45, 0xF1, 0x09, 0x6B, 0x00, 0xF1, 0x70, 0xCA, -+0x29, 0xB3, 0x80, 0xF0, 0x9C, 0xA2, 0x63, 0xDA, 0x28, 0xB3, 0x64, 0xDA, 0x00, 0x6B, 0x65, 0xDA, -+0x66, 0xDA, 0x67, 0xDA, 0x68, 0xDA, 0x69, 0xDA, 0x04, 0x6B, 0x8D, 0xEB, 0xE0, 0xF1, 0x82, 0xA2, -+0x80, 0xF0, 0x7C, 0xC2, 0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x0F, 0x6C, 0x8B, 0xEC, 0x8C, 0xEB, -+0x10, 0x6C, 0x8D, 0xEB, 0x9D, 0x67, 0x70, 0xC4, 0xE0, 0xF1, 0x62, 0xC2, 0x1C, 0xB3, 0x1D, 0xB2, -+0x60, 0xDA, 0x1D, 0xB3, 0x1D, 0xB2, 0x60, 0xDA, 0x1D, 0xB3, 0x1E, 0xB2, 0x60, 0xDA, 0x1E, 0xB3, -+0x1E, 0xB2, 0x60, 0xDA, 0x1E, 0xB3, 0x1F, 0xB2, 0x60, 0xDA, 0x1F, 0xB3, 0x1F, 0xB2, 0x60, 0xDA, -+0x1F, 0xB3, 0x20, 0xB2, 0x60, 0xDA, 0x20, 0xB3, 0x20, 0xB2, 0x60, 0xDA, 0x20, 0xB3, 0x21, 0xB2, -+0x60, 0xDA, 0x21, 0xB3, 0x21, 0xB2, 0x60, 0xDA, 0x21, 0xB3, 0x22, 0xB2, 0x80, 0x18, 0x81, 0x2D, -+0x60, 0xDA, 0x07, 0x97, 0x00, 0xEF, 0x04, 0x63, 0x42, 0x00, 0x11, 0x80, 0x40, 0x00, 0x11, 0x80, -+0xF1, 0xB7, 0x10, 0x80, 0xFC, 0x06, 0x11, 0x80, 0xE1, 0xB5, 0x10, 0x80, 0x04, 0x08, 0x11, 0x80, -+0x48, 0x00, 0x11, 0x80, 0x14, 0xC0, 0x52, 0x02, 0x58, 0xC5, 0xC8, 0x19, 0xB1, 0xB4, 0x10, 0x80, -+0x38, 0x1B, 0x11, 0x80, 0xF5, 0xBB, 0x10, 0x80, 0xC8, 0x1A, 0x11, 0x80, 0x59, 0xB8, 0x10, 0x80, -+0x6C, 0x07, 0x11, 0x80, 0x49, 0xB8, 0x10, 0x80, 0x18, 0x19, 0x11, 0x80, 0xA1, 0xB5, 0x10, 0x80, -+0x90, 0x07, 0x11, 0x80, 0xDD, 0xB5, 0x10, 0x80, 0x24, 0x08, 0x11, 0x80, 0xE9, 0xB5, 0x10, 0x80, -+0x5C, 0x07, 0x11, 0x80, 0x35, 0xBE, 0x10, 0x80, 0xD0, 0x1A, 0x11, 0x80, 0x89, 0xB6, 0x10, 0x80, -+0x5C, 0x1B, 0x11, 0x80, 0xE5, 0xB5, 0x10, 0x80, 0xE8, 0x19, 0x11, 0x80, 0xBD, 0xB6, 0x10, 0x80, -+0xD0, 0x06, 0x11, 0x80, 0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x0A, 0xB0, 0x90, 0x67, 0x00, 0x6D, -+0x00, 0x18, 0x29, 0x34, 0x38, 0x6E, 0x01, 0x6A, 0x4B, 0xEA, 0x47, 0xD8, 0x70, 0x6A, 0x43, 0xC0, -+0x0A, 0x6A, 0x4C, 0xC0, 0x08, 0x6A, 0x4D, 0xC0, 0x05, 0x97, 0x04, 0x90, 0x00, 0xEF, 0x03, 0x63, -+0xE8, 0x93, 0x11, 0x80, 0xD6, 0x63, 0x53, 0x62, 0x52, 0xD1, 0x51, 0xD0, 0x00, 0xF4, 0x05, 0x6A, -+0x7D, 0x67, 0x52, 0xCB, 0x0D, 0x6A, 0x20, 0xF0, 0x46, 0xC3, 0x20, 0xF0, 0x07, 0x04, 0x71, 0xB5, -+0x00, 0x18, 0xF6, 0x33, 0x06, 0x6E, 0x9D, 0x67, 0x01, 0x6A, 0x00, 0x6B, 0x20, 0xF0, 0x4F, 0xC4, -+0x20, 0xF0, 0x53, 0xC4, 0x6C, 0xB2, 0x20, 0xF0, 0x6D, 0xC4, 0x20, 0xF0, 0x6E, 0xC4, 0x20, 0xF0, -+0x70, 0xC4, 0x20, 0xF0, 0x71, 0xC4, 0x20, 0xF0, 0x72, 0xC4, 0xC0, 0xF1, 0x6A, 0xC2, 0xC0, 0xF1, -+0x7E, 0xC2, 0x03, 0x6B, 0x02, 0x6C, 0xC0, 0xF1, 0x7C, 0xC2, 0x64, 0xB3, 0xC0, 0xF1, 0x89, 0xC2, -+0xC0, 0xF1, 0x88, 0xC2, 0xC0, 0xF1, 0x9D, 0xC2, 0x80, 0xC3, 0x61, 0xB3, 0x00, 0x6C, 0x80, 0xDB, -+0x81, 0xDB, 0x60, 0xF1, 0x70, 0xA2, 0x44, 0x67, 0x02, 0x73, 0x07, 0x60, 0x03, 0x73, 0xA0, 0xF0, -+0x07, 0x60, 0x01, 0x73, 0xA0, 0xF0, 0x04, 0x60, 0x0F, 0x10, 0xC0, 0xF2, 0x0C, 0x6B, 0x78, 0xEA, -+0x58, 0xB4, 0x12, 0xEB, 0x6D, 0xE4, 0xC0, 0xF0, 0x68, 0xA3, 0x80, 0xF0, 0x19, 0x2B, 0x01, 0x4A, -+0xFF, 0x6B, 0x6C, 0xEA, 0x0A, 0x5A, 0xF1, 0x61, 0x00, 0x18, 0xBD, 0x5E, 0x09, 0x04, 0x4A, 0xD2, -+0x80, 0xF0, 0x10, 0x2A, 0x7D, 0x67, 0x20, 0xF0, 0x6D, 0xA3, 0x5D, 0x67, 0x9D, 0x67, 0x20, 0xF0, -+0x4E, 0xA2, 0x20, 0xF0, 0x8F, 0xA4, 0x4E, 0xD3, 0x7D, 0x67, 0x4F, 0xD2, 0x4D, 0xD4, 0x5D, 0x67, -+0x20, 0xF0, 0x93, 0xA3, 0x20, 0xF0, 0x50, 0xA2, 0x20, 0xF0, 0x02, 0x05, 0x4B, 0xD4, 0x4C, 0xD2, -+0x20, 0xF0, 0x12, 0xA3, 0x20, 0xF0, 0x31, 0xA3, 0x00, 0x18, 0xCB, 0xE1, 0x08, 0x04, 0x02, 0x22, -+0x4A, 0xD2, 0x70, 0x10, 0x5D, 0x67, 0x00, 0x30, 0x2D, 0xE8, 0x31, 0xAA, 0xC0, 0xF2, 0x0C, 0x6A, -+0x38, 0xB5, 0x58, 0xE9, 0x3B, 0xB2, 0x12, 0xE9, 0x45, 0xE1, 0xE0, 0xF0, 0x88, 0x41, 0x00, 0x18, -+0xF6, 0x33, 0x06, 0x6E, 0x4F, 0x93, 0x4E, 0x94, 0x60, 0x32, 0x8D, 0xEA, 0x60, 0xF2, 0x58, 0xC9, -+0x5D, 0x67, 0x30, 0xF1, 0x64, 0x42, 0x40, 0xA3, 0x7D, 0x67, 0x30, 0xF1, 0x80, 0x43, 0xE0, 0xF0, -+0x55, 0xC1, 0x60, 0xA4, 0x9D, 0x67, 0x20, 0xF1, 0x4C, 0x44, 0xE0, 0xF0, 0x77, 0xC1, 0x80, 0xA2, -+0x7D, 0x67, 0xE0, 0xF0, 0x98, 0xC1, 0x20, 0xF0, 0x40, 0xA3, 0xE0, 0xF0, 0x4E, 0xC1, 0x01, 0x6A, -+0x60, 0xF2, 0x5A, 0xC1, 0x00, 0x18, 0x3A, 0x9D, 0x91, 0xAB, 0x9D, 0x67, 0x20, 0xF1, 0x48, 0x44, -+0x80, 0xA2, 0x02, 0x32, 0x5E, 0x32, 0x00, 0xF1, 0x8C, 0xC1, 0x13, 0x22, 0xEF, 0xF7, 0x1F, 0x6A, -+0x0C, 0xEA, 0x01, 0x6B, 0x80, 0xF0, 0x44, 0xC9, 0x06, 0x6C, 0x04, 0xD3, 0xFC, 0x6D, 0x1E, 0xB3, -+0x00, 0xF5, 0x1B, 0x6E, 0x20, 0xF5, 0x17, 0x6F, 0x05, 0xD3, 0x20, 0x18, 0xC5, 0x30, 0x06, 0xD2, -+0x06, 0x10, 0x5D, 0x67, 0x20, 0xF1, 0x68, 0x42, 0x40, 0xAB, 0x80, 0xF0, 0x44, 0xC9, 0x00, 0x18, -+0xE6, 0xA0, 0x09, 0x04, 0x02, 0x67, 0x0E, 0x22, 0x7D, 0x67, 0x20, 0xF0, 0x80, 0xA3, 0xE0, 0xF0, -+0xA3, 0xA1, 0x00, 0x18, 0xA8, 0xE1, 0x00, 0x65, 0x0A, 0xB4, 0x00, 0x18, 0xA4, 0xE1, 0x00, 0x65, -+0x4A, 0xD0, 0x08, 0x10, 0x5D, 0x67, 0x91, 0xAA, 0x20, 0x18, 0x21, 0x26, 0x01, 0x6D, 0x02, 0x10, -+0x0C, 0x6B, 0x4A, 0xD3, 0x4A, 0x92, 0x53, 0x97, 0x52, 0x91, 0x51, 0x90, 0x00, 0xEF, 0x2A, 0x63, -+0xFC, 0x93, 0x11, 0x80, 0x80, 0x50, 0x11, 0x80, 0x09, 0x50, 0x11, 0x80, 0xB0, 0x51, 0x11, 0x80, -+0x74, 0x54, 0x11, 0x80, 0xB0, 0xE7, 0x04, 0x80, 0xFD, 0x63, 0x05, 0x62, 0x10, 0xB3, 0x00, 0x6D, -+0xC0, 0xF1, 0xAA, 0xC3, 0xC0, 0xF1, 0xBE, 0xC3, 0xFF, 0x6A, 0x03, 0x6D, 0x8C, 0xEA, 0xC0, 0xF1, -+0xBC, 0xC3, 0x02, 0x6C, 0x0B, 0xB5, 0xC0, 0xF1, 0x89, 0xC3, 0xC0, 0xF1, 0x88, 0xC3, 0xC0, 0xF1, -+0x9D, 0xC3, 0x60, 0xF1, 0x40, 0xC3, 0x80, 0xC5, 0x00, 0x18, 0x82, 0xA9, 0x82, 0x67, 0x06, 0xB2, -+0x00, 0x6B, 0x60, 0xDA, 0x61, 0xDA, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0x80, 0x50, 0x11, 0x80, -+0x09, 0x50, 0x11, 0x80, 0xB0, 0x51, 0x11, 0x80, 0xDC, 0x63, 0x47, 0x62, 0x00, 0xF4, 0x06, 0x6A, -+0x7D, 0x67, 0x4A, 0xCB, 0x03, 0x6A, 0x56, 0xC3, 0x13, 0x6A, 0x59, 0xC3, 0x1D, 0xB2, 0x6D, 0xA2, -+0x08, 0x73, 0x1A, 0x60, 0xFF, 0x6C, 0x09, 0x4C, 0x98, 0xEB, 0x1B, 0xB2, 0x01, 0x6D, 0x12, 0xEC, -+0x91, 0xE2, 0x20, 0xF1, 0xCF, 0xA4, 0xAC, 0xEE, 0x0F, 0x26, 0x00, 0xF1, 0x52, 0xAA, 0x47, 0xEB, -+0xAC, 0xEA, 0x0A, 0x22, 0x20, 0xF1, 0x4C, 0xAC, 0x7D, 0x67, 0x05, 0x04, 0x57, 0xC3, 0x42, 0x32, -+0x58, 0xC3, 0x00, 0x18, 0x47, 0x4F, 0x04, 0x05, 0x0E, 0xB2, 0x4C, 0xA2, 0x0A, 0x72, 0x14, 0x60, -+0xC0, 0xF2, 0x0C, 0x6B, 0x78, 0xEA, 0x0D, 0xB3, 0x12, 0xEA, 0x49, 0xE3, 0xE0, 0xF0, 0x66, 0xA2, -+0x01, 0x73, 0x0A, 0x61, 0x60, 0xF2, 0x56, 0xAA, 0x7D, 0x67, 0x05, 0x04, 0x57, 0xC3, 0x42, 0x32, -+0x58, 0xC3, 0x00, 0x18, 0x47, 0x4F, 0x04, 0x05, 0x47, 0x97, 0x00, 0xEF, 0x24, 0x63, 0x00, 0x65, -+0xE8, 0x93, 0x11, 0x80, 0x00, 0x3B, 0x11, 0x80, 0x74, 0x54, 0x11, 0x80, 0xDC, 0x63, 0x47, 0x62, -+0x46, 0xD0, 0x00, 0x6A, 0x18, 0xB3, 0x9D, 0x67, 0x40, 0xDB, 0x41, 0xDB, 0x04, 0xF0, 0x06, 0x6B, -+0x68, 0xCC, 0x54, 0xC4, 0x56, 0xC4, 0x57, 0xC4, 0x58, 0xC4, 0x59, 0xC4, 0x5A, 0xC4, 0x5B, 0xC4, -+0x5C, 0xC4, 0x5D, 0xC4, 0x5E, 0xC4, 0x5F, 0xC4, 0x0F, 0x6B, 0x07, 0x6A, 0x04, 0x00, 0x72, 0xC4, -+0x20, 0xF0, 0x40, 0xC4, 0x20, 0x6B, 0x03, 0x6A, 0x73, 0xC4, 0x75, 0xC4, 0x20, 0xF0, 0x41, 0xC4, -+0x00, 0x18, 0xB5, 0xC9, 0x90, 0x67, 0x7D, 0x67, 0x04, 0xF0, 0x0A, 0x6A, 0x48, 0xCB, 0x01, 0x6A, -+0x90, 0x67, 0x52, 0xC3, 0x00, 0x18, 0x2D, 0xCA, 0x53, 0xC3, 0x47, 0x97, 0x46, 0x90, 0x00, 0xEF, -+0x24, 0x63, 0x00, 0x65, 0xB0, 0x51, 0x11, 0x80, 0xDC, 0x63, 0x47, 0x62, 0x00, 0x6A, 0x21, 0xB3, -+0x9D, 0x67, 0x40, 0xDB, 0x41, 0xDB, 0x04, 0xF0, 0x0D, 0x6B, 0x68, 0xCC, 0x19, 0x6B, 0x72, 0xC4, -+0x60, 0x6B, 0x6B, 0xEB, 0x73, 0xC4, 0x75, 0xC4, 0x1B, 0xB3, 0x54, 0xC4, 0x56, 0xC4, 0x57, 0xC4, -+0x58, 0xC4, 0x94, 0xA3, 0xBD, 0x67, 0x5F, 0xC5, 0x99, 0xC5, 0x95, 0xA3, 0x20, 0xF0, 0x40, 0xC5, -+0x20, 0xF0, 0x42, 0xC5, 0x9A, 0xC5, 0x96, 0xA3, 0x20, 0xF0, 0x44, 0xC5, 0x20, 0xF0, 0x45, 0xC5, -+0x9B, 0xC5, 0x97, 0xA3, 0x20, 0xF0, 0x47, 0xC5, 0x20, 0xF0, 0x49, 0xC5, 0x9C, 0xC5, 0x98, 0xA3, -+0x79, 0xA3, 0x9D, 0xC5, 0x7E, 0xC5, 0x02, 0x6B, 0x20, 0xF0, 0x61, 0xC5, 0x20, 0xF0, 0x63, 0xC5, -+0x1E, 0x6B, 0x20, 0xF0, 0x66, 0xC5, 0x12, 0x6B, 0x20, 0xF0, 0x68, 0xC5, 0x20, 0xF0, 0x6A, 0xC5, -+0x20, 0xF0, 0x4B, 0xC5, 0x00, 0x18, 0xEE, 0xC7, 0x04, 0x04, 0x47, 0x97, 0x00, 0xEF, 0x24, 0x63, -+0xB0, 0x51, 0x11, 0x80, 0xE8, 0x93, 0x11, 0x80, 0xDC, 0x63, 0x47, 0x62, 0x0C, 0xB2, 0x00, 0x6B, -+0x60, 0xDA, 0x61, 0xDA, 0x7D, 0x67, 0x04, 0xF0, 0x1D, 0x6A, 0x48, 0xCB, 0x01, 0x6A, 0x52, 0xC3, -+0x08, 0xB2, 0x41, 0xAA, 0x7F, 0x6B, 0x04, 0x04, 0x4A, 0x32, 0x6C, 0xEA, 0x7D, 0x67, 0x00, 0x18, -+0x51, 0xC5, 0x53, 0xC3, 0x47, 0x97, 0x00, 0xEF, 0x24, 0x63, 0x00, 0x65, 0xB0, 0x51, 0x11, 0x80, -+0xE8, 0x93, 0x11, 0x80, 0xDB, 0x63, 0x49, 0x62, 0x48, 0xD1, 0x47, 0xD0, 0x00, 0x69, 0x0E, 0xB2, -+0x7D, 0x67, 0x20, 0xDA, 0x21, 0xDA, 0x04, 0xF0, 0x1F, 0x6A, 0x48, 0xCB, 0x0B, 0xB2, 0x81, 0xF1, -+0x48, 0xAA, 0x0B, 0xB0, 0x32, 0xC3, 0x04, 0x04, 0x00, 0x18, 0xCB, 0xC4, 0x4B, 0xD8, 0x64, 0xA0, -+0x41, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x29, 0xC0, 0x44, 0xC0, 0x49, 0x97, 0x48, 0x91, 0x47, 0x90, -+0x00, 0xEF, 0x25, 0x63, 0xB0, 0x51, 0x11, 0x80, 0x00, 0x3B, 0x11, 0x80, 0xE8, 0x93, 0x11, 0x80, -+0xDC, 0x63, 0x47, 0x62, 0x46, 0xD0, 0x00, 0x68, 0x0B, 0xB2, 0x7D, 0x67, 0x00, 0xDA, 0x01, 0xDA, -+0x04, 0xF0, 0x1F, 0x6A, 0x12, 0xC3, 0x04, 0x04, 0x00, 0x18, 0xCB, 0xC4, 0x48, 0xCB, 0x07, 0xB2, -+0x84, 0xA2, 0x41, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x64, 0xC2, 0x09, 0xC2, 0x47, 0x97, 0x46, 0x90, -+0x00, 0xEF, 0x24, 0x63, 0xB0, 0x51, 0x11, 0x80, 0xE8, 0x93, 0x11, 0x80, 0xDC, 0x63, 0x47, 0x62, -+0x1C, 0xB2, 0x00, 0x6B, 0x60, 0xDA, 0x61, 0xDA, 0x1B, 0xB2, 0x64, 0xA2, 0x07, 0x6D, 0x6E, 0x34, -+0xAC, 0xEC, 0x05, 0x54, 0x06, 0x61, 0x39, 0x6C, 0x8B, 0xEC, 0x6C, 0xEC, 0x20, 0x6B, 0x6D, 0xEC, -+0x84, 0xC2, 0x15, 0xB2, 0x64, 0xA2, 0x07, 0x6C, 0x14, 0xB5, 0x6E, 0x33, 0x8C, 0xEB, 0x6D, 0xE5, -+0x60, 0xA3, 0xC3, 0xA2, 0x6C, 0xEC, 0x0F, 0x6B, 0x6B, 0xEB, 0x84, 0x35, 0xCC, 0xEB, 0xAD, 0xEB, -+0x63, 0xC2, 0xBD, 0x67, 0x04, 0xF0, 0x1E, 0x6B, 0x68, 0xCD, 0x03, 0x6B, 0x72, 0xC5, 0x61, 0xAA, -+0x7F, 0x6D, 0x6A, 0x33, 0xAC, 0xEB, 0xBD, 0x67, 0x73, 0xC5, 0x40, 0x9A, 0x95, 0xC5, 0x04, 0x04, -+0x42, 0x32, 0x00, 0x18, 0x07, 0xC5, 0x54, 0xC5, 0x47, 0x97, 0x00, 0xEF, 0x24, 0x63, 0x00, 0x65, -+0xB0, 0x51, 0x11, 0x80, 0xE8, 0x93, 0x11, 0x80, 0x44, 0xBF, 0x10, 0x80, 0xFD, 0x63, 0x05, 0x62, -+0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, 0x1F, 0x6B, 0x02, 0xF1, 0x01, 0x6E, -+0x4C, 0xEB, 0xCB, 0xEE, 0x6C, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x00, 0x6C, -+0xA4, 0x67, 0x00, 0x18, 0x01, 0xA6, 0xC4, 0x67, 0x06, 0xB2, 0x84, 0xA2, 0x41, 0x6B, 0x6B, 0xEB, -+0x8C, 0xEB, 0x64, 0xC2, 0x00, 0x6B, 0x69, 0xC2, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0x00, 0x65, -+0xE8, 0x93, 0x11, 0x80, 0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, 0x7C, 0x6C, 0x00, 0x18, -+0xA1, 0xA5, 0x01, 0x6D, 0x79, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0xA1, 0xA5, 0x22, 0x67, 0x1E, 0xB3, -+0xFF, 0xF7, 0x1F, 0x68, 0x80, 0x9B, 0x0C, 0xE9, 0x4C, 0xE8, 0x4B, 0x9B, 0x96, 0x34, 0xE3, 0xF7, -+0x1F, 0x6D, 0x49, 0xE0, 0xAC, 0xEC, 0x98, 0xEA, 0x4B, 0xDB, 0x4D, 0x9B, 0x49, 0xE1, 0x4D, 0xDB, -+0x12, 0xEC, 0x8C, 0xDB, 0x7D, 0xF2, 0x01, 0x6B, 0x63, 0xE8, 0x02, 0x60, 0x63, 0xE9, 0x1D, 0x61, -+0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, 0x1F, 0x68, 0x0C, 0xEA, 0x01, 0xF6, -+0x01, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x6C, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, -+0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x01, 0xF6, 0x00, 0x6B, 0xC2, 0x67, -+0x57, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x6D, 0xEE, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, -+0x00, 0xEF, 0x04, 0x63, 0xE8, 0x93, 0x11, 0x80, 0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x11, 0xB2, 0x47, 0x9A, 0xFF, 0x68, 0x8C, 0xE8, 0x01, 0x4A, 0x04, 0x22, 0x0F, 0xB4, 0x00, 0x18, -+0x4D, 0x1D, 0x00, 0x65, 0x11, 0x20, 0x00, 0x69, 0x0B, 0xB0, 0x01, 0x6C, 0x0B, 0xB5, 0x0C, 0xB6, -+0xF1, 0x67, 0x00, 0x18, 0x5B, 0x1D, 0x04, 0xD1, 0x87, 0x98, 0x00, 0x18, 0x40, 0x1D, 0x14, 0x6D, -+0x00, 0x6A, 0x30, 0xC8, 0x20, 0xF0, 0x49, 0xC0, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x00, 0xEF, -+0x05, 0x63, 0x00, 0x65, 0xE8, 0x93, 0x11, 0x80, 0x04, 0x94, 0x11, 0x80, 0x29, 0xA8, 0x10, 0x80, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, -+0x1F, 0x68, 0xFF, 0x6B, 0x0C, 0xEA, 0x02, 0x4B, 0x6B, 0xEB, 0xC2, 0x67, 0x6C, 0xEE, 0x57, 0x6C, -+0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x59, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, -+0x00, 0xF2, 0x01, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x6C, 0xEE, 0x59, 0x6C, 0x00, 0x18, 0x01, 0xA6, -+0x01, 0x6D, 0x00, 0x6C, 0x0C, 0xB0, 0xA4, 0x67, 0x00, 0x18, 0x01, 0xA6, 0xC4, 0x67, 0xD1, 0xA8, -+0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x42, 0x6C, 0x80, 0x18, 0xD6, 0x29, 0x00, 0x6C, 0x64, 0xA0, -+0x41, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x44, 0xC0, 0x00, 0x6A, 0x49, 0xC0, 0x05, 0x97, 0x04, 0x90, -+0x00, 0xEF, 0x03, 0x63, 0xE8, 0x93, 0x11, 0x80, 0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x20, 0xB2, 0x47, 0x9A, 0x08, 0xD4, 0x8E, 0xEA, 0x05, 0x22, 0x01, 0x4C, 0x03, 0x24, 0x00, 0x18, -+0x4D, 0x1D, 0x08, 0x04, 0x1B, 0xB0, 0x64, 0xA0, 0x40, 0x6A, 0x6C, 0xEA, 0x08, 0x2A, 0x47, 0x98, -+0x01, 0x4A, 0x29, 0x22, 0x18, 0xB4, 0x00, 0x18, 0x4D, 0x1D, 0x00, 0x65, 0x24, 0x10, 0x02, 0x69, -+0x6C, 0xE9, 0xFF, 0x6A, 0x4C, 0xE9, 0x07, 0x21, 0x80, 0x18, 0xB1, 0x29, 0x00, 0x65, 0x50, 0xA8, -+0x01, 0x4A, 0x50, 0xC8, 0x18, 0x10, 0x7D, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x04, 0x6B, -+0x4C, 0xEB, 0x06, 0x23, 0x50, 0xA8, 0x20, 0xF0, 0x29, 0xC0, 0x01, 0x4A, 0x50, 0xC8, 0x0B, 0x10, -+0x20, 0xF0, 0x49, 0xA0, 0x19, 0x5A, 0x04, 0x60, 0x01, 0x4A, 0x20, 0xF0, 0x49, 0xC0, 0x03, 0x10, -+0x80, 0x18, 0xEC, 0x29, 0x00, 0x65, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x00, 0xEF, 0x04, 0x63, -+0xE8, 0x93, 0x11, 0x80, 0x04, 0x94, 0x11, 0x80, 0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x00, 0x6C, 0x02, 0xF0, 0x00, 0x6E, 0x00, 0x18, 0x01, 0xA6, 0xA4, 0x67, 0x2B, 0xB2, 0xC1, 0xAA, -+0x7F, 0x6A, 0x3C, 0x6C, 0xCA, 0x36, 0x4C, 0xEE, 0x29, 0xB2, 0x00, 0xF6, 0xC0, 0x36, 0x00, 0x6D, -+0x00, 0x18, 0x01, 0xA6, 0x4D, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, -+0x1F, 0x68, 0x0C, 0xEA, 0x01, 0xF6, 0x01, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x6C, 0xEE, 0x57, 0x6C, -+0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, -+0x01, 0xF6, 0x00, 0x6B, 0xC2, 0x67, 0x6D, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, -+0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x03, 0x69, 0x2B, 0xE9, 0xC2, 0x67, -+0x2C, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, -+0x01, 0x6D, 0x0C, 0xEA, 0x02, 0x6B, 0xC2, 0x67, 0x6D, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, -+0x01, 0x6D, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0xC2, 0x67, 0x2C, 0xEE, -+0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x57, 0x6C, 0x80, 0x18, 0xD6, 0x29, 0x01, 0x6C, 0x07, 0x97, -+0x06, 0x91, 0x05, 0x90, 0x00, 0xEF, 0x04, 0x63, 0xE8, 0x93, 0x11, 0x80, 0x00, 0x00, 0x00, 0x80, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x00, 0x6C, 0xC4, 0x67, 0x00, 0x18, 0x01, 0xA6, 0xA4, 0x67, -+0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0x6E, 0xFF, 0xF7, 0x1F, 0x6B, 0x04, 0x4E, -+0x4C, 0xEB, 0xCB, 0xEE, 0x6C, 0xEE, 0x01, 0x6D, 0x0B, 0xB0, 0x00, 0x18, 0x01, 0xA6, 0x57, 0x6C, -+0x64, 0xA0, 0x41, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0x00, 0x6C, 0x80, 0x18, 0xD6, 0x29, 0x44, 0xC0, -+0x80, 0x18, 0xB1, 0x29, 0x00, 0x65, 0x00, 0x6A, 0x49, 0xC0, 0x05, 0x97, 0x04, 0x90, 0x00, 0xEF, -+0x03, 0x63, 0x00, 0x65, 0xE8, 0x93, 0x11, 0x80, 0xFB, 0x63, 0x09, 0x62, 0x08, 0xD0, 0x38, 0xB0, -+0x90, 0xA0, 0x4F, 0xA0, 0x04, 0x05, 0x80, 0x34, 0x4D, 0xEC, 0x4E, 0xA0, 0x80, 0x34, 0x00, 0x18, -+0x15, 0xBC, 0x4D, 0xEC, 0x7D, 0x67, 0x48, 0xAB, 0x8F, 0xA0, 0xDD, 0x67, 0x4C, 0xCB, 0x49, 0xAB, -+0xAA, 0xAE, 0x4D, 0xCB, 0x4E, 0xA0, 0x80, 0x33, 0x68, 0x33, 0x48, 0x32, 0x6D, 0xEA, 0x03, 0x6B, -+0xAC, 0xEB, 0x6D, 0xEA, 0x70, 0xA0, 0x4E, 0xCE, 0x9A, 0x34, 0x68, 0x32, 0x7E, 0x33, 0x8D, 0xEA, -+0x05, 0x23, 0x09, 0xF4, 0x00, 0x6B, 0x4D, 0xEB, 0x6F, 0xCE, 0x06, 0x10, 0x0A, 0xF0, 0x00, 0x6B, -+0x6B, 0xEB, 0x4D, 0xEB, 0x5D, 0x67, 0x6F, 0xCA, 0x00, 0x6A, 0x21, 0x10, 0xDD, 0x67, 0x44, 0x35, -+0xB5, 0xE6, 0xAC, 0xAD, 0x01, 0x6E, 0xA7, 0xEB, 0xCC, 0xED, 0x0C, 0x25, 0x0F, 0x6D, 0x77, 0xE5, -+0xC4, 0xED, 0xA6, 0x67, 0x8D, 0xED, 0xA0, 0x34, 0x80, 0x34, 0x83, 0x34, 0x83, 0x34, 0xFF, 0xF7, -+0x1F, 0x6D, 0xAC, 0xEC, 0x01, 0x4B, 0xFF, 0x6D, 0xAC, 0xEB, 0x10, 0x5B, 0xE7, 0x61, 0x44, 0x33, -+0x01, 0x4A, 0xDD, 0x67, 0xAC, 0xEA, 0x6D, 0xE6, 0x04, 0x5A, 0x8C, 0xCB, 0x03, 0x60, 0x00, 0x6B, -+0x83, 0x67, 0xDC, 0x17, 0x5D, 0x67, 0xCC, 0xAA, 0x51, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, -+0x7D, 0x67, 0xCD, 0xAB, 0x50, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x5D, 0x67, 0xCE, 0xAA, -+0x4F, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x7D, 0x67, 0xCF, 0xAB, 0x4E, 0x6C, 0x00, 0x18, -+0x01, 0xA6, 0x01, 0x6D, 0x09, 0x97, 0x08, 0x90, 0x00, 0xEF, 0x05, 0x63, 0xE8, 0x93, 0x11, 0x80, -+0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, -+0xFF, 0xF7, 0x1F, 0x6B, 0xFF, 0x6E, 0x6C, 0xEA, 0x01, 0x4E, 0x53, 0xB1, 0x4D, 0xEE, 0x57, 0x6C, -+0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x04, 0xD3, 0x44, 0xA1, 0x07, 0x68, 0xA3, 0xA1, 0x4E, 0x32, -+0x0C, 0xEA, 0x44, 0x34, 0x0F, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, 0x8D, 0xEA, 0x01, 0x6D, 0x57, 0x6C, -+0x00, 0x18, 0xA1, 0xA5, 0x43, 0xC1, 0x04, 0x93, 0xC3, 0xA1, 0x57, 0x6C, 0x6C, 0xEA, 0xC6, 0x36, -+0x71, 0x6B, 0x6B, 0xEB, 0x0C, 0xEE, 0x6C, 0xEA, 0xD0, 0x36, 0x4D, 0xEE, 0x00, 0x18, 0x01, 0xA6, -+0x01, 0x6D, 0x60, 0xA1, 0x01, 0x6A, 0x01, 0x68, 0x6C, 0xEA, 0x0B, 0x22, 0x44, 0xA1, 0x80, 0x48, -+0xFF, 0x48, 0x4C, 0xE8, 0xFF, 0x6A, 0x4C, 0xE8, 0x0B, 0xE8, 0xC0, 0xF7, 0x02, 0x30, 0x03, 0x6A, -+0x03, 0xE2, 0x39, 0xB1, 0x56, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x80, 0x99, 0x00, 0x33, -+0xE3, 0xF7, 0x1F, 0x6D, 0x96, 0x34, 0xAC, 0xEC, 0x78, 0x33, 0x8D, 0xEB, 0xFB, 0xF7, 0x1F, 0x6C, -+0x8C, 0xEB, 0xFF, 0xF7, 0x1F, 0x68, 0x1C, 0xF0, 0x00, 0x6C, 0x8B, 0xEC, 0x0C, 0xEA, 0xC3, 0x67, -+0x8C, 0xEA, 0x4D, 0xEE, 0x56, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0xC7, 0xA1, 0x46, 0xA1, -+0x58, 0x6C, 0xC0, 0x36, 0x4D, 0xEE, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x59, 0x6C, 0x00, 0x18, -+0xA1, 0xA5, 0x01, 0x6D, 0x04, 0x6B, 0x6B, 0xEB, 0x0C, 0xEA, 0x6C, 0xEA, 0x68, 0xA1, 0x03, 0x6C, -+0xC2, 0x67, 0x8C, 0xEB, 0x6D, 0xEE, 0x59, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x80, 0x18, -+0x76, 0x2A, 0x00, 0x65, 0x63, 0xA1, 0x80, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x1E, 0x22, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x80, 0x6B, 0xC2, 0x67, -+0x6D, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x59, 0x6C, 0x00, 0x18, 0xA1, 0xA5, -+0x01, 0x6D, 0xC5, 0xA1, 0xE0, 0xF1, 0x1D, 0x6B, 0x6B, 0xEB, 0x0C, 0xEA, 0x6C, 0xEA, 0xC8, 0x36, -+0xE0, 0xF3, 0x19, 0x4B, 0x6C, 0xEE, 0x59, 0x6C, 0x01, 0x6D, 0x4D, 0xEE, 0x0B, 0x10, 0x57, 0x6C, -+0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x81, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x57, 0x6C, -+0x01, 0x6D, 0x6C, 0xEE, 0x00, 0x18, 0x01, 0xA6, 0x00, 0x65, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, -+0x00, 0xEF, 0x05, 0x63, 0xE8, 0x93, 0x11, 0x80, 0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, -+0x80, 0x18, 0xB0, 0x2A, 0x00, 0x65, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, -+0x1F, 0x68, 0x0C, 0xEA, 0x02, 0xF0, 0x01, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x6C, 0xEE, 0x57, 0x6C, -+0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x59, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, -+0x00, 0xF2, 0x00, 0x6B, 0xC2, 0x67, 0x6D, 0xEE, 0x59, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, -+0x42, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x33, 0xB3, 0xD2, 0xAB, 0x51, 0xCB, 0x53, 0xAB, -+0xC0, 0x36, 0xC0, 0x36, 0x4D, 0xEE, 0x02, 0xF0, 0x00, 0x5E, 0x02, 0x61, 0xE1, 0xF7, 0x1F, 0x6E, -+0x2D, 0xB1, 0x20, 0xF0, 0x48, 0xA1, 0x0F, 0x6B, 0xD0, 0x36, 0x6C, 0xEA, 0x4D, 0xEE, 0x42, 0x6C, -+0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x00, 0x6C, 0x02, 0xF0, 0x00, 0x6E, 0x00, 0x18, 0x01, 0xA6, -+0xA4, 0x67, 0x63, 0xA1, 0x07, 0x6A, 0x03, 0x6C, 0x72, 0x33, 0x4C, 0xEB, 0x05, 0x4B, 0x00, 0x6D, -+0xFF, 0xF7, 0x1F, 0x68, 0x00, 0x18, 0xA1, 0xA5, 0x04, 0xD3, 0x04, 0x93, 0x1F, 0xF4, 0x01, 0x6C, -+0x0C, 0xEA, 0x8B, 0xEC, 0x8C, 0xEA, 0x1D, 0xB4, 0x6D, 0xE4, 0x20, 0xF1, 0xDA, 0xA3, 0x03, 0x6C, -+0x00, 0x6D, 0xC0, 0x36, 0xC8, 0x36, 0x0C, 0xEE, 0x00, 0x18, 0x01, 0xA6, 0x4D, 0xEE, 0xC1, 0xA9, -+0x7F, 0x6A, 0x3C, 0x6C, 0xCA, 0x36, 0x4C, 0xEE, 0x00, 0xF6, 0xC0, 0x36, 0x00, 0x18, 0x01, 0xA6, -+0x00, 0x6D, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x01, 0x6D, 0xC2, 0x67, -+0xAD, 0xEE, 0x00, 0x18, 0x01, 0xA6, 0x57, 0x6C, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, -+0x0C, 0xEA, 0x02, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x01, 0x6D, 0x6C, 0xEE, 0x00, 0x18, 0x01, 0xA6, -+0x57, 0x6C, 0x80, 0x18, 0xD6, 0x29, 0x01, 0x6C, 0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x00, 0xEF, -+0x05, 0x63, 0x00, 0x65, 0xE8, 0x93, 0x11, 0x80, 0x48, 0x00, 0x11, 0x80, 0xFB, 0x63, 0x09, 0x62, -+0x08, 0xD1, 0x07, 0xD0, 0x80, 0x18, 0xB0, 0x2A, 0x00, 0x65, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, -+0x01, 0x6D, 0xFF, 0xF7, 0x1F, 0x68, 0x0C, 0xEA, 0x02, 0xF0, 0x00, 0x69, 0xC2, 0x67, 0x2D, 0xEE, -+0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x59, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, -+0x0C, 0xEA, 0x00, 0xF2, 0x01, 0x6B, 0x6B, 0xEB, 0xC2, 0x67, 0x6C, 0xEE, 0x59, 0x6C, 0x00, 0x18, -+0x01, 0xA6, 0x01, 0x6D, 0x00, 0x6C, 0xD1, 0x67, 0x24, 0xB1, 0x00, 0x18, 0x01, 0xA6, 0xA4, 0x67, -+0x63, 0xA1, 0x07, 0x6A, 0x03, 0x6C, 0x72, 0x33, 0x4C, 0xEB, 0x05, 0x4B, 0x00, 0x6D, 0x00, 0x18, -+0xA1, 0xA5, 0x04, 0xD3, 0x04, 0x93, 0x1F, 0xF4, 0x01, 0x6C, 0x0C, 0xEA, 0x8B, 0xEC, 0x8C, 0xEA, -+0x1B, 0xB4, 0x6D, 0xE4, 0x20, 0xF1, 0xDA, 0xA3, 0x03, 0x6C, 0x00, 0x6D, 0xC0, 0x36, 0xC8, 0x36, -+0x0C, 0xEE, 0x00, 0x18, 0x01, 0xA6, 0x4D, 0xEE, 0xC1, 0xA9, 0x7F, 0x6A, 0x3C, 0x6C, 0xCA, 0x36, -+0x4C, 0xEE, 0x00, 0xF6, 0xC0, 0x36, 0x00, 0x18, 0x01, 0xA6, 0x00, 0x6D, 0x57, 0x6C, 0x00, 0x18, -+0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x01, 0x6D, 0xC2, 0x67, 0xAD, 0xEE, 0x00, 0x18, 0x01, 0xA6, -+0x57, 0x6C, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x0C, 0xEA, 0x02, 0x6B, 0x6B, 0xEB, -+0xC2, 0x67, 0x57, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x6C, 0xEE, 0x09, 0x97, 0x08, 0x91, -+0x07, 0x90, 0x00, 0xEF, 0x05, 0x63, 0x00, 0x65, 0xE8, 0x93, 0x11, 0x80, 0x48, 0x00, 0x11, 0x80, -+0xFD, 0x63, 0x05, 0x62, 0x80, 0x18, 0xB0, 0x2A, 0x00, 0x65, 0x00, 0x6B, 0x0C, 0xB2, 0x6D, 0xDA, -+0x6B, 0xDA, 0x59, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, 0x1F, 0x6B, 0x00, 0xF2, -+0x01, 0x6E, 0x4C, 0xEB, 0xCB, 0xEE, 0x59, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x6C, 0xEE, -+0x80, 0x18, 0x2E, 0x2A, 0x00, 0x65, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0xE8, 0x93, 0x11, 0x80, -+0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, 0x42, 0xA4, 0x04, 0x67, 0x23, 0xA4, 0x1E, 0x5A, -+0xE0, 0xF2, 0x0A, 0x60, 0x04, 0x0B, 0x44, 0x32, 0x49, 0xE3, 0x40, 0x8A, 0x4D, 0xE3, 0x00, 0xEB, -+0x00, 0x65, 0x00, 0x65, 0x3D, 0x00, 0x45, 0x00, 0x99, 0x00, 0x1F, 0x02, 0xAD, 0x02, 0xE7, 0x02, -+0x5D, 0x03, 0x81, 0x03, 0x93, 0x03, 0xA1, 0x03, 0xB7, 0x03, 0xC5, 0x03, 0xC5, 0x05, 0xC5, 0x05, -+0xD3, 0x03, 0xCB, 0x04, 0xE3, 0x04, 0xC5, 0x05, 0xFB, 0x04, 0x09, 0x05, 0x17, 0x05, 0x47, 0x05, -+0x57, 0x05, 0x69, 0x05, 0x77, 0x05, 0x89, 0x05, 0x8D, 0x05, 0x91, 0x05, 0x9B, 0x05, 0xAD, 0x05, -+0xA0, 0xF5, 0x1C, 0xB2, 0x40, 0xAA, 0xBD, 0x12, 0x57, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, -+0xFF, 0xF7, 0x1F, 0x6B, 0x02, 0xF1, 0x03, 0x6E, 0x4C, 0xEB, 0xCB, 0xEE, 0x6C, 0xEE, 0x57, 0x6C, -+0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x00, 0x6C, 0xA4, 0x67, 0x00, 0x18, 0x01, 0xA6, 0xC4, 0x67, -+0x80, 0x18, 0xD6, 0x29, 0x00, 0x6C, 0x00, 0x18, 0xAF, 0x58, 0x00, 0x65, 0x00, 0x6D, 0x01, 0xF4, -+0x03, 0x6C, 0x00, 0x18, 0xEA, 0x53, 0xC5, 0x67, 0x60, 0xF5, 0x18, 0xB2, 0x0A, 0x6B, 0x6C, 0xC2, -+0x08, 0x6B, 0x6D, 0xC2, 0x00, 0x6B, 0x69, 0xC2, 0x6A, 0xC2, 0x90, 0x10, 0x0B, 0x59, 0x80, 0xF2, -+0x17, 0x60, 0x60, 0xF5, 0x00, 0xB2, 0x06, 0x21, 0x64, 0xA2, 0x40, 0x6A, 0x6C, 0xEA, 0x80, 0xF2, -+0x0F, 0x2A, 0x06, 0x10, 0x84, 0xA2, 0x40, 0x6B, 0x8C, 0xEB, 0x02, 0x2B, 0x29, 0xC2, 0x7E, 0x10, -+0x40, 0xF5, 0x00, 0xB3, 0x0B, 0x59, 0x49, 0xA3, 0x29, 0xC3, 0xA0, 0xF0, 0x00, 0x60, 0x04, 0x0B, -+0x24, 0x31, 0x25, 0xE3, 0x80, 0x89, 0x8D, 0xE3, 0x00, 0xEB, 0x00, 0x65, 0x17, 0x00, 0x95, 0x00, -+0xAB, 0x00, 0xE9, 0x00, 0x09, 0x01, 0x0D, 0x01, 0x11, 0x01, 0x33, 0x01, 0x1B, 0x01, 0x23, 0x01, -+0x2B, 0x01, 0x00, 0xF5, 0x10, 0xB3, 0x64, 0xA3, 0x01, 0x6C, 0x6C, 0xEC, 0x11, 0x24, 0x02, 0x6C, -+0x6C, 0xEC, 0x04, 0x24, 0x80, 0x18, 0x60, 0x2A, 0x00, 0x65, 0x17, 0x10, 0x02, 0x72, 0x04, 0x61, -+0x80, 0x18, 0xEC, 0x29, 0x00, 0x65, 0x11, 0x10, 0x80, 0x18, 0x9F, 0x29, 0x00, 0x65, 0x0D, 0x10, -+0x04, 0x6A, 0x6C, 0xEA, 0x0A, 0x22, 0x02, 0x6A, 0x6C, 0xEA, 0x04, 0x22, 0x80, 0x18, 0x5D, 0x29, -+0x00, 0x65, 0x03, 0x10, 0x80, 0x18, 0x70, 0x29, 0x00, 0x65, 0xC0, 0xF4, 0x08, 0xB1, 0x6B, 0x99, -+0xEC, 0x99, 0x4D, 0x99, 0x06, 0xD3, 0x05, 0xD7, 0x00, 0x18, 0xAF, 0x58, 0x04, 0xD2, 0x00, 0x6D, -+0x01, 0xF4, 0x03, 0x6C, 0x00, 0x18, 0xEA, 0x53, 0xC5, 0x67, 0x0A, 0x6A, 0x4C, 0xC1, 0x08, 0x6A, -+0x4D, 0xC1, 0x06, 0x93, 0x04, 0x94, 0x6B, 0xD9, 0x05, 0x97, 0x8D, 0xD9, 0xEC, 0xD9, 0x26, 0x10, -+0x80, 0xF4, 0x10, 0xB1, 0x64, 0xA1, 0x02, 0x6A, 0x6D, 0xEA, 0x01, 0x6B, 0x6D, 0xEA, 0x80, 0x18, -+0x8C, 0x2B, 0x44, 0xC1, 0x2A, 0x10, 0x60, 0xF4, 0x1C, 0xB3, 0x84, 0xA3, 0x03, 0x6A, 0x4B, 0xEA, -+0x8C, 0xEA, 0x04, 0x6C, 0x4C, 0xEC, 0x07, 0x24, 0x02, 0x6C, 0x8B, 0xEC, 0x4C, 0xEC, 0x80, 0x18, -+0x7F, 0x29, 0x84, 0xC3, 0x05, 0x10, 0x01, 0x6C, 0x4D, 0xEC, 0x80, 0x18, 0x0A, 0x2B, 0x84, 0xC3, -+0x40, 0xF4, 0x10, 0xB3, 0x84, 0xA3, 0x40, 0x6A, 0x8D, 0xEA, 0x44, 0xC3, 0x00, 0x6C, 0x64, 0x67, -+0x44, 0x67, 0x09, 0x12, 0x20, 0xF4, 0x1C, 0xB1, 0x64, 0xA1, 0x03, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, -+0x01, 0x6B, 0x6D, 0xEA, 0x80, 0x18, 0x53, 0x2B, 0x44, 0xC1, 0x64, 0xA1, 0x40, 0x6A, 0x6D, 0xEA, -+0x44, 0xC1, 0xEC, 0x17, 0x01, 0x6C, 0x03, 0x10, 0x02, 0x6C, 0x01, 0x10, 0x03, 0x6C, 0x80, 0x18, -+0xD6, 0x28, 0x00, 0x65, 0xE3, 0x17, 0x80, 0x18, 0x2A, 0x29, 0x00, 0x65, 0xDF, 0x17, 0x80, 0x18, -+0x0F, 0x29, 0x00, 0x65, 0xDB, 0x17, 0x80, 0x18, 0xEA, 0x28, 0x00, 0x65, 0xD7, 0x17, 0x80, 0x18, -+0x59, 0x28, 0x00, 0x65, 0xD3, 0x22, 0x12, 0x72, 0xC0, 0xF1, 0x1A, 0x60, 0x00, 0x6C, 0x04, 0x6B, -+0xD9, 0x11, 0x04, 0x59, 0xC0, 0xF1, 0x14, 0x60, 0x80, 0x18, 0xD6, 0x29, 0x00, 0x6C, 0x57, 0x6C, -+0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, 0x1F, 0x6B, 0x02, 0xF1, 0x03, 0x6E, 0x4C, 0xEB, -+0xCB, 0xEE, 0x6C, 0xEE, 0x57, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x00, 0x6C, 0xA4, 0x67, -+0x00, 0x18, 0x01, 0xA6, 0xC4, 0x67, 0x00, 0x18, 0xAF, 0x58, 0x00, 0x65, 0x00, 0x6D, 0x01, 0xF4, -+0x03, 0x6C, 0x00, 0x18, 0xEA, 0x53, 0xC5, 0x67, 0xE6, 0xB3, 0x0A, 0x6A, 0x4C, 0xC3, 0x08, 0x6A, -+0x2A, 0xC3, 0x4D, 0xC3, 0x00, 0x1C, 0xF6, 0x1B, 0x06, 0xD3, 0x06, 0x93, 0xA2, 0x67, 0x05, 0x6A, -+0x84, 0xA3, 0x4B, 0xEA, 0x01, 0x71, 0x8C, 0xEA, 0x44, 0xC3, 0x09, 0x61, 0x03, 0x6C, 0x80, 0x18, -+0xD6, 0x28, 0x05, 0xD5, 0x00, 0x18, 0x4A, 0x56, 0x00, 0x6C, 0x05, 0x95, 0x05, 0x10, 0x02, 0x71, -+0x03, 0x61, 0x04, 0x6C, 0x4D, 0xEC, 0x84, 0xC3, 0x00, 0x1C, 0xFD, 0x1B, 0x85, 0x67, 0x86, 0x17, -+0x4F, 0x59, 0x80, 0xF1, 0x0D, 0x60, 0x44, 0xA4, 0x08, 0x5A, 0x80, 0xF1, 0x09, 0x60, 0xD1, 0xB3, -+0x7F, 0x6A, 0xA1, 0xAB, 0x2C, 0xEA, 0x48, 0x34, 0xE0, 0xF1, 0x1D, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, -+0x8D, 0xEA, 0x41, 0xCB, 0x84, 0xA0, 0x07, 0x6A, 0xA3, 0xA3, 0x8C, 0xEA, 0x50, 0x34, 0x71, 0x6A, -+0x4B, 0xEA, 0xAC, 0xEA, 0x8D, 0xEA, 0x43, 0xC3, 0x69, 0x17, 0x0A, 0x59, 0x44, 0xA4, 0x65, 0xA4, -+0x60, 0xF1, 0x0E, 0x60, 0x60, 0x33, 0x4D, 0xEB, 0xE3, 0xF7, 0x1F, 0x6C, 0xC1, 0xB2, 0x6C, 0xEC, -+0x94, 0x35, 0xC1, 0xB6, 0x80, 0x9A, 0xCC, 0xEC, 0xAD, 0xEC, 0x80, 0xDA, 0xBF, 0xB5, 0x24, 0x34, -+0x91, 0xE5, 0x80, 0xAC, 0x8C, 0x34, 0x62, 0xEC, 0x40, 0xF1, 0x1A, 0x61, 0x03, 0x59, 0x06, 0x60, -+0x80, 0xA2, 0x02, 0x6B, 0x6B, 0xEB, 0x8C, 0xEB, 0x60, 0xC2, 0x0C, 0x10, 0x80, 0xA2, 0xA4, 0xA2, -+0x01, 0x6B, 0x8D, 0xEB, 0x06, 0x59, 0x60, 0xC2, 0x98, 0x67, 0x7F, 0x6B, 0x9C, 0x34, 0xAC, 0xEB, -+0x8D, 0xEB, 0x64, 0xC2, 0xB2, 0xB2, 0x25, 0xE2, 0x80, 0xA1, 0xAE, 0xB3, 0x0F, 0x6A, 0x8C, 0xEA, -+0xA0, 0xA3, 0x44, 0x34, 0x1F, 0x6A, 0x4B, 0xEA, 0xAC, 0xEA, 0x8D, 0xEA, 0x40, 0xC3, 0x2E, 0x17, -+0x45, 0xA4, 0x08, 0x5A, 0x20, 0xF1, 0x14, 0x60, 0x44, 0xA4, 0xA6, 0xB3, 0xA4, 0xA3, 0x40, 0x32, -+0x2D, 0xEA, 0x53, 0xCB, 0x85, 0xA4, 0x07, 0x6A, 0x8C, 0xEA, 0x4C, 0x34, 0x39, 0x6A, 0x4B, 0xEA, -+0xAC, 0xEA, 0x1A, 0x17, 0x44, 0xA4, 0x9F, 0xB3, 0x40, 0x32, 0x2D, 0xEA, 0x52, 0xCB, 0x45, 0xA4, -+0x20, 0xF0, 0x48, 0xC3, 0x13, 0x17, 0x9B, 0xB2, 0x26, 0xC2, 0x64, 0xA4, 0x67, 0xC2, 0x65, 0xA4, -+0x68, 0xC2, 0x0C, 0x17, 0x97, 0xB2, 0x63, 0xA2, 0x3E, 0x35, 0x7F, 0x6C, 0xBC, 0x35, 0x8C, 0xEB, -+0xAD, 0xEB, 0x8C, 0xE9, 0x63, 0xC2, 0x25, 0xC2, 0x01, 0x17, 0x92, 0xB2, 0x2E, 0xC2, 0x64, 0xA4, -+0x6F, 0xC2, 0x65, 0xA4, 0x70, 0xC2, 0xFA, 0x16, 0x8E, 0xB2, 0x31, 0xC2, 0x64, 0xA4, 0x72, 0xC2, -+0x65, 0xA4, 0x73, 0xC2, 0xF3, 0x16, 0x8B, 0xB3, 0x49, 0xA3, 0x0A, 0x72, 0x2C, 0x61, 0x8C, 0xA3, -+0x00, 0x6A, 0x0A, 0x74, 0x0E, 0x60, 0xC0, 0xF2, 0x0C, 0x4A, 0x58, 0xEC, 0x89, 0xB2, 0x12, 0xEC, -+0x91, 0xE2, 0xC0, 0xF0, 0x48, 0xA4, 0x04, 0x72, 0x05, 0x6A, 0x03, 0x60, 0x0A, 0x6A, 0x4C, 0xC3, -+0x00, 0x6A, 0x80, 0xB3, 0x8D, 0xA3, 0x08, 0x74, 0x5D, 0x60, 0xFF, 0x6A, 0x09, 0x4A, 0x58, 0xEC, -+0x81, 0xB3, 0x12, 0xEA, 0x49, 0xE3, 0x20, 0xF1, 0xAF, 0xA2, 0x01, 0x6A, 0x4C, 0xED, 0x06, 0x25, -+0x00, 0xF1, 0x72, 0xAB, 0x67, 0xEC, 0x4C, 0xEB, 0x05, 0x6A, 0x4C, 0x2B, 0x75, 0xB2, 0x08, 0x6B, -+0x6D, 0xC2, 0x00, 0x6A, 0x47, 0x10, 0x8B, 0x42, 0xFF, 0x6B, 0x6C, 0xEC, 0x03, 0x5C, 0x1A, 0x60, -+0x00, 0x6A, 0xC0, 0xF2, 0x0C, 0x6C, 0x98, 0xEA, 0x72, 0xB3, 0x12, 0xEC, 0x91, 0xE3, 0xC0, 0xF0, -+0x68, 0xA4, 0x04, 0x73, 0x09, 0x61, 0xE0, 0xF0, 0xA8, 0x9C, 0x6A, 0xB3, 0xA5, 0xDB, 0xE0, 0xF0, -+0x8C, 0xAC, 0x4C, 0xC3, 0x8C, 0xCB, 0x26, 0x10, 0x01, 0x4A, 0xFF, 0x6B, 0x6C, 0xEA, 0x0A, 0x5A, -+0xE8, 0x61, 0x27, 0x10, 0x88, 0x42, 0x6C, 0xEC, 0x02, 0x5C, 0x24, 0x60, 0x00, 0x6A, 0xFF, 0x6C, -+0x09, 0x4C, 0x98, 0xEA, 0x64, 0xB3, 0x01, 0x6D, 0x12, 0xEC, 0x91, 0xE3, 0x20, 0xF1, 0xCF, 0xA4, -+0xAC, 0xEE, 0x12, 0x26, 0x00, 0xF1, 0x72, 0xAB, 0x67, 0xEA, 0xAC, 0xEB, 0x0D, 0x23, 0x60, 0xF1, -+0xBE, 0xAC, 0x58, 0xB3, 0xAA, 0xCB, 0x80, 0xF1, 0xA0, 0xAC, 0xAB, 0xCB, 0x80, 0xF1, 0x82, 0xAC, -+0x4D, 0xC3, 0x8C, 0xCB, 0x05, 0x6A, 0x06, 0x10, 0x01, 0x4A, 0xFF, 0x6B, 0x6C, 0xEA, 0x08, 0x5A, -+0xDE, 0x61, 0x04, 0x6A, 0x4F, 0xB3, 0x6A, 0xA3, 0x40, 0x32, 0x6D, 0xEA, 0x44, 0x10, 0x53, 0xB3, -+0x20, 0xF0, 0x9E, 0xA3, 0x20, 0xF0, 0x5D, 0xA3, 0x20, 0xF0, 0x7C, 0xA3, 0x80, 0x34, 0x40, 0x32, -+0x80, 0x34, 0x8D, 0xEA, 0x6D, 0x10, 0x4D, 0xB3, 0x40, 0xF0, 0x81, 0xA3, 0x40, 0xF0, 0x40, 0xA3, -+0x20, 0xF0, 0x7F, 0xA3, 0x80, 0x34, 0x40, 0x32, 0x80, 0x34, 0x8D, 0xEA, 0x61, 0x10, 0x41, 0xB2, -+0x34, 0xC2, 0x64, 0xA4, 0x75, 0xC2, 0x65, 0xA4, 0x76, 0xC2, 0x58, 0x16, 0x3D, 0xB2, 0x37, 0xC2, -+0x64, 0xA4, 0x78, 0xC2, 0x65, 0xA4, 0x79, 0xC2, 0x51, 0x16, 0x4F, 0x41, 0xFF, 0x6B, 0x6C, 0xEA, -+0x09, 0x5A, 0x56, 0x60, 0x5C, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xFF, 0xF7, 0x1F, 0x6B, -+0x4C, 0xEB, 0x79, 0x6A, 0x4B, 0xEA, 0x4C, 0xEB, 0x2C, 0x36, 0x78, 0x6A, 0x4C, 0xEE, 0x5C, 0x6C, -+0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x6D, 0xEE, 0x39, 0x16, 0x2E, 0xB3, 0x8B, 0x9B, 0x34, 0xB5, -+0x56, 0xAB, 0xAC, 0xEC, 0x8B, 0xDB, 0x02, 0x6C, 0x35, 0x10, 0x2A, 0xB4, 0xAB, 0x9C, 0xFF, 0xF7, -+0x1F, 0x6B, 0xA2, 0x32, 0xAC, 0xEB, 0x42, 0x32, 0x6B, 0xDC, 0xF5, 0x17, 0x25, 0xB3, 0x8D, 0x9B, -+0x2B, 0xB5, 0x5A, 0xAB, 0xAC, 0xEC, 0x8D, 0xDB, 0xEE, 0x17, 0x22, 0xB4, 0xAD, 0x9C, 0xFF, 0xF7, -+0x1F, 0x6B, 0xA2, 0x32, 0xAC, 0xEB, 0x42, 0x32, 0x6D, 0xDC, 0xE5, 0x17, 0x78, 0x6C, 0x03, 0x10, -+0x76, 0x6C, 0x01, 0x10, 0x77, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0xDC, 0x17, 0x19, 0xB3, -+0x96, 0xA3, 0x55, 0xA3, 0x74, 0xA3, 0x80, 0x34, 0x40, 0x32, 0x80, 0x34, 0x8D, 0xEA, 0x08, 0x10, -+0x14, 0xB3, 0x99, 0xA3, 0x58, 0xA3, 0x77, 0xA3, 0x80, 0x34, 0x40, 0x32, 0x80, 0x34, 0x8D, 0xEA, -+0x6D, 0xEA, 0x03, 0x6C, 0x00, 0x6B, 0x07, 0x10, 0x00, 0x18, 0x00, 0x30, 0x90, 0x67, 0x10, 0x10, -+0x00, 0x6C, 0x03, 0x6B, 0x44, 0x67, 0x90, 0x34, 0x6D, 0xEC, 0x83, 0xC0, 0x81, 0xA0, 0x10, 0x6B, -+0x6B, 0xEB, 0x8C, 0xEB, 0x61, 0xC0, 0xA0, 0x98, 0x02, 0x6C, 0x00, 0x18, 0x55, 0x2F, 0xC2, 0x67, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x01, 0x6A, 0x00, 0xEF, 0x06, 0x63, 0x40, 0x00, 0x11, 0x80, -+0xE8, 0x93, 0x11, 0x80, 0x1F, 0x00, 0xFC, 0xFF, 0x30, 0xBF, 0x10, 0x80, 0x24, 0xBF, 0x10, 0x80, -+0x74, 0x54, 0x11, 0x80, 0x00, 0x3B, 0x11, 0x80, 0x48, 0x00, 0x11, 0x80, 0x00, 0x00, 0xFF, 0xFF, -+0x0B, 0xB3, 0x7C, 0x4B, 0x77, 0x9B, 0x0C, 0x6E, 0x0A, 0xB2, 0x40, 0xF7, 0x62, 0x33, 0xD8, 0xEB, -+0xE0, 0xF0, 0x86, 0xAA, 0xE0, 0xF0, 0xA8, 0xAA, 0xB7, 0xE4, 0x12, 0xEB, 0x63, 0xED, 0x03, 0x60, -+0x6D, 0xE4, 0xE0, 0xF0, 0x66, 0xCA, 0x20, 0xE8, 0x00, 0x65, 0x00, 0x65, 0x48, 0x00, 0x11, 0x80, -+0x00, 0x3B, 0x11, 0x80, 0x00, 0x6A, 0x21, 0xB5, 0x55, 0xE5, 0xA0, 0xA5, 0x20, 0xB3, 0x51, 0xE3, -+0x20, 0xF1, 0xBA, 0xC4, 0x01, 0x4A, 0xFF, 0x6C, 0x8C, 0xEA, 0x10, 0x5A, 0xF4, 0x61, 0x60, 0xF1, -+0x41, 0xA3, 0x0D, 0x72, 0x03, 0x61, 0x15, 0x6A, 0x60, 0xF1, 0x41, 0xC3, 0x18, 0xB2, 0x0A, 0x6B, -+0x40, 0xF1, 0x7A, 0xC2, 0x09, 0x6B, 0x40, 0xF1, 0x7B, 0xC2, 0x40, 0xF1, 0x7C, 0xC2, 0x40, 0xF1, -+0x7D, 0xC2, 0x40, 0xF1, 0x7E, 0xC2, 0x24, 0xF0, 0x13, 0x6B, 0x60, 0xF1, 0x62, 0xCA, 0x06, 0xF4, -+0x1F, 0x6B, 0x60, 0xF1, 0x64, 0xCA, 0x0A, 0xF4, 0x17, 0x6B, 0x60, 0xF1, 0x66, 0xCA, 0x0E, 0xF2, -+0x0D, 0x6B, 0x60, 0xF1, 0x68, 0xCA, 0x04, 0xF5, 0x00, 0x6B, 0x6B, 0xEB, 0x60, 0xF1, 0x6A, 0xCA, -+0x00, 0x6B, 0xC0, 0xF1, 0x68, 0xCA, 0xC0, 0xF1, 0x6A, 0xCA, 0xC0, 0xF1, 0x6C, 0xCA, 0xC0, 0xF1, -+0x6E, 0xCA, 0x20, 0xE8, 0x00, 0x65, 0x00, 0x65, 0x58, 0xC0, 0x10, 0x80, 0x48, 0x00, 0x11, 0x80, -+0xFF, 0x6A, 0x4C, 0xEE, 0x4C, 0xEC, 0x4C, 0xED, 0xEC, 0xEA, 0x57, 0xE5, 0x00, 0xF6, 0xA0, 0x35, -+0x00, 0xF6, 0xA3, 0x35, 0xB8, 0xED, 0xD3, 0xE4, 0x00, 0xF6, 0x80, 0x34, 0x00, 0xF6, 0x83, 0x34, -+0xFF, 0xF7, 0x1F, 0x6B, 0x12, 0xED, 0x98, 0xEC, 0x12, 0xEC, 0x89, 0xE5, 0x20, 0xE8, 0x6C, 0xEA, -+0x62, 0xA4, 0x60, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, 0x0B, 0x22, 0x00, 0x6A, -+0x06, 0xB3, 0x40, 0xDB, 0x06, 0xB3, 0x40, 0xDB, 0x06, 0xB3, 0x40, 0xDB, 0x06, 0xB3, 0x40, 0xDB, -+0x06, 0xB3, 0x40, 0xDB, 0x20, 0xE8, 0x01, 0x6A, 0x24, 0xC1, 0x10, 0x80, 0x4C, 0x8B, 0x10, 0x80, -+0x54, 0x8B, 0x10, 0x80, 0x58, 0x8B, 0x10, 0x80, 0x60, 0x8B, 0x10, 0x80, 0x20, 0xE8, 0x01, 0x6A, -+0x20, 0xE8, 0x00, 0x6A, 0x20, 0xE8, 0x00, 0x6A, 0xFD, 0x63, 0x05, 0x62, 0x40, 0x9C, 0x3F, 0x6B, -+0x6C, 0xEA, 0x30, 0x72, 0x00, 0x6A, 0x03, 0x61, 0x80, 0x18, 0x9C, 0x2B, 0x00, 0x65, 0x05, 0x97, -+0x00, 0xEF, 0x03, 0x63, 0xFB, 0x63, 0x09, 0x62, 0x08, 0xD1, 0x07, 0xD0, 0x18, 0xB2, 0x19, 0xB3, -+0x63, 0xEA, 0x26, 0x61, 0x18, 0xB2, 0x80, 0x9A, 0x18, 0xB3, 0x8E, 0xEB, 0x21, 0x2B, 0x02, 0xAA, -+0x17, 0xB5, 0x1D, 0x10, 0x17, 0xB4, 0x42, 0x45, 0x43, 0xEC, 0x1A, 0x61, 0xC0, 0xA2, 0xFF, 0xF7, -+0x1F, 0x6F, 0x43, 0x46, 0x43, 0xE8, 0x14, 0x61, 0x45, 0xE5, 0x23, 0xEC, 0x11, 0x61, 0x81, 0xA5, -+0x60, 0xA5, 0x80, 0x34, 0x6D, 0xEC, 0xEC, 0xEC, 0xE0, 0xF3, 0x14, 0x5C, 0x09, 0x60, 0x43, 0xE0, -+0x0D, 0xB2, 0x03, 0x4D, 0x91, 0xE2, 0x00, 0x18, 0xF6, 0x33, 0xEC, 0xE8, 0xB1, 0x67, 0xE2, 0x28, -+0x09, 0x97, 0x08, 0x91, 0x07, 0x90, 0x00, 0xEF, 0x05, 0x63, 0x00, 0x65, 0xF0, 0xFF, 0x10, 0x80, -+0x20, 0xC1, 0x10, 0x80, 0x24, 0xC1, 0x10, 0x80, 0x55, 0xAB, 0x23, 0x87, 0x2A, 0xC1, 0x10, 0x80, -+0xFF, 0xFF, 0x10, 0x80, 0x48, 0x00, 0x11, 0x80, 0xFC, 0x63, 0x07, 0x62, 0x0B, 0xB2, 0x42, 0xAA, -+0x60, 0xAC, 0x9D, 0x67, 0x4F, 0xEA, 0x6C, 0xEA, 0xFF, 0xF7, 0x1F, 0x6B, 0x4C, 0xEB, 0x48, 0xCC, -+0x62, 0x33, 0x20, 0x6A, 0x6C, 0xEA, 0x03, 0x22, 0x00, 0x18, 0x0C, 0xD6, 0x00, 0x65, 0x07, 0x97, -+0x00, 0x6A, 0x00, 0xEF, 0x04, 0x63, 0x00, 0x65, 0x00, 0x3B, 0x11, 0x80, 0xF8, 0x63, 0x0F, 0x62, -+0x0E, 0xD0, 0x68, 0xA4, 0x01, 0x6A, 0x04, 0x67, 0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, 0x19, 0x02, -+0x00, 0x65, 0x63, 0x2A, 0x68, 0xA0, 0x04, 0x6A, 0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, 0xB0, 0x01, -+0x90, 0x67, 0x5B, 0x2A, 0x68, 0xA0, 0x08, 0x6A, 0x6C, 0xEA, 0x04, 0x22, 0x00, 0x18, 0x8B, 0x01, -+0x90, 0x67, 0x53, 0x2A, 0x66, 0xA0, 0x80, 0x6A, 0x4B, 0xEA, 0x6C, 0xEA, 0xFF, 0x6B, 0x6C, 0xEA, -+0x2B, 0x22, 0x00, 0x18, 0x82, 0xA9, 0x00, 0x6C, 0x20, 0x18, 0x08, 0x2F, 0x00, 0x65, 0x1A, 0x22, -+0x30, 0xB2, 0x61, 0xA2, 0x0C, 0x6A, 0x6C, 0xEA, 0x04, 0x72, 0x14, 0x60, 0x66, 0xA0, 0x7F, 0x6A, -+0x01, 0x6C, 0x6C, 0xEA, 0xC0, 0xF5, 0x1C, 0x6D, 0x20, 0x18, 0xED, 0x2E, 0x46, 0xC0, 0x00, 0x6A, -+0x29, 0xB3, 0x40, 0xDB, 0x29, 0xB3, 0x40, 0xDB, 0x29, 0xB3, 0x40, 0xDB, 0x29, 0xB3, 0x40, 0xDB, -+0x29, 0xB3, 0x40, 0xDB, 0x23, 0xB2, 0x61, 0xA2, 0x0C, 0x6A, 0x6C, 0xEA, 0x04, 0x72, 0x04, 0x61, -+0x66, 0xA0, 0x7F, 0x6A, 0x6C, 0xEA, 0x46, 0xC0, 0x24, 0xB2, 0x80, 0xF0, 0x7C, 0xA2, 0x5D, 0x67, -+0x20, 0xF0, 0x70, 0xC2, 0x04, 0x6A, 0x6C, 0xEA, 0x07, 0x22, 0x66, 0xA0, 0x7F, 0x6A, 0x6C, 0xEA, -+0x21, 0x6B, 0x6B, 0xEB, 0x6C, 0xEA, 0x46, 0xC0, 0x1C, 0xB2, 0x20, 0xF0, 0x7B, 0xA2, 0x5D, 0x67, -+0x20, 0xF0, 0x74, 0xC2, 0x40, 0x6A, 0x6C, 0xEA, 0x05, 0x22, 0x66, 0xA0, 0x21, 0x6A, 0x4B, 0xEA, -+0x6C, 0xEA, 0x46, 0xC0, 0x00, 0x18, 0xB8, 0x37, 0x84, 0x40, 0x05, 0x6A, 0x04, 0xD2, 0x14, 0xB2, -+0x05, 0xD2, 0x40, 0x98, 0x04, 0x6C, 0xFA, 0x6D, 0x06, 0xD2, 0x43, 0x98, 0xC0, 0xF6, 0x1A, 0x6E, -+0xA1, 0xF1, 0x1A, 0x6F, 0x07, 0xD2, 0x42, 0x98, 0x08, 0xD2, 0x41, 0x98, 0x09, 0xD2, 0x44, 0x98, -+0x20, 0x18, 0xC5, 0x30, 0x0A, 0xD2, 0x0F, 0x97, 0x0E, 0x90, 0x01, 0x6A, 0x00, 0xEF, 0x08, 0x63, -+0xC0, 0x1E, 0x11, 0x80, 0x24, 0xC1, 0x10, 0x80, 0x4C, 0x8B, 0x10, 0x80, 0x54, 0x8B, 0x10, 0x80, -+0x58, 0x8B, 0x10, 0x80, 0x60, 0x8B, 0x10, 0x80, 0x48, 0x00, 0x11, 0x80, 0xB0, 0xE7, 0x04, 0x80, -+0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x00, 0x1C, 0xF6, 0x1B, 0x00, 0x65, 0x02, 0x67, 0x0F, 0xB2, -+0x60, 0x9A, 0x0F, 0xB2, 0x00, 0x6C, 0x6E, 0xEA, 0x02, 0x2A, 0x0E, 0xB2, 0x80, 0x9A, 0x0E, 0xB3, -+0x82, 0x34, 0x82, 0x34, 0x40, 0x9B, 0xFF, 0xF7, 0x1F, 0x6D, 0x80, 0x34, 0xAC, 0xEA, 0x80, 0x34, -+0x8D, 0xEA, 0x40, 0xDB, 0x00, 0x18, 0xB5, 0x26, 0x00, 0x6C, 0x00, 0x1C, 0xFD, 0x1B, 0x90, 0x67, -+0x05, 0x97, 0x04, 0x90, 0x00, 0xEF, 0x03, 0x63, 0x58, 0x8B, 0x10, 0x80, 0x32, 0x97, 0x79, 0x23, -+0x5C, 0x8B, 0x10, 0x80, 0x30, 0x00, 0x00, 0xB5, 0xFD, 0x63, 0x05, 0x62, 0x80, 0x18, 0x4D, 0x28, -+0x00, 0x65, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, 0x0C, 0xB2, 0x0D, 0xB3, -+0x72, 0xDA, 0x0D, 0xB3, 0x75, 0xDA, 0x0D, 0xB3, 0x69, 0xDA, 0x0D, 0xB3, 0x6C, 0xDA, 0x0D, 0xB3, -+0x6F, 0xDA, 0x0D, 0xB3, 0x66, 0xDA, 0x0D, 0xB3, 0x7B, 0xDA, 0x0D, 0xB3, 0x60, 0xDA, 0x0D, 0xB3, -+0x80, 0x18, 0x4D, 0x28, 0x78, 0xDA, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0x84, 0x88, 0x11, 0x80, -+0x15, 0xBF, 0x10, 0x80, 0x05, 0xBF, 0x10, 0x80, 0xF5, 0xBE, 0x10, 0x80, 0xE5, 0xBE, 0x10, 0x80, -+0xD5, 0xBE, 0x10, 0x80, 0xC5, 0xBE, 0x10, 0x80, 0x7D, 0xBE, 0x10, 0x80, 0x6D, 0xBE, 0x10, 0x80, -+0x5D, 0xBE, 0x10, 0x80, 0xFD, 0x63, 0x05, 0x62, 0x04, 0xD0, 0x00, 0x68, 0x18, 0xB4, 0x04, 0x32, -+0x49, 0xE4, 0x60, 0xAA, 0xFF, 0xF7, 0x1F, 0x73, 0x0E, 0x60, 0x41, 0x40, 0x44, 0x32, 0x49, 0xE4, -+0xC0, 0xAA, 0x3F, 0x6C, 0x6C, 0xEC, 0x00, 0x18, 0x01, 0xA6, 0x00, 0x6D, 0x02, 0x48, 0xFF, 0x6A, -+0x4C, 0xE8, 0x10, 0x58, 0xEB, 0x61, 0x00, 0x68, 0x0E, 0xB4, 0x04, 0x32, 0x49, 0xE4, 0x60, 0xAA, -+0xFF, 0xF7, 0x1F, 0x73, 0x0E, 0x60, 0x41, 0x40, 0x44, 0x32, 0x49, 0xE4, 0xC0, 0xAA, 0x3F, 0x6C, -+0x6C, 0xEC, 0x00, 0x18, 0x01, 0xA6, 0x00, 0x6D, 0x02, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, 0x1A, 0x58, -+0xEB, 0x61, 0x05, 0x97, 0x04, 0x90, 0x00, 0xEF, 0x03, 0x63, 0x00, 0x65, 0x04, 0xC0, 0x10, 0x80, -+0x24, 0xC0, 0x10, 0x80, 0xFA, 0x63, 0x0B, 0x62, 0x0A, 0xD1, 0x09, 0xD0, 0xFF, 0xF7, 0x1F, 0x6A, -+0x4C, 0xEE, 0x4C, 0xED, 0xFF, 0x6A, 0x0C, 0xD4, 0x06, 0xD6, 0x04, 0xD5, 0x05, 0xD2, 0x5C, 0x10, -+0x04, 0x93, 0x0C, 0x94, 0x64, 0x32, 0x49, 0xE4, 0x40, 0xAA, 0xFF, 0xF7, 0x1F, 0x72, 0x58, 0x60, -+0xE0, 0xF3, 0x1F, 0x68, 0x01, 0x4B, 0x4C, 0xE8, 0x64, 0x33, 0x42, 0x32, 0x6D, 0xE4, 0x56, 0x32, -+0x20, 0xAB, 0x44, 0x32, 0x03, 0x0B, 0x49, 0xE3, 0x40, 0x8A, 0x4D, 0xE3, 0x00, 0xEB, 0x00, 0x65, -+0x11, 0x00, 0x19, 0x00, 0x6F, 0x00, 0x45, 0x00, 0x4D, 0x00, 0x6F, 0x00, 0x57, 0x00, 0x61, 0x00, -+0x3F, 0x6C, 0x0C, 0xEC, 0x00, 0x6D, 0x12, 0x10, 0x05, 0x93, 0x02, 0x32, 0x4A, 0xEB, 0x08, 0x60, -+0xC2, 0x67, 0x40, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x07, 0xD2, 0x07, 0x92, 0x05, 0xD2, -+0x7F, 0x6C, 0x0C, 0xEC, 0x87, 0x34, 0x40, 0x6A, 0x4D, 0xEC, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, -+0xD1, 0x67, 0x1C, 0x10, 0x00, 0x18, 0xC6, 0x1C, 0x91, 0x67, 0x18, 0x10, 0x01, 0x6A, 0x0C, 0xEA, -+0x15, 0x2A, 0x13, 0xB2, 0x09, 0x10, 0x01, 0x6A, 0x0C, 0xEA, 0x10, 0x2A, 0x11, 0xB2, 0x04, 0x10, -+0x01, 0x6A, 0x0C, 0xEA, 0x0B, 0x2A, 0x10, 0xB2, 0x41, 0xE0, 0x20, 0xC8, 0x07, 0x10, 0x01, 0x6A, -+0x0C, 0xEA, 0x04, 0x2A, 0x90, 0x67, 0x00, 0x18, 0xC3, 0x3B, 0xB1, 0x67, 0x04, 0x94, 0xFF, 0xF7, -+0x1F, 0x6A, 0x02, 0x4C, 0x4C, 0xEC, 0x04, 0xD4, 0x04, 0x92, 0x06, 0x93, 0x63, 0xEA, 0xA0, 0x61, -+0x0B, 0x97, 0x0A, 0x91, 0x09, 0x90, 0x00, 0xEF, 0x06, 0x63, 0x00, 0x65, 0x00, 0xA0, 0x00, 0xB0, -+0x00, 0x00, 0x00, 0xB5, 0x00, 0x10, 0x00, 0xB6, 0xFC, 0x63, 0x07, 0x62, 0x06, 0xD1, 0x05, 0xD0, -+0x00, 0x68, 0x24, 0x67, 0x04, 0x32, 0x49, 0xE1, 0x60, 0xAA, 0xFF, 0xF7, 0x1F, 0x73, 0x29, 0x60, -+0x1E, 0xF0, 0x00, 0x6A, 0x6C, 0xEA, 0x0C, 0xF0, 0x00, 0x72, 0x07, 0x61, 0x41, 0x40, 0x44, 0x32, -+0x49, 0xE1, 0x00, 0x18, 0xC1, 0x1C, 0x80, 0xAA, 0x18, 0x10, 0x04, 0xF0, 0x00, 0x72, 0x0B, 0x61, -+0xFF, 0x6C, 0x8C, 0xEB, 0x40, 0x6A, 0x67, 0x33, 0x4D, 0xEB, 0x41, 0x40, 0x44, 0x32, 0x49, 0xE1, -+0x6C, 0xEC, 0x01, 0x6D, 0x07, 0x10, 0x0D, 0x2A, 0x41, 0x40, 0x44, 0x32, 0xFF, 0x6C, 0x49, 0xE1, -+0x6C, 0xEC, 0x00, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0xC0, 0xAA, 0x02, 0x48, 0xFF, 0x6A, 0x4C, 0xE8, -+0xD1, 0x17, 0x07, 0x97, 0x06, 0x91, 0x05, 0x90, 0x00, 0xEF, 0x04, 0x63, 0xF9, 0x63, 0x0D, 0x62, -+0x0C, 0xD1, 0x0B, 0xD0, 0xFF, 0x68, 0x00, 0x6E, 0x8C, 0xE8, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, -+0x40, 0x6C, 0x5A, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x5C, 0x6C, 0x01, 0x6D, 0x00, 0x18, -+0xA1, 0xA5, 0x22, 0x67, 0xFF, 0xF7, 0x1F, 0x6B, 0x6C, 0xE9, 0xFF, 0xF7, 0x1E, 0x6E, 0x6C, 0xEA, -+0x5A, 0x6C, 0x01, 0x6D, 0x2C, 0xEE, 0x08, 0xD2, 0x00, 0x18, 0x01, 0xA6, 0x09, 0xD3, 0x08, 0x92, -+0x09, 0x93, 0x03, 0x6E, 0x4D, 0xEE, 0x5C, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0x6C, 0xEE, -+0x42, 0xB4, 0x80, 0x18, 0x86, 0x2E, 0x00, 0x65, 0x06, 0x20, 0x90, 0x67, 0x00, 0x18, 0xC6, 0x1C, -+0x00, 0x68, 0x70, 0x67, 0x24, 0x10, 0x01, 0x6D, 0xC5, 0x67, 0x00, 0x18, 0x01, 0xA6, 0x40, 0x6C, -+0x41, 0x6C, 0x38, 0xF0, 0x03, 0x6E, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x00, 0x18, 0xC1, 0x1C, -+0x0A, 0x6C, 0x00, 0x68, 0x7E, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x00, 0xF2, 0x00, 0x6B, -+0x4C, 0xEB, 0x02, 0x23, 0x00, 0x6B, 0x0B, 0x10, 0x00, 0x18, 0xC6, 0x1C, 0x0A, 0x6C, 0x01, 0x48, -+0xFF, 0xF7, 0x1F, 0x6A, 0x4C, 0xE8, 0xE0, 0xF3, 0x08, 0x58, 0xEC, 0x61, 0x01, 0x6B, 0x2C, 0xB4, -+0x80, 0x18, 0x86, 0x2E, 0x09, 0xD3, 0x5A, 0x6C, 0x01, 0x6D, 0x00, 0x18, 0x01, 0xA6, 0xD1, 0x67, -+0x08, 0x96, 0x5C, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x01, 0x6D, 0x01, 0x6D, 0xC5, 0x67, 0x00, 0x18, -+0x01, 0xA6, 0x40, 0x6C, 0x7E, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x01, 0x6D, 0x40, 0x6C, 0x01, 0x6D, -+0x00, 0x6E, 0x00, 0x18, 0x01, 0xA6, 0x08, 0xD2, 0x09, 0x93, 0x09, 0x23, 0x21, 0x6C, 0x08, 0xF2, -+0x00, 0x6E, 0x00, 0x18, 0x01, 0xA6, 0x00, 0x6D, 0xFF, 0xF7, 0x1F, 0x69, 0x07, 0x10, 0x21, 0x6C, -+0x00, 0x18, 0xA1, 0xA5, 0x00, 0x6D, 0xFF, 0xF7, 0x1F, 0x69, 0x4C, 0xE9, 0x15, 0xB3, 0x01, 0x6A, -+0x04, 0x6C, 0xFA, 0x6D, 0xE0, 0xF4, 0x0B, 0x6E, 0xC4, 0xF3, 0x15, 0x6F, 0x05, 0xD3, 0x06, 0xD0, -+0x09, 0xD3, 0x20, 0x18, 0xC5, 0x30, 0x04, 0xD2, 0x09, 0x93, 0x02, 0x6A, 0x04, 0xD2, 0x05, 0xD3, -+0x08, 0x93, 0xFF, 0xF7, 0x1F, 0x6A, 0x05, 0x6C, 0x6C, 0xEA, 0xFA, 0x6D, 0xE0, 0xF4, 0x0C, 0x6E, -+0x44, 0xF5, 0x18, 0x6F, 0x06, 0xD1, 0x20, 0x18, 0xC5, 0x30, 0x07, 0xD2, 0x51, 0x67, 0x0D, 0x97, -+0x0C, 0x91, 0x0B, 0x90, 0x00, 0xEF, 0x07, 0x63, 0x68, 0xC0, 0x10, 0x80, 0xFC, 0xC0, 0x10, 0x80, -+0xB0, 0xE7, 0x04, 0x80, 0xF5, 0x63, 0x15, 0x62, 0x14, 0xD1, 0x13, 0xD0, 0x8A, 0xB2, 0xA0, 0xF2, -+0x6C, 0xAA, 0x04, 0x2B, 0x01, 0x6B, 0x6B, 0xEB, 0xA0, 0xF2, 0x6C, 0xCA, 0x00, 0x18, 0x71, 0xA7, -+0x00, 0x65, 0x86, 0xB4, 0x00, 0x6D, 0x80, 0x18, 0x49, 0x2E, 0x5C, 0x6E, 0x82, 0xB2, 0xA0, 0xF2, -+0x50, 0xAA, 0x3D, 0x72, 0x06, 0x60, 0xFF, 0x6E, 0x81, 0xB4, 0x5E, 0x6D, 0x80, 0x18, 0x49, 0x2E, -+0x01, 0x4E, 0x80, 0x18, 0x2D, 0x2E, 0xFF, 0x69, 0x00, 0x18, 0x62, 0xA6, 0x00, 0x65, 0x00, 0x18, -+0x47, 0xA6, 0x00, 0x65, 0x00, 0x18, 0x87, 0xA4, 0x00, 0x65, 0x00, 0x18, 0x91, 0xA4, 0x00, 0x65, -+0x02, 0x6C, 0x00, 0x18, 0xA1, 0xA5, 0x00, 0x6D, 0x3F, 0x6C, 0x00, 0x6D, 0x00, 0x18, 0xA1, 0xA5, -+0x11, 0xD2, 0x11, 0x93, 0x2C, 0xEA, 0xFF, 0xF7, 0x1F, 0x68, 0x0C, 0xD2, 0x0C, 0xEB, 0x0C, 0x95, -+0x62, 0x33, 0x2C, 0xEB, 0x01, 0x6A, 0xC3, 0x67, 0x82, 0x67, 0xE2, 0x67, 0x11, 0xD3, 0x80, 0x18, -+0xA3, 0x2E, 0x04, 0xD2, 0x11, 0x93, 0x0C, 0x95, 0x03, 0x6A, 0xC3, 0x67, 0x00, 0x6C, 0x0F, 0x6F, -+0x80, 0x18, 0xA3, 0x2E, 0x04, 0xD2, 0x42, 0x34, 0x1F, 0x6D, 0x11, 0x93, 0x8A, 0x34, 0x56, 0x32, -+0xAC, 0xEC, 0xAC, 0xEA, 0x0C, 0x95, 0x03, 0x6E, 0x0B, 0xD4, 0x04, 0xD6, 0x00, 0x6C, 0xC3, 0x67, -+0x0F, 0x6F, 0x80, 0x18, 0xA3, 0x2E, 0x0A, 0xD2, 0x42, 0x37, 0x1F, 0x6C, 0xEA, 0x37, 0x8C, 0xEF, -+0x09, 0xD7, 0x56, 0x35, 0x8C, 0xED, 0x0B, 0x96, 0x09, 0x94, 0x08, 0xD5, 0x2C, 0xED, 0x2C, 0xEE, -+0x2C, 0xEC, 0x0D, 0xD5, 0x0A, 0x97, 0x97, 0xE6, 0x10, 0xD6, 0x0D, 0x96, 0x2C, 0xEF, 0x0E, 0xD4, -+0xD3, 0xE7, 0x00, 0xF6, 0x80, 0x34, 0x00, 0xF6, 0x83, 0x34, 0x98, 0xEC, 0x00, 0xF6, 0xA0, 0x35, -+0x00, 0xF6, 0xA3, 0x35, 0x0F, 0xD7, 0x11, 0x93, 0x12, 0xEC, 0xB8, 0xED, 0x12, 0xED, 0xB1, 0xE4, -+0x0C, 0xEC, 0x11, 0x5C, 0x09, 0x60, 0x09, 0x93, 0x0B, 0x94, 0x08, 0x95, 0x0A, 0x97, 0x99, 0xE3, -+0xC7, 0x36, 0x0C, 0xEE, 0xED, 0xE5, 0x55, 0x10, 0x0C, 0x95, 0xC3, 0x67, 0x03, 0x6A, 0x00, 0x6C, -+0x0F, 0x6F, 0x80, 0x18, 0xA3, 0x2E, 0x04, 0xD2, 0x42, 0x36, 0x1F, 0x6B, 0xCA, 0x36, 0x6C, 0xEE, -+0x10, 0x95, 0xE6, 0x67, 0x2C, 0xEF, 0x1F, 0x6C, 0x56, 0x33, 0x8C, 0xEB, 0xF3, 0xE5, 0x00, 0xF6, -+0x80, 0x34, 0x00, 0xF6, 0x83, 0x34, 0x0C, 0x65, 0x0F, 0x94, 0x6C, 0xE9, 0x37, 0xE4, 0x00, 0xF6, -+0xA0, 0x35, 0x00, 0xF6, 0xA3, 0x35, 0xB8, 0xED, 0x88, 0x67, 0x12, 0xED, 0x98, 0xEC, 0x12, 0xEC, -+0x95, 0xE5, 0x0E, 0x94, 0x0C, 0xED, 0x11, 0x5D, 0xFF, 0xE4, 0x0D, 0x94, 0x00, 0xF6, 0xE0, 0x37, -+0x00, 0xF6, 0xE3, 0x37, 0x27, 0xE4, 0x00, 0xF6, 0x20, 0x34, 0x00, 0xF6, 0x83, 0x34, 0x98, 0xEC, -+0x12, 0xEC, 0xF8, 0xEF, 0x12, 0xEF, 0xF1, 0xE4, 0x0C, 0xEC, 0x10, 0x60, 0xA3, 0xEC, 0x07, 0x60, -+0x09, 0x94, 0x08, 0x95, 0x99, 0xE6, 0xC7, 0x36, 0x0C, 0xEE, 0xAD, 0xE3, 0x12, 0x10, 0x0B, 0x97, -+0x0A, 0x94, 0xF9, 0xE6, 0xC7, 0x36, 0x0C, 0xEE, 0x8D, 0xE3, 0x0B, 0x10, 0x11, 0x5C, 0x03, 0x61, -+0x10, 0x6B, 0xC3, 0x67, 0x08, 0x10, 0x09, 0x95, 0x08, 0x97, 0xB9, 0xE6, 0xC7, 0x36, 0x0C, 0xEE, -+0xED, 0xE3, 0x67, 0x33, 0x0C, 0xEB, 0x1F, 0x6C, 0x4C, 0xEC, 0x10, 0xF0, 0x00, 0x6A, 0x4B, 0xEA, -+0xC0, 0x36, 0x4D, 0xEC, 0xC8, 0x36, 0x74, 0x33, 0x8D, 0xEE, 0x6D, 0xEE, 0xFF, 0xF7, 0x1F, 0x6A, -+0x4C, 0xEE, 0x21, 0x6C, 0x00, 0x18, 0x01, 0xA6, 0x00, 0x6D, 0x0E, 0x6C, 0x00, 0x18, 0xA1, 0xA5, -+0x00, 0x6D, 0x21, 0x6C, 0x00, 0x6D, 0x00, 0x18, 0xA1, 0xA5, 0x02, 0x67, 0x02, 0x6B, 0x04, 0xD3, -+0x01, 0x6C, 0x0C, 0xB3, 0xFA, 0x6D, 0x60, 0xF5, 0x15, 0x6E, 0xA4, 0xF3, 0x0D, 0x6F, 0x06, 0xD0, -+0x05, 0xD3, 0x20, 0x18, 0xC5, 0x30, 0x07, 0xD2, 0x15, 0x97, 0x14, 0x91, 0x13, 0x90, 0x00, 0xEF, -+0x0B, 0x63, 0x00, 0x65, 0x48, 0x00, 0x11, 0x80, 0x4C, 0xBF, 0x10, 0x80, 0x3C, 0x02, 0x11, 0x80, -+0xB0, 0xE7, 0x04, 0x80, 0xFD, 0x63, 0x05, 0x62, 0xFF, 0x6A, 0x4C, 0xEE, 0x85, 0x67, 0x01, 0x76, -+0x4C, 0xEC, 0x05, 0x61, 0x40, 0x6B, 0x8D, 0xEB, 0x83, 0x67, 0x4C, 0xEC, 0x01, 0x10, 0x03, 0x2E, -+0x00, 0x18, 0xBC, 0xA5, 0xA7, 0x67, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x6D, 0xF5, 0x00, 0x65, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, -+0x00, 0x18, 0x5B, 0x3A, 0x00, 0x65, 0x05, 0x97, 0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, -+0x44, 0xAC, 0x01, 0x72, 0x10, 0x61, 0x60, 0x9C, 0x3F, 0x6A, 0x6C, 0xEA, 0x20, 0x72, 0x0B, 0x61, -+0x09, 0xB2, 0x6C, 0xEA, 0x08, 0x2A, 0x09, 0xB3, 0x40, 0xDB, 0x09, 0xB3, 0x40, 0xDB, 0x40, 0x9C, -+0x08, 0xB3, 0x6D, 0xEA, 0x40, 0xDC, 0x00, 0x18, 0xCE, 0x31, 0x00, 0x65, 0x05, 0x97, 0x00, 0xEF, -+0x03, 0x63, 0x00, 0x65, 0x00, 0x00, 0xFF, 0x00, 0x24, 0xC1, 0x10, 0x80, 0x4C, 0x8B, 0x10, 0x80, -+0x00, 0x00, 0x01, 0x00, 0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xA8, 0xBA, 0x00, 0x65, 0x05, 0x97, -+0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x25, 0xBB, 0x00, 0x65, 0x05, 0x97, -+0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0xC7, 0x5C, 0x00, 0x65, 0x05, 0x97, -+0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x8C, 0x8E, 0x00, 0x65, 0x05, 0x97, -+0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, 0x00, 0x18, 0x50, 0x5D, 0x00, 0x65, 0x05, 0x97, -+0x00, 0xEF, 0x03, 0x63, 0xFD, 0x63, 0x05, 0x62, 0x20, 0x18, 0x6A, 0x24, 0x00, 0x65, 0x05, 0x97, -+0x00, 0xEF, 0x03, 0x63, 0x04, 0x0B, 0x0F, 0x04, 0x0A, 0x0E, 0x08, 0x0B, 0x0F, 0x00, 0x00, 0x00, -+0x1B, 0x00, 0xB7, 0x00, 0x53, 0x01, 0x36, 0x00, 0x6F, 0x01, 0xA7, 0x02, 0x53, 0x00, 0x28, 0x02, -+0xFD, 0x03, 0x25, 0x00, 0x07, 0x04, 0x05, 0x01, 0x00, 0x00, 0x00, 0x00, 0x74, 0x41, 0x01, 0x10, -+0xAC, 0x80, 0x01, 0xF0, 0x78, 0x41, 0x07, 0x20, 0x7A, 0x41, 0xB1, 0x01, 0x7C, 0x41, 0x07, 0x00, -+0x7E, 0x41, 0xB1, 0x01, 0x0A, 0x22, 0x62, 0x02, 0x4E, 0x22, 0x9A, 0x06, 0x50, 0x22, 0x9A, 0x06, -+0x18, 0x20, 0x0F, 0x69, 0x34, 0x20, 0x55, 0x22, 0x38, 0x20, 0xA8, 0xC0, 0x00, 0x00, 0x06, 0x10, -+0x0E, 0x00, 0x2A, 0x10, 0x16, 0x00, 0x00, 0x24, 0x16, 0x00, 0x00, 0x00, 0x1C, 0x00, 0x20, 0x81, -+0x25, 0x00, 0x93, 0x23, 0x2B, 0x00, 0x80, 0x48, 0x21, 0x00, 0x00, 0x42, 0x24, 0x00, 0x00, 0xFE, -+0x26, 0x00, 0x2A, 0x08, 0x26, 0x00, 0x2A, 0x08, 0x27, 0x00, 0x60, 0x04, 0x28, 0x00, 0x42, 0x80, -+0x29, 0x00, 0x18, 0x46, 0x2A, 0x00, 0xC0, 0x40, 0x2D, 0x00, 0x08, 0x00, 0x37, 0x00, 0x04, 0xC0, -+0x0E, 0x00, 0x2A, 0x90, 0x31, 0x00, 0x01, 0x50, 0x32, 0x00, 0x71, 0x00, 0x33, 0x00, 0x70, 0x6F, -+0x0E, 0x00, 0xAA, 0x11, 0x2A, 0x00, 0xC0, 0x46, 0x24, 0x00, 0x01, 0xFE, 0x00, 0x60, 0x00, 0x01, -+0x2A, 0x00, 0xD0, 0x40, 0x1C, 0x00, 0x21, 0x81, 0x00, 0x60, 0x01, 0x00, 0x3F, 0x00, 0x00, 0x00, -+0x00, 0x60, 0x01, 0x00, 0x3F, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0F, 0x00, 0x00, 0x20, -+0xFF, 0xFF, 0xFF, 0xFF, 0x13, 0x00, 0x9B, 0x7D, 0x13, 0x00, 0x0E, 0x60, 0x13, 0x00, 0x9E, 0x5C, -+0x13, 0x00, 0x0A, 0x30, 0x13, 0x00, 0xF8, 0x2F, 0x13, 0x00, 0xC5, 0x1F, 0x13, 0x00, 0x90, 0x00, -+0xFF, 0xFF, 0xFF, 0xFF, 0x1F, 0x00, 0xCB, 0x70, 0x20, 0x00, 0xC4, 0xFF, 0x22, 0x00, 0x00, 0x00, -+0x23, 0x00, 0x15, 0xE0, 0x15, 0x00, 0x40, 0x00, 0x15, 0x00, 0xC0, 0x20, 0x15, 0x00, 0xC0, 0x48, -+0x15, 0x00, 0xC0, 0x69, 0x15, 0x00, 0xC0, 0x90, 0x15, 0x00, 0xC0, 0xB1, 0x15, 0x00, 0xC0, 0xD8, -+0x15, 0x00, 0xC0, 0xF9, 0xFF, 0xFF, 0xFF, 0xFF, 0x08, 0x0B, 0x28, 0x2B, 0x48, 0x4B, 0xC8, 0xCC, -+0xE9, 0xEC, 0xEE, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x21, 0x00, 0x00, 0xC2, 0x00, 0x00, 0x00, 0x50, -+0x01, 0x00, 0x00, 0x17, 0x02, 0x00, 0x00, 0xCC, 0x3F, 0x00, 0x01, 0x00, 0x3F, 0x00, 0x00, 0x00, -+0x00, 0x60, 0xF4, 0x01, 0x00, 0x20, 0x01, 0x00, 0x02, 0x20, 0x00, 0x00, 0x00, 0x20, 0x00, 0x00, -+0x40, 0x20, 0x00, 0x48, 0x42, 0x20, 0x00, 0x01, 0x44, 0x20, 0x00, 0x48, 0x46, 0x20, 0x00, 0x81, -+0x48, 0x20, 0x00, 0x00, 0x4A, 0x20, 0x00, 0xF8, 0x4C, 0x20, 0x00, 0x00, 0x4E, 0x20, 0x38, 0x01, -+0x50, 0x20, 0x30, 0xCC, 0x52, 0x20, 0x00, 0x08, 0x54, 0x20, 0x10, 0x8C, 0x56, 0x20, 0x00, 0xE0, -+0x58, 0x20, 0x00, 0x50, 0x5A, 0x20, 0x00, 0x80, 0x5C, 0x20, 0x00, 0x20, 0x5E, 0x20, 0x00, 0x00, -+0x00, 0x20, 0x01, 0x00, 0x08, 0x20, 0x14, 0x14, 0x0E, 0x20, 0x01, 0x00, 0x02, 0x20, 0x60, 0xC0, -+0x00, 0x60, 0x0A, 0x00, 0x02, 0x20, 0x20, 0xC0, 0x00, 0x60, 0x0A, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, -+0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x20, 0x01, 0x00, -+0x02, 0x20, 0x20, 0x00, 0x0C, 0x20, 0x10, 0x00, 0x0E, 0x20, 0x00, 0x80, 0x00, 0x20, 0x00, 0x00, -+0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, -+0x51, 0x47, 0x2E, 0x80, -+}; -+static const u4Byte ArrayLength_MP_8821A_FW_BT = 8484; -+ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_BT( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+) -+{ -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8821A_FW_BT; -+ *pFirmwareSize = ArrayLength_MP_8821A_FW_BT; -+} -+ -+ -+static const u1Byte Array_MP_8821A_FW_NIC[] = { -+0x01, 0x21, 0x10, 0x00, 0x0B, 0x00, 0x00, 0x00, 0x04, 0x23, 0x15, 0x35, 0xC4, 0x7C, 0x00, 0x00, -+0x71, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x49, 0x61, 0x02, 0x5F, 0xF9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x60, 0x7A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x70, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x60, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x6F, 0x33, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x6F, 0xE6, 0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, -+0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, -+0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, -+0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x10, 0xF0, 0x3F, 0x00, -+0x00, 0x00, 0x00, 0x0A, 0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, -+0x06, 0x03, 0x02, 0x00, 0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, -+0x08, 0x0C, 0x0A, 0x07, 0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, -+0x03, 0x00, 0x08, 0x0B, 0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, -+0x12, 0x09, 0x04, 0x00, 0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, -+0x20, 0x24, 0x22, 0x14, 0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, -+0x04, 0x00, 0x20, 0x23, 0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, -+0x1F, 0x0F, 0x04, 0x00, 0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, -+0x30, 0x31, 0x2F, 0x18, 0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, -+0x0C, 0x00, 0x30, 0x31, 0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, -+0x1E, 0x14, 0x00, 0x00, 0x30, 0x04, 0x04, 0x04, 0x05, 0x04, 0x04, 0x05, 0x07, 0x07, 0x07, 0x08, -+0x0A, 0x04, 0x07, 0x0A, 0x0E, 0x11, 0x13, 0x14, 0x15, 0x03, 0x04, 0x07, 0x07, 0x08, 0x0B, 0x0D, -+0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, -+0x0F, 0x07, 0x08, 0x08, 0x0A, 0x0A, 0x0C, 0x0E, 0x10, 0x11, 0x11, 0x07, 0x09, 0x09, 0x0B, 0x0B, -+0x0D, 0x0F, 0x11, 0x11, 0x12, 0x05, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x05, -+0x05, 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x0F, 0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, 0x07, 0x09, -+0x09, 0x0C, 0x0E, 0x10, 0x12, 0x05, 0x06, 0x07, 0x0D, 0x10, 0x11, 0x12, 0x12, 0x07, 0x08, 0x09, -+0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x09, 0x09, 0x09, -+0x09, 0x0C, 0x0E, 0x11, 0x13, 0x05, 0x06, 0x08, 0x09, 0x0C, 0x0E, 0x12, 0x12, 0x13, 0x14, 0x07, -+0x08, 0x0A, 0x0B, 0x0D, 0x10, 0x11, 0x11, 0x14, 0x16, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, -+0x13, 0x13, 0x13, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, 0x11, 0x13, 0x13, 0x13, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x24, 0x26, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x21, 0x25, 0x27, -+0x28, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, -+0x2A, 0x00, 0x00, 0x00, 0x00, 0x23, 0x26, 0x28, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, -+0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x20, 0x25, 0x27, 0x29, 0x29, 0x2A, 0x00, 0x00, 0x00, -+0x00, 0x23, 0x26, 0x28, 0x2A, 0x2A, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x26, 0x28, 0x2A, 0x2A, -+0x2A, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, -+0x10, 0x00, 0x00, 0x00, 0x18, 0x00, 0x00, 0x00, 0x24, 0x00, 0x00, 0x00, 0x30, 0x00, 0x00, 0x00, -+0x48, 0x00, 0x00, 0x00, 0x60, 0x00, 0x00, 0x00, 0x90, 0x00, 0x00, 0x00, 0xC0, 0x00, 0x00, 0x00, -+0xD8, 0x00, 0x00, 0x00, 0x3C, 0x00, 0x00, 0x00, 0x64, 0x00, 0x00, 0x00, 0x78, 0x00, 0x00, 0x00, -+0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, 0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x01, -+0xE0, 0x00, 0x00, 0x00, 0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, 0x00, 0x01, 0x40, 0x00, 0x00, 0x01, -+0x90, 0x00, 0x00, 0x02, 0x58, 0x00, 0x00, 0x03, 0x20, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, -+0x40, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, -+0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, -+0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, -+0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, -+0xD0, 0x00, 0x00, 0x00, 0x3C, 0x00, 0x00, 0x00, 0x64, 0x00, 0x00, 0x00, 0x78, 0x00, 0x00, 0x00, -+0xA0, 0x00, 0x00, 0x00, 0xF0, 0x00, 0x00, 0x01, 0x40, 0x00, 0x00, 0x01, 0x90, 0x00, 0x00, 0x01, -+0xE0, 0x00, 0x00, 0x02, 0x58, 0x00, 0x00, 0x03, 0x20, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, -+0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x07, -+0xD0, 0x00, 0x00, 0x0B, 0xB8, 0x00, 0x00, 0x13, 0x88, 0x00, 0x00, 0x17, 0x70, 0x00, 0x00, 0x1F, -+0x40, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, 0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, -+0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, 0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, -+0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x00, 0xC8, 0x00, 0x00, 0x01, -+0x18, 0x00, 0x00, 0x01, 0xE0, 0x00, 0x00, 0x02, 0xD0, 0x00, 0x00, 0x03, 0xE8, 0x00, 0x00, 0x04, -+0xB0, 0x00, 0x00, 0x06, 0x40, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, 0xD0, 0x00, 0x00, 0x07, -+0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, 0x04, 0x00, 0x08, 0x00, 0x0C, 0x00, 0x12, 0x00, 0x18, 0x00, -+0x24, 0x00, 0x30, 0x00, 0x48, 0x00, 0x60, 0x00, 0x6C, 0x00, 0x14, 0x00, 0x32, 0x00, 0x3C, 0x00, -+0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x00, 0xF0, 0x00, 0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, -+0xC8, 0x01, 0x2C, 0x01, 0x90, 0x02, 0x58, 0x03, 0x20, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, -+0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, -+0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x00, 0x1E, 0x00, 0x32, 0x00, 0x3C, 0x00, -+0x50, 0x00, 0x78, 0x00, 0xA0, 0x00, 0xC8, 0x00, 0xF0, 0x01, 0x2C, 0x01, 0x90, 0x00, 0x64, 0x00, -+0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x03, 0xE8, 0x05, 0xDC, 0x09, 0xC4, 0x0B, 0xB8, 0x0F, -+0xA0, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, -+0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x00, 0x64, 0x00, 0x8C, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, -+0x58, 0x03, 0x20, 0x03, 0xE8, 0x03, 0xE8, 0x03, 0xE8, 0x02, 0x04, 0x06, 0x08, 0x0A, 0x0C, 0x10, -+0x18, 0x20, 0x30, 0x40, 0x50, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, -+0x05, 0x02, 0x06, 0x06, 0x07, 0x07, 0x08, 0x08, 0x08, 0x02, 0x02, 0x03, 0x03, 0x05, 0x05, 0x06, -+0x06, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, -+0x0A, 0x05, 0x06, 0x06, 0x07, 0x07, 0x07, 0x08, 0x08, 0x0A, 0x0A, 0x06, 0x06, 0x06, 0x07, 0x07, -+0x07, 0x08, 0x08, 0x0A, 0x0B, 0x05, 0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x05, -+0x06, 0x06, 0x07, 0x07, 0x08, 0x09, 0x0A, 0x0A, 0x0B, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, -+0x04, 0x05, 0x06, 0x07, 0x08, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x05, 0x06, 0x06, -+0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x07, -+0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x05, 0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, -+0x06, 0x06, 0x07, 0x08, 0x09, 0x0B, 0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, -+0x0C, 0x0C, 0x0C, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0C, 0x0C, 0x19, 0x06, 0x04, -+0x02, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x46, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4A, 0x01, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x4A, 0x01, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x46, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x46, 0x4C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x46, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, -+0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xEF, 0x2B, 0xFF, -+0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, -+0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, -+0xEC, 0x48, 0xFC, 0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, -+0xE8, 0x9C, 0x45, 0xF0, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x22, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, 0xFD, 0x74, 0x02, 0x93, 0xFE, 0x74, 0x03, 0x93, 0xFF, -+0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE4, 0x93, 0xF8, -+0x74, 0x01, 0x93, 0xF9, 0x74, 0x02, 0x93, 0xFA, 0x74, 0x03, 0x93, 0xFB, 0x22, 0xA4, 0x25, 0x82, -+0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, -+0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, -+0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, -+0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, -+0xDF, 0x02, 0x49, 0x9F, 0x02, 0x46, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, -+0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, -+0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, -+0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, -+0x49, 0xE4, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, -+0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, -+0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, -+0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, -+0xDE, 0xE7, 0x80, 0xBE, 0x00, 0x41, 0xA3, 0x51, 0x00, 0x41, 0xA3, 0x52, 0x00, 0x41, 0xA3, 0x37, -+0x00, 0x41, 0xA3, 0x38, 0x00, 0x41, 0xA3, 0x39, 0x00, 0x41, 0xA3, 0x3A, 0x00, 0x41, 0xA3, 0x65, -+0x00, 0x4B, 0x86, 0x52, 0xFC, 0x59, 0x1A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, -+0x75, 0x83, 0x00, 0xED, 0xF0, 0x7F, 0x10, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x62, 0xED, 0xF0, 0x90, 0xA3, 0x61, -+0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x6D, 0x7F, 0x47, 0x71, 0x24, 0x90, 0xA3, 0x61, 0xE0, 0xFE, -+0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, -+0x51, 0x07, 0x7F, 0x46, 0x71, 0x24, 0x90, 0xA3, 0x61, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, -+0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x46, 0x51, 0x07, 0x90, 0xA3, 0x62, 0xE0, -+0x60, 0x17, 0x7F, 0x45, 0x71, 0x24, 0x90, 0xA3, 0x61, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, -+0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x80, 0x16, 0x7F, 0x45, 0x71, 0x24, 0x90, 0xA3, 0x61, -+0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, -+0x7F, 0x45, 0x80, 0x75, 0x90, 0xA3, 0x61, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0x71, 0x24, 0x90, -+0xA3, 0x61, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, -+0x5F, 0xFD, 0x7F, 0x63, 0x51, 0x07, 0x7F, 0x62, 0x71, 0x24, 0x90, 0xA3, 0x61, 0xE0, 0xFE, 0x74, -+0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0x51, 0x07, -+0x90, 0xA3, 0x62, 0xE0, 0x60, 0x1A, 0x7F, 0x61, 0x71, 0x24, 0x90, 0xA3, 0x61, 0xE0, 0xFE, 0x74, -+0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x19, -+0x7F, 0x61, 0x71, 0x24, 0x90, 0xA3, 0x61, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, -+0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x51, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xEF, 0xF0, 0x7F, 0x8F, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, 0x75, 0x83, 0x00, -+0xE0, 0x90, 0xA3, 0x63, 0xF0, 0x7F, 0x10, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0xA3, 0x63, 0xE0, -+0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x54, 0x71, 0x24, 0xE5, 0x0D, 0x5F, 0xF5, 0x11, 0x7F, -+0x55, 0x71, 0x24, 0xE5, 0x0E, 0x5F, 0xF5, 0x12, 0x7F, 0x56, 0x71, 0x24, 0xE5, 0x0F, 0x5F, 0xF5, -+0x13, 0x7F, 0x57, 0x71, 0x24, 0xE5, 0x10, 0x5F, 0xF5, 0x14, 0xAD, 0x11, 0x7F, 0x54, 0x51, 0x07, -+0xAD, 0x12, 0x7F, 0x55, 0x51, 0x07, 0xAD, 0x13, 0x7F, 0x56, 0x51, 0x07, 0xAD, 0x14, 0x7F, 0x57, -+0x51, 0x07, 0x53, 0x91, 0xEF, 0x22, 0x7F, 0x81, 0x71, 0x24, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, 0x81, -+0x51, 0x07, 0x7F, 0x80, 0x71, 0x24, 0xEF, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x51, 0x07, 0x12, 0x99, -+0x6B, 0x12, 0x3D, 0x3B, 0x12, 0x99, 0x78, 0x12, 0x9A, 0x3A, 0x7F, 0x01, 0x12, 0x47, 0x15, 0x90, -+0xA1, 0x6E, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x47, 0x15, 0x90, 0xA1, 0x6E, 0xE0, 0x04, 0xF0, 0x12, -+0x58, 0x2B, 0x12, 0x92, 0xA5, 0x7F, 0x80, 0x71, 0x24, 0xEF, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x51, -+0x07, 0x75, 0x28, 0xFF, 0x12, 0x59, 0x13, 0x12, 0x99, 0xB9, 0x7F, 0x81, 0x71, 0x24, 0xEF, 0x44, -+0x04, 0xFD, 0x7F, 0x81, 0x51, 0x07, 0x12, 0x9A, 0x44, 0xE4, 0xFF, 0x02, 0x47, 0x9E, 0x7F, 0x8F, -+0x71, 0x24, 0xEF, 0x30, 0xE6, 0x64, 0x7F, 0x8D, 0x71, 0x24, 0xEF, 0x64, 0x03, 0x70, 0x5B, 0x7F, -+0x8F, 0x71, 0x24, 0xEF, 0x7F, 0x00, 0xFE, 0xC0, 0x07, 0xC0, 0x06, 0x7F, 0x8E, 0x71, 0x24, 0xEF, -+0xFD, 0xD0, 0xE0, 0xFF, 0xD0, 0xE0, 0x4D, 0x90, 0xA2, 0x3F, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, -+0x90, 0xA2, 0x3E, 0xF0, 0x90, 0xA2, 0x3E, 0xE0, 0xFD, 0xFF, 0x90, 0xA2, 0x40, 0xE0, 0x2F, 0xFF, -+0x90, 0xA2, 0x3F, 0xE0, 0x34, 0x00, 0x8F, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x91, 0x60, -+0x90, 0xA2, 0x3E, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD8, 0x7F, 0x8F, 0x71, 0x24, -+0xEF, 0x30, 0xE0, 0x06, 0xE4, 0xFD, 0x7F, 0x8D, 0x51, 0x07, 0x22, 0x31, 0x1D, 0xE0, 0xFB, 0x0D, -+0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, -+0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, -+0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, -+0x8F, 0x71, 0x24, 0xEF, 0x20, 0xE6, 0x03, 0x02, 0x52, 0xB5, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0xA3, -+0x47, 0xF0, 0x7F, 0x8D, 0x71, 0x24, 0x90, 0xA3, 0x48, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, -+0xA3, 0x49, 0xF0, 0x90, 0xA3, 0x48, 0xE0, 0x31, 0x3B, 0x4C, 0xE1, 0x01, 0x4C, 0xEC, 0x02, 0x4C, -+0xF7, 0x03, 0x4D, 0x02, 0x04, 0x4E, 0x16, 0x05, 0x4F, 0x0B, 0x06, 0x4F, 0x91, 0x08, 0x50, 0x53, -+0x09, 0x50, 0xEA, 0x0A, 0x51, 0x81, 0x0B, 0x51, 0xF8, 0x0C, 0x52, 0x91, 0x20, 0x00, 0x00, 0x52, -+0xA5, 0x90, 0xA3, 0x47, 0xE0, 0xFF, 0x12, 0xB6, 0xCD, 0x02, 0x52, 0xA5, 0x90, 0xA3, 0x47, 0xE0, -+0xFF, 0x12, 0xB7, 0x30, 0x02, 0x52, 0xA5, 0x90, 0xA3, 0x47, 0xE0, 0xFF, 0x12, 0xB7, 0xA4, 0x02, -+0x52, 0xA5, 0x90, 0xA3, 0x47, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, -+0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, -+0x31, 0x1D, 0xE0, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x91, 0x60, 0x90, 0xA3, 0x47, -+0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, 0x31, 0x1D, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, -+0xFB, 0x0D, 0xE4, 0xFF, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, -+0x31, 0x1D, 0xE0, 0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, -+0x75, 0xF0, 0x04, 0x90, 0x95, 0x92, 0x31, 0x1D, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, -+0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x93, 0x91, 0x5B, 0x90, 0xA3, 0x47, 0xE0, 0x75, -+0xF0, 0x04, 0x90, 0x95, 0x94, 0x31, 0x1D, 0xE0, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, -+0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x94, 0x31, 0x1D, 0xE0, 0x54, -+0x1F, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x31, -+0x1D, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x08, 0x90, -+0x89, 0x01, 0x91, 0x5B, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x91, 0x5B, -+0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x91, 0x5B, 0x90, 0xA3, 0x47, 0xE0, -+0x75, 0xF0, 0x08, 0x90, 0x89, 0x04, 0x31, 0x1D, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, -+0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x05, 0x91, 0x5B, 0x90, 0xA3, 0x47, 0xE0, 0x75, -+0xF0, 0x08, 0x90, 0x89, 0x06, 0x91, 0x5B, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, -+0x07, 0x31, 0x1D, 0x02, 0x50, 0xE5, 0x90, 0xA3, 0x47, 0xE0, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, -+0xE4, 0x34, 0x92, 0xF5, 0x83, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x60, 0x90, 0xA3, 0x47, -+0xE0, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x91, -+0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x31, 0x1D, 0xA3, 0xE0, 0xFB, -+0x0D, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x91, 0x5B, 0x90, -+0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x03, 0x31, 0x1D, 0xA3, 0xE0, 0xFB, 0xE4, 0xFD, -+0x0F, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x05, 0x31, 0x1D, 0xA3, -+0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x07, 0x31, -+0x1D, 0xA3, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x75, 0xF0, 0x0A, 0x90, 0x8D, -+0x09, 0x31, 0x1D, 0xA3, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x24, 0x12, 0xF5, -+0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0xE4, 0xFB, 0x91, -+0x60, 0x90, 0xA3, 0x47, 0xE0, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, -+0xA3, 0xE0, 0xFB, 0x7D, 0x02, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x25, 0xE0, 0x24, 0x11, 0xF5, -+0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x78, 0xE0, 0xFB, -+0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0xA1, 0x79, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x7A, -+0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x7B, 0x02, 0x50, 0xE5, 0x90, 0xA1, 0x80, 0xE0, 0xFB, -+0xE4, 0xFD, 0xFF, 0x91, 0x60, 0x90, 0xA1, 0x81, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x82, -+0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x83, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x84, -+0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0xA1, 0x85, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, -+0xA1, 0x86, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x87, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, -+0xA1, 0x88, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0xA1, 0x89, 0xE0, 0xFB, 0x0D, 0x91, -+0x60, 0x90, 0xA1, 0x8A, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x8B, 0xE0, 0xFB, 0x0D, 0x91, -+0x60, 0x90, 0xA1, 0x8C, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0xA1, 0x8D, 0xE0, 0xFB, -+0x0D, 0x91, 0x60, 0x90, 0xA1, 0x8E, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x8F, 0x02, 0x50, -+0xE5, 0x90, 0xA1, 0x10, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x91, 0x60, 0x90, 0xA1, 0x0F, 0xE0, 0x54, -+0x0F, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x12, 0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA1, 0x13, -+0xE0, 0xFB, 0x0D, 0x91, 0x60, 0x90, 0xA3, 0x47, 0xE0, 0x24, 0x87, 0xF5, 0x82, 0xE4, 0x34, 0xA0, -+0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0x01, 0xFB, -+0x0D, 0x91, 0x60, 0x90, 0xA1, 0x0D, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, -+0x91, 0x60, 0x90, 0xA1, 0x0D, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, -+0x91, 0x60, 0x90, 0x9F, 0x93, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x91, 0x60, 0x90, 0x9F, 0x94, 0xE0, -+0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x17, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, -+0x16, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x0F, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, 0xE4, -+0xFD, 0x7F, 0x03, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x0E, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, -+0x7F, 0x03, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x0E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, -+0x7F, 0x03, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x0D, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, -+0x03, 0x41, 0xA2, 0x90, 0xA1, 0x98, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x12, 0x4C, 0x60, 0x90, 0xA1, -+0x99, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x9A, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, -+0x90, 0xA1, 0x9B, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x9C, 0xE0, 0xFB, 0xE4, 0xFD, -+0x0F, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x9D, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x9E, -+0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x9F, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, -+0xA1, 0xA0, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xA1, 0xE0, 0xFB, 0x0D, -+0x12, 0x4C, 0x60, 0x90, 0xA1, 0xA2, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xA3, 0xE0, -+0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xA4, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, 0x60, -+0x90, 0xA1, 0xA5, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xA6, 0xE0, 0xFB, 0x0D, 0x12, -+0x4C, 0x60, 0x90, 0xA1, 0xA7, 0xE0, 0xFB, 0x0D, 0x41, 0xA2, 0x90, 0xA1, 0xA8, 0xE0, 0xFB, 0xE4, -+0xFD, 0xFF, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xA9, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, -+0xAA, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xAB, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, -+0x90, 0xA1, 0xAC, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xAD, 0xE0, 0xFB, -+0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xAE, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xAF, -+0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xB0, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, -+0x60, 0x90, 0xA1, 0xB1, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xB2, 0xE0, 0xFB, 0x0D, -+0x12, 0x4C, 0x60, 0x90, 0xA1, 0xB3, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xB4, 0xE0, -+0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xB5, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, -+0x90, 0xA1, 0xB6, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0xB7, 0xE0, 0xFB, 0x0D, 0x41, -+0xA2, 0x90, 0xA1, 0x56, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFB, 0xE4, 0xFD, 0xFF, 0x12, 0x4C, 0x60, -+0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0xA3, 0x4A, 0xEF, -+0xF0, 0xE0, 0xC3, 0x13, 0xF0, 0x54, 0x1F, 0xF0, 0xFB, 0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x4C, 0x60, -+0x90, 0xA1, 0x5D, 0x12, 0x48, 0xE5, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0xA3, 0x4A, 0xEF, 0xF0, -+0xE0, 0xC3, 0x13, 0xF0, 0x54, 0x1F, 0xF0, 0xFB, 0x7D, 0x02, 0xE4, 0xFF, 0x12, 0x4C, 0x60, 0x90, -+0xA1, 0x59, 0x12, 0x48, 0xE5, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0xA3, 0x4A, 0xEF, 0xF0, 0xE0, -+0xC3, 0x13, 0xF0, 0x54, 0x1F, 0xF0, 0xFB, 0x7D, 0x03, 0xE4, 0xFF, 0x12, 0x4C, 0x60, 0x90, 0xA1, -+0x65, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x41, 0xA2, 0x90, 0xA1, 0x2E, 0xE0, 0xC4, 0x13, 0x54, 0x01, -+0xFB, 0xE4, 0xFD, 0xFF, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x39, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, -+0x90, 0xA1, 0x3A, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x30, 0xE0, 0xFB, 0x0D, 0x12, -+0x4C, 0x60, 0x90, 0xA1, 0x3D, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, 0x60, 0x90, 0x07, 0x78, -+0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0x05, 0x22, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x7F, -+0xB4, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0x78, 0x18, 0x12, 0x08, 0x47, 0x90, 0xA3, 0x4A, 0xEF, 0xF0, -+0xFB, 0x7D, 0x03, 0x7F, 0x01, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x31, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, -+0x12, 0x4C, 0x60, 0x90, 0xA1, 0x32, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x33, 0xE0, -+0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x34, 0xE0, 0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x90, 0xA1, -+0x35, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x12, 0x4C, 0x60, 0x90, 0xA1, 0x12, 0xE0, 0xFB, 0x0D, 0x80, -+0x11, 0x90, 0xA0, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x12, 0x4C, 0x60, 0x90, 0xA0, 0x84, 0xE0, -+0xFB, 0x0D, 0x12, 0x4C, 0x60, 0x7F, 0x8F, 0x12, 0x4B, 0x24, 0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, -+0x7F, 0x8D, 0x12, 0x4A, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x51, 0xC2, 0x12, 0x4B, 0xEE, 0x02, -+0x4C, 0x88, 0x7F, 0x8F, 0x12, 0x4B, 0x24, 0xEF, 0x30, 0xE5, 0x30, 0x7F, 0x8E, 0x12, 0x4B, 0x24, -+0xEF, 0x64, 0x05, 0x70, 0x26, 0x7F, 0x8F, 0x12, 0x4B, 0x24, 0x90, 0x00, 0x8E, 0xE0, 0xFE, 0x74, -+0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xEE, 0xF0, 0x7F, 0x8F, 0x12, 0x4B, 0x24, -+0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8E, 0x12, 0x4A, 0x07, 0x22, 0xE4, 0x90, 0xA2, 0x3D, -+0xF0, 0x90, 0xA2, 0x3D, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0xFC, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x52, -+0xA3, 0xF0, 0x12, 0x3D, 0x6E, 0xBF, 0x01, 0x03, 0x12, 0x31, 0x38, 0x90, 0xA1, 0x10, 0xE0, 0x60, -+0x0E, 0x90, 0xA1, 0x13, 0xE0, 0xFF, 0x90, 0xA1, 0x12, 0xE0, 0x6F, 0x60, 0x02, 0x71, 0x43, 0xC2, -+0xAF, 0x12, 0x9A, 0x13, 0xBF, 0x01, 0x03, 0x12, 0x9F, 0x13, 0xD2, 0xAF, 0x51, 0xBA, 0x12, 0x46, -+0x4D, 0x80, 0xBE, 0x90, 0xA1, 0x08, 0xE0, 0x90, 0xA1, 0x12, 0x30, 0xE0, 0x04, 0xE0, 0xFF, 0xA1, -+0xCF, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x07, 0x90, 0xA1, 0x12, 0xE0, 0xFF, 0xE4, 0xFD, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x68, 0xED, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0xFE, 0xC4, -+0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x81, 0xAB, 0xEE, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, -+0x30, 0xE0, 0x02, 0x81, 0xAB, 0x90, 0xA1, 0x13, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x81, 0xAB, 0xEF, -+0x70, 0x02, 0x81, 0x20, 0x24, 0xFE, 0x70, 0x02, 0x81, 0x5A, 0x24, 0xFE, 0x60, 0x4A, 0x24, 0xFC, -+0x70, 0x02, 0x81, 0x95, 0x24, 0xFC, 0x60, 0x02, 0x81, 0xAB, 0xEE, 0xB4, 0x0E, 0x02, 0xB1, 0x42, -+0x90, 0xA1, 0x13, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, 0x77, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x06, -+0x02, 0xB1, 0x0F, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x04, 0x0F, 0x90, 0xA3, 0x68, 0xE0, 0xFF, 0x60, -+0x05, 0x12, 0xBA, 0x90, 0x80, 0x03, 0x12, 0x8D, 0x75, 0x90, 0xA1, 0x13, 0xE0, 0x64, 0x08, 0x60, -+0x02, 0x81, 0xAB, 0x12, 0xBC, 0x23, 0x81, 0xAB, 0x90, 0xA1, 0x13, 0xE0, 0x70, 0x04, 0x7F, 0x01, -+0xB1, 0x77, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x06, 0x02, 0xB1, 0x0F, 0x90, 0xA1, 0x13, 0xE0, 0xB4, -+0x0E, 0x07, 0x91, 0xB0, 0xBF, 0x01, 0x02, 0xB1, 0x42, 0x90, 0xA1, 0x13, 0xE0, 0x64, 0x0C, 0x60, -+0x02, 0x81, 0xAB, 0x91, 0xB0, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x81, 0xAB, 0xB1, 0x95, 0x81, 0xAB, -+0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x0E, 0x07, 0x91, 0xB0, 0xBF, 0x01, 0x02, 0xB1, 0x42, 0x90, 0xA1, -+0x13, 0xE0, 0xB4, 0x06, 0x02, 0xB1, 0x0F, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x0C, 0x07, 0x91, 0xB0, -+0xBF, 0x01, 0x02, 0xB1, 0x95, 0x90, 0xA1, 0x13, 0xE0, 0x64, 0x04, 0x70, 0x5E, 0x12, 0xB9, 0xC1, -+0xEF, 0x64, 0x01, 0x70, 0x56, 0x12, 0x8B, 0xA6, 0x80, 0x51, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x0E, -+0x07, 0x91, 0xB0, 0xBF, 0x01, 0x02, 0xB1, 0x42, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x06, 0x02, 0xB1, -+0x0F, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x0C, 0x07, 0x91, 0xB0, 0xBF, 0x01, 0x02, 0xB1, 0x95, 0x90, -+0xA1, 0x13, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, 0x77, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x04, 0x1B, -+0x12, 0xBA, 0xD6, 0x80, 0x16, 0x90, 0xA1, 0x13, 0xE0, 0xB4, 0x0C, 0x0F, 0x90, 0xA1, 0x0E, 0xE0, -+0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x8B, 0x8A, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0xA1, 0x28, 0xE0, 0x30, 0xE0, 0x13, 0x90, 0xA1, 0x2E, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, -+0xE0, 0x17, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x3C, 0xF1, 0xF8, 0xEF, 0x64, 0x01, 0x60, -+0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2D, 0x90, 0xA1, 0x0D, 0xE0, 0x13, 0x13, 0x13, -+0x54, 0x1F, 0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x19, 0x90, 0xA1, 0x12, -+0xE0, 0xD3, 0x94, 0x04, 0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, 0x90, 0x01, -+0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, 0x22, 0x90, -+0xA1, 0x0E, 0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA1, 0x13, -+0x74, 0x04, 0xF0, 0x80, 0x17, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA1, 0x13, 0x74, 0x0C, 0xF0, 0x90, -+0x05, 0x27, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA1, 0x0C, 0x74, 0x0C, 0xF0, 0x90, 0x05, 0x22, 0xE4, -+0xF0, 0x22, 0x90, 0xA1, 0x0E, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0x90, 0xA1, 0x13, 0x74, 0x0C, -+0xF0, 0x80, 0x1E, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA1, -+0x13, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA1, 0x0C, 0x74, 0x04, -+0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0xA3, 0x67, 0xEF, 0xF0, 0x12, 0x86, 0xBC, 0x90, -+0xA3, 0x67, 0xE0, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x13, 0x74, 0x04, 0xF0, -+0x90, 0xA1, 0x0C, 0xF0, 0x22, 0x90, 0xA0, 0x87, 0xE0, 0x64, 0x01, 0x70, 0x31, 0x90, 0xA1, 0x0E, -+0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x7F, 0x01, 0xD1, 0x26, 0xBF, 0x01, -+0x12, 0x90, 0xA1, 0x0D, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA1, 0x13, 0x74, 0x0E, 0xF0, 0x90, 0xA1, -+0x0C, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x22, 0xAE, -+0x07, 0xF1, 0xEC, 0xBF, 0x01, 0x15, 0x90, 0xA1, 0x08, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, -+0xE0, 0x09, 0xAF, 0x06, 0x7D, 0x01, 0x71, 0x5E, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0xA1, -+0x28, 0xE0, 0x20, 0xE0, 0x27, 0x90, 0xA1, 0x10, 0xE0, 0x64, 0x01, 0x70, 0x1F, 0x12, 0x82, 0x1C, -+0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0x60, 0x08, 0xE4, 0xFD, 0x7F, 0x0C, 0x71, 0x5E, 0xE1, 0x9A, -+0x90, 0xA1, 0x13, 0xE0, 0x70, 0x06, 0x7D, 0x01, 0x7F, 0x04, 0x71, 0x5E, 0x22, 0x90, 0xA1, 0x2F, -+0xE0, 0x44, 0x02, 0xF0, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x63, 0x90, -+0x04, 0x1D, 0xE0, 0x60, 0x1F, 0x90, 0x05, 0x22, 0xE0, 0xF5, 0x66, 0x74, 0xFF, 0xF0, 0x12, 0x77, -+0x9E, 0xBF, 0x01, 0x08, 0xAF, 0x63, 0x12, 0xBC, 0x36, 0x12, 0x7E, 0xE5, 0x90, 0x05, 0x22, 0xE5, -+0x66, 0xF0, 0x80, 0x03, 0x12, 0x7E, 0xE5, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xF1, 0x9A, 0x90, 0xA1, 0x13, 0xE0, 0x64, 0x0C, 0x60, 0x0A, 0xE4, 0xFD, -+0x7F, 0x0C, 0x71, 0x5E, 0xE4, 0xFF, 0xD1, 0x26, 0x22, 0x90, 0xA1, 0x0D, 0xE0, 0xFF, 0xC4, 0x13, -+0x13, 0x54, 0x03, 0x30, 0xE0, 0x3A, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0xA1, -+0x0E, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, -+0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x90, 0xA1, 0x2E, 0xE0, 0xFF, 0xC4, -+0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x7D, 0x01, 0x7F, 0x0C, 0x71, 0x5E, 0x80, 0x02, 0x71, 0x43, -+0xE4, 0xFF, 0x90, 0xA1, 0x72, 0xE0, 0x30, 0xE0, 0x48, 0x90, 0xA1, 0x76, 0xE0, 0xFD, 0x60, 0x41, -+0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -+0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x06, 0xE4, 0x90, 0xA1, 0x76, 0xF0, 0x22, -+0x90, 0xA1, 0x74, 0xE0, 0xD3, 0x9D, 0x50, 0x11, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0x12, 0xB8, -+0xB9, 0x90, 0xA1, 0x72, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xF1, 0x7D, 0x90, 0xA1, 0x76, 0xE0, 0x04, -+0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x58, 0xED, 0xF0, 0x90, 0xA3, -+0x57, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0xF1, 0xDC, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0xA3, 0x57, 0xE0, -+0x90, 0x04, 0x25, 0xF0, 0x90, 0xA3, 0x58, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFF, 0xC1, -+0x26, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x12, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x02, 0x80, 0x0A, -+0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xF7, 0xF0, 0x71, 0x43, 0x22, 0x90, 0xA1, 0x0D, 0xE0, 0x13, 0x13, -+0x13, 0x54, 0x1F, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, -+0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x23, 0xE0, 0xC3, 0x13, -+0x54, 0x7F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, -+0x5B, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0xFD, 0x10, 0xEF, -+0xF0, 0x7F, 0x00, 0x22, 0xF1, 0xF8, 0xEF, 0x70, 0x02, 0xB1, 0xEE, 0x22, 0x90, 0x05, 0x43, 0xE0, -+0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, -+0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, -+0x22, 0x7F, 0xF4, 0x12, 0x4B, 0x24, 0xEF, 0x20, 0xE5, 0x0E, 0x7F, 0xF4, 0x12, 0x4B, 0x24, 0xEF, -+0x7F, 0x01, 0x20, 0xE4, 0x05, 0x7F, 0x02, 0x22, 0x7F, 0x03, 0x22, 0x11, 0x11, 0x90, 0x9F, 0x95, -+0xEF, 0xF0, 0x11, 0x44, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, -+0xF0, 0x02, 0x36, 0x83, 0x11, 0xB2, 0x11, 0xE2, 0x11, 0x71, 0x11, 0x90, 0xE4, 0xF5, 0x0D, 0xF5, -+0x0E, 0xF5, 0x0F, 0xF5, 0x10, 0xAD, 0x0D, 0x7F, 0x50, 0x12, 0x4A, 0x07, 0xAD, 0x0E, 0x7F, 0x51, -+0x12, 0x4A, 0x07, 0xAD, 0x0F, 0x7F, 0x52, 0x12, 0x4A, 0x07, 0xAD, 0x10, 0x7F, 0x53, 0x02, 0x4A, -+0x07, 0x75, 0x15, 0x12, 0xE4, 0xF5, 0x16, 0x75, 0x17, 0x07, 0x75, 0x18, 0x72, 0x90, 0x01, 0x30, -+0xE5, 0x15, 0xF0, 0xA3, 0xE5, 0x16, 0xF0, 0xA3, 0xE5, 0x17, 0xF0, 0xA3, 0xE5, 0x18, 0xF0, 0x22, -+0x75, 0x1D, 0x06, 0x75, 0x1E, 0x01, 0x75, 0x1F, 0x03, 0x75, 0x20, 0x62, 0x43, 0x20, 0x80, 0x90, -+0x01, 0x38, 0xE5, 0x1D, 0xF0, 0xA3, 0xE5, 0x1E, 0xF0, 0xA3, 0xE5, 0x1F, 0xF0, 0xA3, 0xE5, 0x20, -+0xF0, 0x22, 0x90, 0x01, 0x30, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x38, -+0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x4A, 0x07, 0xE4, 0xFD, 0x7F, -+0x51, 0x12, 0x4A, 0x07, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x4A, 0x07, 0xE4, 0xFD, 0x7F, 0x53, 0x02, -+0x4A, 0x07, 0x90, 0x01, 0x34, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, -+0x3C, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, 0x4A, 0x07, 0x7D, 0xFF, -+0x7F, 0x55, 0x12, 0x4A, 0x07, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x4A, 0x07, 0x7D, 0xFF, 0x7F, 0x57, -+0x02, 0x4A, 0x07, 0x75, 0xE8, 0x07, 0x75, 0xA8, 0x85, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, -+0x12, 0x48, 0x4E, 0x90, 0xA2, 0x41, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x9F, 0x92, 0xE0, 0x60, 0xEA, -+0xC2, 0xAF, 0x30, 0xE0, 0x11, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x9B, 0x7B, 0x12, 0xAA, 0x83, -+0x90, 0xA1, 0x8E, 0xE0, 0x04, 0xF0, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x9F, 0x92, 0xE0, 0xFF, 0x30, -+0xE1, 0x0B, 0x54, 0xFD, 0xF0, 0x90, 0xA1, 0x90, 0xE0, 0x04, 0xF0, 0x31, 0xAE, 0xD2, 0xAF, 0xC2, -+0xAF, 0x90, 0x9F, 0x92, 0xE0, 0xFF, 0x30, 0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, 0x98, 0xFC, 0xD2, -+0xAF, 0xC2, 0xAF, 0x90, 0x9F, 0x92, 0xE0, 0xFF, 0x30, 0xE6, 0x05, 0x54, 0xBF, 0xF0, 0x31, 0x84, -+0xD2, 0xAF, 0x80, 0xA6, 0xE4, 0x7B, 0x01, 0x7A, 0xA1, 0x79, 0x6B, 0x51, 0x45, 0xEF, 0xB4, 0x02, -+0x1C, 0x90, 0xA3, 0x51, 0xE0, 0x64, 0x04, 0x60, 0x09, 0x7F, 0x40, 0x51, 0x0F, 0x90, 0xA3, 0x51, -+0x80, 0x08, 0xE4, 0x90, 0xA3, 0x51, 0xF0, 0x90, 0xA1, 0x9B, 0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9F, 0xEC, 0xE0, 0xFF, 0x90, 0x9F, 0xEB, 0xE0, 0xB5, 0x07, -+0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x40, 0x90, 0x9F, 0xEB, 0xE0, 0xFE, 0x75, -+0xF0, 0x08, 0x90, 0x9F, 0x9B, 0x12, 0x49, 0x1D, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, -+0x9C, 0xF9, 0x74, 0x9F, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x71, 0x20, 0x90, 0x9F, 0xEB, -+0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, -+0x9F, 0xEB, 0xF0, 0x12, 0x90, 0xE2, 0x7F, 0x02, 0x51, 0x0F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0xA3, 0x64, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x48, 0x27, 0x90, 0x9F, 0x92, 0xE0, 0xFF, 0x90, 0xA3, -+0x64, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x9F, 0x92, 0xF0, 0x22, 0x90, 0xA1, 0x4C, 0xE0, 0x44, 0x04, -+0xF0, 0x7D, 0x01, 0x7F, 0x23, 0x51, 0x49, 0xEF, 0xB4, 0x03, 0x09, 0xE4, 0xFF, 0x12, 0x63, 0x56, -+0x7F, 0x04, 0x51, 0x0F, 0x22, 0x7D, 0x03, 0x7F, 0x11, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x90, 0xA3, 0x29, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x49, 0x32, 0x7F, 0xA3, 0x12, 0x4B, -+0x24, 0xEF, 0x54, 0xF8, 0x44, 0x05, 0xFD, 0x7F, 0xA3, 0x12, 0x4A, 0x07, 0x7F, 0xA0, 0x12, 0x4B, -+0x24, 0xEF, 0x54, 0x0F, 0x64, 0x04, 0x70, 0x24, 0x90, 0xFD, 0x58, 0xE0, 0x20, 0xE0, 0x13, 0x90, -+0xA3, 0x29, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0x12, 0x49, 0x29, 0x12, 0x8F, 0xAC, 0x7F, 0x01, -+0x80, 0x12, 0x90, 0xA1, 0x99, 0xE0, 0x04, 0xF0, 0x7F, 0x02, 0x80, 0x08, 0x90, 0xA1, 0x98, 0xE0, -+0x04, 0xF0, 0x7F, 0x03, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0x12, 0x06, 0x89, 0x90, 0xA2, 0x45, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x46, -+0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x47, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, -+0xA2, 0x90, 0xA2, 0x48, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x49, 0xF0, 0xE4, -+0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0x4C, 0xE0, 0x44, 0x40, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, -+0x45, 0x7D, 0x07, 0x7F, 0x30, 0x51, 0x49, 0xEF, 0xB4, 0x01, 0x08, 0x90, 0xA2, 0x4C, 0x74, 0x01, -+0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x4C, 0xF0, 0x90, 0xA2, 0x4C, 0xE0, 0xFD, 0x90, 0xA2, 0x45, -+0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x81, 0x12, 0x7F, 0x04, 0x51, 0x0F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0xA2, 0x42, 0x12, 0x49, 0x32, 0xEF, 0x12, 0x49, 0x3B, 0x5B, 0x76, 0x00, 0x5B, 0x7F, 0x01, -+0x5B, 0x88, 0x02, 0x5B, 0x91, 0x03, 0x5B, 0x9A, 0x04, 0x5B, 0xA2, 0x20, 0x5B, 0xAB, 0x21, 0x5B, -+0xB4, 0x23, 0x5B, 0xBD, 0x24, 0x5B, 0xC6, 0x25, 0x5B, 0xCF, 0x40, 0x5B, 0xDE, 0x42, 0x5B, 0xE7, -+0x43, 0x5B, 0xEF, 0x60, 0x5B, 0xF8, 0x61, 0x5C, 0x00, 0x62, 0x5C, 0x08, 0x63, 0x5C, 0x10, 0x64, -+0x5C, 0x19, 0x65, 0x5C, 0x22, 0x66, 0x5C, 0x2A, 0x67, 0x5C, 0x32, 0x68, 0x5C, 0x3A, 0x69, 0x5C, -+0x42, 0x6A, 0x00, 0x00, 0x5C, 0x4A, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x8C, 0x6A, 0x90, -+0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x8C, 0xB2, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x85, -+0x0E, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0xB8, 0xC9, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, -+0xE1, 0x15, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x8D, 0x88, 0x90, 0xA2, 0x42, 0x12, 0x49, -+0x29, 0x02, 0x8F, 0x17, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x8F, 0x5D, 0x90, 0xA2, 0x42, -+0x12, 0x49, 0x29, 0x02, 0x65, 0x6A, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x8F, 0x65, 0x90, -+0xA1, 0x91, 0xE0, 0x04, 0xF0, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0xB4, 0xA2, 0x90, 0xA2, -+0x42, 0x12, 0x49, 0x29, 0x02, 0xB6, 0x2C, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0xA1, 0xBB, 0x90, -+0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x78, 0xEE, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x41, 0x2A, -+0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0xC1, 0xB2, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0xC1, 0xB8, -+0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, 0x90, 0x71, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x02, -+0x90, 0xD2, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x80, 0x28, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, -+0x41, 0xA9, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0xC1, 0xD0, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, -+0x81, 0xD5, 0x90, 0xA2, 0x42, 0x12, 0x49, 0x29, 0x80, 0x47, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, -+0xF0, 0x22, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x12, 0x06, -+0x89, 0x90, 0xA1, 0x6B, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0xA1, 0x6C, 0xF0, 0x90, -+0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0xA1, 0x6D, 0xF0, 0x90, 0xA1, 0x4C, 0xE0, 0x44, 0x01, 0xF0, -+0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x51, 0x45, 0xEF, 0xB4, 0x02, 0x04, 0x7F, 0x40, 0x51, 0x0F, -+0x22, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x7D, 0x06, 0x7F, 0x0A, 0x51, 0x49, 0xEF, 0x64, 0x01, -+0x60, 0x0A, 0x7F, 0x88, 0x12, 0x4B, 0x24, 0xEF, 0x44, 0x40, 0x80, 0x23, 0x90, 0xA2, 0x45, 0x12, -+0x49, 0x29, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFE, 0x12, 0x06, 0x89, 0x7C, 0x00, 0x24, 0x00, -+0xFF, 0xEC, 0x3E, 0xFE, 0x12, 0x80, 0x7A, 0x7F, 0x88, 0x12, 0x4B, 0x24, 0xEF, 0x44, 0x80, 0xFD, -+0x7F, 0x88, 0x02, 0x4A, 0x07, 0x12, 0x06, 0x89, 0xFF, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, -+0xA2, 0x47, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x48, 0xF0, 0x90, 0x00, 0x03, -+0x12, 0x06, 0xA2, 0x90, 0xA2, 0x49, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x4A, -+0xF0, 0x90, 0x00, 0x05, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x4B, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x06, -+0xA2, 0x90, 0xA2, 0x4C, 0xF0, 0xEF, 0x12, 0x49, 0x3B, 0x5D, 0x32, 0x00, 0x5D, 0x3E, 0x01, 0x5D, -+0x4A, 0x02, 0x5D, 0x56, 0x03, 0x5D, 0x62, 0x04, 0x5D, 0x6E, 0x05, 0x5D, 0x76, 0x06, 0x00, 0x00, -+0x5D, 0x9F, 0x90, 0xA2, 0x45, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x29, 0xF0, 0x80, 0x6B, 0x90, 0xA2, -+0x45, 0x74, 0x06, 0xF0, 0xA3, 0x74, 0x2A, 0xF0, 0x80, 0x5F, 0x90, 0xA2, 0x45, 0x74, 0x01, 0xF0, -+0xA3, 0x74, 0x31, 0xF0, 0x80, 0x53, 0x90, 0xA2, 0x45, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x32, 0xF0, -+0x80, 0x47, 0x90, 0xA2, 0x45, 0x74, 0x06, 0xF0, 0xA3, 0x74, 0x33, 0xF0, 0x80, 0x3B, 0x7B, 0x01, -+0x7A, 0xA2, 0x79, 0x47, 0xE1, 0xAC, 0x90, 0xA2, 0x47, 0xE0, 0x90, 0xA1, 0x66, 0xF0, 0x90, 0xA2, -+0x48, 0xE0, 0x90, 0xA1, 0x67, 0xF0, 0x90, 0xA2, 0x49, 0xE0, 0x90, 0xA1, 0x68, 0xF0, 0x90, 0xA2, -+0x4A, 0xE0, 0x90, 0xA1, 0x69, 0xF0, 0x90, 0xA2, 0x4B, 0xE0, 0x90, 0xA1, 0x6A, 0xF0, 0x22, 0x90, -+0xA2, 0x45, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0xA2, 0x46, 0xE0, 0xFF, 0x90, 0xA2, -+0x45, 0xE0, 0xFD, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x47, 0x41, 0x49, 0x12, 0x06, 0x89, 0xFD, 0x90, -+0x00, 0x01, 0x12, 0x06, 0xA2, 0xFC, 0xED, 0xC3, 0x94, 0x80, 0x90, 0xA2, 0x47, 0xED, 0x50, 0x3F, -+0xF0, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, -+0x90, 0xA2, 0x48, 0xF0, 0xEE, 0xA3, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, -+0x9B, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA2, 0x4A, 0xF0, 0xEE, 0xA3, 0xF0, 0x75, 0xF0, -+0x10, 0xED, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0x4C, 0xF0, 0x80, 0x01, 0xF0, -+0xEC, 0xC3, 0x94, 0x80, 0x90, 0xA2, 0x4D, 0xEC, 0x50, 0x3F, 0xF0, 0x25, 0xE0, 0x24, 0x92, 0xF5, -+0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0x90, 0xA2, 0x4E, 0xF0, 0xEE, 0xA3, -+0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, -+0xE0, 0x90, 0xA2, 0x50, 0xF0, 0xEE, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x00, 0x12, -+0x49, 0x1D, 0xE0, 0x90, 0xA2, 0x52, 0xF0, 0x80, 0x01, 0xF0, 0x90, 0xA2, 0x45, 0x74, 0x04, 0xF0, -+0x90, 0xA2, 0x53, 0x74, 0x0C, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9C, -+0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9C, -+0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, -+0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEC, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, -+0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x45, 0xF1, 0x42, 0x7F, 0x04, -+0x41, 0x0F, 0x7D, 0x01, 0x7F, 0x17, 0x41, 0x49, 0xE4, 0x90, 0xA2, 0x45, 0xF0, 0x90, 0xA1, 0x4C, -+0xE0, 0x44, 0x10, 0xF0, 0x7D, 0x01, 0x7F, 0x1B, 0x51, 0x49, 0x90, 0xA2, 0x45, 0xEF, 0xF0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA1, 0x4D, 0xE0, 0x44, 0x01, 0xF0, 0x7D, 0x01, -+0x7F, 0x28, 0x51, 0x49, 0x90, 0xA2, 0x45, 0xEF, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, -+0x1F, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, 0xA2, 0x60, 0xF0, 0x90, -+0xA2, 0x5E, 0x74, 0x02, 0xF0, 0x90, 0xA2, 0x6C, 0x14, 0xF0, 0xFB, 0x7A, 0xA2, 0x79, 0x5E, 0xF1, -+0x42, 0x7F, 0x04, 0x41, 0x0F, 0x12, 0x92, 0xD0, 0x12, 0x06, 0x89, 0xFF, 0x54, 0x01, 0xFE, 0x90, -+0xA1, 0x72, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x14, 0x90, 0x00, 0x01, -+0x12, 0x06, 0xA2, 0x90, 0xA1, 0x73, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0xA1, 0x74, -+0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA0, 0x83, 0xE0, 0xFF, 0x70, 0x06, -+0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0xA0, 0x84, 0xE0, 0xB5, 0x07, 0x04, -+0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, -+0x80, 0x35, 0xC0, 0x01, 0x90, 0xA0, 0x84, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xED, 0xF9, 0x74, -+0x9F, 0x35, 0xF0, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x06, -+0x63, 0x90, 0xA0, 0x84, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, -+0x60, 0x05, 0xE4, 0x90, 0xA0, 0x84, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0x4D, 0x74, -+0x0A, 0xF0, 0x90, 0xA2, 0x5B, 0x74, 0x06, 0xF0, 0x12, 0x06, 0x89, 0x90, 0xA2, 0x4F, 0xF0, 0x90, -+0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x50, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, -+0xA2, 0x51, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x52, 0xF0, 0x90, 0x00, 0x04, -+0x12, 0x06, 0xA2, 0x90, 0xA2, 0x53, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x54, -+0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x4D, 0xE1, 0x42, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, -+0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xF9, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, -+0x5F, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, -+0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, -+0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x2A, 0xF0, 0x74, 0x60, 0xA3, -+0xF0, 0x12, 0x4B, 0x46, 0x74, 0x2A, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0xD0, -+0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, -+0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, -+0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, -+0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x7A, 0xF0, 0x74, 0x60, 0xA3, -+0xF0, 0x12, 0x9A, 0x4E, 0xE5, 0x19, 0x30, 0xE1, 0x02, 0x31, 0x35, 0xE5, 0x19, 0x30, 0xE4, 0x02, -+0x71, 0xDF, 0xE5, 0x19, 0x30, 0xE6, 0x03, 0x12, 0x9A, 0xAB, 0xE5, 0x1B, 0x30, 0xE0, 0x03, 0x12, -+0x84, 0x17, 0xE5, 0x1B, 0x30, 0xE1, 0x02, 0x71, 0xE6, 0xE5, 0x1B, 0x30, 0xE2, 0x02, 0x91, 0x79, -+0xE5, 0x1B, 0x30, 0xE3, 0x03, 0x12, 0x9A, 0xB8, 0xE5, 0x1B, 0x30, 0xE4, 0x03, 0x12, 0x9A, 0xEB, -+0xE5, 0x1B, 0x30, 0xE5, 0x03, 0x12, 0x7F, 0x83, 0xE5, 0x1B, 0x30, 0xE6, 0x03, 0x12, 0x9B, 0x1A, -+0xE5, 0x1C, 0x30, 0xE1, 0x03, 0x12, 0x9B, 0x36, 0xE5, 0x1C, 0x30, 0xE4, 0x03, 0x12, 0x9B, 0x73, -+0xE5, 0x1C, 0x30, 0xE5, 0x02, 0xF1, 0x78, 0xE5, 0x1C, 0x30, 0xE6, 0x03, 0x12, 0x9D, 0x54, 0x74, -+0x7A, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x60, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, -+0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, -+0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, 0xFF, 0x90, 0xA2, 0x5E, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, -+0xF5, 0x60, 0xA3, 0xE0, 0xF5, 0x61, 0x65, 0x60, 0x60, 0x6F, 0x90, 0xA2, 0x5F, 0x74, 0x03, 0xF0, -+0x90, 0xA2, 0x6D, 0x74, 0x08, 0xF0, 0xE5, 0x61, 0x04, 0x54, 0x0F, 0xF5, 0x62, 0xE4, 0xF5, 0x5F, -+0xE5, 0x62, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, -+0x82, 0x25, 0x5F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x61, 0x25, 0x5F, -+0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x5F, 0xE5, 0x5F, 0xB4, 0x08, 0xD0, -+0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x5F, 0x12, 0x5F, 0x42, 0xE5, 0x61, 0x04, 0x54, 0x0F, 0xF5, 0x61, -+0xB4, 0x0F, 0x03, 0xE4, 0xF5, 0x61, 0x90, 0x04, 0x7F, 0xE5, 0x61, 0xF0, 0x90, 0xA2, 0x5E, 0xE0, -+0x7F, 0x04, 0x70, 0x02, 0x80, 0x08, 0x12, 0x5A, 0x0F, 0x22, 0x71, 0x56, 0x7F, 0x04, 0x8F, 0x6C, -+0x7F, 0x02, 0x12, 0x48, 0x27, 0x90, 0x9F, 0x92, 0xE0, 0x45, 0x6C, 0xF0, 0x22, 0x90, 0xFD, 0x68, -+0xE0, 0xFF, 0x90, 0xFD, 0x60, 0xE0, 0x90, 0xA2, 0x7E, 0xF0, 0xEF, 0x20, 0xE0, 0x02, 0x61, 0x55, -+0x90, 0xA3, 0x52, 0xE0, 0x70, 0x1A, 0x7F, 0x2E, 0x12, 0x4B, 0x24, 0x90, 0xA1, 0x61, 0xEF, 0xF0, -+0x7F, 0x2D, 0x12, 0x4B, 0x24, 0x90, 0xA1, 0x62, 0xEF, 0xF0, 0x90, 0xA3, 0x52, 0x74, 0x01, 0xF0, -+0x90, 0xA2, 0x7E, 0xE0, 0x64, 0x15, 0x70, 0x6E, 0x90, 0xFD, 0x62, 0xE0, 0xFF, 0x30, 0xE6, 0x1C, -+0xF4, 0x54, 0x3F, 0x04, 0xFE, 0x90, 0xA1, 0x61, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0xC3, 0x9E, 0x90, -+0xA2, 0x7D, 0xF0, 0xD3, 0x94, 0x3F, 0x40, 0x1D, 0xE4, 0xF0, 0x80, 0x19, 0x90, 0xA1, 0x61, 0xE0, -+0x13, 0x13, 0x54, 0x3F, 0xFE, 0xEF, 0x54, 0x3F, 0x2E, 0x90, 0xA2, 0x7D, 0xF0, 0xD3, 0x94, 0x3F, -+0x40, 0x03, 0x74, 0x3F, 0xF0, 0x90, 0xA2, 0x7D, 0xE0, 0xFF, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0xFE, -+0xEF, 0x25, 0xE0, 0x25, 0xE0, 0x4E, 0x90, 0xA2, 0x7C, 0xF0, 0xE0, 0xFD, 0x7F, 0x2E, 0x12, 0x4A, -+0x07, 0x90, 0xA2, 0x7D, 0xE0, 0xC4, 0x54, 0xF0, 0xFF, 0x90, 0xA1, 0x62, 0xE0, 0x54, 0x0F, 0x4F, -+0xFD, 0x7F, 0x2D, 0x12, 0x4A, 0x07, 0x90, 0xA2, 0x7E, 0xE0, 0xB4, 0x21, 0x0C, 0x90, 0xFD, 0x62, -+0xE0, 0xFF, 0x12, 0x80, 0xF8, 0x7F, 0x04, 0x31, 0xBE, 0x90, 0xA2, 0x7E, 0xE0, 0xB4, 0x23, 0x04, -+0x7F, 0x01, 0x31, 0xBA, 0x90, 0xA2, 0x7E, 0xE0, 0xB4, 0x27, 0x07, 0x12, 0x8B, 0xC1, 0x7F, 0x02, -+0x31, 0xBA, 0x90, 0xA2, 0x7E, 0xE0, 0xB4, 0x30, 0x0C, 0xE4, 0xFB, 0xFD, 0x7F, 0x01, 0x12, 0x81, -+0x12, 0x7F, 0x04, 0x31, 0xBE, 0x90, 0xA2, 0x7E, 0xE0, 0x64, 0x34, 0x70, 0x2E, 0x90, 0xFD, 0x62, -+0xE0, 0x30, 0xE0, 0x24, 0x90, 0xA2, 0x7C, 0x74, 0x01, 0xF0, 0xFB, 0x7A, 0xA2, 0x79, 0x7C, 0xFD, -+0x7F, 0x34, 0x12, 0x5A, 0x49, 0x90, 0xA2, 0x7C, 0x74, 0x03, 0xF0, 0xE0, 0xFF, 0x12, 0x8A, 0x23, -+0x90, 0xA1, 0xA8, 0xE0, 0x04, 0xF0, 0x80, 0x03, 0x12, 0x8B, 0xE5, 0x90, 0xA2, 0x7E, 0xE0, 0xB4, -+0x40, 0x14, 0x90, 0xFD, 0x62, 0xE0, 0x30, 0xE0, 0x08, 0x90, 0xA1, 0x4A, 0x74, 0x01, 0xF0, 0x80, -+0x05, 0xE4, 0x90, 0xA1, 0x4A, 0xF0, 0x90, 0xFD, 0x68, 0xE0, 0x90, 0xA1, 0x9F, 0xF0, 0x90, 0xFD, -+0x60, 0xE0, 0x90, 0xA1, 0xA0, 0xF0, 0x90, 0xFD, 0x61, 0xE0, 0x90, 0xA1, 0xA1, 0xF0, 0x90, 0xFD, -+0x62, 0xE0, 0x90, 0xA1, 0xA2, 0xF0, 0x90, 0xFD, 0x63, 0xE0, 0x90, 0xA1, 0xA3, 0xF0, 0x90, 0xFD, -+0x64, 0xE0, 0x90, 0xA1, 0xA4, 0xF0, 0x90, 0xFD, 0x65, 0xE0, 0x90, 0xA1, 0xA5, 0xF0, 0x90, 0xFD, -+0x66, 0xE0, 0x90, 0xA1, 0xA6, 0xF0, 0x90, 0xFD, 0x67, 0xE0, 0x90, 0xA1, 0xA7, 0xF0, 0x90, 0xFD, -+0x68, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0xA2, 0xC6, 0x74, 0x09, 0xF0, 0x90, 0xA2, 0xD4, 0x74, -+0x07, 0xF0, 0x90, 0xA2, 0xC8, 0xEF, 0xF0, 0x70, 0x31, 0x90, 0xA1, 0x40, 0xE0, 0x60, 0x1A, 0xA3, -+0xE0, 0x60, 0x02, 0x80, 0x0C, 0x90, 0x07, 0x70, 0xE0, 0x70, 0x06, 0x90, 0x07, 0x74, 0xE0, 0x60, -+0x08, 0x90, 0xA2, 0xC9, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0xC9, 0xF0, 0xE4, 0x90, -+0xA2, 0xCA, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0x80, 0x39, 0x90, 0xFD, 0x62, 0xE0, 0x90, 0xA2, -+0xC9, 0xF0, 0x90, 0xFD, 0x63, 0xE0, 0x90, 0xA2, 0xCA, 0xF0, 0x90, 0xFD, 0x64, 0xE0, 0x90, 0xA2, -+0xCB, 0xF0, 0x90, 0xFD, 0x65, 0xE0, 0x90, 0xA2, 0xCC, 0xF0, 0x90, 0xFD, 0x66, 0xE0, 0x90, 0xA2, -+0xCD, 0xF0, 0x90, 0xFD, 0x67, 0xE0, 0x90, 0xA2, 0xCE, 0xF0, 0x90, 0xA2, 0xC9, 0xE0, 0x54, 0x01, -+0x90, 0xA1, 0x40, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xC6, 0x02, 0x5F, 0x42, 0x12, -+0x90, 0xE2, 0x7F, 0x02, 0x21, 0xBE, 0x90, 0xA1, 0x42, 0xE0, 0x30, 0xE0, 0x05, 0x12, 0x8C, 0x33, -+0x80, 0x03, 0x12, 0x89, 0x89, 0x90, 0xA1, 0x08, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0xA1, 0x0A, 0x74, -+0x01, 0xF0, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x45, 0x90, 0xA1, 0x0E, 0xE0, 0xFF, 0x13, 0x13, 0x13, -+0x54, 0x1F, 0x30, 0xE0, 0x12, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0B, 0x91, 0x57, 0x90, 0xA1, -+0x16, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0xA3, 0x55, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, -+0xD6, 0xC3, 0x90, 0xA3, 0x56, 0xE0, 0x94, 0x80, 0x90, 0xA3, 0x55, 0xE0, 0x64, 0x80, 0x94, 0x80, -+0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x12, 0xB8, 0xE9, -+0x12, 0x82, 0xDB, 0x7F, 0x01, 0x21, 0xBE, 0x7D, 0x02, 0x7F, 0x02, 0x91, 0x61, 0x7D, 0x01, 0x7F, -+0x02, 0x74, 0x15, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0xA1, 0x77, 0xE0, 0x04, 0xF0, 0x90, -+0xA1, 0x08, 0xE0, 0xFF, 0x30, 0xE0, 0x08, 0x90, 0xA1, 0x0C, 0xE0, 0x64, 0x02, 0x60, 0x3C, 0x90, -+0xA1, 0x10, 0xE0, 0x70, 0x04, 0xEF, 0x30, 0xE0, 0x0B, 0x90, 0xA1, 0x13, 0xE0, 0x64, 0x02, 0x60, -+0x2A, 0x12, 0x7C, 0x4B, 0x90, 0xA1, 0x0E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x15, -+0x90, 0xA1, 0x16, 0xE0, 0xFF, 0xA3, 0xE0, 0x6F, 0x70, 0x0B, 0x12, 0x7C, 0x27, 0x91, 0x57, 0x90, -+0xA1, 0x17, 0xE0, 0x14, 0xF0, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0xEF, 0x70, 0x34, 0x7D, -+0x78, 0x7F, 0x02, 0x91, 0x61, 0x7D, 0x02, 0x7F, 0x03, 0x91, 0x61, 0x7D, 0xC8, 0x7F, 0x02, 0x12, -+0xB7, 0xFF, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x7D, 0x01, 0x7F, -+0x0C, 0x12, 0x53, 0x5E, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, -+0xF8, 0xF0, 0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, -+0xB1, 0x55, 0x7D, 0x02, 0x7F, 0x03, 0xB1, 0x55, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0xF0, 0x90, -+0xA1, 0x1B, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0xA0, 0x87, 0xE0, 0xB4, 0x01, 0x15, 0x90, -+0xA1, 0x0E, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA1, 0x13, 0xE0, 0x20, 0xE2, 0x0E, 0x7D, 0x01, 0x7F, -+0x04, 0x02, 0x53, 0x5E, 0x90, 0xA1, 0x0E, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x01, 0x34, 0x74, -+0x40, 0xF0, 0xFD, 0xE4, 0xFF, 0x74, 0x15, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x05, 0x27, 0xE0, 0x90, 0xA2, 0x45, 0xF0, 0x12, 0x06, 0x89, 0xFF, 0x54, 0x01, 0xFE, -+0x90, 0xA1, 0x08, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, -+0x4F, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x90, -+0xA1, 0x08, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0xFF, 0xF0, 0x12, 0x06, 0x89, -+0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x90, 0xA1, 0x08, 0xF0, 0xEE, 0x54, 0x20, -+0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFE, 0x54, 0x40, 0xFD, 0xEF, 0x54, -+0xBF, 0x4D, 0x90, 0xA1, 0x08, 0xF0, 0xEE, 0xC3, 0x13, 0x20, 0xE0, 0x02, 0xC1, 0x9D, 0xE0, 0xFF, -+0x20, 0xE0, 0x02, 0xC1, 0x83, 0x90, 0xA2, 0x45, 0x74, 0x21, 0xF0, 0xEF, 0x13, 0x13, 0x54, 0x3F, -+0x30, 0xE0, 0x0B, 0xB1, 0x4C, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x08, 0xF0, 0x80, 0x0C, 0xE4, 0x90, -+0xA1, 0x09, 0xF0, 0xA3, 0xF0, 0x7D, 0x40, 0xFF, 0x91, 0x61, 0x90, 0xA1, 0x08, 0xE0, 0xFD, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x12, 0xF0, 0xED, 0xC4, -+0x54, 0x0F, 0x30, 0xE0, 0x07, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x14, 0xF0, 0x90, 0xA1, 0x08, 0xE0, -+0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0xA1, -+0x08, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x07, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x40, -+0xF0, 0x90, 0xA2, 0x45, 0xE0, 0x90, 0x05, 0x27, 0xF0, 0x90, 0xA1, 0x0B, 0xE0, 0x70, 0x05, 0x7F, -+0x01, 0x12, 0x85, 0x5C, 0x90, 0xA1, 0x08, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, -+0x04, 0x7F, 0x04, 0x80, 0x23, 0x12, 0x57, 0xEC, 0xEF, 0x60, 0x04, 0x7F, 0x01, 0x80, 0x19, 0x7F, -+0x02, 0x80, 0x15, 0x90, 0xA2, 0x45, 0x74, 0x01, 0xF0, 0x90, 0x05, 0x27, 0xF0, 0x90, 0xA1, 0x0B, -+0xE0, 0x64, 0x04, 0x60, 0x02, 0xE1, 0x73, 0xFF, 0x12, 0x85, 0x5C, 0xE1, 0x73, 0x90, 0xA1, 0x08, -+0xE0, 0xFD, 0x20, 0xE0, 0x02, 0xE1, 0x3E, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x31, 0xF0, 0xED, 0x13, -+0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0B, 0xB1, 0x4C, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x08, 0xF0, 0x80, -+0x06, 0x7D, 0x40, 0xE4, 0xFF, 0x91, 0x61, 0x90, 0xA1, 0x08, 0xE0, 0xFD, 0x13, 0x13, 0x13, 0x54, -+0x1F, 0x30, 0xE0, 0x07, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x02, 0xF0, 0xED, 0xC4, 0x54, 0x0F, 0x30, -+0xE0, 0x07, 0x90, 0xA2, 0x45, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0xA2, 0x45, 0xE0, 0x90, 0x05, 0x27, -+0xF0, 0x90, 0xA1, 0x08, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x0E, 0x90, 0xA1, -+0x0C, 0xE0, 0x64, 0x02, 0x60, 0x6D, 0xE4, 0xFD, 0x7F, 0x02, 0x80, 0x23, 0x90, 0x05, 0x27, 0xE0, -+0x44, 0x40, 0xF0, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x02, 0x1A, 0x12, 0xBA, 0xF0, 0x12, 0x57, 0xEC, -+0xBF, 0x01, 0x09, 0x90, 0xA1, 0x12, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x03, 0xE4, 0xFD, 0xFF, 0x12, -+0x53, 0x5E, 0x80, 0x3F, 0x90, 0xA1, 0x13, 0xE0, 0x90, 0xA1, 0x0C, 0xF0, 0x80, 0x35, 0x90, 0xA2, -+0x45, 0x74, 0x01, 0xF0, 0x90, 0x05, 0x27, 0xF0, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x02, 0x06, 0x7D, -+0x01, 0x7F, 0x04, 0x80, 0x0B, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x08, 0x07, 0x7D, 0x01, 0x7F, 0x0C, -+0x12, 0x53, 0x5E, 0x12, 0x57, 0xE4, 0x90, 0xA1, 0x12, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x53, 0x5E, -+0x12, 0x92, 0xE5, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x8D, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, -+0x5F, 0x74, 0x87, 0x25, 0x5F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, -+0x68, 0x7E, 0xE5, 0x5F, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0xE5, 0x5F, 0x54, 0x07, 0xFE, 0x74, -+0x01, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0xFD, 0xAF, 0x06, 0x74, 0x01, 0x7E, -+0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, -+0x70, 0x03, 0x02, 0x68, 0x7E, 0x75, 0xF0, 0x10, 0xE5, 0x5F, 0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, -+0xE0, 0x20, 0xE7, 0x02, 0x80, 0x10, 0x75, 0xF0, 0x10, 0xE5, 0x5F, 0x90, 0x81, 0x02, 0x12, 0x49, -+0x1D, 0xE0, 0xFF, 0x20, 0xE7, 0x0A, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x20, 0xF0, 0x02, 0x68, 0x7E, -+0xEF, 0x30, 0xE6, 0x2B, 0x90, 0xA1, 0x8A, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x5F, 0x90, -+0x81, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x5F, 0x90, 0x95, 0x95, 0x12, -+0x49, 0x1D, 0xE0, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, 0x80, 0x5B, 0x90, -+0xA1, 0x8B, 0xE0, 0x04, 0xF0, 0x74, 0x92, 0x25, 0x5F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, -+0xE0, 0x04, 0xF0, 0x74, 0x92, 0x25, 0x5F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xD3, -+0x94, 0x03, 0x40, 0x13, 0xAF, 0x5F, 0x11, 0x8B, 0x74, 0x92, 0x25, 0x5F, 0xF5, 0x82, 0xE4, 0x34, -+0x9E, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x27, 0x75, 0xF0, 0x10, 0xE5, 0x5F, 0x90, 0x81, 0x00, 0x12, -+0x49, 0x1D, 0xE0, 0xFD, 0x75, 0xF0, 0x04, 0xE5, 0x5F, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, -+0x13, 0x13, 0x54, 0x03, 0x90, 0xA3, 0x04, 0xF0, 0x7B, 0x01, 0xAF, 0x5F, 0x31, 0x1C, 0x05, 0x5F, -+0xE5, 0x5F, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0x67, 0x81, 0x22, 0xAD, 0x07, 0x90, 0x01, 0xC4, -+0x74, 0x8B, 0xF0, 0x74, 0x68, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xED, 0x90, 0x81, 0x05, 0x12, 0x49, -+0x1D, 0xE0, 0x54, 0x03, 0xF5, 0x61, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x92, 0x12, 0x49, 0x1D, -+0xE0, 0xF5, 0x62, 0x74, 0x12, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0x54, 0x7F, -+0xF5, 0x60, 0x64, 0x2C, 0x70, 0x2C, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, -+0xE0, 0xFF, 0x54, 0x03, 0x65, 0x61, 0x60, 0x1A, 0x15, 0x61, 0xE5, 0x61, 0x54, 0x03, 0x25, 0xE0, -+0x25, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xEF, 0x54, 0xF3, -+0x4E, 0xF0, 0xE5, 0x60, 0xD3, 0x95, 0x62, 0x40, 0x03, 0x85, 0x62, 0x60, 0x74, 0x12, 0x2D, 0xF5, -+0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0x54, 0x80, 0x42, 0x60, 0xAF, 0x05, 0x90, 0xA3, 0x04, -+0xE5, 0x61, 0xF0, 0xE4, 0xFB, 0xAD, 0x60, 0x31, 0x1C, 0xAF, 0x60, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x01, 0xEF, 0xF0, 0x90, 0xA3, 0x03, 0xEB, 0xF0, 0x90, 0xA3, 0x02, -+0xED, 0xF0, 0xE4, 0x90, 0xA3, 0x0A, 0xF0, 0x90, 0xA3, 0x01, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, -+0x1F, 0x90, 0xA3, 0x05, 0xF0, 0xEF, 0x54, 0x07, 0x90, 0xA3, 0x07, 0xF0, 0x90, 0xA3, 0x01, 0xE0, -+0x75, 0xF0, 0x10, 0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA3, 0x08, 0xF0, 0xED, 0x54, -+0x7F, 0x90, 0xA3, 0x06, 0xF0, 0xFB, 0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, -+0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, 0x04, 0xEB, 0x90, -+0x42, 0x41, 0x12, 0x49, 0x1D, 0x12, 0x49, 0x0D, 0x12, 0x48, 0xAD, 0x78, 0x01, 0x12, 0x08, 0x47, -+0x90, 0xA3, 0x01, 0xE0, 0xFD, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA3, 0x02, 0xE0, 0xB4, 0x3F, 0x19, 0x75, 0xF0, 0x04, 0xED, -+0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x06, 0x90, -+0xA3, 0x02, 0x74, 0xBE, 0xF0, 0x90, 0xA3, 0x02, 0xE0, 0xB4, 0x34, 0x19, 0x75, 0xF0, 0x04, 0xED, -+0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x06, 0x90, -+0xA3, 0x02, 0x74, 0xB3, 0xF0, 0x90, 0xA3, 0x02, 0xE0, 0xFE, 0x54, 0x7F, 0x90, 0xA3, 0x06, 0xF0, -+0xEE, 0x54, 0x80, 0x90, 0xA3, 0x09, 0xF0, 0xED, 0x70, 0x10, 0x90, 0xA3, 0x01, 0xE0, 0xFB, 0xA3, -+0xE0, 0x90, 0xA2, 0x91, 0xF0, 0xE4, 0xFD, 0xFF, 0xD1, 0x47, 0x90, 0xA3, 0x01, 0xE0, 0xFC, 0x75, -+0xF0, 0x04, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0xC4, 0x54, 0x03, 0x70, 0x32, 0x90, 0xA3, -+0x06, 0xE0, 0xFE, 0xC3, 0x94, 0x14, 0x40, 0x15, 0xEE, 0xD3, 0x94, 0x18, 0x50, 0x0F, 0x90, 0x04, -+0x33, 0x74, 0x06, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x80, 0x0F, 0x90, 0x04, 0x33, -+0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, -+0x90, 0xA3, 0x03, 0xE0, 0x70, 0x33, 0x90, 0xA3, 0x05, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, -+0x94, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFE, 0x90, 0xA3, 0x07, 0xE0, 0xFD, 0x74, 0x01, -+0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, -+0x90, 0xA3, 0x08, 0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x50, 0x90, 0xA3, 0x05, 0xE0, 0x24, 0x01, 0xF5, -+0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA3, 0x07, 0xE0, -+0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, 0xD0, -+0x83, 0xF0, 0x75, 0xF0, 0x10, 0xEC, 0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0x07, 0xFF, -+0x90, 0xA3, 0x08, 0xF0, 0x90, 0xA3, 0x06, 0xE0, 0x90, 0x44, 0x45, 0x93, 0x33, 0x33, 0x33, 0x54, -+0xF8, 0x4F, 0x90, 0xA3, 0x08, 0xF0, 0x44, 0x80, 0xF0, 0x90, 0xA3, 0x02, 0xE0, 0xFF, 0x90, 0xA3, -+0x01, 0xE0, 0xFE, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, 0xA3, -+0x08, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0xEE, 0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x75, -+0xF0, 0x10, 0xEE, 0x90, 0x81, 0x05, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xFC, 0xFF, 0x90, 0xA3, 0x04, -+0xE0, 0x4F, 0xFE, 0x90, 0xA3, 0x01, 0xE0, 0xFF, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x05, 0x12, 0x49, -+0x1D, 0xEE, 0xF0, 0x7D, 0x01, 0xD1, 0xA6, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x8F, 0x26, 0x90, 0xA1, 0x8F, 0xE0, 0x04, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, -+0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0x1F, 0x90, 0xA3, 0x30, 0xF0, 0x24, 0xF5, 0x50, 0x0D, -+0x60, 0x6D, 0x14, 0x60, 0x70, 0x14, 0x60, 0x73, 0x14, 0x60, 0x76, 0x80, 0x7D, 0xE4, 0xF5, 0x27, -+0x75, 0xF0, 0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x25, 0x27, 0xF5, -+0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0xA3, 0x30, 0xE0, 0x75, 0xF0, 0x07, 0xA4, -+0x24, 0x56, 0xF5, 0x82, 0xE4, 0x34, 0x40, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x27, 0xF5, 0x82, 0xE4, -+0x35, 0x83, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0xEF, 0x5E, 0xFF, 0x90, 0xA3, 0x32, 0xF0, 0x75, 0xF0, -+0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x25, 0x27, 0xF5, 0x82, 0xE4, -+0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x05, 0x27, 0xE5, 0x27, 0xB4, 0x07, 0xA3, 0x80, 0x1B, 0xAD, -+0x26, 0x7F, 0x8C, 0x80, 0x10, 0xAD, 0x26, 0x7F, 0x94, 0x80, 0x0A, 0xAD, 0x26, 0x7F, 0x9C, 0x80, -+0x04, 0xAD, 0x26, 0x7F, 0xA4, 0x7E, 0x04, 0x12, 0x9F, 0xD1, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, -+0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0xC4, 0x54, 0x03, 0xFD, 0xE4, 0x90, 0xA3, 0x2E, 0xF0, -+0x7C, 0x06, 0x75, 0xF0, 0x08, 0xE5, 0x26, 0x90, 0x89, 0x00, 0xBC, 0x06, 0x12, 0x12, 0x49, 0x1D, -+0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x80, 0x0E, 0x12, -+0x49, 0x1D, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x90, 0xA3, 0x31, -+0xF0, 0x90, 0xA3, 0x31, 0xE0, 0x60, 0x64, 0x75, 0x27, 0x07, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x27, -+0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0xA3, 0x31, 0xE0, 0xFB, -+0xEF, 0x5B, 0x60, 0x3E, 0xEC, 0x75, 0xF0, 0x08, 0xA4, 0x25, 0x27, 0x90, 0xA3, 0x2E, 0xF0, 0xBD, -+0x01, 0x0C, 0xE0, 0xD3, 0x94, 0x0B, 0x40, 0x06, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x39, 0xBD, 0x02, -+0x0F, 0x90, 0xA3, 0x2E, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x06, 0xE0, 0x24, 0x18, 0xF0, 0x80, 0x27, -+0xBD, 0x03, 0x24, 0x90, 0xA3, 0x2E, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x1B, 0xE0, 0x24, 0x22, 0xF0, -+0x80, 0x15, 0x15, 0x27, 0xE5, 0x27, 0xC3, 0x94, 0x00, 0x50, 0x9F, 0xEC, 0x60, 0x09, 0x1C, 0xEC, -+0xC3, 0x94, 0x00, 0x40, 0x02, 0x61, 0xF2, 0xE4, 0x90, 0xA3, 0x2F, 0xF0, 0xFC, 0x75, 0xF0, 0x08, -+0xE5, 0x26, 0x90, 0x89, 0x00, 0xBC, 0x06, 0x12, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2C, 0xF5, 0x82, -+0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x80, 0x0E, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2C, -+0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0x90, 0xA3, 0x31, 0xF0, 0x90, 0xA3, 0x31, 0xE0, -+0x60, 0x63, 0xE4, 0xF5, 0x27, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x27, 0x08, 0x80, 0x05, 0xC3, 0x33, -+0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0xA3, 0x31, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x3E, 0xEC, -+0x75, 0xF0, 0x08, 0xA4, 0x25, 0x27, 0x90, 0xA3, 0x2F, 0xF0, 0xBD, 0x01, 0x0C, 0xE0, 0xD3, 0x94, -+0x0B, 0x40, 0x06, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x34, 0xBD, 0x02, 0x0F, 0x90, 0xA3, 0x2F, 0xE0, -+0xD3, 0x94, 0x1B, 0x40, 0x06, 0xE0, 0x24, 0x18, 0xF0, 0x80, 0x22, 0xBD, 0x03, 0x1F, 0x90, 0xA3, -+0x2F, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x16, 0xE0, 0x24, 0x22, 0xF0, 0x80, 0x10, 0x05, 0x27, 0xE5, -+0x27, 0x64, 0x08, 0x70, 0xA0, 0x0C, 0xEC, 0x64, 0x07, 0x60, 0x02, 0x81, 0x9D, 0x90, 0xA3, 0x2E, -+0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, 0x95, 0x92, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, -+0xA3, 0x2F, 0xE0, 0xFE, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, 0x95, 0x93, 0x12, 0x49, 0x1D, 0xEE, -+0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x26, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0xFC, 0x54, 0x7F, -+0xFD, 0xEC, 0x54, 0x80, 0xFC, 0xED, 0xD3, 0x9F, 0x40, 0x05, 0x90, 0xA3, 0x2E, 0x80, 0x08, 0xED, -+0xC3, 0x9E, 0x50, 0x06, 0x90, 0xA3, 0x2F, 0xE0, 0x4C, 0xFD, 0x74, 0x12, 0x25, 0x26, 0xF5, 0x82, -+0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xED, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x26, 0x90, 0x95, 0x95, 0x12, -+0x49, 0x1D, 0xE0, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, 0xAF, 0x26, 0x31, -+0x1C, 0x75, 0xF0, 0x10, 0xE5, 0x26, 0x90, 0x81, 0x03, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0x90, 0xA3, -+0x2E, 0xE0, 0xFF, 0xC3, 0x94, 0x36, 0x40, 0x10, 0x74, 0x12, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, -+0x95, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x80, 0x6A, 0xEF, 0xC3, 0x94, 0x2C, 0x40, 0x10, 0x74, 0x12, -+0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x74, 0x04, 0xF0, 0x80, 0x54, 0x90, 0xA3, -+0x2E, 0xE0, 0xFF, 0xC3, 0x94, 0x14, 0x40, 0x10, 0x74, 0x12, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, -+0x95, 0xF5, 0x83, 0x74, 0x03, 0xF0, 0x80, 0x3A, 0xEF, 0xC3, 0x94, 0x0C, 0x40, 0x10, 0x74, 0x12, -+0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x74, 0x02, 0xF0, 0x80, 0x24, 0x90, 0xA3, -+0x2E, 0xE0, 0xC3, 0x94, 0x04, 0x74, 0x12, 0x40, 0x0E, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0x95, -+0xF5, 0x83, 0x74, 0x01, 0xF0, 0x80, 0x0B, 0x25, 0x26, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -+0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0x90, 0xEB, 0xF0, 0x70, 0x57, 0x90, 0xA2, -+0x90, 0xE0, 0xFE, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE0, 0xFC, 0x90, 0xA2, -+0x91, 0xE0, 0xFB, 0xEC, 0x6B, 0x60, 0x3E, 0x90, 0xA2, 0x94, 0xEB, 0xF0, 0xA3, 0xEE, 0xF0, 0xAE, -+0x05, 0xEE, 0x25, 0xE0, 0x4F, 0xA3, 0xF0, 0x90, 0xA2, 0x92, 0x74, 0x0C, 0xF0, 0x90, 0xA2, 0xA0, -+0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x92, 0x12, 0x5F, 0x42, 0x7F, 0x04, 0x12, 0x5A, -+0x0F, 0x90, 0xA2, 0x91, 0xE0, 0xFF, 0x90, 0xA2, 0x90, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, -+0x98, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x62, -+0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x01, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, -+0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, -+0x90, 0x8D, 0x05, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, -+0x07, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x09, 0x12, -+0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, -+0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, -+0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x03, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xBF, 0x44, -+0x80, 0xFE, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x03, 0x12, 0x49, 0x1D, 0xEE, 0xF0, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, -+0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -+0x90, 0x01, 0xC4, 0x74, 0x33, 0xF0, 0x74, 0x6F, 0xA3, 0xF0, 0x12, 0x9A, 0x7B, 0xE5, 0x21, 0x30, -+0xE1, 0x02, 0xF1, 0xDC, 0xE5, 0x21, 0x30, 0xE2, 0x03, 0x12, 0x57, 0x81, 0xE5, 0x22, 0x30, 0xE0, -+0x03, 0x12, 0x9D, 0x57, 0xE5, 0x23, 0x30, 0xE1, 0x03, 0x12, 0x84, 0xC6, 0xE5, 0x23, 0x30, 0xE0, -+0x03, 0x12, 0x84, 0x58, 0xE5, 0x23, 0x30, 0xE3, 0x02, 0xF1, 0xDB, 0xE5, 0x24, 0x30, 0xE1, 0x05, -+0x7F, 0x04, 0x12, 0x61, 0xBE, 0xE5, 0x24, 0x30, 0xE4, 0x03, 0x12, 0x82, 0xC7, 0xE5, 0x24, 0x30, -+0xE5, 0x03, 0x12, 0x56, 0x79, 0xE5, 0x24, 0x30, 0xE6, 0x03, 0x12, 0x9D, 0xEC, 0xE5, 0x24, 0x30, -+0xE7, 0x03, 0x12, 0x77, 0x3D, 0x74, 0x33, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x6F, 0xA3, 0xF0, -+0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -+0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x22, 0x90, 0xA1, 0x10, 0xE0, -+0x60, 0x03, 0x12, 0xBB, 0xC5, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -+0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -+0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xE6, 0xF0, 0x74, 0x6F, 0xA3, 0xF0, 0x90, 0xA1, 0x9C, -+0xE0, 0x04, 0xF0, 0x12, 0x61, 0xCD, 0x53, 0x91, 0xBF, 0x74, 0xE6, 0x04, 0x90, 0x01, 0xC4, 0xF0, -+0x74, 0x6F, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, -+0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x3F, -+0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x70, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, -+0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, -+0x90, 0xA3, 0x0B, 0xEF, 0xF0, 0xAB, 0x05, 0x7E, 0x00, 0x7D, 0x00, 0x7C, 0x00, 0xE4, 0x90, 0xA3, -+0x10, 0xF0, 0xAF, 0x03, 0x90, 0xA3, 0x0C, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x0C, 0x12, 0x48, 0xE5, -+0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x38, 0x07, 0x7F, 0x14, 0x7E, -+0x00, 0x12, 0x3D, 0x7A, 0x90, 0xA3, 0x0B, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0xB5, 0xF5, 0x82, -+0xE4, 0x34, 0xAD, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x37, 0xBC, 0xED, 0x54, 0x0F, -+0xFD, 0xE4, 0xFC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0x70, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0xA3, 0x13, -+0x12, 0x48, 0xE5, 0x90, 0xAA, 0x9C, 0x12, 0x08, 0x6D, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0x32, 0x34, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x56, 0xE0, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x1C, 0xEF, -+0xB4, 0x01, 0x05, 0x90, 0xA1, 0x5D, 0x80, 0x03, 0x90, 0xA1, 0x59, 0x12, 0x48, 0xE5, 0x90, 0xAA, -+0xB9, 0x12, 0x08, 0x6D, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x38, 0x07, 0x22, 0x90, 0xA2, 0x6F, 0x74, -+0x02, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0x51, 0x12, 0x87, 0xF6, 0x90, 0xA1, -+0x3A, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x41, 0x09, 0xF5, 0x3B, 0x75, 0x3C, 0x03, 0xFB, 0xFD, 0x7F, -+0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x6F, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, -+0xC4, 0x54, 0x0F, 0x90, 0xA1, 0x3A, 0x30, 0xE0, 0x05, 0x74, 0x05, 0xF0, 0x80, 0x03, 0xE0, 0x04, -+0xF0, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0F, 0x90, 0xA1, 0x29, 0xE0, -+0xFF, 0x90, 0xA1, 0x38, 0xE0, 0xC3, 0x9F, 0x90, 0xA1, 0x3E, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC4, -+0x13, 0x54, 0x07, 0x30, 0xE0, 0x28, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, -+0x6D, 0x90, 0xA1, 0x3E, 0xE0, 0xC3, 0x94, 0x20, 0x50, 0x0A, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, -+0xE4, 0xFD, 0x80, 0x05, 0x7B, 0x7F, 0x7D, 0xFF, 0xE4, 0xFF, 0xF1, 0x63, 0x80, 0x50, 0x90, 0xA1, -+0x28, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x40, 0x90, 0xA1, 0x2E, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, -+0xFD, 0x7F, 0x04, 0x12, 0x53, 0x5E, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, -+0xE0, 0x26, 0x90, 0xA1, 0x2F, 0xE0, 0x44, 0x02, 0xF0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA1, 0x3D, -+0xF0, 0x90, 0xA1, 0x3A, 0xF0, 0x90, 0xA1, 0x30, 0x74, 0x06, 0xF0, 0x90, 0xA1, 0x27, 0xE0, 0x60, -+0x07, 0x90, 0xA1, 0x2F, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0xA1, -+0x2B, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0x51, 0xA1, 0x7B, 0x90, 0xA1, 0x3A, 0xE0, 0x64, 0x02, 0x60, -+0x02, 0x41, 0xFD, 0x7F, 0x01, 0xD1, 0x52, 0x90, 0xA1, 0x2C, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, -+0x30, 0xE0, 0x08, 0xF1, 0x98, 0xBF, 0x01, 0x03, 0x12, 0x8A, 0x8F, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, -+0x13, 0x13, 0x13, 0x54, 0x01, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, -+0x74, 0x01, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x29, 0xE0, 0x24, 0x03, 0xFF, 0x90, 0xA1, 0x38, -+0xE0, 0xC3, 0x9F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, -+0x01, 0x6F, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xE4, 0x90, -+0xA2, 0x6E, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0x6E, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0xC4, -+0x13, 0x54, 0x07, 0x20, 0xE0, 0x13, 0x90, 0xA1, 0x65, 0xE0, 0x60, 0x08, 0x90, 0xA2, 0x6F, 0x74, -+0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x6F, 0xF0, 0xD1, 0x8B, 0xE4, 0x90, 0xA1, 0x39, 0xF0, -+0xA3, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, -+0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x29, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -+0x10, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x0E, 0x12, 0x53, 0x57, 0x80, -+0x09, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x09, 0x12, 0x53, 0x57, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, -+0x90, 0xA1, 0x2B, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, -+0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x20, 0xE0, 0x02, 0xC1, 0x51, 0xC1, 0x4D, 0x90, 0xA1, 0x3A, -+0xE0, 0x64, 0x03, 0x60, 0x02, 0x81, 0xB1, 0xFF, 0xD1, 0x52, 0x90, 0xA1, 0x2C, 0xE0, 0xFF, 0x13, -+0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x86, 0xBC, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x13, -+0x54, 0x03, 0x30, 0xE0, 0x08, 0x90, 0x07, 0x78, 0x74, 0x0D, 0xF0, 0x80, 0x14, 0x90, 0xA1, 0x2B, -+0xE0, 0xC3, 0x13, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x09, -+0xF0, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x02, 0x61, 0xD4, 0x90, -+0xA1, 0x32, 0xE0, 0xFF, 0x90, 0xA1, 0x3C, 0xE0, 0xD3, 0x9F, 0x40, 0x4D, 0xE0, 0x75, 0xF0, 0x03, -+0xA4, 0xFF, 0x90, 0xA1, 0x34, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, 0xFF, 0x24, 0x03, 0xFD, 0xE4, 0x33, -+0xFC, 0x90, 0xA1, 0x2A, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x40, 0x08, -+0xE0, 0x9F, 0x90, 0xA2, 0x70, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0x70, 0x74, 0x03, 0xF0, 0xE4, 0xF5, -+0x3B, 0x90, 0xA2, 0x70, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x35, -+0x7A, 0x90, 0xA1, 0x3A, 0xE0, 0x04, 0xF0, 0x80, 0x24, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x35, 0xE0, -+0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0xA1, 0x30, 0x74, -+0x04, 0xF0, 0xE4, 0x90, 0xA1, 0x3A, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA1, -+0x3C, 0xF0, 0x80, 0x19, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x2A, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, -+0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0xA1, 0x3A, 0xE0, 0x04, 0xF0, 0x90, 0x01, 0x6F, -+0x74, 0x05, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x07, -+0xE4, 0x90, 0xA2, 0x6E, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0x6E, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x2B, -+0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x13, 0x90, 0xA1, 0x65, 0xE0, 0x60, 0x07, 0xE4, 0x90, -+0xA2, 0x6F, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0x6F, 0x74, 0x01, 0xF0, 0xD1, 0x8B, 0x90, 0xA1, 0x39, -+0x74, 0x01, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x33, 0x90, 0xA1, -+0x28, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1C, 0x90, 0xA1, 0x2E, 0xE0, 0x44, 0x20, 0xF0, 0x90, -+0xA1, 0x27, 0xE0, 0x60, 0x04, 0x7D, 0x01, 0x80, 0x13, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x7D, 0x01, -+0x7F, 0x0C, 0x80, 0x0A, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x07, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x53, -+0x5E, 0x90, 0xA1, 0x27, 0xE0, 0x60, 0x08, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x1F, 0x90, -+0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x0F, 0x90, 0xA1, 0x28, 0xE0, 0xFF, 0x13, -+0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, 0x7E, 0x40, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, -+0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x20, 0xE0, 0x02, 0xC1, 0x51, 0x7F, 0x01, 0xC1, -+0x4F, 0x90, 0xA1, 0x3A, 0xE0, 0x64, 0x04, 0x60, 0x02, 0xA1, 0x81, 0xF5, 0x3B, 0x75, 0x3C, 0x03, -+0xFB, 0xFD, 0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x6F, 0x74, 0x05, 0xF0, 0x90, -+0xA1, 0x3A, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0F, -+0x90, 0xA1, 0x2A, 0xE0, 0xFF, 0x90, 0xA1, 0x38, 0xE0, 0xC3, 0x9F, 0x90, 0xA1, 0x3E, 0xF0, 0x90, -+0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x28, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, -+0x54, 0x07, 0x30, 0xE0, 0x6D, 0x90, 0xA1, 0x3E, 0xE0, 0xC3, 0x94, 0x20, 0x50, 0x0A, 0xE0, 0x25, -+0xE0, 0x25, 0xE0, 0xFB, 0xE4, 0xFD, 0x80, 0x05, 0x7B, 0x7F, 0x7D, 0xFF, 0xE4, 0xFF, 0xF1, 0x63, -+0x80, 0x50, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x40, 0x90, 0xA1, 0x2E, 0xE0, -+0x54, 0xDF, 0xF0, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x53, 0x5E, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, -+0x13, 0x54, 0x03, 0x30, 0xE0, 0x26, 0x90, 0xA1, 0x2F, 0xE0, 0x44, 0x02, 0xF0, 0x54, 0xFB, 0xF0, -+0xE4, 0x90, 0xA1, 0x3D, 0xF0, 0x90, 0xA1, 0x3A, 0xF0, 0x90, 0xA1, 0x30, 0x74, 0x07, 0xF0, 0x90, -+0xA1, 0x27, 0xE0, 0x60, 0x07, 0x90, 0xA1, 0x2F, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x05, 0x22, 0x74, -+0x6F, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0x20, 0xE0, 0x02, 0xC1, 0x51, 0x90, 0x05, 0x22, 0xE4, 0xF0, -+0x22, 0x90, 0xA1, 0x3A, 0xE0, 0x64, 0x05, 0x60, 0x02, 0xC1, 0x51, 0x7F, 0x01, 0xD1, 0x52, 0x90, -+0xA1, 0x2C, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x08, 0xF1, 0x98, 0xBF, 0x01, 0x03, -+0x12, 0x8A, 0x8F, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x90, 0x07, 0x78, -+0x30, 0xE0, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC3, -+0x13, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0xA2, 0x6E, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0x6E, 0x74, 0x01, -+0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x13, 0x90, 0xA1, 0x65, 0xE0, -+0x60, 0x08, 0x90, 0xA2, 0x6F, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x6F, 0xF0, 0xD1, -+0x8B, 0xE4, 0x90, 0xA1, 0x39, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xC4, 0x13, 0x54, 0x07, -+0x30, 0xE0, 0x08, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x29, 0x90, 0xA1, 0x28, 0xE0, 0xC4, -+0x54, 0x0F, 0x30, 0xE0, 0x10, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x0E, -+0x12, 0x53, 0x57, 0x80, 0x09, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x09, 0x12, 0x53, 0x57, 0x90, 0x05, -+0x22, 0x74, 0xFF, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, -+0x90, 0xA1, 0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x04, 0xE4, 0xFF, 0x11, -+0xF5, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0xB4, 0x03, 0x13, 0x90, 0xA1, 0x2B, -+0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0x06, 0xCC, 0x30, 0xE0, 0x17, 0xE4, 0xF0, 0x80, 0x16, -+0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x0C, 0xEF, 0x90, 0x06, 0xCC, 0x70, 0x03, -+0xF0, 0x80, 0x03, 0x74, 0x03, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0x6F, 0xE0, 0xFF, -+0x90, 0xA2, 0x6E, 0xE0, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x17, 0xEF, -+0xF0, 0xA3, 0xED, 0xF0, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0x90, 0xA3, 0x19, 0x12, 0x08, -+0x6D, 0x90, 0xA3, 0x17, 0xE0, 0xFB, 0x64, 0x02, 0x60, 0x2A, 0x90, 0xA3, 0x19, 0x12, 0x48, 0xE5, -+0xE4, 0xFC, 0x90, 0xA3, 0x19, 0x12, 0x08, 0x6D, 0xEB, 0x90, 0xA3, 0x19, 0xB4, 0x01, 0x08, 0x12, -+0x48, 0xE5, 0xEC, 0x44, 0x20, 0x80, 0x06, 0x12, 0x48, 0xE5, 0xEC, 0x44, 0x10, 0xFC, 0x90, 0xA3, -+0x19, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x18, 0xE0, 0xFB, 0x64, 0x02, 0x60, 0x2B, 0x90, 0xA3, 0x19, -+0x12, 0x48, 0xE5, 0xE4, 0xFF, 0xEC, 0x90, 0xA3, 0x19, 0x12, 0x08, 0x6D, 0xEB, 0x90, 0xA3, 0x19, -+0x70, 0x08, 0x12, 0x48, 0xE5, 0xEF, 0x44, 0x77, 0x80, 0x06, 0x12, 0x48, 0xE5, 0xEF, 0x44, 0x66, -+0xFF, 0xEC, 0x90, 0xA3, 0x19, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x17, 0xE0, 0xB4, 0x02, 0x06, 0xA3, -+0xE0, 0x64, 0x02, 0x60, 0x13, 0x90, 0xA3, 0x19, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, -+0x6D, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x38, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x42, -+0xE0, 0x30, 0xE0, 0x08, 0x90, 0x01, 0xBE, 0x74, 0x44, 0xF0, 0x80, 0x02, 0x21, 0x1C, 0x90, 0x05, -+0x22, 0x74, 0xFF, 0xF0, 0x90, 0x07, 0x78, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x65, 0xE0, 0xFF, 0xE4, -+0xFD, 0xC1, 0x95, 0x90, 0xA2, 0x71, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x04, -+0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, 0xE0, 0x90, 0xA2, 0x76, 0xF0, 0xF1, 0x98, 0xBF, 0x01, -+0x03, 0x12, 0x81, 0x71, 0x90, 0xA2, 0x76, 0xE0, 0x90, 0x05, 0x22, 0xF0, 0x80, 0x03, 0x12, 0x81, -+0x71, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0xE4, 0x90, -+0xA3, 0x59, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, -+0xE0, 0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0xA3, 0x5A, 0xE0, 0x94, -+0xE8, 0x90, 0xA3, 0x59, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, -+0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0xA3, 0x59, 0xE4, 0x75, 0xF0, -+0x01, 0x12, 0x08, 0xD6, 0x80, 0xBF, 0x90, 0xA1, 0x56, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFB, 0xF0, -+0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x7F, 0x58, 0x7E, 0x0C, 0x12, -+0x37, 0xBC, 0x90, 0xA1, 0x5D, 0x12, 0x08, 0x6D, 0x90, 0xA1, 0x5D, 0x12, 0x48, 0xE5, 0x90, 0xA1, -+0x59, 0x12, 0x08, 0x6D, 0xE4, 0x90, 0xA1, 0x63, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0x66, 0xF0, 0xA3, -+0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xFD, 0x68, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x07, -+0x78, 0x74, 0x03, 0xF0, 0x11, 0x47, 0x90, 0xA1, 0x40, 0x74, 0x01, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, -+0xA1, 0x4A, 0xF0, 0xA3, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0x28, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, -+0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, -+0xA3, 0x74, 0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, -+0x54, 0xFB, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, -+0xE0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, -+0x54, 0x7F, 0xF0, 0x90, 0xA1, 0x2E, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0xA1, 0x2D, 0xF0, 0x90, -+0xA1, 0x2F, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA1, 0x36, -+0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0xE4, 0xA3, 0xF0, -+0xA3, 0xF0, 0x90, 0xA1, 0x42, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, 0xE4, 0x90, 0xA1, 0x3F, -+0xF0, 0x90, 0xA1, 0x4C, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, -+0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0x47, 0x12, 0x49, 0x32, 0x12, 0x06, 0x89, 0xFF, 0x54, -+0x01, 0xFE, 0x90, 0xA1, 0x28, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, -+0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, -+0xFF, 0x90, 0xA1, 0x28, 0xF0, 0xEE, 0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x12, -+0x06, 0x89, 0xFE, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0xA1, 0x28, 0xF0, 0xEE, -+0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFE, 0x54, 0x80, 0xFD, -+0xEF, 0x54, 0x7F, 0x4D, 0x90, 0xA1, 0x28, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFF, 0x54, -+0x01, 0xFD, 0x90, 0xA1, 0x2B, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xED, -+0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFD, 0x54, 0x04, 0xFC, 0xEF, -+0x54, 0xFB, 0x4C, 0xFF, 0x90, 0xA1, 0x2B, 0xF0, 0xED, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, -+0xFF, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFD, 0x54, 0x20, 0xFC, 0xEF, 0x54, 0xDF, 0x4C, -+0xFF, 0x90, 0xA1, 0x2B, 0xF0, 0xED, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, 0x4D, 0xFF, 0xF0, 0x90, -+0x00, 0x03, 0x12, 0x06, 0xA2, 0x54, 0x80, 0xFD, 0xEF, 0x54, 0x7F, 0x4D, 0x90, 0xA1, 0x2B, 0xF0, -+0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0xFF, 0x54, 0x20, 0xFD, 0x90, 0xA1, 0x2C, 0xE0, 0x54, 0xDF, -+0x4D, 0xFD, 0xF0, 0xEF, 0x54, 0x40, 0xFF, 0xED, 0x54, 0xBF, 0x4F, 0xFF, 0xF0, 0x90, 0x00, 0x04, -+0x12, 0x06, 0xA2, 0xFD, 0x54, 0x80, 0xFC, 0xEF, 0x54, 0x7F, 0x4C, 0xFF, 0x90, 0xA1, 0x2C, 0xF0, -+0xED, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, -+0xFD, 0x54, 0x10, 0xFC, 0xEF, 0x54, 0xEF, 0x4C, 0xFF, 0x90, 0xA1, 0x2C, 0xF0, 0xED, 0x54, 0x08, -+0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xF0, 0xEE, 0x20, 0xE0, 0x02, 0x61, 0x8F, 0x90, 0x05, 0x54, 0xE0, -+0xC3, 0x13, 0x90, 0xA1, 0x38, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1C, -+0x90, 0xA2, 0x47, 0x12, 0x49, 0x29, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0xA1, 0x29, 0xF0, -+0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0xA1, 0x2A, 0xF0, 0x80, 0x4E, 0x90, 0xA2, 0x47, 0x12, -+0x49, 0x29, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, -+0x94, 0x03, 0x90, 0xA1, 0x29, 0x50, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, -+0x90, 0xA1, 0x29, 0x74, 0x2A, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFF, 0xC3, 0x94, 0x2A, -+0x50, 0x12, 0xEF, 0xC3, 0x94, 0x03, 0x90, 0xA1, 0x2A, 0x50, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x0A, -+0xEF, 0xF0, 0x80, 0x06, 0x90, 0xA1, 0x2A, 0x74, 0x2A, 0xF0, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, -+0x13, 0x54, 0x03, 0x30, 0xE0, 0x3C, 0x90, 0xA1, 0x29, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0xA1, -+0x31, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0xA1, 0x2A, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, -+0xA1, 0x33, 0xF0, 0x90, 0xA1, 0x29, 0xE0, 0xC3, 0x13, 0x90, 0xA1, 0x34, 0xF0, 0x90, 0xA1, 0x2A, -+0xE0, 0xC3, 0x13, 0x90, 0xA1, 0x35, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, -+0x91, 0x36, 0xE4, 0x90, 0xA1, 0x63, 0xF0, 0x90, 0xA2, 0x47, 0x12, 0x49, 0x29, 0x90, 0x00, 0x03, -+0x12, 0x06, 0xA2, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x30, 0x12, 0x06, 0x89, 0x13, 0x13, -+0x13, 0x54, 0x1F, 0x30, 0xE0, 0x08, 0x90, 0xA1, 0x65, 0xE0, 0x60, 0x08, 0x80, 0x0E, 0x90, 0xA1, -+0x65, 0xE0, 0x60, 0x08, 0x90, 0xA2, 0x45, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x45, -+0xF0, 0x90, 0xA2, 0x45, 0xE0, 0xFF, 0x7D, 0x02, 0x12, 0x76, 0x95, 0x90, 0xA1, 0x28, 0xE0, 0xC4, -+0x54, 0x0F, 0x30, 0xE0, 0x1B, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x06, -+0x90, 0xA1, 0x12, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x74, 0x11, 0xF0, -+0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0x30, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0xA1, -+0x3A, 0x74, 0x01, 0xF0, 0x80, 0x22, 0xEF, 0xB4, 0x04, 0x08, 0x90, 0xA1, 0x3A, 0x74, 0x04, 0xF0, -+0x80, 0x16, 0xEF, 0xB4, 0x06, 0x08, 0x90, 0xA1, 0x3A, 0x74, 0x02, 0xF0, 0x80, 0x0A, 0xEF, 0xB4, -+0x07, 0x06, 0x90, 0xA1, 0x3A, 0x74, 0x05, 0xF0, 0xE4, 0x90, 0xA1, 0x30, 0xF0, 0x80, 0x60, 0x90, -+0xA2, 0x47, 0x12, 0x49, 0x29, 0x12, 0x06, 0x89, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, -+0x08, 0x90, 0xA2, 0x46, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x46, 0xF0, 0x11, 0x47, -+0x7D, 0x20, 0x7F, 0x40, 0x12, 0x4A, 0x07, 0x90, 0xA2, 0x47, 0x12, 0x49, 0x29, 0x90, 0x00, 0x03, -+0x12, 0x06, 0xA2, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x03, -+0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x90, 0xA2, 0x46, 0xE0, 0xFD, 0x7F, 0x02, 0x12, 0x76, 0x95, -+0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x74, 0x43, 0xF0, 0x90, -+0xA1, 0x2E, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0xA1, 0x39, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0xC4, -+0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x09, 0x90, 0xA1, 0x56, 0xE0, 0x44, 0x02, 0xF0, 0x80, -+0x0C, 0x7F, 0x01, 0x12, 0x70, 0xF5, 0x90, 0xA1, 0x56, 0xE0, 0x54, 0xFD, 0xF0, 0x7F, 0x03, 0x12, -+0x76, 0x52, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0x01, 0x3F, -+0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x74, 0x1D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x38, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0xA0, 0x87, 0xE0, 0x64, -+0x01, 0x60, 0x02, 0x81, 0xEA, 0x90, 0xA1, 0x10, 0xE0, 0x70, 0x02, 0x81, 0xEA, 0x90, 0xA1, 0x0F, -+0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0xA1, 0x17, 0xF0, -+0x90, 0x06, 0xAA, 0xE0, 0x90, 0xA1, 0x16, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0xA1, 0x16, -+0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0xA1, 0x17, 0xEF, 0xF0, 0x90, 0xA1, 0x0E, 0xE0, 0x44, 0x04, -+0xF0, 0xE4, 0x90, 0xA1, 0x19, 0xF0, 0x90, 0xA1, 0x1B, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, -+0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0x14, 0xE0, 0x54, 0xFD, -+0xF0, 0x54, 0xEF, 0xF0, 0x90, 0xA1, 0x0F, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, -+0x80, 0x0D, 0x90, 0xA1, 0x08, 0xE0, 0x30, 0xE0, 0x04, 0xB1, 0x7E, 0x80, 0x02, 0x91, 0xFB, 0x90, -+0xA1, 0x0E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0F, 0x90, 0xA1, 0x16, 0xE0, 0xFF, -+0xA3, 0xE0, 0xB5, 0x07, 0x05, 0x91, 0x27, 0x12, 0x64, 0x5D, 0x90, 0xA1, 0x08, 0xE0, 0xC3, 0x13, -+0x20, 0xE0, 0x07, 0x90, 0xA1, 0x0E, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0xA2, 0x5E, 0xF0, -+0x90, 0x06, 0xA9, 0xE0, 0x90, 0xA2, 0x5E, 0xF0, 0xE0, 0x54, 0xC0, 0x70, 0x0D, 0x90, 0xA1, 0x14, -+0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x02, 0x53, 0x43, 0x90, 0xA2, 0x5E, 0xE0, 0x30, 0xE6, -+0x22, 0x90, 0xA1, 0x10, 0xE0, 0x64, 0x01, 0x70, 0x21, 0x90, 0xA1, 0x14, 0xE0, 0x44, 0x01, 0xF0, -+0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x04, 0xD1, 0x40, 0x80, 0x0C, 0x12, 0x56, -+0x64, 0x80, 0x07, 0x90, 0xA1, 0x14, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA2, 0x5E, 0xE0, 0x90, 0xA1, -+0x14, 0x30, 0xE7, 0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x22, 0xE0, 0xF5, -+0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, 0x74, 0x05, -+0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x06, -+0xA9, 0xE0, 0x90, 0xA2, 0x5E, 0xF0, 0xE0, 0xFD, 0x54, 0xC0, 0x70, 0x09, 0x90, 0xA1, 0x14, 0xE0, -+0x54, 0xFE, 0xF0, 0xC1, 0x1C, 0xED, 0x30, 0xE6, 0x4C, 0x90, 0xA1, 0x10, 0xE0, 0x64, 0x02, 0x70, -+0x2A, 0x90, 0xA1, 0x0D, 0xE0, 0xFF, 0xC3, 0x13, 0x20, 0xE0, 0x09, 0x90, 0xA1, 0x14, 0xE0, 0x44, -+0x01, 0xF0, 0x80, 0x28, 0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x2E, 0x90, 0xA1, -+0x14, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x01, 0xD1, 0x20, 0x80, 0x21, 0x90, 0xA1, 0x14, 0xE0, 0x44, -+0x01, 0xF0, 0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x04, 0xD1, 0x40, 0x80, 0x0C, -+0x12, 0x56, 0x64, 0x80, 0x07, 0x90, 0xA1, 0x14, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA2, 0x5E, 0xE0, -+0x90, 0xA1, 0x14, 0x30, 0xE7, 0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x22, -+0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, -+0x74, 0x05, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, -+0x8F, 0x5F, 0xF1, 0xA0, 0xBF, 0x01, 0x18, 0x90, 0x9F, 0x99, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x57, -+0x12, 0xAD, 0x07, 0xAC, 0x06, 0xAF, 0x5F, 0xD1, 0x65, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, -+0x90, 0xA1, 0x26, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x1A, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x14, -+0x90, 0x9F, 0x97, 0xE0, 0xFF, 0xE4, 0xFD, 0x12, 0x57, 0x12, 0x8E, 0x6A, 0x8F, 0x6B, 0x90, 0x04, -+0x1F, 0x74, 0x20, 0xF0, 0x22, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -+0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x52, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x44, 0x10, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, -+0x80, 0xF0, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x47, 0x90, 0xA1, 0x3E, -+0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x50, 0x13, 0xEF, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x74, 0x2B, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0x74, 0x2B, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0x74, 0x7F, 0xF0, 0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x54, 0xEF, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x44, 0x40, 0xF0, 0x22, 0x90, 0x9F, 0x98, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x57, 0x12, 0x8E, -+0x64, 0x8F, 0x65, 0xAD, 0x65, 0xAC, 0x64, 0xAF, 0x63, 0xD1, 0x65, 0xAF, 0x65, 0xAE, 0x64, 0x90, -+0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -+0xF5, 0x83, 0xE0, 0x44, 0x01, 0xF0, 0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, -+0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, -+0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, 0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, -+0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xED, 0xF0, 0x22, 0x90, 0xA0, 0x87, 0xE0, 0xB4, 0x01, 0x15, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x0F, -+0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x02, 0xC1, 0x40, 0x12, 0x56, 0x64, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, -+0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, 0xC6, 0xE0, -+0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xFD, -+0x58, 0xE0, 0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0xE0, 0x04, 0xF0, 0x80, 0xF1, 0xEF, 0x75, 0xF0, -+0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, 0xFD, 0x50, 0xF0, -+0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, -+0xFD, 0x51, 0xF0, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x02, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x90, 0xFD, 0x52, 0xF0, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, 0xE4, -+0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, 0xFD, 0x53, 0xF0, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x04, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, 0xFD, 0x54, 0xF0, 0xEF, 0x75, 0xF0, 0x08, -+0xA4, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, 0xFD, 0x55, 0xF0, 0xEF, -+0x75, 0xF0, 0x08, 0xA4, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, 0xFD, -+0x56, 0xF0, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -+0xE0, 0x90, 0xFD, 0x57, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0xE4, 0xFC, 0x74, 0x28, 0x2F, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0xA2, 0x48, 0xEF, 0xF0, 0xEE, -+0xF9, 0x90, 0x01, 0xBD, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x02, 0x09, 0xE0, 0xC3, 0x13, 0x90, 0xFD, -+0x10, 0xF0, 0xEC, 0xC3, 0x99, 0x50, 0x45, 0xEC, 0x70, 0x04, 0x7D, 0x05, 0x80, 0x02, 0xE4, 0xFD, -+0xED, 0xC3, 0x94, 0x20, 0x50, 0x08, 0xAF, 0x05, 0x12, 0x7F, 0xCE, 0x0D, 0x80, 0xF2, 0x0C, 0x90, -+0xFD, 0x10, 0xE0, 0x04, 0xF0, 0xEC, 0xB5, 0x01, 0xD9, 0xE4, 0xFD, 0xED, 0x75, 0xF0, 0x08, 0xA4, -+0xFF, 0x90, 0xA2, 0x48, 0xE0, 0xFB, 0xC3, 0xEF, 0x9B, 0x74, 0x80, 0xF8, 0x65, 0xF0, 0x98, 0x50, -+0x08, 0xAF, 0x05, 0x12, 0x7F, 0xCE, 0x0D, 0x80, 0xE2, 0x0C, 0x80, 0xB6, 0x90, 0x01, 0xBD, 0xE0, -+0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA2, 0x7F, 0x74, 0x08, 0xF0, 0x90, 0xA2, -+0x8D, 0x74, 0x01, 0xF0, 0x90, 0xA2, 0x81, 0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0x7F, 0x02, -+0x5F, 0x42, 0x90, 0xA2, 0xD5, 0x74, 0x0B, 0xF0, 0x90, 0xA2, 0xE3, 0x74, 0x07, 0xF0, 0x90, 0xA2, -+0xD7, 0xEF, 0xF0, 0x60, 0x32, 0x90, 0xFD, 0x63, 0xE0, 0x90, 0xA2, 0xD8, 0xF0, 0x90, 0xFD, 0x61, -+0xE0, 0x90, 0xA2, 0xD9, 0xF0, 0x90, 0xFD, 0x64, 0xE0, 0x90, 0xA2, 0xDA, 0xF0, 0x90, 0xFD, 0x65, -+0xE0, 0x90, 0xA2, 0xDB, 0xF0, 0x90, 0xFD, 0x66, 0xE0, 0x90, 0xA2, 0xDC, 0xF0, 0x90, 0xFD, 0x67, -+0xE0, 0x90, 0xA2, 0xDD, 0xF0, 0x80, 0x11, 0x90, 0xA2, 0xD8, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0xE4, -+0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xD5, 0x02, 0x5F, -+0x42, 0x90, 0x9F, 0x9A, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0x57, 0x12, 0x90, 0xA2, 0x74, 0xEE, 0xF0, -+0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0xA2, 0x71, 0xE0, 0xFF, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, -+0xA2, 0x7B, 0xF0, 0x90, 0xA2, 0x78, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0xA2, -+0x78, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x12, 0x7E, 0x65, 0x90, 0xA2, 0x78, 0xA3, 0xE0, 0xFF, 0xFD, -+0x24, 0x0D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0D, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xEF, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x02, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0xFC, 0xF5, 0x83, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0xA2, 0x7A, 0xE0, 0xFF, 0x90, 0xA2, 0x78, 0xA3, -+0xE0, 0xFE, 0x24, 0x2A, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0xA2, 0x7B, -+0xE0, 0xFF, 0x74, 0x2B, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x2C, -+0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0x26, 0xE0, -+0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x2F, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x26, 0x90, -+0xA1, 0x2B, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x07, 0x90, 0x07, 0x78, 0x74, 0x03, 0xF0, 0x22, -+0x90, 0xA1, 0x26, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x04, 0x74, 0x0D, -+0xF0, 0x22, 0x74, 0x09, 0xF0, 0x22, 0xE4, 0x90, 0xA2, 0x6E, 0xF0, 0x90, 0xA1, 0x10, 0xE0, 0x60, -+0x65, 0x90, 0xA0, 0x87, 0xE0, 0x64, 0x01, 0x70, 0x5D, 0x90, 0xA2, 0x6E, 0x04, 0xF0, 0xE4, 0x90, -+0xA1, 0x17, 0xF0, 0x90, 0xA1, 0x08, 0xE0, 0x30, 0xE0, 0x16, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x02, -+0x05, 0xE4, 0x90, 0xA2, 0x6E, 0xF0, 0x12, 0x57, 0xEC, 0xEF, 0x70, 0x04, 0x90, 0xA2, 0x6E, 0xF0, -+0x90, 0xA2, 0x6E, 0xE0, 0x60, 0x30, 0x90, 0xA1, 0x14, 0xE0, 0x44, 0x10, 0xF0, 0xE4, 0xF5, 0x3B, -+0x90, 0xA1, 0x18, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, -+0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0x13, 0xE0, 0x20, 0xE2, 0x07, 0x7D, 0x01, 0x7F, -+0x04, 0x12, 0x53, 0x5E, 0x51, 0x1C, 0x22, 0x51, 0x56, 0x90, 0xA1, 0x16, 0xE0, 0x14, 0x90, 0x05, -+0x73, 0xF0, 0x7D, 0x02, 0x7F, 0x02, 0x12, 0x65, 0x55, 0x71, 0x11, 0x90, 0xA1, 0x6F, 0xE0, 0x30, -+0xE0, 0x2E, 0x90, 0xA0, 0x87, 0xE0, 0xB4, 0x01, 0x27, 0x90, 0xA3, 0x65, 0xE0, 0x04, 0xF0, 0xE0, -+0xB4, 0x0A, 0x0B, 0x90, 0xA1, 0x71, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0xA3, 0x65, 0xF0, 0x90, 0xA1, -+0x71, 0xE0, 0xFF, 0x90, 0xA1, 0x70, 0xE0, 0xB5, 0x07, 0x06, 0xE4, 0xA3, 0xF0, 0x12, 0x57, 0x7D, -+0x22, 0x90, 0xA3, 0x53, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0x20, 0xE0, 0x02, 0x81, 0x16, -+0xE4, 0xFF, 0x12, 0x76, 0x52, 0x90, 0xA1, 0x2C, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, -+0x02, 0xD1, 0xBC, 0x90, 0xA1, 0x28, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x08, -+0x90, 0x07, 0x78, 0x74, 0x0D, 0xF0, 0x80, 0x2D, 0x90, 0xA1, 0x2B, 0xE0, 0xFE, 0xC4, 0x54, 0x0F, -+0x30, 0xE0, 0x0D, 0xEE, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x0F, 0x80, 0x12, -+0x90, 0xA1, 0x2B, 0xE0, 0xFE, 0xC3, 0x13, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x03, 0xF0, -+0x80, 0x03, 0x74, 0x09, 0xF0, 0xEF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x07, 0xE4, -+0x90, 0xA3, 0x54, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0x54, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, -+0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x13, 0x90, 0xA1, 0x65, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0xA3, -+0x53, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0x53, 0x74, 0x01, 0xF0, 0x90, 0xA3, 0x53, 0xE0, 0xFF, 0xA3, -+0xE0, 0xFD, 0x12, 0x76, 0x95, 0x90, 0xA1, 0x39, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xFF, -+0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x80, 0x26, 0xEF, 0xC4, -+0x54, 0x0F, 0x30, 0xE0, 0x1F, 0x90, 0xA1, 0x2E, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0xA1, 0x27, 0xE0, -+0x60, 0x06, 0x7D, 0x01, 0x7F, 0x04, 0x80, 0x09, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x7D, 0x01, 0x7F, -+0x0C, 0x12, 0x53, 0x5E, 0x90, 0xA1, 0x27, 0xE0, 0x90, 0x05, 0x22, 0x60, 0x05, 0x74, 0x6F, 0xF0, -+0x80, 0x02, 0xE4, 0xF0, 0x90, 0xA1, 0x2B, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, -+0x05, 0x7F, 0x01, 0x12, 0x70, 0xF5, 0x22, 0x90, 0xA1, 0x08, 0xE0, 0x30, 0xE0, 0x10, 0xA3, 0x74, -+0x01, 0xF0, 0x90, 0xA1, 0x08, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x91, 0x33, 0x12, 0xBB, -+0x09, 0x61, 0x11, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA1, 0x07, 0xE0, 0xB4, 0x01, -+0x04, 0x7F, 0x04, 0x80, 0x0C, 0x12, 0x57, 0xEC, 0xBF, 0x01, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, -+0x02, 0xB1, 0x5C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x08, 0xE0, 0xFF, 0x30, 0xE0, 0x3D, -+0x90, 0xA1, 0x0C, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0xA1, 0x0B, 0xE0, 0x7D, -+0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x23, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, -+0x80, 0xB1, 0x91, 0x9E, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x08, 0x06, 0xE4, 0xFD, 0x7F, 0x0C, 0x80, -+0x09, 0x90, 0xA1, 0x0C, 0xE0, 0x70, 0x06, 0xFD, 0x7F, 0x04, 0x12, 0x53, 0x5E, 0x22, 0x90, 0xA1, -+0x08, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x0F, 0x90, 0xA1, 0x0C, 0xE0, 0x64, -+0x02, 0x60, 0x07, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x53, 0x5E, 0x90, 0xA1, 0x0C, 0xE0, 0x64, 0x02, -+0x60, 0x03, 0x12, 0x9B, 0x56, 0x22, 0x90, 0xA1, 0x08, 0xE0, 0xFF, 0x30, 0xE0, 0x3F, 0x90, 0xA1, -+0x0C, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0xA1, 0x0B, 0xE0, 0x7D, 0x00, 0xB4, -+0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x25, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x81, 0x33, -+0x12, 0xB9, 0x72, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x0C, 0x06, 0xE4, 0xFD, 0x7F, 0x08, 0x80, 0x0A, -+0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x04, 0x06, 0xE4, 0xFD, 0xFF, 0x12, 0x53, 0x5E, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x12, 0x06, 0x89, 0xFF, 0x90, -+0xA1, 0x07, 0xF0, 0xBF, 0x01, 0x12, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x90, 0x00, 0x01, 0x12, -+0x06, 0xA2, 0x64, 0x01, 0x60, 0x21, 0x80, 0x1D, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x90, 0x00, -+0x01, 0x12, 0x06, 0xA2, 0x64, 0x01, 0x60, 0x0F, 0x90, 0xA1, 0x08, 0xE0, 0x20, 0xE0, 0x06, 0xE4, -+0xFF, 0xB1, 0x5C, 0x80, 0x02, 0x91, 0x33, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0xA1, 0x0B, 0xE0, 0x90, 0xA3, 0x66, 0xF0, 0x6F, 0x70, 0x02, 0xC1, 0x52, -+0xEF, 0x14, 0x60, 0x3E, 0x14, 0x60, 0x62, 0x14, 0x70, 0x02, 0xC1, 0x05, 0x14, 0x70, 0x02, 0xC1, -+0x2C, 0x24, 0x04, 0x60, 0x02, 0xC1, 0x52, 0x90, 0xA3, 0x66, 0xE0, 0xFF, 0xB4, 0x04, 0x04, 0xD1, -+0x8F, 0xC1, 0x52, 0xEF, 0xB4, 0x02, 0x04, 0xD1, 0x9E, 0xC1, 0x52, 0x90, 0xA3, 0x66, 0xE0, 0xFF, -+0xB4, 0x03, 0x04, 0xD1, 0xA2, 0xC1, 0x52, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xC1, 0x52, 0xD1, 0x91, -+0xC1, 0x52, 0x90, 0xA3, 0x66, 0xE0, 0xFF, 0xB4, 0x04, 0x04, 0xF1, 0xE3, 0xC1, 0x52, 0xEF, 0xB4, -+0x02, 0x04, 0xD1, 0xA6, 0xC1, 0x52, 0x90, 0xA3, 0x66, 0xE0, 0xFF, 0xB4, 0x03, 0x04, 0xF1, 0xCE, -+0xC1, 0x52, 0xEF, 0x70, 0x7D, 0xD1, 0x79, 0x80, 0x79, 0x90, 0xA3, 0x66, 0xE0, 0xB4, 0x04, 0x05, -+0x12, 0x8B, 0x97, 0x80, 0x6D, 0x90, 0xA3, 0x66, 0xE0, 0xB4, 0x01, 0x04, 0xD1, 0x6F, 0x80, 0x62, -+0x90, 0xA3, 0x66, 0xE0, 0xB4, 0x03, 0x04, 0xF1, 0xD9, 0x80, 0x57, 0x90, 0xA3, 0x66, 0xE0, 0x70, -+0x51, 0xD1, 0x6D, 0x80, 0x4D, 0x90, 0xA3, 0x66, 0xE0, 0xFF, 0xB4, 0x04, 0x05, 0x12, 0xB9, 0x33, -+0x80, 0x40, 0xEF, 0xB4, 0x01, 0x04, 0xD1, 0x82, 0x80, 0x38, 0xEF, 0xB4, 0x02, 0x04, 0xD1, 0xB3, -+0x80, 0x30, 0x90, 0xA3, 0x66, 0xE0, 0x70, 0x2A, 0xD1, 0x80, 0x80, 0x26, 0x90, 0xA3, 0x66, 0xE0, -+0xFF, 0xB4, 0x03, 0x05, 0x12, 0xB9, 0x5E, 0x80, 0x19, 0xEF, 0xB4, 0x01, 0x04, 0xD1, 0x59, 0x80, -+0x11, 0xEF, 0xB4, 0x02, 0x05, 0x12, 0xB9, 0x47, 0x80, 0x08, 0x90, 0xA3, 0x66, 0xE0, 0x70, 0x02, -+0xD1, 0x57, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD1, 0x79, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, -+0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0xA1, 0x0B, 0x74, 0x04, 0xF0, 0x22, 0xD1, 0x79, 0x12, -+0x8A, 0x89, 0x90, 0xA1, 0x0B, 0x74, 0x02, 0xF0, 0x22, 0x90, 0xA1, 0x0B, 0x74, 0x01, 0xF0, 0x22, -+0xD1, 0x79, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x90, 0xA1, 0x0B, 0x74, 0x03, 0xF0, 0x22, 0xF1, -+0xE3, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0xE4, 0x90, 0xA1, 0x0B, 0xF0, 0x22, 0xD1, 0xA6, -+0x80, 0xEF, 0xF1, 0xCE, 0x80, 0xEB, 0xD1, 0xBC, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x0B, -+0x04, 0xF0, 0x22, 0xD1, 0xBC, 0x90, 0xA1, 0x0B, 0x74, 0x03, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x7F, 0x10, 0x12, 0x4B, 0x24, 0xEF, 0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x12, 0x4A, -+0x07, 0x7F, 0x72, 0x12, 0x4B, 0x24, 0xEF, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x12, 0x4A, 0x07, 0x90, -+0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0xA1, 0x26, 0xE0, -+0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x06, 0x90, 0x07, 0x78, 0x74, 0x03, 0xF0, 0x90, -+0xA1, 0x42, 0xE0, 0x20, 0xE0, 0x3A, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x34, 0x90, 0xA1, 0x65, 0xE0, -+0x60, 0x07, 0xE4, 0x90, 0xA3, 0x21, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0x21, 0x74, 0x01, 0xF0, 0x90, -+0xA1, 0x26, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0xA3, 0x22, 0x30, 0xE0, 0x05, 0x74, 0x01, 0xF0, -+0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0xA3, 0x21, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x76, 0x95, -+0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, -+0x12, 0x37, 0xBC, 0xEF, 0x54, 0xBF, 0xFF, 0xEC, 0x90, 0xA3, 0x1D, 0x12, 0x08, 0x6D, 0x90, 0xA3, -+0x1D, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x38, -+0x07, 0x7F, 0x02, 0x12, 0x4B, 0x24, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x12, 0x4A, 0x07, 0x7F, -+0x00, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0xA3, 0x1D, 0x12, 0x08, -+0x6D, 0x90, 0xA3, 0x1D, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0x00, 0x7E, -+0x0C, 0x12, 0x38, 0x07, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x03, 0xFF, 0xEC, -+0x90, 0xA3, 0x1D, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x1D, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, -+0x08, 0x6D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x38, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, -+0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x0B, 0x04, 0xF0, 0x22, 0x12, 0x8A, 0x8F, 0x90, 0xA1, 0x0B, 0x74, -+0x02, 0xF0, 0x22, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, 0x90, -+0xA1, 0x0B, 0x74, 0x01, 0xF0, 0x22, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, -+0xE0, 0x02, 0x21, 0x88, 0x90, 0xA1, 0x30, 0xE0, 0x64, 0x01, 0x70, 0x34, 0x90, 0x06, 0x92, 0xE0, -+0x20, 0xE2, 0x06, 0x90, 0x04, 0xE3, 0xE0, 0x60, 0x1C, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0x90, -+0xA1, 0x3C, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x31, 0xE0, 0xFF, 0x90, 0xA1, 0x3C, 0xE0, 0xB5, 0x07, -+0x02, 0x80, 0x02, 0x21, 0x73, 0xE4, 0x90, 0xA1, 0x30, 0xF0, 0x90, 0xA1, 0x3A, 0x04, 0xF0, 0x22, -+0x90, 0xA1, 0x30, 0xE0, 0x64, 0x04, 0x70, 0x35, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x06, 0x90, -+0x04, 0xE3, 0xE0, 0x60, 0x1C, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0x90, 0xA1, 0x3C, 0xE0, 0x04, -+0xF0, 0x90, 0xA1, 0x33, 0xE0, 0xFF, 0x90, 0xA1, 0x3C, 0xE0, 0xB5, 0x07, 0x02, 0x80, 0x02, 0x21, -+0x73, 0xE4, 0x90, 0xA1, 0x30, 0xF0, 0x90, 0xA1, 0x3A, 0x74, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0x30, -+0xE0, 0x64, 0x06, 0x60, 0x02, 0x21, 0x3C, 0x90, 0xA1, 0x3D, 0xE0, 0xB4, 0x04, 0x0F, 0x90, 0xA1, -+0x2B, 0xE0, 0xC4, 0x54, 0x0F, 0x90, 0xA1, 0x3A, 0x30, 0xE0, 0x4F, 0x21, 0x66, 0x90, 0xA1, 0x2F, -+0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x45, 0xEF, 0x54, 0xFB, 0xF0, 0xE4, 0xA3, 0xF0, -+0x90, 0xA1, 0x2B, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, 0x21, 0x4B, 0x90, 0xA1, 0x3D, 0xE0, -+0xFF, 0x90, 0xA1, 0x3C, 0xE0, 0x2F, 0xFF, 0xE4, 0x33, 0xFE, 0x7C, 0x00, 0x7D, 0x03, 0x12, 0x07, -+0x03, 0x90, 0xA1, 0x34, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xC3, 0xEF, 0x94, 0x32, 0xEE, 0x64, -+0x80, 0x94, 0x80, 0x90, 0xA1, 0x3A, 0x40, 0x02, 0x80, 0x7C, 0x74, 0x02, 0xF0, 0x22, 0x12, 0x56, -+0x1D, 0x90, 0xA1, 0x3D, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x75, 0x3C, 0x03, 0xFB, 0xFD, 0x7F, -+0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x6F, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0x3D, 0xE0, -+0xFF, 0x90, 0xA1, 0x3C, 0xE0, 0x2F, 0xFF, 0xE4, 0x33, 0xFE, 0x7C, 0x00, 0x7D, 0x03, 0x12, 0x07, -+0x03, 0x90, 0xA1, 0x34, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xC3, 0xEF, 0x94, 0x32, 0xEE, 0x64, -+0x80, 0x94, 0x80, 0x40, 0x53, 0x90, 0x07, 0x78, 0x74, 0x03, 0xF0, 0x22, 0x90, 0xA1, 0x30, 0xE0, -+0x64, 0x07, 0x70, 0x44, 0x90, 0xA1, 0x3D, 0xE0, 0xB4, 0x04, 0x05, 0x90, 0xA1, 0x3A, 0x80, 0x16, -+0x90, 0xA1, 0x2F, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0E, 0xEF, 0x54, 0xFB, 0xF0, -+0xE4, 0xA3, 0xF0, 0x90, 0xA1, 0x3A, 0x74, 0x05, 0xF0, 0x22, 0x12, 0x56, 0x1D, 0x90, 0xA1, 0x3D, -+0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x75, 0x3C, 0x03, 0xFB, 0xFD, 0x7F, 0x6C, 0x7E, 0x01, 0x12, -+0x35, 0x7A, 0x90, 0x01, 0x6F, 0x74, 0x05, 0xF0, 0x22, 0xE4, 0x90, 0xA2, 0x5E, 0xF0, 0x90, 0xA1, -+0x28, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x22, 0x90, 0xA1, 0x2C, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x30, 0xE0, 0x2A, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x34, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, -+0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0x90, 0xA1, 0x30, 0x74, -+0x01, 0xF0, 0xE4, 0x90, 0xA1, 0x3C, 0xF0, 0x90, 0xA1, 0x3A, 0xF0, 0x80, 0x20, 0xE4, 0xF5, 0x3B, -+0x90, 0xA2, 0x5E, 0xE0, 0xFF, 0x90, 0xA1, 0x29, 0xE0, 0xC3, 0x9F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, -+0x7F, 0x6C, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0xA1, 0x3A, 0x74, 0x01, 0xF0, 0x90, 0x01, 0x6F, -+0x74, 0x05, 0xF0, 0x90, 0xA1, 0x39, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x27, 0xE0, 0x60, 0x07, 0x90, -+0x05, 0x22, 0x74, 0x6F, 0xF0, 0x22, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x28, 0xE0, 0xFF, -+0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x0B, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x03, 0x12, -+0x7E, 0x40, 0x22, 0x90, 0xA2, 0x80, 0xEF, 0xF0, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0xE4, -+0xFE, 0xFD, 0xEC, 0x90, 0xA1, 0x43, 0x12, 0x08, 0x6D, 0x90, 0xA1, 0x42, 0xE0, 0x44, 0x01, 0x51, -+0x88, 0x90, 0x07, 0x78, 0xE0, 0x90, 0xA1, 0x47, 0xF0, 0x90, 0xA1, 0x65, 0xE0, 0xFF, 0xE4, 0xFD, -+0x12, 0x76, 0x95, 0x90, 0xA2, 0x80, 0xE0, 0xFD, 0x70, 0x02, 0x80, 0x24, 0xED, 0xB4, 0x01, 0x0A, -+0x90, 0xA1, 0x42, 0xE0, 0x54, 0x1F, 0x44, 0x20, 0xF0, 0x22, 0x90, 0xA2, 0x80, 0xE0, 0xFD, 0xB4, -+0x02, 0x0A, 0x90, 0xA1, 0x42, 0xE0, 0x54, 0x1F, 0x44, 0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x07, -+0x90, 0xA1, 0x42, 0xE0, 0x54, 0x1F, 0xF0, 0x22, 0xF0, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x77, 0x9E, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0xBC, -+0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA3, 0x23, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x23, 0x12, 0x48, -+0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x38, 0x07, 0x7F, 0x00, -+0x7E, 0x0E, 0x12, 0x37, 0xBC, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0xA3, 0x23, 0x12, 0x08, 0x6D, -+0x90, 0xA3, 0x23, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0x00, 0x7E, 0x0E, -+0x12, 0x38, 0x07, 0x7F, 0x02, 0x12, 0x4B, 0x24, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x4A, -+0x07, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0xA3, 0x23, -+0x12, 0x08, 0x6D, 0x90, 0xA3, 0x23, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, -+0xB4, 0x7E, 0x08, 0x12, 0x38, 0x07, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, -+0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0xA1, 0x26, 0xE0, 0xFF, 0x13, 0x13, 0x13, -+0x54, 0x1F, 0x30, 0xE0, 0x06, 0x90, 0x07, 0x78, 0x74, 0x01, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, -+0x3C, 0x90, 0xA1, 0x65, 0xE0, 0x60, 0x08, 0x90, 0xA3, 0x27, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, -+0x90, 0xA3, 0x27, 0xF0, 0x90, 0xA1, 0x26, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, -+0x90, 0xA3, 0x28, 0xF0, 0x80, 0x06, 0x90, 0xA3, 0x28, 0x74, 0x02, 0xF0, 0x90, 0xA3, 0x27, 0xE0, -+0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x76, 0x95, 0x90, 0x07, 0x78, 0x74, 0x01, 0xF0, 0x90, 0xA1, 0x25, -+0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x51, 0x89, 0x90, 0xA1, 0x13, 0x74, -+0x08, 0xF0, 0x90, 0xA1, 0x0C, 0xF0, 0x22, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0x51, 0x88, 0x90, -+0xA1, 0x0B, 0x74, 0x02, 0xF0, 0x22, 0x12, 0x77, 0x98, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, -+0x7F, 0x03, 0x12, 0x65, 0x55, 0x51, 0x8F, 0xE4, 0x90, 0xA1, 0x13, 0xF0, 0x90, 0xA1, 0x0C, 0xF0, -+0x22, 0x90, 0xFD, 0x65, 0xE0, 0x30, 0xE5, 0x1C, 0xE0, 0x90, 0xA2, 0x7F, 0x30, 0xE6, 0x05, 0x74, -+0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0xA2, 0x7F, 0xE0, 0xFF, 0x51, 0x23, 0x90, 0xA1, -+0xAA, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0xA1, 0x42, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, 0x90, -+0xA1, 0x47, 0xE0, 0x90, 0x07, 0x78, 0xF0, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0xE4, 0xFF, -+0xE4, 0xFC, 0x90, 0xA3, 0x33, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x33, 0x12, 0x48, 0xE5, 0x90, 0xA1, -+0x43, 0x12, 0x49, 0x01, 0x12, 0x48, 0xC7, 0x90, 0xA3, 0x33, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x33, -+0x12, 0x48, 0xE5, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0xB4, 0x7E, 0x0C, 0x12, 0x38, 0x07, -+0x02, 0x86, 0xBC, 0x12, 0x77, 0x4E, 0x90, 0xA1, 0x42, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0xFE, -+0xEF, 0xC3, 0x13, 0x54, 0x0F, 0xC3, 0x9E, 0x40, 0x04, 0x71, 0xE5, 0x80, 0x16, 0x90, 0xA1, 0x42, -+0xE0, 0xFF, 0xC3, 0x13, 0x54, 0x0F, 0xFE, 0xEF, 0x54, 0xE1, 0xFF, 0xEE, 0x04, 0x54, 0x0F, 0x25, -+0xE0, 0x4F, 0xF0, 0x90, 0xA1, 0xA9, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, -+0x06, 0x89, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x9F, 0x96, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, -+0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x9F, 0x97, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFF, 0xED, -+0x2F, 0x90, 0x9F, 0x98, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x9F, -+0x99, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x9F, 0x9A, -+0xF0, 0x22, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, 0xFE, -+0x12, 0x06, 0x89, 0xFD, 0xC3, 0x13, 0x30, 0xE0, 0x12, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x90, -+0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0xA2, 0x49, 0xF0, 0x80, 0x05, 0x90, 0xA2, 0x49, 0xEF, 0xF0, -+0x90, 0xA2, 0x48, 0xEE, 0xF0, 0x90, 0xA2, 0x49, 0xE0, 0xFE, 0x90, 0xA2, 0x48, 0xE0, 0xFF, 0xD3, -+0x9E, 0x50, 0x38, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x12, 0x06, 0x89, 0x54, 0x01, 0xFE, 0x74, -+0x87, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x87, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0x70, 0x04, 0xB1, 0x64, 0x80, 0x07, 0x90, 0xA2, 0x48, 0xE0, -+0xFF, 0xB1, 0x53, 0x90, 0xA2, 0x48, 0xE0, 0x04, 0xF0, 0x80, 0xBA, 0x90, 0xA0, 0x87, 0xE0, 0x70, -+0x21, 0x90, 0xA1, 0x13, 0xE0, 0x70, 0x04, 0xFF, 0x12, 0x55, 0x77, 0x90, 0xA1, 0x13, 0xE0, 0x64, -+0x0C, 0x60, 0x02, 0xB1, 0x75, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0x54, -+0x7F, 0xF0, 0x22, 0x8F, 0x53, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x49, 0x1D, 0xE0, -+0x54, 0xFB, 0xF0, 0x22, 0x8F, 0x53, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x49, 0x1D, -+0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x05, 0x22, 0xE4, -+0xF0, 0x90, 0xA1, 0x13, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x12, 0x06, -+0x89, 0xFF, 0x54, 0x7F, 0x90, 0xA1, 0x10, 0xF0, 0xEF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xA3, -+0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0xA1, -+0x0F, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0x54, 0x01, 0x25, 0xE0, -+0xFE, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, -+0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0x90, 0xA1, -+0x12, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x06, 0xA2, 0xFF, 0x54, 0x02, 0xFE, 0x90, 0xA1, 0x26, 0xE0, -+0x54, 0xFD, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xFF, 0xF0, 0x90, -+0x00, 0x05, 0x12, 0x06, 0xA2, 0xFE, 0x54, 0x08, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xFF, 0x90, 0xA1, -+0x26, 0xF0, 0xEE, 0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x12, -+0x06, 0xA2, 0xFE, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0xA1, 0x26, 0xF0, 0xEE, -+0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0xF0, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, -+0xE0, 0x37, 0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x0E, 0x90, 0xA2, 0x49, 0x74, 0x01, 0xF0, 0x90, 0xA1, -+0x65, 0xE0, 0x60, 0x0D, 0x80, 0x12, 0xE4, 0x90, 0xA2, 0x49, 0xF0, 0x90, 0xA1, 0x65, 0xE0, 0x60, -+0x07, 0xE4, 0x90, 0xA2, 0x48, 0xF0, 0x80, 0x06, 0x90, 0xA2, 0x48, 0x74, 0x01, 0xF0, 0x90, 0xA2, -+0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x76, 0x95, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0xD1, -+0xA6, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0xF0, 0x90, 0xA1, 0x10, 0xE0, 0x90, -+0x01, 0xBA, 0xF0, 0x90, 0xA1, 0x12, 0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x90, 0xA1, 0x0F, 0xE0, 0x54, -+0x0F, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, 0xA2, 0x4A, 0x12, 0x49, 0x32, 0xD1, 0xD5, 0x90, 0xA1, -+0x10, 0xE0, 0xFF, 0x12, 0x64, 0xCC, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x18, 0x90, 0xA2, 0x4A, 0x12, -+0x49, 0x29, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x54, 0x0F, 0xFF, 0x90, 0x00, 0x02, 0x12, 0x06, -+0xA2, 0xFD, 0xD1, 0xE6, 0x22, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA1, 0x19, -+0xF0, 0x90, 0xA1, 0x14, 0xF0, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0C, 0x04, 0x70, 0x28, 0x90, 0xA1, -+0x16, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x22, 0xED, 0x70, 0x0A, 0x90, 0xA1, 0x24, 0xE0, 0x90, 0xA1, -+0x16, 0xF0, 0x80, 0x05, 0x90, 0xA1, 0x16, 0xED, 0xF0, 0x90, 0xA1, 0x16, 0xE0, 0xA3, 0xF0, 0x90, -+0xA1, 0x0E, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFF, 0x30, 0xE0, -+0x26, 0x12, 0x06, 0x89, 0x90, 0xA1, 0x21, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0xA1, -+0x22, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xA3, 0xE0, 0x54, 0x01, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, -+0x06, 0xA2, 0x90, 0xA1, 0x24, 0xF0, 0x22, 0x90, 0xA1, 0x21, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, -+0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x22, 0x12, 0x06, 0x89, -+0x90, 0xA1, 0x1A, 0xF0, 0x22, 0x12, 0x06, 0x89, 0x90, 0xA1, 0x27, 0xF0, 0x60, 0x35, 0xA3, 0xE0, -+0x20, 0xE0, 0x30, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x53, 0x5E, 0x90, 0xA1, 0x26, 0xE0, 0xFF, 0xC3, -+0x13, 0x30, 0xE0, 0x1F, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x16, 0x90, 0xA1, 0x26, -+0xE0, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x07, 0x78, 0x30, 0xE0, 0x05, 0x74, 0x0D, 0xF0, 0x80, 0x03, -+0x74, 0x09, 0xF0, 0x90, 0xA1, 0x27, 0xE0, 0x90, 0x01, 0xE7, 0xF0, 0x22, 0x90, 0xA3, 0x4B, 0x12, -+0x49, 0x32, 0xE4, 0xFE, 0x90, 0xFD, 0x50, 0xEF, 0xF0, 0x64, 0x30, 0x60, 0x3B, 0xA3, 0xED, 0xF0, -+0xEE, 0xC3, 0x9D, 0x50, 0x1E, 0x90, 0xA3, 0x4B, 0x12, 0x49, 0x29, 0x8E, 0x82, 0x75, 0x83, 0x00, -+0x12, 0x06, 0xA2, 0xFF, 0x74, 0x52, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFD, 0xF5, 0x83, 0xEF, 0xF0, -+0x0E, 0x80, 0xDD, 0xEE, 0xC3, 0x94, 0x06, 0x50, 0x33, 0x74, 0x52, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -+0xFD, 0xF5, 0x83, 0xE4, 0xF0, 0x0E, 0x80, 0xEB, 0xEE, 0xC3, 0x94, 0x07, 0x50, 0x1E, 0x90, 0xA3, -+0x4B, 0x12, 0x49, 0x29, 0x8E, 0x82, 0x75, 0x83, 0x00, 0x12, 0x06, 0xA2, 0xFF, 0x74, 0x51, 0x2E, -+0xF5, 0x82, 0xE4, 0x34, 0xFD, 0xF5, 0x83, 0xEF, 0xF0, 0x0E, 0x80, 0xDC, 0x90, 0xFD, 0x58, 0x74, -+0x01, 0xF0, 0x90, 0xA1, 0x9A, 0xE0, 0x04, 0xF0, 0x90, 0xFD, 0x58, 0xE0, 0x90, 0xA1, 0xAF, 0xF0, -+0x90, 0xFD, 0x50, 0xE0, 0x90, 0xA1, 0xB0, 0xF0, 0x90, 0xFD, 0x51, 0xE0, 0x90, 0xA1, 0xB1, 0xF0, -+0x90, 0xFD, 0x52, 0xE0, 0x90, 0xA1, 0xB2, 0xF0, 0x90, 0xFD, 0x53, 0xE0, 0x90, 0xA1, 0xB3, 0xF0, -+0x90, 0xFD, 0x54, 0xE0, 0x90, 0xA1, 0xB4, 0xF0, 0x90, 0xFD, 0x55, 0xE0, 0x90, 0xA1, 0xB5, 0xF0, -+0x90, 0xFD, 0x56, 0xE0, 0x90, 0xA1, 0xB6, 0xF0, 0x90, 0xFD, 0x57, 0xE0, 0x90, 0xA1, 0xB7, 0xF0, -+0x22, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x90, 0xA3, 0x37, 0xE0, 0x70, 0x13, 0x7F, 0x58, 0x7E, -+0x0C, 0x12, 0x37, 0xBC, 0x90, 0xA1, 0x5D, 0x12, 0x08, 0x6D, 0x90, 0xA3, 0x37, 0x74, 0x01, 0xF0, -+0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x12, 0x06, 0x89, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0xA2, -+0x48, 0x12, 0x08, 0x6D, 0x90, 0xA1, 0x5D, 0x12, 0x48, 0xE5, 0xEC, 0x54, 0xC1, 0xFC, 0xC0, 0x04, -+0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xA2, 0x48, 0x12, 0x48, 0xE5, 0x78, 0x19, 0x12, 0x08, -+0x5A, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x48, 0xC7, 0x90, 0xA1, 0x59, 0x02, -+0x08, 0x6D, 0x12, 0x06, 0x89, 0x90, 0xA1, 0x65, 0xF0, 0x22, 0x12, 0x06, 0x89, 0x90, 0xA1, 0x4B, -+0xF0, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0xA3, 0x4E, 0xF0, 0x90, 0xA3, 0x4E, 0xE0, -+0xFD, 0x70, 0x02, 0x41, 0x96, 0x90, 0x9F, 0xEB, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, -+0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x9F, 0xEC, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, -+0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0xA3, 0x38, -+0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -+0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x41, 0x8F, 0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, -+0x90, 0x01, 0xD0, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA3, 0x4F, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, -+0xA3, 0x75, 0x42, 0x4F, 0x75, 0x43, 0x01, 0x7B, 0x01, 0x7A, 0xA3, 0x79, 0x50, 0x12, 0x34, 0x62, -+0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x90, -+0x9F, 0xEC, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0x9F, 0x9B, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, -+0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD1, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, -+0x08, 0xEE, 0x90, 0x9F, 0x9C, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, -+0x04, 0x90, 0x01, 0xD2, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x9F, 0x9D, -+0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD3, 0x12, -+0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x9F, 0x9E, 0x12, 0x49, 0x1D, 0xEF, 0xF0, -+0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF0, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, -+0xF0, 0x08, 0xEE, 0x90, 0x9F, 0x9F, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x75, -+0xF0, 0x04, 0x90, 0x01, 0xF1, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x9F, -+0xA0, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF2, -+0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x9F, 0xA1, 0x12, 0x49, 0x1D, 0xEF, -+0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF3, 0x12, 0x49, 0x1D, 0xE0, 0xFF, -+0x75, 0xF0, 0x08, 0xEE, 0x90, 0x9F, 0xA2, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x90, 0xA3, 0x4E, 0xE0, -+0xFF, 0x90, 0xA3, 0x38, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0xF4, 0x5F, 0x90, 0xA3, 0x4E, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, -+0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0xA3, 0x38, 0xE0, 0x04, -+0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x9F, 0xEC, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, -+0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x01, 0xEC, 0xE4, 0x90, 0x9F, 0xEC, 0xF0, 0x01, 0xEC, 0x90, -+0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0xE4, 0x90, 0xA0, 0x83, 0xF0, 0xA3, 0xF0, 0x90, 0x9F, -+0xEB, 0xF0, 0xA3, 0xF0, 0x22, 0x51, 0xB8, 0x51, 0x97, 0x91, 0x2F, 0x71, 0x0A, 0x51, 0xE5, 0x71, -+0x5D, 0x51, 0xBE, 0x51, 0xD0, 0x02, 0x77, 0xE6, 0xE4, 0x90, 0xA0, 0x87, 0xF0, 0x22, 0x90, 0xA1, -+0x6F, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, -+0x90, 0xA1, 0x72, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, -+0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0xA1, 0x08, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, -+0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0xE4, 0xA3, -+0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x0C, 0xF0, 0x22, 0xE4, 0xF5, 0x51, 0xE4, 0xF5, 0x52, -+0xE5, 0x52, 0xB4, 0x03, 0x1E, 0xFF, 0xE5, 0x51, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, -+0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x74, 0x40, -+0xF0, 0x80, 0x1B, 0xE5, 0x51, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, -+0x83, 0xE5, 0x82, 0x25, 0x52, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, 0x05, 0x52, -+0xE5, 0x52, 0xB4, 0x10, 0xBB, 0x05, 0x51, 0xE5, 0x51, 0xB4, 0x08, 0xB1, 0x22, 0xE4, 0x90, 0xA1, -+0x10, 0xF0, 0xA3, 0xF0, 0x90, 0xA1, 0x0F, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, 0xF0, 0x90, 0xA1, -+0x0D, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0xA1, 0x16, 0x74, 0x01, 0xF0, 0xA3, 0xF0, -+0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0xA1, 0x19, -+0xF0, 0x90, 0xA1, 0x18, 0x74, 0x07, 0xF0, 0x90, 0xA1, 0x1B, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF0, -+0xE4, 0x90, 0xA1, 0x14, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA1, 0x12, 0x74, -+0x0C, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0xA1, 0x13, 0x74, 0x0C, 0xF0, 0x90, -+0xA1, 0x0D, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, -+0xF0, 0x54, 0xF7, 0xF0, 0x90, 0xA1, 0x1D, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x90, 0x9F, -+0x95, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0xA1, 0x1A, 0x74, 0xFF, 0xF0, 0x80, 0x12, 0x90, 0x9F, 0x95, -+0xE0, 0x90, 0xA1, 0x1A, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x41, 0xF0, 0x90, -+0xA1, 0x21, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, -+0xA3, 0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, -+0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xE4, -+0x90, 0xA2, 0x3A, 0xF0, 0xE4, 0x90, 0xA2, 0x3B, 0xF0, 0x90, 0xA2, 0x3B, 0xE0, 0xFF, 0xC3, 0x94, -+0x10, 0x50, 0x75, 0x90, 0xA2, 0x3A, 0xE0, 0xFE, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, -+0x83, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x90, 0xA2, 0x3B, 0xB4, 0x03, 0x1B, 0xE0, 0xFF, 0x75, 0xF0, -+0x10, 0xEE, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, -+0xF5, 0x83, 0x74, 0x80, 0xF0, 0x80, 0x1B, 0xE0, 0xFF, 0x90, 0xA2, 0x3A, 0xE0, 0x75, 0xF0, 0x10, -+0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, -+0xE4, 0xF0, 0x90, 0xA2, 0x3B, 0xE0, 0xFF, 0x90, 0xA2, 0x3A, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, -+0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE4, 0xF0, -+0x90, 0xA2, 0x3B, 0xE0, 0x04, 0xF0, 0x80, 0x81, 0x90, 0xA2, 0x3A, 0xE0, 0x04, 0xF0, 0xE0, 0x64, -+0x80, 0x60, 0x02, 0x81, 0x34, 0xE4, 0x90, 0xAD, 0xE2, 0xF0, 0x90, 0xA2, 0x3A, 0xF0, 0x90, 0xA2, -+0x3A, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0x90, 0x8D, 0x01, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, -+0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, 0x03, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, -+0x0A, 0xEF, 0x90, 0x8D, 0x05, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, -+0x90, 0x8D, 0x07, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x8D, -+0x09, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9E, -+0xF5, 0x83, 0x74, 0x3F, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE4, -+0xF0, 0x74, 0x92, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x74, 0xC0, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x01, 0xF5, -+0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x98, 0xF5, 0x83, 0xE4, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, -+0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9C, -+0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x92, 0x12, 0x49, 0x1D, -+0x74, 0x3F, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x93, 0x12, 0x49, 0x1D, 0x74, 0x03, 0xF0, -+0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xE0, 0x44, 0x09, 0xF0, -+0x90, 0xA2, 0x3A, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, -+0xF3, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xFC, 0xF0, -+0x90, 0xA2, 0x3A, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0x44, -+0x20, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xCF, 0xF0, -+0x90, 0xA2, 0x3A, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x44, -+0x40, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0x7F, 0xF0, -+0x90, 0xA2, 0x3A, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x92, 0x12, 0x49, 0x1D, 0xE0, 0xFE, -+0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xEE, 0xF0, 0x90, 0xA2, 0x3A, 0xE0, -+0xFF, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x74, 0x92, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0x3A, 0xE0, 0x04, 0xF0, 0xE0, -+0x64, 0x80, 0x60, 0x02, 0x81, 0xCE, 0xE4, 0x90, 0xA2, 0x3C, 0xF0, 0x90, 0xA2, 0x3C, 0xE0, 0xFF, -+0xC3, 0x94, 0x20, 0x50, 0x14, 0x74, 0x78, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE4, -+0xF0, 0x90, 0xA2, 0x3C, 0xE0, 0x04, 0xF0, 0x80, 0xE2, 0x90, 0x04, 0x49, 0x74, 0xF0, 0xF0, 0xA3, -+0xE4, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0x33, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x04, 0xF0, -+0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x04, 0xF0, 0x90, 0xA2, 0x3A, 0xE0, 0x24, 0x92, 0xF5, -+0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0xA3, 0x3B, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0xA3, -+0x3B, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x2D, 0xC3, 0x90, 0xA3, 0x3E, -+0xE0, 0x94, 0xE8, 0x90, 0xA3, 0x3D, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, -+0x80, 0xF0, 0x7F, 0x00, 0x80, 0x15, 0x90, 0xA3, 0x3D, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, -+0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x80, 0xC5, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x43, 0x12, 0x49, 0x32, 0x7F, 0x96, 0x7E, -+0x02, 0xD1, 0xAA, 0xEF, 0x60, 0x59, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, -+0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0xA3, -+0x46, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0xA3, 0x46, 0xE0, 0xFD, 0x90, 0x02, -+0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xA3, 0x43, 0x12, 0x49, 0x29, 0x90, 0x00, 0x0E, 0x12, 0x06, -+0xA2, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0xF1, 0xC4, 0x90, 0xA3, 0x46, 0xE0, 0x24, 0x18, 0xFF, -+0x90, 0xA3, 0x43, 0x12, 0x49, 0x29, 0x12, 0x98, 0x1F, 0x90, 0x02, 0x96, 0x74, 0x01, 0xF0, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA2, 0xE5, -+0xF0, 0x90, 0x01, 0xC7, 0xE0, 0x64, 0xAD, 0x70, 0x36, 0xF0, 0x90, 0xA2, 0xF2, 0x74, 0x0F, 0xF0, -+0x90, 0xA2, 0xE4, 0x74, 0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0xA2, 0xE5, 0xE0, 0x2F, 0xFE, -+0x74, 0xE6, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x0F, -+0xE9, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, 0xA2, 0x79, 0xE4, 0xF1, 0x00, 0xD0, -+0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -+0x83, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xEE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, -+0xF5, 0x83, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, -+0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, -+0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, -+0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, -+0xA3, 0x3F, 0xEF, 0xF0, 0xA3, 0x12, 0x49, 0x32, 0x90, 0xA3, 0x39, 0xE0, 0xFE, 0x04, 0xF0, 0x90, -+0x00, 0x01, 0xEE, 0x12, 0x06, 0xE1, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, -+0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0xA3, 0x40, 0x12, 0x49, 0x29, 0x8B, 0x40, 0x8A, 0x41, -+0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, 0xA3, -+0x3F, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, -+0x01, 0xA3, 0x12, 0x49, 0x29, 0xE9, 0x24, 0x02, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, -+0x42, 0x90, 0xA3, 0x40, 0x12, 0x49, 0x29, 0x90, 0x00, 0x0E, 0x12, 0x06, 0xA2, 0xF5, 0x43, 0xD0, -+0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x62, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -+0xA2, 0x42, 0x12, 0x49, 0x32, 0x90, 0xA3, 0x3A, 0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, -+0x12, 0x06, 0xE1, 0x7F, 0xAF, 0x7E, 0x01, 0x12, 0x96, 0xAA, 0xEF, 0x60, 0x3A, 0x90, 0xA2, 0x42, -+0x12, 0x49, 0x29, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x90, 0x00, 0x0E, 0x12, 0x06, 0xA2, 0x24, -+0x02, 0xF5, 0x43, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x34, 0x62, 0x90, 0xA2, 0x42, 0x12, -+0x49, 0x29, 0x90, 0x00, 0x0E, 0x12, 0x06, 0xA2, 0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, -+0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0xA0, 0x84, 0xE0, 0xFE, 0x90, 0xA0, 0x83, 0xE0, 0xFD, 0xB5, -+0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x49, 0x90, 0x01, 0xAF, -+0xE0, 0x70, 0x13, 0xED, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xED, 0xF9, 0x74, 0x9F, 0x35, 0xF0, 0xFA, -+0x7B, 0x01, 0x11, 0x98, 0x7F, 0x01, 0x90, 0xA0, 0x83, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xED, -+0xF9, 0x74, 0x9F, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x12, 0x97, 0x00, 0x7F, 0x01, 0xEF, 0x60, 0x16, -+0x90, 0xA0, 0x83, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, -+0x05, 0xE4, 0x90, 0xA0, 0x83, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, -+0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, -+0x01, 0x9A, 0xE0, 0x54, 0xC0, 0xF0, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x01, 0x99, -+0xE0, 0x44, 0xC0, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x80, 0xF0, 0x22, 0x90, 0x01, 0x9A, 0xE0, 0x54, -+0xC0, 0x44, 0x0B, 0xF0, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x01, 0x98, 0xE0, 0x54, -+0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0xA2, 0x3A, 0xF0, 0xA3, 0xF0, -+0x31, 0x9B, 0xEF, 0x64, 0x01, 0x60, 0x45, 0xC3, 0x90, 0xA2, 0x3B, 0xE0, 0x94, 0x88, 0x90, 0xA2, -+0x3A, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, -+0x74, 0x03, 0xF0, 0x80, 0x27, 0x90, 0xA2, 0x3A, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x7F, -+0x14, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xD3, 0x90, 0xA2, 0x3B, 0xE0, 0x94, 0x32, 0x90, 0xA2, 0x3A, -+0xE0, 0x94, 0x00, 0x40, 0xBB, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB4, 0x90, 0x01, 0xC7, 0x74, -+0x05, 0xF0, 0x22, 0x7F, 0x02, 0x90, 0xA1, 0x6E, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, -+0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, -+0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x9F, 0x92, 0xF0, 0xA3, -+0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x0B, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, -+0x34, 0xE0, 0x55, 0x15, 0xF5, 0x19, 0xA3, 0xE0, 0x55, 0x16, 0xF5, 0x1A, 0xA3, 0xE0, 0x55, 0x17, -+0xF5, 0x1B, 0xA3, 0xE0, 0x55, 0x18, 0xF5, 0x1C, 0x90, 0x01, 0x34, 0xE5, 0x19, 0xF0, 0xA3, 0xE5, -+0x1A, 0xF0, 0xA3, 0xE5, 0x1B, 0xF0, 0xA3, 0xE5, 0x1C, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, -+0x1D, 0xF5, 0x21, 0xA3, 0xE0, 0x55, 0x1E, 0xF5, 0x22, 0xA3, 0xE0, 0x55, 0x1F, 0xF5, 0x23, 0xA3, -+0xE0, 0x55, 0x20, 0xF5, 0x24, 0x90, 0x01, 0x3C, 0xE5, 0x21, 0xF0, 0xA3, 0xE5, 0x22, 0xF0, 0xA3, -+0xE5, 0x23, 0xF0, 0xA3, 0xE5, 0x24, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0xA1, 0x08, 0xE0, 0x30, -+0xE0, 0x05, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0xA0, 0x87, 0xE0, 0x64, 0x01, 0x70, 0x2A, -+0x90, 0xA1, 0x10, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, -+0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x22, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, -+0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x22, 0x90, 0xA0, 0x87, 0xE0, 0x64, -+0x01, 0x70, 0x26, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x20, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, -+0x3C, 0x74, 0x02, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA1, 0x14, 0xE0, 0x54, -+0xFD, 0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x53, 0x43, 0x22, 0x90, 0xA0, 0x87, 0xE0, 0xB4, 0x01, -+0x14, 0x90, 0xA1, 0x10, 0xE0, 0x60, 0x0E, 0x90, 0xA1, 0x14, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x07, -+0x70, 0x03, 0x12, 0x53, 0x43, 0x22, 0x90, 0xA1, 0x10, 0xE0, 0x70, 0x07, 0x90, 0xA1, 0x08, 0xE0, -+0x30, 0xE0, 0x12, 0x90, 0xA1, 0x08, 0xE0, 0x30, 0xE0, 0x08, 0x12, 0x57, 0xEC, 0xBF, 0x01, 0x05, -+0x80, 0x04, 0x12, 0x55, 0xEE, 0x22, 0x90, 0xA1, 0x10, 0xE0, 0x64, 0x02, 0x60, 0x14, 0x90, 0xA1, -+0x0F, 0xE0, 0x54, 0x0F, 0x60, 0x0C, 0x12, 0x57, 0xF8, 0xEF, 0x70, 0x06, 0xFD, 0x7F, 0x0C, 0x12, -+0x53, 0x5E, 0x22, 0x90, 0xA1, 0x8C, 0xE0, 0x04, 0xF0, 0xE4, 0xFF, 0x90, 0xA1, 0xB9, 0xEF, 0xF0, -+0xE4, 0xF5, 0x69, 0x74, 0xBA, 0x25, 0x69, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0xE4, 0xF0, -+0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x03, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x30, 0xE7, 0x10, -+0xE5, 0x69, 0x70, 0x1E, 0xEF, 0x30, 0xE6, 0x1A, 0x90, 0xA1, 0x89, 0xE0, 0x04, 0xF0, 0x80, 0x12, -+0xAF, 0x69, 0xB1, 0x45, 0x74, 0xBA, 0x25, 0x69, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, 0x74, -+0x01, 0xF0, 0x05, 0x69, 0xE5, 0x69, 0xC3, 0x94, 0x80, 0x40, 0xB8, 0x7F, 0x0C, 0x7E, 0x00, 0x12, -+0x3D, 0x7A, 0xE4, 0xF5, 0x69, 0x74, 0xBA, 0x25, 0x69, 0xF5, 0x82, 0xE4, 0x34, 0xA1, 0xF5, 0x83, -+0xE0, 0x70, 0x02, 0xA1, 0x39, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x06, 0x12, 0x49, 0x1D, -+0xE0, 0xF5, 0x67, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x07, 0x12, 0x49, 0x1D, 0xE0, 0xF5, -+0x68, 0xFE, 0xE5, 0x67, 0xFF, 0xE5, 0x69, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, -+0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x0A, 0x12, -+0x49, 0x1D, 0xE0, 0xF5, 0x67, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x0B, 0x12, 0x49, 0x1D, -+0xE0, 0xF5, 0x68, 0xFE, 0xE5, 0x67, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x69, 0x90, 0x8D, 0x01, 0x12, -+0x49, 0x1D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x0C, 0x12, -+0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x69, 0x90, 0x8D, 0x03, 0x12, 0x49, 0x1D, 0xE4, -+0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x0D, 0x12, 0x49, 0x1D, 0xE0, -+0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x69, 0x90, 0x8D, 0x05, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xEF, -+0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x69, 0x90, 0x81, 0x0E, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, -+0x0A, 0xE5, 0x69, 0x90, 0x8D, 0x07, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, -+0x10, 0xE5, 0x69, 0x90, 0x81, 0x0F, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x75, 0xF0, 0x0A, 0xE5, 0x69, -+0x90, 0x8D, 0x09, 0x12, 0x49, 0x1D, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x69, -+0x90, 0x81, 0x09, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x74, 0x12, 0x25, 0x69, 0xF5, 0x82, 0xE4, 0x34, -+0x98, 0xF5, 0x83, 0xEF, 0xF0, 0xE5, 0x69, 0x70, 0x56, 0xE5, 0x68, 0x30, 0xE7, 0x05, 0x90, 0xA1, -+0x88, 0x80, 0x49, 0xE5, 0x68, 0x30, 0xE6, 0x05, 0x90, 0xA1, 0x87, 0x80, 0x3F, 0xE5, 0x68, 0x30, -+0xE5, 0x05, 0x90, 0xA1, 0x86, 0x80, 0x35, 0xE5, 0x68, 0x30, 0xE4, 0x05, 0x90, 0xA1, 0x85, 0x80, -+0x2B, 0xE5, 0x68, 0x30, 0xE3, 0x05, 0x90, 0xA1, 0x84, 0x80, 0x21, 0xE5, 0x68, 0x30, 0xE2, 0x05, -+0x90, 0xA1, 0x83, 0x80, 0x17, 0xE5, 0x68, 0x30, 0xE1, 0x05, 0x90, 0xA1, 0x82, 0x80, 0x0D, 0xE5, -+0x68, 0x30, 0xE0, 0x05, 0x90, 0xA1, 0x81, 0x80, 0x03, 0x90, 0xA1, 0x80, 0xE0, 0x04, 0xF0, 0x90, -+0xA1, 0xB9, 0xE0, 0xFD, 0xAF, 0x69, 0x12, 0x6E, 0xA6, 0x05, 0x69, 0xE5, 0x69, 0xC3, 0x94, 0x80, -+0x50, 0x02, 0x61, 0xD5, 0x22, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x03, 0x12, 0x49, 0x1D, 0xE0, -+0x44, 0x40, 0xF0, 0x22, 0x02, 0x5E, 0xEE, 0xB1, 0xA0, 0x90, 0xA2, 0x6E, 0xEF, 0xF0, 0x90, 0xA1, -+0x0D, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0xA2, -+0x6E, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, -+0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0xA1, 0x0D, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0xA1, 0x1B, -+0xE4, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x90, 0xA1, 0x1B, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, -+0xE4, 0x90, 0xA2, 0x6F, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x4B, 0x24, 0x90, 0xA2, -+0x6F, 0xEF, 0xF0, 0x7F, 0x83, 0x12, 0x4B, 0x24, 0xAE, 0x07, 0x90, 0xA2, 0x6F, 0xE0, 0xFF, 0xB5, -+0x06, 0x01, 0x22, 0xC3, 0x90, 0xA2, 0x71, 0xE0, 0x94, 0x64, 0x90, 0xA2, 0x70, 0xE0, 0x94, 0x00, -+0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA2, 0x6F, 0xE0, 0xFF, 0x22, 0x90, -+0xA2, 0x70, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x80, 0xBE, 0x22, 0x90, 0xA1, 0x0D, 0xE0, -+0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x4A, 0xEF, 0x54, 0x7F, 0xF0, 0x90, 0x04, -+0xE0, 0xE0, 0x90, 0xA1, 0x0E, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x0F, 0xE0, 0x54, -+0xFD, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x90, 0xA1, 0x2C, -+0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x11, 0x90, 0xA1, 0x2F, 0xE0, 0xFF, 0xC3, -+0x13, 0x30, 0xE0, 0x07, 0xEF, 0x44, 0x04, 0xF0, 0x54, 0xFD, 0xF0, 0x90, 0xA1, 0x10, 0xE0, 0x60, -+0x03, 0x12, 0x53, 0x43, 0x7F, 0x01, 0x02, 0x56, 0xC2, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x0A, 0x0D, -+0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x1E, -+0x90, 0xFD, 0x11, 0xE0, 0xB5, 0x05, 0x14, 0x90, 0x01, 0x17, 0xE0, 0xB5, 0x05, 0x07, 0x90, 0xFD, -+0x11, 0xE4, 0xF0, 0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, 0x11, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0x8F, -+0x6D, 0xE4, 0x90, 0xA3, 0x5B, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, -+0x02, 0x7F, 0x01, 0xEF, 0x65, 0x6D, 0x60, 0x3E, 0xC3, 0x90, 0xA3, 0x5C, 0xE0, 0x94, 0x88, 0x90, -+0xA3, 0x5B, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, -+0xA3, 0x5B, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3D, 0x7A, -+0xD3, 0x90, 0xA3, 0x5C, 0xE0, 0x94, 0x32, 0x90, 0xA3, 0x5B, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, -+0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB2, 0x22, 0xF1, 0x86, 0x7F, 0x08, 0x12, 0x4B, 0x24, 0xEF, 0x54, -+0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x4A, 0x07, 0xE4, 0xFF, 0x80, 0x94, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0xF1, 0x3D, 0xD1, 0xD7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0xA1, 0x13, 0xE0, 0xFF, -+0x60, 0x03, 0xB4, 0x08, 0x0D, 0xF1, 0x9D, 0xBF, 0x01, 0x08, 0xD1, 0xEB, 0x90, 0x01, 0xE5, 0xE0, -+0x04, 0xF0, 0x22, 0x90, 0xA1, 0x0D, 0xE0, 0x30, 0xE0, 0x22, 0x90, 0xA1, 0x08, 0xE0, 0xFF, 0x30, -+0xE0, 0x18, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xF1, 0x90, 0xBF, 0x01, 0x10, 0x80, 0x0A, 0x90, 0xA1, -+0x0C, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x04, 0x80, 0xB1, 0xD1, 0xFB, 0x22, 0x90, 0xA1, 0x1A, -+0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x4A, 0x07, 0x90, 0xA1, 0x11, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, -+0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x7F, -+0x08, 0x12, 0x4B, 0x24, 0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x4A, 0x07, 0x7F, 0x01, 0xD1, -+0x7F, 0x7F, 0x90, 0x12, 0x4B, 0x24, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x4A, 0x07, 0x7F, -+0x14, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0x7F, 0x90, 0x12, 0x4B, 0x24, 0xEF, 0x20, 0xE0, 0xF7, 0x22, -+0x90, 0xA1, 0x0B, 0xE0, 0x64, 0x02, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x90, 0x02, 0x96, -+0xE0, 0xFF, 0x90, 0x02, 0x87, 0xE0, 0x4F, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, -+0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x08, -+0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x7F, 0x00, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA2, 0xF3, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0xA3, 0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0xA2, 0xF6, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x14, -+0x74, 0xF8, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0xF6, 0xE0, -+0x04, 0xF0, 0x80, 0xE2, 0x90, 0xA2, 0xF5, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, 0x12, 0x49, -+0x1D, 0xE0, 0xC4, 0x54, 0x03, 0x90, 0xA3, 0x00, 0xF0, 0x64, 0x01, 0x70, 0x52, 0x90, 0xA2, 0xF5, -+0xE0, 0xFF, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0xF8, 0xF0, -+0x75, 0xF0, 0x08, 0xEF, 0x90, 0x89, 0x01, 0x12, 0x49, 0x1D, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA2, -+0xF9, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xEE, 0x54, 0xF0, 0xA3, 0xF0, 0x90, 0xA2, -+0xF5, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0xFE, 0xF0, -+0x75, 0xF0, 0x08, 0xEF, 0x90, 0x89, 0x03, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0xFF, 0xF0, 0x90, -+0xA3, 0x00, 0xE0, 0xFC, 0xC3, 0x94, 0x02, 0x40, 0x64, 0x90, 0xA2, 0xF5, 0xE0, 0xFE, 0x75, 0xF0, -+0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0xF8, 0xF0, 0x75, 0xF0, 0x08, 0xEE, -+0x90, 0x89, 0x01, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0xF9, 0xF0, 0x90, 0xA2, 0xF5, 0xE0, 0x75, -+0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0xFA, 0xF0, 0x75, 0xF0, 0x08, -+0xEE, 0x90, 0x89, 0x03, 0x12, 0x49, 0x1D, 0xE0, 0xFE, 0x54, 0x0F, 0x90, 0xA2, 0xFB, 0xF0, 0xEE, -+0x54, 0xF0, 0x90, 0xA2, 0xF7, 0xF0, 0xEC, 0xB4, 0x03, 0x0B, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x90, -+0xA2, 0xFF, 0xF0, 0x80, 0x08, 0x90, 0xA2, 0xF7, 0xE0, 0x90, 0xA2, 0xFE, 0xF0, 0xE4, 0x90, 0xA2, -+0xF6, 0xF0, 0x90, 0xA2, 0xF6, 0xE0, 0xFF, 0x24, 0xF8, 0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, -+0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFE, 0xEF, 0xFD, 0x90, 0xA2, 0xF4, 0xE0, 0x2D, 0xFD, 0x90, 0xA2, -+0xF3, 0xE0, 0x34, 0x00, 0x8D, 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, 0x5F, 0xD0, 0x82, 0xD0, 0x83, -+0xF0, 0x90, 0xA2, 0xF6, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xC7, 0x90, 0xA2, 0xFD, 0xE0, 0xFF, -+0xC4, 0x54, 0x0F, 0x70, 0x08, 0xA3, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x37, 0x90, 0xA3, 0x00, -+0xE0, 0x64, 0x01, 0x70, 0x2F, 0x90, 0xA2, 0xF9, 0xE0, 0x54, 0x0F, 0xFE, 0x90, 0xA2, 0xF7, 0xF0, -+0xEF, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0xA2, 0xF9, 0xF0, 0x90, 0xA2, 0xFE, 0xE0, 0x90, 0xA2, 0xFA, -+0xF0, 0x90, 0xA2, 0xFF, 0xE0, 0x90, 0xA2, 0xFB, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, -+0xA3, 0x74, 0x80, 0xF0, 0x90, 0xA3, 0x00, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, 0x26, 0xEF, 0x90, -+0xA2, 0xFB, 0xB4, 0x02, 0x08, 0xE0, 0xFF, 0x90, 0xA2, 0xFE, 0xE0, 0x80, 0x0A, 0xE0, 0xFF, 0x90, -+0xA2, 0xFF, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0xFE, 0xEF, 0x4E, 0x90, 0xA2, 0xFB, 0xF0, 0x90, 0xA2, -+0xFF, 0x74, 0x80, 0xF0, 0xE4, 0x90, 0xA2, 0xF6, 0xF0, 0x90, 0xA2, 0xF6, 0xE0, 0xFF, 0x24, 0xF8, -+0xF5, 0x82, 0xE4, 0x34, 0xA2, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0xA2, 0xF5, 0xE0, 0x75, 0xF0, 0x08, -+0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, -+0xEE, 0xF0, 0x90, 0xA2, 0xF6, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x08, 0xCD, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0x90, 0xA2, 0x54, 0xEF, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0xD1, 0xF0, 0x74, 0xA1, 0xA3, 0xF0, -+0x90, 0xA2, 0x54, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0xB4, -+0xBE, 0x02, 0x7F, 0x3F, 0xEF, 0xB4, 0xB3, 0x02, 0x7F, 0x34, 0x90, 0xA2, 0x55, 0xEF, 0xF0, 0xE4, -+0x90, 0xA2, 0x5B, 0xF0, 0x90, 0xA2, 0x55, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xA3, 0xF0, 0xEF, 0x54, -+0x80, 0xA3, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x92, 0x12, 0x49, -+0x1D, 0xE0, 0x90, 0xA2, 0x59, 0xF0, 0x75, 0xF0, 0x04, 0xEF, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, -+0xE0, 0xFF, 0xC4, 0x54, 0x03, 0x90, 0xA2, 0x5A, 0xF0, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x42, 0x41, -+0x12, 0x49, 0x1D, 0x12, 0x48, 0xF1, 0xAD, 0x07, 0x90, 0xA2, 0x54, 0xE0, 0xFB, 0x25, 0xE0, 0x24, -+0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xED, 0xF0, 0x75, 0xF0, 0x04, -+0xEB, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0xFE, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA2, 0x58, -+0xF0, 0x74, 0x92, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x30, 0xE0, 0x40, 0x90, -+0xA2, 0x56, 0xE0, 0x64, 0x3F, 0x70, 0x38, 0x74, 0x3E, 0xF0, 0x75, 0xF0, 0x04, 0xEB, 0x90, 0x95, -+0x94, 0x12, 0x49, 0x1D, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0xA2, 0x55, 0x74, -+0xBE, 0xF0, 0x80, 0x08, 0x90, 0xA2, 0x56, 0xE0, 0x90, 0xA2, 0x55, 0xF0, 0xAF, 0x03, 0x90, 0xA2, -+0x55, 0xE0, 0xFD, 0x90, 0xA2, 0x58, 0xE0, 0x90, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, 0xE1, 0x71, 0x90, -+0xA2, 0x59, 0xE0, 0xFF, 0x90, 0xA2, 0x56, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0xC1, 0xDC, 0xE0, 0xFF, -+0x90, 0xA2, 0x54, 0xE0, 0xFE, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xEF, 0xF0, -+0xEF, 0x64, 0x2C, 0x70, 0x35, 0x75, 0xF0, 0x04, 0xEE, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, -+0xFF, 0x54, 0x03, 0xFE, 0x90, 0xA2, 0x58, 0xE0, 0x6E, 0x60, 0x1F, 0xE0, 0x04, 0xF0, 0xE0, 0x54, -+0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0x90, 0xA2, 0x54, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x95, 0x95, -+0x12, 0x49, 0x1D, 0xEF, 0x54, 0xF3, 0x4E, 0xF0, 0xC1, 0xD6, 0x90, 0xA2, 0x56, 0xE0, 0xFF, 0xC3, -+0x94, 0x0C, 0x40, 0x1F, 0xEF, 0x94, 0x13, 0x50, 0x1A, 0x90, 0xA2, 0x54, 0xE0, 0xFF, 0x24, 0x92, -+0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0xFE, 0x20, 0xE3, 0x07, 0x90, 0xA2, 0x5B, 0x74, -+0x01, 0x80, 0x27, 0x90, 0xA2, 0x56, 0xE0, 0xFF, 0xC3, 0x94, 0x2C, 0x40, 0x2E, 0xEF, 0x94, 0x35, -+0x50, 0x29, 0x90, 0xA2, 0x54, 0xE0, 0xFF, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, -+0xE0, 0xFE, 0x20, 0xE3, 0x16, 0x90, 0xA2, 0x5B, 0x74, 0x02, 0xF0, 0x74, 0x92, 0x2F, 0xF5, 0x82, -+0xE4, 0x34, 0x99, 0xF5, 0x83, 0xEE, 0x44, 0x08, 0xF0, 0x80, 0x16, 0xE4, 0x90, 0xA2, 0x5B, 0xF0, -+0x90, 0xA2, 0x54, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x54, 0xF7, -+0xF0, 0x90, 0xA2, 0x5B, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x81, 0x81, 0x90, 0xA2, 0x54, 0xE0, 0x75, -+0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0x1D, 0xE0, 0x20, 0xE7, 0x1C, 0x20, 0xE6, 0x19, 0x20, -+0xE5, 0x16, 0x20, 0xE4, 0x13, 0x90, 0xA2, 0x54, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x12, -+0x49, 0x1D, 0xE0, 0x20, 0xE0, 0x02, 0x81, 0x81, 0x90, 0xA2, 0x54, 0xE0, 0xFF, 0x24, 0x92, 0xF5, -+0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0xA2, 0x56, 0xE0, 0xFE, 0xB4, -+0x0C, 0x0C, 0x74, 0x14, 0xF0, 0x90, 0xA2, 0x55, 0xF0, 0x74, 0x12, 0x2F, 0x80, 0x14, 0xEE, 0xB4, -+0x0D, 0x1C, 0x90, 0xA2, 0x56, 0x74, 0x15, 0xF0, 0x90, 0xA2, 0x55, 0xF0, 0x90, 0xA2, 0x54, 0xE0, -+0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x80, 0x5F, 0x90, 0xA2, -+0x56, 0xE0, 0xFF, 0xB4, 0x0E, 0x04, 0x74, 0x15, 0x80, 0x09, 0xEF, 0xB4, 0x0F, 0x1C, 0x90, 0xA2, -+0x56, 0x74, 0x16, 0xF0, 0x90, 0xA2, 0x55, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0x24, 0x12, 0xF5, 0x82, -+0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0x03, 0xF0, 0x80, 0x33, 0x90, 0xA2, 0x56, 0xE0, 0xFF, 0xC3, -+0x94, 0x10, 0x40, 0x04, 0x74, 0x17, 0x80, 0x10, 0xEF, 0xC3, 0x94, 0x11, 0x40, 0x1F, 0x90, 0xA2, -+0x56, 0xE0, 0x94, 0x13, 0x50, 0x17, 0x74, 0x18, 0xF0, 0x90, 0xA2, 0x55, 0xF0, 0x90, 0xA2, 0x54, -+0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0x02, 0xF0, 0x90, 0xA2, 0x54, -+0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA2, 0x58, 0xE0, 0x90, 0xA3, 0x04, 0xF0, 0x7B, 0x01, 0xE1, -+0x71, 0x90, 0xA2, 0x5B, 0xE0, 0x64, 0x02, 0x60, 0x02, 0xA1, 0x25, 0x90, 0xA2, 0x54, 0xE0, 0x75, -+0xF0, 0x08, 0x90, 0x89, 0x02, 0x12, 0x49, 0x1D, 0xE0, 0x20, 0xE6, 0x1A, 0x20, 0xE7, 0x17, 0x90, -+0xA2, 0x54, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x89, 0x03, 0x12, 0x49, 0x1D, 0xE0, 0x20, 0xE0, 0x06, -+0x20, 0xE1, 0x03, 0x30, 0xE2, 0x6F, 0x90, 0xA2, 0x56, 0xE0, 0xFF, 0x64, 0x2C, 0x60, 0x04, 0xEF, -+0xB4, 0x2D, 0x07, 0x90, 0xA2, 0x56, 0x74, 0x36, 0x80, 0x42, 0xEF, 0x64, 0x2E, 0x60, 0x04, 0xEF, -+0xB4, 0x2F, 0x07, 0x90, 0xA2, 0x56, 0x74, 0x37, 0x80, 0x32, 0xEF, 0xB4, 0x30, 0x07, 0x90, 0xA2, -+0x56, 0x74, 0x38, 0x80, 0x27, 0xEF, 0xB4, 0x31, 0x07, 0x90, 0xA2, 0x56, 0x74, 0x39, 0x80, 0x1C, -+0xEF, 0xC3, 0x94, 0x32, 0x40, 0x0D, 0xEF, 0xD3, 0x94, 0x34, 0x50, 0x07, 0x90, 0xA2, 0x56, 0x74, -+0x3A, 0x80, 0x09, 0xEF, 0xB4, 0x35, 0x0A, 0x90, 0xA2, 0x56, 0x74, 0x3B, 0xF0, 0x90, 0xA2, 0x55, -+0xF0, 0x90, 0xA2, 0x54, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA2, 0x58, 0xE0, 0x90, 0xA3, 0x04, -+0xF0, 0x7B, 0x01, 0xE1, 0x71, 0x90, 0xA2, 0x54, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, -+0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0xA2, 0x5A, 0xE0, 0xFF, 0xB4, 0x01, 0x0F, 0x90, 0xA2, -+0x56, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE0, 0xF0, 0x80, 0x27, 0xEF, 0xB4, 0x02, -+0x0F, 0x90, 0xA2, 0x56, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, -+0x90, 0xA2, 0x5A, 0xE0, 0xB4, 0x03, 0x0D, 0x90, 0xA2, 0x56, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, -+0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA2, 0x5A, 0xE0, 0xFF, 0xB4, 0x01, 0x0F, 0x90, 0xA2, 0x59, 0xE0, -+0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE0, 0xF0, 0x80, 0x27, 0xEF, 0xB4, 0x02, 0x0F, 0x90, -+0xA2, 0x59, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, 0x90, 0xA2, -+0x5A, 0xE0, 0xB4, 0x03, 0x0D, 0x90, 0xA2, 0x59, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, -+0xDE, 0xF0, 0x90, 0xA2, 0x56, 0xE0, 0x04, 0xFD, 0x90, 0xA2, 0x59, 0xE0, 0xFF, 0xED, 0xD3, 0x9F, -+0x40, 0x02, 0xC1, 0x48, 0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0x90, 0xA2, 0x54, 0xE0, 0xFC, -+0x75, 0xF0, 0x08, 0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, -+0x83, 0xF5, 0x83, 0xE0, 0xFB, 0x7A, 0x00, 0xED, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, -+0x07, 0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5A, 0xFE, 0xEF, -+0x5B, 0x4E, 0x60, 0x41, 0x74, 0x12, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0x90, -+0xA2, 0x56, 0xB4, 0x13, 0x28, 0x74, 0x18, 0xF0, 0x90, 0xA2, 0x55, 0xF0, 0x90, 0xA2, 0x54, 0xE0, -+0xFF, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x44, 0x04, 0xF0, 0x74, 0x12, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x74, 0x05, 0xF0, 0x80, 0x0B, 0xED, 0xF0, 0x90, -+0xA2, 0x55, 0xF0, 0x80, 0x03, 0x0D, 0xA1, 0xB8, 0x90, 0xA2, 0x5A, 0xE0, 0xFF, 0xB4, 0x01, 0x1A, -+0x90, 0xA2, 0x55, 0xE0, 0xFE, 0xD3, 0x94, 0x0B, 0x40, 0x10, 0xEE, 0x94, 0x34, 0x50, 0x0B, 0xE0, -+0x24, 0x20, 0xF0, 0xA3, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x31, 0xEF, 0xB4, 0x02, 0x14, 0x90, 0xA2, -+0x55, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x0B, 0xE0, 0x24, 0x18, 0xF0, 0xA3, 0xE0, 0x24, 0x18, 0xF0, -+0x80, 0x19, 0x90, 0xA2, 0x5A, 0xE0, 0xB4, 0x03, 0x12, 0x90, 0xA2, 0x55, 0xE0, 0xD3, 0x94, 0x1B, -+0x40, 0x09, 0xE0, 0x24, 0x22, 0xF0, 0xA3, 0xE0, 0x24, 0x22, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0xFF, -+0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x20, 0xE0, 0x02, 0xE1, 0x5F, 0x90, -+0xA2, 0x56, 0xE0, 0x64, 0x3F, 0x60, 0x02, 0xE1, 0x5F, 0x74, 0x3E, 0xF0, 0x75, 0xF0, 0x04, 0xEF, -+0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x08, 0x90, 0xA2, -+0x55, 0x74, 0xBE, 0xF0, 0xE1, 0x5F, 0x90, 0xA2, 0x56, 0xE0, 0x80, 0x7F, 0x90, 0xA2, 0x59, 0xE0, -+0xFF, 0x90, 0xA2, 0x56, 0xE0, 0xFE, 0x6F, 0x70, 0x57, 0x90, 0xA2, 0x55, 0xE0, 0xFF, 0x90, 0xA2, -+0x54, 0xE0, 0xFD, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xEF, 0xF0, 0x75, 0xF0, -+0x04, 0xED, 0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0xFD, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, -+0x09, 0xEF, 0x20, 0xE7, 0x05, 0xEE, 0x44, 0x80, 0x80, 0x41, 0x90, 0xA2, 0x56, 0xE0, 0x75, 0xF0, -+0x04, 0x90, 0x42, 0x41, 0x12, 0x49, 0x1D, 0x12, 0x48, 0xF1, 0x90, 0xA2, 0x54, 0xE0, 0x25, 0xE0, -+0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x80, 0x34, -+0x90, 0xA2, 0x59, 0xE0, 0xFF, 0x90, 0xA2, 0x54, 0xE0, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9F, -+0xF5, 0x83, 0xEF, 0xF0, 0x90, 0xA2, 0x56, 0xEF, 0xF0, 0x54, 0x80, 0x90, 0xA2, 0x55, 0xF0, 0x90, -+0xA2, 0x54, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0xA2, 0x58, 0xE0, 0x90, 0xA3, 0x04, 0xF0, 0x7B, -+0x01, 0x12, 0x69, 0x1C, 0x90, 0xA2, 0x55, 0xE0, 0xFF, 0x22, 0x7D, 0x01, 0xAF, 0x53, 0x8F, 0x5E, -+0xAC, 0x05, 0x90, 0x01, 0xC4, 0x74, 0x7E, 0xF0, 0x74, 0xA7, 0xA3, 0xF0, 0x75, 0xF0, 0x10, 0xE5, -+0x5E, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE0, 0xFF, 0x90, 0xA2, 0x55, 0xF0, 0xBF, 0xBE, 0x03, -+0x74, 0x3F, 0xF0, 0x90, 0xA2, 0x55, 0xE0, 0xB4, 0xB3, 0x03, 0x74, 0x34, 0xF0, 0x90, 0xA2, 0x55, -+0xE0, 0x54, 0x7F, 0x90, 0xA2, 0x54, 0xF0, 0x54, 0x7F, 0xF9, 0x90, 0xA2, 0x5A, 0xF0, 0x75, 0xF0, -+0x04, 0xE5, 0x5E, 0x90, 0x95, 0x93, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0x5C, 0xF0, 0x75, 0xF0, -+0x04, 0xE5, 0x5E, 0x90, 0x95, 0x92, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, 0x5D, 0xF0, 0xFA, 0x75, -+0xF0, 0x10, 0xE5, 0x5E, 0x90, 0x81, 0x05, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0x03, 0x90, 0xA2, 0x56, -+0xF0, 0x90, 0xA2, 0x5A, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, -+0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE5, 0x5E, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, -+0xE4, 0x34, 0x94, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x5E, 0x90, -+0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0xC4, 0x54, 0x03, 0x90, 0xA2, 0x57, 0xF0, 0x74, 0x12, 0x25, -+0x5E, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xEB, 0xF0, 0xE9, 0xD3, 0x9A, 0x40, 0x0C, 0x90, -+0xA2, 0x5D, 0xE0, 0x90, 0xA2, 0x5A, 0xF0, 0x90, 0xA2, 0x54, 0xF0, 0xEC, 0x70, 0x02, 0x41, 0x69, -+0x90, 0xA2, 0x5B, 0xEC, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0x30, 0xE7, 0x0E, 0x90, 0xA2, 0x5A, 0xE0, -+0x90, 0xA2, 0x54, 0xF0, 0x90, 0xA2, 0x5B, 0xE0, 0x14, 0xF0, 0x90, 0xA2, 0x5B, 0xE0, 0x70, 0x02, -+0x41, 0x69, 0x90, 0xA2, 0x5A, 0xE0, 0xFC, 0x64, 0x2C, 0x70, 0x38, 0x75, 0xF0, 0x04, 0xE5, 0x5E, -+0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0xFD, 0x54, 0x03, 0xFF, 0x90, 0xA2, 0x56, 0xE0, 0x6F, -+0x60, 0x21, 0xE0, 0x14, 0xF0, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x75, 0xF0, 0x04, -+0xE5, 0x5E, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xED, 0x54, 0xF3, 0x4F, 0xF0, 0x90, 0xA2, 0x5B, -+0xE0, 0x14, 0xF0, 0x90, 0xA2, 0x5B, 0xE0, 0x70, 0x02, 0x41, 0x69, 0x90, 0xA2, 0x5C, 0xE0, 0xFD, -+0xEC, 0xD3, 0x9D, 0x50, 0x02, 0x41, 0x61, 0xE4, 0x90, 0xA2, 0x59, 0xF0, 0x90, 0xA2, 0x57, 0xE0, -+0xFE, 0xB4, 0x01, 0x16, 0x90, 0xA2, 0x5A, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x0D, 0xE0, 0x24, 0xE0, -+0xF0, 0x90, 0xA2, 0x54, 0xE0, 0x24, 0xE0, 0xF0, 0x80, 0x35, 0xEE, 0xB4, 0x02, 0x16, 0x90, 0xA2, -+0x5A, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x0D, 0xE0, 0x24, 0xE8, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0x24, -+0xE8, 0xF0, 0x80, 0x1B, 0x90, 0xA2, 0x57, 0xE0, 0xB4, 0x03, 0x14, 0x90, 0xA2, 0x5A, 0xE0, 0xC3, -+0x94, 0x2C, 0x40, 0x0B, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0x24, 0xDE, 0xF0, 0x90, -+0xA2, 0x57, 0xE0, 0xFF, 0xB4, 0x01, 0x0F, 0xED, 0xC3, 0x94, 0x2C, 0x40, 0x09, 0x90, 0xA2, 0x5C, -+0xE0, 0x24, 0xE0, 0xF0, 0x80, 0x27, 0xEF, 0xB4, 0x02, 0x0F, 0x90, 0xA2, 0x5C, 0xE0, 0xC3, 0x94, -+0x2C, 0x40, 0x06, 0xE0, 0x24, 0xE8, 0xF0, 0x80, 0x14, 0x90, 0xA2, 0x57, 0xE0, 0xB4, 0x03, 0x0D, -+0x90, 0xA2, 0x5C, 0xE0, 0xC3, 0x94, 0x2C, 0x40, 0x04, 0xE0, 0x24, 0xDE, 0xF0, 0x90, 0xA2, 0x5A, -+0xE0, 0x14, 0x90, 0xA2, 0x58, 0xF0, 0x90, 0xA2, 0x5C, 0xE0, 0xFF, 0x90, 0xA2, 0x58, 0xE0, 0xC3, -+0x9F, 0x50, 0x02, 0x21, 0xF9, 0xE0, 0xFB, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFF, 0x75, 0xF0, 0x08, -+0xE5, 0x5E, 0x90, 0x89, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE4, 0x35, 0x83, -+0xF5, 0x83, 0xE0, 0xFD, 0x7C, 0x00, 0xEB, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, -+0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, -+0x4E, 0x60, 0x3E, 0x74, 0x12, 0x25, 0x5E, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0xB4, -+0x14, 0x08, 0x90, 0xA2, 0x54, 0x74, 0x0C, 0xF0, 0x80, 0x08, 0x90, 0xA2, 0x58, 0xE0, 0x90, 0xA2, -+0x54, 0xF0, 0x90, 0xA2, 0x59, 0xE0, 0x04, 0xF0, 0x90, 0xA2, 0x5B, 0xE0, 0xFF, 0x90, 0xA2, 0x59, -+0xE0, 0x6F, 0x60, 0x15, 0x90, 0xA2, 0x5C, 0xE0, 0xFF, 0x90, 0xA2, 0x54, 0xE0, 0xD3, 0x9F, 0x40, -+0x08, 0x90, 0xA2, 0x58, 0xE0, 0x14, 0xF0, 0x21, 0x66, 0x90, 0xA2, 0x57, 0xE0, 0xFE, 0xB4, 0x01, -+0x1B, 0x90, 0xA2, 0x54, 0xE0, 0xFF, 0xD3, 0x94, 0x0B, 0x40, 0x11, 0xEF, 0x94, 0x34, 0x50, 0x0C, -+0xE0, 0x24, 0x20, 0xF0, 0x90, 0xA2, 0x5A, 0xE0, 0x24, 0x20, 0x80, 0x33, 0xEE, 0xB4, 0x02, 0x15, -+0x90, 0xA2, 0x54, 0xE0, 0xD3, 0x94, 0x1B, 0x40, 0x0C, 0xE0, 0x24, 0x18, 0xF0, 0x90, 0xA2, 0x5A, -+0xE0, 0x24, 0x18, 0x80, 0x1A, 0x90, 0xA2, 0x57, 0xE0, 0xB4, 0x03, 0x2D, 0x90, 0xA2, 0x54, 0xE0, -+0xD3, 0x94, 0x1B, 0x40, 0x24, 0xE0, 0x24, 0x22, 0xF0, 0x90, 0xA2, 0x5A, 0xE0, 0x24, 0x22, 0xF0, -+0x74, 0x12, 0x25, 0x5E, 0xF5, 0x82, 0xE4, 0x34, 0x9F, 0xF5, 0x83, 0xE0, 0x24, 0x20, 0xF0, 0x80, -+0x08, 0x90, 0xA2, 0x5C, 0xE0, 0x90, 0xA2, 0x54, 0xF0, 0x90, 0xA2, 0x54, 0xE0, 0xFD, 0x90, 0xA2, -+0x56, 0xE0, 0x90, 0xA3, 0x04, 0xF0, 0xE4, 0xFB, 0xAF, 0x5E, 0x12, 0x69, 0x1C, 0x90, 0xA2, 0x54, -+0xE0, 0xFF, 0x22, 0x90, 0x01, 0xC4, 0x74, 0x83, 0xF0, 0x74, 0xAA, 0xA3, 0xF0, 0xE4, 0xF5, 0x53, -+0x74, 0x87, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0xA0, 0xF5, 0x83, 0xE0, 0x70, 0x03, 0x02, 0xB4, -+0x95, 0x75, 0xF0, 0x04, 0xE5, 0x53, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0xC4, 0x13, 0x13, -+0x13, 0x54, 0x01, 0x30, 0xE0, 0x03, 0x02, 0xB4, 0x95, 0xE5, 0x53, 0x25, 0xE0, 0x24, 0x01, 0xF5, -+0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xD3, 0x94, 0x00, 0xEE, 0x94, 0x00, -+0x50, 0x03, 0x02, 0xB4, 0x95, 0xE5, 0x53, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x01, 0xF9, 0x74, 0x8D, -+0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x8B, 0x57, 0xF5, 0x58, 0x89, 0x59, 0xE5, 0x53, 0x25, 0xE0, 0x24, -+0x01, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0xA2, 0x45, 0xCF, -+0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE0, -+0xFF, 0x90, 0xA2, 0x47, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x07, 0xAB, 0xFF, -+0xAE, 0xF0, 0x12, 0x07, 0x80, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, 0x90, 0x00, 0x04, 0x12, 0x07, -+0xAB, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, 0x12, 0x07, 0xAB, 0x2F, 0xFF, 0xEE, -+0x35, 0xF0, 0xFE, 0x90, 0x00, 0x08, 0x12, 0x07, 0xAB, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x90, 0xA2, -+0x49, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x53, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, -+0xE0, 0xFF, 0x90, 0xA2, 0x44, 0xF0, 0xBF, 0xBE, 0x03, 0x74, 0x3F, 0xF0, 0x90, 0xA2, 0x44, 0xE0, -+0xB4, 0xB3, 0x03, 0x74, 0x34, 0xF0, 0x90, 0xA2, 0x44, 0xE0, 0x90, 0xA2, 0x42, 0xF0, 0x54, 0x7F, -+0xA3, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x53, 0x90, 0x95, 0x92, 0x12, 0x49, 0x1D, 0xE0, 0x90, 0xA2, -+0x4C, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x53, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x13, 0x13, -+0x54, 0x03, 0x90, 0xA2, 0x4E, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, -+0x83, 0xE0, 0x20, 0xE2, 0x02, 0x81, 0x35, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x99, -+0xF5, 0x83, 0xE0, 0x60, 0x70, 0x90, 0xA2, 0x43, 0xE0, 0xFF, 0xC3, 0x94, 0x0C, 0x40, 0x66, 0xEF, -+0xD3, 0x94, 0x13, 0x50, 0x60, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, -+0xE0, 0x14, 0xF0, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x60, -+0x03, 0x02, 0xB4, 0xA1, 0x90, 0xA2, 0x43, 0xE0, 0xFB, 0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, -+0x34, 0x43, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE4, 0xFC, 0xFD, 0x75, 0xF0, -+0x04, 0xEB, 0x90, 0x42, 0x41, 0x12, 0x49, 0x1D, 0x12, 0x49, 0x0D, 0x12, 0x48, 0xAD, 0x78, 0x01, -+0x12, 0x08, 0x47, 0xE5, 0x53, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, -+0xE0, 0xC3, 0x94, 0x05, 0x40, 0x02, 0xE1, 0xCF, 0x90, 0xA2, 0x4C, 0xE0, 0xFF, 0x90, 0xA2, 0x43, -+0xE0, 0x9F, 0x40, 0x13, 0x90, 0xA2, 0x4C, 0xE0, 0x90, 0xA2, 0x43, 0xF0, 0x90, 0xA2, 0x42, 0xE0, -+0x54, 0x80, 0xFE, 0xF0, 0xEF, 0x4E, 0xF0, 0x90, 0xA2, 0x43, 0xE0, 0xFF, 0x90, 0x41, 0xED, 0x93, -+0xFE, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFD, 0xC3, 0x9E, -+0x40, 0x06, 0xEF, 0x90, 0x41, 0x45, 0x80, 0x07, 0x90, 0xA2, 0x43, 0xE0, 0x90, 0x41, 0x99, 0x93, -+0x90, 0xA2, 0x4B, 0xF0, 0x90, 0xA1, 0x66, 0xE0, 0x60, 0x54, 0x90, 0xA2, 0x43, 0xE0, 0xFF, 0x64, -+0x13, 0x60, 0x04, 0xEF, 0xB4, 0x0B, 0x05, 0x90, 0xA1, 0x68, 0x80, 0x27, 0x90, 0xA2, 0x43, 0xE0, -+0xFF, 0x64, 0x12, 0x60, 0x04, 0xEF, 0xB4, 0x0A, 0x05, 0x90, 0xA1, 0x69, 0x80, 0x15, 0x90, 0xA2, -+0x43, 0xE0, 0xFF, 0x64, 0x11, 0x60, 0x04, 0xEF, 0xB4, 0x09, 0x05, 0x90, 0xA1, 0x6A, 0x80, 0x03, -+0x90, 0xA1, 0x67, 0xE0, 0xF5, 0x5D, 0xED, 0xC3, 0x9E, 0x90, 0xA2, 0x43, 0xE0, 0x40, 0x05, 0x90, -+0x41, 0x45, 0x80, 0x03, 0x90, 0x41, 0x99, 0x93, 0x25, 0x5D, 0x90, 0xA2, 0x4B, 0xF0, 0x90, 0xA2, -+0x4B, 0xE0, 0x75, 0xF0, 0x06, 0xA4, 0x24, 0xA3, 0xF9, 0x74, 0x40, 0x35, 0xF0, 0x75, 0x54, 0xFF, -+0xF5, 0x55, 0x89, 0x56, 0x90, 0xA2, 0x42, 0xE0, 0x90, 0x44, 0x99, 0x93, 0xFF, 0xD3, 0x90, 0xA2, -+0x48, 0xE0, 0x9F, 0x90, 0xA2, 0x47, 0xE0, 0x94, 0x00, 0x40, 0x06, 0x12, 0xA7, 0x7A, 0x02, 0xB3, -+0xF4, 0xC3, 0x90, 0xA2, 0x46, 0xE0, 0x94, 0x0F, 0x90, 0xA2, 0x45, 0xE0, 0x94, 0x00, 0x50, 0x68, -+0xAB, 0x57, 0xAA, 0x58, 0xA9, 0x59, 0x90, 0x00, 0x06, 0x12, 0x07, 0xAB, 0xFF, 0xAE, 0xF0, 0x90, -+0x00, 0x08, 0x12, 0x07, 0xAB, 0x2F, 0xFD, 0xE5, 0xF0, 0x3E, 0xFC, 0x90, 0xA2, 0x45, 0xE0, 0xC3, -+0x13, 0xFE, 0xA3, 0xE0, 0x13, 0xFF, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x05, 0x12, 0xA7, 0x7A, -+0x80, 0x36, 0x90, 0xA2, 0x45, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xAE, 0x04, 0x78, 0x02, 0xCE, 0xC3, -+0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFB, 0xAA, 0x06, 0xEC, 0xC3, 0x13, 0xFE, 0xED, 0x13, 0x2B, 0xFF, -+0xEE, 0x3A, 0xFE, 0xAB, 0x57, 0xAA, 0x58, 0xA9, 0x59, 0x12, 0x07, 0x80, 0xD3, 0x9F, 0xE5, 0xF0, -+0x9E, 0x40, 0x05, 0xAF, 0x53, 0x12, 0xA1, 0xD1, 0xE5, 0x53, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, -+0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0xF5, 0x5A, 0xA3, 0xE0, 0xF5, 0x5B, 0x90, 0xA2, 0x45, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x08, 0x90, 0xA2, 0x4D, 0x74, -+0x05, 0xF0, 0x80, 0x16, 0xD3, 0xEF, 0x94, 0xC8, 0xEE, 0x94, 0x00, 0x40, 0x08, 0x90, 0xA2, 0x4D, -+0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x4D, 0xF0, 0xAB, 0x57, 0xAA, 0x58, 0xA9, 0x59, -+0x12, 0x07, 0x80, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0x4D, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, -+0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x54, 0xAA, 0x55, 0xA9, 0x56, 0x12, -+0x06, 0x89, 0xFD, 0x7C, 0x00, 0x12, 0x07, 0x03, 0xEF, 0x25, 0x5B, 0xF5, 0x5B, 0xEE, 0x35, 0x5A, -+0xF5, 0x5A, 0xAB, 0x57, 0xAA, 0x58, 0xA9, 0x59, 0x90, 0x00, 0x02, 0x12, 0x07, 0xAB, 0xFF, 0xAE, -+0xF0, 0x90, 0xA2, 0x4D, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, -+0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x54, 0xAA, 0x55, 0xA9, 0x56, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, -+0xFD, 0x7C, 0x00, 0x12, 0x07, 0x03, 0xEF, 0x25, 0x5B, 0xF5, 0x5B, 0xEE, 0x35, 0x5A, 0xF5, 0x5A, -+0xAB, 0x57, 0xAA, 0x58, 0xA9, 0x59, 0x90, 0x00, 0x04, 0x12, 0x07, 0xAB, 0xFF, 0xAE, 0xF0, 0x90, -+0xA2, 0x4D, 0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, -+0xF9, 0xFF, 0xAB, 0x54, 0xAA, 0x55, 0xA9, 0x56, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFD, 0x7C, -+0x00, 0x12, 0x07, 0x03, 0xEF, 0x25, 0x5B, 0xF5, 0x5B, 0xEE, 0x35, 0x5A, 0xF5, 0x5A, 0xAB, 0x57, -+0xAA, 0x58, 0xA9, 0x59, 0x90, 0x00, 0x06, 0x12, 0x07, 0xAB, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0x4D, -+0xE0, 0xFD, 0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, -+0xAB, 0x54, 0xAA, 0x55, 0xA9, 0x56, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFD, 0x7C, 0x00, 0x12, -+0x07, 0x03, 0xEF, 0x25, 0x5B, 0xF5, 0x5B, 0xEE, 0x35, 0x5A, 0xF5, 0x5A, 0xAB, 0x57, 0xAA, 0x58, -+0xA9, 0x59, 0x90, 0x00, 0x08, 0x12, 0x07, 0xAB, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0x4D, 0xE0, 0xFD, -+0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xAB, 0x54, -+0xAA, 0x55, 0xA9, 0x56, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0xFD, 0x7C, 0x00, 0x12, 0x07, 0x03, -+0xEF, 0x25, 0x5B, 0xF5, 0x5B, 0xEE, 0x35, 0x5A, 0xF5, 0x5A, 0x90, 0x00, 0x05, 0x12, 0x06, 0xA2, -+0xFD, 0x90, 0xA2, 0x4D, 0xE0, 0xFF, 0x90, 0xA2, 0x45, 0xE0, 0xFE, 0xA3, 0xE0, 0xA8, 0x07, 0x08, -+0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x07, 0x03, 0xD3, 0xE5, 0x5B, -+0x9F, 0xE5, 0x5A, 0x9E, 0x40, 0x0C, 0xE5, 0x5B, 0x9F, 0xF5, 0x5B, 0xE5, 0x5A, 0x9E, 0xF5, 0x5A, -+0x80, 0x05, 0xE4, 0xF5, 0x5A, 0xF5, 0x5B, 0xE5, 0x53, 0x25, 0xE0, 0x24, 0x11, 0xF5, 0x82, 0xE4, -+0x34, 0x94, 0xF5, 0x83, 0xE5, 0x5A, 0xF0, 0xA3, 0xE5, 0x5B, 0xF0, 0xAE, 0x5A, 0xFF, 0xE4, 0xFC, -+0xFD, 0x90, 0xA2, 0x43, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x42, 0x41, 0x12, 0x49, 0x1D, 0x12, 0x49, -+0x0D, 0xC3, 0x12, 0x48, 0xD4, 0x50, 0x07, 0xAF, 0x53, 0x12, 0xA1, 0xD1, 0x80, 0x2C, 0x90, 0xA2, -+0x43, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0x91, 0xF5, 0x82, 0xE4, 0x34, 0x43, 0xF5, 0x83, 0xD3, 0x74, -+0x01, 0x93, 0x95, 0x5B, 0xE4, 0x93, 0x95, 0x5A, 0x40, 0x10, 0xEF, 0x64, 0x36, 0x60, 0x04, 0x7D, -+0x01, 0x80, 0x02, 0x7D, 0x09, 0xAF, 0x53, 0x12, 0xA7, 0x7E, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, -+0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x20, 0xE0, 0x03, 0x02, 0xB3, 0xC8, 0x90, 0xA2, 0x43, 0xE0, -+0x64, 0x3F, 0x60, 0x03, 0x02, 0xB3, 0xC8, 0xAF, 0x53, 0x12, 0xA1, 0xD1, 0x02, 0xB3, 0xC8, 0x74, -+0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE0, 0xFF, 0x64, 0x05, 0x60, 0x03, -+0x02, 0xB2, 0x22, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE4, 0xF0, -+0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFE, 0xB4, 0x05, 0x0D, -+0x90, 0xA2, 0x43, 0xE0, 0xC3, 0x94, 0x3B, 0x50, 0x02, 0x01, 0x8A, 0x80, 0x60, 0xEE, 0xB4, 0x04, -+0x0B, 0x90, 0xA2, 0x43, 0xE0, 0xC3, 0x94, 0x31, 0x40, 0x70, 0x80, 0x51, 0x74, 0x12, 0x25, 0x53, -+0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFE, 0xB4, 0x03, 0x0B, 0x90, 0xA2, 0x43, 0xE0, -+0xC3, 0x94, 0x19, 0x40, 0x55, 0x80, 0x36, 0xEE, 0xB4, 0x02, 0x0B, 0x90, 0xA2, 0x43, 0xE0, 0xC3, -+0x94, 0x11, 0x40, 0x46, 0x80, 0x27, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, -+0x83, 0xE0, 0xFE, 0xB4, 0x01, 0x0B, 0x90, 0xA2, 0x43, 0xE0, 0xC3, 0x94, 0x0A, 0x40, 0x2B, 0x80, -+0x0C, 0xEE, 0x70, 0x19, 0x90, 0xA2, 0x43, 0xE0, 0xC3, 0x94, 0x03, 0x40, 0x1D, 0x74, 0x92, 0x25, -+0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x80, 0x0D, 0x74, 0x92, 0x25, -+0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, -+0xE4, 0x34, 0x97, 0xF5, 0x83, 0xE0, 0x90, 0xA2, 0x4F, 0xF0, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, -+0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFE, 0xC3, 0x94, 0x30, 0x50, 0x13, 0xE4, 0x90, 0xA2, 0x4F, -+0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, 0x21, 0x65, 0x74, -+0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x21, -+0x8E, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x64, 0x0A, 0x60, -+0x51, 0xEE, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0x74, 0x81, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, -+0x93, 0xF5, 0x83, 0xE0, 0xFE, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x50, 0x32, -+0xEE, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, -+0xF5, 0x83, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x50, 0x14, 0x74, 0x12, -+0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0xA2, 0x43, 0xE0, 0x6E, -+0x60, 0x3F, 0x90, 0xA2, 0x4F, 0xE0, 0xFE, 0x70, 0x04, 0x04, 0xF0, 0x80, 0x0F, 0xEE, 0x90, 0xA2, -+0x4F, 0xB4, 0x01, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x03, 0x74, 0x05, 0xF0, 0x74, 0x12, 0x25, 0x53, -+0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x81, 0x25, 0x53, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0x80, -+0x2B, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x12, -+0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x12, 0xE4, 0x90, -+0xA2, 0x4F, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9D, 0xF5, 0x83, 0xE4, 0xF0, -+0x90, 0xA2, 0x43, 0xE0, 0xFE, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9E, 0xF5, 0x83, -+0xEE, 0xF0, 0x90, 0xA2, 0x4F, 0xE0, 0xFE, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x97, -+0xF5, 0x83, 0xEE, 0xF0, 0x75, 0xF0, 0x04, 0xE5, 0x53, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, -+0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x1E, 0x74, 0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, -+0x9B, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0x4F, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, -+0x34, 0x9D, 0xF5, 0x83, 0xE4, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x53, 0x90, 0x81, 0x01, 0x12, 0x49, -+0x1D, 0xE0, 0x54, 0xF8, 0xFE, 0x90, 0xA2, 0x52, 0xF0, 0x90, 0xA2, 0x4F, 0xE0, 0x4E, 0xFE, 0x90, -+0xA2, 0x52, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x53, 0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, 0xEE, 0xF0, -+0x61, 0xC8, 0xEF, 0x64, 0x06, 0x60, 0x02, 0x61, 0xC8, 0xF5, 0x5A, 0xF5, 0x5B, 0x74, 0x92, 0x25, -+0x53, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xE0, 0x90, 0xA2, 0x4F, 0xF0, 0x90, 0xA2, 0x45, -+0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x40, 0x08, 0x90, 0xA2, 0x4D, -+0x74, 0x05, 0xF0, 0x80, 0x16, 0xD3, 0xEF, 0x94, 0xFA, 0xEE, 0x94, 0x00, 0x40, 0x08, 0x90, 0xA2, -+0x4D, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, 0x4D, 0xF0, 0x90, 0xA2, 0x4D, 0xE0, 0xFD, -+0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x44, -+0xF2, 0xE4, 0x93, 0xFD, 0x7C, 0x00, 0x12, 0x07, 0x03, 0x90, 0xA2, 0x50, 0xEE, 0xF0, 0xA3, 0xEF, -+0xF0, 0xE4, 0xF5, 0x5C, 0xAB, 0x57, 0xAA, 0x58, 0xA9, 0x59, 0x75, 0xF0, 0x02, 0xE5, 0x5C, 0xA4, -+0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x07, 0xAB, 0xFF, 0xAE, 0xF0, 0x90, 0xA2, 0x4D, 0xE0, 0xFD, -+0xEF, 0xA8, 0x05, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xE5, 0x5C, -+0x90, 0x44, 0xED, 0x93, 0xFD, 0x7C, 0x00, 0x12, 0x07, 0x03, 0xEF, 0x25, 0x5B, 0xF5, 0x5B, 0xEE, -+0x35, 0x5A, 0xF5, 0x5A, 0xC3, 0x90, 0xA2, 0x51, 0xE0, 0x95, 0x5B, 0x90, 0xA2, 0x50, 0xE0, 0x95, -+0x5A, 0x40, 0x07, 0x05, 0x5C, 0xE5, 0x5C, 0xB4, 0x05, 0xAA, 0xE5, 0x5C, 0xC3, 0x13, 0xF5, 0x5C, -+0x90, 0xA2, 0x4F, 0xE0, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x90, 0xA2, -+0x53, 0xF0, 0xD3, 0x95, 0x5C, 0x40, 0x06, 0xE0, 0x95, 0x5C, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0xA2, -+0x53, 0xF0, 0x74, 0x01, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xC3, 0x13, -+0xFF, 0x90, 0xA2, 0x53, 0xE0, 0xC4, 0x33, 0x54, 0xE0, 0x2F, 0x04, 0xFF, 0x74, 0x01, 0x25, 0x53, -+0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x01, 0x25, 0x53, 0xF5, 0x82, 0xE4, -+0x34, 0x93, 0xF5, 0x83, 0xE0, 0xC3, 0x94, 0xC0, 0x40, 0x0E, 0x74, 0x01, 0x25, 0x53, 0xF5, 0x82, -+0xE4, 0x34, 0x93, 0xF5, 0x83, 0x74, 0xC0, 0xF0, 0x74, 0x01, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, -+0x93, 0xF5, 0x83, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0xA2, 0x53, 0xF0, 0xE0, 0x25, 0xE0, -+0xF0, 0x70, 0x02, 0x80, 0x05, 0x90, 0xA2, 0x53, 0xE0, 0x14, 0x90, 0xA2, 0x4F, 0xF0, 0xD3, 0x90, -+0xA2, 0x48, 0xE0, 0x94, 0x03, 0x90, 0xA2, 0x47, 0xE0, 0x94, 0x00, 0x40, 0x05, 0xE4, 0x90, 0xA2, -+0x4F, 0xF0, 0x90, 0xA2, 0x4F, 0xE0, 0xFF, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x97, -+0xF5, 0x83, 0xEF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x53, 0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, 0xE0, -+0x54, 0xF8, 0xFE, 0x90, 0xA2, 0x52, 0xF0, 0xEF, 0x4E, 0xFF, 0xF0, 0x75, 0xF0, 0x10, 0xE5, 0x53, -+0x90, 0x81, 0x01, 0x12, 0x49, 0x1D, 0xEF, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, -+0x9D, 0xF5, 0x83, 0xE0, 0xD3, 0x94, 0x05, 0x74, 0x92, 0x50, 0x0E, 0x25, 0x53, 0xF5, 0x82, 0xE4, -+0x34, 0x9D, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x0B, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9D, -+0xF5, 0x83, 0xE4, 0xF0, 0x90, 0xA2, 0x47, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, -+0xFD, 0x74, 0xFF, 0x9E, 0xFC, 0xE5, 0x53, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, -+0xF5, 0x83, 0xE0, 0xFA, 0xA3, 0xE0, 0xD3, 0x9D, 0xEA, 0x9C, 0xE5, 0x53, 0x50, 0x13, 0x25, 0xE0, -+0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x08, 0xD6, 0x80, -+0x10, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, -+0xF0, 0x90, 0xA2, 0x49, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFD, 0x74, 0xFF, -+0x9E, 0xFC, 0xE5, 0x53, 0x25, 0xE0, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xE0, -+0xFA, 0xA3, 0xE0, 0xD3, 0x9D, 0xEA, 0x9C, 0xE5, 0x53, 0x50, 0x13, 0x25, 0xE0, 0x24, 0x92, 0xF5, -+0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xEE, 0x8F, 0xF0, 0x12, 0x08, 0xD6, 0x80, 0x10, 0x25, 0xE0, -+0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xE4, 0xFD, -+0xAF, 0x53, 0x12, 0x6E, 0xA6, 0x05, 0x53, 0xE5, 0x53, 0xC3, 0x94, 0x80, 0x50, 0x03, 0x02, 0xAA, -+0x90, 0x22, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x32, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x12, 0x06, -+0x89, 0x54, 0x7F, 0xFD, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFE, 0x54, 0x1F, 0x90, 0xA2, 0x49, -+0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x90, 0xA2, 0x48, 0xF0, 0x90, 0x00, -+0x02, 0x12, 0x06, 0xA2, 0xFE, 0x54, 0x03, 0xFF, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0xA2, -+0x4B, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x90, 0xA2, 0x4A, 0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFE, 0x90, 0x00, -+0x02, 0x12, 0x06, 0xA2, 0xFB, 0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFC, 0x90, 0xA2, 0x4C, -+0xF0, 0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEE, 0x54, 0x01, 0xC4, 0x33, 0x33, -+0x33, 0x54, 0x80, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, -+0x7F, 0x4E, 0xF0, 0x90, 0xA2, 0x4A, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0xFE, 0x75, -+0xF0, 0x04, 0xED, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, 0xEC, 0x60, -+0x02, 0xC1, 0x2B, 0x90, 0xA2, 0x49, 0xE0, 0x54, 0x1F, 0xFE, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, -+0x94, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xE0, 0x4E, 0xF0, 0xEF, 0x54, 0x03, 0xFE, 0x75, 0xF0, 0x04, -+0xED, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xFC, 0x4E, 0xF0, 0xEF, 0x54, 0x03, 0x25, -+0xE0, 0x25, 0xE0, 0xFF, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x95, 0x12, 0x49, 0x1D, 0xE0, 0x54, -+0xF3, 0x4F, 0xF0, 0x90, 0xA2, 0x48, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0xFF, 0x75, 0xF0, -+0x04, 0xED, 0x90, 0x95, 0x94, 0x12, 0x49, 0x1D, 0xE0, 0x54, 0xDF, 0x4F, 0xF0, 0x90, 0xA2, 0x4B, -+0xE0, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0xFF, 0x75, 0xF0, 0x04, 0xED, 0x90, 0x95, 0x95, 0x12, 0x49, -+0x1D, 0xE0, 0x54, 0xCF, 0x4F, 0xF0, 0x74, 0x92, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, -+0xE0, 0x54, 0xFB, 0xF0, 0x74, 0x92, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xC0, 0x83, -+0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA2, 0x4D, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0xD0, -+0x82, 0xD0, 0x83, 0xF0, 0xE4, 0xFC, 0xEC, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0xA2, 0x45, -+0x12, 0x49, 0x29, 0x8F, 0x82, 0x8E, 0x83, 0x12, 0x06, 0xA2, 0xFF, 0x75, 0xF0, 0x08, 0xED, 0x90, -+0x89, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, 0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, -+0xF0, 0x0C, 0xEC, 0xB4, 0x04, 0xD0, 0xAF, 0x05, 0x12, 0x6B, 0x2C, 0x22, 0x90, 0xA2, 0x45, 0x12, -+0x49, 0x32, 0x12, 0x06, 0x89, 0xF5, 0x53, 0x24, 0x92, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, -+0xE0, 0x54, 0xFE, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xC0, -+0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA2, 0x45, 0x12, 0x49, 0x29, 0x90, 0x00, 0x03, 0x12, 0x06, -+0xA2, 0x54, 0x01, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, -+0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0x54, 0xFD, 0xF0, 0x74, 0x92, 0x25, 0x53, 0xF5, 0x82, -+0xE4, 0x34, 0x99, 0xF5, 0x83, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0xA2, 0x45, 0x12, 0x49, -+0x29, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0x54, 0x02, 0xFE, 0xEF, 0x4E, 0xD0, 0x82, 0xD0, 0x83, -+0xF0, 0xE5, 0x53, 0xC3, 0x94, 0x80, 0x50, 0x15, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFF, 0x74, -+0x12, 0x25, 0x53, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0xE5, 0x53, 0xB4, -+0x80, 0x0A, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0x95, 0x11, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0xA3, 0x5D, 0x12, 0x4B, 0x20, 0xEF, 0x30, 0xE6, 0x4D, 0x7F, 0x8D, -+0x12, 0x4B, 0x24, 0xEF, 0x64, 0x01, 0x70, 0x43, 0x90, 0xA3, 0x5E, 0xF0, 0x90, 0xA3, 0x5E, 0xE0, -+0xFD, 0x90, 0xA3, 0x5D, 0xE0, 0x75, 0xF0, 0x10, 0x90, 0x81, 0x00, 0x12, 0x49, 0x1D, 0xE5, 0x82, -+0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x4C, 0x60, 0x90, -+0xA3, 0x5E, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xD1, 0x7F, 0x8F, 0x12, 0x4B, 0x24, -+0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x4A, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -+0x90, 0xA3, 0x5F, 0x12, 0x4B, 0x20, 0xEF, 0x30, 0xE6, 0x69, 0x7F, 0x8D, 0x12, 0x4B, 0x24, 0xEF, -+0x64, 0x02, 0x70, 0x5F, 0x90, 0xA3, 0x60, 0xF0, 0x90, 0xA3, 0x60, 0xE0, 0xFD, 0x90, 0xA3, 0x5F, -+0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, -+0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x4C, 0x60, 0x90, -+0xA3, 0x60, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x08, 0x40, 0xCD, 0x90, 0xA3, 0x60, 0xE0, 0xFD, -+0xC3, 0x94, 0x10, 0x50, 0x0E, 0xE4, 0xFB, 0xFF, 0x12, 0x4C, 0x60, 0x90, 0xA3, 0x60, 0xE0, 0x04, -+0xF0, 0x80, 0xE8, 0x7F, 0x8F, 0x12, 0x4B, 0x24, 0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, -+0x12, 0x4A, 0x07, 0x22, 0x90, 0xA2, 0x3E, 0x12, 0x4B, 0x20, 0xEF, 0x30, 0xE6, 0x50, 0x7F, 0x8D, -+0x12, 0x4B, 0x24, 0xEF, 0x64, 0x03, 0x70, 0x46, 0x90, 0xA2, 0x3F, 0xF0, 0x90, 0xA2, 0x3F, 0xE0, -+0xFD, 0x90, 0xA2, 0x3E, 0xE0, 0xC4, 0x54, 0xF0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, -+0x83, 0xE5, 0x82, 0x2D, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, -+0x4C, 0x60, 0x90, 0xA2, 0x3F, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCE, 0x7F, 0x8F, -+0x12, 0x4B, 0x24, 0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, 0x12, 0x4A, 0x07, 0x22, 0x74, -+0x1D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0xA2, 0xB4, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, -+0x37, 0xBC, 0x90, 0xA2, 0xBE, 0x12, 0x08, 0x6D, 0x90, 0xA2, 0xB6, 0x12, 0x48, 0xE5, 0x12, 0x08, -+0x3A, 0x90, 0xA2, 0xBE, 0x12, 0x49, 0x01, 0x12, 0x48, 0xBA, 0x90, 0xA2, 0xBA, 0x12, 0x49, 0x01, -+0x12, 0x48, 0xC7, 0x90, 0xA2, 0xC2, 0x12, 0x08, 0x6D, 0x90, 0xA2, 0xC2, 0x12, 0x48, 0xE5, 0x90, -+0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x90, 0xA2, 0xB4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x02, 0x38, 0x07, -+0x90, 0xA2, 0xA2, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0xA2, 0xA1, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, -+0xFD, 0x12, 0x3D, 0x2C, 0x90, 0xA2, 0xAC, 0x12, 0x08, 0x6D, 0x90, 0xA2, 0xA4, 0x12, 0x48, 0xE5, -+0x12, 0x08, 0x3A, 0x90, 0xA2, 0xAC, 0x12, 0x49, 0x01, 0x12, 0x48, 0xBA, 0x90, 0xA2, 0xA8, 0x12, -+0x49, 0x01, 0x12, 0x48, 0xC7, 0x90, 0xA2, 0xB0, 0x12, 0x08, 0x6D, 0x90, 0xA2, 0xA2, 0xA3, 0xE0, -+0xFD, 0xC0, 0x05, 0x90, 0xA2, 0xB0, 0x12, 0x48, 0xE5, 0x90, 0xAA, 0x96, 0x12, 0x08, 0x6D, 0x90, -+0xA2, 0xA1, 0xE0, 0xFF, 0xD0, 0x05, 0x02, 0x3C, 0x33, 0x90, 0x9F, 0x95, 0xE0, 0x64, 0x02, 0x60, -+0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x12, 0x06, 0x89, 0xFF, 0x54, 0x01, 0xFE, -+0x90, 0xA1, 0x6F, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, 0x00, -+0x01, 0x12, 0x06, 0xA2, 0x90, 0xA1, 0x70, 0xF0, 0x22, 0x90, 0xA1, 0x72, 0xE0, 0x30, 0xE0, 0x36, -+0x90, 0xA1, 0x75, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x90, 0xA1, 0x73, 0xE0, 0x6F, 0x70, 0x27, 0x90, -+0x06, 0x92, 0xE0, 0x20, 0xE2, 0x11, 0x90, 0xA1, 0x77, 0xE0, 0x70, 0x0B, 0x12, 0x57, 0x7D, 0x90, -+0xA1, 0x76, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0xA1, -+0x75, 0xF0, 0x90, 0xA1, 0x77, 0xF0, 0x22, 0x90, 0x05, 0x2B, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, -+0x7F, 0x01, 0x22, 0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, -+0x90, 0xA1, 0x0B, 0x74, 0x03, 0xF0, 0x22, 0x12, 0x86, 0xBC, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, -+0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0xA1, 0x0B, 0x74, 0x04, 0xF0, 0x22, 0x90, 0x05, -+0x22, 0x74, 0x6F, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0xA1, 0x0B, 0x74, 0x04, -+0xF0, 0x22, 0x90, 0x01, 0x57, 0xE0, 0x60, 0x48, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, -+0x90, 0xA1, 0x0D, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0C, 0xEF, 0x54, 0xFB, 0xF0, -+0x90, 0xA1, 0x14, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0xA1, 0x19, 0xE0, 0x04, 0xF0, 0x90, 0xA1, -+0x14, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0xA1, 0x21, 0xE0, 0xFF, 0x90, 0xA1, 0x19, 0xE0, 0xD3, 0x9F, -+0x40, 0x0E, 0x90, 0xA0, 0x87, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0xA1, 0x0E, 0xE0, 0x54, 0xFB, 0xF0, -+0x22, 0x90, 0xA1, 0x28, 0xE0, 0x30, 0xE0, 0x23, 0x90, 0xA1, 0x39, 0xE0, 0x60, 0x08, 0x90, 0x01, -+0xB8, 0x74, 0x40, 0xF0, 0x41, 0x87, 0x90, 0xA1, 0x12, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, -+0x35, 0x90, 0xA1, 0x27, 0xE0, 0x70, 0x02, 0x41, 0x7F, 0x80, 0x67, 0x12, 0x57, 0xF8, 0xEF, 0x64, -+0x01, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x41, 0x87, 0x90, 0xA1, 0x14, 0xE0, 0xFF, -+0x54, 0x03, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x7B, 0x90, 0xA1, 0x12, 0xE0, -+0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x69, 0xEF, 0x30, -+0xE2, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x5D, 0x90, 0xA1, 0x14, 0xE0, 0x30, 0xE4, -+0x08, 0x90, 0x01, 0xB8, 0x74, 0x10, 0xF0, 0x80, 0x4E, 0x90, 0xA1, 0x0E, 0xE0, 0x13, 0x13, 0x54, -+0x3F, 0x20, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x20, 0xF0, 0x80, 0x3B, 0x90, 0xA1, 0x27, 0xE0, -+0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x80, 0xF0, 0x80, 0x2D, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, -+0x08, 0x90, 0x01, 0xB8, 0x74, 0x11, 0xF0, 0x80, 0x1E, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0F, -+0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x12, 0xF0, 0x80, 0x08, 0x90, -+0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x7F, 0x00, 0x22, -+0xEF, 0x60, 0x42, 0x90, 0xA0, 0x87, 0xE0, 0x64, 0x01, 0x70, 0x3A, 0x90, 0xA1, 0x0E, 0xE0, 0x54, -+0xFE, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE4, -+0xFF, 0x12, 0x56, 0x26, 0xBF, 0x01, 0x12, 0x90, 0xA1, 0x0D, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0xA1, -+0x13, 0x74, 0x06, 0xF0, 0x90, 0xA1, 0x0C, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, -+0x01, 0xB8, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0xA1, 0x13, 0x74, -+0x02, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0xA1, 0x0C, 0x74, 0x02, 0xF0, 0x22, -+0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x13, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x27, 0xE0, 0x44, -+0x40, 0xF0, 0x90, 0xA1, 0x0C, 0x74, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0xA2, 0x5E, 0xF0, 0x90, 0xA1, -+0x10, 0xE0, 0x70, 0x02, 0x61, 0xC4, 0x90, 0xA0, 0x87, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x61, 0xC4, -+0x90, 0xA1, 0x0F, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x60, 0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, -+0x21, 0x90, 0xA1, 0x17, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, 0xA1, 0x19, 0xE0, 0x60, -+0x11, 0xEF, 0x70, 0x08, 0x90, 0xA1, 0x16, 0xE0, 0xA3, 0xF0, 0x80, 0x00, 0x90, 0xA2, 0x5E, 0x74, -+0x01, 0xF0, 0x90, 0xA1, 0x08, 0xE0, 0x30, 0xE0, 0x16, 0x90, 0xA1, 0x0C, 0xE0, 0xB4, 0x02, 0x05, -+0xE4, 0x90, 0xA2, 0x5E, 0xF0, 0x12, 0x57, 0xEC, 0xEF, 0x70, 0x04, 0x90, 0xA2, 0x5E, 0xF0, 0x90, -+0xA2, 0x5E, 0xE0, 0x60, 0x4F, 0x90, 0xA1, 0x14, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0xA1, 0x19, 0xE0, -+0x60, 0x03, 0xB4, 0x01, 0x09, 0xE4, 0xF5, 0x3B, 0x90, 0xA1, 0x19, 0xE0, 0x80, 0x0D, 0xE4, 0xF5, -+0x3B, 0x90, 0xA1, 0x19, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0xA1, 0x18, 0xE0, -+0x2F, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, -+0x74, 0x05, 0xF0, 0x90, 0xA1, 0x13, 0xE0, 0x20, 0xE2, 0x07, 0x7D, 0x01, 0x7F, 0x04, 0x12, 0x53, -+0x5E, 0x12, 0x82, 0x1C, 0x22, 0x90, 0xA1, 0x0D, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, -+0x11, 0xEF, 0x54, 0xFB, 0xF0, 0x90, 0xA1, 0x14, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x42, -+0x80, 0x3D, 0x90, 0xA1, 0x19, 0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x14, 0xE0, 0x54, 0xEF, 0xF0, 0x90, -+0xA1, 0x19, 0xE0, 0xFF, 0xB4, 0x01, 0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, 0x06, 0x90, 0x05, 0x58, -+0xE0, 0x04, 0xF0, 0x90, 0xA1, 0x21, 0xE0, 0xFF, 0x90, 0xA1, 0x19, 0xE0, 0xD3, 0x9F, 0x40, 0x0F, -+0x90, 0xA0, 0x87, 0xE0, 0xB4, 0x01, 0x0B, 0x90, 0xA1, 0x0E, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x12, -+0x53, 0x43, 0x22, 0x12, 0x86, 0xBC, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0xA1, 0x13, 0x74, 0x0C, -+0xF0, 0x90, 0xA1, 0x0C, 0xF0, 0x22, 0x90, 0x9F, 0x98, 0xE0, 0xFE, 0x90, 0x04, 0x1C, 0xE0, 0x6E, -+0x70, 0x40, 0x90, 0xA1, 0x13, 0xE0, 0xFE, 0x64, 0x0E, 0x70, 0x1C, 0xEF, 0x70, 0x34, 0x90, 0xA1, -+0x0D, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xE0, 0x44, 0x80, 0xF0, -+0x90, 0xA1, 0x13, 0x74, 0x04, 0xF0, 0x22, 0xEE, 0xB4, 0x06, 0x17, 0xEF, 0x60, 0x14, 0x90, 0xA1, -+0x0D, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0xA1, 0x13, 0x74, -+0x0C, 0xF0, 0x22, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0xA0, -+0x86, 0xE0, 0x9B, 0x90, 0xA0, 0x85, 0xE0, 0x9A, 0x50, 0x13, 0xA3, 0xE0, 0x24, 0x01, 0xFF, 0x90, -+0xA0, 0x85, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, -+0x11, 0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFF, -+0x22, 0x00, 0xD4, 0x15, -+}; -+static const u4Byte ArrayLength_MP_8821A_FW_NIC = 31972; -+ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_NIC( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+) -+{ -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8821A_FW_NIC; -+ *pFirmwareSize = ArrayLength_MP_8821A_FW_NIC; -+} -+ -+static const u1Byte Array_MP_8821A_FW_WoWLAN[] = { -+0x01, 0x21, 0x30, 0x00, 0x0B, 0x00, 0x00, 0x00, 0x04, 0x23, 0x15, 0x35, 0x6E, 0x45, 0x00, 0x00, -+0x71, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x02, 0x4A, 0xCD, 0x02, 0x5F, 0xED, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x60, 0x6E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x69, 0xA2, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x60, 0x1E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x64, 0x18, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x02, 0x69, 0xA1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x46, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -+0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -+0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -+0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -+0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -+0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -+0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -+0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -+0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -+0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -+0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -+0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -+0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -+0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -+0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -+0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x4B, 0x61, 0x74, 0x01, 0x93, -+0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -+0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -+0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -+0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -+0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -+0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -+0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -+0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -+0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -+0x04, 0x90, 0x4B, 0x61, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -+0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -+0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -+0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x46, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -+0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -+0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -+0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -+0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -+0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -+0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -+0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -+0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x46, 0x4C, 0x8F, 0xF0, -+0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -+0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -+0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, -+0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, -+0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x46, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, -+0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xEF, 0x5B, 0xFF, -+0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, -+0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, -+0xE0, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, -+0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, -+0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, -+0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, -+0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, -+0xA3, 0x80, 0xDF, 0xE3, 0xF5, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, 0xDF, 0xF5, 0x80, 0x67, -+0xE3, 0xF5, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, 0x5A, 0x87, 0xF0, 0x09, -+0xE6, 0x08, 0xB5, 0xF0, 0x52, 0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, -+0x46, 0xDF, 0xF6, 0x80, 0x42, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE0, 0xA3, 0xB5, 0xF0, -+0x36, 0xDF, 0xF6, 0x80, 0x32, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, -+0xF0, 0x25, 0xDF, 0xF5, 0x80, 0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE0, 0xA3, -+0xB5, 0xF0, 0x14, 0xDF, 0xF5, 0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE4, -+0x93, 0xA3, 0xB5, 0xF0, 0x02, 0xDF, 0xF4, 0x02, 0x4A, 0x52, 0x80, 0x87, 0x80, 0xE9, 0x80, 0x90, -+0x80, 0xD4, 0x80, 0x3E, 0x80, 0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, 0x80, 0xB7, 0x80, 0x8D, -+0x80, 0xA3, 0x80, 0x51, 0x80, 0x74, 0x80, 0x3C, 0x02, 0x4A, 0x5E, 0x89, 0x82, 0x8A, 0x83, 0xEC, -+0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, -+0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, 0xDF, 0xE3, 0xDE, 0xE1, -+0x80, 0x70, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, 0xB5, 0xF0, 0x62, -+0xDF, 0xF4, 0x80, 0x5E, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, -+0x51, 0xDF, 0xF5, 0x80, 0x4D, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, 0xB5, -+0xF0, 0x40, 0xDF, 0xF5, 0x80, 0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE6, -+0x08, 0xB5, 0xF0, 0x2E, 0xDF, 0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, 0x89, 0x82, 0x8A, 0x83, -+0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE0, -+0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, 0xDF, 0xE4, 0xDE, 0xE2, -+0x80, 0x00, 0x7F, 0xFF, 0xB5, 0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x89, 0x82, -+0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, -+0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xD5, 0xDF, 0xE5, 0xDE, -+0xE3, 0x80, 0xCF, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, -+0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, -+0xB5, 0xF0, 0xAF, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, -+0x60, 0xAB, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, -+0x04, 0x00, 0x50, 0x8E, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x49, 0x9A, 0x73, 0x02, 0x4B, 0x0B, -+0x02, 0x46, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, -+0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, -+0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, -+0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x4B, 0x50, 0xE4, 0x7E, -+0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, -+0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, -+0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, -+0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, -+0x00, 0x41, 0x91, 0x0F, 0x00, 0x41, 0x91, 0x10, 0x00, 0x41, 0x91, 0x11, 0x00, 0x41, 0x91, 0x24, -+0x00, 0x4E, 0x92, 0x50, 0xF6, 0x58, 0x3A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, -+0x75, 0x83, 0x00, 0xED, 0xF0, 0x7F, 0x10, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xD0, 0xD0, 0x92, 0xAF, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x8F, 0xD1, 0x30, 0xEF, 0x20, 0xE6, 0x02, -+0x81, 0xF3, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x91, 0x15, 0xF0, 0x7F, 0x8D, 0xD1, 0x30, 0x90, 0x91, -+0x16, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0x91, 0x17, 0xF0, 0x90, 0x91, 0x16, 0xE0, 0x24, -+0xF1, 0x70, 0x02, 0x81, 0x7D, 0x24, 0xEF, 0x70, 0x02, 0x81, 0xD3, 0x24, 0x18, 0x60, 0x02, 0x81, -+0xE5, 0x90, 0x8E, 0x7A, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0xB1, 0x04, 0x90, 0x8E, 0x79, 0xE0, 0x54, -+0x0F, 0xFB, 0x0D, 0xB1, 0x04, 0x90, 0x8E, 0x7C, 0xE0, 0xFB, 0x0D, 0xB1, 0x04, 0x90, 0x8E, 0x7D, -+0xE0, 0xFB, 0x0D, 0xB1, 0x04, 0x90, 0x91, 0x15, 0xE0, 0x24, 0xF6, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -+0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xB1, 0x04, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0x01, 0xFB, -+0x0D, 0xB1, 0x04, 0x90, 0x8E, 0x77, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, -+0xB1, 0x04, 0x90, 0x8E, 0x77, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, -+0xB1, 0x04, 0x90, 0x8D, 0x02, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xB1, 0x04, 0x90, 0x8D, 0x03, 0xE0, -+0xFB, 0x0D, 0xB1, 0x04, 0x90, 0x8E, 0x81, 0xE0, 0xFB, 0x0D, 0xB1, 0x04, 0x90, 0x8E, 0x80, 0xE0, -+0xFB, 0x0D, 0xB1, 0x04, 0x90, 0x8E, 0x79, 0xE0, 0xC4, 0x54, 0x0F, 0xFB, 0xE4, 0xFD, 0x7F, 0x03, -+0xB1, 0x04, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0xB1, 0x04, -+0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0xB1, 0x04, 0x90, -+0x8E, 0x77, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x03, 0x80, 0x66, 0x90, 0x8E, 0x92, -+0xE0, 0x54, 0x01, 0xFB, 0xE4, 0xFD, 0xFF, 0xB1, 0x04, 0x90, 0x8E, 0x93, 0xE0, 0xC4, 0x13, 0x13, -+0x13, 0x54, 0x01, 0xFB, 0x0D, 0xE4, 0xFF, 0xB1, 0x04, 0x90, 0x8E, 0x93, 0xE0, 0xC4, 0x54, 0x01, -+0xFB, 0x0D, 0xE4, 0xFF, 0xB1, 0x04, 0x90, 0x8E, 0x97, 0xE0, 0x54, 0x01, 0xFB, 0x0D, 0xB1, 0x04, -+0x90, 0x8E, 0xA4, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xB1, 0x04, 0x90, 0x8E, 0xA5, 0xE0, 0xFB, 0x0D, -+0xB1, 0x04, 0x90, 0x8E, 0xA6, 0xE0, 0xFB, 0x0D, 0xB1, 0x04, 0xE4, 0xFB, 0x91, 0xF8, 0x91, 0xF8, -+0x0D, 0x80, 0x10, 0x90, 0x8D, 0xF2, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0xB1, 0x04, 0x90, 0x8D, 0xF3, -+0xE0, 0xFB, 0x0D, 0xB1, 0x04, 0x7F, 0x8F, 0xD1, 0x30, 0xEF, 0x30, 0xE0, 0x06, 0xE4, 0xFD, 0x7F, -+0x8D, 0x71, 0x67, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x0D, 0xB1, 0x04, 0xE4, 0xFD, 0x0F, 0xB1, 0x04, -+0x0D, 0xB1, 0x04, 0x0D, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, -+0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, -+0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -+0xC3, 0xC0, 0xD0, 0x90, 0x91, 0x21, 0xED, 0xF0, 0x90, 0x91, 0x20, 0xEF, 0xF0, 0xD3, 0x94, 0x07, -+0x50, 0x6D, 0x7F, 0x47, 0xD1, 0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, -+0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, 0x71, 0x67, 0x7F, 0x46, 0xD1, -+0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0x4F, 0xFD, 0x7F, 0x46, 0x71, 0x67, 0x90, 0x91, 0x21, 0xE0, 0x60, 0x17, 0x7F, 0x45, 0xD1, -+0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, -+0xFC, 0x4F, 0x80, 0x16, 0x7F, 0x45, 0xD1, 0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, -+0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x45, 0x80, 0x75, 0x90, -+0x91, 0x20, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0xD1, 0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, -+0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x71, -+0x67, 0x7F, 0x62, 0xD1, 0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0x71, 0x67, 0x90, 0x91, 0x21, 0xE0, 0x60, -+0x1A, 0x7F, 0x61, 0xD1, 0x30, 0x90, 0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, -+0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x19, 0x7F, 0x61, 0xD1, 0x30, 0x90, -+0x91, 0x20, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, -+0x5F, 0xFD, 0x7F, 0x61, 0x71, 0x67, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x38, 0x07, 0x7F, 0x02, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xE0, 0x90, 0x91, 0x22, -+0xF0, 0x7F, 0x10, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x91, 0x22, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, -+0xAF, 0x22, 0x7F, 0x54, 0xD1, 0x30, 0xE5, 0x0D, 0x5F, 0xF5, 0x11, 0x7F, 0x55, 0xD1, 0x30, 0xE5, -+0x0E, 0x5F, 0xF5, 0x12, 0x7F, 0x56, 0xD1, 0x30, 0xE5, 0x0F, 0x5F, 0xF5, 0x13, 0x7F, 0x57, 0xD1, -+0x30, 0xE5, 0x10, 0x5F, 0xF5, 0x14, 0xAD, 0x11, 0x7F, 0x54, 0x71, 0x67, 0xAD, 0x12, 0x7F, 0x55, -+0x71, 0x67, 0xAD, 0x13, 0x7F, 0x56, 0x71, 0x67, 0xAD, 0x14, 0x7F, 0x57, 0x71, 0x67, 0x53, 0x91, -+0xEF, 0x22, 0x7F, 0x81, 0xD1, 0x30, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, 0x81, 0x71, 0x67, 0x7F, 0x80, -+0xD1, 0x30, 0xEF, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x71, 0x67, 0x12, 0x6F, 0xAE, 0x12, 0x3D, 0x3B, -+0x12, 0x6F, 0xBB, 0x12, 0x70, 0x7E, 0x7F, 0x01, 0x12, 0x47, 0x15, 0x90, 0x8F, 0x9D, 0x74, 0x02, -+0xF0, 0xFF, 0x12, 0x47, 0x15, 0x90, 0x8F, 0x9D, 0xE0, 0x04, 0xF0, 0x12, 0x50, 0x10, 0x12, 0x67, -+0x82, 0x7F, 0x80, 0xD1, 0x30, 0xEF, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x71, 0x67, 0x75, 0x28, 0xFF, -+0xF1, 0xF0, 0x12, 0x6F, 0xFC, 0x7F, 0x81, 0xD1, 0x30, 0xEF, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x71, -+0x67, 0x12, 0x70, 0x88, 0xE4, 0xFF, 0x02, 0x47, 0x9E, 0x90, 0x8E, 0x84, 0xE0, 0xFD, 0x7F, 0x93, -+0x71, 0x67, 0x90, 0x8E, 0x7B, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, -+0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x7F, 0x08, 0xD1, 0x30, 0xEF, 0x44, -+0x10, 0xFD, 0x7F, 0x08, 0x71, 0x67, 0x7F, 0x01, 0x12, 0x56, 0x17, 0x7F, 0x90, 0xD1, 0x30, 0xEF, -+0x44, 0x01, 0xFD, 0x7F, 0x90, 0x71, 0x67, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x10, 0xD1, 0x30, 0xEF, 0x44, 0x0C, 0xFD, 0x7F, 0x10, 0x71, -+0x67, 0x7F, 0x72, 0xD1, 0x30, 0xEF, 0x54, 0xF3, 0xFD, 0x7F, 0x72, 0x71, 0x67, 0x90, 0x01, 0x01, -+0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, -+0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x7F, 0xB4, 0x7E, 0x08, 0x12, 0x37, 0xBC, 0xEF, 0x54, 0xBF, -+0xFF, 0xEC, 0x90, 0x91, 0x07, 0x12, 0x08, 0x6D, 0x90, 0x91, 0x07, 0x11, 0xC7, 0x90, 0xAA, 0xB9, -+0x12, 0x08, 0x6D, 0x7F, 0xB4, 0x7E, 0x08, 0xD1, 0x2B, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x71, -+0x67, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x03, 0xFF, 0xEC, 0x90, 0x91, 0x07, -+0x12, 0x08, 0x6D, 0x90, 0x91, 0x07, 0x11, 0xC7, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0x00, -+0x7E, 0x0C, 0x12, 0x38, 0x07, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x03, 0xFF, -+0xEC, 0x90, 0x91, 0x07, 0x12, 0x08, 0x6D, 0x90, 0x91, 0x07, 0x11, 0xC7, 0x90, 0xAA, 0xB9, 0x12, -+0x08, 0x6D, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x38, 0x07, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x61, 0x81, -+0x75, 0xE8, 0x03, 0x75, 0xA8, 0x85, 0x22, 0x7F, 0xF4, 0xD1, 0x30, 0xEF, 0x20, 0xE5, 0x0E, 0x7F, -+0xF4, 0x12, 0x4E, 0x30, 0xEF, 0x7F, 0x01, 0x20, 0xE4, 0x05, 0x7F, 0x02, 0x22, 0x7F, 0x03, 0x22, -+0x12, 0x4F, 0xF7, 0x90, 0x8D, 0x04, 0xEF, 0xF0, 0x11, 0x2A, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, -+0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, 0x36, 0x83, 0x11, 0x95, 0x11, 0xC5, 0x11, 0x57, -+0x11, 0x76, 0xE4, 0xF5, 0x0D, 0xF5, 0x0E, 0xF5, 0x0F, 0xF5, 0x10, 0xAD, 0x0D, 0x7F, 0x50, 0x12, -+0x4B, 0x67, 0xAD, 0x0E, 0x7F, 0x51, 0x12, 0x4B, 0x67, 0xAD, 0x0F, 0x7F, 0x52, 0x12, 0x4B, 0x67, -+0xAD, 0x10, 0x7F, 0x53, 0x02, 0x4B, 0x67, 0x75, 0x15, 0x10, 0xE4, 0xF5, 0x16, 0x75, 0x17, 0x07, -+0x75, 0x18, 0x42, 0x90, 0x01, 0x30, 0xE5, 0x15, 0xF0, 0xA3, 0xE5, 0x16, 0xF0, 0xA3, 0xE5, 0x17, -+0xF0, 0xA3, 0xE5, 0x18, 0xF0, 0x22, 0x75, 0x1D, 0x06, 0x75, 0x1E, 0x01, 0x75, 0x1F, 0x03, 0x75, -+0x20, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x1D, 0xF0, 0xA3, 0xE5, 0x1E, 0xF0, 0xA3, 0xE5, 0x1F, 0xF0, -+0xA3, 0xE5, 0x20, 0xF0, 0x22, 0x90, 0x01, 0x30, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, -+0x90, 0x01, 0x38, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x4B, 0x67, -+0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x4B, 0x67, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x4B, 0x67, 0xE4, 0xFD, -+0x7F, 0x53, 0x02, 0x4B, 0x67, 0x90, 0x01, 0x34, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, -+0xF0, 0x90, 0x01, 0x3C, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0x7F, 0x54, 0x12, 0x4B, -+0x67, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x4B, 0x67, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x4B, 0x67, 0x7D, -+0xFF, 0x7F, 0x57, 0x02, 0x4B, 0x67, 0xE4, 0x90, 0x8F, 0xAA, 0xF0, 0x90, 0x8F, 0xAA, 0xE0, 0x64, -+0x01, 0xF0, 0x24, 0xF6, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x50, 0xA3, 0xF0, 0x12, 0x3D, 0x6E, 0xBF, -+0x01, 0x03, 0x12, 0x31, 0x38, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x0E, 0x90, 0x8E, 0x7D, 0xE0, 0xFF, -+0x90, 0x8E, 0x7C, 0xE0, 0x6F, 0x60, 0x02, 0x31, 0x3D, 0xC2, 0xAF, 0x12, 0x70, 0x57, 0xBF, 0x01, -+0x02, 0x71, 0xA9, 0xD2, 0xAF, 0x12, 0x4F, 0xEE, 0x12, 0x46, 0x4D, 0x80, 0xBE, 0x90, 0x8E, 0x7C, -+0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x04, 0x7D, 0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0x90, 0x91, 0x26, 0xED, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x30, 0xE0, 0x02, 0x41, 0x95, 0xEE, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x02, 0x41, -+0x95, 0x90, 0x8E, 0x7D, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x41, 0x95, 0xEF, 0x70, 0x02, 0x41, 0x0C, -+0x24, 0xFE, 0x70, 0x02, 0x41, 0x45, 0x24, 0xFE, 0x60, 0x4A, 0x24, 0xFC, 0x70, 0x02, 0x41, 0x80, -+0x24, 0xFC, 0x60, 0x02, 0x41, 0x95, 0xEE, 0xB4, 0x0E, 0x02, 0x71, 0x06, 0x90, 0x8E, 0x7D, 0xE0, -+0x70, 0x04, 0x7F, 0x01, 0x71, 0x64, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x06, 0x02, 0x51, 0xE0, 0x90, -+0x8E, 0x7D, 0xE0, 0xB4, 0x04, 0x0F, 0x90, 0x91, 0x26, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x81, 0x54, -+0x80, 0x03, 0x12, 0x6B, 0x63, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x41, 0x95, 0x12, -+0x82, 0x4D, 0x41, 0x95, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x71, 0x64, 0x90, 0x8E, -+0x7D, 0xE0, 0xB4, 0x06, 0x02, 0x51, 0xE0, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0x9A, -+0xBF, 0x01, 0x02, 0x71, 0x06, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x41, 0x95, 0x51, -+0x9A, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x41, 0x95, 0x71, 0x2E, 0x41, 0x95, 0x90, 0x8E, 0x7D, 0xE0, -+0xB4, 0x0E, 0x07, 0x51, 0x9A, 0xBF, 0x01, 0x02, 0x71, 0x06, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x06, -+0x02, 0x51, 0xE0, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x0C, 0x07, 0x51, 0x9A, 0xBF, 0x01, 0x02, 0x71, -+0x2E, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x04, 0x70, 0x5C, 0x12, 0x80, 0x67, 0xEF, 0x64, 0x01, 0x70, -+0x54, 0xF1, 0x00, 0x80, 0x50, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0x9A, 0xBF, 0x01, -+0x02, 0x71, 0x06, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x06, 0x02, 0x51, 0xE0, 0x90, 0x8E, 0x7D, 0xE0, -+0xB4, 0x0C, 0x07, 0x51, 0x9A, 0xBF, 0x01, 0x02, 0x71, 0x2E, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x04, -+0x7F, 0x01, 0x71, 0x64, 0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x04, 0x1A, 0x12, 0x81, 0x96, 0x80, 0x15, -+0x90, 0x8E, 0x7D, 0xE0, 0xB4, 0x0C, 0x0E, 0x90, 0x8E, 0x78, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, -+0x30, 0xE0, 0x02, 0x71, 0x9F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x80, 0x4E, 0xEF, 0x64, 0x01, -+0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2D, 0x90, 0x8E, 0x77, 0xE0, 0x13, 0x13, -+0x13, 0x54, 0x1F, 0x30, 0xE0, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x19, 0x90, 0x8E, -+0x7C, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0x80, 0x08, 0x90, -+0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x7F, 0x00, 0x22, -+0x90, 0x8E, 0x78, 0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x0C, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x8E, -+0x7D, 0x74, 0x04, 0xF0, 0x80, 0x0A, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, -+0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0x8E, 0x78, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0x90, -+0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x80, 0x11, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, -+0x80, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x04, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x22, 0x90, 0x8D, -+0xF6, 0xE0, 0x64, 0x01, 0x70, 0x2D, 0x90, 0x8E, 0x78, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x22, -+0x74, 0x6F, 0xF0, 0x7F, 0x01, 0x71, 0xC8, 0xBF, 0x01, 0x0E, 0x90, 0x8E, 0x77, 0xE0, 0x44, 0x80, -+0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0E, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, -+0xB8, 0x04, 0xF0, 0x22, 0x90, 0x91, 0x25, 0xEF, 0xF0, 0x12, 0x4F, 0x3E, 0x90, 0x91, 0x25, 0xE0, -+0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x04, 0xF0, 0x22, 0x90, 0x8E, -+0x7A, 0xE0, 0x64, 0x01, 0x70, 0x18, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x60, 0x08, 0xE4, 0xFD, -+0x7F, 0x0C, 0x31, 0x4A, 0xC1, 0x88, 0x90, 0x8E, 0x7D, 0xE0, 0x70, 0x02, 0x31, 0x46, 0x22, 0x12, -+0x77, 0xDC, 0x90, 0x8E, 0x7D, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0x30, 0xE0, 0x02, -+0xB1, 0xDB, 0x22, 0xD1, 0x88, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x0C, 0x60, 0x0A, 0xE4, 0xFD, 0x7F, -+0x0C, 0x31, 0x4A, 0xE4, 0xFF, 0x71, 0xC8, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8F, -+0x55, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1D, 0x90, 0x05, 0x22, 0xE0, 0xF5, 0x58, 0x74, 0xFF, 0xF0, -+0xF1, 0xF2, 0xBF, 0x01, 0x07, 0xAF, 0x55, 0x12, 0x82, 0x5C, 0x91, 0x4E, 0x90, 0x05, 0x22, 0xE5, -+0x58, 0xF0, 0x80, 0x02, 0x91, 0x4E, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, -+0x92, 0xAF, 0x22, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0x3F, -+0xF0, 0xEF, 0x60, 0x1D, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, -+0x10, 0xF0, 0x74, 0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, -+0x22, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xEF, 0xF0, 0x74, -+0x09, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x90, 0x8D, -+0x07, 0xE0, 0xFF, 0x7D, 0x01, 0x91, 0xEF, 0x8E, 0x56, 0x8F, 0x57, 0xAD, 0x57, 0xAC, 0x56, 0xAF, -+0x55, 0x91, 0x03, 0xAF, 0x57, 0xAE, 0x56, 0x90, 0x81, 0x00, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, -+0x74, 0x0D, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x01, 0xF0, 0x74, 0x0D, -+0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x12, -+0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x11, 0x2C, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0E, 0xF0, 0x90, 0x04, 0xA7, 0xE4, 0xF0, 0x90, -+0x04, 0xA6, 0xF0, 0x90, 0x04, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0xA4, 0x74, 0xFD, 0xF0, 0x74, -+0x14, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xED, 0xF0, 0x22, 0xE0, 0xFF, 0x7D, 0x01, 0xD3, -+0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x91, 0x1B, 0xED, 0xF0, 0x90, 0x91, 0x1A, 0xEF, 0xF0, -+0xE4, 0xFD, 0xFC, 0xF1, 0xD7, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x91, 0x1A, 0xE0, 0x90, 0x04, 0x25, -+0xF0, 0x90, 0x91, 0x1B, 0xE0, 0x60, 0x0E, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -+0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -+0x54, 0xC0, 0xF0, 0x74, 0x29, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, -+0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x90, 0x5D, 0xF0, 0x90, -+0x06, 0xA9, 0xE0, 0x90, 0x90, 0x5D, 0xF0, 0xE0, 0x54, 0xC0, 0x70, 0x0C, 0x90, 0x8E, 0x7E, 0xE0, -+0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x21, 0x3D, 0x90, 0x90, 0x5D, 0xE0, 0x30, 0xE6, 0x21, 0x90, -+0x8E, 0x7A, 0xE0, 0x64, 0x01, 0x70, 0x20, 0x90, 0x8E, 0x7E, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8E, -+0x79, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x04, 0xD1, 0xCA, 0x80, 0x0B, 0x71, 0xB3, 0x80, 0x07, -+0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x90, 0x5D, 0xE0, 0x90, 0x8E, 0x7E, 0x30, 0xE7, -+0x25, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x8C, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, -+0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, 0x74, 0x05, 0xF0, 0x90, 0x8E, -+0x77, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x8E, 0x7D, 0xE0, 0xFF, -+0x60, 0x03, 0xB4, 0x08, 0x0E, 0x12, 0x81, 0x0B, 0xBF, 0x01, 0x08, 0xB1, 0xF4, 0x90, 0x01, 0xE5, -+0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x4E, 0xF9, 0xD1, 0x05, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0xE8, 0x7F, 0x08, 0x12, 0x4E, 0x30, 0xEF, 0x54, 0xEF, 0xFD, -+0x7F, 0x08, 0x12, 0x4B, 0x67, 0xE4, 0xFF, 0x8F, 0x5A, 0xE4, 0x90, 0x91, 0x1E, 0xF0, 0xA3, 0xF0, -+0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0xEF, 0x65, 0x5A, 0x60, 0x3E, -+0xC3, 0x90, 0x91, 0x1F, 0xE0, 0x94, 0x88, 0x90, 0x91, 0x1E, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, -+0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x91, 0x1E, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, -+0xD6, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xD3, 0x90, 0x91, 0x1F, 0xE0, 0x94, 0x32, 0x90, -+0x91, 0x1E, 0xE0, 0x94, 0x00, 0x40, 0xB9, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB2, 0x22, 0x90, -+0x8E, 0x7A, 0xE0, 0x60, 0x12, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x02, 0x80, 0x0A, 0x90, 0x8E, -+0x77, 0xE0, 0x54, 0xF7, 0xF0, 0x31, 0x3D, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0x13, 0x13, 0x13, 0x54, -+0x1F, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x90, -+0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x8D, 0xE0, 0xC3, 0x13, 0x54, 0x7F, -+0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x5B, 0x74, -+0x05, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x13, -+0x90, 0x8D, 0x06, 0xE0, 0xFF, 0xE4, 0xFD, 0x91, 0xEF, 0x8E, 0x26, 0x8F, 0x27, 0x90, 0x04, 0x1F, -+0x74, 0x20, 0xF0, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, 0x01, 0x14, 0x90, 0x8E, 0x7A, 0xE0, 0x60, -+0x0E, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x64, 0x02, 0x60, 0x02, 0x80, 0xCD, 0x71, 0xB3, 0x22, -+0x90, 0x05, 0x22, 0x74, 0xFF, 0xF0, 0xF1, 0xF2, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, -+0x03, 0xF1, 0x1C, 0x12, 0x77, 0xE2, 0xE4, 0x90, 0x8E, 0x7D, 0xF0, 0x22, 0x74, 0x15, 0x2F, 0xF8, -+0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, -+0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, 0xF1, 0x1C, -+0x7D, 0x02, 0x7F, 0x03, 0xF1, 0x1C, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0xF0, 0x90, 0x8E, 0x85, -+0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, 0x01, 0x14, 0x90, 0x8E, 0x78, -+0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x20, 0xE2, 0x0D, 0x7D, 0x01, 0x7F, 0x04, 0x21, -+0x4A, 0x90, 0x8E, 0x78, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xEF, 0x70, 0x33, 0x7D, 0x78, 0x7F, 0x02, -+0xF1, 0xBB, 0x7D, 0x02, 0x7F, 0x03, 0xF1, 0xBB, 0x7D, 0xC8, 0x7F, 0x02, 0x12, 0x78, 0xC6, 0x90, -+0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x7D, 0x01, 0x7F, 0x0C, 0x31, 0x4A, -+0x90, 0x8E, 0x77, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x80, -+0x80, 0x7D, 0x02, 0x7F, 0x02, 0xF1, 0xBB, 0x7D, 0x01, 0x7F, 0x02, 0x74, 0x15, 0x2F, 0xF8, 0xE6, -+0xFE, 0xED, 0xF4, 0x5E, 0xFE, 0xF6, 0x74, 0x30, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, -+0xEE, 0xF0, 0x22, 0xE4, 0xFF, 0x61, 0xC8, 0x90, 0xFD, 0x10, 0xEF, 0xF0, 0x7F, 0x00, 0x22, 0x90, -+0x8E, 0x7A, 0xE0, 0x60, 0x02, 0x71, 0x7E, 0x22, 0x7F, 0x90, 0x12, 0x4E, 0x30, 0xEF, 0x20, 0xE0, -+0xF7, 0x22, 0xE4, 0x90, 0x91, 0x1C, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, -+0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0xD3, 0x90, -+0x91, 0x1D, 0xE0, 0x94, 0xE8, 0x90, 0x91, 0x1C, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, -+0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x91, -+0x1C, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x80, 0xBF, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, -+0x12, 0x48, 0x4E, 0x90, 0x8F, 0xAB, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x60, -+0xE9, 0xC2, 0xAF, 0x30, 0xE1, 0x06, 0x54, 0xFD, 0xF0, 0x12, 0x62, 0xCD, 0xD2, 0xAF, 0xC2, 0xAF, -+0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x30, 0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, 0x6D, 0xB9, 0xD2, 0xAF, -+0xC2, 0xAF, 0x90, 0x8D, 0x01, 0xE0, 0xFF, 0x30, 0xE4, 0x0B, 0x54, 0xEF, 0xF0, 0x12, 0x79, 0xA0, -+0xBF, 0x01, 0x02, 0x11, 0x89, 0xD2, 0xAF, 0x80, 0xC1, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0xE4, 0x90, 0x90, 0x9F, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, -+0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0xE0, 0x7C, 0x00, 0x24, -+0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x90, 0x95, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x82, 0xE0, 0x90, -+0x90, 0x9E, 0xF0, 0x90, 0x8E, 0x92, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0xC8, 0x90, 0x8E, 0x97, 0xE0, -+0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x02, 0xF1, 0x27, 0xE4, 0x90, 0x90, 0x9D, -+0xF0, 0x90, 0x90, 0x9E, 0xE0, 0xFF, 0x90, 0x90, 0x9D, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0x41, 0xC8, -+0x90, 0x90, 0x95, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x90, -+0xA5, 0xEF, 0xF0, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, -+0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, -+0x3E, 0x54, 0x3F, 0xFE, 0x90, 0x90, 0x97, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x90, 0xA3, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, -+0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x90, 0x9B, 0xF0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0xFE, 0x90, -+0x90, 0x96, 0xE0, 0x2F, 0xFF, 0x90, 0x90, 0x95, 0xE0, 0x3E, 0xFE, 0x90, 0x90, 0x99, 0xF0, 0xA3, -+0xEF, 0xF0, 0xE4, 0xFD, 0x51, 0xDF, 0xC0, 0x07, 0x90, 0x90, 0x99, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -+0x7D, 0x04, 0x51, 0xDF, 0xAD, 0x07, 0xD0, 0x07, 0xF1, 0x68, 0x90, 0x90, 0x9F, 0xEF, 0xF0, 0x90, -+0x90, 0x99, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xE4, 0xFD, 0x51, 0xDF, 0xEF, 0x54, 0xFC, 0x90, 0x90, -+0x9C, 0xF0, 0x90, 0x90, 0x9B, 0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0x90, 0x90, 0x97, 0x8F, 0xF0, -+0x12, 0x08, 0xD6, 0x90, 0x90, 0x97, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x79, 0xDD, 0x90, 0x90, -+0x97, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x90, 0x95, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7D, 0x0F, -+0x51, 0xDF, 0x90, 0x90, 0x97, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x90, 0x90, 0x95, 0xEC, 0x8D, 0xF0, -+0x12, 0x08, 0xD6, 0x90, 0x8D, 0xF4, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x90, 0x90, 0x96, 0xE0, -+0x9D, 0x90, 0x90, 0x95, 0xE0, 0x9C, 0x40, 0x1B, 0x90, 0x8D, 0xF5, 0xE0, 0x24, 0x01, 0xFD, 0x90, -+0x8D, 0xF4, 0xE0, 0x34, 0x00, 0xFC, 0xC3, 0x90, 0x90, 0x96, 0xE0, 0x9D, 0xF0, 0x90, 0x90, 0x95, -+0xE0, 0x9C, 0xF0, 0xEF, 0x30, 0xE7, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x21, 0xF0, 0xEF, 0x30, 0xE6, -+0x06, 0x90, 0x01, 0xC7, 0x74, 0x22, 0xF0, 0xEF, 0x30, 0xE5, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x23, -+0xF0, 0x90, 0x90, 0x9C, 0xE0, 0x24, 0x40, 0x60, 0x04, 0x24, 0x20, 0x70, 0x31, 0x90, 0x8E, 0x93, -+0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x58, 0x90, 0x8E, 0xA4, 0xE0, 0x04, -+0xF0, 0x90, 0x90, 0x99, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF1, 0x81, 0xEF, 0x60, 0x45, 0x90, 0x90, -+0x9C, 0xE0, 0xFF, 0x12, 0x7E, 0x52, 0x90, 0x8E, 0xA5, 0xE0, 0x04, 0xF0, 0x80, 0x35, 0x90, 0x90, -+0x99, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x90, 0x9F, 0xE0, 0xFD, 0x90, 0x90, 0xA2, 0xE0, 0xFB, -+0x90, 0x90, 0xA5, 0xE0, 0x90, 0x90, 0xFA, 0xF0, 0xD1, 0x90, 0x90, 0x8E, 0x92, 0xE0, 0xFF, 0xC3, -+0x13, 0x30, 0xE0, 0x0F, 0x90, 0x90, 0x99, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x90, 0x9F, 0xE0, -+0xFD, 0x91, 0xCB, 0x12, 0x7E, 0x69, 0xEF, 0x64, 0x01, 0x60, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, -+0xE2, 0x02, 0xF1, 0x27, 0x12, 0x7E, 0x2C, 0xBF, 0x01, 0x0D, 0x90, 0x8E, 0xA6, 0xE0, 0x04, 0xF0, -+0x90, 0x90, 0x95, 0xF1, 0xDA, 0x80, 0x09, 0x90, 0x8E, 0x92, 0xE0, 0x54, 0xFE, 0xF0, 0x80, 0x08, -+0x90, 0x90, 0x9D, 0xE0, 0x04, 0xF0, 0x01, 0xE1, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFD, 0x90, 0x8F, -+0xB6, 0xE0, 0x34, 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0xE4, 0xFD, 0xAB, -+0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0x8D, 0xF5, 0xE0, 0x9B, 0x90, -+0x8D, 0xF4, 0xE0, 0x9A, 0x50, 0x13, 0xA3, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8D, 0xF4, 0xE0, 0x34, -+0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, -+0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFF, 0x22, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8F, 0xAF, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, -+0x8F, 0xB4, 0x74, 0x08, 0xF0, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xEF, 0x44, 0x08, 0xF0, 0x90, 0x8F, -+0xAF, 0xA3, 0xE0, 0xFE, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFF, 0x74, -+0x04, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF1, 0x64, 0x90, 0x8F, 0xB0, 0xE0, 0x2F, 0xFF, 0x90, -+0x8F, 0xAF, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x8F, 0xB4, 0xE0, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x3E, -+0x90, 0x8F, 0xB6, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, 0x83, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -+0x8E, 0x79, 0xF4, 0x12, 0x08, 0xAA, 0x90, 0x8F, 0xB7, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8F, 0xB6, -+0xE0, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0x90, 0x8E, 0xF5, 0xEF, 0xF0, 0x90, 0x8F, 0xB7, -+0xE0, 0x24, 0x04, 0xFF, 0x90, 0x8F, 0xB6, 0xE0, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0x90, -+0x8E, 0xF8, 0xEF, 0xF0, 0x90, 0x8F, 0xB7, 0xE0, 0x24, 0x05, 0xFF, 0x90, 0x8F, 0xB6, 0xE0, 0x34, -+0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0x90, 0x8E, 0xF9, 0xEF, 0xF0, 0x90, 0x8F, 0xB7, 0xE0, 0x24, -+0x06, 0xFF, 0x90, 0x8F, 0xB6, 0xE0, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0x90, 0x8E, 0xFA, -+0xEF, 0xF0, 0x90, 0x8F, 0xB7, 0xE0, 0x24, 0x07, 0xFF, 0x90, 0x8F, 0xB6, 0xE0, 0x34, 0x00, 0xFE, -+0xE4, 0xFD, 0x51, 0xDF, 0x90, 0x8E, 0xFB, 0xEF, 0xF0, 0x90, 0x8F, 0xB7, 0xE0, 0x24, 0x08, 0xFF, -+0x90, 0x8F, 0xB6, 0xE0, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0x90, 0x8E, 0xFC, 0xEF, 0xF0, -+0xE4, 0x90, 0x8F, 0xB5, 0xF0, 0x90, 0x8F, 0xB5, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x1F, 0x90, -+0x8F, 0xB7, 0xE0, 0x24, 0x09, 0x51, 0xCD, 0x90, 0x8F, 0xB5, 0xE0, 0x24, 0xFD, 0xF5, 0x82, 0xE4, -+0x34, 0x8E, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xB5, 0xE0, 0x04, 0xF0, 0x80, 0xD7, 0xE4, 0x90, -+0x8F, 0xB5, 0xF0, 0x90, 0x8F, 0xB5, 0xE0, 0xFF, 0xC3, 0x94, 0x20, 0x50, 0x1F, 0x90, 0x8F, 0xB7, -+0xE0, 0x24, 0x63, 0x51, 0xCD, 0x90, 0x8F, 0xB5, 0xE0, 0x24, 0x57, 0xF5, 0x82, 0xE4, 0x34, 0x8F, -+0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xB5, 0xE0, 0x04, 0xF0, 0x80, 0xD7, 0x90, 0x8E, 0xF9, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFD, 0xED, 0xFF, 0x90, 0x8F, 0xB2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x30, 0xE3, -+0x04, 0xF1, 0x27, 0x80, 0x3F, 0x90, 0x8F, 0xB2, 0xA3, 0xE0, 0xFF, 0x7C, 0x00, 0x54, 0x07, 0xFD, -+0x64, 0x01, 0x60, 0x05, 0xED, 0x64, 0x02, 0x70, 0x2B, 0xED, 0x64, 0x02, 0x4C, 0x70, 0x25, 0xEF, -+0x54, 0x30, 0xFF, 0xE4, 0xC4, 0xF8, 0x54, 0xF0, 0xC8, 0xEF, 0xC4, 0x54, 0x0F, 0x48, 0x90, 0x8F, -+0x8D, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xE4, 0xFD, 0x12, 0x76, 0x35, 0x90, 0x06, 0x31, 0xE0, 0x54, -+0xF7, 0x44, 0x10, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8F, 0xAF, 0xEE, 0xF0, -+0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x78, 0xB8, 0x7C, 0x8F, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, -+0x79, 0x56, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x06, 0x63, 0x78, 0xBE, 0x7C, 0x8F, 0x7D, 0x01, 0x7B, -+0xFF, 0x7A, 0x40, 0x79, 0x5C, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x06, 0x63, 0x78, 0xC2, 0x7C, 0x8F, -+0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0x60, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x06, 0x63, 0x90, -+0x8F, 0xB1, 0xE0, 0xFF, 0x90, 0x8F, 0xB0, 0xE0, 0x2F, 0xFF, 0x90, 0x8F, 0xAF, 0xE0, 0x34, 0x00, -+0xCF, 0x24, 0x06, 0xCF, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0xEF, 0x64, 0x08, 0x60, 0x02, -+0xC1, 0x8F, 0x90, 0x8F, 0xB1, 0xE0, 0xFF, 0x90, 0x8F, 0xB0, 0xE0, 0x2F, 0xFF, 0x90, 0x8F, 0xAF, -+0xE0, 0x34, 0x00, 0xCF, 0x24, 0x07, 0xCF, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x51, 0xDF, 0xEF, 0x64, -+0x06, 0x60, 0x02, 0xC1, 0x8F, 0x90, 0x8F, 0xC6, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0xFF, 0xC3, 0x94, -+0x06, 0x50, 0x23, 0x90, 0x8F, 0xB0, 0xE0, 0x24, 0x0A, 0xFD, 0x90, 0x8F, 0xAF, 0x51, 0xD1, 0x90, -+0x8F, 0xC6, 0xE0, 0x24, 0xB2, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, -+0xC6, 0xE0, 0x04, 0xF0, 0x80, 0xD3, 0xE4, 0x90, 0x8F, 0xC6, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0xFF, -+0xC3, 0x94, 0x06, 0x50, 0x2E, 0x90, 0x8F, 0xB1, 0xE0, 0xFD, 0x90, 0x8F, 0xB0, 0xE0, 0x2D, 0xFD, -+0x90, 0x8F, 0xAF, 0xE0, 0x34, 0x00, 0xCD, 0x24, 0x10, 0xCD, 0x51, 0xD2, 0x90, 0x8F, 0xC6, 0xE0, -+0x24, 0xB8, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0x04, -+0xF0, 0x80, 0xC8, 0xE4, 0x90, 0x8F, 0xC6, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0xFF, 0xC3, 0x94, 0x04, -+0x50, 0x2E, 0x90, 0x8F, 0xB1, 0xE0, 0xFD, 0x90, 0x8F, 0xB0, 0xE0, 0x2D, 0xFD, 0x90, 0x8F, 0xAF, -+0xE0, 0x34, 0x00, 0xCD, 0x24, 0x16, 0xCD, 0x51, 0xD2, 0x90, 0x8F, 0xC6, 0xE0, 0x24, 0xBE, 0xF5, -+0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0x04, 0xF0, 0x80, 0xC8, -+0x78, 0xB2, 0x7C, 0x8F, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0x9E, 0x7E, 0x00, 0x7F, 0x06, -+0x12, 0x4A, 0xA9, 0xEF, 0x70, 0x79, 0x90, 0x8F, 0xC6, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0xFF, 0xC3, -+0x94, 0x04, 0x50, 0x2E, 0x90, 0x8F, 0xB1, 0xE0, 0xFD, 0x90, 0x8F, 0xB0, 0xE0, 0x2D, 0xFD, 0x90, -+0x8F, 0xAF, 0xE0, 0x34, 0x00, 0xCD, 0x24, 0x20, 0xCD, 0x51, 0xD2, 0x90, 0x8F, 0xC6, 0xE0, 0x24, -+0xC2, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xC6, 0xE0, 0x04, 0xF0, -+0x80, 0xC8, 0x78, 0xC2, 0x7C, 0x8F, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xA7, 0x7E, 0x00, -+0x7F, 0x04, 0x12, 0x4A, 0xA9, 0xEF, 0x90, 0x06, 0x30, 0x70, 0x1E, 0xE0, 0x44, 0x01, 0x54, 0xDF, -+0xF0, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xB8, 0x90, 0x8F, 0xCA, 0x12, 0x48, 0xF4, 0xE4, 0x90, 0x8F, -+0xCD, 0xF0, 0x7A, 0x8F, 0x79, 0xBE, 0x02, 0x71, 0x7F, 0xE0, 0x44, 0x21, 0x54, 0xEF, 0xF0, 0x22, -+0x90, 0x90, 0xF8, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x90, 0xF6, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0xE4, 0xFD, 0x51, 0xDF, 0xEF, 0x54, 0x0C, 0x64, 0x08, 0x70, 0x7B, 0x90, 0x90, 0xF6, 0xE0, 0xFE, -+0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0x06, 0xFD, 0x51, 0xDF, 0xEF, 0x64, 0x88, 0x70, 0x67, 0x90, -+0x90, 0xF6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0x07, 0xFD, 0x51, 0xDF, 0xEF, 0x64, -+0x8E, 0x70, 0x53, 0x90, 0x90, 0xF6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x90, 0xF9, 0xE0, 0xFD, -+0x90, 0x90, 0xF8, 0xE0, 0x2D, 0x04, 0xFD, 0x51, 0xDF, 0xEF, 0x64, 0x03, 0x70, 0x38, 0x90, 0x90, -+0xF6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x90, 0xF9, 0xE0, 0xFD, 0x90, 0x90, 0xF8, 0xE0, 0x2D, -+0x24, 0x06, 0xFD, 0x51, 0xDF, 0xEF, 0x30, 0xE3, 0x0E, 0x90, 0x01, 0xC7, 0x74, 0x01, 0xF0, 0x90, -+0x8E, 0x97, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x90, 0xF6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, -+0x90, 0xFA, 0xE0, 0xFD, 0x71, 0x1D, 0x22, 0x90, 0x8D, 0x04, 0xE0, 0xB4, 0x02, 0x15, 0x90, 0x8E, -+0x94, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x0F, 0x90, 0x01, 0x4D, 0xE0, 0x64, -+0x80, 0xF0, 0x22, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -+0xFE, 0x24, 0x28, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x2C, 0x2E, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFD, 0xE4, 0xFE, 0xEF, 0x30, 0xE7, 0x04, 0x7C, 0x02, -+0x80, 0x02, 0xE4, 0xFC, 0xAF, 0x05, 0x12, 0x77, 0x78, 0xAE, 0x07, 0xEC, 0x24, 0x18, 0x2E, 0xFF, -+0x22, 0x90, 0x90, 0xD3, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x90, 0xDB, 0xF0, 0x90, 0x90, -+0xDB, 0xE0, 0xFD, 0xC3, 0x94, 0x06, 0x50, 0x27, 0x90, 0x90, 0xD4, 0xE0, 0x24, 0x04, 0xFF, 0x90, -+0x90, 0xD3, 0xE0, 0x34, 0x00, 0xFE, 0x51, 0xDF, 0x90, 0x90, 0xDB, 0xE0, 0x24, 0xD5, 0xF5, 0x82, -+0xE4, 0x34, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x90, 0xDB, 0xE0, 0x04, 0xF0, 0x80, 0xCF, 0x78, -+0x98, 0x7C, 0x8E, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xD5, 0x7E, 0x00, 0x7F, 0x06, 0x12, -+0x4A, 0xA9, 0xEF, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, -+0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, -+0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xED, 0x90, 0x01, -+0xC4, 0xED, 0xF0, 0x74, 0x5F, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, -+0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, -+0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, -+0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x1E, -+0xF0, 0x74, 0x60, 0xA3, 0xF0, 0x12, 0x4E, 0x52, 0x74, 0x1E, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -+0x60, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -+0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, -+0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, -+0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x6E, -+0xF0, 0x74, 0x60, 0xA3, 0xF0, 0x12, 0x70, 0x92, 0xE5, 0x19, 0x30, 0xE3, 0x02, 0x31, 0xEF, 0xE5, -+0x19, 0x30, 0xE4, 0x02, 0x31, 0xDC, 0xE5, 0x1B, 0x30, 0xE0, 0x02, 0x31, 0x0F, 0xE5, 0x1B, 0x30, -+0xE1, 0x02, 0x51, 0x33, 0xE5, 0x1B, 0x30, 0xE2, 0x02, 0x31, 0xFB, 0xE5, 0x1B, 0x30, 0xE3, 0x03, -+0x12, 0x70, 0xEF, 0xE5, 0x1B, 0x30, 0xE4, 0x03, 0x12, 0x71, 0x22, 0xE5, 0x1B, 0x30, 0xE5, 0x03, -+0x12, 0x56, 0xE4, 0xE5, 0x1B, 0x30, 0xE6, 0x02, 0xF1, 0xCD, 0xE5, 0x1C, 0x30, 0xE1, 0x03, 0x12, -+0x57, 0xDF, 0xE5, 0x1C, 0x30, 0xE6, 0x02, 0x31, 0x9C, 0x74, 0x6E, 0x04, 0x90, 0x01, 0xC4, 0xF0, -+0x74, 0x60, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, -+0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, -+0xFF, 0x90, 0x8E, 0x7A, 0xE0, 0x70, 0x02, 0x21, 0x9B, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, -+0x7A, 0x90, 0x8E, 0x79, 0xE0, 0xC4, 0x54, 0x0F, 0x60, 0x24, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, -+0x1F, 0x90, 0x8E, 0x81, 0xE0, 0x14, 0xF0, 0xE0, 0xFE, 0x60, 0x06, 0x90, 0x8E, 0x83, 0xE0, 0x60, -+0x0F, 0xEE, 0x70, 0x06, 0x90, 0x8E, 0x80, 0xE0, 0xA3, 0xF0, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x01, -+0xEF, 0x60, 0x48, 0x90, 0x8E, 0x7E, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x8E, 0x83, 0xE0, 0x60, 0x03, -+0xB4, 0x01, 0x09, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x83, 0xE0, 0x80, 0x0D, 0xE4, 0xF5, 0x3B, 0x90, -+0x8E, 0x83, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0x8E, 0x82, 0xE0, 0x2F, 0xF5, -+0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, 0x74, 0x05, -+0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x51, 0x46, 0x22, 0x90, 0x07, 0x1F, 0xE0, -+0x54, 0x7F, 0xF0, 0x90, 0x07, 0x1C, 0xE0, 0x54, 0x01, 0x90, 0x90, 0x5F, 0xF0, 0x90, 0x90, 0x5D, -+0x74, 0x02, 0xF0, 0x90, 0x90, 0x6B, 0x14, 0xF0, 0xFB, 0x7A, 0x90, 0x79, 0x5D, 0x71, 0xAE, 0x7F, -+0x04, 0x90, 0x91, 0x23, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x48, 0x27, 0x90, 0x8D, 0x01, 0xE0, 0xFF, -+0x90, 0x91, 0x23, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x8D, 0x01, 0xF0, 0x22, 0xF1, 0xE9, 0x7F, 0x02, -+0x8F, 0x59, 0x7F, 0x02, 0x12, 0x48, 0x27, 0x90, 0x8D, 0x01, 0xE0, 0x45, 0x59, 0xF0, 0x22, 0x90, -+0x8E, 0x92, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x10, 0x31, 0xE0, 0x22, 0x90, 0x8F, 0xA6, 0xE0, 0x04, -+0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x02, 0x60, 0x29, 0xB1, 0xB5, 0x90, 0x8E, 0x78, 0xE0, 0x13, -+0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x15, 0x90, 0x8E, 0x80, 0xE0, 0xFF, 0xA3, 0xE0, 0x6F, 0x70, -+0x0B, 0xD1, 0x4B, 0x12, 0x57, 0xB1, 0x90, 0x8E, 0x81, 0xE0, 0x14, 0xF0, 0x90, 0x01, 0xE6, 0xE0, -+0x04, 0xF0, 0x22, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x46, 0x90, 0x8E, 0x78, 0xE0, 0xFF, 0x13, 0x13, -+0x13, 0x54, 0x1F, 0x30, 0xE0, 0x13, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0C, 0x12, 0x57, 0xB1, -+0x90, 0x8E, 0x80, 0xE0, 0x14, 0x90, 0x05, 0x73, 0xF0, 0x90, 0x91, 0x18, 0xE4, 0x75, 0xF0, 0x01, -+0x12, 0x08, 0xD6, 0xC3, 0x90, 0x91, 0x19, 0xE0, 0x94, 0x80, 0x90, 0x91, 0x18, 0xE0, 0x64, 0x80, -+0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x12, -+0x7F, 0x3E, 0x90, 0x8F, 0x9E, 0xE0, 0x30, 0xE0, 0x2E, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, 0x01, 0x27, -+0x90, 0x91, 0x24, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0x8F, 0xA0, 0xE0, 0x04, 0xF0, -+0xE4, 0x90, 0x91, 0x24, 0xF0, 0x90, 0x8F, 0xA0, 0xE0, 0xFF, 0x90, 0x8F, 0x9F, 0xE0, 0xB5, 0x07, -+0x06, 0xE4, 0xA3, 0xF0, 0x12, 0x57, 0xD3, 0x22, 0x12, 0x81, 0xAF, 0x90, 0x8E, 0x80, 0xE0, 0x14, -+0x90, 0x05, 0x73, 0xF0, 0x7D, 0x02, 0x7F, 0x02, 0x12, 0x57, 0x1C, 0x80, 0xB5, 0xD3, 0x10, 0xAF, -+0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8D, 0x5B, 0xE0, 0xFF, 0x90, 0x8D, 0x5A, 0xE0, 0xB5, 0x07, 0x04, -+0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x3F, 0x90, 0x8D, 0x5A, 0xE0, 0xFE, 0x75, 0xF0, -+0x08, 0x90, 0x8D, 0x0A, 0x12, 0x48, 0xDF, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x0B, -+0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0xD1, 0x6F, 0x90, 0x8D, 0x5A, 0xE0, -+0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8D, -+0x5A, 0xF0, 0xF1, 0xE9, 0x7F, 0x02, 0x31, 0xC1, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x90, 0xA6, -+0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xF5, 0x52, 0xA3, 0xE0, 0xF5, 0x53, 0x65, 0x52, 0x60, 0x6D, -+0x90, 0x90, 0xA7, 0x74, 0x03, 0xF0, 0x90, 0x90, 0xB5, 0x74, 0x08, 0xF0, 0xE5, 0x53, 0x04, 0x54, -+0x0F, 0xF5, 0x54, 0xE4, 0xF5, 0x51, 0xE5, 0x54, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, -+0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x25, 0x51, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, -+0xE0, 0xFF, 0x74, 0xA9, 0x25, 0x51, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x05, -+0x51, 0xE5, 0x51, 0xB4, 0x08, 0xD0, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xA7, 0x71, 0xAE, 0xE5, 0x53, -+0x04, 0x54, 0x0F, 0xF5, 0x53, 0xB4, 0x0F, 0x03, 0xE4, 0xF5, 0x53, 0x90, 0x04, 0x7F, 0xE5, 0x53, -+0xF0, 0x90, 0x90, 0xA6, 0xE0, 0x7F, 0x04, 0x70, 0x02, 0x21, 0xE0, 0x31, 0xC1, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8D, 0xF2, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, -+0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x8D, 0xF3, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, -+0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x35, 0xC0, 0x01, -+0x90, 0x8D, 0xF3, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x5C, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xA8, -+0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x06, 0x63, 0x90, 0x8D, 0xF3, -+0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, -+0x8D, 0xF3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, -+0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, -+0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x18, 0xF0, 0x74, 0x64, 0xA3, 0xF0, 0x12, -+0x70, 0xBF, 0xE5, 0x21, 0x30, 0xE1, 0x02, 0x91, 0x9C, 0xE5, 0x21, 0x30, 0xE2, 0x03, 0x12, 0x56, -+0x6F, 0xE5, 0x22, 0x30, 0xE0, 0x02, 0xB1, 0x6B, 0xE5, 0x24, 0x30, 0xE1, 0x04, 0x7F, 0x04, 0x31, -+0xE0, 0xE5, 0x24, 0x30, 0xE4, 0x02, 0x51, 0xB8, 0xE5, 0x24, 0x30, 0xE5, 0x02, 0x91, 0xA6, 0xE5, -+0x24, 0x30, 0xE6, 0x02, 0xB1, 0x2D, 0x74, 0x18, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x64, 0xA3, -+0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -+0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x8E, 0x7A, 0xE0, -+0x60, 0x03, 0x12, 0x81, 0xEF, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, -+0x30, 0xE0, 0x27, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x8E, 0x78, 0x30, 0xE0, -+0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x10, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, -+0xF0, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x12, 0x51, 0x3D, 0xE4, 0xFF, 0x90, 0x8F, 0xA1, 0xE0, -+0x30, 0xE0, 0x49, 0x90, 0x8F, 0xA5, 0xE0, 0xFD, 0x60, 0x42, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, -+0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, -+0xEF, 0x5B, 0x60, 0x06, 0xE4, 0x90, 0x8F, 0xA5, 0xF0, 0x22, 0x90, 0x8F, 0xA3, 0xE0, 0xD3, 0x9D, -+0x50, 0x11, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0x12, 0x5F, 0x27, 0x90, 0x8F, 0xA1, 0xE0, 0x54, -+0xFE, 0xF0, 0x22, 0x12, 0x57, 0xD3, 0x90, 0x8F, 0xA5, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x8E, 0x77, -+0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x30, 0xE0, 0x2C, 0xEF, 0x54, 0x7F, 0xF0, 0x90, -+0x04, 0xE0, 0xE0, 0x90, 0x8E, 0x78, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x0F, 0xE0, -+0x54, 0xFD, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x04, 0xF0, 0x90, 0x8E, -+0x7A, 0xE0, 0x60, 0x03, 0x12, 0x51, 0x3D, 0x7F, 0x01, 0x81, 0xDC, 0x12, 0x78, 0x7B, 0x90, 0x90, -+0x6C, 0xEF, 0xF0, 0x90, 0x8E, 0x77, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x04, 0xE0, -+0x54, 0xFE, 0xF0, 0x90, 0x90, 0x6C, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, -+0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x30, -+0xE0, 0x12, 0x90, 0x8E, 0x85, 0xE4, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x90, 0x8E, 0x85, 0xA3, 0xE0, -+0x90, 0x05, 0x58, 0xF0, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x60, 0x02, 0xC1, 0x4A, 0x90, -+0x8E, 0x7A, 0xE0, 0x70, 0x02, 0xC1, 0x4A, 0x90, 0x8E, 0x79, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, -+0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x8E, 0x81, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x8E, -+0x80, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x8E, 0x80, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, -+0x8E, 0x81, 0xEF, 0xF0, 0x90, 0x8E, 0x78, 0xE0, 0x44, 0x04, 0xF0, 0xE4, 0x90, 0x8E, 0x83, 0xF0, -+0x90, 0x8E, 0x85, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, -+0x3C, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x90, 0x8E, -+0x79, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x03, 0x12, 0x55, 0x5A, 0x90, -+0x8E, 0x78, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0F, 0x90, 0x8E, 0x80, 0xE0, 0xFF, -+0xA3, 0xE0, 0xB5, 0x07, 0x05, 0xD1, 0x4B, 0x12, 0x57, 0xB7, 0x22, 0xEF, 0x14, 0x90, 0x05, 0x73, -+0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x74, 0x1D, 0x2F, 0xF8, 0xE6, 0x4D, -+0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, -+0x8F, 0xAC, 0x12, 0x48, 0xF4, 0xEF, 0x12, 0x48, 0xFD, 0x66, 0xA7, 0x00, 0x66, 0xB0, 0x01, 0x66, -+0xB9, 0x02, 0x66, 0xC2, 0x03, 0x66, 0xCB, 0x04, 0x66, 0xD3, 0x20, 0x66, 0xDC, 0x21, 0x66, 0xE5, -+0x23, 0x66, 0xED, 0x25, 0x66, 0xFE, 0x80, 0x66, 0xF5, 0x81, 0x67, 0x07, 0x82, 0x67, 0x0F, 0x83, -+0x67, 0x18, 0x84, 0x00, 0x00, 0x67, 0x21, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x6A, 0x58, -+0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x6A, 0xA0, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, -+0x6B, 0x76, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x79, 0x80, 0x90, 0x8F, 0xAC, 0x12, 0x48, -+0xEB, 0x80, 0x56, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x6B, 0xAE, 0x90, 0x8F, 0xAC, 0x12, -+0x48, 0xEB, 0x02, 0x6C, 0xAA, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x80, 0x68, 0x90, 0x8F, 0xAC, -+0x12, 0x48, 0xEB, 0x80, 0x68, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x7B, 0xC4, 0x90, 0x8F, -+0xAC, 0x12, 0x48, 0xEB, 0x02, 0x7D, 0x6E, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0xE1, 0xB3, 0x90, -+0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x7E, 0x87, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, 0x02, 0x7E, -+0xDC, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xF1, 0x6D, 0x12, 0x06, 0x89, 0xFF, 0x54, -+0x01, 0xFE, 0x90, 0x8F, 0xA1, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x14, -+0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0x8F, 0xA2, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, -+0x90, 0x8F, 0xA3, 0xF0, 0x22, 0x12, 0x06, 0x89, 0x90, 0x8E, 0x84, 0xF0, 0x22, 0x12, 0x06, 0x89, -+0x90, 0x8E, 0x91, 0xF0, 0x90, 0x8E, 0x91, 0xE0, 0x90, 0x01, 0xE7, 0xF0, 0x22, 0x90, 0x8F, 0xA1, -+0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xA3, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, -+0xF0, 0x22, 0xF1, 0x8D, 0xF1, 0x93, 0x12, 0x7F, 0x7C, 0xF1, 0xA1, 0x80, 0xE0, 0xE4, 0x90, 0x8D, -+0xF6, 0xF0, 0x22, 0xE4, 0x90, 0x8D, 0xF2, 0xF0, 0xA3, 0xF0, 0x90, 0x8D, 0x5A, 0xF0, 0xA3, 0xF0, -+0x22, 0x90, 0x8F, 0x9E, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, -+0xA3, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x8F, 0xAF, 0xF0, 0x12, 0x06, 0x89, 0x90, 0x8F, -+0x8E, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0x8F, 0x8F, 0xF0, 0x22, 0x90, 0x8D, 0xF6, -+0xE0, 0xB4, 0x01, 0x14, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x0E, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFE, -+0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x51, 0x3D, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, -+0x91, 0x12, 0xF0, 0x90, 0x91, 0x12, 0xE0, 0xFD, 0x70, 0x03, 0x02, 0x69, 0xA0, 0x90, 0x8D, 0x5A, -+0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x8D, 0x5B, -+0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, -+0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x91, 0x0F, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, -+0x08, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, -+0x99, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, 0x48, 0xDF, 0xE0, 0x90, -+0x91, 0x13, 0xF0, 0x75, 0x40, 0x01, 0x75, 0x41, 0x91, 0x75, 0x42, 0x13, 0x75, 0x43, 0x01, 0x7B, -+0x01, 0x7A, 0x91, 0x79, 0x14, 0x12, 0x34, 0x62, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, -+0x01, 0xD0, 0x12, 0x48, 0xDF, 0xE0, 0xFF, 0x90, 0x8D, 0x5B, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, -+0x8D, 0x0A, 0x12, 0x48, 0xDF, 0xEF, 0xF0, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, -+0xD1, 0x12, 0x48, 0xDF, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0B, 0x12, 0x48, 0xDF, -+0xEF, 0xF0, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD2, 0x12, 0x48, 0xDF, 0xE0, -+0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0C, 0x12, 0x48, 0xDF, 0xEF, 0xF0, 0x90, 0x91, 0x0F, -+0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD3, 0x12, 0x48, 0xDF, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, -+0x90, 0x8D, 0x0D, 0x12, 0x48, 0xDF, 0xEF, 0xF0, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, -+0x01, 0xF0, 0x12, 0x48, 0xDF, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0E, 0x12, 0x48, -+0xDF, 0xEF, 0xF0, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF1, 0x12, 0x48, 0xDF, -+0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x0F, 0x12, 0x48, 0xDF, 0xEF, 0xF0, 0x90, 0x91, -+0x0F, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xF2, 0x12, 0x48, 0xDF, 0xE0, 0xFF, 0x75, 0xF0, 0x08, -+0xEE, 0x90, 0x8D, 0x10, 0x12, 0x48, 0xDF, 0xEF, 0xF0, 0x90, 0x91, 0x0F, 0xE0, 0x75, 0xF0, 0x04, -+0x90, 0x01, 0xF3, 0x12, 0x48, 0xDF, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x90, 0x8D, 0x11, 0x12, -+0x48, 0xDF, 0xEF, 0xF0, 0x90, 0x91, 0x12, 0xE0, 0xFF, 0x90, 0x91, 0x0F, 0xE0, 0xFE, 0x74, 0x01, -+0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0x91, 0x12, 0xF0, 0x90, -+0x91, 0x0F, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, -+0x01, 0xCC, 0xF0, 0x90, 0x91, 0x0F, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x8D, 0x5B, -+0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x03, 0x02, 0x67, -+0xF3, 0xE4, 0x90, 0x8D, 0x5B, 0xF0, 0x02, 0x67, 0xF3, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, -+0x22, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, -+0x07, 0x7D, 0xA2, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x69, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, -+0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, -+0xD0, 0xE0, 0x32, 0x90, 0x90, 0xE4, 0xEF, 0xF0, 0xAB, 0x05, 0x7E, 0x00, 0x7D, 0x00, 0x7C, 0x00, -+0xE4, 0x90, 0x90, 0xE9, 0xF0, 0xAF, 0x03, 0x90, 0x90, 0xE5, 0x12, 0x08, 0x6D, 0x90, 0x90, 0xE5, -+0x12, 0x48, 0xC7, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0xB0, 0x7E, 0x08, 0x12, 0x38, 0x07, -+0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x90, 0xE4, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, -+0xB5, 0xF5, 0x82, 0xE4, 0x34, 0xAD, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x37, 0xBC, -+0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0xD3, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, -+0x90, 0x90, 0xEC, 0x12, 0x48, 0xC7, 0x90, 0xAA, 0x9C, 0x12, 0x08, 0x6D, 0xD0, 0x05, 0xD0, 0x07, -+0x12, 0x32, 0x34, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x06, 0x89, -+0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8D, 0x05, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, -+0xED, 0x2F, 0x90, 0x8D, 0x06, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, -+0x8D, 0x07, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8D, 0x08, 0xF0, -+0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x8D, 0x09, 0xF0, 0x22, -+0x90, 0x8F, 0xAF, 0x12, 0x48, 0xF4, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, 0xFE, 0x12, 0x06, -+0x89, 0xFD, 0xC3, 0x13, 0x30, 0xE0, 0x12, 0x90, 0x8F, 0xAF, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x02, -+0x12, 0x06, 0xA2, 0x90, 0x8F, 0xB3, 0xF0, 0x80, 0x05, 0x90, 0x8F, 0xB3, 0xEF, 0xF0, 0x90, 0x8F, -+0xB2, 0xEE, 0xF0, 0x90, 0x8F, 0xB3, 0xE0, 0xFE, 0x90, 0x8F, 0xB2, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, -+0x38, 0x90, 0x8F, 0xAF, 0x12, 0x48, 0xEB, 0x12, 0x06, 0x89, 0x54, 0x01, 0xFE, 0x74, 0xF6, 0x2F, -+0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0xF6, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -+0x8D, 0xF5, 0x83, 0xE0, 0x70, 0x04, 0x71, 0x52, 0x80, 0x07, 0x90, 0x8F, 0xB2, 0xE0, 0xFF, 0x71, -+0x41, 0x90, 0x8F, 0xB2, 0xE0, 0x04, 0xF0, 0x80, 0xBA, 0x90, 0x8D, 0xF6, 0xE0, 0x70, 0x21, 0x90, -+0x8E, 0x7D, 0xE0, 0x70, 0x04, 0xFF, 0x12, 0x53, 0x64, 0x90, 0x8E, 0x7D, 0xE0, 0x64, 0x0C, 0x60, -+0x02, 0x71, 0x63, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, -+0x22, 0x8F, 0x5B, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x48, 0xDF, 0xE0, 0x54, 0xFB, -+0xF0, 0x22, 0x8F, 0x5B, 0x75, 0xF0, 0x10, 0xEF, 0x90, 0x81, 0x05, 0x12, 0x48, 0xDF, 0xE0, 0x44, -+0x04, 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, -+0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x06, 0x89, -+0xFF, 0x90, 0x8E, 0x76, 0xF0, 0xBF, 0x01, 0x12, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x64, 0x01, -+0x60, 0x17, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x80, 0x0F, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, -+0x64, 0x01, 0x60, 0x05, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x06, -+0x89, 0xFF, 0x54, 0x7F, 0x90, 0x8E, 0x7A, 0xF0, 0xEF, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0xA3, -+0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0x8E, -+0x79, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0x54, 0x01, 0x25, 0xE0, -+0xFE, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0x90, 0x8E, 0x92, 0xE0, 0x30, 0xE0, 0x09, -+0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0xF0, 0x80, 0x0F, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, -+0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0x90, 0x8E, -+0x7C, 0xF0, 0x91, 0x39, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0xF0, 0x90, 0x8E, -+0x7A, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x8E, 0x7C, 0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x90, 0x8E, -+0x79, 0xE0, 0x54, 0x0F, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, 0x8F, 0xAF, 0x12, 0x48, 0xF4, 0x91, -+0x68, 0x90, 0x8E, 0x7A, 0xE0, 0xFF, 0x12, 0x57, 0x79, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x18, 0x90, -+0x8F, 0xAF, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x54, 0x0F, 0xFF, 0x90, 0x00, -+0x02, 0x12, 0x06, 0xA2, 0xFD, 0x91, 0x79, 0x22, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, -+0x90, 0x8E, 0x83, 0xF0, 0x90, 0x8E, 0x7E, 0xF0, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0C, 0x04, 0x70, -+0x28, 0x90, 0x8E, 0x80, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x22, 0xED, 0x70, 0x0A, 0x90, 0x8E, 0x8E, -+0xE0, 0x90, 0x8E, 0x80, 0xF0, 0x80, 0x05, 0x90, 0x8E, 0x80, 0xED, 0xF0, 0x90, 0x8E, 0x80, 0xE0, -+0xA3, 0xF0, 0x90, 0x8E, 0x78, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, -+0xFF, 0x30, 0xE0, 0x26, 0x12, 0x06, 0x89, 0x90, 0x8E, 0x8B, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, -+0xA2, 0x90, 0x8E, 0x8C, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xA3, 0xE0, 0x54, 0x01, 0x4F, 0xF0, 0x90, -+0x00, 0x03, 0x12, 0x06, 0xA2, 0x90, 0x8E, 0x8E, 0xF0, 0x22, 0x90, 0x8E, 0x8B, 0x74, 0x01, 0xF0, -+0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0x22, -+0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x90, 0xFB, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, -+0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x90, 0xFB, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, -+0x60, 0x2D, 0xC3, 0x90, 0x90, 0xFE, 0xE0, 0x94, 0xE8, 0x90, 0x90, 0xFD, 0xE0, 0x94, 0x03, 0x40, -+0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x15, 0x90, 0x90, 0xFD, 0xE4, -+0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x80, 0xC5, 0x7F, -+0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x91, 0x03, -+0x12, 0x48, 0xF4, 0x7F, 0x96, 0x7E, 0x02, 0x91, 0xF0, 0xEF, 0x60, 0x58, 0x90, 0x01, 0x17, 0xE0, -+0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0xFE, 0xEF, 0x24, 0x01, -+0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x91, 0x06, 0xEF, 0xF0, 0xEE, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, -+0x91, 0x06, 0xE0, 0xFD, 0x90, 0x02, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x91, 0x03, 0x12, 0x48, -+0xEB, 0x90, 0x00, 0x0E, 0x12, 0x06, 0xA2, 0x24, 0x02, 0xFF, 0xE4, 0x33, 0xFE, 0xD1, 0xDA, 0x90, -+0x91, 0x06, 0xE0, 0x24, 0x18, 0xFF, 0x90, 0x91, 0x03, 0x12, 0x48, 0xEB, 0xF1, 0x35, 0x90, 0x02, -+0x96, 0x74, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -+0xE4, 0xFF, 0x90, 0x8D, 0xF3, 0xE0, 0xFE, 0x90, 0x8D, 0xF2, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, -+0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x48, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x13, -+0xED, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x5C, 0xF9, 0x74, 0x8D, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xD1, -+0x27, 0x7F, 0x01, 0x90, 0x8D, 0xF2, 0xE0, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0x5C, 0xF9, 0x74, 0x8D, -+0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xB1, 0x46, 0x7F, 0x01, 0xEF, 0x60, 0x16, 0x90, 0x8D, 0xF2, 0xE0, -+0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x02, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x8D, -+0xF2, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8F, -+0xAC, 0x12, 0x48, 0xF4, 0x90, 0x91, 0x11, 0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, -+0x06, 0xE1, 0x7F, 0xAF, 0x7E, 0x01, 0x91, 0xF0, 0xEF, 0x60, 0x3A, 0x90, 0x8F, 0xAC, 0x12, 0x48, -+0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x90, 0x00, 0x0E, 0x12, 0x06, 0xA2, 0x24, 0x02, 0xF5, -+0x43, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x34, 0x62, 0x90, 0x8F, 0xAC, 0x12, 0x48, 0xEB, -+0x90, 0x00, 0x0E, 0x12, 0x06, 0xA2, 0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, -+0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -+0xD0, 0xE4, 0xFF, 0x90, 0x90, 0xB7, 0xF0, 0x90, 0x01, 0xC7, 0xE0, 0x64, 0xAD, 0x70, 0x36, 0xF0, -+0x90, 0x90, 0xC4, 0x74, 0x0F, 0xF0, 0x90, 0x90, 0xB6, 0x74, 0x0A, 0xF0, 0xA3, 0xE0, 0x04, 0xF0, -+0x90, 0x90, 0xB7, 0xE0, 0x2F, 0xFE, 0x74, 0xB8, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, -+0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x0F, 0xE9, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x7B, 0x01, 0x7A, -+0x90, 0x79, 0xB6, 0xB1, 0x46, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFC, 0xED, 0x2C, 0x24, 0x00, -+0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE4, 0xF0, 0x0C, 0xEC, 0xB4, 0x18, 0xEE, 0x74, 0x00, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0xEE, 0x54, 0x3F, 0xFF, 0x74, 0x01, -+0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, -+0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, -+0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0x74, 0x0B, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, -+0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x90, 0xFF, 0xEF, 0xF0, 0xA3, 0x12, 0x48, 0xF4, 0x90, 0x91, -+0x10, 0xE0, 0xFE, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x06, 0xE1, 0x74, 0x00, 0x2F, 0xF9, -+0xE4, 0x34, 0xFB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x91, 0x00, 0x12, -+0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x02, 0xD0, 0x01, 0xD0, 0x02, 0xD0, -+0x03, 0x12, 0x34, 0x62, 0x90, 0x90, 0xFF, 0xE0, 0x24, 0x02, 0xF9, 0xE4, 0x34, 0xFB, 0xFA, 0x7B, -+0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xA3, 0x12, 0x48, 0xEB, 0xE9, 0x24, 0x02, 0xF9, 0xE4, -+0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x90, 0x91, 0x00, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x0E, -+0x12, 0x06, 0xA2, 0xF5, 0x43, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x02, 0x34, 0x62, 0x90, 0x01, -+0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, -+0x04, 0xF0, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0xF0, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, -+0x90, 0x01, 0x99, 0xE0, 0x44, 0xC0, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x80, 0xF0, 0x22, 0x90, 0x01, -+0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, 0xF0, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x01, -+0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x8F, 0xA8, -+0xF0, 0xA3, 0xF0, 0x12, 0x6F, 0xDE, 0xEF, 0x64, 0x01, 0x60, 0x45, 0xC3, 0x90, 0x8F, 0xA9, 0xE0, -+0x94, 0x88, 0x90, 0x8F, 0xA8, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, -+0xF0, 0x90, 0x01, 0xC7, 0x74, 0x03, 0xF0, 0x80, 0x27, 0x90, 0x8F, 0xA8, 0xE4, 0x75, 0xF0, 0x01, -+0x12, 0x08, 0xD6, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0xD3, 0x90, 0x8F, 0xA9, 0xE0, 0x94, -+0x32, 0x90, 0x8F, 0xA8, 0xE0, 0x94, 0x00, 0x40, 0xBA, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB3, -+0x90, 0x01, 0xC7, 0x74, 0x05, 0xF0, 0x22, 0x7F, 0x02, 0x90, 0x8F, 0x9D, 0xE0, 0xFE, 0xEF, 0xC3, -+0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, -+0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0xE4, 0x90, -+0x8D, 0x01, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x0B, 0xF0, 0xA3, 0xE4, -+0xF0, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x15, 0xF5, 0x19, 0xA3, 0xE0, 0x55, 0x16, 0xF5, 0x1A, -+0xA3, 0xE0, 0x55, 0x17, 0xF5, 0x1B, 0xA3, 0xE0, 0x55, 0x18, 0xF5, 0x1C, 0x90, 0x01, 0x34, 0xE5, -+0x19, 0xF0, 0xA3, 0xE5, 0x1A, 0xF0, 0xA3, 0xE5, 0x1B, 0xF0, 0xA3, 0xE5, 0x1C, 0xF0, 0x22, 0x90, -+0x01, 0x3C, 0xE0, 0x55, 0x1D, 0xF5, 0x21, 0xA3, 0xE0, 0x55, 0x1E, 0xF5, 0x22, 0xA3, 0xE0, 0x55, -+0x1F, 0xF5, 0x23, 0xA3, 0xE0, 0x55, 0x20, 0xF5, 0x24, 0x90, 0x01, 0x3C, 0xE5, 0x21, 0xF0, 0xA3, -+0xE5, 0x22, 0xF0, 0xA3, 0xE5, 0x23, 0xF0, 0xA3, 0xE5, 0x24, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, -+0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x2A, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x24, 0x90, 0x01, 0x57, -+0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, 0x8C, 0xE0, 0xF5, -+0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, 0x57, 0x74, 0x05, -+0xF0, 0x22, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x26, 0x90, 0x8E, 0x7A, 0xE0, 0x60, 0x20, -+0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x54, -+0xFB, 0xF0, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x51, 0x3D, -+0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, -+0x22, 0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x01, 0xC6, -+0xE0, 0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -+0x8F, 0xC7, 0x12, 0x48, 0xF4, 0x90, 0x8F, 0x91, 0x12, 0x54, 0xEB, 0x90, 0x8F, 0xCE, 0x12, 0x5F, -+0x4B, 0x90, 0x8F, 0xD0, 0xEF, 0xF0, 0x90, 0x8F, 0xCE, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, 0x34, -+0xFC, 0xFA, 0x7B, 0x01, 0x90, 0x8F, 0xCD, 0xE0, 0xFD, 0x51, 0x52, 0x90, 0x8F, 0xCE, 0xA3, 0xE0, -+0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, -+0x8F, 0xCA, 0x12, 0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0xD0, 0x01, -+0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, 0x8F, 0xCE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, -+0x24, 0x42, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, -+0x8F, 0xCA, 0x12, 0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x06, 0xD0, 0x01, -+0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, 0x8F, 0xCE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, -+0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, -+0x8F, 0xC7, 0x12, 0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0xD0, 0x01, -+0xD0, 0x02, 0xD0, 0x03, 0x12, 0x34, 0x62, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x10, 0xF0, 0x31, 0x51, -+0xBF, 0x01, 0x0E, 0x90, 0x8F, 0x91, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x04, 0x1F, 0x74, 0x20, -+0xF0, 0x22, 0x90, 0x90, 0xF3, 0xED, 0xF0, 0x90, 0x90, 0xF0, 0x12, 0x48, 0xF4, 0xE4, 0x90, 0x90, -+0xF4, 0xF0, 0xA3, 0xF0, 0x12, 0x06, 0x89, 0xFF, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0xFD, 0x12, -+0x5F, 0x68, 0x90, 0x90, 0xF4, 0xEF, 0xF0, 0x90, 0x90, 0xF0, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x04, -+0x12, 0x06, 0xA2, 0xFF, 0xF1, 0x78, 0x90, 0x90, 0xF5, 0xEF, 0xF0, 0x90, 0x8E, 0xAB, 0xE0, 0x24, -+0xFE, 0x60, 0x1E, 0x24, 0xFE, 0x60, 0x1A, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, -+0x54, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xAC, 0x90, 0x90, 0xF3, 0xE0, 0xFD, 0x12, 0x84, 0xF1, 0x80, -+0x16, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xAC, 0x90, 0x90, 0xF3, 0xE0, 0xFD, 0x90, 0x8E, 0xAB, 0xE0, -+0x90, 0x90, 0xC9, 0xF0, 0x12, 0x83, 0xCF, 0x90, 0x90, 0xF5, 0xE0, 0xFF, 0x90, 0x90, 0xF0, 0x12, -+0x48, 0xEB, 0x90, 0x90, 0xF4, 0xE0, 0x7C, 0x00, 0x29, 0xF9, 0xEC, 0x3A, 0xFA, 0xC3, 0xE9, 0x9F, -+0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x40, 0x01, 0x75, 0x41, 0x8E, 0x75, 0x42, 0xAC, 0xA3, 0xE0, -+0xF5, 0x43, 0x12, 0x34, 0x62, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x8F, 0xBB, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8F, 0xD3, 0x74, 0x18, 0xF0, 0x7E, 0x00, -+0x7F, 0x80, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xDB, 0x12, 0x08, 0xAA, 0x90, 0x8F, 0x93, -+0xE0, 0xFF, 0x12, 0x57, 0xD7, 0x90, 0x8F, 0xD2, 0xEF, 0xF0, 0xF9, 0xE0, 0xFE, 0x24, 0x29, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x41, 0xF0, 0xEE, 0x24, 0x28, 0xFD, 0xE4, 0x33, 0xFC, -+0x90, 0x8F, 0xD3, 0xE0, 0x7A, 0x00, 0x2D, 0xFE, 0xEA, 0x3C, 0x90, 0x8F, 0xD7, 0xF0, 0xA3, 0xCE, -+0xF0, 0x74, 0x28, 0x29, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x90, 0x8F, 0xBD, 0xE0, 0xFD, -+0x51, 0x52, 0x90, 0x8F, 0xD7, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x08, 0xD6, 0x90, 0x8F, 0xD7, 0xE4, -+0x75, 0xF0, 0x08, 0x12, 0x08, 0xD6, 0x90, 0x8F, 0xD7, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x8F, 0xD5, -+0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x8F, 0xDB, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xE4, -+0xA3, 0xF0, 0xA3, 0x74, 0x5F, 0xF0, 0x90, 0x8F, 0xD7, 0xE4, 0x75, 0xF0, 0x04, 0x12, 0x08, 0xD6, -+0x90, 0x8E, 0xF8, 0xE0, 0xFF, 0x7E, 0x02, 0xB4, 0xFE, 0x02, 0x7E, 0xFE, 0x90, 0x8F, 0xD7, 0xA3, -+0xE0, 0xFD, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x00, 0x2D, -+0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x90, 0x8F, 0xDF, 0xF0, 0x90, 0x8F, 0xD7, 0xE4, -+0x75, 0xF0, 0x01, 0x12, 0x08, 0xD6, 0x90, 0x8F, 0x8D, 0xE0, 0x90, 0x8F, 0xBB, 0xB4, 0x01, 0x0B, -+0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, 0x44, 0x10, 0xFD, 0x80, 0x09, 0xE0, 0x44, 0x03, 0xFC, 0xA3, -+0xE0, 0x44, 0x20, 0xFD, 0x90, 0x8F, 0xD9, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8F, 0xE0, 0x74, -+0x03, 0xF0, 0xA3, 0x74, 0x12, 0xF0, 0x90, 0x8F, 0xD7, 0xE4, 0x75, 0xF0, 0x02, 0x12, 0x08, 0xD6, -+0xEF, 0x64, 0xFE, 0x70, 0x37, 0x90, 0x8F, 0xD7, 0xA3, 0xE0, 0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, -+0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x40, 0x75, 0x41, 0x8E, 0x75, 0x42, 0xFB, 0x75, 0x43, 0x02, -+0xD0, 0x03, 0x12, 0x34, 0x62, 0x75, 0x40, 0x01, 0x75, 0x41, 0x8E, 0x75, 0x42, 0xFB, 0x75, 0x43, -+0x02, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xE2, 0x12, 0x34, 0x62, 0x80, 0x60, 0x90, 0x8F, 0x8E, 0xE0, -+0xFF, 0xB4, 0x02, 0x2B, 0x90, 0x8F, 0xD7, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x24, 0x00, 0xF5, 0x82, -+0x74, 0xFC, 0x3C, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0x74, 0xFC, 0x3C, 0xF5, -+0x83, 0x74, 0x20, 0xF0, 0xE4, 0x90, 0x8F, 0xE2, 0xF0, 0xA3, 0x74, 0x20, 0xF0, 0x80, 0x2D, 0xEF, -+0xB4, 0x04, 0x29, 0x90, 0x8F, 0xD7, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x24, 0x00, 0xF5, 0x82, 0x74, -+0xFC, 0x3E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2F, 0xF5, 0x82, 0x74, 0xFC, 0x3E, 0xF5, 0x83, -+0x74, 0x10, 0xF0, 0xE4, 0x90, 0x8F, 0xE2, 0xF0, 0xA3, 0x74, 0x10, 0xF0, 0x90, 0x8F, 0xD7, 0xE4, -+0x75, 0xF0, 0x02, 0x12, 0x08, 0xD6, 0xE4, 0x90, 0x8F, 0xD4, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, 0xFF, -+0x24, 0xFD, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0x8F, 0xD7, 0xA3, 0xE0, -+0xFD, 0xEF, 0x2D, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0x8F, -+0xD4, 0xE0, 0xFF, 0x24, 0xFD, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0xE4, -+0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xEE, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, 0x04, 0xF0, -+0xE0, 0xB4, 0x08, 0xB7, 0x90, 0x8F, 0xD7, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x08, 0xD6, 0x90, 0x8F, -+0xD7, 0xE4, 0x75, 0xF0, 0x20, 0x12, 0x08, 0xD6, 0x90, 0x8F, 0xD7, 0xE4, 0x75, 0xF0, 0x10, 0x12, -+0x08, 0xD6, 0x90, 0x8F, 0xD7, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x08, 0xD6, 0x90, 0x8F, 0xD7, 0xE4, -+0x75, 0xF0, 0x08, 0x12, 0x08, 0xD6, 0xE4, 0x90, 0x8F, 0xD4, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, 0xFF, -+0xC3, 0x94, 0x10, 0x50, 0x1B, 0xD1, 0x51, 0x90, 0x8F, 0xD2, 0xEF, 0xF0, 0xE0, 0x24, 0x00, 0xF5, -+0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, 0x04, 0xF0, 0x80, 0xDB, -+0x7F, 0x64, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x90, 0x8F, 0x94, 0xE0, 0xFD, 0xFF, 0x90, 0x8F, 0x93, -+0xE0, 0xC3, 0x9F, 0xFF, 0xEF, 0xFE, 0x90, 0x8F, 0xD3, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, -+0x3E, 0xCF, 0x24, 0x38, 0xCF, 0x34, 0x00, 0xFE, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0xAC, 0x7A, 0x74, -+0x10, 0xF0, 0xED, 0xFE, 0xE4, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, -+0xAC, 0x7B, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0x7B, 0x63, 0xE4, 0xFD, 0xFC, -+0x12, 0x38, 0xC6, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xDB, 0x90, 0xAC, 0xA0, 0x12, 0x48, 0xF4, 0x7A, -+0x8F, 0x79, 0xBE, 0x90, 0xAC, 0xA3, 0x12, 0x48, 0xF4, 0x90, 0xAC, 0xA6, 0x74, 0x10, 0xF0, 0x7A, -+0x8E, 0x79, 0xB4, 0x12, 0x34, 0xC2, 0xE4, 0x90, 0x8F, 0xD4, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, 0xFF, -+0xC3, 0x94, 0x10, 0x50, 0x2D, 0xD1, 0x51, 0x90, 0x8F, 0xD2, 0xEF, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, -+0x24, 0xBE, 0xF5, 0x82, 0xE4, 0x34, 0x8F, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x8F, 0xD2, 0xE0, 0x24, -+0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x8F, 0xD4, 0xE0, 0x04, 0xF0, -+0x80, 0xC9, 0x31, 0x51, 0xBF, 0x01, 0x19, 0x90, 0x8F, 0x93, 0x12, 0x54, 0xEB, 0x90, 0x8F, 0xD2, -+0xEF, 0xF0, 0x90, 0x8F, 0x93, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, -+0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8F, 0xBA, 0xED, 0xF0, 0x90, 0x8F, 0xB8, 0xEE, 0xF0, 0xA3, -+0xEF, 0xF0, 0xD1, 0x7B, 0x90, 0x8F, 0xB8, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x41, -+0xF6, 0x90, 0x8F, 0xD8, 0xE0, 0x2F, 0xFF, 0x90, 0x8F, 0xD7, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x90, -+0x5B, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x8F, 0x93, 0xE0, 0xFD, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x0A, -+0x0D, 0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -+0xC0, 0xD0, 0x90, 0x8F, 0x8F, 0xE0, 0xFD, 0xB4, 0x02, 0x0C, 0x90, 0x90, 0x0B, 0x74, 0x80, 0xF0, -+0xA3, 0x74, 0x08, 0xF0, 0x80, 0x0E, 0xED, 0xB4, 0x04, 0x0A, 0x90, 0x90, 0x0B, 0x74, 0x80, 0xF0, -+0xA3, 0x74, 0x10, 0xF0, 0xEF, 0x64, 0x02, 0x4E, 0x60, 0x02, 0xE1, 0x73, 0x90, 0x8E, 0xF5, 0xE0, -+0xFF, 0x64, 0xFE, 0x70, 0x02, 0xE1, 0x73, 0xEF, 0x64, 0x02, 0x60, 0x07, 0xEF, 0x64, 0x03, 0x60, -+0x02, 0xE1, 0x73, 0x90, 0x8F, 0x55, 0xE0, 0xFE, 0xA3, 0xE0, 0xFD, 0xED, 0xFF, 0x90, 0x90, 0x0D, -+0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, 0x20, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x8F, 0x79, -+0xCB, 0x12, 0x08, 0xAA, 0x7E, 0x00, 0x7F, 0x20, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xEB, -+0x12, 0x08, 0xAA, 0x90, 0xAC, 0x7A, 0x74, 0x10, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x7B, 0x20, -+0xFD, 0xFC, 0xFF, 0xFE, 0x12, 0x38, 0xC6, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0x57, 0x90, 0xAC, 0x89, -+0x12, 0x48, 0xF4, 0x7A, 0x8F, 0x79, 0xEB, 0x90, 0xAC, 0x8C, 0x12, 0x48, 0xF4, 0x90, 0xAC, 0x8F, -+0x74, 0x20, 0xF0, 0x7A, 0x8E, 0x79, 0xC4, 0x12, 0x33, 0x97, 0x75, 0x40, 0x01, 0x75, 0x41, 0x8F, -+0x75, 0x42, 0xF3, 0x75, 0x43, 0x18, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xCB, 0x12, 0x34, 0x62, 0x75, -+0x40, 0x01, 0x75, 0x41, 0x8F, 0x75, 0x42, 0xD3, 0x75, 0x43, 0x10, 0x7B, 0x01, 0x7A, 0x8F, 0x79, -+0xBB, 0x12, 0x34, 0x62, 0x90, 0x8F, 0xD1, 0xE0, 0x54, 0x03, 0xFF, 0x24, 0xA0, 0xF5, 0x82, 0xE4, -+0x34, 0x04, 0xF5, 0x83, 0xEF, 0xF0, 0x70, 0x02, 0x7F, 0x01, 0x7B, 0x01, 0x7A, 0x8F, 0x79, 0xBB, -+0x12, 0x82, 0xA9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, -+0x20, 0xE0, 0x05, 0x90, 0x8F, 0x8E, 0x80, 0x03, 0x90, 0x8F, 0x8F, 0xE0, 0x90, 0x8E, 0xAB, 0xF0, -+0x90, 0x8E, 0xAB, 0xE0, 0x14, 0x60, 0x13, 0x14, 0x60, 0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, 0x60, -+0x09, 0x14, 0x60, 0x06, 0x24, 0x06, 0xE4, 0xFE, 0x80, 0x06, 0x7E, 0x04, 0x80, 0x02, 0x7E, 0x08, -+0xAF, 0x06, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x1E, 0x90, 0xFD, 0x11, -+0xE0, 0xB5, 0x05, 0x14, 0x90, 0x01, 0x17, 0xE0, 0xB5, 0x05, 0x07, 0x90, 0xFD, 0x11, 0xE4, 0xF0, -+0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, 0x11, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0x90, 0x05, 0x22, 0x74, -+0xFF, 0xF0, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x57, 0xF2, 0x7F, 0x00, 0x7E, 0x0C, -+0x12, 0x37, 0xBC, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0x91, 0x0B, 0x12, 0x08, 0x6D, 0x90, 0x91, -+0x0B, 0x12, 0x48, 0xC7, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0x00, 0x7E, 0x0C, 0x12, 0x38, -+0x07, 0x7F, 0x00, 0x7E, 0x0E, 0x12, 0x37, 0xBC, 0xEF, 0x54, 0xFC, 0xFF, 0xEC, 0x90, 0x91, 0x0B, -+0x12, 0x08, 0x6D, 0x90, 0x91, 0x0B, 0x12, 0x48, 0xC7, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, -+0x00, 0x7E, 0x0E, 0x12, 0x4E, 0x2B, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, 0x02, 0x12, 0x4B, 0x67, 0x7F, -+0xB4, 0x7E, 0x08, 0x12, 0x37, 0xBC, 0xEF, 0x44, 0x40, 0xFF, 0xEC, 0x90, 0x91, 0x0B, 0x12, 0x08, -+0x6D, 0x90, 0x91, 0x0B, 0x12, 0x48, 0xC7, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x7F, 0xB4, 0x7E, -+0x08, 0x12, 0x38, 0x07, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, -+0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x90, 0x6D, 0xF0, -+0xA3, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x4E, 0x30, 0x90, 0x90, 0x6D, 0xEF, 0xF0, 0x7F, 0x83, -+0x12, 0x4E, 0x30, 0xAE, 0x07, 0x90, 0x90, 0x6D, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, -+0x90, 0x6F, 0xE0, 0x94, 0x64, 0x90, 0x90, 0x6E, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, -+0xE0, 0x44, 0x40, 0xF0, 0x90, 0x90, 0x6D, 0xE0, 0xFF, 0x22, 0x90, 0x90, 0x6E, 0xE4, 0x75, 0xF0, -+0x01, 0x12, 0x08, 0xD6, 0x80, 0xBE, 0x74, 0x1D, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0xFE, -+0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0x90, -+0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x37, 0xBC, 0x90, 0x90, 0x8D, 0x12, 0x08, 0x6D, 0x90, -+0x90, 0x85, 0x12, 0x48, 0xC7, 0x12, 0x08, 0x3A, 0x90, 0x90, 0x8D, 0x12, 0x48, 0xD3, 0x12, 0x48, -+0xAD, 0x90, 0x90, 0x89, 0x12, 0x48, 0xD3, 0x12, 0x48, 0xBA, 0x90, 0x90, 0x91, 0x12, 0x08, 0x6D, -+0x90, 0x90, 0x91, 0x12, 0x48, 0xC7, 0x90, 0xAA, 0xB9, 0x12, 0x08, 0x6D, 0x90, 0x90, 0x83, 0xE0, -+0xFE, 0xA3, 0xE0, 0xFF, 0x02, 0x38, 0x07, 0x90, 0x90, 0x71, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, -+0x90, 0x70, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x3D, 0x2C, 0x90, 0x90, 0x7B, 0x12, 0x08, -+0x6D, 0x90, 0x90, 0x73, 0x12, 0x48, 0xC7, 0x12, 0x08, 0x3A, 0x90, 0x90, 0x7B, 0x12, 0x48, 0xD3, -+0x12, 0x48, 0xAD, 0x90, 0x90, 0x77, 0x12, 0x48, 0xD3, 0x12, 0x48, 0xBA, 0x90, 0x90, 0x7F, 0x12, -+0x08, 0x6D, 0x90, 0x90, 0x71, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x90, 0x7F, 0x12, 0x48, 0xC7, -+0x90, 0xAA, 0x96, 0x12, 0x08, 0x6D, 0x90, 0x90, 0x70, 0xE0, 0xFF, 0xD0, 0x05, 0x02, 0x3C, 0x33, -+0x12, 0x06, 0x89, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x8F, 0x9E, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0xEF, -+0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x90, 0x8F, 0x9F, 0xF0, 0x22, -+0xE4, 0x90, 0x8F, 0xAC, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x2C, 0xC3, 0x90, -+0x8F, 0xAD, 0xE0, 0x94, 0xD0, 0x90, 0x8F, 0xAC, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, -+0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x8F, 0xAC, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x08, -+0xD6, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x3D, 0x7A, 0x80, 0xCD, 0x7F, 0x01, 0x22, 0x7D, 0x07, 0xEF, -+0x5D, 0xC3, 0x60, 0x14, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, -+0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x0D, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, -+0x5E, 0xFE, 0xED, 0x5F, 0xFF, 0x22, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0xE0, 0x7C, -+0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8F, 0xAF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x87, -+0xE0, 0xF9, 0x90, 0x8E, 0x92, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0xC7, 0xEC, 0xC3, 0x99, 0x40, 0x02, -+0x41, 0xC7, 0x90, 0x8F, 0xAF, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, -+0x03, 0xAD, 0x07, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, -+0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, -+0x3E, 0x54, 0x3F, 0xFE, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, -+0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFD, 0x24, 0x18, 0xFB, 0xEA, 0x33, 0xFA, 0xEB, 0x2F, 0xFF, -+0xEA, 0x3E, 0xFE, 0x31, 0xDD, 0x90, 0x8F, 0xAF, 0xEE, 0x8F, 0xF0, 0x12, 0x08, 0xD6, 0x90, 0x8D, -+0xF4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD3, 0x90, 0x8F, 0xB0, 0xE0, 0x9F, 0x90, 0x8F, 0xAF, 0xE0, -+0x9E, 0x40, 0x1B, 0x90, 0x8D, 0xF5, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x8D, 0xF4, 0xE0, 0x34, 0x00, -+0xFE, 0xC3, 0x90, 0x8F, 0xB0, 0xE0, 0x9F, 0xF0, 0x90, 0x8F, 0xAF, 0xE0, 0x9E, 0xF0, 0x90, 0x8F, -+0xAF, 0x12, 0x5F, 0xDA, 0x0C, 0x41, 0x2B, 0x22, 0x51, 0x06, 0x90, 0x02, 0x87, 0xE0, 0x70, 0xF8, -+0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0xEF, 0x60, 0x59, 0x90, 0x8F, 0x90, 0xE0, 0xFF, -+0x60, 0x02, 0x91, 0x91, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, -+0x16, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8D, 0xF4, 0xF0, 0xA3, 0xEF, 0xF0, -+0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF0, 0x12, 0x77, 0xDC, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, -+0xF0, 0x51, 0xC8, 0x91, 0x83, 0x12, 0x4F, 0x3E, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x06, 0x64, -+0xE0, 0x60, 0x03, 0x12, 0x58, 0x89, 0x91, 0xDA, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, -+0xFF, 0x02, 0x57, 0x1C, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x57, 0xBB, 0x90, 0x06, 0x90, 0xE4, 0xF0, -+0x90, 0x02, 0x86, 0xE0, 0x54, 0xFB, 0xF0, 0x71, 0xA1, 0x91, 0x84, 0x90, 0x8E, 0x92, 0xE0, 0x54, -+0xFE, 0xF0, 0x90, 0x8E, 0x97, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0x90, 0x8E, 0xA4, 0xF0, 0xA3, 0xF0, -+0xA3, 0xF0, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x8E, 0x93, 0xE0, 0x54, 0xFE, 0xF0, -+0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, 0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, -+0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0x80, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, -+0xFE, 0xF0, 0x90, 0x8E, 0x94, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x8E, 0x96, 0xE0, 0x54, 0xFD, 0xF0, -+0x22, 0x71, 0x69, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x90, 0x8D, 0x04, 0xE0, 0xFF, 0xB4, 0x01, -+0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, -+0x54, 0xFB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x06, 0x89, 0xFF, 0x54, -+0x01, 0xFE, 0x90, 0x8E, 0x92, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, -+0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, -+0xFF, 0x90, 0x8E, 0x92, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0xFF, 0xF0, 0x12, -+0x06, 0x89, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x90, 0x8E, 0x92, 0xF0, 0xEE, -+0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0x54, 0x40, 0xFE, 0xEF, -+0x54, 0xBF, 0x4E, 0x90, 0x8E, 0x92, 0xF0, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, -+0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x8D, 0xF4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x8E, -+0x92, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, 0x91, 0x78, 0x90, 0x8E, 0x92, 0xE0, 0x13, 0x13, 0x54, -+0x01, 0xFF, 0x91, 0x85, 0x90, 0x8E, 0x92, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFF, 0xB1, 0x12, -+0x90, 0x8E, 0x92, 0xE0, 0xC4, 0x54, 0x01, 0xFF, 0x91, 0x8B, 0x90, 0x8E, 0x92, 0xE0, 0x54, 0x01, -+0xFF, 0x51, 0xD8, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x60, 0x07, 0x90, 0x8F, 0x91, 0xE0, 0xFF, -+0x91, 0xB0, 0x22, 0x22, 0x22, 0x90, 0x8F, 0xAF, 0xEF, 0xF0, 0x22, 0x90, 0x8F, 0xAF, 0xEF, 0xF0, -+0x22, 0x12, 0x57, 0xD7, 0x7E, 0x00, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, -+0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x08, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xAC, 0x02, 0x34, 0x62, -+0x12, 0x57, 0xD7, 0x7E, 0x00, 0x90, 0x8F, 0xAF, 0x12, 0x5F, 0x4B, 0x90, 0x8F, 0xAF, 0xA3, 0xE0, -+0x2F, 0x24, 0x3E, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x40, 0x01, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, -+0x04, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xA7, 0x02, 0x34, 0x62, 0xE4, 0xFF, 0x74, 0x18, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x9E, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8E, -+0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x10, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, -+0x74, 0x98, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x06, -+0xCB, 0x22, 0xE4, 0xFD, 0xFC, 0xEF, 0x60, 0x55, 0x90, 0x8F, 0x94, 0xE0, 0xFF, 0x12, 0x57, 0xD7, -+0x7C, 0x00, 0xAD, 0x07, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x90, 0x8F, -+0xAF, 0x12, 0x48, 0xF4, 0x90, 0x8F, 0xAF, 0x12, 0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, -+0x75, 0x43, 0x40, 0x7B, 0x01, 0x7A, 0x8E, 0x79, 0xB4, 0x12, 0x34, 0x62, 0xE4, 0xFD, 0x7F, 0x03, -+0x12, 0x30, 0x0A, 0x90, 0x8F, 0x95, 0xE0, 0xFE, 0xE4, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, -+0xD8, 0xF9, 0xFF, 0x12, 0x39, 0x00, 0x7D, 0x01, 0x7F, 0x03, 0x12, 0x30, 0x0A, 0x22, 0xD3, 0x10, -+0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x06, 0x89, 0xFE, 0x20, 0xE0, 0x04, 0x71, 0xA1, 0xC1, 0x27, -+0x12, 0x06, 0x89, 0xFF, 0x54, 0x01, 0xFD, 0x90, 0x8E, 0x93, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, -+0xEF, 0x54, 0x02, 0xFF, 0xED, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFD, 0x54, 0x04, -+0xFC, 0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0x8E, 0x93, 0xF0, 0xED, 0x54, 0x08, 0xFD, 0xEF, 0x54, -+0xF7, 0x4D, 0xFF, 0xF0, 0x12, 0x06, 0x89, 0xFD, 0x54, 0x10, 0xFC, 0xEF, 0x54, 0xEF, 0x4C, 0xFF, -+0x90, 0x8E, 0x93, 0xF0, 0xED, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0xF0, 0x12, 0x06, -+0x89, 0xFD, 0x54, 0x40, 0xFC, 0xEF, 0x54, 0xBF, 0x4C, 0xFF, 0x90, 0x8E, 0x93, 0xF0, 0xED, 0x54, -+0x80, 0xFD, 0xEF, 0x54, 0x7F, 0x4D, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0x54, 0x80, 0xFF, -+0x90, 0x8E, 0x94, 0xE0, 0x54, 0x7F, 0x4F, 0xF0, 0xEE, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, -+0x90, 0x06, 0x90, 0xE0, 0x44, 0x04, 0xF0, 0x12, 0x06, 0x89, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, -+0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x8D, 0x04, 0xE0, 0xB4, 0x01, 0x07, -+0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8E, 0x97, 0xE0, -+0xFF, 0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x14, 0xEF, 0x44, 0x01, 0x90, 0x8E, -+0x97, 0xF0, 0x90, 0x8E, 0x93, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, -+0x01, 0x22, 0xEF, 0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, 0x74, 0x04, 0xF0, 0x80, 0x03, 0x74, 0x08, -+0xF0, 0x90, 0x8E, 0x97, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x8E, 0x97, 0xE0, 0x30, 0xE0, 0x03, -+0x7F, 0x01, 0x22, 0x90, 0x06, 0x90, 0xE0, 0x20, 0xE5, 0x0A, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, -+0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x06, 0x89, 0xFE, -+0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8F, 0x90, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, 0xA2, 0xFF, 0xED, -+0x2F, 0x90, 0x8F, 0x91, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8F, -+0x92, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x93, 0xF0, 0x90, -+0x00, 0x04, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x94, 0xF0, 0x90, 0x00, 0x05, 0x12, -+0x06, 0xA2, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x8F, 0x95, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, -+0xFD, 0x12, 0x06, 0x89, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x8F, 0x96, 0xF0, 0x90, 0x00, 0x01, -+0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x97, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, -+0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x98, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, -+0x90, 0x8F, 0x99, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x9A, -+0xF0, 0x90, 0x00, 0x05, 0x12, 0x06, 0xA2, 0xFF, 0xED, 0x2F, 0x90, 0x8F, 0x9B, 0xF0, 0x90, 0x00, -+0x06, 0x12, 0x06, 0xA2, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x8F, 0x9C, 0xF0, 0x22, 0x90, 0x8F, -+0xA1, 0xE0, 0x30, 0xE0, 0x36, 0x90, 0x8F, 0xA4, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x90, 0x8F, 0xA2, -+0xE0, 0x6F, 0x70, 0x27, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x11, 0x90, 0x8F, 0xA6, 0xE0, 0x70, -+0x0B, 0x12, 0x57, 0xD3, 0x90, 0x8F, 0xA5, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, 0x74, -+0x04, 0xF0, 0xE4, 0x90, 0x8F, 0xA4, 0xF0, 0x90, 0x8F, 0xA6, 0xF0, 0x22, 0xE4, 0x90, 0x8E, 0x7A, -+0xF0, 0xA3, 0xF0, 0x90, 0x8E, 0x79, 0xE0, 0x54, 0x0F, 0xF0, 0x54, 0xF0, 0xF0, 0x90, 0x8E, 0x77, -+0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xF7, 0xF0, 0x90, 0x8E, 0x80, 0x74, 0x01, 0xF0, 0xA3, 0xF0, 0x90, -+0x8E, 0x77, 0xE0, 0x54, 0xFB, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x8E, 0x83, 0xF0, -+0x90, 0x8E, 0x82, 0x74, 0x07, 0xF0, 0x90, 0x8E, 0x85, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0xE4, -+0x90, 0x8E, 0x7E, 0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x8E, 0x7C, 0x74, 0x0C, -+0xF0, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x90, 0x8E, -+0x77, 0xE0, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, -+0x54, 0xF7, 0xF0, 0x90, 0x8E, 0x87, 0x12, 0x08, 0x79, 0x00, 0x00, 0x00, 0x00, 0x90, 0x8D, 0x04, -+0xE0, 0xB4, 0x01, 0x08, 0x90, 0x8E, 0x84, 0x74, 0xFF, 0xF0, 0x80, 0x12, 0x90, 0x8D, 0x04, 0xE0, -+0x90, 0x8E, 0x84, 0xB4, 0x03, 0x05, 0x74, 0xD4, 0xF0, 0x80, 0x03, 0x74, 0x41, 0xF0, 0x90, 0x8E, -+0x8B, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, -+0x74, 0x05, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, -+0xF0, 0x54, 0xEF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xBF, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x90, 0x04, -+0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, -+0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x11, 0x4E, 0xEF, 0x64, 0x01, 0x60, 0x08, 0x90, 0x01, -+0xB8, 0x74, 0x01, 0xF0, 0x21, 0x02, 0x90, 0x8E, 0x7E, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x08, 0x90, -+0x01, 0xB8, 0x74, 0x02, 0xF0, 0x80, 0x7B, 0x90, 0x8E, 0x7C, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, -+0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, 0xF0, 0x80, 0x69, 0xEF, 0x30, 0xE2, 0x08, 0x90, 0x01, 0xB8, -+0x74, 0x08, 0xF0, 0x80, 0x5D, 0x90, 0x8E, 0x7E, 0xE0, 0x30, 0xE4, 0x08, 0x90, 0x01, 0xB8, 0x74, -+0x10, 0xF0, 0x80, 0x4E, 0x90, 0x8E, 0x78, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x08, 0x90, -+0x01, 0xB8, 0x74, 0x20, 0xF0, 0x80, 0x3B, 0x90, 0x8E, 0x91, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, -+0x74, 0x80, 0xF0, 0x80, 0x2D, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, -+0x11, 0xF0, 0x80, 0x1E, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0F, 0xE0, 0x54, 0xFC, 0xFF, 0xBF, -+0x80, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x12, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, -+0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x02, 0x96, 0xE0, 0xFF, -+0x90, 0x02, 0x87, 0xE0, 0x4F, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x01, 0xF0, 0x80, 0x2C, 0x90, -+0x8E, 0x92, 0xE0, 0x30, 0xE0, 0x0E, 0x90, 0x02, 0x82, 0xE0, 0x60, 0x08, 0x90, 0x01, 0xB8, 0x74, -+0x02, 0xF0, 0x80, 0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x08, 0x90, 0x01, 0xB8, 0x74, 0x04, -+0xF0, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, -+0xF0, 0x7F, 0x00, 0x22, 0xEF, 0x60, 0x3E, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, -+0x8E, 0x78, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x05, 0x22, 0x74, 0x0F, 0xF0, 0x90, 0x06, 0x04, 0xE0, -+0x54, 0xBF, 0xF0, 0xE4, 0xFF, 0x12, 0x53, 0xC8, 0xBF, 0x01, 0x0E, 0x90, 0x8E, 0x77, 0xE0, 0x44, -+0x40, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x06, 0xF0, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, -+0x01, 0xB8, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x05, 0x22, 0x74, 0x6F, 0xF0, 0x90, 0x8E, 0x7D, 0x74, -+0x02, 0xF0, 0x22, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x04, 0xF0, 0x22, 0x90, -+0x8E, 0x7A, 0xE0, 0x60, 0x39, 0x90, 0x8D, 0xF6, 0xE0, 0x64, 0x01, 0x70, 0x31, 0x90, 0x8E, 0x81, -+0xF0, 0x04, 0x60, 0x2A, 0x90, 0x8E, 0x7E, 0xE0, 0x44, 0x10, 0xF0, 0xE4, 0xF5, 0x3B, 0x90, 0x8E, -+0x82, 0xE0, 0xF5, 0x3C, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x35, 0x7A, 0x90, 0x01, -+0x57, 0x74, 0x05, 0xF0, 0x90, 0x8E, 0x7D, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x51, 0x46, 0x22, 0x90, -+0x8E, 0x77, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x11, 0xEF, 0x54, 0xFB, 0xF0, 0x90, -+0x8E, 0x7E, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x70, 0x42, 0x80, 0x3D, 0x90, 0x8E, 0x83, 0xE0, -+0x04, 0xF0, 0x90, 0x8E, 0x7E, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x8E, 0x83, 0xE0, 0xFF, 0xB4, 0x01, -+0x02, 0x80, 0x04, 0xEF, 0xB4, 0x02, 0x06, 0x90, 0x05, 0x58, 0xE0, 0x04, 0xF0, 0x90, 0x8E, 0x8B, -+0xE0, 0xFF, 0x90, 0x8E, 0x83, 0xE0, 0xD3, 0x9F, 0x40, 0x0F, 0x90, 0x8D, 0xF6, 0xE0, 0xB4, 0x01, -+0x0B, 0x90, 0x8E, 0x78, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x12, 0x51, 0x3D, 0x22, 0x12, 0x4F, 0x3E, -+0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0x8D, 0x07, 0xE0, -+0xFE, 0x90, 0x04, 0x1C, 0xE0, 0x6E, 0x70, 0x40, 0x90, 0x8E, 0x7D, 0xE0, 0xFE, 0x64, 0x0E, 0x70, -+0x1C, 0xEF, 0x70, 0x34, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, -+0xBF, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x04, 0xF0, 0x22, 0xEE, 0xB4, 0x06, -+0x17, 0xEF, 0x60, 0x14, 0x90, 0x8E, 0x77, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0x06, 0x04, 0xE0, 0x54, -+0x7F, 0xF0, 0x90, 0x8E, 0x7D, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0x90, 0x0F, 0xEF, 0xF0, 0xA3, 0x12, -+0x48, 0xF4, 0x90, 0x90, 0x10, 0x12, 0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, 0x89, 0x42, 0x75, 0x43, -+0x04, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x13, 0x12, 0x34, 0x62, 0x90, 0x90, 0x0F, 0xE0, 0x75, 0xF0, -+0x08, 0xA4, 0x24, 0x02, 0x71, 0x8D, 0x90, 0x90, 0x10, 0x12, 0x48, 0xEB, 0xE9, 0x24, 0x04, 0xF9, -+0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x90, 0x79, -+0x13, 0x12, 0x34, 0x62, 0x90, 0x90, 0x0F, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0x71, 0x8D, -+0x90, 0x90, 0x10, 0x12, 0x48, 0xEB, 0xE9, 0x24, 0x08, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, -+0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0x13, 0x12, 0x34, 0x62, 0x90, 0x90, -+0x0F, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x04, 0x71, 0x8D, 0x90, 0x90, 0x10, 0x12, 0x48, 0xEB, -+0xE9, 0x24, 0x0C, 0xF9, 0xE4, 0x3A, 0x8B, 0x40, 0xF5, 0x41, 0x89, 0x42, 0x75, 0x43, 0x04, 0x7B, -+0x01, 0x7A, 0x90, 0x79, 0x13, 0x12, 0x34, 0x62, 0x90, 0x90, 0x0F, 0xE0, 0x75, 0xF0, 0x08, 0xA4, -+0x24, 0x05, 0x71, 0x8D, 0x90, 0x90, 0x0F, 0xE0, 0xFE, 0x44, 0x10, 0x90, 0x90, 0x13, 0xF0, 0xA3, -+0x74, 0x80, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x71, 0x8D, -+0x90, 0x90, 0x13, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x90, 0x0F, 0xE0, -+0x75, 0xF0, 0x08, 0xA4, 0x04, 0x71, 0x8D, 0x90, 0x06, 0x72, 0xE4, 0xF0, 0x22, 0xFF, 0x7B, 0x01, -+0x7A, 0x90, 0x79, 0x13, 0x12, 0x06, 0x89, 0x90, 0x06, 0x74, 0xF0, 0x90, 0x00, 0x01, 0x12, 0x06, -+0xA2, 0x90, 0x06, 0x75, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xA2, 0x90, 0x06, 0x76, 0xF0, 0x90, -+0x00, 0x03, 0x12, 0x06, 0xA2, 0x90, 0x06, 0x77, 0xF0, 0x90, 0x06, 0x70, 0xEF, 0xF0, 0xA3, 0xE4, -+0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x02, 0x3D, 0x7A, 0x90, -+0x90, 0xC5, 0x12, 0x48, 0xF4, 0x12, 0x06, 0x89, 0x90, 0x90, 0xCA, 0xF0, 0x90, 0x00, 0x01, 0x12, -+0x06, 0xA2, 0x90, 0x90, 0xCB, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x06, 0xA2, 0x90, 0x90, 0xCC, 0xF0, -+0x90, 0x00, 0x05, 0x12, 0x06, 0xA2, 0x90, 0x90, 0xCD, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x06, 0xA2, -+0x90, 0x90, 0xCE, 0xF0, 0x90, 0x00, 0x07, 0x12, 0x06, 0xA2, 0x90, 0x90, 0xCF, 0xF0, 0x90, 0x00, -+0x03, 0x12, 0x06, 0xA2, 0x90, 0x90, 0xD2, 0xF0, 0xED, 0x70, 0x31, 0xFF, 0x74, 0xCA, 0x2F, 0xF5, -+0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, 0xB4, 0xFF, 0x0E, 0x74, 0xCA, 0x2F, 0xF5, 0x82, 0xE4, -+0x34, 0x90, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x0F, 0x74, 0xCA, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, -+0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x06, 0xD0, 0x90, 0x90, 0xC9, 0xE0, -+0xFF, 0xB4, 0x04, 0x25, 0xA3, 0xE0, 0xFE, 0x90, 0x90, 0xC5, 0x12, 0x48, 0xEB, 0xEE, 0x12, 0x06, -+0xCF, 0x90, 0x90, 0xCB, 0xE0, 0xFE, 0x90, 0x90, 0xC5, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x01, 0xEE, -+0x12, 0x06, 0xE1, 0x90, 0x00, 0x02, 0xE4, 0x80, 0x30, 0xEF, 0xB4, 0x02, 0x2F, 0x90, 0x90, 0xCB, -+0xE0, 0xFF, 0x90, 0x90, 0xC5, 0x12, 0x48, 0xEB, 0xEF, 0x12, 0x06, 0xCF, 0x90, 0x90, 0xCB, 0xE0, -+0x44, 0x20, 0x54, 0x7F, 0xFF, 0x90, 0x90, 0xC5, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x01, 0xEF, 0x12, -+0x06, 0xE1, 0x90, 0x90, 0xCA, 0xE0, 0x90, 0x00, 0x02, 0x12, 0x06, 0xE1, 0x90, 0x90, 0xC5, 0x12, -+0x48, 0xEB, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x06, 0x89, 0x44, 0x20, 0x12, 0x06, -+0xCF, 0x90, 0x90, 0xCC, 0xE0, 0xFF, 0x90, 0x90, 0xC5, 0x12, 0x48, 0xEB, 0x90, 0x00, 0x04, 0xEF, -+0x12, 0x06, 0xE1, 0x90, 0x90, 0xCD, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x06, 0xE1, 0x90, 0x90, 0xCE, -+0xE0, 0x90, 0x00, 0x06, 0x12, 0x06, 0xE1, 0x90, 0x90, 0xCF, 0xE0, 0x90, 0x00, 0x07, 0x02, 0x06, -+0xE1, 0x90, 0x90, 0xDF, 0xED, 0xF0, 0x90, 0x90, 0xDC, 0x12, 0x48, 0xF4, 0x90, 0x00, 0x03, 0x12, -+0x06, 0xA2, 0x90, 0x90, 0xE3, 0xF0, 0x90, 0x90, 0xDC, 0x12, 0x48, 0xEB, 0x8B, 0x40, 0x8A, 0x41, -+0x89, 0x42, 0x75, 0x43, 0x03, 0x7B, 0x01, 0x7A, 0x90, 0x79, 0xE0, 0x12, 0x34, 0x62, 0x90, 0x90, -+0xDF, 0xE0, 0x70, 0x46, 0xFF, 0x74, 0xE0, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, -+0xB4, 0xFF, 0x0E, 0x74, 0xE0, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE4, 0xF0, 0x80, -+0x0F, 0x74, 0xE0, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x90, 0xF5, 0x83, 0xE0, 0x04, 0xF0, 0x80, 0x05, -+0x0F, 0xEF, 0xB4, 0x03, 0xD0, 0x75, 0x40, 0x01, 0x75, 0x41, 0x90, 0x75, 0x42, 0xE0, 0x75, 0x43, -+0x03, 0x90, 0x90, 0xDC, 0x12, 0x48, 0xEB, 0x12, 0x34, 0x62, 0x22, 0x00, 0x9D, 0x91, -+}; -+static const u4Byte ArrayLength_MP_8821A_FW_WoWLAN = 17806; -+ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_WoWLAN( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+) -+{ -+ *((SIZE_PTR *)pFirmware) = (SIZE_PTR)Array_MP_8821A_FW_WoWLAN; -+ *pFirmwareSize = ArrayLength_MP_8821A_FW_WoWLAN; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_FW.h 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,64 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_MP_FW_HW_IMG_8821A_H -+#define __INC_MP_FW_HW_IMG_8821A_H -+ -+ -+/****************************************************************************** -+* FW_AP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_AP( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_BT.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_BT( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_NIC.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_NIC( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+); -+ -+/****************************************************************************** -+* FW_WoWLAN.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadFirmware_MP_8821A_FW_WoWLAN( -+ PDM_ODM_T pDM_Odm, -+ u1Byte *pFirmware, -+ u4Byte *pFirmwareSize -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.c 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,219 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+//#include "Mp_Precomp.h" -+#include "odm_precomp.h" -+ -+static bool -+CheckCondition( -+ const u4Byte Condition, -+ const u4Byte Hex -+ ) -+{ -+ u4Byte _board = (Hex & 0x000000FF); -+ u4Byte _interface = (Hex & 0x0000FF00) >> 8; -+ u4Byte _platform = (Hex & 0x00FF0000) >> 16; -+ u4Byte cond = Condition; -+ -+ if ( Condition == 0xCDCDCDCD ) -+ return true; -+ -+ cond = Condition & 0x000000FF; -+ if ( (_board != cond) && (cond != 0xFF) ) -+ return false; -+ -+ cond = Condition & 0x0000FF00; -+ cond = cond >> 8; -+ if ( ((_interface & cond) == 0) && (cond != 0x07) ) -+ return false; -+ -+ cond = Condition & 0x00FF0000; -+ cond = cond >> 16; -+ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) -+ return false; -+ return true; -+} -+ -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+static u4Byte Array_MP_8821A_MAC_REG[] = { -+ 0x428, 0x0000000A, -+ 0x429, 0x00000010, -+ 0x430, 0x00000000, -+ 0x431, 0x00000000, -+ 0x432, 0x00000000, -+ 0x433, 0x00000001, -+ 0x434, 0x00000004, -+ 0x435, 0x00000005, -+ 0x436, 0x00000007, -+ 0x437, 0x00000008, -+ 0x43C, 0x00000004, -+ 0x43D, 0x00000005, -+ 0x43E, 0x00000007, -+ 0x43F, 0x00000008, -+ 0x440, 0x0000005D, -+ 0x441, 0x00000001, -+ 0x442, 0x00000000, -+ 0x444, 0x00000010, -+ 0x445, 0x00000000, -+ 0x446, 0x00000000, -+ 0x447, 0x00000000, -+ 0x448, 0x00000000, -+ 0x449, 0x000000F0, -+ 0x44A, 0x0000000F, -+ 0x44B, 0x0000003E, -+ 0x44C, 0x00000010, -+ 0x44D, 0x00000000, -+ 0x44E, 0x00000000, -+ 0x44F, 0x00000000, -+ 0x450, 0x00000000, -+ 0x451, 0x000000F0, -+ 0x452, 0x0000000F, -+ 0x453, 0x00000000, -+ 0x456, 0x0000005E, -+ 0x460, 0x00000066, -+ 0x461, 0x00000066, -+ 0x4C8, 0x000000FF, -+ 0x4C9, 0x00000008, -+ 0x4CC, 0x000000FF, -+ 0x4CD, 0x000000FF, -+ 0x4CE, 0x00000001, -+ 0x500, 0x00000026, -+ 0x501, 0x000000A2, -+ 0x502, 0x0000002F, -+ 0x503, 0x00000000, -+ 0x504, 0x00000028, -+ 0x505, 0x000000A3, -+ 0x506, 0x0000005E, -+ 0x507, 0x00000000, -+ 0x508, 0x0000002B, -+ 0x509, 0x000000A4, -+ 0x50A, 0x0000005E, -+ 0x50B, 0x00000000, -+ 0x50C, 0x0000004F, -+ 0x50D, 0x000000A4, -+ 0x50E, 0x00000000, -+ 0x50F, 0x00000000, -+ 0x512, 0x0000001C, -+ 0x514, 0x0000000A, -+ 0x516, 0x0000000A, -+ 0x525, 0x0000004F, -+ 0x550, 0x00000010, -+ 0x551, 0x00000010, -+ 0x559, 0x00000002, -+ 0x55C, 0x00000050, -+ 0x55D, 0x000000FF, -+ 0x605, 0x00000030, -+ 0x607, 0x00000007, -+ 0x608, 0x0000000E, -+ 0x609, 0x0000002A, -+ 0x620, 0x000000FF, -+ 0x621, 0x000000FF, -+ 0x622, 0x000000FF, -+ 0x623, 0x000000FF, -+ 0x624, 0x000000FF, -+ 0x625, 0x000000FF, -+ 0x626, 0x000000FF, -+ 0x627, 0x000000FF, -+ 0x638, 0x00000050, -+ 0x63C, 0x0000000A, -+ 0x63D, 0x0000000A, -+ 0x63E, 0x0000000E, -+ 0x63F, 0x0000000E, -+ 0x640, 0x00000040, -+ 0x642, 0x00000040, -+ 0x643, 0x00000000, -+ 0x66E, 0x00000005, -+ 0x700, 0x00000021, -+ 0x701, 0x00000043, -+ 0x702, 0x00000065, -+ 0x703, 0x00000087, -+ 0x708, 0x00000021, -+ 0x709, 0x00000043, -+ 0x70A, 0x00000065, -+ 0x70B, 0x00000087, -+ 0x718, 0x00000040, -+ -+}; -+ -+void ODM_ReadAndConfig_MP_8821A_MAC_REG(PDM_ODM_T pDM_Odm) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_MAC_REG)/sizeof(u4Byte); -+ pu4Byte Array = Array_MP_8821A_MAC_REG; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8821A_MAC_REG, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigMAC_8821A(pDM_Odm, v1, (u1Byte)v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigMAC_8821A(pDM_Odm, v1, (u1Byte)v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_MAC.h 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+* -+******************************************************************************/ -+ -+#ifndef __INC_MP_MAC_HW_IMG_8821A_H -+#define __INC_MP_MAC_HW_IMG_8821A_H -+ -+static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_MAC_REG( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.c 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,1500 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+//#include "Mp_Precomp.h" -+#include "odm_precomp.h" -+ -+static bool -+CheckCondition( -+ const u4Byte Condition, -+ const u4Byte Hex -+ ) -+{ -+ u4Byte _board = (Hex & 0x000000FF); -+ u4Byte _interface = (Hex & 0x0000FF00) >> 8; -+ u4Byte _platform = (Hex & 0x00FF0000) >> 16; -+ u4Byte cond = Condition; -+ -+ if ( Condition == 0xCDCDCDCD ) -+ return true; -+ -+ cond = Condition & 0x000000FF; -+ if ( (_board != cond) && (cond != 0xFF) ) -+ return false; -+ -+ cond = Condition & 0x0000FF00; -+ cond = cond >> 8; -+ if ( ((_interface & cond) == 0) && (cond != 0x07) ) -+ return false; -+ -+ cond = Condition & 0x00FF0000; -+ cond = cond >> 16; -+ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) -+ return false; -+ return true; -+} -+ -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+static const u4Byte Array_MP_8821A_RadioA[] = { -+ 0x018, 0x0001712A, -+ 0x056, 0x00051CF2, -+ 0x066, 0x00040000, -+ 0x000, 0x00010000, -+ 0x01E, 0x00080000, -+ 0x082, 0x00000830, -+ 0x083, 0x00021800, -+ 0x084, 0x00028000, -+ 0x085, 0x00048000, -+ 0x086, 0x00094838, -+ 0x087, 0x00044980, -+ 0x088, 0x00048000, -+ 0x089, 0x0000D480, -+ 0x08A, 0x00042240, -+ 0x08B, 0x000F0380, -+ 0x08C, 0x00090000, -+ 0x08D, 0x00022852, -+ 0x08E, 0x00065540, -+ 0x08F, 0x00088001, -+ 0x0EF, 0x00020000, -+ 0x03E, 0x00000380, -+ 0x03F, 0x00090018, -+ 0x03E, 0x00020380, -+ 0x03F, 0x000A0018, -+ 0x03E, 0x00040308, -+ 0x03F, 0x000A0018, -+ 0x03E, 0x00060018, -+ 0x03F, 0x000A0018, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x089, 0x00000080, -+ 0x08B, 0x00080180, -+ 0x0EF, 0x00001000, -+ 0x03A, 0x00000244, -+ 0x03B, 0x00038027, -+ 0x03C, 0x00082000, -+ 0x03A, 0x00000244, -+ 0x03B, 0x00030113, -+ 0x03C, 0x00082000, -+ 0x03A, 0x0000014C, -+ 0x03B, 0x00028027, -+ 0x03C, 0x00082000, -+ 0x03A, 0x000000CC, -+ 0x03B, 0x00027027, -+ 0x03C, 0x00042000, -+ 0x03A, 0x0000014C, -+ 0x03B, 0x0001F913, -+ 0x03C, 0x00042000, -+ 0x03A, 0x0000010C, -+ 0x03B, 0x00017F10, -+ 0x03C, 0x00012000, -+ 0x03A, 0x000000D0, -+ 0x03B, 0x00008027, -+ 0x03C, 0x000CA000, -+ 0x03A, 0x00000244, -+ 0x03B, 0x00078027, -+ 0x03C, 0x00082000, -+ 0x03A, 0x00000244, -+ 0x03B, 0x00070113, -+ 0x03C, 0x00082000, -+ 0x03A, 0x0000014C, -+ 0x03B, 0x00068027, -+ 0x03C, 0x00082000, -+ 0x03A, 0x000000CC, -+ 0x03B, 0x00067027, -+ 0x03C, 0x00042000, -+ 0x03A, 0x0000014C, -+ 0x03B, 0x0005F913, -+ 0x03C, 0x00042000, -+ 0x03A, 0x0000010C, -+ 0x03B, 0x00057F10, -+ 0x03C, 0x00012000, -+ 0x03A, 0x000000D0, -+ 0x03B, 0x00048027, -+ 0x03C, 0x000CA000, -+ 0x03A, 0x00000244, -+ 0x03B, 0x000B8027, -+ 0x03C, 0x00082000, -+ 0x03A, 0x00000244, -+ 0x03B, 0x000B0113, -+ 0x03C, 0x00082000, -+ 0x03A, 0x0000014C, -+ 0x03B, 0x000A8027, -+ 0x03C, 0x00082000, -+ 0x03A, 0x000000CC, -+ 0x03B, 0x000A7027, -+ 0x03C, 0x00042000, -+ 0x03A, 0x0000014C, -+ 0x03B, 0x0009F913, -+ 0x03C, 0x00042000, -+ 0x03A, 0x0000010C, -+ 0x03B, 0x00097F10, -+ 0x03C, 0x00012000, -+ 0x03A, 0x000000D0, -+ 0x03B, 0x00088027, -+ 0x03C, 0x000CA000, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00001100, -+ 0xFF0F0104, 0xABCD, -+ 0x034, 0x0004ADF3, -+ 0x034, 0x00049DF0, -+ 0xFF0F0204, 0xCDEF, -+ 0x034, 0x0004ADF3, -+ 0x034, 0x00049DF0, -+ 0xFF0F0404, 0xCDEF, -+ 0x034, 0x0004ADF3, -+ 0x034, 0x00049DF0, -+ 0xFF0F0200, 0xCDEF, -+ 0x034, 0x0004ADF5, -+ 0x034, 0x00049DF2, -+ 0xFF0F02C0, 0xCDEF, -+ 0x034, 0x0004A0F3, -+ 0x034, 0x000490B1, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0004ADF7, -+ 0x034, 0x00049DF3, -+ 0xFF0F0104, 0xDEAD, -+ 0xFF0F0104, 0xABCD, -+ 0x034, 0x00048DED, -+ 0x034, 0x00047DEA, -+ 0x034, 0x00046DE7, -+ 0x034, 0x00045CE9, -+ 0x034, 0x00044CE6, -+ 0x034, 0x000438C6, -+ 0x034, 0x00042886, -+ 0x034, 0x00041486, -+ 0x034, 0x00040447, -+ 0xFF0F0204, 0xCDEF, -+ 0x034, 0x00048DED, -+ 0x034, 0x00047DEA, -+ 0x034, 0x00046DE7, -+ 0x034, 0x00045CE9, -+ 0x034, 0x00044CE6, -+ 0x034, 0x000438C6, -+ 0x034, 0x00042886, -+ 0x034, 0x00041486, -+ 0x034, 0x00040447, -+ 0xFF0F0404, 0xCDEF, -+ 0x034, 0x00048DED, -+ 0x034, 0x00047DEA, -+ 0x034, 0x00046DE7, -+ 0x034, 0x00045CE9, -+ 0x034, 0x00044CE6, -+ 0x034, 0x000438C6, -+ 0x034, 0x00042886, -+ 0x034, 0x00041486, -+ 0x034, 0x00040447, -+ 0xFF0F02C0, 0xCDEF, -+ 0x034, 0x000480AE, -+ 0x034, 0x000470AB, -+ 0x034, 0x0004608B, -+ 0x034, 0x00045069, -+ 0x034, 0x00044048, -+ 0x034, 0x00043045, -+ 0x034, 0x00042026, -+ 0x034, 0x00041023, -+ 0x034, 0x00040002, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x00048DEF, -+ 0x034, 0x00047DEC, -+ 0x034, 0x00046DE9, -+ 0x034, 0x00045CCB, -+ 0x034, 0x0004488D, -+ 0x034, 0x0004348D, -+ 0x034, 0x0004248A, -+ 0x034, 0x0004108D, -+ 0x034, 0x0004008A, -+ 0xFF0F0104, 0xDEAD, -+ 0xFF0F0200, 0xABCD, -+ 0x034, 0x0002ADF4, -+ 0xFF0F02C0, 0xCDEF, -+ 0x034, 0x0002A0F3, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0002ADF7, -+ 0xFF0F0200, 0xDEAD, -+ 0xFF0F0104, 0xABCD, -+ 0x034, 0x00029DF4, -+ 0xFF0F0204, 0xCDEF, -+ 0x034, 0x00029DF4, -+ 0xFF0F0404, 0xCDEF, -+ 0x034, 0x00029DF4, -+ 0xFF0F0200, 0xCDEF, -+ 0x034, 0x00029DF1, -+ 0xFF0F02C0, 0xCDEF, -+ 0x034, 0x000290F0, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x00029DF2, -+ 0xFF0F0104, 0xDEAD, -+ 0xFF0F0104, 0xABCD, -+ 0x034, 0x00028DF1, -+ 0x034, 0x00027DEE, -+ 0x034, 0x00026DEB, -+ 0x034, 0x00025CEC, -+ 0x034, 0x00024CE9, -+ 0x034, 0x000238CA, -+ 0x034, 0x00022889, -+ 0x034, 0x00021489, -+ 0x034, 0x0002044A, -+ 0xFF0F0204, 0xCDEF, -+ 0x034, 0x00028DF1, -+ 0x034, 0x00027DEE, -+ 0x034, 0x00026DEB, -+ 0x034, 0x00025CEC, -+ 0x034, 0x00024CE9, -+ 0x034, 0x000238CA, -+ 0x034, 0x00022889, -+ 0x034, 0x00021489, -+ 0x034, 0x0002044A, -+ 0xFF0F0404, 0xCDEF, -+ 0x034, 0x00028DF1, -+ 0x034, 0x00027DEE, -+ 0x034, 0x00026DEB, -+ 0x034, 0x00025CEC, -+ 0x034, 0x00024CE9, -+ 0x034, 0x000238CA, -+ 0x034, 0x00022889, -+ 0x034, 0x00021489, -+ 0x034, 0x0002044A, -+ 0xFF0F02C0, 0xCDEF, -+ 0x034, 0x000280AF, -+ 0x034, 0x000270AC, -+ 0x034, 0x0002608B, -+ 0x034, 0x00025069, -+ 0x034, 0x00024048, -+ 0x034, 0x00023045, -+ 0x034, 0x00022026, -+ 0x034, 0x00021023, -+ 0x034, 0x00020002, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x00028DEE, -+ 0x034, 0x00027DEB, -+ 0x034, 0x00026CCD, -+ 0x034, 0x00025CCA, -+ 0x034, 0x0002488C, -+ 0x034, 0x0002384C, -+ 0x034, 0x00022849, -+ 0x034, 0x00021449, -+ 0x034, 0x0002004D, -+ 0xFF0F0104, 0xDEAD, -+ 0xFF0F02C0, 0xABCD, -+ 0x034, 0x0000A0D7, -+ 0x034, 0x000090D3, -+ 0x034, 0x000080B1, -+ 0x034, 0x000070AE, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0000ADF7, -+ 0x034, 0x00009DF4, -+ 0x034, 0x00008DF1, -+ 0x034, 0x00007DEE, -+ 0xFF0F02C0, 0xDEAD, -+ 0xFF0F0104, 0xABCD, -+ 0x034, 0x00006DEB, -+ 0x034, 0x00005CEC, -+ 0x034, 0x00004CE9, -+ 0x034, 0x000038CA, -+ 0x034, 0x00002889, -+ 0x034, 0x00001489, -+ 0x034, 0x0000044A, -+ 0xFF0F0204, 0xCDEF, -+ 0x034, 0x00006DEB, -+ 0x034, 0x00005CEC, -+ 0x034, 0x00004CE9, -+ 0x034, 0x000038CA, -+ 0x034, 0x00002889, -+ 0x034, 0x00001489, -+ 0x034, 0x0000044A, -+ 0xFF0F0404, 0xCDEF, -+ 0x034, 0x00006DEB, -+ 0x034, 0x00005CEC, -+ 0x034, 0x00004CE9, -+ 0x034, 0x000038CA, -+ 0x034, 0x00002889, -+ 0x034, 0x00001489, -+ 0x034, 0x0000044A, -+ 0xFF0F02C0, 0xCDEF, -+ 0x034, 0x0000608D, -+ 0x034, 0x0000506B, -+ 0x034, 0x0000404A, -+ 0x034, 0x00003047, -+ 0x034, 0x00002044, -+ 0x034, 0x00001025, -+ 0x034, 0x00000004, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x00006DCD, -+ 0x034, 0x00005CCD, -+ 0x034, 0x00004CCA, -+ 0x034, 0x0000388C, -+ 0x034, 0x00002888, -+ 0x034, 0x00001488, -+ 0x034, 0x00000486, -+ 0xFF0F0104, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0xFF0F0104, 0xABCD, -+ 0x035, 0x00000187, -+ 0x035, 0x00008187, -+ 0x035, 0x00010187, -+ 0x035, 0x00020188, -+ 0x035, 0x00028188, -+ 0x035, 0x00030188, -+ 0x035, 0x00040188, -+ 0x035, 0x00048188, -+ 0x035, 0x00050188, -+ 0xFF0F0204, 0xCDEF, -+ 0x035, 0x00000187, -+ 0x035, 0x00008187, -+ 0x035, 0x00010187, -+ 0x035, 0x00020188, -+ 0x035, 0x00028188, -+ 0x035, 0x00030188, -+ 0x035, 0x00040188, -+ 0x035, 0x00048188, -+ 0x035, 0x00050188, -+ 0xFF0F0404, 0xCDEF, -+ 0x035, 0x00000187, -+ 0x035, 0x00008187, -+ 0x035, 0x00010187, -+ 0x035, 0x00020188, -+ 0x035, 0x00028188, -+ 0x035, 0x00030188, -+ 0x035, 0x00040188, -+ 0x035, 0x00048188, -+ 0x035, 0x00050188, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x035, 0x00000145, -+ 0x035, 0x00008145, -+ 0x035, 0x00010145, -+ 0x035, 0x00020196, -+ 0x035, 0x00028196, -+ 0x035, 0x00030196, -+ 0x035, 0x000401C7, -+ 0x035, 0x000481C7, -+ 0x035, 0x000501C7, -+ 0xFF0F0104, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0xFF0F0104, 0xABCD, -+ 0x036, 0x00085733, -+ 0x036, 0x0008D733, -+ 0x036, 0x00095733, -+ 0x036, 0x0009D733, -+ 0x036, 0x000A64B4, -+ 0x036, 0x000AE4B4, -+ 0x036, 0x000B64B4, -+ 0x036, 0x000BE4B4, -+ 0x036, 0x000C64B4, -+ 0x036, 0x000CE4B4, -+ 0x036, 0x000D64B4, -+ 0x036, 0x000DE4B4, -+ 0xFF0F0204, 0xCDEF, -+ 0x036, 0x00085733, -+ 0x036, 0x0008D733, -+ 0x036, 0x00095733, -+ 0x036, 0x0009D733, -+ 0x036, 0x000A64B4, -+ 0x036, 0x000AE4B4, -+ 0x036, 0x000B64B4, -+ 0x036, 0x000BE4B4, -+ 0x036, 0x000C64B4, -+ 0x036, 0x000CE4B4, -+ 0x036, 0x000D64B4, -+ 0x036, 0x000DE4B4, -+ 0xFF0F0404, 0xCDEF, -+ 0x036, 0x00085733, -+ 0x036, 0x0008D733, -+ 0x036, 0x00095733, -+ 0x036, 0x0009D733, -+ 0x036, 0x000A64B4, -+ 0x036, 0x000AE4B4, -+ 0x036, 0x000B64B4, -+ 0x036, 0x000BE4B4, -+ 0x036, 0x000C64B4, -+ 0x036, 0x000CE4B4, -+ 0x036, 0x000D64B4, -+ 0x036, 0x000DE4B4, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x036, 0x000056B3, -+ 0x036, 0x0000D6B3, -+ 0x036, 0x000156B3, -+ 0x036, 0x0001D6B3, -+ 0x036, 0x00026634, -+ 0x036, 0x0002E634, -+ 0x036, 0x00036634, -+ 0x036, 0x0003E634, -+ 0x036, 0x000467B4, -+ 0x036, 0x0004E7B4, -+ 0x036, 0x000567B4, -+ 0x036, 0x0005E7B4, -+ 0xFF0F0104, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000008, -+ 0xFF0F0104, 0xABCD, -+ 0x03C, 0x000001C8, -+ 0x03C, 0x00000492, -+ 0xFF0F0204, 0xCDEF, -+ 0x03C, 0x000001C8, -+ 0x03C, 0x00000492, -+ 0xFF0F0404, 0xCDEF, -+ 0x03C, 0x000001C8, -+ 0x03C, 0x00000492, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x03C, 0x0000022A, -+ 0x03C, 0x00000594, -+ 0xFF0F0104, 0xDEAD, -+ 0xFF0F0104, 0xABCD, -+ 0x03C, 0x00000800, -+ 0xFF0F0204, 0xCDEF, -+ 0x03C, 0x00000800, -+ 0xFF0F0404, 0xCDEF, -+ 0x03C, 0x00000800, -+ 0xFF0F02C0, 0xCDEF, -+ 0x03C, 0x00000820, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x03C, 0x00000900, -+ 0xFF0F0104, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000002, -+ 0xFF0F0104, 0xABCD, -+ 0x008, 0x0004E400, -+ 0xFF0F0204, 0xCDEF, -+ 0x008, 0x0004E400, -+ 0xFF0F0404, 0xCDEF, -+ 0x008, 0x0004E400, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x008, 0x00002000, -+ 0xFF0F0104, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x0DF, 0x000000C0, -+ 0x01F, 0x00040064, -+ 0xFF0F0104, 0xABCD, -+ 0x058, 0x000A7284, -+ 0x059, 0x000600EC, -+ 0xFF0F0204, 0xCDEF, -+ 0x058, 0x000A7284, -+ 0x059, 0x000600EC, -+ 0xFF0F0404, 0xCDEF, -+ 0x058, 0x000A7284, -+ 0x059, 0x000600EC, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x058, 0x00081184, -+ 0x059, 0x0006016C, -+ 0xFF0F0104, 0xDEAD, -+ 0xFF0F0104, 0xABCD, -+ 0x061, 0x000E8D73, -+ 0x062, 0x00093FC5, -+ 0xFF0F0204, 0xCDEF, -+ 0x061, 0x000E8D73, -+ 0x062, 0x00093FC5, -+ 0xFF0F0404, 0xCDEF, -+ 0x061, 0x000E8D73, -+ 0x062, 0x00093FC5, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x061, 0x000EAD53, -+ 0x062, 0x00093BC4, -+ 0xFF0F0104, 0xDEAD, -+ 0xFF0F0104, 0xABCD, -+ 0x063, 0x000110E9, -+ 0xFF0F0204, 0xCDEF, -+ 0x063, 0x000110E9, -+ 0xFF0F0404, 0xCDEF, -+ 0x063, 0x000110E9, -+ 0xFF0F0200, 0xCDEF, -+ 0x063, 0x000710E9, -+ 0xFF0F02C0, 0xCDEF, -+ 0x063, 0x000110E9, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x063, 0x000714E9, -+ 0xFF0F0104, 0xDEAD, -+ 0xFF0F0104, 0xABCD, -+ 0x064, 0x0001C27C, -+ 0xFF0F0204, 0xCDEF, -+ 0x064, 0x0001C27C, -+ 0xFF0F0404, 0xCDEF, -+ 0x064, 0x0001C27C, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x064, 0x0001C67C, -+ 0xFF0F0104, 0xDEAD, -+ 0xFF0F0200, 0xABCD, -+ 0x065, 0x00093016, -+ 0xFF0F02C0, 0xCDEF, -+ 0x065, 0x00093015, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x065, 0x00091016, -+ 0xFF0F0200, 0xDEAD, -+ 0x018, 0x00000006, -+ 0x0EF, 0x00002000, -+ 0x03B, 0x0003824B, -+ 0x03B, 0x0003024B, -+ 0x03B, 0x0002884B, -+ 0x03B, 0x00020F4B, -+ 0x03B, 0x00018F4B, -+ 0x03B, 0x000104B2, -+ 0x03B, 0x00008049, -+ 0x03B, 0x00000148, -+ 0x03B, 0x0007824B, -+ 0x03B, 0x0007024B, -+ 0x03B, 0x0006824B, -+ 0x03B, 0x00060F4B, -+ 0x03B, 0x00058F4B, -+ 0x03B, 0x000504B2, -+ 0x03B, 0x00048049, -+ 0x03B, 0x00040148, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000100, -+ 0x034, 0x0000ADF2, -+ 0x035, 0x00004800, -+ 0x034, 0x00009DEF, -+ 0x035, 0x00003C00, -+ 0x034, 0x00008DEC, -+ 0x035, 0x00003000, -+ 0x034, 0x00007DE9, -+ 0x035, 0x00002400, -+ 0x034, 0x00006CEC, -+ 0x035, 0x00003000, -+ 0x034, 0x00005CE9, -+ 0x035, 0x00002400, -+ 0x034, 0x000044EC, -+ 0x035, 0x00003000, -+ 0x034, 0x000034E9, -+ 0x035, 0x00002400, -+ 0x034, 0x0000246C, -+ 0x035, 0x00003000, -+ 0x034, 0x00001469, -+ 0x035, 0x00002400, -+ 0x034, 0x0000006C, -+ 0x035, 0x00003000, -+ 0x0EF, 0x00000000, -+ 0x0ED, 0x00000010, -+ 0x044, 0x0000ADF2, -+ 0x044, 0x00009DEF, -+ 0x044, 0x00008DEC, -+ 0x044, 0x00007DE9, -+ 0x044, 0x00006CEC, -+ 0x044, 0x00005CE9, -+ 0x044, 0x000044EC, -+ 0x044, 0x000034E9, -+ 0x044, 0x0000246C, -+ 0x044, 0x00001469, -+ 0x044, 0x0000006C, -+ 0x0ED, 0x00000000, -+ 0x0ED, 0x00000001, -+ 0x040, 0x00038DA7, -+ 0x040, 0x000300C2, -+ 0x040, 0x000288E2, -+ 0x040, 0x000200B8, -+ 0x040, 0x000188A5, -+ 0x040, 0x00010FBC, -+ 0x040, 0x00008F71, -+ 0x040, 0x00000240, -+ 0x0ED, 0x00000000, -+ 0x0EF, 0x000020A2, -+ 0x0DF, 0x00000080, -+ 0x035, 0x00000120, -+ 0x035, 0x00008120, -+ 0x035, 0x00010120, -+ 0x036, 0x00000085, -+ 0x036, 0x00008085, -+ 0x036, 0x00010085, -+ 0x036, 0x00018085, -+ 0x0EF, 0x00000000, -+ 0x051, 0x00000C31, -+ 0x052, 0x00000622, -+ 0x053, 0x000FC70B, -+ 0x054, 0x0000017E, -+ 0x056, 0x00051DF3, -+ 0x051, 0x00000C01, -+ 0x052, 0x000006D6, -+ 0x053, 0x000FC649, -+ 0x070, 0x00049661, -+ 0x071, 0x0007843E, -+ 0x072, 0x00000382, -+ 0x074, 0x00051400, -+ 0x035, 0x00000160, -+ 0x035, 0x00008160, -+ 0x035, 0x00010160, -+ 0x036, 0x00000124, -+ 0x036, 0x00008124, -+ 0x036, 0x00010124, -+ 0x036, 0x00018124, -+ 0x0ED, 0x0000000C, -+ 0x045, 0x00000140, -+ 0x045, 0x00008140, -+ 0x045, 0x00010140, -+ 0x046, 0x00000124, -+ 0x046, 0x00008124, -+ 0x046, 0x00010124, -+ 0x046, 0x00018124, -+ 0x0DF, 0x00000088, -+ 0x0B3, 0x000F0E18, -+ 0x0B4, 0x0001214C, -+ 0x0B7, 0x0003000C, -+ 0x01C, 0x000539D2, -+ 0x018, 0x0001F12A, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x018, 0x0001712A, -+ -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_RadioA( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_RadioA)/sizeof(u4Byte); -+ const pu4Byte Array = Array_MP_8821A_RadioA; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8821A_RadioA, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigRF_RadioA_8821A(pDM_Odm, v1, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigRF_RadioA_8821A(pDM_Odm, v1, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* TxPowerTrack_AP.TXT -+******************************************************************************/ -+ -+static const u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_AP_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+static const u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_AP_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 17, 17, 18, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+static const u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_AP_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 4, 4, 5, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 13, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16}, -+}; -+static const u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_AP_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 7, 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 18, 19, 19, 19}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_AP_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_AP_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_AP_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_AP_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_AP_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_AP_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_AP_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_AP_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_AP( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8821A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_AP_8821A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+static const u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static const u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static const u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 13, 13, 13}, -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 11, 12, 12, 12, 12, 12, 13, 13}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 8, 8, 9, 10, 11, 12, 13, 14, 14, 15, 15, 15, 16, 16, 16, 17, 17, 18, 18}, -+}; -+static const u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_PCIE( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8821A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+static const u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static const u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+}; -+static const u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 0, 0, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15}, -+ {0, 0, 0, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15}, -+ {0, 0, 0, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15}, -+}; -+static const u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16}, -+ {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16}, -+}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; -+static const u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_USB( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_MP_8821A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8821A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+static const pu1Byte Array_MP_8821A_TXPWR_LMT[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "114", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "114", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "32", -+ "MKK", "5G", "20M", "HT", "1T", "36", "32", -+ "FCC", "5G", "20M", "HT", "1T", "40", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "32", -+ "MKK", "5G", "20M", "HT", "1T", "40", "32", -+ "FCC", "5G", "20M", "HT", "1T", "44", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "32", -+ "MKK", "5G", "20M", "HT", "1T", "44", "32", -+ "FCC", "5G", "20M", "HT", "1T", "48", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "32", -+ "MKK", "5G", "20M", "HT", "1T", "48", "32", -+ "FCC", "5G", "20M", "HT", "1T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "32", -+ "MKK", "5G", "20M", "HT", "1T", "52", "32", -+ "FCC", "5G", "20M", "HT", "1T", "56", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "32", -+ "MKK", "5G", "20M", "HT", "1T", "56", "32", -+ "FCC", "5G", "20M", "HT", "1T", "60", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "32", -+ "MKK", "5G", "20M", "HT", "1T", "60", "32", -+ "FCC", "5G", "20M", "HT", "1T", "64", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "32", -+ "MKK", "5G", "20M", "HT", "1T", "64", "32", -+ "FCC", "5G", "20M", "HT", "1T", "100", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "32", -+ "MKK", "5G", "20M", "HT", "1T", "100", "32", -+ "FCC", "5G", "20M", "HT", "1T", "114", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "114", "32", -+ "MKK", "5G", "20M", "HT", "1T", "114", "32", -+ "FCC", "5G", "20M", "HT", "1T", "108", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "32", -+ "MKK", "5G", "20M", "HT", "1T", "108", "32", -+ "FCC", "5G", "20M", "HT", "1T", "112", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "32", -+ "MKK", "5G", "20M", "HT", "1T", "112", "32", -+ "FCC", "5G", "20M", "HT", "1T", "116", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "32", -+ "MKK", "5G", "20M", "HT", "1T", "116", "32", -+ "FCC", "5G", "20M", "HT", "1T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "32", -+ "MKK", "5G", "20M", "HT", "1T", "120", "32", -+ "FCC", "5G", "20M", "HT", "1T", "124", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "32", -+ "MKK", "5G", "20M", "HT", "1T", "124", "32", -+ "FCC", "5G", "20M", "HT", "1T", "128", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "32", -+ "MKK", "5G", "20M", "HT", "1T", "128", "32", -+ "FCC", "5G", "20M", "HT", "1T", "132", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "32", -+ "MKK", "5G", "20M", "HT", "1T", "132", "32", -+ "FCC", "5G", "20M", "HT", "1T", "136", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "32", -+ "MKK", "5G", "20M", "HT", "1T", "136", "32", -+ "FCC", "5G", "20M", "HT", "1T", "140", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "32", -+ "MKK", "5G", "20M", "HT", "1T", "140", "32", -+ "FCC", "5G", "20M", "HT", "1T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "32", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "32", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "32", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "32", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "32", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "30", -+ "MKK", "5G", "20M", "HT", "2T", "36", "30", -+ "FCC", "5G", "20M", "HT", "2T", "40", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "30", -+ "MKK", "5G", "20M", "HT", "2T", "40", "30", -+ "FCC", "5G", "20M", "HT", "2T", "44", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "30", -+ "MKK", "5G", "20M", "HT", "2T", "44", "30", -+ "FCC", "5G", "20M", "HT", "2T", "48", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "30", -+ "MKK", "5G", "20M", "HT", "2T", "48", "30", -+ "FCC", "5G", "20M", "HT", "2T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "30", -+ "MKK", "5G", "20M", "HT", "2T", "52", "30", -+ "FCC", "5G", "20M", "HT", "2T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "30", -+ "MKK", "5G", "20M", "HT", "2T", "56", "30", -+ "FCC", "5G", "20M", "HT", "2T", "60", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "30", -+ "MKK", "5G", "20M", "HT", "2T", "60", "30", -+ "FCC", "5G", "20M", "HT", "2T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "30", -+ "MKK", "5G", "20M", "HT", "2T", "64", "30", -+ "FCC", "5G", "20M", "HT", "2T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "30", -+ "MKK", "5G", "20M", "HT", "2T", "100", "30", -+ "FCC", "5G", "20M", "HT", "2T", "114", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "114", "30", -+ "MKK", "5G", "20M", "HT", "2T", "114", "30", -+ "FCC", "5G", "20M", "HT", "2T", "108", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "30", -+ "MKK", "5G", "20M", "HT", "2T", "108", "30", -+ "FCC", "5G", "20M", "HT", "2T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "30", -+ "MKK", "5G", "20M", "HT", "2T", "112", "30", -+ "FCC", "5G", "20M", "HT", "2T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "30", -+ "MKK", "5G", "20M", "HT", "2T", "116", "30", -+ "FCC", "5G", "20M", "HT", "2T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "30", -+ "MKK", "5G", "20M", "HT", "2T", "120", "30", -+ "FCC", "5G", "20M", "HT", "2T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "30", -+ "MKK", "5G", "20M", "HT", "2T", "124", "30", -+ "FCC", "5G", "20M", "HT", "2T", "128", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "30", -+ "MKK", "5G", "20M", "HT", "2T", "128", "30", -+ "FCC", "5G", "20M", "HT", "2T", "132", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "30", -+ "MKK", "5G", "20M", "HT", "2T", "132", "30", -+ "FCC", "5G", "20M", "HT", "2T", "136", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "30", -+ "MKK", "5G", "20M", "HT", "2T", "136", "30", -+ "FCC", "5G", "20M", "HT", "2T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "30", -+ "MKK", "5G", "20M", "HT", "2T", "140", "30", -+ "FCC", "5G", "20M", "HT", "2T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "30", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "30", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "30", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "30", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "30", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "32", -+ "MKK", "5G", "40M", "HT", "1T", "38", "32", -+ "FCC", "5G", "40M", "HT", "1T", "46", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "32", -+ "MKK", "5G", "40M", "HT", "1T", "46", "32", -+ "FCC", "5G", "40M", "HT", "1T", "54", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "32", -+ "MKK", "5G", "40M", "HT", "1T", "54", "32", -+ "FCC", "5G", "40M", "HT", "1T", "62", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "32", -+ "MKK", "5G", "40M", "HT", "1T", "62", "32", -+ "FCC", "5G", "40M", "HT", "1T", "102", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "32", -+ "MKK", "5G", "40M", "HT", "1T", "102", "32", -+ "FCC", "5G", "40M", "HT", "1T", "110", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "32", -+ "MKK", "5G", "40M", "HT", "1T", "110", "32", -+ "FCC", "5G", "40M", "HT", "1T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "32", -+ "MKK", "5G", "40M", "HT", "1T", "118", "32", -+ "FCC", "5G", "40M", "HT", "1T", "126", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "32", -+ "MKK", "5G", "40M", "HT", "1T", "126", "32", -+ "FCC", "5G", "40M", "HT", "1T", "134", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "32", -+ "MKK", "5G", "40M", "HT", "1T", "134", "32", -+ "FCC", "5G", "40M", "HT", "1T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "32", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "32", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "30", -+ "MKK", "5G", "40M", "HT", "2T", "38", "30", -+ "FCC", "5G", "40M", "HT", "2T", "46", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "30", -+ "MKK", "5G", "40M", "HT", "2T", "46", "30", -+ "FCC", "5G", "40M", "HT", "2T", "54", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "30", -+ "MKK", "5G", "40M", "HT", "2T", "54", "30", -+ "FCC", "5G", "40M", "HT", "2T", "62", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "30", -+ "MKK", "5G", "40M", "HT", "2T", "62", "30", -+ "FCC", "5G", "40M", "HT", "2T", "102", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "30", -+ "MKK", "5G", "40M", "HT", "2T", "102", "30", -+ "FCC", "5G", "40M", "HT", "2T", "110", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "30", -+ "MKK", "5G", "40M", "HT", "2T", "110", "30", -+ "FCC", "5G", "40M", "HT", "2T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "30", -+ "MKK", "5G", "40M", "HT", "2T", "118", "30", -+ "FCC", "5G", "40M", "HT", "2T", "126", "32", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "30", -+ "MKK", "5G", "40M", "HT", "2T", "126", "30", -+ "FCC", "5G", "40M", "HT", "2T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "30", -+ "MKK", "5G", "40M", "HT", "2T", "134", "30", -+ "FCC", "5G", "40M", "HT", "2T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "30", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "30", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "28", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "32", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+}; -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_MP_8821A_TXPWR_LMT)/sizeof(pu1Byte); -+ const pu1Byte *Array = Array_MP_8821A_TXPWR_LMT; -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_8821A_TXPWR_LMT\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7 ) -+ { -+ const pu1Byte regulation = Array[i]; -+ const pu1Byte band = Array[i+1]; -+ const pu1Byte bandwidth = Array[i+2]; -+ const pu1Byte rate = Array[i+3]; -+ const pu1Byte rfPath = Array[i+4]; -+ const pu1Byte chnl = Array[i+5]; -+ const pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8821A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+ } -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_RF.h 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,66 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_MP_RF_HW_IMG_8821A_H -+#define __INC_MP_RF_HW_IMG_8821A_H -+ -+static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_RadioA( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_AP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_AP( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_PCIE( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TxPowerTrack_USB( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_MP_8821A_TXPWR_LMT( // TC: Test Chip, MP: MP Chip -+ PDM_ODM_T pDM_Odm -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.c 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,637 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+//#include "Mp_Precomp.h" -+#include "odm_precomp.h" -+ -+static bool -+CheckCondition( -+ const u4Byte Condition, -+ const u4Byte Hex -+ ) -+{ -+ u4Byte _board = (Hex & 0x000000FF); -+ u4Byte _interface = (Hex & 0x0000FF00) >> 8; -+ u4Byte _platform = (Hex & 0x00FF0000) >> 16; -+ u4Byte cond = Condition; -+ -+ if ( Condition == 0xCDCDCDCD ) -+ return true; -+ -+ cond = Condition & 0x000000FF; -+ if ( (_board != cond) && (cond != 0xFF) ) -+ return false; -+ -+ cond = Condition & 0x0000FF00; -+ cond = cond >> 8; -+ if ( ((_interface & cond) == 0) && (cond != 0x07) ) -+ return false; -+ -+ cond = Condition & 0x00FF0000; -+ cond = cond >> 16; -+ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) -+ return false; -+ return true; -+} -+ -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+static const u4Byte Array_TC_8821A_AGC_TAB[] = { -+ 0x81C, 0xBF000001, -+ 0x81C, 0xBF020001, -+ 0x81C, 0xBF040001, -+ 0x81C, 0xBF060001, -+ 0x81C, 0xBE080001, -+ 0x81C, 0xBD0A0001, -+ 0x81C, 0xBC0C0001, -+ 0x81C, 0xBA0E0001, -+ 0x81C, 0xB9100001, -+ 0x81C, 0xB8120001, -+ 0x81C, 0xB7140001, -+ 0x81C, 0xB6160001, -+ 0x81C, 0xB5180001, -+ 0x81C, 0xB41A0001, -+ 0x81C, 0xB41C0001, -+ 0x81C, 0xB31E0001, -+ 0x81C, 0xB2200001, -+ 0x81C, 0xB1220001, -+ 0x81C, 0xB0240001, -+ 0x81C, 0xAF260001, -+ 0x81C, 0xAE280001, -+ 0x81C, 0xAD2A0001, -+ 0x81C, 0xAC2C0001, -+ 0x81C, 0xAB2E0001, -+ 0x81C, 0xAA300001, -+ 0x81C, 0xA9320001, -+ 0x81C, 0xA8340001, -+ 0x81C, 0xA7360001, -+ 0x81C, 0xA6380001, -+ 0x81C, 0xA53A0001, -+ 0x81C, 0xA43C0001, -+ 0x81C, 0x673E0001, -+ 0x81C, 0x66400001, -+ 0x81C, 0x65420001, -+ 0x81C, 0x64440001, -+ 0x81C, 0x63460001, -+ 0x81C, 0x62480001, -+ 0x81C, 0x614A0001, -+ 0x81C, 0x474C0001, -+ 0x81C, 0x464E0001, -+ 0x81C, 0x45500001, -+ 0x81C, 0x44520001, -+ 0x81C, 0x43540001, -+ 0x81C, 0x42560001, -+ 0x81C, 0x41580001, -+ 0x81C, 0x285A0001, -+ 0x81C, 0x275C0001, -+ 0x81C, 0x265E0001, -+ 0x81C, 0x25600001, -+ 0x81C, 0x24620001, -+ 0x81C, 0x0A640001, -+ 0x81C, 0x09660001, -+ 0x81C, 0x08680001, -+ 0x81C, 0x076A0001, -+ 0x81C, 0x066C0001, -+ 0x81C, 0x056E0001, -+ 0x81C, 0x04700001, -+ 0x81C, 0x03720001, -+ 0x81C, 0x02740001, -+ 0x81C, 0x01760001, -+ 0x81C, 0x01780001, -+ 0x81C, 0x017A0001, -+ 0x81C, 0x017C0001, -+ 0x81C, 0x017E0001, -+ 0xFF0F02C0, 0xABCD, -+ 0x81C, 0xFD800001, -+ 0x81C, 0xFC820001, -+ 0x81C, 0xFB840001, -+ 0x81C, 0xFA860001, -+ 0x81C, 0xF9880001, -+ 0x81C, 0xF88A0001, -+ 0x81C, 0xF78C0001, -+ 0x81C, 0xF68E0001, -+ 0x81C, 0xF5900001, -+ 0x81C, 0xF4920001, -+ 0x81C, 0xF3940001, -+ 0x81C, 0xF2960001, -+ 0x81C, 0xF1980001, -+ 0x81C, 0xF09A0001, -+ 0x81C, 0xEF9C0001, -+ 0x81C, 0xEE9E0001, -+ 0x81C, 0xEDA00001, -+ 0x81C, 0xECA20001, -+ 0x81C, 0xEBA40001, -+ 0x81C, 0xEAA60001, -+ 0x81C, 0xE9A80001, -+ 0x81C, 0xE8AA0001, -+ 0x81C, 0xE7AC0001, -+ 0x81C, 0xE6AE0001, -+ 0x81C, 0xC6B00001, -+ 0x81C, 0xC5B20001, -+ 0x81C, 0xA5B40001, -+ 0x81C, 0xA4B60001, -+ 0x81C, 0xA3B80001, -+ 0x81C, 0xA2BA0001, -+ 0x81C, 0xA1BC0001, -+ 0x81C, 0x65BE0001, -+ 0x81C, 0x64C00001, -+ 0x81C, 0x63C20001, -+ 0x81C, 0x62C40001, -+ 0x81C, 0x61C60001, -+ 0x81C, 0x60C80001, -+ 0x81C, 0x60CA0001, -+ 0x81C, 0x60CC0001, -+ 0x81C, 0x60CE0001, -+ 0x81C, 0x60D00001, -+ 0x81C, 0x60D20001, -+ 0x81C, 0x60D40001, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x81C, 0xFF800001, -+ 0x81C, 0xFF820001, -+ 0x81C, 0xFF840001, -+ 0x81C, 0xFF860001, -+ 0x81C, 0xFF880001, -+ 0x81C, 0xFF8A0001, -+ 0x81C, 0xFE8C0001, -+ 0x81C, 0xFD8E0001, -+ 0x81C, 0xFC900001, -+ 0x81C, 0xFB920001, -+ 0x81C, 0xFA940001, -+ 0x81C, 0xF9960001, -+ 0x81C, 0xF8980001, -+ 0x81C, 0xF79A0001, -+ 0x81C, 0xF69C0001, -+ 0x81C, 0xF59E0001, -+ 0x81C, 0xF4A00001, -+ 0x81C, 0xF3A20001, -+ 0x81C, 0xF2A40001, -+ 0x81C, 0xF1A60001, -+ 0x81C, 0xF0A80001, -+ 0x81C, 0xEFAA0001, -+ 0x81C, 0xEEAC0001, -+ 0x81C, 0xEDAE0001, -+ 0x81C, 0xECB00001, -+ 0x81C, 0xEBB20001, -+ 0x81C, 0xEAB40001, -+ 0x81C, 0xE9B60001, -+ 0x81C, 0xE8B80001, -+ 0x81C, 0xE7BA0001, -+ 0x81C, 0xE6BC0001, -+ 0x81C, 0xC6BE0001, -+ 0x81C, 0xC5C00001, -+ 0x81C, 0xA5C20001, -+ 0x81C, 0xA4C40001, -+ 0x81C, 0xA3C60001, -+ 0x81C, 0xA2C80001, -+ 0x81C, 0xA1CA0001, -+ 0x81C, 0x65CC0001, -+ 0x81C, 0x64CE0001, -+ 0x81C, 0x63D00001, -+ 0x81C, 0x62D20001, -+ 0x81C, 0x61D40001, -+ 0xFF0F02C0, 0xDEAD, -+ 0x81C, 0x60D60001, -+ 0x81C, 0x60D80001, -+ 0x81C, 0x60DA0001, -+ 0x81C, 0x60DC0001, -+ 0x81C, 0x60DE0001, -+ 0x81C, 0x60E00001, -+ 0x81C, 0x60E20001, -+ 0x81C, 0x60E40001, -+ 0x81C, 0x60E60001, -+ 0x81C, 0x60E80001, -+ 0x81C, 0x60EA0001, -+ 0x81C, 0x60EC0001, -+ 0x81C, 0x60EE0001, -+ 0x81C, 0x60F00001, -+ 0x81C, 0x60F20001, -+ 0x81C, 0x60F40001, -+ 0x81C, 0x60F60001, -+ 0x81C, 0x60F80001, -+ 0x81C, 0x60FA0001, -+ 0x81C, 0x60FC0001, -+ 0x81C, 0x60FE0001, -+ -+}; -+ -+static void ODM_ReadAndConfig_TC_8821A_AGC_TAB(PDM_ODM_T pDM_Odm) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_TC_8821A_AGC_TAB)/sizeof(u4Byte); -+ const pu4Byte Array = Array_TC_8821A_AGC_TAB; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8821A_AGC_TAB, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_AGC_8821A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_AGC_8821A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+static const u32 Array_TC_8821A_PHY_REG[] = { -+ 0x800, 0x0020D410, -+ 0x804, 0x080112E0, -+ 0x808, 0x0E028211, -+ 0x80C, 0x12131111, -+ 0x810, 0x20101261, -+ 0x814, 0x020C3D10, -+ 0x818, 0x03A00385, -+ 0x820, 0x00000000, -+ 0x824, 0x00030FE0, -+ 0x828, 0x00000000, -+ 0x82C, 0x002083DD, -+ 0x830, 0x2AAA8E24, -+ 0x834, 0x0037A705, -+ 0x838, 0x06489B45, -+ 0x83C, 0x0000095B, -+ 0x840, 0xC0000001, -+ 0x844, 0x40003CDE, -+ 0x848, 0x62103F8B, -+ 0x84C, 0x6CFDFFB8, -+ 0x850, 0x28874706, -+ 0x854, 0x0001520C, -+ 0x858, 0x8060E000, -+ 0x85C, 0x74210168, -+ 0x860, 0x6929C321, -+ 0x864, 0x79727432, -+ 0x868, 0x8CA7A314, -+ 0x86C, 0x338C2878, -+ 0x870, 0x03333333, -+ 0x874, 0x31612C2E, -+ 0x878, 0x00000152, -+ 0x87C, 0x000FC000, -+ 0x8A0, 0x00000013, -+ 0x8A4, 0x7F7F7F7F, -+ 0x8A8, 0xA0000338, -+ 0x8AC, 0x0FF0FA0A, -+ 0x8B4, 0x000FC080, -+ 0x8B8, 0x7C005FFF, -+ 0x8BC, 0x8CA520A0, -+ 0x8C0, 0x01F00020, -+ 0x8C4, 0x00000000, -+ 0x8C8, 0x00013169, -+ 0x8CC, 0x08248492, -+ 0x8D4, 0x940008A0, -+ 0x8D8, 0x290B5612, -+ 0x8F8, 0x400002C0, -+ 0x8FC, 0x00000000, -+ 0x900, 0x00000700, -+ 0x90C, 0x00000000, -+ 0x910, 0x0000FC00, -+ 0x914, 0x00000404, -+ 0x918, 0x1C1028C0, -+ 0x91C, 0x64B11A1C, -+ 0x920, 0xE0767233, -+ 0x924, 0x055AA500, -+ 0x928, 0x00000004, -+ 0x92C, 0xFFFE0000, -+ 0x930, 0xFFFFFFFE, -+ 0x934, 0x001FFFFF, -+ 0x960, 0x00000000, -+ 0x964, 0x00000000, -+ 0x968, 0x00000000, -+ 0x96C, 0x00000000, -+ 0x970, 0x801FFFFF, -+ 0x974, 0x000003FF, -+ 0x978, 0x00000000, -+ 0x97C, 0x00000000, -+ 0x980, 0x00000000, -+ 0x984, 0x00000000, -+ 0x988, 0x00000000, -+ 0x9A4, 0x00000080, -+ 0x9A8, 0x00000000, -+ 0x9AC, 0x00000000, -+ 0x9B0, 0x01081008, -+ 0x9B4, 0x01081008, -+ 0x9B8, 0x01081008, -+ 0x9BC, 0x01081008, -+ 0x9D0, 0x00000000, -+ 0x9D4, 0x00000000, -+ 0x9D8, 0x00000000, -+ 0x9DC, 0x00000000, -+ 0x9E4, 0x00000002, -+ 0x9E8, 0x00000000, -+ 0xA00, 0x00D047C8, -+ 0xA04, 0x01FF000C, -+ 0xA08, 0x8C8A8300, -+ 0xA0C, 0x2E68000F, -+ 0xA10, 0x9500BB78, -+ 0xA14, 0x11144028, -+ 0xA18, 0x00881117, -+ 0xA1C, 0x89140F00, -+ 0xA20, 0x1A1B0000, -+ 0xA24, 0x090E1317, -+ 0xA28, 0x00000204, -+ 0xA2C, 0x00910000, -+ 0xA70, 0x101FFF00, -+ 0xA74, 0x00000008, -+ 0xA78, 0x00000900, -+ 0xA7C, 0x225B0606, -+ 0xA80, 0x21805490, -+ 0xA84, 0x001F0000, -+ 0xB00, 0x03100000, -+ 0xB04, 0x0000B000, -+ 0xB08, 0xAE0201EB, -+ 0xB0C, 0x01003207, -+ 0xB10, 0x00009807, -+ 0xB14, 0x01000000, -+ 0xB18, 0x00000002, -+ 0xB1C, 0x00000002, -+ 0xB20, 0x0000001F, -+ 0xB24, 0x03020100, -+ 0xB28, 0x07060504, -+ 0xB2C, 0x0B0A0908, -+ 0xB30, 0x0F0E0D0C, -+ 0xB34, 0x13121110, -+ 0xB38, 0x17161514, -+ 0xB3C, 0x0000003A, -+ 0xB40, 0x00000000, -+ 0xB44, 0x00000000, -+ 0xB48, 0x13000032, -+ 0xB4C, 0x48080000, -+ 0xB50, 0x00000000, -+ 0xB54, 0x00000000, -+ 0xB58, 0x00000000, -+ 0xB5C, 0x00000000, -+ 0xC00, 0x00000007, -+ 0xC04, 0x00042020, -+ 0xC08, 0x80410231, -+ 0xC0C, 0x00000000, -+ 0xC10, 0x00000100, -+ 0xC14, 0x01000000, -+ 0xC1C, 0x40000003, -+ 0xC20, 0x2C2C2C2C, -+ 0xC24, 0x30303030, -+ 0xC28, 0x30303030, -+ 0xC2C, 0x2C2C2C2C, -+ 0xC30, 0x2C2C2C2C, -+ 0xC34, 0x2C2C2C2C, -+ 0xC38, 0x2C2C2C2C, -+ 0xC3C, 0x2A2A2A2A, -+ 0xC40, 0x2A2A2A2A, -+ 0xC44, 0x2A2A2A2A, -+ 0xC48, 0x2A2A2A2A, -+ 0xC4C, 0x2A2A2A2A, -+ 0xC50, 0x00000020, -+ 0xC54, 0x001C1208, -+ 0xC58, 0x30000C1C, -+ 0xC5C, 0x00000058, -+ 0xC60, 0x34344443, -+ 0xC64, 0x07003333, -+ 0xC68, 0x19791979, -+ 0xC6C, 0x19791979, -+ 0xC70, 0x19791979, -+ 0xC74, 0x19791979, -+ 0xC78, 0x19791979, -+ 0xC7C, 0x19791979, -+ 0xC80, 0x19791979, -+ 0xC84, 0x19791979, -+ 0xC94, 0x00000000, -+ 0xC98, 0x00000000, -+ 0xC9C, 0x00000000, -+ 0xCA0, 0x00000029, -+ 0xCA4, 0x08040201, -+ 0xCA8, 0x80402010, -+ 0xCB0, 0x77775745, -+ 0xCB4, 0x10000077, -+ 0xCB8, 0x00508240, -+ -+}; -+ -+static void -+ODM_ReadAndConfig_TC_8821A_PHY_REG( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_TC_8821A_PHY_REG)/sizeof(u4Byte); -+ const pu4Byte Array = Array_TC_8821A_PHY_REG; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8821A_PHY_REG, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_PHY_8821A(pDM_Odm, v1, bMaskDWord, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigBB_PHY_8821A(pDM_Odm, v1, bMaskDWord, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+static const u32 Array_TC_8821A_PHY_REG_PG[] = { -+ 0xC20, 0x00000000, 0x34343434, -+ 0xC24, 0x00000000, 0x34343434, -+ 0xC28, 0x00000000, 0x30323234, -+ 0xC2C, 0x00000000, 0x34343434, -+ 0xC30, 0x00000000, 0x26283032, -+ 0xC34, 0x00000000, 0x34343434, -+ 0xC38, 0x00000000, 0x26283032, -+ 0xE20, 0x00000000, 0x34343434, -+ 0xE24, 0x00000000, 0x34343434, -+ 0xE28, 0x00000000, 0x30323234, -+ 0xE2C, 0x00000000, 0x34343434, -+ 0xE30, 0x00000000, 0x26283032, -+ 0xE34, 0x00000000, 0x34343434, -+ 0xE38, 0x00000000, 0x26283032, -+ 0xC24, 0x00000000, 0x32323434, -+ 0xC28, 0x00000000, 0x30303032, -+ 0xC2C, 0x00000000, 0x32323434, -+ 0xC30, 0x00000000, 0x30303032, -+ 0xC34, 0x00000000, 0x32323434, -+ 0xC38, 0x00000000, 0x30303032, -+ 0xC3C, 0x00000000, 0x32323434, -+ 0xC40, 0x00000000, 0x30303032, -+ 0xC44, 0x00000000, 0x34342828, -+ 0xC48, 0x00000000, 0x30323232, -+ 0xC4C, 0x00000000, 0x28283030, -+ 0xE24, 0x00000000, 0x32323434, -+ 0xE28, 0x00000000, 0x30303032, -+ 0xE2C, 0x00000000, 0x32323434, -+ 0xE30, 0x00000000, 0x28303032, -+ 0xE34, 0x00000000, 0x32323434, -+ 0xE38, 0x00000000, 0x30303032, -+ 0xE3C, 0x00000000, 0x32323434, -+ 0xE40, 0x00000000, 0x30303032, -+ 0xE44, 0x00000000, 0x34342828, -+ 0xE48, 0x00000000, 0x30323232, -+ 0xE4C, 0x00000000, 0x28283030, -+ -+}; -+ -+static void -+ODM_ReadAndConfig_TC_8821A_PHY_REG_PG( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_TC_8821A_PHY_REG_PG)/sizeof(u4Byte); -+ const pu4Byte Array = Array_TC_8821A_PHY_REG_PG; -+ -+ pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ for (i = 0; i < ArrayLen; i += 3 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ u4Byte v3 = Array[i+2]; -+ -+ // this line is a line of pure_body -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigBB_PHY_REG_PG_8821A(pDM_Odm, v1, v2, v3); -+ continue; -+ } -+ else -+ { // this line is the start of branch -+ if ( !CheckCondition(Array[i], hex) ) -+ { // don't need the hw_body -+ i += 2; // skip the pair of expression -+ v1 = Array[i]; -+ v2 = Array[i+1]; -+ v3 = Array[i+2]; -+ while (v2 != 0xDEAD) -+ { -+ i += 3; -+ v1 = Array[i]; -+ v2 = Array[i+1]; -+ v3 = Array[i+1]; -+ } -+ } -+ } -+ } -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_BB.h 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,48 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_TC_BB_HW_IMG_8821A_H -+#define __INC_TC_BB_HW_IMG_8821A_H -+ -+static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); -+ -+/****************************************************************************** -+* AGC_TAB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8821A_AGC_TAB( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* PHY_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8821A_PHY_REG( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* PHY_REG_PG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8821A_PHY_REG_PG( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.c 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,219 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+//#include "Mp_Precomp.h" -+#include "odm_precomp.h" -+ -+static bool -+CheckCondition( -+ const u4Byte Condition, -+ const u4Byte Hex -+ ) -+{ -+ u4Byte _board = (Hex & 0x000000FF); -+ u4Byte _interface = (Hex & 0x0000FF00) >> 8; -+ u4Byte _platform = (Hex & 0x00FF0000) >> 16; -+ u4Byte cond = Condition; -+ -+ if ( Condition == 0xCDCDCDCD ) -+ return true; -+ -+ cond = Condition & 0x000000FF; -+ if ( (_board != cond) && (cond != 0xFF) ) -+ return false; -+ -+ cond = Condition & 0x0000FF00; -+ cond = cond >> 8; -+ if ( ((_interface & cond) == 0) && (cond != 0x07) ) -+ return false; -+ -+ cond = Condition & 0x00FF0000; -+ cond = cond >> 16; -+ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) -+ return false; -+ return true; -+} -+ -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+static const u4Byte Array_TC_8821A_MAC_REG[] = { -+ 0x428, 0x0000000A, -+ 0x429, 0x00000010, -+ 0x430, 0x00000000, -+ 0x431, 0x00000000, -+ 0x432, 0x00000000, -+ 0x433, 0x00000001, -+ 0x434, 0x00000004, -+ 0x435, 0x00000005, -+ 0x436, 0x00000007, -+ 0x437, 0x00000008, -+ 0x43C, 0x00000004, -+ 0x43D, 0x00000005, -+ 0x43E, 0x00000007, -+ 0x43F, 0x00000008, -+ 0x440, 0x0000005D, -+ 0x441, 0x00000001, -+ 0x442, 0x00000000, -+ 0x444, 0x00000010, -+ 0x445, 0x00000000, -+ 0x446, 0x00000000, -+ 0x447, 0x00000000, -+ 0x448, 0x00000000, -+ 0x449, 0x000000F0, -+ 0x44A, 0x0000000F, -+ 0x44B, 0x0000003E, -+ 0x44C, 0x00000010, -+ 0x44D, 0x00000000, -+ 0x44E, 0x00000000, -+ 0x44F, 0x00000000, -+ 0x450, 0x00000000, -+ 0x451, 0x000000F0, -+ 0x452, 0x0000000F, -+ 0x453, 0x00000000, -+ 0x460, 0x00000066, -+ 0x461, 0x00000066, -+ 0x4C8, 0x000000FF, -+ 0x4C9, 0x00000008, -+ 0x4CC, 0x000000FF, -+ 0x4CD, 0x000000FF, -+ 0x4CE, 0x00000001, -+ 0x500, 0x00000026, -+ 0x501, 0x000000A2, -+ 0x502, 0x0000002F, -+ 0x503, 0x00000000, -+ 0x504, 0x00000028, -+ 0x505, 0x000000A3, -+ 0x506, 0x0000005E, -+ 0x507, 0x00000000, -+ 0x508, 0x0000002B, -+ 0x509, 0x000000A4, -+ 0x50A, 0x0000005E, -+ 0x50B, 0x00000000, -+ 0x50C, 0x0000004F, -+ 0x50D, 0x000000A4, -+ 0x50E, 0x00000000, -+ 0x50F, 0x00000000, -+ 0x512, 0x0000001C, -+ 0x514, 0x0000000A, -+ 0x516, 0x0000000A, -+ 0x525, 0x0000004F, -+ 0x550, 0x00000010, -+ 0x551, 0x00000010, -+ 0x559, 0x00000002, -+ 0x55C, 0x00000050, -+ 0x55D, 0x000000FF, -+ 0x605, 0x00000030, -+ 0x608, 0x0000000E, -+ 0x609, 0x0000002A, -+ 0x620, 0x000000FF, -+ 0x621, 0x000000FF, -+ 0x622, 0x000000FF, -+ 0x623, 0x000000FF, -+ 0x624, 0x000000FF, -+ 0x625, 0x000000FF, -+ 0x626, 0x000000FF, -+ 0x627, 0x000000FF, -+ 0x638, 0x00000050, -+ 0x63C, 0x0000000A, -+ 0x63D, 0x0000000A, -+ 0x63E, 0x0000000E, -+ 0x63F, 0x0000000E, -+ 0x640, 0x00000040, -+ 0x642, 0x00000040, -+ 0x643, 0x00000000, -+ 0x66E, 0x00000005, -+ 0x700, 0x00000021, -+ 0x701, 0x00000043, -+ 0x702, 0x00000065, -+ 0x703, 0x00000087, -+ 0x708, 0x00000021, -+ 0x709, 0x00000043, -+ 0x70A, 0x00000065, -+ 0x70B, 0x00000087, -+ -+}; -+ -+static void -+ODM_ReadAndConfig_TC_8821A_MAC_REG( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_TC_8821A_MAC_REG)/sizeof(u4Byte); -+ const pu4Byte Array = Array_TC_8821A_MAC_REG; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8821A_MAC_REG, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigMAC_8821A(pDM_Odm, v1, (u1Byte)v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigMAC_8821A(pDM_Odm, v1, (u1Byte)v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_MAC.h 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,30 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_TC_MAC_HW_IMG_8821A_H -+#define __INC_TC_MAC_HW_IMG_8821A_H -+ -+static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); -+ -+/****************************************************************************** -+* MAC_REG.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8821A_MAC_REG( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.c 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,1195 @@ -+ /****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ //#include "Mp_Precomp.h" -+ #include "odm_precomp.h" -+ -+ static bool -+ CheckCondition( -+ const u4Byte Condition, -+ const u4Byte Hex -+ ) -+ { -+ u4Byte _board = (Hex & 0x000000FF); -+ u4Byte _interface = (Hex & 0x0000FF00) >> 8; -+ u4Byte _platform = (Hex & 0x00FF0000) >> 16; -+ u4Byte cond = Condition; -+ -+ if ( Condition == 0xCDCDCDCD ) -+ return true; -+ -+ cond = Condition & 0x000000FF; -+ if ( (_board != cond) && (cond != 0xFF) ) -+ return false; -+ -+ cond = Condition & 0x0000FF00; -+ cond = cond >> 8; -+ if ( ((_interface & cond) == 0) && (cond != 0x07) ) -+ return false; -+ -+ cond = Condition & 0x00FF0000; -+ cond = cond >> 16; -+ if ( ((_platform & cond) == 0) && (cond != 0x0F) ) -+ return false; -+ return true; -+ } -+ -+ -+ /****************************************************************************** -+ * RadioA.TXT -+ ******************************************************************************/ -+ -+static const u4Byte Array_TC_8821A_RadioA[] = { -+ 0x018, 0x0001712A, -+ 0x056, 0x00051CF2, -+ 0x066, 0x00040000, -+ 0x01C, 0x000739D2, -+ 0x01E, 0x000F8000, -+ 0x082, 0x00000830, -+ 0x083, 0x00021800, -+ 0x084, 0x00028000, -+ 0x085, 0x00048000, -+ 0x086, 0x00094838, -+ 0x087, 0x00044980, -+ 0x088, 0x00048000, -+ 0x089, 0x0000D480, -+ 0x08A, 0x00042240, -+ 0x08B, 0x000F0380, -+ 0x08C, 0x00090000, -+ 0x08D, 0x00022852, -+ 0x08E, 0x00065540, -+ 0x08F, 0x00088001, -+ 0x0EF, 0x00020000, -+ 0x03E, 0x00000380, -+ 0x03F, 0x00090018, -+ 0x03E, 0x00020380, -+ 0x03F, 0x000A0018, -+ 0x03E, 0x00040308, -+ 0x03F, 0x000A0018, -+ 0x03E, 0x00060018, -+ 0x03F, 0x000A0018, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00001000, -+ 0x03A, 0x000000C4, -+ 0x03B, 0x0003A000, -+ 0x03A, 0x000001FC, -+ 0x03B, 0x00032000, -+ 0x03A, 0x000001B4, -+ 0x03B, 0x0002A000, -+ 0x03A, 0x000001C4, -+ 0x03B, 0x000221C8, -+ 0x03A, 0x00000188, -+ 0x03B, 0x0001A001, -+ 0x03A, 0x000000C4, -+ 0x03B, 0x0007A000, -+ 0x03A, 0x000001FC, -+ 0x03B, 0x00072000, -+ 0x03A, 0x000001B4, -+ 0x03B, 0x0006A000, -+ 0x03A, 0x000001C4, -+ 0x03B, 0x000621C8, -+ 0x03A, 0x00000188, -+ 0x03B, 0x0005A001, -+ 0x03A, 0x000000C4, -+ 0x03B, 0x000BA000, -+ 0x03A, 0x000001FC, -+ 0x03B, 0x000B2000, -+ 0x03A, 0x000001B4, -+ 0x03B, 0x000AA000, -+ 0x03A, 0x000001C4, -+ 0x03B, 0x000A21C8, -+ 0x03A, 0x00000188, -+ 0x03B, 0x0009A001, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00001100, -+ 0xFF0F02C0, 0xABCD, -+ 0x034, 0x0004A8B1, -+ 0x034, 0x000498AE, -+ 0x034, 0x000484AE, -+ 0x034, 0x000474AB, -+ 0x034, 0x0004648E, -+ 0x034, 0x0004548B, -+ 0x034, 0x0004408D, -+ 0x034, 0x0004308A, -+ 0x034, 0x00042087, -+ 0x034, 0x00041084, -+ 0x034, 0x00040081, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0004ADF7, -+ 0x034, 0x00049DF3, -+ 0x034, 0x00048DEF, -+ 0x034, 0x00047DEC, -+ 0x034, 0x00046DE9, -+ 0x034, 0x00045CCB, -+ 0x034, 0x0004488D, -+ 0x034, 0x0004348D, -+ 0x034, 0x0004248A, -+ 0x034, 0x0004108D, -+ 0x034, 0x0004008A, -+ 0xFF0F02C0, 0xDEAD, -+ 0xFF0F02C0, 0xABCD, -+ 0x034, 0x0002A8F0, -+ 0x034, 0x000298AF, -+ 0x034, 0x000284AF, -+ 0x034, 0x000274AC, -+ 0x034, 0x0002648E, -+ 0x034, 0x0002548B, -+ 0x034, 0x0002408D, -+ 0x034, 0x0002308A, -+ 0x034, 0x00022087, -+ 0x034, 0x00021084, -+ 0x034, 0x00020081, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0002ADF7, -+ 0x034, 0x00029DF2, -+ 0x034, 0x00028DEE, -+ 0x034, 0x00027DEB, -+ 0x034, 0x00026CCD, -+ 0x034, 0x00025CCA, -+ 0x034, 0x0002488C, -+ 0x034, 0x0002384C, -+ 0x034, 0x00022849, -+ 0x034, 0x00021449, -+ 0x034, 0x0002004D, -+ 0xFF0F02C0, 0xDEAD, -+ 0xFF0F02C0, 0xABCD, -+ 0x034, 0x0000A9EF, -+ 0x034, 0x000098EF, -+ 0x034, 0x000088AE, -+ 0x034, 0x000074AE, -+ 0x034, 0x000064AB, -+ 0x034, 0x0000548E, -+ 0x034, 0x0000448B, -+ 0x034, 0x0000308D, -+ 0x034, 0x0000208A, -+ 0x034, 0x00001087, -+ 0x034, 0x00000084, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x034, 0x0000ADF7, -+ 0x034, 0x00009DF4, -+ 0x034, 0x00008DF1, -+ 0x034, 0x00007DEE, -+ 0x034, 0x00006DCD, -+ 0x034, 0x00005CCD, -+ 0x034, 0x00004CCA, -+ 0x034, 0x0000388C, -+ 0x034, 0x00002888, -+ 0x034, 0x00001488, -+ 0x034, 0x00000486, -+ 0xFF0F02C0, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000040, -+ 0x035, 0x00000145, -+ 0x035, 0x00008145, -+ 0x035, 0x00010145, -+ 0x035, 0x00020196, -+ 0x035, 0x00028196, -+ 0x035, 0x00030196, -+ 0x035, 0x000401C7, -+ 0x035, 0x000481C7, -+ 0x035, 0x000501C7, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000010, -+ 0x036, 0x000056B3, -+ 0x036, 0x0000D6B3, -+ 0x036, 0x000156B3, -+ 0x036, 0x0001D6B3, -+ 0x036, 0x00026634, -+ 0x036, 0x0002E634, -+ 0x036, 0x00036634, -+ 0x036, 0x0003E634, -+ 0x036, 0x000467B4, -+ 0x036, 0x0004E7B4, -+ 0x036, 0x000567B4, -+ 0x036, 0x0005E7B4, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000008, -+ 0x03C, 0x0000022A, -+ 0x03C, 0x00000594, -+ 0xFF0F02C0, 0xABCD, -+ 0x03C, 0x00000820, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x03C, 0x00000900, -+ 0xFF0F02C0, 0xDEAD, -+ 0x0EF, 0x00000000, -+ 0x018, 0x0001712A, -+ 0x0EF, 0x00000002, -+ 0x008, 0x00002000, -+ 0x0EF, 0x00000000, -+ 0x0DF, 0x000000C0, -+ 0x01F, 0x00040064, -+ 0x058, 0x00081184, -+ 0x059, 0x0006016C, -+ 0x061, 0x000EAD53, -+ 0x062, 0x00093BC4, -+ 0x063, 0x000714E9, -+ 0x064, 0x0001C67C, -+ 0xFF0F02C0, 0xABCD, -+ 0x065, 0x00091011, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x065, 0x00091016, -+ 0xFF0F02C0, 0xDEAD, -+ 0x018, 0x00000006, -+ 0x0EF, 0x00002000, -+ 0x03B, 0x00039258, -+ 0x03B, 0x00031258, -+ 0x03B, 0x00029258, -+ 0x03B, 0x00027A58, -+ 0x03B, 0x0001FA58, -+ 0x03B, 0x00012590, -+ 0x03B, 0x00008248, -+ 0x03B, 0x00000A40, -+ 0x0EF, 0x00000000, -+ 0x0EF, 0x00000100, -+ 0x034, 0x0000ADF2, -+ 0x035, 0x00004800, -+ 0x034, 0x00009DEF, -+ 0x035, 0x00003C00, -+ 0x034, 0x00008DEC, -+ 0x035, 0x00003000, -+ 0x034, 0x00007DE9, -+ 0x035, 0x00002400, -+ 0x034, 0x00006CEC, -+ 0x035, 0x00003000, -+ 0x034, 0x00005CE9, -+ 0x035, 0x00002400, -+ 0x034, 0x000044EC, -+ 0x035, 0x00003000, -+ 0x034, 0x000034E9, -+ 0x035, 0x00002400, -+ 0x034, 0x0000246C, -+ 0x035, 0x00003000, -+ 0x034, 0x00001469, -+ 0x035, 0x00002400, -+ 0x034, 0x0000006C, -+ 0x035, 0x00003000, -+ 0x0EF, 0x00000000, -+ 0x0ED, 0x00000010, -+ 0x044, 0x0000ADF2, -+ 0x044, 0x00009DEF, -+ 0x044, 0x00008DEC, -+ 0x044, 0x00007DE9, -+ 0x044, 0x00006CEC, -+ 0x044, 0x00005CE9, -+ 0x044, 0x000044EC, -+ 0x044, 0x000034E9, -+ 0x044, 0x0000246C, -+ 0x044, 0x00001469, -+ 0x044, 0x0000006C, -+ 0x0ED, 0x00000000, -+ 0x0ED, 0x00000001, -+ 0x040, 0x00038DA7, -+ 0x040, 0x000300C2, -+ 0x040, 0x000288E2, -+ 0x040, 0x000200B8, -+ 0x040, 0x000188A5, -+ 0x040, 0x00010FBC, -+ 0x040, 0x00008F71, -+ 0x040, 0x00000240, -+ 0x0ED, 0x00000000, -+ 0x0EF, 0x000020A2, -+ 0x0DF, 0x00000080, -+ 0x035, 0x00000120, -+ 0x035, 0x00008120, -+ 0x035, 0x00010120, -+ 0x036, 0x00000085, -+ 0x036, 0x00008085, -+ 0x036, 0x00010085, -+ 0x036, 0x00018085, -+ 0x0EF, 0x00000000, -+ 0x051, 0x00000C31, -+ 0x052, 0x00000622, -+ 0x053, 0x000FC70B, -+ 0x054, 0x0000017E, -+ 0x056, 0x00051DF3, -+ 0x051, 0x00000C01, -+ 0x052, 0x000006D6, -+ 0x053, 0x000FC649, -+ 0xFF0F0104, 0xABCD, -+ 0x0DD, 0x00000060, -+ 0xCDCDCDCD, 0xCDCD, -+ 0x0DD, 0x00000040, -+ 0xFF0F0104, 0xDEAD, -+ 0x070, 0x00049661, -+ 0x071, 0x0007843E, -+ 0x072, 0x00000382, -+ 0x074, 0x00051400, -+ 0x035, 0x00000160, -+ 0x035, 0x00008160, -+ 0x035, 0x00010160, -+ 0x036, 0x00000124, -+ 0x036, 0x00008124, -+ 0x036, 0x00010124, -+ 0x036, 0x00018124, -+ 0x0ED, 0x0000000C, -+ 0x045, 0x00000140, -+ 0x045, 0x00008140, -+ 0x045, 0x00010140, -+ 0x046, 0x00000124, -+ 0x046, 0x00008124, -+ 0x046, 0x00010124, -+ 0x046, 0x00018124, -+ 0x0DF, 0x00000088, -+ 0x0B3, 0x000F0618, -+ 0x0B4, 0x00013E4C, -+ 0x0B7, 0x00030008, -+ 0x018, 0x0001F12A, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0FE, 0x00000000, -+ 0x0B3, 0x000F0E18, -+ 0x0B4, 0x0001364C, -+ -+ }; -+ -+static void -+ ODM_ReadAndConfig_TC_8821A_RadioA( -+ PDM_ODM_T pDM_Odm -+ ) -+ { -+ #define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+ -+ u4Byte hex = 0; -+ u4Byte i = 0; -+ u2Byte count = 0; -+ pu4Byte ptr_array = NULL; -+ u1Byte platform = pDM_Odm->SupportPlatform; -+ u1Byte _interface = pDM_Odm->SupportInterface; -+ u1Byte board = pDM_Odm->BoardType; -+ u4Byte ArrayLen = sizeof(Array_TC_8821A_RadioA)/sizeof(u4Byte); -+ const pu4Byte Array = Array_TC_8821A_RadioA; -+ -+ -+ hex += board; -+ hex += _interface << 8; -+ hex += platform << 16; -+ hex += 0xFF000000; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8821A_RadioA, hex = 0x%X\n", hex)); -+ -+ for (i = 0; i < ArrayLen; i += 2 ) -+ { -+ u4Byte v1 = Array[i]; -+ u4Byte v2 = Array[i+1]; -+ -+ // This (offset, data) pair meets the condition. -+ if ( v1 < 0xCDCDCDCD ) -+ { -+ odm_ConfigRF_RadioA_8821A(pDM_Odm, v1, v2); -+ continue; -+ } -+ else -+ { // This line is the start line of branch. -+ if ( !CheckCondition(Array[i], hex) ) -+ { // Discard the following (offset, data) pairs. -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ i -= 2; // prevent from for-loop += 2 -+ } -+ else // Configure matched pairs and skip to end of if-else. -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ while (v2 != 0xDEAD && -+ v2 != 0xCDEF && -+ v2 != 0xCDCD && i < ArrayLen -2) -+ { -+ odm_ConfigRF_RadioA_8821A(pDM_Odm, v1, v2); -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ while (v2 != 0xDEAD && i < ArrayLen -2) -+ { -+ READ_NEXT_PAIR(v1, v2, i); -+ } -+ -+ } -+ } -+ } -+ -+ } -+ -+ /****************************************************************************** -+ * TxPowerTrack_AP.TXT -+ ******************************************************************************/ -+ -+static const u1Byte gDeltaSwingTableIdx_TC_5GB_N__8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+ }; -+static const u1Byte gDeltaSwingTableIdx_TC_5GB_P__8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 16, 17, 17, 18, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 19, 20, 20, 20}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+ }; -+static const u1Byte gDeltaSwingTableIdx_TC_5GA_N__8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 2, 3, 3, 4, 4, 5, 5, 6, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 13, 13, 14, 15, 16, 16, 16, 16, 16, 16, 16}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 16, 16, 16, 16, 16}, -+ }; -+static const u1Byte gDeltaSwingTableIdx_TC_5GA_P__8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 5, 6, 7, 8, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 18, 19, 19, 19}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+ {0, 1, 2, 3, 3, 4, 5, 6, 6, 7, 8, 9, 9, 10, 11, 12, 12, 13, 14, 15, 15, 16, 17, 18, 18, 19, 20, 21, 21, 21}, -+ }; -+static const u1Byte gDeltaSwingTableIdx_TC_2GB_N__8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GB_P__8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GA_N__8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GA_P__8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GCCKB_N__8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GCCKB_P__8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GCCKA_N__8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GCCKA_P__8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+ -+static void -+ ODM_ReadAndConfig_TC_8821A_TxPowerTrack_AP( -+ PDM_ODM_T pDM_Odm -+ ) -+ { -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_TC_8821A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_TC_2GA_P__8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_TC_2GA_N__8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_TC_2GB_P__8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_TC_2GB_N__8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_TC_2GCCKA_P__8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_TC_2GCCKA_N__8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_TC_2GCCKB_P__8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_TC_2GCCKB_N__8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_TC_5GA_P__8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_TC_5GA_N__8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_TC_5GB_P__8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_TC_5GB_N__8821A, DELTA_SWINGIDX_SIZE*3); -+ } -+ -+ /****************************************************************************** -+ * TxPowerTrack_PCIE.TXT -+ ******************************************************************************/ -+ -+static const u1Byte gDeltaSwingTableIdx_TC_5GB_N_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 9, 10, 10, 11, 11, 12, 12, 13}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ }; -+static const u1Byte gDeltaSwingTableIdx_TC_5GB_P_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ }; -+static const u1Byte gDeltaSwingTableIdx_TC_5GA_N_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 12, 13, 13, 13}, -+ {0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 8, 9, 9, 10, 10, 11, 11, 11, 12, 12, 12, 12, 12, 13, 13}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 8, 8, 9, 10, 11, 12, 13, 14, 14, 15, 15, 15, 16, 16, 16, 17, 17, 18, 18}, -+ }; -+static const u1Byte gDeltaSwingTableIdx_TC_5GA_P_PCIE_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 4, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ }; -+static const u1Byte gDeltaSwingTableIdx_TC_2GB_N_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GB_P_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GA_N_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GA_P_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GCCKB_N_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 9, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GCCKB_P_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GCCKA_N_PCIE_8821A[] = {0, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 6, 7, 8, 8, 9, 9, 9, 10, 10, 10, 10, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GCCKA_P_PCIE_8821A[] = {0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9, 9}; -+ -+static void ODM_ReadAndConfig_TC_8821A_TxPowerTrack_PCIE(PDM_ODM_T pDM_Odm) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_TC_8821A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_TC_2GA_P_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_TC_2GA_N_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_TC_2GB_P_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_TC_2GB_N_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_TC_2GCCKA_P_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_TC_2GCCKA_N_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_TC_2GCCKB_P_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_TC_2GCCKB_N_PCIE_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_TC_5GA_P_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_TC_5GA_N_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_TC_5GB_P_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_TC_5GB_N_PCIE_8821A, DELTA_SWINGIDX_SIZE*3); -+ } -+ -+ /****************************************************************************** -+ * TxPowerTrack_USB.TXT -+ ******************************************************************************/ -+ -+static const u1Byte gDeltaSwingTableIdx_TC_5GB_N_USB_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 14, 14, 14, 14}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ }; -+static const u1Byte gDeltaSwingTableIdx_TC_5GB_P_USB_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 5, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ }; -+static const u1Byte gDeltaSwingTableIdx_TC_5GA_N_USB_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 12, 12, 13, 13, 14, 15, 15, 15, 15, 15}, -+ }; -+static const u1Byte gDeltaSwingTableIdx_TC_5GA_P_USB_8821A[][DELTA_SWINGIDX_SIZE] = { -+ {0, 1, 1, 2, 2, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ {0, 1, 1, 2, 3, 3, 4, 5, 6, 7, 7, 8, 8, 9, 10, 11, 11, 12, 12, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11, 11}, -+ }; -+static const u1Byte gDeltaSwingTableIdx_TC_2GB_N_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GB_P_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GA_N_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GA_P_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GCCKB_N_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GCCKB_P_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GCCKA_N_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 10, 10, 10, 10, 10, 10}; -+static const u1Byte gDeltaSwingTableIdx_TC_2GCCKA_P_USB_8821A[] = {0, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 6, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7}; -+ -+static void ODM_ReadAndConfig_TC_8821A_TxPowerTrack_USB(PDM_ODM_T pDM_Odm) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_MP_TC_8821A\n")); -+ -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_TC_2GA_P_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_TC_2GA_N_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_TC_2GB_P_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_TC_2GB_N_USB_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_TC_2GCCKA_P_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_TC_2GCCKA_N_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_TC_2GCCKB_P_USB_8821A, DELTA_SWINGIDX_SIZE); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_TC_2GCCKB_N_USB_8821A, DELTA_SWINGIDX_SIZE); -+ -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_TC_5GA_P_USB_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_TC_5GA_N_USB_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_TC_5GB_P_USB_8821A, DELTA_SWINGIDX_SIZE*3); -+ ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_TC_5GB_N_USB_8821A, DELTA_SWINGIDX_SIZE*3); -+} -+ -+ /****************************************************************************** -+ * TXPWR_LMT.TXT -+ ******************************************************************************/ -+ -+static pu1Byte Array_TC_8821A_TXPWR_LMT[] = { -+ "FCC", "2.4G", "20M", "CCK", "1T", "01", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "11", "34", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "CCK", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "CCK", "1T", "14", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "1T", "01", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "02", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "03", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "04", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "05", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "06", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "07", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "08", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "09", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "10", "34", -+ "ETSI", "2.4G", "20M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "11", "32", -+ "ETSI", "2.4G", "20M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "20M", "HT", "2T", "01", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "01", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "01", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "02", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "02", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "02", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "03", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "03", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "03", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "04", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "04", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "05", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "05", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "06", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "06", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "07", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "07", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "08", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "08", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "09", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "09", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "20M", "HT", "2T", "10", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "10", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "20M", "HT", "2T", "11", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "11", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "20M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "20M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "20M", "HT", "2T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "1T", "03", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "03", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "03", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "04", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "04", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "04", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "05", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "05", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "05", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "06", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "06", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "06", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "07", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "07", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "07", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "08", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "08", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "08", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "09", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "09", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "09", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "10", "34", -+ "ETSI", "2.4G", "40M", "HT", "1T", "10", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "10", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "11", "32", -+ "ETSI", "2.4G", "40M", "HT", "1T", "11", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "11", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "1T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "1T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "1T", "14", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "01", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "01", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "02", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "02", "63", -+ "FCC", "2.4G", "40M", "HT", "2T", "03", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "03", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "03", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "04", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "04", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "04", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "05", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "05", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "05", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "06", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "06", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "06", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "07", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "07", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "07", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "08", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "08", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "08", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "09", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "09", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "09", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "10", "32", -+ "ETSI", "2.4G", "40M", "HT", "2T", "10", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "10", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "11", "30", -+ "ETSI", "2.4G", "40M", "HT", "2T", "11", "30", -+ "MKK", "2.4G", "40M", "HT", "2T", "11", "30", -+ "FCC", "2.4G", "40M", "HT", "2T", "12", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "12", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "12", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "13", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "13", "32", -+ "MKK", "2.4G", "40M", "HT", "2T", "13", "32", -+ "FCC", "2.4G", "40M", "HT", "2T", "14", "63", -+ "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", -+ "MKK", "2.4G", "40M", "HT", "2T", "14", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "36", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "36", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "40", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "40", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "44", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "44", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "48", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "48", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "52", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "52", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "56", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "56", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "60", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "60", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "64", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "64", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "100", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "100", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "114", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "114", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "108", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "108", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "112", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "112", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "116", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "116", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "120", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "120", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "124", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "124", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "128", "32", -+ "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "128", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "132", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "132", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "136", "30", -+ "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "136", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "140", "28", -+ "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "140", "32", -+ "FCC", "5G", "20M", "OFDM", "1T", "149", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "149", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "153", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "153", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "157", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "157", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "161", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "161", "63", -+ "FCC", "5G", "20M", "OFDM", "1T", "165", "34", -+ "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", -+ "MKK", "5G", "20M", "OFDM", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "1T", "36", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "36", "32", -+ "MKK", "5G", "20M", "HT", "1T", "36", "32", -+ "FCC", "5G", "20M", "HT", "1T", "40", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "40", "32", -+ "MKK", "5G", "20M", "HT", "1T", "40", "32", -+ "FCC", "5G", "20M", "HT", "1T", "44", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "44", "32", -+ "MKK", "5G", "20M", "HT", "1T", "44", "32", -+ "FCC", "5G", "20M", "HT", "1T", "48", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "48", "32", -+ "MKK", "5G", "20M", "HT", "1T", "48", "32", -+ "FCC", "5G", "20M", "HT", "1T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "52", "32", -+ "MKK", "5G", "20M", "HT", "1T", "52", "32", -+ "FCC", "5G", "20M", "HT", "1T", "56", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "56", "32", -+ "MKK", "5G", "20M", "HT", "1T", "56", "32", -+ "FCC", "5G", "20M", "HT", "1T", "60", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "60", "32", -+ "MKK", "5G", "20M", "HT", "1T", "60", "32", -+ "FCC", "5G", "20M", "HT", "1T", "64", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "64", "32", -+ "MKK", "5G", "20M", "HT", "1T", "64", "32", -+ "FCC", "5G", "20M", "HT", "1T", "100", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "100", "32", -+ "MKK", "5G", "20M", "HT", "1T", "100", "32", -+ "FCC", "5G", "20M", "HT", "1T", "114", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "114", "32", -+ "MKK", "5G", "20M", "HT", "1T", "114", "32", -+ "FCC", "5G", "20M", "HT", "1T", "108", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "108", "32", -+ "MKK", "5G", "20M", "HT", "1T", "108", "32", -+ "FCC", "5G", "20M", "HT", "1T", "112", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "112", "32", -+ "MKK", "5G", "20M", "HT", "1T", "112", "32", -+ "FCC", "5G", "20M", "HT", "1T", "116", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "116", "32", -+ "MKK", "5G", "20M", "HT", "1T", "116", "32", -+ "FCC", "5G", "20M", "HT", "1T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "120", "32", -+ "MKK", "5G", "20M", "HT", "1T", "120", "32", -+ "FCC", "5G", "20M", "HT", "1T", "124", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "124", "32", -+ "MKK", "5G", "20M", "HT", "1T", "124", "32", -+ "FCC", "5G", "20M", "HT", "1T", "128", "32", -+ "ETSI", "5G", "20M", "HT", "1T", "128", "32", -+ "MKK", "5G", "20M", "HT", "1T", "128", "32", -+ "FCC", "5G", "20M", "HT", "1T", "132", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "132", "32", -+ "MKK", "5G", "20M", "HT", "1T", "132", "32", -+ "FCC", "5G", "20M", "HT", "1T", "136", "30", -+ "ETSI", "5G", "20M", "HT", "1T", "136", "32", -+ "MKK", "5G", "20M", "HT", "1T", "136", "32", -+ "FCC", "5G", "20M", "HT", "1T", "140", "28", -+ "ETSI", "5G", "20M", "HT", "1T", "140", "32", -+ "MKK", "5G", "20M", "HT", "1T", "140", "32", -+ "FCC", "5G", "20M", "HT", "1T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "149", "32", -+ "MKK", "5G", "20M", "HT", "1T", "149", "63", -+ "FCC", "5G", "20M", "HT", "1T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "153", "32", -+ "MKK", "5G", "20M", "HT", "1T", "153", "63", -+ "FCC", "5G", "20M", "HT", "1T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "157", "32", -+ "MKK", "5G", "20M", "HT", "1T", "157", "63", -+ "FCC", "5G", "20M", "HT", "1T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "161", "32", -+ "MKK", "5G", "20M", "HT", "1T", "161", "63", -+ "FCC", "5G", "20M", "HT", "1T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "1T", "165", "32", -+ "MKK", "5G", "20M", "HT", "1T", "165", "63", -+ "FCC", "5G", "20M", "HT", "2T", "36", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "36", "30", -+ "MKK", "5G", "20M", "HT", "2T", "36", "30", -+ "FCC", "5G", "20M", "HT", "2T", "40", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "40", "30", -+ "MKK", "5G", "20M", "HT", "2T", "40", "30", -+ "FCC", "5G", "20M", "HT", "2T", "44", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "44", "30", -+ "MKK", "5G", "20M", "HT", "2T", "44", "30", -+ "FCC", "5G", "20M", "HT", "2T", "48", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "48", "30", -+ "MKK", "5G", "20M", "HT", "2T", "48", "30", -+ "FCC", "5G", "20M", "HT", "2T", "52", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "52", "30", -+ "MKK", "5G", "20M", "HT", "2T", "52", "30", -+ "FCC", "5G", "20M", "HT", "2T", "56", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "56", "30", -+ "MKK", "5G", "20M", "HT", "2T", "56", "30", -+ "FCC", "5G", "20M", "HT", "2T", "60", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "60", "30", -+ "MKK", "5G", "20M", "HT", "2T", "60", "30", -+ "FCC", "5G", "20M", "HT", "2T", "64", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "64", "30", -+ "MKK", "5G", "20M", "HT", "2T", "64", "30", -+ "FCC", "5G", "20M", "HT", "2T", "100", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "100", "30", -+ "MKK", "5G", "20M", "HT", "2T", "100", "30", -+ "FCC", "5G", "20M", "HT", "2T", "114", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "114", "30", -+ "MKK", "5G", "20M", "HT", "2T", "114", "30", -+ "FCC", "5G", "20M", "HT", "2T", "108", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "108", "30", -+ "MKK", "5G", "20M", "HT", "2T", "108", "30", -+ "FCC", "5G", "20M", "HT", "2T", "112", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "112", "30", -+ "MKK", "5G", "20M", "HT", "2T", "112", "30", -+ "FCC", "5G", "20M", "HT", "2T", "116", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "116", "30", -+ "MKK", "5G", "20M", "HT", "2T", "116", "30", -+ "FCC", "5G", "20M", "HT", "2T", "120", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "120", "30", -+ "MKK", "5G", "20M", "HT", "2T", "120", "30", -+ "FCC", "5G", "20M", "HT", "2T", "124", "32", -+ "ETSI", "5G", "20M", "HT", "2T", "124", "30", -+ "MKK", "5G", "20M", "HT", "2T", "124", "30", -+ "FCC", "5G", "20M", "HT", "2T", "128", "30", -+ "ETSI", "5G", "20M", "HT", "2T", "128", "30", -+ "MKK", "5G", "20M", "HT", "2T", "128", "30", -+ "FCC", "5G", "20M", "HT", "2T", "132", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "132", "30", -+ "MKK", "5G", "20M", "HT", "2T", "132", "30", -+ "FCC", "5G", "20M", "HT", "2T", "136", "28", -+ "ETSI", "5G", "20M", "HT", "2T", "136", "30", -+ "MKK", "5G", "20M", "HT", "2T", "136", "30", -+ "FCC", "5G", "20M", "HT", "2T", "140", "26", -+ "ETSI", "5G", "20M", "HT", "2T", "140", "30", -+ "MKK", "5G", "20M", "HT", "2T", "140", "30", -+ "FCC", "5G", "20M", "HT", "2T", "149", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "149", "30", -+ "MKK", "5G", "20M", "HT", "2T", "149", "63", -+ "FCC", "5G", "20M", "HT", "2T", "153", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "153", "30", -+ "MKK", "5G", "20M", "HT", "2T", "153", "63", -+ "FCC", "5G", "20M", "HT", "2T", "157", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "157", "30", -+ "MKK", "5G", "20M", "HT", "2T", "157", "63", -+ "FCC", "5G", "20M", "HT", "2T", "161", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "161", "30", -+ "MKK", "5G", "20M", "HT", "2T", "161", "63", -+ "FCC", "5G", "20M", "HT", "2T", "165", "34", -+ "ETSI", "5G", "20M", "HT", "2T", "165", "30", -+ "MKK", "5G", "20M", "HT", "2T", "165", "63", -+ "FCC", "5G", "40M", "HT", "1T", "38", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "38", "32", -+ "MKK", "5G", "40M", "HT", "1T", "38", "32", -+ "FCC", "5G", "40M", "HT", "1T", "46", "30", -+ "ETSI", "5G", "40M", "HT", "1T", "46", "32", -+ "MKK", "5G", "40M", "HT", "1T", "46", "32", -+ "FCC", "5G", "40M", "HT", "1T", "54", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "54", "32", -+ "MKK", "5G", "40M", "HT", "1T", "54", "32", -+ "FCC", "5G", "40M", "HT", "1T", "62", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "62", "32", -+ "MKK", "5G", "40M", "HT", "1T", "62", "32", -+ "FCC", "5G", "40M", "HT", "1T", "102", "28", -+ "ETSI", "5G", "40M", "HT", "1T", "102", "32", -+ "MKK", "5G", "40M", "HT", "1T", "102", "32", -+ "FCC", "5G", "40M", "HT", "1T", "110", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "110", "32", -+ "MKK", "5G", "40M", "HT", "1T", "110", "32", -+ "FCC", "5G", "40M", "HT", "1T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "118", "32", -+ "MKK", "5G", "40M", "HT", "1T", "118", "32", -+ "FCC", "5G", "40M", "HT", "1T", "126", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "126", "32", -+ "MKK", "5G", "40M", "HT", "1T", "126", "32", -+ "FCC", "5G", "40M", "HT", "1T", "134", "32", -+ "ETSI", "5G", "40M", "HT", "1T", "134", "32", -+ "MKK", "5G", "40M", "HT", "1T", "134", "32", -+ "FCC", "5G", "40M", "HT", "1T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "151", "32", -+ "MKK", "5G", "40M", "HT", "1T", "151", "63", -+ "FCC", "5G", "40M", "HT", "1T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "1T", "159", "32", -+ "MKK", "5G", "40M", "HT", "1T", "159", "63", -+ "FCC", "5G", "40M", "HT", "2T", "38", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "38", "30", -+ "MKK", "5G", "40M", "HT", "2T", "38", "30", -+ "FCC", "5G", "40M", "HT", "2T", "46", "28", -+ "ETSI", "5G", "40M", "HT", "2T", "46", "30", -+ "MKK", "5G", "40M", "HT", "2T", "46", "30", -+ "FCC", "5G", "40M", "HT", "2T", "54", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "54", "30", -+ "MKK", "5G", "40M", "HT", "2T", "54", "30", -+ "FCC", "5G", "40M", "HT", "2T", "62", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "62", "30", -+ "MKK", "5G", "40M", "HT", "2T", "62", "30", -+ "FCC", "5G", "40M", "HT", "2T", "102", "26", -+ "ETSI", "5G", "40M", "HT", "2T", "102", "30", -+ "MKK", "5G", "40M", "HT", "2T", "102", "30", -+ "FCC", "5G", "40M", "HT", "2T", "110", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "110", "30", -+ "MKK", "5G", "40M", "HT", "2T", "110", "30", -+ "FCC", "5G", "40M", "HT", "2T", "118", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "118", "30", -+ "MKK", "5G", "40M", "HT", "2T", "118", "30", -+ "FCC", "5G", "40M", "HT", "2T", "126", "32", -+ "ETSI", "5G", "40M", "HT", "2T", "126", "30", -+ "MKK", "5G", "40M", "HT", "2T", "126", "30", -+ "FCC", "5G", "40M", "HT", "2T", "134", "30", -+ "ETSI", "5G", "40M", "HT", "2T", "134", "30", -+ "MKK", "5G", "40M", "HT", "2T", "134", "30", -+ "FCC", "5G", "40M", "HT", "2T", "151", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "151", "30", -+ "MKK", "5G", "40M", "HT", "2T", "151", "63", -+ "FCC", "5G", "40M", "HT", "2T", "159", "34", -+ "ETSI", "5G", "40M", "HT", "2T", "159", "30", -+ "MKK", "5G", "40M", "HT", "2T", "159", "63", -+ "FCC", "5G", "80M", "VHT", "1T", "42", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "42", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "42", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "58", "28", -+ "ETSI", "5G", "80M", "VHT", "1T", "58", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "58", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "106", "30", -+ "ETSI", "5G", "80M", "VHT", "1T", "106", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "106", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "122", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "122", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "122", "32", -+ "FCC", "5G", "80M", "VHT", "1T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "1T", "155", "32", -+ "MKK", "5G", "80M", "VHT", "1T", "155", "63", -+ "FCC", "5G", "80M", "VHT", "2T", "42", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "42", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "42", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "58", "26", -+ "ETSI", "5G", "80M", "VHT", "2T", "58", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "58", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "106", "28", -+ "ETSI", "5G", "80M", "VHT", "2T", "106", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "106", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "122", "32", -+ "ETSI", "5G", "80M", "VHT", "2T", "122", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "122", "30", -+ "FCC", "5G", "80M", "VHT", "2T", "155", "34", -+ "ETSI", "5G", "80M", "VHT", "2T", "155", "30", -+ "MKK", "5G", "80M", "VHT", "2T", "155", "63" -+ }; -+ -+static void ODM_ReadAndConfig_TC_8821A_TXPWR_LMT(PDM_ODM_T pDM_Odm) -+{ -+ u4Byte i = 0; -+ u4Byte ArrayLen = sizeof(Array_TC_8821A_TXPWR_LMT)/sizeof(pu1Byte); -+ pu1Byte *Array = Array_TC_8821A_TXPWR_LMT; -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ReadAndConfig_TC_8821A_TXPWR_LMT\n")); -+ -+ for (i = 0; i < ArrayLen; i += 7 ) -+ { -+ pu1Byte regulation = Array[i]; -+ pu1Byte band = Array[i+1]; -+ pu1Byte bandwidth = Array[i+2]; -+ pu1Byte rate = Array[i+3]; -+ pu1Byte rfPath = Array[i+4]; -+ pu1Byte chnl = Array[i+5]; -+ pu1Byte val = Array[i+6]; -+ -+ odm_ConfigBB_TXPWR_LMT_8821A(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -+ } -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalHWImg8821A_TestChip_RF.h 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,66 @@ -+/****************************************************************************** -+* -+* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+* -+* This program is free software; you can redistribute it and/or modify it -+* under the terms of version 2 of the GNU General Public License as -+* published by the Free Software Foundation. -+* -+* This program is distributed in the hope that it will be useful, but WITHOUT -+* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+* more details. -+* -+******************************************************************************/ -+ -+#ifndef __INC_TC_RF_HW_IMG_8821A_H -+#define __INC_TC_RF_HW_IMG_8821A_H -+ -+static bool CheckCondition(const u4Byte Condition, const u4Byte Hex); -+ -+/****************************************************************************** -+* RadioA.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8821A_RadioA( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_AP.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8821A_TxPowerTrack_AP( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_PCIE.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8821A_TxPowerTrack_PCIE( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TxPowerTrack_USB.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8821A_TxPowerTrack_USB( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+/****************************************************************************** -+* TXPWR_LMT.TXT -+******************************************************************************/ -+ -+void -+ODM_ReadAndConfig_TC_8821A_TXPWR_LMT( // TC: Test Chip, MP: MP Chip -+ IN PDM_ODM_T pDM_Odm -+); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/hal_intf.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_intf.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/hal_intf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_intf.c 2018-02-06 17:42:30.709967150 +0200 -@@ -0,0 +1,530 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#define _HAL_INTF_C_ -+ -+#include -+ -+ -+void rtw_hal_chip_configure(_adapter *padapter) -+{ -+ if(padapter->HalFunc.intf_chip_configure) -+ padapter->HalFunc.intf_chip_configure(padapter); -+} -+ -+void rtw_hal_read_chip_info(_adapter *padapter) -+{ -+ if(padapter->HalFunc.read_adapter_info) -+ padapter->HalFunc.read_adapter_info(padapter); -+} -+ -+void rtw_hal_read_chip_version(_adapter *padapter) -+{ -+ if(padapter->HalFunc.read_chip_version) -+ padapter->HalFunc.read_chip_version(padapter); -+} -+ -+void rtw_hal_def_value_init(_adapter *padapter) -+{ -+ if(padapter->HalFunc.init_default_value) -+ padapter->HalFunc.init_default_value(padapter); -+} -+void rtw_hal_free_data(_adapter *padapter) -+{ -+ if(padapter->HalFunc.free_hal_data) -+ padapter->HalFunc.free_hal_data(padapter); -+} -+void rtw_hal_dm_init(_adapter *padapter) -+{ -+ if(padapter->HalFunc.dm_init) -+ padapter->HalFunc.dm_init(padapter); -+} -+void rtw_hal_dm_deinit(_adapter *padapter) -+{ -+ // cancel dm timer -+ if(padapter->HalFunc.dm_deinit) -+ padapter->HalFunc.dm_deinit(padapter); -+} -+void rtw_hal_sw_led_init(_adapter *padapter) -+{ -+ if(padapter->HalFunc.InitSwLeds) -+ padapter->HalFunc.InitSwLeds(padapter); -+} -+ -+void rtw_hal_sw_led_deinit(_adapter *padapter) -+{ -+ if(padapter->HalFunc.DeInitSwLeds) -+ padapter->HalFunc.DeInitSwLeds(padapter); -+} -+ -+u32 rtw_hal_power_on(_adapter *padapter) -+{ -+ if(padapter->HalFunc.hal_power_on) -+ return padapter->HalFunc.hal_power_on(padapter); -+ return _FAIL; -+} -+ -+ -+uint rtw_hal_init(_adapter *padapter) -+{ -+ uint status = _SUCCESS; -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ if(padapter->hw_init_completed == true) -+ { -+ DBG_871X("rtw_hal_init: hw_init_completed == true\n"); -+ return status; -+ } -+ -+ // before init mac0, driver must init mac1 first to avoid usb rx error. -+ if((padapter->pbuddy_adapter != NULL) && (padapter->DualMacConcurrent == true) -+ && (padapter->adapter_type == PRIMARY_ADAPTER)) -+ { -+ if(padapter->pbuddy_adapter->hw_init_completed == true) -+ { -+ DBG_871X("rtw_hal_init: pbuddy_adapter hw_init_completed == true\n"); -+ } -+ else -+ { -+ status = padapter->HalFunc.hal_init(padapter->pbuddy_adapter); -+ if(status == _SUCCESS){ -+ padapter->pbuddy_adapter->hw_init_completed = true; -+ } -+ else{ -+ padapter->pbuddy_adapter->hw_init_completed = false; -+ RT_TRACE(_module_hal_init_c_,_drv_err_,("rtw_hal_init: hal__init fail(pbuddy_adapter)\n")); -+ DBG_871X("rtw_hal_init: hal__init fail(pbuddy_adapter)\n"); -+ return status; -+ } -+ } -+ } -+#endif -+ -+ padapter->hw_init_completed=false; -+ -+ status = padapter->HalFunc.hal_init(padapter); -+ -+ if(status == _SUCCESS){ -+ padapter->hw_init_completed = true; -+ -+ if (padapter->registrypriv.notch_filter == 1) -+ rtw_hal_notch_filter(padapter, 1); -+ -+ rtw_hal_reset_security_engine(padapter); -+ -+ rtw_led_control(padapter, LED_CTL_POWER_ON); -+ } -+ else{ -+ padapter->hw_init_completed = false; -+ DBG_871X("rtw_hal_init: hal__init fail\n"); -+ } -+ -+ RT_TRACE(_module_hal_init_c_,_drv_err_,("-rtl871x_hal_init:status=0x%x\n",status)); -+ -+ return status; -+ -+} -+ -+uint rtw_hal_deinit(_adapter *padapter) -+{ -+ uint status = _SUCCESS; -+ -+ -+ -+ status = padapter->HalFunc.hal_deinit(padapter); -+ -+ if(status == _SUCCESS){ -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ padapter->hw_init_completed = false; -+ } -+ else -+ { -+ DBG_871X("\n rtw_hal_deinit: hal_init fail\n"); -+ } -+ -+ -+ -+ return status; -+} -+ -+void rtw_hal_set_hwreg(_adapter *padapter, u8 variable, u8 *val) -+{ -+ if (padapter->HalFunc.SetHwRegHandler) -+ padapter->HalFunc.SetHwRegHandler(padapter, variable, val); -+} -+ -+void rtw_hal_get_hwreg(_adapter *padapter, u8 variable, u8 *val) -+{ -+ if (padapter->HalFunc.GetHwRegHandler) -+ padapter->HalFunc.GetHwRegHandler(padapter, variable, val); -+} -+ -+u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void * pValue) -+{ -+ if(padapter->HalFunc.SetHalDefVarHandler) -+ return padapter->HalFunc.SetHalDefVarHandler(padapter,eVariable,pValue); -+ return _FAIL; -+} -+u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void * pValue) -+{ -+ if(padapter->HalFunc.GetHalDefVarHandler) -+ return padapter->HalFunc.GetHalDefVarHandler(padapter,eVariable,pValue); -+ return _FAIL; -+} -+ -+void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void * pValue1,bool bSet) -+{ -+ if(padapter->HalFunc.SetHalODMVarHandler) -+ padapter->HalFunc.SetHalODMVarHandler(padapter,eVariable,pValue1,bSet); -+} -+void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void * pValue1,bool bSet) -+{ -+ if(padapter->HalFunc.GetHalODMVarHandler) -+ padapter->HalFunc.GetHalODMVarHandler(padapter,eVariable,pValue1,bSet); -+} -+ -+void rtw_hal_enable_interrupt(_adapter *padapter) -+{ -+ if (padapter->HalFunc.enable_interrupt) -+ padapter->HalFunc.enable_interrupt(padapter); -+ else -+ DBG_871X("%s: HalFunc.enable_interrupt is NULL!\n", __FUNCTION__); -+ -+} -+void rtw_hal_disable_interrupt(_adapter *padapter) -+{ -+ if (padapter->HalFunc.disable_interrupt) -+ padapter->HalFunc.disable_interrupt(padapter); -+ else -+ DBG_871X("%s: HalFunc.disable_interrupt is NULL!\n", __FUNCTION__); -+ -+} -+ -+ -+u32 rtw_hal_inirp_init(_adapter *padapter) -+{ -+ u32 rst = _FAIL; -+ if(padapter->HalFunc.inirp_init) -+ rst = padapter->HalFunc.inirp_init(padapter); -+ else -+ DBG_871X(" %s HalFunc.inirp_init is NULL!!!\n",__FUNCTION__); -+ return rst; -+} -+ -+u32 rtw_hal_inirp_deinit(_adapter *padapter) -+{ -+ -+ if(padapter->HalFunc.inirp_deinit) -+ return padapter->HalFunc.inirp_deinit(padapter); -+ -+ return _FAIL; -+ -+} -+ -+u8 rtw_hal_intf_ps_func(_adapter *padapter,HAL_INTF_PS_FUNC efunc_id, u8* val) -+{ -+ if(padapter->HalFunc.interface_ps_func) -+ return padapter->HalFunc.interface_ps_func(padapter,efunc_id,val); -+ return _FAIL; -+} -+ -+s32 rtw_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ if(padapter->HalFunc.hal_xmitframe_enqueue) -+ return padapter->HalFunc.hal_xmitframe_enqueue(padapter, pxmitframe); -+ -+ return false; -+} -+ -+s32 rtw_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ if(padapter->HalFunc.hal_xmit) -+ return padapter->HalFunc.hal_xmit(padapter, pxmitframe); -+ -+ return false; -+} -+ -+s32 rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ s32 ret = _FAIL; -+ -+ update_mgntframe_attrib_addr(padapter, pmgntframe); -+ -+ if(padapter->HalFunc.mgnt_xmit) -+ ret = padapter->HalFunc.mgnt_xmit(padapter, pmgntframe); -+ return ret; -+} -+ -+s32 rtw_hal_init_xmit_priv(_adapter *padapter) -+{ -+ if(padapter->HalFunc.init_xmit_priv != NULL) -+ return padapter->HalFunc.init_xmit_priv(padapter); -+ return _FAIL; -+} -+void rtw_hal_free_xmit_priv(_adapter *padapter) -+{ -+ if(padapter->HalFunc.free_xmit_priv != NULL) -+ padapter->HalFunc.free_xmit_priv(padapter); -+} -+ -+s32 rtw_hal_init_recv_priv(_adapter *padapter) -+{ -+ if(padapter->HalFunc.init_recv_priv) -+ return padapter->HalFunc.init_recv_priv(padapter); -+ -+ return _FAIL; -+} -+void rtw_hal_free_recv_priv(_adapter *padapter) -+{ -+ -+ if(padapter->HalFunc.free_recv_priv) -+ padapter->HalFunc.free_recv_priv(padapter); -+} -+ -+void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level) -+{ -+ _adapter *padapter; -+ struct mlme_priv *pmlmepriv; -+ -+ if(!psta) -+ return; -+ -+ padapter = psta->padapter; -+ -+ pmlmepriv = &(padapter->mlmepriv); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ add_RATid(padapter, psta, rssi_level); -+ } -+ else -+ { -+ if(padapter->HalFunc.UpdateRAMaskHandler) -+ padapter->HalFunc.UpdateRAMaskHandler(padapter, psta->mac_id, rssi_level); -+ } -+} -+ -+void rtw_hal_add_ra_tid(_adapter *padapter, u32 bitmap, u8* arg, u8 rssi_level) -+{ -+ if(padapter->HalFunc.Add_RateATid) -+ padapter->HalFunc.Add_RateATid(padapter, bitmap, arg, rssi_level); -+} -+#ifdef CONFIG_CONCURRENT_MODE -+void rtw_hal_clone_data(_adapter *dst_padapter, _adapter *src_padapter) -+{ -+ if(dst_padapter->HalFunc.clone_haldata) -+ dst_padapter->HalFunc.clone_haldata(dst_padapter, src_padapter); -+} -+#endif -+/* Start specifical interface thread */ -+void rtw_hal_start_thread(_adapter *padapter) -+{ -+ if(padapter->HalFunc.run_thread) -+ padapter->HalFunc.run_thread(padapter); -+} -+/* Start specifical interface thread */ -+void rtw_hal_stop_thread(_adapter *padapter) -+{ -+ if(padapter->HalFunc.cancel_thread) -+ padapter->HalFunc.cancel_thread(padapter); -+} -+ -+u32 rtw_hal_read_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask) -+{ -+ u32 data = 0; -+ if(padapter->HalFunc.read_bbreg) -+ data = padapter->HalFunc.read_bbreg(padapter, RegAddr, BitMask); -+ return data; -+} -+void rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ if(padapter->HalFunc.write_bbreg) -+ padapter->HalFunc.write_bbreg(padapter, RegAddr, BitMask, Data); -+} -+ -+u32 rtw_hal_read_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask) -+{ -+ u32 data = 0; -+ if( padapter->HalFunc.read_rfreg) -+ data = padapter->HalFunc.read_rfreg(padapter, eRFPath, RegAddr, BitMask); -+ return data; -+} -+void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) -+{ -+ if(padapter->HalFunc.write_rfreg) -+ padapter->HalFunc.write_rfreg(padapter, eRFPath, RegAddr, BitMask, Data); -+} -+ -+s32 rtw_hal_interrupt_handler(_adapter *padapter) -+{ -+ if(padapter->HalFunc.interrupt_handler) -+ return padapter->HalFunc.interrupt_handler(padapter); -+ return _FAIL; -+} -+ -+void rtw_hal_set_bwmode(_adapter *padapter, CHANNEL_WIDTH Bandwidth, u8 Offset) -+{ -+ if(padapter->HalFunc.set_bwmode_handler) -+ padapter->HalFunc.set_bwmode_handler(padapter, Bandwidth, Offset); -+} -+ -+void rtw_hal_set_chan(_adapter *padapter, u8 channel) -+{ -+ if(padapter->HalFunc.set_channel_handler) -+ padapter->HalFunc.set_channel_handler(padapter, channel); -+} -+ -+void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80) -+{ -+ if(padapter->HalFunc.set_chnl_bw_handler) -+ padapter->HalFunc.set_chnl_bw_handler(padapter, channel, Bandwidth, Offset40, Offset80); -+} -+ -+void rtw_hal_dm_watchdog(_adapter *padapter) -+{ -+#if defined(CONFIG_CONCURRENT_MODE) -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ if(padapter->HalFunc.hal_dm_watchdog) -+ padapter->HalFunc.hal_dm_watchdog(padapter); -+} -+ -+void rtw_hal_bcn_related_reg_setting(_adapter *padapter) -+{ -+ if(padapter->HalFunc.SetBeaconRelatedRegistersHandler) -+ padapter->HalFunc.SetBeaconRelatedRegistersHandler(padapter); -+} -+ -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+u8 rtw_hal_antdiv_before_linked(_adapter *padapter) -+{ -+ if(padapter->HalFunc.AntDivBeforeLinkHandler) -+ return padapter->HalFunc.AntDivBeforeLinkHandler(padapter); -+ return false; -+} -+void rtw_hal_antdiv_rssi_compared(_adapter *padapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src) -+{ -+ if(padapter->HalFunc.AntDivCompareHandler) -+ padapter->HalFunc.AntDivCompareHandler(padapter, dst, src); -+} -+#endif -+ -+#ifdef CONFIG_HOSTAPD_MLME -+s32 rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt) -+{ -+ if(padapter->HalFunc.hostap_mgnt_xmit_entry) -+ return padapter->HalFunc.hostap_mgnt_xmit_entry(padapter, pkt); -+ return _FAIL; -+} -+#endif //CONFIG_HOSTAPD_MLME -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+void rtw_hal_sreset_init(_adapter *padapter) -+{ -+ if(padapter->HalFunc.sreset_init_value) -+ padapter->HalFunc.sreset_init_value(padapter); -+} -+void rtw_hal_sreset_reset(_adapter *padapter) -+{ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ -+ if(padapter->HalFunc.silentreset) -+ padapter->HalFunc.silentreset(padapter); -+} -+ -+void rtw_hal_sreset_reset_value(_adapter *padapter) -+{ -+ if(padapter->HalFunc.sreset_reset_value) -+ padapter->HalFunc.sreset_reset_value(padapter); -+} -+ -+void rtw_hal_sreset_xmit_status_check(_adapter *padapter) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ if(padapter->HalFunc.sreset_xmit_status_check) -+ padapter->HalFunc.sreset_xmit_status_check(padapter); -+} -+void rtw_hal_sreset_linked_status_check(_adapter *padapter) -+{ -+ if(padapter->HalFunc.sreset_linked_status_check) -+ padapter->HalFunc.sreset_linked_status_check(padapter); -+} -+u8 rtw_hal_sreset_get_wifi_status(_adapter *padapter) -+{ -+ u8 status = 0; -+ if(padapter->HalFunc.sreset_get_wifi_status) -+ status = padapter->HalFunc.sreset_get_wifi_status(padapter); -+ return status; -+} -+ -+bool rtw_hal_sreset_inprogress(_adapter *padapter) -+{ -+ bool inprogress = false; -+ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ -+ if(padapter->HalFunc.sreset_inprogress) -+ inprogress = padapter->HalFunc.sreset_inprogress(padapter); -+ return inprogress; -+} -+#endif //DBG_CONFIG_ERROR_DETECT -+ -+#ifdef CONFIG_IOL -+int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt) -+{ -+ if(adapter->HalFunc.IOL_exec_cmds_sync) -+ return adapter->HalFunc.IOL_exec_cmds_sync(adapter, xmit_frame, max_wating_ms,bndy_cnt); -+ return _FAIL; -+} -+#endif -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+s32 rtw_hal_xmit_thread_handler(_adapter *padapter) -+{ -+ if(padapter->HalFunc.xmit_thread_handler) -+ return padapter->HalFunc.xmit_thread_handler(padapter); -+ return _FAIL; -+} -+#endif -+ -+void rtw_hal_notch_filter(_adapter *adapter, bool enable) -+{ -+ if(adapter->HalFunc.hal_notch_filter) -+ adapter->HalFunc.hal_notch_filter(adapter,enable); -+} -+ -+void rtw_hal_reset_security_engine(_adapter * adapter) -+{ -+ if(adapter->HalFunc.hal_reset_security_engine) -+ adapter->HalFunc.hal_reset_security_engine(adapter); -+} -+ -+s32 rtw_hal_c2h_handler(_adapter *adapter, struct c2h_evt_hdr *c2h_evt) -+{ -+ s32 ret = _FAIL; -+ if (adapter->HalFunc.c2h_handler) -+ ret = adapter->HalFunc.c2h_handler(adapter, c2h_evt); -+ return ret; -+} -+ -+c2h_id_filter rtw_hal_c2h_id_filter_ccx(_adapter *adapter) -+{ -+ return adapter->HalFunc.c2h_id_filter_ccx; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/hal_phy.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_phy.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/hal_phy.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_phy.c 2018-02-06 17:42:30.709967150 +0200 -@@ -0,0 +1,278 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _HAL_PHY_C_ -+ -+#include -+ -+//================================================================================ -+// Constant. -+//================================================================================ -+// 2008/11/20 MH For Debug only, RF -+static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG]; -+ -+/** -+* Function: PHY_CalculateBitShift -+* -+* OverView: Get shifted position of the BitMask -+* -+* Input: -+* u4Byte BitMask, -+* -+* Output: none -+* Return: u4Byte Return the shift bit bit position of the mask -+*/ -+u32 -+PHY_CalculateBitShift( -+ u32 BitMask -+ ) -+{ -+ u32 i; -+ -+ for(i=0; i<=31; i++) -+ { -+ if ( ((BitMask>>i) & 0x1 ) == 1) -+ break; -+ } -+ -+ return (i); -+} -+ -+ -+// -+// ==> RF shadow Operation API Code Section!!! -+// -+/*----------------------------------------------------------------------------- -+ * Function: PHY_RFShadowRead -+ * PHY_RFShadowWrite -+ * PHY_RFShadowCompare -+ * PHY_RFShadowRecorver -+ * PHY_RFShadowCompareAll -+ * PHY_RFShadowRecorverAll -+ * PHY_RFShadowCompareFlagSet -+ * PHY_RFShadowRecorverFlagSet -+ * -+ * Overview: When we set RF register, we must write shadow at first. -+ * When we are running, we must compare shadow abd locate error addr. -+ * Decide to recorver or not. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 11/20/2008 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+u32 -+PHY_RFShadowRead( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset) -+{ -+ return RF_Shadow[eRFPath][Offset].Value; -+ -+} /* PHY_RFShadowRead */ -+ -+ -+void -+PHY_RFShadowWrite( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset, -+ u32 Data) -+{ -+ RF_Shadow[eRFPath][Offset].Value = (Data & bRFRegOffsetMask); -+ RF_Shadow[eRFPath][Offset].Driver_Write = true; -+ -+} /* PHY_RFShadowWrite */ -+ -+ -+bool -+PHY_RFShadowCompare( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset) -+{ -+ u32 reg; -+ // Check if we need to check the register -+ if (RF_Shadow[eRFPath][Offset].Compare == true) -+ { -+ reg = rtw_hal_read_rfreg(Adapter, eRFPath, Offset, bRFRegOffsetMask); -+ // Compare shadow and real rf register for 20bits!! -+ if (RF_Shadow[eRFPath][Offset].Value != reg) -+ { -+ // Locate error position. -+ RF_Shadow[eRFPath][Offset].ErrorOrNot = true; -+ //RT_TRACE(COMP_INIT, DBG_LOUD, -+ //("PHY_RFShadowCompare RF-%d Addr%02lx Err = %05lx\n", -+ //eRFPath, Offset, reg)); -+ } -+ return RF_Shadow[eRFPath][Offset].ErrorOrNot ; -+ } -+ return false; -+} /* PHY_RFShadowCompare */ -+ -+ -+void -+PHY_RFShadowRecorver( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset) -+{ -+ // Check if the address is error -+ if (RF_Shadow[eRFPath][Offset].ErrorOrNot == true) -+ { -+ // Check if we need to recorver the register. -+ if (RF_Shadow[eRFPath][Offset].Recorver == true) -+ { -+ rtw_hal_write_rfreg(Adapter, eRFPath, Offset, bRFRegOffsetMask, -+ RF_Shadow[eRFPath][Offset].Value); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, -+ //("PHY_RFShadowRecorver RF-%d Addr%02lx=%05lx", -+ //eRFPath, Offset, RF_Shadow[eRFPath][Offset].Value)); -+ } -+ } -+ -+} /* PHY_RFShadowRecorver */ -+ -+ -+void -+PHY_RFShadowCompareAll( -+ PADAPTER Adapter) -+{ -+ u8 eRFPath = 0 ; -+ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) -+ { -+ for (Offset = 0; Offset <= maxReg; Offset++) -+ { -+ PHY_RFShadowCompare(Adapter, eRFPath, Offset); -+ } -+ } -+ -+} /* PHY_RFShadowCompareAll */ -+ -+ -+void -+PHY_RFShadowRecorverAll( -+ PADAPTER Adapter) -+{ -+ u8 eRFPath =0; -+ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) -+ { -+ for (Offset = 0; Offset <= maxReg; Offset++) -+ { -+ PHY_RFShadowRecorver(Adapter, eRFPath, Offset); -+ } -+ } -+ -+} /* PHY_RFShadowRecorverAll */ -+ -+ -+void -+PHY_RFShadowCompareFlagSet( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset, -+ u8 Type) -+{ -+ // Set True or False!!! -+ RF_Shadow[eRFPath][Offset].Compare = Type; -+ -+} /* PHY_RFShadowCompareFlagSet */ -+ -+ -+void -+PHY_RFShadowRecorverFlagSet( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset, -+ u8 Type) -+{ -+ // Set True or False!!! -+ RF_Shadow[eRFPath][Offset].Recorver= Type; -+ -+} /* PHY_RFShadowRecorverFlagSet */ -+ -+ -+void -+PHY_RFShadowCompareFlagSetAll( -+ PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) -+ { -+ for (Offset = 0; Offset <= maxReg; Offset++) -+ { -+ // 2008/11/20 MH For S3S4 test, we only check reg 26/27 now!!!! -+ if (Offset != 0x26 && Offset != 0x27) -+ PHY_RFShadowCompareFlagSet(Adapter, eRFPath, Offset, false); -+ else -+ PHY_RFShadowCompareFlagSet(Adapter, eRFPath, Offset, true); -+ } -+ } -+ -+} /* PHY_RFShadowCompareFlagSetAll */ -+ -+ -+void -+PHY_RFShadowRecorverFlagSetAll( -+ PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) -+ { -+ for (Offset = 0; Offset <= maxReg; Offset++) -+ { -+ // 2008/11/20 MH For S3S4 test, we only check reg 26/27 now!!!! -+ if (Offset != 0x26 && Offset != 0x27) -+ PHY_RFShadowRecorverFlagSet(Adapter, eRFPath, Offset, false); -+ else -+ PHY_RFShadowRecorverFlagSet(Adapter, eRFPath, Offset, true); -+ } -+ } -+ -+} /* PHY_RFShadowCompareFlagSetAll */ -+ -+void -+PHY_RFShadowRefresh( -+ PADAPTER Adapter) -+{ -+ u8 eRFPath = 0; -+ u32 Offset = 0, maxReg= GET_RF6052_REAL_MAX_REG(Adapter); -+ -+ for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) -+ { -+ for (Offset = 0; Offset <= maxReg; Offset++) -+ { -+ RF_Shadow[eRFPath][Offset].Value = 0; -+ RF_Shadow[eRFPath][Offset].Compare = false; -+ RF_Shadow[eRFPath][Offset].Recorver = false; -+ RF_Shadow[eRFPath][Offset].ErrorOrNot = false; -+ RF_Shadow[eRFPath][Offset].Driver_Write = false; -+ } -+ } -+ -+} /* PHY_RFShadowRead */ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8812A.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8812A.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8812A.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8812A.c 2018-02-06 17:42:30.709967150 +0200 -@@ -0,0 +1,2724 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+// 2010/04/25 MH Define the max tx power tracking tx agc power. -+#define ODM_TXPWRTRACK_MAX_IDX8812A 6 -+ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+ -+//3============================================================ -+//3 Tx Power Tracking -+//3============================================================ -+ -+ -+void DoIQK_8812A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ ODM_ResetIQKResult(pDM_Odm); -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; -+ PHY_IQCalibrate_8812A(Adapter, false); -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: odm_TxPwrTrackSetPwr88E() -+ * -+ * Overview: 88E change all channel tx power accordign to flag. -+ * OFDM & CCK are all different. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 04/23/2012 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+ODM_TxPwrTrackSetPwr8812A( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ) -+{ -+ u4Byte finalBbSwingIdx[2]; -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ u1Byte PwrTrackingLimit = 26; //+1.0dB -+ u1Byte TxRate = 0xFF; -+ s1Byte Final_OFDM_Swing_Index = 0; -+ s1Byte Final_CCK_Swing_Index = 0; -+ u1Byte i = 0; -+ -+#if 0 -+ #if (MP_DRIVER==1) -+ PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); -+ -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+ #else -+ u2Byte rate = *(pDM_Odm->pForcedDataRate); -+ -+ if(!rate) //auto rate -+ { -+ if(pDM_Odm->TxRate != 0xFF) -+ TxRate = HwRateToMRate8812(pDM_Odm->TxRate); -+ } -+ else //force rate -+ { -+ TxRate = (u1Byte) rate; -+ } -+ #endif -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8812A\n")); -+#endif -+ if(TxRate != 0xFF) -+ { -+ //2 CCK -+ if((TxRate >= MGN_1M)&&(TxRate <= MGN_11M)) -+ PwrTrackingLimit = 32; //+4dB -+ //2 OFDM -+ else if((TxRate >= MGN_6M)&&(TxRate <= MGN_48M)) -+ PwrTrackingLimit = 32; //+4dB -+ else if(TxRate == MGN_54M) -+ PwrTrackingLimit = 30; //+3dB -+ //2 HT -+ else if((TxRate >= MGN_MCS0)&&(TxRate <= MGN_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_MCS3)&&(TxRate <= MGN_MCS4)) //16QAM -+ PwrTrackingLimit = 32; //+4dB -+ else if((TxRate >= MGN_MCS5)&&(TxRate <= MGN_MCS7)) //64QAM -+ PwrTrackingLimit = 30; //+3dB -+ -+ else if((TxRate >= MGN_MCS8)&&(TxRate <= MGN_MCS10)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_MCS11)&&(TxRate <= MGN_MCS12)) //16QAM -+ PwrTrackingLimit = 32; //+4dB -+ else if((TxRate >= MGN_MCS13)&&(TxRate <= MGN_MCS15)) //64QAM -+ PwrTrackingLimit = 30; //+3dB -+ -+ //2 VHT -+ else if((TxRate >= MGN_VHT1SS_MCS0)&&(TxRate <= MGN_VHT1SS_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_VHT1SS_MCS3)&&(TxRate <= MGN_VHT1SS_MCS4)) //16QAM -+ PwrTrackingLimit = 32; //+4dB -+ else if((TxRate >= MGN_VHT1SS_MCS5)&&(TxRate <= MGN_VHT1SS_MCS6)) //64QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if(TxRate == MGN_VHT1SS_MCS7) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ else if(TxRate == MGN_VHT1SS_MCS8) //256QAM -+ PwrTrackingLimit = 26; //+1dB -+ else if(TxRate == MGN_VHT1SS_MCS9) //256QAM -+ PwrTrackingLimit = 24; //+0dB -+ -+ else if((TxRate >= MGN_VHT2SS_MCS0)&&(TxRate <= MGN_VHT2SS_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_VHT2SS_MCS3)&&(TxRate <= MGN_VHT2SS_MCS4)) //16QAM -+ PwrTrackingLimit = 32; //+4dB -+ else if((TxRate >= MGN_VHT2SS_MCS5)&&(TxRate <= MGN_VHT2SS_MCS6)) //64QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if(TxRate == MGN_VHT2SS_MCS7) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ else if(TxRate == MGN_VHT2SS_MCS8) //256QAM -+ PwrTrackingLimit = 26; //+1dB -+ else if(TxRate == MGN_VHT2SS_MCS9) //256QAM -+ PwrTrackingLimit = 24; //+0dB -+ -+ else -+ PwrTrackingLimit = 24; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("TxRate=0x%x, PwrTrackingLimit=%d\n", TxRate, PwrTrackingLimit)); -+ -+ -+ if (Method == BBSWING) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8812A\n")); -+ -+ if (RFPath == ODM_RF_PATH_A) -+ { -+ finalBbSwingIdx[ODM_RF_PATH_A] = (pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A] > PwrTrackingLimit) ? PwrTrackingLimit : pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A]; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A]=%d, pDM_Odm->RealBbSwingIdx[ODM_RF_PATH_A]=%d\n", -+ pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A], finalBbSwingIdx[ODM_RF_PATH_A])); -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_A]]); -+ } -+ else -+ { -+ finalBbSwingIdx[ODM_RF_PATH_B] = (pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_B] > PwrTrackingLimit) ? PwrTrackingLimit : pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_B]; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_B]=%d, pDM_Odm->RealBbSwingIdx[ODM_RF_PATH_B]=%d\n", -+ pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_B], finalBbSwingIdx[ODM_RF_PATH_B])); -+ -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_B]]); -+ } -+ -+ /* -+ // <20121120> +2.5dB clipping, asked by Jerry Chang. -+ pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_A] = (pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_A] > 29) ? 29 : pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_A]; -+ pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_B] = (pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_B] > 29) ? 29 : pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_B]; -+ -+ //2013.01.28 LukeLee: This is for debug request by Joe, otherwise BbSwingOffsetA and BbSwingOffsetB is 0 in normal & MP driver -+ if(pDM_Odm->IsBbSwingOffsetPositiveA) -+ { -+ finalBbSwingIdx[ODM_RF_PATH_A] = pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_A] + pDM_Odm->BbSwingOffsetA; -+ finalBbSwingIdx[ODM_RF_PATH_A] = (finalBbSwingIdx[ODM_RF_PATH_A] > 29) ? 29 : finalBbSwingIdx[ODM_RF_PATH_A]; -+ } -+ else -+ finalBbSwingIdx[ODM_RF_PATH_A] = pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_A] - pDM_Odm->BbSwingOffsetA; -+ -+ if(pDM_Odm->IsBbSwingOffsetPositiveB) -+ { -+ finalBbSwingIdx[ODM_RF_PATH_B] = pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_B] + pDM_Odm->BbSwingOffsetB; -+ finalBbSwingIdx[ODM_RF_PATH_B] = (finalBbSwingIdx[ODM_RF_PATH_B] > 29) ? 29 : finalBbSwingIdx[ODM_RF_PATH_B]; -+ } -+ else -+ finalBbSwingIdx[ODM_RF_PATH_B] = pDM_Odm->BbSwingIdxOfdm[ODM_RF_PATH_B] - pDM_Odm->BbSwingOffsetB; -+ -+ // Adjust BB swing by Tx scaling, no matter CCK or OFDM. -+ if (RFPath == ODM_RF_PATH_A) -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_A]]); -+ else if (RFPath == ODM_RF_PATH_B) -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_B]]); -+ -+ */ -+ -+ } -+ -+ else if (Method == MIX_MODE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->DefaultOfdmIndex=%d, pDM_Odm->Aboslute_OFDMSwingIdx[RFPath]=%d, RF_Path = %d\n", -+ pDM_Odm->DefaultOfdmIndex, pDM_Odm->Aboslute_OFDMSwingIdx[RFPath],RFPath )); -+ -+ -+ Final_OFDM_Swing_Index = pDM_Odm->DefaultOfdmIndex + pDM_Odm->Aboslute_OFDMSwingIdx[RFPath]; -+ -+ if (RFPath == ODM_RF_PATH_A) -+ { -+ if(Final_OFDM_Swing_Index > PwrTrackingLimit) //BBSwing higher then Limit -+ { -+ pDM_Odm->Remnant_CCKSwingIdx= Final_OFDM_Swing_Index - PwrTrackingLimit; // CCK Follow the same compensate value as Path A -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit; -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[PwrTrackingLimit]); -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathA= true; -+ -+ //Set TxAGC Page C{}; -+ //Adapter->HalFunc.SetTxPowerLevelHandler(Adapter, pHalData->CurrentChannel); -+ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit, pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else if (Final_OFDM_Swing_Index < 0) -+ { -+ pDM_Odm->Remnant_CCKSwingIdx= Final_OFDM_Swing_Index; // CCK Follow the same compensate value as Path A -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[0]); -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathA= true; -+ -+ //Set TxAGC Page C{}; -+ //Adapter->HalFunc.SetTxPowerLevelHandler(Adapter, pHalData->CurrentChannel); -+ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[Final_OFDM_Swing_Index]); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); -+ -+ if(pDM_Odm->Modify_TxAGC_Flag_PathA) //If TxAGC has changed, reset TxAGC again -+ { -+ pDM_Odm->Remnant_CCKSwingIdx= 0; -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = 0; -+ -+ //Set TxAGC Page C{}; -+ //Adapter->HalFunc.SetTxPowerLevelHandler(Adapter, pHalData->CurrentChannel); -+ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathA= false; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A pDM_Odm->Modify_TxAGC_Flag = false \n")); -+ } -+ } -+ } -+ -+ if (RFPath == ODM_RF_PATH_B) -+ { -+ if(Final_OFDM_Swing_Index > PwrTrackingLimit) //BBSwing higher then Limit -+ { -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit; -+ -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[PwrTrackingLimit]); -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathB= true; -+ -+ //Set TxAGC Page E{}; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_B Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit, pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else if (Final_OFDM_Swing_Index < 0) -+ { -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; -+ -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[0]); -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathB = true; -+ -+ //Set TxAGC Page E{}; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_B Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, rB_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[Final_OFDM_Swing_Index]); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_B Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); -+ -+ if(pDM_Odm->Modify_TxAGC_Flag_PathB) //If TxAGC has changed, reset TxAGC again -+ { -+ pDM_Odm->Remnant_CCKSwingIdx= 0; -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = 0; -+ -+ //Set TxAGC Page E{}; -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathB = false; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_B pDM_Odm->Modify_TxAGC_Flag = false \n")); -+ } -+ } -+ } -+ -+ } -+ else -+ { -+ return; -+ } -+} -+ -+void -+GetDeltaSwingTable_8812A( -+ PDM_ODM_T pDM_Odm, -+ pu1Byte *TemperatureUP_A, -+ pu1Byte *TemperatureDOWN_A, -+ pu1Byte *TemperatureUP_B, -+ pu1Byte *TemperatureDOWN_B -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u2Byte rate = *(pDM_Odm->pForcedDataRate); -+ u1Byte channel = pHalData->CurrentChannel; -+ -+ if ( 1 <= channel && channel <= 14) { -+ if (IS_CCK_RATE(rate)) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N; -+ } else { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N; -+ } -+ } else if ( 36 <= channel && channel <= 64) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0]; -+ } else if ( 100 <= channel && channel <= 140) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1]; -+ } else if ( 149 <= channel && channel <= 173) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2]; -+ } else { -+ *TemperatureUP_A = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_A = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ *TemperatureUP_B = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_B = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ } -+ -+ return; -+} -+ -+void ConfigureTxpowerTrack_8812A( -+ PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ pConfig->SwingTableSize_CCK = TXSCALE_TABLE_SIZE; -+ pConfig->SwingTableSize_OFDM = TXSCALE_TABLE_SIZE; -+ pConfig->Threshold_IQK = IQK_THRESHOLD; -+ pConfig->AverageThermalNum = AVG_THERMAL_NUM_8812A; -+ pConfig->RfPathCount = MAX_PATH_NUM_8812A; -+ pConfig->ThermalRegAddr = RF_T_METER_8812A; -+ -+ pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr8812A; -+ pConfig->DoIQK = DoIQK_8812A; -+ pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8812A; -+ pConfig->GetDeltaSwingTable = GetDeltaSwingTable_8812A; -+} -+ -+ -+// -+// 2011/07/26 MH Add an API for testing IQK fail case. -+// -+// MP Already declare in odm.c -+static bool -+ODM_CheckPowerStatus( -+ PADAPTER Adapter) -+{ -+ return true; -+} -+ -+#define BW_20M 0 -+#define BW_40M 1 -+#define BW_80M 2 -+ -+static void _IQK_RX_FillIQC_8812A( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_RADIO_PATH_E Path, -+ unsigned int RX_X, -+ unsigned int RX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ if (RX_X>>1 ==0x112 || RX_Y>>1 == 0x3ee){ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x100); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, RX_Y>>1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc10 = %x ====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xc10))); -+ } -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ if (RX_X>>1 ==0x112 || RX_Y>>1 == 0x3ee){ -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x100); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, 0); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, RX_Y>>1); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x====>fill to IQC\n ", RX_X>>1&0x000003ff, RX_Y>>1&0x000003ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe10 = %x====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xe10))); -+ } -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+static void _IQK_TX_FillIQC_8812A( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_RADIO_PATH_E Path, -+ unsigned int TX_X, -+ unsigned int TX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X&0x000007ff, TX_Y&0x000007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xcd4 = %x;;0xccc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xcd4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xccc, 0x000007ff))); -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xe90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xec4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xec8, 0x20000000); -+ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X&0x000007ff, TX_Y&0x000007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xed4 = %x;;0xecc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xed4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xecc, 0x000007ff))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+static void _IQK_BackupMacBB_8812A( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte MACBB_backup, -+ pu4Byte Backup_MACBB_REG, -+ u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupMacBB Success!!!!\n")); -+} -+ -+static void _IQK_BackupRF_8812A( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte RFA_backup, -+ pu4Byte RFB_backup, -+ pu4Byte Backup_RF_REG, -+ u4Byte RF_NUM -+ ) -+{ -+ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save RF Parameters -+ for (i = 0; i < RF_NUM; i++){ -+ RFA_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG[i], bMaskDWord); -+ RFB_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, Backup_RF_REG[i], bMaskDWord); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupRF Success!!!!\n")); -+} -+ -+static void _IQK_BackupAFE_8812A( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte AFE_backup, -+ pu4Byte Backup_AFE_REG, -+ u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ AFE_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_AFE_REG[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupAFE Success!!!!\n")); -+} -+ -+static void _IQK_RestoreMacBB_8812A( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte MACBB_backup, -+ pu4Byte Backup_MACBB_REG, -+ u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload MacBB Parameters -+ for (i = 0; i < MACBB_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreMacBB Success!!!!\n")); -+} -+ -+static void _IQK_RestoreRF_8812A( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_RADIO_PATH_E Path, -+ pu4Byte Backup_RF_REG, -+ pu4Byte RF_backup, -+ u4Byte RF_REG_NUM -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ for (i = 0; i < RF_REG_NUM; i++) -+ ODM_SetRFReg(pDM_Odm, Path, Backup_RF_REG[i], bRFRegOffsetMask, RF_backup[i]); -+ -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x0); -+ -+ switch(Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path A Success!!!!\n")); -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path B Success!!!!\n")); -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+static void _IQK_RestoreAFE_8812A( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte AFE_backup, -+ pu4Byte Backup_AFE_REG, -+ u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_AFE_REG[i], AFE_backup[i]); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x0); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreAFE Success!!!!\n")); -+} -+ -+static void _IQK_ConfigureMAC_8812A( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ // ========MAC register setting======== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_Write1Byte(pDM_Odm, 0x522, 0x3f); -+ ODM_SetBBReg(pDM_Odm, 0x550, BIT(11)|BIT(3), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT(28), 0x0); // CCK Off -+ ODM_Write1Byte(pDM_Odm, 0x808, 0x00); // RX ante off -+ ODM_SetBBReg(pDM_Odm, 0x838, 0xf, 0xc); // CCA off -+} -+ -+#define cal_num 3 -+ -+static void _IQK_Tx_8812A( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_RADIO_PATH_E Path, -+ u1Byte chnlIdx -+ ) -+{ -+ u4Byte TX_fail,RX_fail, delay_count, IQK_ready, cal_retry, cal = 0, temp_reg65; -+ int TX_X = 0, TX_Y = 0, RX_X = 0, RX_Y = 0, TX_Average = 0, RX_Average = 0; -+ int TX_X0[cal_num], TX_Y0[cal_num], RX_X0[cal_num], RX_Y0[cal_num]; -+ bool TX0IQKOK = false, RX0IQKOK = false; -+ int TX_X1[cal_num], TX_Y1[cal_num], RX_X1[cal_num], RX_Y1[cal_num]; -+ bool TX1IQKOK = false, RX1IQKOK = false, VDF_enable = false; -+ int i, k, VDF_Y[3], VDF_X[3], Tx_dt[3], Rx_dt[3], ii, dx = 0, dy = 0, TX_finish = 0, RX_finish = 0, dt = 0; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BandWidth = %d, ExtPA5G = %d, ExtPA2G = %d\n", *pDM_Odm->pBandWidth, pDM_Odm->ExtPA5G, pDM_Odm->ExtPA)); -+ if (*pDM_Odm->pBandWidth == 2){ -+ VDF_enable = true; -+ } -+ VDF_enable = false; -+ temp_reg65 = ODM_GetRFReg(pDM_Odm, Path, 0x65, bMaskDWord); -+ -+ switch(Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // ========Path-A AFE all on======== -+ // Port 0 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); -+ -+ // Port 1 DAC/ADC off -+ ODM_Write4Byte(pDM_Odm, 0xe60, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xe64, 0x00000000); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); -+ -+ ODM_SetBBReg(pDM_Odm, 0xc00, 0xf, 0x4);// hardware 3-wire off -+ -+ // DAC/ADC sampling rate (160 MHz) -+ ODM_SetBBReg(pDM_Odm, 0xc5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ ODM_SetBBReg(pDM_Odm, 0x8c4, BIT(30), 0x1); -+ //ODM_SetBBReg(pDM_Odm, 0xcb0, 0x00ff0000, 0x77); -+ //ODM_SetBBReg(pDM_Odm, 0xcb4, 0x03000000, 0x0); -+ } -+ break; -+ case ODM_RF_PATH_B: -+ {ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // ========Path-B AFE all on======== -+ // Port 0 DAC/ADC off -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x00000000); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x00000000); -+ -+ // Port 1 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xe60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xe64, 0x77777777); -+ -+ ODM_Write4Byte(pDM_Odm, 0xe68, 0x19791979); -+ -+ ODM_SetBBReg(pDM_Odm, 0xe00, 0xf, 0x4);// hardware 3-wire off -+ -+ // DAC/ADC sampling rate (160 MHz) -+ ODM_SetBBReg(pDM_Odm, 0xe5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ ODM_SetBBReg(pDM_Odm, 0x8c4, BIT(30), 0x1); -+ //ODM_SetBBReg(pDM_Odm, 0xeb0, 0x00ff0000, 0x77); -+ //ODM_SetBBReg(pDM_Odm, 0xeb4, 0x03000000, 0x0); -+ } -+ break; -+ default: -+ break; -+ } -+ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ //====== TX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3fffd); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe83f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA5G) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f1); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28163e96); -+ if (pDM_Odm->RFEType == 3) -+ { if (pDM_Odm->ExtPA) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403e3); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ } -+ -+ } -+ -+ if (VDF_enable == 1){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXVDF Start\n")); -+ for (k = 0;k <= 2; k++){ -+ switch (k){ -+ case 0: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); -+ } -+ break; -+ case 1: -+ { -+ ODM_SetBBReg(pDM_Odm, 0xc80, BIT(28), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xc84, BIT(28), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask -+ } -+ break; -+ case 2: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Tx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Tx_dt = %d\n", Tx_dt[cal])); -+ Tx_dt[cal] = ((16*Tx_dt[cal])*10000/15708); -+ Tx_dt[cal] = (Tx_dt[cal] >> 1 )+(Tx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x3fff0000, Tx_dt[cal] & 0x00003fff); -+ } -+ break; -+ default: -+ break; -+ } -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((IQK_ready) || (delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = true; -+ break; -+ } -+ else{ -+ TX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXA_VDF_cal_retry = %d\n", cal_retry)); -+ TX_X0[cal] = VDF_X[k-1] ; -+ TX_Y0[cal] = VDF_Y[k-1]; -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x00000000); -+ -+ for(cal = 0; cal < cal_num; cal++){ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 25ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((IQK_ready) || (delay_count>20)) { -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ TX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ TX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = true; -+ /* -+ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x01000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x03000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ break; -+ } -+ else{ -+ TX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXA_cal_retry = %d\n", cal_retry)); -+ if (TX0IQKOK) -+ TX_Average++; -+ } -+ } -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, Path, 0x8, 0xffc00)); // Load LOK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (TX0IQKOK == false) -+ break; // TXK fail, Don't do RXK -+ -+ -+ if (VDF_enable == 1){ -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); // TX VDF Disable -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXVDF Start\n")); -+ -+ //====== RX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe7bf); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d0); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161420); -+ -+ for (k = 0;k <= 2; k++){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (VDF_X[k])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (VDF_Y[k])>>21&0x000007ff); -+ -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ switch (k){ -+ case 0: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(30), 0x0); -+ } -+ break; -+ case 1: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x28008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x08008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ } -+ break; -+ case 2: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Rx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Rx_dt = %d\n", Rx_dt[cal])); -+ Rx_dt[cal] = ((16*Rx_dt[cal])*10000/13823); -+ Rx_dt[cal] = (Rx_dt[cal] >> 1 )+(Rx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x00003fff, Rx_dt[cal] & 0x00003fff); -+ } -+ break; -+ default: -+ break; -+ } -+ -+ -+ if (k==2){ -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(30), 0x1); //RX VDF Enable -+ } -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); -+ if (RX_fail == 0){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ RX0IQKOK = true; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); -+ RX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ -+ } -+ } -+ else{ -+ RX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXA_VDF_cal_retry = %d\n", cal_retry)); -+ RX_X0[cal] = VDF_X[k-1] ; -+ RX_Y0[cal] = VDF_Y[k-1]; -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); // TX VDF Enable -+ } -+ else{ -+ //====== RX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // 1. RX RF Setting -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe7bf); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d0); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ //ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a891); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28160d40); -+ -+ for(cal = 0; cal < cal_num; cal++){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X0[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y0[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); -+ if (RX_fail == 0){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ RX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ RX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ RX0IQKOK = true; -+ /* -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x05000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ DbgPrint("reg1 = %d, reg2 = %d", reg1, reg2); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x07000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd00, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd00, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); -+ RX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ -+ } -+ } -+ else{ -+ RX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXA_cal_retry = %d\n", cal_retry)); -+ if (RX0IQKOK) -+ RX_Average++; -+ } -+ } -+ -+ -+ -+ -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ //Path-B TX/RX IQK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3fffd); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe83f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); -+ ODM_SetBBReg(pDM_Odm, 0xe94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA5G) -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x821403f7); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x821403f1); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x68163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28163e96); -+ -+ if (VDF_enable == 1){ -+ for (k = 0;k <= 2; k++){ -+ switch (k){ -+ case 0: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910); -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x0); -+ } -+ break; -+ case 1: -+ { -+ ODM_SetBBReg(pDM_Odm, 0xe80, BIT(28), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xe84, BIT(28), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910); -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x0); -+ } -+ break; -+ case 2: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Tx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Tx_dt = %d\n", Tx_dt[cal])); -+ Tx_dt[cal] = ((16*Tx_dt[cal])*10000/15708); -+ Tx_dt[cal] = (Tx_dt[cal] >> 1 )+(Tx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xee8, 0x3fff0000, Tx_dt[cal] & 0x00003fff); -+ } -+ break; -+ default: -+ break; -+ } -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); -+ if ((IQK_ready) || (delay_count>20)) { -+ break; -+ } -+ else { -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ TX1IQKOK = true; -+ break; -+ } -+ else{ -+ TX1IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX1IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXB_VDF_cal_retry = %d\n", cal_retry)); -+ TX_X1[cal] = VDF_X[k-1] ; -+ TX_Y1[cal] = VDF_Y[k-1]; -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xee8, 0x00000000); -+ -+ for(cal = 0; cal < cal_num; cal++){ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 25ms -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); -+ if ((IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(12)); -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); -+ TX_X1[cal] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); -+ TX_Y1[cal] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ TX1IQKOK = true; -+ /* -+ int reg1 = 0, reg2 = 0, Image_Power = 0; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x01000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x02000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x03000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x04000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+ */ -+ break; -+ } -+ else{ -+ TX1IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ else { -+ TX1IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TXB_cal_retry = %d\n", cal_retry)); -+ if (TX1IQKOK) -+ TX_Average++; -+ } -+ } -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, Path, 0x8, 0xffc00)); // Load LOK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (TX1IQKOK == false) -+ break; // TXK fail, Don't do RXK -+ -+ if (VDF_enable == 1) { -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x0); // TX VDF Disable -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXVDF Start\n")); -+ -+ //====== RX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe7bf); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d0); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x02140119); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28161420); -+ -+ for (k = 0;k <= 2; k++){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (VDF_X[k])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (VDF_Y[k])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ switch (k){ -+ case 0: -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x38008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x18008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(30), 0x0); -+ break; -+ case 1: -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x28008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x08008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(30), 0x0); -+ break; -+ case 2: -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Rx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Rx_dt = %d\n", Rx_dt[cal])); -+ Rx_dt[cal] = ((16*Rx_dt[cal])*10000/13823); -+ Rx_dt[cal] = (Rx_dt[cal] >> 1 )+(Rx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x38008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x18008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xee8, 0x00003fff, Rx_dt[cal] & 0x00003fff); -+ break; -+ default: -+ break; -+ } -+ -+ -+ if (k==2) -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(30), 0x1); //RX VDF Enable -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); -+ if ((IQK_ready)||(delay_count>20)) { -+ break; -+ } else { -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(11)); -+ if (RX_fail == 0){ -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x06000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x08000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ RX1IQKOK = true; -+ break; -+ } else { -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, 0x0>>1); -+ RX1IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ -+ } -+ } -+ else{ -+ RX1IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXB_VDF_cal_retry = %d\n", cal_retry)); -+ RX_X1[cal] = VDF_X[k-1] ; -+ RX_Y1[cal] = VDF_Y[k-1]; -+ ODM_SetBBReg(pDM_Odm, 0xee8, BIT(31), 0x1); // TX VDF Enable -+ } -+ else{ -+ -+ //====== RX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x3f7ff); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfe7bf); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d0); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ //ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a891); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xe88, 0x02140119); -+ ODM_Write4Byte(pDM_Odm, 0xe8c, 0x28161180); -+ -+ for(cal = 0; cal < cal_num; cal++){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X1[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y1[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(10)); -+ if ((IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else { -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd40, BIT(11)); -+ if (RX_fail == 0){ -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x06000000); -+ RX_X1[cal] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x08000000); -+ RX_Y1[cal] = ODM_GetBBReg(pDM_Odm, 0xd40, 0x07ff0000)<<21; -+ RX1IQKOK = true; -+/* -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x05000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x06000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ DbgPrint("reg1 = %d, reg2 = %d", reg1, reg2); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("Before PW = %d\n", Image_Power); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x07000000); -+ reg1 = ODM_GetBBReg(pDM_Odm, 0xd40, 0xffffffff); -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x08000000); -+ reg2 = ODM_GetBBReg(pDM_Odm, 0xd40, 0x0000001f); -+ Image_Power = (reg2<<32)+reg1; -+ DbgPrint("After PW = %d\n", Image_Power); -+*/ -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, 0x0>>1); -+ RX1IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ else{ -+ RX1IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXB_cal_retry = %d\n", cal_retry)); -+ if (RX1IQKOK) -+ RX_Average++; -+ } -+ } -+ } -+ break; -+ default: -+ break; -+ } -+ -+ // FillIQK Result -+ switch (Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_A =======\n")); -+ if (TX_Average == 0){ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ break; -+ } -+ for (i = 0; i < TX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X0[%d] = %x ;; TX_Y0[%d] = %x\n", i, (TX_X0[i])>>21&0x000007ff, i, (TX_Y0[i])>>21&0x000007ff)); -+ } -+ -+ for (i = 0; i < TX_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_X0[ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (TX_Y0[i]>>21) - (TX_Y0[ii]>>21); -+ if (dy < 4 && dy > -4){ -+ TX_X = ((TX_X0[i]>>21) + (TX_X0[ii]>>21))/2; -+ TX_Y = ((TX_Y0[i]>>21) + (TX_Y0[ii]>>21))/2; -+ if (*pDM_Odm->pBandWidth == 2){ -+ Tx_dt[0] = (Tx_dt[i] + Tx_dt[ii])/2; -+ } -+ TX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (TX_finish == 1) -+ break; -+ } -+ if (*pDM_Odm->pBandWidth == 2){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x3fff0000, Tx_dt[0] & 0x00003fff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ } -+ if (TX_finish == 1){ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, TX_X, TX_Y); -+ } -+ else{ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ -+ if (RX_Average == 0){ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ break; -+ } -+ -+ for (i = 0; i < RX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[%d] = %x ;; RX_Y0[%d] = %x\n", i, (RX_X0[i])>>21&0x000007ff, i, (RX_Y0[i])>>21&0x000007ff)); -+ } -+ -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X0[ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_Y0[i]>>21) - (RX_Y0[ii]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_X = ((RX_X0[i]>>21) + (RX_X0[ii]>>21))/2; -+ RX_Y = ((RX_Y0[i]>>21) + (RX_Y0[ii]>>21))/2; -+ if (*pDM_Odm->pBandWidth == 2){ -+ Rx_dt[0] = (Rx_dt[i] + Rx_dt[ii])/2; -+ } -+ RX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish == 1) -+ break; -+ } -+ if (*pDM_Odm->pBandWidth == 2){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x00003fff, Rx_dt[0] & 0x00003fff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ } -+ if (RX_finish == 1){ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, RX_X, RX_Y); -+ } -+ else{ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ if (TX_finish && RX_finish){ -+ pRFCalibrateInfo->bNeedIQK = false; -+ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][0] = ((TX_X & 0x000007ff) << 16) + (TX_Y & 0x000007ff); //Path A TX -+ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][1] = ((RX_X & 0x000007ff) << 16) + (RX_Y & 0x000007ff); //Path A RX -+ -+ if (*pDM_Odm->pBandWidth == 2){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C -+ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][4] = ODM_Read4Byte( pDM_Odm, 0xce8); //Path B VDF -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ } -+ } -+ -+ } -+ break; -+ case ODM_RF_PATH_B: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_B =======\n")); -+ if (TX_Average == 0){ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ break; -+ } -+ -+ for (i = 0; i < TX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X1[%d] = %x ;; TX_Y1[%d] = %x\n", i, (TX_X1[i])>>21&0x000007ff, i, (TX_Y1[i])>>21&0x000007ff)); -+ } -+ -+ for (i = 0; i < TX_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_X1[ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (TX_Y1[i]>>21) - (TX_Y1[ii]>>21); -+ if (dy < 4 && dy > -4){ -+ TX_X = ((TX_X1[i]>>21) + (TX_X1[ii]>>21))/2; -+ TX_Y = ((TX_Y1[i]>>21) + (TX_Y1[ii]>>21))/2; -+ if (*pDM_Odm->pBandWidth == 2){ -+ Tx_dt[0] = (Tx_dt[i] + Tx_dt[ii])/2; -+ } -+ TX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (TX_finish == 1) -+ break; -+ } -+ if (*pDM_Odm->pBandWidth == 2){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xee8, 0x3fff0000, Tx_dt[0] & 0x00003fff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ } -+ if (TX_finish == 1){ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, TX_X, TX_Y); -+ } -+ else{ -+ _IQK_TX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ -+ if (RX_Average == 0){ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ break; -+ } -+ -+ for (i = 0; i < RX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X1[%d] = %x ;; RX_Y1[%d] = %x\n", i, (RX_X1[i])>>21&0x000007ff, i, (RX_Y1[i])>>21&0x000007ff)); -+ } -+ -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X1[ii]>>21); -+ if (dx < 4 && dx > -4){ -+ dy = (RX_Y1[i]>>21) - (RX_Y1[ii]>>21); -+ if (dy < 4 && dy > -4){ -+ RX_X = ((RX_X1[i]>>21) + (RX_X1[ii]>>21))/2; -+ RX_Y = ((RX_Y1[i]>>21) + (RX_Y1[ii]>>21))/2; -+ if (*pDM_Odm->pBandWidth == 2){ -+ Rx_dt[0] = (Rx_dt[i] + Rx_dt[ii])/2; -+ } -+ RX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish == 1) -+ break; -+ } -+ if (*pDM_Odm->pBandWidth == 2){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xee8, 0x00003fff, Rx_dt[0] & 0x00003fff); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ } -+ -+ if (RX_finish == 1){ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, RX_X, RX_Y); -+ } -+ else{ -+ _IQK_RX_FillIQC_8812A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ if (TX_finish && RX_finish){ -+//pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].bIQKDone= true; -+ pRFCalibrateInfo->bNeedIQK = false; -+ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][2] = ((TX_X & 0x000007ff) << 16) + (TX_Y & 0x000007ff); //Path B TX -+ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][3] = ((RX_X & 0x000007ff) << 16) + (RX_Y & 0x000007ff); //Path B RX -+ -+ if (*pDM_Odm->pBandWidth == 2){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 0 --> Page C -+ pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][5] = ODM_Read4Byte( pDM_Odm, 0xee8); //Path B VDF -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ } -+ } -+ -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+#define MACBB_REG_NUM 10 -+#define AFE_REG_NUM 14 -+#define RF_REG_NUM 3 -+ -+// Maintained by BB James. -+static void -+phy_IQCalibrate_8812A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Channel -+ ) -+{ -+ u4Byte MACBB_backup[MACBB_REG_NUM], AFE_backup[AFE_REG_NUM], RFA_backup[RF_REG_NUM], RFB_backup[RF_REG_NUM]; -+ u4Byte Backup_MACBB_REG[MACBB_REG_NUM] = {0xb00, 0x520, 0x550, 0x808, 0x90c, 0xc00, 0xe00, 0x8c4,0x838, 0x82c}; -+ u4Byte Backup_AFE_REG[AFE_REG_NUM] = {0xc5c, 0xc60, 0xc64, 0xc68, 0xcb8, 0xcb0, 0xcb4, -+ 0xe5c, 0xe60, 0xe64, 0xe68, 0xeb8, 0xeb0, 0xeb4}; -+ u4Byte Backup_RF_REG[RF_REG_NUM] = {0x65, 0x8f, 0x0}; -+ u1Byte chnlIdx = ODM_GetRightChnlPlaceforIQK(Channel); -+ -+ _IQK_BackupMacBB_8812A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); -+ _IQK_BackupAFE_8812A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); -+ _IQK_BackupRF_8812A(pDM_Odm, RFA_backup, RFB_backup, Backup_RF_REG, RF_REG_NUM); -+ -+ _IQK_ConfigureMAC_8812A(pDM_Odm); -+ _IQK_Tx_8812A(pDM_Odm, ODM_RF_PATH_A, chnlIdx); -+ _IQK_RestoreRF_8812A(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG, RFA_backup, RF_REG_NUM); -+ -+ _IQK_Tx_8812A(pDM_Odm, ODM_RF_PATH_B, chnlIdx); -+ _IQK_RestoreRF_8812A(pDM_Odm, ODM_RF_PATH_B, Backup_RF_REG, RFB_backup, RF_REG_NUM); -+ -+ _IQK_RestoreAFE_8812A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); -+ _IQK_RestoreMacBB_8812A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); -+ -+ -+} -+ -+ -+static void -+phy_LCCalibrate_8812A( -+ PDM_ODM_T pDM_Odm, -+ bool is2T -+ ) -+{ -+ u4Byte /*RF_Amode=0, RF_Bmode=0,*/ LC_Cal = 0, tmp = 0; -+ -+ //Check continuous TX and Packet TX -+ u4Byte reg0x914 = ODM_Read4Byte(pDM_Odm, rSingleTone_ContTx_Jaguar);; -+ -+ // Backup RF reg18. -+ LC_Cal = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); -+ -+ if((reg0x914 & 0x70000) != 0) //If contTx, disable all continuous TX. 0x914[18:16] -+ // <20121121, Kordan> A workaround: If we set 0x914[18:16] as zero, BB turns off ContTx -+ // until another packet comes in. To avoid ContTx being turned off, we skip this step. -+ ;//ODM_Write4Byte(pDM_Odm, rSingleTone_ContTx_Jaguar, reg0x914 & (~0x70000)); -+ else // If packet Tx-ing, pause Tx. -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF); -+ -+ -+/* -+ //3 1. Read original RF mode -+ RF_Amode = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask); -+ if(is2T) -+ RF_Bmode = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bRFRegOffsetMask); -+ -+ -+ //3 2. Set RF mode = standby mode -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask, (RF_Amode&0x8FFFF)|0x10000); -+ if(is2T) -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bRFRegOffsetMask, (RF_Bmode&0x8FFFF)|0x10000); -+*/ -+ -+ // Enter LCK mode -+ tmp = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask, tmp | BIT14); -+ -+ //3 3. Read RF reg18 -+ LC_Cal = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); -+ -+ //3 4. Set LC calibration begin bit15 -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal|0x08000); -+ -+ // Leave LCK mode -+ tmp = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_LCK, bRFRegOffsetMask, tmp & ~BIT14); -+ -+ ODM_delay_ms(100); -+ -+ //3 Restore original situation -+ if((reg0x914 & 70000) != 0) //Deal with contisuous TX case, 0x914[18:16] -+ { -+ // <20121121, Kordan> A workaround: If we set 0x914[18:16] as zero, BB turns off ContTx -+ // until another packet comes in. To avoid ContTx being turned off, we skip this step. -+ //ODM_Write4Byte(pDM_Odm, rSingleTone_ContTx_Jaguar, reg0x914); -+ } -+ else // Deal with Packet TX case -+ { -+ ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x00); -+ } -+ -+ // Recover channel number -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal); -+ -+ /* -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bRFRegOffsetMask, RF_Amode); -+ if(is2T) -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bRFRegOffsetMask, RF_Bmode); -+ */ -+ -+} -+ -+ -+ -+ -+ -+#define DP_BB_REG_NUM 7 -+#define DP_RF_REG_NUM 1 -+#define DP_RETRY_LIMIT 10 -+#define DP_PATH_NUM 2 -+#define DP_DPK_NUM 3 -+#define DP_DPK_VALUE_NUM 2 -+ -+static void -+phy_ReloadIQKSetting_8812A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Channel -+ ) -+{ -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ u1Byte chnlIdx = ODM_GetRightChnlPlaceforIQK(Channel); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][0]&0x7ff); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][0]&0x7ff0000)>>16); -+ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][2]&0x7ff); -+ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][2]&0x7ff0000)>>16); -+ -+ if (*pDM_Odm->pBandWidth != 2){ -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xee8, 0x0); -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xce8, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][4]); -+ ODM_Write4Byte(pDM_Odm, 0xee8, pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][5]); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][1]&0x7ff0000)>>17); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][1]&0x7ff)>>1); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][3]&0x7ff0000)>>17); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x03ff0000, (pRFCalibrateInfo->IQKMatrixRegSetting[chnlIdx].Value[*pDM_Odm->pBandWidth][3]&0x7ff)>>1); -+ -+ -+} -+ -+static void -+PHY_ResetIQKResult_8812A( -+ PDM_ODM_T pDM_Odm -+) -+{ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ ODM_SetBBReg(pDM_Odm, 0xecc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xed4, 0x000007ff, 0x200); -+ ODM_Write4Byte(pDM_Odm, 0xce8, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xee8, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x100); -+ ODM_SetBBReg(pDM_Odm, 0xe10, 0x000003ff, 0x100); -+} -+ -+static void -+phy_IQCalibrate_By_FW_8812A( -+ PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u1Byte IQKcmd[3] = {pHalData->CurrentChannel, 0x0, 0x0}; -+ u1Byte Buf1 = 0x0; -+ u1Byte Buf2 = 0x0; -+ -+//Byte 2, Bit 4 ~ Bit 5 : BandType -+ if(pHalData->CurrentBandType) -+ Buf1 = 0x2<<4; -+ else -+ Buf1 = 0x1<<4; -+ -+//Byte 2, Bit 0 ~ Bit 3 : Bandwidth -+ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) -+ Buf2 = 0x1; -+ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) -+ Buf2 = 0x1<<1; -+ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) -+ Buf2 = 0x1<<2; -+ else -+ Buf2 = 0x1<<3; -+ -+ IQKcmd[1] = Buf1 | Buf2; -+ IQKcmd[2] = pHalData->ExternalPA_5G | pHalData->ExternalLNA_5G<<1; -+ -+ RT_TRACE(COMP_MP, DBG_LOUD, ("== Start ==\n")); -+ -+ -+ //FillH2CCmd_8812(pAdapter, 0x45, 3, IQKcmd); -+} -+ -+void -+PHY_IQCalibrate_8812A( -+ PADAPTER pAdapter, -+ bool bReCovery -+ ) -+{ -+ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+#if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+#endif//(MP_DRIVER == 1) -+ -+ if (ODM_CheckPowerStatus(pAdapter) == false) -+ return; -+#if MP_DRIVER == 1 -+ if( ! (pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) ) -+#endif -+ { -+ phy_IQCalibrate_8812A(pDM_Odm, pHalData->CurrentChannel); -+ } -+ -+} -+ -+ -+void -+PHY_LCCalibrate_8812A( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ bool bStartContTx = false, bSingleTone = false, bCarrierSuppression = false; -+ -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ -+ #if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ bStartContTx = pMptCtx->bStartContTx; -+ bSingleTone = pMptCtx->bSingleTone; -+ bCarrierSuppression = pMptCtx->bCarrierSuppression; -+ #endif//(MP_DRIVER == 1) -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> PHY_LCCalibrate_8812A\n")); -+ -+#if (MP_DRIVER == 1) -+ phy_LCCalibrate_8812A(pDM_Odm, true); -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== PHY_LCCalibrate_8812A\n")); -+ -+} -+ -+static void phy_SetRFPathSwitch_8812A( -+ PADAPTER pAdapter, -+ bool bMain, -+ bool is2T -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ if (IS_HARDWARE_TYPE_8821(pAdapter)) -+ { -+ if(bMain) -+ ODM_SetBBReg(pDM_Odm, rA_RFE_Pinmux_Jaguar+4, BIT29|BIT28, 0x1); //Main -+ else -+ ODM_SetBBReg(pDM_Odm, rA_RFE_Pinmux_Jaguar+4, BIT29|BIT28, 0x2); //Aux -+ } -+ else if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ { -+ if (pHalData->RFEType == 5) -+ { -+ if(bMain) { -+ //WiFi -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x2); -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); -+ } else { -+ // BT -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); -+ ODM_SetBBReg(pDM_Odm, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); -+ } -+ } -+ } -+ -+} -+ -+void PHY_SetRFPathSwitch_8812A( -+ PADAPTER pAdapter, -+ bool bMain -+ ) -+{ -+ -+#if DISABLE_BB_RF -+ return; -+#else -+ phy_SetRFPathSwitch_8812A(pAdapter, bMain, true); -+#endif -+} -+ -+ -+static void -+_DPK_ThermalCompensation( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+static void -+_DPK_parareload( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte MACBB_backup, -+ pu4Byte Backup_MACBB_REG, -+ u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); -+ } -+} -+ -+ -+static void -+_DPK_parabackup( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte MACBB_backup, -+ pu4Byte Backup_MACBB_REG, -+ u4Byte MACBB_NUM -+ -+ -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); -+ } -+} -+ -+static void -+_DPK_Globalparaset( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+ //***************************************// -+ //set MAC register -+ //***************************************// -+ -+ //TX pause -+ ODM_Write4Byte(pDM_Odm, 0x520, 0x007f3F0F); -+ -+ //***************************************// -+ //set BB register -+ //***************************************// -+ -+ // reg82c[31] = b'0, ¤Á´«¨ì page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083d5); -+ -+ // test pin in/out control -+ ODM_Write4Byte(pDM_Odm, 0x970, 0x00000000); -+ -+ // path A regcb8[3:0] = h'd, TRSW to TX -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0050824d); -+ -+ // path B regeb8[3:0] = h'd, TRSW to TX -+ ODM_Write4Byte(pDM_Odm, 0xeb8, 0x0050824d); -+ -+ // reg838[3:0] = h'c, CCA off -+ ODM_Write4Byte(pDM_Odm, 0x838, 0x06c8d24c); -+ -+ // path A 3-wire off -+ ODM_Write4Byte(pDM_Odm, 0xc00, 0x00000004); -+ -+ // path B 3-wire off -+ ODM_Write4Byte(pDM_Odm, 0xe00, 0x00000004); -+ -+ // reg90c[15] = b'1, DAC fifo reset by CSWU -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ -+ // reset DPK circuit -+ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); -+ -+ // path A regc94[0] = b'1 (r_gothrough_iqkdpk), ±N DPK ¤Á¶i normal path -+ ODM_Write4Byte(pDM_Odm, 0xc94, 0x01000001); -+ -+ // path B rege94[0] = b'1 (r_gothrough_iqkdpk), ±N DPK ¤Á¶i normal path -+ ODM_Write4Byte(pDM_Odm, 0xe94, 0x01000001); -+ -+ //***************************************// -+ //set AFE register -+ //***************************************// -+ -+ //path A -+ //regc68 ¨ì regc84À³¸Ó¬O­n¸ò¥¿±` Tx mode ®Éªº³]©w¤@­P -+ -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc6c, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc70, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc74, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc78, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc7c, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x19791979); -+ -+ // force DAC/ADC power on -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); -+ -+ //path B -+ //rege68 ¨ì rege84À³¸Ó¬O­n¸ò¥¿±` Tx mode ®Éªº³]©w¤@­P -+ -+ ODM_Write4Byte(pDM_Odm, 0xe68, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe6c, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe70, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe74, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe78, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe7c, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe80, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xe84, 0x19791979); -+ -+ // force DAC/ADC power on -+ ODM_Write4Byte(pDM_Odm, 0xe60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xe64, 0x77777777); -+ -+} -+ -+ -+static void -+_DPK_GetGainLoss( -+ PDM_ODM_T pDM_Odm, -+ u1Byte path -+ ) -+{ -+ u4Byte GL_I=0,GL_Q=0; -+ u4Byte GL_I_tmp=0,GL_Q_tmp=0; -+ -+ u4Byte Power_GL; -+ u2Byte Scaler[]={0x4000, 0x41db, 0x43c7, 0x45c3, 0x47cf, 0x49ec, 0x4c19, 0x4e46, 0x5093,0x52f2, //10 -+ 0x5560, 0x57cf, 0x5a7f, 0x5d0e, 0x5fbe -+ }; -+ u1Byte sindex=0; -+ u4Byte pagesel = 0,regsel = 0; -+ -+ if(path == 0) //pathA -+ { -+ pagesel = 0; -+ regsel = 0; -+ } -+ else //pathB -+ { -+ pagesel = 0x200; -+ regsel = 0x40; -+ } -+ -+ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0601f0bf); -+ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x0c000000); -+ -+ -+ -+ GL_I_tmp = ODM_GetBBReg(pDM_Odm, 0xd00+regsel, 0xffff0000); -+ GL_Q_tmp = ODM_GetBBReg(pDM_Odm, 0xd00+regsel, 0x0000ffff); -+ -+ if(GL_I_tmp >= 0x8000) -+ GL_I = (GL_I_tmp-0x8000+0x1); -+ else -+ GL_I = GL_I_tmp; -+ -+ -+ if(GL_Q_tmp >= 0x8000) -+ GL_Q = (GL_Q_tmp-0x8000+0x1); -+ else -+ GL_Q = GL_Q_tmp; -+ -+ Power_GL = ((GL_I*GL_I)+(GL_Q*GL_Q))/4; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Power_GL = 0x%x", Power_GL)); -+ -+ if (Power_GL > 63676){ -+ sindex = 0; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 0 dB\n")); -+ } -+ else if (63676 >= Power_GL && Power_GL > 60114){ -+ sindex = 1; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 0.25 dB\n")); -+ } -+ else if (60114 >= Power_GL && Power_GL> 56751){ -+ sindex = 2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 0.5 dB\n")); -+ } -+ else if (56751 >= Power_GL && Power_GL> 53577){ -+ sindex = 3; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 0.75 dB\n")); -+ } -+ else if (53577 >= Power_GL && Power_GL> 49145){ -+ sindex = 4; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 1 dB\n")); -+ } -+ else if (49145 >= Power_GL && Power_GL> 47750){ -+ sindex = 5; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 1.25 dB\n")); -+ } -+ else if (47750 >= Power_GL && Power_GL> 45079){ -+ sindex = 6; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 1.5 dB\n")); -+ } -+ else if (45079 >= Power_GL && Power_GL> 42557){ -+ sindex = 7; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 1.75 dB\n")); -+ } -+ else if (42557 >= Power_GL && Power_GL> 40177){ -+ sindex = 8; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 2 dB\n")); -+ } -+ else if (40177 >= Power_GL && Power_GL> 37929){ -+ sindex = 9; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 2.25 dB\n")); -+ } -+ else if (37929 >= Power_GL && Power_GL> 35807){ -+ sindex = 10; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 2.5 dB\n")); -+ } -+ else if (35807 >= Power_GL && Power_GL> 33804){ -+ sindex = 11; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 2.75 dB\n")); -+ } -+ else if (33804 >= Power_GL && Power_GL> 31913){ -+ sindex = 12; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 3 dB\n")); -+ } -+ else if (31913 >= Power_GL && Power_GL> 30128){ -+ sindex = 13; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 3.25 dB\n")); -+ } -+ else if (30128 >= Power_GL){ -+ sindex = 14; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Gainloss = 3.5 dB\n")); -+ } -+ -+ -+ ODM_Write4Byte(pDM_Odm, 0xc98+pagesel, (Scaler[sindex] << 16) | Scaler[sindex]); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Set Gainloss reg 0xc98(0xe98)= 0x%x\n",ODM_Read4Byte(pDM_Odm, 0xc98+pagesel))); -+ -+} -+ -+ -+static void -+_DPK_EnableDP( -+ PDM_ODM_T pDM_Odm, -+ u1Byte path, -+ u4Byte TXindex -+ ) -+{ -+ -+ //***************************************// -+ //Enable DP -+ //***************************************// -+ -+ //PWSF[6] = 0x40 = 0dB, set the address represented TXindex as 0dB -+ u1Byte PWSF[] = { 0xff, 0xca, 0xa1, 0x80, 0x65, 0x51, 0x40, //6~0dB -+ 0x33, 0x28, 0x20, 0x19, 0x14, 0x10, 0x0d, //-1~-7dB -+ 0x0a, 0x08, 0x06, 0x05, 0x04, 0x03, 0x03, //-8~-14dB -+ 0x02, 0x02, 0x01, 0x01, -+ }; -+ u1Byte zeropoint; -+ u1Byte pwsf1,pwsf2; -+ u1Byte i; -+ u4Byte pagesel = 0,regsel = 0; -+ -+ if(path == 0) -+ { -+ pagesel = 0; -+ regsel = 0; -+ } -+ else -+ { -+ pagesel = 0x200; -+ regsel = 0x40; -+ } -+ -+ -+ //=========// -+ // DPK setting // -+ //=========// -+ // reg82c[31] = b'1, ¤Á´«¨ì page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083d5); -+ -+ -+ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0000f098); -+ ODM_Write4Byte(pDM_Odm, 0xc94+pagesel, 0x776c9f84); -+ ODM_Write4Byte(pDM_Odm, 0xcc4+pagesel, 0x08840000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x20000000); -+ ODM_Write4Byte(pDM_Odm, 0xc8c+pagesel, 0x3c000000); -+ -+ -+ // ¼gPWSF table in 1st SRAM for PA = 11 use -+ ODM_Write4Byte(pDM_Odm, 0xc20+pagesel, 0x00000800); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Write PWSF table\n")); -+ -+ -+ if(TXindex == 0x1f) -+ zeropoint = 0; -+ else if(TXindex == 0x1e) -+ zeropoint = 1; -+ else if(TXindex == 0x1d) -+ zeropoint = 2; -+ else if(TXindex == 0x1c) -+ zeropoint = 3; -+ else if(TXindex == 0x1b) -+ zeropoint = 4; -+ else if(TXindex == 0x1a) -+ zeropoint = 5; -+ else if(TXindex == 0x19) -+ zeropoint = 6; -+ else -+ zeropoint = 6; -+ -+ -+ -+ for(i=0;i<16;i++) -+ { -+ if((6-zeropoint)+i*2 > 24) -+ pwsf1 = 24; -+ else -+ pwsf1 = (6-zeropoint)+i*2; -+ -+ if((6-zeropoint-1)+i*2 > 24) -+ pwsf2 = 24; -+ else -+ pwsf2 = (6-zeropoint-1)+i*2; -+ -+ ODM_Write4Byte(pDM_Odm, 0xce4+pagesel, 0x00000001 | i<<1 | (PWSF[pwsf1]<<8) | (PWSF[pwsf2]<<16)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0x%x\n", ODM_Read4Byte(pDM_Odm, 0xce4+pagesel))); -+ ODM_SetBBReg(pDM_Odm, 0xce4+pagesel, 0xff, 0x0); -+ } -+ -+ ODM_Write4Byte(pDM_Odm, 0xce4+pagesel, 0x00000000); -+ -+ // reg82c[31] = b'0, ¤Á´«¨ì page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083d5); -+ -+} -+ -+ -+static void -+_DPK_pathABDPK( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte TXindex = 0; -+ u1Byte path = 0; -+ u4Byte pagesel = 0,regsel = 0; -+ u4Byte i=0,j=0; -+ -+ for(path=0;path<2;path ++) //path A = 0; path B = 1; -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path %s DPK start!!!\n", (path==0)?"A":"B")); -+ -+ if(path == 0) -+ { -+ pagesel = 0; -+ regsel = 0; -+ } -+ else -+ { -+ pagesel = 0x200; -+ regsel = 0x40; -+ } -+ -+ //***************************************// -+ //find compress-2.5dB TX index -+ //***************************************// -+ -+ -+ // reg82c[31] = b'1, ¤Á´«¨ì page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083d5); -+ -+ // regc20[15:13] = dB sel, §i¶D Gain Loss function ¥h´M§ä dB_sel ©Ò³]©wªºPA gain loss¥Ø¼Ð©Ò¹ïÀ³ªº Tx AGC ¬°¦ó. -+ // dB_sel = b'000 ' 1.0 dB PA gain loss -+ // dB_sel = b'001 ' 1.5 dB PA gain loss -+ // dB_sel = b'010 ' 2.0 dB PA gain loss -+ // dB_sel = b'011 ' 2.5 dB PA gain loss -+ // dB_sel = b'100 ' 3.0 dB PA gain loss -+ // dB_sel = b'101 ' 3.5 dB PA gain loss -+ // dB_sel = b'110 ' 4.0 dB PA gain loss -+ ODM_Write4Byte(pDM_Odm, 0xc20+pagesel, 0x00006000); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0401e038); -+ ODM_Write4Byte(pDM_Odm, 0xc94+pagesel, 0xf76c9f84); -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x000c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc4+pagesel, 0x148b0000); -+ ODM_Write4Byte(pDM_Odm, 0xc8c+pagesel, 0x3c000000); -+ -+ // tx_amp ' ¨M©w Ramp ¤¤¦U©¶ªiªº®¶´T¤j¤p -+ ODM_Write4Byte(pDM_Odm, 0xc98+pagesel, 0x41382e21); -+ ODM_Write4Byte(pDM_Odm, 0xc9c+pagesel, 0x5b554f48); -+ ODM_Write4Byte(pDM_Odm, 0xca0+pagesel, 0x6f6b6661); -+ ODM_Write4Byte(pDM_Odm, 0xca4+pagesel, 0x817d7874); -+ ODM_Write4Byte(pDM_Odm, 0xca8+pagesel, 0x908c8884); -+ ODM_Write4Byte(pDM_Odm, 0xcac+pagesel, 0x9d9a9793); -+ ODM_Write4Byte(pDM_Odm, 0xcb0+pagesel, 0xaaa7a4a1); -+ ODM_Write4Byte(pDM_Odm, 0xcb4+pagesel, 0xb6b3b0ad); -+ -+ // tx_inverse ' Ramp ¤¤¦U©¶ªipower ªº­Ë¼Æ, ¥H­pºâ¥X PA ªº gain report?? -+ ODM_Write4Byte(pDM_Odm, 0xc40+pagesel, 0x02ce03e9); -+ ODM_Write4Byte(pDM_Odm, 0xc44+pagesel, 0x01fd0249); -+ ODM_Write4Byte(pDM_Odm, 0xc48+pagesel, 0x01a101c9); -+ ODM_Write4Byte(pDM_Odm, 0xc4c+pagesel, 0x016a0181); -+ ODM_Write4Byte(pDM_Odm, 0xc50+pagesel, 0x01430155); -+ ODM_Write4Byte(pDM_Odm, 0xc54+pagesel, 0x01270135); -+ ODM_Write4Byte(pDM_Odm, 0xc58+pagesel, 0x0112011c); -+ ODM_Write4Byte(pDM_Odm, 0xc5c+pagesel, 0x01000108); -+ ODM_Write4Byte(pDM_Odm, 0xc60+pagesel, 0x00f100f8); -+ ODM_Write4Byte(pDM_Odm, 0xc64+pagesel, 0x00e500eb); -+ ODM_Write4Byte(pDM_Odm, 0xc68+pagesel, 0x00db00e0); -+ ODM_Write4Byte(pDM_Odm, 0xc6c+pagesel, 0x00d100d5); -+ ODM_Write4Byte(pDM_Odm, 0xc70+pagesel, 0x00c900cd); -+ ODM_Write4Byte(pDM_Odm, 0xc74+pagesel, 0x00c200c5); -+ ODM_Write4Byte(pDM_Odm, 0xc78+pagesel, 0x00bb00be); -+ ODM_Write4Byte(pDM_Odm, 0xc7c+pagesel, 0x00b500b8); -+ -+ //============// -+ // RF setting for DPK // -+ //============// -+ -+ //pathA,pathB standby mode -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)0x0, 0x0, bRFRegOffsetMask, 0x10000); -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)0x1, 0x0, bRFRegOffsetMask, 0x10000); -+ -+ // 00[4:0] = Tx AGC, 00[9:5] = Rx AGC (BB), 00[12:10] = Rx AGC (LNA) -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)(0x0+path), 0x0, bRFRegOffsetMask, 0x50bff); -+ -+ -+ // 64[14:12] = loop back attenuation -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)(0x0+path), 0x64, bRFRegOffsetMask, 0x19aac); -+ -+ // 8f[14:13] = PGA2 gain -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)(0x0+path), 0x8f, bRFRegOffsetMask, 0x8e001); -+ -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x800c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x000c5599); -+ -+ -+ // delay 100 ms -+ ODM_delay_ms(100); -+ -+ -+ // read back -+ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0109f018); -+ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x09000000); -+ // ¥i¥H¦b d00[3:0] ¤¤Åª¦^, dB_sel ¤¤©Ò³]©wªº gain loss ·|¸¨¦b­þ¤@­Ó Tx AGC ³]©w -+ // Ū¦^d00[3:0] = h'1 ' Tx AGC = 15 -+ // Ū¦^d00[3:0] = h'2 ' Tx AGC = 16 -+ // Ū¦^d00[3:0] = h'3 ' Tx AGC = 17 -+ // Ū¦^d00[3:0] = h'4 ' Tx AGC = 18 -+ // Ū¦^d00[3:0] = h'5 ' Tx AGC = 19 -+ // Ū¦^d00[3:0] = h'6 ' Tx AGC = 1a -+ // Ū¦^d00[3:0] = h'7 ' Tx AGC = 1b -+ // Ū¦^d00[3:0] = h'8 ' Tx AGC = 1c -+ // Ū¦^d00[3:0] = h'9 ' Tx AGC = 1d -+ // Ū¦^d00[3:0] = h'a ' Tx AGC = 1e -+ // Ū¦^d00[3:0] = h'b ' Tx AGC = 1f -+ -+ TXindex = ODM_GetBBReg(pDM_Odm, 0xd00+regsel, 0x0000000f); -+ -+ -+ //***************************************// -+ //get LUT -+ //***************************************// -+ -+ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0001e038); -+ ODM_Write4Byte(pDM_Odm, 0xc94+pagesel, 0xf76c9f84); -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x400c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc4+pagesel, 0x11930080); //0xcc4[9:4]= DPk fail threshold -+ ODM_Write4Byte(pDM_Odm, 0xc8c+pagesel, 0x3c000000); -+ -+ -+ // tx_amp ' ¨M©w Ramp ¤¤¦U©¶ªiªº®¶´T¤j¤p -+ -+ ODM_Write4Byte(pDM_Odm, 0xc98+pagesel, 0x41382e21); -+ ODM_Write4Byte(pDM_Odm, 0xc9c+pagesel, 0x5b554f48); -+ ODM_Write4Byte(pDM_Odm, 0xca0+pagesel, 0x6f6b6661); -+ ODM_Write4Byte(pDM_Odm, 0xca4+pagesel, 0x817d7874); -+ ODM_Write4Byte(pDM_Odm, 0xca8+pagesel, 0x908c8884); -+ ODM_Write4Byte(pDM_Odm, 0xcac+pagesel, 0x9d9a9793); -+ ODM_Write4Byte(pDM_Odm, 0xcb0+pagesel, 0xaaa7a4a1); -+ ODM_Write4Byte(pDM_Odm, 0xcb4+pagesel, 0xb6b3b0ad); -+ -+ // tx_inverse ' Ramp ¤¤¦U©¶ªipower ªº­Ë¼Æ, ¥H­pºâ¥X PA ªº gain -+ ODM_Write4Byte(pDM_Odm, 0xc40+pagesel, 0x02ce03e9); -+ ODM_Write4Byte(pDM_Odm, 0xc44+pagesel, 0x01fd0249); -+ ODM_Write4Byte(pDM_Odm, 0xc48+pagesel, 0x01a101c9); -+ ODM_Write4Byte(pDM_Odm, 0xc4c+pagesel, 0x016a0181); -+ ODM_Write4Byte(pDM_Odm, 0xc50+pagesel, 0x01430155); -+ ODM_Write4Byte(pDM_Odm, 0xc54+pagesel, 0x01270135); -+ ODM_Write4Byte(pDM_Odm, 0xc58+pagesel, 0x0112011c); -+ ODM_Write4Byte(pDM_Odm, 0xc5c+pagesel, 0x01000108); -+ ODM_Write4Byte(pDM_Odm, 0xc60+pagesel, 0x00f100f8); -+ ODM_Write4Byte(pDM_Odm, 0xc64+pagesel, 0x00e500eb); -+ ODM_Write4Byte(pDM_Odm, 0xc68+pagesel, 0x00db00e0); -+ ODM_Write4Byte(pDM_Odm, 0xc6c+pagesel, 0x00d100d5); -+ ODM_Write4Byte(pDM_Odm, 0xc70+pagesel, 0x00c900cd); -+ ODM_Write4Byte(pDM_Odm, 0xc74+pagesel, 0x00c200c5); -+ ODM_Write4Byte(pDM_Odm, 0xc78+pagesel, 0x00bb00be); -+ ODM_Write4Byte(pDM_Odm, 0xc7c+pagesel, 0x00b500b8); -+ -+ //fill BB TX index for the DPK reference -+ // reg82c[31] =1b'0, ¤Á´«¨ì page C -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x002083d5); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc20+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc24+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc28+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc2c+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc30+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc34+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc38+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc3c+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc40+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc44+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc48+pagesel, 0x3c3c3c3c); -+ ODM_Write4Byte(pDM_Odm, 0xc4c+pagesel, 0x3c3c3c3c); -+ -+ // reg82c[31] =1b'1, ¤Á´«¨ì page C1 -+ ODM_Write4Byte(pDM_Odm, 0x82c, 0x802083d5); -+ -+ -+ -+ // r_agc_boudary -+ // PA gain = 11 ¹ïÀ³ tx_agc ±q1f ¨ì11 boundary = b'11111 ' PageC1 ªº bc0[4:0] = 11111 -+ // PA gain = 10 ¹ïÀ³ tx_agc ±q11 ¨ì11 ? boundary = b'10011 ' PageC1 ªº bc0[9:5] = 10001 -+ // PA gain = 01 ¹ïÀ³ tx_agc ±q10 ¨ì0e ? boundary = b'10000 ' PageC1 ªº bc0[14:10] = 10000 -+ // PA gain = 00 ¹ïÀ³ tx_agc ±q0d ¨ì00 ? boundary = b'01101 ' PageC1 ªº bc0[19:15] = 01101 -+ ODM_Write4Byte(pDM_Odm, 0xcbc+pagesel, 0x0006c23f); -+ -+ // r_bnd, ¥t¥~4¶ô PWSF (power scaling factor) ªº boundary, ¦]¬°¥Ø«e¥u¦³¦b PA gain = 11 ®É¤~°µ¸ÉÀv, ©Ò¥H³]¦¨ h'fffff §Y¥i. -+ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x000fffff); -+ -+ //============// -+ // RF setting for DPK // -+ //============// -+ // 00[4:0] = Tx AGC, 00[9:5] = Rx AGC (BB), 00[12:10] = Rx AGC (LNA) -+ // ¦¹³B reg00[4:0] = h'1d, ¬O¥Ñ«e­± gain loss function ±o¨ìªºµ²ªG. -+ ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)(0x0+path), 0x0, bRFRegOffsetMask, 0x517e0 | TXindex); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF 0x0 = 0x%x\n", 0x517e0 | TXindex)); -+ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0xc00c5599); -+ ODM_Write4Byte(pDM_Odm, 0xcc8+pagesel, 0x400c5599); -+ -+ // delay 100 ms -+ ODM_delay_ms(100); -+ -+ // read back dp_fail report -+ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x00000000); -+ -+ //if d00[6] = 1, DPK fail -+ if(ODM_GetBBReg(pDM_Odm, 0xd00+regsel, BIT6)) -+ { -+ //bypass DPK -+ ODM_Write4Byte(pDM_Odm, 0xcc4+pagesel, 0x28848000); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path %s DPK fail!!!!!!!!!!!!!!!!!!!!!\n", (path==0)?"A":"B")); -+ -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path %s DPK ok!!!!!!!!!!!!!!!!!!!!!\n", (path==0)?"A":"B")); -+ -+ -+ -+ //read LMS table -->debug message only -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("read LMS\n")); -+ -+ for(i=0;i<8;i++){ -+ ODM_Write4Byte(pDM_Odm, 0xc90+pagesel, 0x0601f0b8+i); -+ for(j=0;j<4;j++){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8+pagesel, 0x09000000+(j<<24)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0x%x", ODM_Read4Byte(pDM_Odm, 0xd00+regsel))); -+ } -+ } -+ -+ -+ //***************************************// -+ //get gain loss -+ //***************************************// -+ -+ _DPK_GetGainLoss(pDM_Odm,path); -+ -+ -+ //***************************************// -+ //Enable DP -+ //***************************************// -+ -+ _DPK_EnableDP(pDM_Odm, path, TXindex); -+ -+ -+} -+ -+ -+} -+ -+ -+ -+static void -+phy_DPCalibrate_8812A( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte backupRegAddrs[] = { -+ 0x970, 0xcb8, 0x838, 0xc00, 0x90c, 0xb00, 0xc94, 0x82c, 0x520, 0xc60, // 10 -+ 0xc64, 0xc68, 0xc6c, 0xc70, 0xc74, 0xc78, 0xc7c, 0xc80, 0xc84, 0xc50, // 20 -+ 0xc20, 0xc24, 0xc28, 0xc2c, 0xc30, 0xc34, 0xc38, 0xc3c, 0xc40, 0xc44, // 30 -+ 0xc48, 0xc4c, 0xe50, 0xe20, 0xe24, 0xe28, 0xe2c, 0xe30, 0xe34, 0xe38, // 40 -+ 0xe3c, 0xe40, 0xe44, 0xe48, 0xe4c, 0xeb8, 0xe00, 0xe94, 0xe60, 0xe64, //50 -+ 0xe68, 0xe6c, 0xe70, 0xe74, 0xe78, 0xe7c, 0xe80, 0xe84 -+ }; -+ -+ u4Byte backupRegData[sizeof(backupRegAddrs)/sizeof(u4Byte)]; -+ -+ -+ //backup BB&MAC default value -+ -+ _DPK_parabackup(pDM_Odm,backupRegAddrs, backupRegData, sizeof(backupRegAddrs)/sizeof(u4Byte)); -+ -+ //set global parameters -+ _DPK_Globalparaset(pDM_Odm); -+ -+ //DPK -+ _DPK_pathABDPK(pDM_Odm); -+ -+ // TH_DPK=thermalmeter -+ -+ -+ //reload BB&MAC defaul value; -+ _DPK_parareload(pDM_Odm,backupRegAddrs, backupRegData, sizeof(backupRegAddrs)/sizeof(u4Byte)); -+ -+} -+ -+void -+PHY_DPCalibrate_8812A( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> PHY_DPCalibrate_8812A\n")); -+ phy_DPCalibrate_8812A(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<=== PHY_DPCalibrate_8812A\n")); -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8812A.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8812A.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8812A.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8812A.h 2018-02-06 17:42:30.709967150 +0200 -@@ -0,0 +1,90 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PHY_RF_8812A_H__ -+#define __HAL_PHY_RF_8812A_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define IQK_DELAY_TIME_8812A 10 //ms -+#define IQK_DEFERRED_TIME_8812A 4 //sec -+#define index_mapping_NUM_8812A 15 -+#define AVG_THERMAL_NUM_8812A 4 -+#define RF_T_METER_8812A 0x42 -+ -+ -+void ConfigureTxpowerTrack_8812A( -+ PTXPWRTRACK_CFG pConfig -+ ); -+ -+void -+GetDeltaSwingTable_8812A( -+ PDM_ODM_T pDM_Odm, -+ pu1Byte *TemperatureUP_A, -+ pu1Byte *TemperatureDOWN_A, -+ pu1Byte *TemperatureUP_B, -+ pu1Byte *TemperatureDOWN_B -+ ); -+ -+void DoIQK_8812A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ); -+ -+void -+ODM_TxPwrTrackSetPwr8812A( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ); -+ -+//1 7. IQK -+ -+void -+PHY_IQCalibrate_8812A( -+ PADAPTER pAdapter, -+ bool bReCovery -+); -+ -+ -+// -+// LC calibrate -+// -+void -+PHY_LCCalibrate_8812A( -+ PDM_ODM_T pDM_Odm -+); -+ -+// -+// AP calibrate -+// -+void -+PHY_APCalibrate_8812A(PADAPTER pAdapter, s1Byte delta); -+void -+PHY_DigitalPredistortion_8812A(PADAPTER pAdapter); -+ -+void -+PHY_DPCalibrate_8812A( -+ PDM_ODM_T pDM_Odm -+); -+void PHY_SetRFPathSwitch_8812A( -+ PADAPTER pAdapter, -+ bool bMain -+ ); -+ -+ -+#endif // #ifndef __HAL_PHY_RF_8812A_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8821A.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8821A.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8821A.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8821A.c 2018-02-06 17:42:30.709967150 +0200 -@@ -0,0 +1,1347 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+//#include "Mp_Precomp.h" -+#include "odm_precomp.h" -+ -+ -+ -+/*---------------------------Define Local Constant---------------------------*/ -+// 2010/04/25 MH Define the max tx power tracking tx agc power. -+#define ODM_TXPWRTRACK_MAX_IDX8821A 6 -+ -+/*---------------------------Define Local Constant---------------------------*/ -+ -+ -+//3 ============================================================ -+//3 Tx Power Tracking -+//3 ============================================================ -+ -+ -+static void setIqkMatrix_8821A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte OFDM_index, -+ u1Byte RFPath, -+ s4Byte IqkResult_X, -+ s4Byte IqkResult_Y -+ ) -+{ -+ s4Byte ele_A=0, ele_D, ele_C=0, value32; -+ -+ ele_D = (OFDMSwingTable_New[OFDM_index] & 0xFFC00000)>>22; -+ -+ //new element A = element D x X -+ if((IqkResult_X != 0) && (*(pDM_Odm->pBandType) == ODM_BAND_2_4G)) -+ { -+ if ((IqkResult_X & 0x00000200) != 0) //consider minus -+ IqkResult_X = IqkResult_X | 0xFFFFFC00; -+ ele_A = ((IqkResult_X * ele_D)>>8)&0x000003FF; -+ -+ //new element C = element D x Y -+ if ((IqkResult_Y & 0x00000200) != 0) -+ IqkResult_Y = IqkResult_Y | 0xFFFFFC00; -+ ele_C = ((IqkResult_Y * ele_D)>>8)&0x000003FF; -+ -+ if (RFPath == ODM_RF_PATH_A) -+ switch (RFPath) -+ { -+ case ODM_RF_PATH_A: -+ //wirte new elements A, C, D to regC80 and regC94, element B is always 0 -+ value32 = (ele_D<<22)|((ele_C&0x3F)<<16)|ele_A; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord, value32); -+ -+ value32 = (ele_C&0x000003C0)>>6; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, bMaskH4Bits, value32); -+ -+ value32 = ((IqkResult_X * ele_D)>>7)&0x01; -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT24, value32); -+ break; -+ default: -+ break; -+ } -+ } -+ else -+ { -+ switch (RFPath) -+ { -+ case ODM_RF_PATH_A: -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord, OFDMSwingTable_New[OFDM_index]); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, bMaskH4Bits, 0x00); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT24, 0x00); -+ break; -+ -+ default: -+ break; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("TxPwrTracking path B: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x 0xeb4 = 0x%x 0xebc = 0x%x\n", -+ (u4Byte)IqkResult_X, (u4Byte)IqkResult_Y, (u4Byte)ele_A, (u4Byte)ele_C, (u4Byte)ele_D, (u4Byte)IqkResult_X, (u4Byte)IqkResult_Y)); -+} -+ -+void DoIQK_8821A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ ODM_ResetIQKResult(pDM_Odm); -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; -+ PHY_IQCalibrate_8821A(Adapter, false); -+} -+ -+void -+ODM_TxPwrTrackSetPwr8821A( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ u1Byte PwrTrackingLimit = 26; //+1.0dB -+ u1Byte TxRate = 0xFF; -+ s1Byte Final_OFDM_Swing_Index = 0; -+ s1Byte Final_CCK_Swing_Index = 0; -+ u1Byte i = 0; -+ u4Byte finalBbSwingIdx[1]; -+ -+ -+#if 0 //gtemp -+#if (MP_DRIVER==1) -+ //PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); -+ PMPT_CONTEXT pMptCtx = &Adapter->mppriv.MptCtx; -+ TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -+#else -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ -+ if(!pMgntInfo->ForcedDataRate) //auto rate -+ { -+ if(pDM_Odm->TxRate != 0xFF) -+ TxRate = HwRateToMRate8812(pDM_Odm->TxRate); -+ } -+ else //force rate -+ { -+ TxRate = (u1Byte) pMgntInfo->ForcedDataRate; -+ } -+#endif -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8821A\n")); -+ -+ if(TxRate != 0xFF) -+ { -+ //2 CCK -+ if((TxRate >= MGN_1M)&&(TxRate <= MGN_11M)) -+ PwrTrackingLimit = 32; //+4dB -+ //2 OFDM -+ else if((TxRate >= MGN_6M)&&(TxRate <= MGN_48M)) -+ PwrTrackingLimit = 32; //+4dB -+ else if(TxRate == MGN_54M) -+ PwrTrackingLimit = 30; //+3dB -+ //2 HT -+ else if((TxRate >= MGN_MCS0)&&(TxRate <= MGN_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_MCS3)&&(TxRate <= MGN_MCS4)) //16QAM -+ PwrTrackingLimit = 32; //+4dB -+ else if((TxRate >= MGN_MCS5)&&(TxRate <= MGN_MCS7)) //64QAM -+ PwrTrackingLimit = 30; //+3dB -+ //2 VHT -+ else if((TxRate >= MGN_VHT1SS_MCS0)&&(TxRate <= MGN_VHT1SS_MCS2)) //QPSK/BPSK -+ PwrTrackingLimit = 34; //+5dB -+ else if((TxRate >= MGN_VHT1SS_MCS3)&&(TxRate <= MGN_VHT1SS_MCS4)) //16QAM -+ PwrTrackingLimit = 32; //+4dB -+ else if((TxRate >= MGN_VHT1SS_MCS5)&&(TxRate <= MGN_VHT1SS_MCS6)) //64QAM -+ PwrTrackingLimit = 30; //+3dB -+ else if(TxRate == MGN_VHT1SS_MCS7) //64QAM -+ PwrTrackingLimit = 28; //+2dB -+ else if(TxRate == MGN_VHT1SS_MCS8) //256QAM -+ PwrTrackingLimit = 26; //+1dB -+ else if(TxRate == MGN_VHT1SS_MCS9) //256QAM -+ PwrTrackingLimit = 24; //+0dB -+ else -+ PwrTrackingLimit = 24; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("TxRate=0x%x, PwrTrackingLimit=%d\n", TxRate, PwrTrackingLimit)); -+ -+ if (Method == BBSWING) -+ { -+ if (RFPath == ODM_RF_PATH_A) -+ { -+ finalBbSwingIdx[ODM_RF_PATH_A] = (pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A] > PwrTrackingLimit) ? PwrTrackingLimit : pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A]; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A]=%d, pDM_Odm->RealBbSwingIdx[ODM_RF_PATH_A]=%d\n", -+ pDM_Odm->RFCalibrateInfo.OFDM_index[ODM_RF_PATH_A], finalBbSwingIdx[ODM_RF_PATH_A])); -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[finalBbSwingIdx[ODM_RF_PATH_A]]); -+ } -+ } -+ else if (Method == MIX_MODE) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("pDM_Odm->DefaultOfdmIndex=%d, pDM_Odm->Aboslute_OFDMSwingIdx[RFPath]=%d, RF_Path = %d\n", -+ pDM_Odm->DefaultOfdmIndex, pDM_Odm->Aboslute_OFDMSwingIdx[RFPath],RFPath )); -+ -+ -+ Final_OFDM_Swing_Index = pDM_Odm->DefaultOfdmIndex + pDM_Odm->Aboslute_OFDMSwingIdx[RFPath]; -+ -+ if (RFPath == ODM_RF_PATH_A) -+ { -+ if(Final_OFDM_Swing_Index > PwrTrackingLimit) //BBSwing higher then Limit -+ { -+ pDM_Odm->Remnant_CCKSwingIdx= Final_OFDM_Swing_Index - PwrTrackingLimit; // CCK Follow the same compensate value as Path A -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit; -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[PwrTrackingLimit]); -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathA= true; -+ -+ //Set TxAGC Page C{}; -+ //Adapter->HalFunc.SetTxPowerLevelHandler(Adapter, pHalData->CurrentChannel); -+ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit, pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else if (Final_OFDM_Swing_Index < 0) -+ { -+ pDM_Odm->Remnant_CCKSwingIdx= Final_OFDM_Swing_Index; // CCK Follow the same compensate value as Path A -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index; -+ -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[0]); -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathA= true; -+ -+ //Set TxAGC Page C{}; -+ //Adapter->HalFunc.SetTxPowerLevelHandler(Adapter, pHalData->CurrentChannel); -+ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pDM_Odm->Remnant_OFDMSwingIdx[RFPath])); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, rA_TxScale_Jaguar, 0xFFE00000, TxScalingTable_Jaguar[Final_OFDM_Swing_Index]); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); -+ -+ if(pDM_Odm->Modify_TxAGC_Flag_PathA) //If TxAGC has changed, reset TxAGC again -+ { -+ pDM_Odm->Remnant_CCKSwingIdx= 0; -+ pDM_Odm->Remnant_OFDMSwingIdx[RFPath] = 0; -+ -+ //Set TxAGC Page C{}; -+ //Adapter->HalFunc.SetTxPowerLevelHandler(Adapter, pHalData->CurrentChannel); -+ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathA= false; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Path_A pDM_Odm->Modify_TxAGC_Flag = false \n")); -+ } -+ } -+ } -+ -+ } -+ else -+ { -+ return; -+ } -+} // odm_TxPwrTrackSetPwr88E -+ -+void -+GetDeltaSwingTable_8821A( -+ PDM_ODM_T pDM_Odm, -+ pu1Byte *TemperatureUP_A, -+ pu1Byte *TemperatureDOWN_A, -+ pu1Byte *TemperatureUP_B, -+ pu1Byte *TemperatureDOWN_B -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ //u2Byte rate = pMgntInfo->ForcedDataRate; -+ u2Byte rate = 0; -+ u1Byte channel = pHalData->CurrentChannel; -+ -+ -+ if ( 1 <= channel && channel <= 14) { -+ if (IS_CCK_RATE(rate)) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N; -+ } else { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N; -+ } -+ } else if ( 36 <= channel && channel <= 64) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0]; -+ } else if ( 100 <= channel && channel <= 140) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1]; -+ } else if ( 149 <= channel && channel <= 173) { -+ *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2]; -+ *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2]; -+ *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2]; -+ *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2]; -+ } else { -+ *TemperatureUP_A = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_A = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ *TemperatureUP_B = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; -+ *TemperatureDOWN_B = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; -+ } -+ -+ return; -+} -+ -+void ConfigureTxpowerTrack_8821A( -+ PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ pConfig->SwingTableSize_CCK = TXSCALE_TABLE_SIZE; -+ pConfig->SwingTableSize_OFDM = TXSCALE_TABLE_SIZE; -+ pConfig->Threshold_IQK = IQK_THRESHOLD; -+ pConfig->AverageThermalNum = AVG_THERMAL_NUM_8812A; -+ pConfig->RfPathCount = MAX_PATH_NUM_8821A; -+ pConfig->ThermalRegAddr = RF_T_METER_8812A; -+ -+ pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr8821A; -+ pConfig->DoIQK = DoIQK_8821A; -+ pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8821A; -+ pConfig->GetDeltaSwingTable = GetDeltaSwingTable_8821A; -+} -+ -+//1 7. IQK -+#define MAX_TOLERANCE 5 -+#define IQK_DELAY_TIME 1 //ms -+ -+static void _IQK_RX_FillIQC_8821A( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_RADIO_PATH_E Path, -+ unsigned int RX_X, -+ unsigned int RX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, RX_X>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, RX_Y>>1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X = %x;;RX_Y = %x ====>fill to IQC\n", RX_X>>1, RX_Y>>1)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc10 = %x ====>fill to IQC\n", ODM_Read4Byte(pDM_Odm, 0xc10))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+static void _IQK_TX_FillIQC_8821A( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_RADIO_PATH_E Path, -+ unsigned int TX_X, -+ unsigned int TX_Y -+ ) -+{ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc90, 0x00000080); -+ ODM_Write4Byte(pDM_Odm, 0xcc4, 0x20040000); -+ ODM_Write4Byte(pDM_Odm, 0xcc8, 0x20000000); -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, TX_Y); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, TX_X); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X = %x;;TX_Y = %x =====> fill to IQC\n", TX_X, TX_Y)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xcd4 = %x;;0xccc = %x ====>fill to IQC\n", ODM_GetBBReg(pDM_Odm, 0xcd4, 0x000007ff), ODM_GetBBReg(pDM_Odm, 0xccc, 0x000007ff))); -+ } -+ break; -+ default: -+ break; -+ }; -+} -+ -+static void _IQK_BackupMacBB_8821A( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte MACBB_backup, -+ pu4Byte Backup_MACBB_REG, -+ u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //save MACBB default value -+ for (i = 0; i < MACBB_NUM; i++){ -+ MACBB_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_MACBB_REG[i]); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupMacBB Success!!!!\n")); -+} -+ -+static void _IQK_BackupRF_8821A( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte RFA_backup, -+ pu4Byte RFB_backup, -+ pu4Byte Backup_RF_REG, -+ u4Byte RF_NUM -+ ) -+{ -+ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save RF Parameters -+ for (i = 0; i < RF_NUM; i++){ -+ RFA_backup[i] = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG[i], bMaskDWord); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupRF Success!!!!\n")); -+} -+ -+static void _IQK_BackupAFE_8821A( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte AFE_backup, -+ pu4Byte Backup_AFE_REG, -+ u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Save AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ AFE_backup[i] = ODM_Read4Byte(pDM_Odm, Backup_AFE_REG[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BackupAFE Success!!!!\n")); -+} -+ -+static void _IQK_RestoreMacBB_8821A( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte MACBB_backup, -+ pu4Byte Backup_MACBB_REG, -+ u4Byte MACBB_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload MacBB Parameters -+ for (i = 0; i < MACBB_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_MACBB_REG[i], MACBB_backup[i]); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreMacBB Success!!!!\n")); -+} -+ -+static void _IQK_RestoreRF_8821A( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_RADIO_PATH_E Path, -+ pu4Byte Backup_RF_REG, -+ pu4Byte RF_backup, -+ u4Byte RF_REG_NUM -+ ) -+{ -+ u4Byte i; -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ for (i = 0; i < RF_REG_NUM; i++) -+ ODM_SetRFReg(pDM_Odm, Path, Backup_RF_REG[i], bRFRegOffsetMask, RF_backup[i]); -+ -+ switch(Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreRF Path A Success!!!!\n")); -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+static void _IQK_RestoreAFE_8821A( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte AFE_backup, -+ pu4Byte Backup_AFE_REG, -+ u4Byte AFE_NUM -+ ) -+{ -+ u4Byte i; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ //Reload AFE Parameters -+ for (i = 0; i < AFE_NUM; i++){ -+ ODM_Write4Byte(pDM_Odm, Backup_AFE_REG[i], AFE_backup[i]); -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x3c000000); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x0); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RestoreAFE Success!!!!\n")); -+} -+ -+static void _IQK_ConfigureMAC_8821A( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ // ========MAC register setting======== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_Write1Byte(pDM_Odm, 0x522, 0x3f); -+ ODM_SetBBReg(pDM_Odm, 0x550, BIT(3), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x551, BIT(3), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT(28), 0x0); // CCK Off -+ ODM_Write1Byte(pDM_Odm, 0x808, 0x00); // RX ante off -+ ODM_SetBBReg(pDM_Odm, 0x838, 0xf, 0xc); // CCA off -+} -+ -+#define cal_num 3 -+ -+static void _IQK_Tx_8821A( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_RADIO_PATH_E Path -+ ) -+{ -+ u4Byte TX_fail, RX_fail, delay_count, IQK_ready, cal_retry, cal = 0, temp_reg65; -+ int TX_X = 0, TX_Y = 0, RX_X = 0, RX_Y = 0, TX_Average = 0, RX_Average = 0; -+ int TX_X0[cal_num], TX_Y0[cal_num], TX_X0_RXK[cal_num], TX_Y0_RXK[cal_num], RX_X0[cal_num], RX_Y0[cal_num]; -+ bool TX0IQKOK = false, RX0IQKOK = false; -+ bool VDF_enable = false; -+ int i, k, VDF_Y[3], VDF_X[3], Tx_dt[3], Rx_dt[3], ii, dx = 0, dy = 0, TX_finish = 0, RX_finish = 0; -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BandWidth = %d\n", *pDM_Odm->pBandWidth)); -+ if (*pDM_Odm->pBandWidth == 2){ -+ VDF_enable = true; -+ } -+ -+ while (cal < cal_num){ -+ switch (Path) { -+ case ODM_RF_PATH_A: -+ { -+ temp_reg65 = ODM_GetRFReg(pDM_Odm, Path, 0x65, bMaskDWord); -+ -+ if (pDM_Odm->ExtPA){ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ } -+ -+ //Path-A LOK -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // ========Path-A AFE all on======== -+ // Port 0 DAC/ADC on -+ ODM_Write4Byte(pDM_Odm, 0xc60, 0x77777777); -+ ODM_Write4Byte(pDM_Odm, 0xc64, 0x77777777); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc68, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc6c, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc70, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc74, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc78, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc7c, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x19791979); -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x19791979); -+ -+ ODM_SetBBReg(pDM_Odm, 0xc00, 0xf, 0x4);// hardware 3-wire off -+ -+ // LOK Setting -+ //====== LOK ====== -+ // 1. DAC/ADC sampling rate (160 MHz) -+ ODM_SetBBReg(pDM_Odm, 0xc5c, BIT(26)|BIT(25)|BIT(24), 0x7); -+ -+ // 2. LoK RF Setting (at BW = 20M) -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80002); -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x3); // BW 20M -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0003f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xf3fc3); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_SetBBReg(pDM_Odm, 0xcb8, 0xf, 0xd); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x00462910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f4); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28163e96); -+ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0x58, 0x7fe00, ODM_GetRFReg(pDM_Odm, Path, 0x8, 0xffc00)); // Load LOK -+ switch (*pDM_Odm->pBandWidth) -+ { -+ case 1: -+ { -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x1); -+ } -+ break; -+ case 2: -+ { -+ ODM_SetRFReg(pDM_Odm, Path, 0x18, 0x00c00, 0x0); -+ } -+ break; -+ default: -+ break; -+ -+ } -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ // 3. TX RF Setting -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x20000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0003f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xf3fc3); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d5); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ ODM_SetBBReg(pDM_Odm, 0xcb8, 0xf, 0xd); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); -+ ODM_SetBBReg(pDM_Odm, 0xc94, BIT(0), 0x1); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ -+ if (pDM_Odm->ExtPA) -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f7); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821403f1); -+ -+ if (*pDM_Odm->pBandType) -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x40163e96); -+ else -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x00163e96); -+ -+ if (VDF_enable == 1){ -+ DbgPrint("VDF_enable\n"); -+ for (k = 0;k <= 2; k++){ -+ switch (k){ -+ case 0: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); -+ } -+ break; -+ case 1: -+ { -+ ODM_SetBBReg(pDM_Odm, 0xc80, BIT(28), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xc84, BIT(28), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); -+ } -+ break; -+ case 2: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Tx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ Tx_dt[cal] = ((16*Tx_dt[cal])*10000/15708); -+ Tx_dt[cal] = (Tx_dt[cal] >> 1 )+(Tx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x3fff0000, Tx_dt[cal] & 0x00003fff); -+ } -+ break; -+ default: -+ break; -+ } -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready) || (delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = true; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ TX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10){ -+ break; -+ } -+ } -+ } -+ } -+ if (k == 3){ -+ TX_X0[cal] = VDF_X[k-1] ; -+ TX_Y0[cal] = VDF_Y[k-1]; -+ } -+ } -+ else{ -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready) || (delay_count>20)) { -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ TX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ TX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = true; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xccc, 0x000007ff, 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcd4, 0x000007ff, 0x200); -+ TX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) { -+ break; -+ } -+ } -+ } -+ else{ -+ TX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ } -+ -+ -+ if (TX0IQKOK == false) -+ break; // TXK fail, Don't do RXK -+ -+ if (VDF_enable == 1){ -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x0); // TX VDF Disable -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXVDF Start\n")); -+ for (k = 0;k <= 2; k++){ -+ //====== RX mode TXK (RXK Step 1) ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // 1. TX RF Setting -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x00029); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xd7ffb); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, temp_reg65); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ -+ ODM_SetBBReg(pDM_Odm, 0xcb8, 0xf, 0xd); -+ ODM_Write4Byte(pDM_Odm, 0x978, 0x29002000);// TX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x97c, 0xa9002000);// RX (X,Y) -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ switch (k){ -+ case 0: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(30), 0x0); -+ } -+ break; -+ case 1: -+ { -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x08008c38);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x28008c38);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(30), 0x0); -+ } -+ break; -+ case 2: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_Y[1] = %x;;;VDF_Y[0] = %x\n", VDF_Y[1]>>21 & 0x00007ff, VDF_Y[0]>>21 & 0x00007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("VDF_X[1] = %x;;;VDF_X[0] = %x\n", VDF_X[1]>>21 & 0x00007ff, VDF_X[0]>>21 & 0x00007ff)); -+ Rx_dt[cal] = (VDF_Y[1]>>20)-(VDF_Y[0]>>20); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Rx_dt = %d\n", Rx_dt[cal])); -+ Rx_dt[cal] = ((16*Rx_dt[cal])*10000/13823); -+ Rx_dt[cal] = (Rx_dt[cal] >> 1 )+(Rx_dt[cal] & BIT(0)); -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c20);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c20);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_SetBBReg(pDM_Odm, 0xce8, 0x00003fff, Rx_dt[cal] & 0x00003fff); -+ } -+ break; -+ default: -+ break; -+ } -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821603e0); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ TX_X0_RXK[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ TX_Y0_RXK[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = true; -+ break; -+ } -+ else{ -+ TX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ else{ -+ TX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ -+ if (TX0IQKOK == false){ //If RX mode TXK fail, then take TXK Result -+ TX_X0_RXK[cal] = TX_X0[cal]; -+ TX_Y0_RXK[cal] = TX_Y0[cal]; -+ TX0IQKOK = true; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RXK Step 1 fail\n")); -+ } -+ -+ -+ //====== RX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // 1. RX RF Setting -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0002f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfffbb); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d8); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X0_RXK[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y0_RXK[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcb8, 0xF, 0xe); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_SetBBReg(pDM_Odm, 0xc80, BIT(29), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0xc84, BIT(29), 0x0); -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161420); -+ -+ if (k==2){ -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(30), 0x1); //RX VDF Enable -+ } -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); -+ if (RX_fail == 0){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ VDF_X[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ VDF_Y[k] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ RX0IQKOK = true; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); -+ RX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ -+ } -+ } -+ else{ -+ RX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ -+ } -+ if (k == 3){ -+ RX_X0[cal] = VDF_X[k-1] ; -+ RX_Y0[cal] = VDF_Y[k-1]; -+ } -+ ODM_SetBBReg(pDM_Odm, 0xce8, BIT(31), 0x1); // TX VDF Enable -+ } -+ else{ -+ //====== RX mode TXK (RXK Step 1) ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // 1. TX RF Setting -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x00029); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xd7ffb); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, temp_reg65); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x8a001); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0xb00, 0x03000100); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a910);// [0]:AGC_en, [15]:idac_K_Mask -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x18008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x38008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x821603e0); -+ //ODM_Write4Byte(pDM_Odm, 0xc8c, 0x68163e96); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============TXIQK Check============== -+ TX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(12)); -+ -+ if (~TX_fail){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x02000000); -+ TX_X0_RXK[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x04000000); -+ TX_Y0_RXK[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ TX0IQKOK = true; -+ break; -+ } -+ else{ -+ TX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ else{ -+ TX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ -+ -+ if (TX0IQKOK == false){ //If RX mode TXK fail, then take TXK Result -+ TX_X0_RXK[cal] = TX_X0[cal]; -+ TX_Y0_RXK[cal] = TX_Y0[cal]; -+ TX0IQKOK = true; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("1")); -+ } -+ -+ -+ //====== RX IQK ====== -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ // 1. RX RF Setting -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x80000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x30, bRFRegOffsetMask, 0x30000); -+ ODM_SetRFReg(pDM_Odm, Path, 0x31, bRFRegOffsetMask, 0x0002f); -+ ODM_SetRFReg(pDM_Odm, Path, 0x32, bRFRegOffsetMask, 0xfffbb); -+ ODM_SetRFReg(pDM_Odm, Path, 0x8f, bRFRegOffsetMask, 0x88001); -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, 0x931d8); -+ ODM_SetRFReg(pDM_Odm, Path, 0xef, bRFRegOffsetMask, 0x00000); -+ -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x03FF8000, (TX_X0_RXK[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, 0x000007FF, (TX_Y0_RXK[cal])>>21&0x000007ff); -+ ODM_SetBBReg(pDM_Odm, 0x978, BIT(31), 0x1); -+ ODM_SetBBReg(pDM_Odm, 0x97c, BIT(31), 0x0); -+ ODM_SetBBReg(pDM_Odm, 0xcb8, 0xF, 0xe); -+ ODM_Write4Byte(pDM_Odm, 0x90c, 0x00008000); -+ ODM_Write4Byte(pDM_Odm, 0x984, 0x0046a911); -+ -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); // [31] = 1 --> Page C1 -+ ODM_Write4Byte(pDM_Odm, 0xc80, 0x38008c10);// TX_Tone_idx[9:0], TxK_Mask[29] TX_Tone = 16 -+ ODM_Write4Byte(pDM_Odm, 0xc84, 0x18008c10);// RX_Tone_idx[9:0], RxK_Mask[29] -+ ODM_Write4Byte(pDM_Odm, 0xc88, 0x02140119); -+ ODM_Write4Byte(pDM_Odm, 0xc8c, 0x28161440); -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00100000);// cb8[20] ±N SI/PI ¨Ï¥ÎÅv¤Áµ¹ iqk_dpk module -+ -+ cal_retry = 0; -+ while(1){ -+ // one shot -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xfa000000); -+ ODM_Write4Byte(pDM_Odm, 0x980, 0xf8000000); -+ -+ ODM_delay_ms(10); //Delay 10ms -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x00000000); -+ delay_count = 0; -+ while (1){ -+ IQK_ready = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(10)); -+ if ((~IQK_ready)||(delay_count>20)){ -+ break; -+ } -+ else{ -+ ODM_delay_ms(1); -+ delay_count++; -+ } -+ } -+ -+ if (delay_count < 20){ // If 20ms No Result, then cal_retry++ -+ // ============RXIQK Check============== -+ RX_fail = ODM_GetBBReg(pDM_Odm, 0xd00, BIT(11)); -+ if (RX_fail == 0){ -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x06000000); -+ RX_X0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ ODM_Write4Byte(pDM_Odm, 0xcb8, 0x08000000); -+ RX_Y0[cal] = ODM_GetBBReg(pDM_Odm, 0xd00, 0x07ff0000)<<21; -+ RX0IQKOK = true; -+ break; -+ } -+ else{ -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x000003ff, 0x200>>1); -+ ODM_SetBBReg(pDM_Odm, 0xc10, 0x03ff0000, 0x0>>1); -+ RX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ -+ } -+ } -+ else{ -+ RX0IQKOK = false; -+ cal_retry++; -+ if (cal_retry == 10) -+ break; -+ } -+ } -+ } -+ if (TX0IQKOK) -+ TX_Average++; -+ if (RX0IQKOK) -+ RX_Average++; -+ ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); // [31] = 0 --> Page C -+ ODM_SetRFReg(pDM_Odm, Path, 0x65, bRFRegOffsetMask, temp_reg65); -+ } -+ break; -+ default: -+ break; -+ } -+ cal++; -+ } -+ // FillIQK Result -+ switch (Path){ -+ case ODM_RF_PATH_A: -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("========Path_A =======\n")); -+ if (TX_Average == 0) -+ break; -+ -+ for (i = 0; i < TX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, (" TX_X0_RXK[%d] = %x ;; TX_Y0_RXK[%d] = %x\n", i, (TX_X0_RXK[i])>>21&0x000007ff, i, (TX_Y0_RXK[i])>>21&0x000007ff)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("TX_X0[%d] = %x ;; TX_Y0[%d] = %x\n", i, (TX_X0[i])>>21&0x000007ff, i, (TX_Y0[i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < TX_Average; i++){ -+ for (ii = i+1; ii >21) - (TX_X0[ii]>>21); -+ if (dx < 3 && dx > -3){ -+ dy = (TX_Y0[i]>>21) - (TX_Y0[ii]>>21); -+ if (dy < 3 && dy > -3){ -+ TX_X = ((TX_X0[i]>>21) + (TX_X0[ii]>>21))/2; -+ TX_Y = ((TX_Y0[i]>>21) + (TX_Y0[ii]>>21))/2; -+ TX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (TX_finish == 1) -+ break; -+ } -+ -+ if (TX_finish == 1){ -+ _IQK_TX_FillIQC_8821A(pDM_Odm, Path, TX_X, TX_Y); -+ } -+ else{ -+ _IQK_TX_FillIQC_8821A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ -+ if (RX_Average == 0) -+ break; -+ -+ for (i = 0; i < RX_Average; i++){ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RX_X0[%d] = %x ;; RX_Y0[%d] = %x\n", i, (RX_X0[i])>>21&0x000007ff, i, (RX_Y0[i])>>21&0x000007ff)); -+ } -+ for (i = 0; i < RX_Average; i++){ -+ for (ii = i+1; ii >21) - (RX_X0[ii]>>21); -+ if (dx < 3 && dx > -3){ -+ dy = (RX_Y0[i]>>21) - (RX_Y0[ii]>>21); -+ if (dy < 3 && dy > -3){ -+ RX_X = ((RX_X0[i]>>21) + (RX_X0[ii]>>21))/2; -+ RX_Y = ((RX_Y0[i]>>21) + (RX_Y0[ii]>>21))/2; -+ RX_finish = 1; -+ break; -+ } -+ } -+ } -+ if (RX_finish == 1) -+ break; -+ } -+ -+ if (RX_finish == 1){ -+ _IQK_RX_FillIQC_8821A(pDM_Odm, Path, RX_X, RX_Y); -+ } -+ else{ -+ _IQK_RX_FillIQC_8821A(pDM_Odm, Path, 0x200, 0x0); -+ } -+ } -+ break; -+ default: -+ break; -+ } -+} -+ -+#define MACBB_REG_NUM 11 -+#define AFE_REG_NUM 12 -+#define RF_REG_NUM 3 -+ -+static void phy_IQCalibrate_By_FW_8821A( -+ PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u1Byte IQKcmd[3] = {pHalData->CurrentChannel, 0x0, 0x0}; -+ u1Byte Buf1 = 0x0; -+ u1Byte Buf2 = 0x0; -+ -+//Byte 2, Bit 4 ~ Bit 5 : BandType -+ if(pHalData->CurrentBandType) -+ Buf1 = 0x2<<4; -+ else -+ Buf1 = 0x1<<4; -+ -+//Byte 2, Bit 0 ~ Bit 3 : Bandwidth -+ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) -+ Buf2 = 0x1; -+ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) -+ Buf2 = 0x1<<1; -+ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) -+ Buf2 = 0x1<<2; -+ else -+ Buf2 = 0x1<<3; -+ -+ IQKcmd[1] = Buf1 | Buf2; -+ IQKcmd[2] = pHalData->ExternalPA_5G | pHalData->ExternalLNA_5G<<1; -+ -+ -+ //RT_TRACE(COMP_MP, DBG_LOUD, ("== IQK Start ==\n")); -+ -+ //FillH2CCmd_8812(pAdapter, 0x45, 3, IQKcmd); -+ -+} -+ -+static void phy_IQCalibrate_8821A( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte MACBB_backup[MACBB_REG_NUM], AFE_backup[AFE_REG_NUM], RFA_backup[RF_REG_NUM], RFB_backup[RF_REG_NUM]; -+ u4Byte Backup_MACBB_REG[MACBB_REG_NUM] = {0xb00, 0x520, 0x550, 0x808, 0x90c, 0xc00, 0xc50, 0xe00, 0xe50, 0x838, 0x82c}; -+ u4Byte Backup_AFE_REG[AFE_REG_NUM] = {0xc5c, 0xc60, 0xc64, 0xc68, 0xc6c, 0xc70, 0xc74, 0xc78, 0xc7c, 0xc80, 0xc84, 0xcb8}; -+ u4Byte Backup_RF_REG[RF_REG_NUM] = {0x65, 0x8f, 0x0}; -+ -+ _IQK_BackupMacBB_8821A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); -+ _IQK_BackupAFE_8821A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); -+ _IQK_BackupRF_8821A(pDM_Odm, RFA_backup, RFB_backup, Backup_RF_REG, RF_REG_NUM); -+ -+ _IQK_ConfigureMAC_8821A(pDM_Odm); -+ _IQK_Tx_8821A(pDM_Odm, ODM_RF_PATH_A); -+ _IQK_RestoreRF_8821A(pDM_Odm, ODM_RF_PATH_A, Backup_RF_REG, RFA_backup, RF_REG_NUM); -+ -+ _IQK_RestoreAFE_8821A(pDM_Odm, AFE_backup, Backup_AFE_REG, AFE_REG_NUM); -+ _IQK_RestoreMacBB_8821A(pDM_Odm, MACBB_backup, Backup_MACBB_REG, MACBB_REG_NUM); -+ -+ //_IQK_Exit_8821A(pDM_Odm); -+ //_IQK_TX_CheckResult_8821A -+ -+} -+ -+ -+ -+ -+#define DP_BB_REG_NUM 7 -+#define DP_RF_REG_NUM 1 -+#define DP_RETRY_LIMIT 10 -+#define DP_PATH_NUM 2 -+#define DP_DPK_NUM 3 -+#define DP_DPK_VALUE_NUM 2 -+ -+ -+ -+ -+ -+void -+PHY_IQCalibrate_8821A( -+ PADAPTER pAdapter, -+ bool bReCovery -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+#if (MP_DRIVER == 1) -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+#endif//(MP_DRIVER == 1) -+ -+#if MP_DRIVER == 1 -+ if( ! (pMptCtx->bSingleTone || pMptCtx->bCarrierSuppression) ) -+#endif -+ { -+ phy_IQCalibrate_8821A(pDM_Odm); -+ } -+} -+ -+ -+void -+PHY_LCCalibrate_8821A( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PHY_LCCalibrate_8812A(pDM_Odm); -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8821A.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8821A.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf_8821A.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf_8821A.h 2018-02-06 17:42:30.709967150 +0200 -@@ -0,0 +1,73 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PHY_RF_8821A_H__ -+#define __HAL_PHY_RF_8821A_H__ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define IQK_DELAY_TIME_8821A 10 //ms -+#define index_mapping_NUM_8821A 15 -+#define AVG_THERMAL_NUM_8821A 4 -+#define RF_T_METER_8821A 0x42 -+ -+ -+void ConfigureTxpowerTrack_8821A( -+ PTXPWRTRACK_CFG pConfig -+ ); -+ -+void DoIQK_8821A( -+ PDM_ODM_T pDM_Odm, -+ u1Byte DeltaThermalIndex, -+ u1Byte ThermalValue, -+ u1Byte Threshold -+ ); -+ -+void -+ODM_TxPwrTrackSetPwr8821A( -+ PDM_ODM_T pDM_Odm, -+ PWRTRACK_METHOD Method, -+ u1Byte RFPath, -+ u1Byte ChannelMappedIndex -+ ); -+ -+//1 7. IQK -+ -+void -+PHY_IQCalibrate_8821A( -+ PADAPTER pAdapter, -+ bool bReCovery -+); -+ -+void -+PHY_LCCalibrate_8821A( -+ PDM_ODM_T pDM_Odm -+); -+ -+void -+GetDeltaSwingTable_8821A( -+ PDM_ODM_T pDM_Odm, -+ pu1Byte *TemperatureUP_A, -+ pu1Byte *TemperatureDOWN_A, -+ pu1Byte *TemperatureUP_B, -+ pu1Byte *TemperatureDOWN_B -+); -+ -+void PHY_SetRFPathSwitch_8821A( -+ PADAPTER pAdapter, -+ bool bMain -+ ); -+ -+ -+#endif // #ifndef __HAL_PHY_RF_8821A_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/HalPhyRf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/HalPhyRf.c 2018-02-06 17:42:30.708967135 +0200 -@@ -0,0 +1,467 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ #include "odm_precomp.h" -+ -+ -+ -+#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ -+ do {\ -+ for(_offset = 0; _offset < _size; _offset++)\ -+ {\ -+ if(_deltaThermal < thermalThreshold[_direction][_offset])\ -+ {\ -+ if(_offset != 0)\ -+ _offset--;\ -+ break;\ -+ }\ -+ } \ -+ if(_offset >= _size)\ -+ _offset = _size-1;\ -+ } while(0) -+ -+ -+void ConfigureTxpowerTrack( -+ PDM_ODM_T pDM_Odm, -+ PTXPWRTRACK_CFG pConfig -+ ) -+{ -+ if(pDM_Odm->SupportICType==ODM_RTL8821) -+ ConfigureTxpowerTrack_8821A(pConfig); -+ if(pDM_Odm->SupportICType==ODM_RTL8812) -+ ConfigureTxpowerTrack_8812A(pConfig); -+} -+ -+//====================================================================== -+// <20121113, Kordan> This function should be called when TxAGC changed. -+// Otherwise the previous compensation is gone, because we record the -+// delta of temperature between two TxPowerTracking watch dogs. -+// -+// NOTE: If Tx BB swing or Tx scaling is varified during run-time, still -+// need to call this function. -+//====================================================================== -+void -+ODM_ClearTxPowerTrackingState( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -+ u1Byte p = 0; -+ -+ pDM_Odm->BbSwingIdxCckBase = pDM_Odm->DefaultCckIndex; -+ pDM_Odm->BbSwingIdxCck = pDM_Odm->DefaultCckIndex; -+ pDM_Odm->RFCalibrateInfo.CCK_index = 0; -+ -+ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) -+ { -+ pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->DefaultOfdmIndex; -+ pDM_Odm->BbSwingIdxOfdm[p] = pDM_Odm->DefaultOfdmIndex; -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pDM_Odm->DefaultOfdmIndex; -+ -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = 0; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] = 0; -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; -+ -+ pDM_Odm->Aboslute_OFDMSwingIdx[p] = 0; // Initial Mix mode power tracking -+ pDM_Odm->Remnant_OFDMSwingIdx[p] = 0; -+ } -+ -+ pDM_Odm->Modify_TxAGC_Flag_PathA= false; //Initial at Modify Tx Scaling Mode -+ pDM_Odm->Modify_TxAGC_Flag_PathB= false; //Initial at Modify Tx Scaling Mode -+ pDM_Odm->Remnant_CCKSwingIdx= 0; -+ pDM_Odm->RFCalibrateInfo.ThermalValue = pHalData->EEPROMThermalMeter; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = pHalData->EEPROMThermalMeter; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = pHalData->EEPROMThermalMeter; -+} -+ -+void -+ODM_TXPowerTrackingCallback_ThermalMeter( -+ PADAPTER Adapter -+ ) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; -+ u1Byte ThermalValue_AVG_count = 0; -+ u4Byte ThermalValue_AVG = 0; -+ -+ u1Byte OFDM_min_index = 0; // OFDM BB Swing should be less than +3.0dB, which is required by Arthur -+ u1Byte Indexforchannel = 0; // GetRightChnlPlaceforIQK(pHalData->CurrentChannel) -+ -+ TXPWRTRACK_CFG c; -+ -+ -+ //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. -+ pu1Byte deltaSwingTableIdx_TUP_A; -+ pu1Byte deltaSwingTableIdx_TDOWN_A; -+ pu1Byte deltaSwingTableIdx_TUP_B; -+ pu1Byte deltaSwingTableIdx_TDOWN_B; -+ -+ //4 2. Initilization ( 7 steps in total ) -+ -+ ConfigureTxpowerTrack(pDM_Odm, &c); -+ -+ (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_A, (pu1Byte*)&deltaSwingTableIdx_TDOWN_A, -+ (pu1Byte*)&deltaSwingTableIdx_TUP_B, (pu1Byte*)&deltaSwingTableIdx_TDOWN_B); -+ -+ pDM_Odm->RFCalibrateInfo.TXPowerTrackingCallbackCnt++; //cosa add for debug -+ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = true; -+ -+#if (MP_DRIVER == 1) -+ if ( *(pDM_Odm->mp_mode) == 1) -+ // RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. -+ pDM_Odm->RFCalibrateInfo.RegA24 = 0x090e1317; -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("===>ODM_TXPowerTrackingCallback_ThermalMeter, \ -+ \n pDM_Odm->BbSwingIdxCckBase: %d, pDM_Odm->BbSwingIdxOfdmBase[A]: %d, pDM_Odm->DefaultOfdmIndex: %d\n", -+ pDM_Odm->BbSwingIdxCckBase, pDM_Odm->BbSwingIdxOfdmBase[ODM_RF_PATH_A], pDM_Odm->DefaultOfdmIndex)); -+ -+ ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E -+ if( ! pDM_Odm->RFCalibrateInfo.TxPowerTrackControl || pHalData->EEPROMThermalMeter == 0 || -+ pHalData->EEPROMThermalMeter == 0xFF) -+ return; -+ -+ -+ //4 3. Initialize ThermalValues of RFCalibrateInfo -+ -+ if(pDM_Odm->RFCalibrateInfo.bReloadtxpowerindex) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); -+ } -+ -+ //4 4. Calculate average thermal meter -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; -+ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) //Average times = c.AverageThermalNum -+ pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; -+ -+ for(i = 0; i < c.AverageThermalNum; i++) -+ { -+ if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) -+ { -+ ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; -+ ThermalValue_AVG_count++; -+ } -+ } -+ -+ if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times -+ { -+ ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("AVG Thermal Meter = 0x%X, EFUSE Thermal Base = 0x%X\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ } -+ -+ //4 5. Calculate delta, delta_LCK, delta_IQK. -+ -+ //"delta" here is used to determine whether thermal value changes or not. -+ delta = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue):(pDM_Odm->RFCalibrateInfo.ThermalValue - ThermalValue); -+ delta_LCK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_LCK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK):(pDM_Odm->RFCalibrateInfo.ThermalValue_LCK - ThermalValue); -+ delta_IQK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_IQK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK):(pDM_Odm->RFCalibrateInfo.ThermalValue_IQK - ThermalValue); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK)); -+ -+ //4 6. If necessary, do LCK. -+ -+ if ((delta_LCK >= c.Threshold_IQK)) // Delta temperature is equal to or larger than 20 centigrade. -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; -+ if(c.PHY_LCCalibrate) -+ (*c.PHY_LCCalibrate)(pDM_Odm); -+ } -+ -+ //3 7. If necessary, move the index of swing table to adjust Tx power. -+ -+ if (delta > 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -+ { -+ //"delta" here is used to record the absolute value of differrence. -+ delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); -+ if (delta >= TXSCALE_TABLE_SIZE) -+ delta = TXSCALE_TABLE_SIZE - 1; -+ -+ //4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset -+ -+ if(ThermalValue > pHalData->EEPROMThermalMeter) { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[ODM_RF_PATH_A] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_A]; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_A] = deltaSwingTableIdx_TUP_A[delta]; -+ -+ pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_A] = deltaSwingTableIdx_TUP_A[delta]; // Record delta swing for mix mode power tracking -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Temp is higher and pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_A])); -+ -+ if(c.RfPathCount > 1) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[ODM_RF_PATH_B] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_B]; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_B] = deltaSwingTableIdx_TUP_B[delta]; -+ -+ pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_B] = deltaSwingTableIdx_TUP_B[delta]; // Record delta swing for mix mode power tracking -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Temp is higher and pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_B])); -+ } -+ -+ } -+ else { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); -+ -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[ODM_RF_PATH_A] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_A]; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_A] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; -+ -+ pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_A] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; // Record delta swing for mix mode power tracking -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Temp is lower and pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_A])); -+ -+ if(c.RfPathCount > 1) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); -+ -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[ODM_RF_PATH_B] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_B]; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[ODM_RF_PATH_B] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; -+ -+ pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_B] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; // Record delta swing for mix mode power tracking -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("******Temp is lower and pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pDM_Odm->Aboslute_OFDMSwingIdx[ODM_RF_PATH_B])); -+ } -+ } -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n\n================================ [Path-%c] Calculating PowerIndexOffset ================================\n", (p == ODM_RF_PATH_A ? 'A' : 'B'))); -+ -+ if (pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] == pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p]) // If Thermal value changes but lookup table value still the same -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; -+ else -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] - pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p]; // Power Index Diff between 2 times Power Tracking -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("[Path-%c] PowerIndexOffset(%d) = DeltaPowerIndex(%d) - DeltaPowerIndexLast(%d)\n", -+ (p == ODM_RF_PATH_A ? 'A' : 'B'), pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p], pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p], -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p])); -+ -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pDM_Odm->BbSwingIdxOfdmBase[p] + pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p]; -+ pDM_Odm->RFCalibrateInfo.CCK_index = pDM_Odm->BbSwingIdxCckBase + pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p]; -+ -+ pDM_Odm->BbSwingIdxCck = pDM_Odm->RFCalibrateInfo.CCK_index; -+ pDM_Odm->BbSwingIdxOfdm[p] = pDM_Odm->RFCalibrateInfo.OFDM_index[p]; -+ -+ // *************Print BB Swing Base and Index Offset************* -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", -+ pDM_Odm->BbSwingIdxCck, pDM_Odm->BbSwingIdxCckBase, pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p])); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("The 'OFDM' final index(%d) = BaseIndex[%c](%d) + PowerIndexOffset(%d)\n", -+ pDM_Odm->BbSwingIdxOfdm[p], (p == ODM_RF_PATH_A ? 'A' : 'B'), pDM_Odm->BbSwingIdxOfdmBase[p], pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p])); -+ -+ //4 7.1 Handle boundary conditions of index. -+ -+ -+ if(pDM_Odm->RFCalibrateInfo.OFDM_index[p] > c.SwingTableSize_OFDM-1) -+ { -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = c.SwingTableSize_OFDM-1; -+ } -+ else if (pDM_Odm->RFCalibrateInfo.OFDM_index[p] < OFDM_min_index) -+ { -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = OFDM_min_index; -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("\n\n========================================================================================================\n")); -+ if(pDM_Odm->RFCalibrateInfo.CCK_index > c.SwingTableSize_CCK-1) -+ pDM_Odm->RFCalibrateInfo.CCK_index = c.SwingTableSize_CCK-1; -+ //else if (pDM_Odm->RFCalibrateInfo.CCK_index < 0) -+ //pDM_Odm->RFCalibrateInfo.CCK_index = 0; -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("The thermal meter is unchanged or TxPowerTracking OFF(%d): ThermalValue: %d , pDM_Odm->RFCalibrateInfo.ThermalValue: %d\n", -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl, ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", -+ pDM_Odm->RFCalibrateInfo.CCK_index, pDM_Odm->BbSwingIdxCckBase)); //Print Swing base & current -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index[%c]: %d\n", -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p], (p == ODM_RF_PATH_A ? 'A' : 'B'), pDM_Odm->BbSwingIdxOfdmBase[p])); -+ } -+ -+ if ((pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_A] != 0 || -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_B] != 0 ) && -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -+ { -+ //4 7.2 Configure the Swing Table to adjust Tx Power. -+ -+ pDM_Odm->RFCalibrateInfo.bTxPowerChanged = true; // Always true after Tx Power is adjusted by power tracking. -+ // -+ // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital -+ // to increase TX power. Otherwise, EVM will be bad. -+ // -+ // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. -+ if (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature Increasing(A): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_A], delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ -+ if(c.RfPathCount > 1) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature Increasing(B): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_B], delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ -+ } -+ else if (ThermalValue < pDM_Odm->RFCalibrateInfo.ThermalValue)// Low temperature -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature Decreasing(A): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_A], delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ -+ if(c.RfPathCount > 1) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature Decreasing(B): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[ODM_RF_PATH_B], delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); -+ -+ } -+ if (ThermalValue > pHalData->EEPROMThermalMeter) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TXAGC, p, 0); -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("**********Enter POWER Tracking MIX_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); -+ } -+ else -+ { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("**********Enter POWER Tracking MIX_MODE**********\n")); -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); -+ } -+ else -+ { -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); -+ } -+ } -+ -+ pDM_Odm->BbSwingIdxCckBase = pDM_Odm->BbSwingIdxCck; // Record last time Power Tracking result as base. -+ for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) -+ pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->BbSwingIdxOfdm[p]; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, -+ ("pDM_Odm->RFCalibrateInfo.ThermalValue = %d ThermalValue= %d\n", pDM_Odm->RFCalibrateInfo.ThermalValue, ThermalValue)); -+ -+ pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; //Record last Power Tracking Thermal Value -+ -+ } -+ if ((delta_IQK >= c.Threshold_IQK)) // Delta temperature is equal to or larger than 20 centigrade (When threshold is 8). -+ (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("<===ODM_TXPowerTrackingCallback_ThermalMeter\n")); -+ -+ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; -+} -+ -+ -+ -+ -+//3============================================================ -+//3 IQ Calibration -+//3============================================================ -+ -+void -+ODM_ResetIQKResult( -+ PDM_ODM_T pDM_Odm -+) -+{ -+ u1Byte i; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ if (!IS_HARDWARE_TYPE_8192D(Adapter)) -+ return; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD,("PHY_ResetIQKResult:: settings regs %d default regs %d\n", (u32)(sizeof(pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting)/sizeof(IQK_MATRIX_REGS_SETTING)), IQK_Matrix_Settings_NUM)); -+ //0xe94, 0xe9c, 0xea4, 0xeac, 0xeb4, 0xebc, 0xec4, 0xecc -+ -+ for(i = 0; i < IQK_Matrix_Settings_NUM; i++) -+ { -+ { -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][0] = -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][2] = -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][4] = -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][6] = 0x100; -+ -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][1] = -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][3] = -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][5] = -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].Value[0][7] = 0x0; -+ -+ pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[i].bIQKDone = false; -+ -+ } -+ } -+ -+} -+ -+u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) -+{ -+ u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = -+ {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; -+ u1Byte place = chnl; -+ -+ -+ if(chnl > 14) -+ { -+ for(place = 14; place -+ -+ -+// -+// Description: -+// This routine deal with the Power Configuration CMDs parsing for RTL8723/RTL8188E Series IC. -+// -+// Assumption: -+// We should follow specific format which was released from HW SD. -+// -+// 2011.07.07, added by Roger. -+// -+u8 HalPwrSeqCmdParsing( -+ PADAPTER padapter, -+ u8 CutVersion, -+ u8 FabVersion, -+ u8 InterfaceType, -+ WLAN_PWR_CFG PwrSeqCmd[]) -+{ -+ WLAN_PWR_CFG PwrCfgCmd = {0}; -+ u8 bPollingBit = false; -+ u32 AryIdx = 0; -+ u8 value = 0; -+ u32 offset = 0; -+ u32 pollingCount = 0; // polling autoload done. -+ u32 maxPollingCnt = 5000; -+ -+ do { -+ PwrCfgCmd = PwrSeqCmd[AryIdx]; -+ -+ RT_TRACE(_module_hal_init_c_ , _drv_info_, -+ ("HalPwrSeqCmdParsing: offset(%#x) cut_msk(%#x) fab_msk(%#x) interface_msk(%#x) base(%#x) cmd(%#x) msk(%#x) value(%#x)\n", -+ GET_PWR_CFG_OFFSET(PwrCfgCmd), -+ GET_PWR_CFG_CUT_MASK(PwrCfgCmd), -+ GET_PWR_CFG_FAB_MASK(PwrCfgCmd), -+ GET_PWR_CFG_INTF_MASK(PwrCfgCmd), -+ GET_PWR_CFG_BASE(PwrCfgCmd), -+ GET_PWR_CFG_CMD(PwrCfgCmd), -+ GET_PWR_CFG_MASK(PwrCfgCmd), -+ GET_PWR_CFG_VALUE(PwrCfgCmd))); -+ -+ //2 Only Handle the command whose FAB, CUT, and Interface are matched -+ if ((GET_PWR_CFG_FAB_MASK(PwrCfgCmd) & FabVersion) && -+ (GET_PWR_CFG_CUT_MASK(PwrCfgCmd) & CutVersion) && -+ (GET_PWR_CFG_INTF_MASK(PwrCfgCmd) & InterfaceType)) { -+ switch (GET_PWR_CFG_CMD(PwrCfgCmd)) { -+ case PWR_CMD_READ: -+ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_READ\n")); -+ break; -+ case PWR_CMD_WRITE: -+ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_WRITE\n")); -+ offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); -+ // Read the value from system register -+ value = rtw_read8(padapter, offset); -+ -+ value=value&(~(GET_PWR_CFG_MASK(PwrCfgCmd))); -+ value=value|(GET_PWR_CFG_VALUE(PwrCfgCmd)&GET_PWR_CFG_MASK(PwrCfgCmd)); -+ -+ // Write the value back to sytem register -+ rtw_write8(padapter, offset, value); -+ break; -+ case PWR_CMD_POLLING: -+ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_POLLING\n")); -+ -+ bPollingBit = false; -+ offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); -+ do { -+ value = rtw_read8(padapter, offset); -+ -+ value=value&GET_PWR_CFG_MASK(PwrCfgCmd); -+ if (value == (GET_PWR_CFG_VALUE(PwrCfgCmd) & GET_PWR_CFG_MASK(PwrCfgCmd))) -+ bPollingBit = true; -+ else -+ rtw_udelay_os(10); -+ -+ if (pollingCount++ > maxPollingCnt) { -+ DBG_871X("Fail to polling Offset[%#x]\n", offset); -+ return false; -+ } -+ } while (!bPollingBit); -+ -+ break; -+ case PWR_CMD_DELAY: -+ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_DELAY\n")); -+ if (GET_PWR_CFG_VALUE(PwrCfgCmd) == PWRSEQ_DELAY_US) -+ rtw_udelay_os(GET_PWR_CFG_OFFSET(PwrCfgCmd)); -+ else -+ rtw_udelay_os(GET_PWR_CFG_OFFSET(PwrCfgCmd)*1000); -+ break; -+ case PWR_CMD_END: -+ // When this command is parsed, end the process -+ RT_TRACE(_module_hal_init_c_ , _drv_info_, ("HalPwrSeqCmdParsing: PWR_CMD_END\n")); -+ return true; -+ break; -+ default: -+ RT_TRACE(_module_hal_init_c_ , _drv_err_, ("HalPwrSeqCmdParsing: Unknown CMD!!\n")); -+ break; -+ } -+ } -+ AryIdx++;//Add Array Index -+ } while(1); -+ -+ return true; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/hal_usb_led.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_usb_led.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/hal_usb_led.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/hal_usb_led.c 2018-02-06 17:42:30.710967164 +0200 -@@ -0,0 +1,4710 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include -+#include -+ -+// -+// Description: -+// Implementation of LED blinking behavior. -+// It toggle off LED and schedule corresponding timer if necessary. -+// -+static void -+SwLedBlink( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 bStopBlinking = false; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,( "Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ // Determine if we shall change LED state again. -+ pLed->BlinkTimes--; -+ switch(pLed->CurrLedState) -+ { -+ -+ case LED_BLINK_NORMAL: -+ if(pLed->BlinkTimes == 0) -+ { -+ bStopBlinking = true; -+ } -+ break; -+ -+ case LED_BLINK_StartToBlink: -+ if( check_fwstate(pmlmepriv, _FW_LINKED) && check_fwstate(pmlmepriv, WIFI_STATION_STATE) ) -+ { -+ bStopBlinking = true; -+ } -+ if( check_fwstate(pmlmepriv, _FW_LINKED) && -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) ) -+ { -+ bStopBlinking = true; -+ } -+ else if(pLed->BlinkTimes == 0) -+ { -+ bStopBlinking = true; -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ break; -+ -+ -+ default: -+ bStopBlinking = true; -+ break; -+ -+ } -+ -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if( (check_fwstate(pmlmepriv, _FW_LINKED)== true) && (pLed->bLedOn == false)) -+ { -+ SwLedOn(padapter, pLed); -+ } -+ else if( (check_fwstate(pmlmepriv, _FW_LINKED)== false) && pLed->bLedOn == true) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ // Assign LED state to toggle. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ // Schedule a timer to toggle LED state. -+ switch( pLed->CurrLedState ) -+ { -+ case LED_BLINK_NORMAL: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ break; -+ -+ case LED_BLINK_SLOWLY: -+ case LED_BLINK_StartToBlink: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ break; -+ -+ case LED_BLINK_WPS: -+ { -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); -+ } -+ break; -+ -+ default: -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ break; -+ } -+ } -+} -+ -+static void -+SwLedBlink1( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ PLED_USB pLed1 = &(ledpriv->SwLed1); -+ u8 bStopBlinking = false; -+ -+ u32 uLedBlinkNoLinkInterval = LED_BLINK_NO_LINK_INTERVAL_ALPHA; //add by ylb 20121012 for customer led for alpha -+ if(pEEPROM->CustomerID == RT_CID_819x_ALPHA_Dlink) -+ uLedBlinkNoLinkInterval= LED_BLINK_NO_LINK_INTERVAL_ALPHA_500MS; -+ -+ if(pEEPROM->CustomerID == RT_CID_819x_CAMEO) -+ pLed = &(ledpriv->SwLed1); -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,( "Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ -+ if(pEEPROM->CustomerID == RT_CID_DEFAULT) -+ { -+ if(check_fwstate(pmlmepriv, _FW_LINKED)== true) -+ { -+ if(!pLed1->bSWLedCtrl) -+ { -+ SwLedOn(padapter, pLed1); -+ pLed1->bSWLedCtrl = true; -+ } -+ else if(!pLed1->bLedOn) -+ SwLedOn(padapter, pLed1); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (): turn on pLed1\n")); -+ } -+ else -+ { -+ if(!pLed1->bSWLedCtrl) -+ { -+ SwLedOff(padapter, pLed1); -+ pLed1->bSWLedCtrl = true; -+ } -+ else if(pLed1->bLedOn) -+ SwLedOff(padapter, pLed1); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (): turn off pLed1\n")); -+ } -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SLOWLY: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval);//change by ylb 20121012 for customer led for alpha -+ break; -+ -+ case LED_BLINK_NORMAL: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) -+ { -+ pLed->bLedLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) -+ { -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ else -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) -+ { -+ pLed->bLedLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) -+ { -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS success -+ if(pLed->BlinkingLedState == RTW_LED_ON) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA); -+ bStopBlinking = false; -+ } -+ else -+ { -+ bStopBlinking = true; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ pLed->bLedLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+static void -+SwLedBlink2( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 bStopBlinking = false; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("stop scan blink CurrLedState %d\n", pLed->CurrLedState)); -+ -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("stop scan blink CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ else -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("stop CurrLedState %d\n", pLed->CurrLedState)); -+ -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("stop CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+} -+ -+static void -+SwLedBlink3( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 bStopBlinking = false; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ if(pLed->CurrLedState != LED_BLINK_WPS_STOP) -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if( !pLed->bLedOn ) -+ SwLedOn(padapter, pLed); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedOn ) -+ SwLedOff(padapter, pLed); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ else -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ if( !pLed->bLedOn ) -+ SwLedOn(padapter, pLed); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if( pLed->bLedOn ) -+ SwLedOff(padapter, pLed); -+ -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS success -+ if(pLed->BlinkingLedState == RTW_LED_ON) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA); -+ bStopBlinking = false; -+ } -+ else -+ { -+ bStopBlinking = true; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ break; -+ -+ -+ default: -+ break; -+ } -+ -+} -+ -+ -+static void -+SwLedBlink4( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ PLED_USB pLed1 = &(ledpriv->SwLed1); -+ u8 bStopBlinking = false; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ if(!pLed1->bLedWPSBlinkInProgress && pLed1->BlinkingLedState == LED_UNKNOWN) -+ { -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ SwLedOff(padapter, pLed1); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SLOWLY: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_StartToBlink: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = false; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = false; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ else -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if(IS_HARDWARE_TYPE_8192DU(padapter)) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS authentication fail -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ break; -+ -+ case LED_BLINK_WPS_STOP_OVERLAP: //WPS session overlap -+ pLed->BlinkTimes--; -+ if(pLed->BlinkTimes == 0) -+ { -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkTimes = 1; -+ } -+ else -+ { -+ bStopBlinking = true; -+ } -+ } -+ -+ if(bStopBlinking) -+ { -+ pLed->BlinkTimes = 10; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_ALWAYS_ON: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if(IS_HARDWARE_TYPE_8192DU(padapter)) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("RFOff Status \n")); -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if(IS_HARDWARE_TYPE_8192DU(padapter)) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink4 CurrLedState %d\n", pLed->CurrLedState)); -+ -+ -+} -+ -+static void -+SwLedBlink5( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 bStopBlinking = false; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if(pLed->bLedOn) -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if(!pLed->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ else -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if(pLed->bLedOn) -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if(!pLed->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ if( padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(padapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink5 CurrLedState %d\n", pLed->CurrLedState)); -+ -+ -+} -+ -+static void -+SwLedBlink6( -+ PLED_USB pLed -+ ) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 bStopBlinking = false; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(padapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink6\n")); -+} -+ -+static void -+SwLedBlink7( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ bool bStopBlinking = false; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ if(pLed->CurrLedState != LED_BLINK_WPS_STOP) -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if( !pLed->bLedOn ) -+ SwLedOn(Adapter, pLed); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedOn ) -+ SwLedOff(Adapter, pLed); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ else -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS success -+ if(pLed->BlinkingLedState == RTW_LED_ON) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ bStopBlinking = false; -+ } -+ else -+ { -+ bStopBlinking = true; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ break; -+ -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink7\n")); -+ -+} -+ -+static void -+SwLedBlink8( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes blink8(%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes blink8(%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink8\n")); -+ -+} -+ -+//page added for Belkin AC950. 20120813 -+static void -+SwLedBlink9( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ bool bStopBlinking = false; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ -+ switch(pLed->CurrLedState) -+ { -+ case RTW_LED_ON: -+ SwLedOn(Adapter, pLed); -+ break; -+ -+ case RTW_LED_OFF: -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ case LED_BLINK_SLOWLY: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_StartToBlink: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ { -+ pLed->bLedLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== false) -+ { -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ if(bStopBlinking) -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if(IS_HARDWARE_TYPE_8192DU(Adapter)) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS authentication fail -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ break; -+ -+ case LED_BLINK_WPS_STOP_OVERLAP: //WPS session overlap -+ pLed->BlinkTimes--; -+ pLed->BlinkCounter --; -+ if(pLed->BlinkCounter == 0) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ pLed->CurrLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ else -+ { -+ if(pLed->BlinkTimes == 0) -+ { -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkTimes = 1; -+ } -+ else -+ { -+ bStopBlinking = true; -+ } -+ } -+ -+ if(bStopBlinking) -+ { -+ pLed->BlinkTimes = 10; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_BLINK_ALWAYS_ON: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ if(bStopBlinking) -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if(IS_HARDWARE_TYPE_8192DU(Adapter) || IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("RFOff Status \n")); -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if(IS_HARDWARE_TYPE_8192DU(Adapter) || IS_HARDWARE_TYPE_8723AU(Adapter) || IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_LINK_IN_PROCESS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ON_BELKIN); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_OFF_BELKIN); -+ } -+ break; -+ -+ case LED_BLINK_AUTH_ERROR: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ if(bStopBlinking == false) -+ { -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); -+ } -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink9 CurrLedState %d\n", pLed->CurrLedState)); -+} -+ -+//page added for Netgear A6200V2. 20120827 -+static void -+SwLedBlink10( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ bool bStopBlinking = false; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ -+ switch(pLed->CurrLedState) -+ { -+ case RTW_LED_ON: -+ SwLedOn(Adapter, pLed); -+ break; -+ -+ case RTW_LED_OFF: -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ case LED_BLINK_SLOWLY: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_StartToBlink: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_BLINK_SCAN: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on ) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else if(check_fwstate(pmlmepriv, _FW_LINKED)== true) -+ { -+ pLed->bLedNoLinkBlinkInProgress = false; -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ pLed->BlinkTimes = 0; -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_SLOWLY_INTERVAL_NETGEAR+LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ } -+ } -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL+LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS authentication fail -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ break; -+ -+ case LED_BLINK_WPS_STOP_OVERLAP: //WPS session overlap -+ pLed->BlinkTimes--; -+ pLed->BlinkCounter --; -+ if(pLed->BlinkCounter == 0) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ pLed->CurrLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ else -+ { -+ if(pLed->BlinkTimes == 0) -+ { -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkTimes = 1; -+ } -+ else -+ { -+ bStopBlinking = true; -+ } -+ } -+ -+ if(bStopBlinking) -+ { -+ pLed->BlinkTimes = 10; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_BLINK_ALWAYS_ON: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ if(bStopBlinking) -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if(IS_HARDWARE_TYPE_8192DU(Adapter) || IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("RFOff Status \n")); -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if(IS_HARDWARE_TYPE_8192DU(Adapter) || IS_HARDWARE_TYPE_8723AU(Adapter) || IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ case LED_BLINK_LINK_IN_PROCESS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ON_BELKIN); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_OFF_BELKIN); -+ } -+ break; -+ -+ case LED_BLINK_AUTH_ERROR: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ if(bStopBlinking == false) -+ { -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); -+ } -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_ERROR_INTERVAL_BELKIN); -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink10 CurrLedState %d\n", pLed->CurrLedState)); -+ -+} -+ -+static void -+SwLedBlink11( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ bool bStopBlinking = false; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_TXRX: -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ -+ break; -+ -+ case LED_BLINK_WPS: -+ if(pLed->BlinkTimes == 5) -+ { -+ SwLedOn(Adapter, pLed); -+ _set_timer(&(pLed->BlinkTimer), LED_CM11_LINK_ON_INTERVEL); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_CM11_BLINK_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_CM11_BLINK_INTERVAL); -+ } -+ } -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ if(bStopBlinking == true) -+ pLed->BlinkTimes = 5; -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS authentication fail -+ if(check_fwstate(pmlmepriv, _FW_LINKED)== true) -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ SwLedOn(Adapter, pLed); -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink5 CurrLedState %d\n", pLed->CurrLedState)); -+} -+ -+static void -+SwLedBlink12( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ bool bStopBlinking = false; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%ld): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%ld): turn off\n", pLed->BlinkTimes)); -+ } -+ -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_SLOWLY: -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ break; -+ -+ case LED_BLINK_TXRX: -+ pLed->BlinkTimes--; -+ if( pLed->BlinkTimes == 0 ) -+ { -+ bStopBlinking = true; -+ } -+ -+ if(bStopBlinking) -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if(pLed->bLedOn) -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ -+ pLed->bLedBlinkInProgress = false; -+ } -+ else -+ { -+ if( Adapter->pwrctrlpriv.rf_pwrstate != rf_on && Adapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) -+ { -+ SwLedOff(Adapter, pLed); -+ } -+ else -+ { -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ } -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedBlink8 CurrLedState %d\n", pLed->CurrLedState)); -+ -+ -+} -+ -+static void -+SwLedBlink13( -+ PLED_USB pLed -+ ) -+{ -+ PADAPTER Adapter = pLed->padapter; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ bool bStopBlinking = false; -+ static u8 LinkBlinkCnt=0; -+ -+ // Change LED according to BlinkingLedState specified. -+ if( pLed->BlinkingLedState == RTW_LED_ON ) -+ { -+ SwLedOn(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn on\n", pLed->BlinkTimes)); -+ } -+ else -+ { -+ if(pLed->CurrLedState != LED_BLINK_WPS_STOP) -+ SwLedOff(Adapter, pLed); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Blinktimes (%d): turn off\n", pLed->BlinkTimes)); -+ } -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("!!! SwLedBlink13 CurrLedState %d, bLedWPSBlinkInProgress %d, bLedBlinkInProgress %d\n", pLed->CurrLedState,pLed->bLedWPSBlinkInProgress,pLed->bLedBlinkInProgress)); -+ switch(pLed->CurrLedState) -+ { -+ case LED_BLINK_LINK_IN_PROCESS: -+ if(!pLed->bLedWPSBlinkInProgress) -+ LinkBlinkCnt++; -+ -+ if(LinkBlinkCnt>15) -+ { -+ LinkBlinkCnt=0; -+ pLed->bLedBlinkInProgress = false; -+ break; -+ } -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 500); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 500); -+ } -+ -+ break; -+ -+ case LED_BLINK_WPS: -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_ON_INTERVAL_NETGEAR); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_OFF_INTERVAL_NETGEAR); -+ } -+ -+ break; -+ -+ case LED_BLINK_WPS_STOP: //WPS success -+ SwLedOff(Adapter, pLed); -+ pLed->bLedWPSBlinkInProgress = false; -+ break; -+ -+ default: -+ LinkBlinkCnt=0; -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("<==== blink13\n")); -+ -+} -+ -+// -+// Description: -+// Handler function of LED Blinking. -+// We dispatch acture LED blink action according to LedStrategy. -+// -+void BlinkHandler(PLED_USB pLed) -+{ -+ _adapter *padapter = pLed->padapter; -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ -+ //DBG_871X("%s (%s:%d)\n",__FUNCTION__, current->comm, current->pid); -+ -+ if( (padapter->bSurpriseRemoved == true) || ( padapter->bDriverStopped == true)) -+ { -+ //DBG_871X("%s bSurpriseRemoved:%d, bDriverStopped:%d\n", __FUNCTION__, padapter->bSurpriseRemoved, padapter->bDriverStopped); -+ return; -+ } -+ -+ switch(ledpriv->LedStrategy) -+ { -+ case SW_LED_MODE0: -+ SwLedBlink(pLed); -+ break; -+ -+ case SW_LED_MODE1: -+ SwLedBlink1(pLed); -+ break; -+ -+ case SW_LED_MODE2: -+ SwLedBlink2(pLed); -+ break; -+ -+ case SW_LED_MODE3: -+ SwLedBlink3(pLed); -+ break; -+ -+ case SW_LED_MODE4: -+ SwLedBlink4(pLed); -+ break; -+ -+ case SW_LED_MODE5: -+ SwLedBlink5(pLed); -+ break; -+ -+ case SW_LED_MODE6: -+ SwLedBlink6(pLed); -+ break; -+ -+ case SW_LED_MODE7: -+ SwLedBlink7(pLed); -+ break; -+ -+ case SW_LED_MODE8: -+ SwLedBlink8(pLed); -+ break; -+ -+ case SW_LED_MODE9: -+ SwLedBlink9(pLed); -+ break; -+ -+ case SW_LED_MODE10: -+ SwLedBlink10(pLed); -+ break; -+ -+ case SW_LED_MODE11: -+ SwLedBlink11(pLed); -+ break; -+ -+ case SW_LED_MODE12: -+ SwLedBlink12(pLed); -+ -+ default: -+ //RT_TRACE(COMP_LED, DBG_LOUD, ("BlinkWorkItemCallback 0x%x \n", pHalData->LedStrategy)); -+ //SwLedBlink(pLed); -+ break; -+ } -+} -+ -+// -+// Description: -+// Callback function of LED BlinkTimer, -+// it just schedules to corresponding BlinkWorkItem/led_blink_hdl -+// -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+void BlinkTimerCallback(void *data) -+#else -+void BlinkTimerCallback(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ PLED_USB pLed = (PLED_USB)data; -+#else -+ PLED_USB pLed = from_timer(pLed, t, BlinkTimer); -+#endif -+ _adapter *padapter = pLed->padapter; -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ if( (padapter->bSurpriseRemoved == true) || ( padapter->bDriverStopped == true)) -+ { -+ //DBG_871X("%s bSurpriseRemoved:%d, bDriverStopped:%d\n", __FUNCTION__, padapter->bSurpriseRemoved, padapter->bDriverStopped); -+ return; -+ } -+ -+ #ifdef CONFIG_LED_HANDLED_BY_CMD_THREAD -+ rtw_led_blink_cmd(padapter, (void *)pLed); -+ #else -+ _set_workitem(&(pLed->BlinkWorkItem)); -+ #endif -+} -+ -+// -+// Description: -+// Callback function of LED BlinkWorkItem. -+// We dispatch acture LED blink action according to LedStrategy. -+// -+void BlinkWorkItemCallback(_workitem *work) -+{ -+ PLED_USB pLed = container_of(work, LED_USB, BlinkWorkItem); -+ BlinkHandler(pLed); -+} -+ -+static void -+SwLedControlMode0( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ PLED_USB pLed = &(ledpriv->SwLed1); -+ -+ // Decide led state -+ switch(LedAction) -+ { -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if( pLed->bLedBlinkInProgress == false ) -+ { -+ pLed->bLedBlinkInProgress = true; -+ -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ pLed->BlinkTimes = 2; -+ -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ break; -+ -+ case LED_CTL_START_TO_LINK: -+ if( pLed->bLedBlinkInProgress == false ) -+ { -+ pLed->bLedBlinkInProgress = true; -+ -+ pLed->CurrLedState = LED_BLINK_StartToBlink; -+ pLed->BlinkTimes = 24; -+ -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->CurrLedState = LED_BLINK_StartToBlink; -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ pLed->CurrLedState = RTW_LED_ON; -+ if( pLed->bLedBlinkInProgress == false ) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_NO_LINK: -+ pLed->CurrLedState = RTW_LED_OFF; -+ if( pLed->bLedBlinkInProgress == false ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ if(pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ SwLedOff(padapter, pLed); -+ break; -+ -+ case LED_CTL_START_WPS: -+ if( pLed->bLedBlinkInProgress == false || pLed->CurrLedState == RTW_LED_ON) -+ { -+ pLed->bLedBlinkInProgress = true; -+ -+ pLed->CurrLedState = LED_BLINK_WPS; -+ pLed->BlinkTimes = 20; -+ -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LONG_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ if(pLed->bLedBlinkInProgress) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ break; -+ -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led %d\n", pLed->CurrLedState)); -+ -+} -+ -+ //ALPHA, added by chiyoko, 20090106 -+static void -+SwLedControlMode1( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ -+ u32 uLedBlinkNoLinkInterval = LED_BLINK_NO_LINK_INTERVAL_ALPHA; //add by ylb 20121012 for customer led for alpha -+ if(pEEPROM->CustomerID == RT_CID_819x_ALPHA_Dlink) -+ uLedBlinkNoLinkInterval= LED_BLINK_NO_LINK_INTERVAL_ALPHA_500MS; -+ -+ if(pEEPROM->CustomerID == RT_CID_819x_CAMEO) -+ pLed = &(ledpriv->SwLed1); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_START_TO_LINK: -+ case LED_CTL_NO_LINK: -+ if( pLed->bLedNoLinkBlinkInProgress == false ) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if( pLed->bLedLinkBlinkInProgress == true ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = false; -+ } -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval);//change by ylb 20121012 for customer led for alpha -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ if( pLed->bLedLinkBlinkInProgress == false ) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ pLed->bLedLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_NORMAL; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if((pmlmepriv->LinkDetectInfo.bBusyTraffic) && (check_fwstate(pmlmepriv, _FW_LINKED)== true)) -+ ; -+ else if(pLed->bLedScanBlinkInProgress ==false) -+ { -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if( pLed->bLedLinkBlinkInProgress == true ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = false; -+ } -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ pLed->bLedScanBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 24; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ if (padapter->pwrctrlpriv.rf_pwrstate != rf_on && padapter->pwrctrlpriv.rfoff_reason == RF_CHANGE_BY_IPS) -+ _set_timer(&(pLed->BlinkTimer), LED_INITIAL_INTERVAL); -+ else -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if(pLed->bLedBlinkInProgress ==false) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if( pLed->bLedLinkBlinkInProgress == true ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = false; -+ } -+ pLed->bLedBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed->bLedWPSBlinkInProgress ==false) -+ { -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if( pLed->bLedLinkBlinkInProgress == true ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = false; -+ } -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if(pLed->bLedScanBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ pLed->bLedWPSBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ break; -+ -+ -+ case LED_CTL_STOP_WPS: -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if( pLed->bLedLinkBlinkInProgress == true ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = false; -+ } -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if(pLed->bLedScanBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ } -+ else -+ { -+ pLed->bLedWPSBlinkInProgress = true; -+ } -+ -+ pLed->CurrLedState = LED_BLINK_WPS_STOP; -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), uLedBlinkNoLinkInterval);//change by ylb 20121012 for customer led for alpha -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedNoLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if( pLed->bLedLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = false; -+ } -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ -+ SwLedOff(padapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led %d\n", pLed->CurrLedState)); -+} -+ -+ //Arcadyan/Sitecom , added by chiyoko, 20090216 -+static void -+SwLedControlMode2( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_SITE_SURVEY: -+ if(pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ ; -+ else if(pLed->bLedScanBlinkInProgress ==false) -+ { -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ pLed->bLedScanBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 24; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if((pLed->bLedBlinkInProgress ==false) && (check_fwstate(pmlmepriv, _FW_LINKED)== true)) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ -+ pLed->bLedBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed->bLedWPSBlinkInProgress ==false) -+ { -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if(pLed->bLedScanBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ pLed->bLedWPSBlinkInProgress = true; -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ pLed->bLedWPSBlinkInProgress = false; -+ if(padapter->pwrctrlpriv.rf_pwrstate != rf_on) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ else -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: -+ pLed->bLedWPSBlinkInProgress = false; -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+ break; -+ -+ case LED_CTL_START_TO_LINK: -+ case LED_CTL_NO_LINK: -+ if(!IS_LED_BLINKING(pLed)) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ -+ SwLedOff(padapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+} -+ -+ //COREGA, added by chiyoko, 20090316 -+ static void -+ SwLedControlMode3( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_SITE_SURVEY: -+ if(pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ ; -+ else if(pLed->bLedScanBlinkInProgress ==false) -+ { -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ pLed->bLedScanBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 24; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if((pLed->bLedBlinkInProgress ==false) && (check_fwstate(pmlmepriv, _FW_LINKED)== true)) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ -+ pLed->bLedBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed->bLedWPSBlinkInProgress ==false) -+ { -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if(pLed->bLedScanBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ pLed->bLedWPSBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ else -+ { -+ pLed->bLedWPSBlinkInProgress = true; -+ } -+ -+ pLed->CurrLedState = LED_BLINK_WPS_STOP; -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_TO_LINK: -+ case LED_CTL_NO_LINK: -+ if(!IS_LED_BLINKING(pLed)) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ -+ SwLedOff(padapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("CurrLedState %d\n", pLed->CurrLedState)); -+} -+ -+ -+ //Edimax-Belkin, added by chiyoko, 20090413 -+static void -+SwLedControlMode4( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ PLED_USB pLed1 = &(ledpriv->SwLed1); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_START_TO_LINK: -+ if(pLed1->bLedWPSBlinkInProgress) -+ { -+ pLed1->bLedWPSBlinkInProgress = false; -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ -+ if(pLed1->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ if( pLed->bLedStartToLinkBlinkInProgress == false ) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if(pLed->bLedNoLinkBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ -+ pLed->bLedStartToLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_StartToBlink; -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ case LED_CTL_NO_LINK: -+ //LED1 settings -+ if(LedAction == LED_CTL_LINK) -+ { -+ if(pLed1->bLedWPSBlinkInProgress) -+ { -+ pLed1->bLedWPSBlinkInProgress = false; -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ -+ if(pLed1->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ } -+ -+ if( pLed->bLedNoLinkBlinkInProgress == false ) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = true; -+ if(IS_HARDWARE_TYPE_8192DU(padapter)) -+ { -+ if(LedAction == LED_CTL_LINK) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ } -+ else -+ { -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ } -+ } -+ else -+ { -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if((pmlmepriv->LinkDetectInfo.bBusyTraffic) && (check_fwstate(pmlmepriv, _FW_LINKED)== true)) -+ ; -+ else if(pLed->bLedScanBlinkInProgress ==false) -+ { -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ pLed->bLedScanBlinkInProgress = true; -+ if(IS_HARDWARE_TYPE_8192D(padapter)) -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ else -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 24; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if(pLed->bLedBlinkInProgress ==false) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ pLed->bLedBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed1->bLedWPSBlinkInProgress) -+ { -+ pLed1->bLedWPSBlinkInProgress = false; -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ -+ if(pLed1->bLedOn) -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ if(pLed->bLedWPSBlinkInProgress ==false) -+ { -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if(pLed->bLedScanBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ pLed->bLedWPSBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SLOWLY_INTERVAL); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ } -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: //WPS connect success -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: //WPS authentication fail -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ -+ //LED1 settings -+ if(pLed1->bLedWPSBlinkInProgress) -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ else -+ pLed1->bLedWPSBlinkInProgress = true; -+ -+ pLed1->CurrLedState = LED_BLINK_WPS_STOP; -+ if( pLed1->bLedOn ) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ -+ //LED1 settings -+ if(pLed1->bLedWPSBlinkInProgress) -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ else -+ pLed1->bLedWPSBlinkInProgress = true; -+ -+ pLed1->CurrLedState = LED_BLINK_WPS_STOP_OVERLAP; -+ pLed1->BlinkTimes = 10; -+ if( pLed1->bLedOn ) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NORMAL_INTERVAL); -+ -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if( pLed->bLedNoLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if( pLed->bLedLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = false; -+ } -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ if( pLed->bLedStartToLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedStartToLinkBlinkInProgress = false; -+ } -+ -+ if( pLed1->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedWPSBlinkInProgress = false; -+ } -+ -+ pLed1->BlinkingLedState = LED_UNKNOWN; -+ SwLedOff(padapter, pLed); -+ SwLedOff(padapter, pLed1); -+ break; -+ -+ case LED_CTL_CONNECTION_NO_TRANSFER: -+ if(pLed->bLedBlinkInProgress == false) -+ { -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ pLed->bLedBlinkInProgress = true; -+ -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led %d\n", pLed->CurrLedState)); -+} -+ -+ -+ -+ //Sercomm-Belkin, added by chiyoko, 20090415 -+static void -+SwLedControlMode5( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ if(pEEPROM->CustomerID == RT_CID_819x_CAMEO) -+ pLed = &(ledpriv->SwLed1); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_NO_LINK: -+ case LED_CTL_LINK: //solid blue -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if((pmlmepriv->LinkDetectInfo.bBusyTraffic) && (check_fwstate(pmlmepriv, _FW_LINKED)== true)) -+ ; -+ else if(pLed->bLedScanBlinkInProgress ==false) -+ { -+ if(pLed->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ pLed->bLedScanBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 24; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if(pLed->bLedBlinkInProgress ==false) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN) -+ { -+ return; -+ } -+ pLed->bLedBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ -+ SwLedOff(padapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led %d\n", pLed->CurrLedState)); -+} -+ -+ //WNC-Corega, added by chiyoko, 20090902 -+static void -+SwLedControlMode6( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ PLED_USB pLed0 = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_LINK: -+ case LED_CTL_NO_LINK: -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->CurrLedState = RTW_LED_ON; -+ pLed0->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed0->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ SwLedOff(padapter, pLed0); -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("ledcontrol 6 Led %d\n", pLed0->CurrLedState)); -+} -+ -+//Netgear, added by sinda, 2011/11/11 -+static void -+ SwLedControlMode7( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+ ) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_SITE_SURVEY: -+ if(pmlmepriv->LinkDetectInfo.bBusyTraffic) -+ ; -+ else if(pLed->bLedScanBlinkInProgress == false) -+ { -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ if(pLed->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ pLed->bLedScanBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 6; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed->bLedWPSBlinkInProgress ==false) -+ { -+ if(pLed->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if(pLed->bLedScanBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ pLed->bLedWPSBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ else -+ { -+ pLed->bLedWPSBlinkInProgress = true; -+ } -+ -+ pLed->CurrLedState = LED_BLINK_WPS_STOP; -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ break; -+ -+ -+ case LED_CTL_STOP_WPS_FAIL: -+ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_TO_LINK: -+ case LED_CTL_NO_LINK: -+ if(!IS_LED_BLINKING(pLed)) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ case LED_CTL_POWER_ON: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("LEd control mode 7 CurrLedState %d\n", pLed->CurrLedState)); -+} -+ -+static void -+SwLedControlMode8( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+ ) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed0 = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_LINK: -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->CurrLedState = RTW_LED_ON; -+ pLed0->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed0->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_NO_LINK: -+ _cancel_timer_ex(&(pLed0->BlinkTimer)); -+ pLed0->CurrLedState = RTW_LED_OFF; -+ pLed0->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed0->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ SwLedOff(Adapter, pLed0); -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 8 %d\n", pLed0->CurrLedState)); -+ -+} -+ -+//page added for Belkin AC950, 20120813 -+static void -+SwLedControlMode9( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ PLED_USB pLed1 = &(ledpriv->SwLed1); -+ PLED_USB pLed2 = &(ledpriv->SwLed2); -+ bool bWPSOverLap = false; -+ -+ switch(LedAction) -+ { -+ case LED_CTL_START_TO_LINK: -+ if(pLed2->bLedBlinkInProgress == false) -+ { -+ pLed2->bLedBlinkInProgress = true; -+ pLed2->BlinkingLedState = RTW_LED_ON; -+ pLed2->CurrLedState = LED_BLINK_LINK_IN_PROCESS; -+ -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ case LED_CTL_NO_LINK: -+ //LED1 settings -+ if(LedAction == LED_CTL_NO_LINK) -+ { -+ //if(pMgntInfo->AuthStatus == AUTH_STATUS_FAILED) -+ if(0) -+ { -+ pLed1->CurrLedState = LED_BLINK_AUTH_ERROR; -+ if( pLed1->bLedOn ) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ else -+ { -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ if( pLed1->bLedOn ) -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ } -+ else -+ { -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ if( pLed1->bLedOn ) -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ -+ //LED2 settings -+ if(LedAction == LED_CTL_LINK) -+ { -+ if(Adapter->securitypriv.dot11PrivacyAlgrthm != _NO_PRIVACY_) -+ { -+ if(pLed2->bLedBlinkInProgress ==true) -+ { -+ _cancel_timer_ex(&(pLed2->BlinkTimer)); -+ pLed2->bLedBlinkInProgress = false; -+ } -+ pLed2->CurrLedState = RTW_LED_ON; -+ pLed2->bLedNoLinkBlinkInProgress = true; -+ if(!pLed2->bLedOn) -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ } -+ else -+ { -+ if(pLed2->bLedWPSBlinkInProgress != true) -+ { -+ pLed2->CurrLedState = RTW_LED_OFF; -+ pLed2->BlinkingLedState = RTW_LED_OFF; -+ if(pLed2->bLedOn) -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ } -+ } -+ } -+ else //NO_LINK -+ { -+ if(pLed2->bLedWPSBlinkInProgress == false) -+ { -+ pLed2->CurrLedState = RTW_LED_OFF; -+ pLed2->BlinkingLedState = RTW_LED_OFF; -+ if(pLed2->bLedOn) -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ } -+ } -+ -+ //LED0 settings -+ if( pLed->bLedNoLinkBlinkInProgress == false ) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = true; -+ if(IS_HARDWARE_TYPE_8192DU(Adapter) || IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+ if(LedAction == LED_CTL_LINK) -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ } -+ else -+ { -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ } -+ else -+ { -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ } -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if((pmlmepriv->LinkDetectInfo.bBusyTraffic) && (check_fwstate(pmlmepriv, _FW_LINKED)== true)) -+ ; -+ else //if(pLed->bLedScanBlinkInProgress ==false) -+ { -+ if(IS_LED_WPS_BLINKING(pLed)) -+ return; -+ -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if(pLed->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ pLed->bLedScanBlinkInProgress = true; -+ if(IS_HARDWARE_TYPE_8192D(Adapter)) -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ else -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 24; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if(pLed->bLedBlinkInProgress == false) -+ { -+ if(pLed->CurrLedState == LED_BLINK_SCAN || IS_LED_WPS_BLINKING(pLed)) -+ { -+ return; -+ } -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ pLed->bLedBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ pLed2->bLedBlinkInProgress = true; -+ pLed2->BlinkingLedState = RTW_LED_ON; -+ pLed2->CurrLedState = LED_BLINK_LINK_IN_PROCESS; -+ pLed2->bLedWPSBlinkInProgress = true; -+ -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ -+ break; -+ -+ case LED_CTL_STOP_WPS: //WPS connect success -+ //LED2 settings -+ if(pLed2->bLedWPSBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed2->BlinkTimer)); -+ pLed2->bLedBlinkInProgress = false; -+ pLed2->bLedWPSBlinkInProgress = false; -+ } -+ pLed2->CurrLedState = RTW_LED_ON; -+ pLed2->bLedNoLinkBlinkInProgress = true; -+ if(!pLed2->bLedOn) -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ -+ //LED1 settings -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ if( pLed1->bLedOn ) -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: //WPS authentication fail -+ //LED1 settings -+ if(bWPSOverLap == false) -+ { -+ pLed1->CurrLedState = LED_BLINK_AUTH_ERROR; -+ pLed1->BlinkTimes = 50; -+ if( pLed1->bLedOn ) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ else -+ { -+ bWPSOverLap = false; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ -+ //LED2 settings -+ pLed2->CurrLedState = RTW_LED_OFF; -+ pLed2->BlinkingLedState = RTW_LED_OFF; -+ pLed2->bLedWPSBlinkInProgress = false; -+ if( pLed2->bLedOn ) -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap -+ //LED1 settings -+ bWPSOverLap = true; -+ pLed1->CurrLedState = LED_BLINK_WPS_STOP_OVERLAP; -+ pLed1->BlinkTimes = 10; -+ pLed1->BlinkCounter = 50; -+ if( pLed1->bLedOn ) -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ -+ //LED2 settings -+ pLed2->CurrLedState = RTW_LED_OFF; -+ pLed2->BlinkingLedState = RTW_LED_OFF; -+ pLed2->bLedWPSBlinkInProgress = false; -+ if( pLed2->bLedOn ) -+ _set_timer(&(pLed2->BlinkTimer), 0); -+ -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if( pLed->bLedNoLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if( pLed->bLedLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = false; -+ } -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ if( pLed->bLedStartToLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedStartToLinkBlinkInProgress = false; -+ } -+ -+ if( pLed1->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedWPSBlinkInProgress = false; -+ } -+ -+ -+ pLed1->BlinkingLedState = LED_UNKNOWN; -+ SwLedOff(Adapter, pLed); -+ SwLedOff(Adapter, pLed1); -+ break; -+ -+ case LED_CTL_CONNECTION_NO_TRANSFER: -+ if(pLed->bLedBlinkInProgress == false) -+ { -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ pLed->bLedBlinkInProgress = true; -+ -+ pLed->CurrLedState = LED_BLINK_ALWAYS_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 9 Led %d\n", pLed->CurrLedState)); -+} -+ -+//page added for Netgear A6200V2, 20120827 -+static void -+SwLedControlMode10( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ PLED_USB pLed1 = &(ledpriv->SwLed1); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_START_TO_LINK: -+ if(pLed1->bLedBlinkInProgress == false) -+ { -+ pLed1->bLedBlinkInProgress = true; -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ pLed1->CurrLedState = LED_BLINK_LINK_IN_PROCESS; -+ -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_LINK: -+ case LED_CTL_NO_LINK: -+ if(LedAction == LED_CTL_LINK) -+ { -+ if(pLed->bLedWPSBlinkInProgress == true || pLed1->bLedWPSBlinkInProgress == true) -+ ; -+ else -+ { -+ if(pHalData->CurrentBandType == BAND_ON_2_4G) -+ //LED0 settings -+ { -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if(pLed->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ _set_timer(&(pLed->BlinkTimer), 0); -+ -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ else if(pHalData->CurrentBandType == BAND_ON_5G) -+ //LED1 settings -+ { -+ pLed1->CurrLedState = RTW_LED_ON; -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ if(pLed1->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = false; -+ } -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ } -+ } -+ else if(LedAction == LED_CTL_NO_LINK) //TODO by page -+ { -+ if(pLed->bLedWPSBlinkInProgress == true || pLed1->bLedWPSBlinkInProgress == true) -+ ; -+ else -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedOn ) -+ _set_timer(&(pLed->BlinkTimer), 0); -+ -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ if( pLed1->bLedOn ) -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ } -+ -+ break; -+ -+ case LED_CTL_SITE_SURVEY: -+ if(check_fwstate(pmlmepriv, _FW_LINKED)== true) -+ ; //don't blink when media connect -+ else //if(pLed->bLedScanBlinkInProgress ==false) -+ { -+ if(IS_LED_WPS_BLINKING(pLed) || IS_LED_WPS_BLINKING(pLed1)) -+ return; -+ -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if(pLed->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ pLed->bLedScanBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SCAN; -+ pLed->BlinkTimes = 12; -+ pLed->BlinkingLedState = LED_BLINK_SCAN; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ -+ if(pLed1->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedNoLinkBlinkInProgress = false; -+ } -+ if(pLed1->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = false; -+ } -+ pLed1->bLedScanBlinkInProgress = true; -+ pLed1->CurrLedState = LED_BLINK_SCAN; -+ pLed1->BlinkTimes = 12; -+ pLed1->BlinkingLedState = LED_BLINK_SCAN; -+ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_LINK_SLOWLY_INTERVAL_NETGEAR); -+ -+ } -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ //LED0 settings -+ if(pLed->bLedBlinkInProgress == false) -+ { -+ pLed->bLedBlinkInProgress = true; -+ pLed->bLedWPSBlinkInProgress = true; -+ pLed->BlinkingLedState = LED_BLINK_WPS; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ //LED1 settings -+ if(pLed1->bLedBlinkInProgress == false) -+ { -+ pLed1->bLedBlinkInProgress = true; -+ pLed1->bLedWPSBlinkInProgress = true; -+ pLed1->BlinkingLedState = LED_BLINK_WPS; -+ pLed1->CurrLedState = LED_BLINK_WPS; -+ _set_timer(&(pLed1->BlinkTimer), LED_BLINK_NORMAL_INTERVAL+LED_BLINK_LINK_INTERVAL_NETGEAR); -+ } -+ -+ -+ break; -+ -+ case LED_CTL_STOP_WPS: //WPS connect success -+ if(pHalData->CurrentBandType == BAND_ON_2_4G) -+ //LED0 settings -+ { -+ pLed->bLedWPSBlinkInProgress = false; -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if(pLed->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ _set_timer(&(pLed->BlinkTimer), 0); -+ -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ } -+ else if(pHalData->CurrentBandType == BAND_ON_5G) -+ //LED1 settings -+ { -+ pLed1->bLedWPSBlinkInProgress = false; -+ pLed1->CurrLedState = RTW_LED_ON; -+ pLed1->BlinkingLedState = RTW_LED_ON; -+ if(pLed1->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed1->BlinkTimer)); -+ pLed1->bLedBlinkInProgress = false; -+ } -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ break; -+ -+ case LED_CTL_STOP_WPS_FAIL: //WPS authentication fail -+ //LED1 settings -+ pLed1->bLedWPSBlinkInProgress = false; -+ pLed1->CurrLedState = RTW_LED_OFF; -+ pLed1->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed1->BlinkTimer), 0); -+ -+ //LED0 settings -+ pLed->bLedWPSBlinkInProgress = false; -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedOn ) -+ _set_timer(&(pLed->BlinkTimer), 0); -+ -+ break; -+ -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 10 Led %d\n", pLed->CurrLedState)); -+} -+ -+ //Edimax-ASUS, added by Page, 20121221 -+static void -+SwLedControlMode11( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_START_TO_LINK: -+ case LED_CTL_NO_LINK: -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_LINK: -+ if( pLed->bLedBlinkInProgress == true ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ pLed->bLedBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_SCAN_INTERVAL_ALPHA); -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ pLed->bLedWPSBlinkInProgress = true; -+ pLed->bLedBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->BlinkTimes = 5; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ -+ break; -+ -+ -+ case LED_CTL_STOP_WPS: -+ case LED_CTL_STOP_WPS_FAIL: -+ if(pLed->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ pLed->CurrLedState = LED_BLINK_WPS_STOP; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if( pLed->bLedNoLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ if( pLed->bLedLinkBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedLinkBlinkInProgress = false; -+ } -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led mode 1 CurrLedState %d\n", pLed->CurrLedState)); -+} -+ -+// page added for NEC -+ -+static void -+SwLedControlMode12( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ switch(LedAction) -+ { -+ case LED_CTL_POWER_ON: -+ case LED_CTL_NO_LINK: -+ case LED_CTL_LINK: -+ case LED_CTL_SITE_SURVEY: -+ -+ if( pLed->bLedNoLinkBlinkInProgress == false ) -+ { -+ if(pLed->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ -+ pLed->bLedNoLinkBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_SLOWLY; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_NO_LINK_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_TX: -+ case LED_CTL_RX: -+ if(pLed->bLedBlinkInProgress == false) -+ { -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ pLed->bLedBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_TXRX; -+ pLed->BlinkTimes = 2; -+ if( pLed->bLedOn ) -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ else -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ -+ if(pLed->bLedNoLinkBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedNoLinkBlinkInProgress = false; -+ } -+ -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SWLed12 %d\n", pLed->CurrLedState)); -+} -+ -+// Maddest add for NETGEAR R6100 -+ -+static void -+SwLedControlMode13( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+) -+{ -+ struct led_priv *ledpriv = &(Adapter->ledpriv); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ PLED_USB pLed = &(ledpriv->SwLed0); -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("Led control mode 13 CurrLedState %d, LedAction %d\n", pLed->CurrLedState,LedAction)); -+ switch(LedAction) -+ { -+ case LED_CTL_LINK: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ return; -+ } -+ -+ -+ pLed->CurrLedState = RTW_LED_ON; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_WPS: //wait until xinpin finish -+ case LED_CTL_START_WPS_BOTTON: -+ if(pLed->bLedWPSBlinkInProgress == false) -+ { -+ if(pLed->bLedBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if(pLed->bLedScanBlinkInProgress == true) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ pLed->bLedWPSBlinkInProgress = true; -+ pLed->CurrLedState = LED_BLINK_WPS; -+ if( pLed->bLedOn ) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_OFF_INTERVAL_NETGEAR); -+ } -+ else -+ { -+ pLed->BlinkingLedState = RTW_LED_ON; -+ _set_timer(&(pLed->BlinkTimer), LED_WPS_BLINK_ON_INTERVAL_NETGEAR); -+ } -+ } -+ break; -+ -+ case LED_CTL_STOP_WPS: -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ else -+ { -+ pLed->bLedWPSBlinkInProgress = true; -+ } -+ -+ pLed->bLedWPSBlinkInProgress = false; -+ pLed->CurrLedState = LED_BLINK_WPS_STOP; -+ if(pLed->bLedOn) -+ { -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ -+ break; -+ -+ -+ case LED_CTL_STOP_WPS_FAIL: -+ case LED_CTL_STOP_WPS_FAIL_OVERLAP: //WPS session overlap -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ break; -+ -+ case LED_CTL_START_TO_LINK: -+ if((pLed->bLedBlinkInProgress == false) && (pLed->bLedWPSBlinkInProgress == false)) -+ { -+ pLed->bLedBlinkInProgress = true; -+ pLed->BlinkingLedState = RTW_LED_ON; -+ pLed->CurrLedState = LED_BLINK_LINK_IN_PROCESS; -+ -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_NO_LINK: -+ -+ if(pLed->bLedWPSBlinkInProgress) -+ { -+ return; -+ } -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ //if(!IS_LED_BLINKING(pLed)) -+ { -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ _set_timer(&(pLed->BlinkTimer), 0); -+ } -+ break; -+ -+ case LED_CTL_POWER_OFF: -+ case LED_CTL_POWER_ON: -+ pLed->CurrLedState = RTW_LED_OFF; -+ pLed->BlinkingLedState = RTW_LED_OFF; -+ if( pLed->bLedBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedBlinkInProgress = false; -+ } -+ if( pLed->bLedScanBlinkInProgress) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedScanBlinkInProgress = false; -+ } -+ if( pLed->bLedWPSBlinkInProgress ) -+ { -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ pLed->bLedWPSBlinkInProgress = false; -+ } -+ -+ if (LedAction == LED_CTL_POWER_ON) -+ _set_timer(&(pLed->BlinkTimer), 0); -+ else -+ SwLedOff(Adapter, pLed); -+ break; -+ -+ default: -+ break; -+ -+ } -+ -+ -+} -+ -+void -+LedControlUSB( -+ _adapter *padapter, -+ LED_CTL_MODE LedAction -+ ) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ -+#if(MP_DRIVER == 1) -+ if (padapter->registrypriv.mp_mode == 1) -+ return; -+#endif -+ -+ if( (padapter->bSurpriseRemoved == true) ||(padapter->hw_init_completed == false) ) -+ { -+ return; -+ } -+ -+ if( ledpriv->bRegUseLed == false) -+ return; -+ -+ //if(priv->bInHctTest) -+ // return; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ // Only do led action for PRIMARY_ADAPTER -+ if (padapter->adapter_type != PRIMARY_ADAPTER) -+ return; -+#endif -+ -+ if( (padapter->pwrctrlpriv.rf_pwrstate != rf_on && -+ padapter->pwrctrlpriv.rfoff_reason > RF_CHANGE_BY_PS) && -+ (LedAction == LED_CTL_TX || LedAction == LED_CTL_RX || -+ LedAction == LED_CTL_SITE_SURVEY || -+ LedAction == LED_CTL_LINK || -+ LedAction == LED_CTL_NO_LINK || -+ LedAction == LED_CTL_POWER_ON) ) -+ { -+ return; -+ } -+ -+ switch(ledpriv->LedStrategy) -+ { -+ case SW_LED_MODE0: -+ SwLedControlMode0(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE1: -+ SwLedControlMode1(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE2: -+ SwLedControlMode2(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE3: -+ SwLedControlMode3(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE4: -+ SwLedControlMode4(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE5: -+ SwLedControlMode5(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE6: -+ SwLedControlMode6(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE7: -+ SwLedControlMode7(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE8: -+ SwLedControlMode8(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE9: -+ SwLedControlMode9(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE10: -+ SwLedControlMode10(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE11: -+ SwLedControlMode11(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE12: -+ SwLedControlMode12(padapter, LedAction); -+ break; -+ -+ case SW_LED_MODE13: -+ SwLedControlMode13(padapter, LedAction); -+ break; -+ -+ default: -+ break; -+ } -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("LedStrategy:%d, LedAction %d\n", ledpriv->LedStrategy,LedAction)); -+} -+ -+// -+// Description: -+// Reset status of LED_871x object. -+// -+void ResetLedStatus(PLED_USB pLed) { -+ -+ pLed->CurrLedState = RTW_LED_OFF; // Current LED state. -+ pLed->bLedOn = false; // true if LED is ON, false if LED is OFF. -+ -+ pLed->bLedBlinkInProgress = false; // true if it is blinking, false o.w.. -+ pLed->bLedWPSBlinkInProgress = false; -+ -+ pLed->BlinkTimes = 0; // Number of times to toggle led state for blinking. -+ pLed->BlinkCounter = 0; -+ pLed->BlinkingLedState = LED_UNKNOWN; // Next state for blinking, either RTW_LED_ON or RTW_LED_OFF are. -+ -+ pLed->bLedNoLinkBlinkInProgress = false; -+ pLed->bLedLinkBlinkInProgress = false; -+ pLed->bLedStartToLinkBlinkInProgress = false; -+ pLed->bLedScanBlinkInProgress = false; -+} -+ -+ // -+// Description: -+// Initialize an LED_871x object. -+// -+void -+InitLed( -+ _adapter *padapter, -+ PLED_USB pLed, -+ LED_PIN LedPin -+ ) -+{ -+ pLed->padapter = padapter; -+ pLed->LedPin = LedPin; -+ -+ ResetLedStatus(pLed); -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _init_timer(&(pLed->BlinkTimer), padapter->pnetdev, BlinkTimerCallback, pLed); -+#else -+ timer_setup(&pLed->BlinkTimer, BlinkTimerCallback, 0); -+#endif -+ _init_workitem(&(pLed->BlinkWorkItem), BlinkWorkItemCallback, pLed); -+} -+ -+ -+// -+// Description: -+// DeInitialize an LED_871x object. -+// -+void -+DeInitLed( -+ PLED_USB pLed -+ ) -+{ -+ _cancel_workitem_sync(&(pLed->BlinkWorkItem)); -+ _cancel_timer_ex(&(pLed->BlinkTimer)); -+ ResetLedStatus(pLed); -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm.c 2018-02-06 17:42:30.711967179 +0200 -@@ -0,0 +1,4874 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "odm_precomp.h" -+ -+ -+const u2Byte dB_Invert_Table[8][12] = { -+ { 1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4}, -+ { 4, 5, 6, 6, 7, 8, 9, 10, 11, 13, 14, 16}, -+ { 18, 20, 22, 25, 28, 32, 35, 40, 45, 50, 56, 63}, -+ { 71, 79, 89, 100, 112, 126, 141, 158, 178, 200, 224, 251}, -+ { 282, 316, 355, 398, 447, 501, 562, 631, 708, 794, 891, 1000}, -+ { 1122, 1259, 1413, 1585, 1778, 1995, 2239, 2512, 2818, 3162, 3548, 3981}, -+ { 4467, 5012, 5623, 6310, 7079, 7943, 8913, 10000, 11220, 12589, 14125, 15849}, -+ { 17783, 19953, 22387, 25119, 28184, 31623, 35481, 39811, 44668, 50119, 56234, 65535}}; -+ -+// 20100515 Joseph: Add global variable to keep temporary scan list for antenna switching test. -+//u1Byte tmpNumBssDesc; -+//RT_WLAN_BSS tmpbssDesc[MAX_BSS_DESC]; -+ -+static u4Byte edca_setting_UL[HT_IOT_PEER_MAX] = -+// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU MARVELL 92U_AP SELF_AP(DownLink/Tx) -+{ 0x5e4322, 0xa44f, 0x5e4322, 0x5ea32b, 0x5ea422, 0x5ea322, 0x3ea430, 0x5ea42b, 0x5ea44f, 0x5e4322, 0x5e4322}; -+ -+ -+static u4Byte edca_setting_DL[HT_IOT_PEER_MAX] = -+// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU, MARVELL 92U_AP SELF_AP(UpLink/Rx) -+{ 0xa44f, 0x5ea44f, 0x5e4322, 0x5ea42b, 0xa44f, 0xa630, 0x5ea630, 0x5ea42b, 0xa44f, 0xa42b, 0xa42b}; -+ -+static u4Byte edca_setting_DL_GMode[HT_IOT_PEER_MAX] = -+// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU, MARVELL 92U_AP SELF_AP -+{ 0x4322, 0xa44f, 0x5e4322, 0xa42b, 0x5e4322, 0x4322, 0xa42b, 0x5ea42b, 0xa44f, 0x5e4322, 0x5ea42b}; -+ -+//============================================================ -+// Global var -+//============================================================ -+ -+u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D] = { -+ 0x7f8001fe, // 0, +6.0dB -+ 0x788001e2, // 1, +5.5dB -+ 0x71c001c7, // 2, +5.0dB -+ 0x6b8001ae, // 3, +4.5dB -+ 0x65400195, // 4, +4.0dB -+ 0x5fc0017f, // 5, +3.5dB -+ 0x5a400169, // 6, +3.0dB -+ 0x55400155, // 7, +2.5dB -+ 0x50800142, // 8, +2.0dB -+ 0x4c000130, // 9, +1.5dB -+ 0x47c0011f, // 10, +1.0dB -+ 0x43c0010f, // 11, +0.5dB -+ 0x40000100, // 12, +0dB -+ 0x3c8000f2, // 13, -0.5dB -+ 0x390000e4, // 14, -1.0dB -+ 0x35c000d7, // 15, -1.5dB -+ 0x32c000cb, // 16, -2.0dB -+ 0x300000c0, // 17, -2.5dB -+ 0x2d4000b5, // 18, -3.0dB -+ 0x2ac000ab, // 19, -3.5dB -+ 0x288000a2, // 20, -4.0dB -+ 0x26000098, // 21, -4.5dB -+ 0x24000090, // 22, -5.0dB -+ 0x22000088, // 23, -5.5dB -+ 0x20000080, // 24, -6.0dB -+ 0x1e400079, // 25, -6.5dB -+ 0x1c800072, // 26, -7.0dB -+ 0x1b00006c, // 27. -7.5dB -+ 0x19800066, // 28, -8.0dB -+ 0x18000060, // 29, -8.5dB -+ 0x16c0005b, // 30, -9.0dB -+ 0x15800056, // 31, -9.5dB -+ 0x14400051, // 32, -10.0dB -+ 0x1300004c, // 33, -10.5dB -+ 0x12000048, // 34, -11.0dB -+ 0x11000044, // 35, -11.5dB -+ 0x10000040, // 36, -12.0dB -+}; -+ -+u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, // 0, +0dB -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 1, -0.5dB -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 2, -1.0dB -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 3, -1.5dB -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 4, -2.0dB -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 5, -2.5dB -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 6, -3.0dB -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 7, -3.5dB -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 8, -4.0dB -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 9, -4.5dB -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 10, -5.0dB -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 11, -5.5dB -+ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 12, -6.0dB <== default -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 13, -6.5dB -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 14, -7.0dB -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 15, -7.5dB -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 17, -8.5dB -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 18, -9.0dB -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 19, -9.5dB -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 20, -10.0dB -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 21, -10.5dB -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 22, -11.0dB -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 23, -11.5dB -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 24, -12.0dB -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 25, -12.5dB -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 26, -13.0dB -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 27, -13.5dB -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 28, -14.0dB -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 29, -14.5dB -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 30, -15.0dB -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 31, -15.5dB -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} // 32, -16.0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = { -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, // 0, +0dB -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 1, -0.5dB -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 2, -1.0dB -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 3, -1.5dB -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 4, -2.0dB -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 5, -2.5dB -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 6, -3.0dB -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 7, -3.5dB -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 8, -4.0dB -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 9, -4.5dB -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 10, -5.0dB -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 11, -5.5dB -+ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 12, -6.0dB <== default -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 13, -6.5dB -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 14, -7.0dB -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 15, -7.5dB -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 17, -8.5dB -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 18, -9.0dB -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 19, -9.5dB -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 20, -10.0dB -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 21, -10.5dB -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 22, -11.0dB -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 23, -11.5dB -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 24, -12.0dB -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 25, -12.5dB -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 26, -13.0dB -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 27, -13.5dB -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 28, -14.0dB -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 29, -14.5dB -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 30, -15.0dB -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 31, -15.5dB -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} // 32, -16.0dB -+}; -+ -+ -+u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE_92D] = { -+ 0x0b40002d, // 0, -15.0dB -+ 0x0c000030, // 1, -14.5dB -+ 0x0cc00033, // 2, -14.0dB -+ 0x0d800036, // 3, -13.5dB -+ 0x0e400039, // 4, -13.0dB -+ 0x0f00003c, // 5, -12.5dB -+ 0x10000040, // 6, -12.0dB -+ 0x11000044, // 7, -11.5dB -+ 0x12000048, // 8, -11.0dB -+ 0x1300004c, // 9, -10.5dB -+ 0x14400051, // 10, -10.0dB -+ 0x15800056, // 11, -9.5dB -+ 0x16c0005b, // 12, -9.0dB -+ 0x18000060, // 13, -8.5dB -+ 0x19800066, // 14, -8.0dB -+ 0x1b00006c, // 15, -7.5dB -+ 0x1c800072, // 16, -7.0dB -+ 0x1e400079, // 17, -6.5dB -+ 0x20000080, // 18, -6.0dB -+ 0x22000088, // 19, -5.5dB -+ 0x24000090, // 20, -5.0dB -+ 0x26000098, // 21, -4.5dB -+ 0x288000a2, // 22, -4.0dB -+ 0x2ac000ab, // 23, -3.5dB -+ 0x2d4000b5, // 24, -3.0dB -+ 0x300000c0, // 25, -2.5dB -+ 0x32c000cb, // 26, -2.0dB -+ 0x35c000d7, // 27, -1.5dB -+ 0x390000e4, // 28, -1.0dB -+ 0x3c8000f2, // 29, -0.5dB -+ 0x40000100, // 30, +0dB -+ 0x43c0010f, // 31, +0.5dB -+ 0x47c0011f, // 32, +1.0dB -+ 0x4c000130, // 33, +1.5dB -+ 0x50800142, // 34, +2.0dB -+ 0x55400155, // 35, +2.5dB -+ 0x5a400169, // 36, +3.0dB -+ 0x5fc0017f, // 37, +3.5dB -+ 0x65400195, // 38, +4.0dB -+ 0x6b8001ae, // 39, +4.5dB -+ 0x71c001c7, // 40, +5.0dB -+ 0x788001e2, // 41, +5.5dB -+ 0x7f8001fe // 42, +6.0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { -+ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB -+ {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB -+ {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB -+}; -+ -+ -+u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { -+ {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB -+ {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB -+ {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB -+ {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB -+ {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB -+ {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB -+ {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB -+ {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB -+ {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB -+ {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB -+ {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB -+ {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB -+ {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB -+ {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB -+ {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB -+ {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB -+ {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB -+ {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB -+ {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB -+ {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB -+ {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB -+ {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB -+ {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB -+ {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB -+ {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB -+ {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB -+ {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB -+ {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB -+ {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB -+ {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB -+ {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB -+ {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB -+ {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB -+}; -+ -+u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = -+{ -+ 0x081, // 0, -12.0dB -+ 0x088, // 1, -11.5dB -+ 0x090, // 2, -11.0dB -+ 0x099, // 3, -10.5dB -+ 0x0A2, // 4, -10.0dB -+ 0x0AC, // 5, -9.5dB -+ 0x0B6, // 6, -9.0dB -+ 0x0C0, // 7, -8.5dB -+ 0x0CC, // 8, -8.0dB -+ 0x0D8, // 9, -7.5dB -+ 0x0E5, // 10, -7.0dB -+ 0x0F2, // 11, -6.5dB -+ 0x101, // 12, -6.0dB -+ 0x110, // 13, -5.5dB -+ 0x120, // 14, -5.0dB -+ 0x131, // 15, -4.5dB -+ 0x143, // 16, -4.0dB -+ 0x156, // 17, -3.5dB -+ 0x16A, // 18, -3.0dB -+ 0x180, // 19, -2.5dB -+ 0x197, // 20, -2.0dB -+ 0x1AF, // 21, -1.5dB -+ 0x1C8, // 22, -1.0dB -+ 0x1E3, // 23, -0.5dB -+ 0x200, // 24, +0 dB -+ 0x21E, // 25, +0.5dB -+ 0x23E, // 26, +1.0dB -+ 0x261, // 27, +1.5dB -+ 0x285, // 28, +2.0dB -+ 0x2AB, // 29, +2.5dB -+ 0x2D3, // 30, +3.0dB -+ 0x2FE, // 31, +3.5dB -+ 0x32B, // 32, +4.0dB -+ 0x35C, // 33, +4.5dB -+ 0x38E, // 34, +5.0dB -+ 0x3C4, // 35, +5.5dB -+ 0x3FE // 36, +6.0dB -+}; -+ -+#ifdef AP_BUILD_WORKAROUND -+ -+unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { -+ /* +6.0dB */ 0x7f8001fe, -+ /* +5.5dB */ 0x788001e2, -+ /* +5.0dB */ 0x71c001c7, -+ /* +4.5dB */ 0x6b8001ae, -+ /* +4.0dB */ 0x65400195, -+ /* +3.5dB */ 0x5fc0017f, -+ /* +3.0dB */ 0x5a400169, -+ /* +2.5dB */ 0x55400155, -+ /* +2.0dB */ 0x50800142, -+ /* +1.5dB */ 0x4c000130, -+ /* +1.0dB */ 0x47c0011f, -+ /* +0.5dB */ 0x43c0010f, -+ /* 0.0dB */ 0x40000100, -+ /* -0.5dB */ 0x3c8000f2, -+ /* -1.0dB */ 0x390000e4, -+ /* -1.5dB */ 0x35c000d7, -+ /* -2.0dB */ 0x32c000cb, -+ /* -2.5dB */ 0x300000c0, -+ /* -3.0dB */ 0x2d4000b5, -+ /* -3.5dB */ 0x2ac000ab, -+ /* -4.0dB */ 0x288000a2, -+ /* -4.5dB */ 0x26000098, -+ /* -5.0dB */ 0x24000090, -+ /* -5.5dB */ 0x22000088, -+ /* -6.0dB */ 0x20000080, -+ /* -6.5dB */ 0x1a00006c, -+ /* -7.0dB */ 0x1c800072, -+ /* -7.5dB */ 0x18000060, -+ /* -8.0dB */ 0x19800066, -+ /* -8.5dB */ 0x15800056, -+ /* -9.0dB */ 0x26c0005b, -+ /* -9.5dB */ 0x14400051, -+ /* -10.0dB */ 0x24400051, -+ /* -10.5dB */ 0x1300004c, -+ /* -11.0dB */ 0x12000048, -+ /* -11.5dB */ 0x11000044, -+ /* -12.0dB */ 0x10000040 -+}; -+#endif -+ -+//============================================================ -+// Local Function predefine. -+//============================================================ -+ -+//START------------COMMON INFO RELATED---------------// -+void -+odm_CommonInfoSelfInit( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_CommonInfoSelfUpdate( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_CmnInfoInit_Debug( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_CmnInfoHook_Debug( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_CmnInfoUpdate_Debug( -+ PDM_ODM_T pDM_Odm -+ ); -+void -+odm_BasicDbgMessage -+( -+ PDM_ODM_T pDM_Odm -+ ); -+/* -+void -+odm_FindMinimumRSSI( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_IsLinked( -+ PDM_ODM_T pDM_Odm -+ ); -+*/ -+//END------------COMMON INFO RELATED---------------// -+ -+//START---------------DIG---------------------------// -+void -+odm_FalseAlarmCounterStatistics( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_DIGInit( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_DIG( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+bool -+odm_DigAbort( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_CCKPacketDetectionThresh( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_AdaptivityInit( -+ PDM_ODM_T pDM_Odm -+); -+ -+void -+odm_Adaptivity( -+ PDM_ODM_T pDM_Odm, -+ u1Byte IGI -+); -+//END---------------DIG---------------------------// -+ -+//START-------BB POWER SAVE-----------------------// -+void -+odm_DynamicBBPowerSavingInit( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_DynamicBBPowerSaving( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_1R_CCA( -+ PDM_ODM_T pDM_Odm -+ ); -+//END---------BB POWER SAVE-----------------------// -+ -+void -+odm_RefreshRateAdaptiveMaskMP( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_RefreshRateAdaptiveMaskCE( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_RefreshRateAdaptiveMaskAPADSL( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_DynamicATCSwitch_init( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_DynamicATCSwitch( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_Write_CrystalCap( -+ PDM_ODM_T pDM_Odm, -+ u1Byte CrystalCap -+); -+ -+void -+odm_DynamicTxPowerInit( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_DynamicTxPowerRestorePowerIndex( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_DynamicTxPowerNIC( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_DynamicTxPowerSavePowerIndex( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_DynamicTxPowerWritePowerIndex( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Value); -+ -+void -+odm_DynamicTxPower_92C( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_DynamicTxPower_92D( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_MPT_DIGCallback( -+ PRT_TIMER pTimer -+); -+ -+void -+odm_MPT_DIGWorkItemCallback( -+ void * pContext -+ ); -+ -+void -+odm_RSSIMonitorInit( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_RSSIMonitorCheckMP( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_RSSIMonitorCheckCE( -+ PDM_ODM_T pDM_Odm -+ ); -+void -+odm_RSSIMonitorCheckAP( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+ -+ -+void -+odm_RSSIMonitorCheck( -+ PDM_ODM_T pDM_Odm -+ ); -+void -+odm_DynamicTxPower( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_DynamicTxPowerAP( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+ -+void -+odm_SwAntDivInit( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_SwAntDivInit_NIC( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_SwAntDivChkAntSwitch( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Step -+ ); -+ -+void -+odm_SwAntDivChkAntSwitchNIC( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Step -+ ); -+ -+ -+void odm_SwAntDivChkAntSwitchCallback(void *FunctionContext); -+ -+void -+odm_GlobalAdapterCheck( -+ void -+ ); -+ -+void -+odm_RefreshBasicRateMask( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_RefreshRateAdaptiveMask( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+ODM_TXPowerTrackingCheck( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_TXPowerTrackingCheckAP( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+ -+ -+ -+ -+ -+ -+void -+odm_RateAdaptiveMaskInit( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_TXPowerTrackingThermalMeterInit( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+ -+void -+odm_TXPowerTrackingInit( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_TXPowerTrackingCheckMP( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+ -+void -+odm_TXPowerTrackingCheckCE( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+odm_EdcaTurboCheck( -+ PDM_ODM_T pDM_Odm -+ ); -+void -+ODM_EdcaTurboInit( -+ PDM_ODM_T pDM_Odm -+); -+ -+void -+odm_EdcaTurboCheckCE( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+#define RxDefaultAnt1 0x65a9 -+#define RxDefaultAnt2 0x569a -+ -+void -+odm_InitHybridAntDiv( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+bool -+odm_StaDefAntSel( -+ PDM_ODM_T pDM_Odm, -+ u4Byte OFDM_Ant1_Cnt, -+ u4Byte OFDM_Ant2_Cnt, -+ u4Byte CCK_Ant1_Cnt, -+ u4Byte CCK_Ant2_Cnt, -+ u1Byte *pDefAnt -+ ); -+ -+void -+odm_SetRxIdleAnt( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Ant, -+ bool bDualPath -+); -+ -+ -+ -+void -+odm_HwAntDiv( -+ PDM_ODM_T pDM_Odm -+); -+ -+void odm_PathDiversityInit(PDM_ODM_T pDM_Odm); -+void odm_PathDiversity( PDM_ODM_T pDM_Odm); -+ -+//============================================================ -+//3 Export Interface -+//============================================================ -+ -+// -+// 2011/09/21 MH Add to describe different team necessary resource allocate?? -+// -+void -+ODM_DMInit( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+ //2012.05.03 Luke: For all IC series -+ odm_CommonInfoSelfInit(pDM_Odm); -+ odm_CmnInfoInit_Debug(pDM_Odm); -+ odm_DIGInit(pDM_Odm); -+ odm_AdaptivityInit(pDM_Odm); -+ odm_RateAdaptiveMaskInit(pDM_Odm); -+ -+ if ( *(pDM_Odm->mp_mode) != 1) -+ odm_PathDiversityInit(pDM_Odm); -+ ODM_EdcaTurboInit(pDM_Odm); -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ odm_TXPowerTrackingInit(pDM_Odm); -+ if (*(pDM_Odm->mp_mode) != 1) -+ odm_InitHybridAntDiv(pDM_Odm); -+ } else if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { -+ odm_DynamicBBPowerSavingInit(pDM_Odm); -+ odm_DynamicTxPowerInit(pDM_Odm); -+ odm_TXPowerTrackingInit(pDM_Odm); -+ -+ if ( *(pDM_Odm->mp_mode) != 1) { -+ if(pDM_Odm->SupportICType==ODM_RTL8723A) { -+ odm_SwAntDivInit(pDM_Odm); -+ } else if(pDM_Odm->SupportICType & (ODM_RTL8192C|ODM_RTL8192D)) { -+ if(pDM_Odm->AntDivType == HW_ANTDIV) -+ odm_InitHybridAntDiv(pDM_Odm); -+ else -+ odm_SwAntDivInit(pDM_Odm); -+ } else { -+ odm_InitHybridAntDiv(pDM_Odm); -+ } -+ } -+ } -+ -+ odm_DynamicATCSwitch_init(pDM_Odm); -+} -+ -+// -+// 2011/09/20 MH This is the entry pointer for all team to execute HW out source DM. -+// You can not add any dummy function here, be care, you can only use DM structure -+// to perform any new ODM_DM. -+// -+void -+ODM_DMWatchdog( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ //odm_CmnInfoHook_Debug(pDM_Odm); -+ //odm_CmnInfoUpdate_Debug(pDM_Odm); -+ -+ odm_CommonInfoSelfUpdate(pDM_Odm); -+ odm_BasicDbgMessage(pDM_Odm); -+ odm_FalseAlarmCounterStatistics(pDM_Odm); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): RSSI=0x%x\n",pDM_Odm->RSSI_Min)); -+ -+ odm_RSSIMonitorCheck(pDM_Odm); -+ -+ //For CE Platform(SPRD or Tablet) -+ //8723A or 8189ES platform -+ //NeilChen--2012--08--24-- -+ //Fix Leave LPS issue -+ if( (pDM_Odm->Adapter->pwrctrlpriv.pwr_mode != PS_MODE_ACTIVE) &&// in LPS mode -+ ( -+ (pDM_Odm->SupportICType & (ODM_RTL8723A ) )|| -+ (pDM_Odm->SupportICType & (ODM_RTL8188E) &&((pDM_Odm->SupportInterface == ODM_ITRF_SDIO)) ) -+ ) -+ ) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("----Step1: odm_DIG is in LPS mode\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("---Step2: 8723AS is in LPS mode\n")); -+ odm_DIGbyRSSI_LPS(pDM_Odm); -+ } -+ else -+ { -+ odm_DIG(pDM_Odm); -+ } -+ -+ { -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ odm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue); -+ } -+ odm_CCKPacketDetectionThresh(pDM_Odm); -+ -+ if(*(pDM_Odm->pbPowerSaving)==true) -+ return; -+ -+ -+ odm_RefreshRateAdaptiveMask(pDM_Odm); -+ odm_RefreshBasicRateMask(pDM_Odm); -+ odm_DynamicBBPowerSaving(pDM_Odm); -+ odm_EdcaTurboCheck(pDM_Odm); -+ odm_PathDiversity(pDM_Odm); -+ odm_DynamicATCSwitch(pDM_Odm); -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ return; -+ -+ if ( *(pDM_Odm->mp_mode) != 1) { -+ if(pDM_Odm->SupportICType==ODM_RTL8723A) { -+ odm_SwAntDivChkAntSwitch(pDM_Odm, SWAW_STEP_PEAK); -+ } else if(pDM_Odm->SupportICType & (ODM_RTL8192C|ODM_RTL8192D)) { -+ if(pDM_Odm->AntDivType == HW_ANTDIV) -+ odm_HwAntDiv(pDM_Odm); -+ else -+ odm_SwAntDivChkAntSwitch(pDM_Odm, SWAW_STEP_PEAK); -+ } else { -+ odm_HwAntDiv(pDM_Odm); -+ } -+ } -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { -+ if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) { -+ ODM_TXPowerTrackingCheck(pDM_Odm); -+ } -+ if(pDM_Odm->SupportICType & ODM_RTL8821) -+ { -+ if(pDM_Odm->bLinked) -+ { -+ if((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) -+ { -+ pDM_Odm->preChannel = *pDM_Odm->pChannel; -+ pDM_Odm->LinkedInterval = 0; -+ } -+ -+ if(pDM_Odm->LinkedInterval < 3) -+ pDM_Odm->LinkedInterval++; -+ -+ if(pDM_Odm->LinkedInterval == 2) -+ { -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ -+ //mark out IQK flow to prevent tx stuck. by Maddest 20130306 -+ //PHY_IQCalibrate_8821A(pAdapter, false); -+ } -+ } -+ else -+ pDM_Odm->LinkedInterval = 0; -+ } -+ } -+ else if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ if (!(pDM_Odm->SupportICType & (ODM_RTL8723B))) -+ ODM_TXPowerTrackingCheck(pDM_Odm); -+ -+ //odm_EdcaTurboCheck(pDM_Odm); -+ odm_DynamicTxPower(pDM_Odm); -+ -+//2010.05.30 LukeLee: For CE platform, files in IC subfolders may not be included to be compiled, -+// so compile flags must be left here to prevent from compile errors -+ odm_DynamicBBPowerSaving(pDM_Odm); -+ } -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt = 0; -+ -+ odm_dtc(pDM_Odm); -+} -+ -+ -+// -+// Init /.. Fixed HW value. Only init time. -+// -+void -+ODM_CmnInfoInit( -+ PDM_ODM_T pDM_Odm, -+ ODM_CMNINFO_E CmnInfo, -+ u4Byte Value -+ ) -+{ -+ //ODM_RT_TRACE(pDM_Odm,); -+ -+ // -+ // This section is used for init value -+ // -+ switch (CmnInfo) -+ { -+ // -+ // Fixed ODM value. -+ // -+ case ODM_CMNINFO_ABILITY: -+ pDM_Odm->SupportAbility = (u4Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RF_TYPE: -+ pDM_Odm->RFType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_PLATFORM: -+ pDM_Odm->SupportPlatform = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_INTERFACE: -+ pDM_Odm->SupportInterface = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_MP_TEST_CHIP: -+ pDM_Odm->bIsMPChip= (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_IC_TYPE: -+ pDM_Odm->SupportICType = Value; -+ break; -+ -+ case ODM_CMNINFO_CUT_VER: -+ pDM_Odm->CutVersion = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_FAB_VER: -+ pDM_Odm->FabVersion = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RFE_TYPE: -+ pDM_Odm->RFEType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RF_ANTENNA_TYPE: -+ pDM_Odm->AntDivType= (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BOARD_TYPE: -+ pDM_Odm->BoardType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_EXT_LNA: -+ pDM_Odm->ExtLNA = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_5G_EXT_LNA: -+ pDM_Odm->ExtLNA5G = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_EXT_PA: -+ pDM_Odm->ExtPA = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_5G_EXT_PA: -+ pDM_Odm->ExtPA5G = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_EXT_TRSW: -+ pDM_Odm->ExtTRSW = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_PATCH_ID: -+ pDM_Odm->PatchID = (u1Byte)Value; -+ break; -+ case ODM_CMNINFO_BINHCT_TEST: -+ pDM_Odm->bInHctTest = (bool)Value; -+ break; -+ case ODM_CMNINFO_BWIFI_TEST: -+ pDM_Odm->bWIFITest = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_SMART_CONCURRENT: -+ pDM_Odm->bDualMacSmartConcurrent = (bool )Value; -+ break; -+ -+ //To remove the compiler warning, must add an empty default statement to handle the other values. -+ default: -+ //do nothing -+ break; -+ -+ } -+ -+} -+ -+ -+void -+ODM_CmnInfoHook( -+ PDM_ODM_T pDM_Odm, -+ ODM_CMNINFO_E CmnInfo, -+ void * pValue -+ ) -+{ -+ // -+ // Hook call by reference pointer. -+ // -+ switch (CmnInfo) -+ { -+ // -+ // Dynamic call by reference pointer. -+ // -+ case ODM_CMNINFO_MAC_PHY_MODE: -+ pDM_Odm->pMacPhyMode = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_TX_UNI: -+ pDM_Odm->pNumTxBytesUnicast = (u8Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_RX_UNI: -+ pDM_Odm->pNumRxBytesUnicast = (u8Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_WM_MODE: -+ pDM_Odm->pWirelessMode = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_BAND: -+ pDM_Odm->pBandType = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_SEC_CHNL_OFFSET: -+ pDM_Odm->pSecChOffset = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_SEC_MODE: -+ pDM_Odm->pSecurity = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_BW: -+ pDM_Odm->pBandWidth = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_CHNL: -+ pDM_Odm->pChannel = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_DMSP_GET_VALUE: -+ pDM_Odm->pbGetValueFromOtherMac = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_BUDDY_ADAPTOR: -+ pDM_Odm->pBuddyAdapter = (PADAPTER *)pValue; -+ break; -+ -+ case ODM_CMNINFO_DMSP_IS_MASTER: -+ pDM_Odm->pbMasterOfDMSP = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_SCAN: -+ pDM_Odm->pbScanInProcess = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_POWER_SAVING: -+ pDM_Odm->pbPowerSaving = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_ONE_PATH_CCA: -+ pDM_Odm->pOnePathCCA = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_DRV_STOP: -+ pDM_Odm->pbDriverStopped = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_PNP_IN: -+ pDM_Odm->pbDriverIsGoingToPnpSetPowerSleep = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_INIT_ON: -+ pDM_Odm->pinit_adpt_in_progress = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_ANT_TEST: -+ pDM_Odm->pAntennaTest = (u1Byte *)pValue; -+ break; -+ -+ case ODM_CMNINFO_NET_CLOSED: -+ pDM_Odm->pbNet_closed = (bool *)pValue; -+ break; -+ -+ case ODM_CMNINFO_FORCED_RATE: -+ pDM_Odm->pForcedDataRate = (pu2Byte)pValue; -+ break; -+ -+ case ODM_CMNINFO_MP_MODE: -+ pDM_Odm->mp_mode = (u1Byte *)pValue; -+ break; -+ -+ //case ODM_CMNINFO_RTSTA_AID: -+ // pDM_Odm->pAidMap = (u1Byte *)pValue; -+ // break; -+ -+ //case ODM_CMNINFO_BT_COEXIST: -+ // pDM_Odm->BTCoexist = (bool *)pValue; -+ -+ //case ODM_CMNINFO_STA_STATUS: -+ //pDM_Odm->pODM_StaInfo[] = (PSTA_INFO_T)pValue; -+ //break; -+ -+ //case ODM_CMNINFO_PHY_STATUS: -+ // pDM_Odm->pPhyInfo = (ODM_PHY_INFO *)pValue; -+ // break; -+ -+ //case ODM_CMNINFO_MAC_STATUS: -+ // pDM_Odm->pMacInfo = (ODM_MAC_INFO *)pValue; -+ // break; -+ //To remove the compiler warning, must add an empty default statement to handle the other values. -+ default: -+ //do nothing -+ break; -+ -+ } -+ -+} -+ -+ -+void -+ODM_CmnInfoPtrArrayHook( -+ PDM_ODM_T pDM_Odm, -+ ODM_CMNINFO_E CmnInfo, -+ u2Byte Index, -+ void * pValue -+ ) -+{ -+ // -+ // Hook call by reference pointer. -+ // -+ switch (CmnInfo) -+ { -+ // -+ // Dynamic call by reference pointer. -+ // -+ case ODM_CMNINFO_STA_STATUS: -+ pDM_Odm->pODM_StaInfo[Index] = (PSTA_INFO_T)pValue; -+ break; -+ //To remove the compiler warning, must add an empty default statement to handle the other values. -+ default: -+ //do nothing -+ break; -+ } -+ -+} -+ -+ -+// -+// Update Band/CHannel/.. The values are dynamic but non-per-packet. -+// -+void -+ODM_CmnInfoUpdate( -+ PDM_ODM_T pDM_Odm, -+ u4Byte CmnInfo, -+ u8Byte Value -+ ) -+{ -+ // -+ // This init variable may be changed in run time. -+ // -+ switch (CmnInfo) -+ { -+ case ODM_CMNINFO_LINK_IN_PROGRESS: -+ pDM_Odm->bLinkInProcess = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_ABILITY: -+ pDM_Odm->SupportAbility = (u4Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RF_TYPE: -+ pDM_Odm->RFType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_WIFI_DIRECT: -+ pDM_Odm->bWIFI_Direct = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_WIFI_DISPLAY: -+ pDM_Odm->bWIFI_Display = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_LINK: -+ pDM_Odm->bLinked = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_RSSI_MIN: -+ pDM_Odm->RSSI_Min= (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_DBG_COMP: -+ pDM_Odm->DebugComponents = Value; -+ break; -+ -+ case ODM_CMNINFO_DBG_LEVEL: -+ pDM_Odm->DebugLevel = (u4Byte)Value; -+ break; -+ case ODM_CMNINFO_RA_THRESHOLD_HIGH: -+ pDM_Odm->RateAdaptive.HighRSSIThresh = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_RA_THRESHOLD_LOW: -+ pDM_Odm->RateAdaptive.LowRSSIThresh = (u1Byte)Value; -+ break; -+ // The following is for BT HS mode and BT coexist mechanism. -+ case ODM_CMNINFO_BT_DISABLED: -+ pDM_Odm->bBtDisabled = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_HS_CONNECT_PROCESS: -+ pDM_Odm->bBtConnectProcess = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_HS_RSSI: -+ pDM_Odm->btHsRssi = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_OPERATION: -+ pDM_Odm->bBtHsOperation = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_LIMITED_DIG: -+ pDM_Odm->bBtLimitedDig = (bool)Value; -+ break; -+ -+ case ODM_CMNINFO_BT_DISABLE_EDCA: -+ pDM_Odm->bBtDisableEdcaTurbo = (bool)Value; -+ break; -+ -+/* -+ case ODM_CMNINFO_OP_MODE: -+ pDM_Odm->OPMode = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_WM_MODE: -+ pDM_Odm->WirelessMode = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BAND: -+ pDM_Odm->BandType = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_SEC_CHNL_OFFSET: -+ pDM_Odm->SecChOffset = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_SEC_MODE: -+ pDM_Odm->Security = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_BW: -+ pDM_Odm->BandWidth = (u1Byte)Value; -+ break; -+ -+ case ODM_CMNINFO_CHNL: -+ pDM_Odm->Channel = (u1Byte)Value; -+ break; -+*/ -+ default: -+ //do nothing -+ break; -+ } -+ -+ -+} -+ -+void -+odm_CommonInfoSelfInit( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ pDM_Odm->bCckHighPower = (bool) ODM_GetBBReg(pDM_Odm, ODM_REG(CCK_RPT_FORMAT,pDM_Odm), ODM_BIT(CCK_RPT_FORMAT,pDM_Odm)); -+ pDM_Odm->RFPathRxEnable = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(BB_RX_PATH,pDM_Odm), ODM_BIT(BB_RX_PATH,pDM_Odm)); -+ -+ if(pDM_Odm->SupportICType==ODM_RTL8723A) -+ { -+ pDM_Odm->AntDivType = SW_ANTDIV; -+ } -+ -+ else if(pDM_Odm->SupportICType==ODM_RTL8723B) -+ { -+ //pDM_Odm->AntDivType = S0S1_HW_ANTDIV; -+ pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; -+ } -+ -+ else if(pDM_Odm->SupportICType & (ODM_RTL8192C|ODM_RTL8192D)) -+ { -+#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ pDM_Odm->AntDivType = HW_ANTDIV; -+#elif (defined(CONFIG_SW_ANTENNA_DIVERSITY)) -+ pDM_Odm->AntDivType = SW_ANTDIV; -+#endif -+ } -+ pDM_Odm->TxRate = 0xFF; -+ ODM_InitDebugSetting(pDM_Odm); -+} -+ -+void -+odm_CommonInfoSelfUpdate( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u1Byte EntryCnt=0; -+ u1Byte i; -+ PSTA_INFO_T pEntry; -+ -+ if(*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ { -+ if(*(pDM_Odm->pSecChOffset) == 1) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) -2; -+ else if(*(pDM_Odm->pSecChOffset) == 2) -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) +2; -+ } -+ else -+ pDM_Odm->ControlChannel = *(pDM_Odm->pChannel); -+ -+ for (i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pEntry)) -+ EntryCnt++; -+ } -+ if(EntryCnt == 1) -+ pDM_Odm->bOneEntryOnly = true; -+ else -+ pDM_Odm->bOneEntryOnly = false; -+} -+ -+void -+odm_CmnInfoInit_Debug( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_CmnInfoInit_Debug==>\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("SupportPlatform=%d\n",pDM_Odm->SupportPlatform) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("SupportAbility=0x%x\n",pDM_Odm->SupportAbility) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("SupportInterface=%d\n",pDM_Odm->SupportInterface) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("SupportICType=0x%x\n",pDM_Odm->SupportICType) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("CutVersion=%d\n",pDM_Odm->CutVersion) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("FabVersion=%d\n",pDM_Odm->FabVersion) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("RFType=%d\n",pDM_Odm->RFType) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("BoardType=%d\n",pDM_Odm->BoardType) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("ExtLNA=%d\n",pDM_Odm->ExtLNA) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("ExtPA=%d\n",pDM_Odm->ExtPA) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("ExtTRSW=%d\n",pDM_Odm->ExtTRSW) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("PatchID=%d\n",pDM_Odm->PatchID) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bInHctTest=%d\n",pDM_Odm->bInHctTest) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bWIFITest=%d\n",pDM_Odm->bWIFITest) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bDualMacSmartConcurrent=%d\n",pDM_Odm->bDualMacSmartConcurrent) ); -+ -+} -+ -+void -+odm_CmnInfoHook_Debug( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_CmnInfoHook_Debug==>\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pNumTxBytesUnicast=%llu\n",*(pDM_Odm->pNumTxBytesUnicast)) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pNumRxBytesUnicast=%llu\n",*(pDM_Odm->pNumRxBytesUnicast)) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pWirelessMode=0x%x\n",*(pDM_Odm->pWirelessMode)) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pSecChOffset=%d\n",*(pDM_Odm->pSecChOffset)) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pSecurity=%d\n",*(pDM_Odm->pSecurity)) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pBandWidth=%d\n",*(pDM_Odm->pBandWidth)) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pChannel=%d\n",*(pDM_Odm->pChannel)) ); -+ -+ if(pDM_Odm->SupportICType==ODM_RTL8192D) -+ { -+ if(pDM_Odm->pBandType) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pBandType=%d\n",*(pDM_Odm->pBandType)) ); -+ if(pDM_Odm->pMacPhyMode) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pMacPhyMode=%d\n",*(pDM_Odm->pMacPhyMode)) ); -+ if(pDM_Odm->pBuddyAdapter) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pbGetValueFromOtherMac=%d\n",*(pDM_Odm->pbGetValueFromOtherMac)) ); -+ if(pDM_Odm->pBuddyAdapter) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pBuddyAdapter=%p\n",*(pDM_Odm->pBuddyAdapter)) ); -+ if(pDM_Odm->pbMasterOfDMSP) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pbMasterOfDMSP=%d\n",*(pDM_Odm->pbMasterOfDMSP)) ); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pbScanInProcess=%d\n",*(pDM_Odm->pbScanInProcess)) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pbPowerSaving=%d\n",*(pDM_Odm->pbPowerSaving)) ); -+ -+ if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL)) -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pOnePathCCA=%d\n",*(pDM_Odm->pOnePathCCA)) ); -+} -+ -+void -+odm_CmnInfoUpdate_Debug( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_CmnInfoUpdate_Debug==>\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bWIFI_Direct=%d\n",pDM_Odm->bWIFI_Direct) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bWIFI_Display=%d\n",pDM_Odm->bWIFI_Display) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bLinked=%d\n",pDM_Odm->bLinked) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("RSSI_Min=%d\n",pDM_Odm->RSSI_Min) ); -+} -+ -+void -+odm_BasicDbgMessage -+( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = &(pDM_Odm->FalseAlmCnt); -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_BasicDbgMsg==>\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("bLinked = %d, RSSI_Min = %d, CurrentIGI = 0x%x \n", -+ pDM_Odm->bLinked, pDM_Odm->RSSI_Min, pDM_DigTable->CurIGValue) ); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("Cnt_Cck_fail = %d, Cnt_Ofdm_fail = %d, Total False Alarm = %d\n", -+ FalseAlmCnt->Cnt_Cck_fail, FalseAlmCnt->Cnt_Ofdm_fail, FalseAlmCnt->Cnt_all)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("RxRate = 0x%x, RSSI_A = %d, RSSI_B = %d\n", -+ pDM_Odm->RxRate, pDM_Odm->RSSI_A, pDM_Odm->RSSI_B)); -+ -+} -+ -+//3============================================================ -+//3 DIG -+//3============================================================ -+/*----------------------------------------------------------------------------- -+ * Function: odm_DIGInit() -+ * -+ * Overview: Set DIG scheme init value. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * -+ *---------------------------------------------------------------------------*/ -+void -+ODM_ChangeDynamicInitGainThresh( -+ PDM_ODM_T pDM_Odm, -+ u4Byte DM_Type, -+ u4Byte DM_Value -+ ) -+{ -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ if (DM_Type == DIG_TYPE_THRESH_HIGH) -+ { -+ pDM_DigTable->RssiHighThresh = DM_Value; -+ } -+ else if (DM_Type == DIG_TYPE_THRESH_LOW) -+ { -+ pDM_DigTable->RssiLowThresh = DM_Value; -+ } -+ else if (DM_Type == DIG_TYPE_ENABLE) -+ { -+ pDM_DigTable->Dig_Enable_Flag = true; -+ } -+ else if (DM_Type == DIG_TYPE_DISABLE) -+ { -+ pDM_DigTable->Dig_Enable_Flag = false; -+ } -+ else if (DM_Type == DIG_TYPE_BACKOFF) -+ { -+ if(DM_Value > 30) -+ DM_Value = 30; -+ pDM_DigTable->BackoffVal = (u1Byte)DM_Value; -+ } -+ else if(DM_Type == DIG_TYPE_RX_GAIN_MIN) -+ { -+ if(DM_Value == 0) -+ DM_Value = 0x1; -+ pDM_DigTable->rx_gain_range_min = (u1Byte)DM_Value; -+ } -+ else if(DM_Type == DIG_TYPE_RX_GAIN_MAX) -+ { -+ if(DM_Value > 0x50) -+ DM_Value = 0x50; -+ pDM_DigTable->rx_gain_range_max = (u1Byte)DM_Value; -+ } -+} /* DM_ChangeDynamicInitGainThresh */ -+ -+int getIGIForDiff(int value_IGI) -+{ -+ #define ONERCCA_LOW_TH 0x30 -+ #define ONERCCA_LOW_DIFF 8 -+ -+ if (value_IGI < ONERCCA_LOW_TH) { -+ if ((ONERCCA_LOW_TH - value_IGI) < ONERCCA_LOW_DIFF) -+ return ONERCCA_LOW_TH; -+ else -+ return value_IGI + ONERCCA_LOW_DIFF; -+ } else { -+ return value_IGI; -+ } -+} -+ -+ -+void -+odm_AdaptivityInit( -+PDM_ODM_T pDM_Odm -+) -+{ -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ -+ if(IS_HARDWARE_TYPE_8723B(pAdapter)) -+ { -+ pDM_Odm->TH_H = 0xf8; //-8dB -+ pDM_Odm->TH_L = 0xfb; //-5dB -+ } -+ else if(IS_HARDWARE_TYPE_8192EE(pAdapter)) -+ { -+ pDM_Odm->TH_H = 0xf0; //-16dB -+ pDM_Odm->TH_L = 0xf3; //-13dB -+ } -+ else -+ { -+ pDM_Odm->TH_H = 0xfa; //-6dB -+ pDM_Odm->TH_L = 0xfd; //-3dB -+ } -+ -+ pDM_Odm->IGI_Base = 0x32; -+ pDM_Odm->IGI_target = 0x1c; -+ pDM_Odm->ForceEDCCA = 0; -+ pDM_Odm->AdapEn_RSSI = 32;//45; -+} -+ -+// Add by Neil Chen to enable edcca to MP Platform -+ -+void -+odm_DynamicATCSwitch_init( -+ PDM_ODM_T pDM_Odm -+) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+} -+ -+void -+odm_DynamicATCSwitch( -+ PDM_ODM_T pDM_Odm -+) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u1Byte CrystalCap,ATC_status_temp = 0; -+ u4Byte packet_count; -+ int CFO_kHz_A,CFO_kHz_B,CFO_ave = 0, Adjust_Xtal = 0; -+ int CFO_ave_diff; -+ -+} -+ -+void -+odm_Write_CrystalCap( -+ PDM_ODM_T pDM_Odm, -+ u1Byte CrystalCap -+) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if(IS_HARDWARE_TYPE_8192D(Adapter)) -+ { -+ PHY_SetBBReg(Adapter, 0x24, 0xF0, CrystalCap & 0x0F); -+ PHY_SetBBReg(Adapter, 0x28, 0xF0000000, ((CrystalCap & 0xF0) >> 4)); -+ } -+ -+ if(IS_HARDWARE_TYPE_8188E(Adapter)) -+ { -+ // write 0x24[16:11] = 0x24[22:17] = CrystalCap -+ PHY_SetBBReg(Adapter, REG_AFE_XTAL_CTRL, 0x7ff800, (CrystalCap | (CrystalCap << 6))); -+ } -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ { -+ // write 0x2C[30:25] = 0x2C[24:19] = CrystalCap -+ CrystalCap = CrystalCap & 0x3F; -+ PHY_SetBBReg(Adapter, REG_MAC_PHY_CTRL, 0x7FF80000, (CrystalCap | (CrystalCap << 6))); -+ } -+ -+ //only for B-cut -+ if ((IS_HARDWARE_TYPE_8723A(Adapter) && pHalData->EEPROMVersion >= 0x01) || -+ IS_HARDWARE_TYPE_8723B(Adapter) ||IS_HARDWARE_TYPE_8192E(Adapter) || IS_HARDWARE_TYPE_8821(Adapter)) -+ { -+ // 0x2C[23:18] = 0x2C[17:12] = CrystalCap -+ CrystalCap = CrystalCap & 0x3F; -+ PHY_SetBBReg(Adapter, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCap | (CrystalCap << 6))); -+ } -+ -+ if(IS_HARDWARE_TYPE_8723AE(Adapter)) -+ PHY_SetBBReg(Adapter, REG_LDOA15_CTRL, bMaskDWord, 0x01572505); -+ -+} -+ -+void -+odm_Adaptivity( -+ PDM_ODM_T pDM_Odm, -+ u1Byte IGI -+) -+{ -+ s4Byte TH_H_dmc, TH_L_dmc; -+ s4Byte TH_H, TH_L, Diff, IGI_target; -+ u4Byte value32; -+ bool EDCCA_State; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("Go to odm_DynamicEDCCA() \n")); -+ // Add by Neil Chen to enable edcca to MP Platform -+ return; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_Adaptivity() =====> \n")); -+ -+ if(pDM_Odm->bForceThresh) -+ { -+ pDM_Odm->TH_H = pDM_Odm->Force_TH_H; -+ pDM_Odm->TH_L = pDM_Odm->Force_TH_L; -+ } -+ else -+ { -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ if(*pDM_Odm->pBandType == BAND_ON_5G) -+ { -+ pDM_Odm->TH_H = 0xf4;//0xf8; -+ pDM_Odm->TH_L = 0xf7;//0xfb; -+ } -+ else -+ { -+ pDM_Odm->TH_H = 0xf4;//0xfa; -+ pDM_Odm->TH_L = 0xf7;//0xfd; -+ } -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("pDM_Odm->ForceEDCCA=%d, IGI_Base=0x%x, TH_H=0x%x, TH_L=0x%x, AdapEn_RSSI = %d\n", -+ pDM_Odm->ForceEDCCA, pDM_Odm->IGI_Base, pDM_Odm->TH_H, pDM_Odm->TH_L, pDM_Odm->AdapEn_RSSI)); -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ ODM_SetBBReg(pDM_Odm, 0x800, BIT10, 0); //ADC_mask enable -+ -+ if(!pDM_Odm->bLinked) -+ { -+ return; -+ } -+ -+ if(!pDM_Odm->ForceEDCCA) -+ { -+ if(pDM_Odm->RSSI_Min > pDM_Odm->AdapEn_RSSI) -+ EDCCA_State = 1; -+ else if(pDM_Odm->RSSI_Min < (pDM_Odm->AdapEn_RSSI - 5)) -+ EDCCA_State = 0; -+ } -+ else -+ EDCCA_State = 1; -+ //if((pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) && (*pDM_Odm->pBandType == BAND_ON_5G)) -+ //IGI_target = pDM_Odm->IGI_Base; -+ //else -+ { -+ -+ if(*pDM_Odm->pBandWidth == ODM_BW20M) //CHANNEL_WIDTH_20 -+ IGI_target = pDM_Odm->IGI_Base; -+ else if(*pDM_Odm->pBandWidth == ODM_BW40M) -+ IGI_target = pDM_Odm->IGI_Base + 2; -+ else if(*pDM_Odm->pBandWidth == ODM_BW80M) -+ IGI_target = pDM_Odm->IGI_Base + 6; -+ else -+ IGI_target = pDM_Odm->IGI_Base; -+ } -+ -+ pDM_Odm->IGI_target = IGI_target; -+ -+ if(pDM_Odm->TH_H & BIT7) -+ TH_H = pDM_Odm->TH_H | 0xFFFFFF00; -+ else -+ TH_H = pDM_Odm->TH_H; -+ if(pDM_Odm->TH_L & BIT7) -+ TH_L = pDM_Odm->TH_L | 0xFFFFFF00; -+ else -+ TH_L = pDM_Odm->TH_L; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("BandWidth=%s, IGI_target=0x%x, EDCCA_State=%d\n", -+ (*pDM_Odm->pBandWidth==ODM_BW80M)?"80M":((*pDM_Odm->pBandWidth==ODM_BW40M)?"40M":"20M"), IGI_target, EDCCA_State)); -+ -+ if(EDCCA_State == 1) -+ { -+ if(IGI < IGI_target) -+ { -+ Diff = IGI_target -(s4Byte)IGI; -+ TH_H_dmc = TH_H + Diff; -+ if(TH_H_dmc > 10) -+ TH_H_dmc = 10; -+ TH_L_dmc = TH_L + Diff; -+ if(TH_L_dmc > 10) -+ TH_L_dmc = 10; -+ } -+ else -+ { -+ Diff = (s4Byte)IGI - IGI_target; -+ TH_H_dmc = TH_H - Diff; -+ TH_L_dmc = TH_L - Diff; -+ } -+ TH_H_dmc = (TH_H_dmc & 0xFF); -+ TH_L_dmc = (TH_L_dmc & 0xFF); -+ } -+ else -+ { -+ TH_H_dmc = 0x7f; -+ TH_L_dmc = 0x7f; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("IGI=0x%x, TH_H_dmc=0x%x, TH_L_dmc=0x%x\n", -+ IGI, TH_H_dmc, TH_L_dmc)); -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ ODM_SetBBReg(pDM_Odm,rOFDM0_ECCAThreshold, bMaskByte0, TH_L_dmc); -+ ODM_SetBBReg(pDM_Odm,rOFDM0_ECCAThreshold, bMaskByte2, TH_H_dmc); -+ } -+ else -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, 0xFFFF, (TH_H_dmc<<8) | TH_L_dmc); -+} -+ -+ -+void -+ODM_Write_DIG( -+ PDM_ODM_T pDM_Odm, -+ u1Byte CurrentIGI -+ ) -+{ -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ if(pDM_Odm->StopDIG) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("Stop Writing IGI\n")); -+ return; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_REG(IGI_A,pDM_Odm)=0x%x, ODM_BIT(IGI,pDM_Odm)=0x%x \n", -+ ODM_REG(IGI_A,pDM_Odm),ODM_BIT(IGI,pDM_Odm))); -+ -+ if(pDM_DigTable->CurIGValue != CurrentIGI)//if(pDM_DigTable->PreIGValue != CurrentIGI) -+ { -+ if(pDM_Odm->SupportPlatform & (ODM_CE|ODM_WIN)) -+ { -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ if(pDM_Odm->RFType != ODM_1T1R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ } -+ else if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL)) -+ { -+ switch(*(pDM_Odm->pOnePathCCA)) -+ { -+ case ODM_CCA_2R: -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ if(pDM_Odm->RFType != ODM_1T1R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ break; -+ case ODM_CCA_1R_A: -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ if(pDM_Odm->RFType != ODM_1T1R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), getIGIForDiff(CurrentIGI)); -+ break; -+ case ODM_CCA_1R_B: -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), getIGIForDiff(CurrentIGI)); -+ if(pDM_Odm->RFType != ODM_1T1R) -+ ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -+ break; -+ } -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("CurrentIGI(0x%02x). \n",CurrentIGI)); -+ //pDM_DigTable->PreIGValue = pDM_DigTable->CurIGValue; -+ pDM_DigTable->CurIGValue = CurrentIGI; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_Write_DIG():CurrentIGI=0x%x \n",CurrentIGI)); -+ -+} -+ -+void -+odm_DIGbyRSSI_LPS( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ //PADAPTER pAdapter =pDM_Odm->Adapter; -+ //pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ PFALSE_ALARM_STATISTICS pFalseAlmCnt = &pDM_Odm->FalseAlmCnt; -+ -+ u1Byte RSSI_Lower=DM_DIG_MIN_NIC; //0x1E or 0x1C -+ u1Byte CurrentIGI=pDM_Odm->RSSI_Min; -+ -+ CurrentIGI=CurrentIGI+RSSI_OFFSET_DIG; -+ -+ // Using FW PS mode to make IGI -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("---Neil---odm_DIG is in LPS mode\n")); -+ //Adjust by FA in LPS MODE -+ if(pFalseAlmCnt->Cnt_all> DM_DIG_FA_TH2_LPS) -+ CurrentIGI = CurrentIGI+2; -+ else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1_LPS) -+ CurrentIGI = CurrentIGI+1; -+ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0_LPS) -+ CurrentIGI = CurrentIGI-1; -+ -+ -+ //Lower bound checking -+ -+ //RSSI Lower bound check -+ if((pDM_Odm->RSSI_Min-10) > DM_DIG_MIN_NIC) -+ RSSI_Lower =(pDM_Odm->RSSI_Min-10); -+ else -+ RSSI_Lower =DM_DIG_MIN_NIC; -+ -+ //Upper and Lower Bound checking -+ if(CurrentIGI > DM_DIG_MAX_NIC) -+ CurrentIGI=DM_DIG_MAX_NIC; -+ else if(CurrentIGI < RSSI_Lower) -+ CurrentIGI =RSSI_Lower; -+ -+ ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); -+ -+} -+ -+void -+odm_DIGInit( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ //pDM_DigTable->Dig_Enable_Flag = true; -+ //pDM_DigTable->Dig_Ext_Port_Stage = DIG_EXT_PORT_STAGE_MAX; -+ pDM_DigTable->CurIGValue = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm)); -+ //pDM_DigTable->PreIGValue = 0x0; -+ //pDM_DigTable->CurSTAConnectState = pDM_DigTable->PreSTAConnectState = DIG_STA_DISCONNECT; -+ //pDM_DigTable->CurMultiSTAConnectState = DIG_MultiSTA_DISCONNECT; -+ pDM_DigTable->RssiLowThresh = DM_DIG_THRESH_LOW; -+ pDM_DigTable->RssiHighThresh = DM_DIG_THRESH_HIGH; -+ pDM_DigTable->FALowThresh = DMfalseALARM_THRESH_LOW; -+ pDM_DigTable->FAHighThresh = DMfalseALARM_THRESH_HIGH; -+ if(pDM_Odm->BoardType & (ODM_BOARD_EXT_PA|ODM_BOARD_EXT_LNA)) -+ { -+ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; -+ pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; -+ } -+ else -+ { -+ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; -+ pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; -+ } -+ pDM_DigTable->BackoffVal = DM_DIG_BACKOFF_DEFAULT; -+ pDM_DigTable->BackoffVal_range_max = DM_DIG_BACKOFF_MAX; -+ pDM_DigTable->BackoffVal_range_min = DM_DIG_BACKOFF_MIN; -+ pDM_DigTable->PreCCK_CCAThres = 0xFF; -+ pDM_DigTable->CurCCK_CCAThres = 0x83; -+ pDM_DigTable->ForbiddenIGI = DM_DIG_MIN_NIC; -+ pDM_DigTable->LargeFAHit = 0; -+ pDM_DigTable->Recover_cnt = 0; -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DM_DIG_MIN_NIC; -+ pDM_DigTable->DIG_Dynamic_MIN_1 = DM_DIG_MIN_NIC; -+ pDM_DigTable->bMediaConnect_0 = false; -+ pDM_DigTable->bMediaConnect_1 = false; -+ -+ //To Initialize pDM_Odm->bDMInitialGainEnable == false to avoid DIG error -+ pDM_Odm->bDMInitialGainEnable = true; -+ -+ //To Initi BT30 IGI -+ pDM_DigTable->BT30_CurIGI=0x32; -+ -+} -+ -+void -+odm_DigForBtHsMode( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+void -+odm_DIG( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ PFALSE_ALARM_STATISTICS pFalseAlmCnt = &pDM_Odm->FalseAlmCnt; -+ pRXHP_T pRX_HP_Table = &pDM_Odm->DM_RXHP_Table; -+ u1Byte DIG_Dynamic_MIN; -+ u1Byte DIG_MaxOfMin; -+ bool FirstConnect, FirstDisConnect; -+ u1Byte dm_dig_max, dm_dig_min, offset; -+ u1Byte CurrentIGI = pDM_DigTable->CurIGValue; -+ -+#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+ if((pDM_Odm->bLinked) && (pDM_Odm->Adapter->registrypriv.force_igi !=0)) -+ { -+ printk("pDM_Odm->RSSI_Min=%d \n",pDM_Odm->RSSI_Min); -+ ODM_Write_DIG(pDM_Odm,pDM_Odm->Adapter->registrypriv.force_igi); -+ return; -+ } -+#endif -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG()==>\n")); -+ if((!(pDM_Odm->SupportAbility&ODM_BB_DIG)) ||(!(pDM_Odm->SupportAbility&ODM_BB_FA_CNT))) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() Return: SupportAbility ODM_BB_DIG or ODM_BB_FA_CNT is disabled\n")); -+ return; -+ } -+ -+ if(*(pDM_Odm->pbScanInProcess)) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() Return: In Scan Progress \n")); -+ return; -+ } -+ -+ //add by Neil Chen to avoid PSD is processing -+ if(pDM_Odm->SupportICType==ODM_RTL8723A) -+ { -+ if(pDM_Odm->bDMInitialGainEnable == false) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() Return: PSD is Processing \n")); -+ return; -+ } -+ } -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ { -+ if(*(pDM_Odm->pMacPhyMode) == ODM_DMSP) -+ { -+ if(*(pDM_Odm->pbMasterOfDMSP)) -+ { -+ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; -+ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == false); -+ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == true); -+ } -+ else -+ { -+ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_1; -+ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_1 == false); -+ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_1 == true); -+ } -+ } -+ else -+ { -+ if(*(pDM_Odm->pBandType) == ODM_BAND_5G) -+ { -+ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; -+ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == false); -+ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == true); -+ } -+ else -+ { -+ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_1; -+ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_1 == false); -+ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_1 == true); -+ } -+ } -+ } -+ else -+ { -+ DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; -+ FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == false); -+ FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == true); -+ } -+ -+ //1 Boundary Decision -+ if(pDM_Odm->SupportICType & (ODM_RTL8192C) &&(pDM_Odm->BoardType & (ODM_BOARD_EXT_LNA | ODM_BOARD_EXT_PA))) -+ { -+ if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL)) -+ { -+ -+ dm_dig_max = DM_DIG_MAX_AP_HP; -+ dm_dig_min = DM_DIG_MIN_AP_HP; -+ } -+ else -+ { -+ dm_dig_max = DM_DIG_MAX_NIC_HP; -+ dm_dig_min = DM_DIG_MIN_NIC_HP; -+ } -+ DIG_MaxOfMin = DM_DIG_MAX_AP_HP; -+ } -+ else -+ { -+ if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL)) -+ { -+ dm_dig_max = DM_DIG_MAX_AP; -+ dm_dig_min = DM_DIG_MIN_AP; -+ DIG_MaxOfMin = dm_dig_max; -+ } -+ else -+ { -+ if((pDM_Odm->SupportICType >= ODM_RTL8188E) && (pDM_Odm->SupportPlatform & (ODM_WIN|ODM_CE))) -+ dm_dig_max = 0x5A; -+ else -+ dm_dig_max = DM_DIG_MAX_NIC; -+ -+ if(pDM_Odm->SupportICType != ODM_RTL8821) -+ dm_dig_min = DM_DIG_MIN_NIC; -+ else -+ dm_dig_min = 0x1C; -+ -+ DIG_MaxOfMin = DM_DIG_MAX_AP; -+ } -+ } -+ -+ -+ if(pDM_Odm->bLinked) -+ { -+ if(pDM_Odm->SupportICType&(ODM_RTL8723A/*|ODM_RTL8821*/)) -+ { -+ //2 Upper Bound -+ if(( pDM_Odm->RSSI_Min + 10) > DM_DIG_MAX_NIC ) -+ pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; -+ else if(( pDM_Odm->RSSI_Min + 10) < DM_DIG_MIN_NIC ) -+ pDM_DigTable->rx_gain_range_max = DM_DIG_MIN_NIC; -+ else -+ pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + 10; -+ -+ //BT is Concurrent -+ -+ if(pDM_Odm->bBtLimitedDig) -+ { -+ if(pDM_Odm->RSSI_Min>10) -+ { -+ if((pDM_Odm->RSSI_Min - 10) > DM_DIG_MAX_NIC) -+ DIG_Dynamic_MIN = DM_DIG_MAX_NIC; -+ else if((pDM_Odm->RSSI_Min - 10) < DM_DIG_MIN_NIC) -+ DIG_Dynamic_MIN = DM_DIG_MIN_NIC; -+ else -+ DIG_Dynamic_MIN = pDM_Odm->RSSI_Min - 10; -+ } -+ else -+ DIG_Dynamic_MIN=DM_DIG_MIN_NIC; -+ } -+ else -+ { -+ if((pDM_Odm->RSSI_Min + 20) > dm_dig_max ) -+ pDM_DigTable->rx_gain_range_max = dm_dig_max; -+ else if((pDM_Odm->RSSI_Min + 20) < dm_dig_min ) -+ pDM_DigTable->rx_gain_range_max = dm_dig_min; -+ else -+ pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + 20; -+ -+ } -+ } -+ else -+ { -+ if((pDM_Odm->SupportICType & (ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8812|ODM_RTL8821)) && (pDM_Odm->bBtLimitedDig==1)){ -+ //2 Modify DIG upper bound for 92E, 8723B, 8821 & 8812 BT -+ if((pDM_Odm->RSSI_Min + 10) > dm_dig_max ) -+ pDM_DigTable->rx_gain_range_max = dm_dig_max; -+ else if((pDM_Odm->RSSI_Min + 10) < dm_dig_min ) -+ pDM_DigTable->rx_gain_range_max = dm_dig_min; -+ else -+ pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + 10; -+ } -+ else{ -+ -+ //2 Modify DIG upper bound -+ //2013.03.19 Luke: Modified upper bound for Netgear rental house test -+ if(pDM_Odm->SupportICType != ODM_RTL8821) -+ offset = 20; -+ else -+ offset = 10; -+ -+ if((pDM_Odm->RSSI_Min + offset) > dm_dig_max ) -+ pDM_DigTable->rx_gain_range_max = dm_dig_max; -+ else if((pDM_Odm->RSSI_Min + offset) < dm_dig_min ) -+ pDM_DigTable->rx_gain_range_max = dm_dig_min; -+ else -+ pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + offset; -+ -+ } -+ -+ //2 Modify DIG lower bound -+ /* -+ if((pFalseAlmCnt->Cnt_all > 500)&&(DIG_Dynamic_MIN < 0x25)) -+ DIG_Dynamic_MIN++; -+ else if(((pFalseAlmCnt->Cnt_all < 500)||(pDM_Odm->RSSI_Min < 8))&&(DIG_Dynamic_MIN > dm_dig_min)) -+ DIG_Dynamic_MIN--; -+ */ -+ if(pDM_Odm->bOneEntryOnly) -+ { -+ if(pDM_Odm->RSSI_Min < dm_dig_min) -+ DIG_Dynamic_MIN = dm_dig_min; -+ else if (pDM_Odm->RSSI_Min > DIG_MaxOfMin) -+ DIG_Dynamic_MIN = DIG_MaxOfMin; -+ else -+ DIG_Dynamic_MIN = pDM_Odm->RSSI_Min; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() : bOneEntryOnly=true, DIG_Dynamic_MIN=0x%x\n",DIG_Dynamic_MIN)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() : pDM_Odm->RSSI_Min=%d\n",pDM_Odm->RSSI_Min)); -+ } -+ //1 Lower Bound for 88E AntDiv -+ else -+ { -+ DIG_Dynamic_MIN=dm_dig_min; -+ } -+ } -+ } -+ else -+ { -+ pDM_DigTable->rx_gain_range_max = dm_dig_max; -+ DIG_Dynamic_MIN = dm_dig_min; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() : No Link\n")); -+ } -+ -+ //1 Modify DIG lower bound, deal with abnorally large false alarm -+ if(pFalseAlmCnt->Cnt_all > 10000) -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("dm_DIG(): Abnornally false alarm case. \n")); -+ -+ if(pDM_DigTable->LargeFAHit != 3) -+ pDM_DigTable->LargeFAHit++; -+ if(pDM_DigTable->ForbiddenIGI < CurrentIGI)//if(pDM_DigTable->ForbiddenIGI < pDM_DigTable->CurIGValue) -+ { -+ pDM_DigTable->ForbiddenIGI = (u1Byte)CurrentIGI;//pDM_DigTable->ForbiddenIGI = pDM_DigTable->CurIGValue; -+ pDM_DigTable->LargeFAHit = 1; -+ } -+ -+ if(pDM_DigTable->LargeFAHit >= 3) -+ { -+ if((pDM_DigTable->ForbiddenIGI+1) >pDM_DigTable->rx_gain_range_max) -+ pDM_DigTable->rx_gain_range_min = pDM_DigTable->rx_gain_range_max; -+ else -+ pDM_DigTable->rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 1); -+ pDM_DigTable->Recover_cnt = 3600; //3600=2hr -+ } -+ -+ } -+ else -+ { -+ //Recovery mechanism for IGI lower bound -+ if(pDM_DigTable->Recover_cnt != 0) -+ pDM_DigTable->Recover_cnt --; -+ else -+ { -+ if(pDM_DigTable->LargeFAHit < 3) -+ { -+ if((pDM_DigTable->ForbiddenIGI -1) < DIG_Dynamic_MIN) //DM_DIG_MIN) -+ { -+ pDM_DigTable->ForbiddenIGI = DIG_Dynamic_MIN; //DM_DIG_MIN; -+ pDM_DigTable->rx_gain_range_min = DIG_Dynamic_MIN; //DM_DIG_MIN; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: At Lower Bound\n")); -+ } -+ else -+ { -+ pDM_DigTable->ForbiddenIGI --; -+ pDM_DigTable->rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 1); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Approach Lower Bound\n")); -+ } -+ } -+ else -+ { -+ pDM_DigTable->LargeFAHit = 0; -+ } -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): pDM_DigTable->LargeFAHit=%d\n",pDM_DigTable->LargeFAHit)); -+ -+ if((pDM_Odm->SupportPlatform&(ODM_WIN|ODM_CE))&&(pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 10)) -+ pDM_DigTable->rx_gain_range_min = dm_dig_min; -+ -+ if(pDM_DigTable->rx_gain_range_min > pDM_DigTable->rx_gain_range_max) -+ pDM_DigTable->rx_gain_range_min = pDM_DigTable->rx_gain_range_max; -+ -+ //1 Adjust initial gain by false alarm -+ if(pDM_Odm->bLinked) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DIG AfterLink\n")); -+ if(FirstConnect) -+ { -+ if(pDM_Odm->RSSI_Min <= DIG_MaxOfMin) -+ CurrentIGI = pDM_Odm->RSSI_Min; -+ else -+ CurrentIGI = DIG_MaxOfMin; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("DIG: First Connect\n")); -+ } -+ else -+ { -+ if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ { -+ if(pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH2_92D) -+ CurrentIGI = CurrentIGI + 4;//pDM_DigTable->CurIGValue = pDM_DigTable->PreIGValue+2; -+ else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1_92D) -+ CurrentIGI = CurrentIGI + 2; //pDM_DigTable->CurIGValue = pDM_DigTable->PreIGValue+1; -+ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0_92D) -+ CurrentIGI = CurrentIGI - 2;//pDM_DigTable->CurIGValue =pDM_DigTable->PreIGValue-1; -+ } -+ else -+ { -+ //FA for Combo IC--NeilChen--2012--09--28 -+ if(pDM_Odm->SupportICType == ODM_RTL8723A) -+ { -+ //WLAN and BT ConCurrent -+ if(pDM_Odm->bBtLimitedDig) -+ { -+ if(pFalseAlmCnt->Cnt_all > 0x300) -+ CurrentIGI = CurrentIGI + 4; -+ else if (pFalseAlmCnt->Cnt_all > 0x250) -+ CurrentIGI = CurrentIGI + 2; -+ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0) -+ CurrentIGI = CurrentIGI -2; -+ } -+ else //Not Concurrent -+ { -+ if(pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH2) -+ CurrentIGI = CurrentIGI + 4;//pDM_DigTable->CurIGValue = pDM_DigTable->PreIGValue+2; -+ else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1) -+ CurrentIGI = CurrentIGI + 2;//pDM_DigTable->CurIGValue = pDM_DigTable->PreIGValue+1; -+ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0) -+ CurrentIGI = CurrentIGI - 2;//pDM_DigTable->CurIGValue =pDM_DigTable->PreIGValue-1; -+ } -+ } -+ else -+ { -+ if(pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH2) -+ CurrentIGI = CurrentIGI + 4;//pDM_DigTable->CurIGValue = pDM_DigTable->PreIGValue+2; -+ else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1) -+ CurrentIGI = CurrentIGI + 2;//pDM_DigTable->CurIGValue = pDM_DigTable->PreIGValue+1; -+ else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0) -+ CurrentIGI = CurrentIGI - 2;//pDM_DigTable->CurIGValue =pDM_DigTable->PreIGValue-1; -+ -+ if((pDM_Odm->SupportPlatform&(ODM_WIN|ODM_CE))&&(pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 10) -+ &&(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH1)) -+ CurrentIGI = pDM_DigTable->rx_gain_range_min; -+ } -+ } -+ } -+ } -+ else -+ { -+ //CurrentIGI = pDM_DigTable->rx_gain_range_min;//pDM_DigTable->CurIGValue = pDM_DigTable->rx_gain_range_min -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DIG BeforeLink\n")); -+ if(FirstDisConnect) -+ { -+ CurrentIGI = pDM_DigTable->rx_gain_range_min; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): First DisConnect \n")); -+ } -+ else -+ { -+ //2012.03.30 LukeLee: enable DIG before link but with very high thresholds -+ if(pFalseAlmCnt->Cnt_all > 10000) -+ CurrentIGI = CurrentIGI + 4; -+ else if (pFalseAlmCnt->Cnt_all > 8000) -+ CurrentIGI = CurrentIGI + 2; -+ else if(pFalseAlmCnt->Cnt_all < 500) -+ CurrentIGI = CurrentIGI - 2; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): England DIG \n")); -+ } -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DIG End Adjust IGI\n")); -+ //1 Check initial gain by upper/lower bound -+ -+ if(CurrentIGI > pDM_DigTable->rx_gain_range_max) -+ CurrentIGI = pDM_DigTable->rx_gain_range_max; -+ if(CurrentIGI < pDM_DigTable->rx_gain_range_min) -+ CurrentIGI = pDM_DigTable->rx_gain_range_min; -+ -+ if(pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) -+ { -+ if(CurrentIGI > (pDM_Odm->IGI_target + 4)) -+ CurrentIGI = (u1Byte)pDM_Odm->IGI_target + 4; -+ } -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): rx_gain_range_max=0x%x, rx_gain_range_min=0x%x\n", -+ pDM_DigTable->rx_gain_range_max, pDM_DigTable->rx_gain_range_min)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): TotalFA=%d\n", pFalseAlmCnt->Cnt_all)); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): CurIGValue=0x%x\n", CurrentIGI)); -+ -+ //2 High power RSSI threshold -+ { -+ if(pDM_Odm->bBtHsOperation) -+ { -+ if(pDM_Odm->bLinked) -+ { -+ if(pDM_DigTable->BT30_CurIGI > (CurrentIGI)) -+ { -+ ODM_Write_DIG(pDM_Odm, CurrentIGI); -+ -+ } -+ else -+ { -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI); -+ } -+ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; -+ } -+ else -+ { -+ if(pDM_Odm->bLinkInProcess) -+ { -+ ODM_Write_DIG(pDM_Odm, 0x1c); -+ } -+ else if(pDM_Odm->bBtConnectProcess) -+ { -+ ODM_Write_DIG(pDM_Odm, 0x28); -+ } -+ else -+ { -+ ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); -+ } -+ } -+ } -+ else // BT is not using -+ { -+ ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); -+ pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; -+ pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; -+ } -+ } -+} -+ -+ -+bool -+odm_DigAbort( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ return false; -+} -+ -+//3============================================================ -+//3 FASLE ALARM CHECK -+//3============================================================ -+ -+void -+odm_FalseAlarmCounterStatistics( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u4Byte ret_value; -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = &(pDM_Odm->FalseAlmCnt); -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) -+ return; -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -+ { -+ -+ //hold ofdm counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 1); //hold page C counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 1); //hold page D counter -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE1_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_Fast_Fsync = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_SB_Search_fail = ((ret_value&0xffff0000)>>16); -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE2_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_OFDM_CCA = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_Parity_Fail = ((ret_value&0xffff0000)>>16); -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE3_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_Rate_Illegal = (ret_value&0xffff); -+ FalseAlmCnt->Cnt_Crc8_fail = ((ret_value&0xffff0000)>>16); -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE4_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_Mcs_fail = (ret_value&0xffff); -+ -+ FalseAlmCnt->Cnt_Ofdm_fail = FalseAlmCnt->Cnt_Parity_Fail + FalseAlmCnt->Cnt_Rate_Illegal + -+ FalseAlmCnt->Cnt_Crc8_fail + FalseAlmCnt->Cnt_Mcs_fail + -+ FalseAlmCnt->Cnt_Fast_Fsync + FalseAlmCnt->Cnt_SB_Search_fail; -+ -+ { -+ //hold cck counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT12, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT14, 1); -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_LSB_11N, bMaskByte0); -+ FalseAlmCnt->Cnt_Cck_fail = ret_value; -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_MSB_11N, bMaskByte3); -+ FalseAlmCnt->Cnt_Cck_fail += (ret_value& 0xff)<<8; -+ -+ ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CCA_CNT_11N, bMaskDWord); -+ FalseAlmCnt->Cnt_CCK_CCA = ((ret_value&0xFF)<<8) |((ret_value&0xFF00)>>8); -+ } -+ -+ FalseAlmCnt->Cnt_all = ( FalseAlmCnt->Cnt_Fast_Fsync + -+ FalseAlmCnt->Cnt_SB_Search_fail + -+ FalseAlmCnt->Cnt_Parity_Fail + -+ FalseAlmCnt->Cnt_Rate_Illegal + -+ FalseAlmCnt->Cnt_Crc8_fail + -+ FalseAlmCnt->Cnt_Mcs_fail + -+ FalseAlmCnt->Cnt_Cck_fail); -+ -+ FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_OFDM_CCA + FalseAlmCnt->Cnt_CCK_CCA; -+ -+ if(pDM_Odm->SupportICType >=ODM_RTL8723A) -+ { -+ //reset false alarm counter registers -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT31, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT31, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT27, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT27, 0); -+ //update ofdm counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 0); //update page C counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 0); //update page D counter -+ -+ //reset CCK CCA counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT13|BIT12, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT13|BIT12, 2); -+ //reset CCK FA counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT15|BIT14, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT15|BIT14, 2); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Enter odm_FalseAlarmCounterStatistics\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Cnt_Fast_Fsync=%d, Cnt_SB_Search_fail=%d\n", -+ FalseAlmCnt->Cnt_Fast_Fsync, FalseAlmCnt->Cnt_SB_Search_fail)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Cnt_Parity_Fail=%d, Cnt_Rate_Illegal=%d\n", -+ FalseAlmCnt->Cnt_Parity_Fail, FalseAlmCnt->Cnt_Rate_Illegal)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Cnt_Crc8_fail=%d, Cnt_Mcs_fail=%d\n", -+ FalseAlmCnt->Cnt_Crc8_fail, FalseAlmCnt->Cnt_Mcs_fail)); -+ } -+ else if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) -+ { -+ u4Byte CCKenable; -+ //read OFDM FA counter -+ FalseAlmCnt->Cnt_Ofdm_fail = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_11AC, bMaskLWord); -+ FalseAlmCnt->Cnt_Cck_fail = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_11AC, bMaskLWord); -+ -+ CCKenable = ODM_GetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT28); -+ if(CCKenable)//if(*pDM_Odm->pBandType == ODM_BAND_2_4G) -+ FalseAlmCnt->Cnt_all = FalseAlmCnt->Cnt_Ofdm_fail + FalseAlmCnt->Cnt_Cck_fail; -+ else -+ FalseAlmCnt->Cnt_all = FalseAlmCnt->Cnt_Ofdm_fail; -+ -+ // reset OFDM FA coutner -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RST_11AC, BIT17, 1); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RST_11AC, BIT17, 0); -+ // reset CCK FA counter -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11AC, BIT15, 0); -+ ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11AC, BIT15, 1); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Cnt_Cck_fail=%d\n", FalseAlmCnt->Cnt_Cck_fail)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("Total False Alarm=%d\n", FalseAlmCnt->Cnt_all)); -+} -+ -+//3============================================================ -+//3 CCK Packet Detect Threshold -+//3============================================================ -+ -+void -+odm_CCKPacketDetectionThresh( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+ u1Byte CurCCK_CCAThres; -+ PFALSE_ALARM_STATISTICS FalseAlmCnt = &(pDM_Odm->FalseAlmCnt); -+ -+ if(!(pDM_Odm->SupportAbility & (ODM_BB_CCK_PD|ODM_BB_FA_CNT))) -+ return; -+ -+ if(pDM_Odm->ExtLNA) -+ return; -+ -+ if(pDM_Odm->bLinked) -+ { -+ if(pDM_Odm->RSSI_Min > 25) -+ CurCCK_CCAThres = 0xcd; -+ else if((pDM_Odm->RSSI_Min <= 25) && (pDM_Odm->RSSI_Min > 10)) -+ CurCCK_CCAThres = 0x83; -+ else -+ { -+ if(FalseAlmCnt->Cnt_Cck_fail > 1000) -+ CurCCK_CCAThres = 0x83; -+ else -+ CurCCK_CCAThres = 0x40; -+ } -+ } -+ else -+ { -+ if(FalseAlmCnt->Cnt_Cck_fail > 1000) -+ CurCCK_CCAThres = 0x83; -+ else -+ CurCCK_CCAThres = 0x40; -+ } -+ ODM_Write_CCK_CCA_Thres(pDM_Odm, CurCCK_CCAThres); -+} -+ -+void -+ODM_Write_CCK_CCA_Thres( -+ PDM_ODM_T pDM_Odm, -+ u1Byte CurCCK_CCAThres -+ ) -+{ -+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -+ -+ if(pDM_DigTable->CurCCK_CCAThres!=CurCCK_CCAThres) //modify by Guo.Mingzhi 2012-01-03 -+ { -+ ODM_Write1Byte(pDM_Odm, ODM_REG(CCK_CCA,pDM_Odm), CurCCK_CCAThres); -+ } -+ pDM_DigTable->PreCCK_CCAThres = pDM_DigTable->CurCCK_CCAThres; -+ pDM_DigTable->CurCCK_CCAThres = CurCCK_CCAThres; -+ -+} -+ -+//3============================================================ -+//3 BB Power Save -+//3============================================================ -+void -+odm_DynamicBBPowerSavingInit( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; -+ -+ pDM_PSTable->PreCCAState = CCA_MAX; -+ pDM_PSTable->CurCCAState = CCA_MAX; -+ pDM_PSTable->PreRFState = RF_MAX; -+ pDM_PSTable->CurRFState = RF_MAX; -+ pDM_PSTable->Rssi_val_min = 0; -+ pDM_PSTable->initialize = 0; -+} -+ -+ -+void -+odm_DynamicBBPowerSaving( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ if (pDM_Odm->SupportICType != ODM_RTL8723A) -+ return; -+ if(!(pDM_Odm->SupportAbility & ODM_BB_PWR_SAVE)) -+ return; -+ if(!(pDM_Odm->SupportPlatform & (ODM_WIN|ODM_CE))) -+ return; -+ -+ //1 2.Power Saving for 92C -+ if((pDM_Odm->SupportICType == ODM_RTL8192C) &&(pDM_Odm->RFType == ODM_2T2R)) -+ { -+ odm_1R_CCA(pDM_Odm); -+ } -+ -+ // 20100628 Joseph: Turn off BB power save for 88CE because it makesthroughput unstable. -+ // 20100831 Joseph: Turn ON BB power save again after modifying AGC delay from 900ns ot 600ns. -+ //1 3.Power Saving for 88C -+ else -+ { -+ ODM_RF_Saving(pDM_Odm, false); -+ } -+} -+ -+void -+odm_1R_CCA( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; -+ -+ if(pDM_Odm->RSSI_Min!= 0xFF) -+ { -+ -+ if(pDM_PSTable->PreCCAState == CCA_2R) -+ { -+ if(pDM_Odm->RSSI_Min >= 35) -+ pDM_PSTable->CurCCAState = CCA_1R; -+ else -+ pDM_PSTable->CurCCAState = CCA_2R; -+ -+ } -+ else{ -+ if(pDM_Odm->RSSI_Min <= 30) -+ pDM_PSTable->CurCCAState = CCA_2R; -+ else -+ pDM_PSTable->CurCCAState = CCA_1R; -+ } -+ } -+ else{ -+ pDM_PSTable->CurCCAState=CCA_MAX; -+ } -+ -+ if(pDM_PSTable->PreCCAState != pDM_PSTable->CurCCAState) -+ { -+ if(pDM_PSTable->CurCCAState == CCA_1R) -+ { -+ if( pDM_Odm->RFType ==ODM_2T2R ) -+ { -+ ODM_SetBBReg(pDM_Odm, 0xc04 , bMaskByte0, 0x13); -+ //PHY_SetBBReg(pAdapter, 0xe70, bMaskByte3, 0x20); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, 0xc04 , bMaskByte0, 0x23); -+ //PHY_SetBBReg(pAdapter, 0xe70, 0x7fc00000, 0x10c); // Set RegE70[30:22] = 9b'100001100 -+ } -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, 0xc04 , bMaskByte0, 0x33); -+ //PHY_SetBBReg(pAdapter,0xe70, bMaskByte3, 0x63); -+ } -+ pDM_PSTable->PreCCAState = pDM_PSTable->CurCCAState; -+ } -+ //ODM_RT_TRACE(pDM_Odm, COMP_BB_POWERSAVING, DBG_LOUD, ("CCAStage = %s\n",(pDM_PSTable->CurCCAState==0)?"1RCCA":"2RCCA")); -+} -+ -+void -+ODM_RF_Saving( -+ PDM_ODM_T pDM_Odm, -+ u1Byte bForceInNormal -+ ) -+{ -+ pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; -+ u1Byte Rssi_Up_bound = 30 ; -+ u1Byte Rssi_Low_bound = 25; -+ if(pDM_Odm->PatchID == 40 ) //RT_CID_819x_FUNAI_TV -+ { -+ Rssi_Up_bound = 50 ; -+ Rssi_Low_bound = 45; -+ } -+ if(pDM_PSTable->initialize == 0){ -+ -+ pDM_PSTable->Reg874 = (ODM_GetBBReg(pDM_Odm, 0x874, bMaskDWord)&0x1CC000)>>14; -+ pDM_PSTable->RegC70 = (ODM_GetBBReg(pDM_Odm, 0xc70, bMaskDWord)&BIT3)>>3; -+ pDM_PSTable->Reg85C = (ODM_GetBBReg(pDM_Odm, 0x85c, bMaskDWord)&0xFF000000)>>24; -+ pDM_PSTable->RegA74 = (ODM_GetBBReg(pDM_Odm, 0xa74, bMaskDWord)&0xF000)>>12; -+ pDM_PSTable->initialize = 1; -+ } -+ -+ if(!bForceInNormal) -+ { -+ if(pDM_Odm->RSSI_Min != 0xFF) -+ { -+ if(pDM_PSTable->PreRFState == RF_Normal) -+ { -+ if(pDM_Odm->RSSI_Min >= Rssi_Up_bound) -+ pDM_PSTable->CurRFState = RF_Save; -+ else -+ pDM_PSTable->CurRFState = RF_Normal; -+ } -+ else{ -+ if(pDM_Odm->RSSI_Min <= Rssi_Low_bound) -+ pDM_PSTable->CurRFState = RF_Normal; -+ else -+ pDM_PSTable->CurRFState = RF_Save; -+ } -+ } -+ else -+ pDM_PSTable->CurRFState=RF_MAX; -+ } -+ else -+ { -+ pDM_PSTable->CurRFState = RF_Normal; -+ } -+ -+ if(pDM_PSTable->PreRFState != pDM_PSTable->CurRFState) -+ { -+ if(pDM_PSTable->CurRFState == RF_Save) -+ { -+ // 8723 RSSI report will be wrong. Set 0x874[5]=1 when enter BB power saving mode. -+ // Suggested by SD3 Yu-Nan. 2011.01.20. -+ if(pDM_Odm->SupportICType == ODM_RTL8723A) -+ { -+ ODM_SetBBReg(pDM_Odm, 0x874 , BIT5, 0x1); //Reg874[5]=1b'1 -+ } -+ ODM_SetBBReg(pDM_Odm, 0x874 , 0x1C0000, 0x2); //Reg874[20:18]=3'b010 -+ ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, 0); //RegC70[3]=1'b0 -+ ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, 0x63); //Reg85C[31:24]=0x63 -+ ODM_SetBBReg(pDM_Odm, 0x874, 0xC000, 0x2); //Reg874[15:14]=2'b10 -+ ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, 0x3); //RegA75[7:4]=0x3 -+ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x0); //Reg818[28]=1'b0 -+ ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x1); //Reg818[28]=1'b1 -+ //ODM_RT_TRACE(pDM_Odm, COMP_BB_POWERSAVING, DBG_LOUD, (" RF_Save")); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, 0x874 , 0x1CC000, pDM_PSTable->Reg874); -+ ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, pDM_PSTable->RegC70); -+ ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, pDM_PSTable->Reg85C); -+ ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, pDM_PSTable->RegA74); -+ ODM_SetBBReg(pDM_Odm,0x818, BIT28, 0x0); -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8723A) -+ { -+ ODM_SetBBReg(pDM_Odm,0x874 , BIT5, 0x0); //Reg874[5]=1b'0 -+ } -+ //ODM_RT_TRACE(pDM_Odm, COMP_BB_POWERSAVING, DBG_LOUD, (" RF_Normal")); -+ } -+ pDM_PSTable->PreRFState =pDM_PSTable->CurRFState; -+ } -+} -+ -+ -+//3============================================================ -+//3 RATR MASK -+//3============================================================ -+//3============================================================ -+//3 Rate Adaptive -+//3============================================================ -+ -+void -+odm_RateAdaptiveMaskInit( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PODM_RATE_ADAPTIVE pOdmRA = &pDM_Odm->RateAdaptive; -+ -+ pOdmRA->Type = DM_Type_ByDriver; -+ if (pOdmRA->Type == DM_Type_ByDriver) -+ pDM_Odm->bUseRAMask = true; -+ else -+ pDM_Odm->bUseRAMask = false; -+ -+ pOdmRA->RATRState = DM_RATR_STA_INIT; -+ pOdmRA->LdpcThres = 35; -+ pOdmRA->bUseLdpc = false; -+ pOdmRA->HighRSSIThresh = 50; -+ pOdmRA->LowRSSIThresh = 20; -+} -+ -+u4Byte ODM_Get_Rate_Bitmap( -+ PDM_ODM_T pDM_Odm, -+ u4Byte macid, -+ u4Byte ra_mask, -+ u1Byte rssi_level) -+{ -+ PSTA_INFO_T pEntry; -+ u4Byte rate_bitmap = 0; -+ u1Byte WirelessMode; -+ -+ -+ pEntry = pDM_Odm->pODM_StaInfo[macid]; -+ if(!IS_STA_VALID(pEntry)) -+ return ra_mask; -+ -+ WirelessMode = pEntry->wireless_mode; -+ -+ switch(WirelessMode) -+ { -+ case ODM_WM_B: -+ if(ra_mask & 0x0000000c) //11M or 5.5M enable -+ rate_bitmap = 0x0000000d; -+ else -+ rate_bitmap = 0x0000000f; -+ break; -+ -+ case (ODM_WM_G): -+ case (ODM_WM_A): -+ if(rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x00000f00; -+ else -+ rate_bitmap = 0x00000ff0; -+ break; -+ -+ case (ODM_WM_B|ODM_WM_G): -+ if(rssi_level == DM_RATR_STA_HIGH) -+ rate_bitmap = 0x00000f00; -+ else if(rssi_level == DM_RATR_STA_MIDDLE) -+ rate_bitmap = 0x00000ff0; -+ else -+ rate_bitmap = 0x00000ff5; -+ break; -+ -+ case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G) : -+ case (ODM_WM_B|ODM_WM_N24G) : -+ case (ODM_WM_A|ODM_WM_N5G) : -+ { -+ if ( pDM_Odm->RFType == ODM_1T2R ||pDM_Odm->RFType == ODM_1T1R) -+ { -+ if(rssi_level == DM_RATR_STA_HIGH) -+ { -+ rate_bitmap = 0x000f0000; -+ } -+ else if(rssi_level == DM_RATR_STA_MIDDLE) -+ { -+ rate_bitmap = 0x000ff000; -+ } -+ else{ -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x000ff015; -+ else -+ rate_bitmap = 0x000ff005; -+ } -+ } -+ else -+ { -+ if(rssi_level == DM_RATR_STA_HIGH) -+ { -+ rate_bitmap = 0x0f8f0000; -+ } -+ else if(rssi_level == DM_RATR_STA_MIDDLE) -+ { -+ rate_bitmap = 0x0f8ff000; -+ } -+ else -+ { -+ if (*(pDM_Odm->pBandWidth) == ODM_BW40M) -+ rate_bitmap = 0x0f8ff015; -+ else -+ rate_bitmap = 0x0f8ff005; -+ } -+ } -+ } -+ break; -+ case (ODM_WM_AC|ODM_WM_A): -+ case (ODM_WM_AC|ODM_WM_G): -+ -+ if (pDM_Odm->RFType == RF_1T1R) -+ { -+ if( (pDM_Odm->SupportICType == ODM_RTL8821)|| -+ (pDM_Odm->SupportICType == ODM_RTL8812 && pDM_Odm->bIsMPChip)) -+ { -+ if( (pDM_Odm->SupportICType == ODM_RTL8821) -+ && (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ && (*(pDM_Odm->pChannel) >= 149)) -+ { -+ if(rssi_level == 1) // add by Gary for ac-series -+ rate_bitmap = 0x001f8000; -+ else if (rssi_level == 2) -+ rate_bitmap = 0x001ff000; -+ else -+ rate_bitmap = 0x001ff010; -+ } -+ else -+ { -+ if(rssi_level == 1) // add by Gary for ac-series -+ rate_bitmap = 0x003f8000; -+ else if (rssi_level == 2) -+ rate_bitmap = 0x003ff000; -+ else -+ rate_bitmap = 0x003ff010; -+ } -+ } -+ else{ -+ rate_bitmap = 0x000ff010; -+ } -+ } -+ else -+ { -+ if(pDM_Odm->bIsMPChip) -+ { -+ if(rssi_level == 1) // add by Gary for ac-series -+ rate_bitmap = 0xfe3f8000; // VHT 2SS MCS3~9 -+ else if (rssi_level == 2) -+ rate_bitmap = 0xfffff000; // VHT 2SS MCS0~9 -+ else -+ rate_bitmap = 0xfffff010; // All -+ } -+ else -+ rate_bitmap = 0x3fcff010; -+ } -+ break; -+ -+ default: -+ if(pDM_Odm->RFType == RF_1T2R) -+ rate_bitmap = 0x000fffff; -+ else -+ rate_bitmap = 0x0fffffff; -+ break; -+ -+ } -+ -+ //printk("%s ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x \n",__FUNCTION__,rssi_level,WirelessMode,rate_bitmap); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x \n",rssi_level,WirelessMode,rate_bitmap)); -+ -+ return (ra_mask&rate_bitmap); -+ -+} -+ -+void -+odm_RefreshBasicRateMask( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: odm_RefreshRateAdaptiveMask() -+ * -+ * Overview: Update rate table mask according to rssi -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 05/27/2009 hpfan Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+void -+odm_RefreshRateAdaptiveMask( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("odm_RefreshRateAdaptiveMask()---------->\n")); -+ if (!(pDM_Odm->SupportAbility & ODM_BB_RA_MASK)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("odm_RefreshRateAdaptiveMask(): Return cos not supported\n")); -+ return; -+ } -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ odm_RefreshRateAdaptiveMaskMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_RefreshRateAdaptiveMaskCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ case ODM_ADSL: -+ odm_RefreshRateAdaptiveMaskAPADSL(pDM_Odm); -+ break; -+ } -+ -+} -+ -+void -+odm_RefreshRateAdaptiveMaskMP( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+void -+odm_RefreshRateAdaptiveMaskCE( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u1Byte i; -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; -+ -+ if(pAdapter->bDriverStopped) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_RefreshRateAdaptiveMask(): driver is going to unload\n")); -+ return; -+ } -+ -+ if(!pDM_Odm->bUseRAMask) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_RefreshRateAdaptiveMask(): driver does not control rate adaptive mask\n")); -+ return; -+ } -+ -+ for(i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pstat) ) { -+ -+ if((pDM_Odm->SupportICType == ODM_RTL8812)||(pDM_Odm->SupportICType == ODM_RTL8821)) -+ { -+ if(pstat->rssi_stat.UndecoratedSmoothedPWDB < pRA->LdpcThres) -+ { -+ pRA->bUseLdpc = true; -+ pRA->bLowerRtsRate = true; -+ Set_RA_LDPC_8812(pstat, true); -+ } -+ else if(pstat->rssi_stat.UndecoratedSmoothedPWDB > (pRA->LdpcThres-5)) -+ { -+ pRA->bUseLdpc = false; -+ pRA->bLowerRtsRate = false; -+ Set_RA_LDPC_8812(pstat, false); -+ } -+ } -+ -+ if( true == ODM_RAStateCheck(pDM_Odm, pstat->rssi_stat.UndecoratedSmoothedPWDB, false , &pstat->rssi_level) ) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi_stat.UndecoratedSmoothedPWDB, pstat->rssi_level)); -+ rtw_hal_update_ra_mask(pstat, pstat->rssi_level); -+ } -+ -+ } -+ } -+} -+ -+void -+odm_RefreshRateAdaptiveMaskAPADSL( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+// Return Value: bool -+// - true: RATRState is changed. -+bool -+ODM_RAStateCheck( -+ PDM_ODM_T pDM_Odm, -+ s4Byte RSSI, -+ bool bForceUpdate, -+ pu1Byte pRATRState -+ ) -+{ -+ PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; -+ const u1Byte GoUpGap = 5; -+ u1Byte HighRSSIThreshForRA = pRA->HighRSSIThresh; -+ u1Byte LowRSSIThreshForRA = pRA->LowRSSIThresh; -+ u1Byte RATRState; -+ -+ // Threshold Adjustment: -+ // when RSSI state trends to go up one or two levels, make sure RSSI is high enough. -+ // Here GoUpGap is added to solve the boundary's level alternation issue. -+ switch (*pRATRState) -+ { -+ case DM_RATR_STA_INIT: -+ case DM_RATR_STA_HIGH: -+ break; -+ -+ case DM_RATR_STA_MIDDLE: -+ HighRSSIThreshForRA += GoUpGap; -+ break; -+ -+ case DM_RATR_STA_LOW: -+ HighRSSIThreshForRA += GoUpGap; -+ LowRSSIThreshForRA += GoUpGap; -+ break; -+ -+ default: -+ ODM_RT_ASSERT(pDM_Odm, false, ("wrong rssi level setting %d !", *pRATRState) ); -+ break; -+ } -+ -+ // Decide RATRState by RSSI. -+ if(RSSI > HighRSSIThreshForRA) -+ RATRState = DM_RATR_STA_HIGH; -+ else if(RSSI > LowRSSIThreshForRA) -+ RATRState = DM_RATR_STA_MIDDLE; -+ else -+ RATRState = DM_RATR_STA_LOW; -+ //printk("==>%s,RATRState:0x%02x ,RSSI:%d \n",__FUNCTION__,RATRState,RSSI); -+ -+ if( *pRATRState!=RATRState || bForceUpdate) -+ { -+ ODM_RT_TRACE( pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI Level %d -> %d\n", *pRATRState, RATRState) ); -+ *pRATRState = RATRState; -+ return true; -+ } -+ -+ return false; -+} -+ -+ -+//============================================================ -+ -+//3============================================================ -+//3 Dynamic Tx Power -+//3============================================================ -+ -+void -+odm_DynamicTxPowerInit( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ pdmpriv->bDynamicTxPowerEnable = false; -+ -+ pdmpriv->LastDTPLvl = TxHighPwrLevel_Normal; -+ pdmpriv->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; -+} -+ -+void -+odm_DynamicTxPowerSavePowerIndex( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u1Byte index; -+ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ for(index = 0; index< 6; index++) -+ pdmpriv->PowerIndex_backup[index] = rtw_read8(Adapter, Power_Index_REG[index]); -+} -+ -+void -+odm_DynamicTxPowerRestorePowerIndex( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u1Byte index; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ for(index = 0; index< 6; index++) -+ rtw_write8(Adapter, Power_Index_REG[index], pdmpriv->PowerIndex_backup[index]); -+} -+ -+void -+odm_DynamicTxPowerWritePowerIndex( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Value) -+{ -+ -+ u1Byte index; -+ u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; -+ -+ for(index = 0; index< 6; index++) -+ //PlatformEFIOWrite1Byte(Adapter, Power_Index_REG[index], Value); -+ ODM_Write1Byte(pDM_Odm, Power_Index_REG[index], Value); -+ -+} -+ -+ -+void -+odm_DynamicTxPower( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ // -+ // For AP/ADSL use prtl8192cd_priv -+ // For CE/NIC use PADAPTER -+ // -+ //PADAPTER pAdapter = pDM_Odm->Adapter; -+// prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) -+ return; -+ -+ // 2012/01/12 MH According to Luke's suggestion, only high power will support the feature. -+ if (pDM_Odm->ExtPA == false) -+ return; -+ -+ -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ case ODM_CE: -+ odm_DynamicTxPowerNIC(pDM_Odm); -+ break; -+ case ODM_AP: -+ odm_DynamicTxPowerAP(pDM_Odm); -+ break; -+ -+ case ODM_ADSL: -+ //odm_DIGAP(pDM_Odm); -+ break; -+ } -+ -+ -+} -+ -+ -+void -+odm_DynamicTxPowerNIC( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) -+ return; -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8192C) -+ { -+ odm_DynamicTxPower_92C(pDM_Odm); -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ { -+ odm_DynamicTxPower_92D(pDM_Odm); -+ } -+ else if (pDM_Odm->SupportICType & ODM_RTL8188E) -+ { -+ // Add Later. -+ } -+ else if (pDM_Odm->SupportICType == ODM_RTL8188E) -+ { -+ // ??? -+ // This part need to be redefined. -+ } -+} -+ -+void -+odm_DynamicTxPowerAP( -+ PDM_ODM_T pDM_Odm -+ -+ ) -+{ -+} -+ -+ -+void -+odm_DynamicTxPower_92C( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+ -+void -+odm_DynamicTxPower_92D( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+//3============================================================ -+//3 RSSI Monitor -+//3============================================================ -+ -+void -+odm_RSSIDumpToRegister( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+ -+void -+odm_RSSIMonitorInit( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+void -+odm_RSSIMonitorCheck( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ // -+ // For AP/ADSL use prtl8192cd_priv -+ // For CE/NIC use PADAPTER -+ // -+ -+ if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)) -+ return; -+ -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ odm_RSSIMonitorCheckMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_RSSIMonitorCheckCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ odm_RSSIMonitorCheckAP(pDM_Odm); -+ break; -+ -+ case ODM_ADSL: -+ //odm_DIGAP(pDM_Odm); -+ break; -+ } -+ -+} // odm_RSSIMonitorCheck -+ -+ -+void -+odm_RSSIMonitorCheckMP( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+// -+//sherry move from DUSC to here 20110517 -+// -+static void -+FindMinimumRSSI_Dmsp( -+ PADAPTER pAdapter -+) -+{ -+} -+ -+static void -+FindMinimumRSSI( -+PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ //1 1.Determine the minimum RSSI -+ -+ if((pDM_Odm->bLinked != true) && -+ (pdmpriv->EntryMinUndecoratedSmoothedPWDB == 0)) -+ { -+ pdmpriv->MinUndecoratedPWDBForDM = 0; -+ //ODM_RT_TRACE(pDM_Odm,COMP_BB_POWERSAVING, DBG_LOUD, ("Not connected to any \n")); -+ } -+ else -+ { -+ pdmpriv->MinUndecoratedPWDBForDM = pdmpriv->EntryMinUndecoratedSmoothedPWDB; -+ } -+ -+ //DBG_8192C("%s=>MinUndecoratedPWDBForDM(%d)\n",__FUNCTION__,pdmpriv->MinUndecoratedPWDBForDM); -+ //ODM_RT_TRACE(pDM_Odm,COMP_DIG, DBG_LOUD, ("MinUndecoratedPWDBForDM =%d\n",pHalData->MinUndecoratedPWDBForDM)); -+} -+ -+void -+odm_RSSIMonitorCheckCE( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ int i; -+ int tmpEntryMaxPWDB=0, tmpEntryMinPWDB=0xff; -+ u8 sta_cnt=0; -+ u8 UL_DL_STATE = 0;// for 8812 use -+ u32 PWDB_rssi[NUM_STA]={0};//[0~15]:MACID, [16~31]:PWDB_rssi -+ -+ if(pDM_Odm->bLinked != true) -+ return; -+ -+ if((pDM_Odm->SupportICType == ODM_RTL8812)||(pDM_Odm->SupportICType == ODM_RTL8821)) -+ { -+ u64 curTxOkCnt = Adapter->xmitpriv.tx_bytes - Adapter->xmitpriv.last_tx_bytes; -+ u64 curRxOkCnt = Adapter->recvpriv.rx_bytes - Adapter->recvpriv.last_rx_bytes; -+ -+ if(curRxOkCnt >(curTxOkCnt*6)) -+ UL_DL_STATE = 1; -+ else -+ UL_DL_STATE = 0; -+ } -+ -+ { -+ struct sta_info *psta; -+ -+ for(i=0; ipODM_StaInfo[i])) -+ { -+ if(psta->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB) -+ tmpEntryMinPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ if(psta->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB) -+ tmpEntryMaxPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ #if 0 -+ DBG_871X("%s mac_id:%u, mac:"MAC_FMT", rssi:%d\n", __func__, -+ psta->mac_id, MAC_ARG(psta->hwaddr), psta->rssi_stat.UndecoratedSmoothedPWDB); -+ #endif -+ -+ if(psta->rssi_stat.UndecoratedSmoothedPWDB != (-1)) { -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8192D) -+ PWDB_rssi[sta_cnt++] = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB<<16) | ((Adapter->stapriv.asoc_sta_count+1) << 8)); -+ else if ((pDM_Odm->SupportICType == ODM_RTL8192E)||(pDM_Odm->SupportICType == ODM_RTL8812)||(pDM_Odm->SupportICType == ODM_RTL8821)) -+ PWDB_rssi[sta_cnt++] = (((u8)(psta->mac_id&0xFF)) | ((psta->rssi_stat.UndecoratedSmoothedPWDB&0x7F)<<16) ); -+ else -+ PWDB_rssi[sta_cnt++] = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB<<16) ); -+ -+ } -+ } -+ } -+ -+ //printk("%s==> sta_cnt(%d)\n",__FUNCTION__,sta_cnt); -+ -+ for(i=0; i< sta_cnt; i++) -+ { -+ if(PWDB_rssi[i] != (0)){ -+ if(pHalData->fw_ractrl == true)// Report every sta's RSSI to FW -+ { -+ if((pDM_Odm->SupportICType == ODM_RTL8812)||(pDM_Odm->SupportICType == ODM_RTL8821)){ -+ PWDB_rssi[i] |= (UL_DL_STATE << 24); -+ rtl8812_set_rssi_cmd(Adapter, (u8 *)(&PWDB_rssi[i])); -+ } -+ } -+ } -+ } -+ } -+ -+ if(tmpEntryMaxPWDB != 0) // If associated entry is found -+ { -+ pdmpriv->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB; -+ } -+ else -+ { -+ pdmpriv->EntryMaxUndecoratedSmoothedPWDB = 0; -+ } -+ -+ if(tmpEntryMinPWDB != 0xff) // If associated entry is found -+ { -+ pdmpriv->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB; -+ } -+ else -+ { -+ pdmpriv->EntryMinUndecoratedSmoothedPWDB = 0; -+ } -+ -+ FindMinimumRSSI(Adapter);//get pdmpriv->MinUndecoratedPWDBForDM -+ -+ ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); -+} -+ -+void -+odm_RSSIMonitorCheckAP( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+void -+ODM_InitAllTimers( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+#if(defined(CONFIG_SW_ANTENNA_DIVERSITY)) -+ ODM_InitializeTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer, -+ (RT_TIMER_CALL_BACK)odm_SwAntDivChkAntSwitchCallback, NULL, "SwAntennaSwitchTimer"); -+#endif -+} -+ -+void -+ODM_CancelAllTimers( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+#if(defined(CONFIG_SW_ANTENNA_DIVERSITY)) -+ ODM_CancelTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer); -+#endif -+} -+ -+void -+ODM_ReleaseAllTimers( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer); -+} -+ -+//3============================================================ -+//3 Tx Power Tracking -+//3============================================================ -+ -+void -+odm_TXPowerTrackingInit( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ odm_TXPowerTrackingThermalMeterInit(pDM_Odm); -+} -+ -+u1Byte -+getSwingIndex( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u1Byte i = 0; -+ u4Byte bbSwing; -+ -+ bbSwing = PHY_GetTxBBSwing_8812A(Adapter, pHalData->CurrentBandType, ODM_RF_PATH_A); -+ -+ for (i = 0; i < TXSCALE_TABLE_SIZE; ++i) -+ if ( bbSwing == TxScalingTable_Jaguar[i]) -+ break; -+ -+ return i; -+} -+ -+void -+odm_TXPowerTrackingThermalMeterInit( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u1Byte p = 0; -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ pDM_Odm->RFCalibrateInfo.bTXPowerTracking = true; -+ pDM_Odm->RFCalibrateInfo.TXPowercount = 0; -+ pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = false; -+ if ( *(pDM_Odm->mp_mode) != 1) -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = true; -+ MSG_8192C("pDM_Odm TxPowerTrackControl = %d\n", pDM_Odm->RFCalibrateInfo.TxPowerTrackControl); -+ -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = true; -+ pDM_Odm->RFCalibrateInfo.ThermalValue = pHalData->EEPROMThermalMeter; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = pHalData->EEPROMThermalMeter; -+ pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = pHalData->EEPROMThermalMeter; -+ -+ // The index of "0 dB" in SwingTable. -+ if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || -+ pDM_Odm->SupportICType == ODM_RTL8192E) -+ { -+ pDM_Odm->DefaultOfdmIndex = 30; -+ pDM_Odm->DefaultCckIndex = 20; -+ } else { -+ u1Byte defaultSwingIndex = getSwingIndex(pDM_Odm); -+ -+ pDM_Odm->DefaultOfdmIndex = (defaultSwingIndex == TXSCALE_TABLE_SIZE) ? 24 : defaultSwingIndex; -+ pDM_Odm->DefaultCckIndex = 24; -+ } -+ -+ pDM_Odm->BbSwingIdxCckBase = pDM_Odm->DefaultCckIndex; -+ pDM_Odm->RFCalibrateInfo.CCK_index = pDM_Odm->DefaultCckIndex; -+ -+ for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) -+ { -+ pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->DefaultOfdmIndex; -+ pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pDM_Odm->DefaultOfdmIndex; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = 0; -+ pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] = 0; -+ pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; -+ } -+ -+} -+ -+void -+ODM_TXPowerTrackingCheck( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ // -+ // For AP/ADSL use prtl8192cd_priv -+ // For CE/NIC use PADAPTER -+ // -+ -+ //if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ //return; -+ -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ odm_TXPowerTrackingCheckMP(pDM_Odm); -+ break; -+ -+ case ODM_CE: -+ odm_TXPowerTrackingCheckCE(pDM_Odm); -+ break; -+ -+ case ODM_AP: -+ odm_TXPowerTrackingCheckAP(pDM_Odm); -+ break; -+ -+ case ODM_ADSL: -+ //odm_DIGAP(pDM_Odm); -+ break; -+ } -+ -+} -+ -+void -+odm_TXPowerTrackingCheckCE( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ -+ if(!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) -+ return; -+ -+ if(!pDM_Odm->RFCalibrateInfo.TM_Trigger) { //at least delay 1 sec -+ if(IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) )//||IS_HARDWARE_TYPE_8723B(Adapter)) -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_NEW, (BIT17 | BIT16), 0x03); -+ else -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_OLD, bRFRegOffsetMask, 0x60); -+ -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; -+ return; -+ } -+ ODM_TXPowerTrackingCallback_ThermalMeter(Adapter); -+ pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; -+} -+ -+void -+odm_TXPowerTrackingCheckMP( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+void -+odm_TXPowerTrackingCheckAP( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+} -+ -+//3============================================================ -+//3 SW Antenna Diversity -+//3============================================================ -+#if(defined(CONFIG_SW_ANTENNA_DIVERSITY)) -+void -+odm_SwAntDivInit( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ odm_SwAntDivInit_NIC(pDM_Odm); -+} -+ -+void -+odm_SwAntDivInit_NIC( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ -+// Init SW ANT DIV mechanism for 8723AE/AU/AS -+// CE/AP/ADSL no using SW ANT DIV for 8723A Series IC -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("SWAS:Init SW Antenna Switch\n")); -+ pDM_SWAT_Table->RSSI_sum_A = 0; -+ pDM_SWAT_Table->RSSI_cnt_A = 0; -+ pDM_SWAT_Table->RSSI_sum_B = 0; -+ pDM_SWAT_Table->RSSI_cnt_B = 0; -+ pDM_SWAT_Table->CurAntenna = MAIN_ANT; -+ pDM_SWAT_Table->PreAntenna = MAIN_ANT; -+ pDM_SWAT_Table->try_flag = 0xff; -+ pDM_SWAT_Table->PreRSSI = 0; -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ pDM_SWAT_Table->bTriggerAntennaSwitch = 0; -+ pDM_SWAT_Table->SelectAntennaMap=0xAA; -+ pDM_SWAT_Table->lastTxOkCnt = 0; -+ pDM_SWAT_Table->lastRxOkCnt = 0; -+ pDM_SWAT_Table->TXByteCnt_A = 0; -+ pDM_SWAT_Table->TXByteCnt_B = 0; -+ pDM_SWAT_Table->RXByteCnt_A = 0; -+ pDM_SWAT_Table->RXByteCnt_B = 0; -+ pDM_SWAT_Table->TrafficLoad = TRAFFIC_LOW; -+ pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 = ODM_Read4Byte(pDM_Odm, 0x860); -+ -+} -+ -+// -+// 20100514 Joseph: -+// Add new function to reset the state of antenna diversity before link. -+// -+void -+ODM_SwAntDivResetBeforeLink( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ -+} -+ -+// -+// 20100514 Luke/Joseph: -+// Add new function to reset antenna diversity state after link. -+// -+void -+ODM_SwAntDivRestAfterLink( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ pDM_SWAT_Table->RSSI_cnt_A = 0; -+ pDM_SWAT_Table->RSSI_cnt_B = 0; -+ pDM_Odm->RSSI_test = false; -+ pDM_SWAT_Table->try_flag = 0xff; -+ pDM_SWAT_Table->RSSI_Trying = 0; -+ pDM_SWAT_Table->SelectAntennaMap=0xAA; -+} -+ -+void -+ODM_SwAntDivChkPerPktRssi( -+ PDM_ODM_T pDM_Odm, -+ u1Byte StationID, -+ PODM_PHY_INFO_T pPhyInfo -+ ) -+{ -+ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ if(!(pDM_Odm->SupportAbility & (ODM_BB_ANT_DIV))) -+ return; -+ -+// temporary Fix 8723A MP SW ANT DIV Bug --NeilChen--2012--07--11 -+ if(pDM_Odm->SupportICType == ODM_RTL8723A) -+ { -+ //if(StationID == pDM_SWAT_Table->RSSI_target) -+ //{ -+ //1 RSSI for SW Antenna Switch -+ if(pDM_SWAT_Table->CurAntenna == MAIN_ANT) -+ { -+ pDM_SWAT_Table->RSSI_sum_A += pPhyInfo->RxPWDBAll; -+ pDM_SWAT_Table->RSSI_cnt_A++; -+ } -+ else -+ { -+ pDM_SWAT_Table->RSSI_sum_B += pPhyInfo->RxPWDBAll; -+ pDM_SWAT_Table->RSSI_cnt_B++; -+ -+ } -+ //} -+ } -+ else -+ { -+ if(StationID == pDM_SWAT_Table->RSSI_target) -+ { -+ //1 RSSI for SW Antenna Switch -+ if(pDM_SWAT_Table->CurAntenna == MAIN_ANT) -+ { -+ pDM_SWAT_Table->RSSI_sum_A += pPhyInfo->RxPWDBAll; -+ pDM_SWAT_Table->RSSI_cnt_A++; -+ } -+ else -+ { -+ pDM_SWAT_Table->RSSI_sum_B += pPhyInfo->RxPWDBAll; -+ pDM_SWAT_Table->RSSI_cnt_B++; -+ -+ } -+ } -+ } -+} -+ -+// -+void -+odm_SwAntDivChkAntSwitch( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Step -+ ) -+{ -+ // -+ // For AP/ADSL use prtl8192cd_priv -+ // For CE/NIC use PADAPTER -+ // -+ prtl8192cd_priv priv = pDM_Odm->priv; -+ -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ switch (pDM_Odm->SupportPlatform) -+ { -+ case ODM_WIN: -+ odm_SwAntDivChkAntSwitchNIC(pDM_Odm, Step); -+ break; -+ case ODM_CE: -+ odm_SwAntDivChkAntSwitchNIC(pDM_Odm, Step); -+ break; -+ -+ case ODM_AP: -+ case ODM_ADSL: -+ break; -+ } -+ -+} -+ -+// -+// 20100514 Luke/Joseph: -+// Add new function for antenna diversity after link. -+// This is the main function of antenna diversity after link. -+// This function is called in HalDmWatchDog() and ODM_SwAntDivChkAntSwitchCallback(). -+// HalDmWatchDog() calls this function with SWAW_STEP_PEAK to initialize the antenna test. -+// In SWAW_STEP_PEAK, another antenna and a 500ms timer will be set for testing. -+// After 500ms, ODM_SwAntDivChkAntSwitchCallback() calls this function to compare the signal just -+// listened on the air with the RSSI of original antenna. -+// It chooses the antenna with better RSSI. -+// There is also a aged policy for error trying. Each error trying will cost more 5 seconds waiting -+// penalty to get next try. -+ -+ -+void -+ODM_SetAntenna( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Antenna) -+{ -+ ODM_SetBBReg(pDM_Odm, 0x860, BIT8|BIT9, Antenna); -+} -+ -+void -+odm_SwAntDivChkAntSwitchNIC( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Step -+ ) -+{ -+} -+ -+// -+// 20100514 Luke/Joseph: -+// Callback function for 500ms antenna test trying. -+// -+void odm_SwAntDivChkAntSwitchCallback(void *FunctionContext) -+{ -+ PDM_ODM_T pDM_Odm= (PDM_ODM_T)FunctionContext; -+ PADAPTER padapter = pDM_Odm->Adapter; -+ if(padapter->net_closed == true) -+ return; -+ odm_SwAntDivChkAntSwitch(pDM_Odm, SWAW_STEP_DETERMINE); -+} -+ -+#else //#if(defined(CONFIG_SW_ANTENNA_DIVERSITY)) -+ -+void odm_SwAntDivInit( PDM_ODM_T pDM_Odm ) {} -+void ODM_SwAntDivChkPerPktRssi( -+ PDM_ODM_T pDM_Odm, -+ u1Byte StationID, -+ PODM_PHY_INFO_T pPhyInfo -+ ) {} -+void odm_SwAntDivChkAntSwitch( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Step -+ ) {} -+void ODM_SwAntDivResetBeforeLink( PDM_ODM_T pDM_Odm ){} -+void ODM_SwAntDivRestAfterLink( PDM_ODM_T pDM_Odm ){} -+void odm_SwAntDivChkAntSwitchCallback(void *FunctionContext){} -+ -+#endif //#if(defined(CONFIG_SW_ANTENNA_DIVERSITY)) -+ -+//3============================================================ -+//3 SW Antenna Diversity -+//3============================================================ -+ -+#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+void -+odm_InitHybridAntDiv_88C_92D( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ u1Byte bTxPathSel=0; //0:Path-A 1:Path-B -+ u1Byte i; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_InitHybridAntDiv==============>\n")); -+ -+ //whether to do antenna diversity or not -+ -+ if((pDM_Odm->SupportICType != ODM_RTL8192C) && (pDM_Odm->SupportICType != ODM_RTL8192D)) -+ return; -+ -+ -+ bTxPathSel=(pDM_Odm->RFType==ODM_1T1R)?false:true; -+ -+ ODM_SetBBReg(pDM_Odm,ODM_REG_BB_PWR_SAV1_11N, BIT23, 0); //No update ANTSEL during GNT_BT=1 -+ ODM_SetBBReg(pDM_Odm,ODM_REG_TX_ANT_CTRL_11N, BIT21, 1); //TX atenna selection from tx_info -+ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_PIN_11N, BIT23, 1); //enable LED[1:0] pin as ANTSEL -+ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_CTRL_11N, BIT8|BIT9, 0x01); // 0x01: left antenna, 0x02: right antenna -+ -+ // only AP support different path selection temperarly -+ if(!bTxPathSel){ //PATH-A -+ ODM_SetBBReg(pDM_Odm,ODM_REG_PIN_CTRL_11N, BIT8|BIT9, 0 ); // ANTSEL as HW control -+ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_PATH_11N, BIT13, 1); //select TX ANTESEL from path A -+ } -+ else { -+ ODM_SetBBReg(pDM_Odm,ODM_REG_PIN_CTRL_11N, BIT24|BIT25, 0 ); // ANTSEL as HW control -+ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_PATH_11N, BIT13, 0); //select ANTESEL from path B -+ } -+ -+ //Set OFDM HW RX Antenna Diversity -+ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTDIV_PARA1_11N, 0x7FF, 0x0c0); //Pwdb threshold=8dB -+ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTDIV_PARA1_11N, BIT11, 0); //Switch to another antenna by checking pwdb threshold -+ ODM_SetBBReg(pDM_Odm,ODM_REG_ANTDIV_PARA3_11N, BIT23, 1); // Decide final antenna by comparing 2 antennas' pwdb -+ -+ //Set CCK HW RX Antenna Diversity -+ ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA2_11N, BIT4, 0); //Antenna diversity decision period = 32 sample -+ ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA2_11N, 0xf, 0xf); //Threshold for antenna diversity. Check another antenna power if input power < ANT_lim*4 -+ ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA3_11N, BIT13, 1); //polarity ana_A=1 and ana_B=0 -+ ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA4_11N, 0x1f, 0x8); //default antenna power = inpwr*(0.5 + r_ant_step/16) -+ -+ -+ //Enable HW Antenna Diversity -+ if(!bTxPathSel) //PATH-A -+ ODM_SetBBReg(pDM_Odm,ODM_REG_IGI_A_11N, BIT7,1); // Enable Hardware antenna switch -+ else -+ ODM_SetBBReg(pDM_Odm,ODM_REG_IGI_B_11N, BIT7,1); // Enable Hardware antenna switch -+ ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA1_11N, BIT15, 1);//Enable antenna diversity -+ -+ pDM_SWAT_Table->CurAntenna=0; //choose left antenna as default antenna -+ pDM_SWAT_Table->PreAntenna=0; -+ for(i=0; iCCK_Ant1_Cnt[i] = 0; -+ pDM_SWAT_Table->CCK_Ant2_Cnt[i] = 0; -+ pDM_SWAT_Table->OFDM_Ant1_Cnt[i] = 0; -+ pDM_SWAT_Table->OFDM_Ant2_Cnt[i] = 0; -+ pDM_SWAT_Table->RSSI_Ant1_Sum[i] = 0; -+ pDM_SWAT_Table->RSSI_Ant2_Sum[i] = 0; -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("<==============odm_InitHybridAntDiv\n")); -+} -+ -+ -+void -+odm_InitHybridAntDiv( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("Return: Not Support HW AntDiv\n")); -+ return; -+ } -+} -+ -+bool -+odm_StaDefAntSel( -+ PDM_ODM_T pDM_Odm, -+ u4Byte OFDM_Ant1_Cnt, -+ u4Byte OFDM_Ant2_Cnt, -+ u4Byte CCK_Ant1_Cnt, -+ u4Byte CCK_Ant2_Cnt, -+ u1Byte *pDefAnt -+ -+ ) -+{ -+#if 1 -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_StaDefAntSelect==============>\n")); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("OFDM_Ant1_Cnt:%d, OFDM_Ant2_Cnt:%d\n",OFDM_Ant1_Cnt,OFDM_Ant2_Cnt)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("CCK_Ant1_Cnt:%d, CCK_Ant2_Cnt:%d\n",CCK_Ant1_Cnt,CCK_Ant2_Cnt)); -+ -+ -+ if(((OFDM_Ant1_Cnt+OFDM_Ant2_Cnt)==0)&&((CCK_Ant1_Cnt + CCK_Ant2_Cnt) <10)){ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_StaDefAntSelect Fail: No enough packet info!\n")); -+ return false; -+ } -+ -+ if(OFDM_Ant1_Cnt || OFDM_Ant2_Cnt ) { -+ //if RX OFDM packet number larger than 0 -+ if(OFDM_Ant1_Cnt > OFDM_Ant2_Cnt) -+ (*pDefAnt)=1; -+ else -+ (*pDefAnt)=0; -+ } -+ // else if RX CCK packet number larger than 10 -+ else if((CCK_Ant1_Cnt + CCK_Ant2_Cnt) >=10 ) -+ { -+ if(CCK_Ant1_Cnt > (5*CCK_Ant2_Cnt)) -+ (*pDefAnt)=1; -+ else if(CCK_Ant2_Cnt > (5*CCK_Ant1_Cnt)) -+ (*pDefAnt)=0; -+ else if(CCK_Ant1_Cnt > CCK_Ant2_Cnt) -+ (*pDefAnt)=0; -+ else -+ (*pDefAnt)=1; -+ -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("TxAnt = %s\n",((*pDefAnt)==1)?"Ant1":"Ant2")); -+ -+#endif -+ //u4Byte antsel = ODM_GetBBReg(pDM_Odm, 0xc88, bMaskByte0); -+ //(*pDefAnt)= (u1Byte) antsel; -+ -+ -+ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("<==============odm_StaDefAntSelect\n")); -+ -+ return true; -+ -+ -+} -+ -+ -+void -+odm_SetRxIdleAnt( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Ant, -+ bool bDualPath -+) -+{ -+ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_SetRxIdleAnt==============>\n")); -+ -+ if(Ant != pDM_SWAT_Table->RxIdleAnt) -+ { -+ //for path-A -+ if(Ant==1) -+ ODM_SetBBReg(pDM_Odm,ODM_REG_RX_DEFUALT_A_11N, 0xFFFF, 0x65a9); //right-side antenna -+ else -+ ODM_SetBBReg(pDM_Odm,ODM_REG_RX_DEFUALT_A_11N, 0xFFFF, 0x569a); //left-side antenna -+ -+ //for path-B -+ if(bDualPath){ -+ if(Ant==0) -+ ODM_SetBBReg(pDM_Odm,ODM_REG_RX_DEFUALT_A_11N, 0xFFFF0000, 0x65a9); //right-side antenna -+ else -+ ODM_SetBBReg(pDM_Odm,ODM_REG_RX_DEFUALT_A_11N, 0xFFFF0000, 0x569a); //left-side antenna -+ } -+ } -+ pDM_SWAT_Table->RxIdleAnt = Ant; -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("RxIdleAnt: %s Reg858=0x%x\n",(Ant==1)?"Ant1":"Ant2",(Ant==1)?0x65a9:0x569a)); -+ -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("<==============odm_SetRxIdleAnt\n")); -+ -+ } -+ -+void -+ODM_AntselStatistics_88C( -+ PDM_ODM_T pDM_Odm, -+ u1Byte MacId, -+ u4Byte PWDBAll, -+ bool isCCKrate -+) -+{ -+ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ -+ if(pDM_SWAT_Table->antsel == 1) -+ { -+ if(isCCKrate) -+ pDM_SWAT_Table->CCK_Ant1_Cnt[MacId]++; -+ else -+ { -+ pDM_SWAT_Table->OFDM_Ant1_Cnt[MacId]++; -+ pDM_SWAT_Table->RSSI_Ant1_Sum[MacId] += PWDBAll; -+ } -+ } -+ else -+ { -+ if(isCCKrate) -+ pDM_SWAT_Table->CCK_Ant2_Cnt[MacId]++; -+ else -+ { -+ pDM_SWAT_Table->OFDM_Ant2_Cnt[MacId]++; -+ pDM_SWAT_Table->RSSI_Ant2_Sum[MacId] += PWDBAll; -+ } -+ } -+ -+} -+ -+ -+ -+ -+void -+ODM_SetTxAntByTxInfo_88C_92D( -+ PDM_ODM_T pDM_Odm -+) -+{ -+} -+ -+void -+odm_HwAntDiv_92C_92D( -+ PDM_ODM_T pDM_Odm -+) -+{ -+ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ u4Byte RSSI_Min=0xFF, RSSI, RSSI_Ant1, RSSI_Ant2; -+ u1Byte RxIdleAnt, i; -+ bool bRet=false; -+ PSTA_INFO_T pEntry; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_HwAntDiv==============>\n")); -+ -+ if(!(pDM_Odm->SupportAbility&ODM_BB_ANT_DIV)) //if don't support antenna diveristy -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_HwAntDiv: Not supported!\n")); -+ return; -+ } -+ -+ if((pDM_Odm->SupportICType != ODM_RTL8192C) && (pDM_Odm->SupportICType != ODM_RTL8192D)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("Return: IC Type is not 92C or 92D\n")); -+ return; -+ } -+ -+ if(!pDM_Odm->bLinked) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("Return: bLinked is false\n")); -+ return; -+ } -+ -+ for (i=0; ipODM_StaInfo[i]; -+ if(IS_STA_VALID(pEntry)) -+ { -+ -+ RSSI_Ant1 = (pDM_SWAT_Table->OFDM_Ant1_Cnt[i] == 0)?0:(pDM_SWAT_Table->RSSI_Ant1_Sum[i]/pDM_SWAT_Table->OFDM_Ant1_Cnt[i]); -+ RSSI_Ant2 = (pDM_SWAT_Table->OFDM_Ant2_Cnt[i] == 0)?0:(pDM_SWAT_Table->RSSI_Ant2_Sum[i]/pDM_SWAT_Table->OFDM_Ant2_Cnt[i]); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("RSSI_Ant1=%d, RSSI_Ant2=%d\n", RSSI_Ant1, RSSI_Ant2)); -+ -+ if(RSSI_Ant1 ||RSSI_Ant2) { -+ RSSI = (RSSI_Ant1 < RSSI_Ant2) ? RSSI_Ant1 : RSSI_Ant2; -+ if((!RSSI) || ( RSSI < RSSI_Min) ) { -+ pDM_SWAT_Table->TargetSTA = i; -+ RSSI_Min = RSSI; -+ } -+ } -+ ///STA: found out default antenna -+ bRet=odm_StaDefAntSel(pDM_Odm, -+ pDM_SWAT_Table->OFDM_Ant1_Cnt[i], -+ pDM_SWAT_Table->OFDM_Ant2_Cnt[i], -+ pDM_SWAT_Table->CCK_Ant1_Cnt[i], -+ pDM_SWAT_Table->CCK_Ant2_Cnt[i], -+ &pDM_SWAT_Table->TxAnt[i]); -+ -+ //if Tx antenna selection: successful -+ if(bRet){ -+ pDM_SWAT_Table->RSSI_Ant1_Sum[i] = 0; -+ pDM_SWAT_Table->RSSI_Ant2_Sum[i] = 0; -+ pDM_SWAT_Table->OFDM_Ant1_Cnt[i] = 0; -+ pDM_SWAT_Table->OFDM_Ant2_Cnt[i] = 0; -+ pDM_SWAT_Table->CCK_Ant1_Cnt[i] = 0; -+ pDM_SWAT_Table->CCK_Ant2_Cnt[i] = 0; -+ } -+ } -+ } -+ -+ //set RX Idle Ant -+ RxIdleAnt = pDM_SWAT_Table->TxAnt[pDM_SWAT_Table->TargetSTA]; -+ odm_SetRxIdleAnt(pDM_Odm, RxIdleAnt, false); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("<==============odm_HwAntDiv\n")); -+} -+ -+void -+odm_HwAntDiv( -+ PDM_ODM_T pDM_Odm -+) -+{ -+ -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("Return: Not Support HW AntDiv\n")); -+ return; -+ } -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8821) -+ ODM_AntennaDiversity_8821A(pDM_Odm); -+} -+ -+#else //#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ -+void odm_InitHybridAntDiv(PDM_ODM_T pDM_Odm ){} -+void odm_HwAntDiv( PDM_ODM_T pDM_Odm){} -+void ODM_SetTxAntByTxInfo_88C_92D(PDM_ODM_T pDM_Odm){ } -+ -+#endif //#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ -+ -+ -+//============================================================ -+//EDCA Turbo -+//============================================================ -+void -+ODM_EdcaTurboInit( -+ PDM_ODM_T pDM_Odm) -+{ -+ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = false; -+ pDM_Odm->DM_EDCA_Table.bIsCurRDLState = false; -+ Adapter->recvpriv.bIsAnyNonBEPkts =false; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VO PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VO_PARAM))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VI PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VI_PARAM))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BE PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BE_PARAM))); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BK PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BK_PARAM))); -+ -+ -+} // ODM_InitEdcaTurbo -+ -+void -+odm_EdcaTurboCheck( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ // -+ // For AP/ADSL use prtl8192cd_priv -+ // For CE/NIC use PADAPTER -+ // -+ -+ // -+ // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate -+ // at the same time. In the stage2/3, we need to prive universal interface and merge all -+ // HW dynamic mechanism. -+ // -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("odm_EdcaTurboCheck========================>\n")); -+ -+ if(!(pDM_Odm->SupportAbility& ODM_MAC_EDCA_TURBO )) -+ return; -+ -+ switch (pDM_Odm->SupportPlatform) { -+ case ODM_WIN: -+ break; -+ case ODM_CE: -+ odm_EdcaTurboCheckCE(pDM_Odm); -+ break; -+ case ODM_AP: -+ case ODM_ADSL: -+ break; -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("<========================odm_EdcaTurboCheck\n")); -+ -+} // odm_CheckEdcaTurbo -+ -+void -+odm_EdcaTurboCheckCE( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ u32 EDCA_BE_UL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[pMgntInfo->IOTPeer]; -+ u32 EDCA_BE_DL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[pMgntInfo->IOTPeer]; -+ u32 ICType=pDM_Odm->SupportICType; -+ u32 IOTPeer=0; -+ u8 WirelessMode=0xFF; //invalid value -+ u32 trafficIndex; -+ u32 edca_param; -+ u64 cur_tx_bytes = 0; -+ u64 cur_rx_bytes = 0; -+ u8 bbtchange = false; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); -+ struct recv_priv *precvpriv = &(Adapter->recvpriv); -+ struct registry_priv *pregpriv = &Adapter->registrypriv; -+ struct mlme_ext_priv *pmlmeext = &(Adapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ if ((pregpriv->wifi_spec == 1) )//|| (pmlmeinfo->HT_enable == 0)) -+ { -+ goto dm_CheckEdcaTurbo_EXIT; -+ } -+ -+ if(pDM_Odm->pWirelessMode!=NULL) -+ WirelessMode=*(pDM_Odm->pWirelessMode); -+ -+ IOTPeer = pmlmeinfo->assoc_AP_vendor; -+ -+ if (IOTPeer >= HT_IOT_PEER_MAX) -+ { -+ goto dm_CheckEdcaTurbo_EXIT; -+ } -+ -+ // Check if the status needs to be changed. -+ if((bbtchange) || (!precvpriv->bIsAnyNonBEPkts) ) -+ { -+ cur_tx_bytes = pxmitpriv->tx_bytes - pxmitpriv->last_tx_bytes; -+ cur_rx_bytes = precvpriv->rx_bytes - precvpriv->last_rx_bytes; -+ -+ //traffic, TX or RX -+ if((IOTPeer == HT_IOT_PEER_RALINK)||(IOTPeer == HT_IOT_PEER_ATHEROS)) -+ { -+ if (cur_tx_bytes > (cur_rx_bytes << 2)) -+ { // Uplink TP is present. -+ trafficIndex = UP_LINK; -+ } -+ else -+ { // Balance TP is present. -+ trafficIndex = DOWN_LINK; -+ } -+ } -+ else -+ { -+ if (cur_rx_bytes > (cur_tx_bytes << 2)) -+ { // Downlink TP is present. -+ trafficIndex = DOWN_LINK; -+ } -+ else -+ { // Balance TP is present. -+ trafficIndex = UP_LINK; -+ } -+ } -+ -+ if ((pDM_Odm->DM_EDCA_Table.prv_traffic_idx != trafficIndex) || (!pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA)) -+ { -+ if(ICType==ODM_RTL8192D) -+ { -+ // Single PHY -+ if(pDM_Odm->RFType==ODM_2T2R) -+ { -+ EDCA_BE_UL = 0x60a42b; //0x5ea42b; -+ EDCA_BE_DL = 0x60a42b; //0x5ea42b; -+ } -+ else -+ { -+ EDCA_BE_UL = 0x6ea42b; -+ EDCA_BE_DL = 0x6ea42b; -+ } -+ } -+ else -+ { -+ if(pDM_Odm->SupportInterface==ODM_ITRF_PCIE) { -+ if((ICType==ODM_RTL8192C)&&(pDM_Odm->RFType==ODM_2T2R)) { -+ EDCA_BE_UL = 0x60a42b; -+ EDCA_BE_DL = 0x60a42b; -+ } -+ else -+ { -+ EDCA_BE_UL = 0x6ea42b; -+ EDCA_BE_DL = 0x6ea42b; -+ } -+ } -+ } -+ -+ //92D txop can't be set to 0x3e for cisco1250 -+ if((ICType!=ODM_RTL8192D) && (IOTPeer== HT_IOT_PEER_CISCO) &&(WirelessMode==ODM_WM_N24G)) -+ { -+ EDCA_BE_DL = edca_setting_DL[IOTPeer]; -+ EDCA_BE_UL = edca_setting_UL[IOTPeer]; -+ } -+ //merge from 92s_92c_merge temp brunch v2445 20120215 -+ else if((IOTPeer == HT_IOT_PEER_CISCO) &&((WirelessMode==ODM_WM_G)||(WirelessMode==(ODM_WM_B|ODM_WM_G))||(WirelessMode==ODM_WM_A)||(WirelessMode==ODM_WM_B))) -+ { -+ EDCA_BE_DL = edca_setting_DL_GMode[IOTPeer]; -+ } -+ else if((IOTPeer== HT_IOT_PEER_AIRGO )&& ((WirelessMode==ODM_WM_G)||(WirelessMode==ODM_WM_A))) -+ { -+ EDCA_BE_DL = 0xa630; -+ } -+ else if(IOTPeer == HT_IOT_PEER_MARVELL) -+ { -+ EDCA_BE_DL = edca_setting_DL[IOTPeer]; -+ EDCA_BE_UL = edca_setting_UL[IOTPeer]; -+ } -+ else if(IOTPeer == HT_IOT_PEER_ATHEROS) -+ { -+ // Set DL EDCA for Atheros peer to 0x3ea42b. Suggested by SD3 Wilson for ASUS TP issue. -+ EDCA_BE_DL = edca_setting_DL[IOTPeer]; -+ } -+ -+ if((ICType==ODM_RTL8812)||(ICType==ODM_RTL8192E)) //add 8812AU/8812AE -+ { -+ EDCA_BE_UL = 0x5ea42b; -+ EDCA_BE_DL = 0x5ea42b; -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8812A: EDCA_BE_UL=0x%x EDCA_BE_DL =0x%x",EDCA_BE_UL,EDCA_BE_DL)); -+ } -+ -+ if (trafficIndex == DOWN_LINK) -+ edca_param = EDCA_BE_DL; -+ else -+ edca_param = EDCA_BE_UL; -+ -+ rtw_write32(Adapter, REG_EDCA_BE_PARAM, edca_param); -+ -+ pDM_Odm->DM_EDCA_Table.prv_traffic_idx = trafficIndex; -+ } -+ -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = true; -+ } -+ else -+ { -+ // -+ // Turn Off EDCA turbo here. -+ // Restore original EDCA according to the declaration of AP. -+ // -+ if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA) -+ { -+ rtw_write32(Adapter, REG_EDCA_BE_PARAM, pHalData->AcParam_BE); -+ pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = false; -+ } -+ } -+ -+dm_CheckEdcaTurbo_EXIT: -+ // Set variables for next time. -+ precvpriv->bIsAnyNonBEPkts = false; -+ pxmitpriv->last_tx_bytes = pxmitpriv->tx_bytes; -+ precvpriv->last_rx_bytes = precvpriv->rx_bytes; -+} -+ -+// need to ODM CE Platform -+//move to here for ANT detection mechanism using -+ -+u4Byte -+GetPSDData( -+ PDM_ODM_T pDM_Odm, -+ unsigned int point, -+ u1Byte initial_gain_psd) -+{ -+ //unsigned int val, rfval; -+ //int psd_report; -+ u4Byte psd_report; -+ -+ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ //Debug Message -+ //val = PHY_QueryBBReg(Adapter,0x908, bMaskDWord); -+ //DbgPrint("Reg908 = 0x%x\n",val); -+ //val = PHY_QueryBBReg(Adapter,0xDF4, bMaskDWord); -+ //rfval = PHY_QueryRFReg(Adapter, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask); -+ //DbgPrint("RegDF4 = 0x%x, RFReg00 = 0x%x\n",val, rfval); -+ //DbgPrint("PHYTXON = %x, OFDMCCA_PP = %x, CCKCCA_PP = %x, RFReg00 = %x\n", -+ //(val&BIT25)>>25, (val&BIT14)>>14, (val&BIT15)>>15, rfval); -+ -+ //Set DCO frequency index, offset=(40MHz/SamplePts)*point -+ ODM_SetBBReg(pDM_Odm, 0x808, 0x3FF, point); -+ -+ //Start PSD calculation, Reg808[22]=0->1 -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 1); -+ //Need to wait for HW PSD report -+ ODM_StallExecution(1000); -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 0); -+ //Read PSD report, Reg8B4[15:0] -+ psd_report = ODM_GetBBReg(pDM_Odm,0x8B4, bMaskDWord) & 0x0000FFFF; -+ -+ psd_report = (u4Byte) (ConvertTo_dB(psd_report))+(u4Byte)(initial_gain_psd-0x1c); -+ -+ return psd_report; -+} -+ -+u4Byte -+ConvertTo_dB( -+ u4Byte Value) -+{ -+ u1Byte i; -+ u1Byte j; -+ u4Byte dB; -+ -+ Value = Value & 0xFFFF; -+ -+ for (i=0;i<8;i++) -+ { -+ if (Value <= dB_Invert_Table[i][11]) -+ { -+ break; -+ } -+ } -+ -+ if (i >= 8) -+ { -+ return (96); // maximum 96 dB -+ } -+ -+ for (j=0;j<12;j++) -+ { -+ if (Value <= dB_Invert_Table[i][j]) -+ { -+ break; -+ } -+ } -+ -+ dB = i*12 + j + 1; -+ -+ return (dB); -+} -+ -+void -+odm_PathDiversityInit( -+ PDM_ODM_T pDM_Odm -+) -+{ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Return: Not Support PathDiv\n")); -+ return; -+ } -+} -+ -+void -+odm_PathDiversity( -+ PDM_ODM_T pDM_Odm -+) -+{ -+ if(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) -+ { -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Return: Not Support PathDiv\n")); -+ return; -+ } -+} -+ -+void -+odm_PHY_SaveAFERegisters( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte AFEReg, -+ pu4Byte AFEBackup, -+ u4Byte RegisterNum -+ ) -+{ -+ u4Byte i; -+ -+ //RT_DISP(FINIT, INIT_IQK, ("Save ADDA parameters.\n")); -+ for( i = 0 ; i < RegisterNum ; i++){ -+ AFEBackup[i] = ODM_GetBBReg(pDM_Odm, AFEReg[i], bMaskDWord); -+ } -+} -+ -+void -+odm_PHY_ReloadAFERegisters( -+ PDM_ODM_T pDM_Odm, -+ pu4Byte AFEReg, -+ pu4Byte AFEBackup, -+ u4Byte RegiesterNum -+ ) -+{ -+ u4Byte i; -+ -+ //RT_DISP(FINIT, INIT_IQK, ("Reload ADDA power saving parameters !\n")); -+ for(i = 0 ; i < RegiesterNum; i++) -+ { -+ -+ ODM_SetBBReg(pDM_Odm, AFEReg[i], bMaskDWord, AFEBackup[i]); -+ } -+} -+ -+// -+// Description: -+// Set Single/Dual Antenna default setting for products that do not do detection in advance. -+// -+// Added by Joseph, 2012.03.22 -+// -+void -+ODM_SingleDualAntennaDefaultSetting( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ pDM_SWAT_Table->ANTA_ON=true; -+ pDM_SWAT_Table->ANTB_ON=true; -+} -+ -+ -+ -+//2 8723A ANT DETECT -+// -+// Description: -+// Implement IQK single tone for RF DPK loopback and BB PSD scanning. -+// This function is cooperated with BB team Neil. -+// -+// Added by Roger, 2011.12.15 -+// -+bool -+ODM_SingleDualAntennaDetection( -+ PDM_ODM_T pDM_Odm, -+ u1Byte mode -+ ) -+{ -+ PADAPTER pAdapter = pDM_Odm->Adapter; -+ pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ u4Byte CurrentChannel,RfLoopReg; -+ u1Byte n; -+ u4Byte Reg88c, Regc08, Reg874, Regc50; -+ u1Byte initial_gain = 0x5a; -+ u4Byte PSD_report_tmp; -+ u4Byte AntA_report = 0x0, AntB_report = 0x0,AntO_report=0x0; -+ bool bResult = true; -+ bool bAntDetection = false; -+ u4Byte AFE_Backup[16]; -+ u4Byte AFE_REG_8723A[16] = { -+ rRx_Wait_CCA, rTx_CCK_RFON, -+ rTx_CCK_BBON, rTx_OFDM_RFON, -+ rTx_OFDM_BBON, rTx_To_Rx, -+ rTx_To_Tx, rRx_CCK, -+ rRx_OFDM, rRx_Wait_RIFS, -+ rRx_TO_Rx, rStandby, -+ rSleep, rPMPD_ANAEN, -+ rFPGA0_XCD_SwitchControl, rBlue_Tooth}; -+ -+ -+ // Retrieve antenna detection registry info, added by Roger, 2012.11.27. -+ pAdapter->HalFunc.GetHalDefVarHandler(pAdapter, HAL_DEF_ANT_DETECT, &bAntDetection); -+ -+ if(!(pDM_Odm->SupportICType & (ODM_RTL8723A|ODM_RTL8192C))) -+ return bResult; -+ -+ if(!(pDM_Odm->SupportAbility&ODM_BB_ANT_DIV) && !bAntDetection) -+ return bResult; -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8192C) -+ { -+ //Which path in ADC/DAC is turnned on for PSD: both I/Q -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT10|BIT11, 0x3); -+ //Ageraged number: 8 -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT12|BIT13, 0x1); -+ //pts = 128; -+ ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x0); -+ } -+ -+ //1 Backup Current RF/BB Settings -+ -+ CurrentChannel = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask); -+ RfLoopReg = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, ODM_DPDT, Antenna_A); // change to Antenna A -+ // Step 1: USE IQK to transmitter single tone -+ -+ ODM_StallExecution(10); -+ -+ //Store A Path Register 88c, c08, 874, c50 -+ Reg88c = ODM_GetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord); -+ Regc08 = ODM_GetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord); -+ Reg874 = ODM_GetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord); -+ Regc50 = ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord); -+ -+ // Store AFE Registers -+ odm_PHY_SaveAFERegisters(pDM_Odm, AFE_REG_8723A, AFE_Backup, 16); -+ -+ //Set PSD 128 pts -+ ODM_SetBBReg(pDM_Odm, rFPGA0_PSDFunction, BIT14|BIT15, 0x0); //128 pts -+ -+ // To SET CH1 to do -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask, 0x7401); //Channel 1 -+ -+ // AFE all on step -+ ODM_SetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rTx_CCK_RFON, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rTx_CCK_BBON, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rTx_OFDM_RFON, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rTx_OFDM_BBON, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rTx_To_Rx, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rTx_To_Tx, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rRx_CCK, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rRx_OFDM, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rRx_Wait_RIFS, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rRx_TO_Rx, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rStandby, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rSleep, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rPMPD_ANAEN, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_SwitchControl, bMaskDWord, 0x6FDB25A4); -+ ODM_SetBBReg(pDM_Odm, rBlue_Tooth, bMaskDWord, 0x6FDB25A4); -+ -+ // 3 wire Disable -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord, 0xCCF000C0); -+ -+ //BB IQK Setting -+ ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, 0x000800E4); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x22208000); -+ -+ //IQK setting tone@ 4.34Mhz -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x10008C1C); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); -+ -+ -+ //Page B init -+ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00080000); -+ ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x0f600000); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x10008c1f); -+ ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82150008); -+ ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28150008); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x001028d0); -+ -+ //RF loop Setting -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0, 0xFFFFF, 0x50008); -+ -+ //IQK Single tone start -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, bMaskDWord, 0x80800000); -+ ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); -+ ODM_StallExecution(10000); -+ PSD_report_tmp=0x0; -+ -+ for (n=0;n<2;n++) -+ { -+ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); -+ if(PSD_report_tmp >AntA_report) -+ AntA_report=PSD_report_tmp; -+ } -+ -+ PSD_report_tmp=0x0; -+ -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, 0x300, Antenna_B); // change to Antenna B -+ ODM_StallExecution(10); -+ -+ -+ for (n=0;n<2;n++) -+ { -+ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); -+ if(PSD_report_tmp > AntB_report) -+ AntB_report=PSD_report_tmp; -+ } -+ -+ // change to open case -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, 0x300, 0); // change to Ant A and B all open case -+ ODM_StallExecution(10); -+ -+ for (n=0;n<2;n++) -+ { -+ PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); -+ if(PSD_report_tmp > AntO_report) -+ AntO_report=PSD_report_tmp; -+ } -+ -+ //Close IQK Single Tone function -+ ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, bMaskDWord, 0x00000000); -+ PSD_report_tmp = 0x0; -+ -+ //1 Return to antanna A -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, 0x300, Antenna_A); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord, Reg88c); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, Regc08); -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, Reg874); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, 0x7F, 0x40); -+ ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord, Regc50); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask,CurrentChannel); -+ ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask,RfLoopReg); -+ -+ //Reload AFE Registers -+ odm_PHY_ReloadAFERegisters(pDM_Odm, AFE_REG_8723A, AFE_Backup, 16); -+ -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_A[%d]= %d \n", 2416, AntA_report)); -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_B[%d]= %d \n", 2416, AntB_report)); -+ //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_O[%d]= %d \n", 2416, AntO_report)); -+ -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8723A) -+ { -+ //2 Test Ant B based on Ant A is ON -+ if(mode==ANTTESTB) -+ { -+ if(AntA_report >= 100) -+ { -+ if(AntB_report > (AntA_report+1)) -+ { -+ pDM_SWAT_Table->ANTB_ON=false; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Single Antenna A\n")); -+ } -+ else -+ { -+ pDM_SWAT_Table->ANTB_ON=true; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Dual Antenna is A and B\n")); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Need to check again\n")); -+ pDM_SWAT_Table->ANTB_ON=false; // Set Antenna B off as default -+ bResult = false; -+ } -+ } -+ //2 Test Ant A and B based on DPDT Open -+ else if(mode==ANTTESTALL) -+ { -+ if((AntO_report >=100) && (AntO_report <=118)) -+ { -+ if(AntA_report > (AntO_report+1)) -+ { -+ pDM_SWAT_Table->ANTA_ON=false; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Ant A is OFF\n")); -+ } -+ else -+ { -+ pDM_SWAT_Table->ANTA_ON=true; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Ant A is ON\n")); -+ } -+ -+ if(AntB_report > (AntO_report+2)) -+ { -+ pDM_SWAT_Table->ANTB_ON=false; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Ant B is OFF\n")); -+ } -+ else -+ { -+ pDM_SWAT_Table->ANTB_ON=true; -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Ant B is ON\n")); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_A[%d]= %d \n", 2416, AntA_report)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_B[%d]= %d \n", 2416, AntB_report)); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_O[%d]= %d \n", 2416, AntO_report)); -+ -+ pDM_Odm->AntDetectedInfo.bAntDetected= true; -+ pDM_Odm->AntDetectedInfo.dBForAntA = AntA_report; -+ pDM_Odm->AntDetectedInfo.dBForAntB = AntB_report; -+ pDM_Odm->AntDetectedInfo.dBForAntO = AntO_report; -+ -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("return false!!\n")); -+ bResult = false; -+ } -+ } -+ } -+ else if(pDM_Odm->SupportICType == ODM_RTL8192C) -+ { -+ if(AntA_report >= 100) -+ { -+ if(AntB_report > (AntA_report+2)) -+ { -+ pDM_SWAT_Table->ANTA_ON=false; -+ pDM_SWAT_Table->ANTB_ON=true; -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, 0x300, Antenna_B); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Single Antenna B\n")); -+ } -+ else if(AntA_report > (AntB_report+2)) -+ { -+ pDM_SWAT_Table->ANTA_ON=true; -+ pDM_SWAT_Table->ANTB_ON=false; -+ ODM_SetBBReg(pDM_Odm, rFPGA0_XA_RFInterfaceOE, 0x300, Antenna_A); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Single Antenna A\n")); -+ } -+ else -+ { -+ pDM_SWAT_Table->ANTA_ON=true; -+ pDM_SWAT_Table->ANTB_ON=true; -+ RT_TRACE(COMP_ANTENNA, DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Dual Antenna \n")); -+ } -+ } -+ else -+ { -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Need to check again\n")); -+ pDM_SWAT_Table->ANTA_ON=true; // Set Antenna A on as default -+ pDM_SWAT_Table->ANTB_ON=false; // Set Antenna B off as default -+ bResult = false; -+ } -+ } -+ return bResult; -+ -+} -+ -+/* Justin: According to the current RRSI to adjust Response Frame TX power, 2012/11/05 */ -+void odm_dtc(PDM_ODM_T pDM_Odm) -+{ -+#ifdef CONFIG_DM_RESP_TXAGC -+ #define DTC_BASE 35 /* RSSI higher than this value, start to decade TX power */ -+ #define DTC_DWN_BASE (DTC_BASE-5) /* RSSI lower than this value, start to increase TX power */ -+ -+ /* RSSI vs TX power step mapping: decade TX power */ -+ static const u8 dtc_table_down[]={ -+ DTC_BASE, -+ (DTC_BASE+5), -+ (DTC_BASE+10), -+ (DTC_BASE+15), -+ (DTC_BASE+20), -+ (DTC_BASE+25) -+ }; -+ -+ /* RSSI vs TX power step mapping: increase TX power */ -+ static const u8 dtc_table_up[]={ -+ DTC_DWN_BASE, -+ (DTC_DWN_BASE-5), -+ (DTC_DWN_BASE-10), -+ (DTC_DWN_BASE-15), -+ (DTC_DWN_BASE-15), -+ (DTC_DWN_BASE-20), -+ (DTC_DWN_BASE-20), -+ (DTC_DWN_BASE-25), -+ (DTC_DWN_BASE-25), -+ (DTC_DWN_BASE-30), -+ (DTC_DWN_BASE-35) -+ }; -+ -+ u8 i; -+ u8 dtc_steps=0; -+ u8 sign; -+ u8 resp_txagc=0; -+ -+ #if 0 -+ /* As DIG is disabled, DTC is also disable */ -+ if(!(pDM_Odm->SupportAbility & ODM_XXXXXX)) -+ return; -+ #endif -+ -+ if (DTC_BASE < pDM_Odm->RSSI_Min) { -+ /* need to decade the CTS TX power */ -+ sign = 1; -+ for (i=0;i= pDM_Odm->RSSI_Min) || (dtc_steps >= 6)) -+ break; -+ else -+ dtc_steps++; -+ } -+ } -+ else -+ { -+ sign = 0; -+ dtc_steps = 0; -+ } -+ -+ resp_txagc = dtc_steps | (sign << 4); -+ resp_txagc = resp_txagc | (resp_txagc << 5); -+ ODM_Write1Byte(pDM_Odm, 0x06d9, resp_txagc); -+ -+ DBG_871X("%s RSSI_Min:%u, set RESP_TXAGC to %s %u\n", -+ __func__, pDM_Odm->RSSI_Min, sign?"minus":"plus", dtc_steps); -+#endif /* CONFIG_RESP_TXAGC_ADJUST */ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_debug.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_debug.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_debug.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_debug.c 2018-02-06 17:42:30.712967194 +0200 -@@ -0,0 +1,63 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "odm_precomp.h" -+ -+ -+void -+ODM_InitDebugSetting( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+pDM_Odm->DebugLevel = ODM_DBG_LOUD; -+ -+pDM_Odm->DebugComponents = -+\ -+#if DBG -+//BB Functions -+// ODM_COMP_DIG | -+// ODM_COMP_RA_MASK | -+// ODM_COMP_DYNAMIC_TXPWR | -+// ODM_COMP_FA_CNT | -+// ODM_COMP_RSSI_MONITOR | -+// ODM_COMP_CCK_PD | -+// ODM_COMP_ANT_DIV | -+// ODM_COMP_PWR_SAVE | -+// ODM_COMP_PWR_TRAIN | -+// ODM_COMP_RATE_ADAPTIVE | -+// ODM_COMP_PATH_DIV | -+// ODM_COMP_DYNAMIC_PRICCA | -+// ODM_COMP_RXHP | -+// ODM_COMP_MP | -+// ODM_COMP_DYNAMIC_ATC | -+ -+//MAC Functions -+// ODM_COMP_EDCA_TURBO | -+// ODM_COMP_EARLY_MODE | -+//RF Functions -+// ODM_COMP_TX_PWR_TRACK | -+// ODM_COMP_RX_GAIN_TRACK | -+// ODM_COMP_CALIBRATION | -+//Common -+// ODM_COMP_COMMON | -+// ODM_COMP_INIT | -+// ODM_COMP_PSD | -+#endif -+ 0; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_debug.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_debug.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_debug.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_debug.h 2018-02-06 17:42:30.712967194 +0200 -@@ -0,0 +1,870 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __ODM_DBG_H__ -+#define __ODM_DBG_H__ -+ -+ -+//----------------------------------------------------------------------------- -+// Define the debug levels -+// -+// 1. DBG_TRACE and DBG_LOUD are used for normal cases. -+// So that, they can help SW engineer to develope or trace states changed -+// and also help HW enginner to trace every operation to and from HW, -+// e.g IO, Tx, Rx. -+// -+// 2. DBG_WARNNING and DBG_SERIOUS are used for unusual or error cases, -+// which help us to debug SW or HW. -+// -+//----------------------------------------------------------------------------- -+// -+// Never used in a call to ODM_RT_TRACE()! -+// -+#define ODM_DBG_OFF 1 -+ -+// -+// Fatal bug. -+// For example, Tx/Rx/IO locked up, OS hangs, memory access violation, -+// resource allocation failed, unexpected HW behavior, HW BUG and so on. -+// -+#define ODM_DBG_SERIOUS 2 -+ -+// -+// Abnormal, rare, or unexpeted cases. -+// For example, IRP/Packet/OID canceled, device suprisely unremoved and so on. -+// -+#define ODM_DBG_WARNING 3 -+ -+// -+// Normal case with useful information about current SW or HW state. -+// For example, Tx/Rx descriptor to fill, Tx/Rx descriptor completed status, -+// SW protocol state change, dynamic mechanism state change and so on. -+// -+#define ODM_DBG_LOUD 4 -+ -+// -+// Normal case with detail execution flow or information. -+// -+#define ODM_DBG_TRACE 5 -+ -+//----------------------------------------------------------------------------- -+// Define the tracing components -+// -+//----------------------------------------------------------------------------- -+//BB Functions -+#define ODM_COMP_DIG BIT0 -+#define ODM_COMP_RA_MASK BIT1 -+#define ODM_COMP_DYNAMIC_TXPWR BIT2 -+#define ODM_COMP_FA_CNT BIT3 -+#define ODM_COMP_RSSI_MONITOR BIT4 -+#define ODM_COMP_CCK_PD BIT5 -+#define ODM_COMP_ANT_DIV BIT6 -+#define ODM_COMP_PWR_SAVE BIT7 -+#define ODM_COMP_PWR_TRAIN BIT8 -+#define ODM_COMP_RATE_ADAPTIVE BIT9 -+#define ODM_COMP_PATH_DIV BIT10 -+#define ODM_COMP_PSD BIT11 -+#define ODM_COMP_DYNAMIC_PRICCA BIT12 -+#define ODM_COMP_RXHP BIT13 -+#define ODM_COMP_MP BIT14 -+#define ODM_COMP_DYNAMIC_ATC BIT15 -+//MAC Functions -+#define ODM_COMP_EDCA_TURBO BIT16 -+#define ODM_COMP_EARLY_MODE BIT17 -+//RF Functions -+#define ODM_COMP_TX_PWR_TRACK BIT24 -+#define ODM_COMP_RX_GAIN_TRACK BIT25 -+#define ODM_COMP_CALIBRATION BIT26 -+//Common Functions -+#define ODM_COMP_COMMON BIT30 -+#define ODM_COMP_INIT BIT31 -+ -+/*------------------------Export Marco Definition---------------------------*/ -+ #define DbgPrint printk -+ #define RT_PRINTK(fmt, args...) DbgPrint( "%s(): " fmt, __FUNCTION__, ## args); -+ #define RT_DISP(dbgtype, dbgflag, printstr) -+ -+#ifndef ASSERT -+ #define ASSERT(expr) -+#endif -+ -+#if DBG -+#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) \ -+ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel || level == ODM_DBG_SERIOUS)) \ -+ { \ -+ RT_PRINTK fmt; \ -+ } -+ -+#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) \ -+ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel)) \ -+ { \ -+ RT_PRINTK fmt; \ -+ } -+ -+#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) \ -+ if(!(expr)) { \ -+ DbgPrint( "Assertion failed! %s at ......\n", #expr); \ -+ DbgPrint( " ......%s,%s,line=%d\n",__FILE__,__FUNCTION__,__LINE__); \ -+ RT_PRINTK fmt; \ -+ ASSERT(false); \ -+ } -+#define ODM_dbg_enter() { DbgPrint("==> %s\n", __FUNCTION__); } -+#define ODM_dbg_exit() { DbgPrint("<== %s\n", __FUNCTION__); } -+#define ODM_dbg_trace(str) { DbgPrint("%s:%s\n", __FUNCTION__, str); } -+ -+#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) \ -+ if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel)) \ -+ { \ -+ int __i; \ -+ pu1Byte __ptr = (pu1Byte)ptr; \ -+ DbgPrint("[ODM] "); \ -+ DbgPrint(title_str); \ -+ DbgPrint(" "); \ -+ for( __i=0; __i<6; __i++ ) \ -+ DbgPrint("%02X%s", __ptr[__i], (__i==5)?"":"-"); \ -+ DbgPrint("\n"); \ -+ } -+#else -+#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) -+#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) -+#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) -+#define ODM_dbg_enter() -+#define ODM_dbg_exit() -+#define ODM_dbg_trace(str) -+#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) -+#endif -+ -+ -+void ODM_InitDebugSetting(PDM_ODM_T pDM_Odm); -+ -+ -+ -+#if 0 -+#if DBG -+#define DbgPrint printk -+ -+#define PRINT_DATA(_TitleString, _HexData, _HexDataLen) \ -+ { \ -+ char *szTitle = _TitleString; \ -+ pu1Byte pbtHexData = _HexData; \ -+ u4Byte u4bHexDataLen = _HexDataLen; \ -+ u4Byte __i; \ -+ DbgPrint("%s", szTitle); \ -+ for (__i=0;__i=' ' &&_ch<='~' ) // I want to see ASCII 33 to 126 only. Otherwise, I print '?'. Annie, 2005-11-22. -+ -+#define RT_PRINT_STR(_Comp, _Level, _TitleString, _Ptr, _Len) \ -+ if(((_Comp) & ODM_GlobalDebugComponents) && (_Level <= ODM_GlobalDebugLevel)) \ -+ { \ -+ int __i; \ -+ u1Byte buffer[MAX_STR_LEN]; \ -+ int length = (_Len\n", _Len, buffer); \ -+ } -+ -+#else // of #if DBG -+#define DbgPrint(...) -+#define PRINT_DATA(_TitleString, _HexData, _HexDataLen) -+#define RT_PRINT_DATA(_Comp, _Level, _TitleString, _HexData, _HexDataLen) -+#define RT_PRINT_ADDR(_Comp, _Level, _TitleString, _Ptr) -+#define RT_PRINT_ADDRS(_Comp, _Level, _TitleString, _Ptr, _AddNum) -+#define RT_PRINT_STR(_Comp, _Level, _TitleString, _Ptr, _Len) -+#endif // of #if DBG -+ -+#endif -+ -+ -+#if 0 -+/* Define debug print header for every service module.*/ -+typedef struct tag_ODM_DBGP_Service_Module_Header_Name_Structure -+{ -+ const char *pMANS; -+ const char *pRTOS; -+ const char *pALM; -+ const char *pPEM; -+ const char *pCMPK; -+ const char *pRAPD; -+ const char *pTXPB; -+ const char *pQUMG; -+}ODM_DBGP_HEAD_T; -+ -+ -+/* Define different debug flag for dedicated service modules in debug flag array. */ -+// Each module has independt 32 bit debug flag you cnn define the flag as yout require. -+typedef enum tag_ODM_DBGP_Flag_Type_Definition -+{ -+ ODM_FTX = 0, -+ ODM_FRX , -+ ODM_FPHY , -+ ODM_FPWR , -+ ODM_FDM , -+ ODM_FC2H , -+ ODM_FBT , -+ ODM_DBGP_TYPE_MAX -+}ODM_DBGP_FLAG_E; -+ -+ -+// Define TX relative debug bit --> FTX -+#define ODM_TX_DESC BIT0 -+#define ODM_TX_DESC_TID BIT1 -+#define ODM_TX_PATH BIT2 -+ -+// Define RX relative debug bit --> FRX -+#define ODM_RX_DATA BIT0 -+#define ODM_RX_PHY_STS BIT1 -+#define ODM_RX_PHY_SS BIT2 -+#define ODM_RX_PHY_SQ BIT3 -+#define ODM_RX_PHY_ASTS BIT4 -+#define ODM_RX_ERR_LEN BIT5 -+#define ODM_RX_DEFRAG BIT6 -+#define ODM_RX_ERR_RATE BIT7 -+#define ODM_RX_PATH BIT8 -+#define ODM_RX_BEACON BIT9 -+ -+// Define PHY-BB/RF/MAC check module bit --> FPHY -+#define ODM_PHY_BBR BIT0 -+#define ODM_PHY_BBW BIT1 -+#define ODM_PHY_RFR BIT2 -+#define ODM_PHY_RFW BIT3 -+#define ODM_PHY_MACR BIT4 -+#define ODM_PHY_MACW BIT5 -+#define ODM_PHY_ALLR BIT6 -+#define ODM_PHY_ALLW BIT7 -+#define ODM_PHY_TXPWR BIT8 -+#define ODM_PHY_PWRDIFF BIT9 -+#define ODM_PHY_SICR BIT10 -+#define ODM_PHY_SICW BIT11 -+ -+ -+ -+ -+extern u4Byte ODM_GlobalDebugLevel; -+ -+ -+#if DBG -+extern u8Byte ODM_GlobalDebugComponents; -+#endif -+#endif -+#if 0 -+ -+//----------------------------------------------------------------------------- -+// Define the debug levels -+// -+// 1. DBG_TRACE and DBG_LOUD are used for normal cases. -+// So that, they can help SW engineer to develope or trace states changed -+// and also help HW enginner to trace every operation to and from HW, -+// e.g IO, Tx, Rx. -+// -+// 2. DBG_WARNNING and DBG_SERIOUS are used for unusual or error cases, -+// which help us to debug SW or HW. -+// -+//----------------------------------------------------------------------------- -+// -+// Never used in a call to ODM_RT_TRACE(pDM_Odm,)! -+// -+#define DBG_OFF 0 -+ -+// -+// Deprecated! Don't use it! -+// TODO: fix related debug message! -+// -+//#define DBG_SEC 1 -+ -+// -+// Fatal bug. -+// For example, Tx/Rx/IO locked up, OS hangs, memory access violation, -+// resource allocation failed, unexpected HW behavior, HW BUG and so on. -+// -+#define DBG_SERIOUS 2 -+ -+// -+// Abnormal, rare, or unexpeted cases. -+// For example, IRP/Packet/OID canceled, device suprisely unremoved and so on. -+// -+#define DBG_WARNING 3 -+ -+// -+// Normal case with useful information about current SW or HW state. -+// For example, Tx/Rx descriptor to fill, Tx/Rx descriptor completed status, -+// SW protocol state change, dynamic mechanism state change and so on. -+// -+#define DBG_LOUD 4 -+ -+// -+// Normal case with detail execution flow or information. -+// -+#define DBG_TRACE 5 -+ -+ -+ -+//----------------------------------------------------------------------------- -+// Define the tracing components -+// -+//----------------------------------------------------------------------------- -+#define COMP_TRACE BIT0 // For function call tracing. -+#define COMP_DBG BIT1 // Only for temporary debug message. -+#define COMP_INIT BIT2 // during driver initialization / halt / reset. -+#define COMP_OID_QUERY BIT3 // Query OID. -+#define COMP_OID_SET BIT4 // Set OID. -+#define COMP_RECV BIT5 // Reveive part data path. -+#define COMP_SEND BIT6 // Send part path. -+#define COMP_IO BIT7 // I/O Related. Added by Annie, 2006-03-02. -+#define COMP_POWER BIT8 // 802.11 Power Save mode or System/Device Power state related. -+#define COMP_MLME BIT9 // 802.11 link related: join/start BSS, leave BSS. -+#define COMP_SCAN BIT10 // For site survey. -+#define COMP_SYSTEM BIT11 // For general platform function. -+#define COMP_SEC BIT12 // For Security. -+#define COMP_AP BIT13 // For AP mode related. -+#define COMP_TURBO BIT14 // For Turbo Mode related. By Annie, 2005-10-21. -+#define COMP_QOS BIT15 // For QoS. -+#define COMP_AUTHENTICATOR BIT16 // For AP mode Authenticator. Added by Annie, 2006-01-30. -+#define COMP_BEACON BIT17 // For Beacon related, by rcnjko. -+#define COMP_ANTENNA BIT18 // For Antenna diversity related, by rcnjko. -+#define COMP_RATE BIT19 // For Rate Adaptive mechanism, 2006.07.02, by rcnjko. #define COMP_EVENTS 0x00000080 // Event handling -+#define COMP_EVENTS BIT20 // Event handling -+#define COMP_FPGA BIT21 // For FPGA verfication -+#define COMP_RM BIT22 // For Radio Measurement. -+#define COMP_MP BIT23 // For mass production test, by shien chang, 2006.07.13 -+#define COMP_RXDESC BIT24 // Show Rx desc information for SD3 debug. Added by Annie, 2006-07-15. -+#define COMP_CKIP BIT25 // For CCX 1 S13: CKIP. Added by Annie, 2006-08-14. -+#define COMP_DIG BIT26 // For DIG, 2006.09.25, by rcnjko. -+#define COMP_TXAGC BIT27 // For Tx power, 060928, by rcnjko. -+#define COMP_HIPWR BIT28 // For High Power Mechanism, 060928, by rcnjko. -+#define COMP_HALDM BIT29 // For HW Dynamic Mechanism, 061010, by rcnjko. -+#define COMP_RSNA BIT30 // For RSNA IBSS , 061201, by CCW. -+#define COMP_INDIC BIT31 // For link indication -+#define COMP_LED BIT32 // For LED. -+#define COMP_RF BIT33 // For RF. -+//1!!!!!!!!!!!!!!!!!!!!!!!!!!! -+//1//1Attention Please!!!<11n or 8190 specific code should be put below this line> -+//1!!!!!!!!!!!!!!!!!!!!!!!!!!! -+ -+#define COMP_HT BIT34 // For 802.11n HT related information. by Emily 2006-8-11 -+#define COMP_POWER_TRACKING BIT35 //FOR 8190 TX POWER TRACKING -+#define COMP_RX_REORDER BIT36 // 8190 Rx Reorder -+#define COMP_AMSDU BIT37 // For A-MSDU Debugging -+#define COMP_WPS BIT38 //WPS Debug Message -+#define COMP_RATR BIT39 -+#define COMP_RESET BIT40 -+// For debug command to print on dbgview!! -+#define COMP_CMD BIT41 -+#define COMP_EFUSE BIT42 -+#define COMP_MESH_INTERWORKING BIT43 -+#define COMP_CCX BIT44 //CCX Debug Flag -+#define COMP_IOCTL BIT45 // IO Control -+#define COMP_GP BIT46 // For generic parser. -+#define COMP_TXAGG BIT47 -+#define COMP_HVL BIT48 // For Ndis 6.2 Context Swirch and Hardware Virtualiztion Layer -+#define COMP_TEST BIT49 -+#define COMP_BB_POWERSAVING BIT50 -+#define COMP_SWAS BIT51 // For SW Antenna Switch -+#define COMP_P2P BIT52 -+#define COMP_MUX BIT53 -+#define COMP_FUNC BIT54 -+#define COMP_TDLS BIT55 -+#define COMP_OMNIPEEK BIT56 -+#define COMP_DUALMACSWITCH BIT60 // 2010/12/27 Add for Dual mac mode debug -+#define COMP_EASY_CONCURRENT BIT61 // 2010/12/27 Add for easy cncurrent mode debug -+#define COMP_PSD BIT63 //2011/3/9 Add for WLAN PSD for BT AFH -+ -+#define COMP_DFS BIT62 -+ -+#define COMP_ALL u3264_C(0xFFFFFFFFFFFFFFFF) // All components -+// For debug print flag to use -+/*------------------------------Define structure----------------------------*/ -+/* 2007/07/13 MH *//*------For DeBuG Print modeue------*/ -+ -+/* Defnie structure to store different debug flag variable. Every debug flag -+ is a u3232 integer and you can assign 32 different events. */ -+typedef struct tag_DBGP_Debug_Flag_Structure -+{ -+ u4Byte Mans; /* Main Scheduler module. */ -+ u4Byte Rtos; /* RTOS module. */ -+ u4Byte Alarm; /* Alarm module. */ -+ u4Byte Pm; /* Performance monitor module. */ -+}DBGP_FLAG_T; -+ -+/* Define debug print header for every service module.*/ -+typedef struct tag_DBGP_Service_Module_Header_Name_Structure -+{ -+ const char *pMANS; -+ const char *pRTOS; -+ const char *pALM; -+ const char *pPEM; -+ const char *pCMPK; -+ const char *pRAPD; -+ const char *pTXPB; -+ const char *pQUMG; -+}DBGP_HEAD_T; -+ -+ -+/* Define different debug flag for dedicated service modules in debug flag array. */ -+// Each module has independt 32 bit debug flag you cnn define the flag as yout require. -+typedef enum tag_DBGP_Flag_Type_Definition -+{ -+ FQoS = 0, -+ FTX = 1, -+ FRX = 2, -+ FSEC = 3, -+ FMGNT = 4, -+ FMLME = 5, -+ FRESOURCE = 6, -+ FBEACON = 7, -+ FISR = 8, -+ FPHY = 9, -+ FMP = 10, -+ FEEPROM = 11, -+ FPWR = 12, -+ FDM = 13, -+ FDBG_CTRL = 14, -+ FC2H = 15, -+ FBT = 16, -+ FINIT = 17, -+ FIOCTL = 18, -+ FSHORT_CUT = 19, -+ DBGP_TYPE_MAX -+}DBGP_FLAG_E; -+ -+ -+// Define Qos Relative debug flag bit --> FQoS -+#define QoS_INIT BIT0 -+#define QoS_VISTA BIT1 -+ -+// Define TX relative debug bit --> FTX -+#define TX_DESC BIT0 -+#define TX_DESC_TID BIT1 -+#define TX_PATH BIT2 -+ -+// Define RX relative debug bit --> FRX -+#define RX_DATA BIT0 -+#define RX_PHY_STS BIT1 -+#define RX_PHY_SS BIT2 -+#define RX_PHY_SQ BIT3 -+#define RX_PHY_ASTS BIT4 -+#define RX_ERR_LEN BIT5 -+#define RX_DEFRAG BIT6 -+#define RX_ERR_RATE BIT7 -+#define RX_PATH BIT8 -+#define RX_BEACON BIT9 -+ -+// Define Security relative debug bit --> FSEC -+ -+// Define MGNT relative debug bit --> FMGNT -+ -+// Define MLME relative debug bit --> FMLME -+#define MEDIA_STS BIT0 -+#define LINK_STS BIT1 -+ -+// Define OS resource check module bit --> FRESOURCE -+#define OS_CHK BIT0 -+ -+// Define beacon content check module bit --> FBEACON -+#define BCN_SHOW BIT0 -+#define BCN_PEER BIT1 -+ -+// Define ISR/IMR check module bit --> FISR -+#define ISR_CHK BIT0 -+ -+// Define PHY-BB/RF/MAC check module bit --> FPHY -+#define PHY_BBR BIT0 -+#define PHY_BBW BIT1 -+#define PHY_RFR BIT2 -+#define PHY_RFW BIT3 -+#define PHY_MACR BIT4 -+#define PHY_MACW BIT5 -+#define PHY_ALLR BIT6 -+#define PHY_ALLW BIT7 -+#define PHY_TXPWR BIT8 -+#define PHY_PWRDIFF BIT9 -+#define PHY_SICR BIT10 -+#define PHY_SICW BIT11 -+ -+// Define MPT driver check module bit --> FMP -+#define MP_RX BIT0 -+#define MP_SWICH_CH BIT1 -+ -+// Define EEPROM and EFUSE check module bit --> FEEPROM -+#define EEPROM_W BIT0 -+#define EFUSE_PG BIT1 -+#define EFUSE_READ_ALL BIT2 -+#define EFUSE_ANALYSIS BIT3 -+#define EFUSE_PG_DETAIL BIT4 -+ -+// Define power save check module bit --> FPWR -+#define LPS BIT0 -+#define IPS BIT1 -+#define PWRSW BIT2 -+#define PWRHW BIT3 -+#define PWRHAL BIT4 -+ -+// Define Dynamic Mechanism check module bit --> FDM -+#define WA_IOT BIT0 -+#define DM_PWDB BIT1 -+#define DM_Monitor BIT2 -+#define DM_DIG BIT3 -+#define DM_EDCA_Turbo BIT4 -+#define DM_BT30 BIT5 -+ -+// Define Dbg Control module bit --> FDBG_CTRL -+#define DBG_CTRL_TRACE BIT0 -+#define DBG_CTRL_INBAND_NOISE BIT1 -+ -+// Define FW C2H Cmd check module bit --> FC2H -+#define C2H_Summary BIT0 -+#define C2H_PacketData BIT1 -+#define C2H_ContentData BIT2 -+// Define BT Cmd check module bit --> FBT -+#define BT_TRACE BIT0 -+#define BT_RFPoll BIT1 -+ -+// Define init check for module bit --> FINIT -+#define INIT_EEPROM BIT0 -+#define INIT_TxPower BIT1 -+#define INIT_IQK BIT2 -+#define INIT_RF BIT3 -+ -+// Define IOCTL Cmd check module bit --> FIOCTL -+// section 1 : IRP related -+#define IOCTL_IRP BIT0 -+#define IOCTL_IRP_DETAIL BIT1 -+#define IOCTL_IRP_STATISTICS BIT2 -+#define IOCTL_IRP_HANDLE BIT3 -+// section 2 : HCI command/event -+#define IOCTL_BT_HCICMD BIT8 -+#define IOCTL_BT_HCICMD_DETAIL BIT9 -+#define IOCTL_BT_HCICMD_EXT BIT10 -+#define IOCTL_BT_EVENT BIT11 -+#define IOCTL_BT_EVENT_DETAIL BIT12 -+#define IOCTL_BT_EVENT_PERIODICAL BIT13 -+// section 3 : BT tx/rx data and throughput -+#define IOCTL_BT_TX_ACLDATA BIT16 -+#define IOCTL_BT_TX_ACLDATA_DETAIL BIT17 -+#define IOCTL_BT_RX_ACLDATA BIT18 -+#define IOCTL_BT_RX_ACLDATA_DETAIL BIT19 -+#define IOCTL_BT_TP BIT20 -+// section 4 : BT connection state machine. -+#define IOCTL_STATE BIT21 -+#define IOCTL_BT_LOGO BIT22 -+// section 5 : BT function trace -+#define IOCTL_CALLBACK_FUN BIT24 -+#define IOCTL_PARSE_BT_PKT BIT25 -+#define IOCTL_BT_TX_PKT BIT26 -+#define IOCTL_BT_FLAG_MON BIT27 -+ -+// -+// Define init check for module bit --> FSHORT_CUT -+// 2011/07/20 MH Add for short but definition. -+// -+#define SHCUT_TX BIT0 -+#define SHCUT_RX BIT1 -+ -+ -+/* 2007/07/13 MH *//*------For DeBuG Print modeue------*/ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/*------------------------Export Marco Definition---------------------------*/ -+#define RT_PRINTK(fmt, args...) printk( "%s(): " fmt, __FUNCTION__, ## args); -+ -+#if DBG -+#define ODM_RT_TRACE(pDM_Odm,comp, level, fmt) \ -+ if(((comp) & GlobalDebugComponents) && (level <= GlobalDebugLevel)) \ -+ { \ -+ RT_PRINTK fmt; \ -+ } -+ -+#define RT_TRACE_F(comp, level, fmt) \ -+ if(((comp) & GlobalDebugComponents) && (level <= GlobalDebugLevel)) \ -+ { \ -+ RT_PRINTK fmt; \ -+ } -+ -+#define RT_ASSERT(expr,fmt) \ -+ if(!(expr)) { \ -+ printk( "Assertion failed! %s at ......\n", #expr); \ -+ printk( " ......%s,%s,line=%d\n",__FILE__,__FUNCTION__,__LINE__); \ -+ } -+#define dbg_enter() { printk("==> %s\n", __FUNCTION__); } -+#define dbg_exit() { printk("<== %s\n", __FUNCTION__); } -+#define dbg_trace(str) { printk("%s:%s\n", __FUNCTION__, str); } -+#else -+#define ODM_RT_TRACE(pDM_Odm,comp, level, fmt) -+#define RT_TRACE_F(comp, level, fmt) -+#define RT_ASSERT(expr, fmt) -+#define dbg_enter() -+#define dbg_exit() -+#define dbg_trace(str) -+#endif -+ -+#if DBG -+#define DbgPrint printk -+ -+#define PRINT_DATA(_TitleString, _HexData, _HexDataLen) \ -+ { \ -+ char *szTitle = _TitleString; \ -+ pu1Byte pbtHexData = _HexData; \ -+ u4Byte u4bHexDataLen = _HexDataLen; \ -+ u4Byte __i; \ -+ DbgPrint("%s", szTitle); \ -+ for (__i=0;__i=' ' &&_ch<='~' ) // I want to see ASCII 33 to 126 only. Otherwise, I print '?'. Annie, 2005-11-22. -+ -+#define RT_PRINT_STR(_Comp, _Level, _TitleString, _Ptr, _Len) \ -+ if(((_Comp) & GlobalDebugComponents) && (_Level <= GlobalDebugLevel)) \ -+ { \ -+ int __i; \ -+ u1Byte buffer[MAX_STR_LEN]; \ -+ int length = (_Len\n", _Len, buffer); \ -+ } -+ -+#else // of #if DBG -+#define DbgPrint(...) -+#define PRINT_DATA(_TitleString, _HexData, _HexDataLen) -+#define RT_PRINT_DATA(_Comp, _Level, _TitleString, _HexData, _HexDataLen) -+#define RT_PRINT_ADDR(_Comp, _Level, _TitleString, _Ptr) -+#define RT_PRINT_ADDRS(_Comp, _Level, _TitleString, _Ptr, _AddNum) -+#define RT_PRINT_STR(_Comp, _Level, _TitleString, _Ptr, _Len) -+#endif // of #if DBG -+ -+#define DEBUG_PRINT 1 -+ -+// Please add new OS's print API by yourself -+ -+#if (DEBUG_PRINT == 1) && DBG -+#define RT_DISP(dbgtype, dbgflag, printstr)\ -+{\ -+ if (DBGP_Type[dbgtype] & dbgflag)\ -+ {\ -+ DbgPrint printstr;\ -+ }\ -+} -+ -+#define RT_DISP_ADDR(dbgtype, dbgflag, printstr, _Ptr)\ -+{\ -+ if (DBGP_Type[dbgtype] & dbgflag)\ -+ {\ -+ int __i; \ -+ pu1Byte ptr = (pu1Byte)_Ptr; \ -+ DbgPrint printstr; \ -+ DbgPrint(" "); \ -+ for( __i=0; __i<6; __i++ ) \ -+ DbgPrint("%02X%s", ptr[__i], (__i==5)?"":"-"); \ -+ DbgPrint("\n"); \ -+ }\ -+} -+ -+#define RT_DISP_DATA(dbgtype, dbgflag, _TitleString, _HexData, _HexDataLen)\ -+{\ -+ if (DBGP_Type[dbgtype] & dbgflag)\ -+ {\ -+ int __i; \ -+ pu1Byte ptr = (pu1Byte)_HexData; \ -+ DbgPrint(_TitleString); \ -+ for( __i=0; __i<(int)_HexDataLen; __i++ ) \ -+ { \ -+ DbgPrint("%02X%s", ptr[__i], (((__i + 1) % 4) == 0)?" ":" ");\ -+ if (((__i + 1) % 16) == 0) DbgPrint("\n");\ -+ } \ -+ DbgPrint("\n"); \ -+ }\ -+} -+ -+#define FunctionIn(_comp) ODM_RT_TRACE(pDM_Odm,(_comp), DBG_LOUD, ("==========> %s\n", __FUNCTION__)) -+#define FunctionOut(_comp) ODM_RT_TRACE(pDM_Odm,(_comp), DBG_LOUD, ("<========== %s\n", __FUNCTION__)) -+ -+ -+#else -+ -+#define RT_DISP(dbgtype, dbgflag, printstr) -+#define RT_DISP_ADDR(dbgtype, dbgflag, printstr, _Ptr) -+#define RT_DISP_DATA(dbgtype, dbgflag, _TitleString, _HexData, _HexDataLen) -+ -+#define FunctionIn(_comp) -+#define FunctionOut(_comp) -+#endif -+/*------------------------Export Marco Definition---------------------------*/ -+ -+ -+/*------------------------Export global variable----------------------------*/ -+extern u4Byte DBGP_Type[DBGP_TYPE_MAX]; -+extern DBGP_HEAD_T DBGP_Head; -+ -+/*------------------------Export global variable----------------------------*/ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+extern void DBGP_Flag_Init(void); -+extern void DBG_PrintAllFlag(void); -+extern void DBG_PrintAllComp(void); -+extern void DBG_PrintFlagEvent(u1Byte DbgFlag); -+extern void DBG_DumpMem(const u1Byte DbgComp, -+ const u1Byte DbgLevel, -+ pu1Byte pMem, -+ u2Byte Len); -+ -+/*--------------------------Exported Function prototype---------------------*/ -+ -+ -+ -+ -+ -+ -+ -+ -+ -+extern u4Byte GlobalDebugLevel; -+extern u8Byte GlobalDebugComponents; -+ -+ -+#endif -+ -+ -+#endif // __ODM_DBG_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm.h 2018-02-06 17:42:30.712967194 +0200 -@@ -0,0 +1,1750 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __HALDMOUTSRC_H__ -+#define __HALDMOUTSRC_H__ -+ -+//============================================================ -+// Definition -+//============================================================ -+// -+// 20100503 Joseph: -+// Add new function SwAntDivCheck8192C(). -+// This is the main function of Antenna diversity function before link. -+// Mainly, it just retains last scan result and scan again. -+// After that, it compares the scan result to see which one gets better RSSI. -+// It selects antenna with better receiving power and returns better scan result. -+// -+#define TP_MODE 0 -+#define RSSI_MODE 1 -+#define TRAFFIC_LOW 0 -+#define TRAFFIC_HIGH 1 -+ -+//============================================================ -+//3 Tx Power Tracking -+//3============================================================ -+#define DPK_DELTA_MAPPING_NUM 13 -+#define index_mapping_HP_NUM 15 -+#define OFDM_TABLE_SIZE 37 -+#define OFDM_TABLE_SIZE_92D 43 -+#define CCK_TABLE_SIZE 33 -+#define TXSCALE_TABLE_SIZE 37 -+#define DELTA_SWINGIDX_SIZE 30 -+#define BAND_NUM 3 -+ -+//============================================================ -+//3 PSD Handler -+//3============================================================ -+ -+#define AFH_PSD 1 //0:normal PSD scan, 1: only do 20 pts PSD -+#define MODE_40M 0 //0:20M, 1:40M -+#define PSD_TH2 3 -+#define PSD_CHMIN 20 // Minimum channel number for BT AFH -+#define SIR_STEP_SIZE 3 -+#define Smooth_Size_1 5 -+#define Smooth_TH_1 3 -+#define Smooth_Size_2 10 -+#define Smooth_TH_2 4 -+#define Smooth_Size_3 20 -+#define Smooth_TH_3 4 -+#define Smooth_Step_Size 5 -+#define Adaptive_SIR 1 -+#if(RTL8723_FPGA_VERIFICATION == 1) -+#define PSD_RESCAN 1 -+#else -+#define PSD_RESCAN 4 -+#endif -+#define PSD_SCAN_INTERVAL 700 //ms -+ -+ -+ -+//8723A High Power IGI Setting -+#define DM_DIG_HIGH_PWR_IGI_LOWER_BOUND 0x22 -+#define DM_DIG_Gmode_HIGH_PWR_IGI_LOWER_BOUND 0x28 -+#define DM_DIG_HIGH_PWR_THRESHOLD 0x3a -+#define DM_DIG_LOW_PWR_THRESHOLD 0x14 -+ -+//ANT Test -+#define ANTTESTALL 0x00 //Ant A or B will be Testing -+#define ANTTESTA 0x01 //Ant A will be Testing -+#define ANTTESTB 0x02 //Ant B will be testing -+ -+// LPS define -+#define DM_DIG_FA_TH0_LPS 4 //-> 4 in lps -+#define DM_DIG_FA_TH1_LPS 15 //-> 15 lps -+#define DM_DIG_FA_TH2_LPS 30 //-> 30 lps -+#define RSSI_OFFSET_DIG 0x05; -+ -+ -+ -+//for 8723A Ant Definition--2012--06--07 due to different IC may be different ANT define -+#define MAIN_ANT 1 //Ant A or Ant Main -+#define AUX_ANT 2 //AntB or Ant Aux -+#define MAX_ANT 3 // 3 for AP using -+ -+ -+//Antenna Diversity Type -+#define SW_ANTDIV 0 -+#define HW_ANTDIV 1 -+ -+//Antenna Diversty Control Type -+#define ODM_AUTO_ANT 0 -+#define ODM_FIX_MAIN_ANT 1 -+#define ODM_FIX_AUX_ANT 2 -+ -+//============================================================ -+// structure and define -+//============================================================ -+ -+// -+// 2011/09/20 MH Add for AP/ADSLpseudo DM structuer requirement. -+// We need to remove to other position??? -+// -+typedef struct rtl8192cd_priv { -+ u1Byte temp; -+ -+}rtl8192cd_priv, *prtl8192cd_priv; -+ -+typedef struct _Dynamic_Initial_Gain_Threshold_ -+{ -+ u1Byte Dig_Enable_Flag; -+ u1Byte Dig_Ext_Port_Stage; -+ -+ int RssiLowThresh; -+ int RssiHighThresh; -+ -+ u4Byte FALowThresh; -+ u4Byte FAHighThresh; -+ -+ u1Byte CurSTAConnectState; -+ u1Byte PreSTAConnectState; -+ u1Byte CurMultiSTAConnectState; -+ -+ u1Byte PreIGValue; -+ u1Byte CurIGValue; -+ u1Byte BT30_CurIGI; -+ u1Byte BackupIGValue; -+ -+ s1Byte BackoffVal; -+ s1Byte BackoffVal_range_max; -+ s1Byte BackoffVal_range_min; -+ u1Byte rx_gain_range_max; -+ u1Byte rx_gain_range_min; -+ u1Byte Rssi_val_min; -+ -+ u1Byte PreCCK_CCAThres; -+ u1Byte CurCCK_CCAThres; -+ u1Byte PreCCKPDState; -+ u1Byte CurCCKPDState; -+ -+ u1Byte LargeFAHit; -+ u1Byte ForbiddenIGI; -+ u4Byte Recover_cnt; -+ -+ u1Byte DIG_Dynamic_MIN_0; -+ u1Byte DIG_Dynamic_MIN_1; -+ bool bMediaConnect_0; -+ bool bMediaConnect_1; -+ -+ u4Byte AntDiv_RSSI_max; -+ u4Byte RSSI_max; -+}DIG_T,*pDIG_T; -+ -+typedef struct _Dynamic_Power_Saving_ -+{ -+ u1Byte PreCCAState; -+ u1Byte CurCCAState; -+ -+ u1Byte PreRFState; -+ u1Byte CurRFState; -+ -+ int Rssi_val_min; -+ -+ u1Byte initialize; -+ u4Byte Reg874,RegC70,Reg85C,RegA74; -+ -+}PS_T,*pPS_T; -+ -+typedef struct false_ALARM_STATISTICS{ -+ u4Byte Cnt_Parity_Fail; -+ u4Byte Cnt_Rate_Illegal; -+ u4Byte Cnt_Crc8_fail; -+ u4Byte Cnt_Mcs_fail; -+ u4Byte Cnt_Ofdm_fail; -+ u4Byte Cnt_Cck_fail; -+ u4Byte Cnt_all; -+ u4Byte Cnt_Fast_Fsync; -+ u4Byte Cnt_SB_Search_fail; -+ u4Byte Cnt_OFDM_CCA; -+ u4Byte Cnt_CCK_CCA; -+ u4Byte Cnt_CCA_all; -+ u4Byte Cnt_BW_USC; //Gary -+ u4Byte Cnt_BW_LSC; //Gary -+}FALSE_ALARM_STATISTICS, *PFALSE_ALARM_STATISTICS; -+ -+typedef struct _Dynamic_Primary_CCA{ -+ u1Byte PriCCA_flag; -+ u1Byte intf_flag; -+ u1Byte intf_type; -+ u1Byte DupRTS_flag; -+ u1Byte Monitor_flag; -+ u1Byte CH_offset; -+ u1Byte MF_state; -+}Pri_CCA_T, *pPri_CCA_T; -+ -+typedef struct _RX_High_Power_ -+{ -+ u1Byte RXHP_flag; -+ u1Byte PSD_func_trigger; -+ u1Byte PSD_bitmap_RXHP[80]; -+ u1Byte Pre_IGI; -+ u1Byte Cur_IGI; -+ u1Byte Pre_pw_th; -+ u1Byte Cur_pw_th; -+ bool First_time_enter; -+ bool RXHP_enable; -+ u1Byte TP_Mode; -+ RT_TIMER PSDTimer; -+}RXHP_T, *pRXHP_T; -+ -+#define ASSOCIATE_ENTRY_NUM 32 // Max size of AsocEntry[]. -+#define ODM_ASSOCIATE_ENTRY_NUM ASSOCIATE_ENTRY_NUM -+ -+// This indicates two different the steps. -+// In SWAW_STEP_PEAK, driver needs to switch antenna and listen to the signal on the air. -+// In SWAW_STEP_DETERMINE, driver just compares the signal captured in SWAW_STEP_PEAK -+// with original RSSI to determine if it is necessary to switch antenna. -+#define SWAW_STEP_PEAK 0 -+#define SWAW_STEP_DETERMINE 1 -+ -+#define TP_MODE 0 -+#define RSSI_MODE 1 -+#define TRAFFIC_LOW 0 -+#define TRAFFIC_HIGH 1 -+ -+typedef struct _SW_Antenna_Switch_ -+{ -+ u1Byte try_flag; -+ s4Byte PreRSSI; -+ u1Byte CurAntenna; -+ u1Byte PreAntenna; -+ u1Byte RSSI_Trying; -+ u1Byte TestMode; -+ u1Byte bTriggerAntennaSwitch; -+ u1Byte SelectAntennaMap; -+ u1Byte RSSI_target; -+ -+ // Before link Antenna Switch check -+ u1Byte SWAS_NoLink_State; -+ u4Byte SWAS_NoLink_BK_Reg860; -+ bool ANTA_ON; //To indicate Ant A is or not -+ bool ANTB_ON; //To indicate Ant B is on or not -+ -+ s4Byte RSSI_sum_A; -+ s4Byte RSSI_sum_B; -+ s4Byte RSSI_cnt_A; -+ s4Byte RSSI_cnt_B; -+ -+ u8Byte lastTxOkCnt; -+ u8Byte lastRxOkCnt; -+ u8Byte TXByteCnt_A; -+ u8Byte TXByteCnt_B; -+ u8Byte RXByteCnt_A; -+ u8Byte RXByteCnt_B; -+ u1Byte TrafficLoad; -+ RT_TIMER SwAntennaSwitchTimer; -+#ifdef CONFIG_HW_ANTENNA_DIVERSITY -+ //Hybrid Antenna Diversity -+ u4Byte CCK_Ant1_Cnt[ASSOCIATE_ENTRY_NUM+1]; -+ u4Byte CCK_Ant2_Cnt[ASSOCIATE_ENTRY_NUM+1]; -+ u4Byte OFDM_Ant1_Cnt[ASSOCIATE_ENTRY_NUM+1]; -+ u4Byte OFDM_Ant2_Cnt[ASSOCIATE_ENTRY_NUM+1]; -+ u4Byte RSSI_Ant1_Sum[ASSOCIATE_ENTRY_NUM+1]; -+ u4Byte RSSI_Ant2_Sum[ASSOCIATE_ENTRY_NUM+1]; -+ u1Byte TxAnt[ASSOCIATE_ENTRY_NUM+1]; -+ u1Byte TargetSTA; -+ u1Byte antsel; -+ u1Byte RxIdleAnt; -+ -+#endif -+ -+}SWAT_T, *pSWAT_T; -+ -+typedef struct _EDCA_TURBO_ -+{ -+ bool bCurrentTurboEDCA; -+ bool bIsCurRDLState; -+ u4Byte prv_traffic_idx; // edca turbo -+}EDCA_T,*pEDCA_T; -+ -+typedef struct _ODM_RATE_ADAPTIVE -+{ -+ u1Byte Type; // DM_Type_ByFW/DM_Type_ByDriver -+ u1Byte LdpcThres; // if RSSI > LdpcThres => switch from LPDC to BCC -+ bool bUseLdpc; -+ bool bLowerRtsRate; -+ u1Byte HighRSSIThresh; // if RSSI > HighRSSIThresh => RATRState is DM_RATR_STA_HIGH -+ u1Byte LowRSSIThresh; // if RSSI <= LowRSSIThresh => RATRState is DM_RATR_STA_LOW -+ u1Byte RATRState; // Current RSSI level, DM_RATR_STA_HIGH/DM_RATR_STA_MIDDLE/DM_RATR_STA_LOW -+ -+} ODM_RATE_ADAPTIVE, *PODM_RATE_ADAPTIVE; -+ -+#define IQK_MAC_REG_NUM 4 -+#define IQK_ADDA_REG_NUM 16 -+#define IQK_BB_REG_NUM_MAX 10 -+ -+ -+#define IQK_BB_REG_NUM 10 -+#define HP_THERMAL_NUM 8 -+ -+#define AVG_THERMAL_NUM 8 -+#define IQK_Matrix_REG_NUM 8 -+#define IQK_Matrix_Settings_NUM 14+24+21 // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G -+ -+#define DM_Type_ByFW 0 -+#define DM_Type_ByDriver 1 -+ -+// -+// Declare for common info -+// -+#define MAX_PATH_NUM_92CS 2 -+#define MAX_PATH_NUM_8188E 1 -+#define MAX_PATH_NUM_8192E 2 -+#define MAX_PATH_NUM_8723B 1 -+#define MAX_PATH_NUM_8812A 2 -+#define MAX_PATH_NUM_8821A 1 -+ -+#define IQK_THRESHOLD 8 -+ -+typedef struct _ODM_Phy_Status_Info_ -+{ -+ // -+ // Be care, if you want to add any element please insert between -+ // RxPWDBAll & SignalStrength. -+ // -+ u1Byte RxPWDBAll; -+ -+ u1Byte SignalQuality; // in 0-100 index. -+ s1Byte RxMIMOSignalQuality[4]; //per-path's EVM -+ u1Byte RxMIMOEVMdbm[4]; //per-path's EVM dbm -+ -+ u1Byte RxMIMOSignalStrength[4];// in 0~100 index -+ -+ u2Byte Cfo_short[4]; // per-path's Cfo_short -+ u2Byte Cfo_tail[4]; // per-path's Cfo_tail -+ -+ s1Byte RxPower; // in dBm Translate from PWdB -+ s1Byte RecvSignalPower; // Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. -+ u1Byte BTRxRSSIPercentage; -+ u1Byte SignalStrength; // in 0-100 index. -+ -+ u1Byte RxPwr[4]; //per-path's pwdb -+ u1Byte RxSNR[4]; //per-path's SNR -+ u1Byte BandWidth; -+ u1Byte btCoexPwrAdjust; -+}ODM_PHY_INFO_T,*PODM_PHY_INFO_T; -+ -+ -+typedef struct _ODM_Per_Pkt_Info_ -+{ -+ //u1Byte Rate; -+ u1Byte DataRate; -+ u1Byte StationID; -+ bool bPacketMatchBSSID; -+ bool bPacketToSelf; -+ bool bPacketBeacon; -+}ODM_PACKET_INFO_T,*PODM_PACKET_INFO_T; -+ -+ -+typedef struct _ODM_Phy_Dbg_Info_ -+{ -+ //ODM Write,debug info -+ s1Byte RxSNRdB[4]; -+ u8Byte NumQryPhyStatus; -+ u8Byte NumQryPhyStatusCCK; -+ u8Byte NumQryPhyStatusOFDM; -+ u1Byte NumQryBeaconPkt; -+ //Others -+ s4Byte RxEVM[4]; -+ -+}ODM_PHY_DBG_INFO_T; -+ -+ -+typedef struct _ODM_Mac_Status_Info_ -+{ -+ u1Byte test; -+ -+}ODM_MAC_INFO; -+ -+ -+typedef enum tag_Dynamic_ODM_Support_Ability_Type -+{ -+ // BB Team -+ ODM_DIG = 0x00000001, -+ ODM_HIGH_POWER = 0x00000002, -+ ODM_CCK_CCA_TH = 0x00000004, -+ ODM_FA_STATISTICS = 0x00000008, -+ ODM_RAMASK = 0x00000010, -+ ODM_RSSI_MONITOR = 0x00000020, -+ ODM_SW_ANTDIV = 0x00000040, -+ ODM_HW_ANTDIV = 0x00000080, -+ ODM_BB_PWRSV = 0x00000100, -+ ODM_2TPATHDIV = 0x00000200, -+ ODM_1TPATHDIV = 0x00000400, -+ ODM_PSD2AFH = 0x00000800 -+}ODM_Ability_E; -+ -+// -+// 2011/20/20 MH For MP driver RT_WLAN_STA = STA_INFO_T -+// Please declare below ODM relative info in your STA info structure. -+// -+#if 1 -+typedef struct _ODM_STA_INFO{ -+ // Driver Write -+ bool bUsed; // record the sta status link or not? -+ //u1Byte WirelessMode; // -+ u1Byte IOTPeer; // Enum value. HT_IOT_PEER_E -+ -+ // ODM Write -+ //1 PHY_STATUS_INFO -+ u1Byte RSSI_Path[4]; // -+ u1Byte RSSI_Ave; -+ u1Byte RXEVM[4]; -+ u1Byte RXSNR[4]; -+ -+ // ODM Write -+ //1 TX_INFO (may changed by IC) -+ //TX_INFO_T pTxInfo; // Define in IC folder. Move lower layer. -+#if 0 -+ u1Byte ANTSEL_A; //in Jagar: 4bit; others: 2bit -+ u1Byte ANTSEL_B; //in Jagar: 4bit; others: 2bit -+ u1Byte ANTSEL_C; //only in Jagar: 4bit -+ u1Byte ANTSEL_D; //only in Jagar: 4bit -+ u1Byte TX_ANTL; //not in Jagar: 2bit -+ u1Byte TX_ANT_HT; //not in Jagar: 2bit -+ u1Byte TX_ANT_CCK; //not in Jagar: 2bit -+ u1Byte TXAGC_A; //not in Jagar: 4bit -+ u1Byte TXAGC_B; //not in Jagar: 4bit -+ u1Byte TXPWR_OFFSET; //only in Jagar: 3bit -+ u1Byte TX_ANT; //only in Jagar: 4bit for TX_ANTL/TX_ANTHT/TX_ANT_CCK -+#endif -+ -+ // -+ // Please use compile flag to disabe the strcutrue for other IC except 88E. -+ // Move To lower layer. -+ // -+ // ODM Write Wilson will handle this part(said by Luke.Lee) -+ //TX_RPT_T pTxRpt; // Define in IC folder. Move lower layer. -+#if 0 -+ //1 For 88E RA (don't redefine the naming) -+ u1Byte rate_id; -+ u1Byte rate_SGI; -+ u1Byte rssi_sta_ra; -+ u1Byte SGI_enable; -+ u1Byte Decision_rate; -+ u1Byte Pre_rate; -+ u1Byte Active; -+ -+ // Driver write Wilson handle. -+ //1 TX_RPT (don't redefine the naming) -+ u2Byte RTY[4]; // ??? -+ u2Byte TOTAL; // ??? -+ u2Byte DROP; // ??? -+ // -+ // Please use compile flag to disabe the strcutrue for other IC except 88E. -+ // -+#endif -+ -+}ODM_STA_INFO_T, *PODM_STA_INFO_T; -+#endif -+ -+// -+// 2011/10/20 MH Define Common info enum for all team. -+// -+typedef enum _ODM_Common_Info_Definition -+{ -+//-------------REMOVED CASE-----------// -+ //ODM_CMNINFO_CCK_HP, -+ //ODM_CMNINFO_RFPATH_ENABLE, // Define as ODM write??? -+ //ODM_CMNINFO_BT_COEXIST, // ODM_BT_COEXIST_E -+ //ODM_CMNINFO_OP_MODE, // ODM_OPERATION_MODE_E -+//-------------REMOVED CASE-----------// -+ -+ // -+ // Fixed value: -+ // -+ -+ //-----------HOOK BEFORE REG INIT-----------// -+ ODM_CMNINFO_PLATFORM = 0, -+ ODM_CMNINFO_ABILITY, // ODM_ABILITY_E -+ ODM_CMNINFO_INTERFACE, // ODM_INTERFACE_E -+ ODM_CMNINFO_MP_TEST_CHIP, -+ ODM_CMNINFO_IC_TYPE, // ODM_IC_TYPE_E -+ ODM_CMNINFO_CUT_VER, // ODM_CUT_VERSION_E -+ ODM_CMNINFO_FAB_VER, // ODM_FAB_E -+ ODM_CMNINFO_RF_TYPE, // ODM_RF_PATH_E or ODM_RF_TYPE_E? -+ ODM_CMNINFO_RFE_TYPE, -+ ODM_CMNINFO_BOARD_TYPE, // ODM_BOARD_TYPE_E -+ ODM_CMNINFO_EXT_LNA, // TRUE -+ ODM_CMNINFO_5G_EXT_LNA, -+ ODM_CMNINFO_EXT_PA, -+ ODM_CMNINFO_5G_EXT_PA, -+ ODM_CMNINFO_EXT_TRSW, -+ ODM_CMNINFO_PATCH_ID, //CUSTOMER ID -+ ODM_CMNINFO_BINHCT_TEST, -+ ODM_CMNINFO_BWIFI_TEST, -+ ODM_CMNINFO_SMART_CONCURRENT, -+ //-----------HOOK BEFORE REG INIT-----------// -+ -+ -+ // -+ // Dynamic value: -+ // -+//--------- POINTER REFERENCE-----------// -+ ODM_CMNINFO_MAC_PHY_MODE, // ODM_MAC_PHY_MODE_E -+ ODM_CMNINFO_TX_UNI, -+ ODM_CMNINFO_RX_UNI, -+ ODM_CMNINFO_WM_MODE, // ODM_WIRELESS_MODE_E -+ ODM_CMNINFO_BAND, // ODM_BAND_TYPE_E -+ ODM_CMNINFO_SEC_CHNL_OFFSET, // ODM_SEC_CHNL_OFFSET_E -+ ODM_CMNINFO_SEC_MODE, // ODM_SECURITY_E -+ ODM_CMNINFO_BW, // ODM_BW_E -+ ODM_CMNINFO_CHNL, -+ ODM_CMNINFO_FORCED_RATE, -+ -+ ODM_CMNINFO_DMSP_GET_VALUE, -+ ODM_CMNINFO_BUDDY_ADAPTOR, -+ ODM_CMNINFO_DMSP_IS_MASTER, -+ ODM_CMNINFO_SCAN, -+ ODM_CMNINFO_POWER_SAVING, -+ ODM_CMNINFO_ONE_PATH_CCA, // ODM_CCA_PATH_E -+ ODM_CMNINFO_DRV_STOP, -+ ODM_CMNINFO_PNP_IN, -+ ODM_CMNINFO_INIT_ON, -+ ODM_CMNINFO_ANT_TEST, -+ ODM_CMNINFO_NET_CLOSED, -+ ODM_CMNINFO_MP_MODE, -+ //ODM_CMNINFO_RTSTA_AID, // For win driver only? -+//--------- POINTER REFERENCE-----------// -+ -+//------------CALL BY VALUE-------------// -+ ODM_CMNINFO_WIFI_DIRECT, -+ ODM_CMNINFO_WIFI_DISPLAY, -+ ODM_CMNINFO_LINK_IN_PROGRESS, -+ ODM_CMNINFO_LINK, -+ ODM_CMNINFO_RSSI_MIN, -+ ODM_CMNINFO_DBG_COMP, // u8Byte -+ ODM_CMNINFO_DBG_LEVEL, // u4Byte -+ ODM_CMNINFO_RA_THRESHOLD_HIGH, // u1Byte -+ ODM_CMNINFO_RA_THRESHOLD_LOW, // u1Byte -+ ODM_CMNINFO_RF_ANTENNA_TYPE, // u1Byte -+ ODM_CMNINFO_BT_DISABLED, -+ ODM_CMNINFO_BT_HS_CONNECT_PROCESS, -+ ODM_CMNINFO_BT_HS_RSSI, -+ ODM_CMNINFO_BT_OPERATION, -+ ODM_CMNINFO_BT_LIMITED_DIG, //Need to Limited Dig or not -+ ODM_CMNINFO_BT_DISABLE_EDCA, -+//------------CALL BY VALUE-------------// -+ -+ // -+ // Dynamic ptr array hook itms. -+ // -+ ODM_CMNINFO_STA_STATUS, -+ ODM_CMNINFO_PHY_STATUS, -+ ODM_CMNINFO_MAC_STATUS, -+ -+ ODM_CMNINFO_MAX, -+ -+ -+}ODM_CMNINFO_E; -+ -+// -+// 2011/10/20 MH Define ODM support ability. ODM_CMNINFO_ABILITY -+// -+typedef enum _ODM_Support_Ability_Definition -+{ -+ // -+ // BB ODM section BIT 0-15 -+ // -+ ODM_BB_DIG = BIT0, -+ ODM_BB_RA_MASK = BIT1, -+ ODM_BB_DYNAMIC_TXPWR = BIT2, -+ ODM_BB_FA_CNT = BIT3, -+ ODM_BB_RSSI_MONITOR = BIT4, -+ ODM_BB_CCK_PD = BIT5, -+ ODM_BB_ANT_DIV = BIT6, -+ ODM_BB_PWR_SAVE = BIT7, -+ ODM_BB_PWR_TRAIN = BIT8, -+ ODM_BB_RATE_ADAPTIVE = BIT9, -+ ODM_BB_PATH_DIV = BIT10, -+ ODM_BB_PSD = BIT11, -+ ODM_BB_RXHP = BIT12, -+ ODM_BB_ADAPTIVITY = BIT13, -+ ODM_BB_DYNAMIC_ATC = BIT14, -+ -+ // -+ // MAC DM section BIT 16-23 -+ // -+ ODM_MAC_EDCA_TURBO = BIT16, -+ ODM_MAC_EARLY_MODE = BIT17, -+ -+ // -+ // RF ODM section BIT 24-31 -+ // -+ ODM_RF_TX_PWR_TRACK = BIT24, -+ ODM_RF_RX_GAIN_TRACK = BIT25, -+ ODM_RF_CALIBRATION = BIT26, -+ -+}ODM_ABILITY_E; -+ -+// ODM_CMNINFO_INTERFACE -+typedef enum tag_ODM_Support_Interface_Definition -+{ -+ ODM_ITRF_PCIE = 0x1, -+ ODM_ITRF_USB = 0x2, -+ ODM_ITRF_SDIO = 0x4, -+ ODM_ITRF_ALL = 0x7, -+}ODM_INTERFACE_E; -+ -+// ODM_CMNINFO_IC_TYPE -+typedef enum tag_ODM_Support_IC_Type_Definition -+{ -+ ODM_RTL8192S = BIT0, -+ ODM_RTL8192C = BIT1, -+ ODM_RTL8192D = BIT2, -+ ODM_RTL8723A = BIT3, -+ ODM_RTL8188E = BIT4, -+ ODM_RTL8812 = BIT5, -+ ODM_RTL8821 = BIT6, -+ ODM_RTL8192E = BIT7, -+ ODM_RTL8723B = BIT8, -+ ODM_RTL8813A = BIT9 -+}ODM_IC_TYPE_E; -+ -+#define ODM_IC_11N_SERIES (ODM_RTL8192S|ODM_RTL8192C|ODM_RTL8192D|ODM_RTL8723A|ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B) -+#define ODM_IC_11AC_SERIES (ODM_RTL8812 | ODM_RTL8821|ODM_RTL8813A) -+ -+//ODM_CMNINFO_CUT_VER -+typedef enum tag_ODM_Cut_Version_Definition -+{ -+ ODM_CUT_A = 1, -+ ODM_CUT_B = 2, -+ ODM_CUT_C = 3, -+ ODM_CUT_D = 4, -+ ODM_CUT_E = 5, -+ ODM_CUT_F = 6, -+ ODM_CUT_I = 9, -+ ODM_CUT_TEST = 7, -+}ODM_CUT_VERSION_E; -+ -+// ODM_CMNINFO_FAB_VER -+typedef enum tag_ODM_Fab_Version_Definition -+{ -+ ODM_TSMC = 0, -+ ODM_UMC = 1, -+ ODM_SMIC = 2, -+}ODM_FAB_E; -+ -+// ODM_CMNINFO_RF_TYPE -+// -+// For example 1T2R (A+AB = BIT0|BIT4|BIT5) -+// -+typedef enum tag_ODM_RF_Path_Bit_Definition -+{ -+ ODM_RF_TX_A = BIT0, -+ ODM_RF_TX_B = BIT1, -+ ODM_RF_TX_C = BIT2, -+ ODM_RF_TX_D = BIT3, -+ ODM_RF_RX_A = BIT4, -+ ODM_RF_RX_B = BIT5, -+ ODM_RF_RX_C = BIT6, -+ ODM_RF_RX_D = BIT7, -+}ODM_RF_PATH_E; -+ -+ -+typedef enum tag_ODM_RF_Type_Definition -+{ -+ ODM_1T1R = 0, -+ ODM_1T2R = 1, -+ ODM_2T2R = 2, -+ ODM_2T3R = 3, -+ ODM_2T4R = 4, -+ ODM_3T3R = 5, -+ ODM_3T4R = 6, -+ ODM_4T4R = 7, -+}ODM_RF_TYPE_E; -+ -+ -+// -+// ODM Dynamic common info value definition -+// -+ -+//typedef enum _MACPHY_MODE_8192D{ -+// SINGLEMAC_SINGLEPHY, -+// DUALMAC_DUALPHY, -+// DUALMAC_SINGLEPHY, -+//}MACPHY_MODE_8192D,*PMACPHY_MODE_8192D; -+// Above is the original define in MP driver. Please use the same define. THX. -+typedef enum tag_ODM_MAC_PHY_Mode_Definition -+{ -+ ODM_SMSP = 0, -+ ODM_DMSP = 1, -+ ODM_DMDP = 2, -+}ODM_MAC_PHY_MODE_E; -+ -+ -+typedef enum tag_BT_Coexist_Definition -+{ -+ ODM_BT_BUSY = 1, -+ ODM_BT_ON = 2, -+ ODM_BT_OFF = 3, -+ ODM_BT_NONE = 4, -+}ODM_BT_COEXIST_E; -+ -+// ODM_CMNINFO_OP_MODE -+typedef enum tag_Operation_Mode_Definition -+{ -+ ODM_NO_LINK = BIT0, -+ ODM_LINK = BIT1, -+ ODM_SCAN = BIT2, -+ ODM_POWERSAVE = BIT3, -+ ODM_AP_MODE = BIT4, -+ ODM_CLIENT_MODE = BIT5, -+ ODM_AD_HOC = BIT6, -+ ODM_WIFI_DIRECT = BIT7, -+ ODM_WIFI_DISPLAY = BIT8, -+}ODM_OPERATION_MODE_E; -+ -+// ODM_CMNINFO_WM_MODE -+typedef enum tag_Wireless_Mode_Definition -+{ -+ ODM_WM_UNKNOW = 0x0, -+ ODM_WM_B = BIT0, -+ ODM_WM_G = BIT1, -+ ODM_WM_A = BIT2, -+ ODM_WM_N24G = BIT3, -+ ODM_WM_N5G = BIT4, -+ ODM_WM_AUTO = BIT5, -+ ODM_WM_AC = BIT6, -+}ODM_WIRELESS_MODE_E; -+ -+// ODM_CMNINFO_BAND -+typedef enum tag_Band_Type_Definition -+{ -+ ODM_BAND_2_4G = BIT0, -+ ODM_BAND_5G = BIT1, -+ -+}ODM_BAND_TYPE_E; -+ -+// ODM_CMNINFO_SEC_CHNL_OFFSET -+typedef enum tag_Secondary_Channel_Offset_Definition -+{ -+ ODM_DONT_CARE = 0, -+ ODM_BELOW = 1, -+ ODM_ABOVE = 2 -+}ODM_SEC_CHNL_OFFSET_E; -+ -+// ODM_CMNINFO_SEC_MODE -+typedef enum tag_Security_Definition -+{ -+ ODM_SEC_OPEN = 0, -+ ODM_SEC_WEP40 = 1, -+ ODM_SEC_TKIP = 2, -+ ODM_SEC_RESERVE = 3, -+ ODM_SEC_AESCCMP = 4, -+ ODM_SEC_WEP104 = 5, -+ ODM_WEP_WPA_MIXED = 6, // WEP + WPA -+ ODM_SEC_SMS4 = 7, -+}ODM_SECURITY_E; -+ -+// ODM_CMNINFO_BW -+typedef enum tag_Bandwidth_Definition -+{ -+ ODM_BW20M = 0, -+ ODM_BW40M = 1, -+ ODM_BW80M = 2, -+ ODM_BW160M = 3, -+ ODM_BW10M = 4, -+}ODM_BW_E; -+ -+// ODM_CMNINFO_CHNL -+ -+// ODM_CMNINFO_BOARD_TYPE -+// For non-AC-series IC , ODM_BOARD_5G_EXT_PA and ODM_BOARD_5G_EXT_LNA are ignored -+// For AC-series IC, external PA & LNA can be indivisuallly added on 2.4G and/or 5G -+typedef enum tag_Board_Definition -+{ -+ ODM_BOARD_DEFAULT = 0, // The DEFAULT case. -+ ODM_BOARD_MINICARD = BIT(0), // 0 = non-mini card, 1= mini card. -+ ODM_BOARD_SLIM = BIT(1), // 0 = non-slim card, 1 = slim card -+ ODM_BOARD_BT = BIT(2), // 0 = without BT card, 1 = with BT -+ ODM_BOARD_EXT_PA = BIT(3), // 0 = no 2G ext-PA, 1 = existing 2G ext-PA -+ ODM_BOARD_EXT_LNA = BIT(4), // 0 = no 2G ext-LNA, 1 = existing 2G ext-LNA -+ ODM_BOARD_EXT_TRSW = BIT(5), // 0 = no ext-TRSW, 1 = existing ext-TRSW -+ ODM_BOARD_EXT_PA_5G = BIT(6), // 0 = no 5G ext-PA, 1 = existing 5G ext-PA -+ ODM_BOARD_EXT_LNA_5G = BIT(7), // 0 = no 5G ext-LNA, 1 = existing 5G ext-LNA -+}ODM_BOARD_TYPE_E; -+ -+ -+// ODM_CMNINFO_ONE_PATH_CCA -+typedef enum tag_CCA_Path -+{ -+ ODM_CCA_2R = 0, -+ ODM_CCA_1R_A = 1, -+ ODM_CCA_1R_B = 2, -+}ODM_CCA_PATH_E; -+ -+ -+typedef struct _ODM_RA_Info_ -+{ -+ u1Byte RateID; -+ u4Byte RateMask; -+ u4Byte RAUseRate; -+ u1Byte RateSGI; -+ u1Byte RssiStaRA; -+ u1Byte PreRssiStaRA; -+ u1Byte SGIEnable; -+ u1Byte DecisionRate; -+ u1Byte PreRate; -+ u1Byte HighestRate; -+ u1Byte LowestRate; -+ u4Byte NscUp; -+ u4Byte NscDown; -+ u2Byte RTY[5]; -+ u4Byte TOTAL; -+ u2Byte DROP; -+ u1Byte Active; -+ u2Byte RptTime; -+ u1Byte RAWaitingCounter; -+ u1Byte RAPendingCounter; -+#if 1 //POWER_TRAINING_ACTIVE == 1 // For compile pass only~! -+ u1Byte PTActive; // on or off -+ u1Byte PTTryState; // 0 trying state, 1 for decision state -+ u1Byte PTStage; // 0~6 -+ u1Byte PTStopCount; //Stop PT counter -+ u1Byte PTPreRate; // if rate change do PT -+ u1Byte PTPreRssi; // if RSSI change 5% do PT -+ u1Byte PTModeSS; // decide whitch rate should do PT -+ u1Byte RAstage; // StageRA, decide how many times RA will be done between PT -+ u1Byte PTSmoothFactor; -+#endif -+} ODM_RA_INFO_T,*PODM_RA_INFO_T; -+ -+typedef struct _IQK_MATRIX_REGS_SETTING{ -+ bool bIQKDone; -+ s4Byte Value[3][IQK_Matrix_REG_NUM]; -+ bool bBWIqkResultSaved[3]; -+}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; -+ -+typedef struct ODM_RF_Calibration_Structure -+{ -+ //for tx power tracking -+ -+ u4Byte RegA24; // for TempCCK -+ s4Byte RegE94; -+ s4Byte RegE9C; -+ s4Byte RegEB4; -+ s4Byte RegEBC; -+ -+ u1Byte TXPowercount; -+ bool bTXPowerTrackingInit; -+ bool bTXPowerTracking; -+ u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default -+ u1Byte TM_Trigger; -+ u1Byte InternalPA5G[2]; //pathA / pathB -+ -+ u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 -+ u1Byte ThermalValue; -+ u1Byte ThermalValue_LCK; -+ u1Byte ThermalValue_IQK; -+ u1Byte ThermalValue_DPK; -+ u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; -+ u1Byte ThermalValue_AVG_index; -+ u1Byte ThermalValue_RxGain; -+ u1Byte ThermalValue_Crystal; -+ u1Byte ThermalValue_DPKstore; -+ u1Byte ThermalValue_DPKtrack; -+ bool TxPowerTrackingInProgress; -+ bool bDPKenable; -+ -+ bool bReloadtxpowerindex; -+ u1Byte bRfPiEnable; -+ u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug -+ -+ -+ //------------------------- Tx power Tracking -------------------------// -+ u1Byte bCCKinCH14; -+ u1Byte CCK_index; -+ u1Byte OFDM_index[MAX_RF_PATH]; -+ s1Byte PowerIndexOffset[MAX_RF_PATH]; -+ s1Byte DeltaPowerIndex[MAX_RF_PATH]; -+ s1Byte DeltaPowerIndexLast[MAX_RF_PATH]; -+ bool bTxPowerChanged; -+ -+ u1Byte ThermalValue_HP[HP_THERMAL_NUM]; -+ u1Byte ThermalValue_HP_index; -+ IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; -+ bool bNeedIQK; -+ u1Byte Delta_IQK; -+ u1Byte Delta_LCK; -+ s1Byte BBSwingDiff2G, BBSwingDiff5G; // Unit: dB -+ u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; -+ u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; -+ -+ //--------------------------------------------------------------------// -+ -+ //for IQK -+ u4Byte RegC04; -+ u4Byte Reg874; -+ u4Byte RegC08; -+ u4Byte RegB68; -+ u4Byte RegB6C; -+ u4Byte Reg870; -+ u4Byte Reg860; -+ u4Byte Reg864; -+ -+ bool bIQKInitialized; -+ bool bLCKInProgress; -+ bool bAntennaDetected; -+ u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; -+ u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; -+ u4Byte IQK_BB_backup_recover[9]; -+ u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; -+ -+ //for APK -+ u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a -+ u1Byte bAPKdone; -+ u1Byte bAPKThermalMeterIgnore; -+ u1Byte bDPdone; -+ u1Byte bDPPathAOK; -+ u1Byte bDPPathBOK; -+ -+ u4Byte TxIQC_8723B[2][3][2]; // { {S0: 0xc94, 0xc80, 0xc4c} , {S1: 0xc9c, 0xc88, 0xc4c}} -+ u4Byte RxIQC_8723B[2][2][2]; // { {S0: 0xc14, 0xca0} , {S1: 0xc1c, 0xc78}} -+ -+}ODM_RF_CAL_T,*PODM_RF_CAL_T; -+// -+// ODM Dynamic common info value definition -+// -+ -+typedef struct _FAST_ANTENNA_TRAINNING_ -+{ -+ u1Byte Bssid[6]; -+ u1Byte antsel_rx_keep_0; -+ u1Byte antsel_rx_keep_1; -+ u1Byte antsel_rx_keep_2; -+ u4Byte antSumRSSI[7]; -+ u4Byte antRSSIcnt[7]; -+ u4Byte antAveRSSI[7]; -+ u1Byte FAT_State; -+ u4Byte TrainIdx; -+ u1Byte antsel_a[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte antsel_b[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte antsel_c[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte MainAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte AuxAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte MainAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte AuxAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u1Byte RxIdleAnt; -+ bool bBecomeLinked; -+ -+}FAT_T,*pFAT_T; -+ -+typedef enum _FAT_STATE -+{ -+ FAT_NORMAL_STATE = 0, -+ FAT_TRAINING_STATE = 1, -+}FAT_STATE_E, *PFAT_STATE_E; -+ -+typedef enum _ANT_DIV_TYPE -+{ -+ NO_ANTDIV = 0xFF, -+ CG_TRX_HW_ANTDIV = 0x01, -+ CGCS_RX_HW_ANTDIV = 0x02, -+ FIXED_HW_ANTDIV = 0x03, -+ CG_TRX_SMART_ANTDIV = 0x04, -+ CGCS_RX_SW_ANTDIV = 0x05, -+ S0S1_HW_ANTDIV = 0x06, //8723B intrnal switch S0 S1 -+}ANT_DIV_TYPE_E, *PANT_DIV_TYPE_E; -+ -+typedef struct _ODM_PATH_DIVERSITY_ -+{ -+ u1Byte RespTxPath; -+ u1Byte PathSel[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte PathA_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte PathB_Sum[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte PathA_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+ u4Byte PathB_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; -+}PATHDIV_T, *pPATHDIV_T; -+ -+ -+typedef enum _BASEBAND_CONFIG_PHY_REG_PG_VALUE_TYPE{ -+ PHY_REG_PG_RELATIVE_VALUE = 0, -+ PHY_REG_PG_EXACT_VALUE = 1 -+} PHY_REG_PG_TYPE; -+ -+ -+// -+// Antenna detection information from single tone mechanism, added by Roger, 2012.11.27. -+// -+typedef struct _ANT_DETECTED_INFO{ -+ bool bAntDetected; -+ u4Byte dBForAntA; -+ u4Byte dBForAntB; -+ u4Byte dBForAntO; -+}ANT_DETECTED_INFO, *PANT_DETECTED_INFO; -+ -+// -+// 2011/09/22 MH Copy from SD4 defined structure. We use to support PHY DM integration. -+// -+typedef struct DM_Out_Source_Dynamic_Mechanism_Structure -+{ -+ //RT_TIMER FastAntTrainingTimer; -+ // -+ // Add for different team use temporarily -+ // -+ PADAPTER Adapter; // For CE/NIC team -+ prtl8192cd_priv priv; // For AP/ADSL team -+ // WHen you use Adapter or priv pointer, you must make sure the pointer is ready. -+ bool odm_ready; -+ -+ rtl8192cd_priv fake_priv; -+ PHY_REG_PG_TYPE PhyRegPgValueType; -+ -+ u8Byte DebugComponents; -+ u4Byte DebugLevel; -+ -+ u8Byte NumQryPhyStatusAll; //CCK + OFDM -+ u8Byte LastNumQryPhyStatusAll; -+ u8Byte RxPWDBAve; -+ u8Byte RxPWDBAve_final; -+ bool MPDIG_2G; //off MPDIG -+ u1Byte Times_2G; -+ -+//------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------// -+ bool bCckHighPower; -+ u1Byte RFPathRxEnable; // ODM_CMNINFO_RFPATH_ENABLE -+ u1Byte ControlChannel; -+//------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------// -+ -+//--------REMOVED COMMON INFO----------// -+ //u1Byte PseudoMacPhyMode; -+ //bool *BTCoexist; -+ //bool PseudoBtCoexist; -+ //u1Byte OPMode; -+ //bool bAPMode; -+ //bool bClientMode; -+ //bool bAdHocMode; -+ //bool bSlaveOfDMSP; -+//--------REMOVED COMMON INFO----------// -+ -+ -+//1 COMMON INFORMATION -+ -+ // -+ // Init Value -+ // -+//-----------HOOK BEFORE REG INIT-----------// -+ // ODM Platform info AP/ADSL/CE/MP = 1/2/3/4 -+ u1Byte SupportPlatform; -+ // ODM Support Ability DIG/RATR/TX_PWR_TRACK/ ¡K¡K = 1/2/3/¡K -+ u4Byte SupportAbility; -+ // ODM PCIE/USB/SDIO = 1/2/3 -+ u1Byte SupportInterface; -+ // ODM composite or independent. Bit oriented/ 92C+92D+ .... or any other type = 1/2/3/... -+ u4Byte SupportICType; -+ // Cut Version TestChip/A-cut/B-cut... = 0/1/2/3/... -+ u1Byte CutVersion; -+ // Fab Version TSMC/UMC = 0/1 -+ u1Byte FabVersion; -+ // RF Type 4T4R/3T3R/2T2R/1T2R/1T1R/... -+ u1Byte RFType; -+ u1Byte RFEType; -+ // Board Type Normal/HighPower/MiniCard/SLIM/Combo/... = 0/1/2/3/4/... -+ u1Byte BoardType; -+ // with external LNA NO/Yes = 0/1 -+ u1Byte ExtLNA; -+ u1Byte ExtLNA5G; -+ // with external PA NO/Yes = 0/1 -+ u1Byte ExtPA; -+ u1Byte ExtPA5G; -+ // with external TRSW NO/Yes = 0/1 -+ u1Byte ExtTRSW; -+ u1Byte PatchID; //Customer ID -+ bool bInHctTest; -+ bool bWIFITest; -+ -+ bool bDualMacSmartConcurrent; -+ u4Byte BK_SupportAbility; -+ u1Byte AntDivType; -+//-----------HOOK BEFORE REG INIT-----------// -+ -+ // -+ // Dynamic Value -+ // -+//--------- POINTER REFERENCE-----------// -+ -+ u1Byte u1Byte_temp; -+ bool bool_temp; -+ PADAPTER PADAPTER_temp; -+ -+ // MAC PHY Mode SMSP/DMSP/DMDP = 0/1/2 -+ u1Byte *pMacPhyMode; -+ //TX Unicast byte count -+ u8Byte *pNumTxBytesUnicast; -+ //RX Unicast byte count -+ u8Byte *pNumRxBytesUnicast; -+ // Wireless mode B/G/A/N = BIT0/BIT1/BIT2/BIT3 -+ u1Byte *pWirelessMode; //ODM_WIRELESS_MODE_E -+ // Frequence band 2.4G/5G = 0/1 -+ u1Byte *pBandType; -+ // Secondary channel offset don't_care/below/above = 0/1/2 -+ u1Byte *pSecChOffset; -+ // Security mode Open/WEP/AES/TKIP = 0/1/2/3 -+ u1Byte *pSecurity; -+ // BW info 20M/40M/80M = 0/1/2 -+ u1Byte *pBandWidth; -+ // Central channel location Ch1/Ch2/.... -+ u1Byte *pChannel; //central channel number -+ // Common info for 92D DMSP -+ -+ bool *pbGetValueFromOtherMac; -+ PADAPTER *pBuddyAdapter; -+ bool *pbMasterOfDMSP; //MAC0: master, MAC1: slave -+ // Common info for Status -+ bool *pbScanInProcess; -+ bool *pbPowerSaving; -+ // CCA Path 2-path/path-A/path-B = 0/1/2; using ODM_CCA_PATH_E. -+ u1Byte *pOnePathCCA; -+ //pMgntInfo->AntennaTest -+ u1Byte *pAntennaTest; -+ bool *pbNet_closed; -+ u1Byte *mp_mode; -+ //u1Byte *pAidMap; -+//--------- POINTER REFERENCE-----------// -+ pu2Byte pForcedDataRate; -+//------------CALL BY VALUE-------------// -+ bool bLinkInProcess; -+ bool bWIFI_Direct; -+ bool bWIFI_Display; -+ bool bLinked; -+ u1Byte RSSI_Min; -+ u1Byte InterfaceIndex; // Add for 92D dual MAC: 0--Mac0 1--Mac1 -+ bool bIsMPChip; -+ bool bOneEntryOnly; -+ // Common info for BTDM -+ bool bBtDisabled; // BT is disabled -+ bool bBtConnectProcess; // BT HS is under connection progress. -+ u1Byte btHsRssi; // BT HS mode wifi rssi value. -+ bool bBtHsOperation; // BT HS mode is under progress -+ bool bBtDisableEdcaTurbo; // Under some condition, don't enable the EDCA Turbo -+ bool bBtLimitedDig; // BT is busy. -+//------------CALL BY VALUE-------------// -+ u1Byte RSSI_A; -+ u1Byte RSSI_B; -+ u8Byte RSSI_TRSW; -+ u8Byte RSSI_TRSW_H; -+ u8Byte RSSI_TRSW_L; -+ u8Byte RSSI_TRSW_iso; -+ -+ u1Byte RxRate; -+ bool StopDIG; -+ u1Byte TxRate; -+ u1Byte LinkedInterval; -+ u1Byte preChannel; -+ u1Byte AntType; -+ u4Byte TxagcOffsetValueA; -+ bool IsTxagcOffsetPositiveA; -+ u4Byte TxagcOffsetValueB; -+ bool IsTxagcOffsetPositiveB; -+ u8Byte lastTxOkCnt; -+ u8Byte lastRxOkCnt; -+ u4Byte BbSwingOffsetA; -+ bool IsBbSwingOffsetPositiveA; -+ u4Byte BbSwingOffsetB; -+ bool IsBbSwingOffsetPositiveB; -+ u4Byte TH_H; -+ u4Byte TH_L; -+ u4Byte IGI_Base; -+ u4Byte IGI_target; -+ bool ForceEDCCA; -+ u1Byte AdapEn_RSSI; -+ bool bForceThresh; -+ u4Byte Force_TH_H; -+ u4Byte Force_TH_L; -+ -+ //2 Define STA info. -+ // _ODM_STA_INFO -+ // 2012/01/12 MH For MP, we need to reduce one array pointer for default port.?? -+ PSTA_INFO_T pODM_StaInfo[ODM_ASSOCIATE_ENTRY_NUM]; -+ -+#if (RATE_ADAPTIVE_SUPPORT == 1) -+ u2Byte CurrminRptTime; -+ ODM_RA_INFO_T RAInfo[ODM_ASSOCIATE_ENTRY_NUM]; //See HalMacID support -+#endif -+ // -+ // 2012/02/14 MH Add to share 88E ra with other SW team. -+ // We need to colelct all support abilit to a proper area. -+ // -+ bool RaSupport88E; -+ -+ // Define ........... -+ -+ // Latest packet phy info (ODM write) -+ ODM_PHY_DBG_INFO_T PhyDbgInfo; -+ //PHY_INFO_88E PhyInfo; -+ -+ // Latest packet phy info (ODM write) -+ ODM_MAC_INFO *pMacInfo; -+ //MAC_INFO_88E MacInfo; -+ -+ // Different Team independt structure?? -+ -+ // -+ //TX_RTP_CMN TX_retrpo; -+ //TX_RTP_88E TX_retrpo; -+ //TX_RTP_8195 TX_retrpo; -+ -+ // -+ //ODM Structure -+ // -+ FAT_T DM_FatTable; -+ DIG_T DM_DigTable; -+ PS_T DM_PSTable; -+ Pri_CCA_T DM_PriCCA; -+ RXHP_T DM_RXHP_Table; -+ FALSE_ALARM_STATISTICS FalseAlmCnt; -+ FALSE_ALARM_STATISTICS FlaseAlmCntBuddyAdapter; -+ SWAT_T DM_SWAT_Table; -+ bool RSSI_test; -+ -+ EDCA_T DM_EDCA_Table; -+ u4Byte WMMEDCA_BE; -+ PATHDIV_T DM_PathDiv; -+ // Copy from SD4 structure -+ // -+ // ================================================== -+ // -+ -+ //common -+ //u1Byte DM_Type; -+ //u1Byte PSD_Report_RXHP[80]; // Add By Gary -+ //u1Byte PSD_func_flag; // Add By Gary -+ //for DIG -+ //u1Byte bDMInitialGainEnable; -+ //u1Byte binitialized; // for dm_initial_gain_Multi_STA use. -+ //for Antenna diversity -+ //u8 AntDivCfg;// 0:OFF , 1:ON, 2:by efuse -+ //PSTA_INFO_T RSSI_target; -+ -+ bool *pbDriverStopped; -+ bool *pbDriverIsGoingToPnpSetPowerSleep; -+ bool *pinit_adpt_in_progress; -+ -+ //PSD -+ bool bUserAssignLevel; -+ RT_TIMER PSDTimer; -+ u1Byte RSSI_BT; //come from BT -+ bool bPSDinProcess; -+ bool bPSDactive; -+ bool bDMInitialGainEnable; -+ -+ //MPT DIG -+ RT_TIMER MPT_DIGTimer; -+ -+ //for rate adaptive, in fact, 88c/92c fw will handle this -+ u1Byte bUseRAMask; -+ -+ ODM_RATE_ADAPTIVE RateAdaptive; -+ -+ ANT_DETECTED_INFO AntDetectedInfo; // Antenna detected information for RSSI tool -+ -+ ODM_RF_CAL_T RFCalibrateInfo; -+ -+ // -+ // TX power tracking -+ // -+ u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; -+ u1Byte BbSwingIdxOfdmCurrent; -+ u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; -+ bool BbSwingFlagOfdm; -+ u1Byte BbSwingIdxCck; -+ u1Byte BbSwingIdxCckCurrent; -+ u1Byte BbSwingIdxCckBase; -+ u1Byte DefaultOfdmIndex; -+ u1Byte DefaultCckIndex; -+ bool BbSwingFlagCck; -+ -+ s1Byte Aboslute_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; -+ s1Byte Remnant_CCKSwingIdx; -+ s1Byte Modify_TxAGC_Value; //Remnat compensate value at TxAGC -+ bool Modify_TxAGC_Flag_PathA; -+ bool Modify_TxAGC_Flag_PathB; -+ -+ // -+ // Dynamic ATC switch -+ // -+ bool bATCStatus; -+ bool largeCFOHit; -+ bool bIsfreeze; -+ int CFO_tail[2]; -+ int CFO_ave_pre; -+ int CrystalCap; -+ u1Byte CFOThreshold; -+ u4Byte packetCount; -+ u4Byte packetCount_pre; -+ -+ // -+ // ODM system resource. -+ // -+ -+ // ODM relative time. -+ RT_TIMER PathDivSwitchTimer; -+ //2011.09.27 add for Path Diversity -+ RT_TIMER CCKPathDiversityTimer; -+ RT_TIMER FastAntTrainingTimer; -+} DM_ODM_T, *PDM_ODM_T; // DM_Dynamic_Mechanism_Structure -+ -+#define ODM_RF_PATH_MAX 2 -+ -+typedef enum _ODM_RF_RADIO_PATH { -+ ODM_RF_PATH_A = 0, //Radio Path A -+ ODM_RF_PATH_B = 1, //Radio Path B -+ ODM_RF_PATH_C = 2, //Radio Path C -+ ODM_RF_PATH_D = 3, //Radio Path D -+ // ODM_RF_PATH_MAX, //Max RF number 90 support -+} ODM_RF_RADIO_PATH_E, *PODM_RF_RADIO_PATH_E; -+ -+ typedef enum _ODM_RF_CONTENT{ -+ odm_radioa_txt = 0x1000, -+ odm_radiob_txt = 0x1001, -+ odm_radioc_txt = 0x1002, -+ odm_radiod_txt = 0x1003 -+} ODM_RF_CONTENT; -+ -+typedef enum _ODM_BB_Config_Type{ -+ CONFIG_BB_PHY_REG, -+ CONFIG_BB_AGC_TAB, -+ CONFIG_BB_AGC_TAB_2G, -+ CONFIG_BB_AGC_TAB_5G, -+ CONFIG_BB_PHY_REG_PG, -+ CONFIG_BB_PHY_REG_MP, -+} ODM_BB_Config_Type, *PODM_BB_Config_Type; -+ -+typedef enum _ODM_RF_Config_Type{ -+ CONFIG_RF_RADIO, -+ CONFIG_RF_TXPWR_LMT, -+} ODM_RF_Config_Type, *PODM_RF_Config_Type; -+ -+typedef enum _ODM_FW_Config_Type{ -+ CONFIG_FW_NIC, -+ CONFIG_FW_NIC_2, -+ CONFIG_FW_AP, -+ CONFIG_FW_MP, -+ CONFIG_FW_WoWLAN, -+ CONFIG_FW_WoWLAN_2, -+ CONFIG_FW_BT, -+} ODM_FW_Config_Type; -+ -+// Status code -+typedef enum _RT_STATUS{ -+ RT_STATUS_SUCCESS, -+ RT_STATUS_FAILURE, -+ RT_STATUS_PENDING, -+ RT_STATUS_RESOURCE, -+ RT_STATUS_INVALID_CONTEXT, -+ RT_STATUS_INVALID_PARAMETER, -+ RT_STATUS_NOT_SUPPORT, -+ RT_STATUS_OS_API_FAILED, -+}RT_STATUS,*PRT_STATUS; -+ -+#ifdef REMOVE_PACK -+#pragma pack() -+#endif -+ -+//#include "odm_function.h" -+ -+//3=========================================================== -+//3 DIG -+//3=========================================================== -+ -+typedef enum tag_Dynamic_Init_Gain_Operation_Type_Definition -+{ -+ DIG_TYPE_THRESH_HIGH = 0, -+ DIG_TYPE_THRESH_LOW = 1, -+ DIG_TYPE_BACKOFF = 2, -+ DIG_TYPE_RX_GAIN_MIN = 3, -+ DIG_TYPE_RX_GAIN_MAX = 4, -+ DIG_TYPE_ENABLE = 5, -+ DIG_TYPE_DISABLE = 6, -+ DIG_OP_TYPE_MAX -+}DM_DIG_OP_E; -+/* -+typedef enum tag_CCK_Packet_Detection_Threshold_Type_Definition -+{ -+ CCK_PD_STAGE_LowRssi = 0, -+ CCK_PD_STAGE_HighRssi = 1, -+ CCK_PD_STAGE_MAX = 3, -+}DM_CCK_PDTH_E; -+ -+typedef enum tag_DIG_EXT_PORT_ALGO_Definition -+{ -+ DIG_EXT_PORT_STAGE_0 = 0, -+ DIG_EXT_PORT_STAGE_1 = 1, -+ DIG_EXT_PORT_STAGE_2 = 2, -+ DIG_EXT_PORT_STAGE_3 = 3, -+ DIG_EXT_PORT_STAGE_MAX = 4, -+}DM_DIG_EXT_PORT_ALG_E; -+ -+typedef enum tag_DIG_Connect_Definition -+{ -+ DIG_STA_DISCONNECT = 0, -+ DIG_STA_CONNECT = 1, -+ DIG_STA_BEFORE_CONNECT = 2, -+ DIG_MultiSTA_DISCONNECT = 3, -+ DIG_MultiSTA_CONNECT = 4, -+ DIG_CONNECT_MAX -+}DM_DIG_CONNECT_E; -+ -+ -+#define DM_MultiSTA_InitGainChangeNotify(Event) {DM_DigTable.CurMultiSTAConnectState = Event;} -+ -+#define DM_MultiSTA_InitGainChangeNotify_CONNECT(_ADAPTER) \ -+ DM_MultiSTA_InitGainChangeNotify(DIG_MultiSTA_CONNECT) -+ -+#define DM_MultiSTA_InitGainChangeNotify_DISCONNECT(_ADAPTER) \ -+ DM_MultiSTA_InitGainChangeNotify(DIG_MultiSTA_DISCONNECT) -+*/ -+#define DM_DIG_THRESH_HIGH 40 -+#define DM_DIG_THRESH_LOW 35 -+ -+#define DMfalseALARM_THRESH_LOW 400 -+#define DMfalseALARM_THRESH_HIGH 1000 -+ -+#define DM_DIG_MAX_NIC 0x3e -+#define DM_DIG_MIN_NIC 0x1e //0x22//0x1c -+ -+#define DM_DIG_MAX_AP 0x32 -+#define DM_DIG_MIN_AP 0x20 -+ -+#define DM_DIG_MAX_NIC_HP 0x46 -+#define DM_DIG_MIN_NIC_HP 0x2e -+ -+#define DM_DIG_MAX_AP_HP 0x42 -+#define DM_DIG_MIN_AP_HP 0x30 -+ -+//vivi 92c&92d has different definition, 20110504 -+//this is for 92c -+#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+#define DM_DIG_FA_TH0 0x80//0x20 -+#else -+#define DM_DIG_FA_TH0 0x200//0x20 -+#endif -+#define DM_DIG_FA_TH1 0x300//0x100 -+#define DM_DIG_FA_TH2 0x400//0x200 -+//this is for 92d -+#define DM_DIG_FA_TH0_92D 0x100 -+#define DM_DIG_FA_TH1_92D 0x400 -+#define DM_DIG_FA_TH2_92D 0x600 -+ -+#define DM_DIG_BACKOFF_MAX 12 -+#define DM_DIG_BACKOFF_MIN -4 -+#define DM_DIG_BACKOFF_DEFAULT 10 -+ -+//3=========================================================== -+//3 AGC RX High Power Mode -+//3=========================================================== -+#define LNA_Low_Gain_1 0x64 -+#define LNA_Low_Gain_2 0x5A -+#define LNA_Low_Gain_3 0x58 -+ -+#define FA_RXHP_TH1 5000 -+#define FA_RXHP_TH2 1500 -+#define FA_RXHP_TH3 800 -+#define FA_RXHP_TH4 600 -+#define FA_RXHP_TH5 500 -+ -+//3=========================================================== -+//3 EDCA -+//3=========================================================== -+ -+//3=========================================================== -+//3 Dynamic Tx Power -+//3=========================================================== -+//Dynamic Tx Power Control Threshold -+#define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 -+#define TX_POWER_NEAR_FIELD_THRESH_LVL1 67 -+#define TX_POWER_NEAR_FIELD_THRESH_AP 0x3F -+ -+#define TxHighPwrLevel_Normal 0 -+#define TxHighPwrLevel_Level1 1 -+#define TxHighPwrLevel_Level2 2 -+#define TxHighPwrLevel_BT1 3 -+#define TxHighPwrLevel_BT2 4 -+#define TxHighPwrLevel_15 5 -+#define TxHighPwrLevel_35 6 -+#define TxHighPwrLevel_50 7 -+#define TxHighPwrLevel_70 8 -+#define TxHighPwrLevel_100 9 -+ -+//3=========================================================== -+//3 Tx Power Tracking -+//3=========================================================== -+#if 0 //mask this, since these have been defined in typdef.h, vivi -+#define OFDM_TABLE_SIZE 37 -+#define OFDM_TABLE_SIZE_92D 43 -+#define CCK_TABLE_SIZE 33 -+#endif -+ -+ -+//3=========================================================== -+//3 Rate Adaptive -+//3=========================================================== -+#define DM_RATR_STA_INIT 0 -+#define DM_RATR_STA_HIGH 1 -+#define DM_RATR_STA_MIDDLE 2 -+#define DM_RATR_STA_LOW 3 -+ -+//3=========================================================== -+//3 BB Power Save -+//3=========================================================== -+ -+ -+//3=========================================================== -+//3 Dynamic ATC switch -+//3=========================================================== -+#define ATC_Status_Off 0x0 // enable -+#define ATC_Status_On 0x1 // disable -+#define CFO_Threshold_Xtal 10 // kHz -+#define CFO_Threshold_ATC 80 // kHz -+ -+typedef enum tag_1R_CCA_Type_Definition -+{ -+ CCA_1R =0, -+ CCA_2R = 1, -+ CCA_MAX = 2, -+}DM_1R_CCA_E; -+ -+typedef enum tag_RF_Type_Definition -+{ -+ RF_Save =0, -+ RF_Normal = 1, -+ RF_MAX = 2, -+}DM_RF_E; -+ -+//3=========================================================== -+//3 Antenna Diversity -+//3=========================================================== -+typedef enum tag_SW_Antenna_Switch_Definition -+{ -+ Antenna_A = 1, -+ Antenna_B = 2, -+ Antenna_MAX = 3, -+}DM_SWAS_E; -+ -+ -+// Maximal number of antenna detection mechanism needs to perform, added by Roger, 2011.12.28. -+#define MAX_ANTENNA_DETECTION_CNT 10 -+ -+// -+// Extern Global Variables. -+// -+extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D]; -+extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; -+ -+extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE_92D]; -+extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; -+extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; -+ -+extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; -+ -+// <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. -+static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; -+static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; -+ -+// -+// check Sta pointer valid or not -+// -+#define IS_STA_VALID(pSta) (pSta) -+// 20100514 Joseph: Add definition for antenna switching test after link. -+// This indicates two different the steps. -+// In SWAW_STEP_PEAK, driver needs to switch antenna and listen to the signal on the air. -+// In SWAW_STEP_DETERMINE, driver just compares the signal captured in SWAW_STEP_PEAK -+// with original RSSI to determine if it is necessary to switch antenna. -+#define SWAW_STEP_PEAK 0 -+#define SWAW_STEP_DETERMINE 1 -+ -+void ODM_Write_DIG(PDM_ODM_T pDM_Odm, u1Byte CurrentIGI); -+void ODM_Write_CCK_CCA_Thres(PDM_ODM_T pDM_Odm, u1Byte CurCCK_CCAThres); -+ -+void -+ODM_SetAntenna( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Antenna); -+ -+ -+#define dm_RF_Saving ODM_RF_Saving -+void ODM_RF_Saving(PDM_ODM_T pDM_Odm, -+ u1Byte bForceInNormal ); -+ -+#define SwAntDivRestAfterLink ODM_SwAntDivRestAfterLink -+void ODM_SwAntDivRestAfterLink(PDM_ODM_T pDM_Odm); -+ -+#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck -+void -+ODM_TXPowerTrackingCheck( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+bool -+ODM_RAStateCheck( -+ PDM_ODM_T pDM_Odm, -+ s4Byte RSSI, -+ bool bForceUpdate, -+ pu1Byte pRATRState -+ ); -+ -+#define dm_SWAW_RSSI_Check ODM_SwAntDivChkPerPktRssi -+void ODM_SwAntDivChkPerPktRssi( -+ PDM_ODM_T pDM_Odm, -+ u1Byte StationID, -+ PODM_PHY_INFO_T pPhyInfo -+ ); -+ -+u4Byte ConvertTo_dB(u4Byte Value); -+ -+u4Byte -+GetPSDData( -+ PDM_ODM_T pDM_Odm, -+ unsigned int point, -+ u1Byte initial_gain_psd); -+ -+void -+odm_DIGbyRSSI_LPS( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+u4Byte ODM_Get_Rate_Bitmap( -+ PDM_ODM_T pDM_Odm, -+ u4Byte macid, -+ u4Byte ra_mask, -+ u1Byte rssi_level); -+ -+#if (BEAMFORMING_SUPPORT == 1) -+BEAMFORMING_CAP -+Beamforming_GetEntryBeamCapByMacId( -+ PMGNT_INFO pMgntInfo, -+ u1Byte MacId -+ ); -+#endif -+ -+void ODM_DMInit(PDM_ODM_T pDM_Odm); -+ -+void -+ODM_DMWatchdog( -+ PDM_ODM_T pDM_Odm // For common use in the future -+ ); -+ -+void -+ODM_CmnInfoInit( -+ PDM_ODM_T pDM_Odm, -+ ODM_CMNINFO_E CmnInfo, -+ u4Byte Value -+ ); -+ -+void -+ODM_CmnInfoHook( -+ PDM_ODM_T pDM_Odm, -+ ODM_CMNINFO_E CmnInfo, -+ void * pValue -+ ); -+ -+void -+ODM_CmnInfoPtrArrayHook( -+ PDM_ODM_T pDM_Odm, -+ ODM_CMNINFO_E CmnInfo, -+ u2Byte Index, -+ void * pValue -+ ); -+ -+void -+ODM_CmnInfoUpdate( -+ PDM_ODM_T pDM_Odm, -+ u4Byte CmnInfo, -+ u8Byte Value -+ ); -+ -+void -+ODM_InitAllTimers( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+ODM_CancelAllTimers( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+ODM_ReleaseAllTimers( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+ODM_ResetIQKResult( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+ODM_AntselStatistics_88C( -+ PDM_ODM_T pDM_Odm, -+ u1Byte MacId, -+ u4Byte PWDBAll, -+ bool isCCKrate -+); -+ -+void -+ODM_SingleDualAntennaDefaultSetting( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+bool -+ODM_SingleDualAntennaDetection( -+ PDM_ODM_T pDM_Odm, -+ u1Byte mode -+ ); -+ -+void -+ODM_UpdateInitRate( -+ PDM_ODM_T pDM_Odm, -+ u1Byte Rate -+ ); -+void odm_dtc(PDM_ODM_T pDM_Odm); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_HWConfig.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_HWConfig.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_HWConfig.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_HWConfig.c 2018-02-06 17:42:30.712967194 +0200 -@@ -0,0 +1,1454 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+ -+#include "odm_precomp.h" -+ -+#define READ_AND_CONFIG_MP(ic, txt) (ODM_ReadAndConfig_MP_##ic##txt(pDM_Odm)) -+#define READ_AND_CONFIG_TC(ic, txt) (ODM_ReadAndConfig_TC_##ic##txt(pDM_Odm)) -+ -+ -+#if (TEST_CHIP_SUPPORT == 1) -+#define READ_AND_CONFIG(ic, txt) do {\ -+ if (pDM_Odm->bIsMPChip)\ -+ READ_AND_CONFIG_MP(ic,txt);\ -+ else\ -+ READ_AND_CONFIG_TC(ic,txt);\ -+ } while(0) -+#else -+ #define READ_AND_CONFIG READ_AND_CONFIG_MP -+#endif -+ -+ -+#define READ_FIRMWARE_MP(ic, txt) (ODM_ReadFirmware_MP_##ic##txt(pDM_Odm, pFirmware, pSize)) -+#define READ_FIRMWARE_TC(ic, txt) (ODM_ReadFirmware_TC_##ic##txt(pDM_Odm, pFirmware, pSize)) -+ -+#if (TEST_CHIP_SUPPORT == 1) -+#define READ_FIRMWARE(ic, txt) do {\ -+ if (pDM_Odm->bIsMPChip)\ -+ READ_FIRMWARE_MP(ic,txt);\ -+ else\ -+ READ_FIRMWARE_TC(ic,txt);\ -+ } while(0) -+#else -+#define READ_FIRMWARE READ_FIRMWARE_MP -+#endif -+ -+u1Byte -+odm_QueryRxPwrPercentage( -+ s1Byte AntPower -+ ) -+{ -+ if ((AntPower <= -100) || (AntPower >= 20)) -+ { -+ return 0; -+ } -+ else if (AntPower >= 0) -+ { -+ return 100; -+ } -+ else -+ { -+ return (100+AntPower); -+ } -+ -+} -+ -+// -+// 2012/01/12 MH MOve some signal strength smooth method to MP HAL layer. -+// IF other SW team do not support the feature, remove this section.?? -+// -+s4Byte -+odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Lenovo( -+ PDM_ODM_T pDM_Odm, -+ s4Byte CurrSig -+) -+{ -+ s4Byte RetSig; -+ return RetSig; -+} -+ -+s4Byte -+odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Netcore( -+ PDM_ODM_T pDM_Odm, -+ s4Byte CurrSig -+) -+{ -+ s4Byte RetSig; -+ return RetSig; -+} -+ -+ -+s4Byte -+odm_SignalScaleMapping_92CSeries( -+ PDM_ODM_T pDM_Odm, -+ s4Byte CurrSig -+) -+{ -+ s4Byte RetSig; -+#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -+ if(pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ { -+ // Step 1. Scale mapping. -+ if(CurrSig >= 61 && CurrSig <= 100) -+ { -+ RetSig = 90 + ((CurrSig - 60) / 4); -+ } -+ else if(CurrSig >= 41 && CurrSig <= 60) -+ { -+ RetSig = 78 + ((CurrSig - 40) / 2); -+ } -+ else if(CurrSig >= 31 && CurrSig <= 40) -+ { -+ RetSig = 66 + (CurrSig - 30); -+ } -+ else if(CurrSig >= 21 && CurrSig <= 30) -+ { -+ RetSig = 54 + (CurrSig - 20); -+ } -+ else if(CurrSig >= 5 && CurrSig <= 20) -+ { -+ RetSig = 42 + (((CurrSig - 5) * 2) / 3); -+ } -+ else if(CurrSig == 4) -+ { -+ RetSig = 36; -+ } -+ else if(CurrSig == 3) -+ { -+ RetSig = 27; -+ } -+ else if(CurrSig == 2) -+ { -+ RetSig = 18; -+ } -+ else if(CurrSig == 1) -+ { -+ RetSig = 9; -+ } -+ else -+ { -+ RetSig = CurrSig; -+ } -+ } -+#endif -+ -+#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) ||(DEV_BUS_TYPE == RT_SDIO_INTERFACE)) -+ if((pDM_Odm->SupportInterface == ODM_ITRF_USB) || (pDM_Odm->SupportInterface == ODM_ITRF_SDIO)) -+ { -+ if(CurrSig >= 51 && CurrSig <= 100) -+ { -+ RetSig = 100; -+ } -+ else if(CurrSig >= 41 && CurrSig <= 50) -+ { -+ RetSig = 80 + ((CurrSig - 40)*2); -+ } -+ else if(CurrSig >= 31 && CurrSig <= 40) -+ { -+ RetSig = 66 + (CurrSig - 30); -+ } -+ else if(CurrSig >= 21 && CurrSig <= 30) -+ { -+ RetSig = 54 + (CurrSig - 20); -+ } -+ else if(CurrSig >= 10 && CurrSig <= 20) -+ { -+ RetSig = 42 + (((CurrSig - 10) * 2) / 3); -+ } -+ else if(CurrSig >= 5 && CurrSig <= 9) -+ { -+ RetSig = 22 + (((CurrSig - 5) * 3) / 2); -+ } -+ else if(CurrSig >= 1 && CurrSig <= 4) -+ { -+ RetSig = 6 + (((CurrSig - 1) * 3) / 2); -+ } -+ else -+ { -+ RetSig = CurrSig; -+ } -+ } -+ -+#endif -+ return RetSig; -+} -+s4Byte -+odm_SignalScaleMapping( -+ PDM_ODM_T pDM_Odm, -+ s4Byte CurrSig -+) -+{ -+ if( (pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->SupportInterface != ODM_ITRF_PCIE) && //USB & SDIO -+ (pDM_Odm->PatchID==10))//pMgntInfo->CustomerID == RT_CID_819x_Netcore -+ { -+ return odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Netcore(pDM_Odm,CurrSig); -+ } -+ else if( (pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) && -+ (pDM_Odm->PatchID==19))//pMgntInfo->CustomerID == RT_CID_819x_Lenovo) -+ { -+ return odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Lenovo(pDM_Odm, CurrSig); -+ } -+ else{ -+ return odm_SignalScaleMapping_92CSeries(pDM_Odm,CurrSig); -+ } -+ -+} -+ -+static u1Byte odm_SQ_process_patch_RT_CID_819x_Lenovo( -+ PDM_ODM_T pDM_Odm, -+ u1Byte isCCKrate, -+ u1Byte PWDB_ALL, -+ u1Byte path, -+ u1Byte RSSI -+) -+{ -+ u1Byte SQ; -+ return SQ; -+} -+ -+static u1Byte -+odm_EVMdbToPercentage( -+ s1Byte Value -+ ) -+{ -+ // -+ // -33dB~0dB to 0%~99% -+ // -+ s1Byte ret_val; -+ -+ ret_val = Value; -+ //ret_val /= 2; -+ -+ //ODM_RT_DISP(FRX, RX_PHY_SQ, ("EVMdbToPercentage92C Value=%d / %x \n", ret_val, ret_val)); -+ -+ if(ret_val >= 0) -+ ret_val = 0; -+ if(ret_val <= -33) -+ ret_val = -33; -+ -+ ret_val = 0 - ret_val; -+ ret_val*=3; -+ -+ if(ret_val == 99) -+ ret_val = 100; -+ -+ return(ret_val); -+} -+ -+static u1Byte -+odm_EVMdbm_JaguarSeries( -+ s1Byte Value -+ ) -+{ -+ s1Byte ret_val = Value; -+ -+ // -33dB~0dB to 33dB ~ 0dB -+ if(ret_val == -128) -+ ret_val = 127; -+ else if (ret_val < 0) -+ ret_val = 0 - ret_val; -+ -+ ret_val = ret_val >> 1; -+ return ret_val; -+} -+ -+static u2Byte -+odm_Cfo( -+ s1Byte Value -+) -+{ -+ s2Byte ret_val; -+ -+ if (Value < 0) -+ { -+ ret_val = 0 - Value; -+ ret_val = (ret_val << 1) + (ret_val >> 1) ; // *2.5~=312.5/2^7 -+ ret_val = ret_val | BIT12; // set bit12 as 1 for negative cfo -+ } -+ else -+ { -+ ret_val = Value; -+ ret_val = (ret_val << 1) + (ret_val>>1) ; // *2.5~=312.5/2^7 -+ } -+ return ret_val; -+} -+ -+ -+void -+odm_RxPhyStatus92CSeries_Parsing( -+ PDM_ODM_T pDM_Odm, -+ PODM_PHY_INFO_T pPhyInfo, -+ pu1Byte pPhyStatus, -+ PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ u1Byte i, Max_spatial_stream; -+ s1Byte rx_pwr[4], rx_pwr_all=0; -+ u1Byte EVM, PWDB_ALL = 0, PWDB_ALL_BT; -+ u1Byte RSSI, total_rssi=0; -+ bool isCCKrate=false; -+ u1Byte rf_rx_num = 0; -+ u1Byte cck_highpwr = 0; -+ u1Byte LNA_idx, VGA_idx; -+ PPHY_STATUS_RPT_8192CD_T pPhyStaRpt = (PPHY_STATUS_RPT_8192CD_T)pPhyStatus; -+ -+ isCCKrate = (pPktinfo->DataRate <= DESC92C_RATE11M)?true :false; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; -+ -+ -+ if(isCCKrate) -+ { -+ u1Byte report; -+ u1Byte cck_agc_rpt; -+ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; -+ // -+ // (1)Hardware does not provide RSSI for CCK -+ // (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) -+ // -+ -+ //if(pHalData->eRFPowerState == eRfOn) -+ cck_highpwr = pDM_Odm->bCckHighPower; -+ //else -+ // cck_highpwr = false; -+ -+ cck_agc_rpt = pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a ; -+ -+ //2011.11.28 LukeLee: 88E use different LNA & VGA gain table -+ //The RSSI formula should be modified according to the gain table -+ //In 88E, cck_highpwr is always set to 1 -+ if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B)) -+ { -+ LNA_idx = ((cck_agc_rpt & 0xE0) >>5); -+ VGA_idx = (cck_agc_rpt & 0x1F); -+ if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8192E)) -+ { -+ switch(LNA_idx) -+ { -+ case 7: -+ if(VGA_idx <= 27) -+ rx_pwr_all = -100 + 2*(27-VGA_idx); //VGA_idx = 27~2 -+ else -+ rx_pwr_all = -100; -+ break; -+ case 6: -+ rx_pwr_all = -48 + 2*(2-VGA_idx); //VGA_idx = 2~0 -+ break; -+ case 5: -+ rx_pwr_all = -42 + 2*(7-VGA_idx); //VGA_idx = 7~5 -+ break; -+ case 4: -+ rx_pwr_all = -36 + 2*(7-VGA_idx); //VGA_idx = 7~4 -+ break; -+ case 3: -+ //rx_pwr_all = -28 + 2*(7-VGA_idx); //VGA_idx = 7~0 -+ rx_pwr_all = -24 + 2*(7-VGA_idx); //VGA_idx = 7~0 -+ break; -+ case 2: -+ if(cck_highpwr) -+ rx_pwr_all = -12 + 2*(5-VGA_idx); //VGA_idx = 5~0 -+ else -+ rx_pwr_all = -6+ 2*(5-VGA_idx); -+ break; -+ case 1: -+ rx_pwr_all = 8-2*VGA_idx; -+ break; -+ case 0: -+ rx_pwr_all = 14-2*VGA_idx; -+ break; -+ default: -+ //DbgPrint("CCK Exception default\n"); -+ break; -+ } -+ rx_pwr_all += 6; -+ -+ //2012.10.08 LukeLee: Modify for 92E CCK RSSI -+ if(pDM_Odm->SupportICType == ODM_RTL8192E) -+ rx_pwr_all += 10; -+ -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ if(cck_highpwr == false) -+ { -+ if(PWDB_ALL >= 80) -+ PWDB_ALL = ((PWDB_ALL-80)<<1)+((PWDB_ALL-80)>>1)+80; -+ else if((PWDB_ALL <= 78) && (PWDB_ALL >= 20)) -+ PWDB_ALL += 3; -+ if(PWDB_ALL>100) -+ PWDB_ALL = 100; -+ } -+ } -+ } -+ else -+ { -+ if(!cck_highpwr) -+ { -+ report =( cck_agc_rpt & 0xc0 )>>6; -+ switch(report) -+ { -+ // 03312009 modified by cosa -+ // Modify the RF RNA gain value to -40, -20, -2, 14 by Jenyu's suggestion -+ // Note: different RF with the different RNA gain. -+ case 0x3: -+ rx_pwr_all = -46 - (cck_agc_rpt & 0x3e); -+ break; -+ case 0x2: -+ rx_pwr_all = -26 - (cck_agc_rpt & 0x3e); -+ break; -+ case 0x1: -+ rx_pwr_all = -12 - (cck_agc_rpt & 0x3e); -+ break; -+ case 0x0: -+ rx_pwr_all = 16 - (cck_agc_rpt & 0x3e); -+ break; -+ } -+ } -+ else -+ { -+ //report = pDrvInfo->cfosho[0] & 0x60; -+ //report = pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a& 0x60; -+ -+ report = (cck_agc_rpt & 0x60)>>5; -+ switch(report) -+ { -+ case 0x3: -+ rx_pwr_all = -46 - ((cck_agc_rpt & 0x1f)<<1) ; -+ break; -+ case 0x2: -+ rx_pwr_all = -26 - ((cck_agc_rpt & 0x1f)<<1); -+ break; -+ case 0x1: -+ rx_pwr_all = -12 - ((cck_agc_rpt & 0x1f)<<1) ; -+ break; -+ case 0x0: -+ rx_pwr_all = 16 - ((cck_agc_rpt & 0x1f)<<1) ; -+ break; -+ } -+ } -+ -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ -+ //Modification for ext-LNA board -+ if(pDM_Odm->BoardType & (ODM_BOARD_EXT_LNA | ODM_BOARD_EXT_PA)) -+ { -+ if((cck_agc_rpt>>7) == 0){ -+ PWDB_ALL = (PWDB_ALL>94)?100:(PWDB_ALL +6); -+ } -+ else -+ { -+ if(PWDB_ALL > 38) -+ PWDB_ALL -= 16; -+ else -+ PWDB_ALL = (PWDB_ALL<=16)?(PWDB_ALL>>2):(PWDB_ALL -12); -+ } -+ -+ //CCK modification -+ if(PWDB_ALL > 25 && PWDB_ALL <= 60) -+ PWDB_ALL += 6; -+ //else if (PWDB_ALL <= 25) -+ // PWDB_ALL += 8; -+ } -+ else//Modification for int-LNA board -+ { -+ if(PWDB_ALL > 99) -+ PWDB_ALL -= 8; -+ else if(PWDB_ALL > 50 && PWDB_ALL <= 68) -+ PWDB_ALL += 4; -+ } -+ } -+ -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+ // -+ // (3) Get Signal Quality (EVM) -+ // -+ if(pPktinfo->bPacketMatchBSSID) -+ { -+ u1Byte SQ,SQ_rpt; -+ -+ if((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)){ -+ SQ = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,0,0); -+ } -+ else if(pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest){ -+ SQ = 100; -+ } -+ else{ -+ SQ_rpt = pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all; -+ -+ if(SQ_rpt > 64) -+ SQ = 0; -+ else if (SQ_rpt < 20) -+ SQ = 100; -+ else -+ SQ = ((64-SQ_rpt) * 100) / 44; -+ -+ } -+ -+ //DbgPrint("cck SQ = %d\n", SQ); -+ pPhyInfo->SignalQuality = SQ; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; -+ } -+ } -+ else //is OFDM rate -+ { -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; -+ -+ // -+ // (1)Get RSSI for HT rate -+ // -+ -+ for(i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) -+ { -+ // 2008/01/30 MH we will judge RF RX path now. -+ if (pDM_Odm->RFPathRxEnable & BIT(i)) -+ rf_rx_num++; -+ //else -+ //continue; -+ -+ rx_pwr[i] = ((pPhyStaRpt->path_agc[i].gain& 0x3F)*2) - 110; -+ -+ pPhyInfo->RxPwr[i] = rx_pwr[i]; -+ -+ /* Translate DBM to percentage. */ -+ RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); -+ total_rssi += RSSI; -+ //RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR=%x RSSI=%d\n", i, rx_pwr[i], RSSI)); -+ -+ //Modification for ext-LNA board -+ if(pDM_Odm->SupportICType&ODM_RTL8192C) -+ { -+ if(pDM_Odm->BoardType & (ODM_BOARD_EXT_LNA | ODM_BOARD_EXT_PA)) -+ { -+ if((pPhyStaRpt->path_agc[i].trsw) == 1) -+ RSSI = (RSSI>94)?100:(RSSI +6); -+ else -+ RSSI = (RSSI<=16)?(RSSI>>3):(RSSI -16); -+ -+ if((RSSI <= 34) && (RSSI >=4)) -+ RSSI -= 4; -+ } -+ } -+ -+ pPhyInfo->RxMIMOSignalStrength[i] =(u1Byte) RSSI; -+ -+ //Get Rx snr value in DB -+ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = (s4Byte)(pPhyStaRpt->path_rxsnr[i]/2); -+ -+ /* Record Signal Strength for next packet */ -+ if(pPktinfo->bPacketMatchBSSID) -+ { -+ if((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)) -+ { -+ if(i==ODM_RF_PATH_A) -+ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,i,RSSI); -+ -+ } -+ -+ } -+ } -+ -+ -+ // -+ // (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) -+ // -+ rx_pwr_all = (((pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all) >> 1 )& 0x7f) -110; -+ -+ PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; -+ pPhyInfo->RxPower = rx_pwr_all; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+ -+ if((pDM_Odm->SupportPlatform == ODM_WIN) &&(pDM_Odm->PatchID==19)){ -+ //do nothing -+ } -+ else{//pMgntInfo->CustomerID != RT_CID_819x_Lenovo -+ // -+ // (3)EVM of HT rate -+ // -+ if(pPktinfo->DataRate >=DESC92C_RATEMCS8 && pPktinfo->DataRate <=DESC92C_RATEMCS15) -+ Max_spatial_stream = 2; //both spatial stream make sense -+ else -+ Max_spatial_stream = 1; //only spatial stream 1 makes sense -+ -+ for(i=0; i>= 1" because the compilor of free build environment -+ // fill most significant bit to "zero" when doing shifting operation which may change a negative -+ // value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore. -+ EVM = odm_EVMdbToPercentage( (pPhyStaRpt->stream_rxevm[i] )); //dbm -+ -+ //RT_DISP(FRX, RX_PHY_SQ, ("RXRATE=%x RXEVM=%x EVM=%s%d\n", -+ //GET_RX_STATUS_DESC_RX_MCS(pDesc), pDrvInfo->rxevm[i], "%", EVM)); -+ -+ if(pPktinfo->bPacketMatchBSSID) -+ { -+ if(i==ODM_RF_PATH_A) // Fill value in RFD, Get the first spatial stream only -+ { -+ pPhyInfo->SignalQuality = (u1Byte)(EVM & 0xff); -+ } -+ pPhyInfo->RxMIMOSignalQuality[i] = (u1Byte)(EVM & 0xff); -+ } -+ } -+ } -+ -+ //2 For dynamic ATC switch -+ if(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_ATC) -+ { -+ if(pPktinfo->bPacketMatchBSSID) -+ { -+ //3 Update CFO report for path-A & path-B -+ for(i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) -+ { -+ pDM_Odm->CFO_tail[i] = (int)pPhyStaRpt->path_cfotail[i]; -+ } -+ -+ //3 Update packet counter -+ if(pDM_Odm->packetCount == 0xffffffff) -+ pDM_Odm->packetCount = 0; -+ else -+ pDM_Odm->packetCount++; -+ -+ //ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_ATC, ODM_DBG_LOUD, -+ //("pPhyStaRpt->path_cfotail[i] = 0x%x, pDM_Odm->CFO_tail[i] = 0x%x\n", pPhyStaRpt->path_cfotail[0], pDM_Odm->CFO_tail[1])); -+ } -+ } -+ -+ } -+ //UI BSS List signal strength(in percentage), make it good looking, from 0~100. -+ //It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp(). -+ if(isCCKrate) -+ { -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));//PWDB_ALL; -+ } -+ else -+ { -+ if (rf_rx_num != 0) -+ { -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, total_rssi/=rf_rx_num)); -+ } -+ } -+ -+ //For 92C/92D HW (Hybrid) Antenna Diversity -+#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ pDM_SWAT_Table->antsel = pPhyStaRpt->ant_sel; -+ //For 88E HW Antenna Diversity -+ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->ant_sel; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->ant_sel_b; -+ pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antsel_rx_keep_2; -+#endif -+} -+ -+void -+odm_RxPhyStatusJaguarSeries_Parsing( -+ PDM_ODM_T pDM_Odm, -+ PODM_PHY_INFO_T pPhyInfo, -+ pu1Byte pPhyStatus, -+ PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ u1Byte i, Max_spatial_stream; -+ s1Byte rx_pwr[4], rx_pwr_all=0; -+ u1Byte EVM, EVMdbm, PWDB_ALL = 0, PWDB_ALL_BT; -+ u1Byte RSSI, total_rssi=0; -+ u1Byte isCCKrate=0; -+ u1Byte rf_rx_num = 0; -+ u1Byte cck_highpwr = 0; -+ u1Byte LNA_idx, VGA_idx; -+ -+ PPHY_STATUS_RPT_8812_T pPhyStaRpt = (PPHY_STATUS_RPT_8812_T)pPhyStatus; -+ -+ if(pPktinfo->DataRate <= DESC_RATE54M) -+ { -+ switch(pPhyStaRpt->r_RFMOD){ -+ case 1: -+ if(pPhyStaRpt->sub_chnl == 0) -+ pPhyInfo->BandWidth = 1; -+ else -+ pPhyInfo->BandWidth = 0; -+ break; -+ -+ case 2: -+ if(pPhyStaRpt->sub_chnl == 0) -+ pPhyInfo->BandWidth = 2; -+ else if(pPhyStaRpt->sub_chnl == 9 || pPhyStaRpt->sub_chnl == 10) -+ pPhyInfo->BandWidth = 1; -+ else -+ pPhyInfo->BandWidth = 0; -+ break; -+ -+ default: case 0: -+ pPhyInfo->BandWidth = 0; -+ break; -+ } -+ } -+ -+ if(pPktinfo->DataRate <= DESC_RATE11M) -+ isCCKrate = true; -+ else -+ isCCKrate = false; -+ -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; -+ -+ -+ if(isCCKrate) -+ { -+ u1Byte cck_agc_rpt; -+ -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; -+ // -+ // (1)Hardware does not provide RSSI for CCK -+ // (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) -+ // -+ -+ //if(pHalData->eRFPowerState == eRfOn) -+ cck_highpwr = pDM_Odm->bCckHighPower; -+ //else -+ // cck_highpwr = false; -+ -+ cck_agc_rpt = pPhyStaRpt->cfosho[0] ; -+ -+ LNA_idx = ((cck_agc_rpt & 0xE0) >>5); -+ VGA_idx = (cck_agc_rpt & 0x1F); -+ if(pDM_Odm->SupportICType == ODM_RTL8812) { -+ switch(LNA_idx) { -+ case 7: -+ if(VGA_idx <= 27) -+ rx_pwr_all = -100 + 2*(27-VGA_idx); //VGA_idx = 27~2 -+ else -+ rx_pwr_all = -100; -+ break; -+ case 6: -+ rx_pwr_all = -48 + 2*(2-VGA_idx); //VGA_idx = 2~0 -+ break; -+ case 5: -+ rx_pwr_all = -42 + 2*(7-VGA_idx); //VGA_idx = 7~5 -+ break; -+ case 4: -+ rx_pwr_all = -36 + 2*(7-VGA_idx); //VGA_idx = 7~4 -+ break; -+ case 3: -+ rx_pwr_all = -24 + 2*(7-VGA_idx); //VGA_idx = 7~0 -+ break; -+ case 2: -+ if(cck_highpwr) -+ rx_pwr_all = -12 + 2*(5-VGA_idx); //VGA_idx = 5~0 -+ else -+ rx_pwr_all = -6+ 2*(5-VGA_idx); -+ break; -+ case 1: -+ rx_pwr_all = 8-2*VGA_idx; -+ break; -+ case 0: -+ rx_pwr_all = 14-2*VGA_idx; -+ break; -+ default: -+ break; -+ } -+ rx_pwr_all += 6; -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ if(cck_highpwr == false) { -+ if(PWDB_ALL >= 80) -+ PWDB_ALL = ((PWDB_ALL-80)<<1)+((PWDB_ALL-80)>>1)+80; -+ else if((PWDB_ALL <= 78) && (PWDB_ALL >= 20)) -+ PWDB_ALL += 3; -+ if(PWDB_ALL>100) -+ PWDB_ALL = 100; -+ } -+ } else if(pDM_Odm->SupportICType == ODM_RTL8821) { -+ s1Byte Pout = -6; -+ -+ switch(LNA_idx) { -+ case 5: -+ rx_pwr_all = Pout -32 -(2*VGA_idx); -+ break; -+ case 4: -+ rx_pwr_all = Pout -24 -(2*VGA_idx); -+ break; -+ case 2: -+ rx_pwr_all = Pout -11 -(2*VGA_idx); -+ break; -+ case 1: -+ rx_pwr_all = Pout + 5 -(2*VGA_idx); -+ break; -+ case 0: -+ rx_pwr_all = Pout + 21 -(2*VGA_idx); -+ break; -+ } -+ PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ } -+ -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+ // -+ // (3) Get Signal Quality (EVM) -+ // -+ if(pPktinfo->bPacketMatchBSSID) { -+ u1Byte SQ,SQ_rpt; -+ -+ if((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)){ -+ SQ = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,0,0); -+ } else if(pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest){ -+ SQ = 100; -+ } else{ -+ SQ_rpt = pPhyStaRpt->pwdb_all; -+ -+ if(SQ_rpt > 64) -+ SQ = 0; -+ else if (SQ_rpt < 20) -+ SQ = 100; -+ else -+ SQ = ((64-SQ_rpt) * 100) / 44; -+ -+ } -+ -+ pPhyInfo->SignalQuality = SQ; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; -+ pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; -+ } -+ } else { //is OFDM rate -+ pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; -+ -+ // -+ // (1)Get RSSI for OFDM rate -+ // -+ -+ for(i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) { -+ // 2008/01/30 MH we will judge RF RX path now. -+ if (pDM_Odm->RFPathRxEnable & BIT(i)) { -+ rf_rx_num++; -+ } -+ rx_pwr[i] = (pPhyStaRpt->gain_trsw[i]&0x7F) - 110; -+ -+ pPhyInfo->RxPwr[i] = rx_pwr[i]; -+ -+ /* Translate DBM to percentage. */ -+ RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); -+ -+ total_rssi += RSSI; -+ -+ pPhyInfo->RxMIMOSignalStrength[i] =(u1Byte) RSSI; -+ -+ //Get Rx snr value in DB -+ pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = pPhyStaRpt->rxsnr[i]/2; -+ -+ // -+ // (2) CFO_short & CFO_tail -+ // -+ pPhyInfo->Cfo_short[i] = odm_Cfo( (pPhyStaRpt->cfosho[i]) ); -+ pPhyInfo->Cfo_tail[i] = odm_Cfo( (pPhyStaRpt->cfotail[i]) ); -+ -+ /* Record Signal Strength for next packet */ -+ if(pPktinfo->bPacketMatchBSSID) { -+ if ((pDM_Odm->SupportPlatform == ODM_WIN) && -+ (pDM_Odm->PatchID==RT_CID_819x_Lenovo)) { -+ if (i==ODM_RF_PATH_A) -+ pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,i,RSSI); -+ -+ } -+ } -+ } -+ -+ -+ // -+ // (3)PWDB, Average PWDB cacluated by hardware (for rate adaptive) -+ // -+ //2012.05.25 LukeLee: Testchip AGC report is wrong, it should be restored back to old formula in MP chip -+ if((pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) && (!pDM_Odm->bIsMPChip)) -+ rx_pwr_all = (pPhyStaRpt->pwdb_all& 0x7f) -110; -+ else -+ rx_pwr_all = (((pPhyStaRpt->pwdb_all) >> 1 )& 0x7f) -110; //OLD FORMULA -+ -+ -+ PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); -+ -+ -+ pPhyInfo->RxPWDBAll = PWDB_ALL; -+ pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; -+ pPhyInfo->RxPower = rx_pwr_all; -+ pPhyInfo->RecvSignalPower = rx_pwr_all; -+ -+ if((pDM_Odm->SupportPlatform == ODM_WIN) &&(pDM_Odm->PatchID==19)){ -+ //do nothing -+ } else{//pMgntInfo->CustomerID != RT_CID_819x_Lenovo -+ // -+ // (4)EVM of OFDM rate -+ // -+ if ((pPktinfo->DataRate>=DESC_RATEMCS8) && -+ (pPktinfo->DataRate <=DESC_RATEMCS15)) -+ Max_spatial_stream = 2; -+ else if ((pPktinfo->DataRate>=DESC_RATEVHTSS2MCS0) && -+ (pPktinfo->DataRate <=DESC_RATEVHTSS2MCS9)) -+ Max_spatial_stream = 2; -+ else -+ Max_spatial_stream = 1; -+ -+ for (i=0; i>= 1" because the compilor of free build environment -+ // fill most significant bit to "zero" when doing shifting operation which may change a negative -+ // value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore. -+ EVM = odm_EVMdbToPercentage( (pPhyStaRpt->rxevm[i] )); //dbm -+ EVMdbm = odm_EVMdbm_JaguarSeries(pPhyStaRpt->rxevm[i]); -+ -+ if(pPktinfo->bPacketMatchBSSID) { -+ if(i==ODM_RF_PATH_A) // Fill value in RFD, Get the first spatial stream only -+ pPhyInfo->SignalQuality = EVM; -+ pPhyInfo->RxMIMOSignalQuality[i] = EVM; -+ pPhyInfo->RxMIMOEVMdbm[i] = EVMdbm; -+ } -+ } -+ } -+ //2 For dynamic ATC switch -+ if(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_ATC) { -+ if(pPktinfo->bPacketMatchBSSID) { -+ //3 Update CFO report for path-A & path-B -+ for(i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) -+ pDM_Odm->CFO_tail[i] = (int)pPhyStaRpt->cfotail[i]; -+ -+ //3 Update packet counter -+ if(pDM_Odm->packetCount == 0xffffffff) -+ pDM_Odm->packetCount = 0; -+ else -+ pDM_Odm->packetCount++; -+ } -+ } -+ } -+ -+ //UI BSS List signal strength(in percentage), make it good looking, from 0~100. -+ //It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp(). -+ if(isCCKrate) { -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));//PWDB_ALL; -+ } else { -+ if (rf_rx_num != 0) -+ pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, total_rssi/=rf_rx_num)); -+ } -+ pDM_Odm->RxPWDBAve = pDM_Odm->RxPWDBAve + pPhyInfo->RxPWDBAll; -+ -+ pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->antidx_anta; -+} -+ -+void -+odm_Init_RSSIForDM( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ -+} -+ -+void -+odm_Process_RSSIForDM( -+ PDM_ODM_T pDM_Odm, -+ PODM_PHY_INFO_T pPhyInfo, -+ PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ -+ s4Byte UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK, UndecoratedSmoothedOFDM, RSSI_Ave; -+ u1Byte isCCKrate=0; -+ u1Byte RSSI_max, RSSI_min, i; -+ u4Byte OFDM_pkt=0; -+ u4Byte Weighting=0; -+ -+ PSTA_INFO_T pEntry; -+ -+ if(pPktinfo->StationID == 0xFF) -+ return; -+ -+ // -+ // 2012/05/30 MH/Luke.Lee Add some description -+ // In windows driver: AP/IBSS mode STA -+ // -+ //if (pDM_Odm->SupportPlatform == ODM_WIN) -+ //{ -+ // pEntry = pDM_Odm->pODM_StaInfo[pDM_Odm->pAidMap[pPktinfo->StationID-1]]; -+ //} -+ //else -+ pEntry = pDM_Odm->pODM_StaInfo[pPktinfo->StationID]; -+ -+ if(!IS_STA_VALID(pEntry) ){ -+ return; -+ } -+ if((!pPktinfo->bPacketMatchBSSID) ) -+ { -+ return; -+ } -+ -+ if(pPktinfo->bPacketBeacon) -+ pDM_Odm->PhyDbgInfo.NumQryBeaconPkt++; -+ isCCKrate = (pPktinfo->DataRate <= DESC92C_RATE11M)?true :false; -+ pDM_Odm->RxRate = pPktinfo->DataRate; -+ /* -+ if(!isCCKrate) -+ { -+ DbgPrint("OFDM: pPktinfo->StationID=%d, isCCKrate=%d, pPhyInfo->RxPWDBAll=%d\n", -+ pPktinfo->StationID, isCCKrate, pPhyInfo->RxPWDBAll); -+ } -+ */ -+#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ if(pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -+ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketMatchBSSID) -+ { -+ if(pPktinfo->DataRate > DESC8812_RATE11M) -+ ODM_AntselStatistics_8821A(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, pPhyInfo->RxPWDBAll); -+ } -+ } -+ -+#endif //#if(defined(CONFIG_HW_ANTENNA_DIVERSITY)) -+ -+ //-----------------Smart Antenna Debug Message------------------// -+ -+ UndecoratedSmoothedCCK = pEntry->rssi_stat.UndecoratedSmoothedCCK; -+ UndecoratedSmoothedOFDM = pEntry->rssi_stat.UndecoratedSmoothedOFDM; -+ UndecoratedSmoothedPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; -+ -+ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon) -+ { -+ -+ if(!isCCKrate)//ofdm rate -+ { -+ if(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B] == 0){ -+ RSSI_Ave = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_B = 0; -+ } -+ else -+ { -+ pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ -+ if(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A] > pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]) -+ { -+ RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ } -+ else -+ { -+ RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; -+ RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; -+ } -+ if((RSSI_max -RSSI_min) < 3) -+ RSSI_Ave = RSSI_max; -+ else if((RSSI_max -RSSI_min) < 6) -+ RSSI_Ave = RSSI_max - 1; -+ else if((RSSI_max -RSSI_min) < 10) -+ RSSI_Ave = RSSI_max - 2; -+ else -+ RSSI_Ave = RSSI_max - 3; -+ } -+ -+ //1 Process OFDM RSSI -+ if(UndecoratedSmoothedOFDM <= 0) // initialize -+ { -+ UndecoratedSmoothedOFDM = pPhyInfo->RxPWDBAll; -+ } -+ else -+ { -+ if(pPhyInfo->RxPWDBAll > (u4Byte)UndecoratedSmoothedOFDM) -+ { -+ UndecoratedSmoothedOFDM = -+ ( ((UndecoratedSmoothedOFDM)*(Rx_Smooth_Factor-1)) + -+ (RSSI_Ave)) /(Rx_Smooth_Factor); -+ UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM + 1; -+ } -+ else -+ { -+ UndecoratedSmoothedOFDM = -+ ( ((UndecoratedSmoothedOFDM)*(Rx_Smooth_Factor-1)) + -+ (RSSI_Ave)) /(Rx_Smooth_Factor); -+ } -+ } -+ -+ pEntry->rssi_stat.PacketMap = (pEntry->rssi_stat.PacketMap<<1) | BIT0; -+ -+ } -+ else -+ { -+ RSSI_Ave = pPhyInfo->RxPWDBAll; -+ pDM_Odm->RSSI_A = (u1Byte) pPhyInfo->RxPWDBAll; -+ pDM_Odm->RSSI_B = 0xFF; -+ -+ //1 Process CCK RSSI -+ if(UndecoratedSmoothedCCK <= 0) // initialize -+ { -+ UndecoratedSmoothedCCK = pPhyInfo->RxPWDBAll; -+ } -+ else -+ { -+ if(pPhyInfo->RxPWDBAll > (u4Byte)UndecoratedSmoothedCCK) -+ { -+ UndecoratedSmoothedCCK = -+ ( ((UndecoratedSmoothedCCK)*(Rx_Smooth_Factor-1)) + -+ (pPhyInfo->RxPWDBAll)) /(Rx_Smooth_Factor); -+ UndecoratedSmoothedCCK = UndecoratedSmoothedCCK + 1; -+ } -+ else -+ { -+ UndecoratedSmoothedCCK = -+ ( ((UndecoratedSmoothedCCK)*(Rx_Smooth_Factor-1)) + -+ (pPhyInfo->RxPWDBAll)) /(Rx_Smooth_Factor); -+ } -+ } -+ pEntry->rssi_stat.PacketMap = pEntry->rssi_stat.PacketMap<<1; -+ } -+ -+ //if(pEntry) -+ { -+ //2011.07.28 LukeLee: modified to prevent unstable CCK RSSI -+ if(pEntry->rssi_stat.ValidBit >= 64) -+ pEntry->rssi_stat.ValidBit = 64; -+ else -+ pEntry->rssi_stat.ValidBit++; -+ -+ for(i=0; irssi_stat.ValidBit; i++) -+ OFDM_pkt += (u1Byte)(pEntry->rssi_stat.PacketMap>>i)&BIT0; -+ -+ if(pEntry->rssi_stat.ValidBit == 64) -+ { -+ Weighting = ((OFDM_pkt<<4) > 64)?64:(OFDM_pkt<<4); -+ UndecoratedSmoothedPWDB = (Weighting*UndecoratedSmoothedOFDM+(64-Weighting)*UndecoratedSmoothedCCK)>>6; -+ } -+ else -+ { -+ if(pEntry->rssi_stat.ValidBit != 0) -+ UndecoratedSmoothedPWDB = (OFDM_pkt*UndecoratedSmoothedOFDM+(pEntry->rssi_stat.ValidBit-OFDM_pkt)*UndecoratedSmoothedCCK)/pEntry->rssi_stat.ValidBit; -+ else -+ UndecoratedSmoothedPWDB = 0; -+ } -+ -+ pEntry->rssi_stat.UndecoratedSmoothedCCK = UndecoratedSmoothedCCK; -+ pEntry->rssi_stat.UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM; -+ pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; -+ -+ //DbgPrint("OFDM_pkt=%d, Weighting=%d\n", OFDM_pkt, Weighting); -+ //DbgPrint("UndecoratedSmoothedOFDM=%d, UndecoratedSmoothedPWDB=%d, UndecoratedSmoothedCCK=%d\n", -+ // UndecoratedSmoothedOFDM, UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK); -+ -+ } -+ -+ } -+} -+ -+ -+// -+// Endianness before calling this API -+// -+void -+ODM_PhyStatusQuery_92CSeries( -+ PDM_ODM_T pDM_Odm, -+ PODM_PHY_INFO_T pPhyInfo, -+ pu1Byte pPhyStatus, -+ PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ -+ odm_RxPhyStatus92CSeries_Parsing( -+ pDM_Odm, -+ pPhyInfo, -+ pPhyStatus, -+ pPktinfo); -+ -+ if( pDM_Odm->RSSI_test == true) -+ { -+ // Select the packets to do RSSI checking for antenna switching. -+ if(pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon ) -+ { -+ ODM_SwAntDivChkPerPktRssi(pDM_Odm,pPktinfo->StationID,pPhyInfo); -+ } -+ } -+ else -+ { -+ odm_Process_RSSIForDM(pDM_Odm,pPhyInfo,pPktinfo); -+ } -+} -+ -+// -+// Endianness before calling this API -+// -+void -+ODM_PhyStatusQuery_JaguarSeries( -+ PDM_ODM_T pDM_Odm, -+ PODM_PHY_INFO_T pPhyInfo, -+ pu1Byte pPhyStatus, -+ PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ odm_RxPhyStatusJaguarSeries_Parsing( -+ pDM_Odm, -+ pPhyInfo, -+ pPhyStatus, -+ pPktinfo); -+ -+ odm_Process_RSSIForDM(pDM_Odm,pPhyInfo,pPktinfo); -+} -+ -+void -+ODM_PhyStatusQuery( -+ PDM_ODM_T pDM_Odm, -+ PODM_PHY_INFO_T pPhyInfo, -+ pu1Byte pPhyStatus, -+ PODM_PACKET_INFO_T pPktinfo -+ ) -+{ -+ -+ if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES ) -+ { -+ ODM_PhyStatusQuery_JaguarSeries(pDM_Odm,pPhyInfo,pPhyStatus,pPktinfo); -+ } -+ else -+ { -+ ODM_PhyStatusQuery_92CSeries(pDM_Odm,pPhyInfo,pPhyStatus,pPktinfo); -+ } -+} -+ -+// For future use. -+void -+ODM_MacStatusQuery( -+ PDM_ODM_T pDM_Odm, -+ pu1Byte pMacStatus, -+ u1Byte MacID, -+ bool bPacketMatchBSSID, -+ bool bPacketToSelf, -+ bool bPacketBeacon -+ ) -+{ -+ // 2011/10/19 Driver team will handle in the future. -+ -+} -+ -+ -+// -+// If you want to add a new IC, Please follow below template and generate a new one. -+// -+// -+ -+HAL_STATUS -+ODM_ConfigRFWithHeaderFile( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_Config_Type ConfigType, -+ ODM_RF_RADIO_PATH_E eRFPath -+ ) -+{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigRFWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A) -+ { -+ READ_AND_CONFIG(8812A,_RadioA); -+ } -+ else if(eRFPath == ODM_RF_PATH_B) -+ { -+ READ_AND_CONFIG(8812A,_RadioB); -+ } -+ } -+ else if(ConfigType == CONFIG_RF_TXPWR_LMT) { -+ READ_AND_CONFIG(8812A,_TXPWR_LMT); -+ } -+ } -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ if(ConfigType == CONFIG_RF_RADIO) { -+ if(eRFPath == ODM_RF_PATH_A) -+ { -+ READ_AND_CONFIG(8821A,_RadioA); -+ } -+ } -+ else if(ConfigType == CONFIG_RF_TXPWR_LMT) { -+ READ_AND_CONFIG(8821A,_TXPWR_LMT); -+ } -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigRFWithHeaderFile\n")); -+ } -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS -+ODM_ConfigRFWithTxPwrTrackHeaderFile( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigRFWithTxPwrTrackHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ if (pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG(8821A,_TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) -+ READ_AND_CONFIG(8821A,_TxPowerTrack_USB); -+ } -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) -+ READ_AND_CONFIG(8812A,_TxPowerTrack_PCIE); -+ else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { -+ if (pDM_Odm->RFEType == 3 && pDM_Odm->bIsMPChip) -+ READ_AND_CONFIG_MP(8812A,_TxPowerTrack_USB_RFE3); -+ else -+ READ_AND_CONFIG(8812A,_TxPowerTrack_USB); -+ } -+ -+ } -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS -+ODM_ConfigBBWithHeaderFile( -+ PDM_ODM_T pDM_Odm, -+ ODM_BB_Config_Type ConfigType -+ ) -+{ -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigBBWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ if(pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG) -+ { -+ READ_AND_CONFIG(8812A,_PHY_REG); -+ } -+ else if(ConfigType == CONFIG_BB_AGC_TAB) -+ { -+ READ_AND_CONFIG(8812A,_AGC_TAB); -+ } -+ else if(ConfigType == CONFIG_BB_PHY_REG_PG) -+ { -+ if (pDM_Odm->RFEType == 3 && pDM_Odm->bIsMPChip) -+ READ_AND_CONFIG_MP(8812A,_PHY_REG_PG_ASUS); -+ else -+ READ_AND_CONFIG(8812A,_PHY_REG_PG); -+ } -+ else if(ConfigType == CONFIG_BB_PHY_REG_MP) -+ { -+ READ_AND_CONFIG_MP(8812A,_PHY_REG_MP); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8812AGCTABArray\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8812PHY_REGArray\n")); -+ } -+ -+ if(pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ if(ConfigType == CONFIG_BB_PHY_REG) -+ { -+ READ_AND_CONFIG(8821A,_PHY_REG); -+ } -+ else if(ConfigType == CONFIG_BB_AGC_TAB) -+ { -+ READ_AND_CONFIG(8821A,_AGC_TAB); -+ } -+ else if(ConfigType == CONFIG_BB_PHY_REG_PG) -+ { -+ READ_AND_CONFIG(8821A,_PHY_REG_PG); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8821AGCTABArray\n")); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8821PHY_REGArray\n")); -+ } -+ return HAL_STATUS_SUCCESS; -+} -+ -+HAL_STATUS -+ODM_ConfigMACWithHeaderFile( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ u1Byte result = HAL_STATUS_SUCCESS; -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("===>ODM_ConfigMACWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, -+ ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", -+ pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); -+ -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ READ_AND_CONFIG(8812A,_MAC_REG); -+ } -+ if (pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ READ_AND_CONFIG(8821A,_MAC_REG); -+ -+ ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigMACwithHeaderFile\n")); -+ } -+ return result; -+} -+ -+HAL_STATUS -+ODM_ConfigFWWithHeaderFile( -+ PDM_ODM_T pDM_Odm, -+ ODM_FW_Config_Type ConfigType, -+ u1Byte *pFirmware, -+ u4Byte *pSize -+ ) -+{ -+ if (pDM_Odm->SupportICType == ODM_RTL8812) -+ { -+ if (ConfigType == CONFIG_FW_NIC) -+ { -+ READ_FIRMWARE(8812A,_FW_NIC); -+ } -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ { -+ READ_FIRMWARE(8812A,_FW_WoWLAN); -+ } -+ else if (ConfigType == CONFIG_FW_BT) -+ { -+ READ_FIRMWARE(8812A,_FW_NIC_BT); -+ } -+ } -+ if (pDM_Odm->SupportICType == ODM_RTL8821) -+ { -+ if (ConfigType == CONFIG_FW_NIC) -+ { -+ READ_FIRMWARE(8821A,_FW_NIC); -+ } -+ else if (ConfigType == CONFIG_FW_WoWLAN) -+ { -+ READ_FIRMWARE(8821A,_FW_WoWLAN); -+ } -+ else if (ConfigType == CONFIG_FW_BT) -+ { -+ READ_FIRMWARE(8821A,_FW_BT); -+ } -+ } -+ return HAL_STATUS_SUCCESS; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_HWConfig.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_HWConfig.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_HWConfig.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_HWConfig.h 2018-02-06 17:42:30.712967194 +0200 -@@ -0,0 +1,294 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __HALHWOUTSRC_H__ -+#define __HALHWOUTSRC_H__ -+ -+//============================================================ -+// C Series Rate -+//============================================================ -+// -+//----------------------------------------------------------- -+// CCK Rates, TxHT = 0 -+#define DESC92C_RATE1M 0x00 -+#define DESC92C_RATE2M 0x01 -+#define DESC92C_RATE5_5M 0x02 -+#define DESC92C_RATE11M 0x03 -+ -+// OFDM Rates, TxHT = 0 -+#define DESC92C_RATE6M 0x04 -+#define DESC92C_RATE9M 0x05 -+#define DESC92C_RATE12M 0x06 -+#define DESC92C_RATE18M 0x07 -+#define DESC92C_RATE24M 0x08 -+#define DESC92C_RATE36M 0x09 -+#define DESC92C_RATE48M 0x0a -+#define DESC92C_RATE54M 0x0b -+ -+// MCS Rates, TxHT = 1 -+#define DESC92C_RATEMCS0 0x0c -+#define DESC92C_RATEMCS1 0x0d -+#define DESC92C_RATEMCS2 0x0e -+#define DESC92C_RATEMCS3 0x0f -+#define DESC92C_RATEMCS4 0x10 -+#define DESC92C_RATEMCS5 0x11 -+#define DESC92C_RATEMCS6 0x12 -+#define DESC92C_RATEMCS7 0x13 -+#define DESC92C_RATEMCS8 0x14 -+#define DESC92C_RATEMCS9 0x15 -+#define DESC92C_RATEMCS10 0x16 -+#define DESC92C_RATEMCS11 0x17 -+#define DESC92C_RATEMCS12 0x18 -+#define DESC92C_RATEMCS13 0x19 -+#define DESC92C_RATEMCS14 0x1a -+#define DESC92C_RATEMCS15 0x1b -+#define DESC92C_RATEMCS15_SG 0x1c -+#define DESC92C_RATEMCS32 0x20 -+ -+ -+/*--------------------------Define -------------------------------------------*/ -+/* BIT 7 HT Rate*/ -+// TxHT = 0 -+#define MGN_1M 0x02 -+#define MGN_2M 0x04 -+#define MGN_5_5M 0x0b -+#define MGN_11M 0x16 -+ -+#define MGN_6M 0x0c -+#define MGN_9M 0x12 -+#define MGN_12M 0x18 -+#define MGN_18M 0x24 -+#define MGN_24M 0x30 -+#define MGN_36M 0x48 -+#define MGN_48M 0x60 -+#define MGN_54M 0x6c -+ -+// TxHT = 1 -+#define MGN_MCS0 0x80 -+#define MGN_MCS1 0x81 -+#define MGN_MCS2 0x82 -+#define MGN_MCS3 0x83 -+#define MGN_MCS4 0x84 -+#define MGN_MCS5 0x85 -+#define MGN_MCS6 0x86 -+#define MGN_MCS7 0x87 -+#define MGN_MCS8 0x88 -+#define MGN_MCS9 0x89 -+#define MGN_MCS10 0x8a -+#define MGN_MCS11 0x8b -+#define MGN_MCS12 0x8c -+#define MGN_MCS13 0x8d -+#define MGN_MCS14 0x8e -+#define MGN_MCS15 0x8f -+#define MGN_VHT1SS_MCS0 0x90 -+#define MGN_VHT1SS_MCS1 0x91 -+#define MGN_VHT1SS_MCS2 0x92 -+#define MGN_VHT1SS_MCS3 0x93 -+#define MGN_VHT1SS_MCS4 0x94 -+#define MGN_VHT1SS_MCS5 0x95 -+#define MGN_VHT1SS_MCS6 0x96 -+#define MGN_VHT1SS_MCS7 0x97 -+#define MGN_VHT1SS_MCS8 0x98 -+#define MGN_VHT1SS_MCS9 0x99 -+#define MGN_VHT2SS_MCS0 0x9a -+#define MGN_VHT2SS_MCS1 0x9b -+#define MGN_VHT2SS_MCS2 0x9c -+#define MGN_VHT2SS_MCS3 0x9d -+#define MGN_VHT2SS_MCS4 0x9e -+#define MGN_VHT2SS_MCS5 0x9f -+#define MGN_VHT2SS_MCS6 0xa0 -+#define MGN_VHT2SS_MCS7 0xa1 -+#define MGN_VHT2SS_MCS8 0xa2 -+#define MGN_VHT2SS_MCS9 0xa3 -+ -+#define MGN_MCS0_SG 0xc0 -+#define MGN_MCS1_SG 0xc1 -+#define MGN_MCS2_SG 0xc2 -+#define MGN_MCS3_SG 0xc3 -+#define MGN_MCS4_SG 0xc4 -+#define MGN_MCS5_SG 0xc5 -+#define MGN_MCS6_SG 0xc6 -+#define MGN_MCS7_SG 0xc7 -+#define MGN_MCS8_SG 0xc8 -+#define MGN_MCS9_SG 0xc9 -+#define MGN_MCS10_SG 0xca -+#define MGN_MCS11_SG 0xcb -+#define MGN_MCS12_SG 0xcc -+#define MGN_MCS13_SG 0xcd -+#define MGN_MCS14_SG 0xce -+#define MGN_MCS15_SG 0xcf -+ -+#define READ_NEXT_PAIR(v1, v2, i) do { i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -+#define AGC_DIFF_CONFIG_MP(ic, band) (ODM_ReadAndConfig_MP_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_MP_##ic##_AGC_TAB_DIFF_##band, \ -+ sizeof(Array_MP_##ic##_AGC_TAB_DIFF_##band)/sizeof(u4Byte))) -+#define AGC_DIFF_CONFIG_TC(ic, band) (ODM_ReadAndConfig_TC_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_TC_##ic##_AGC_TAB_DIFF_##band, \ -+ sizeof(Array_TC_##ic##_AGC_TAB_DIFF_##band)/sizeof(u4Byte))) -+ -+#define AGC_DIFF_CONFIG(ic, band) do {\ -+ if (pDM_Odm->bIsMPChip)\ -+ AGC_DIFF_CONFIG_MP(ic,band);\ -+ else\ -+ AGC_DIFF_CONFIG_TC(ic,band);\ -+ } while(0) -+ -+ -+//============================================================ -+// structure and define -+//============================================================ -+ -+typedef struct _Phy_Rx_AGC_Info -+{ -+ #ifdef __LITTLE_ENDIAN -+ u1Byte gain:7,trsw:1; -+ #else -+ u1Byte trsw:1,gain:7; -+ #endif -+} PHY_RX_AGC_INFO_T,*pPHY_RX_AGC_INFO_T; -+ -+typedef struct _Phy_Status_Rpt_8192cd -+{ -+ PHY_RX_AGC_INFO_T path_agc[2]; -+ u1Byte ch_corr[2]; -+ u1Byte cck_sig_qual_ofdm_pwdb_all; -+ u1Byte cck_agc_rpt_ofdm_cfosho_a; -+ u1Byte cck_rpt_b_ofdm_cfosho_b; -+ u1Byte rsvd_1;//ch_corr_msb; -+ u1Byte noise_power_db_msb; -+ s1Byte path_cfotail[2]; -+ u1Byte pcts_mask[2]; -+ s1Byte stream_rxevm[2]; -+ u1Byte path_rxsnr[2]; -+ u1Byte noise_power_db_lsb; -+ u1Byte rsvd_2[3]; -+ u1Byte stream_csi[2]; -+ u1Byte stream_target_csi[2]; -+ s1Byte sig_evm; -+ u1Byte rsvd_3; -+ -+#ifdef __LITTLE_ENDIAN -+ u1Byte antsel_rx_keep_2:1; //ex_intf_flg:1; -+ u1Byte sgi_en:1; -+ u1Byte rxsc:2; -+ u1Byte idle_long:1; -+ u1Byte r_ant_train_en:1; -+ u1Byte ant_sel_b:1; -+ u1Byte ant_sel:1; -+#else // __BIG_ENDIAN -+ u1Byte ant_sel:1; -+ u1Byte ant_sel_b:1; -+ u1Byte r_ant_train_en:1; -+ u1Byte idle_long:1; -+ u1Byte rxsc:2; -+ u1Byte sgi_en:1; -+ u1Byte antsel_rx_keep_2:1; //ex_intf_flg:1; -+#endif -+} PHY_STATUS_RPT_8192CD_T,*PPHY_STATUS_RPT_8192CD_T; -+ -+ -+typedef struct _Phy_Status_Rpt_8812 -+{ -+ //2012.05.24 LukeLee: This structure should take big/little endian in consideration later..... -+ -+ //DWORD 0 -+ u1Byte gain_trsw[2]; -+ u2Byte chl_num:10; -+ u2Byte sub_chnl:4; -+ u2Byte r_RFMOD:2; -+ -+ //DWORD 1 -+ u1Byte pwdb_all; -+ u1Byte cfosho[4]; // DW 1 byte 1 DW 2 byte 0 -+ -+ //DWORD 2 -+ s1Byte cfotail[4]; // DW 2 byte 1 DW 3 byte 0 -+ -+ //DWORD 3 -+ s1Byte rxevm[2]; // DW 3 byte 1 DW 3 byte 2 -+ s1Byte rxsnr[2]; // DW 3 byte 3 DW 4 byte 0 -+ -+ //DWORD 4 -+ u1Byte PCTS_MSK_RPT[2]; -+ u1Byte pdsnr[2]; // DW 4 byte 3 DW 5 Byte 0 -+ -+ //DWORD 5 -+ u1Byte csi_current[2]; -+ u1Byte rx_gain_c; -+ -+ //DWORD 6 -+ u1Byte rx_gain_d; -+ u1Byte sigevm; -+ u1Byte resvd_0; -+ u1Byte antidx_anta:3; -+ u1Byte antidx_antb:3; -+ u1Byte resvd_1:2; -+} PHY_STATUS_RPT_8812_T,*PPHY_STATUS_RPT_8812_T; -+ -+ -+void -+odm_Init_RSSIForDM( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+ODM_PhyStatusQuery( -+ PDM_ODM_T pDM_Odm, -+ PODM_PHY_INFO_T pPhyInfo, -+ pu1Byte pPhyStatus, -+ PODM_PACKET_INFO_T pPktinfo -+ ); -+ -+void -+ODM_MacStatusQuery( -+ PDM_ODM_T pDM_Odm, -+ pu1Byte pMacStatus, -+ u1Byte MacID, -+ bool bPacketMatchBSSID, -+ bool bPacketToSelf, -+ bool bPacketBeacon -+ ); -+ -+HAL_STATUS -+ODM_ConfigRFWithTxPwrTrackHeaderFile( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+HAL_STATUS -+ODM_ConfigRFWithHeaderFile( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_Config_Type ConfigType, -+ ODM_RF_RADIO_PATH_E eRFPath -+ ); -+ -+HAL_STATUS -+ODM_ConfigBBWithHeaderFile( -+ PDM_ODM_T pDM_Odm, -+ ODM_BB_Config_Type ConfigType -+ ); -+ -+HAL_STATUS -+ODM_ConfigMACWithHeaderFile( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+HAL_STATUS -+ODM_ConfigFWWithHeaderFile( -+ PDM_ODM_T pDM_Odm, -+ ODM_FW_Config_Type ConfigType, -+ u1Byte *pFirmware, -+ u4Byte *pSize -+ ); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_interface.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_interface.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_interface.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_interface.c 2018-02-06 17:42:30.713967209 +0200 -@@ -0,0 +1,384 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+//============================================================ -+// include files -+//============================================================ -+ -+#include "odm_precomp.h" -+// -+// ODM IO Relative API. -+// -+ -+u1Byte -+ODM_Read1Byte( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ return rtw_read8(Adapter,RegAddr); -+} -+ -+ -+u2Byte -+ODM_Read2Byte( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ return rtw_read16(Adapter,RegAddr); -+} -+ -+u4Byte -+ODM_Read4Byte( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ return rtw_read32(Adapter,RegAddr); -+} -+ -+ -+void -+ODM_Write1Byte( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u1Byte Data -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ rtw_write8(Adapter,RegAddr, Data); -+} -+ -+ -+void -+ODM_Write2Byte( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u2Byte Data -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ rtw_write16(Adapter,RegAddr, Data); -+} -+ -+ -+void -+ODM_Write4Byte( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u4Byte Data -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ rtw_write32(Adapter,RegAddr, Data); -+} -+ -+void -+ODM_SetMACReg( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u4Byte BitMask, -+ u4Byte Data -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ PHY_SetBBReg(Adapter, RegAddr, BitMask, Data); -+} -+ -+u4Byte -+ODM_GetMACReg( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u4Byte BitMask -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ return PHY_QueryBBReg(Adapter, RegAddr, BitMask); -+} -+ -+void -+ODM_SetBBReg( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u4Byte BitMask, -+ u4Byte Data -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ PHY_SetBBReg(Adapter, RegAddr, BitMask, Data); -+} -+ -+u4Byte -+ODM_GetBBReg( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u4Byte BitMask -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ return PHY_QueryBBReg(Adapter, RegAddr, BitMask); -+} -+ -+ -+void -+ODM_SetRFReg( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_RADIO_PATH_E eRFPath, -+ u4Byte RegAddr, -+ u4Byte BitMask, -+ u4Byte Data -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ PHY_SetRFReg(Adapter, eRFPath, RegAddr, BitMask, Data); -+} -+ -+ -+u4Byte -+ODM_GetRFReg( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_RADIO_PATH_E eRFPath, -+ u4Byte RegAddr, -+ u4Byte BitMask -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ return PHY_QueryRFReg(Adapter, eRFPath, RegAddr, BitMask); -+} -+ -+// -+// ODM Memory relative API. -+// -+void -+ODM_AllocateMemory( -+ PDM_ODM_T pDM_Odm, -+ void * *pPtr, -+ u4Byte length -+ ) -+{ -+ *pPtr = rtw_zvmalloc(length); -+} -+ -+// length could be ignored, used to detect memory leakage. -+void -+ODM_FreeMemory( -+ PDM_ODM_T pDM_Odm, -+ void * pPtr, -+ u4Byte length -+ ) -+{ -+ rtw_vmfree(pPtr, length); -+} -+ -+void -+ODM_MoveMemory( -+ PDM_ODM_T pDM_Odm, -+ void * pDest, -+ const void * pSrc, -+ u4Byte Length -+ ) -+{ -+ _rtw_memcpy(pDest, (void *)pSrc, Length); -+} -+ -+s4Byte ODM_CompareMemory( -+ PDM_ODM_T pDM_Odm, -+ void * pBuf1, -+ void * pBuf2, -+ u4Byte length -+ ) -+{ -+ return _rtw_memcmp(pBuf1,pBuf2,length); -+} -+ -+// -+// ODM MISC relative API. -+// -+void -+ODM_AcquireSpinLock( -+ PDM_ODM_T pDM_Odm, -+ RT_SPINLOCK_TYPE type -+ ) -+{ -+} -+ -+void -+ODM_ReleaseSpinLock( -+ PDM_ODM_T pDM_Odm, -+ RT_SPINLOCK_TYPE type -+ ) -+{ -+} -+ -+// -+// Work item relative API. FOr MP driver only~! -+// -+void -+ODM_InitializeWorkItem( -+ PDM_ODM_T pDM_Odm, -+ PRT_WORK_ITEM pRtWorkItem, -+ RT_WORKITEM_CALL_BACK RtWorkItemCallback, -+ void * pContext, -+ const char* szID -+ ) -+{ -+} -+ -+void -+ODM_StartWorkItem( -+ PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+} -+ -+ -+void -+ODM_StopWorkItem( -+ PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+} -+ -+void -+ODM_FreeWorkItem( -+ PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+} -+ -+void -+ODM_ScheduleWorkItem( -+ PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+} -+ -+void -+ODM_IsWorkItemScheduled( -+ PRT_WORK_ITEM pRtWorkItem -+ ) -+{ -+} -+ -+// -+// ODM Timer relative API. -+// -+void -+ODM_StallExecution( -+ u4Byte usDelay -+ ) -+{ -+ rtw_udelay_os(usDelay); -+} -+ -+void -+ODM_delay_ms(u4Byte ms) -+{ -+ rtw_mdelay_os(ms); -+} -+ -+void -+ODM_delay_us(u4Byte us) -+{ -+ rtw_udelay_os(us); -+} -+ -+void -+ODM_sleep_ms(u4Byte ms) -+{ -+ rtw_msleep_os(ms); -+} -+ -+void -+ODM_sleep_us(u4Byte us) -+{ -+ rtw_usleep_os(us); -+} -+ -+void -+ODM_SetTimer( -+ PDM_ODM_T pDM_Odm, -+ PRT_TIMER pTimer, -+ u4Byte msDelay -+ ) -+{ -+ _set_timer(pTimer,msDelay ); //ms -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+void -+ODM_InitializeTimer( -+ PDM_ODM_T pDM_Odm, -+ PRT_TIMER pTimer, -+ RT_TIMER_CALL_BACK CallBackFunc, -+ void * pContext, -+ const char* szID -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ -+ _init_timer(pTimer,Adapter->pnetdev,CallBackFunc,pDM_Odm); -+} -+#endif -+ -+void -+ODM_CancelTimer( -+ PDM_ODM_T pDM_Odm, -+ PRT_TIMER pTimer -+ ) -+{ -+ _cancel_timer_ex(pTimer); -+} -+ -+void -+ODM_ReleaseTimer( -+ PDM_ODM_T pDM_Odm, -+ PRT_TIMER pTimer -+ ) -+{ -+} -+ -+// -+// ODM FW relative API. -+// -+u4Byte -+ODM_FillH2CCmd( -+ pu1Byte pH2CBuffer, -+ u4Byte H2CBufferLen, -+ u4Byte CmdNum, -+ pu4Byte pElementID, -+ pu4Byte pCmdLen, -+ pu1Byte* pCmbBuffer, -+ pu1Byte CmdStartSeq -+ ) -+{ -+ return true; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_interface.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_interface.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_interface.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_interface.h 2018-02-06 17:42:30.713967209 +0200 -@@ -0,0 +1,315 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __ODM_INTERFACE_H__ -+#define __ODM_INTERFACE_H__ -+ -+ -+ -+// -+// =========== Constant/Structure/Enum/... Define -+// -+ -+ -+ -+// -+// =========== Macro Define -+// -+ -+#define _reg_all(_name) ODM_##_name -+#define _reg_ic(_name, _ic) ODM_##_name##_ic -+#define _bit_all(_name) BIT_##_name -+#define _bit_ic(_name, _ic) BIT_##_name##_ic -+ -+ -+#define _reg_11N(_name) ODM_REG_##_name##_11N -+#define _reg_11AC(_name) ODM_REG_##_name##_11AC -+#define _bit_11N(_name) ODM_BIT_##_name##_11N -+#define _bit_11AC(_name) ODM_BIT_##_name##_11AC -+ -+#define _cat(_name, _ic_type, _func) \ -+ ( \ -+ ((_ic_type) & ODM_IC_11N_SERIES)? _func##_11N(_name): \ -+ _func##_11AC(_name) \ -+ ) -+ -+// _name: name of register or bit. -+// Example: "ODM_REG(R_A_AGC_CORE1, pDM_Odm)" -+// gets "ODM_R_A_AGC_CORE1" or "ODM_R_A_AGC_CORE1_8192C", depends on SupportICType. -+#define ODM_REG(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _reg) -+#define ODM_BIT(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _bit) -+ -+typedef enum _ODM_H2C_CMD -+{ -+ ODM_H2C_RSSI_REPORT = 0, -+ ODM_H2C_PSD_RESULT=1, -+ ODM_H2C_PathDiv = 2, -+ ODM_MAX_H2CCMD -+}ODM_H2C_CMD; -+ -+ -+// -+// 2012/02/17 MH For non-MP compile pass only. Linux does not support workitem. -+// Suggest HW team to use thread instead of workitem. Windows also support the feature. -+// -+typedef void *PRT_WORK_ITEM ; -+typedef void RT_WORKITEM_HANDLE,*PRT_WORKITEM_HANDLE; -+typedef void (*RT_WORKITEM_CALL_BACK)(void * pContext); -+ -+// -+// =========== Extern Variable ??? It should be forbidden. -+// -+ -+ -+// -+// =========== EXtern Function Prototype -+// -+ -+ -+u1Byte -+ODM_Read1Byte( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr -+ ); -+ -+u2Byte -+ODM_Read2Byte( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr -+ ); -+ -+u4Byte -+ODM_Read4Byte( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr -+ ); -+ -+void -+ODM_Write1Byte( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u1Byte Data -+ ); -+ -+void -+ODM_Write2Byte( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u2Byte Data -+ ); -+ -+void -+ODM_Write4Byte( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u4Byte Data -+ ); -+ -+void -+ODM_SetMACReg( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u4Byte BitMask, -+ u4Byte Data -+ ); -+ -+u4Byte -+ODM_GetMACReg( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u4Byte BitMask -+ ); -+ -+void -+ODM_SetBBReg( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u4Byte BitMask, -+ u4Byte Data -+ ); -+ -+u4Byte -+ODM_GetBBReg( -+ PDM_ODM_T pDM_Odm, -+ u4Byte RegAddr, -+ u4Byte BitMask -+ ); -+ -+void -+ODM_SetRFReg( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_RADIO_PATH_E eRFPath, -+ u4Byte RegAddr, -+ u4Byte BitMask, -+ u4Byte Data -+ ); -+ -+u4Byte -+ODM_GetRFReg( -+ PDM_ODM_T pDM_Odm, -+ ODM_RF_RADIO_PATH_E eRFPath, -+ u4Byte RegAddr, -+ u4Byte BitMask -+ ); -+ -+// -+// Memory Relative Function. -+// -+void -+ODM_AllocateMemory( -+ PDM_ODM_T pDM_Odm, -+ void * *pPtr, -+ u4Byte length -+ ); -+void -+ODM_FreeMemory( -+ PDM_ODM_T pDM_Odm, -+ void * pPtr, -+ u4Byte length -+ ); -+ -+void -+ODM_MoveMemory( -+ PDM_ODM_T pDM_Odm, -+ void * pDest, -+ const void * pSrc, -+ u4Byte Length -+ ); -+ -+s4Byte ODM_CompareMemory( -+ PDM_ODM_T pDM_Odm, -+ void * pBuf1, -+ void * pBuf2, -+ u4Byte length -+ ); -+ -+// -+// ODM MISC-spin lock relative API. -+// -+void -+ODM_AcquireSpinLock( -+ PDM_ODM_T pDM_Odm, -+ RT_SPINLOCK_TYPE type -+ ); -+ -+void -+ODM_ReleaseSpinLock( -+ PDM_ODM_T pDM_Odm, -+ RT_SPINLOCK_TYPE type -+ ); -+ -+ -+// -+// ODM MISC-workitem relative API. -+// -+void -+ODM_InitializeWorkItem( -+ PDM_ODM_T pDM_Odm, -+ PRT_WORK_ITEM pRtWorkItem, -+ RT_WORKITEM_CALL_BACK RtWorkItemCallback, -+ void * pContext, -+ const char* szID -+ ); -+ -+void -+ODM_StartWorkItem( -+ PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+void -+ODM_StopWorkItem( -+ PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+void -+ODM_FreeWorkItem( -+ PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+void -+ODM_ScheduleWorkItem( -+ PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+void -+ODM_IsWorkItemScheduled( -+ PRT_WORK_ITEM pRtWorkItem -+ ); -+ -+// -+// ODM Timer relative API. -+// -+void -+ODM_StallExecution( -+ u4Byte usDelay -+ ); -+ -+void -+ODM_delay_ms(u4Byte ms); -+ -+ -+void -+ODM_delay_us(u4Byte us); -+ -+void -+ODM_sleep_ms(u4Byte ms); -+ -+void -+ODM_sleep_us(u4Byte us); -+ -+void -+ODM_SetTimer( -+ PDM_ODM_T pDM_Odm, -+ PRT_TIMER pTimer, -+ u4Byte msDelay -+ ); -+ -+void -+ODM_InitializeTimer( -+ PDM_ODM_T pDM_Odm, -+ PRT_TIMER pTimer, -+ RT_TIMER_CALL_BACK CallBackFunc, -+ void * pContext, -+ const char* szID -+ ); -+ -+void -+ODM_CancelTimer( -+ PDM_ODM_T pDM_Odm, -+ PRT_TIMER pTimer -+ ); -+ -+void -+ODM_ReleaseTimer( -+ PDM_ODM_T pDM_Odm, -+ PRT_TIMER pTimer -+ ); -+ -+// -+// ODM FW relative API. -+// -+u4Byte -+ODM_FillH2CCmd( -+ pu1Byte pH2CBuffer, -+ u4Byte H2CBufferLen, -+ u4Byte CmdNum, -+ pu4Byte pElementID, -+ pu4Byte pCmdLen, -+ pu1Byte* pCmbBuffer, -+ pu1Byte CmdStartSeq -+ ); -+ -+#endif // __ODM_INTERFACE_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_precomp.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_precomp.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_precomp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_precomp.h 2018-02-06 17:42:30.713967209 +0200 -@@ -0,0 +1,74 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_PRECOMP_H__ -+#define __ODM_PRECOMP_H__ -+ -+#include "odm_types.h" -+ -+#define TEST_FALG___ 1 -+ -+#define BEAMFORMING_SUPPORT 0 -+ -+//2 Hardware Parameter Files -+ -+//2 OutSrc Header Files -+ -+#include "odm.h" -+#include "odm_HWConfig.h" -+#include "odm_debug.h" -+#include "odm_RegDefine11AC.h" -+#include "odm_RegDefine11N.h" -+ -+#include "HalPhyRf.h" -+#include "HalPhyRf_8812A.h"//for IQK,LCK,Power-tracking -+#include "rtl8812a_hal.h" -+ -+#include "HalPhyRf_8821A.h"//for IQK,LCK,Power-tracking -+#include "HalPhyRf_8812A.h"//for IQK,LCK,Power-tracking -+#include "rtl8812a_hal.h" -+ -+#include "odm_interface.h" -+#include "odm_reg.h" -+ -+#if (TEST_CHIP_SUPPORT == 1) -+#include "rtl8188e/HalHWImg8188E_TestChip_MAC.h" -+#include "rtl8188e/HalHWImg8188E_TestChip_RF.h" -+#include "rtl8188e/HalHWImg8188E_TestChip_BB.h" -+#endif -+ -+#include "HalHWImg8812A_MAC.h" -+#include "HalHWImg8812A_RF.h" -+#include "HalHWImg8812A_BB.h" -+#include "HalHWImg8812A_FW.h" -+#include "odm_RegConfig8812A.h" -+#if (TEST_CHIP_SUPPORT == 1) -+#include "HalHWImg8812A_TestChip_MAC.h" -+#include "HalHWImg8812A_TestChip_RF.h" -+#include "HalHWImg8812A_TestChip_BB.h" -+#endif -+ -+#include "HalHWImg8821A_MAC.h" -+#include "HalHWImg8821A_RF.h" -+#include "HalHWImg8821A_BB.h" -+#include "HalHWImg8821A_FW.h" -+#include "odm_RegConfig8821A.h" -+#if (TEST_CHIP_SUPPORT == 1) -+#include "HalHWImg8821A_TestChip_MAC.h" -+#include "HalHWImg8821A_TestChip_RF.h" -+#include "HalHWImg8821A_TestChip_BB.h" -+#endif -+ -+#endif // __ODM_PRECOMP_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8812A.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8812A.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8812A.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8812A.c 2018-02-06 17:42:30.712967194 +0200 -@@ -0,0 +1,177 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+void -+odm_ConfigRFReg_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Data, -+ ODM_RF_RADIO_PATH_E RF_PATH, -+ u4Byte RegAddr -+ ) -+{ -+ if(Addr == 0xfe || Addr == 0xffe) -+ { -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ } -+ else -+ { -+ ODM_SetRFReg(pDM_Odm, RF_PATH, RegAddr, bRFRegOffsetMask, Data); -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ } -+} -+ -+ -+void -+odm_ConfigRF_RadioA_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Data -+ ) -+{ -+ u4Byte content = 0x1000; // RF_Content: radioa_txt -+ u4Byte maskforPhySet= (u4Byte)(content&0xE000); -+ -+ odm_ConfigRFReg_8812A(pDM_Odm, Addr, Data, ODM_RF_PATH_A, Addr|maskforPhySet); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioA] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigRF_RadioB_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Data -+ ) -+{ -+ u4Byte content = 0x1001; // RF_Content: radiob_txt -+ u4Byte maskforPhySet= (u4Byte)(content&0xE000); -+ -+ odm_ConfigRFReg_8812A(pDM_Odm, Addr, Data, ODM_RF_PATH_B, Addr|maskforPhySet); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioB] %08X %08X\n", Addr, Data)); -+ -+} -+ -+void -+odm_ConfigMAC_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u1Byte Data -+ ) -+{ -+ ODM_Write1Byte(pDM_Odm, Addr, Data); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigMACWithHeaderFile: [MAC_REG] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_AGC_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Bitmask, -+ u4Byte Data -+ ) -+{ -+ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [AGC_TAB] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_PHY_REG_PG_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Bitmask, -+ u4Byte Data -+ ) -+{ -+ if (Addr == 0xfe || Addr == 0xffe) { -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ } -+ else -+ { -+ storePwrIndexDiffRateOffset(pDM_Odm->Adapter, Addr, Bitmask, Data); -+ } -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X %08X\n", Addr, Bitmask, Data)); -+} -+ -+void -+odm_ConfigBB_PHY_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Bitmask, -+ u4Byte Data -+ ) -+{ -+ if (Addr == 0xfe) { -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ } -+ else if (Addr == 0xfd) { -+ ODM_delay_ms(5); -+ } -+ else if (Addr == 0xfc) { -+ ODM_delay_ms(1); -+ } -+ else if (Addr == 0xfb) { -+ ODM_delay_us(50); -+ } -+ else if (Addr == 0xfa) { -+ ODM_delay_us(5); -+ } -+ else if (Addr == 0xf9) { -+ ODM_delay_us(1); -+ } -+ else -+ { -+ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ } -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_TXPWR_LMT_8812A( -+ PDM_ODM_T pDM_Odm, -+ const pu1Byte Regulation, -+ const pu1Byte Band, -+ const pu1Byte Bandwidth, -+ const pu1Byte RateSection, -+ const pu1Byte RfPath, -+ const pu1Byte Channel, -+ const pu1Byte PowerLimit -+ ) -+{ -+ PHY_SetPowerLimitTableValue(pDM_Odm, Regulation, Band, -+ Bandwidth, RateSection, RfPath, Channel, PowerLimit); -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8812A.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8812A.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8812A.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8812A.h 2018-02-06 17:42:30.712967194 +0200 -@@ -0,0 +1,84 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __INC_ODM_REGCONFIG_H_8812A -+#define __INC_ODM_REGCONFIG_H_8812A -+ -+void -+odm_ConfigRFReg_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Data, -+ ODM_RF_RADIO_PATH_E RF_PATH, -+ u4Byte RegAddr -+ ); -+ -+void -+odm_ConfigRF_RadioA_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Data -+ ); -+ -+void -+odm_ConfigRF_RadioB_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Data -+ ); -+ -+void -+odm_ConfigMAC_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u1Byte Data -+ ); -+ -+void -+odm_ConfigBB_AGC_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Bitmask, -+ u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_PHY_REG_PG_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Bitmask, -+ u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_PHY_8812A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Bitmask, -+ u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_TXPWR_LMT_8812A( -+ PDM_ODM_T pDM_Odm, -+ const pu1Byte Regulation, -+ const pu1Byte Band, -+ const pu1Byte Bandwidth, -+ const pu1Byte RateSection, -+ const pu1Byte RfPath, -+ const pu1Byte Channel, -+ const pu1Byte PowerLimit -+ ); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8821A.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8821A.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8821A.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8821A.c 2018-02-06 17:42:30.712967194 +0200 -@@ -0,0 +1,201 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include "odm_precomp.h" -+ -+void -+odm_ConfigRFReg_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Data, -+ ODM_RF_RADIO_PATH_E RF_PATH, -+ u4Byte RegAddr -+ ) -+{ -+ if(Addr == 0xfe || Addr == 0xffe) -+ { -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ } -+ else if (Addr == 0xfd) -+ { -+ ODM_delay_ms(5); -+ } -+ else if (Addr == 0xfc) -+ { -+ ODM_delay_ms(1); -+ } -+ else if (Addr == 0xfb) -+ { -+ ODM_delay_us(50); -+ } -+ else if (Addr == 0xfa) -+ { -+ ODM_delay_us(5); -+ } -+ else if (Addr == 0xf9) -+ { -+ ODM_delay_us(1); -+ } -+ else -+ { -+ ODM_SetRFReg(pDM_Odm, RF_PATH, RegAddr, bRFRegOffsetMask, Data); -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ } -+} -+ -+ -+void -+odm_ConfigRF_RadioA_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Data -+ ) -+{ -+ u4Byte content = 0x1000; // RF_Content: radioa_txt -+ u4Byte maskforPhySet= (u4Byte)(content&0xE000); -+ -+ odm_ConfigRFReg_8821A(pDM_Odm, Addr, Data, ODM_RF_PATH_A, Addr|maskforPhySet); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioA] %08X %08X\n", Addr, Data)); -+} -+ -+// 8821 no RF B -+/* -+void -+odm_ConfigRF_RadioB_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Data -+ ) -+{ -+ u4Byte content = 0x1001; // RF_Content: radiob_txt -+ u4Byte maskforPhySet= (u4Byte)(content&0xE000); -+ -+ odm_ConfigRFReg_8812A(pDM_Odm, Addr, Data, ODM_RF_PATH_B, Addr|maskforPhySet); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioB] %08X %08X\n", Addr, Data)); -+ -+} -+*/ -+ -+void -+odm_ConfigMAC_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u1Byte Data -+ ) -+{ -+ ODM_Write1Byte(pDM_Odm, Addr, Data); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigMACWithHeaderFile: [MAC_REG] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_AGC_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Bitmask, -+ u4Byte Data -+ ) -+{ -+ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [AGC_TAB] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_PHY_REG_PG_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Bitmask, -+ u4Byte Data -+ ) -+{ -+ if (Addr == 0xfe) -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ else if (Addr == 0xfd) -+ ODM_delay_ms(5); -+ else if (Addr == 0xfc) -+ ODM_delay_ms(1); -+ else if (Addr == 0xfb) -+ ODM_delay_us(50); -+ else if (Addr == 0xfa) -+ ODM_delay_us(5); -+ else if (Addr == 0xf9) -+ ODM_delay_us(1); -+ -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("===> @@@@@@@ ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X %08X\n", Addr, Bitmask, Data)); -+ -+ storePwrIndexDiffRateOffset(pDM_Odm->Adapter, Addr, Bitmask, Data); -+} -+ -+void -+odm_ConfigBB_PHY_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Bitmask, -+ u4Byte Data -+ ) -+{ -+ if (Addr == 0xfe) -+ #ifdef CONFIG_LONG_DELAY_ISSUE -+ ODM_sleep_ms(50); -+ #else -+ ODM_delay_ms(50); -+ #endif -+ else if (Addr == 0xfd) -+ ODM_delay_ms(5); -+ else if (Addr == 0xfc) -+ ODM_delay_ms(1); -+ else if (Addr == 0xfb) -+ ODM_delay_us(50); -+ else if (Addr == 0xfa) -+ ODM_delay_us(5); -+ else if (Addr == 0xf9) -+ ODM_delay_us(1); -+ else if (Addr == 0xa24) -+ pDM_Odm->RFCalibrateInfo.RegA24 = Data; -+ ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); -+ -+ // Add 1us delay between BB/RF register setting. -+ ODM_delay_us(1); -+ ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X\n", Addr, Data)); -+} -+ -+void -+odm_ConfigBB_TXPWR_LMT_8821A( -+ PDM_ODM_T pDM_Odm, -+ const pu1Byte Regulation, -+ const pu1Byte Band, -+ const pu1Byte Bandwidth, -+ const pu1Byte RateSection, -+ const pu1Byte RfPath, -+ const pu1Byte Channel, -+ const pu1Byte PowerLimit -+ ) -+{ -+ PHY_SetPowerLimitTableValue(pDM_Odm, Regulation, Band, -+ Bandwidth, RateSection, RfPath, Channel, PowerLimit); -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8821A.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8821A.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegConfig8821A.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegConfig8821A.h 2018-02-06 17:42:30.712967194 +0200 -@@ -0,0 +1,84 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __INC_ODM_REGCONFIG_H_8821A -+#define __INC_ODM_REGCONFIG_H_8821A -+ -+void -+odm_ConfigRFReg_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Data, -+ ODM_RF_RADIO_PATH_E RF_PATH, -+ u4Byte RegAddr -+ ); -+ -+void -+odm_ConfigRF_RadioA_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Data -+ ); -+ -+void -+odm_ConfigRF_RadioB_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Data -+ ); -+ -+void -+odm_ConfigMAC_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u1Byte Data -+ ); -+ -+void -+odm_ConfigBB_AGC_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Bitmask, -+ u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_PHY_REG_PG_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Bitmask, -+ u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_PHY_8821A( -+ PDM_ODM_T pDM_Odm, -+ u4Byte Addr, -+ u4Byte Bitmask, -+ u4Byte Data -+ ); -+ -+void -+odm_ConfigBB_TXPWR_LMT_8821A( -+ PDM_ODM_T pDM_Odm, -+ const pu1Byte Regulation, -+ const pu1Byte Band, -+ const pu1Byte Bandwidth, -+ const pu1Byte RateSection, -+ const pu1Byte RfPath, -+ const pu1Byte Channel, -+ const pu1Byte PowerLimit -+ ); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegDefine11AC.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegDefine11AC.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegDefine11AC.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegDefine11AC.h 2018-02-06 17:42:30.712967194 +0200 -@@ -0,0 +1,51 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_REGDEFINE11AC_H__ -+#define __ODM_REGDEFINE11AC_H__ -+ -+//2 RF REG LIST -+ -+ -+ -+//2 BB REG LIST -+//PAGE 8 -+#define ODM_REG_CCK_RPT_FORMAT_11AC 0x804 -+#define ODM_REG_BB_RX_PATH_11AC 0x808 -+//PAGE 9 -+#define ODM_REG_OFDM_FA_RST_11AC 0x9A4 -+//PAGE A -+#define ODM_REG_CCK_CCA_11AC 0xA0A -+#define ODM_REG_CCK_FA_RST_11AC 0xA2C -+#define ODM_REG_CCK_FA_11AC 0xA5C -+//PAGE C -+#define ODM_REG_IGI_A_11AC 0xC50 -+//PAGE E -+#define ODM_REG_IGI_B_11AC 0xE50 -+//PAGE F -+#define ODM_REG_OFDM_FA_11AC 0xF48 -+ -+ -+//2 MAC REG LIST -+ -+ -+ -+ -+//DIG Related -+#define ODM_BIT_IGI_11AC 0xFFFFFFFF -+#define ODM_BIT_CCK_RPT_FORMAT_11AC BIT16 -+#define ODM_BIT_BB_RX_PATH_11AC 0xF -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegDefine11N.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegDefine11N.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_RegDefine11N.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_RegDefine11N.h 2018-02-06 17:42:30.712967194 +0200 -@@ -0,0 +1,168 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __ODM_REGDEFINE11N_H__ -+#define __ODM_REGDEFINE11N_H__ -+ -+ -+//2 RF REG LIST -+#define ODM_REG_RF_MODE_11N 0x00 -+#define ODM_REG_RF_0B_11N 0x0B -+#define ODM_REG_CHNBW_11N 0x18 -+#define ODM_REG_T_METER_11N 0x24 -+#define ODM_REG_RF_25_11N 0x25 -+#define ODM_REG_RF_26_11N 0x26 -+#define ODM_REG_RF_27_11N 0x27 -+#define ODM_REG_RF_2B_11N 0x2B -+#define ODM_REG_RF_2C_11N 0x2C -+#define ODM_REG_RXRF_A3_11N 0x3C -+#define ODM_REG_T_METER_92D_11N 0x42 -+#define ODM_REG_T_METER_88E_11N 0x42 -+ -+ -+ -+//2 BB REG LIST -+//PAGE 8 -+#define ODM_REG_BB_CTRL_11N 0x800 -+#define ODM_REG_RF_PIN_11N 0x804 -+#define ODM_REG_PSD_CTRL_11N 0x808 -+#define ODM_REG_TX_ANT_CTRL_11N 0x80C -+#define ODM_REG_BB_PWR_SAV5_11N 0x818 -+#define ODM_REG_CCK_RPT_FORMAT_11N 0x824 -+#define ODM_REG_RX_DEFUALT_A_11N 0x858 -+#define ODM_REG_RX_DEFUALT_B_11N 0x85A -+#define ODM_REG_BB_PWR_SAV3_11N 0x85C -+#define ODM_REG_ANTSEL_CTRL_11N 0x860 -+#define ODM_REG_RX_ANT_CTRL_11N 0x864 -+#define ODM_REG_PIN_CTRL_11N 0x870 -+#define ODM_REG_BB_PWR_SAV1_11N 0x874 -+#define ODM_REG_ANTSEL_PATH_11N 0x878 -+#define ODM_REG_BB_3WIRE_11N 0x88C -+#define ODM_REG_SC_CNT_11N 0x8C4 -+#define ODM_REG_PSD_DATA_11N 0x8B4 -+//PAGE 9 -+#define ODM_REG_ANT_MAPPING1_11N 0x914 -+#define ODM_REG_ANT_MAPPING2_11N 0x918 -+//PAGE A -+#define ODM_REG_CCK_ANTDIV_PARA1_11N 0xA00 -+#define ODM_REG_CCK_CCA_11N 0xA0A -+#define ODM_REG_CCK_ANTDIV_PARA2_11N 0xA0C -+#define ODM_REG_CCK_ANTDIV_PARA3_11N 0xA10 -+#define ODM_REG_CCK_ANTDIV_PARA4_11N 0xA14 -+#define ODM_REG_CCK_FILTER_PARA1_11N 0xA22 -+#define ODM_REG_CCK_FILTER_PARA2_11N 0xA23 -+#define ODM_REG_CCK_FILTER_PARA3_11N 0xA24 -+#define ODM_REG_CCK_FILTER_PARA4_11N 0xA25 -+#define ODM_REG_CCK_FILTER_PARA5_11N 0xA26 -+#define ODM_REG_CCK_FILTER_PARA6_11N 0xA27 -+#define ODM_REG_CCK_FILTER_PARA7_11N 0xA28 -+#define ODM_REG_CCK_FILTER_PARA8_11N 0xA29 -+#define ODM_REG_CCK_FA_RST_11N 0xA2C -+#define ODM_REG_CCK_FA_MSB_11N 0xA58 -+#define ODM_REG_CCK_FA_LSB_11N 0xA5C -+#define ODM_REG_CCK_CCA_CNT_11N 0xA60 -+#define ODM_REG_BB_PWR_SAV4_11N 0xA74 -+//PAGE B -+#define ODM_REG_LNA_SWITCH_11N 0xB2C -+#define ODM_REG_PATH_SWITCH_11N 0xB30 -+#define ODM_REG_RSSI_CTRL_11N 0xB38 -+#define ODM_REG_CONFIG_ANTA_11N 0xB68 -+#define ODM_REG_RSSI_BT_11N 0xB9C -+//PAGE C -+#define ODM_REG_OFDM_FA_HOLDC_11N 0xC00 -+#define ODM_REG_BB_RX_PATH_11N 0xC04 -+#define ODM_REG_TRMUX_11N 0xC08 -+#define ODM_REG_OFDM_FA_RSTC_11N 0xC0C -+#define ODM_REG_RXIQI_MATRIX_11N 0xC14 -+#define ODM_REG_TXIQK_MATRIX_LSB1_11N 0xC4C -+#define ODM_REG_IGI_A_11N 0xC50 -+#define ODM_REG_ANTDIV_PARA2_11N 0xC54 -+#define ODM_REG_IGI_B_11N 0xC58 -+#define ODM_REG_ANTDIV_PARA3_11N 0xC5C -+#define ODM_REG_L1SBD_PD_CH_11N 0XC6C -+#define ODM_REG_BB_PWR_SAV2_11N 0xC70 -+#define ODM_REG_RX_OFF_11N 0xC7C -+#define ODM_REG_TXIQK_MATRIXA_11N 0xC80 -+#define ODM_REG_TXIQK_MATRIXB_11N 0xC88 -+#define ODM_REG_TXIQK_MATRIXA_LSB2_11N 0xC94 -+#define ODM_REG_TXIQK_MATRIXB_LSB2_11N 0xC9C -+#define ODM_REG_RXIQK_MATRIX_LSB_11N 0xCA0 -+#define ODM_REG_ANTDIV_PARA1_11N 0xCA4 -+#define ODM_REG_OFDM_FA_TYPE1_11N 0xCF0 -+//PAGE D -+#define ODM_REG_OFDM_FA_RSTD_11N 0xD00 -+#define ODM_REG_OFDM_FA_TYPE2_11N 0xDA0 -+#define ODM_REG_OFDM_FA_TYPE3_11N 0xDA4 -+#define ODM_REG_OFDM_FA_TYPE4_11N 0xDA8 -+//PAGE E -+#define ODM_REG_TXAGC_A_6_18_11N 0xE00 -+#define ODM_REG_TXAGC_A_24_54_11N 0xE04 -+#define ODM_REG_TXAGC_A_1_MCS32_11N 0xE08 -+#define ODM_REG_TXAGC_A_MCS0_3_11N 0xE10 -+#define ODM_REG_TXAGC_A_MCS4_7_11N 0xE14 -+#define ODM_REG_TXAGC_A_MCS8_11_11N 0xE18 -+#define ODM_REG_TXAGC_A_MCS12_15_11N 0xE1C -+#define ODM_REG_FPGA0_IQK_11N 0xE28 -+#define ODM_REG_TXIQK_TONE_A_11N 0xE30 -+#define ODM_REG_RXIQK_TONE_A_11N 0xE34 -+#define ODM_REG_TXIQK_PI_A_11N 0xE38 -+#define ODM_REG_RXIQK_PI_A_11N 0xE3C -+#define ODM_REG_TXIQK_11N 0xE40 -+#define ODM_REG_RXIQK_11N 0xE44 -+#define ODM_REG_IQK_AGC_PTS_11N 0xE48 -+#define ODM_REG_IQK_AGC_RSP_11N 0xE4C -+#define ODM_REG_BLUETOOTH_11N 0xE6C -+#define ODM_REG_RX_WAIT_CCA_11N 0xE70 -+#define ODM_REG_TX_CCK_RFON_11N 0xE74 -+#define ODM_REG_TX_CCK_BBON_11N 0xE78 -+#define ODM_REG_OFDM_RFON_11N 0xE7C -+#define ODM_REG_OFDM_BBON_11N 0xE80 -+#define ODM_REG_TX2RX_11N 0xE84 -+#define ODM_REG_TX2TX_11N 0xE88 -+#define ODM_REG_RX_CCK_11N 0xE8C -+#define ODM_REG_RX_OFDM_11N 0xED0 -+#define ODM_REG_RX_WAIT_RIFS_11N 0xED4 -+#define ODM_REG_RX2RX_11N 0xED8 -+#define ODM_REG_STANDBY_11N 0xEDC -+#define ODM_REG_SLEEP_11N 0xEE0 -+#define ODM_REG_PMPD_ANAEN_11N 0xEEC -+ -+ -+ -+ -+ -+ -+ -+//2 MAC REG LIST -+#define ODM_REG_BB_RST_11N 0x02 -+#define ODM_REG_ANTSEL_PIN_11N 0x4C -+#define ODM_REG_EARLY_MODE_11N 0x4D0 -+#define ODM_REG_RSSI_MONITOR_11N 0x4FE -+#define ODM_REG_EDCA_VO_11N 0x500 -+#define ODM_REG_EDCA_VI_11N 0x504 -+#define ODM_REG_EDCA_BE_11N 0x508 -+#define ODM_REG_EDCA_BK_11N 0x50C -+#define ODM_REG_TXPAUSE_11N 0x522 -+#define ODM_REG_RESP_TX_11N 0x6D8 -+#define ODM_REG_ANT_TRAIN_PARA1_11N 0x7b0 -+#define ODM_REG_ANT_TRAIN_PARA2_11N 0x7b4 -+ -+ -+//DIG Related -+#define ODM_BIT_IGI_11N 0x0000007F -+#define ODM_BIT_CCK_RPT_FORMAT_11N BIT9 -+#define ODM_BIT_BB_RX_PATH_11N 0xF -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_reg.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_reg.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_reg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_reg.h 2018-02-06 17:42:30.713967209 +0200 -@@ -0,0 +1,117 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+//============================================================ -+// File Name: odm_reg.h -+// -+// Description: -+// -+// This file is for general register definition. -+// -+// -+//============================================================ -+#ifndef __HAL_ODM_REG_H__ -+#define __HAL_ODM_REG_H__ -+ -+// -+// Register Definition -+// -+ -+//MAC REG -+#define ODM_BB_RESET 0x002 -+#define ODM_DUMMY 0x4fe -+#define RF_T_METER_OLD 0x24 -+#define RF_T_METER_NEW 0x42 -+ -+#define ODM_EDCA_VO_PARAM 0x500 -+#define ODM_EDCA_VI_PARAM 0x504 -+#define ODM_EDCA_BE_PARAM 0x508 -+#define ODM_EDCA_BK_PARAM 0x50C -+#define ODM_TXPAUSE 0x522 -+ -+//BB REG -+#define ODM_FPGA_PHY0_PAGE8 0x800 -+#define ODM_PSD_SETTING 0x808 -+#define ODM_AFE_SETTING 0x818 -+#define ODM_TXAGC_B_6_18 0x830 -+#define ODM_TXAGC_B_24_54 0x834 -+#define ODM_TXAGC_B_MCS32_5 0x838 -+#define ODM_TXAGC_B_MCS0_MCS3 0x83c -+#define ODM_TXAGC_B_MCS4_MCS7 0x848 -+#define ODM_TXAGC_B_MCS8_MCS11 0x84c -+#define ODM_ANALOG_REGISTER 0x85c -+#define ODM_RF_INTERFACE_OUTPUT 0x860 -+#define ODM_TXAGC_B_MCS12_MCS15 0x868 -+#define ODM_TXAGC_B_11_A_2_11 0x86c -+#define ODM_AD_DA_LSB_MASK 0x874 -+#define ODM_ENABLE_3_WIRE 0x88c -+#define ODM_PSD_REPORT 0x8b4 -+#define ODM_R_ANT_SELECT 0x90c -+#define ODM_CCK_ANT_SELECT 0xa07 -+#define ODM_CCK_PD_THRESH 0xa0a -+#define ODM_CCK_RF_REG1 0xa11 -+#define ODM_CCK_MATCH_FILTER 0xa20 -+#define ODM_CCK_RAKE_MAC 0xa2e -+#define ODM_CCK_CNT_RESET 0xa2d -+#define ODM_CCK_TX_DIVERSITY 0xa2f -+#define ODM_CCK_FA_CNT_MSB 0xa5b -+#define ODM_CCK_FA_CNT_LSB 0xa5c -+#define ODM_CCK_NEW_FUNCTION 0xa75 -+#define ODM_OFDM_PHY0_PAGE_C 0xc00 -+#define ODM_OFDM_RX_ANT 0xc04 -+#define ODM_R_A_RXIQI 0xc14 -+#define ODM_R_A_AGC_CORE1 0xc50 -+#define ODM_R_A_AGC_CORE2 0xc54 -+#define ODM_R_B_AGC_CORE1 0xc58 -+#define ODM_R_AGC_PAR 0xc70 -+#define ODM_R_HTSTF_AGC_PAR 0xc7c -+#define ODM_TX_PWR_TRAINING_A 0xc90 -+#define ODM_TX_PWR_TRAINING_B 0xc98 -+#define ODM_OFDM_FA_CNT1 0xcf0 -+#define ODM_OFDM_PHY0_PAGE_D 0xd00 -+#define ODM_OFDM_FA_CNT2 0xda0 -+#define ODM_OFDM_FA_CNT3 0xda4 -+#define ODM_OFDM_FA_CNT4 0xda8 -+#define ODM_TXAGC_A_6_18 0xe00 -+#define ODM_TXAGC_A_24_54 0xe04 -+#define ODM_TXAGC_A_1_MCS32 0xe08 -+#define ODM_TXAGC_A_MCS0_MCS3 0xe10 -+#define ODM_TXAGC_A_MCS4_MCS7 0xe14 -+#define ODM_TXAGC_A_MCS8_MCS11 0xe18 -+#define ODM_TXAGC_A_MCS12_MCS15 0xe1c -+ -+//RF REG -+#define ODM_GAIN_SETTING 0x00 -+#define ODM_CHANNEL 0x18 -+ -+//Ant Detect Reg -+#define ODM_DPDT 0x300 -+ -+//PSD Init -+#define ODM_PSDREG 0x808 -+ -+//92D Path Div -+#define PATHDIV_REG 0xB30 -+#define PATHDIV_TRI 0xBA0 -+ -+ -+// -+// Bitmap Definition -+// -+ -+#define BIT_FA_RESET BIT0 -+ -+ -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/odm_types.h linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_types.h ---- linux-4.14.17/3rdparty/rtl8812au/hal/odm_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/odm_types.h 2018-02-06 17:42:30.713967209 +0200 -@@ -0,0 +1,82 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __ODM_TYPES_H__ -+#define __ODM_TYPES_H__ -+ -+// -+// Define Different SW team support -+// -+#define ODM_AP 0x01 //BIT0 -+#define ODM_ADSL 0x02 //BIT1 -+#define ODM_CE 0x04 //BIT2 -+#define ODM_WIN 0x08 //BIT3 -+ -+#define RT_PCI_INTERFACE 1 -+#define RT_USB_INTERFACE 2 -+#define RT_SDIO_INTERFACE 3 -+ -+typedef enum _HAL_STATUS{ -+ HAL_STATUS_SUCCESS, -+ HAL_STATUS_FAILURE, -+}HAL_STATUS,*PHAL_STATUS; -+ -+typedef enum _RT_SPINLOCK_TYPE{ -+ RT_TEMP =1, -+}RT_SPINLOCK_TYPE; -+ -+ #include -+ -+ #define u1Byte u8 -+ #define pu1Byte u8* -+ -+ #define u2Byte u16 -+ #define pu2Byte u16* -+ -+ #define u4Byte u32 -+ #define pu4Byte u32* -+ -+ #define u8Byte u64 -+ #define pu8Byte u64* -+ -+ #define s1Byte s8 -+ #define ps1Byte s8* -+ -+ #define s2Byte s16 -+ #define ps2Byte s16* -+ -+ #define s4Byte s32 -+ #define ps4Byte s32* -+ -+ #define s8Byte s64 -+ #define ps8Byte s64* -+ -+ #define DEV_BUS_TYPE RT_USB_INTERFACE -+ -+ typedef struct timer_list RT_TIMER, *PRT_TIMER; -+ typedef void * RT_TIMER_CALL_BACK; -+ #define STA_INFO_T struct sta_info -+ #define PSTA_INFO_T struct sta_info * -+ -+ #define SET_TX_DESC_ANTSEL_A_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 1, __Value) -+ #define SET_TX_DESC_ANTSEL_B_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 25, 1, __Value) -+ #define SET_TX_DESC_ANTSEL_C_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 29, 1, __Value) -+ -+ //define useless flag to avoid compile warning -+ #define USE_WORKITEM 0 -+ #define FOR_BRAZIL_PRETEST 0 -+ #define BT_30_SUPPORT 0 -+ #define FPGA_TWO_MAC_VERIFICATION 0 -+ -+#endif // __ODM_TYPES_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_cmd.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_cmd.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_cmd.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_cmd.c 2018-02-06 17:42:30.713967209 +0200 -@@ -0,0 +1,1338 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8812A_CMD_C_ -+ -+//#include -+#include -+ -+#define CONFIG_H2C_EF -+ -+#define RTL8812_MAX_H2C_BOX_NUMS 4 -+#define RTL8812_MAX_CMD_LEN 7 -+#define RTL8812_MESSAGE_BOX_SIZE 4 -+#define RTL8812_EX_MESSAGE_BOX_SIZE 4 -+ -+ -+static u8 _is_fw_read_cmd_down(_adapter* padapter, u8 msgbox_num) -+{ -+ u8 read_down = false; -+ int retry_cnts = 100; -+ -+ u8 valid; -+ -+ //DBG_8192C(" _is_fw_read_cmd_down ,reg_1cc(%x),msg_box(%d)...\n",rtw_read8(padapter,REG_HMETFR),msgbox_num); -+ -+ do{ -+ valid = rtw_read8(padapter,REG_HMETFR) & BIT(msgbox_num); -+ if(0 == valid ){ -+ read_down = true; -+ } -+#ifdef CONFIG_WOWLAN -+ rtw_msleep_os(2); -+#endif -+ }while( (!read_down) && (retry_cnts--)); -+ -+ return read_down; -+ -+} -+ -+ -+/***************************************** -+* H2C Msg format : -+* 0x1DF - 0x1D0 -+*| 31 - 8 | 7-5 4 - 0 | -+*| h2c_msg |Class_ID CMD_ID | -+* -+* Extend 0x1FF - 0x1F0 -+*|31 - 0 | -+*|ext_msg| -+******************************************/ -+static s32 FillH2CCmd_8812(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) -+{ -+ u8 bcmd_down = false; -+ s32 retry_cnts = 100; -+ u8 h2c_box_num; -+ u32 msgbox_addr; -+ u32 msgbox_ex_addr; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 cmd_idx,ext_cmd_len; -+ u32 h2c_cmd = 0; -+ u32 h2c_cmd_ex = 0; -+ s32 ret = _FAIL; -+ -+ -+ -+ padapter = GET_PRIMARY_ADAPTER(padapter); -+ pHalData = GET_HAL_DATA(padapter); -+ -+ -+ if(padapter->bFWReady == false) -+ { -+ //DBG_8192C("FillH2CCmd_8812(): return H2C cmd because fw is not ready\n"); -+ return ret; -+ } -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->h2c_fwcmd_mutex), NULL); -+ -+ -+ if (!pCmdBuffer) { -+ goto exit; -+ } -+ if (CmdLen > RTL8812_MAX_CMD_LEN) { -+ goto exit; -+ } -+ if (padapter->bSurpriseRemoved == true) -+ goto exit; -+ -+ //pay attention to if race condition happened in H2C cmd setting. -+ do{ -+ h2c_box_num = pHalData->LastHMEBoxNum; -+ -+ if(!_is_fw_read_cmd_down(padapter, h2c_box_num)){ -+ DBG_8192C(" fw read cmd failed...\n"); -+ goto exit; -+ } -+ -+ *(u8*)(&h2c_cmd) = ElementID; -+ -+ if(CmdLen<=3) -+ { -+ _rtw_memcpy((u8*)(&h2c_cmd)+1, pCmdBuffer, CmdLen ); -+ } -+ else{ -+ _rtw_memcpy((u8*)(&h2c_cmd)+1, pCmdBuffer,3); -+ ext_cmd_len = CmdLen-3; -+ _rtw_memcpy((u8*)(&h2c_cmd_ex), pCmdBuffer+3,ext_cmd_len ); -+ -+ //Write Ext command -+ msgbox_ex_addr = REG_HMEBOX_EXT0_8812 + (h2c_box_num *RTL8812_EX_MESSAGE_BOX_SIZE); -+ #ifdef CONFIG_H2C_EF -+ for(cmd_idx=0;cmd_idxh2c_cmd:0x%x, reg:0x%x =>h2c_cmd_ex:0x%x ..\n" -+ // ,pHalData->LastHMEBoxNum ,CmdLen,msgbox_addr,h2c_cmd,msgbox_ex_addr,h2c_cmd_ex); -+ -+ pHalData->LastHMEBoxNum = (h2c_box_num+1) % RTL8812_MAX_H2C_BOX_NUMS; -+ -+ }while((!bcmd_down) && (retry_cnts--)); -+ -+ ret = _SUCCESS; -+ -+exit: -+ -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->h2c_fwcmd_mutex), NULL); -+ -+ -+ -+ return ret; -+} -+ -+static u8 rtl8812_h2c_msg_hdl(_adapter *padapter, unsigned char *pbuf) -+{ -+ u8 ElementID, CmdLen; -+ u8 *pCmdBuffer; -+ struct cmd_msg_parm *pcmdmsg; -+ -+ if(!pbuf) -+ return H2C_PARAMETERS_ERROR; -+ -+ pcmdmsg = (struct cmd_msg_parm*)pbuf; -+ ElementID = pcmdmsg->eid; -+ CmdLen = pcmdmsg->sz; -+ pCmdBuffer = pcmdmsg->buf; -+ -+ FillH2CCmd_8812(padapter, ElementID, CmdLen, pCmdBuffer); -+ -+ return H2C_SUCCESS; -+} -+ -+u8 rtl8812_set_rssi_cmd(_adapter*padapter, u8 *param) -+{ -+ u8 res=_SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ *((__le32*) param ) = cpu_to_le32( *((u32*) param ) ); -+ -+ FillH2CCmd_8812(padapter, H2C_8812_RSSI_REPORT, 4, param); -+ -+ -+ -+ return res; -+} -+ -+static u8 Get_VHT_ENI( -+ u32 IOTAction, -+ u32 WirelessMode, -+ u32 ratr_bitmap -+ ) -+{ -+ u8 Ret = 0; -+ -+ if(WirelessMode == WIRELESS_11_24AC) -+ { -+ if(ratr_bitmap & 0xfff00000) // Mix , 2SS -+ Ret = 3; -+ else // Mix, 1SS -+ Ret = 2; -+ } -+ else if(WirelessMode == WIRELESS_11_5AC) -+ { -+ Ret = 1; // VHT -+ } -+ -+ return (Ret << 4); -+} -+ -+static bool -+Get_RA_ShortGI( -+ PADAPTER Adapter, -+ struct sta_info *psta, -+ u8 shortGIrate -+) -+{ -+ bool bShortGI; -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ bShortGI = shortGIrate; -+ -+#ifdef CONFIG_80211AC_VHT -+ if( bShortGI && -+ IsSupportedVHT(psta->wireless_mode) && -+ (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP) && -+ TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX) -+ ) -+ { -+ if(psta->vhtpriv.vht_highest_rate >= MGN_VHT2SS_MCS8) -+ bShortGI = false; -+ } -+#endif -+ -+ return bShortGI; -+} -+ -+ -+void -+Set_RA_LDPC_8812( -+ struct sta_info *psta, -+ bool bLDPC -+ ) -+{ -+ if(psta == NULL) -+ return; -+#ifdef CONFIG_80211AC_VHT -+ if(psta->wireless_mode == WIRELESS_11_5AC) -+ { -+ if(bLDPC && TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_CAP_TX)) -+ SET_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX); -+ else -+ CLEAR_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX); -+ } -+ else if(IsSupportedTxHT(psta->wireless_mode) || IsSupportedVHT(psta->wireless_mode)) -+ { -+ if(bLDPC && TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_CAP_TX)) -+ SET_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX); -+ else -+ CLEAR_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX); -+ } -+#endif -+ -+ //DBG_871X("MacId %d bLDPC %d\n", psta->mac_id, bLDPC); -+} -+ -+ -+static u8 -+Get_RA_LDPC_8812( -+ struct sta_info *psta -+) -+{ -+ u8 bLDPC = 0; -+ -+ if(psta->mac_id == 1) -+ bLDPC = 0; -+ else if(psta != NULL) -+ { -+#ifdef CONFIG_80211AC_VHT -+ if(IsSupportedVHT(psta->wireless_mode)) -+ { -+ if(TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_CAP_TX)) -+ bLDPC = 1; -+ else -+ bLDPC = 0; -+ } -+ else if(IsSupportedTxHT(psta->wireless_mode)) -+ { -+ if(TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_CAP_TX)) -+ bLDPC =1; -+ else -+ bLDPC =0; -+ } -+ else -+#endif -+ bLDPC = 0; -+ } -+ -+ return (bLDPC << 2); -+} -+ -+void rtl8812_set_raid_cmd(PADAPTER padapter, u32 bitmap, u8* arg) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct sta_info *psta; -+ u8 macid, init_rate, raid, shortGIrate=false; -+ -+ -+ -+ macid = arg[0]; -+ raid = arg[1]; -+ shortGIrate = arg[2]; -+ init_rate = arg[3]; -+ -+ psta = pmlmeinfo->FW_sta_info[macid].psta; -+ if(psta == NULL) -+ { -+ return; -+ } -+ -+ if(pHalData->fw_ractrl == true) -+ { -+ u8 H2CCommand[7] ={0}; -+ -+ shortGIrate = Get_RA_ShortGI(padapter, psta, shortGIrate); -+ -+ H2CCommand[0] = macid; -+ H2CCommand[1] = (raid & 0x1F) | (shortGIrate?0x80:0x00) ; -+ H2CCommand[2] = (pmlmeext->cur_bwmode & 0x3) |Get_RA_LDPC_8812(psta) |Get_VHT_ENI(0, psta->wireless_mode, bitmap); -+ -+ H2CCommand[3] = (u8)(bitmap & 0x000000ff); -+ H2CCommand[4] = (u8)((bitmap & 0x0000ff00) >>8); -+ H2CCommand[5] = (u8)((bitmap & 0x00ff0000) >> 16); -+ H2CCommand[6] = (u8)((bitmap & 0xff000000) >> 24); -+ -+ DBG_871X("rtl8812_set_raid_cmd, bitmap=0x%x, mac_id=0x%x, raid=0x%x, shortGIrate=%x\n", bitmap, macid, raid, shortGIrate); -+ -+ FillH2CCmd_8812(padapter, H2C_8812_RA_MASK, 7, H2CCommand); -+ } -+ -+ if (shortGIrate==true) -+ init_rate |= BIT(7); -+ -+ pdmpriv->INIDATA_RATE[macid] = init_rate; -+ -+ -+ -+} -+ -+void rtl8812_Add_RateATid(PADAPTER pAdapter, u32 bitmap, u8* arg, u8 rssi_level) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 macid; -+ -+ macid = arg[0]; -+ -+#ifdef CONFIG_ODM_REFRESH_RAMASK -+ if(rssi_level != DM_RATR_STA_INIT) -+ bitmap = ODM_Get_Rate_Bitmap(&pHalData->odmpriv, macid, bitmap, rssi_level); -+#endif //CONFIG_ODM_REFRESH_RAMASK -+ -+ rtl8812_set_raid_cmd(pAdapter, bitmap, arg); -+} -+ -+void rtl8812_set_FwPwrMode_cmd(PADAPTER padapter, u8 PSMode) -+{ -+ u8 u1H2CSetPwrMode[5]={0}; -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ u8 Mode = 0, RLBM = 0, PowerState = 0, LPSAwakeIntvl = 1; -+ -+ -+ -+ DBG_871X("%s: Mode=%d SmartPS=%d UAPSD=%d\n", __FUNCTION__, -+ PSMode, pwrpriv->smart_ps, padapter->registrypriv.uapsd_enable); -+ -+ switch(PSMode) -+ { -+ case PS_MODE_ACTIVE: -+ Mode = 0; -+ break; -+ case PS_MODE_MIN: -+ Mode = 1; -+ break; -+ case PS_MODE_MAX: -+ RLBM = 1; -+ Mode = 1; -+ break; -+ case PS_MODE_DTIM: -+ RLBM = 2; -+ Mode = 1; -+ break; -+ case PS_MODE_UAPSD_WMM: -+ Mode = 2; -+ break; -+ default: -+ Mode = 0; -+ break; -+ } -+ -+ if (Mode > PS_MODE_ACTIVE) { -+ PowerState = 0x00;// AllON(0x0C), RFON(0x04), RFOFF(0x00) -+#ifdef CONFIG_EXT_CLK -+ Mode |= BIT(7);//supporting 26M XTAL CLK_Request feature. -+#endif //CONFIG_EXT_CLK -+ } else { -+ PowerState = 0x0C;// AllON(0x0C), RFON(0x04), RFOFF(0x00) -+ } -+ -+ // 0: Active, 1: LPS, 2: WMMPS -+ SET_8812_H2CCMD_PWRMODE_PARM_MODE(u1H2CSetPwrMode, Mode); -+ -+ // 0:Min, 1:Max , 2:User define -+ SET_8812_H2CCMD_PWRMODE_PARM_RLBM(u1H2CSetPwrMode, RLBM); -+ -+ // (LPS) smart_ps: 0: PS_Poll, 1: PS_Poll , 2: NullData -+ // (WMM)smart_ps: 0:PS_Poll, 1:NullData -+ SET_8812_H2CCMD_PWRMODE_PARM_SMART_PS(u1H2CSetPwrMode, pwrpriv->smart_ps); -+ -+ // AwakeInterval: Unit is beacon interval, this field is only valid in PS_DTIM mode -+ SET_8812_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(u1H2CSetPwrMode, LPSAwakeIntvl); -+ -+ // (WMM only)bAllQueueUAPSD -+ SET_8812_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(u1H2CSetPwrMode, padapter->registrypriv.uapsd_enable); -+ -+ // AllON(0x0C), RFON(0x04), RFOFF(0x00) -+ SET_8812_H2CCMD_PWRMODE_PARM_PWR_STATE(u1H2CSetPwrMode, PowerState); -+ -+ FillH2CCmd_8812(padapter, H2C_8812_SETPWRMODE, sizeof(u1H2CSetPwrMode), (u8 *)&u1H2CSetPwrMode); -+ -+ -+} -+ -+void rtl8812_set_FwMediaStatus_cmd(PADAPTER padapter, u16 mstatus_rpt ) -+{ -+ u8 u1JoinBssRptParm[3]={0}; -+ u8 mstatus, macId, macId_Ind = 0, macId_End = 0; -+ -+ mstatus = (u8) (mstatus_rpt & 0xFF); -+ macId = (u8)(mstatus_rpt >> 8) ; -+ -+ SET_8812_H2CCMD_MSRRPT_PARM_OPMODE(u1JoinBssRptParm, mstatus); -+ SET_8812_H2CCMD_MSRRPT_PARM_MACID_IND(u1JoinBssRptParm, macId_Ind); -+ -+ SET_8812_H2CCMD_MSRRPT_PARM_MACID(u1JoinBssRptParm, macId); -+ SET_8812_H2CCMD_MSRRPT_PARM_MACID_END(u1JoinBssRptParm, macId_End); -+ -+ DBG_871X("[MacId], Set MacId Ctrl(original) = 0x%x \n", u1JoinBssRptParm[0]<<16|u1JoinBssRptParm[1]<<8|u1JoinBssRptParm[2]); -+ -+ FillH2CCmd_8812(padapter, H2C_8812_MSRRPT, 3, u1JoinBssRptParm); -+} -+ -+static void ConstructBeacon(_adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ u32 rate_len, pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ //pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_BEACON); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pktlen = sizeof (struct rtw_ieee80211_hdr_3addr); -+ -+ //timestamp will be inserted by hardware -+ pframe += 8; -+ pktlen += 8; -+ -+ // beacon interval: 2 bytes -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ // capability info: 2 bytes -+ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); -+ -+ pframe += 2; -+ pktlen += 2; -+ -+ if( (pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ { -+ //DBG_871X("ie len=%d\n", cur_network->IELength); -+ pktlen += cur_network->IELength - sizeof(NDIS_802_11_FIXED_IEs); -+ _rtw_memcpy(pframe, cur_network->IEs+sizeof(NDIS_802_11_FIXED_IEs), pktlen); -+ -+ goto _ConstructBeacon; -+ } -+ -+ //below for ad-hoc mode -+ -+ // SSID -+ pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen); -+ -+ // supported rates... -+ rate_len = rtw_get_rateset_len(cur_network->SupportedRates); -+ pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8)? 8: rate_len), cur_network->SupportedRates, &pktlen); -+ -+ // DS parameter set -+ pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen); -+ -+ if( (pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) -+ { -+ u32 ATIMWindow; -+ // IBSS Parameter Set... -+ //ATIMWindow = cur->Configuration.ATIMWindow; -+ ATIMWindow = 0; -+ pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen); -+ } -+ -+ -+ //todo: ERP IE -+ -+ -+ // EXTERNDED SUPPORTED RATE -+ if (rate_len > 8) -+ { -+ pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); -+ } -+ -+ -+ //todo:HT for adhoc -+ -+_ConstructBeacon: -+ -+ if ((pktlen + TXDESC_SIZE) > 512) -+ { -+ DBG_871X("beacon frame too large\n"); -+ return; -+ } -+ -+ *pLength = pktlen; -+ -+ //DBG_871X("%s bcn_sz=%d\n", __FUNCTION__, pktlen); -+ -+} -+ -+static void ConstructPSPoll(_adapter *padapter, u8 *pframe, u32 *pLength) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ u32 pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ // Frame control. -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ SetPwrMgt(fctrl); -+ SetFrameSubType(pframe, WIFI_PSPOLL); -+ -+ // AID. -+ SetDuration(pframe, (pmlmeinfo->aid | 0xc000)); -+ -+ // BSSID. -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ // TA. -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ -+ *pLength = 16; -+} -+ -+static void ConstructNullFunctionData( -+ PADAPTER padapter, -+ u8 *pframe, -+ u32 *pLength, -+ u8 *StaAddr, -+ u8 bQoS, -+ u8 AC, -+ u8 bEosp, -+ u8 bForcePowerSave) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ u32 pktlen; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &pmlmepriv->cur_network; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ -+ //DBG_871X("%s:%d\n", __FUNCTION__, bForcePowerSave); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; -+ -+ fctrl = &pwlanhdr->frame_ctl; -+ *(fctrl) = 0; -+ if (bForcePowerSave) -+ { -+ SetPwrMgt(fctrl); -+ } -+ -+ switch(cur_network->network.InfrastructureMode) -+ { -+ case Ndis802_11Infrastructure: -+ SetToDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, StaAddr, ETH_ALEN); -+ break; -+ case Ndis802_11APMode: -+ SetFrDs(fctrl); -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ break; -+ case Ndis802_11IBSS: -+ default: -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ break; -+ } -+ -+ SetSeqNum(pwlanhdr, 0); -+ -+ if (bQoS == true) { -+ struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; -+ -+ SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); -+ -+ pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos*)pframe; -+ SetPriority(&pwlanqoshdr->qc, AC); -+ SetEOSP(&pwlanqoshdr->qc, bEosp); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); -+ } else { -+ SetFrameSubType(pframe, WIFI_DATA_NULL); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ } -+ -+ *pLength = pktlen; -+} -+ -+static void ConstructProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength, u8 *StaAddr, bool bHideSSID) -+{ -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ __le16 *fctrl; -+ u8 *mac, *bssid; -+ u32 pktlen; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ mac = myid(&(padapter->eeprompriv)); -+ bssid = cur_network->MacAddress; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, 0); -+ SetFrameSubType(fctrl, WIFI_PROBERSP); -+ -+ pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ pframe += pktlen; -+ -+ if(cur_network->IELength>MAX_IE_SZ) -+ return; -+ -+ _rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength); -+ pframe += cur_network->IELength; -+ pktlen += cur_network->IELength; -+ -+ *pLength = pktlen; -+} -+ -+// To check if reserved page content is destroyed by beacon beacuse beacon is too large. -+// 2010.06.23. Added by tynli. -+void -+CheckFwRsvdPageContent( -+ PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE* pHalData = GET_HAL_DATA(Adapter); -+ u32 MaxBcnPageNum; -+ -+ if(pHalData->FwRsvdPageStartOffset != 0) -+ { -+ /*MaxBcnPageNum = PageNum_128(pMgntInfo->MaxBeaconSize); -+ RT_ASSERT((MaxBcnPageNum <= pHalData->FwRsvdPageStartOffset), -+ ("CheckFwRsvdPageContent(): The reserved page content has been"\ -+ "destroyed by beacon!!! MaxBcnPageNum(%d) FwRsvdPageStartOffset(%d)\n!", -+ MaxBcnPageNum, pHalData->FwRsvdPageStartOffset));*/ -+ } -+} -+ -+// -+// Description: Get the reserved page number in Tx packet buffer. -+// Retrun value: the page number. -+// 2012.08.09, by tynli. -+// -+static u8 -+GetTxBufferRsvdPageNum8812( -+ PADAPTER Adapter, -+ bool bWoWLANBoundary -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 RsvdPageNum=0; -+ u8 TxPageBndy= LAST_ENTRY_OF_TX_PKT_BUFFER_8812; // default reseved 1 page for the IC type which is undefined. -+ -+ if(bWoWLANBoundary) -+ { -+ rtw_hal_get_def_var(Adapter, HAL_DEF_TX_PAGE_BOUNDARY_WOWLAN, (u8 *)&TxPageBndy); -+ } -+ else -+ { -+ rtw_hal_get_def_var(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&TxPageBndy); -+ } -+ -+ RsvdPageNum = LAST_ENTRY_OF_TX_PKT_BUFFER_8812 -TxPageBndy + 1; -+ -+ return RsvdPageNum; -+} -+ -+// -+// Description: Fill the reserved packets that FW will use to RSVD page. -+// Now we just send 4 types packet to rsvd page. -+// (1)Beacon, (2)Ps-poll, (3)Null data, (4)ProbeRsp. -+// Input: -+// bDLFinished - false: At the first time we will send all the packets as a large packet to Hw, -+// so we need to set the packet length to total lengh. -+// true: At the second time, we should send the first packet (default:beacon) -+// to Hw again and set the lengh in descriptor to the real beacon lengh. -+// 2009.10.15 by tynli. -+static void SetFwRsvdPagePkt_8812(PADAPTER padapter, bool bDLFinished) -+{ -+ PHAL_DATA_TYPE pHalData; -+ struct xmit_frame *pcmdframe; -+ struct pkt_attrib *pattrib; -+ struct xmit_priv *pxmitpriv; -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ u32 PSPollLength, NullFunctionDataLength, QosNullLength; -+ u32 BcnLen; -+ u8 TotalPageNum=0, CurtPktPageNum=0, TxDescLen=0, RsvdPageNum=0; -+ u8 *ReservedPagePacket; -+ u8 RsvdPageLoc[5] = {0}; -+ u16 BufIndex=0, PageSize = 256; -+ u32 TotalPacketLen, MaxRsvdPageBufSize=0;; -+ -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pxmitpriv = &padapter->xmitpriv; -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ -+ if(IS_HARDWARE_TYPE_8812(padapter)) -+ PageSize = 512; -+ else if (IS_HARDWARE_TYPE_8821(padapter)) -+ PageSize = PAGE_SIZE_TX_8821A; -+ -+ // The function SetFwRsvdPagePkt_8812() input must be added a value "bDLWholePackets" to -+ // decide if download wowlan packets, and use "bDLWholePackets" to be GetTxBufferRsvdPageNum8812() 2nd input value. -+ RsvdPageNum = GetTxBufferRsvdPageNum8812(padapter, false); -+ MaxRsvdPageBufSize = RsvdPageNum*PageSize; -+ -+ pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv, MaxRsvdPageBufSize); -+ if (pcmdframe == NULL) { -+ return; -+ } -+ -+ ReservedPagePacket = pcmdframe->buf_addr; -+ -+ TxDescLen = TXDESC_SIZE;//The desc lengh in Tx packet buffer of 8812A is 40 bytes. -+ -+ //(1) beacon -+ BufIndex = TXDESC_OFFSET; -+ ConstructBeacon(padapter, &ReservedPagePacket[BufIndex], &BcnLen); -+ -+ // When we count the first page size, we need to reserve description size for the RSVD -+ // packet, it will be filled in front of the packet in TXPKTBUF. -+ CurtPktPageNum = (u8)PageNum(BcnLen+TxDescLen, PageSize); -+ -+ if(bDLFinished) -+ { -+ TotalPageNum += CurtPktPageNum; -+ TotalPacketLen = (TotalPageNum*PageSize); -+ DBG_871X("%s(): Beacon page size = %d\n",__FUNCTION__,TotalPageNum); -+ } -+ else -+ { -+ TotalPageNum += CurtPktPageNum; -+ -+ pHalData->FwRsvdPageStartOffset = TotalPageNum; -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ if(BufIndex > MaxRsvdPageBufSize) -+ { -+ DBG_871X("%s(): Beacon: The rsvd page size is not enough!!BufIndex %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, -+ BufIndex,MaxRsvdPageBufSize); -+ goto error; -+ } -+ -+ //(2) ps-poll -+ ConstructPSPoll(padapter, &ReservedPagePacket[BufIndex], &PSPollLength); -+ rtl8812a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], PSPollLength, true, false); -+ -+ SET_8812_H2CCMD_RSVDPAGE_LOC_PSPOLL(RsvdPageLoc, TotalPageNum); -+ -+ //DBG_871X("SetFwRsvdPagePkt_8812(): HW_VAR_SET_TX_CMD: PS-POLL %p %d\n", -+ // &ReservedPagePacket[BufIndex-TxDescLen], (PSPollLength+TxDescLen)); -+ -+ CurtPktPageNum = (u8)PageNum(PSPollLength+TxDescLen, PageSize); -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ if(BufIndex > MaxRsvdPageBufSize) -+ { -+ DBG_871X("%s(): ps-poll: The rsvd page size is not enough!!BufIndex %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, -+ BufIndex,MaxRsvdPageBufSize); -+ goto error; -+ } -+ -+ //(3) null data -+ ConstructNullFunctionData( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &NullFunctionDataLength, -+ get_my_bssid(&pmlmeinfo->network), -+ false, 0, 0, false); -+ rtl8812a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], NullFunctionDataLength, false, false); -+ -+ SET_8812_H2CCMD_RSVDPAGE_LOC_NULL_DATA(RsvdPageLoc, TotalPageNum); -+ -+ //DBG_871X("SetFwRsvdPagePkt_8812(): HW_VAR_SET_TX_CMD: NULL DATA %p %d\n", -+ // &ReservedPagePacket[BufIndex-TxDescLen], (NullFunctionDataLength+TxDescLen)); -+ -+ CurtPktPageNum = (u8)PageNum(NullFunctionDataLength+TxDescLen, PageSize); -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ if(BufIndex > MaxRsvdPageBufSize) -+ { -+ DBG_871X("%s(): Null-data: The rsvd page size is not enough!!BufIndex %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, -+ BufIndex,MaxRsvdPageBufSize); -+ goto error; -+ } -+ -+ //(5) Qos null data -+ ConstructNullFunctionData( -+ padapter, -+ &ReservedPagePacket[BufIndex], -+ &QosNullLength, -+ get_my_bssid(&pmlmeinfo->network), -+ true, 0, 0, false); -+ rtl8812a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], QosNullLength, false, false); -+ -+ SET_8812_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(RsvdPageLoc, TotalPageNum); -+ -+ //DBG_871X("SetFwRsvdPagePkt_8812(): HW_VAR_SET_TX_CMD: QOS NULL DATA %p %d\n", -+ // &ReservedPagePacket[BufIndex-TxDescLen], (QosNullLength+TxDescLen)); -+ -+ CurtPktPageNum = (u8)PageNum(QosNullLength+TxDescLen, PageSize); -+ -+ BufIndex += (CurtPktPageNum*PageSize); -+ -+ TotalPageNum += CurtPktPageNum; -+ -+ TotalPacketLen = (TotalPageNum * PageSize); -+ } -+ -+ -+ if(TotalPacketLen > MaxRsvdPageBufSize) -+ { -+ DBG_871X("%s(): ERROR: The rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n",__FUNCTION__, -+ TotalPacketLen,MaxRsvdPageBufSize); -+ goto error; -+ } -+ else -+ { -+ // update attribute -+ pattrib = &pcmdframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->qsel = 0x10; -+ pattrib->pktlen = pattrib->last_txcmdsz = TotalPacketLen - TxDescLen; -+ -+ dump_mgntframe_and_wait(padapter, pcmdframe, 100); -+ } -+ -+ if(!bDLFinished) -+ { -+ DBG_871X("%s: Set RSVD page location to Fw ,TotalPacketLen(%d), TotalPageNum(%d)\n", __FUNCTION__,TotalPacketLen,TotalPageNum); -+ FillH2CCmd_8812(padapter, H2C_8812_RSVDPAGE, 5, RsvdPageLoc); -+ } -+ -+ rtw_free_cmd_xmitbuf(pxmitpriv); -+ -+ return; -+ -+error: -+ rtw_free_cmdxmitframe(pxmitpriv, pcmdframe); -+} -+ -+void rtl8812_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ bool bSendBeacon=false; -+ bool bcn_valid = false; -+ u8 DLBcnCount=0; -+ u32 poll = 0; -+ -+ -+ -+ DBG_871X("%s mstatus(%x)\n", __FUNCTION__,mstatus); -+ -+ if(mstatus == 1) -+ { -+ // We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. -+ // Suggested by filen. Added by tynli. -+ rtw_write16(padapter, REG_BCN_PSR_RPT, (0xC000|pmlmeinfo->aid)); -+ // Do not set TSF again here or vWiFi beacon DMA INT will not work. -+ //correct_TSF(padapter, pmlmeext); -+ // Hw sequende enable by dedault. 2010.06.23. by tynli. -+ //rtw_write16(padapter, REG_NQOS_SEQ, ((pmlmeext->mgnt_seq+100)&0xFFF)); -+ //rtw_write8(padapter, REG_HWSEQ_CTRL, 0xFF); -+ -+ //Set REG_CR bit 8. DMA beacon by SW. -+ pHalData->RegCR_1 |= BIT0; -+ rtw_write8(padapter, REG_CR+1, pHalData->RegCR_1); -+ -+ // Disable Hw protection for a time which revserd for Hw sending beacon. -+ // Fix download reserved page packet fail that access collision with the protection time. -+ // 2010.05.11. Added by tynli. -+ //SetBcnCtrlReg(padapter, 0, BIT3); -+ //SetBcnCtrlReg(padapter, BIT4, 0); -+ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)&(~BIT(3))); -+ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)|BIT(4)); -+ -+ if(pHalData->RegFwHwTxQCtrl&BIT6) -+ { -+ DBG_871X("HalDownloadRSVDPage(): There is an Adapter is sending beacon.\n"); -+ bSendBeacon = true; -+ } -+ -+ // Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, (pHalData->RegFwHwTxQCtrl&(~BIT6))); -+ pHalData->RegFwHwTxQCtrl &= (~BIT6); -+ -+ // Clear beacon valid check bit. -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ DLBcnCount = 0; -+ poll = 0; -+ do -+ { -+ // download rsvd page. -+ SetFwRsvdPagePkt_8812(padapter, false); -+ DLBcnCount++; -+ do -+ { -+ rtw_yield_os(); -+ //rtw_mdelay_os(10); -+ // check rsvd page download OK. -+ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8*)(&bcn_valid)); -+ poll++; -+ } while(!bcn_valid && (poll%10)!=0 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); -+ -+ }while(!bcn_valid && DLBcnCount<=100 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); -+ -+ //RT_ASSERT(bcn_valid, ("HalDownloadRSVDPage88ES(): 1 Download RSVD page failed!\n")); -+ if(padapter->bSurpriseRemoved || padapter->bDriverStopped) -+ { -+ } -+ else if(!bcn_valid) -+ DBG_871X("%s: 1 Download RSVD page failed! DLBcnCount:%u, poll:%u\n", __FUNCTION__ ,DLBcnCount, poll); -+ else -+ DBG_871X("%s: 1 Download RSVD success! DLBcnCount:%u, poll:%u\n", __FUNCTION__, DLBcnCount, poll); -+ // -+ // We just can send the reserved page twice during the time that Tx thread is stopped (e.g. pnpsetpower) -+ // becuase we need to free the Tx BCN Desc which is used by the first reserved page packet. -+ // At run time, we cannot get the Tx Desc until it is released in TxHandleInterrupt() so we will return -+ // the beacon TCB in the following code. 2011.11.23. by tynli. -+ // -+ //if(bcn_valid && padapter->bEnterPnpSleep) -+ if(0) -+ { -+ if(bSendBeacon) -+ { -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ DLBcnCount = 0; -+ poll = 0; -+ do -+ { -+ SetFwRsvdPagePkt_8812(padapter, true); -+ DLBcnCount++; -+ -+ do -+ { -+ rtw_yield_os(); -+ //rtw_mdelay_os(10); -+ // check rsvd page download OK. -+ rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8*)(&bcn_valid)); -+ poll++; -+ } while(!bcn_valid && (poll%10)!=0 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); -+ }while(!bcn_valid && DLBcnCount<=100 && !padapter->bSurpriseRemoved && !padapter->bDriverStopped); -+ -+ //RT_ASSERT(bcn_valid, ("HalDownloadRSVDPage(): 2 Download RSVD page failed!\n")); -+ if(padapter->bSurpriseRemoved || padapter->bDriverStopped) -+ { -+ } -+ else if(!bcn_valid) -+ DBG_871X("%s: 2 Download RSVD page failed! DLBcnCount:%u, poll:%u\n", __FUNCTION__ ,DLBcnCount, poll); -+ else -+ DBG_871X("%s: 2 Download RSVD success! DLBcnCount:%u, poll:%u\n", __FUNCTION__, DLBcnCount, poll); -+ } -+ } -+ -+ // Enable Bcn -+ //SetBcnCtrlReg(padapter, BIT3, 0); -+ //SetBcnCtrlReg(padapter, 0, BIT4); -+ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)|BIT(3)); -+ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)&(~BIT(4))); -+ -+ // To make sure that if there exists an adapter which would like to send beacon. -+ // If exists, the origianl value of 0x422[6] will be 1, we should check this to -+ // prevent from setting 0x422[6] to 0 after download reserved page, or it will cause -+ // the beacon cannot be sent by HW. -+ // 2010.06.23. Added by tynli. -+ if(bSendBeacon) -+ { -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, (pHalData->RegFwHwTxQCtrl|BIT6)); -+ pHalData->RegFwHwTxQCtrl |= BIT6; -+ } -+ -+ // -+ // Update RSVD page location H2C to Fw. -+ // -+ if(bcn_valid) -+ { -+ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); -+ DBG_871X("Set RSVD page location to Fw.\n"); -+ //FillH2CCmd88E(Adapter, H2C_88E_RSVDPAGE, H2C_RSVDPAGE_LOC_LENGTH, pMgntInfo->u1RsvdPageLoc); -+ } -+ -+ // Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli. -+ //if(!padapter->bEnterPnpSleep) -+ { -+ // Clear CR[8] or beacon packet will not be send to TxBuf anymore. -+ pHalData->RegCR_1 &= (~BIT0); -+ rtw_write8(padapter, REG_CR+1, pHalData->RegCR_1); -+ } -+ } -+#ifdef CONFIG_WOWLAN -+ if (padapter->pwrctrlpriv.wowlan_mode){ -+ u16 media_status; -+ -+ media_status = mstatus; -+ rtl8812_set_FwMediaStatus_cmd(padapter, media_status); -+ DBG_871X_LEVEL(_drv_info_, "%s wowlan_mode is on\n", __func__); -+ } else { -+ DBG_871X_LEVEL(_drv_info_, "%s wowlan_mode is off\n", __func__); -+ } -+#endif //CONFIG_WOWLAN -+ -+} -+ -+#ifdef CONFIG_P2P_PS -+void rtl8812_set_p2p_ps_offload_cmd(_adapter* padapter, u8 p2p_ps_state) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ u8 *p2p_ps_offload = (u8 *)&pHalData->p2p_ps_offload; -+ u8 i; -+ -+ -+ -+#if 1 -+ switch(p2p_ps_state) -+ { -+ case P2P_PS_DISABLE: -+ DBG_8192C("P2P_PS_DISABLE \n"); -+ _rtw_memset(p2p_ps_offload, 0, 1); -+ break; -+ case P2P_PS_ENABLE: -+ DBG_8192C("P2P_PS_ENABLE \n"); -+ // update CTWindow value. -+ if( pwdinfo->ctwindow > 0 ) -+ { -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(p2p_ps_offload, 1); -+ rtw_write8(padapter, REG_P2P_CTWIN, pwdinfo->ctwindow); -+ } -+ -+ // hw only support 2 set of NoA -+ for( i=0 ; inoa_num ; i++) -+ { -+ // To control the register setting for which NOA -+ rtw_write8(padapter, REG_NOA_DESC_SEL, (i << 4)); -+ if(i == 0) { -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(p2p_ps_offload, 1); -+ } else { -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(p2p_ps_offload, 1); -+ } -+ -+ // config P2P NoA Descriptor Register -+ //DBG_8192C("%s(): noa_duration = %x\n",__FUNCTION__,pwdinfo->noa_duration[i]); -+ rtw_write32(padapter, REG_NOA_DESC_DURATION, pwdinfo->noa_duration[i]); -+ -+ //DBG_8192C("%s(): noa_interval = %x\n",__FUNCTION__,pwdinfo->noa_interval[i]); -+ rtw_write32(padapter, REG_NOA_DESC_INTERVAL, pwdinfo->noa_interval[i]); -+ -+ //DBG_8192C("%s(): start_time = %x\n",__FUNCTION__,pwdinfo->noa_start_time[i]); -+ rtw_write32(padapter, REG_NOA_DESC_START, pwdinfo->noa_start_time[i]); -+ -+ //DBG_8192C("%s(): noa_count = %x\n",__FUNCTION__,pwdinfo->noa_count[i]); -+ rtw_write8(padapter, REG_NOA_DESC_COUNT, pwdinfo->noa_count[i]); -+ } -+ -+ if( (pwdinfo->opp_ps == 1) || (pwdinfo->noa_num > 0) ) -+ { -+ // rst p2p circuit -+ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(4)); -+ -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_ENABLE(p2p_ps_offload, 1); -+ -+ if(pwdinfo->role == P2P_ROLE_GO) -+ { -+ // 1: Owner, 0: Client -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_ROLE(p2p_ps_offload, 1); -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(p2p_ps_offload, 0); -+ } -+ else -+ { -+ // 1: Owner, 0: Client -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_ROLE(p2p_ps_offload, 0); -+ } -+ -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(p2p_ps_offload, 0); -+ } -+ break; -+ case P2P_PS_SCAN: -+ DBG_8192C("P2P_PS_SCAN \n"); -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(p2p_ps_offload, 1); -+ break; -+ case P2P_PS_SCAN_DONE: -+ DBG_8192C("P2P_PS_SCAN_DONE \n"); -+ SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(p2p_ps_offload, 0); -+ pwdinfo->p2p_ps_state = P2P_PS_ENABLE; -+ break; -+ default: -+ break; -+ } -+ -+ DBG_871X("P2P_PS_OFFLOAD : %x\n", p2p_ps_offload[0]); -+ FillH2CCmd_8812(padapter, H2C_8812_P2P_PS_OFFLOAD, 1, p2p_ps_offload); -+#endif -+ -+ -+ -+} -+#endif //CONFIG_P2P -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+/* -+ ask FW to Reset sync register at Beacon early interrupt -+*/ -+u8 rtl8812_reset_tsf(_adapter *padapter, u8 reset_port ) -+{ -+ u8 buf[2]; -+ u8 res=_SUCCESS; -+ -+ s32 ret; -+ -+ if (IFACE_PORT0==reset_port) { -+ buf[0] = 0x1; buf[1] = 0; -+ } else{ -+ buf[0] = 0x0; buf[1] = 0x1; -+ } -+ -+ ret = FillH2CCmd_8812(padapter, H2C_8812_TSF_RESET, 2, buf); -+ -+ -+ -+ return res; -+} -+ -+int reset_tsf(PADAPTER Adapter, u8 reset_port ) -+{ -+ u8 reset_cnt_before = 0, reset_cnt_after = 0, loop_cnt = 0; -+ u32 reg_reset_tsf_cnt = (IFACE_PORT0==reset_port) ? -+ REG_FW_RESET_TSF_CNT_0:REG_FW_RESET_TSF_CNT_1; -+ u32 reg_bcncrtl = (IFACE_PORT0==reset_port) ? -+ REG_BCN_CTRL_1:REG_BCN_CTRL; -+ -+ rtw_scan_abort(Adapter->pbuddy_adapter); /* site survey will cause reset_tsf fail */ -+ reset_cnt_after = reset_cnt_before = rtw_read8(Adapter,reg_reset_tsf_cnt); -+ rtl8812_reset_tsf(Adapter, reset_port); -+ -+ while ((reset_cnt_after == reset_cnt_before ) && (loop_cnt < 10)) { -+ rtw_msleep_os(100); -+ loop_cnt++; -+ reset_cnt_after = rtw_read8(Adapter, reg_reset_tsf_cnt); -+ } -+ -+ return(loop_cnt >= 10) ? _FAIL : true; -+} -+ -+ -+#endif // CONFIG_TSF_RESET_OFFLOAD -+ -+#ifdef CONFIG_WOWLAN -+void rtl8812_set_wowlan_cmd(_adapter* padapter, u8 enable) -+{ -+ u8 res=_SUCCESS; -+ u32 test=0; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ SETWOWLAN_PARM pwowlan_parm; -+ struct pwrctrl_priv *pwrpriv=&padapter->pwrctrlpriv; -+ -+ -+ DBG_871X_LEVEL(_drv_always_, "+%s+\n", __func__); -+ -+ pwowlan_parm.mode =0; -+ pwowlan_parm.gpio_index=0; -+ pwowlan_parm.gpio_duration=0; -+ pwowlan_parm.second_mode =0; -+ pwowlan_parm.reserve=0; -+ -+ if(enable){ -+ -+ pwowlan_parm.mode |=FW_WOWLAN_FUN_EN; -+ pwrpriv->wowlan_magic =true; -+ pwrpriv->wowlan_unicast =true; -+ -+ if(pwrpriv->wowlan_pattern ==true){ -+ pwowlan_parm.mode |= FW_WOWLAN_PATTERN_MATCH; -+ DBG_871X_LEVEL(_drv_info_, "%s 2.pwowlan_parm.mode=0x%x \n",__FUNCTION__,pwowlan_parm.mode ); -+ } -+ if(pwrpriv->wowlan_magic ==true){ -+ pwowlan_parm.mode |=FW_WOWLAN_MAGIC_PKT; -+ DBG_871X_LEVEL(_drv_info_, "%s 3.pwowlan_parm.mode=0x%x \n",__FUNCTION__,pwowlan_parm.mode ); -+ } -+ if(pwrpriv->wowlan_unicast ==true){ -+ pwowlan_parm.mode |=FW_WOWLAN_UNICAST; -+ DBG_871X_LEVEL(_drv_info_, "%s 4.pwowlan_parm.mode=0x%x \n",__FUNCTION__,pwowlan_parm.mode ); -+ } -+ -+ if(!(padapter->pwrctrlpriv.wowlan_wake_reason & FWDecisionDisconnect)) -+ rtl8812a_set_FwJoinBssReport_cmd(padapter, 1); -+ else -+ DBG_871X_LEVEL(_drv_always_, "%s, disconnected, no FwJoinBssReport\n",__FUNCTION__); -+ rtw_msleep_os(2); -+ -+ //WOWLAN_GPIO_ACTIVE means GPIO high active -+ //pwowlan_parm.mode |=FW_WOWLAN_GPIO_ACTIVE; -+ //pwowlan_parm.mode |=FW_WOWLAN_REKEY_WAKEUP; -+ pwowlan_parm.mode |=FW_WOWLAN_DEAUTH_WAKEUP; -+ //pwowlan_parm.mode |=FW_WOWLAN_ALL_PKT_DROP; -+ -+ //DataPinWakeUp -+ pwowlan_parm.gpio_index=0x80; -+ -+ DBG_871X_LEVEL(_drv_info_, "%s 5.pwowlan_parm.mode=0x%x \n",__FUNCTION__,pwowlan_parm.mode); -+ DBG_871X_LEVEL(_drv_info_, "%s 6.pwowlan_parm.index=0x%x \n",__FUNCTION__,pwowlan_parm.gpio_index); -+ -+ res = FillH2CCmd_8812(padapter, H2C_8812_WO_WLAN, 2, (u8 *)&pwowlan_parm); -+ -+ rtw_msleep_os(2); -+ -+ //disconnect decision -+ pwowlan_parm.mode =1; -+ pwowlan_parm.gpio_index=0; -+ pwowlan_parm.gpio_duration=0; -+ FillH2CCmd_8812(padapter, H2C_8812_DISCONNECT_DECISION, 3, (u8 *)&pwowlan_parm); -+ -+ //keep alive period = 10 * 10 BCN interval -+ pwowlan_parm.mode =1; -+ pwowlan_parm.gpio_index=10; -+ -+ res = FillH2CCmd_8812(padapter, H2C_8812_KEEP_ALIVE_CTRL, 2, (u8 *)&pwowlan_parm); -+ -+ rtw_msleep_os(2); -+ //enable Remote wake ctrl -+ pwowlan_parm.mode = 1; -+ pwowlan_parm.gpio_index=0; -+ pwowlan_parm.gpio_duration=0; -+ -+ res = FillH2CCmd_8812(padapter, H2C_8812_REMOTE_WAKE_CTRL, 3, (u8 *)&pwowlan_parm); -+ } else { -+ pwrpriv->wowlan_magic =false; -+ res = FillH2CCmd_8812(padapter, H2C_8812_WO_WLAN, 2, (u8 *)&pwowlan_parm); -+ rtw_msleep_os(2); -+ res = FillH2CCmd_8812(padapter, H2C_8812_REMOTE_WAKE_CTRL, 3, (u8 *)&pwowlan_parm); -+ } -+ -+ DBG_871X_LEVEL(_drv_always_, "-%s res:%d-\n", __func__, res); -+ return ; -+} -+#endif //CONFIG_WOWLAN -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_dm.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_dm.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_dm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_dm.c 2018-02-06 17:42:30.713967209 +0200 -@@ -0,0 +1,597 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+//============================================================ -+// Description: -+// -+// This file is for 92CE/92CU dynamic mechanism only -+// -+// -+//============================================================ -+#define _RTL8812A_DM_C_ -+ -+//============================================================ -+// include files -+//============================================================ -+//#include -+#include -+ -+//============================================================ -+// Global var -+//============================================================ -+ -+ -+static void -+dm_CheckProtection( -+ PADAPTER Adapter -+ ) -+{ -+#if 0 -+ PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -+ u1Byte CurRate, RateThreshold; -+ -+ if(pMgntInfo->pHTInfo->bCurBW40MHz) -+ RateThreshold = MGN_MCS1; -+ else -+ RateThreshold = MGN_MCS3; -+ -+ if(Adapter->TxStats.CurrentInitTxRate <= RateThreshold) -+ { -+ pMgntInfo->bDmDisableProtect = true; -+ DbgPrint("Forced disable protect: %x\n", Adapter->TxStats.CurrentInitTxRate); -+ } -+ else -+ { -+ pMgntInfo->bDmDisableProtect = false; -+ DbgPrint("Enable protect: %x\n", Adapter->TxStats.CurrentInitTxRate); -+ } -+#endif -+} -+ -+static void -+dm_CheckStatistics( -+ PADAPTER Adapter -+ ) -+{ -+#if 0 -+ if(!Adapter->MgntInfo.bMediaConnect) -+ return; -+ -+ //2008.12.10 tynli Add for getting Current_Tx_Rate_Reg flexibly. -+ rtw_hal_get_hwreg( Adapter, HW_VAR_INIT_TX_RATE, (pu1Byte)(&Adapter->TxStats.CurrentInitTxRate) ); -+ -+ // Calculate current Tx Rate(Successful transmited!!) -+ -+ // Calculate current Rx Rate(Successful received!!) -+ -+ //for tx tx retry count -+ rtw_hal_get_hwreg( Adapter, HW_VAR_RETRY_COUNT, (pu1Byte)(&Adapter->TxStats.NumTxRetryCount) ); -+#endif -+} -+ -+static void dm_CheckPbcGPIO(_adapter *padapter) -+{ -+ u8 tmp1byte; -+ u8 bPbcPressed = false; -+ -+ if(!padapter->registrypriv.hw_wps_pbc) -+ return; -+ -+ if (IS_HARDWARE_TYPE_8812(padapter)) -+ { -+ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL); -+ tmp1byte |= (HAL_8192C_HW_GPIO_WPS_BIT); -+ rtw_write8(padapter, GPIO_IO_SEL, tmp1byte); //enable GPIO[2] as output mode -+ -+ tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT); -+ rtw_write8(padapter, GPIO_IN, tmp1byte); //reset the floating voltage level -+ -+ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL); -+ tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT); -+ rtw_write8(padapter, GPIO_IO_SEL, tmp1byte); //enable GPIO[2] as input mode -+ -+ tmp1byte =rtw_read8(padapter, GPIO_IN); -+ -+ if (tmp1byte == 0xff) -+ return ; -+ -+ if (tmp1byte&HAL_8192C_HW_GPIO_WPS_BIT) -+ { -+ bPbcPressed = true; -+ } -+ } -+ else if (IS_HARDWARE_TYPE_8821(padapter)) -+ { -+ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL_8811A); -+ tmp1byte |= (BIT4); -+ rtw_write8(padapter, GPIO_IO_SEL_8811A, tmp1byte); //enable GPIO[2] as output mode -+ -+ tmp1byte &= ~(BIT4); -+ rtw_write8(padapter, GPIO_IN_8811A, tmp1byte); //reset the floating voltage level -+ -+ tmp1byte = rtw_read8(padapter, GPIO_IO_SEL_8811A); -+ tmp1byte &= ~(BIT4); -+ rtw_write8(padapter, GPIO_IO_SEL_8811A, tmp1byte); //enable GPIO[2] as input mode -+ -+ tmp1byte =rtw_read8(padapter, GPIO_IN_8811A); -+ -+ if (tmp1byte == 0xff) -+ return ; -+ -+ if (tmp1byte&BIT4) -+ { -+ bPbcPressed = true; -+ } -+ } -+ -+ if( true == bPbcPressed) -+ { -+ // Here we only set bPbcPressed to true -+ // After trigger PBC, the variable will be set to false -+ DBG_8192C("CheckPbcGPIO - PBC is pressed\n"); -+ -+ rtw_request_wps_pbc_event(padapter); -+ } -+} -+ -+// -+// Initialize GPIO setting registers -+// -+static void -+dm_InitGPIOSetting( -+ PADAPTER Adapter -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ u8 tmp1byte; -+ -+ tmp1byte = rtw_read8(Adapter, REG_GPIO_MUXCFG); -+ tmp1byte &= (GPIOSEL_GPIO | ~GPIOSEL_ENBT); -+ -+#ifdef CONFIG_BT_COEXIST -+ // UMB-B cut bug. We need to support the modification. -+ if (IS_81xxC_VENDOR_UMC_B_CUT(pHalData->VersionID) && -+ pHalData->bt_coexist.BT_Coexist) -+ { -+ tmp1byte |= (BIT5); -+ } -+#endif -+ rtw_write8(Adapter, REG_GPIO_MUXCFG, tmp1byte); -+ -+} -+ -+// A mapping from HalData to ODM. -+ODM_BOARD_TYPE_E boardType(u8 InterfaceSel) -+{ -+ ODM_BOARD_TYPE_E board = ODM_BOARD_DEFAULT; -+ -+ INTERFACE_SELECT_USB usb = (INTERFACE_SELECT_USB)InterfaceSel; -+ switch (usb) -+ { -+ case INTF_SEL1_USB_High_Power: -+ board |= ODM_BOARD_EXT_LNA; -+ board |= ODM_BOARD_EXT_PA; -+ break; -+ case INTF_SEL2_MINICARD: -+ board |= ODM_BOARD_MINICARD; -+ break; -+ case INTF_SEL4_USB_Combo: -+ board |= ODM_BOARD_BT; -+ break; -+ case INTF_SEL5_USB_Combo_MF: -+ board |= ODM_BOARD_BT; -+ break; -+ case INTF_SEL0_USB: -+ case INTF_SEL3_USB_Solo: -+ default: -+ board = ODM_BOARD_DEFAULT; -+ break; -+ } -+ -+ return board; -+} -+ -+//============================================================ -+// functions -+//============================================================ -+static void Init_ODM_ComInfo_8812(PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ u8 cut_ver,fab_ver; -+ u8 BoardType = ODM_BOARD_DEFAULT; -+ -+ // -+ // Init Value -+ // -+ _rtw_memset(pDM_Odm,0,sizeof(pDM_Odm)); -+ -+ pDM_Odm->Adapter = Adapter; -+ -+ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_PLATFORM,ODM_CE); -+ -+ if (Adapter->interface_type == RTW_GSPI) -+ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_INTERFACE,ODM_ITRF_SDIO); -+ else -+ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_INTERFACE,Adapter->interface_type); -+ -+ -+ if (IS_HARDWARE_TYPE_8812(Adapter)) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_IC_TYPE, ODM_RTL8812); -+ else if (IS_HARDWARE_TYPE_8821(Adapter)) -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_IC_TYPE, ODM_RTL8821); -+ -+ -+ fab_ver = ODM_TSMC; -+ if (IS_VENDOR_8812A_C_CUT(Adapter)) -+ cut_ver = ODM_CUT_C; -+ else -+ cut_ver = ODM_CUT_A; -+ -+ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_FAB_VER,fab_ver); -+ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_CUT_VER,cut_ver); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_MP_TEST_CHIP,IS_NORMAL_CHIP(pHalData->VersionID)); -+ -+ //1 ======= BoardType: ODM_CMNINFO_BOARD_TYPE ======= -+ if(pHalData->InterfaceSel == INTF_SEL1_USB_High_Power) -+ { -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_PA, 1); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_LNA, 1); -+ } -+ else -+ { -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_PA, pHalData->ExternalPA_2G); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_LNA, 0); -+ } -+ -+ if (pHalData->ExternalLNA_2G != 0) { -+ BoardType |= ODM_BOARD_EXT_LNA; -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_LNA, 1); -+ } -+ if (pHalData->ExternalLNA_5G != 0) { -+ BoardType |= ODM_BOARD_EXT_LNA_5G; -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_5G_EXT_LNA, 1); -+ } -+ if (pHalData->ExternalPA_2G != 0) { -+ BoardType |= ODM_BOARD_EXT_PA; -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_PA, 1); -+ } -+ if (pHalData->ExternalPA_5G != 0) { -+ BoardType |= ODM_BOARD_EXT_PA_5G; -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_5G_EXT_PA, 1); -+ } -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BOARD_TYPE, BoardType); -+ -+ //1 ============== End of BoardType ============== -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RFE_TYPE, pHalData->RFEType); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_TRSW, 0); -+ -+ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_PATCH_ID,pEEPROM->CustomerID); -+ // ODM_CMNINFO_BINHCT_TEST only for MP Team -+ ODM_CmnInfoInit(pDM_Odm,ODM_CMNINFO_BWIFI_TEST,Adapter->registrypriv.wifi_spec); -+ -+ -+ if(pHalData->rf_type == RF_1T1R){ -+ ODM_CmnInfoUpdate(pDM_Odm,ODM_CMNINFO_RF_TYPE,ODM_1T1R); -+ } -+ else if(pHalData->rf_type == RF_2T2R){ -+ ODM_CmnInfoUpdate(pDM_Odm,ODM_CMNINFO_RF_TYPE,ODM_2T2R); -+ } -+ else if(pHalData->rf_type == RF_1T2R){ -+ ODM_CmnInfoUpdate(pDM_Odm,ODM_CMNINFO_RF_TYPE,ODM_1T2R); -+ } -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RFE_TYPE, pHalData->RFEType); -+ -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, pHalData->TRxAntDivType); -+ -+ #ifdef CONFIG_DISABLE_ODM -+ pdmpriv->InitODMFlag = 0; -+ #else -+ pdmpriv->InitODMFlag = ODM_RF_CALIBRATION | -+ ODM_RF_TX_PWR_TRACK //| -+ ; -+ //if(pHalData->AntDivCfg) -+ // pdmpriv->InitODMFlag |= ODM_BB_ANT_DIV; -+ #endif -+ -+ ODM_CmnInfoUpdate(pDM_Odm,ODM_CMNINFO_ABILITY,pdmpriv->InitODMFlag); -+ -+} -+static void Update_ODM_ComInfo_8812(PADAPTER Adapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ struct pwrctrl_priv *pwrctrlpriv = &Adapter->pwrctrlpriv; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ int i; -+ #ifdef CONFIG_DISABLE_ODM -+ pdmpriv->InitODMFlag = 0; -+ #else //CONFIG_DISABLE_ODM -+ -+ pdmpriv->InitODMFlag = ODM_BB_DIG | -+#ifdef CONFIG_ODM_REFRESH_RAMASK -+ ODM_BB_RA_MASK | -+#endif -+ ODM_BB_FA_CNT | -+ ODM_BB_RSSI_MONITOR | -+ ODM_RF_TX_PWR_TRACK | // For RF -+ ODM_MAC_EDCA_TURBO -+ ; -+ if(pHalData->AntDivCfg) -+ pdmpriv->InitODMFlag |= ODM_BB_ANT_DIV; -+ -+ #if (MP_DRIVER==1) -+ if (Adapter->registrypriv.mp_mode == 1) -+ { -+ pdmpriv->InitODMFlag = ODM_RF_CALIBRATION | -+ ODM_RF_TX_PWR_TRACK; -+ } -+ #endif//(MP_DRIVER==1) -+ -+ #endif//CONFIG_DISABLE_ODM -+ ODM_CmnInfoUpdate(pDM_Odm,ODM_CMNINFO_ABILITY,pdmpriv->InitODMFlag); -+ -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_TX_UNI,&(Adapter->xmitpriv.tx_bytes)); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_RX_UNI,&(Adapter->recvpriv.rx_bytes)); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_WM_MODE,&(pmlmeext->cur_wireless_mode)); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_BAND,&(pHalData->CurrentBandType)); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_FORCED_RATE,&(pHalData->ForcedDataRate)); -+ -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_SEC_CHNL_OFFSET,&(pHalData->nCur40MhzPrimeSC)); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_SEC_MODE,&(Adapter->securitypriv.dot11PrivacyAlgrthm)); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_BW,&(pHalData->CurrentChannelBW )); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_CHNL,&( pHalData->CurrentChannel)); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_NET_CLOSED,&( Adapter->net_closed)); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_MP_MODE,&(Adapter->registrypriv.mp_mode)); -+ //================= only for 8192D ================= -+ /* -+ //pHalData->CurrentBandType92D -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_DMSP_GET_VALUE,&(pDM_Odm->u1Byte_temp)); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_BUDDY_ADAPTOR,&(pDM_Odm->PADAPTER_temp)); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_DMSP_IS_MASTER,&(pDM_Odm->u1Byte_temp)); -+ //================= only for 8192D ================= -+ // driver havn't those variable now -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_BT_OPERATION,&(pDM_Odm->u1Byte_temp)); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_BT_DISABLE_EDCA,&(pDM_Odm->u1Byte_temp)); -+ */ -+ -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_SCAN,&(pmlmepriv->bScanInProcess)); -+ ODM_CmnInfoHook(pDM_Odm,ODM_CMNINFO_POWER_SAVING,&(pwrctrlpriv->bpower_saving)); -+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, pHalData->TRxAntDivType); -+ -+ for(i=0; i< NUM_STA; i++) -+ { -+ //pDM_Odm->pODM_StaInfo[i] = NULL; -+ ODM_CmnInfoPtrArrayHook(pDM_Odm, ODM_CMNINFO_STA_STATUS,i,NULL); -+ } -+} -+ -+void -+rtl8812_InitHalDm( -+ PADAPTER Adapter -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ u8 i; -+ -+ dm_InitGPIOSetting(Adapter); -+ -+ pdmpriv->DM_Type = DM_Type_ByDriver; -+ pdmpriv->DMFlag = DYNAMIC_FUNC_DISABLE; -+ -+ Update_ODM_ComInfo_8812(Adapter); -+ ODM_DMInit(pDM_Odm); -+ -+ Adapter->fix_rate = 0xFF; -+ -+} -+ -+ -+void -+rtl8812_HalDmWatchDog( -+ PADAPTER Adapter -+ ) -+{ -+ bool bFwCurrentInPSMode = false; -+ bool bFwPSAwake = true; -+ u8 hw_init_completed = false; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+#ifdef CONFIG_CONCURRENT_MODE -+ PADAPTER pbuddy_adapter = Adapter->pbuddy_adapter; -+#endif //CONFIG_CONCURRENT_MODE -+ -+ -+ -+ hw_init_completed = Adapter->hw_init_completed; -+ -+ if (hw_init_completed == false) -+ goto skip_dm; -+ -+#ifdef CONFIG_LPS -+ #ifdef CONFIG_CONCURRENT_MODE -+ if (Adapter->iface_type != IFACE_PORT0 && pbuddy_adapter) { -+ bFwCurrentInPSMode = pbuddy_adapter->pwrctrlpriv.bFwCurrentInPSMode; -+ rtw_hal_get_hwreg(pbuddy_adapter, HW_VAR_FWLPS_RF_ON, (u8 *)(&bFwPSAwake)); -+ } else -+ #endif //CONFIG_CONCURRENT_MODE -+ { -+ bFwCurrentInPSMode = Adapter->pwrctrlpriv.bFwCurrentInPSMode; -+ rtw_hal_get_hwreg(Adapter, HW_VAR_FWLPS_RF_ON, (u8 *)(&bFwPSAwake)); -+ } -+#endif -+ -+#ifdef CONFIG_P2P_PS -+ // Fw is under p2p powersaving mode, driver should stop dynamic mechanism. -+ // modifed by thomas. 2011.06.11. -+ if(Adapter->wdinfo.p2p_ps_mode) -+ bFwPSAwake = false; -+#endif //CONFIG_P2P_PS -+ -+ if( (hw_init_completed == true) -+ && ((!bFwCurrentInPSMode) && bFwPSAwake)) -+ { -+ // -+ // Calculate Tx/Rx statistics. -+ // -+ dm_CheckStatistics(Adapter); -+ -+ // -+ // Dynamically switch RTS/CTS protection. -+ // -+ } -+ -+ //ODM -+ if (hw_init_completed == true) -+ { -+ u8 bLinked=false; -+ -+ #ifdef CONFIG_DISABLE_ODM -+ pHalData->odmpriv.SupportAbility = 0; -+ #endif -+ -+ if(rtw_linked_check(Adapter)) -+ bLinked = true; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(pbuddy_adapter && rtw_linked_check(pbuddy_adapter)) -+ bLinked = true; -+#endif //CONFIG_CONCURRENT_MODE -+ -+ ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_LINK, bLinked); -+ ODM_DMWatchdog(&pHalData->odmpriv); -+ -+ } -+ -+skip_dm: -+ -+ // Check GPIO to determine current RF on/off and Pbc status. -+ // Check Hardware Radio ON/OFF or not -+ //temp removed -+ dm_CheckPbcGPIO(Adapter); -+} -+ -+void rtl8812_init_dm_priv(PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ _rtw_memset(pdmpriv, 0, sizeof(struct dm_priv)); -+ //_rtw_spinlock_init(&(pHalData->odm_stainfo_lock)); -+ Init_ODM_ComInfo_8812(Adapter); -+#ifdef CONFIG_SW_ANTENNA_DIVERSITY -+ //_init_timer(&(pdmpriv->SwAntennaSwitchTimer), Adapter->pnetdev , odm_SW_AntennaSwitchCallback, Adapter); -+ ODM_InitAllTimers(podmpriv ); -+#endif -+ ODM_InitDebugSetting(podmpriv); -+ -+ Adapter->registrypriv.RegEnableTxPowerLimit = 0; -+ Adapter->registrypriv.RegPowerBase = 14; -+ Adapter->registrypriv.RegTxPwrLimit = 0xFFFFFFFF; -+ Adapter->registrypriv.TxBBSwing_2G = 0xFF; -+ Adapter->registrypriv.TxBBSwing_5G = 0xFF; -+ Adapter->registrypriv.bEn_RFE = 0; -+ Adapter->registrypriv.RFE_Type = 64; -+ pHalData->RegRFPathS1 = 0; -+ pHalData->TxPwrInPercentage = TX_PWR_PERCENTAGE_3; -+} -+ -+void rtl8812_deinit_dm_priv(PADAPTER Adapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ //_rtw_spinlock_free(&pHalData->odm_stainfo_lock); -+#ifdef CONFIG_SW_ANTENNA_DIVERSITY -+ //_cancel_timer_ex(&pdmpriv->SwAntennaSwitchTimer); -+ ODM_CancelAllTimers(podmpriv); -+#endif -+} -+ -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+// Add new function to reset the state of antenna diversity before link. -+// -+// Compare RSSI for deciding antenna -+void AntDivCompare8812(PADAPTER Adapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src) -+{ -+ //PADAPTER Adapter = pDM_Odm->Adapter ; -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ if(0 != pHalData->AntDivCfg ) -+ { -+ //DBG_8192C("update_network=> orgRSSI(%d)(%d),newRSSI(%d)(%d)\n",dst->Rssi,query_rx_pwr_percentage(dst->Rssi), -+ // src->Rssi,query_rx_pwr_percentage(src->Rssi)); -+ //select optimum_antenna for before linked =>For antenna diversity -+ if(dst->Rssi >= src->Rssi )//keep org parameter -+ { -+ src->Rssi = dst->Rssi; -+ src->PhyInfo.Optimum_antenna = dst->PhyInfo.Optimum_antenna; -+ } -+ } -+} -+ -+// Add new function to reset the state of antenna diversity before link. -+u8 AntDivBeforeLink8812(PADAPTER Adapter ) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T pDM_Odm =&pHalData->odmpriv; -+ SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; -+ struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); -+ -+ // Condition that does not need to use antenna diversity. -+ if(pHalData->AntDivCfg==0) -+ { -+ //DBG_8192C("odm_AntDivBeforeLink8192C(): No AntDiv Mechanism.\n"); -+ return false; -+ } -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ { -+ return false; -+ } -+ -+ -+ if(pDM_SWAT_Table->SWAS_NoLink_State == 0){ -+ //switch channel -+ pDM_SWAT_Table->SWAS_NoLink_State = 1; -+ pDM_SWAT_Table->CurAntenna = (pDM_SWAT_Table->CurAntenna==MAIN_ANT)?AUX_ANT:MAIN_ANT; -+ -+ //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, pDM_SWAT_Table->CurAntenna); -+ rtw_antenna_select_cmd(Adapter, pDM_SWAT_Table->CurAntenna, false); -+ //DBG_8192C("%s change antenna to ANT_( %s ).....\n",__FUNCTION__, (pDM_SWAT_Table->CurAntenna==MAIN_ANT)?"MAIN":"AUX"); -+ return true; -+ } -+ else -+ { -+ pDM_SWAT_Table->SWAS_NoLink_State = 0; -+ return false; -+ } -+ -+} -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_hal_init.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_hal_init.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_hal_init.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_hal_init.c 2018-02-06 17:42:30.714967223 +0200 -@@ -0,0 +1,5955 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8812A_HAL_INIT_C_ -+ -+//#include -+#include -+ -+ -+#if defined(CONFIG_IOL) -+void iol_mode_enable(PADAPTER padapter, u8 enable) -+{ -+ u8 reg_0xf0 = 0; -+ -+ if(enable) -+ { -+ //Enable initial offload -+ reg_0xf0 = rtw_read8(padapter, REG_SYS_CFG); -+ //DBG_871X("%s reg_0xf0:0x%02x, write 0x%02x\n", __FUNCTION__, reg_0xf0, reg_0xf0|IOL_ENABLE); -+ rtw_write8(padapter, REG_SYS_CFG, reg_0xf0|SW_OFFLOAD_EN); -+ -+ _8051Reset8812(padapter); -+ } -+ else -+ { -+ //disable initial offload -+ reg_0xf0 = rtw_read8(padapter, REG_SYS_CFG); -+ //DBG_871X("%s reg_0xf0:0x%02x, write 0x%02x\n", __FUNCTION__, reg_0xf0, reg_0xf0& ~IOL_ENABLE); -+ rtw_write8(padapter, REG_SYS_CFG, reg_0xf0 & ~SW_OFFLOAD_EN); -+ } -+} -+ -+s32 iol_execute(PADAPTER padapter, u8 control) -+{ -+ s32 status = _FAIL; -+ u8 reg_0x88 = 0; -+ u32 start = 0, passing_time = 0; -+ control = control&0x0f; -+ -+ reg_0x88 = rtw_read8(padapter, 0x88); -+ //DBG_871X("%s reg_0x88:0x%02x, write 0x%02x\n", __FUNCTION__, reg_0x88, reg_0x88|control); -+ rtw_write8(padapter, 0x88, reg_0x88|control); -+ -+ start = rtw_get_current_time(); -+ while((reg_0x88=rtw_read8(padapter, 0x88)) & control -+ && (passing_time=rtw_get_passing_time_ms(start))<1000 -+ ) { -+ DBG_871X("%s polling reg_0x88:0x%02x\n", __FUNCTION__, reg_0x88); -+ rtw_usleep_os(100); -+ } -+ -+ reg_0x88 = rtw_read8(padapter, 0x88); -+ status = (reg_0x88 & control)?_FAIL:_SUCCESS; -+ if(reg_0x88 & control<<4) -+ status = _FAIL; -+ -+ DBG_871X("%s in %u ms, reg_0x88:0x%02x\n", __FUNCTION__, passing_time, reg_0x88); -+ -+ return status; -+} -+ -+s32 iol_InitLLTTable( -+ PADAPTER padapter, -+ u8 txpktbuf_bndy -+ ) -+{ -+ //DBG_871X("%s txpktbuf_bndy:%u\n", __FUNCTION__, txpktbuf_bndy); -+ rtw_write8(padapter, REG_TDECTRL+1, txpktbuf_bndy); -+ return iol_execute(padapter, IOL_INIT_LLT); -+} -+ -+static void -+efuse_phymap_to_logical(u8 * phymap, u16 _offset, u16 _size_byte, u8 *pbuf) -+{ -+ u8 *efuseTbl = NULL; -+ u8 rtemp8; -+ u16 eFuse_Addr = 0; -+ u8 offset, wren; -+ u16 i, j; -+ u16 **eFuseWord = NULL; -+ u16 efuse_utilized = 0; -+ u8 efuse_usage = 0; -+ u8 u1temp = 0; -+ -+ -+ efuseTbl = (u8*)rtw_zmalloc(EFUSE_MAP_LEN_JAGUAR); -+ if(efuseTbl == NULL) -+ { -+ DBG_871X("%s: alloc efuseTbl fail!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ eFuseWord= (u16 **)rtw_malloc2d(EFUSE_MAX_SECTION_JAGUAR, EFUSE_MAX_WORD_UNIT, sizeof(u16)); -+ if(eFuseWord == NULL) -+ { -+ DBG_871X("%s: alloc eFuseWord fail!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ // 0. Refresh efuse init map as all oxFF. -+ for (i = 0; i < EFUSE_MAX_SECTION_JAGUAR; i++) -+ for (j = 0; j < EFUSE_MAX_WORD_UNIT; j++) -+ eFuseWord[i][j] = 0xFFFF; -+ -+ // -+ // 1. Read the first byte to check if efuse is empty!!! -+ // -+ // -+ rtemp8 = *(phymap+eFuse_Addr); -+ if(rtemp8 != 0xFF) -+ { -+ efuse_utilized++; -+ //printk("efuse_Addr-%d efuse_data=%x\n", eFuse_Addr, *rtemp8); -+ eFuse_Addr++; -+ } -+ else -+ { -+ DBG_871X("EFUSE is empty efuse_Addr-%d efuse_data=%x\n", eFuse_Addr, rtemp8); -+ goto exit; -+ } -+ -+ -+ // -+ // 2. Read real efuse content. Filter PG header and every section data. -+ // -+ while((rtemp8 != 0xFF) && (eFuse_Addr < EFUSE_REAL_CONTENT_LEN_JAGUAR)) -+ { -+ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("efuse_Addr-%d efuse_data=%x\n", eFuse_Addr-1, *rtemp8)); -+ -+ // Check PG header for section num. -+ if((rtemp8 & 0x1F ) == 0x0F) //extended header -+ { -+ u1temp =( (rtemp8 & 0xE0) >> 5); -+ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("extended header u1temp=%x *rtemp&0xE0 0x%x\n", u1temp, *rtemp8 & 0xE0)); -+ -+ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("extended header u1temp=%x \n", u1temp)); -+ -+ rtemp8 = *(phymap+eFuse_Addr); -+ -+ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("extended header efuse_Addr-%d efuse_data=%x\n", eFuse_Addr, *rtemp8)); -+ -+ if((rtemp8 & 0x0F) == 0x0F) -+ { -+ eFuse_Addr++; -+ rtemp8 = *(phymap+eFuse_Addr); -+ -+ if(rtemp8 != 0xFF && (eFuse_Addr < EFUSE_REAL_CONTENT_LEN_JAGUAR)) -+ { -+ eFuse_Addr++; -+ } -+ continue; -+ } -+ else -+ { -+ offset = ((rtemp8 & 0xF0) >> 1) | u1temp; -+ wren = (rtemp8 & 0x0F); -+ eFuse_Addr++; -+ } -+ } -+ else -+ { -+ offset = ((rtemp8 >> 4) & 0x0f); -+ wren = (rtemp8 & 0x0f); -+ } -+ -+ if(offset < EFUSE_MAX_SECTION_JAGUAR) -+ { -+ // Get word enable value from PG header -+ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("Offset-%d Worden=%x\n", offset, wren)); -+ -+ for(i=0; i= EFUSE_REAL_CONTENT_LEN_JAGUAR) -+ break; -+ -+ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("Addr=%d", eFuse_Addr)); -+ rtemp8 = *(phymap+eFuse_Addr); -+ eFuse_Addr++; -+ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("Data=0x%x\n", *rtemp8)); -+ -+ efuse_utilized++; -+ eFuseWord[offset][i] |= (((u2Byte)rtemp8 << 8) & 0xff00); -+ -+ if(eFuse_Addr >= EFUSE_REAL_CONTENT_LEN_JAGUAR) -+ break; -+ } -+ -+ wren >>= 1; -+ -+ } -+ } -+ -+ // Read next PG header -+ rtemp8 = *(phymap+eFuse_Addr); -+ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("Addr=%d rtemp 0x%x\n", eFuse_Addr, *rtemp8)); -+ -+ if(rtemp8 != 0xFF && (eFuse_Addr < EFUSE_REAL_CONTENT_LEN_JAGUAR)) -+ { -+ efuse_utilized++; -+ eFuse_Addr++; -+ } -+ } -+ -+ // -+ // 3. Collect 16 sections and 4 word unit into Efuse map. -+ // -+ for(i=0; i> 8) & 0xff); -+ } -+ } -+ -+ -+ // -+ // 4. Copy from Efuse map to output pointer memory!!! -+ // -+ for(i=0; i<_size_byte; i++) -+ { -+ pbuf[i] = efuseTbl[_offset+i]; -+ } -+ -+ // -+ // 5. Calculate Efuse utilization. -+ // -+ efuse_usage = (u1Byte)((efuse_utilized*100)/EFUSE_REAL_CONTENT_LEN_JAGUAR); -+ //Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_EFUSE_BYTES, (u8 *)&efuse_utilized); -+ -+exit: -+ if(efuseTbl) -+ rtw_mfree(efuseTbl, EFUSE_MAP_LEN_JAGUAR); -+ -+ if(eFuseWord) -+ rtw_mfree2d((void *)eFuseWord, EFUSE_MAX_SECTION_JAGUAR, EFUSE_MAX_WORD_UNIT, sizeof(u16)); -+} -+ -+void efuse_read_phymap_from_txpktbuf( -+ ADAPTER *adapter, -+ int bcnhead, //beacon head, where FW store len(2-byte) and efuse physical map. -+ u8 *content, //buffer to store efuse physical map -+ u16 *size //for efuse content: the max byte to read. will update to byte read -+ ) -+{ -+ u16 dbg_addr = 0; -+ u32 start = 0, passing_time = 0; -+ u8 reg_0x143 = 0; -+ u8 reg_0x106 = 0; -+ u32 lo32 = 0, hi32 = 0; -+ u16 len = 0, count = 0; -+ int i = 0; -+ u16 limit = *size; -+ -+ u8 *pos = content; -+ -+ if(bcnhead<0) //if not valid -+ bcnhead = rtw_read8(adapter, REG_TDECTRL+1); -+ -+ DBG_871X("%s bcnhead:%d\n", __FUNCTION__, bcnhead); -+ -+ //reg_0x106 = rtw_read8(adapter, REG_PKT_BUFF_ACCESS_CTRL); -+ //DBG_871X("%s reg_0x106:0x%02x, write 0x%02x\n", __FUNCTION__, reg_0x106, 0x69); -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, TXPKT_BUF_SELECT); -+ //DBG_871X("%s reg_0x106:0x%02x\n", __FUNCTION__, rtw_read8(adapter, 0x106)); -+ -+ dbg_addr = bcnhead*128/8; //8-bytes addressing -+ -+ while(1) -+ { -+ //DBG_871X("%s dbg_addr:0x%x\n", __FUNCTION__, dbg_addr+i); -+ rtw_write16(adapter, REG_PKTBUF_DBG_ADDR, dbg_addr+i); -+ -+ //DBG_871X("%s write reg_0x143:0x00\n", __FUNCTION__); -+ rtw_write8(adapter, REG_TXPKTBUF_DBG, 0); -+ start = rtw_get_current_time(); -+ while(!(reg_0x143=rtw_read8(adapter, REG_TXPKTBUF_DBG))//dbg -+ //while(rtw_read8(adapter, REG_TXPKTBUF_DBG) & BIT0 -+ && (passing_time=rtw_get_passing_time_ms(start))<1000 -+ ) { -+ DBG_871X("%s polling reg_0x143:0x%02x, reg_0x106:0x%02x\n", __FUNCTION__, reg_0x143, rtw_read8(adapter, 0x106)); -+ rtw_usleep_os(100); -+ } -+ -+ -+ lo32 = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L); -+ hi32 = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); -+ -+ #if 0 -+ DBG_871X("%s lo32:0x%08x, %02x %02x %02x %02x\n", __FUNCTION__, lo32 -+ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_L) -+ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_L+1) -+ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_L+2) -+ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_L+3) -+ ); -+ DBG_871X("%s hi32:0x%08x, %02x %02x %02x %02x\n", __FUNCTION__, hi32 -+ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_H) -+ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_H+1) -+ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_H+2) -+ , rtw_read8(adapter, REG_PKTBUF_DBG_DATA_H+3) -+ ); -+ #endif -+ -+ if(i==0) -+ { -+ #if 1 //for debug -+ u8 lenc[2]; -+ u16 lenbak, aaabak; -+ u16 aaa; -+ lenc[0] = rtw_read8(adapter, REG_PKTBUF_DBG_DATA_L); -+ lenc[1] = rtw_read8(adapter, REG_PKTBUF_DBG_DATA_L+1); -+ -+ aaabak = le16_to_cpup((u16*)lenc); -+ lenbak = le16_to_cpu(*((u16*)lenc)); -+ aaa = le16_to_cpup((u16*)&lo32); -+ #endif -+ len = le16_to_cpu(*((u16*)&lo32)); -+ -+ limit = len-2=count+2?2:limit-count); -+ count+=limit>=count+2?2:limit-count; -+ pos=content+count; -+ -+ } -+ else -+ { -+ _rtw_memcpy(pos, ((u8*)&lo32), limit>=count+4?4:limit-count); -+ count+=limit>=count+4?4:limit-count; -+ pos=content+count; -+ -+ -+ } -+ -+ if(limit>count && len-2>count) { -+ _rtw_memcpy(pos, (u8*)&hi32, limit>=count+4?4:limit-count); -+ count+=limit>=count+4?4:limit-count; -+ pos=content+count; -+ } -+ -+ if(limit<=count || len-2<=count) -+ break; -+ -+ i++; -+ } -+ -+ rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, DISABLE_TRXPKT_BUF_ACCESS); -+ -+ DBG_871X("%s read count:%u\n", __FUNCTION__, count); -+ *size = count; -+ -+} -+ -+ -+static bool efuse_read_phymap( -+ PADAPTER Adapter, -+ u8 *pbuf, //buffer to store efuse physical map -+ u16 *size //the max byte to read. will update to byte read -+ ) -+{ -+ u8 *pos = pbuf; -+ u16 limit = *size; -+ u16 addr = 0; -+ bool reach_end = false; -+ -+ // -+ // Refresh efuse init map as all 0xFF. -+ // -+ _rtw_memset(pbuf, 0xFF, limit); -+ -+ -+ // -+ // Read physical efuse content. -+ // -+ while(addr < limit) -+ { -+ ReadEFuseByte(Adapter, addr, pos, false); -+ if(*pos != 0xFF) -+ { -+ pos++; -+ addr++; -+ } -+ else -+ { -+ reach_end = true; -+ break; -+ } -+ } -+ -+ *size = addr; -+ -+ return reach_end; -+ -+} -+ -+s32 iol_read_efuse( -+ PADAPTER padapter, -+ u8 txpktbuf_bndy, -+ u16 offset, -+ u16 size_byte, -+ u8 *logical_map -+ ) -+{ -+ s32 status = _FAIL; -+ u8 reg_0x106 = 0; -+ u8 physical_map[512]; -+ u16 size = 512; -+ int i; -+ -+ -+ rtw_write8(padapter, REG_TDECTRL+1, txpktbuf_bndy); -+ _rtw_memset(physical_map, 0xFF, 512); -+ -+ ///reg_0x106 = rtw_read8(padapter, REG_PKT_BUFF_ACCESS_CTRL); -+ //DBG_871X("%s reg_0x106:0x%02x, write 0x%02x\n", __FUNCTION__, reg_0x106, 0x69); -+ rtw_write8(padapter, REG_PKT_BUFF_ACCESS_CTRL, TXPKT_BUF_SELECT); -+ //DBG_871X("%s reg_0x106:0x%02x\n", __FUNCTION__, rtw_read8(padapter, 0x106)); -+ -+ status = iol_execute(padapter, IOL_READ_EFUSE_MAP); -+ -+ if(status == _SUCCESS) -+ efuse_read_phymap_from_txpktbuf(padapter, txpktbuf_bndy, physical_map, &size); -+ -+ #if 0 -+ DBG_871X("%s physical map\n", __FUNCTION__); -+ for(i=0;i POLLING_LLT_THRESHOLD) { -+ RT_TRACE(_module_hal_init_c_, _drv_err_, ("Failed to polling write LLT done at address %d!\n", address)); -+ status = _FAIL; -+ break; -+ } -+ } while (count++); -+ -+ return status; -+} -+ -+u8 _LLTRead(PADAPTER padapter, u32 address) -+{ -+ s32 count = 0; -+ u32 value = _LLT_INIT_ADDR(address) | _LLT_OP(_LLT_READ_ACCESS); -+ u16 LLTReg = REG_LLT_INIT; -+ -+ -+ rtw_write32(padapter, LLTReg, value); -+ -+ //polling and get value -+ do { -+ value = rtw_read32(padapter, LLTReg); -+ if (_LLT_NO_ACTIVE == _LLT_OP_VALUE(value)) { -+ return (u8)value; -+ } -+ -+ if (count > POLLING_LLT_THRESHOLD) { -+ RT_TRACE(_module_hal_init_c_, _drv_err_, ("Failed to polling read LLT done at address %d!\n", address)); -+ break; -+ } -+ } while (count++); -+ -+ return 0xFF; -+} -+ -+s32 InitLLTTable8812(PADAPTER padapter, u8 txpktbuf_bndy) -+{ -+ s32 status = _FAIL; -+ u32 i; -+ u32 Last_Entry_Of_TxPktBuf = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+#if defined(CONFIG_IOL_LLT) -+ if(1 || rtw_IOL_applied(padapter)) -+ { -+ iol_mode_enable(padapter, 1); -+ status = iol_InitLLTTable(padapter, txpktbuf_bndy); -+ iol_mode_enable(padapter, 0); -+ } -+ else -+#endif -+ { -+ for (i = 0; i < (txpktbuf_bndy - 1); i++) { -+ status = _LLTWrite(padapter, i, i + 1); -+ if (_SUCCESS != status) { -+ return status; -+ } -+ } -+ -+ // end of list -+ status = _LLTWrite(padapter, (txpktbuf_bndy - 1), 0xFF); -+ if (_SUCCESS != status) { -+ return status; -+ } -+ -+ // Make the other pages as ring buffer -+ // This ring buffer is used as beacon buffer if we config this MAC as two MAC transfer. -+ // Otherwise used as local loopback buffer. -+ for (i = txpktbuf_bndy; i < Last_Entry_Of_TxPktBuf; i++) { -+ status = _LLTWrite(padapter, i, (i + 1)); -+ if (_SUCCESS != status) { -+ return status; -+ } -+ } -+ -+ // Let last entry point to the start entry of ring buffer -+ status = _LLTWrite(padapter, Last_Entry_Of_TxPktBuf, txpktbuf_bndy); -+ if (_SUCCESS != status) { -+ return status; -+ } -+ } -+ -+ return status; -+} -+ -+bool HalDetectPwrDownMode8812(PADAPTER Adapter) -+{ -+ u8 tmpvalue = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct pwrctrl_priv *pwrctrlpriv = &Adapter->pwrctrlpriv; -+ -+ EFUSE_ShadowRead(Adapter, 1, EEPROM_RF_OPT3_92C, (u32 *)&tmpvalue); -+ -+ // 2010/08/25 MH INF priority > PDN Efuse value. -+ if(tmpvalue & BIT(4) && pwrctrlpriv->reg_pdnmode) -+ { -+ pHalData->pwrdown = true; -+ } -+ else -+ { -+ pHalData->pwrdown = false; -+ } -+ -+ DBG_8192C("HalDetectPwrDownMode(): PDN=%d\n", pHalData->pwrdown); -+ -+ return pHalData->pwrdown; -+} // HalDetectPwrDownMode -+ -+#ifdef CONFIG_WOWLAN -+void Hal_DetectWoWMode(PADAPTER pAdapter) -+{ -+ pAdapter->pwrctrlpriv.bSupportRemoteWakeup = true; -+ DBG_871X("%s\n", __func__); -+} -+#endif -+ -+//==================================================================================== -+// -+// 20100209 Joseph: -+// This function is used only for 92C to set REG_BCN_CTRL(0x550) register. -+// We just reserve the value of the register in variable pHalData->RegBcnCtrlVal and then operate -+// the value of the register via atomic operation. -+// This prevents from race condition when setting this register. -+// The value of pHalData->RegBcnCtrlVal is initialized in HwConfigureRTL8192CE() function. -+// -+void SetBcnCtrlReg( -+ PADAPTER padapter, -+ u8 SetBits, -+ u8 ClearBits) -+{ -+ PHAL_DATA_TYPE pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ -+ pHalData->RegBcnCtrlVal |= SetBits; -+ pHalData->RegBcnCtrlVal &= ~ClearBits; -+ -+ rtw_write8(padapter, REG_BCN_CTRL, (u8)pHalData->RegBcnCtrlVal); -+} -+ -+static void -+_FWDownloadEnable_8812( -+ PADAPTER padapter, -+ bool enable -+ ) -+{ -+ u8 tmp; -+ -+ if(enable) -+ { -+ // MCU firmware download enable. -+ tmp = rtw_read8(padapter, REG_MCUFWDL); -+ rtw_write8(padapter, REG_MCUFWDL, tmp|0x01); -+ -+ // 8051 reset -+ tmp = rtw_read8(padapter, REG_MCUFWDL+2); -+ rtw_write8(padapter, REG_MCUFWDL+2, tmp&0xf7); -+ } -+ else -+ { -+ -+ // MCU firmware download disable. -+ tmp = rtw_read8(padapter, REG_MCUFWDL); -+ rtw_write8(padapter, REG_MCUFWDL, tmp&0xfe); -+ } -+} -+#define MAX_REG_BOLCK_SIZE 196 -+static int -+_BlockWrite_8812( -+ PADAPTER padapter, -+ void * buffer, -+ u32 buffSize -+ ) -+{ -+ int ret = _SUCCESS; -+ -+ u32 blockSize_p1 = 4; // (Default) Phase #1 : PCI muse use 4-byte write to download FW -+ u32 blockSize_p2 = 8; // Phase #2 : Use 8-byte, if Phase#1 use big size to write FW. -+ u32 blockSize_p3 = 1; // Phase #3 : Use 1-byte, the remnant of FW image. -+ u32 blockCount_p1 = 0, blockCount_p2 = 0, blockCount_p3 = 0; -+ u32 remainSize_p1 = 0, remainSize_p2 = 0; -+ u8 *bufferPtr = (u8*)buffer; -+ u32 i=0, offset=0; -+ blockSize_p1 = MAX_REG_BOLCK_SIZE; -+ -+ //3 Phase #1 -+ blockCount_p1 = buffSize / blockSize_p1; -+ remainSize_p1 = buffSize % blockSize_p1; -+ -+ if (blockCount_p1) { -+ RT_TRACE(_module_hal_init_c_, _drv_notice_, -+ ("_BlockWrite: [P1] buffSize(%d) blockSize_p1(%d) blockCount_p1(%d) remainSize_p1(%d)\n", -+ buffSize, blockSize_p1, blockCount_p1, remainSize_p1)); -+ } -+ -+ for (i = 0; i < blockCount_p1; i++) -+ { -+ ret = rtw_writeN(padapter, (FW_START_ADDRESS + i * blockSize_p1), blockSize_p1, (bufferPtr + i * blockSize_p1)); -+ -+ if(ret == _FAIL) -+ goto exit; -+ } -+ -+ //3 Phase #2 -+ if (remainSize_p1) -+ { -+ offset = blockCount_p1 * blockSize_p1; -+ -+ blockCount_p2 = remainSize_p1/blockSize_p2; -+ remainSize_p2 = remainSize_p1%blockSize_p2; -+ -+ if (blockCount_p2) { -+ RT_TRACE(_module_hal_init_c_, _drv_notice_, -+ ("_BlockWrite: [P2] buffSize_p2(%d) blockSize_p2(%d) blockCount_p2(%d) remainSize_p2(%d)\n", -+ (buffSize-offset), blockSize_p2 ,blockCount_p2, remainSize_p2)); -+ } -+ -+ for (i = 0; i < blockCount_p2; i++) { -+ ret = rtw_writeN(padapter, (FW_START_ADDRESS + offset + i*blockSize_p2), blockSize_p2, (bufferPtr + offset + i*blockSize_p2)); -+ -+ if(ret == _FAIL) -+ goto exit; -+ } -+ } -+ -+ //3 Phase #3 -+ if (remainSize_p2) -+ { -+ offset = (blockCount_p1 * blockSize_p1) + (blockCount_p2 * blockSize_p2); -+ -+ blockCount_p3 = remainSize_p2 / blockSize_p3; -+ -+ RT_TRACE(_module_hal_init_c_, _drv_notice_, -+ ("_BlockWrite: [P3] buffSize_p3(%d) blockSize_p3(%d) blockCount_p3(%d)\n", -+ (buffSize-offset), blockSize_p3, blockCount_p3)); -+ -+ for(i = 0 ; i < blockCount_p3 ; i++){ -+ ret =rtw_write8(padapter, (FW_START_ADDRESS + offset + i), *(bufferPtr + offset + i)); -+ -+ if(ret == _FAIL) -+ goto exit; -+ } -+ } -+ -+exit: -+ return ret; -+} -+ -+static int -+_PageWrite_8812( -+ PADAPTER padapter, -+ u32 page, -+ void * buffer, -+ u32 size -+ ) -+{ -+ u8 value8; -+ u8 u8Page = (u8) (page & 0x07) ; -+ -+ value8 = (rtw_read8(padapter, REG_MCUFWDL+2) & 0xF8) | u8Page ; -+ rtw_write8(padapter, REG_MCUFWDL+2,value8); -+ -+ return _BlockWrite_8812(padapter,buffer,size); -+} -+ -+static void -+_FillDummy_8812( -+ u8* pFwBuf, -+ u32* pFwLen -+ ) -+{ -+ u32 FwLen = *pFwLen; -+ u8 remain = (u8)(FwLen%4); -+ remain = (remain==0)?0:(4-remain); -+ -+ while(remain>0) -+ { -+ pFwBuf[FwLen] = 0; -+ FwLen++; -+ remain--; -+ } -+ -+ *pFwLen = FwLen; -+} -+ -+static int -+_WriteFW_8812( -+ PADAPTER padapter, -+ void * buffer, -+ u32 size -+ ) -+{ -+ // Since we need dynamic decide method of dwonload fw, so we call this function to get chip version. -+ // We can remove _ReadChipVersion from ReadpadapterInfo8192C later. -+ int ret = _SUCCESS; -+ u32 pageNums,remainSize ; -+ u32 page, offset; -+ u8 *bufferPtr = (u8*)buffer; -+ -+ pageNums = size / MAX_DLFW_PAGE_SIZE ; -+ remainSize = size % MAX_DLFW_PAGE_SIZE; -+ -+ for (page = 0; page < pageNums; page++) { -+ offset = page * MAX_DLFW_PAGE_SIZE; -+ ret = _PageWrite_8812(padapter, page, bufferPtr+offset, MAX_DLFW_PAGE_SIZE); -+ -+ if(ret == _FAIL) -+ goto exit; -+ } -+ if (remainSize) { -+ offset = pageNums * MAX_DLFW_PAGE_SIZE; -+ page = pageNums; -+ ret = _PageWrite_8812(padapter, page, bufferPtr+offset, remainSize); -+ -+ if(ret == _FAIL) -+ goto exit; -+ -+ } -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("_WriteFW Done- for Normal chip.\n")); -+ -+exit: -+ return ret; -+} -+ -+void _8051Reset8812(PADAPTER padapter) -+{ -+ u8 u1bTmp, u1bTmp2; -+ -+ // Reset MCU IO Wrapper- sugggest by SD1-Gimmy -+ if(IS_HARDWARE_TYPE_8812(padapter)) -+ { -+ u1bTmp2 = rtw_read8(padapter, REG_RSV_CTRL+1); -+ rtw_write8(padapter, REG_RSV_CTRL+1, u1bTmp2&(~BIT3)); -+ } -+ else if(IS_HARDWARE_TYPE_8821(padapter)) -+ { -+ u1bTmp2 = rtw_read8(padapter, REG_RSV_CTRL+1); -+ rtw_write8(padapter, REG_RSV_CTRL+1, u1bTmp2&(~BIT0)); -+ } -+ -+ u1bTmp = rtw_read8(padapter, REG_SYS_FUNC_EN+1); -+ rtw_write8(padapter, REG_SYS_FUNC_EN+1, u1bTmp&(~BIT2)); -+ -+ // Enable MCU IO Wrapper -+ if(IS_HARDWARE_TYPE_8812(padapter)) -+ { -+ u1bTmp2 = rtw_read8(padapter, REG_RSV_CTRL+1); -+ rtw_write8(padapter, REG_RSV_CTRL+1, u1bTmp2 |(BIT3)); -+ } -+ else if(IS_HARDWARE_TYPE_8821(padapter)) -+ { -+ u1bTmp2 = rtw_read8(padapter, REG_RSV_CTRL+1); -+ rtw_write8(padapter, REG_RSV_CTRL+1, u1bTmp2|(BIT0)); -+ } -+ -+ rtw_write8(padapter, REG_SYS_FUNC_EN+1, u1bTmp|(BIT2)); -+ -+ DBG_871X("=====> _8051Reset8812(): 8051 reset success .\n"); -+} -+ -+static s32 _FWFreeToGo8812(PADAPTER padapter) -+{ -+ u32 counter = 0; -+ u32 value32; -+ u8 value8; -+ -+ // polling CheckSum report -+ do { -+ value32 = rtw_read32(padapter, REG_MCUFWDL); -+ if (value32 & FWDL_ChkSum_rpt) break; -+ } while (counter++ < 6000); -+ -+ if (counter >= 6000) { -+ DBG_871X("%s: chksum report fail! REG_MCUFWDL:0x%08x\n", __FUNCTION__, value32); -+ return _FAIL; -+ } -+ DBG_871X("%s: Checksum report OK! REG_MCUFWDL:0x%08x\n", __FUNCTION__, value32); -+ -+ value32 = rtw_read32(padapter, REG_MCUFWDL); -+ value32 |= MCUFWDL_RDY; -+ value32 &= ~WINTINI_RDY; -+ rtw_write32(padapter, REG_MCUFWDL, value32); -+ -+ _8051Reset8812(padapter); -+ -+ // polling for FW ready -+ counter = 0; -+ do { -+ value32 = rtw_read32(padapter, REG_MCUFWDL); -+ if (value32 & WINTINI_RDY) { -+ DBG_871X("%s: Polling FW ready success!! REG_MCUFWDL:0x%08x\n", __FUNCTION__, value32); -+ return _SUCCESS; -+ } -+ rtw_udelay_os(5); -+ } while (counter++ < 6000); -+ -+ DBG_871X ("%s: Polling FW ready fail!! REG_MCUFWDL:0x%08x\n", __FUNCTION__, value32); -+ return _FAIL; -+} -+ -+#ifdef CONFIG_FILE_FWIMG -+extern char *rtw_fw_file_path; -+u8 FwBuffer8812[FW_SIZE_8812]; -+#endif //CONFIG_FILE_FWIMG -+ -+s32 -+FirmwareDownload8812( -+ PADAPTER Adapter, -+ bool bUsedWoWLANFw -+) -+{ -+ s32 rtStatus = _SUCCESS; -+ u8 writeFW_retry = 0; -+ u32 fwdl_start_time; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ u8 *pFwImageFileName; -+ u8 *pucMappedFile = NULL; -+ PRT_FIRMWARE_8812 pFirmware = NULL; -+ u8 *pFwHdr = NULL; -+ u8 *pFirmwareBuf; -+ u32 FirmwareLen; -+ -+ -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("+%s\n", __FUNCTION__)); -+ pFirmware = (PRT_FIRMWARE_8812)rtw_zmalloc(sizeof(RT_FIRMWARE_8812)); -+ if(!pFirmware) -+ { -+ rtStatus = _FAIL; -+ goto Exit; -+ } -+ -+ #ifdef CONFIG_FILE_FWIMG -+ if(rtw_is_file_readable(rtw_fw_file_path) == true) -+ { -+ DBG_871X("%s accquire FW from file:%s\n", __FUNCTION__, rtw_fw_file_path); -+ pFirmware->eFWSource = FW_SOURCE_IMG_FILE; -+ } -+ else -+ #endif //CONFIG_FILE_FWIMG -+ { -+ pFirmware->eFWSource = FW_SOURCE_HEADER_FILE; -+ } -+ -+ DBG_871X(" ===> FirmwareDownload8812() fw source from %s.\n", (pFirmware->eFWSource ? "Header": "File")); -+ -+ switch(pFirmware->eFWSource) -+ { -+ case FW_SOURCE_IMG_FILE: -+ #ifdef CONFIG_FILE_FWIMG -+ rtStatus = rtw_retrive_from_file(rtw_fw_file_path, FwBuffer8812, FW_SIZE_8812); -+ pFirmware->ulFwLength = rtStatus>=0?rtStatus:0; -+ pFirmware->szFwBuffer = FwBuffer8812; -+ #endif //CONFIG_FILE_FWIMG -+ break; -+ case FW_SOURCE_HEADER_FILE: -+ ODM_ConfigFWWithHeaderFile(&pHalData->odmpriv, CONFIG_FW_NIC, (u8 *)&(pFirmware->szFwBuffer), &(pFirmware->ulFwLength)); -+ DBG_871X(" ===> FirmwareDownload8812() fw:%s, size: %d\n", "Firmware for NIC", pFirmware->ulFwLength); -+ -+#ifdef CONFIG_WOWLAN -+ ODM_ConfigFWWithHeaderFile(&pHalData->odmpriv, CONFIG_FW_WoWLAN, (u8 *)&(pFirmware->szWoWLANFwBuffer), &(pFirmware->ulWoWLANFwLength)); -+ DBG_871X(" ===> FirmwareDownload88E() fw:%s, size: %d\n", "Firmware for WoWLAN", pFirmware->ulWoWLANFwLength); -+#endif //CONFIG_WOWLAN -+ -+ if (pFirmware->ulFwLength > FW_SIZE_8812) { -+ rtStatus = _FAIL; -+ RT_TRACE(_module_hal_init_c_, _drv_err_, ("Firmware size exceed 0x%X. Check it.\n", FW_SIZE_8812) ); -+ goto Exit; -+ } -+ -+ break; -+ } -+ -+#ifdef CONFIG_WOWLAN -+ if (bUsedWoWLANFw) { -+ pFirmwareBuf = pFirmware->szWoWLANFwBuffer; -+ FirmwareLen = pFirmware->ulWoWLANFwLength; -+ pFwHdr = (u8 *)pFirmware->szWoWLANFwBuffer; -+ } else -+#endif -+ { -+ pFirmwareBuf = pFirmware->szFwBuffer; -+ FirmwareLen = pFirmware->ulFwLength; -+ DBG_871X_LEVEL(_drv_info_, "+%s: !bUsedWoWLANFw, FmrmwareLen:%d+\n", __func__, FirmwareLen); -+ // To Check Fw header. Added by tynli. 2009.12.04. -+ pFwHdr = (u8 *)pFirmware->szFwBuffer; -+ } -+ -+ pHalData->FirmwareVersion = (u16)GET_FIRMWARE_HDR_VERSION_8812(pFwHdr); -+ pHalData->FirmwareSubVersion = (u16)GET_FIRMWARE_HDR_SUB_VER_8812(pFwHdr); -+ pHalData->FirmwareSignature = (u16)GET_FIRMWARE_HDR_SIGNATURE_8812(pFwHdr); -+ -+ DBG_871X ("%s: fw_ver=%d fw_subver=%d sig=0x%x\n", -+ __FUNCTION__, pHalData->FirmwareVersion, pHalData->FirmwareSubVersion, pHalData->FirmwareSignature); -+ -+ if (IS_FW_HEADER_EXIST_8812(pFwHdr) || IS_FW_HEADER_EXIST_8821(pFwHdr)) -+ { -+ // Shift 32 bytes for FW header -+ pFirmwareBuf = pFirmwareBuf + 32; -+ FirmwareLen = FirmwareLen - 32; -+ } -+ -+ // Suggested by Filen. If 8051 is running in RAM code, driver should inform Fw to reset by itself, -+ // or it will cause download Fw fail. 2010.02.01. by tynli. -+ if (rtw_read8(Adapter, REG_MCUFWDL) & BIT7) //8051 RAM code -+ { -+ rtw_write8(Adapter, REG_MCUFWDL, 0x00); -+ _8051Reset8812(Adapter); -+ } -+ -+ _FWDownloadEnable_8812(Adapter, true); -+ fwdl_start_time = rtw_get_current_time(); -+ while(1) { -+ //reset the FWDL chksum -+ rtw_write8(Adapter, REG_MCUFWDL, rtw_read8(Adapter, REG_MCUFWDL)|FWDL_ChkSum_rpt); -+ -+ rtStatus = _WriteFW_8812(Adapter, pFirmwareBuf, FirmwareLen); -+ -+ if(rtStatus == _SUCCESS -+ ||(rtw_get_passing_time_ms(fwdl_start_time) > 500 && writeFW_retry++ >= 3) -+ ) -+ break; -+ -+ DBG_871X("%s writeFW_retry:%u, time after fwdl_start_time:%ums\n", __FUNCTION__ -+ , writeFW_retry -+ , rtw_get_passing_time_ms(fwdl_start_time) -+ ); -+ } -+ _FWDownloadEnable_8812(Adapter, false); -+ if(_SUCCESS != rtStatus){ -+ DBG_871X("DL Firmware failed!\n"); -+ goto Exit; -+ } -+ -+ rtStatus = _FWFreeToGo8812(Adapter); -+ if (_SUCCESS != rtStatus) { -+ DBG_871X("DL Firmware failed!\n"); -+ goto Exit; -+ } -+ RT_TRACE(_module_hal_init_c_, _drv_info_, ("Firmware is ready to run!\n")); -+ -+Exit: -+ -+ if (pFirmware) -+ rtw_mfree((u8*)pFirmware, sizeof(RT_FIRMWARE_8812)); -+ -+ //RT_TRACE(COMP_INIT, DBG_LOUD, (" <=== FirmwareDownload91C()\n")); -+#ifdef CONFIG_WOWLAN -+ if (Adapter->pwrctrlpriv.wowlan_mode) -+ InitializeFirmwareVars8812(Adapter); -+ else -+ DBG_871X_LEVEL(_drv_always_, "%s: wowland_mode:%d wowlan_wake_reason:%d\n", -+ __func__, Adapter->pwrctrlpriv.wowlan_mode, -+ Adapter->pwrctrlpriv.wowlan_wake_reason); -+#endif -+ -+ return rtStatus; -+} -+ -+ -+void InitializeFirmwareVars8812(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ struct pwrctrl_priv *pwrpriv; -+ pwrpriv = &padapter->pwrctrlpriv; -+ -+ // Init Fw LPS related. -+ padapter->pwrctrlpriv.bFwCurrentInPSMode = false; -+ // Init H2C counter. by tynli. 2009.12.09. -+ pHalData->LastHMEBoxNum = 0; -+} -+ -+#ifdef CONFIG_WOWLAN -+//=========================================== -+// -+// Description: Prepare some information to Fw for WoWLAN. -+// (1) Download wowlan Fw. -+// (2) Download RSVD page packets. -+// (3) Enable AP offload if needed. -+// -+// 2011.04.12 by tynli. -+// -+void -+SetFwRelatedForWoWLAN8812( -+ PADAPTER padapter, -+ u8 bHostIsGoingtoSleep -+) -+{ -+ int status=_FAIL; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 bRecover = false; -+ // -+ // 1. Before WoWLAN we need to re-download WoWLAN Fw. -+ // -+ status = FirmwareDownload8812(padapter, bHostIsGoingtoSleep); -+ if(status != _SUCCESS) { -+ DBG_871X("SetFwRelatedForWoWLAN8812(): Re-Download Firmware failed!!\n"); -+ return; -+ } else { -+ DBG_871X("SetFwRelatedForWoWLAN8812(): Re-Download Firmware Success !!\n"); -+ } -+ // -+ // 2. Re-Init the variables about Fw related setting. -+ // -+ InitializeFirmwareVars8812(padapter); -+} -+#endif //CONFIG_WOWLAN -+ -+static void rtl8812_free_hal_data(PADAPTER padapter) -+{ -+ -+ if (padapter->HalData) { -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->isprimary) -+#endif //CONFIG_CONCURRENT_MODE -+ rtw_mfree(padapter->HalData, sizeof(HAL_DATA_TYPE)); -+ padapter->HalData = NULL; -+ } -+ -+} -+ -+//=========================================================== -+// Efuse related code -+//=========================================================== -+bool -+Hal_GetChnlGroup8812A( -+ u8 Channel, -+ u8* pGroup -+ ) -+{ -+ bool bIn24G=true; -+ -+ if(Channel <= 14) -+ { -+ bIn24G=true; -+ -+ if (1 <= Channel && Channel <= 2 ) *pGroup = 0; -+ else if (3 <= Channel && Channel <= 5 ) *pGroup = 1; -+ else if (6 <= Channel && Channel <= 8 ) *pGroup = 2; -+ else if (9 <= Channel && Channel <= 11) *pGroup = 3; -+ else if (12 <= Channel && Channel <= 14) *pGroup = 4; -+ else -+ { -+ DBG_871X("==>mpt_GetChnlGroup8812A in 2.4 G, but Channel %d in Group not found \n", Channel); -+ } -+ } -+ else -+ { -+ bIn24G=false; -+ -+ if (36 <= Channel && Channel <= 42) *pGroup = 0; -+ else if (44 <= Channel && Channel <= 48) *pGroup = 1; -+ else if (50 <= Channel && Channel <= 58) *pGroup = 2; -+ else if (60 <= Channel && Channel <= 64) *pGroup = 3; -+ else if (100 <= Channel && Channel <= 106) *pGroup = 4; -+ else if (108 <= Channel && Channel <= 114) *pGroup = 5; -+ else if (116 <= Channel && Channel <= 122) *pGroup = 6; -+ else if (124 <= Channel && Channel <= 130) *pGroup = 7; -+ else if (132 <= Channel && Channel <= 138) *pGroup = 8; -+ else if (140 <= Channel && Channel <= 144) *pGroup = 9; -+ else if (149 <= Channel && Channel <= 155) *pGroup = 10; -+ else if (157 <= Channel && Channel <= 161) *pGroup = 11; -+ else if (165 <= Channel && Channel <= 171) *pGroup = 12; -+ else if (173 <= Channel && Channel <= 177) *pGroup = 13; -+ else -+ { -+ DBG_871X("==>mpt_GetChnlGroup8812A in 5G, but Channel %d in Group not found \n",Channel); -+ } -+ -+ } -+ //DBG_871X("<==mpt_GetChnlGroup8812A, (%s) Channel = %d, Group =%d,\n", (bIn24G) ? "2.4G" : "5G", Channel, *pGroup); -+ -+ return bIn24G; -+} -+ -+static void -+hal_ReadPowerValueFromPROM8812A( -+ PADAPTER Adapter, -+ PTxPowerInfo24G pwrInfo24G, -+ PTxPowerInfo5G pwrInfo5G, -+ u8* PROMContent, -+ bool AutoLoadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u32 rfPath, eeAddr=EEPROM_TX_PWR_INX_8812, group,TxCount=0; -+ -+ _rtw_memset(pwrInfo24G, 0, sizeof(TxPowerInfo24G)); -+ _rtw_memset(pwrInfo5G, 0, sizeof(TxPowerInfo5G)); -+ -+ //DBG_871X("hal_ReadPowerValueFromPROM8812A(): PROMContent[0x%x]=0x%x\n", (eeAddr+1), PROMContent[eeAddr+1]); -+ if(0xFF == PROMContent[eeAddr+1]) //YJ,add,120316 -+ AutoLoadFail = true; -+ -+ if(AutoLoadFail) -+ { -+ DBG_871X("hal_ReadPowerValueFromPROM8812A(): Use Default value!\n"); -+ for(rfPath = 0 ; rfPath < MAX_RF_PATH ; rfPath++) -+ { -+ // 2.4G default value -+ for(group = 0 ; group < MAX_CHNL_GROUP_24G; group++) -+ { -+ pwrInfo24G->IndexCCK_Base[rfPath][group] = EEPROM_DEFAULT_24G_INDEX; -+ pwrInfo24G->IndexBW40_Base[rfPath][group] = EEPROM_DEFAULT_24G_INDEX; -+ } -+ for(TxCount=0;TxCountBW20_Diff[rfPath][0] = EEPROM_DEFAULT_24G_HT20_DIFF; -+ pwrInfo24G->OFDM_Diff[rfPath][0] = EEPROM_DEFAULT_24G_OFDM_DIFF; -+ } -+ else -+ { -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ pwrInfo24G->BW40_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ pwrInfo24G->CCK_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ } -+ } -+ -+ // 5G default value -+ for(group = 0 ; group < MAX_CHNL_GROUP_5G; group++) -+ { -+ pwrInfo5G->IndexBW40_Base[rfPath][group] = EEPROM_DEFAULT_5G_INDEX; -+ } -+ -+ for(TxCount=0;TxCountOFDM_Diff[rfPath][0] = EEPROM_DEFAULT_5G_OFDM_DIFF; -+ pwrInfo5G->BW20_Diff[rfPath][0] = EEPROM_DEFAULT_5G_HT20_DIFF; -+ pwrInfo5G->BW80_Diff[rfPath][0] = EEPROM_DEFAULT_DIFF; -+ pwrInfo5G->BW160_Diff[rfPath][0] = EEPROM_DEFAULT_DIFF; -+ } -+ else -+ { -+ pwrInfo5G->OFDM_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ pwrInfo5G->BW20_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ pwrInfo5G->BW40_Diff[rfPath][TxCount]= EEPROM_DEFAULT_DIFF; -+ pwrInfo5G->BW80_Diff[rfPath][TxCount]= EEPROM_DEFAULT_DIFF; -+ pwrInfo5G->BW160_Diff[rfPath][TxCount] = EEPROM_DEFAULT_DIFF; -+ -+ } -+ } -+ -+ } -+ -+ //pHalData->bNOPG = true; -+ return; -+ } -+ -+ pHalData->bTXPowerDataReadFromEEPORM = true; //YJ,move,120316 -+ -+ for(rfPath = 0 ; rfPath < MAX_RF_PATH ; rfPath++) -+ { -+ // 2.4G default value -+ for(group = 0 ; group < MAX_CHNL_GROUP_24G; group++) -+ { -+ pwrInfo24G->IndexCCK_Base[rfPath][group] = PROMContent[eeAddr++]; -+ if(pwrInfo24G->IndexCCK_Base[rfPath][group] == 0xFF) -+ { -+ pwrInfo24G->IndexCCK_Base[rfPath][group] = EEPROM_DEFAULT_24G_INDEX; -+ //pHalData->bNOPG = true; -+ } -+ //DBG_871X("8812-2G RF-%d-G-%d CCK-Addr-%x BASE=%x\n", -+ //rfPath, group, eeAddr-1, pwrInfo24G->IndexCCK_Base[rfPath][group]); -+ } -+ for(group = 0 ; group < MAX_CHNL_GROUP_24G-1; group++) -+ { -+ pwrInfo24G->IndexBW40_Base[rfPath][group] = PROMContent[eeAddr++]; -+ if(pwrInfo24G->IndexBW40_Base[rfPath][group] == 0xFF) -+ pwrInfo24G->IndexBW40_Base[rfPath][group] = EEPROM_DEFAULT_24G_INDEX; -+ //DBG_871X("8812-2G RF-%d-G-%d BW40-Addr-%x BASE=%x\n", -+ //rfPath, group, eeAddr-1, pwrInfo24G->IndexBW40_Base[rfPath][group]); -+ } -+ for(TxCount=0;TxCountBW40_Diff[rfPath][TxCount] = 0; -+ -+ { -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; -+ if(pwrInfo24G->BW20_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ //DBG_871X("8812-2G RF-%d-SS-%d BW20-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo24G->BW20_Diff[rfPath][TxCount]); -+ -+ { -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); -+ if(pwrInfo24G->OFDM_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ //DBG_871X("8812-2G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo24G->OFDM_Diff[rfPath][TxCount]); -+ -+ pwrInfo24G->CCK_Diff[rfPath][TxCount] = 0; -+ eeAddr++; -+ } -+ else -+ { -+ -+ { -+ pwrInfo24G->BW40_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; -+ if(pwrInfo24G->BW40_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo24G->BW40_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ //DBG_871X("8812-2G RF-%d-SS-%d BW40-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo24G->BW40_Diff[rfPath][TxCount]); -+ -+ -+ { -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); -+ if(pwrInfo24G->BW20_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo24G->BW20_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ //DBG_871X("8812-2G RF-%d-SS-%d BW20-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo24G->BW20_Diff[rfPath][TxCount]); -+ -+ eeAddr++; -+ -+ -+ { -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; -+ if(pwrInfo24G->OFDM_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo24G->OFDM_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ //DBG_871X("8812-2G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo24G->BW20_Diff[rfPath][TxCount]); -+ -+ -+ { -+ pwrInfo24G->CCK_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); -+ if(pwrInfo24G->CCK_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo24G->CCK_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ //DBG_871X("8812-2G RF-%d-SS-%d CCK-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo24G->CCK_Diff[rfPath][TxCount]); -+ -+ eeAddr++; -+ } -+ } -+ -+ //5G default value -+ for(group = 0 ; group < MAX_CHNL_GROUP_5G; group++) -+ { -+ pwrInfo5G->IndexBW40_Base[rfPath][group] = PROMContent[eeAddr++]; -+ if(pwrInfo5G->IndexBW40_Base[rfPath][group] == 0xFF) -+ pwrInfo5G->IndexBW40_Base[rfPath][group] = EEPROM_DEFAULT_DIFF; -+ -+ //DBG_871X("8812-5G RF-%d-G-%d BW40-Addr-%x BASE=%x\n", -+ // rfPath, TxCount, eeAddr-1, pwrInfo5G->IndexBW40_Base[rfPath][group]); -+ } -+ -+ for(TxCount=0;TxCountBW40_Diff[rfPath][TxCount]= 0; -+ -+ -+ { -+ pwrInfo5G->BW20_Diff[rfPath][0] = (PROMContent[eeAddr]&0xf0)>>4; -+ if(pwrInfo5G->BW20_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo5G->BW20_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ //DBG_871X("8812-5G RF-%d-SS-%d BW20-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo5G->BW20_Diff[rfPath][TxCount]); -+ -+ -+ { -+ pwrInfo5G->OFDM_Diff[rfPath][0] = (PROMContent[eeAddr]&0x0f); -+ if(pwrInfo5G->OFDM_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo5G->OFDM_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ //DBG_871X("8812-5G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo5G->OFDM_Diff[rfPath][TxCount]); -+ -+ eeAddr++; -+ } -+ else -+ { -+ -+ { -+ pwrInfo5G->BW40_Diff[rfPath][TxCount]= (PROMContent[eeAddr]&0xf0)>>4; -+ if(pwrInfo5G->BW40_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo5G->BW40_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ //DBG_871X("8812-5G RF-%d-SS-%d BW40-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo5G->BW40_Diff[rfPath][TxCount]); -+ -+ -+ { -+ pwrInfo5G->BW20_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0x0f); -+ if(pwrInfo5G->BW20_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo5G->BW20_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ //DBG_871X("8812-5G RF-%d-SS-%d BW20-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo5G->BW20_Diff[rfPath][TxCount]); -+ -+ eeAddr++; -+ } -+ } -+ -+ -+ { -+ pwrInfo5G->OFDM_Diff[rfPath][1] = (PROMContent[eeAddr]&0xf0)>>4; -+ pwrInfo5G->OFDM_Diff[rfPath][2] = (PROMContent[eeAddr]&0x0f); -+ } -+ //DBG_871X("8812-5G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", -+ // rfPath, 2, eeAddr, pwrInfo5G->OFDM_Diff[rfPath][2]); -+ eeAddr++; -+ -+ -+ pwrInfo5G->OFDM_Diff[rfPath][3] = (PROMContent[eeAddr]&0x0f); -+ -+ //DBG_871X("8812-5G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", -+ //rfPath, 3, eeAddr, pwrInfo5G->OFDM_Diff[rfPath][3]); -+ eeAddr++; -+ -+ for(TxCount=1;TxCountOFDM_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo5G->OFDM_Diff[rfPath][TxCount] |= 0xF0; -+ -+ //DBG_871X("8812-5G RF-%d-SS-%d LGOD-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo5G->OFDM_Diff[rfPath][TxCount]); -+ } -+ -+ for(TxCount=0;TxCountBW80_Diff[rfPath][TxCount] = (PROMContent[eeAddr]&0xf0)>>4; -+ if(pwrInfo5G->BW80_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo5G->BW80_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ //DBG_871X("8812-5G RF-%d-SS-%d BW80-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo5G->BW80_Diff[rfPath][TxCount]); -+ -+ -+ { -+ pwrInfo5G->BW160_Diff[rfPath][TxCount]= (PROMContent[eeAddr]&0x0f); -+ if(pwrInfo5G->BW160_Diff[rfPath][TxCount] & BIT3) //4bit sign number to 8 bit sign number -+ pwrInfo5G->BW160_Diff[rfPath][TxCount] |= 0xF0; -+ } -+ //DBG_871X("8812-5G RF-%d-SS-%d BW160-Addr-%x DIFF=%d\n", -+ //rfPath, TxCount, eeAddr, pwrInfo5G->BW160_Diff[rfPath][TxCount]); -+ eeAddr++; -+ } -+ } -+ -+} -+ -+void -+Hal_EfuseParseBTCoexistInfo8812A( -+ PADAPTER Adapter, -+ pu1Byte hwinfo, -+ bool AutoLoadFail -+ ) -+{ -+#ifdef CONFIG_BT_COEXIST -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ pHalData->EEPROMBluetoothCoexist = 0; -+ pHalData->EEPROMBluetoothType = BT_CSR_BC8; -+ pHalData->EEPROMBluetoothAntNum = Ant_x2; -+ pHalData->EEPROMBluetoothAntIsolation = 1; -+ pHalData->EEPROMBluetoothRadioShared = BT_Radio_Shared; -+ BT_InitHalVars(Adapter); -+#endif -+} -+ -+void -+Hal_EfuseParseIDCode8812A( -+ PADAPTER padapter, -+ u8 *hwinfo -+ ) -+{ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ u16 EEPROMId; -+ -+ -+ // Checl 0x8129 again for making sure autoload status!! -+ EEPROMId = le16_to_cpu(*((u16*)hwinfo)); -+ if (EEPROMId != RTL_EEPROM_ID) -+ { -+ DBG_8192C("EEPROM ID(%#x) is invalid!!\n", EEPROMId); -+ pEEPROM->bautoload_fail_flag = true; -+ } -+ else -+ { -+ pEEPROM->bautoload_fail_flag = false; -+ } -+ -+ DBG_8192C("EEPROM ID=0x%04x\n", EEPROMId); -+} -+ -+void -+Hal_ReadPROMVersion8812A( -+ PADAPTER Adapter, -+ u8* PROMContent, -+ bool AutoloadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if(AutoloadFail){ -+ pHalData->EEPROMVersion = EEPROM_Default_Version; -+ } -+ else{ -+ pHalData->EEPROMVersion = *(u8 *)&PROMContent[EEPROM_VERSION_8812]; -+ if(pHalData->EEPROMVersion == 0xFF) -+ pHalData->EEPROMVersion = EEPROM_Default_Version; -+ } -+ //DBG_871X("pHalData->EEPROMVersion is 0x%x\n", pHalData->EEPROMVersion); -+} -+ -+void -+Hal_ReadTxPowerInfo8812A( -+ PADAPTER Adapter, -+ u8* PROMContent, -+ bool AutoLoadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ TxPowerInfo24G pwrInfo24G; -+ TxPowerInfo5G pwrInfo5G; -+ u8 rfPath, ch, group, TxCount; -+ u8 channel5G[CHANNEL_MAX_NUMBER_5G] = -+ {36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112, -+ 114,116,118,120,122,124,126,128,130,132,134,136,138,140,142,144,149,151, -+ 153,155,157,159,161,163,165,167,168,169,171,173,175,177}; -+ u8 channel5G_80M[CHANNEL_MAX_NUMBER_5G_80M] = {42, 58, 106, 122, 138, 155, 171}; -+ -+ hal_ReadPowerValueFromPROM8812A(Adapter, &pwrInfo24G,&pwrInfo5G, PROMContent, AutoLoadFail); -+ -+ //if(!AutoLoadFail) -+ // pHalData->bTXPowerDataReadFromEEPORM = true; -+ -+ for(rfPath = 0 ; rfPath < MAX_RF_PATH ; rfPath++) -+ { -+ for(ch = 0 ; ch < CHANNEL_MAX_NUMBER_2G ; ch++) -+ { -+ Hal_GetChnlGroup8812A(ch+1, &group); -+ -+ if(ch == 14-1) -+ { -+ pHalData->Index24G_CCK_Base[rfPath][ch] = pwrInfo24G.IndexCCK_Base[rfPath][5]; -+ pHalData->Index24G_BW40_Base[rfPath][ch] = pwrInfo24G.IndexBW40_Base[rfPath][group]; -+ } -+ else -+ { -+ pHalData->Index24G_CCK_Base[rfPath][ch] = pwrInfo24G.IndexCCK_Base[rfPath][group]; -+ pHalData->Index24G_BW40_Base[rfPath][ch] = pwrInfo24G.IndexBW40_Base[rfPath][group]; -+ } -+ //DBG_871X("======= Path %d, ChannelIndex %d, Group %d=======\n",rfPath,ch, group); -+ //DBG_871X("Index24G_CCK_Base[%d][%d] = 0x%x\n",rfPath,ch ,pHalData->Index24G_CCK_Base[rfPath][ch]); -+ //DBG_871X("Index24G_BW40_Base[%d][%d] = 0x%x\n",rfPath,ch,pHalData->Index24G_BW40_Base[rfPath][ch]); -+ } -+ -+ for(ch = 0 ; ch < CHANNEL_MAX_NUMBER_5G; ch++) -+ { -+ Hal_GetChnlGroup8812A(channel5G[ch], &group); -+ -+ pHalData->Index5G_BW40_Base[rfPath][ch] = pwrInfo5G.IndexBW40_Base[rfPath][group]; -+ //DBG_871X("======= Path %d, ChannelIndex %d, Group %d=======\n",rfPath,ch, group); -+ //DBG_871X("Index5G_BW40_Base[%d][%d] = 0x%x\n",rfPath,ch,pHalData->Index5G_BW40_Base[rfPath][ch]); -+ } -+ for(ch = 0 ; ch < CHANNEL_MAX_NUMBER_5G_80M; ch++) -+ { -+ u8 upper, lower; -+ -+ Hal_GetChnlGroup8812A(channel5G_80M[ch], &group); -+ upper = pwrInfo5G.IndexBW40_Base[rfPath][group]; -+ lower = pwrInfo5G.IndexBW40_Base[rfPath][group+1]; -+ -+ pHalData->Index5G_BW80_Base[rfPath][ch] = (upper + lower) / 2; -+ -+ //DBG_871X("======= Path %d, ChannelIndex %d, Group %d=======\n",rfPath,ch, group); -+ //DBG_871X("Index5G_BW80_Base[%d][%d] = 0x%x\n",rfPath,ch,pHalData->Index5G_BW80_Base[rfPath][ch]); -+ } -+ -+ for(TxCount=0;TxCountCCK_24G_Diff[rfPath][TxCount]=pwrInfo24G.CCK_Diff[rfPath][TxCount]; -+ pHalData->OFDM_24G_Diff[rfPath][TxCount]=pwrInfo24G.OFDM_Diff[rfPath][TxCount]; -+ pHalData->BW20_24G_Diff[rfPath][TxCount]=pwrInfo24G.BW20_Diff[rfPath][TxCount]; -+ pHalData->BW40_24G_Diff[rfPath][TxCount]=pwrInfo24G.BW40_Diff[rfPath][TxCount]; -+ -+ pHalData->OFDM_5G_Diff[rfPath][TxCount]=pwrInfo5G.OFDM_Diff[rfPath][TxCount]; -+ pHalData->BW20_5G_Diff[rfPath][TxCount]=pwrInfo5G.BW20_Diff[rfPath][TxCount]; -+ pHalData->BW40_5G_Diff[rfPath][TxCount]=pwrInfo5G.BW40_Diff[rfPath][TxCount]; -+ pHalData->BW80_5G_Diff[rfPath][TxCount]=pwrInfo5G.BW80_Diff[rfPath][TxCount]; -+//#if DBG -+#if 0 -+ DBG_871X("--------------------------------------- 2.4G ---------------------------------------\n"); -+ DBG_871X("CCK_24G_Diff[%d][%d]= %d\n",rfPath,TxCount,pHalData->CCK_24G_Diff[rfPath][TxCount]); -+ DBG_871X("OFDM_24G_Diff[%d][%d]= %d\n",rfPath,TxCount,pHalData->OFDM_24G_Diff[rfPath][TxCount]); -+ DBG_871X("BW20_24G_Diff[%d][%d]= %d\n",rfPath,TxCount,pHalData->BW20_24G_Diff[rfPath][TxCount]); -+ DBG_871X("BW40_24G_Diff[%d][%d]= %d\n",rfPath,TxCount,pHalData->BW40_24G_Diff[rfPath][TxCount]); -+ DBG_871X("---------------------------------------- 5G ----------------------------------------\n"); -+ DBG_871X("OFDM_5G_Diff[%d][%d]= %d\n",rfPath,TxCount,pHalData->OFDM_5G_Diff[rfPath][TxCount]); -+ DBG_871X("BW20_5G_Diff[%d][%d]= %d\n",rfPath,TxCount,pHalData->BW20_5G_Diff[rfPath][TxCount]); -+ DBG_871X("BW40_5G_Diff[%d][%d]= %d\n",rfPath,TxCount,pHalData->BW40_5G_Diff[rfPath][TxCount]); -+ DBG_871X("BW80_5G_Diff[%d][%d]= %d\n",rfPath,TxCount,pHalData->BW80_5G_Diff[rfPath][TxCount]); -+#endif -+ } -+ } -+ -+ -+ // 2010/10/19 MH Add Regulator recognize for CU. -+ if(!AutoLoadFail) -+ { -+ struct registry_priv *registry_par = &Adapter->registrypriv; -+ if( registry_par->regulatory_tid == 0xff){ -+ -+ if(PROMContent[EEPROM_RF_BOARD_OPTION_8812] == 0xFF) -+ pHalData->EEPROMRegulatory = (EEPROM_DEFAULT_BOARD_OPTION&0x7); //bit0~2 -+ else -+ pHalData->EEPROMRegulatory = (PROMContent[EEPROM_RF_BOARD_OPTION_8812]&0x7); //bit0~2 -+ } -+ else{ -+ pHalData->EEPROMRegulatory = registry_par->regulatory_tid; -+ } -+ -+ // 2012/09/26 MH Add for TX power calibrate rate. -+ pHalData->TxPwrCalibrateRate = PROMContent[EEPROM_TX_PWR_CALIBRATE_RATE_8812]; -+ } -+ else -+ { -+ pHalData->EEPROMRegulatory = 0; -+ // 2012/09/26 MH Add for TX power calibrate rate. -+ pHalData->TxPwrCalibrateRate = EEPROM_DEFAULT_TX_CALIBRATE_RATE; -+ } -+ DBG_871X("EEPROMRegulatory = 0x%x TxPwrCalibrateRate=0x%x\n", pHalData->EEPROMRegulatory, pHalData->TxPwrCalibrateRate); -+ -+} -+ -+void -+Hal_ReadBoardType8812A( -+ PADAPTER Adapter, -+ u8* PROMContent, -+ bool AutoloadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if(!AutoloadFail) -+ { -+ pHalData->InterfaceSel = (PROMContent[EEPROM_RF_BOARD_OPTION_8812]&0xE0)>>5; -+ if(PROMContent[EEPROM_RF_BOARD_OPTION_8812] == 0xFF) -+ pHalData->InterfaceSel = (EEPROM_DEFAULT_BOARD_OPTION&0xE0)>>5; -+ } -+ else -+ { -+ pHalData->InterfaceSel = 0; -+ } -+ DBG_871X("Board Type: 0x%2x\n", pHalData->InterfaceSel); -+ -+} -+ -+void -+Hal_ReadThermalMeter_8812A( -+ PADAPTER Adapter, -+ u8* PROMContent, -+ bool AutoloadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ //u8 tempval; -+ -+ // -+ // ThermalMeter from EEPROM -+ // -+ if(!AutoloadFail) -+ pHalData->EEPROMThermalMeter = PROMContent[EEPROM_THERMAL_METER_8812]; -+ else -+ pHalData->EEPROMThermalMeter = EEPROM_Default_ThermalMeter_8812; -+ //pHalData->EEPROMThermalMeter = (tempval&0x1f); //[4:0] -+ -+ if(pHalData->EEPROMThermalMeter == 0xff || AutoloadFail) -+ { -+ pHalData->bAPKThermalMeterIgnore = true; -+ pHalData->EEPROMThermalMeter = 0xFF; -+ } -+ -+ //pHalData->ThermalMeter[0] = pHalData->EEPROMThermalMeter; -+ DBG_871X("ThermalMeter = 0x%x\n", pHalData->EEPROMThermalMeter); -+} -+ -+void -+Hal_ReadChannelPlan8812A( -+ PADAPTER padapter, -+ u8* hwinfo, -+ bool AutoLoadFail -+ ) -+{ -+ padapter->mlmepriv.ChannelPlan = hal_com_get_channel_plan( -+ padapter -+ , hwinfo?hwinfo[EEPROM_ChannelPlan_8812]:0xFF -+ , padapter->registrypriv.channel_plan -+ , RT_CHANNEL_DOMAIN_REALTEK_DEFINE -+ , AutoLoadFail -+ ); -+ -+ DBG_871X("mlmepriv.ChannelPlan = 0x%02x\n", padapter->mlmepriv.ChannelPlan); -+} -+ -+void -+Hal_EfuseParseXtal_8812A( -+ PADAPTER pAdapter, -+ u8* hwinfo, -+ bool AutoLoadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ if(!AutoLoadFail) -+ { -+ pHalData->CrystalCap = hwinfo[EEPROM_XTAL_8812]; -+ if(pHalData->CrystalCap == 0xFF) -+ pHalData->CrystalCap = EEPROM_Default_CrystalCap_8812; //what value should 8812 set? -+ } -+ else -+ { -+ pHalData->CrystalCap = EEPROM_Default_CrystalCap_8812; -+ } -+ DBG_871X("CrystalCap: 0x%2x\n", pHalData->CrystalCap); -+} -+ -+void -+Hal_ReadAntennaDiversity8812A( -+ PADAPTER pAdapter, -+ u8* PROMContent, -+ bool AutoLoadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct registry_priv *registry_par = &pAdapter->registrypriv; -+ -+ if(!AutoLoadFail) -+ { -+ // Antenna Diversity setting. -+ if(registry_par->antdiv_cfg == 2) -+ { -+ pHalData->AntDivCfg = (PROMContent[EEPROM_RF_BOARD_OPTION_8812]&0x18)>>3; -+ if(PROMContent[EEPROM_RF_BOARD_OPTION_8812] == 0xFF) -+ pHalData->AntDivCfg = (EEPROM_DEFAULT_BOARD_OPTION&0x18)>>3;; -+ } -+ else -+ { -+ pHalData->AntDivCfg = registry_par->antdiv_cfg; -+ } -+ -+ if(pHalData->EEPROMBluetoothCoexist!=0 && pHalData->EEPROMBluetoothAntNum==Ant_x1) -+ pHalData->AntDivCfg = 0; -+ -+ pHalData->TRxAntDivType = PROMContent[EEPROM_RF_ANTENNA_OPT_8812]; //todo by page -+ if (pHalData->TRxAntDivType == 0xFF) -+ pHalData->TRxAntDivType = FIXED_HW_ANTDIV; // For 88EE, 1Tx and 1RxCG are fixed.(1Ant, Tx and RxCG are both on aux port) -+ } -+ else -+ { -+ pHalData->AntDivCfg = 0; -+ //pHalData->TRxAntDivType = pHalData->TRxAntDivType; // ????? -+ } -+ -+ DBG_871X("SWAS: bHwAntDiv = %x, TRxAntDivType = %x\n", pHalData->AntDivCfg, pHalData->TRxAntDivType); -+} -+ -+void -+Hal_ReadPAType_8812A( -+ PADAPTER Adapter, -+ u8* PROMContent, -+ bool AutoloadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if( ! AutoloadFail ) -+ { -+ if (GetRegAmplifierType2G(Adapter) == 0) // AUTO -+ { -+ pHalData->PAType_2G = ( *(u8 *)&PROMContent[EEPROM_PA_TYPE_8812AU] ); -+ pHalData->LNAType_2G = ( *(u8 *)&PROMContent[EEPROM_LNA_TYPE_2G_8812AU] ); -+ if (pHalData->PAType_2G == 0xFF && pHalData->LNAType_2G == 0xFF) { -+ pHalData->PAType_2G = 0; -+ pHalData->LNAType_2G = 0; -+ } -+ pHalData->ExternalPA_2G = ((pHalData->PAType_2G & BIT5) && (pHalData->PAType_2G & BIT4)) ? 1 : 0; -+ pHalData->ExternalLNA_2G = ((pHalData->LNAType_2G & BIT7) && (pHalData->LNAType_2G & BIT3)) ? 1 : 0; -+ } -+ else -+ { -+ pHalData->ExternalPA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_PA) ? 1 : 0; -+ pHalData->ExternalLNA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_LNA) ? 1 : 0; -+ } -+ -+ if (GetRegAmplifierType5G(Adapter) == 0) // AUTO -+ { -+ pHalData->PAType_5G = ( *(u8 *)&PROMContent[EEPROM_PA_TYPE_8812AU] ); -+ pHalData->LNAType_5G = ( *(u8 *)&PROMContent[EEPROM_LNA_TYPE_5G_8812AU] ); -+ if (pHalData->PAType_5G == 0xFF && pHalData->LNAType_5G == 0xFF) { -+ pHalData->PAType_5G = 0; -+ pHalData->LNAType_5G = 0; -+ } -+ pHalData->ExternalPA_5G = ((pHalData->PAType_5G & BIT1) && (pHalData->PAType_5G & BIT0)) ? 1 : 0; -+ pHalData->ExternalLNA_5G = ((pHalData->LNAType_5G & BIT7) && (pHalData->LNAType_5G & BIT3)) ? 1 : 0; -+ } -+ else -+ { -+ pHalData->ExternalPA_5G = (GetRegAmplifierType5G(Adapter)&ODM_BOARD_EXT_PA_5G) ? 1 : 0; -+ pHalData->ExternalLNA_5G = (GetRegAmplifierType5G(Adapter)&ODM_BOARD_EXT_LNA_5G) ? 1 : 0; -+ } -+ } -+ else -+ { -+ pHalData->ExternalPA_2G = EEPROM_Default_PAType; -+ pHalData->ExternalPA_5G = 0xFF; -+ pHalData->ExternalLNA_2G = EEPROM_Default_LNAType; -+ pHalData->ExternalLNA_5G = 0xFF; -+ -+ if (GetRegAmplifierType2G(Adapter) == 0) // AUTO -+ { -+ pHalData->ExternalPA_2G = 0; -+ pHalData->ExternalLNA_2G = 0; -+ } -+ else -+ { -+ pHalData->ExternalPA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_PA) ? 1 : 0; -+ pHalData->ExternalLNA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_LNA) ? 1 : 0; -+ } -+ if (GetRegAmplifierType5G(Adapter) == 0) // AUTO -+ { -+ pHalData->ExternalPA_5G = 0; -+ pHalData->ExternalLNA_5G = 0; -+ } -+ else -+ { -+ pHalData->ExternalPA_5G = (GetRegAmplifierType5G(Adapter)&ODM_BOARD_EXT_PA_5G) ? 1 : 0; -+ pHalData->ExternalLNA_5G = (GetRegAmplifierType5G(Adapter)&ODM_BOARD_EXT_LNA_5G) ? 1 : 0; -+ } -+ } -+ DBG_871X("pHalData->PAType_2G is 0x%x, pHalData->ExternalPA_2G = %d\n", pHalData->PAType_2G, pHalData->ExternalPA_2G); -+ DBG_871X("pHalData->PAType_5G is 0x%x, pHalData->ExternalPA_5G = %d\n", pHalData->PAType_5G, pHalData->ExternalPA_5G); -+ DBG_871X("pHalData->LNAType_2G is 0x%x, pHalData->ExternalLNA_2G = %d\n", pHalData->LNAType_2G, pHalData->ExternalLNA_2G); -+ DBG_871X("pHalData->LNAType_5G is 0x%x, pHalData->ExternalLNA_5G = %d\n", pHalData->LNAType_5G, pHalData->ExternalLNA_5G); -+} -+ -+void -+Hal_ReadPAType_8821A( -+ PADAPTER Adapter, -+ u8* PROMContent, -+ bool AutoloadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if( ! AutoloadFail ) -+ { -+ if (GetRegAmplifierType2G(Adapter) == 0) // AUTO -+ { -+ pHalData->PAType_2G = ( *(u8 *)&PROMContent[EEPROM_PA_TYPE_8812AU] ); -+ pHalData->LNAType_2G = ( *(u8 *)&PROMContent[EEPROM_LNA_TYPE_2G_8812AU] ); -+ if (pHalData->PAType_2G == 0xFF && pHalData->LNAType_2G == 0xFF) { -+ pHalData->PAType_2G = 0; -+ pHalData->LNAType_2G = 0; -+ } -+ pHalData->ExternalPA_2G = (pHalData->PAType_2G & BIT4) ? 1 : 0; -+ pHalData->ExternalLNA_2G = (pHalData->LNAType_2G & BIT3) ? 1 : 0; -+ } -+ else -+ { -+ pHalData->ExternalPA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_PA) ? 1 : 0; -+ pHalData->ExternalLNA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_LNA) ? 1 : 0; -+ } -+ -+ if (GetRegAmplifierType5G(Adapter) == 0) // AUTO -+ { -+ pHalData->PAType_5G = ( *(u8 *)&PROMContent[EEPROM_PA_TYPE_8812AU] ); -+ pHalData->LNAType_5G = ( *(u8 *)&PROMContent[EEPROM_LNA_TYPE_5G_8812AU] ); -+ if (pHalData->PAType_5G == 0xFF && pHalData->LNAType_5G == 0xFF) { -+ pHalData->PAType_5G = 0; -+ pHalData->LNAType_5G = 0; -+ } -+ pHalData->ExternalPA_5G = (pHalData->PAType_5G & BIT0) ? 1 : 0; -+ pHalData->ExternalLNA_5G = (pHalData->LNAType_5G & BIT3) ? 1 : 0; -+ } -+ else -+ { -+ pHalData->ExternalPA_5G = (GetRegAmplifierType5G(Adapter)&ODM_BOARD_EXT_PA_5G) ? 1 : 0; -+ pHalData->ExternalLNA_5G = (GetRegAmplifierType5G(Adapter)&ODM_BOARD_EXT_LNA_5G) ? 1 : 0; -+ } -+ } -+ else -+ { -+ pHalData->ExternalPA_2G = EEPROM_Default_PAType; -+ pHalData->ExternalPA_5G = 0xFF; -+ pHalData->ExternalLNA_2G = EEPROM_Default_LNAType; -+ pHalData->ExternalLNA_5G = 0xFF; -+ -+ if (GetRegAmplifierType2G(Adapter) == 0) // AUTO -+ { -+ pHalData->ExternalPA_2G = 0; -+ pHalData->ExternalLNA_2G = 0; -+ } -+ else -+ { -+ pHalData->ExternalPA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_PA) ? 1 : 0; -+ pHalData->ExternalLNA_2G = (GetRegAmplifierType2G(Adapter)&ODM_BOARD_EXT_LNA) ? 1 : 0; -+ } -+ if (GetRegAmplifierType5G(Adapter) == 0) // AUTO -+ { -+ pHalData->ExternalPA_5G = 0; -+ pHalData->ExternalLNA_5G = 0; -+ } -+ else -+ { -+ pHalData->ExternalPA_5G = (GetRegAmplifierType5G(Adapter)&ODM_BOARD_EXT_PA_5G) ? 1 : 0; -+ pHalData->ExternalLNA_5G = (GetRegAmplifierType5G(Adapter)&ODM_BOARD_EXT_LNA_5G) ? 1 : 0; -+ } -+ } -+ DBG_871X("pHalData->PAType_2G is 0x%x, pHalData->ExternalPA_2G = %d\n", pHalData->PAType_2G, pHalData->ExternalPA_2G); -+ DBG_871X("pHalData->PAType_5G is 0x%x, pHalData->ExternalPA_5G = %d\n", pHalData->PAType_5G, pHalData->ExternalPA_5G); -+ DBG_871X("pHalData->LNAType_2G is 0x%x, pHalData->ExternalLNA_2G = %d\n", pHalData->LNAType_2G, pHalData->ExternalLNA_2G); -+ DBG_871X("pHalData->LNAType_5G is 0x%x, pHalData->ExternalLNA_5G = %d\n", pHalData->LNAType_5G, pHalData->ExternalLNA_5G); -+} -+ -+void -+Hal_ReadRFEType_8812A( -+ PADAPTER Adapter, -+ u8* PROMContent, -+ bool AutoloadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if(!AutoloadFail) -+ { -+ if(GetRegRFEType(Adapter) != 64) -+ pHalData->RFEType = GetRegRFEType(Adapter); -+ else if(PROMContent[EEPROM_RFE_OPTION_8812] & BIT7) -+ { -+ if(pHalData->ExternalLNA_5G) -+ { -+ if(pHalData->ExternalPA_5G) -+ { -+ if(pHalData->ExternalLNA_2G && pHalData->ExternalPA_2G ) -+ pHalData->RFEType = 3; -+ else -+ pHalData->RFEType = 0; -+ } -+ else -+ pHalData->RFEType = 2; -+ } -+ else -+ pHalData->RFEType = 4; -+ } -+ else -+ { -+ pHalData->RFEType = PROMContent[EEPROM_RFE_OPTION_8812]&0x3F; -+ -+ // 2013/03/19 MH Due to othe customer already use incorrect EFUSE map -+ // to for their product. We need to add workaround to prevent to modify -+ // spec and notify all customer to revise the IC 0xca content. After -+ // discussing with Willis an YN, revise driver code to prevent. -+ if (pHalData->RFEType == 4 && -+ (pHalData->ExternalPA_5G == true || pHalData->ExternalPA_2G == true || -+ pHalData->ExternalLNA_5G == true || pHalData->ExternalLNA_2G == true)) -+ { -+ if (IS_HARDWARE_TYPE_8812AU(Adapter)) -+ pHalData->RFEType = 0; -+ else if (IS_HARDWARE_TYPE_8812E(Adapter)) -+ pHalData->RFEType = 2; -+ } -+ } -+ } -+ else -+ { -+ if(GetRegRFEType(Adapter) != 64) -+ pHalData->RFEType = GetRegRFEType(Adapter); -+ else -+ pHalData->RFEType = EEPROM_DEFAULT_RFE_OPTION; -+ } -+ -+ DBG_871X("RFE Type: 0x%2x\n", pHalData->RFEType); -+} -+ -+// -+// 2013/04/15 MH Add 8812AU- VL/VS/VN for different board type. -+// -+void -+hal_ReadUsbType_8812AU( -+ PADAPTER Adapter, -+ u8 *PROMContent, -+ bool AutoloadFail -+ ) -+{ -+ //if (IS_HARDWARE_TYPE_8812AU(Adapter) && Adapter->UsbModeMechanism.RegForcedUsbMode == 5) -+ { -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ u8 reg_tmp, i, j, antenna = 0, wmode = 0; -+ // Read anenna type from EFUSE 1019/1018 -+ for (i = 0; i < 2; i++) -+ { -+ // Check efuse address 1019 -+ // Check efuse address 1018 -+ efuse_OneByteRead(Adapter, 1019-i, ®_tmp, false); -+ -+ for (j = 0; j < 2; j++) -+ { -+ // CHeck bit 7-5 -+ // Check bit 3-1 -+ antenna = ((reg_tmp&0xee) >> (5-(j*4))); -+ if (antenna == 0) -+ continue; -+ else -+ { -+ break; -+ } -+ } -+ } -+ -+ // Read anenna type from EFUSE 1021/1020 -+ for (i = 0; i < 2; i++) -+ { -+ // Check efuse address 1019 -+ // Check efuse address 1018 -+ efuse_OneByteRead(Adapter, 1021-i, ®_tmp, false); -+ -+ for (j = 0; j < 2; j++) -+ { -+ // CHeck bit 3-2 -+ // Check bit 1-0 -+ wmode = ((reg_tmp&0x0f) >> (2-(j*2))); -+ if (wmode) -+ continue; -+ else -+ { -+ break; -+ } -+ } -+ } -+ -+ // Antenna == 1 WMODE = 3 RTL8812AU-VL 11AC + USB2.0 Mode -+ if (antenna == 1) -+ { -+ // Config 8812AU as 1*1 mode AC mode. -+ pHalData->rf_type = RF_1T1R; -+ //UsbModeSwitch_SetUsbModeMechOn(Adapter, false); -+ //pHalData->EFUSEHidden = EFUSE_HIDDEN_812AU_VL; -+ DBG_871X("%s(): EFUSE_HIDDEN_812AU_VL\n",__FUNCTION__); -+ } -+ else if (antenna == 2) -+ { -+ if (wmode == 3) -+ { -+ if (PROMContent[EEPROM_USB_MODE_8812] == 0x2) -+ { -+ // RTL8812AU Normal Mode. No further action. -+ //pHalData->EFUSEHidden = EFUSE_HIDDEN_812AU; -+ DBG_871X("%s(): EFUSE_HIDDEN_812AU\n",__FUNCTION__); -+ } -+ else -+ { -+ // Antenna == 2 WMODE = 3 RTL8812AU-VS 11AC + USB2.0 Mode -+ // Driver will not support USB automatic switch -+ //UsbModeSwitch_SetUsbModeMechOn(Adapter, false); -+ //pHalData->EFUSEHidden = EFUSE_HIDDEN_812AU_VS; -+ DBG_871X("%s(): EFUSE_HIDDEN_812AU_VS\n",__FUNCTION__); -+ } -+ } -+ else if (wmode == 2) -+ { -+ // Antenna == 2 WMODE = 2 RTL8812AU-VN 11N only + USB2.0 Mode -+ //UsbModeSwitch_SetUsbModeMechOn(Adapter, false); -+ //pHalData->EFUSEHidden = EFUSE_HIDDEN_812AU_VN; -+ DBG_871X("%s(): EFUSE_HIDDEN_812AU_VN\n",__FUNCTION__); -+ } -+ } -+ } -+} -+ -+enum{ -+ VOLTAGE_V25 = 0x03, -+ LDOE25_SHIFT = 28 , -+ }; -+ -+static void -+Hal_EfusePowerSwitch8812A( -+ PADAPTER pAdapter, -+ u8 bWrite, -+ u8 PwrState) -+{ -+ u8 tempval; -+ u16 tmpV16; -+ #define EFUSE_ACCESS_ON_JAGUAR 0x69 -+ #define EFUSE_ACCESS_OFF_JAGUAR 0x00 -+ if (PwrState == true) -+ { -+ rtw_write8(pAdapter, REG_EFUSE_BURN_GNT_8812, EFUSE_ACCESS_ON_JAGUAR); -+ -+ // 1.2V Power: From VDDON with Power Cut(0x0000h[15]), defualt valid -+ tmpV16 = rtw_read16(pAdapter,REG_SYS_ISO_CTRL); -+ if( ! (tmpV16 & PWC_EV12V ) ){ -+ tmpV16 |= PWC_EV12V ; -+ //rtw_write16(pAdapter,REG_SYS_ISO_CTRL,tmpV16); -+ } -+ // Reset: 0x0000h[28], default valid -+ tmpV16 = rtw_read16(pAdapter,REG_SYS_FUNC_EN); -+ if( !(tmpV16 & FEN_ELDR) ){ -+ tmpV16 |= FEN_ELDR ; -+ rtw_write16(pAdapter,REG_SYS_FUNC_EN,tmpV16); -+ } -+ -+ // Clock: Gated(0x0008h[5]) 8M(0x0008h[1]) clock from ANA, default valid -+ tmpV16 = rtw_read16(pAdapter,REG_SYS_CLKR); -+ if( (!(tmpV16 & LOADER_CLK_EN) ) ||(!(tmpV16 & ANA8M) ) ) -+ { -+ tmpV16 |= (LOADER_CLK_EN |ANA8M ) ; -+ rtw_write16(pAdapter,REG_SYS_CLKR,tmpV16); -+ } -+ -+ if(bWrite == true) -+ { -+ // Enable LDO 2.5V before read/write action -+ tempval = rtw_read8(pAdapter, EFUSE_TEST+3); -+ tempval &= ~(BIT3|BIT4|BIT5|BIT6); -+ tempval |= (VOLTAGE_V25 << 3); -+ tempval |= BIT7; -+ rtw_write8(pAdapter, EFUSE_TEST+3, tempval); -+ } -+ } -+ else -+ { -+ rtw_write8(pAdapter, REG_EFUSE_BURN_GNT_8812, EFUSE_ACCESS_OFF_JAGUAR); -+ -+ if(bWrite == true){ -+ // Disable LDO 2.5V after read/write action -+ tempval = rtw_read8(pAdapter, EFUSE_TEST+3); -+ rtw_write8(pAdapter, EFUSE_TEST+3, (tempval & 0x7F)); -+ } -+ } -+} -+ -+static void -+rtl8812_EfusePowerSwitch( -+ PADAPTER pAdapter, -+ u8 bWrite, -+ u8 PwrState) -+{ -+ Hal_EfusePowerSwitch8812A(pAdapter, bWrite, PwrState); -+} -+ -+static bool -+Hal_EfuseSwitchToBank8812A( -+ PADAPTER pAdapter, -+ u1Byte bank, -+ bool bPseudoTest -+ ) -+{ -+ return false; -+} -+ -+static void -+Hal_EfuseReadEFuse8812A( -+ PADAPTER Adapter, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ bool bPseudoTest -+ ) -+{ -+ u8 *efuseTbl = NULL; -+ u16 eFuse_Addr = 0; -+ u8 offset=0, wden=0; -+ u16 i, j; -+ u16 **eFuseWord = NULL; -+ u16 efuse_utilized = 0; -+ u8 efuse_usage = 0; -+ u8 offset_2_0=0; -+ u8 efuseHeader=0, efuseExtHdr=0, efuseData=0; -+ -+ // -+ // Do NOT excess total size of EFuse table. Added by Roger, 2008.11.10. -+ // -+ if((_offset + _size_byte)>EFUSE_MAP_LEN_JAGUAR) -+ {// total E-Fuse table is 512bytes -+ DBG_8192C("Hal_EfuseReadEFuse8812A(): Invalid offset(%#x) with read bytes(%#x)!!\n",_offset, _size_byte); -+ goto exit; -+ } -+ -+ efuseTbl = (u8*)rtw_zmalloc(EFUSE_MAP_LEN_JAGUAR); -+ if(efuseTbl == NULL) -+ { -+ DBG_871X("%s: alloc efuseTbl fail!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ eFuseWord= (u16 **)rtw_malloc2d(EFUSE_MAX_SECTION_JAGUAR, EFUSE_MAX_WORD_UNIT, sizeof(u16)); -+ if(eFuseWord == NULL) -+ { -+ DBG_871X("%s: alloc eFuseWord fail!\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ // 0. Refresh efuse init map as all oxFF. -+ for (i = 0; i < EFUSE_MAX_SECTION_JAGUAR; i++) -+ for (j = 0; j < EFUSE_MAX_WORD_UNIT; j++) -+ eFuseWord[i][j] = 0xFFFF; -+ -+ // -+ // 1. Read the first byte to check if efuse is empty!!! -+ // -+ // -+ efuse_OneByteRead(Adapter, eFuse_Addr++, &efuseHeader, bPseudoTest); -+ -+ if(efuseHeader != 0xFF) -+ { -+ efuse_utilized++; -+ } -+ else -+ { -+ DBG_871X("EFUSE is empty\n"); -+ efuse_utilized = 0; -+ goto exit; -+ } -+ //RT_DISP(FEEPROM, EFUSE_READ_ALL, ("Hal_EfuseReadEFuse8812A(): efuse_utilized: %d\n", efuse_utilized)); -+ -+ // -+ // 2. Read real efuse content. Filter PG header and every section data. -+ // -+ while((efuseHeader != 0xFF) && AVAILABLE_EFUSE_ADDR_8812(eFuse_Addr)) -+ { -+ //RTPRINT(FEEPROM, EFUSE_READ_ALL, ("efuse_Addr-%d efuse_data=%x\n", eFuse_Addr-1, *rtemp8)); -+ -+ // Check PG header for section num. -+ if(EXT_HEADER(efuseHeader)) //extended header -+ { -+ offset_2_0 = GET_HDR_OFFSET_2_0(efuseHeader); -+ //RT_DISP(FEEPROM, EFUSE_READ_ALL, ("extended header offset_2_0=%X\n", offset_2_0)); -+ -+ efuse_OneByteRead(Adapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); -+ -+ //RT_DISP(FEEPROM, EFUSE_READ_ALL, ("efuse[%X]=%X\n", eFuse_Addr-1, efuseExtHdr)); -+ -+ if(efuseExtHdr != 0xff) -+ { -+ efuse_utilized++; -+ if(ALL_WORDS_DISABLED(efuseExtHdr)) -+ { -+ efuse_OneByteRead(Adapter, eFuse_Addr++, &efuseHeader, bPseudoTest); -+ if(efuseHeader != 0xff) -+ { -+ efuse_utilized++; -+ } -+ break; -+ } -+ else -+ { -+ offset = ((efuseExtHdr & 0xF0) >> 1) | offset_2_0; -+ wden = (efuseExtHdr & 0x0F); -+ } -+ } -+ else -+ { -+ DBG_871X("Error condition, extended = 0xff\n"); -+ // We should handle this condition. -+ break; -+ } -+ } -+ else -+ { -+ offset = ((efuseHeader >> 4) & 0x0f); -+ wden = (efuseHeader & 0x0f); -+ } -+ -+ if(offset < EFUSE_MAX_SECTION_JAGUAR) -+ { -+ // Get word enable value from PG header -+ //RT_DISP(FEEPROM, EFUSE_READ_ALL, ("Offset-%X Worden=%X\n", offset, wden)); -+ -+ for(i=0; i> 8) & 0xff); -+ } -+ } -+ -+ //RT_DISP(FEEPROM, EFUSE_READ_ALL, ("Hal_EfuseReadEFuse8812A(): efuse_utilized: %d\n", efuse_utilized)); -+ -+ // -+ // 4. Copy from Efuse map to output pointer memory!!! -+ // -+ for(i=0; i<_size_byte; i++) -+ { -+ pbuf[i] = efuseTbl[_offset+i]; -+ } -+ -+ // -+ // 5. Calculate Efuse utilization. -+ // -+ efuse_usage = (u1Byte)((eFuse_Addr*100)/EFUSE_REAL_CONTENT_LEN_JAGUAR); -+ rtw_hal_set_hwreg(Adapter, HW_VAR_EFUSE_BYTES, (u8 *)&eFuse_Addr); -+ -+exit: -+ if(efuseTbl) -+ rtw_mfree(efuseTbl, EFUSE_MAP_LEN_JAGUAR); -+ -+ if(eFuseWord) -+ rtw_mfree2d((void *)eFuseWord, EFUSE_MAX_SECTION_JAGUAR, EFUSE_MAX_WORD_UNIT, sizeof(u16)); -+} -+ -+static void -+rtl8812_ReadEFuse( -+ PADAPTER Adapter, -+ u8 efuseType, -+ u16 _offset, -+ u16 _size_byte, -+ u8 *pbuf, -+ bool bPseudoTest -+ ) -+{ -+#ifdef DBG_IOL_READ_EFUSE_MAP -+ u8 logical_map[512]; -+#endif -+ -+#ifdef CONFIG_IOL_READ_EFUSE_MAP -+ if(!bPseudoTest )//&& rtw_IOL_applied(Adapter)) -+ { -+ int ret = _FAIL; -+ -+ rtw_hal_power_on(Adapter); -+ -+ iol_mode_enable(Adapter, 1); -+ #ifdef DBG_IOL_READ_EFUSE_MAP -+ iol_read_efuse(Adapter, 0, _offset, _size_byte, logical_map); -+ #else -+ ret = iol_read_efuse(Adapter, 0, _offset, _size_byte, pbuf); -+ #endif -+ iol_mode_enable(Adapter, 0); -+ -+ if(_SUCCESS == ret) -+ goto exit; -+ } -+#endif -+ Hal_EfuseReadEFuse8812A(Adapter, _offset, _size_byte, pbuf, bPseudoTest); -+ -+#ifdef CONFIG_IOL_READ_EFUSE_MAP -+exit: -+#endif -+ -+#ifdef DBG_IOL_READ_EFUSE_MAP -+ if(_rtw_memcmp(logical_map, Adapter->eeprompriv.efuse_eeprom_data, 0x130) == false) -+ { -+ int i; -+ DBG_871X("%s compare first 0x130 byte fail\n", __FUNCTION__); -+ for(i=0;i<512;i++) -+ { -+ if(i%16==0) -+ DBG_871X("0x%03x: ", i); -+ DBG_871X("%02x ", logical_map[i]); -+ if(i%16==15) -+ DBG_871X("\n"); -+ } -+ DBG_871X("\n"); -+ } -+#endif -+} -+ -+//Do not support BT -+void -+Hal_EFUSEGetEfuseDefinition8812A( -+ PADAPTER pAdapter, -+ u1Byte efuseType, -+ u1Byte type, -+ void * pOut -+ ) -+{ -+ switch(type) -+ { -+ case TYPE_EFUSE_MAX_SECTION: -+ { -+ u8* pMax_section; -+ pMax_section = (u8*)pOut; -+ *pMax_section = EFUSE_MAX_SECTION_JAGUAR; -+ } -+ break; -+ case TYPE_EFUSE_REAL_CONTENT_LEN: -+ { -+ u16* pu2Tmp; -+ pu2Tmp = (u16*)pOut; -+ *pu2Tmp = EFUSE_REAL_CONTENT_LEN_JAGUAR; -+ } -+ break; -+ case TYPE_EFUSE_CONTENT_LEN_BANK: -+ { -+ u16* pu2Tmp; -+ pu2Tmp = (u16*)pOut; -+ *pu2Tmp = EFUSE_REAL_CONTENT_LEN_JAGUAR; -+ } -+ break; -+ case TYPE_AVAILABLE_EFUSE_BYTES_BANK: -+ { -+ u16* pu2Tmp; -+ pu2Tmp = (u16*)pOut; -+ *pu2Tmp = (u16)(EFUSE_REAL_CONTENT_LEN_JAGUAR-EFUSE_OOB_PROTECT_BYTES_JAGUAR); -+ } -+ break; -+ case TYPE_AVAILABLE_EFUSE_BYTES_TOTAL: -+ { -+ u16* pu2Tmp; -+ pu2Tmp = (u16*)pOut; -+ *pu2Tmp = (u16)(EFUSE_REAL_CONTENT_LEN_JAGUAR-EFUSE_OOB_PROTECT_BYTES_JAGUAR); -+ } -+ break; -+ case TYPE_EFUSE_MAP_LEN: -+ { -+ u16* pu2Tmp; -+ pu2Tmp = (u16*)pOut; -+ *pu2Tmp = (u16)EFUSE_MAP_LEN_JAGUAR; -+ } -+ break; -+ case TYPE_EFUSE_PROTECT_BYTES_BANK: -+ { -+ u8* pu1Tmp; -+ pu1Tmp = (u8*)pOut; -+ *pu1Tmp = (u8)(EFUSE_OOB_PROTECT_BYTES_JAGUAR); -+ } -+ break; -+ default: -+ { -+ u8* pu1Tmp; -+ pu1Tmp = (u8*)pOut; -+ *pu1Tmp = 0; -+ } -+ break; -+ } -+} -+void -+Hal_EFUSEGetEfuseDefinition_Pseudo8812A( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ u8 type, -+ void * pOut -+ ) -+{ -+ switch(type) -+ { -+ case TYPE_EFUSE_MAX_SECTION: -+ { -+ u8* pMax_section; -+ pMax_section = (pu1Byte)pOut; -+ *pMax_section = EFUSE_MAX_SECTION_JAGUAR; -+ } -+ break; -+ case TYPE_EFUSE_REAL_CONTENT_LEN: -+ { -+ u16* pu2Tmp; -+ pu2Tmp = (pu2Byte)pOut; -+ *pu2Tmp = EFUSE_REAL_CONTENT_LEN_JAGUAR; -+ } -+ break; -+ case TYPE_EFUSE_CONTENT_LEN_BANK: -+ { -+ u16* pu2Tmp; -+ pu2Tmp = (pu2Byte)pOut; -+ *pu2Tmp = EFUSE_REAL_CONTENT_LEN_JAGUAR; -+ } -+ break; -+ case TYPE_AVAILABLE_EFUSE_BYTES_BANK: -+ { -+ u16* pu2Tmp; -+ pu2Tmp = (pu2Byte)pOut; -+ *pu2Tmp = (u2Byte)(EFUSE_REAL_CONTENT_LEN_JAGUAR-EFUSE_OOB_PROTECT_BYTES_JAGUAR); -+ } -+ break; -+ case TYPE_AVAILABLE_EFUSE_BYTES_TOTAL: -+ { -+ u16* pu2Tmp; -+ pu2Tmp = (pu2Byte)pOut; -+ *pu2Tmp = (u2Byte)(EFUSE_REAL_CONTENT_LEN_JAGUAR-EFUSE_OOB_PROTECT_BYTES_JAGUAR); -+ } -+ break; -+ case TYPE_EFUSE_MAP_LEN: -+ { -+ u16* pu2Tmp; -+ pu2Tmp = (pu2Byte)pOut; -+ *pu2Tmp = (u2Byte)EFUSE_MAP_LEN_JAGUAR; -+ } -+ break; -+ case TYPE_EFUSE_PROTECT_BYTES_BANK: -+ { -+ u8* pu1Tmp; -+ pu1Tmp = (u8*)pOut; -+ *pu1Tmp = (u8)(EFUSE_OOB_PROTECT_BYTES_JAGUAR); -+ } -+ break; -+ default: -+ { -+ u8* pu1Tmp; -+ pu1Tmp = (u8*)pOut; -+ *pu1Tmp = 0; -+ } -+ break; -+ } -+} -+ -+ -+static void -+rtl8812_EFUSE_GetEfuseDefinition( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ u8 type, -+ void *pOut, -+ bool bPseudoTest -+ ) -+{ -+ if(bPseudoTest) -+ { -+ Hal_EFUSEGetEfuseDefinition_Pseudo8812A(pAdapter, efuseType, type, pOut); -+ } -+ else -+ { -+ Hal_EFUSEGetEfuseDefinition8812A(pAdapter, efuseType, type, pOut); -+ } -+} -+ -+static u8 -+Hal_EfuseWordEnableDataWrite8812A(PADAPTER pAdapter, -+ u16 efuse_addr, -+ u8 word_en, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ u16 tmpaddr = 0; -+ u16 start_addr = efuse_addr; -+ u8 badworden = 0x0F; -+ u8 tmpdata[8]; -+ -+ _rtw_memset((void *)tmpdata, 0xff, PGPKT_DATA_SIZE); -+ //RT_TRACE(COMP_EFUSE, DBG_LOUD, ("word_en = %x efuse_addr=%x\n", word_en, efuse_addr)); -+ -+ if(!(word_en&BIT0)) -+ { -+ tmpaddr = start_addr; -+ efuse_OneByteWrite(pAdapter,start_addr++, data[0], bPseudoTest); -+ efuse_OneByteWrite(pAdapter,start_addr++, data[1], bPseudoTest); -+ -+ efuse_OneByteRead(pAdapter,tmpaddr, &tmpdata[0], bPseudoTest); -+ efuse_OneByteRead(pAdapter,tmpaddr+1, &tmpdata[1], bPseudoTest); -+ if((data[0]!=tmpdata[0])||(data[1]!=tmpdata[1])){ -+ badworden &= (~BIT0); -+ } -+ } -+ if(!(word_en&BIT1)) -+ { -+ tmpaddr = start_addr; -+ efuse_OneByteWrite(pAdapter,start_addr++, data[2], bPseudoTest); -+ efuse_OneByteWrite(pAdapter,start_addr++, data[3], bPseudoTest); -+ -+ efuse_OneByteRead(pAdapter,tmpaddr , &tmpdata[2], bPseudoTest); -+ efuse_OneByteRead(pAdapter,tmpaddr+1, &tmpdata[3], bPseudoTest); -+ if((data[2]!=tmpdata[2])||(data[3]!=tmpdata[3])){ -+ badworden &=( ~BIT1); -+ } -+ } -+ if(!(word_en&BIT2)) -+ { -+ tmpaddr = start_addr; -+ efuse_OneByteWrite(pAdapter,start_addr++, data[4], bPseudoTest); -+ efuse_OneByteWrite(pAdapter,start_addr++, data[5], bPseudoTest); -+ -+ efuse_OneByteRead(pAdapter,tmpaddr, &tmpdata[4], bPseudoTest); -+ efuse_OneByteRead(pAdapter,tmpaddr+1, &tmpdata[5], bPseudoTest); -+ if((data[4]!=tmpdata[4])||(data[5]!=tmpdata[5])){ -+ badworden &=( ~BIT2); -+ } -+ } -+ if(!(word_en&BIT3)) -+ { -+ tmpaddr = start_addr; -+ efuse_OneByteWrite(pAdapter,start_addr++, data[6], bPseudoTest); -+ efuse_OneByteWrite(pAdapter,start_addr++, data[7], bPseudoTest); -+ -+ efuse_OneByteRead(pAdapter,tmpaddr, &tmpdata[6], bPseudoTest); -+ efuse_OneByteRead(pAdapter,tmpaddr+1, &tmpdata[7], bPseudoTest); -+ if((data[6]!=tmpdata[6])||(data[7]!=tmpdata[7])){ -+ badworden &=( ~BIT3); -+ } -+ } -+ return badworden; -+} -+ -+static u8 -+rtl8812_Efuse_WordEnableDataWrite(PADAPTER pAdapter, -+ u16 efuse_addr, -+ u8 word_en, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ u8 ret=0; -+ -+ ret = Hal_EfuseWordEnableDataWrite8812A(pAdapter, efuse_addr, word_en, data, bPseudoTest); -+ -+ return ret; -+} -+ -+ -+static u16 -+hal_EfuseGetCurrentSize_8812A(PADAPTER pAdapter, -+ bool bPseudoTest) -+{ -+ int bContinual = true; -+ -+ u16 efuse_addr = 0; -+ u8 hoffset=0,hworden=0; -+ u8 efuse_data,word_cnts=0; -+ -+ if(bPseudoTest) -+ { -+ efuse_addr = (u16)(fakeEfuseUsedBytes); -+ } -+ else -+ { -+ rtw_hal_get_hwreg(pAdapter, HW_VAR_EFUSE_BYTES, (u8 *)&efuse_addr); -+ } -+ //RTPRINT(FEEPROM, EFUSE_PG, ("hal_EfuseGetCurrentSize_8723A(), start_efuse_addr = %d\n", efuse_addr)); -+ -+ while ( bContinual && -+ efuse_OneByteRead(pAdapter, efuse_addr ,&efuse_data, bPseudoTest) && -+ (efuse_addr < EFUSE_REAL_CONTENT_LEN_JAGUAR)) -+ { -+ if(efuse_data!=0xFF) -+ { -+ if((efuse_data&0x1F) == 0x0F) //extended header -+ { -+ hoffset = efuse_data; -+ efuse_addr++; -+ efuse_OneByteRead(pAdapter, efuse_addr ,&efuse_data, bPseudoTest); -+ if((efuse_data & 0x0F) == 0x0F) -+ { -+ efuse_addr++; -+ continue; -+ } -+ else -+ { -+ hoffset = ((hoffset & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); -+ hworden = efuse_data & 0x0F; -+ } -+ } -+ else -+ { -+ hoffset = (efuse_data>>4) & 0x0F; -+ hworden = efuse_data & 0x0F; -+ } -+ word_cnts = Efuse_CalculateWordCnts(hworden); -+ //read next header -+ efuse_addr = efuse_addr + (word_cnts*2)+1; -+ } -+ else -+ { -+ bContinual = false ; -+ } -+ } -+ -+ if(bPseudoTest) -+ { -+ fakeEfuseUsedBytes = efuse_addr; -+ //RTPRINT(FEEPROM, EFUSE_PG, ("hal_EfuseGetCurrentSize_8723A(), return %d\n", fakeEfuseUsedBytes)); -+ } -+ else -+ { -+ rtw_hal_set_hwreg(pAdapter, HW_VAR_EFUSE_BYTES, (u8 *)&efuse_addr); -+ //RTPRINT(FEEPROM, EFUSE_PG, ("hal_EfuseGetCurrentSize_8723A(), return %d\n", efuse_addr)); -+ } -+ -+ return efuse_addr; -+} -+ -+static u16 -+rtl8812_EfuseGetCurrentSize( -+ PADAPTER pAdapter, -+ u8 efuseType, -+ bool bPseudoTest) -+{ -+ u16 ret=0; -+ -+ ret = hal_EfuseGetCurrentSize_8812A(pAdapter, bPseudoTest); -+ -+ return ret; -+} -+ -+ -+static int -+hal_EfusePgPacketRead_8812A( -+ PADAPTER pAdapter, -+ u8 offset, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ u8 ReadState = PG_STATE_HEADER; -+ -+ int bContinual = true; -+ int bDataEmpty = true ; -+ -+ u8 efuse_data,word_cnts = 0; -+ u16 efuse_addr = 0; -+ u8 hoffset = 0,hworden = 0; -+ u8 tmpidx = 0; -+ u8 tmpdata[8]; -+ u8 max_section = 0; -+ u8 tmp_header = 0; -+ -+ if(data==NULL) -+ return false; -+ if(offset>EFUSE_MAX_SECTION_JAGUAR) -+ return false; -+ -+ _rtw_memset((void *)data, 0xff, sizeof(u8)*PGPKT_DATA_SIZE); -+ _rtw_memset((void *)tmpdata, 0xff, sizeof(u8)*PGPKT_DATA_SIZE); -+ -+ -+ // -+ // Efuse has been pre-programmed dummy 5Bytes at the end of Efuse by CP. -+ // Skip dummy parts to prevent unexpected data read from Efuse. -+ // By pass right now. 2009.02.19. -+ // -+ while(bContinual && (efuse_addr < EFUSE_REAL_CONTENT_LEN_JAGUAR) ) -+ { -+ //------- Header Read ------------- -+ if(ReadState & PG_STATE_HEADER) -+ { -+ if(efuse_OneByteRead(pAdapter, efuse_addr ,&efuse_data, bPseudoTest)&&(efuse_data!=0xFF)) -+ { -+ if(EXT_HEADER(efuse_data)) -+ { -+ tmp_header = efuse_data; -+ efuse_addr++; -+ efuse_OneByteRead(pAdapter, efuse_addr ,&efuse_data, bPseudoTest); -+ if(!ALL_WORDS_DISABLED(efuse_data)) -+ { -+ hoffset = ((tmp_header & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); -+ hworden = efuse_data & 0x0F; -+ } -+ else -+ { -+ DBG_8192C("Error, All words disabled\n"); -+ efuse_addr++; -+ break; -+ } -+ } -+ else -+ { -+ hoffset = (efuse_data>>4) & 0x0F; -+ hworden = efuse_data & 0x0F; -+ } -+ word_cnts = Efuse_CalculateWordCnts(hworden); -+ bDataEmpty = true ; -+ -+ if(hoffset==offset) -+ { -+ for(tmpidx = 0;tmpidx< word_cnts*2 ;tmpidx++) -+ { -+ if(efuse_OneByteRead(pAdapter, efuse_addr+1+tmpidx ,&efuse_data, bPseudoTest) ) -+ { -+ tmpdata[tmpidx] = efuse_data; -+ if(efuse_data!=0xff) -+ { -+ bDataEmpty = false; -+ } -+ } -+ } -+ if(bDataEmpty==false){ -+ ReadState = PG_STATE_DATA; -+ }else{//read next header -+ efuse_addr = efuse_addr + (word_cnts*2)+1; -+ ReadState = PG_STATE_HEADER; -+ } -+ } -+ else{//read next header -+ efuse_addr = efuse_addr + (word_cnts*2)+1; -+ ReadState = PG_STATE_HEADER; -+ } -+ -+ } -+ else{ -+ bContinual = false ; -+ } -+ } -+ //------- Data section Read ------------- -+ else if(ReadState & PG_STATE_DATA) -+ { -+ efuse_WordEnableDataRead(hworden,tmpdata,data); -+ efuse_addr = efuse_addr + (word_cnts*2)+1; -+ ReadState = PG_STATE_HEADER; -+ } -+ -+ } -+ -+ if( (data[0]==0xff) &&(data[1]==0xff) && (data[2]==0xff) && (data[3]==0xff) && -+ (data[4]==0xff) &&(data[5]==0xff) && (data[6]==0xff) && (data[7]==0xff)) -+ return false; -+ else -+ return true; -+ -+} -+ -+static int -+rtl8812_Efuse_PgPacketRead( PADAPTER pAdapter, -+ u8 offset, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ int ret=0; -+ -+ ret = hal_EfusePgPacketRead_8812A(pAdapter, offset, data, bPseudoTest); -+ -+ return ret; -+} -+ -+int -+hal_EfusePgPacketWrite_8812A(PADAPTER pAdapter, -+ u8 offset, -+ u8 word_en, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ u8 WriteState = PG_STATE_HEADER; -+ -+ int bContinual = true,bDataEmpty=true; -+ //int bResult = true; -+ u16 efuse_addr = 0; -+ u8 efuse_data; -+ -+ u8 pg_header = 0, pg_header_temp = 0; -+ -+ u8 tmp_word_cnts=0,target_word_cnts=0; -+ u8 tmp_header,match_word_en,tmp_word_en; -+ -+ PGPKT_STRUCT target_pkt; -+ PGPKT_STRUCT tmp_pkt; -+ -+ u8 originaldata[sizeof(u8)*8]; -+ u8 tmpindex = 0,badworden = 0x0F; -+ -+ static int repeat_times = 0; -+ -+ bool bExtendedHeader = false; -+ u8 efuseType=EFUSE_WIFI; -+ -+ // -+ // Efuse has been pre-programmed dummy 5Bytes at the end of Efuse by CP. -+ // So we have to prevent unexpected data string connection, which will cause -+ // incorrect data auto-load from HW. The total size is equal or smaller than 498bytes -+ // (i.e., offset 0~497, and dummy 1bytes) expected after CP test. -+ // 2009.02.19. -+ // -+ if( Efuse_GetCurrentSize(pAdapter, efuseType, bPseudoTest) >= (EFUSE_REAL_CONTENT_LEN_JAGUAR-EFUSE_OOB_PROTECT_BYTES_JAGUAR)) -+ { -+ DBG_871X("hal_EfusePgPacketWrite_8812A() error: %x >= %x\n", Efuse_GetCurrentSize(pAdapter, efuseType, bPseudoTest), (EFUSE_REAL_CONTENT_LEN_JAGUAR-EFUSE_OOB_PROTECT_BYTES_JAGUAR)); -+ return false; -+ } -+ -+ // Init the 8 bytes content as 0xff -+ target_pkt.offset = offset; -+ target_pkt.word_en= word_en; -+ // Initial the value to avoid compile warning -+ tmp_pkt.offset = 0; -+ tmp_pkt.word_en= 0; -+ -+ //DBG_871X("hal_EfusePgPacketWrite_8812A target offset 0x%x word_en 0x%x \n", target_pkt.offset, target_pkt.word_en); -+ -+ _rtw_memset((void *)target_pkt.data, 0xFF, sizeof(u8)*8); -+ -+ efuse_WordEnableDataRead(word_en, data, target_pkt.data); -+ target_word_cnts = Efuse_CalculateWordCnts(target_pkt.word_en); -+ -+ //efuse_reg_ctrl(pAdapter,true);//power on -+ //DBG_871X("EFUSE Power ON\n"); -+ -+ // -+ // Efuse has been pre-programmed dummy 5Bytes at the end of Efuse by CP. -+ // So we have to prevent unexpected data string connection, which will cause -+ // incorrect data auto-load from HW. Dummy 1bytes is additional. -+ // 2009.02.19. -+ // -+ while( bContinual && (efuse_addr < (EFUSE_REAL_CONTENT_LEN_JAGUAR-EFUSE_OOB_PROTECT_BYTES_JAGUAR)) ) -+ { -+ if(WriteState==PG_STATE_HEADER) -+ { -+ bDataEmpty=true; -+ badworden = 0x0F; -+ //************ so ******************* -+ //DBG_871X("EFUSE PG_STATE_HEADER\n"); -+ if ( efuse_OneByteRead(pAdapter, efuse_addr ,&efuse_data, bPseudoTest) && -+ (efuse_data!=0xFF)) -+ { -+ if((efuse_data&0x1F) == 0x0F) //extended header -+ { -+ tmp_header = efuse_data; -+ efuse_addr++; -+ efuse_OneByteRead(pAdapter, efuse_addr ,&efuse_data, bPseudoTest); -+ if((efuse_data & 0x0F) == 0x0F) //wren fail -+ { -+ u8 next = 0, next_next = 0, data = 0, i = 0; -+ u8 s = ((tmp_header & 0xF0) >> 4); -+ efuse_OneByteRead(pAdapter, efuse_addr+1, &next, bPseudoTest); -+ efuse_OneByteRead(pAdapter, efuse_addr+2, &next_next, bPseudoTest); -+ if (next == 0xFF && next_next == 0xFF) { // Have enough space to make fake data to recover bad header. -+ switch (s) { -+ case 0x0: -+ case 0x2: -+ case 0x4: -+ case 0x6: -+ case 0x8: -+ case 0xA: -+ case 0xC: -+ for (i = 0; i < 3; ++i) { -+ efuse_OneByteWrite(pAdapter, efuse_addr, 0x27, bPseudoTest); -+ efuse_OneByteRead(pAdapter, efuse_addr, &data, bPseudoTest); -+ if (data == 0x27) -+ break; -+ } -+ break; -+ case 0xE: -+ for (i = 0; i < 3; ++i) { -+ efuse_OneByteWrite(pAdapter, efuse_addr, 0x17, bPseudoTest); -+ efuse_OneByteRead(pAdapter, efuse_addr, &data, bPseudoTest); -+ if (data == 0x17) -+ break; -+ } -+ break; -+ default: -+ break; -+ } -+ efuse_OneByteWrite(pAdapter, efuse_addr+1, 0xFF, bPseudoTest); -+ efuse_OneByteWrite(pAdapter, efuse_addr+2, 0xFF, bPseudoTest); -+ efuse_addr += 3; -+ } else { -+ efuse_addr++; -+ } -+ continue; -+ } -+ else -+ { -+ tmp_pkt.offset = ((tmp_header & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); -+ tmp_pkt.word_en = efuse_data & 0x0F; -+ } -+ } -+ else -+ { -+ u8 i = 0, data = 0; -+ tmp_header = efuse_data; -+ tmp_pkt.offset = (tmp_header>>4) & 0x0F; -+ tmp_pkt.word_en = tmp_header & 0x0F; -+ -+ if (tmp_pkt.word_en == 0xF) { -+ u8 next = 0; -+ efuse_OneByteRead(pAdapter, efuse_addr+1, &next, bPseudoTest); -+ if (next == 0xFF) { // Have enough space to make fake data to recover bad header. -+ tmp_header = (tmp_header & 0xF0) | 0x7; -+ for (i = 0; i < 3; ++i) { -+ efuse_OneByteWrite(pAdapter, efuse_addr, tmp_header, bPseudoTest); -+ efuse_OneByteRead(pAdapter, efuse_addr, &data, bPseudoTest); -+ if (data == tmp_header) -+ break; -+ } -+ efuse_OneByteWrite(pAdapter, efuse_addr+1, 0xFF, bPseudoTest); -+ efuse_OneByteWrite(pAdapter, efuse_addr+2, 0xFF, bPseudoTest); -+ efuse_addr += 2; -+ } -+ } -+ } -+ tmp_word_cnts = Efuse_CalculateWordCnts(tmp_pkt.word_en); -+ -+ //DBG_871X("section offset 0x%x worden 0x%x\n", tmp_pkt.offset, tmp_pkt.word_en); -+ -+ //************ so-1 ******************* -+ if(tmp_pkt.offset != target_pkt.offset) -+ { -+ efuse_addr = efuse_addr + (tmp_word_cnts*2) +1; //Next pg_packet -+#if (EFUSE_ERROE_HANDLE == 1) -+ WriteState = PG_STATE_HEADER; -+#endif -+ } -+ else //write the same offset -+ { -+ //DBG_871X("hal_EfusePgPacketWrite_8812A section offset the same\n"); -+ //************ so-2 ******************* -+ for(tmpindex=0 ; tmpindex<(tmp_word_cnts*2) ; tmpindex++) -+ { -+ if(efuse_OneByteRead(pAdapter, (efuse_addr+1+tmpindex) ,&efuse_data, bPseudoTest)&&(efuse_data != 0xFF)){ -+ bDataEmpty = false; -+ } -+ } -+ //************ so-2-1 ******************* -+ if(bDataEmpty == false) -+ { -+ //DBG_871X("hal_EfusePgPacketWrite_8812A section offset the same and data is NOT empty\n"); -+ -+ efuse_addr = efuse_addr + (tmp_word_cnts*2) +1; //Next pg_packet -+#if (EFUSE_ERROE_HANDLE == 1) -+ WriteState=PG_STATE_HEADER; -+#endif -+ } -+ else -+ {//************ so-2-2 ******************* -+ //DBG_871X("hal_EfusePgPacketWrite_8812A section data empty\n"); -+ match_word_en = 0x0F; //same bit as original wren -+ if( !( (target_pkt.word_en&BIT0)|(tmp_pkt.word_en&BIT0) )) -+ { -+ match_word_en &= (~BIT0); -+ } -+ if( !( (target_pkt.word_en&BIT1)|(tmp_pkt.word_en&BIT1) )) -+ { -+ match_word_en &= (~BIT1); -+ } -+ if( !( (target_pkt.word_en&BIT2)|(tmp_pkt.word_en&BIT2) )) -+ { -+ match_word_en &= (~BIT2); -+ } -+ if( !( (target_pkt.word_en&BIT3)|(tmp_pkt.word_en&BIT3) )) -+ { -+ match_word_en &= (~BIT3); -+ } -+ -+ //************ so-2-2-A ******************* -+ if((match_word_en&0x0F)!=0x0F) -+ { -+ badworden = Efuse_WordEnableDataWrite(pAdapter,efuse_addr+1, tmp_pkt.word_en ,target_pkt.data, bPseudoTest); -+ -+ //************ so-2-2-A-1 ******************* -+ //############################ -+ if(0x0F != (badworden&0x0F)) -+ { -+ u8 reorg_offset = offset; -+ u8 reorg_worden=badworden; -+ Efuse_PgPacketWrite(pAdapter, reorg_offset, reorg_worden, target_pkt.data, bPseudoTest); -+ } -+ //############################ -+ -+ tmp_word_en = 0x0F; //not the same bit as original wren -+ if( (target_pkt.word_en&BIT0)^(match_word_en&BIT0) ) -+ { -+ tmp_word_en &= (~BIT0); -+ } -+ if( (target_pkt.word_en&BIT1)^(match_word_en&BIT1) ) -+ { -+ tmp_word_en &= (~BIT1); -+ } -+ if( (target_pkt.word_en&BIT2)^(match_word_en&BIT2) ) -+ { -+ tmp_word_en &= (~BIT2); -+ } -+ if( (target_pkt.word_en&BIT3)^(match_word_en&BIT3) ) -+ { -+ tmp_word_en &=(~BIT3); -+ } -+ -+ //************ so-2-2-A-2 ******************* -+ if((tmp_word_en&0x0F)!=0x0F){ -+ //reorganize other pg packet -+// efuse_addr = efuse_addr + (2*tmp_word_cnts) +1;//next pg packet addr -+ efuse_addr = Efuse_GetCurrentSize(pAdapter, efuseType, bPseudoTest); -+ //=========================== -+ target_pkt.offset = offset; -+ target_pkt.word_en= tmp_word_en; -+ //=========================== -+ }else{ -+ bContinual = false; -+ } -+#if (EFUSE_ERROE_HANDLE == 1) -+ WriteState=PG_STATE_HEADER; -+ repeat_times++; -+ if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = false; -+ //bResult = false; -+ } -+#endif -+ } -+ else{//************ so-2-2-B ******************* -+ //reorganize other pg packet -+ efuse_addr = efuse_addr + (2*tmp_word_cnts) +1;//next pg packet addr -+ //=========================== -+ target_pkt.offset = offset; -+ target_pkt.word_en= target_pkt.word_en; -+ //=========================== -+#if (EFUSE_ERROE_HANDLE == 1) -+ WriteState=PG_STATE_HEADER; -+#endif -+ } -+ } -+ } -+ DBG_871X("EFUSE PG_STATE_HEADER-1\n"); -+ } -+ else //************ s1: header == oxff ******************* -+ { -+ bExtendedHeader = false; -+ -+ if(target_pkt.offset >= EFUSE_MAX_SECTION_BASE) -+ { -+ pg_header = ((target_pkt.offset &0x07) << 5) | 0x0F; -+ -+ //DBG_871X("hal_EfusePgPacketWrite_8812A extended pg_header[2:0] |0x0F 0x%x \n", pg_header); -+ -+ efuse_OneByteWrite(pAdapter,efuse_addr, pg_header, bPseudoTest); -+ efuse_OneByteRead(pAdapter,efuse_addr, &tmp_header, bPseudoTest); -+ -+ while(tmp_header == 0xFF) -+ { -+ //DBG_871X("hal_EfusePgPacketWrite_8812A extended pg_header[2:0] wirte fail \n"); -+ -+ repeat_times++; -+ -+ if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = false; -+ //bResult = false; -+ efuse_addr++; -+ break; -+ } -+ efuse_OneByteWrite(pAdapter,efuse_addr, pg_header, bPseudoTest); -+ efuse_OneByteRead(pAdapter,efuse_addr, &tmp_header, bPseudoTest); -+ } -+ -+ if(!bContinual) -+ break; -+ -+ if(tmp_header == pg_header) -+ { -+ efuse_addr++; -+ pg_header_temp = pg_header; -+ pg_header = ((target_pkt.offset & 0x78) << 1 ) | target_pkt.word_en; -+ -+ //DBG_871X("hal_EfusePgPacketWrite_8812A extended pg_header[6:3] | worden 0x%x word_en 0x%x \n", pg_header, target_pkt.word_en); -+ -+ efuse_OneByteWrite(pAdapter,efuse_addr, pg_header, bPseudoTest); -+ efuse_OneByteRead(pAdapter,efuse_addr, &tmp_header, bPseudoTest); -+ -+ while(tmp_header == 0xFF) -+ { -+ repeat_times++; -+ -+ if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = false; -+ //bResult = false; -+ break; -+ } -+ efuse_OneByteWrite(pAdapter,efuse_addr, pg_header, bPseudoTest); -+ efuse_OneByteRead(pAdapter,efuse_addr, &tmp_header, bPseudoTest); -+ } -+ -+ if(!bContinual) -+ break; -+ -+ if((tmp_header & 0x0F) == 0x0F) //wren PG fail -+ { -+ repeat_times++; -+ -+ if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = false; -+ //bResult = false; -+ break; -+ } -+ else -+ { -+ efuse_addr++; -+ continue; -+ } -+ } -+ else if(pg_header != tmp_header) //offset PG fail -+ { -+ bExtendedHeader = true; -+ tmp_pkt.offset = ((pg_header_temp & 0xE0) >> 5) | ((tmp_header & 0xF0) >> 1); -+ tmp_pkt.word_en= tmp_header & 0x0F; -+ tmp_word_cnts = Efuse_CalculateWordCnts(tmp_pkt.word_en); -+ } -+ } -+ else if ((tmp_header & 0x1F) == 0x0F) //wrong extended header -+ { -+ efuse_addr+=2; -+ continue; -+ } -+ } -+ else -+ { -+ pg_header = ((target_pkt.offset << 4)&0xf0) |target_pkt.word_en; -+ efuse_OneByteWrite(pAdapter,efuse_addr, pg_header, bPseudoTest); -+ efuse_OneByteRead(pAdapter,efuse_addr, &tmp_header, bPseudoTest); -+ } -+ -+ if(tmp_header == pg_header) -+ { //************ s1-1******************* -+ WriteState = PG_STATE_DATA; -+ } -+#if (EFUSE_ERROE_HANDLE == 1) -+ else if(tmp_header == 0xFF){//************ s1-3: if Write or read func doesn't work ******************* -+ //efuse_addr doesn't change -+ WriteState = PG_STATE_HEADER; -+ repeat_times++; -+ if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = false; -+ //bResult = false; -+ } -+ } -+#endif -+ else -+ {//************ s1-2 : fixed the header procedure ******************* -+ if(!bExtendedHeader) -+ { -+ tmp_pkt.offset = (tmp_header>>4) & 0x0F; -+ tmp_pkt.word_en= tmp_header & 0x0F; -+ tmp_word_cnts = Efuse_CalculateWordCnts(tmp_pkt.word_en); -+ } -+ -+ //************ s1-2-A :cover the exist data ******************* -+ _rtw_memset(originaldata, 0xff, sizeof(u8)*8); -+ -+ if(Efuse_PgPacketRead( pAdapter, tmp_pkt.offset,originaldata, bPseudoTest)) -+ { //check if data exist -+ //efuse_reg_ctrl(pAdapter,true);//power on -+ badworden = Efuse_WordEnableDataWrite(pAdapter,efuse_addr+1,tmp_pkt.word_en,originaldata, bPseudoTest); -+ //############################ -+ if(0x0F != (badworden&0x0F)) -+ { -+ u8 reorg_offset = tmp_pkt.offset; -+ u8 reorg_worden=badworden; -+ Efuse_PgPacketWrite(pAdapter,reorg_offset,reorg_worden,originaldata, bPseudoTest); -+ efuse_addr = Efuse_GetCurrentSize(pAdapter, efuseType, bPseudoTest); -+ } -+ //############################ -+ else{ -+ efuse_addr = efuse_addr + (tmp_word_cnts*2) +1; //Next pg_packet -+ } -+ } -+ //************ s1-2-B: wrong address******************* -+ else -+ { -+ efuse_addr = efuse_addr + (tmp_word_cnts*2) +1; //Next pg_packet -+ } -+ -+#if (EFUSE_ERROE_HANDLE == 1) -+ WriteState=PG_STATE_HEADER; -+ repeat_times++; -+ if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = false; -+ //bResult = false; -+ } -+#endif -+ -+ //DBG_871X("EFUSE PG_STATE_HEADER-2\n"); -+ } -+ -+ } -+ -+ } -+ //write data state -+ else if(WriteState==PG_STATE_DATA) -+ { //************ s1-1 ******************* -+ //DBG_871X("EFUSE PG_STATE_DATA\n"); -+ badworden = 0x0f; -+ badworden = Efuse_WordEnableDataWrite(pAdapter,efuse_addr+1,target_pkt.word_en,target_pkt.data, bPseudoTest); -+ if((badworden&0x0F)==0x0F) -+ { //************ s1-1-A ******************* -+ bContinual = false; -+ } -+ else -+ {//reorganize other pg packet //************ s1-1-B ******************* -+ efuse_addr = efuse_addr + (2*target_word_cnts) +1;//next pg packet addr -+ -+ //=========================== -+ target_pkt.offset = offset; -+ target_pkt.word_en= badworden; -+ target_word_cnts = Efuse_CalculateWordCnts(target_pkt.word_en); -+ //=========================== -+#if (EFUSE_ERROE_HANDLE == 1) -+ WriteState=PG_STATE_HEADER; -+ repeat_times++; -+ if(repeat_times>EFUSE_REPEAT_THRESHOLD_){ -+ bContinual = false; -+ //bResult = false; -+ } -+#endif -+ //DBG_871X("EFUSE PG_STATE_HEADER-3\n"); -+ } -+ } -+ } -+ -+ if(efuse_addr >= (EFUSE_REAL_CONTENT_LEN_JAGUAR-EFUSE_OOB_PROTECT_BYTES_JAGUAR)) -+ { -+ DBG_871X("hal_EfusePgPacketWrite_8812A(): efuse_addr(%#x) Out of size!!\n", efuse_addr); -+ } -+ //efuse_reg_ctrl(pAdapter,false);//power off -+ -+ return true; -+} -+ -+static int -+rtl8812_Efuse_PgPacketWrite(PADAPTER pAdapter, -+ u8 offset, -+ u8 word_en, -+ u8 *data, -+ bool bPseudoTest) -+{ -+ int ret; -+ -+ ret = hal_EfusePgPacketWrite_8812A(pAdapter, offset, word_en, data, bPseudoTest); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+static s32 _halReadPGDataFromFile(PADAPTER padapter, u8 *pbuf) -+{ -+ u32 i; -+ struct file *fp; -+ mm_segment_t fs; -+ u8 temp[3]; -+ loff_t pos = 0; -+ -+ -+ temp[2] = 0; // add end of string '\0' -+ -+ DBG_8192C("%s: Read Efuse from file [%s]\n", __FUNCTION__, EFUSE_FILE_PATH); -+ fp = filp_open(EFUSE_FILE_PATH, O_RDONLY, 0); -+ if (IS_ERR(fp)) { -+ DBG_8192C("%s: Error, Read Efuse configure file FAIL!\n", __FUNCTION__); -+ pEEPROM->bloadfile_fail_flag = true; -+ return _FAIL; -+ } -+ -+ fs = get_fs(); -+ set_fs(KERNEL_DS); -+ for (i=0; ibloadfile_fail_flag = false; -+ return _SUCCESS; -+} -+ -+static s32 _halReadMACAddrFromFile(PADAPTER padapter, u8 *pbuf) -+{ -+ struct file *fp; -+ mm_segment_t fs; -+ loff_t pos = 0; -+ u8 source_addr[18]; -+ u8 *head, *end; -+ u32 curtime; -+ u32 i; -+ s32 ret = _SUCCESS; -+ -+ u8 null_mac_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; -+ u8 multi_mac_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ -+ curtime = rtw_get_current_time(); -+ -+ _rtw_memset(source_addr, 0, 18); -+ _rtw_memset(pbuf, 0, ETH_ALEN); -+ -+ fp = filp_open(MAC_ADDRESS_FILE_PATH, O_RDONLY, 0); -+ if (IS_ERR(fp)) -+ { -+ ret = _FAIL; -+ DBG_8192C("%s: Error, Read MAC address file FAIL!\n", __FUNCTION__); -+ } -+ else -+ { -+ fs = get_fs(); -+ set_fs(KERNEL_DS); -+ -+ vfs_read(fp, source_addr, 18, &pos); -+ source_addr[17] = ':'; -+ -+ head = end = source_addr; -+ for (i=0; i>8) & 0xff) ; -+ pbuf[5] = (u8)((curtime>>16) & 0xff) ; -+ } -+ -+ DBG_8192C("%s: Permanent Address = " MAC_FMT "\n", __FUNCTION__, MAC_ARG(pbuf)); -+ -+ return ret; -+} -+#endif // CONFIG_EFUSE_CONFIG_FILE -+ -+void InitRDGSetting8812A(PADAPTER padapter) -+{ -+ rtw_write8(padapter, REG_RD_CTRL, 0xFF); -+ rtw_write16(padapter, REG_RD_NAV_NXT, 0x200); -+ rtw_write8(padapter, REG_RD_RESP_PKT_TH, 0x05); -+} -+ -+void ReadRFType8812A(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ -+#if DISABLE_BB_RF -+ pHalData->rf_chip = RF_PSEUDO_11N; -+#else -+ pHalData->rf_chip = RF_6052; -+#endif -+ -+ //if (pHalData->rf_type == RF_1T1R){ -+ // pHalData->bRFPathRxEnable[0] = true; -+ //} -+ //else { // Default unknow type is 2T2r -+ // pHalData->bRFPathRxEnable[0] = pHalData->bRFPathRxEnable[1] = true; -+ //} -+ -+ if (IsSupported24G(padapter->registrypriv.wireless_mode) && -+ IsSupported5G(padapter->registrypriv.wireless_mode)) -+ pHalData->BandSet = BAND_ON_BOTH; -+ else if (IsSupported5G(padapter->registrypriv.wireless_mode)) -+ pHalData->BandSet = BAND_ON_5G; -+ else -+ pHalData->BandSet = BAND_ON_2_4G; -+ -+ //if(padapter->bInHctTest) -+ // pHalData->BandSet = BAND_ON_2_4G; -+} -+ -+void rtl8812_GetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ void * pValue1, -+ bool bSet) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ switch(eVariable){ -+ case HAL_ODM_STA_INFO: -+ break; -+ default: -+ break; -+ } -+} -+ -+void rtl8812_SetHalODMVar( -+ PADAPTER Adapter, -+ HAL_ODM_VARIABLE eVariable, -+ void * pValue1, -+ bool bSet) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ PDM_ODM_T podmpriv = &pHalData->odmpriv; -+ //_irqL irqL; -+ switch(eVariable){ -+ case HAL_ODM_STA_INFO: -+ { -+ struct sta_info *psta = (struct sta_info *)pValue1; -+ if(bSet){ -+ DBG_8192C("### Set STA_(%d) info\n",psta->mac_id); -+ ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS,psta->mac_id,psta); -+ #if(RATE_ADAPTIVE_SUPPORT==1) -+ ODM_RAInfo_Init(podmpriv,psta->mac_id); -+ #endif -+ } -+ else{ -+ DBG_8192C("### Clean STA_(%d) info\n",psta->mac_id); -+ //_enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); -+ ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS,psta->mac_id,NULL); -+ -+ //_exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); -+ } -+ } -+ break; -+ case HAL_ODM_P2P_STATE: -+ ODM_CmnInfoUpdate(podmpriv,ODM_CMNINFO_WIFI_DIRECT,bSet); -+ break; -+ case HAL_ODM_WIFI_DISPLAY_STATE: -+ ODM_CmnInfoUpdate(podmpriv,ODM_CMNINFO_WIFI_DISPLAY,bSet); -+ break; -+ default: -+ break; -+ } -+} -+ -+void rtl8812_clone_haldata(_adapter* dst_adapter, _adapter* src_adapter) -+{ -+ _rtw_memcpy(dst_adapter->HalData, src_adapter->HalData, dst_adapter->hal_data_sz); -+} -+ -+void rtl8812_start_thread(PADAPTER padapter) -+{ -+} -+ -+void rtl8812_stop_thread(PADAPTER padapter) -+{ -+} -+ -+void hal_notch_filter_8812(_adapter *adapter, bool enable) -+{ -+ if (enable) { -+ DBG_871X("Enable notch filter\n"); -+ //rtw_write8(adapter, rOFDM0_RxDSP+1, rtw_read8(adapter, rOFDM0_RxDSP+1) | BIT1); -+ } else { -+ DBG_871X("Disable notch filter\n"); -+ //rtw_write8(adapter, rOFDM0_RxDSP+1, rtw_read8(adapter, rOFDM0_RxDSP+1) & ~BIT1); -+ } -+} -+ -+u8 -+GetEEPROMSize8812A( -+ PADAPTER Adapter -+ ) -+{ -+ u8 size = 0; -+ u32 curRCR; -+ -+ curRCR = rtw_read16(Adapter, REG_SYS_EEPROM_CTRL); -+ size = (curRCR & EEPROMSEL) ? 6 : 4; // 6: EEPROM used is 93C46, 4: boot from E-Fuse. -+ -+ DBG_871X("EEPROM type is %s\n", size==4 ? "E-FUSE" : "93C46"); -+ //return size; -+ return 4; // <20120713, Kordan> The default value of HW is 6 ?!! -+} -+ -+void CheckAutoloadState8812A(PADAPTER padapter) -+{ -+ PEEPROM_EFUSE_PRIV pEEPROM; -+ u8 val8; -+ -+ -+ pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ -+ /* check system boot selection */ -+ val8 = rtw_read8(padapter, REG_9346CR); -+ pEEPROM->EepromOrEfuse = (val8 & BOOT_FROM_EEPROM) ? true : false; -+ pEEPROM->bautoload_fail_flag = (val8 & EEPROM_EN) ? false : true; -+ -+ DBG_8192C("%s: 9346CR(%#x)=0x%02x, Boot from %s, Autoload %s!\n", -+ __FUNCTION__, REG_9346CR, val8, -+ (pEEPROM->EepromOrEfuse ? "EEPROM" : "EFUSE"), -+ (pEEPROM->bautoload_fail_flag ? "Fail" : "OK")); -+} -+ -+void InitPGData8812A(PADAPTER padapter) -+{ -+ PEEPROM_EFUSE_PRIV pEEPROM; -+ u32 i; -+ u16 val16; -+ -+ -+ pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ { -+ s32 tmp; -+ u32 addr; -+ -+ tmp = _halReadPGDataFromFile(padapter, pEEPROM->efuse_eeprom_data); -+ pEEPROM->bloadfile_fail_flag = ((tmp==_FAIL) ? true : false); -+ tmp = _halReadMACAddrFromFile(padapter, pEEPROM->mac_addr); -+ pEEPROM->bloadmac_fail_flag = ((tmp==_FAIL) ? true : false); -+ -+ if (IS_HARDWARE_TYPE_8812AU(padapter)) -+ addr = EEPROM_MAC_ADDR_8812AE; -+ else -+ addr = EEPROM_MAC_ADDR_8821AE; -+ _rtw_memcpy(&pEEPROM->efuse_eeprom_data[addr], pEEPROM->mac_addr, ETH_ALEN); -+ } -+#else // !CONFIG_EFUSE_CONFIG_FILE -+ -+ if (false == pEEPROM->bautoload_fail_flag) -+ { -+ // autoload OK. -+ if (is_boot_from_eeprom(padapter)) -+ { -+ // Read all Content from EEPROM or EFUSE. -+ for (i = 0; i < HWSET_MAX_SIZE_JAGUAR; i += 2) -+ { -+ //val16 = le16_to_cpu(ReadEEprom(pAdapter, (u2Byte) (i>>1))); -+ //*((u16*)(&PROMContent[i])) = val16; -+ } -+ } -+ else -+ { -+ // Read EFUSE real map to shadow. -+ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, false); -+ } -+ } -+ else -+ { -+ // update to default value 0xFF -+ if (!is_boot_from_eeprom(padapter)) -+ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, false); -+ } -+#endif // !CONFIG_EFUSE_CONFIG_FILE -+} -+ -+void -+ReadChipVersion8812A( -+ PADAPTER Adapter -+ ) -+{ -+ u32 value32; -+ HAL_VERSION ChipVersion; -+ PHAL_DATA_TYPE pHalData; -+ -+ -+ pHalData = GET_HAL_DATA(Adapter); -+ -+ value32 = rtw_read32(Adapter, REG_SYS_CFG); -+ DBG_8192C("%s SYS_CFG(0x%X)=0x%08x \n", __FUNCTION__, REG_SYS_CFG, value32); -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ ChipVersion.ICType = CHIP_8812; -+ else -+ ChipVersion.ICType = CHIP_8821; -+ -+ ChipVersion.ChipType = ((value32 & RTL_ID) ? TEST_CHIP : NORMAL_CHIP); -+ -+ if (Adapter->registrypriv.rf_config == RF_MAX_TYPE) { -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ ChipVersion.RFType = RF_TYPE_2T2R;//RF_2T2R; -+ else -+ ChipVersion.RFType = RF_TYPE_1T1R;//RF_1T1R; -+ } -+ -+ if (IS_HARDWARE_TYPE_8812(Adapter)) -+ ChipVersion.VendorType = ((value32 & VENDOR_ID) ? CHIP_VENDOR_UMC : CHIP_VENDOR_TSMC); -+ else -+ { -+ u32 vendor; -+ -+ vendor = (value32 & EXT_VENDOR_ID) >> EXT_VENDOR_ID_SHIFT; -+ switch (vendor) -+ { -+ case 0: -+ vendor = CHIP_VENDOR_TSMC; -+ break; -+ case 1: -+ vendor = CHIP_VENDOR_SMIC; -+ break; -+ case 2: -+ vendor = CHIP_VENDOR_UMC; -+ break; -+ } -+ ChipVersion.VendorType = vendor; -+ } -+ ChipVersion.CUTVersion = (value32 & CHIP_VER_RTL_MASK)>>CHIP_VER_RTL_SHIFT; // IC version (CUT) -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ ChipVersion.CUTVersion += 1; -+ -+ //value32 = rtw_read32(Adapter, REG_GPIO_OUTSTS); -+ ChipVersion.ROMVer = 0; // ROM code version. -+ -+ // For multi-function consideration. Added by Roger, 2010.10.06. -+ pHalData->MultiFunc = RT_MULTI_FUNC_NONE; -+ value32 = rtw_read32(Adapter, REG_MULTI_FUNC_CTRL); -+ pHalData->MultiFunc |= ((value32 & WL_FUNC_EN) ? RT_MULTI_FUNC_WIFI : 0); -+ pHalData->MultiFunc |= ((value32 & BT_FUNC_EN) ? RT_MULTI_FUNC_BT : 0); -+ pHalData->PolarityCtl = ((value32 & WL_HWPDN_SL) ? RT_POLARITY_HIGH_ACT : RT_POLARITY_LOW_ACT); -+ -+#if 1 -+ dump_chip_info(ChipVersion); -+#endif -+ -+ _rtw_memcpy(&pHalData->VersionID, &ChipVersion, sizeof(HAL_VERSION)); -+ -+ if (IS_1T2R(ChipVersion)){ -+ pHalData->rf_type = RF_1T2R; -+ pHalData->NumTotalRFPath = 2; -+ } -+ else if (IS_2T2R(ChipVersion)){ -+ pHalData->rf_type = RF_2T2R; -+ pHalData->NumTotalRFPath = 2; -+ } -+ else{ -+ pHalData->rf_type = RF_1T1R; -+ pHalData->NumTotalRFPath = 1; -+ } -+ -+ DBG_8192C("RF_Type is %x!!\n", pHalData->rf_type); -+} -+ -+void -+Hal_PatchwithJaguar_8812( -+ PADAPTER Adapter, -+ RT_MEDIA_STATUS MediaStatus -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct mlme_ext_priv *pmlmeext = &(Adapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ if( (MediaStatus == RT_MEDIA_CONNECT) && -+ (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP )) -+ { -+ rtw_write8(Adapter, rVhtlen_Use_Lsig_Jaguar, 0x1); -+ rtw_write8(Adapter, REG_TCR+3, BIT2); -+ } -+ else -+ { -+ rtw_write8(Adapter, rVhtlen_Use_Lsig_Jaguar, 0x3F); -+ rtw_write8(Adapter, REG_TCR+3, BIT0|BIT1|BIT2); -+ } -+ -+ -+ if( (MediaStatus == RT_MEDIA_CONNECT) && -+ ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP) || -+ (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP))) -+ { -+ pHalData->Reg837 |= BIT2; -+ rtw_write8(Adapter, rBWIndication_Jaguar+3, pHalData->Reg837); -+ } -+ else -+ { -+ pHalData->Reg837 &= (~BIT2); -+ rtw_write8(Adapter, rBWIndication_Jaguar+3, pHalData->Reg837); -+ } -+} -+ -+void UpdateHalRAMask8812A(PADAPTER padapter, u32 mac_id, u8 rssi_level) -+{ -+ //volatile unsigned int result; -+ u8 init_rate=0; -+ u8 networkType, raid; -+ u32 mask,rate_bitmap; -+ u8 shortGIrate = false; -+ int supportRateNum = 0; -+ u8 arg[4] = {0}; -+ struct sta_info *psta; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ //struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); -+ -+ if (mac_id >= NUM_STA) //CAM_SIZE -+ { -+ return; -+ } -+ -+ psta = pmlmeinfo->FW_sta_info[mac_id].psta; -+ if(psta == NULL) -+ { -+ return; -+ } -+ -+ switch (mac_id) -+ { -+ case 0:// for infra mode -+#ifdef CONFIG_CONCURRENT_MODE -+ case 2:// first station uses macid=0, second station uses macid=2 -+#endif -+ supportRateNum = rtw_get_rateset_len(cur_network->SupportedRates); -+ networkType = judge_network_type(padapter, cur_network->SupportedRates, supportRateNum); -+ //pmlmeext->cur_wireless_mode = networkType; -+ //raid = networktype_to_raid(networkType); -+ raid = rtw_hal_networktype_to_raid(padapter, networkType); -+ -+ mask = update_supported_rate(cur_network->SupportedRates, supportRateNum); -+#ifdef CONFIG_80211AC_VHT -+ if (pmlmeinfo->VHT_enable) { -+ mask |= (rtw_vht_rate_to_bitmap(psta->vhtpriv.vht_mcs_map) << 12); -+ shortGIrate = psta->vhtpriv.sgi; -+ } -+ else -+#endif -+ { -+ mask |= (pmlmeinfo->HT_enable)? update_MCS_rate(&(pmlmeinfo->HT_caps)): 0; -+ if (support_short_GI(padapter, &(pmlmeinfo->HT_caps))) -+ shortGIrate = true; -+ } -+ -+ break; -+ -+ case 1://for broadcast/multicast -+ supportRateNum = rtw_get_rateset_len(pmlmeinfo->FW_sta_info[mac_id].SupportedRates); -+ if(pmlmeext->cur_wireless_mode & WIRELESS_11B) -+ networkType = WIRELESS_11B; -+ else -+ networkType = WIRELESS_11G; -+ //raid = networktype_to_raid(networkType); -+ raid = rtw_hal_networktype_to_raid(padapter, networkType); -+ mask = update_basic_rate(cur_network->SupportedRates, supportRateNum); -+ -+ -+ break; -+ -+ default: //for each sta in IBSS -+ supportRateNum = rtw_get_rateset_len(pmlmeinfo->FW_sta_info[mac_id].SupportedRates); -+ networkType = judge_network_type(padapter, pmlmeinfo->FW_sta_info[mac_id].SupportedRates, supportRateNum) & 0xf; -+ //pmlmeext->cur_wireless_mode = networkType; -+ //raid = networktype_to_raid(networkType); -+ raid = rtw_hal_networktype_to_raid(padapter, networkType); -+ mask = update_supported_rate(cur_network->SupportedRates, supportRateNum); -+ -+ //todo: support HT in IBSS -+ -+ break; -+ } -+ -+ //mask &=0x0fffffff; -+ rate_bitmap = 0xffffffff; -+#ifdef CONFIG_ODM_REFRESH_RAMASK -+ { -+ rate_bitmap = ODM_Get_Rate_Bitmap(&pHalData->odmpriv,mac_id,mask,rssi_level); -+ printk("%s => mac_id:%d, networkType:0x%02x, mask:0x%08x\n\t ==> rssi_level:%d, rate_bitmap:0x%08x\n", -+ __FUNCTION__,mac_id,networkType,mask,rssi_level,rate_bitmap); -+ } -+#endif -+ -+ mask &= rate_bitmap; -+ init_rate = get_highest_rate_idx(mask)&0x3f; -+ -+ //arg[0] = macid -+ //arg[1] = raid -+ //arg[2] = shortGIrate -+ //arg[3] = init_rate -+ -+ arg[0] = mac_id; -+ arg[1] = raid; -+ arg[2] = shortGIrate; -+ arg[3] = init_rate; -+ -+ rtl8812_set_raid_cmd(padapter, mask, arg); -+ -+ //set ra_id -+ psta->raid = raid; -+ psta->init_rate = init_rate; -+} -+ -+void InitDefaultValue8821A(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ struct pwrctrl_priv *pwrctrlpriv; -+ struct dm_priv *pdmpriv; -+ u8 i; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pwrctrlpriv = &padapter->pwrctrlpriv; -+ pdmpriv = &pHalData->dmpriv; -+ -+ // init default value -+ pHalData->fw_ractrl = false; -+ if (!pwrctrlpriv->bkeepfwalive) -+ pHalData->LastHMEBoxNum = 0; -+ -+ // init dm default value -+ pHalData->bChnlBWInitialzed = false; -+ pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized = false; -+ pHalData->odmpriv.RFCalibrateInfo.TM_Trigger = 0;//for IQK -+ pHalData->pwrGroupCnt = 0; -+ pHalData->PGMaxGroup = MAX_PG_GROUP; -+ pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP_index = 0; -+ for (i = 0; i < HP_THERMAL_NUM; i++) -+ pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP[i] = 0; -+} -+ -+void -+_InitBeaconParameters_8812A( -+ PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ rtw_write16(Adapter, REG_BCN_CTRL, 0x1010); -+ -+ // TODO: Remove these magic number -+ rtw_write16(Adapter, REG_TBTT_PROHIBIT,0x6404);// ms -+ rtw_write8(Adapter, REG_DRVERLYINT, DRIVER_EARLY_INT_TIME_8812);// 5ms -+ rtw_write8(Adapter, REG_BCNDMATIM, BCN_DMA_ATIME_INT_TIME_8812); // 2ms -+ -+ // Suggested by designer timchen. Change beacon AIFS to the largest number -+ // beacause test chip does not contension before sending beacon. by tynli. 2009.11.03 -+ rtw_write16(Adapter, REG_BCNTCFG, 0x660F); -+ -+ pHalData->RegBcnCtrlVal = rtw_read8(Adapter, REG_BCN_CTRL); -+ pHalData->RegTxPause = rtw_read8(Adapter, REG_TXPAUSE); -+ pHalData->RegFwHwTxQCtrl = rtw_read8(Adapter, REG_FWHW_TXQ_CTRL+2); -+ pHalData->RegReg542 = rtw_read8(Adapter, REG_TBTT_PROHIBIT+2); -+ pHalData->RegCR_1 = rtw_read8(Adapter, REG_CR+1); -+} -+ -+static void -+_BeaconFunctionEnable( -+ PADAPTER Adapter, -+ bool Enable, -+ bool Linked -+ ) -+{ -+ rtw_write8(Adapter, REG_BCN_CTRL, (BIT4 | BIT3 | BIT1)); -+ //SetBcnCtrlReg(Adapter, (BIT4 | BIT3 | BIT1), 0x00); -+ //RT_TRACE(COMP_BEACON, DBG_LOUD, ("_BeaconFunctionEnable 0x550 0x%x\n", PlatformEFIORead1Byte(Adapter, 0x550))); -+ -+ rtw_write8(Adapter, REG_RD_CTRL+1, 0x6F); -+} -+ -+static void ResumeTxBeacon(_adapter *padapter) -+{ -+ HAL_DATA_TYPE* pHalData = GET_HAL_DATA(padapter); -+ -+ // 2010.03.01. Marked by tynli. No need to call workitem beacause we record the value -+ // which should be read from register to a global variable. -+ -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, (pHalData->RegFwHwTxQCtrl) | BIT6); -+ pHalData->RegFwHwTxQCtrl |= BIT6; -+ rtw_write8(padapter, REG_TBTT_PROHIBIT+1, 0xff); -+ pHalData->RegReg542 |= BIT0; -+ rtw_write8(padapter, REG_TBTT_PROHIBIT+2, pHalData->RegReg542); -+} -+ -+static void StopTxBeacon(_adapter *padapter) -+{ -+ HAL_DATA_TYPE* pHalData = GET_HAL_DATA(padapter); -+ -+ rtw_write8(padapter, REG_FWHW_TXQ_CTRL+2, (pHalData->RegFwHwTxQCtrl) & (~BIT6)); -+ pHalData->RegFwHwTxQCtrl &= (~BIT6); -+ rtw_write8(padapter, REG_TBTT_PROHIBIT+1, 0x64); -+ pHalData->RegReg542 &= ~(BIT0); -+ rtw_write8(padapter, REG_TBTT_PROHIBIT+2, pHalData->RegReg542); -+ -+ //todo: CheckFwRsvdPageContent(Adapter); // 2010.06.23. Added by tynli. -+} -+ -+void SetBeaconRelatedRegisters8812A(PADAPTER padapter) -+{ -+ u32 value32; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u32 bcn_ctrl_reg = REG_BCN_CTRL; -+ //reset TSF, enable update TSF, correcting TSF On Beacon -+ -+ //REG_BCN_INTERVAL -+ //REG_BCNDMATIM -+ //REG_ATIMWND -+ //REG_TBTT_PROHIBIT -+ //REG_DRVERLYINT -+ //REG_BCN_MAX_ERR -+ //REG_BCNTCFG //(0x510) -+ //REG_DUAL_TSF_RST -+ //REG_BCN_CTRL //(0x550) -+ -+ //BCN interval -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->iface_type == IFACE_PORT1){ -+ bcn_ctrl_reg = REG_BCN_CTRL_1; -+ } -+#endif -+ rtw_write16(padapter, REG_BCN_INTERVAL, pmlmeinfo->bcn_interval); -+ rtw_write8(padapter, REG_ATIMWND, 0x02);// 2ms -+ -+ _InitBeaconParameters_8812A(padapter); -+ -+ rtw_write8(padapter, REG_SLOT, 0x09); -+ -+ value32 =rtw_read32(padapter, REG_TCR); -+ value32 &= ~TSFRST; -+ rtw_write32(padapter, REG_TCR, value32); -+ -+ value32 |= TSFRST; -+ rtw_write32(padapter, REG_TCR, value32); -+ -+ // NOTE: Fix test chip's bug (about contention windows's randomness) -+ rtw_write8(padapter, REG_RXTSF_OFFSET_CCK, 0x50); -+ rtw_write8(padapter, REG_RXTSF_OFFSET_OFDM, 0x50); -+ -+ _BeaconFunctionEnable(padapter, true, true); -+ -+ ResumeTxBeacon(padapter); -+ -+ //rtw_write8(padapter, 0x422, rtw_read8(padapter, 0x422)|BIT(6)); -+ -+ //rtw_write8(padapter, 0x541, 0xff); -+ -+ //rtw_write8(padapter, 0x542, rtw_read8(padapter, 0x541)|BIT(0)); -+ -+ rtw_write8(padapter, bcn_ctrl_reg, rtw_read8(padapter, bcn_ctrl_reg)|BIT(1)); -+ -+} -+ -+static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8* val) -+{ -+ u8 val8; -+ u8 mode = *((u8 *)val); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(Adapter->iface_type == IFACE_PORT1) -+ { -+ // disable Port1 TSF update -+ rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)|DIS_TSF_UDT); -+ -+ // set net_type -+ val8 = rtw_read8(Adapter, MSR)&0x03; -+ val8 |= (mode<<2); -+ rtw_write8(Adapter, MSR, val8); -+ -+ DBG_871X("%s()-%d mode = %d\n", __FUNCTION__, __LINE__, mode); -+ -+ if((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) -+ { -+ if(!check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE)) -+ { -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ rtw_write8(Adapter, REG_DRVERLYINT, 0x05);//restore early int time to 5ms -+ UpdateInterruptMask8812AU(Adapter,true, 0, IMR_BCNDMAINT1_8812); -+ #endif // CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8812AU(Adapter,true ,0, (IMR_TXBCN0ERR_8812|IMR_TXBCN0OK_8812)); -+ #endif// CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ -+ #endif //CONFIG_INTERRUPT_BASED_TXBCN -+ -+ -+ StopTxBeacon(Adapter); -+ } -+ -+ rtw_write8(Adapter,REG_BCN_CTRL_1, 0x19);//disable atim wnd -+ //rtw_write8(Adapter,REG_BCN_CTRL_1, 0x18); -+ } -+ else if((mode == _HW_STATE_ADHOC_) /*|| (mode == _HW_STATE_AP_)*/) -+ { -+ ResumeTxBeacon(Adapter); -+ rtw_write8(Adapter,REG_BCN_CTRL_1, 0x1a); -+ } -+ else if(mode == _HW_STATE_AP_) -+ { -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ UpdateInterruptMask8812AU(Adapter,true ,IMR_BCNDMAINT1_8812, 0); -+ #endif//CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8812AU(Adapter,true ,(IMR_TXBCN0ERR_8812|IMR_TXBCN0OK_8812), 0); -+ #endif//CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ -+#endif //CONFIG_INTERRUPT_BASED_TXBCN -+ -+ ResumeTxBeacon(Adapter); -+ -+ rtw_write8(Adapter, REG_BCN_CTRL_1, 0x12); -+ -+ //Set RCR -+ //rtw_write32(padapter, REG_RCR, 0x70002a8e);//CBSSID_DATA must set to 0 -+ //rtw_write32(Adapter, REG_RCR, 0x7000228e);//CBSSID_DATA must set to 0 -+ rtw_write32(Adapter, REG_RCR, 0x7000208e);//CBSSID_DATA must set to 0,reject ICV_ERR packet -+ //enable to rx data frame -+ rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); -+ //enable to rx ps-poll -+ rtw_write16(Adapter, REG_RXFLTMAP1, 0x0400); -+ -+ //Beacon Control related register for first time -+ rtw_write8(Adapter, REG_BCNDMATIM, 0x02); // 2ms -+ -+ //rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF); -+ rtw_write8(Adapter, REG_ATIMWND_1, 0x0a); // 10ms for port1 -+ rtw_write16(Adapter, REG_BCNTCFG, 0x00); -+ rtw_write16(Adapter, REG_TBTT_PROHIBIT, 0xff04); -+ rtw_write16(Adapter, REG_TSFTR_SYN_OFFSET, 0x7fff);// +32767 (~32ms) -+ -+ //reset TSF2 -+ rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(1)); -+ -+ //enable BCN1 Function for if2 -+ //don't enable update TSF1 for if2 (due to TSF update when beacon/probe rsp are received) -+ rtw_write8(Adapter, REG_BCN_CTRL_1, (DIS_TSF_UDT|EN_BCN_FUNCTION | EN_TXBCN_RPT|DIS_BCNQ_SUB)); -+ -+ if(IS_HARDWARE_TYPE_8821(Adapter)) -+ { -+ // select BCN on port 1 -+ rtw_write8(Adapter, REG_CCK_CHECK_8812, rtw_read8(Adapter, REG_CCK_CHECK_8812)|BIT(5)); -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(Adapter, WIFI_FW_NULL_STATE)) -+ rtw_write8(Adapter, REG_BCN_CTRL, -+ rtw_read8(Adapter, REG_BCN_CTRL) & ~EN_BCN_FUNCTION); -+#endif -+ //BCN1 TSF will sync to BCN0 TSF with offset(0x518) if if1_sta linked -+ //rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)|BIT(5)); -+ //rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(3)); -+ -+ //dis BCN0 ATIM WND if if1 is station -+ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)|DIS_ATIM); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+ // Reset TSF for STA+AP concurrent mode -+ if ( check_buddy_fwstate(Adapter, (WIFI_STATION_STATE|WIFI_ASOC_STATE)) ) { -+ if (reset_tsf(Adapter, IFACE_PORT1) == false) -+ DBG_871X("ERROR! %s()-%d: Reset port1 TSF fail\n", -+ __FUNCTION__, __LINE__); -+ } -+#endif // CONFIG_TSF_RESET_OFFLOAD -+ } -+ } -+ else //else for port0 -+#endif // CONFIG_CONCURRENT_MODE -+ { -+ // disable Port0 TSF update -+ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)|DIS_TSF_UDT); -+ -+ // set net_type -+ val8 = rtw_read8(Adapter, MSR)&0x0c; -+ val8 |= mode; -+ rtw_write8(Adapter, MSR, val8); -+ -+ DBG_871X("%s()-%d mode = %d\n", __FUNCTION__, __LINE__, mode); -+ -+ if((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if(!check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE)) -+#endif // CONFIG_CONCURRENT_MODE -+ { -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ rtw_write8(Adapter, REG_DRVERLYINT, 0x05);//restore early int time to 5ms -+ UpdateInterruptMask8812AU(Adapter,true, 0, IMR_BCNDMAINT0_8812); -+ #endif//CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8812AU(Adapter,true ,0, (IMR_TXBCN0ERR_8812|IMR_TXBCN0OK_8812)); -+ #endif //CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ -+ #endif //CONFIG_INTERRUPT_BASED_TXBCN -+ StopTxBeacon(Adapter); -+ } -+ -+ rtw_write8(Adapter,REG_BCN_CTRL, 0x19);//disable atim wnd -+ //rtw_write8(Adapter,REG_BCN_CTRL, 0x18); -+ } -+ else if((mode == _HW_STATE_ADHOC_) /*|| (mode == _HW_STATE_AP_)*/) -+ { -+ ResumeTxBeacon(Adapter); -+ rtw_write8(Adapter,REG_BCN_CTRL, 0x1a); -+ } -+ else if(mode == _HW_STATE_AP_) -+ { -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ UpdateInterruptMask8812AU(Adapter,true ,IMR_BCNDMAINT0_8812, 0); -+ #endif//CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ UpdateInterruptMask8812AU(Adapter,true ,(IMR_TXBCN0ERR_8812|IMR_TXBCN0OK_8812), 0); -+ #endif//CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ -+#endif //CONFIG_INTERRUPT_BASED_TXBCN -+ -+ -+ ResumeTxBeacon(Adapter); -+ -+ rtw_write8(Adapter, REG_BCN_CTRL, 0x12); -+ -+ //Set RCR -+ //rtw_write32(padapter, REG_RCR, 0x70002a8e);//CBSSID_DATA must set to 0 -+ //rtw_write32(Adapter, REG_RCR, 0x7000228e);//CBSSID_DATA must set to 0 -+ rtw_write32(Adapter, REG_RCR, 0x7000208e);//CBSSID_DATA must set to 0,reject ICV_ERR packet -+ //enable to rx data frame -+ rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); -+ //enable to rx ps-poll -+ rtw_write16(Adapter, REG_RXFLTMAP1, 0x0400); -+ -+ //Beacon Control related register for first time -+ rtw_write8(Adapter, REG_BCNDMATIM, 0x02); // 2ms -+ -+ //rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF); -+ rtw_write8(Adapter, REG_ATIMWND, 0x0a); // 10ms -+ rtw_write16(Adapter, REG_BCNTCFG, 0x00); -+ rtw_write16(Adapter, REG_TBTT_PROHIBIT, 0xff04); -+ rtw_write16(Adapter, REG_TSFTR_SYN_OFFSET, 0x7fff);// +32767 (~32ms) -+ -+ //reset TSF -+ rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(0)); -+ -+ //enable BCN0 Function for if1 -+ //don't enable update TSF0 for if1 (due to TSF update when beacon/probe rsp are received) -+ rtw_write8(Adapter, REG_BCN_CTRL, (DIS_TSF_UDT|EN_BCN_FUNCTION | EN_TXBCN_RPT|DIS_BCNQ_SUB)); -+ -+ if(IS_HARDWARE_TYPE_8821(Adapter)) -+ { -+ // select BCN on port 0 -+ rtw_write8(Adapter, REG_CCK_CHECK_8812, rtw_read8(Adapter, REG_CCK_CHECK_8812)&(~BIT(5))); -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(Adapter, WIFI_FW_NULL_STATE)) -+ rtw_write8(Adapter, REG_BCN_CTRL_1, -+ rtw_read8(Adapter, REG_BCN_CTRL_1) & ~EN_BCN_FUNCTION); -+#endif -+ -+ //dis BCN1 ATIM WND if if2 is station -+ rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)|DIS_ATIM); -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+ // Reset TSF for STA+AP concurrent mode -+ if ( check_buddy_fwstate(Adapter, (WIFI_STATION_STATE|WIFI_ASOC_STATE)) ) { -+ if (reset_tsf(Adapter, IFACE_PORT0) == false) -+ DBG_871X("ERROR! %s()-%d: Reset port0 TSF fail\n", -+ __FUNCTION__, __LINE__); -+ } -+#endif // CONFIG_TSF_RESET_OFFLOAD -+ } -+ } -+ -+} -+ -+static void hw_var_set_macaddr(PADAPTER Adapter, u8 variable, u8* val) -+{ -+ u8 idx = 0; -+ u32 reg_macid; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(Adapter->iface_type == IFACE_PORT1) -+ { -+ reg_macid = REG_MACID1; -+ } -+ else -+#endif -+ { -+ reg_macid = REG_MACID; -+ } -+ -+ for(idx = 0 ; idx < 6; idx++) -+ { -+ rtw_write8(Adapter, (reg_macid+idx), val[idx]); -+ } -+ -+} -+ -+static void hw_var_set_bssid(PADAPTER Adapter, u8 variable, u8* val) -+{ -+ u8 idx = 0; -+ u32 reg_bssid; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(Adapter->iface_type == IFACE_PORT1) -+ { -+ reg_bssid = REG_BSSID1; -+ } -+ else -+#endif -+ { -+ reg_bssid = REG_BSSID; -+ } -+ -+ for(idx = 0 ; idx < 6; idx++) -+ { -+ rtw_write8(Adapter, (reg_bssid+idx), val[idx]); -+ } -+ -+} -+ -+static void hw_var_set_bcn_func(PADAPTER Adapter, u8 variable, u8* val) -+{ -+ u32 bcn_ctrl_reg; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(Adapter->iface_type == IFACE_PORT1) -+ { -+ bcn_ctrl_reg = REG_BCN_CTRL_1; -+ } -+ else -+#endif -+ { -+ bcn_ctrl_reg = REG_BCN_CTRL; -+ } -+ -+ if(*((u8 *)val)) -+ { -+ rtw_write8(Adapter, bcn_ctrl_reg, (EN_BCN_FUNCTION | EN_TXBCN_RPT)); -+ } -+ else -+ { -+ rtw_write8(Adapter, bcn_ctrl_reg, rtw_read8(Adapter, bcn_ctrl_reg)&(~(EN_BCN_FUNCTION | EN_TXBCN_RPT))); -+ } -+ -+ -+} -+ -+static void hw_var_set_correct_tsf(PADAPTER Adapter, u8 variable, u8* val) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ u64 tsf; -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ //tsf = pmlmeext->TSFValue - ((u32)pmlmeext->TSFValue % (pmlmeinfo->bcn_interval*1024)) -1024; //us -+ tsf = pmlmeext->TSFValue - rtw_modular64(pmlmeext->TSFValue, (pmlmeinfo->bcn_interval*1024)) -1024; //us -+ -+ if(((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ { -+ //pHalData->RegTxPause |= STOP_BCNQ;BIT(6) -+ //rtw_write8(Adapter, REG_TXPAUSE, (rtw_read8(Adapter, REG_TXPAUSE)|BIT(6))); -+ StopTxBeacon(Adapter); -+ } -+ -+ if(Adapter->iface_type == IFACE_PORT1) -+ { -+ //disable related TSF function -+ rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)&(~BIT(3))); -+ -+ rtw_write32(Adapter, REG_TSFTR1, tsf); -+ rtw_write32(Adapter, REG_TSFTR1+4, tsf>>32); -+ -+ -+ //enable related TSF function -+ rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)|BIT(3)); -+ -+ // Update buddy port's TSF if it is SoftAP for beacon TX issue! -+ if ( (pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE -+ && check_buddy_fwstate(Adapter, WIFI_AP_STATE) -+ ) { -+ //disable related TSF function -+ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)&(~BIT(3))); -+ -+ rtw_write32(Adapter, REG_TSFTR, tsf); -+ rtw_write32(Adapter, REG_TSFTR+4, tsf>>32); -+ -+ //enable related TSF function -+ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)|BIT(3)); -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+ // Update buddy port's TSF(TBTT) if it is SoftAP for beacon TX issue! -+ if (reset_tsf(Adapter, IFACE_PORT0) == false) -+ DBG_871X("ERROR! %s()-%d: Reset port0 TSF fail\n", -+ __FUNCTION__, __LINE__); -+ -+#endif // CONFIG_TSF_RESET_OFFLOAD -+ } -+ -+ -+ } -+ else -+ { -+ //disable related TSF function -+ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)&(~BIT(3))); -+ -+ rtw_write32(Adapter, REG_TSFTR, tsf); -+ rtw_write32(Adapter, REG_TSFTR+4, tsf>>32); -+ -+ //enable related TSF function -+ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)|BIT(3)); -+ -+ // Update buddy port's TSF if it is SoftAP for beacon TX issue! -+ if ( (pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE -+ && check_buddy_fwstate(Adapter, WIFI_AP_STATE) -+ ) { -+ //disable related TSF function -+ rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)&(~BIT(3))); -+ -+ rtw_write32(Adapter, REG_TSFTR1, tsf); -+ rtw_write32(Adapter, REG_TSFTR1+4, tsf>>32); -+ -+ //enable related TSF function -+ rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)|BIT(3)); -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+ // Update buddy port's TSF if it is SoftAP for beacon TX issue! -+ if (reset_tsf(Adapter, IFACE_PORT1) == false) -+ DBG_871X("ERROR! %s()-%d: Reset port1 TSF fail\n", -+ __FUNCTION__, __LINE__); -+#endif // CONFIG_TSF_RESET_OFFLOAD -+ } -+ -+ } -+ -+ -+ if(((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ { -+ //pHalData->RegTxPause &= (~STOP_BCNQ); -+ //rtw_write8(Adapter, REG_TXPAUSE, (rtw_read8(Adapter, REG_TXPAUSE)&(~BIT(6)))); -+ ResumeTxBeacon(Adapter); -+ } -+#endif -+} -+ -+static void hw_var_set_mlme_disconnect(PADAPTER Adapter, u8 variable, u8* val) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ -+ if(check_buddy_mlmeinfo_state(Adapter, _HW_STATE_NOLINK_)) -+ rtw_write16(Adapter, REG_RXFLTMAP2, 0x00); -+ -+ -+ if(Adapter->iface_type == IFACE_PORT1) -+ { -+ //reset TSF1 -+ rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(1)); -+ -+ //disable update TSF1 -+ rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)|BIT(4)); -+ } -+ else -+ { -+ //reset TSF -+ rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(0)); -+ -+ //disable update TSF -+ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)|BIT(4)); -+ } -+#endif -+} -+ -+static void hw_var_set_mlme_sitesurvey(PADAPTER Adapter, u8 variable, u8* val) -+{ -+ u32 value_rcr, rcr_clear_bit, reg_bcn_ctl; -+ u16 value_rxfltmap2; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct mlme_priv *pmlmepriv=&(Adapter->mlmepriv); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(Adapter->iface_type == IFACE_PORT1) -+ reg_bcn_ctl = REG_BCN_CTRL_1; -+ else -+#endif -+ reg_bcn_ctl = REG_BCN_CTRL; -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ -+ rcr_clear_bit = (RCR_CBSSID_BCN | RCR_CBSSID_DATA); -+ -+ // Recieve all data frames -+ value_rxfltmap2 = 0xFFFF; -+ -+#else /* CONFIG_FIND_BEST_CHANNEL */ -+ -+ rcr_clear_bit = RCR_CBSSID_BCN; -+ -+ //config RCR to receive different BSSID & not to receive data frame -+ value_rxfltmap2 = 0; -+ -+#endif /* CONFIG_FIND_BEST_CHANNEL */ -+ -+ if( (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+#ifdef CONFIG_CONCURRENT_MODE -+ || (check_buddy_fwstate(Adapter, WIFI_AP_STATE) == true) -+#endif -+ ) -+ { -+ rcr_clear_bit = RCR_CBSSID_BCN; -+ } -+#ifdef CONFIG_TDLS -+ // TDLS will clear RCR_CBSSID_DATA bit for connection. -+ else if (Adapter->tdlsinfo.setup_state & TDLS_LINKED_STATE) -+ { -+ rcr_clear_bit = RCR_CBSSID_BCN; -+ } -+#endif // CONFIG_TDLS -+ -+ value_rcr = rtw_read32(Adapter, REG_RCR); -+ -+ if(*((u8 *)val))//under sitesurvey -+ { -+ value_rcr &= ~(rcr_clear_bit); -+ rtw_write32(Adapter, REG_RCR, value_rcr); -+ -+ rtw_write16(Adapter, REG_RXFLTMAP2, value_rxfltmap2); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE |WIFI_ADHOC_MASTER_STATE)) { -+ //disable update TSF -+ rtw_write8(Adapter, reg_bcn_ctl, rtw_read8(Adapter, reg_bcn_ctl)|DIS_TSF_UDT); -+ } -+ -+ // Save orignal RRSR setting. -+ pHalData->RegRRSR = rtw_read16(Adapter, REG_RRSR); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE) && -+ check_buddy_fwstate(Adapter, _FW_LINKED)) -+ { -+ StopTxBeacon(Adapter); -+ } -+#endif -+ } -+ else//sitesurvey done -+ { -+ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) -+#ifdef CONFIG_CONCURRENT_MODE -+ || check_buddy_fwstate(Adapter, (_FW_LINKED|WIFI_AP_STATE)) -+#endif -+ ) -+ { -+ //enable to rx data frame -+ rtw_write16(Adapter, REG_RXFLTMAP2,0xFFFF); -+ } -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE |WIFI_ADHOC_MASTER_STATE)) { -+ //enable update TSF -+ rtw_write8(Adapter, reg_bcn_ctl, rtw_read8(Adapter, reg_bcn_ctl)&(~(DIS_TSF_UDT))); -+ } -+ -+ value_rcr |= rcr_clear_bit; -+ rtw_write32(Adapter, REG_RCR, value_rcr); -+ -+ // Restore orignal RRSR setting. -+ rtw_write16(Adapter, REG_RRSR, pHalData->RegRRSR); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE) && -+ check_buddy_fwstate(Adapter, _FW_LINKED)) -+ { -+ ResumeTxBeacon(Adapter); -+ } -+#endif -+ } -+} -+ -+static void hw_var_set_mlme_join(PADAPTER Adapter, u8 variable, u8* val) -+{ -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 RetryLimit = 0x30; -+ u8 type = *((u8 *)val); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); -+ -+ if(type == 0) // prepare to join -+ { -+ if(check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE) && -+ check_buddy_fwstate(Adapter, _FW_LINKED)) -+ { -+ StopTxBeacon(Adapter); -+ } -+ -+ //enable to rx data frame.Accept all data frame -+ //rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_ADF); -+ rtw_write16(Adapter, REG_RXFLTMAP2,0xFFFF); -+ -+ if(check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE)) -+ { -+ rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR)|RCR_CBSSID_BCN); -+ } -+ else -+ { -+ rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR)|RCR_CBSSID_DATA|RCR_CBSSID_BCN); -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) -+ { -+ RetryLimit = (pEEPROM->CustomerID == RT_CID_CCX) ? 7 : 48; -+ } -+ else // Ad-hoc Mode -+ { -+ RetryLimit = 0x7; -+ } -+ } -+ else if(type == 1) //joinbss_event call back when join res < 0 -+ { -+ if(check_buddy_mlmeinfo_state(Adapter, _HW_STATE_NOLINK_)) -+ rtw_write16(Adapter, REG_RXFLTMAP2,0x00); -+ -+ if(check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE) && -+ check_buddy_fwstate(Adapter, _FW_LINKED)) -+ { -+ ResumeTxBeacon(Adapter); -+ -+ //reset TSF 1/2 after ResumeTxBeacon -+ rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(1)|BIT(0)); -+ -+ } -+ } -+ else if(type == 2) //sta add event call back -+ { -+ -+ //enable update TSF -+ if(Adapter->iface_type == IFACE_PORT1) -+ rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1)&(~BIT(4))); -+ else -+ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)&(~BIT(4))); -+ -+ -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE)) -+ { -+ //fixed beacon issue for 8191su........... -+ rtw_write8(Adapter,0x542 ,0x02); -+ RetryLimit = 0x7; -+ } -+ -+ -+ if(check_buddy_mlmeinfo_state(Adapter, WIFI_FW_AP_STATE) && -+ check_buddy_fwstate(Adapter, _FW_LINKED)) -+ { -+ ResumeTxBeacon(Adapter); -+ -+ //reset TSF 1/2 after ResumeTxBeacon -+ rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(1)|BIT(0)); -+ } -+ -+ } -+ -+ rtw_write16(Adapter, REG_RL, RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT); -+ -+#endif -+} -+ -+void SetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval) -+{ -+ PHAL_DATA_TYPE pHalData; -+ struct dm_priv *pdmpriv; -+ PDM_ODM_T podmpriv; -+ u8 val8; -+ u16 val16; -+ u32 val32; -+ -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pdmpriv = &pHalData->dmpriv; -+ podmpriv = &pHalData->odmpriv; -+ -+ switch (variable) -+ { -+ case HW_VAR_MEDIA_STATUS: -+ val8 = rtw_read8(padapter, MSR) & 0x0c; -+ val8 |= *pval; -+ rtw_write8(padapter, MSR, val8); -+ break; -+ -+ case HW_VAR_MEDIA_STATUS1: -+ val8 = rtw_read8(padapter, MSR) & 0x03; -+ val8 |= *pval << 2; -+ rtw_write8(padapter, MSR, val8); -+ break; -+ -+ case HW_VAR_SET_OPMODE: -+ hw_var_set_opmode(padapter, variable, pval); -+ break; -+ -+ case HW_VAR_MAC_ADDR: -+ hw_var_set_macaddr(padapter, variable, pval); -+ break; -+ -+ case HW_VAR_BSSID: -+ hw_var_set_bssid(padapter, variable, pval); -+ break; -+ -+ case HW_VAR_BASIC_RATE: -+ { -+ u16 BrateCfg = 0; -+ u8 RateIndex = 0; -+ -+ // 2007.01.16, by Emily -+ // Select RRSR (in Legacy-OFDM and CCK) -+ // For 8190, we select only 24M, 12M, 6M, 11M, 5.5M, 2M, and 1M from the Basic rate. -+ // We do not use other rates. -+ HalSetBrateCfg(padapter, pval, &BrateCfg); -+ -+ if(pHalData->CurrentBandType == BAND_ON_2_4G) -+ { -+ //CCK 2M ACK should be disabled for some BCM and Atheros AP IOT -+ //because CCK 2M has poor TXEVM -+ //CCK 5.5M & 11M ACK should be enabled for better performance -+ -+ pHalData->BasicRateSet = BrateCfg = (BrateCfg |0xd) & 0x15d; -+ BrateCfg |= 0x01; // default enable 1M ACK rate -+ } -+ else // 5G -+ { -+ pHalData->BasicRateSet &= 0xFF0; -+ BrateCfg |= 0x10; // default enable 6M ACK rate -+ } -+// DBG_8192C("HW_VAR_BASIC_RATE: BrateCfg(%#x)\n", BrateCfg); -+ -+ // Set RRSR rate table. -+ rtw_write8(padapter, REG_RRSR, BrateCfg&0xff); -+ rtw_write8(padapter, REG_RRSR+1, (BrateCfg>>8)&0xff); -+ rtw_write8(padapter, REG_RRSR+2, rtw_read8(padapter, REG_RRSR+2)&0xf0); -+ } -+ break; -+ -+ case HW_VAR_TXPAUSE: -+ rtw_write8(padapter, REG_TXPAUSE, *pval); -+ break; -+ -+ case HW_VAR_BCN_FUNC: -+ hw_var_set_bcn_func(padapter, variable, pval); -+ break; -+ -+ case HW_VAR_CORRECT_TSF: -+#ifdef CONFIG_CONCURRENT_MODE -+ hw_var_set_correct_tsf(padapter, variable, pval); -+#else -+ { -+ u64 tsf; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ //tsf = pmlmeext->TSFValue - ((u32)pmlmeext->TSFValue % (pmlmeinfo->bcn_interval*1024)) -1024; //us -+ tsf = pmlmeext->TSFValue - rtw_modular64(pmlmeext->TSFValue, (pmlmeinfo->bcn_interval*1024)) -1024; //us -+ -+ if(((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ { -+ //pHalData->RegTxPause |= STOP_BCNQ;BIT(6) -+ //rtw_write8(padapter, REG_TXPAUSE, (rtw_read8(padapter, REG_TXPAUSE)|BIT(6))); -+ StopTxBeacon(padapter); -+ } -+ -+ //disable related TSF function -+ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)&(~BIT(3))); -+ -+ rtw_write32(padapter, REG_TSFTR, tsf); -+ rtw_write32(padapter, REG_TSFTR+4, tsf>>32); -+ -+ //enable related TSF function -+ rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL)|BIT(3)); -+ -+ -+ if(((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) -+ { -+ //pHalData->RegTxPause &= (~STOP_BCNQ); -+ //rtw_write8(padapter, REG_TXPAUSE, (rtw_read8(padapter, REG_TXPAUSE)&(~BIT(6)))); -+ ResumeTxBeacon(padapter); -+ } -+ } -+#endif -+ break; -+ -+ case HW_VAR_CHECK_BSSID: -+ val32 = rtw_read32(padapter, REG_RCR); -+ if (*pval) -+ val32 |= RCR_CBSSID_DATA|RCR_CBSSID_BCN; -+ else -+ val32 &= ~(RCR_CBSSID_DATA|RCR_CBSSID_BCN); -+ rtw_write32(padapter, REG_RCR, val32); -+ break; -+ -+ case HW_VAR_MLME_DISCONNECT: -+#ifdef CONFIG_CONCURRENT_MODE -+ hw_var_set_mlme_disconnect(padapter, variable, pval); -+#else -+ { -+ // Set RCR to not to receive data frame when NO LINK state -+// val32 = rtw_read32(padapter, REG_RCR); -+// val32 &= ~RCR_ADF; -+// rtw_write32(padapter, REG_RCR, val32); -+ -+ // reject all data frames -+ rtw_write16(padapter, REG_RXFLTMAP2, 0x00); -+ -+ // reset TSF -+ val8 = BIT(0) | BIT(1); -+ rtw_write8(padapter, REG_DUAL_TSF_RST, val8); -+ -+ // disable update TSF -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 |= BIT(4); -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ } -+#endif -+ break; -+ -+ case HW_VAR_MLME_SITESURVEY: -+ hw_var_set_mlme_sitesurvey(padapter, variable, pval); -+ -+#ifdef CONFIG_BT_COEXIST -+ BT_WifiScanNotify(padapter, *pval?true:false); -+#endif -+ break; -+ -+ case HW_VAR_MLME_JOIN: -+#ifdef CONFIG_CONCURRENT_MODE -+ hw_var_set_mlme_join(padapter, variable, pval); -+#else // !CONFIG_CONCURRENT_MODE -+ { -+ u8 RetryLimit = 0x30; -+ u8 type = *(u8*)pval; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ -+ if (type == 0) // prepare to join -+ { -+ //enable to rx data frame.Accept all data frame -+ //rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_ADF); -+ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); -+ -+ val32 = rtw_read32(padapter, REG_RCR); -+ if (padapter->in_cta_test) -+ val32 &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN);//| RCR_ADF -+ else -+ val32 |= RCR_CBSSID_DATA|RCR_CBSSID_BCN; -+ rtw_write32(padapter, REG_RCR, val32); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) -+ { -+ RetryLimit = (pEEPROM->CustomerID == RT_CID_CCX) ? 7 : 48; -+ } -+ else // Ad-hoc Mode -+ { -+ RetryLimit = 0x7; -+ } -+ -+ pHalData->bNeedIQK = true; -+ } -+ else if (type == 1) //joinbss_event call back when join res < 0 -+ { -+ rtw_write16(padapter, REG_RXFLTMAP2, 0x00); -+ } -+ else if (type == 2) //sta add event call back -+ { -+ //enable update TSF -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 &= ~BIT(4); -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE)) -+ { -+ RetryLimit = 0x7; -+ } -+ } -+ -+ val16 = RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT; -+ rtw_write16(padapter, REG_RL, val16); -+ } -+#endif // !CONFIG_CONCURRENT_MODE -+ -+#ifdef CONFIG_BT_COEXIST -+ switch (*pval) -+ { -+ case 0: -+ // prepare to join -+ BT_WifiAssociateNotify(padapter, true); -+ break; -+ case 1: -+ // joinbss_event callback when join res < 0 -+ BT_WifiAssociateNotify(padapter, false); -+ break; -+ case 2: -+ // sta add event callback -+// BT_WifiMediaStatusNotify(padapter, RT_MEDIA_CONNECT); -+ break; -+ } -+#endif -+ break; -+ -+ case HW_VAR_ON_RCR_AM: -+ val32 = rtw_read32(padapter, REG_RCR); -+ val32 |= RCR_AM; -+ rtw_write32(padapter, REG_RCR, val32); -+ DBG_8192C("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(padapter, REG_RCR)); -+ break; -+ -+ case HW_VAR_OFF_RCR_AM: -+ val32 = rtw_read32(padapter, REG_RCR); -+ val32 &= ~RCR_AM; -+ rtw_write32(padapter, REG_RCR, val32); -+ DBG_8192C("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(padapter, REG_RCR)); -+ break; -+ -+ case HW_VAR_BEACON_INTERVAL: -+ rtw_write16(padapter, REG_BCN_INTERVAL, *(u16*)pval); -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ { -+ struct mlme_ext_priv *pmlmeext; -+ struct mlme_ext_info *pmlmeinfo; -+ u16 bcn_interval; -+ -+ pmlmeext = &padapter->mlmeextpriv; -+ pmlmeinfo = &pmlmeext->mlmext_info; -+ bcn_interval = *((u16*)pval); -+ -+ if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) -+ { -+ DBG_8192C("%s==> bcn_interval:%d, eraly_int:%d\n", __FUNCTION__, bcn_interval, bcn_interval>>1); -+ rtw_write8(padapter, REG_DRVERLYINT, bcn_interval>>1);// 50ms for sdio -+ } -+ } -+#endif // CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ break; -+ -+ case HW_VAR_SLOT_TIME: -+ rtw_write8(padapter, REG_SLOT, *pval); -+ break; -+ -+ case HW_VAR_RESP_SIFS: -+ // SIFS_Timer = 0x0a0a0808; -+ // RESP_SIFS for CCK -+ rtw_write8(padapter, REG_RESP_SIFS_CCK, pval[0]); // SIFS_T2T_CCK (0x08) -+ rtw_write8(padapter, REG_RESP_SIFS_CCK+1, pval[1]); //SIFS_R2T_CCK(0x08) -+ // RESP_SIFS for OFDM -+ rtw_write8(padapter, REG_RESP_SIFS_OFDM, pval[2]); //SIFS_T2T_OFDM (0x0a) -+ rtw_write8(padapter, REG_RESP_SIFS_OFDM+1, pval[3]); //SIFS_R2T_OFDM(0x0a) -+ break; -+ -+ case HW_VAR_ACK_PREAMBLE: -+ { -+ u8 bShortPreamble = *pval; -+ -+ // Joseph marked out for Netgear 3500 TKIP channel 7 issue.(Temporarily) -+ val8 = (pHalData->nCur40MhzPrimeSC) << 5; -+ if (bShortPreamble) -+ val8 |= 0x80; -+ rtw_write8(padapter, REG_RRSR+2, val8); -+ } -+ break; -+ -+ case HW_VAR_SEC_CFG: -+#ifdef CONFIG_CONCURRENT_MODE -+ // enable tx enc and rx dec engine, and no key search for MC/BC -+ val8 = 0x0c | BIT(5); -+#else -+ val8 = *pval; -+#endif -+ rtw_write8(padapter, REG_SECCFG, val8); -+ break; -+ -+ case HW_VAR_DM_FLAG: -+ podmpriv->SupportAbility = *(u32*)pval; -+ break; -+ -+ case HW_VAR_DM_FUNC_OP: -+ if (*pval) // save dm flag -+ podmpriv->BK_SupportAbility = podmpriv->SupportAbility; -+ else // restore dm flag -+ podmpriv->SupportAbility = podmpriv->BK_SupportAbility; -+ break; -+ -+ case HW_VAR_DM_FUNC_SET: -+ val32 = *(u32*)pval; -+ if (val32 == DYNAMIC_ALL_FUNC_ENABLE) { -+ pdmpriv->DMFlag = pdmpriv->InitDMFlag; -+ podmpriv->SupportAbility = pdmpriv->InitODMFlag; -+ } else { -+ podmpriv->SupportAbility |= val32; -+ } -+ break; -+ -+ case HW_VAR_DM_FUNC_CLR: -+ val32 = *(u32*)pval; -+ // input is already a mask to clear function -+ // don't invert it again! George,Lucas@20130513 -+ podmpriv->SupportAbility &= val32; -+ break; -+ -+ case HW_VAR_CAM_EMPTY_ENTRY: -+ { -+ u8 ucIndex = *pval; -+ u8 i; -+ u32 ulCommand = 0; -+ u32 ulContent = 0; -+ u32 ulEncAlgo = CAM_AES; -+ -+ for (i=0; iAcParam_BE = *(u32*)pval; -+ rtw_write32(padapter, REG_EDCA_BE_PARAM, *(u32*)pval); -+ break; -+ -+ case HW_VAR_AC_PARAM_BK: -+ rtw_write32(padapter, REG_EDCA_BK_PARAM, *(u32*)pval); -+ break; -+ -+ case HW_VAR_ACM_CTRL: -+ { -+ u8 acm_ctrl; -+ u8 AcmCtrl; -+ -+ acm_ctrl = *(u8*)pval; -+ AcmCtrl = rtw_read8(padapter, REG_ACMHWCTRL); -+ -+ if (acm_ctrl > 1) -+ AcmCtrl = AcmCtrl | 0x1; -+ -+ if (acm_ctrl & BIT(3)) -+ AcmCtrl |= AcmHw_VoqEn; -+ else -+ AcmCtrl &= (~AcmHw_VoqEn); -+ -+ if (acm_ctrl & BIT(2)) -+ AcmCtrl |= AcmHw_ViqEn; -+ else -+ AcmCtrl &= (~AcmHw_ViqEn); -+ -+ if (acm_ctrl & BIT(1)) -+ AcmCtrl |= AcmHw_BeqEn; -+ else -+ AcmCtrl &= (~AcmHw_BeqEn); -+ -+ DBG_8192C("[HW_VAR_ACM_CTRL] Write 0x%X\n", AcmCtrl); -+ rtw_write8(padapter, REG_ACMHWCTRL, AcmCtrl ); -+ } -+ break; -+ -+ case HW_VAR_AMPDU_MIN_SPACE: -+ pHalData->AMPDUDensity = *(u8*)pval; -+ break; -+ -+ case HW_VAR_AMPDU_FACTOR: -+ { -+ u32 AMPDULen = *(u8*)pval; -+ -+ if (IS_HARDWARE_TYPE_8812(padapter)) -+ { -+ if (AMPDULen < VHT_AGG_SIZE_128K) -+ AMPDULen = (0x2000 << *(u8*)pval) - 1; -+ else -+ AMPDULen = 0x1ffff; -+ } -+ else if(IS_HARDWARE_TYPE_8821(padapter)) -+ { -+ if (AMPDULen < HT_AGG_SIZE_64K) -+ AMPDULen = (0x2000 << *(u8*)pval) - 1; -+ else -+ AMPDULen = 0xffff; -+ } -+ AMPDULen |= BIT(31); -+ rtw_write32(padapter, REG_AMPDU_MAX_LENGTH_8812, AMPDULen); -+ } -+ break; -+#if 0 -+ case HW_VAR_RXDMA_AGG_PG_TH: -+ rtw_write8(padapter, REG_RXDMA_AGG_PG_TH, *pval); -+ break; -+#endif -+ case HW_VAR_H2C_FW_PWRMODE: -+ { -+ u8 psmode = *pval; -+ -+ // Forece leave RF low power mode for 1T1R to prevent conficting setting in Fw power -+ // saving sequence. 2010.06.07. Added by tynli. Suggested by SD3 yschang. -+ if ((psmode != PS_MODE_ACTIVE) && (!IS_92C_SERIAL(pHalData->VersionID))) -+ { -+ ODM_RF_Saving(podmpriv, true); -+ } -+ rtl8812_set_FwPwrMode_cmd(padapter, psmode); -+ } -+ break; -+ -+ case HW_VAR_H2C_FW_JOINBSSRPT: -+ rtl8812_set_FwJoinBssReport_cmd(padapter, *pval); -+ break; -+ -+#ifdef CONFIG_P2P_PS -+ case HW_VAR_H2C_FW_P2P_PS_OFFLOAD: -+ rtl8812_set_p2p_ps_offload_cmd(padapter, *pval); -+ break; -+#endif // CONFIG_P2P_PS -+ -+#ifdef CONFIG_TDLS -+ case HW_VAR_TDLS_WRCR: -+ val32 = rtw_read32(padapter, REG_RCR); -+ val32 &= ~RCR_CBSSID_DATA; -+ rtw_write32(padapter, REG_RCR, val32); -+ break; -+ -+ case HW_VAR_TDLS_INIT_CH_SEN: -+ val32 = rtw_read32(padapter, REG_RCR); -+ val32 &= (~RCR_CBSSID_DATA) & (~RCR_CBSSID_BCN); -+ rtw_write32(padapter, REG_RCR, val32); -+ rtw_write16(padapter, REG_RXFLTMAP2, 0xffff); -+ -+ // disable update TSF -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 |= BIT(4); -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ break; -+ -+ case HW_VAR_TDLS_DONE_CH_SEN: -+ // enable update TSF -+ val8 = rtw_read8(padapter, REG_BCN_CTRL); -+ val8 &= ~BIT(4); -+ rtw_write8(padapter, REG_BCN_CTRL, val8); -+ -+ val32 = rtw_read32(padapter, REG_RCR); -+ val32 |= RCR_CBSSID_BCN; -+ rtw_write32(padapter, REG_RCR, val32); -+ break; -+ -+ case HW_VAR_TDLS_RS_RCR: -+ val32 = rtw_read32(padapter, REG_RCR); -+ val32 |= RCR_CBSSID_DATA; -+ rtw_write32(padapter, REG_RCR, val32); -+ break; -+#endif // CONFIG_TDLS -+ -+ case HW_VAR_INITIAL_GAIN: -+ { -+ pDIG_T pDigTable = &podmpriv->DM_DigTable; -+ u32 rx_gain = *(u32*)pval; -+ -+ if (rx_gain == 0xff) {//restore rx gain -+ ODM_Write_DIG(podmpriv, pDigTable->BackupIGValue); -+ } else { -+ pDigTable->BackupIGValue = pDigTable->CurIGValue; -+ ODM_Write_DIG(podmpriv, rx_gain); -+ } -+ } -+ break; -+ -+#ifdef CONFIG_BT_COEXIST -+ case HW_VAR_BT_SET_COEXIST: -+ rtl8812_set_dm_bt_coexist(padapter, *pval); -+ break; -+ -+ case HW_VAR_BT_ISSUE_DELBA: -+ rtl8812_issue_delete_ba(padapter, *pval); -+ break; -+#endif -+ -+#if (RATE_ADAPTIVE_SUPPORT==1) -+ case HW_VAR_RPT_TIMER_SETTING: -+ { -+ val16 = *(u16*)pval; -+ ODM_RA_Set_TxRPT_Time(podmpriv, val16); -+ } -+ break; -+#endif -+ -+#ifdef CONFIG_SW_ANTENNA_DIVERSITY -+ case HW_VAR_ANTENNA_DIVERSITY_LINK: -+ //SwAntDivRestAfterLink8192C(padapter); -+ ODM_SwAntDivRestAfterLink(podmpriv); -+ break; -+ -+ case HW_VAR_ANTENNA_DIVERSITY_SELECT: -+ { -+ u8 Optimum_antenna = *pval; -+ u8 Ant; -+ -+ //switch antenna to Optimum_antenna -+ //DBG_8192C("==> HW_VAR_ANTENNA_DIVERSITY_SELECT , Ant_(%s)\n",(Optimum_antenna==2)?"A":"B"); -+ if (pHalData->CurAntenna != Optimum_antenna) -+ { -+ Ant = (Optimum_antenna==2) ? MAIN_ANT : AUX_ANT; -+ ODM_UpdateRxIdleAnt_88E(podmpriv, Ant); -+ -+ pHalData->CurAntenna = Optimum_antenna; -+ //DBG_8192C("==> HW_VAR_ANTENNA_DIVERSITY_SELECT , Ant_(%s)\n",(Optimum_antenna==2)?"A":"B"); -+ } -+ } -+ break; -+#endif -+ -+ case HW_VAR_EFUSE_USAGE: -+ pHalData->EfuseUsedPercentage = *pval; -+ break; -+ -+ case HW_VAR_EFUSE_BYTES: -+ pHalData->EfuseUsedBytes = *(u16*)pval; -+ break; -+#if 0 -+ case HW_VAR_EFUSE_BT_USAGE: -+#ifdef HAL_EFUSE_MEMORY -+ pHalData->EfuseHal.BTEfuseUsedPercentage = *pval; -+#endif -+ break; -+ -+ case HW_VAR_EFUSE_BT_BYTES: -+#ifdef HAL_EFUSE_MEMORY -+ pHalData->EfuseHal.BTEfuseUsedBytes = *(u16*)pval; -+#else -+ BTEfuseUsedBytes = *(u16*)pval; -+#endif -+ break; -+#endif -+ case HW_VAR_FIFO_CLEARN_UP: -+ { -+ struct pwrctrl_priv *pwrpriv; -+ u8 trycnt = 100; -+ -+ pwrpriv = &padapter->pwrctrlpriv; -+ -+ // pause tx -+ rtw_write8(padapter, REG_TXPAUSE, 0xff); -+ -+ // keep sn -+ padapter->xmitpriv.nqos_ssn = rtw_read16(padapter, REG_NQOS_SEQ); -+ -+ if (pwrpriv->bkeepfwalive != true) -+ { -+ // RX DMA stop -+ val32 = rtw_read32(padapter, REG_RXPKT_NUM); -+ val32 |= RW_RELEASE_EN; -+ rtw_write32(padapter, REG_RXPKT_NUM, val32); -+ do { -+ val32 = rtw_read32(padapter, REG_RXPKT_NUM); -+ val32 &= RXDMA_IDLE; -+ if (!val32) -+ break; -+ } while (trycnt--); -+ if (trycnt == 0) -+ { -+ DBG_8192C("[HW_VAR_FIFO_CLEARN_UP] Stop RX DMA failed......\n"); -+ } -+ -+ //RQPN Load 0 -+ rtw_write16(padapter, REG_RQPN_NPQ, 0x0); -+ rtw_write32(padapter, REG_RQPN, 0x80000000); -+ rtw_mdelay_os(10); -+ } -+ } -+ break; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ case HW_VAR_CHECK_TXBUF: -+ { -+ u32 i; -+ u8 RetryLimit; -+ u32 reg_200, reg_204; -+ -+ RetryLimit = 0x01; -+ -+ val16 = RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT; -+ rtw_write16(padapter, REG_RL, val16); -+ -+ for (i=0; i<1000; i++) -+ { -+ reg_200 = rtw_read32(padapter, 0x200); -+ reg_204 = rtw_read32(padapter, 0x204); -+ if (reg_200 != reg_204) -+ { -+// DBG_8192C("%s: (HW_VAR_CHECK_TXBUF)Tx buffer NOT empty - 0x204=0x%x, 0x200=0x%x (%d)\n", __FUNCTION__, reg_204, reg_200, i); -+ rtw_msleep_os(10); -+ } -+ else -+ { -+ DBG_8192C("%s: (HW_VAR_CHECK_TXBUF)Tx buffer Empty(%d)\n", __FUNCTION__, i); -+ break; -+ } -+ } -+ if (i == 1000) -+ { -+ DBG_8192C("%s: (HW_VAR_CHECK_TXBUF)TXBUF is still not Empty after %d times check!\n", __FUNCTION__, i); -+ DBG_8192C("%s: (HW_VAR_CHECK_TXBUF)0x204=0x%08x, 0x200=0x%08x\n", __FUNCTION__, reg_204, reg_200); -+ } -+ -+ RetryLimit = 0x30; -+ val16 = RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT; -+ rtw_write16(padapter, REG_RL, val16); -+ } -+ break; -+#endif -+ -+#if (RATE_ADAPTIVE_SUPPORT == 1) -+ case HW_VAR_TX_RPT_MAX_MACID: -+ { -+ u8 maxMacid = *pval; -+ DBG_8192C("### MacID(%d),Set Max Tx RPT MID(%d)\n", maxMacid, maxMacid+1); -+ rtw_write8(padapter, REG_TX_RPT_CTRL+1, maxMacid+1); -+ } -+ break; -+#endif -+ -+ case HW_VAR_H2C_MEDIA_STATUS_RPT: -+ { -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ RT_MEDIA_STATUS mstatus = *(u16*)pval & 0xFF; -+ -+ rtl8812_set_FwMediaStatus_cmd(padapter, *(u16*)pval); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) -+ Hal_PatchwithJaguar_8812(padapter, mstatus); -+ } -+ break; -+ -+ case HW_VAR_APFM_ON_MAC: -+ pHalData->bMacPwrCtrlOn = *pval; -+ DBG_8192C("%s: bMacPwrCtrlOn=%d\n", __FUNCTION__, pHalData->bMacPwrCtrlOn); -+ break; -+ -+ case HW_VAR_NAV_UPPER: -+ { -+ u32 usNavUpper = *((u32*)pval); -+ -+ if (usNavUpper > HAL_NAV_UPPER_UNIT * 0xFF) -+ { -+ DBG_8192C("%s: [HW_VAR_NAV_UPPER] set value(0x%08X us) is larger than (%d * 0xFF)!\n", -+ __FUNCTION__, usNavUpper, HAL_NAV_UPPER_UNIT); -+ break; -+ } -+ -+ // The value of ((usNavUpper + HAL_NAV_UPPER_UNIT - 1) / HAL_NAV_UPPER_UNIT) -+ // is getting the upper integer. -+ usNavUpper = (usNavUpper + HAL_NAV_UPPER_UNIT - 1) / HAL_NAV_UPPER_UNIT; -+ rtw_write8(padapter, REG_NAV_UPPER, (u8)usNavUpper); -+ } -+ break; -+ -+ case HW_VAR_BCN_VALID: -+#ifdef CONFIG_CONCURRENT_MODE -+ if (IS_HARDWARE_TYPE_8821(padapter) && padapter->iface_type == IFACE_PORT1) -+ { -+ val8 = rtw_read8(padapter, REG_TDECTRL1_8812+2); -+ val8 |= BIT(0); -+ rtw_write8(padapter, REG_TDECTRL1_8812+2, val8); -+ } -+ else -+#endif -+ { -+ // BCN_VALID, BIT16 of REG_TDECTRL = BIT0 of REG_TDECTRL+2, write 1 to clear, Clear by sw -+ val8 = rtw_read8(padapter, REG_TDECTRL+2); -+ val8 |= BIT(0); -+ rtw_write8(padapter, REG_TDECTRL+2, val8); -+ } -+ break; -+ -+ case HW_VAR_DL_BCN_SEL: -+#ifdef CONFIG_CONCURRENT_MODE -+ if (IS_HARDWARE_TYPE_8821(padapter) && padapter->iface_type == IFACE_PORT1) -+ { -+ // SW_BCN_SEL - Port1 -+ val8 = rtw_read8(padapter, REG_TDECTRL1_8812+2); -+ val8 |= BIT(4); -+ rtw_write8(padapter, REG_TDECTRL1_8812+2, val8); -+ } -+ else -+#endif -+ { -+ // SW_BCN_SEL - Port0 -+ val8 = rtw_read8(padapter, REG_TDECTRL1_8812+2); -+ val8 &= ~BIT(4); -+ rtw_write8(padapter, REG_TDECTRL1_8812+2, val8); -+ } -+ break; -+ -+ case HW_VAR_WIRELESS_MODE: -+ { -+ u8 R2T_SIFS = 0, SIFS_Timer = 0; -+ u8 wireless_mode = *pval; -+ -+ if ((wireless_mode == WIRELESS_11BG) || (wireless_mode == WIRELESS_11G)) -+ SIFS_Timer = 0xa; -+ else -+ SIFS_Timer = 0xe; -+ -+ // SIFS for OFDM Data ACK -+ rtw_write8(padapter, REG_SIFS_CTX+1, SIFS_Timer); -+ // SIFS for OFDM consecutive tx like CTS data! -+ rtw_write8(padapter, REG_SIFS_TRX+1, SIFS_Timer); -+ -+ rtw_write8(padapter,REG_SPEC_SIFS+1, SIFS_Timer); -+ rtw_write8(padapter,REG_MAC_SPEC_SIFS+1, SIFS_Timer); -+ -+ // 20100719 Joseph: Revise SIFS setting due to Hardware register definition change. -+ rtw_write8(padapter, REG_RESP_SIFS_OFDM+1, SIFS_Timer); -+ rtw_write8(padapter, REG_RESP_SIFS_OFDM, SIFS_Timer); -+ -+ // -+ // Adjust R2T SIFS for IOT issue. Add by hpfan 2013.01.25 -+ // Set R2T SIFS to 0x0a for Atheros IOT. Add by hpfan 2013.02.22 -+ // -+ // Mac has 10 us delay so use 0xa value is enough. -+ R2T_SIFS = 0xa; -+ -+ rtw_write8(padapter, REG_RESP_SIFS_OFDM+1, R2T_SIFS); -+ } -+ break; -+ -+ default: -+ DBG_8192C("%s: [WARNNING] variable(%d) not defined!\n", __FUNCTION__, variable); -+ break; -+ } -+ -+ -+} -+ -+void GetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval) -+{ -+ PHAL_DATA_TYPE pHalData; -+ PDM_ODM_T podmpriv; -+ u8 val8; -+ u16 val16; -+ u32 val32; -+ -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ podmpriv = &pHalData->odmpriv; -+ -+ switch (variable) -+ { -+ case HW_VAR_BASIC_RATE: -+ *(u16*)pval = pHalData->BasicRateSet; -+ break; -+ -+ case HW_VAR_TXPAUSE: -+ *pval = rtw_read8(padapter, REG_TXPAUSE); -+ break; -+ -+ case HW_VAR_BCN_VALID: -+#ifdef CONFIG_CONCURRENT_MODE -+ if (IS_HARDWARE_TYPE_8821(padapter) && padapter->iface_type == IFACE_PORT1) -+ { -+ val8 = rtw_read8(padapter, REG_TDECTRL1_8812+2); -+ *pval = (BIT(0) & val8) ? true:false; -+ } -+ else -+#endif -+ { -+ //BCN_VALID, BIT16 of REG_TDECTRL = BIT0 of REG_TDECTRL+2 -+ val8 = rtw_read8(padapter, REG_TDECTRL+2); -+ *pval = (BIT(0) & val8) ? true:false; -+ } -+ break; -+ -+ case HW_VAR_DM_FLAG: -+ *pval = podmpriv->SupportAbility; -+ break; -+ -+ case HW_VAR_RF_TYPE: -+ *pval = pHalData->rf_type; -+ break; -+ -+ case HW_VAR_FWLPS_RF_ON: -+ //When we halt NIC, we should check if FW LPS is leave. -+ if(padapter->pwrctrlpriv.rf_pwrstate == rf_off) -+ { -+ // If it is in HW/SW Radio OFF or IPS state, we do not check Fw LPS Leave, -+ // because Fw is unload. -+ *pval = true; -+ } -+ else -+ { -+ u32 valRCR; -+ valRCR = rtw_read32(padapter, REG_RCR); -+ valRCR &= 0x00070000; -+ if(valRCR) -+ *pval = false; -+ else -+ *pval = true; -+ } -+ -+ break; -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ case HW_VAR_CURRENT_ANTENNA: -+ *pval = pHalData->CurAntenna; -+ break; -+#endif -+ -+ case HW_VAR_EFUSE_BYTES: // To get EFUE total used bytes, added by Roger, 2008.12.22. -+ *(u16*)pval = pHalData->EfuseUsedBytes; -+ break; -+ -+ case HW_VAR_APFM_ON_MAC: -+ *pval = pHalData->bMacPwrCtrlOn; -+ break; -+ -+ case HW_VAR_CHK_HI_QUEUE_EMPTY: -+ val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); -+ *pval = (val16 & BIT(10)) ? true:false; -+ break; -+ -+ default: -+ DBG_8192C("%s: [WARNNING] variable(%d) not defined!\n", __FUNCTION__, variable); -+ break; -+ } -+ -+ -+} -+ -+/* -+ * Description: -+ * Change default setting of specified variable. -+ */ -+u8 SetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 bResult; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ bResult = _SUCCESS; -+ -+ switch (variable) -+ { -+ case HAL_DEF_DBG_DM_FUNC: -+ { -+ u8 dm_func; -+ struct dm_priv *pdmpriv; -+ DM_ODM_T *podmpriv; -+ -+ -+ dm_func = *((u8*)pval); -+ pdmpriv = &pHalData->dmpriv; -+ podmpriv = &pHalData->odmpriv; -+ -+ if (dm_func == 0) -+ { -+ //disable all dynamic func -+ podmpriv->SupportAbility = DYNAMIC_FUNC_DISABLE; -+ DBG_8192C("==> Disable all dynamic function...\n"); -+ } -+ else if (dm_func == 1) -+ { -+ // disable DIG -+ podmpriv->SupportAbility &= (~DYNAMIC_BB_DIG); -+ DBG_8192C("==> Disable DIG...\n"); -+ } -+ else if (dm_func == 2) -+ { -+ // disable High power -+ podmpriv->SupportAbility &= (~DYNAMIC_BB_DYNAMIC_TXPWR); -+ } -+ else if (dm_func == 3) -+ { -+ // disable tx power tracking -+ podmpriv->SupportAbility &= (~DYNAMIC_RF_CALIBRATION); -+ DBG_8192C("==> Disable tx power tracking...\n"); -+ } -+// else if (dm_func == 4) -+// { -+ // disable BT coexistence -+// pdmpriv->DMFlag &= (~DYNAMIC_FUNC_BT); -+// } -+ else if (dm_func == 5) -+ { -+ // disable antenna diversity -+ podmpriv->SupportAbility &= (~DYNAMIC_BB_ANT_DIV); -+ } -+ else if (dm_func == 6) -+ { -+ // turn on all dynamic func -+ if (!(podmpriv->SupportAbility & DYNAMIC_BB_DIG)) -+ { -+ pDIG_T pDigTable = &podmpriv->DM_DigTable; -+ pDigTable->CurIGValue = rtw_read8(padapter, 0xc50); -+ } -+// pdmpriv->DMFlag |= DYNAMIC_FUNC_BT; -+ podmpriv->SupportAbility = DYNAMIC_ALL_FUNC_ENABLE; -+ DBG_8192C("==> Turn on all dynamic function...\n"); -+ } -+ } -+ break; -+ -+ case HAL_DEF_DBG_DUMP_RXPKT: -+ pHalData->bDumpRxPkt = *(u8*)pval; -+ break; -+ -+ case HAL_DEF_DBG_DUMP_TXPKT: -+ pHalData->bDumpTxPkt = *(u8*)pval; -+ break; -+ -+ case HW_DEF_FA_CNT_DUMP: -+ { -+ u8 mac_id; -+ PDM_ODM_T pDM_Odm; -+ -+ -+ mac_id = *(u8*)pval; -+ pDM_Odm = &pHalData->odmpriv; -+ -+ if (padapter->bLinkInfoDump & BIT(1)) -+ pDM_Odm->DebugComponents |= ODM_COMP_DIG; -+ else -+ pDM_Odm->DebugComponents &= ~ODM_COMP_DIG; -+ -+ if (padapter->bLinkInfoDump & BIT(2)) -+ pDM_Odm->DebugComponents |= ODM_COMP_FA_CNT; -+ else -+ pDM_Odm->DebugComponents &= ~ODM_COMP_FA_CNT; -+ } -+ break; -+ -+ case HW_DEF_ODM_DBG_FLAG: -+ { -+ u64 DebugComponents; -+ PDM_ODM_T pDM_Odm; -+ -+ -+ DebugComponents = *((u64*)pval); -+ pDM_Odm = &pHalData->odmpriv; -+ pDM_Odm->DebugComponents = DebugComponents; -+ } -+ break; -+ -+ default: -+ DBG_8192C("%s: [ERROR] HAL_DEF_VARIABLE(%d) not defined!\n", __FUNCTION__, variable); -+ bResult = _FAIL; -+ break; -+ } -+ -+ return bResult; -+} -+ -+/* -+ * Description: -+ * Query setting of specified variable. -+ */ -+u8 GetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval) -+{ -+ PHAL_DATA_TYPE pHalData; -+ u8 bResult; -+ -+ -+ pHalData = GET_HAL_DATA(padapter); -+ bResult = _SUCCESS; -+ -+ switch (variable) -+ { -+ case HAL_DEF_UNDERCORATEDSMOOTHEDPWDB: -+ { -+ struct mlme_priv *pmlmepriv; -+ struct sta_priv *pstapriv; -+ struct sta_info *psta; -+ -+ pmlmepriv = &padapter->mlmepriv; -+ pstapriv = &padapter->stapriv; -+ psta = rtw_get_stainfo(pstapriv, pmlmepriv->cur_network.network.MacAddress); -+ if (psta) -+ { -+ *((int*)pval) = psta->rssi_stat.UndecoratedSmoothedPWDB; -+ } -+ } -+ break; -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ case HAL_DEF_IS_SUPPORT_ANT_DIV: -+ *((u8*)pval) = (pHalData->AntDivCfg==0) ? false : true; -+ break; -+#endif -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ case HAL_DEF_CURRENT_ANTENNA: -+ *((u8*)pval) = pHalData->CurAntenna; -+ break; -+#endif -+ -+ case HAL_DEF_DRVINFO_SZ: -+ *((u32*)pval) = DRVINFO_SZ; -+ break; -+ -+ case HAL_DEF_MAX_RECVBUF_SZ: -+ *((u32*)pval) = MAX_RECVBUF_SZ; -+ break; -+ -+ case HAL_DEF_RX_PACKET_OFFSET: -+ *((u32*)pval) = RXDESC_SIZE + DRVINFO_SZ; -+ break; -+ -+ case HAL_DEF_DBG_DM_FUNC: -+ *((u32*)pval) = pHalData->odmpriv.SupportAbility; -+ break; -+ -+#if (RATE_ADAPTIVE_SUPPORT == 1) -+ case HAL_DEF_RA_DECISION_RATE: -+ { -+ u8 MacID = *(u8*)pval; -+ *((u8*)pval) = ODM_RA_GetDecisionRate_8812A(&pHalData->odmpriv, MacID); -+ } -+ break; -+ -+ case HAL_DEF_RA_SGI: -+ { -+ u8 MacID = *(u8*)pval; -+ *((u8*)pval) = ODM_RA_GetShortGI_8812A(&pHalData->odmpriv, MacID); -+ } -+ break; -+#endif // (RATE_ADAPTIVE_SUPPORT == 1) -+ -+#if (POWER_TRAINING_ACTIVE == 1) -+ case HAL_DEF_PT_PWR_STATUS: -+ { -+ u8 MacID = *(u8*)pval; -+ *(u8*)pval = ODM_RA_GetHwPwrStatus_8812A(&pHalData->odmpriv, MacID); -+ } -+ break; -+#endif //(POWER_TRAINING_ACTIVE == 1) -+ -+ case HW_VAR_MAX_RX_AMPDU_FACTOR: -+ *((u32*)pval) = MAX_AMPDU_FACTOR_64K; -+ break; -+ -+ case HAL_DEF_LDPC: -+ if (IS_VENDOR_8812A_C_CUT(padapter)) -+ *(u8*)pval = true; -+ else if (IS_HARDWARE_TYPE_8821(padapter)) -+ *(u8*)pval = false; -+ else -+ *(u8*)pval = false; -+#if (MP_DRIVER == 1) -+ if (padapter->registrypriv.mp_mode == 1) -+ *(u8*)pval = true; -+#endif -+ break; -+ -+ case HAL_DEF_TX_STBC: -+ if (pHalData->rf_type == RF_2T2R) -+ *(u8*)pval = 1; -+ else -+ *(u8*)pval = 0; -+ break; -+ -+ case HAL_DEF_RX_STBC: -+ *(u8*)pval = 1; -+ break; -+ -+ case HW_DEF_RA_INFO_DUMP: -+ { -+ u8 mac_id = *(u8*)pval; -+ u32 cmd = 0x40000400 | mac_id; -+ u32 ra_info1, ra_info2; -+ u32 rate_mask1, rate_mask2; -+ -+ if ((padapter->bLinkInfoDump & BIT(0)) -+ && (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == true)) -+ { -+ DBG_8192C("============ RA status check Mac_id:%d ===================\n", mac_id); -+ -+ rtw_write32(padapter, REG_HMEBOX_E2_E3_8812,cmd); -+ ra_info1 = rtw_read32(padapter, REG_RSVD5_8812); -+ ra_info2 = rtw_read32(padapter, REG_RSVD6_8812); -+ rate_mask1 = rtw_read32(padapter,REG_RSVD7_8812); -+ rate_mask2 = rtw_read32(padapter,REG_RSVD8_8812); -+ -+ DBG_8192C("[ ra_info1:0x%08x ] =>RSSI=%d, BW_setting=0x%02x, DISRA=0x%02x, VHT_EN=0x%02x\n", -+ ra_info1, -+ ra_info1&0xFF, -+ (ra_info1>>8) & 0xFF, -+ (ra_info1>>16) & 0xFF, -+ (ra_info1>>24) & 0xFF); -+ -+ DBG_8192C("[ ra_info2:0x%08x ] =>hight_rate=0x%02x, lowest_rate=0x%02x, SGI=0x%02x, RateID=%d\n", -+ ra_info2, -+ ra_info2&0xFF, -+ (ra_info2>>8) & 0xFF, -+ (ra_info2>>16) & 0xFF, -+ (ra_info2>>24) & 0xFF); -+ -+ DBG_8192C("rate_mask2=0x%08x, rate_mask1=0x%08x\n", rate_mask2, rate_mask1); -+ } -+ } -+ break; -+ -+ case HAL_DEF_DBG_DUMP_RXPKT: -+ *(u8*)pval = pHalData->bDumpRxPkt; -+ break; -+ -+ case HAL_DEF_DBG_DUMP_TXPKT: -+ *(u8*)pval = pHalData->bDumpTxPkt; -+ break; -+ -+ case HW_DEF_ODM_DBG_FLAG: -+ { -+ u64 DebugComponents; -+ PDM_ODM_T pDM_Odm; -+ -+ pDM_Odm = &pHalData->odmpriv; -+ DebugComponents = pDM_Odm->DebugComponents; -+ DBG_8192C("%s: pDM_Odm->DebugComponents=0x%llx\n", __FUNCTION__, DebugComponents); -+ *((u64*)pval) = DebugComponents; -+ } -+ break; -+ -+ case HAL_DEF_TX_PAGE_BOUNDARY: -+ if (!padapter->registrypriv.wifi_spec) -+ { -+ if (IS_HARDWARE_TYPE_8812(padapter)) -+ *(u8*)pval = TX_PAGE_BOUNDARY_8812; -+ else -+ *(u8*)pval = TX_PAGE_BOUNDARY_8821; -+ } -+ else -+ { -+ if (IS_HARDWARE_TYPE_8812(padapter)) -+ *(u8*)pval = WMM_NORMAL_TX_PAGE_BOUNDARY_8812; -+ else -+ *(u8*)pval = WMM_NORMAL_TX_PAGE_BOUNDARY_8821; -+ } -+ break; -+ -+ case HAL_DEF_TX_PAGE_BOUNDARY_WOWLAN: -+ *(u8*)pval = TX_PAGE_BOUNDARY_WOWLAN_8812; -+ break; -+ -+ default: -+ DBG_8192C("%s: [ERROR] HAL_DEF_VARIABLE(%d) not defined!\n", __FUNCTION__, variable); -+ bResult = _FAIL; -+ break; -+ } -+ -+ return bResult; -+} -+ -+void rtl8812_set_hal_ops(struct hal_ops *pHalFunc) -+{ -+ pHalFunc->free_hal_data = &rtl8812_free_hal_data; -+ -+ pHalFunc->dm_init = &rtl8812_init_dm_priv; -+ pHalFunc->dm_deinit = &rtl8812_deinit_dm_priv; -+ -+ pHalFunc->UpdateRAMaskHandler = &UpdateHalRAMask8812A; -+ -+ pHalFunc->read_chip_version = &ReadChipVersion8812A; -+ -+ pHalFunc->set_bwmode_handler = &PHY_SetBWMode8812; -+ pHalFunc->set_channel_handler = &PHY_SwChnl8812; -+ pHalFunc->set_chnl_bw_handler = &PHY_SetSwChnlBWMode8812; -+ -+ pHalFunc->hal_dm_watchdog = &rtl8812_HalDmWatchDog; -+ -+ pHalFunc->Add_RateATid = &rtl8812_Add_RateATid; -+#ifdef CONFIG_CONCURRENT_MODE -+ pHalFunc->clone_haldata = &rtl8812_clone_haldata; -+#endif -+ pHalFunc->run_thread= &rtl8812_start_thread; -+ pHalFunc->cancel_thread= &rtl8812_stop_thread; -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ pHalFunc->AntDivBeforeLinkHandler = &AntDivBeforeLink8812; -+ pHalFunc->AntDivCompareHandler = &AntDivCompare8812; -+#endif -+ -+ pHalFunc->read_bbreg = &PHY_QueryBBReg8812; -+ pHalFunc->write_bbreg = &PHY_SetBBReg8812; -+ pHalFunc->read_rfreg = &PHY_QueryRFReg8812; -+ pHalFunc->write_rfreg = &PHY_SetRFReg8812; -+ -+ -+ // Efuse related function -+ pHalFunc->EfusePowerSwitch = &rtl8812_EfusePowerSwitch; -+ pHalFunc->ReadEFuse = &rtl8812_ReadEFuse; -+ pHalFunc->EFUSEGetEfuseDefinition = &rtl8812_EFUSE_GetEfuseDefinition; -+ pHalFunc->EfuseGetCurrentSize = &rtl8812_EfuseGetCurrentSize; -+ pHalFunc->Efuse_PgPacketRead = &rtl8812_Efuse_PgPacketRead; -+ pHalFunc->Efuse_PgPacketWrite = &rtl8812_Efuse_PgPacketWrite; -+ pHalFunc->Efuse_WordEnableDataWrite = &rtl8812_Efuse_WordEnableDataWrite; -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ pHalFunc->sreset_init_value = &sreset_init_value; -+ pHalFunc->sreset_reset_value = &sreset_reset_value; -+ pHalFunc->silentreset = &sreset_reset; -+ pHalFunc->sreset_xmit_status_check = &rtl8812_sreset_xmit_status_check; -+ pHalFunc->sreset_linked_status_check = &rtl8812_sreset_linked_status_check; -+ pHalFunc->sreset_get_wifi_status = &sreset_get_wifi_status; -+ pHalFunc->sreset_inprogress= &sreset_inprogress; -+#endif //DBG_CONFIG_ERROR_DETECT -+ -+ pHalFunc->GetHalODMVarHandler = &rtl8812_GetHalODMVar; -+ pHalFunc->SetHalODMVarHandler = &rtl8812_SetHalODMVar; -+ pHalFunc->hal_notch_filter = &hal_notch_filter_8812; -+ -+ pHalFunc->SetBeaconRelatedRegistersHandler = &SetBeaconRelatedRegisters8812A; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_mp.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_mp.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_mp.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_mp.c 2018-02-06 17:42:30.714967223 +0200 -@@ -0,0 +1,1098 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8812A_MP_C_ -+#ifdef CONFIG_MP_INCLUDED -+ -+//#include -+#include -+ -+ -+s32 Hal_SetPowerTracking(PADAPTER padapter, u8 enable) -+{ -+ bool bResult = true; -+ PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ pHalData->TxPowerTrackControl = (u1Byte)enable; -+ if(pHalData->TxPowerTrackControl > 1) -+ pHalData->TxPowerTrackControl = 0; -+ return bResult; -+ -+ -+ return _SUCCESS; -+} -+ -+void Hal_GetPowerTracking(PADAPTER padapter, u8 *enable) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ -+ *enable = pDM_Odm->RFCalibrateInfo.TxPowerTrackControl; -+} -+ -+static void Hal_disable_dm(PADAPTER padapter) -+{ -+ u8 v8; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ -+ //3 1. disable firmware dynamic mechanism -+ // disable Power Training, Rate Adaptive -+ v8 = rtw_read8(padapter, REG_BCN_CTRL); -+ v8 &= ~EN_BCN_FUNCTION; -+ rtw_write8(padapter, REG_BCN_CTRL, v8); -+ -+ //3 2. disable driver dynamic mechanism -+ // disable Dynamic Initial Gain -+ // disable High Power -+ // disable Power Tracking -+ Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, false); -+ -+ // enable APK, LCK and IQK but disable power tracking -+ pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = false; -+ Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, true); -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: mpt_SwitchRfSetting -+ * -+ * Overview: Change RF Setting when we siwthc channel/rate/BW for MP. -+ * -+ * Input: IN PADAPTER pAdapter -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 01/08/2009 MHC Suggestion from SD3 Willis for 92S series. -+ * 01/09/2009 MHC Add CCK modification for 40MHZ. Suggestion from SD3. -+ * -+ *---------------------------------------------------------------------------*/ -+void Hal_mpt_SwitchRfSetting(PADAPTER pAdapter) -+{ -+ //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct mp_priv *pmp = &pAdapter->mppriv; -+ u1Byte ChannelToSw = pmp->channel; -+ u32 ulRateIdx = pmp->rateidx; -+ u32 ulbandwidth = pmp->bandwidth; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ // <20120525, Kordan> Dynamic mechanism for APK, asked by Dennis. -+ pmp->MptCtx.backup0x52_RF_A = (u1Byte)PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0); -+ pmp->MptCtx.backup0x52_RF_B = (u1Byte)PHY_QueryRFReg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0); -+ PHY_SetRFReg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0, 0xD); -+ PHY_SetRFReg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0, 0xD); -+ -+ return ; -+} -+/*---------------------------hal\rtl8192c\MPT_Phy.c---------------------------*/ -+ -+/*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ -+void Hal_MPT_CCKTxPowerAdjust(PADAPTER Adapter, bool bInCH14) -+{ -+ u32 TempVal = 0, TempVal2 = 0, TempVal3 = 0; -+ u32 CurrCCKSwingVal = 0, CCKSwingIndex = 12; -+ u8 i; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ -+ // get current cck swing value and check 0xa22 & 0xa23 later to match the table. -+ CurrCCKSwingVal = read_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord); -+ -+ if (!bInCH14) -+ { -+ // Readback the current bb cck swing value and compare with the table to -+ // get the current swing index -+ for (i = 0; i < CCK_TABLE_SIZE; i++) -+ { -+ if (((CurrCCKSwingVal&0xff) == (u32)CCKSwingTable_Ch1_Ch13[i][0]) && -+ (((CurrCCKSwingVal&0xff00)>>8) == (u32)CCKSwingTable_Ch1_Ch13[i][1])) -+ { -+ CCKSwingIndex = i; -+// RT_TRACE(COMP_INIT, DBG_LOUD,("Ch1~13, Current reg0x%x = 0x%lx, CCKSwingIndex=0x%x\n", -+// (rCCK0_TxFilter1+2), CurrCCKSwingVal, CCKSwingIndex)); -+ break; -+ } -+ } -+ -+ //Write 0xa22 0xa23 -+ TempVal = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][0] + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][1]<<8) ; -+ -+ -+ //Write 0xa24 ~ 0xa27 -+ TempVal2 = 0; -+ TempVal2 = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][2] + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][3]<<8) + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][4]<<16 )+ -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][5]<<24); -+ -+ //Write 0xa28 0xa29 -+ TempVal3 = 0; -+ TempVal3 = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][6] + -+ (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][7]<<8) ; -+ } -+ else -+ { -+ for (i = 0; i < CCK_TABLE_SIZE; i++) -+ { -+ if (((CurrCCKSwingVal&0xff) == (u32)CCKSwingTable_Ch14[i][0]) && -+ (((CurrCCKSwingVal&0xff00)>>8) == (u32)CCKSwingTable_Ch14[i][1])) -+ { -+ CCKSwingIndex = i; -+// RT_TRACE(COMP_INIT, DBG_LOUD,("Ch14, Current reg0x%x = 0x%lx, CCKSwingIndex=0x%x\n", -+// (rCCK0_TxFilter1+2), CurrCCKSwingVal, CCKSwingIndex)); -+ break; -+ } -+ } -+ -+ //Write 0xa22 0xa23 -+ TempVal = CCKSwingTable_Ch14[CCKSwingIndex][0] + -+ (CCKSwingTable_Ch14[CCKSwingIndex][1]<<8) ; -+ -+ //Write 0xa24 ~ 0xa27 -+ TempVal2 = 0; -+ TempVal2 = CCKSwingTable_Ch14[CCKSwingIndex][2] + -+ (CCKSwingTable_Ch14[CCKSwingIndex][3]<<8) + -+ (CCKSwingTable_Ch14[CCKSwingIndex][4]<<16 )+ -+ (CCKSwingTable_Ch14[CCKSwingIndex][5]<<24); -+ -+ //Write 0xa28 0xa29 -+ TempVal3 = 0; -+ TempVal3 = CCKSwingTable_Ch14[CCKSwingIndex][6] + -+ (CCKSwingTable_Ch14[CCKSwingIndex][7]<<8) ; -+ } -+ -+ write_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord, TempVal); -+ write_bbreg(Adapter, rCCK0_TxFilter2, bMaskDWord, TempVal2); -+ write_bbreg(Adapter, rCCK0_DebugPort, bMaskLWord, TempVal3); -+} -+ -+void Hal_MPT_CCKTxPowerAdjustbyIndex(PADAPTER pAdapter, bool beven) -+{ -+ s32 TempCCk; -+ u8 CCK_index, CCK_index_old; -+ u8 Action = 0; //0: no action, 1: even->odd, 2:odd->even -+ u8 TimeOut = 100; -+ s32 i = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; -+ -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ -+ if (!IS_92C_SERIAL(pHalData->VersionID)) -+ return; -+#if 0 -+ while(PlatformAtomicExchange(&Adapter->IntrCCKRefCount, true) == true) -+ { -+ PlatformSleepUs(100); -+ TimeOut--; -+ if(TimeOut <= 0) -+ { -+ RTPRINT(FINIT, INIT_TxPower, -+ ("!!!MPT_CCKTxPowerAdjustbyIndex Wait for check CCK gain index too long!!!\n" )); -+ break; -+ } -+ } -+#endif -+ if (beven && !pMptCtx->bMptIndexEven) //odd->even -+ { -+ Action = 2; -+ pMptCtx->bMptIndexEven = true; -+ } -+ else if (!beven && pMptCtx->bMptIndexEven) //even->odd -+ { -+ Action = 1; -+ pMptCtx->bMptIndexEven = false; -+ } -+ -+ if (Action != 0) -+ { -+ //Query CCK default setting From 0xa24 -+ TempCCk = read_bbreg(pAdapter, rCCK0_TxFilter2, bMaskDWord) & bMaskCCK; -+ for (i = 0; i < CCK_TABLE_SIZE; i++) -+ { -+ if (pDM_Odm->RFCalibrateInfo.bCCKinCH14) -+ { -+ if (_rtw_memcmp((void*)&TempCCk, (void*)&CCKSwingTable_Ch14[i][2], 4) == true) -+ { -+ CCK_index_old = (u8) i; -+// RTPRINT(FINIT, INIT_TxPower,("MPT_CCKTxPowerAdjustbyIndex: Initial reg0x%x = 0x%lx, CCK_index=0x%x, ch 14 %d\n", -+// rCCK0_TxFilter2, TempCCk, CCK_index_old, pHalData->bCCKinCH14)); -+ break; -+ } -+ } -+ else -+ { -+ if (_rtw_memcmp((void*)&TempCCk, (void*)&CCKSwingTable_Ch1_Ch13[i][2], 4) == true) -+ { -+ CCK_index_old = (u8) i; -+// RTPRINT(FINIT, INIT_TxPower,("MPT_CCKTxPowerAdjustbyIndex: Initial reg0x%x = 0x%lx, CCK_index=0x%x, ch14 %d\n", -+// rCCK0_TxFilter2, TempCCk, CCK_index_old, pHalData->bCCKinCH14)); -+ break; -+ } -+ } -+ } -+ -+ if (Action == 1) -+ CCK_index = CCK_index_old - 1; -+ else -+ CCK_index = CCK_index_old + 1; -+ -+// RTPRINT(FINIT, INIT_TxPower,("MPT_CCKTxPowerAdjustbyIndex: new CCK_index=0x%x\n", -+// CCK_index)); -+ -+ //Adjust CCK according to gain index -+ if (!pDM_Odm->RFCalibrateInfo.bCCKinCH14) { -+ rtw_write8(pAdapter, 0xa22, CCKSwingTable_Ch1_Ch13[CCK_index][0]); -+ rtw_write8(pAdapter, 0xa23, CCKSwingTable_Ch1_Ch13[CCK_index][1]); -+ rtw_write8(pAdapter, 0xa24, CCKSwingTable_Ch1_Ch13[CCK_index][2]); -+ rtw_write8(pAdapter, 0xa25, CCKSwingTable_Ch1_Ch13[CCK_index][3]); -+ rtw_write8(pAdapter, 0xa26, CCKSwingTable_Ch1_Ch13[CCK_index][4]); -+ rtw_write8(pAdapter, 0xa27, CCKSwingTable_Ch1_Ch13[CCK_index][5]); -+ rtw_write8(pAdapter, 0xa28, CCKSwingTable_Ch1_Ch13[CCK_index][6]); -+ rtw_write8(pAdapter, 0xa29, CCKSwingTable_Ch1_Ch13[CCK_index][7]); -+ } else { -+ rtw_write8(pAdapter, 0xa22, CCKSwingTable_Ch14[CCK_index][0]); -+ rtw_write8(pAdapter, 0xa23, CCKSwingTable_Ch14[CCK_index][1]); -+ rtw_write8(pAdapter, 0xa24, CCKSwingTable_Ch14[CCK_index][2]); -+ rtw_write8(pAdapter, 0xa25, CCKSwingTable_Ch14[CCK_index][3]); -+ rtw_write8(pAdapter, 0xa26, CCKSwingTable_Ch14[CCK_index][4]); -+ rtw_write8(pAdapter, 0xa27, CCKSwingTable_Ch14[CCK_index][5]); -+ rtw_write8(pAdapter, 0xa28, CCKSwingTable_Ch14[CCK_index][6]); -+ rtw_write8(pAdapter, 0xa29, CCKSwingTable_Ch14[CCK_index][7]); -+ } -+ } -+#if 0 -+ RTPRINT(FINIT, INIT_TxPower, -+ ("MPT_CCKTxPowerAdjustbyIndex 0xa20=%x\n", PlatformEFIORead4Byte(Adapter, 0xa20))); -+ -+ PlatformAtomicExchange(&Adapter->IntrCCKRefCount, false); -+#endif -+} -+/*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ -+ -+/* -+ * SetChannel -+ * Description -+ * Use H2C command to change channel, -+ * not only modify rf register, but also other setting need to be done. -+ */ -+void Hal_SetChannel(PADAPTER pAdapter) -+{ -+#if 0 -+ struct mp_priv *pmp = &pAdapter->mppriv; -+ -+// SelectChannel(pAdapter, pmp->channel); -+ set_channel_bwmode(pAdapter, pmp->channel, pmp->channel_offset, pmp->bandwidth); -+#else -+ u8 eRFPath; -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ struct mp_priv *pmp = &pAdapter->mppriv; -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); -+ -+ u8 channel = pmp->channel; -+ u8 bandwidth = pmp->bandwidth; -+ u8 rate = pmp->rateidx; -+ -+ -+ // set RF channel register -+ for (eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) -+ { -+ if(IS_HARDWARE_TYPE_8192D(pAdapter)) -+ _write_rfreg(pAdapter, eRFPath, ODM_CHANNEL, 0xFF, channel); -+ else -+ _write_rfreg(pAdapter, eRFPath, ODM_CHANNEL, 0x3FF, channel); -+ } -+ //Hal_mpt_SwitchRfSetting(pAdapter); -+ -+ SelectChannel(pAdapter, channel); -+ -+ if (pHalData->CurrentChannel == 14 && !pDM_Odm->RFCalibrateInfo.bCCKinCH14) { -+ pDM_Odm->RFCalibrateInfo.bCCKinCH14 = true; -+ Hal_MPT_CCKTxPowerAdjust(pAdapter, pDM_Odm->RFCalibrateInfo.bCCKinCH14); -+ } -+ else if (pHalData->CurrentChannel != 14 && pDM_Odm->RFCalibrateInfo.bCCKinCH14) { -+ pDM_Odm->RFCalibrateInfo.bCCKinCH14 = false; -+ Hal_MPT_CCKTxPowerAdjust(pAdapter, pDM_Odm->RFCalibrateInfo.bCCKinCH14); -+ } -+ -+#endif -+} -+ -+/* -+ * Notice -+ * Switch bandwitdth may change center frequency(channel) -+ */ -+void Hal_SetBandwidth(PADAPTER pAdapter) -+{ -+ struct mp_priv *pmp = &pAdapter->mppriv; -+ -+ -+ SetBWMode(pAdapter, pmp->bandwidth, pmp->prime_channel_offset); -+ Hal_mpt_SwitchRfSetting(pAdapter); -+} -+ -+void Hal_SetCCKTxPower(PADAPTER pAdapter, u8 *TxPower) -+{ -+ u32 tmpval = 0; -+ -+ -+ // rf-A cck tx power -+ write_bbreg(pAdapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, TxPower[RF_PATH_A]); -+ tmpval = (TxPower[RF_PATH_A]<<16) | (TxPower[RF_PATH_A]<<8) | TxPower[RF_PATH_A]; -+ write_bbreg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, 0xffffff00, tmpval); -+ -+ // rf-B cck tx power -+ write_bbreg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte0, TxPower[RF_PATH_B]); -+ tmpval = (TxPower[RF_PATH_B]<<16) | (TxPower[RF_PATH_B]<<8) | TxPower[RF_PATH_B]; -+ write_bbreg(pAdapter, rTxAGC_B_CCK1_55_Mcs32, 0xffffff00, tmpval); -+ -+ RT_TRACE(_module_mp_, _drv_notice_, -+ ("-SetCCKTxPower: A[0x%02x] B[0x%02x]\n", -+ TxPower[RF_PATH_A], TxPower[RF_PATH_B])); -+} -+ -+void Hal_SetOFDMTxPower(PADAPTER pAdapter, u8 *TxPower) -+{ -+ u32 TxAGC = 0; -+ u8 tmpval = 0; -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ -+ // HT Tx-rf(A) -+ tmpval = TxPower[RF_PATH_A]; -+ TxAGC = (tmpval<<24) | (tmpval<<16) | (tmpval<<8) | tmpval; -+ -+ write_bbreg(pAdapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); -+ write_bbreg(pAdapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); -+ write_bbreg(pAdapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ write_bbreg(pAdapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ write_bbreg(pAdapter, rTxAGC_A_Mcs11_Mcs08, bMaskDWord, TxAGC); -+ write_bbreg(pAdapter, rTxAGC_A_Mcs15_Mcs12, bMaskDWord, TxAGC); -+ -+ // HT Tx-rf(B) -+ tmpval = TxPower[RF_PATH_B]; -+ TxAGC = (tmpval<<24) | (tmpval<<16) | (tmpval<<8) | tmpval; -+ -+ write_bbreg(pAdapter, rTxAGC_B_Rate18_06, bMaskDWord, TxAGC); -+ write_bbreg(pAdapter, rTxAGC_B_Rate54_24, bMaskDWord, TxAGC); -+ write_bbreg(pAdapter, rTxAGC_B_Mcs03_Mcs00, bMaskDWord, TxAGC); -+ write_bbreg(pAdapter, rTxAGC_B_Mcs07_Mcs04, bMaskDWord, TxAGC); -+ write_bbreg(pAdapter, rTxAGC_B_Mcs11_Mcs08, bMaskDWord, TxAGC); -+ write_bbreg(pAdapter, rTxAGC_B_Mcs15_Mcs12, bMaskDWord, TxAGC); -+ -+} -+ -+void Hal_SetAntennaPathPower(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 TxPowerLevel[MAX_RF_PATH]; -+ u8 rfPath; -+ -+ TxPowerLevel[RF_PATH_A] = pAdapter->mppriv.txpoweridx; -+ TxPowerLevel[RF_PATH_B] = pAdapter->mppriv.txpoweridx_b; -+ -+ switch (pAdapter->mppriv.antenna_tx) -+ { -+ case ANTENNA_A: -+ default: -+ rfPath = RF_PATH_A; -+ break; -+ case ANTENNA_B: -+ rfPath = RF_PATH_B; -+ break; -+ case ANTENNA_C: -+ rfPath = RF_PATH_C; -+ break; -+ } -+ -+ switch (pHalData->rf_chip) -+ { -+ case RF_8225: -+ case RF_8256: -+ case RF_6052: -+ Hal_SetCCKTxPower(pAdapter, TxPowerLevel); -+ if (pAdapter->mppriv.rateidx < MPT_RATE_6M) // CCK rate -+ Hal_MPT_CCKTxPowerAdjustbyIndex(pAdapter, TxPowerLevel[rfPath]%2 == 0); -+ Hal_SetOFDMTxPower(pAdapter, TxPowerLevel); -+ break; -+ -+ default: -+ break; -+ } -+} -+ -+typedef enum _MPT_TXPWR_DEF{ -+ MPT_CCK, -+ MPT_OFDM, // L and HT OFDM -+ MPT_VHT_OFDM -+}MPT_TXPWR_DEF; -+ -+void -+mpt_SetTxPower_8812( -+ PADAPTER pAdapter, -+ MPT_TXPWR_DEF Rate, -+ pu1Byte pTxPower -+ ) -+{ -+ u1Byte path = 0; -+ -+ switch (Rate) -+ { -+ case MPT_CCK: -+ { -+ for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_B; path++) -+ { -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_1M ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_2M ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_5_5M); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_11M ); -+ } -+ } -+ break; -+ case MPT_OFDM: -+ { -+ for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_B; path++) -+ { -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_1M ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_2M ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_5_5M); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_11M ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_6M ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_9M ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_12M); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_18M); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_24M); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_36M); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_48M); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_54M); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS0 ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS1 ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS2 ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS3 ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS4 ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS5 ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS6 ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS7 ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS8 ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS9 ); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS10); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS11); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS12); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS13); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS14); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_MCS15); -+ } -+ } break; -+ case MPT_VHT_OFDM: -+ { -+ for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_B; path++) -+ { -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS0); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS1); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS2); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS3); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS4); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS5); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS6); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS7); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS8); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT1SS_MCS9); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS0); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS1); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS2); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS3); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS4); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS5); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS6); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS7); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS8); -+ PHY_SetTxPowerIndex_8812A(pAdapter, pTxPower[path], path, MGN_VHT2SS_MCS9); -+ } -+ -+ } break; -+ -+ default: -+ DBG_871X("<===mpt_SetTxPower_8812: Illegal channel!!\n"); -+ break; -+ } -+ -+} -+ -+void Hal_SetTxPower(PADAPTER pAdapter) -+ { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -+ u1Byte path; -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ -+ path = ( pAdapter->mppriv.antenna_tx == ANTENNA_A) ? (ODM_RF_PATH_A) : (ODM_RF_PATH_B); -+ -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) -+ { -+ DBG_871X("===> MPT_ProSetTxPower: Jaguar\n"); -+ mpt_SetTxPower_8812(pAdapter, MPT_CCK, pMptCtx->TxPwrLevel); -+ mpt_SetTxPower_8812(pAdapter, MPT_OFDM, pMptCtx->TxPwrLevel); -+ mpt_SetTxPower_8812(pAdapter, MPT_VHT_OFDM, pMptCtx->TxPwrLevel); -+ } -+ -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+ -+} -+ -+void Hal_SetTxAGCOffset(PADAPTER pAdapter, u32 ulTxAGCOffset) -+{ -+ u32 TxAGCOffset_B, TxAGCOffset_C, TxAGCOffset_D,tmpAGC; -+ -+ TxAGCOffset_B = (ulTxAGCOffset&0x000000ff); -+ TxAGCOffset_C = ((ulTxAGCOffset&0x0000ff00)>>8); -+ TxAGCOffset_D = ((ulTxAGCOffset&0x00ff0000)>>16); -+ -+ tmpAGC = (TxAGCOffset_D<<8 | TxAGCOffset_C<<4 | TxAGCOffset_B); -+ write_bbreg(pAdapter, rFPGA0_TxGainStage, -+ (bXBTxAGC|bXCTxAGC|bXDTxAGC), tmpAGC); -+} -+ -+void Hal_SetDataRate(PADAPTER pAdapter) -+{ -+ //Hal_mpt_SwitchRfSetting(pAdapter); -+} -+ -+#define RF_PATH_AB 22 -+void Hal_SetAntenna(PADAPTER pAdapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; -+ R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ -+ R_ANTENNA_SELECT_CCK *p_cck_txrx; -+ -+ u8 r_rx_antenna_ofdm = 0, r_ant_select_cck_val = 0; -+ u8 chgTx = 0, chgRx = 0; -+ u32 r_ant_sel_cck_val = 0, r_ant_select_ofdm_val = 0, r_ofdm_tx_en_val = 0; -+ u32 reg0xC50 = 0; -+ -+ -+ p_ofdm_tx = (R_ANTENNA_SELECT_OFDM *)&r_ant_select_ofdm_val; -+ p_cck_txrx = (R_ANTENNA_SELECT_CCK *)&r_ant_select_cck_val; -+ -+ switch (pAdapter->mppriv.antenna_tx) -+ { -+ case ANTENNA_A: -+ pMptCtx->MptRfPath = ODM_RF_PATH_A; -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x1111); -+ if (pHalData->RFEType == 3) -+ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0 ); -+ break; -+ -+ case ANTENNA_B: -+ pMptCtx->MptRfPath = ODM_RF_PATH_B; -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x2222); -+ if (pHalData->RFEType == 3) -+ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x1 ); -+ break; -+ break; -+ -+ case ANTENNA_AB: // For 8192S -+ pMptCtx->MptRfPath = RF_PATH_AB; -+ PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x3333); -+ if (pHalData->RFEType == 3) -+ PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0 ); -+ break; -+ -+ default: -+ pMptCtx->MptRfPath = RF_PATH_AB; -+ DBG_871X("Unknown Tx antenna.\n"); -+ break; -+ } -+ -+ switch (pAdapter->mppriv.antenna_rx) { -+ case ANTENNA_A: -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); // RF_B_0x0[19:16] = 1, Standby mode -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, BIT19|BIT18|BIT17|BIT16, 0x3); -+ -+ // <20121101, Kordan> To prevent gain table from not switched, asked by Ynlin. -+ reg0xC50 = PHY_QueryBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0); -+ PHY_SetBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50+2); -+ PHY_SetBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50); -+ break; -+ case ANTENNA_B: -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); // RF_A_0x0[19:16] = 1, Standby mode -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x1); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, BIT19|BIT18|BIT17|BIT16, 0x3); -+ -+ // <20121101, Kordan> To prevent gain table from not switched, asked by Ynlin. -+ reg0xC50 = PHY_QueryBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0); -+ PHY_SetBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50+2); -+ PHY_SetBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50); -+ break; -+ case ANTENNA_AB: -+ PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x33); -+ PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); // RF_B_0x0[19:16] = 3, Rx mode -+ PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); -+ break; -+ default: -+ DBG_871X("Unknown Rx antenna.\n"); -+ break; -+ } -+ -+ RT_TRACE(_module_mp_, _drv_notice_, ("-SwitchAntenna: finished\n")); -+} -+ -+s32 Hal_SetThermalMeter(PADAPTER pAdapter, u8 target_ther) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ -+ if (!netif_running(pAdapter->pnetdev)) { -+ RT_TRACE(_module_mp_, _drv_warning_, ("SetThermalMeter! Fail: interface not opened!\n")); -+ return _FAIL; -+ } -+ -+ if (check_fwstate(&pAdapter->mlmepriv, WIFI_MP_STATE) == false) { -+ RT_TRACE(_module_mp_, _drv_warning_, ("SetThermalMeter: Fail! not in MP mode!\n")); -+ return _FAIL; -+ } -+ -+ target_ther &= 0xff; -+ if (target_ther < 0x07) -+ target_ther = 0x07; -+ else if (target_ther > 0x1d) -+ target_ther = 0x1d; -+ -+ pHalData->EEPROMThermalMeter = target_ther; -+ -+ return _SUCCESS; -+} -+ -+void Hal_TriggerRFThermalMeter(PADAPTER pAdapter) -+{ -+ _write_rfreg( pAdapter, RF_PATH_A , RF_T_METER_8812A , BIT17 |BIT16 , 0x03 ); -+ -+// RT_TRACE(_module_mp_,_drv_alert_, ("TriggerRFThermalMeter() finished.\n" )); -+} -+ -+u8 Hal_ReadRFThermalMeter(PADAPTER pAdapter) -+{ -+ u32 ThermalValue = 0; -+ -+ ThermalValue = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, RF_T_METER_8812A, 0xfc00); // 0x42: RF Reg[15:10] -+ -+// RT_TRACE(_module_mp_, _drv_alert_, ("ThermalValue = 0x%x\n", ThermalValue)); -+ return (u8)ThermalValue; -+} -+ -+void Hal_GetThermalMeter(PADAPTER pAdapter, u8 *value) -+{ -+#if 0 -+ fw_cmd(pAdapter, IOCMD_GET_THERMAL_METER); -+ rtw_msleep_os(1000); -+ fw_cmd_data(pAdapter, value, 1); -+ *value &= 0xFF; -+#else -+ -+ Hal_TriggerRFThermalMeter(pAdapter); -+ rtw_msleep_os(1000); -+ *value = Hal_ReadRFThermalMeter(pAdapter); -+#endif -+} -+ -+void Hal_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ pAdapter->mppriv.MptCtx.bSingleCarrier = bStart; -+ if (bStart)// Start Single Carrier. -+ { -+ RT_TRACE(_module_mp_,_drv_alert_, ("SetSingleCarrierTx: test start\n")); -+ // 1. if OFDM block on? -+ if(!read_bbreg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) -+ write_bbreg(pAdapter, rFPGA0_RFMOD, bOFDMEn, bEnable);//set OFDM block on -+ -+ // 2. set CCK test mode off, set to CCK normal mode -+ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, bDisable); -+ // 3. turn on scramble setting -+ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, bEnable); -+ -+ // 4. Turn On Continue Tx and turn off the other test modes. -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) -+ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_SingleCarrier); -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_SingleCarrier); -+ -+ //for dynamic set Power index. -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ } -+ else// Stop Single Carrier. -+ { -+ RT_TRACE(_module_mp_,_drv_alert_, ("SetSingleCarrierTx: test stop\n")); -+ //Turn off all test modes. -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) -+ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_ALL_OFF); -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ALL_OFF); -+ -+ //Delay 10 ms //delay_ms(10); -+ rtw_msleep_os(10); -+ -+ //BB Reset -+ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ -+ //Stop for dynamic set Power index. -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ -+ } -+} -+ -+ -+void Hal_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; -+ bool is92C = IS_92C_SERIAL(pHalData->VersionID); -+ -+ u8 rfPath; -+ u32 reg58 = 0x0; -+ static u4Byte regRF0x0 = 0x0; -+ static u4Byte reg0xCB0 = 0x0; -+ static u4Byte reg0xEB0 = 0x0; -+ static u4Byte reg0xCB4 = 0x0; -+ static u4Byte reg0xEB4 = 0x0; -+ switch (pAdapter->mppriv.antenna_tx) -+ { -+ case ANTENNA_A: -+ default: -+ rfPath = RF_PATH_A; -+ break; -+ case ANTENNA_B: -+ rfPath = RF_PATH_B; -+ break; -+ case ANTENNA_C: -+ rfPath = RF_PATH_C; -+ break; -+ } -+ -+ pAdapter->mppriv.MptCtx.bSingleTone = bStart; -+ if (bStart)// Start Single Tone. -+ { -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) -+ { -+ u1Byte p = ODM_RF_PATH_A; -+ -+ regRF0x0 = PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, bRFRegOffsetMask); -+ reg0xCB0 = PHY_QueryBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord); -+ reg0xEB0 = PHY_QueryBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord); -+ reg0xCB4 = PHY_QueryBBReg(pAdapter, rA_RFE_Pinmux_Jaguar+4, bMaskDWord); -+ reg0xEB4 = PHY_QueryBBReg(pAdapter, rB_RFE_Pinmux_Jaguar+4, bMaskDWord); -+ -+ PHY_SetBBReg(pAdapter, rOFDMCCKEN_Jaguar, BIT29|BIT28, 0x0); // Disable CCK and OFDM -+ -+ if (pMptCtx->MptRfPath == RF_PATH_AB) { -+ for (p = ODM_RF_PATH_A; p <= ODM_RF_PATH_B; ++p) { -+ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, 0xF0000, 0x2); // Tx mode: RF0x00[19:16]=4'b0010 -+ PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, 0x1F, 0x0); // Lowest RF gain index: RF_0x0[4:0] = 0 -+ PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x1); // RF LO enabled -+ } -+ } else { -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC_Jaguar, 0xF0000, 0x2); // Tx mode: RF0x00[19:16]=4'b0010 -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC_Jaguar, 0x1F, 0x0); // Lowest RF gain index: RF_0x0[4:0] = 0 -+ PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); // RF LO enabled -+ } -+ -+ -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); // 0xCB0[[23:16, 7:4] = 0x77007 -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); // 0xCB0[[23:16, 7:4] = 0x77007 -+ -+ if (pHalData->ExternalPA_5G) { -+ -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar+4, 0xFF00000, 0x12); // 0xCB4[23:16] = 0x12 -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar+4, 0xFF00000, 0x12); // 0xEB4[23:16] = 0x12 -+ } else if (pHalData->ExternalPA_2G) { -+ PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar+4, 0xFF00000, 0x11); // 0xCB4[23:16] = 0x11 -+ PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar+4, 0xFF00000, 0x11); // 0xEB4[23:16] = 0x11 -+ } -+ } -+ else -+ { -+ // Turn On SingleTone and turn off the other test modes. -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_SingleTone); -+ } -+ -+ //for dynamic set Power index. -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ } -+ else// Stop Single Tone. -+ { -+ RT_TRACE(_module_mp_,_drv_alert_, ("SetSingleToneTx: test stop\n")); -+ -+ { // <20120326, Kordan> To amplify the power of tone for Xtal calibration. (asked by Edlu) -+ // <20120326, Kordan> Only in single tone mode. (asked by Edlu) -+ if (IS_HARDWARE_TYPE_8188E(pAdapter)) -+ { -+ reg58 = PHY_QueryRFReg(pAdapter, RF_PATH_A, LNA_Low_Gain_3, bRFRegOffsetMask); -+ reg58 &= 0xFFFFFFF0; -+ PHY_SetRFReg(pAdapter, RF_PATH_A, LNA_Low_Gain_3, bRFRegOffsetMask, reg58); -+ } -+ -+ write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x1); -+ write_bbreg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x1); -+ } -+ if (is92C) { -+ _write_rfreg(pAdapter, RF_PATH_A, 0x21, BIT19, 0x00); -+ rtw_usleep_os(100); -+ write_rfreg(pAdapter, RF_PATH_A, 0x00, 0x32d75); // PAD all on. -+ write_rfreg(pAdapter, RF_PATH_B, 0x00, 0x32d75); // PAD all on. -+ rtw_usleep_os(100); -+ } else { -+ write_rfreg(pAdapter, rfPath, 0x21, 0x54000); -+ rtw_usleep_os(100); -+ write_rfreg(pAdapter, rfPath, 0x00, 0x30000); // PAD all on. -+ rtw_usleep_os(100); -+ } -+ -+ //Stop for dynamic set Power index. -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ -+ } -+ -+} -+ -+ -+ -+void Hal_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) -+{ -+ pAdapter->mppriv.MptCtx.bCarrierSuppression = bStart; -+ if (bStart) // Start Carrier Suppression. -+ { -+ RT_TRACE(_module_mp_,_drv_alert_, ("SetCarrierSuppressionTx: test start\n")); -+ //if(pMgntInfo->dot11CurrentWirelessMode == WIRELESS_MODE_B) -+ if (pAdapter->mppriv.rateidx <= MPT_RATE_11M) -+ { -+ // 1. if CCK block on? -+ if(!read_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn)) -+ write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, bEnable);//set CCK block on -+ -+ //Turn Off All Test Mode -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) -+ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_ALL_OFF); -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ALL_OFF); -+ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); //transmit mode -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x0); //turn off scramble setting -+ //Set CCK Tx Test Rate -+ //PHY_SetBBReg(pAdapter, rCCK0_System, bCCKTxRate, pMgntInfo->ForcedDataRate); -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKTxRate, 0x0); //Set FTxRate to 1Mbps -+ } -+ -+ //for dynamic set Power index. -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ } -+ else// Stop Carrier Suppression. -+ { -+ RT_TRACE(_module_mp_,_drv_alert_, ("SetCarrierSuppressionTx: test stop\n")); -+ //if(pMgntInfo->dot11CurrentWirelessMode == WIRELESS_MODE_B) -+ if (pAdapter->mppriv.rateidx <= MPT_RATE_11M ) { -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); //normal mode -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x1); //turn on scramble setting -+ -+ //BB Reset -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ } -+ -+ //Stop for dynamic set Power index. -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ -+ } -+ //DbgPrint("\n MPT_ProSetCarrierSupp() is finished. \n"); -+} -+ -+void Hal_SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ u32 cckrate; -+ -+ if (bStart) -+ { -+ RT_TRACE(_module_mp_, _drv_alert_, -+ ("SetCCKContinuousTx: test start\n")); -+ -+ // 1. if CCK block on? -+ if(!read_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn)) -+ write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, bEnable);//set CCK block on -+ -+ //Turn Off All Test Mode -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) -+ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_ALL_OFF); -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ALL_OFF); -+ //Set CCK Tx Test Rate -+ #if 0 -+ switch(pAdapter->mppriv.rateidx) -+ { -+ case 2: -+ cckrate = 0; -+ break; -+ case 4: -+ cckrate = 1; -+ break; -+ case 11: -+ cckrate = 2; -+ break; -+ case 22: -+ cckrate = 3; -+ break; -+ default: -+ cckrate = 0; -+ break; -+ } -+ #else -+ cckrate = pAdapter->mppriv.rateidx; -+ #endif -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKTxRate, cckrate); -+ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); //transmit mode -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x1); //turn on scramble setting -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ pAdapter->mppriv.MptCtx.bCckContTx = true; -+ pAdapter->mppriv.MptCtx.bOfdmContTx = false; -+ -+ } -+ else { -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("SetCCKContinuousTx: test stop\n")); -+ -+ pAdapter->mppriv.MptCtx.bCckContTx = false; -+ pAdapter->mppriv.MptCtx.bOfdmContTx = false; -+ -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); //normal mode -+ PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x1); //turn on scramble setting -+ -+ //BB Reset -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ -+ PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ } -+}/* mpt_StartCckContTx */ -+ -+void Hal_SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ if (bStart) { -+ RT_TRACE(_module_mp_, _drv_info_, ("SetOFDMContinuousTx: test start\n")); -+ // 1. if OFDM block on? -+ if(!read_bbreg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) -+ write_bbreg(pAdapter, rFPGA0_RFMOD, bOFDMEn, bEnable);//set OFDM block on -+ -+ -+ // 2. set CCK test mode off, set to CCK normal mode -+ write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, bDisable); -+ -+ // 3. turn on scramble setting -+ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, bEnable); -+ -+ // 4. Turn On Continue Tx and turn off the other test modes. -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) -+ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_ContinuousTx); -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ContinuousTx); -+ //for dynamic set Power index. -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); -+ -+ } else { -+ RT_TRACE(_module_mp_,_drv_info_, ("SetOFDMContinuousTx: test stop\n")); -+ -+ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) -+ PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18|BIT17|BIT16, OFDM_ALL_OFF); -+ else -+ PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30|BIT29|BIT28, OFDM_ALL_OFF); -+ -+ rtw_msleep_os(10); -+ //BB Reset -+ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); -+ write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); -+ -+ //Stop for dynamic set Power index. -+ write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); -+ write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); -+ } -+ -+ pAdapter->mppriv.MptCtx.bCckContTx = false; -+ pAdapter->mppriv.MptCtx.bOfdmContTx = bStart; -+}/* mpt_StartOfdmContTx */ -+ -+void Hal_SetContinuousTx(PADAPTER pAdapter, u8 bStart) -+{ -+#if 0 -+ // ADC turn off [bit24-21] adc port0 ~ port1 -+ if (bStart) { -+ write_bbreg(pAdapter, rRx_Wait_CCCA, read_bbreg(pAdapter, rRx_Wait_CCCA) & 0xFE1FFFFF); -+ rtw_usleep_os(100); -+ } -+#endif -+ RT_TRACE(_module_mp_, _drv_info_, -+ ("SetContinuousTx: rate:%d\n", pAdapter->mppriv.rateidx)); -+ -+ pAdapter->mppriv.MptCtx.bStartContTx = bStart; -+ if (pAdapter->mppriv.rateidx <= MPT_RATE_11M) -+ { -+ Hal_SetCCKContinuousTx(pAdapter, bStart); -+ } -+ else if ((pAdapter->mppriv.rateidx >= MPT_RATE_6M) && -+ (pAdapter->mppriv.rateidx <= MPT_RATE_MCS15)) -+ { -+ Hal_SetOFDMContinuousTx(pAdapter, bStart); -+ } -+#if 0 -+ // ADC turn on [bit24-21] adc port0 ~ port1 -+ if (!bStart) { -+ write_bbreg(pAdapter, rRx_Wait_CCCA, read_bbreg(pAdapter, rRx_Wait_CCCA) | 0x01E00000); -+ } -+#endif -+} -+ -+#endif // CONFIG_MP_INCLUDE -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_phycfg.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_phycfg.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_phycfg.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_phycfg.c 2018-02-06 17:42:30.715967238 +0200 -@@ -0,0 +1,4327 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8812A_PHYCFG_C_ -+ -+//#include -+ -+#include -+ -+ -+const char *const GLBwSrc[]={ -+ "CHANNEL_WIDTH_20", -+ "CHANNEL_WIDTH_40", -+ "CHANNEL_WIDTH_80", -+ "CHANNEL_WIDTH_160", -+ "CHANNEL_WIDTH_80_80" -+}; -+#define ENABLE_POWER_BY_RATE 1 -+#define POWERINDEX_ARRAY_SIZE 48 //= cckRatesSize + ofdmRatesSize + htRates1TSize + htRates2TSize + vhtRates1TSize + vhtRates1TSize; -+ -+/*---------------------Define local function prototype-----------------------*/ -+ -+/*----------------------------Function Body----------------------------------*/ -+ -+// -+// 1. BB register R/W API -+// -+ -+u32 -+PHY_QueryBBReg8812( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask -+ ) -+{ -+ u32 ReturnValue = 0, OriginalValue, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return 0; -+#endif -+ -+ //DBG_871X("--->PHY_QueryBBReg8812(): RegAddr(%#x), BitMask(%#x)\n", RegAddr, BitMask); -+ -+ -+ OriginalValue = rtw_read32(Adapter, RegAddr); -+ BitShift = PHY_CalculateBitShift(BitMask); -+ ReturnValue = (OriginalValue & BitMask) >> BitShift; -+ -+ //DBG_871X("BBR MASK=0x%x Addr[0x%x]=0x%x\n", BitMask, RegAddr, OriginalValue); -+ return (ReturnValue); -+} -+ -+ -+void -+PHY_SetBBReg8812( -+ PADAPTER Adapter, -+ u4Byte RegAddr, -+ u4Byte BitMask, -+ u4Byte Data -+ ) -+{ -+ u4Byte OriginalValue, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return; -+#endif -+ -+ if(BitMask!= bMaskDWord) -+ {//if not "double word" write -+ OriginalValue = rtw_read32(Adapter, RegAddr); -+ BitShift = PHY_CalculateBitShift(BitMask); -+ Data = ((OriginalValue) & (~BitMask)) |( ((Data << BitShift)) & BitMask); -+ } -+ -+ rtw_write32(Adapter, RegAddr, Data); -+ -+ //DBG_871X("BBW MASK=0x%x Addr[0x%x]=0x%x\n", BitMask, RegAddr, Data); -+} -+ -+// -+// 2. RF register R/W API -+// -+ -+static u32 -+phy_RFSerialRead( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset -+ ) -+{ -+ u32 retValue = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ BB_REGISTER_DEFINITION_T *pPhyReg = &pHalData->PHYRegDef[eRFPath]; -+ bool bIsPIMode = false; -+ -+ -+ // 2009/06/17 MH We can not execute IO for power save or other accident mode. -+ //if(RT_CANNOT_IO(Adapter)) -+ //{ -+ // RT_DISP(FPHY, PHY_RFR, ("phy_RFSerialRead return all one\n")); -+ // return 0xFFFFFFFF; -+ //} -+ -+ // <20120809, Kordan> CCA OFF(when entering), asked by James to avoid reading the wrong value. -+ // <20120828, Kordan> Toggling CCA would affect RF 0x0, skip it! -+ if (Offset != 0x0 && ! (IS_VENDOR_8812A_C_CUT(Adapter) || IS_HARDWARE_TYPE_8821(Adapter))) -+ PHY_SetBBReg(Adapter, rCCAonSec_Jaguar, 0x8, 1); -+ -+ Offset &= 0xff; -+ -+ if (eRFPath == RF_PATH_A) -+ bIsPIMode = (bool)PHY_QueryBBReg(Adapter, 0xC00, 0x4); -+ else if (eRFPath == RF_PATH_B) -+ bIsPIMode = (bool)PHY_QueryBBReg(Adapter, 0xE00, 0x4); -+ -+ if(IS_VENDOR_8812A_TEST_CHIP(Adapter)) -+ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, bMaskDWord, 0); -+ -+ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, bHSSIRead_addr_Jaguar, Offset); -+ -+ if (IS_VENDOR_8812A_TEST_CHIP(Adapter) ) -+ PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, bMaskDWord, Offset|BIT8); -+ -+ if (IS_VENDOR_8812A_C_CUT(Adapter) || IS_HARDWARE_TYPE_8821(Adapter)) -+ rtw_udelay_os(20); -+ -+ if (bIsPIMode) -+ { -+ retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBackPi, rRead_data_Jaguar); -+ //DBG_871X("[PI mode] RFR-%d Addr[0x%x]=0x%x\n", eRFPath, pPhyReg->rfLSSIReadBackPi, retValue); -+ } -+ else -+ { -+ retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBack, rRead_data_Jaguar); -+ //DBG_871X("[SI mode] RFR-%d Addr[0x%x]=0x%x\n", eRFPath, pPhyReg->rfLSSIReadBack, retValue); -+ } -+ -+ // <20120809, Kordan> CCA ON(when exiting), asked by James to avoid reading the wrong value. -+ // <20120828, Kordan> Toggling CCA would affect RF 0x0, skip it! -+ if (Offset != 0x0 && ! (IS_VENDOR_8812A_C_CUT(Adapter) || IS_HARDWARE_TYPE_8821(Adapter))) -+ PHY_SetBBReg(Adapter, rCCAonSec_Jaguar, 0x8, 0); -+ -+ return retValue; -+} -+ -+ -+static void -+phy_RFSerialWrite( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset, -+ u32 Data -+ ) -+{ -+ u32 DataAndAddr = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ BB_REGISTER_DEFINITION_T *pPhyReg = &pHalData->PHYRegDef[eRFPath]; -+ -+ // 2009/06/17 MH We can not execute IO for power save or other accident mode. -+ //if(RT_CANNOT_IO(Adapter)) -+ //{ -+ // RTPRINT(FPHY, PHY_RFW, ("phy_RFSerialWrite stop\n")); -+ // return; -+ //} -+ -+ Offset &= 0xff; -+ -+ // Shadow Update -+ //PHY_RFShadowWrite(Adapter, eRFPath, Offset, Data); -+ -+ // Put write addr in [27:20] and write data in [19:00] -+ DataAndAddr = ((Offset<<20) | (Data&0x000fffff)) & 0x0fffffff; -+ -+ //3 This is a workaround for 8812A test chips. -+ // <20120427, Kordan> MAC first moves lower 16 bits and then upper 16 bits of a 32-bit data. -+ // BaseBand doesn't know the two actions is actually only one action to access 32-bit data, -+ // so that the lower 16 bits is overwritten by the upper 16 bits. (Asked by ynlin.) -+ // (Unfortunately, the protection mechanism has not been implemented in 8812A yet.) -+ // 2012/10/26 MH Revise V3236 Lanhsin check in, if we do not enable the function -+ // for 8821, then it can not scan. -+ if ((!pHalData->bSupportUSB3) && (IS_TEST_CHIP(pHalData->VersionID))) // USB 2.0 or older -+ { -+ //if (IS_VENDOR_8812A_TEST_CHIP(Adapter) || IS_HARDWARE_TYPE_8821(Adapter) is) -+ { -+ rtw_write32(Adapter, 0x1EC, DataAndAddr); -+ if (eRFPath == RF_PATH_A) -+ rtw_write32(Adapter, 0x1E8, 0x4000F000|0xC90); -+ else -+ rtw_write32(Adapter, 0x1E8, 0x4000F000|0xE90); -+ } -+ } -+ else // USB 3.0 -+ { -+ // Write Operation -+ // TODO: Dynamically determine whether using PI or SI to write RF registers. -+ PHY_SetBBReg(Adapter, pPhyReg->rf3wireOffset, bMaskDWord, DataAndAddr); -+ //DBG_871X("RFW-%d Addr[0x%x]=0x%x\n", eRFPath, pPhyReg->rf3wireOffset, DataAndAddr); -+ } -+ -+} -+ -+u32 -+PHY_QueryRFReg8812( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 RegAddr, -+ u32 BitMask -+ ) -+{ -+ u32 Original_Value, Readback_Value, BitShift; -+ -+#if (DISABLE_BB_RF == 1) -+ return 0; -+#endif -+ -+ Original_Value = phy_RFSerialRead(Adapter, eRFPath, RegAddr); -+ -+ BitShift = PHY_CalculateBitShift(BitMask); -+ Readback_Value = (Original_Value & BitMask) >> BitShift; -+ -+ return (Readback_Value); -+} -+ -+void -+PHY_SetRFReg8812( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+ ) -+{ -+#if (DISABLE_BB_RF == 1) -+ return; -+#endif -+ -+ if(BitMask == 0) -+ return; -+ -+ // RF data is 20 bits only -+ if (BitMask != bLSSIWrite_data_Jaguar) { -+ u32 Original_Value, BitShift; -+ Original_Value = phy_RFSerialRead(Adapter, eRFPath, RegAddr); -+ BitShift = PHY_CalculateBitShift(BitMask); -+ Data = ((Original_Value) & (~BitMask)) | (Data<< BitShift); -+ } -+ -+ phy_RFSerialWrite(Adapter, eRFPath, RegAddr, Data); -+ -+} -+ -+// -+// 3. Initial MAC/BB/RF config by reading MAC/BB/RF txt. -+// -+ -+s32 PHY_MACConfig8812(PADAPTER Adapter) -+{ -+ int rtStatus = _SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ s8 *pszMACRegFile; -+ s8 sz8812MACRegFile[] = RTL8812_PHY_MACREG; -+ -+ pszMACRegFile = sz8812MACRegFile; -+ -+ // -+ // Config MAC -+ // -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if(HAL_STATUS_SUCCESS != ODM_ConfigMACWithHeaderFile(&pHalData->odmpriv)) -+ rtStatus = _FAIL; -+#else -+ -+ // Not make sure EEPROM, add later -+ DBG_871X("Read MACREG.txt\n"); -+ rtStatus = phy_ConfigMACWithParaFile(Adapter, pszMACRegFile); -+#endif//CONFIG_EMBEDDED_FWIMG -+ -+ return rtStatus; -+} -+ -+ -+static void -+phy_InitBBRFRegisterDefinition( -+ PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ // RF Interface Sowrtware Control -+ pHalData->PHYRegDef[RF_PATH_A].rfintfs = rFPGA0_XAB_RFInterfaceSW; // 16 LSBs if read 32-bit from 0x870 -+ pHalData->PHYRegDef[RF_PATH_B].rfintfs = rFPGA0_XAB_RFInterfaceSW; // 16 MSBs if read 32-bit from 0x870 (16-bit for 0x872) -+ -+ // RF Interface Output (and Enable) -+ pHalData->PHYRegDef[RF_PATH_A].rfintfo = rFPGA0_XA_RFInterfaceOE; // 16 LSBs if read 32-bit from 0x860 -+ pHalData->PHYRegDef[RF_PATH_B].rfintfo = rFPGA0_XB_RFInterfaceOE; // 16 LSBs if read 32-bit from 0x864 -+ -+ // RF Interface (Output and) Enable -+ pHalData->PHYRegDef[RF_PATH_A].rfintfe = rFPGA0_XA_RFInterfaceOE; // 16 MSBs if read 32-bit from 0x860 (16-bit for 0x862) -+ pHalData->PHYRegDef[RF_PATH_B].rfintfe = rFPGA0_XB_RFInterfaceOE; // 16 MSBs if read 32-bit from 0x864 (16-bit for 0x866) -+ -+ pHalData->PHYRegDef[RF_PATH_A].rf3wireOffset = rA_LSSIWrite_Jaguar; //LSSI Parameter -+ pHalData->PHYRegDef[RF_PATH_B].rf3wireOffset = rB_LSSIWrite_Jaguar; -+ -+ pHalData->PHYRegDef[RF_PATH_A].rfHSSIPara2 = rHSSIRead_Jaguar; //wire control parameter2 -+ pHalData->PHYRegDef[RF_PATH_B].rfHSSIPara2 = rHSSIRead_Jaguar; //wire control parameter2 -+ -+ // Tranceiver Readback LSSI/HSPI mode -+ pHalData->PHYRegDef[RF_PATH_A].rfLSSIReadBack = rA_SIRead_Jaguar; -+ pHalData->PHYRegDef[RF_PATH_B].rfLSSIReadBack = rB_SIRead_Jaguar; -+ pHalData->PHYRegDef[RF_PATH_A].rfLSSIReadBackPi = rA_PIRead_Jaguar; -+ pHalData->PHYRegDef[RF_PATH_B].rfLSSIReadBackPi = rB_PIRead_Jaguar; -+ -+ //pHalData->bPhyValueInitReady=true; -+} -+ -+void -+PHY_BB8812_Config_1T( -+ PADAPTER Adapter -+ ) -+{ -+ // BB OFDM RX Path_A -+ PHY_SetBBReg(Adapter, rRxPath_Jaguar, bRxPath_Jaguar, 0x11); -+ // BB OFDM TX Path_A -+ PHY_SetBBReg(Adapter, rTxPath_Jaguar, bMaskLWord, 0x1111); -+ // BB CCK R/Rx Path_A -+ PHY_SetBBReg(Adapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); -+ // MCS support -+ PHY_SetBBReg(Adapter, 0x8bc, 0xc0000060, 0x4); -+ // RF Path_B HSSI OFF -+ PHY_SetBBReg(Adapter, 0xe00, 0xf, 0x4); -+ // RF Path_B Power Down -+ PHY_SetBBReg(Adapter, 0xe90, bMaskDWord, 0); -+ // ADDA Path_B OFF -+ PHY_SetBBReg(Adapter, 0xe60, bMaskDWord, 0); -+ PHY_SetBBReg(Adapter, 0xe64, bMaskDWord, 0); -+} -+ -+ -+static int -+phy_BB8812_Config_ParaFile( -+ PADAPTER Adapter -+ ) -+{ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rtStatus = _SUCCESS; -+ -+ s8 sz8812BBRegFile[] = RTL8812_PHY_REG; -+ s8 sz8812AGCTableFile[] = RTL8812_AGC_TAB; -+ s8 sz8812BBRegPgFile[] = RTL8812_PHY_REG_PG; -+ s8 sz8812BBRegMpFile[] = RTL8812_PHY_REG_MP; -+ s8 sz8812BBRegLimitFile[] = RTL8812_TXPWR_LMT; -+ -+ s8 sz8821BBRegFile[] = RTL8821_PHY_REG; -+ s8 sz8821AGCTableFile[] = RTL8821_AGC_TAB; -+ s8 sz8821BBRegPgFile[] = RTL8821_PHY_REG_PG; -+ s8 sz8821BBRegMpFile[] = RTL8821_PHY_REG_MP; -+ s8 sz8821RFTxPwrLmtFile[] = RTL8821_TXPWR_LMT; -+ s8 *pszBBRegFile = NULL, *pszAGCTableFile = NULL, -+ *pszBBRegPgFile = NULL, *pszBBRegMpFile=NULL, -+ *pszRFTxPwrLmtFile = NULL; -+ -+ -+ //DBG_871X("==>phy_BB8812_Config_ParaFile\n"); -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ { -+ pszBBRegFile=sz8812BBRegFile ; -+ pszAGCTableFile =sz8812AGCTableFile; -+ pszBBRegPgFile = sz8812BBRegPgFile; -+ pszBBRegMpFile = sz8812BBRegMpFile; -+ pszRFTxPwrLmtFile = sz8812BBRegLimitFile; -+ } -+ else -+ { -+ pszBBRegFile=sz8821BBRegFile ; -+ pszAGCTableFile =sz8821AGCTableFile; -+ pszBBRegPgFile = sz8821BBRegPgFile; -+ pszBBRegMpFile = sz8821BBRegMpFile; -+ pszRFTxPwrLmtFile = sz8821RFTxPwrLmtFile; -+ } -+ -+ DBG_871X("===> phy_BB8812_Config_ParaFile() EEPROMRegulatory %d\n", pHalData->EEPROMRegulatory ); -+ -+ //DBG_871X(" ===> phy_BB8812_Config_ParaFile() phy_reg:%s\n",pszBBRegFile); -+ //DBG_871X(" ===> phy_BB8812_Config_ParaFile() phy_reg_pg:%s\n",pszBBRegPgFile); -+ //DBG_871X(" ===> phy_BB8812_Config_ParaFile() agc_table:%s\n",pszAGCTableFile); -+ -+ PHY_InitPowerLimitTable( &(pHalData->odmpriv) ); -+ -+ if ( ( Adapter->registrypriv.RegEnableTxPowerLimit == 1 && pHalData->EEPROMRegulatory != 2 ) || -+ pHalData->EEPROMRegulatory == 1 ) -+ { -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS != ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv, CONFIG_RF_TXPWR_LMT, 0)) -+ rtStatus = _FAIL; -+#else -+ rtStatus = PHY_ConfigBBWithPowerLimitTableParaFile( Adapter, pszRFTxPwrLmtFile ); -+#endif -+ -+ if(rtStatus != _SUCCESS){ -+ DBG_871X("phy_BB8812_Config_ParaFile():Write BB Reg Fail!!"); -+ goto phy_BB_Config_ParaFile_Fail; -+ } -+ } -+ -+ // Read PHY_REG.TXT BB INIT!! -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG)) -+ rtStatus = _FAIL; -+#else -+ // No matter what kind of CHIP we always read PHY_REG.txt. We must copy different -+ // type of parameter files to phy_reg.txt at first. -+ rtStatus = phy_ConfigBBWithParaFile(Adapter,pszBBRegFile); -+#endif -+ -+ if(rtStatus != _SUCCESS){ -+ DBG_871X("phy_BB8812_Config_ParaFile():Write BB Reg Fail!!"); -+ goto phy_BB_Config_ParaFile_Fail; -+ } -+ -+//f (MP_DRIVER == 1) -+#if 0 -+ // Read PHY_REG_MP.TXT BB INIT!! -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG)) -+ rtStatus = _FAIL; -+#else -+ // No matter what kind of CHIP we always read PHY_REG.txt. We must copy different -+ // type of parameter files to phy_reg.txt at first. -+ rtStatus = phy_ConfigBBWithMpParaFile(Adapter,pszBBRegMpFile); -+#endif -+ -+ if(rtStatus != _SUCCESS){ -+ DBG_871X("phy_BB8812_Config_ParaFile():Write BB Reg MP Fail!!"); -+ goto phy_BB_Config_ParaFile_Fail; -+ } -+#endif // #if (MP_DRIVER == 1) -+ -+ // If EEPROM or EFUSE autoload OK, We must config by PHY_REG_PG.txt -+ //1 TODO -+ if (pEEPROM->bautoload_fail_flag == false) -+ { -+ pHalData->pwrGroupCnt = 0; -+ -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG_PG)) -+ rtStatus = _FAIL; -+#else -+ rtStatus = phy_ConfigBBWithPgParaFile(Adapter, pszBBRegPgFile); -+#endif -+ -+ if(rtStatus != _SUCCESS){ -+ DBG_871X("phy_BB8812_Config_ParaFile():BB_PG Reg Fail!!"); -+ goto phy_BB_Config_ParaFile_Fail; -+ } -+ -+ if ( ( Adapter->registrypriv.RegEnableTxPowerLimit == 1 && pHalData->EEPROMRegulatory != 2 ) || -+ pHalData->EEPROMRegulatory == 1 ) -+ PHY_ConvertPowerLimitToPowerIndex( Adapter ); -+ } -+ -+ -+ // BB AGC table Initialization -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_AGC_TAB)) -+ rtStatus = _FAIL; -+#else -+ rtStatus = phy_ConfigBBWithParaFile(Adapter, pszAGCTableFile); -+#endif -+ -+ if(rtStatus != _SUCCESS){ -+ DBG_871X("phy_BB8812_Config_ParaFile():AGC Table Fail\n"); -+ goto phy_BB_Config_ParaFile_Fail; -+ } -+ -+phy_BB_Config_ParaFile_Fail: -+ -+ return rtStatus; -+} -+ -+int -+PHY_BBConfig8812( -+ PADAPTER Adapter -+ ) -+{ -+ int rtStatus = _SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 TmpU1B=0; -+ u8 CrystalCap; -+ -+ phy_InitBBRFRegisterDefinition(Adapter); -+ -+ //tangw check start 20120412 -+ // . APLL_EN,,APLL_320_GATEB,APLL_320BIAS, auto config by hw fsm after pfsm_go (0x4 bit 8) set -+ TmpU1B = rtw_read8(Adapter, REG_SYS_FUNC_EN); -+ -+ if(IS_HARDWARE_TYPE_8812AU(Adapter) || IS_HARDWARE_TYPE_8821U(Adapter)) -+ TmpU1B |= FEN_USBA; -+ else if(IS_HARDWARE_TYPE_8812E(Adapter) || IS_HARDWARE_TYPE_8821E(Adapter)) -+ TmpU1B |= FEN_PCIEA; -+ -+ rtw_write8(Adapter, REG_SYS_FUNC_EN, TmpU1B); -+ -+ rtw_write8(Adapter, REG_SYS_FUNC_EN, (TmpU1B|FEN_BB_GLB_RSTn|FEN_BBRSTB));//same with 8812 -+ //6. 0x1f[7:0] = 0x07 PathA RF Power On -+ rtw_write8(Adapter, REG_RF_CTRL, 0x07);//RF_SDMRSTB,RF_RSTB,RF_EN same with 8723a -+ //7. PathB RF Power On -+ rtw_write8(Adapter, REG_OPT_CTRL_8812+2, 0x7);//RF_SDMRSTB,RF_RSTB,RF_EN same with 8723a -+ //tangw check end 20120412 -+ -+ -+ // -+ // Config BB and AGC -+ // -+ rtStatus = phy_BB8812_Config_ParaFile(Adapter); -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ { -+ // write 0x2C[30:25] = 0x2C[24:19] = CrystalCap -+ CrystalCap = pHalData->CrystalCap & 0x3F; -+ PHY_SetBBReg(Adapter, REG_MAC_PHY_CTRL, 0x7FF80000, (CrystalCap | (CrystalCap << 6))); -+ } -+ else if ((IS_HARDWARE_TYPE_8723A(Adapter) && pHalData->EEPROMVersion >= 0x01) || -+ IS_HARDWARE_TYPE_8821(Adapter) || IS_HARDWARE_TYPE_8723B(Adapter) || -+ IS_HARDWARE_TYPE_8192E(Adapter)) -+ { -+ // 0x2C[23:18] = 0x2C[17:12] = CrystalCap -+ CrystalCap = pHalData->CrystalCap & 0x3F; -+ PHY_SetBBReg(Adapter, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCap | (CrystalCap << 6))); -+ } -+ -+ if(IS_HARDWARE_TYPE_JAGUAR(Adapter)) -+ { -+ pHalData->Reg837 = rtw_read8(Adapter, 0x837); -+ } -+ -+ return rtStatus; -+ -+} -+ -+int -+PHY_RFConfig8812( -+ PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rtStatus = _SUCCESS; -+ -+ if (Adapter->bSurpriseRemoved) -+ return _FAIL; -+ -+ switch(pHalData->rf_chip) -+ { -+ case RF_PSEUDO_11N: -+ DBG_871X("%s(): RF_PSEUDO_11N\n",__FUNCTION__); -+ break; -+ default: -+ rtStatus = PHY_RF6052_Config_8812(Adapter); -+ break; -+ } -+ -+ return rtStatus; -+} -+ -+bool -+eqNByte( -+ const u8* str1, -+ u8* str2, -+ u32 num -+ ) -+{ -+ if(num==0) -+ return false; -+ while(num>0) -+ { -+ num--; -+ if(str1[num]!=str2[num]) -+ return false; -+ } -+ return true; -+} -+ -+bool -+GetU1ByteIntegerFromStringInDecimal( -+ const s8* Str, -+ u8* pInt -+ ) -+{ -+ u16 i = 0; -+ *pInt = 0; -+ -+ while ( Str[i] != '\0' ) -+ { -+ if ( Str[i] >= '0' && Str[i] <= '9' ) -+ { -+ *pInt *= 10; -+ *pInt += ( Str[i] - '0' ); -+ } -+ else -+ { -+ return false; -+ } -+ ++i; -+ } -+ -+ return true; -+} -+ -+static s8 -+phy_GetChannelGroup( -+ BAND_TYPE Band, -+ u8 Channel -+ ) -+{ -+ s8 channelGroup = -1; -+ if ( Channel <= 14 && Band == BAND_ON_2_4G ) -+ { -+ if ( 1 <= Channel && Channel <= 2 ) channelGroup = 0; -+ else if ( 3 <= Channel && Channel <= 5 ) channelGroup = 1; -+ else if ( 6 <= Channel && Channel <= 8 ) channelGroup = 2; -+ else if ( 9 <= Channel && Channel <= 11 ) channelGroup = 3; -+ else if ( 12 <= Channel && Channel <= 14) channelGroup = 4; -+ else -+ { -+ DBG_871X( "==> phy_GetChannelGroup() in 2.4 G, but Channel %d in Group not found \n", Channel ); -+ channelGroup = -1; -+ } -+ } -+ else if( Band == BAND_ON_5G ) -+ { -+ if ( 36 <= Channel && Channel <= 42 ) channelGroup = 0; -+ else if ( 44 <= Channel && Channel <= 48 ) channelGroup = 1; -+ else if ( 50 <= Channel && Channel <= 58 ) channelGroup = 2; -+ else if ( 60 <= Channel && Channel <= 64 ) channelGroup = 3; -+ else if ( 100 <= Channel && Channel <= 106 ) channelGroup = 4; -+ else if ( 108 <= Channel && Channel <= 114 ) channelGroup = 5; -+ else if ( 116 <= Channel && Channel <= 122 ) channelGroup = 6; -+ else if ( 124 <= Channel && Channel <= 130 ) channelGroup = 7; -+ else if ( 132 <= Channel && Channel <= 138 ) channelGroup = 8; -+ else if ( 140 <= Channel && Channel <= 144 ) channelGroup = 9; -+ else if ( 149 <= Channel && Channel <= 155 ) channelGroup = 10; -+ else if ( 157 <= Channel && Channel <= 161 ) channelGroup = 11; -+ else if ( 165 <= Channel && Channel <= 171 ) channelGroup = 12; -+ else if ( 173 <= Channel && Channel <= 177 ) channelGroup = 13; -+ else -+ { -+ DBG_871X("==>phy_GetChannelGroup() in 5G, but Channel %d in Group not found \n", Channel ); -+ channelGroup = -1; -+ } -+ } -+ else -+ { -+ DBG_871X("==>phy_GetChannelGroup() in unsupported band %d\n", Band ); -+ channelGroup = -1; -+ } -+ -+ return channelGroup; -+} -+ -+u8 -+phy_getPowerByRateBaseIndex( -+ BAND_TYPE Band, -+ u8 Rate -+ ) -+{ -+ u8 index = 0; -+ if ( Band == BAND_ON_2_4G ) -+ { -+ switch ( Rate ) -+ { -+ case MGN_1M: case MGN_2M: case MGN_5_5M: case MGN_11M: -+ index = 0; -+ break; -+ -+ case MGN_6M: case MGN_9M: case MGN_12M: case MGN_18M: -+ case MGN_24M: case MGN_36M: case MGN_48M: case MGN_54M: -+ index = 1; -+ break; -+ -+ case MGN_MCS0: case MGN_MCS1: case MGN_MCS2: case MGN_MCS3: -+ case MGN_MCS4: case MGN_MCS5: case MGN_MCS6: case MGN_MCS7: -+ index = 2; -+ break; -+ -+ case MGN_MCS8: case MGN_MCS9: case MGN_MCS10: case MGN_MCS11: -+ case MGN_MCS12: case MGN_MCS13: case MGN_MCS14: case MGN_MCS15: -+ index = 3; -+ break; -+ -+ default: -+ DBG_871X("Wrong rate 0x%x to obtain index in 2.4G in phy_getPowerByRateBaseIndex()\n", Rate ); -+ break; -+ } -+ } -+ else if ( Band == BAND_ON_5G ) -+ { -+ switch ( Rate ) -+ { -+ case MGN_6M: case MGN_9M: case MGN_12M: case MGN_18M: -+ case MGN_24M: case MGN_36M: case MGN_48M: case MGN_54M: -+ index = 0; -+ break; -+ -+ case MGN_MCS0: case MGN_MCS1: case MGN_MCS2: case MGN_MCS3: -+ case MGN_MCS4: case MGN_MCS5: case MGN_MCS6: case MGN_MCS7: -+ index = 1; -+ break; -+ -+ case MGN_MCS8: case MGN_MCS9: case MGN_MCS10: case MGN_MCS11: -+ case MGN_MCS12: case MGN_MCS13: case MGN_MCS14: case MGN_MCS15: -+ index = 2; -+ break; -+ -+ case MGN_VHT1SS_MCS0: case MGN_VHT1SS_MCS1: case MGN_VHT1SS_MCS2: -+ case MGN_VHT1SS_MCS3: case MGN_VHT1SS_MCS4: case MGN_VHT1SS_MCS5: -+ case MGN_VHT1SS_MCS6: case MGN_VHT1SS_MCS7: case MGN_VHT1SS_MCS8: -+ case MGN_VHT1SS_MCS9: -+ index = 3; -+ break; -+ -+ case MGN_VHT2SS_MCS0: case MGN_VHT2SS_MCS1: case MGN_VHT2SS_MCS2: -+ case MGN_VHT2SS_MCS3: case MGN_VHT2SS_MCS4: case MGN_VHT2SS_MCS5: -+ case MGN_VHT2SS_MCS6: case MGN_VHT2SS_MCS7: case MGN_VHT2SS_MCS8: -+ case MGN_VHT2SS_MCS9: -+ index = 4; -+ break; -+ -+ default: -+ DBG_871X("Wrong rate 0x%x to obtain index in 5G in phy_getPowerByRateBaseIndex()\n", Rate ); -+ break; -+ } -+ } -+ -+ return index; -+} -+ -+void -+PHY_InitPowerLimitTable( -+ PDM_ODM_T pDM_Odm -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 i, j, k, l, m; -+ -+ //DBG_871X( "=====> PHY_InitPowerLimitTable()!\n" ); -+ -+ for ( i = 0; i < MAX_REGULATION_NUM; ++i ) -+ { -+ for ( j = 0; j < MAX_2_4G_BANDWITH_NUM; ++j ) -+ for ( k = 0; k < MAX_2_4G_RATE_SECTION_NUM; ++k ) -+ for ( m = 0; m < MAX_2_4G_CHANNEL_NUM; ++m ) -+ for ( l = 0; l < GET_HAL_RFPATH_NUM(Adapter) ;++l ) -+ pHalData->TxPwrLimit_2_4G[i][j][k][m][l] = MAX_POWER_INDEX; -+ } -+ -+ for ( i = 0; i < MAX_REGULATION_NUM; ++i ) -+ { -+ for ( j = 0; j < MAX_5G_BANDWITH_NUM; ++j ) -+ for ( k = 0; k < MAX_5G_RATE_SECTION_NUM; ++k ) -+ for ( m = 0; m < MAX_5G_CHANNEL_NUM; ++m ) -+ for ( l = 0; l < GET_HAL_RFPATH_NUM(Adapter) ; ++l ) -+ pHalData->TxPwrLimit_5G[i][j][k][m][l] = MAX_POWER_INDEX; -+ } -+ -+ //DBG_871X("<===== PHY_InitPowerLimitTable()!\n" ); -+} -+ -+void -+PHY_ConvertPowerLimitToPowerIndex( -+ PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 BW40PwrBasedBm2_4G, BW40PwrBasedBm5G; -+ u8 regulation, bw, channel, rateSection, group; -+ u8 baseIndex2_4G; -+ u8 baseIndex5G; -+ s8 tempValue = 0, tempPwrLmt = 0; -+ u8 rfPath = 0; -+ -+ DBG_871X( "=====> PHY_ConvertPowerLimitToPowerIndex()\n" ); -+ for ( regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation ) -+ { -+ for ( bw = 0; bw < MAX_2_4G_BANDWITH_NUM; ++bw ) -+ { -+ for ( group = 0; group < MAX_2_4G_CHANNEL_NUM; ++group ) -+ { -+ if ( group == 0 ) -+ channel = 1; -+ else if ( group == 1 ) -+ channel = 3; -+ else if ( group == 2 ) -+ channel = 6; -+ else if ( group == 3 ) -+ channel = 9; -+ else if ( group == 4 ) -+ channel = 12; -+ else -+ channel = 14; -+ -+ -+ for ( rateSection = 0; rateSection < MAX_2_4G_RATE_SECTION_NUM; ++rateSection ) -+ { -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) { -+ // obtain the base dBm values in 2.4G band -+ // CCK => 11M, OFDM => 54M, HT 1T => MCS7, HT 2T => MCS15 -+ if ( rateSection == 0 ) { //CCK -+ baseIndex2_4G = phy_getPowerByRateBaseIndex( BAND_ON_2_4G, MGN_11M ); -+ } -+ else if ( rateSection == 1 ) { //OFDM -+ baseIndex2_4G = phy_getPowerByRateBaseIndex( BAND_ON_2_4G, MGN_54M ); -+ } -+ else if ( rateSection == 2 ) { //HT IT -+ baseIndex2_4G = phy_getPowerByRateBaseIndex( BAND_ON_2_4G, MGN_MCS7 ); -+ } -+ else if ( rateSection == 3 ) { //HT 2T -+ baseIndex2_4G = phy_getPowerByRateBaseIndex( BAND_ON_2_4G, MGN_MCS15 ); -+ } -+ } -+ -+ // we initially record the raw power limit value in rf path A, so we must obtain the raw -+ // power limit value by using index rf path A and use it to calculate all the value of -+ // all the path -+ tempPwrLmt = pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][group][ODM_RF_PATH_A]; -+ // process ODM_RF_PATH_A later -+ for ( rfPath = 0; rfPath < MAX_RF_PATH_NUM; ++rfPath ) -+ { -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) -+ BW40PwrBasedBm2_4G = pHalData->TxPwrByRateBase2_4G[rfPath][baseIndex2_4G]; -+ else -+ BW40PwrBasedBm2_4G = Adapter->registrypriv.RegPowerBase * 2; -+ -+ if ( tempPwrLmt != MAX_POWER_INDEX ) { -+ tempValue = tempPwrLmt - BW40PwrBasedBm2_4G; -+ pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][group][rfPath] = tempValue; -+ } -+ -+ DBG_871X("TxPwrLimit_2_4G[regulation %d][bw %d][rateSection %d][group %d] %d=\n\ -+ (TxPwrLimit in dBm %d - BW40PwrLmt2_4G[channel %d][rfPath %d] %d) \n", -+ regulation, bw, rateSection, group, pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][group][rfPath], -+ tempPwrLmt, channel, rfPath, BW40PwrBasedBm2_4G ); -+ } -+ } -+ } -+ } -+ } -+ -+ if ( IS_HARDWARE_TYPE_8812( Adapter ) || IS_HARDWARE_TYPE_8821( Adapter ) ) -+ { -+ for ( regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation ) -+ { -+ for ( bw = 0; bw < MAX_5G_BANDWITH_NUM; ++bw ) -+ { -+ for ( group = 0; group < MAX_5G_CHANNEL_NUM; ++group ) -+ { -+ -+ /* channels of 5G band in Hal_ReadTxPowerInfo8812A() -+ 36,38,40,42,44, -+ 46,48,50,52,54, -+ 56,58,60,62,64, -+ 100,102,104,106,108, -+ 110,112,114,116,118, -+ 120,122,124,126,128, -+ 130,132,134,136,138, -+ 140,142,144,149,151, -+ 153,155,157,159,161, -+ 163,165,167,168,169, -+ 171,173,175,177 */ -+ if ( group == 0 ) -+ channel = 0; // index of chnl 36 in channel5G -+ else if ( group == 1 ) -+ channel = 4; // index of chnl 44 in chanl5G -+ else if ( group == 2 ) -+ channel = 7; // index of chnl 50 in chanl5G -+ else if ( group == 3 ) -+ channel = 12; // index of chnl 60 in chanl5G -+ else if ( group == 4 ) -+ channel = 15; // index of chnl 100 in chanl5G -+ else if ( group == 5 ) -+ channel = 19; // index of chnl 108 in chanl5G -+ else if ( group == 6 ) -+ channel = 23; // index of chnl 116 in chanl5G -+ else if ( group == 7 ) -+ channel = 27; // index of chnl 124 in chanl5G -+ else if ( group == 8 ) -+ channel = 31; // index of chnl 132 in chanl5G -+ else if ( group == 9 ) -+ channel = 35; // index of chnl 140 in chanl5G -+ else if ( group == 10 ) -+ channel = 38; // index of chnl 149 in chanl5G -+ else if ( group == 11 ) -+ channel = 42; // index of chnl 157 in chanl5G -+ else if ( group == 12 ) -+ channel = 46; // index of chnl 165 in chanl5G -+ else -+ channel = 51; // index of chnl 173 in chanl5G -+ -+ for ( rateSection = 1; rateSection < MAX_5G_RATE_SECTION_NUM; ++rateSection ) -+ { -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) { -+ // obtain the base dBm values in 5G band -+ // OFDM => 54M, HT 1T => MCS7, HT 2T => MCS15, -+ // VHT => 1SSMCS7, VHT 2T => 2SSMCS7 -+ if ( rateSection == 1 ) { //OFDM -+ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_54M ); -+ } -+ else if ( rateSection == 2 ) { //HT 1T -+ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_MCS7 ); -+ } -+ else if ( rateSection == 3 ) { //HT 2T -+ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_MCS15 ); -+ } -+ else if ( rateSection == 4 ) { //VHT 1T -+ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_VHT1SS_MCS7 ); -+ } -+ else if ( rateSection == 5 ) { //VHT 2T -+ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_VHT2SS_MCS7 ); -+ } -+ } -+ -+ // we initially record the raw power limit value in rf path A, so we must obtain the raw -+ // power limit value by using index rf path A and use it to calculate all the value of -+ // all the path -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation][bw][rateSection][group][ODM_RF_PATH_A]; -+ if ( tempPwrLmt == MAX_POWER_INDEX ) -+ { -+ if ( bw == 0 || bw == 1 ) { // 5G VHT and HT can cross reference -+ DBG_871X( "No power limit table of the specified band %d, bandwidth %d, ratesection %d, group %d, rf path %d\n", -+ 1, bw, rateSection, group, ODM_RF_PATH_A ); -+ if ( rateSection == 2 ) { -+ pHalData->TxPwrLimit_5G[regulation][bw][2][group][ODM_RF_PATH_A] = -+ pHalData->TxPwrLimit_5G[regulation][bw][4][group][ODM_RF_PATH_A]; -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] -+ [bw][4][group][ODM_RF_PATH_A]; -+ } -+ else if ( rateSection == 4 ) { -+ pHalData->TxPwrLimit_5G[regulation][bw][4][group][ODM_RF_PATH_A] = -+ pHalData->TxPwrLimit_5G[regulation][bw][2][group][ODM_RF_PATH_A]; -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] -+ [bw][2][group][ODM_RF_PATH_A]; -+ } -+ else if ( rateSection == 3 ) { -+ pHalData->TxPwrLimit_5G[regulation][bw][3][group][ODM_RF_PATH_A] = -+ pHalData->TxPwrLimit_5G[regulation][bw][5][group][ODM_RF_PATH_A]; -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] -+ [bw][5][group][ODM_RF_PATH_A]; -+ } -+ else if ( rateSection == 5 ) { -+ pHalData->TxPwrLimit_5G[regulation][bw][5][group][ODM_RF_PATH_A] = -+ pHalData->TxPwrLimit_5G[regulation][bw][3][group][ODM_RF_PATH_A]; -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] -+ [bw][3][group][ODM_RF_PATH_A]; -+ } -+ -+ DBG_871X("use other value %d", tempPwrLmt); -+ } -+ } -+ -+ // process ODM_RF_PATH_A later -+ for ( rfPath = ODM_RF_PATH_B; rfPath < MAX_RF_PATH_NUM; ++rfPath ) -+ { -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) -+ BW40PwrBasedBm5G = pHalData->TxPwrByRateBase5G[rfPath][baseIndex5G]; -+ else -+ BW40PwrBasedBm5G = Adapter->registrypriv.RegPowerBase * 2; -+ -+ if ( tempPwrLmt != MAX_POWER_INDEX ) { -+ tempValue = tempPwrLmt - BW40PwrBasedBm5G; -+ pHalData->TxPwrLimit_5G[regulation][bw][rateSection][group][rfPath] = tempValue; -+ } -+ -+ DBG_871X("TxPwrLimit_5G[regulation %d][bw %d][rateSection %d][group %d] %d=\n\ -+ (TxPwrLimit in dBm %d - BW40PwrLmt5G[channel %d][rfPath %d] %d) \n", -+ regulation, bw, rateSection, group, pHalData->TxPwrLimit_5G[regulation][bw][rateSection][group][rfPath], -+ tempPwrLmt, channel, rfPath, BW40PwrBasedBm5G ); -+ } -+ -+ } -+ -+ } -+ } -+ } -+ -+ // process value of ODM_RF_PATH_A -+ for ( regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation ) -+ { -+ for ( bw = 0; bw < MAX_5G_BANDWITH_NUM; ++bw ) -+ { -+ for ( group = 0; group < MAX_5G_CHANNEL_NUM; ++group ) -+ { -+ if ( group == 0 ) -+ channel = 0; // index of chnl 36 in channel5G -+ else if ( group == 1 ) -+ channel = 4; // index of chnl 44 in chanl5G -+ else if ( group == 2 ) -+ channel = 7; // index of chnl 50 in chanl5G -+ else if ( group == 3 ) -+ channel = 12; // index of chnl 60 in chanl5G -+ else if ( group == 4 ) -+ channel = 15; // index of chnl 100 in chanl5G -+ else if ( group == 5 ) -+ channel = 19; // index of chnl 108 in chanl5G -+ else if ( group == 6 ) -+ channel = 23; // index of chnl 116 in chanl5G -+ else if ( group == 7 ) -+ channel = 27; // index of chnl 124 in chanl5G -+ else if ( group == 8 ) -+ channel = 31; // index of chnl 132 in chanl5G -+ else if ( group == 9 ) -+ channel = 35; // index of chnl 140 in chanl5G -+ else if ( group == 10 ) -+ channel = 38; // index of chnl 149 in chanl5G -+ else if ( group == 11 ) -+ channel = 42; // index of chnl 157 in chanl5G -+ else if ( group == 12 ) -+ channel = 46; // index of chnl 165 in chanl5G -+ else -+ channel = 51; // index of chnl 173 in chanl5G -+ -+ for ( rateSection = 0; rateSection < MAX_5G_RATE_SECTION_NUM; ++rateSection ) -+ { -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) { -+ // obtain the base dBm values in 5G band -+ // OFDM => 54M, HT 1T => MCS7, HT 2T => MCS15, -+ // VHT => 1SSMCS7, VHT 2T => 2SSMCS7 -+ if ( rateSection == 1 ) { //OFDM -+ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_54M ); -+ } -+ else if ( rateSection == 2 ) { //HT 1T -+ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_MCS7 ); -+ } -+ else if ( rateSection == 3 ) { //HT 2T -+ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_MCS15 ); -+ } -+ else if ( rateSection == 4 ) { //VHT 1T -+ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_VHT1SS_MCS7 ); -+ } -+ else if ( rateSection == 5 ) { //VHT 2T -+ baseIndex5G = phy_getPowerByRateBaseIndex( BAND_ON_5G, MGN_VHT2SS_MCS7 ); -+ } -+ } -+ -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation][bw][rateSection][group][ODM_RF_PATH_A]; -+ if ( tempPwrLmt == MAX_POWER_INDEX ) -+ { -+ if ( bw == 0 || bw == 1 ) { // 5G VHT and HT can cross reference -+ DBG_871X("No power limit table of the specified band %d, bandwidth %d, ratesection %d, group %d, rf path %d\n", -+ 1, bw, rateSection, group, ODM_RF_PATH_A ); -+ if ( rateSection == 2 ) -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] -+ [bw][4][group][ODM_RF_PATH_A]; -+ else if ( rateSection == 4 ) -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] -+ [bw][2][group][ODM_RF_PATH_A]; -+ else if ( rateSection == 3 ) -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] -+ [bw][5][group][ODM_RF_PATH_A]; -+ else if ( rateSection == 5 ) -+ tempPwrLmt = pHalData->TxPwrLimit_5G[regulation] -+ [bw][3][group][ODM_RF_PATH_A]; -+ -+ DBG_871X("use other value %d", tempPwrLmt ); -+ } -+ } -+ -+ -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) -+ BW40PwrBasedBm5G = pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][baseIndex5G]; -+ else -+ BW40PwrBasedBm5G = Adapter->registrypriv.RegPowerBase * 2; -+ -+ if ( tempPwrLmt != MAX_POWER_INDEX ) { -+ tempValue = tempPwrLmt - BW40PwrBasedBm5G; -+ pHalData->TxPwrLimit_5G[regulation][bw][rateSection][group][ODM_RF_PATH_A] = tempValue; -+ } -+ -+ DBG_871X("TxPwrLimit_5G[regulation %d][bw %d][rateSection %d][group %d] %d=\n\ -+ (TxPwrLimit in dBm %d - BW40PwrLmt5G[channel %d][rfPath %d] %d) \n", -+ regulation, bw, rateSection, group, pHalData->TxPwrLimit_5G[regulation][bw][rateSection][group][ODM_RF_PATH_A], -+ tempPwrLmt, channel, ODM_RF_PATH_A, BW40PwrBasedBm5G ); -+ } -+ } -+ } -+ } -+ } -+ DBG_871X("<===== PHY_ConvertPowerLimitToPowerIndex()\n" ); -+} -+ -+void -+PHY_SetPowerLimitTableValue( -+ PDM_ODM_T pDM_Odm, -+ const s8* Regulation, -+ const s8* Band, -+ const s8* Bandwidth, -+ const s8* RateSection, -+ const s8* RfPath, -+ const s8* Channel, -+ const s8* PowerLimit -+ ) -+{ -+ PADAPTER Adapter = pDM_Odm->Adapter; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA( Adapter ); -+ u8 regulation=0, bandwidth=0, rateSection=0, -+ channel, powerLimit, channelGroup; -+ -+ DBG_871X( "Index of power limit table \ -+ [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s][val %s]\n", -+ Band, Regulation, Bandwidth, RateSection, RfPath, Channel, PowerLimit ) ; -+ -+ if ( !GetU1ByteIntegerFromStringInDecimal( Channel, &channel ) || -+ !GetU1ByteIntegerFromStringInDecimal( PowerLimit, &powerLimit ) ) -+ { -+ DBG_871X("Illegal index of power limit table [chnl %s][val %s]\n", Channel, PowerLimit ); -+ } -+ -+ powerLimit = powerLimit > MAX_POWER_INDEX ? MAX_POWER_INDEX : powerLimit; -+ -+ if ( eqNByte( Regulation, "FCC", 3 ) ) regulation = 0; -+ else if ( eqNByte( Regulation, "MKK", 3 ) ) regulation = 1; -+ else if ( eqNByte( Regulation, "ETSI", 4 ) ) regulation = 2; -+ -+ if ( eqNByte( RateSection, "CCK", 3 ) ) -+ rateSection = 0; -+ else if ( eqNByte( RateSection, "OFDM", 4 ) ) -+ rateSection = 1; -+ else if ( eqNByte( RateSection, "HT", 2 ) && eqNByte( RfPath, "1T", 2 ) ) -+ rateSection = 2; -+ else if ( eqNByte( RateSection, "HT", 2 ) && eqNByte( RfPath, "2T", 2 ) ) -+ rateSection = 3; -+ else if ( eqNByte( RateSection, "VHT", 3 ) && eqNByte( RfPath, "1T", 2 ) ) -+ rateSection = 4; -+ else if ( eqNByte( RateSection, "VHT", 3 ) && eqNByte( RfPath, "2T", 2 ) ) -+ rateSection = 5; -+ -+ -+ if ( eqNByte( Bandwidth, "20M", 3 ) ) bandwidth = 0; -+ else if ( eqNByte( Bandwidth, "40M", 3 ) ) bandwidth = 1; -+ else if ( eqNByte( Bandwidth, "80M", 3 ) ) bandwidth = 2; -+ else if ( eqNByte( Bandwidth, "160M", 4 ) ) bandwidth = 3; -+ -+ if ( eqNByte( Band, "2.4G", 4 ) ) -+ { -+ DBG_871X( "2.4G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n", -+ regulation, bandwidth, rateSection, channel, powerLimit ); -+ channelGroup = phy_GetChannelGroup( BAND_ON_2_4G, channel ); -+ pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelGroup][ODM_RF_PATH_A] = powerLimit; -+ } -+ else if ( eqNByte( Band, "5G", 2 ) ) -+ { -+ DBG_871X("5G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n", -+ regulation, bandwidth, rateSection, channel, powerLimit ); -+ channelGroup = phy_GetChannelGroup( BAND_ON_5G, channel ); -+ pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelGroup][ODM_RF_PATH_A] = powerLimit; -+ } -+ else -+ { -+ DBG_871X("Cannot recognize the band info in %s\n", Band ); -+ return; -+ } -+} -+ -+u8 -+PHY_GetPowerLimitValue( -+ PADAPTER Adapter, -+ u32 RegPwrTblSel, -+ BAND_TYPE Band, -+ CHANNEL_WIDTH Bandwidth, -+ RF_PATH RfPath, -+ u8 DataRate, -+ u8 Channel -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ s16 band = -1, regulation = -1, bandwidth = -1, -+ rfPath = -1, rateSection = -1, channelGroup = -1; -+ u8 powerLimit = MAX_POWER_INDEX; -+ -+ if ( ( Adapter->registrypriv.RegEnableTxPowerLimit == 0 && pHalData->EEPROMRegulatory != 1 ) || -+ pHalData->EEPROMRegulatory == 2 ) -+ return MAX_POWER_INDEX; -+ -+ switch( RegPwrTblSel ) -+ { -+ case 1: -+ regulation = TXPWR_LMT_ETSI; -+ break; -+ case 2: -+ regulation = TXPWR_LMT_MKK; -+ break; -+ case 3: -+ regulation = TXPWR_LMT_FCC; -+ break; -+ -+ default: -+ regulation = TXPWR_LMT_FCC; -+ break; -+ } -+ //DBG_871X("pregistrypriv->RegPwrTblSel %d\n", RegPwrTblSel); -+ -+ -+ if ( Band == BAND_ON_2_4G ) band = 0; -+ else if ( Band == BAND_ON_5G ) band = 1; -+ -+ if ( Bandwidth == CHANNEL_WIDTH_20 ) bandwidth = 0; -+ else if ( Bandwidth == CHANNEL_WIDTH_40 ) bandwidth = 1; -+ else if ( Bandwidth == CHANNEL_WIDTH_80 ) bandwidth = 2; -+ else if ( Bandwidth == CHANNEL_WIDTH_160 ) bandwidth = 3; -+ -+ switch ( DataRate ) -+ { -+ case MGN_1M: case MGN_2M: case MGN_5_5M: case MGN_11M: -+ rateSection = 0; -+ break; -+ -+ case MGN_6M: case MGN_9M: case MGN_12M: case MGN_18M: -+ case MGN_24M: case MGN_36M: case MGN_48M: case MGN_54M: -+ rateSection = 1; -+ break; -+ -+ case MGN_MCS0: case MGN_MCS1: case MGN_MCS2: case MGN_MCS3: -+ case MGN_MCS4: case MGN_MCS5: case MGN_MCS6: case MGN_MCS7: -+ rateSection = 2; -+ break; -+ -+ case MGN_MCS8: case MGN_MCS9: case MGN_MCS10: case MGN_MCS11: -+ case MGN_MCS12: case MGN_MCS13: case MGN_MCS14: case MGN_MCS15: -+ rateSection = 3; -+ break; -+ -+ case MGN_VHT1SS_MCS0: case MGN_VHT1SS_MCS1: case MGN_VHT1SS_MCS2: -+ case MGN_VHT1SS_MCS3: case MGN_VHT1SS_MCS4: case MGN_VHT1SS_MCS5: -+ case MGN_VHT1SS_MCS6: case MGN_VHT1SS_MCS7: case MGN_VHT1SS_MCS8: -+ case MGN_VHT1SS_MCS9: -+ rateSection = 4; -+ break; -+ -+ case MGN_VHT2SS_MCS0: case MGN_VHT2SS_MCS1: case MGN_VHT2SS_MCS2: -+ case MGN_VHT2SS_MCS3: case MGN_VHT2SS_MCS4: case MGN_VHT2SS_MCS5: -+ case MGN_VHT2SS_MCS6: case MGN_VHT2SS_MCS7: case MGN_VHT2SS_MCS8: -+ case MGN_VHT2SS_MCS9: -+ rateSection = 5; -+ break; -+ -+ default: -+ DBG_871X("Wrong rate 0x%x\n", DataRate ); -+ break; -+ } -+ -+ if ( BAND_ON_2_4G && rateSection > 3 ) -+ DBG_871X("Wrong rate 0x%x: No VHT in 2.4G Band\n", DataRate ); -+ if ( BAND_ON_5G && rateSection == 0 ) -+ DBG_871X("Wrong rate 0x%x: No CCK in 5G Band\n", DataRate ); -+ -+ // workaround for wrong index combination to obtain tx power limit, -+ // OFDM only exists in BW 20M -+ if ( rateSection == 1 ) -+ bandwidth = 0; -+ -+ // workaround for wrong indxe combination to obtain tx power limit, -+ // HT on 80M will reference to HT on 40M -+ if ( ( rateSection == 2 || rateSection == 3 ) && Band == BAND_ON_5G && bandwidth == 2 ) { -+ bandwidth = 1; -+ } -+ -+ if ( Band == BAND_ON_2_4G ) -+ channelGroup = phy_GetChannelGroup( BAND_ON_2_4G, Channel ); -+ else if ( Band == BAND_ON_5G ) -+ channelGroup = phy_GetChannelGroup( BAND_ON_5G, Channel ); -+ else if ( Band == BAND_ON_BOTH ) -+ { -+ // BAND_ON_BOTH don't care temporarily -+ } -+ -+ if ( band == -1 || regulation == -1 || bandwidth == -1 || -+ rateSection == -1 || channelGroup == -1 ) -+ { -+ DBG_871X("Wrong index value to access power limit table \ -+ [band %d][regulation %d][bandwidth %d][rf_path %d][rate_section %d][chnlGroup %d]\n", -+ band, regulation, bandwidth, RfPath, rateSection, channelGroup ); -+ -+ return 0xFF; -+ } -+ -+ if ( Band == BAND_ON_2_4G ) -+ powerLimit = pHalData->TxPwrLimit_2_4G[regulation] -+ [bandwidth][rateSection][channelGroup][RfPath]; -+ else if ( Band == BAND_ON_5G ) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][rateSection][channelGroup][RfPath]; -+ else -+ DBG_871X("No power limit table of the specified band\n" ); -+ -+ // combine 5G VHT & HT rate -+ // 5G 20M and 40M HT and VHT can cross reference -+ /*if ( Band == BAND_ON_5G && powerLimit == MAX_POWER_INDEX ) { -+ if ( bandwidth == 0 || bandwidth == 1 ) { -+ if ( rateSection == 2 ) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][4][channelGroup][RfPath]; -+ else if ( rateSection == 4 ) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][2][channelGroup][RfPath]; -+ else if ( rateSection == 3 ) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][5][channelGroup][RfPath]; -+ else if ( rateSection == 5 ) -+ powerLimit = pHalData->TxPwrLimit_5G[regulation] -+ [bandwidth][3][channelGroup][RfPath]; -+ } -+ }*/ -+ -+ //DBG_871X("TxPwrLmt[Regulation %d][Band %d][BW %d][RFPath %d][Rate 0x%x][Chnl %d] = %d\n", -+ // regulation, pHalData->CurrentBandType, Bandwidth, RfPath, DataRate, Channel, powerLimit); -+ -+ return powerLimit; -+} -+ -+ -+// -+// 2012/10/18 -+// -+void -+PHY_StorePwrByRateIndexVhtSeries( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 rf_path, rate_section; -+ -+ // -+ // For VHT series TX power by rate table. -+ // VHT TX power by rate off setArray = -+ // Band:-2G&5G = 0 / 1 -+ // RF: at most 4*4 = ABCD=0/1/2/3 -+ // CCK=0 11/5.5/2/1 -+ // OFDM=1/2 18/12/9/6 54/48/36/24 -+ // HT=3/4/56 MCS0-3 MCS4-7 MCS8-11 MCS12-15 -+ // VHT=7/8/9/10/11 1SSMCS0-3 1SSMCS4-7 2SSMCS1/0/1SSMCS/9/8 2SSMCS2-5 -+ // -+ // #define TX_PWR_BY_RATE_NUM_BAND 2 -+ // #define TX_PWR_BY_RATE_NUM_RF 4 -+ // #define TX_PWR_BY_RATE_NUM_SECTION 12 -+ // -+ -+ // -+ // 1. Judge TX power by rate array band type. -+ // -+ //if(RegAddr == rTxAGC_A_CCK11_CCK1_JAguar || RegAddr == rTxAGC_B_CCK11_CCK1_JAguar) -+ if ((RegAddr & 0xFFF) == 0xC20) -+ { -+ pHalData->TxPwrByRateTable++; // Record that it is the first data to record. -+ pHalData->TxPwrByRateBand = 0; -+ } -+ -+ if ((RegAddr & 0xFFF) == 0xe20) -+ { -+ pHalData->TxPwrByRateTable++; // The value should be 2 now. -+ } -+ -+ if ((RegAddr & 0xFFF) == 0xC24 && pHalData->TxPwrByRateTable != 1) -+ { -+ pHalData->TxPwrByRateTable++; // The value should be 3 bow. -+ pHalData->TxPwrByRateBand = 1; -+ } -+ -+ // -+ // 2. Judge TX power by rate array RF type -+ // -+ if ((RegAddr & 0xF00) == 0xC00) -+ { -+ rf_path = 0; -+ } -+ else if ((RegAddr & 0xF00) == 0xE00) -+ { -+ rf_path = 1; -+ } -+ -+ // -+ // 3. Judge TX power by rate array rate section -+ // -+ if (rf_path == 0) -+ { -+ rate_section = (u8)((RegAddr&0xFFF)-0xC20)/4; -+ } -+ else if (rf_path == 1) -+ { -+ rate_section = (u8)((RegAddr&0xFFF)-0xE20)/4; -+ } -+ -+ pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section] = Data; -+ //DBG_871X("VHT TxPwrByRateOffset Addr-%x==>BAND/RF/SEC=%d/%d/%d = %08x\n", -+ // RegAddr, pHalData->TxPwrByRateBand, rf_path, rate_section, Data); -+ -+} -+ -+void -+phy_ChangePGDataFromExactToRelativeValue( -+ u32* pData, -+ u8 Start, -+ u8 End, -+ u8 BaseValue -+ ) -+{ -+ s8 i = 0; -+ u8 TempValue = 0; -+ u32 TempData = 0; -+ //BaseValue = ( BaseValue & 0xf ) + ( ( BaseValue >> 4 ) & 0xf ) * 10; -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("Corrected BaseValue %u\n", BaseValue ) ); -+ -+ for ( i = 3; i >= 0; --i ) -+ { -+ if ( i >= Start && i <= End ) -+ { -+ // Get the exact value -+ TempValue = ( u8 ) ( *pData >> ( i * 8 ) ) & 0xF; -+ TempValue += ( ( u8 ) ( ( *pData >> ( i * 8 + 4 ) ) & 0xF ) ) * 10; -+ -+ // Change the value to a relative value -+ TempValue = ( TempValue > BaseValue ) ? TempValue - BaseValue : BaseValue - TempValue; -+ } -+ else -+ { -+ TempValue = ( u8 ) ( *pData >> ( i * 8 ) ) & 0xFF; -+ } -+ -+ -+ -+ TempData <<= 8; -+ TempData |= TempValue; -+ } -+ -+ *pData = TempData; -+} -+ -+void phy_PreprocessVHTPGDataFromExactToRelativeValue( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32* pData -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 rf_path, rate_section, BaseValue = 0; -+ // -+ // For VHT series TX power by rate table. -+ // VHT TX power by rate off setArray = -+ // Band:-2G&5G = 0 / 1 -+ // RF: at most 4*4 = ABCD=0/1/2/3 -+ // CCK=0 11/5.5/2/1 -+ // OFDM=1/2 18/12/9/6 54/48/36/24 -+ // HT=3/4/56 MCS0-3 MCS4-7 MCS8-11 MCS12-15 -+ // VHT=7/8/9/10/11 1SSMCS0-3 1SSMCS4-7 2SSMCS1/0/1SSMCS/9/8 2SSMCS2-5 -+ // -+ // #define TX_PWR_BY_RATE_NUM_BAND 2 -+ // #define TX_PWR_BY_RATE_NUM_RF 4 -+ // #define TX_PWR_BY_RATE_NUM_SECTION 12 -+ // -+ // Judge TX power by rate array RF type -+ // -+ if ( ( RegAddr & 0xF00 ) == 0xC00 ) -+ { -+ rf_path = 0; -+ } -+ else if ( ( RegAddr & 0xF00 ) == 0xE00 ) -+ { -+ rf_path = 1; -+ } -+ -+ // -+ // Judge TX power by rate array rate section -+ // -+ if ( rf_path == 0 ) -+ { -+ rate_section = ( u8) ( ( RegAddr & 0xFFF ) - 0xC20 ) / 4; -+ } -+ else if ( rf_path == 1 ) -+ { -+ rate_section = ( u8 ) ( ( RegAddr & 0xFFF ) - 0xE20 ) / 4; -+ } -+ -+ switch ( RegAddr ) -+ { -+ case 0xC20: -+ case 0xE20: -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("RegAddr %x\n", RegAddr )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); -+ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); -+ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); -+ break; -+ -+ case 0xC28: -+ case 0xE28: -+ case 0xC30: -+ case 0xE30: -+ case 0xC38: -+ case 0xE38: -+ -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("RegAddr %x\n", RegAddr )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section - 1, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] )); -+ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); -+ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( -+ &( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] ), -+ 0, 3, BaseValue); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section - 1, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] )); -+ break; -+ -+ case 0xC44: -+ case 0xE44: -+ -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("RegAddr %x\n", RegAddr )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section - 1, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section - 2, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 2] )); -+ BaseValue = ( ( u8 ) ( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] >> 28 ) & 0xF ) * 10 + -+ ( ( u8 ) ( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] >> 24 ) & 0xF ); -+ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 1, BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( -+ &( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] ), -+ 0, 3, BaseValue); -+ phy_ChangePGDataFromExactToRelativeValue( -+ &( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 2] ), -+ 0, 3, BaseValue); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section - 1, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section - 2, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 2] )); -+ break; -+ -+ case 0xC4C: -+ case 0xE4C: -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("RegAddr %x\n", RegAddr )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section - 1, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, before changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section - 2, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 2] )); -+ BaseValue = ( ( u8 ) ( *pData >> 12 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 8 ) & 0xF ); -+ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( -+ &( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] ), -+ 0, 3, BaseValue); -+ phy_ChangePGDataFromExactToRelativeValue( -+ &( pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 2] ), -+ 2, 3, BaseValue); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section, *pData )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section - 1, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 1] )); -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("pHalData->TxPwrByRateOffset[%d][%d][%d] = 0x%x, after changing to relative\n", -+ // pHalData->TxPwrByRateBand, rf_path, rate_section - 2, pHalData->TxPwrByRateOffset[pHalData->TxPwrByRateBand][rf_path][rate_section - 2] )); -+ break; -+ } -+} -+ -+void -+phy_PreprocessPGDataFromExactToRelativeValue( -+ PADAPTER Adapter, -+ u4Byte RegAddr, -+ u4Byte BitMask, -+ pu4Byte pData -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u1Byte BaseValue = 0; -+ -+ if ( RegAddr == rTxAGC_A_Rate54_24 ) -+ { -+ //DBG_871X("RegAddr %x\n", RegAddr ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, before changing to relative\n", -+ // pHalData->pwrGroupCnt, *pData ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, before changing to relative\n", -+ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0] ); -+ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); -+ //DBG_871X("BaseValue = %d\n", BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0] ), -+ 0, 3, BaseValue); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x, after changing to relative\n", -+ // pHalData->pwrGroupCnt, *pData ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x, after changing to relative\n", -+ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0] ); -+ } -+ -+ if ( RegAddr == rTxAGC_A_CCK1_Mcs32 ) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][6] = *pData; -+ //DBG_871X("MCSTxPowerLevelOriginalOffset[%d][6] = 0x%x\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][6]); -+ } -+ -+ if ( RegAddr == rTxAGC_B_CCK11_A_CCK2_11 && BitMask == 0xffffff00 ) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][7] = *pData; -+ //DBG_871X("MCSTxPowerLevelOriginalOffset[%d][7] = 0x%x\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][7]); -+ } -+ -+ if ( RegAddr == rTxAGC_A_Mcs07_Mcs04 ) -+ { -+ //DBG_871X("RegAddr %x\n", RegAddr ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, before changing to relative\n", -+ // pHalData->pwrGroupCnt, *pData ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, before changing to relative\n", -+ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][2] ); -+ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); -+ //DBG_871X("BaseValue = %d\n", BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][2] ), -+ 0, 3, BaseValue); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x, after changing to relative\n", -+ // pHalData->pwrGroupCnt, *pData ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x, after changing to relative\n", -+ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][2] ); -+ } -+ -+ if ( RegAddr == rTxAGC_A_Mcs11_Mcs08 ) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4] = *pData; -+ //DBG_871X("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4]); -+ } -+ -+ if ( RegAddr == rTxAGC_A_Mcs15_Mcs12 ) -+ { -+ //DBG_871X("RegAddr %x\n", RegAddr ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, before changing to relative\n", -+ // pHalData->pwrGroupCnt, *pData ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, before changing to relative\n", -+ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4] ); -+ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); -+ //DBG_871X("BaseValue = %d\n", BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4] ), -+ 0, 3, BaseValue); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x, after changing to relative\n", -+ // pHalData->pwrGroupCnt, *pData ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x, after changing to relative\n", -+ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4] ); -+ } -+ -+ if ( RegAddr == rTxAGC_B_Rate54_24 ) -+ { -+ //DBG_871X("RegAddr %x\n", RegAddr ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][9] = 0x%x, before changing to relative\n", -+ // pHalData->pwrGroupCnt, *pData ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][8] = 0x%x, before changing to relative\n", -+ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][8] ); -+ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); -+ //DBG_871X("BaseValue = %d\n", BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][8] ), -+ 0, 3, BaseValue); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][9] = 0x%x, after changing to relative\n", -+ // pHalData->pwrGroupCnt, *pData ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][8] = 0x%x, after changing to relative\n", -+ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][8] ); -+ -+ } -+ -+ if ( RegAddr == rTxAGC_B_CCK1_55_Mcs32 ) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][14] = *pData; -+ //DBG_871X("MCSTxPowerLevelOriginalOffset[%d][14] = 0x%x\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][14]); -+ } -+ -+ if ( RegAddr == rTxAGC_B_CCK11_A_CCK2_11 && BitMask == 0x000000ff ) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][15] = *pData; -+ //DBG_871X("MCSTxPowerLevelOriginalOffset[%d][15] = 0x%x\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][15]); -+ } -+ -+ if ( RegAddr == rTxAGC_B_Mcs07_Mcs04 ) -+ { -+ //DBG_871X("RegAddr %x\n", RegAddr ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][11] = 0x%x, before changing to relative\n", -+ // pHalData->pwrGroupCnt, *pData ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][10] = 0x%x, before changing to relative\n", -+ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][10] ); -+ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); -+ //DBG_871X("BaseValue = %d\n", BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][10] ), -+ 0, 3, BaseValue); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][11] = 0x%x, after changing to relative\n", -+ // pHalData->pwrGroupCnt, *pData ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][10] = 0x%x, after changing to relative\n", -+ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][10] ); -+ } -+ -+ if ( RegAddr == rTxAGC_B_Mcs15_Mcs12 ) -+ { -+ //DBG_871X("RegAddr %x\n", RegAddr ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][13] = 0x%x, before changing to relative\n", -+ // pHalData->pwrGroupCnt, *pData ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][12] = 0x%x, before changing to relative\n", -+ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][12] ); -+ BaseValue = ( ( u8 ) ( *pData >> 28 ) & 0xF ) *10 + ( ( u8 ) ( *pData >> 24 ) & 0xF ); -+ //DBG_871X("BaseValue = %d\n", BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( pData, 0, 3, BaseValue ); -+ phy_ChangePGDataFromExactToRelativeValue( -+ &( pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][12] ), -+ 0, 3, BaseValue); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][13] = 0x%x, after changing to relative\n", -+ // pHalData->pwrGroupCnt, *pData ); -+ //DBG_871X("pHalData->MCSTxPowerLevelOriginalOffset[%d][12] = 0x%x, after changing to relative\n", -+ // pHalData->pwrGroupCnt, pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][12] ); -+ } -+ -+ -+ -+ // -+ // 1. Judge TX power by rate array band type. -+ // -+ //if(RegAddr == rTxAGC_A_CCK11_CCK1_JAguar || RegAddr == rTxAGC_B_CCK11_CCK1_JAguar) -+ -+ if ( IS_HARDWARE_TYPE_8812( Adapter ) || -+ IS_HARDWARE_TYPE_8821( Adapter ) ) -+ { -+ phy_PreprocessVHTPGDataFromExactToRelativeValue( Adapter, RegAddr, -+ BitMask, pData ); -+ } -+ -+} -+ -+void -+phy_StorePwrByRateIndexBase( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 Data -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 Base = 0; -+ -+ -+ if( pHalData->TxPwrByRateTable == 1 && pHalData->TxPwrByRateBand == 0 ) // 2.4G -+ { -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) -+ { -+ Base = ( ( ( u8 ) ( Data >> 28 ) & 0xF ) * 10 + -+ ( ( u8 ) ( Data >> 24 ) & 0xF ) ); -+ -+ switch( RegAddr ) { -+ case 0xC20: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][0] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of CCK (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][0] ) ); -+ break; -+ case 0xC28: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][1] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of OFDM 54M (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][1] ) ); -+ break; -+ case 0xC30: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][2] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS7 (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][2] ) ); -+ break; -+ case 0xC38: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][3] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS15 (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][3] ) ); -+ break; -+ default: -+ break; -+ }; -+ } -+ else -+ { -+ Base = ( u8 ) ( Data >> 24 ); -+ switch( RegAddr ) { -+ case 0xC20: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][0] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of CCK (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][0] ) ); -+ break; -+ case 0xC28: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][1] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of OFDM 54M (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][1] ) ); -+ break; -+ case 0xC30: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][2] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS7 (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][2] ) ); -+ break; -+ case 0xC38: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][3] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS15 (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][3] ) ); -+ break; -+ default: -+ break; -+ }; -+ } -+ } -+ else if ( pHalData->TxPwrByRateTable == 3 && pHalData->TxPwrByRateBand == 1 ) // 5G -+ { -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) -+ { -+ Base = ( ( ( u8 ) ( Data >> 28 ) & 0xF ) * 10 + -+ ( ( u8 ) ( Data >> 24 ) & 0xF ) ); -+ -+ switch( RegAddr ) -+ { -+ case 0xC28: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][0] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of OFDM 54M (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][0] ) ); -+ break; -+ case 0xC30: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][1] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS7 (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][1] ) ); -+ break; -+ case 0xC38: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][2] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS15 (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][2] ) ); -+ break; -+ case 0xC40: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][3] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 1SS MCS7 (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][3] ) ); -+ break; -+ case 0xC4C: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][4] = -+ ( u8 ) ( ( Data >> 12 ) & 0xF ) * 10 + -+ ( u8 ) ( ( Data >> 8 ) & 0xF ); -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 2SS MCS7 (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][4] ) ); -+ break; -+ case 0xE28: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][0] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of OFDM 54M (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][0] ) ); -+ break; -+ case 0xE30: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][1] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS7 (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][1] ) ); -+ break; -+ case 0xE38: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][2] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS15 (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][2] ) ); -+ break; -+ case 0xE40: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][3] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 1SS MCS7 (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][3] ) ); -+ break; -+ case 0xE4C: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][4] = -+ ( u8 ) ( ( Data >> 12 ) & 0xF ) * 10 + -+ ( u8 ) ( ( Data >> 8 ) & 0xF ); -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 2SS MCS7 (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][4] ) ); -+ break; -+ default: -+ break; -+ }; -+ } -+ else -+ { -+ Base = ( u8 ) ( Data >> 24 ); -+ switch( RegAddr ) { -+ case 0xC28: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][0] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of OFDM 54M (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][0] ) ); -+ break; -+ case 0xC30: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][1] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS7 (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][1] ) ); -+ break; -+ case 0xC38: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][2] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS15 (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][2] ) ); -+ break; -+ case 0xC40: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][3] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 1SS MCS7 (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][3] ) ); -+ break; -+ case 0xC4C: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][4] = ( u8 ) ( ( Data >> 8 ) & 0xFF ); -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 2SS MCS7 (RF path A) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_A][4] ) ); -+ break; -+ case 0xE28: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][0] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of OFDM 54M (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][0] ) ); -+ break; -+ case 0xE30: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][1] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS7 (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][1] ) ); -+ break; -+ case 0xE38: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][2] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of MCS15 (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][2] ) ); -+ break; -+ case 0xE40: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][3] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 1SS MCS7 (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][3] ) ); -+ break; -+ case 0xE4C: -+ pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][4] = ( u8 ) ( ( Data >> 8 ) & 0xFF ); -+ //RT_DISP(FPHY, PHY_TXPWR, ("5G power by rate of 2SS MCS7 (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase5G[ODM_RF_PATH_B][4] ) ); -+ break; -+ default: -+ break; -+ }; -+ } -+ } -+ else if( pHalData->TxPwrByRateTable == 2 && pHalData->TxPwrByRateBand == 0 ) // 2.4G -+ { -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) -+ { -+ Base = ( ( ( u8 ) ( Data >> 28 ) & 0xF ) * 10 + -+ ( ( u8 ) ( Data >> 24 ) & 0xF ) ); -+ -+ switch( RegAddr ) { -+ case 0xE20: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][0] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of CCK (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][0] ) ); -+ break; -+ case 0xE28: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][1] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of OFDM 54M (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][1] ) ); -+ break; -+ case 0xE30: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][2] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS7 (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][2] ) ); -+ break; -+ case 0xE38: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][3] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS15 (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][3] ) ); -+ break; -+ default: -+ break; -+ }; -+ -+ } -+ else -+ { -+ Base = ( u8 ) ( Data >> 24 ); -+ switch( RegAddr ) { -+ case 0xC20: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][0] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of CCK (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][0] ) ); -+ break; -+ case 0xC28: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][1] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of OFDM 54M (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][1] ) ); -+ break; -+ case 0xC30: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][2] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS7 (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][2] ) ); -+ break; -+ case 0xC38: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][3] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS15 (RF path B) = %d\n", -+ // pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][3] ) ); -+ break; -+ default: -+ break; -+ }; -+ } -+ } -+ -+ //-------------- following code is for 88E ----------------// -+ -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) -+ { -+ Base = ( u8 ) ( ( Data >> 28 ) & 0xF ) * 10 + -+ ( u8 ) ( ( Data >> 24 ) & 0xF ); -+ } -+ else -+ { -+ Base = ( u8 ) ( ( Data >> 24 ) & 0xFF ); -+ } -+ -+ switch ( RegAddr ) -+ { -+ -+ case rTxAGC_A_Rate54_24: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][1] = Base; -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][1] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of OFDM 54M (RF path A) = %d\n", pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][1])); -+ break; -+ case rTxAGC_A_Mcs07_Mcs04: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][2] = Base; -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][2] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS7 (RF path A) = %d\n", pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][2])); -+ break; -+ case rTxAGC_A_Mcs15_Mcs12: -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][3] = Base; -+ pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_B][3] = Base; -+ //RT_DISP(FPHY, PHY_TXPWR, ("2.4G power by rate of MCS15 (RF path A) = %d\n", pHalData->TxPwrByRateBase2_4G[ODM_RF_PATH_A][3])); -+ break; -+ default: -+ break; -+ -+ }; -+} -+ -+void -+storePwrIndexDiffRateOffset( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u32 tmpData = Data; -+ -+ // If the pHalData->DM_OutSrc.PhyRegPgValueType == 1, which means that the data in PHY_REG_PG data are -+ // exact value, we must change them into relative values -+ if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE ) -+ { -+ //DBG_871X("PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE\n"); -+ phy_PreprocessPGDataFromExactToRelativeValue( Adapter, RegAddr, BitMask, &Data ); -+ //DBG_871X("Data = 0x%x, tmpData = 0x%x\n", Data, tmpData ); -+ } -+ -+ // -+ // 2012/09/26 MH Add for VHT series. The power by rate table is diffeent as before. -+ // 2012/10/24 MH Add description for the old tx power by rate method is only used -+ // for 11 n series. T -+ // -+ if (IS_HARDWARE_TYPE_8812(Adapter) || -+ IS_HARDWARE_TYPE_8821(Adapter)) -+ { -+ PHY_StorePwrByRateIndexVhtSeries(Adapter, RegAddr, BitMask, Data); -+ } -+ -+ // Awk add to stroe the base power by rate value -+ phy_StorePwrByRateIndexBase(Adapter, RegAddr, tmpData ); -+ -+ if(RegAddr == rTxAGC_A_Rate18_06) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0])); -+ } -+ if(RegAddr == rTxAGC_A_Rate54_24) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][1] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][1])); -+ } -+ if(RegAddr == rTxAGC_A_CCK1_Mcs32) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][6] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][6] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][6])); -+ } -+ if(RegAddr == rTxAGC_B_CCK11_A_CCK2_11 && BitMask == 0xffffff00) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][7] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][7] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][7])); -+ } -+ if(RegAddr == rTxAGC_A_Mcs03_Mcs00) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][2] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][2])); -+ } -+ if(RegAddr == rTxAGC_A_Mcs07_Mcs04) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][3] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][3])); -+ } -+ if(RegAddr == rTxAGC_A_Mcs11_Mcs08) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][4])); -+ } -+ if(RegAddr == rTxAGC_A_Mcs15_Mcs12) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][5] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][5])); -+ if(pHalData->rf_type== RF_1T1R) -+ { -+ pHalData->pwrGroupCnt++; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("pwrGroupCnt = %d\n", pHalData->pwrGroupCnt)); -+ } -+ } -+ if(RegAddr == rTxAGC_B_Rate18_06) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][8] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][8] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][8])); -+ } -+ if(RegAddr == rTxAGC_B_Rate54_24) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][9] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][9] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][9])); -+ } -+ if(RegAddr == rTxAGC_B_CCK1_55_Mcs32) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][14] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][14] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][14])); -+ } -+ if(RegAddr == rTxAGC_B_CCK11_A_CCK2_11 && BitMask == 0x000000ff) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][15] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][15] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][15])); -+ } -+ if(RegAddr == rTxAGC_B_Mcs03_Mcs00) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][10] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][10] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][10])); -+ } -+ if(RegAddr == rTxAGC_B_Mcs07_Mcs04) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][11] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][11] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][11])); -+ } -+ if(RegAddr == rTxAGC_B_Mcs11_Mcs08) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][12] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][12] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][12])); -+ } -+ if(RegAddr == rTxAGC_B_Mcs15_Mcs12) -+ { -+ pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][13] = Data; -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("MCSTxPowerLevelOriginalOffset[%d][13] = 0x%lx\n", pHalData->pwrGroupCnt, -+ // pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][13])); -+ if(pHalData->rf_type != RF_1T1R) -+ pHalData->pwrGroupCnt++; -+ } -+} -+ -+static u8 -+phy_DbmToTxPwrIdx( -+ PADAPTER Adapter, -+ WIRELESS_MODE WirelessMode, -+ int PowerInDbm -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 TxPwrIdx = 0; -+ s32 Offset = 0; -+ -+#if 0 -+ // -+ // Tested by MP, we found that CCK Index 0 equals to 8dbm, OFDM legacy equals to -+ // 3dbm, and OFDM HT equals to 0dbm repectively. -+ // Note: -+ // The mapping may be different by different NICs. Do not use this formula for what needs accurate result. -+ // By Bruce, 2008-01-29. -+ // -+ switch(WirelessMode) -+ { -+ case WIRELESS_MODE_B: -+ //Offset = -7; -+ Offset = -6; // For 88 RU test only -+ TxPwrIdx = (u8)((pHalData->OriginalCckTxPwrIdx*( PowerInDbm-pHalData->MinCCKDbm))/(pHalData->MaxCCKDbm-pHalData->MinCCKDbm)); -+ break; -+ -+ case WIRELESS_MODE_G: -+ case WIRELESS_MODE_N_24G: -+ Offset = -8; -+ TxPwrIdx = (u8)((pHalData->OriginalOfdm24GTxPwrIdx* (PowerInDbm-pHalData->MinHOFDMDbm))/(pHalData->MaxHOFDMDbm-pHalData->MinHOFDMDbm)); -+ break; -+ -+ default: //for MacOSX compiler warning -+ break; -+ } -+ -+ if (PowerInDbm <= pHalData->MinCCKDbm || -+ PowerInDbm <= pHalData->MinLOFDMDbm || -+ PowerInDbm <= pHalData->MinHOFDMDbm) -+ { -+ TxPwrIdx = 0; -+ } -+ -+ // Simple judge to prevent tx power exceed the limitation. -+ if (PowerInDbm >= pHalData->MaxCCKDbm || -+ PowerInDbm >= pHalData->MaxLOFDMDbm || -+ PowerInDbm >= pHalData->MaxHOFDMDbm) -+ { -+ if (WirelessMode == WIRELESS_MODE_B) -+ TxPwrIdx = pHalData->OriginalCckTxPwrIdx; -+ else -+ TxPwrIdx = pHalData->OriginalOfdm24GTxPwrIdx; -+ } -+#endif -+ return TxPwrIdx; -+} -+ -+static int -+phy_TxPwrIdxToDbm( -+ PADAPTER Adapter, -+ WIRELESS_MODE WirelessMode, -+ u8 TxPwrIdx -+ ) -+{ -+ int Offset = 0; -+ int PwrOutDbm = 0; -+ -+ // -+ // Tested by MP, we found that CCK Index 0 equals to -7dbm, OFDM legacy equals to -8dbm. -+ // Note: -+ // The mapping may be different by different NICs. Do not use this formula for what needs accurate result. -+ // By Bruce, 2008-01-29. -+ // -+ switch(WirelessMode) -+ { -+ case WIRELESS_MODE_B: -+ Offset = -7; -+ break; -+ -+ case WIRELESS_MODE_G: -+ case WIRELESS_MODE_N_24G: -+ Offset = -8; -+ break; -+ -+ default: //for MacOSX compiler warning -+ break; -+ } -+ -+ PwrOutDbm = TxPwrIdx / 2 + Offset; // Discard the decimal part. -+ -+ return PwrOutDbm; -+} -+ -+void -+PHY_GetTxPowerLevel8812( -+ PADAPTER Adapter, -+ u32* powerlevel -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 TxPwrLevel = 0; -+ int TxPwrDbm; -+#if 0 -+ // -+ // Because the Tx power indexes are different, we report the maximum of them to -+ // meet the CCX TPC request. By Bruce, 2008-01-31. -+ // -+ -+ // CCK -+ TxPwrLevel = pHalData->CurrentCckTxPwrIdx; -+ TxPwrDbm = phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_B, TxPwrLevel); -+ pHalData->MaxCCKDbm = TxPwrDbm; -+ -+ // Legacy OFDM -+ TxPwrLevel = pHalData->CurrentOfdm24GTxPwrIdx + pHalData->LegacyHTTxPowerDiff; -+ -+ // Compare with Legacy OFDM Tx power. -+ pHalData->MaxLOFDMDbm = phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_G, TxPwrLevel); -+ if(phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_G, TxPwrLevel) > TxPwrDbm) -+ TxPwrDbm = phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_G, TxPwrLevel); -+ -+ // HT OFDM -+ TxPwrLevel = pHalData->CurrentOfdm24GTxPwrIdx; -+ -+ // Compare with HT OFDM Tx power. -+ pHalData->MaxHOFDMDbm = phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_G, TxPwrLevel); -+ if(phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_N_24G, TxPwrLevel) > TxPwrDbm) -+ TxPwrDbm = phy_TxPwrIdxToDbm(Adapter, WIRELESS_MODE_N_24G, TxPwrLevel); -+ pHalData->MaxHOFDMDbm = TxPwrDbm; -+ -+ *powerlevel = TxPwrDbm; -+#endif -+} -+ -+void phy_PowerIndexCheck8812( -+ PADAPTER Adapter, -+ u8 channel, -+ u8 * cckPowerLevel, -+ u8 * ofdmPowerLevel, -+ u8 * BW20PowerLevel, -+ u8 * BW40PowerLevel -+ ) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ // Add or not ??? -+ -+ pHalData->CurrentCckTxPwrIdx = cckPowerLevel[0]; -+ pHalData->CurrentOfdm24GTxPwrIdx = ofdmPowerLevel[0]; -+ pHalData->CurrentBW2024GTxPwrIdx = BW20PowerLevel[0]; -+ pHalData->CurrentBW4024GTxPwrIdx = BW40PowerLevel[0]; -+} -+ -+bool -+phy_GetChnlIndex8812A( -+ u8 Channel, -+ u8* ChannelIdx -+ ) -+{ -+ u8 channel5G[CHANNEL_MAX_NUMBER_5G] = -+ {36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112, -+ 114,116,118,120,122,124,126,128,130,132,134,136,138,140,142,144,149,151, -+ 153,155,157,159,161,163,165,167,168,169,171,173,175,177}; -+ u8 i = 0; -+ bool bIn24G=true; -+ -+ if(Channel <= 14) -+ { -+ bIn24G=true; -+ *ChannelIdx = Channel -1; -+ } -+ else -+ { -+ bIn24G = false; -+ -+ for (i = 0; i < sizeof(channel5G)/sizeof(u8); ++i) -+ { -+ if ( channel5G[i] == Channel) { -+ *ChannelIdx = i; -+ return bIn24G; -+ } -+ } -+ } -+ return bIn24G; -+ -+} -+ -+// -+// For VHT series, we will use a new TX pwr by rate array to meet new spec. -+// -+u32 -+phy_GetTxPwrByRateOffset_8812( -+ PADAPTER pAdapter, -+ u8 Band, -+ u8 Rf_Path, -+ u8 Rate_Section -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 shift = 0, original_rate = Rate_Section; -+ u32 tx_pwr_diff = 0; -+ -+ // -+ // For VHT series TX power by rate table. -+ // VHT TX power by rate off setArray = -+ // Band:-2G&5G = 0 / 1 -+ // RF: at most 4*4 = ABCD=0/1/2/3 -+ // CCK=0 11/5.5/2/1 -+ // OFDM=1/2 18/12/9/6 54/48/36/24 -+ // HT=3/4/5/6 MCS0-3 MCS4-7 MCS8-11 MCS12-15 -+ // VHT=7/8/9/10/11 1SSMCS0-3 1SSMCS4-7 2SSMCS1/0/1SSMCS/9/8 2SSMCS2-5 -+ // -+ // #define TX_PWR_BY_RATE_NUM_BAND 2 -+ // #define TX_PWR_BY_RATE_NUM_RF 4 -+ // #define TX_PWR_BY_RATE_NUM_SECTION 12 -+ // -+ -+ switch (Rate_Section) -+ { -+ case MGN_1M: -+ case MGN_2M: -+ case MGN_5_5M: -+ case MGN_11M: -+ Rate_Section =0; -+ break; -+ -+ case MGN_6M: -+ case MGN_9M: -+ case MGN_12M: -+ case MGN_18M: -+ Rate_Section =1; -+ break; -+ -+ case MGN_24M: -+ case MGN_36M: -+ case MGN_48M: -+ case MGN_54M: -+ Rate_Section =2; -+ break; -+ -+ case MGN_MCS0: -+ case MGN_MCS1: -+ case MGN_MCS2: -+ case MGN_MCS3: -+ Rate_Section =3; -+ break; -+ -+ case MGN_MCS4: -+ case MGN_MCS5: -+ case MGN_MCS6: -+ case MGN_MCS7: -+ Rate_Section =4; -+ break; -+ -+ case MGN_MCS8: -+ case MGN_MCS9: -+ case MGN_MCS10: -+ case MGN_MCS11: -+ Rate_Section =5; -+ break; -+ -+ case MGN_MCS12: -+ case MGN_MCS13: -+ case MGN_MCS14: -+ case MGN_MCS15: -+ Rate_Section =6; -+ break; -+ -+ case MGN_VHT1SS_MCS0: -+ case MGN_VHT1SS_MCS1: -+ case MGN_VHT1SS_MCS2: -+ case MGN_VHT1SS_MCS3: -+ Rate_Section =7; -+ break; -+ -+ case MGN_VHT1SS_MCS4: -+ case MGN_VHT1SS_MCS5: -+ case MGN_VHT1SS_MCS6: -+ case MGN_VHT1SS_MCS7: -+ Rate_Section =8; -+ break; -+ -+ case MGN_VHT1SS_MCS8: -+ case MGN_VHT1SS_MCS9: -+ case MGN_VHT2SS_MCS0: -+ case MGN_VHT2SS_MCS1: -+ Rate_Section =9; -+ break; -+ -+ case MGN_VHT2SS_MCS2: -+ case MGN_VHT2SS_MCS3: -+ case MGN_VHT2SS_MCS4: -+ case MGN_VHT2SS_MCS5: -+ Rate_Section =10; -+ break; -+ -+ case MGN_VHT2SS_MCS6: -+ case MGN_VHT2SS_MCS7: -+ case MGN_VHT2SS_MCS8: -+ case MGN_VHT2SS_MCS9: -+ Rate_Section =11; -+ break; -+ -+ default: -+ DBG_871X("Rate_Section is Illegal\n"); -+ break; -+ } -+ -+ switch (original_rate) -+ { -+ case MGN_1M: shift = 0; break; -+ case MGN_2M: shift = 8; break; -+ case MGN_5_5M: shift = 16; break; -+ case MGN_11M: shift = 24; break; -+ -+ case MGN_6M: shift = 0; break; -+ case MGN_9M: shift = 8; break; -+ case MGN_12M: shift = 16; break; -+ case MGN_18M: shift = 24; break; -+ -+ case MGN_24M: shift = 0; break; -+ case MGN_36M: shift = 8; break; -+ case MGN_48M: shift = 16; break; -+ case MGN_54M: shift = 24; break; -+ -+ case MGN_MCS0: shift = 0; break; -+ case MGN_MCS1: shift = 8; break; -+ case MGN_MCS2: shift = 16; break; -+ case MGN_MCS3: shift = 24; break; -+ -+ case MGN_MCS4: shift = 0; break; -+ case MGN_MCS5: shift = 8; break; -+ case MGN_MCS6: shift = 16; break; -+ case MGN_MCS7: shift = 24; break; -+ -+ case MGN_MCS8: shift = 0; break; -+ case MGN_MCS9: shift = 8; break; -+ case MGN_MCS10: shift = 16; break; -+ case MGN_MCS11: shift = 24; break; -+ -+ case MGN_MCS12: shift = 0; break; -+ case MGN_MCS13: shift = 8; break; -+ case MGN_MCS14: shift = 16; break; -+ case MGN_MCS15: shift = 24; break; -+ -+ case MGN_VHT1SS_MCS0: shift = 0; break; -+ case MGN_VHT1SS_MCS1: shift = 8; break; -+ case MGN_VHT1SS_MCS2: shift = 16; break; -+ case MGN_VHT1SS_MCS3: shift = 24; break; -+ -+ case MGN_VHT1SS_MCS4: shift = 0; break; -+ case MGN_VHT1SS_MCS5: shift = 8; break; -+ case MGN_VHT1SS_MCS6: shift = 16; break; -+ case MGN_VHT1SS_MCS7: shift = 24; break; -+ -+ case MGN_VHT1SS_MCS8: shift = 0; break; -+ case MGN_VHT1SS_MCS9: shift = 8; break; -+ case MGN_VHT2SS_MCS0: shift = 16; break; -+ case MGN_VHT2SS_MCS1: shift = 24; break; -+ -+ case MGN_VHT2SS_MCS2: shift = 0; break; -+ case MGN_VHT2SS_MCS3: shift = 8; break; -+ case MGN_VHT2SS_MCS4: shift = 16; break; -+ case MGN_VHT2SS_MCS5: shift = 24; break; -+ -+ case MGN_VHT2SS_MCS6: shift = 0; break; -+ case MGN_VHT2SS_MCS7: shift = 8; break; -+ case MGN_VHT2SS_MCS8: shift = 16; break; -+ case MGN_VHT2SS_MCS9: shift = 24; break; -+ -+ default: -+ DBG_871X("Rate_Section is Illegal\n"); -+ break; -+ } -+ -+ // Willis suggest to adopt 5G VHT power by rate for 2.4G -+ if ( Band == BAND_ON_2_4G && ( Rate_Section >= 7 && Rate_Section <= 11 ) ) -+ Band = BAND_ON_5G; -+ -+ tx_pwr_diff = (pHalData->TxPwrByRateOffset[Band][Rf_Path][Rate_Section] >> shift) & 0xff; -+ -+ //DBG_871X("TxPwrByRateOffset-BAND(%d)-RF(%d)-RAS(%d)=%x tx_pwr_diff=%d shift=%d\n", -+ //Band, Rf_Path, Rate_Section, pHalData->TxPwrByRateOffset[Band][Rf_Path][Rate_Section], tx_pwr_diff, shift); -+ -+ return tx_pwr_diff; -+ -+} // phy_GetTxPwrByRateOffset_8812 -+ -+ -+// -+// Description: -+// Subtract number of TxPwr index from different advance settings. -+// -+// 2010.03.09, added by Roger. -+// -+void -+phy_TxPwrAdjInPercentage( -+ PADAPTER Adapter, -+ u8* pTxPwrIdx) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 TxPwrInPercentage = 0; -+ -+ // Retrieve default TxPwr index settings from registry. -+ TxPwrInPercentage = pHalData->TxPwrInPercentage; -+ -+ if(*pTxPwrIdx > RF6052_MAX_TX_PWR) -+ *pTxPwrIdx = RF6052_MAX_TX_PWR; -+ -+ // -+ // NEC Spec: dB = 10*log(X/Y), X: target value, Y: default value. -+ // For example: TxPower 50%, 10*log(50/100)=(nearly)-3dB -+ // 2010.07.26. -+ // -+ if(TxPwrInPercentage & TX_PWR_PERCENTAGE_0)// 12.5% , -9dB -+ { -+ *pTxPwrIdx -=18; -+ } -+ else if(TxPwrInPercentage & TX_PWR_PERCENTAGE_1)// 25%, -6dB -+ { -+ *pTxPwrIdx -=12; -+ } -+ else if(TxPwrInPercentage & TX_PWR_PERCENTAGE_2)// 50%, -3dB -+ { -+ *pTxPwrIdx -=6; -+ } -+ -+ if(*pTxPwrIdx > RF6052_MAX_TX_PWR) // Avoid underflow condition. -+ *pTxPwrIdx = RF6052_MAX_TX_PWR; -+} -+ -+/************************************************************************************************************** -+ * Description: -+ * The low-level interface to get the FINAL Tx Power Index , called by both MP and Normal Driver. -+ * -+ * <20120830, Kordan> -+ **************************************************************************************************************/ -+u32 -+PHY_GetTxPowerIndex_8812A( -+ PADAPTER pAdapter, -+ u8 RFPath, -+ u8 Rate, -+ CHANNEL_WIDTH BandWidth, -+ u8 Channel -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 i = 0; //default set to 1S -+ struct registry_priv *pregistrypriv = &pAdapter->registrypriv; -+ u32 powerDiffByRate = 0; -+ u32 txPower = 0; -+ u8 chnlIdx = (Channel-1); -+ bool bIn24G = false; -+ -+ //DBG_871X("===> PHY_GetTxPowerIndex_8812A\n"); -+ -+ if (HAL_IsLegalChannel(pAdapter, Channel) == false) -+ { -+ chnlIdx = 0; -+ DBG_871X("Illegal channel!!\n"); -+ } -+ -+ bIn24G = phy_GetChnlIndex8812A(Channel, &chnlIdx); -+ -+ //DBG_871X("[%s] Channel Index: %d\n", (bIn24G?"2.4G":"5G"), chnlIdx); -+ -+ if (bIn24G) //3 ============================== 2.4 G ============================== -+ { -+ if ( IS_CCK_RATE(Rate) ) -+ { -+ txPower = pHalData->Index24G_CCK_Base[RFPath][chnlIdx]; -+ } -+ else if ( MGN_6M <= Rate ) -+ { -+ txPower = pHalData->Index24G_BW40_Base[RFPath][chnlIdx]; -+ } -+ else -+ { -+ DBG_871X("===> mpt_ProQueryCaltxPower_Jaguar: INVALID Rate.\n"); -+ } -+ -+ //DBG_871X("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower); -+ -+ // OFDM-1T -+ if ( MGN_6M <= Rate && Rate <= MGN_54M && ! IS_CCK_RATE(Rate) ) -+ { -+ txPower += pHalData->OFDM_24G_Diff[RFPath][TX_1S]; -+ //DBG_871X("+PowerDiff 2.4G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_24G_Diff[RFPath][TX_1S]); -+ } -+ // BW20-1S, BW20-2S -+ if (BandWidth == CHANNEL_WIDTH_20) -+ { -+ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_1S]; -+ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) -+ txPower += pHalData->BW20_24G_Diff[RFPath][TX_2S]; -+ -+ //DBG_871X("+PowerDiff 2.4G (RF-%c): (BW20-1S, BW20-2S) = (%d, %d)\n", ((RFPath==0)?'A':'B'), -+ // pHalData->BW20_24G_Diff[RFPath][TX_1S], pHalData->BW20_24G_Diff[RFPath][TX_2S]); -+ } -+ // BW40-1S, BW40-2S -+ else if (BandWidth == CHANNEL_WIDTH_40) -+ { -+ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; -+ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; -+ -+ //DBG_871X("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S) = (%d, %d)\n", ((RFPath==0)?'A':'B'), -+ // pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S]); -+ } -+ // Willis suggest adopt BW 40M power index while in BW 80 mode -+ else if ( BandWidth == CHANNEL_WIDTH_80 ) -+ { -+ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; -+ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) -+ txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; -+ -+ //DBG_871X("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S) = (%d, %d) P.S. Current is in BW 80MHz\n", ((RFPath==0)?'A':'B'), -+ // pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S]); -+ } -+ -+ // -+ // 2012/09/26 MH Accordng to BB team's opinion, there might 40M VHT mode in the future.? -+ // We need to judge VHT mode by what? -+ // -+ } -+ else //3 ============================== 5 G ============================== -+ { -+ if ( MGN_6M <= Rate ) -+ { -+ txPower = pHalData->Index5G_BW40_Base[RFPath][chnlIdx]; -+ } -+ else -+ { -+ DBG_871X("===> mpt_ProQueryCalTxPower_Jaguar: INVALID Rate.\n"); -+ } -+ -+ //DBG_871X("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower); -+ -+ // OFDM-1T -+ if ( MGN_6M <= Rate && Rate <= MGN_54M && ! IS_CCK_RATE(Rate)) -+ { -+ txPower += pHalData->OFDM_5G_Diff[RFPath][TX_1S]; -+ //DBG_871X("+PowerDiff 5G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_5G_Diff[RFPath][TX_1S]); -+ } -+ -+ // BW20-1S, BW20-2S -+ if (BandWidth == CHANNEL_WIDTH_20) -+ { -+ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_1S]; -+ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) -+ txPower += pHalData->BW20_5G_Diff[RFPath][TX_2S]; -+ -+ //DBG_871X("+PowerDiff 5G (RF-%c): (BW20-1S, BW20-2S) = (%d, %d)\n", ((RFPath==0)?'A':'B'), -+ // pHalData->BW20_5G_Diff[RFPath][TX_1S], pHalData->BW20_5G_Diff[RFPath][TX_2S]); -+ } -+ // BW40-1S, BW40-2S -+ else if (BandWidth == CHANNEL_WIDTH_40) -+ { -+ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_1S]; -+ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) -+ txPower += pHalData->BW40_5G_Diff[RFPath][TX_2S]; -+ -+ //DBG_871X("+PowerDiff 5G(RF-%c): (BW40-1S, BW40-2S) = (%d, %d)\n", ((RFPath==0)?'A':'B'), -+ // pHalData->BW40_5G_Diff[RFPath][TX_1S], pHalData->BW40_5G_Diff[RFPath][TX_2S]); -+ } -+ // BW80-1S, BW80-2S -+ else if (BandWidth== CHANNEL_WIDTH_80) -+ { -+ // <20121220, Kordan> Get the index of array "Index5G_BW80_Base". -+ u8 channel5G_80M[CHANNEL_MAX_NUMBER_5G_80M] = {42, 58, 106, 122, 138, 155, 171}; -+ for (i = 0; i < sizeof(channel5G_80M)/sizeof(u8); ++i) -+ if ( channel5G_80M[i] == Channel) -+ chnlIdx = i; -+ -+ if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) -+ txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx] + pHalData->BW80_5G_Diff[RFPath][TX_1S]; -+ if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS15) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT2SS_MCS9)) -+ txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx] + pHalData->BW80_5G_Diff[RFPath][TX_1S] + pHalData->BW80_5G_Diff[RFPath][TX_2S]; -+ -+ //DBG_871X("+PowerDiff 5G(RF-%c): (BW80-1S, BW80-2S) = (%d, %d)\n", ((RFPath==0)?'A':'B'), -+ // pHalData->BW80_5G_Diff[RFPath][TX_1S], pHalData->BW80_5G_Diff[RFPath][TX_2S]); -+ } -+ } -+ -+ // Band:-2G&5G = 0 / 1 -+ // Becasue in the functionwe use the bIn24G = 1=2.4G. Then we need to convert the value. -+ // RF: at most 4*4 = ABCD=0/1/2/3 -+ // CCK=0 11/5.5/2/1 -+ // OFDM=1/2 18/12/9/6 54/48/36/24 -+ // HT=3/4/5/6 MCS0-3 MCS4-7 MCS8-11 MCS12-15 -+ // VHT=7/8/9/10/11 1SSMCS0-3 1SSMCS4-7 2SSMCS1/0/1SSMCS/9/8 2SSMCS2-5 -+ if (pregistrypriv->RegPwrByRate == false && pHalData->EEPROMRegulatory != 2) -+ { -+ powerDiffByRate = phy_GetTxPwrByRateOffset_8812(pAdapter, (u8)(!bIn24G), RFPath, Rate); -+ -+ if ( ( pregistrypriv->RegEnableTxPowerLimit == 1 && pHalData->EEPROMRegulatory != 2 ) || -+ pHalData->EEPROMRegulatory == 1 ) -+ { -+ u8 limit = 0; -+ limit = PHY_GetPowerLimitValue(pAdapter, pregistrypriv->RegPwrTblSel, (u8)(!bIn24G) ? BAND_ON_5G : BAND_ON_2_4G, BandWidth, (ODM_RF_RADIO_PATH_E)RFPath, Rate, Channel); -+ -+ if ( Rate == MGN_VHT1SS_MCS8 || Rate == MGN_VHT1SS_MCS9 || -+ Rate == MGN_VHT2SS_MCS8 || Rate == MGN_VHT2SS_MCS9 ) -+ { -+ if ( limit < 0 ) -+ { -+ if ( powerDiffByRate < -limit ) -+ powerDiffByRate = -limit; -+ } -+ } -+ else -+ { -+ if ( limit < 0 ) -+ powerDiffByRate = limit; -+ else -+ powerDiffByRate = powerDiffByRate > limit ? limit : powerDiffByRate; -+ } -+ //DBG_871X("Maximum power by rate %d, final power by rate %d\n", limit, powerDiffByRate ); -+ } -+ } -+ -+ //DBG_871X("Rate-%x txPower=%x +PowerDiffByRate(RF-%c) = %d\n", Rate, txPower, ((RFPath==0)?'A':'B'), powerDiffByRate); -+ -+ // We need to reduce power index for VHT MCS 8 & 9. -+ if (Rate == MGN_VHT1SS_MCS8 || Rate == MGN_VHT1SS_MCS9 || -+ Rate == MGN_VHT2SS_MCS8 || Rate == MGN_VHT2SS_MCS9) -+ { -+ txPower -= powerDiffByRate; -+ } -+ else -+ { -+ // -+ // 2013/01/29 MH For preventing VHT rate of 8812AU to be used in USB 2.0 mode -+ // and the current will be more than 500mA and card disappear. We need to limit -+ // TX power with any power by rate for VHT in U2. -+ // 2013/01/30 MH According to power current test compare with BCM AC NIC, we -+ // decide to use host hub = 2.0 mode to enable tx power limit behavior. -+ // -+ if (adapter_to_dvobj(pAdapter)->usb_speed <= RTW_USB_SPEED_2 && IS_HARDWARE_TYPE_8812AU(pAdapter)) -+ { -+ powerDiffByRate = 0; -+ } -+ -+ txPower += powerDiffByRate; -+ } -+ //DBG_871X("BASE ON HT MCS7\n"); -+ //DBG_871X("Final Tx Power(RF-%c, Channel: %d) = %d(0x%X)\n", ((RFPath==0)?'A':'B'), chnlIdx+1, txPower, txPower); -+ -+ if(pDM_Odm->Modify_TxAGC_Flag_PathA || pDM_Odm->Modify_TxAGC_Flag_PathB) //20130424 Mimic whether path A or B has to modify TxAGC -+ { -+ //DBG_871X("Before add Remanant_OFDMSwingIdx[rfpath %u] %d", txPower); -+ txPower += pDM_Odm->Remnant_OFDMSwingIdx[RFPath]; -+ //DBG_871X("After add Remanant_OFDMSwingIdx[rfpath %u] %d => txPower %d", RFPath, pDM_Odm->Remnant_OFDMSwingIdx[RFPath], txPower); -+ } -+ -+ if(txPower > MAX_POWER_INDEX) -+ txPower = MAX_POWER_INDEX; -+ -+ // 2012/09/26 MH We need to take care high power device limiation to prevent destroy EXT_PA. -+ // This case had ever happened in CU/SU high power module. THe limitation = 0x20. -+ // But for 8812, we still not know the value. -+ phy_TxPwrAdjInPercentage(pAdapter, (u8 *)&txPower); -+ -+ return txPower; -+} -+ -+/************************************************************************************************************** -+ * Description: -+ * The low-level interface to set TxAGC , called by both MP and Normal Driver. -+ * -+ * <20120830, Kordan> -+ **************************************************************************************************************/ -+ -+void -+PHY_SetTxPowerIndex_8812A( -+ PADAPTER Adapter, -+ u4Byte PowerIndex, -+ u1Byte RFPath, -+ u1Byte Rate -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ bool Direction = false; -+ u4Byte TxagcOffset = 0; -+ -+ // <20120928, Kordan> A workaround in 8812A/8821A testchip, to fix the bug of odd Tx power indexes. -+ if ( (PowerIndex % 2 == 1) && IS_HARDWARE_TYPE_JAGUAR(Adapter) && IS_TEST_CHIP(pHalData->VersionID) ) -+ PowerIndex -= 1; -+ -+ //2013.01.18 LukeLee: Modify TXAGC by dcmd_Dynamic_Ctrl() -+ if(RFPath == RF_PATH_A) -+ { -+ Direction = pHalData->odmpriv.IsTxagcOffsetPositiveA; -+ TxagcOffset = pHalData->odmpriv.TxagcOffsetValueA; -+ } -+ else if(RFPath == RF_PATH_B) -+ { -+ Direction = pHalData->odmpriv.IsTxagcOffsetPositiveB; -+ TxagcOffset = pHalData->odmpriv.TxagcOffsetValueB; -+ } -+ if(Direction == false) -+ { -+ if(PowerIndex > TxagcOffset) -+ PowerIndex -= TxagcOffset; -+ else -+ PowerIndex = 0; -+ } -+ else -+ { -+ PowerIndex += TxagcOffset; -+ if(PowerIndex > 0x3F) -+ PowerIndex = 0x3F; -+ } -+ -+ if (RFPath == RF_PATH_A) -+ { -+ switch (Rate) -+ { -+ case MGN_1M: PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_2M: PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_5_5M: PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_11M: PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_6M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm18_Ofdm6_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_9M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm18_Ofdm6_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_12M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm18_Ofdm6_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_18M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm18_Ofdm6_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_24M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm54_Ofdm24_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_36M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm54_Ofdm24_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_48M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm54_Ofdm24_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_54M: PHY_SetBBReg(Adapter, rTxAGC_A_Ofdm54_Ofdm24_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS0: PHY_SetBBReg(Adapter, rTxAGC_A_MCS3_MCS0_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS1: PHY_SetBBReg(Adapter, rTxAGC_A_MCS3_MCS0_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS2: PHY_SetBBReg(Adapter, rTxAGC_A_MCS3_MCS0_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS3: PHY_SetBBReg(Adapter, rTxAGC_A_MCS3_MCS0_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS4: PHY_SetBBReg(Adapter, rTxAGC_A_MCS7_MCS4_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS5: PHY_SetBBReg(Adapter, rTxAGC_A_MCS7_MCS4_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS6: PHY_SetBBReg(Adapter, rTxAGC_A_MCS7_MCS4_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS7: PHY_SetBBReg(Adapter, rTxAGC_A_MCS7_MCS4_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS8: PHY_SetBBReg(Adapter, rTxAGC_A_MCS11_MCS8_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS9: PHY_SetBBReg(Adapter, rTxAGC_A_MCS11_MCS8_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS10: PHY_SetBBReg(Adapter, rTxAGC_A_MCS11_MCS8_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS11: PHY_SetBBReg(Adapter, rTxAGC_A_MCS11_MCS8_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS12: PHY_SetBBReg(Adapter, rTxAGC_A_MCS15_MCS12_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS13: PHY_SetBBReg(Adapter, rTxAGC_A_MCS15_MCS12_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS14: PHY_SetBBReg(Adapter, rTxAGC_A_MCS15_MCS12_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS15: PHY_SetBBReg(Adapter, rTxAGC_A_MCS15_MCS12_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT1SS_MCS0: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index3_Nss1Index0_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT1SS_MCS1: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index3_Nss1Index0_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT1SS_MCS2: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index3_Nss1Index0_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT1SS_MCS3: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index3_Nss1Index0_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT1SS_MCS4: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index7_Nss1Index4_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT1SS_MCS5: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index7_Nss1Index4_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT1SS_MCS6: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index7_Nss1Index4_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT1SS_MCS7: PHY_SetBBReg(Adapter, rTxAGC_A_Nss1Index7_Nss1Index4_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT1SS_MCS8: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index1_Nss1Index8_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT1SS_MCS9: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index1_Nss1Index8_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT2SS_MCS0: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index1_Nss1Index8_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT2SS_MCS1: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index1_Nss1Index8_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT2SS_MCS2: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index5_Nss2Index2_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT2SS_MCS3: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index5_Nss2Index2_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT2SS_MCS4: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index5_Nss2Index2_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT2SS_MCS5: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index5_Nss2Index2_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT2SS_MCS6: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index9_Nss2Index6_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT2SS_MCS7: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index9_Nss2Index6_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT2SS_MCS8: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index9_Nss2Index6_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT2SS_MCS9: PHY_SetBBReg(Adapter, rTxAGC_A_Nss2Index9_Nss2Index6_JAguar, bMaskByte3, PowerIndex); break; -+ -+ default: -+ DBG_871X("Invalid Rate!!\n"); -+ break; -+ } -+ } -+ else if (RFPath == RF_PATH_B) -+ { -+ switch (Rate) -+ { -+ case MGN_1M: PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_2M: PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_5_5M: PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_11M: PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_6M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm18_Ofdm6_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_9M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm18_Ofdm6_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_12M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm18_Ofdm6_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_18M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm18_Ofdm6_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_24M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm54_Ofdm24_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_36M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm54_Ofdm24_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_48M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm54_Ofdm24_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_54M: PHY_SetBBReg(Adapter, rTxAGC_B_Ofdm54_Ofdm24_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS0: PHY_SetBBReg(Adapter, rTxAGC_B_MCS3_MCS0_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS1: PHY_SetBBReg(Adapter, rTxAGC_B_MCS3_MCS0_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS2: PHY_SetBBReg(Adapter, rTxAGC_B_MCS3_MCS0_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS3: PHY_SetBBReg(Adapter, rTxAGC_B_MCS3_MCS0_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS4: PHY_SetBBReg(Adapter, rTxAGC_B_MCS7_MCS4_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS5: PHY_SetBBReg(Adapter, rTxAGC_B_MCS7_MCS4_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS6: PHY_SetBBReg(Adapter, rTxAGC_B_MCS7_MCS4_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS7: PHY_SetBBReg(Adapter, rTxAGC_B_MCS7_MCS4_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS8: PHY_SetBBReg(Adapter, rTxAGC_B_MCS11_MCS8_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS9: PHY_SetBBReg(Adapter, rTxAGC_B_MCS11_MCS8_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS10: PHY_SetBBReg(Adapter, rTxAGC_B_MCS11_MCS8_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS11: PHY_SetBBReg(Adapter, rTxAGC_B_MCS11_MCS8_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_MCS12: PHY_SetBBReg(Adapter, rTxAGC_B_MCS15_MCS12_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_MCS13: PHY_SetBBReg(Adapter, rTxAGC_B_MCS15_MCS12_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_MCS14: PHY_SetBBReg(Adapter, rTxAGC_B_MCS15_MCS12_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_MCS15: PHY_SetBBReg(Adapter, rTxAGC_B_MCS15_MCS12_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT1SS_MCS0: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index3_Nss1Index0_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT1SS_MCS1: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index3_Nss1Index0_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT1SS_MCS2: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index3_Nss1Index0_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT1SS_MCS3: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index3_Nss1Index0_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT1SS_MCS4: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index7_Nss1Index4_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT1SS_MCS5: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index7_Nss1Index4_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT1SS_MCS6: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index7_Nss1Index4_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT1SS_MCS7: PHY_SetBBReg(Adapter, rTxAGC_B_Nss1Index7_Nss1Index4_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT1SS_MCS8: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index1_Nss1Index8_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT1SS_MCS9: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index1_Nss1Index8_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT2SS_MCS0: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index1_Nss1Index8_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT2SS_MCS1: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index1_Nss1Index8_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT2SS_MCS2: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index5_Nss2Index2_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT2SS_MCS3: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index5_Nss2Index2_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT2SS_MCS4: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index5_Nss2Index2_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT2SS_MCS5: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index5_Nss2Index2_JAguar, bMaskByte3, PowerIndex); break; -+ -+ case MGN_VHT2SS_MCS6: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index9_Nss2Index6_JAguar, bMaskByte0, PowerIndex); break; -+ case MGN_VHT2SS_MCS7: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index9_Nss2Index6_JAguar, bMaskByte1, PowerIndex); break; -+ case MGN_VHT2SS_MCS8: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index9_Nss2Index6_JAguar, bMaskByte2, PowerIndex); break; -+ case MGN_VHT2SS_MCS9: PHY_SetBBReg(Adapter, rTxAGC_B_Nss2Index9_Nss2Index6_JAguar, bMaskByte3, PowerIndex); break; -+ -+ default: -+ DBG_871X("Invalid Rate!!\n"); -+ break; -+ } -+ } -+ else -+ { -+ DBG_871X("Invalid RFPath!!\n"); -+ } -+} -+ -+void -+phy_SetTxPowerIndexByRateArray( -+ PADAPTER pAdapter, -+ u8 RFPath, -+ CHANNEL_WIDTH BandWidth, -+ u8 Channel, -+ u8* Rates, -+ u8 RateArraySize -+ ) -+{ -+ u32 powerIndex = 0; -+ int i = 0; -+ -+ for (i = 0; i < RateArraySize; ++i) -+ { -+ powerIndex = PHY_GetTxPowerIndex_8812A(pAdapter, RFPath, Rates[i], BandWidth, Channel); -+ -+ PHY_SetTxPowerIndex_8812A(pAdapter, powerIndex, RFPath, Rates[i]); -+ } -+ -+} -+ -+void -+PHY_GetTxPowerIndexByRateArray_8812A( -+ PADAPTER pAdapter, -+ u8 RFPath, -+ CHANNEL_WIDTH BandWidth, -+ u8 Channel, -+ u8* Rate, -+ u8* PowerIndex, -+ u8 ArraySize -+ ) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -+ u8 i; -+ for(i=0 ; iVersionID) ) -+ PowerIndex[i] -= 1; -+ } -+ -+} -+ -+void -+phy_TxPowerTrainingByPath_8812( -+ PADAPTER Adapter, -+ CHANNEL_WIDTH BandWidth, -+ u8 Channel, -+ u8 RfPath -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ u8 i; -+ u32 PowerLevel, writeData, writeOffset; -+ -+ if(RfPath >= pHalData->NumTotalRFPath) -+ return; -+ -+ writeData = 0; -+ if(RfPath == ODM_RF_PATH_A) -+ { -+ PowerLevel = PHY_GetTxPowerIndex_8812A(Adapter, ODM_RF_PATH_A, MGN_MCS7, BandWidth, Channel); -+ writeOffset = rA_TxPwrTraing_Jaguar; -+ } -+ else -+ { -+ PowerLevel = PHY_GetTxPowerIndex_8812A(Adapter, ODM_RF_PATH_B, MGN_MCS7, BandWidth, Channel); -+ writeOffset = rB_TxPwrTraing_Jaguar; -+ } -+ -+ for(i = 0; i < 3; i++) -+ { -+ if(i == 0) -+ PowerLevel = PowerLevel - 10; -+ else if(i == 1) -+ PowerLevel = PowerLevel - 8; -+ else -+ PowerLevel = PowerLevel - 6; -+ writeData |= (((PowerLevel > 2)?(PowerLevel):2) << (i * 8)); -+ } -+ -+ PHY_SetBBReg(Adapter, writeOffset, 0xffffff, writeData); -+} -+ -+void -+PHY_SetTxPowerLevelByPath8812( -+ PADAPTER Adapter, -+ u8 channel, -+ u8 path -+ ) -+{ -+ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ struct registry_priv *pregistrypriv = &Adapter->registrypriv; -+ u8 cckRates[] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}; -+ u8 ofdmRates[] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M}; -+ u8 htRates1T[] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}; -+ u8 htRates2T[] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}; -+ u8 vhtRates1T[] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4, -+ MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9}; -+ u8 vhtRates2T[] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, -+ MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9}; -+ -+ //DBG_871X("==>PHY_SetTxPowerLevelByPath8812()\n"); -+#if(MP_DRIVER == 1) -+ if (pregistrypriv->mp_mode == 1) -+ return; -+#endif -+ -+ //if(pMgntInfo->RegNByteAccess == 0) -+ { -+ if(pHalData->CurrentBandType == BAND_ON_2_4G) -+ phy_SetTxPowerIndexByRateArray(Adapter, path, pHalData->CurrentChannelBW, channel, -+ cckRates, sizeof(cckRates)/sizeof(u1Byte)); -+ -+ phy_SetTxPowerIndexByRateArray(Adapter, path, pHalData->CurrentChannelBW, channel, -+ ofdmRates, sizeof(ofdmRates)/sizeof(u1Byte)); -+ phy_SetTxPowerIndexByRateArray(Adapter, path, pHalData->CurrentChannelBW, channel, -+ htRates1T, sizeof(htRates1T)/sizeof(u1Byte)); -+ phy_SetTxPowerIndexByRateArray(Adapter, path, pHalData->CurrentChannelBW, channel, -+ vhtRates1T, sizeof(vhtRates1T)/sizeof(u1Byte)); -+ -+ if(pHalData->NumTotalRFPath >= 2) -+ { -+ phy_SetTxPowerIndexByRateArray(Adapter, path, pHalData->CurrentChannelBW, channel, -+ htRates2T, sizeof(htRates2T)/sizeof(u1Byte)); -+ phy_SetTxPowerIndexByRateArray(Adapter, path, pHalData->CurrentChannelBW, channel, -+ vhtRates2T, sizeof(vhtRates2T)/sizeof(u1Byte)); -+ } -+ } -+ phy_TxPowerTrainingByPath_8812(Adapter, pHalData->CurrentChannelBW, channel, path); -+} -+ -+//create new definition of PHY_SetTxPowerLevel8812 by YP. -+//Page revised on 20121106 -+//the new way to set tx power by rate, NByte access, here N byte shall be 4 byte(DWord) or NByte(N>4) access. by page/YP, 20121106 -+void -+PHY_SetTxPowerLevel8812( -+ PADAPTER Adapter, -+ u8 Channel -+ ) -+{ -+ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ u8 path = 0; -+ -+ for( path = ODM_RF_PATH_A; path < pHalData->NumTotalRFPath; ++path ) -+ { -+ PHY_SetTxPowerLevelByPath8812(Adapter, Channel, path); -+ } -+ -+ //DBG_871X("<==PHY_SetTxPowerLevel8812()\n"); -+} -+ -+bool -+PHY_UpdateTxPowerDbm8812( -+ PADAPTER Adapter, -+ int powerInDbm -+ ) -+{ -+ return true; -+} -+ -+ -+u32 PHY_GetTxBBSwing_8812A( -+ PADAPTER Adapter, -+ BAND_TYPE Band, -+ u8 RFPath -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(GetDefaultAdapter(Adapter)); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); -+ s8 bbSwing_2G = -1 * GetRegTxBBSwing_2G(Adapter); -+ s8 bbSwing_5G = -1 * GetRegTxBBSwing_5G(Adapter); -+ u32 out = 0x200; -+ const s8 AUTO = -1; -+ -+ -+ if (pEEPROM->bautoload_fail_flag) -+ { -+ if ( Band == BAND_ON_2_4G ) { -+ pRFCalibrateInfo->BBSwingDiff2G = bbSwing_2G; -+ if (bbSwing_2G == 0) out = 0x200; // 0 dB -+ else if (bbSwing_2G == -3) out = 0x16A; // -3 dB -+ else if (bbSwing_2G == -6) out = 0x101; // -6 dB -+ else if (bbSwing_2G == -9) out = 0x0B6; // -9 dB -+ else { -+ if ( pHalData->ExternalPA_2G ) { -+ pRFCalibrateInfo->BBSwingDiff2G = -3; -+ out = 0x16A; -+ } else { -+ pRFCalibrateInfo->BBSwingDiff2G = 0; -+ out = 0x200; -+ } -+ } -+ } else if ( Band == BAND_ON_5G ) { -+ pRFCalibrateInfo->BBSwingDiff5G = bbSwing_5G; -+ if (bbSwing_5G == 0) out = 0x200; // 0 dB -+ else if (bbSwing_5G == -3) out = 0x16A; // -3 dB -+ else if (bbSwing_5G == -6) out = 0x101; // -6 dB -+ else if (bbSwing_5G == -9) out = 0x0B6; // -9 dB -+ else { -+ if ( pHalData->ExternalPA_5G ) { -+ pRFCalibrateInfo->BBSwingDiff5G = -3; -+ out = 0x16A; -+ } else { -+ pRFCalibrateInfo->BBSwingDiff5G = 0; -+ out = 0x200; -+ } -+ } -+ } else { -+ pRFCalibrateInfo->BBSwingDiff2G = -3; -+ pRFCalibrateInfo->BBSwingDiff5G = -3; -+ out = 0x16A; // -3 dB -+ } -+ } -+ else -+ { -+ u32 swing = 0, swingA = 0, swingB = 0; -+ -+ if (Band == BAND_ON_2_4G) { -+ if (GetRegTxBBSwing_2G(Adapter) == AUTO) -+ { -+ EFUSE_ShadowRead(Adapter, 1, EEPROM_TX_BBSWING_2G_8812, (u32 *)&swing); -+ swing = (swing == 0xFF) ? 0x00 : swing; -+ } -+ else if (bbSwing_2G == 0) swing = 0x00; // 0 dB -+ else if (bbSwing_2G == -3) swing = 0x05; // -3 dB -+ else if (bbSwing_2G == -6) swing = 0x0A; // -6 dB -+ else if (bbSwing_2G == -9) swing = 0xFF; // -9 dB -+ else swing = 0x00; -+ } -+ else { -+ if (GetRegTxBBSwing_5G(Adapter) == AUTO) -+ { -+ EFUSE_ShadowRead(Adapter, 1, EEPROM_TX_BBSWING_5G_8812, (u32 *)&swing); -+ swing = (swing == 0xFF) ? 0x00 : swing; -+ } -+ else if (bbSwing_5G == 0) swing = 0x00; // 0 dB -+ else if (bbSwing_5G == -3) swing = 0x05; // -3 dB -+ else if (bbSwing_5G == -6) swing = 0x0A; // -6 dB -+ else if (bbSwing_5G == -9) swing = 0xFF; // -9 dB -+ else swing = 0x00; -+ } -+ -+ swingA = (swing & 0x3) >> 0; // 0xC6/C7[1:0] -+ swingB = (swing & 0xC) >> 2; // 0xC6/C7[3:2] -+ -+ //DBG_871X("===> PHY_GetTxBBSwing_8812A, swingA: 0x%X, swingB: 0x%X\n", swingA, swingB); -+ -+ //3 Path-A -+ if (swingA == 0x00) { -+ if (Band == BAND_ON_2_4G) -+ pRFCalibrateInfo->BBSwingDiff2G = 0; -+ else -+ pRFCalibrateInfo->BBSwingDiff5G = 0; -+ out = 0x200; // 0 dB -+ } else if (swingA == 0x01) { -+ if (Band == BAND_ON_2_4G) -+ pRFCalibrateInfo->BBSwingDiff2G = -3; -+ else -+ pRFCalibrateInfo->BBSwingDiff5G = -3; -+ out = 0x16A; // -3 dB -+ } else if (swingA == 0x10) { -+ if (Band == BAND_ON_2_4G) -+ pRFCalibrateInfo->BBSwingDiff2G = -6; -+ else -+ pRFCalibrateInfo->BBSwingDiff5G = -6; -+ out = 0x101; // -6 dB -+ } else if (swingA == 0x11) { -+ if (Band == BAND_ON_2_4G) -+ pRFCalibrateInfo->BBSwingDiff2G = -9; -+ else -+ pRFCalibrateInfo->BBSwingDiff5G = -9; -+ out = 0x0B6; // -9 dB -+ } -+ -+ //3 Path-B -+ if (swingB == 0x00) { -+ if (Band == BAND_ON_2_4G) -+ pRFCalibrateInfo->BBSwingDiff2G = 0; -+ else -+ pRFCalibrateInfo->BBSwingDiff5G = 0; -+ out = 0x200; // 0 dB -+ } else if (swingB == 0x01) { -+ if (Band == BAND_ON_2_4G) -+ pRFCalibrateInfo->BBSwingDiff2G = -3; -+ else -+ pRFCalibrateInfo->BBSwingDiff5G = -3; -+ out = 0x16A; // -3 dB -+ } else if (swingB == 0x10) { -+ if (Band == BAND_ON_2_4G) -+ pRFCalibrateInfo->BBSwingDiff2G = -6; -+ else -+ pRFCalibrateInfo->BBSwingDiff5G = -6; -+ out = 0x101; // -6 dB -+ } else if (swingB == 0x11) { -+ if (Band == BAND_ON_2_4G) -+ pRFCalibrateInfo->BBSwingDiff2G = -9; -+ else -+ pRFCalibrateInfo->BBSwingDiff5G = -9; -+ out = 0x0B6; // -9 dB -+ } -+ } -+ -+ //DBG_871X("<=== PHY_GetTxBBSwing_8812A, out = 0x%X\n", out); -+ -+ return out; -+} -+ -+void -+phy_SetRFEReg8812( -+ PADAPTER Adapter, -+ u8 Band -+) -+{ -+ u1Byte u1tmp = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if(Band == BAND_ON_2_4G) -+ { -+ switch(pHalData->RFEType){ -+ case 0: case 1: case 2: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); -+ break; -+ case 3: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x54337770); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x54337770); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar,0x00000303, 0x1); -+ break; -+ case 4: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x001); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x001); -+ break; -+ case 5: -+ //if(BT_IsBtExist(Adapter)) -+ { -+ //rtw_write16(Adapter, rA_RFE_Pinmux_Jaguar, 0x7777); -+ rtw_write8(Adapter, rA_RFE_Pinmux_Jaguar+2, 0x77); -+ } -+ //else -+ //PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77777777); -+ -+ //if(BT_IsBtExist(Adapter)) -+ { -+ //u1tmp = rtw_read8(Adapter, rA_RFE_Inv_Jaguar+2); -+ //rtw_write8(Adapter, rA_RFE_Inv_Jaguar+2, (u1tmp &0x0f)); -+ u1tmp = rtw_read8(Adapter, rA_RFE_Inv_Jaguar+3); -+ rtw_write8(Adapter, rA_RFE_Inv_Jaguar+3, (u1tmp &= ~BIT0)); -+ } -+ //else -+ //PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar, bMask_RFEInv_Jaguar, 0x000); -+ -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar, bMask_RFEInv_Jaguar, 0x000); -+ break; -+ default: -+ break; -+ } -+ } -+ else -+ { -+ switch(pHalData->RFEType){ -+ case 0: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ break; -+ case 1: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337717); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x000); -+ break; -+ case 2: case 4: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337777); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337777); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ break; -+ case 3: -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x54337717); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x54337717); -+ PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar,bMask_RFEInv_Jaguar, 0x010); -+ PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar,0x00000303, 0x1); -+ break; -+ case 5: -+ //if(BT_IsBtExist(Adapter)) -+ { -+ //rtw_write16(Adapter, rA_RFE_Pinmux_Jaguar, 0x7777); -+ if(pHalData->ExternalPA_5G) -+ PlatformEFIOWrite1Byte(Adapter, rA_RFE_Pinmux_Jaguar+2, 0x33); -+ else -+ PlatformEFIOWrite1Byte(Adapter, rA_RFE_Pinmux_Jaguar+2, 0x73); -+ } -+ #if 0 -+ else -+ { -+ if (pHalData->ExternalPA_5G) -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337777); -+ else -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar,bMaskDWord, 0x77737777); -+ } -+ #endif -+ -+ if (pHalData->ExternalPA_5G) -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77337777); -+ else -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar,bMaskDWord, 0x77737777); -+ -+ //if(BT_IsBtExist(Adapter)) -+ { -+ //u1tmp = rtw_read8(Adapter, rA_RFE_Inv_Jaguar+2); -+ //rtw_write8(Adapter, rA_RFE_Inv_Jaguar+2, (u1tmp &0x0f)); -+ u1tmp = rtw_read8(Adapter, rA_RFE_Inv_Jaguar+3); -+ rtw_write8(Adapter, rA_RFE_Inv_Jaguar+3, (u1tmp |= BIT0)); -+ } -+ //else -+ //PHY_SetBBReg(Adapter, rA_RFE_Inv_Jaguar, bMask_RFEInv_Jaguar, 0x010); -+ -+ PHY_SetBBReg(Adapter, rB_RFE_Inv_Jaguar, bMask_RFEInv_Jaguar, 0x010); -+ break; -+ default: -+ break; -+ } -+ } -+} -+ -+s32 -+PHY_SwitchWirelessBand8812( -+ PADAPTER Adapter, -+ u8 Band -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 currentBand = pHalData->CurrentBandType; -+ -+ //DBG_871X("==>PHY_SwitchWirelessBand8812() %s\n", ((Band==0)?"2.4G":"5G")); -+ -+ pHalData->CurrentBandType =(BAND_TYPE)Band; -+ -+ if(Band == BAND_ON_2_4G) -+ {// 2.4G band -+ -+ // STOP Tx/Rx -+ PHY_SetBBReg(Adapter, rOFDMCCKEN_Jaguar, bOFDMEN_Jaguar|bCCKEN_Jaguar, 0x00); -+ -+ if (IS_HARDWARE_TYPE_8821(Adapter)) -+ { -+ // Turn off RF PA and LNA -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0xF000, 0x7); // 0xCB0[15:12] = 0x7 (LNA_On) -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0xF0, 0x7); // 0xCB0[7:4] = 0x7 (PAPE_A) -+ } -+ -+ // AGC table select -+ if(IS_VENDOR_8821A_MP_CHIP(Adapter)) -+ PHY_SetBBReg(Adapter, rA_TxScale_Jaguar, 0xF00, 0); // 0xC1C[11:8] = 0 -+ else -+ PHY_SetBBReg(Adapter, rAGC_table_Jaguar, 0x3, 0); -+ -+ if(IS_VENDOR_8812A_TEST_CHIP(Adapter)) -+ { -+ // r_select_5G for path_A/B -+ PHY_SetBBReg(Adapter, rA_RFE_Jaguar, BIT12, 0x0); -+ PHY_SetBBReg(Adapter, rB_RFE_Jaguar, BIT12, 0x0); -+ -+ // LANON (5G uses external LNA) -+ PHY_SetBBReg(Adapter, rA_RFE_Jaguar, BIT15, 0x1); -+ PHY_SetBBReg(Adapter, rB_RFE_Jaguar, BIT15, 0x1); -+ } -+ else if(IS_VENDOR_8812A_MP_CHIP(Adapter)) -+ { -+ if(GetRegbENRFEType(Adapter)) -+ phy_SetRFEReg8812(Adapter, Band); -+ else -+ { -+ // PAPE_A (bypass RFE module in 2G) -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0x000000F0, 0x7); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, 0x000000F0, 0x7); -+ -+ // PAPE_G (bypass RFE module in 5G) -+ if (pHalData->ExternalPA_2G) { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0x0000000F, 0x0); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, 0x0000000F, 0x0); -+ } else { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0x0000000F, 0x7); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, 0x0000000F, 0x7); -+ } -+ -+ // TRSW bypass RFE moudle in 2G -+ if (pHalData->ExternalLNA_2G) { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, bMaskByte2, 0x54); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, bMaskByte2, 0x54); -+ } else { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, bMaskByte2, 0x77); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, bMaskByte2, 0x77); -+ } -+ } -+ } -+ -+ update_tx_basic_rate(Adapter, WIRELESS_11BG); -+ -+ // cck_enable -+ PHY_SetBBReg(Adapter, rOFDMCCKEN_Jaguar, bOFDMEN_Jaguar|bCCKEN_Jaguar, 0x3); -+ -+ // SYN Setting -+ if(IS_VENDOR_8812A_TEST_CHIP(Adapter)) -+ { -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0xEF, bLSSIWrite_data_Jaguar, 0x40000); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0x3E, bLSSIWrite_data_Jaguar, 0x00000); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0x3F, bLSSIWrite_data_Jaguar, 0x0001c); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0xEF, bLSSIWrite_data_Jaguar, 0x00000); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0xB5, bLSSIWrite_data_Jaguar, 0x16BFF); -+ } -+ -+ // CCK_CHECK_en -+ rtw_write8(Adapter, REG_CCK_CHECK_8812, 0x0); -+ } -+ else //5G band -+ { -+ u16 count = 0, reg41A = 0; -+ -+ if (IS_HARDWARE_TYPE_8821(Adapter)) -+ { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0xF000, 0x5); // 0xCB0[15:12] = 0x5 (LNA_On) -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0xF0, 0x4); // 0xCB0[7:4] = 0x4 (PAPE_A) -+ } -+ -+ // CCK_CHECK_en -+ rtw_write8(Adapter, REG_CCK_CHECK_8812, 0x80); -+ -+ count = 0; -+ reg41A = rtw_read16(Adapter, REG_TXPKT_EMPTY); -+ //DBG_871X("Reg41A value %d", reg41A); -+ reg41A &= 0x30; -+ while((reg41A!= 0x30) && (count < 50)) -+ { -+ rtw_udelay_os(50); -+ //DBG_871X("Delay 50us \n"); -+ -+ reg41A = rtw_read16(Adapter, REG_TXPKT_EMPTY); -+ reg41A &= 0x30; -+ count++; -+ //DBG_871X("Reg41A value %d", reg41A); -+ } -+ if(count != 0) -+ DBG_871X("PHY_SwitchWirelessBand8812(): Switch to 5G Band. Count = %d reg41A=0x%x\n", count, reg41A); -+ -+ // STOP Tx/Rx -+ PHY_SetBBReg(Adapter, rOFDMCCKEN_Jaguar, bOFDMEN_Jaguar|bCCKEN_Jaguar, 0x00); -+ -+ // AGC table select -+ if (IS_VENDOR_8821A_MP_CHIP(Adapter)) -+ PHY_SetBBReg(Adapter, rA_TxScale_Jaguar, 0xF00, 1); // 0xC1C[11:8] = 1 -+ else -+ PHY_SetBBReg(Adapter, rAGC_table_Jaguar, 0x3, 1); -+ -+ if(IS_VENDOR_8812A_TEST_CHIP(Adapter)) -+ { -+ // r_select_5G for path_A/B -+ PHY_SetBBReg(Adapter, rA_RFE_Jaguar, BIT12, 0x1); -+ PHY_SetBBReg(Adapter, rB_RFE_Jaguar, BIT12, 0x1); -+ -+ // LANON (5G uses external LNA) -+ PHY_SetBBReg(Adapter, rA_RFE_Jaguar, BIT15, 0x0); -+ PHY_SetBBReg(Adapter, rB_RFE_Jaguar, BIT15, 0x0); -+ } -+ else if(IS_VENDOR_8812A_MP_CHIP(Adapter)) -+ { -+ if(GetRegbENRFEType(Adapter)) -+ phy_SetRFEReg8812(Adapter, Band); -+ else -+ { -+ // PAPE_A (bypass RFE module in 2G) -+ if (pHalData->ExternalPA_5G) { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0x000000F0, 0x1); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, 0x000000F0, 0x1); -+ } else { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0x000000F0, 0x0); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, 0x000000F0, 0x0); -+ } -+ -+ // PAPE_G (bypass RFE module in 5G) -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, 0x0000000F, 0x7); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, 0x0000000F, 0x7); -+ -+ // TRSW bypass RFE moudle in 2G -+ if (pHalData->ExternalLNA_5G) { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, bMaskByte2, 0x54); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, bMaskByte2, 0x54); -+ } else { -+ PHY_SetBBReg(Adapter, rA_RFE_Pinmux_Jaguar, bMaskByte2, 0x77); -+ PHY_SetBBReg(Adapter, rB_RFE_Pinmux_Jaguar, bMaskByte2, 0x77); -+ } -+ } -+ } -+ -+ //avoid using cck rate in 5G band -+ // Set RRSR rate table. -+ update_tx_basic_rate(Adapter, WIRELESS_11A); -+ -+ // cck_enable -+ PHY_SetBBReg(Adapter, rOFDMCCKEN_Jaguar, bOFDMEN_Jaguar|bCCKEN_Jaguar, 0x2); -+ -+ // SYN Setting -+ if(IS_VENDOR_8812A_TEST_CHIP(Adapter)) -+ { -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0xEF, bLSSIWrite_data_Jaguar, 0x40000); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0x3E, bLSSIWrite_data_Jaguar, 0x00000); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0x3F, bLSSIWrite_data_Jaguar, 0x00017); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0xEF, bLSSIWrite_data_Jaguar, 0x00000); -+ PHY_SetRFReg(Adapter, RF_PATH_A, 0xB5, bLSSIWrite_data_Jaguar, 0x04BFF); -+ } -+ -+ //DBG_871X("==>PHY_SwitchWirelessBand8812() BAND_ON_5G settings OFDM index 0x%x\n", pHalData->OFDM_index[RF_PATH_A]); -+ } -+ -+ //<20120903, Kordan> Tx BB swing setting for RL6286, asked by Ynlin. -+ if (IS_NORMAL_CHIP(pHalData->VersionID) || IS_HARDWARE_TYPE_8821(Adapter)) -+ { -+ s8 BBDiffBetweenBand = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(GetDefaultAdapter(Adapter)); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -+ -+ PHY_SetBBReg(Adapter, rA_TxScale_Jaguar, 0xFFE00000, -+ PHY_GetTxBBSwing_8812A(Adapter, (BAND_TYPE)Band, ODM_RF_PATH_A)); // 0xC1C[31:21] -+ PHY_SetBBReg(Adapter, rB_TxScale_Jaguar, 0xFFE00000, -+ PHY_GetTxBBSwing_8812A(Adapter, (BAND_TYPE)Band, ODM_RF_PATH_B)); // 0xE1C[31:21] -+ -+ // <20121005, Kordan> When TxPowerTrack is ON, we should take care of the change of BB swing. -+ // That is, reset all info to trigger Tx power tracking. -+ { -+ if (Band != currentBand) -+ { -+ BBDiffBetweenBand = (pRFCalibrateInfo->BBSwingDiff2G - pRFCalibrateInfo->BBSwingDiff5G); -+ BBDiffBetweenBand = (Band == BAND_ON_2_4G) ? BBDiffBetweenBand : (-1 * BBDiffBetweenBand); -+ pDM_Odm->DefaultOfdmIndex += BBDiffBetweenBand*2; -+ } -+ -+ ODM_ClearTxPowerTrackingState(pDM_Odm); -+ } -+ } -+ -+ //DBG_871X("<==PHY_SwitchWirelessBand8812():Switch Band OK.\n"); -+ return _SUCCESS; -+} -+ -+bool -+phy_SwBand8812( -+ PADAPTER pAdapter, -+ u8 channelToSW -+) -+{ -+ u8 u1Btmp; -+ bool ret_value = true; -+ u8 Band = BAND_ON_5G, BandToSW; -+ -+ u1Btmp = rtw_read8(pAdapter, REG_CCK_CHECK_8812); -+ if(u1Btmp & BIT7) -+ Band = BAND_ON_5G; -+ else -+ Band = BAND_ON_2_4G; -+ -+ // Use current channel to judge Band Type and switch Band if need. -+ if(channelToSW > 14) -+ { -+ BandToSW = BAND_ON_5G; -+ } -+ else -+ { -+ BandToSW = BAND_ON_2_4G; -+ } -+ -+ if(BandToSW != Band) -+ PHY_SwitchWirelessBand8812(pAdapter,BandToSW); -+ -+ return ret_value; -+} -+ -+u8 -+phy_GetSecondaryChnl_8812( -+ PADAPTER Adapter -+) -+{ -+ u8 SCSettingOf40 = 0, SCSettingOf20 = 0; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ //DBG_871X("SCMapping: VHT Case: pHalData->CurrentChannelBW %d, pHalData->nCur80MhzPrimeSC %d, pHalData->nCur40MhzPrimeSC %d \n",pHalData->CurrentChannelBW,pHalData->nCur80MhzPrimeSC,pHalData->nCur40MhzPrimeSC); -+ if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_80) -+ { -+ if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOf40 = VHT_DATA_SC_40_LOWER_OF_80MHZ; -+ else if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOf40 = VHT_DATA_SC_40_UPPER_OF_80MHZ; -+ else -+ DBG_871X("SCMapping: Not Correct Primary40MHz Setting \n"); -+ -+ if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOf20 = VHT_DATA_SC_20_LOWEST_OF_80MHZ; -+ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOf20 = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOf20 = VHT_DATA_SC_20_UPPERST_OF_80MHZ; -+ else -+ DBG_871X("SCMapping: Not Correct Primary40MHz Setting \n"); -+ } -+ else if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) -+ { -+ //DBG_871X("SCMapping: VHT Case: pHalData->CurrentChannelBW %d, pHalData->nCur40MhzPrimeSC %d \n",pHalData->CurrentChannelBW,pHalData->nCur40MhzPrimeSC); -+ -+ if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOf20 = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else -+ DBG_871X("SCMapping: Not Correct Primary40MHz Setting \n"); -+ } -+ -+ //DBG_871X("SCMapping: SC Value %x \n", ( (SCSettingOf40 << 4) | SCSettingOf20)); -+ return ( (SCSettingOf40 << 4) | SCSettingOf20); -+} -+ -+void -+phy_SetRegBW_8812( -+ PADAPTER Adapter, -+ CHANNEL_WIDTH CurrentBW -+) -+{ -+ u16 RegRfMod_BW, u2tmp = 0; -+ RegRfMod_BW = rtw_read16(Adapter, REG_WMAC_TRXPTCL_CTL); -+ -+ switch(CurrentBW) -+ { -+ case CHANNEL_WIDTH_20: -+ rtw_write16(Adapter, REG_WMAC_TRXPTCL_CTL, (RegRfMod_BW & 0xFE7F)); // BIT 7 = 0, BIT 8 = 0 -+ break; -+ -+ case CHANNEL_WIDTH_40: -+ u2tmp = RegRfMod_BW | BIT7; -+ rtw_write16(Adapter, REG_WMAC_TRXPTCL_CTL, (u2tmp & 0xFEFF)); // BIT 7 = 1, BIT 8 = 0 -+ break; -+ -+ case CHANNEL_WIDTH_80: -+ u2tmp = RegRfMod_BW | BIT8; -+ rtw_write16(Adapter, REG_WMAC_TRXPTCL_CTL, (u2tmp & 0xFF7F)); // BIT 7 = 0, BIT 8 = 1 -+ break; -+ -+ default: -+ DBG_871X("phy_PostSetBWMode8812(): unknown Bandwidth: %#X\n",CurrentBW); -+ break; -+ } -+ -+} -+ -+void -+phy_FixSpur_8812A( -+ PADAPTER pAdapter, -+ CHANNEL_WIDTH Bandwidth, -+ u1Byte Channel -+) -+{ -+ // C cut Item12 ADC FIFO CLOCK -+ if(IS_VENDOR_8812A_C_CUT(pAdapter)) -+ { -+ if(Bandwidth == CHANNEL_WIDTH_40 && Channel == 11) -+ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0xC00, 0x3) ; // 0x8AC[11:10] = 2'b11 -+ else -+ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0xC00, 0x2); // 0x8AC[11:10] = 2'b10 -+ -+ // <20120914, Kordan> A workarould to resolve 2480Mhz spur by setting ADC clock as 160M. (Asked by Binson) -+ if (Bandwidth == CHANNEL_WIDTH_20 && -+ (Channel == 13 || Channel == 14)) { -+ -+ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0x300, 0x3); // 0x8AC[9:8] = 2'b11 -+ PHY_SetBBReg(pAdapter, rADC_Buf_Clk_Jaguar, BIT30, 1); // 0x8C4[30] = 1 -+ -+ } else if (Bandwidth == CHANNEL_WIDTH_40 && -+ Channel == 11) { -+ -+ PHY_SetBBReg(pAdapter, rADC_Buf_Clk_Jaguar, BIT30, 1); // 0x8C4[30] = 1 -+ -+ } else if (Bandwidth != CHANNEL_WIDTH_80) { -+ -+ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0x300, 0x2); // 0x8AC[9:8] = 2'b10 -+ PHY_SetBBReg(pAdapter, rADC_Buf_Clk_Jaguar, BIT30, 0); // 0x8C4[30] = 0 -+ -+ } -+ } -+ else if (IS_HARDWARE_TYPE_8812(pAdapter)) -+ { -+ // <20120914, Kordan> A workarould to resolve 2480Mhz spur by setting ADC clock as 160M. (Asked by Binson) -+ if (Bandwidth == CHANNEL_WIDTH_20 && -+ (Channel == 13 || Channel == 14)) -+ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0x300, 0x3); // 0x8AC[9:8] = 11 -+ else if (Channel <= 14) // 2.4G only -+ PHY_SetBBReg(pAdapter, rRFMOD_Jaguar, 0x300, 0x2); // 0x8AC[9:8] = 10 -+ } -+ -+} -+ -+void -+phy_PostSetBwMode8812( -+ PADAPTER Adapter -+) -+{ -+ u8 SubChnlNum = 0; -+ u8 L1pkVal = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ -+ //3 Set Reg668 Reg440 BW -+ phy_SetRegBW_8812(Adapter, pHalData->CurrentChannelBW); -+ -+ //3 Set Reg483 -+ SubChnlNum = phy_GetSecondaryChnl_8812(Adapter); -+ rtw_write8(Adapter, REG_DATA_SC_8812, SubChnlNum); -+ -+ if(pHalData->rf_chip == RF_PSEUDO_11N) -+ { -+ DBG_871X("phy_PostSetBwMode8812: return for PSEUDO \n"); -+ return; -+ } -+ -+ //DBG_871X("[BW:CHNL], phy_PostSetBwMode8812(), set BW=%s !!\n", GLBwSrc[pHalData->CurrentChannelBW]); -+ -+ //3 Set Reg848 Reg864 Reg8AC Reg8C4 RegA00 -+ switch(pHalData->CurrentChannelBW) -+ { -+ case CHANNEL_WIDTH_20: -+ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x003003C3, 0x00300200); // 0x8ac[21,20,9:6,1,0]=8'b11100000 -+ PHY_SetBBReg(Adapter, rADC_Buf_Clk_Jaguar, BIT30, 0); // 0x8c4[30] = 1'b0 -+ -+ PHY_SetBBReg(Adapter, rFPGA0_XB_RFInterfaceOE, 0x001C0000, 4); // 0x864[20:18] = 3'b4 -+ -+ if(pHalData->rf_type == RF_2T2R) -+ PHY_SetBBReg(Adapter, rL1PeakTH_Jaguar, 0x03C00000, 7); // 2R 0x848[25:22] = 0x7 -+ else -+ PHY_SetBBReg(Adapter, rL1PeakTH_Jaguar, 0x03C00000, 8); // 1R 0x848[25:22] = 0x8 -+ -+ break; -+ -+ case CHANNEL_WIDTH_40: -+ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x003003C3, 0x00300201); // 0x8ac[21,20,9:6,1,0]=8'b11100000 -+ PHY_SetBBReg(Adapter, rADC_Buf_Clk_Jaguar, BIT30, 0); // 0x8c4[30] = 1'b0 -+ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x3C, SubChnlNum); -+ PHY_SetBBReg(Adapter, rCCAonSec_Jaguar, 0xf0000000, SubChnlNum); -+ -+ PHY_SetBBReg(Adapter, rFPGA0_XB_RFInterfaceOE, 0x001C0000, 2); // 0x864[20:18] = 3'b2 -+ -+ if(pHalData->Reg837 & BIT2) -+ L1pkVal = 6; -+ else -+ { -+ if(pHalData->rf_type == RF_2T2R) -+ L1pkVal = 7; -+ else -+ L1pkVal = 8; -+ } -+ -+ PHY_SetBBReg(Adapter, rL1PeakTH_Jaguar, 0x03C00000, L1pkVal); // 0x848[25:22] = 0x6 -+ -+ if(SubChnlNum == VHT_DATA_SC_20_UPPER_OF_80MHZ) -+ PHY_SetBBReg(Adapter, rCCK_System_Jaguar, bCCK_System_Jaguar, 1); -+ else -+ PHY_SetBBReg(Adapter, rCCK_System_Jaguar, bCCK_System_Jaguar, 0); -+ break; -+ -+ case CHANNEL_WIDTH_80: -+ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x003003C3, 0x00300202); // 0x8ac[21,20,9:6,1,0]=8'b11100010 -+ PHY_SetBBReg(Adapter, rADC_Buf_Clk_Jaguar, BIT30, 1); // 0x8c4[30] = 1 -+ PHY_SetBBReg(Adapter, rRFMOD_Jaguar, 0x3C, SubChnlNum); -+ PHY_SetBBReg(Adapter, rCCAonSec_Jaguar, 0xf0000000, SubChnlNum); -+ -+ PHY_SetBBReg(Adapter, rFPGA0_XB_RFInterfaceOE, 0x001C0000, 2); // 0x864[20:18] = 3'b2 -+ -+ if(pHalData->Reg837 & BIT2) -+ L1pkVal = 5; -+ else -+ { -+ if(pHalData->rf_type == RF_2T2R) -+ L1pkVal = 6; -+ else -+ L1pkVal = 7; -+ } -+ PHY_SetBBReg(Adapter, rL1PeakTH_Jaguar, 0x03C00000, L1pkVal); // 0x848[25:22] = 0x5 -+ -+ break; -+ -+ default: -+ DBG_871X("phy_PostSetBWMode8812(): unknown Bandwidth: %#X\n",pHalData->CurrentChannelBW); -+ break; -+ } -+ -+ // <20121109, Kordan> A workaround for 8812A only. -+ phy_FixSpur_8812A(Adapter, pHalData->CurrentChannelBW, pHalData->CurrentChannel); -+ -+ //DBG_871X("phy_PostSetBwMode8812(): Reg483: %x\n", rtw_read8(Adapter, 0x483)); -+ //DBG_871X("phy_PostSetBwMode8812(): Reg668: %x\n", rtw_read32(Adapter, 0x668)); -+ //DBG_871X("phy_PostSetBwMode8812(): Reg8AC: %x\n", PHY_QueryBBReg(Adapter, rRFMOD_Jaguar, 0xffffffff)); -+ -+ //3 Set RF related register -+ PHY_RF6052SetBandwidth8812(Adapter, pHalData->CurrentChannelBW); -+} -+ -+//<20130207, Kordan> The variales initialized here are used in odm_LNAPowerControl(). -+void phy_InitRssiTRSW( -+ PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -+ u8 channel = pHalData->CurrentChannel; -+ -+ if (pHalData->RFEType == 3){ -+ -+ if (channel <= 14) { -+ pDM_Odm->RSSI_TRSW_H = 70; // Unit: percentage(%) -+ pDM_Odm->RSSI_TRSW_iso = 25; -+ } else if (36 <= channel && channel <= 64) { -+ pDM_Odm->RSSI_TRSW_H = 70; -+ pDM_Odm->RSSI_TRSW_iso = 25; -+ } else if (100 <= channel && channel <= 144) { -+ pDM_Odm->RSSI_TRSW_H = 80; -+ pDM_Odm->RSSI_TRSW_iso = 35; -+ } else if (149 <= channel) { -+ pDM_Odm->RSSI_TRSW_H = 75; -+ pDM_Odm->RSSI_TRSW_iso = 30; -+ } -+ -+ pDM_Odm->RSSI_TRSW_L = pDM_Odm->RSSI_TRSW_H - pDM_Odm->RSSI_TRSW_iso - 10; -+ } -+} -+ -+void -+phy_SwChnl8812( -+ PADAPTER pAdapter -+ ) -+{ -+ u8 eRFPath = 0; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 channelToSW = pHalData->CurrentChannel; -+ -+ if (pAdapter->registrypriv.mp_mode == 0) { -+ if(phy_SwBand8812(pAdapter, channelToSW) == false) -+ { -+ DBG_871X("error Chnl %d !\n", channelToSW); -+ } -+ } -+ -+ //<20130313, Kordan> Sample code to demonstrate how to configure AGC_TAB_DIFF.(Disabled by now) -+#if 0 -+ if (36 <= channelToSW && channelToSW <= 48) -+ AGC_DIFF_CONFIG(8812A,LB); -+ else if (50 <= channelToSW && channelToSW <= 64) -+ AGC_DIFF_CONFIG(8812A,MB); -+ else if (100 <= channelToSW && channelToSW <= 116) -+ AGC_DIFF_CONFIG(8812A,HB); -+#endif -+ -+ if(pHalData->rf_chip == RF_PSEUDO_11N) -+ { -+ DBG_871X("phy_SwChnl8812: return for PSEUDO \n"); -+ return; -+ } -+ -+ //DBG_871X("[BW:CHNL], phy_SwChnl8812(), switch to channel %d !!\n", channelToSW); -+ -+ // fc_area -+ if (36 <= channelToSW && channelToSW <= 48) -+ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x494); -+ else if (50 <= channelToSW && channelToSW <= 64) -+ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x453); -+ else if (100 <= channelToSW && channelToSW <= 116) -+ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x452); -+ else if (118 <= channelToSW) -+ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x412); -+ else -+ PHY_SetBBReg(pAdapter, rFc_area_Jaguar, 0x1ffe0000, 0x96a); -+ -+ for(eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) -+ { -+ // [2.4G] LC Tank -+ if(IS_VENDOR_8812A_TEST_CHIP(pAdapter)) -+ { -+ if (1 <= channelToSW && channelToSW <= 7) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_TxLCTank_Jaguar, bLSSIWrite_data_Jaguar, 0x0017e); -+ else if (8 <= channelToSW && channelToSW <= 14) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_TxLCTank_Jaguar, bLSSIWrite_data_Jaguar, 0x0013e); -+ } -+ -+ // RF_MOD_AG -+ if (36 <= channelToSW && channelToSW <= 64) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, BIT18|BIT17|BIT16|BIT9|BIT8, 0x101); //5'b00101); -+ else if (100 <= channelToSW && channelToSW <= 140) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, BIT18|BIT17|BIT16|BIT9|BIT8, 0x301); //5'b01101); -+ else if (140 < channelToSW) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, BIT18|BIT17|BIT16|BIT9|BIT8, 0x501); //5'b10101); -+ else -+ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, BIT18|BIT17|BIT16|BIT9|BIT8, 0x000); //5'b00000); -+ -+ // <20121109, Kordan> A workaround for 8812A only. -+ phy_FixSpur_8812A(pAdapter, pHalData->CurrentChannelBW, channelToSW); -+ -+ PHY_SetRFReg(pAdapter, eRFPath, RF_CHNLBW_Jaguar, bMaskByte0, channelToSW); -+ -+ // <20130104, Kordan> APK for MP chip is done on initialization from folder. -+ if (IS_HARDWARE_TYPE_8811AU(pAdapter) && ( !IS_NORMAL_CHIP(pHalData->VersionID)) && channelToSW > 14 ) -+ { -+ // <20121116, Kordan> For better result of APK. Asked by AlexWang. -+ if (36 <= channelToSW && channelToSW <= 64) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x710E7); -+ else if (100 <= channelToSW && channelToSW <= 140) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x716E9); -+ else -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x714E9); -+ } -+ else if ((IS_HARDWARE_TYPE_8821E(pAdapter) || IS_HARDWARE_TYPE_8821S(pAdapter)) -+ && channelToSW > 14) -+ { -+ // <20130111, Kordan> For better result of APK. Asked by Willson. -+ if (36 <= channelToSW && channelToSW <= 64) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x714E9); -+ else if (100 <= channelToSW && channelToSW <= 140) -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x110E9); -+ else -+ PHY_SetRFReg(pAdapter, eRFPath, RF_APK_Jaguar, bRFRegOffsetMask, 0x714E9); -+ } -+ } -+} -+ -+void -+phy_SwChnlAndSetBwMode8812( -+ PADAPTER Adapter -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ //DBG_871X("phy_SwChnlAndSetBwMode8812(): bSwChnl %d, bSetChnlBW %d \n", pHalData->bSwChnl, pHalData->bSetChnlBW); -+ -+ if((Adapter->bDriverStopped) || (Adapter->bSurpriseRemoved)) -+ { -+ return; -+ } -+ -+ if(pHalData->bSwChnl) -+ { -+ phy_SwChnl8812(Adapter); -+ pHalData->bSwChnl = false; -+ } -+ -+ if(pHalData->bSetChnlBW) -+ { -+ phy_PostSetBwMode8812(Adapter); -+ pHalData->bSetChnlBW = false; -+ } -+ -+ ODM_ClearTxPowerTrackingState(&pHalData->odmpriv); -+ PHY_SetTxPowerLevel8812(Adapter, pHalData->CurrentChannel); -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ phy_InitRssiTRSW(Adapter); -+ -+ if ( (pHalData->bNeedIQK == true) -+#if (MP_DRIVER == 1) -+ || (Adapter->registrypriv.mp_mode == 1) -+#endif -+ ) -+ { -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ PHY_IQCalibrate_8812A(Adapter, false); -+ else if(IS_HARDWARE_TYPE_8821(Adapter)) -+ PHY_IQCalibrate_8821A(Adapter, false); -+ pHalData->bNeedIQK = false; -+ } -+} -+ -+void -+PHY_HandleSwChnlAndSetBW8812( -+ PADAPTER Adapter, -+ bool bSwitchChannel, -+ bool bSetBandWidth, -+ u8 ChannelNum, -+ CHANNEL_WIDTH ChnlWidth, -+ u8 ChnlOffsetOf40MHz, -+ u8 ChnlOffsetOf80MHz, -+ u8 CenterFrequencyIndex1 -+) -+{ -+ PADAPTER pDefAdapter = GetDefaultAdapter(Adapter); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDefAdapter); -+ u8 tmpChannel = pHalData->CurrentChannel; -+ CHANNEL_WIDTH tmpBW= pHalData->CurrentChannelBW; -+ u8 tmpnCur40MhzPrimeSC = pHalData->nCur40MhzPrimeSC; -+ u8 tmpnCur80MhzPrimeSC = pHalData->nCur80MhzPrimeSC; -+ u8 tmpCenterFrequencyIndex1 =pHalData->CurrentCenterFrequencyIndex1; -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ -+ //DBG_871X("=> PHY_HandleSwChnlAndSetBW8812: bSwitchChannel %d, bSetBandWidth %d \n",bSwitchChannel,bSetBandWidth); -+ -+ //check is swchnl or setbw -+ if(!bSwitchChannel && !bSetBandWidth) -+ { -+ DBG_871X("PHY_HandleSwChnlAndSetBW8812: not switch channel and not set bandwidth \n"); -+ return; -+ } -+ -+ //skip change for channel or bandwidth is the same -+ if(bSwitchChannel) -+ { -+ if(pHalData->CurrentChannel != ChannelNum) -+ { -+ if (HAL_IsLegalChannel(Adapter, ChannelNum)) -+ pHalData->bSwChnl = true; -+ else -+ return; -+ } -+ } -+ -+ if(bSetBandWidth) -+ { -+ if(pHalData->bChnlBWInitialzed == false) -+ { -+ pHalData->bChnlBWInitialzed = true; -+ pHalData->bSetChnlBW = true; -+ } -+ else if((pHalData->CurrentChannelBW != ChnlWidth) || -+ (pHalData->nCur40MhzPrimeSC != ChnlOffsetOf40MHz) || -+ (pHalData->nCur80MhzPrimeSC != ChnlOffsetOf80MHz) || -+ (pHalData->CurrentCenterFrequencyIndex1!= CenterFrequencyIndex1)) -+ { -+ pHalData->bSetChnlBW = true; -+ } -+ } -+ -+ if(!pHalData->bSetChnlBW && !pHalData->bSwChnl) -+ { -+ //DBG_871X("<= PHY_HandleSwChnlAndSetBW8812: bSwChnl %d, bSetChnlBW %d \n",pHalData->bSwChnl,pHalData->bSetChnlBW); -+ return; -+ } -+ -+ -+ if(pHalData->bSwChnl) -+ { -+ pHalData->CurrentChannel=ChannelNum; -+ pHalData->CurrentCenterFrequencyIndex1 = ChannelNum; -+ } -+ -+ -+ if(pHalData->bSetChnlBW) -+ { -+ pHalData->CurrentChannelBW = ChnlWidth; -+#if 0 -+ if(ExtChnlOffsetOf40MHz==EXTCHNL_OFFSET_LOWER) -+ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else if(ExtChnlOffsetOf40MHz==EXTCHNL_OFFSET_UPPER) -+ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else -+ pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ -+ if(ExtChnlOffsetOf80MHz==EXTCHNL_OFFSET_LOWER) -+ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_UPPER; -+ else if(ExtChnlOffsetOf80MHz==EXTCHNL_OFFSET_UPPER) -+ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_LOWER; -+ else -+ pHalData->nCur80MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+#else -+ pHalData->nCur40MhzPrimeSC = ChnlOffsetOf40MHz; -+ pHalData->nCur80MhzPrimeSC = ChnlOffsetOf80MHz; -+#endif -+ -+ pHalData->CurrentCenterFrequencyIndex1 = CenterFrequencyIndex1; -+ } -+ -+ //Switch workitem or set timer to do switch channel or setbandwidth operation -+ if((!pDefAdapter->bDriverStopped) && (!pDefAdapter->bSurpriseRemoved)) -+ { -+ phy_SwChnlAndSetBwMode8812(Adapter); -+ } -+ else -+ { -+ if(pHalData->bSwChnl) -+ { -+ pHalData->CurrentChannel = tmpChannel; -+ pHalData->CurrentCenterFrequencyIndex1 = tmpChannel; -+ } -+ if(pHalData->bSetChnlBW) -+ { -+ pHalData->CurrentChannelBW = tmpBW; -+ pHalData->nCur40MhzPrimeSC = tmpnCur40MhzPrimeSC; -+ pHalData->nCur80MhzPrimeSC = tmpnCur80MhzPrimeSC; -+ pHalData->CurrentCenterFrequencyIndex1 = tmpCenterFrequencyIndex1; -+ } -+ } -+ -+ //DBG_871X("Channel %d ChannelBW %d ",pHalData->CurrentChannel, pHalData->CurrentChannelBW); -+ //DBG_871X("40MhzPrimeSC %d 80MhzPrimeSC %d ",pHalData->nCur40MhzPrimeSC, pHalData->nCur80MhzPrimeSC); -+ //DBG_871X("CenterFrequencyIndex1 %d \n",pHalData->CurrentCenterFrequencyIndex1); -+ -+ //DBG_871X("<= PHY_HandleSwChnlAndSetBW8812: bSwChnl %d, bSetChnlBW %d \n",pHalData->bSwChnl,pHalData->bSetChnlBW); -+ -+} -+ -+void -+PHY_SetBWMode8812( -+ PADAPTER Adapter, -+ CHANNEL_WIDTH Bandwidth, // 20M or 40M -+ u8 Offset // Upper, Lower, or Don't care -+) -+{ -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ //DBG_871X("%s()===>\n",__FUNCTION__); -+ -+ PHY_HandleSwChnlAndSetBW8812(Adapter, false, true, pHalData->CurrentChannel, Bandwidth, Offset, Offset, pHalData->CurrentChannel); -+ -+ //DBG_871X("<==%s()\n",__FUNCTION__); -+} -+ -+void -+PHY_SwChnl8812( -+ PADAPTER Adapter, -+ u8 channel -+ ) -+{ -+ //DBG_871X("%s()===>\n",__FUNCTION__); -+ -+ PHY_HandleSwChnlAndSetBW8812(Adapter, true, false, channel, 0, 0, 0, channel); -+ -+ //DBG_871X("<==%s()\n",__FUNCTION__); -+} -+ -+void -+PHY_SetSwChnlBWMode8812( -+ PADAPTER Adapter, -+ u8 channel, -+ CHANNEL_WIDTH Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+) -+{ -+ //DBG_871X("%s()===>\n",__FUNCTION__); -+ -+ PHY_HandleSwChnlAndSetBW8812(Adapter, true, true, channel, Bandwidth, Offset40, Offset80, channel); -+ -+ //DBG_871X("<==%s()\n",__FUNCTION__); -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_rf6052.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_rf6052.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_rf6052.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_rf6052.c 2018-02-06 17:42:30.715967238 +0200 -@@ -0,0 +1,571 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8812A_RF6052_C_ -+ -+//#include -+#include -+ -+ -+/*----------------------------------------------------------------------------- -+ * Function: PHY_RF6052SetBandwidth() -+ * -+ * Overview: This function is called by SetBWModeCallback8190Pci() only -+ * -+ * Input: PADAPTER Adapter -+ * WIRELESS_BANDWIDTH_E Bandwidth //20M or 40M -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Note: For RF type 0222D -+ *---------------------------------------------------------------------------*/ -+void -+PHY_RF6052SetBandwidth8812( -+ PADAPTER Adapter, -+ CHANNEL_WIDTH Bandwidth) //20M or 40M -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ switch(Bandwidth) -+ { -+ case CHANNEL_WIDTH_20: -+ //DBG_871X("PHY_RF6052SetBandwidth8812(), set 20MHz, pHalData->RfRegChnlVal[0] = 0x%x \n", pHalData->RfRegChnlVal[0]); -+ PHY_SetRFReg(Adapter, RF_PATH_A, RF_CHNLBW_Jaguar, BIT11|BIT10, 3); -+ PHY_SetRFReg(Adapter, RF_PATH_B, RF_CHNLBW_Jaguar, BIT11|BIT10, 3); -+ break; -+ -+ case CHANNEL_WIDTH_40: -+ //DBG_871X("PHY_RF6052SetBandwidth8812(), set 40MHz, pHalData->RfRegChnlVal[0] = 0x%x \n", pHalData->RfRegChnlVal[0]); -+ PHY_SetRFReg(Adapter, RF_PATH_A, RF_CHNLBW_Jaguar, BIT11|BIT10, 1); -+ PHY_SetRFReg(Adapter, RF_PATH_B, RF_CHNLBW_Jaguar, BIT11|BIT10, 1); -+ break; -+ -+ case CHANNEL_WIDTH_80: -+ //DBG_871X("PHY_RF6052SetBandwidth8812(), set 80MHz, pHalData->RfRegChnlVal[0] = 0x%x \n", pHalData->RfRegChnlVal[0]); -+ PHY_SetRFReg(Adapter, RF_PATH_A, RF_CHNLBW_Jaguar, BIT11|BIT10, 0); -+ PHY_SetRFReg(Adapter, RF_PATH_B, RF_CHNLBW_Jaguar, BIT11|BIT10, 0); -+ break; -+ -+ default: -+ DBG_871X("PHY_RF6052SetBandwidth8812(): unknown Bandwidth: %#X\n",Bandwidth ); -+ break; -+ } -+} -+ -+// -+// powerbase0 for OFDM rates -+// powerbase1 for HT MCS rates -+// -+void getPowerBase8812( -+ PADAPTER Adapter, -+ u8* pPowerLevelOFDM, -+ u8* pPowerLevelBW20, -+ u8* pPowerLevelBW40, -+ u8 Channel, -+ u32* OfdmBase, -+ u32* MCSBase -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u32 powerBase0, powerBase1; -+ u8 i, powerlevel[2]; -+ -+ for(i=0; i<2; i++) -+ { -+ powerBase0 = pPowerLevelOFDM[i]; -+ -+ powerBase0 = (powerBase0<<24) | (powerBase0<<16) |(powerBase0<<8) |powerBase0; -+ *(OfdmBase+i) = powerBase0; -+ //DBG_871X(" [OFDM power base index rf(%c) = 0x%x]\n", ((i==0)?'A':'B'), *(OfdmBase+i)); -+ } -+ -+ for(i=0; iNumTotalRFPath; i++) -+ { -+ //Check HT20 to HT40 diff -+ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) -+ { -+ powerlevel[i] = pPowerLevelBW20[i]; -+ } -+ else -+ { -+ powerlevel[i] = pPowerLevelBW40[i]; -+ } -+ powerBase1 = powerlevel[i]; -+ powerBase1 = (powerBase1<<24) | (powerBase1<<16) |(powerBase1<<8) |powerBase1; -+ *(MCSBase+i) = powerBase1; -+ //DBG_871X(" [MCS power base index rf(%c) = 0x%x]\n", ((i==0)?'A':'B'), *(MCSBase+i)); -+ } -+} -+ -+void getTxPowerWriteValByRegulatory8812( -+ PADAPTER Adapter, -+ u8 Channel, -+ u8 index, -+ u32* powerBase0, -+ u32* powerBase1, -+ u32* pOutWriteVal -+ ) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ u8 i, chnlGroup=0, pwr_diff_limit[4], customer_pwr_limit; -+ s8 pwr_diff=0; -+ u32 writeVal, customer_limit, rf; -+ u8 Regulatory = pHalData->EEPROMRegulatory; -+ -+ // -+ // Index 0 & 1= legacy OFDM, 2-5=HT_MCS rate -+ // -+#if 0 // (INTEL_PROXIMITY_SUPPORT == 1) -+ if(pMgntInfo->IntelProximityModeInfo.PowerOutput > 0) -+ Regulatory = 2; -+#endif -+ -+ for(rf=0; rf<2; rf++) -+ { -+ switch(Regulatory) -+ { -+ case 0: // Realtek better performance -+ // increase power diff defined by Realtek for large power -+ chnlGroup = 0; -+ //RTPRINT(FPHY, PHY_TXPWR, ("MCSTxPowerLevelOriginalOffset[%d][%d] = 0x%x\n", -+ // chnlGroup, index, pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)])); -+ writeVal = pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)] + -+ ((index<2)?powerBase0[rf]:powerBase1[rf]); -+ //RTPRINT(FPHY, PHY_TXPWR, ("RTK better performance, writeVal(%c) = 0x%x\n", ((rf==0)?'A':'B'), writeVal)); -+ break; -+ case 1: // Realtek regulatory -+ // increase power diff defined by Realtek for regulatory -+ { -+ if(pHalData->pwrGroupCnt == 1) -+ chnlGroup = 0; -+ //if(pHalData->pwrGroupCnt >= pHalData->PGMaxGroup) -+ { -+ if (Channel < 3) // Chanel 1-2 -+ chnlGroup = 0; -+ else if (Channel < 6) // Channel 3-5 -+ chnlGroup = 1; -+ else if(Channel <9) // Channel 6-8 -+ chnlGroup = 2; -+ else if(Channel <12) // Channel 9-11 -+ chnlGroup = 3; -+ else if(Channel <14) // Channel 12-13 -+ chnlGroup = 4; -+ else if(Channel ==14) // Channel 14 -+ chnlGroup = 5; -+ -+/* -+ if(Channel <= 3) -+ chnlGroup = 0; -+ else if(Channel >= 4 && Channel <= 9) -+ chnlGroup = 1; -+ else if(Channel > 9) -+ chnlGroup = 2; -+ -+ -+ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) -+ chnlGroup++; -+ else -+ chnlGroup+=4; -+*/ -+ } -+ //RTPRINT(FPHY, PHY_TXPWR, ("MCSTxPowerLevelOriginalOffset[%d][%d] = 0x%x\n", -+ //chnlGroup, index, pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)])); -+ writeVal = pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)] + -+ ((index<2)?powerBase0[rf]:powerBase1[rf]); -+ //RTPRINT(FPHY, PHY_TXPWR, ("Realtek regulatory, 20MHz, writeVal(%c) = 0x%x\n", ((rf==0)?'A':'B'), writeVal)); -+ } -+ break; -+ case 2: // Better regulatory -+ // don't increase any power diff -+ writeVal = ((index<2)?powerBase0[rf]:powerBase1[rf]); -+ //RTPRINT(FPHY, PHY_TXPWR, ("Better regulatory, writeVal(%c) = 0x%x\n", ((rf==0)?'A':'B'), writeVal)); -+ break; -+ case 3: // Customer defined power diff. -+ // increase power diff defined by customer. -+ chnlGroup = 0; -+ //RTPRINT(FPHY, PHY_TXPWR, ("MCSTxPowerLevelOriginalOffset[%d][%d] = 0x%x\n", -+ // chnlGroup, index, pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)])); -+ -+ /* -+ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) -+ { -+ RTPRINT(FPHY, PHY_TXPWR, ("customer's limit, 40MHz rf(%c) = 0x%x\n", -+ ((rf==0)?'A':'B'), pHalData->PwrGroupHT40[rf][Channel-1])); -+ } -+ else -+ { -+ RTPRINT(FPHY, PHY_TXPWR, ("customer's limit, 20MHz rf(%c) = 0x%x\n", -+ ((rf==0)?'A':'B'), pHalData->PwrGroupHT20[rf][Channel-1])); -+ }*/ -+ -+ if(index < 2) -+ pwr_diff = pHalData->TxPwrLegacyHtDiff[rf][Channel-1]; -+ else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_20) -+ pwr_diff = pHalData->TxPwrHt20Diff[rf][Channel-1]; -+ -+ //RTPRINT(FPHY, PHY_TXPWR, ("power diff rf(%c) = 0x%x\n", ((rf==0)?'A':'B'), pwr_diff)); -+ -+ if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) -+ customer_pwr_limit = pHalData->PwrGroupHT40[rf][Channel-1]; -+ else -+ customer_pwr_limit = pHalData->PwrGroupHT20[rf][Channel-1]; -+ -+ //RTPRINT(FPHY, PHY_TXPWR, ("customer pwr limit rf(%c) = 0x%x\n", ((rf==0)?'A':'B'), customer_pwr_limit)); -+ -+ if(pwr_diff >= customer_pwr_limit) -+ pwr_diff = 0; -+ else -+ pwr_diff = customer_pwr_limit - pwr_diff; -+ -+ for (i=0; i<4; i++) -+ { -+ pwr_diff_limit[i] = (u1Byte)((pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)]&(0x7f<<(i*8)))>>(i*8)); -+ -+ if(pwr_diff_limit[i] > pwr_diff) -+ pwr_diff_limit[i] = pwr_diff; -+ } -+ customer_limit = (pwr_diff_limit[3]<<24) | (pwr_diff_limit[2]<<16) | -+ (pwr_diff_limit[1]<<8) | (pwr_diff_limit[0]); -+ //RTPRINT(FPHY, PHY_TXPWR, ("Customer's limit rf(%c) = 0x%x\n", ((rf==0)?'A':'B'), customer_limit)); -+ writeVal = customer_limit + ((index<2)?powerBase0[rf]:powerBase1[rf]); -+ //RTPRINT(FPHY, PHY_TXPWR, ("Customer, writeVal rf(%c)= 0x%x\n", ((rf==0)?'A':'B'), writeVal)); -+ break; -+ default: -+ chnlGroup = 0; -+ writeVal = pHalData->MCSTxPowerLevelOriginalOffset[chnlGroup][index+(rf?8:0)] + -+ ((index<2)?powerBase0[rf]:powerBase1[rf]); -+ //RTPRINT(FPHY, PHY_TXPWR, ("RTK better performance, writeVal rf(%c) = 0x%x\n", ((rf==0)?'A':'B'), writeVal)); -+ break; -+ } -+ -+// 20100427 Joseph: Driver dynamic Tx power shall not affect Tx power. It shall be determined by power training mechanism. -+// Currently, we cannot fully disable driver dynamic tx power mechanism because it is referenced by BT coexist mechanism. -+// In the future, two mechanism shall be separated from each other and maintained independantly. Thanks for Lanhsin's reminder. -+ //92d do not need this -+ if(pdmpriv->DynamicTxHighPowerLvl == TxHighPwrLevel_Level1) -+ writeVal = 0x14141414; -+ else if(pdmpriv->DynamicTxHighPowerLvl == TxHighPwrLevel_Level2) -+ writeVal = 0x00000000; -+ -+ // 20100628 Joseph: High power mode for BT-Coexist mechanism. -+ // This mechanism is only applied when Driver-Highpower-Mechanism is OFF. -+ if(pdmpriv->DynamicTxHighPowerLvl == TxHighPwrLevel_BT1) -+ { -+ //RTPRINT(FBT, BT_TRACE, ("Tx Power (-6)\n")); -+ writeVal = writeVal - 0x06060606; -+ } -+ else if(pdmpriv->DynamicTxHighPowerLvl == TxHighPwrLevel_BT2) -+ { -+ //RTPRINT(FBT, BT_TRACE, ("Tx Power (-0)\n")); -+ writeVal = writeVal ; -+ } -+ /* -+ if(pMgntInfo->bDisableTXPowerByRate) -+ { -+ // add for OID_RT_11N_TX_POWER_BY_RATE ,disable tx powre change by rate -+ writeVal = 0x2c2c2c2c; -+ } -+ */ -+ *(pOutWriteVal+rf) = writeVal; -+ } -+} -+ -+static void writeOFDMPowerReg8812( -+ PADAPTER Adapter, -+ u8 index, -+ u32* pValue -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ u2Byte RegOffset_A[6] = { -+ rTxAGC_A_Ofdm18_Ofdm6_JAguar, -+ rTxAGC_A_Ofdm54_Ofdm24_JAguar, -+ rTxAGC_A_MCS3_MCS0_JAguar, -+ rTxAGC_A_MCS7_MCS4_JAguar, -+ rTxAGC_A_MCS11_MCS8_JAguar, -+ rTxAGC_A_MCS15_MCS12_JAguar -+ }; -+ u2Byte RegOffset_B[6] = { -+ rTxAGC_B_Ofdm18_Ofdm6_JAguar, -+ rTxAGC_B_Ofdm54_Ofdm24_JAguar, -+ rTxAGC_B_MCS3_MCS0_JAguar, -+ rTxAGC_B_MCS7_MCS4_JAguar, -+ rTxAGC_B_MCS11_MCS8_JAguar, -+ rTxAGC_B_MCS15_MCS12_JAguar -+ }; -+ -+ u8 i, rf, pwr_val[4]; -+ u32 writeVal; -+ u16 RegOffset; -+ -+ for(rf=0; rf<2; rf++) -+ { -+ writeVal = pValue[rf]; -+ for(i=0; i>(i*8)); -+ if (pwr_val[i] > RF6052_MAX_TX_PWR) -+ pwr_val[i] = RF6052_MAX_TX_PWR; -+ } -+ writeVal = (pwr_val[3]<<24) | (pwr_val[2]<<16) |(pwr_val[1]<<8) |pwr_val[0]; -+ -+ if(rf == 0) -+ RegOffset = RegOffset_A[index]; -+ else -+ RegOffset = RegOffset_B[index]; -+ PHY_SetBBReg(Adapter, RegOffset, bMaskDWord, writeVal); -+ //RTPRINT(FPHY, PHY_TXPWR, ("Set 0x%x = %08x\n", RegOffset, writeVal)); -+ } -+} -+ -+void -+PHY_RF6052SetCckTxPower8812( -+ PADAPTER Adapter, -+ u8* pPowerlevel) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; -+ u32 TxAGC[2]={0, 0}, tmpval=0; -+ bool TurboScanOff = false; -+ u8 idx1, idx2; -+ u8* ptr; -+ -+ //FOR CE ,must disable turbo scan -+ TurboScanOff = true; -+ -+ if(pmlmeext->sitesurvey_res.state == SCAN_PROCESS) -+ { -+ TxAGC[RF_PATH_A] = 0x3f3f3f3f; -+ TxAGC[RF_PATH_B] = 0x3f3f3f3f; -+ -+ TurboScanOff = true;//disable turbo scan -+ -+ if(TurboScanOff) -+ { -+ for(idx1=RF_PATH_A; idx1<=RF_PATH_B; idx1++) -+ { -+ TxAGC[idx1] = -+ pPowerlevel[idx1] | (pPowerlevel[idx1]<<8) | -+ (pPowerlevel[idx1]<<16) | (pPowerlevel[idx1]<<24); -+ // 2010/10/18 MH For external PA module. We need to limit power index to be less than 0x20. -+ if (TxAGC[idx1] > 0x20 && pHalData->ExternalPA_5G) -+ TxAGC[idx1] = 0x20; -+ } -+ } -+ } -+ else -+ { -+// 20100427 Joseph: Driver dynamic Tx power shall not affect Tx power. It shall be determined by power training mechanism. -+// Currently, we cannot fully disable driver dynamic tx power mechanism because it is referenced by BT coexist mechanism. -+// In the future, two mechanism shall be separated from each other and maintained independantly. Thanks for Lanhsin's reminder. -+ if(pdmpriv->DynamicTxHighPowerLvl == TxHighPwrLevel_Level1) -+ { -+ TxAGC[RF_PATH_A] = 0x10101010; -+ TxAGC[RF_PATH_B] = 0x10101010; -+ } -+ else if(pdmpriv->DynamicTxHighPowerLvl == TxHighPwrLevel_Level2) -+ { -+ TxAGC[RF_PATH_A] = 0x00000000; -+ TxAGC[RF_PATH_B] = 0x00000000; -+ } -+ else -+ { -+ for(idx1=RF_PATH_A; idx1<=RF_PATH_B; idx1++) -+ { -+ TxAGC[idx1] = -+ pPowerlevel[idx1] | (pPowerlevel[idx1]<<8) | -+ (pPowerlevel[idx1]<<16) | (pPowerlevel[idx1]<<24); -+ } -+ -+ if(pHalData->EEPROMRegulatory==0) -+ { -+ tmpval = (pHalData->MCSTxPowerLevelOriginalOffset[0][6]) + -+ (pHalData->MCSTxPowerLevelOriginalOffset[0][7]<<8); -+ TxAGC[RF_PATH_A] += tmpval; -+ -+ tmpval = (pHalData->MCSTxPowerLevelOriginalOffset[0][14]) + -+ (pHalData->MCSTxPowerLevelOriginalOffset[0][15]<<24); -+ TxAGC[RF_PATH_B] += tmpval; -+ } -+ } -+ } -+ -+ for(idx1=RF_PATH_A; idx1<=RF_PATH_B; idx1++) -+ { -+ ptr = (u8*)(&(TxAGC[idx1])); -+ for(idx2=0; idx2<4; idx2++) -+ { -+ if(*ptr > RF6052_MAX_TX_PWR) -+ *ptr = RF6052_MAX_TX_PWR; -+ ptr++; -+ } -+ } -+ -+ // rf-A cck tx power -+ tmpval = TxAGC[RF_PATH_A]&0xff; -+ PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, bMaskByte1, tmpval); -+ //RT_DISP(FPHY, PHY_TXPWR, ("CCK PWR 1M (rf-A) = 0x%x (reg 0x%x)\n", tmpval, rTxAGC_A_CCK1_Mcs32)); -+ tmpval = TxAGC[RF_PATH_A]>>8; -+ PHY_SetBBReg(Adapter, rTxAGC_A_CCK11_CCK1_JAguar, 0xffffff00, tmpval); -+ //RT_DISP(FPHY, PHY_TXPWR, ("CCK PWR 2~11M (rf-A) = 0x%x (reg 0x%x)\n", tmpval, rTxAGC_B_CCK11_A_CCK2_11)); -+ -+ // rf-B cck tx power -+ tmpval = TxAGC[RF_PATH_B]>>24; -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, bMaskByte0, tmpval); -+ //RT_DISP(FPHY, PHY_TXPWR, ("CCK PWR 11M (rf-B) = 0x%x (reg 0x%x)\n", tmpval, rTxAGC_B_CCK11_A_CCK2_11)); -+ tmpval = TxAGC[RF_PATH_B]&0x00ffffff; -+ PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_CCK1_JAguar, 0xffffff00, tmpval); -+ //RT_DISP(FPHY, PHY_TXPWR, ("CCK PWR 1~5.5M (rf-B) = 0x%x (reg 0x%x)\n", tmpval, rTxAGC_B_CCK1_55_Mcs32)); -+ -+} /* PHY_RF6052SetCckTxPower */ -+ -+void -+PHY_RF6052SetOFDMTxPower8812( -+ PADAPTER Adapter, -+ u8* pPowerLevelOFDM, -+ u8* pPowerLevelBW20, -+ u8* pPowerLevelBW40, -+ u8 Channel) -+{ -+ u32 writeVal[2], powerBase0[2], powerBase1[2], pwrtrac_value; -+ u8 index = 0; -+ -+ -+ //DBG_871X("PHY_RF6052SetOFDMTxPower, channel(%d) \n", Channel); -+ -+ getPowerBase8812(Adapter, pPowerLevelOFDM,pPowerLevelBW20,pPowerLevelBW40, Channel, &powerBase0[0], &powerBase1[0]); -+ -+ for(index=0; index<6; index++) -+ { -+ getTxPowerWriteValByRegulatory8812(Adapter, Channel, index, -+ &powerBase0[0], &powerBase1[0], &writeVal[0]); -+ -+ writeOFDMPowerReg8812(Adapter, index, &writeVal[0]); -+ } -+} -+ -+static int -+phy_RF6052_Config_ParaFile_8812( -+ PADAPTER Adapter -+ ) -+{ -+ u8 eRFPath; -+ int rtStatus = _SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ static char sz8812RadioAFile[] = RTL8812_PHY_RADIO_A; -+ static char sz8812RadioBFile[] = RTL8812_PHY_RADIO_B; -+ static char sz8812TxPwrTrack[] = RTL8812_TXPWR_TRACK; -+ static char sz8821RadioAFile[] = RTL8821_PHY_RADIO_A; -+ static char sz8821RadioBFile[] = RTL8821_PHY_RADIO_B; -+ static char sz8821TxPwrTrack[] = RTL8821_TXPWR_TRACK; -+ char *pszRadioAFile = NULL, *pszRadioBFile = NULL, *pszTxPwrTrack = NULL; -+ -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ { -+ pszRadioAFile = sz8812RadioAFile; -+ pszRadioBFile = sz8812RadioBFile; -+ pszTxPwrTrack = sz8812TxPwrTrack; -+ } -+ else -+ { -+ pszRadioAFile = sz8821RadioAFile; -+ pszRadioBFile = sz8821RadioBFile; -+ pszTxPwrTrack = sz8821TxPwrTrack; -+ } -+ -+ -+ //3//----------------------------------------------------------------- -+ //3// <2> Initialize RF -+ //3//----------------------------------------------------------------- -+ //for(eRFPath = RF_PATH_A; eRFPath NumTotalRFPath; eRFPath++) -+ for(eRFPath = 0; eRFPath NumTotalRFPath; eRFPath++) -+ { -+ /*----Initialize RF fom connfiguration file----*/ -+ switch(eRFPath) -+ { -+ case RF_PATH_A: -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if(HAL_STATUS_FAILURE ==ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv,CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) -+ rtStatus= _FAIL; -+#else -+ rtStatus = PHY_ConfigRFWithParaFile(Adapter, pszRadioAFile, eRFPath); -+#endif//#ifdef CONFIG_EMBEDDED_FWIMG -+ break; -+ case RF_PATH_B: -+#ifdef CONFIG_EMBEDDED_FWIMG -+ if(HAL_STATUS_FAILURE ==ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv,CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) -+ rtStatus= _FAIL; -+#else -+ rtStatus =PHY_ConfigRFWithParaFile(Adapter, pszRadioBFile, eRFPath); -+#endif -+ break; -+ default: -+ break; -+ } -+ -+ if(rtStatus != _SUCCESS){ -+ DBG_871X("%s():Radio[%d] Fail!!", __FUNCTION__, eRFPath); -+ goto phy_RF6052_Config_ParaFile_Fail; -+ } -+ -+ } -+ -+ //3 ----------------------------------------------------------------- -+ //3 Configuration of Tx Power Tracking -+ //3 ----------------------------------------------------------------- -+ -+#ifdef CONFIG_EMBEDDED_FWIMG -+ ODM_ConfigRFWithTxPwrTrackHeaderFile(&pHalData->odmpriv); -+#else -+ PHY_ConfigRFWithTxPwrTrackParaFile(Adapter, pszTxPwrTrack); -+#endif -+ -+ //RT_TRACE(COMP_INIT, DBG_LOUD, ("<---phy_RF6052_Config_ParaFile_8812()\n")); -+ -+phy_RF6052_Config_ParaFile_Fail: -+ return rtStatus; -+} -+ -+ -+int -+PHY_RF6052_Config_8812( -+ PADAPTER Adapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ int rtStatus = _SUCCESS; -+ -+ // Initialize general global value -+ if(pHalData->rf_type == RF_1T1R) -+ pHalData->NumTotalRFPath = 1; -+ else -+ pHalData->NumTotalRFPath = 2; -+ -+ // -+ // Config BB and RF -+ // -+ rtStatus = phy_RF6052_Config_ParaFile_8812(Adapter); -+ -+ return rtStatus; -+ -+} -+ -+ -+/* End of HalRf6052.c */ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_rxdesc.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_rxdesc.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_rxdesc.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_rxdesc.c 2018-02-06 17:42:30.715967238 +0200 -@@ -0,0 +1,300 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8812A_RXDESC_C_ -+ -+//#include -+#include -+ -+static s32 translate2dbm(u8 signal_strength_idx) -+{ -+ s32 signal_power; // in dBm. -+ -+ -+ // Translate to dBm (x=0.5y-95). -+ signal_power = (s32)((signal_strength_idx + 1) >> 1); -+ signal_power -= 95; -+ -+ return signal_power; -+} -+ -+ -+static void process_rssi(_adapter *padapter,union recv_frame *prframe) -+{ -+ u32 last_rssi, tmp_val; -+ struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ struct signal_stat * signal_stat = &padapter->recvpriv.signal_strength_data; -+#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+ //DBG_8192C("process_rssi=> pattrib->rssil(%d) signal_strength(%d)\n ",pattrib->RecvSignalPower,pattrib->signal_strength); -+ //if(pRfd->Status.bPacketToSelf || pRfd->Status.bPacketBeacon) -+ { -+ -+ #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ if(signal_stat->update_req) { -+ signal_stat->total_num = 0; -+ signal_stat->total_val = 0; -+ signal_stat->update_req = 0; -+ } -+ -+ signal_stat->total_num++; -+ signal_stat->total_val += pattrib->phy_info.SignalStrength; -+ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; -+ #else //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+ //Adapter->RxStats.RssiCalculateCnt++; //For antenna Test -+ if(padapter->recvpriv.signal_strength_data.total_num++ >= PHY_RSSI_SLID_WIN_MAX) -+ { -+ padapter->recvpriv.signal_strength_data.total_num = PHY_RSSI_SLID_WIN_MAX; -+ last_rssi = padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index]; -+ padapter->recvpriv.signal_strength_data.total_val -= last_rssi; -+ } -+ padapter->recvpriv.signal_strength_data.total_val +=pattrib->phy_info.SignalStrength; -+ -+ padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index++] = pattrib->phy_info.SignalStrength; -+ if(padapter->recvpriv.signal_strength_data.index >= PHY_RSSI_SLID_WIN_MAX) -+ padapter->recvpriv.signal_strength_data.index = 0; -+ -+ -+ tmp_val = padapter->recvpriv.signal_strength_data.total_val/padapter->recvpriv.signal_strength_data.total_num; -+ -+ if(padapter->recvpriv.is_signal_dbg) { -+ padapter->recvpriv.signal_strength= padapter->recvpriv.signal_strength_dbg; -+ padapter->recvpriv.rssi=(s8)translate2dbm((u8)padapter->recvpriv.signal_strength_dbg); -+ } else { -+ padapter->recvpriv.signal_strength= tmp_val; -+ padapter->recvpriv.rssi=(s8)translate2dbm((u8)tmp_val); -+ } -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("UI RSSI = %d, ui_rssi.TotalVal = %d, ui_rssi.TotalNum = %d\n", tmp_val, padapter->recvpriv.signal_strength_data.total_val,padapter->recvpriv.signal_strength_data.total_num)); -+ #endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ } -+ -+}// Process_UI_RSSI_8192C -+ -+ -+ -+static void process_link_qual(_adapter *padapter,union recv_frame *prframe) -+{ -+ u32 last_evm=0, tmpVal; -+ struct rx_pkt_attrib *pattrib; -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ struct signal_stat * signal_stat; -+#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+ if(prframe == NULL || padapter==NULL){ -+ return; -+ } -+ -+ pattrib = &prframe->u.hdr.attrib; -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ signal_stat = &padapter->recvpriv.signal_qual_data; -+#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+ //DBG_8192C("process_link_qual=> pattrib->signal_qual(%d)\n ",pattrib->signal_qual); -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ if(signal_stat->update_req) { -+ signal_stat->total_num = 0; -+ signal_stat->total_val = 0; -+ signal_stat->update_req = 0; -+ } -+ -+ signal_stat->total_num++; -+ signal_stat->total_val += pattrib->phy_info.SignalQuality; -+ signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; -+ -+#else //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ if(pattrib->phy_info.SignalQuality != 0) -+ { -+ // -+ // 1. Record the general EVM to the sliding window. -+ // -+ if(padapter->recvpriv.signal_qual_data.total_num++ >= PHY_LINKQUALITY_SLID_WIN_MAX) -+ { -+ padapter->recvpriv.signal_qual_data.total_num = PHY_LINKQUALITY_SLID_WIN_MAX; -+ last_evm = padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index]; -+ padapter->recvpriv.signal_qual_data.total_val -= last_evm; -+ } -+ padapter->recvpriv.signal_qual_data.total_val += pattrib->phy_info.SignalQuality; -+ -+ padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = pattrib->phy_info.SignalQuality; -+ if(padapter->recvpriv.signal_qual_data.index >= PHY_LINKQUALITY_SLID_WIN_MAX) -+ padapter->recvpriv.signal_qual_data.index = 0; -+ -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("Total SQ=%d pattrib->signal_qual= %d\n", padapter->recvpriv.signal_qual_data.total_val, pattrib->phy_info.SignalQuality)); -+ -+ // <1> Showed on UI for user, in percentage. -+ tmpVal = padapter->recvpriv.signal_qual_data.total_val/padapter->recvpriv.signal_qual_data.total_num; -+ padapter->recvpriv.signal_qual=(u8)tmpVal; -+ -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" pattrib->signal_qual =%d\n", pattrib->phy_info.SignalQuality)); -+ } -+#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+} -+ -+static void process_phy_info(_adapter *padapter, void *prframe) -+{ -+ union recv_frame *precvframe = (union recv_frame *)prframe; -+ -+ // -+ // Check RSSI -+ // -+ process_rssi(padapter, precvframe); -+ // -+ // Check PWDB. -+ // -+ //process_PWDB(padapter, precvframe); -+ -+ //UpdateRxSignalStatistics8192C(Adapter, pRfd); -+ // -+ // Check EVM -+ // -+ process_link_qual(padapter, precvframe); -+ -+} -+ -+void rtl8812_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc) -+{ -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ -+ _rtw_memset(pattrib, 0, sizeof(struct rx_pkt_attrib)); -+ -+ //Offset 0 -+ pattrib->pkt_len = (u16)GET_RX_STATUS_DESC_PKT_LEN_8812(pdesc);//(le32_to_cpu(pdesc->rxdw0)&0x00003fff) -+ pattrib->crc_err = (u8)GET_RX_STATUS_DESC_CRC32_8812(pdesc);//((le32_to_cpu(pdesc->rxdw0) >> 14) & 0x1); -+ pattrib->icv_err = (u8)GET_RX_STATUS_DESC_ICV_8812(pdesc);//((le32_to_cpu(pdesc->rxdw0) >> 15) & 0x1); -+ pattrib->drvinfo_sz = (u8)GET_RX_STATUS_DESC_DRVINFO_SIZE_8812(pdesc) * 8;//((le32_to_cpu(pdesc->rxdw0) >> 16) & 0xf) * 8;//uint 2^3 = 8 bytes -+ pattrib->encrypt = (u8)GET_RX_STATUS_DESC_SECURITY_8812(pdesc);//((le32_to_cpu(pdesc->rxdw0) >> 20) & 0x7); -+ pattrib->qos = (u8)GET_RX_STATUS_DESC_QOS_8812(pdesc);//(( le32_to_cpu( pdesc->rxdw0 ) >> 23) & 0x1);// Qos data, wireless lan header length is 26 -+ pattrib->shift_sz = (u8)GET_RX_STATUS_DESC_SHIFT_8812(pdesc);//((le32_to_cpu(pdesc->rxdw0) >> 24) & 0x3); -+ pattrib->physt = (u8)GET_RX_STATUS_DESC_PHY_STATUS_8812(pdesc);//((le32_to_cpu(pdesc->rxdw0) >> 26) & 0x1); -+ pattrib->bdecrypted = !GET_RX_STATUS_DESC_SWDEC_8812(pdesc);//(le32_to_cpu(pdesc->rxdw0) & BIT(27))? 0:1; -+ -+ //Offset 4 -+ pattrib->priority = (u8)GET_RX_STATUS_DESC_TID_8812(pdesc);//((le32_to_cpu(pdesc->rxdw1) >> 8) & 0xf); -+ pattrib->mdata = (u8)GET_RX_STATUS_DESC_MORE_DATA_8812(pdesc);//((le32_to_cpu(pdesc->rxdw1) >> 26) & 0x1); -+ pattrib->mfrag = (u8)GET_RX_STATUS_DESC_MORE_FRAG_8812(pdesc);//((le32_to_cpu(pdesc->rxdw1) >> 27) & 0x1);//more fragment bit -+ -+ //Offset 8 -+ pattrib->seq_num = (u16)GET_RX_STATUS_DESC_SEQ_8812(pdesc);//(le32_to_cpu(pdesc->rxdw2) & 0x00000fff); -+ pattrib->frag_num = (u8)GET_RX_STATUS_DESC_FRAG_8812(pdesc);//((le32_to_cpu(pdesc->rxdw2) >> 12) & 0xf);//fragmentation number -+ -+ if (GET_RX_STATUS_DESC_RPT_SEL_8812(pdesc)) -+ pattrib->pkt_rpt_type = C2H_PACKET; -+ else -+ pattrib->pkt_rpt_type = NORMAL_RX; -+ -+ //Offset 12 -+ pattrib->data_rate=(u8)GET_RX_STATUS_DESC_RX_RATE_8812(pdesc);//((le32_to_cpu(pdesc->rxdw3))&0x7f); -+ -+ //Offset 16 -+ //Offset 20 -+ -+} -+ -+ -+/* -+ * Notice: -+ * Before calling this function, -+ * precvframe->u.hdr.rx_data should be ready! -+ */ -+void rtl8812_query_rx_phy_status( -+ union recv_frame *precvframe, -+ u8 *pphy_status) -+{ -+ PADAPTER padapter = precvframe->u.hdr.adapter; -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ PODM_PHY_INFO_T pPHYInfo = (PODM_PHY_INFO_T)(&pattrib->phy_info); -+ u8 *wlanhdr; -+ ODM_PACKET_INFO_T pkt_info; -+ u8 *sa; -+ struct sta_priv *pstapriv; -+ struct sta_info *psta; -+ //_irqL irqL; -+ -+ pkt_info.bPacketMatchBSSID =false; -+ pkt_info.bPacketToSelf = false; -+ pkt_info.bPacketBeacon = false; -+ -+ wlanhdr = get_recvframe_data(precvframe); -+ -+ pkt_info.bPacketMatchBSSID = ((!IsFrameTypeCtrl(wlanhdr)) && -+ !pattrib->icv_err && !pattrib->crc_err && -+ _rtw_memcmp(get_hdr_bssid(wlanhdr), get_bssid(&padapter->mlmepriv), ETH_ALEN)); -+ -+ pkt_info.bPacketToSelf = pkt_info.bPacketMatchBSSID && (_rtw_memcmp(get_da(wlanhdr), myid(&padapter->eeprompriv), ETH_ALEN)); -+ -+ pkt_info.bPacketBeacon = pkt_info.bPacketMatchBSSID && (GetFrameSubType(wlanhdr) == WIFI_BEACON); -+ -+ if(pkt_info.bPacketBeacon){ -+ if(check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) == true){ -+ sa = padapter->mlmepriv.cur_network.network.MacAddress; -+ #if 0 -+ { -+ DBG_8192C("==> rx beacon from AP[%02x:%02x:%02x:%02x:%02x:%02x]\n", -+ sa[0],sa[1],sa[2],sa[3],sa[4],sa[5]); -+ } -+ #endif -+ } -+ //to do Ad-hoc -+ } -+ else{ -+ sa = get_sa(wlanhdr); -+ } -+ -+ pstapriv = &padapter->stapriv; -+ pkt_info.StationID = 0xFF; -+ psta = rtw_get_stainfo(pstapriv, sa); -+ if (psta) -+ { -+ pkt_info.StationID = psta->mac_id; -+ //DBG_8192C("%s ==> StationID(%d)\n",__FUNCTION__,pkt_info.StationID); -+ } -+ pkt_info.DataRate = pattrib->data_rate; -+ //rtl8188e_query_rx_phy_status(precvframe, pphy_status); -+ -+ //_enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); -+ ODM_PhyStatusQuery(&pHalData->odmpriv,pPHYInfo,pphy_status,&(pkt_info)); -+ //_exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); -+ -+ precvframe->u.hdr.psta = NULL; -+ if (pkt_info.bPacketMatchBSSID && -+ (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == true)) -+ { -+ if (psta) -+ { -+ precvframe->u.hdr.psta = psta; -+ process_phy_info(padapter, precvframe); -+ -+ } -+ } -+ else if (pkt_info.bPacketToSelf || pkt_info.bPacketBeacon) -+ { -+ if (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE) == true) -+ { -+ if (psta) -+ { -+ precvframe->u.hdr.psta = psta; -+ } -+ } -+ process_phy_info(padapter, precvframe); -+ } -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_sreset.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_sreset.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_sreset.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_sreset.c 2018-02-06 17:42:30.715967238 +0200 -@@ -0,0 +1,94 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8812A_SRESET_C_ -+ -+//#include -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+void rtl8812_sreset_xmit_status_check(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ unsigned long current_time; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ unsigned int diff_time; -+ u32 txdma_status; -+ -+ if( (txdma_status=rtw_read32(padapter, REG_TXDMA_STATUS)) !=0x00){ -+ DBG_871X("%s REG_TXDMA_STATUS:0x%08x\n", __FUNCTION__, txdma_status); -+ rtw_hal_sreset_reset(padapter); -+ } -+ current_time = rtw_get_current_time(); -+ -+ if (0 == pxmitpriv->free_xmitbuf_cnt || 0 == pxmitpriv->free_xmit_extbuf_cnt) { -+ -+ diff_time = rtw_get_passing_time_ms(psrtpriv->last_tx_time); -+ -+ if (diff_time > 2000) { -+ if (psrtpriv->last_tx_complete_time == 0) { -+ psrtpriv->last_tx_complete_time = current_time; -+ } else { -+ diff_time = rtw_get_passing_time_ms(psrtpriv->last_tx_complete_time); -+ if (diff_time > 4000) { -+ DBG_871X("%s tx hang\n", __FUNCTION__); -+ rtw_hal_sreset_reset(padapter); -+ } -+ } -+ } -+ } -+ -+ if (psrtpriv->dbg_trigger_point == SRESET_TGP_XMIT_STATUS) { -+ psrtpriv->dbg_trigger_point = SRESET_TGP_NULL; -+ rtw_hal_sreset_reset(padapter); -+ return; -+ } -+} -+ -+void rtl8812_sreset_linked_status_check(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ -+ u32 rx_dma_status = 0; -+ rx_dma_status = rtw_read32(padapter,REG_RXDMA_STATUS); -+ if(rx_dma_status!= 0x00){ -+ DBG_8192C("%s REG_RXDMA_STATUS:0x%08x\n",__FUNCTION__,rx_dma_status); -+ } -+#if 0 -+ u32 regc50,regc58,reg824,reg800; -+ regc50 = rtw_read32(padapter,0xc50); -+ regc58 = rtw_read32(padapter,0xc58); -+ reg824 = rtw_read32(padapter,0x824); -+ reg800 = rtw_read32(padapter,0x800); -+ if( ((regc50&0xFFFFFF00)!= 0x69543400)|| -+ ((regc58&0xFFFFFF00)!= 0x69543400)|| -+ (((reg824&0xFFFFFF00)!= 0x00390000)&&(((reg824&0xFFFFFF00)!= 0x80390000)))|| -+ ( ((reg800&0xFFFFFF00)!= 0x03040000)&&((reg800&0xFFFFFF00)!= 0x83040000))) -+ { -+ DBG_8192C("%s regc50:0x%08x, regc58:0x%08x, reg824:0x%08x, reg800:0x%08x,\n", __FUNCTION__, -+ regc50, regc58, reg824, reg800); -+ rtw_hal_sreset_reset(padapter); -+ } -+#endif -+ -+ if (psrtpriv->dbg_trigger_point == SRESET_TGP_LINK_STATUS) { -+ psrtpriv->dbg_trigger_point = SRESET_TGP_NULL; -+ rtw_hal_sreset_reset(padapter); -+ return; -+ } -+} -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812au_led.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812au_led.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812au_led.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812au_led.c 2018-02-06 17:42:30.715967238 +0200 -@@ -0,0 +1,442 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8812AU_LED_C_ -+ -+//#include -+#include -+ -+//================================================================================ -+// LED object. -+//================================================================================ -+ -+ -+//================================================================================ -+// Prototype of protected function. -+//================================================================================ -+ -+ -+//================================================================================ -+// LED_819xUsb routines. -+//================================================================================ -+ -+// -+// Description: -+// Turn on LED according to LedPin specified. -+// -+static void -+SwLedOn_8812AU( -+ PADAPTER padapter, -+ PLED_USB pLed -+) -+{ -+ u8 LedCfg; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if( (padapter->bSurpriseRemoved == true) || ( padapter->bDriverStopped == true)) -+ { -+ return; -+ } -+ -+ if( RT_GetInterfaceSelection(padapter) == INTF_SEL2_MINICARD || -+ RT_GetInterfaceSelection(padapter) == INTF_SEL3_USB_Solo || -+ RT_GetInterfaceSelection(padapter) == INTF_SEL4_USB_Combo) -+ { -+ LedCfg = rtw_read8(padapter, REG_LEDCFG2); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("In SwLedON,LedAddr:%X LEDPIN=%d\n",REG_LEDCFG2, pLed->LedPin)); -+ switch(pLed->LedPin) -+ { -+ case LED_PIN_GPIO0: -+ break; -+ -+ case LED_PIN_LED0: -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("In SwLedOn,LedAddr:%X LEDPIN=%d\n",REG_LEDCFG2, pLed->LedPin)); -+ LedCfg = rtw_read8(padapter, REG_LEDCFG2); -+ rtw_write8(padapter, REG_LEDCFG2, (LedCfg&0xf0)|BIT5|BIT6); // SW control led0 on. -+ break; -+ -+ case LED_PIN_LED1: -+ rtw_write8(padapter, REG_LEDCFG2, (LedCfg&0x0f)|BIT5); // SW control led1 on. -+ break; -+ -+ default: -+ break; -+ } -+ } -+ else -+ { -+ switch(pLed->LedPin) -+ { -+ case LED_PIN_GPIO0: -+ break; -+ -+ case LED_PIN_LED0: -+ if(pHalData->AntDivCfg==0) -+ { -+ LedCfg = rtw_read8(padapter, REG_LEDCFG0); -+ rtw_write8(padapter, REG_LEDCFG0, (LedCfg&0x70)|BIT5); // SW control led0 on. -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedOn LED0 0x%x\n", rtw_read32(padapter, REG_LEDCFG0))); -+ } -+ else -+ { -+ LedCfg = rtw_read8(padapter, REG_LEDCFG2); -+ rtw_write8(padapter, REG_LEDCFG2, (LedCfg&0xe0)|BIT7|BIT6|BIT5); // SW control led0 on. -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedOn LED0 Addr 0x%x, 0x%x\n", REG_LEDCFG2, rtw_read32(padapter, REG_LEDCFG2))); -+ } -+ break; -+ -+ case LED_PIN_LED1: -+ LedCfg = rtw_read8(padapter, (REG_LEDCFG1)); -+ rtw_write8(padapter, (REG_LEDCFG1), (LedCfg&0x70)|BIT5); // SW control led1 on. -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedOn LED1 0x%x\n", rtw_read32(padapter, REG_LEDCFG1))); -+ break; -+ -+ case LED_PIN_LED2: -+ LedCfg = rtw_read8(padapter, (REG_LEDCFG2)); -+ rtw_write8(padapter, (REG_LEDCFG2), (LedCfg&0x70)|BIT5); // SW control led1 on. -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedOn LED2 0x%x\n", rtw_read32(padapter, REG_LEDCFG2))); -+ break; -+ -+ default: -+ break; -+ } -+ } -+ -+ pLed->bLedOn = true; -+} -+ -+ -+// -+// Description: -+// Turn off LED according to LedPin specified. -+// -+static void -+SwLedOff_8812AU( -+ PADAPTER padapter, -+ PLED_USB pLed -+) -+{ -+ u8 LedCfg; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ if(padapter->bSurpriseRemoved == true) -+ { -+ return; -+ } -+ -+ if( RT_GetInterfaceSelection(padapter) == INTF_SEL2_MINICARD || -+ RT_GetInterfaceSelection(padapter) == INTF_SEL3_USB_Solo || -+ RT_GetInterfaceSelection(padapter) == INTF_SEL4_USB_Combo) -+ { -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("In SwLedOff,LedAddr:%X LEDPIN=%d\n",REG_LEDCFG2, pLed->LedPin)); -+ LedCfg = rtw_read8(padapter, REG_LEDCFG2); -+ -+ // 2009/10/23 MH Issau eed to move the LED GPIO from bit 0 to bit3. -+ // 2009/10/26 MH Issau if tyhe device is 8c DID is 0x8176, we need to enable bit6 to -+ // enable GPIO8 for controlling LED. -+ // 2010/07/02 Supprt Open-drain arrangement for controlling the LED. Added by Roger. -+ // -+ switch(pLed->LedPin) -+ { -+ -+ case LED_PIN_GPIO0: -+ break; -+ -+ case LED_PIN_LED0: -+ if(pHalData->bLedOpenDrain == true) -+ { -+ LedCfg &= 0x90; // Set to software control. -+ rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3)); -+ LedCfg = rtw_read8(padapter, REG_MAC_PINMUX_CFG); -+ LedCfg &= 0xFE; -+ rtw_write8(padapter, REG_MAC_PINMUX_CFG, LedCfg); -+ } -+ else -+ { -+ rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3|BIT5|BIT6)); -+ } -+ break; -+ -+ case LED_PIN_LED1: -+ LedCfg &= 0x0f; // Set to software control. -+ rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3)); -+ break; -+ -+ default: -+ break; -+ } -+ } -+ else -+ { -+ switch(pLed->LedPin) -+ { -+ case LED_PIN_GPIO0: -+ break; -+ -+ case LED_PIN_LED0: -+ if(pHalData->AntDivCfg==0) -+ { -+ LedCfg = rtw_read8(padapter, REG_LEDCFG0); -+ LedCfg &= 0x70; // Set to software control. -+ rtw_write8(padapter, REG_LEDCFG0, (LedCfg|BIT3|BIT5)); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedOff LED0 0x%x\n", rtw_read32(padapter, REG_LEDCFG0))); -+ } -+ else -+ { -+ LedCfg = rtw_read8(padapter, REG_LEDCFG2); -+ LedCfg &= 0xe0; // Set to software control. -+ if(IS_HARDWARE_TYPE_8723A(padapter)) -+ rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3|BIT7|BIT5)); -+ else -+ rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3|BIT7|BIT6|BIT5)); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedOff LED0 0x%x\n", rtw_read32(padapter, REG_LEDCFG2))); -+ } -+ break; -+ -+ case LED_PIN_LED1: -+ LedCfg = rtw_read8(padapter, REG_LEDCFG1); -+ LedCfg &= 0x70; // Set to software control. -+ rtw_write8(padapter, REG_LEDCFG1, (LedCfg|BIT3|BIT5)); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedOff LED1 0x%x\n", rtw_read32(padapter, REG_LEDCFG1))); -+ break; -+ -+ case LED_PIN_LED2: -+ LedCfg = rtw_read8(padapter, REG_LEDCFG2); -+ LedCfg &= 0x70; // Set to software control. -+ rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3|BIT5)); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("SwLedOff LED1 0x%x\n", rtw_read32(padapter, REG_LEDCFG2))); -+ break; -+ -+ default: -+ break; -+ } -+ } -+ -+ pLed->bLedOn = false; -+} -+ -+// -+// Description: -+// Turn on LED according to LedPin specified. -+// -+static void -+SwLedOn_8821AU( -+ PADAPTER Adapter, -+ PLED_USB pLed -+) -+{ -+ u8 LedCfg; -+ -+ if( (Adapter->bSurpriseRemoved == true) || ( Adapter->bDriverStopped == true)) -+ { -+ return; -+ } -+ -+ if( RT_GetInterfaceSelection(Adapter) == INTF_SEL2_MINICARD || -+ RT_GetInterfaceSelection(Adapter) == INTF_SEL3_USB_Solo || -+ RT_GetInterfaceSelection(Adapter) == INTF_SEL4_USB_Combo) -+ { -+ LedCfg = rtw_read8(Adapter, REG_LEDCFG2); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("In SwLedON,LedAddr:%X LEDPIN=%d\n",REG_LEDCFG2, pLed->LedPin)); -+ switch(pLed->LedPin) -+ { -+ case LED_PIN_GPIO0: -+ break; -+ -+ case LED_PIN_LED0: -+ -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("In SwLedOn,LedAddr:%X LEDPIN=%d\n",REG_LEDCFG2, pLed->LedPin)); -+ LedCfg = rtw_read8(Adapter, REG_LEDCFG2); -+ rtw_write8(Adapter, REG_LEDCFG2, (LedCfg&0xf0)|BIT5|BIT6); // SW control led0 on. -+ break; -+ -+ case LED_PIN_LED1: -+ rtw_write8(Adapter, REG_LEDCFG2, (LedCfg&0x0f)|BIT5); // SW control led1 on. -+ break; -+ -+ default: -+ break; -+ -+ } -+ } -+ else -+ { -+ switch(pLed->LedPin) -+ { -+ case LED_PIN_GPIO0: -+ break; -+ -+ case LED_PIN_LED0: -+ case LED_PIN_LED1: -+ case LED_PIN_LED2: -+ if(IS_HARDWARE_TYPE_8821U(Adapter)) -+ { -+ LedCfg = rtw_read8(Adapter, REG_LEDCFG2); -+ rtw_write8(Adapter, REG_LEDCFG2, ((LedCfg&0x20) & (~BIT3))|BIT5); // SW control led0 on. -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("8821 SwLedOn LED2 0x%x\n", rtw_read32(Adapter, REG_LEDCFG0))); -+ } -+ -+ break; -+ -+ default: -+ break; -+ } -+ } -+ pLed->bLedOn = true; -+} -+ -+ -+// -+// Description: -+// Turn off LED according to LedPin specified. -+// -+static void -+SwLedOff_8821AU( -+ PADAPTER Adapter, -+ PLED_USB pLed -+) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 LedCfg; -+ -+ if(Adapter->bSurpriseRemoved == true) -+ { -+ return; -+ } -+ -+ if( RT_GetInterfaceSelection(Adapter) == INTF_SEL2_MINICARD || -+ RT_GetInterfaceSelection(Adapter) == INTF_SEL3_USB_Solo || -+ RT_GetInterfaceSelection(Adapter) == INTF_SEL4_USB_Combo) -+ { -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("In SwLedOff,LedAddr:%X LEDPIN=%d\n",REG_LEDCFG2, pLed->LedPin)); -+ LedCfg = rtw_read8(Adapter, REG_LEDCFG2); -+ -+ // 2009/10/23 MH Issau eed to move the LED GPIO from bit 0 to bit3. -+ // 2009/10/26 MH Issau if tyhe device is 8c DID is 0x8176, we need to enable bit6 to -+ // enable GPIO8 for controlling LED. -+ // 2010/07/02 Supprt Open-drain arrangement for controlling the LED. Added by Roger. -+ // -+ switch(pLed->LedPin) -+ { -+ -+ case LED_PIN_GPIO0: -+ break; -+ -+ case LED_PIN_LED0: -+ if(pHalData->bLedOpenDrain == true) -+ { -+ LedCfg &= 0x90; // Set to software control. -+ rtw_write8(Adapter, REG_LEDCFG2, (LedCfg|BIT3)); -+ LedCfg = rtw_read8(Adapter, REG_MAC_PINMUX_CFG); -+ LedCfg &= 0xFE; -+ rtw_write8(Adapter, REG_MAC_PINMUX_CFG, LedCfg); -+ } -+ else -+ { -+ rtw_write8(Adapter, REG_LEDCFG2, (LedCfg|BIT3|BIT5|BIT6)); -+ } -+ break; -+ -+ case LED_PIN_LED1: -+ LedCfg &= 0x0f; // Set to software control. -+ rtw_write8(Adapter, REG_LEDCFG2, (LedCfg|BIT3)); -+ break; -+ -+ default: -+ break; -+ } -+ } -+ else -+ { -+ switch(pLed->LedPin) -+ { -+ case LED_PIN_GPIO0: -+ break; -+ -+ case LED_PIN_LED0: -+ case LED_PIN_LED1: -+ case LED_PIN_LED2: -+ if(IS_HARDWARE_TYPE_8821U(Adapter)) -+ { -+ LedCfg = rtw_read8(Adapter, REG_LEDCFG2); -+ LedCfg &= 0x20; // Set to software control. -+ rtw_write8(Adapter, REG_LEDCFG2, (LedCfg|BIT3|BIT5)); -+ RT_TRACE(_module_rtl8712_led_c_,_drv_info_,("8821 SwLedOff LED2 0x%x\n", rtw_read32(Adapter, REG_LEDCFG0))); -+ } -+ -+ break; -+ -+ -+ default: -+ break; -+ } -+ } -+ -+ pLed->bLedOn = false; -+} -+ -+ -+//================================================================================ -+// Interface to manipulate LED objects. -+//================================================================================ -+ -+ -+//================================================================================ -+// Default LED behavior. -+//================================================================================ -+ -+// -+// Description: -+// Initialize all LED_871x objects. -+// -+void -+rtl8812au_InitSwLeds( -+ _adapter *padapter -+ ) -+{ -+ struct led_priv *pledpriv = &(padapter->ledpriv); -+ -+ pledpriv->LedControlHandler = LedControlUSB; -+ -+ if(IS_HARDWARE_TYPE_8812(padapter)) { -+ pledpriv->SwLedOn = SwLedOn_8812AU; -+ pledpriv->SwLedOff = SwLedOff_8812AU; -+ } else { -+ pledpriv->SwLedOn = SwLedOn_8821AU; -+ pledpriv->SwLedOff = SwLedOff_8821AU; -+ } -+ -+ InitLed(padapter, &(pledpriv->SwLed0), LED_PIN_LED0); -+ -+ InitLed(padapter, &(pledpriv->SwLed1), LED_PIN_LED1); -+ -+ InitLed(padapter, &(pledpriv->SwLed2), LED_PIN_LED2); -+} -+ -+ -+// -+// Description: -+// DeInitialize all LED_819xUsb objects. -+// -+void -+rtl8812au_DeInitSwLeds( -+ _adapter *padapter -+ ) -+{ -+ struct led_priv *ledpriv = &(padapter->ledpriv); -+ -+ DeInitLed( &(ledpriv->SwLed0) ); -+ DeInitLed( &(ledpriv->SwLed1) ); -+ DeInitLed( &(ledpriv->SwLed2) ); -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812au_recv.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812au_recv.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812au_recv.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812au_recv.c 2018-02-06 17:42:30.715967238 +0200 -@@ -0,0 +1,194 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8812AU_RECV_C_ -+ -+//#include -+#include -+ -+ -+void rtl8812au_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf) -+{ -+ -+ precvbuf->transfer_len = 0; -+ -+ precvbuf->len = 0; -+ -+ precvbuf->ref_cnt = 0; -+ -+ if(precvbuf->pbuf) -+ { -+ precvbuf->pdata = precvbuf->phead = precvbuf->ptail = precvbuf->pbuf; -+ precvbuf->pend = precvbuf->pdata + MAX_RECVBUF_SZ; -+ } -+ -+} -+ -+int rtl8812au_init_recv_priv(_adapter *padapter) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ int i, res = _SUCCESS; -+ struct recv_buf *precvbuf; -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+ _rtw_init_sema(&precvpriv->recv_sema, 0);//will be removed -+ _rtw_init_sema(&precvpriv->terminate_recvthread_sema, 0);//will be removed -+#endif -+ -+ tasklet_init(&precvpriv->recv_tasklet, -+ (void(*)(unsigned long))rtl8812au_recv_tasklet, -+ (unsigned long)padapter); -+ -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+ precvpriv->int_in_urb = usb_alloc_urb(0, GFP_KERNEL); -+ if(precvpriv->int_in_urb == NULL){ -+ res= _FAIL; -+ DBG_8192C("alloc_urb for interrupt in endpoint fail !!!!\n"); -+ goto exit; -+ } -+ precvpriv->int_in_buf = rtw_zmalloc(INTERRUPT_MSG_FORMAT_LEN); -+ if(precvpriv->int_in_buf == NULL){ -+ res= _FAIL; -+ DBG_8192C("alloc_mem for interrupt in endpoint fail !!!!\n"); -+ goto exit; -+ } -+#endif -+ -+ //init recv_buf -+ _rtw_init_queue(&precvpriv->free_recv_buf_queue); -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ _rtw_init_queue(&precvpriv->recv_buf_pending_queue); -+#endif // CONFIG_USE_USB_BUFFER_ALLOC_RX -+ -+ precvpriv->pallocated_recv_buf = rtw_zmalloc(NR_RECVBUFF *sizeof(struct recv_buf) + 4); -+ if(precvpriv->pallocated_recv_buf==NULL){ -+ res= _FAIL; -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("alloc recv_buf fail!\n")); -+ goto exit; -+ } -+ _rtw_memset(precvpriv->pallocated_recv_buf, 0, NR_RECVBUFF *sizeof(struct recv_buf) + 4); -+ -+ precvpriv->precv_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(precvpriv->pallocated_recv_buf), 4); -+ //precvpriv->precv_buf = precvpriv->pallocated_recv_buf + 4 - -+ // ((uint) (precvpriv->pallocated_recv_buf) &(4-1)); -+ -+ -+ precvbuf = (struct recv_buf*)precvpriv->precv_buf; -+ -+ for(i=0; i < NR_RECVBUFF ; i++) -+ { -+ _rtw_init_listhead(&precvbuf->list); -+ -+ _rtw_spinlock_init(&precvbuf->recvbuf_lock); -+ -+ precvbuf->alloc_sz = MAX_RECVBUF_SZ; -+ -+ res = rtw_os_recvbuf_resource_alloc(padapter, precvbuf); -+ if(res==_FAIL) -+ break; -+ -+ precvbuf->ref_cnt = 0; -+ precvbuf->adapter =padapter; -+ -+ -+ //rtw_list_insert_tail(&precvbuf->list, &(precvpriv->free_recv_buf_queue.queue)); -+ -+ precvbuf++; -+ -+ } -+ -+ precvpriv->free_recv_buf_queue_cnt = NR_RECVBUFF; -+ -+ skb_queue_head_init(&precvpriv->rx_skb_queue); -+ -+#ifdef CONFIG_PREALLOC_RECV_SKB -+ { -+ int i; -+ SIZE_PTR tmpaddr=0; -+ SIZE_PTR alignment=0; -+ struct sk_buff *pskb=NULL; -+ -+ skb_queue_head_init(&precvpriv->free_recv_skb_queue); -+ -+ for(i=0; ipnetdev, MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ, GFP_KERNEL); -+ #endif -+ -+ if(pskb) -+ { -+ pskb->dev = padapter->pnetdev; -+ -+ tmpaddr = (SIZE_PTR)pskb->data; -+ alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1); -+ skb_reserve(pskb, (RECVBUFF_ALIGN_SZ - alignment)); -+ -+ skb_queue_tail(&precvpriv->free_recv_skb_queue, pskb); -+ } -+ -+ pskb=NULL; -+ -+ } -+ } -+#endif -+ -+exit: -+ return res; -+} -+ -+void rtl8812au_free_recv_priv (_adapter *padapter) -+{ -+ int i; -+ struct recv_buf *precvbuf; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ precvbuf = (struct recv_buf *)precvpriv->precv_buf; -+ -+ for(i=0; i < NR_RECVBUFF ; i++) -+ { -+ rtw_os_recvbuf_resource_free(padapter, precvbuf); -+ precvbuf++; -+ } -+ -+ if(precvpriv->pallocated_recv_buf) -+ rtw_mfree(precvpriv->pallocated_recv_buf, NR_RECVBUFF *sizeof(struct recv_buf) + 4); -+ -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+ if(precvpriv->int_in_urb) -+ usb_free_urb(precvpriv->int_in_urb); -+ -+ if(precvpriv->int_in_buf) -+ rtw_mfree(precvpriv->int_in_buf, INTERRUPT_MSG_FORMAT_LEN); -+#endif//CONFIG_USB_INTERRUPT_IN_PIPE -+ -+ if (skb_queue_len(&precvpriv->rx_skb_queue)) { -+ DBG_8192C(KERN_WARNING "rx_skb_queue not empty\n"); -+ } -+ -+ skb_queue_purge(&precvpriv->rx_skb_queue); -+ -+#ifdef CONFIG_PREALLOC_RECV_SKB -+ -+ if (skb_queue_len(&precvpriv->free_recv_skb_queue)) { -+ DBG_8192C(KERN_WARNING "free_recv_skb_queue not empty, %d\n", skb_queue_len(&precvpriv->free_recv_skb_queue)); -+ } -+ -+ skb_queue_purge(&precvpriv->free_recv_skb_queue); -+#endif -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812au_xmit.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812au_xmit.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812au_xmit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812au_xmit.c 2018-02-06 17:42:30.716967253 +0200 -@@ -0,0 +1,1036 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8812AU_XMIT_C_ -+ -+//#include -+#include -+ -+ -+s32 rtl8812au_init_xmit_priv(_adapter *padapter) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ -+ tasklet_init(&pxmitpriv->xmit_tasklet, -+ (void(*)(unsigned long))rtl8812au_xmit_tasklet, -+ (unsigned long)padapter); -+#ifdef CONFIG_TX_EARLY_MODE -+ pHalData->bEarlyModeEnable = padapter->registrypriv.early_mode; -+#endif -+ -+ return _SUCCESS; -+} -+ -+void rtl8812au_free_xmit_priv(_adapter *padapter) -+{ -+} -+ -+static s32 update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem, s32 sz ,u8 bagg_pkt) -+{ -+ int pull=0; -+ uint qsel; -+ u8 data_rate,pwr_status,offset; -+ _adapter *padapter = pxmitframe->padapter; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ u8 *ptxdesc = pmem; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ sint bmcst = IS_MCAST(pattrib->ra); -+ -+#ifndef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ if (padapter->registrypriv.mp_mode == 0) -+ { -+ if((!bagg_pkt) &&(rtw_usb_bulk_size_boundary(padapter,TXDESC_SIZE+sz)==false)) -+ { -+ ptxdesc = (pmem+PACKET_OFFSET_SZ); -+ //DBG_8192C("==> non-agg-pkt,shift pointer...\n"); -+ pull = 1; -+ } -+ } -+#endif // CONFIG_USE_USB_BUFFER_ALLOC_TX -+ -+ _rtw_memset(ptxdesc, 0, TXDESC_SIZE); -+ -+ //4 offset 0 -+ SET_TX_DESC_FIRST_SEG_8812(ptxdesc, 1); -+ SET_TX_DESC_LAST_SEG_8812(ptxdesc, 1); -+ SET_TX_DESC_OWN_8812(ptxdesc, 1); -+ -+ //DBG_8192C("%s==> pkt_len=%d,bagg_pkt=%02x\n",__FUNCTION__,sz,bagg_pkt); -+ SET_TX_DESC_PKT_SIZE_8812(ptxdesc, sz); -+ -+ offset = TXDESC_SIZE + OFFSET_SZ; -+ -+#ifdef CONFIG_TX_EARLY_MODE -+ if(bagg_pkt){ -+ offset += EARLY_MODE_INFO_SIZE ;//0x28 -+ } -+#endif -+ //DBG_8192C("%s==>offset(0x%02x) \n",__FUNCTION__,offset); -+ SET_TX_DESC_OFFSET_8812(ptxdesc, offset); -+ -+ if (bmcst) { -+ SET_TX_DESC_BMC_8812(ptxdesc, 1); -+ } -+ -+#ifndef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ if (padapter->registrypriv.mp_mode == 0) -+ { -+ if(!bagg_pkt){ -+ if((pull) && (pxmitframe->pkt_offset>0)) { -+ pxmitframe->pkt_offset = pxmitframe->pkt_offset -1; -+ } -+ } -+ } -+#endif -+ -+ //DBG_8192C("%s, pkt_offset=0x%02x\n",__FUNCTION__,pxmitframe->pkt_offset); -+ // pkt_offset, unit:8 bytes padding -+ if (pxmitframe->pkt_offset > 0) { -+ SET_TX_DESC_PKT_OFFSET_8812(ptxdesc, pxmitframe->pkt_offset); -+ } -+ -+ SET_TX_DESC_MACID_8812(ptxdesc, pattrib->mac_id); -+ SET_TX_DESC_RATE_ID_8812(ptxdesc, pattrib->raid); -+ -+ SET_TX_DESC_QUEUE_SEL_8812(ptxdesc, pattrib->qsel); -+ -+ //offset 12 -+ -+ if (!pattrib->qos_en) { -+ SET_TX_DESC_HWSEQ_EN_8812(ptxdesc, 1); // Hw set sequence number -+ } else { -+ SET_TX_DESC_SEQ_8812(ptxdesc, pattrib->seqnum); -+ } -+ -+ if((pxmitframe->frame_tag&0x0f) == DATA_FRAMETAG) -+ { -+ //DBG_8192C("pxmitframe->frame_tag == DATA_FRAMETAG\n"); -+ -+ rtl8812a_fill_txdesc_sectype(pattrib, ptxdesc); -+ -+ //offset 20 -+#ifdef CONFIG_USB_TX_AGGREGATION -+ if (pxmitframe->agg_num > 1){ -+ //DBG_8192C("%s agg_num:%d\n",__FUNCTION__,pxmitframe->agg_num ); -+ SET_TX_DESC_USB_TXAGG_NUM_8812(ptxdesc, pxmitframe->agg_num); -+ } -+#endif -+ -+ rtl8812a_fill_txdesc_vcs(padapter, pattrib, ptxdesc); -+ -+ if ((pattrib->ether_type != 0x888e) && -+ (pattrib->ether_type != 0x0806) && -+ (pattrib->ether_type != 0x88b4) && -+ (pattrib->dhcp_pkt != 1) -+#ifdef CONFIG_AUTO_AP_MODE -+ && (pattrib->pctrl != true) -+#endif -+ ) -+ { -+ //Non EAP & ARP & DHCP type data packet -+ -+ if (pattrib->ampdu_en==true) { -+ SET_TX_DESC_AGG_ENABLE_8812(ptxdesc, 1); -+ SET_TX_DESC_MAX_AGG_NUM_8812(ptxdesc, 0x1f); -+ // Set A-MPDU aggregation. -+ SET_TX_DESC_AMPDU_DENSITY_8812(ptxdesc, pHalData->AMPDUDensity); -+ } else { -+ SET_TX_DESC_AGG_BREAK_8812(ptxdesc, 1); -+ } -+ -+ rtl8812a_fill_txdesc_phy(padapter, pattrib, ptxdesc); -+ -+ //DATA Rate FB LMT -+ SET_TX_DESC_DATA_RATE_FB_LIMIT_8812(ptxdesc, 0x1f); -+ -+ if (pHalData->fw_ractrl == false) { -+ SET_TX_DESC_USE_RATE_8812(ptxdesc, 1); -+ -+ if(pdmpriv->INIDATA_RATE[pattrib->mac_id] & BIT(7)) -+ SET_TX_DESC_DATA_SHORT_8812(ptxdesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8812(ptxdesc, (pdmpriv->INIDATA_RATE[pattrib->mac_id] & 0x7F)); -+ } -+ -+ if (padapter->fix_rate != 0xFF) { // modify data rate by iwpriv -+ SET_TX_DESC_USE_RATE_8812(ptxdesc, 1); -+ if(padapter->fix_rate & BIT(7)) -+ SET_TX_DESC_DATA_SHORT_8812(ptxdesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8812(ptxdesc, (padapter->fix_rate & 0x7F)); -+ } -+ -+ if (pattrib->ldpc) -+ SET_TX_DESC_DATA_LDPC_8812(ptxdesc, 1); -+ if (pattrib->stbc) -+ SET_TX_DESC_DATA_STBC_8812(ptxdesc, 1); -+ } -+ else -+ { -+ // EAP data packet and ARP packet and DHCP. -+ // Use the 1M data rate to send the EAP/ARP packet. -+ // This will maybe make the handshake smooth. -+ -+ SET_TX_DESC_USE_RATE_8812(ptxdesc, 1); -+ -+ SET_TX_DESC_AGG_BREAK_8812(ptxdesc, 1); -+ -+ // HW will ignore this setting if the transmission rate is legacy OFDM. -+ if (pmlmeinfo->preamble_mode == PREAMBLE_SHORT) { -+ SET_TX_DESC_DATA_SHORT_8812(ptxdesc, 1); -+ } -+ -+ SET_TX_DESC_TX_RATE_8812(ptxdesc, MRateToHwRate(pmlmeext->tx_rate)); -+ } -+ } -+ else if((pxmitframe->frame_tag&0x0f)== MGNT_FRAMETAG) -+ { -+ //DBG_8192C("pxmitframe->frame_tag == MGNT_FRAMETAG\n"); -+ -+ if(IS_HARDWARE_TYPE_8821(padapter)) -+ SET_TX_DESC_MBSSID_8821(ptxdesc, pattrib->mbssid); -+ -+ //offset 20 -+ SET_TX_DESC_RETRY_LIMIT_ENABLE_8812(ptxdesc, 1); -+ if (pattrib->retry_ctrl == true) { -+ SET_TX_DESC_DATA_RETRY_LIMIT_8812(ptxdesc, 6); -+ } else { -+ SET_TX_DESC_DATA_RETRY_LIMIT_8812(ptxdesc, 12); -+ } -+ -+ SET_TX_DESC_USE_RATE_8812(ptxdesc, 1); -+ -+#ifdef CONFIG_INTEL_PROXIM -+ if((padapter->proximity.proxim_on==true)&&(pattrib->intel_proxim==true)){ -+ DBG_871X("\n %s pattrib->rate=%d\n",__FUNCTION__,pattrib->rate); -+ SET_TX_DESC_TX_RATE_8812(ptxdesc, pattrib->rate); -+ } -+ else -+#endif -+ { -+ SET_TX_DESC_TX_RATE_8812(ptxdesc, MRateToHwRate(pmlmeext->tx_rate)); -+ } -+ } -+ else if((pxmitframe->frame_tag&0x0f) == TXAGG_FRAMETAG) -+ { -+ DBG_8192C("pxmitframe->frame_tag == TXAGG_FRAMETAG\n"); -+ } -+#ifdef CONFIG_MP_INCLUDED -+ else if(((pxmitframe->frame_tag&0x0f) == MP_FRAMETAG) && -+ (padapter->registrypriv.mp_mode == 1)) -+ { -+ fill_txdesc_for_mp(padapter, (struct tx_desc *)ptxdesc); -+ } -+#endif -+ else -+ { -+ DBG_8192C("pxmitframe->frame_tag = %d\n", pxmitframe->frame_tag); -+ -+ SET_TX_DESC_USE_RATE_8812(ptxdesc, 1); -+ SET_TX_DESC_TX_RATE_8812(ptxdesc, MRateToHwRate(pmlmeext->tx_rate)); -+ } -+ -+ rtl8812a_cal_txdesc_chksum(ptxdesc); -+ _dbg_dump_tx_info(padapter,pxmitframe->frame_tag,ptxdesc); -+ return pull; -+} -+ -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+/* -+ * Description -+ * Transmit xmitbuf to hardware tx fifo -+ * -+ * Return -+ * _SUCCESS ok -+ * _FAIL something error -+ */ -+s32 rtl8812au_xmit_buf_handler(PADAPTER padapter) -+{ -+ PHAL_DATA_TYPE phal; -+ struct xmit_priv *pxmitpriv; -+ struct xmit_buf *pxmitbuf; -+ s32 ret; -+ -+ -+ phal = GET_HAL_DATA(padapter); -+ pxmitpriv = &padapter->xmitpriv; -+ -+ ret = _rtw_down_sema(&pxmitpriv->xmit_sema); -+ if (_FAIL == ret) { -+ RT_TRACE(_module_hal_xmit_c_, _drv_emerg_, -+ ("%s: down SdioXmitBufSema fail!\n", __FUNCTION__)); -+ return _FAIL; -+ } -+ -+ ret = (padapter->bDriverStopped == true) || (padapter->bSurpriseRemoved == true); -+ if (ret) { -+ RT_TRACE(_module_hal_xmit_c_, _drv_notice_, -+ ("%s: bDriverStopped(%d) bSurpriseRemoved(%d)!\n", -+ __FUNCTION__, padapter->bDriverStopped, padapter->bSurpriseRemoved)); -+ return _FAIL; -+ } -+ -+ if(check_pending_xmitbuf(pxmitpriv) == false) -+ return _SUCCESS; -+ -+#ifdef CONFIG_LPS_LCLK -+ ret = rtw_register_tx_alive(padapter); -+ if (ret != _SUCCESS) { -+ RT_TRACE(_module_hal_xmit_c_, _drv_notice_, -+ ("%s: wait to leave LPS_LCLK\n", __FUNCTION__)); -+ return _SUCCESS; -+ } -+#endif -+ -+ do { -+ pxmitbuf = dequeue_pending_xmitbuf(pxmitpriv); -+ if (pxmitbuf == NULL) break; -+ -+ rtw_write_port(padapter, pxmitbuf->ff_hwaddr, pxmitbuf->len, (unsigned char*)pxmitbuf); -+ -+ } while (1); -+ -+#ifdef CONFIG_LPS_LCLK -+ rtw_unregister_tx_alive(padapter); -+#endif -+ -+ return _SUCCESS; -+} -+#endif -+ -+ -+//for non-agg data frame or management frame -+static s32 rtw_dump_xframe(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ s32 ret = _SUCCESS; -+ s32 inner_ret = _SUCCESS; -+ int t, sz, w_sz, pull=0; -+ u8 *mem_addr; -+ u32 ff_hwaddr; -+ struct xmit_buf *pxmitbuf = pxmitframe->pxmitbuf; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+#ifdef CONFIG_80211N_HT -+ if ((pxmitframe->frame_tag == DATA_FRAMETAG) && -+ (pxmitframe->attrib.ether_type != 0x0806) && -+ (pxmitframe->attrib.ether_type != 0x888e) && -+ (pxmitframe->attrib.ether_type != 0x88b4) && -+ (pxmitframe->attrib.dhcp_pkt != 1)) -+ { -+ rtw_issue_addbareq_cmd(padapter, pxmitframe); -+ } -+#endif //CONFIG_80211N_HT -+ mem_addr = pxmitframe->buf_addr; -+ -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_dump_xframe()\n")); -+ -+ for (t = 0; t < pattrib->nr_frags; t++) -+ { -+ if (inner_ret != _SUCCESS && ret == _SUCCESS) -+ ret = _FAIL; -+ -+ if (t != (pattrib->nr_frags - 1)) -+ { -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_err_,("pattrib->nr_frags=%d\n", pattrib->nr_frags)); -+ -+ sz = pxmitpriv->frag_len; -+ sz = sz - 4 - (psecuritypriv->sw_encrypt ? 0 : pattrib->icv_len); -+ } -+ else //no frag -+ { -+ sz = pattrib->last_txcmdsz; -+ } -+ -+ pull = update_txdesc(pxmitframe, mem_addr, sz, false); -+ -+ if(pull) -+ { -+ mem_addr += PACKET_OFFSET_SZ; //pull txdesc head -+ -+ //pxmitbuf ->pbuf = mem_addr; -+ pxmitframe->buf_addr = mem_addr; -+ -+ w_sz = sz + TXDESC_SIZE; -+ } -+ else -+ { -+ w_sz = sz + TXDESC_SIZE + PACKET_OFFSET_SZ; -+ } -+ -+ ff_hwaddr = rtw_get_ff_hwaddr(pxmitframe); -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+ pxmitbuf->len = w_sz; -+ pxmitbuf->ff_hwaddr = ff_hwaddr; -+ enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf); -+#else -+ inner_ret = rtw_write_port(padapter, ff_hwaddr, w_sz, (unsigned char*)pxmitbuf); -+#endif -+ rtw_count_tx_stats(padapter, pxmitframe, sz); -+ -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("rtw_write_port, w_sz=%d\n", w_sz)); -+ //DBG_8192C("rtw_write_port, w_sz=%d, sz=%d, txdesc_sz=%d, tid=%d\n", w_sz, sz, w_sz-sz, pattrib->priority); -+ -+ mem_addr += w_sz; -+ -+ mem_addr = (u8 *)RND4(((SIZE_PTR)(mem_addr))); -+ -+ } -+ -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ if (ret != _SUCCESS) -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_UNKNOWN); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+static u32 xmitframe_need_length(struct xmit_frame *pxmitframe) -+{ -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+ u32 len = 0; -+ -+ // no consider fragement -+ len = pattrib->hdrlen + pattrib->iv_len + -+ SNAP_SIZE + sizeof(u16) + -+ pattrib->pktlen + -+ ((pattrib->bswenc) ? pattrib->icv_len : 0); -+ -+ if(pattrib->encrypt ==_TKIP_) -+ len += 8; -+ -+ return len; -+} -+ -+#define IDEA_CONDITION 1 // check all packets before enqueue -+s32 rtl8812au_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct xmit_frame *pxmitframe = NULL; -+ struct xmit_frame *pfirstframe = NULL; -+ -+ // aggregate variable -+ struct hw_xmit *phwxmit; -+ struct sta_info *psta = NULL; -+ struct tx_servq *ptxservq = NULL; -+ -+ _irqL irqL; -+ _list *xmitframe_plist = NULL, *xmitframe_phead = NULL; -+ -+ u32 pbuf; // next pkt address -+ u32 pbuf_tail; // last pkt tail -+ u32 len; // packet length, except TXDESC_SIZE and PKT_OFFSET -+ -+ u32 bulkSize = pHalData->UsbBulkOutSize; -+ u8 descCount; -+ u32 bulkPtr; -+ -+ // dump frame variable -+ u32 ff_hwaddr; -+ -+#ifndef IDEA_CONDITION -+ int res = _SUCCESS; -+#endif -+ -+ RT_TRACE(_module_rtl8192c_xmit_c_, _drv_info_, ("+xmitframe_complete\n")); -+ -+ -+ // check xmitbuffer is ok -+ if (pxmitbuf == NULL) { -+ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); -+ if (pxmitbuf == NULL){ -+ //DBG_871X("%s #1, connot alloc xmitbuf!!!! \n",__FUNCTION__); -+ return false; -+ } -+ } -+ -+//DBG_8192C("%s ===================================== \n",__FUNCTION__); -+ //3 1. pick up first frame -+ do { -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ pxmitframe = rtw_dequeue_xframe(pxmitpriv, pxmitpriv->hwxmits, pxmitpriv->hwxmit_entry); -+ if (pxmitframe == NULL) { -+ // no more xmit frame, release xmit buffer -+ //DBG_8192C("no more xmit frame ,return\n"); -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ return false; -+ } -+ -+#ifndef IDEA_CONDITION -+ if (pxmitframe->frame_tag != DATA_FRAMETAG) { -+ RT_TRACE(_module_rtl8192c_xmit_c_, _drv_err_, -+ ("xmitframe_complete: frame tag(%d) is not DATA_FRAMETAG(%d)!\n", -+ pxmitframe->frame_tag, DATA_FRAMETAG)); -+// rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ continue; -+ } -+ -+ // TID 0~15 -+ if ((pxmitframe->attrib.priority < 0) || -+ (pxmitframe->attrib.priority > 15)) { -+ RT_TRACE(_module_rtl8192c_xmit_c_, _drv_err_, -+ ("xmitframe_complete: TID(%d) should be 0~15!\n", -+ pxmitframe->attrib.priority)); -+// rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ continue; -+ } -+#endif -+ //DBG_8192C("==> pxmitframe->attrib.priority:%d\n",pxmitframe->attrib.priority); -+ pxmitframe->pxmitbuf = pxmitbuf; -+ pxmitframe->buf_addr = pxmitbuf->pbuf; -+ pxmitbuf->priv_data = pxmitframe; -+ -+ pxmitframe->agg_num = 1; // alloc xmitframe should assign to 1. -+ #ifdef CONFIG_TX_EARLY_MODE -+ pxmitframe->pkt_offset = 2; // first frame of aggregation, reserve one offset for EM info ,another for usb bulk-out block check -+ #else -+ pxmitframe->pkt_offset = 1; // first frame of aggregation, reserve offset -+ #endif -+ -+ if (rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe) == false) { -+ DBG_871X("%s coalesce 1st xmitframe failed \n",__FUNCTION__); -+ continue; -+ } -+ -+ -+ // always return ndis_packet after rtw_xmitframe_coalesce -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ -+ break; -+ } while (1); -+ -+ //3 2. aggregate same priority and same DA(AP or STA) frames -+ pfirstframe = pxmitframe; -+ len = xmitframe_need_length(pfirstframe) + TXDESC_SIZE+(pfirstframe->pkt_offset*PACKET_OFFSET_SZ); -+ pbuf_tail = len; -+ pbuf = _RND8(pbuf_tail); -+ -+ // check pkt amount in one bulk -+ descCount = 0; -+ bulkPtr = bulkSize; -+ if (pbuf < bulkPtr) -+ descCount++; -+ else { -+ descCount = 0; -+ bulkPtr = ((pbuf / bulkSize) + 1) * bulkSize; // round to next bulkSize -+ } -+ -+ // dequeue same priority packet from station tx queue -+ psta = pfirstframe->attrib.psta; -+ switch (pfirstframe->attrib.priority) { -+ case 1: -+ case 2: -+ ptxservq = &(psta->sta_xmitpriv.bk_q); -+ phwxmit = pxmitpriv->hwxmits + 3; -+ break; -+ -+ case 4: -+ case 5: -+ ptxservq = &(psta->sta_xmitpriv.vi_q); -+ phwxmit = pxmitpriv->hwxmits + 1; -+ break; -+ -+ case 6: -+ case 7: -+ ptxservq = &(psta->sta_xmitpriv.vo_q); -+ phwxmit = pxmitpriv->hwxmits; -+ break; -+ -+ case 0: -+ case 3: -+ default: -+ ptxservq = &(psta->sta_xmitpriv.be_q); -+ phwxmit = pxmitpriv->hwxmits + 2; -+ break; -+ } -+//DBG_8192C("==> pkt_no=%d,pkt_len=%d,len=%d,RND8_LEN=%d,pkt_offset=0x%02x\n", -+ //pxmitframe->agg_num,pxmitframe->attrib.last_txcmdsz,len,pbuf,pxmitframe->pkt_offset ); -+ -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ xmitframe_phead = get_list_head(&ptxservq->sta_pending); -+ xmitframe_plist = get_next(xmitframe_phead); -+ -+ while (rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist) == false) -+ { -+ pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); -+ xmitframe_plist = get_next(xmitframe_plist); -+ -+ pxmitframe->agg_num = 0; // not first frame of aggregation -+ #ifdef CONFIG_TX_EARLY_MODE -+ pxmitframe->pkt_offset = 1;// not first frame of aggregation,reserve offset for EM Info -+ #else -+ pxmitframe->pkt_offset = 0; // not first frame of aggregation, no need to reserve offset -+ #endif -+ -+ len = xmitframe_need_length(pxmitframe) + TXDESC_SIZE +(pxmitframe->pkt_offset*PACKET_OFFSET_SZ); -+ -+ if (_RND8(pbuf + len) > MAX_XMITBUF_SZ) -+ //if (_RND8(pbuf + len) > (MAX_XMITBUF_SZ/2))//to do : for TX TP finial tune , Georgia 2012-0323 -+ { -+ //DBG_8192C("%s....len> MAX_XMITBUF_SZ\n",__FUNCTION__); -+ pxmitframe->agg_num = 1; -+ pxmitframe->pkt_offset = 1; -+ break; -+ } -+ rtw_list_delete(&pxmitframe->list); -+ ptxservq->qcnt--; -+ phwxmit->accnt--; -+ -+#ifndef IDEA_CONDITION -+ // suppose only data frames would be in queue -+ if (pxmitframe->frame_tag != DATA_FRAMETAG) { -+ RT_TRACE(_module_rtl8192c_xmit_c_, _drv_err_, -+ ("xmitframe_complete: frame tag(%d) is not DATA_FRAMETAG(%d)!\n", -+ pxmitframe->frame_tag, DATA_FRAMETAG)); -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ continue; -+ } -+ -+ // TID 0~15 -+ if ((pxmitframe->attrib.priority < 0) || -+ (pxmitframe->attrib.priority > 15)) { -+ RT_TRACE(_module_rtl8192c_xmit_c_, _drv_err_, -+ ("xmitframe_complete: TID(%d) should be 0~15!\n", -+ pxmitframe->attrib.priority)); -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ continue; -+ } -+#endif -+ -+// pxmitframe->pxmitbuf = pxmitbuf; -+ pxmitframe->buf_addr = pxmitbuf->pbuf + pbuf; -+ -+ if (rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe) == false) { -+ DBG_871X("%s coalesce failed \n",__FUNCTION__); -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ continue; -+ } -+ -+ //DBG_8192C("==> pxmitframe->attrib.priority:%d\n",pxmitframe->attrib.priority); -+ // always return ndis_packet after rtw_xmitframe_coalesce -+ rtw_os_xmit_complete(padapter, pxmitframe); -+ -+ // (len - TXDESC_SIZE) == pxmitframe->attrib.last_txcmdsz -+ update_txdesc(pxmitframe, pxmitframe->buf_addr, pxmitframe->attrib.last_txcmdsz,true); -+ -+ // don't need xmitframe any more -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ // handle pointer and stop condition -+ pbuf_tail = pbuf + len; -+ pbuf = _RND8(pbuf_tail); -+ -+ -+ pfirstframe->agg_num++; -+#ifdef CONFIG_TX_EARLY_MODE -+ pxmitpriv->agg_pkt[pfirstframe->agg_num-1].offset = _RND8(len); -+ pxmitpriv->agg_pkt[pfirstframe->agg_num-1].pkt_len = pxmitframe->attrib.last_txcmdsz; -+#endif -+ if (MAX_TX_AGG_PACKET_NUMBER == pfirstframe->agg_num) -+ break; -+ -+ if (pbuf < bulkPtr) { -+ descCount++; -+ if (descCount == pHalData->UsbTxAggDescNum) -+ break; -+ } else { -+ descCount = 0; -+ bulkPtr = ((pbuf / bulkSize) + 1) * bulkSize; -+ } -+ }//end while( aggregate same priority and same DA(AP or STA) frames) -+ -+ -+ if (_rtw_queue_empty(&ptxservq->sta_pending) == true) -+ rtw_list_delete(&ptxservq->tx_pending); -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+#ifdef CONFIG_80211N_HT -+ if ((pfirstframe->attrib.ether_type != 0x0806) && -+ (pfirstframe->attrib.ether_type != 0x888e) && -+ (pfirstframe->attrib.ether_type != 0x88b4) && -+ (pfirstframe->attrib.dhcp_pkt != 1)) -+ { -+ rtw_issue_addbareq_cmd(padapter, pfirstframe); -+ } -+#endif //CONFIG_80211N_HT -+#ifndef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ //3 3. update first frame txdesc -+ if ((pbuf_tail % bulkSize) == 0) { -+ // remove pkt_offset -+ pbuf_tail -= PACKET_OFFSET_SZ; -+ pfirstframe->buf_addr += PACKET_OFFSET_SZ; -+ pfirstframe->pkt_offset--; -+ //DBG_8192C("$$$$$ buf size equal to USB block size $$$$$$\n"); -+ } -+#endif // CONFIG_USE_USB_BUFFER_ALLOC_TX -+ -+ update_txdesc(pfirstframe, pfirstframe->buf_addr, pfirstframe->attrib.last_txcmdsz,true); -+ -+ #ifdef CONFIG_TX_EARLY_MODE -+ //prepare EM info for first frame, agg_num value start from 1 -+ pxmitpriv->agg_pkt[0].offset = _RND8(pfirstframe->attrib.last_txcmdsz +TXDESC_SIZE +(pfirstframe->pkt_offset*PACKET_OFFSET_SZ)); -+ pxmitpriv->agg_pkt[0].pkt_len = pfirstframe->attrib.last_txcmdsz;//get from rtw_xmitframe_coalesce -+ -+ UpdateEarlyModeInfo8812(pxmitpriv,pxmitbuf ); -+ #endif -+ -+ //3 4. write xmit buffer to USB FIFO -+ ff_hwaddr = rtw_get_ff_hwaddr(pfirstframe); -+//DBG_8192C("%s ===================================== write port,buf_size(%d) \n",__FUNCTION__,pbuf_tail); -+ // xmit address == ((xmit_frame*)pxmitbuf->priv_data)->buf_addr -+ rtw_write_port(padapter, ff_hwaddr, pbuf_tail, (u8*)pxmitbuf); -+ -+ -+ //3 5. update statisitc -+ pbuf_tail -= (pfirstframe->agg_num * TXDESC_SIZE); -+ pbuf_tail -= (pfirstframe->pkt_offset * PACKET_OFFSET_SZ); -+ -+ -+ rtw_count_tx_stats(padapter, pfirstframe, pbuf_tail); -+ -+ rtw_free_xmitframe(pxmitpriv, pfirstframe); -+ -+ return true; -+} -+ -+#else -+ -+s32 rtl8812au_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf) -+{ -+ -+ struct hw_xmit *phwxmits; -+ sint hwentry; -+ struct xmit_frame *pxmitframe=NULL; -+ int res=_SUCCESS, xcnt = 0; -+ -+ phwxmits = pxmitpriv->hwxmits; -+ hwentry = pxmitpriv->hwxmit_entry; -+ -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("xmitframe_complete()\n")); -+ -+ if(pxmitbuf==NULL) -+ { -+ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); -+ if(!pxmitbuf) -+ { -+ return false; -+ } -+ } -+ -+ -+ do -+ { -+ pxmitframe = rtw_dequeue_xframe(pxmitpriv, phwxmits, hwentry); -+ -+ if(pxmitframe) -+ { -+ pxmitframe->pxmitbuf = pxmitbuf; -+ -+ pxmitframe->buf_addr = pxmitbuf->pbuf; -+ -+ pxmitbuf->priv_data = pxmitframe; -+ -+ if((pxmitframe->frame_tag&0x0f) == DATA_FRAMETAG) -+ { -+ if(pxmitframe->attrib.priority<=15)//TID0~15 -+ { -+ res = rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe); -+ } -+ //DBG_8192C("==> pxmitframe->attrib.priority:%d\n",pxmitframe->attrib.priority); -+ rtw_os_xmit_complete(padapter, pxmitframe);//always return ndis_packet after rtw_xmitframe_coalesce -+ } -+ -+ -+ RT_TRACE(_module_rtl871x_xmit_c_,_drv_info_,("xmitframe_complete(): rtw_dump_xframe\n")); -+ -+ -+ if(res == _SUCCESS) -+ { -+ rtw_dump_xframe(padapter, pxmitframe); -+ } -+ else -+ { -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ } -+ -+ xcnt++; -+ -+ } -+ else -+ { -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ return false; -+ } -+ -+ break; -+ -+ }while(0/*xcnt < (NR_XMITFRAME >> 3)*/); -+ -+ return true; -+ -+} -+#endif -+ -+ -+ -+static s32 xmitframe_direct(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ s32 res = _SUCCESS; -+//DBG_8192C("==> %s \n",__FUNCTION__); -+ -+ res = rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe); -+ if (res == _SUCCESS) { -+ rtw_dump_xframe(padapter, pxmitframe); -+ } -+ else{ -+ DBG_8192C("==> %s xmitframe_coalsece failed\n",__FUNCTION__); -+ } -+ -+ return res; -+} -+ -+/* -+ * Return -+ * true dump packet directly -+ * false enqueue packet -+ */ -+static s32 pre_xmitframe(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ _irqL irqL; -+ s32 res; -+ struct xmit_buf *pxmitbuf = NULL; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+//DBG_8192C("==> %s \n",__FUNCTION__); -+ -+ if (rtw_txframes_sta_ac_pending(padapter, pattrib) > 0) -+ { -+ //DBG_8192C("enqueue AC(%d)\n",pattrib->priority); -+ goto enqueue; -+ } -+ -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) -+ goto enqueue; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) -+ goto enqueue; -+#endif -+ -+ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); -+ if (pxmitbuf == NULL) -+ goto enqueue; -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ pxmitframe->pxmitbuf = pxmitbuf; -+ pxmitframe->buf_addr = pxmitbuf->pbuf; -+ pxmitbuf->priv_data = pxmitframe; -+ -+ if (xmitframe_direct(padapter, pxmitframe) != _SUCCESS) { -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ } -+ -+ return true; -+ -+enqueue: -+ res = rtw_xmitframe_enqueue(padapter, pxmitframe); -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ if (res != _SUCCESS) { -+ RT_TRACE(_module_xmit_osdep_c_, _drv_err_, ("pre_xmitframe: enqueue xmitframe fail\n")); -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ // Trick, make the statistics correct -+ pxmitpriv->tx_pkts--; -+ pxmitpriv->tx_drop++; -+ return true; -+ } -+ -+ return false; -+} -+ -+s32 rtl8812au_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) -+{ -+ return rtw_dump_xframe(padapter, pmgntframe); -+} -+ -+/* -+ * Return -+ * true dump packet directly ok -+ * false temporary can't transmit packets to hardware -+ */ -+s32 rtl8812au_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ return pre_xmitframe(padapter, pxmitframe); -+} -+ -+s32 rtl8812au_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ s32 err; -+ -+ if ((err=rtw_xmitframe_enqueue(padapter, pxmitframe)) != _SUCCESS) { -+ rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ // Trick, make the statistics correct -+ pxmitpriv->tx_pkts--; -+ pxmitpriv->tx_drop++; -+ } else { -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+ } -+ -+ return err; -+ -+} -+ -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ -+static void rtl8812au_hostap_mgnt_xmit_cb(struct urb *urb) -+{ -+ struct sk_buff *skb = (struct sk_buff *)urb->context; -+ -+ dev_kfree_skb_any(skb); -+} -+ -+s32 rtl8812au_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt) -+{ -+ u16 fc; -+ int rc, len, pipe; -+ unsigned int bmcst, tid, qsel; -+ struct sk_buff *skb, *pxmit_skb; -+ struct urb *urb; -+ unsigned char *pxmitbuf; -+ struct tx_desc *ptxdesc; -+ struct rtw_ieee80211_hdr *tx_hdr; -+ struct hostapd_priv *phostapdpriv = padapter->phostapdpriv; -+ struct net_device *pnetdev = padapter->pnetdev; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ -+ -+ skb = pkt; -+ -+ len = skb->len; -+ tx_hdr = (struct rtw_ieee80211_hdr *)(skb->data); -+ fc = le16_to_cpu(tx_hdr->frame_ctl); -+ bmcst = IS_MCAST(tx_hdr->addr1); -+ -+ if ((fc & RTW_IEEE80211_FCTL_FTYPE) != RTW_IEEE80211_FTYPE_MGMT) -+ goto _exit; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18)) // http://www.mail-archive.com/netdev@vger.kernel.org/msg17214.html -+ pxmit_skb = dev_alloc_skb(len + TXDESC_SIZE); -+#else -+ pxmit_skb = netdev_alloc_skb(pnetdev, len + TXDESC_SIZE); -+#endif -+ -+ if(!pxmit_skb) -+ goto _exit; -+ -+ pxmitbuf = pxmit_skb->data; -+ -+ urb = usb_alloc_urb(0, GFP_ATOMIC); -+ if (!urb) { -+ goto _exit; -+ } -+ -+ // ----- fill tx desc ----- -+ ptxdesc = (struct tx_desc *)pxmitbuf; -+ _rtw_memset(ptxdesc, 0, sizeof(*ptxdesc)); -+ -+ //offset 0 -+ ptxdesc->txdw0 |= cpu_to_le32(len&0x0000ffff); -+ ptxdesc->txdw0 |= cpu_to_le32(((TXDESC_SIZE+OFFSET_SZ)<txdw0 |= cpu_to_le32(OWN | FSG | LSG); -+ -+ if(bmcst) -+ { -+ ptxdesc->txdw0 |= cpu_to_le32(BIT(24)); -+ } -+ -+ //offset 4 -+ ptxdesc->txdw1 |= cpu_to_le32(0x00);//MAC_ID -+ -+ ptxdesc->txdw1 |= cpu_to_le32((0x12<txdw1 |= cpu_to_le32((0x06<< 16) & 0x000f0000);//b mode -+ -+ //offset 8 -+ -+ //offset 12 -+ ptxdesc->txdw3 |= cpu_to_le32((le16_to_cpu(tx_hdr->seq_ctl)<<16)&0xffff0000); -+ -+ //offset 16 -+ ptxdesc->txdw4 |= cpu_to_le32(BIT(8));//driver uses rate -+ -+ //offset 20 -+ -+ -+ //HW append seq -+ ptxdesc->txdw4 |= cpu_to_le32(BIT(7)); // Hw set sequence number -+ ptxdesc->txdw3 |= cpu_to_le32((8 <<28)); //set bit3 to 1. Suugested by TimChen. 2009.12.29. -+ -+ -+ rtl8188eu_cal_txdesc_chksum(ptxdesc); -+ // ----- end of fill tx desc ----- -+ -+ // -+ skb_put(pxmit_skb, len + TXDESC_SIZE); -+ pxmitbuf = pxmitbuf + TXDESC_SIZE; -+ _rtw_memcpy(pxmitbuf, skb->data, len); -+ -+ // ----- prepare urb for submit ----- -+ -+ //translate DMA FIFO addr to pipehandle -+ pipe = usb_sndbulkpipe(pdvobj->pusbdev, pHalData->Queue2EPNum[(u8)MGT_QUEUE_INX]&0x0f); -+ -+ usb_fill_bulk_urb(urb, pdvobj->pusbdev, pipe, -+ pxmit_skb->data, pxmit_skb->len, rtl8192cu_hostap_mgnt_xmit_cb, pxmit_skb); -+ -+ urb->transfer_flags |= URB_ZERO_PACKET; -+ usb_anchor_urb(urb, &phostapdpriv->anchored); -+ rc = usb_submit_urb(urb, GFP_ATOMIC); -+ if (rc < 0) { -+ usb_unanchor_urb(urb); -+ kfree_skb(skb); -+ } -+ usb_free_urb(urb); -+ -+_exit: -+ -+ dev_kfree_skb_any(skb); -+ return 0; -+} -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_xmit.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_xmit.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/rtl8812a_xmit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/rtl8812a_xmit.c 2018-02-06 17:42:30.715967238 +0200 -@@ -0,0 +1,512 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RTL8812A_XMIT_C_ -+ -+//#include -+#include -+ -+void _dbg_dump_tx_info(_adapter *padapter,int frame_tag, u8 *ptxdesc) -+{ -+ u8 bDumpTxPkt; -+ u8 bDumpTxDesc = false; -+ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DUMP_TXPKT, &(bDumpTxPkt)); -+ -+ if(bDumpTxPkt ==1){//dump txdesc for data frame -+ DBG_871X("dump tx_desc for data frame\n"); -+ if((frame_tag&0x0f) == DATA_FRAMETAG){ -+ bDumpTxDesc = true; -+ } -+ } -+ else if(bDumpTxPkt ==2){//dump txdesc for mgnt frame -+ DBG_871X("dump tx_desc for mgnt frame\n"); -+ if((frame_tag&0x0f) == MGNT_FRAMETAG){ -+ bDumpTxDesc = true; -+ } -+ } -+ else if(bDumpTxPkt ==3){//dump early info -+ } -+ -+ if(bDumpTxDesc){ -+ // ptxdesc->txdw4 = cpu_to_le32(0x00001006);//RTS Rate=24M -+ // ptxdesc->txdw6 = 0x6666f800; -+ DBG_8192C("=====================================\n"); -+ DBG_8192C("Offset00(0x%08x)\n",*((u32 *)(ptxdesc))); -+ DBG_8192C("Offset04(0x%08x)\n",*((u32 *)(ptxdesc+4))); -+ DBG_8192C("Offset08(0x%08x)\n",*((u32 *)(ptxdesc+8))); -+ DBG_8192C("Offset12(0x%08x)\n",*((u32 *)(ptxdesc+12))); -+ DBG_8192C("Offset16(0x%08x)\n",*((u32 *)(ptxdesc+16))); -+ DBG_8192C("Offset20(0x%08x)\n",*((u32 *)(ptxdesc+20))); -+ DBG_8192C("Offset24(0x%08x)\n",*((u32 *)(ptxdesc+24))); -+ DBG_8192C("Offset28(0x%08x)\n",*((u32 *)(ptxdesc+28))); -+ DBG_8192C("Offset32(0x%08x)\n",*((u32 *)(ptxdesc+32))); -+ DBG_8192C("Offset36(0x%08x)\n",*((u32 *)(ptxdesc+36))); -+ DBG_8192C("=====================================\n"); -+ } -+ -+} -+ -+/* -+ * Description: -+ * Aggregation packets and send to hardware -+ * -+ * Return: -+ * 0 Success -+ * -1 Hardware resource(TX FIFO) not ready -+ * -2 Software resource(xmitbuf) not ready -+ */ -+#ifdef CONFIG_TX_EARLY_MODE -+ -+//#define DBG_EMINFO -+ -+#if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1 -+ #define EARLY_MODE_MAX_PKT_NUM 10 -+#else -+ #define EARLY_MODE_MAX_PKT_NUM 5 -+#endif -+ -+ -+struct EMInfo{ -+ u8 EMPktNum; -+ u16 EMPktLen[EARLY_MODE_MAX_PKT_NUM]; -+}; -+ -+ -+void -+InsertEMContent_8812( -+ struct EMInfo *pEMInfo, -+ IN pu1Byte VirtualAddress) -+{ -+ -+#if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1 -+ u1Byte index=0; -+ u4Byte dwtmp=0; -+#endif -+ -+ _rtw_memset(VirtualAddress, 0, EARLY_MODE_INFO_SIZE); -+ if(pEMInfo->EMPktNum==0) -+ return; -+ -+ #ifdef DBG_EMINFO -+ { -+ int i; -+ DBG_8192C("\n%s ==> pEMInfo->EMPktNum =%d\n",__FUNCTION__,pEMInfo->EMPktNum); -+ for(i=0;i< EARLY_MODE_MAX_PKT_NUM;i++){ -+ DBG_8192C("%s ==> pEMInfo->EMPktLen[%d] =%d\n",__FUNCTION__,i,pEMInfo->EMPktLen[i]); -+ } -+ -+ } -+ #endif -+ -+#if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1 -+ SET_EARLYMODE_PKTNUM(VirtualAddress, pEMInfo->EMPktNum); -+ -+ if(pEMInfo->EMPktNum == 1){ -+ dwtmp = pEMInfo->EMPktLen[0]; -+ }else{ -+ dwtmp = pEMInfo->EMPktLen[0]; -+ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; -+ dwtmp += pEMInfo->EMPktLen[1]; -+ } -+ SET_EARLYMODE_LEN0(VirtualAddress, dwtmp); -+ if(pEMInfo->EMPktNum <= 3){ -+ dwtmp = pEMInfo->EMPktLen[2]; -+ }else{ -+ dwtmp = pEMInfo->EMPktLen[2]; -+ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; -+ dwtmp += pEMInfo->EMPktLen[3]; -+ } -+ SET_EARLYMODE_LEN1(VirtualAddress, dwtmp); -+ if(pEMInfo->EMPktNum <= 5){ -+ dwtmp = pEMInfo->EMPktLen[4]; -+ }else{ -+ dwtmp = pEMInfo->EMPktLen[4]; -+ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; -+ dwtmp += pEMInfo->EMPktLen[5]; -+ } -+ SET_EARLYMODE_LEN2_1(VirtualAddress, dwtmp&0xF); -+ SET_EARLYMODE_LEN2_2(VirtualAddress, dwtmp>>4); -+ if(pEMInfo->EMPktNum <= 7){ -+ dwtmp = pEMInfo->EMPktLen[6]; -+ }else{ -+ dwtmp = pEMInfo->EMPktLen[6]; -+ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; -+ dwtmp += pEMInfo->EMPktLen[7]; -+ } -+ SET_EARLYMODE_LEN3(VirtualAddress, dwtmp); -+ if(pEMInfo->EMPktNum <= 9){ -+ dwtmp = pEMInfo->EMPktLen[8]; -+ }else{ -+ dwtmp = pEMInfo->EMPktLen[8]; -+ dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4; -+ dwtmp += pEMInfo->EMPktLen[9]; -+ } -+ SET_EARLYMODE_LEN4(VirtualAddress, dwtmp); -+#else -+ SET_EARLYMODE_PKTNUM(VirtualAddress, pEMInfo->EMPktNum); -+ SET_EARLYMODE_LEN0(VirtualAddress, pEMInfo->EMPktLen[0]); -+ SET_EARLYMODE_LEN1(VirtualAddress, pEMInfo->EMPktLen[1]); -+ SET_EARLYMODE_LEN2_1(VirtualAddress, pEMInfo->EMPktLen[2]&0xF); -+ SET_EARLYMODE_LEN2_2(VirtualAddress, pEMInfo->EMPktLen[2]>>4); -+ SET_EARLYMODE_LEN3(VirtualAddress, pEMInfo->EMPktLen[3]); -+ SET_EARLYMODE_LEN4(VirtualAddress, pEMInfo->EMPktLen[4]); -+#endif -+ //RT_PRINT_DATA(COMP_SEND, DBG_LOUD, "EMHdr:", VirtualAddress, 8); -+ -+} -+ -+ -+ -+void UpdateEarlyModeInfo8812(struct xmit_priv *pxmitpriv,struct xmit_buf *pxmitbuf ) -+{ -+ //_adapter *padapter, struct xmit_frame *pxmitframe,struct tx_servq *ptxservq -+ int index,j; -+ u16 offset,pktlen; -+ PTXDESC_8812 ptxdesc; -+ -+ u8 *pmem,*pEMInfo_mem; -+ s8 node_num_0=0,node_num_1=0; -+ struct EMInfo eminfo; -+ struct agg_pkt_info *paggpkt; -+ struct xmit_frame *pframe = (struct xmit_frame*)pxmitbuf->priv_data; -+ pmem= pframe->buf_addr; -+ -+ #ifdef DBG_EMINFO -+ DBG_8192C("\n%s ==> agg_num:%d\n",__FUNCTION__, pframe->agg_num); -+ for(index=0;indexagg_num;index++){ -+ offset = pxmitpriv->agg_pkt[index].offset; -+ pktlen = pxmitpriv->agg_pkt[index].pkt_len; -+ DBG_8192C("%s ==> agg_pkt[%d].offset=%d\n",__FUNCTION__,index,offset); -+ DBG_8192C("%s ==> agg_pkt[%d].pkt_len=%d\n",__FUNCTION__,index,pktlen); -+ } -+ #endif -+ -+ if( pframe->agg_num > EARLY_MODE_MAX_PKT_NUM) -+ { -+ node_num_0 = pframe->agg_num; -+ node_num_1= EARLY_MODE_MAX_PKT_NUM-1; -+ } -+ -+ for(index=0;indexagg_num;index++){ -+ -+ offset = pxmitpriv->agg_pkt[index].offset; -+ pktlen = pxmitpriv->agg_pkt[index].pkt_len; -+ -+ _rtw_memset(&eminfo,0,sizeof(struct EMInfo)); -+ if( pframe->agg_num > EARLY_MODE_MAX_PKT_NUM){ -+ if(node_num_0 > EARLY_MODE_MAX_PKT_NUM){ -+ eminfo.EMPktNum = EARLY_MODE_MAX_PKT_NUM; -+ node_num_0--; -+ } -+ else{ -+ eminfo.EMPktNum = node_num_1; -+ node_num_1--; -+ } -+ } -+ else{ -+ eminfo.EMPktNum = pframe->agg_num-(index+1); -+ } -+ for(j=0;j< eminfo.EMPktNum ;j++){ -+ eminfo.EMPktLen[j] = pxmitpriv->agg_pkt[index+1+j].pkt_len+4;// 4 bytes CRC -+ } -+ -+ if(pmem){ -+ if(index==0){ -+ ptxdesc = (PTXDESC_8812)(pmem); -+ pEMInfo_mem = ((u8 *)ptxdesc)+TXDESC_SIZE; -+ } -+ else{ -+ pmem = pmem + pxmitpriv->agg_pkt[index-1].offset; -+ ptxdesc = (PTXDESC_8812)(pmem); -+ pEMInfo_mem = ((u8 *)ptxdesc)+TXDESC_SIZE; -+ } -+ -+ #ifdef DBG_EMINFO -+ DBG_8192C("%s ==> desc.pkt_len=%d\n",__FUNCTION__,ptxdesc->pktlen); -+ #endif -+ InsertEMContent_8812(&eminfo,pEMInfo_mem); -+ } -+ -+ -+ } -+ _rtw_memset(pxmitpriv->agg_pkt,0,sizeof(struct agg_pkt_info)*MAX_AGG_PKT_NUM); -+ -+} -+#endif -+ -+void rtl8812a_cal_txdesc_chksum(u8 *ptxdesc) -+{ -+ u16 *usPtr; -+ u32 count; -+ u32 index; -+ u16 checksum = 0; -+ -+ -+ usPtr = (u16*)ptxdesc; -+ // checksume is always calculated by first 32 bytes, -+ // and it doesn't depend on TX DESC length. -+ // Thomas,Lucas@SD4,20130515 -+ count = 16; -+ -+ // Clear first -+ SET_TX_DESC_TX_DESC_CHECKSUM_8812(ptxdesc, 0); -+ -+ for(index = 0 ; index < count ; index++){ -+ checksum = checksum ^ le16_to_cpu(*(usPtr + index)); -+ } -+ -+ SET_TX_DESC_TX_DESC_CHECKSUM_8812(ptxdesc, checksum); -+} -+ -+// -+// Description: In normal chip, we should send some packet to Hw which will be used by Fw -+// in FW LPS mode. The function is to fill the Tx descriptor of this packets, then -+// Fw can tell Hw to send these packet derectly. -+// -+void rtl8812a_fill_fake_txdesc( -+ PADAPTER padapter, -+ u8* pDesc, -+ u32 BufferLen, -+ u8 IsPsPoll, -+ u8 IsBTQosNull) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ -+ // Clear all status -+ _rtw_memset(pDesc, 0, TXDESC_SIZE); -+ -+ SET_TX_DESC_FIRST_SEG_8812(pDesc, 1); -+ SET_TX_DESC_LAST_SEG_8812(pDesc, 1); -+ -+ SET_TX_DESC_OFFSET_8812(pDesc, TXDESC_SIZE); -+ -+ SET_TX_DESC_PKT_SIZE_8812(pDesc, BufferLen); -+ -+ SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT); -+ -+ if (pmlmeext->cur_wireless_mode & WIRELESS_11B) { -+ SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_B); -+ } else { -+ SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_G); -+ } -+ -+ //Set NAVUSEHDR to prevent Ps-poll AId filed to be changed to error vlaue by Hw. -+ if (IsPsPoll) -+ { -+ SET_TX_DESC_NAV_USE_HDR_8812(pDesc, 1); -+ } -+ else -+ { -+ SET_TX_DESC_HWSEQ_EN_8812(pDesc, 1); // Hw set sequence number -+ } -+ -+ if(IsBTQosNull) -+ { -+ SET_TX_DESC_BT_INT_8812(pDesc, 1); -+ } -+ -+ SET_TX_DESC_USE_RATE_8812(pDesc, 1); -+ SET_TX_DESC_OWN_8812(pDesc, 1); -+ -+ SET_TX_DESC_TX_RATE_8812(pDesc, MRateToHwRate(pmlmeext->tx_rate)); -+ -+ // USB interface drop packet if the checksum of descriptor isn't correct. -+ // Using this checksum can let hardware recovery from packet bulk out error (e.g. Cancel URC, Bulk out error.). -+ rtl8812a_cal_txdesc_chksum(pDesc); -+} -+ -+void rtl8812a_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ if ((pattrib->encrypt > 0) && !pattrib->bswenc) -+ { -+ switch (pattrib->encrypt) -+ { -+ //SEC_TYPE : 0:NO_ENC,1:WEP40/TKIP,2:WAPI,3:AES -+ case _WEP40_: -+ case _WEP104_: -+ case _TKIP_: -+ case _TKIP_WTMIC_: -+ SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x1); -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case _SMS4_: -+ SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x2); -+ break; -+#endif -+ case _AES_: -+ SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x3); -+ break; -+ case _NO_PRIVACY_: -+ default: -+ SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x0); -+ break; -+ -+ } -+ -+ } -+ -+} -+ -+void rtl8812a_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ //DBG_8192C("vcs_mode=%d\n", pattrib->vcs_mode); -+ -+ if (pattrib->vcs_mode) { -+ -+ switch(pattrib->vcs_mode) -+ { -+ case RTS_CTS: -+ SET_TX_DESC_RTS_ENABLE_8812(ptxdesc, 1); -+ break; -+ case CTS_TO_SELF: -+ SET_TX_DESC_CTS2SELF_8812(ptxdesc, 1); -+ break; -+ case NONE_VCS: -+ default: -+ break; -+ } -+ -+ if (pmlmeinfo->preamble_mode == PREAMBLE_SHORT) -+ SET_TX_DESC_RTS_SHORT_8812(ptxdesc, 1); -+ -+ SET_TX_DESC_RTS_RATE_8812(ptxdesc, 0x8);//RTS Rate=24M -+ -+ SET_TX_DESC_RTS_RATE_FB_LIMIT_8812(ptxdesc, 0xf); -+ -+ //Enable HW RTS -+ //SET_TX_DESC_HW_RTS_ENABLE_8812(ptxdesc, 1); -+ } -+} -+ -+void rtl8812a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc) -+{ -+ //DBG_8192C("bwmode=%d, ch_off=%d\n", pattrib->bwmode, pattrib->ch_offset); -+ -+ if(pattrib->ht_en) -+ { -+ // Set Bandwidth and sub-channel settings. -+ SET_TX_DESC_DATA_BW_8812(ptxdesc, BWMapping_8812(padapter,pattrib)); -+ -+ //SET_TX_DESC_DATA_SC_8812(ptxdesc, SCMapping_8812(padapter,pattrib)); -+ } -+} -+ -+u8 -+BWMapping_8812( -+ PADAPTER Adapter, -+ struct pkt_attrib *pattrib -+) -+{ -+ u8 BWSettingOfDesc = 0; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ -+ //DBG_871X("BWMapping pHalData->CurrentChannelBW %d, pattrib->bwmode %d \n",pHalData->CurrentChannelBW,pattrib->bwmode); -+ -+ if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_80) -+ { -+ if(pattrib->bwmode == CHANNEL_WIDTH_80) -+ BWSettingOfDesc= 2; -+ else if(pattrib->bwmode == CHANNEL_WIDTH_40) -+ BWSettingOfDesc = 1; -+ else -+ BWSettingOfDesc = 0; -+ } -+ else if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_40) -+ { -+ if((pattrib->bwmode == CHANNEL_WIDTH_40) || (pattrib->bwmode == CHANNEL_WIDTH_80)) -+ BWSettingOfDesc = 1; -+ else -+ BWSettingOfDesc = 0; -+ } -+ else -+ BWSettingOfDesc = 0; -+ -+ return BWSettingOfDesc; -+} -+ -+u8 -+SCMapping_8812( -+ PADAPTER Adapter, -+ struct pkt_attrib *pattrib -+) -+{ -+ u8 SCSettingOfDesc = 0; -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); -+ //DBG_871X("SCMapping: pHalData->CurrentChannelBW %d, pHalData->nCur80MhzPrimeSC %d, pHalData->nCur40MhzPrimeSC %d \n",pHalData->CurrentChannelBW,pHalData->nCur80MhzPrimeSC,pHalData->nCur40MhzPrimeSC); -+ -+ if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) -+ { -+ if(pattrib->bwmode == CHANNEL_WIDTH_80) -+ { -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } -+ else if(pattrib->bwmode == CHANNEL_WIDTH_40) -+ { -+ if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ SCSettingOfDesc = VHT_DATA_SC_40_LOWER_OF_80MHZ; -+ else if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ SCSettingOfDesc = VHT_DATA_SC_40_UPPER_OF_80MHZ; -+ else -+ DBG_871X("SCMapping: Not Correct Primary40MHz Setting \n"); -+ } -+ else -+ { -+ if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWEST_OF_80MHZ; -+ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPERST_OF_80MHZ; -+ else -+ DBG_871X("SCMapping: Not Correct Primary40MHz Setting \n"); -+ } -+ } -+ else if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_40) -+ { -+ //DBG_871X("SCMapping: HT Case: pHalData->CurrentChannelBW %d, pHalData->nCur40MhzPrimeSC %d \n",pHalData->CurrentChannelBW,pHalData->nCur40MhzPrimeSC); -+ -+ if(pattrib->bwmode == CHANNEL_WIDTH_40) -+ { -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } -+ else if(pattrib->bwmode == CHANNEL_WIDTH_20) -+ { -+ if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) -+ { -+ SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ; -+ } -+ else if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) -+ { -+ SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ; -+ } -+ else -+ { -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } -+ -+ } -+ } -+ else -+ { -+ SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; -+ } -+ -+ return SCSettingOfDesc; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/usb_halinit.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/usb_halinit.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/usb_halinit.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/usb_halinit.c 2018-02-06 17:42:30.716967253 +0200 -@@ -0,0 +1,2563 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _HCI_HAL_INIT_C_ -+ -+//#include -+#include -+ -+static void _dbg_dump_macreg(_adapter *padapter) -+{ -+ u32 offset = 0; -+ u32 val32 = 0; -+ u32 index =0 ; -+ for(index=0;index<64;index++) -+ { -+ offset = index*4; -+ val32 = rtw_read32(padapter,offset); -+ DBG_8192C("offset : 0x%02x ,val:0x%08x\n",offset,val32); -+ } -+} -+ -+static void -+_ConfigChipOutEP_8812( -+ PADAPTER pAdapter, -+ u8 NumOutPipe -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ -+ -+ pHalData->OutEpQueueSel = 0; -+ pHalData->OutEpNumber = 0; -+ -+ switch(NumOutPipe){ -+ case 4: -+ pHalData->OutEpQueueSel=TX_SELE_HQ| TX_SELE_LQ|TX_SELE_NQ; -+ pHalData->OutEpNumber=4; -+ break; -+ case 3: -+ pHalData->OutEpQueueSel=TX_SELE_HQ| TX_SELE_LQ|TX_SELE_NQ; -+ pHalData->OutEpNumber=3; -+ break; -+ case 2: -+ pHalData->OutEpQueueSel=TX_SELE_HQ| TX_SELE_NQ; -+ pHalData->OutEpNumber=2; -+ break; -+ case 1: -+ pHalData->OutEpQueueSel=TX_SELE_HQ; -+ pHalData->OutEpNumber=1; -+ break; -+ default: -+ break; -+ -+ } -+ DBG_871X("%s OutEpQueueSel(0x%02x), OutEpNumber(%d) \n",__FUNCTION__,pHalData->OutEpQueueSel,pHalData->OutEpNumber ); -+ -+} -+ -+static bool HalUsbSetQueuePipeMapping8812AUsb( -+ PADAPTER pAdapter, -+ u8 NumInPipe, -+ u8 NumOutPipe -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ bool result = false; -+ -+ _ConfigChipOutEP_8812(pAdapter, NumOutPipe); -+ -+ // Normal chip with one IN and one OUT doesn't have interrupt IN EP. -+ if(1 == pHalData->OutEpNumber){ -+ if(1 != NumInPipe){ -+ return result; -+ } -+ } -+ -+ // All config other than above support one Bulk IN and one Interrupt IN. -+ //if(2 != NumInPipe){ -+ // return result; -+ //} -+ -+ result = Hal_MappingOutPipe(pAdapter, NumOutPipe); -+ -+ return result; -+ -+} -+ -+static void rtl8812au_interface_configure(_adapter *padapter) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ -+ if (IS_SUPER_SPEED_USB(padapter)) -+ { -+ pHalData->UsbBulkOutSize = USB_SUPER_SPEED_BULK_SIZE;//1024 bytes -+ } -+ else if (IS_HIGH_SPEED_USB(padapter)) -+ { -+ pHalData->UsbBulkOutSize = USB_HIGH_SPEED_BULK_SIZE;//512 bytes -+ } -+ else -+ { -+ pHalData->UsbBulkOutSize = USB_FULL_SPEED_BULK_SIZE;//64 bytes -+ } -+ -+ pHalData->interfaceIndex = pdvobjpriv->InterfaceNumber; -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ pHalData->UsbTxAggMode = 1; -+ pHalData->UsbTxAggDescNum = 6; // only 4 bits -+ -+ if(IS_HARDWARE_TYPE_8812AU(padapter)) //page added for Jaguar -+ pHalData->UsbTxAggDescNum = 3; -+#endif -+ -+#ifdef CONFIG_USB_RX_AGGREGATION -+ pHalData->UsbRxAggMode = USB_RX_AGG_DMA;// USB_RX_AGG_DMA; -+ pHalData->UsbRxAggBlockCount = 8; //unit : 512b -+ pHalData->UsbRxAggBlockTimeout = 0x6; -+ pHalData->UsbRxAggPageCount = 16; //uint :128 b //0x0A; // 10 = MAX_RX_DMA_BUFFER_SIZE/2/pHalData->UsbBulkOutSize -+ pHalData->UsbRxAggPageTimeout = 0x6; //6, absolute time = 34ms/(2^6) -+ -+ pHalData->RegAcUsbDmaSize = 4; -+ pHalData->RegAcUsbDmaTime = 8; -+#endif -+ -+ HalUsbSetQueuePipeMapping8812AUsb(padapter, -+ pdvobjpriv->RtNumInPipes, pdvobjpriv->RtNumOutPipes); -+ -+} -+ -+static void -+_InitBurstPktLen(PADAPTER Adapter) -+{ -+ u1Byte speedvalue, provalue, temp; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ -+ //rtw_write16(Adapter, REG_TRXDMA_CTRL_8195, 0xf5b0); -+ //rtw_write16(Adapter, REG_TRXDMA_CTRL_8812, 0xf5b4); -+ rtw_write8(Adapter, 0xf050, 0x01); //usb3 rx interval -+ rtw_write16(Adapter, REG_RXDMA_STATUS, 0x7400); //burset lenght=4, set 0x3400 for burset length=2 -+ rtw_write8(Adapter, 0x289,0xf5); //for rxdma control -+ //rtw_write8(Adapter, 0x3a, 0x46); -+ -+ // 0x456 = 0x70, sugguested by Zhilin -+ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8812, 0x70); -+ -+ rtw_write32(Adapter, 0x458, 0xffffffff); -+ rtw_write8(Adapter, REG_USTIME_TSF, 0x50); -+ rtw_write8(Adapter, REG_USTIME_EDCA, 0x50); -+ -+ if(IS_HARDWARE_TYPE_8821U(Adapter)) -+ speedvalue = BIT7; -+ else -+ speedvalue = rtw_read8(Adapter, 0xff); //check device operation speed: SS 0xff bit7 -+ -+ if(speedvalue & BIT7) //USB2/1.1 Mode -+ { -+ temp = rtw_read8(Adapter, 0xfe17); -+ if(((temp>>4)&0x03)==0) -+ { -+ pHalData->UsbBulkOutSize = USB_HIGH_SPEED_BULK_SIZE; -+ provalue = rtw_read8(Adapter, REG_RXDMA_PRO_8812); -+ rtw_write8(Adapter, REG_RXDMA_PRO_8812, ((provalue|BIT(4))&(~BIT(5)))); //set burst pkt len=512B -+ rtw_write16(Adapter, REG_RXDMA_PRO_8812, 0x1e); -+ } -+ else -+ { -+ pHalData->UsbBulkOutSize = 64; -+ provalue = rtw_read8(Adapter, REG_RXDMA_PRO_8812); -+ rtw_write8(Adapter, REG_RXDMA_PRO_8812, ((provalue|BIT(5))&(~BIT(4)))); //set burst pkt len=64B -+ } -+ -+ rtw_write16(Adapter, REG_RXDMA_AGG_PG_TH,0x2005); //dmc agg th 20K -+ -+ //rtw_write8(Adapter, 0x10c, 0xb4); -+ //hal_UphyUpdate8812AU(Adapter); -+ -+ pHalData->bSupportUSB3 = false; -+ } -+ else //USB3 Mode -+ { -+ pHalData->UsbBulkOutSize = USB_SUPER_SPEED_BULK_SIZE; -+ provalue = rtw_read8(Adapter, REG_RXDMA_PRO_8812); -+ rtw_write8(Adapter, REG_RXDMA_PRO_8812, provalue&(~(BIT5|BIT4))); //set burst pkt len=1k -+ rtw_write16(Adapter, REG_RXDMA_PRO_8812, 0x0e); -+ //PlatformEFIOWrite2Byte(Adapter, REG_RXDMA_AGG_PG_TH,0x0a05); //dmc agg th 20K -+ pHalData->bSupportUSB3 = true; -+ -+ // set Reg 0xf008[3:4] to 2'00 to disable U1/U2 Mode to avoid 2.5G spur in USB3.0. added by page, 20120712 -+ rtw_write8(Adapter, 0xf008, rtw_read8(Adapter, 0xf008)&0xE7); -+ } -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ //rtw_write8(Adapter, REG_TDECTRL_8195, 0x30); -+#else -+ rtw_write8(Adapter, REG_TDECTRL, 0x10); -+#endif -+ -+ temp = rtw_read8(Adapter, REG_SYS_FUNC_EN); -+ rtw_write8(Adapter, REG_SYS_FUNC_EN, temp&(~BIT(10))); //reset 8051 -+ -+ rtw_write8(Adapter, REG_HT_SINGLE_AMPDU_8812,rtw_read8(Adapter, REG_HT_SINGLE_AMPDU_8812)|BIT(7)); //enable single pkt ampdu -+ rtw_write8(Adapter, REG_RX_PKT_LIMIT, 0x18); //for VHT packet length 11K -+ -+ rtw_write8(Adapter, REG_PIFS, 0x00); -+ -+ //Suggention by SD1 Jong and Pisa, by Maddest 20130107. -+ if(IS_HARDWARE_TYPE_8821U(Adapter) && (Adapter->registrypriv.wifi_spec == false)) -+ { -+ rtw_write16(Adapter, REG_MAX_AGGR_NUM, 0x0a0a); -+ rtw_write8(Adapter, REG_FWHW_TXQ_CTRL, 0x80); -+ rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8812, 0x5e); -+ rtw_write32(Adapter, REG_FAST_EDCA_CTRL, 0x03087777); -+ } -+ else -+ { -+ rtw_write8(Adapter, REG_MAX_AGGR_NUM, 0x1f); -+ rtw_write8(Adapter, REG_FWHW_TXQ_CTRL, rtw_read8(Adapter, REG_FWHW_TXQ_CTRL)&(~BIT(7))); -+ } -+ -+ if(pHalData->AMPDUBurstMode) -+ { -+ rtw_write8(Adapter,REG_AMPDU_BURST_MODE_8812, 0x5F); -+ } -+ -+ rtw_write8(Adapter, 0x1c, rtw_read8(Adapter, 0x1c) | BIT(5) |BIT(6)); //to prevent mac is reseted by bus. 20111208, by Page -+ -+ // ARFB table 9 for 11ac 5G 2SS -+ rtw_write32(Adapter, REG_ARFR0, 0x00000010); -+ if(IS_NORMAL_CHIP(pHalData->VersionID)) -+ rtw_write32(Adapter, REG_ARFR0+4, 0xfffff000); -+ else -+ rtw_write32(Adapter, REG_ARFR0+4, 0x3e0ff000); -+ -+ // ARFB table 10 for 11ac 5G 1SS -+ rtw_write32(Adapter, REG_ARFR1, 0x00000010); -+ if(IS_VENDOR_8812A_TEST_CHIP(Adapter)) -+ rtw_write32(Adapter, REG_ARFR1_8812+4, 0x000ff000); -+ else -+ rtw_write32(Adapter, REG_ARFR1_8812+4, 0x003ff000); -+ -+} -+ -+static u32 _InitPowerOn8812AU(_adapter *padapter) -+{ -+ u16 u2btmp = 0; -+ u8 u1btmp = 0; -+ -+ if(IS_VENDOR_8821A_MP_CHIP(padapter)) -+ { -+ // HW Power on sequence -+ if(!HalPwrSeqCmdParsing(padapter, PWR_CUT_A_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8821A_NIC_ENABLE_FLOW)) { -+ DBG_871X(KERN_ERR "%s: run power on flow fail\n", __func__); -+ return _FAIL; -+ } -+ } -+ else if(IS_HARDWARE_TYPE_8821U(padapter)) -+ { -+ if(!HalPwrSeqCmdParsing(padapter, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8821A_NIC_ENABLE_FLOW)) { -+ DBG_871X(KERN_ERR "%s: run power on flow fail\n", __func__); -+ return _FAIL; -+ } -+ } -+ else -+ { -+ if(!HalPwrSeqCmdParsing(padapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8812_NIC_ENABLE_FLOW)) { -+ DBG_871X(KERN_ERR "%s: run power on flow fail\n", __func__); -+ return _FAIL; -+ } -+ } -+ -+ // Enable MAC DMA/WMAC/SCHEDULE/SEC block -+ // Set CR bit10 to enable 32k calibration. Suggested by SD1 Gimmy. Added by tynli. 2011.08.31. -+ rtw_write16(padapter, REG_CR, 0x00); //suggseted by zhouzhou, by page, 20111230 -+ u2btmp = rtw_read16(padapter, REG_CR); -+ u2btmp |= (HCI_TXDMA_EN | HCI_RXDMA_EN | TXDMA_EN | RXDMA_EN -+ | PROTOCOL_EN | SCHEDULE_EN | ENSEC | CALTMR_EN); -+ rtw_write16(padapter, REG_CR, u2btmp); -+ -+ //Need remove below furture, suggest by Jackie. -+ // if 0xF0[24] =1 (LDO), need to set the 0x7C[6] to 1. -+ if(IS_HARDWARE_TYPE_8821U(padapter)) -+ { -+ u1btmp = rtw_read8(padapter, REG_SYS_CFG+3); -+ if(u1btmp & BIT0) //LDO mode. -+ { -+ u1btmp =rtw_read8(padapter, 0x7c); -+ rtw_write8(padapter,0x7c,u1btmp | BIT6); -+ } -+ } -+ -+ return _SUCCESS; -+} -+ -+ -+ -+ -+ -+//--------------------------------------------------------------- -+// -+// MAC init functions -+// -+//--------------------------------------------------------------- -+ -+// Shall USB interface init this? -+static void -+_InitInterrupt_8812AU( -+ PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ // HIMR -+ rtw_write32(Adapter, REG_HIMR0_8812, pHalData->IntrMask[0]&0xFFFFFFFF); -+ rtw_write32(Adapter, REG_HIMR1_8812, pHalData->IntrMask[1]&0xFFFFFFFF); -+} -+ -+static void -+_InitQueueReservedPage_8821AUsb( -+ PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct registry_priv *pregistrypriv = &Adapter->registrypriv; -+ u32 numHQ = 0; -+ u32 numLQ = 0; -+ u32 numNQ = 0; -+ u32 numPubQ = 0; -+ u32 value32; -+ u8 value8; -+ bool bWiFiConfig = pregistrypriv->wifi_spec; -+ -+ if(!bWiFiConfig) -+ { -+ numPubQ = NORMAL_PAGE_NUM_PUBQ_8821; -+ -+ if(pHalData->OutEpQueueSel & TX_SELE_HQ) -+ { -+ numHQ = NORMAL_PAGE_NUM_HPQ_8821; -+ } -+ -+ if(pHalData->OutEpQueueSel & TX_SELE_LQ) -+ { -+ numLQ = NORMAL_PAGE_NUM_LPQ_8821; -+ } -+ -+ // NOTE: This step shall be proceed before writting REG_RQPN. -+ if(pHalData->OutEpQueueSel & TX_SELE_NQ){ -+ numNQ = NORMAL_PAGE_NUM_NPQ_8821; -+ } -+ } -+ else -+ { // WMM -+ numPubQ = WMM_NORMAL_PAGE_NUM_PUBQ_8821; -+ -+ if(pHalData->OutEpQueueSel & TX_SELE_HQ) -+ { -+ numHQ = WMM_NORMAL_PAGE_NUM_HPQ_8821; -+ } -+ -+ if(pHalData->OutEpQueueSel & TX_SELE_LQ) -+ { -+ numLQ = WMM_NORMAL_PAGE_NUM_LPQ_8821; -+ } -+ -+ // NOTE: This step shall be proceed before writting REG_RQPN. -+ if(pHalData->OutEpQueueSel & TX_SELE_NQ){ -+ numNQ = WMM_NORMAL_PAGE_NUM_NPQ_8821; -+ } -+ } -+ -+ value8 = (u8)_NPQ(numNQ); -+ rtw_write8(Adapter, REG_RQPN_NPQ, value8); -+ -+ // TX DMA -+ value32 = _HPQ(numHQ) | _LPQ(numLQ) | _PUBQ(numPubQ) | LD_RQPN; -+ rtw_write32(Adapter, REG_RQPN, value32); -+} -+ -+static void -+_InitQueueReservedPage_8812AUsb( -+ PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct registry_priv *pregistrypriv = &Adapter->registrypriv; -+ u32 numHQ = 0; -+ u32 numLQ = 0; -+ u32 numNQ = 0; -+ u32 numPubQ = 0; -+ u32 value32; -+ u8 value8; -+ bool bWiFiConfig = pregistrypriv->wifi_spec; -+ -+ if(!bWiFiConfig) -+ { -+ numPubQ = NORMAL_PAGE_NUM_PUBQ_8812; -+ -+ if(pHalData->OutEpQueueSel & TX_SELE_HQ) -+ { -+ numHQ = NORMAL_PAGE_NUM_HPQ_8812; -+ } -+ -+ if(pHalData->OutEpQueueSel & TX_SELE_LQ) -+ { -+ numLQ = NORMAL_PAGE_NUM_LPQ_8812; -+ } -+ -+ // NOTE: This step shall be proceed before writting REG_RQPN. -+ if(pHalData->OutEpQueueSel & TX_SELE_NQ){ -+ numNQ = NORMAL_PAGE_NUM_NPQ_8812; -+ } -+ } -+ else -+ { // WMM -+ numPubQ = WMM_NORMAL_PAGE_NUM_PUBQ_8812; -+ -+ if(pHalData->OutEpQueueSel & TX_SELE_HQ) -+ { -+ numHQ = WMM_NORMAL_PAGE_NUM_HPQ_8812; -+ } -+ -+ if(pHalData->OutEpQueueSel & TX_SELE_LQ) -+ { -+ numLQ = WMM_NORMAL_PAGE_NUM_LPQ_8812; -+ } -+ -+ // NOTE: This step shall be proceed before writting REG_RQPN. -+ if(pHalData->OutEpQueueSel & TX_SELE_NQ){ -+ numNQ = WMM_NORMAL_PAGE_NUM_NPQ_8812; -+ } -+ } -+ -+ value8 = (u8)_NPQ(numNQ); -+ rtw_write8(Adapter, REG_RQPN_NPQ, value8); -+ -+ // TX DMA -+ value32 = _HPQ(numHQ) | _LPQ(numLQ) | _PUBQ(numPubQ) | LD_RQPN; -+ rtw_write32(Adapter, REG_RQPN, value32); -+} -+ -+static void _InitID_8812A( PADAPTER Adapter) -+{ -+ hal_init_macaddr(Adapter);//set mac_address -+} -+ -+static void -+_InitTxBufferBoundary_8821AUsb( -+ PADAPTER Adapter -+ ) -+{ -+ struct registry_priv *pregistrypriv = &Adapter->registrypriv; -+ u8 txpktbuf_bndy; -+ -+ if(!pregistrypriv->wifi_spec){ -+ txpktbuf_bndy = TX_PAGE_BOUNDARY_8821; -+ } -+ else -+ {//for WMM -+ txpktbuf_bndy = WMM_NORMAL_TX_PAGE_BOUNDARY_8821; -+ } -+ -+ rtw_write8(Adapter, REG_BCNQ_BDNY, txpktbuf_bndy); -+ rtw_write8(Adapter, REG_MGQ_BDNY, txpktbuf_bndy); -+ rtw_write8(Adapter, REG_WMAC_LBK_BF_HD, txpktbuf_bndy); -+ rtw_write8(Adapter, REG_TRXFF_BNDY, txpktbuf_bndy); -+ rtw_write8(Adapter, REG_TDECTRL+1, txpktbuf_bndy); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ rtw_write8(Adapter, REG_BCNQ1_BDNY, txpktbuf_bndy+8); -+ rtw_write8(Adapter, REG_TDECTRL1_8812+1, txpktbuf_bndy+8);//BCN1_HEAD -+ // BIT1- BIT_SW_BCN_SEL_EN -+ rtw_write8(Adapter, REG_TDECTRL1_8812+2, rtw_read8(Adapter, REG_TDECTRL1_8812+2)|BIT1); -+#endif -+ -+} -+ -+static void -+_InitTxBufferBoundary_8812AUsb( -+ PADAPTER Adapter -+ ) -+{ -+ struct registry_priv *pregistrypriv = &Adapter->registrypriv; -+ u8 txpktbuf_bndy; -+ -+ if(!pregistrypriv->wifi_spec){ -+ txpktbuf_bndy = TX_PAGE_BOUNDARY_8812; -+ } -+ else -+ {//for WMM -+ txpktbuf_bndy = WMM_NORMAL_TX_PAGE_BOUNDARY_8812; -+ } -+ -+ rtw_write8(Adapter, REG_BCNQ_BDNY, txpktbuf_bndy); -+ rtw_write8(Adapter, REG_MGQ_BDNY, txpktbuf_bndy); -+ rtw_write8(Adapter, REG_WMAC_LBK_BF_HD, txpktbuf_bndy); -+ rtw_write8(Adapter, REG_TRXFF_BNDY, txpktbuf_bndy); -+ rtw_write8(Adapter, REG_TDECTRL+1, txpktbuf_bndy); -+ -+} -+ -+static void -+_InitPageBoundary_8812AUsb( -+ PADAPTER Adapter -+ ) -+{ -+ //u2Byte rxff_bndy; -+ //u2Byte Offset; -+ //bool bSupportRemoteWakeUp; -+ -+ //Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_WOWLAN , &bSupportRemoteWakeUp); -+ // RX Page Boundary -+ //srand(static_cast(time(NULL)) ); -+ -+// Offset = MAX_RX_DMA_BUFFER_SIZE_8812/256; -+// rxff_bndy = (Offset*256)-1; -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ rtw_write16(Adapter, (REG_TRXFF_BNDY + 2), MAX_RX_DMA_BUFFER_SIZE_8812-1); -+ else -+ rtw_write16(Adapter, (REG_TRXFF_BNDY + 2), MAX_RX_DMA_BUFFER_SIZE_8821-1); -+ -+} -+ -+ -+static void -+_InitNormalChipRegPriority_8812AUsb( -+ PADAPTER Adapter, -+ u16 beQ, -+ u16 bkQ, -+ u16 viQ, -+ u16 voQ, -+ u16 mgtQ, -+ u16 hiQ -+ ) -+{ -+ u16 value16 = (rtw_read16(Adapter, REG_TRXDMA_CTRL) & 0x7); -+ -+ value16 |= _TXDMA_BEQ_MAP(beQ) | _TXDMA_BKQ_MAP(bkQ) | -+ _TXDMA_VIQ_MAP(viQ) | _TXDMA_VOQ_MAP(voQ) | -+ _TXDMA_MGQ_MAP(mgtQ)| _TXDMA_HIQ_MAP(hiQ); -+ -+ rtw_write16(Adapter, REG_TRXDMA_CTRL, value16); -+} -+ -+static void -+_InitNormalChipTwoOutEpPriority_8812AUsb( -+ PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct registry_priv *pregistrypriv = &Adapter->registrypriv; -+ u16 beQ,bkQ,viQ,voQ,mgtQ,hiQ; -+ -+ -+ u16 valueHi = 0; -+ u16 valueLow = 0; -+ -+ switch(pHalData->OutEpQueueSel) -+ { -+ case (TX_SELE_HQ | TX_SELE_LQ): -+ valueHi = QUEUE_HIGH; -+ valueLow = QUEUE_LOW; -+ break; -+ case (TX_SELE_NQ | TX_SELE_LQ): -+ valueHi = QUEUE_NORMAL; -+ valueLow = QUEUE_LOW; -+ break; -+ case (TX_SELE_HQ | TX_SELE_NQ): -+ valueHi = QUEUE_HIGH; -+ valueLow = QUEUE_NORMAL; -+ break; -+ default: -+ valueHi = QUEUE_HIGH; -+ valueLow = QUEUE_NORMAL; -+ break; -+ } -+ -+ if(!pregistrypriv->wifi_spec ){ -+ beQ = valueLow; -+ bkQ = valueLow; -+ viQ = valueHi; -+ voQ = valueHi; -+ mgtQ = valueHi; -+ hiQ = valueHi; -+ } -+ else{//for WMM ,CONFIG_OUT_EP_WIFI_MODE -+ beQ = valueLow; -+ bkQ = valueHi; -+ viQ = valueHi; -+ voQ = valueLow; -+ mgtQ = valueHi; -+ hiQ = valueHi; -+ } -+ -+ _InitNormalChipRegPriority_8812AUsb(Adapter,beQ,bkQ,viQ,voQ,mgtQ,hiQ); -+ -+} -+ -+static void -+_InitNormalChipThreeOutEpPriority_8812AUsb( -+ PADAPTER Adapter -+ ) -+{ -+ struct registry_priv *pregistrypriv = &Adapter->registrypriv; -+ u16 beQ,bkQ,viQ,voQ,mgtQ,hiQ; -+ -+ if(!pregistrypriv->wifi_spec ){// typical setting -+ beQ = QUEUE_LOW; -+ bkQ = QUEUE_LOW; -+ viQ = QUEUE_NORMAL; -+ voQ = QUEUE_HIGH; -+ mgtQ = QUEUE_HIGH; -+ hiQ = QUEUE_HIGH; -+ } -+ else{// for WMM -+ beQ = QUEUE_LOW; -+ bkQ = QUEUE_NORMAL; -+ viQ = QUEUE_NORMAL; -+ voQ = QUEUE_HIGH; -+ mgtQ = QUEUE_HIGH; -+ hiQ = QUEUE_HIGH; -+ } -+ _InitNormalChipRegPriority_8812AUsb(Adapter,beQ,bkQ,viQ,voQ,mgtQ,hiQ); -+} -+ -+static void -+_InitQueuePriority_8812AUsb( -+ PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ switch(pHalData->OutEpNumber) -+ { -+ case 2: -+ _InitNormalChipTwoOutEpPriority_8812AUsb(Adapter); -+ break; -+ case 3: -+ case 4: -+ _InitNormalChipThreeOutEpPriority_8812AUsb(Adapter); -+ break; -+ default: -+ DBG_871X("_InitQueuePriority_8812AUsb(): Shall not reach here!\n"); -+ break; -+ } -+} -+ -+ -+ -+static void -+_InitHardwareDropIncorrectBulkOut_8812A( -+ PADAPTER Adapter -+ ) -+{ -+ u32 value32 = rtw_read32(Adapter, REG_TXDMA_OFFSET_CHK); -+ value32 |= DROP_DATA_EN; -+ rtw_write32(Adapter, REG_TXDMA_OFFSET_CHK, value32); -+} -+ -+static void -+_InitNetworkType_8812A( -+ PADAPTER Adapter -+ ) -+{ -+ u32 value32; -+ -+ value32 = rtw_read32(Adapter, REG_CR); -+ // TODO: use the other function to set network type -+ value32 = (value32 & ~MASK_NETTYPE) | _NETTYPE(NT_LINK_AP); -+ -+ rtw_write32(Adapter, REG_CR, value32); -+} -+ -+static void -+_InitTransferPageSize_8812AUsb( -+ PADAPTER Adapter -+ ) -+{ -+ -+ u8 value8; -+ value8 = _PSTX(PBP_512); -+ -+ PlatformEFIOWrite1Byte(Adapter, REG_PBP, value8); -+} -+ -+static void -+_InitDriverInfoSize_8812A( -+ PADAPTER Adapter, -+ u8 drvInfoSize -+ ) -+{ -+ rtw_write8(Adapter,REG_RX_DRVINFO_SZ, drvInfoSize); -+} -+ -+static void -+_InitWMACSetting_8812A( -+ PADAPTER Adapter -+ ) -+{ -+ //u4Byte value32; -+ //u16 value16; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ //pHalData->ReceiveConfig = AAP | APM | AM | AB | APP_ICV | ADF | AMF | APP_FCS | HTC_LOC_CTRL | APP_MIC | APP_PHYSTS; -+ pHalData->ReceiveConfig = -+ RCR_APM | RCR_AM | RCR_AB |RCR_CBSSID_DATA| RCR_CBSSID_BCN| RCR_APP_ICV | RCR_AMF | RCR_HTC_LOC_CTRL | RCR_APP_MIC | RCR_APP_PHYST_RXFF; -+ -+#if (1 == RTL8812A_RX_PACKET_INCLUDE_CRC) -+ pHalData->ReceiveConfig |= ACRC32; -+#endif -+ -+ if(IS_HARDWARE_TYPE_8812AU(Adapter) || IS_HARDWARE_TYPE_8821U(Adapter)) -+ pHalData->ReceiveConfig |= FORCEACK; -+ -+ // some REG_RCR will be modified later by phy_ConfigMACWithHeaderFile() -+ rtw_write32(Adapter, REG_RCR, pHalData->ReceiveConfig); -+ -+ // Accept all multicast address -+ rtw_write32(Adapter, REG_MAR, 0xFFFFFFFF); -+ rtw_write32(Adapter, REG_MAR + 4, 0xFFFFFFFF); -+ -+ -+ // Accept all data frames -+ //value16 = 0xFFFF; -+ //rtw_write16(Adapter, REG_RXFLTMAP2, value16); -+ -+ // 2010.09.08 hpfan -+ // Since ADF is removed from RCR, ps-poll will not be indicate to driver, -+ // RxFilterMap should mask ps-poll to gurantee AP mode can rx ps-poll. -+ //value16 = 0x400; -+ //rtw_write16(Adapter, REG_RXFLTMAP1, value16); -+ -+ // Accept all management frames -+ //value16 = 0xFFFF; -+ //rtw_write16(Adapter, REG_RXFLTMAP0, value16); -+ -+ //enable RX_SHIFT bits -+ //rtw_write8(Adapter, REG_TRXDMA_CTRL, rtw_read8(Adapter, REG_TRXDMA_CTRL)|BIT(1)); -+ -+} -+ -+static void -+_InitAdaptiveCtrl_8812AUsb( -+ PADAPTER Adapter -+ ) -+{ -+ u16 value16; -+ u32 value32; -+ -+ // Response Rate Set -+ value32 = rtw_read32(Adapter, REG_RRSR); -+ value32 &= ~RATE_BITMAP_ALL; -+ -+ if(Adapter->registrypriv.wireless_mode & WIRELESS_11B) -+ value32 |= RATE_RRSR_CCK_ONLY_1M; -+ else -+ value32 |= RATE_RRSR_WITHOUT_CCK; -+ -+ value32 |= RATE_RRSR_CCK_ONLY_1M; -+ rtw_write32(Adapter, REG_RRSR, value32); -+ -+ // CF-END Threshold -+ //m_spIoBase->rtw_write8(REG_CFEND_TH, 0x1); -+ -+ // SIFS (used in NAV) -+ value16 = _SPEC_SIFS_CCK(0x10) | _SPEC_SIFS_OFDM(0x10); -+ rtw_write16(Adapter, REG_SPEC_SIFS, value16); -+ -+ // Retry Limit -+ value16 = _LRL(0x30) | _SRL(0x30); -+ rtw_write16(Adapter, REG_RL, value16); -+ -+} -+ -+static void -+_InitEDCA_8812AUsb( -+ PADAPTER Adapter -+ ) -+{ -+ // Set Spec SIFS (used in NAV) -+ rtw_write16(Adapter,REG_SPEC_SIFS, 0x100a); -+ rtw_write16(Adapter,REG_MAC_SPEC_SIFS, 0x100a); -+ -+ // Set SIFS for CCK -+ rtw_write16(Adapter,REG_SIFS_CTX, 0x100a); -+ -+ // Set SIFS for OFDM -+ rtw_write16(Adapter,REG_SIFS_TRX, 0x100a); -+ -+ // TXOP -+ rtw_write32(Adapter, REG_EDCA_BE_PARAM, 0x005EA42B); -+ rtw_write32(Adapter, REG_EDCA_BK_PARAM, 0x0000A44F); -+ rtw_write32(Adapter, REG_EDCA_VI_PARAM, 0x005EA324); -+ rtw_write32(Adapter, REG_EDCA_VO_PARAM, 0x002FA226); -+ -+ // 0x50 for 80MHz clock -+ rtw_write8(Adapter, REG_USTIME_TSF, 0x50); -+ rtw_write8(Adapter, REG_USTIME_EDCA, 0x50); -+} -+ -+ -+static void -+_InitBeaconMaxError_8812A( -+ PADAPTER Adapter, -+ bool InfraMode -+ ) -+{ -+#ifdef RTL8192CU_ADHOC_WORKAROUND_SETTING -+ rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF); -+#else -+ //rtw_write8(Adapter, REG_BCN_MAX_ERR, (InfraMode ? 0xFF : 0x10)); -+#endif -+} -+ -+ -+#ifdef CONFIG_LED -+static void _InitHWLed(PADAPTER Adapter) -+{ -+ struct led_priv *pledpriv = &(Adapter->ledpriv); -+ -+ if( pledpriv->LedStrategy != HW_LED) -+ return; -+ -+// HW led control -+// to do .... -+//must consider cases of antenna diversity/ commbo card/solo card/mini card -+ -+} -+#endif //CONFIG_LED -+ -+static void -+_InitRDGSetting_8812A( -+ PADAPTER Adapter -+ ) -+{ -+ rtw_write8(Adapter,REG_RD_CTRL,0xFF); -+ rtw_write16(Adapter, REG_RD_NAV_NXT, 0x200); -+ rtw_write8(Adapter,REG_RD_RESP_PKT_TH,0x05); -+} -+ -+static void -+_InitRxSetting_8812AU( -+ PADAPTER Adapter -+ ) -+{ -+ rtw_write32(Adapter, REG_MACID, 0x87654321); -+ rtw_write32(Adapter, 0x0700, 0x87654321); -+} -+ -+static void -+_InitRetryFunction_8812A( -+ PADAPTER Adapter -+ ) -+{ -+ u8 value8; -+ -+ value8 = rtw_read8(Adapter, REG_FWHW_TXQ_CTRL); -+ value8 |= EN_AMPDU_RTY_NEW; -+ rtw_write8(Adapter, REG_FWHW_TXQ_CTRL, value8); -+ -+ // Set ACK timeout -+ //rtw_write8(Adapter, REG_ACKTO, 0x40); //masked by page for BCM IOT issue temporally -+ rtw_write8(Adapter, REG_ACKTO, 0x80); -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: usb_AggSettingTxUpdate() -+ * -+ * Overview: Seperate TX/RX parameters update independent for TP detection and -+ * dynamic TX/RX aggreagtion parameters update. -+ * -+ * Input: PADAPTER -+ * -+ * Output/Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 12/10/2010 MHC Seperate to smaller function. -+ * -+ *---------------------------------------------------------------------------*/ -+static void -+usb_AggSettingTxUpdate_8812A( -+ PADAPTER Adapter -+ ) -+{ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u32 value32; -+ -+ if(Adapter->registrypriv.wifi_spec) -+ pHalData->UsbTxAggMode = false; -+ -+ if(pHalData->UsbTxAggMode){ -+ value32 = rtw_read32(Adapter, REG_TDECTRL); -+ value32 = value32 & ~(BLK_DESC_NUM_MASK << BLK_DESC_NUM_SHIFT); -+ value32 |= ((pHalData->UsbTxAggDescNum & BLK_DESC_NUM_MASK) << BLK_DESC_NUM_SHIFT); -+ -+ rtw_write32(Adapter, REG_TDECTRL, value32); -+ } -+ -+#endif -+} // usb_AggSettingTxUpdate -+ -+ -+/*----------------------------------------------------------------------------- -+ * Function: usb_AggSettingRxUpdate() -+ * -+ * Overview: Seperate TX/RX parameters update independent for TP detection and -+ * dynamic TX/RX aggreagtion parameters update. -+ * -+ * Input: PADAPTER -+ * -+ * Output/Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 12/10/2010 MHC Seperate to smaller function. -+ * -+ *---------------------------------------------------------------------------*/ -+static void -+usb_AggSettingRxUpdate_8812A( -+ PADAPTER Adapter -+ ) -+{ -+#ifdef CONFIG_USB_RX_AGGREGATION -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 valueDMA; -+ u8 valueUSB; -+ -+ valueDMA = rtw_read8(Adapter, REG_TRXDMA_CTRL); -+ -+ switch(pHalData->UsbRxAggMode) -+ { -+ case USB_RX_AGG_DMA: -+ valueDMA |= RXDMA_AGG_EN; -+ -+ //rtw_write8(Adapter, REG_RXDMA_AGG_PG_TH, 0x05); //dma agg mode, 20k -+ // -+ // 2012/10/26 MH For TX throught start rate temp fix. -+ // -+ { -+ u16 temp; -+ -+ //Adjust DMA page and thresh. -+ temp = pHalData->RegAcUsbDmaSize | (pHalData->RegAcUsbDmaTime<<8); -+ rtw_write16(Adapter, REG_RXDMA_AGG_PG_TH, temp); -+ } -+ break; -+ case USB_RX_AGG_USB: -+ case USB_RX_AGG_MIX: -+ case USB_RX_AGG_DISABLE: -+ default: -+ // TODO: -+ break; -+ } -+ -+ rtw_write8(Adapter, REG_TRXDMA_CTRL, valueDMA); -+#endif -+} // usb_AggSettingRxUpdate -+ -+static void -+init_UsbAggregationSetting_8812A( -+ PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ // Tx aggregation setting -+ usb_AggSettingTxUpdate_8812A(Adapter); -+ -+ // Rx aggregation setting -+ usb_AggSettingRxUpdate_8812A(Adapter); -+ -+ // 201/12/10 MH Add for USB agg mode dynamic switch. -+ pHalData->UsbRxHighSpeedMode = false; -+} -+ -+/*----------------------------------------------------------------------------- -+ * Function: USB_AggModeSwitch() -+ * -+ * Overview: When RX traffic is more than 40M, we need to adjust some parameters to increase -+ * RX speed by increasing batch indication size. This will decrease TCP ACK speed, we -+ * need to monitor the influence of FTP/network share. -+ * For TX mode, we are still ubder investigation. -+ * -+ * Input: PADAPTER -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 12/10/2010 MHC Create Version 0. -+ * -+ *---------------------------------------------------------------------------*/ -+static void -+USB_AggModeSwitch( -+ PADAPTER Adapter -+ ) -+{ -+} // USB_AggModeSwitch -+ -+static void -+_InitOperationMode_8812A( -+ PADAPTER Adapter -+ ) -+{ -+} -+ -+ -+// Set CCK and OFDM Block "ON" -+static void _BBTurnOnBlock( -+ PADAPTER Adapter -+ ) -+{ -+#if (DISABLE_BB_RF) -+ return; -+#endif -+ -+ PHY_SetBBReg(Adapter, rFPGA0_RFMOD, bCCKEn, 0x1); -+ PHY_SetBBReg(Adapter, rFPGA0_RFMOD, bOFDMEn, 0x1); -+} -+ -+static void _RfPowerSave( -+ PADAPTER Adapter -+ ) -+{ -+} -+ -+enum { -+ Antenna_Lfet = 1, -+ Antenna_Right = 2, -+}; -+ -+static void -+_InitAntenna_Selection_8812A(PADAPTER Adapter) -+{ -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ if(pHalData->AntDivCfg==0) -+ return; -+ DBG_8192C("==> %s ....\n",__FUNCTION__); -+ -+ rtw_write8(Adapter, REG_LEDCFG2, 0x82); -+ -+ PHY_SetBBReg(Adapter, rFPGA0_XAB_RFParameter, BIT13, 0x01); -+ -+ if(PHY_QueryBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300) == MAIN_ANT) -+ pHalData->CurAntenna = MAIN_ANT; -+ else -+ pHalData->CurAntenna = AUX_ANT; -+ DBG_8192C("%s,Cur_ant:(%x)%s\n",__FUNCTION__,pHalData->CurAntenna,(pHalData->CurAntenna == MAIN_ANT)?"MAIN_ANT":"AUX_ANT"); -+ -+ -+} -+ -+// -+// 2010/08/26 MH Add for selective suspend mode check. -+// If Efuse 0x0e bit1 is not enabled, we can not support selective suspend for Minicard and -+// slim card. -+// -+static void -+HalDetectSelectiveSuspendMode( -+ PADAPTER Adapter -+ ) -+{ -+} // HalDetectSelectiveSuspendMode -+/*----------------------------------------------------------------------------- -+ * Function: HwSuspendModeEnable92Cu() -+ * -+ * Overview: HW suspend mode switch. -+ * -+ * Input: NONE -+ * -+ * Output: NONE -+ * -+ * Return: NONE -+ * -+ * Revised History: -+ * When Who Remark -+ * 08/23/2010 MHC HW suspend mode switch test.. -+ *---------------------------------------------------------------------------*/ -+static void -+HwSuspendModeEnable_8812AU( -+ PADAPTER pAdapter, -+ u8 Type -+ ) -+{ -+ //PRT_USB_DEVICE pDevice = GET_RT_USB_DEVICE(pAdapter); -+ u16 reg = rtw_read16(pAdapter, REG_GPIO_MUXCFG); -+ -+ //if (!pDevice->RegUsbSS) -+ { -+ return; -+ } -+ -+ // -+ // 2010/08/23 MH According to Alfred's suggestion, we need to to prevent HW -+ // to enter suspend mode automatically. Otherwise, it will shut down major power -+ // domain and 8051 will stop. When we try to enter selective suspend mode, we -+ // need to prevent HW to enter D2 mode aumotmatically. Another way, Host will -+ // issue a S10 signal to power domain. Then it will cleat SIC setting(from Yngli). -+ // We need to enable HW suspend mode when enter S3/S4 or disable. We need -+ // to disable HW suspend mode for IPS/radio_off. -+ // -+ //RT_TRACE(COMP_RF, DBG_LOUD, ("HwSuspendModeEnable92Cu = %d\n", Type)); -+ if (Type == false) -+ { -+ reg |= BIT14; -+ //RT_TRACE(COMP_RF, DBG_LOUD, ("REG_GPIO_MUXCFG = %x\n", reg)); -+ rtw_write16(pAdapter, REG_GPIO_MUXCFG, reg); -+ reg |= BIT12; -+ //RT_TRACE(COMP_RF, DBG_LOUD, ("REG_GPIO_MUXCFG = %x\n", reg)); -+ rtw_write16(pAdapter, REG_GPIO_MUXCFG, reg); -+ } -+ else -+ { -+ reg &= (~BIT12); -+ rtw_write16(pAdapter, REG_GPIO_MUXCFG, reg); -+ reg &= (~BIT14); -+ rtw_write16(pAdapter, REG_GPIO_MUXCFG, reg); -+ } -+ -+} // HwSuspendModeEnable92Cu -+ -+static rt_rf_power_state RfOnOffDetect(PADAPTER pAdapter ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ u8 val8; -+ rt_rf_power_state rfpowerstate = rf_off; -+ -+ if(pAdapter->pwrctrlpriv.bHWPowerdown) -+ { -+ val8 = rtw_read8(pAdapter, REG_HSISR); -+ DBG_8192C("pwrdown, 0x5c(BIT7)=%02x\n", val8); -+ rfpowerstate = (val8 & BIT7) ? rf_off: rf_on; -+ } -+ else // rf on/off -+ { -+ rtw_write8( pAdapter, REG_MAC_PINMUX_CFG,rtw_read8(pAdapter, REG_MAC_PINMUX_CFG)&~(BIT3)); -+ val8 = rtw_read8(pAdapter, REG_GPIO_IO_SEL); -+ DBG_8192C("GPIO_IN=%02x\n", val8); -+ rfpowerstate = (val8 & BIT3) ? rf_on : rf_off; -+ } -+ return rfpowerstate; -+} // HalDetectPwrDownMode -+ -+static void _ps_open_RF(_adapter *padapter) -+{ -+} -+ -+static void _ps_close_RF(_adapter *padapter){ -+ //here call with bRegSSPwrLvl 1, bRegSSPwrLvl 2 needs to be verified -+ //phy_SsPwrSwitch92CU(padapter, rf_off, 1); -+} -+ -+static u32 rtl8812au_hal_init(PADAPTER Adapter) -+{ -+ u8 value8 = 0, u1bRegCR; -+ u16 value16; -+ u8 txpktbuf_bndy; -+ u32 status = _SUCCESS; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct pwrctrl_priv *pwrctrlpriv = &Adapter->pwrctrlpriv; -+ struct registry_priv *pregistrypriv = &Adapter->registrypriv; -+ -+ rt_rf_power_state eRfPowerStateToSet; -+#ifdef CONFIG_BT_COEXIST -+ struct btcoexist_priv *pbtpriv = &(pHalData->bt_coexist); -+#endif -+ -+ u32 init_start_time = rtw_get_current_time(); -+ -+ -+#ifdef DBG_HAL_INIT_PROFILING -+ -+ enum HAL_INIT_STAGES { -+ HAL_INIT_STAGES_BEGIN = 0, -+ HAL_INIT_STAGES_INIT_PW_ON, -+ HAL_INIT_STAGES_INIT_LLTT, -+ HAL_INIT_STAGES_DOWNLOAD_FW, -+ HAL_INIT_STAGES_MAC, -+ HAL_INIT_STAGES_MISC01, -+ HAL_INIT_STAGES_MISC02, -+ HAL_INIT_STAGES_BB, -+ HAL_INIT_STAGES_RF, -+ HAL_INIT_STAGES_TURN_ON_BLOCK, -+ HAL_INIT_STAGES_INIT_SECURITY, -+ HAL_INIT_STAGES_MISC11, -+ HAL_INIT_STAGES_INIT_HAL_DM, -+ //HAL_INIT_STAGES_RF_PS, -+ HAL_INIT_STAGES_IQK, -+ HAL_INIT_STAGES_PW_TRACK, -+ HAL_INIT_STAGES_LCK, -+ HAL_INIT_STAGES_MISC21, -+ //HAL_INIT_STAGES_INIT_PABIAS, -+ #ifdef CONFIG_BT_COEXIST -+ HAL_INIT_STAGES_BT_COEXIST, -+ #endif -+ //HAL_INIT_STAGES_ANTENNA_SEL, -+ HAL_INIT_STAGES_MISC31, -+ HAL_INIT_STAGES_END, -+ HAL_INIT_STAGES_NUM -+ }; -+ -+ char * hal_init_stages_str[] = { -+ "HAL_INIT_STAGES_BEGIN", -+ "HAL_INIT_STAGES_INIT_PW_ON", -+ "HAL_INIT_STAGES_INIT_LLTT", -+ "HAL_INIT_STAGES_DOWNLOAD_FW", -+ "HAL_INIT_STAGES_MAC", -+ "HAL_INIT_STAGES_MISC01", -+ "HAL_INIT_STAGES_MISC02", -+ "HAL_INIT_STAGES_BB", -+ "HAL_INIT_STAGES_RF", -+ "HAL_INIT_STAGES_TURN_ON_BLOCK", -+ "HAL_INIT_STAGES_INIT_SECURITY", -+ "HAL_INIT_STAGES_MISC11", -+ "HAL_INIT_STAGES_INIT_HAL_DM", -+ //"HAL_INIT_STAGES_RF_PS", -+ "HAL_INIT_STAGES_IQK", -+ "HAL_INIT_STAGES_PW_TRACK", -+ "HAL_INIT_STAGES_LCK", -+ "HAL_INIT_STAGES_MISC21", -+ #ifdef CONFIG_BT_COEXIST -+ "HAL_INIT_STAGES_BT_COEXIST", -+ #endif -+ //"HAL_INIT_STAGES_ANTENNA_SEL", -+ "HAL_INIT_STAGES_MISC31", -+ "HAL_INIT_STAGES_END", -+ }; -+ -+ int hal_init_profiling_i; -+ u32 hal_init_stages_timestamp[HAL_INIT_STAGES_NUM]; //used to record the time of each stage's starting point -+ -+ for(hal_init_profiling_i=0;hal_init_profiling_ipwrctrlpriv.bkeepfwalive) -+ { -+ _ps_open_RF(Adapter); -+ -+ if(pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized){ -+ //PHY_IQCalibrate_8812A(Adapter,true); -+ } -+ else -+ { -+ //PHY_IQCalibrate_8812A(Adapter,false); -+ pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized = true; -+ } -+ -+ //ODM_TXPowerTrackingCheck(&pHalData->odmpriv ); -+ //PHY_LCCalibrate_8812A(Adapter); -+ -+ goto exit; -+ } -+ -+ // Check if MAC has already power on. by tynli. 2011.05.27. -+ value8 = rtw_read8(Adapter, REG_SYS_CLKR+1); -+ u1bRegCR = PlatformEFIORead1Byte(Adapter, REG_CR); -+ DBG_871X(" power-on :REG_SYS_CLKR 0x09=0x%02x. REG_CR 0x100=0x%02x.\n", value8, u1bRegCR); -+ if((value8&BIT3) && (u1bRegCR != 0 && u1bRegCR != 0xEA)) -+ { -+ //pHalData->bMACFuncEnable = true; -+ DBG_871X(" MAC has already power on.\n"); -+ } -+ else -+ { -+ //pHalData->bMACFuncEnable = false; -+ // Set FwPSState to ALL_ON mode to prevent from the I/O be return because of 32k -+ // state which is set before sleep under wowlan mode. 2012.01.04. by tynli. -+ //pHalData->FwPSState = FW_PS_STATE_ALL_ON_88E; -+ DBG_871X(" MAC has not been powered on yet.\n"); -+ } -+ -+ // -+ // 2012/11/13 MH Revise for U2/U3 switch we can not update RF-A/B reset. -+ // After discuss with BB team YN, reset after MAC power on to prevent RF -+ // R/W error. Is it a right method? -+ // -+ if(!IS_HARDWARE_TYPE_8821(Adapter)) -+ { -+ rtw_write8(Adapter, REG_RF_CTRL, 5); -+ rtw_write8(Adapter, REG_RF_CTRL, 7); -+ rtw_write8(Adapter, REG_RF_B_CTRL_8812, 5); -+ rtw_write8(Adapter, REG_RF_B_CTRL_8812, 7); -+ } -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_PW_ON); -+ status = _InitPowerOn8812AU(Adapter); -+ if(status == _FAIL){ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_err_, ("Failed to init power on!\n")); -+ goto exit; -+ } -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_LLTT); -+ if (!pregistrypriv->wifi_spec) { -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ txpktbuf_bndy = TX_PAGE_BOUNDARY_8812; -+ else -+ txpktbuf_bndy = TX_PAGE_BOUNDARY_8821; -+ } else { -+ // for WMM -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ txpktbuf_bndy = WMM_NORMAL_TX_PAGE_BOUNDARY_8812; -+ else -+ txpktbuf_bndy = WMM_NORMAL_TX_PAGE_BOUNDARY_8821; -+ } -+ -+ status = InitLLTTable8812(Adapter, txpktbuf_bndy); -+ if(status == _FAIL){ -+ RT_TRACE(_module_hci_hal_init_c_, _drv_err_, ("Failed to init LLT table\n")); -+ goto exit; -+ } -+ -+#if ENABLE_USB_DROP_INCORRECT_OUT -+ _InitHardwareDropIncorrectBulkOut_8812A(Adapter); -+#endif -+ -+ if(pHalData->bRDGEnable){ -+ _InitRDGSetting_8812A(Adapter); -+ } -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_DOWNLOAD_FW); -+#if (MP_DRIVER == 1) -+ if (Adapter->registrypriv.mp_mode == 1) -+ { -+ _InitRxSetting_8812AU(Adapter); -+ } -+#endif //MP_DRIVER == 1 -+ { -+ status = FirmwareDownload8812(Adapter, false); -+ if (status != _SUCCESS) { -+ DBG_871X("%s: Download Firmware failed!!\n", __FUNCTION__); -+ Adapter->bFWReady = false; -+ pHalData->fw_ractrl = false; -+ //return status; -+ } else { -+ DBG_871X("%s: Download Firmware Success!!\n",__FUNCTION__); -+ Adapter->bFWReady = true; -+ pHalData->fw_ractrl = true; -+ } -+ } -+ -+ -+ InitializeFirmwareVars8812(Adapter); -+ -+ if(pwrctrlpriv->reg_rfoff == true){ -+ pwrctrlpriv->rf_pwrstate = rf_off; -+ } -+ -+ // 2010/08/09 MH We need to check if we need to turnon or off RF after detecting -+ // HW GPIO pin. Before PHY_RFConfig8192C. -+ //HalDetectPwrDownMode(Adapter); -+ // 2010/08/26 MH If Efuse does not support sective suspend then disable the function. -+ //HalDetectSelectiveSuspendMode(Adapter); -+ -+ // Save target channel -+ // Current Channel will be updated again later. -+ pHalData->CurrentChannel = 0;//set 0 to trigger switch correct channel -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_MAC); -+#if (HAL_MAC_ENABLE == 1) -+ status = PHY_MACConfig8812(Adapter); -+ if(status == _FAIL) -+ { -+ goto exit; -+ } -+#endif -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_MISC01); -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ { -+ _InitQueueReservedPage_8812AUsb(Adapter); -+ _InitTxBufferBoundary_8812AUsb(Adapter); -+ } -+ else if(IS_HARDWARE_TYPE_8821(Adapter)) -+ { -+ _InitQueueReservedPage_8821AUsb(Adapter); -+ _InitTxBufferBoundary_8821AUsb(Adapter); -+ } -+ -+ _InitQueuePriority_8812AUsb(Adapter); -+ _InitPageBoundary_8812AUsb(Adapter); -+ -+ if(IS_HARDWARE_TYPE_8812(Adapter)) -+ _InitTransferPageSize_8812AUsb(Adapter); -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_MISC02); -+ // Get Rx PHY status in order to report RSSI and others. -+ _InitDriverInfoSize_8812A(Adapter, DRVINFO_SZ); -+ -+ _InitInterrupt_8812AU(Adapter); -+ _InitID_8812A(Adapter);//set mac_address -+ _InitNetworkType_8812A(Adapter);//set msr -+ _InitWMACSetting_8812A(Adapter); -+ _InitAdaptiveCtrl_8812AUsb(Adapter); -+ _InitEDCA_8812AUsb(Adapter); -+ -+ _InitRetryFunction_8812A(Adapter); -+ init_UsbAggregationSetting_8812A(Adapter); -+ _InitOperationMode_8812A(Adapter);//todo -+ _InitBeaconParameters_8812A(Adapter); -+ _InitBeaconMaxError_8812A(Adapter, true); -+ -+ _InitBurstPktLen(Adapter); //added by page. 20110919 -+ -+ // -+ // Init CR MACTXEN, MACRXEN after setting RxFF boundary REG_TRXFF_BNDY to patch -+ // Hw bug which Hw initials RxFF boundry size to a value which is larger than the real Rx buffer size in 88E. -+ // 2011.08.05. by tynli. -+ // -+ value8 = rtw_read8(Adapter, REG_CR); -+ rtw_write8(Adapter, REG_CR, (value8|MACTXEN|MACRXEN)); -+ -+#if defined(CONFIG_CONCURRENT_MODE) || defined(CONFIG_TX_MCAST2UNI) -+ -+#ifdef CONFIG_CHECK_AC_LIFETIME -+ // Enable lifetime check for the four ACs -+ rtw_write8(Adapter, REG_LIFETIME_CTRL, 0x0F); -+#endif // CONFIG_CHECK_AC_LIFETIME -+ -+#ifdef CONFIG_TX_MCAST2UNI -+ rtw_write16(Adapter, REG_PKT_VO_VI_LIFE_TIME, 0x0400); // unit: 256us. 256ms -+ rtw_write16(Adapter, REG_PKT_BE_BK_LIFE_TIME, 0x0400); // unit: 256us. 256ms -+#else // CONFIG_TX_MCAST2UNI -+ rtw_write16(Adapter, REG_PKT_VO_VI_LIFE_TIME, 0x3000); // unit: 256us. 3s -+ rtw_write16(Adapter, REG_PKT_BE_BK_LIFE_TIME, 0x3000); // unit: 256us. 3s -+#endif // CONFIG_TX_MCAST2UNI -+#endif // CONFIG_CONCURRENT_MODE || CONFIG_TX_MCAST2UNI -+ -+ -+#ifdef CONFIG_LED -+ _InitHWLed(Adapter); -+#endif //CONFIG_LED -+ -+ // -+ //d. Initialize BB related configurations. -+ // -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_BB); -+#if (HAL_BB_ENABLE == 1) -+ status = PHY_BBConfig8812(Adapter); -+ if(status == _FAIL) -+ { -+ goto exit; -+ } -+#endif -+ -+ // 92CU use 3-wire to r/w RF -+ //pHalData->Rf_Mode = RF_OP_By_SW_3wire; -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_RF); -+#if (HAL_RF_ENABLE == 1) -+ status = PHY_RFConfig8812(Adapter); -+ if(status == _FAIL) -+ { -+ goto exit; -+ } -+ -+ if(pHalData->rf_type == RF_1T1R && IS_HARDWARE_TYPE_8812AU(Adapter)) -+ PHY_BB8812_Config_1T(Adapter); -+#endif -+ -+ if(Adapter->registrypriv.channel <= 14) -+ PHY_SwitchWirelessBand8812(Adapter, BAND_ON_2_4G); -+ else -+ PHY_SwitchWirelessBand8812(Adapter, BAND_ON_5G); -+ -+ rtw_hal_set_chnl_bw(Adapter, Adapter->registrypriv.channel, -+ CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE, HAL_PRIME_CHNL_OFFSET_DONT_CARE); -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_TURN_ON_BLOCK); -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_SECURITY); -+ invalidate_cam_all(Adapter); -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_MISC11); -+ _InitAntenna_Selection_8812A(Adapter); -+ -+ // HW SEQ CTRL -+ //set 0x0 to 0xFF by tynli. Default enable HW SEQ NUM. -+ rtw_write8(Adapter,REG_HWSEQ_CTRL, 0xFF); -+ -+ // -+ // Disable BAR, suggested by Scott -+ // 2010.04.09 add by hpfan -+ // -+ rtw_write32(Adapter, REG_BAR_MODE_CTRL, 0x0201ffff); -+ -+ if(pregistrypriv->wifi_spec) -+ rtw_write16(Adapter,REG_FAST_EDCA_CTRL ,0); -+ -+ //Nav limit , suggest by scott -+ rtw_write8(Adapter, 0x652, 0x0); -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_HAL_DM); -+ rtl8812_InitHalDm(Adapter); -+ -+#if (MP_DRIVER == 1) -+ if (Adapter->registrypriv.mp_mode == 1) -+ { -+ Adapter->mppriv.channel = pHalData->CurrentChannel; -+ MPT_InitializeAdapter(Adapter, Adapter->mppriv.channel); -+ } -+ else -+#endif //#if (MP_DRIVER == 1) -+ { -+ // -+ // 2010/08/11 MH Merge from 8192SE for Minicard init. We need to confirm current radio status -+ // and then decide to enable RF or not.!!!??? For Selective suspend mode. We may not -+ // call init_adapter. May cause some problem?? -+ // -+ // Fix the bug that Hw/Sw radio off before S3/S4, the RF off action will not be executed -+ // in MgntActSet_RF_State() after wake up, because the value of pHalData->eRFPowerState -+ // is the same as eRfOff, we should change it to eRfOn after we config RF parameters. -+ // Added by tynli. 2010.03.30. -+ pwrctrlpriv->rf_pwrstate = rf_on; -+ -+ -+ //0x4c6[3] 1: RTS BW = Data BW -+ //0: RTS BW depends on CCA / secondary CCA result. -+ rtw_write8(Adapter, REG_QUEUE_CTRL, rtw_read8(Adapter, REG_QUEUE_CTRL)&0xF7); -+ -+ // enable Tx report. -+ rtw_write8(Adapter, REG_FWHW_TXQ_CTRL+1, 0x0F); -+ -+ // Suggested by SD1 pisa. Added by tynli. 2011.10.21. -+ rtw_write8(Adapter, REG_EARLY_MODE_CONTROL_8812+3, 0x01);//Pretx_en, for WEP/TKIP SEC -+ -+ //tynli_test_tx_report. -+ rtw_write16(Adapter, REG_TX_RPT_TIME, 0x3DF0); -+ -+ // Reset USB mode switch setting -+ rtw_write8(Adapter, REG_SDIO_CTRL_8812, 0x0); -+ rtw_write8(Adapter, REG_ACLK_MON, 0x0); -+ -+ //RT_TRACE(COMP_INIT, DBG_TRACE, ("InitializeAdapter8188EUsb() <====\n")); -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_IQK); -+ // 2010/08/26 MH Merge from 8192CE. -+ if(pwrctrlpriv->rf_pwrstate == rf_on) -+ { -+ if(IS_HARDWARE_TYPE_8812AU(Adapter)) { -+ pHalData->odmpriv.RFCalibrateInfo.bNeedIQK = true; -+ if(pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized) -+ PHY_IQCalibrate_8812A(Adapter, true); -+ else -+ { -+ PHY_IQCalibrate_8812A(Adapter, false); -+ pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized = true; -+ } -+ } -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_PW_TRACK); -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_LCK); -+ } -+} -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_MISC21); -+ -+ -+//HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_PABIAS); -+// _InitPABias(Adapter); -+ -+#ifdef CONFIG_BT_COEXIST -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_BT_COEXIST); -+ //_InitBTCoexist(Adapter); -+#endif -+ -+ // 2010/08/23 MH According to Alfred's suggestion, we need to to prevent HW enter -+ // suspend mode automatically. -+ //HwSuspendModeEnable92Cu(Adapter, false); -+ -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_MISC31); -+ -+ rtw_write8(Adapter, REG_USB_HRPWM, 0); -+ -+ //misc -+ { -+ int i; -+ u8 mac_addr[6]; -+ for(i=0; i<6; i++) -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if(Adapter->iface_type == IFACE_PORT1) -+ mac_addr[i] = rtw_read8(Adapter, REG_MACID1+i); -+ else -+#endif -+ mac_addr[i] = rtw_read8(Adapter, REG_MACID+i); -+ } -+ -+ DBG_8192C("MAC Address from REG_MACID = "MAC_FMT"\n", MAC_ARG(mac_addr)); -+ } -+ -+exit: -+HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_END); -+ -+ DBG_871X("%s in %dms\n", __FUNCTION__, rtw_get_passing_time_ms(init_start_time)); -+ -+ #ifdef DBG_HAL_INIT_PROFILING -+ hal_init_stages_timestamp[HAL_INIT_STAGES_END]=rtw_get_current_time(); -+ -+ for(hal_init_profiling_i=0;hal_init_profiling_ibFWReady) //8051 RAM code -+ { -+ _8051Reset8812(Adapter); -+ } -+ -+ // Reset MCU. Suggested by Filen. 2011.01.26. by tynli. -+ u1bTmp = rtw_read8(Adapter, REG_SYS_FUNC_EN+1); -+ rtw_write8(Adapter, REG_SYS_FUNC_EN+1, (u1bTmp&(~BIT2))); -+ -+ // MCUFWDL 0x80[1:0]=0 // reset MCU ready status -+ rtw_write8(Adapter, REG_MCUFWDL, 0x00); -+ -+ // Card disable power action flow -+ if(IS_HARDWARE_TYPE_8821U(Adapter)) -+ HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8821A_NIC_DISABLE_FLOW); -+ else -+ HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8812_NIC_DISABLE_FLOW); -+} -+ -+static void rtl8812au_hw_power_down(_adapter *padapter) -+{ -+ // 2010/-8/09 MH For power down module, we need to enable register block contrl reg at 0x1c. -+ // Then enable power down control bit of register 0x04 BIT4 and BIT15 as 1. -+ -+ // Enable register area 0x0-0xc. -+ rtw_write8(padapter,REG_RSV_CTRL, 0x0); -+ rtw_write16(padapter, REG_APS_FSMCO, 0x8812); -+} -+ -+static u32 rtl8812au_hal_deinit(PADAPTER Adapter) -+ { -+ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ DBG_8192C("==> %s \n",__FUNCTION__); -+ -+#ifdef CONFIG_BT_COEXIST -+ if (BT_IsBtExist(Adapter)) -+ { -+ DBG_871X("BT module enable SIC\n"); -+ // Only under WIN7 we can support selective suspend and enter D3 state when system call halt adapter. -+ -+ //rtw_write16(Adapter, REG_GPIO_MUXCFG, rtw_read16(Adapter, REG_GPIO_MUXCFG)|BIT12); -+ // 2010/10/13 MH If we enable SIC in the position and then call _ResetDigitalProcedure1. in XP, -+ // the system will hang due to 8051 reset fail. -+ } -+ else -+#endif -+ { -+ rtw_write16(Adapter, REG_GPIO_MUXCFG, rtw_read16(Adapter, REG_GPIO_MUXCFG)&(~BIT12)); -+ } -+ -+ if(pHalData->bSupportUSB3 == true) -+ { -+ // set Reg 0xf008[3:4] to 2'11 to eable U1/U2 Mode in USB3.0. added by page, 20120712 -+ rtw_write8(Adapter, 0xf008, rtw_read8(Adapter, 0xf008)|0x18); -+ } -+ -+ rtw_write32(Adapter, REG_HISR0_8812, 0xFFFFFFFF); -+ rtw_write32(Adapter, REG_HISR1_8812, 0xFFFFFFFF); -+ rtw_write32(Adapter, REG_HIMR0_8812, IMR_DISABLED_8812); -+ rtw_write32(Adapter, REG_HIMR1_8812, IMR_DISABLED_8812); -+ -+ #ifdef SUPPORT_HW_RFOFF_DETECTED -+ DBG_8192C("bkeepfwalive(%x)\n",Adapter->pwrctrlpriv.bkeepfwalive); -+ if(Adapter->pwrctrlpriv.bkeepfwalive) -+ { -+ _ps_close_RF(Adapter); -+ if((Adapter->pwrctrlpriv.bHWPwrPindetect) && (Adapter->pwrctrlpriv.bHWPowerdown)) -+ rtl8812au_hw_power_down(Adapter); -+ } -+ else -+#endif -+ { -+ if(Adapter->hw_init_completed == true){ -+ CardDisableRTL8812AU(Adapter); -+ -+ if((Adapter->pwrctrlpriv.bHWPwrPindetect ) && (Adapter->pwrctrlpriv.bHWPowerdown)) -+ rtl8812au_hw_power_down(Adapter); -+ } -+ } -+ return _SUCCESS; -+ } -+ -+ -+static unsigned int rtl8812au_inirp_init(PADAPTER Adapter) -+{ -+ u8 i; -+ struct recv_buf *precvbuf; -+ uint status; -+ struct dvobj_priv *pdev= adapter_to_dvobj(Adapter); -+ struct intf_hdl * pintfhdl=&Adapter->iopriv.intf; -+ struct recv_priv *precvpriv = &(Adapter->recvpriv); -+ u32 (*_read_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u32 (*_read_interrupt)(struct intf_hdl *pintfhdl, u32 addr); -+#endif -+ -+ -+ -+ _read_port = pintfhdl->io_ops._read_port; -+ -+ status = _SUCCESS; -+ -+ RT_TRACE(_module_hci_hal_init_c_,_drv_info_,("===> usb_inirp_init \n")); -+ -+ precvpriv->ff_hwaddr = RECV_BULK_IN_ADDR; -+ -+ //issue Rx irp to receive data -+ precvbuf = (struct recv_buf *)precvpriv->precv_buf; -+ for(i=0; iff_hwaddr, 0, (unsigned char *)precvbuf) == false ) -+ { -+ RT_TRACE(_module_hci_hal_init_c_,_drv_err_,("usb_rx_init: usb_read_port error \n")); -+ status = _FAIL; -+ goto exit; -+ } -+ -+ precvbuf++; -+ precvpriv->free_recv_buf_queue_cnt--; -+ } -+ -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+ if(pHalData->RtIntInPipe != 0x05) -+ { -+ status = _FAIL; -+ DBG_871X("%s =>Warning !! Have not USB Int-IN pipe, pHalData->RtIntInPipe(%d)!!!\n",__FUNCTION__,pHalData->RtIntInPipe); -+ goto exit; -+ } -+ _read_interrupt = pintfhdl->io_ops._read_interrupt; -+ if(_read_interrupt(pintfhdl, RECV_INT_IN_ADDR) == false ) -+ { -+ RT_TRACE(_module_hci_hal_init_c_,_drv_err_,("usb_rx_init: usb_read_interrupt error \n")); -+ status = _FAIL; -+ } -+#endif -+ -+exit: -+ -+ RT_TRACE(_module_hci_hal_init_c_,_drv_info_,("<=== usb_inirp_init \n")); -+ -+ -+ -+ return status; -+ -+} -+ -+static unsigned int rtl8812au_inirp_deinit(PADAPTER Adapter) -+{ -+ RT_TRACE(_module_hci_hal_init_c_,_drv_info_,("\n ===> usb_rx_deinit \n")); -+ -+ rtw_read_port_cancel(Adapter); -+ -+ RT_TRACE(_module_hci_hal_init_c_,_drv_info_,("\n <=== usb_rx_deinit \n")); -+ -+ return _SUCCESS; -+} -+ -+//------------------------------------------------------------------- -+// -+// EEPROM/EFUSE Content Parsing -+// -+//------------------------------------------------------------------- -+static void -+hal_ReadIDs_8812AU( -+ PADAPTER Adapter, -+ pu1Byte PROMContent, -+ bool AutoloadFail -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); -+ -+ if( !AutoloadFail ) -+ { -+ // VID, PID -+ if(IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+ pHalData->EEPROMVID = le16_to_cpu( *(__le16 *)&PROMContent[EEPROM_VID_8812AU] ); -+ pHalData->EEPROMPID = le16_to_cpu( *(__le16 *)&PROMContent[EEPROM_PID_8812AU] ); -+ } -+ else if (IS_HARDWARE_TYPE_8821U(Adapter)) -+ -+ { -+ pHalData->EEPROMVID = le16_to_cpu( *(__le16 *)&PROMContent[EEPROM_VID_8821AU] ); -+ pHalData->EEPROMPID = le16_to_cpu( *(__le16 *)&PROMContent[EEPROM_PID_8821AU] ); -+ } -+ -+ -+ // Customer ID, 0x00 and 0xff are reserved for Realtek. -+ pHalData->EEPROMCustomerID = *(u8 *)&PROMContent[EEPROM_CustomID_8812]; -+ pHalData->EEPROMSubCustomerID = EEPROM_Default_SubCustomerID; -+ -+ } -+ else -+ { -+ pHalData->EEPROMVID = EEPROM_Default_VID; -+ pHalData->EEPROMPID = EEPROM_Default_PID; -+ -+ // Customer ID, 0x00 and 0xff are reserved for Realtek. -+ pHalData->EEPROMCustomerID = EEPROM_Default_CustomerID; -+ pHalData->EEPROMSubCustomerID = EEPROM_Default_SubCustomerID; -+ -+ } -+ -+ if((pHalData->EEPROMVID == 0x050D) && (pHalData->EEPROMPID == 0x1106))// SerComm for Belkin. -+ pEEPROM->CustomerID = RT_CID_819x_Sercomm_Belkin; -+ else if((pHalData->EEPROMVID == 0x0846) && (pHalData->EEPROMPID == 0x9051))// SerComm for Netgear. -+ pEEPROM->CustomerID = RT_CID_819x_Sercomm_Netgear; -+ else if((pHalData->EEPROMVID == 0x2001) && (pHalData->EEPROMPID == 0x330e))//add by ylb 20121012 for customer led for alpha -+ pEEPROM->CustomerID = RT_CID_819x_ALPHA_Dlink; -+ else if((pHalData->EEPROMVID == 0x0B05) && (pHalData->EEPROMPID == 0x17D2))//Edimax for ASUS -+ pEEPROM->CustomerID = RT_CID_819x_Edimax_ASUS; -+ -+ DBG_871X("VID = 0x%04X, PID = 0x%04X\n", pHalData->EEPROMVID, pHalData->EEPROMPID); -+ DBG_871X("Customer ID: 0x%02X, SubCustomer ID: 0x%02X\n", pHalData->EEPROMCustomerID, pHalData->EEPROMSubCustomerID); -+} -+ -+static void -+hal_ReadMACAddress_8812AU( -+ PADAPTER Adapter, -+ u8* PROMContent, -+ bool AutoloadFail -+ ) -+{ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); -+ -+ if(false == AutoloadFail) -+ { -+ if(IS_HARDWARE_TYPE_8812AU(Adapter)) -+ { -+ //Read Permanent MAC address and set value to hardware -+ _rtw_memcpy(pEEPROM->mac_addr, &PROMContent[EEPROM_MAC_ADDR_8812AU], ETH_ALEN); -+ } -+ else if(IS_HARDWARE_TYPE_8821U(Adapter)) -+ { -+ //Read Permanent MAC address and set value to hardware -+ _rtw_memcpy(pEEPROM->mac_addr, &PROMContent[EEPROM_MAC_ADDR_8821AU], ETH_ALEN); -+ } -+ } -+ else -+ { -+ //Random assigh MAC address -+ u8 sMacAddr[ETH_ALEN] = {0x00, 0xE0, 0x4C, 0x88, 0x12, 0x00}; -+ //sMacAddr[5] = (u8)GetRandomNumber(1, 254); -+ _rtw_memcpy(pEEPROM->mac_addr, sMacAddr, ETH_ALEN); -+ } -+ -+ DBG_8192C("%s MAC Address from EFUSE = "MAC_FMT"\n",__FUNCTION__, MAC_ARG(pEEPROM->mac_addr)); -+} -+ -+static void -+hal_InitPGData_8812A( -+ PADAPTER padapter, -+ u8* PROMContent -+ ) -+{ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+// HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u32 i; -+ u16 value16; -+ -+ if(false == pEEPROM->bautoload_fail_flag) -+ { // autoload OK. -+ if (is_boot_from_eeprom(padapter)) -+ { -+ // Read all Content from EEPROM or EFUSE. -+ for(i = 0; i < HWSET_MAX_SIZE_JAGUAR; i += 2) -+ { -+ //value16 = le16_to_cpu(ReadEEprom(pAdapter, (u2Byte) (i>>1))); -+ //*((u16*)(&PROMContent[i])) = value16; -+ } -+ } -+ else -+ { -+ // Read EFUSE real map to shadow. -+ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, false); -+ } -+ } -+ else -+ {//autoload fail -+ RT_TRACE(_module_hci_hal_init_c_, _drv_notice_, ("AutoLoad Fail reported from CR9346!!\n")); -+ //pHalData->AutoloadFailFlag = true; -+ //update to default value 0xFF -+ if (!is_boot_from_eeprom(padapter)) -+ EFUSE_ShadowMapUpdate(padapter, EFUSE_WIFI, false); -+ } -+} -+ -+static void -+hal_CustomizedBehavior_8812AU( -+ PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); -+ struct led_priv *pledpriv = &(Adapter->ledpriv); -+ -+ -+ // Led mode -+ switch(pEEPROM->CustomerID) -+ { -+ case RT_CID_DEFAULT: -+ pledpriv->LedStrategy = SW_LED_MODE9; -+ pledpriv->bRegUseLed = true; -+ break; -+ -+ case RT_CID_819x_HP: -+ pledpriv->LedStrategy = SW_LED_MODE6; // Customize Led mode -+ break; -+ -+ case RT_CID_819x_Sercomm_Belkin: -+ pledpriv->LedStrategy = SW_LED_MODE9; -+ break; -+ -+ case RT_CID_819x_Sercomm_Netgear: -+ pledpriv->LedStrategy = SW_LED_MODE10; -+ break; -+ -+ case RT_CID_819x_ALPHA_Dlink://add by ylb 20121012 for customer led for alpha -+ pledpriv->LedStrategy = SW_LED_MODE1; -+ break; -+ -+ case RT_CID_819x_Edimax_ASUS: -+ pledpriv->LedStrategy = SW_LED_MODE11; -+ break; -+ -+ case RT_CID_WNC_NEC: -+ pledpriv->LedStrategy = SW_LED_MODE12; -+ break; -+ -+ case RT_CID_NETGEAR: -+ pledpriv->LedStrategy = SW_LED_MODE13; -+ break; -+ -+ default: -+ pledpriv->LedStrategy = SW_LED_MODE9; -+ break; -+ } -+ -+ pHalData->bLedOpenDrain = true;// Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. -+} -+ -+static void -+hal_CustomizeByCustomerID_8812AU( -+ PADAPTER pAdapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(pAdapter); -+ -+ // For customized behavior. -+ if((pHalData->EEPROMVID == 0x103C) && (pHalData->EEPROMPID == 0x1629))// HP Lite-On for RTL8188CUS Slim Combo. -+ pEEPROM->CustomerID = RT_CID_819x_HP; -+ else if ((pHalData->EEPROMVID == 0x9846) && (pHalData->EEPROMPID == 0x9041)) -+ pEEPROM->CustomerID = RT_CID_NETGEAR; -+ else if ((pHalData->EEPROMVID == 0x2019) && (pHalData->EEPROMPID == 0x1201)) -+ pEEPROM->CustomerID = RT_CID_PLANEX; -+ else if((pHalData->EEPROMVID == 0x0BDA) &&(pHalData->EEPROMPID == 0x5088)) -+ pEEPROM->CustomerID = RT_CID_CC_C; -+ -+ DBG_871X("PID= 0x%x, VID= %x\n",pHalData->EEPROMPID,pHalData->EEPROMVID); -+ -+ // Decide CustomerID according to VID/DID or EEPROM -+ switch(pHalData->EEPROMCustomerID) -+ { -+ case EEPROM_CID_DEFAULT: -+ if((pHalData->EEPROMVID == 0x2001) && (pHalData->EEPROMPID == 0x3308)) -+ pEEPROM->CustomerID = RT_CID_DLINK; -+ else if((pHalData->EEPROMVID == 0x2001) && (pHalData->EEPROMPID == 0x3309)) -+ pEEPROM->CustomerID = RT_CID_DLINK; -+ else if((pHalData->EEPROMVID == 0x2001) && (pHalData->EEPROMPID == 0x330a)) -+ pEEPROM->CustomerID = RT_CID_DLINK; -+ else if((pHalData->EEPROMVID == 0x0BFF) && (pHalData->EEPROMPID == 0x8160)) -+ { -+ //pHalData->bAutoConnectEnable = false; -+ pEEPROM->CustomerID = RT_CID_CHINA_MOBILE; -+ } -+ else if((pHalData->EEPROMVID == 0x0BDA) && (pHalData->EEPROMPID == 0x5088)) -+ pEEPROM->CustomerID = RT_CID_CC_C; -+ else if ((pHalData->EEPROMVID == 0x0846) &&(pHalData->EEPROMPID == 0x9052)) -+ pEEPROM->CustomerID = RT_CID_NETGEAR; -+ DBG_871X("PID= 0x%x, VID= %x\n",pHalData->EEPROMPID,pHalData->EEPROMVID); -+ break; -+ case EEPROM_CID_WHQL: -+ //padapter->bInHctTest = true; -+ -+ //pMgntInfo->bSupportTurboMode = false; -+ //pMgntInfo->bAutoTurboBy8186 = false; -+ -+ //pMgntInfo->PowerSaveControl.bInactivePs = false; -+ //pMgntInfo->PowerSaveControl.bIPSModeBackup = false; -+ //pMgntInfo->PowerSaveControl.bLeisurePs = false; -+ //pMgntInfo->PowerSaveControl.bLeisurePsModeBackup = false; -+ //pMgntInfo->keepAliveLevel = 0; -+ -+ //padapter->bUnloadDriverwhenS3S4 = false; -+ break; -+ default: -+ pEEPROM->CustomerID = RT_CID_DEFAULT; -+ break; -+ -+ } -+ DBG_871X("Customer ID: 0x%2x\n", pEEPROM->CustomerID); -+ -+ hal_CustomizedBehavior_8812AU(pAdapter); -+} -+ -+static void -+hal_ReadUsbModeSwitch_8812AU( -+ PADAPTER Adapter, -+ u8* PROMContent, -+ bool AutoloadFail -+ ) -+{ -+} -+ -+static void -+ReadLEDSetting_8812AU( -+ PADAPTER Adapter, -+ u8* PROMContent, -+ bool AutoloadFail -+ ) -+{ -+ struct led_priv *pledpriv = &(Adapter->ledpriv); -+ -+#ifdef CONFIG_SW_LED -+ pledpriv->bRegUseLed = true; -+#else // HW LED -+ pledpriv->LedStrategy = HW_LED; -+#endif //CONFIG_SW_LED -+} -+ -+static void -+InitAdapterVariablesByPROM_8812AU( -+ PADAPTER Adapter -+ ) -+{ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); -+ -+ hal_InitPGData_8812A(Adapter, pEEPROM->efuse_eeprom_data); -+ Hal_EfuseParseIDCode8812A(Adapter, pEEPROM->efuse_eeprom_data); -+ -+ Hal_ReadPROMVersion8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ hal_ReadIDs_8812AU(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ hal_ReadMACAddress_8812AU(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ Hal_ReadTxPowerInfo8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ Hal_ReadBoardType8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ -+ // -+ // Read Bluetooth co-exist and initialize -+ // -+ Hal_EfuseParseBTCoexistInfo8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ -+ Hal_ReadChannelPlan8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ Hal_EfuseParseXtal_8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ Hal_ReadThermalMeter_8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ Hal_ReadAntennaDiversity8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ -+ if(IS_HARDWARE_TYPE_8821U(Adapter)) -+ { -+ Hal_ReadPAType_8821A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ } -+ else -+ { -+ Hal_ReadPAType_8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ Hal_ReadRFEType_8812A(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ } -+ -+ hal_ReadUsbModeSwitch_8812AU(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ hal_CustomizeByCustomerID_8812AU(Adapter); -+ -+ ReadLEDSetting_8812AU(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+ -+ // 2013/04/15 MH Add for different board type recognize. -+ hal_ReadUsbType_8812AU(Adapter, pEEPROM->efuse_eeprom_data, pEEPROM->bautoload_fail_flag); -+} -+ -+static void Hal_ReadPROMContent_8812A( -+ PADAPTER Adapter -+ ) -+{ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(Adapter); -+ u8 eeValue; -+ -+ /* check system boot selection */ -+ eeValue = rtw_read8(Adapter, REG_9346CR); -+ pEEPROM->EepromOrEfuse = (eeValue & BOOT_FROM_EEPROM) ? true : false; -+ pEEPROM->bautoload_fail_flag = (eeValue & EEPROM_EN) ? false : true; -+ -+ DBG_8192C("Boot from %s, Autoload %s !\n", (pEEPROM->EepromOrEfuse ? "EEPROM" : "EFUSE"), -+ (pEEPROM->bautoload_fail_flag ? "Fail" : "OK") ); -+ -+ //pHalData->EEType = IS_BOOT_FROM_EEPROM(Adapter) ? EEPROM_93C46 : EEPROM_BOOT_EFUSE; -+ -+ InitAdapterVariablesByPROM_8812AU(Adapter); -+} -+ -+static void -+hal_ReadRFType_8812A( -+ PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+#if DISABLE_BB_RF -+ pHalData->rf_chip = RF_PSEUDO_11N; -+#else -+ pHalData->rf_chip = RF_6052; -+#endif -+ -+ //if (pHalData->rf_type == RF_1T1R){ -+ // pHalData->bRFPathRxEnable[0] = true; -+ //} -+ //else { // Default unknow type is 2T2r -+ // pHalData->bRFPathRxEnable[0] = pHalData->bRFPathRxEnable[1] = true; -+ //} -+ -+ if (IsSupported24G(Adapter->registrypriv.wireless_mode) && -+ IsSupported5G(Adapter->registrypriv.wireless_mode)) -+ pHalData->BandSet = BAND_ON_BOTH; -+ else if (IsSupported5G(Adapter->registrypriv.wireless_mode)) -+ pHalData->BandSet = BAND_ON_5G; -+ else -+ pHalData->BandSet = BAND_ON_2_4G; -+ -+ //if(Adapter->bInHctTest) -+ // pHalData->BandSet = BAND_ON_2_4G; -+} -+ -+static void -+hal_CustomizedBehavior_8812AUsb( -+ PADAPTER Adapter -+ ) -+{ -+} -+ -+static void -+ReadAdapterInfo8812AU( -+ PADAPTER Adapter -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ -+ DBG_871X("====> ReadAdapterInfo8812AU\n"); -+ -+ // Read all content in Efuse/EEPROM. -+ Hal_ReadPROMContent_8812A(Adapter); -+ -+ // We need to define the RF type after all PROM value is recognized. -+ hal_ReadRFType_8812A(Adapter); -+ -+ // 2011/02/09 MH We gather the same value for all USB series IC. -+ hal_CustomizedBehavior_8812AUsb(Adapter); -+ -+ DBG_871X("ReadAdapterInfo8812AU <====\n"); -+} -+ -+static void UpdateInterruptMask8812AU(PADAPTER padapter,u8 bHIMR0 ,u32 AddMSR, u32 RemoveMSR) -+{ -+ HAL_DATA_TYPE *pHalData; -+ -+ u32 *himr; -+ pHalData = GET_HAL_DATA(padapter); -+ -+ if(bHIMR0) -+ himr = &(pHalData->IntrMask[0]); -+ else -+ himr = &(pHalData->IntrMask[1]); -+ -+ if (AddMSR) -+ *himr |= AddMSR; -+ -+ if (RemoveMSR) -+ *himr &= (~RemoveMSR); -+ -+ if(bHIMR0) -+ rtw_write32(padapter, REG_HIMR0_8812, *himr); -+ else -+ rtw_write32(padapter, REG_HIMR1_8812, *himr); -+ -+} -+ -+static void SetHwReg8812AU(PADAPTER Adapter, u8 variable, u8* val) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ struct dm_priv *pdmpriv = &pHalData->dmpriv; -+ DM_ODM_T *podmpriv = &pHalData->odmpriv; -+ -+ -+ switch(variable) -+ { -+ case HW_VAR_RXDMA_AGG_PG_TH: -+#ifdef CONFIG_USB_RX_AGGREGATION -+ { -+ /*u8 threshold = *((u8 *)val); -+ if( threshold == 0) -+ { -+ threshold = pHalData->UsbRxAggPageCount; -+ } -+ rtw_write8(Adapter, REG_RXDMA_AGG_PG_TH, threshold);*/ -+ } -+#endif -+ break; -+ case HW_VAR_SET_RPWM: -+#ifdef CONFIG_LPS_LCLK -+ { -+ u8 ps_state = *((u8 *)val); -+ //rpwm value only use BIT0(clock bit) ,BIT6(Ack bit), and BIT7(Toggle bit) for 88e. -+ //BIT0 value - 1: 32k, 0:40MHz. -+ //BIT6 value - 1: report cpwm value after success set, 0:do not report. -+ //BIT7 value - Toggle bit change. -+ //modify by Thomas. 2012/4/2. -+ ps_state = ps_state & 0xC1; -+ //DBG_871X("##### Change RPWM value to = %x for switch clk #####\n",ps_state); -+ rtw_write8(Adapter, REG_USB_HRPWM, ps_state); -+ } -+#endif -+ break; -+ case HW_VAR_USB_MODE: -+ if(*val == 1) -+ rtw_write8(Adapter, REG_OPT_CTRL_8812, 0x4); -+ else if(*val == 2) -+ rtw_write8(Adapter, REG_OPT_CTRL_8812, 0x8); -+ -+ rtw_write8(Adapter, REG_SDIO_CTRL_8812, 0x2); -+ rtw_write8(Adapter, REG_ACLK_MON, 0x1); -+ // -+ // 2013/01/29 MH Test with chunchu/cheng, in Alpha AMD platform. when -+ // U2/U3 switch 8812AU will be recognized as another card and then -+ // OS will treat it as a new card and assign a new GUID. Then SWUSB -+ // service can not work well. We need to delay the card switch time to U3 -+ // Then OS can unload the previous U2 port card and load new U3 port card later. -+ // The strange sympton can disappear. -+ // -+ rtw_write8(Adapter, REG_CAL_TIMER+1, 0x40); -+ //rtw_write8(Adapter, REG_CAL_TIMER+1, 0x3); -+ rtw_write8(Adapter, REG_APS_FSMCO+1, 0x80); -+ break; -+ default: -+ SetHwReg8812A(Adapter, variable, val); -+ break; -+ } -+ -+ -+} -+ -+static void GetHwReg8812AU(PADAPTER Adapter, u8 variable, u8* val) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ DM_ODM_T *podmpriv = &pHalData->odmpriv; -+ -+ -+ switch(variable) -+ { -+ default: -+ GetHwReg8812A(Adapter,variable,val); -+ break; -+ } -+ -+ -+} -+ -+// -+// Description: -+// Change default setting of specified variable. -+// -+static u8 -+SetHalDefVar8812AUsb( -+ PADAPTER Adapter, -+ HAL_DEF_VARIABLE eVariable, -+ void * pValue -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 bResult = _SUCCESS; -+ -+ switch(eVariable) -+ { -+ default: -+ SetHalDefVar8812A(Adapter,eVariable,pValue); -+ break; -+ } -+ -+ return bResult; -+} -+ -+// -+// Description: -+// Query setting of specified variable. -+// -+static u8 -+GetHalDefVar8812AUsb( -+ PADAPTER Adapter, -+ HAL_DEF_VARIABLE eVariable, -+ void * pValue -+ ) -+{ -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -+ u8 bResult = _SUCCESS; -+ -+ switch(eVariable) -+ { -+ default: -+ GetHalDefVar8812A(Adapter,eVariable,pValue); -+ break; -+ } -+ -+ return bResult; -+} -+ -+static void _update_response_rate(_adapter *padapter,unsigned int mask) -+{ -+ u8 RateIndex = 0; -+ // Set RRSR rate table. -+ rtw_write8(padapter, REG_RRSR, mask&0xff); -+ rtw_write8(padapter,REG_RRSR+1, (mask>>8)&0xff); -+ -+ // Set RTS initial rate -+ while(mask > 0x1) -+ { -+ mask = (mask>> 1); -+ RateIndex++; -+ } -+ rtw_write8(padapter, REG_INIRTS_RATE_SEL, RateIndex); -+} -+ -+static void rtl8812au_init_default_value(_adapter * padapter) -+{ -+ PHAL_DATA_TYPE pHalData; -+ struct pwrctrl_priv *pwrctrlpriv; -+ struct dm_priv *pdmpriv; -+ u8 i; -+ -+ pHalData = GET_HAL_DATA(padapter); -+ pwrctrlpriv = &padapter->pwrctrlpriv; -+ pdmpriv = &pHalData->dmpriv; -+ -+ -+ //init default value -+ pHalData->fw_ractrl = false; -+ if(!pwrctrlpriv->bkeepfwalive) -+ pHalData->LastHMEBoxNum = 0; -+ -+ //init dm default value -+ pHalData->bChnlBWInitialzed = false; -+ pHalData->odmpriv.RFCalibrateInfo.bIQKInitialized = false; -+ pHalData->odmpriv.RFCalibrateInfo.TM_Trigger = 0;//for IQK -+ pHalData->pwrGroupCnt = 0; -+ pHalData->PGMaxGroup= MAX_PG_GROUP; -+ pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP_index = 0; -+ for(i = 0; i < HP_THERMAL_NUM; i++) -+ pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP[i] = 0; -+ -+ pHalData->IntrMask[0] = (u32)( \ -+ //IMR_ROK | -+ //IMR_RDU | -+ //IMR_VODOK | -+ //IMR_VIDOK | -+ //IMR_BEDOK | -+ //IMR_BKDOK | -+ //IMR_MGNTDOK | -+ //IMR_HIGHDOK | -+ //IMR_CPWM | -+ //IMR_CPWM2 | -+ //IMR_C2HCMD | -+ //IMR_HISR1_IND_INT | -+ //IMR_ATIMEND | -+ //IMR_BCNDMAINT_E | -+ //IMR_HSISR_IND_ON_INT | -+ //IMR_BCNDOK0 | -+ //IMR_BCNDMAINT0 | -+ //IMR_TSF_BIT32_TOGGLE | -+ //IMR_TXBCN0OK | -+ //IMR_TXBCN0ERR | -+ //IMR_GTINT3 | -+ //IMR_GTINT4 | -+ //IMR_TXCCK | -+ 0); -+ -+ pHalData->IntrMask[1] = (u32)(\ -+ //IMR_RXFOVW | -+ //IMR_TXFOVW | -+ //IMR_RXERR | -+ //IMR_TXERR | -+ //IMR_ATIMEND_E | -+ //IMR_BCNDOK1 | -+ //IMR_BCNDOK2 | -+ //IMR_BCNDOK3 | -+ //IMR_BCNDOK4 | -+ //IMR_BCNDOK5 | -+ //IMR_BCNDOK6 | -+ //IMR_BCNDOK7 | -+ //IMR_BCNDMAINT1 | -+ //IMR_BCNDMAINT2 | -+ //IMR_BCNDMAINT3 | -+ //IMR_BCNDMAINT4 | -+ //IMR_BCNDMAINT5 | -+ //IMR_BCNDMAINT6 | -+ //IMR_BCNDMAINT7 | -+ 0); -+} -+ -+static u8 rtl8812au_ps_func(PADAPTER Adapter,HAL_INTF_PS_FUNC efunc_id, u8 *val) -+{ -+ u8 bResult = true; -+ switch(efunc_id){ -+ -+ #if defined(CONFIG_AUTOSUSPEND) && defined(SUPPORT_HW_RFOFF_DETECTED) -+ case HAL_USB_SELECT_SUSPEND: -+ { -+ u8 bfwpoll = *(( u8*)val); -+ //rtl8188e_set_FwSelectSuspend_cmd(Adapter,bfwpoll ,500);//note fw to support hw power down ping detect -+ } -+ break; -+ #endif //CONFIG_AUTOSUSPEND && SUPPORT_HW_RFOFF_DETECTED -+ -+ default: -+ break; -+ } -+ return bResult; -+} -+ -+void rtl8812au_set_hal_ops(_adapter * padapter) -+{ -+ struct hal_ops *pHalFunc = &padapter->HalFunc; -+ -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->isprimary) -+#endif //CONFIG_CONCURRENT_MODE -+ { -+ padapter->HalData = rtw_zmalloc(sizeof(HAL_DATA_TYPE)); -+ if(padapter->HalData == NULL){ -+ DBG_8192C("cant not alloc memory for HAL DATA \n"); -+ } -+ } -+ //_rtw_memset(padapter->HalData, 0, sizeof(HAL_DATA_TYPE)); -+ padapter->hal_data_sz = sizeof(HAL_DATA_TYPE); -+ -+ pHalFunc->hal_power_on = _InitPowerOn8812AU; -+ pHalFunc->hal_init = &rtl8812au_hal_init; -+ pHalFunc->hal_deinit = &rtl8812au_hal_deinit; -+ -+ //pHalFunc->free_hal_data = &rtl8192c_free_hal_data; -+ -+ pHalFunc->inirp_init = &rtl8812au_inirp_init; -+ pHalFunc->inirp_deinit = &rtl8812au_inirp_deinit; -+ -+ pHalFunc->init_xmit_priv = &rtl8812au_init_xmit_priv; -+ pHalFunc->free_xmit_priv = &rtl8812au_free_xmit_priv; -+ -+ pHalFunc->init_recv_priv = &rtl8812au_init_recv_priv; -+ pHalFunc->free_recv_priv = &rtl8812au_free_recv_priv; -+#ifdef CONFIG_SW_LED -+ pHalFunc->InitSwLeds = &rtl8812au_InitSwLeds; -+ pHalFunc->DeInitSwLeds = &rtl8812au_DeInitSwLeds; -+#else //case of hw led or no led -+ pHalFunc->InitSwLeds = NULL; -+ pHalFunc->DeInitSwLeds = NULL; -+#endif//CONFIG_SW_LED -+ -+ pHalFunc->init_default_value = &rtl8812au_init_default_value; -+ pHalFunc->intf_chip_configure = &rtl8812au_interface_configure; -+ pHalFunc->read_adapter_info = &ReadAdapterInfo8812AU; -+ -+ pHalFunc->SetHwRegHandler = &SetHwReg8812AU; -+ pHalFunc->GetHwRegHandler = &GetHwReg8812AU; -+ pHalFunc->GetHalDefVarHandler = &GetHalDefVar8812AUsb; -+ pHalFunc->SetHalDefVarHandler = &SetHalDefVar8812AUsb; -+ -+ pHalFunc->SetBeaconRelatedRegistersHandler = &SetBeaconRelatedRegisters8812A; -+ -+ pHalFunc->hal_xmit = &rtl8812au_hal_xmit; -+ pHalFunc->mgnt_xmit = &rtl8812au_mgnt_xmit; -+ pHalFunc->hal_xmitframe_enqueue = &rtl8812au_hal_xmitframe_enqueue; -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ pHalFunc->hostap_mgnt_xmit_entry = &rtl8812au_hostap_mgnt_xmit_entry; -+#endif -+ pHalFunc->interface_ps_func = &rtl8812au_ps_func; -+#ifdef CONFIG_XMIT_THREAD_MODE -+ pHalFunc->xmit_thread_handler = &rtl8812au_xmit_buf_handler; -+#endif -+ rtl8812_set_hal_ops(pHalFunc); -+ -+ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/hal/usb_ops_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/hal/usb_ops_linux.c ---- linux-4.14.17/3rdparty/rtl8812au/hal/usb_ops_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/hal/usb_ops_linux.c 2018-02-06 17:42:30.716967253 +0200 -@@ -0,0 +1,1190 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _HCI_OPS_OS_C_ -+ -+//#include -+#include -+ -+static u8 usb_read8(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ u8 data=0; -+ -+ request = 0x05; -+ requesttype = 0x01;//read_in -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = 1; -+ -+ usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); -+ -+ return data; -+} -+ -+static u16 usb_read16(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ __le32 data; -+ -+ request = 0x05; -+ requesttype = 0x01;//read_in -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = 2; -+ -+ usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); -+ -+ return (u16)(le32_to_cpu(data)&0xffff); -+} -+ -+static u32 usb_read32(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ __le32 data; -+ -+ request = 0x05; -+ requesttype = 0x01;//read_in -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = 4; -+ -+ usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); -+ -+ return le32_to_cpu(data); -+} -+ -+static int usb_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ u8 data; -+ int ret; -+ -+ request = 0x05; -+ requesttype = 0x00;//write_out -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = 1; -+ -+ data = val; -+ -+ ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); -+ -+ return ret; -+} -+ -+static int usb_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ __le32 data; -+ int ret; -+ -+ request = 0x05; -+ requesttype = 0x00;//write_out -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = 2; -+ -+ data = cpu_to_le32(val & 0x0000ffff); -+ -+ ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); -+ -+ return ret; -+} -+ -+static int usb_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ __le32 data; -+ int ret; -+ -+ request = 0x05; -+ requesttype = 0x00;//write_out -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = 4; -+ data = cpu_to_le32(val); -+ -+ ret =usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); -+ -+ return ret; -+} -+ -+static int usb_writeN(struct intf_hdl *pintfhdl, u32 addr, u32 length, u8 *pdata) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ u16 len; -+ u8 buf[VENDOR_CMD_MAX_DATA_LEN]={0}; -+ int ret; -+ -+ -+ -+ request = 0x05; -+ requesttype = 0x00;//write_out -+ index = 0;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ len = length; -+ _rtw_memcpy(buf, pdata, len ); -+ -+ ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, buf, len, requesttype); -+ -+ -+ -+ return ret; -+ -+} -+ -+#ifdef CONFIG_SUPPORT_USB_INT -+void interrupt_handler_8812au(_adapter *padapter,u16 pkt_len,u8 *pbuf) -+{ -+ HAL_DATA_TYPE *pHalData=GET_HAL_DATA(padapter); -+ struct reportpwrstate_parm pwr_rpt; -+ -+ if ( pkt_len != INTERRUPT_MSG_FORMAT_LEN ) -+ { -+ DBG_8192C("%s Invalid interrupt content length (%d)!\n", __FUNCTION__, pkt_len); -+ return ; -+ } -+ -+ // HISR -+ _rtw_memcpy(&(pHalData->IntArray[0]), &(pbuf[USB_INTR_CONTENT_HISR_OFFSET]), 4); -+ _rtw_memcpy(&(pHalData->IntArray[1]), &(pbuf[USB_INTR_CONTENT_HISRE_OFFSET]), 4); -+ -+ #if 0 //DBG -+ { -+ u32 hisr=0 ,hisr_ex=0; -+ _rtw_memcpy(&hisr,&(pHalData->IntArray[0]),4); -+ hisr = le32_to_cpu(hisr); -+ -+ _rtw_memcpy(&hisr_ex,&(pHalData->IntArray[1]),4); -+ hisr_ex = le32_to_cpu(hisr_ex); -+ -+ if((hisr != 0) || (hisr_ex!=0)) -+ DBG_871X("===> %s hisr:0x%08x ,hisr_ex:0x%08x \n",__FUNCTION__,hisr,hisr_ex); -+ } -+ #endif -+ -+ -+#ifdef CONFIG_LPS_LCLK -+ if( pHalData->IntArray[0] & IMR_CPWM_88E ) -+ { -+ _rtw_memcpy(&pwr_rpt.state, &(pbuf[USB_INTR_CONTENT_CPWM1_OFFSET]), 1); -+ //_rtw_memcpy(&pwr_rpt.state2, &(pbuf[USB_INTR_CONTENT_CPWM2_OFFSET]), 1); -+ -+ //88e's cpwm value only change BIT0, so driver need to add PS_STATE_S2 for LPS flow. -+ pwr_rpt.state |= PS_STATE_S2; -+ _set_workitem(&padapter->pwrctrlpriv.cpwm_event); -+ } -+#endif//CONFIG_LPS_LCLK -+ -+#ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT -+ if (pHalData->IntArray[0] & IMR_BCNDMAINT0_88E) -+ #endif -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ if (pHalData->IntArray[0] & (IMR_TBDER_88E|IMR_TBDOK_88E)) -+ #endif -+ { -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ #if 0 -+ if(pHalData->IntArray[0] & IMR_BCNDMAINT0_88E) -+ DBG_8192C("%s: HISR_BCNERLY_INT\n", __func__); -+ if(pHalData->IntArray[0] & IMR_TBDOK_88E) -+ DBG_8192C("%s: HISR_TXBCNOK\n", __func__); -+ if(pHalData->IntArray[0] & IMR_TBDER_88E) -+ DBG_8192C("%s: HISR_TXBCNERR\n", __func__); -+ #endif -+ -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ { -+ //send_beacon(padapter); -+ if(pmlmepriv->update_bcn == true) -+ { -+ //tx_beacon_hdl(padapter, NULL); -+ set_tx_beacon_cmd(padapter); -+ } -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(padapter, WIFI_AP_STATE)) -+ { -+ //send_beacon(padapter); -+ if(padapter->pbuddy_adapter->mlmepriv.update_bcn == true) -+ { -+ //tx_beacon_hdl(padapter, NULL); -+ set_tx_beacon_cmd(padapter->pbuddy_adapter); -+ } -+ } -+#endif -+ -+ } -+#endif //CONFIG_INTERRUPT_BASED_TXBCN -+ -+ -+ -+ -+#ifdef DBG_CONFIG_ERROR_DETECT_INT -+ if( pHalData->IntArray[1] & IMR_TXERR_88E ) -+ DBG_871X("===> %s Tx Error Flag Interrupt Status \n",__FUNCTION__); -+ if( pHalData->IntArray[1] & IMR_RXERR_88E ) -+ DBG_871X("===> %s Rx Error Flag INT Status \n",__FUNCTION__); -+ if( pHalData->IntArray[1] & IMR_TXFOVW_88E ) -+ DBG_871X("===> %s Transmit FIFO Overflow \n",__FUNCTION__); -+ if( pHalData->IntArray[1] & IMR_RXFOVW_88E ) -+ DBG_871X("===> %s Receive FIFO Overflow \n",__FUNCTION__); -+#endif//DBG_CONFIG_ERROR_DETECT_INT -+ -+ -+ // C2H Event -+ if(pbuf[0]!= 0){ -+ _rtw_memcpy(&(pHalData->C2hArray[0]), &(pbuf[USB_INTR_CONTENT_C2H_OFFSET]), 16); -+ //rtw_c2h_wk_cmd(padapter); to do.. -+ } -+ -+} -+#endif -+ -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+static void usb_read_interrupt_complete(struct urb *purb, struct pt_regs *regs) -+{ -+ int err; -+ _adapter *padapter = (_adapter *)purb->context; -+ -+ if(padapter->bSurpriseRemoved || padapter->bDriverStopped||padapter->bReadPortCancel) -+ { -+ DBG_8192C("%s() RX Warning! bDriverStopped(%d) OR bSurpriseRemoved(%d) bReadPortCancel(%d)\n", -+ __FUNCTION__,padapter->bDriverStopped, padapter->bSurpriseRemoved,padapter->bReadPortCancel); -+ -+ return; -+ } -+ -+ if(purb->status==0)//SUCCESS -+ { -+ if (purb->actual_length > INTERRUPT_MSG_FORMAT_LEN) -+ { -+ DBG_8192C("usb_read_interrupt_complete: purb->actual_length > INTERRUPT_MSG_FORMAT_LEN(%d)\n",INTERRUPT_MSG_FORMAT_LEN); -+ } -+ -+ interrupt_handler_8188eu(padapter, purb->actual_length,purb->transfer_buffer ); -+ -+ err = usb_submit_urb(purb, GFP_ATOMIC); -+ if((err) && (err != (-EPERM))) -+ { -+ DBG_8192C("cannot submit interrupt in-token(err = 0x%08x),urb_status = %d\n",err, purb->status); -+ } -+ } -+ else -+ { -+ DBG_8192C("###=> usb_read_interrupt_complete => urb status(%d)\n", purb->status); -+ -+ switch(purb->status) { -+ case -EINVAL: -+ case -EPIPE: -+ case -ENODEV: -+ case -ESHUTDOWN: -+ //padapter->bSurpriseRemoved=true; -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bSurpriseRemoved=true\n")); -+ case -ENOENT: -+ padapter->bDriverStopped=true; -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bDriverStopped=true\n")); -+ break; -+ case -EPROTO: -+ break; -+ case -EINPROGRESS: -+ DBG_8192C("ERROR: URB IS IN PROGRESS!/n"); -+ break; -+ default: -+ break; -+ } -+ } -+ -+} -+ -+static u32 usb_read_interrupt(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ int err; -+ unsigned int pipe; -+ u32 ret = _SUCCESS; -+ _adapter *adapter = pintfhdl->padapter; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter); -+ struct recv_priv *precvpriv = &adapter->recvpriv; -+ struct usb_device *pusbd = pdvobj->pusbdev; -+ -+ -+ -+ //translate DMA FIFO addr to pipehandle -+ pipe = ffaddr2pipehdl(pdvobj, addr); -+ -+ usb_fill_int_urb(precvpriv->int_in_urb, pusbd, pipe, -+ precvpriv->int_in_buf, -+ INTERRUPT_MSG_FORMAT_LEN, -+ usb_read_interrupt_complete, -+ adapter, -+ 1); -+ -+ err = usb_submit_urb(precvpriv->int_in_urb, GFP_ATOMIC); -+ if((err) && (err != (-EPERM))) -+ { -+ DBG_8192C("cannot submit interrupt in-token(err = 0x%08x),urb_status = %d\n",err, precvpriv->int_in_urb->status); -+ ret = _FAIL; -+ } -+ -+ -+ -+ return ret; -+} -+#endif -+ -+static s32 pre_recv_entry(union recv_frame *precvframe, u8 *pphy_status) -+{ -+ s32 ret=_SUCCESS; -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 *primary_myid, *secondary_myid, *paddr1; -+ union recv_frame *precvframe_if2 = NULL; -+ _adapter *primary_padapter = precvframe->u.hdr.adapter; -+ _adapter *secondary_padapter = primary_padapter->pbuddy_adapter; -+ struct recv_priv *precvpriv = &primary_padapter->recvpriv; -+ _queue *pfree_recv_queue = &precvpriv->free_recv_queue; -+ u8 *pbuf = precvframe->u.hdr.rx_data; -+ -+ if(!secondary_padapter) -+ return ret; -+ -+ paddr1 = GetAddr1Ptr(pbuf); -+ -+ if(IS_MCAST(paddr1) == false)//unicast packets -+ { -+ //primary_myid = myid(&primary_padapter->eeprompriv); -+ secondary_myid = myid(&secondary_padapter->eeprompriv); -+ -+ if(_rtw_memcmp(paddr1, secondary_myid, ETH_ALEN)) -+ { -+ //change to secondary interface -+ precvframe->u.hdr.adapter = secondary_padapter; -+ } -+ -+ //ret = recv_entry(precvframe); -+ -+ } -+ else // Handle BC/MC Packets -+ { -+ -+ u8 clone = true; -+#if 0 -+ u8 type, subtype, *paddr2, *paddr3; -+ -+ type = GetFrameType(pbuf); -+ subtype = GetFrameSubType(pbuf); //bit(7)~bit(2) -+ -+ switch (type) -+ { -+ case WIFI_MGT_TYPE: //Handle BC/MC mgnt Packets -+ if(subtype == WIFI_BEACON) -+ { -+ paddr3 = GetAddr3Ptr(precvframe->u.hdr.rx_data); -+ -+ if (check_fwstate(&secondary_padapter->mlmepriv, _FW_LINKED) && -+ _rtw_memcmp(paddr3, get_bssid(&secondary_padapter->mlmepriv), ETH_ALEN)) -+ { -+ //change to secondary interface -+ precvframe->u.hdr.adapter = secondary_padapter; -+ clone = false; -+ } -+ -+ if(check_fwstate(&primary_padapter->mlmepriv, _FW_LINKED) && -+ _rtw_memcmp(paddr3, get_bssid(&primary_padapter->mlmepriv), ETH_ALEN)) -+ { -+ if(clone==false) -+ { -+ clone = true; -+ } -+ else -+ { -+ clone = false; -+ } -+ -+ precvframe->u.hdr.adapter = primary_padapter; -+ } -+ -+ if(check_fwstate(&primary_padapter->mlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) || -+ check_fwstate(&secondary_padapter->mlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)) -+ { -+ clone = true; -+ precvframe->u.hdr.adapter = primary_padapter; -+ } -+ -+ } -+ else if(subtype == WIFI_PROBEREQ) -+ { -+ //probe req frame is only for interface2 -+ //change to secondary interface -+ precvframe->u.hdr.adapter = secondary_padapter; -+ clone = false; -+ } -+ break; -+ case WIFI_CTRL_TYPE: // Handle BC/MC ctrl Packets -+ -+ break; -+ case WIFI_DATA_TYPE: //Handle BC/MC data Packets -+ //Notes: AP MODE never rx BC/MC data packets -+ -+ paddr2 = GetAddr2Ptr(precvframe->u.hdr.rx_data); -+ -+ if(_rtw_memcmp(paddr2, get_bssid(&secondary_padapter->mlmepriv), ETH_ALEN)) -+ { -+ //change to secondary interface -+ precvframe->u.hdr.adapter = secondary_padapter; -+ clone = false; -+ } -+ -+ break; -+ default: -+ -+ break; -+ } -+#endif -+ -+ if(true == clone) -+ { -+ //clone/copy to if2 -+ struct rx_pkt_attrib *pattrib = NULL; -+ -+ precvframe_if2 = rtw_alloc_recvframe(pfree_recv_queue); -+ if(precvframe_if2) -+ { -+ precvframe_if2->u.hdr.adapter = secondary_padapter; -+ -+ _rtw_init_listhead(&precvframe_if2->u.hdr.list); -+ precvframe_if2->u.hdr.precvbuf = NULL; //can't access the precvbuf for new arch. -+ precvframe_if2->u.hdr.len=0; -+ -+ _rtw_memcpy(&precvframe_if2->u.hdr.attrib, &precvframe->u.hdr.attrib, sizeof(struct rx_pkt_attrib)); -+ -+ pattrib = &precvframe_if2->u.hdr.attrib; -+ -+ if(rtw_os_alloc_recvframe(secondary_padapter, precvframe_if2, pbuf, NULL) == _SUCCESS) -+ { -+ recvframe_put(precvframe_if2, pattrib->pkt_len); -+ //recvframe_pull(precvframe_if2, drvinfo_sz + RXDESC_SIZE); -+ -+ if (pattrib->physt && pphy_status) -+ rtl8812_query_rx_phy_status(precvframe_if2, pphy_status); -+ -+ ret = rtw_recv_entry(precvframe_if2); -+ } -+ else -+ { -+ rtw_free_recvframe(precvframe_if2, pfree_recv_queue); -+ DBG_8192C("%s()-%d: alloc_skb() failed!\n", __FUNCTION__, __LINE__); -+ } -+ -+ } -+ -+ } -+ -+ } -+ //if (precvframe->u.hdr.attrib.physt) -+ // rtl8812_query_rx_phy_status(precvframe, pphy_status); -+ -+ //ret = rtw_recv_entry(precvframe); -+ -+#endif -+ -+ return ret; -+ -+} -+ -+static int recvbuf2recvframe(_adapter *padapter, -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+struct recv_buf *precvbuf -+#else -+_pkt *pskb -+#endif -+) -+{ -+ u8 *pbuf; -+ u8 pkt_cnt = 0; -+ u32 pkt_offset; -+ s32 transfer_len; -+ u8 *pphy_status = NULL; -+ union recv_frame *precvframe = NULL; -+ struct rx_pkt_attrib *pattrib = NULL; -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ _queue *pfree_recv_queue = &precvpriv->free_recv_queue; -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ transfer_len = (s32)precvbuf->transfer_len; -+ pbuf = precvbuf->pbuf; -+#else -+ transfer_len = (s32)pskb->len; -+ pbuf = pskb->data; -+#endif//CONFIG_USE_USB_BUFFER_ALLOC_RX -+ -+ -+#ifdef CONFIG_USB_RX_AGGREGATION -+ pkt_cnt = GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8812(pbuf); -+#endif -+ -+ do{ -+ precvframe = rtw_alloc_recvframe(pfree_recv_queue); -+ if(precvframe==NULL) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,("recvbuf2recvframe: precvframe==NULL\n")); -+ DBG_8192C("%s()-%d: rtw_alloc_recvframe() failed! RX Drop!\n", __FUNCTION__, __LINE__); -+ goto _exit_recvbuf2recvframe; -+ } -+ -+ _rtw_init_listhead(&precvframe->u.hdr.list); -+ precvframe->u.hdr.precvbuf = NULL; //can't access the precvbuf for new arch. -+ precvframe->u.hdr.len=0; -+ -+ rtl8812_query_rx_desc_status(precvframe, pbuf); -+ -+ pattrib = &precvframe->u.hdr.attrib; -+ -+ if ((pattrib->crc_err) || (pattrib->icv_err)) -+ { -+ DBG_8192C("%s: RX Warning! crc_err=%d icv_err=%d, skip!\n", __FUNCTION__, pattrib->crc_err, pattrib->icv_err); -+ -+ rtw_free_recvframe(precvframe, pfree_recv_queue); -+ goto _exit_recvbuf2recvframe; -+ } -+ -+ pkt_offset = RXDESC_SIZE + pattrib->drvinfo_sz + pattrib->shift_sz + pattrib->pkt_len; -+ -+ if((pattrib->pkt_len<=0) || (pkt_offset>transfer_len)) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("recvbuf2recvframe: pkt_len<=0\n")); -+ DBG_8192C("%s()-%d: RX Warning!,pkt_len<=0 or pkt_offset> transfer_len \n", __FUNCTION__, __LINE__); -+ rtw_free_recvframe(precvframe, pfree_recv_queue); -+ goto _exit_recvbuf2recvframe; -+ } -+ -+ if(rtw_os_alloc_recvframe(padapter, precvframe, -+ (pbuf+pattrib->shift_sz + pattrib->drvinfo_sz + RXDESC_SIZE), -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ NULL -+#else -+ pskb -+#endif -+ ) == _FAIL) -+ { -+ rtw_free_recvframe(precvframe, pfree_recv_queue); -+ -+ goto _exit_recvbuf2recvframe; -+ } -+ -+ recvframe_put(precvframe, pattrib->pkt_len); -+ //recvframe_pull(precvframe, drvinfo_sz + RXDESC_SIZE); -+ -+ if(pattrib->pkt_rpt_type == NORMAL_RX)//Normal rx packet -+ { -+ if(pattrib->physt) -+ pphy_status = (pbuf + RXDESC_OFFSET); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(rtw_buddy_adapter_up(padapter)) -+ { -+ if(pre_recv_entry(precvframe, pphy_status) != _SUCCESS) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_, -+ ("recvbuf2recvframe: recv_entry(precvframe) != _SUCCESS\n")); -+ } -+ } -+#endif //CONFIG_CONCURRENT_MODE -+ -+ if(pattrib->physt && pphy_status) -+ rtl8812_query_rx_phy_status(precvframe, pphy_status); -+ -+ if(rtw_recv_entry(precvframe) != _SUCCESS) -+ { -+ RT_TRACE(_module_rtl871x_recv_c_,_drv_err_, -+ ("recvbuf2recvframe: rtw_recv_entry(precvframe) != _SUCCESS\n")); -+ } -+ -+ } -+ else{ // pkt_rpt_type == TX_REPORT1-CCX, TX_REPORT2-TX RTP,HIS_REPORT-USB HISR RTP -+ -+ if (pattrib->pkt_rpt_type == C2H_PACKET) { -+ //DBG_8192C("rx C2H_PACKET \n"); -+ //C2HPacketHandler_8812A(padapter,precvframe->u.hdr.rx_data,pattrib->pkt_len); -+ } -+ //enqueue recvframe to txrtp queue -+ else if(pattrib->pkt_rpt_type == TX_REPORT1){ -+ DBG_8192C("rx CCX \n"); -+ } -+ else if(pattrib->pkt_rpt_type == TX_REPORT2){ -+ //DBG_8192C("rx TX RPT \n"); -+ } -+ /*else if(pattrib->pkt_rpt_type == HIS_REPORT) -+ { -+ //DBG_8192C("%s , rx USB HISR \n",__FUNCTION__); -+ #ifdef CONFIG_SUPPORT_USB_INT -+ interrupt_handler_8812au(padapter,pattrib->pkt_len,precvframe->u.hdr.rx_data); -+ #endif -+ }*/ -+ rtw_free_recvframe(precvframe, pfree_recv_queue); -+ -+ } -+ -+#ifdef CONFIG_USB_RX_AGGREGATION -+ // jaguar 8-byte alignment -+ pkt_offset = (u16)_RND8(pkt_offset); -+ pkt_cnt--; -+ pbuf += pkt_offset; -+#endif -+ transfer_len -= pkt_offset; -+ precvframe = NULL; -+ -+ }while(transfer_len>0); -+ -+_exit_recvbuf2recvframe: -+ -+ return _SUCCESS; -+} -+ -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+void rtl8812au_recv_tasklet(void *priv) -+{ -+ struct recv_buf *precvbuf = NULL; -+ _adapter *padapter = (_adapter*)priv; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ while (NULL != (precvbuf = rtw_dequeue_recvbuf(&precvpriv->recv_buf_pending_queue))) -+ { -+ if ((padapter->bDriverStopped == true)||(padapter->bSurpriseRemoved== true)) -+ { -+ DBG_8192C("recv_tasklet => bDriverStopped or bSurpriseRemoved \n"); -+ -+ break; -+ } -+ -+ -+ recvbuf2recvframe(padapter, precvbuf); -+ -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ } -+ -+} -+ -+static void usb_read_port_complete(struct urb *purb, struct pt_regs *regs) -+{ -+ struct recv_buf *precvbuf = (struct recv_buf *)purb->context; -+ _adapter *padapter =(_adapter *)precvbuf->adapter; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete!!!\n")); -+ -+ precvpriv->rx_pending_cnt --; -+ -+ if(padapter->bSurpriseRemoved || padapter->bDriverStopped||padapter->bReadPortCancel) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bDriverStopped(%d) OR bSurpriseRemoved(%d)\n", padapter->bDriverStopped, padapter->bSurpriseRemoved)); -+ -+ goto exit; -+ } -+ -+ if(purb->status==0)//SUCCESS -+ { -+ if ((purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE)) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete: (purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE)\n")); -+ -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ } -+ else -+ { -+ rtw_reset_continual_urb_error(adapter_to_dvobj(padapter)); -+ -+ precvbuf->transfer_len = purb->actual_length; -+ -+ //rtw_enqueue_rx_transfer_buffer(precvpriv, rx_transfer_buf); -+ rtw_enqueue_recvbuf(precvbuf, &precvpriv->recv_buf_pending_queue); -+ -+ tasklet_schedule(&precvpriv->recv_tasklet); -+ } -+ } -+ else -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete : purb->status(%d) != 0 \n", purb->status)); -+ -+ DBG_8192C("###=> usb_read_port_complete => urb status(%d)\n", purb->status); -+ -+ if(rtw_inc_and_chk_continual_urb_error(adapter_to_dvobj(padapter)) == true ){ -+ padapter->bSurpriseRemoved = true; -+ } -+ -+ switch(purb->status) { -+ case -EINVAL: -+ case -EPIPE: -+ case -ENODEV: -+ case -ESHUTDOWN: -+ //padapter->bSurpriseRemoved=true; -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bSurpriseRemoved=true\n")); -+ case -ENOENT: -+ padapter->bDriverStopped=true; -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bDriverStopped=true\n")); -+ break; -+ case -EPROTO: -+ case -EILSEQ: -+ case -ETIME: -+ case -ECOMM: -+ case -EOVERFLOW: -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.Wifi_Error_Status = USB_READ_PORT_FAIL; -+ } -+ #endif -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ break; -+ case -EINPROGRESS: -+ DBG_8192C("ERROR: URB IS IN PROGRESS!/n"); -+ break; -+ default: -+ break; -+ } -+ -+ } -+ -+exit: -+ -+ -+ -+} -+ -+static u32 usb_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) -+{ -+ int err; -+ unsigned int pipe; -+ u32 ret = _SUCCESS; -+ PURB purb = NULL; -+ struct recv_buf *precvbuf = (struct recv_buf *)rmem; -+ _adapter *adapter = pintfhdl->padapter; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter); -+ struct recv_priv *precvpriv = &adapter->recvpriv; -+ struct usb_device *pusbd = pdvobj->pusbdev; -+ -+ -+ -+ if(adapter->bDriverStopped || adapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port:( padapter->bDriverStopped ||padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n")); -+ return _FAIL; -+ } -+ -+ if(precvbuf !=NULL) -+ { -+ rtl8812au_init_recvbuf(adapter, precvbuf); -+ -+ if(precvbuf->pbuf) -+ { -+ precvpriv->rx_pending_cnt++; -+ -+ purb = precvbuf->purb; -+ -+ //translate DMA FIFO addr to pipehandle -+ pipe = ffaddr2pipehdl(pdvobj, addr); -+ -+ usb_fill_bulk_urb(purb, pusbd, pipe, -+ precvbuf->pbuf, -+ MAX_RECVBUF_SZ, -+ usb_read_port_complete, -+ precvbuf);//context is precvbuf -+ -+ purb->transfer_dma = precvbuf->dma_transfer_addr; -+ purb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; -+ -+ err = usb_submit_urb(purb, GFP_ATOMIC); -+ if((err) && (err != (-EPERM))) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("cannot submit rx in-token(err=0x%.8x), URB_STATUS =0x%.8x", err, purb->status)); -+ DBG_8192C("cannot submit rx in-token(err = 0x%08x),urb_status = %d\n",err,purb->status); -+ ret = _FAIL; -+ } -+ -+ } -+ -+ } -+ else -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port:precvbuf ==NULL\n")); -+ ret = _FAIL; -+ } -+ -+ -+ -+ return ret; -+} -+#else // CONFIG_USE_USB_BUFFER_ALLOC_RX -+ -+void rtl8812au_recv_tasklet(void *priv) -+{ -+ _pkt *pskb; -+ _adapter *padapter = (_adapter*)priv; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ while (NULL != (pskb = skb_dequeue(&precvpriv->rx_skb_queue))) -+ { -+ if ((padapter->bDriverStopped == true)||(padapter->bSurpriseRemoved== true)) -+ { -+ DBG_8192C("recv_tasklet => bDriverStopped or bSurpriseRemoved \n"); -+ dev_kfree_skb_any(pskb); -+ break; -+ } -+ -+ recvbuf2recvframe(padapter, pskb); -+ -+#ifdef CONFIG_PREALLOC_RECV_SKB -+ -+ skb_reset_tail_pointer(pskb); -+ -+ pskb->len = 0; -+ -+ skb_queue_tail(&precvpriv->free_recv_skb_queue, pskb); -+ -+#else -+ dev_kfree_skb_any(pskb); -+#endif -+ -+ } -+ -+} -+ -+ -+static void usb_read_port_complete(struct urb *purb, struct pt_regs *regs) -+{ -+ _irqL irqL; -+ uint isevt, *pbuf; -+ struct recv_buf *precvbuf = (struct recv_buf *)purb->context; -+ _adapter *padapter =(_adapter *)precvbuf->adapter; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete!!!\n")); -+ -+ precvpriv->rx_pending_cnt --; -+ if(padapter->bSurpriseRemoved || padapter->bDriverStopped||padapter->bReadPortCancel) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bDriverStopped(%d) OR bSurpriseRemoved(%d)\n", padapter->bDriverStopped, padapter->bSurpriseRemoved)); -+ -+ #ifdef CONFIG_PREALLOC_RECV_SKB -+ precvbuf->reuse = true; -+ #else -+ if(precvbuf->pskb){ -+ DBG_8192C("==> free skb(%p)\n",precvbuf->pskb); -+ dev_kfree_skb_any(precvbuf->pskb); -+ } -+ #endif -+ DBG_8192C("%s() RX Warning! bDriverStopped(%d) OR bSurpriseRemoved(%d) bReadPortCancel(%d)\n", -+ __FUNCTION__,padapter->bDriverStopped, padapter->bSurpriseRemoved,padapter->bReadPortCancel); -+ return; -+ } -+ -+ if(purb->status==0)//SUCCESS -+ { -+ if ((purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE)) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete: (purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE)\n")); -+ precvbuf->reuse = true; -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ DBG_8192C("%s()-%d: RX Warning!\n", __FUNCTION__, __LINE__); -+ } -+ else -+ { -+ rtw_reset_continual_urb_error(adapter_to_dvobj(padapter)); -+ -+ precvbuf->transfer_len = purb->actual_length; -+ skb_put(precvbuf->pskb, purb->actual_length); -+ skb_queue_tail(&precvpriv->rx_skb_queue, precvbuf->pskb); -+ -+ if (skb_queue_len(&precvpriv->rx_skb_queue)<=1) -+ tasklet_schedule(&precvpriv->recv_tasklet); -+ -+ precvbuf->pskb = NULL; -+ precvbuf->reuse = false; -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ } -+ } -+ else -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete : purb->status(%d) != 0 \n", purb->status)); -+ -+ DBG_8192C("###=> usb_read_port_complete => urb status(%d)\n", purb->status); -+ -+ if(rtw_inc_and_chk_continual_urb_error(adapter_to_dvobj(padapter)) == true ){ -+ padapter->bSurpriseRemoved = true; -+ } -+ -+ switch(purb->status) { -+ case -EINVAL: -+ case -EPIPE: -+ case -ENODEV: -+ case -ESHUTDOWN: -+ //padapter->bSurpriseRemoved=true; -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bSurpriseRemoved=true\n")); -+ case -ENOENT: -+ padapter->bDriverStopped=true; -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete:bDriverStopped=true\n")); -+ break; -+ case -EPROTO: -+ case -EILSEQ: -+ case -ETIME: -+ case -ECOMM: -+ case -EOVERFLOW: -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.Wifi_Error_Status = USB_READ_PORT_FAIL; -+ } -+ #endif -+ precvbuf->reuse = true; -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ break; -+ case -EINPROGRESS: -+ DBG_8192C("ERROR: URB IS IN PROGRESS!/n"); -+ break; -+ default: -+ break; -+ } -+ -+ } -+} -+ -+static u32 usb_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) -+{ -+ _irqL irqL; -+ int err; -+ unsigned int pipe; -+ SIZE_PTR tmpaddr=0; -+ SIZE_PTR alignment=0; -+ u32 ret = _SUCCESS; -+ PURB purb = NULL; -+ struct recv_buf *precvbuf = (struct recv_buf *)rmem; -+ _adapter *adapter = pintfhdl->padapter; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter); -+ struct recv_priv *precvpriv = &adapter->recvpriv; -+ struct usb_device *pusbd = pdvobj->pusbdev; -+ -+ -+ -+ -+ if(adapter->bDriverStopped || adapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port:( padapter->bDriverStopped ||padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n")); -+ return _FAIL; -+ } -+ -+#ifdef CONFIG_PREALLOC_RECV_SKB -+ if((precvbuf->reuse == false) || (precvbuf->pskb == NULL)) -+ { -+ if (NULL != (precvbuf->pskb = skb_dequeue(&precvpriv->free_recv_skb_queue))) -+ { -+ precvbuf->reuse = true; -+ } -+ } -+#endif -+ -+ -+ if(precvbuf !=NULL) -+ { -+ rtl8812au_init_recvbuf(adapter, precvbuf); -+ -+ //re-assign for linux based on skb -+ if((precvbuf->reuse == false) || (precvbuf->pskb == NULL)) -+ { -+ //precvbuf->pskb = alloc_skb(MAX_RECVBUF_SZ, GFP_ATOMIC);//don't use this after v2.6.25 -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18)) // http://www.mail-archive.com/netdev@vger.kernel.org/msg17214.html -+ precvbuf->pskb = dev_alloc_skb(MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ); -+#else -+ precvbuf->pskb = netdev_alloc_skb(adapter->pnetdev, MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ); -+#endif -+ if(precvbuf->pskb == NULL) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("init_recvbuf(): alloc_skb fail!\n")); -+ DBG_8192C("#### usb_read_port() alloc_skb fail!#####\n"); -+ return _FAIL; -+ } -+ -+ tmpaddr = (SIZE_PTR)precvbuf->pskb->data; -+ alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1); -+ skb_reserve(precvbuf->pskb, (RECVBUFF_ALIGN_SZ - alignment)); -+ -+ precvbuf->phead = precvbuf->pskb->head; -+ precvbuf->pdata = precvbuf->pskb->data; -+ precvbuf->ptail = skb_tail_pointer(precvbuf->pskb); -+ precvbuf->pend = skb_end_pointer(precvbuf->pskb); -+ precvbuf->pbuf = precvbuf->pskb->data; -+ } -+ else//reuse skb -+ { -+ precvbuf->phead = precvbuf->pskb->head; -+ precvbuf->pdata = precvbuf->pskb->data; -+ precvbuf->ptail = skb_tail_pointer(precvbuf->pskb); -+ precvbuf->pend = skb_end_pointer(precvbuf->pskb); -+ precvbuf->pbuf = precvbuf->pskb->data; -+ -+ precvbuf->reuse = false; -+ } -+ -+ //_enter_critical(&precvpriv->lock, &irqL); -+ //precvpriv->rx_pending_cnt++; -+ //precvbuf->irp_pending = true; -+ //_exit_critical(&precvpriv->lock, &irqL); -+ -+ precvpriv->rx_pending_cnt++; -+ -+ purb = precvbuf->purb; -+ -+ //translate DMA FIFO addr to pipehandle -+ pipe = ffaddr2pipehdl(pdvobj, addr); -+ -+ usb_fill_bulk_urb(purb, pusbd, pipe, -+ precvbuf->pbuf, -+ MAX_RECVBUF_SZ, -+ usb_read_port_complete, -+ precvbuf);//context is precvbuf -+ -+ err = usb_submit_urb(purb, GFP_ATOMIC); -+ if((err) && (err != (-EPERM))) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("cannot submit rx in-token(err=0x%.8x), URB_STATUS =0x%.8x", err, purb->status)); -+ DBG_8192C("cannot submit rx in-token(err = 0x%08x),urb_status = %d\n",err,purb->status); -+ ret = _FAIL; -+ } -+ } -+ else -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port:precvbuf ==NULL\n")); -+ ret = _FAIL; -+ } -+ -+ -+ -+ return ret; -+} -+#endif // CONFIG_USE_USB_BUFFER_ALLOC_RX -+ -+void rtl8812au_xmit_tasklet(void *priv) -+{ -+ int ret = false; -+ _adapter *padapter = (_adapter*)priv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ if(check_fwstate(&padapter->mlmepriv, _FW_UNDER_SURVEY) == true) -+ return; -+ -+ while(1) -+ { -+ if ((padapter->bDriverStopped == true)||(padapter->bSurpriseRemoved== true) || (padapter->bWritePortCancel == true)) -+ { -+ DBG_8192C("xmit_tasklet => bDriverStopped or bSurpriseRemoved or bWritePortCancel\n"); -+ break; -+ } -+ -+ ret = rtl8812au_xmitframe_complete(padapter, pxmitpriv, NULL); -+ -+ if(ret==false) -+ break; -+ -+ } -+ -+} -+ -+void rtl8812au_set_intf_ops(struct _io_ops *pops) -+{ -+ -+ -+ _rtw_memset((u8 *)pops, 0, sizeof(struct _io_ops)); -+ -+ pops->_read8 = &usb_read8; -+ pops->_read16 = &usb_read16; -+ pops->_read32 = &usb_read32; -+ pops->_read_mem = &usb_read_mem; -+ pops->_read_port = &usb_read_port; -+ -+ pops->_write8 = &usb_write8; -+ pops->_write16 = &usb_write16; -+ pops->_write32 = &usb_write32; -+ pops->_writeN = &usb_writeN; -+ -+#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ -+ pops->_write8_async= &usb_async_write8; -+ pops->_write16_async = &usb_async_write16; -+ pops->_write32_async = &usb_async_write32; -+#endif -+ pops->_write_mem = &usb_write_mem; -+ pops->_write_port = &usb_write_port; -+ -+ pops->_read_port_cancel = &usb_read_port_cancel; -+ pops->_write_port_cancel = &usb_write_port_cancel; -+ -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+ pops->_read_interrupt = &usb_read_interrupt; -+#endif -+ -+ -+ -+} -+ -+void rtl8812au_set_hw_type(_adapter *padapter) -+{ -+ if(padapter->chip_type == RTL8812) -+ { -+ padapter->HardwareType = HARDWARE_TYPE_RTL8812AU; -+ DBG_871X("CHIP TYPE: RTL8812\n"); -+ } -+ else if(padapter->chip_type == RTL8821) -+ { -+ //padapter->HardwareType = HARDWARE_TYPE_RTL8811AU; -+ padapter->HardwareType = HARDWARE_TYPE_RTL8821U; -+ DBG_871X("CHIP TYPE: RTL8811AU or RTL8821U\n"); -+ } -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/autoconf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/autoconf.h ---- linux-4.14.17/3rdparty/rtl8812au/include/autoconf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/autoconf.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,196 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+//***** temporarily flag ******* -+#define CONFIG_SINGLE_IMG -+#define CONFIG_ODM_REFRESH_RAMASK -+#define CONFIG_PHY_SETTING_WITH_ODM -+//for FPGA VERIFICATION config -+#define RTL8188E_FPGAtrue_PHY_VERIFICATION 0 -+ -+//***** temporarily flag ******* -+/* -+ * Public General Config -+ */ -+#define AUTOCONF_INCLUDED -+#define RTL871X_MODULE_NAME "8812AU" -+#define DRV_NAME "rtl8812au" -+ -+#define PLATFORM_LINUX 1 -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ #define CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER -+ #define CONFIG_SET_SCAN_DENY_TIMER -+#endif -+ -+/* -+ * Internal General Config -+ */ -+ -+#define CONFIG_EMBEDDED_FWIMG 1 -+ -+#define CONFIG_80211N_HT 1 -+ -+#ifdef CONFIG_80211N_HT -+ #define CONFIG_80211AC_VHT 1 -+#endif -+ -+#define CONFIG_RECV_REORDERING_CTRL 1 -+ -+#define CONFIG_DFS 1 -+ -+#define CONFIG_IPS 1 -+ -+#define CONFIG_LPS 1 -+ -+#ifdef CONFIG_LPS_LCLK -+#define CONFIG_XMIT_THREAD_MODE -+#endif -+ -+//after link -+#ifdef CONFIG_ANTENNA_DIVERSITY -+#define CONFIG_HW_ANTENNA_DIVERSITY -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ #define CONFIG_TSF_RESET_OFFLOAD 1 // For 2 PORT TSF SYNC. -+#endif -+ -+#define CONFIG_AP_MODE 1 -+#ifdef CONFIG_AP_MODE -+ #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_INTERRUPT_BASED_TXBCN) -+ #undef CONFIG_INTERRUPT_BASED_TXBCN -+ #endif -+ #ifdef CONFIG_INTERRUPT_BASED_TXBCN -+ #define CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR -+ #endif -+ -+ #define CONFIG_NATIVEAP_MLME -+ #ifndef CONFIG_NATIVEAP_MLME -+ #define CONFIG_HOSTAPD_MLME 1 -+ #endif -+ #define CONFIG_FIND_BEST_CHANNEL 1 -+#endif -+ -+#define CONFIG_P2P 1 -+#ifdef CONFIG_P2P -+ //The CONFIG_WFD is for supporting the Wi-Fi display -+ #define CONFIG_WFD -+ -+ #ifndef CONFIG_WIFI_TEST -+ #define CONFIG_P2P_REMOVE_GROUP_INFO -+ #endif -+ -+ #define CONFIG_P2P_PS -+#endif -+ -+#define CONFIG_SKB_COPY 1//for amsdu -+ -+#define CONFIG_LED -+#ifdef CONFIG_LED -+ #define CONFIG_SW_LED -+#endif // CONFIG_LED -+ -+#ifdef CONFIG_IOL -+ #define CONFIG_IOL_READ_EFUSE_MAP -+ #define CONFIG_IOL_LLT -+#endif -+ -+#define USB_INTERFERENCE_ISSUE // this should be checked in all usb interface -+#define CONFIG_GLOBAL_UI_PID -+ -+#define CONFIG_LAYER2_ROAMING -+#define CONFIG_LAYER2_ROAMING_RESUME -+#define CONFIG_LONG_DELAY_ISSUE -+#define CONFIG_NEW_SIGNAL_STAT_PROCESS -+#define RTW_NOTCH_FILTER 0 /* 0:Disable, 1:Enable, */ -+ -+#define CONFIG_BR_EXT 1 // Enable NAT2.5 support for STA mode interface with a L2 Bridge -+#ifdef CONFIG_BR_EXT -+#define CONFIG_BR_EXT_BRNAME "br0" -+#endif // CONFIG_BR_EXT -+ -+#define CONFIG_TX_MCAST2UNI 1 // Support IP multicast->unicast -+ -+/* -+ * Interface Related Config -+ */ -+ -+#ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #define CONFIG_USB_TX_AGGREGATION 1 -+ #define CONFIG_USB_RX_AGGREGATION 1 -+#endif -+ -+#define CONFIG_PREALLOC_RECV_SKB 1 -+ -+/* -+ * CONFIG_USE_USB_BUFFER_ALLOC_XX uses Linux USB Buffer alloc API and is for Linux platform only now! -+ */ -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+#undef CONFIG_PREALLOC_RECV_SKB -+#endif -+ -+/* -+ * USB VENDOR REQ BUFFER ALLOCATION METHOD -+ * if not set we'll use function local variable (stack memory) -+ */ -+#define CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC -+ -+#define CONFIG_USB_VENDOR_REQ_MUTEX -+#define CONFIG_VENDOR_REQ_RETRY -+ -+/* -+ * HAL Related Config -+ */ -+#define RTL8812A_RX_PACKET_INCLUDE_CRC 0 -+ -+#define CONFIG_OUT_EP_WIFI_MODE 0 -+ -+#define ENABLE_USB_DROP_INCORRECT_OUT 0 -+ -+#define RTL8192CU_ADHOC_WORKAROUND_SETTING 1 -+ -+#define ENABLE_NEW_RFE_TYPE 0 -+ -+#define DISABLE_BB_RF 0 -+ -+#ifdef CONFIG_MP_INCLUDED -+ #define MP_DRIVER 1 -+ #define CONFIG_MP_IWPRIV_SUPPORT 1 -+#else -+ #define MP_DRIVER 0 -+#endif -+ -+/* -+ * Outsource Related Config -+ */ -+ -+#define TEST_CHIP_SUPPORT 0 -+ -+#define RTL8723_FPGA_VERIFICATION 0 -+ -+#define RATE_ADAPTIVE_SUPPORT 0 -+#define POWER_TRAINING_ACTIVE 0 -+ -+#define RTL8188E_EARLY_MODE_PKT_NUM_10 0 -+ -+#define CONFIG_80211D -+ -+#define CONFIG_ATTEMPT_TO_FIX_AP_BEACON_ERROR -+ -+/* -+ * Debug Related Config -+ */ -+#define DBG 0 -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/basic_types.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/basic_types.h ---- linux-4.14.17/3rdparty/rtl8812au/include/basic_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/basic_types.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,205 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __BASIC_TYPES_H__ -+#define __BASIC_TYPES_H__ -+ -+ -+#define SUCCESS 0 -+#define FAIL (-1) -+ -+ #include -+ -+ typedef signed int sint; -+ -+ typedef void (*proc_t)(void*); -+ -+ typedef __kernel_size_t SIZE_T; -+ typedef __kernel_ssize_t SSIZE_T; -+ #define FIELD_OFFSET(s,field) ((SSIZE_T)&((s*)(0))->field) -+ -+#define MEM_ALIGNMENT_OFFSET (sizeof (SIZE_T)) -+#define MEM_ALIGNMENT_PADDING (sizeof(SIZE_T) - 1) -+ -+#define SIZE_PTR SIZE_T -+#define SSIZE_PTR SSIZE_T -+ -+//port from fw by thomas -+// TODO: Belows are Sync from SD7-Driver. It is necessary to check correctness -+ -+/* -+ * Call endian free function when -+ * 1. Read/write packet content. -+ * 2. Before write integer to IO. -+ * 3. After read integer from IO. -+*/ -+ -+// -+// Read LE format data from memory -+// -+#define Read(_ptr) (*((u8 *)(_ptr))) -+#define Readle16_to_cpu(_ptr) le16_to_cpu(*((__le16 *)(_ptr))) -+#define Readle32_to_cpu(_ptr) le32_to_cpu(*((__le32 *)(_ptr))) -+ -+// -+// Write LE data to memory -+// -+#define Write(_ptr, _val) (*((u8 *)(_ptr)))=(_val) -+#define Writele16_to_cpu(_ptr, _val) (*((u16 *)(_ptr)))=le16_to_cpu(_val) -+#define Writele32_to_cpu(_ptr, _val) (*((u32 *)(_ptr)))=le32_to_cpu(_val) -+ -+// -+// Example: -+// BIT_LEN_MASK_32(0) => 0x00000000 -+// BIT_LEN_MASK_32(1) => 0x00000001 -+// BIT_LEN_MASK_32(2) => 0x00000003 -+// BIT_LEN_MASK_32(32) => 0xFFFFFFFF -+// -+#define BIT_LEN_MASK_32(__BitLen) \ -+ (0xFFFFFFFF >> (32 - (__BitLen))) -+// -+// Example: -+// BIT_OFFSET_LEN_MASK_32(0, 2) => 0x00000003 -+// BIT_OFFSET_LEN_MASK_32(16, 2) => 0x00030000 -+// -+#define BIT_OFFSET_LEN_MASK_32(__BitOffset, __BitLen) \ -+ (BIT_LEN_MASK_32(__BitLen) << (__BitOffset)) -+ -+// -+// Description: -+// Return 4-byte value in host byte ordering from -+// 4-byte pointer in litten-endian system. -+// -+#define LE_P4BYTE_TO_HOST_4BYTE(__pStart) \ -+ (le32_to_cpu(*((__le32 *)(__pStart)))) -+ -+// -+// Description: -+// Translate subfield (continuous bits in little-endian) of 4-byte value in litten byte to -+// 4-byte value in host byte ordering. -+// -+#define LE_BITS_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ -+ ( \ -+ ( LE_P4BYTE_TO_HOST_4BYTE(__pStart) >> (__BitOffset) ) \ -+ & \ -+ BIT_LEN_MASK_32(__BitLen) \ -+ ) -+ -+// -+// Description: -+// Mask subfield (continuous bits in little-endian) of 4-byte value in litten byte oredering -+// and return the result in 4-byte value in host byte ordering. -+// -+#define LE_BITS_CLEARED_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ -+ ( \ -+ LE_P4BYTE_TO_HOST_4BYTE(__pStart) \ -+ & \ -+ ( ~BIT_OFFSET_LEN_MASK_32(__BitOffset, __BitLen) ) \ -+ ) -+ -+// -+// Description: -+// Set subfield of little-endian 4-byte value to specified value. -+// -+#define SET_BITS_TO_LE_4BYTE(__pStart, __BitOffset, __BitLen, __Value) \ -+ *((__le32 *)(__pStart)) = \ -+ cpu_to_le32( \ -+ LE_BITS_CLEARED_TO_4BYTE(__pStart, __BitOffset, __BitLen) \ -+ | \ -+ ( (((u32)__Value) & BIT_LEN_MASK_32(__BitLen)) << (__BitOffset) ) \ -+ ); -+ -+ -+#define BIT_LEN_MASK_16(__BitLen) \ -+ (0xFFFF >> (16 - (__BitLen))) -+ -+#define BIT_OFFSET_LEN_MASK_16(__BitOffset, __BitLen) \ -+ (BIT_LEN_MASK_16(__BitLen) << (__BitOffset)) -+ -+#define LE_P2BYTE_TO_HOST_2BYTE(__pStart) \ -+ (le16_to_cpu(*((__le16 *)(__pStart)))) -+ -+#define LE_BITS_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ -+ ( \ -+ ( LE_P2BYTE_TO_HOST_2BYTE(__pStart) >> (__BitOffset) ) \ -+ & \ -+ BIT_LEN_MASK_16(__BitLen) \ -+ ) -+ -+#define LE_BITS_CLEARED_TO_2BYTE(__pStart, __BitOffset, __BitLen) \ -+ ( \ -+ LE_P2BYTE_TO_HOST_2BYTE(__pStart) \ -+ & \ -+ ( ~BIT_OFFSET_LEN_MASK_16(__BitOffset, __BitLen) ) \ -+ ) -+ -+#define SET_BITS_TO_LE_2BYTE(__pstart, __bitoffset, __bitlen, __val) \ -+ *((__le16 *)(__pstart)) = \ -+ cpu_to_le16( \ -+ LE_BITS_CLEARED_TO_2BYTE(__pstart, __bitoffset, __bitlen) | \ -+ ((((u16)__val) & BIT_LEN_MASK_16(__bitlen)) << (__bitoffset)) \ -+ ); -+ -+#define BIT_LEN_MASK_8(__BitLen) \ -+ (0xFF >> (8 - (__BitLen))) -+ -+#define BIT_OFFSET_LEN_MASK_8(__BitOffset, __BitLen) \ -+ (BIT_LEN_MASK_8(__BitLen) << (__BitOffset)) -+ -+#define LE_P1BYTE_TO_HOST_1BYTE(__pStart) \ -+ ((*((u8 *)(__pStart)))) -+ -+#define LE_BITS_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ -+ ( \ -+ ( LE_P1BYTE_TO_HOST_1BYTE(__pStart) >> (__BitOffset) ) \ -+ & \ -+ BIT_LEN_MASK_8(__BitLen) \ -+ ) -+ -+#define LE_BITS_CLEARED_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ -+ ( \ -+ LE_P1BYTE_TO_HOST_1BYTE(__pStart) \ -+ & \ -+ ( ~BIT_OFFSET_LEN_MASK_8(__BitOffset, __BitLen) ) \ -+ ) -+ -+#define SET_BITS_TO_LE_1BYTE(__pStart, __BitOffset, __BitLen, __Value) \ -+ *((u8 *)(__pStart)) = \ -+ ( \ -+ LE_BITS_CLEARED_TO_1BYTE(__pStart, __BitOffset, __BitLen) \ -+ | \ -+ ( (((u8)__Value) & BIT_LEN_MASK_8(__BitLen)) << (__BitOffset) ) \ -+ ); -+ -+//pclint -+#define LE_BITS_CLEARED_TO_1BYTE_8BIT(__pStart, __BitOffset, __BitLen) \ -+ ( \ -+ LE_P1BYTE_TO_HOST_1BYTE(__pStart) \ -+ ) -+ -+//pclint -+#define SET_BITS_TO_LE_1BYTE_8BIT(__pStart, __BitOffset, __BitLen, __Value) \ -+{ \ -+ *((pu1Byte)(__pStart)) = \ -+ ( \ -+ LE_BITS_CLEARED_TO_1BYTE_8BIT(__pStart, __BitOffset, __BitLen) \ -+ | \ -+ ((u1Byte)__Value) \ -+ ); \ -+} -+ -+// Get the N-bytes aligment offset from the current length -+#define N_BYTE_ALIGMENT(__Value, __Aligment) ((__Aligment == 1) ? (__Value) : (((__Value + __Aligment - 1) / __Aligment) * __Aligment)) -+ -+#endif //__BASIC_TYPES_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/circ_buf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/circ_buf.h ---- linux-4.14.17/3rdparty/rtl8812au/include/circ_buf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/circ_buf.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,22 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __CIRC_BUF_H_ -+#define __CIRC_BUF_H_ 1 -+ -+#define CIRC_CNT(head,tail,size) (((head) - (tail)) & ((size)-1)) -+ -+#define CIRC_SPACE(head,tail,size) CIRC_CNT((tail),((head)+1),(size)) -+ -+#endif //_CIRC_BUF_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/cmd_osdep.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/cmd_osdep.h ---- linux-4.14.17/3rdparty/rtl8812au/include/cmd_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/cmd_osdep.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __CMD_OSDEP_H_ -+#define __CMD_OSDEP_H_ -+ -+ -+extern sint _rtw_init_cmd_priv (struct cmd_priv *pcmdpriv); -+extern sint _rtw_init_evt_priv(struct evt_priv *pevtpriv); -+extern void _rtw_free_evt_priv (struct evt_priv *pevtpriv); -+extern void _rtw_free_cmd_priv (struct cmd_priv *pcmdpriv); -+extern sint _rtw_enqueue_cmd(_queue *queue, struct cmd_obj *obj); -+extern struct cmd_obj *_rtw_dequeue_cmd(_queue *queue); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/custom_gpio.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/custom_gpio.h ---- linux-4.14.17/3rdparty/rtl8812au/include/custom_gpio.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/custom_gpio.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,22 @@ -+#ifndef __CUSTOM_GPIO_H__ -+#define __CUSTOM_GPIO_H___ -+ -+#include -+#include -+ -+#include -+ -+typedef enum cust_gpio_modes { -+ WLAN_PWDN_ON, -+ WLAN_PWDN_OFF, -+ WLAN_POWER_ON, -+ WLAN_POWER_OFF, -+ WLAN_BT_PWDN_ON, -+ WLAN_BT_PWDN_OFF -+} cust_gpio_modes_t; -+ -+extern int rtw_wifi_gpio_init(void); -+extern int rtw_wifi_gpio_deinit(void); -+extern void rtw_wifi_gpio_wlan_ctrl(int onoff); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/drv_conf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/drv_conf.h ---- linux-4.14.17/3rdparty/rtl8812au/include/drv_conf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/drv_conf.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,49 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __DRV_CONF_H__ -+#define __DRV_CONF_H__ -+#include "autoconf.h" -+ -+#if defined(CONFIG_HAS_EARLYSUSPEND) && defined (CONFIG_RESUME_IN_WORKQUEUE) -+ #warning "You have CONFIG_HAS_EARLYSUSPEND enabled in your system, we disable CONFIG_RESUME_IN_WORKQUEUE automatically" -+ #undef CONFIG_RESUME_IN_WORKQUEUE -+#endif -+ -+#if defined(CONFIG_ANDROID_POWER) && defined (CONFIG_RESUME_IN_WORKQUEUE) -+ #warning "You have CONFIG_ANDROID_POWER enabled in your system, we disable CONFIG_RESUME_IN_WORKQUEUE automatically" -+ #undef CONFIG_RESUME_IN_WORKQUEUE -+#endif -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE //this can be removed, because there is no case for this... -+ #if !defined( CONFIG_WAKELOCK) && !defined(CONFIG_ANDROID_POWER) -+ #error "enable CONFIG_RESUME_IN_WORKQUEUE without CONFIG_WAKELOCK or CONFIG_ANDROID_POWER will suffer from the danger of wifi's unfunctionality..." -+ #error "If you still want to enable CONFIG_RESUME_IN_WORKQUEUE in this case, mask this preprossor checking and GOOD LUCK..." -+ #endif -+#endif -+ -+//About USB VENDOR REQ -+#if defined(CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC) && !defined(CONFIG_USB_VENDOR_REQ_MUTEX) -+ #warning "define CONFIG_USB_VENDOR_REQ_MUTEX for CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC automatically" -+ #define CONFIG_USB_VENDOR_REQ_MUTEX -+#endif -+#if defined(CONFIG_VENDOR_REQ_RETRY) && !defined(CONFIG_USB_VENDOR_REQ_MUTEX) -+ #warning "define CONFIG_USB_VENDOR_REQ_MUTEX for CONFIG_VENDOR_REQ_RETRY automatically" -+ #define CONFIG_USB_VENDOR_REQ_MUTEX -+#endif -+ -+ -+//#include -+ -+#endif // __DRV_CONF_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/drv_types.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/drv_types.h ---- linux-4.14.17/3rdparty/rtl8812au/include/drv_types.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/drv_types.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,653 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/*------------------------------------------------------------------------------- -+ -+ For type defines and data structure defines -+ -+--------------------------------------------------------------------------------*/ -+ -+ -+#ifndef __DRV_TYPES_H__ -+#define __DRV_TYPES_H__ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+ -+enum _NIC_VERSION { -+ RTL8711_NIC, -+ RTL8712_NIC, -+ RTL8713_NIC, -+ RTL8716_NIC -+}; -+ -+typedef struct _ADAPTER _adapter, ADAPTER,*PADAPTER; -+ -+#include -+ -+#ifdef CONFIG_80211N_HT -+#include -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+#include -+#endif -+ -+#ifdef CONFIG_INTEL_WIDI -+#include -+#endif -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#ifdef CONFIG_P2P -+#include -+#endif // CONFIG_P2P -+ -+#ifdef CONFIG_TDLS -+#include -+#endif // CONFIG_TDLS -+ -+#ifdef CONFIG_WAPI_SUPPORT -+#include -+#endif // CONFIG_WAPI_SUPPORT -+ -+#ifdef CONFIG_DRVEXT_MODULE -+#include -+#endif // CONFIG_DRVEXT_MODULE -+ -+#ifdef CONFIG_MP_INCLUDED -+#include -+#endif // CONFIG_MP_INCLUDED -+ -+#ifdef CONFIG_BR_EXT -+#include -+#endif // CONFIG_BR_EXT -+ -+#ifdef CONFIG_IOL -+#include -+#endif // CONFIG_IOL -+ -+#ifdef CONFIG_BT_COEXIST -+#include -+#endif // CONFIG_BT_COEXIST -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+#include "ioctl_cfg80211.h" -+#endif //CONFIG_IOCTL_CFG80211 -+ -+#include -+#include -+#include -+#include -+ -+#include -+ -+#define SPEC_DEV_ID_NONE BIT(0) -+#define SPEC_DEV_ID_DISABLE_HT BIT(1) -+#define SPEC_DEV_ID_ENABLE_PS BIT(2) -+#define SPEC_DEV_ID_RF_CONFIG_1T1R BIT(3) -+#define SPEC_DEV_ID_RF_CONFIG_2T2R BIT(4) -+#define SPEC_DEV_ID_ASSIGN_IFNAME BIT(5) -+ -+struct specific_device_id{ -+ -+ u32 flags; -+ -+ u16 idVendor; -+ u16 idProduct; -+ -+}; -+ -+struct registry_priv -+{ -+ u8 chip_version; -+ u8 rfintfs; -+ u8 lbkmode; -+ u8 hci; -+ NDIS_802_11_SSID ssid; -+ u8 network_mode; //infra, ad-hoc, auto -+ u8 channel;//ad-hoc support requirement -+ u8 wireless_mode;//A, B, G, auto -+ u8 scan_mode;//active, passive -+ u8 radio_enable; -+ u8 preamble;//long, short, auto -+ u8 vrtl_carrier_sense;//Enable, Disable, Auto -+ u8 vcs_type;//RTS/CTS, CTS-to-self -+ u16 rts_thresh; -+ u16 frag_thresh; -+ u8 adhoc_tx_pwr; -+ u8 soft_ap; -+ u8 power_mgnt; -+ u8 ips_mode; -+ u8 smart_ps; -+ u8 long_retry_lmt; -+ u8 short_retry_lmt; -+ u16 busy_thresh; -+ u8 ack_policy; -+ u8 mp_mode; -+ u8 software_encrypt; -+ u8 software_decrypt; -+ #ifdef CONFIG_TX_EARLY_MODE -+ u8 early_mode; -+ #endif -+ u8 acm_method; -+ //UAPSD -+ u8 wmm_enable; -+ u8 uapsd_enable; -+ u8 uapsd_max_sp; -+ u8 uapsd_acbk_en; -+ u8 uapsd_acbe_en; -+ u8 uapsd_acvi_en; -+ u8 uapsd_acvo_en; -+ -+ WLAN_BSSID_EX dev_network; -+ -+#ifdef CONFIG_80211N_HT -+ u8 ht_enable; -+ // 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz -+ // 2.4G use bit 0 ~ 3, 5G use bit 4 ~ 7 -+ // 0x21 means enable 2.4G 40MHz & 5G 80MHz -+ u8 bw_mode; -+ u8 ampdu_enable;//for tx -+ u8 rx_stbc; -+ u8 ampdu_amsdu;//A-MPDU Supports A-MSDU is permitted -+ // Short GI support Bit Map -+ // BIT0 - 20MHz, 1: support, 0: non-support -+ // BIT1 - 40MHz, 1: support, 0: non-support -+ // BIT2 - 80MHz, 1: support, 0: non-support -+ // BIT3 - 160MHz, 1: support, 0: non-support -+ u8 short_gi; -+#endif //CONFIG_80211N_HT -+ -+#ifdef CONFIG_80211AC_VHT -+ u8 vht_enable; -+ u8 ampdu_factor; -+ u8 vht_rate_sel; -+ // BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx -+ u8 ldpc_cap; -+ // BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx -+ u8 stbc_cap; -+ // BIT0: Enable VHT Beamformer, BIT1: Enable VHT Beamformee, BIT4: Enable HT Beamformer, BIT5: Enable HT Beamformee -+ u8 beamform_cap; -+#endif //CONFIG_80211AC_VHT -+ -+ u8 lowrate_two_xmit; -+ -+ u8 rf_config ; -+ u8 low_power ; -+ -+ u8 wifi_spec;// !turbo_mode -+ -+ u8 channel_plan; -+#ifdef CONFIG_BT_COEXIST -+ u8 btcoex; -+ u8 bt_iso; -+ u8 bt_sco; -+ u8 bt_ampdu; -+#endif -+ bool bAcceptAddbaReq; -+ -+ u8 antdiv_cfg; -+ u8 antdiv_type; -+ -+ u8 usbss_enable;//0:disable,1:enable -+ u8 hwpdn_mode;//0:disable,1:enable,2:decide by EFUSE config -+ u8 hwpwrp_detect;//0:disable,1:enable -+ -+ u8 hw_wps_pbc;//0:disable,1:enable -+ -+#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+ char adaptor_info_caching_file_path[PATH_LENGTH_MAX]; -+#endif -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ u8 max_roaming_times; // the max number driver will try to roaming -+#endif -+ -+#ifdef CONFIG_IOL -+ u8 fw_iol; //enable iol without other concern -+#endif -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ u8 dmsp;//0:disable,1:enable -+#endif -+ -+#ifdef CONFIG_80211D -+ u8 enable80211d; -+#endif -+ -+ u8 ifname[16]; -+ u8 if2name[16]; -+ -+ u8 notch_filter; -+ -+#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+ u8 force_ant;//0 normal,1 main,2 aux -+ u8 force_igi;//0 normal -+#endif -+ u8 regulatory_tid; -+ -+ //define for tx power adjust -+ u32 RegTxPwrLimit; -+ u8 RegEnableTxPowerLimit; -+ u8 RegPowerBase; -+ u8 RegPwrTblSel; -+ u8 RegPwrByRate; -+ s8 TxBBSwing_2G; -+ s8 TxBBSwing_5G; -+ u8 AmplifierType_2G; -+ u8 AmplifierType_5G; -+ u8 bEn_RFE; -+ u8 RFE_Type; -+ -+#ifdef CONFIG_MULTI_VIR_IFACES -+ u8 ext_iface_num;//primary/secondary iface is excluded -+#endif -+}; -+ -+ -+//For registry parameters -+#define RGTRY_OFT(field) ((u32)FIELD_OFFSET(struct registry_priv,field)) -+#define RGTRY_SZ(field) sizeof(((struct registry_priv*) 0)->field) -+#define BSSID_OFT(field) ((u32)FIELD_OFFSET(WLAN_BSSID_EX,field)) -+#define BSSID_SZ(field) sizeof(((PWLAN_BSSID_EX) 0)->field) -+ -+#define MAX_CONTINUAL_URB_ERR 4 -+ -+#define GET_PRIMARY_ADAPTER(padapter) (((_adapter *)padapter)->dvobj->if1) -+#define GET_IFACE_NUMS(padapter) (((_adapter *)padapter)->dvobj->iface_nums) -+#define GET_ADAPTER(padapter, iface_id) (((_adapter *)padapter)->dvobj->padapters[iface_id]) -+ -+enum _IFACE_ID { -+ IFACE_ID0, //maping to PRIMARY_ADAPTER -+ IFACE_ID1, //maping to SECONDARY_ADAPTER -+ IFACE_ID2, -+ IFACE_ID3, -+ IFACE_ID_MAX, -+}; -+ -+struct dvobj_priv -+{ -+ _adapter *if1; //PRIMARY_ADAPTER -+ _adapter *if2; //SECONDARY_ADAPTER -+ -+ //for local/global synchronization -+ // -+ _lock lock; -+ int macid[NUM_STA]; -+ -+ _mutex hw_init_mutex; -+ _mutex h2c_fwcmd_mutex; -+ _mutex setch_mutex; -+ _mutex setbw_mutex; -+ -+ unsigned char oper_channel; //saved channel info when call set_channel_bw -+ unsigned char oper_bwmode; -+ unsigned char oper_ch_offset;//PRIME_CHNL_OFFSET -+ -+ //extend to support mulitu interface -+ //padapters[IFACE_ID0] == if1 -+ //padapters[IFACE_ID1] == if2 -+ _adapter *padapters[IFACE_ID_MAX]; -+ u8 iface_nums; // total number of ifaces used runtime -+ -+ -+ //For 92D, DMDP have 2 interface. -+ u8 InterfaceNumber; -+ u8 NumInterfaces; -+ -+ //In /Out Pipe information -+ int RtInPipe[2]; -+ int RtOutPipe[3]; -+ u8 Queue2Pipe[HW_QUEUE_ENTRY];//for out pipe mapping -+ -+ u8 irq_alloc; -+ -+/*-------- below is for SDIO INTERFACE --------*/ -+ -+#ifdef INTF_DATA -+ INTF_DATA intf_data; -+#endif -+ -+/*-------- below is for USB INTERFACE --------*/ -+ -+ u8 usb_speed; // 1.1, 2.0 or 3.0 -+ u8 nr_endpoint; -+ u8 RtNumInPipes; -+ u8 RtNumOutPipes; -+ int ep_num[6]; //endpoint number -+ -+ int RegUsbSS; -+ -+ _sema usb_suspend_sema; -+ -+#ifdef CONFIG_USB_VENDOR_REQ_MUTEX -+ _mutex usb_vendor_req_mutex; -+#endif -+ -+#ifdef CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC -+ u8 * usb_alloc_vendor_req_buf; -+ u8 * usb_vendor_req_buf; -+#endif -+ -+ struct usb_interface *pusbintf; -+ struct usb_device *pusbdev; -+ -+ ATOMIC_T continual_urb_error; -+}; -+ -+static struct device *dvobj_to_dev(struct dvobj_priv *dvobj) -+{ -+ /* todo: get interface type from dvobj and the return the dev accordingly */ -+ -+ return &dvobj->pusbintf->dev; -+} -+ -+enum _IFACE_TYPE { -+ IFACE_PORT0, //mapping to port0 for C/D series chips -+ IFACE_PORT1, //mapping to port1 for C/D series chip -+ MAX_IFACE_PORT, -+}; -+ -+enum _ADAPTER_TYPE { -+ PRIMARY_ADAPTER, -+ SECONDARY_ADAPTER, -+ MAX_ADAPTER = 0xFF, -+}; -+ -+typedef enum _DRIVER_STATE{ -+ DRIVER_NORMAL = 0, -+ DRIVER_DISAPPEAR = 1, -+ DRIVER_REPLACE_DONGLE = 2, -+}DRIVER_STATE; -+ -+#ifdef CONFIG_INTEL_PROXIM -+struct proxim { -+ bool proxim_support; -+ bool proxim_on; -+ -+ void *proximity_priv; -+ int (*proxim_rx)(_adapter *padapter, -+ union recv_frame *precv_frame); -+ u8 (*proxim_get_var)(_adapter* padapter, u8 type); -+}; -+#endif //CONFIG_INTEL_PROXIM -+ -+#ifdef CONFIG_MAC_LOOPBACK_DRIVER -+typedef struct loopbackdata -+{ -+ _sema sema; -+ _thread_hdl_ lbkthread; -+ u8 bstop; -+ u32 cnt; -+ u16 size; -+ u16 txsize; -+ u8 txbuf[0x8000]; -+ u16 rxsize; -+ u8 rxbuf[0x8000]; -+ u8 msg[100]; -+ -+}LOOPBACKDATA, *PLOOPBACKDATA; -+#endif -+ -+struct _ADAPTER{ -+ int DriverState;// for disable driver using module, use dongle to replace module. -+ int pid[3];//process id from UI, 0:wps, 1:hostapd, 2:dhcpcd -+ int bDongle;//build-in module or external dongle -+ u16 chip_type; -+ u16 HardwareType; -+ u16 interface_type;//USB,SDIO,SPI,PCI -+ -+ struct dvobj_priv *dvobj; -+ struct mlme_priv mlmepriv; -+ struct mlme_ext_priv mlmeextpriv; -+ struct cmd_priv cmdpriv; -+ struct evt_priv evtpriv; -+ //struct io_queue *pio_queue; -+ struct io_priv iopriv; -+ struct xmit_priv xmitpriv; -+ struct recv_priv recvpriv; -+ struct sta_priv stapriv; -+ struct security_priv securitypriv; -+ struct registry_priv registrypriv; -+ struct pwrctrl_priv pwrctrlpriv; -+ struct eeprom_priv eeprompriv; -+ struct led_priv ledpriv; -+ -+#ifdef CONFIG_MP_INCLUDED -+ struct mp_priv mppriv; -+#endif -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ struct drvext_priv drvextpriv; -+#endif -+ -+#ifdef CONFIG_AP_MODE -+ struct hostapd_priv *phostapdpriv; -+#endif -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+#ifdef CONFIG_P2P -+ struct cfg80211_wifidirect_info cfg80211_wdinfo; -+#endif //CONFIG_P2P -+#endif //CONFIG_IOCTL_CFG80211 -+ u32 setband; -+#ifdef CONFIG_P2P -+ struct wifidirect_info wdinfo; -+#endif //CONFIG_P2P -+ -+#ifdef CONFIG_TDLS -+ struct tdls_info tdlsinfo; -+#endif //CONFIG_TDLS -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ u8 WapiSupport; -+ RT_WAPI_T wapiInfo; -+#endif -+ -+ -+#ifdef CONFIG_WFD -+ struct wifi_display_info wfd_info; -+#endif //CONFIG_WFD -+ -+ void * HalData; -+ u32 hal_data_sz; -+ struct hal_ops HalFunc; -+ -+ s32 bDriverStopped; -+ s32 bSurpriseRemoved; -+ s32 bCardDisableWOHSM; -+ -+ u32 IsrContent; -+ u32 ImrContent; -+ -+ u8 EepromAddressSize; -+ u8 hw_init_completed; -+ u8 bDriverIsGoingToUnload; -+ u8 init_adpt_in_progress; -+ u8 bHaltInProgress; -+ -+ _thread_hdl_ cmdThread; -+ _thread_hdl_ evtThread; -+ _thread_hdl_ xmitThread; -+ _thread_hdl_ recvThread; -+ -+ void (*intf_start)(_adapter * adapter); -+ void (*intf_stop)(_adapter * adapter); -+ -+ _nic_hdl pnetdev; -+ -+ // used by rtw_rereg_nd_name related function -+ struct rereg_nd_name_data { -+ _nic_hdl old_pnetdev; -+ char old_ifname[IFNAMSIZ]; -+ u8 old_ips_mode; -+ u8 old_bRegUseLed; -+ } rereg_nd_name_priv; -+ -+ int bup; -+ struct net_device_stats stats; -+ struct iw_statistics iwstats; -+ struct proc_dir_entry *dir_dev;// for proc directory -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ struct wireless_dev *rtw_wdev; -+#endif //CONFIG_IOCTL_CFG80211 -+ int net_closed; -+ -+ u8 bFWReady; -+ u8 bBTFWReady; -+ u8 bReadPortCancel; -+ u8 bWritePortCancel; -+ u8 bLinkInfoDump; -+ // Added by Albert 2012/10/26 -+ // The driver will show up the desired channel number when this flag is 1. -+ u8 bNotifyChannelChange; -+#ifdef CONFIG_P2P -+ // Added by Albert 2012/12/06 -+ // The driver will show the current P2P status when the upper application reads it. -+ u8 bShowGetP2PState; -+#endif -+#ifdef CONFIG_AUTOSUSPEND -+ u8 bDisableAutosuspend; -+#endif -+ -+ //pbuddy_adapter is used only in two inteface case, (iface_nums=2 in struct dvobj_priv) -+ //PRIMARY_ADAPTER's buddy is SECONDARY_ADAPTER -+ //SECONDARY_ADAPTER's buddy is PRIMARY_ADAPTER -+ //for iface_id > SECONDARY_ADAPTER(IFACE_ID1), refer to padapters[iface_id] in struct dvobj_priv -+ //and their pbuddy_adapter is PRIMARY_ADAPTER. -+ //for PRIMARY_ADAPTER(IFACE_ID0) can directly refer to if1 in struct dvobj_priv -+ _adapter *pbuddy_adapter; -+ -+#if defined(CONFIG_CONCURRENT_MODE) || defined(CONFIG_DUALMAC_CONCURRENT) -+ u8 isprimary; //is primary adapter or not -+ //notes: -+ // if isprimary is true, the adapter_type value is 0, iface_id is IFACE_ID0 for PRIMARY_ADAPTER -+ // if isprimary is false, the adapter_type value is 1, iface_id is IFACE_ID1 for SECONDARY_ADAPTER -+ // refer to iface_id if iface_nums>2 and isprimary is false and the adapter_type value is 0xff. -+ u8 adapter_type;//used only in two inteface case(PRIMARY_ADAPTER and SECONDARY_ADAPTER) . -+ u8 iface_type; //interface port type, it depends on HW port -+#endif //CONFIG_CONCURRENT_MODE || CONFIG_DUALMAC_CONCURRENT -+ -+ //extend to support multi interface -+ //IFACE_ID0 is equals to PRIMARY_ADAPTER -+ //IFACE_ID1 is equals to SECONDARY_ADAPTER -+ u8 iface_id; -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ u8 DualMacConcurrent; // 1: DMSP 0:DMDP -+#endif -+ -+#ifdef CONFIG_BR_EXT -+ _lock br_ext_lock; -+ //unsigned int macclone_completed; -+ struct nat25_network_db_entry *nethash[NAT25_HASH_SIZE]; -+ int pppoe_connection_in_progress; -+ unsigned char pppoe_addr[MACADDRLEN]; -+ unsigned char scdb_mac[MACADDRLEN]; -+ unsigned char scdb_ip[4]; -+ struct nat25_network_db_entry *scdb_entry; -+ unsigned char br_mac[MACADDRLEN]; -+ unsigned char br_ip[4]; -+ -+ struct br_ext_info ethBrExtInfo; -+#endif // CONFIG_BR_EXT -+ -+#ifdef CONFIG_INTEL_PROXIM -+ /* intel Proximity, should be alloc mem -+ * in intel Proximity module and can only -+ * be used in intel Proximity mode */ -+ struct proxim proximity; -+#endif //CONFIG_INTEL_PROXIM -+ -+#ifdef CONFIG_MAC_LOOPBACK_DRIVER -+ PLOOPBACKDATA ploopback; -+#endif -+ -+ u8 fix_rate; -+ -+ unsigned char in_cta_test; -+ -+}; -+ -+#define adapter_to_dvobj(adapter) (adapter->dvobj) -+ -+int rtw_handle_dualmac(_adapter *adapter, bool init); -+ -+__inline static u8 *myid(struct eeprom_priv *peepriv) -+{ -+ return (peepriv->mac_addr); -+} -+ -+// HCI Related header file -+#include -+#include -+#include -+ -+extern int rtw_mc2u_disable; -+extern char *rtw_initmac; -+extern int rtw_ht_enable; -+extern int rtw_ampdu_enable; -+extern int rtw_bw_mode; -+ -+void netdev_br_init(struct net_device *netdev); -+int pm_netdev_open(struct net_device *pnetdev,u8 bnormal); -+void rtw_indicate_wx_assoc_event(_adapter *padapter); -+void rtw_indicate_wx_disassoc_event(_adapter *padapter); -+void indicate_wx_scan_complete_event(_adapter *padapter); -+u8 rtw_do_join(_adapter * padapter); -+int nat25_handle_frame(_adapter *priv, struct sk_buff *skb); -+void *scdb_findEntry(_adapter *priv, unsigned char *macAddr, unsigned char *ipAddr); -+void dhcp_flag_bcast(_adapter *priv, struct sk_buff *skb); -+int nat25_db_handle(_adapter *priv, struct sk_buff *skb, int method); -+void nat25_db_expire(_adapter *priv); -+int rtw_change_ifname(_adapter *padapter, const char *ifname); -+ -+#endif //__DRV_TYPES_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/drv_types_linux.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/drv_types_linux.h ---- linux-4.14.17/3rdparty/rtl8812au/include/drv_types_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/drv_types_linux.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,19 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __DRV_TYPES_LINUX_H__ -+#define __DRV_TYPES_LINUX_H__ -+ -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/ethernet.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/ethernet.h ---- linux-4.14.17/3rdparty/rtl8812au/include/ethernet.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/ethernet.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,36 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/*! \file */ -+#ifndef __INC_ETHERNET_H -+#define __INC_ETHERNET_H -+ -+#define ETHERNET_ADDRESS_LENGTH 6 //!< Ethernet Address Length -+#define ETHERNET_HEADER_SIZE 14 //!< Ethernet Header Length -+#define LLC_HEADER_SIZE 6 //!< LLC Header Length -+#define TYPE_LENGTH_FIELD_SIZE 2 //!< Type/Length Size -+#define MINIMUM_ETHERNET_PACKET_SIZE 60 //!< Minimum Ethernet Packet Size -+#define MAXIMUM_ETHERNET_PACKET_SIZE 1514 //!< Maximum Ethernet Packet Size -+ -+#define RT_ETH_IS_MULTICAST(_pAddr) ((((u8 *)(_pAddr))[0]&0x01)!=0) //!< Is Multicast Address? -+#define RT_ETH_IS_BROADCAST(_pAddr) ( \ -+ ((u8 *)(_pAddr))[0]==0xff && \ -+ ((u8 *)(_pAddr))[1]==0xff && \ -+ ((u8 *)(_pAddr))[2]==0xff && \ -+ ((u8 *)(_pAddr))[3]==0xff && \ -+ ((u8 *)(_pAddr))[4]==0xff && \ -+ ((u8 *)(_pAddr))[5]==0xff ) //!< Is Broadcast Address? -+ -+ -+#endif // #ifndef __INC_ETHERNET_H -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/h2clbk.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/h2clbk.h ---- linux-4.14.17/3rdparty/rtl8812au/include/h2clbk.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/h2clbk.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,26 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#define _H2CLBK_H_ -+ -+ -+void _lbk_cmd(PADAPTER Adapter); -+ -+void _lbk_rsp(PADAPTER Adapter); -+ -+void _lbk_evt(PADAPTER Adapter); -+ -+void h2c_event_callback(unsigned char *dev, unsigned char *pbuf); -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/Hal8812PhyCfg.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8812PhyCfg.h ---- linux-4.14.17/3rdparty/rtl8812au/include/Hal8812PhyCfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8812PhyCfg.h 2018-02-06 17:42:30.716967253 +0200 -@@ -0,0 +1,198 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8812PHYCFG_H__ -+#define __INC_HAL8812PHYCFG_H__ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+#define LOOP_LIMIT 5 -+#define MAX_STALL_TIME 50 //us -+#define AntennaDiversityValue 0x80 //(Adapter->bSoftwareAntennaDiversity ? 0x00:0x80) -+#define MAX_TXPWR_IDX_NMODE_92S 63 -+#define Reset_Cnt_Limit 3 -+ -+ -+#ifdef CONFIG_PCI_HCI -+#define MAX_AGGR_NUM 0x0B -+#else -+#define MAX_AGGR_NUM 0x07 -+#endif // CONFIG_PCI_HCI -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/* BB/RF related */ -+ -+/*------------------------------Define structure----------------------------*/ -+ -+ -+/*------------------------Export global variable----------------------------*/ -+/*------------------------Export global variable----------------------------*/ -+ -+ -+/*------------------------Export Marco Definition---------------------------*/ -+/*------------------------Export Marco Definition---------------------------*/ -+ -+ -+/*--------------------------Exported Function prototype---------------------*/ -+// -+// BB and RF register read/write -+// -+u32 PHY_QueryBBReg8812( PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask ); -+void PHY_SetBBReg8812( PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data ); -+u32 PHY_QueryRFReg8812( PADAPTER Adapter, -+ u8 eRFPath, -+ u32 RegAddr, -+ u32 BitMask ); -+void PHY_SetRFReg8812( PADAPTER Adapter, -+ u8 eRFPath, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data ); -+ -+// -+// Initialization related function -+// -+/* MAC/BB/RF HAL config */ -+int PHY_MACConfig8812(PADAPTER Adapter ); -+int PHY_BBConfig8812(PADAPTER Adapter ); -+void PHY_BB8812_Config_1T(PADAPTER Adapter ); -+int PHY_RFConfig8812(PADAPTER Adapter ); -+ -+void -+PHY_InitPowerLimitTable( -+ PDM_ODM_T pDM_Odm -+ ); -+ -+void -+PHY_ConvertPowerLimitToPowerIndex( -+ PADAPTER Adapter -+ ); -+ -+void -+PHY_SetPowerLimitTableValue( -+ PDM_ODM_T pDM_Odm, -+ const s8* Regulation, -+ const s8* Band, -+ const s8* Bandwidth, -+ const s8* RateSection, -+ const s8* RfPath, -+ const s8* Channel, -+ const s8* PowerLimit -+ ); -+ -+u8 -+PHY_GetPowerLimitValue( -+ PADAPTER Adapter, -+ u32 RegPwrTblSel, -+ BAND_TYPE Band, -+ CHANNEL_WIDTH Bandwidth, -+ RF_PATH RfPath, -+ u8 DataRate, -+ u8 Channel -+ ); -+ -+/* RF config */ -+ -+s32 -+PHY_SwitchWirelessBand8812( -+ PADAPTER Adapter, -+ u8 Band -+); -+ -+// -+// BB TX Power R/W -+// -+void PHY_GetTxPowerLevel8812(PADAPTER Adapter, u32* powerlevel ); -+void PHY_SetTxPowerLevel8812(PADAPTER Adapter, u8 Channel ); -+bool PHY_UpdateTxPowerDbm8812(PADAPTER Adapter, int powerInDbm ); -+u32 PHY_GetTxPowerIndex_8812A( -+ PADAPTER pAdapter, -+ u8 RFPath, -+ u8 Rate, -+ CHANNEL_WIDTH BandWidth, -+ u8 Channel -+ ); -+ -+u32 PHY_GetTxBBSwing_8812A( -+ PADAPTER Adapter, -+ BAND_TYPE Band, -+ u8 RFPath -+ ); -+ -+void -+PHY_SetTxPowerIndex_8812A( -+ PADAPTER Adapter, -+ u4Byte PowerIndex, -+ u1Byte RFPath, -+ u1Byte Rate -+ ); -+// -+// Switch bandwidth for 8192S -+// -+void -+PHY_SetBWMode8812( -+ PADAPTER pAdapter, -+ CHANNEL_WIDTH Bandwidth, -+ u8 Offset -+); -+ -+// -+// channel switch related funciton -+// -+void -+PHY_SwChnl8812( -+ PADAPTER Adapter, -+ u8 channel -+); -+ -+ -+void -+PHY_SetSwChnlBWMode8812( -+ PADAPTER Adapter, -+ u8 channel, -+ CHANNEL_WIDTH Bandwidth, -+ u8 Offset40, -+ u8 Offset80 -+); -+ -+// -+// BB/MAC/RF other monitor API -+// -+ -+void -+PHY_SetRFPathSwitch_8812A( -+ PADAPTER pAdapter, -+ bool bMain -+); -+ -+void -+storePwrIndexDiffRateOffset( -+ PADAPTER Adapter, -+ u32 RegAddr, -+ u32 BitMask, -+ u32 Data -+ ); -+ -+/*--------------------------Exported Function prototype---------------------*/ -+#endif // __INC_HAL8192CPHYCFG_H -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/Hal8812PhyReg.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8812PhyReg.h ---- linux-4.14.17/3rdparty/rtl8812au/include/Hal8812PhyReg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8812PhyReg.h 2018-02-06 17:42:30.716967253 +0200 -@@ -0,0 +1,718 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __INC_HAL8812PHYREG_H__ -+#define __INC_HAL8812PHYREG_H__ -+/*--------------------------Define Parameters-------------------------------*/ -+// -+// BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+// 3. RF register 0x00-2E -+// 4. Bit Mask for BB/RF register -+// 5. Other defintion for BB/RF R/W -+// -+ -+ -+// BB Register Definition -+ -+#define rCCAonSec_Jaguar 0x838 -+ -+// BW and sideband setting -+#define rBWIndication_Jaguar 0x834 -+#define rL1PeakTH_Jaguar 0x848 -+#define rRFMOD_Jaguar 0x8ac //RF mode -+#define rADC_Buf_Clk_Jaguar 0x8c4 -+#define rRFECTRL_Jaguar 0x900 -+#define bRFMOD_Jaguar 0xc3 -+#define rCCK_System_Jaguar 0xa00 // for cck sideband -+#define bCCK_System_Jaguar 0x10 -+ -+// Block & Path enable -+#define rOFDMCCKEN_Jaguar 0x808 // OFDM/CCK block enable -+#define bOFDMEN_Jaguar 0x20000000 -+#define bCCKEN_Jaguar 0x10000000 -+#define rRxPath_Jaguar 0x808 // Rx antenna -+#define bRxPath_Jaguar 0xff -+#define rTxPath_Jaguar 0x80c // Tx antenna -+#define bTxPath_Jaguar 0x0fffffff -+#define rCCK_RX_Jaguar 0xa04 // for cck rx path selection -+#define bCCK_RX_Jaguar 0x0c000000 -+#define rVhtlen_Use_Lsig_Jaguar 0x8c3 // Use LSIG for VHT length -+ -+// RF read/write-related -+#define rHSSIRead_Jaguar 0x8b0 // RF read addr -+#define bHSSIRead_addr_Jaguar 0xff -+#define bHSSIRead_trigger_Jaguar 0x100 -+#define rA_PIRead_Jaguar 0xd04 // RF readback with PI -+#define rB_PIRead_Jaguar 0xd44 // RF readback with PI -+#define rA_SIRead_Jaguar 0xd08 // RF readback with SI -+#define rB_SIRead_Jaguar 0xd48 // RF readback with SI -+#define rRead_data_Jaguar 0xfffff -+#define rA_LSSIWrite_Jaguar 0xc90 // RF write addr -+#define rB_LSSIWrite_Jaguar 0xe90 // RF write addr -+#define bLSSIWrite_data_Jaguar 0x000fffff -+#define bLSSIWrite_addr_Jaguar 0x0ff00000 -+ -+ -+ -+// YN: mask the following register definition temporarily -+#define rFPGA0_XA_RFInterfaceOE 0x860 // RF Channel switch -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 // RF Interface Software Control -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+//#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter -+//#define rFPGA0_XCD_RFParameter 0x87c -+ -+//#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? -+//#define rFPGA0_AnalogParameter2 0x884 -+//#define rFPGA0_AnalogParameter3 0x888 -+//#define rFPGA0_AdDaClockEn 0x888 // enable ad/da clock1 for dual-phy -+//#define rFPGA0_AnalogParameter4 0x88c -+ -+ -+// CCK TX scaling -+#define rCCK_TxFilter1_Jaguar 0xa20 -+#define bCCK_TxFilter1_C0_Jaguar 0x00ff0000 -+#define bCCK_TxFilter1_C1_Jaguar 0xff000000 -+#define rCCK_TxFilter2_Jaguar 0xa24 -+#define bCCK_TxFilter2_C2_Jaguar 0x000000ff -+#define bCCK_TxFilter2_C3_Jaguar 0x0000ff00 -+#define bCCK_TxFilter2_C4_Jaguar 0x00ff0000 -+#define bCCK_TxFilter2_C5_Jaguar 0xff000000 -+#define rCCK_TxFilter3_Jaguar 0xa28 -+#define bCCK_TxFilter3_C6_Jaguar 0x000000ff -+#define bCCK_TxFilter3_C7_Jaguar 0x0000ff00 -+ -+ -+// YN: mask the following register definition temporarily -+//#define rPdp_AntA 0xb00 -+//#define rPdp_AntA_4 0xb04 -+//#define rConfig_Pmpd_AntA 0xb28 -+//#define rConfig_AntA 0xb68 -+//#define rConfig_AntB 0xb6c -+//#define rPdp_AntB 0xb70 -+//#define rPdp_AntB_4 0xb74 -+//#define rConfig_Pmpd_AntB 0xb98 -+//#define rAPK 0xbd8 -+ -+// RXIQC -+#define rA_RxIQC_AB_Jaguar 0xc10 //RxIQ imblance matrix coeff. A & B -+#define rA_RxIQC_CD_Jaguar 0xc14 //RxIQ imblance matrix coeff. C & D -+#define rA_TxScale_Jaguar 0xc1c // Pah_A TX scaling factor -+#define rB_TxScale_Jaguar 0xe1c // Path_B TX scaling factor -+#define rB_RxIQC_AB_Jaguar 0xe10 //RxIQ imblance matrix coeff. A & B -+#define rB_RxIQC_CD_Jaguar 0xe14 //RxIQ imblance matrix coeff. C & D -+#define b_RxIQC_AC_Jaguar 0x02ff // bit mask for IQC matrix element A & C -+#define b_RxIQC_BD_Jaguar 0x02ff0000 // bit mask for IQC matrix element A & C -+ -+ -+// DIG-related -+#define rA_IGI_Jaguar 0xc50 // Initial Gain for path-A -+#define rB_IGI_Jaguar 0xe50 // Initial Gain for path-B -+#define rOFDM_FalseAlarm1_Jaguar 0xf48 // counter for break -+#define rOFDM_FalseAlarm2_Jaguar 0xf4c // counter for spoofing -+#define rCCK_FalseAlarm_Jaguar 0xa5c // counter for cck false alarm -+#define b_FalseAlarm_Jaguar 0xffff -+#define rCCK_CCA_Jaguar 0xa08 // cca threshold -+#define bCCK_CCA_Jaguar 0x00ff0000 -+ -+// Tx Power Ttraining-related -+#define rA_TxPwrTraing_Jaguar 0xc54 -+#define rB_TxPwrTraing_Jaguar 0xe54 -+ -+// Report-related -+#define rOFDM_ShortCFOAB_Jaguar 0xf60 -+#define rOFDM_LongCFOAB_Jaguar 0xf64 -+#define rOFDM_EndCFOAB_Jaguar 0xf70 -+#define rOFDM_AGCReport_Jaguar 0xf84 -+#define rOFDM_RxSNR_Jaguar 0xf88 -+#define rOFDM_RxEVMCSI_Jaguar 0xf8c -+#define rOFDM_SIGReport_Jaguar 0xf90 -+ -+// Misc functions -+#define rEDCCA_Jaguar 0x8a4 // EDCCA -+#define bEDCCA_Jaguar 0xffff -+#define rAGC_table_Jaguar 0x82c // AGC tabel select -+#define bAGC_table_Jaguar 0x3 -+#define b_sel5g_Jaguar 0x1000 // sel5g -+#define b_LNA_sw_Jaguar 0x8000 // HW/WS control for LNA -+#define rFc_area_Jaguar 0x860 // fc_area -+#define bFc_area_Jaguar 0x1ffe000 -+#define rSingleTone_ContTx_Jaguar 0x914 -+ -+// RFE -+#define rA_RFE_Pinmux_Jaguar 0xcb0 // Path_A RFE cotrol pinmux -+#define rB_RFE_Pinmux_Jaguar 0xeb0 // Path_B RFE control pinmux -+#define rA_RFE_Inv_Jaguar 0xcb4 // Path_A RFE cotrol -+#define rB_RFE_Inv_Jaguar 0xeb4 // Path_B RFE control -+#define rA_RFE_Jaguar 0xcb8 // Path_A RFE cotrol -+#define rB_RFE_Jaguar 0xeb8 // Path_B RFE control -+#define r_ANTSEL_SW_Jaguar 0x900 // ANTSEL SW Control -+#define bMask_RFEInv_Jaguar 0x3ff00000 -+#define bMask_AntselPathFollow_Jaguar 0x00030000 -+ -+// TX AGC -+#define rTxAGC_A_CCK11_CCK1_JAguar 0xc20 -+#define rTxAGC_A_Ofdm18_Ofdm6_JAguar 0xc24 -+#define rTxAGC_A_Ofdm54_Ofdm24_JAguar 0xc28 -+#define rTxAGC_A_MCS3_MCS0_JAguar 0xc2c -+#define rTxAGC_A_MCS7_MCS4_JAguar 0xc30 -+#define rTxAGC_A_MCS11_MCS8_JAguar 0xc34 -+#define rTxAGC_A_MCS15_MCS12_JAguar 0xc38 -+#define rTxAGC_A_Nss1Index3_Nss1Index0_JAguar 0xc3c -+#define rTxAGC_A_Nss1Index7_Nss1Index4_JAguar 0xc40 -+#define rTxAGC_A_Nss2Index1_Nss1Index8_JAguar 0xc44 -+#define rTxAGC_A_Nss2Index5_Nss2Index2_JAguar 0xc48 -+#define rTxAGC_A_Nss2Index9_Nss2Index6_JAguar 0xc4c -+#define rTxAGC_B_CCK11_CCK1_JAguar 0xe20 -+#define rTxAGC_B_Ofdm18_Ofdm6_JAguar 0xe24 -+#define rTxAGC_B_Ofdm54_Ofdm24_JAguar 0xe28 -+#define rTxAGC_B_MCS3_MCS0_JAguar 0xe2c -+#define rTxAGC_B_MCS7_MCS4_JAguar 0xe30 -+#define rTxAGC_B_MCS11_MCS8_JAguar 0xe34 -+#define rTxAGC_B_MCS15_MCS12_JAguar 0xe38 -+#define rTxAGC_B_Nss1Index3_Nss1Index0_JAguar 0xe3c -+#define rTxAGC_B_Nss1Index7_Nss1Index4_JAguar 0xe40 -+#define rTxAGC_B_Nss2Index1_Nss1Index8_JAguar 0xe44 -+#define rTxAGC_B_Nss2Index5_Nss2Index2_JAguar 0xe48 -+#define rTxAGC_B_Nss2Index9_Nss2Index6_JAguar 0xe4c -+#define bTxAGC_byte0_Jaguar 0xff -+#define bTxAGC_byte1_Jaguar 0xff00 -+#define bTxAGC_byte2_Jaguar 0xff0000 -+#define bTxAGC_byte3_Jaguar 0xff000000 -+ -+// IQK YN: temporaily mask this part -+//#define rFPGA0_IQK 0xe28 -+//#define rTx_IQK_Tone_A 0xe30 -+//#define rRx_IQK_Tone_A 0xe34 -+//#define rTx_IQK_PI_A 0xe38 -+//#define rRx_IQK_PI_A 0xe3c -+ -+//#define rTx_IQK 0xe40 -+//#define rRx_IQK 0xe44 -+//#define rIQK_AGC_Pts 0xe48 -+//#define rIQK_AGC_Rsp 0xe4c -+//#define rTx_IQK_Tone_B 0xe50 -+//#define rRx_IQK_Tone_B 0xe54 -+//#define rTx_IQK_PI_B 0xe58 -+//#define rRx_IQK_PI_B 0xe5c -+//#define rIQK_AGC_Cont 0xe60 -+ -+ -+// AFE-related -+#define rA_AFEPwr1_Jaguar 0xc60 // dynamic AFE power control -+#define rA_AFEPwr2_Jaguar 0xc64 // dynamic AFE power control -+#define rA_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xc68 -+#define rA_Tx_CCKBBON_OFDMRFON_Jaguar 0xc6c -+#define rA_Tx_OFDMBBON_Tx2Rx_Jaguar 0xc70 -+#define rA_Tx2Tx_RXCCK_Jaguar 0xc74 -+#define rA_Rx_OFDM_WaitRIFS_Jaguar 0xc78 -+#define rA_Rx2Rx_BT_Jaguar 0xc7c -+#define rA_sleep_nav_Jaguar 0xc80 -+#define rA_pmpd_Jaguar 0xc84 -+#define rB_AFEPwr1_Jaguar 0xe60 // dynamic AFE power control -+#define rB_AFEPwr2_Jaguar 0xe64 // dynamic AFE power control -+#define rB_Rx_WaitCCA_Tx_CCKRFON_Jaguar 0xe68 -+#define rB_Tx_CCKBBON_OFDMRFON_Jaguar 0xe6c -+#define rB_Tx_OFDMBBON_Tx2Rx_Jaguar 0xe70 -+#define rB_Tx2Tx_RXCCK_Jaguar 0xe74 -+#define rB_Rx_OFDM_WaitRIFS_Jaguar 0xe78 -+#define rB_Rx2Rx_BT_Jaguar 0xe7c -+#define rB_sleep_nav_Jaguar 0xe80 -+#define rB_pmpd_Jaguar 0xe84 -+ -+ -+// YN: mask these registers temporaily -+//#define rTx_Power_Before_IQK_A 0xe94 -+//#define rTx_Power_After_IQK_A 0xe9c -+ -+//#define rRx_Power_Before_IQK_A 0xea0 -+//#define rRx_Power_Before_IQK_A_2 0xea4 -+//#define rRx_Power_After_IQK_A 0xea8 -+//#define rRx_Power_After_IQK_A_2 0xeac -+ -+//#define rTx_Power_Before_IQK_B 0xeb4 -+//#define rTx_Power_After_IQK_B 0xebc -+ -+//#define rRx_Power_Before_IQK_B 0xec0 -+//#define rRx_Power_Before_IQK_B_2 0xec4 -+//#define rRx_Power_After_IQK_B 0xec8 -+//#define rRx_Power_After_IQK_B_2 0xecc -+ -+ -+// RSSI Dump -+#define rA_RSSIDump_Jaguar 0xBF0 -+#define rB_RSSIDump_Jaguar 0xBF1 -+#define rS1_RXevmDump_Jaguar 0xBF4 -+#define rS2_RXevmDump_Jaguar 0xBF5 -+#define rA_RXsnrDump_Jaguar 0xBF6 -+#define rB_RXsnrDump_Jaguar 0xBF7 -+#define rA_CfoShortDump_Jaguar 0xBF8 -+#define rB_CfoShortDump_Jaguar 0xBFA -+#define rA_CfoLongDump_Jaguar 0xBEC -+#define rB_CfoLongDump_Jaguar 0xBEE -+ -+ -+// RF Register -+// -+#define RF_AC_Jaguar 0x00 // -+#define RF_RF_Top_Jaguar 0x07 // -+#define RF_TXLOK_Jaguar 0x08 // -+#define RF_TXAPK_Jaguar 0x0B -+#define RF_CHNLBW_Jaguar 0x18 // RF channel and BW switch -+#define RF_TxLCTank_Jaguar 0x54 -+#define RF_APK_Jaguar 0x63 -+#define bRF_CHNLBW_MOD_AG_Jaguar 0x70300 -+#define bRF_CHNLBW_BW 0xc00 -+#define RF_RCK1_Jaguar 0x1c // -+#define RF_RCK2_Jaguar 0x1d -+#define RF_RCK3_Jaguar 0x1e -+#define RF_LCK 0xB4 -+ -+ -+// -+// RL6052 Register definition -+// -+#define RF_AC 0x00 // -+#define RF_IPA_A 0x0C // -+#define RF_TXBIAS_A 0x0D -+#define RF_BS_PA_APSET_G9_G11 0x0E -+#define RF_MODE1 0x10 // -+#define RF_MODE2 0x11 // -+#define RF_CHNLBW 0x18 // RF channel and BW switch -+#define RF_RCK_OS 0x30 // RF TX PA control -+#define RF_TXPA_G1 0x31 // RF TX PA control -+#define RF_TXPA_G2 0x32 // RF TX PA control -+#define RF_TXPA_G3 0x33 // RF TX PA control -+#define RF_0x52 0x52 -+#define RF_WE_LUT 0xEF -+ -+// -+//Bit Mask -+// -+// 1. Page1(0x100) -+#define bBBResetB 0x100 // Useless now? -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+ -+// -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 1. Page1(0x100) -+// -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+// -+// 3. Page8(0x800) -+// -+#define rFPGA0_RFMOD 0x800 //RF mode & CCK TxSC // RF BW Setting?? -+ -+#define rFPGA0_TxInfo 0x804 // Status report?? -+#define rFPGA0_PSDFunction 0x808 -+#define rFPGA0_TxGainStage 0x80c // Set TX PWR init gain? -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 // RF 3 wire register -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+ -+#define rFPGA0_XAB_SwitchControl 0x858 // RF Channel switch -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 -+#define rFPGA0_AdDaClockEn 0x888 // enable ad/da clock1 for dual-phy -+#define rFPGA0_AnalogParameter4 0x88c -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+// -+// 4. Page9(0x900) -+// -+#define rFPGA1_RFMOD 0x900 //RF mode & OFDM TxSC // RF BW Setting?? -+ -+#define rFPGA1_TxBlock 0x904 // Useless now -+#define rFPGA1_DebugSelect 0x908 // Useless now -+#define rFPGA1_TxInfo 0x90c // Useless now // Status report?? -+ -+// -+// PageA(0xA00) -+// -+#define rCCK0_System 0xa00 -+#define rCCK0_AFESetting 0xa04 // Disable init gain now // Select RX path by RSSI -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 //debug port and Tx filter3 -+ -+// -+// PageB(0xB00) -+// -+#define rPdp_AntA 0xb00 -+#define rPdp_AntA_4 0xb04 -+#define rConfig_Pmpd_AntA 0xb28 -+#define rConfig_AntA 0xb68 -+#define rConfig_AntB 0xb6c -+#define rPdp_AntB 0xb70 -+#define rPdp_AntB_4 0xb74 -+#define rConfig_Pmpd_AntB 0xb98 -+#define rAPK 0xbd8 -+ -+// -+// 6. PageC(0xC00) -+// -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 //RxIQ DC offset, Rx digital filter, DC notch filter -+#define rOFDM0_XARxIQImbalance 0xc14 //RxIQ imblance matrix -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 //PD,BW & SBD // DM tune init gain -+#define rOFDM0_RxDetector2 0xc34 //SBD & Fame Sync. -+#define rOFDM0_RxDetector3 0xc38 //Frame Sync. -+#define rOFDM0_RxDetector4 0xc3c //PD, SBD, Frame Sync & Short-GI -+ -+#define rOFDM0_RxDSP 0xc40 //Rx Sync Path -+#define rOFDM0_CFOandDAGC 0xc44 //CFO & DAGC -+#define rOFDM0_CCADropThreshold 0xc48 //CCA Drop threshold -+#define rOFDM0_ECCAThreshold 0xc4c // energy CCA -+ -+#define rOFDM0_XAAGCCore1 0xc50 // DIG -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 // TX PWR TRACK and DIG -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+ -+#define rOFDM0_RxIQExtAnta 0xca0 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+ -+// -+// 7. PageD(0xD00) -+// -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+// -+// 8. PageE(0xE00) -+// -+#define rTxAGC_A_Rate18_06 0xe00 -+#define rTxAGC_A_Rate54_24 0xe04 -+#define rTxAGC_A_CCK1_Mcs32 0xe08 -+#define rTxAGC_A_Mcs03_Mcs00 0xe10 -+#define rTxAGC_A_Mcs07_Mcs04 0xe14 -+#define rTxAGC_A_Mcs11_Mcs08 0xe18 -+#define rTxAGC_A_Mcs15_Mcs12 0xe1c -+ -+#define rTxAGC_B_Rate18_06 0x830 -+#define rTxAGC_B_Rate54_24 0x834 -+#define rTxAGC_B_CCK1_55_Mcs32 0x838 -+#define rTxAGC_B_Mcs03_Mcs00 0x83c -+#define rTxAGC_B_Mcs07_Mcs04 0x848 -+#define rTxAGC_B_Mcs11_Mcs08 0x84c -+#define rTxAGC_B_Mcs15_Mcs12 0x868 -+#define rTxAGC_B_CCK11_A_CCK2_11 0x86c -+ -+#define rFPGA0_IQK 0xe28 -+#define rTx_IQK_Tone_A 0xe30 -+#define rRx_IQK_Tone_A 0xe34 -+#define rTx_IQK_PI_A 0xe38 -+#define rRx_IQK_PI_A 0xe3c -+ -+#define rTx_IQK 0xe40 -+#define rRx_IQK 0xe44 -+#define rIQK_AGC_Pts 0xe48 -+#define rIQK_AGC_Rsp 0xe4c -+#define rTx_IQK_Tone_B 0xe50 -+#define rRx_IQK_Tone_B 0xe54 -+#define rTx_IQK_PI_B 0xe58 -+#define rRx_IQK_PI_B 0xe5c -+#define rIQK_AGC_Cont 0xe60 -+ -+#define rBlue_Tooth 0xe6c -+#define rRx_Wait_CCA 0xe70 -+#define rTx_CCK_RFON 0xe74 -+#define rTx_CCK_BBON 0xe78 -+#define rTx_OFDM_RFON 0xe7c -+#define rTx_OFDM_BBON 0xe80 -+#define rTx_To_Rx 0xe84 -+#define rTx_To_Tx 0xe88 -+#define rRx_CCK 0xe8c -+ -+#define rTx_Power_Before_IQK_A 0xe94 -+#define rTx_Power_After_IQK_A 0xe9c -+ -+#define rRx_Power_Before_IQK_A 0xea0 -+#define rRx_Power_Before_IQK_A_2 0xea4 -+#define rRx_Power_After_IQK_A 0xea8 -+#define rRx_Power_After_IQK_A_2 0xeac -+ -+#define rTx_Power_Before_IQK_B 0xeb4 -+#define rTx_Power_After_IQK_B 0xebc -+ -+#define rRx_Power_Before_IQK_B 0xec0 -+#define rRx_Power_Before_IQK_B_2 0xec4 -+#define rRx_Power_After_IQK_B 0xec8 -+#define rRx_Power_After_IQK_B_2 0xecc -+ -+#define rRx_OFDM 0xed0 -+#define rRx_Wait_RIFS 0xed4 -+#define rRx_TO_Rx 0xed8 -+#define rStandby 0xedc -+#define rSleep 0xee0 -+#define rPMPD_ANAEN 0xeec -+ -+ -+// 2. Page8(0x800) -+#define bRFMOD 0x1 // Reg 0x800 rFPGA0_RFMOD -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+#define bXBTxAGC 0xf00 // Reg 80c rFPGA0_TxGainStage -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+// 4. PageA(0xA00) -+#define bCCKBBMode 0x3 // Useless -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 // Reg 0xa00 rCCK0_System 20/40 switch -+ -+#define bCCKScramble 0x8 // Useless -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 //r_rx_clk -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 //CCK Rx Iinital gain polarity -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f //AGCsamp_dly -+#define bCCKFixedRxAGC 0x8000 -+//#define bCCKRxAGCFormat 0x4000 //remove to HSSI register 0x824 -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+// 6. PageE(0xE00) -+#define bSTBCEn 0x4 // Useless -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+ -+ -+// -+// Other Definition -+// -+ -+#define bEnable 0x1 // Useless -+#define bDisable 0x0 -+ -+//byte endable for srwrite -+#define bByte0 0x1 // Useless -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+//for PutRegsetting & GetRegSetting BitMask -+#define bMaskByte0 0xff // Reg 0xc50 rOFDM0_XAAGCCore~0xC6f -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMask12Bits 0xfff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/Hal8812PwrSeq.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8812PwrSeq.h ---- linux-4.14.17/3rdparty/rtl8812au/include/Hal8812PwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8812PwrSeq.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,204 @@ -+ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL8812PWRSEQ_H__ -+#define __HAL8812PWRSEQ_H__ -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WB-110628-DZ-RTL8195 (Jaguar) Power Architecture-R04.pdf -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8812_TRANS_CARDEMU_TO_ACT_STEPS 15 -+#define RTL8812_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8812_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8812_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8812_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8812_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8812_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8812_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8812_TRANS_END_STEPS 1 -+ -+ -+#define RTL8812_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ -+ -+#define RTL8812_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ -+ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ /*{0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},//0x1F[7:0] = 0 turn off RF*/ \ -+ /*{0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},//0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x28}, /* 0x07[7:0] = 0x28 sps pwm mode */ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk =500k */ \ -+ /*{0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0|BIT1, 0}, // 0x02[1:0] = 0 reset BB */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ -+ -+#define RTL8812_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xcc},\ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xEC},\ -+ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ -+ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ -+ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/* suspend option all off */ \ -+ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x80, BIT7},/*0x14[7] = 1 turn on ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, BIT0},/* 0x15[0] =1 trun on ZCD */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk =500k */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 2b'11 enable WL suspend for PCIe*/ -+ -+#define RTL8812_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 2b'01enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO sleep mode leave */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, 0},/* 0x15[0] =0 trun off ZCD */ \ -+ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x80, 0},/*0x14[7] = 0 turn off ZCD */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ -+ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ -+ -+#define RTL8812_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ /**{0x0194, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, //0x194[0]=0 , disable 32K clock*/ \ -+ /**{0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x94}, //0x93=0x94 , 90[30] =0 enable 500k ANA clock .switch clock from 12M to 500K , 90 [26] =0 disable EEprom loader clock*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0}, /*0x03[2] = 0, reset 8051*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x05}, /*0x80=05h if reload fw, fill the default value of host_CPU handshake field*/ \ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xcc},\ -+ {0x0042, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xF0, 0xEC},\ -+ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x07},/* gpio11 input mode, gpio10~8 output mode */ \ -+ {0x0045, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio 0~7 output same value as input ?? */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xff},/* gpio0~7 output mode */ \ -+ {0x0047, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/* 0x47[7:0] = 00 gpio mode */ \ -+ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x80, BIT7},/*0x14[7] = 1 turn on ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, BIT0},/* 0x15[0] =1 trun on ZCD */ \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, 0},/*0x12[0] = 0 force PFM mode */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, BIT4},/*0x23[4] = 1 hpon LDO sleep mode */ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x02, 0},/*0x8[1] = 0 ANA clk =500k */ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07=0x20 , SOP option to disable BG/MB*/ \ -+ {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /*0x01f[1]=0 , disable RFC_0 control REG_RF_CTRL_8812 */ \ -+ {0x0076, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /*0x076[1]=0 , disable RFC_1 control REG_OPT_CTRL_8812 +2 */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3}, /*0x04[11] = 2b'01 enable WL suspend*/ -+ -+#define RTL8812_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*0x12[0] = 1 force PWM mode */ \ -+ {0x0014, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x80, 0},/*0x14[7] = 0 turn off ZCD */ \ -+ {0x0015, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x01, 0},/* 0x15[0] =0 trun off ZCD */ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x10, 0},/*0x23[4] = 0 hpon LDO leave sleep mode */ \ -+ {0x0046, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio0~7 input mode */ \ -+ {0x0043, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/* gpio11 input mode, gpio10~8 input mode */ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0}, /*0x04[10] = 0, enable SW LPS PCIE only*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 2b'01enable WL suspend*/ \ -+ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2}, /*0x03[2] = 1, enable 8051*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8812_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8812_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8812_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x7F},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0c00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xc00[7:0] = 4 turn off 3-wire */ \ -+ {0x0e00, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x04}, /* 0xe00[7:0] = 4 turn off 3-wire */ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated,and RF closed*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ -+ -+ -+#define RTL8812_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/ \ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/ \ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/ \ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/ \ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/ \ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8812_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // -+ -+ -+extern WLAN_PWR_CFG rtl8812_power_on_flow[RTL8812_TRANS_CARDEMU_TO_ACT_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_radio_off_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_card_disable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_card_enable_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_suspend_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_SUS_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_resume_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_SUS_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_hwpdn_flow[RTL8812_TRANS_ACT_TO_CARDEMU_STEPS+RTL8812_TRANS_CARDEMU_TO_PDN_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_enter_lps_flow[RTL8812_TRANS_ACT_TO_LPS_STEPS+RTL8812_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8812_leave_lps_flow[RTL8812_TRANS_LPS_TO_ACT_STEPS+RTL8812_TRANS_END_STEPS]; -+ -+#endif //__HAL8812PWRSEQ_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/Hal8821APwrSeq.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8821APwrSeq.h ---- linux-4.14.17/3rdparty/rtl8812au/include/Hal8821APwrSeq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/Hal8821APwrSeq.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,183 @@ -+#ifndef REALTEK_POWER_SEQUENCE_8821 -+#define REALTEK_POWER_SEQUENCE_8821 -+ -+#include "HalPwrSeqCmd.h" -+ -+/* -+ Check document WM-20121114-JackieLau-RTL8821A_Power_Architecture-R06.vsd -+ There are 6 HW Power States: -+ 0: POFF--Power Off -+ 1: PDN--Power Down -+ 2: CARDEMU--Card Emulation -+ 3: ACT--Active Mode -+ 4: LPS--Low Power State -+ 5: SUS--Suspend -+ -+ The transision from different states are defined below -+ TRANS_CARDEMU_TO_ACT -+ TRANS_ACT_TO_CARDEMU -+ TRANS_CARDEMU_TO_SUS -+ TRANS_SUS_TO_CARDEMU -+ TRANS_CARDEMU_TO_PDN -+ TRANS_ACT_TO_LPS -+ TRANS_LPS_TO_ACT -+ -+ TRANS_END -+*/ -+#define RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS 22 -+#define RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS 15 -+#define RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS 15 -+#define RTL8821A_TRANS_SUS_TO_CARDEMU_STEPS 15 -+#define RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS 15 -+#define RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS 15 -+#define RTL8821A_TRANS_PDN_TO_CARDEMU_STEPS 15 -+#define RTL8821A_TRANS_ACT_TO_LPS_STEPS 15 -+#define RTL8821A_TRANS_LPS_TO_ACT_STEPS 15 -+#define RTL8821A_TRANS_END_STEPS 1 -+ -+ -+#define RTL8821A_TRANS_CARDEMU_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ -+ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, 0},/* disable SW LPS 0x04[10]=0*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* disable HWPDN 0x04[15]=0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT4|BIT3), 0},/* disable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ \ -+ {0x004F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*0x4C[24] = 0x4F[0] = 1, switch DPDT_SEL_P output from WL BB */\ -+ {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT5|BIT4), (BIT5|BIT4)},/*0x66[13] = 0x67[5] = 1, switch for PAPE_G/PAPE_A from WL BB ; 0x66[12] = 0x67[4] = 1, switch LNAON from WL BB */\ -+ {0x0025, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, 0},/*anapar_mac<118> , 0x25[6]=0 by wlan single function*/\ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ -+ {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable GPIO9 interrupt mode*/\ -+ {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ -+ {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ -+ {0x005A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable HSISR GPIO9 interrupt*/\ -+ {0x007A, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x3A},/*0x7A = 0x3A start BT*/\ -+ {0x002E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF , 0x82 },/* 0x2C[23:12]=0x820 ; XTAL trim */ \ -+ {0x0010, PWR_CUT_A_MSK , PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6 , BIT6 },/* 0x10[6]=1 ; MP·s¼W¹ï©ó0x2Cªº±±¨îÅv¡A¶·§â0x10[6]³]¬°1¤~¯àÅýWLAN±±¨î */ \ -+ -+ -+#define RTL8821A_TRANS_ACT_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*0x1F[7:0] = 0 turn off RF*/ \ -+ {0x004F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*0x4C[24] = 0x4F[0] = 0, switch DPDT_SEL_P output from register 0x65[2] */\ -+ {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ -+ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ -+ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/ \ -+ -+ -+#define RTL8821A_TRANS_CARDEMU_TO_SUS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4|BIT3, (BIT4|BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3|BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8821A_TRANS_SUS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ -+ -+#define RTL8821A_TRANS_CARDEMU_TO_CARDDIS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07=0x20 , SOP option to disable BG/MB*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ -+ -+#define RTL8821A_TRANS_CARDDIS_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ -+ {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ -+ {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ -+ -+ -+#define RTL8821A_TRANS_CARDEMU_TO_PDN \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ -+ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK|PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ -+ {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ -+ -+#define RTL8821A_TRANS_PDN_TO_CARDEMU \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ -+ -+#define RTL8821A_TRANS_ACT_TO_LPS \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ -+ {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ -+ {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ -+ {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ -+ -+ -+#define RTL8821A_TRANS_LPS_TO_ACT \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ -+ {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ -+ {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ -+ {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ -+ {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ -+ {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ -+ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ -+ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ -+ {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ -+ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ -+ -+#define RTL8821A_TRANS_END \ -+ /* format */ \ -+ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ -+ {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // -+ -+ -+extern WLAN_PWR_CFG rtl8821A_power_on_flow[RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_radio_off_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_card_disable_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_card_enable_flow[RTL8821A_TRANS_CARDDIS_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_suspend_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_resume_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_SUS_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_hwpdn_flow[RTL8821A_TRANS_ACT_TO_CARDEMU_STEPS+RTL8821A_TRANS_CARDEMU_TO_PDN_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_enter_lps_flow[RTL8821A_TRANS_ACT_TO_LPS_STEPS+RTL8821A_TRANS_END_STEPS]; -+extern WLAN_PWR_CFG rtl8821A_leave_lps_flow[RTL8821A_TRANS_LPS_TO_ACT_STEPS+RTL8821A_TRANS_END_STEPS]; -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_com.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com.h ---- linux-4.14.17/3rdparty/rtl8812au/include/hal_com.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,155 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_COMMON_H__ -+#define __HAL_COMMON_H__ -+ -+#include "HalVerDef.h" -+#include "hal_pg.h" -+#include "hal_phy.h" -+#include "hal_phy_reg.h" -+#include "hal_com_reg.h" -+#include "hal_com_phycfg.h" -+ -+/*------------------------------ Tx Desc definition Macro ------------------------*/ -+//#pragma mark -- Tx Desc related definition. -- -+//---------------------------------------------------------------------------- -+//----------------------------------------------------------- -+// Rate -+//----------------------------------------------------------- -+// CCK Rates, TxHT = 0 -+#define DESC_RATE1M 0x00 -+#define DESC_RATE2M 0x01 -+#define DESC_RATE5_5M 0x02 -+#define DESC_RATE11M 0x03 -+ -+// OFDM Rates, TxHT = 0 -+#define DESC_RATE6M 0x04 -+#define DESC_RATE9M 0x05 -+#define DESC_RATE12M 0x06 -+#define DESC_RATE18M 0x07 -+#define DESC_RATE24M 0x08 -+#define DESC_RATE36M 0x09 -+#define DESC_RATE48M 0x0a -+#define DESC_RATE54M 0x0b -+ -+// MCS Rates, TxHT = 1 -+#define DESC_RATEMCS0 0x0c -+#define DESC_RATEMCS1 0x0d -+#define DESC_RATEMCS2 0x0e -+#define DESC_RATEMCS3 0x0f -+#define DESC_RATEMCS4 0x10 -+#define DESC_RATEMCS5 0x11 -+#define DESC_RATEMCS6 0x12 -+#define DESC_RATEMCS7 0x13 -+#define DESC_RATEMCS8 0x14 -+#define DESC_RATEMCS9 0x15 -+#define DESC_RATEMCS10 0x16 -+#define DESC_RATEMCS11 0x17 -+#define DESC_RATEMCS12 0x18 -+#define DESC_RATEMCS13 0x19 -+#define DESC_RATEMCS14 0x1a -+#define DESC_RATEMCS15 0x1b -+#define DESC_RATEMCS15_SG 0x1c -+#define DESC_RATEMCS32 0x20 -+ -+#define DESC_RATEVHTSS1MCS0 0x2c -+#define DESC_RATEVHTSS1MCS1 0x2d -+#define DESC_RATEVHTSS1MCS2 0x2e -+#define DESC_RATEVHTSS1MCS3 0x2f -+#define DESC_RATEVHTSS1MCS4 0x30 -+#define DESC_RATEVHTSS1MCS5 0x31 -+#define DESC_RATEVHTSS1MCS6 0x32 -+#define DESC_RATEVHTSS1MCS7 0x33 -+#define DESC_RATEVHTSS1MCS8 0x34 -+#define DESC_RATEVHTSS1MCS9 0x35 -+#define DESC_RATEVHTSS2MCS0 0x36 -+#define DESC_RATEVHTSS2MCS1 0x37 -+#define DESC_RATEVHTSS2MCS2 0x38 -+#define DESC_RATEVHTSS2MCS3 0x39 -+#define DESC_RATEVHTSS2MCS4 0x3a -+#define DESC_RATEVHTSS2MCS5 0x3b -+#define DESC_RATEVHTSS2MCS6 0x3c -+#define DESC_RATEVHTSS2MCS7 0x3d -+#define DESC_RATEVHTSS2MCS8 0x3e -+#define DESC_RATEVHTSS2MCS9 0x3f -+ -+enum{ -+ UP_LINK, -+ DOWN_LINK, -+}; -+typedef enum _RT_MEDIA_STATUS { -+ RT_MEDIA_DISCONNECT = 0, -+ RT_MEDIA_CONNECT = 1 -+} RT_MEDIA_STATUS; -+ -+#define MAX_DLFW_PAGE_SIZE 4096 // @ page : 4k bytes -+typedef enum _FIRMWARE_SOURCE { -+ FW_SOURCE_IMG_FILE = 0, -+ FW_SOURCE_HEADER_FILE = 1, //from header file -+} FIRMWARE_SOURCE, *PFIRMWARE_SOURCE; -+ -+ -+// BK, BE, VI, VO, HCCA, MANAGEMENT, COMMAND, HIGH, BEACON. -+//#define MAX_TX_QUEUE 9 -+ -+#define TX_SELE_HQ BIT(0) // High Queue -+#define TX_SELE_LQ BIT(1) // Low Queue -+#define TX_SELE_NQ BIT(2) // Normal Queue -+#define TX_SELE_EQ BIT(3) // Extern Queue -+ -+#define PageNum_128(_Len) (u32)(((_Len)>>7) + ((_Len)&0x7F ? 1:0)) -+#define PageNum_256(_Len) (u32)(((_Len)>>8) + ((_Len)&0xFF ? 1:0)) -+#define PageNum_512(_Len) (u32)(((_Len)>>9) + ((_Len)&0x1FF ? 1:0)) -+#define PageNum(_Len, _Size) (u32)(((_Len)/(_Size)) + ((_Len)&((_Size) - 1) ? 1:0)) -+ -+ -+void dump_chip_info(HAL_VERSION ChipVersion); -+ -+u8 //return the final channel plan decision -+hal_com_get_channel_plan( -+ PADAPTER padapter, -+ u8 hw_channel_plan, //channel plan from HW (efuse/eeprom) -+ u8 sw_channel_plan, //channel plan from SW (registry/module param) -+ u8 def_channel_plan, //channel plan used when the former two is invalid -+ bool AutoLoadFail -+ ); -+ -+bool -+HAL_IsLegalChannel( -+ PADAPTER Adapter, -+ u32 Channel -+ ); -+ -+u8 MRateToHwRate(u8 rate); -+ -+void HalSetBrateCfg( -+ PADAPTER Adapter, -+ u8 *mBratesOS, -+ u16 *pBrateCfg); -+ -+bool -+Hal_MappingOutPipe( -+ PADAPTER pAdapter, -+ u8 NumOutPipe -+ ); -+ -+void hal_init_macaddr(_adapter *adapter); -+ -+void c2h_evt_clear(_adapter *adapter); -+s32 c2h_evt_read(_adapter *adapter, u8 *buf); -+ -+u8 rtw_hal_networktype_to_raid(_adapter *adapter,unsigned char network_type); -+u8 rtw_get_mgntframe_raid(_adapter *adapter,unsigned char network_type); -+#endif //__HAL_COMMON_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_com_led.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com_led.h ---- linux-4.14.17/3rdparty/rtl8812au/include/hal_com_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com_led.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,264 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_COMMON_LED_H_ -+#define __HAL_COMMON_LED_H_ -+ -+ -+#define MSECS(t) (HZ * ((t) / 1000) + (HZ * ((t) % 1000)) / 1000) -+ -+//================================================================================ -+// LED Behavior Constant. -+//================================================================================ -+// Default LED behavior. -+// -+#define LED_BLINK_NORMAL_INTERVAL 100 -+#define LED_BLINK_SLOWLY_INTERVAL 200 -+#define LED_BLINK_LONG_INTERVAL 400 -+#define LED_INITIAL_INTERVAL 1800 -+ -+// LED Customerization -+ -+//NETTRONIX -+#define LED_BLINK_NORMAL_INTERVAL_NETTRONIX 100 -+#define LED_BLINK_SLOWLY_INTERVAL_NETTRONIX 2000 -+ -+//PORNET -+#define LED_BLINK_SLOWLY_INTERVAL_PORNET 1000 -+#define LED_BLINK_NORMAL_INTERVAL_PORNET 100 -+#define LED_BLINK_FAST_INTERVAL_BITLAND 30 -+ -+//AzWave. -+#define LED_CM2_BLINK_ON_INTERVAL 250 -+#define LED_CM2_BLINK_OFF_INTERVAL 4750 -+#define LED_CM8_BLINK_OFF_INTERVAL 3750 //for QMI -+ -+//RunTop -+#define LED_RunTop_BLINK_INTERVAL 300 -+ -+//ALPHA -+#define LED_BLINK_NO_LINK_INTERVAL_ALPHA 1000 -+#define LED_BLINK_NO_LINK_INTERVAL_ALPHA_500MS 500 //add by ylb 20121012 for customer led for alpha -+#define LED_BLINK_LINK_INTERVAL_ALPHA 500 //500 -+#define LED_BLINK_SCAN_INTERVAL_ALPHA 180 //150 -+#define LED_BLINK_FASTER_INTERVAL_ALPHA 50 -+#define LED_BLINK_WPS_SUCESS_INTERVAL_ALPHA 5000 -+ -+// 111122 by hpfan: Customized for Xavi -+#define LED_CM11_BLINK_INTERVAL 300 -+#define LED_CM11_LINK_ON_INTERVEL 3000 -+ -+//Netgear -+#define LED_BLINK_LINK_INTERVAL_NETGEAR 500 -+#define LED_BLINK_LINK_SLOWLY_INTERVAL_NETGEAR 1000 -+ -+#define LED_WPS_BLINK_OFF_INTERVAL_NETGEAR 100 -+#define LED_WPS_BLINK_ON_INTERVAL_NETGEAR 500 -+ -+//Belkin AC950 -+#define LED_BLINK_LINK_INTERVAL_ON_BELKIN 200 -+#define LED_BLINK_LINK_INTERVAL_OFF_BELKIN 100 -+#define LED_BLINK_ERROR_INTERVAL_BELKIN 100 -+ -+//by chiyokolin for Azurewave -+#define LED_CM12_BLINK_INTERVAL_5Mbps 160 -+#define LED_CM12_BLINK_INTERVAL_10Mbps 80 -+#define LED_CM12_BLINK_INTERVAL_20Mbps 50 -+#define LED_CM12_BLINK_INTERVAL_40Mbps 40 -+#define LED_CM12_BLINK_INTERVAL_80Mbps 30 -+#define LED_CM12_BLINK_INTERVAL_MAXMbps 25 -+ -+//================================================================================ -+// LED object. -+//================================================================================ -+ -+typedef enum _LED_CTL_MODE{ -+ LED_CTL_POWER_ON = 1, -+ LED_CTL_LINK = 2, -+ LED_CTL_NO_LINK = 3, -+ LED_CTL_TX = 4, -+ LED_CTL_RX = 5, -+ LED_CTL_SITE_SURVEY = 6, -+ LED_CTL_POWER_OFF = 7, -+ LED_CTL_START_TO_LINK = 8, -+ LED_CTL_START_WPS = 9, -+ LED_CTL_STOP_WPS = 10, -+ LED_CTL_START_WPS_BOTTON = 11, //added for runtop -+ LED_CTL_STOP_WPS_FAIL = 12, //added for ALPHA -+ LED_CTL_STOP_WPS_FAIL_OVERLAP = 13, //added for BELKIN -+ LED_CTL_CONNECTION_NO_TRANSFER = 14, -+}LED_CTL_MODE; -+ -+typedef enum _LED_STATE{ -+ LED_UNKNOWN = 0, -+ RTW_LED_ON = 1, -+ RTW_LED_OFF = 2, -+ LED_BLINK_NORMAL = 3, -+ LED_BLINK_SLOWLY = 4, -+ LED_BLINK_POWER_ON = 5, -+ LED_BLINK_SCAN = 6, // LED is blinking during scanning period, the # of times to blink is depend on time for scanning. -+ LED_BLINK_NO_LINK = 7, // LED is blinking during no link state. -+ LED_BLINK_StartToBlink = 8, // Customzied for Sercomm Printer Server case -+ LED_BLINK_TXRX = 9, -+ LED_BLINK_WPS = 10, // LED is blinkg during WPS communication -+ LED_BLINK_WPS_STOP = 11, //for ALPHA -+ LED_BLINK_WPS_STOP_OVERLAP = 12, //for BELKIN -+ LED_BLINK_RUNTOP = 13, // Customized for RunTop -+ LED_BLINK_CAMEO = 14, -+ LED_BLINK_XAVI = 15, -+ LED_BLINK_ALWAYS_ON = 16, -+ LED_BLINK_LINK_IN_PROCESS = 17, //Customized for Belkin AC950 -+ LED_BLINK_AUTH_ERROR = 18, //Customized for Belkin AC950 -+ LED_BLINK_Azurewave_5Mbps = 19, -+ LED_BLINK_Azurewave_10Mbps = 20, -+ LED_BLINK_Azurewave_20Mbps = 21, -+ LED_BLINK_Azurewave_40Mbps = 22, -+ LED_BLINK_Azurewave_80Mbps = 23, -+ LED_BLINK_Azurewave_MAXMbps = 24, -+}LED_STATE; -+ -+typedef enum _LED_PIN{ -+ LED_PIN_GPIO0, -+ LED_PIN_LED0, -+ LED_PIN_LED1, -+ LED_PIN_LED2 -+}LED_PIN; -+ -+ -+//================================================================================ -+// PCIE LED Definition. -+//================================================================================ -+ -+#define IS_LED_WPS_BLINKING(_LED_USB) (((PLED_USB)_LED_USB)->CurrLedState==LED_BLINK_WPS \ -+ || ((PLED_USB)_LED_USB)->CurrLedState==LED_BLINK_WPS_STOP \ -+ || ((PLED_USB)_LED_USB)->bLedWPSBlinkInProgress) -+ -+#define IS_LED_BLINKING(_LED_USB) (((PLED_USB)_LED_USB)->bLedWPSBlinkInProgress \ -+ ||((PLED_USB)_LED_USB)->bLedScanBlinkInProgress) -+ -+ -+typedef enum _LED_STRATEGY_USB{ -+ SW_LED_MODE0, // SW control 1 LED via GPIO0. It is default option. -+ SW_LED_MODE1, // 2 LEDs, through LED0 and LED1. For ALPHA. -+ SW_LED_MODE2, // SW control 1 LED via GPIO0, customized for AzWave 8187 minicard. -+ SW_LED_MODE3, // SW control 1 LED via GPIO0, customized for Sercomm Printer Server case. -+ SW_LED_MODE4, //for Edimax / Belkin -+ SW_LED_MODE5, //for Sercomm / Belkin -+ SW_LED_MODE6, //for 88CU minicard, porting from ce SW_LED_MODE7 -+ SW_LED_MODE7, //for Netgear special requirement -+ SW_LED_MODE8, //for LC -+ SW_LED_MODE9, //for Belkin AC950 -+ SW_LED_MODE10, //for Netgear A6200V2 -+ SW_LED_MODE11, //for Edimax / ASUS -+ SW_LED_MODE12, //for WNC/NEC -+ SW_LED_MODE13, //for Netgear A6100, 8811Au -+ HW_LED, // HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes, see MAC.CONFIG1 for details.) -+}LED_STRATEGY_USB, *PLED_STRATEGY_USB; -+ -+typedef struct _LED_USB{ -+ PADAPTER padapter; -+ -+ LED_PIN LedPin; // Identify how to implement this SW led. -+ -+ LED_STATE CurrLedState; // Current LED state. -+ bool bLedOn; // TRUE if LED is ON, FALSE if LED is OFF. -+ -+ bool bSWLedCtrl; -+ -+ bool bLedBlinkInProgress; // TRUE if it is blinking, FALSE o.w.. -+ // ALPHA, added by chiyoko, 20090106 -+ bool bLedNoLinkBlinkInProgress; -+ bool bLedLinkBlinkInProgress; -+ bool bLedStartToLinkBlinkInProgress; -+ bool bLedScanBlinkInProgress; -+ bool bLedWPSBlinkInProgress; -+ -+ u32 BlinkTimes; // Number of times to toggle led state for blinking. -+ u8 BlinkCounter; //Added for turn off overlap led after blinking a while, by page, 20120821 -+ LED_STATE BlinkingLedState; // Next state for blinking, either LED_ON or LED_OFF are. -+ -+ _timer BlinkTimer; // Timer object for led blinking. -+ -+ _workitem BlinkWorkItem; // Workitem used by BlinkTimer to manipulate H/W to blink LED. -+} LED_USB, *PLED_USB; -+ -+typedef struct _LED_USB LED_DATA, *PLED_DATA; -+typedef enum _LED_STRATEGY_USB LED_STRATEGY, *PLED_STRATEGY; -+ -+void -+LedControlUSB( -+ PADAPTER Adapter, -+ LED_CTL_MODE LedAction -+ ); -+ -+struct led_priv{ -+ /* add for led controll */ -+ LED_DATA SwLed0; -+ LED_DATA SwLed1; -+ LED_DATA SwLed2; -+ LED_STRATEGY LedStrategy; -+ u8 bRegUseLed; -+ void (*LedControlHandler)(_adapter *padapter, LED_CTL_MODE LedAction); -+ void (*SwLedOn)(_adapter *padapter, PLED_DATA pLed); -+ void (*SwLedOff)(_adapter *padapter, PLED_DATA pLed); -+ /* add for led controll */ -+}; -+ -+#ifdef CONFIG_SW_LED -+#define rtw_led_control(adapter, LedAction) \ -+ do { \ -+ if((adapter)->ledpriv.LedControlHandler) \ -+ (adapter)->ledpriv.LedControlHandler((adapter), (LedAction)); \ -+ } while(0) -+#else //CONFIG_SW_LED -+#define rtw_led_control(adapter, LedAction) -+#endif //CONFIG_SW_LED -+ -+#define SwLedOn(adapter, pLed) \ -+ do { \ -+ if((adapter)->ledpriv.SwLedOn) \ -+ (adapter)->ledpriv.SwLedOn((adapter), (pLed)); \ -+ } while(0) -+ -+#define SwLedOff(adapter, pLed) \ -+ do { \ -+ if((adapter)->ledpriv.SwLedOff) \ -+ (adapter)->ledpriv.SwLedOff((adapter), (pLed)); \ -+ } while(0) -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+void BlinkTimerCallback(void *data); -+#else -+void BlinkTimerCallback(struct timer_list *t); -+#endif -+void BlinkWorkItemCallback(_workitem *work); -+ -+void ResetLedStatus(PLED_DATA pLed); -+ -+void -+InitLed( -+ _adapter *padapter, -+ PLED_DATA pLed, -+ LED_PIN LedPin -+ ); -+ -+void -+DeInitLed( -+ PLED_DATA pLed -+ ); -+ -+//hal... -+extern void BlinkHandler(PLED_DATA pLed); -+ -+#endif //__RTW_LED_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_com_phycfg.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com_phycfg.h ---- linux-4.14.17/3rdparty/rtl8812au/include/hal_com_phycfg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com_phycfg.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,68 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_COM_PHYCFG_H__ -+#define __HAL_COM_PHYCFG_H__ -+ -+ -+#define MAX_POWER_INDEX 0x3F -+ -+typedef enum _REGULATION_TXPWR_LMT { -+ TXPWR_LMT_FCC = 0, -+ TXPWR_LMT_MKK, -+ TXPWR_LMT_ETSI, -+} REGULATION_TXPWR_LMT; -+ -+/*------------------------------Define structure----------------------------*/ -+typedef struct _BB_REGISTER_DEFINITION{ -+ u32 rfintfs; // set software control: -+ // 0x870~0x877[8 bytes] -+ -+ u32 rfintfo; // output data: -+ // 0x860~0x86f [16 bytes] -+ -+ u32 rfintfe; // output enable: -+ // 0x860~0x86f [16 bytes] -+ -+ u32 rf3wireOffset; // LSSI data: -+ // 0x840~0x84f [16 bytes] -+ -+ u32 rfHSSIPara2; // wire parameter control2 : -+ // 0x824~0x827,0x82c~0x82f, 0x834~0x837, 0x83c~0x83f [16 bytes] -+ -+ u32 rfLSSIReadBack; //LSSI RF readback data SI mode -+ // 0x8a0~0x8af [16 bytes] -+ -+ u32 rfLSSIReadBackPi; //LSSI RF readback data PI mode 0x8b8-8bc for Path A and B -+ -+}BB_REGISTER_DEFINITION_T, *PBB_REGISTER_DEFINITION_T; -+ -+#ifndef CONFIG_EMBEDDED_FWIMG -+int phy_ConfigMACWithParaFile(PADAPTER Adapter, u8* pFileName); -+ -+int PHY_ConfigBBWithPowerLimitTableParaFile(PADAPTER Adapter, s8* pFileName); -+ -+int phy_ConfigBBWithParaFile(PADAPTER Adapter, u8* pFileName); -+ -+int phy_ConfigBBWithPgParaFile(PADAPTER Adapter, u8* pFileName); -+ -+int phy_ConfigBBWithMpParaFile(PADAPTER Adapter, u8* pFileName); -+ -+int PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, u8* pFileName, u8 eRFPath); -+ -+int PHY_ConfigRFWithTxPwrTrackParaFile(PADAPTER Adapter, u8* pFileName); -+#endif -+ -+ -+#endif //__HAL_COMMON_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_com_reg.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com_reg.h ---- linux-4.14.17/3rdparty/rtl8812au/include/hal_com_reg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_com_reg.h 2018-02-06 17:42:30.718967283 +0200 -@@ -0,0 +1,1697 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_COMMON_REG_H__ -+#define __HAL_COMMON_REG_H__ -+ -+ -+#define MAC_ADDR_LEN 6 -+ -+#define HAL_NAV_UPPER_UNIT 128 // micro-second -+ -+// 8188E PKT_BUFF_ACCESS_CTRL value -+#define TXPKT_BUF_SELECT 0x69 -+#define RXPKT_BUF_SELECT 0xA5 -+#define DISABLE_TRXPKT_BUF_ACCESS 0x0 -+ -+//============================================================ -+// -+//============================================================ -+ -+//----------------------------------------------------- -+// -+// 0x0000h ~ 0x00FFh System Configuration -+// -+//----------------------------------------------------- -+#define REG_SYS_ISO_CTRL 0x0000 -+#define REG_SYS_FUNC_EN 0x0002 -+#define REG_APS_FSMCO 0x0004 -+#define REG_SYS_CLKR 0x0008 -+#define REG_9346CR 0x000A -+#define REG_SYS_EEPROM_CTRL 0x000A -+#define REG_EE_VPD 0x000C -+#define REG_AFE_MISC 0x0010 -+#define REG_SPS0_CTRL 0x0011 -+#define REG_SPS0_CTRL_6 0x0016 -+#define REG_POWER_OFF_IN_PROCESS 0x0017 -+#define REG_SPS_OCP_CFG 0x0018 -+#define REG_RSV_CTRL 0x001C -+#define REG_RF_CTRL 0x001F -+#define REG_LDOA15_CTRL 0x0020 -+#define REG_LDOV12D_CTRL 0x0021 -+#define REG_LDOHCI12_CTRL 0x0022 -+#define REG_LPLDO_CTRL 0x0023 -+#define REG_AFE_XTAL_CTRL 0x0024 -+#define REG_AFE_LDO_CTRL 0x0027 // 1.5v for 8188EE test chip, 1.4v for MP chip -+#define REG_AFE_PLL_CTRL 0x0028 -+#define REG_MAC_PHY_CTRL 0x002c //for 92d, DMDP,SMSP,DMSP contrl -+#define REG_APE_PLL_CTRL_EXT 0x002c -+#define REG_EFUSE_CTRL 0x0030 -+#define REG_EFUSE_TEST 0x0034 -+#define REG_PWR_DATA 0x0038 -+#define REG_CAL_TIMER 0x003C -+#define REG_ACLK_MON 0x003E -+#define REG_GPIO_MUXCFG 0x0040 -+#define REG_GPIO_IO_SEL 0x0042 -+#define REG_MAC_PINMUX_CFG 0x0043 -+#define REG_GPIO_PIN_CTRL 0x0044 -+#define REG_GPIO_INTM 0x0048 -+#define REG_LEDCFG0 0x004C -+#define REG_LEDCFG1 0x004D -+#define REG_LEDCFG2 0x004E -+#define REG_LEDCFG3 0x004F -+#define REG_FSIMR 0x0050 -+#define REG_FSISR 0x0054 -+#define REG_HSIMR 0x0058 -+#define REG_HSISR 0x005c -+#define REG_GPIO_PIN_CTRL_2 0x0060 // RTL8723 WIFI/BT/GPS Multi-Function GPIO Pin Control. -+#define REG_GPIO_IO_SEL_2 0x0062 // RTL8723 WIFI/BT/GPS Multi-Function GPIO Select. -+#define REG_MULTI_FUNC_CTRL 0x0068 // RTL8723 WIFI/BT/GPS Multi-Function control source. -+#define REG_GSSR 0x006c -+#define REG_AFE_XTAL_CTRL_EXT 0x0078 //RTL8188E -+#define REG_XCK_OUT_CTRL 0x007c //RTL8188E -+#define REG_MCUFWDL 0x0080 -+#define REG_WOL_EVENT 0x0081 //RTL8188E -+#define REG_MCUTSTCFG 0x0084 -+#define REG_FDHM0 0x0088 -+#define REG_HOST_SUSP_CNT 0x00BC // RTL8192C Host suspend counter on FPGA platform -+#define REG_SYSTEM_ON_CTRL 0x00CC // For 8723AE Reset after S3 -+#define REG_EFUSE_ACCESS 0x00CF // Efuse access protection for RTL8723 -+#define REG_BIST_SCAN 0x00D0 -+#define REG_BIST_RPT 0x00D4 -+#define REG_BIST_ROM_RPT 0x00D8 -+#define REG_USB_SIE_INTF 0x00E0 -+#define REG_PCIE_MIO_INTF 0x00E4 -+#define REG_PCIE_MIO_INTD 0x00E8 -+#define REG_HPON_FSM 0x00EC -+#define REG_SYS_CFG 0x00F0 -+#define REG_GPIO_OUTSTS 0x00F4 // For RTL8723 only. -+#define REG_TYPE_ID 0x00FC -+ -+ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+#define REG_CR 0x0100 -+#define REG_PBP 0x0104 -+#define REG_PKT_BUFF_ACCESS_CTRL 0x0106 -+#define REG_TRXDMA_CTRL 0x010C -+#define REG_TRXFF_BNDY 0x0114 -+#define REG_TRXFF_STATUS 0x0118 -+#define REG_RXFF_PTR 0x011C -+#define REG_HIMR 0x0120 -+#define REG_HISR 0x0124 -+#define REG_HIMRE 0x0128 -+#define REG_HISRE 0x012C -+#define REG_CPWM 0x012F -+#define REG_FWIMR 0x0130 -+#define REG_FWISR 0x0134 -+#define REG_FTIMR 0x0138 -+#define REG_FTISR 0x013C //RTL8192C -+#define REG_PKTBUF_DBG_CTRL 0x0140 -+#define REG_RXPKTBUF_CTRL (REG_PKTBUF_DBG_CTRL+2) -+#define REG_PKTBUF_DBG_DATA_L 0x0144 -+#define REG_PKTBUF_DBG_DATA_H 0x0148 -+ -+#define REG_TC0_CTRL 0x0150 -+#define REG_TC1_CTRL 0x0154 -+#define REG_TC2_CTRL 0x0158 -+#define REG_TC3_CTRL 0x015C -+#define REG_TC4_CTRL 0x0160 -+#define REG_TCUNIT_BASE 0x0164 -+#define REG_MBIST_START 0x0174 -+#define REG_MBIST_DONE 0x0178 -+#define REG_MBIST_FAIL 0x017C -+#define REG_32K_CTRL 0x0194 //RTL8188E -+#define REG_C2HEVT_MSG_NORMAL 0x01A0 -+#define REG_C2HEVT_CLEAR 0x01AF -+#define REG_MCUTST_1 0x01c0 -+#define REG_MCUTST_WOWLAN 0x01C7 // Defined after 8188E series. -+#define REG_FMETHR 0x01C8 -+#define REG_HMETFR 0x01CC -+#define REG_HMEBOX_0 0x01D0 -+#define REG_HMEBOX_1 0x01D4 -+#define REG_HMEBOX_2 0x01D8 -+#define REG_HMEBOX_3 0x01DC -+#define REG_LLT_INIT 0x01E0 -+ -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_RQPN 0x0200 -+#define REG_FIFOPAGE 0x0204 -+#define REG_TDECTRL 0x0208 -+#define REG_TXDMA_OFFSET_CHK 0x020C -+#define REG_TXDMA_STATUS 0x0210 -+#define REG_RQPN_NPQ 0x0214 -+ -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_RXDMA_AGG_PG_TH 0x0280 -+#define REG_RXPKT_NUM 0x0284 -+#define REG_RXDMA_STATUS 0x0288 -+ -+//----------------------------------------------------- -+// -+// 0x0300h ~ 0x03FFh PCIe -+// -+//----------------------------------------------------- -+#define REG_PCIE_CTRL_REG 0x0300 -+#define REG_INT_MIG 0x0304 // Interrupt Migration -+#define REG_BCNQ_DESA 0x0308 // TX Beacon Descriptor Address -+#define REG_HQ_DESA 0x0310 // TX High Queue Descriptor Address -+#define REG_MGQ_DESA 0x0318 // TX Manage Queue Descriptor Address -+#define REG_VOQ_DESA 0x0320 // TX VO Queue Descriptor Address -+#define REG_VIQ_DESA 0x0328 // TX VI Queue Descriptor Address -+#define REG_BEQ_DESA 0x0330 // TX BE Queue Descriptor Address -+#define REG_BKQ_DESA 0x0338 // TX BK Queue Descriptor Address -+#define REG_RX_DESA 0x0340 // RX Queue Descriptor Address -+//sherry added for DBI Read/Write 20091126 -+#define REG_DBI_WDATA 0x0348 // Backdoor REG for Access Configuration -+#define REG_DBI_RDATA 0x034C //Backdoor REG for Access Configuration -+#define REG_DBI_CTRL 0x0350 //Backdoor REG for Access Configuration -+#define REG_DBI_FLAG 0x0352 //Backdoor REG for Access Configuration -+#define REG_MDIO 0x0354 // MDIO for Access PCIE PHY -+#define REG_DBG_SEL 0x0360 // Debug Selection Register -+#define REG_PCIE_HRPWM 0x0361 //PCIe RPWM -+#define REG_PCIE_HCPWM 0x0363 //PCIe CPWM -+#define REG_WATCH_DOG 0x0368 -+ -+// RTL8723 series ------------------------------- -+#define REG_PCIE_HISR_EN 0x0394 //PCIE Local Interrupt Enable Register -+#define REG_PCIE_HISR 0x03A0 -+#define REG_PCIE_HISRE 0x03A4 -+#define REG_PCIE_HIMR 0x03A8 -+#define REG_PCIE_HIMRE 0x03AC -+ -+#define REG_USB_HIMR 0xFE38 -+#define REG_USB_HIMRE 0xFE3C -+#define REG_USB_HISR 0xFE78 -+#define REG_USB_HISRE 0xFE7C -+ -+ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+#define REG_VOQ_INFORMATION 0x0400 -+#define REG_VIQ_INFORMATION 0x0404 -+#define REG_BEQ_INFORMATION 0x0408 -+#define REG_BKQ_INFORMATION 0x040C -+#define REG_MGQ_INFORMATION 0x0410 -+#define REG_HGQ_INFORMATION 0x0414 -+#define REG_BCNQ_INFORMATION 0x0418 -+#define REG_TXPKT_EMPTY 0x041A -+#define REG_CPU_MGQ_INFORMATION 0x041C -+#define REG_FWHW_TXQ_CTRL 0x0420 -+#define REG_HWSEQ_CTRL 0x0423 -+#define REG_BCNQ_BDNY 0x0424 -+#define REG_MGQ_BDNY 0x0425 -+#define REG_LIFETIME_CTRL 0x0426 -+#define REG_MULTI_BCNQ_OFFSET 0x0427 -+#define REG_SPEC_SIFS 0x0428 -+#define REG_RL 0x042A -+#define REG_DARFRC 0x0430 -+#define REG_RARFRC 0x0438 -+#define REG_RRSR 0x0440 -+#define REG_ARFR0 0x0444 -+#define REG_ARFR1 0x0448 -+#define REG_ARFR2 0x044C -+#define REG_ARFR3 0x0450 -+#define REG_BCNQ1_BDNY 0x0457 -+ -+#define REG_AGGLEN_LMT 0x0458 -+#define REG_AMPDU_MIN_SPACE 0x045C -+#define REG_WMAC_LBK_BF_HD 0x045D -+#define REG_FAST_EDCA_CTRL 0x0460 -+#define REG_RD_RESP_PKT_TH 0x0463 -+ -+#define REG_INIRTS_RATE_SEL 0x0480 -+#define REG_INIDATA_RATE_SEL 0x0484 -+ -+#define REG_POWER_STAGE1 0x04B4 -+#define REG_POWER_STAGE2 0x04B8 -+#define REG_PKT_VO_VI_LIFE_TIME 0x04C0 -+#define REG_PKT_BE_BK_LIFE_TIME 0x04C2 -+#define REG_STBC_SETTING 0x04C4 -+#define REG_QUEUE_CTRL 0x04C6 -+#define REG_PROT_MODE_CTRL 0x04C8 -+#define REG_MAX_AGGR_NUM 0x04CA -+#define REG_RTS_MAX_AGGR_NUM 0x04CB -+#define REG_BAR_MODE_CTRL 0x04CC -+#define REG_RA_TRY_RATE_AGG_LMT 0x04CF -+#define REG_EARLY_MODE_CONTROL 0x04D0 -+#define REG_NQOS_SEQ 0x04DC -+#define REG_QOS_SEQ 0x04DE -+#define REG_NEED_CPU_HANDLE 0x04E0 -+#define REG_PKT_LOSE_RPT 0x04E1 -+#define REG_PTCL_ERR_STATUS 0x04E2 -+#define REG_TX_RPT_CTRL 0x04EC -+#define REG_TX_RPT_TIME 0x04F0 // 2 byte -+#define REG_DUMMY 0x04FC -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+#define REG_EDCA_VO_PARAM 0x0500 -+#define REG_EDCA_VI_PARAM 0x0504 -+#define REG_EDCA_BE_PARAM 0x0508 -+#define REG_EDCA_BK_PARAM 0x050C -+#define REG_BCNTCFG 0x0510 -+#define REG_PIFS 0x0512 -+#define REG_RDG_PIFS 0x0513 -+#define REG_SIFS_CTX 0x0514 -+#define REG_SIFS_TRX 0x0516 -+#define REG_TSFTR_SYN_OFFSET 0x0518 -+#define REG_AGGR_BREAK_TIME 0x051A -+#define REG_SLOT 0x051B -+#define REG_TX_PTCL_CTRL 0x0520 -+#define REG_TXPAUSE 0x0522 -+#define REG_DIS_TXREQ_CLR 0x0523 -+#define REG_RD_CTRL 0x0524 -+// -+// Format for offset 540h-542h: -+// [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. -+// [7:4]: Reserved. -+// [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. -+// [23:20]: Reserved -+// Description: -+// | -+// |<--Setup--|--Hold------------>| -+// --------------|---------------------- -+// | -+// TBTT -+// Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. -+// Described by Designer Tim and Bruce, 2011-01-14. -+// -+#define REG_TBTT_PROHIBIT 0x0540 -+#define REG_RD_NAV_NXT 0x0544 -+#define REG_NAV_PROT_LEN 0x0546 -+#define REG_BCN_CTRL 0x0550 -+#define REG_BCN_CTRL_1 0x0551 -+#define REG_MBID_NUM 0x0552 -+#define REG_DUAL_TSF_RST 0x0553 -+#define REG_BCN_INTERVAL 0x0554 // The same as REG_MBSSID_BCN_SPACE -+#define REG_DRVERLYINT 0x0558 -+#define REG_BCNDMATIM 0x0559 -+#define REG_ATIMWND 0x055A -+#define REG_USTIME_TSF 0x055C -+#define REG_BCN_MAX_ERR 0x055D -+#define REG_RXTSF_OFFSET_CCK 0x055E -+#define REG_RXTSF_OFFSET_OFDM 0x055F -+#define REG_TSFTR 0x0560 -+#define REG_TSFTR1 0x0568 // HW Port 1 TSF Register -+#define REG_ATIMWND_1 0x0570 -+#define REG_P2P_CTWIN 0x0572 // 1 Byte long (in unit of TU) -+#define REG_PSTIMER 0x0580 -+#define REG_TIMER0 0x0584 -+#define REG_TIMER1 0x0588 -+#define REG_ACMHWCTRL 0x05C0 -+#define REG_NOA_DESC_SEL 0x05CF -+#define REG_NOA_DESC_DURATION 0x05E0 -+#define REG_NOA_DESC_INTERVAL 0x05E4 -+#define REG_NOA_DESC_START 0x05E8 -+#define REG_NOA_DESC_COUNT 0x05EC -+ -+#define REG_DMC 0x05F0 //Dual MAC Co-Existence Register -+#define REG_SCH_TX_CMD 0x05F8 -+ -+#define REG_FW_RESET_TSF_CNT_1 0x05FC -+#define REG_FW_RESET_TSF_CNT_0 0x05FD -+#define REG_FW_BCN_DIS_CNT 0x05FE -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+#define REG_APSD_CTRL 0x0600 -+#define REG_BWOPMODE 0x0603 -+#define REG_TCR 0x0604 -+#define REG_RCR 0x0608 -+#define REG_RX_PKT_LIMIT 0x060C -+#define REG_RX_DLK_TIME 0x060D -+#define REG_RX_DRVINFO_SZ 0x060F -+ -+#define REG_MACID 0x0610 -+#define REG_BSSID 0x0618 -+#define REG_MAR 0x0620 -+#define REG_MBIDCAMCFG 0x0628 -+ -+#define REG_USTIME_EDCA 0x0638 -+#define REG_MAC_SPEC_SIFS 0x063A -+// 20100719 Joseph: Hardware register definition change. (HW datasheet v54) -+#define REG_RESP_SIFS_CCK 0x063C // [15:8]SIFS_R2T_OFDM, [7:0]SIFS_R2T_CCK -+#define REG_RESP_SIFS_OFDM 0x063E // [15:8]SIFS_T2T_OFDM, [7:0]SIFS_T2T_CCK -+ -+#define REG_ACKTO 0x0640 -+#define REG_CTS2TO 0x0641 -+#define REG_EIFS 0x0642 -+ -+ -+//RXERR_RPT -+#define RXERR_TYPE_OFDM_PPDU 0 -+#define RXERR_TYPE_OFDMfalse_ALARM 1 -+#define RXERR_TYPE_OFDM_MPDU_OK 2 -+#define RXERR_TYPE_OFDM_MPDU_FAIL 3 -+#define RXERR_TYPE_CCK_PPDU 4 -+#define RXERR_TYPE_CCKfalse_ALARM 5 -+#define RXERR_TYPE_CCK_MPDU_OK 6 -+#define RXERR_TYPE_CCK_MPDU_FAIL 7 -+#define RXERR_TYPE_HT_PPDU 8 -+#define RXERR_TYPE_HTfalse_ALARM 9 -+#define RXERR_TYPE_HT_MPDU_TOTAL 10 -+#define RXERR_TYPE_HT_MPDU_OK 11 -+#define RXERR_TYPE_HT_MPDU_FAIL 12 -+#define RXERR_TYPE_RX_FULL_DROP 15 -+ -+#define RXERR_COUNTER_MASK 0xFFFFF -+#define RXERR_RPT_RST BIT(27) -+#define _RXERR_RPT_SEL(type) ((type) << 28) -+ -+// -+// Note: -+// The NAV upper value is very important to WiFi 11n 5.2.3 NAV test. The default value is -+// always too small, but the WiFi TestPlan test by 25,000 microseconds of NAV through sending -+// CTS in the air. We must update this value greater than 25,000 microseconds to pass the item. -+// The offset of NAV_UPPER in 8192C Spec is incorrect, and the offset should be 0x0652. Commented -+// by SD1 Scott. -+// By Bruce, 2011-07-18. -+// -+#define REG_NAV_UPPER 0x0652 // unit of 128 -+ -+//WMA, BA, CCX -+#define REG_NAV_CTRL 0x0650 -+#define REG_BACAMCMD 0x0654 -+#define REG_BACAMCONTENT 0x0658 -+#define REG_LBDLY 0x0660 -+#define REG_FWDLY 0x0661 -+#define REG_RXERR_RPT 0x0664 -+#define REG_WMAC_TRXPTCL_CTL 0x0668 -+ -+// Security -+#define REG_CAMCMD 0x0670 -+#define REG_CAMWRITE 0x0674 -+#define REG_CAMREAD 0x0678 -+#define REG_CAMDBG 0x067C -+#define REG_SECCFG 0x0680 -+ -+// Power -+#define REG_WOW_CTRL 0x0690 -+#define REG_PS_RX_INFO 0x0692 -+#define REG_UAPSD_TID 0x0693 -+#define REG_WKFMCAM_CMD 0x0698 -+#define REG_WKFMCAM_NUM REG_WKFMCAM_CMD -+#define REG_WKFMCAM_RWD 0x069C -+#define REG_RXFLTMAP0 0x06A0 -+#define REG_RXFLTMAP1 0x06A2 -+#define REG_RXFLTMAP2 0x06A4 -+#define REG_BCN_PSR_RPT 0x06A8 -+#define REG_BT_COEX_TABLE 0x06C0 -+ -+// Hardware Port 2 -+#define REG_MACID1 0x0700 -+#define REG_BSSID1 0x0708 -+ -+ -+//----------------------------------------------------- -+// -+// 0xFE00h ~ 0xFE55h USB Configuration -+// -+//----------------------------------------------------- -+#define REG_USB_INFO 0xFE17 -+#define REG_USB_SPECIAL_OPTION 0xFE55 -+#define REG_USB_DMA_AGG_TO 0xFE5B -+#define REG_USB_AGG_TO 0xFE5C -+#define REG_USB_AGG_TH 0xFE5D -+ -+#define REG_USB_HRPWM 0xFE58 -+#define REG_USB_HCPWM 0xFE57 -+ -+// for 92DU high_Queue low_Queue Normal_Queue select -+#define REG_USB_High_NORMAL_Queue_Select_MAC0 0xFE44 -+//#define REG_USB_LOW_Queue_Select_MAC0 0xFE45 -+#define REG_USB_High_NORMAL_Queue_Select_MAC1 0xFE47 -+//#define REG_USB_LOW_Queue_Select_MAC1 0xFE48 -+ -+// For test chip -+#define REG_TEST_USB_TXQS 0xFE48 -+#define REG_TEST_SIE_VID 0xFE60 // 0xFE60~0xFE61 -+#define REG_TEST_SIE_PID 0xFE62 // 0xFE62~0xFE63 -+#define REG_TEST_SIE_OPTIONAL 0xFE64 -+#define REG_TEST_SIE_CHIRP_K 0xFE65 -+#define REG_TEST_SIE_PHY 0xFE66 // 0xFE66~0xFE6B -+#define REG_TEST_SIE_MAC_ADDR 0xFE70 // 0xFE70~0xFE75 -+#define REG_TEST_SIE_STRING 0xFE80 // 0xFE80~0xFEB9 -+ -+ -+// For normal chip -+#define REG_NORMAL_SIE_VID 0xFE60 // 0xFE60~0xFE61 -+#define REG_NORMAL_SIE_PID 0xFE62 // 0xFE62~0xFE63 -+#define REG_NORMAL_SIE_OPTIONAL 0xFE64 -+#define REG_NORMAL_SIE_EP 0xFE65 // 0xFE65~0xFE67 -+#define REG_NORMAL_SIE_PHY 0xFE68 // 0xFE68~0xFE6B -+#define REG_NORMAL_SIE_OPTIONAL2 0xFE6C -+#define REG_NORMAL_SIE_GPS_EP 0xFE6D // 0xFE6D, for RTL8723 only. -+#define REG_NORMAL_SIE_MAC_ADDR 0xFE70 // 0xFE70~0xFE75 -+#define REG_NORMAL_SIE_STRING 0xFE80 // 0xFE80~0xFEDF -+ -+ -+//----------------------------------------------------- -+// -+// Redifine 8192C register definition for compatibility -+// -+//----------------------------------------------------- -+ -+// TODO: use these definition when using REG_xxx naming rule. -+// NOTE: DO NOT Remove these definition. Use later. -+ -+#define EFUSE_CTRL REG_EFUSE_CTRL // E-Fuse Control. -+#define EFUSE_TEST REG_EFUSE_TEST // E-Fuse Test. -+#define MSR (REG_CR + 2) // Media Status register -+//#define ISR REG_HISR -+ -+#define TSFR REG_TSFTR // Timing Sync Function Timer Register. -+#define TSFR1 REG_TSFTR1 // HW Port 1 TSF Register -+ -+#define PBP REG_PBP -+ -+// Redifine MACID register, to compatible prior ICs. -+#define IDR0 REG_MACID // MAC ID Register, Offset 0x0050-0x0053 -+#define IDR4 (REG_MACID + 4) // MAC ID Register, Offset 0x0054-0x0055 -+ -+ -+// -+// 9. Security Control Registers (Offset: ) -+// -+#define RWCAM REG_CAMCMD //IN 8190 Data Sheet is called CAMcmd -+#define WCAMI REG_CAMWRITE // Software write CAM input content -+#define RCAMO REG_CAMREAD // Software read/write CAM config -+#define CAMDBG REG_CAMDBG -+#define SECR REG_SECCFG //Security Configuration Register -+ -+// Unused register -+#define UnusedRegister 0x1BF -+#define DCAM UnusedRegister -+#define PSR UnusedRegister -+#define BBAddr UnusedRegister -+#define PhyDataR UnusedRegister -+ -+// Min Spacing related settings. -+#define MAX_MSS_DENSITY_2T 0x13 -+#define MAX_MSS_DENSITY_1T 0x0A -+ -+//---------------------------------------------------------------------------- -+// 8192C Cmd9346CR bits (Offset 0xA, 16bit) -+//---------------------------------------------------------------------------- -+#define CmdEEPROM_En BIT5 // EEPROM enable when set 1 -+#define CmdEERPOMSEL BIT4 // System EEPROM select, 0: boot from E-FUSE, 1: The EEPROM used is 9346 -+#define Cmd9346CR_9356SEL BIT4 -+ -+//---------------------------------------------------------------------------- -+// 8192C GPIO MUX Configuration Register (offset 0x40, 4 byte) -+//---------------------------------------------------------------------------- -+#define GPIOSEL_GPIO 0 -+#define GPIOSEL_ENBT BIT5 -+ -+//---------------------------------------------------------------------------- -+// 8192C GPIO PIN Control Register (offset 0x44, 4 byte) -+//---------------------------------------------------------------------------- -+#define GPIO_IN REG_GPIO_PIN_CTRL // GPIO pins input value -+#define GPIO_OUT (REG_GPIO_PIN_CTRL+1) // GPIO pins output value -+#define GPIO_IO_SEL (REG_GPIO_PIN_CTRL+2) // GPIO pins output enable when a bit is set to "1"; otherwise, input is configured. -+#define GPIO_MOD (REG_GPIO_PIN_CTRL+3) -+ -+//---------------------------------------------------------------------------- -+// 8811A GPIO PIN Control Register (offset 0x60, 4 byte) -+//---------------------------------------------------------------------------- -+#define GPIO_IN_8811A REG_GPIO_PIN_CTRL_2 // GPIO pins input value -+#define GPIO_OUT_8811A (REG_GPIO_PIN_CTRL_2+1) // GPIO pins output value -+#define GPIO_IO_SEL_8811A (REG_GPIO_PIN_CTRL_2+2) // GPIO pins output enable when a bit is set to "1"; otherwise, input is configured. -+#define GPIO_MOD_8811A (REG_GPIO_PIN_CTRL_2+3) -+ -+//---------------------------------------------------------------------------- -+// 8723/8188E Host System Interrupt Mask Register (offset 0x58, 32 byte) -+//---------------------------------------------------------------------------- -+#define HSIMR_GPIO12_0_INT_EN BIT0 -+#define HSIMR_SPS_OCP_INT_EN BIT5 -+#define HSIMR_RON_INT_EN BIT6 -+#define HSIMR_PDN_INT_EN BIT7 -+#define HSIMR_GPIO9_INT_EN BIT25 -+ -+//---------------------------------------------------------------------------- -+// 8723/8188E Host System Interrupt Status Register (offset 0x5C, 32 byte) -+//---------------------------------------------------------------------------- -+#define HSISR_GPIO12_0_INT BIT0 -+#define HSISR_SPS_OCP_INT BIT5 -+#define HSISR_RON_INT BIT6 -+#define HSISR_PDNINT BIT7 -+#define HSISR_GPIO9_INT BIT25 -+ -+//---------------------------------------------------------------------------- -+// 8192C (MSR) Media Status Register (Offset 0x4C, 8 bits) -+//---------------------------------------------------------------------------- -+/* -+Network Type -+00: No link -+01: Link in ad hoc network -+10: Link in infrastructure network -+11: AP mode -+Default: 00b. -+*/ -+#define MSR_NOLINK 0x00 -+#define MSR_ADHOC 0x01 -+#define MSR_INFRA 0x02 -+#define MSR_AP 0x03 -+ -+//---------------------------------------------------------------------------- -+// USB INTR CONTENT -+//---------------------------------------------------------------------------- -+#define USB_C2H_CMDID_OFFSET 0 -+#define USB_C2H_SEQ_OFFSET 1 -+#define USB_C2H_EVENT_OFFSET 2 -+#define USB_INTR_CPWM_OFFSET 16 -+#define USB_INTR_CONTENT_C2H_OFFSET 0 -+#define USB_INTR_CONTENT_CPWM1_OFFSET 16 -+#define USB_INTR_CONTENT_CPWM2_OFFSET 20 -+#define USB_INTR_CONTENT_HISR_OFFSET 48 -+#define USB_INTR_CONTENT_HISRE_OFFSET 52 -+#define USB_INTR_CONTENT_LENGTH 56 -+ -+//---------------------------------------------------------------------------- -+// Response Rate Set Register (offset 0x440, 24bits) -+//---------------------------------------------------------------------------- -+#define RRSR_1M BIT0 -+#define RRSR_2M BIT1 -+#define RRSR_5_5M BIT2 -+#define RRSR_11M BIT3 -+#define RRSR_6M BIT4 -+#define RRSR_9M BIT5 -+#define RRSR_12M BIT6 -+#define RRSR_18M BIT7 -+#define RRSR_24M BIT8 -+#define RRSR_36M BIT9 -+#define RRSR_48M BIT10 -+#define RRSR_54M BIT11 -+#define RRSR_MCS0 BIT12 -+#define RRSR_MCS1 BIT13 -+#define RRSR_MCS2 BIT14 -+#define RRSR_MCS3 BIT15 -+#define RRSR_MCS4 BIT16 -+#define RRSR_MCS5 BIT17 -+#define RRSR_MCS6 BIT18 -+#define RRSR_MCS7 BIT19 -+ -+// WOL bit information -+#define HAL92C_WOL_PTK_UPDATE_EVENT BIT0 -+#define HAL92C_WOL_GTK_UPDATE_EVENT BIT1 -+#define HAL92C_WOL_DISASSOC_EVENT BIT2 -+#define HAL92C_WOL_DEAUTH_EVENT BIT3 -+#define HAL92C_WOL_FW_DISCONNECT_EVENT BIT4 -+ -+//---------------------------------------------------------------------------- -+// Rate Definition -+//---------------------------------------------------------------------------- -+//CCK -+#define RATR_1M 0x00000001 -+#define RATR_2M 0x00000002 -+#define RATR_55M 0x00000004 -+#define RATR_11M 0x00000008 -+//OFDM -+#define RATR_6M 0x00000010 -+#define RATR_9M 0x00000020 -+#define RATR_12M 0x00000040 -+#define RATR_18M 0x00000080 -+#define RATR_24M 0x00000100 -+#define RATR_36M 0x00000200 -+#define RATR_48M 0x00000400 -+#define RATR_54M 0x00000800 -+//MCS 1 Spatial Stream -+#define RATR_MCS0 0x00001000 -+#define RATR_MCS1 0x00002000 -+#define RATR_MCS2 0x00004000 -+#define RATR_MCS3 0x00008000 -+#define RATR_MCS4 0x00010000 -+#define RATR_MCS5 0x00020000 -+#define RATR_MCS6 0x00040000 -+#define RATR_MCS7 0x00080000 -+//MCS 2 Spatial Stream -+#define RATR_MCS8 0x00100000 -+#define RATR_MCS9 0x00200000 -+#define RATR_MCS10 0x00400000 -+#define RATR_MCS11 0x00800000 -+#define RATR_MCS12 0x01000000 -+#define RATR_MCS13 0x02000000 -+#define RATR_MCS14 0x04000000 -+#define RATR_MCS15 0x08000000 -+ -+//CCK -+#define RATE_1M BIT(0) -+#define RATE_2M BIT(1) -+#define RATE_5_5M BIT(2) -+#define RATE_11M BIT(3) -+//OFDM -+#define RATE_6M BIT(4) -+#define RATE_9M BIT(5) -+#define RATE_12M BIT(6) -+#define RATE_18M BIT(7) -+#define RATE_24M BIT(8) -+#define RATE_36M BIT(9) -+#define RATE_48M BIT(10) -+#define RATE_54M BIT(11) -+//MCS 1 Spatial Stream -+#define RATE_MCS0 BIT(12) -+#define RATE_MCS1 BIT(13) -+#define RATE_MCS2 BIT(14) -+#define RATE_MCS3 BIT(15) -+#define RATE_MCS4 BIT(16) -+#define RATE_MCS5 BIT(17) -+#define RATE_MCS6 BIT(18) -+#define RATE_MCS7 BIT(19) -+//MCS 2 Spatial Stream -+#define RATE_MCS8 BIT(20) -+#define RATE_MCS9 BIT(21) -+#define RATE_MCS10 BIT(22) -+#define RATE_MCS11 BIT(23) -+#define RATE_MCS12 BIT(24) -+#define RATE_MCS13 BIT(25) -+#define RATE_MCS14 BIT(26) -+#define RATE_MCS15 BIT(27) -+ -+ -+// ALL CCK Rate -+#define RATE_ALL_CCK RATR_1M|RATR_2M|RATR_55M|RATR_11M -+#define RATE_ALL_OFDM_AG RATR_6M|RATR_9M|RATR_12M|RATR_18M|RATR_24M|\ -+ RATR_36M|RATR_48M|RATR_54M -+#define RATE_ALL_OFDM_1SS RATR_MCS0|RATR_MCS1|RATR_MCS2|RATR_MCS3 |\ -+ RATR_MCS4|RATR_MCS5|RATR_MCS6 |RATR_MCS7 -+#define RATE_ALL_OFDM_2SS RATR_MCS8|RATR_MCS9 |RATR_MCS10|RATR_MCS11|\ -+ RATR_MCS12|RATR_MCS13|RATR_MCS14|RATR_MCS15 -+ -+#define RATE_BITMAP_ALL 0xFFFFF -+ -+// Only use CCK 1M rate for ACK -+#define RATE_RRSR_CCK_ONLY_1M 0xFFFF1 -+#define RATE_RRSR_WITHOUT_CCK 0xFFFF0 -+ -+//---------------------------------------------------------------------------- -+// BW_OPMODE bits (Offset 0x603, 8bit) -+//---------------------------------------------------------------------------- -+#define BW_OPMODE_20MHZ BIT2 -+#define BW_OPMODE_5G BIT1 -+ -+//---------------------------------------------------------------------------- -+// CAM Config Setting (offset 0x680, 1 byte) -+//---------------------------------------------------------------------------- -+#define CAM_VALID BIT15 -+#define CAM_NOTVALID 0x0000 -+#define CAM_USEDK BIT5 -+ -+#define CAM_CONTENT_COUNT 8 -+ -+#define CAM_NONE 0x0 -+#define CAM_WEP40 0x01 -+#define CAM_TKIP 0x02 -+#define CAM_AES 0x04 -+#define CAM_WEP104 0x05 -+#define CAM_SMS4 0x6 -+ -+#define TOTAL_CAM_ENTRY 32 -+#define HALF_CAM_ENTRY 16 -+ -+#define CAM_CONFIG_USEDK true -+#define CAM_CONFIG_NO_USEDK false -+ -+#define CAM_WRITE BIT16 -+#define CAM_READ 0x00000000 -+#define CAM_POLLINIG BIT31 -+ -+#define SCR_UseDK 0x01 -+#define SCR_TxSecEnable 0x02 -+#define SCR_RxSecEnable 0x04 -+ -+// -+// 10. Power Save Control Registers -+// -+#define WOW_PMEN BIT0 // Power management Enable. -+#define WOW_WOMEN BIT1 // WoW function on or off. -+#define WOW_MAGIC BIT2 // Magic packet -+#define WOW_UWF BIT3 // Unicast Wakeup frame. -+ -+// -+// 12. Host Interrupt Status Registers -+// -+//---------------------------------------------------------------------------- -+// 8190 IMR/ISR bits -+//---------------------------------------------------------------------------- -+#define IMR8190_DISABLED 0x0 -+#define IMR_DISABLED 0x0 -+// IMR DW0 Bit 0-31 -+#define IMR_BCNDMAINT6 BIT31 // Beacon DMA Interrupt 6 -+#define IMR_BCNDMAINT5 BIT30 // Beacon DMA Interrupt 5 -+#define IMR_BCNDMAINT4 BIT29 // Beacon DMA Interrupt 4 -+#define IMR_BCNDMAINT3 BIT28 // Beacon DMA Interrupt 3 -+#define IMR_BCNDMAINT2 BIT27 // Beacon DMA Interrupt 2 -+#define IMR_BCNDMAINT1 BIT26 // Beacon DMA Interrupt 1 -+#define IMR_BCNDOK8 BIT25 // Beacon Queue DMA OK Interrup 8 -+#define IMR_BCNDOK7 BIT24 // Beacon Queue DMA OK Interrup 7 -+#define IMR_BCNDOK6 BIT23 // Beacon Queue DMA OK Interrup 6 -+#define IMR_BCNDOK5 BIT22 // Beacon Queue DMA OK Interrup 5 -+#define IMR_BCNDOK4 BIT21 // Beacon Queue DMA OK Interrup 4 -+#define IMR_BCNDOK3 BIT20 // Beacon Queue DMA OK Interrup 3 -+#define IMR_BCNDOK2 BIT19 // Beacon Queue DMA OK Interrup 2 -+#define IMR_BCNDOK1 BIT18 // Beacon Queue DMA OK Interrup 1 -+#define IMR_TIMEOUT2 BIT17 // Timeout interrupt 2 -+#define IMR_TIMEOUT1 BIT16 // Timeout interrupt 1 -+#define IMR_TXFOVW BIT15 // Transmit FIFO Overflow -+#define IMR_PSTIMEOUT BIT14 // Power save time out interrupt -+#define IMR_BcnInt BIT13 // Beacon DMA Interrupt 0 -+#define IMR_RXFOVW BIT12 // Receive FIFO Overflow -+#define IMR_RDU BIT11 // Receive Descriptor Unavailable -+#define IMR_ATIMEND BIT10 // For 92C,ATIM Window End Interrupt. For 8723 and later ICs, it also means P2P CTWin End interrupt. -+#define IMR_BDOK BIT9 // Beacon Queue DMA OK Interrup -+#define IMR_HIGHDOK BIT8 // High Queue DMA OK Interrupt -+#define IMR_TBDOK BIT7 // Transmit Beacon OK interrup -+#define IMR_MGNTDOK BIT6 // Management Queue DMA OK Interrupt -+#define IMR_TBDER BIT5 // For 92C,Transmit Beacon Error Interrupt -+#define IMR_BKDOK BIT4 // AC_BK DMA OK Interrupt -+#define IMR_BEDOK BIT3 // AC_BE DMA OK Interrupt -+#define IMR_VIDOK BIT2 // AC_VI DMA OK Interrupt -+#define IMR_VODOK BIT1 // AC_VO DMA Interrupt -+#define IMR_ROK BIT0 // Receive DMA OK Interrupt -+ -+// 13. Host Interrupt Status Extension Register (Offset: 0x012C-012Eh) -+#define IMR_TSF_BIT32_TOGGLE BIT15 -+#define IMR_BcnInt_E BIT12 -+#define IMR_TXERR BIT11 -+#define IMR_RXERR BIT10 -+#define IMR_C2HCMD BIT9 -+#define IMR_CPWM BIT8 -+//RSVD [2-7] -+#define IMR_OCPINT BIT1 -+#define IMR_WLANOFF BIT0 -+ -+//---------------------------------------------------------------------------- -+// 8723E series PCIE Host IMR/ISR bit -+//---------------------------------------------------------------------------- -+// IMR DW0 Bit 0-31 -+#define PHIMR_TIMEOUT2 BIT31 -+#define PHIMR_TIMEOUT1 BIT30 -+#define PHIMR_PSTIMEOUT BIT29 -+#define PHIMR_GTINT4 BIT28 -+#define PHIMR_GTINT3 BIT27 -+#define PHIMR_TXBCNERR BIT26 -+#define PHIMR_TXBCNOK BIT25 -+#define PHIMR_TSF_BIT32_TOGGLE BIT24 -+#define PHIMR_BCNDMAINT3 BIT23 -+#define PHIMR_BCNDMAINT2 BIT22 -+#define PHIMR_BCNDMAINT1 BIT21 -+#define PHIMR_BCNDMAINT0 BIT20 -+#define PHIMR_BCNDOK3 BIT19 -+#define PHIMR_BCNDOK2 BIT18 -+#define PHIMR_BCNDOK1 BIT17 -+#define PHIMR_BCNDOK0 BIT16 -+#define PHIMR_HSISR_IND_ON BIT15 -+#define PHIMR_BCNDMAINT_E BIT14 -+#define PHIMR_ATIMEND_E BIT13 -+#define PHIMR_ATIM_CTW_END BIT12 -+#define PHIMR_HISRE_IND BIT11 // RO. HISRE Indicator (HISRE & HIMRE is true, this bit is set to 1) -+#define PHIMR_C2HCMD BIT10 -+#define PHIMR_CPWM2 BIT9 -+#define PHIMR_CPWM BIT8 -+#define PHIMR_HIGHDOK BIT7 // High Queue DMA OK Interrupt -+#define PHIMR_MGNTDOK BIT6 // Management Queue DMA OK Interrupt -+#define PHIMR_BKDOK BIT5 // AC_BK DMA OK Interrupt -+#define PHIMR_BEDOK BIT4 // AC_BE DMA OK Interrupt -+#define PHIMR_VIDOK BIT3 // AC_VI DMA OK Interrupt -+#define PHIMR_VODOK BIT2 // AC_VO DMA Interrupt -+#define PHIMR_RDU BIT1 // Receive Descriptor Unavailable -+#define PHIMR_ROK BIT0 // Receive DMA OK Interrupt -+ -+// PCIE Host Interrupt Status Extension bit -+#define PHIMR_BCNDMAINT7 BIT23 -+#define PHIMR_BCNDMAINT6 BIT22 -+#define PHIMR_BCNDMAINT5 BIT21 -+#define PHIMR_BCNDMAINT4 BIT20 -+#define PHIMR_BCNDOK7 BIT19 -+#define PHIMR_BCNDOK6 BIT18 -+#define PHIMR_BCNDOK5 BIT17 -+#define PHIMR_BCNDOK4 BIT16 -+// bit12 15: RSVD -+#define PHIMR_TXERR BIT11 -+#define PHIMR_RXERR BIT10 -+#define PHIMR_TXFOVW BIT9 -+#define PHIMR_RXFOVW BIT8 -+// bit2-7: RSVD -+#define PHIMR_OCPINT BIT1 -+// bit0: RSVD -+ -+#define UHIMR_TIMEOUT2 BIT31 -+#define UHIMR_TIMEOUT1 BIT30 -+#define UHIMR_PSTIMEOUT BIT29 -+#define UHIMR_GTINT4 BIT28 -+#define UHIMR_GTINT3 BIT27 -+#define UHIMR_TXBCNERR BIT26 -+#define UHIMR_TXBCNOK BIT25 -+#define UHIMR_TSF_BIT32_TOGGLE BIT24 -+#define UHIMR_BCNDMAINT3 BIT23 -+#define UHIMR_BCNDMAINT2 BIT22 -+#define UHIMR_BCNDMAINT1 BIT21 -+#define UHIMR_BCNDMAINT0 BIT20 -+#define UHIMR_BCNDOK3 BIT19 -+#define UHIMR_BCNDOK2 BIT18 -+#define UHIMR_BCNDOK1 BIT17 -+#define UHIMR_BCNDOK0 BIT16 -+#define UHIMR_HSISR_IND BIT15 -+#define UHIMR_BCNDMAINT_E BIT14 -+//RSVD BIT13 -+#define UHIMR_CTW_END BIT12 -+//RSVD BIT11 -+#define UHIMR_C2HCMD BIT10 -+#define UHIMR_CPWM2 BIT9 -+#define UHIMR_CPWM BIT8 -+#define UHIMR_HIGHDOK BIT7 // High Queue DMA OK Interrupt -+#define UHIMR_MGNTDOK BIT6 // Management Queue DMA OK Interrupt -+#define UHIMR_BKDOK BIT5 // AC_BK DMA OK Interrupt -+#define UHIMR_BEDOK BIT4 // AC_BE DMA OK Interrupt -+#define UHIMR_VIDOK BIT3 // AC_VI DMA OK Interrupt -+#define UHIMR_VODOK BIT2 // AC_VO DMA Interrupt -+#define UHIMR_RDU BIT1 // Receive Descriptor Unavailable -+#define UHIMR_ROK BIT0 // Receive DMA OK Interrupt -+ -+// USB Host Interrupt Status Extension bit -+#define UHIMR_BCNDMAINT7 BIT23 -+#define UHIMR_BCNDMAINT6 BIT22 -+#define UHIMR_BCNDMAINT5 BIT21 -+#define UHIMR_BCNDMAINT4 BIT20 -+#define UHIMR_BCNDOK7 BIT19 -+#define UHIMR_BCNDOK6 BIT18 -+#define UHIMR_BCNDOK5 BIT17 -+#define UHIMR_BCNDOK4 BIT16 -+// bit14-15: RSVD -+#define UHIMR_ATIMEND_E BIT13 -+#define UHIMR_ATIMEND BIT12 -+#define UHIMR_TXERR BIT11 -+#define UHIMR_RXERR BIT10 -+#define UHIMR_TXFOVW BIT9 -+#define UHIMR_RXFOVW BIT8 -+// bit2-7: RSVD -+#define UHIMR_OCPINT BIT1 -+// bit0: RSVD -+ -+ -+#define HAL_NIC_UNPLUG_ISR 0xFFFFFFFF // The value when the NIC is unplugged for PCI. -+#define HAL_NIC_UNPLUG_PCI_ISR 0xEAEAEAEA // The value when the NIC is unplugged for PCI in PCI interrupt (page 3). -+ -+//---------------------------------------------------------------------------- -+// 8188 IMR/ISR bits -+//---------------------------------------------------------------------------- -+#define IMR_DISABLED_88E 0x0 -+// IMR DW0(0x0060-0063) Bit 0-31 -+#define IMR_TXCCK_88E BIT30 // TXRPT interrupt when CCX bit of the packet is set -+#define IMR_PSTIMEOUT_88E BIT29 // Power Save Time Out Interrupt -+#define IMR_GTINT4_88E BIT28 // When GTIMER4 expires, this bit is set to 1 -+#define IMR_GTINT3_88E BIT27 // When GTIMER3 expires, this bit is set to 1 -+#define IMR_TBDER_88E BIT26 // Transmit Beacon0 Error -+#define IMR_TBDOK_88E BIT25 // Transmit Beacon0 OK -+#define IMR_TSF_BIT32_TOGGLE_88E BIT24 // TSF Timer BIT32 toggle indication interrupt -+#define IMR_BCNDMAINT0_88E BIT20 // Beacon DMA Interrupt 0 -+#define IMR_BCNDERR0_88E BIT16 // Beacon Queue DMA Error 0 -+#define IMR_HSISR_IND_ON_INT_88E BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) -+#define IMR_BCNDMAINT_E_88E BIT14 // Beacon DMA Interrupt Extension for Win7 -+#define IMR_ATIMEND_88E BIT12 // CTWidnow End or ATIM Window End -+#define IMR_HISR1_IND_INT_88E BIT11 // HISR1 Indicator (HISR1 & HIMR1 is true, this bit is set to 1) -+#define IMR_C2HCMD_88E BIT10 // CPU to Host Command INT Status, Write 1 clear -+#define IMR_CPWM2_88E BIT9 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_CPWM_88E BIT8 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_HIGHDOK_88E BIT7 // High Queue DMA OK -+#define IMR_MGNTDOK_88E BIT6 // Management Queue DMA OK -+#define IMR_BKDOK_88E BIT5 // AC_BK DMA OK -+#define IMR_BEDOK_88E BIT4 // AC_BE DMA OK -+#define IMR_VIDOK_88E BIT3 // AC_VI DMA OK -+#define IMR_VODOK_88E BIT2 // AC_VO DMA OK -+#define IMR_RDU_88E BIT1 // Rx Descriptor Unavailable -+#define IMR_ROK_88E BIT0 // Receive DMA OK -+ -+// IMR DW1(0x00B4-00B7) Bit 0-31 -+#define IMR_BCNDMAINT7_88E BIT27 // Beacon DMA Interrupt 7 -+#define IMR_BCNDMAINT6_88E BIT26 // Beacon DMA Interrupt 6 -+#define IMR_BCNDMAINT5_88E BIT25 // Beacon DMA Interrupt 5 -+#define IMR_BCNDMAINT4_88E BIT24 // Beacon DMA Interrupt 4 -+#define IMR_BCNDMAINT3_88E BIT23 // Beacon DMA Interrupt 3 -+#define IMR_BCNDMAINT2_88E BIT22 // Beacon DMA Interrupt 2 -+#define IMR_BCNDMAINT1_88E BIT21 // Beacon DMA Interrupt 1 -+#define IMR_BCNDOK7_88E BIT20 // Beacon Queue DMA OK Interrup 7 -+#define IMR_BCNDOK6_88E BIT19 // Beacon Queue DMA OK Interrup 6 -+#define IMR_BCNDOK5_88E BIT18 // Beacon Queue DMA OK Interrup 5 -+#define IMR_BCNDOK4_88E BIT17 // Beacon Queue DMA OK Interrup 4 -+#define IMR_BCNDOK3_88E BIT16 // Beacon Queue DMA OK Interrup 3 -+#define IMR_BCNDOK2_88E BIT15 // Beacon Queue DMA OK Interrup 2 -+#define IMR_BCNDOK1_88E BIT14 // Beacon Queue DMA OK Interrup 1 -+#define IMR_ATIMEND_E_88E BIT13 // ATIM Window End Extension for Win7 -+#define IMR_TXERR_88E BIT11 // Tx Error Flag Interrupt Status, write 1 clear. -+#define IMR_RXERR_88E BIT10 // Rx Error Flag INT Status, Write 1 clear -+#define IMR_TXFOVW_88E BIT9 // Transmit FIFO Overflow -+#define IMR_RXFOVW_88E BIT8 // Receive FIFO Overflow -+ -+/*=================================================================== -+===================================================================== -+Here the register defines are for 92C. When the define is as same with 92C, -+we will use the 92C's define for the consistency -+So the following defines for 92C is not entire!!!!!! -+===================================================================== -+=====================================================================*/ -+/* -+Based on Datasheet V33---090401 -+Register Summary -+Current IOREG MAP -+0x0000h ~ 0x00FFh System Configuration (256 Bytes) -+0x0100h ~ 0x01FFh MACTOP General Configuration (256 Bytes) -+0x0200h ~ 0x027Fh TXDMA Configuration (128 Bytes) -+0x0280h ~ 0x02FFh RXDMA Configuration (128 Bytes) -+0x0300h ~ 0x03FFh PCIE EMAC Reserved Region (256 Bytes) -+0x0400h ~ 0x04FFh Protocol Configuration (256 Bytes) -+0x0500h ~ 0x05FFh EDCA Configuration (256 Bytes) -+0x0600h ~ 0x07FFh WMAC Configuration (512 Bytes) -+0x2000h ~ 0x3FFFh 8051 FW Download Region (8196 Bytes) -+*/ -+ //---------------------------------------------------------------------------- -+ // 8192C (TXPAUSE) transmission pause (Offset 0x522, 8 bits) -+ //---------------------------------------------------------------------------- -+// Note: -+// The the bits of stoping AC(VO/VI/BE/BK) queue in datasheet RTL8192S/RTL8192C are wrong, -+// the correct arragement is VO - Bit0, VI - Bit1, BE - Bit2, and BK - Bit3. -+// 8723 and 88E may be not correct either in the eralier version. Confirmed with DD Tim. -+// By Bruce, 2011-09-22. -+#define StopBecon BIT6 -+#define StopHigh BIT5 -+#define StopMgt BIT4 -+#define StopBK BIT3 -+#define StopBE BIT2 -+#define StopVI BIT1 -+#define StopVO BIT0 -+ -+//---------------------------------------------------------------------------- -+// 8192C (RCR) Receive Configuration Register (Offset 0x608, 32 bits) -+//---------------------------------------------------------------------------- -+#define RCR_APPFCS BIT31 // WMAC append FCS after pauload -+#define RCR_APP_MIC BIT30 // MACRX will retain the MIC at the bottom of the packet. -+#define RCR_APP_ICV BIT29 // MACRX will retain the ICV at the bottom of the packet. -+#define RCR_APP_PHYST_RXFF BIT28 // PHY Status is appended before RX packet in RXFF -+#define RCR_APP_BA_SSN BIT27 // SSN of previous TXBA is appended as after original RXDESC as the 4-th DW of RXDESC. -+#define RCR_NONQOS_VHT BIT26 // Reserved -+#define RCR_RSVD_BIT25 BIT25 // Reserved -+#define RCR_ENMBID BIT24 // Enable Multiple BssId. Only response ACK to the packets whose DID(A1) matching to the addresses in the MBSSID CAM Entries. -+#define RCR_LSIGEN BIT23 // Enable LSIG TXOP Protection function. Search KEYCAM for each rx packet to check if LSIGEN bit is set. -+#define RCR_MFBEN BIT22 // Enable immediate MCS Feedback function. When Rx packet with MRQ = 1'b1, then search KEYCAM to find sender's MCS Feedback function and send response. -+#define RCR_RSVD_BIT21 BIT21 // Reserved -+#define RCR_RSVD_BIT20 BIT20 // Reserved -+#define RCR_RSVD_BIT19 BIT19 // Reserved -+#define RCR_TIM_PARSER_EN BIT18 // RX Beacon TIM Parser. -+#define RCR_BM_DATA_EN BIT17 // Broadcast data packet interrupt enable. -+#define RCR_UC_DATA_EN BIT16 // Unicast data packet interrupt enable. -+#define RCR_RSVD_BIT15 BIT15 // Reserved -+#define RCR_HTC_LOC_CTRL BIT14 // MFC<--HTC=1 MFC-->HTC=0 -+#define RCR_AMF BIT13 // Accept management type frame -+#define RCR_ACF BIT12 // Accept control type frame. Control frames BA, BAR, and PS-Poll (when in AP mode) are not controlled by this bit. They are controlled by ADF. -+#define RCR_ADF BIT11 // Accept data type frame. This bit also regulates BA, BAR, and PS-Poll (AP mode only). -+#define RCR_RSVD_BIT10 BIT10 // Reserved -+#define RCR_AICV BIT9 // Accept ICV error packet -+#define RCR_ACRC32 BIT8 // Accept CRC32 error packet -+#define RCR_CBSSID_BCN BIT7 // Accept BSSID match packet (Rx beacon, probe rsp) -+#define RCR_CBSSID_DATA BIT6 // Accept BSSID match packet (Data) -+#define RCR_CBSSID RCR_CBSSID_DATA // Accept BSSID match packet -+#define RCR_APWRMGT BIT5 // Accept power management packet -+#define RCR_ADD3 BIT4 // Accept address 3 match packet -+#define RCR_AB BIT3 // Accept broadcast packet -+#define RCR_AM BIT2 // Accept multicast packet -+#define RCR_APM BIT1 // Accept physical match packet -+#define RCR_AAP BIT0 // Accept all unicast packet -+ -+ -+//----------------------------------------------------- -+// -+// 0x0000h ~ 0x00FFh System Configuration -+// -+//----------------------------------------------------- -+ -+//2 SYS_ISO_CTRL -+#define ISO_MD2PP BIT(0) -+#define ISO_UA2USB BIT(1) -+#define ISO_UD2CORE BIT(2) -+#define ISO_PA2PCIE BIT(3) -+#define ISO_PD2CORE BIT(4) -+#define ISO_IP2MAC BIT(5) -+#define ISO_DIOP BIT(6) -+#define ISO_DIOE BIT(7) -+#define ISO_EB2CORE BIT(8) -+#define ISO_DIOR BIT(9) -+#define PWC_EV12V BIT(15) -+ -+ -+//2 SYS_FUNC_EN -+#define FEN_BBRSTB BIT(0) -+#define FEN_BB_GLB_RSTn BIT(1) -+#define FEN_USBA BIT(2) -+#define FEN_UPLL BIT(3) -+#define FEN_USBD BIT(4) -+#define FEN_DIO_PCIE BIT(5) -+#define FEN_PCIEA BIT(6) -+#define FEN_PPLL BIT(7) -+#define FEN_PCIED BIT(8) -+#define FEN_DIOE BIT(9) -+#define FEN_CPUEN BIT(10) -+#define FEN_DCORE BIT(11) -+#define FEN_ELDR BIT(12) -+//#define FEN_DIO_RF BIT(13) -+#define FEN_HWPDN BIT(14) -+#define FEN_MREGEN BIT(15) -+ -+//2 APS_FSMCO -+#define PFM_LDALL BIT(0) -+#define PFM_ALDN BIT(1) -+#define PFM_LDKP BIT(2) -+#define PFM_WOWL BIT(3) -+#define EnPDN BIT(4) -+#define PDN_PL BIT(5) -+#define APFM_ONMAC BIT(8) -+#define APFM_OFF BIT(9) -+#define APFM_RSM BIT(10) -+#define AFSM_HSUS BIT(11) -+#define AFSM_PCIE BIT(12) -+#define APDM_MAC BIT(13) -+#define APDM_HOST BIT(14) -+#define APDM_HPDN BIT(15) -+#define RDY_MACON BIT(16) -+#define SUS_HOST BIT(17) -+#define ROP_ALD BIT(20) -+#define ROP_PWR BIT(21) -+#define ROP_SPS BIT(22) -+#define SOP_MRST BIT(25) -+#define SOP_FUSE BIT(26) -+#define SOP_ABG BIT(27) -+#define SOP_AMB BIT(28) -+#define SOP_RCK BIT(29) -+#define SOP_A8M BIT(30) -+#define XOP_BTCK BIT(31) -+ -+//2 SYS_CLKR -+#define ANAD16V_EN BIT(0) -+#define ANA8M BIT(1) -+#define MACSLP BIT(4) -+#define LOADER_CLK_EN BIT(5) -+ -+ -+//2 9346CR /REG_SYS_EEPROM_CTRL -+#define BOOT_FROM_EEPROM BIT(4) -+#define EEPROMSEL BIT(4) -+#define EEPROM_EN BIT(5) -+ -+ -+//2 RF_CTRL -+#define RF_EN BIT(0) -+#define RF_RSTB BIT(1) -+#define RF_SDMRSTB BIT(2) -+ -+ -+//2 LDOV12D_CTRL -+#define LDV12_EN BIT(0) -+#define LDV12_SDBY BIT(1) -+#define LPLDO_HSM BIT(2) -+#define LPLDO_LSM_DIS BIT(3) -+#define _LDV12_VADJ(x) (((x) & 0xF) << 4) -+ -+ -+ -+//2 EFUSE_TEST (For RTL8723 partially) -+#define EF_TRPT BIT(7) -+#define EF_CELL_SEL (BIT(8)|BIT(9)) // 00: Wifi Efuse, 01: BT Efuse0, 10: BT Efuse1, 11: BT Efuse2 -+#define LDOE25_EN BIT(31) -+#define EFUSE_SEL(x) (((x) & 0x3) << 8) -+#define EFUSE_SEL_MASK 0x300 -+#define EFUSE_WIFI_SEL_0 0x0 -+#define EFUSE_BT_SEL_0 0x1 -+#define EFUSE_BT_SEL_1 0x2 -+#define EFUSE_BT_SEL_2 0x3 -+ -+ -+//2 8051FWDL -+//2 MCUFWDL -+#define MCUFWDL_EN BIT(0) -+#define MCUFWDL_RDY BIT(1) -+#define FWDL_ChkSum_rpt BIT(2) -+#define MACINI_RDY BIT(3) -+#define BBINI_RDY BIT(4) -+#define RFINI_RDY BIT(5) -+#define WINTINI_RDY BIT(6) -+#define RAM_DL_SEL BIT(7) -+#define ROM_DLEN BIT(19) -+#define CPRST BIT(23) -+ -+ -+//2 REG_SYS_CFG -+#define XCLK_VLD BIT(0) -+#define ACLK_VLD BIT(1) -+#define UCLK_VLD BIT(2) -+#define PCLK_VLD BIT(3) -+#define PCIRSTB BIT(4) -+#define V15_VLD BIT(5) -+#define SW_OFFLOAD_EN BIT(7) -+#define SIC_IDLE BIT(8) -+#define BD_MAC2 BIT(9) -+#define BD_MAC1 BIT(10) -+#define IC_MACPHY_MODE BIT(11) -+#define CHIP_VER (BIT(12)|BIT(13)|BIT(14)|BIT(15)) -+#define BT_FUNC BIT(16) -+#define VENDOR_ID BIT(19) -+#define EXT_VENDOR_ID (BIT(18)|BIT(19)) //Currently only for RTL8723B -+#define PAD_HWPD_IDN BIT(22) -+#define TRP_VAUX_EN BIT(23) // RTL ID -+#define TRP_BT_EN BIT(24) -+#define BD_PKG_SEL BIT(25) -+#define BD_HCI_SEL BIT(26) -+#define TYPE_ID BIT(27) -+#define RF_TYPE_ID BIT(27) -+ -+#define RTL_ID BIT(23) // TestChip ID, 1:Test(RLE); 0:MP(RL) -+#define SPS_SEL BIT(24) // 1:LDO regulator mode; 0:Switching regulator mode -+ -+ -+#define CHIP_VER_RTL_MASK 0xF000 //Bit 12 ~ 15 -+#define CHIP_VER_RTL_SHIFT 12 -+#define EXT_VENDOR_ID_SHIFT 18 -+ -+//2 REG_GPIO_OUTSTS (For RTL8723 only) -+#define EFS_HCI_SEL (BIT(0)|BIT(1)) -+#define PAD_HCI_SEL (BIT(2)|BIT(3)) -+#define HCI_SEL (BIT(4)|BIT(5)) -+#define PKG_SEL_HCI BIT(6) -+#define FEN_GPS BIT(7) -+#define FEN_BT BIT(8) -+#define FEN_WL BIT(9) -+#define FEN_PCI BIT(10) -+#define FEN_USB BIT(11) -+#define BTRF_HWPDN_N BIT(12) -+#define WLRF_HWPDN_N BIT(13) -+#define PDN_BT_N BIT(14) -+#define PDN_GPS_N BIT(15) -+#define BT_CTL_HWPDN BIT(16) -+#define GPS_CTL_HWPDN BIT(17) -+#define PPHY_SUSB BIT(20) -+#define UPHY_SUSB BIT(21) -+#define PCI_SUSEN BIT(22) -+#define USB_SUSEN BIT(23) -+#define RF_RL_ID (BIT(31)|BIT(30)|BIT(29)|BIT(28)) -+ -+ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+ -+//2 Function Enable Registers -+//2 CR -+#define HCI_TXDMA_EN BIT(0) -+#define HCI_RXDMA_EN BIT(1) -+#define TXDMA_EN BIT(2) -+#define RXDMA_EN BIT(3) -+#define PROTOCOL_EN BIT(4) -+#define SCHEDULE_EN BIT(5) -+#define MACTXEN BIT(6) -+#define MACRXEN BIT(7) -+#define ENSWBCN BIT(8) -+#define ENSEC BIT(9) -+#define CALTMR_EN BIT(10) // 32k CAL TMR enable -+ -+// Network type -+#define _NETTYPE(x) (((x) & 0x3) << 16) -+#define MASK_NETTYPE 0x30000 -+#define NT_NO_LINK 0x0 -+#define NT_LINK_AD_HOC 0x1 -+#define NT_LINK_AP 0x2 -+#define NT_AS_AP 0x3 -+ -+//2 PBP - Page Size Register -+#define GET_RX_PAGE_SIZE(value) ((value) & 0xF) -+#define GET_TX_PAGE_SIZE(value) (((value) & 0xF0) >> 4) -+#define _PSRX_MASK 0xF -+#define _PSTX_MASK 0xF0 -+#define _PSRX(x) (x) -+#define _PSTX(x) ((x) << 4) -+ -+#define PBP_64 0x0 -+#define PBP_128 0x1 -+#define PBP_256 0x2 -+#define PBP_512 0x3 -+#define PBP_1024 0x4 -+ -+ -+//2 TX/RXDMA -+#define RXDMA_ARBBW_EN BIT(0) -+#define RXSHFT_EN BIT(1) -+#define RXDMA_AGG_EN BIT(2) -+#define QS_VO_QUEUE BIT(8) -+#define QS_VI_QUEUE BIT(9) -+#define QS_BE_QUEUE BIT(10) -+#define QS_BK_QUEUE BIT(11) -+#define QS_MANAGER_QUEUE BIT(12) -+#define QS_HIGH_QUEUE BIT(13) -+ -+#define HQSEL_VOQ BIT(0) -+#define HQSEL_VIQ BIT(1) -+#define HQSEL_BEQ BIT(2) -+#define HQSEL_BKQ BIT(3) -+#define HQSEL_MGTQ BIT(4) -+#define HQSEL_HIQ BIT(5) -+ -+// For normal driver, 0x10C -+#define _TXDMA_CMQ_MAP(x) (((x)&0x3) << 16) -+#define _TXDMA_HIQ_MAP(x) (((x)&0x3) << 14) -+#define _TXDMA_MGQ_MAP(x) (((x)&0x3) << 12) -+#define _TXDMA_BKQ_MAP(x) (((x)&0x3) << 10) -+#define _TXDMA_BEQ_MAP(x) (((x)&0x3) << 8 ) -+#define _TXDMA_VIQ_MAP(x) (((x)&0x3) << 6 ) -+#define _TXDMA_VOQ_MAP(x) (((x)&0x3) << 4 ) -+ -+#define QUEUE_EXTRA 0 -+#define QUEUE_LOW 1 -+#define QUEUE_NORMAL 2 -+#define QUEUE_HIGH 3 -+ -+ -+//2 TRXFF_BNDY -+ -+ -+//2 LLT_INIT -+#define _LLT_NO_ACTIVE 0x0 -+#define _LLT_WRITE_ACCESS 0x1 -+#define _LLT_READ_ACCESS 0x2 -+ -+#define _LLT_INIT_DATA(x) ((x) & 0xFF) -+#define _LLT_INIT_ADDR(x) (((x) & 0xFF) << 8) -+#define _LLT_OP(x) (((x) & 0x3) << 30) -+#define _LLT_OP_VALUE(x) (((x) >> 30) & 0x3) -+ -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+//2 RQPN -+#define _HPQ(x) ((x) & 0xFF) -+#define _LPQ(x) (((x) & 0xFF) << 8) -+#define _PUBQ(x) (((x) & 0xFF) << 16) -+#define _NPQ(x) ((x) & 0xFF) // NOTE: in RQPN_NPQ register -+#define _EPQ(x) (((x) & 0xFF) << 16) // NOTE: in RQPN_EPQ register -+ -+ -+#define HPQ_PUBLIC_DIS BIT(24) -+#define LPQ_PUBLIC_DIS BIT(25) -+#define LD_RQPN BIT(31) -+ -+ -+//2 TDECTL -+#define BLK_DESC_NUM_SHIFT 4 -+#define BLK_DESC_NUM_MASK 0xF -+ -+ -+//2 TXDMA_OFFSET_CHK -+#define DROP_DATA_EN BIT(9) -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x028Bh RX DMA Configuration -+// -+//----------------------------------------------------- -+ -+//2 REG_RXDMA_CONTROL, 0x0286h -+// Write only. When this bit is set, RXDMA will decrease RX PKT counter by one. Before -+// this bit is polled, FW shall update RXFF_RD_PTR first. This register is write pulse and auto clear. -+//#define RXPKT_RELEASE_POLL BIT(0) -+// Read only. When RXMA finishes on-going DMA operation, RXMDA will report idle state in -+// this bit. FW can start releasing packets after RXDMA entering idle mode. -+//#define RXDMA_IDLE BIT(1) -+// When this bit is set, RXDMA will enter this mode after on-going RXDMA packet to host -+// completed, and stop DMA packet to host. RXDMA will then report Default: 0; -+//#define RW_RELEASE_EN BIT(2) -+ -+//2 REG_RXPKT_NUM, 0x0284 -+#define RXPKT_RELEASE_POLL BIT(16) -+#define RXDMA_IDLE BIT(17) -+#define RW_RELEASE_EN BIT(18) -+ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+//2 FWHW_TXQ_CTRL -+#define EN_AMPDU_RTY_NEW BIT(7) -+ -+ -+//2 SPEC SIFS -+#define _SPEC_SIFS_CCK(x) ((x) & 0xFF) -+#define _SPEC_SIFS_OFDM(x) (((x) & 0xFF) << 8) -+ -+//2 RL -+#define RETRY_LIMIT_SHORT_SHIFT 8 -+#define RETRY_LIMIT_LONG_SHIFT 0 -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+ -+//2 EDCA setting -+#define AC_PARAM_TXOP_LIMIT_OFFSET 16 -+#define AC_PARAM_ECW_MAX_OFFSET 12 -+#define AC_PARAM_ECW_MIN_OFFSET 8 -+#define AC_PARAM_AIFS_OFFSET 0 -+ -+ -+#define _LRL(x) ((x) & 0x3F) -+#define _SRL(x) (((x) & 0x3F) << 8) -+ -+ -+//2 BCN_CTRL -+#define EN_TXBCN_RPT BIT(2) -+#define EN_BCN_FUNCTION BIT(3) -+#define STOP_BCNQ BIT(6) -+#define DIS_RX_BSSID_FIT BIT(6) -+ -+#define DIS_ATIM BIT(0) -+#define DIS_BCNQ_SUB BIT(1) -+#define DIS_TSF_UDT BIT(4) -+ -+// The same function but different bit field. -+#define DIS_TSF_UDT0_NORMAL_CHIP BIT(4) -+#define DIS_TSF_UDT0_TEST_CHIP BIT(5) -+ -+ -+//2 ACMHWCTRL -+#define AcmHw_HwEn BIT(0) -+#define AcmHw_BeqEn BIT(1) -+#define AcmHw_ViqEn BIT(2) -+#define AcmHw_VoqEn BIT(3) -+#define AcmHw_BeqStatus BIT(4) -+#define AcmHw_ViqStatus BIT(5) -+#define AcmHw_VoqStatus BIT(6) -+ -+//2 //REG_DUAL_TSF_RST (0x553) -+#define DUAL_TSF_RST_P2P BIT(4) -+ -+//2 // REG_NOA_DESC_SEL (0x5CF) -+#define NOA_DESC_SEL_0 0 -+#define NOA_DESC_SEL_1 BIT(4) -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+ -+//2 APSD_CTRL -+#define APSDOFF BIT(6) -+ -+//2 TCR -+#define TSFRST BIT(0) -+#define DIS_GCLK BIT(1) -+#define PAD_SEL BIT(2) -+#define PWR_ST BIT(6) -+#define PWRBIT_OW_EN BIT(7) -+#define ACRC BIT(8) -+#define CFENDFORM BIT(9) -+#define ICV BIT(10) -+ -+ -+//2 RCR -+#define AAP BIT(0) -+#define APM BIT(1) -+#define AM BIT(2) -+#define AB BIT(3) -+#define ADD3 BIT(4) -+#define APWRMGT BIT(5) -+#define CBSSID BIT(6) -+#define CBSSID_DATA BIT(6) -+#define CBSSID_BCN BIT(7) -+#define ACRC32 BIT(8) -+#define AICV BIT(9) -+#define ADF BIT(11) -+#define ACF BIT(12) -+#define AMF BIT(13) -+#define HTC_LOC_CTRL BIT(14) -+#define UC_DATA_EN BIT(16) -+#define BM_DATA_EN BIT(17) -+#define MFBEN BIT(22) -+#define LSIGEN BIT(23) -+#define EnMBID BIT(24) -+#define FORCEACK BIT(26) -+#define APP_BASSN BIT(27) -+#define APP_PHYSTS BIT(28) -+#define APP_ICV BIT(29) -+#define APP_MIC BIT(30) -+#define APP_FCS BIT(31) -+ -+ -+//2 SECCFG -+#define SCR_TxUseDK BIT(0) //Force Tx Use Default Key -+#define SCR_RxUseDK BIT(1) //Force Rx Use Default Key -+#define SCR_TxEncEnable BIT(2) //Enable Tx Encryption -+#define SCR_RxDecEnable BIT(3) //Enable Rx Decryption -+#define SCR_SKByA2 BIT(4) //Search kEY BY A2 -+#define SCR_NoSKMC BIT(5) //No Key Search Multicast -+#define SCR_TXBCUSEDK BIT(6) // Force Tx Broadcast packets Use Default Key -+#define SCR_RXBCUSEDK BIT(7) // Force Rx Broadcast packets Use Default Key -+ -+//----------------------------------------------------- -+// -+// 0xFE00h ~ 0xFE55h RTL8723 SDIO Configuration -+// -+//----------------------------------------------------- -+ -+// I/O bus domain address mapping -+#define SDIO_LOCAL_BASE 0x10250000 -+#define WLAN_IOREG_BASE 0x10260000 -+#define FIRMWARE_FIFO_BASE 0x10270000 -+#define TX_HIQ_BASE 0x10310000 -+#define TX_MIQ_BASE 0x10320000 -+#define TX_LOQ_BASE 0x10330000 -+#define RX_RX0FF_BASE 0x10340000 -+ -+//SDIO host local register space mapping. -+#define SDIO_LOCAL_MSK 0x0FFF -+#define WLAN_IOREG_MSK 0x7FFF -+#define WLAN_FIFO_MSK 0x1FFF // Aggregation Length[12:0] -+#define WLAN_RX0FF_MSK 0x0003 -+ -+#define SDIO_WITHOUT_REF_DEVICE_ID 0 // Without reference to the SDIO Device ID -+#define SDIO_LOCAL_DEVICE_ID 0 // 0b[16], 000b[15:13] -+#define WLAN_TX_HIQ_DEVICE_ID 4 // 0b[16], 100b[15:13] -+#define WLAN_TX_MIQ_DEVICE_ID 5 // 0b[16], 101b[15:13] -+#define WLAN_TX_LOQ_DEVICE_ID 6 // 0b[16], 110b[15:13] -+#define WLAN_RX0FF_DEVICE_ID 7 // 0b[16], 111b[15:13] -+#define WLAN_IOREG_DEVICE_ID 8 // 1b[16] -+ -+//SDIO Tx Free Page Index -+#define HI_QUEUE_IDX 0 -+#define MID_QUEUE_IDX 1 -+#define LOW_QUEUE_IDX 2 -+#define PUBLIC_QUEUE_IDX 3 -+ -+#define SDIO_MAX_TX_QUEUE 3 // HIQ, MIQ and LOQ -+#define SDIO_MAX_RX_QUEUE 1 -+ -+#define SDIO_REG_TX_CTRL 0x0000 // SDIO Tx Control -+#define SDIO_REG_HIMR 0x0014 // SDIO Host Interrupt Mask -+#define SDIO_REG_HISR 0x0018 // SDIO Host Interrupt Service Routine -+#define SDIO_REG_HCPWM 0x0019 // HCI Current Power Mode -+#define SDIO_REG_RX0_REQ_LEN 0x001C // RXDMA Request Length -+#define SDIO_REG_FREE_TXPG 0x0020 // Free Tx Buffer Page -+#define SDIO_REG_HCPWM1 0x0024 // HCI Current Power Mode 1 -+#define SDIO_REG_HCPWM2 0x0026 // HCI Current Power Mode 2 -+#define SDIO_REG_HTSFR_INFO 0x0030 // HTSF Informaion -+#define SDIO_REG_HRPWM1 0x0080 // HCI Request Power Mode 1 -+#define SDIO_REG_HRPWM2 0x0082 // HCI Request Power Mode 2 -+#define SDIO_REG_HPS_CLKR 0x0084 // HCI Power Save Clock -+#define SDIO_REG_HSUS_CTRL 0x0086 // SDIO HCI Suspend Control -+#define SDIO_REG_HIMR_ON 0x0090 //SDIO Host Extension Interrupt Mask Always -+#define SDIO_REG_HISR_ON 0x0091 //SDIO Host Extension Interrupt Status Always -+ -+#define SDIO_HIMR_DISABLED 0 -+ -+// RTL8723/RTL8188E SDIO Host Interrupt Mask Register -+#define SDIO_HIMR_RX_REQUEST_MSK BIT0 -+#define SDIO_HIMR_AVAL_MSK BIT1 -+#define SDIO_HIMR_TXERR_MSK BIT2 -+#define SDIO_HIMR_RXERR_MSK BIT3 -+#define SDIO_HIMR_TXFOVW_MSK BIT4 -+#define SDIO_HIMR_RXFOVW_MSK BIT5 -+#define SDIO_HIMR_TXBCNOK_MSK BIT6 -+#define SDIO_HIMR_TXBCNERR_MSK BIT7 -+#define SDIO_HIMR_BCNERLY_INT_MSK BIT16 -+#define SDIO_HIMR_C2HCMD_MSK BIT17 -+#define SDIO_HIMR_CPWM1_MSK BIT18 -+#define SDIO_HIMR_CPWM2_MSK BIT19 -+#define SDIO_HIMR_HSISR_IND_MSK BIT20 -+#define SDIO_HIMR_GTINT3_IND_MSK BIT21 -+#define SDIO_HIMR_GTINT4_IND_MSK BIT22 -+#define SDIO_HIMR_PSTIMEOUT_MSK BIT23 -+#define SDIO_HIMR_OCPINT_MSK BIT24 -+#define SDIO_HIMR_ATIMEND_MSK BIT25 -+#define SDIO_HIMR_ATIMEND_E_MSK BIT26 -+#define SDIO_HIMR_CTWEND_MSK BIT27 -+ -+//RTL8188E SDIO Specific -+#define SDIO_HIMR_MCU_ERR_MSK BIT28 -+#define SDIO_HIMR_TSF_BIT32_TOGGLE_MSK BIT29 -+ -+// SDIO Host Interrupt Service Routine -+#define SDIO_HISR_RX_REQUEST BIT0 -+#define SDIO_HISR_AVAL BIT1 -+#define SDIO_HISR_TXERR BIT2 -+#define SDIO_HISR_RXERR BIT3 -+#define SDIO_HISR_TXFOVW BIT4 -+#define SDIO_HISR_RXFOVW BIT5 -+#define SDIO_HISR_TXBCNOK BIT6 -+#define SDIO_HISR_TXBCNERR BIT7 -+#define SDIO_HISR_BCNERLY_INT BIT16 -+#define SDIO_HISR_C2HCMD BIT17 -+#define SDIO_HISR_CPWM1 BIT18 -+#define SDIO_HISR_CPWM2 BIT19 -+#define SDIO_HISR_HSISR_IND BIT20 -+#define SDIO_HISR_GTINT3_IND BIT21 -+#define SDIO_HISR_GTINT4_IND BIT22 -+#define SDIO_HISR_PSTIMEOUT BIT23 -+#define SDIO_HISR_OCPINT BIT24 -+#define SDIO_HISR_ATIMEND BIT25 -+#define SDIO_HISR_ATIMEND_E BIT26 -+#define SDIO_HISR_CTWEND BIT27 -+ -+//RTL8188E SDIO Specific -+#define SDIO_HISR_MCU_ERR BIT28 -+#define SDIO_HISR_TSF_BIT32_TOGGLE BIT29 -+ -+#define MASK_SDIO_HISR_CLEAR (SDIO_HISR_TXERR |\ -+ SDIO_HISR_RXERR |\ -+ SDIO_HISR_TXFOVW |\ -+ SDIO_HISR_RXFOVW |\ -+ SDIO_HISR_TXBCNOK |\ -+ SDIO_HISR_TXBCNERR |\ -+ SDIO_HISR_C2HCMD |\ -+ SDIO_HISR_CPWM1 |\ -+ SDIO_HISR_CPWM2 |\ -+ SDIO_HISR_HSISR_IND |\ -+ SDIO_HISR_GTINT3_IND |\ -+ SDIO_HISR_GTINT4_IND |\ -+ SDIO_HISR_PSTIMEOUT |\ -+ SDIO_HISR_OCPINT) -+ -+// SDIO HCI Suspend Control Register -+#define HCI_RESUME_PWR_RDY BIT1 -+#define HCI_SUS_CTRL BIT0 -+ -+// SDIO Tx FIFO related -+#define SDIO_TX_FREE_PG_QUEUE 4 // The number of Tx FIFO free page -+#define SDIO_TX_FIFO_PAGE_SZ 128 -+ -+#define MAX_TX_AGG_PACKET_NUMBER 0xFF -+#define MAX_TX_AGG_PACKET_NUMBER_8812 64 -+ -+//----------------------------------------------------- -+// -+// 0xFE00h ~ 0xFE55h USB Configuration -+// -+//----------------------------------------------------- -+ -+//2 USB Information (0xFE17) -+#define USB_IS_HIGH_SPEED 0 -+#define USB_IS_FULL_SPEED 1 -+#define USB_SPEED_MASK BIT(5) -+ -+#define USB_NORMAL_SIE_EP_MASK 0xF -+#define USB_NORMAL_SIE_EP_SHIFT 4 -+ -+//2 Special Option -+#define USB_AGG_EN BIT(3) -+ -+// 0; Use interrupt endpoint to upload interrupt pkt -+// 1; Use bulk endpoint to upload interrupt pkt, -+#define INT_BULK_SEL BIT(4) -+ -+//2REG_C2HEVT_CLEAR -+#define C2H_EVT_HOST_CLOSE 0x00 // Set by driver and notify FW that the driver has read the C2H command message -+#define C2H_EVT_FW_CLOSE 0xFF // Set by FW indicating that FW had set the C2H command message and it's not yet read by driver. -+ -+ -+//2REG_MULTI_FUNC_CTRL(For RTL8723 Only) -+#define WL_HWPDN_EN BIT0 // Enable GPIO[9] as WiFi HW PDn source -+#define WL_HWPDN_SL BIT1 // WiFi HW PDn polarity control -+#define WL_FUNC_EN BIT2 // WiFi function enable -+#define WL_HWROF_EN BIT3 // Enable GPIO[9] as WiFi RF HW PDn source -+#define BT_HWPDN_EN BIT16 // Enable GPIO[11] as BT HW PDn source -+#define BT_HWPDN_SL BIT17 // BT HW PDn polarity control -+#define BT_FUNC_EN BIT18 // BT function enable -+#define BT_HWROF_EN BIT19 // Enable GPIO[11] as BT/GPS RF HW PDn source -+#define GPS_HWPDN_EN BIT20 // Enable GPIO[10] as GPS HW PDn source -+#define GPS_HWPDN_SL BIT21 // GPS HW PDn polarity control -+#define GPS_FUNC_EN BIT22 // GPS function enable -+ -+//3 REG_LIFECTRL_CTRL -+#define HAL92C_EN_PKT_LIFE_TIME_BK BIT3 -+#define HAL92C_EN_PKT_LIFE_TIME_BE BIT2 -+#define HAL92C_EN_PKT_LIFE_TIME_VI BIT1 -+#define HAL92C_EN_PKT_LIFE_TIME_VO BIT0 -+ -+#define HAL92C_MSDU_LIFE_TIME_UNIT 128 // in us, said by Tim. -+ -+//2 8192D PartNo. -+#define PARTNO_92D_NIC (BIT7|BIT6) -+#define PARTNO_92D_NIC_REMARK (BIT5|BIT4) -+#define PARTNO_SINGLE_BAND_VS BIT3 -+#define PARTNO_SINGLE_BAND_VS_REMARK BIT1 -+#define PARTNO_CONCURRENT_BAND_VC (BIT3|BIT2) -+#define PARTNO_CONCURRENT_BAND_VC_REMARK (BIT1|BIT0) -+ -+//======================================================== -+// General definitions -+//======================================================== -+ -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8188E 176 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8812 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8723B 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_8192C 255 -+#define LAST_ENTRY_OF_TX_PKT_BUFFER_DUAL_MAC 127 -+ -+#define POLLING_LLT_THRESHOLD 20 -+#define POLLING_READY_TIMEOUT_COUNT 1000 -+ -+// GPIO BIT -+#define HAL_8192C_HW_GPIO_WPS_BIT BIT2 -+ -+#endif //__HAL_COMMON_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_data.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_data.h ---- linux-4.14.17/3rdparty/rtl8812au/include/hal_data.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_data.h 2018-02-06 17:42:30.718967283 +0200 -@@ -0,0 +1,490 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_DATA_H__ -+#define __HAL_DATA_H__ -+ -+#if 1//def CONFIG_SINGLE_IMG -+ -+#include "../hal/odm_precomp.h" -+ -+// -+// For RTL8723 WiFi/BT/GPS multi-function configuration. 2010.10.06. -+// -+typedef enum _RT_MULTI_FUNC{ -+ RT_MULTI_FUNC_NONE = 0x00, -+ RT_MULTI_FUNC_WIFI = 0x01, -+ RT_MULTI_FUNC_BT = 0x02, -+ RT_MULTI_FUNC_GPS = 0x04, -+}RT_MULTI_FUNC,*PRT_MULTI_FUNC; -+// -+// For RTL8723 WiFi PDn/GPIO polarity control configuration. 2010.10.08. -+// -+typedef enum _RT_POLARITY_CTL { -+ RT_POLARITY_LOW_ACT = 0, -+ RT_POLARITY_HIGH_ACT = 1, -+} RT_POLARITY_CTL, *PRT_POLARITY_CTL; -+ -+// For RTL8723 regulator mode. by tynli. 2011.01.14. -+typedef enum _RT_REGULATOR_MODE { -+ RT_SWITCHING_REGULATOR = 0, -+ RT_LDO_REGULATOR = 1, -+} RT_REGULATOR_MODE, *PRT_REGULATOR_MODE; -+ -+// -+// Interface type. -+// -+typedef enum _INTERFACE_SELECT_PCIE{ -+ INTF_SEL0_SOLO_MINICARD = 0, // WiFi solo-mCard -+ INTF_SEL1_BT_COMBO_MINICARD = 1, // WiFi+BT combo-mCard -+ INTF_SEL2_PCIe = 2, // PCIe Card -+} INTERFACE_SELECT_PCIE, *PINTERFACE_SELECT_PCIE; -+ -+ -+typedef enum _INTERFACE_SELECT_USB{ -+ INTF_SEL0_USB = 0, // USB -+ INTF_SEL1_USB_High_Power = 1, // USB with high power PA -+ INTF_SEL2_MINICARD = 2, // Minicard -+ INTF_SEL3_USB_Solo = 3, // USB solo-Slim module -+ INTF_SEL4_USB_Combo = 4, // USB Combo-Slim module -+ INTF_SEL5_USB_Combo_MF = 5, // USB WiFi+BT Multi-Function Combo, i.e., Proprietary layout(AS-VAU) which is the same as SDIO card -+} INTERFACE_SELECT_USB, *PINTERFACE_SELECT_USB; -+ -+typedef enum _RT_AMPDU_BRUST_MODE{ -+ RT_AMPDU_BRUST_NONE = 0, -+ RT_AMPDU_BRUST_92D = 1, -+ RT_AMPDU_BRUST_88E = 2, -+ RT_AMPDU_BRUST_8812_4 = 3, -+ RT_AMPDU_BRUST_8812_8 = 4, -+ RT_AMPDU_BRUST_8812_12 = 5, -+ RT_AMPDU_BRUST_8812_15 = 6, -+ RT_AMPDU_BRUST_8723B = 7, -+}RT_AMPDU_BRUST,*PRT_AMPDU_BRUST_MODE; -+ -+#define CHANNEL_MAX_NUMBER 14+24+21 // 14 is the max channel number -+#define CHANNEL_MAX_NUMBER_2G 14 -+#define CHANNEL_MAX_NUMBER_5G 54 // Please refer to "phy_GetChnlGroup8812A" and "Hal_ReadTxPowerInfo8812A" -+#define CHANNEL_MAX_NUMBER_5G_80M 7 -+#define CHANNEL_GROUP_MAX 3+9 // ch1~3, ch4~9, ch10~14 total three groups -+#define MAX_PG_GROUP 13 -+ -+#define MAX_REGULATION_NUM 3 -+#define MAX_RF_PATH_NUM_IN_POWER_LIMIT_TABLE 4 -+#define MAX_2_4G_BANDWITH_NUM 2 -+#define MAX_2_4G_RATE_SECTION_NUM 3 -+#define MAX_2_4G_CHANNEL_NUM 5 // adopt channel group instead of individual channel -+#define MAX_5G_BANDWITH_NUM 4 -+#define MAX_5G_RATE_SECTION_NUM 4 -+#define MAX_5G_CHANNEL_NUM 14 // adopt channel group instead of individual channel -+ -+#define MAX_BASE_NUM_IN_PHY_REG_PG_2_4G 4 // CCK:1,OFDM:2, HT:2 -+#define MAX_BASE_NUM_IN_PHY_REG_PG_5G 5 // OFDM:1, HT:2, VHT:2 -+ -+ -+//###### duplicate code,will move to ODM ######### -+#define IQK_MAC_REG_NUM 4 -+#define IQK_ADDA_REG_NUM 16 -+ -+#define IQK_BB_REG_NUM 10 -+#define IQK_BB_REG_NUM_92C 9 -+#define IQK_BB_REG_NUM_92D 10 -+#define IQK_BB_REG_NUM_test 6 -+ -+#define IQK_Matrix_Settings_NUM_92D 1+24+21 -+ -+#define HP_THERMAL_NUM 8 -+//###### duplicate code,will move to ODM ######### -+ -+#ifdef CONFIG_USB_RX_AGGREGATION -+typedef enum _USB_RX_AGG_MODE{ -+ USB_RX_AGG_DISABLE, -+ USB_RX_AGG_DMA, -+ USB_RX_AGG_USB, -+ USB_RX_AGG_MIX -+}USB_RX_AGG_MODE; -+ -+#endif -+ -+struct dm_priv -+{ -+ u8 DM_Type; -+ u8 DMFlag; -+ u8 InitDMFlag; -+ //u8 RSVD_1; -+ -+ u32 InitODMFlag; -+ //* Upper and Lower Signal threshold for Rate Adaptive*/ -+ int UndecoratedSmoothedPWDB; -+ int UndecoratedSmoothedCCK; -+ int EntryMinUndecoratedSmoothedPWDB; -+ int EntryMaxUndecoratedSmoothedPWDB; -+ int MinUndecoratedPWDBForDM; -+ int LastMinUndecoratedPWDBForDM; -+ -+ s32 UndecoratedSmoothedBeacon; -+ #ifdef CONFIG_BT_COEXIST -+ s32 BT_EntryMinUndecoratedSmoothedPWDB; -+ s32 BT_EntryMaxUndecoratedSmoothedPWDB; -+ #endif -+ -+//###### duplicate code,will move to ODM ######### -+ //for High Power -+ u8 bDynamicTxPowerEnable; -+ u8 LastDTPLvl; -+ u8 DynamicTxHighPowerLvl;//Add by Jacken Tx Power Control for Near/Far Range 2008/03/06 -+ -+ //for tx power tracking -+ u8 bTXPowerTracking; -+ u8 TXPowercount; -+ u8 bTXPowerTrackingInit; -+ u8 TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default -+ u8 TM_Trigger; -+ -+ u8 ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 -+ u8 ThermalValue; -+ u8 ThermalValue_LCK; -+ u8 ThermalValue_IQK; -+ u8 ThermalValue_DPK; -+ u8 bRfPiEnable; -+ //u8 RSVD_2; -+ -+ //for APK -+ u32 APKoutput[2][2]; //path A/B; output1_1a/output1_2a -+ u8 bAPKdone; -+ u8 bAPKThermalMeterIgnore; -+ u8 bDPdone; -+ u8 bDPPathAOK; -+ u8 bDPPathBOK; -+ //u8 RSVD_3; -+ //u8 RSVD_4; -+ //u8 RSVD_5; -+ -+ //for IQK -+ u32 ADDA_backup[IQK_ADDA_REG_NUM]; -+ u32 IQK_MAC_backup[IQK_MAC_REG_NUM]; -+ u32 IQK_BB_backup_recover[9]; -+ u32 IQK_BB_backup[IQK_BB_REG_NUM]; -+ -+ u8 PowerIndex_backup[6]; -+ u8 OFDM_index[2]; -+ -+ u8 bCCKinCH14; -+ u8 CCK_index; -+ u8 bDoneTxpower; -+ u8 CCK_index_HP; -+ -+ u8 OFDM_index_HP[2]; -+ u8 ThermalValue_HP[HP_THERMAL_NUM]; -+ u8 ThermalValue_HP_index; -+ //u8 RSVD_6; -+ -+ //for TxPwrTracking2 -+ s32 RegE94; -+ s32 RegE9C; -+ s32 RegEB4; -+ s32 RegEBC; -+ -+ u32 TXPowerTrackingCallbackCnt; //cosa add for debug -+ -+ u32 prv_traffic_idx; // edca turbo -+//###### duplicate code,will move to ODM ######### -+ -+ // Add for Reading Initial Data Rate SEL Register 0x484 during watchdog. Using for fill tx desc. 2011.3.21 by Thomas -+ u8 INIDATA_RATE[32]; -+}; -+ -+ -+typedef struct hal_com_data -+{ -+ HAL_VERSION VersionID; -+ RT_MULTI_FUNC MultiFunc; // For multi-function consideration. -+ RT_POLARITY_CTL PolarityCtl; // For Wifi PDn Polarity control. -+ RT_REGULATOR_MODE RegulatorMode; // switching regulator or LDO -+ -+ u16 FirmwareVersion; -+ u16 FirmwareVersionRev; -+ u16 FirmwareSubVersion; -+ u16 FirmwareSignature; -+ -+ //current WIFI_PHY values -+ WIRELESS_MODE CurrentWirelessMode; -+ CHANNEL_WIDTH CurrentChannelBW; -+ BAND_TYPE CurrentBandType; //0:2.4G, 1:5G -+ BAND_TYPE BandSet; -+ u8 CurrentChannel; -+ u8 CurrentCenterFrequencyIndex1; -+ u8 nCur40MhzPrimeSC;// Control channel sub-carrier -+ u8 nCur80MhzPrimeSC; //used for primary 40MHz of 80MHz mode -+ -+ u16 CustomerID; -+ u16 BasicRateSet; -+ u16 ForcedDataRate;// Force Data Rate. 0: Auto, 0x02: 1M ~ 0x6C: 54M. -+ u32 ReceiveConfig; -+ -+ //rf_ctrl -+ u8 rf_chip; -+ u8 rf_type; -+ u8 NumTotalRFPath; -+ -+ u8 InterfaceSel; -+ u8 framesync; -+ u32 framesyncC34; -+ u8 framesyncMonitor; -+ u8 DefaultInitialGain[4]; -+ // -+ // EEPROM setting. -+ // -+ u16 EEPROMVID; -+ u16 EEPROMSVID; -+ u16 EEPROMPID; -+ u16 EEPROMSDID; -+ -+ u8 EEPROMCustomerID; -+ u8 EEPROMSubCustomerID; -+ u8 EEPROMVersion; -+ u8 EEPROMRegulatory; -+ u8 EEPROMThermalMeter; -+ u8 EEPROMBluetoothCoexist; -+ u8 EEPROMBluetoothType; -+ u8 EEPROMBluetoothAntNum; -+ u8 EEPROMBluetoothAntIsolation; -+ u8 EEPROMBluetoothRadioShared; -+ u8 bTXPowerDataReadFromEEPORM; -+ u8 bAPKThermalMeterIgnore; -+ -+ bool EepromOrEfuse; -+ u8 EfuseUsedPercentage; -+ u16 EfuseUsedBytes; -+ //u8 EfuseMap[2][HWSET_MAX_SIZE_JAGUAR]; -+ EFUSE_HAL EfuseHal; -+ -+ //---------------------------------------------------------------------------------// -+ //3 [2.4G] -+ u8 Index24G_CCK_Base[MAX_RF_PATH][CHANNEL_MAX_NUMBER]; -+ u8 Index24G_BW40_Base[MAX_RF_PATH][CHANNEL_MAX_NUMBER]; -+ //If only one tx, only BW20 and OFDM are used. -+ s8 CCK_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 OFDM_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_24G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ //3 [5G] -+ u8 Index5G_BW40_Base[MAX_RF_PATH][CHANNEL_MAX_NUMBER]; -+ u8 Index5G_BW80_Base[MAX_RF_PATH][CHANNEL_MAX_NUMBER_5G_80M]; -+ s8 OFDM_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW80_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ -+ u8 Regulation2_4G; -+ u8 Regulation5G; -+ -+ u8 TxPwrInPercentage; -+ -+ u8 TxPwrCalibrateRate; -+ // -+ // TX power by rate table at most 4RF path. -+ // The register is -+ // -+ // VHT TX power by rate off setArray = -+ // Band:-2G&5G = 0 / 1 -+ // RF: at most 4*4 = ABCD=0/1/2/3 -+ // CCK=0 OFDM=1/2 HT-MCS 0-15=3/4/56 VHT=7/8/9/10/11 -+ // -+ u8 TxPwrByRateTable; -+ u8 TxPwrByRateBand; -+ u32 TxPwrByRateOffset[TX_PWR_BY_RATE_NUM_BAND] -+ [TX_PWR_BY_RATE_NUM_RF] -+ [TX_PWR_BY_RATE_NUM_SECTION]; -+ //---------------------------------------------------------------------------------// -+ -+ //2 Power Limit Table -+ u8 TxPwrLevelCck[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; -+ u8 TxPwrLevelHT40_1S[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; // For HT 40MHZ pwr -+ u8 TxPwrLevelHT40_2S[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; // For HT 40MHZ pwr -+ u8 TxPwrHt20Diff[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER];// HT 20<->40 Pwr diff -+ u8 TxPwrLegacyHtDiff[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER];// For HT<->legacy pwr diff -+ -+ // Power Limit Table for 2.4G -+ u8 TxPwrLimit_2_4G[MAX_REGULATION_NUM] -+ [MAX_2_4G_BANDWITH_NUM] -+ [MAX_2_4G_RATE_SECTION_NUM] -+ [MAX_2_4G_CHANNEL_NUM] -+ [MAX_RF_PATH_NUM]; -+ -+ // Power Limit Table for 5G -+ u8 TxPwrLimit_5G[MAX_REGULATION_NUM] -+ [MAX_5G_BANDWITH_NUM] -+ [MAX_5G_RATE_SECTION_NUM] -+ [MAX_5G_CHANNEL_NUM] -+ [MAX_RF_PATH_NUM]; -+ -+ -+ // Store the original power by rate value of the base of each rate section of rf path A & B -+ u8 TxPwrByRateBase2_4G[MAX_RF_PATH_NUM_IN_POWER_LIMIT_TABLE] -+ [MAX_BASE_NUM_IN_PHY_REG_PG_2_4G]; -+ u8 TxPwrByRateBase5G[MAX_RF_PATH_NUM_IN_POWER_LIMIT_TABLE] -+ [MAX_BASE_NUM_IN_PHY_REG_PG_5G]; -+ -+ // For power group -+ u8 PwrGroupHT20[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; -+ u8 PwrGroupHT40[RF_PATH_MAX_92C_88E][CHANNEL_MAX_NUMBER]; -+ -+ -+ -+ -+ u8 PGMaxGroup; -+ u8 LegacyHTTxPowerDiff;// Legacy to HT rate power diff -+ // The current Tx Power Level -+ u8 CurrentCckTxPwrIdx; -+ u8 CurrentOfdm24GTxPwrIdx; -+ u8 CurrentBW2024GTxPwrIdx; -+ u8 CurrentBW4024GTxPwrIdx; -+ -+ // Read/write are allow for following hardware information variables -+ u8 pwrGroupCnt; -+ u32 MCSTxPowerLevelOriginalOffset[MAX_PG_GROUP][16]; -+ u32 CCKTxPowerLevelOriginalOffset; -+ -+ u8 CrystalCap; -+ u32 AntennaTxPath; // Antenna path Tx -+ u32 AntennaRxPath; // Antenna path Rx -+ -+ u8 PAType_2G; -+ u8 PAType_5G; -+ u8 LNAType_2G; -+ u8 LNAType_5G; -+ u8 ExternalPA_2G; -+ u8 ExternalLNA_2G; -+ u8 ExternalPA_5G; -+ u8 ExternalLNA_5G; -+ u8 RFEType; -+ u8 BoardType; -+ u8 ExternalPA; -+ u8 bIQKInitialized; -+ bool bLCKInProgress; -+ -+ bool bSwChnl; -+ bool bSetChnlBW; -+ bool bChnlBWInitialzed; -+ bool bNeedIQK; -+ -+ u8 bLedOpenDrain; // Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. -+ u8 TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default -+ u8 b1x1RecvCombine; // for 1T1R receive combining -+ -+ u32 AcParam_BE; //Original parameter for BE, use for EDCA turbo. -+ -+ BB_REGISTER_DEFINITION_T PHYRegDef[4]; //Radio A/B/C/D -+ -+ u32 RfRegChnlVal[2]; -+ -+ //RDG enable -+ bool bRDGEnable; -+ -+ //for host message to fw -+ u8 LastHMEBoxNum; -+ -+ u8 fw_ractrl; -+ u8 RegTxPause; -+ // Beacon function related global variable. -+ u8 RegBcnCtrlVal; -+ u8 RegFwHwTxQCtrl; -+ u8 RegReg542; -+ u8 RegCR_1; -+ u8 Reg837; -+ u8 RegRFPathS1; -+ u16 RegRRSR; -+ -+ u8 CurAntenna; -+ u8 AntDivCfg; -+ u8 TRxAntDivType; -+ -+ u8 bDumpRxPkt;//for debug -+ u8 bDumpTxPkt;//for debug -+ u8 FwRsvdPageStartOffset; //2010.06.23. Added by tynli. Reserve page start offset except beacon in TxQ. -+ -+ // 2010/08/09 MH Add CU power down mode. -+ bool pwrdown; -+ -+ // Add for dual MAC 0--Mac0 1--Mac1 -+ u32 interfaceIndex; -+ -+ u8 OutEpQueueSel; -+ u8 OutEpNumber; -+ -+ // 2010/12/10 MH Add for USB aggreation mode dynamic shceme. -+ bool UsbRxHighSpeedMode; -+ -+ // 2010/11/22 MH Add for slim combo debug mode selective. -+ // This is used for fix the drawback of CU TSMC-A/UMC-A cut. HW auto suspend ability. Close BT clock. -+ bool SlimComboDbg; -+ -+#ifdef CONFIG_P2P -+ u8 p2p_ps_offload; -+#endif -+ -+ u8 AMPDUDensity; -+ -+ // Auto FSM to Turn On, include clock, isolation, power control for MAC only -+ u8 bMacPwrCtrlOn; -+ -+ RT_AMPDU_BRUST AMPDUBurstMode; //92C maybe not use, but for compile successfully -+ -+ u32 UsbBulkOutSize; -+ bool bSupportUSB3; -+ -+ // Interrupt relatd register information. -+ u32 IntArray[3];//HISR0,HISR1,HSISR -+ u32 IntrMask[3]; -+ u8 C2hArray[16]; -+ #ifdef CONFIG_USB_TX_AGGREGATION -+ u8 UsbTxAggMode; -+ u8 UsbTxAggDescNum; -+ #endif // CONFIG_USB_TX_AGGREGATION -+ -+ #ifdef CONFIG_USB_RX_AGGREGATION -+ u16 HwRxPageSize; // Hardware setting -+ u32 MaxUsbRxAggBlock; -+ -+ USB_RX_AGG_MODE UsbRxAggMode; -+ u8 UsbRxAggBlockCount; // USB Block count. Block size is 512-byte in hight speed and 64-byte in full speed -+ u8 UsbRxAggBlockTimeout; -+ u8 UsbRxAggPageCount; // 8192C DMA page count -+ u8 UsbRxAggPageTimeout; -+ -+ u8 RegAcUsbDmaSize; -+ u8 RegAcUsbDmaTime; -+ #endif//CONFIG_USB_RX_AGGREGATION -+ -+ struct dm_priv dmpriv; -+ DM_ODM_T odmpriv; -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ struct sreset_priv srestpriv; -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ struct btcoexist_priv bt_coexist; -+#endif -+} HAL_DATA_COMMON, *PHAL_DATA_COMMON; -+ -+ -+typedef struct hal_com_data HAL_DATA_TYPE, *PHAL_DATA_TYPE; -+#define GET_HAL_DATA(__pAdapter) ((HAL_DATA_TYPE *)((__pAdapter)->HalData)) -+#define GET_HAL_RFPATH_NUM(__pAdapter) (((HAL_DATA_TYPE *)((__pAdapter)->HalData))->NumTotalRFPath ) -+#define RT_GetInterfaceSelection(_Adapter) (GET_HAL_DATA(_Adapter)->InterfaceSel) -+#endif -+ -+ -+#endif //__HAL_DATA_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_intf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_intf.h ---- linux-4.14.17/3rdparty/rtl8812au/include/hal_intf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_intf.h 2018-02-06 17:42:30.718967283 +0200 -@@ -0,0 +1,536 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_INTF_H__ -+#define __HAL_INTF_H__ -+ -+ -+enum RTL871X_HCI_TYPE { -+ RTW_PCIE = BIT0, -+ RTW_USB = BIT1, -+ RTW_SDIO = BIT2, -+ RTW_GSPI = BIT3, -+}; -+ -+enum _CHIP_TYPE { -+ -+ NULL_CHIP_TYPE, -+ RTL8188C_8192C, -+ RTL8192D, -+ RTL8723A, -+ RTL8188E, -+ RTL8192E, -+ RTL8812, -+ RTL8821, //RTL8811 -+ RTL8723B, -+ MAX_CHIP_TYPE -+}; -+ -+ -+typedef enum _HW_VARIABLES{ -+ HW_VAR_MEDIA_STATUS, -+ HW_VAR_MEDIA_STATUS1, -+ HW_VAR_SET_OPMODE, -+ HW_VAR_MAC_ADDR, -+ HW_VAR_BSSID, -+ HW_VAR_INIT_RTS_RATE, -+ HW_VAR_BASIC_RATE, -+ HW_VAR_TXPAUSE, -+ HW_VAR_BCN_FUNC, -+ HW_VAR_CORRECT_TSF, -+ HW_VAR_CHECK_BSSID, -+ HW_VAR_MLME_DISCONNECT, -+ HW_VAR_MLME_SITESURVEY, -+ HW_VAR_MLME_JOIN, -+ HW_VAR_ON_RCR_AM, -+ HW_VAR_OFF_RCR_AM, -+ HW_VAR_BEACON_INTERVAL, -+ HW_VAR_SLOT_TIME, -+ HW_VAR_RESP_SIFS, -+ HW_VAR_ACK_PREAMBLE, -+ HW_VAR_SEC_CFG, -+ HW_VAR_BCN_VALID, -+ HW_VAR_RF_TYPE, -+ HW_VAR_DM_FLAG, -+ HW_VAR_DM_FUNC_OP, -+ HW_VAR_DM_FUNC_SET, -+ HW_VAR_DM_FUNC_CLR, -+ HW_VAR_CAM_EMPTY_ENTRY, -+ HW_VAR_CAM_INVALID_ALL, -+ HW_VAR_CAM_WRITE, -+ HW_VAR_CAM_READ, -+ HW_VAR_AC_PARAM_VO, -+ HW_VAR_AC_PARAM_VI, -+ HW_VAR_AC_PARAM_BE, -+ HW_VAR_AC_PARAM_BK, -+ HW_VAR_ACM_CTRL, -+ HW_VAR_AMPDU_MIN_SPACE, -+ HW_VAR_AMPDU_FACTOR, -+ HW_VAR_RXDMA_AGG_PG_TH, -+ HW_VAR_SET_RPWM, -+ HW_VAR_H2C_FW_PWRMODE, -+ HW_VAR_H2C_PS_TUNE_PARAM, -+ HW_VAR_H2C_FW_JOINBSSRPT, -+ HW_VAR_FWLPS_RF_ON, -+ HW_VAR_H2C_FW_P2P_PS_OFFLOAD, -+ HW_VAR_TDLS_WRCR, -+ HW_VAR_TDLS_INIT_CH_SEN, -+ HW_VAR_TDLS_RS_RCR, -+ HW_VAR_TDLS_DONE_CH_SEN, -+ HW_VAR_INITIAL_GAIN, -+ HW_VAR_TRIGGER_GPIO_0, -+ HW_VAR_BT_SET_COEXIST, -+ HW_VAR_BT_ISSUE_DELBA, -+ HW_VAR_CURRENT_ANTENNA, -+ HW_VAR_ANTENNA_DIVERSITY_LINK, -+ HW_VAR_ANTENNA_DIVERSITY_SELECT, -+ HW_VAR_SWITCH_EPHY_WoWLAN, -+ HW_VAR_EFUSE_USAGE, -+ HW_VAR_EFUSE_BYTES, -+ HW_VAR_EFUSE_BT_USAGE, -+ HW_VAR_EFUSE_BT_BYTES, -+ HW_VAR_FIFO_CLEARN_UP, -+ HW_VAR_CHECK_TXBUF, -+ HW_VAR_APFM_ON_MAC, //Auto FSM to Turn On, include clock, isolation, power control for MAC only -+ // The valid upper nav range for the HW updating, if the true value is larger than the upper range, the HW won't update it. -+ // Unit in microsecond. 0 means disable this function. -+#ifdef CONFIG_WOWLAN -+ HW_VAR_WOWLAN, -+#endif -+ HW_VAR_NAV_UPPER, -+ HW_VAR_C2H_HANDLE, -+ HW_VAR_RPT_TIMER_SETTING, -+ HW_VAR_TX_RPT_MAX_MACID, -+ HW_VAR_H2C_MEDIA_STATUS_RPT, -+ HW_VAR_CHK_HI_QUEUE_EMPTY, -+ HW_VAR_DL_BCN_SEL, -+ HW_VAR_AMPDU_MAX_TIME, -+ HW_VAR_WIRELESS_MODE, -+ HW_VAR_USB_MODE, -+}HW_VARIABLES; -+ -+typedef enum _HAL_DEF_VARIABLE{ -+ HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, -+ HAL_DEF_IS_SUPPORT_ANT_DIV, -+ HAL_DEF_CURRENT_ANTENNA, -+ HAL_DEF_DRVINFO_SZ, -+ HAL_DEF_MAX_RECVBUF_SZ, -+ HAL_DEF_RX_PACKET_OFFSET, -+ HAL_DEF_DBG_DUMP_RXPKT,//for dbg -+ HAL_DEF_DBG_DM_FUNC,//for dbg -+ HAL_DEF_RA_DECISION_RATE, -+ HAL_DEF_RA_SGI, -+ HAL_DEF_PT_PWR_STATUS, -+ HAL_DEF_LDPC, // LDPC support -+ HAL_DEF_TX_STBC, // TX STBC support -+ HAL_DEF_RX_STBC, // RX STBC support -+ HW_VAR_MAX_RX_AMPDU_FACTOR, -+ HW_DEF_RA_INFO_DUMP, -+ HAL_DEF_DBG_DUMP_TXPKT, -+ HW_DEF_FA_CNT_DUMP, -+ HW_DEF_ODM_DBG_FLAG, -+ HAL_DEF_TX_PAGE_BOUNDARY, -+ HAL_DEF_TX_PAGE_BOUNDARY_WOWLAN, -+ HAL_DEF_ANT_DETECT,//to do for 8723a -+ -+}HAL_DEF_VARIABLE; -+ -+typedef enum _HAL_ODM_VARIABLE{ -+ HAL_ODM_STA_INFO, -+ HAL_ODM_P2P_STATE, -+ HAL_ODM_WIFI_DISPLAY_STATE, -+}HAL_ODM_VARIABLE; -+ -+typedef enum _HAL_INTF_PS_FUNC{ -+ HAL_USB_SELECT_SUSPEND, -+ HAL_MAX_ID, -+}HAL_INTF_PS_FUNC; -+ -+typedef s32 (*c2h_id_filter)(u8 id); -+ -+struct hal_ops { -+ u32 (*hal_power_on)(_adapter *padapter); -+ u32 (*hal_init)(_adapter *padapter); -+ u32 (*hal_deinit)(_adapter *padapter); -+ -+ void (*free_hal_data)(_adapter *padapter); -+ -+ u32 (*inirp_init)(_adapter *padapter); -+ u32 (*inirp_deinit)(_adapter *padapter); -+ -+ s32 (*init_xmit_priv)(_adapter *padapter); -+ void (*free_xmit_priv)(_adapter *padapter); -+ -+ s32 (*init_recv_priv)(_adapter *padapter); -+ void (*free_recv_priv)(_adapter *padapter); -+ -+ void (*InitSwLeds)(_adapter *padapter); -+ void (*DeInitSwLeds)(_adapter *padapter); -+ -+ void (*dm_init)(_adapter *padapter); -+ void (*dm_deinit)(_adapter *padapter); -+ void (*read_chip_version)(_adapter *padapter); -+ -+ void (*init_default_value)(_adapter *padapter); -+ -+ void (*intf_chip_configure)(_adapter *padapter); -+ -+ void (*read_adapter_info)(_adapter *padapter); -+ -+ void (*enable_interrupt)(_adapter *padapter); -+ void (*disable_interrupt)(_adapter *padapter); -+ s32 (*interrupt_handler)(_adapter *padapter); -+ -+ void (*set_bwmode_handler)(_adapter *padapter, CHANNEL_WIDTH Bandwidth, u8 Offset); -+ void (*set_channel_handler)(_adapter *padapter, u8 channel); -+ void (*set_chnl_bw_handler)(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80); -+ -+ void (*hal_dm_watchdog)(_adapter *padapter); -+ -+ void (*SetHwRegHandler)(_adapter *padapter, u8 variable,u8* val); -+ void (*GetHwRegHandler)(_adapter *padapter, u8 variable,u8* val); -+ -+ u8 (*GetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void * pValue); -+ u8 (*SetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void * pValue); -+ -+ void (*GetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void * pValue1,bool bSet); -+ void (*SetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void * pValue1,bool bSet); -+ -+ void (*UpdateRAMaskHandler)(_adapter *padapter, u32 mac_id, u8 rssi_level); -+ void (*SetBeaconRelatedRegistersHandler)(_adapter *padapter); -+ -+ void (*Add_RateATid)(_adapter *padapter, u32 bitmap, u8* arg, u8 rssi_level); -+#ifdef CONFIG_CONCURRENT_MODE -+ void (*clone_haldata)(_adapter *dst_padapter, _adapter *src_padapter); -+#endif -+ void (*run_thread)(_adapter *padapter); -+ void (*cancel_thread)(_adapter *padapter); -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+ u8 (*AntDivBeforeLinkHandler)(_adapter *padapter); -+ void (*AntDivCompareHandler)(_adapter *padapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src); -+#endif -+ u8 (*interface_ps_func)(_adapter *padapter,HAL_INTF_PS_FUNC efunc_id, u8* val); -+ -+ s32 (*hal_xmit)(_adapter *padapter, struct xmit_frame *pxmitframe); -+ s32 (*mgnt_xmit)(_adapter *padapter, struct xmit_frame *pmgntframe); -+ s32 (*hal_xmitframe_enqueue)(_adapter *padapter, struct xmit_frame *pxmitframe); -+ -+ u32 (*read_bbreg)(_adapter *padapter, u32 RegAddr, u32 BitMask); -+ void (*write_bbreg)(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); -+ u32 (*read_rfreg)(_adapter *padapter, u8 eRFPath, u32 RegAddr, u32 BitMask); -+ void (*write_rfreg)(_adapter *padapter, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data); -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ s32 (*hostap_mgnt_xmit_entry)(_adapter *padapter, _pkt *pkt); -+#endif -+ -+ void (*EfusePowerSwitch)(_adapter *padapter, u8 bWrite, u8 PwrState); -+ void (*ReadEFuse)(_adapter *padapter, u8 efuseType, u16 _offset, u16 _size_byte, u8 *pbuf, bool bPseudoTest); -+ void (*EFUSEGetEfuseDefinition)(_adapter *padapter, u8 efuseType, u8 type, void *pOut, bool bPseudoTest); -+ u16 (*EfuseGetCurrentSize)(_adapter *padapter, u8 efuseType, bool bPseudoTest); -+ int (*Efuse_PgPacketRead)(_adapter *padapter, u8 offset, u8 *data, bool bPseudoTest); -+ int (*Efuse_PgPacketWrite)(_adapter *padapter, u8 offset, u8 word_en, u8 *data, bool bPseudoTest); -+ u8 (*Efuse_WordEnableDataWrite)(_adapter *padapter, u16 efuse_addr, u8 word_en, u8 *data, bool bPseudoTest); -+ bool (*Efuse_PgPacketWrite_BT)(_adapter *padapter, u8 offset, u8 word_en, u8 *data, bool bPseudoTest); -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ void (*sreset_init_value)(_adapter *padapter); -+ void (*sreset_reset_value)(_adapter *padapter); -+ void (*silentreset)(_adapter *padapter); -+ void (*sreset_xmit_status_check)(_adapter *padapter); -+ void (*sreset_linked_status_check) (_adapter *padapter); -+ u8 (*sreset_get_wifi_status)(_adapter *padapter); -+ bool (*sreset_inprogress)(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_IOL -+ int (*IOL_exec_cmds_sync)(_adapter *padapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt); -+#endif -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+ s32 (*xmit_thread_handler)(_adapter *padapter); -+#endif -+ void (*hal_notch_filter)(_adapter * adapter, bool enable); -+ void (*hal_reset_security_engine)(_adapter * adapter); -+ s32 (*c2h_handler)(_adapter *padapter, struct c2h_evt_hdr *c2h_evt); -+ c2h_id_filter c2h_id_filter_ccx; -+}; -+ -+typedef enum _RT_EEPROM_TYPE{ -+ EEPROM_93C46, -+ EEPROM_93C56, -+ EEPROM_BOOT_EFUSE, -+}RT_EEPROM_TYPE,*PRT_EEPROM_TYPE; -+ -+ -+ -+#define RF_CHANGE_BY_INIT 0 -+#define RF_CHANGE_BY_IPS BIT28 -+#define RF_CHANGE_BY_PS BIT29 -+#define RF_CHANGE_BY_HW BIT30 -+#define RF_CHANGE_BY_SW BIT31 -+ -+typedef enum _HARDWARE_TYPE{ -+ HARDWARE_TYPE_RTL8180, -+ HARDWARE_TYPE_RTL8185, -+ HARDWARE_TYPE_RTL8187, -+ HARDWARE_TYPE_RTL8188, -+ HARDWARE_TYPE_RTL8190P, -+ HARDWARE_TYPE_RTL8192E, -+ HARDWARE_TYPE_RTL819xU, -+ HARDWARE_TYPE_RTL8192SE, -+ HARDWARE_TYPE_RTL8192SU, -+ HARDWARE_TYPE_RTL8192CE, -+ HARDWARE_TYPE_RTL8192CU, -+ HARDWARE_TYPE_RTL8192DE, -+ HARDWARE_TYPE_RTL8192DU, -+ HARDWARE_TYPE_RTL8723AE, -+ HARDWARE_TYPE_RTL8723AU, -+ HARDWARE_TYPE_RTL8723AS, -+ HARDWARE_TYPE_RTL8188EE, -+ HARDWARE_TYPE_RTL8188EU, -+ HARDWARE_TYPE_RTL8188ES, -+// NEW_GENERATION_IC -+ HARDWARE_TYPE_RTL8192EE, -+ HARDWARE_TYPE_RTL8192EU, -+ HARDWARE_TYPE_RTL8192ES, -+ HARDWARE_TYPE_RTL8812E, -+ HARDWARE_TYPE_RTL8812AU, -+ HARDWARE_TYPE_RTL8811AU, -+ HARDWARE_TYPE_RTL8821E, -+ HARDWARE_TYPE_RTL8821U, -+ HARDWARE_TYPE_RTL8821S, -+ HARDWARE_TYPE_RTL8723BE, -+ HARDWARE_TYPE_RTL8723BU, -+ HARDWARE_TYPE_RTL8723BS, -+ -+ HARDWARE_TYPE_MAX, -+}HARDWARE_TYPE; -+ -+#define IS_NEW_GENERATION_IC(_Adapter) (((PADAPTER)_Adapter)->HardwareType >=HARDWARE_TYPE_RTL8192EE) -+// -+// RTL8192C Series -+// -+#define IS_HARDWARE_TYPE_8192CE(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192CE) -+#define IS_HARDWARE_TYPE_8192CU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192CU) -+#define IS_HARDWARE_TYPE_8192C(_Adapter) \ -+(IS_HARDWARE_TYPE_8192CE(_Adapter) || IS_HARDWARE_TYPE_8192CU(_Adapter)) -+ -+// -+// RTL8192D Series -+// -+#define IS_HARDWARE_TYPE_8192DE(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192DE) -+#define IS_HARDWARE_TYPE_8192DU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192DU) -+#define IS_HARDWARE_TYPE_8192D(_Adapter) \ -+(IS_HARDWARE_TYPE_8192DE(_Adapter) || IS_HARDWARE_TYPE_8192DU(_Adapter)) -+ -+// -+// RTL8723A Series -+// -+#define IS_HARDWARE_TYPE_8723AE(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8723AE) -+#define IS_HARDWARE_TYPE_8723AU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8723AU) -+#define IS_HARDWARE_TYPE_8723AS(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8723AS) -+#define IS_HARDWARE_TYPE_8723A(_Adapter) \ -+(IS_HARDWARE_TYPE_8723AE(_Adapter) || IS_HARDWARE_TYPE_8723AU(_Adapter) || IS_HARDWARE_TYPE_8723AS(_Adapter)) -+ -+// -+// RTL8188E Series -+// -+#define IS_HARDWARE_TYPE_8188EE(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8188EE) -+#define IS_HARDWARE_TYPE_8188EU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8188EU) -+#define IS_HARDWARE_TYPE_8188ES(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8188ES) -+#define IS_HARDWARE_TYPE_8188E(_Adapter) \ -+(IS_HARDWARE_TYPE_8188EE(_Adapter) || IS_HARDWARE_TYPE_8188EU(_Adapter) || IS_HARDWARE_TYPE_8188ES(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_OLDER_THAN_8812A(_Adapter) \ -+(IS_HARDWARE_TYPE_8192D(_Adapter) || IS_HARDWARE_TYPE_8192C(_Adapter) ||\ -+ IS_HARDWARE_TYPE_8723AE(_Adapter) || IS_HARDWARE_TYPE_8723AU(_Adapter) || IS_HARDWARE_TYPE_8723AS(_Adapter) ||\ -+ IS_HARDWARE_TYPE_8188EE(_Adapter) || IS_HARDWARE_TYPE_8188EU(_Adapter) || IS_HARDWARE_TYPE_8188ES(_Adapter)\ -+) -+ -+// RTL8812 Series -+#define IS_HARDWARE_TYPE_8812E(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8812E) -+#define IS_HARDWARE_TYPE_8812AU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8812AU) -+#define IS_HARDWARE_TYPE_8812(_Adapter) \ -+(IS_HARDWARE_TYPE_8812E(_Adapter) || IS_HARDWARE_TYPE_8812AU(_Adapter)) -+ -+// RTL8821 Series -+#define IS_HARDWARE_TYPE_8821E(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8821E) -+#define IS_HARDWARE_TYPE_8811AU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8811AU) -+#define IS_HARDWARE_TYPE_8821U(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8821U ||\ -+ ((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8811AU) -+#define IS_HARDWARE_TYPE_8821S(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8821S) -+#define IS_HARDWARE_TYPE_8821(_Adapter) \ -+(IS_HARDWARE_TYPE_8821E(_Adapter) || IS_HARDWARE_TYPE_8821U(_Adapter)|| IS_HARDWARE_TYPE_8821S(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_JAGUAR(_Adapter) \ -+(IS_HARDWARE_TYPE_8812(_Adapter) || IS_HARDWARE_TYPE_8821(_Adapter)) -+ -+//RTL8192E Series -+#define IS_HARDWARE_TYPE_8192EE(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192EE) -+#define IS_HARDWARE_TYPE_8192EU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192EU) -+#define IS_HARDWARE_TYPE_8192ES(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8192ES) -+ -+#define IS_HARDWARE_TYPE_8192E(_Adapter) \ -+(IS_HARDWARE_TYPE_8192EE(_Adapter) || IS_HARDWARE_TYPE_8192EU(_Adapter) ||IS_HARDWARE_TYPE_8192ES(_Adapter)) -+ -+#define IS_HARDWARE_TYPE_8723BE(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8723BE) -+#define IS_HARDWARE_TYPE_8723BU(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8723BU) -+#define IS_HARDWARE_TYPE_8723BS(_Adapter) (((PADAPTER)_Adapter)->HardwareType==HARDWARE_TYPE_RTL8723BS) -+ -+ -+#define IS_HARDWARE_TYPE_8723B(_Adapter) \ -+ (IS_HARDWARE_TYPE_8723BE(_Adapter) || IS_HARDWARE_TYPE_8723BU(_Adapter) ||IS_HARDWARE_TYPE_8723BS(_Adapter)) -+ -+typedef struct eeprom_priv EEPROM_EFUSE_PRIV, *PEEPROM_EFUSE_PRIV; -+#define GET_EEPROM_EFUSE_PRIV(adapter) (&adapter->eeprompriv) -+#define is_boot_from_eeprom(adapter) (adapter->eeprompriv.EepromOrEfuse) -+ -+#ifdef CONFIG_WOWLAN -+typedef enum _wowlan_subcode{ -+ WOWLAN_PATTERN_MATCH = 1, -+ WOWLAN_MAGIC_PACKET = 2, -+ WOWLAN_UNICAST = 3, -+ WOWLAN_SET_PATTERN = 4, -+ WOWLAN_DUMP_REG = 5, -+ WOWLAN_ENABLE = 6, -+ WOWLAN_DISABLE = 7, -+ WOWLAN_STATUS = 8, -+ WOWLAN_DEBUG_RELOAD_FW = 9, -+ WOWLAN_DEBUG_1 =10, -+ WOWLAN_DEBUG_2 =11 -+}wowlan_subcode; -+ -+struct wowlan_ioctl_param{ -+ unsigned int subcode; -+ unsigned int subcode_value; -+ unsigned int wakeup_reason; -+ unsigned int len; -+ unsigned char pattern[0]; -+}; -+ -+#define Rx_Pairwisekey 0x01 -+#define Rx_GTK 0x02 -+#define Rx_DisAssoc 0x04 -+#define Rx_DeAuth 0x08 -+#define FWDecisionDisconnect 0x10 -+#define Rx_MagicPkt 0x21 -+#define Rx_UnicastPkt 0x22 -+#define Rx_PatternPkt 0x23 -+#endif // CONFIG_WOWLAN -+ -+void rtw_hal_def_value_init(_adapter *padapter); -+ -+void rtw_hal_free_data(_adapter *padapter); -+ -+void rtw_hal_dm_init(_adapter *padapter); -+void rtw_hal_dm_deinit(_adapter *padapter); -+void rtw_hal_sw_led_init(_adapter *padapter); -+void rtw_hal_sw_led_deinit(_adapter *padapter); -+ -+u32 rtw_hal_power_on(_adapter *padapter); -+uint rtw_hal_init(_adapter *padapter); -+uint rtw_hal_deinit(_adapter *padapter); -+void rtw_hal_stop(_adapter *padapter); -+void rtw_hal_set_hwreg(PADAPTER padapter, u8 variable, u8 *val); -+void rtw_hal_get_hwreg(PADAPTER padapter, u8 variable, u8 *val); -+ -+void rtw_hal_chip_configure(_adapter *padapter); -+void rtw_hal_read_chip_info(_adapter *padapter); -+void rtw_hal_read_chip_version(_adapter *padapter); -+ -+u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void * pValue); -+u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void * pValue); -+ -+void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void * pValue1,bool bSet); -+void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void * pValue1,bool bSet); -+ -+void rtw_hal_enable_interrupt(_adapter *padapter); -+void rtw_hal_disable_interrupt(_adapter *padapter); -+ -+u32 rtw_hal_inirp_init(_adapter *padapter); -+u32 rtw_hal_inirp_deinit(_adapter *padapter); -+ -+u8 rtw_hal_intf_ps_func(_adapter *padapter,HAL_INTF_PS_FUNC efunc_id, u8* val); -+ -+s32 rtw_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtw_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe); -+ -+s32 rtw_hal_init_xmit_priv(_adapter *padapter); -+void rtw_hal_free_xmit_priv(_adapter *padapter); -+ -+s32 rtw_hal_init_recv_priv(_adapter *padapter); -+void rtw_hal_free_recv_priv(_adapter *padapter); -+ -+void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level); -+void rtw_hal_add_ra_tid(_adapter *padapter, u32 bitmap, u8* arg, u8 rssi_level); -+void rtw_hal_clone_data(_adapter *dst_padapter, _adapter *src_padapter); -+void rtw_hal_start_thread(_adapter *padapter); -+void rtw_hal_stop_thread(_adapter *padapter); -+ -+void rtw_hal_bcn_related_reg_setting(_adapter *padapter); -+ -+u32 rtw_hal_read_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask); -+void rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); -+u32 rtw_hal_read_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask); -+void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask, u32 Data); -+ -+#define PHY_QueryBBReg(Adapter, RegAddr, BitMask) rtw_hal_read_bbreg((Adapter), (RegAddr), (BitMask)) -+#define PHY_SetBBReg(Adapter, RegAddr, BitMask, Data) rtw_hal_write_bbreg((Adapter), (RegAddr), (BitMask), (Data)) -+#define PHY_QueryRFReg(Adapter, eRFPath, RegAddr, BitMask) rtw_hal_read_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask)) -+#define PHY_SetRFReg(Adapter, eRFPath, RegAddr, BitMask, Data) rtw_hal_write_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask), (Data)) -+ -+s32 rtw_hal_interrupt_handler(_adapter *padapter); -+ -+void rtw_hal_set_bwmode(_adapter *padapter, CHANNEL_WIDTH Bandwidth, u8 Offset); -+void rtw_hal_set_chan(_adapter *padapter, u8 channel); -+void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80); -+void rtw_hal_dm_watchdog(_adapter *padapter); -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+u8 rtw_hal_antdiv_before_linked(_adapter *padapter); -+void rtw_hal_antdiv_rssi_compared(_adapter *padapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src); -+#endif -+ -+#ifdef CONFIG_HOSTAPD_MLME -+s32 rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt); -+#endif -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+void rtw_hal_sreset_init(_adapter *padapter); -+void rtw_hal_sreset_reset(_adapter *padapter); -+void rtw_hal_sreset_reset_value(_adapter *padapter); -+void rtw_hal_sreset_xmit_status_check(_adapter *padapter); -+void rtw_hal_sreset_linked_status_check (_adapter *padapter); -+u8 rtw_hal_sreset_get_wifi_status(_adapter *padapter); -+bool rtw_hal_sreset_inprogress(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_IOL -+int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt); -+#endif -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+s32 rtw_hal_xmit_thread_handler(_adapter *padapter); -+#endif -+ -+void rtw_hal_notch_filter(_adapter * adapter, bool enable); -+void rtw_hal_reset_security_engine(_adapter * adapter); -+ -+s32 rtw_hal_c2h_handler(_adapter *adapter, struct c2h_evt_hdr *c2h_evt); -+c2h_id_filter rtw_hal_c2h_id_filter_ccx(_adapter *adapter); -+ -+#endif //__HAL_INTF_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_pg.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_pg.h ---- linux-4.14.17/3rdparty/rtl8812au/include/hal_pg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_pg.h 2018-02-06 17:42:30.718967283 +0200 -@@ -0,0 +1,636 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __HAL_PG_H__ -+#define __HAL_PG_H__ -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 8192 CE/CU -+//==================================================== -+#define EEPROM_VID_92C 0x0A -+#define EEPROM_PID_92C 0x0C -+#define EEPROM_DID_92C 0x0C -+#define EEPROM_SVID_92C 0x0E -+#define EEPROM_SMID_92C 0x10 -+#define EEPROM_MAC_ADDR_92C 0x16 -+ -+#define EEPROM_MAC_ADDR 0x16 -+#define EEPROM_TV_OPTION 0x50 -+#define EEPROM_SUBCUSTOMER_ID_92C 0x59 -+#define EEPROM_CCK_TX_PWR_INX 0x5A -+#define EEPROM_HT40_1S_TX_PWR_INX 0x60 -+#define EEPROM_HT40_2S_TX_PWR_INX_DIFF 0x66 -+#define EEPROM_HT20_TX_PWR_INX_DIFF 0x69 -+#define EEPROM_OFDM_TX_PWR_INX_DIFF 0x6C -+#define EEPROM_HT40_MAX_PWR_OFFSET 0x6F -+#define EEPROM_HT20_MAX_PWR_OFFSET 0x72 -+#define EEPROM_CHANNEL_PLAN_92C 0x75 -+#define EEPROM_TSSI_A 0x76 -+#define EEPROM_TSSI_B 0x77 -+#define EEPROM_THERMAL_METER_92C 0x78 -+#define EEPROM_RF_OPT1_92C 0x79 -+#define EEPROM_RF_OPT2_92C 0x7A -+#define EEPROM_RF_OPT3_92C 0x7B -+#define EEPROM_RF_OPT4_92C 0x7C -+#define EEPROM_VERSION_92C 0x7E -+#define EEPROM_CUSTOMER_ID_92C 0x7F -+ -+#define EEPROM_NORMAL_CHANNEL_PLAN 0x75 -+#define EEPROM_NORMAL_BoardType_92C EEPROM_RF_OPT1_92C -+#define BOARD_TYPE_NORMAL_MASK 0xE0 -+#define BOARD_TYPE_TEST_MASK 0xF -+#define EEPROM_TYPE_ID 0x7E -+ -+// EEPROM address for Test chip -+#define EEPROM_TEST_USB_OPT 0x0E -+ -+#define EEPROM_EASY_REPLACEMENT 0x50//BIT0 1 for build-in module, 0 for external dongle -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 8723AE/8723AU/8723AS -+//==================================================== -+#define EEPROM_CCK_TX_PWR_INX_8723A 0x10 -+#define EEPROM_HT40_1S_TX_PWR_INX_8723A 0x16 -+#define EEPROM_HT20_TX_PWR_INX_DIFF_8723A 0x1C -+#define EEPROM_OFDM_TX_PWR_INX_DIFF_8723A 0x1F -+#define EEPROM_HT40_MAX_PWR_OFFSET_8723A 0x22 -+#define EEPROM_HT20_MAX_PWR_OFFSET_8723A 0x25 -+ -+#define EEPROM_ChannelPlan_8723A 0x28 -+#define EEPROM_TSSI_A_8723A 0x29 -+#define EEPROM_THERMAL_METER_8723A 0x2A -+#define RF_OPTION1_8723A 0x2B -+#define RF_OPTION2_8723A 0x2C -+#define RF_OPTION3_8723A 0x2D -+#define RF_OPTION4_8723A 0x2E -+#define EEPROM_VERSION_8723A 0x30 -+#define EEPROM_CustomID_8723A 0x31 -+#define EEPROM_SubCustomID_8723A 0x32 -+#define EEPROM_XTAL_K_8723A 0x33 -+#define EEPROM_Chipset_8723A 0x34 -+ -+ -+// RTL8723AE -+#define EEPROM_VID_8723AE 0x49 -+#define EEPROM_DID_8723AE 0x4B -+#define EEPROM_SVID_8723AE 0x4D -+#define EEPROM_SMID_8723AE 0x4F -+#define EEPROM_MAC_ADDR_8723AE 0x67 -+ -+//RTL8723AU -+#define EEPROM_MAC_ADDR_8723AU 0xC6 -+#define EEPROM_VID_8723AU 0xB7 -+#define EEPROM_PID_8723AU 0xB9 -+ -+// RTL8723AS -+#define EEPROM_MAC_ADDR_8723AS 0xAA -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 8192 DE/DU -+//==================================================== -+// pcie -+#define RTL8190_EEPROM_ID 0x8129 // 0-1 -+#define EEPROM_HPON 0x02 // LDO settings.2-5 -+#define EEPROM_CLK 0x06 // Clock settings.6-7 -+#define EEPROM_MAC_FUNCTION 0x08 // SE Test mode.8 -+ -+#define EEPROM_MAC_ADDR_MAC0_92DE 0x55 -+#define EEPROM_MAC_ADDR_MAC1_92DE 0x5B -+ -+//usb -+#define EEPROM_ENDPOINT_SETTING 0x10 -+#define EEPROM_CHIRP_K 0x12 // Changed -+#define EEPROM_USB_PHY 0x13 // Changed -+#define EEPROM_STRING 0x1F -+#define EEPROM_SUBCUSTOMER_ID_92D 0x59 -+ -+#define EEPROM_MAC_ADDR_MAC0_92DU 0x19 -+#define EEPROM_MAC_ADDR_MAC1_92DU 0x5B -+//---------------------------------------------------------------- -+// 2.4G band Tx power index setting -+#define EEPROM_CCK_TX_PWR_INX_2G_92D 0x61 -+#define EEPROM_HT40_1S_TX_PWR_INX_2G_92D 0x67 -+#define EEPROM_HT40_2S_TX_PWR_INX_DIFF_2G_92D 0x6D -+#define EEPROM_HT20_TX_PWR_INX_DIFF_2G_92D 0x70 -+#define EEPROM_OFDM_TX_PWR_INX_DIFF_2G_92D 0x73 -+#define EEPROM_HT40_MAX_PWR_OFFSET_2G_92D 0x76 -+#define EEPROM_HT20_MAX_PWR_OFFSET_2G_92D 0x79 -+ -+//5GL channel 32-64 -+#define EEPROM_HT40_1S_TX_PWR_INX_5GL_92D 0x7C -+#define EEPROM_HT40_2S_TX_PWR_INX_DIFF_5GL_92D 0x82 -+#define EEPROM_HT20_TX_PWR_INX_DIFF_5GL_92D 0x85 -+#define EEPROM_OFDM_TX_PWR_INX_DIFF_5GL_92D 0x88 -+#define EEPROM_HT40_MAX_PWR_OFFSET_5GL_92D 0x8B -+#define EEPROM_HT20_MAX_PWR_OFFSET_5GL_92D 0x8E -+ -+//5GM channel 100-140 -+#define EEPROM_HT40_1S_TX_PWR_INX_5GM_92D 0x91 -+#define EEPROM_HT40_2S_TX_PWR_INX_DIFF_5GM_92D 0x97 -+#define EEPROM_HT20_TX_PWR_INX_DIFF_5GM_92D 0x9A -+#define EEPROM_OFDM_TX_PWR_INX_DIFF_5GM_92D 0x9D -+#define EEPROM_HT40_MAX_PWR_OFFSET_5GM_92D 0xA0 -+#define EEPROM_HT20_MAX_PWR_OFFSET_5GM_92D 0xA3 -+ -+//5GH channel 149-165 -+#define EEPROM_HT40_1S_TX_PWR_INX_5GH_92D 0xA6 -+#define EEPROM_HT40_2S_TX_PWR_INX_DIFF_5GH_92D 0xAC -+#define EEPROM_HT20_TX_PWR_INX_DIFF_5GH_92D 0xAF -+#define EEPROM_OFDM_TX_PWR_INX_DIFF_5GH_92D 0xB2 -+#define EEPROM_HT40_MAX_PWR_OFFSET_5GH_92D 0xB5 -+#define EEPROM_HT20_MAX_PWR_OFFSET_5GH_92D 0xB8 -+ -+ -+#define EEPROM_CHANNEL_PLAN_92D 0xBB // Map of supported channels. -+#define EEPROM_TEST_CHANNEL_PLAN_92D 0xBB -+#define EEPROM_THERMAL_METER_92D 0xC3 //[4:0] -+#define EEPROM_IQK_DELTA_92D 0xBC -+#define EEPROM_LCK_DELTA_92D 0xBC -+#define EEPROM_XTAL_K_92D 0xBD //[7:5] -+#define EEPROM_TSSI_A_5G_92D 0xBE -+#define EEPROM_TSSI_B_5G_92D 0xBF -+#define EEPROM_TSSI_AB_5G_92D 0xC0 -+ -+#define EEPROM_RF_OPT1_92D 0xC4 -+#define EEPROM_RF_OPT2_92D 0xC5 -+#define EEPROM_RF_OPT3_92D 0xC6 -+#define EEPROM_RF_OPT4_92D 0xC7 -+#define EEPROM_RF_OPT5_92D 0xC8 -+#define EEPROM_RF_OPT6_92D 0xC9 -+#define EEPROM_RF_OPT7_92D 0xCC -+ -+#define EEPROM_NORMAL_BoardType_92D EEPROM_RF_OPT1_92D //[7:5] -+ -+#define EEPROM_WIDIPAIRING_ADDR 0xF0 -+#define EEPROM_WIDIPAIRING_KEY 0xF6 -+ -+#define EEPROM_DEF_PART_NO 0x3FD //Byte -+#define EEPROME_CHIP_VERSION_L 0x3FF -+#define EEPROME_CHIP_VERSION_H 0x3FE -+ -+//---------------------------------------------------------------- -+ -+#define EEPROM_VID_92DE 0x28 -+#define EEPROM_PID_92DE 0x2A -+#define EEPROM_SVID_92DE 0x2C -+#define EEPROM_SMID_92DE 0x2E -+#define EEPROM_PATHDIV_92D 0xC4 -+ -+#define EEPROM_BOARD_OPTIONS_92D 0xC4 -+#define EEPROM_5G_LNA_GAIN_92D 0xC6 -+#define EEPROM_FEATURE_OPTIONS_92D 0xC7 -+#define EEPROM_BT_SETTING_92D 0xC8 -+ -+#define EEPROM_VERSION_92D 0xCA -+#define EEPROM_CUSTOMER_ID_92D 0xCB -+ -+#define EEPROM_VID_92DU 0xC -+#define EEPROM_PID_92DU 0xE -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 88EE/88EU/88ES -+//==================================================== -+#define EEPROM_TX_PWR_INX_88E 0x10 -+ -+#define EEPROM_ChannelPlan_88E 0xB8 -+#define EEPROM_XTAL_88E 0xB9 -+#define EEPROM_THERMAL_METER_88E 0xBA -+#define EEPROM_IQK_LCK_88E 0xBB -+ -+#define EEPROM_RF_BOARD_OPTION_88E 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_88E 0xC2 -+#define EEPROM_RF_BT_SETTING_88E 0xC3 -+#define EEPROM_VERSION_88E 0xC4 -+#define EEPROM_CustomID_88E 0xC5 -+#define EEPROM_RF_ANTENNA_OPT_88E 0xC9 -+ -+// RTL88EE -+#define EEPROM_MAC_ADDR_88EE 0xD0 -+#define EEPROM_VID_88EE 0xD6 -+#define EEPROM_DID_88EE 0xD8 -+#define EEPROM_SVID_88EE 0xDA -+#define EEPROM_SMID_88EE 0xDC -+ -+//RTL88EU -+#define EEPROM_MAC_ADDR_88EU 0xD7 -+#define EEPROM_VID_88EU 0xD0 -+#define EEPROM_PID_88EU 0xD2 -+#define EEPROM_USB_OPTIONAL_FUNCTION0 0xD4 -+ -+// RTL88ES -+#define EEPROM_MAC_ADDR_88ES 0x11A -+//==================================================== -+// EEPROM/Efuse PG Offset for 8192EE/8192EU/8192ES -+//==================================================== -+// 0x10 ~ 0x63 = TX power area. -+#define EEPROM_TX_PWR_INX_8192E 0x10 -+ -+#define EEPROM_ChannelPlan_8192E 0xB8 -+#define EEPROM_XTAL_8192E 0xB9 -+#define EEPROM_THERMAL_METER_8192E 0xBA -+#define EEPROM_IQK_LCK_8192E 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8192E 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8192E 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8192E 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8192E 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_8192E 0xC2 -+#define EEPROM_RF_BT_SETTING_8192E 0xC3 -+#define EEPROM_VERSION_8192E 0xC4 -+#define EEPROM_CustomID_8192E 0xC5 -+#define EEPROM_TX_BBSWING_2G_8192E 0xC6 -+#define EEPROM_TX_BBSWING_5G_8192E 0xC7 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8192E 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8192E 0xC9 -+ -+// RTL8192EE -+#define EEPROM_MAC_ADDR_8192EE 0xD0 -+#define EEPROM_VID_8192EE 0xD6 -+#define EEPROM_DID_8192EE 0xD8 -+#define EEPROM_SVID_8192EE 0xDA -+#define EEPROM_SMID_8192EE 0xDC -+ -+//RTL8192EU -+#define EEPROM_MAC_ADDR_8192EU 0xD7 -+#define EEPROM_VID_8192EU 0xD0 -+#define EEPROM_PID_8192EU 0xD2 -+#define EEPROM_PA_TYPE_8192EU 0xBC -+#define EEPROM_LNA_TYPE_2G_8192EU 0xBD -+#define EEPROM_LNA_TYPE_5G_8192EU 0xBF -+ -+// RTL8192ES -+#define EEPROM_MAC_ADDR_8192ES 0x11B -+//==================================================== -+// EEPROM/Efuse PG Offset for 8812AE/8812AU/8812AS -+//==================================================== -+// 0x10 ~ 0x63 = TX power area. -+#define EEPROM_USB_MODE_8812 0x08 -+#define EEPROM_TX_PWR_INX_8812 0x10 -+ -+#define EEPROM_ChannelPlan_8812 0xB8 -+#define EEPROM_XTAL_8812 0xB9 -+#define EEPROM_THERMAL_METER_8812 0xBA -+#define EEPROM_IQK_LCK_8812 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8812 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8812 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8812 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8812 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_8812 0xC2 -+#define EEPROM_RF_BT_SETTING_8812 0xC3 -+#define EEPROM_VERSION_8812 0xC4 -+#define EEPROM_CustomID_8812 0xC5 -+#define EEPROM_TX_BBSWING_2G_8812 0xC6 -+#define EEPROM_TX_BBSWING_5G_8812 0xC7 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8812 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8812 0xC9 -+#define EEPROM_RFE_OPTION_8812 0xCA -+ -+// RTL8812AE -+#define EEPROM_MAC_ADDR_8812AE 0xD0 -+#define EEPROM_VID_8812AE 0xD6 -+#define EEPROM_DID_8812AE 0xD8 -+#define EEPROM_SVID_8812AE 0xDA -+#define EEPROM_SMID_8812AE 0xDC -+ -+//RTL8812AU -+#define EEPROM_MAC_ADDR_8812AU 0xD7 -+#define EEPROM_VID_8812AU 0xD0 -+#define EEPROM_PID_8812AU 0xD2 -+#define EEPROM_PA_TYPE_8812AU 0xBC -+#define EEPROM_LNA_TYPE_2G_8812AU 0xBD -+#define EEPROM_LNA_TYPE_5G_8812AU 0xBF -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 8821AE/8821AU/8821AS -+//==================================================== -+#define EEPROM_TX_PWR_INX_8821 0x10 -+ -+#define EEPROM_ChannelPlan_8821 0xB8 -+#define EEPROM_XTAL_8821 0xB9 -+#define EEPROM_THERMAL_METER_8821 0xBA -+#define EEPROM_IQK_LCK_8821 0xBB -+ -+ -+#define EEPROM_RF_BOARD_OPTION_8821 0xC1 -+#define EEPROM_RF_FEATURE_OPTION_8821 0xC2 -+#define EEPROM_RF_BT_SETTING_8821 0xC3 -+#define EEPROM_VERSION_8821 0xC4 -+#define EEPROM_CustomID_8821 0xC5 -+#define EEPROM_RF_ANTENNA_OPT_8821 0xC9 -+ -+// RTL8821AE -+#define EEPROM_MAC_ADDR_8821AE 0xD0 -+#define EEPROM_VID_8821AE 0xD6 -+#define EEPROM_DID_8821AE 0xD8 -+#define EEPROM_SVID_8821AE 0xDA -+#define EEPROM_SMID_8821AE 0xDC -+ -+//RTL8821AU -+#define EEPROM_PA_TYPE_8821AU 0xBC -+#define EEPROM_LNA_TYPE_8821AU 0xBF -+ -+// RTL8821AS -+#define EEPROM_MAC_ADDR_8821AS 0x11A -+ -+//RTL8821AU -+#define EEPROM_MAC_ADDR_8821AU 0x107 -+#define EEPROM_VID_8821AU 0x100 -+#define EEPROM_PID_8821AU 0x102 -+ -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 8192 SE/SU -+//==================================================== -+#define EEPROM_VID_92SE 0x0A -+#define EEPROM_DID_92SE 0x0C -+#define EEPROM_SVID_92SE 0x0E -+#define EEPROM_SMID_92SE 0x10 -+ -+#define EEPROM_MAC_ADDR_92S 0x12 -+ -+#define EEPROM_TSSI_A_92SE 0x74 -+#define EEPROM_TSSI_B_92SE 0x75 -+ -+#define EEPROM_Version_92SE 0x7C -+ -+ -+#define EEPROM_VID_92SU 0x08 -+#define EEPROM_PID_92SU 0x0A -+ -+#define EEPROM_Version_92SU 0x50 -+#define EEPROM_TSSI_A_92SU 0x6b -+#define EEPROM_TSSI_B_92SU 0x6c -+ -+//==================================================== -+// EEPROM/Efuse PG Offset for 8723BE/8723BU/8723BS -+//==================================================== -+// 0x10 ~ 0x63 = TX power area. -+#define EEPROM_TX_PWR_INX_8723B 0x10 -+ -+#define EEPROM_ChannelPlan_8723B 0xB8 -+#define EEPROM_XTAL_8723B 0xB9 -+#define EEPROM_THERMAL_METER_8723B 0xBA -+#define EEPROM_IQK_LCK_8723B 0xBB -+#define EEPROM_2G_5G_PA_TYPE_8723B 0xBC -+#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8723B 0xBD -+#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8723B 0xBF -+ -+#define EEPROM_RF_BOARD_OPTION_8723B 0xC1 -+#define EEPROM_FEATURE_OPTION_8723B 0xC2 -+#define EEPROM_RF_BT_SETTING_8723B 0xC3 -+#define EEPROM_VERSION_8723B 0xC4 -+#define EEPROM_CustomID_8723B 0xC5 -+#define EEPROM_TX_BBSWING_2G_8723B 0xC6 -+#define EEPROM_TX_PWR_CALIBRATE_RATE_8723B 0xC8 -+#define EEPROM_RF_ANTENNA_OPT_8723B 0xC9 -+#define EEPROM_RFE_OPTION_8723B 0xCA -+ -+// RTL8723BE -+#define EEPROM_MAC_ADDR_8723BE 0xD0 -+#define EEPROM_VID_8723BE 0xD6 -+#define EEPROM_DID_8723BE 0xD8 -+#define EEPROM_SVID_8723BE 0xDA -+#define EEPROM_SMID_8723BE 0xDC -+ -+//RTL8723BU -+#define EEPROM_MAC_ADDR_8723BU 0xD7 -+#define EEPROM_VID_8723BU 0xD0 -+#define EEPROM_PID_8723BU 0xD2 -+#define EEPROM_PA_TYPE_8723BU 0xBC -+#define EEPROM_LNA_TYPE_2G_8723BU 0xBD -+ -+//RTL8723BS -+#define EEPROM_MAC_ADDR_8723BS 0x11A -+ -+ -+//==================================================== -+// EEPROM/Efuse Value Type -+//==================================================== -+#define EETYPE_TX_PWR 0x0 -+//==================================================== -+// EEPROM/Efuse Default Value -+//==================================================== -+#define EEPROM_CID_DEFAULT 0x0 -+#define EEPROM_CID_DEFAULT_EXT 0xFF // Reserved for Realtek -+#define EEPROM_CID_TOSHIBA 0x4 -+#define EEPROM_CID_CCX 0x10 -+#define EEPROM_CID_QMI 0x0D -+#define EEPROM_CID_WHQL 0xFE -+ -+#define EEPROM_CHANNEL_PLAN_FCC 0x0 -+#define EEPROM_CHANNEL_PLAN_IC 0x1 -+#define EEPROM_CHANNEL_PLAN_ETSI 0x2 -+#define EEPROM_CHANNEL_PLAN_SPAIN 0x3 -+#define EEPROM_CHANNEL_PLAN_FRANCE 0x4 -+#define EEPROM_CHANNEL_PLAN_MKK 0x5 -+#define EEPROM_CHANNEL_PLAN_MKK1 0x6 -+#define EEPROM_CHANNEL_PLAN_ISRAEL 0x7 -+#define EEPROM_CHANNEL_PLAN_TELEC 0x8 -+#define EEPROM_CHANNEL_PLAN_GLOBAL_DOMAIN 0x9 -+#define EEPROM_CHANNEL_PLAN_WORLD_WIDE_13 0xA -+#define EEPROM_CHANNEL_PLAN_NCC_TAIWAN 0xB -+#define EEPROM_CHANNEL_PLAN_CHIAN 0XC -+#define EEPROM_CHANNEL_PLAN_SINGAPORE_INDIA_MEXICO 0XD -+#define EEPROM_CHANNEL_PLAN_KOREA 0xE -+#define EEPROM_CHANNEL_PLAN_TURKEY 0xF -+#define EEPROM_CHANNEL_PLAN_JAPAN 0x10 -+#define EEPROM_CHANNEL_PLAN_FCC_NO_DFS 0x11 -+#define EEPROM_CHANNEL_PLAN_JAPAN_NO_DFS 0x12 -+#define EEPROM_CHANNEL_PLAN_WORLD_WIDE_5G 0x13 -+#define EEPROM_CHANNEL_PLAN_TAIWAN_NO_DFS 0x14 -+ -+#define EEPROM_USB_OPTIONAL1 0xE -+#define EEPROM_CHANNEL_PLAN_BY_HW_MASK 0x80 -+ -+#define RTL_EEPROM_ID 0x8129 -+#define EEPROM_Default_TSSI 0x0 -+#define EEPROM_Default_BoardType 0x02 -+#define EEPROM_Default_ThermalMeter 0x12 -+#define EEPROM_Default_ThermalMeter_92SU 0x7 -+#define EEPROM_Default_ThermalMeter_88E 0x18 -+#define EEPROM_Default_ThermalMeter_8812 0x18 -+#define EEPROM_Default_ThermalMeter_8192E 0x1A -+#define EEPROM_Default_ThermalMeter_8723B 0x18 -+ -+ -+#define EEPROM_Default_CrystalCap 0x0 -+#define EEPROM_Default_CrystalCap_8723A 0x20 -+#define EEPROM_Default_CrystalCap_88E 0x20 -+#define EEPROM_Default_CrystalCap_8812 0x20 -+#define EEPROM_Default_CrystalCap_8192E 0x20 -+#define EEPROM_Default_CrystalCap_8723B 0x20 -+#define EEPROM_Default_CrystalFreq 0x0 -+#define EEPROM_Default_TxPowerLevel_92C 0x22 -+#define EEPROM_Default_TxPowerLevel_2G 0x2C -+#define EEPROM_Default_TxPowerLevel_5G 0x22 -+#define EEPROM_Default_TxPowerLevel 0x22 -+#define EEPROM_Default_HT40_2SDiff 0x0 -+#define EEPROM_Default_HT20_Diff 2 -+#define EEPROM_Default_LegacyHTTxPowerDiff 0x3 -+#define EEPROM_Default_LegacyHTTxPowerDiff_92C 0x3 -+#define EEPROM_Default_LegacyHTTxPowerDiff_92D 0x4 -+#define EEPROM_Default_HT40_PwrMaxOffset 0 -+#define EEPROM_Default_HT20_PwrMaxOffset 0 -+ -+#define EEPROM_Default_PID 0x1234 -+#define EEPROM_Default_VID 0x5678 -+#define EEPROM_Default_CustomerID 0xAB -+#define EEPROM_Default_CustomerID_8188E 0x00 -+#define EEPROM_Default_SubCustomerID 0xCD -+#define EEPROM_Default_Version 0 -+ -+#define EEPROM_Default_externalPA_C9 0x00 -+#define EEPROM_Default_externalPA_CC 0xFF -+#define EEPROM_Default_internalPA_SP3T_C9 0xAA -+#define EEPROM_Default_internalPA_SP3T_CC 0xAF -+#define EEPROM_Default_internalPA_SPDT_C9 0xAA -+#define EEPROM_Default_internalPA_SPDT_CC 0xFA -+#define EEPROM_Default_PAType 0 -+#define EEPROM_Default_LNAType 0 -+ -+//New EFUSE deafult value -+#define EEPROM_DEFAULT_24G_INDEX 0x2A -+#define EEPROM_DEFAULT_24G_HT20_DIFF 0X02 -+#define EEPROM_DEFAULT_24G_OFDM_DIFF 0X04 -+ -+#define EEPROM_DEFAULT_5G_INDEX 0X2A -+#define EEPROM_DEFAULT_5G_HT20_DIFF 0X00 -+#define EEPROM_DEFAULT_5G_OFDM_DIFF 0X04 -+ -+#define EEPROM_DEFAULT_DIFF 0XFE -+#define EEPROM_DEFAULT_CHANNEL_PLAN 0x7F -+#define EEPROM_DEFAULT_BOARD_OPTION 0x00 -+#define EEPROM_DEFAULT_RFE_OPTION 0x04 -+#define EEPROM_DEFAULT_FEATURE_OPTION 0x00 -+#define EEPROM_DEFAULT_BT_OPTION 0x10 -+ -+ -+#define EEPROM_DEFAULT_TX_CALIBRATE_RATE 0x00 -+ -+// -+// For VHT series TX power by rate table. -+// VHT TX power by rate off setArray = -+// Band:-2G&5G = 0 / 1 -+// RF: at most 4*4 = ABCD=0/1/2/3 -+// CCK=0 OFDM=1/2 HT-MCS 0-15=3/4/56 VHT=7/8/9/10/11 -+// -+#define TX_PWR_BY_RATE_NUM_BAND 2 -+#define TX_PWR_BY_RATE_NUM_RF 4 -+#define TX_PWR_BY_RATE_NUM_SECTION 12 -+ -+//---------------------------------------------------------------------------- -+// EEPROM/EFUSE data structure definition. -+//---------------------------------------------------------------------------- -+#define MAX_RF_PATH_NUM 2 -+#define MAX_CHNL_GROUP 3+9 -+typedef struct _TxPowerInfo{ -+ u8 CCKIndex[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; -+ u8 HT40_1SIndex[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; -+ u8 HT40_2SIndexDiff[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; -+ s8 HT20IndexDiff[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; -+ u8 OFDMIndexDiff[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; -+ u8 HT40MaxOffset[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; -+ u8 HT20MaxOffset[MAX_RF_PATH_NUM][MAX_CHNL_GROUP]; -+ u8 TSSI_A[3]; -+ u8 TSSI_B[3]; -+ u8 TSSI_A_5G[3]; //5GL/5GM/5GH -+ u8 TSSI_B_5G[3]; -+}TxPowerInfo, *PTxPowerInfo; -+ -+ -+//For 88E new structure -+ -+/* -+2.4G: -+{ -+{1,2}, -+{3,4,5}, -+{6,7,8}, -+{9,10,11}, -+{12,13}, -+{14} -+} -+ -+5G: -+{ -+{36,38,40}, -+{44,46,48}, -+{52,54,56}, -+{60,62,64}, -+{100,102,104}, -+{108,110,112}, -+{116,118,120}, -+{124,126,128}, -+{132,134,136}, -+{140,142,144}, -+{149,151,153}, -+{157,159,161}, -+{173,175,177}, -+} -+*/ -+#define MAX_RF_PATH 4 -+#define RF_PATH_MAX MAX_RF_PATH -+#define MAX_CHNL_GROUP_24G 6 -+#define MAX_CHNL_GROUP_5G 14 -+ -+//It must always set to 4, otherwise read efuse table secquence will be wrong. -+#define MAX_TX_COUNT 4 -+ -+typedef struct _TxPowerInfo24G{ -+ u8 IndexCCK_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G]; -+ u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G-1]; -+ //If only one tx, only BW20 and OFDM are used. -+ s8 CCK_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+}TxPowerInfo24G, *PTxPowerInfo24G; -+ -+typedef struct _TxPowerInfo5G{ -+ u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_5G]; -+ //If only one tx, only BW20, OFDM, BW80 and BW160 are used. -+ s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW80_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+ s8 BW160_Diff[MAX_RF_PATH][MAX_TX_COUNT]; -+}TxPowerInfo5G, *PTxPowerInfo5G; -+ -+ -+typedef enum _BT_Ant_NUM{ -+ Ant_x2 = 0, -+ Ant_x1 = 1 -+} BT_Ant_NUM, *PBT_Ant_NUM; -+ -+typedef enum _BT_CoType{ -+ BT_2Wire = 0, -+ BT_ISSC_3Wire = 1, -+ BT_ACCEL = 2, -+ BT_CSR_BC4 = 3, -+ BT_CSR_BC8 = 4, -+ BT_RTL8756 = 5, -+ BT_RTL8723A = 6, -+ BT_RTL8821 = 7, -+ BT_RTL8723B = 8, -+} BT_CoType, *PBT_CoType; -+ -+typedef enum _BT_RadioShared{ -+ BT_Radio_Shared = 0, -+ BT_Radio_Individual = 1, -+} BT_RadioShared, *PBT_RadioShared; -+ -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_phy.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_phy.h ---- linux-4.14.17/3rdparty/rtl8812au/include/hal_phy.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_phy.h 2018-02-06 17:42:30.718967283 +0200 -@@ -0,0 +1,243 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_PHY_H__ -+#define __HAL_PHY_H__ -+ -+ -+#if DISABLE_BB_RF -+#define HAL_FW_ENABLE 0 -+#define HAL_MAC_ENABLE 0 -+#define HAL_BB_ENABLE 0 -+#define HAL_RF_ENABLE 0 -+#else // FPGA_PHY and ASIC -+#define HAL_FW_ENABLE 1 -+#define HAL_MAC_ENABLE 1 -+#define HAL_BB_ENABLE 1 -+#define HAL_RF_ENABLE 1 -+#endif -+ -+#define RF6052_MAX_TX_PWR 0x3F -+#define RF6052_MAX_REG_88E 0xFF -+#define RF6052_MAX_REG_92C 0x7F -+ -+#define RF6052_MAX_REG \ -+ (RF6052_MAX_REG_88E > RF6052_MAX_REG_92C) ? RF6052_MAX_REG_88E: RF6052_MAX_REG_92C -+ -+#define GET_RF6052_REAL_MAX_REG(_Adapter) \ -+ IS_HARDWARE_TYPE_8188E(_Adapter) ? RF6052_MAX_REG_88E : RF6052_MAX_REG_92C -+ -+#define RF6052_MAX_PATH 2 -+ -+/*--------------------------Define Parameters-------------------------------*/ -+typedef enum _BAND_TYPE{ -+ BAND_ON_2_4G = 0, -+ BAND_ON_5G, -+ BAND_ON_BOTH, -+ BANDMAX -+}BAND_TYPE,*PBAND_TYPE; -+ -+typedef enum _RF_TYPE{ -+ RF_TYPE_MIN = 0, // 0 -+ RF_8225=1, // 1 11b/g RF for verification only -+ RF_8256=2, // 2 11b/g/n -+ RF_8258=3, // 3 11a/b/g/n RF -+ RF_6052=4, // 4 11b/g/n RF -+ RF_PSEUDO_11N=5, // 5, It is a temporality RF. -+ RF_TYPE_MAX -+}RF_TYPE_E,*PRF_TYPE_E; -+ -+typedef enum _RF_PATH{ -+ RF_PATH_A = 0, -+ RF_PATH_B, -+ RF_PATH_C, -+ RF_PATH_D -+}RF_PATH, *PRF_PATH; -+ -+#define TX_1S 0 -+#define TX_2S 1 -+#define TX_3S 2 -+#define TX_4S 3 -+ -+#define RF_PATH_MAX_92C_88E 2 -+#define RF_PATH_MAX_90_8812 4 //Max RF number 90 support -+ -+typedef enum _ANTENNA_PATH{ -+ ANTENNA_NONE = 0, -+ ANTENNA_D = 1, -+ ANTENNA_C = 2, -+ ANTENNA_CD = 3, -+ ANTENNA_B = 4, -+ ANTENNA_BD = 5, -+ ANTENNA_BC = 6, -+ ANTENNA_BCD = 7, -+ ANTENNA_A = 8, -+ ANTENNA_AD = 9, -+ ANTENNA_AC = 10, -+ ANTENNA_ACD = 11, -+ ANTENNA_AB = 12, -+ ANTENNA_ABD = 13, -+ ANTENNA_ABC = 14, -+ ANTENNA_ABCD = 15 -+} ANTENNA_PATH; -+ -+typedef enum _RF_CONTENT{ -+ radioa_txt = 0x1000, -+ radiob_txt = 0x1001, -+ radioc_txt = 0x1002, -+ radiod_txt = 0x1003 -+} RF_CONTENT; -+ -+typedef enum _BaseBand_Config_Type{ -+ BaseBand_Config_PHY_REG = 0, //Radio Path A -+ BaseBand_Config_AGC_TAB = 1, //Radio Path B -+ BaseBand_Config_AGC_TAB_2G = 2, -+ BaseBand_Config_AGC_TAB_5G = 3, -+ BaseBand_Config_PHY_REG_PG -+}BaseBand_Config_Type, *PBaseBand_Config_Type; -+ -+typedef enum _HW_BLOCK{ -+ HW_BLOCK_MAC = 0, -+ HW_BLOCK_PHY0 = 1, -+ HW_BLOCK_PHY1 = 2, -+ HW_BLOCK_RF = 3, -+ HW_BLOCK_MAXIMUM = 4, // Never use this -+}HW_BLOCK_E, *PHW_BLOCK_E; -+ -+typedef enum _WIRELESS_MODE { -+ WIRELESS_MODE_UNKNOWN = 0x00, -+ WIRELESS_MODE_A = 0x01, -+ WIRELESS_MODE_B = 0x02, -+ WIRELESS_MODE_G = 0x04, -+ WIRELESS_MODE_AUTO = 0x08, -+ WIRELESS_MODE_N_24G = 0x10, -+ WIRELESS_MODE_N_5G = 0x20, -+ WIRELESS_MODE_AC_5G = 0x40 -+} WIRELESS_MODE; -+ -+typedef enum _SwChnlCmdID{ -+ CmdID_End, -+ CmdID_SetTxPowerLevel, -+ CmdID_BBRegWrite10, -+ CmdID_WritePortUlong, -+ CmdID_WritePortUshort, -+ CmdID_WritePortUchar, -+ CmdID_RF_WriteReg, -+}SwChnlCmdID; -+ -+typedef struct _SwChnlCmd{ -+ SwChnlCmdID CmdID; -+ u32 Para1; -+ u32 Para2; -+ u32 msDelay; -+}SwChnlCmd; -+ -+typedef struct _R_ANTENNA_SELECT_OFDM{ -+ u32 r_tx_antenna:4; -+ u32 r_ant_l:4; -+ u32 r_ant_non_ht:4; -+ u32 r_ant_ht1:4; -+ u32 r_ant_ht2:4; -+ u32 r_ant_ht_s1:4; -+ u32 r_ant_non_ht_s1:4; -+ u32 OFDM_TXSC:2; -+ u32 Reserved:2; -+}R_ANTENNA_SELECT_OFDM; -+ -+typedef struct _R_ANTENNA_SELECT_CCK{ -+ u8 r_cckrx_enable_2:2; -+ u8 r_cckrx_enable:2; -+ u8 r_ccktx_enable:4; -+}R_ANTENNA_SELECT_CCK; -+ -+typedef struct RF_Shadow_Compare_Map { -+ // Shadow register value -+ u32 Value; -+ // Compare or not flag -+ u8 Compare; -+ // Record If it had ever modified unpredicted -+ u8 ErrorOrNot; -+ // Recorver Flag -+ u8 Recorver; -+ // -+ u8 Driver_Write; -+}RF_SHADOW_T; -+ -+/*--------------------------Exported Function prototype---------------------*/ -+ -+u32 -+PHY_CalculateBitShift( -+ u32 BitMask -+ ); -+ -+u32 -+PHY_RFShadowRead( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset); -+ -+void -+PHY_RFShadowWrite( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset, -+ u32 Data); -+ -+bool -+PHY_RFShadowCompare( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset); -+ -+void -+PHY_RFShadowRecorver( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset); -+ -+void -+PHY_RFShadowCompareAll( -+ PADAPTER Adapter); -+ -+void -+PHY_RFShadowRecorverAll( -+ PADAPTER Adapter); -+ -+void -+PHY_RFShadowCompareFlagSet( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset, -+ u8 Type); -+ -+void -+PHY_RFShadowRecorverFlagSet( -+ PADAPTER Adapter, -+ u8 eRFPath, -+ u32 Offset, -+ u8 Type); -+ -+void -+PHY_RFShadowCompareFlagSetAll( -+ PADAPTER Adapter); -+ -+void -+PHY_RFShadowRecorverFlagSetAll( -+ PADAPTER Adapter); -+ -+void -+PHY_RFShadowRefresh( -+ PADAPTER Adapter); -+ -+#endif //__HAL_COMMON_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/hal_phy_reg.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_phy_reg.h ---- linux-4.14.17/3rdparty/rtl8812au/include/hal_phy_reg.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/hal_phy_reg.h 2018-02-06 17:42:30.718967283 +0200 -@@ -0,0 +1,25 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_PHY_REG_H__ -+#define __HAL_PHY_REG_H__ -+ -+//for PutRFRegsetting & GetRFRegSetting BitMask -+//#if (RTL92SE_FPGA_VERIFY == 1) -+//#define bRFRegOffsetMask 0xfff -+//#else -+#define bRFRegOffsetMask 0xfffff -+//#endif -+ -+#endif //__HAL_PHY_REG_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/HalPwrSeqCmd.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/HalPwrSeqCmd.h ---- linux-4.14.17/3rdparty/rtl8812au/include/HalPwrSeqCmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/HalPwrSeqCmd.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,132 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HALPWRSEQCMD_H__ -+#define __HALPWRSEQCMD_H__ -+ -+#include -+ -+/*---------------------------------------------*/ -+//3 The value of cmd: 4 bits -+/*---------------------------------------------*/ -+#define PWR_CMD_READ 0x00 -+ // offset: the read register offset -+ // msk: the mask of the read value -+ // value: N/A, left by 0 -+ // note: dirver shall implement this function by read & msk -+ -+#define PWR_CMD_WRITE 0x01 -+ // offset: the read register offset -+ // msk: the mask of the write bits -+ // value: write value -+ // note: driver shall implement this cmd by read & msk after write -+ -+#define PWR_CMD_POLLING 0x02 -+ // offset: the read register offset -+ // msk: the mask of the polled value -+ // value: the value to be polled, masked by the msd field. -+ // note: driver shall implement this cmd by -+ // do{ -+ // if( (Read(offset) & msk) == (value & msk) ) -+ // break; -+ // } while(not timeout); -+ -+#define PWR_CMD_DELAY 0x03 -+ // offset: the value to delay -+ // msk: N/A -+ // value: the unit of delay, 0: us, 1: ms -+ -+#define PWR_CMD_END 0x04 -+ // offset: N/A -+ // msk: N/A -+ // value: N/A -+ -+/*---------------------------------------------*/ -+//3 The value of base: 4 bits -+/*---------------------------------------------*/ -+ // define the base address of each block -+#define PWR_BASEADDR_MAC 0x00 -+#define PWR_BASEADDR_USB 0x01 -+#define PWR_BASEADDR_PCIE 0x02 -+#define PWR_BASEADDR_SDIO 0x03 -+ -+/*---------------------------------------------*/ -+//3 The value of interface_msk: 4 bits -+/*---------------------------------------------*/ -+#define PWR_INTF_SDIO_MSK BIT(0) -+#define PWR_INTF_USB_MSK BIT(1) -+#define PWR_INTF_PCI_MSK BIT(2) -+#define PWR_INTF_ALL_MSK (BIT(0)|BIT(1)|BIT(2)|BIT(3)) -+ -+/*---------------------------------------------*/ -+//3 The value of fab_msk: 4 bits -+/*---------------------------------------------*/ -+#define PWR_FAB_TSMC_MSK BIT(0) -+#define PWR_FAB_UMC_MSK BIT(1) -+#define PWR_FAB_ALL_MSK (BIT(0)|BIT(1)|BIT(2)|BIT(3)) -+ -+/*---------------------------------------------*/ -+//3 The value of cut_msk: 8 bits -+/*---------------------------------------------*/ -+#define PWR_CUT_TESTCHIP_MSK BIT(0) -+#define PWR_CUT_A_MSK BIT(1) -+#define PWR_CUT_B_MSK BIT(2) -+#define PWR_CUT_C_MSK BIT(3) -+#define PWR_CUT_D_MSK BIT(4) -+#define PWR_CUT_E_MSK BIT(5) -+#define PWR_CUT_F_MSK BIT(6) -+#define PWR_CUT_G_MSK BIT(7) -+#define PWR_CUT_ALL_MSK 0xFF -+ -+ -+typedef enum _PWRSEQ_CMD_DELAY_UNIT_ -+{ -+ PWRSEQ_DELAY_US, -+ PWRSEQ_DELAY_MS, -+} PWRSEQ_DELAY_UNIT; -+ -+typedef struct _WL_PWR_CFG_ -+{ -+ u16 offset; -+ u8 cut_msk; -+ u8 fab_msk:4; -+ u8 interface_msk:4; -+ u8 base:4; -+ u8 cmd:4; -+ u8 msk; -+ u8 value; -+} WLAN_PWR_CFG, *PWLAN_PWR_CFG; -+ -+ -+#define GET_PWR_CFG_OFFSET(__PWR_CMD) __PWR_CMD.offset -+#define GET_PWR_CFG_CUT_MASK(__PWR_CMD) __PWR_CMD.cut_msk -+#define GET_PWR_CFG_FAB_MASK(__PWR_CMD) __PWR_CMD.fab_msk -+#define GET_PWR_CFG_INTF_MASK(__PWR_CMD) __PWR_CMD.interface_msk -+#define GET_PWR_CFG_BASE(__PWR_CMD) __PWR_CMD.base -+#define GET_PWR_CFG_CMD(__PWR_CMD) __PWR_CMD.cmd -+#define GET_PWR_CFG_MASK(__PWR_CMD) __PWR_CMD.msk -+#define GET_PWR_CFG_VALUE(__PWR_CMD) __PWR_CMD.value -+ -+ -+//================================================================================ -+// Prototype of protected function. -+//================================================================================ -+u8 HalPwrSeqCmdParsing( -+ PADAPTER padapter, -+ u8 CutVersion, -+ u8 FabVersion, -+ u8 InterfaceType, -+ WLAN_PWR_CFG PwrCfgCmd[]); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/HalVerDef.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/HalVerDef.h ---- linux-4.14.17/3rdparty/rtl8812au/include/HalVerDef.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/HalVerDef.h 2018-02-06 17:42:30.717967268 +0200 -@@ -0,0 +1,160 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __HAL_VERSION_DEF_H__ -+#define __HAL_VERSION_DEF_H__ -+ -+// HAL_IC_TYPE_E -+typedef enum tag_HAL_IC_Type_Definition -+{ -+ CHIP_8192S = 0, -+ CHIP_8188C = 1, -+ CHIP_8192C = 2, -+ CHIP_8192D = 3, -+ CHIP_8723A = 4, -+ CHIP_8188E = 5, -+ CHIP_8812 = 6, -+ CHIP_8821 = 7, -+ CHIP_8723B = 8, -+ CHIP_8192E = 9, -+}HAL_IC_TYPE_E; -+ -+//HAL_CHIP_TYPE_E -+typedef enum tag_HAL_CHIP_Type_Definition -+{ -+ TEST_CHIP = 0, -+ NORMAL_CHIP = 1, -+ FPGA = 2, -+}HAL_CHIP_TYPE_E; -+ -+//HAL_CUT_VERSION_E -+typedef enum tag_HAL_Cut_Version_Definition -+{ -+ A_CUT_VERSION = 0, -+ B_CUT_VERSION = 1, -+ C_CUT_VERSION = 2, -+ D_CUT_VERSION = 3, -+ E_CUT_VERSION = 4, -+ F_CUT_VERSION = 5, -+ G_CUT_VERSION = 6, -+}HAL_CUT_VERSION_E; -+ -+// HAL_Manufacturer -+typedef enum tag_HAL_Manufacturer_Version_Definition -+{ -+ CHIP_VENDOR_TSMC = 0, -+ CHIP_VENDOR_UMC = 1, -+ CHIP_VENDOR_SMIC = 2, -+}HAL_VENDOR_E; -+ -+typedef enum tag_HAL_RF_Type_Definition -+{ -+ RF_TYPE_1T1R = 0, -+ RF_TYPE_1T2R = 1, -+ RF_TYPE_2T2R = 2, -+ RF_TYPE_2T3R = 3, -+ RF_TYPE_2T4R = 4, -+ RF_TYPE_3T3R = 5, -+ RF_TYPE_3T4R = 6, -+ RF_TYPE_4T4R = 7, -+}HAL_RF_TYPE_E; -+ -+typedef struct tag_HAL_VERSION -+{ -+ HAL_IC_TYPE_E ICType; -+ HAL_CHIP_TYPE_E ChipType; -+ HAL_CUT_VERSION_E CUTVersion; -+ HAL_VENDOR_E VendorType; -+ HAL_RF_TYPE_E RFType; -+ u8 ROMVer; -+}HAL_VERSION,*PHAL_VERSION; -+ -+//VERSION_8192C VersionID; -+//HAL_VERSION VersionID; -+ -+// Get element -+#define GET_CVID_IC_TYPE(version) (((version).ICType) ) -+#define GET_CVID_CHIP_TYPE(version) (((version).ChipType) ) -+#define GET_CVID_RF_TYPE(version) (((version).RFType)) -+#define GET_CVID_MANUFACTUER(version) (((version).VendorType)) -+#define GET_CVID_CUT_VERSION(version) (((version).CUTVersion)) -+#define GET_CVID_ROM_VERSION(version) (((version).ROMVer) & ROM_VERSION_MASK) -+ -+//---------------------------------------------------------------------------- -+//Common Macro. -- -+//---------------------------------------------------------------------------- -+//HAL_VERSION VersionID -+ -+// HAL_IC_TYPE_E -+#define IS_81XXC(version) (((GET_CVID_IC_TYPE(version) == CHIP_8192C)||(GET_CVID_IC_TYPE(version) == CHIP_8188C))? true : false) -+#define IS_8723_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8723A)? true : false) -+#define IS_92D(version) ((GET_CVID_IC_TYPE(version) == CHIP_8192D)? true : false) -+#define IS_8188E(version) ((GET_CVID_IC_TYPE(version) == CHIP_8188E)? true : false) -+#define IS_8192E(version) ((GET_CVID_IC_TYPE(version) == CHIP_8192E)? true : false) -+#define IS_8812_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8812)? true : false) -+#define IS_8821_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8821)? true : false) -+#define IS_8723B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8723B)? true : false) -+ -+ -+//HAL_CHIP_TYPE_E -+#define IS_TEST_CHIP(version) ((GET_CVID_CHIP_TYPE(version)==TEST_CHIP)? true: false) -+#define IS_NORMAL_CHIP(version) ((GET_CVID_CHIP_TYPE(version)==NORMAL_CHIP)? true: false) -+ -+//HAL_CUT_VERSION_E -+#define IS_A_CUT(version) ((GET_CVID_CUT_VERSION(version) == A_CUT_VERSION) ? true : false) -+#define IS_B_CUT(version) ((GET_CVID_CUT_VERSION(version) == B_CUT_VERSION) ? true : false) -+#define IS_C_CUT(version) ((GET_CVID_CUT_VERSION(version) == C_CUT_VERSION) ? true : false) -+#define IS_D_CUT(version) ((GET_CVID_CUT_VERSION(version) == D_CUT_VERSION) ? true : false) -+#define IS_E_CUT(version) ((GET_CVID_CUT_VERSION(version) == E_CUT_VERSION) ? true : false) -+ -+ -+//HAL_VENDOR_E -+#define IS_CHIP_VENDOR_TSMC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_TSMC)? true: false) -+#define IS_CHIP_VENDOR_UMC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_UMC)? true: false) -+#define IS_CHIP_VENDOR_SMIC(version) ((GET_CVID_MANUFACTUER(version) == CHIP_VENDOR_SMIC)? true: false) -+ -+//HAL_RF_TYPE_E -+#define IS_1T1R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_1T1R)? true : false ) -+#define IS_1T2R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_1T2R)? true : false) -+#define IS_2T2R(version) ((GET_CVID_RF_TYPE(version) == RF_TYPE_2T2R)? true : false) -+ -+ -+//---------------------------------------------------------------------------- -+//Chip version Macro. -- -+//---------------------------------------------------------------------------- -+#define IS_81XXC_TEST_CHIP(version) ((IS_81XXC(version) && (!IS_NORMAL_CHIP(version)))? true: false) -+ -+#define IS_92C_SERIAL(version) ((IS_81XXC(version) && IS_2T2R(version)) ? true : false) -+#define IS_81xxC_VENDOR_UMC_A_CUT(version) (IS_81XXC(version)?(IS_CHIP_VENDOR_UMC(version) ? (IS_A_CUT(version) ? true : false) : false): false) -+#define IS_81xxC_VENDOR_UMC_B_CUT(version) (IS_81XXC(version)?(IS_CHIP_VENDOR_UMC(version) ? (IS_B_CUT(version) ? true : false) : false): false) -+#define IS_81xxC_VENDOR_UMC_C_CUT(version) (IS_81XXC(version)?(IS_CHIP_VENDOR_UMC(version) ? (IS_C_CUT(version) ? true : false) : false): false) -+ -+#define IS_NORMAL_CHIP92D(version) (( IS_92D(version))?((GET_CVID_CHIP_TYPE(version)==NORMAL_CHIP)? true: false):false) -+ -+#define IS_92D_SINGLEPHY(version) ((IS_92D(version)) ? (IS_2T2R(version) ? true: false) : false) -+#define IS_92D_C_CUT(version) ((IS_92D(version)) ? (IS_C_CUT(version) ? true : false) : false) -+#define IS_92D_D_CUT(version) ((IS_92D(version)) ? (IS_D_CUT(version) ? true : false) : false) -+#define IS_92D_E_CUT(version) ((IS_92D(version)) ? (IS_E_CUT(version) ? true : false) : false) -+ -+#define IS_8723A_A_CUT(version) ((IS_8723_SERIES(version)) ? ( IS_A_CUT(version)?true : false) : false) -+#define IS_8723A_B_CUT(version) ((IS_8723_SERIES(version)) ? ( IS_B_CUT(version)?true : false) : false) -+ -+#define IS_VENDOR_8812A_TEST_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? false : true) : false) -+#define IS_VENDOR_8812A_MP_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? true : false) : false) -+#define IS_VENDOR_8812A_C_CUT(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) == C_CUT_VERSION) ? true : false) : false) -+ -+#define IS_VENDOR_8821A_TEST_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? false : true) : false) -+#define IS_VENDOR_8821A_MP_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? true : false) : false) -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/ieee80211_ext.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/ieee80211_ext.h ---- linux-4.14.17/3rdparty/rtl8812au/include/ieee80211_ext.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/ieee80211_ext.h 2018-02-06 17:42:30.718967283 +0200 -@@ -0,0 +1,281 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __IEEE80211_EXT_H -+#define __IEEE80211_EXT_H -+ -+#include -+#include -+#include -+ -+#define WMM_OUI_TYPE 2 -+#define WMM_OUI_SUBTYPE_INFORMATION_ELEMENT 0 -+#define WMM_OUI_SUBTYPE_PARAMETER_ELEMENT 1 -+#define WMM_OUI_SUBTYPE_TSPEC_ELEMENT 2 -+#define WMM_VERSION 1 -+ -+#define WPA_PROTO_WPA BIT(0) -+#define WPA_PROTO_RSN BIT(1) -+ -+#define WPA_KEY_MGMT_IEEE8021X BIT(0) -+#define WPA_KEY_MGMT_PSK BIT(1) -+#define WPA_KEY_MGMT_NONE BIT(2) -+#define WPA_KEY_MGMT_IEEE8021X_NO_WPA BIT(3) -+#define WPA_KEY_MGMT_WPA_NONE BIT(4) -+ -+ -+#define WPA_CAPABILITY_PREAUTH BIT(0) -+#define WPA_CAPABILITY_MGMT_FRAME_PROTECTION BIT(6) -+#define WPA_CAPABILITY_PEERKEY_ENABLED BIT(9) -+ -+#define PMKID_LEN 16 -+ -+struct wpa_ie_hdr { -+ u8 elem_id; -+ u8 len; -+ u8 oui[4]; /* 24-bit OUI followed by 8-bit OUI type */ -+ u8 version[2]; /* little endian */ -+}__attribute__ ((packed)); -+ -+struct rsn_ie_hdr { -+ u8 elem_id; /* WLAN_EID_RSN */ -+ u8 len; -+ u8 version[2]; /* little endian */ -+}__attribute__ ((packed)); -+ -+struct wme_ac_parameter { -+#if defined(__LITTLE_ENDIAN) -+ /* byte 1 */ -+ u8 aifsn:4, -+ acm:1, -+ aci:2, -+ reserved:1; -+ -+ /* byte 2 */ -+ u8 eCWmin:4, -+ eCWmax:4; -+#else -+ /* byte 1 */ -+ u8 reserved:1, -+ aci:2, -+ acm:1, -+ aifsn:4; -+ -+ /* byte 2 */ -+ u8 eCWmax:4, -+ eCWmin:4; -+#endif -+ -+ /* bytes 3 & 4 */ -+ u16 txopLimit; -+} __attribute__ ((packed)); -+ -+struct wme_parameter_element { -+ /* required fields for WME version 1 */ -+ u8 oui[3]; -+ u8 oui_type; -+ u8 oui_subtype; -+ u8 version; -+ u8 acInfo; -+ u8 reserved; -+ struct wme_ac_parameter ac[4]; -+ -+} __attribute__ ((packed)); -+ -+#define WPA_PUT_LE16(a, val) \ -+ do { \ -+ (a)[1] = ((u16) (val)) >> 8; \ -+ (a)[0] = ((u16) (val)) & 0xff; \ -+ } while (0) -+ -+#define WPA_PUT_BE32(a, val) \ -+ do { \ -+ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[3] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define WPA_PUT_LE32(a, val) \ -+ do { \ -+ (a)[3] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[0] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define RSN_SELECTOR_PUT(a, val) WPA_PUT_BE32((u8 *) (a), (val)) -+ -+/* Action category code */ -+enum ieee80211_category { -+ WLAN_CATEGORY_SPECTRUM_MGMT = 0, -+ WLAN_CATEGORY_QOS = 1, -+ WLAN_CATEGORY_DLS = 2, -+ WLAN_CATEGORY_BACK = 3, -+ WLAN_CATEGORY_HT = 7, -+ WLAN_CATEGORY_WMM = 17, -+}; -+ -+/* SPECTRUM_MGMT action code */ -+enum ieee80211_spectrum_mgmt_actioncode { -+ WLAN_ACTION_SPCT_MSR_REQ = 0, -+ WLAN_ACTION_SPCT_MSR_RPRT = 1, -+ WLAN_ACTION_SPCT_TPC_REQ = 2, -+ WLAN_ACTION_SPCT_TPC_RPRT = 3, -+ WLAN_ACTION_SPCT_CHL_SWITCH = 4, -+ WLAN_ACTION_SPCT_EXT_CHL_SWITCH = 5, -+}; -+ -+/* BACK action code */ -+enum ieee80211_back_actioncode { -+ WLAN_ACTION_ADDBA_REQ = 0, -+ WLAN_ACTION_ADDBA_RESP = 1, -+ WLAN_ACTION_DELBA = 2, -+}; -+ -+/* HT features action code */ -+enum ieee80211_ht_actioncode { -+ WLAN_ACTION_NOTIFY_CH_WIDTH = 0, -+ WLAN_ACTION_SM_PS = 1, -+ WLAN_ACTION_PSPM = 2, -+ WLAN_ACTION_PCO_PHASE = 3, -+ WLAN_ACTION_MIMO_CSI_MX = 4, -+ WLAN_ACTION_MIMO_NONCP_BF = 5, -+ WLAN_ACTION_MIMP_CP_BF = 6, -+ WLAN_ACTION_ASEL_INDICATES_FB = 7, -+ WLAN_ACTION_HI_INFO_EXCHG = 8, -+}; -+ -+/* BACK (block-ack) parties */ -+enum ieee80211_back_parties { -+ WLAN_BACK_RECIPIENT = 0, -+ WLAN_BACK_INITIATOR = 1, -+ WLAN_BACK_TIMER = 2, -+}; -+ -+struct ieee80211_mgmt { -+ __le16 frame_control; -+ __le16 duration; -+ u8 da[6]; -+ u8 sa[6]; -+ u8 bssid[6]; -+ __le16 seq_ctrl; -+ union { -+ struct { -+ __le16 auth_alg; -+ __le16 auth_transaction; -+ __le16 status_code; -+ /* possibly followed by Challenge text */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) auth; -+ struct { -+ __le16 reason_code; -+ } __attribute__ ((packed)) deauth; -+ struct { -+ __le16 capab_info; -+ __le16 listen_interval; -+ /* followed by SSID and Supported rates */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) assoc_req; -+ struct { -+ __le16 capab_info; -+ __le16 status_code; -+ __le16 aid; -+ /* followed by Supported rates */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) assoc_resp, reassoc_resp; -+ struct { -+ __le16 capab_info; -+ __le16 listen_interval; -+ u8 current_ap[6]; -+ /* followed by SSID and Supported rates */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) reassoc_req; -+ struct { -+ __le16 reason_code; -+ } __attribute__ ((packed)) disassoc; -+ struct { -+ __le64 timestamp; -+ __le16 beacon_int; -+ __le16 capab_info; -+ /* followed by some of SSID, Supported rates, -+ * FH Params, DS Params, CF Params, IBSS Params, TIM */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) beacon; -+ struct { -+ /* only variable items: SSID, Supported rates */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) probe_req; -+ struct { -+ __le64 timestamp; -+ __le16 beacon_int; -+ __le16 capab_info; -+ /* followed by some of SSID, Supported rates, -+ * FH Params, DS Params, CF Params, IBSS Params */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) probe_resp; -+ struct { -+ u8 category; -+ union { -+ struct { -+ u8 action_code; -+ u8 dialog_token; -+ u8 status_code; -+ u8 variable[0]; -+ } __attribute__ ((packed)) wme_action; -+ struct{ -+ u8 action_code; -+ u8 dialog_token; -+ __le16 capab; -+ __le16 timeout; -+ __le16 start_seq_num; -+ } __attribute__ ((packed)) addba_req; -+ struct{ -+ u8 action_code; -+ u8 dialog_token; -+ __le16 status; -+ __le16 capab; -+ __le16 timeout; -+ } __attribute__ ((packed)) addba_resp; -+ struct{ -+ u8 action_code; -+ __le16 params; -+ __le16 reason_code; -+ } __attribute__ ((packed)) delba; -+ struct{ -+ u8 action_code; -+ /* capab_info for open and confirm, -+ * reason for close -+ */ -+ __le16 aux; -+ /* Followed in plink_confirm by status -+ * code, AID and supported rates, -+ * and directly by supported rates in -+ * plink_open and plink_close -+ */ -+ u8 variable[0]; -+ } __attribute__ ((packed)) plink_action; -+ struct{ -+ u8 action_code; -+ u8 variable[0]; -+ } __attribute__ ((packed)) mesh_action; -+ } __attribute__ ((packed)) u; -+ } __attribute__ ((packed)) action; -+ } __attribute__ ((packed)) u; -+}__attribute__ ((packed)); -+ -+/* mgmt header + 1 byte category code */ -+#define IEEE80211_MIN_ACTION_SIZE FIELD_OFFSET(struct ieee80211_mgmt, u.action.u) -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/ieee80211.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/ieee80211.h ---- linux-4.14.17/3rdparty/rtl8812au/include/ieee80211.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/ieee80211.h 2018-02-06 17:42:30.718967283 +0200 -@@ -0,0 +1,1463 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __IEEE80211_H -+#define __IEEE80211_H -+ -+#define MGMT_QUEUE_NUM 5 -+ -+#define ETH_ALEN 6 -+#define ETH_TYPE_LEN 2 -+#define PAYLOAD_TYPE_LEN 1 -+ -+#ifdef CONFIG_AP_MODE -+ -+#define RTL_IOCTL_HOSTAPD (SIOCIWFIRSTPRIV + 28) -+ -+/* RTL871X_IOCTL_HOSTAPD ioctl() cmd: */ -+enum { -+ RTL871X_HOSTAPD_FLUSH = 1, -+ RTL871X_HOSTAPD_ADD_STA = 2, -+ RTL871X_HOSTAPD_REMOVE_STA = 3, -+ RTL871X_HOSTAPD_GET_INFO_STA = 4, -+ /* REMOVED: PRISM2_HOSTAPD_RESET_TXEXC_STA = 5, */ -+ RTL871X_HOSTAPD_GET_WPAIE_STA = 5, -+ RTL871X_SET_ENCRYPTION = 6, -+ RTL871X_GET_ENCRYPTION = 7, -+ RTL871X_HOSTAPD_SET_FLAGS_STA = 8, -+ RTL871X_HOSTAPD_GET_RID = 9, -+ RTL871X_HOSTAPD_SET_RID = 10, -+ RTL871X_HOSTAPD_SET_ASSOC_AP_ADDR = 11, -+ RTL871X_HOSTAPD_SET_GENERIC_ELEMENT = 12, -+ RTL871X_HOSTAPD_MLME = 13, -+ RTL871X_HOSTAPD_SCAN_REQ = 14, -+ RTL871X_HOSTAPD_STA_CLEAR_STATS = 15, -+ RTL871X_HOSTAPD_SET_BEACON=16, -+ RTL871X_HOSTAPD_SET_WPS_BEACON = 17, -+ RTL871X_HOSTAPD_SET_WPS_PROBE_RESP = 18, -+ RTL871X_HOSTAPD_SET_WPS_ASSOC_RESP = 19, -+ RTL871X_HOSTAPD_SET_HIDDEN_SSID = 20, -+ RTL871X_HOSTAPD_SET_MACADDR_ACL = 21, -+ RTL871X_HOSTAPD_ACL_ADD_STA = 22, -+ RTL871X_HOSTAPD_ACL_REMOVE_STA = 23, -+}; -+ -+/* STA flags */ -+#define WLAN_STA_AUTH BIT(0) -+#define WLAN_STA_ASSOC BIT(1) -+#define WLAN_STA_PS BIT(2) -+#define WLAN_STA_TIM BIT(3) -+#define WLAN_STA_PERM BIT(4) -+#define WLAN_STA_AUTHORIZED BIT(5) -+#define WLAN_STA_PENDING_POLL BIT(6) /* pending activity poll not ACKed */ -+#define WLAN_STA_SHORT_PREAMBLE BIT(7) -+#define WLAN_STA_PREAUTH BIT(8) -+#define WLAN_STA_WME BIT(9) -+#define WLAN_STA_MFP BIT(10) -+#define WLAN_STA_HT BIT(11) -+#define WLAN_STA_WPS BIT(12) -+#define WLAN_STA_MAYBE_WPS BIT(13) -+#define WLAN_STA_VHT BIT(14) -+#define WLAN_STA_NONERP BIT(31) -+ -+#endif -+ -+#define IEEE_CMD_SET_WPA_PARAM 1 -+#define IEEE_CMD_SET_WPA_IE 2 -+#define IEEE_CMD_SET_ENCRYPTION 3 -+#define IEEE_CMD_MLME 4 -+ -+#define IEEE_PARAM_WPA_ENABLED 1 -+#define IEEE_PARAM_TKIP_COUNTERMEASURES 2 -+#define IEEE_PARAM_DROP_UNENCRYPTED 3 -+#define IEEE_PARAM_PRIVACY_INVOKED 4 -+#define IEEE_PARAM_AUTH_ALGS 5 -+#define IEEE_PARAM_IEEE_802_1X 6 -+#define IEEE_PARAM_WPAX_SELECT 7 -+ -+#define AUTH_ALG_OPEN_SYSTEM 0x1 -+#define AUTH_ALG_SHARED_KEY 0x2 -+#define AUTH_ALG_LEAP 0x00000004 -+ -+#define IEEE_MLME_STA_DEAUTH 1 -+#define IEEE_MLME_STA_DISASSOC 2 -+ -+#define IEEE_CRYPT_ERR_UNKNOWN_ALG 2 -+#define IEEE_CRYPT_ERR_UNKNOWN_ADDR 3 -+#define IEEE_CRYPT_ERR_CRYPT_INIT_FAILED 4 -+#define IEEE_CRYPT_ERR_KEY_SET_FAILED 5 -+#define IEEE_CRYPT_ERR_TX_KEY_SET_FAILED 6 -+#define IEEE_CRYPT_ERR_CARD_CONF_FAILED 7 -+ -+ -+#define IEEE_CRYPT_ALG_NAME_LEN 16 -+ -+#define WPA_CIPHER_NONE BIT(0) -+#define WPA_CIPHER_WEP40 BIT(1) -+#define WPA_CIPHER_WEP104 BIT(2) -+#define WPA_CIPHER_TKIP BIT(3) -+#define WPA_CIPHER_CCMP BIT(4) -+ -+ -+ -+#define WPA_SELECTOR_LEN 4 -+extern u8 RTW_WPA_OUI_TYPE[] ; -+extern u16 RTW_WPA_VERSION ; -+extern u8 WPA_AUTH_KEY_MGMT_NONE[]; -+extern u8 WPA_AUTH_KEY_MGMT_UNSPEC_802_1X[]; -+extern u8 WPA_AUTH_KEY_MGMT_PSK_OVER_802_1X[]; -+extern u8 WPA_CIPHER_SUITE_NONE[]; -+extern u8 WPA_CIPHER_SUITE_WEP40[]; -+extern u8 WPA_CIPHER_SUITE_TKIP[]; -+extern u8 WPA_CIPHER_SUITE_WRAP[]; -+extern u8 WPA_CIPHER_SUITE_CCMP[]; -+extern u8 WPA_CIPHER_SUITE_WEP104[]; -+ -+ -+#define RSN_HEADER_LEN 4 -+#define RSN_SELECTOR_LEN 4 -+ -+extern u16 RSN_VERSION_BSD; -+extern u8 RSN_AUTH_KEY_MGMT_UNSPEC_802_1X[]; -+extern u8 RSN_AUTH_KEY_MGMT_PSK_OVER_802_1X[]; -+extern u8 RSN_CIPHER_SUITE_NONE[]; -+extern u8 RSN_CIPHER_SUITE_WEP40[]; -+extern u8 RSN_CIPHER_SUITE_TKIP[]; -+extern u8 RSN_CIPHER_SUITE_WRAP[]; -+extern u8 RSN_CIPHER_SUITE_CCMP[]; -+extern u8 RSN_CIPHER_SUITE_WEP104[]; -+ -+ -+typedef enum _RATEID_IDX_ { -+ RATEID_IDX_BGN_40M_2SS = 0, -+ RATEID_IDX_BGN_40M_1SS = 1, -+ RATEID_IDX_BGN_20M_2SS_BN = 2, -+ RATEID_IDX_BGN_20M_1SS_BN = 3, -+ RATEID_IDX_GN_N2SS = 4, -+ RATEID_IDX_GN_N1SS = 5, -+ RATEID_IDX_BG = 6, -+ RATEID_IDX_G = 7, -+ RATEID_IDX_B = 8, -+ RATEID_IDX_VHT_2SS = 9, -+ RATEID_IDX_VHT_1SS = 10, -+} RATEID_IDX, *PRATEID_IDX; -+ -+typedef enum _RATR_TABLE_MODE{ -+ RATR_INX_WIRELESS_NGB = 0, // BGN 40 Mhz 2SS 1SS -+ RATR_INX_WIRELESS_NG = 1, // GN or N -+ RATR_INX_WIRELESS_NB = 2, // BGN 20 Mhz 2SS 1SS or BN -+ RATR_INX_WIRELESS_N = 3, -+ RATR_INX_WIRELESS_GB = 4, -+ RATR_INX_WIRELESS_G = 5, -+ RATR_INX_WIRELESS_B = 6, -+ RATR_INX_WIRELESS_MC = 7, -+ RATR_INX_WIRELESS_AC_N = 8, -+}RATR_TABLE_MODE, *PRATR_TABLE_MODE; -+ -+ -+enum NETWORK_TYPE -+{ -+ WIRELESS_INVALID = 0, -+ //Sub-Element -+ WIRELESS_11B = BIT(0), // tx: cck only , rx: cck only, hw: cck -+ WIRELESS_11G = BIT(1), // tx: ofdm only, rx: ofdm & cck, hw: cck & ofdm -+ WIRELESS_11A = BIT(2), // tx: ofdm only, rx: ofdm only, hw: ofdm only -+ WIRELESS_11_24N = BIT(3), // tx: MCS only, rx: MCS & cck, hw: MCS & cck -+ WIRELESS_11_5N = BIT(4), // tx: MCS only, rx: MCS & ofdm, hw: ofdm only -+ WIRELESS_AUTO = BIT(5), -+ WIRELESS_11AC = BIT(6), -+ -+ //Combination -+ //Type for current wireless mode -+ WIRELESS_11BG = (WIRELESS_11B|WIRELESS_11G), // tx: cck & ofdm, rx: cck & ofdm & MCS, hw: cck & ofdm -+ WIRELESS_11G_24N = (WIRELESS_11G|WIRELESS_11_24N), // tx: ofdm & MCS, rx: ofdm & cck & MCS, hw: cck & ofdm -+ WIRELESS_11A_5N = (WIRELESS_11A|WIRELESS_11_5N), // tx: ofdm & MCS, rx: ofdm & MCS, hw: ofdm only -+ WIRELESS_11B_24N = (WIRELESS_11B|WIRELESS_11_24N), // tx: ofdm & cck & MCS, rx: ofdm & cck & MCS, hw: ofdm & cck -+ WIRELESS_11BG_24N = (WIRELESS_11B|WIRELESS_11G|WIRELESS_11_24N), // tx: ofdm & cck & MCS, rx: ofdm & cck & MCS, hw: ofdm & cck -+ WIRELESS_11_24AC = (WIRELESS_11G|WIRELESS_11AC), -+ WIRELESS_11_5AC = (WIRELESS_11A|WIRELESS_11AC), -+ -+ -+ //Type for registry default wireless mode -+ WIRELESS_11AGN = (WIRELESS_11A|WIRELESS_11G|WIRELESS_11_24N|WIRELESS_11_5N), // tx: ofdm & MCS, rx: ofdm & MCS, hw: ofdm only -+ WIRELESS_11ABGN = (WIRELESS_11A|WIRELESS_11B|WIRELESS_11G|WIRELESS_11_24N|WIRELESS_11_5N), -+ WIRELESS_MODE_24G = (WIRELESS_11B|WIRELESS_11G|WIRELESS_11_24N|WIRELESS_11AC), -+ WIRELESS_MODE_5G = (WIRELESS_11A|WIRELESS_11_5N|WIRELESS_11AC), -+ WIRELESS_MODE_MAX = (WIRELESS_11A|WIRELESS_11B|WIRELESS_11G|WIRELESS_11_24N|WIRELESS_11_5N|WIRELESS_11AC), -+}; -+ -+#define SUPPORTED_24G_NETTYPE_MSK (WIRELESS_11B | WIRELESS_11G | WIRELESS_11_24N) -+#define SUPPORTED_5G_NETTYPE_MSK (WIRELESS_11A | WIRELESS_11_5N) -+ -+#define IsSupported24G(NetType) ((NetType) & SUPPORTED_24G_NETTYPE_MSK ? true : false) -+#define IsSupported5G(NetType) ((NetType) & SUPPORTED_5G_NETTYPE_MSK ? true : false) -+ -+#define IsEnableHWCCK(NetType) IsSupported24G(NetType) -+#define IsEnableHWOFDM(NetType) ((NetType) & (WIRELESS_11G|WIRELESS_11_24N|SUPPORTED_5G_NETTYPE_MSK) ? true : false) -+ -+#define IsSupportedRxCCK(NetType) IsEnableHWCCK(NetType) -+#define IsSupportedRxOFDM(NetType) IsEnableHWOFDM(NetType) -+#define IsSupportedRxHT(NetType) IsEnableHWOFDM(NetType) -+ -+#define IsSupportedTxCCK(NetType) ((NetType) & (WIRELESS_11B) ? true : false) -+#define IsSupportedTxOFDM(NetType) ((NetType) & (WIRELESS_11G|WIRELESS_11A) ? true : false) -+#define IsSupportedTxHT(NetType) ((NetType) & (WIRELESS_11_24N|WIRELESS_11_5N) ? true : false) -+ -+#define IsSupportedVHT(NetType) ((NetType) & (WIRELESS_11AC) ? true : false) -+ -+ -+typedef struct ieee_param { -+ u32 cmd; -+ u8 sta_addr[ETH_ALEN]; -+ union { -+ struct { -+ u8 name; -+ u32 value; -+ } wpa_param; -+ struct { -+ u32 len; -+ u8 reserved[32]; -+ u8 data[0]; -+ } wpa_ie; -+ struct{ -+ int command; -+ int reason_code; -+ } mlme; -+ struct { -+ u8 alg[IEEE_CRYPT_ALG_NAME_LEN]; -+ u8 set_tx; -+ u32 err; -+ u8 idx; -+ u8 seq[8]; /* sequence counter (set: RX, get: TX) */ -+ u16 key_len; -+ u8 key[0]; -+ } crypt; -+#ifdef CONFIG_AP_MODE -+ struct { -+ u16 aid; -+ u16 capability; -+ int flags; -+ u8 tx_supp_rates[16]; -+ struct rtw_ieee80211_ht_cap ht_cap; -+ } add_sta; -+ struct { -+ u8 reserved[2];//for set max_num_sta -+ u8 buf[0]; -+ } bcn_ie; -+#endif -+ -+ } u; -+}ieee_param; -+ -+#ifdef CONFIG_AP_MODE -+typedef struct ieee_param_ex { -+ u32 cmd; -+ u8 sta_addr[ETH_ALEN]; -+ u8 data[0]; -+}ieee_param_ex; -+ -+struct sta_data{ -+ u16 aid; -+ u16 capability; -+ int flags; -+ u32 sta_set; -+ u8 tx_supp_rates[16]; -+ u32 tx_supp_rates_len; -+ struct rtw_ieee80211_ht_cap ht_cap; -+ u64 rx_pkts; -+ u64 rx_bytes; -+ u64 rx_drops; -+ u64 tx_pkts; -+ u64 tx_bytes; -+ u64 tx_drops; -+}; -+#endif -+ -+ -+#if WIRELESS_EXT < 17 -+#define IW_QUAL_QUAL_INVALID 0x10 -+#define IW_QUAL_LEVEL_INVALID 0x20 -+#define IW_QUAL_NOISE_INVALID 0x40 -+#define IW_QUAL_QUAL_UPDATED 0x1 -+#define IW_QUAL_LEVEL_UPDATED 0x2 -+#define IW_QUAL_NOISE_UPDATED 0x4 -+#endif -+ -+#define IEEE80211_DATA_LEN 2304 -+/* Maximum size for the MA-UNITDATA primitive, 802.11 standard section -+ 6.2.1.1.2. -+ -+ The figure in section 7.1.2 suggests a body size of up to 2312 -+ bytes is allowed, which is a bit confusing, I suspect this -+ represents the 2304 bytes of real data, plus a possible 8 bytes of -+ WEP IV and ICV. (this interpretation suggested by Ramiro Barreiro) */ -+ -+ -+#define IEEE80211_HLEN 30 -+#define IEEE80211_FRAME_LEN (IEEE80211_DATA_LEN + IEEE80211_HLEN) -+ -+ -+/* this is stolen from ipw2200 driver */ -+#define IEEE_IBSS_MAC_HASH_SIZE 31 -+ -+struct ieee_ibss_seq { -+ u8 mac[ETH_ALEN]; -+ u16 seq_num; -+ u16 frag_num; -+ unsigned long packet_time; -+ _list list; -+}; -+ -+struct rtw_ieee80211_hdr { -+ __le16 frame_ctl; -+ __le16 duration_id; -+ u8 addr1[ETH_ALEN]; -+ u8 addr2[ETH_ALEN]; -+ u8 addr3[ETH_ALEN]; -+ __le16 seq_ctl; -+ u8 addr4[ETH_ALEN]; -+} __attribute__ ((packed)); -+ -+struct rtw_ieee80211_hdr_3addr { -+ __le16 frame_ctl; -+ __le16 duration_id; -+ u8 addr1[ETH_ALEN]; -+ u8 addr2[ETH_ALEN]; -+ u8 addr3[ETH_ALEN]; -+ __le16 seq_ctl; -+} __attribute__ ((packed)); -+ -+ -+struct rtw_ieee80211_hdr_qos { -+ __le16 frame_ctl; -+ __le16 duration_id; -+ u8 addr1[ETH_ALEN]; -+ u8 addr2[ETH_ALEN]; -+ u8 addr3[ETH_ALEN]; -+ __le16 seq_ctl; -+ u8 addr4[ETH_ALEN]; -+ __le16 qc; -+} __attribute__ ((packed)); -+ -+struct rtw_ieee80211_hdr_3addr_qos { -+ __le16 frame_ctl; -+ __le16 duration_id; -+ u8 addr1[ETH_ALEN]; -+ u8 addr2[ETH_ALEN]; -+ u8 addr3[ETH_ALEN]; -+ __le16 seq_ctl; -+ __le16 qc; -+} __attribute__ ((packed)); -+ -+struct eapol { -+ u8 snap[6]; -+ __le16 ethertype; -+ u8 version; -+ u8 type; -+ __le16 length; -+} __attribute__ ((packed)); -+ -+enum eap_type { -+ EAP_PACKET = 0, -+ EAPOL_START, -+ EAPOL_LOGOFF, -+ EAPOL_KEY, -+ EAPOL_ENCAP_ASF_ALERT -+}; -+ -+#define IEEE80211_3ADDR_LEN 24 -+#define IEEE80211_4ADDR_LEN 30 -+#define IEEE80211_FCS_LEN 4 -+ -+#define MIN_FRAG_THRESHOLD 256U -+#define MAX_FRAG_THRESHOLD 2346U -+ -+/* Frame control field constants */ -+#define RTW_IEEE80211_FCTL_VERS 0x0003 -+#define RTW_IEEE80211_FCTL_FTYPE 0x000c -+#define RTW_IEEE80211_FCTL_STYPE 0x00f0 -+#define RTW_IEEE80211_FCTL_TODS 0x0100 -+#define RTW_IEEE80211_FCTL_FROMDS 0x0200 -+#define RTW_IEEE80211_FCTL_MOREFRAGS 0x0400 -+#define RTW_IEEE80211_FCTL_RETRY 0x0800 -+#define RTW_IEEE80211_FCTL_PM 0x1000 -+#define RTW_IEEE80211_FCTL_MOREDATA 0x2000 -+#define RTW_IEEE80211_FCTL_PROTECTED 0x4000 -+#define RTW_IEEE80211_FCTL_ORDER 0x8000 -+#define RTW_IEEE80211_FCTL_CTL_EXT 0x0f00 -+ -+#define RTW_IEEE80211_FTYPE_MGMT 0x0000 -+#define RTW_IEEE80211_FTYPE_CTL 0x0004 -+#define RTW_IEEE80211_FTYPE_DATA 0x0008 -+#define RTW_IEEE80211_FTYPE_EXT 0x000c -+ -+/* management */ -+#define RTW_IEEE80211_STYPE_ASSOC_REQ 0x0000 -+#define RTW_IEEE80211_STYPE_ASSOC_RESP 0x0010 -+#define RTW_IEEE80211_STYPE_REASSOC_REQ 0x0020 -+#define RTW_IEEE80211_STYPE_REASSOC_RESP 0x0030 -+#define RTW_IEEE80211_STYPE_PROBE_REQ 0x0040 -+#define RTW_IEEE80211_STYPE_PROBE_RESP 0x0050 -+#define RTW_IEEE80211_STYPE_BEACON 0x0080 -+#define RTW_IEEE80211_STYPE_ATIM 0x0090 -+#define RTW_IEEE80211_STYPE_DISASSOC 0x00A0 -+#define RTW_IEEE80211_STYPE_AUTH 0x00B0 -+#define RTW_IEEE80211_STYPE_DEAUTH 0x00C0 -+#define RTW_IEEE80211_STYPE_ACTION 0x00D0 -+ -+/* control */ -+#define RTW_IEEE80211_STYPE_CTL_EXT 0x0060 -+#define RTW_IEEE80211_STYPE_BACK_REQ 0x0080 -+#define RTW_IEEE80211_STYPE_BACK 0x0090 -+#define RTW_IEEE80211_STYPE_PSPOLL 0x00A0 -+#define RTW_IEEE80211_STYPE_RTS 0x00B0 -+#define RTW_IEEE80211_STYPE_CTS 0x00C0 -+#define RTW_IEEE80211_STYPE_ACK 0x00D0 -+#define RTW_IEEE80211_STYPE_CFEND 0x00E0 -+#define RTW_IEEE80211_STYPE_CFENDACK 0x00F0 -+ -+/* data */ -+#define RTW_IEEE80211_STYPE_DATA 0x0000 -+#define RTW_IEEE80211_STYPE_DATA_CFACK 0x0010 -+#define RTW_IEEE80211_STYPE_DATA_CFPOLL 0x0020 -+#define RTW_IEEE80211_STYPE_DATA_CFACKPOLL 0x0030 -+#define RTW_IEEE80211_STYPE_NULLFUNC 0x0040 -+#define RTW_IEEE80211_STYPE_CFACK 0x0050 -+#define RTW_IEEE80211_STYPE_CFPOLL 0x0060 -+#define RTW_IEEE80211_STYPE_CFACKPOLL 0x0070 -+#define RTW_IEEE80211_STYPE_QOS_DATA 0x0080 -+#define RTW_IEEE80211_STYPE_QOS_DATA_CFACK 0x0090 -+#define RTW_IEEE80211_STYPE_QOS_DATA_CFPOLL 0x00A0 -+#define RTW_IEEE80211_STYPE_QOS_DATA_CFACKPOLL 0x00B0 -+#define RTW_IEEE80211_STYPE_QOS_NULLFUNC 0x00C0 -+#define RTW_IEEE80211_STYPE_QOS_CFACK 0x00D0 -+#define RTW_IEEE80211_STYPE_QOS_CFPOLL 0x00E0 -+#define RTW_IEEE80211_STYPE_QOS_CFACKPOLL 0x00F0 -+ -+/* sequence control field */ -+#define RTW_IEEE80211_SCTL_FRAG 0x000F -+#define RTW_IEEE80211_SCTL_SEQ 0xFFF0 -+ -+ -+#define RTW_ERP_INFO_NON_ERP_PRESENT BIT(0) -+#define RTW_ERP_INFO_USE_PROTECTION BIT(1) -+#define RTW_ERP_INFO_BARKER_PREAMBLE_MODE BIT(2) -+ -+/* QoS,QOS */ -+#define NORMAL_ACK 0 -+#define NO_ACK 1 -+#define NON_EXPLICIT_ACK 2 -+#define BLOCK_ACK 3 -+ -+#ifndef ETH_P_PAE -+#define ETH_P_PAE 0x888E /* Port Access Entity (IEEE 802.1X) */ -+#endif /* ETH_P_PAE */ -+ -+#define ETH_P_PREAUTH 0x88C7 /* IEEE 802.11i pre-authentication */ -+ -+#define ETH_P_ECONET 0x0018 -+ -+#ifndef ETH_P_80211_RAW -+#define ETH_P_80211_RAW (ETH_P_ECONET + 1) -+#endif -+ -+/* IEEE 802.11 defines */ -+ -+#define P80211_OUI_LEN 3 -+ -+struct ieee80211_snap_hdr { -+ -+ u8 dsap; /* always 0xAA */ -+ u8 ssap; /* always 0xAA */ -+ u8 ctrl; /* always 0x03 */ -+ u8 oui[P80211_OUI_LEN]; /* organizational universal id */ -+ -+} __attribute__ ((packed)); -+ -+#define SNAP_SIZE sizeof(struct ieee80211_snap_hdr) -+ -+#define WLAN_FC_GET_TYPE(fc) ((fc) & RTW_IEEE80211_FCTL_FTYPE) -+#define WLAN_FC_GET_STYPE(fc) ((fc) & RTW_IEEE80211_FCTL_STYPE) -+ -+#define WLAN_QC_GET_TID(qc) ((qc) & 0x0f) -+ -+#define WLAN_GET_SEQ_FRAG(seq) ((seq) & RTW_IEEE80211_SCTL_FRAG) -+#define WLAN_GET_SEQ_SEQ(seq) ((seq) & RTW_IEEE80211_SCTL_SEQ) -+ -+/* Authentication algorithms */ -+#define WLAN_AUTH_OPEN 0 -+#define WLAN_AUTH_SHARED_KEY 1 -+ -+#define WLAN_AUTH_CHALLENGE_LEN 128 -+ -+#define WLAN_CAPABILITY_BSS (1<<0) -+#define WLAN_CAPABILITY_IBSS (1<<1) -+#define WLAN_CAPABILITY_CF_POLLABLE (1<<2) -+#define WLAN_CAPABILITY_CF_POLL_REQUEST (1<<3) -+#define WLAN_CAPABILITY_PRIVACY (1<<4) -+#define WLAN_CAPABILITY_SHORT_PREAMBLE (1<<5) -+#define WLAN_CAPABILITY_PBCC (1<<6) -+#define WLAN_CAPABILITY_CHANNEL_AGILITY (1<<7) -+#define WLAN_CAPABILITY_SHORT_SLOT (1<<10) -+ -+/* Status codes */ -+#define WLAN_STATUS_SUCCESS 0 -+#define WLAN_STATUS_UNSPECIFIED_FAILURE 1 -+#define WLAN_STATUS_CAPS_UNSUPPORTED 10 -+#define WLAN_STATUS_REASSOC_NO_ASSOC 11 -+#define WLAN_STATUS_ASSOC_DENIED_UNSPEC 12 -+#define WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG 13 -+#define WLAN_STATUS_UNKNOWN_AUTH_TRANSACTION 14 -+#define WLAN_STATUS_CHALLENGE_FAIL 15 -+#define WLAN_STATUS_AUTH_TIMEOUT 16 -+#define WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA 17 -+#define WLAN_STATUS_ASSOC_DENIED_RATES 18 -+/* 802.11b */ -+#define WLAN_STATUS_ASSOC_DENIED_NOSHORT 19 -+#define WLAN_STATUS_ASSOC_DENIED_NOPBCC 20 -+#define WLAN_STATUS_ASSOC_DENIED_NOAGILITY 21 -+ -+/* Reason codes */ -+#define WLAN_REASON_UNSPECIFIED 1 -+#define WLAN_REASON_PREV_AUTH_NOT_VALID 2 -+#define WLAN_REASON_DEAUTH_LEAVING 3 -+#define WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY 4 -+#define WLAN_REASON_DISASSOC_AP_BUSY 5 -+#define WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA 6 -+#define WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA 7 -+#define WLAN_REASON_DISASSOC_STA_HAS_LEFT 8 -+#define WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH 9 -+#define WLAN_REASON_JOIN_WRONG_CHANNEL 65534 -+#define WLAN_REASON_EXPIRATION_CHK 65535 -+ -+/* Information Element IDs */ -+#define WLAN_EID_SSID 0 -+#define WLAN_EID_SUPP_RATES 1 -+#define WLAN_EID_FH_PARAMS 2 -+#define WLAN_EID_DS_PARAMS 3 -+#define WLAN_EID_CF_PARAMS 4 -+#define WLAN_EID_TIM 5 -+#define WLAN_EID_IBSS_PARAMS 6 -+#define WLAN_EID_CHALLENGE 16 -+/* EIDs defined by IEEE 802.11h - START */ -+#define WLAN_EID_PWR_CONSTRAINT 32 -+#define WLAN_EID_PWR_CAPABILITY 33 -+#define WLAN_EID_TPC_REQUEST 34 -+#define WLAN_EID_TPC_REPORT 35 -+#define WLAN_EID_SUPPORTED_CHANNELS 36 -+#define WLAN_EID_CHANNEL_SWITCH 37 -+#define WLAN_EID_MEASURE_REQUEST 38 -+#define WLAN_EID_MEASURE_REPORT 39 -+#define WLAN_EID_QUITE 40 -+#define WLAN_EID_IBSS_DFS 41 -+/* EIDs defined by IEEE 802.11h - END */ -+#define WLAN_EID_ERP_INFO 42 -+#define WLAN_EID_HT_CAP 45 -+#define WLAN_EID_RSN 48 -+#define WLAN_EID_EXT_SUPP_RATES 50 -+#define WLAN_EID_MOBILITY_DOMAIN 54 -+#define WLAN_EID_FAST_BSS_TRANSITION 55 -+#define WLAN_EID_TIMEOUT_INTERVAL 56 -+#define WLAN_EID_RIC_DATA 57 -+#define WLAN_EID_HT_OPERATION 61 -+#define WLAN_EID_SECONDARY_CHANNEL_OFFSET 62 -+#define WLAN_EID_20_40_BSS_COEXISTENCE 72 -+#define WLAN_EID_20_40_BSS_INTOLERANT 73 -+#define WLAN_EID_OVERLAPPING_BSS_SCAN_PARAMS 74 -+#define WLAN_EID_MMIE 76 -+#define WLAN_EID_VENDOR_SPECIFIC 221 -+#define WLAN_EID_GENERIC (WLAN_EID_VENDOR_SPECIFIC) -+#define WLAN_EID_VHT_CAPABILITY 191 -+#define WLAN_EID_VHT_OPERATION 192 -+#define WLAN_EID_VHT_OP_MODE_NOTIFY 193 -+ -+#define IEEE80211_MGMT_HDR_LEN 24 -+#define IEEE80211_DATA_HDR3_LEN 24 -+#define IEEE80211_DATA_HDR4_LEN 30 -+ -+ -+#define IEEE80211_STATMASK_SIGNAL (1<<0) -+#define IEEE80211_STATMASK_RSSI (1<<1) -+#define IEEE80211_STATMASK_NOISE (1<<2) -+#define IEEE80211_STATMASK_RATE (1<<3) -+#define IEEE80211_STATMASK_WEMASK 0x7 -+ -+ -+#define IEEE80211_CCK_MODULATION (1<<0) -+#define IEEE80211_OFDM_MODULATION (1<<1) -+ -+#define IEEE80211_24GHZ_BAND (1<<0) -+#define IEEE80211_52GHZ_BAND (1<<1) -+ -+#define IEEE80211_CCK_RATE_LEN 4 -+#define IEEE80211_NUM_OFDM_RATESLEN 8 -+ -+ -+#define IEEE80211_CCK_RATE_1MB 0x02 -+#define IEEE80211_CCK_RATE_2MB 0x04 -+#define IEEE80211_CCK_RATE_5MB 0x0B -+#define IEEE80211_CCK_RATE_11MB 0x16 -+#define IEEE80211_OFDM_RATE_LEN 8 -+#define IEEE80211_OFDM_RATE_6MB 0x0C -+#define IEEE80211_OFDM_RATE_9MB 0x12 -+#define IEEE80211_OFDM_RATE_12MB 0x18 -+#define IEEE80211_OFDM_RATE_18MB 0x24 -+#define IEEE80211_OFDM_RATE_24MB 0x30 -+#define IEEE80211_OFDM_RATE_36MB 0x48 -+#define IEEE80211_OFDM_RATE_48MB 0x60 -+#define IEEE80211_OFDM_RATE_54MB 0x6C -+#define IEEE80211_BASIC_RATE_MASK 0x80 -+ -+#define IEEE80211_CCK_RATE_1MB_MASK (1<<0) -+#define IEEE80211_CCK_RATE_2MB_MASK (1<<1) -+#define IEEE80211_CCK_RATE_5MB_MASK (1<<2) -+#define IEEE80211_CCK_RATE_11MB_MASK (1<<3) -+#define IEEE80211_OFDM_RATE_6MB_MASK (1<<4) -+#define IEEE80211_OFDM_RATE_9MB_MASK (1<<5) -+#define IEEE80211_OFDM_RATE_12MB_MASK (1<<6) -+#define IEEE80211_OFDM_RATE_18MB_MASK (1<<7) -+#define IEEE80211_OFDM_RATE_24MB_MASK (1<<8) -+#define IEEE80211_OFDM_RATE_36MB_MASK (1<<9) -+#define IEEE80211_OFDM_RATE_48MB_MASK (1<<10) -+#define IEEE80211_OFDM_RATE_54MB_MASK (1<<11) -+ -+#define IEEE80211_CCK_RATES_MASK 0x0000000F -+#define IEEE80211_CCK_BASIC_RATES_MASK (IEEE80211_CCK_RATE_1MB_MASK | \ -+ IEEE80211_CCK_RATE_2MB_MASK) -+#define IEEE80211_CCK_DEFAULT_RATES_MASK (IEEE80211_CCK_BASIC_RATES_MASK | \ -+ IEEE80211_CCK_RATE_5MB_MASK | \ -+ IEEE80211_CCK_RATE_11MB_MASK) -+ -+#define IEEE80211_OFDM_RATES_MASK 0x00000FF0 -+#define IEEE80211_OFDM_BASIC_RATES_MASK (IEEE80211_OFDM_RATE_6MB_MASK | \ -+ IEEE80211_OFDM_RATE_12MB_MASK | \ -+ IEEE80211_OFDM_RATE_24MB_MASK) -+#define IEEE80211_OFDM_DEFAULT_RATES_MASK (IEEE80211_OFDM_BASIC_RATES_MASK | \ -+ IEEE80211_OFDM_RATE_9MB_MASK | \ -+ IEEE80211_OFDM_RATE_18MB_MASK | \ -+ IEEE80211_OFDM_RATE_36MB_MASK | \ -+ IEEE80211_OFDM_RATE_48MB_MASK | \ -+ IEEE80211_OFDM_RATE_54MB_MASK) -+#define IEEE80211_DEFAULT_RATES_MASK (IEEE80211_OFDM_DEFAULT_RATES_MASK | \ -+ IEEE80211_CCK_DEFAULT_RATES_MASK) -+ -+#define IEEE80211_NUM_OFDM_RATES 8 -+#define IEEE80211_NUM_CCK_RATES 4 -+#define IEEE80211_OFDM_SHIFT_MASK_A 4 -+ -+ -+/* BIT 7 HT Rate*/ -+// TxHT = 0 -+#define MGN_1M 0x02 -+#define MGN_2M 0x04 -+#define MGN_5_5M 0x0b -+#define MGN_11M 0x16 -+ -+#define MGN_6M 0x0c -+#define MGN_9M 0x12 -+#define MGN_12M 0x18 -+#define MGN_18M 0x24 -+#define MGN_24M 0x30 -+#define MGN_36M 0x48 -+#define MGN_48M 0x60 -+#define MGN_54M 0x6c -+ -+// TxHT = 1 -+#define MGN_MCS0 0x80 -+#define MGN_MCS1 0x81 -+#define MGN_MCS2 0x82 -+#define MGN_MCS3 0x83 -+#define MGN_MCS4 0x84 -+#define MGN_MCS5 0x85 -+#define MGN_MCS6 0x86 -+#define MGN_MCS7 0x87 -+#define MGN_MCS8 0x88 -+#define MGN_MCS9 0x89 -+#define MGN_MCS10 0x8a -+#define MGN_MCS11 0x8b -+#define MGN_MCS12 0x8c -+#define MGN_MCS13 0x8d -+#define MGN_MCS14 0x8e -+#define MGN_MCS15 0x8f -+#define MGN_VHT1SS_MCS0 0x90 -+#define MGN_VHT1SS_MCS1 0x91 -+#define MGN_VHT1SS_MCS2 0x92 -+#define MGN_VHT1SS_MCS3 0x93 -+#define MGN_VHT1SS_MCS4 0x94 -+#define MGN_VHT1SS_MCS5 0x95 -+#define MGN_VHT1SS_MCS6 0x96 -+#define MGN_VHT1SS_MCS7 0x97 -+#define MGN_VHT1SS_MCS8 0x98 -+#define MGN_VHT1SS_MCS9 0x99 -+#define MGN_VHT2SS_MCS0 0x9a -+#define MGN_VHT2SS_MCS1 0x9b -+#define MGN_VHT2SS_MCS2 0x9c -+#define MGN_VHT2SS_MCS3 0x9d -+#define MGN_VHT2SS_MCS4 0x9e -+#define MGN_VHT2SS_MCS5 0x9f -+#define MGN_VHT2SS_MCS6 0xa0 -+#define MGN_VHT2SS_MCS7 0xa1 -+#define MGN_VHT2SS_MCS8 0xa2 -+#define MGN_VHT2SS_MCS9 0xa3 -+ -+#define MGN_MCS0_SG 0xc0 -+#define MGN_MCS1_SG 0xc1 -+#define MGN_MCS2_SG 0xc2 -+#define MGN_MCS3_SG 0xc3 -+#define MGN_MCS4_SG 0xc4 -+#define MGN_MCS5_SG 0xc5 -+#define MGN_MCS6_SG 0xc6 -+#define MGN_MCS7_SG 0xc7 -+#define MGN_MCS8_SG 0xc8 -+#define MGN_MCS9_SG 0xc9 -+#define MGN_MCS10_SG 0xca -+#define MGN_MCS11_SG 0xcb -+#define MGN_MCS12_SG 0xcc -+#define MGN_MCS13_SG 0xcd -+#define MGN_MCS14_SG 0xce -+#define MGN_MCS15_SG 0xcf -+ -+#define IS_HT_RATE(rate) (((rate) & 0x80) ? true : false) -+#define IS_CCK_RATE(_rate) (_rate == MGN_1M || _rate == MGN_2M || _rate == MGN_5_5M || _rate == MGN_11M) -+ -+ -+/* NOTE: This data is for statistical purposes; not all hardware provides this -+ * information for frames received. Not setting these will not cause -+ * any adverse affects. */ -+struct ieee80211_rx_stats { -+ //u32 mac_time[2]; -+ s8 rssi; -+ u8 signal; -+ u8 noise; -+ u8 received_channel; -+ u16 rate; /* in 100 kbps */ -+ //u8 control; -+ u8 mask; -+ u8 freq; -+ u16 len; -+}; -+ -+/* IEEE 802.11 requires that STA supports concurrent reception of at least -+ * three fragmented frames. This define can be increased to support more -+ * concurrent frames, but it should be noted that each entry can consume about -+ * 2 kB of RAM and increasing cache size will slow down frame reassembly. */ -+#define IEEE80211_FRAG_CACHE_LEN 4 -+ -+struct ieee80211_frag_entry { -+ u32 first_frag_time; -+ uint seq; -+ uint last_frag; -+ uint qos; //jackson -+ uint tid; //jackson -+ struct sk_buff *skb; -+ u8 src_addr[ETH_ALEN]; -+ u8 dst_addr[ETH_ALEN]; -+}; -+ -+struct ieee80211_stats { -+ uint tx_unicast_frames; -+ uint tx_multicast_frames; -+ uint tx_fragments; -+ uint tx_unicast_octets; -+ uint tx_multicast_octets; -+ uint tx_deferred_transmissions; -+ uint tx_single_retry_frames; -+ uint tx_multiple_retry_frames; -+ uint tx_retry_limit_exceeded; -+ uint tx_discards; -+ uint rx_unicast_frames; -+ uint rx_multicast_frames; -+ uint rx_fragments; -+ uint rx_unicast_octets; -+ uint rx_multicast_octets; -+ uint rx_fcs_errors; -+ uint rx_discards_no_buffer; -+ uint tx_discards_wrong_sa; -+ uint rx_discards_undecryptable; -+ uint rx_message_in_msg_fragments; -+ uint rx_message_in_bad_msg_fragments; -+}; -+ -+struct ieee80211_softmac_stats{ -+ uint rx_ass_ok; -+ uint rx_ass_err; -+ uint rx_probe_rq; -+ uint tx_probe_rs; -+ uint tx_beacons; -+ uint rx_auth_rq; -+ uint rx_auth_rs_ok; -+ uint rx_auth_rs_err; -+ uint tx_auth_rq; -+ uint no_auth_rs; -+ uint no_ass_rs; -+ uint tx_ass_rq; -+ uint rx_ass_rq; -+ uint tx_probe_rq; -+ uint reassoc; -+ uint swtxstop; -+ uint swtxawake; -+}; -+ -+#define SEC_KEY_1 (1<<0) -+#define SEC_KEY_2 (1<<1) -+#define SEC_KEY_3 (1<<2) -+#define SEC_KEY_4 (1<<3) -+#define SEC_ACTIVE_KEY (1<<4) -+#define SEC_AUTH_MODE (1<<5) -+#define SEC_UNICAST_GROUP (1<<6) -+#define SEC_LEVEL (1<<7) -+#define SEC_ENABLED (1<<8) -+ -+#define SEC_LEVEL_0 0 /* None */ -+#define SEC_LEVEL_1 1 /* WEP 40 and 104 bit */ -+#define SEC_LEVEL_2 2 /* Level 1 + TKIP */ -+#define SEC_LEVEL_2_CKIP 3 /* Level 1 + CKIP */ -+#define SEC_LEVEL_3 4 /* Level 2 + CCMP */ -+ -+#define WEP_KEYS 4 -+#define WEP_KEY_LEN 13 -+ -+struct ieee80211_security { -+ u16 active_key:2, -+ enabled:1, -+ auth_mode:2, -+ auth_algo:4, -+ unicast_uses_group:1; -+ u8 key_sizes[WEP_KEYS]; -+ u8 keys[WEP_KEYS][WEP_KEY_LEN]; -+ u8 level; -+ __le16 flags; -+} __attribute__ ((packed)); -+ -+/* -+ -+ 802.11 data frame from AP -+ -+ ,-------------------------------------------------------------------. -+Bytes | 2 | 2 | 6 | 6 | 6 | 2 | 0..2312 | 4 | -+ |------|------|---------|---------|---------|------|---------|------| -+Desc. | ctrl | dura | DA/RA | TA | SA | Sequ | frame | fcs | -+ | | tion | (BSSID) | | | ence | data | | -+ `-------------------------------------------------------------------' -+ -+Total: 28-2340 bytes -+ -+*/ -+ -+struct ieee80211_header_data { -+ u16 frame_ctl; -+ u16 duration_id; -+ u8 addr1[6]; -+ u8 addr2[6]; -+ u8 addr3[6]; -+ u16 seq_ctrl; -+}; -+ -+#define BEACON_PROBE_SSID_ID_POSITION 12 -+ -+/* Management Frame Information Element Types */ -+#define MFIE_TYPE_SSID 0 -+#define MFIE_TYPE_RATES 1 -+#define MFIE_TYPE_FH_SET 2 -+#define MFIE_TYPE_DS_SET 3 -+#define MFIE_TYPE_CF_SET 4 -+#define MFIE_TYPE_TIM 5 -+#define MFIE_TYPE_IBSS_SET 6 -+#define MFIE_TYPE_CHALLENGE 16 -+#define MFIE_TYPE_ERP 42 -+#define MFIE_TYPE_RSN 48 -+#define MFIE_TYPE_RATES_EX 50 -+#define MFIE_TYPE_GENERIC 221 -+ -+struct ieee80211_info_element_hdr { -+ u8 id; -+ u8 len; -+} __attribute__ ((packed)); -+ -+struct ieee80211_info_element { -+ u8 id; -+ u8 len; -+ u8 data[0]; -+} __attribute__ ((packed)); -+ -+/* -+ * These are the data types that can make up management packets -+ * -+ u16 auth_algorithm; -+ u16 auth_sequence; -+ u16 beacon_interval; -+ u16 capability; -+ u8 current_ap[ETH_ALEN]; -+ u16 listen_interval; -+ struct { -+ u16 association_id:14, reserved:2; -+ } __attribute__ ((packed)); -+ u32 time_stamp[2]; -+ u16 reason; -+ u16 status; -+*/ -+ -+#define IEEE80211_DEFAULT_TX_ESSID "Penguin" -+#define IEEE80211_DEFAULT_BASIC_RATE 10 -+ -+struct ieee80211_authentication { -+ struct ieee80211_header_data header; -+ __le16 algorithm; -+ __le16 transaction; -+ __le16 status; -+ //struct ieee80211_info_element_hdr info_element; -+} __attribute__ ((packed)); -+ -+struct ieee80211_probe_response { -+ struct ieee80211_header_data header; -+ __le32 time_stamp[2]; -+ __le16 beacon_interval; -+ __le16 capability; -+ struct ieee80211_info_element info_element; -+} __attribute__ ((packed)); -+ -+struct ieee80211_probe_request { -+ struct ieee80211_header_data header; -+} __attribute__ ((packed)); -+ -+struct ieee80211_assoc_request_frame { -+ struct rtw_ieee80211_hdr_3addr header; -+ __le16 capability; -+ __le16 listen_interval; -+ struct ieee80211_info_element_hdr info_element; -+} __attribute__ ((packed)); -+ -+struct ieee80211_assoc_response_frame { -+ struct rtw_ieee80211_hdr_3addr header; -+ __le16 capability; -+ __le16 status; -+ __le16 aid; -+} __attribute__ ((packed)); -+ -+struct ieee80211_txb { -+ u8 nr_frags; -+ u8 encrypted; -+ __le16 reserved; -+ __le16 frag_size; -+ __le16 payload_size; -+ struct sk_buff *fragments[0]; -+}; -+ -+/* SWEEP TABLE ENTRIES NUMBER*/ -+#define MAX_SWEEP_TAB_ENTRIES 42 -+#define MAX_SWEEP_TAB_ENTRIES_PER_PACKET 7 -+/* MAX_RATES_LENGTH needs to be 12. The spec says 8, and many APs -+ * only use 8, and then use extended rates for the remaining supported -+ * rates. Other APs, however, stick all of their supported rates on the -+ * main rates information element... */ -+#define MAX_RATES_LENGTH ((u8)12) -+#define MAX_RATES_EX_LENGTH ((u8)16) -+#define MAX_NETWORK_COUNT 128 -+#define MAX_CHANNEL_NUMBER 161 -+#define IEEE80211_SOFTMAC_SCAN_TIME 400 -+//(HZ / 2) -+#define IEEE80211_SOFTMAC_ASSOC_RETRY_TIME (HZ * 2) -+ -+#define CRC_LENGTH 4U -+ -+#define MAX_WPA_IE_LEN (256) -+#define MAX_WPS_IE_LEN (512) -+#define MAX_P2P_IE_LEN (256) -+#define MAX_WFD_IE_LEN (128) -+ -+#define NETWORK_EMPTY_ESSID (1<<0) -+#define NETWORK_HAS_OFDM (1<<1) -+#define NETWORK_HAS_CCK (1<<2) -+ -+#define IEEE80211_DTIM_MBCAST 4 -+#define IEEE80211_DTIM_UCAST 2 -+#define IEEE80211_DTIM_VALID 1 -+#define IEEE80211_DTIM_INVALID 0 -+ -+#define IEEE80211_PS_DISABLED 0 -+#define IEEE80211_PS_UNICAST IEEE80211_DTIM_UCAST -+#define IEEE80211_PS_MBCAST IEEE80211_DTIM_MBCAST -+#define IW_ESSID_MAX_SIZE 32 -+#if 0 -+struct ieee80211_network { -+ /* These entries are used to identify a unique network */ -+ u8 bssid[ETH_ALEN]; -+ u8 channel; -+ /* Ensure null-terminated for any debug msgs */ -+ u8 ssid[IW_ESSID_MAX_SIZE + 1]; -+ u8 ssid_len; -+ u8 rssi; //relative signal strength -+ u8 sq; //signal quality -+ -+ /* These are network statistics */ -+ //struct ieee80211_rx_stats stats; -+ u16 capability; -+ u16 aid; -+ u8 rates[MAX_RATES_LENGTH]; -+ u8 rates_len; -+ u8 rates_ex[MAX_RATES_EX_LENGTH]; -+ u8 rates_ex_len; -+ -+ u8 edca_parmsets[18]; -+ -+ u8 mode; -+ u8 flags; -+ u8 time_stamp[8]; -+ u16 beacon_interval; -+ u16 listen_interval; -+ u16 atim_window; -+ u8 wpa_ie[MAX_WPA_IE_LEN]; -+ size_t wpa_ie_len; -+ u8 rsn_ie[MAX_WPA_IE_LEN]; -+ size_t rsn_ie_len; -+ u8 country[6]; -+ u8 dtim_period; -+ u8 dtim_data; -+ u8 power_constraint; -+ u8 qosinfo; -+ u8 qbssload[5]; -+ u8 network_type; -+ int join_res; -+ unsigned long last_scanned; -+}; -+#endif -+/* -+join_res: -+-1: authentication fail -+-2: association fail -+> 0: TID -+*/ -+ -+enum ieee80211_state { -+ /* the card is not linked at all */ -+ IEEE80211_NOLINK = 0, -+ -+ /* IEEE80211_ASSOCIATING* are for BSS client mode -+ * the driver shall not perform RX filtering unless -+ * the state is LINKED. -+ * The driver shall just check for the state LINKED and -+ * defaults to NOLINK for ALL the other states (including -+ * LINKED_SCANNING) -+ */ -+ -+ /* the association procedure will start (wq scheduling)*/ -+ IEEE80211_ASSOCIATING, -+ IEEE80211_ASSOCIATING_RETRY, -+ -+ /* the association procedure is sending AUTH request*/ -+ IEEE80211_ASSOCIATING_AUTHENTICATING, -+ -+ /* the association procedure has successfully authentcated -+ * and is sending association request -+ */ -+ IEEE80211_ASSOCIATING_AUTHENTICATED, -+ -+ /* the link is ok. the card associated to a BSS or linked -+ * to a ibss cell or acting as an AP and creating the bss -+ */ -+ IEEE80211_LINKED, -+ -+ /* same as LINKED, but the driver shall apply RX filter -+ * rules as we are in NO_LINK mode. As the card is still -+ * logically linked, but it is doing a syncro site survey -+ * then it will be back to LINKED state. -+ */ -+ IEEE80211_LINKED_SCANNING, -+ -+}; -+ -+#define DEFAULT_MAX_SCAN_AGE (15 * HZ) -+#define DEFAULT_FTS 2346 -+#define MAC_FMT "%02x:%02x:%02x:%02x:%02x:%02x" -+#define MAC_ARG(x) ((u8*)(x))[0],((u8*)(x))[1],((u8*)(x))[2],((u8*)(x))[3],((u8*)(x))[4],((u8*)(x))[5] -+ -+extern __inline int is_multicast_mac_addr(const u8 *addr) -+{ -+ return ((addr[0] != 0xff) && (0x01 & addr[0])); -+} -+ -+extern __inline int is_broadcast_mac_addr(const u8 *addr) -+{ -+ return ((addr[0] == 0xff) && (addr[1] == 0xff) && (addr[2] == 0xff) && \ -+ (addr[3] == 0xff) && (addr[4] == 0xff) && (addr[5] == 0xff)); -+} -+ -+#define CFG_IEEE80211_RESERVE_FCS (1<<0) -+#define CFG_IEEE80211_COMPUTE_FCS (1<<1) -+ -+typedef struct tx_pending_t{ -+ int frag; -+ struct ieee80211_txb *txb; -+}tx_pending_t; -+ -+ -+ -+#define MAXTID 16 -+ -+#define IEEE_A (1<<0) -+#define IEEE_B (1<<1) -+#define IEEE_G (1<<2) -+#define IEEE_MODE_MASK (IEEE_A|IEEE_B|IEEE_G) -+ -+//Baron move to ieee80211.c -+int ieee80211_is_empty_essid(const char *essid, int essid_len); -+int ieee80211_get_hdrlen(u16 fc); -+ -+#if 0 -+/* Action frame categories (IEEE 802.11-2007, 7.3.1.11, Table 7-24) */ -+#define WLAN_ACTION_SPECTRUM_MGMT 0 -+#define WLAN_ACTION_QOS 1 -+#define WLAN_ACTION_DLS 2 -+#define WLAN_ACTION_BLOCK_ACK 3 -+#define WLAN_ACTION_RADIO_MEASUREMENT 5 -+#define WLAN_ACTION_FT 6 -+#define WLAN_ACTION_SA_QUERY 8 -+#define WLAN_ACTION_WMM 17 -+#endif -+ -+ -+/* Action category code */ -+enum rtw_ieee80211_category { -+ RTW_WLAN_CATEGORY_SPECTRUM_MGMT = 0, -+ RTW_WLAN_CATEGORY_QOS = 1, -+ RTW_WLAN_CATEGORY_DLS = 2, -+ RTW_WLAN_CATEGORY_BACK = 3, -+ RTW_WLAN_CATEGORY_PUBLIC = 4, //IEEE 802.11 public action frames -+ RTW_WLAN_CATEGORY_RADIO_MEASUREMENT = 5, -+ RTW_WLAN_CATEGORY_FT = 6, -+ RTW_WLAN_CATEGORY_HT = 7, -+ RTW_WLAN_CATEGORY_SA_QUERY = 8, -+ RTW_WLAN_CATEGORY_TDLS = 12, -+ RTW_WLAN_CATEGORY_WMM = 17, -+ RTW_WLAN_CATEGORY_P2P = 0x7f,//P2P action frames -+}; -+ -+/* SPECTRUM_MGMT action code */ -+enum rtw_ieee80211_spectrum_mgmt_actioncode { -+ RTW_WLAN_ACTION_SPCT_MSR_REQ = 0, -+ RTW_WLAN_ACTION_SPCT_MSR_RPRT = 1, -+ RTW_WLAN_ACTION_SPCT_TPC_REQ = 2, -+ RTW_WLAN_ACTION_SPCT_TPC_RPRT = 3, -+ RTW_WLAN_ACTION_SPCT_CHL_SWITCH = 4, -+ RTW_WLAN_ACTION_SPCT_EXT_CHL_SWITCH = 5, -+}; -+ -+enum _PUBLIC_ACTION{ -+ ACT_PUBLIC_BSSCOEXIST = 0, // 20/40 BSS Coexistence -+ ACT_PUBLIC_DSE_ENABLE = 1, -+ ACT_PUBLIC_DSE_DEENABLE = 2, -+ ACT_PUBLIC_DSE_REG_LOCATION = 3, -+ ACT_PUBLIC_EXT_CHL_SWITCH = 4, -+ ACT_PUBLIC_DSE_MSR_REQ = 5, -+ ACT_PUBLIC_DSE_MSR_RPRT = 6, -+ ACT_PUBLIC_MP = 7, // Measurement Pilot -+ ACT_PUBLIC_DSE_PWR_CONSTRAINT = 8, -+ ACT_PUBLIC_VENDOR = 9, // for WIFI_DIRECT -+ ACT_PUBLIC_GAS_INITIAL_REQ = 10, -+ ACT_PUBLIC_GAS_INITIAL_RSP = 11, -+ ACT_PUBLIC_GAS_COMEBACK_REQ = 12, -+ ACT_PUBLIC_GAS_COMEBACK_RSP = 13, -+ ACT_PUBLIC_TDLS_DISCOVERY_RSP = 14, -+ ACT_PUBLIC_LOCATION_TRACK = 15, -+ ACT_PUBLIC_MAX -+}; -+ -+#ifdef CONFIG_TDLS -+enum TDLS_ACTION_FIELD{ -+ TDLS_SETUP_REQUEST = 0, -+ TDLS_SETUP_RESPONSE = 1, -+ TDLS_SETUP_CONFIRM = 2, -+ TDLS_TEARDOWN = 3, -+ TDLS_PEER_TRAFFIC_INDICATION = 4, -+ TDLS_CHANNEL_SWITCH_REQUEST = 5, -+ TDLS_CHANNEL_SWITCH_RESPONSE = 6, -+ TDLS_PEER_PSM_REQUEST = 7, -+ TDLS_PEER_PSM_RESPONSE = 8, -+ TDLS_PEER_TRAFFIC_RESPONSE = 9, -+ TDLS_DISCOVERY_REQUEST = 10, -+ TDLS_DISCOVERY_RESPONSE = 14, //it's used in public action frame -+}; -+ -+#define TUNNELED_PROBE_REQ 15 -+#define TUNNELED_PROBE_RSP 16 -+#endif //CONFIG_TDLS -+ -+/* BACK action code */ -+enum rtw_ieee80211_back_actioncode { -+ RTW_WLAN_ACTION_ADDBA_REQ = 0, -+ RTW_WLAN_ACTION_ADDBA_RESP = 1, -+ RTW_WLAN_ACTION_DELBA = 2, -+}; -+ -+/* HT features action code */ -+enum rtw_ieee80211_ht_actioncode { -+ RTW_WLAN_ACTION_NOTIFY_CH_WIDTH = 0, -+ RTW_WLAN_ACTION_SM_PS = 1, -+ RTW_WLAN_ACTION_PSPM = 2, -+ RTW_WLAN_ACTION_PCO_PHASE = 3, -+ RTW_WLAN_ACTION_MIMO_CSI_MX = 4, -+ RTW_WLAN_ACTION_MIMO_NONCP_BF = 5, -+ RTW_WLAN_ACTION_MIMP_CP_BF = 6, -+ RTW_WLAN_ACTION_ASEL_INDICATES_FB = 7, -+ RTW_WLAN_ACTION_HI_INFO_EXCHG = 8, -+}; -+ -+/* BACK (block-ack) parties */ -+enum rtw_ieee80211_back_parties { -+ RTW_WLAN_BACK_RECIPIENT = 0, -+ RTW_WLAN_BACK_INITIATOR = 1, -+ RTW_WLAN_BACK_TIMER = 2, -+}; -+ -+ -+#define OUI_MICROSOFT 0x0050f2 /* Microsoft (also used in Wi-Fi specs) -+ * 00:50:F2 */ -+#define WME_OUI_TYPE 2 -+#define WME_OUI_SUBTYPE_INFORMATION_ELEMENT 0 -+#define WME_OUI_SUBTYPE_PARAMETER_ELEMENT 1 -+#define WME_OUI_SUBTYPE_TSPEC_ELEMENT 2 -+#define WME_VERSION 1 -+ -+#define WME_ACTION_CODE_SETUP_REQUEST 0 -+#define WME_ACTION_CODE_SETUP_RESPONSE 1 -+#define WME_ACTION_CODE_TEARDOWN 2 -+ -+#define WME_SETUP_RESPONSE_STATUS_ADMISSION_ACCEPTED 0 -+#define WME_SETUP_RESPONSE_STATUS_INVALID_PARAMETERS 1 -+#define WME_SETUP_RESPONSE_STATUS_REFUSED 3 -+ -+#define WME_TSPEC_DIRECTION_UPLINK 0 -+#define WME_TSPEC_DIRECTION_DOWNLINK 1 -+#define WME_TSPEC_DIRECTION_BI_DIRECTIONAL 3 -+ -+ -+#define OUI_BROADCOM 0x00904c /* Broadcom (Epigram) */ -+ -+#define VENDOR_HT_CAPAB_OUI_TYPE 0x33 /* 00-90-4c:0x33 */ -+ -+/** -+ * enum rtw_ieee80211_channel_flags - channel flags -+ * -+ * Channel flags set by the regulatory control code. -+ * -+ * @RTW_IEEE80211_CHAN_DISABLED: This channel is disabled. -+ * @RTW_IEEE80211_CHAN_PASSIVE_SCAN: Only passive scanning is permitted -+ * on this channel. -+ * @RTW_IEEE80211_CHAN_NO_IBSS: IBSS is not allowed on this channel. -+ * @RTW_IEEE80211_CHAN_RADAR: Radar detection is required on this channel. -+ * @RTW_IEEE80211_CHAN_NO_HT40PLUS: extension channel above this channel -+ * is not permitted. -+ * @RTW_IEEE80211_CHAN_NO_HT40MINUS: extension channel below this channel -+ * is not permitted. -+ */ -+ enum rtw_ieee80211_channel_flags { -+ RTW_IEEE80211_CHAN_DISABLED = 1<<0, -+ RTW_IEEE80211_CHAN_PASSIVE_SCAN = 1<<1, -+ RTW_IEEE80211_CHAN_NO_IBSS = 1<<2, -+ RTW_IEEE80211_CHAN_RADAR = 1<<3, -+ RTW_IEEE80211_CHAN_NO_HT40PLUS = 1<<4, -+ RTW_IEEE80211_CHAN_NO_HT40MINUS = 1<<5, -+ }; -+ -+ #define RTW_IEEE80211_CHAN_NO_HT40 \ -+ (RTW_IEEE80211_CHAN_NO_HT40PLUS | RTW_IEEE80211_CHAN_NO_HT40MINUS) -+ -+/* Represent channel details, subset of ieee80211_channel */ -+struct rtw_ieee80211_channel { -+ //enum ieee80211_band band; -+ //u16 center_freq; -+ u16 hw_value; -+ u32 flags; -+ //int max_antenna_gain; -+ //int max_power; -+ //int max_reg_power; -+ //bool beacon_found; -+ //u32 orig_flags; -+ //int orig_mag; -+ //int orig_mpwr; -+}; -+ -+#define CHAN_FMT \ -+ /*"band:%d, "*/ \ -+ /*"center_freq:%u, "*/ \ -+ "hw_value:%u, " \ -+ "flags:0x%08x" \ -+ /*"max_antenna_gain:%d\n"*/ \ -+ /*"max_power:%d\n"*/ \ -+ /*"max_reg_power:%d\n"*/ \ -+ /*"beacon_found:%u\n"*/ \ -+ /*"orig_flags:0x%08x\n"*/ \ -+ /*"orig_mag:%d\n"*/ \ -+ /*"orig_mpwr:%d\n"*/ -+ -+#define CHAN_ARG(channel) \ -+ /*(channel)->band*/ \ -+ /*, (channel)->center_freq*/ \ -+ (channel)->hw_value \ -+ , (channel)->flags \ -+ /*, (channel)->max_antenna_gain*/ \ -+ /*, (channel)->max_power*/ \ -+ /*, (channel)->max_reg_power*/ \ -+ /*, (channel)->beacon_found*/ \ -+ /*, (channel)->orig_flags*/ \ -+ /*, (channel)->orig_mag*/ \ -+ /*, (channel)->orig_mpwr*/ \ -+ -+/* Parsed Information Elements */ -+struct rtw_ieee802_11_elems { -+ u8 *ssid; -+ u8 ssid_len; -+ u8 *supp_rates; -+ u8 supp_rates_len; -+ u8 *fh_params; -+ u8 fh_params_len; -+ u8 *ds_params; -+ u8 ds_params_len; -+ u8 *cf_params; -+ u8 cf_params_len; -+ u8 *tim; -+ u8 tim_len; -+ u8 *ibss_params; -+ u8 ibss_params_len; -+ u8 *challenge; -+ u8 challenge_len; -+ u8 *erp_info; -+ u8 erp_info_len; -+ u8 *ext_supp_rates; -+ u8 ext_supp_rates_len; -+ u8 *wpa_ie; -+ u8 wpa_ie_len; -+ u8 *rsn_ie; -+ u8 rsn_ie_len; -+ u8 *wme; -+ u8 wme_len; -+ u8 *wme_tspec; -+ u8 wme_tspec_len; -+ u8 *wps_ie; -+ u8 wps_ie_len; -+ u8 *power_cap; -+ u8 power_cap_len; -+ u8 *supp_channels; -+ u8 supp_channels_len; -+ u8 *mdie; -+ u8 mdie_len; -+ u8 *ftie; -+ u8 ftie_len; -+ u8 *timeout_int; -+ u8 timeout_int_len; -+ u8 *ht_capabilities; -+ u8 ht_capabilities_len; -+ u8 *ht_operation; -+ u8 ht_operation_len; -+ u8 *vendor_ht_cap; -+ u8 vendor_ht_cap_len; -+ u8 *vht_capabilities; -+ u8 vht_capabilities_len; -+ u8 *vht_operation; -+ u8 vht_operation_len; -+ u8 *vht_op_mode_notify; -+ u8 vht_op_mode_notify_len; -+}; -+ -+typedef enum { ParseOK = 0, ParseUnknown = 1, ParseFailed = -1 } ParseRes; -+ -+ParseRes rtw_ieee802_11_parse_elems(u8 *start, uint len, -+ struct rtw_ieee802_11_elems *elems, -+ int show_errors); -+ -+u8 *rtw_set_fixed_ie(unsigned char *pbuf, unsigned int len, unsigned char *source, unsigned int *frlen); -+u8 *rtw_set_ie(u8 *pbuf, sint index, uint len, u8 *source, uint *frlen); -+ -+enum secondary_ch_offset { -+ SCN = 0, /* no secondary channel */ -+ SCA = 1, /* secondary channel above */ -+ SCB = 3, /* secondary channel below */ -+}; -+u8 secondary_ch_offset_to_hal_ch_offset(u8 ch_offset); -+u8 hal_ch_offset_to_secondary_ch_offset(u8 ch_offset); -+u8 *rtw_set_ie_ch_switch(u8 *buf, u32 *buf_len, u8 ch_switch_mode, u8 new_ch, u8 ch_switch_cnt); -+u8 *rtw_set_ie_secondary_ch_offset(u8 *buf, u32 *buf_len, u8 secondary_ch_offset); -+u8 *rtw_set_ie_mesh_ch_switch_parm(u8 *buf, u32 *buf_len, u8 ttl, u8 flags, u16 reason, u16 precedence); -+ -+u8 *rtw_get_ie(u8*pbuf, sint index, sint *len, sint limit); -+u8 *rtw_get_ie_ex(u8 *in_ie, uint in_len, u8 eid, u8 *oui, u8 oui_len, u8 *ie, uint *ielen); -+int rtw_ies_remove_ie(u8 *ies, uint *ies_len, uint offset, u8 eid, u8 *oui, u8 oui_len); -+ -+void rtw_set_supported_rate(u8* SupportedRates, uint mode) ; -+ -+unsigned char *rtw_get_wpa_ie(unsigned char *pie, int *wpa_ie_len, int limit); -+unsigned char *rtw_get_wpa2_ie(unsigned char *pie, int *rsn_ie_len, int limit); -+int rtw_get_wpa_cipher_suite(u8 *s); -+int rtw_get_wpa2_cipher_suite(u8 *s); -+int rtw_get_wapi_ie(u8 *in_ie,uint in_len,u8 *wapi_ie,u16 *wapi_len); -+int rtw_parse_wpa_ie(u8* wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x); -+int rtw_parse_wpa2_ie(u8* wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x); -+ -+int rtw_get_sec_ie(u8 *in_ie,uint in_len,u8 *rsn_ie,u16 *rsn_len,u8 *wpa_ie,u16 *wpa_len); -+ -+u8 rtw_is_wps_ie(u8 *ie_ptr, uint *wps_ielen); -+u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen); -+u8 *rtw_get_wps_attr(u8 *wps_ie, uint wps_ielen, u16 target_attr_id ,u8 *buf_attr, u32 *len_attr); -+u8 *rtw_get_wps_attr_content(u8 *wps_ie, uint wps_ielen, u16 target_attr_id ,u8 *buf_content, uint *len_content); -+ -+/** -+ * for_each_ie - iterate over continuous IEs -+ * @ie: -+ * @buf: -+ * @buf_len: -+ */ -+#define for_each_ie(ie, buf, buf_len) \ -+ for (ie = (void*)buf; (((u8*)ie) - ((u8*)buf) + 1) < buf_len; ie = (void*)(((u8*)ie) + *(((u8*)ie)+1) + 2)) -+ -+void dump_ies(u8 *buf, u32 buf_len); -+void dump_wps_ie(u8 *ie, u32 ie_len); -+ -+#ifdef CONFIG_P2P -+void dump_p2p_ie(u8 *ie, u32 ie_len); -+u8 *rtw_get_p2p_ie(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen); -+u8 *rtw_get_p2p_attr(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id ,u8 *buf_attr, u32 *len_attr); -+u8 *rtw_get_p2p_attr_content(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id ,u8 *buf_content, uint *len_content); -+u32 rtw_set_p2p_attr_content(u8 *pbuf, u8 attr_id, u16 attr_len, u8 *pdata_attr); -+void rtw_WLAN_BSSID_EX_remove_p2p_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id); -+#endif -+ -+#ifdef CONFIG_WFD -+int rtw_get_wfd_ie(u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen); -+int rtw_get_wfd_attr_content(u8 *wfd_ie, uint wfd_ielen, u8 target_attr_id ,u8 *attr_content, uint *attr_contentlen); -+#endif // CONFIG_WFD -+ -+uint rtw_get_rateset_len(u8 *rateset); -+ -+struct registry_priv; -+int rtw_generate_ie(struct registry_priv *pregistrypriv); -+ -+ -+int rtw_get_bit_value_from_ieee_value(u8 val); -+ -+uint rtw_is_cckrates_included(u8 *rate); -+ -+uint rtw_is_cckratesonly_included(u8 *rate); -+ -+int rtw_check_network_type(unsigned char *rate, int ratelen, int channel); -+ -+void rtw_get_bcn_info(struct wlan_network *pnetwork); -+ -+void rtw_macaddr_cfg(u8 *mac_addr); -+ -+u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI_20, u8 short_GI_40, unsigned char * MCS_rate); -+ -+int rtw_action_frame_parse(const u8 *frame, u32 frame_len, u8* category, u8 *action); -+const char *action_public_str(u8 action); -+ -+#endif /* IEEE80211_H */ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/if_ether.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/if_ether.h ---- linux-4.14.17/3rdparty/rtl8812au/include/if_ether.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/if_ether.h 2018-02-06 17:42:30.718967283 +0200 -@@ -0,0 +1,107 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef _LINUX_IF_ETHER_H -+#define _LINUX_IF_ETHER_H -+ -+/* -+ * IEEE 802.3 Ethernet magic constants. The frame sizes omit the preamble -+ * and FCS/CRC (frame check sequence). -+ */ -+ -+#define ETH_ALEN 6 /* Octets in one ethernet addr */ -+#define ETH_HLEN 14 /* Total octets in header. */ -+#define ETH_ZLEN 60 /* Min. octets in frame sans FCS */ -+#define ETH_DATA_LEN 1500 /* Max. octets in payload */ -+#define ETH_FRAME_LEN 1514 /* Max. octets in frame sans FCS */ -+ -+/* -+ * These are the defined Ethernet Protocol ID's. -+ */ -+ -+#define ETH_P_LOOP 0x0060 /* Ethernet Loopback packet */ -+#define ETH_P_PUP 0x0200 /* Xerox PUP packet */ -+#define ETH_P_PUPAT 0x0201 /* Xerox PUP Addr Trans packet */ -+#define ETH_P_IP 0x0800 /* Internet Protocol packet */ -+#define ETH_P_X25 0x0805 /* CCITT X.25 */ -+#define ETH_P_ARP 0x0806 /* Address Resolution packet */ -+#define ETH_P_BPQ 0x08FF /* G8BPQ AX.25 Ethernet Packet [ NOT AN OFFICIALLY REGISTERED ID ] */ -+#define ETH_P_IEEEPUP 0x0a00 /* Xerox IEEE802.3 PUP packet */ -+#define ETH_P_IEEEPUPAT 0x0a01 /* Xerox IEEE802.3 PUP Addr Trans packet */ -+#define ETH_P_DEC 0x6000 /* DEC Assigned proto */ -+#define ETH_P_DNA_DL 0x6001 /* DEC DNA Dump/Load */ -+#define ETH_P_DNA_RC 0x6002 /* DEC DNA Remote Console */ -+#define ETH_P_DNA_RT 0x6003 /* DEC DNA Routing */ -+#define ETH_P_LAT 0x6004 /* DEC LAT */ -+#define ETH_P_DIAG 0x6005 /* DEC Diagnostics */ -+#define ETH_P_CUST 0x6006 /* DEC Customer use */ -+#define ETH_P_SCA 0x6007 /* DEC Systems Comms Arch */ -+#define ETH_P_RARP 0x8035 /* Reverse Addr Res packet */ -+#define ETH_P_ATALK 0x809B /* Appletalk DDP */ -+#define ETH_P_AARP 0x80F3 /* Appletalk AARP */ -+#define ETH_P_8021Q 0x8100 /* 802.1Q VLAN Extended Header */ -+#define ETH_P_IPX 0x8137 /* IPX over DIX */ -+#define ETH_P_IPV6 0x86DD /* IPv6 over bluebook */ -+#define ETH_P_PPP_DISC 0x8863 /* PPPoE discovery messages */ -+#define ETH_P_PPP_SES 0x8864 /* PPPoE session messages */ -+#define ETH_P_ATMMPOA 0x884c /* MultiProtocol Over ATM */ -+#define ETH_P_ATMFATE 0x8884 /* Frame-based ATM Transport -+ * over Ethernet -+ */ -+ -+/* -+ * Non DIX types. Won't clash for 1500 types. -+ */ -+ -+#define ETH_P_802_3 0x0001 /* Dummy type for 802.3 frames */ -+#define ETH_P_AX25 0x0002 /* Dummy protocol id for AX.25 */ -+#define ETH_P_ALL 0x0003 /* Every packet (be careful!!!) */ -+#define ETH_P_802_2 0x0004 /* 802.2 frames */ -+#define ETH_P_SNAP 0x0005 /* Internal only */ -+#define ETH_P_DDCMP 0x0006 /* DEC DDCMP: Internal only */ -+#define ETH_P_WAN_PPP 0x0007 /* Dummy type for WAN PPP frames*/ -+#define ETH_P_PPP_MP 0x0008 /* Dummy type for PPP MP frames */ -+#define ETH_P_LOCALTALK 0x0009 /* Localtalk pseudo type */ -+#define ETH_P_PPPTALK 0x0010 /* Dummy type for Atalk over PPP*/ -+#define ETH_P_TR_802_2 0x0011 /* 802.2 frames */ -+#define ETH_P_MOBITEX 0x0015 /* Mobitex (kaz@cafe.net) */ -+#define ETH_P_CONTROL 0x0016 /* Card specific control frames */ -+#define ETH_P_IRDA 0x0017 /* Linux-IrDA */ -+#define ETH_P_ECONET 0x0018 /* Acorn Econet */ -+ -+/* -+ * This is an Ethernet frame header. -+ */ -+ -+struct ethhdr -+{ -+ unsigned char h_dest[ETH_ALEN]; /* destination eth addr */ -+ unsigned char h_source[ETH_ALEN]; /* source ether addr */ -+ unsigned short h_proto; /* packet type ID field */ -+}; -+ -+struct _vlan { -+ unsigned short h_vlan_TCI; // Encapsulates priority and VLAN ID -+ unsigned short h_vlan_encapsulated_proto; -+}; -+ -+ -+ -+#define get_vlan_id(pvlan) ((ntohs((unsigned short )pvlan->h_vlan_TCI)) & 0xfff) -+#define get_vlan_priority(pvlan) ((ntohs((unsigned short )pvlan->h_vlan_TCI))>>13) -+#define get_vlan_encap_proto(pvlan) (ntohs((unsigned short )pvlan->h_vlan_encapsulated_proto)) -+ -+ -+#endif /* _LINUX_IF_ETHER_H */ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/ioctl_cfg80211.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/ioctl_cfg80211.h ---- linux-4.14.17/3rdparty/rtl8812au/include/ioctl_cfg80211.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/ioctl_cfg80211.h 2018-02-06 17:42:30.718967283 +0200 -@@ -0,0 +1,132 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __IOCTL_CFG80211_H__ -+#define __IOCTL_CFG80211_H__ -+ -+ -+#if defined(RTW_USE_CFG80211_STA_EVENT) -+ #undef CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER -+#endif -+ -+struct rtw_wdev_invit_info { -+ u8 token; -+ u8 flags; -+ u8 status; -+ u8 req_op_ch; -+ u8 rsp_op_ch; -+}; -+ -+#define rtw_wdev_invit_info_init(invit_info) \ -+ do { \ -+ (invit_info)->token = 0; \ -+ (invit_info)->flags = 0x00; \ -+ (invit_info)->status = 0xff; \ -+ (invit_info)->req_op_ch = 0; \ -+ (invit_info)->rsp_op_ch = 0; \ -+ } while (0) -+ -+struct rtw_wdev_priv -+{ -+ struct wireless_dev *rtw_wdev; -+ -+ _adapter *padapter; -+ -+ struct cfg80211_scan_request *scan_request; -+ _lock scan_req_lock; -+ -+ struct net_device *pmon_ndev;//for monitor interface -+ char ifname_mon[IFNAMSIZ + 1]; //interface name for monitor interface -+ -+ u8 p2p_enabled; -+ -+ u8 provdisc_req_issued; -+ -+ struct rtw_wdev_invit_info invit_info; -+ -+ u8 bandroid_scan; -+ bool block; -+ bool power_mgmt; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_T ro_ch_to; -+ ATOMIC_T switch_ch_to; -+#endif -+ -+}; -+ -+#define wdev_to_priv(w) ((struct rtw_wdev_priv *)(wdev_priv(w))) -+ -+#define wiphy_to_adapter(x) (_adapter *)(((struct rtw_wdev_priv*)wiphy_priv(x))->padapter) -+ -+#define wiphy_to_wdev(x) (struct wireless_dev *)(((struct rtw_wdev_priv*)wiphy_priv(x))->rtw_wdev) -+ -+int rtw_wdev_alloc(_adapter *padapter, struct device *dev); -+void rtw_wdev_free(struct wireless_dev *wdev); -+void rtw_wdev_unregister(struct wireless_dev *wdev); -+ -+void rtw_cfg80211_init_wiphy(_adapter *padapter); -+ -+void rtw_cfg80211_surveydone_event_callback(_adapter *padapter); -+ -+void rtw_cfg80211_indicate_connect(_adapter *padapter); -+void rtw_cfg80211_indicate_disconnect(_adapter *padapter); -+void rtw_cfg80211_indicate_scan_done(struct rtw_wdev_priv *pwdev_priv, bool aborted); -+ -+#ifdef CONFIG_AP_MODE -+void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); -+void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, unsigned short reason); -+#endif //CONFIG_AP_MODE -+ -+void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, size_t len); -+void rtw_cfg80211_rx_p2p_action_public(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); -+void rtw_cfg80211_rx_action_p2p(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); -+void rtw_cfg80211_rx_action(_adapter *adapter, u8 *frame, uint frame_len, const char*msg); -+ -+int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, int type); -+ -+bool rtw_cfg80211_pwr_mgmt(_adapter *adapter); -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0)) && !defined(COMPAT_KERNEL_RELEASE) -+#define rtw_cfg80211_rx_mgmt(adapter, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt((adapter)->pnetdev, freq, buf, len, gfp) -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3,6,0)) -+#define rtw_cfg80211_rx_mgmt(adapter, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt((adapter)->pnetdev, freq, sig_dbm, buf, len, gfp) -+#else -+#define rtw_cfg80211_rx_mgmt(adapter, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt((adapter)->rtw_wdev, freq, sig_dbm, buf, len, gfp) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0)) && !defined(COMPAT_KERNEL_RELEASE) -+#define rtw_cfg80211_send_rx_assoc(adapter, bss, buf, len) cfg80211_send_rx_assoc((adapter)->pnetdev, buf, len) -+#else -+#define rtw_cfg80211_send_rx_assoc(adapter, bss, buf, len) cfg80211_send_rx_assoc((adapter)->pnetdev, bss, buf, len) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,6,0)) -+#define rtw_cfg80211_mgmt_tx_status(adapter, cookie, buf, len, ack, gfp) cfg80211_mgmt_tx_status((adapter)->pnetdev, cookie, buf, len, ack, gfp) -+#else -+#define rtw_cfg80211_mgmt_tx_status(adapter, cookie, buf, len, ack, gfp) cfg80211_mgmt_tx_status((adapter)->rtw_wdev, cookie, buf, len, ack, gfp) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,6,0)) -+#define rtw_cfg80211_ready_on_channel(adapter, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel((adapter)->pnetdev, cookie, chan, channel_type, duration, gfp) -+#define rtw_cfg80211_remain_on_channel_expired(adapter, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired((adapter)->pnetdev, cookie, chan, chan_type, gfp) -+#elif (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) -+#define rtw_cfg80211_ready_on_channel(adapter, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel((adapter)->rtw_wdev, cookie, chan, channel_type, duration, gfp) -+#define rtw_cfg80211_remain_on_channel_expired(adapter, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired((adapter)->rtw_wdev, cookie, chan, chan_type, gfp) -+#else -+#define rtw_cfg80211_ready_on_channel(adapter, cookie, chan, channel_type, duration, gfp) cfg80211_ready_on_channel((adapter)->rtw_wdev, cookie, chan, duration, gfp) -+#define rtw_cfg80211_remain_on_channel_expired(adapter, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired((adapter)->rtw_wdev, cookie, chan, gfp) -+#endif -+ -+#endif //__IOCTL_CFG80211_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/ip.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/ip.h ---- linux-4.14.17/3rdparty/rtl8812au/include/ip.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/ip.h 2018-02-06 17:42:30.718967283 +0200 -@@ -0,0 +1,130 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _LINUX_IP_H -+#define _LINUX_IP_H -+ -+/* SOL_IP socket options */ -+ -+#define IPTOS_TOS_MASK 0x1E -+#define IPTOS_TOS(tos) ((tos)&IPTOS_TOS_MASK) -+#define IPTOS_LOWDELAY 0x10 -+#define IPTOS_THROUGHPUT 0x08 -+#define IPTOS_RELIABILITY 0x04 -+#define IPTOS_MINCOST 0x02 -+ -+#define IPTOS_PREC_MASK 0xE0 -+#define IPTOS_PREC(tos) ((tos)&IPTOS_PREC_MASK) -+#define IPTOS_PREC_NETCONTROL 0xe0 -+#define IPTOS_PREC_INTERNETCONTROL 0xc0 -+#define IPTOS_PREC_CRITIC_ECP 0xa0 -+#define IPTOS_PREC_FLASHOVERRIDE 0x80 -+#define IPTOS_PREC_FLASH 0x60 -+#define IPTOS_PREC_IMMEDIATE 0x40 -+#define IPTOS_PREC_PRIORITY 0x20 -+#define IPTOS_PREC_ROUTINE 0x00 -+ -+ -+/* IP options */ -+#define IPOPT_COPY 0x80 -+#define IPOPT_CLASS_MASK 0x60 -+#define IPOPT_NUMBER_MASK 0x1f -+ -+#define IPOPT_COPIED(o) ((o)&IPOPT_COPY) -+#define IPOPT_CLASS(o) ((o)&IPOPT_CLASS_MASK) -+#define IPOPT_NUMBER(o) ((o)&IPOPT_NUMBER_MASK) -+ -+#define IPOPT_CONTROL 0x00 -+#define IPOPT_RESERVED1 0x20 -+#define IPOPT_MEASUREMENT 0x40 -+#define IPOPT_RESERVED2 0x60 -+ -+#define IPOPT_END (0 |IPOPT_CONTROL) -+#define IPOPT_NOOP (1 |IPOPT_CONTROL) -+#define IPOPT_SEC (2 |IPOPT_CONTROL|IPOPT_COPY) -+#define IPOPT_LSRR (3 |IPOPT_CONTROL|IPOPT_COPY) -+#define IPOPT_TIMESTAMP (4 |IPOPT_MEASUREMENT) -+#define IPOPT_RR (7 |IPOPT_CONTROL) -+#define IPOPT_SID (8 |IPOPT_CONTROL|IPOPT_COPY) -+#define IPOPT_SSRR (9 |IPOPT_CONTROL|IPOPT_COPY) -+#define IPOPT_RA (20|IPOPT_CONTROL|IPOPT_COPY) -+ -+#define IPVERSION 4 -+#define MAXTTL 255 -+#define IPDEFTTL 64 -+ -+/* struct timestamp, struct route and MAX_ROUTES are removed. -+ -+ REASONS: it is clear that nobody used them because: -+ - MAX_ROUTES value was wrong. -+ - "struct route" was wrong. -+ - "struct timestamp" had fatally misaligned bitfields and was completely unusable. -+ */ -+ -+#define IPOPT_OPTVAL 0 -+#define IPOPT_OLEN 1 -+#define IPOPT_OFFSET 2 -+#define IPOPT_MINOFF 4 -+#define MAX_IPOPTLEN 40 -+#define IPOPT_NOP IPOPT_NOOP -+#define IPOPT_EOL IPOPT_END -+#define IPOPT_TS IPOPT_TIMESTAMP -+ -+#define IPOPT_TS_TSONLY 0 /* timestamps only */ -+#define IPOPT_TS_TSANDADDR 1 /* timestamps and addresses */ -+#define IPOPT_TS_PRESPEC 3 /* specified modules only */ -+ -+struct ip_options { -+ __u32 faddr; /* Saved first hop address */ -+ unsigned char optlen; -+ unsigned char srr; -+ unsigned char rr; -+ unsigned char ts; -+ unsigned char is_setbyuser:1, /* Set by setsockopt? */ -+ is_data:1, /* Options in __data, rather than skb */ -+ is_strictroute:1, /* Strict source route */ -+ srr_is_hit:1, /* Packet destination addr was our one */ -+ is_changed:1, /* IP checksum more not valid */ -+ rr_needaddr:1, /* Need to record addr of outgoing dev */ -+ ts_needtime:1, /* Need to record timestamp */ -+ ts_needaddr:1; /* Need to record addr of outgoing dev */ -+ unsigned char router_alert; -+ unsigned char __pad1; -+ unsigned char __pad2; -+ unsigned char __data[0]; -+}; -+ -+#define optlength(opt) (sizeof(struct ip_options) + opt->optlen) -+ -+struct iphdr { -+#if defined(__LITTLE_ENDIAN) -+ __u8 ihl:4, -+ version:4; -+#else -+ __u8 version:4, -+ ihl:4; -+#endif -+ __u8 tos; -+ __u16 tot_len; -+ __u16 id; -+ __u16 frag_off; -+ __u8 ttl; -+ __u8 protocol; -+ __u16 check; -+ __u32 saddr; -+ __u32 daddr; -+ /*The options start here. */ -+}; -+ -+#endif /* _LINUX_IP_H */ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/linux/wireless.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/linux/wireless.h ---- linux-4.14.17/3rdparty/rtl8812au/include/linux/wireless.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/linux/wireless.h 2018-02-06 17:42:30.718967283 +0200 -@@ -0,0 +1,86 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef _LINUX_WIRELESS_H -+#define _LINUX_WIRELESS_H -+ -+/***************************** INCLUDES *****************************/ -+ -+#if 0 -+#include /* for __u* and __s* typedefs */ -+#include /* for "struct sockaddr" et al */ -+#include /* for IFNAMSIZ and co... */ -+#else -+#define __user -+//typedef uint16_t __u16; -+#include /* for "struct sockaddr" et al */ -+#include /* for IFNAMSIZ and co... */ -+#endif -+ -+/****************************** TYPES ******************************/ -+ -+/* --------------------------- SUBTYPES --------------------------- */ -+/* -+ * For all data larger than 16 octets, we need to use a -+ * pointer to memory allocated in user space. -+ */ -+struct iw_point -+{ -+ void __user *pointer; /* Pointer to the data (in user space) */ -+ __u16 length; /* number of fields or size in bytes */ -+ __u16 flags; /* Optional params */ -+}; -+ -+ -+/* ------------------------ IOCTL REQUEST ------------------------ */ -+/* -+ * This structure defines the payload of an ioctl, and is used -+ * below. -+ * -+ * Note that this structure should fit on the memory footprint -+ * of iwreq (which is the same as ifreq), which mean a max size of -+ * 16 octets = 128 bits. Warning, pointers might be 64 bits wide... -+ * You should check this when increasing the structures defined -+ * above in this file... -+ */ -+union iwreq_data -+{ -+ /* Config - generic */ -+ char name[IFNAMSIZ]; -+ /* Name : used to verify the presence of wireless extensions. -+ * Name of the protocol/provider... */ -+ -+ struct iw_point data; /* Other large parameters */ -+}; -+ -+/* -+ * The structure to exchange data for ioctl. -+ * This structure is the same as 'struct ifreq', but (re)defined for -+ * convenience... -+ * Do I need to remind you about structure size (32 octets) ? -+ */ -+struct iwreq -+{ -+ union -+ { -+ char ifrn_name[IFNAMSIZ]; /* if name, e.g. "eth0" */ -+ } ifr_ifrn; -+ -+ /* Data part (defined just above) */ -+ union iwreq_data u; -+}; -+ -+#endif /* _LINUX_WIRELESS_H */ -+ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/mlme_osdep.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/mlme_osdep.h ---- linux-4.14.17/3rdparty/rtl8812au/include/mlme_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/mlme_osdep.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,28 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __MLME_OSDEP_H_ -+#define __MLME_OSDEP_H_ -+ -+extern void rtw_init_mlme_timer(_adapter *padapter); -+extern void rtw_os_indicate_disconnect( _adapter *adapter ); -+extern void rtw_os_indicate_connect( _adapter *adapter ); -+void rtw_os_indicate_scan_done( _adapter *padapter, bool aborted); -+extern void rtw_report_sec_ie(_adapter *adapter,u8 authmode,u8 *sec_ie); -+ -+void rtw_reset_securitypriv( _adapter *adapter ); -+ -+u8 rtw_handle_tkip_countermeasure(_adapter* padapter); -+ -+#endif //_MLME_OSDEP_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/mp_custom_oid.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/mp_custom_oid.h ---- linux-4.14.17/3rdparty/rtl8812au/include/mp_custom_oid.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/mp_custom_oid.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,348 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __CUSTOM_OID_H -+#define __CUSTOM_OID_H -+ -+// by Owen -+// 0xFF818000 - 0xFF81802F RTL8180 Mass Production Kit -+// 0xFF818500 - 0xFF81850F RTL8185 Setup Utility -+// 0xFF818580 - 0xFF81858F RTL8185 Phy Status Utility -+ -+// -+ -+// by Owen for Production Kit -+// For Production Kit with Agilent Equipments -+// in order to make our custom oids hopefully somewhat unique -+// we will use 0xFF (indicating implementation specific OID) -+// 81(first byte of non zero Realtek unique identifier) -+// 80 (second byte of non zero Realtek unique identifier) -+// XX (the custom OID number - providing 255 possible custom oids) -+ -+#define OID_RT_PRO_RESET_DUT 0xFF818000 -+#define OID_RT_PRO_SET_DATA_RATE 0xFF818001 -+#define OID_RT_PRO_START_TEST 0xFF818002 -+#define OID_RT_PRO_STOP_TEST 0xFF818003 -+#define OID_RT_PRO_SET_PREAMBLE 0xFF818004 -+#define OID_RT_PRO_SET_SCRAMBLER 0xFF818005 -+#define OID_RT_PRO_SET_FILTER_BB 0xFF818006 -+#define OID_RT_PRO_SET_MANUAL_DIVERSITY_BB 0xFF818007 -+#define OID_RT_PRO_SET_CHANNEL_DIRECT_CALL 0xFF818008 -+#define OID_RT_PRO_SET_SLEEP_MODE_DIRECT_CALL 0xFF818009 -+#define OID_RT_PRO_SET_WAKE_MODE_DIRECT_CALL 0xFF81800A -+ -+#define OID_RT_PRO_SET_TX_ANTENNA_BB 0xFF81800D -+#define OID_RT_PRO_SET_ANTENNA_BB 0xFF81800E -+#define OID_RT_PRO_SET_CR_SCRAMBLER 0xFF81800F -+#define OID_RT_PRO_SET_CR_NEW_FILTER 0xFF818010 -+#define OID_RT_PRO_SET_TX_POWER_CONTROL 0xFF818011 -+#define OID_RT_PRO_SET_CR_TX_CONFIG 0xFF818012 -+#define OID_RT_PRO_GET_TX_POWER_CONTROL 0xFF818013 -+#define OID_RT_PRO_GET_CR_SIGNAL_QUALITY 0xFF818014 -+#define OID_RT_PRO_SET_CR_SETPOINT 0xFF818015 -+#define OID_RT_PRO_SET_INTEGRATOR 0xFF818016 -+#define OID_RT_PRO_SET_SIGNAL_QUALITY 0xFF818017 -+#define OID_RT_PRO_GET_INTEGRATOR 0xFF818018 -+#define OID_RT_PRO_GET_SIGNAL_QUALITY 0xFF818019 -+#define OID_RT_PRO_QUERY_EEPROM_TYPE 0xFF81801A -+#define OID_RT_PRO_WRITE_MAC_ADDRESS 0xFF81801B -+#define OID_RT_PRO_READ_MAC_ADDRESS 0xFF81801C -+#define OID_RT_PRO_WRITE_CIS_DATA 0xFF81801D -+#define OID_RT_PRO_READ_CIS_DATA 0xFF81801E -+#define OID_RT_PRO_WRITE_POWER_CONTROL 0xFF81801F -+#define OID_RT_PRO_READ_POWER_CONTROL 0xFF818020 -+#define OID_RT_PRO_WRITE_EEPROM 0xFF818021 -+#define OID_RT_PRO_READ_EEPROM 0xFF818022 -+#define OID_RT_PRO_RESET_TX_PACKET_SENT 0xFF818023 -+#define OID_RT_PRO_QUERY_TX_PACKET_SENT 0xFF818024 -+#define OID_RT_PRO_RESET_RX_PACKET_RECEIVED 0xFF818025 -+#define OID_RT_PRO_QUERY_RX_PACKET_RECEIVED 0xFF818026 -+#define OID_RT_PRO_QUERY_RX_PACKET_CRC32_ERROR 0xFF818027 -+#define OID_RT_PRO_QUERY_CURRENT_ADDRESS 0xFF818028 -+#define OID_RT_PRO_QUERY_PERMANENT_ADDRESS 0xFF818029 -+#define OID_RT_PRO_SET_PHILIPS_RF_PARAMETERS 0xFF81802A -+#define OID_RT_PRO_RECEIVE_PACKET 0xFF81802C -+// added by Owen on 04/08/03 for Cameo's request -+#define OID_RT_PRO_WRITE_EEPROM_BYTE 0xFF81802D -+#define OID_RT_PRO_READ_EEPROM_BYTE 0xFF81802E -+#define OID_RT_PRO_SET_MODULATION 0xFF81802F -+// -+ -+//Sean -+#define OID_RT_DRIVER_OPTION 0xFF818080 -+#define OID_RT_RF_OFF 0xFF818081 -+#define OID_RT_AUTH_STATUS 0xFF818082 -+ -+//======================================================================== -+#define OID_RT_PRO_SET_CONTINUOUS_TX 0xFF81800B -+#define OID_RT_PRO_SET_SINGLE_CARRIER_TX 0xFF81800C -+#define OID_RT_PRO_SET_CARRIER_SUPPRESSION_TX 0xFF81802B -+#define OID_RT_PRO_SET_SINGLE_TONE_TX 0xFF818043 -+//======================================================================== -+ -+ -+// by Owen for RTL8185 Phy Status Report Utility -+#define OID_RT_UTILITYfalse_ALARM_COUNTERS 0xFF818580 -+#define OID_RT_UTILITY_SELECT_DEBUG_MODE 0xFF818581 -+#define OID_RT_UTILITY_SELECT_SUBCARRIER_NUMBER 0xFF818582 -+#define OID_RT_UTILITY_GET_RSSI_STATUS 0xFF818583 -+#define OID_RT_UTILITY_GET_FRAME_DETECTION_STATUS 0xFF818584 -+#define OID_RT_UTILITY_GET_AGC_AND_FREQUENCY_OFFSET_ESTIMATION_STATUS 0xFF818585 -+#define OID_RT_UTILITY_GET_CHANNEL_ESTIMATION_STATUS 0xFF818586 -+// -+ -+// by Owen on 03/09/19-03/09/22 for RTL8185 -+#define OID_RT_WIRELESS_MODE 0xFF818500 -+#define OID_RT_SUPPORTED_RATES 0xFF818501 -+#define OID_RT_DESIRED_RATES 0xFF818502 -+#define OID_RT_WIRELESS_MODE_STARTING_ADHOC 0xFF818503 -+// -+ -+#define OID_RT_GET_CONNECT_STATE 0xFF030001 -+#define OID_RT_RESCAN 0xFF030002 -+#define OID_RT_SET_KEY_LENGTH 0xFF030003 -+#define OID_RT_SET_DEFAULT_KEY_ID 0xFF030004 -+ -+#define OID_RT_SET_CHANNEL 0xFF010182 -+#define OID_RT_SET_SNIFFER_MODE 0xFF010183 -+#define OID_RT_GET_SIGNAL_QUALITY 0xFF010184 -+#define OID_RT_GET_SMALL_PACKET_CRC 0xFF010185 -+#define OID_RT_GET_MIDDLE_PACKET_CRC 0xFF010186 -+#define OID_RT_GET_LARGE_PACKET_CRC 0xFF010187 -+#define OID_RT_GET_TX_RETRY 0xFF010188 -+#define OID_RT_GET_RX_RETRY 0xFF010189 -+#define OID_RT_PRO_SET_FW_DIG_STATE 0xFF01018A//S -+#define OID_RT_PRO_SET_FW_RA_STATE 0xFF01018B//S -+ -+#define OID_RT_GET_RX_TOTAL_PACKET 0xFF010190 -+#define OID_RT_GET_TX_BEACON_OK 0xFF010191 -+#define OID_RT_GET_TX_BEACON_ERR 0xFF010192 -+#define OID_RT_GET_RX_ICV_ERR 0xFF010193 -+#define OID_RT_SET_ENCRYPTION_ALGORITHM 0xFF010194 -+#define OID_RT_SET_NO_AUTO_RESCAN 0xFF010195 -+#define OID_RT_GET_PREAMBLE_MODE 0xFF010196 -+#define OID_RT_GET_DRIVER_UP_DELTA_TIME 0xFF010197 -+#define OID_RT_GET_AP_IP 0xFF010198 -+#define OID_RT_GET_CHANNELPLAN 0xFF010199 -+#define OID_RT_SET_PREAMBLE_MODE 0xFF01019A -+#define OID_RT_SET_BCN_INTVL 0xFF01019B -+#define OID_RT_GET_RF_VENDER 0xFF01019C -+#define OID_RT_DEDICATE_PROBE 0xFF01019D -+#define OID_RT_PRO_RX_FILTER_PATTERN 0xFF01019E -+ -+#define OID_RT_GET_DCST_CURRENT_THRESHOLD 0xFF01019F -+ -+#define OID_RT_GET_CCA_ERR 0xFF0101A0 -+#define OID_RT_GET_CCA_UPGRADE_THRESHOLD 0xFF0101A1 -+#define OID_RT_GET_CCA_FALLBACK_THRESHOLD 0xFF0101A2 -+ -+#define OID_RT_GET_CCA_UPGRADE_EVALUATE_TIMES 0xFF0101A3 -+#define OID_RT_GET_CCA_FALLBACK_EVALUATE_TIMES 0xFF0101A4 -+ -+// by Owen on 03/31/03 for Cameo's request -+#define OID_RT_SET_RATE_ADAPTIVE 0xFF0101A5 -+// -+#define OID_RT_GET_DCST_EVALUATE_PERIOD 0xFF0101A5 -+#define OID_RT_GET_DCST_TIME_UNIT_INDEX 0xFF0101A6 -+#define OID_RT_GET_TOTAL_TX_BYTES 0xFF0101A7 -+#define OID_RT_GET_TOTAL_RX_BYTES 0xFF0101A8 -+#define OID_RT_CURRENT_TX_POWER_LEVEL 0xFF0101A9 -+#define OID_RT_GET_ENC_KEY_MISMATCH_COUNT 0xFF0101AA -+#define OID_RT_GET_ENC_KEY_MATCH_COUNT 0xFF0101AB -+#define OID_RT_GET_CHANNEL 0xFF0101AC -+ -+#define OID_RT_SET_CHANNELPLAN 0xFF0101AD -+#define OID_RT_GET_HARDWARE_RADIO_OFF 0xFF0101AE -+#define OID_RT_CHANNELPLAN_BY_COUNTRY 0xFF0101AF -+#define OID_RT_SCAN_AVAILABLE_BSSID 0xFF0101B0 -+#define OID_RT_GET_HARDWARE_VERSION 0xFF0101B1 -+#define OID_RT_GET_IS_ROAMING 0xFF0101B2 -+#define OID_RT_GET_IS_PRIVACY 0xFF0101B3 -+#define OID_RT_GET_KEY_MISMATCH 0xFF0101B4 -+#define OID_RT_SET_RSSI_ROAM_TRAFFIC_TH 0xFF0101B5 -+#define OID_RT_SET_RSSI_ROAM_SIGNAL_TH 0xFF0101B6 -+#define OID_RT_RESET_LOG 0xFF0101B7 -+#define OID_RT_GET_LOG 0xFF0101B8 -+#define OID_RT_SET_INDICATE_HIDDEN_AP 0xFF0101B9 -+#define OID_RT_GET_HEADER_FAIL 0xFF0101BA -+#define OID_RT_SUPPORTED_WIRELESS_MODE 0xFF0101BB -+#define OID_RT_GET_CHANNEL_LIST 0xFF0101BC -+#define OID_RT_GET_SCAN_IN_PROGRESS 0xFF0101BD -+#define OID_RT_GET_TX_INFO 0xFF0101BE -+#define OID_RT_RF_READ_WRITE_OFFSET 0xFF0101BF -+#define OID_RT_RF_READ_WRITE 0xFF0101C0 -+ -+// For Netgear request. 2005.01.13, by rcnjko. -+#define OID_RT_FORCED_DATA_RATE 0xFF0101C1 -+#define OID_RT_WIRELESS_MODE_FOR_SCAN_LIST 0xFF0101C2 -+// For Netgear request. 2005.02.17, by rcnjko. -+#define OID_RT_GET_BSS_WIRELESS_MODE 0xFF0101C3 -+// For AZ project. 2005.06.27, by rcnjko. -+#define OID_RT_SCAN_WITH_MAGIC_PACKET 0xFF0101C4 -+ -+// Vincent 8185MP -+#define OID_RT_PRO_RX_FILTER 0xFF0111C0 -+ -+//Andy TEST -+//#define OID_RT_PRO_WRITE_REGISTRY 0xFF0111C1 -+//#define OID_RT_PRO_READ_REGISTRY 0xFF0111C2 -+#define OID_CE_USB_WRITE_REGISTRY 0xFF0111C1 -+#define OID_CE_USB_READ_REGISTRY 0xFF0111C2 -+ -+ -+#define OID_RT_PRO_SET_INITIAL_GAIN 0xFF0111C3 -+#define OID_RT_PRO_SET_BB_RF_STANDBY_MODE 0xFF0111C4 -+#define OID_RT_PRO_SET_BB_RF_SHUTDOWN_MODE 0xFF0111C5 -+#define OID_RT_PRO_SET_TX_CHARGE_PUMP 0xFF0111C6 -+#define OID_RT_PRO_SET_RX_CHARGE_PUMP 0xFF0111C7 -+#define OID_RT_PRO_RF_WRITE_REGISTRY 0xFF0111C8 -+#define OID_RT_PRO_RF_READ_REGISTRY 0xFF0111C9 -+#define OID_RT_PRO_QUERY_RF_TYPE 0xFF0111CA -+ -+// AP OID -+#define OID_RT_AP_GET_ASSOCIATED_STATION_LIST 0xFF010300 -+#define OID_RT_AP_GET_CURRENT_TIME_STAMP 0xFF010301 -+#define OID_RT_AP_SWITCH_INTO_AP_MODE 0xFF010302 -+#define OID_RT_AP_SET_DTIM_PERIOD 0xFF010303 -+#define OID_RT_AP_SUPPORTED 0xFF010304 // Determine if driver supports AP mode. 2004.08.27, by rcnjko. -+#define OID_RT_AP_SET_PASSPHRASE 0xFF010305 // Set WPA-PSK passphrase into authenticator. 2005.07.08, byrcnjko. -+ -+// 8187MP. 2004.09.06, by rcnjko. -+#define OID_RT_PRO8187_WI_POLL 0xFF818780 -+#define OID_RT_PRO_WRITE_BB_REG 0xFF818781 -+#define OID_RT_PRO_READ_BB_REG 0xFF818782 -+#define OID_RT_PRO_WRITE_RF_REG 0xFF818783 -+#define OID_RT_PRO_READ_RF_REG 0xFF818784 -+ -+// Meeting House. added by Annie, 2005-07-20. -+#define OID_RT_MH_VENDER_ID 0xFFEDC100 -+ -+//8711 MP OID added 20051230. -+#define OID_RT_PRO8711_JOIN_BSS 0xFF871100//S -+ -+#define OID_RT_PRO_READ_REGISTER 0xFF871101 //Q -+#define OID_RT_PRO_WRITE_REGISTER 0xFF871102 //S -+ -+#define OID_RT_PRO_BURST_READ_REGISTER 0xFF871103 //Q -+#define OID_RT_PRO_BURST_WRITE_REGISTER 0xFF871104 //S -+ -+#define OID_RT_PRO_WRITE_TXCMD 0xFF871105 //S -+ -+#define OID_RT_PRO_READ16_EEPROM 0xFF871106 //Q -+#define OID_RT_PRO_WRITE16_EEPROM 0xFF871107 //S -+ -+#define OID_RT_PRO_H2C_SET_COMMAND 0xFF871108 //S -+#define OID_RT_PRO_H2C_QUERY_RESULT 0xFF871109 //Q -+ -+#define OID_RT_PRO8711_WI_POLL 0xFF87110A //Q -+#define OID_RT_PRO8711_PKT_LOSS 0xFF87110B //Q -+#define OID_RT_RD_ATTRIB_MEM 0xFF87110C//Q -+#define OID_RT_WR_ATTRIB_MEM 0xFF87110D//S -+ -+ -+//Method 2 for H2C/C2H -+#define OID_RT_PRO_H2C_CMD_MODE 0xFF871110 //S -+#define OID_RT_PRO_H2C_CMD_RSP_MODE 0xFF871111 //Q -+#define OID_RT_PRO_H2C_CMD_EVENT_MODE 0xFF871112 //S -+#define OID_RT_PRO_WAIT_C2H_EVENT 0xFF871113 //Q -+#define OID_RT_PRO_RW_ACCESS_PROTOCOL_TEST 0xFF871114//Q -+ -+#define OID_RT_PRO_SCSI_ACCESS_TEST 0xFF871115 //Q, S -+ -+#define OID_RT_PRO_SCSI_TCPIPOFFLOAD_OUT 0xFF871116 //S -+#define OID_RT_PRO_SCSI_TCPIPOFFLOAD_IN 0xFF871117 //Q,S -+#define OID_RT_RRO_RX_PKT_VIA_IOCTRL 0xFF871118 //Q -+#define OID_RT_RRO_RX_PKTARRAY_VIA_IOCTRL 0xFF871119 //Q -+ -+#define OID_RT_RPO_SET_PWRMGT_TEST 0xFF87111A //S -+#define OID_RT_PRO_QRY_PWRMGT_TEST 0XFF87111B //Q -+#define OID_RT_RPO_ASYNC_RWIO_TEST 0xFF87111C //S -+#define OID_RT_RPO_ASYNC_RWIO_POLL 0xFF87111D //Q -+#define OID_RT_PRO_SET_RF_INTFS 0xFF87111E //S -+#define OID_RT_POLL_RX_STATUS 0xFF87111F //Q -+ -+#define OID_RT_PRO_CFG_DEBUG_MESSAGE 0xFF871120 //Q,S -+#define OID_RT_PRO_SET_DATA_RATE_EX 0xFF871121//S -+#define OID_RT_PRO_SET_BASIC_RATE 0xFF871122//S -+#define OID_RT_PRO_READ_TSSI 0xFF871123//S -+#define OID_RT_PRO_SET_POWER_TRACKING 0xFF871124//S -+ -+ -+#define OID_RT_PRO_QRY_PWRSTATE 0xFF871150 //Q -+#define OID_RT_PRO_SET_PWRSTATE 0xFF871151 //S -+ -+//Method 2 , using workitem -+#define OID_RT_SET_READ_REG 0xFF871181 //S -+#define OID_RT_SET_WRITE_REG 0xFF871182 //S -+#define OID_RT_SET_BURST_READ_REG 0xFF871183 //S -+#define OID_RT_SET_BURST_WRITE_REG 0xFF871184 //S -+#define OID_RT_SET_WRITE_TXCMD 0xFF871185 //S -+#define OID_RT_SET_READ16_EEPROM 0xFF871186 //S -+#define OID_RT_SET_WRITE16_EEPROM 0xFF871187 //S -+#define OID_RT_QRY_POLL_WKITEM 0xFF871188 //Q -+ -+//For SDIO INTERFACE only -+#define OID_RT_PRO_SYNCPAGERW_SRAM 0xFF8711A0 //Q, S -+#define OID_RT_PRO_871X_DRV_EXT 0xFF8711A1 -+ -+//For USB INTERFACE only -+#define OID_RT_PRO_USB_VENDOR_REQ 0xFF8711B0 //Q, S -+#define OID_RT_PRO_SCSI_AUTO_TEST 0xFF8711B1 //S -+#define OID_RT_PRO_USB_MAC_AC_FIFO_WRITE 0xFF8711B2 //S -+#define OID_RT_PRO_USB_MAC_RX_FIFO_READ 0xFF8711B3 //Q -+#define OID_RT_PRO_USB_MAC_RX_FIFO_POLLING 0xFF8711B4 //Q -+ -+#define OID_RT_PRO_H2C_SET_RATE_TABLE 0xFF8711FB //S -+#define OID_RT_PRO_H2C_GET_RATE_TABLE 0xFF8711FC //S -+#define OID_RT_PRO_H2C_C2H_LBK_TEST 0xFF8711FE -+ -+#define OID_RT_PRO_ENCRYPTION_CTRL 0xFF871200 //Q, S -+#define OID_RT_PRO_ADD_STA_INFO 0xFF871201 //S -+#define OID_RT_PRO_DELE_STA_INFO 0xFF871202 //S -+#define OID_RT_PRO_QUERY_DR_VARIABLE 0xFF871203 //Q -+ -+#define OID_RT_PRO_RX_PACKET_TYPE 0xFF871204 //Q, S -+ -+#define OID_RT_PRO_READ_EFUSE 0xFF871205 //Q -+#define OID_RT_PRO_WRITE_EFUSE 0xFF871206 //S -+#define OID_RT_PRO_RW_EFUSE_PGPKT 0xFF871207 //Q, S -+#define OID_RT_GET_EFUSE_CURRENT_SIZE 0xFF871208 //Q -+ -+#define OID_RT_SET_BANDWIDTH 0xFF871209 //S -+#define OID_RT_SET_CRYSTAL_CAP 0xFF87120A //S -+ -+#define OID_RT_SET_RX_PACKET_TYPE 0xFF87120B //S -+ -+#define OID_RT_GET_EFUSE_MAX_SIZE 0xFF87120C //Q -+ -+#define OID_RT_PRO_SET_TX_AGC_OFFSET 0xFF87120D //S -+ -+#define OID_RT_PRO_SET_PKT_TEST_MODE 0xFF87120E //S -+ -+#define OID_RT_PRO_FOR_EVM_TEST_SETTING 0xFF87120F //S -+ -+#define OID_RT_PRO_GET_THERMAL_METER 0xFF871210 //Q -+ -+#define OID_RT_RESET_PHY_RX_PACKET_COUNT 0xFF871211 //S -+#define OID_RT_GET_PHY_RX_PACKET_RECEIVED 0xFF871212 //Q -+#define OID_RT_GET_PHY_RX_PACKET_CRC32_ERROR 0xFF871213 //Q -+ -+#define OID_RT_SET_POWER_DOWN 0xFF871214 //S -+ -+#define OID_RT_GET_POWER_MODE 0xFF871215 //Q -+ -+#define OID_RT_PRO_EFUSE 0xFF871216 //Q, S -+#define OID_RT_PRO_EFUSE_MAP 0xFF871217 //Q, S -+ -+#endif //#ifndef __CUSTOM_OID_H -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/nic_spec.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/nic_spec.h ---- linux-4.14.17/3rdparty/rtl8812au/include/nic_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/nic_spec.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef __NIC_SPEC_H__ -+#define __NIC_SPEC_H__ -+ -+#include -+ -+#define RTL8711_MCTRL_ (0x20000) -+#define RTL8711_UART_ (0x30000) -+#define RTL8711_TIMER_ (0x40000) -+#define RTL8711_FINT_ (0x50000) -+#define RTL8711_HINT_ (0x50000) -+#define RTL8711_GPIO_ (0x60000) -+#define RTL8711_WLANCTRL_ (0x200000) -+#define RTL8711_WLANFF_ (0xe00000) -+#define RTL8711_HCICTRL_ (0x600000) -+#define RTL8711_SYSCFG_ (0x620000) -+#define RTL8711_SYSCTRL_ (0x620000) -+#define RTL8711_MCCTRL_ (0x020000) -+ -+ -+#include -+ -+#include -+ -+ -+#endif // __RTL8711_SPEC_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/osdep_intf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_intf.h ---- linux-4.14.17/3rdparty/rtl8812au/include/osdep_intf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_intf.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,111 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __OSDEP_INTF_H_ -+#define __OSDEP_INTF_H_ -+ -+ -+struct intf_priv { -+ -+ u8 *intf_dev; -+ u32 max_iosz; //USB2.0: 128, USB1.1: 64, SDIO:64 -+ u32 max_xmitsz; //USB2.0: unlimited, SDIO:512 -+ u32 max_recvsz; //USB2.0: unlimited, SDIO:512 -+ -+ volatile u8 *io_rwmem; -+ volatile u8 *allocated_io_rwmem; -+ u32 io_wsz; //unit: 4bytes -+ u32 io_rsz;//unit: 4bytes -+ u8 intf_status; -+ -+ void (*_bus_io)(u8 *priv); -+ -+/* -+Under Sync. IRP (SDIO/USB) -+A protection mechanism is necessary for the io_rwmem(read/write protocol) -+ -+Under Async. IRP (SDIO/USB) -+The protection mechanism is through the pending queue. -+*/ -+ -+ _mutex ioctl_mutex; -+ -+ // when in USB, IO is through interrupt in/out endpoints -+ struct usb_device *udev; -+ PURB piorw_urb; -+ u8 io_irp_cnt; -+ u8 bio_irp_pending; -+ _sema io_retevt; -+ _timer io_timer; -+ u8 bio_irp_timeout; -+ u8 bio_timer_cancel; -+}; -+ -+#ifdef CONFIG_R871X_TEST -+int rtw_start_pseudo_adhoc(_adapter *padapter); -+int rtw_stop_pseudo_adhoc(_adapter *padapter); -+#endif -+ -+u8 rtw_init_drv_sw(_adapter *padapter); -+u8 rtw_free_drv_sw(_adapter *padapter); -+u8 rtw_reset_drv_sw(_adapter *padapter); -+ -+u32 rtw_start_drv_threads(_adapter *padapter); -+void rtw_stop_drv_threads (_adapter *padapter); -+#ifdef CONFIG_WOWLAN -+void rtw_cancel_dynamic_chk_timer(_adapter *padapter); -+#endif -+void rtw_cancel_all_timer(_adapter *padapter); -+ -+int rtw_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); -+ -+int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname); -+struct net_device *rtw_init_netdev(_adapter *padapter); -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+u16 rtw_recv_select_queue(struct sk_buff *skb); -+#endif //LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35) -+ -+#ifdef CONFIG_PROC_DEBUG -+void rtw_proc_init_one(struct net_device *dev); -+void rtw_proc_remove_one(struct net_device *dev); -+#else //!CONFIG_PROC_DEBUG -+static void rtw_proc_init_one(struct net_device *dev){} -+static void rtw_proc_remove_one(struct net_device *dev){} -+#endif //!CONFIG_PROC_DEBUG -+ -+void rtw_ips_dev_unload(_adapter *padapter); -+#ifdef CONFIG_IPS -+int rtw_ips_pwr_up(_adapter *padapter); -+void rtw_ips_pwr_down(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+struct _io_ops; -+_adapter *rtw_drv_if2_init(_adapter *primary_padapter, void (*set_intf_ops)(_adapter *primary_padapter,struct _io_ops *pops)); -+void rtw_drv_if2_free(_adapter *if2); -+void rtw_drv_if2_stop(_adapter *if2); -+#ifdef CONFIG_MULTI_VIR_IFACES -+struct dvobj_priv; -+_adapter *rtw_drv_add_vir_if(_adapter *primary_padapter, void (*set_intf_ops)(_adapter *primary_padapter,struct _io_ops *pops)); -+void rtw_drv_stop_vir_ifaces(struct dvobj_priv *dvobj); -+void rtw_drv_free_vir_ifaces(struct dvobj_priv *dvobj); -+#endif //CONFIG_MULTI_VIR_IFACES -+#endif -+ -+int rtw_drv_register_netdev(_adapter *padapter); -+void rtw_ndev_destructor(_nic_hdl ndev); -+ -+#endif //_OSDEP_INTF_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/osdep_service_bsd.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service_bsd.h ---- linux-4.14.17/3rdparty/rtl8812au/include/osdep_service_bsd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service_bsd.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,742 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __OSDEP_BSD_SERVICE_H_ -+#define __OSDEP_BSD_SERVICE_H_ -+ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+ -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include "usbdevs.h" -+ -+#define USB_DEBUG_VAR rum_debug -+#include -+ -+#if 1 //Baron porting from linux, it's all temp solution, needs to check again -+#include -+#include /* XXX for PCPU_GET */ -+// typedef struct semaphore _sema; -+ typedef struct sema _sema; -+// typedef spinlock_t _lock; -+ typedef struct mtx _lock; -+ typedef struct mtx _mutex; -+ typedef struct timer_list _timer; -+ struct list_head { -+ struct list_head *next, *prev; -+ }; -+ struct __queue { -+ struct list_head queue; -+ _lock lock; -+ }; -+ -+ //typedef struct sk_buff _pkt; -+ typedef struct mbuf _pkt; -+ typedef struct mbuf _buffer; -+ -+ typedef struct __queue _queue; -+ typedef struct list_head _list; -+ typedef int _OS_STATUS; -+ //typedef u32 _irqL; -+ typedef unsigned long _irqL; -+ typedef struct ifnet * _nic_hdl; -+ -+ typedef pid_t _thread_hdl_; -+// typedef struct thread _thread_hdl_; -+ typedef void thread_return; -+ typedef void* thread_context; -+ -+ //#define thread_exit() complete_and_exit(NULL, 0) -+ -+ #define thread_exit() do{printf("%s", "RTKTHREAD_exit");}while(0) -+ -+ typedef void timer_hdl_return; -+ typedef void* timer_hdl_context; -+ typedef struct work_struct _workitem; -+ -+#define KERNEL_VERSION(a,b,c) (((a) << 16) + ((b) << 8) + (c)) -+/* emulate a modern version */ -+#define LINUX_VERSION_CODE KERNEL_VERSION(2, 6, 35) -+ -+#define WIRELESS_EXT -1 -+#define HZ hz -+#define spin_lock_irqsave mtx_lock_irqsave -+#define spin_lock_bh mtx_lock_irqsave -+#define mtx_lock_irqsave(lock, x) mtx_lock(lock)//{local_irq_save((x)); mtx_lock_spin((lock));} -+//#define IFT_RTW 0xf9 //ifnet allocate type for RTW -+#define free_netdev if_free -+#define LIST_CONTAINOR(ptr, type, member) \ -+ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) -+#define container_of(p,t,n) (t*)((p)-&(((t*)0)->n)) -+/* -+ * Linux timers are emulated using FreeBSD callout functions -+ * (and taskqueue functionality). -+ * -+ * Currently no timer stats functionality. -+ * -+ * See (linux_compat) processes.c -+ * -+ */ -+struct timer_list { -+ -+ /* FreeBSD callout related fields */ -+ struct callout callout; -+ -+ //timeout function -+ void (*function)(void*); -+ //argument -+ void *arg; -+ -+}; -+struct workqueue_struct; -+struct work_struct; -+typedef void (*work_func_t)(struct work_struct *work); -+/* Values for the state of an item of work (work_struct) */ -+typedef enum work_state { -+ WORK_STATE_UNSET = 0, -+ WORK_STATE_CALLOUT_PENDING = 1, -+ WORK_STATE_TASK_PENDING = 2, -+ WORK_STATE_WORK_CANCELLED = 3 -+} work_state_t; -+ -+struct work_struct { -+ struct task task; /* FreeBSD task */ -+ work_state_t state; /* the pending or otherwise state of work. */ -+ work_func_t func; -+}; -+#define spin_unlock_irqrestore mtx_unlock_irqrestore -+#define spin_unlock_bh mtx_unlock_irqrestore -+#define mtx_unlock_irqrestore(lock,x) mtx_unlock(lock); -+extern void _rtw_spinlock_init(_lock *plock); -+ -+//modify private structure to match freebsd -+#define BITS_PER_LONG 32 -+union ktime { -+ s64 tv64; -+#if BITS_PER_LONG != 64 && !defined(CONFIG_KTIME_SCALAR) -+ struct { -+#ifdef __BIG_ENDIAN -+ s32 sec, nsec; -+#else -+ s32 nsec, sec; -+#endif -+ } tv; -+#endif -+}; -+#define kmemcheck_bitfield_begin(name) -+#define kmemcheck_bitfield_end(name) -+#define CHECKSUM_NONE 0 -+typedef unsigned char *sk_buff_data_t; -+typedef union ktime ktime_t; /* Kill this */ -+ -+void rtw_mtx_lock(_lock *plock); -+ -+void rtw_mtx_unlock(_lock *plock); -+ -+/** -+ * struct sk_buff - socket buffer -+ * @next: Next buffer in list -+ * @prev: Previous buffer in list -+ * @sk: Socket we are owned by -+ * @tstamp: Time we arrived -+ * @dev: Device we arrived on/are leaving by -+ * @transport_header: Transport layer header -+ * @network_header: Network layer header -+ * @mac_header: Link layer header -+ * @_skb_refdst: destination entry (with norefcount bit) -+ * @sp: the security path, used for xfrm -+ * @cb: Control buffer. Free for use by every layer. Put private vars here -+ * @len: Length of actual data -+ * @data_len: Data length -+ * @mac_len: Length of link layer header -+ * @hdr_len: writable header length of cloned skb -+ * @csum: Checksum (must include start/offset pair) -+ * @csum_start: Offset from skb->head where checksumming should start -+ * @csum_offset: Offset from csum_start where checksum should be stored -+ * @local_df: allow local fragmentation -+ * @cloned: Head may be cloned (check refcnt to be sure) -+ * @nohdr: Payload reference only, must not modify header -+ * @pkt_type: Packet class -+ * @fclone: skbuff clone status -+ * @ip_summed: Driver fed us an IP checksum -+ * @priority: Packet queueing priority -+ * @users: User count - see {datagram,tcp}.c -+ * @protocol: Packet protocol from driver -+ * @truesize: Buffer size -+ * @head: Head of buffer -+ * @data: Data head pointer -+ * @tail: Tail pointer -+ * @end: End pointer -+ * @destructor: Destruct function -+ * @mark: Generic packet mark -+ * @nfct: Associated connection, if any -+ * @ipvs_property: skbuff is owned by ipvs -+ * @peeked: this packet has been seen already, so stats have been -+ * done for it, don't do them again -+ * @nf_trace: netfilter packet trace flag -+ * @nfctinfo: Relationship of this skb to the connection -+ * @nfct_reasm: netfilter conntrack re-assembly pointer -+ * @nf_bridge: Saved data about a bridged frame - see br_netfilter.c -+ * @skb_iif: ifindex of device we arrived on -+ * @rxhash: the packet hash computed on receive -+ * @queue_mapping: Queue mapping for multiqueue devices -+ * @tc_index: Traffic control index -+ * @tc_verd: traffic control verdict -+ * @ndisc_nodetype: router type (from link layer) -+ * @dma_cookie: a cookie to one of several possible DMA operations -+ * done by skb DMA functions -+ * @secmark: security marking -+ * @vlan_tci: vlan tag control information -+ */ -+ -+struct sk_buff { -+ /* These two members must be first. */ -+ struct sk_buff *next; -+ struct sk_buff *prev; -+ -+ ktime_t tstamp; -+ -+ struct sock *sk; -+ //struct net_device *dev; -+ struct ifnet *dev; -+ -+ /* -+ * This is the control buffer. It is free to use for every -+ * layer. Please put your private variables there. If you -+ * want to keep them across layers you have to do a skb_clone() -+ * first. This is owned by whoever has the skb queued ATM. -+ */ -+ char cb[48] __aligned(8); -+ -+ unsigned long _skb_refdst; -+#ifdef CONFIG_XFRM -+ struct sec_path *sp; -+#endif -+ unsigned int len, -+ data_len; -+ u16 mac_len, -+ hdr_len; -+ union { -+ u32 csum; -+ struct { -+ u16 csum_start; -+ u16 csum_offset; -+ }smbol2; -+ }smbol1; -+ u32 priority; -+ kmemcheck_bitfield_begin(flags1); -+ u8 local_df:1, -+ cloned:1, -+ ip_summed:2, -+ nohdr:1, -+ nfctinfo:3; -+ u8 pkt_type:3, -+ fclone:2, -+ ipvs_property:1, -+ peeked:1, -+ nf_trace:1; -+ kmemcheck_bitfield_end(flags1); -+ u16 protocol; -+ -+ void (*destructor)(struct sk_buff *skb); -+#if defined(CONFIG_NF_CONNTRACK) || defined(CONFIG_NF_CONNTRACK_MODULE) -+ struct nf_conntrack *nfct; -+ struct sk_buff *nfct_reasm; -+#endif -+#ifdef CONFIG_BRIDGE_NETFILTER -+ struct nf_bridge_info *nf_bridge; -+#endif -+ -+ int skb_iif; -+#ifdef CONFIG_NET_SCHED -+ u16 tc_index; /* traffic control index */ -+#ifdef CONFIG_NET_CLS_ACT -+ u16 tc_verd; /* traffic control verdict */ -+#endif -+#endif -+ -+ u32 rxhash; -+ -+ kmemcheck_bitfield_begin(flags2); -+ u16 queue_mapping:16; -+#ifdef CONFIG_IPV6_NDISC_NODETYPE -+ u8 ndisc_nodetype:2, -+ deliver_no_wcard:1; -+#else -+ u8 deliver_no_wcard:1; -+#endif -+ kmemcheck_bitfield_end(flags2); -+ -+ /* 0/14 bit hole */ -+ -+#ifdef CONFIG_NET_DMA -+ dma_cookie_t dma_cookie; -+#endif -+#ifdef CONFIG_NETWORK_SECMARK -+ u32 secmark; -+#endif -+ union { -+ u32 mark; -+ u32 dropcount; -+ }symbol3; -+ -+ u16 vlan_tci; -+ -+ sk_buff_data_t transport_header; -+ sk_buff_data_t network_header; -+ sk_buff_data_t mac_header; -+ /* These elements must be at the end, see alloc_skb() for details. */ -+ sk_buff_data_t tail; -+ sk_buff_data_t end; -+ unsigned char *head, -+ *data; -+ unsigned int truesize; -+ atomic_t users; -+}; -+struct sk_buff_head { -+ /* These two members must be first. */ -+ struct sk_buff *next; -+ struct sk_buff *prev; -+ -+ u32 qlen; -+ _lock lock; -+}; -+#define skb_tail_pointer(skb) skb->tail -+static inline unsigned char *skb_put(struct sk_buff *skb, unsigned int len) -+{ -+ unsigned char *tmp = skb_tail_pointer(skb); -+ //SKB_LINEAR_ASSERT(skb); -+ skb->tail += len; -+ skb->len += len; -+ return tmp; -+} -+ -+static inline unsigned char *__skb_pull(struct sk_buff *skb, unsigned int len) -+{ -+ skb->len -= len; -+ if(skb->len < skb->data_len) -+ printf("%s(),%d,error!\n",__FUNCTION__,__LINE__); -+ return skb->data += len; -+} -+static inline unsigned char *skb_pull(struct sk_buff *skb, unsigned int len) -+{ -+ return unlikely(len > skb->len) ? NULL : __skb_pull(skb, len); -+} -+static inline u32 skb_queue_len(const struct sk_buff_head *list_) -+{ -+ return list_->qlen; -+} -+static inline void __skb_insert(struct sk_buff *newsk, -+ struct sk_buff *prev, struct sk_buff *next, -+ struct sk_buff_head *list) -+{ -+ newsk->next = next; -+ newsk->prev = prev; -+ next->prev = prev->next = newsk; -+ list->qlen++; -+} -+static inline void __skb_queue_before(struct sk_buff_head *list, -+ struct sk_buff *next, -+ struct sk_buff *newsk) -+{ -+ __skb_insert(newsk, next->prev, next, list); -+} -+static inline void skb_queue_tail(struct sk_buff_head *list, -+ struct sk_buff *newsk) -+{ -+ mtx_lock(&list->lock); -+ __skb_queue_before(list, (struct sk_buff *)list, newsk); -+ mtx_unlock(&list->lock); -+} -+static inline struct sk_buff *skb_peek(struct sk_buff_head *list_) -+{ -+ struct sk_buff *list = ((struct sk_buff *)list_)->next; -+ if (list == (struct sk_buff *)list_) -+ list = NULL; -+ return list; -+} -+static inline void __skb_unlink(struct sk_buff *skb, struct sk_buff_head *list) -+{ -+ struct sk_buff *next, *prev; -+ -+ list->qlen--; -+ next = skb->next; -+ prev = skb->prev; -+ skb->next = skb->prev = NULL; -+ next->prev = prev; -+ prev->next = next; -+} -+ -+static inline struct sk_buff *skb_dequeue(struct sk_buff_head *list) -+{ -+ mtx_lock(&list->lock); -+ -+ struct sk_buff *skb = skb_peek(list); -+ if (skb) -+ __skb_unlink(skb, list); -+ -+ mtx_unlock(&list->lock); -+ -+ return skb; -+} -+static inline void skb_reserve(struct sk_buff *skb, int len) -+{ -+ skb->data += len; -+ skb->tail += len; -+} -+static inline void __skb_queue_head_init(struct sk_buff_head *list) -+{ -+ list->prev = list->next = (struct sk_buff *)list; -+ list->qlen = 0; -+} -+/* -+ * This function creates a split out lock class for each invocation; -+ * this is needed for now since a whole lot of users of the skb-queue -+ * infrastructure in drivers have different locking usage (in hardirq) -+ * than the networking core (in softirq only). In the long run either the -+ * network layer or drivers should need annotation to consolidate the -+ * main types of usage into 3 classes. -+ */ -+static inline void skb_queue_head_init(struct sk_buff_head *list) -+{ -+ _rtw_spinlock_init(&list->lock); -+ __skb_queue_head_init(list); -+} -+unsigned long copy_from_user(void *to, const void *from, unsigned long n); -+unsigned long copy_to_user(void *to, const void *from, unsigned long n); -+struct sk_buff * dev_alloc_skb(unsigned int size); -+struct sk_buff *skb_clone(const struct sk_buff *skb); -+void dev_kfree_skb_any(struct sk_buff *skb); -+#endif //Baron porting from linux, it's all temp solution, needs to check again -+ -+ -+#if 1 // kenny add Linux compatibility code for Linux USB driver -+#include -+ -+#define __init // __attribute ((constructor)) -+#define __exit // __attribute ((destructor)) -+ -+/* -+ * Definitions for module_init and module_exit macros. -+ * -+ * These macros will use the SYSINIT framework to call a specified -+ * function (with no arguments) on module loading or unloading. -+ * -+ */ -+ -+void module_init_exit_wrapper(void *arg); -+ -+#define module_init(initfn) \ -+ SYSINIT(mod_init_ ## initfn, \ -+ SI_SUB_KLD, SI_ORDER_FIRST, \ -+ module_init_exit_wrapper, initfn) -+ -+#define module_exit(exitfn) \ -+ SYSUNINIT(mod_exit_ ## exitfn, \ -+ SI_SUB_KLD, SI_ORDER_ANY, \ -+ module_init_exit_wrapper, exitfn) -+ -+/* -+ * The usb_register and usb_deregister functions are used to register -+ * usb drivers with the usb subsystem. -+ */ -+int usb_register(struct usb_driver *driver); -+int usb_deregister(struct usb_driver *driver); -+ -+/* -+ * usb_get_dev and usb_put_dev - increment/decrement the reference count -+ * of the usb device structure. -+ * -+ * Original body of usb_get_dev: -+ * -+ * if (dev) -+ * get_device(&dev->dev); -+ * return dev; -+ * -+ * Reference counts are not currently used in this compatibility -+ * layer. So these functions will do nothing. -+ */ -+static inline struct usb_device * -+usb_get_dev(struct usb_device *dev) -+{ -+ return dev; -+} -+ -+static inline void -+usb_put_dev(struct usb_device *dev) -+{ -+ return; -+} -+ -+ -+// rtw_usb_compat_linux -+int rtw_usb_submit_urb(struct urb *urb, uint16_t mem_flags); -+int rtw_usb_unlink_urb(struct urb *urb); -+int rtw_usb_clear_halt(struct usb_device *dev, struct usb_host_endpoint *uhe); -+int rtw_usb_control_msg(struct usb_device *dev, struct usb_host_endpoint *uhe, -+ uint8_t request, uint8_t requesttype, -+ uint16_t value, uint16_t index, void *data, -+ uint16_t size, usb_timeout_t timeout); -+int rtw_usb_set_interface(struct usb_device *dev, uint8_t iface_no, uint8_t alt_index); -+int rtw_usb_setup_endpoint(struct usb_device *dev, -+ struct usb_host_endpoint *uhe, usb_size_t bufsize); -+struct urb *rtw_usb_alloc_urb(uint16_t iso_packets, uint16_t mem_flags); -+struct usb_host_endpoint *rtw_usb_find_host_endpoint(struct usb_device *dev, uint8_t type, uint8_t ep); -+struct usb_host_interface *rtw_usb_altnum_to_altsetting(const struct usb_interface *intf, uint8_t alt_index); -+struct usb_interface *rtw_usb_ifnum_to_if(struct usb_device *dev, uint8_t iface_no); -+void *rtw_usb_buffer_alloc(struct usb_device *dev, usb_size_t size, uint8_t *dma_addr); -+void *rtw_usbd_get_intfdata(struct usb_interface *intf); -+void rtw_usb_linux_register(void *arg); -+void rtw_usb_linux_deregister(void *arg); -+void rtw_usb_linux_free_device(struct usb_device *dev); -+void rtw_usb_buffer_free(struct usb_device *dev, usb_size_t size, -+ void *addr, uint8_t dma_addr); -+void rtw_usb_free_urb(struct urb *urb); -+void rtw_usb_init_urb(struct urb *urb); -+void rtw_usb_kill_urb(struct urb *urb); -+void rtw_usb_set_intfdata(struct usb_interface *intf, void *data); -+void rtw_usb_fill_bulk_urb(struct urb *urb, struct usb_device *udev, -+ struct usb_host_endpoint *uhe, void *buf, -+ int length, usb_complete_t callback, void *arg); -+int rtw_usb_bulk_msg(struct usb_device *udev, struct usb_host_endpoint *uhe, -+ void *data, int len, uint16_t *pactlen, usb_timeout_t timeout); -+void *usb_get_intfdata(struct usb_interface *intf); -+int usb_linux_init_endpoints(struct usb_device *udev); -+ -+ -+ -+typedef struct urb * PURB; -+ -+typedef unsigned gfp_t; -+#define __GFP_WAIT ((gfp_t)0x10u) /* Can wait and reschedule? */ -+#define __GFP_HIGH ((gfp_t)0x20u) /* Should access emergency pools? */ -+#define __GFP_IO ((gfp_t)0x40u) /* Can start physical IO? */ -+#define __GFP_FS ((gfp_t)0x80u) /* Can call down to low-level FS? */ -+#define __GFP_COLD ((gfp_t)0x100u) /* Cache-cold page required */ -+#define __GFP_NOWARN ((gfp_t)0x200u) /* Suppress page allocation failure warning */ -+#define __GFP_REPEAT ((gfp_t)0x400u) /* Retry the allocation. Might fail */ -+#define __GFP_NOFAIL ((gfp_t)0x800u) /* Retry for ever. Cannot fail */ -+#define __GFP_NORETRY ((gfp_t)0x1000u)/* Do not retry. Might fail */ -+#define __GFP_NO_GROW ((gfp_t)0x2000u)/* Slab internal usage */ -+#define __GFP_COMP ((gfp_t)0x4000u)/* Add compound page metadata */ -+#define __GFP_ZERO ((gfp_t)0x8000u)/* Return zeroed page on success */ -+#define __GFP_NOMEMALLOC ((gfp_t)0x10000u) /* Don't use emergency reserves */ -+#define __GFP_HARDWALL ((gfp_t)0x20000u) /* Enforce hardwall cpuset memory allocs */ -+ -+/* This equals 0, but use constants in case they ever change */ -+#define GFP_NOWAIT (GFP_ATOMIC & ~__GFP_HIGH) -+/* GFP_ATOMIC means both !wait (__GFP_WAIT not set) and use emergency pool */ -+#define GFP_ATOMIC (__GFP_HIGH) -+#define GFP_NOIO (__GFP_WAIT) -+#define GFP_NOFS (__GFP_WAIT | __GFP_IO) -+#define GFP_KERNEL (__GFP_WAIT | __GFP_IO | __GFP_FS) -+#define GFP_USER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL) -+#define GFP_HIGHUSER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL | \ -+ __GFP_HIGHMEM) -+ -+ -+#endif // kenny add Linux compatibility code for Linux USB -+ -+__inline static _list *get_next(_list *list) -+{ -+ return list->next; -+} -+ -+__inline static _list *get_list_head(_queue *queue) -+{ -+ return (&(queue->queue)); -+} -+ -+ -+#define LIST_CONTAINOR(ptr, type, member) \ -+ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) -+ -+ -+__inline static void _enter_critical(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_irqsave(plock, *pirqL); -+} -+ -+__inline static void _exit_critical(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_irqrestore(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_irqsave(plock, *pirqL); -+} -+ -+__inline static void _exit_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_irqrestore(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_bh(plock, *pirqL); -+} -+ -+__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_bh(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ -+ mtx_lock(pmutex); -+ -+} -+ -+ -+__inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ -+ mtx_unlock(pmutex); -+ -+} -+static inline void __list_del(struct list_head * prev, struct list_head * next) -+{ -+ next->prev = prev; -+ prev->next = next; -+} -+static inline void INIT_LIST_HEAD(struct list_head *list) -+{ -+ list->next = list; -+ list->prev = list; -+} -+__inline static void rtw_list_delete(_list *plist) -+{ -+ __list_del(plist->prev, plist->next); -+ INIT_LIST_HEAD(plist); -+} -+ -+__inline static void _init_timer(_timer *ptimer,_nic_hdl padapter,void *pfunc,void* cntx) -+{ -+ ptimer->function = pfunc; -+ ptimer->arg = cntx; -+ callout_init(&ptimer->callout, CALLOUT_MPSAFE); -+} -+ -+__inline static void _set_timer(_timer *ptimer,u32 delay_time) -+{ -+ // mod_timer(ptimer , (jiffies+(delay_time*HZ/1000))); -+ if(ptimer->function && ptimer->arg){ -+ rtw_mtx_lock(NULL); -+ callout_reset(&ptimer->callout, delay_time,ptimer->function, ptimer->arg); -+ rtw_mtx_unlock(NULL); -+ } -+} -+ -+__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -+{ -+ // del_timer_sync(ptimer); -+ // *bcancelled= true;//TRUE ==1; FALSE==0 -+ rtw_mtx_lock(NULL); -+ callout_drain(&ptimer->callout); -+ rtw_mtx_unlock(NULL); -+} -+ -+__inline static void _init_workitem(_workitem *pwork, void *pfunc, void * cntx) -+{ -+ printf("%s Not implement yet! \n",__FUNCTION__); -+} -+ -+__inline static void _set_workitem(_workitem *pwork) -+{ -+ printf("%s Not implement yet! \n",__FUNCTION__); -+// schedule_work(pwork); -+} -+ -+// -+// Global Mutex: can only be used at PASSIVE level. -+// -+ -+#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+} -+ -+#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+} -+ -+#define ATOMIC_INIT(i) { (i) } -+ -+static __inline void thread_enter(char *name); -+ -+//Atomic integer operations -+typedef uint32_t ATOMIC_T ; -+ -+#define rtw_netdev_priv(netdev) (((struct ifnet *)netdev)->if_softc) -+ -+#define rtw_free_netdev(netdev) if_free((netdev)) -+ -+#define NDEV_FMT "%s" -+#define NDEV_ARG(ndev) "" -+#define ADPT_FMT "%s" -+#define ADPT_ARG(adapter) "" -+#define FUNC_NDEV_FMT "%s" -+#define FUNC_NDEV_ARG(ndev) __func__ -+#define FUNC_ADPT_FMT "%s" -+#define FUNC_ADPT_ARG(adapter) __func__ -+ -+#define STRUCT_PACKED -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/osdep_service_ce.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service_ce.h ---- linux-4.14.17/3rdparty/rtl8812au/include/osdep_service_ce.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service_ce.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,180 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __OSDEP_CE_SERVICE_H_ -+#define __OSDEP_CE_SERVICE_H_ -+ -+ -+#include -+#include -+ -+#include -+ -+typedef HANDLE _sema; -+typedef LIST_ENTRY _list; -+typedef uint _OS_STATUS; -+ -+typedef NDIS_SPIN_LOCK _lock; -+ -+typedef HANDLE _rwlock; //Mutex -+ -+typedef u32 _irqL; -+ -+typedef NDIS_HANDLE _nic_hdl; -+ -+ -+typedef NDIS_MINIPORT_TIMER _timer; -+ -+struct __queue { -+ LIST_ENTRY queue; -+ _lock lock; -+}; -+ -+typedef NDIS_PACKET _pkt; -+typedef NDIS_BUFFER _buffer; -+typedef struct __queue _queue; -+ -+typedef HANDLE _thread_hdl_; -+typedef DWORD thread_return; -+typedef void* thread_context; -+typedef NDIS_WORK_ITEM _workitem; -+ -+#define thread_exit() ExitThread(STATUS_SUCCESS); return 0; -+ -+ -+#define SEMA_UPBND (0x7FFFFFFF) //8192 -+ -+__inline static _list *get_prev(_list *list) -+{ -+ return list->Blink; -+} -+ -+__inline static _list *get_next(_list *list) -+{ -+ return list->Flink; -+} -+ -+__inline static _list *get_list_head(_queue *queue) -+{ -+ return (&(queue->queue)); -+} -+ -+#define LIST_CONTAINOR(ptr, type, member) CONTAINING_RECORD(ptr, type, member) -+ -+__inline static void _enter_critical(_lock *plock, _irqL *pirqL) -+{ -+ NdisAcquireSpinLock(plock); -+} -+ -+__inline static void _exit_critical(_lock *plock, _irqL *pirqL) -+{ -+ NdisReleaseSpinLock(plock); -+} -+ -+__inline static _enter_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprAcquireSpinLock(plock); -+} -+ -+__inline static _exit_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ NdisDprReleaseSpinLock(plock); -+} -+ -+ -+__inline static void _enter_hwio_critical(_rwlock *prwlock, _irqL *pirqL) -+{ -+ WaitForSingleObject(*prwlock, INFINITE ); -+ -+} -+ -+__inline static void _exit_hwio_critical(_rwlock *prwlock, _irqL *pirqL) -+{ -+ ReleaseMutex(*prwlock); -+} -+ -+__inline static void rtw_list_delete(_list *plist) -+{ -+ RemoveEntryList(plist); -+ InitializeListHead(plist); -+} -+ -+#define RTW_TIMER_HDL_ARGS IN void * SystemSpecific1, void * FunctionContext, void * SystemSpecific2, void * SystemSpecific3 -+ -+__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,void * cntx) -+{ -+ NdisMInitializeTimer(ptimer, nic_hdl, pfunc, cntx); -+} -+ -+__inline static void _set_timer(_timer *ptimer,u32 delay_time) -+{ -+ NdisMSetTimer(ptimer,delay_time); -+} -+ -+__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -+{ -+ NdisMCancelTimer(ptimer,bcancelled); -+} -+ -+__inline static void _init_workitem(_workitem *pwork, void *pfunc, void * cntx) -+{ -+ -+ NdisInitializeWorkItem(pwork, pfunc, cntx); -+} -+ -+__inline static void _set_workitem(_workitem *pwork) -+{ -+ NdisScheduleWorkItem(pwork); -+} -+ -+#define ATOMIC_INIT(i) { (i) } -+ -+// -+// Global Mutex: can only be used at PASSIVE level. -+// -+ -+#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ while (NdisInterlockedIncrement((Pu32)&(_MutexCounter)) != 1)\ -+ { \ -+ NdisInterlockedDecrement((Pu32)&(_MutexCounter)); \ -+ NdisMSleep(10000); \ -+ } \ -+} -+ -+#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ NdisInterlockedDecrement((Pu32)&(_MutexCounter)); \ -+} -+ -+// limitation of path length -+#define PATH_LENGTH_MAX MAX_PATH -+ -+//Atomic integer operations -+#define ATOMIC_T LONG -+ -+#define NDEV_FMT "%s" -+#define NDEV_ARG(ndev) "" -+#define ADPT_FMT "%s" -+#define ADPT_ARG(adapter) "" -+#define FUNC_NDEV_FMT "%s" -+#define FUNC_NDEV_ARG(ndev) __func__ -+#define FUNC_ADPT_FMT "%s" -+#define FUNC_ADPT_ARG(adapter) __func__ -+ -+#define STRUCT_PACKED -+ -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/osdep_service.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service.h ---- linux-4.14.17/3rdparty/rtl8812au/include/osdep_service.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,434 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __OSDEP_SERVICE_H_ -+#define __OSDEP_SERVICE_H_ -+ -+ -+#define _FAIL 0 -+#define _SUCCESS 1 -+#define RTW_RX_HANDLED 2 -+//#define RTW_STATUS_TIMEDOUT -110 -+ -+#undef true -+#define true 1 -+ -+#undef false -+#define false 0 -+ -+#include -+#include -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 11, 0) -+#include -+#endif -+ -+#define RTW_TIMER_HDL_NAME(name) rtw_##name##_timer_hdl -+#define RTW_DECLARE_TIMER_HDL(name) void RTW_TIMER_HDL_NAME(name)(RTW_TIMER_HDL_ARGS) -+ -+//#include -+ -+#ifndef BIT -+ #define BIT(x) ( 1 << (x)) -+#endif -+ -+#define BIT0 0x00000001 -+#define BIT1 0x00000002 -+#define BIT2 0x00000004 -+#define BIT3 0x00000008 -+#define BIT4 0x00000010 -+#define BIT5 0x00000020 -+#define BIT6 0x00000040 -+#define BIT7 0x00000080 -+#define BIT8 0x00000100 -+#define BIT9 0x00000200 -+#define BIT10 0x00000400 -+#define BIT11 0x00000800 -+#define BIT12 0x00001000 -+#define BIT13 0x00002000 -+#define BIT14 0x00004000 -+#define BIT15 0x00008000 -+#define BIT16 0x00010000 -+#define BIT17 0x00020000 -+#define BIT18 0x00040000 -+#define BIT19 0x00080000 -+#define BIT20 0x00100000 -+#define BIT21 0x00200000 -+#define BIT22 0x00400000 -+#define BIT23 0x00800000 -+#define BIT24 0x01000000 -+#define BIT25 0x02000000 -+#define BIT26 0x04000000 -+#define BIT27 0x08000000 -+#define BIT28 0x10000000 -+#define BIT29 0x20000000 -+#define BIT30 0x40000000 -+#define BIT31 0x80000000 -+#define BIT32 0x0100000000 -+#define BIT33 0x0200000000 -+#define BIT34 0x0400000000 -+#define BIT35 0x0800000000 -+#define BIT36 0x1000000000 -+ -+extern int RTW_STATUS_CODE(int error_code); -+ -+#define CONFIG_USE_VMALLOC -+ -+//flags used for rtw_update_mem_stat() -+enum { -+ MEM_STAT_VIR_ALLOC_SUCCESS, -+ MEM_STAT_VIR_ALLOC_FAIL, -+ MEM_STAT_VIR_FREE, -+ MEM_STAT_PHY_ALLOC_SUCCESS, -+ MEM_STAT_PHY_ALLOC_FAIL, -+ MEM_STAT_PHY_FREE, -+ MEM_STAT_TX, //used to distinguish TX/RX, asigned from caller -+ MEM_STAT_TX_ALLOC_SUCCESS, -+ MEM_STAT_TX_ALLOC_FAIL, -+ MEM_STAT_TX_FREE, -+ MEM_STAT_RX, //used to distinguish TX/RX, asigned from caller -+ MEM_STAT_RX_ALLOC_SUCCESS, -+ MEM_STAT_RX_ALLOC_FAIL, -+ MEM_STAT_RX_FREE -+}; -+ -+#ifdef DBG_MEM_ALLOC -+void rtw_update_mem_stat(u8 flag, u32 sz); -+void rtw_dump_mem_stat (void); -+extern u8* dbg_rtw_vmalloc(u32 sz, const char *func, int line); -+extern u8* dbg_rtw_zvmalloc(u32 sz, const char *func, int line); -+extern void dbg_rtw_vmfree(u8 *pbuf, u32 sz, const char *func, int line); -+extern u8* dbg_rtw_malloc(u32 sz, const char *func, int line); -+extern u8* dbg_rtw_zmalloc(u32 sz, const char *func, int line); -+extern void dbg_rtw_mfree(u8 *pbuf, u32 sz, const char *func, int line); -+#ifdef CONFIG_USE_VMALLOC -+#define rtw_vmalloc(sz) dbg_rtw_vmalloc((sz), __FUNCTION__, __LINE__) -+#define rtw_zvmalloc(sz) dbg_rtw_zvmalloc((sz), __FUNCTION__, __LINE__) -+#define rtw_vmfree(pbuf, sz) dbg_rtw_vmfree((pbuf), (sz), __FUNCTION__, __LINE__) -+#else //CONFIG_USE_VMALLOC -+#define rtw_vmalloc(sz) dbg_rtw_malloc((sz), __FUNCTION__, __LINE__) -+#define rtw_zvmalloc(sz) dbg_rtw_zmalloc((sz), __FUNCTION__, __LINE__) -+#define rtw_vmfree(pbuf, sz) dbg_rtw_mfree((pbuf), (sz), __FUNCTION__, __LINE__) -+#endif //CONFIG_USE_VMALLOC -+#define rtw_malloc(sz) dbg_rtw_malloc((sz), __FUNCTION__, __LINE__) -+#define rtw_zmalloc(sz) dbg_rtw_zmalloc((sz), __FUNCTION__, __LINE__) -+#define rtw_mfree(pbuf, sz) dbg_rtw_mfree((pbuf), (sz), __FUNCTION__, __LINE__) -+#else -+#define rtw_update_mem_stat(flag, sz) do {} while(0) -+extern u8* _rtw_vmalloc(u32 sz); -+extern u8* _rtw_zvmalloc(u32 sz); -+extern void _rtw_vmfree(u8 *pbuf, u32 sz); -+extern u8* _rtw_zmalloc(u32 sz); -+extern u8* _rtw_malloc(u32 sz); -+extern void _rtw_mfree(u8 *pbuf, u32 sz); -+#ifdef CONFIG_USE_VMALLOC -+#define rtw_vmalloc(sz) _rtw_vmalloc((sz)) -+#define rtw_zvmalloc(sz) _rtw_zvmalloc((sz)) -+#define rtw_vmfree(pbuf, sz) _rtw_vmfree((pbuf), (sz)) -+#else //CONFIG_USE_VMALLOC -+#define rtw_vmalloc(sz) _rtw_malloc((sz)) -+#define rtw_zvmalloc(sz) _rtw_zmalloc((sz)) -+#define rtw_vmfree(pbuf, sz) _rtw_mfree((pbuf), (sz)) -+#endif //CONFIG_USE_VMALLOC -+#define rtw_malloc(sz) _rtw_malloc((sz)) -+#define rtw_zmalloc(sz) _rtw_zmalloc((sz)) -+#define rtw_mfree(pbuf, sz) _rtw_mfree((pbuf), (sz)) -+#endif -+ -+extern void* rtw_malloc2d(int h, int w, int size); -+extern void rtw_mfree2d(void *pbuf, int h, int w, int size); -+ -+extern void _rtw_memcpy(void* dec, void* sour, u32 sz); -+extern int _rtw_memcmp(void *dst, void *src, u32 sz); -+extern void _rtw_memset(void *pbuf, int c, u32 sz); -+ -+extern void _rtw_init_listhead(_list *list); -+extern u32 rtw_is_list_empty(_list *phead); -+extern void rtw_list_insert_head(_list *plist, _list *phead); -+extern void rtw_list_insert_tail(_list *plist, _list *phead); -+extern void rtw_list_delete(_list *plist); -+ -+extern void _rtw_init_sema(_sema *sema, int init_val); -+extern void _rtw_free_sema(_sema *sema); -+extern void _rtw_up_sema(_sema *sema); -+extern u32 _rtw_down_sema(_sema *sema); -+extern void _rtw_mutex_init(_mutex *pmutex); -+extern void _rtw_mutex_free(_mutex *pmutex); -+extern void _rtw_spinlock_init(_lock *plock); -+extern void _rtw_spinlock_free(_lock *plock); -+extern void _rtw_spinlock(_lock *plock); -+extern void _rtw_spinunlock(_lock *plock); -+extern void _rtw_spinlock_ex(_lock *plock); -+extern void _rtw_spinunlock_ex(_lock *plock); -+ -+extern void _rtw_init_queue(_queue *pqueue); -+extern u32 _rtw_queue_empty(_queue *pqueue); -+extern u32 rtw_end_of_queue_search(_list *queue, _list *pelement); -+ -+extern u32 rtw_get_current_time(void); -+extern u32 rtw_systime_to_ms(u32 systime); -+extern u32 rtw_ms_to_systime(u32 ms); -+extern s32 rtw_get_passing_time_ms(u32 start); -+extern s32 rtw_get_time_interval_ms(u32 start, u32 end); -+ -+extern void rtw_sleep_schedulable(int ms); -+ -+extern void rtw_msleep_os(int ms); -+extern void rtw_usleep_os(int us); -+ -+extern u32 rtw_atoi(u8* s); -+ -+#ifdef DBG_DELAY_OS -+#define rtw_mdelay_os(ms) _rtw_mdelay_os((ms), __FUNCTION__, __LINE__) -+#define rtw_udelay_os(ms) _rtw_udelay_os((ms), __FUNCTION__, __LINE__) -+extern void _rtw_mdelay_os(int ms, const char *func, const int line); -+extern void _rtw_udelay_os(int us, const char *func, const int line); -+#else -+extern void rtw_mdelay_os(int ms); -+extern void rtw_udelay_os(int us); -+#endif -+ -+extern void rtw_yield_os(void); -+ -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+extern void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc); -+#endif -+ -+__inline static unsigned char _cancel_timer_ex(_timer *ptimer) -+{ -+ return del_timer_sync(ptimer); -+} -+ -+static __inline void thread_enter(char *name) -+{ -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) -+ daemonize("%s", name); -+ #endif -+ allow_signal(SIGTERM); -+} -+ -+__inline static void flush_signals_thread(void) -+{ -+ if (signal_pending (current)) -+ { -+ flush_signals(current); -+ } -+} -+ -+__inline static _OS_STATUS res_to_status(sint res) -+{ -+ return res; -+} -+ -+__inline static void rtw_dump_stack(void) -+{ -+ dump_stack(); -+} -+ -+__inline static int rtw_bug_check(void *parg1, void *parg2, void *parg3, void *parg4) -+{ -+ int ret = true; -+ -+ return ret; -+} -+ -+#define _RND(sz, r) ((((sz)+((r)-1))/(r))*(r)) -+#define RND4(x) (((x >> 2) + (((x & 3) == 0) ? 0: 1)) << 2) -+ -+__inline static u32 _RND4(u32 sz) -+{ -+ -+ u32 val; -+ -+ val = ((sz >> 2) + ((sz & 3) ? 1: 0)) << 2; -+ -+ return val; -+ -+} -+ -+__inline static u32 _RND8(u32 sz) -+{ -+ -+ u32 val; -+ -+ val = ((sz >> 3) + ((sz & 7) ? 1: 0)) << 3; -+ -+ return val; -+ -+} -+ -+__inline static u32 _RND128(u32 sz) -+{ -+ -+ u32 val; -+ -+ val = ((sz >> 7) + ((sz & 127) ? 1: 0)) << 7; -+ -+ return val; -+ -+} -+ -+__inline static u32 _RND256(u32 sz) -+{ -+ -+ u32 val; -+ -+ val = ((sz >> 8) + ((sz & 255) ? 1: 0)) << 8; -+ -+ return val; -+ -+} -+ -+__inline static u32 _RND512(u32 sz) -+{ -+ -+ u32 val; -+ -+ val = ((sz >> 9) + ((sz & 511) ? 1: 0)) << 9; -+ -+ return val; -+ -+} -+ -+__inline static u32 bitshift(u32 bitmask) -+{ -+ u32 i; -+ -+ for (i = 0; i <= 31; i++) -+ if (((bitmask>>i) & 0x1) == 1) break; -+ -+ return i; -+} -+ -+#ifndef MAC_FMT -+#define MAC_FMT "%02x:%02x:%02x:%02x:%02x:%02x" -+#endif -+#ifndef MAC_ARG -+#define MAC_ARG(x) ((u8*)(x))[0],((u8*)(x))[1],((u8*)(x))[2],((u8*)(x))[3],((u8*)(x))[4],((u8*)(x))[5] -+#endif -+ -+ -+extern void rtw_suspend_lock_init(void); -+extern void rtw_suspend_lock_uninit(void); -+extern void rtw_lock_suspend(void); -+extern void rtw_unlock_suspend(void); -+#ifdef CONFIG_WOWLAN -+extern void rtw_lock_suspend_timeout(long timeout); -+#endif //CONFIG_WOWLAN -+ -+extern void ATOMIC_SET(ATOMIC_T *v, int i); -+extern int ATOMIC_READ(ATOMIC_T *v); -+extern void ATOMIC_ADD(ATOMIC_T *v, int i); -+extern void ATOMIC_SUB(ATOMIC_T *v, int i); -+extern void ATOMIC_INC(ATOMIC_T *v); -+extern void ATOMIC_DEC(ATOMIC_T *v); -+extern int ATOMIC_ADD_RETURN(ATOMIC_T *v, int i); -+extern int ATOMIC_SUB_RETURN(ATOMIC_T *v, int i); -+extern int ATOMIC_INC_RETURN(ATOMIC_T *v); -+extern int ATOMIC_DEC_RETURN(ATOMIC_T *v); -+ -+//File operation APIs, just for linux now -+extern int rtw_is_file_readable(char *path); -+extern int rtw_retrive_from_file(char *path, u8* buf, u32 sz); -+extern int rtw_store_to_file(char *path, u8* buf, u32 sz); -+ -+extern void rtw_free_netdev(struct net_device * netdev); -+ -+extern u64 rtw_modular64(u64 x, u64 y); -+extern u64 rtw_division64(u64 x, u64 y); -+ -+/* Macros for handling unaligned memory accesses */ -+ -+#define RTW_GET_BE16(a) ((u16) (((a)[0] << 8) | (a)[1])) -+#define RTW_PUT_BE16(a, val) \ -+ do { \ -+ (a)[0] = ((u16) (val)) >> 8; \ -+ (a)[1] = ((u16) (val)) & 0xff; \ -+ } while (0) -+ -+#define RTW_GET_LE16(a) ((u16) (((a)[1] << 8) | (a)[0])) -+#define RTW_PUT_LE16(a, val) \ -+ do { \ -+ (a)[1] = ((u16) (val)) >> 8; \ -+ (a)[0] = ((u16) (val)) & 0xff; \ -+ } while (0) -+ -+#define RTW_GET_BE24(a) ((((u32) (a)[0]) << 16) | (((u32) (a)[1]) << 8) | \ -+ ((u32) (a)[2])) -+#define RTW_PUT_BE24(a, val) \ -+ do { \ -+ (a)[0] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[2] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define RTW_GET_BE32(a) ((((u32) (a)[0]) << 24) | (((u32) (a)[1]) << 16) | \ -+ (((u32) (a)[2]) << 8) | ((u32) (a)[3])) -+#define RTW_PUT_BE32(a, val) \ -+ do { \ -+ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[3] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define RTW_GET_LE32(a) ((((u32) (a)[3]) << 24) | (((u32) (a)[2]) << 16) | \ -+ (((u32) (a)[1]) << 8) | ((u32) (a)[0])) -+#define RTW_PUT_LE32(a, val) \ -+ do { \ -+ (a)[3] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[0] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define RTW_GET_BE64(a) ((((u64) (a)[0]) << 56) | (((u64) (a)[1]) << 48) | \ -+ (((u64) (a)[2]) << 40) | (((u64) (a)[3]) << 32) | \ -+ (((u64) (a)[4]) << 24) | (((u64) (a)[5]) << 16) | \ -+ (((u64) (a)[6]) << 8) | ((u64) (a)[7])) -+#define RTW_PUT_BE64(a, val) \ -+ do { \ -+ (a)[0] = (u8) (((u64) (val)) >> 56); \ -+ (a)[1] = (u8) (((u64) (val)) >> 48); \ -+ (a)[2] = (u8) (((u64) (val)) >> 40); \ -+ (a)[3] = (u8) (((u64) (val)) >> 32); \ -+ (a)[4] = (u8) (((u64) (val)) >> 24); \ -+ (a)[5] = (u8) (((u64) (val)) >> 16); \ -+ (a)[6] = (u8) (((u64) (val)) >> 8); \ -+ (a)[7] = (u8) (((u64) (val)) & 0xff); \ -+ } while (0) -+ -+#define RTW_GET_LE64(a) ((((u64) (a)[7]) << 56) | (((u64) (a)[6]) << 48) | \ -+ (((u64) (a)[5]) << 40) | (((u64) (a)[4]) << 32) | \ -+ (((u64) (a)[3]) << 24) | (((u64) (a)[2]) << 16) | \ -+ (((u64) (a)[1]) << 8) | ((u64) (a)[0])) -+ -+void rtw_buf_free(u8 **buf, u32 *buf_len); -+void rtw_buf_update(u8 **buf, u32 *buf_len, u8 *src, u32 src_len); -+ -+struct rtw_cbuf { -+ u32 write; -+ u32 read; -+ u32 size; -+ void *bufs[0]; -+}; -+ -+bool rtw_cbuf_full(struct rtw_cbuf *cbuf); -+bool rtw_cbuf_empty(struct rtw_cbuf *cbuf); -+bool rtw_cbuf_push(struct rtw_cbuf *cbuf, void *buf); -+void *rtw_cbuf_pop(struct rtw_cbuf *cbuf); -+struct rtw_cbuf *rtw_cbuf_alloc(u32 size); -+void rtw_cbuf_free(struct rtw_cbuf *cbuf); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/osdep_service_linux.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service_linux.h ---- linux-4.14.17/3rdparty/rtl8812au/include/osdep_service_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/osdep_service_linux.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,386 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __OSDEP_LINUX_SERVICE_H_ -+#define __OSDEP_LINUX_SERVICE_H_ -+ -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,5)) -+ #include -+#endif -+ //#include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26)) -+ #include -+#else -+ #include -+#endif -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include -+ #include // Necessary because we use the proc fs -+ #include // for struct tasklet_struct -+ #include -+ #include -+ #include -+ #include -+ -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,5,41)) -+ #include -+#endif -+ -+ #include -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+// #include -+ #include -+ #include -+#endif //CONFIG_IOCTL_CFG80211 -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ #include -+ #include -+#endif -+ -+#ifdef CONFIG_HAS_EARLYSUSPEND -+ #include -+#endif //CONFIG_HAS_EARLYSUSPEND -+ -+#ifdef CONFIG_EFUSE_CONFIG_FILE -+ #include -+#endif //CONFIG_EFUSE_CONFIG_FILE -+ -+ #include -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) -+ #include -+#else -+ #include -+#endif -+ -+ typedef struct urb * PURB; -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,22)) -+#ifdef CONFIG_USB_SUSPEND -+#define CONFIG_AUTOSUSPEND 1 -+#endif -+#endif -+ -+ typedef struct semaphore _sema; -+ typedef spinlock_t _lock; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ typedef struct mutex _mutex; -+#else -+ typedef struct semaphore _mutex; -+#endif -+ typedef struct timer_list _timer; -+ -+ struct __queue { -+ struct list_head queue; -+ _lock lock; -+ }; -+ -+ typedef struct sk_buff _pkt; -+ typedef unsigned char _buffer; -+ -+ typedef struct __queue _queue; -+ typedef struct list_head _list; -+ typedef int _OS_STATUS; -+ //typedef u32 _irqL; -+ typedef unsigned long _irqL; -+ typedef struct net_device * _nic_hdl; -+ -+ typedef void* _thread_hdl_; -+ typedef int thread_return; -+ typedef void* thread_context; -+ -+ #define thread_exit() complete_and_exit(NULL, 0) -+ -+ typedef void timer_hdl_return; -+ typedef void* timer_hdl_context; -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)) -+ typedef struct work_struct _workitem; -+#else -+ typedef struct tq_struct _workitem; -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) -+ #define DMA_BIT_MASK(n) (((n) == 64) ? ~0ULL : ((1ULL<<(n))-1)) -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22)) -+// Porting from linux kernel, for compatible with old kernel. -+static inline unsigned char *skb_tail_pointer(const struct sk_buff *skb) -+{ -+ return skb->tail; -+} -+ -+static inline void skb_reset_tail_pointer(struct sk_buff *skb) -+{ -+ skb->tail = skb->data; -+} -+ -+static inline void skb_set_tail_pointer(struct sk_buff *skb, const int offset) -+{ -+ skb->tail = skb->data + offset; -+} -+ -+static inline unsigned char *skb_end_pointer(const struct sk_buff *skb) -+{ -+ return skb->end; -+} -+#endif -+ -+__inline static _list *get_next(_list *list) -+{ -+ return list->next; -+} -+ -+__inline static _list *get_list_head(_queue *queue) -+{ -+ return (&(queue->queue)); -+} -+ -+ -+#define LIST_CONTAINOR(ptr, type, member) \ -+ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) -+ -+ -+__inline static void _enter_critical(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_irqsave(plock, *pirqL); -+} -+ -+__inline static void _exit_critical(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_irqrestore(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_irqsave(plock, *pirqL); -+} -+ -+__inline static void _exit_critical_ex(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_irqrestore(plock, *pirqL); -+} -+ -+__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ spin_lock_bh(plock); -+} -+ -+__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) -+{ -+ spin_unlock_bh(plock); -+} -+ -+__inline static int _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+ int ret = 0; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ //mutex_lock(pmutex); -+ ret = mutex_lock_interruptible(pmutex); -+#else -+ ret = down_interruptible(pmutex); -+#endif -+ return ret; -+} -+ -+ -+__inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ mutex_unlock(pmutex); -+#else -+ up(pmutex); -+#endif -+} -+ -+__inline static void rtw_list_delete(_list *plist) -+{ -+ list_del_init(plist); -+} -+ -+#define RTW_TIMER_HDL_ARGS void *FunctionContext -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,void* cntx) -+{ -+ //setup_timer(ptimer, pfunc,(u32)cntx); -+ ptimer->function = pfunc; -+ ptimer->data = (unsigned long)cntx; -+ init_timer(ptimer); -+} -+#endif -+ -+__inline static void _set_timer(_timer *ptimer,u32 delay_time) -+{ -+ mod_timer(ptimer , (jiffies+(delay_time*HZ/1000))); -+} -+ -+__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -+{ -+ del_timer_sync(ptimer); -+ *bcancelled= true;//TRUE ==1; FALSE==0 -+} -+ -+ -+__inline static void _init_workitem(_workitem *pwork, void *pfunc, void * cntx) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) -+ INIT_WORK(pwork, pfunc); -+#elif (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)) -+ INIT_WORK(pwork, pfunc,pwork); -+#else -+ INIT_TQUEUE(pwork, pfunc,pwork); -+#endif -+} -+ -+__inline static void _set_workitem(_workitem *pwork) -+{ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)) -+ schedule_work(pwork); -+#else -+ schedule_task(pwork); -+#endif -+} -+ -+__inline static void _cancel_workitem_sync(_workitem *pwork) -+{ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,22)) -+ cancel_work_sync(pwork); -+#elif (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)) -+ flush_scheduled_work(); -+#else -+ flush_scheduled_tasks(); -+#endif -+} -+// -+// Global Mutex: can only be used at PASSIVE level. -+// -+ -+#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ while (atomic_inc_return((atomic_t *)&(_MutexCounter)) != 1)\ -+ { \ -+ atomic_dec((atomic_t *)&(_MutexCounter)); \ -+ msleep(10); \ -+ } \ -+} -+ -+#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -+{ \ -+ atomic_dec((atomic_t *)&(_MutexCounter)); \ -+} -+ -+static inline int rtw_netif_queue_stopped(struct net_device *pnetdev) -+{ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ return (netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 0)) && -+ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 1)) && -+ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 2)) && -+ netif_tx_queue_stopped(netdev_get_tx_queue(pnetdev, 3)) ); -+#else -+ return netif_queue_stopped(pnetdev); -+#endif -+} -+ -+static inline void rtw_netif_wake_queue(struct net_device *pnetdev) -+{ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ netif_tx_wake_all_queues(pnetdev); -+#else -+ netif_wake_queue(pnetdev); -+#endif -+} -+ -+static inline void rtw_netif_start_queue(struct net_device *pnetdev) -+{ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ netif_tx_start_all_queues(pnetdev); -+#else -+ netif_start_queue(pnetdev); -+#endif -+} -+ -+static inline void rtw_netif_stop_queue(struct net_device *pnetdev) -+{ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ netif_tx_stop_all_queues(pnetdev); -+#else -+ netif_stop_queue(pnetdev); -+#endif -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27)) -+#define rtw_signal_process(pid, sig) kill_pid(find_vpid((pid)),(sig), 1) -+#else //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27)) -+#define rtw_signal_process(pid, sig) kill_proc((pid), (sig), 1) -+#endif //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27)) -+ -+ -+// Suspend lock prevent system from going suspend -+#ifdef CONFIG_WAKELOCK -+#include -+#elif defined(CONFIG_ANDROID_POWER) -+#include -+#endif -+ -+// limitation of path length -+#define PATH_LENGTH_MAX PATH_MAX -+ -+//Atomic integer operations -+#define ATOMIC_T atomic_t -+ -+#define rtw_netdev_priv(netdev) ( ((struct rtw_netdev_priv_indicator *)netdev_priv(netdev))->priv ) -+ -+#define NDEV_FMT "%s" -+#define NDEV_ARG(ndev) ndev->name -+#define ADPT_FMT "%s" -+#define ADPT_ARG(adapter) adapter->pnetdev->name -+#define FUNC_NDEV_FMT "%s(%s)" -+#define FUNC_NDEV_ARG(ndev) __func__, ndev->name -+#define FUNC_ADPT_FMT "%s(%s)" -+#define FUNC_ADPT_ARG(adapter) __func__, adapter->pnetdev->name -+ -+struct rtw_netdev_priv_indicator { -+ void *priv; -+ u32 sizeof_priv; -+}; -+struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv); -+extern struct net_device * rtw_alloc_etherdev(int sizeof_priv); -+ -+#define STRUCT_PACKED __attribute__ ((packed)) -+ -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/recv_osdep.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/recv_osdep.h ---- linux-4.14.17/3rdparty/rtl8812au/include/recv_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/recv_osdep.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,55 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RECV_OSDEP_H_ -+#define __RECV_OSDEP_H_ -+ -+ -+extern sint _rtw_init_recv_priv(struct recv_priv *precvpriv, _adapter *padapter); -+extern void _rtw_free_recv_priv (struct recv_priv *precvpriv); -+ -+ -+extern s32 rtw_recv_entry(union recv_frame *precv_frame); -+extern int rtw_recv_indicatepkt(_adapter *adapter, union recv_frame *precv_frame); -+extern void rtw_recv_returnpacket(_nic_hdl cnxt, _pkt *preturnedpkt); -+ -+extern void rtw_hostapd_mlme_rx(_adapter *padapter, union recv_frame *precv_frame); -+extern void rtw_handle_tkip_mic_err(_adapter *padapter,u8 bgroup); -+ -+ -+int rtw_init_recv_priv(struct recv_priv *precvpriv, _adapter *padapter); -+void rtw_free_recv_priv (struct recv_priv *precvpriv); -+ -+ -+int rtw_os_recv_resource_init(struct recv_priv *precvpriv, _adapter *padapter); -+int rtw_os_recv_resource_alloc(_adapter *padapter, union recv_frame *precvframe); -+void rtw_os_recv_resource_free(struct recv_priv *precvpriv); -+ -+ -+int rtw_os_alloc_recvframe(_adapter *padapter, union recv_frame *precvframe, u8 *pdata, _pkt *pskb); -+void rtw_os_free_recvframe(union recv_frame *precvframe); -+ -+ -+int rtw_os_recvbuf_resource_alloc(_adapter *padapter, struct recv_buf *precvbuf); -+int rtw_os_recvbuf_resource_free(_adapter *padapter, struct recv_buf *precvbuf); -+ -+_pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 *pdata); -+void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, struct rx_pkt_attrib *pattrib); -+ -+void rtw_os_read_port(_adapter *padapter, struct recv_buf *precvbuf); -+ -+void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl); -+ -+ -+#endif // -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_cmd.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_cmd.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_cmd.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,163 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_CMD_H__ -+#define __RTL8812A_CMD_H__ -+ -+typedef enum _RTL8812_H2C_CMD -+{ -+ H2C_8812_RSVDPAGE = 0, -+ H2C_8812_MSRRPT = 1, -+ H2C_8812_SCAN = 2, -+ H2C_8812_KEEP_ALIVE_CTRL = 3, -+ H2C_8812_DISCONNECT_DECISION = 4, -+ -+ H2C_8812_INIT_OFFLOAD = 6, -+ H2C_8812_AP_OFFLOAD = 8, -+ H2C_8812_BCN_RSVDPAGE = 9, -+ H2C_8812_PROBERSP_RSVDPAGE = 10, -+ -+ H2C_8812_SETPWRMODE = 0x20, -+ H2C_8812_PS_TUNING_PARA = 0x21, -+ H2C_8812_PS_TUNING_PARA2 = 0x22, -+ H2C_8812_PS_LPS_PARA = 0x23, -+ H2C_8812_P2P_PS_OFFLOAD = 0x24, -+ H2C_8812_RA_MASK = 0x40, -+ H2C_8812_RSSI_REPORT = 0x42, -+ -+ H2C_8812_WO_WLAN = 0x80, -+ H2C_8812_REMOTE_WAKE_CTRL = 0x81, -+ H2C_8812_AOAC_GLOBAL_INFO = 0x82, -+ H2C_8812_AOAC_RSVDPAGE = 0x83, -+ -+ H2C_8812_TSF_RESET = 0xC0, -+ -+ MAX_8812_H2CCMD -+}RTL8812_H2C_CMD; -+ -+ -+typedef enum _RTL8812_C2H_EVT -+{ -+ C2H_8812_DBG = 0, -+ C2H_8812_LB = 1, -+ C2H_8812_TXBF = 2, -+ C2H_8812_TX_REPORT = 3, -+ C2H_8812_BT_INFO = 9, -+ C2H_8812_BT_MP = 11, -+ C2H_8812_RA_RPT=12, -+ -+ C2H_8812_FW_SWCHNL = 0x10, -+ C2H_8812_IQK_FINISH = 0x11, -+ MAX_8812_C2HEVENT -+}RTL8812_C2H_EVT; -+ -+ -+struct cmd_msg_parm { -+ u8 eid; //element id -+ u8 sz; // sz -+ u8 buf[6]; -+}; -+ -+enum{ -+ PWRS -+}; -+ -+struct H2C_SS_RFOFF_PARAM{ -+ u8 ROFOn; // 1: on, 0:off -+ u16 gpio_period; // unit: 1024 us -+}__attribute__ ((packed)); -+ -+ -+ -+//_RSVDPAGE_LOC_CMD0 -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8812_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+//_MEDIA_STATUS_RPT_PARM_CMD1 -+#define SET_8812_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8812_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8812_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -+#define SET_8812_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) -+ -+//_SETPWRMODE_PARM -+#define SET_8812_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -+#define SET_8812_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -+ -+#define GET_8812_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) -+ -+//_P2P_PS_OFFLOAD -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_CTWINDOW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA0_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_NOA1_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_ALLSTASLEEP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) -+#define SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -+ -+ -+void Set_RA_LDPC_8812(struct sta_info *psta, bool bLDPC); -+ -+// host message to firmware cmd -+void rtl8812_set_FwPwrMode_cmd(PADAPTER padapter, u8 PSMode); -+void rtl8812_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); -+u8 rtl8812_set_rssi_cmd(PADAPTER padapter, u8 *param); -+void rtl8812_set_raid_cmd(PADAPTER padapter, u32 bitmap, u8* arg); -+void rtl8812_Add_RateATid(PADAPTER padapter, u32 bitmap, u8* arg, u8 rssi_level); -+ -+ -+#ifdef CONFIG_P2P_PS -+void rtl8812_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); -+#endif //CONFIG_P2P -+ -+void CheckFwRsvdPageContent(PADAPTER padapter); -+void rtl8812_set_FwMediaStatus_cmd(PADAPTER padapter, u16 mstatus_rpt ); -+ -+#ifdef CONFIG_TSF_RESET_OFFLOAD -+int reset_tsf(PADAPTER Adapter, u8 reset_port ); -+#endif // CONFIG_TSF_RESET_OFFLOAD -+ -+#ifdef CONFIG_WOWLAN -+typedef struct _SETWOWLAN_PARM{ -+ u8 mode; -+ u8 gpio_index; -+ u8 gpio_duration; -+ u8 second_mode; -+ u8 reserve; -+}SETWOWLAN_PARM, *PSETWOWLAN_PARM; -+ -+#define FW_WOWLAN_FUN_EN BIT(0) -+#define FW_WOWLAN_PATTERN_MATCH BIT(1) -+#define FW_WOWLAN_MAGIC_PKT BIT(2) -+#define FW_WOWLAN_UNICAST BIT(3) -+#define FW_WOWLAN_ALL_PKT_DROP BIT(4) -+#define FW_WOWLAN_GPIO_ACTIVE BIT(5) -+#define FW_WOWLAN_REKEY_WAKEUP BIT(6) -+#define FW_WOWLAN_DEAUTH_WAKEUP BIT(7) -+ -+#define FW_WOWLAN_GPIO_WAKEUP_EN BIT(0) -+#define FW_FW_PARSE_MAGIC_PKT BIT(1) -+ -+#define FW_REMOTE_WAKE_CTRL_EN BIT(0) -+#define FW_REALWOWLAN_EN BIT(5) -+void rtl8812a_set_wowlan_cmd(_adapter* padapter, u8 enable); -+void SetFwRelatedForWoWLAN8812(_adapter* padapter, u8 bHostIsGoingtoSleep); -+#endif//CONFIG_WOWLAN -+#endif//__RTL8188E_CMD_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_dm.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_dm.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_dm.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_dm.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,31 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_DM_H__ -+#define __RTL8812A_DM_H__ -+ -+void rtl8812_init_dm_priv(PADAPTER Adapter); -+void rtl8812_deinit_dm_priv(PADAPTER Adapter); -+void rtl8812_InitHalDm(PADAPTER Adapter); -+void rtl8812_HalDmWatchDog(PADAPTER Adapter); -+ -+//void rtl8192c_dm_CheckTXPowerTracking(PADAPTER Adapter); -+ -+//void rtl8192c_dm_RF_Saving(PADAPTER pAdapter, u8 bForceInNormal); -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+void AntDivCompare8812(PADAPTER Adapter, WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src); -+u8 AntDivBeforeLink8812(PADAPTER Adapter ); -+#endif -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_hal.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_hal.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_hal.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,319 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_HAL_H__ -+#define __RTL8812A_HAL_H__ -+ -+//#include "hal_com.h" -+#if 1 -+#include "hal_data.h" -+#else -+#include "../hal/OUTSRC/odm_precomp.h" -+#endif -+ -+//include HAL Related header after HAL Related compiling flags -+#include "rtl8812a_spec.h" -+#include "rtl8812a_rf.h" -+#include "rtl8812a_dm.h" -+#include "rtl8812a_recv.h" -+#include "rtl8812a_xmit.h" -+#include "rtl8812a_cmd.h" -+#include "rtl8812a_led.h" -+#include "Hal8812PwrSeq.h" -+#include "Hal8821APwrSeq.h" //for 8821A/8811A -+#include "Hal8812PhyReg.h" -+#include "Hal8812PhyCfg.h" -+#ifdef DBG_CONFIG_ERROR_DETECT -+#include "rtl8812a_sreset.h" -+#endif -+ -+ -+//--------------------------------------------------------------------- -+// RTL8812AU From header -+//--------------------------------------------------------------------- -+ #define RTL8812_FW_IMG "rtl8812AU\\rtl8812Ufw.bin" -+ #define RTL8812_FW_WW_IMG "rtl8812AU\\rtl8812Ufwww.bin" -+ #define RTL8812_PHY_REG "rtl8812AU\\PHY_REG.txt" -+ #define RTL8812_PHY_RADIO_A "rtl8812AU\\RadioA.txt" -+ #define RTL8812_PHY_RADIO_B "rtl8812AU\\RadioB.txt" -+ #define RTL8812_TXPWR_TRACK "rtl8812AU\\TxPowerTrack.txt" -+ #define RTL8812_AGC_TAB "rtl8812AU\\AGC_TAB.txt" -+ #define RTL8812_PHY_MACREG "rtl8812AU\\MAC_REG.txt" -+ #define RTL8812_PHY_REG_PG "rtl8812AU\\PHY_REG_PG.txt" -+ #define RTL8812_PHY_REG_MP "rtl8812AU\\PHY_REG_MP.txt" -+ #define RTL8812_TXPWR_LMT "rtl8812AU\\TXPWR_LMT.txt" -+ -+//--------------------------------------------------------------------- -+// RTL8821U From file -+//--------------------------------------------------------------------- -+ #define RTL8821_FW_IMG "rtl8821AU\\rtl8821Ufw.bin" -+ #define RTL8821_FW_WW_IMG "rtl8821AU\\rtl8821Ufwww.bin" -+ #define RTL8821_PHY_REG "rtl8821AU\\PHY_REG.txt" -+ #define RTL8821_PHY_RADIO_A "rtl8821AU\\RadioA.txt" -+ #define RTL8821_PHY_RADIO_B "rtl8821AU\\RadioB.txt" -+ #define RTL8821_TXPWR_TRACK "rtl8821AU\\TxPowerTrack.txt" -+ #define RTL8821_AGC_TAB "rtl8821AU\\AGC_TAB.txt" -+ #define RTL8821_PHY_MACREG "rtl8821AU\\MAC_REG.txt" -+ #define RTL8821_PHY_REG_PG "rtl8821AU\\PHY_REG_PG.txt" -+ #define RTL8821_PHY_REG_MP "rtl8821AU\\PHY_REG_MP.txt" -+ #define RTL8821_TXPWR_LMT "rtl8821AU\\TXPWR_LMT.txt" -+ -+//--------------------------------------------------------------------- -+// RTL8812 Power Configuration CMDs for PCIe interface -+//--------------------------------------------------------------------- -+#define Rtl8812_NIC_PWR_ON_FLOW rtl8812_power_on_flow -+#define Rtl8812_NIC_RF_OFF_FLOW rtl8812_radio_off_flow -+#define Rtl8812_NIC_DISABLE_FLOW rtl8812_card_disable_flow -+#define Rtl8812_NIC_ENABLE_FLOW rtl8812_card_enable_flow -+#define Rtl8812_NIC_SUSPEND_FLOW rtl8812_suspend_flow -+#define Rtl8812_NIC_RESUME_FLOW rtl8812_resume_flow -+#define Rtl8812_NIC_PDN_FLOW rtl8812_hwpdn_flow -+#define Rtl8812_NIC_LPS_ENTER_FLOW rtl8812_enter_lps_flow -+#define Rtl8812_NIC_LPS_LEAVE_FLOW rtl8812_leave_lps_flow -+ -+//--------------------------------------------------------------------- -+// RTL8821 Power Configuration CMDs for PCIe interface -+//--------------------------------------------------------------------- -+#define Rtl8821A_NIC_PWR_ON_FLOW rtl8821A_power_on_flow -+#define Rtl8821A_NIC_RF_OFF_FLOW rtl8821A_radio_off_flow -+#define Rtl8821A_NIC_DISABLE_FLOW rtl8821A_card_disable_flow -+#define Rtl8821A_NIC_ENABLE_FLOW rtl8821A_card_enable_flow -+#define Rtl8821A_NIC_SUSPEND_FLOW rtl8821A_suspend_flow -+#define Rtl8821A_NIC_RESUME_FLOW rtl8821A_resume_flow -+#define Rtl8821A_NIC_PDN_FLOW rtl8821A_hwpdn_flow -+#define Rtl8821A_NIC_LPS_ENTER_FLOW rtl8821A_enter_lps_flow -+#define Rtl8821A_NIC_LPS_LEAVE_FLOW rtl8821A_leave_lps_flow -+ -+ -+#if 1 // download firmware related data structure -+#define FW_SIZE_8812 0x8000 // Compatible with RTL8723 Maximal RAM code size 24K. modified to 32k, TO compatible with 92d maximal fw size 32k -+#define FW_START_ADDRESS 0x1000 -+#define FW_END_ADDRESS 0x5FFF -+ -+ -+ -+typedef struct _RT_FIRMWARE_8812 { -+ FIRMWARE_SOURCE eFWSource; -+#ifdef CONFIG_EMBEDDED_FWIMG -+ u8* szFwBuffer; -+#else -+ u8 szFwBuffer[FW_SIZE_8812]; -+#endif -+ u32 ulFwLength; -+ -+#ifdef CONFIG_WOWLAN -+ u8* szWoWLANFwBuffer; -+ u32 ulWoWLANFwLength; -+#endif //CONFIG_WOWLAN -+} RT_FIRMWARE_8812, *PRT_FIRMWARE_8812; -+ -+// -+// This structure must be cared byte-ordering -+// -+// Added by tynli. 2009.12.04. -+#define IS_FW_HEADER_EXIST_8812(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8812(_pFwHdr) &0xFFF0) == 0x9500) -+ -+#define IS_FW_HEADER_EXIST_8821(_pFwHdr) ((GET_FIRMWARE_HDR_SIGNATURE_8812(_pFwHdr) &0xFFF0) == 0x2100) -+//===================================================== -+// Firmware Header(8-byte alinment required) -+//===================================================== -+//--- LONG WORD 0 ---- -+#define GET_FIRMWARE_HDR_SIGNATURE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 0, 16) // 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut -+#define GET_FIRMWARE_HDR_CATEGORY_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 16, 8) // AP/NIC and USB/PCI -+#define GET_FIRMWARE_HDR_FUNCTION_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr, 24, 8) // Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions -+#define GET_FIRMWARE_HDR_VERSION_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 0, 16)// FW Version -+#define GET_FIRMWARE_HDR_SUB_VER_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 16, 8) // FW Subversion, default 0x00 -+#define GET_FIRMWARE_HDR_RSVD1_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+4, 24, 8) -+ -+//--- LONG WORD 1 ---- -+#define GET_FIRMWARE_HDR_MONTH_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 0, 8) // Release time Month field -+#define GET_FIRMWARE_HDR_DATE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 8, 8) // Release time Date field -+#define GET_FIRMWARE_HDR_HOUR_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 16, 8)// Release time Hour field -+#define GET_FIRMWARE_HDR_MINUTE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+8, 24, 8)// Release time Minute field -+#define GET_FIRMWARE_HDR_ROMCODE_SIZE_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 0, 16)// The size of RAM code -+#define GET_FIRMWARE_HDR_RSVD2_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+12, 16, 16) -+ -+//--- LONG WORD 2 ---- -+#define GET_FIRMWARE_HDR_SVN_IDX_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+16, 0, 32)// The SVN entry index -+#define GET_FIRMWARE_HDR_RSVD3_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+20, 0, 32) -+ -+//--- LONG WORD 3 ---- -+#define GET_FIRMWARE_HDR_RSVD4_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+24, 0, 32) -+#define GET_FIRMWARE_HDR_RSVD5_8812(__FwHdr) LE_BITS_TO_4BYTE(__FwHdr+28, 0, 32) -+ -+#endif // download firmware related data structure -+ -+ -+#define DRIVER_EARLY_INT_TIME_8812 0x05 -+#define BCN_DMA_ATIME_INT_TIME_8812 0x02 -+ -+//for 8812 -+#define MAX_RX_DMA_BUFFER_SIZE_8812 0x3E80 //0x3FFF // RX 16K -+ -+#define TX_TOTAL_PAGE_NUMBER_8812 0xF8 -+ -+#define TX_PAGE_BOUNDARY_8812 (TX_TOTAL_PAGE_NUMBER_8812 + 1) -+#define TX_PAGE_LOAD_FW_BOUNDARY_8812 0x47 //0xA5 -+#define TX_PAGE_BOUNDARY_WOWLAN_8812 0xE0 -+ -+// For Normal Chip Setting -+// (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_92C -+#define NORMAL_PAGE_NUM_PUBQ_8812 0xD8 -+#define NORMAL_PAGE_NUM_LPQ_8812 0x10 -+#define NORMAL_PAGE_NUM_HPQ_8812 0x10 -+#define NORMAL_PAGE_NUM_NPQ_8812 0x00 -+ -+//Note: For WMM Normal Chip Setting ,modify later -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8812 0xFB -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8812 (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8812 + 1) -+ -+#define WMM_NORMAL_PAGE_NUM_PUBQ_8812 0x8B -+#define WMM_NORMAL_PAGE_NUM_HPQ_8812 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8812 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8812 0x20 -+ -+ -+// for 8821A -+// TX 64K, RX 16K, Page size 256B for TX, 128B for RX -+#define PAGE_SIZE_TX_8821A 256 -+#define PAGE_SIZE_RX_8821A 128 -+ -+#define MAX_RX_DMA_BUFFER_SIZE_8821 0x3E80 // RX 16K -+ -+// For Normal Chip Setting -+#define TX_TOTAL_PAGE_NUMBER_8821 0xF7 -+#define TX_PAGE_BOUNDARY_8821 (TX_TOTAL_PAGE_NUMBER_8821 + 1) -+//#define TX_PAGE_BOUNDARY_WOWLAN_8821 0xE0 -+ -+// (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER -+#define NORMAL_PAGE_NUM_PUBQ_8821 0xE7 -+#define NORMAL_PAGE_NUM_LPQ_8821 0x08 -+#define NORMAL_PAGE_NUM_HPQ_8821 0x08 -+#define NORMAL_PAGE_NUM_NPQ_8821 0x00 -+ -+// For WMM Normal Chip Setting -+#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8821 0xFB -+#define WMM_NORMAL_TX_PAGE_BOUNDARY_8821 (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8821 + 1) -+ -+#define WMM_NORMAL_PAGE_NUM_PUBQ_8821 0x8B -+#define WMM_NORMAL_PAGE_NUM_HPQ_8821 0x30 -+#define WMM_NORMAL_PAGE_NUM_LPQ_8821 0x20 -+#define WMM_NORMAL_PAGE_NUM_NPQ_8821 0x20 -+ -+ -+#define EFUSE_HIDDEN_812AU 0 -+#define EFUSE_HIDDEN_812AU_VS 1 -+#define EFUSE_HIDDEN_812AU_VL 2 -+#define EFUSE_HIDDEN_812AU_VN 3 -+ -+#ifdef CONFIG_PCI_HCI -+#define EFUSE_REAL_CONTENT_LEN_JAGUAR 1024 -+#define HWSET_MAX_SIZE_JAGUAR 1024 -+#else -+#define EFUSE_REAL_CONTENT_LEN_JAGUAR 512 -+#define HWSET_MAX_SIZE_JAGUAR 512 -+#endif -+ -+#define EFUSE_MAX_BANK_8812A 2 -+#define EFUSE_MAP_LEN_JAGUAR 512 -+#define EFUSE_MAX_SECTION_JAGUAR 64 -+#define EFUSE_MAX_WORD_UNIT_JAGUAR 4 -+#define EFUSE_IC_ID_OFFSET_JAGUAR 506 //For some inferiority IC purpose. added by Roger, 2009.09.02. -+#define AVAILABLE_EFUSE_ADDR_8812(addr) (addr < EFUSE_REAL_CONTENT_LEN_JAGUAR) -+// To prevent out of boundary programming case, leave 1byte and program full section -+// 9bytes + 1byt + 5bytes and pre 1byte. -+// For worst case: -+// | 2byte|----8bytes----|1byte|--7bytes--| //92D -+#define EFUSE_OOB_PROTECT_BYTES_JAGUAR 18 // PG data exclude header, dummy 7 bytes frome CP test and reserved 1byte. -+#define EFUSE_PROTECT_BYTES_BANK_JAGUAR 16 -+// Added for different registry settings to adjust TxPwr index. added by Roger, 2010.03.09. -+typedef enum _TX_PWR_PERCENTAGE{ -+ TX_PWR_PERCENTAGE_0 = 0x01, // 12.5% -+ TX_PWR_PERCENTAGE_1 = 0x02, // 25% -+ TX_PWR_PERCENTAGE_2 = 0x04, // 50% -+ TX_PWR_PERCENTAGE_3 = 0x08, //100%, default target output power. -+} TX_PWR_PERCENTAGE; -+ -+#define GET_RF_TYPE(priv) (GET_HAL_DATA(priv)->rf_type) -+ -+#define INCLUDE_MULTI_FUNC_BT(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) -+#define INCLUDE_MULTI_FUNC_GPS(_Adapter) (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) -+ -+//#define IS_MULTI_FUNC_CHIP(_Adapter) (((((PHAL_DATA_TYPE)(_Adapter->HalData))->MultiFunc) & (RT_MULTI_FUNC_BT|RT_MULTI_FUNC_GPS)) ? true : false) -+ -+//#define RT_IS_FUNC_DISABLED(__pAdapter, __FuncBits) ( (__pAdapter)->DisabledFunctions & (__FuncBits) ) -+ -+#define GetRegTxBBSwing_2G(_Adapter) (_Adapter->registrypriv.TxBBSwing_2G) -+#define GetRegTxBBSwing_5G(_Adapter) (_Adapter->registrypriv.TxBBSwing_5G) -+ -+#define GetRegAmplifierType2G(_Adapter) (_Adapter->registrypriv.AmplifierType_2G) -+#define GetRegAmplifierType5G(_Adapter) (_Adapter->registrypriv.AmplifierType_5G) -+ -+#define GetRegbENRFEType(_Adapter) (_Adapter->registrypriv.bEn_RFE) -+#define GetRegRFEType(_Adapter) (_Adapter->registrypriv.RFE_Type) -+ -+#define GetDefaultAdapter(padapter) padapter -+ -+// rtl8812_hal_init.c -+void _8051Reset8812(PADAPTER padapter); -+s32 FirmwareDownload8812(PADAPTER Adapter, bool bUsedWoWLANFw); -+void InitializeFirmwareVars8812(PADAPTER padapter); -+ -+s32 InitLLTTable8812(PADAPTER padapter, u8 txpktbuf_bndy); -+void InitRDGSetting8812A(PADAPTER padapter); -+ -+void CheckAutoloadState8812A(PADAPTER padapter); -+ -+// EFuse -+u8 GetEEPROMSize8812A(PADAPTER padapter); -+void InitPGData8812A(PADAPTER padapter); -+void Hal_EfuseParseIDCode8812A(PADAPTER padapter, u8 *hwinfo); -+void Hal_ReadPROMVersion8812A(PADAPTER padapter, u8 *hwinfo, bool AutoLoadFail); -+void Hal_ReadTxPowerInfo8812A(PADAPTER padapter,u8* hwinfo,bool AutoLoadFail); -+void Hal_ReadBoardType8812A(PADAPTER pAdapter,u8* hwinfo,bool AutoLoadFail); -+void Hal_ReadThermalMeter_8812A(PADAPTER Adapter,u8* PROMContent,bool AutoloadFail); -+void Hal_ReadChannelPlan8812A(PADAPTER padapter, u8 *hwinfo, bool AutoLoadFail); -+void Hal_EfuseParseXtal_8812A(PADAPTER pAdapter,u8* hwinfo,bool AutoLoadFail); -+void Hal_ReadAntennaDiversity8812A(PADAPTER pAdapter,u8* PROMContent,bool AutoLoadFail); -+void Hal_ReadPAType_8812A(PADAPTER Adapter,u8* PROMContent, bool AutoloadFail); -+void Hal_ReadPAType_8821A(PADAPTER Adapter,u8* PROMContent, bool AutoloadFail); -+void Hal_ReadRFEType_8812A(PADAPTER Adapter,u8* PROMContent, bool AutoloadFail); -+void Hal_EfuseParseBTCoexistInfo8812A(PADAPTER Adapter, u8* hwinfo, bool AutoLoadFail); -+void hal_ReadUsbType_8812AU(PADAPTER Adapter, u8 *PROMContent, bool AutoloadFail); -+ -+bool HalDetectPwrDownMode8812(PADAPTER Adapter); -+ -+#ifdef CONFIG_WOWLAN -+void Hal_DetectWoWMode(PADAPTER pAdapter); -+#endif //CONFIG_WOWLAN -+ -+void _InitBeaconParameters_8812A(PADAPTER padapter); -+void SetBeaconRelatedRegisters8812A(PADAPTER padapter); -+ -+void ReadRFType8812A(PADAPTER padapter); -+void InitDefaultValue8821A(PADAPTER padapter); -+ -+void SetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); -+void GetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); -+u8 SetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+u8 GetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); -+void rtl8812_set_hal_ops(struct hal_ops *pHalFunc); -+ -+// register -+void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); -+ -+void rtl8812_clone_haldata(PADAPTER dst_adapter, PADAPTER src_adapter); -+void rtl8812_start_thread(PADAPTER padapter); -+void rtl8812_stop_thread(PADAPTER padapter); -+#endif //__RTL8188E_HAL_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_led.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_led.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_led.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_led.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,25 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_LED_H__ -+#define __RTL8812A_LED_H__ -+ -+ -+//================================================================================ -+// Interface to manipulate LED objects. -+//================================================================================ -+void rtl8812au_InitSwLeds(PADAPTER padapter); -+void rtl8812au_DeInitSwLeds(PADAPTER padapter); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_recv.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_recv.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_recv.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,112 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_RECV_H__ -+#define __RTL8812A_RECV_H__ -+ -+ #ifndef CONFIG_MINIMAL_MEMORY_USAGE -+ #define MAX_RECVBUF_SZ (24576) // 24k -+ //#define MAX_RECVBUF_SZ (20480) //20K -+ //#define MAX_RECVBUF_SZ (10240) //10K -+ //#define MAX_RECVBUF_SZ (15360) // 15k < 16k -+ //#define MAX_RECVBUF_SZ (8192+1024) // 8K+1k -+ #else -+ #define MAX_RECVBUF_SZ (4000) // about 4K -+ #endif -+ -+// Rx smooth factor -+#define Rx_Smooth_Factor (20) -+ -+//DWORD 0 -+#define SET_RX_STATUS_DESC_PKT_LEN_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 0, 14, __Value) -+#define SET_RX_STATUS_DESC_EOR_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 30, 1, __Value) -+#define SET_RX_STATUS_DESC_OWN_8812(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE( __pRxStatusDesc, 31, 1, __Value) -+ -+#define GET_RX_STATUS_DESC_PKT_LEN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 0, 14) -+#define GET_RX_STATUS_DESC_CRC32_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 14, 1) -+#define GET_RX_STATUS_DESC_ICV_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 15, 1) -+#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 16, 4) -+#define GET_RX_STATUS_DESC_SECURITY_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 20, 3) -+#define GET_RX_STATUS_DESC_QOS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 23, 1) -+#define GET_RX_STATUS_DESC_SHIFT_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 24, 2) -+#define GET_RX_STATUS_DESC_PHY_STATUS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 26, 1) -+#define GET_RX_STATUS_DESC_SWDEC_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 27, 1) -+#define GET_RX_STATUS_DESC_LAST_SEG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 28, 1) -+#define GET_RX_STATUS_DESC_FIRST_SEG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 29, 1) -+#define GET_RX_STATUS_DESC_EOR_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 30, 1) -+#define GET_RX_STATUS_DESC_OWN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc, 31, 1) -+ -+//DWORD 1 -+#define GET_RX_STATUS_DESC_MACID_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) -+#define GET_RX_STATUS_DESC_TID_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) -+#define GET_RX_STATUS_DESC_AMSDU_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) -+#define GET_RX_STATUS_DESC_RXID_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 14, 1) -+#define GET_RX_STATUS_DESC_PAGGR_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 15, 1) -+#define GET_RX_STATUS_DESC_A1_FIT_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 16, 4) -+#define GET_RX_STATUS_DESC_CHKERR_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 20, 1) -+#define GET_RX_STATUS_DESC_IPVER_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) -+#define GET_RX_STATUS_DESC_IS_TCPUDP__8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) -+#define GET_RX_STATUS_DESC_CHK_VLD_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) -+#define GET_RX_STATUS_DESC_PAM_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 24, 1) -+#define GET_RX_STATUS_DESC_PWR_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 25, 1) -+#define GET_RX_STATUS_DESC_MORE_DATA_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 26, 1) -+#define GET_RX_STATUS_DESC_MORE_FRAG_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 27, 1) -+#define GET_RX_STATUS_DESC_TYPE_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 28, 2) -+#define GET_RX_STATUS_DESC_MC_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 30, 1) -+#define GET_RX_STATUS_DESC_BC_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+4, 31, 1) -+ -+//DWORD 2 -+#define GET_RX_STATUS_DESC_SEQ_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 0, 12) -+#define GET_RX_STATUS_DESC_FRAG_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 12, 4) -+#define GET_RX_STATUS_DESC_RX_IS_QOS_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 16, 1) -+#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 18, 6) -+#define GET_RX_STATUS_DESC_RPT_SEL_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+8, 28, 1) -+ -+//DWORD 3 -+#define GET_RX_STATUS_DESC_RX_RATE_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 0, 7) -+#define GET_RX_STATUS_DESC_HTC_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 10, 1) -+#define GET_RX_STATUS_DESC_EOSP_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 11, 1) -+#define GET_RX_STATUS_DESC_BSSID_FIT_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 12, 2) -+#ifdef CONFIG_USB_RX_AGGREGATION -+#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+12, 16, 8) -+#endif -+#define GET_RX_STATUS_DESC_PATTERN_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 29, 1) -+#define GET_RX_STATUS_DESC_UNICAST_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 30, 1) -+#define GET_RX_STATUS_DESC_MAGIC_MATCH_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+12, 31, 1) -+ -+//DWORD 6 -+#define GET_RX_STATUS_DESC_SPLCP_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 0, 1) -+#define GET_RX_STATUS_DESC_LDPC_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 1, 1) -+#define GET_RX_STATUS_DESC_STBC_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 2, 1) -+#define GET_RX_STATUS_DESC_BW_8812(__pRxDesc) LE_BITS_TO_4BYTE( __pRxDesc+16, 4, 2) -+ -+//DWORD 5 -+#define GET_RX_STATUS_DESC_TSFL_8812(__pRxStatusDesc) LE_BITS_TO_4BYTE( __pRxStatusDesc+20, 0, 32) -+ -+#define GET_RX_STATUS_DESC_BUFF_ADDR_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) -+#define GET_RX_STATUS_DESC_BUFF_ADDR64_8812(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) -+ -+#define SET_RX_STATUS_DESC_BUFF_ADDR_8812(__pRxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) -+ -+#define INTERRUPT_MSG_FORMAT_LEN 60 -+void rtl8812au_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); -+s32 rtl8812au_init_recv_priv(PADAPTER padapter); -+void rtl8812au_free_recv_priv(PADAPTER padapter); -+void rtl8812au_recv_hdl(PADAPTER padapter, struct recv_buf *precvbuf); -+void rtl8812au_recv_tasklet(void *priv); -+ -+void rtl8812_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); -+void rtl8812_query_rx_phy_status(union recv_frame *prframe, u8 *pphy_stat); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_rf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_rf.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_rf.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,41 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_RF_H__ -+#define __RTL8812A_RF_H__ -+ -+void -+PHY_RF6052SetBandwidth8812( -+ PADAPTER Adapter, -+ CHANNEL_WIDTH Bandwidth); -+ -+ -+int -+PHY_RF6052_Config_8812( -+ PADAPTER Adapter ); -+ -+void -+PHY_RF6052SetCckTxPower8812( -+ PADAPTER Adapter, -+ u8* pPowerlevel); -+ -+void -+PHY_RF6052SetOFDMTxPower8812( -+ PADAPTER Adapter, -+ u8* pPowerLevelOFDM, -+ u8* pPowerLevelBW20, -+ u8* pPowerLevelBW40, -+ u8 Channel); -+ -+#endif//__RTL8188E_RF_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_spec.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_spec.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_spec.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_spec.h 2018-02-06 17:42:30.719967298 +0200 -@@ -0,0 +1,220 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ *******************************************************************************/ -+#ifndef __RTL8812A_SPEC_H__ -+#define __RTL8812A_SPEC_H__ -+ -+#include -+ -+ -+//============================================================ -+// 8812 Regsiter offset definition -+//============================================================ -+ -+//============================================================ -+// -+//============================================================ -+ -+//----------------------------------------------------- -+// -+// 0x0000h ~ 0x00FFh System Configuration -+// -+//----------------------------------------------------- -+ -+#define REG_SDIO_CTRL_8812 0x0070 -+#define REG_OPT_CTRL_8812 0x0074 -+#define REG_RF_B_CTRL_8812 0x0076 -+#define REG_FW_DRV_MSG_8812 0x0088 -+#define REG_HMEBOX_E2_E3_8812 0x008C -+#define REG_HIMR0_8812 0x00B0 -+#define REG_HISR0_8812 0x00B4 -+#define REG_HIMR1_8812 0x00B8 -+#define REG_HISR1_8812 0x00BC -+#define REG_EFUSE_BURN_GNT_8812 0x00CF -+#define REG_SYS_CFG1_8812 0x00FC -+ -+//----------------------------------------------------- -+// -+// 0x0100h ~ 0x01FFh MACTOP General Configuration -+// -+//----------------------------------------------------- -+#define REG_PKTBUF_DBG_ADDR (REG_PKTBUF_DBG_CTRL) -+#define REG_RXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+2) -+#define REG_TXPKTBUF_DBG (REG_PKTBUF_DBG_CTRL+3) -+ -+#define REG_RSVD3_8812 0x0168 -+#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 -+#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 -+#define REG_C2HEVT_CMD_LEN_88XX 0x01AE -+ -+#define REG_HMEBOX_EXT0_8812 0x01F0 -+#define REG_HMEBOX_EXT1_8812 0x01F4 -+#define REG_HMEBOX_EXT2_8812 0x01F8 -+#define REG_HMEBOX_EXT3_8812 0x01FC -+ -+//----------------------------------------------------- -+// -+// 0x0200h ~ 0x027Fh TXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_TDECTRL1_8812 0x0228 -+ -+//----------------------------------------------------- -+// -+// 0x0280h ~ 0x02FFh RXDMA Configuration -+// -+//----------------------------------------------------- -+#define REG_RXDMA_PRO_8812 0x0290 -+#define REG_EARLY_MODE_CONTROL_8812 0x02BC -+#define REG_RSVD5_8812 0x02F0 -+#define REG_RSVD6_8812 0x02F4 -+#define REG_RSVD7_8812 0x02F8 -+#define REG_RSVD8_8812 0x02FC -+ -+ -+//----------------------------------------------------- -+// -+// 0x0300h ~ 0x03FFh PCIe -+// -+//----------------------------------------------------- -+#define REG_PCIE_MULTIFET_CTRL_8812 0x036A //PCIE Multi-Fethc Control -+ -+//----------------------------------------------------- -+// -+// 0x0400h ~ 0x047Fh Protocol Configuration -+// -+//----------------------------------------------------- -+#define REG_TXBF_CTRL_8812 0x042C -+#define REG_ARFR1_8812 0x044C -+#define REG_CCK_CHECK_8812 0x0454 -+#define REG_AMPDU_MAX_TIME_8812 0x0456 -+#define REG_TXPKTBUF_BCNQ_BDNY1_8812 0x0457 -+ -+#define REG_AMPDU_MAX_LENGTH_8812 0x0458 -+#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8812 0x045D -+#define REG_NDPA_OPT_CTRL_8812 0x045F -+#define REG_DATA_SC_8812 0x0483 -+#define REG_ARFR2_8812 0x048C -+#define REG_ARFR3_8812 0x0494 -+#define REG_TXRPT_START_OFFSET 0x04AC -+#define REG_AMPDU_BURST_MODE_8812 0x04BC -+#define REG_HT_SINGLE_AMPDU_8812 0x04C7 -+#define REG_MACID_PKT_DROP0_8812 0x04D0 -+ -+//----------------------------------------------------- -+// -+// 0x0500h ~ 0x05FFh EDCA Configuration -+// -+//----------------------------------------------------- -+#define REG_CTWND_8812 0x0572 -+#define REG_SECONDARY_CCA_CTRL_8812 0x0577 -+#define REG_SCH_TXCMD_8812 0x05F8 -+ -+//----------------------------------------------------- -+// -+// 0x0600h ~ 0x07FFh WMAC Configuration -+// -+//----------------------------------------------------- -+#define REG_MAC_CR_8812 0x0600 -+ -+#define REG_MAC_TX_SM_STATE_8812 0x06B4 -+ -+// Power -+#define REG_BFMER0_INFO_8812 0x06E4 -+#define REG_BFMER1_INFO_8812 0x06EC -+#define REG_CSI_RPT_PARAM_BW20_8812 0x06F4 -+#define REG_CSI_RPT_PARAM_BW40_8812 0x06F8 -+#define REG_CSI_RPT_PARAM_BW80_8812 0x06FC -+ -+// Hardware Port 2 -+#define REG_BFMEE_SEL_8812 0x0714 -+#define REG_SND_PTCL_CTRL_8812 0x0718 -+ -+ -+//----------------------------------------------------- -+// -+// Redifine register definition for compatibility -+// -+//----------------------------------------------------- -+ -+// TODO: use these definition when using REG_xxx naming rule. -+// NOTE: DO NOT Remove these definition. Use later. -+#define ISR_8812 REG_HISR0_8812 -+ -+//---------------------------------------------------------------------------- -+// 8195 IMR/ISR bits (offset 0xB0, 8bits) -+//---------------------------------------------------------------------------- -+#define IMR_DISABLED_8812 0 -+// IMR DW0(0x00B0-00B3) Bit 0-31 -+#define IMR_TIMER2_8812 BIT31 // Timeout interrupt 2 -+#define IMR_TIMER1_8812 BIT30 // Timeout interrupt 1 -+#define IMR_PSTIMEOUT_8812 BIT29 // Power Save Time Out Interrupt -+#define IMR_GTINT4_8812 BIT28 // When GTIMER4 expires, this bit is set to 1 -+#define IMR_GTINT3_8812 BIT27 // When GTIMER3 expires, this bit is set to 1 -+#define IMR_TXBCN0ERR_8812 BIT26 // Transmit Beacon0 Error -+#define IMR_TXBCN0OK_8812 BIT25 // Transmit Beacon0 OK -+#define IMR_TSF_BIT32_TOGGLE_8812 BIT24 // TSF Timer BIT32 toggle indication interrupt -+#define IMR_BCNDMAINT0_8812 BIT20 // Beacon DMA Interrupt 0 -+#define IMR_BCNDERR0_8812 BIT16 // Beacon Queue DMA OK0 -+#define IMR_HSISR_IND_ON_INT_8812 BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) -+#define IMR_BCNDMAINT_E_8812 BIT14 // Beacon DMA Interrupt Extension for Win7 -+#define IMR_ATIMEND_8812 BIT12 // CTWidnow End or ATIM Window End -+#define IMR_C2HCMD_8812 BIT10 // CPU to Host Command INT Status, Write 1 clear -+#define IMR_CPWM2_8812 BIT9 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_CPWM_8812 BIT8 // CPU power Mode exchange INT Status, Write 1 clear -+#define IMR_HIGHDOK_8812 BIT7 // High Queue DMA OK -+#define IMR_MGNTDOK_8812 BIT6 // Management Queue DMA OK -+#define IMR_BKDOK_8812 BIT5 // AC_BK DMA OK -+#define IMR_BEDOK_8812 BIT4 // AC_BE DMA OK -+#define IMR_VIDOK_8812 BIT3 // AC_VI DMA OK -+#define IMR_VODOK_8812 BIT2 // AC_VO DMA OK -+#define IMR_RDU_8812 BIT1 // Rx Descriptor Unavailable -+#define IMR_ROK_8812 BIT0 // Receive DMA OK -+ -+// IMR DW1(0x00B4-00B7) Bit 0-31 -+#define IMR_BCNDMAINT7_8812 BIT27 // Beacon DMA Interrupt 7 -+#define IMR_BCNDMAINT6_8812 BIT26 // Beacon DMA Interrupt 6 -+#define IMR_BCNDMAINT5_8812 BIT25 // Beacon DMA Interrupt 5 -+#define IMR_BCNDMAINT4_8812 BIT24 // Beacon DMA Interrupt 4 -+#define IMR_BCNDMAINT3_8812 BIT23 // Beacon DMA Interrupt 3 -+#define IMR_BCNDMAINT2_8812 BIT22 // Beacon DMA Interrupt 2 -+#define IMR_BCNDMAINT1_8812 BIT21 // Beacon DMA Interrupt 1 -+#define IMR_BCNDOK7_8812 BIT20 // Beacon Queue DMA OK Interrup 7 -+#define IMR_BCNDOK6_8812 BIT19 // Beacon Queue DMA OK Interrup 6 -+#define IMR_BCNDOK5_8812 BIT18 // Beacon Queue DMA OK Interrup 5 -+#define IMR_BCNDOK4_8812 BIT17 // Beacon Queue DMA OK Interrup 4 -+#define IMR_BCNDOK3_8812 BIT16 // Beacon Queue DMA OK Interrup 3 -+#define IMR_BCNDOK2_8812 BIT15 // Beacon Queue DMA OK Interrup 2 -+#define IMR_BCNDOK1_8812 BIT14 // Beacon Queue DMA OK Interrup 1 -+#define IMR_ATIMEND_E_8812 BIT13 // ATIM Window End Extension for Win7 -+#define IMR_TXERR_8812 BIT11 // Tx Error Flag Interrupt Status, write 1 clear. -+#define IMR_RXERR_8812 BIT10 // Rx Error Flag INT Status, Write 1 clear -+#define IMR_TXFOVW_8812 BIT9 // Transmit FIFO Overflow -+#define IMR_RXFOVW_8812 BIT8 // Receive FIFO Overflow -+ -+ -+//============================================================================ -+// Regsiter Bit and Content definition -+//============================================================================ -+ -+//2 ACMHWCTRL 0x05C0 -+#define AcmHw_HwEn_8812 BIT(0) -+#define AcmHw_VoqEn_8812 BIT(1) -+#define AcmHw_ViqEn_8812 BIT(2) -+#define AcmHw_BeqEn_8812 BIT(3) -+#define AcmHw_VoqStatus_8812 BIT(5) -+#define AcmHw_ViqStatus_8812 BIT(6) -+#define AcmHw_BeqStatus_8812 BIT(7) -+ -+#endif //__RTL8188E_SPEC_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_sreset.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_sreset.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_sreset.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTL88812A_SRESET_H_ -+#define _RTL8812A_SRESET_H_ -+ -+#include -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+extern void rtl8812_sreset_xmit_status_check(_adapter *padapter); -+extern void rtl8812_sreset_linked_status_check(_adapter *padapter); -+#endif -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_xmit.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_xmit.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtl8812a_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8812a_xmit.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,344 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8812A_XMIT_H__ -+#define __RTL8812A_XMIT_H__ -+ -+#include "rtl8821a_xmit.h" -+ -+// -+// Queue Select Value in TxDesc -+// -+#define QSLT_BK 0x2//0x01 -+#define QSLT_BE 0x0 -+#define QSLT_VI 0x5//0x4 -+#define QSLT_VO 0x7//0x6 -+#define QSLT_BEACON 0x10 -+#define QSLT_HIGH 0x11 -+#define QSLT_MGNT 0x12 -+#define QSLT_CMD 0x13 -+ -+//For 88e early mode -+#define SET_EARLYMODE_PKTNUM(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 3, __Value) -+#define SET_EARLYMODE_LEN0(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 12, __Value) -+#define SET_EARLYMODE_LEN1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 16, 12, __Value) -+#define SET_EARLYMODE_LEN2_1(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 28, 4, __Value) -+#define SET_EARLYMODE_LEN2_2(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 8, __Value) -+#define SET_EARLYMODE_LEN3(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 8, 12, __Value) -+#define SET_EARLYMODE_LEN4(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 20, 12, __Value) -+ -+// -+//defined for TX DESC Operation -+// -+ -+#define MAX_TID (15) -+ -+//OFFSET 0 -+#define OFFSET_SZ 0 -+#define OFFSET_SHT 16 -+#define BMC BIT(24) -+#define LSG BIT(26) -+#define FSG BIT(27) -+#define OWN BIT(31) -+ -+ -+//OFFSET 4 -+#define PKT_OFFSET_SZ 0 -+#define QSEL_SHT 8 -+#define RATE_ID_SHT 16 -+#define NAVUSEHDR BIT(20) -+#define SEC_TYPE_SHT 22 -+#define PKT_OFFSET_SHT 26 -+ -+//OFFSET 8 -+#define AGG_EN BIT(12) -+#define AGG_BK BIT(16) -+#define AMPDU_DENSITY_SHT 20 -+#define ANTSEL_A BIT(24) -+#define ANTSEL_B BIT(25) -+#define TX_ANT_CCK_SHT 26 -+#define TX_ANTL_SHT 28 -+#define TX_ANT_HT_SHT 30 -+ -+//OFFSET 12 -+#define SEQ_SHT 16 -+#define EN_HWSEQ BIT(31) -+ -+//OFFSET 16 -+#define QOS BIT(6) -+#define HW_SSN BIT(7) -+#define USERATE BIT(8) -+#define DISDATAFB BIT(10) -+#define CTS_2_SELF BIT(11) -+#define RTS_EN BIT(12) -+#define HW_RTS_EN BIT(13) -+#define DATA_SHORT BIT(24) -+#define PWR_STATUS_SHT 15 -+#define DATA_SC_SHT 20 -+#define DATA_BW BIT(25) -+ -+//OFFSET 20 -+#define RTY_LMT_EN BIT(17) -+ -+//OFFSET 20 -+#define SGI BIT(6) -+#define USB_TXAGG_NUM_SHT 24 -+ -+typedef struct txdescriptor_8812 -+{ -+ // Offset 0 -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 ls:1; -+ u32 fs:1; -+ u32 linip:1; -+ u32 noacm:1; -+ u32 gf:1; -+ u32 own:1; -+ -+ // Offset 4 -+ u32 macid:6; -+ u32 rsvd0406:2; -+ u32 qsel:5; -+ u32 rd_nav_ext:1; -+ u32 lsig_txop_en:1; -+ u32 pifs:1; -+ u32 rate_id:4; -+ u32 navusehdr:1; -+ u32 en_desc_id:1; -+ u32 sectype:2; -+ u32 rsvd0424:2; -+ u32 pkt_offset:5; // unit: 8 bytes -+ u32 rsvd0431:1; -+ -+ // Offset 8 -+ u32 rts_rc:6; -+ u32 data_rc:6; -+ u32 agg_en:1; -+ u32 rd_en:1; -+ u32 bar_rty_th:2; -+ u32 bk:1; -+ u32 morefrag:1; -+ u32 raw:1; -+ u32 ccx:1; -+ u32 ampdu_density:3; -+ u32 bt_null:1; -+ u32 ant_sel_a:1; -+ u32 ant_sel_b:1; -+ u32 tx_ant_cck:2; -+ u32 tx_antl:2; -+ u32 tx_ant_ht:2; -+ -+ // Offset 12 -+ u32 nextheadpage:8; -+ u32 tailpage:8; -+ u32 seq:12; -+ u32 cpu_handle:1; -+ u32 tag1:1; -+ u32 trigger_int:1; -+ u32 hwseq_en:1; -+ -+ // Offset 16 -+ u32 rtsrate:5; -+ u32 ap_dcfe:1; -+ u32 hwseq_sel:2; -+ u32 userate:1; -+ u32 disrtsfb:1; -+ u32 disdatafb:1; -+ u32 cts2self:1; -+ u32 rtsen:1; -+ u32 hw_rts_en:1; -+ u32 port_id:1; -+ u32 pwr_status:3; -+ u32 wait_dcts:1; -+ u32 cts2ap_en:1; -+ u32 data_sc:2; -+ u32 data_stbc:2; -+ u32 data_short:1; -+ u32 data_bw:1; -+ u32 rts_short:1; -+ u32 rts_bw:1; -+ u32 rts_sc:2; -+ u32 vcs_stbc:2; -+ -+ // Offset 20 -+ u32 datarate:6; -+ u32 sgi:1; -+ u32 try_rate:1; -+ u32 data_ratefb_lmt:5; -+ u32 rts_ratefb_lmt:4; -+ u32 rty_lmt_en:1; -+ u32 data_rt_lmt:6; -+ u32 usb_txagg_num:8; -+ -+ // Offset 24 -+ u32 txagg_a:5; -+ u32 txagg_b:5; -+ u32 use_max_len:1; -+ u32 max_agg_num:5; -+ u32 mcsg1_max_len:4; -+ u32 mcsg2_max_len:4; -+ u32 mcsg3_max_len:4; -+ u32 mcs7_sgi_max_len:4; -+ -+ // Offset 28 -+ u32 checksum:16; // TxBuffSize(PCIe)/CheckSum(USB) -+ u32 mcsg4_max_len:4; -+ u32 mcsg5_max_len:4; -+ u32 mcsg6_max_len:4; -+ u32 mcs15_sgi_max_len:4; -+ -+ // Offset 32 -+ u32 rsvd32; -+ -+ // Offset 36 -+ u32 rsvd36; -+}TXDESC_8812, *PTXDESC_8812; -+ -+ -+// Dword 0 -+#define GET_TX_DESC_OWN_8812(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) -+#define SET_TX_DESC_PKT_SIZE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) -+#define SET_TX_DESC_OFFSET_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) -+#define SET_TX_DESC_BMC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) -+#define SET_TX_DESC_HTC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) -+#define SET_TX_DESC_LAST_SEG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 26, 1, __Value) -+#define SET_TX_DESC_FIRST_SEG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) -+#define SET_TX_DESC_LINIP_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 28, 1, __Value) -+#define SET_TX_DESC_NO_ACM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) -+#define SET_TX_DESC_GF_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) -+#define SET_TX_DESC_OWN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) -+ -+// Dword 1 -+#define SET_TX_DESC_MACID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) -+#define SET_TX_DESC_QUEUE_SEL_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) -+#define SET_TX_DESC_RDG_NAV_EXT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) -+#define SET_TX_DESC_LSIG_TXOP_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) -+#define SET_TX_DESC_PIFS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) -+#define SET_TX_DESC_RATE_ID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) -+#define SET_TX_DESC_EN_DESC_ID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) -+#define SET_TX_DESC_SEC_TYPE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) -+#define SET_TX_DESC_PKT_OFFSET_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) -+ -+// Dword 2 -+#define SET_TX_DESC_PAID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) -+#define SET_TX_DESC_CCA_RTS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) -+#define SET_TX_DESC_AGG_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) -+#define SET_TX_DESC_RDG_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) -+#define SET_TX_DESC_AGG_BREAK_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) -+#define SET_TX_DESC_MORE_FRAG_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) -+#define SET_TX_DESC_RAW_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) -+#define SET_TX_DESC_SPE_RPT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) -+#define SET_TX_DESC_AMPDU_DENSITY_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) -+#define SET_TX_DESC_BT_INT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) -+#define SET_TX_DESC_GID_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 6, __Value) -+ -+// Dword 3 -+#define SET_TX_DESC_WHEADER_LEN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 0, 4, __Value) -+#define SET_TX_DESC_CHK_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 4, 1, __Value) -+#define SET_TX_DESC_EARLY_MODE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -+#define SET_TX_DESC_HWSEQ_SEL_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) -+#define SET_TX_DESC_USE_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) -+#define SET_TX_DESC_DISABLE_RTS_FB_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) -+#define SET_TX_DESC_DISABLE_FB_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) -+#define SET_TX_DESC_CTS2SELF_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) -+#define SET_TX_DESC_RTS_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) -+#define SET_TX_DESC_HW_RTS_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) -+#define SET_TX_DESC_NAV_USE_HDR_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) -+#define SET_TX_DESC_USE_MAX_LEN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) -+#define SET_TX_DESC_MAX_AGG_NUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) -+#define SET_TX_DESC_NDPA_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) -+#define SET_TX_DESC_AMPDU_MAX_TIME_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) -+ -+// Dword 4 -+#define SET_TX_DESC_TX_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) -+#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) -+#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) -+#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) -+#define SET_TX_DESC_DATA_RETRY_LIMIT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) -+#define SET_TX_DESC_RTS_RATE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) -+ -+// Dword 5 -+#define SET_TX_DESC_DATA_SC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) -+#define SET_TX_DESC_DATA_SHORT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) -+#define SET_TX_DESC_DATA_BW_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) -+#define SET_TX_DESC_DATA_LDPC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) -+#define SET_TX_DESC_DATA_STBC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) -+#define SET_TX_DESC_CTROL_STBC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) -+#define SET_TX_DESC_RTS_SHORT_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) -+#define SET_TX_DESC_RTS_SC_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) -+ -+// Dword 6 -+#define SET_TX_DESC_MBSSID_8821(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) -+ -+// Dword 7 -+#define SET_TX_DESC_TX_BUFFER_SIZE_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#define SET_TX_DESC_TX_DESC_CHECKSUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -+#define SET_TX_DESC_USB_TXAGG_NUM_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -+// Dword 8 -+#define SET_TX_DESC_HWSEQ_EN_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -+ -+// Dword 9 -+#define SET_TX_DESC_SEQ_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) -+ -+// Dword 10 -+#define SET_TX_DESC_TX_BUFFER_ADDRESS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+40, 0, 32, __Value) -+ -+// Dword 11 -+#define SET_TX_DESC_NEXT_DESC_ADDRESS_8812(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+48, 0, 32, __Value) -+ -+ -+#define SET_EARLYMODE_PKTNUM_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) -+#define SET_EARLYMODE_LEN0_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) -+#define SET_EARLYMODE_LEN1_1_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) -+#define SET_EARLYMODE_LEN1_2_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) -+#define SET_EARLYMODE_LEN2_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) -+#define SET_EARLYMODE_LEN3_8812(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) -+ -+#ifdef CONFIG_TX_EARLY_MODE -+#define USB_DUMMY_OFFSET 2 -+#else -+#define USB_DUMMY_OFFSET 1 -+#endif -+#define USB_DUMMY_LENGTH (USB_DUMMY_OFFSET * PACKET_OFFSET_SZ) -+ -+ -+void rtl8812a_cal_txdesc_chksum(u8 *ptxdesc); -+void rtl8812a_fill_fake_txdesc(PADAPTER padapter,u8*pDesc,u32 BufferLen,u8 IsPsPoll,u8 IsBTQosNull); -+void rtl8812a_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc); -+void rtl8812a_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); -+void rtl8812a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc); -+ -+s32 rtl8812au_init_xmit_priv(PADAPTER padapter); -+void rtl8812au_free_xmit_priv(PADAPTER padapter); -+s32 rtl8812au_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); -+s32 rtl8812au_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); -+s32 rtl8812au_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+s32 rtl8812au_xmit_buf_handler(PADAPTER padapter); -+void rtl8812au_xmit_tasklet(void *priv); -+s32 rtl8812au_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+ -+#ifdef CONFIG_TX_EARLY_MODE -+void UpdateEarlyModeInfo8812(struct xmit_priv *pxmitpriv,struct xmit_buf *pxmitbuf ); -+#endif -+ -+void _dbg_dump_tx_info(_adapter *padapter,int frame_tag,u8 *ptxdesc); -+ -+u8 BWMapping_8812(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+u8 SCMapping_8812(PADAPTER Adapter, struct pkt_attrib *pattrib); -+ -+#endif //__RTL8812_XMIT_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtl8821a_xmit.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8821a_xmit.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtl8821a_xmit.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtl8821a_xmit.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,139 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2013 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTL8821A_XMIT_H__ -+#define __RTL8821A_XMIT_H__ -+ -+#include -+ -+typedef struct txdescriptor_8821a -+{ -+ // Offset 0 -+ u32 pktlen:16; -+ u32 offset:8; -+ u32 bmc:1; -+ u32 htc:1; -+ u32 rsvd0026:1; -+ u32 rsvd0027:1; -+ u32 linip:1; -+ u32 noacm:1; -+ u32 gf:1; -+ u32 rsvd0031:1; -+ -+ // Offset 4 -+ u32 macid:7; -+ u32 rsvd0407:1; -+ u32 qsel:5; -+ u32 rdg_nav_ext:1; -+ u32 lsig_txop_en:1; -+ u32 pifs:1; -+ u32 rate_id:5; -+ u32 en_desc_id:1; -+ u32 sectype:2; -+ u32 pkt_offset:5; // unit: 8 bytes -+ u32 moredata:1; -+ u32 txop_ps_cap:1; -+ u32 txop_ps_mode:1; -+ -+ // Offset 8 -+ u32 p_aid:9; -+ u32 rsvd0809:1; -+ u32 cca_rts:2; -+ u32 agg_en:1; -+ u32 rdg_en:1; -+ u32 null_0:1; -+ u32 null_1:1; -+ u32 bk:1; -+ u32 morefrag:1; -+ u32 raw:1; -+ u32 spe_rpt:1; -+ u32 ampdu_density:3; -+ u32 bt_null:1; -+ u32 g_id:6; -+ u32 rsvd0830:2; -+ -+ // Offset 12 -+ u32 wheader_len:4; -+ u32 chk_en:1; -+ u32 early_rate:1; -+ u32 hw_ssn_sel:2; -+ u32 userate:1; -+ u32 disrtsfb:1; -+ u32 disdatafb:1; -+ u32 cts2self:1; -+ u32 rtsen:1; -+ u32 hw_rts_en:1; -+ u32 port_id:1; -+ u32 navusehdr:1; -+ u32 use_max_len:1; -+ u32 max_agg_num:5; -+ u32 ndpa:2; -+ u32 ampdu_max_time:8; -+ -+ // Offset 16 -+ u32 datarate:7; -+ u32 try_rate:1; -+ u32 data_ratefb_lmt:5; -+ u32 rts_ratefb_lmt:4; -+ u32 rty_lmt_en:1; -+ u32 data_rt_lmt:6; -+ u32 rtsrate:5; -+ u32 pcts_en:1; -+ u32 pcts_mask_idx:2; -+ -+ // Offset 20 -+ u32 data_sc:4; -+ u32 data_short:1; -+ u32 data_bw:2; -+ u32 data_ldpc:1; -+ u32 data_stbc:2; -+ u32 vcs_stbc:2; -+ u32 rts_short:1; -+ u32 rts_sc:4; -+ u32 rsvd2016:7; -+ u32 tx_ant:4; -+ u32 txpwr_offset:3; -+ u32 rsvd2031:1; -+ -+ // Offset 24 -+ u32 sw_define:12; -+ u32 mbssid:4; -+ u32 antsel_A:3; -+ u32 antsel_B:3; -+ u32 antsel_C:3; -+ u32 antsel_D:3; -+ u32 rsvd2428:4; -+ -+ // Offset 28 -+ u32 checksum:16; -+ u32 rsvd2816:8; -+ u32 usb_txagg_num:8; -+ -+ // Offset 32 -+ u32 rts_rc:6; -+ u32 bar_rty_th:2; -+ u32 data_rc:6; -+ u32 rsvd3214:1; -+ u32 en_hwseq:1; -+ u32 nextneadpage:8; -+ u32 tailpage:8; -+ -+ // Offset 36 -+ u32 padding_len:11; -+ u32 txbf_path:1; -+ u32 seq:12; -+ u32 final_data_rate:8; -+}TXDESC_8821A, *PTXDESC_8821A; -+ -+#endif //__RTL8821_XMIT_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_android.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_android.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_android.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_android.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,81 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __RTW_ANDROID_H__ -+#define __RTW_ANDROID_H__ -+ -+enum ANDROID_WIFI_CMD { -+ ANDROID_WIFI_CMD_START, -+ ANDROID_WIFI_CMD_STOP, -+ ANDROID_WIFI_CMD_SCAN_ACTIVE, -+ ANDROID_WIFI_CMD_SCAN_PASSIVE, -+ ANDROID_WIFI_CMD_RSSI, -+ ANDROID_WIFI_CMD_LINKSPEED, -+ ANDROID_WIFI_CMD_RXFILTER_START, -+ ANDROID_WIFI_CMD_RXFILTER_STOP, -+ ANDROID_WIFI_CMD_RXFILTER_ADD, -+ ANDROID_WIFI_CMD_RXFILTER_REMOVE, -+ ANDROID_WIFI_CMD_BTCOEXSCAN_START, -+ ANDROID_WIFI_CMD_BTCOEXSCAN_STOP, -+ ANDROID_WIFI_CMD_BTCOEXMODE, -+ ANDROID_WIFI_CMD_SETSUSPENDOPT, -+ ANDROID_WIFI_CMD_P2P_DEV_ADDR, -+ ANDROID_WIFI_CMD_SETFWPATH, -+ ANDROID_WIFI_CMD_SETBAND, -+ ANDROID_WIFI_CMD_GETBAND, -+ ANDROID_WIFI_CMD_COUNTRY, -+ ANDROID_WIFI_CMD_P2P_SET_NOA, -+ ANDROID_WIFI_CMD_P2P_GET_NOA, -+ ANDROID_WIFI_CMD_P2P_SET_PS, -+ ANDROID_WIFI_CMD_SET_AP_WPS_P2P_IE, -+#ifdef PNO_SUPPORT -+ ANDROID_WIFI_CMD_PNOSSIDCLR_SET, -+ ANDROID_WIFI_CMD_PNOSETUP_SET, -+ ANDROID_WIFI_CMD_PNOENABLE_SET, -+ ANDROID_WIFI_CMD_PNODEBUG_SET, -+#endif -+ -+ ANDROID_WIFI_CMD_MACADDR, -+ -+ ANDROID_WIFI_CMD_BLOCK, -+ -+ ANDROID_WIFI_CMD_WFD_ENABLE, -+ ANDROID_WIFI_CMD_WFD_DISABLE, -+ -+ ANDROID_WIFI_CMD_WFD_SET_TCPPORT, -+ ANDROID_WIFI_CMD_WFD_SET_MAX_TPUT, -+ ANDROID_WIFI_CMD_WFD_SET_DEVTYPE, -+ -+ ANDROID_WIFI_CMD_MAX -+}; -+ -+int rtw_android_cmdstr_to_num(char *cmdstr); -+int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd); -+ -+#if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) -+int rtw_android_wifictrl_func_add(void); -+void rtw_android_wifictrl_func_del(void); -+void* wl_android_prealloc(int section, unsigned long size); -+ -+int wifi_get_irq_number(unsigned long *irq_flags_ptr); -+int wifi_set_power(int on, unsigned long msec); -+int wifi_get_mac_addr(unsigned char *buf); -+void *wifi_get_country_code(char *ccode); -+#else -+static int rtw_android_wifictrl_func_add(void) { return 0; } -+static void rtw_android_wifictrl_func_del(void) {} -+#endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ -+ -+#endif //__RTW_ANDROID_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_ap.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ap.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_ap.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ap.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,64 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_AP_H_ -+#define __RTW_AP_H_ -+ -+ -+#ifdef CONFIG_AP_MODE -+ -+//external function -+extern void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta); -+extern void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta); -+ -+ -+void init_mlme_ap_info(_adapter *padapter); -+void free_mlme_ap_info(_adapter *padapter); -+//void update_BCNTIM(_adapter *padapter); -+void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *data, u8 len); -+void rtw_remove_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index); -+void update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx); -+void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level); -+void expire_timeout_chk(_adapter *padapter); -+void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta); -+int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len); -+void rtw_ap_restore_network(_adapter *padapter); -+void rtw_set_macaddr_acl(_adapter *padapter, int mode); -+int rtw_acl_add_sta(_adapter *padapter, u8 *addr); -+int rtw_acl_remove_sta(_adapter *padapter, u8 *addr); -+ -+u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta); -+int rtw_ap_set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid); -+int rtw_ap_set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx); -+ -+#ifdef CONFIG_NATIVEAP_MLME -+void associated_clients_update(_adapter *padapter, u8 updated); -+void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta); -+u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta); -+void sta_info_update(_adapter *padapter, struct sta_info *psta); -+void ap_sta_info_defer_update(_adapter *padapter, struct sta_info *psta); -+u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reason); -+int rtw_sta_flush(_adapter *padapter); -+int rtw_ap_inform_ch_switch(_adapter *padapter, u8 new_ch, u8 ch_offset); -+void start_ap_mode(_adapter *padapter); -+void stop_ap_mode(_adapter *padapter); -+#endif -+ -+#ifdef CONFIG_AUTO_AP_MODE -+extern void rtw_start_auto_ap(_adapter *adapter); -+#endif //CONFIG_AUTO_AP_MODE -+ -+#endif //end of CONFIG_AP_MODE -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_br_ext.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_br_ext.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_br_ext.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_br_ext.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,70 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_BR_EXT_H_ -+#define _RTW_BR_EXT_H_ -+ -+#if 1 // rtw_wifi_driver -+#define CL_IPV6_PASS 1 -+#define MACADDRLEN 6 -+#define _DEBUG_ERR DBG_8192C -+#define _DEBUG_INFO //DBG_8192C -+#define DEBUG_WARN DBG_8192C -+#define DEBUG_INFO //DBG_8192C -+#define DEBUG_ERR DBG_8192C -+//#define GET_MY_HWADDR ((GET_MIB(priv))->dot11OperationEntry.hwaddr) -+#define GET_MY_HWADDR(padapter) ((padapter)->eeprompriv.mac_addr) -+#endif // rtw_wifi_driver -+ -+#define NAT25_HASH_BITS 4 -+#define NAT25_HASH_SIZE (1 << NAT25_HASH_BITS) -+#define NAT25_AGEING_TIME 300 -+ -+#ifdef CL_IPV6_PASS -+#define MAX_NETWORK_ADDR_LEN 17 -+#else -+#define MAX_NETWORK_ADDR_LEN 11 -+#endif -+ -+struct nat25_network_db_entry -+{ -+ struct nat25_network_db_entry *next_hash; -+ struct nat25_network_db_entry **pprev_hash; -+ atomic_t use_count; -+ unsigned char macAddr[6]; -+ unsigned long ageing_timer; -+ unsigned char networkAddr[MAX_NETWORK_ADDR_LEN]; -+}; -+ -+enum NAT25_METHOD { -+ NAT25_MIN, -+ NAT25_CHECK, -+ NAT25_INSERT, -+ NAT25_LOOKUP, -+ NAT25_PARSE, -+ NAT25_MAX -+}; -+ -+struct br_ext_info { -+ unsigned int nat25_disable; -+ unsigned int macclone_enable; -+ unsigned int dhcp_bcst_disable; -+ int addPPPoETag; // 1: Add PPPoE relay-SID, 0: disable -+ unsigned char nat25_dmzMac[MACADDRLEN]; -+ unsigned int nat25sc_disable; -+}; -+ -+void nat25_db_cleanup(_adapter *priv); -+ -+#endif // _RTW_BR_EXT_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_bt_mp.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_bt_mp.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_bt_mp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_bt_mp.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,291 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef __RTW_BT_MP_H -+#define __RTW_BT_MP_H -+ -+ -+#if(MP_DRIVER == 1) -+ -+#pragma pack(1) -+ -+// definition for BT_UP_OP_BT_READY -+#define MP_BT_NOT_READY 0 -+#define MP_BT_READY 1 -+ -+// definition for BT_UP_OP_BT_SET_MODE -+typedef enum _MP_BT_MODE{ -+ MP_BT_MODE_RF_TXRX_TEST_MODE = 0, -+ MP_BT_MODE_BT20_DUT_TEST_MODE = 1, -+ MP_BT_MODE_BT40_DIRECT_TEST_MODE = 2, -+ MP_BT_MODE_CONNECT_TEST_MODE = 3, -+ MP_BT_MODE_MAX -+}MP_BT_MODE,*PMP_BT_MODE; -+ -+ -+// definition for BT_UP_OP_BT_SET_TX_RX_PARAMETER -+typedef struct _BT_TXRX_PARAMETERS{ -+ u1Byte txrxChannel; -+ u4Byte txrxTxPktCnt; -+ u1Byte txrxTxPktInterval; -+ u1Byte txrxPayloadType; -+ u1Byte txrxPktType; -+ u2Byte txrxPayloadLen; -+ u4Byte txrxPktHeader; -+ u1Byte txrxWhitenCoeff; -+ u1Byte txrxBdaddr[6]; -+ u1Byte txrxTxGainIndex; -+} BT_TXRX_PARAMETERS, *PBT_TXRX_PARAMETERS; -+ -+// txrxPktType -+typedef enum _MP_BT_PKT_TYPE{ -+ MP_BT_PKT_DH1 = 0, -+ MP_BT_PKT_DH3 = 1, -+ MP_BT_PKT_DH5 = 2, -+ MP_BT_PKT_2DH1 = 3, -+ MP_BT_PKT_2DH3 = 4, -+ MP_BT_PKT_2DH5 = 5, -+ MP_BT_PKT_3DH1 = 6, -+ MP_BT_PKT_3DH3 = 7, -+ MP_BT_PKT_3DH5 = 8, -+ MP_BT_PKT_LE = 9, -+ MP_BT_PKT_MAX -+}MP_BT_PKT_TYPE,*PMP_BT_PKT_TYPE; -+// txrxPayloadType -+typedef enum _MP_BT_PAYLOAD_TYPE{ -+ MP_BT_PAYLOAD_01010101 = 0, -+ MP_BT_PAYLOAD_ALL_1 = 1, -+ MP_BT_PAYLOAD_ALL_0 = 2, -+ MP_BT_PAYLOAD_11110000 = 3, -+ MP_BT_PAYLOAD_PRBS9 = 4, -+ MP_BT_PAYLOAD_MAX -+}MP_BT_PAYLOAD_TYPE,*PMP_BT_PAYLOAD_TYPE; -+ -+ -+// definition for BT_UP_OP_BT_TEST_CTRL -+typedef enum _MP_BT_TEST_CTRL{ -+ MP_BT_TEST_STOP_ALL_TESTS = 0, -+ MP_BT_TEST_START_RX_TEST = 1, -+ MP_BT_TEST_START_PACKET_TX_TEST = 2, -+ MP_BT_TEST_START_CONTINUOUS_TX_TEST = 3, -+ MP_BT_TEST_START_INQUIRY_SCAN_TEST = 4, -+ MP_BT_TEST_START_PAGE_SCAN_TEST = 5, -+ MP_BT_TEST_START_INQUIRY_PAGE_SCAN_TEST = 6, -+ MP_BT_TEST_START_LEGACY_CONNECT_TEST = 7, -+ MP_BT_TEST_START_LE_CONNECT_TEST_INITIATOR = 8, -+ MP_BT_TEST_START_LE_CONNECT_TEST_ADVERTISER = 9, -+ MP_BT_TEST_MAX -+}MP_BT_TEST_CTRL,*PMP_BT_TEST_CTRL; -+ -+ -+typedef enum _RTL_EXT_C2H_EVT -+{ -+ EXT_C2H_WIFI_FW_ACTIVE_RSP = 0, -+ EXT_C2H_TRIG_BY_BT_FW = 1, -+ MAX_EXT_C2HEVENT -+}RTL_EXT_C2H_EVT; -+ -+ -+// return status definition to the user layer -+typedef enum _BT_CTRL_STATUS{ -+ BT_STATUS_SUCCESS = 0x00, // Success -+ BT_STATUS_BT_OP_SUCCESS = 0x01, // bt fw op execution success -+ BT_STATUS_H2C_SUCCESS = 0x02, // H2c success -+ BT_STATUS_H2C_TIMTOUT = 0x03, // H2c timeout -+ BT_STATUS_H2C_BT_NO_RSP = 0x04, // H2c sent, bt no rsp -+ BT_STATUS_C2H_SUCCESS = 0x05, // C2h success -+ BT_STATUS_C2H_REQNUM_MISMATCH = 0x06, // bt fw wrong rsp -+ BT_STATUS_OPCODE_U_VERSION_MISMATCH = 0x07, // Upper layer OP code version mismatch. -+ BT_STATUS_OPCODE_L_VERSION_MISMATCH = 0x08, // Lower layer OP code version mismatch. -+ BT_STATUS_UNKNOWN_OPCODE_U = 0x09, // Unknown Upper layer OP code -+ BT_STATUS_UNKNOWN_OPCODE_L = 0x0a, // Unknown Lower layer OP code -+ BT_STATUS_PARAMETER_FORMAT_ERROR_U = 0x0b, // Wrong parameters sent by upper layer. -+ BT_STATUS_PARAMETER_FORMAT_ERROR_L = 0x0c, // bt fw parameter format is not consistency -+ BT_STATUS_PARAMETER_OUT_OF_RANGE_U = 0x0d, // uppery layer parameter value is out of range -+ BT_STATUS_PARAMETER_OUT_OF_RANGE_L = 0x0e, // bt fw parameter value is out of range -+ BT_STATUS_UNKNOWN_STATUS_L = 0x0f, // bt returned an defined status code -+ BT_STATUS_UNKNOWN_STATUS_H = 0x10, // driver need to do error handle or not handle-well. -+ BT_STATUS_WRONG_LEVEL = 0x11, // should be under passive level -+ BT_STATUS_MAX -+}BT_CTRL_STATUS,*PBT_CTRL_STATUS; -+ -+// OP codes definition between the user layer and driver -+typedef enum _BT_CTRL_OPCODE_UPPER{ -+ BT_UP_OP_BT_READY = 0x00, -+ BT_UP_OP_BT_SET_MODE = 0x01, -+ BT_UP_OP_BT_SET_TX_RX_PARAMETER = 0x02, -+ BT_UP_OP_BT_SET_GENERAL = 0x03, -+ BT_UP_OP_BT_GET_GENERAL = 0x04, -+ BT_UP_OP_BT_TEST_CTRL = 0x05, -+ BT_UP_OP_TEST_BT = 0x06, -+ BT_UP_OP_MAX -+}BT_CTRL_OPCODE_UPPER,*PBT_CTRL_OPCODE_UPPER; -+ -+ -+typedef enum _BT_SET_GENERAL{ -+ BT_GSET_REG = 0x00, -+ BT_GSET_RESET = 0x01, -+ BT_GSET_TARGET_BD_ADDR = 0x02, -+ BT_GSET_TX_PWR_FINETUNE = 0x03, -+ BT_GSET_UPDATE_BT_PATCH = 0x04, -+ BT_GSET_MAX -+}BT_SET_GENERAL,*PBT_SET_GENERAL; -+ -+typedef enum _BT_GET_GENERAL{ -+ BT_GGET_REG = 0x00, -+ BT_GGET_STATUS = 0x01, -+ BT_GGET_REPORT = 0x02, -+ BT_GGET_MAX -+}BT_GET_GENERAL,*PBT_GET_GENERAL; -+ -+// definition for BT_UP_OP_BT_SET_GENERAL -+typedef enum _BT_REG_TYPE{ -+ BT_REG_RF = 0, -+ BT_REG_MODEM = 1, -+ BT_REG_BLUEWIZE = 2, -+ BT_REG_VENDOR = 3, -+ BT_REG_LE = 4, -+ BT_REG_MAX -+}BT_REG_TYPE,*PBT_REG_TYPE; -+ -+ -+// definition for BT_UP_OP_BT_GET_GENERAL -+typedef enum _BT_REPORT_TYPE{ -+ BT_REPORT_RX_PACKET_CNT = 0, -+ BT_REPORT_RX_ERROR_BITS = 1, -+ BT_REPORT_RSSI = 2, -+ BT_REPORT_CFO_HDR_QUALITY = 3, -+ BT_REPORT_CONNECT_TARGET_BD_ADDR = 4, -+ BT_REPORT_MAX -+}BT_REPORT_TYPE,*PBT_REPORT_TYPE; -+ -+void -+MPTBT_Test( -+ PADAPTER Adapter, -+ u1Byte opCode, -+ u1Byte byte1, -+ u1Byte byte2, -+ u1Byte byte3 -+ ); -+ -+uint -+MPTBT_SendOidBT( -+ PADAPTER pAdapter, -+ void * InformationBuffer, -+ u32 InformationBufferLength, -+ Pu32 BytesRead, -+ Pu32 BytesNeeded -+ ); -+ -+void -+MPTBT_FwC2hBtMpCtrl( -+ PADAPTER Adapter, -+ pu1Byte tmpBuf, -+ u1Byte length -+ ); -+ -+void MPh2c_timeout_handle(void *FunctionContext); -+ -+void mptbt_BtControlProcess( -+ PADAPTER Adapter, -+ void * pInBuf -+ ); -+ -+#define BT_H2C_MAX_RETRY 1 -+#define BT_MAX_C2H_LEN 20 -+ -+typedef struct _BT_REQ_CMD{ -+ u8 opCodeVer; -+ u8 OpCode; -+ u16 paraLength; -+ u8 pParamStart[100]; -+} BT_REQ_CMD, *PBT_REQ_CMD; -+ -+typedef struct _BT_RSP_CMD{ -+ u16 status; -+ u16 paraLength; -+ u8 pParamStart[100]; -+} BT_RSP_CMD, *PBT_RSP_CMD; -+ -+ -+typedef struct _BT_H2C{ -+ u1Byte opCodeVer:4; -+ u1Byte reqNum:4; -+ u1Byte opCode; -+ u1Byte buf[100]; -+}BT_H2C, *PBT_H2C; -+ -+ -+ -+typedef struct _BT_EXT_C2H{ -+ u1Byte extendId; -+ u1Byte statusCode:4; -+ u1Byte retLen:4; -+ u1Byte opCodeVer:4; -+ u1Byte reqNum:4; -+ u1Byte buf[100]; -+}BT_EXT_C2H, *PBT_EXT_C2H; -+ -+ -+typedef enum _BT_OPCODE_STATUS{ -+ BT_OP_STATUS_SUCCESS = 0x00, // Success -+ BT_OP_STATUS_VERSION_MISMATCH = 0x01, -+ BT_OP_STATUS_UNKNOWN_OPCODE = 0x02, -+ BT_OP_STATUS_ERROR_PARAMETER = 0x03, -+ BT_OP_STATUS_MAX -+}BT_OPCODE_STATUS,*PBT_OPCODE_STATUS; -+ -+ -+ -+//OP codes definition between driver and bt fw -+typedef enum _BT_CTRL_OPCODE_LOWER{ -+ BT_LO_OP_GET_BT_VERSION = 0x00, -+ BT_LO_OP_RESET = 0x01, -+ BT_LO_OP_TEST_CTRL = 0x02, -+ BT_LO_OP_SET_BT_MODE = 0x03, -+ BT_LO_OP_SET_CHNL_TX_GAIN = 0x04, -+ BT_LO_OP_SET_PKT_TYPE_LEN = 0x05, -+ BT_LO_OP_SET_PKT_CNT_L_PL_TYPE = 0x06, -+ BT_LO_OP_SET_PKT_CNT_H_PKT_INTV = 0x07, -+ BT_LO_OP_SET_PKT_HEADER = 0x08, -+ BT_LO_OP_SET_WHITENCOEFF = 0x09, -+ BT_LO_OP_SET_BD_ADDR_L = 0x0a, -+ BT_LO_OP_SET_BD_ADDR_H = 0x0b, -+ BT_LO_OP_WRITE_REG_ADDR = 0x0c, -+ BT_LO_OP_WRITE_REG_VALUE = 0x0d, -+ BT_LO_OP_GET_BT_STATUS = 0x0e, -+ BT_LO_OP_GET_BD_ADDR_L = 0x0f, -+ BT_LO_OP_GET_BD_ADDR_H = 0x10, -+ BT_LO_OP_READ_REG = 0x11, -+ BT_LO_OP_SET_TARGET_BD_ADDR_L = 0x12, -+ BT_LO_OP_SET_TARGET_BD_ADDR_H = 0x13, -+ BT_LO_OP_SET_TX_POWER_CALIBRATION = 0x14, -+ BT_LO_OP_GET_RX_PKT_CNT_L = 0x15, -+ BT_LO_OP_GET_RX_PKT_CNT_H = 0x16, -+ BT_LO_OP_GET_RX_ERROR_BITS_L = 0x17, -+ BT_LO_OP_GET_RX_ERROR_BITS_H = 0x18, -+ BT_LO_OP_GET_RSSI = 0x19, -+ BT_LO_OP_GET_CFO_HDR_QUALITY_L = 0x1a, -+ BT_LO_OP_GET_CFO_HDR_QUALITY_H = 0x1b, -+ BT_LO_OP_GET_TARGET_BD_ADDR_L = 0x1c, -+ BT_LO_OP_GET_TARGET_BD_ADDR_H = 0x1d, -+ BT_LO_OP_MAX -+}BT_CTRL_OPCODE_LOWER,*PBT_CTRL_OPCODE_LOWER; -+ -+ -+ -+#endif /* #if(MP_DRIVER == 1) */ -+ -+#endif // #ifndef __INC_MPT_BT_H -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_byteorder.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_byteorder.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_byteorder.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_byteorder.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTL871X_BYTEORDER_H_ -+#define _RTL871X_BYTEORDER_H_ -+ -+#if defined (__LITTLE_ENDIAN) -+# include -+#else -+# include -+#endif -+ -+#endif /* _RTL871X_BYTEORDER_H_ */ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_cmd.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_cmd.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_cmd.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_cmd.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,1148 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_CMD_H_ -+#define __RTW_CMD_H_ -+ -+ -+#define C2H_MEM_SZ (16*1024) -+ -+ #define FREE_CMDOBJ_SZ 128 -+ -+ #define MAX_CMDSZ 1024 -+ #define MAX_RSPSZ 512 -+ #define MAX_EVTSZ 1024 -+ -+ #define CMDBUFF_ALIGN_SZ 512 -+ -+ struct cmd_obj { -+ _adapter *padapter; -+ u16 cmdcode; -+ u8 res; -+ u8 *parmbuf; -+ u32 cmdsz; -+ u8 *rsp; -+ u32 rspsz; -+ //_sema cmd_sem; -+ _list list; -+ }; -+ -+ struct cmd_priv { -+ _sema cmd_queue_sema; -+ //_sema cmd_done_sema; -+ _sema terminate_cmdthread_sema; -+ _queue cmd_queue; -+ u8 cmd_seq; -+ u8 *cmd_buf; //shall be non-paged, and 4 bytes aligned -+ u8 *cmd_allocated_buf; -+ u8 *rsp_buf; //shall be non-paged, and 4 bytes aligned -+ u8 *rsp_allocated_buf; -+ u32 cmd_issued_cnt; -+ u32 cmd_done_cnt; -+ u32 rsp_cnt; -+ u8 cmdthd_running; -+ _adapter *padapter; -+ }; -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+ struct evt_obj { -+ u16 evtcode; -+ u8 res; -+ u8 *parmbuf; -+ u32 evtsz; -+ _list list; -+ }; -+#endif -+ -+ struct evt_priv { -+#ifdef CONFIG_EVENT_THREAD_MODE -+ _sema evt_notify; -+ _sema terminate_evtthread_sema; -+ _queue evt_queue; -+#endif -+ -+#define CONFIG_C2H_WK -+#ifdef CONFIG_C2H_WK -+ _workitem c2h_wk; -+ bool c2h_wk_alive; -+ struct rtw_cbuf *c2h_queue; -+ #define C2H_QUEUE_MAX_LEN 10 -+#endif -+ -+#ifdef CONFIG_H2CLBK -+ _sema lbkevt_done; -+ u8 lbkevt_limit; -+ u8 lbkevt_num; -+ u8 *cmdevt_parm; -+#endif -+ ATOMIC_T event_seq; -+ u8 *evt_buf; //shall be non-paged, and 4 bytes aligned -+ u8 *evt_allocated_buf; -+ u32 evt_done_cnt; -+ }; -+ -+#define init_h2fwcmd_w_parm_no_rsp(pcmd, pparm, code) \ -+do {\ -+ _rtw_init_listhead(&pcmd->list);\ -+ pcmd->cmdcode = code;\ -+ pcmd->parmbuf = (u8 *)(pparm);\ -+ pcmd->cmdsz = sizeof (*pparm);\ -+ pcmd->rsp = NULL;\ -+ pcmd->rspsz = 0;\ -+} while(0) -+ -+struct c2h_evt_hdr { -+ u8 id:4; -+ u8 plen:4; -+ u8 seq; -+ u8 payload[0]; -+}; -+ -+struct P2P_PS_Offload_t { -+ u8 Offload_En:1; -+ u8 role:1; // 1: Owner, 0: Client -+ u8 CTWindow_En:1; -+ u8 NoA0_En:1; -+ u8 NoA1_En:1; -+ u8 AllStaSleep:1; // Only valid in Owner -+ u8 discovery:1; -+ u8 rsvd:1; -+}; -+ -+struct P2P_PS_CTWPeriod_t { -+ u8 CTWPeriod; //TU -+}; -+ -+#define c2h_evt_exist(c2h_evt) ((c2h_evt)->id || (c2h_evt)->plen) -+ -+extern u32 rtw_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *obj); -+extern struct cmd_obj *rtw_dequeue_cmd(struct cmd_priv *pcmdpriv); -+extern void rtw_free_cmd_obj(struct cmd_obj *pcmd); -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+extern u32 rtw_enqueue_evt(struct evt_priv *pevtpriv, struct evt_obj *obj); -+extern struct evt_obj *rtw_dequeue_evt(_queue *queue); -+extern void rtw_free_evt_obj(struct evt_obj *pcmd); -+#endif -+ -+thread_return rtw_cmd_thread(thread_context context); -+ -+extern u32 rtw_init_cmd_priv (struct cmd_priv *pcmdpriv); -+extern void rtw_free_cmd_priv (struct cmd_priv *pcmdpriv); -+ -+extern u32 rtw_init_evt_priv (struct evt_priv *pevtpriv); -+extern void rtw_free_evt_priv (struct evt_priv *pevtpriv); -+extern void rtw_cmd_clr_isr(struct cmd_priv *pcmdpriv); -+extern void rtw_evt_notify_isr(struct evt_priv *pevtpriv); -+#ifdef CONFIG_P2P -+u8 p2p_protocol_wk_cmd(_adapter*padapter, int intCmdType ); -+#endif //CONFIG_P2P -+ -+enum rtw_drvextra_cmd_id -+{ -+ NONE_WK_CID, -+ DYNAMIC_CHK_WK_CID, -+ DM_CTRL_WK_CID, -+ PBC_POLLING_WK_CID, -+ POWER_SAVING_CTRL_WK_CID,//IPS,AUTOSuspend -+ LPS_CTRL_WK_CID, -+ ANT_SELECT_WK_CID, -+ P2P_PS_WK_CID, -+ P2P_PROTO_WK_CID, -+ CHECK_HIQ_WK_CID,//for softap mode, check hi queue if empty -+ INTEl_WIDI_WK_CID, -+ C2H_WK_CID, -+ RTP_TIMER_CFG_WK_CID, -+ MAX_WK_CID -+}; -+ -+enum LPS_CTRL_TYPE -+{ -+ LPS_CTRL_SCAN=0, -+ LPS_CTRL_JOINBSS=1, -+ LPS_CTRL_CONNECT=2, -+ LPS_CTRL_DISCONNECT=3, -+ LPS_CTRL_SPECIAL_PACKET=4, -+ LPS_CTRL_LEAVE=5, -+}; -+ -+enum RFINTFS { -+ SWSI, -+ HWSI, -+ HWPI, -+}; -+ -+/* -+Caller Mode: Infra, Ad-HoC(C) -+ -+Notes: To enter USB suspend mode -+ -+Command Mode -+ -+*/ -+struct usb_suspend_parm { -+ u32 action;// 1: sleep, 0:resume -+}; -+ -+/* -+Caller Mode: Infra, Ad-HoC -+ -+Notes: To join a known BSS. -+ -+Command-Event Mode -+ -+*/ -+ -+/* -+Caller Mode: Infra, Ad-Hoc -+ -+Notes: To join the specified bss -+ -+Command Event Mode -+ -+*/ -+struct joinbss_parm { -+ WLAN_BSSID_EX network; -+}; -+ -+/* -+Caller Mode: Infra, Ad-HoC(C) -+ -+Notes: To disconnect the current associated BSS -+ -+Command Mode -+ -+*/ -+struct disconnect_parm { -+ u32 deauth_timeout_ms; -+}; -+ -+/* -+Caller Mode: AP, Ad-HoC(M) -+ -+Notes: To create a BSS -+ -+Command Mode -+*/ -+struct createbss_parm { -+ WLAN_BSSID_EX network; -+}; -+ -+/* -+Caller Mode: AP, Ad-HoC, Infra -+ -+Notes: To set the NIC mode of RTL8711 -+ -+Command Mode -+ -+The definition of mode: -+ -+#define IW_MODE_AUTO 0 // Let the driver decides which AP to join -+#define IW_MODE_ADHOC 1 // Single cell network (Ad-Hoc Clients) -+#define IW_MODE_INFRA 2 // Multi cell network, roaming, .. -+#define IW_MODE_MASTER 3 // Synchronisation master or Access Point -+#define IW_MODE_REPEAT 4 // Wireless Repeater (forwarder) -+#define IW_MODE_SECOND 5 // Secondary master/repeater (backup) -+#define IW_MODE_MONITOR 6 // Passive monitor (listen only) -+ -+*/ -+struct setopmode_parm { -+ u8 mode; -+ u8 rsvd[3]; -+}; -+ -+/* -+Caller Mode: AP, Ad-HoC, Infra -+ -+Notes: To ask RTL8711 performing site-survey -+ -+Command-Event Mode -+ -+*/ -+ -+#define RTW_SSID_SCAN_AMOUNT 9 // for WEXT_CSCAN_AMOUNT 9 -+#define RTW_CHANNEL_SCAN_AMOUNT (14+37) -+struct sitesurvey_parm { -+ sint scan_mode; //active: 1, passive: 0 -+ /* sint bsslimit; // 1 ~ 48 */ -+ u8 ssid_num; -+ u8 ch_num; -+ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; -+ struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To set the auth type of RTL8711. open/shared/802.1x -+ -+Command Mode -+ -+*/ -+struct setauth_parm { -+ u8 mode; //0: legacy open, 1: legacy shared 2: 802.1x -+ u8 _1x; //0: PSK, 1: TLS -+ u8 rsvd[2]; -+}; -+ -+/* -+Caller Mode: Infra -+ -+a. algorithm: wep40, wep104, tkip & aes -+b. keytype: grp key/unicast key -+c. key contents -+ -+when shared key ==> keyid is the camid -+when 802.1x ==> keyid [0:1] ==> grp key -+when 802.1x ==> keyid > 2 ==> unicast key -+ -+*/ -+struct setkey_parm { -+ u8 algorithm; // encryption algorithm, could be none, wep40, TKIP, CCMP, wep104 -+ u8 keyid; -+ u8 grpkey; // 1: this is the grpkey for 802.1x. 0: this is the unicast key for 802.1x -+ u8 set_tx; // 1: main tx key for wep. 0: other key. -+ u8 key[16]; // this could be 40 or 104 -+}; -+ -+/* -+When in AP or Ad-Hoc mode, this is used to -+allocate an sw/hw entry for a newly associated sta. -+ -+Command -+ -+when shared key ==> algorithm/keyid -+ -+*/ -+struct set_stakey_parm { -+ u8 addr[ETH_ALEN]; -+ u8 algorithm; -+ u8 id;// currently for erasing cam entry if algorithm == _NO_PRIVACY_ -+ u8 key[16]; -+}; -+ -+struct set_stakey_rsp { -+ u8 addr[ETH_ALEN]; -+ u8 keyid; -+ u8 rsvd; -+}; -+ -+/* -+Caller Ad-Hoc/AP -+ -+Command -Rsp(AID == CAMID) mode -+ -+This is to force fw to add an sta_data entry per driver's request. -+ -+FW will write an cam entry associated with it. -+ -+*/ -+struct set_assocsta_parm { -+ u8 addr[ETH_ALEN]; -+}; -+ -+struct set_assocsta_rsp { -+ u8 cam_id; -+ u8 rsvd[3]; -+}; -+ -+/* -+ Caller Ad-Hoc/AP -+ -+ Command mode -+ -+ This is to force fw to del an sta_data entry per driver's request -+ -+ FW will invalidate the cam entry associated with it. -+ -+*/ -+struct del_assocsta_parm { -+ u8 addr[ETH_ALEN]; -+}; -+ -+/* -+Caller Mode: AP/Ad-HoC(M) -+ -+Notes: To notify fw that given staid has changed its power state -+ -+Command Mode -+ -+*/ -+struct setstapwrstate_parm { -+ u8 staid; -+ u8 status; -+ u8 hwaddr[6]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To setup the basic rate of RTL8711 -+ -+Command Mode -+ -+*/ -+struct setbasicrate_parm { -+ u8 basicrates[NumRates]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To read the current basic rate -+ -+Command-Rsp Mode -+ -+*/ -+struct getbasicrate_parm { -+ u32 rsvd; -+}; -+ -+struct getbasicrate_rsp { -+ u8 basicrates[NumRates]; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To setup the data rate of RTL8711 -+ -+Command Mode -+ -+*/ -+struct setdatarate_parm { -+#ifdef MP_FIRMWARE_OFFLOAD -+ u32 curr_rateidx; -+#else -+ u8 mac_id; -+ u8 datarates[NumRates]; -+#endif -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To read the current data rate -+ -+Command-Rsp Mode -+ -+*/ -+struct getdatarate_parm { -+ u32 rsvd; -+ -+}; -+struct getdatarate_rsp { -+ u8 datarates[NumRates]; -+}; -+ -+ -+/* -+Caller Mode: Any -+AP: AP can use the info for the contents of beacon frame -+Infra: STA can use the info when sitesurveying -+Ad-HoC(M): Like AP -+Ad-HoC(C): Like STA -+ -+ -+Notes: To set the phy capability of the NIC -+ -+Command Mode -+ -+*/ -+ -+struct setphyinfo_parm { -+ struct regulatory_class class_sets[NUM_REGULATORYS]; -+ u8 status; -+}; -+ -+struct getphyinfo_parm { -+ u32 rsvd; -+}; -+ -+struct getphyinfo_rsp { -+ struct regulatory_class class_sets[NUM_REGULATORYS]; -+ u8 status; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To set the channel/modem/band -+This command will be used when channel/modem/band is changed. -+ -+Command Mode -+ -+*/ -+struct setphy_parm { -+ u8 rfchannel; -+ u8 modem; -+}; -+ -+/* -+Caller Mode: Any -+ -+Notes: To get the current setting of channel/modem/band -+ -+Command-Rsp Mode -+ -+*/ -+struct getphy_parm { -+ u32 rsvd; -+ -+}; -+struct getphy_rsp { -+ u8 rfchannel; -+ u8 modem; -+}; -+ -+struct readBB_parm { -+ u8 offset; -+}; -+struct readBB_rsp { -+ u8 value; -+}; -+ -+struct readTSSI_parm { -+ u8 offset; -+}; -+struct readTSSI_rsp { -+ u8 value; -+}; -+ -+struct writeBB_parm { -+ u8 offset; -+ u8 value; -+}; -+ -+struct readRF_parm { -+ u8 offset; -+}; -+struct readRF_rsp { -+ u32 value; -+}; -+ -+struct writeRF_parm { -+ u32 offset; -+ u32 value; -+}; -+ -+struct getrfintfs_parm { -+ u8 rfintfs; -+}; -+ -+ -+struct Tx_Beacon_param -+{ -+ WLAN_BSSID_EX network; -+}; -+ -+/* -+ Notes: This command is used for H2C/C2H loopback testing -+ -+ mac[0] == 0 -+ ==> CMD mode, return H2C_SUCCESS. -+ The following condition must be ture under CMD mode -+ mac[1] == mac[4], mac[2] == mac[3], mac[0]=mac[5]= 0; -+ s0 == 0x1234, s1 == 0xabcd, w0 == 0x78563412, w1 == 0x5aa5def7; -+ s2 == (b1 << 8 | b0); -+ -+ mac[0] == 1 -+ ==> CMD_RSP mode, return H2C_SUCCESS_RSP -+ -+ The rsp layout shall be: -+ rsp: parm: -+ mac[0] = mac[5]; -+ mac[1] = mac[4]; -+ mac[2] = mac[3]; -+ mac[3] = mac[2]; -+ mac[4] = mac[1]; -+ mac[5] = mac[0]; -+ s0 = s1; -+ s1 = swap16(s0); -+ w0 = swap32(w1); -+ b0 = b1 -+ s2 = s0 + s1 -+ b1 = b0 -+ w1 = w0 -+ -+ mac[0] == 2 -+ ==> CMD_EVENT mode, return H2C_SUCCESS -+ The event layout shall be: -+ event: parm: -+ mac[0] = mac[5]; -+ mac[1] = mac[4]; -+ mac[2] = event's sequence number, starting from 1 to parm's marc[3] -+ mac[3] = mac[2]; -+ mac[4] = mac[1]; -+ mac[5] = mac[0]; -+ s0 = swap16(s0) - event.mac[2]; -+ s1 = s1 + event.mac[2]; -+ w0 = swap32(w0); -+ b0 = b1 -+ s2 = s0 + event.mac[2] -+ b1 = b0 -+ w1 = swap32(w1) - event.mac[2]; -+ -+ parm->mac[3] is the total event counts that host requested. -+ -+ -+ event will be the same with the cmd's param. -+ -+*/ -+ -+#ifdef CONFIG_H2CLBK -+ -+struct seth2clbk_parm { -+ u8 mac[6]; -+ u16 s0; -+ u16 s1; -+ u32 w0; -+ u8 b0; -+ u16 s2; -+ u8 b1; -+ u32 w1; -+}; -+ -+struct geth2clbk_parm { -+ u32 rsv; -+}; -+ -+struct geth2clbk_rsp { -+ u8 mac[6]; -+ u16 s0; -+ u16 s1; -+ u32 w0; -+ u8 b0; -+ u16 s2; -+ u8 b1; -+ u32 w1; -+}; -+ -+#endif /* CONFIG_H2CLBK */ -+ -+// CMD param Formart for driver extra cmd handler -+struct drvextra_cmd_parm { -+ int ec_id; //extra cmd id -+ int type_size; // Can use this field as the type id or command size -+ unsigned char *pbuf; -+}; -+ -+/*------------------- Below are used for RF/BB tunning ---------------------*/ -+ -+struct setantenna_parm { -+ u8 tx_antset; -+ u8 rx_antset; -+ u8 tx_antenna; -+ u8 rx_antenna; -+}; -+ -+struct enrateadaptive_parm { -+ u32 en; -+}; -+ -+struct settxagctbl_parm { -+ u32 txagc[MAX_RATES_LENGTH]; -+}; -+ -+struct gettxagctbl_parm { -+ u32 rsvd; -+}; -+struct gettxagctbl_rsp { -+ u32 txagc[MAX_RATES_LENGTH]; -+}; -+ -+struct setagcctrl_parm { -+ u32 agcctrl; // 0: pure hw, 1: fw -+}; -+ -+ -+struct setssup_parm { -+ u32 ss_ForceUp[MAX_RATES_LENGTH]; -+}; -+ -+struct getssup_parm { -+ u32 rsvd; -+}; -+struct getssup_rsp { -+ u8 ss_ForceUp[MAX_RATES_LENGTH]; -+}; -+ -+ -+struct setssdlevel_parm { -+ u8 ss_DLevel[MAX_RATES_LENGTH]; -+}; -+ -+struct getssdlevel_parm { -+ u32 rsvd; -+}; -+struct getssdlevel_rsp { -+ u8 ss_DLevel[MAX_RATES_LENGTH]; -+}; -+ -+struct setssulevel_parm { -+ u8 ss_ULevel[MAX_RATES_LENGTH]; -+}; -+ -+struct getssulevel_parm { -+ u32 rsvd; -+}; -+struct getssulevel_rsp { -+ u8 ss_ULevel[MAX_RATES_LENGTH]; -+}; -+ -+ -+struct setcountjudge_parm { -+ u8 count_judge[MAX_RATES_LENGTH]; -+}; -+ -+struct getcountjudge_parm { -+ u32 rsvd; -+}; -+struct getcountjudge_rsp { -+ u8 count_judge[MAX_RATES_LENGTH]; -+}; -+ -+ -+struct setratable_parm { -+ u8 ss_ForceUp[NumRates]; -+ u8 ss_ULevel[NumRates]; -+ u8 ss_DLevel[NumRates]; -+ u8 count_judge[NumRates]; -+}; -+ -+struct getratable_parm { -+ uint rsvd; -+}; -+struct getratable_rsp { -+ u8 ss_ForceUp[NumRates]; -+ u8 ss_ULevel[NumRates]; -+ u8 ss_DLevel[NumRates]; -+ u8 count_judge[NumRates]; -+}; -+ -+ -+//to get TX,RX retry count -+struct gettxretrycnt_parm{ -+ unsigned int rsvd; -+}; -+struct gettxretrycnt_rsp{ -+ unsigned long tx_retrycnt; -+}; -+ -+struct getrxretrycnt_parm{ -+ unsigned int rsvd; -+}; -+struct getrxretrycnt_rsp{ -+ unsigned long rx_retrycnt; -+}; -+ -+//to get BCNOK,BCNERR count -+struct getbcnokcnt_parm{ -+ unsigned int rsvd; -+}; -+struct getbcnokcnt_rsp{ -+ unsigned long bcnokcnt; -+}; -+ -+struct getbcnerrcnt_parm{ -+ unsigned int rsvd; -+}; -+struct getbcnerrcnt_rsp{ -+ unsigned long bcnerrcnt; -+}; -+ -+// to get current TX power level -+struct getcurtxpwrlevel_parm{ -+ unsigned int rsvd; -+}; -+struct getcurtxpwrlevel_rsp{ -+ unsigned short tx_power; -+}; -+ -+struct setprobereqextraie_parm { -+ unsigned char e_id; -+ unsigned char ie_len; -+ unsigned char ie[0]; -+}; -+ -+struct setassocreqextraie_parm { -+ unsigned char e_id; -+ unsigned char ie_len; -+ unsigned char ie[0]; -+}; -+ -+struct setproberspextraie_parm { -+ unsigned char e_id; -+ unsigned char ie_len; -+ unsigned char ie[0]; -+}; -+ -+struct setassocrspextraie_parm { -+ unsigned char e_id; -+ unsigned char ie_len; -+ unsigned char ie[0]; -+}; -+ -+ -+struct addBaReq_parm -+{ -+ unsigned int tid; -+ u8 addr[ETH_ALEN]; -+}; -+ -+/*H2C Handler index: 46 */ -+struct set_ch_parm { -+ u8 ch; -+ u8 bw; -+ u8 ch_offset; -+}; -+ -+#ifdef MP_FIRMWARE_OFFLOAD -+/*H2C Handler index: 47 */ -+struct SetTxPower_parm -+{ -+ u8 TxPower; -+}; -+ -+/*H2C Handler index: 48 */ -+struct SwitchAntenna_parm -+{ -+ u16 antenna_tx; -+ u16 antenna_rx; -+// R_ANTENNA_SELECT_CCK cck_txrx; -+ u8 cck_txrx; -+}; -+ -+/*H2C Handler index: 49 */ -+struct SetCrystalCap_parm -+{ -+ u32 curr_crystalcap; -+}; -+ -+/*H2C Handler index: 50 */ -+struct SetSingleCarrierTx_parm -+{ -+ u8 bStart; -+}; -+ -+/*H2C Handler index: 51 */ -+struct SetSingleToneTx_parm -+{ -+ u8 bStart; -+ u8 curr_rfpath; -+}; -+ -+/*H2C Handler index: 52 */ -+struct SetCarrierSuppressionTx_parm -+{ -+ u8 bStart; -+ u32 curr_rateidx; -+}; -+ -+/*H2C Handler index: 53 */ -+struct SetContinuousTx_parm -+{ -+ u8 bStart; -+ u8 CCK_flag; /*1:CCK 2:OFDM*/ -+ u32 curr_rateidx; -+}; -+ -+/*H2C Handler index: 54 */ -+struct SwitchBandwidth_parm -+{ -+ u8 curr_bandwidth; -+}; -+ -+#endif /* MP_FIRMWARE_OFFLOAD */ -+ -+/*H2C Handler index: 59 */ -+struct SetChannelPlan_param -+{ -+ u8 channel_plan; -+}; -+ -+/*H2C Handler index: 60 */ -+struct LedBlink_param -+{ -+ void * pLed; -+}; -+ -+/*H2C Handler index: 61 */ -+struct SetChannelSwitch_param -+{ -+ u8 new_ch_no; -+}; -+ -+/*H2C Handler index: 62 */ -+struct TDLSoption_param -+{ -+ u8 addr[ETH_ALEN]; -+ u8 option; -+}; -+ -+#define GEN_CMD_CODE(cmd) cmd ## _CMD_ -+ -+ -+/* -+ -+Result: -+0x00: success -+0x01: sucess, and check Response. -+0x02: cmd ignored due to duplicated sequcne number -+0x03: cmd dropped due to invalid cmd code -+0x04: reserved. -+ -+*/ -+ -+#define H2C_RSP_OFFSET 512 -+ -+#define H2C_SUCCESS 0x00 -+#define H2C_SUCCESS_RSP 0x01 -+#define H2C_DUPLICATED 0x02 -+#define H2C_DROPPED 0x03 -+#define H2C_PARAMETERS_ERROR 0x04 -+#define H2C_REJECTED 0x05 -+#define H2C_CMD_OVERFLOW 0x06 -+#define H2C_RESERVED 0x07 -+ -+extern u8 rtw_setassocsta_cmd(_adapter *padapter, u8 *mac_addr); -+extern u8 rtw_setstandby_cmd(_adapter *padapter, uint action); -+u8 rtw_sitesurvey_cmd(_adapter *padapter, NDIS_802_11_SSID *ssid, int ssid_num, struct rtw_ieee80211_channel *ch, int ch_num); -+extern u8 rtw_createbss_cmd(_adapter *padapter); -+extern u8 rtw_createbss_cmd_ex(_adapter *padapter, unsigned char *pbss, unsigned int sz); -+extern u8 rtw_setphy_cmd(_adapter *padapter, u8 modem, u8 ch); -+extern u8 rtw_setstakey_cmd(_adapter *padapter, u8 *psta, u8 unicast_key); -+extern u8 rtw_clearstakey_cmd(_adapter *padapter, u8 *psta, u8 entry, u8 enqueue); -+extern u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network* pnetwork); -+u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, bool enqueue); -+extern u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype); -+extern u8 rtw_setdatarate_cmd(_adapter *padapter, u8 *rateset); -+extern u8 rtw_setbasicrate_cmd(_adapter *padapter, u8 *rateset); -+extern u8 rtw_setbbreg_cmd(_adapter * padapter, u8 offset, u8 val); -+extern u8 rtw_setrfreg_cmd(_adapter * padapter, u8 offset, u32 val); -+extern u8 rtw_getbbreg_cmd(_adapter * padapter, u8 offset, u8 * pval); -+extern u8 rtw_getrfreg_cmd(_adapter * padapter, u8 offset, u8 * pval); -+extern u8 rtw_setrfintfs_cmd(_adapter *padapter, u8 mode); -+extern u8 rtw_setrttbl_cmd(_adapter *padapter, struct setratable_parm *prate_table); -+extern u8 rtw_getrttbl_cmd(_adapter *padapter, struct getratable_rsp *pval); -+ -+extern u8 rtw_gettssi_cmd(_adapter *padapter, u8 offset,u8 *pval); -+extern u8 rtw_setfwdig_cmd(_adapter*padapter, u8 type); -+extern u8 rtw_setfwra_cmd(_adapter*padapter, u8 type); -+ -+extern u8 rtw_addbareq_cmd(_adapter*padapter, u8 tid, u8 *addr); -+ -+extern u8 rtw_dynamic_chk_wk_cmd(_adapter *adapter); -+ -+u8 rtw_lps_ctrl_wk_cmd(_adapter*padapter, u8 lps_ctrl_type, u8 enqueue); -+#if (RATE_ADAPTIVE_SUPPORT==1) -+u8 rtw_rpt_timer_cfg_cmd(_adapter*padapter, u16 minRptTime); -+#endif -+ -+#ifdef CONFIG_ANTENNA_DIVERSITY -+extern u8 rtw_antenna_select_cmd(_adapter*padapter, u8 antenna,u8 enqueue); -+#endif -+ -+extern u8 rtw_ps_cmd(_adapter*padapter); -+ -+#ifdef CONFIG_AP_MODE -+u8 rtw_chk_hi_queue_cmd(_adapter*padapter); -+#endif -+ -+u8 rtw_set_ch_cmd(_adapter*padapter, u8 ch, u8 bw, u8 ch_offset, u8 enqueue); -+extern u8 rtw_set_chplan_cmd(_adapter*padapter, u8 chplan, u8 enqueue); -+extern u8 rtw_led_blink_cmd(_adapter*padapter, void * pLed); -+extern u8 rtw_set_csa_cmd(_adapter*padapter, u8 new_ch_no); -+extern u8 rtw_tdls_cmd(_adapter*padapter, u8 *addr, u8 option); -+ -+extern u8 rtw_c2h_wk_cmd(PADAPTER padapter, u8 *c2h_evt); -+ -+u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf); -+ -+extern void rtw_survey_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_disassoc_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_joinbss_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_createbss_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_getbbrfreg_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_readtssi_cmdrsp_callback(_adapter* padapter, struct cmd_obj *pcmd); -+ -+extern void rtw_setstaKey_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_setassocsta_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+extern void rtw_getrttbl_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd); -+ -+ -+struct _cmd_callback { -+ u32 cmd_code; -+ void (*callback)(_adapter *padapter, struct cmd_obj *cmd); -+}; -+ -+enum rtw_h2c_cmd -+{ -+ GEN_CMD_CODE(_Read_MACREG) , /*0*/ -+ GEN_CMD_CODE(_Write_MACREG) , -+ GEN_CMD_CODE(_Read_BBREG) , -+ GEN_CMD_CODE(_Write_BBREG) , -+ GEN_CMD_CODE(_Read_RFREG) , -+ GEN_CMD_CODE(_Write_RFREG) , /*5*/ -+ GEN_CMD_CODE(_Read_EEPROM) , -+ GEN_CMD_CODE(_Write_EEPROM) , -+ GEN_CMD_CODE(_Read_EFUSE) , -+ GEN_CMD_CODE(_Write_EFUSE) , -+ -+ GEN_CMD_CODE(_Read_CAM) , /*10*/ -+ GEN_CMD_CODE(_Write_CAM) , -+ GEN_CMD_CODE(_setBCNITV), -+ GEN_CMD_CODE(_setMBIDCFG), -+ GEN_CMD_CODE(_JoinBss), /*14*/ -+ GEN_CMD_CODE(_DisConnect) , /*15*/ -+ GEN_CMD_CODE(_CreateBss) , -+ GEN_CMD_CODE(_SetOpMode) , -+ GEN_CMD_CODE(_SiteSurvey), /*18*/ -+ GEN_CMD_CODE(_SetAuth) , -+ -+ GEN_CMD_CODE(_SetKey) , /*20*/ -+ GEN_CMD_CODE(_SetStaKey) , -+ GEN_CMD_CODE(_SetAssocSta) , -+ GEN_CMD_CODE(_DelAssocSta) , -+ GEN_CMD_CODE(_SetStaPwrState) , -+ GEN_CMD_CODE(_SetBasicRate) , /*25*/ -+ GEN_CMD_CODE(_GetBasicRate) , -+ GEN_CMD_CODE(_SetDataRate) , -+ GEN_CMD_CODE(_GetDataRate) , -+ GEN_CMD_CODE(_SetPhyInfo) , -+ -+ GEN_CMD_CODE(_GetPhyInfo) , /*30*/ -+ GEN_CMD_CODE(_SetPhy) , -+ GEN_CMD_CODE(_GetPhy) , -+ GEN_CMD_CODE(_readRssi) , -+ GEN_CMD_CODE(_readGain) , -+ GEN_CMD_CODE(_SetAtim) , /*35*/ -+ GEN_CMD_CODE(_SetPwrMode) , -+ GEN_CMD_CODE(_JoinbssRpt), -+ GEN_CMD_CODE(_SetRaTable) , -+ GEN_CMD_CODE(_GetRaTable) , -+ -+ GEN_CMD_CODE(_GetCCXReport), /*40*/ -+ GEN_CMD_CODE(_GetDTMReport), -+ GEN_CMD_CODE(_GetTXRateStatistics), -+ GEN_CMD_CODE(_SetUsbSuspend), -+ GEN_CMD_CODE(_SetH2cLbk), -+ GEN_CMD_CODE(_AddBAReq) , /*45*/ -+ GEN_CMD_CODE(_SetChannel), /*46*/ -+ GEN_CMD_CODE(_SetTxPower), -+ GEN_CMD_CODE(_SwitchAntenna), -+ GEN_CMD_CODE(_SetCrystalCap), -+ GEN_CMD_CODE(_SetSingleCarrierTx), /*50*/ -+ -+ GEN_CMD_CODE(_SetSingleToneTx),/*51*/ -+ GEN_CMD_CODE(_SetCarrierSuppressionTx), -+ GEN_CMD_CODE(_SetContinuousTx), -+ GEN_CMD_CODE(_SwitchBandwidth), /*54*/ -+ GEN_CMD_CODE(_TX_Beacon), /*55*/ -+ -+ GEN_CMD_CODE(_Set_MLME_EVT), /*56*/ -+ GEN_CMD_CODE(_Set_Drv_Extra), /*57*/ -+ GEN_CMD_CODE(_Set_H2C_MSG), /*58*/ -+ -+ GEN_CMD_CODE(_SetChannelPlan), /*59*/ -+ GEN_CMD_CODE(_LedBlink), /*60*/ -+ -+ GEN_CMD_CODE(_SetChannelSwitch), /*61*/ -+ GEN_CMD_CODE(_TDLS), /*62*/ -+ -+ MAX_H2CCMD -+}; -+ -+#define _GetBBReg_CMD_ _Read_BBREG_CMD_ -+#define _SetBBReg_CMD_ _Write_BBREG_CMD_ -+#define _GetRFReg_CMD_ _Read_RFREG_CMD_ -+#define _SetRFReg_CMD_ _Write_RFREG_CMD_ -+ -+#ifdef _RTW_CMD_C_ -+static struct _cmd_callback rtw_cmd_callback[] = -+{ -+ {GEN_CMD_CODE(_Read_MACREG), NULL}, /*0*/ -+ {GEN_CMD_CODE(_Write_MACREG), NULL}, -+ {GEN_CMD_CODE(_Read_BBREG), &rtw_getbbrfreg_cmdrsp_callback}, -+ {GEN_CMD_CODE(_Write_BBREG), NULL}, -+ {GEN_CMD_CODE(_Read_RFREG), &rtw_getbbrfreg_cmdrsp_callback}, -+ {GEN_CMD_CODE(_Write_RFREG), NULL}, /*5*/ -+ {GEN_CMD_CODE(_Read_EEPROM), NULL}, -+ {GEN_CMD_CODE(_Write_EEPROM), NULL}, -+ {GEN_CMD_CODE(_Read_EFUSE), NULL}, -+ {GEN_CMD_CODE(_Write_EFUSE), NULL}, -+ -+ {GEN_CMD_CODE(_Read_CAM), NULL}, /*10*/ -+ {GEN_CMD_CODE(_Write_CAM), NULL}, -+ {GEN_CMD_CODE(_setBCNITV), NULL}, -+ {GEN_CMD_CODE(_setMBIDCFG), NULL}, -+ {GEN_CMD_CODE(_JoinBss), &rtw_joinbss_cmd_callback}, /*14*/ -+ {GEN_CMD_CODE(_DisConnect), &rtw_disassoc_cmd_callback}, /*15*/ -+ {GEN_CMD_CODE(_CreateBss), &rtw_createbss_cmd_callback}, -+ {GEN_CMD_CODE(_SetOpMode), NULL}, -+ {GEN_CMD_CODE(_SiteSurvey), &rtw_survey_cmd_callback}, /*18*/ -+ {GEN_CMD_CODE(_SetAuth), NULL}, -+ -+ {GEN_CMD_CODE(_SetKey), NULL}, /*20*/ -+ {GEN_CMD_CODE(_SetStaKey), &rtw_setstaKey_cmdrsp_callback}, -+ {GEN_CMD_CODE(_SetAssocSta), &rtw_setassocsta_cmdrsp_callback}, -+ {GEN_CMD_CODE(_DelAssocSta), NULL}, -+ {GEN_CMD_CODE(_SetStaPwrState), NULL}, -+ {GEN_CMD_CODE(_SetBasicRate), NULL}, /*25*/ -+ {GEN_CMD_CODE(_GetBasicRate), NULL}, -+ {GEN_CMD_CODE(_SetDataRate), NULL}, -+ {GEN_CMD_CODE(_GetDataRate), NULL}, -+ {GEN_CMD_CODE(_SetPhyInfo), NULL}, -+ -+ {GEN_CMD_CODE(_GetPhyInfo), NULL}, /*30*/ -+ {GEN_CMD_CODE(_SetPhy), NULL}, -+ {GEN_CMD_CODE(_GetPhy), NULL}, -+ {GEN_CMD_CODE(_readRssi), NULL}, -+ {GEN_CMD_CODE(_readGain), NULL}, -+ {GEN_CMD_CODE(_SetAtim), NULL}, /*35*/ -+ {GEN_CMD_CODE(_SetPwrMode), NULL}, -+ {GEN_CMD_CODE(_JoinbssRpt), NULL}, -+ {GEN_CMD_CODE(_SetRaTable), NULL}, -+ {GEN_CMD_CODE(_GetRaTable) , NULL}, -+ -+ {GEN_CMD_CODE(_GetCCXReport), NULL}, /*40*/ -+ {GEN_CMD_CODE(_GetDTMReport), NULL}, -+ {GEN_CMD_CODE(_GetTXRateStatistics), NULL}, -+ {GEN_CMD_CODE(_SetUsbSuspend), NULL}, -+ {GEN_CMD_CODE(_SetH2cLbk), NULL}, -+ {GEN_CMD_CODE(_AddBAReq), NULL}, /*45*/ -+ {GEN_CMD_CODE(_SetChannel), NULL}, /*46*/ -+ {GEN_CMD_CODE(_SetTxPower), NULL}, -+ {GEN_CMD_CODE(_SwitchAntenna), NULL}, -+ {GEN_CMD_CODE(_SetCrystalCap), NULL}, -+ {GEN_CMD_CODE(_SetSingleCarrierTx), NULL}, /*50*/ -+ -+ {GEN_CMD_CODE(_SetSingleToneTx), NULL}, /*51*/ -+ {GEN_CMD_CODE(_SetCarrierSuppressionTx), NULL}, -+ {GEN_CMD_CODE(_SetContinuousTx), NULL}, -+ {GEN_CMD_CODE(_SwitchBandwidth), NULL}, /*54*/ -+ {GEN_CMD_CODE(_TX_Beacon), NULL},/*55*/ -+ -+ {GEN_CMD_CODE(_Set_MLME_EVT), NULL},/*56*/ -+ {GEN_CMD_CODE(_Set_Drv_Extra), NULL},/*57*/ -+ {GEN_CMD_CODE(_Set_H2C_MSG), NULL},/*58*/ -+ {GEN_CMD_CODE(_SetChannelPlan), NULL},/*59*/ -+ {GEN_CMD_CODE(_LedBlink), NULL},/*60*/ -+ -+ {GEN_CMD_CODE(_SetChannelSwitch), NULL},/*61*/ -+ {GEN_CMD_CODE(_TDLS), NULL},/*62*/ -+}; -+#endif -+ -+#endif // _CMD_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_debug.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_debug.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_debug.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_debug.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,412 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_DEBUG_H__ -+#define __RTW_DEBUG_H__ -+ -+ -+#define _drv_always_ 1 -+#define _drv_emerg_ 2 -+#define _drv_alert_ 3 -+#define _drv_crit_ 4 -+#define _drv_err_ 5 -+#define _drv_warning_ 6 -+#define _drv_notice_ 7 -+#define _drv_info_ 8 -+#define _drv_dump_ 9 -+#define _drv_debug_ 10 -+ -+ -+#define _module_rtl871x_xmit_c_ BIT(0) -+#define _module_xmit_osdep_c_ BIT(1) -+#define _module_rtl871x_recv_c_ BIT(2) -+#define _module_recv_osdep_c_ BIT(3) -+#define _module_rtl871x_mlme_c_ BIT(4) -+#define _module_mlme_osdep_c_ BIT(5) -+#define _module_rtl871x_sta_mgt_c_ BIT(6) -+#define _module_rtl871x_cmd_c_ BIT(7) -+#define _module_cmd_osdep_c_ BIT(8) -+#define _module_rtl871x_io_c_ BIT(9) -+#define _module_io_osdep_c_ BIT(10) -+#define _module_os_intfs_c_ BIT(11) -+#define _module_rtl871x_security_c_ BIT(12) -+#define _module_rtl871x_eeprom_c_ BIT(13) -+#define _module_hal_init_c_ BIT(14) -+#define _module_hci_hal_init_c_ BIT(15) -+#define _module_rtl871x_ioctl_c_ BIT(16) -+#define _module_rtl871x_ioctl_set_c_ BIT(17) -+#define _module_rtl871x_ioctl_query_c_ BIT(18) -+#define _module_rtl871x_pwrctrl_c_ BIT(19) -+#define _module_hci_intfs_c_ BIT(20) -+#define _module_hci_ops_c_ BIT(21) -+#define _module_osdep_service_c_ BIT(22) -+#define _module_mp_ BIT(23) -+#define _module_hci_ops_os_c_ BIT(24) -+#define _module_rtl871x_ioctl_os_c BIT(25) -+#define _module_rtl8712_cmd_c_ BIT(26) -+//#define _module_efuse_ BIT(27) -+#define _module_rtl8192c_xmit_c_ BIT(28) -+#define _module_hal_xmit_c_ BIT(28) -+#define _module_efuse_ BIT(29) -+#define _module_rtl8712_recv_c_ BIT(30) -+#define _module_rtl8712_led_c_ BIT(31) -+ -+#undef _MODULE_DEFINE_ -+ -+#if defined _RTW_XMIT_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_xmit_c_ -+#elif defined _XMIT_OSDEP_C_ -+ #define _MODULE_DEFINE_ _module_xmit_osdep_c_ -+#elif defined _RTW_RECV_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_recv_c_ -+#elif defined _RECV_OSDEP_C_ -+ #define _MODULE_DEFINE_ _module_recv_osdep_c_ -+#elif defined _RTW_MLME_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_mlme_c_ -+#elif defined _MLME_OSDEP_C_ -+ #define _MODULE_DEFINE_ _module_mlme_osdep_c_ -+#elif defined _RTW_MLME_EXT_C_ -+ #define _MODULE_DEFINE_ 1 -+#elif defined _RTW_STA_MGT_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_sta_mgt_c_ -+#elif defined _RTW_CMD_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_cmd_c_ -+#elif defined _CMD_OSDEP_C_ -+ #define _MODULE_DEFINE_ _module_cmd_osdep_c_ -+#elif defined _RTW_IO_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_io_c_ -+#elif defined _IO_OSDEP_C_ -+ #define _MODULE_DEFINE_ _module_io_osdep_c_ -+#elif defined _OS_INTFS_C_ -+ #define _MODULE_DEFINE_ _module_os_intfs_c_ -+#elif defined _RTW_SECURITY_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_security_c_ -+#elif defined _RTW_EEPROM_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_eeprom_c_ -+#elif defined _HAL_INTF_C_ -+ #define _MODULE_DEFINE_ _module_hal_init_c_ -+#elif (defined _HCI_HAL_INIT_C_) || (defined _SDIO_HALINIT_C_) -+ #define _MODULE_DEFINE_ _module_hci_hal_init_c_ -+#elif defined _RTL871X_IOCTL_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_ioctl_c_ -+#elif defined _RTL871X_IOCTL_SET_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_ioctl_set_c_ -+#elif defined _RTL871X_IOCTL_QUERY_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_ioctl_query_c_ -+#elif defined _RTL871X_PWRCTRL_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_pwrctrl_c_ -+#elif defined _RTW_PWRCTRL_C_ -+ #define _MODULE_DEFINE_ 1 -+#elif defined _HCI_INTF_C_ -+ #define _MODULE_DEFINE_ _module_hci_intfs_c_ -+#elif defined _HCI_OPS_C_ -+ #define _MODULE_DEFINE_ _module_hci_ops_c_ -+#elif defined _SDIO_OPS_C_ -+ #define _MODULE_DEFINE_ 1 -+#elif defined _OSDEP_HCI_INTF_C_ -+ #define _MODULE_DEFINE_ _module_hci_intfs_c_ -+#elif defined _OSDEP_SERVICE_C_ -+ #define _MODULE_DEFINE_ _module_osdep_service_c_ -+#elif defined _HCI_OPS_OS_C_ -+ #define _MODULE_DEFINE_ _module_hci_ops_os_c_ -+#elif defined _RTL871X_IOCTL_LINUX_C_ -+ #define _MODULE_DEFINE_ _module_rtl871x_ioctl_os_c -+#elif defined _RTL8712_CMD_C_ -+ #define _MODULE_DEFINE_ _module_rtl8712_cmd_c_ -+#elif defined _RTL8192C_XMIT_C_ -+ #define _MODULE_DEFINE_ 1 -+#elif defined _RTL8723AS_XMIT_C_ -+ #define _MODULE_DEFINE_ 1 -+#elif defined _RTL8712_RECV_C_ -+ #define _MODULE_DEFINE_ _module_rtl8712_recv_c_ -+#elif defined _RTL8192CU_RECV_C_ -+ #define _MODULE_DEFINE_ _module_rtl8712_recv_c_ -+#elif defined _RTL871X_MLME_EXT_C_ -+ #define _MODULE_DEFINE_ _module_mlme_osdep_c_ -+#elif defined _RTW_MP_C_ -+ #define _MODULE_DEFINE_ _module_mp_ -+#elif defined _RTW_MP_IOCTL_C_ -+ #define _MODULE_DEFINE_ _module_mp_ -+#elif defined _RTW_EFUSE_C_ -+ #define _MODULE_DEFINE_ _module_efuse_ -+#endif -+ -+#define RT_TRACE(_Comp, _Level, Fmt) do{}while(0) -+#define RT_PRINT_DATA(_Comp, _Level, _TitleString, _HexData, _HexDataLen) do{}while(0) -+ -+ #define DBG_871X(x, ...) do {} while(0) -+ #define MSG_8192C(x, ...) do {} while(0) -+ #define DBG_8192C(x,...) do {} while(0) -+ #define DBG_871X_LEVEL(x,...) do {} while(0) -+ -+#undef _dbgdump -+ #define _dbgdump printk -+ -+#define DRIVER_PREFIX "RTL8812: " -+#define DEBUG_LEVEL (_drv_err_) -+#if defined (_dbgdump) -+ #undef DBG_871X_LEVEL -+ #define DBG_871X_LEVEL(level, fmt, arg...) \ -+ do {\ -+ if (level <= DEBUG_LEVEL) {\ -+ if (level <= _drv_err_ && level > _drv_always_) \ -+ _dbgdump(DRIVER_PREFIX"ERROR " fmt, ##arg);\ -+ else \ -+ _dbgdump(DRIVER_PREFIX fmt, ##arg);\ -+ }\ -+ }while(0) -+#endif -+ -+#ifdef CONFIG_DEBUG -+#if defined (_dbgdump) -+ #undef DBG_871X -+ #define DBG_871X(...) do {\ -+ _dbgdump(DRIVER_PREFIX __VA_ARGS__);\ -+ }while(0) -+ -+ #undef MSG_8192C -+ #define MSG_8192C(...) do {\ -+ _dbgdump(DRIVER_PREFIX __VA_ARGS__);\ -+ }while(0) -+ -+ #undef DBG_8192C -+ #define DBG_8192C(...) do {\ -+ _dbgdump(DRIVER_PREFIX __VA_ARGS__);\ -+ }while(0) -+#endif -+#endif /* CONFIG_DEBUG */ -+ -+#ifdef CONFIG_DEBUG_RTL871X -+#ifndef _RTL871X_DEBUG_C_ -+ extern u32 GlobalDebugLevel; -+ extern u64 GlobalDebugComponents; -+#endif -+ -+#if defined (_dbgdump) && defined (_MODULE_DEFINE_) -+ -+ #undef RT_TRACE -+ #define RT_TRACE(_Comp, _Level, Fmt)\ -+ do {\ -+ if((_Comp & GlobalDebugComponents) && (_Level <= GlobalDebugLevel)) {\ -+ _dbgdump("%s [0x%08x,%d]", DRIVER_PREFIX, (unsigned int)_Comp, _Level);\ -+ _dbgdump Fmt;\ -+ }\ -+ }while(0) -+ -+#endif -+ -+ -+#if defined (_dbgdump) -+ #undef RT_PRINT_DATA -+ #define RT_PRINT_DATA(_Comp, _Level, _TitleString, _HexData, _HexDataLen) \ -+ if(((_Comp) & GlobalDebugComponents) && (_Level <= GlobalDebugLevel)) \ -+ { \ -+ int __i; \ -+ u8 *ptr = (u8 *)_HexData; \ -+ _dbgdump("%s", DRIVER_PREFIX); \ -+ _dbgdump(_TitleString); \ -+ for( __i=0; __i<(int)_HexDataLen; __i++ ) \ -+ { \ -+ _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0)?" ":" "); \ -+ if (((__i + 1) % 16) == 0) _dbgdump("\n"); \ -+ } \ -+ _dbgdump("\n"); \ -+ } -+#endif -+#endif /* CONFIG_DEBUG_RTL871X */ -+ -+ -+#ifdef CONFIG_PROC_DEBUG -+ -+ int proc_get_drv_version(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_write_reg(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_set_write_reg(struct file *file, const char *buffer, -+ unsigned long count, void *data); -+ -+ int proc_get_read_reg(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_set_read_reg(struct file *file, const char *buffer, -+ unsigned long count, void *data); -+ -+ -+ int proc_get_fwstate(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_sec_info(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_mlmext_state(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_qos_option(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_ht_option(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_rf_info(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_ap_info(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_adapter_state(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_trx_info(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_mac_reg_dump1(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_mac_reg_dump2(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_mac_reg_dump3(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_bb_reg_dump1(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_bb_reg_dump2(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_bb_reg_dump3(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_rf_reg_dump1(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_rf_reg_dump2(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_rf_reg_dump3(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_rf_reg_dump4(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+#ifdef CONFIG_AP_MODE -+ -+ int proc_get_all_sta_info(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+#endif -+ -+#ifdef DBG_MEMORY_LEAK -+ int proc_get_malloc_cnt(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+#endif -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ int proc_get_best_channel(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+#endif -+ -+ int proc_get_rx_signal(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_set_rx_signal(struct file *file, const char *buffer, -+ unsigned long count, void *data); -+#ifdef CONFIG_80211N_HT -+ -+ int proc_get_ht_enable(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_set_ht_enable(struct file *file, const char *buffer, -+ unsigned long count, void *data); -+ -+ int proc_get_bw_mode(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_set_bw_mode(struct file *file, const char *buffer, -+ unsigned long count, void *data); -+ -+ int proc_get_ampdu_enable(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_set_ampdu_enable(struct file *file, const char *buffer, -+ unsigned long count, void *data); -+ -+ int proc_get_rx_stbc(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_set_rx_stbc(struct file *file, const char *buffer, -+ unsigned long count, void *data); -+#endif //CONFIG_80211N_HT -+ -+ int proc_get_two_path_rssi(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_get_rssi_disp(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_set_rssi_disp(struct file *file, const char *buffer, -+ unsigned long count, void *data); -+ -+#ifdef CONFIG_BT_COEXIST -+ int proc_get_btcoex_dbg(char *page, char **start, -+ off_t offset, int count, -+ int *eof, void *data); -+ -+ int proc_set_btcoex_dbg(struct file *file, const char *buffer, -+ unsigned long count, void *data); -+ -+#endif //CONFIG_BT_COEXIST -+ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+int proc_get_sreset(char *page, char **start, off_t offset, int count, int *eof, void *data); -+int proc_set_sreset(struct file *file, const char *buffer, unsigned long count, void *data); -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ -+#endif //CONFIG_PROC_DEBUG -+ -+#endif //__RTW_DEBUG_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_eeprom.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_eeprom.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_eeprom.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_eeprom.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,128 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_EEPROM_H__ -+#define __RTW_EEPROM_H__ -+ -+ -+#define RTL8712_EEPROM_ID 0x8712 -+//#define EEPROM_MAX_SIZE 256 -+ -+#define HWSET_MAX_SIZE_128 128 -+#define HWSET_MAX_SIZE_256 256 -+#define HWSET_MAX_SIZE_512 512 -+ -+#define EEPROM_MAX_SIZE HWSET_MAX_SIZE_512 -+ -+#define CLOCK_RATE 50 //100us -+ -+//- EEPROM opcodes -+#define EEPROM_READ_OPCODE 06 -+#define EEPROM_WRITE_OPCODE 05 -+#define EEPROM_ERASE_OPCODE 07 -+#define EEPROM_EWEN_OPCODE 19 // Erase/write enable -+#define EEPROM_EWDS_OPCODE 16 // Erase/write disable -+ -+//Country codes -+#define USA 0x555320 -+#define EUROPE 0x1 //temp, should be provided later -+#define JAPAN 0x2 //temp, should be provided later -+ -+// -+// Customer ID, note that: -+// This variable is initiailzed through EEPROM or registry, -+// however, its definition may be different with that in EEPROM for -+// EEPROM size consideration. So, we have to perform proper translation between them. -+// Besides, CustomerID of registry has precedence of that of EEPROM. -+// defined below. 060703, by rcnjko. -+// -+typedef enum _RT_CUSTOMER_ID -+{ -+ RT_CID_DEFAULT = 0, -+ RT_CID_8187_ALPHA0 = 1, -+ RT_CID_8187_SERCOMM_PS = 2, -+ RT_CID_8187_HW_LED = 3, -+ RT_CID_8187_NETGEAR = 4, -+ RT_CID_WHQL = 5, -+ RT_CID_819x_CAMEO = 6, -+ RT_CID_819x_RUNTOP = 7, -+ RT_CID_819x_Senao = 8, -+ RT_CID_TOSHIBA = 9, // Merge by Jacken, 2008/01/31. -+ RT_CID_819x_Netcore = 10, -+ RT_CID_Nettronix = 11, -+ RT_CID_DLINK = 12, -+ RT_CID_PRONET = 13, -+ RT_CID_COREGA = 14, -+ RT_CID_CHINA_MOBILE = 15, -+ RT_CID_819x_ALPHA = 16, -+ RT_CID_819x_Sitecom = 17, -+ RT_CID_CCX = 18, // It's set under CCX logo test and isn't demanded for CCX functions, but for test behavior like retry limit and tx report. By Bruce, 2009-02-17. -+ RT_CID_819x_Lenovo = 19, -+ RT_CID_819x_QMI = 20, -+ RT_CID_819x_Edimax_Belkin = 21, -+ RT_CID_819x_Sercomm_Belkin = 22, -+ RT_CID_819x_CAMEO1 = 23, -+ RT_CID_819x_MSI = 24, -+ RT_CID_819x_Acer = 25, -+ RT_CID_819x_AzWave_ASUS = 26, -+ RT_CID_819x_AzWave = 27, // For AzWave in PCIe, The ID is AzWave use and not only Asus -+ RT_CID_819x_HP = 28, -+ RT_CID_819x_WNC_COREGA = 29, -+ RT_CID_819x_Arcadyan_Belkin = 30, -+ RT_CID_819x_SAMSUNG = 31, -+ RT_CID_819x_CLEVO = 32, -+ RT_CID_819x_DELL = 33, -+ RT_CID_819x_PRONETS = 34, -+ RT_CID_819x_Edimax_ASUS = 35, -+ RT_CID_NETGEAR = 36, -+ RT_CID_PLANEX = 37, -+ RT_CID_CC_C = 38, -+ RT_CID_819x_Xavi = 39, -+ RT_CID_LENOVO_CHINA = 40, -+ RT_CID_INTEL_CHINA = 41, -+ RT_CID_TPLINK_HPWR = 42, -+ RT_CID_819x_Sercomm_Netgear = 43, -+ RT_CID_819x_ALPHA_Dlink = 44,//add by ylb 20121012 for customer led for alpha -+ RT_CID_WNC_NEC = 45,//add by page for NEC -+}RT_CUSTOMER_ID, *PRT_CUSTOMER_ID; -+ -+struct eeprom_priv -+{ -+ u8 bautoload_fail_flag; -+ u8 bloadfile_fail_flag; -+ u8 bloadmac_fail_flag; -+ u8 EepromOrEfuse; -+ -+ u8 mac_addr[6]; //PermanentAddress -+ -+ u16 channel_plan; -+ u16 CustomerID; -+ -+ u8 efuse_eeprom_data[EEPROM_MAX_SIZE]; //92C:256bytes, 88E:512bytes, we use union set (512bytes) -+}; -+ -+extern void eeprom_write16(_adapter *padapter, u16 reg, u16 data); -+extern u16 eeprom_read16(_adapter *padapter, u16 reg); -+extern void read_eeprom_content(_adapter *padapter); -+extern void eeprom_read_sz(_adapter * padapter, u16 reg,u8* data, u32 sz); -+ -+extern void read_eeprom_content_by_attrib(_adapter * padapter ); -+ -+#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+extern int isAdaptorInfoFileValid(void); -+extern int storeAdaptorInfoFile(char *path, struct eeprom_priv * eeprom_priv); -+extern int retriveAdaptorInfoFile(char *path, struct eeprom_priv * eeprom_priv); -+#endif //CONFIG_ADAPTOR_INFO_CACHING_FILE -+ -+#endif //__RTL871X_EEPROM_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_efuse.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_efuse.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_efuse.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_efuse.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,137 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_EFUSE_H__ -+#define __RTW_EFUSE_H__ -+ -+ -+#define EFUSE_ERROE_HANDLE 1 -+ -+#define PG_STATE_HEADER 0x01 -+#define PG_STATE_WORD_0 0x02 -+#define PG_STATE_WORD_1 0x04 -+#define PG_STATE_WORD_2 0x08 -+#define PG_STATE_WORD_3 0x10 -+#define PG_STATE_DATA 0x20 -+ -+#define PG_SWBYTE_H 0x01 -+#define PG_SWBYTE_L 0x02 -+ -+#define PGPKT_DATA_SIZE 8 -+ -+#define EFUSE_WIFI 0 -+#define EFUSE_BT 1 -+ -+enum _EFUSE_DEF_TYPE { -+ TYPE_EFUSE_MAX_SECTION = 0, -+ TYPE_EFUSE_REAL_CONTENT_LEN = 1, -+ TYPE_AVAILABLE_EFUSE_BYTES_BANK = 2, -+ TYPE_AVAILABLE_EFUSE_BYTES_TOTAL = 3, -+ TYPE_EFUSE_MAP_LEN = 4, -+ TYPE_EFUSE_PROTECT_BYTES_BANK = 5, -+ TYPE_EFUSE_CONTENT_LEN_BANK = 6, -+}; -+ -+#define EFUSE_MAX_MAP_LEN 256 -+#define EFUSE_MAX_HW_SIZE 512 -+#define EFUSE_MAX_SECTION_BASE 16 -+ -+#define EXT_HEADER(header) ((header & 0x1F ) == 0x0F) -+#define ALL_WORDS_DISABLED(wde) ((wde & 0x0F) == 0x0F) -+#define GET_HDR_OFFSET_2_0(header) ( (header & 0xE0) >> 5) -+ -+#define EFUSE_REPEAT_THRESHOLD_ 3 -+ -+//============================================= -+// The following is for BT Efuse definition -+//============================================= -+#define EFUSE_BT_MAX_MAP_LEN 1024 -+#define EFUSE_MAX_BANK 4 -+#define EFUSE_MAX_BT_BANK (EFUSE_MAX_BANK-1) -+//============================================= -+/*--------------------------Define Parameters-------------------------------*/ -+#define EFUSE_MAX_WORD_UNIT 4 -+ -+/*------------------------------Define structure----------------------------*/ -+typedef struct PG_PKT_STRUCT_A{ -+ u8 offset; -+ u8 word_en; -+ u8 data[8]; -+ u8 word_cnts; -+}PGPKT_STRUCT,*PPGPKT_STRUCT; -+ -+/*------------------------------Define structure----------------------------*/ -+typedef struct _EFUSE_HAL{ -+ u8 fakeEfuseBank; -+ u32 fakeEfuseUsedBytes; -+ u8 fakeEfuseContent[EFUSE_MAX_HW_SIZE]; -+ u8 fakeEfuseInitMap[EFUSE_MAX_MAP_LEN]; -+ u8 fakeEfuseModifiedMap[EFUSE_MAX_MAP_LEN]; -+ -+ u16 BTEfuseUsedBytes; -+ u8 BTEfuseUsedPercentage; -+ u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+ u8 BTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN]; -+ u8 BTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN]; -+ -+ u16 fakeBTEfuseUsedBytes; -+ u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+ u8 fakeBTEfuseInitMap[EFUSE_BT_MAX_MAP_LEN]; -+ u8 fakeBTEfuseModifiedMap[EFUSE_BT_MAX_MAP_LEN]; -+}EFUSE_HAL, *PEFUSE_HAL; -+ -+ -+/*------------------------Export global variable----------------------------*/ -+extern u8 fakeEfuseBank; -+extern u32 fakeEfuseUsedBytes; -+extern u8 fakeEfuseContent[]; -+extern u8 fakeEfuseInitMap[]; -+extern u8 fakeEfuseModifiedMap[]; -+ -+extern u32 BTEfuseUsedBytes; -+extern u8 BTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+extern u8 BTEfuseInitMap[]; -+extern u8 BTEfuseModifiedMap[]; -+ -+extern u32 fakeBTEfuseUsedBytes; -+extern u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; -+extern u8 fakeBTEfuseInitMap[]; -+extern u8 fakeBTEfuseModifiedMap[]; -+/*------------------------Export global variable----------------------------*/ -+ -+u8 efuse_GetCurrentSize(PADAPTER padapter, u16 *size); -+u16 efuse_GetMaxSize(PADAPTER padapter); -+u8 rtw_efuse_access(PADAPTER padapter, u8 bRead, u16 start_addr, u16 cnts, u8 *data); -+u8 rtw_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); -+u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); -+u8 rtw_BT_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); -+u8 rtw_BT_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data); -+ -+u16 Efuse_GetCurrentSize(PADAPTER pAdapter, u8 efuseType, bool bPseudoTest); -+u8 Efuse_CalculateWordCnts(u8 word_en); -+void ReadEFuseByte(PADAPTER Adapter, u16 _offset, u8 *pbuf, bool bPseudoTest) ; -+void EFUSE_GetEfuseDefinition(PADAPTER pAdapter, u8 efuseType, u8 type, void *pOut, bool bPseudoTest); -+u8 efuse_OneByteRead(PADAPTER pAdapter, u16 addr, u8 *data, bool bPseudoTest); -+u8 efuse_OneByteWrite(PADAPTER pAdapter, u16 addr, u8 data, bool bPseudoTest); -+ -+void Efuse_PowerSwitch(PADAPTER pAdapter,u8 bWrite,u8 PwrState); -+int Efuse_PgPacketRead(PADAPTER pAdapter, u8 offset, u8 *data, bool bPseudoTest); -+int Efuse_PgPacketWrite(PADAPTER pAdapter, u8 offset, u8 word_en, u8 *data, bool bPseudoTest); -+void efuse_WordEnableDataRead(u8 word_en, u8 *sourdata, u8 *targetdata); -+u8 Efuse_WordEnableDataWrite(PADAPTER pAdapter, u16 efuse_addr, u8 word_en, u8 *data, bool bPseudoTest); -+ -+u8 EFUSE_Read1Byte(PADAPTER pAdapter, u16 Address); -+void EFUSE_ShadowMapUpdate(PADAPTER pAdapter, u8 efuseType, bool bPseudoTest); -+void EFUSE_ShadowRead(PADAPTER pAdapter, u8 Type, u16 Offset, u32 *Value); -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_event.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_event.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_event.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_event.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,130 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_EVENT_H_ -+#define _RTW_EVENT_H_ -+ -+#ifdef CONFIG_H2CLBK -+#include -+#endif -+ -+/* -+Used to report a bss has been scanned -+ -+*/ -+struct survey_event { -+ WLAN_BSSID_EX bss; -+}; -+ -+/* -+Used to report that the requested site survey has been done. -+ -+bss_cnt indicates the number of bss that has been reported. -+ -+ -+*/ -+struct surveydone_event { -+ unsigned int bss_cnt; -+ -+}; -+ -+/* -+Used to report the link result of joinning the given bss -+ -+ -+join_res: -+-1: authentication fail -+-2: association fail -+> 0: TID -+ -+*/ -+struct joinbss_event { -+ struct wlan_network network; -+}; -+ -+/* -+Used to report a given STA has joinned the created BSS. -+It is used in AP/Ad-HoC(M) mode. -+ -+ -+*/ -+struct stassoc_event { -+ unsigned char macaddr[6]; -+ unsigned char rsvd[2]; -+ int cam_id; -+ -+}; -+ -+struct stadel_event { -+ unsigned char macaddr[6]; -+ unsigned char rsvd[2]; //for reason -+ int mac_id; -+}; -+ -+struct addba_event -+{ -+ unsigned int tid; -+}; -+ -+ -+#ifdef CONFIG_H2CLBK -+struct c2hlbk_event{ -+ unsigned char mac[6]; -+ unsigned short s0; -+ unsigned short s1; -+ unsigned int w0; -+ unsigned char b0; -+ unsigned short s2; -+ unsigned char b1; -+ unsigned int w1; -+}; -+#endif//CONFIG_H2CLBK -+ -+#define GEN_EVT_CODE(event) event ## _EVT_ -+ -+ -+ -+struct fwevent { -+ u32 parmsize; -+ void (*event_callback)(_adapter *dev, u8 *pbuf); -+}; -+ -+ -+#define C2HEVENT_SZ 32 -+ -+struct event_node{ -+ unsigned char *node; -+ unsigned char evt_code; -+ unsigned short evt_sz; -+ volatile int *caller_ff_tail; -+ int caller_ff_sz; -+}; -+ -+struct c2hevent_queue { -+ volatile int head; -+ volatile int tail; -+ struct event_node nodes[C2HEVENT_SZ]; -+ unsigned char seq; -+}; -+ -+#define NETWORK_QUEUE_SZ 4 -+ -+struct network_queue { -+ volatile int head; -+ volatile int tail; -+ WLAN_BSSID_EX networks[NETWORK_QUEUE_SZ]; -+}; -+ -+ -+#endif // _WLANEVENT_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_ht.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ht.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_ht.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ht.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,87 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_HT_H_ -+#define _RTW_HT_H_ -+ -+ -+struct ht_priv -+{ -+ u32 ht_option; -+ u32 ampdu_enable;//for enable Tx A-MPDU -+ //u8 baddbareq_issued[16]; -+ u32 tx_amsdu_enable;//for enable Tx A-MSDU -+ u32 tx_amsdu_maxlen; // 1: 8k, 0:4k ; default:8k, for tx -+ u32 rx_ampdu_maxlen; //for rx reordering ctrl win_sz, updated when join_callback. -+ -+ u8 bwmode;// -+ u8 ch_offset;//PRIME_CHNL_OFFSET -+ u8 sgi;//short GI -+ -+ //for processing Tx A-MPDU -+ u8 agg_enable_bitmap; -+ //u8 ADDBA_retry_count; -+ u8 candidate_tid_bitmap; -+ -+ u8 ldpc_cap; -+ u8 stbc_cap; -+ u8 beamform_cap; -+ -+ struct rtw_ieee80211_ht_cap ht_cap; -+ -+}; -+ -+typedef enum AGGRE_SIZE{ -+ HT_AGG_SIZE_8K = 0, -+ HT_AGG_SIZE_16K = 1, -+ HT_AGG_SIZE_32K = 2, -+ HT_AGG_SIZE_64K = 3, -+ VHT_AGG_SIZE_128K = 4, -+ VHT_AGG_SIZE_256K = 5, -+ VHT_AGG_SIZE_512K = 6, -+ VHT_AGG_SIZE_1024K = 7, -+}AGGRE_SIZE_E, *PAGGRE_SIZE_E; -+ -+typedef enum _RT_HT_INF0_CAP{ -+ RT_HT_CAP_USE_TURBO_AGGR = 0x01, -+ RT_HT_CAP_USE_LONG_PREAMBLE = 0x02, -+ RT_HT_CAP_USE_AMPDU = 0x04, -+ RT_HT_CAP_USE_WOW = 0x8, -+ RT_HT_CAP_USE_SOFTAP = 0x10, -+ RT_HT_CAP_USE_92SE = 0x20, -+ RT_HT_CAP_USE_88C_92C = 0x40, -+ RT_HT_CAP_USE_AP_CLIENT_MODE = 0x80, // AP team request to reserve this bit, by Emily -+}RT_HT_INF0_CAPBILITY, *PRT_HT_INF0_CAPBILITY; -+ -+typedef enum _RT_HT_INF1_CAP{ -+ RT_HT_CAP_USE_VIDEO_CLIENT = 0x01, -+ RT_HT_CAP_USE_JAGUAR_BCUT = 0x02, -+ RT_HT_CAP_USE_JAGUAR_CCUT = 0x04, -+}RT_HT_INF1_CAPBILITY, *PRT_HT_INF1_CAPBILITY; -+ -+#define LDPC_HT_ENABLE_RX BIT0 -+#define LDPC_HT_ENABLE_TX BIT1 -+#define LDPC_HT_TEST_TX_ENABLE BIT2 -+#define LDPC_HT_CAP_TX BIT3 -+ -+#define STBC_HT_ENABLE_RX BIT0 -+#define STBC_HT_ENABLE_TX BIT1 -+#define STBC_HT_TEST_TX_ENABLE BIT2 -+#define STBC_HT_CAP_TX BIT3 -+ -+#define BEAMFORMING_HT_BEAMFORMER_ENABLE BIT0 // Declare our NIC supports beamformer -+#define BEAMFORMING_HT_BEAMFORMEE_ENABLE BIT1 // Declare our NIC supports beamformee -+#define BEAMFORMING_HT_BEAMFORMER_TEST BIT2 // Transmiting Beamforming no matter the target supports it or not -+ -+#endif //_RTL871X_HT_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,187 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_IOCTL_H_ -+#define _RTW_IOCTL_H_ -+ -+// 00 - Success -+// 11 - Error -+#define STATUS_SUCCESS (0x00000000L) -+#define STATUS_PENDING (0x00000103L) -+ -+#define STATUS_UNSUCCESSFUL (0xC0000001L) -+#define STATUS_INSUFFICIENT_RESOURCES (0xC000009AL) -+#define STATUS_NOT_SUPPORTED (0xC00000BBL) -+ -+#define uint_SUCCESS ((uint)STATUS_SUCCESS) -+#define uint_PENDING ((uint)STATUS_PENDING) -+#define uint_NOT_RECOGNIZED ((uint)0x00010001L) -+#define uint_NOT_COPIED ((uint)0x00010002L) -+#define uint_NOT_ACCEPTED ((uint)0x00010003L) -+#define uint_CALL_ACTIVE ((uint)0x00010007L) -+ -+#define uint_FAILURE ((uint)STATUS_UNSUCCESSFUL) -+#define uint_RESOURCES ((uint)STATUS_INSUFFICIENT_RESOURCES) -+#define uint_CLOSING ((uint)0xC0010002L) -+#define uint_BAD_VERSION ((uint)0xC0010004L) -+#define uint_BAD_CHARACTERISTICS ((uint)0xC0010005L) -+#define uint_ADAPTER_NOT_FOUND ((uint)0xC0010006L) -+#define uint_OPEN_FAILED ((uint)0xC0010007L) -+#define uint_DEVICE_FAILED ((uint)0xC0010008L) -+#define uint_MULTICAST_FULL ((uint)0xC0010009L) -+#define uint_MULTICAST_EXISTS ((uint)0xC001000AL) -+#define uint_MULTICAST_NOT_FOUND ((uint)0xC001000BL) -+#define uint_REQUEST_ABORTED ((uint)0xC001000CL) -+#define uint_RESET_IN_PROGRESS ((uint)0xC001000DL) -+#define uint_CLOSING_INDICATING ((uint)0xC001000EL) -+#define uint_NOT_SUPPORTED ((uint)STATUS_NOT_SUPPORTED) -+#define uint_INVALID_PACKET ((uint)0xC001000FL) -+#define uint_OPEN_LIST_FULL ((uint)0xC0010010L) -+#define uint_ADAPTER_NOT_READY ((uint)0xC0010011L) -+#define uint_ADAPTER_NOT_OPEN ((uint)0xC0010012L) -+#define uint_NOT_INDICATING ((uint)0xC0010013L) -+#define uint_INVALID_LENGTH ((uint)0xC0010014L) -+#define uint_INVALID_DATA ((uint)0xC0010015L) -+#define uint_BUFFER_TOO_SHORT ((uint)0xC0010016L) -+#define uint_INVALID_OID ((uint)0xC0010017L) -+#define uint_ADAPTER_REMOVED ((uint)0xC0010018L) -+#define uint_UNSUPPORTED_MEDIA ((uint)0xC0010019L) -+#define uint_GROUP_ADDRESS_IN_USE ((uint)0xC001001AL) -+#define uint_FILE_NOT_FOUND ((uint)0xC001001BL) -+#define uint_ERROR_READING_FILE ((uint)0xC001001CL) -+#define uint_ALREADY_MAPPED ((uint)0xC001001DL) -+#define uint_RESOURCE_CONFLICT ((uint)0xC001001EL) -+#define uint_NO_CABLE ((uint)0xC001001FL) -+ -+#define uint_INVALID_SAP ((uint)0xC0010020L) -+#define uint_SAP_IN_USE ((uint)0xC0010021L) -+#define uint_INVALID_ADDRESS ((uint)0xC0010022L) -+#define uint_VC_NOT_ACTIVATED ((uint)0xC0010023L) -+#define uint_DEST_OUT_OF_ORDER ((uint)0xC0010024L) // cause 27 -+#define uint_VC_NOT_AVAILABLE ((uint)0xC0010025L) // cause 35,45 -+#define uint_CELLRATE_NOT_AVAILABLE ((uint)0xC0010026L) // cause 37 -+#define uint_INCOMPATABLE_QOS ((uint)0xC0010027L) // cause 49 -+#define uint_AAL_PARAMS_UNSUPPORTED ((uint)0xC0010028L) // cause 93 -+#define uint_NO_ROUTE_TO_DESTINATION ((uint)0xC0010029L) // cause 3 -+ -+#ifndef OID_802_11_CAPABILITY -+ #define OID_802_11_CAPABILITY 0x0d010122 -+#endif -+ -+#ifndef OID_802_11_PMKID -+ #define OID_802_11_PMKID 0x0d010123 -+#endif -+ -+ -+// For DDK-defined OIDs -+#define OID_NDIS_SEG1 0x00010100 -+#define OID_NDIS_SEG2 0x00010200 -+#define OID_NDIS_SEG3 0x00020100 -+#define OID_NDIS_SEG4 0x01010100 -+#define OID_NDIS_SEG5 0x01020100 -+#define OID_NDIS_SEG6 0x01020200 -+#define OID_NDIS_SEG7 0xFD010100 -+#define OID_NDIS_SEG8 0x0D010100 -+#define OID_NDIS_SEG9 0x0D010200 -+#define OID_NDIS_SEG10 0x0D020200 -+ -+#define SZ_OID_NDIS_SEG1 23 -+#define SZ_OID_NDIS_SEG2 3 -+#define SZ_OID_NDIS_SEG3 6 -+#define SZ_OID_NDIS_SEG4 6 -+#define SZ_OID_NDIS_SEG5 4 -+#define SZ_OID_NDIS_SEG6 8 -+#define SZ_OID_NDIS_SEG7 7 -+#define SZ_OID_NDIS_SEG8 36 -+#define SZ_OID_NDIS_SEG9 24 -+#define SZ_OID_NDIS_SEG10 19 -+ -+// For Realtek-defined OIDs -+#define OID_MP_SEG1 0xFF871100 -+#define OID_MP_SEG2 0xFF818000 -+ -+#define OID_MP_SEG3 0xFF818700 -+#define OID_MP_SEG4 0xFF011100 -+ -+#define DEBUG_OID(dbg, str) \ -+ if((!dbg)) \ -+ { \ -+ RT_TRACE(_module_rtl871x_ioctl_c_,_drv_info_,("%s(%d): %s", __FUNCTION__, __LINE__, str)); \ -+ } -+ -+ -+enum oid_type -+{ -+ QUERY_OID, -+ SET_OID -+}; -+ -+struct oid_funs_node { -+ unsigned int oid_start; //the starting number for OID -+ unsigned int oid_end; //the ending number for OID -+ struct oid_obj_priv *node_array; -+ unsigned int array_sz; //the size of node_array -+ int query_counter; //count the number of query hits for this segment -+ int set_counter; //count the number of set hits for this segment -+}; -+ -+struct oid_par_priv -+{ -+ void *adapter_context; -+ uint oid; -+ void *information_buf; -+ u32 information_buf_len; -+ u32 *bytes_rw; -+ u32 *bytes_needed; -+ enum oid_type type_of_oid; -+ u32 dbg; -+}; -+ -+struct oid_obj_priv { -+ unsigned char dbg; // 0: without OID debug message 1: with OID debug message -+ uint (*oidfuns)(struct oid_par_priv *poid_par_priv); -+}; -+ -+#if (defined(CONFIG_MP_INCLUDED) && defined(_RTW_MP_IOCTL_C_)) -+static uint oid_null_function(struct oid_par_priv* poid_par_priv) -+{ -+ return uint_SUCCESS; -+} -+#endif -+ -+#if defined(CONFIG_WIRELESS_EXT) -+extern struct iw_handler_def rtw_handlers_def; -+#endif -+ -+extern void rtw_request_wps_pbc_event(_adapter *padapter); -+ -+extern uint drv_query_info( -+ _nic_hdl MiniportAdapterContext, -+ uint Oid, -+ void * InformationBuffer, -+ u32 InformationBufferLength, -+ u32* BytesWritten, -+ u32* BytesNeeded -+ ); -+ -+extern uint drv_set_info( -+ _nic_hdl MiniportAdapterContext, -+ uint Oid, -+ void * InformationBuffer, -+ u32 InformationBufferLength, -+ u32* BytesRead, -+ u32* BytesNeeded -+ ); -+ -+#endif // #ifndef __INC_CEINFO_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl_query.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl_query.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl_query.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl_query.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,18 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_IOCTL_QUERY_H_ -+#define _RTW_IOCTL_QUERY_H_ -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl_rtl.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,75 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_IOCTL_RTL_H_ -+#define _RTW_IOCTL_RTL_H_ -+ -+ -+//************** oid_rtl_seg_01_01 ************** -+uint oid_rt_get_signal_quality_hdl(struct oid_par_priv* poid_par_priv);//84 -+uint oid_rt_get_small_packet_crc_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_middle_packet_crc_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_large_packet_crc_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_tx_retry_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_rx_retry_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_rx_total_packet_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_tx_beacon_ok_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_tx_beacon_err_hdl(struct oid_par_priv* poid_par_priv); -+ -+uint oid_rt_pro_set_fw_dig_state_hdl(struct oid_par_priv* poid_par_priv); //8a -+uint oid_rt_pro_set_fw_ra_state_hdl(struct oid_par_priv* poid_par_priv); //8b -+ -+uint oid_rt_get_rx_icv_err_hdl(struct oid_par_priv* poid_par_priv);//93 -+uint oid_rt_set_encryption_algorithm_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_preamble_mode_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_ap_ip_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_channelplan_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_set_channelplan_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_set_preamble_mode_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_set_bcn_intvl_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_dedicate_probe_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_total_tx_bytes_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_total_rx_bytes_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_current_tx_power_level_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_enc_key_mismatch_count_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_enc_key_match_count_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_channel_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_hardware_radio_off_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_key_mismatch_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_supported_wireless_mode_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_channel_list_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_scan_in_progress_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_forced_data_rate_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_wireless_mode_for_scan_list_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_bss_wireless_mode_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_scan_with_magic_packet_hdl(struct oid_par_priv* poid_par_priv); -+ -+//************** oid_rtl_seg_01_03 section start ************** -+uint oid_rt_ap_get_associated_station_list_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_ap_switch_into_ap_mode_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_ap_supported_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_ap_set_passphrase_hdl(struct oid_par_priv* poid_par_priv); -+ -+// oid_rtl_seg_01_11 -+uint oid_rt_pro_rf_write_registry_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_rf_read_registry_hdl(struct oid_par_priv* poid_par_priv); -+ -+//************** oid_rtl_seg_03_00 section start ************** -+uint oid_rt_get_connect_state_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_set_default_key_id_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+ -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl_set.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl_set.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_ioctl_set.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_ioctl_set.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,45 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_IOCTL_SET_H_ -+#define __RTW_IOCTL_SET_H_ -+ -+ -+typedef u8 NDIS_802_11_PMKID_VALUE[16]; -+ -+typedef struct _BSSIDInfo { -+ NDIS_802_11_MAC_ADDRESS BSSID; -+ NDIS_802_11_PMKID_VALUE PMKID; -+} BSSIDInfo, *PBSSIDInfo; -+ -+u8 rtw_set_802_11_add_key(_adapter * padapter, NDIS_802_11_KEY * key); -+u8 rtw_set_802_11_authentication_mode(_adapter *pdapter, NDIS_802_11_AUTHENTICATION_MODE authmode); -+u8 rtw_set_802_11_bssid(_adapter* padapter, u8 *bssid); -+u8 rtw_set_802_11_add_wep(_adapter * padapter, NDIS_802_11_WEP * wep); -+u8 rtw_set_802_11_disassociate(_adapter * padapter); -+u8 rtw_set_802_11_bssid_list_scan(_adapter* padapter, NDIS_802_11_SSID *pssid, int ssid_max_num); -+u8 rtw_set_802_11_infrastructure_mode(_adapter * padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype); -+u8 rtw_set_802_11_remove_wep(_adapter * padapter, u32 keyindex); -+u8 rtw_set_802_11_ssid(_adapter * padapter, NDIS_802_11_SSID * ssid); -+u8 rtw_set_802_11_remove_key(_adapter * padapter, NDIS_802_11_REMOVE_KEY * key); -+ -+ -+u8 rtw_validate_ssid(NDIS_802_11_SSID *ssid); -+ -+u16 rtw_get_cur_max_rate(_adapter *adapter); -+int rtw_set_scan_mode(_adapter *adapter, RT_SCAN_TYPE scan_mode); -+int rtw_set_channel_plan(_adapter *adapter, u8 channel_plan); -+int rtw_set_country(_adapter *adapter, const char *country_code); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_io.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_io.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_io.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_io.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,448 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#ifndef _RTW_IO_H_ -+#define _RTW_IO_H_ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+#define rtw_usb_buffer_alloc(dev, size, dma) usb_alloc_coherent((dev), (size), (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL), (dma)) -+#define rtw_usb_buffer_free(dev, size, addr, dma) usb_free_coherent((dev), (size), (addr), (dma)) -+#else -+#define rtw_usb_buffer_alloc(dev, size, dma) usb_buffer_alloc((dev), (size), (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL), (dma)) -+#define rtw_usb_buffer_free(dev, size, addr, dma) usb_buffer_free((dev), (size), (addr), (dma)) -+#endif -+ -+#define NUM_IOREQ 8 -+ -+#define MAX_PROT_SZ (64-16) -+ -+#define _IOREADY 0 -+#define _IO_WAIT_COMPLETE 1 -+#define _IO_WAIT_RSP 2 -+ -+// IO COMMAND TYPE -+#define _IOSZ_MASK_ (0x7F) -+#define _IO_WRITE_ BIT(7) -+#define _IO_FIXED_ BIT(8) -+#define _IO_BURST_ BIT(9) -+#define _IO_BYTE_ BIT(10) -+#define _IO_HW_ BIT(11) -+#define _IO_WORD_ BIT(12) -+#define _IO_SYNC_ BIT(13) -+#define _IO_CMDMASK_ (0x1F80) -+ -+ -+/* -+ For prompt mode accessing, caller shall free io_req -+ Otherwise, io_handler will free io_req -+*/ -+ -+ -+ -+// IO STATUS TYPE -+#define _IO_ERR_ BIT(2) -+#define _IO_SUCCESS_ BIT(1) -+#define _IO_DONE_ BIT(0) -+ -+ -+#define IO_RD32 (_IO_SYNC_ | _IO_WORD_) -+#define IO_RD16 (_IO_SYNC_ | _IO_HW_) -+#define IO_RD8 (_IO_SYNC_ | _IO_BYTE_) -+ -+#define IO_RD32_ASYNC (_IO_WORD_) -+#define IO_RD16_ASYNC (_IO_HW_) -+#define IO_RD8_ASYNC (_IO_BYTE_) -+ -+#define IO_WR32 (_IO_WRITE_ | _IO_SYNC_ | _IO_WORD_) -+#define IO_WR16 (_IO_WRITE_ | _IO_SYNC_ | _IO_HW_) -+#define IO_WR8 (_IO_WRITE_ | _IO_SYNC_ | _IO_BYTE_) -+ -+#define IO_WR32_ASYNC (_IO_WRITE_ | _IO_WORD_) -+#define IO_WR16_ASYNC (_IO_WRITE_ | _IO_HW_) -+#define IO_WR8_ASYNC (_IO_WRITE_ | _IO_BYTE_) -+ -+/* -+ -+ Only Sync. burst accessing is provided. -+ -+*/ -+ -+#define IO_WR_BURST(x) (_IO_WRITE_ | _IO_SYNC_ | _IO_BURST_ | ( (x) & _IOSZ_MASK_)) -+#define IO_RD_BURST(x) (_IO_SYNC_ | _IO_BURST_ | ( (x) & _IOSZ_MASK_)) -+ -+ -+ -+//below is for the intf_option bit defition... -+ -+#define _INTF_ASYNC_ BIT(0) //support async io -+ -+struct intf_priv; -+struct intf_hdl; -+struct io_queue; -+ -+struct _io_ops { -+ u8 (*_read8)(struct intf_hdl *pintfhdl, u32 addr); -+ u16 (*_read16)(struct intf_hdl *pintfhdl, u32 addr); -+ u32 (*_read32)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ int (*_write8)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int (*_write16)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int (*_write32)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ int (*_writeN)(struct intf_hdl *pintfhdl, u32 addr, u32 length, u8 *pdata); -+ -+ int (*_write8_async)(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+ int (*_write16_async)(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+ int (*_write32_async)(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+ -+ void (*_read_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ void (*_write_mem)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ -+ void (*_sync_irp_protocol_rw)(struct io_queue *pio_q); -+ -+ u32 (*_read_interrupt)(struct intf_hdl *pintfhdl, u32 addr); -+ -+ u32 (*_read_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ u32 (*_write_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -+ -+ u32 (*_write_scsi)(struct intf_hdl *pintfhdl,u32 cnt, u8 *pmem); -+ -+ void (*_read_port_cancel)(struct intf_hdl *pintfhdl); -+ void (*_write_port_cancel)(struct intf_hdl *pintfhdl); -+ -+}; -+ -+struct io_req { -+ _list list; -+ u32 addr; -+ volatile u32 val; -+ u32 command; -+ u32 status; -+ u8 *pbuf; -+ _sema sema; -+ -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt); -+ u8 *cnxt; -+}; -+ -+struct intf_hdl { -+ _adapter *padapter; -+ struct dvobj_priv *pintf_dev;// pointer to &(padapter->dvobjpriv); -+ -+ struct _io_ops io_ops; -+ -+}; -+ -+struct reg_protocol_rd { -+ -+#ifdef __LITTLE_ENDIAN -+ -+ //DW1 -+ u32 NumOfTrans:4; -+ u32 Reserved1:4; -+ u32 Reserved2:24; -+ //DW2 -+ u32 ByteCount:7; -+ u32 WriteEnable:1; //0:read, 1:write -+ u32 FixOrContinuous:1; //0:continuous, 1: Fix -+ u32 BurstMode:1; -+ u32 Byte1Access:1; -+ u32 Byte2Access:1; -+ u32 Byte4Access:1; -+ u32 Reserved3:3; -+ u32 Reserved4:16; -+ //DW3 -+ u32 BusAddress; -+ //DW4 -+ //u32 Value; -+#else -+ -+ -+//DW1 -+ u32 Reserved1 :4; -+ u32 NumOfTrans :4; -+ -+ u32 Reserved2 :24; -+ -+ //DW2 -+ u32 WriteEnable : 1; -+ u32 ByteCount :7; -+ -+ -+ u32 Reserved3 : 3; -+ u32 Byte4Access : 1; -+ -+ u32 Byte2Access : 1; -+ u32 Byte1Access : 1; -+ u32 BurstMode :1 ; -+ u32 FixOrContinuous : 1; -+ -+ u32 Reserved4 : 16; -+ -+ //DW3 -+ u32 BusAddress; -+ -+ //DW4 -+ //u32 Value; -+ -+#endif -+ -+}; -+ -+ -+struct reg_protocol_wt { -+ -+ -+#ifdef __LITTLE_ENDIAN -+ -+ //DW1 -+ u32 NumOfTrans:4; -+ u32 Reserved1:4; -+ u32 Reserved2:24; -+ //DW2 -+ u32 ByteCount:7; -+ u32 WriteEnable:1; //0:read, 1:write -+ u32 FixOrContinuous:1; //0:continuous, 1: Fix -+ u32 BurstMode:1; -+ u32 Byte1Access:1; -+ u32 Byte2Access:1; -+ u32 Byte4Access:1; -+ u32 Reserved3:3; -+ u32 Reserved4:16; -+ //DW3 -+ u32 BusAddress; -+ //DW4 -+ u32 Value; -+ -+#else -+ //DW1 -+ u32 Reserved1 :4; -+ u32 NumOfTrans :4; -+ -+ u32 Reserved2 :24; -+ -+ //DW2 -+ u32 WriteEnable : 1; -+ u32 ByteCount :7; -+ -+ u32 Reserved3 : 3; -+ u32 Byte4Access : 1; -+ -+ u32 Byte2Access : 1; -+ u32 Byte1Access : 1; -+ u32 BurstMode :1 ; -+ u32 FixOrContinuous : 1; -+ -+ u32 Reserved4 : 16; -+ -+ //DW3 -+ u32 BusAddress; -+ -+ //DW4 -+ u32 Value; -+ -+#endif -+ -+}; -+ -+/* -+Below is the data structure used by _io_handler -+ -+*/ -+ -+struct io_queue { -+ _lock lock; -+ _list free_ioreqs; -+ _list pending; //The io_req list that will be served in the single protocol read/write. -+ _list processing; -+ u8 *free_ioreqs_buf; // 4-byte aligned -+ u8 *pallocated_free_ioreqs_buf; -+ struct intf_hdl intf; -+}; -+ -+struct io_priv{ -+ -+ _adapter *padapter; -+ -+ struct intf_hdl intf; -+ -+}; -+ -+extern uint ioreq_flush(_adapter *adapter, struct io_queue *ioqueue); -+extern void sync_ioreq_enqueue(struct io_req *preq,struct io_queue *ioqueue); -+extern uint sync_ioreq_flush(_adapter *adapter, struct io_queue *ioqueue); -+ -+ -+extern uint free_ioreq(struct io_req *preq, struct io_queue *pio_queue); -+extern struct io_req *alloc_ioreq(struct io_queue *pio_q); -+ -+extern uint register_intf_hdl(u8 *dev, struct intf_hdl *pintfhdl); -+extern void unregister_intf_hdl(struct intf_hdl *pintfhdl); -+ -+extern void _rtw_attrib_read(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void _rtw_attrib_write(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+ -+extern u8 _rtw_read8(_adapter *adapter, u32 addr); -+extern u16 _rtw_read16(_adapter *adapter, u32 addr); -+extern u32 _rtw_read32(_adapter *adapter, u32 addr); -+extern void _rtw_read_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void _rtw_read_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void _rtw_read_port_cancel(_adapter *adapter); -+ -+ -+extern int _rtw_write8(_adapter *adapter, u32 addr, u8 val); -+extern int _rtw_write16(_adapter *adapter, u32 addr, u16 val); -+extern int _rtw_write32(_adapter *adapter, u32 addr, u32 val); -+extern int _rtw_writeN(_adapter *adapter, u32 addr, u32 length, u8 *pdata); -+ -+extern int _rtw_write8_async(_adapter *adapter, u32 addr, u8 val); -+extern int _rtw_write16_async(_adapter *adapter, u32 addr, u16 val); -+extern int _rtw_write32_async(_adapter *adapter, u32 addr, u32 val); -+ -+extern void _rtw_write_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern u32 _rtw_write_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+u32 _rtw_write_port_and_wait(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem, int timeout_ms); -+extern void _rtw_write_port_cancel(_adapter *adapter); -+ -+#ifdef DBG_IO -+bool match_read_sniff_ranges(u16 addr, u16 len); -+bool match_write_sniff_ranges(u16 addr, u16 len); -+ -+extern u8 dbg_rtw_read8(_adapter *adapter, u32 addr, const char *caller, const int line); -+extern u16 dbg_rtw_read16(_adapter *adapter, u32 addr, const char *caller, const int line); -+extern u32 dbg_rtw_read32(_adapter *adapter, u32 addr, const char *caller, const int line); -+ -+extern int dbg_rtw_write8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line); -+extern int dbg_rtw_write16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line); -+extern int dbg_rtw_write32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line); -+extern int dbg_rtw_writeN(_adapter *adapter, u32 addr ,u32 length , u8 *data, const char *caller, const int line); -+ -+#define rtw_read8(adapter, addr) dbg_rtw_read8((adapter), (addr), __FUNCTION__, __LINE__) -+#define rtw_read16(adapter, addr) dbg_rtw_read16((adapter), (addr), __FUNCTION__, __LINE__) -+#define rtw_read32(adapter, addr) dbg_rtw_read32((adapter), (addr), __FUNCTION__, __LINE__) -+#define rtw_read_mem(adapter, addr, cnt, mem) _rtw_read_mem((adapter), (addr), (cnt), (mem)) -+#define rtw_read_port(adapter, addr, cnt, mem) _rtw_read_port((adapter), (addr), (cnt), (mem)) -+#define rtw_read_port_cancel(adapter) _rtw_read_port_cancel((adapter)) -+ -+#define rtw_write8(adapter, addr, val) dbg_rtw_write8((adapter), (addr), (val), __FUNCTION__, __LINE__) -+#define rtw_write16(adapter, addr, val) dbg_rtw_write16((adapter), (addr), (val), __FUNCTION__, __LINE__) -+#define rtw_write32(adapter, addr, val) dbg_rtw_write32((adapter), (addr), (val), __FUNCTION__, __LINE__) -+#define rtw_writeN(adapter, addr, length, data) dbg_rtw_writeN((adapter), (addr), (length), (data), __FUNCTION__, __LINE__) -+ -+#define rtw_write8_async(adapter, addr, val) _rtw_write8_async((adapter), (addr), (val)) -+#define rtw_write16_async(adapter, addr, val) _rtw_write16_async((adapter), (addr), (val)) -+#define rtw_write32_async(adapter, addr, val) _rtw_write32_async((adapter), (addr), (val)) -+ -+#define rtw_write_mem(adapter, addr, cnt, mem) _rtw_write_mem((adapter), addr, cnt, mem) -+#define rtw_write_port(adapter, addr, cnt, mem) _rtw_write_port(adapter, addr, cnt, mem) -+#define rtw_write_port_and_wait(adapter, addr, cnt, mem, timeout_ms) _rtw_write_port_and_wait((adapter), (addr), (cnt), (mem), (timeout_ms)) -+#define rtw_write_port_cancel(adapter) _rtw_write_port_cancel(adapter) -+#else //DBG_IO -+#define rtw_read8(adapter, addr) _rtw_read8((adapter), (addr)) -+#define rtw_read16(adapter, addr) _rtw_read16((adapter), (addr)) -+#define rtw_read32(adapter, addr) _rtw_read32((adapter), (addr)) -+#define rtw_read_mem(adapter, addr, cnt, mem) _rtw_read_mem((adapter), (addr), (cnt), (mem)) -+#define rtw_read_port(adapter, addr, cnt, mem) _rtw_read_port((adapter), (addr), (cnt), (mem)) -+#define rtw_read_port_cancel(adapter) _rtw_read_port_cancel((adapter)) -+ -+#define rtw_write8(adapter, addr, val) _rtw_write8((adapter), (addr), (val)) -+#define rtw_write16(adapter, addr, val) _rtw_write16((adapter), (addr), (val)) -+#define rtw_write32(adapter, addr, val) _rtw_write32((adapter), (addr), (val)) -+#define rtw_writeN(adapter, addr, length, data) _rtw_writeN((adapter), (addr), (length), (data)) -+ -+#define rtw_write8_async(adapter, addr, val) _rtw_write8_async((adapter), (addr), (val)) -+#define rtw_write16_async(adapter, addr, val) _rtw_write16_async((adapter), (addr), (val)) -+#define rtw_write32_async(adapter, addr, val) _rtw_write32_async((adapter), (addr), (val)) -+ -+#define rtw_write_mem(adapter, addr, cnt, mem) _rtw_write_mem((adapter), (addr), (cnt), (mem)) -+#define rtw_write_port(adapter, addr, cnt, mem) _rtw_write_port((adapter), (addr), (cnt), (mem)) -+#define rtw_write_port_and_wait(adapter, addr, cnt, mem, timeout_ms) _rtw_write_port_and_wait((adapter), (addr), (cnt), (mem), (timeout_ms)) -+#define rtw_write_port_cancel(adapter) _rtw_write_port_cancel((adapter)) -+#endif //DBG_IO -+ -+extern void rtw_write_scsi(_adapter *adapter, u32 cnt, u8 *pmem); -+ -+//ioreq -+extern void ioreq_read8(_adapter *adapter, u32 addr, u8 *pval); -+extern void ioreq_read16(_adapter *adapter, u32 addr, u16 *pval); -+extern void ioreq_read32(_adapter *adapter, u32 addr, u32 *pval); -+extern void ioreq_write8(_adapter *adapter, u32 addr, u8 val); -+extern void ioreq_write16(_adapter *adapter, u32 addr, u16 val); -+extern void ioreq_write32(_adapter *adapter, u32 addr, u32 val); -+ -+ -+extern uint async_read8(_adapter *adapter, u32 addr, u8 *pbuff, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+extern uint async_read16(_adapter *adapter, u32 addr, u8 *pbuff, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+extern uint async_read32(_adapter *adapter, u32 addr, u8 *pbuff, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+ -+extern void async_read_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void async_read_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+ -+extern void async_write8(_adapter *adapter, u32 addr, u8 val, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+extern void async_write16(_adapter *adapter, u32 addr, u16 val, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+extern void async_write32(_adapter *adapter, u32 addr, u32 val, -+ void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt), u8 *cnxt); -+ -+extern void async_write_mem(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+extern void async_write_port(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem); -+ -+ -+int rtw_init_io_priv(_adapter *padapter, void (*set_intf_ops)(_adapter *padapter,struct _io_ops *pops)); -+ -+ -+extern uint alloc_io_queue(_adapter *adapter); -+extern void free_io_queue(_adapter *adapter); -+extern void async_bus_io(struct io_queue *pio_q); -+extern void bus_sync_io(struct io_queue *pio_q); -+extern u32 _ioreq2rwmem(struct io_queue *pio_q); -+extern void dev_power_down(_adapter * Adapter, u8 bpwrup); -+ -+/* -+#define RTL_R8(reg) rtw_read8(padapter, reg) -+#define RTL_R16(reg) rtw_read16(padapter, reg) -+#define RTL_R32(reg) rtw_read32(padapter, reg) -+#define RTL_W8(reg, val8) rtw_write8(padapter, reg, val8) -+#define RTL_W16(reg, val16) rtw_write16(padapter, reg, val16) -+#define RTL_W32(reg, val32) rtw_write32(padapter, reg, val32) -+*/ -+ -+/* -+#define RTL_W8_ASYNC(reg, val8) rtw_write32_async(padapter, reg, val8) -+#define RTL_W16_ASYNC(reg, val16) rtw_write32_async(padapter, reg, val16) -+#define RTL_W32_ASYNC(reg, val32) rtw_write32_async(padapter, reg, val32) -+ -+#define RTL_WRITE_BB(reg, val32) phy_SetUsbBBReg(padapter, reg, val32) -+#define RTL_READ_BB(reg) phy_QueryUsbBBReg(padapter, reg) -+*/ -+ -+#define PlatformEFIOWrite1Byte(_a,_b,_c) \ -+ rtw_write8(_a,_b,_c) -+#define PlatformEFIOWrite2Byte(_a,_b,_c) \ -+ rtw_write16(_a,_b,_c) -+#define PlatformEFIOWrite4Byte(_a,_b,_c) \ -+ rtw_write32(_a,_b,_c) -+ -+#define PlatformEFIORead1Byte(_a,_b) \ -+ rtw_read8(_a,_b) -+#define PlatformEFIORead2Byte(_a,_b) \ -+ rtw_read16(_a,_b) -+#define PlatformEFIORead4Byte(_a,_b) \ -+ rtw_read32(_a,_b) -+ -+#endif //_RTL8711_IO_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_iol.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_iol.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_iol.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_iol.h 2018-02-06 17:42:30.720967312 +0200 -@@ -0,0 +1,131 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_IOL_H_ -+#define __RTW_IOL_H_ -+ -+ -+struct xmit_frame *rtw_IOL_accquire_xmit_frame(ADAPTER *adapter); -+int rtw_IOL_append_cmds(struct xmit_frame *xmit_frame, u8 *IOL_cmds, u32 cmd_len); -+int rtw_IOL_append_LLT_cmd(struct xmit_frame *xmit_frame, u8 page_boundary); -+int rtw_IOL_exec_cmds_sync(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt); -+bool rtw_IOL_applied(ADAPTER *adapter); -+int rtw_IOL_append_DELAY_US_cmd(struct xmit_frame *xmit_frame, u16 us); -+int rtw_IOL_append_DELAY_MS_cmd(struct xmit_frame *xmit_frame, u16 ms); -+int rtw_IOL_append_END_cmd(struct xmit_frame *xmit_frame); -+ -+ -+#ifdef CONFIG_IOL_NEW_GENERATION -+#define IOREG_CMD_END_LEN 4 -+ -+struct ioreg_cfg{ -+ u8 length; -+ u8 cmd_id; -+ u16 address; -+ u32 data; -+ u32 mask; -+}; -+enum ioreg_cmd{ -+ IOREG_CMD_LLT = 0x01, -+ IOREG_CMD_REFUSE = 0x02, -+ IOREG_CMD_EFUSE_PATH = 0x03, -+ IOREG_CMD_WB_REG = 0x04, -+ IOREG_CMD_WW_REG = 0x05, -+ IOREG_CMD_WD_REG = 0x06, -+ IOREG_CMD_W_RF = 0x07, -+ IOREG_CMD_DELAY_US = 0x10, -+ IOREG_CMD_DELAY_MS = 0x11, -+ IOREG_CMD_END = 0xFF, -+}; -+void read_efuse_from_txpktbuf(ADAPTER *adapter, int bcnhead, u8 *content, u16 *size); -+ -+int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, u8 mask); -+int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, u16 mask); -+int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, u32 mask); -+int _rtw_IOL_append_WRF_cmd(struct xmit_frame *xmit_frame, u8 rf_path, u16 addr, u32 value, u32 mask); -+#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value,mask) _rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value) ,(mask)) -+#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value,mask) _rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value),(mask)) -+#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value,mask) _rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value),(mask)) -+#define rtw_IOL_append_WRF_cmd(xmit_frame, rf_path, addr, value,mask) _rtw_IOL_append_WRF_cmd((xmit_frame),(rf_path), (addr), (value),(mask)) -+ -+u8 rtw_IOL_cmd_boundary_handle(struct xmit_frame *pxmit_frame); -+void rtw_IOL_cmd_buf_dump(ADAPTER *Adapter,int buf_len,u8 *pbuf); -+ -+#ifdef CONFIG_IOL_IOREG_CFG_DBG -+ struct cmd_cmp{ -+ u16 addr; -+ u32 value; -+ }; -+#endif -+ -+#else //CONFIG_IOL_NEW_GENERATION -+ -+typedef struct _io_offload_cmd { -+ u8 rsvd0; -+ u8 cmd; -+ u16 address; -+ u32 value; -+} IO_OFFLOAD_CMD, IOL_CMD; -+ -+#define IOL_CMD_LLT 0x00 -+//#define IOL_CMD_R_EFUSE 0x01 -+#define IOL_CMD_WB_REG 0x02 -+#define IOL_CMD_WW_REG 0x03 -+#define IOL_CMD_WD_REG 0x04 -+//#define IOL_CMD_W_RF 0x05 -+#define IOL_CMD_DELAY_US 0x80 -+#define IOL_CMD_DELAY_MS 0x81 -+//#define IOL_CMD_DELAY_S 0x82 -+#define IOL_CMD_END 0x83 -+ -+/***************************************************** -+CMD Address Value -+(B1) (B2/B3:H/L addr) (B4:B7 : MSB:LSB) -+****************************************************** -+IOL_CMD_LLT - B7: PGBNDY -+//IOL_CMD_R_EFUSE - - -+IOL_CMD_WB_REG 0x0~0xFFFF B7 -+IOL_CMD_WW_REG 0x0~0xFFFF B6~B7 -+IOL_CMD_WD_REG 0x0~0xFFFF B4~B7 -+//IOL_CMD_W_RF RF Reg B5~B7 -+IOL_CMD_DELAY_US - B6~B7 -+IOL_CMD_DELAY_MS - B6~B7 -+//IOL_CMD_DELAY_S - B6~B7 -+IOL_CMD_END - - -+******************************************************/ -+int _rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value); -+int _rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value); -+int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value); -+ -+ -+int rtw_IOL_exec_cmd_array_sync(PADAPTER adapter, u8 *IOL_cmds, u32 cmd_num, u32 max_wating_ms); -+int rtw_IOL_exec_empty_cmds_sync(ADAPTER *adapter, u32 max_wating_ms); -+ -+#ifdef DBG_IO -+int dbg_rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, const char *caller, const int line); -+int dbg_rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, const char *caller, const int line); -+int dbg_rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, const char *caller, const int line); -+#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) -+#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) -+#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value) dbg_rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value), __FUNCTION__, __LINE__) -+#else -+#define rtw_IOL_append_WB_cmd(xmit_frame, addr, value) _rtw_IOL_append_WB_cmd((xmit_frame), (addr), (value)) -+#define rtw_IOL_append_WW_cmd(xmit_frame, addr, value) _rtw_IOL_append_WW_cmd((xmit_frame), (addr), (value)) -+#define rtw_IOL_append_WD_cmd(xmit_frame, addr, value) _rtw_IOL_append_WD_cmd((xmit_frame), (addr), (value)) -+#endif // DBG_IO -+#endif // CONFIG_IOL_NEW_GENERATION -+ -+ -+ -+#endif //__RTW_IOL_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_mlme_ext.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mlme_ext.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_mlme_ext.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mlme_ext.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,966 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_MLME_EXT_H_ -+#define __RTW_MLME_EXT_H_ -+ -+ -+// Commented by Albert 20101105 -+// Increase the SURVEY_TO value from 100 to 150 ( 100ms to 150ms ) -+// The Realtek 8188CE SoftAP will spend around 100ms to send the probe response after receiving the probe request. -+// So, this driver tried to extend the dwell time for each scanning channel. -+// This will increase the chance to receive the probe response from SoftAP. -+ -+#define SURVEY_TO (100) -+#define REAUTH_TO (300) //(50) -+#define REASSOC_TO (300) //(50) -+//#define DISCONNECT_TO (3000) -+#define ADDBA_TO (2000) -+ -+#define LINKED_TO (1) //unit:2 sec, 1x2=2 sec -+ -+#define REAUTH_LIMIT (4) -+#define REASSOC_LIMIT (4) -+#define READDBA_LIMIT (2) -+ -+#define ROAMING_LIMIT 8 -+#define DYNAMIC_FUNC_DISABLE (0x0) -+ -+// ====== ODM_ABILITY_E ======== -+// BB ODM section BIT 0-15 -+#define DYNAMIC_BB_DIG BIT(0) -+#define DYNAMIC_BB_RA_MASK BIT(1) -+#define DYNAMIC_BB_DYNAMIC_TXPWR BIT(2) -+#define DYNAMIC_BB_BB_FA_CNT BIT(3) -+ -+#define DYNAMIC_BB_RSSI_MONITOR BIT(4) -+#define DYNAMIC_BB_CCK_PD BIT(5) -+#define DYNAMIC_BB_ANT_DIV BIT(6) -+#define DYNAMIC_BB_PWR_SAVE BIT(7) -+#define DYNAMIC_BB_PWR_TRAIN BIT(8) -+#define DYNAMIC_BB_RATE_ADAPTIVE BIT(9) -+#define DYNAMIC_BB_PATH_DIV BIT(10) -+#define DYNAMIC_BB_PSD BIT(11) -+ -+// MAC DM section BIT 16-23 -+#define DYNAMIC_MAC_EDCA_TURBO BIT(16) -+#define DYNAMIC_MAC_EARLY_MODE BIT(17) -+ -+// RF ODM section BIT 24-31 -+#define DYNAMIC_RF_TX_PWR_TRACK BIT(24) -+#define DYNAMIC_RF_RX_GAIN_TRACK BIT(25) -+#define DYNAMIC_RF_CALIBRATION BIT(26) -+ -+#define DYNAMIC_ALL_FUNC_ENABLE 0xFFFFFFF -+ -+#define _HW_STATE_NOLINK_ 0x00 -+#define _HW_STATE_ADHOC_ 0x01 -+#define _HW_STATE_STATION_ 0x02 -+#define _HW_STATE_AP_ 0x03 -+ -+ -+#define _1M_RATE_ 0 -+#define _2M_RATE_ 1 -+#define _5M_RATE_ 2 -+#define _11M_RATE_ 3 -+#define _6M_RATE_ 4 -+#define _9M_RATE_ 5 -+#define _12M_RATE_ 6 -+#define _18M_RATE_ 7 -+#define _24M_RATE_ 8 -+#define _36M_RATE_ 9 -+#define _48M_RATE_ 10 -+#define _54M_RATE_ 11 -+ -+ -+extern unsigned char RTW_WPA_OUI[]; -+extern unsigned char WMM_OUI[]; -+extern unsigned char WPS_OUI[]; -+extern unsigned char WFD_OUI[]; -+extern unsigned char P2P_OUI[]; -+ -+extern unsigned char WMM_INFO_OUI[]; -+extern unsigned char WMM_PARA_OUI[]; -+ -+ -+// -+// Channel Plan Type. -+// Note: -+// We just add new channel plan when the new channel plan is different from any of the following -+// channel plan. -+// If you just wnat to customize the acitions(scan period or join actions) about one of the channel plan, -+// customize them in RT_CHANNEL_INFO in the RT_CHANNEL_LIST. -+// -+typedef enum _RT_CHANNEL_DOMAIN -+{ -+ //===== old channel plan mapping =====// -+ RT_CHANNEL_DOMAIN_FCC = 0x00, -+ RT_CHANNEL_DOMAIN_IC = 0x01, -+ RT_CHANNEL_DOMAIN_ETSI = 0x02, -+ RT_CHANNEL_DOMAIN_SPAIN = 0x03, -+ RT_CHANNEL_DOMAIN_FRANCE = 0x04, -+ RT_CHANNEL_DOMAIN_MKK = 0x05, -+ RT_CHANNEL_DOMAIN_MKK1 = 0x06, -+ RT_CHANNEL_DOMAIN_ISRAEL = 0x07, -+ RT_CHANNEL_DOMAIN_TELEC = 0x08, -+ RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN = 0x09, -+ RT_CHANNEL_DOMAIN_WORLD_WIDE_13 = 0x0A, -+ RT_CHANNEL_DOMAIN_TAIWAN = 0x0B, -+ RT_CHANNEL_DOMAIN_CHINA = 0x0C, -+ RT_CHANNEL_DOMAIN_SINGAPORE_INDIA_MEXICO = 0x0D, -+ RT_CHANNEL_DOMAIN_KOREA = 0x0E, -+ RT_CHANNEL_DOMAIN_TURKEY = 0x0F, -+ RT_CHANNEL_DOMAIN_JAPAN = 0x10, -+ RT_CHANNEL_DOMAIN_FCC_NO_DFS = 0x11, -+ RT_CHANNEL_DOMAIN_JAPAN_NO_DFS = 0x12, -+ RT_CHANNEL_DOMAIN_WORLD_WIDE_5G = 0x13, -+ RT_CHANNEL_DOMAIN_TAIWAN_NO_DFS = 0x14, -+ -+ //===== new channel plan mapping, (2GDOMAIN_5GDOMAIN) =====// -+ RT_CHANNEL_DOMAIN_WORLD_NULL = 0x20, -+ RT_CHANNEL_DOMAIN_ETSI1_NULL = 0x21, -+ RT_CHANNEL_DOMAIN_FCC1_NULL = 0x22, -+ RT_CHANNEL_DOMAIN_MKK1_NULL = 0x23, -+ RT_CHANNEL_DOMAIN_ETSI2_NULL = 0x24, -+ RT_CHANNEL_DOMAIN_FCC1_FCC1 = 0x25, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI1 = 0x26, -+ RT_CHANNEL_DOMAIN_MKK1_MKK1 = 0x27, -+ RT_CHANNEL_DOMAIN_WORLD_KCC1 = 0x28, -+ RT_CHANNEL_DOMAIN_WORLD_FCC2 = 0x29, -+ RT_CHANNEL_DOMAIN_WORLD_FCC3 = 0x30, -+ RT_CHANNEL_DOMAIN_WORLD_FCC4 = 0x31, -+ RT_CHANNEL_DOMAIN_WORLD_FCC5 = 0x32, -+ RT_CHANNEL_DOMAIN_WORLD_FCC6 = 0x33, -+ RT_CHANNEL_DOMAIN_FCC1_FCC7 = 0x34, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI2 = 0x35, -+ RT_CHANNEL_DOMAIN_WORLD_ETSI3 = 0x36, -+ RT_CHANNEL_DOMAIN_MKK1_MKK2 = 0x37, -+ RT_CHANNEL_DOMAIN_MKK1_MKK3 = 0x38, -+ RT_CHANNEL_DOMAIN_FCC1_NCC1 = 0x39, -+ RT_CHANNEL_DOMAIN_FCC1_NCC2 = 0x40, -+ RT_CHANNEL_DOMAIN_GLOBAL_DOAMIN_2G = 0x41, -+ //===== Add new channel plan above this line===============// -+ RT_CHANNEL_DOMAIN_MAX, -+ RT_CHANNEL_DOMAIN_REALTEK_DEFINE = 0x7F, -+}RT_CHANNEL_DOMAIN, *PRT_CHANNEL_DOMAIN; -+ -+typedef enum _RT_CHANNEL_DOMAIN_2G -+{ -+ RT_CHANNEL_DOMAIN_2G_WORLD = 0x00, //Worldwird 13 -+ RT_CHANNEL_DOMAIN_2G_ETSI1 = 0x01, //Europe -+ RT_CHANNEL_DOMAIN_2G_FCC1 = 0x02, //US -+ RT_CHANNEL_DOMAIN_2G_MKK1 = 0x03, //Japan -+ RT_CHANNEL_DOMAIN_2G_ETSI2 = 0x04, //France -+ RT_CHANNEL_DOMAIN_2G_NULL = 0x05, -+ //===== Add new channel plan above this line===============// -+ RT_CHANNEL_DOMAIN_2G_MAX, -+}RT_CHANNEL_DOMAIN_2G, *PRT_CHANNEL_DOMAIN_2G; -+ -+typedef enum _RT_CHANNEL_DOMAIN_5G -+{ -+ RT_CHANNEL_DOMAIN_5G_NULL = 0x00, -+ RT_CHANNEL_DOMAIN_5G_ETSI1 = 0x01, //Europe -+ RT_CHANNEL_DOMAIN_5G_ETSI2 = 0x02, //Australia, New Zealand -+ RT_CHANNEL_DOMAIN_5G_ETSI3 = 0x03, //Russia -+ RT_CHANNEL_DOMAIN_5G_FCC1 = 0x04, //US -+ RT_CHANNEL_DOMAIN_5G_FCC2 = 0x05, //FCC o/w DFS Channels -+ RT_CHANNEL_DOMAIN_5G_FCC3 = 0x06, //India, Mexico -+ RT_CHANNEL_DOMAIN_5G_FCC4 = 0x07, //Venezuela -+ RT_CHANNEL_DOMAIN_5G_FCC5 = 0x08, //China -+ RT_CHANNEL_DOMAIN_5G_FCC6 = 0x09, //Israel -+ RT_CHANNEL_DOMAIN_5G_FCC7_IC1 = 0x0A, //US, Canada -+ RT_CHANNEL_DOMAIN_5G_KCC1 = 0x0B, //Korea -+ RT_CHANNEL_DOMAIN_5G_MKK1 = 0x0C, //Japan -+ RT_CHANNEL_DOMAIN_5G_MKK2 = 0x0D, //Japan (W52, W53) -+ RT_CHANNEL_DOMAIN_5G_MKK3 = 0x0E, //Japan (W56) -+ RT_CHANNEL_DOMAIN_5G_NCC1 = 0x0F, //Taiwan -+ RT_CHANNEL_DOMAIN_5G_NCC2 = 0x10, //Taiwan o/w DFS -+ //===== Add new channel plan above this line===============// -+ //===== Driver Self Defined =====// -+ RT_CHANNEL_DOMAIN_5G_FCC = 0x11, -+ RT_CHANNEL_DOMAIN_5G_JAPAN_NO_DFS = 0x12, -+ RT_CHANNEL_DOMAIN_5G_FCC4_NO_DFS = 0x13, -+ RT_CHANNEL_DOMAIN_5G_MAX, -+}RT_CHANNEL_DOMAIN_5G, *PRT_CHANNEL_DOMAIN_5G; -+ -+#define rtw_is_channel_plan_valid(chplan) (chplansurvey_timer, (ms)); \ -+ } while(0) -+ -+#define set_link_timer(mlmeext, ms) \ -+ do { \ -+ /*DBG_871X("%s set_link_timer(%p, %d)\n", __FUNCTION__, (mlmeext), (ms));*/ \ -+ _set_timer(&(mlmeext)->link_timer, (ms)); \ -+ } while(0) -+ -+extern int cckrates_included(unsigned char *rate, int ratelen); -+extern int cckratesonly_included(unsigned char *rate, int ratelen); -+ -+extern void process_addba_req(_adapter *padapter, u8 *paddba_req, u8 *addr); -+ -+extern void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len); -+extern void correct_TSF(_adapter *padapter, struct mlme_ext_priv *pmlmeext); -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ sint check_buddy_mlmeinfo_state(_adapter *padapter, u32 state); -+int concurrent_chk_start_clnt_join(_adapter *padapter); -+void concurrent_chk_joinbss_done(_adapter *padapter, int join_res); -+#endif //CONFIG_CONCURRENT_MODE -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+void dc_SelectChannel(_adapter *padapter, unsigned char channel); -+void dc_SetBWMode(_adapter *padapter, unsigned short bwmode, unsigned char channel_offset); -+void dc_set_channel_bwmode_disconnect(_adapter *padapter); -+u8 dc_handle_join_request(_adapter *padapter); -+void dc_handle_join_done(_adapter *padapter, u8 join_res); -+sint dc_check_fwstate(_adapter *padapter, sint fw_state); -+u8 dc_handle_site_survey(_adapter *padapter); -+void dc_report_survey_event(_adapter *padapter, union recv_frame *precv_frame); -+void dc_set_channel_bwmode_survey_done(_adapter *padapter); -+void dc_set_ap_channel_bandwidth(_adapter *padapter, u8 channel, u8 channel_offset, u8 bwmode); -+void dc_resume_xmit(_adapter *padapter); -+u8 dc_check_xmit(_adapter *padapter); -+#endif -+ -+struct cmd_hdl { -+ uint parmsize; -+ u8 (*h2cfuns)(struct _ADAPTER *padapter, u8 *pbuf); -+}; -+ -+ -+u8 read_macreg_hdl(_adapter *padapter, u8 *pbuf); -+u8 write_macreg_hdl(_adapter *padapter, u8 *pbuf); -+u8 read_bbreg_hdl(_adapter *padapter, u8 *pbuf); -+u8 write_bbreg_hdl(_adapter *padapter, u8 *pbuf); -+u8 read_rfreg_hdl(_adapter *padapter, u8 *pbuf); -+u8 write_rfreg_hdl(_adapter *padapter, u8 *pbuf); -+ -+ -+u8 NULL_hdl(_adapter *padapter, u8 *pbuf); -+u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf); -+u8 disconnect_hdl(_adapter *padapter, u8 *pbuf); -+u8 createbss_hdl(_adapter *padapter, u8 *pbuf); -+u8 setopmode_hdl(_adapter *padapter, u8 *pbuf); -+u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf); -+u8 setauth_hdl(_adapter *padapter, u8 *pbuf); -+u8 setkey_hdl(_adapter *padapter, u8 *pbuf); -+u8 set_stakey_hdl(_adapter *padapter, u8 *pbuf); -+u8 set_assocsta_hdl(_adapter *padapter, u8 *pbuf); -+u8 del_assocsta_hdl(_adapter *padapter, u8 *pbuf); -+u8 add_ba_hdl(_adapter *padapter, unsigned char *pbuf); -+ -+u8 mlme_evt_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 h2c_msg_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 tx_beacon_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 set_ch_hdl(_adapter *padapter, u8 *pbuf); -+u8 set_chplan_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 led_blink_hdl(_adapter *padapter, unsigned char *pbuf); -+u8 set_csa_hdl(_adapter *padapter, unsigned char *pbuf); //Kurt: Handling DFS channel switch announcement ie. -+u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf); -+ -+ -+#define GEN_DRV_CMD_HANDLER(size, cmd) {size, &cmd ## _hdl}, -+#define GEN_MLME_EXT_HANDLER(size, cmd) {size, cmd}, -+ -+#ifdef _RTW_CMD_C_ -+ -+static struct cmd_hdl wlancmds[] = -+{ -+ GEN_DRV_CMD_HANDLER(0, NULL) /*0*/ -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_DRV_CMD_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) /*10*/ -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(sizeof (struct joinbss_parm), join_cmd_hdl) /*14*/ -+ GEN_MLME_EXT_HANDLER(sizeof (struct disconnect_parm), disconnect_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof (struct createbss_parm), createbss_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof (struct setopmode_parm), setopmode_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof (struct sitesurvey_parm), sitesurvey_cmd_hdl) /*18*/ -+ GEN_MLME_EXT_HANDLER(sizeof (struct setauth_parm), setauth_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof (struct setkey_parm), setkey_hdl) /*20*/ -+ GEN_MLME_EXT_HANDLER(sizeof (struct set_stakey_parm), set_stakey_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof (struct set_assocsta_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof (struct del_assocsta_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof (struct setstapwrstate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof (struct setbasicrate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof (struct getbasicrate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof (struct setdatarate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof (struct getdatarate_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof (struct setphyinfo_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof (struct getphyinfo_parm), NULL) /*30*/ -+ GEN_MLME_EXT_HANDLER(sizeof (struct setphy_parm), NULL) -+ GEN_MLME_EXT_HANDLER(sizeof (struct getphy_parm), NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) /*40*/ -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct addBaReq_parm), add_ba_hdl) -+ GEN_MLME_EXT_HANDLER(sizeof(struct set_ch_parm), set_ch_hdl) /* 46 */ -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) /*50*/ -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(0, NULL) -+ GEN_MLME_EXT_HANDLER(sizeof(struct Tx_Beacon_param), tx_beacon_hdl) /*55*/ -+ -+ GEN_MLME_EXT_HANDLER(0, mlme_evt_hdl) /*56*/ -+ GEN_MLME_EXT_HANDLER(0, rtw_drvextra_cmd_hdl) /*57*/ -+ -+ GEN_MLME_EXT_HANDLER(0, h2c_msg_hdl) /*58*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelPlan_param), set_chplan_hdl) /*59*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct LedBlink_param), led_blink_hdl) /*60*/ -+ -+ GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelSwitch_param), set_csa_hdl) /*61*/ -+ GEN_MLME_EXT_HANDLER(sizeof(struct TDLSoption_param), tdls_hdl) /*62*/ -+}; -+ -+#endif -+ -+struct C2HEvent_Header -+{ -+ -+#ifdef __LITTLE_ENDIAN -+ unsigned int len:16; -+ unsigned int ID:8; -+ unsigned int seq:8; -+#else -+ unsigned int seq:8; -+ unsigned int ID:8; -+ unsigned int len:16; -+#endif -+ unsigned int rsvd; -+}; -+ -+void rtw_dummy_event_callback(_adapter *adapter , u8 *pbuf); -+void rtw_fwdbg_event_callback(_adapter *adapter , u8 *pbuf); -+ -+enum rtw_c2h_event -+{ -+ GEN_EVT_CODE(_Read_MACREG)=0, /*0*/ -+ GEN_EVT_CODE(_Read_BBREG), -+ GEN_EVT_CODE(_Read_RFREG), -+ GEN_EVT_CODE(_Read_EEPROM), -+ GEN_EVT_CODE(_Read_EFUSE), -+ GEN_EVT_CODE(_Read_CAM), /*5*/ -+ GEN_EVT_CODE(_Get_BasicRate), -+ GEN_EVT_CODE(_Get_DataRate), -+ GEN_EVT_CODE(_Survey), /*8*/ -+ GEN_EVT_CODE(_SurveyDone), /*9*/ -+ -+ GEN_EVT_CODE(_JoinBss) , /*10*/ -+ GEN_EVT_CODE(_AddSTA), -+ GEN_EVT_CODE(_DelSTA), -+ GEN_EVT_CODE(_AtimDone) , -+ GEN_EVT_CODE(_TX_Report), -+ GEN_EVT_CODE(_CCX_Report), /*15*/ -+ GEN_EVT_CODE(_DTM_Report), -+ GEN_EVT_CODE(_TX_Rate_Statistics), -+ GEN_EVT_CODE(_C2HLBK), -+ GEN_EVT_CODE(_FWDBG), -+ GEN_EVT_CODE(_C2HFEEDBACK), /*20*/ -+ GEN_EVT_CODE(_ADDBA), -+ GEN_EVT_CODE(_C2HBCN), -+ GEN_EVT_CODE(_ReportPwrState), //filen: only for PCIE, USB -+ GEN_EVT_CODE(_CloseRF), //filen: only for PCIE, work around ASPM -+ MAX_C2HEVT -+}; -+ -+ -+#ifdef _RTW_MLME_EXT_C_ -+ -+static struct fwevent wlanevents[] = -+{ -+ {0, rtw_dummy_event_callback}, /*0*/ -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, &rtw_survey_event_callback}, /*8*/ -+ {sizeof (struct surveydone_event), &rtw_surveydone_event_callback}, /*9*/ -+ -+ {0, &rtw_joinbss_event_callback}, /*10*/ -+ {sizeof(struct stassoc_event), &rtw_stassoc_event_callback}, -+ {sizeof(struct stadel_event), &rtw_stadel_event_callback}, -+ {0, &rtw_atimdone_event_callback}, -+ {0, rtw_dummy_event_callback}, -+ {0, NULL}, /*15*/ -+ {0, NULL}, -+ {0, NULL}, -+ {0, NULL}, -+ {0, rtw_fwdbg_event_callback}, -+ {0, NULL}, /*20*/ -+ {0, NULL}, -+ {0, NULL}, -+ {0, &rtw_cpwm_event_callback}, -+}; -+ -+#endif//_RTL8192C_CMD_C_ -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_mlme.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mlme.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_mlme.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mlme.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,811 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_MLME_H_ -+#define __RTW_MLME_H_ -+ -+ -+#define MAX_BSS_CNT 128 -+//#define MAX_JOIN_TIMEOUT 2000 -+//#define MAX_JOIN_TIMEOUT 2500 -+#define MAX_JOIN_TIMEOUT 6500 -+ -+// Commented by Albert 20101105 -+// Increase the scanning timeout because of increasing the SURVEY_TO value. -+ -+#define SCANNING_TIMEOUT 8000 -+ -+#define SCAN_INTERVAL (30) // unit:2sec, 30*2=60sec -+ -+#ifdef PALTFORM_OS_WINCE -+#define SCANQUEUE_LIFETIME 12000000 // unit:us -+#else -+#define SCANQUEUE_LIFETIME 20000 // 20sec, unit:msec -+#endif -+ -+#define WIFI_NULL_STATE 0x00000000 -+#define WIFI_ASOC_STATE 0x00000001 // Under Linked state... -+#define WIFI_REASOC_STATE 0x00000002 -+#define WIFI_SLEEP_STATE 0x00000004 -+#define WIFI_STATION_STATE 0x00000008 -+#define WIFI_AP_STATE 0x00000010 -+#define WIFI_ADHOC_STATE 0x00000020 -+#define WIFI_ADHOC_MASTER_STATE 0x00000040 -+#define WIFI_UNDER_LINKING 0x00000080 -+ -+#define WIFI_UNDER_WPS 0x00000100 -+//#define WIFI_UNDER_CMD 0x00000200 -+//#define WIFI_UNDER_P2P 0x00000400 -+#define WIFI_STA_ALIVE_CHK_STATE 0x00000400 -+#define WIFI_SITE_MONITOR 0x00000800 //to indicate the station is under site surveying -+#ifdef WDS -+#define WIFI_WDS 0x00001000 -+#define WIFI_WDS_RX_BEACON 0x00002000 // already rx WDS AP beacon -+#endif -+#ifdef AUTO_CONFIG -+#define WIFI_AUTOCONF 0x00004000 -+#define WIFI_AUTOCONF_IND 0x00008000 -+#endif -+ -+/* -+// ========== P2P Section Start =============== -+#define WIFI_P2P_LISTEN_STATE 0x00010000 -+#define WIFI_P2P_GROUP_FORMATION_STATE 0x00020000 -+// ========== P2P Section End =============== -+*/ -+ -+//#ifdef UNDER_MPTEST -+#define WIFI_MP_STATE 0x00010000 -+#define WIFI_MP_CTX_BACKGROUND 0x00020000 // in continous tx background -+#define WIFI_MP_CTX_ST 0x00040000 // in continous tx with single-tone -+#define WIFI_MP_CTX_BACKGROUND_PENDING 0x00080000 // pending in continous tx background due to out of skb -+#define WIFI_MP_CTX_CCK_HW 0x00100000 // in continous tx -+#define WIFI_MP_CTX_CCK_CS 0x00200000 // in continous tx with carrier suppression -+#define WIFI_MP_LPBK_STATE 0x00400000 -+//#endif -+ -+//#define _FW_UNDER_CMD WIFI_UNDER_CMD -+#define _FW_UNDER_LINKING WIFI_UNDER_LINKING -+#define _FW_LINKED WIFI_ASOC_STATE -+#define _FW_UNDER_SURVEY WIFI_SITE_MONITOR -+ -+extern unsigned char WPA_TKIP_CIPHER[4]; -+extern unsigned char RSN_TKIP_CIPHER[4]; -+#ifdef CONFIG_DISABLE_MCS13TO15 -+extern unsigned char MCS_rate_2R_MCS13TO15_OFF[16]; -+extern unsigned char MCS_rate_2R[16]; -+#else //CONFIG_DISABLE_MCS13TO15 -+extern unsigned char MCS_rate_2R[16]; -+#endif //CONFIG_DISABLE_MCS13TO15 -+extern unsigned char MCS_rate_1R[16]; -+ -+ -+enum dot11AuthAlgrthmNum { -+ dot11AuthAlgrthm_Open = 0, -+ dot11AuthAlgrthm_Shared, -+ dot11AuthAlgrthm_8021X, -+ dot11AuthAlgrthm_Auto, -+ dot11AuthAlgrthm_WAPI, -+ dot11AuthAlgrthm_MaxNum -+}; -+ -+// Scan type including active and passive scan. -+typedef enum _RT_SCAN_TYPE -+{ -+ SCAN_PASSIVE, -+ SCAN_ACTIVE, -+ SCAN_MIX, -+}RT_SCAN_TYPE, *PRT_SCAN_TYPE; -+ -+enum _BAND -+{ -+ GHZ24_50 = 0, -+ GHZ_50, -+ GHZ_24, -+}; -+ -+enum DriverInterface { -+ DRIVER_WEXT = 1, -+ DRIVER_CFG80211 = 2 -+}; -+ -+enum SCAN_RESULT_TYPE -+{ -+ SCAN_RESULT_P2P_ONLY = 0, // Will return all the P2P devices. -+ SCAN_RESULT_ALL = 1, // Will return all the scanned device, include AP. -+ SCAN_RESULT_WFD_TYPE = 2 // Will just return the correct WFD device. -+ // If this device is Miracast sink device, it will just return all the Miracast source devices. -+}; -+ -+/* -+ -+there are several "locks" in mlme_priv, -+since mlme_priv is a shared resource between many threads, -+like ISR/Call-Back functions, the OID handlers, and even timer functions. -+ -+ -+Each _queue has its own locks, already. -+Other items are protected by mlme_priv.lock. -+ -+To avoid possible dead lock, any thread trying to modifiying mlme_priv -+SHALL not lock up more than one locks at a time! -+ -+*/ -+ -+ -+#define traffic_threshold 10 -+#define traffic_scan_period 500 -+ -+struct sitesurvey_ctrl { -+ u64 last_tx_pkts; -+ uint last_rx_pkts; -+ sint traffic_busy; -+ _timer sitesurvey_ctrl_timer; -+}; -+ -+typedef struct _RT_LINK_DETECT_T{ -+ u32 NumTxOkInPeriod; -+ u32 NumRxOkInPeriod; -+ u32 NumRxUnicastOkInPeriod; -+ bool bBusyTraffic; -+ bool bTxBusyTraffic; -+ bool bRxBusyTraffic; -+ bool bHigherBusyTraffic; // For interrupt migration purpose. -+ bool bHigherBusyRxTraffic; // We may disable Tx interrupt according as Rx traffic. -+ bool bHigherBusyTxTraffic; // We may disable Tx interrupt according as Tx traffic. -+}RT_LINK_DETECT_T, *PRT_LINK_DETECT_T; -+ -+struct profile_info { -+ u8 ssidlen; -+ u8 ssid[ WLAN_SSID_MAXLEN ]; -+ u8 peermac[ ETH_ALEN ]; -+}; -+ -+struct tx_invite_req_info{ -+ u8 token; -+ u8 benable; -+ u8 go_ssid[ WLAN_SSID_MAXLEN ]; -+ u8 ssidlen; -+ u8 go_bssid[ ETH_ALEN ]; -+ u8 peer_macaddr[ ETH_ALEN ]; -+ u8 operating_ch; // This information will be set by using the p2p_set op_ch=x -+ u8 peer_ch; // The listen channel for peer P2P device -+ -+}; -+ -+struct tx_invite_resp_info{ -+ u8 token; // Used to record the dialog token of p2p invitation request frame. -+}; -+ -+#ifdef CONFIG_WFD -+ -+struct wifi_display_info{ -+ u16 wfd_enable; // Eanble/Disable the WFD function. -+ u16 rtsp_ctrlport; // TCP port number at which the this WFD device listens for RTSP messages -+ u16 peer_rtsp_ctrlport; // TCP port number at which the peer WFD device listens for RTSP messages -+ // This filed should be filled when receiving the gropu negotiation request -+ -+ u8 peer_session_avail; // WFD session is available or not for the peer wfd device. -+ // This variable will be set when sending the provisioning discovery request to peer WFD device. -+ // And this variable will be reset when it is read by using the iwpriv p2p_get wfd_sa command. -+ u8 ip_address[4]; -+ u8 peer_ip_address[4]; -+ u8 wfd_pc; // WFD preferred connection -+ // 0 -> Prefer to use the P2P for WFD connection on peer side. -+ // 1 -> Prefer to use the TDLS for WFD connection on peer side. -+ -+ u8 wfd_device_type; // WFD Device Type -+ // 0 -> WFD Source Device -+ // 1 -> WFD Primary Sink Device -+ enum SCAN_RESULT_TYPE scan_result_type; // Used when P2P is enable. This parameter will impact the scan result. -+ -+}; -+#endif //CONFIG_WFD -+ -+struct tx_provdisc_req_info{ -+ u16 wps_config_method_request; // Used when sending the provisioning request frame -+ u16 peer_channel_num[2]; // The channel number which the receiver stands. -+ NDIS_802_11_SSID ssid; -+ u8 peerDevAddr[ ETH_ALEN ]; // Peer device address -+ u8 peerIFAddr[ ETH_ALEN ]; // Peer interface address -+ u8 benable; // This provision discovery request frame is trigger to send or not -+}; -+ -+struct rx_provdisc_req_info{ //When peer device issue prov_disc_req first, we should store the following informations -+ u8 peerDevAddr[ ETH_ALEN ]; // Peer device address -+ u8 strconfig_method_desc_of_prov_disc_req[4]; // description for the config method located in the provisioning discovery request frame. -+ // The UI must know this information to know which config method the remote p2p device is requiring. -+}; -+ -+struct tx_nego_req_info{ -+ u16 peer_channel_num[2]; // The channel number which the receiver stands. -+ u8 peerDevAddr[ ETH_ALEN ]; // Peer device address -+ u8 benable; // This negoitation request frame is trigger to send or not -+}; -+ -+struct group_id_info{ -+ u8 go_device_addr[ ETH_ALEN ]; // The GO's device address of this P2P group -+ u8 ssid[ WLAN_SSID_MAXLEN ]; // The SSID of this P2P group -+}; -+ -+struct scan_limit_info{ -+ u8 scan_op_ch_only; // When this flag is set, the driver should just scan the operation channel -+ u8 operation_ch[2]; // Store the operation channel of invitation request frame -+}; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+struct cfg80211_wifidirect_info{ -+ _timer remain_on_ch_timer; -+ u8 restore_channel; -+ struct ieee80211_channel remain_on_ch_channel; -+ enum nl80211_channel_type remain_on_ch_type; -+ u64 remain_on_ch_cookie; -+ bool is_ro_ch; -+}; -+#endif //CONFIG_IOCTL_CFG80211 -+ -+struct wifidirect_info{ -+ _adapter* padapter; -+ _timer find_phase_timer; -+ _timer restore_p2p_state_timer; -+ -+ // Used to do the scanning. After confirming the peer is availalble, the driver transmits the P2P frame to peer. -+ _timer pre_tx_scan_timer; -+ _timer reset_ch_sitesurvey; -+ _timer reset_ch_sitesurvey2; // Just for resetting the scan limit function by using p2p nego -+#ifdef CONFIG_CONCURRENT_MODE -+ // Used to switch the channel between legacy AP and listen state. -+ _timer ap_p2p_switch_timer; -+#endif -+ struct tx_provdisc_req_info tx_prov_disc_info; -+ struct rx_provdisc_req_info rx_prov_disc_info; -+ struct tx_invite_req_info invitereq_info; -+ struct profile_info profileinfo[ P2P_MAX_PERSISTENT_GROUP_NUM ]; // Store the profile information of persistent group -+ struct tx_invite_resp_info inviteresp_info; -+ struct tx_nego_req_info nego_req_info; -+ struct group_id_info groupid_info; // Store the group id information when doing the group negotiation handshake. -+ struct scan_limit_info rx_invitereq_info; // Used for get the limit scan channel from the Invitation procedure -+ struct scan_limit_info p2p_info; // Used for get the limit scan channel from the P2P negotiation handshake -+#ifdef CONFIG_WFD -+ struct wifi_display_info *wfd_info; -+#endif -+ enum P2P_ROLE role; -+ enum P2P_STATE pre_p2p_state; -+ enum P2P_STATE p2p_state; -+ u8 device_addr[ETH_ALEN]; // The device address should be the mac address of this device. -+ u8 interface_addr[ETH_ALEN]; -+ u8 social_chan[4]; -+ u8 listen_channel; -+ u8 operating_channel; -+ u8 listen_dwell; // This value should be between 1 and 3 -+ u8 support_rate[8]; -+ u8 p2p_wildcard_ssid[P2P_WILDCARD_SSID_LEN]; -+ u8 intent; // should only include the intent value. -+ u8 p2p_peer_interface_addr[ ETH_ALEN ]; -+ u8 p2p_peer_device_addr[ ETH_ALEN ]; -+ u8 peer_intent; // Included the intent value and tie breaker value. -+ u8 device_name[ WPS_MAX_DEVICE_NAME_LEN ]; // Device name for displaying on searching device screen -+ u8 device_name_len; -+ u8 profileindex; // Used to point to the index of profileinfo array -+ u8 peer_operating_ch; -+ u8 find_phase_state_exchange_cnt; -+ u16 device_password_id_for_nego; // The device password ID for group negotation -+ u8 negotiation_dialog_token; -+ u8 nego_ssid[ WLAN_SSID_MAXLEN ]; // SSID information for group negotitation -+ u8 nego_ssidlen; -+ u8 p2p_group_ssid[WLAN_SSID_MAXLEN]; -+ u8 p2p_group_ssid_len; -+ u8 persistent_supported; // Flag to know the persistent function should be supported or not. -+ // In the Sigma test, the Sigma will provide this enable from the sta_set_p2p CAPI. -+ // 0: disable -+ // 1: enable -+ u8 session_available; // Flag to set the WFD session available to enable or disable "by Sigma" -+ // In the Sigma test, the Sigma will disable the session available by using the sta_preset CAPI. -+ // 0: disable -+ // 1: enable -+ -+ u8 wfd_tdls_enable; // Flag to enable or disable the TDLS by WFD Sigma -+ // 0: disable -+ // 1: enable -+ u8 wfd_tdls_weaksec; // Flag to enable or disable the weak security function for TDLS by WFD Sigma -+ // 0: disable -+ // In this case, the driver can't issue the tdsl setup request frame. -+ // 1: enable -+ // In this case, the driver can issue the tdls setup request frame -+ // even the current security is weak security. -+ -+ enum P2P_WPSINFO ui_got_wps_info; // This field will store the WPS value (PIN value or PBC) that UI had got from the user. -+ u16 supported_wps_cm; // This field describes the WPS config method which this driver supported. -+ // The value should be the combination of config method defined in page104 of WPS v2.0 spec. -+ uint channel_list_attr_len; // This field will contain the length of body of P2P Channel List attribute of group negotitation response frame. -+ u8 channel_list_attr[100]; // This field will contain the body of P2P Channel List attribute of group negotitation response frame. -+ // We will use the channel_cnt and channel_list fields when constructing the group negotitation confirm frame. -+ u8 driver_interface; // Indicate DRIVER_WEXT or DRIVER_CFG80211 -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ u16 ext_listen_interval; // The interval to be available with legacy AP (ms) -+ u16 ext_listen_period; // The time period to be available for P2P listen state (ms) -+#endif -+#ifdef CONFIG_P2P_PS -+ enum P2P_PS_MODE p2p_ps_mode; // indicate p2p ps mode -+ enum P2P_PS_STATE p2p_ps_state; // indicate p2p ps state -+ u8 noa_index; // Identifies and instance of Notice of Absence timing. -+ u8 ctwindow; // Client traffic window. A period of time in TU after TBTT. -+ u8 opp_ps; // opportunistic power save. -+ u8 noa_num; // number of NoA descriptor in P2P IE. -+ u8 noa_count[P2P_MAX_NOA_NUM]; // Count for owner, Type of client. -+ u32 noa_duration[P2P_MAX_NOA_NUM]; // Max duration for owner, preferred or min acceptable duration for client. -+ u32 noa_interval[P2P_MAX_NOA_NUM]; // Length of interval for owner, preferred or max acceptable interval of client. -+ u32 noa_start_time[P2P_MAX_NOA_NUM]; // schedule expressed in terms of the lower 4 bytes of the TSF timer. -+#endif // CONFIG_P2P_PS -+}; -+ -+struct tdls_ss_record{ //signal strength record -+ u8 macaddr[ETH_ALEN]; -+ u8 RxPWDBAll; -+ u8 is_tdls_sta; // true: direct link sta, false: else -+}; -+ -+struct tdls_info{ -+ u8 ap_prohibited; -+ uint setup_state; -+ u8 sta_cnt; -+ u8 sta_maximum; // 1:tdls sta is equal (NUM_STA-1), reach max direct link number; 0: else; -+ struct tdls_ss_record ss_record; -+ u8 macid_index; //macid entry that is ready to write -+ u8 clear_cam; //cam entry that is trying to clear, using it in direct link teardown -+ u8 ch_sensing; -+ u8 cur_channel; -+ u8 candidate_ch; -+ u8 collect_pkt_num[MAX_CHANNEL_NUM]; -+ _lock cmd_lock; -+ _lock hdl_lock; -+ u8 watchdog_count; -+ u8 dev_discovered; //WFD_TDLS: for sigma test -+ u8 enable; -+#ifdef CONFIG_WFD -+ struct wifi_display_info *wfd_info; -+#endif -+}; -+ -+struct mlme_priv { -+ -+ _lock lock; -+ sint fw_state; //shall we protect this variable? maybe not necessarily... -+ u8 bScanInProcess; -+ u8 to_join; //flag -+ #ifdef CONFIG_LAYER2_ROAMING -+ u8 to_roaming; // roaming trying times -+ #endif -+ -+ u8 *nic_hdl; -+ -+ u8 not_indic_disco; -+ _list *pscanned; -+ _queue free_bss_pool; -+ _queue scanned_queue; -+ u8 *free_bss_buf; -+ u32 num_of_scanned; -+ -+ NDIS_802_11_SSID assoc_ssid; -+ u8 assoc_bssid[6]; -+ -+ struct wlan_network cur_network; -+ -+ //uint wireless_mode; no used, remove it -+ -+ u32 scan_interval; -+ -+ _timer assoc_timer; -+ -+ uint assoc_by_bssid; -+ uint assoc_by_rssi; -+ -+ _timer scan_to_timer; // driver itself handles scan_timeout status. -+ u32 scan_start_time; // used to evaluate the time spent in scanning -+ -+ #ifdef CONFIG_SET_SCAN_DENY_TIMER -+ _timer set_scan_deny_timer; -+ ATOMIC_T set_scan_deny; //0: allowed, 1: deny -+ #endif -+ -+ struct qos_priv qospriv; -+ -+#ifdef CONFIG_80211N_HT -+ -+ /* Number of non-HT AP/stations */ -+ int num_sta_no_ht; -+ -+ /* Number of HT AP/stations 20 MHz */ -+ //int num_sta_ht_20mhz; -+ -+ -+ int num_FortyMHzIntolerant; -+ -+ struct ht_priv htpriv; -+ -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv vhtpriv; -+#endif -+ -+ RT_LINK_DETECT_T LinkDetectInfo; -+ _timer dynamic_chk_timer; //dynamic/periodic check timer -+ -+ u8 key_mask; //use for ips to set wep key after ips_leave -+ u8 acm_mask; // for wmm acm mask -+ u8 ChannelPlan; -+ RT_SCAN_TYPE scan_mode; // active: 1, passive: 0 -+ -+ //u8 probereq_wpsie[MAX_WPS_IE_LEN];//added in probe req -+ //int probereq_wpsie_len; -+ u8 *wps_probe_req_ie; -+ u32 wps_probe_req_ie_len; -+ -+#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ /* Number of associated Non-ERP stations (i.e., stations using 802.11b -+ * in 802.11g BSS) */ -+ int num_sta_non_erp; -+ -+ /* Number of associated stations that do not support Short Slot Time */ -+ int num_sta_no_short_slot_time; -+ -+ /* Number of associated stations that do not support Short Preamble */ -+ int num_sta_no_short_preamble; -+ -+ int olbc; /* Overlapping Legacy BSS Condition */ -+ -+ /* Number of HT associated stations that do not support greenfield */ -+ int num_sta_ht_no_gf; -+ -+ /* Number of associated non-HT stations */ -+ //int num_sta_no_ht; -+ -+ /* Number of HT associated stations 20 MHz */ -+ int num_sta_ht_20mhz; -+ -+ /* Overlapping BSS information */ -+ int olbc_ht; -+ -+#ifdef CONFIG_80211N_HT -+ u16 ht_op_mode; -+#endif /* CONFIG_80211N_HT */ -+ -+ u8 *assoc_req; -+ u32 assoc_req_len; -+ u8 *assoc_rsp; -+ u32 assoc_rsp_len; -+ -+ u8 *wps_beacon_ie; -+ //u8 *wps_probe_req_ie; -+ u8 *wps_probe_resp_ie; -+ u8 *wps_assoc_resp_ie; // for CONFIG_IOCTL_CFG80211, this IE could include p2p ie / wfd ie -+ -+ u32 wps_beacon_ie_len; -+ //u32 wps_probe_req_ie_len; -+ u32 wps_probe_resp_ie_len; -+ u32 wps_assoc_resp_ie_len; // for CONFIG_IOCTL_CFG80211, this IE len could include p2p ie / wfd ie -+ -+ u8 *p2p_beacon_ie; -+ u8 *p2p_probe_req_ie; -+ u8 *p2p_probe_resp_ie; -+ u8 *p2p_go_probe_resp_ie; //for GO -+ u8 *p2p_assoc_req_ie; -+ -+ u32 p2p_beacon_ie_len; -+ u32 p2p_probe_req_ie_len; -+ u32 p2p_probe_resp_ie_len; -+ u32 p2p_go_probe_resp_ie_len; //for GO -+ u32 p2p_assoc_req_ie_len; -+/* -+#if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) -+ //u8 *wps_p2p_beacon_ie; -+ u8 *p2p_beacon_ie; -+ u8 *wps_p2p_probe_resp_ie; -+ u8 *wps_p2p_assoc_resp_ie; -+ //u32 wps_p2p_beacon_ie_len; -+ u32 p2p_beacon_ie_len; -+ u32 wps_p2p_probe_resp_ie_len; -+ u32 wps_p2p_assoc_resp_ie_len; -+#endif -+*/ -+ -+ _lock bcn_update_lock; -+ u8 update_bcn; -+ -+ -+#endif //#if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) -+ -+#if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) -+ -+ u8 *wfd_beacon_ie; -+ u8 *wfd_probe_req_ie; -+ u8 *wfd_probe_resp_ie; -+ u8 *wfd_go_probe_resp_ie; //for GO -+ u8 *wfd_assoc_req_ie; -+ -+ u32 wfd_beacon_ie_len; -+ u32 wfd_probe_req_ie_len; -+ u32 wfd_probe_resp_ie_len; -+ u32 wfd_go_probe_resp_ie_len; //for GO -+ u32 wfd_assoc_req_ie_len; -+ -+#endif -+ -+#ifdef CONFIG_INTEL_WIDI -+ int widi_state; -+ int listen_state; -+ _timer listen_timer; -+ ATOMIC_T rx_probe_rsp; // 1:receive probe respone from RDS source. -+ u8 *l2sdTaBuffer; -+ u8 channel_idx; -+ u8 group_cnt; //In WiDi 3.5, they specified another scan algo. for WFD/RDS co-existed -+ u8 sa_ext[L2SDTA_SERVICE_VE_LEN]; -+#endif // CONFIG_INTEL_WIDI -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ u8 scanning_via_buddy_intf; -+#endif -+ -+#ifdef CONFIG_FTP_PROTECT -+ u8 ftp_lock_flag; -+#endif //CONFIG_FTP_PROTECT -+}; -+ -+#ifdef CONFIG_AP_MODE -+ -+struct hostapd_priv -+{ -+ _adapter *padapter; -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ struct net_device *pmgnt_netdev; -+ struct usb_anchor anchored; -+#endif -+ -+}; -+ -+extern int hostapd_mode_init(_adapter *padapter); -+extern void hostapd_mode_unload(_adapter *padapter); -+#endif -+ -+ -+extern void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf); -+extern void rtw_survey_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_joinbss_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_atimdone_event_callback(_adapter *adapter, u8 *pbuf); -+extern void rtw_cpwm_event_callback(_adapter *adapter, u8 *pbuf); -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+void rtw_join_timeout_handler(void *FunctionContext); -+void _rtw_scan_timeout_handler(RTW_TIMER_HDL_ARGS); -+#else -+void rtw_join_timeout_handler(struct timer_list *t); -+void _rtw_scan_timeout_handler(struct timer_list *t); -+#endif -+ -+thread_return event_thread(thread_context context); -+ -+extern void rtw_free_network_queue(_adapter *adapter,u8 isfreeall); -+extern int rtw_init_mlme_priv(_adapter *adapter);// (struct mlme_priv *pmlmepriv); -+ -+extern void rtw_free_mlme_priv (struct mlme_priv *pmlmepriv); -+ -+ -+extern sint rtw_select_and_join_from_scanned_queue(struct mlme_priv *pmlmepriv); -+extern sint rtw_set_key(_adapter *adapter,struct security_priv *psecuritypriv,sint keyid, u8 set_tx); -+extern sint rtw_set_auth(_adapter *adapter,struct security_priv *psecuritypriv); -+ -+__inline static u8 *get_bssid(struct mlme_priv *pmlmepriv) -+{ //if sta_mode:pmlmepriv->cur_network.network.MacAddress=> bssid -+ // if adhoc_mode:pmlmepriv->cur_network.network.MacAddress=> ibss mac address -+ return pmlmepriv->cur_network.network.MacAddress; -+} -+ -+__inline static sint check_fwstate(struct mlme_priv *pmlmepriv, sint state) -+{ -+ if (pmlmepriv->fw_state & state) -+ return true; -+ -+ return false; -+} -+ -+__inline static sint get_fwstate(struct mlme_priv *pmlmepriv) -+{ -+ return pmlmepriv->fw_state; -+} -+ -+/* -+ * No Limit on the calling context, -+ * therefore set it to be the critical section... -+ * -+ * ### NOTE:#### (!!!!) -+ * MUST TAKE CARE THAT BEFORE CALLING THIS FUNC, YOU SHOULD HAVE LOCKED pmlmepriv->lock -+ */ -+__inline static void set_fwstate(struct mlme_priv *pmlmepriv, sint state) -+{ -+ pmlmepriv->fw_state |= state; -+ //FOR HW integration -+ if(_FW_UNDER_SURVEY==state){ -+ pmlmepriv->bScanInProcess = true; -+ } -+} -+ -+__inline static void _clr_fwstate_(struct mlme_priv *pmlmepriv, sint state) -+{ -+ pmlmepriv->fw_state &= ~state; -+ //FOR HW integration -+ if(_FW_UNDER_SURVEY==state){ -+ pmlmepriv->bScanInProcess = false; -+ } -+} -+ -+/* -+ * No Limit on the calling context, -+ * therefore set it to be the critical section... -+ */ -+__inline static void clr_fwstate(struct mlme_priv *pmlmepriv, sint state) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ if (check_fwstate(pmlmepriv, state) == true) -+ pmlmepriv->fw_state ^= state; -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+ -+__inline static void clr_fwstate_ex(struct mlme_priv *pmlmepriv, sint state) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ _clr_fwstate_(pmlmepriv, state); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+ -+__inline static void up_scanned_network(struct mlme_priv *pmlmepriv) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ pmlmepriv->num_of_scanned++; -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+ -+#ifdef CONFIG_CONCURRENT_MODE -+sint rtw_buddy_adapter_up(_adapter *padapter); -+sint check_buddy_fwstate(_adapter *padapter, sint state); -+#endif //CONFIG_CONCURRENT_MODE -+ -+__inline static void down_scanned_network(struct mlme_priv *pmlmepriv) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ pmlmepriv->num_of_scanned--; -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+ -+__inline static void set_scanned_network_val(struct mlme_priv *pmlmepriv, sint val) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ pmlmepriv->num_of_scanned = val; -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+} -+ -+extern u16 rtw_get_capability(WLAN_BSSID_EX *bss); -+extern void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target); -+extern void rtw_disconnect_hdl_under_linked(_adapter* adapter, struct sta_info *psta, u8 free_assoc); -+extern void rtw_generate_random_ibss(u8 *pibss); -+extern struct wlan_network* rtw_find_network(_queue *scanned_queue, u8 *addr); -+extern struct wlan_network* rtw_get_oldest_wlan_network(_queue *scanned_queue); -+ -+extern void rtw_free_assoc_resources(_adapter* adapter, int lock_scanned_queue); -+extern void rtw_indicate_disconnect(_adapter* adapter); -+extern void rtw_indicate_connect(_adapter* adapter); -+void rtw_indicate_scan_done( _adapter *padapter, bool aborted); -+void rtw_scan_abort(_adapter *adapter); -+ -+extern int rtw_restruct_sec_ie(_adapter *adapter,u8 *in_ie,u8 *out_ie,uint in_len); -+extern int rtw_restruct_wmm_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len, uint initial_out_len); -+extern void rtw_init_registrypriv_dev_network(_adapter *adapter); -+ -+extern void rtw_update_registrypriv_dev_network(_adapter *adapter); -+ -+extern void rtw_get_encrypt_decrypt_from_registrypriv(_adapter *adapter); -+ -+extern void _rtw_join_timeout_handler(_adapter *adapter); -+extern void rtw_scan_timeout_handler(_adapter *adapter); -+ -+extern void rtw_dynamic_check_timer_handlder(_adapter *adapter); -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+bool rtw_is_scan_deny(_adapter *adapter); -+void rtw_clear_scan_deny(_adapter *adapter); -+void rtw_set_scan_deny_timer_hdl(_adapter *adapter); -+void rtw_set_scan_deny(_adapter *adapter, u32 ms); -+#else -+#define rtw_is_scan_deny(adapter) false -+#define rtw_clear_scan_deny(adapter) do {} while (0) -+#define rtw_set_scan_deny_timer_hdl(adapter) do {} while (0) -+#define rtw_set_scan_deny(adapter, ms) do {} while (0) -+#endif -+ -+ -+extern int _rtw_init_mlme_priv(_adapter *padapter); -+ -+void rtw_free_mlme_priv_ie_data(struct mlme_priv *pmlmepriv); -+ -+extern void _rtw_free_mlme_priv(struct mlme_priv *pmlmepriv); -+ -+extern int _rtw_enqueue_network(_queue *queue, struct wlan_network *pnetwork); -+ -+//extern struct wlan_network* _rtw_dequeue_network(_queue *queue); -+ -+extern struct wlan_network* _rtw_alloc_network(struct mlme_priv *pmlmepriv); -+ -+ -+extern void _rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 isfreeall); -+extern void _rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork); -+ -+ -+extern struct wlan_network* _rtw_find_network(_queue *scanned_queue, u8 *addr); -+ -+extern void _rtw_free_network_queue(_adapter* padapter, u8 isfreeall); -+ -+extern sint rtw_if_up(_adapter *padapter); -+ -+sint rtw_linked_check(_adapter *padapter); -+ -+u8 *rtw_get_capability_from_ie(u8 *ie); -+u8 *rtw_get_timestampe_from_ie(u8 *ie); -+u8 *rtw_get_beacon_interval_from_ie(u8 *ie); -+ -+ -+void rtw_joinbss_reset(_adapter *padapter); -+ -+#ifdef CONFIG_80211N_HT -+unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len); -+void rtw_update_ht_cap(_adapter *padapter, u8 *pie, uint ie_len, u8 channel); -+void rtw_issue_addbareq_cmd(_adapter *padapter, struct xmit_frame *pxmitframe); -+#endif -+ -+int rtw_is_same_ibss(_adapter *adapter, struct wlan_network *pnetwork); -+int is_same_network(WLAN_BSSID_EX *src, WLAN_BSSID_EX *dst); -+ -+#ifdef CONFIG_LAYER2_ROAMING -+void _rtw_roaming(_adapter *adapter, struct wlan_network *tgt_network); -+void rtw_roaming(_adapter *adapter, struct wlan_network *tgt_network); -+void rtw_set_roaming(_adapter *adapter, u8 to_roaming); -+u8 rtw_to_roaming(_adapter *adapter); -+#else -+#define _rtw_roaming(adapter, tgt_network) do {} while(0) -+#define rtw_roaming(adapter, tgt_network) do {} while(0) -+#define rtw_set_roaming(adapter, to_roaming) do {} while(0) -+#define rtw_to_roaming(adapter) 0 -+#endif -+ -+void rtw_stassoc_hw_rpt(_adapter *adapter,struct sta_info *psta); -+ -+#ifdef CONFIG_INTEL_PROXIM -+void rtw_proxim_enable(_adapter *padapter); -+void rtw_proxim_disable(_adapter *padapter); -+void rtw_proxim_send_packet(_adapter *padapter,u8 *pbuf,u16 len,u8 hw_rate); -+#endif //CONFIG_INTEL_PROXIM -+#endif //__RTL871X_MLME_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_mp.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mp.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_mp.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mp.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,591 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_MP_H_ -+#define _RTW_MP_H_ -+ -+#define MAX_MP_XMITBUF_SZ 2048 -+#define NR_MP_XMITFRAME 8 -+ -+struct mp_xmit_frame -+{ -+ _list list; -+ struct pkt_attrib attrib; -+ _pkt *pkt; -+ int frame_tag; -+ _adapter *padapter; -+ -+ //insert urb, irp, and irpcnt info below... -+ u8 *mem_addr; -+ u32 sz[8]; -+ -+ PURB pxmit_urb[8]; -+ -+ u8 bpending[8]; -+ sint ac_tag[8]; -+ sint last[8]; -+ uint irpcnt; -+ uint fragcnt; -+ -+ uint mem[(MAX_MP_XMITBUF_SZ >> 2)]; -+}; -+ -+struct mp_wiparam -+{ -+ u32 bcompleted; -+ u32 act_type; -+ u32 io_offset; -+ u32 io_value; -+}; -+ -+typedef void(*wi_act_func)(void* padapter); -+ -+struct mp_tx -+{ -+ u8 stop; -+ u32 count, sended; -+ u8 payload; -+ struct pkt_attrib attrib; -+ struct tx_desc desc; -+ u8 resvdtx[7]; -+ u8 *pallocated_buf; -+ u8 *buf; -+ u32 buf_size, write_size; -+ _thread_hdl_ PktTxThread; -+}; -+ -+#define MP_MAX_LINES 1000 -+#define MP_MAX_LINES_BYTES 256 -+#define u1Byte u8 -+#define s1Byte s8 -+#define u4Byte u32 -+#define s4Byte s32 -+#define u1Byte u8 -+#define pu1Byte u8* -+ -+#define u2Byte u16 -+#define pu2Byte u16* -+ -+#define u4Byte u32 -+#define pu4Byte u32* -+ -+#define u8Byte u64 -+#define pu8Byte u64* -+ -+#define s1Byte s8 -+#define ps1Byte s8* -+ -+#define s2Byte s16 -+#define ps2Byte s16* -+ -+#define s4Byte s32 -+#define ps4Byte s32* -+ -+#define s8Byte s64 -+#define ps8Byte s64* -+ -+#define u8 u8 -+#define u16 u16 -+#define u32 u32 -+#define u32 u32 -+#define Pu32 u32* -+ -+typedef void (*MPT_WORK_ITEM_HANDLER)(void * Adapter); -+typedef struct _MPT_CONTEXT -+{ -+ // Indicate if we have started Mass Production Test. -+ bool bMassProdTest; -+ -+ // Indicate if the driver is unloading or unloaded. -+ bool bMptDrvUnload; -+ -+ _sema MPh2c_Sema; -+ _timer MPh2c_timeout_timer; -+// Event used to sync H2c for BT control -+ -+ bool MptH2cRspEvent; -+ bool MptBtC2hEvent; -+ bool bMPh2c_timeout; -+ -+ /* 8190 PCI does not support NDIS_WORK_ITEM. */ -+ // Work Item for Mass Production Test. -+ //NDIS_WORK_ITEM MptWorkItem; -+// RT_WORK_ITEM MptWorkItem; -+ // Event used to sync the case unloading driver and MptWorkItem is still in progress. -+// NDIS_EVENT MptWorkItemEvent; -+ // To protect the following variables. -+// NDIS_SPIN_LOCK MptWorkItemSpinLock; -+ // Indicate a MptWorkItem is scheduled and not yet finished. -+ bool bMptWorkItemInProgress; -+ // An instance which implements function and context of MptWorkItem. -+ MPT_WORK_ITEM_HANDLER CurrMptAct; -+ -+ // 1=Start, 0=Stop from UI. -+ u32 MptTestStart; -+ // _TEST_MODE, defined in MPT_Req2.h -+ u32 MptTestItem; -+ // Variable needed in each implementation of CurrMptAct. -+ u32 MptActType; // Type of action performed in CurrMptAct. -+ // The Offset of IO operation is depend of MptActType. -+ u32 MptIoOffset; -+ // The Value of IO operation is depend of MptActType. -+ u32 MptIoValue; -+ // The RfPath of IO operation is depend of MptActType. -+ u32 MptRfPath; -+ -+ WIRELESS_MODE MptWirelessModeToSw; // Wireless mode to switch. -+ u8 MptChannelToSw; // Channel to switch. -+ u8 MptInitGainToSet; // Initial gain to set. -+ //u32 bMptAntennaA; // TRUE if we want to use antenna A. -+ u32 MptBandWidth; // bandwidth to switch. -+ u32 MptRateIndex; // rate index. -+ // Register value kept for Single Carrier Tx test. -+ u8 btMpCckTxPower; -+ // Register value kept for Single Carrier Tx test. -+ u8 btMpOfdmTxPower; -+ // For MP Tx Power index -+ u8 TxPwrLevel[2]; // rf-A, rf-B -+ u32 RegTxPwrLimit; -+ // Content of RCR Regsiter for Mass Production Test. -+ u32 MptRCR; -+ // TRUE if we only receive packets with specific pattern. -+ bool bMptFilterPattern; -+ // Rx OK count, statistics used in Mass Production Test. -+ u32 MptRxOkCnt; -+ // Rx CRC32 error count, statistics used in Mass Production Test. -+ u32 MptRxCrcErrCnt; -+ -+ bool bCckContTx; // TRUE if we are in CCK Continuous Tx test. -+ bool bOfdmContTx; // TRUE if we are in OFDM Continuous Tx test. -+ bool bStartContTx; // TRUE if we have start Continuous Tx test. -+ // TRUE if we are in Single Carrier Tx test. -+ bool bSingleCarrier; -+ // TRUE if we are in Carrier Suppression Tx Test. -+ bool bCarrierSuppression; -+ //TRUE if we are in Single Tone Tx test. -+ bool bSingleTone; -+ -+ // ACK counter asked by K.Y.. -+ bool bMptEnableAckCounter; -+ u32 MptAckCounter; -+ -+ // SD3 Willis For 8192S to save 1T/2T RF table for ACUT Only fro ACUT delete later ~~~! -+ //s1Byte BufOfLines[2][MAX_LINES_HWCONFIG_TXT][MAX_BYTES_LINE_HWCONFIG_TXT]; -+ //s1Byte BufOfLines[2][MP_MAX_LINES][MP_MAX_LINES_BYTES]; -+ //s4Byte RfReadLine[2]; -+ -+ u8 APK_bound[2]; //for APK path A/path B -+ bool bMptIndexEven; -+ -+ u8 backup0xc50; -+ u8 backup0xc58; -+ u8 backup0xc30; -+ u8 backup0x52_RF_A; -+ u8 backup0x52_RF_B; -+ -+ u1Byte h2cReqNum; -+ u1Byte c2hBuf[20]; -+ -+ u1Byte btInBuf[100]; -+ u32 mptOutLen; -+ u1Byte mptOutBuf[100]; -+ -+}MPT_CONTEXT, *PMPT_CONTEXT; -+//#endif -+ -+/* E-Fuse */ -+#define EFUSE_MAP_SIZE 512 -+ -+#define EFUSE_MAX_SIZE 1024 -+/* end of E-Fuse */ -+ -+//#define RTPRIV_IOCTL_MP ( SIOCIWFIRSTPRIV + 0x17) -+enum { -+ WRITE_REG = 1, -+ READ_REG, -+ WRITE_RF, -+ READ_RF, -+ MP_START, -+ MP_STOP, -+ MP_RATE, -+ MP_CHANNEL, -+ MP_BANDWIDTH, -+ MP_TXPOWER, -+ MP_ANT_TX, -+ MP_ANT_RX, -+ MP_CTX, -+ MP_QUERY, -+ MP_ARX, -+ MP_PSD, -+ MP_PWRTRK, -+ MP_THER, -+ MP_IOCTL, -+ EFUSE_GET, -+ EFUSE_SET, -+ MP_RESET_STATS, -+ MP_DUMP, -+ MP_PHYPARA, -+ MP_SetRFPathSwh, -+ MP_QueryDrvStats, -+ MP_SetBT, -+ CTA_TEST, -+ MP_NULL, -+ MP_GET_TXPOWER_INX, -+}; -+ -+struct mp_priv -+{ -+ _adapter *papdater; -+ -+ //Testing Flag -+ u32 mode;//0 for normal type packet, 1 for loopback packet (16bytes TXCMD) -+ -+ u32 prev_fw_state; -+ -+ //OID cmd handler -+ struct mp_wiparam workparam; -+// u8 act_in_progress; -+ -+ //Tx Section -+ u8 TID; -+ u32 tx_pktcount; -+ struct mp_tx tx; -+ -+ //Rx Section -+ u32 rx_pktcount; -+ u32 rx_crcerrpktcount; -+ u32 rx_pktloss; -+ -+ struct recv_stat rxstat; -+ -+ //RF/BB relative -+ u8 channel; -+ u8 bandwidth; -+ u8 prime_channel_offset; -+ u8 txpoweridx; -+ u8 txpoweridx_b; -+ u8 rateidx; -+ u32 preamble; -+// u8 modem; -+ u32 CrystalCap; -+// u32 curr_crystalcap; -+ -+ u16 antenna_tx; -+ u16 antenna_rx; -+// u8 curr_rfpath; -+ -+ u8 check_mp_pkt; -+ -+ u8 bSetTxPower; -+// uint ForcedDataRate; -+ -+ struct wlan_network mp_network; -+ NDIS_802_11_MAC_ADDRESS network_macaddr; -+ -+ u8 *pallocated_mp_xmitframe_buf; -+ u8 *pmp_xmtframe_buf; -+ _queue free_mp_xmitqueue; -+ u32 free_mp_xmitframe_cnt; -+ -+ MPT_CONTEXT MptCtx; -+}; -+ -+typedef struct _IOCMD_STRUCT_ { -+ u8 cmdclass; -+ u16 value; -+ u8 index; -+}IOCMD_STRUCT; -+ -+struct rf_reg_param { -+ u32 path; -+ u32 offset; -+ u32 value; -+}; -+ -+struct bb_reg_param { -+ u32 offset; -+ u32 value; -+}; -+//======================================================================= -+ -+#define LOWER true -+#define RAISE false -+ -+/* Hardware Registers */ -+#if 0 -+#if 0 -+#define IOCMD_CTRL_REG 0x102502C0 -+#define IOCMD_DATA_REG 0x102502C4 -+#else -+#define IOCMD_CTRL_REG 0x10250370 -+#define IOCMD_DATA_REG 0x10250374 -+#endif -+ -+#define IOCMD_GET_THERMAL_METER 0xFD000028 -+ -+#define IOCMD_CLASS_BB_RF 0xF0 -+#define IOCMD_BB_READ_IDX 0x00 -+#define IOCMD_BB_WRITE_IDX 0x01 -+#define IOCMD_RF_READ_IDX 0x02 -+#define IOCMD_RF_WRIT_IDX 0x03 -+#endif -+#define BB_REG_BASE_ADDR 0x800 -+ -+/* MP variables */ -+#if 0 -+#define _2MAC_MODE_ 0 -+#define _LOOPBOOK_MODE_ 1 -+#endif -+typedef enum _MP_MODE_ { -+ MP_OFF, -+ MP_ON, -+ MP_ERR, -+ MP_CONTINUOUS_TX, -+ MP_SINGLE_CARRIER_TX, -+ MP_CARRIER_SUPPRISSION_TX, -+ MP_SINGLE_TONE_TX, -+ MP_PACKET_TX, -+ MP_PACKET_RX -+} MP_MODE; -+ -+ -+#define MAX_RF_PATH_NUMS RF_PATH_MAX -+ -+ -+extern u8 mpdatarate[NumRates]; -+ -+/* MP set force data rate base on the definition. */ -+typedef enum _MPT_RATE_INDEX -+{ -+ /* CCK rate. */ -+ MPT_RATE_1M =1 , /* 0 */ -+ MPT_RATE_2M, -+ MPT_RATE_55M, -+ MPT_RATE_11M, /* 3 */ -+ -+ /* OFDM rate. */ -+ MPT_RATE_6M, /* 4 */ -+ MPT_RATE_9M, -+ MPT_RATE_12M, -+ MPT_RATE_18M, -+ MPT_RATE_24M, -+ MPT_RATE_36M, -+ MPT_RATE_48M, -+ MPT_RATE_54M, /* 11 */ -+ -+ /* HT rate. */ -+ MPT_RATE_MCS0, /* 12 */ -+ MPT_RATE_MCS1, -+ MPT_RATE_MCS2, -+ MPT_RATE_MCS3, -+ MPT_RATE_MCS4, -+ MPT_RATE_MCS5, -+ MPT_RATE_MCS6, -+ MPT_RATE_MCS7, /* 19 */ -+ MPT_RATE_MCS8, -+ MPT_RATE_MCS9, -+ MPT_RATE_MCS10, -+ MPT_RATE_MCS11, -+ MPT_RATE_MCS12, -+ MPT_RATE_MCS13, -+ MPT_RATE_MCS14, -+ MPT_RATE_MCS15, /* 27 */ -+ /* VHT rate. Total: 20*/ -+ MPT_RATE_VHT1SS_MCS0 = 100,// To reserve MCS16~MCS31, the index starts from #100. -+ MPT_RATE_VHT1SS_MCS1, // #101 -+ MPT_RATE_VHT1SS_MCS2, -+ MPT_RATE_VHT1SS_MCS3, -+ MPT_RATE_VHT1SS_MCS4, -+ MPT_RATE_VHT1SS_MCS5, -+ MPT_RATE_VHT1SS_MCS6, // #106 -+ MPT_RATE_VHT1SS_MCS7, -+ MPT_RATE_VHT1SS_MCS8, -+ MPT_RATE_VHT1SS_MCS9, -+ MPT_RATE_VHT2SS_MCS0, -+ MPT_RATE_VHT2SS_MCS1, // #111 -+ MPT_RATE_VHT2SS_MCS2, -+ MPT_RATE_VHT2SS_MCS3, -+ MPT_RATE_VHT2SS_MCS4, -+ MPT_RATE_VHT2SS_MCS5, -+ MPT_RATE_VHT2SS_MCS6, // #116 -+ MPT_RATE_VHT2SS_MCS7, -+ MPT_RATE_VHT2SS_MCS8, -+ MPT_RATE_VHT2SS_MCS9, -+ MPT_RATE_LAST -+}MPT_RATE_E, *PMPT_RATE_E; -+ -+#define MAX_TX_PWR_INDEX_N_MODE 64 // 0x3F -+ -+typedef enum _POWER_MODE_ { -+ POWER_LOW = 0, -+ POWER_NORMAL -+}POWER_MODE; -+ -+// The following enumeration is used to define the value of Reg0xD00[30:28] or JaguarReg0x914[18:16]. -+typedef enum _OFDM_TX_MODE { -+ OFDM_ALL_OFF = 0, -+ OFDM_ContinuousTx = 1, -+ OFDM_SingleCarrier = 2, -+ OFDM_SingleTone = 4, -+} OFDM_TX_MODE; -+ -+ -+#define RX_PKT_BROADCAST 1 -+#define RX_PKT_DEST_ADDR 2 -+#define RX_PKT_PHY_MATCH 3 -+ -+#if 0 -+#define RPTMaxCount 0x000FFFFF; -+ -+// parameter 1 : BitMask -+// bit 0 : OFDM PPDU -+// bit 1 : OFDM False Alarm -+// bit 2 : OFDM MPDU OK -+// bit 3 : OFDM MPDU Fail -+// bit 4 : CCK PPDU -+// bit 5 : CCK False Alarm -+// bit 6 : CCK MPDU ok -+// bit 7 : CCK MPDU fail -+// bit 8 : HT PPDU counter -+// bit 9 : HT false alarm -+// bit 10 : HT MPDU total -+// bit 11 : HT MPDU OK -+// bit 12 : HT MPDU fail -+// bit 15 : RX full drop -+typedef enum _RXPHY_BITMASK_ -+{ -+ OFDM_PPDU_BIT = 0, -+ OFDMfalse_BIT, -+ OFDM_MPDU_OK_BIT, -+ OFDM_MPDU_FAIL_BIT, -+ CCK_PPDU_BIT, -+ CCKfalse_BIT, -+ CCK_MPDU_OK_BIT, -+ CCK_MPDU_FAIL_BIT, -+ HT_PPDU_BIT, -+ HTfalse_BIT, -+ HT_MPDU_BIT, -+ HT_MPDU_OK_BIT, -+ HT_MPDU_FAIL_BIT, -+} RXPHY_BITMASK; -+#endif -+ -+typedef enum _ENCRY_CTRL_STATE_ { -+ HW_CONTROL, //hw encryption& decryption -+ SW_CONTROL, //sw encryption& decryption -+ HW_ENCRY_SW_DECRY, //hw encryption & sw decryption -+ SW_ENCRY_HW_DECRY //sw encryption & hw decryption -+}ENCRY_CTRL_STATE; -+ -+ -+//======================================================================= -+//extern struct mp_xmit_frame *alloc_mp_xmitframe(struct mp_priv *pmp_priv); -+//extern int free_mp_xmitframe(struct xmit_priv *pxmitpriv, struct mp_xmit_frame *pmp_xmitframe); -+ -+extern s32 init_mp_priv(PADAPTER padapter); -+extern void free_mp_priv(struct mp_priv *pmp_priv); -+extern s32 MPT_InitializeAdapter(PADAPTER padapter, u8 Channel); -+extern void MPT_DeInitAdapter(PADAPTER padapter); -+extern s32 mp_start_test(PADAPTER padapter); -+extern void mp_stop_test(PADAPTER padapter); -+ -+//======================================================================= -+//extern void IQCalibrateBcut(PADAPTER pAdapter); -+ -+//extern u32 bb_reg_read(PADAPTER Adapter, u16 offset); -+//extern u8 bb_reg_write(PADAPTER Adapter, u16 offset, u32 value); -+//extern u32 rf_reg_read(PADAPTER Adapter, u8 path, u8 offset); -+//extern u8 rf_reg_write(PADAPTER Adapter, u8 path, u8 offset, u32 value); -+ -+//extern u32 get_bb_reg(PADAPTER Adapter, u16 offset, u32 bitmask); -+//extern u8 set_bb_reg(PADAPTER Adapter, u16 offset, u32 bitmask, u32 value); -+//extern u32 get_rf_reg(PADAPTER Adapter, u8 path, u8 offset, u32 bitmask); -+//extern u8 set_rf_reg(PADAPTER Adapter, u8 path, u8 offset, u32 bitmask, u32 value); -+ -+extern u32 _read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask); -+extern void _write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 bitmask, u32 val); -+ -+extern u32 read_macreg(_adapter *padapter, u32 addr, u32 sz); -+extern void write_macreg(_adapter *padapter, u32 addr, u32 val, u32 sz); -+extern u32 read_bbreg(_adapter *padapter, u32 addr, u32 bitmask); -+extern void write_bbreg(_adapter *padapter, u32 addr, u32 bitmask, u32 val); -+extern u32 read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr); -+extern void write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 val); -+ -+extern void SetChannel(PADAPTER pAdapter); -+extern void SetBandwidth(PADAPTER pAdapter); -+extern int SetTxPower(PADAPTER pAdapter); -+extern void SetAntennaPathPower(PADAPTER pAdapter); -+//extern void SetTxAGCOffset(PADAPTER pAdapter, u32 ulTxAGCOffset); -+extern void SetDataRate(PADAPTER pAdapter); -+ -+extern void SetAntenna(PADAPTER pAdapter); -+ -+//extern void SetCrystalCap(PADAPTER pAdapter); -+ -+extern s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther); -+extern void GetThermalMeter(PADAPTER pAdapter, u8 *value); -+ -+extern void SetContinuousTx(PADAPTER pAdapter, u8 bStart); -+extern void SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart); -+extern void SetSingleToneTx(PADAPTER pAdapter, u8 bStart); -+extern void SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart); -+extern void PhySetTxPowerLevel(PADAPTER pAdapter); -+ -+extern void fill_txdesc_for_mp(PADAPTER padapter, struct tx_desc *ptxdesc); -+extern void SetPacketTx(PADAPTER padapter); -+extern void SetPacketRx(PADAPTER pAdapter, u8 bStartRx); -+ -+extern void ResetPhyRxPktCount(PADAPTER pAdapter); -+extern u32 GetPhyRxPktReceived(PADAPTER pAdapter); -+extern u32 GetPhyRxPktCRC32Error(PADAPTER pAdapter); -+ -+extern s32 SetPowerTracking(PADAPTER padapter, u8 enable); -+extern void GetPowerTracking(PADAPTER padapter, u8 *enable); -+ -+extern u32 mp_query_psd(PADAPTER pAdapter, u8 *data); -+ -+ -+extern void Hal_SetAntenna(PADAPTER pAdapter); -+extern void Hal_SetBandwidth(PADAPTER pAdapter); -+ -+extern void Hal_SetTxPower(PADAPTER pAdapter); -+extern void Hal_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart); -+extern void Hal_SetSingleToneTx ( PADAPTER pAdapter , u8 bStart ); -+extern void Hal_SetSingleCarrierTx (PADAPTER pAdapter, u8 bStart); -+extern void Hal_SetContinuousTx (PADAPTER pAdapter, u8 bStart); -+extern void Hal_SetBandwidth(PADAPTER pAdapter); -+ -+extern void Hal_SetDataRate(PADAPTER pAdapter); -+extern void Hal_SetChannel(PADAPTER pAdapter); -+extern void Hal_SetAntennaPathPower(PADAPTER pAdapter); -+extern s32 Hal_SetThermalMeter(PADAPTER pAdapter, u8 target_ther); -+extern s32 Hal_SetPowerTracking(PADAPTER padapter, u8 enable); -+extern void Hal_GetPowerTracking(PADAPTER padapter, u8 * enable); -+extern void Hal_GetThermalMeter(PADAPTER pAdapter, u8 *value); -+extern void Hal_mpt_SwitchRfSetting(PADAPTER pAdapter); -+extern void Hal_MPT_CCKTxPowerAdjust(PADAPTER Adapter, bool bInCH14); -+extern void Hal_MPT_CCKTxPowerAdjustbyIndex(PADAPTER pAdapter, bool beven); -+extern void Hal_SetCCKTxPower(PADAPTER pAdapter, u8 * TxPower); -+extern void Hal_SetOFDMTxPower(PADAPTER pAdapter, u8 * TxPower); -+extern void Hal_TriggerRFThermalMeter(PADAPTER pAdapter); -+extern u8 Hal_ReadRFThermalMeter(PADAPTER pAdapter); -+extern void Hal_SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart); -+extern void Hal_SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart); -+extern void Hal_ProSetCrystalCap (PADAPTER pAdapter , u32 CrystalCapVal); -+extern void _rtw_mp_xmit_priv(struct xmit_priv *pxmitpriv); -+extern void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter ,bool bMain); -+extern u32 mpt_ProQueryCalTxPower(PADAPTER pAdapter,u8 RfPath); -+ -+#endif //_RTW_MP_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_mp_ioctl.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mp_ioctl.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_mp_ioctl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mp_ioctl.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,555 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_MP_IOCTL_H_ -+#define _RTW_MP_IOCTL_H_ -+ -+#include -+#include -+ -+//------------------------------------------------------------------------------ -+typedef struct CFG_DBG_MSG_STRUCT { -+ u32 DebugLevel; -+ u32 DebugComponent_H32; -+ u32 DebugComponent_L32; -+}CFG_DBG_MSG_STRUCT,*PCFG_DBG_MSG_STRUCT; -+ -+typedef struct _RW_REG { -+ u32 offset; -+ u32 width; -+ u32 value; -+}mp_rw_reg,RW_Reg, *pRW_Reg; -+ -+//for OID_RT_PRO_READ16_EEPROM & OID_RT_PRO_WRITE16_EEPROM -+typedef struct _EEPROM_RW_PARAM { -+ u32 offset; -+ u16 value; -+}eeprom_rw_param,EEPROM_RWParam, *pEEPROM_RWParam; -+ -+typedef struct _EFUSE_ACCESS_STRUCT_ { -+ u16 start_addr; -+ u16 cnts; -+ u8 data[0]; -+}EFUSE_ACCESS_STRUCT, *PEFUSE_ACCESS_STRUCT; -+ -+typedef struct _BURST_RW_REG { -+ u32 offset; -+ u32 len; -+ u8 Data[256]; -+}burst_rw_reg,Burst_RW_Reg, *pBurst_RW_Reg; -+ -+typedef struct _USB_VendorReq{ -+ u8 bRequest; -+ u16 wValue; -+ u16 wIndex; -+ u16 wLength; -+ u8 u8Dir;//0:OUT, 1:IN -+ u8 u8InData; -+}usb_vendor_req, USB_VendorReq, *pUSB_VendorReq; -+ -+typedef struct _DR_VARIABLE_STRUCT_ { -+ u8 offset; -+ u32 variable; -+}DR_VARIABLE_STRUCT; -+ -+//int mp_start_joinbss(_adapter *padapter, NDIS_802_11_SSID *pssid); -+ -+//void _irqlevel_changed_(_irqL *irqlevel, /*bool*/unsigned char bLower); -+#define _irqlevel_changed_(a,b) -+ -+//oid_rtl_seg_81_80_00 -+uint oid_rt_pro_set_data_rate_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_start_test_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_stop_test_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv* poid_par_priv); -+//oid_rtl_seg_81_80_20 -+uint oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv* poid_par_priv); -+ -+uint oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_modulation_hdl(struct oid_par_priv* poid_par_priv); -+ -+uint oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+//oid_rtl_seg_81_87 -+uint oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv* poid_par_priv); -+ -+uint oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+//oid_rtl_seg_81_85 -+uint oid_rt_wireless_mode_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+// oid_rtl_seg_87_11_00 -+uint oid_rt_pro8711_join_bss_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_read_register_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_write_register_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_burst_read_register_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_burst_write_register_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_write_txcmd_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_write16_eeprom_hdl (struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_rd_attrib_mem_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_wr_attrib_mem_hdl (struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_poll_rx_status_hdl(struct oid_par_priv* poid_par_priv); -+// oid_rtl_seg_87_11_20 -+uint oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_read_tssi_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv* poid_par_priv); -+//oid_rtl_seg_87_11_50 -+uint oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv* poid_par_priv); -+//oid_rtl_seg_87_11_F0 -+uint oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv* poid_par_priv); -+ -+ -+//oid_rtl_seg_87_12_00 -+uint oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_add_sta_info_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv* poid_par_priv); -+ -+uint oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv); -+uint oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv); -+uint oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv); -+uint oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv); -+uint oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv); -+uint oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv); -+ -+uint oid_rt_set_bandwidth_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_set_crystal_cap_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_set_rx_packet_type_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_efuse_max_size_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv* poid_par_priv); -+ -+uint oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv* poid_par_priv); -+ -+uint oid_rt_get_thermal_meter_hdl(struct oid_par_priv* poid_par_priv); -+ -+uint oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv* poid_par_priv); -+uint oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv* poid_par_priv); -+ -+uint oid_rt_set_power_down_hdl(struct oid_par_priv* poid_par_priv); -+ -+uint oid_rt_get_power_mode_hdl(struct oid_par_priv* poid_par_priv); -+ -+uint oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv); -+ -+#ifdef _RTW_MP_IOCTL_C_ -+ -+static const struct oid_obj_priv oid_rtl_seg_81_80_00[] = -+{ -+ {1, &oid_null_function}, //0x00 OID_RT_PRO_RESET_DUT -+ {1, &oid_rt_pro_set_data_rate_hdl}, //0x01 -+ {1, &oid_rt_pro_start_test_hdl}, //0x02 -+ {1, &oid_rt_pro_stop_test_hdl}, //0x03 -+ {1, &oid_null_function}, //0x04 OID_RT_PRO_SET_PREAMBLE -+ {1, &oid_null_function}, //0x05 OID_RT_PRO_SET_SCRAMBLER -+ {1, &oid_null_function}, //0x06 OID_RT_PRO_SET_FILTER_BB -+ {1, &oid_null_function}, //0x07 OID_RT_PRO_SET_MANUAL_DIVERSITY_BB -+ {1, &oid_rt_pro_set_channel_direct_call_hdl}, //0x08 -+ {1, &oid_null_function}, //0x09 OID_RT_PRO_SET_SLEEP_MODE_DIRECT_CALL -+ {1, &oid_null_function}, //0x0A OID_RT_PRO_SET_WAKE_MODE_DIRECT_CALL -+ {1, &oid_rt_pro_set_continuous_tx_hdl}, //0x0B OID_RT_PRO_SET_TX_CONTINUOUS_DIRECT_CALL -+ {1, &oid_rt_pro_set_single_carrier_tx_hdl}, //0x0C OID_RT_PRO_SET_SINGLE_CARRIER_TX_CONTINUOUS -+ {1, &oid_null_function}, //0x0D OID_RT_PRO_SET_TX_ANTENNA_BB -+ {1, &oid_rt_pro_set_antenna_bb_hdl}, //0x0E -+ {1, &oid_null_function}, //0x0F OID_RT_PRO_SET_CR_SCRAMBLER -+ {1, &oid_null_function}, //0x10 OID_RT_PRO_SET_CR_NEW_FILTER -+ {1, &oid_rt_pro_set_tx_power_control_hdl}, //0x11 OID_RT_PRO_SET_TX_POWER_CONTROL -+ {1, &oid_null_function}, //0x12 OID_RT_PRO_SET_CR_TX_CONFIG -+ {1, &oid_null_function}, //0x13 OID_RT_PRO_GET_TX_POWER_CONTROL -+ {1, &oid_null_function}, //0x14 OID_RT_PRO_GET_CR_SIGNAL_QUALITY -+ {1, &oid_null_function}, //0x15 OID_RT_PRO_SET_CR_SETPOINT -+ {1, &oid_null_function}, //0x16 OID_RT_PRO_SET_INTEGRATOR -+ {1, &oid_null_function}, //0x17 OID_RT_PRO_SET_SIGNAL_QUALITY -+ {1, &oid_null_function}, //0x18 OID_RT_PRO_GET_INTEGRATOR -+ {1, &oid_null_function}, //0x19 OID_RT_PRO_GET_SIGNAL_QUALITY -+ {1, &oid_null_function}, //0x1A OID_RT_PRO_QUERY_EEPROM_TYPE -+ {1, &oid_null_function}, //0x1B OID_RT_PRO_WRITE_MAC_ADDRESS -+ {1, &oid_null_function}, //0x1C OID_RT_PRO_READ_MAC_ADDRESS -+ {1, &oid_null_function}, //0x1D OID_RT_PRO_WRITE_CIS_DATA -+ {1, &oid_null_function}, //0x1E OID_RT_PRO_READ_CIS_DATA -+ {1, &oid_null_function} //0x1F OID_RT_PRO_WRITE_POWER_CONTROL -+ -+}; -+ -+static const struct oid_obj_priv oid_rtl_seg_81_80_20[] = -+{ -+ {1, &oid_null_function}, //0x20 OID_RT_PRO_READ_POWER_CONTROL -+ {1, &oid_null_function}, //0x21 OID_RT_PRO_WRITE_EEPROM -+ {1, &oid_null_function}, //0x22 OID_RT_PRO_READ_EEPROM -+ {1, &oid_rt_pro_reset_tx_packet_sent_hdl}, //0x23 -+ {1, &oid_rt_pro_query_tx_packet_sent_hdl}, //0x24 -+ {1, &oid_rt_pro_reset_rx_packet_received_hdl}, //0x25 -+ {1, &oid_rt_pro_query_rx_packet_received_hdl}, //0x26 -+ {1, &oid_rt_pro_query_rx_packet_crc32_error_hdl}, //0x27 -+ {1, &oid_null_function}, //0x28 OID_RT_PRO_QUERY_CURRENT_ADDRESS -+ {1, &oid_null_function}, //0x29 OID_RT_PRO_QUERY_PERMANENT_ADDRESS -+ {1, &oid_null_function}, //0x2A OID_RT_PRO_SET_PHILIPS_RF_PARAMETERS -+ {1, &oid_rt_pro_set_carrier_suppression_tx_hdl},//0x2B OID_RT_PRO_SET_CARRIER_SUPPRESSION_TX -+ {1, &oid_null_function}, //0x2C OID_RT_PRO_RECEIVE_PACKET -+ {1, &oid_null_function}, //0x2D OID_RT_PRO_WRITE_EEPROM_BYTE -+ {1, &oid_null_function}, //0x2E OID_RT_PRO_READ_EEPROM_BYTE -+ {1, &oid_rt_pro_set_modulation_hdl} //0x2F -+ -+}; -+ -+static const struct oid_obj_priv oid_rtl_seg_81_80_40[] = -+{ -+ {1, &oid_null_function}, //0x40 -+ {1, &oid_null_function}, //0x41 -+ {1, &oid_null_function}, //0x42 -+ {1, &oid_rt_pro_set_single_tone_tx_hdl}, //0x43 -+ {1, &oid_null_function}, //0x44 -+ {1, &oid_null_function} //0x45 -+}; -+ -+static const struct oid_obj_priv oid_rtl_seg_81_80_80[] = -+{ -+ {1, &oid_null_function}, //0x80 OID_RT_DRIVER_OPTION -+ {1, &oid_null_function}, //0x81 OID_RT_RF_OFF -+ {1, &oid_null_function} //0x82 OID_RT_AUTH_STATUS -+ -+}; -+ -+static const struct oid_obj_priv oid_rtl_seg_81_85[] = -+{ -+ {1, &oid_rt_wireless_mode_hdl} //0x00 OID_RT_WIRELESS_MODE -+}; -+ -+static struct oid_obj_priv oid_rtl_seg_81_87[] = -+{ -+ {1, &oid_null_function}, //0x80 OID_RT_PRO8187_WI_POLL -+ {1, &oid_rt_pro_write_bb_reg_hdl}, //0x81 -+ {1, &oid_rt_pro_read_bb_reg_hdl}, //0x82 -+ {1, &oid_rt_pro_write_rf_reg_hdl}, //0x82 -+ {1, &oid_rt_pro_read_rf_reg_hdl} //0x83 -+}; -+ -+static struct oid_obj_priv oid_rtl_seg_87_11_00[] = -+{ -+ {1, &oid_rt_pro8711_join_bss_hdl}, //0x00 //S -+ {1, &oid_rt_pro_read_register_hdl}, //0x01 -+ {1, &oid_rt_pro_write_register_hdl}, //0x02 -+ {1, &oid_rt_pro_burst_read_register_hdl}, //0x03 -+ {1, &oid_rt_pro_burst_write_register_hdl}, //0x04 -+ {1, &oid_rt_pro_write_txcmd_hdl}, //0x05 -+ {1, &oid_rt_pro_read16_eeprom_hdl}, //0x06 -+ {1, &oid_rt_pro_write16_eeprom_hdl}, //0x07 -+ {1, &oid_null_function}, //0x08 OID_RT_PRO_H2C_SET_COMMAND -+ {1, &oid_null_function}, //0x09 OID_RT_PRO_H2C_QUERY_RESULT -+ {1, &oid_rt_pro8711_wi_poll_hdl}, //0x0A -+ {1, &oid_rt_pro8711_pkt_loss_hdl}, //0x0B -+ {1, &oid_rt_rd_attrib_mem_hdl}, //0x0C -+ {1, &oid_rt_wr_attrib_mem_hdl}, //0x0D -+ {1, &oid_null_function}, //0x0E -+ {1, &oid_null_function}, //0x0F -+ {1, &oid_null_function}, //0x10 OID_RT_PRO_H2C_CMD_MODE -+ {1, &oid_null_function}, //0x11 OID_RT_PRO_H2C_CMD_RSP_MODE -+ {1, &oid_null_function}, //0X12 OID_RT_PRO_WAIT_C2H_EVENT -+ {1, &oid_null_function}, //0X13 OID_RT_PRO_RW_ACCESS_PROTOCOL_TEST -+ {1, &oid_null_function}, //0X14 OID_RT_PRO_SCSI_ACCESS_TEST -+ {1, &oid_null_function}, //0X15 OID_RT_PRO_SCSI_TCPIPOFFLOAD_OUT -+ {1, &oid_null_function}, //0X16 OID_RT_PRO_SCSI_TCPIPOFFLOAD_IN -+ {1, &oid_null_function}, //0X17 OID_RT_RRO_RX_PKT_VIA_IOCTRL -+ {1, &oid_null_function}, //0X18 OID_RT_RRO_RX_PKTARRAY_VIA_IOCTRL -+ {1, &oid_null_function}, //0X19 OID_RT_RPO_SET_PWRMGT_TEST -+ {1, &oid_null_function}, //0X1A -+ {1, &oid_null_function}, //0X1B OID_RT_PRO_QRY_PWRMGT_TEST -+ {1, &oid_null_function}, //0X1C OID_RT_RPO_ASYNC_RWIO_TEST -+ {1, &oid_null_function}, //0X1D OID_RT_RPO_ASYNC_RWIO_POLL -+ {1, &oid_rt_pro_set_rf_intfs_hdl}, //0X1E -+ {1, &oid_rt_poll_rx_status_hdl} //0X1F -+}; -+ -+static struct oid_obj_priv oid_rtl_seg_87_11_20[] = -+{ -+ {1, &oid_rt_pro_cfg_debug_message_hdl}, //0x20 -+ {1, &oid_rt_pro_set_data_rate_ex_hdl}, //0x21 -+ {1, &oid_rt_pro_set_basic_rate_hdl}, //0x22 -+ {1, &oid_rt_pro_read_tssi_hdl}, //0x23 -+ {1, &oid_rt_pro_set_power_tracking_hdl} //0x24 -+}; -+ -+ -+static struct oid_obj_priv oid_rtl_seg_87_11_50[] = -+{ -+ {1, &oid_rt_pro_qry_pwrstate_hdl}, //0x50 -+ {1, &oid_rt_pro_set_pwrstate_hdl} //0x51 -+}; -+ -+static struct oid_obj_priv oid_rtl_seg_87_11_80[] = -+{ -+ {1, &oid_null_function} //0x80 -+}; -+ -+static struct oid_obj_priv oid_rtl_seg_87_11_B0[] = -+{ -+ {1, &oid_null_function} //0xB0 -+}; -+ -+static struct oid_obj_priv oid_rtl_seg_87_11_F0[] = -+{ -+ {1, &oid_null_function}, //0xF0 -+ {1, &oid_null_function}, //0xF1 -+ {1, &oid_null_function}, //0xF2 -+ {1, &oid_null_function}, //0xF3 -+ {1, &oid_null_function}, //0xF4 -+ {1, &oid_null_function}, //0xF5 -+ {1, &oid_null_function}, //0xF6 -+ {1, &oid_null_function}, //0xF7 -+ {1, &oid_null_function}, //0xF8 -+ {1, &oid_null_function}, //0xF9 -+ {1, &oid_null_function}, //0xFA -+ {1, &oid_rt_pro_h2c_set_rate_table_hdl}, //0xFB -+ {1, &oid_rt_pro_h2c_get_rate_table_hdl}, //0xFC -+ {1, &oid_null_function}, //0xFD -+ {1, &oid_null_function}, //0xFE OID_RT_PRO_H2C_C2H_LBK_TEST -+ {1, &oid_null_function} //0xFF -+ -+}; -+ -+static struct oid_obj_priv oid_rtl_seg_87_12_00[]= -+{ -+ {1, &oid_rt_pro_encryption_ctrl_hdl}, //0x00 Q&S -+ {1, &oid_rt_pro_add_sta_info_hdl}, //0x01 S -+ {1, &oid_rt_pro_dele_sta_info_hdl}, //0x02 S -+ {1, &oid_rt_pro_query_dr_variable_hdl}, //0x03 Q -+ {1, &oid_rt_pro_rx_packet_type_hdl}, //0x04 Q,S -+ {1, &oid_rt_pro_read_efuse_hdl}, //0x05 Q OID_RT_PRO_READ_EFUSE -+ {1, &oid_rt_pro_write_efuse_hdl}, //0x06 S OID_RT_PRO_WRITE_EFUSE -+ {1, &oid_rt_pro_rw_efuse_pgpkt_hdl}, //0x07 Q,S -+ {1, &oid_rt_get_efuse_current_size_hdl}, //0x08 Q -+ {1, &oid_rt_set_bandwidth_hdl}, //0x09 -+ {1, &oid_rt_set_crystal_cap_hdl}, //0x0a -+ {1, &oid_rt_set_rx_packet_type_hdl}, //0x0b S -+ {1, &oid_rt_get_efuse_max_size_hdl}, //0x0c -+ {1, &oid_rt_pro_set_tx_agc_offset_hdl}, //0x0d -+ {1, &oid_rt_pro_set_pkt_test_mode_hdl}, //0x0e -+ {1, &oid_null_function}, //0x0f OID_RT_PRO_FOR_EVM_TEST_SETTING -+ {1, &oid_rt_get_thermal_meter_hdl}, //0x10 Q OID_RT_PRO_GET_THERMAL_METER -+ {1, &oid_rt_reset_phy_rx_packet_count_hdl}, //0x11 S OID_RT_RESET_PHY_RX_PACKET_COUNT -+ {1, &oid_rt_get_phy_rx_packet_received_hdl}, //0x12 Q OID_RT_GET_PHY_RX_PACKET_RECEIVED -+ {1, &oid_rt_get_phy_rx_packet_crc32_error_hdl}, //0x13 Q OID_RT_GET_PHY_RX_PACKET_CRC32_ERROR -+ {1, &oid_rt_set_power_down_hdl}, //0x14 Q OID_RT_SET_POWER_DOWN -+ {1, &oid_rt_get_power_mode_hdl} //0x15 Q OID_RT_GET_POWER_MODE -+}; -+ -+#else /* _RTL871X_MP_IOCTL_C_ */ -+ -+extern struct oid_obj_priv oid_rtl_seg_81_80_00[32]; -+extern struct oid_obj_priv oid_rtl_seg_81_80_20[16]; -+extern struct oid_obj_priv oid_rtl_seg_81_80_40[6]; -+extern struct oid_obj_priv oid_rtl_seg_81_80_80[3]; -+ -+extern struct oid_obj_priv oid_rtl_seg_81_85[1]; -+extern struct oid_obj_priv oid_rtl_seg_81_87[5]; -+ -+extern struct oid_obj_priv oid_rtl_seg_87_11_00[32]; -+extern struct oid_obj_priv oid_rtl_seg_87_11_20[5]; -+extern struct oid_obj_priv oid_rtl_seg_87_11_50[2]; -+extern struct oid_obj_priv oid_rtl_seg_87_11_80[1]; -+extern struct oid_obj_priv oid_rtl_seg_87_11_B0[1]; -+extern struct oid_obj_priv oid_rtl_seg_87_11_F0[16]; -+ -+extern struct oid_obj_priv oid_rtl_seg_87_12_00[32]; -+ -+#endif /* _RTL871X_MP_IOCTL_C_ */ -+ -+struct rwreg_param{ -+ u32 offset; -+ u32 width; -+ u32 value; -+}; -+ -+struct bbreg_param{ -+ u32 offset; -+ u32 phymask; -+ u32 value; -+}; -+/* -+struct rfchannel_param{ -+ u32 ch; -+ u32 modem; -+}; -+*/ -+struct txpower_param{ -+ u32 pwr_index; -+}; -+ -+ -+struct datarate_param{ -+ u32 rate_index; -+}; -+ -+ -+struct rfintfs_parm { -+ u32 rfintfs; -+}; -+ -+typedef struct _mp_xmit_parm_ { -+ u8 enable; -+ u32 count; -+ u16 length; -+ u8 payload_type; -+ u8 da[ETH_ALEN]; -+}MP_XMIT_PARM, *PMP_XMIT_PARM; -+ -+struct mp_xmit_packet { -+ u32 len; -+ u32 mem[MAX_MP_XMITBUF_SZ >> 2]; -+}; -+ -+struct psmode_param { -+ u32 ps_mode; -+ u32 smart_ps; -+}; -+ -+//for OID_RT_PRO_READ16_EEPROM & OID_RT_PRO_WRITE16_EEPROM -+struct eeprom_rw_param { -+ u32 offset; -+ u16 value; -+}; -+ -+struct mp_ioctl_handler { -+ u32 paramsize; -+ u32 (*handler)(struct oid_par_priv* poid_par_priv); -+ u32 oid; -+}; -+ -+struct mp_ioctl_param{ -+ u32 subcode; -+ u32 len; -+ u8 data[0]; -+}; -+ -+#define GEN_MP_IOCTL_SUBCODE(code) _MP_IOCTL_ ## code ## _CMD_ -+ -+enum RTL871X_MP_IOCTL_SUBCODE { -+ GEN_MP_IOCTL_SUBCODE(MP_START), /*0*/ -+ GEN_MP_IOCTL_SUBCODE(MP_STOP), -+ GEN_MP_IOCTL_SUBCODE(READ_REG), -+ GEN_MP_IOCTL_SUBCODE(WRITE_REG), -+ GEN_MP_IOCTL_SUBCODE(READ_BB_REG), -+ GEN_MP_IOCTL_SUBCODE(WRITE_BB_REG), /*5*/ -+ GEN_MP_IOCTL_SUBCODE(READ_RF_REG), -+ GEN_MP_IOCTL_SUBCODE(WRITE_RF_REG), -+ GEN_MP_IOCTL_SUBCODE(SET_CHANNEL), -+ GEN_MP_IOCTL_SUBCODE(SET_TXPOWER), -+ GEN_MP_IOCTL_SUBCODE(SET_DATARATE), /*10*/ -+ GEN_MP_IOCTL_SUBCODE(SET_BANDWIDTH), -+ GEN_MP_IOCTL_SUBCODE(SET_ANTENNA), -+ GEN_MP_IOCTL_SUBCODE(CNTU_TX), -+ GEN_MP_IOCTL_SUBCODE(SC_TX), -+ GEN_MP_IOCTL_SUBCODE(CS_TX), /*15*/ -+ GEN_MP_IOCTL_SUBCODE(ST_TX), -+ GEN_MP_IOCTL_SUBCODE(IOCTL_XMIT_PACKET), -+ GEN_MP_IOCTL_SUBCODE(SET_RX_PKT_TYPE), -+ GEN_MP_IOCTL_SUBCODE(RESET_PHY_RX_PKT_CNT), -+ GEN_MP_IOCTL_SUBCODE(GET_PHY_RX_PKT_RECV), /*20*/ -+ GEN_MP_IOCTL_SUBCODE(GET_PHY_RX_PKT_ERROR), -+ GEN_MP_IOCTL_SUBCODE(READ16_EEPROM), -+ GEN_MP_IOCTL_SUBCODE(WRITE16_EEPROM), -+ GEN_MP_IOCTL_SUBCODE(EFUSE), -+ GEN_MP_IOCTL_SUBCODE(EFUSE_MAP), /*25*/ -+ GEN_MP_IOCTL_SUBCODE(GET_EFUSE_MAX_SIZE), -+ GEN_MP_IOCTL_SUBCODE(GET_EFUSE_CURRENT_SIZE), -+ GEN_MP_IOCTL_SUBCODE(GET_THERMAL_METER), -+ GEN_MP_IOCTL_SUBCODE(SET_PTM), -+ GEN_MP_IOCTL_SUBCODE(SET_POWER_DOWN), /*30*/ -+ GEN_MP_IOCTL_SUBCODE(TRIGGER_GPIO), -+ GEN_MP_IOCTL_SUBCODE(SET_DM_BT), /*35*/ -+ GEN_MP_IOCTL_SUBCODE(DEL_BA), /*36*/ -+ GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS), /*37*/ -+ MAX_MP_IOCTL_SUBCODE, -+}; -+ -+u32 mp_ioctl_xmit_packet_hdl(struct oid_par_priv* poid_par_priv); -+ -+#ifdef _RTW_MP_IOCTL_C_ -+ -+#define GEN_MP_IOCTL_HANDLER(sz, hdl, oid) {sz, hdl, oid}, -+ -+#define EXT_MP_IOCTL_HANDLER(sz, subcode, oid) {sz, mp_ioctl_ ## subcode ## _hdl, oid}, -+ -+ -+struct mp_ioctl_handler mp_ioctl_hdl[] = { -+/*0*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_start_test_hdl, OID_RT_PRO_START_TEST) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_stop_test_hdl, OID_RT_PRO_STOP_TEST) -+ -+ GEN_MP_IOCTL_HANDLER(sizeof(struct rwreg_param), oid_rt_pro_read_register_hdl, OID_RT_PRO_READ_REGISTER) -+ GEN_MP_IOCTL_HANDLER(sizeof(struct rwreg_param), oid_rt_pro_write_register_hdl, OID_RT_PRO_WRITE_REGISTER) -+ GEN_MP_IOCTL_HANDLER(sizeof(struct bb_reg_param), oid_rt_pro_read_bb_reg_hdl, OID_RT_PRO_READ_BB_REG) -+/*5*/ GEN_MP_IOCTL_HANDLER(sizeof(struct bb_reg_param), oid_rt_pro_write_bb_reg_hdl, OID_RT_PRO_WRITE_BB_REG) -+ GEN_MP_IOCTL_HANDLER(sizeof(struct rf_reg_param), oid_rt_pro_read_rf_reg_hdl, OID_RT_PRO_RF_READ_REGISTRY) -+ GEN_MP_IOCTL_HANDLER(sizeof(struct rf_reg_param), oid_rt_pro_write_rf_reg_hdl, OID_RT_PRO_RF_WRITE_REGISTRY) -+ -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_channel_direct_call_hdl, OID_RT_PRO_SET_CHANNEL_DIRECT_CALL) -+ GEN_MP_IOCTL_HANDLER(sizeof(struct txpower_param), oid_rt_pro_set_tx_power_control_hdl, OID_RT_PRO_SET_TX_POWER_CONTROL) -+/*10*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_data_rate_hdl, OID_RT_PRO_SET_DATA_RATE) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_set_bandwidth_hdl, OID_RT_SET_BANDWIDTH) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_antenna_bb_hdl, OID_RT_PRO_SET_ANTENNA_BB) -+ -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_continuous_tx_hdl, OID_RT_PRO_SET_CONTINUOUS_TX) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_single_carrier_tx_hdl, OID_RT_PRO_SET_SINGLE_CARRIER_TX) -+/*15*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_carrier_suppression_tx_hdl, OID_RT_PRO_SET_CARRIER_SUPPRESSION_TX) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_single_tone_tx_hdl, OID_RT_PRO_SET_SINGLE_TONE_TX) -+ -+ EXT_MP_IOCTL_HANDLER(0, xmit_packet, 0) -+ -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_set_rx_packet_type_hdl, OID_RT_SET_RX_PACKET_TYPE) -+ GEN_MP_IOCTL_HANDLER(0, oid_rt_reset_phy_rx_packet_count_hdl, OID_RT_RESET_PHY_RX_PACKET_COUNT) -+/*20*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_phy_rx_packet_received_hdl, OID_RT_GET_PHY_RX_PACKET_RECEIVED) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_phy_rx_packet_crc32_error_hdl, OID_RT_GET_PHY_RX_PACKET_CRC32_ERROR) -+ -+ GEN_MP_IOCTL_HANDLER(sizeof(struct eeprom_rw_param), NULL, 0) -+ GEN_MP_IOCTL_HANDLER(sizeof(struct eeprom_rw_param), NULL, 0) -+ GEN_MP_IOCTL_HANDLER(sizeof(EFUSE_ACCESS_STRUCT), oid_rt_pro_efuse_hdl, OID_RT_PRO_EFUSE) -+/*25*/ GEN_MP_IOCTL_HANDLER(0, oid_rt_pro_efuse_map_hdl, OID_RT_PRO_EFUSE_MAP) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_efuse_max_size_hdl, OID_RT_GET_EFUSE_MAX_SIZE) -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_efuse_current_size_hdl, OID_RT_GET_EFUSE_CURRENT_SIZE) -+ -+ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_thermal_meter_hdl, OID_RT_PRO_GET_THERMAL_METER) -+ GEN_MP_IOCTL_HANDLER(sizeof(u8), oid_rt_pro_set_power_tracking_hdl, OID_RT_PRO_SET_POWER_TRACKING) -+/*30*/ GEN_MP_IOCTL_HANDLER(sizeof(u8), oid_rt_set_power_down_hdl, OID_RT_SET_POWER_DOWN) -+/*31*/ GEN_MP_IOCTL_HANDLER(0, oid_rt_pro_trigger_gpio_hdl, 0) -+ -+ -+}; -+ -+#else -+extern struct mp_ioctl_handler mp_ioctl_hdl[]; -+#endif -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_mp_phy_regdef.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,1092 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+/***************************************************************************** -+ * -+ * Module: __RTW_MP_PHY_REGDEF_H_ -+ * -+ * -+ * Note: 1. Define PMAC/BB register map -+ * 2. Define RF register map -+ * 3. PMAC/BB register bit mask. -+ * 4. RF reg bit mask. -+ * 5. Other BB/RF relative definition. -+ * -+ * -+ * Export: Constants, macro, functions(API), global variables(None). -+ * -+ * Abbrev: -+ * -+ * History: -+ * Data Who Remark -+ * 08/07/2007 MHC 1. Porting from 9x series PHYCFG.h. -+ * 2. Reorganize code architecture. -+ * 09/25/2008 MH 1. Add RL6052 register definition -+ * -+ *****************************************************************************/ -+#ifndef __RTW_MP_PHY_REGDEF_H_ -+#define __RTW_MP_PHY_REGDEF_H_ -+ -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+//============================================================ -+// 8192S Regsiter offset definition -+//============================================================ -+ -+// -+// BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 -+// 3. RF register 0x00-2E -+// 4. Bit Mask for BB/RF register -+// 5. Other defintion for BB/RF R/W -+// -+ -+ -+// -+// 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF -+// 1. Page1(0x100) -+// -+#define rPMAC_Reset 0x100 -+#define rPMAC_TxStart 0x104 -+#define rPMAC_TxLegacySIG 0x108 -+#define rPMAC_TxHTSIG1 0x10c -+#define rPMAC_TxHTSIG2 0x110 -+#define rPMAC_PHYDebug 0x114 -+#define rPMAC_TxPacketNum 0x118 -+#define rPMAC_TxIdle 0x11c -+#define rPMAC_TxMACHeader0 0x120 -+#define rPMAC_TxMACHeader1 0x124 -+#define rPMAC_TxMACHeader2 0x128 -+#define rPMAC_TxMACHeader3 0x12c -+#define rPMAC_TxMACHeader4 0x130 -+#define rPMAC_TxMACHeader5 0x134 -+#define rPMAC_TxDataType 0x138 -+#define rPMAC_TxRandomSeed 0x13c -+#define rPMAC_CCKPLCPPreamble 0x140 -+#define rPMAC_CCKPLCPHeader 0x144 -+#define rPMAC_CCKCRC16 0x148 -+#define rPMAC_OFDMRxCRC32OK 0x170 -+#define rPMAC_OFDMRxCRC32Er 0x174 -+#define rPMAC_OFDMRxParityEr 0x178 -+#define rPMAC_OFDMRxCRC8Er 0x17c -+#define rPMAC_CCKCRxRC16Er 0x180 -+#define rPMAC_CCKCRxRC32Er 0x184 -+#define rPMAC_CCKCRxRC32OK 0x188 -+#define rPMAC_TxStatus 0x18c -+ -+// -+// 2. Page2(0x200) -+// -+// The following two definition are only used for USB interface. -+//#define RF_BB_CMD_ADDR 0x02c0 // RF/BB read/write command address. -+//#define RF_BB_CMD_DATA 0x02c4 // RF/BB read/write command data. -+ -+// -+// 3. Page8(0x800) -+// -+#define rFPGA0_RFMOD 0x800 //RF mode & CCK TxSC // RF BW Setting?? -+ -+#define rFPGA0_TxInfo 0x804 // Status report?? -+#define rFPGA0_PSDFunction 0x808 -+ -+#define rFPGA0_TxGainStage 0x80c // Set TX PWR init gain? -+ -+#define rFPGA0_RFTiming1 0x810 // Useless now -+#define rFPGA0_RFTiming2 0x814 -+//#define rFPGA0_XC_RFTiming 0x818 -+//#define rFPGA0_XD_RFTiming 0x81c -+ -+#define rFPGA0_XA_HSSIParameter1 0x820 // RF 3 wire register -+#define rFPGA0_XA_HSSIParameter2 0x824 -+#define rFPGA0_XB_HSSIParameter1 0x828 -+#define rFPGA0_XB_HSSIParameter2 0x82c -+#define rFPGA0_XC_HSSIParameter1 0x830 -+#define rFPGA0_XC_HSSIParameter2 0x834 -+#define rFPGA0_XD_HSSIParameter1 0x838 -+#define rFPGA0_XD_HSSIParameter2 0x83c -+#define rFPGA0_XA_LSSIParameter 0x840 -+#define rFPGA0_XB_LSSIParameter 0x844 -+#define rFPGA0_XC_LSSIParameter 0x848 -+#define rFPGA0_XD_LSSIParameter 0x84c -+ -+#define rFPGA0_RFWakeUpParameter 0x850 // Useless now -+#define rFPGA0_RFSleepUpParameter 0x854 -+ -+#define rFPGA0_XAB_SwitchControl 0x858 // RF Channel switch -+#define rFPGA0_XCD_SwitchControl 0x85c -+ -+#define rFPGA0_XA_RFInterfaceOE 0x860 // RF Channel switch -+#define rFPGA0_XB_RFInterfaceOE 0x864 -+#define rFPGA0_XC_RFInterfaceOE 0x868 -+#define rFPGA0_XD_RFInterfaceOE 0x86c -+ -+#define rFPGA0_XAB_RFInterfaceSW 0x870 // RF Interface Software Control -+#define rFPGA0_XCD_RFInterfaceSW 0x874 -+ -+#define rFPGA0_XAB_RFParameter 0x878 // RF Parameter -+#define rFPGA0_XCD_RFParameter 0x87c -+ -+#define rFPGA0_AnalogParameter1 0x880 // Crystal cap setting RF-R/W protection for parameter4?? -+#define rFPGA0_AnalogParameter2 0x884 -+#define rFPGA0_AnalogParameter3 0x888 // Useless now -+#define rFPGA0_AnalogParameter4 0x88c -+ -+#define rFPGA0_XA_LSSIReadBack 0x8a0 // Tranceiver LSSI Readback -+#define rFPGA0_XB_LSSIReadBack 0x8a4 -+#define rFPGA0_XC_LSSIReadBack 0x8a8 -+#define rFPGA0_XD_LSSIReadBack 0x8ac -+ -+#define rFPGA0_PSDReport 0x8b4 // Useless now -+#define rFPGA0_XAB_RFInterfaceRB 0x8e0 // Useless now // RF Interface Readback Value -+#define rFPGA0_XCD_RFInterfaceRB 0x8e4 // Useless now -+ -+// -+// 4. Page9(0x900) -+// -+#define rFPGA1_RFMOD 0x900 //RF mode & OFDM TxSC // RF BW Setting?? -+ -+#define rFPGA1_TxBlock 0x904 // Useless now -+#define rFPGA1_DebugSelect 0x908 // Useless now -+#define rFPGA1_TxInfo 0x90c // Useless now // Status report?? -+ -+// -+// 5. PageA(0xA00) -+// -+// Set Control channel to upper or lower. These settings are required only for 40MHz -+#define rCCK0_System 0xa00 -+ -+#define rCCK0_AFESetting 0xa04 // Disable init gain now // Select RX path by RSSI -+#define rCCK0_CCA 0xa08 // Disable init gain now // Init gain -+ -+#define rCCK0_RxAGC1 0xa0c //AGC default value, saturation level // Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series -+#define rCCK0_RxAGC2 0xa10 //AGC & DAGC -+ -+#define rCCK0_RxHP 0xa14 -+ -+#define rCCK0_DSPParameter1 0xa18 //Timing recovery & Channel estimation threshold -+#define rCCK0_DSPParameter2 0xa1c //SQ threshold -+ -+#define rCCK0_TxFilter1 0xa20 -+#define rCCK0_TxFilter2 0xa24 -+#define rCCK0_DebugPort 0xa28 //debug port and Tx filter3 -+#define rCCK0_FalseAlarmReport 0xa2c //0xa2d useless now 0xa30-a4f channel report -+#define rCCK0_TRSSIReport 0xa50 -+#define rCCK0_RxReport 0xa54 //0xa57 -+#define rCCK0_FACounterLower 0xa5c //0xa5b -+#define rCCK0_FACounterUpper 0xa58 //0xa5c -+ -+// -+// 6. PageC(0xC00) -+// -+#define rOFDM0_LSTF 0xc00 -+ -+#define rOFDM0_TRxPathEnable 0xc04 -+#define rOFDM0_TRMuxPar 0xc08 -+#define rOFDM0_TRSWIsolation 0xc0c -+ -+#define rOFDM0_XARxAFE 0xc10 //RxIQ DC offset, Rx digital filter, DC notch filter -+#define rOFDM0_XARxIQImbalance 0xc14 //RxIQ imblance matrix -+#define rOFDM0_XBRxAFE 0xc18 -+#define rOFDM0_XBRxIQImbalance 0xc1c -+#define rOFDM0_XCRxAFE 0xc20 -+#define rOFDM0_XCRxIQImbalance 0xc24 -+#define rOFDM0_XDRxAFE 0xc28 -+#define rOFDM0_XDRxIQImbalance 0xc2c -+ -+#define rOFDM0_RxDetector1 0xc30 //PD,BW & SBD // DM tune init gain -+#define rOFDM0_RxDetector2 0xc34 //SBD & Fame Sync. -+#define rOFDM0_RxDetector3 0xc38 //Frame Sync. -+#define rOFDM0_RxDetector4 0xc3c //PD, SBD, Frame Sync & Short-GI -+ -+#define rOFDM0_RxDSP 0xc40 //Rx Sync Path -+#define rOFDM0_CFOandDAGC 0xc44 //CFO & DAGC -+#define rOFDM0_CCADropThreshold 0xc48 //CCA Drop threshold -+#define rOFDM0_ECCAThreshold 0xc4c // energy CCA -+ -+#define rOFDM0_XAAGCCore1 0xc50 // DIG -+#define rOFDM0_XAAGCCore2 0xc54 -+#define rOFDM0_XBAGCCore1 0xc58 -+#define rOFDM0_XBAGCCore2 0xc5c -+#define rOFDM0_XCAGCCore1 0xc60 -+#define rOFDM0_XCAGCCore2 0xc64 -+#define rOFDM0_XDAGCCore1 0xc68 -+#define rOFDM0_XDAGCCore2 0xc6c -+ -+#define rOFDM0_AGCParameter1 0xc70 -+#define rOFDM0_AGCParameter2 0xc74 -+#define rOFDM0_AGCRSSITable 0xc78 -+#define rOFDM0_HTSTFAGC 0xc7c -+ -+#define rOFDM0_XATxIQImbalance 0xc80 // TX PWR TRACK and DIG -+#define rOFDM0_XATxAFE 0xc84 -+#define rOFDM0_XBTxIQImbalance 0xc88 -+#define rOFDM0_XBTxAFE 0xc8c -+#define rOFDM0_XCTxIQImbalance 0xc90 -+#define rOFDM0_XCTxAFE 0xc94 -+#define rOFDM0_XDTxIQImbalance 0xc98 -+#define rOFDM0_XDTxAFE 0xc9c -+#define rOFDM0_RxIQExtAnta 0xca0 -+ -+#define rOFDM0_RxHPParameter 0xce0 -+#define rOFDM0_TxPseudoNoiseWgt 0xce4 -+#define rOFDM0_FrameSync 0xcf0 -+#define rOFDM0_DFSReport 0xcf4 -+#define rOFDM0_TxCoeff1 0xca4 -+#define rOFDM0_TxCoeff2 0xca8 -+#define rOFDM0_TxCoeff3 0xcac -+#define rOFDM0_TxCoeff4 0xcb0 -+#define rOFDM0_TxCoeff5 0xcb4 -+#define rOFDM0_TxCoeff6 0xcb8 -+ -+ -+// -+// 7. PageD(0xD00) -+// -+#define rOFDM1_LSTF 0xd00 -+#define rOFDM1_TRxPathEnable 0xd04 -+ -+#define rOFDM1_CFO 0xd08 // No setting now -+#define rOFDM1_CSI1 0xd10 -+#define rOFDM1_SBD 0xd14 -+#define rOFDM1_CSI2 0xd18 -+#define rOFDM1_CFOTracking 0xd2c -+#define rOFDM1_TRxMesaure1 0xd34 -+#define rOFDM1_IntfDet 0xd3c -+#define rOFDM1_PseudoNoiseStateAB 0xd50 -+#define rOFDM1_PseudoNoiseStateCD 0xd54 -+#define rOFDM1_RxPseudoNoiseWgt 0xd58 -+ -+#define rOFDM_PHYCounter1 0xda0 //cca, parity fail -+#define rOFDM_PHYCounter2 0xda4 //rate illegal, crc8 fail -+#define rOFDM_PHYCounter3 0xda8 //MCS not support -+ -+#define rOFDM_ShortCFOAB 0xdac // No setting now -+#define rOFDM_ShortCFOCD 0xdb0 -+#define rOFDM_LongCFOAB 0xdb4 -+#define rOFDM_LongCFOCD 0xdb8 -+#define rOFDM_TailCFOAB 0xdbc -+#define rOFDM_TailCFOCD 0xdc0 -+#define rOFDM_PWMeasure1 0xdc4 -+#define rOFDM_PWMeasure2 0xdc8 -+#define rOFDM_BWReport 0xdcc -+#define rOFDM_AGCReport 0xdd0 -+#define rOFDM_RxSNR 0xdd4 -+#define rOFDM_RxEVMCSI 0xdd8 -+#define rOFDM_SIGReport 0xddc -+ -+ -+// -+// 8. PageE(0xE00) -+// -+#define rTxAGC_Rate18_06 0xe00 -+#define rTxAGC_Rate54_24 0xe04 -+#define rTxAGC_CCK_Mcs32 0xe08 -+#define rTxAGC_Mcs03_Mcs00 0xe10 -+#define rTxAGC_Mcs07_Mcs04 0xe14 -+#define rTxAGC_Mcs11_Mcs08 0xe18 -+#define rTxAGC_Mcs15_Mcs12 0xe1c -+ -+// Analog- control in RX_WAIT_CCA : REG: EE0 [Analog- Power & Control Register] -+#define rRx_Wait_CCCA 0xe70 -+#define rAnapar_Ctrl_BB 0xee0 -+ -+// -+// 7. RF Register 0x00-0x2E (RF 8256) -+// RF-0222D 0x00-3F -+// -+//Zebra1 -+#define RTL92SE_FPGA_VERIFY 0 -+#define rZebra1_HSSIEnable 0x0 // Useless now -+#define rZebra1_TRxEnable1 0x1 -+#define rZebra1_TRxEnable2 0x2 -+#define rZebra1_AGC 0x4 -+#define rZebra1_ChargePump 0x5 -+//#if (RTL92SE_FPGA_VERIFY == 1) -+#define rZebra1_Channel 0x7 // RF channel switch -+//#else -+ -+//#endif -+#define rZebra1_TxGain 0x8 // Useless now -+#define rZebra1_TxLPF 0x9 -+#define rZebra1_RxLPF 0xb -+#define rZebra1_RxHPFCorner 0xc -+ -+//Zebra4 -+#define rGlobalCtrl 0 // Useless now -+#define rRTL8256_TxLPF 19 -+#define rRTL8256_RxLPF 11 -+ -+//RTL8258 -+#define rRTL8258_TxLPF 0x11 // Useless now -+#define rRTL8258_RxLPF 0x13 -+#define rRTL8258_RSSILPF 0xa -+ -+// -+// RL6052 Register definition -+// -+#define RF_AC 0x00 // -+ -+#define RF_IQADJ_G1 0x01 // -+#define RF_IQADJ_G2 0x02 // -+#define RF_POW_TRSW 0x05 // -+ -+#define RF_GAIN_RX 0x06 // -+#define RF_GAIN_TX 0x07 // -+ -+#define RF_TXM_IDAC 0x08 // -+#define RF_BS_IQGEN 0x0F // -+ -+#define RF_MODE1 0x10 // -+#define RF_MODE2 0x11 // -+ -+#define RF_RX_AGC_HP 0x12 // -+#define RF_TX_AGC 0x13 // -+#define RF_BIAS 0x14 // -+#define RF_IPA 0x15 // -+#define RF_TXBIAS 0x16 // -+#define RF_POW_ABILITY 0x17 // -+#define RF_MODE_AG 0x18 // -+#define rRfChannel 0x18 // RF channel and BW switch -+#define RF_CHNLBW 0x18 // RF channel and BW switch -+#define RF_TOP 0x19 // -+ -+#define RF_RX_G1 0x1A // -+#define RF_RX_G2 0x1B // -+ -+#define RF_RX_BB2 0x1C // -+#define RF_RX_BB1 0x1D // -+ -+#define RF_RCK1 0x1E // -+#define RF_RCK2 0x1F // -+ -+#define RF_TX_G1 0x20 // -+#define RF_TX_G2 0x21 // -+#define RF_TX_G3 0x22 // -+ -+#define RF_TX_BB1 0x23 // -+ -+#define RF_T_METER 0x24 // -+ -+#define RF_SYN_G1 0x25 // RF TX Power control -+#define RF_SYN_G2 0x26 // RF TX Power control -+#define RF_SYN_G3 0x27 // RF TX Power control -+#define RF_SYN_G4 0x28 // RF TX Power control -+#define RF_SYN_G5 0x29 // RF TX Power control -+#define RF_SYN_G6 0x2A // RF TX Power control -+#define RF_SYN_G7 0x2B // RF TX Power control -+#define RF_SYN_G8 0x2C // RF TX Power control -+ -+#define RF_RCK_OS 0x30 // RF TX PA control -+ -+#define RF_TXPA_G1 0x31 // RF TX PA control -+#define RF_TXPA_G2 0x32 // RF TX PA control -+#define RF_TXPA_G3 0x33 // RF TX PA control -+ -+// -+//Bit Mask -+// -+// 1. Page1(0x100) -+#define bBBResetB 0x100 // Useless now? -+#define bGlobalResetB 0x200 -+#define bOFDMTxStart 0x4 -+#define bCCKTxStart 0x8 -+#define bCRC32Debug 0x100 -+#define bPMACLoopback 0x10 -+#define bTxLSIG 0xffffff -+#define bOFDMTxRate 0xf -+#define bOFDMTxReserved 0x10 -+#define bOFDMTxLength 0x1ffe0 -+#define bOFDMTxParity 0x20000 -+#define bTxHTSIG1 0xffffff -+#define bTxHTMCSRate 0x7f -+#define bTxHTBW 0x80 -+#define bTxHTLength 0xffff00 -+#define bTxHTSIG2 0xffffff -+#define bTxHTSmoothing 0x1 -+#define bTxHTSounding 0x2 -+#define bTxHTReserved 0x4 -+#define bTxHTAggreation 0x8 -+#define bTxHTSTBC 0x30 -+#define bTxHTAdvanceCoding 0x40 -+#define bTxHTShortGI 0x80 -+#define bTxHTNumberHT_LTF 0x300 -+#define bTxHTCRC8 0x3fc00 -+#define bCounterReset 0x10000 -+#define bNumOfOFDMTx 0xffff -+#define bNumOfCCKTx 0xffff0000 -+#define bTxIdleInterval 0xffff -+#define bOFDMService 0xffff0000 -+#define bTxMACHeader 0xffffffff -+#define bTxDataInit 0xff -+#define bTxHTMode 0x100 -+#define bTxDataType 0x30000 -+#define bTxRandomSeed 0xffffffff -+#define bCCKTxPreamble 0x1 -+#define bCCKTxSFD 0xffff0000 -+#define bCCKTxSIG 0xff -+#define bCCKTxService 0xff00 -+#define bCCKLengthExt 0x8000 -+#define bCCKTxLength 0xffff0000 -+#define bCCKTxCRC16 0xffff -+#define bCCKTxStatus 0x1 -+#define bOFDMTxStatus 0x2 -+ -+#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) -+ -+// 2. Page8(0x800) -+#define bRFMOD 0x1 // Reg 0x800 rFPGA0_RFMOD -+#define bJapanMode 0x2 -+#define bCCKTxSC 0x30 -+#define bCCKEn 0x1000000 -+#define bOFDMEn 0x2000000 -+ -+#define bOFDMRxADCPhase 0x10000 // Useless now -+#define bOFDMTxDACPhase 0x40000 -+#define bXATxAGC 0x3f -+ -+#define bXBTxAGC 0xf00 // Reg 80c rFPGA0_TxGainStage -+#define bXCTxAGC 0xf000 -+#define bXDTxAGC 0xf0000 -+ -+#define bPAStart 0xf0000000 // Useless now -+#define bTRStart 0x00f00000 -+#define bRFStart 0x0000f000 -+#define bBBStart 0x000000f0 -+#define bBBCCKStart 0x0000000f -+#define bPAEnd 0xf //Reg0x814 -+#define bTREnd 0x0f000000 -+#define bRFEnd 0x000f0000 -+#define bCCAMask 0x000000f0 //T2R -+#define bR2RCCAMask 0x00000f00 -+#define bHSSI_R2TDelay 0xf8000000 -+#define bHSSI_T2RDelay 0xf80000 -+#define bContTxHSSI 0x400 //chane gain at continue Tx -+#define bIGFromCCK 0x200 -+#define bAGCAddress 0x3f -+#define bRxHPTx 0x7000 -+#define bRxHPT2R 0x38000 -+#define bRxHPCCKIni 0xc0000 -+#define bAGCTxCode 0xc00000 -+#define bAGCRxCode 0x300000 -+ -+#define b3WireDataLength 0x800 // Reg 0x820~84f rFPGA0_XA_HSSIParameter1 -+#define b3WireAddressLength 0x400 -+ -+#define b3WireRFPowerDown 0x1 // Useless now -+//#define bHWSISelect 0x8 -+#define b5GPAPEPolarity 0x40000000 -+#define b2GPAPEPolarity 0x80000000 -+#define bRFSW_TxDefaultAnt 0x3 -+#define bRFSW_TxOptionAnt 0x30 -+#define bRFSW_RxDefaultAnt 0x300 -+#define bRFSW_RxOptionAnt 0x3000 -+#define bRFSI_3WireData 0x1 -+#define bRFSI_3WireClock 0x2 -+#define bRFSI_3WireLoad 0x4 -+#define bRFSI_3WireRW 0x8 -+#define bRFSI_3Wire 0xf -+ -+#define bRFSI_RFENV 0x10 // Reg 0x870 rFPGA0_XAB_RFInterfaceSW -+ -+#define bRFSI_TRSW 0x20 // Useless now -+#define bRFSI_TRSWB 0x40 -+#define bRFSI_ANTSW 0x100 -+#define bRFSI_ANTSWB 0x200 -+#define bRFSI_PAPE 0x400 -+#define bRFSI_PAPE5G 0x800 -+#define bBandSelect 0x1 -+#define bHTSIG2_GI 0x80 -+#define bHTSIG2_Smoothing 0x01 -+#define bHTSIG2_Sounding 0x02 -+#define bHTSIG2_Aggreaton 0x08 -+#define bHTSIG2_STBC 0x30 -+#define bHTSIG2_AdvCoding 0x40 -+#define bHTSIG2_NumOfHTLTF 0x300 -+#define bHTSIG2_CRC8 0x3fc -+#define bHTSIG1_MCS 0x7f -+#define bHTSIG1_BandWidth 0x80 -+#define bHTSIG1_HTLength 0xffff -+#define bLSIG_Rate 0xf -+#define bLSIG_Reserved 0x10 -+#define bLSIG_Length 0x1fffe -+#define bLSIG_Parity 0x20 -+#define bCCKRxPhase 0x4 -+#if (RTL92SE_FPGA_VERIFY == 1) -+#define bLSSIReadAddress 0x3f000000 //LSSI "Read" Address // Reg 0x824 rFPGA0_XA_HSSIParameter2 -+#else -+#define bLSSIReadAddress 0x7f800000 // T65 RF -+#endif -+#define bLSSIReadEdge 0x80000000 //LSSI "Read" edge signal -+#if (RTL92SE_FPGA_VERIFY == 1) -+#define bLSSIReadBackData 0xfff // Reg 0x8a0 rFPGA0_XA_LSSIReadBack -+#else -+#define bLSSIReadBackData 0xfffff // T65 RF -+#endif -+#define bLSSIReadOKFlag 0x1000 // Useless now -+#define bCCKSampleRate 0x8 //0: 44MHz, 1:88MHz -+#define bRegulator0Standby 0x1 -+#define bRegulatorPLLStandby 0x2 -+#define bRegulator1Standby 0x4 -+#define bPLLPowerUp 0x8 -+#define bDPLLPowerUp 0x10 -+#define bDA10PowerUp 0x20 -+#define bAD7PowerUp 0x200 -+#define bDA6PowerUp 0x2000 -+#define bXtalPowerUp 0x4000 -+#define b40MDClkPowerUP 0x8000 -+#define bDA6DebugMode 0x20000 -+#define bDA6Swing 0x380000 -+ -+#define bADClkPhase 0x4000000 // Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ -+ -+#define b80MClkDelay 0x18000000 // Useless -+#define bAFEWatchDogEnable 0x20000000 -+ -+#define bXtalCap01 0xc0000000 // Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap -+#define bXtalCap23 0x3 -+#define bXtalCap92x 0x0f000000 -+#define bXtalCap 0x0f000000 -+ -+#define bIntDifClkEnable 0x400 // Useless -+#define bExtSigClkEnable 0x800 -+#define bBandgapMbiasPowerUp 0x10000 -+#define bAD11SHGain 0xc0000 -+#define bAD11InputRange 0x700000 -+#define bAD11OPCurrent 0x3800000 -+#define bIPathLoopback 0x4000000 -+#define bQPathLoopback 0x8000000 -+#define bAFELoopback 0x10000000 -+#define bDA10Swing 0x7e0 -+#define bDA10Reverse 0x800 -+#define bDAClkSource 0x1000 -+#define bAD7InputRange 0x6000 -+#define bAD7Gain 0x38000 -+#define bAD7OutputCMMode 0x40000 -+#define bAD7InputCMMode 0x380000 -+#define bAD7Current 0xc00000 -+#define bRegulatorAdjust 0x7000000 -+#define bAD11PowerUpAtTx 0x1 -+#define bDA10PSAtTx 0x10 -+#define bAD11PowerUpAtRx 0x100 -+#define bDA10PSAtRx 0x1000 -+#define bCCKRxAGCFormat 0x200 -+#define bPSDFFTSamplepPoint 0xc000 -+#define bPSDAverageNum 0x3000 -+#define bIQPathControl 0xc00 -+#define bPSDFreq 0x3ff -+#define bPSDAntennaPath 0x30 -+#define bPSDIQSwitch 0x40 -+#define bPSDRxTrigger 0x400000 -+#define bPSDTxTrigger 0x80000000 -+#define bPSDSineToneScale 0x7f000000 -+#define bPSDReport 0xffff -+ -+// 3. Page9(0x900) -+#define bOFDMTxSC 0x30000000 // Useless -+#define bCCKTxOn 0x1 -+#define bOFDMTxOn 0x2 -+#define bDebugPage 0xfff //reset debug page and also HWord, LWord -+#define bDebugItem 0xff //reset debug page and LWord -+#define bAntL 0x10 -+#define bAntNonHT 0x100 -+#define bAntHT1 0x1000 -+#define bAntHT2 0x10000 -+#define bAntHT1S1 0x100000 -+#define bAntNonHTS1 0x1000000 -+ -+// 4. PageA(0xA00) -+#define bCCKBBMode 0x3 // Useless -+#define bCCKTxPowerSaving 0x80 -+#define bCCKRxPowerSaving 0x40 -+ -+#define bCCKSideBand 0x10 // Reg 0xa00 rCCK0_System 20/40 switch -+ -+#define bCCKScramble 0x8 // Useless -+#define bCCKAntDiversity 0x8000 -+#define bCCKCarrierRecovery 0x4000 -+#define bCCKTxRate 0x3000 -+#define bCCKDCCancel 0x0800 -+#define bCCKISICancel 0x0400 -+#define bCCKMatchFilter 0x0200 -+#define bCCKEqualizer 0x0100 -+#define bCCKPreambleDetect 0x800000 -+#define bCCKFastFalseCCA 0x400000 -+#define bCCKChEstStart 0x300000 -+#define bCCKCCACount 0x080000 -+#define bCCKcs_lim 0x070000 -+#define bCCKBistMode 0x80000000 -+#define bCCKCCAMask 0x40000000 -+#define bCCKTxDACPhase 0x4 -+#define bCCKRxADCPhase 0x20000000 //r_rx_clk -+#define bCCKr_cp_mode0 0x0100 -+#define bCCKTxDCOffset 0xf0 -+#define bCCKRxDCOffset 0xf -+#define bCCKCCAMode 0xc000 -+#define bCCKFalseCS_lim 0x3f00 -+#define bCCKCS_ratio 0xc00000 -+#define bCCKCorgBit_sel 0x300000 -+#define bCCKPD_lim 0x0f0000 -+#define bCCKNewCCA 0x80000000 -+#define bCCKRxHPofIG 0x8000 -+#define bCCKRxIG 0x7f00 -+#define bCCKLNAPolarity 0x800000 -+#define bCCKRx1stGain 0x7f0000 -+#define bCCKRFExtend 0x20000000 //CCK Rx Iinital gain polarity -+#define bCCKRxAGCSatLevel 0x1f000000 -+#define bCCKRxAGCSatCount 0xe0 -+#define bCCKRxRFSettle 0x1f //AGCsamp_dly -+#define bCCKFixedRxAGC 0x8000 -+//#define bCCKRxAGCFormat 0x4000 //remove to HSSI register 0x824 -+#define bCCKAntennaPolarity 0x2000 -+#define bCCKTxFilterType 0x0c00 -+#define bCCKRxAGCReportType 0x0300 -+#define bCCKRxDAGCEn 0x80000000 -+#define bCCKRxDAGCPeriod 0x20000000 -+#define bCCKRxDAGCSatLevel 0x1f000000 -+#define bCCKTimingRecovery 0x800000 -+#define bCCKTxC0 0x3f0000 -+#define bCCKTxC1 0x3f000000 -+#define bCCKTxC2 0x3f -+#define bCCKTxC3 0x3f00 -+#define bCCKTxC4 0x3f0000 -+#define bCCKTxC5 0x3f000000 -+#define bCCKTxC6 0x3f -+#define bCCKTxC7 0x3f00 -+#define bCCKDebugPort 0xff0000 -+#define bCCKDACDebug 0x0f000000 -+#define bCCKFalseAlarmEnable 0x8000 -+#define bCCKFalseAlarmRead 0x4000 -+#define bCCKTRSSI 0x7f -+#define bCCKRxAGCReport 0xfe -+#define bCCKRxReport_AntSel 0x80000000 -+#define bCCKRxReport_MFOff 0x40000000 -+#define bCCKRxRxReport_SQLoss 0x20000000 -+#define bCCKRxReport_Pktloss 0x10000000 -+#define bCCKRxReport_Lockedbit 0x08000000 -+#define bCCKRxReport_RateError 0x04000000 -+#define bCCKRxReport_RxRate 0x03000000 -+#define bCCKRxFACounterLower 0xff -+#define bCCKRxFACounterUpper 0xff000000 -+#define bCCKRxHPAGCStart 0xe000 -+#define bCCKRxHPAGCFinal 0x1c00 -+#define bCCKRxFalseAlarmEnable 0x8000 -+#define bCCKFACounterFreeze 0x4000 -+#define bCCKTxPathSel 0x10000000 -+#define bCCKDefaultRxPath 0xc000000 -+#define bCCKOptionRxPath 0x3000000 -+ -+// 5. PageC(0xC00) -+#define bNumOfSTF 0x3 // Useless -+#define bShift_L 0xc0 -+#define bGI_TH 0xc -+#define bRxPathA 0x1 -+#define bRxPathB 0x2 -+#define bRxPathC 0x4 -+#define bRxPathD 0x8 -+#define bTxPathA 0x1 -+#define bTxPathB 0x2 -+#define bTxPathC 0x4 -+#define bTxPathD 0x8 -+#define bTRSSIFreq 0x200 -+#define bADCBackoff 0x3000 -+#define bDFIRBackoff 0xc000 -+#define bTRSSILatchPhase 0x10000 -+#define bRxIDCOffset 0xff -+#define bRxQDCOffset 0xff00 -+#define bRxDFIRMode 0x1800000 -+#define bRxDCNFType 0xe000000 -+#define bRXIQImb_A 0x3ff -+#define bRXIQImb_B 0xfc00 -+#define bRXIQImb_C 0x3f0000 -+#define bRXIQImb_D 0xffc00000 -+#define bDC_dc_Notch 0x60000 -+#define bRxNBINotch 0x1f000000 -+#define bPD_TH 0xf -+#define bPD_TH_Opt2 0xc000 -+#define bPWED_TH 0x700 -+#define bIfMF_Win_L 0x800 -+#define bPD_Option 0x1000 -+#define bMF_Win_L 0xe000 -+#define bBW_Search_L 0x30000 -+#define bwin_enh_L 0xc0000 -+#define bBW_TH 0x700000 -+#define bED_TH2 0x3800000 -+#define bBW_option 0x4000000 -+#define bRatio_TH 0x18000000 -+#define bWindow_L 0xe0000000 -+#define bSBD_Option 0x1 -+#define bFrame_TH 0x1c -+#define bFS_Option 0x60 -+#define bDC_Slope_check 0x80 -+#define bFGuard_Counter_DC_L 0xe00 -+#define bFrame_Weight_Short 0x7000 -+#define bSub_Tune 0xe00000 -+#define bFrame_DC_Length 0xe000000 -+#define bSBD_start_offset 0x30000000 -+#define bFrame_TH_2 0x7 -+#define bFrame_GI2_TH 0x38 -+#define bGI2_Sync_en 0x40 -+#define bSarch_Short_Early 0x300 -+#define bSarch_Short_Late 0xc00 -+#define bSarch_GI2_Late 0x70000 -+#define bCFOAntSum 0x1 -+#define bCFOAcc 0x2 -+#define bCFOStartOffset 0xc -+#define bCFOLookBack 0x70 -+#define bCFOSumWeight 0x80 -+#define bDAGCEnable 0x10000 -+#define bTXIQImb_A 0x3ff -+#define bTXIQImb_B 0xfc00 -+#define bTXIQImb_C 0x3f0000 -+#define bTXIQImb_D 0xffc00000 -+#define bTxIDCOffset 0xff -+#define bTxQDCOffset 0xff00 -+#define bTxDFIRMode 0x10000 -+#define bTxPesudoNoiseOn 0x4000000 -+#define bTxPesudoNoise_A 0xff -+#define bTxPesudoNoise_B 0xff00 -+#define bTxPesudoNoise_C 0xff0000 -+#define bTxPesudoNoise_D 0xff000000 -+#define bCCADropOption 0x20000 -+#define bCCADropThres 0xfff00000 -+#define bEDCCA_H 0xf -+#define bEDCCA_L 0xf0 -+#define bLambda_ED 0x300 -+#define bRxInitialGain 0x7f -+#define bRxAntDivEn 0x80 -+#define bRxAGCAddressForLNA 0x7f00 -+#define bRxHighPowerFlow 0x8000 -+#define bRxAGCFreezeThres 0xc0000 -+#define bRxFreezeStep_AGC1 0x300000 -+#define bRxFreezeStep_AGC2 0xc00000 -+#define bRxFreezeStep_AGC3 0x3000000 -+#define bRxFreezeStep_AGC0 0xc000000 -+#define bRxRssi_Cmp_En 0x10000000 -+#define bRxQuickAGCEn 0x20000000 -+#define bRxAGCFreezeThresMode 0x40000000 -+#define bRxOverFlowCheckType 0x80000000 -+#define bRxAGCShift 0x7f -+#define bTRSW_Tri_Only 0x80 -+#define bPowerThres 0x300 -+#define bRxAGCEn 0x1 -+#define bRxAGCTogetherEn 0x2 -+#define bRxAGCMin 0x4 -+#define bRxHP_Ini 0x7 -+#define bRxHP_TRLNA 0x70 -+#define bRxHP_RSSI 0x700 -+#define bRxHP_BBP1 0x7000 -+#define bRxHP_BBP2 0x70000 -+#define bRxHP_BBP3 0x700000 -+#define bRSSI_H 0x7f0000 //the threshold for high power -+#define bRSSI_Gen 0x7f000000 //the threshold for ant diversity -+#define bRxSettle_TRSW 0x7 -+#define bRxSettle_LNA 0x38 -+#define bRxSettle_RSSI 0x1c0 -+#define bRxSettle_BBP 0xe00 -+#define bRxSettle_RxHP 0x7000 -+#define bRxSettle_AntSW_RSSI 0x38000 -+#define bRxSettle_AntSW 0xc0000 -+#define bRxProcessTime_DAGC 0x300000 -+#define bRxSettle_HSSI 0x400000 -+#define bRxProcessTime_BBPPW 0x800000 -+#define bRxAntennaPowerShift 0x3000000 -+#define bRSSITableSelect 0xc000000 -+#define bRxHP_Final 0x7000000 -+#define bRxHTSettle_BBP 0x7 -+#define bRxHTSettle_HSSI 0x8 -+#define bRxHTSettle_RxHP 0x70 -+#define bRxHTSettle_BBPPW 0x80 -+#define bRxHTSettle_Idle 0x300 -+#define bRxHTSettle_Reserved 0x1c00 -+#define bRxHTRxHPEn 0x8000 -+#define bRxHTAGCFreezeThres 0x30000 -+#define bRxHTAGCTogetherEn 0x40000 -+#define bRxHTAGCMin 0x80000 -+#define bRxHTAGCEn 0x100000 -+#define bRxHTDAGCEn 0x200000 -+#define bRxHTRxHP_BBP 0x1c00000 -+#define bRxHTRxHP_Final 0xe0000000 -+#define bRxPWRatioTH 0x3 -+#define bRxPWRatioEn 0x4 -+#define bRxMFHold 0x3800 -+#define bRxPD_Delay_TH1 0x38 -+#define bRxPD_Delay_TH2 0x1c0 -+#define bRxPD_DC_COUNT_MAX 0x600 -+//#define bRxMF_Hold 0x3800 -+#define bRxPD_Delay_TH 0x8000 -+#define bRxProcess_Delay 0xf0000 -+#define bRxSearchrange_GI2_Early 0x700000 -+#define bRxFrame_Guard_Counter_L 0x3800000 -+#define bRxSGI_Guard_L 0xc000000 -+#define bRxSGI_Search_L 0x30000000 -+#define bRxSGI_TH 0xc0000000 -+#define bDFSCnt0 0xff -+#define bDFSCnt1 0xff00 -+#define bDFSFlag 0xf0000 -+#define bMFWeightSum 0x300000 -+#define bMinIdxTH 0x7f000000 -+#define bDAFormat 0x40000 -+#define bTxChEmuEnable 0x01000000 -+#define bTRSWIsolation_A 0x7f -+#define bTRSWIsolation_B 0x7f00 -+#define bTRSWIsolation_C 0x7f0000 -+#define bTRSWIsolation_D 0x7f000000 -+#define bExtLNAGain 0x7c00 -+ -+// 6. PageE(0xE00) -+#define bSTBCEn 0x4 // Useless -+#define bAntennaMapping 0x10 -+#define bNss 0x20 -+#define bCFOAntSumD 0x200 -+#define bPHYCounterReset 0x8000000 -+#define bCFOReportGet 0x4000000 -+#define bOFDMContinueTx 0x10000000 -+#define bOFDMSingleCarrier 0x20000000 -+#define bOFDMSingleTone 0x40000000 -+//#define bRxPath1 0x01 -+//#define bRxPath2 0x02 -+//#define bRxPath3 0x04 -+//#define bRxPath4 0x08 -+//#define bTxPath1 0x10 -+//#define bTxPath2 0x20 -+#define bHTDetect 0x100 -+#define bCFOEn 0x10000 -+#define bCFOValue 0xfff00000 -+#define bSigTone_Re 0x3f -+#define bSigTone_Im 0x7f00 -+#define bCounter_CCA 0xffff -+#define bCounter_ParityFail 0xffff0000 -+#define bCounter_RateIllegal 0xffff -+#define bCounter_CRC8Fail 0xffff0000 -+#define bCounter_MCSNoSupport 0xffff -+#define bCounter_FastSync 0xffff -+#define bShortCFO 0xfff -+#define bShortCFOTLength 12 //total -+#define bShortCFOFLength 11 //fraction -+#define bLongCFO 0x7ff -+#define bLongCFOTLength 11 -+#define bLongCFOFLength 11 -+#define bTailCFO 0x1fff -+#define bTailCFOTLength 13 -+#define bTailCFOFLength 12 -+#define bmax_en_pwdB 0xffff -+#define bCC_power_dB 0xffff0000 -+#define bnoise_pwdB 0xffff -+#define bPowerMeasTLength 10 -+#define bPowerMeasFLength 3 -+#define bRx_HT_BW 0x1 -+#define bRxSC 0x6 -+#define bRx_HT 0x8 -+#define bNB_intf_det_on 0x1 -+#define bIntf_win_len_cfg 0x30 -+#define bNB_Intf_TH_cfg 0x1c0 -+#define bRFGain 0x3f -+#define bTableSel 0x40 -+#define bTRSW 0x80 -+#define bRxSNR_A 0xff -+#define bRxSNR_B 0xff00 -+#define bRxSNR_C 0xff0000 -+#define bRxSNR_D 0xff000000 -+#define bSNREVMTLength 8 -+#define bSNREVMFLength 1 -+#define bCSI1st 0xff -+#define bCSI2nd 0xff00 -+#define bRxEVM1st 0xff0000 -+#define bRxEVM2nd 0xff000000 -+#define bSIGEVM 0xff -+#define bPWDB 0xff00 -+#define bSGIEN 0x10000 -+ -+#define bSFactorQAM1 0xf // Useless -+#define bSFactorQAM2 0xf0 -+#define bSFactorQAM3 0xf00 -+#define bSFactorQAM4 0xf000 -+#define bSFactorQAM5 0xf0000 -+#define bSFactorQAM6 0xf0000 -+#define bSFactorQAM7 0xf00000 -+#define bSFactorQAM8 0xf000000 -+#define bSFactorQAM9 0xf0000000 -+#define bCSIScheme 0x100000 -+ -+#define bNoiseLvlTopSet 0x3 // Useless -+#define bChSmooth 0x4 -+#define bChSmoothCfg1 0x38 -+#define bChSmoothCfg2 0x1c0 -+#define bChSmoothCfg3 0xe00 -+#define bChSmoothCfg4 0x7000 -+#define bMRCMode 0x800000 -+#define bTHEVMCfg 0x7000000 -+ -+#define bLoopFitType 0x1 // Useless -+#define bUpdCFO 0x40 -+#define bUpdCFOOffData 0x80 -+#define bAdvUpdCFO 0x100 -+#define bAdvTimeCtrl 0x800 -+#define bUpdClko 0x1000 -+#define bFC 0x6000 -+#define bTrackingMode 0x8000 -+#define bPhCmpEnable 0x10000 -+#define bUpdClkoLTF 0x20000 -+#define bComChCFO 0x40000 -+#define bCSIEstiMode 0x80000 -+#define bAdvUpdEqz 0x100000 -+#define bUChCfg 0x7000000 -+#define bUpdEqz 0x8000000 -+ -+#define bTxAGCRate18_06 0x7f7f7f7f // Useless -+#define bTxAGCRate54_24 0x7f7f7f7f -+#define bTxAGCRateMCS32 0x7f -+#define bTxAGCRateCCK 0x7f00 -+#define bTxAGCRateMCS3_MCS0 0x7f7f7f7f -+#define bTxAGCRateMCS7_MCS4 0x7f7f7f7f -+#define bTxAGCRateMCS11_MCS8 0x7f7f7f7f -+#define bTxAGCRateMCS15_MCS12 0x7f7f7f7f -+ -+//Rx Pseduo noise -+#define bRxPesudoNoiseOn 0x20000000 // Useless -+#define bRxPesudoNoise_A 0xff -+#define bRxPesudoNoise_B 0xff00 -+#define bRxPesudoNoise_C 0xff0000 -+#define bRxPesudoNoise_D 0xff000000 -+#define bPesudoNoiseState_A 0xffff -+#define bPesudoNoiseState_B 0xffff0000 -+#define bPesudoNoiseState_C 0xffff -+#define bPesudoNoiseState_D 0xffff0000 -+ -+//7. RF Register -+//Zebra1 -+#define bZebra1_HSSIEnable 0x8 // Useless -+#define bZebra1_TRxControl 0xc00 -+#define bZebra1_TRxGainSetting 0x07f -+#define bZebra1_RxCorner 0xc00 -+#define bZebra1_TxChargePump 0x38 -+#define bZebra1_RxChargePump 0x7 -+#define bZebra1_ChannelNum 0xf80 -+#define bZebra1_TxLPFBW 0x400 -+#define bZebra1_RxLPFBW 0x600 -+ -+//Zebra4 -+#define bRTL8256RegModeCtrl1 0x100 // Useless -+#define bRTL8256RegModeCtrl0 0x40 -+#define bRTL8256_TxLPFBW 0x18 -+#define bRTL8256_RxLPFBW 0x600 -+ -+//RTL8258 -+#define bRTL8258_TxLPFBW 0xc // Useless -+#define bRTL8258_RxLPFBW 0xc00 -+#define bRTL8258_RSSILPFBW 0xc0 -+ -+ -+// -+// Other Definition -+// -+ -+//byte endable for sb_write -+#define bByte0 0x1 // Useless -+#define bByte1 0x2 -+#define bByte2 0x4 -+#define bByte3 0x8 -+#define bWord0 0x3 -+#define bWord1 0xc -+#define bDWord 0xf -+ -+//for PutRegsetting & GetRegSetting BitMask -+#define bMaskByte0 0xff // Reg 0xc50 rOFDM0_XAAGCCore~0xC6f -+#define bMaskByte1 0xff00 -+#define bMaskByte2 0xff0000 -+#define bMaskByte3 0xff000000 -+#define bMaskHWord 0xffff0000 -+#define bMaskLWord 0x0000ffff -+#define bMaskDWord 0xffffffff -+#define bMaskH4Bits 0xf0000000 -+#define bMaskOFDM_D 0xffc00000 -+#define bMaskCCK 0x3f3f3f3f -+#define bMask12Bits 0xfff -+ -+//for PutRFRegsetting & GetRFRegSetting BitMask -+#if (RTL92SE_FPGA_VERIFY == 1) -+//#define bMask12Bits 0xfff // RF Reg mask bits -+//#define bMask20Bits 0xfff // RF Reg mask bits T65 RF -+#define bRFRegOffsetMask 0xfff -+#else -+//#define bMask12Bits 0xfffff // RF Reg mask bits -+//#define bMask20Bits 0xfffff // RF Reg mask bits T65 RF -+#define bRFRegOffsetMask 0xfffff -+#endif -+#define bEnable 0x1 // Useless -+#define bDisable 0x0 -+ -+#define LeftAntenna 0x0 // Useless -+#define RightAntenna 0x1 -+ -+#define tCheckTxStatus 500 //500ms // Useless -+#define tUpdateRxCounter 100 //100ms -+ -+#define rateCCK 0 // Useless -+#define rateOFDM 1 -+#define rateHT 2 -+ -+//define Register-End -+#define bPMAC_End 0x1ff // Useless -+#define bFPGAPHY0_End 0x8ff -+#define bFPGAPHY1_End 0x9ff -+#define bCCKPHY0_End 0xaff -+#define bOFDMPHY0_End 0xcff -+#define bOFDMPHY1_End 0xdff -+ -+//define max debug item in each debug page -+//#define bMaxItem_FPGA_PHY0 0x9 -+//#define bMaxItem_FPGA_PHY1 0x3 -+//#define bMaxItem_PHY_11B 0x16 -+//#define bMaxItem_OFDM_PHY0 0x29 -+//#define bMaxItem_OFDM_PHY1 0x0 -+ -+#define bPMACControl 0x0 // Useless -+#define bWMACControl 0x1 -+#define bWNICControl 0x2 -+ -+#if 0 -+#define ANTENNA_A 0x1 // Useless -+#define ANTENNA_B 0x2 -+#define ANTENNA_AB 0x3 // ANTENNA_A|ANTENNA_B -+ -+#define ANTENNA_C 0x4 -+#define ANTENNA_D 0x8 -+#endif -+ -+#define RCR_AAP BIT(0) // accept all physical address -+#define RCR_APM BIT(1) // accept physical match -+#define RCR_AM BIT(2) // accept multicast -+#define RCR_AB BIT(3) // accept broadcast -+#define RCR_ACRC32 BIT(5) // accept error packet -+#define RCR_9356SEL BIT(6) -+#define RCR_AICV BIT(12) // Accept ICV error packet -+#define RCR_RXFTH0 (BIT(13)|BIT(14)|BIT(15)) // Rx FIFO threshold -+#define RCR_ADF BIT(18) // Accept Data(frame type) frame -+#define RCR_ACF BIT(19) // Accept control frame -+#define RCR_AMF BIT(20) // Accept management frame -+#define RCR_ADD3 BIT(21) -+#define RCR_APWRMGT BIT(22) // Accept power management packet -+#define RCR_CBSSID BIT(23) // Accept BSSID match packet -+#define RCR_ENMARP BIT(28) // enable mac auto reset phy -+#define RCR_EnCS1 BIT(29) // enable carrier sense method 1 -+#define RCR_EnCS2 BIT(30) // enable carrier sense method 2 -+#define RCR_OnlyErlPkt BIT(31) // Rx Early mode is performed for packet size greater than 1536 -+ -+/*--------------------------Define Parameters-------------------------------*/ -+ -+ -+#endif //__INC_HAL8192SPHYREG_H -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_p2p.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_p2p.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_p2p.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_p2p.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,154 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_P2P_H_ -+#define __RTW_P2P_H_ -+ -+ -+u32 build_beacon_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_probe_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_prov_disc_request_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8* pssid, u8 ussidlen, u8* pdev_raddr ); -+u32 build_assoc_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 status_code); -+u32 build_deauth_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+#ifdef CONFIG_WFD -+u32 build_probe_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_probe_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 tunneled); -+u32 build_beacon_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_nego_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_nego_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_nego_confirm_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_invitation_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_invitation_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_assoc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_assoc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_provdisc_req_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+u32 build_provdisc_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf); -+#endif //CONFIG_WFD -+ -+u32 process_probe_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+u32 process_assoc_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint len, struct sta_info *psta); -+u32 process_p2p_devdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+u32 process_p2p_devdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+u8 process_p2p_provdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+u8 process_p2p_provdisc_resp(struct wifidirect_info *pwdinfo, u8 *pframe); -+u8 process_p2p_group_negotation_req( struct wifidirect_info *pwdinfo, u8 *pframe, uint len ); -+u8 process_p2p_group_negotation_resp( struct wifidirect_info *pwdinfo, u8 *pframe, uint len ); -+u8 process_p2p_group_negotation_confirm( struct wifidirect_info *pwdinfo, u8 *pframe, uint len ); -+u8 process_p2p_presence_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint len); -+ -+void p2p_protocol_wk_hdl(_adapter *padapter, int intCmdType); -+ -+#ifdef CONFIG_P2P_PS -+void process_p2p_ps_ie(PADAPTER padapter, u8 *IEs, u32 IELength); -+void p2p_ps_wk_hdl(_adapter *padapter, u8 p2p_ps_state); -+u8 p2p_ps_wk_cmd(_adapter*padapter, u8 p2p_ps_state, u8 enqueue); -+#endif // CONFIG_P2P_PS -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+void rtw_init_cfg80211_wifidirect_info( _adapter* padapter); -+int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx); -+void rtw_append_wfd_ie(_adapter *padapter, u8 *buf, u32 *len); -+#endif //CONFIG_IOCTL_CFG80211 -+ -+void reset_global_wifidirect_info( _adapter* padapter ); -+int rtw_init_wifi_display_info(_adapter* padapter); -+void rtw_init_wifidirect_timers(_adapter* padapter); -+void rtw_init_wifidirect_addrs(_adapter* padapter, u8 *dev_addr, u8 *iface_addr); -+void init_wifidirect_info( _adapter* padapter, enum P2P_ROLE role); -+int rtw_p2p_enable(_adapter *padapter, enum P2P_ROLE role); -+ -+static inline void _rtw_p2p_set_state(struct wifidirect_info *wdinfo, enum P2P_STATE state) -+{ -+ if(wdinfo->p2p_state != state) { -+ //wdinfo->pre_p2p_state = wdinfo->p2p_state; -+ wdinfo->p2p_state = state; -+ } -+} -+static inline void _rtw_p2p_set_pre_state(struct wifidirect_info *wdinfo, enum P2P_STATE state) -+{ -+ if(wdinfo->pre_p2p_state != state) { -+ wdinfo->pre_p2p_state = state; -+ } -+} -+#if 0 -+static inline void _rtw_p2p_restore_state(struct wifidirect_info *wdinfo) -+{ -+ if(wdinfo->pre_p2p_state != -1) { -+ wdinfo->p2p_state = wdinfo->pre_p2p_state; -+ wdinfo->pre_p2p_state = -1; -+ } -+} -+#endif -+static inline void _rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role) -+{ -+ if(wdinfo->role != role) { -+ wdinfo->role = role; -+ } -+} -+static inline int _rtw_p2p_state(struct wifidirect_info *wdinfo) -+{ -+ return wdinfo->p2p_state; -+} -+static inline int _rtw_p2p_pre_state(struct wifidirect_info *wdinfo) -+{ -+ return wdinfo->pre_p2p_state; -+} -+static inline int _rtw_p2p_role(struct wifidirect_info *wdinfo) -+{ -+ return wdinfo->role; -+} -+static inline bool _rtw_p2p_chk_state(struct wifidirect_info *wdinfo, enum P2P_STATE state) -+{ -+ return wdinfo->p2p_state == state; -+} -+static inline bool _rtw_p2p_chk_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role) -+{ -+ return wdinfo->role == role; -+} -+ -+#ifdef CONFIG_DBG_P2P -+void dbg_rtw_p2p_set_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line); -+void dbg_rtw_p2p_set_pre_state(struct wifidirect_info *wdinfo, enum P2P_STATE state, const char *caller, int line); -+//void dbg_rtw_p2p_restore_state(struct wifidirect_info *wdinfo, const char *caller, int line); -+void dbg_rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role, const char *caller, int line); -+#define rtw_p2p_set_state(wdinfo, state) dbg_rtw_p2p_set_state(wdinfo, state, __FUNCTION__, __LINE__) -+#define rtw_p2p_set_pre_state(wdinfo, state) dbg_rtw_p2p_set_pre_state(wdinfo, state, __FUNCTION__, __LINE__) -+#define rtw_p2p_set_role(wdinfo, role) dbg_rtw_p2p_set_role(wdinfo, role, __FUNCTION__, __LINE__) -+//#define rtw_p2p_restore_state(wdinfo) dbg_rtw_p2p_restore_state(wdinfo, __FUNCTION__, __LINE__) -+#else //CONFIG_DBG_P2P -+#define rtw_p2p_set_state(wdinfo, state) _rtw_p2p_set_state(wdinfo, state) -+#define rtw_p2p_set_pre_state(wdinfo, state) _rtw_p2p_set_pre_state(wdinfo, state) -+#define rtw_p2p_set_role(wdinfo, role) _rtw_p2p_set_role(wdinfo, role) -+//#define rtw_p2p_restore_state(wdinfo) _rtw_p2p_restore_state(wdinfo) -+#endif //CONFIG_DBG_P2P -+ -+#define rtw_p2p_state(wdinfo) _rtw_p2p_state(wdinfo) -+#define rtw_p2p_pre_state(wdinfo) _rtw_p2p_pre_state(wdinfo) -+#define rtw_p2p_role(wdinfo) _rtw_p2p_role(wdinfo) -+#define rtw_p2p_chk_state(wdinfo, state) _rtw_p2p_chk_state(wdinfo, state) -+#define rtw_p2p_chk_role(wdinfo, role) _rtw_p2p_chk_role(wdinfo, role) -+ -+#define rtw_p2p_findphase_ex_set(wdinfo, value) \ -+ (wdinfo)->find_phase_state_exchange_cnt = (value) -+ -+//is this find phase exchange for social channel scan? -+#define rtw_p2p_findphase_ex_is_social(wdinfo) \ -+ (wdinfo)->find_phase_state_exchange_cnt >= P2P_FINDPHASE_EX_SOCIAL_FIRST -+ -+//should we need find phase exchange anymore? -+#define rtw_p2p_findphase_ex_is_needed(wdinfo) \ -+ ((wdinfo)->find_phase_state_exchange_cnt < P2P_FINDPHASE_EX_MAX && \ -+ (wdinfo)->find_phase_state_exchange_cnt != P2P_FINDPHASE_EX_NONE) -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_pwrctrl.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_pwrctrl.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_pwrctrl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_pwrctrl.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,356 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_PWRCTRL_H_ -+#define __RTW_PWRCTRL_H_ -+ -+ -+#define FW_PWR0 0 -+#define FW_PWR1 1 -+#define FW_PWR2 2 -+#define FW_PWR3 3 -+ -+ -+#define HW_PWR0 7 -+#define HW_PWR1 6 -+#define HW_PWR2 2 -+#define HW_PWR3 0 -+#define HW_PWR4 8 -+ -+#define FW_PWRMSK 0x7 -+ -+ -+#define XMIT_ALIVE BIT(0) -+#define RECV_ALIVE BIT(1) -+#define CMD_ALIVE BIT(2) -+#define EVT_ALIVE BIT(3) -+ -+ -+enum Power_Mgnt -+{ -+ PS_MODE_ACTIVE = 0 , -+ PS_MODE_MIN , -+ PS_MODE_MAX , -+ PS_MODE_DTIM , -+ PS_MODE_VOIP , -+ PS_MODE_UAPSD_WMM , -+ PS_MODE_UAPSD , -+ PS_MODE_IBSS , -+ PS_MODE_WWLAN , -+ PM_Radio_Off , -+ PM_Card_Disable , -+ PS_MODE_NUM, -+}; -+ -+/* -+ BIT[2:0] = HW state -+ BIT[3] = Protocol PS state, 0: register active state , 1: register sleep state -+ BIT[4] = sub-state -+*/ -+ -+#define PS_DPS BIT(0) -+#define PS_LCLK (PS_DPS) -+#define PS_RF_OFF BIT(1) -+#define PS_ALL_ON BIT(2) -+#define PS_ST_ACTIVE BIT(3) -+ -+#define PS_ISR_ENABLE BIT(4) -+#define PS_IMR_ENABLE BIT(5) -+#define PS_ACK BIT(6) -+#define PS_TOGGLE BIT(7) -+ -+#define PS_STATE_MASK (0x0F) -+#define PS_STATE_HW_MASK (0x07) -+#define PS_SEQ_MASK (0xc0) -+ -+#define PS_STATE(x) (PS_STATE_MASK & (x)) -+#define PS_STATE_HW(x) (PS_STATE_HW_MASK & (x)) -+#define PS_SEQ(x) (PS_SEQ_MASK & (x)) -+ -+#define PS_STATE_S0 (PS_DPS) -+#define PS_STATE_S1 (PS_LCLK) -+#define PS_STATE_S2 (PS_RF_OFF) -+#define PS_STATE_S3 (PS_ALL_ON) -+#define PS_STATE_S4 ((PS_ST_ACTIVE) | (PS_ALL_ON)) -+ -+ -+#define PS_IS_RF_ON(x) ((x) & (PS_ALL_ON)) -+#define PS_IS_ACTIVE(x) ((x) & (PS_ST_ACTIVE)) -+#define CLR_PS_STATE(x) ((x) = ((x) & (0xF0))) -+ -+ -+struct reportpwrstate_parm { -+ unsigned char mode; -+ unsigned char state; //the CPWM value -+ unsigned short rsvd; -+}; -+ -+ -+typedef _sema _pwrlock; -+ -+ -+__inline static void _init_pwrlock(_pwrlock *plock) -+{ -+ _rtw_init_sema(plock, 1); -+} -+ -+__inline static void _free_pwrlock(_pwrlock *plock) -+{ -+ _rtw_free_sema(plock); -+} -+ -+ -+__inline static void _enter_pwrlock(_pwrlock *plock) -+{ -+ _rtw_down_sema(plock); -+} -+ -+ -+__inline static void _exit_pwrlock(_pwrlock *plock) -+{ -+ _rtw_up_sema(plock); -+} -+ -+#define LPS_DELAY_TIME 1*HZ // 1 sec -+ -+#define EXE_PWR_NONE 0x01 -+#define EXE_PWR_IPS 0x02 -+#define EXE_PWR_LPS 0x04 -+ -+// RF state. -+typedef enum _rt_rf_power_state -+{ -+ rf_on, // RF is on after RFSleep or RFOff -+ rf_sleep, // 802.11 Power Save mode -+ rf_off, // HW/SW Radio OFF or Inactive Power Save -+ //=====Add the new RF state above this line=====// -+ rf_max -+}rt_rf_power_state; -+ -+// RF Off Level for IPS or HW/SW radio off -+#define RT_RF_OFF_LEVL_ASPM BIT(0) // PCI ASPM -+#define RT_RF_OFF_LEVL_CLK_REQ BIT(1) // PCI clock request -+#define RT_RF_OFF_LEVL_PCI_D3 BIT(2) // PCI D3 mode -+#define RT_RF_OFF_LEVL_HALT_NIC BIT(3) // NIC halt, re-initialize hw parameters -+#define RT_RF_OFF_LEVL_FREE_FW BIT(4) // FW free, re-download the FW -+#define RT_RF_OFF_LEVL_FW_32K BIT(5) // FW in 32k -+#define RT_RF_PS_LEVEL_ALWAYS_ASPM BIT(6) // Always enable ASPM and Clock Req in initialization. -+#define RT_RF_LPS_DISALBE_2R BIT(30) // When LPS is on, disable 2R if no packet is received or transmittd. -+#define RT_RF_LPS_LEVEL_ASPM BIT(31) // LPS with ASPM -+ -+#define RT_IN_PS_LEVEL(ppsc, _PS_FLAG) ((ppsc->cur_ps_level & _PS_FLAG) ? true : false) -+#define RT_CLEAR_PS_LEVEL(ppsc, _PS_FLAG) (ppsc->cur_ps_level &= (~(_PS_FLAG))) -+#define RT_SET_PS_LEVEL(ppsc, _PS_FLAG) (ppsc->cur_ps_level |= _PS_FLAG) -+ -+ -+enum _PS_BBRegBackup_ { -+ PSBBREG_RF0 = 0, -+ PSBBREG_RF1, -+ PSBBREG_RF2, -+ PSBBREG_AFE0, -+ PSBBREG_TOTALCNT -+}; -+ -+enum { // for ips_mode -+ IPS_NONE=0, -+ IPS_NORMAL, -+ IPS_LEVEL_2, -+}; -+ -+struct pwrctrl_priv -+{ -+ _pwrlock lock; -+ volatile u8 rpwm; // requested power state for fw -+ volatile u8 cpwm; // fw current power state. updated when 1. read from HCPWM 2. driver lowers power level -+ volatile u8 tog; // toggling -+ volatile u8 cpwm_tog; // toggling -+ -+ u8 pwr_mode; -+ u8 smart_ps; -+ u8 bcn_ant_mode; -+ -+ u32 alives; -+ _workitem cpwm_event; -+#ifdef CONFIG_LPS_RPWM_TIMER -+ u8 brpwmtimeout; -+ _workitem rpwmtimeoutwi; -+ _timer pwr_rpwm_timer; -+#endif // CONFIG_LPS_RPWM_TIMER -+ u8 bpower_saving; -+ -+ u8 b_hw_radio_off; -+ u8 reg_rfoff; -+ u8 reg_pdnmode; //powerdown mode -+ u32 rfoff_reason; -+ -+ //RF OFF Level -+ u32 cur_ps_level; -+ u32 reg_rfps_level; -+ -+ uint ips_enter_cnts; -+ uint ips_leave_cnts; -+ -+ u8 ips_mode; -+ u8 ips_mode_req; // used to accept the mode setting request, will update to ipsmode later -+ uint bips_processing; -+ u32 ips_deny_time; /* will deny IPS when system time is smaller than this */ -+ u8 ps_processing; /* temporarily used to mark whether in rtw_ps_processor */ -+ -+ u8 bLeisurePs; -+ u8 LpsIdleCount; -+ u8 power_mgnt; -+ u8 bFwCurrentInPSMode; -+ u32 DelayLPSLastTimeStamp; -+ u8 btcoex_rfon; -+ s32 pnp_current_pwr_state; -+ u8 pnp_bstop_trx; -+ -+ -+ u8 bInternalAutoSuspend; -+ u8 bInSuspend; -+#ifdef CONFIG_BT_COEXIST -+ u8 bAutoResume; -+ u8 autopm_cnt; -+#endif -+ u8 bSupportRemoteWakeup; -+#ifdef CONFIG_WOWLAN -+ u8 wowlan_mode; -+ u8 wowlan_pattern; -+ u8 wowlan_magic; -+ u8 wowlan_unicast; -+ u8 wowlan_pattern_idx; -+ u8 wowlan_wake_reason; -+ u32 wowlan_pattern_context[8][5]; -+#endif // CONFIG_WOWLAN -+ _timer pwr_state_check_timer; -+ int pwr_state_check_interval; -+ u8 pwr_state_check_cnts; -+ -+ int ps_flag; -+ -+ rt_rf_power_state rf_pwrstate;//cur power state -+ //rt_rf_power_state current_rfpwrstate; -+ rt_rf_power_state change_rfpwrstate; -+ -+ u8 wepkeymask; -+ u8 bHWPowerdown;//if support hw power down -+ u8 bHWPwrPindetect; -+ u8 bkeepfwalive; -+ u8 brfoffbyhw; -+ unsigned long PS_BBRegBackup[PSBBREG_TOTALCNT]; -+ -+ #ifdef CONFIG_RESUME_IN_WORKQUEUE -+ struct workqueue_struct *rtw_workqueue; -+ _workitem resume_work; -+ #endif -+ -+ #ifdef CONFIG_HAS_EARLYSUSPEND -+ struct early_suspend early_suspend; -+ u8 do_late_resume; -+ #endif //CONFIG_HAS_EARLYSUSPEND -+ -+ #ifdef CONFIG_ANDROID_POWER -+ android_early_suspend_t early_suspend; -+ u8 do_late_resume; -+ #endif -+ -+ #ifdef CONFIG_INTEL_PROXIM -+ u8 stored_power_mgnt; -+ #endif -+}; -+ -+#define rtw_get_ips_mode_req(pwrctrlpriv) \ -+ (pwrctrlpriv)->ips_mode_req -+ -+#define rtw_ips_mode_req(pwrctrlpriv, ips_mode) \ -+ (pwrctrlpriv)->ips_mode_req = (ips_mode) -+ -+#define RTW_PWR_STATE_CHK_INTERVAL 2000 -+ -+#define _rtw_set_pwr_state_check_timer(pwrctrlpriv, ms) \ -+ do { \ -+ /*DBG_871X("%s _rtw_set_pwr_state_check_timer(%p, %d)\n", __FUNCTION__, (pwrctrlpriv), (ms));*/ \ -+ _set_timer(&(pwrctrlpriv)->pwr_state_check_timer, (ms)); \ -+ } while(0) -+ -+#define rtw_set_pwr_state_check_timer(pwrctrlpriv) \ -+ _rtw_set_pwr_state_check_timer((pwrctrlpriv), (pwrctrlpriv)->pwr_state_check_interval) -+ -+extern void rtw_init_pwrctrl_priv(_adapter *adapter); -+extern void rtw_free_pwrctrl_priv(_adapter * adapter); -+ -+#ifdef CONFIG_LPS_LCLK -+extern s32 rtw_register_tx_alive(PADAPTER padapter); -+extern void rtw_unregister_tx_alive(PADAPTER padapter); -+extern s32 rtw_register_rx_alive(PADAPTER padapter); -+extern void rtw_unregister_rx_alive(PADAPTER padapter); -+extern s32 rtw_register_cmd_alive(PADAPTER padapter); -+extern void rtw_unregister_cmd_alive(PADAPTER padapter); -+extern s32 rtw_register_evt_alive(PADAPTER padapter); -+extern void rtw_unregister_evt_alive(PADAPTER padapter); -+extern void cpwm_int_hdl(PADAPTER padapter, struct reportpwrstate_parm *preportpwrstate); -+extern void LPS_Leave_check(PADAPTER padapter); -+#endif -+ -+extern void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode); -+extern void rtw_set_rpwm(_adapter * padapter, u8 val8); -+extern void LeaveAllPowerSaveMode(PADAPTER Adapter); -+#ifdef CONFIG_IPS -+void ips_enter(_adapter * padapter); -+int ips_leave(_adapter * padapter); -+#endif -+ -+void rtw_ps_processor(_adapter*padapter); -+ -+#ifdef CONFIG_AUTOSUSPEND -+int autoresume_enter(_adapter* padapter); -+#endif -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+rt_rf_power_state RfOnOffDetect(IN PADAPTER pAdapter ); -+#endif -+ -+ -+#ifdef CONFIG_LPS -+s32 LPS_RF_ON_check(PADAPTER padapter, u32 delay_ms); -+void LPS_Enter(PADAPTER padapter); -+void LPS_Leave(PADAPTER padapter); -+#endif -+ -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+void rtw_resume_in_workqueue(struct pwrctrl_priv *pwrpriv); -+#endif //CONFIG_RESUME_IN_WORKQUEUE -+ -+#if defined(CONFIG_HAS_EARLYSUSPEND ) || defined(CONFIG_ANDROID_POWER) -+bool rtw_is_earlysuspend_registered(struct pwrctrl_priv *pwrpriv); -+bool rtw_is_do_late_resume(struct pwrctrl_priv *pwrpriv); -+void rtw_set_do_late_resume(struct pwrctrl_priv *pwrpriv, bool enable); -+void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv); -+void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv); -+#else -+#define rtw_is_earlysuspend_registered(pwrpriv) false -+#define rtw_is_do_late_resume(pwrpriv) false -+#define rtw_set_do_late_resume(pwrpriv, enable) do {} while (0) -+#define rtw_register_early_suspend(pwrpriv) do {} while (0) -+#define rtw_unregister_early_suspend(pwrpriv) do {} while (0) -+#endif /* CONFIG_HAS_EARLYSUSPEND || CONFIG_ANDROID_POWER */ -+ -+u8 rtw_interface_ps_func(_adapter *padapter,HAL_INTF_PS_FUNC efunc_id,u8* val); -+void rtw_set_ips_deny(_adapter *padapter, u32 ms); -+int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller); -+#define rtw_pwr_wakeup(adapter) _rtw_pwr_wakeup(adapter, RTW_PWR_STATE_CHK_INTERVAL, __FUNCTION__) -+#define rtw_pwr_wakeup_ex(adapter, ips_deffer_ms) _rtw_pwr_wakeup(adapter, ips_deffer_ms, __FUNCTION__) -+int rtw_pm_set_ips(_adapter *padapter, u8 mode); -+int rtw_pm_set_lps(_adapter *padapter, u8 mode); -+ -+#endif //__RTL871X_PWRCTRL_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_qos.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_qos.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_qos.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_qos.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#ifndef _RTW_QOS_H_ -+#define _RTW_QOS_H_ -+ -+ -+ -+struct qos_priv { -+ -+ unsigned int qos_option; //bit mask option: u-apsd, s-apsd, ts, block ack... -+ -+}; -+ -+ -+#endif //_RTL871X_QOS_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_recv.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_recv.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_recv.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_recv.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,676 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_RECV_H_ -+#define _RTW_RECV_H_ -+ -+#ifdef CONFIG_SINGLE_RECV_BUF -+ #define NR_RECVBUFF (1) -+#else -+ #define NR_RECVBUFF (4) -+#endif //CONFIG_SINGLE_RECV_BUF -+ -+#define NR_PREALLOC_RECV_SKB (8) -+ -+#define NR_RECVFRAME 256 -+ -+#define RXFRAME_ALIGN 8 -+#define RXFRAME_ALIGN_SZ (1<signal_stat_timer, (recvpriv)->signal_stat_sampling_interval) -+#endif //CONFIG_NEW_SIGNAL_STAT_PROCESS -+ -+struct sta_recv_priv { -+ -+ _lock lock; -+ sint option; -+ -+ //_queue blk_strms[MAX_RX_NUMBLKS]; -+ _queue defrag_q; //keeping the fragment frame until defrag -+ -+ struct stainfo_rxcache rxcache; -+ -+ //uint sta_rx_bytes; -+ //uint sta_rx_pkts; -+ //uint sta_rx_fail; -+ -+}; -+ -+ -+struct recv_buf -+{ -+ _list list; -+ -+ _lock recvbuf_lock; -+ -+ u32 ref_cnt; -+ -+ PADAPTER adapter; -+ -+ u8 *pbuf; -+ u8 *pallocated_buf; -+ -+ u32 len; -+ u8 *phead; -+ u8 *pdata; -+ u8 *ptail; -+ u8 *pend; -+ -+ PURB purb; -+ dma_addr_t dma_transfer_addr; /* (in) dma addr for transfer_buffer */ -+ u32 alloc_sz; -+ -+ u8 irp_pending; -+ int transfer_len; -+ -+ _pkt *pskb; -+ u8 reuse; -+}; -+ -+ -+/* -+ head -----> -+ -+ data -----> -+ -+ payload -+ -+ tail -----> -+ -+ -+ end -----> -+ -+ len = (unsigned int )(tail - data); -+ -+*/ -+struct recv_frame_hdr -+{ -+ _list list; -+#ifndef CONFIG_BSD_RX_USE_MBUF -+ struct sk_buff *pkt; -+ struct sk_buff *pkt_newalloc; -+#else // CONFIG_BSD_RX_USE_MBUF -+ _pkt *pkt; -+ _pkt *pkt_newalloc; -+#endif // CONFIG_BSD_RX_USE_MBUF -+ -+ _adapter *adapter; -+ -+ u8 fragcnt; -+ -+ int frame_tag; -+ -+ struct rx_pkt_attrib attrib; -+ -+ uint len; -+ u8 *rx_head; -+ u8 *rx_data; -+ u8 *rx_tail; -+ u8 *rx_end; -+ -+ void *precvbuf; -+ -+ -+ // -+ struct sta_info *psta; -+ -+ //for A-MPDU Rx reordering buffer control -+ struct recv_reorder_ctrl *preorder_ctrl; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ u8 UserPriority; -+ u8 WapiTempPN[16]; -+ u8 WapiSrcAddr[6]; -+ u8 bWapiCheckPNInDecrypt; -+ u8 bIsWaiPacket; -+#endif -+ -+}; -+ -+ -+union recv_frame{ -+ -+ union{ -+ _list list; -+ struct recv_frame_hdr hdr; -+ uint mem[RECVFRAME_HDR_ALIGN>>2]; -+ }u; -+ -+ //uint mem[MAX_RXSZ>>2]; -+ -+}; -+ -+typedef enum _RX_PACKET_TYPE{ -+ NORMAL_RX,//Normal rx packet -+ TX_REPORT1,//CCX -+ TX_REPORT2,//TX RPT -+ HIS_REPORT,// USB HISR RPT -+ C2H_PACKET -+}RX_PACKET_TYPE, *PRX_PACKET_TYPE; -+ -+extern union recv_frame *_rtw_alloc_recvframe (_queue *pfree_recv_queue); //get a free recv_frame from pfree_recv_queue -+extern union recv_frame *rtw_alloc_recvframe (_queue *pfree_recv_queue); //get a free recv_frame from pfree_recv_queue -+extern void rtw_init_recvframe(union recv_frame *precvframe ,struct recv_priv *precvpriv); -+extern int rtw_free_recvframe(union recv_frame *precvframe, _queue *pfree_recv_queue); -+ -+#define rtw_dequeue_recvframe(queue) rtw_alloc_recvframe(queue) -+extern int _rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue); -+extern int rtw_enqueue_recvframe(union recv_frame *precvframe, _queue *queue); -+ -+extern void rtw_free_recvframe_queue(_queue *pframequeue, _queue *pfree_recv_queue); -+u32 rtw_free_uc_swdec_pending_queue(_adapter *adapter); -+ -+sint rtw_enqueue_recvbuf_to_head(struct recv_buf *precvbuf, _queue *queue); -+sint rtw_enqueue_recvbuf(struct recv_buf *precvbuf, _queue *queue); -+struct recv_buf *rtw_dequeue_recvbuf (_queue *queue); -+ -+void rtw_reordering_ctrl_timeout_handler(void *pcontext); -+ -+__inline static u8 *get_rxmem(union recv_frame *precvframe) -+{ -+ //always return rx_head... -+ if(precvframe==NULL) -+ return NULL; -+ -+ return precvframe->u.hdr.rx_head; -+} -+ -+__inline static u8 *get_rx_status(union recv_frame *precvframe) -+{ -+ -+ return get_rxmem(precvframe); -+ -+} -+ -+__inline static u8 *get_recvframe_data(union recv_frame *precvframe) -+{ -+ -+ //alwasy return rx_data -+ if(precvframe==NULL) -+ return NULL; -+ -+ return precvframe->u.hdr.rx_data; -+ -+} -+ -+__inline static u8 *recvframe_push(union recv_frame *precvframe, sint sz) -+{ -+ // append data before rx_data -+ -+ /* add data to the start of recv_frame -+ * -+ * This function extends the used data area of the recv_frame at the buffer -+ * start. rx_data must be still larger than rx_head, after pushing. -+ */ -+ -+ if(precvframe==NULL) -+ return NULL; -+ -+ -+ precvframe->u.hdr.rx_data -= sz ; -+ if( precvframe->u.hdr.rx_data < precvframe->u.hdr.rx_head ) -+ { -+ precvframe->u.hdr.rx_data += sz ; -+ return NULL; -+ } -+ -+ precvframe->u.hdr.len +=sz; -+ -+ return precvframe->u.hdr.rx_data; -+ -+} -+ -+ -+__inline static u8 *recvframe_pull(union recv_frame *precvframe, sint sz) -+{ -+ // rx_data += sz; move rx_data sz bytes hereafter -+ -+ //used for extract sz bytes from rx_data, update rx_data and return the updated rx_data to the caller -+ -+ -+ if(precvframe==NULL) -+ return NULL; -+ -+ -+ precvframe->u.hdr.rx_data += sz; -+ -+ if(precvframe->u.hdr.rx_data > precvframe->u.hdr.rx_tail) -+ { -+ precvframe->u.hdr.rx_data -= sz; -+ return NULL; -+ } -+ -+ precvframe->u.hdr.len -=sz; -+ -+ return precvframe->u.hdr.rx_data; -+ -+} -+ -+__inline static u8 *recvframe_put(union recv_frame *precvframe, sint sz) -+{ -+ // rx_tai += sz; move rx_tail sz bytes hereafter -+ -+ //used for append sz bytes from ptr to rx_tail, update rx_tail and return the updated rx_tail to the caller -+ //after putting, rx_tail must be still larger than rx_end. -+ unsigned char * prev_rx_tail; -+ -+ if(precvframe==NULL) -+ return NULL; -+ -+ prev_rx_tail = precvframe->u.hdr.rx_tail; -+ -+ precvframe->u.hdr.rx_tail += sz; -+ -+ if(precvframe->u.hdr.rx_tail > precvframe->u.hdr.rx_end) -+ { -+ precvframe->u.hdr.rx_tail -= sz; -+ return NULL; -+ } -+ -+ precvframe->u.hdr.len +=sz; -+ -+ return precvframe->u.hdr.rx_tail; -+ -+} -+ -+ -+ -+__inline static u8 *recvframe_pull_tail(union recv_frame *precvframe, sint sz) -+{ -+ // rmv data from rx_tail (by yitsen) -+ -+ //used for extract sz bytes from rx_end, update rx_end and return the updated rx_end to the caller -+ //after pulling, rx_end must be still larger than rx_data. -+ -+ if(precvframe==NULL) -+ return NULL; -+ -+ precvframe->u.hdr.rx_tail -= sz; -+ -+ if(precvframe->u.hdr.rx_tail < precvframe->u.hdr.rx_data) -+ { -+ precvframe->u.hdr.rx_tail += sz; -+ return NULL; -+ } -+ -+ precvframe->u.hdr.len -=sz; -+ -+ return precvframe->u.hdr.rx_tail; -+ -+} -+ -+ -+ -+__inline static _buffer * get_rxbuf_desc(union recv_frame *precvframe) -+{ -+ _buffer * buf_desc; -+ -+ if(precvframe==NULL) -+ return NULL; -+ return buf_desc; -+} -+ -+ -+__inline static union recv_frame *rxmem_to_recvframe(u8 *rxmem) -+{ -+ //due to the design of 2048 bytes alignment of recv_frame, we can reference the union recv_frame -+ //from any given member of recv_frame. -+ // rxmem indicates the any member/address in recv_frame -+ -+ return (union recv_frame*)(((SIZE_PTR)rxmem >> RXFRAME_ALIGN) << RXFRAME_ALIGN); -+ -+} -+ -+__inline static union recv_frame *pkt_to_recvframe(_pkt *pkt) -+{ -+ -+ u8 * buf_star; -+ union recv_frame * precv_frame; -+ precv_frame = rxmem_to_recvframe((unsigned char*)buf_star); -+ -+ return precv_frame; -+} -+ -+__inline static u8 *pkt_to_recvmem(_pkt *pkt) -+{ -+ // return the rx_head -+ -+ union recv_frame * precv_frame = pkt_to_recvframe(pkt); -+ -+ return precv_frame->u.hdr.rx_head; -+ -+} -+ -+__inline static u8 *pkt_to_recvdata(_pkt *pkt) -+{ -+ // return the rx_data -+ -+ union recv_frame * precv_frame =pkt_to_recvframe(pkt); -+ -+ return precv_frame->u.hdr.rx_data; -+ -+} -+ -+ -+__inline static sint get_recvframe_len(union recv_frame *precvframe) -+{ -+ return precvframe->u.hdr.len; -+} -+ -+ -+__inline static s32 translate_percentage_to_dbm(u32 SignalStrengthIndex) -+{ -+ s32 SignalPower; // in dBm. -+ -+ // Translate to dBm (x=0.5y-95). -+ SignalPower = (s32)((SignalStrengthIndex + 1) >> 1); -+ SignalPower -= 95; -+ -+ return SignalPower; -+} -+ -+ -+struct sta_info; -+ -+extern void _rtw_init_sta_recv_priv(struct sta_recv_priv *psta_recvpriv); -+ -+extern void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_rf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_rf.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_rf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_rf.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,183 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_RF_H_ -+#define __RTW_RF_H_ -+ -+ -+#define OFDM_PHY 1 -+#define MIXED_PHY 2 -+#define CCK_PHY 3 -+ -+#define NumRates (13) -+ -+// slot time for 11g -+#define SHORT_SLOT_TIME 9 -+#define NON_SHORT_SLOT_TIME 20 -+ -+#define RTL8711_RF_MAX_SENS 6 -+#define RTL8711_RF_DEF_SENS 4 -+ -+// -+// We now define the following channels as the max channels in each channel plan. -+// 2G, total 14 chnls -+// {1,2,3,4,5,6,7,8,9,10,11,12,13,14} -+// 5G, total 24 chnls -+// {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165} -+#define MAX_CHANNEL_NUM_2G 14 -+#define MAX_CHANNEL_NUM_5G 24 -+#define MAX_CHANNEL_NUM 38//14+24 -+ -+//#define NUM_REGULATORYS 21 -+#define NUM_REGULATORYS 1 -+ -+//Country codes -+#define USA 0x555320 -+#define EUROPE 0x1 //temp, should be provided later -+#define JAPAN 0x2 //temp, should be provided later -+ -+struct regulatory_class { -+ u32 starting_freq; //MHz, -+ u8 channel_set[MAX_CHANNEL_NUM]; -+ u8 channel_cck_power[MAX_CHANNEL_NUM];//dbm -+ u8 channel_ofdm_power[MAX_CHANNEL_NUM];//dbm -+ u8 txpower_limit; //dbm -+ u8 channel_spacing; //MHz -+ u8 modem; -+}; -+ -+typedef enum _CAPABILITY{ -+ cESS = 0x0001, -+ cIBSS = 0x0002, -+ cPollable = 0x0004, -+ cPollReq = 0x0008, -+ cPrivacy = 0x0010, -+ cShortPreamble = 0x0020, -+ cPBCC = 0x0040, -+ cChannelAgility = 0x0080, -+ cSpectrumMgnt = 0x0100, -+ cQos = 0x0200, // For HCCA, use with CF-Pollable and CF-PollReq -+ cShortSlotTime = 0x0400, -+ cAPSD = 0x0800, -+ cRM = 0x1000, // RRM (Radio Request Measurement) -+ cDSSS_OFDM = 0x2000, -+ cDelayedBA = 0x4000, -+ cImmediateBA = 0x8000, -+}CAPABILITY, *PCAPABILITY; -+ -+enum _REG_PREAMBLE_MODE{ -+ PREAMBLE_LONG = 1, -+ PREAMBLE_AUTO = 2, -+ PREAMBLE_SHORT = 3, -+}; -+ -+ -+enum _RTL8712_RF_MIMO_CONFIG_{ -+ RTL8712_RFCONFIG_1T=0x10, -+ RTL8712_RFCONFIG_2T=0x20, -+ RTL8712_RFCONFIG_1R=0x01, -+ RTL8712_RFCONFIG_2R=0x02, -+ RTL8712_RFCONFIG_1T1R=0x11, -+ RTL8712_RFCONFIG_1T2R=0x12, -+ RTL8712_RFCONFIG_TURBO=0x92, -+ RTL8712_RFCONFIG_2T2R=0x22 -+}; -+ -+ -+typedef enum _RF90_RADIO_PATH{ -+ RF90_PATH_A = 0, //Radio Path A -+ RF90_PATH_B = 1, //Radio Path B -+ RF90_PATH_C = 2, //Radio Path C -+ RF90_PATH_D = 3 //Radio Path D -+ //RF90_PATH_MAX //Max RF number 90 support -+}RF90_RADIO_PATH_E, *PRF90_RADIO_PATH_E; -+ -+// Bandwidth Offset -+#define HAL_PRIME_CHNL_OFFSET_DONT_CARE 0 -+#define HAL_PRIME_CHNL_OFFSET_LOWER 1 -+#define HAL_PRIME_CHNL_OFFSET_UPPER 2 -+ -+// Represent Channel Width in HT Capabilities -+// -+typedef enum _CHANNEL_WIDTH{ -+ CHANNEL_WIDTH_20 = 0, -+ CHANNEL_WIDTH_40 = 1, -+ CHANNEL_WIDTH_80 = 2, -+ CHANNEL_WIDTH_160 = 3, -+ CHANNEL_WIDTH_80_80 = 4, -+ CHANNEL_WIDTH_MAX = 5, -+}CHANNEL_WIDTH, *PCHANNEL_WIDTH; -+ -+// -+// Represent Extention Channel Offset in HT Capabilities -+// This is available only in 40Mhz mode. -+// -+typedef enum _EXTCHNL_OFFSET{ -+ EXTCHNL_OFFSET_NO_EXT = 0, -+ EXTCHNL_OFFSET_UPPER = 1, -+ EXTCHNL_OFFSET_NO_DEF = 2, -+ EXTCHNL_OFFSET_LOWER = 3, -+}EXTCHNL_OFFSET, *PEXTCHNL_OFFSET; -+ -+typedef enum _VHT_DATA_SC{ -+ VHT_DATA_SC_DONOT_CARE = 0, -+ VHT_DATA_SC_20_UPPER_OF_80MHZ = 1, -+ VHT_DATA_SC_20_LOWER_OF_80MHZ = 2, -+ VHT_DATA_SC_20_UPPERST_OF_80MHZ = 3, -+ VHT_DATA_SC_20_LOWEST_OF_80MHZ = 4, -+ VHT_DATA_SC_20_RECV1 = 5, -+ VHT_DATA_SC_20_RECV2 = 6, -+ VHT_DATA_SC_20_RECV3 = 7, -+ VHT_DATA_SC_20_RECV4 = 8, -+ VHT_DATA_SC_40_UPPER_OF_80MHZ = 9, -+ VHT_DATA_SC_40_LOWER_OF_80MHZ = 10, -+}VHT_DATA_SC, *PVHT_DATA_SC_E; -+ -+typedef enum _PROTECTION_MODE{ -+ PROTECTION_MODE_AUTO = 0, -+ PROTECTION_MODE_FORCE_ENABLE = 1, -+ PROTECTION_MODE_FORCE_DISABLE = 2, -+}PROTECTION_MODE, *PPROTECTION_MODE; -+ -+#define LDPC_VHT_ENABLE_RX BIT0 -+#define LDPC_VHT_ENABLE_TX BIT1 -+#define LDPC_VHT_TEST_TX_ENABLE BIT2 -+#define LDPC_VHT_CAP_TX BIT3 -+ -+#define STBC_VHT_ENABLE_RX BIT0 -+#define STBC_VHT_ENABLE_TX BIT1 -+#define STBC_VHT_TEST_TX_ENABLE BIT2 -+#define STBC_VHT_CAP_TX BIT3 -+ -+#define BEAMFORMING_VHT_BEAMFORMER_ENABLE BIT0 // Declare our NIC supports beamformer -+#define BEAMFORMING_VHT_BEAMFORMEE_ENABLE BIT1 // Declare our NIC supports beamformee -+#define BEAMFORMING_VHT_BEAMFORMER_TEST BIT2 // Transmiting Beamforming no matter the target supports it or not -+ -+/* 2007/11/15 MH Define different RF type. */ -+typedef enum _RT_RF_TYPE_DEFINITION -+{ -+ RF_1T2R = 0, -+ RF_2T4R = 1, -+ RF_2T2R = 2, -+ RF_1T1R = 3, -+ RF_2T2R_GREEN = 4, -+ RF_MAX_TYPE = 5, -+}RT_RF_TYPE_DEF_E; -+ -+ -+u32 rtw_ch2freq(u32 ch); -+u32 rtw_freq2ch(u32 freq); -+ -+ -+#endif //_RTL8711_RF_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_security.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_security.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_security.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_security.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,420 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_SECURITY_H_ -+#define __RTW_SECURITY_H_ -+ -+ -+#define _NO_PRIVACY_ 0x0 -+#define _WEP40_ 0x1 -+#define _TKIP_ 0x2 -+#define _TKIP_WTMIC_ 0x3 -+#define _AES_ 0x4 -+#define _WEP104_ 0x5 -+#define _WEP_WPA_MIXED_ 0x07 // WEP + WPA -+#define _SMS4_ 0x06 -+ -+#define is_wep_enc(alg) (((alg) == _WEP40_) || ((alg) == _WEP104_)) -+ -+#define _WPA_IE_ID_ 0xdd -+#define _WPA2_IE_ID_ 0x30 -+ -+#define SHA256_MAC_LEN 32 -+#define AES_BLOCK_SIZE 16 -+#define AES_PRIV_SIZE (4 * 44) -+ -+typedef enum { -+ ENCRYP_PROTOCOL_OPENSYS, //open system -+ ENCRYP_PROTOCOL_WEP, //WEP -+ ENCRYP_PROTOCOL_WPA, //WPA -+ ENCRYP_PROTOCOL_WPA2, //WPA2 -+ ENCRYP_PROTOCOL_WAPI, //WAPI: Not support in this version -+ ENCRYP_PROTOCOL_MAX -+}ENCRYP_PROTOCOL_E; -+ -+ -+#ifndef Ndis802_11AuthModeWPA2 -+#define Ndis802_11AuthModeWPA2 (Ndis802_11AuthModeWPANone + 1) -+#endif -+ -+#ifndef Ndis802_11AuthModeWPA2PSK -+#define Ndis802_11AuthModeWPA2PSK (Ndis802_11AuthModeWPANone + 2) -+#endif -+ -+union pn48 { -+ -+ u64 val; -+ -+#ifdef __LITTLE_ENDIAN -+ -+struct { -+ u8 TSC0; -+ u8 TSC1; -+ u8 TSC2; -+ u8 TSC3; -+ u8 TSC4; -+ u8 TSC5; -+ u8 TSC6; -+ u8 TSC7; -+} _byte_; -+ -+#else -+ -+struct { -+ u8 TSC7; -+ u8 TSC6; -+ u8 TSC5; -+ u8 TSC4; -+ u8 TSC3; -+ u8 TSC2; -+ u8 TSC1; -+ u8 TSC0; -+} _byte_; -+ -+#endif -+ -+}; -+ -+union Keytype { -+ u8 skey[16]; -+ u32 lkey[4]; -+}; -+ -+ -+typedef struct _RT_PMKID_LIST -+{ -+ u8 bUsed; -+ u8 Bssid[6]; -+ u8 PMKID[16]; -+ u8 SsidBuf[33]; -+ u8* ssid_octet; -+ u16 ssid_length; -+} RT_PMKID_LIST, *PRT_PMKID_LIST; -+ -+ -+struct security_priv -+{ -+ u32 dot11AuthAlgrthm; // 802.11 auth, could be open, shared, 8021x and authswitch -+ u32 dot11PrivacyAlgrthm; // This specify the privacy for shared auth. algorithm. -+ -+ /* WEP */ -+ u32 dot11PrivacyKeyIndex; // this is only valid for legendary wep, 0~3 for key id. (tx key index) -+ union Keytype dot11DefKey[4]; // this is only valid for def. key -+ u32 dot11DefKeylen[4]; -+ -+ u32 dot118021XGrpPrivacy; // This specify the privacy algthm. used for Grp key -+ u32 dot118021XGrpKeyid; // key id used for Grp Key ( tx key index) -+ union Keytype dot118021XGrpKey[4]; // 802.1x Group Key, for inx0 and inx1 -+ union Keytype dot118021XGrptxmickey[4]; -+ union Keytype dot118021XGrprxmickey[4]; -+ union pn48 dot11Grptxpn; // PN48 used for Grp Key xmit. -+ union pn48 dot11Grprxpn; // PN48 used for Grp Key recv. -+ -+#ifdef CONFIG_AP_MODE -+ //extend security capabilities for AP_MODE -+ unsigned int dot8021xalg;//0:disable, 1:psk, 2:802.1x -+ unsigned int wpa_psk;//0:disable, bit(0): WPA, bit(1):WPA2 -+ unsigned int wpa_group_cipher; -+ unsigned int wpa2_group_cipher; -+ unsigned int wpa_pairwise_cipher; -+ unsigned int wpa2_pairwise_cipher; -+#endif -+ -+ u8 wps_ie[MAX_WPS_IE_LEN];//added in assoc req -+ int wps_ie_len; -+ -+ -+ u8 binstallGrpkey; -+ u8 busetkipkey; -+ //_timer tkip_timer; -+ u8 bcheck_grpkey; -+ u8 bgrpkey_handshake; -+ -+ //u8 packet_cnt;//unused, removed -+ -+ s32 sw_encrypt;//from registry_priv -+ s32 sw_decrypt;//from registry_priv -+ -+ s32 hw_decrypted;//if the rx packets is hw_decrypted==false, it means the hw has not been ready. -+ -+ -+ //keeps the auth_type & enc_status from upper layer ioctl(wpa_supplicant or wzc) -+ u32 ndisauthtype; // NDIS_802_11_AUTHENTICATION_MODE -+ u32 ndisencryptstatus; // NDIS_802_11_ENCRYPTION_STATUS -+ -+ WLAN_BSSID_EX sec_bss; //for joinbss (h2c buffer) usage -+ -+ NDIS_802_11_WEP ndiswep; -+ -+ u8 assoc_info[600]; -+ u8 szofcapability[256]; //for wpa2 usage -+ u8 oidassociation[512]; //for wpa/wpa2 usage -+ u8 authenticator_ie[256]; //store ap security information element -+ u8 supplicant_ie[256]; //store sta security information element -+ -+ -+ //for tkip countermeasure -+ u32 last_mic_err_time; -+ u8 btkip_countermeasure; -+ u8 btkip_wait_report; -+ u32 btkip_countermeasure_time; -+ -+ //--------------------------------------------------------------------------- -+ // For WPA2 Pre-Authentication. -+ //--------------------------------------------------------------------------- -+ //u8 RegEnablePreAuth; // Default value: Pre-Authentication enabled or not, from registry "EnablePreAuth". Added by Annie, 2005-11-01. -+ //u8 EnablePreAuthentication; // Current Value: Pre-Authentication enabled or not. -+ RT_PMKID_LIST PMKIDList[NUM_PMKID_CACHE]; // Renamed from PreAuthKey[NUM_PRE_AUTH_KEY]. Annie, 2006-10-13. -+ u8 PMKIDIndex; -+ //u32 PMKIDCount; // Added by Annie, 2006-10-13. -+ //u8 szCapability[256]; // For WPA2-PSK using zero-config, by Annie, 2005-09-20. -+ -+ u8 bWepDefaultKeyIdxSet; -+}; -+ -+struct sha256_state { -+ u64 length; -+ u32 state[8], curlen; -+ u8 buf[64]; -+}; -+ -+#define GET_ENCRY_ALGO(psecuritypriv, psta, encry_algo, bmcst)\ -+do{\ -+ switch(psecuritypriv->dot11AuthAlgrthm)\ -+ {\ -+ case dot11AuthAlgrthm_Open:\ -+ case dot11AuthAlgrthm_Shared:\ -+ case dot11AuthAlgrthm_Auto:\ -+ encry_algo = (u8)psecuritypriv->dot11PrivacyAlgrthm;\ -+ break;\ -+ case dot11AuthAlgrthm_8021X:\ -+ if(bmcst)\ -+ encry_algo = (u8)psecuritypriv->dot118021XGrpPrivacy;\ -+ else\ -+ encry_algo =(u8) psta->dot118021XPrivacy;\ -+ break;\ -+ case dot11AuthAlgrthm_WAPI:\ -+ encry_algo = (u8)psecuritypriv->dot11PrivacyAlgrthm;\ -+ break;\ -+ }\ -+}while(0) -+ -+ -+#define SET_ICE_IV_LEN( iv_len, icv_len, encrypt)\ -+do{\ -+ switch(encrypt)\ -+ {\ -+ case _WEP40_:\ -+ case _WEP104_:\ -+ iv_len = 4;\ -+ icv_len = 4;\ -+ break;\ -+ case _TKIP_:\ -+ iv_len = 8;\ -+ icv_len = 4;\ -+ break;\ -+ case _AES_:\ -+ iv_len = 8;\ -+ icv_len = 8;\ -+ break;\ -+ case _SMS4_:\ -+ iv_len = 18;\ -+ icv_len = 16;\ -+ break;\ -+ default:\ -+ iv_len = 0;\ -+ icv_len = 0;\ -+ break;\ -+ }\ -+}while(0) -+ -+ -+#define GET_TKIP_PN(iv,dot11txpn)\ -+do{\ -+ dot11txpn._byte_.TSC0=iv[2];\ -+ dot11txpn._byte_.TSC1=iv[0];\ -+ dot11txpn._byte_.TSC2=iv[4];\ -+ dot11txpn._byte_.TSC3=iv[5];\ -+ dot11txpn._byte_.TSC4=iv[6];\ -+ dot11txpn._byte_.TSC5=iv[7];\ -+}while(0) -+ -+ -+#define ROL32( A, n ) ( ((A) << (n)) | ( ((A)>>(32-(n))) & ( (1UL << (n)) - 1 ) ) ) -+#define ROR32( A, n ) ROL32( (A), 32-(n) ) -+ -+struct mic_data -+{ -+ u32 K0, K1; // Key -+ u32 L, R; // Current state -+ u32 M; // Message accumulator (single word) -+ u32 nBytesInM; // # bytes in M -+}; -+ -+extern const u32 Te0[256]; -+extern const u32 Te1[256]; -+extern const u32 Te2[256]; -+extern const u32 Te3[256]; -+extern const u32 Te4[256]; -+extern const u32 Td0[256]; -+extern const u32 Td1[256]; -+extern const u32 Td2[256]; -+extern const u32 Td3[256]; -+extern const u32 Td4[256]; -+extern const u32 rcon[10]; -+extern const u8 Td4s[256]; -+extern const u8 rcons[10]; -+ -+#define RCON(i) (rcons[(i)] << 24) -+ -+static inline u32 rotr(u32 val, int bits) -+{ -+ return (val >> bits) | (val << (32 - bits)); -+} -+ -+#define TE0(i) Te0[((i) >> 24) & 0xff] -+#define TE1(i) rotr(Te0[((i) >> 16) & 0xff], 8) -+#define TE2(i) rotr(Te0[((i) >> 8) & 0xff], 16) -+#define TE3(i) rotr(Te0[(i) & 0xff], 24) -+#define TE41(i) ((Te0[((i) >> 24) & 0xff] << 8) & 0xff000000) -+#define TE42(i) (Te0[((i) >> 16) & 0xff] & 0x00ff0000) -+#define TE43(i) (Te0[((i) >> 8) & 0xff] & 0x0000ff00) -+#define TE44(i) ((Te0[(i) & 0xff] >> 8) & 0x000000ff) -+#define TE421(i) ((Te0[((i) >> 16) & 0xff] << 8) & 0xff000000) -+#define TE432(i) (Te0[((i) >> 8) & 0xff] & 0x00ff0000) -+#define TE443(i) (Te0[(i) & 0xff] & 0x0000ff00) -+#define TE414(i) ((Te0[((i) >> 24) & 0xff] >> 8) & 0x000000ff) -+#define TE4(i) ((Te0[(i)] >> 8) & 0x000000ff) -+ -+#define TD0(i) Td0[((i) >> 24) & 0xff] -+#define TD1(i) rotr(Td0[((i) >> 16) & 0xff], 8) -+#define TD2(i) rotr(Td0[((i) >> 8) & 0xff], 16) -+#define TD3(i) rotr(Td0[(i) & 0xff], 24) -+#define TD41(i) (Td4s[((i) >> 24) & 0xff] << 24) -+#define TD42(i) (Td4s[((i) >> 16) & 0xff] << 16) -+#define TD43(i) (Td4s[((i) >> 8) & 0xff] << 8) -+#define TD44(i) (Td4s[(i) & 0xff]) -+#define TD0_(i) Td0[(i) & 0xff] -+#define TD1_(i) rotr(Td0[(i) & 0xff], 8) -+#define TD2_(i) rotr(Td0[(i) & 0xff], 16) -+#define TD3_(i) rotr(Td0[(i) & 0xff], 24) -+ -+#define GETU32(pt) (((u32)(pt)[0] << 24) ^ ((u32)(pt)[1] << 16) ^ \ -+ ((u32)(pt)[2] << 8) ^ ((u32)(pt)[3])) -+ -+#define PUTU32(ct, st) { \ -+(ct)[0] = (u8)((st) >> 24); (ct)[1] = (u8)((st) >> 16); \ -+(ct)[2] = (u8)((st) >> 8); (ct)[3] = (u8)(st); } -+ -+#define WPA_GET_BE32(a) ((((u32) (a)[0]) << 24) | (((u32) (a)[1]) << 16) | \ -+ (((u32) (a)[2]) << 8) | ((u32) (a)[3])) -+ -+#define WPA_PUT_LE16(a, val) \ -+ do { \ -+ (a)[1] = ((u16) (val)) >> 8; \ -+ (a)[0] = ((u16) (val)) & 0xff; \ -+ } while (0) -+ -+#define WPA_PUT_BE32(a, val) \ -+ do { \ -+ (a)[0] = (u8) ((((u32) (val)) >> 24) & 0xff); \ -+ (a)[1] = (u8) ((((u32) (val)) >> 16) & 0xff); \ -+ (a)[2] = (u8) ((((u32) (val)) >> 8) & 0xff); \ -+ (a)[3] = (u8) (((u32) (val)) & 0xff); \ -+ } while (0) -+ -+#define WPA_PUT_BE64(a, val) \ -+ do { \ -+ (a)[0] = (u8) (((u64) (val)) >> 56); \ -+ (a)[1] = (u8) (((u64) (val)) >> 48); \ -+ (a)[2] = (u8) (((u64) (val)) >> 40); \ -+ (a)[3] = (u8) (((u64) (val)) >> 32); \ -+ (a)[4] = (u8) (((u64) (val)) >> 24); \ -+ (a)[5] = (u8) (((u64) (val)) >> 16); \ -+ (a)[6] = (u8) (((u64) (val)) >> 8); \ -+ (a)[7] = (u8) (((u64) (val)) & 0xff); \ -+ } while (0) -+ -+/* ===== start - public domain SHA256 implementation ===== */ -+ -+/* This is based on SHA256 implementation in LibTomCrypt that was released into -+ * public domain by Tom St Denis. */ -+ -+/* the K array */ -+static const unsigned long K[64] = { -+ 0x428a2f98UL, 0x71374491UL, 0xb5c0fbcfUL, 0xe9b5dba5UL, 0x3956c25bUL, -+ 0x59f111f1UL, 0x923f82a4UL, 0xab1c5ed5UL, 0xd807aa98UL, 0x12835b01UL, -+ 0x243185beUL, 0x550c7dc3UL, 0x72be5d74UL, 0x80deb1feUL, 0x9bdc06a7UL, -+ 0xc19bf174UL, 0xe49b69c1UL, 0xefbe4786UL, 0x0fc19dc6UL, 0x240ca1ccUL, -+ 0x2de92c6fUL, 0x4a7484aaUL, 0x5cb0a9dcUL, 0x76f988daUL, 0x983e5152UL, -+ 0xa831c66dUL, 0xb00327c8UL, 0xbf597fc7UL, 0xc6e00bf3UL, 0xd5a79147UL, -+ 0x06ca6351UL, 0x14292967UL, 0x27b70a85UL, 0x2e1b2138UL, 0x4d2c6dfcUL, -+ 0x53380d13UL, 0x650a7354UL, 0x766a0abbUL, 0x81c2c92eUL, 0x92722c85UL, -+ 0xa2bfe8a1UL, 0xa81a664bUL, 0xc24b8b70UL, 0xc76c51a3UL, 0xd192e819UL, -+ 0xd6990624UL, 0xf40e3585UL, 0x106aa070UL, 0x19a4c116UL, 0x1e376c08UL, -+ 0x2748774cUL, 0x34b0bcb5UL, 0x391c0cb3UL, 0x4ed8aa4aUL, 0x5b9cca4fUL, -+ 0x682e6ff3UL, 0x748f82eeUL, 0x78a5636fUL, 0x84c87814UL, 0x8cc70208UL, -+ 0x90befffaUL, 0xa4506cebUL, 0xbef9a3f7UL, 0xc67178f2UL -+}; -+ -+ -+/* Various logical functions */ -+#define RORc(x, y) \ -+( ((((unsigned long) (x) & 0xFFFFFFFFUL) >> (unsigned long) ((y) & 31)) | \ -+ ((unsigned long) (x) << (unsigned long) (32 - ((y) & 31)))) & 0xFFFFFFFFUL) -+#define Ch(x,y,z) (z ^ (x & (y ^ z))) -+#define Maj(x,y,z) (((x | y) & z) | (x & y)) -+#define S(x, n) RORc((x), (n)) -+#define R(x, n) (((x)&0xFFFFFFFFUL)>>(n)) -+#define Sigma0(x) (S(x, 2) ^ S(x, 13) ^ S(x, 22)) -+#define Sigma1(x) (S(x, 6) ^ S(x, 11) ^ S(x, 25)) -+#define Gamma0(x) (S(x, 7) ^ S(x, 18) ^ R(x, 3)) -+#define Gamma1(x) (S(x, 17) ^ S(x, 19) ^ R(x, 10)) -+#ifndef MIN -+#define MIN(x, y) (((x) < (y)) ? (x) : (y)) -+#endif -+ -+void rtw_secmicsetkey(struct mic_data *pmicdata, u8 * key ); -+void rtw_secmicappendbyte(struct mic_data *pmicdata, u8 b ); -+void rtw_secmicappend(struct mic_data *pmicdata, u8 * src, u32 nBytes ); -+void rtw_secgetmic(struct mic_data *pmicdata, u8 * dst ); -+ -+void rtw_seccalctkipmic( -+ u8 * key, -+ u8 *header, -+ u8 *data, -+ u32 data_len, -+ u8 *Miccode, -+ u8 priority); -+ -+u32 rtw_aes_encrypt(_adapter *padapter, u8 *pxmitframe); -+u32 rtw_tkip_encrypt(_adapter *padapter, u8 *pxmitframe); -+void rtw_wep_encrypt(_adapter *padapter, u8 *pxmitframe); -+ -+u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe); -+u32 rtw_tkip_decrypt(_adapter *padapter, u8 *precvframe); -+void rtw_wep_decrypt(_adapter *padapter, u8 *precvframe); -+ -+#ifdef CONFIG_TDLS -+void wpa_tdls_generate_tpk(_adapter *padapter, struct sta_info *psta); -+int wpa_tdls_ftie_mic(u8 *kck, u8 trans_seq, -+ u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie, -+ u8 *mic); -+int tdls_verify_mic(u8 *kck, u8 trans_seq, -+ u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie); -+#endif //CONFIG_TDLS -+ -+void rtw_use_tkipkey_handler(RTW_TIMER_HDL_ARGS); -+ -+#endif //__RTL871X_SECURITY_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_sreset.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_sreset.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_sreset.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_sreset.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,55 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_SRESET_H_ -+#define _RTW_SRESET_H_ -+ -+//#include -+ -+enum { -+ SRESET_TGP_NULL = 0, -+ SRESET_TGP_XMIT_STATUS = 1, -+ SRESET_TGP_LINK_STATUS = 2, -+}; -+ -+struct sreset_priv { -+ _mutex silentreset_mutex; -+ u8 silent_reset_inprogress; -+ u8 Wifi_Error_Status; -+ unsigned long last_tx_time; -+ unsigned long last_tx_complete_time; -+ -+ s32 dbg_trigger_point; -+}; -+ -+ -+ -+#define WIFI_STATUS_SUCCESS 0 -+#define USB_VEN_REQ_CMD_FAIL BIT0 -+#define USB_READ_PORT_FAIL BIT1 -+#define USB_WRITE_PORT_FAIL BIT2 -+#define WIFI_MAC_TXDMA_ERROR BIT3 -+#define WIFI_TX_HANG BIT4 -+#define WIFI_RX_HANG BIT5 -+#define WIFI_IF_NOT_EXIST BIT6 -+ -+void sreset_init_value(_adapter *padapter); -+void sreset_reset_value(_adapter *padapter); -+u8 sreset_get_wifi_status(_adapter *padapter); -+void sreset_set_wifi_error_status(_adapter *padapter, u32 status); -+void sreset_set_trigger_point(_adapter *padapter, s32 tgp); -+bool sreset_inprogress(_adapter *padapter); -+void sreset_reset(_adapter *padapter); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_tdls.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_tdls.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_tdls.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_tdls.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,136 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __RTW_TDLS_H_ -+#define __RTW_TDLS_H_ -+ -+ -+#ifdef CONFIG_TDLS -+/* TDLS STA state */ -+#define TDLS_STATE_NONE 0x00000000 //default state -+#define TDLS_INITIATOR_STATE 0x10000000 -+#define TDLS_RESPONDER_STATE 0x20000000 -+#define TDLS_LINKED_STATE 0x40000000 -+#define TDLS_CH_SWITCH_ON_STATE 0x01000000 -+#define TDLS_PEER_AT_OFF_STATE 0x02000000 //could send pkt on target ch -+#define TDLS_AT_OFF_CH_STATE 0x04000000 -+#define TDLS_CH_SW_INITIATOR_STATE 0x08000000 //avoiding duplicated or unconditional ch. switch rsp. -+#define TDLS_APSD_CHSW_STATE 0x00100000 //in APSD and want to setup channel switch -+#define TDLS_PEER_SLEEP_STATE 0x00200000 //peer sta is sleeping -+#define TDLS_SW_OFF_STATE 0x00400000 //terminate channel swithcing -+#define TDLS_ALIVE_STATE 0x00010000 //Check if peer sta is alived. -+ -+#define TPK_RESEND_COUNT 301 -+#define CH_SWITCH_TIME 10 -+#define CH_SWITCH_TIMEOUT 30 -+#define TDLS_STAY_TIME 500 -+#define TDLS_SIGNAL_THRESH 0x20 -+#define TDLS_WATCHDOG_PERIOD 10 //Periodically sending tdls discovery request in TDLS_WATCHDOG_PERIOD * 2 sec -+#define TDLS_ALIVE_TIMER_PH1 5000 -+#define TDLS_ALIVE_TIMER_PH2 2000 -+#define TDLS_STAY_TIME 500 -+#define TDLS_HANDSHAKE_TIME 8000 -+#define TDLS_ALIVE_COUNT 3 -+#define TDLS_INI_MACID_ENTRY 6 -+ -+/* TDLS */ -+#define TDLS_MIC_LEN 16 -+#define WPA_NONCE_LEN 32 -+#define TDLS_TIMEOUT_LEN 4 -+ -+struct wpa_tdls_ftie { -+ u8 ie_type; /* FTIE */ -+ u8 ie_len; -+ u8 mic_ctrl[2]; -+ u8 mic[TDLS_MIC_LEN]; -+ u8 Anonce[WPA_NONCE_LEN]; /* Responder Nonce in TDLS */ -+ u8 Snonce[WPA_NONCE_LEN]; /* Initiator Nonce in TDLS */ -+ /* followed by optional elements */ -+} ; -+ -+struct wpa_tdls_lnkid { -+ u8 ie_type; /* Link Identifier IE */ -+ u8 ie_len; -+ u8 bssid[ETH_ALEN]; -+ u8 init_sta[ETH_ALEN]; -+ u8 resp_sta[ETH_ALEN]; -+} ; -+ -+static u8 TDLS_RSNIE[]={ 0x01, 0x00, //version shall be set to 1 -+ 0x00, 0x0f, 0xac, 0x07, //group sipher suite -+ 0x01, 0x00, //pairwise cipher suite count -+ 0x00, 0x0f, 0xac, 0x04, //pairwise cipher suite list; CCMP only -+ 0x01, 0x00, //AKM suite count -+ 0x00, 0x0f, 0xac, 0x07, //TPK Handshake -+ 0x00, 0x02, -+ //PMKID shall not be present -+ }; -+ -+static u8 TDLS_WMMIE[]={0x00, 0x50, 0xf2, 0x02, 0x00, 0x01, 0x00}; //Qos info all set zero -+ -+static u8 TDLS_EXT_CAPIE[] = {0x00, 0x00, 0x00, 0x50, 0x20}; //bit(28), bit(30), bit(37) -+ -+// SRC: Supported Regulatory Classes -+static u8 TDLS_SRC[] = { 0x01, 0x01, 0x02, 0x03, 0x04, 0x0c, 0x16, 0x17, 0x18, 0x19, 0x1b, 0x1c, 0x1d, 0x1e, 0x20, 0x21 }; -+ -+void rtw_reset_tdls_info(_adapter* padapter); -+int rtw_init_tdls_info(_adapter* padapter); -+void rtw_free_tdls_info(struct tdls_info *ptdlsinfo); -+void issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, struct sta_info *ptdls_sta, unsigned int power_mode); -+void init_TPK_timer(_adapter *padapter, struct sta_info *psta); -+void init_ch_switch_timer(_adapter *padapter, struct sta_info *psta); -+void init_base_ch_timer(_adapter *padapter, struct sta_info *psta); -+void init_off_ch_timer(_adapter *padapter, struct sta_info *psta); -+void init_tdls_alive_timer(_adapter *padapter, struct sta_info *psta); -+void init_handshake_timer(_adapter *padapter, struct sta_info *psta); -+void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta); -+#ifdef CONFIG_WFD -+void issue_tunneled_probe_req(_adapter *padapter); -+void issue_tunneled_probe_rsp(_adapter *padapter, union recv_frame *precv_frame); -+#endif //CONFIG_WFD -+void issue_tdls_dis_req(_adapter *padapter, u8 *mac_addr); -+void issue_tdls_setup_req(_adapter *padapter, u8 *mac_addr); -+void issue_tdls_setup_rsp(_adapter *padapter, union recv_frame *precv_frame); -+void issue_tdls_setup_cfm(_adapter *padapter, union recv_frame *precv_frame); -+void issue_tdls_dis_rsp(_adapter * padapter, union recv_frame * precv_frame, u8 dialog); -+void issue_tdls_teardown(_adapter *padapter, u8 *mac_addr); -+void issue_tdls_peer_traffic_indication(_adapter *padapter, struct sta_info *psta); -+void issue_tdls_ch_switch_req(_adapter *padapter, u8 *mac_addr); -+void issue_tdls_ch_switch_rsp(_adapter *padapter, u8 *mac_addr); -+sint On_TDLS_Dis_Rsp(_adapter *adapter, union recv_frame *precv_frame); -+sint On_TDLS_Setup_Req(_adapter *adapter, union recv_frame *precv_frame); -+sint On_TDLS_Setup_Rsp(_adapter *adapter, union recv_frame *precv_frame); -+sint On_TDLS_Setup_Cfm(_adapter *adapter, union recv_frame *precv_frame); -+sint On_TDLS_Dis_Req(_adapter *adapter, union recv_frame *precv_frame); -+sint On_TDLS_Teardown(_adapter *adapter, union recv_frame *precv_frame); -+sint On_TDLS_Peer_Traffic_Rsp(_adapter *adapter, union recv_frame *precv_frame); -+sint On_TDLS_Ch_Switch_Req(_adapter *adapter, union recv_frame *precv_frame); -+sint On_TDLS_Ch_Switch_Rsp(_adapter *adapter, union recv_frame *precv_frame); -+void rtw_build_tdls_setup_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); -+void rtw_build_tdls_setup_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); -+void rtw_build_tdls_setup_cfm_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); -+void rtw_build_tdls_teardown_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); -+void rtw_build_tdls_dis_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); -+void rtw_build_tdls_dis_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, u8 dialog); -+void rtw_build_tdls_peer_traffic_indication_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); -+void rtw_build_tdls_ch_switch_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); -+void rtw_build_tdls_ch_switch_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); -+void rtw_build_tunneled_probe_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); -+void rtw_build_tunneled_probe_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe); -+ -+int update_sgi_tdls(_adapter *padapter, struct sta_info *psta); -+u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta); -+#endif //CONFIG_TDLS -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_version.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_version.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_version.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_version.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1 @@ -+#define DRIVERVERSION "v4.2.2_7502.20130517" -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_vht.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_vht.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_vht.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_vht.h 2018-02-06 17:42:30.721967327 +0200 -@@ -0,0 +1,120 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _RTW_VHT_H_ -+#define _RTW_VHT_H_ -+ -+ -+//VHT capability info -+#define SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 2, _val) -+#define SET_VHT_CAPABILITY_ELE_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 2, 2, _val) -+#define SET_VHT_CAPABILITY_ELE_RX_LDPC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 4, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_SHORT_GI80M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 5, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_SHORT_GI160M(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 6, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_TX_STBC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 7, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_RX_STBC(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 0, 3, _val) -+#define SET_VHT_CAPABILITY_ELE_SU_BFER(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 3, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_SU_BFEE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 4, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_BFER_ANT_SUPP(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+1, 5, 3, _val) -+#define SET_VHT_CAPABILITY_ELE_SOUNDING_DIMENSIONS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 0, 3, _val) -+#define SET_VHT_CAPABILITY_ELE_MU_BFER(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 3, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_MU_BFEE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 4, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_TXOP_PS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 5, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_HTC_VHT(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 6, 1, _val) -+#define SET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+2, 7, 3, _val) //B23~B25 -+#define SET_VHT_CAPABILITY_ELE_LINK_ADAPTION(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+2, 2, 2, _val) -+#define SET_VHT_CAPABILITY_ELE_MCS_RX_MAP(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+4, 0, 16, _val) //B0~B15 indicate Rx MCS MAP, we write 0 to indicate MCS0~7. by page -+#define SET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+6, 0, 13, _val) -+#define SET_VHT_CAPABILITY_ELE_MCS_TX_MAP(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+8, 0, 16, _val) //B0~B15 indicate Tx MCS MAP, we write 0 to indicate MCS0~7. by page -+#define SET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(_pEleStart, _val) SET_BITS_TO_LE_2BYTE((_pEleStart)+10, 0, 13, _val) -+ -+ -+#define GET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 0, 2) -+#define GET_VHT_CAPABILITY_ELE_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 2, 2) -+#define GET_VHT_CAPABILITY_ELE_RX_LDPC(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 4, 1) -+#define GET_VHT_CAPABILITY_ELE_SHORT_GI80M(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 5, 1) -+#define GET_VHT_CAPABILITY_ELE_SHORT_GI160M(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 6, 1) -+#define GET_VHT_CAPABILITY_ELE_TX_STBC(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 7, 1) -+#define GET_VHT_CAPABILITY_ELE_RX_STBC(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 0, 3) -+#define GET_VHT_CAPABILITY_ELE_SU_BFER(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 3, 1) -+#define GET_VHT_CAPABILITY_ELE_SU_BFEE(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1, 4, 1) -+#define GET_VHT_CAPABILITY_ELE_TXOP_PS(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2, 5, 1) -+#define GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+2, 7, 3) -+#define GET_VHT_CAPABILITY_ELE_RX_MCS(_pEleStart) ((_pEleStart)+4) -+#define GET_VHT_CAPABILITY_ELE_MCS_RX_HIGHEST_RATE(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+6, 0, 13) -+#define GET_VHT_CAPABILITY_ELE_TX_MCS(_pEleStart) ((_pEleStart)+8) -+#define GET_VHT_CAPABILITY_ELE_MCS_TX_HIGHEST_RATE(_pEleStart) LE_BITS_TO_2BYTE((_pEleStart)+10, 0, 13) -+ -+ -+//VHT Operation Information Element -+#define SET_VHT_OPERATION_ELE_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 8, _val) -+#define SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(_pEleStart, _val) SET_BITS_TO_LE_2BYTE(_pEleStart+1, 0, 8, _val) -+#define SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(_pEleStart, _val) SET_BITS_TO_LE_2BYTE(_pEleStart+2, 0, 8, _val) -+#define SET_VHT_OPERATION_ELE_BASIC_MCS_SET(_pEleStart, _val) SET_BITS_TO_LE_2BYTE(_pEleStart+3, 0, 16, _val) -+ -+#define GET_VHT_OPERATION_ELE_CHL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart,0,8) -+#define GET_VHT_OPERATION_ELE_CENTER_FREQ1(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+1,0,8) -+#define GET_VHT_OPERATION_ELE_CENTER_FREQ2(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+2,0,8) -+ -+//VHT Operating Mode -+#define SET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 2, _val) -+#define SET_VHT_OPERATING_MODE_FIELD_RX_NSS(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 4, 3, _val) -+#define SET_VHT_OPERATING_MODE_FIELD_RX_NSS_TYPE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 7, 1, _val) -+#define GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 0, 2) -+#define GET_VHT_OPERATING_MODE_FIELD_RX_NSS(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 4, 3) -+#define GET_VHT_OPERATING_MODE_FIELD_RX_NSS_TYPE(_pEleStart) LE_BITS_TO_1BYTE(_pEleStart, 7, 1) -+ -+#define SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+7, 6, 1, _val) -+#define GET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+7, 6, 1) -+ -+ -+#define TEST_FLAG(__Flag,__testFlag) (((__Flag) & (__testFlag)) != 0) -+#define SET_FLAG(__Flag, __setFlag) ((__Flag) |= __setFlag) -+#define CLEAR_FLAG(__Flag, __clearFlag) ((__Flag) &= ~(__clearFlag)) -+#define CLEAR_FLAGS(__Flag) ((__Flag) = 0) -+#define TEST_FLAGS(__Flag, __testFlags) (((__Flag) & (__testFlags)) == (__testFlags)) -+ -+struct vht_priv -+{ -+ u8 vht_option; -+ -+ u8 ldpc_cap; -+ u8 stbc_cap; -+ u8 beamform_cap; -+ -+ u8 bwmode; -+ u8 sgi;//short GI -+ u8 ampdu_len; -+ -+ u8 vht_highest_rate; -+ u8 vht_mcs_map[2]; -+ -+ u8 vht_cap[32]; -+}; -+ -+u8 rtw_get_vht_highest_rate(_adapter *padapter, u8 *pvht_mcs_map); -+u16 rtw_vht_data_rate(u8 bw, u8 short_GI, u8 vht_mcs_rate); -+u32 rtw_vht_rate_to_bitmap(u8 *pVHTRate); -+void rtw_vht_use_default_setting(_adapter *padapter); -+u32 rtw_build_vht_operation_ie(_adapter *padapter, u8 *pbuf, u8 channel); -+u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf); -+u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf); -+void update_sta_vht_info_apmode(_adapter *padapter, void * psta); -+void update_hw_vht_param(_adapter *padapter); -+void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+void VHT_operation_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -+u32 rtw_restructure_vht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len); -+void VHTOnAssocRsp(_adapter *padapter); -+ -+#endif //_RTW_VHT_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/rtw_wapi.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_wapi.h ---- linux-4.14.17/3rdparty/rtl8812au/include/rtw_wapi.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/rtw_wapi.h 2018-02-06 17:42:30.722967342 +0200 -@@ -0,0 +1,222 @@ -+#ifndef __INC_WAPI_H -+#define __INC_WAPI_H -+ -+ -+#define CONFIG_WAPI_SW_SMS4 -+#define WAPI_DEBUG -+ -+#define SMS4_MIC_LEN 16 -+#define WAPI_EXT_LEN 18 -+#define MAX_WAPI_IE_LEN 256 -+#define sMacHdrLng 24 // octets in data header, no WEP -+ -+#ifdef WAPI_DEBUG -+ -+/* WAPI trace debug */ -+extern u32 wapi_debug_component; -+ -+static inline void dump_buf(u8 *buf, u32 len) -+{ -+ u32 i; -+ printk("-----------------Len %d----------------\n", len); -+ for(i=0; i4096), HW will execute -+ // memoryR/W CRC error. And then all DMA fetch will fail. We must decrease descriptor -+ // number or enlarge descriptor size as 64 bytes. -+ unsigned int txdw12; -+ unsigned int txdw13; -+ unsigned int txdw14; -+ unsigned int txdw15; -+#endif -+}; -+ -+ -+union txdesc { -+ struct tx_desc txdesc; -+ unsigned int value[TXDESC_SIZE>>2]; -+}; -+ -+struct hw_xmit { -+ //_lock xmit_lock; -+ //_list pending; -+ _queue *sta_queue; -+ //struct hw_txqueue *phwtxqueue; -+ //sint txcmdcnt; -+ int accnt; -+}; -+ -+//reduce size -+struct pkt_attrib -+{ -+ u8 type; -+ u8 subtype; -+ u8 bswenc; -+ u8 dhcp_pkt; -+ u16 ether_type; -+ u16 seqnum; -+ u16 pkt_hdrlen; //the original 802.3 pkt header len -+ u16 hdrlen; //the WLAN Header Len -+ u32 pktlen; //the original 802.3 pkt raw_data len (not include ether_hdr data) -+ u32 last_txcmdsz; -+ u8 nr_frags; -+ u8 encrypt; //when 0 indicate no encrypt. when non-zero, indicate the encrypt algorith -+ u8 iv_len; -+ u8 icv_len; -+ u8 iv[18]; -+ u8 icv[16]; -+ u8 priority; -+ u8 ack_policy; -+ u8 mac_id; -+ u8 vcs_mode; //virtual carrier sense method -+ u8 dst[ETH_ALEN]; -+ u8 src[ETH_ALEN]; -+ u8 ta[ETH_ALEN]; -+ u8 ra[ETH_ALEN]; -+ u8 key_idx; -+ u8 qos_en; -+ u8 ht_en; -+ u8 raid;//rate adpative id -+ u8 bwmode; -+ u8 ch_offset;//PRIME_CHNL_OFFSET -+ u8 sgi;//short GI -+ u8 ampdu_en;//tx ampdu enable -+ u8 mdata;//more data bit -+ u8 pctrl;//per packet txdesc control enable -+ u8 triggered;//for ap mode handling Power Saving sta -+ u8 qsel; -+ u8 eosp; -+ u8 rate; -+ u8 intel_proxim; -+ u8 retry_ctrl; -+ u8 mbssid; -+ u8 ldpc; -+ u8 stbc; -+ struct sta_info * psta; -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ u8 hw_tcp_csum; -+#endif -+ -+ u8 rtsen; -+ u8 cts2self; -+ union Keytype dot11tkiptxmickey; -+ //union Keytype dot11tkiprxmickey; -+ union Keytype dot118021x_UncstKey; -+ -+ -+}; -+ -+#define WLANHDR_OFFSET 64 -+ -+#define NULL_FRAMETAG (0x0) -+#define DATA_FRAMETAG 0x01 -+#define L2_FRAMETAG 0x02 -+#define MGNT_FRAMETAG 0x03 -+#define AMSDU_FRAMETAG 0x04 -+ -+#define EII_FRAMETAG 0x05 -+#define IEEE8023_FRAMETAG 0x06 -+ -+#define MP_FRAMETAG 0x07 -+ -+#define TXAGG_FRAMETAG 0x08 -+ -+enum { -+ XMITBUF_DATA = 0, -+ XMITBUF_MGNT = 1, -+ XMITBUF_CMD = 2, -+}; -+ -+struct submit_ctx{ -+ u32 submit_time; /* */ -+ u32 timeout_ms; /* <0: not synchronous, 0: wait forever, >0: up to ms waiting */ -+ int status; /* status for operation */ -+ struct completion done; -+}; -+ -+enum { -+ RTW_SCTX_SUBMITTED = -1, -+ RTW_SCTX_DONE_SUCCESS = 0, -+ RTW_SCTX_DONE_UNKNOWN, -+ RTW_SCTX_DONE_TIMEOUT, -+ RTW_SCTX_DONE_BUF_ALLOC, -+ RTW_SCTX_DONE_BUF_FREE, -+ RTW_SCTX_DONE_WRITE_PORT_ERR, -+ RTW_SCTX_DONE_TX_DESC_NA, -+ RTW_SCTX_DONE_TX_DENY, -+ RTW_SCTX_DONE_CCX_PKT_FAIL, -+ RTW_SCTX_DONE_DRV_STOP, -+ RTW_SCTX_DONE_DEV_REMOVE, -+}; -+ -+ -+void rtw_sctx_init(struct submit_ctx *sctx, int timeout_ms); -+int rtw_sctx_wait(struct submit_ctx *sctx); -+void rtw_sctx_done_err(struct submit_ctx **sctx, int status); -+void rtw_sctx_done(struct submit_ctx **sctx); -+ -+struct xmit_buf -+{ -+ _list list; -+ -+ _adapter *padapter; -+ -+ u8 *pallocated_buf; -+ -+ u8 *pbuf; -+ -+ void *priv_data; -+ -+ u16 buf_tag; // 0: Normal xmitbuf, 1: extension xmitbuf, 2:cmd xmitbuf -+ u16 flags; -+ u32 alloc_sz; -+ -+ u32 len; -+ -+ struct submit_ctx *sctx; -+ -+ u32 ff_hwaddr; -+ -+ PURB pxmit_urb[8]; -+ dma_addr_t dma_transfer_addr; /* (in) dma addr for transfer_buffer */ -+ -+ u8 bpending[8]; -+ -+ sint last[8]; -+ -+#if defined(DBG_XMIT_BUF )|| defined(DBG_XMIT_BUF_EXT) -+ u8 no; -+#endif -+}; -+ -+struct xmit_frame -+{ -+ _list list; -+ -+ struct pkt_attrib attrib; -+ -+ _pkt *pkt; -+ -+ int frame_tag; -+ -+ _adapter *padapter; -+ -+ u8 *buf_addr; -+ -+ struct xmit_buf *pxmitbuf; -+ -+#ifdef CONFIG_USB_TX_AGGREGATION -+ u8 agg_num; -+#endif -+ s8 pkt_offset; -+ -+#ifdef CONFIG_XMIT_ACK -+ u8 ack_report; -+#endif -+ -+ u8 *alloc_addr; /* the actual address this xmitframe allocated */ -+ u8 ext_tag; /* 0:data, 1:mgmt */ -+ -+}; -+ -+struct tx_servq { -+ _list tx_pending; -+ _queue sta_pending; -+ int qcnt; -+}; -+ -+ -+struct sta_xmit_priv -+{ -+ _lock lock; -+ sint option; -+ sint apsd_setting; //When bit mask is on, the associated edca queue supports APSD. -+ -+ -+ //struct tx_servq blk_q[MAX_NUMBLKS]; -+ struct tx_servq be_q; //priority == 0,3 -+ struct tx_servq bk_q; //priority == 1,2 -+ struct tx_servq vi_q; //priority == 4,5 -+ struct tx_servq vo_q; //priority == 6,7 -+ _list legacy_dz; -+ _list apsd; -+ -+ u16 txseq_tid[16]; -+ -+ //uint sta_tx_bytes; -+ //u64 sta_tx_pkts; -+ //uint sta_tx_fail; -+ -+ -+}; -+ -+ -+struct hw_txqueue { -+ volatile sint head; -+ volatile sint tail; -+ volatile sint free_sz; //in units of 64 bytes -+ volatile sint free_cmdsz; -+ volatile sint txsz[8]; -+ uint ff_hwaddr; -+ uint cmd_hwaddr; -+ sint ac_tag; -+}; -+ -+struct agg_pkt_info{ -+ u16 offset; -+ u16 pkt_len; -+}; -+ -+struct xmit_priv { -+ -+ _lock lock; -+ -+ _sema xmit_sema; -+ _sema terminate_xmitthread_sema; -+ -+ //_queue blk_strms[MAX_NUMBLKS]; -+ _queue be_pending; -+ _queue bk_pending; -+ _queue vi_pending; -+ _queue vo_pending; -+ _queue bm_pending; -+ -+ //_queue legacy_dz_queue; -+ //_queue apsd_queue; -+ -+ u8 *pallocated_frame_buf; -+ u8 *pxmit_frame_buf; -+ uint free_xmitframe_cnt; -+ _queue free_xmit_queue; -+ -+ //uint mapping_addr; -+ //uint pkt_sz; -+ -+ u8 *xframe_ext_alloc_addr; -+ u8 *xframe_ext; -+ uint free_xframe_ext_cnt; -+ _queue free_xframe_ext_queue; -+ -+ //struct hw_txqueue be_txqueue; -+ //struct hw_txqueue bk_txqueue; -+ //struct hw_txqueue vi_txqueue; -+ //struct hw_txqueue vo_txqueue; -+ //struct hw_txqueue bmc_txqueue; -+ -+ uint frag_len; -+ -+ _adapter *adapter; -+ -+ u8 vcs_setting; -+ u8 vcs; -+ u8 vcs_type; -+ //u16 rts_thresh; -+ -+ u64 tx_bytes; -+ u64 tx_pkts; -+ u64 tx_drop; -+ u64 last_tx_bytes; -+ u64 last_tx_pkts; -+ -+ struct hw_xmit *hwxmits; -+ u8 hwxmit_entry; -+ -+ u8 wmm_para_seq[4];//sequence for wmm ac parameter strength from large to small. it's value is 0->vo, 1->vi, 2->be, 3->bk. -+ -+ _sema tx_retevt;//all tx return event; -+ u8 txirp_cnt;// -+ -+ struct tasklet_struct xmit_tasklet; -+ //per AC pending irp -+ int beq_cnt; -+ int bkq_cnt; -+ int viq_cnt; -+ int voq_cnt; -+ -+ _queue free_xmitbuf_queue; -+ _queue pending_xmitbuf_queue; -+ u8 *pallocated_xmitbuf; -+ u8 *pxmitbuf; -+ uint free_xmitbuf_cnt; -+ -+ _queue free_xmit_extbuf_queue; -+ u8 *pallocated_xmit_extbuf; -+ u8 *pxmit_extbuf; -+ uint free_xmit_extbuf_cnt; -+ -+ struct xmit_buf pcmd_xmitbuf; -+ -+ u16 nqos_ssn; -+ #ifdef CONFIG_TX_EARLY_MODE -+ -+ #define MAX_AGG_PKT_NUM 256 //Max tx ampdu coounts -+ -+ struct agg_pkt_info agg_pkt[MAX_AGG_PKT_NUM]; -+ #endif -+ -+#ifdef CONFIG_XMIT_ACK -+ int ack_tx; -+ _mutex ack_tx_mutex; -+ struct submit_ctx ack_tx_ops; -+#endif -+ _lock lock_sctx; -+}; -+ -+extern struct xmit_frame *rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, u32 buffsize); -+extern void rtw_free_cmdxmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe); -+extern struct xmit_buf *rtw_alloc_cmd_xmitbuf(struct xmit_priv *pxmitpriv, u32 buffsize); -+extern s32 rtw_free_cmd_xmitbuf(struct xmit_priv *pxmitpriv); -+ -+extern struct xmit_buf *rtw_alloc_xmitbuf_ext(struct xmit_priv *pxmitpriv); -+extern s32 rtw_free_xmitbuf_ext(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+ -+extern struct xmit_buf *rtw_alloc_xmitbuf(struct xmit_priv *pxmitpriv); -+extern s32 rtw_free_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+ -+void rtw_count_tx_stats(_adapter *padapter, struct xmit_frame *pxmitframe, int sz); -+extern void rtw_update_protection(_adapter *padapter, u8 *ie, uint ie_len); -+extern s32 rtw_make_wlanhdr(_adapter *padapter, u8 *hdr, struct pkt_attrib *pattrib); -+extern s32 rtw_put_snap(u8 *data, u16 h_proto); -+ -+extern struct xmit_frame *rtw_alloc_xmitframe(struct xmit_priv *pxmitpriv); -+struct xmit_frame *rtw_alloc_xmitframe_ext(struct xmit_priv *pxmitpriv); -+struct xmit_frame *rtw_alloc_xmitframe_once(struct xmit_priv *pxmitpriv); -+extern s32 rtw_free_xmitframe(struct xmit_priv *pxmitpriv, struct xmit_frame *pxmitframe); -+extern void rtw_free_xmitframe_queue(struct xmit_priv *pxmitpriv, _queue *pframequeue); -+struct tx_servq *rtw_get_sta_pending(_adapter *padapter, struct sta_info *psta, sint up, u8 *ac); -+extern s32 rtw_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); -+extern struct xmit_frame* rtw_dequeue_xframe(struct xmit_priv *pxmitpriv, struct hw_xmit *phwxmit_i, sint entry); -+ -+extern s32 rtw_xmit_classifier(_adapter *padapter, struct xmit_frame *pxmitframe); -+extern u32 rtw_calculate_wlan_pkt_size_by_attribue(struct pkt_attrib *pattrib); -+#define rtw_wlan_pkt_size(f) rtw_calculate_wlan_pkt_size_by_attribue(&f->attrib) -+extern s32 rtw_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe); -+#ifdef CONFIG_TDLS -+s32 rtw_xmit_tdls_coalesce(_adapter *padapter, struct xmit_frame *pxmitframe, u8 action); -+#endif -+s32 _rtw_init_hw_txqueue(struct hw_txqueue* phw_txqueue, u8 ac_tag); -+void _rtw_init_sta_xmit_priv(struct sta_xmit_priv *psta_xmitpriv); -+ -+ -+s32 rtw_txframes_pending(_adapter *padapter); -+s32 rtw_txframes_sta_ac_pending(_adapter *padapter, struct pkt_attrib *pattrib); -+void rtw_init_hwxmits(struct hw_xmit *phwxmit, sint entry); -+ -+ -+s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, _adapter *padapter); -+void _rtw_free_xmit_priv (struct xmit_priv *pxmitpriv); -+ -+ -+void rtw_alloc_hwxmits(_adapter *padapter); -+void rtw_free_hwxmits(_adapter *padapter); -+ -+ -+s32 rtw_xmit(_adapter *padapter, _pkt **pkt); -+ -+#if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) -+sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe); -+void stop_sta_xmit(_adapter *padapter, struct sta_info *psta); -+void wakeup_sta_to_xmit(_adapter *padapter, struct sta_info *psta); -+void xmit_delivery_enabled_frames(_adapter *padapter, struct sta_info *psta); -+#endif -+ -+u8 qos_acm(u8 acm_mask, u8 priority); -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+void enqueue_pending_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); -+struct xmit_buf* dequeue_pending_xmitbuf(struct xmit_priv *pxmitpriv); -+struct xmit_buf* dequeue_pending_xmitbuf_under_survey(struct xmit_priv *pxmitpriv); -+sint check_pending_xmitbuf(struct xmit_priv *pxmitpriv); -+thread_return rtw_xmit_thread(thread_context context); -+#endif -+ -+u32 rtw_get_ff_hwaddr(struct xmit_frame *pxmitframe); -+ -+#ifdef CONFIG_XMIT_ACK -+int rtw_ack_tx_wait(struct xmit_priv *pxmitpriv, u32 timeout_ms); -+void rtw_ack_tx_done(struct xmit_priv *pxmitpriv, int status); -+#endif //CONFIG_XMIT_ACK -+ -+ -+//include after declaring struct xmit_buf, in order to avoid warning -+#include -+ -+#endif //_RTL871X_XMIT_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/sta_info.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/sta_info.h ---- linux-4.14.17/3rdparty/rtl8812au/include/sta_info.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/sta_info.h 2018-02-06 17:42:30.722967342 +0200 -@@ -0,0 +1,456 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __STA_INFO_H_ -+#define __STA_INFO_H_ -+ -+ -+#define IBSS_START_MAC_ID 2 -+#define NUM_STA 32 -+#define NUM_ACL 16 -+ -+ -+//if mode ==0, then the sta is allowed once the addr is hit. -+//if mode ==1, then the sta is rejected once the addr is non-hit. -+struct rtw_wlan_acl_node { -+ _list list; -+ u8 addr[ETH_ALEN]; -+ u8 valid; -+}; -+ -+//mode=0, disable -+//mode=1, accept unless in deny list -+//mode=2, deny unless in accept list -+struct wlan_acl_pool { -+ int mode; -+ int num; -+ struct rtw_wlan_acl_node aclnode[NUM_ACL]; -+ _queue acl_node_q; -+}; -+ -+typedef struct _RSSI_STA{ -+ s32 UndecoratedSmoothedPWDB; -+ s32 UndecoratedSmoothedCCK; -+ s32 UndecoratedSmoothedOFDM; -+ u64 PacketMap; -+ u8 ValidBit; -+}RSSI_STA, *PRSSI_STA; -+ -+struct stainfo_stats { -+ -+ u64 rx_mgnt_pkts; -+ u64 rx_beacon_pkts; -+ u64 rx_probereq_pkts; -+ u64 rx_probersp_pkts; -+ u64 rx_probersp_bm_pkts; -+ u64 rx_probersp_uo_pkts; -+ u64 rx_ctrl_pkts; -+ u64 rx_data_pkts; -+ -+ u64 last_rx_mgnt_pkts; -+ u64 last_rx_beacon_pkts; -+ u64 last_rx_probereq_pkts; -+ u64 last_rx_probersp_pkts; -+ u64 last_rx_probersp_bm_pkts; -+ u64 last_rx_probersp_uo_pkts; -+ u64 last_rx_ctrl_pkts; -+ u64 last_rx_data_pkts; -+ -+ u64 rx_bytes; -+ u64 rx_drops; -+ -+ u64 tx_pkts; -+ u64 tx_bytes; -+ u64 tx_drops; -+ -+}; -+ -+#ifdef CONFIG_TDLS -+struct TDLS_PeerKey { -+ u8 kck[16]; /* TPK-KCK */ -+ u8 tk[16]; /* TPK-TK; only CCMP will be used */ -+} ; -+#endif //CONFIG_TDLS -+ -+struct sta_info { -+ -+ _lock lock; -+ _list list; //free_sta_queue -+ _list hash_list; //sta_hash -+ //_list asoc_list; //20061114 -+ //_list sleep_list;//sleep_q -+ //_list wakeup_list;//wakeup_q -+ _adapter *padapter; -+ -+ struct sta_xmit_priv sta_xmitpriv; -+ struct sta_recv_priv sta_recvpriv; -+ -+ _queue sleep_q; -+ unsigned int sleepq_len; -+ -+ uint state; -+ uint aid; -+ uint mac_id; -+ uint qos_option; -+ u8 hwaddr[ETH_ALEN]; -+ -+ uint ieee8021x_blocked; //0: allowed, 1:blocked -+ uint dot118021XPrivacy; //aes, tkip... -+ union Keytype dot11tkiptxmickey; -+ union Keytype dot11tkiprxmickey; -+ union Keytype dot118021x_UncstKey; -+ union pn48 dot11txpn; // PN48 used for Unicast xmit. -+ union pn48 dot11rxpn; // PN48 used for Unicast recv. -+ -+ -+ u8 bssrateset[16]; -+ u32 bssratelen; -+ s32 rssi; -+ s32 signal_quality; -+ -+ u8 cts2self; -+ u8 rtsen; -+ -+ u8 raid; -+ u8 init_rate; -+ u32 ra_mask; -+ u8 wireless_mode; // NETWORK_TYPE -+ -+ struct stainfo_stats sta_stats; -+ -+#ifdef CONFIG_TDLS -+ u32 tdls_sta_state; -+ u8 dialog; -+ u8 SNonce[32]; -+ u8 ANonce[32]; -+ u32 TDLS_PeerKey_Lifetime; -+ u16 TPK_count; -+ _timer TPK_timer; -+ struct TDLS_PeerKey tpk; -+ u16 stat_code; -+ u8 off_ch; -+ u16 ch_switch_time; -+ u16 ch_switch_timeout; -+ u8 option; -+ _timer option_timer; -+ _timer base_ch_timer; -+ _timer off_ch_timer; -+ -+ _timer handshake_timer; -+ _timer alive_timer1; -+ _timer alive_timer2; -+ u8 timer_flag; -+ u8 alive_count; -+#endif //CONFIG_TDLS -+ -+ //for A-MPDU TX, ADDBA timeout check -+ _timer addba_retry_timer; -+ -+ //for A-MPDU Rx reordering buffer control -+ struct recv_reorder_ctrl recvreorder_ctrl[16]; -+ -+ //for A-MPDU Tx -+ //unsigned char ampdu_txen_bitmap; -+ u16 BA_starting_seqctrl[16]; -+ -+ -+#ifdef CONFIG_80211N_HT -+ struct ht_priv htpriv; -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ struct vht_priv vhtpriv; -+#endif -+ -+ //Notes: -+ //STA_Mode: -+ //curr_network(mlme_priv/security_priv/qos/ht) + sta_info: (STA & AP) CAP/INFO -+ //scan_q: AP CAP/INFO -+ -+ //AP_Mode: -+ //curr_network(mlme_priv/security_priv/qos/ht) : AP CAP/INFO -+ //sta_info: (AP & STA) CAP/INFO -+ -+#ifdef CONFIG_AP_MODE -+ -+ _list asoc_list; -+ _list auth_list; -+ -+ unsigned int expire_to; -+ unsigned int auth_seq; -+ unsigned int authalg; -+ unsigned char chg_txt[128]; -+ -+ u16 capability; -+ int flags; -+ -+ int dot8021xalg;//0:disable, 1:psk, 2:802.1x -+ int wpa_psk;//0:disable, bit(0): WPA, bit(1):WPA2 -+ int wpa_group_cipher; -+ int wpa2_group_cipher; -+ int wpa_pairwise_cipher; -+ int wpa2_pairwise_cipher; -+ -+ u8 bpairwise_key_installed; -+ -+#ifdef CONFIG_NATIVEAP_MLME -+ u8 wpa_ie[32]; -+ -+ u8 nonerp_set; -+ u8 no_short_slot_time_set; -+ u8 no_short_preamble_set; -+ u8 no_ht_gf_set; -+ u8 no_ht_set; -+ u8 ht_20mhz_set; -+#endif // CONFIG_NATIVEAP_MLME -+ -+ unsigned int tx_ra_bitmap; -+ u8 qos_info; -+ -+ u8 max_sp_len; -+ u8 uapsd_bk;//BIT(0): Delivery enabled, BIT(1): Trigger enabled -+ u8 uapsd_be; -+ u8 uapsd_vi; -+ u8 uapsd_vo; -+ -+ u8 has_legacy_ac; -+ unsigned int sleepq_ac_len; -+ -+#ifdef CONFIG_P2P -+ //p2p priv data -+ u8 is_p2p_device; -+ u8 p2p_status_code; -+ -+ //p2p client info -+ u8 dev_addr[ETH_ALEN]; -+ //u8 iface_addr[ETH_ALEN];//= hwaddr[ETH_ALEN] -+ u8 dev_cap; -+ u16 config_methods; -+ u8 primary_dev_type[8]; -+ u8 num_of_secdev_type; -+ u8 secdev_types_list[32];// 32/8 == 4; -+ u16 dev_name_len; -+ u8 dev_name[32]; -+#endif //CONFIG_P2P -+ -+#ifdef CONFIG_TX_MCAST2UNI -+ u8 under_exist_checking; -+#endif // CONFIG_TX_MCAST2UNI -+ -+ u8 keep_alive_trycnt; -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ u8 isrc; //this device is rc -+ u16 pid; // pairing id -+#endif -+ -+#endif // CONFIG_AP_MODE -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ u8 *passoc_req; -+ u32 assoc_req_len; -+#endif -+ -+ //for DM -+ RSSI_STA rssi_stat; -+ -+ // -+ // ================ODM Relative Info======================= -+ // Please be care, dont declare too much structure here. It will cost memory * STA support num. -+ // -+ // -+ // 2011/10/20 MH Add for ODM STA info. -+ // -+ // Driver Write -+ u8 bValid; // record the sta status link or not? -+ //u8 WirelessMode; // -+ u8 IOTPeer; // Enum value. HT_IOT_PEER_E -+ u8 rssi_level; //for Refresh RA mask -+ // ODM Write -+ //1 PHY_STATUS_INFO -+ u8 RSSI_Path[4]; // -+ u8 RSSI_Ave; -+ u8 RXEVM[4]; -+ u8 RXSNR[4]; -+ -+ // ODM Write -+ //1 TX_INFO (may changed by IC) -+ //TX_INFO_T pTxInfo; // Define in IC folder. Move lower layer. -+ // -+ // ================ODM Relative Info======================= -+ // -+ -+ /* To store the sequence number of received management frame */ -+ u16 RxMgmtFrameSeqNum; -+}; -+ -+#define sta_rx_pkts(sta) \ -+ (sta->sta_stats.rx_mgnt_pkts \ -+ + sta->sta_stats.rx_ctrl_pkts \ -+ + sta->sta_stats.rx_data_pkts) -+ -+#define sta_last_rx_pkts(sta) \ -+ (sta->sta_stats.last_rx_mgnt_pkts \ -+ + sta->sta_stats.last_rx_ctrl_pkts \ -+ + sta->sta_stats.last_rx_data_pkts) -+ -+#define sta_rx_data_pkts(sta) \ -+ (sta->sta_stats.rx_data_pkts) -+ -+#define sta_last_rx_data_pkts(sta) \ -+ (sta->sta_stats.last_rx_data_pkts) -+ -+#define sta_rx_mgnt_pkts(sta) \ -+ (sta->sta_stats.rx_mgnt_pkts) -+ -+#define sta_last_rx_mgnt_pkts(sta) \ -+ (sta->sta_stats.last_rx_mgnt_pkts) -+ -+#define sta_rx_beacon_pkts(sta) \ -+ (sta->sta_stats.rx_beacon_pkts) -+ -+#define sta_last_rx_beacon_pkts(sta) \ -+ (sta->sta_stats.last_rx_beacon_pkts) -+ -+#define sta_rx_probereq_pkts(sta) \ -+ (sta->sta_stats.rx_probereq_pkts) -+ -+#define sta_last_rx_probereq_pkts(sta) \ -+ (sta->sta_stats.last_rx_probereq_pkts) -+ -+#define sta_rx_probersp_pkts(sta) \ -+ (sta->sta_stats.rx_probersp_pkts) -+ -+#define sta_last_rx_probersp_pkts(sta) \ -+ (sta->sta_stats.last_rx_probersp_pkts) -+ -+#define sta_rx_probersp_bm_pkts(sta) \ -+ (sta->sta_stats.rx_probersp_bm_pkts) -+ -+#define sta_last_rx_probersp_bm_pkts(sta) \ -+ (sta->sta_stats.last_rx_probersp_bm_pkts) -+ -+#define sta_rx_probersp_uo_pkts(sta) \ -+ (sta->sta_stats.rx_probersp_uo_pkts) -+ -+#define sta_last_rx_probersp_uo_pkts(sta) \ -+ (sta->sta_stats.last_rx_probersp_uo_pkts) -+ -+#define sta_update_last_rx_pkts(sta) \ -+ do { \ -+ sta->sta_stats.last_rx_mgnt_pkts = sta->sta_stats.rx_mgnt_pkts; \ -+ sta->sta_stats.last_rx_beacon_pkts = sta->sta_stats.rx_beacon_pkts; \ -+ sta->sta_stats.last_rx_probereq_pkts = sta->sta_stats.rx_probereq_pkts; \ -+ sta->sta_stats.last_rx_probersp_pkts = sta->sta_stats.rx_probersp_pkts; \ -+ sta->sta_stats.last_rx_probersp_bm_pkts = sta->sta_stats.rx_probersp_bm_pkts; \ -+ sta->sta_stats.last_rx_probersp_uo_pkts = sta->sta_stats.rx_probersp_uo_pkts; \ -+ sta->sta_stats.last_rx_ctrl_pkts = sta->sta_stats.rx_ctrl_pkts; \ -+ sta->sta_stats.last_rx_data_pkts = sta->sta_stats.rx_data_pkts; \ -+ } while(0) -+ -+#define STA_RX_PKTS_ARG(sta) \ -+ sta->sta_stats.rx_mgnt_pkts \ -+ , sta->sta_stats.rx_ctrl_pkts \ -+ , sta->sta_stats.rx_data_pkts -+ -+#define STA_LAST_RX_PKTS_ARG(sta) \ -+ sta->sta_stats.last_rx_mgnt_pkts \ -+ , sta->sta_stats.last_rx_ctrl_pkts \ -+ , sta->sta_stats.last_rx_data_pkts -+ -+#define STA_RX_PKTS_DIFF_ARG(sta) \ -+ sta->sta_stats.rx_mgnt_pkts - sta->sta_stats.last_rx_mgnt_pkts \ -+ , sta->sta_stats.rx_ctrl_pkts - sta->sta_stats.last_rx_ctrl_pkts \ -+ , sta->sta_stats.rx_data_pkts -sta->sta_stats.last_rx_data_pkts -+ -+#define STA_PKTS_FMT "(m:%llu, c:%llu, d:%llu)" -+ -+struct sta_priv { -+ -+ u8 *pallocated_stainfo_buf; -+ u8 *pstainfo_buf; -+ _queue free_sta_queue; -+ -+ _lock sta_hash_lock; -+ _list sta_hash[NUM_STA]; -+ int asoc_sta_count; -+ _queue sleep_q; -+ _queue wakeup_q; -+ -+ _adapter *padapter; -+ -+ -+#ifdef CONFIG_AP_MODE -+ _list asoc_list; -+ _list auth_list; -+ _lock asoc_list_lock; -+ _lock auth_list_lock; -+ u8 asoc_list_cnt; -+ u8 auth_list_cnt; -+ -+ unsigned int auth_to; //sec, time to expire in authenticating. -+ unsigned int assoc_to; //sec, time to expire before associating. -+ unsigned int expire_to; //sec , time to expire after associated. -+ -+ /* pointers to STA info; based on allocated AID or NULL if AID free -+ * AID is in the range 1-2007, so sta_aid[0] corresponders to AID 1 -+ * and so on -+ */ -+ struct sta_info *sta_aid[NUM_STA]; -+ -+ u16 sta_dz_bitmap;//only support 15 stations, staion aid bitmap for sleeping sta. -+ u16 tim_bitmap;//only support 15 stations, aid=0~15 mapping bit0~bit15 -+ -+ u16 max_num_sta; -+ -+ struct wlan_acl_pool acl_list; -+#endif -+ -+}; -+ -+ -+__inline static u32 wifi_mac_hash(u8 *mac) -+{ -+ u32 x; -+ -+ x = mac[0]; -+ x = (x << 2) ^ mac[1]; -+ x = (x << 2) ^ mac[2]; -+ x = (x << 2) ^ mac[3]; -+ x = (x << 2) ^ mac[4]; -+ x = (x << 2) ^ mac[5]; -+ -+ x ^= x >> 8; -+ x = x & (NUM_STA - 1); -+ -+ return x; -+} -+ -+ -+extern u32 _rtw_init_sta_priv(struct sta_priv *pstapriv); -+extern u32 _rtw_free_sta_priv(struct sta_priv *pstapriv); -+ -+#define stainfo_offset_valid(offset) (offset < NUM_STA && offset >= 0) -+int rtw_stainfo_offset(struct sta_priv *stapriv, struct sta_info *sta); -+struct sta_info *rtw_get_stainfo_by_offset(struct sta_priv *stapriv, int offset); -+ -+extern struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr); -+extern u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta); -+extern void rtw_free_all_stainfo(_adapter *padapter); -+extern struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr); -+extern u32 rtw_init_bcmc_stainfo(_adapter* padapter); -+extern struct sta_info* rtw_get_bcmc_stainfo(_adapter* padapter); -+extern u8 rtw_access_ctrl(_adapter *padapter, u8 *mac_addr); -+ -+#endif //_STA_INFO_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/usb_hal.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_hal.h ---- linux-4.14.17/3rdparty/rtl8812au/include/usb_hal.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_hal.h 2018-02-06 17:42:30.722967342 +0200 -@@ -0,0 +1,24 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __USB_HAL_H__ -+#define __USB_HAL_H__ -+ -+void rtw_set_hal_ops(_adapter *padapter); -+void rtl8812au_set_hal_ops(_adapter * padapter); -+#ifdef CONFIG_INTEL_PROXIM -+extern _adapter *rtw_usb_get_sw_pointer(void); -+#endif //CONFIG_INTEL_PROXIM -+ -+#endif //__USB_HAL_H__ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/usb_ops.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_ops.h ---- linux-4.14.17/3rdparty/rtl8812au/include/usb_ops.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_ops.h 2018-02-06 17:42:30.722967342 +0200 -@@ -0,0 +1,105 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __USB_OPS_H_ -+#define __USB_OPS_H_ -+ -+ -+#define REALTEK_USB_VENQT_READ 0xC0 -+#define REALTEK_USB_VENQT_WRITE 0x40 -+#define REALTEK_USB_VENQT_CMD_REQ 0x05 -+#define REALTEK_USB_VENQT_CMD_IDX 0x00 -+ -+enum{ -+ VENDOR_WRITE = 0x00, -+ VENDOR_READ = 0x01, -+}; -+#define ALIGNMENT_UNIT 16 -+#define MAX_VENDOR_REQ_CMD_SIZE 254 //8188cu SIE Support -+#define MAX_USB_IO_CTL_SIZE (MAX_VENDOR_REQ_CMD_SIZE +ALIGNMENT_UNIT) -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,12)) -+#define rtw_usb_control_msg(dev, pipe, request, requesttype, value, index, data, size, timeout_ms) \ -+ usb_control_msg((dev), (pipe), (request), (requesttype), (value), (index), (data), (size), (timeout_ms)) -+#define rtw_usb_bulk_msg(usb_dev, pipe, data, len, actual_length, timeout_ms) \ -+ usb_bulk_msg((usb_dev), (pipe), (data), (len), (actual_length), (timeout_ms)) -+#else -+#define rtw_usb_control_msg(dev, pipe, request, requesttype, value, index, data, size,timeout_ms) \ -+ usb_control_msg((dev), (pipe), (request), (requesttype), (value), (index), (data), (size), \ -+ ((timeout_ms) == 0) ||((timeout_ms)*HZ/1000>0)?((timeout_ms)*HZ/1000):1) -+#define rtw_usb_bulk_msg(usb_dev, pipe, data, len, actual_length, timeout_ms) \ -+ usb_bulk_msg((usb_dev), (pipe), (data), (len), (actual_length), \ -+ ((timeout_ms) == 0) ||((timeout_ms)*HZ/1000>0)?((timeout_ms)*HZ/1000):1) -+#endif -+#include -+ -+void rtl8812au_set_hw_type(_adapter *padapter); -+void rtl8812au_set_intf_ops(struct _io_ops *pops); -+ -+/* -+* Increase and check if the continual_urb_error of this @param dvobjprive is larger than MAX_CONTINUAL_URB_ERR -+* @return true: -+* @return false: -+*/ -+static inline int rtw_inc_and_chk_continual_urb_error(struct dvobj_priv *dvobj) -+{ -+ int ret = false; -+ int value; -+ if( (value=ATOMIC_INC_RETURN(&dvobj->continual_urb_error)) > MAX_CONTINUAL_URB_ERR) { -+ DBG_871X("[dvobj:%p][ERROR] continual_urb_error:%d > %d\n", dvobj, value, MAX_CONTINUAL_URB_ERR); -+ ret = true; -+ } else { -+ //DBG_871X("[dvobj:%p] continual_urb_error:%d\n", dvobj, value); -+ } -+ return ret; -+} -+ -+/* -+* Set the continual_urb_error of this @param dvobjprive to 0 -+*/ -+static inline void rtw_reset_continual_urb_error(struct dvobj_priv *dvobj) -+{ -+ ATOMIC_SET(&dvobj->continual_urb_error, 0); -+} -+ -+enum RTW_USB_SPEED { -+ RTW_USB_SPEED_UNKNOWN = 0, -+ RTW_USB_SPEED_1_1 = 1, -+ RTW_USB_SPEED_2 = 2, -+ RTW_USB_SPEED_3 = 3, -+}; -+ -+#define IS_FULL_SPEED_USB(Adapter) (adapter_to_dvobj(Adapter)->usb_speed == RTW_USB_SPEED_1_1) -+#define IS_HIGH_SPEED_USB(Adapter) (adapter_to_dvobj(Adapter)->usb_speed == RTW_USB_SPEED_2) -+#define IS_SUPER_SPEED_USB(Adapter) (adapter_to_dvobj(Adapter)->usb_speed == RTW_USB_SPEED_3) -+ -+#define USB_SUPER_SPEED_BULK_SIZE 1024 // usb 3.0 -+#define USB_HIGH_SPEED_BULK_SIZE 512 // usb 2.0 -+#define USB_FULL_SPEED_BULK_SIZE 64 // usb 1.1 -+ -+static inline u8 rtw_usb_bulk_size_boundary(_adapter * padapter,int buf_len) -+{ -+ u8 rst = true; -+ -+ if (IS_SUPER_SPEED_USB(padapter)) -+ rst = (0 == (buf_len) % USB_SUPER_SPEED_BULK_SIZE)?true:false; -+ if (IS_HIGH_SPEED_USB(padapter)) -+ rst = (0 == (buf_len) % USB_HIGH_SPEED_BULK_SIZE)?true:false; -+ else -+ rst = (0 == (buf_len) % USB_FULL_SPEED_BULK_SIZE)?true:false; -+ return rst; -+} -+ -+ -+#endif //__USB_OPS_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/usb_ops_linux.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_ops_linux.h ---- linux-4.14.17/3rdparty/rtl8812au/include/usb_ops_linux.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_ops_linux.h 2018-02-06 17:42:30.722967342 +0200 -@@ -0,0 +1,63 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __USB_OPS_LINUX_H__ -+#define __USB_OPS_LINUX_H__ -+ -+#define VENDOR_CMD_MAX_DATA_LEN 254 -+#define FW_START_ADDRESS 0x1000 -+ -+#define RTW_USB_CONTROL_MSG_TIMEOUT_TEST 10//ms -+#define RTW_USB_CONTROL_MSG_TIMEOUT 500//ms -+ -+#define RECV_BULK_IN_ADDR 0x80//assign by drv,not real address -+#define RECV_INT_IN_ADDR 0x81//assign by drv,not real address -+ -+ -+#if defined(CONFIG_VENDOR_REQ_RETRY) && defined(CONFIG_USB_VENDOR_REQ_MUTEX) -+/* vendor req retry should be in the situation when each vendor req is atomically submitted from others */ -+#define MAX_USBCTRL_VENDORREQ_TIMES 10 -+#else -+#define MAX_USBCTRL_VENDORREQ_TIMES 1 -+#endif -+ -+#define RTW_USB_BULKOUT_TIMEOUT 5000//ms -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)) || (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,18)) -+#define _usbctrl_vendorreq_async_callback(urb, regs) _usbctrl_vendorreq_async_callback(urb) -+#define usb_bulkout_zero_complete(purb, regs) usb_bulkout_zero_complete(purb) -+#define usb_write_mem_complete(purb, regs) usb_write_mem_complete(purb) -+#define usb_write_port_complete(purb, regs) usb_write_port_complete(purb) -+#define usb_read_port_complete(purb, regs) usb_read_port_complete(purb) -+#define usb_read_interrupt_complete(purb, regs) usb_read_interrupt_complete(purb) -+#endif -+ -+#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ -+int usb_async_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val); -+int usb_async_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val); -+int usb_async_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val); -+#endif /* CONFIG_USB_SUPPORT_ASYNC_VDN_REQ */ -+ -+unsigned int ffaddr2pipehdl(struct dvobj_priv *pdvobj, u32 addr); -+ -+void usb_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem); -+void usb_write_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem); -+ -+void usb_read_port_cancel(struct intf_hdl *pintfhdl); -+ -+u32 usb_write_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem); -+void usb_write_port_cancel(struct intf_hdl *pintfhdl); -+ -+int usbctrl_vendorreq(struct intf_hdl *pintfhdl, u8 request, u16 value, u16 index, void *pdata, u16 len, u8 requesttype); -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/usb_osintf.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_osintf.h ---- linux-4.14.17/3rdparty/rtl8812au/include/usb_osintf.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_osintf.h 2018-02-06 17:42:30.722967342 +0200 -@@ -0,0 +1,29 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __USB_OSINTF_H -+#define __USB_OSINTF_H -+ -+#include -+ -+#define USBD_HALTED(Status) ((u32)(Status) >> 30 == 3) -+ -+ -+//uint usb_dvobj_init(_adapter * adapter); -+//void usb_dvobj_deinit(_adapter * adapter); -+ -+u8 usbvendorrequest(struct dvobj_priv *pdvobjpriv, RT_USB_BREQUEST brequest, RT_USB_WVALUE wvalue, u8 windex, void* data, u8 datalen, u8 isdirectionin); -+ -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/usb_vendor_req.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_vendor_req.h ---- linux-4.14.17/3rdparty/rtl8812au/include/usb_vendor_req.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/usb_vendor_req.h 2018-02-06 17:42:30.722967342 +0200 -@@ -0,0 +1,54 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _USB_VENDOR_REQUEST_H_ -+#define _USB_VENDOR_REQUEST_H_ -+ -+//4 Set/Get Register related wIndex/Data -+#define RT_USB_RESET_MASK_OFF 0 -+#define RT_USB_RESET_MASK_ON 1 -+#define RT_USB_SLEEP_MASK_OFF 0 -+#define RT_USB_SLEEP_MASK_ON 1 -+#define RT_USB_LDO_ON 1 -+#define RT_USB_LDO_OFF 0 -+ -+//4 Set/Get SYSCLK related wValue or Data -+#define RT_USB_SYSCLK_32KHZ 0 -+#define RT_USB_SYSCLK_40MHZ 1 -+#define RT_USB_SYSCLK_60MHZ 2 -+ -+ -+typedef enum _RT_USB_BREQUEST { -+ RT_USB_SET_REGISTER = 1, -+ RT_USB_SET_SYSCLK = 2, -+ RT_USB_GET_SYSCLK = 3, -+ RT_USB_GET_REGISTER = 4 -+} RT_USB_BREQUEST; -+ -+ -+typedef enum _RT_USB_WVALUE { -+ RT_USB_RESET_MASK = 1, -+ RT_USB_SLEEP_MASK = 2, -+ RT_USB_USB_HRCPWM = 3, -+ RT_USB_LDO = 4, -+ RT_USB_BOOT_TYPE = 5 -+} RT_USB_WVALUE; -+ -+ -+//bool usbvendorrequest(PCE_USB_DEVICE CEdevice, RT_USB_BREQUEST bRequest, RT_USB_WVALUE wValue, u8 wIndex, void * Data, u8 DataLength, bool isDirectionIn); -+//bool CEusbGetStatusRequest(PCE_USB_DEVICE CEdevice, u16 Op, u16 Index, void * Data); -+//bool CEusbFeatureRequest(PCE_USB_DEVICE CEdevice, u16 Op, u16 FeatureSelector, u16 Index); -+//bool CEusbGetDescriptorRequest(PCE_USB_DEVICE CEdevice, short urbLength, u8 DescriptorType, u8 Index, u16 LanguageId, void * TransferBuffer, u32 TransferBufferLength); -+ -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/wifi.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/wifi.h ---- linux-4.14.17/3rdparty/rtl8812au/include/wifi.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/wifi.h 2018-02-06 17:42:30.722967342 +0200 -@@ -0,0 +1,1214 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef _WIFI_H_ -+#define _WIFI_H_ -+ -+ -+#ifdef BIT -+//#error "BIT define occurred earlier elsewhere!\n" -+#undef BIT -+#endif -+#define BIT(x) (1 << (x)) -+ -+ -+#define WLAN_ETHHDR_LEN 14 -+#define WLAN_ETHADDR_LEN 6 -+#define WLAN_IEEE_OUI_LEN 3 -+#define WLAN_ADDR_LEN 6 -+#define WLAN_CRC_LEN 4 -+#define WLAN_BSSID_LEN 6 -+#define WLAN_BSS_TS_LEN 8 -+#define WLAN_HDR_A3_LEN 24 -+#define WLAN_HDR_A4_LEN 30 -+#define WLAN_HDR_A3_QOS_LEN 26 -+#define WLAN_HDR_A4_QOS_LEN 32 -+#define WLAN_SSID_MAXLEN 32 -+#define WLAN_DATA_MAXLEN 2312 -+ -+#define WLAN_A3_PN_OFFSET 24 -+#define WLAN_A4_PN_OFFSET 30 -+ -+#define WLAN_MIN_ETHFRM_LEN 60 -+#define WLAN_MAX_ETHFRM_LEN 1514 -+#define WLAN_ETHHDR_LEN 14 -+ -+#define P80211CAPTURE_VERSION 0x80211001 -+ -+// This value is tested by WiFi 11n Test Plan 5.2.3. -+// This test verifies the WLAN NIC can update the NAV through sending the CTS with large duration. -+#define WiFiNavUpperUs 30000 // 30 ms -+ -+#ifdef GREEN_HILL -+#pragma pack(1) -+#endif -+ -+enum WIFI_FRAME_TYPE { -+ WIFI_MGT_TYPE = (0), -+ WIFI_CTRL_TYPE = (BIT(2)), -+ WIFI_DATA_TYPE = (BIT(3)), -+ WIFI_QOS_DATA_TYPE = (BIT(7)|BIT(3)), //!< QoS Data -+}; -+ -+enum WIFI_FRAME_SUBTYPE { -+ -+ // below is for mgt frame -+ WIFI_ASSOCREQ = (0 | WIFI_MGT_TYPE), -+ WIFI_ASSOCRSP = (BIT(4) | WIFI_MGT_TYPE), -+ WIFI_REASSOCREQ = (BIT(5) | WIFI_MGT_TYPE), -+ WIFI_REASSOCRSP = (BIT(5) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_PROBEREQ = (BIT(6) | WIFI_MGT_TYPE), -+ WIFI_PROBERSP = (BIT(6) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_BEACON = (BIT(7) | WIFI_MGT_TYPE), -+ WIFI_ATIM = (BIT(7) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_DISASSOC = (BIT(7) | BIT(5) | WIFI_MGT_TYPE), -+ WIFI_AUTH = (BIT(7) | BIT(5) | BIT(4) | WIFI_MGT_TYPE), -+ WIFI_DEAUTH = (BIT(7) | BIT(6) | WIFI_MGT_TYPE), -+ WIFI_ACTION = (BIT(7) | BIT(6) | BIT(4) | WIFI_MGT_TYPE), -+ -+ // below is for control frame -+ WIFI_PSPOLL = (BIT(7) | BIT(5) | WIFI_CTRL_TYPE), -+ WIFI_RTS = (BIT(7) | BIT(5) | BIT(4) | WIFI_CTRL_TYPE), -+ WIFI_CTS = (BIT(7) | BIT(6) | WIFI_CTRL_TYPE), -+ WIFI_ACK = (BIT(7) | BIT(6) | BIT(4) | WIFI_CTRL_TYPE), -+ WIFI_CFEND = (BIT(7) | BIT(6) | BIT(5) | WIFI_CTRL_TYPE), -+ WIFI_CFEND_CFACK = (BIT(7) | BIT(6) | BIT(5) | BIT(4) | WIFI_CTRL_TYPE), -+ -+ // below is for data frame -+ WIFI_DATA = (0 | WIFI_DATA_TYPE), -+ WIFI_DATA_CFACK = (BIT(4) | WIFI_DATA_TYPE), -+ WIFI_DATA_CFPOLL = (BIT(5) | WIFI_DATA_TYPE), -+ WIFI_DATA_CFACKPOLL = (BIT(5) | BIT(4) | WIFI_DATA_TYPE), -+ WIFI_DATA_NULL = (BIT(6) | WIFI_DATA_TYPE), -+ WIFI_CF_ACK = (BIT(6) | BIT(4) | WIFI_DATA_TYPE), -+ WIFI_CF_POLL = (BIT(6) | BIT(5) | WIFI_DATA_TYPE), -+ WIFI_CF_ACKPOLL = (BIT(6) | BIT(5) | BIT(4) | WIFI_DATA_TYPE), -+ WIFI_QOS_DATA_NULL = (BIT(6) | WIFI_QOS_DATA_TYPE), -+}; -+ -+enum WIFI_REASON_CODE { -+ _RSON_RESERVED_ = 0, -+ _RSON_UNSPECIFIED_ = 1, -+ _RSON_AUTH_NO_LONGER_VALID_ = 2, -+ _RSON_DEAUTH_STA_LEAVING_ = 3, -+ _RSON_INACTIVITY_ = 4, -+ _RSON_UNABLE_HANDLE_ = 5, -+ _RSON_CLS2_ = 6, -+ _RSON_CLS3_ = 7, -+ _RSON_DISAOC_STA_LEAVING_ = 8, -+ _RSON_ASOC_NOT_AUTH_ = 9, -+ -+ // WPA reason -+ _RSON_INVALID_IE_ = 13, -+ _RSON_MIC_FAILURE_ = 14, -+ _RSON_4WAY_HNDSHK_TIMEOUT_ = 15, -+ _RSON_GROUP_KEY_UPDATE_TIMEOUT_ = 16, -+ _RSON_DIFF_IE_ = 17, -+ _RSON_MLTCST_CIPHER_NOT_VALID_ = 18, -+ _RSON_UNICST_CIPHER_NOT_VALID_ = 19, -+ _RSON_AKMP_NOT_VALID_ = 20, -+ _RSON_UNSUPPORT_RSNE_VER_ = 21, -+ _RSON_INVALID_RSNE_CAP_ = 22, -+ _RSON_IEEE_802DOT1X_AUTH_FAIL_ = 23, -+ -+ //belowing are Realtek definition -+ _RSON_PMK_NOT_AVAILABLE_ = 24, -+ _RSON_TDLS_TEAR_TOOFAR_ = 25, -+ _RSON_TDLS_TEAR_UN_RSN_ = 26, -+}; -+ -+/* Reason codes (IEEE 802.11-2007, 7.3.1.7, Table 7-22) */ -+#if 0 -+#define WLAN_REASON_UNSPECIFIED 1 -+#define WLAN_REASON_PREV_AUTH_NOT_VALID 2 -+#define WLAN_REASON_DEAUTH_LEAVING 3 -+#define WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY 4 -+#define WLAN_REASON_DISASSOC_AP_BUSY 5 -+#define WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA 6 -+#define WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA 7 -+#define WLAN_REASON_DISASSOC_STA_HAS_LEFT 8 -+#define WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH 9 -+#endif -+/* IEEE 802.11h */ -+#define WLAN_REASON_PWR_CAPABILITY_NOT_VALID 10 -+#define WLAN_REASON_SUPPORTED_CHANNEL_NOT_VALID 11 -+#if 0 -+/* IEEE 802.11i */ -+#define WLAN_REASON_INVALID_IE 13 -+#define WLAN_REASON_MICHAEL_MIC_FAILURE 14 -+#define WLAN_REASON_4WAY_HANDSHAKE_TIMEOUT 15 -+#define WLAN_REASON_GROUP_KEY_UPDATE_TIMEOUT 16 -+#define WLAN_REASON_IE_IN_4WAY_DIFFERS 17 -+#define WLAN_REASON_GROUP_CIPHER_NOT_VALID 18 -+#define WLAN_REASON_PAIRWISE_CIPHER_NOT_VALID 19 -+#define WLAN_REASON_AKMP_NOT_VALID 20 -+#define WLAN_REASON_UNSUPPORTED_RSN_IE_VERSION 21 -+#define WLAN_REASON_INVALID_RSN_IE_CAPAB 22 -+#define WLAN_REASON_IEEE_802_1X_AUTH_FAILED 23 -+#define WLAN_REASON_CIPHER_SUITE_REJECTED 24 -+#endif -+ -+enum WIFI_STATUS_CODE { -+ _STATS_SUCCESSFUL_ = 0, -+ _STATS_FAILURE_ = 1, -+ _STATS_CAP_FAIL_ = 10, -+ _STATS_NO_ASOC_ = 11, -+ _STATS_OTHER_ = 12, -+ _STATS_NO_SUPP_ALG_ = 13, -+ _STATS_OUT_OF_AUTH_SEQ_ = 14, -+ _STATS_CHALLENGE_FAIL_ = 15, -+ _STATS_AUTH_TIMEOUT_ = 16, -+ _STATS_UNABLE_HANDLE_STA_ = 17, -+ _STATS_RATE_FAIL_ = 18, -+}; -+ -+/* Status codes (IEEE 802.11-2007, 7.3.1.9, Table 7-23) */ -+#if 0 -+#define WLAN_STATUS_SUCCESS 0 -+#define WLAN_STATUS_UNSPECIFIED_FAILURE 1 -+#define WLAN_STATUS_CAPS_UNSUPPORTED 10 -+#define WLAN_STATUS_REASSOC_NO_ASSOC 11 -+#define WLAN_STATUS_ASSOC_DENIED_UNSPEC 12 -+#define WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG 13 -+#define WLAN_STATUS_UNKNOWN_AUTH_TRANSACTION 14 -+#define WLAN_STATUS_CHALLENGE_FAIL 15 -+#define WLAN_STATUS_AUTH_TIMEOUT 16 -+#define WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA 17 -+#define WLAN_STATUS_ASSOC_DENIED_RATES 18 -+#endif -+//entended -+/* IEEE 802.11b */ -+#define WLAN_STATUS_ASSOC_DENIED_NOSHORT 19 -+#define WLAN_STATUS_ASSOC_DENIED_NOPBCC 20 -+#define WLAN_STATUS_ASSOC_DENIED_NOAGILITY 21 -+/* IEEE 802.11h */ -+#define WLAN_STATUS_SPEC_MGMT_REQUIRED 22 -+#define WLAN_STATUS_PWR_CAPABILITY_NOT_VALID 23 -+#define WLAN_STATUS_SUPPORTED_CHANNEL_NOT_VALID 24 -+/* IEEE 802.11g */ -+#define WLAN_STATUS_ASSOC_DENIED_NO_SHORT_SLOT_TIME 25 -+#define WLAN_STATUS_ASSOC_DENIED_NO_ER_PBCC 26 -+#define WLAN_STATUS_ASSOC_DENIED_NO_DSSS_OFDM 27 -+/* IEEE 802.11w */ -+#define WLAN_STATUS_ASSOC_REJECTED_TEMPORARILY 30 -+#define WLAN_STATUS_ROBUST_MGMT_FRAME_POLICY_VIOLATION 31 -+/* IEEE 802.11i */ -+#define WLAN_STATUS_INVALID_IE 40 -+#define WLAN_STATUS_GROUP_CIPHER_NOT_VALID 41 -+#define WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID 42 -+#define WLAN_STATUS_AKMP_NOT_VALID 43 -+#define WLAN_STATUS_UNSUPPORTED_RSN_IE_VERSION 44 -+#define WLAN_STATUS_INVALID_RSN_IE_CAPAB 45 -+#define WLAN_STATUS_CIPHER_REJECTED_PER_POLICY 46 -+#define WLAN_STATUS_TS_NOT_CREATED 47 -+#define WLAN_STATUS_DIRECT_LINK_NOT_ALLOWED 48 -+#define WLAN_STATUS_DEST_STA_NOT_PRESENT 49 -+#define WLAN_STATUS_DEST_STA_NOT_QOS_STA 50 -+#define WLAN_STATUS_ASSOC_DENIED_LISTEN_INT_TOO_LARGE 51 -+/* IEEE 802.11r */ -+#define WLAN_STATUS_INVALID_FT_ACTION_FRAME_COUNT 52 -+#define WLAN_STATUS_INVALID_PMKID 53 -+#define WLAN_STATUS_INVALID_MDIE 54 -+#define WLAN_STATUS_INVALID_FTIE 55 -+ -+ -+enum WIFI_REG_DOMAIN { -+ DOMAIN_FCC = 1, -+ DOMAIN_IC = 2, -+ DOMAIN_ETSI = 3, -+ DOMAIN_SPAIN = 4, -+ DOMAIN_FRANCE = 5, -+ DOMAIN_MKK = 6, -+ DOMAIN_ISRAEL = 7, -+ DOMAIN_MKK1 = 8, -+ DOMAIN_MKK2 = 9, -+ DOMAIN_MKK3 = 10, -+ DOMAIN_MAX -+}; -+ -+#define _TO_DS_ BIT(8) -+#define _FROM_DS_ BIT(9) -+#define _MORE_FRAG_ BIT(10) -+#define _RETRY_ BIT(11) -+#define _PWRMGT_ BIT(12) -+#define _MORE_DATA_ BIT(13) -+#define _PRIVACY_ BIT(14) -+#define _ORDER_ BIT(15) -+ -+#define SetToDs(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_TO_DS_) -+ -+#define GetToDs(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_TO_DS_)) != 0) -+ -+#define ClearToDs(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_TO_DS_)) -+ -+#define SetFrDs(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_FROM_DS_) -+ -+#define GetFrDs(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_FROM_DS_)) != 0) -+ -+#define ClearFrDs(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_FROM_DS_)) -+ -+#define get_tofr_ds(pframe) ((GetToDs(pframe) << 1) | GetFrDs(pframe)) -+ -+ -+#define SetMFrag(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_MORE_FRAG_) -+ -+#define GetMFrag(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_MORE_FRAG_)) != 0) -+ -+#define ClearMFrag(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_MORE_FRAG_)) -+ -+#define SetRetry(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_RETRY_) -+ -+#define GetRetry(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_RETRY_)) != 0) -+ -+#define ClearRetry(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_RETRY_)) -+ -+#define SetPwrMgt(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_PWRMGT_) -+ -+#define GetPwrMgt(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_PWRMGT_)) != 0) -+ -+#define ClearPwrMgt(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_PWRMGT_)) -+ -+#define SetMData(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_MORE_DATA_) -+ -+#define GetMData(pbuf) (((*(__le16 *)(pbuf)) & cpu_to_le16(_MORE_DATA_)) != 0) -+ -+#define ClearMData(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_MORE_DATA_)) -+ -+#define SetPrivacy(pbuf) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(_PRIVACY_) -+ -+#define GetPrivacy(pbuf) \ -+ (((*(__le16 *)(pbuf)) & cpu_to_le16(_PRIVACY_)) != 0) -+ -+#define ClearPrivacy(pbuf) \ -+ *(__le16 *)(pbuf) &= (~cpu_to_le16(_PRIVACY_)) -+ -+ -+#define GetOrder(pbuf) \ -+ (((*(__le16 *)(pbuf)) & cpu_to_le16(_ORDER_)) != 0) -+ -+#define GetFrameType(pbuf) \ -+ (le16_to_cpu(*(__le16 *)(pbuf)) & (BIT(3) | BIT(2))) -+ -+#define SetFrameType(pbuf, type) \ -+ do { \ -+ *(unsigned short *)(pbuf) &= __constant_cpu_to_le16(~(BIT(3) | BIT(2))); \ -+ *(unsigned short *)(pbuf) |= __constant_cpu_to_le16(type); \ -+ } while (0) -+ -+#define GetFrameSubType(pbuf) (le16_to_cpu(*(__le16 *)(pbuf)) & (BIT(7) |\ -+ BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))) -+ -+#define SetFrameSubType(pbuf, type) \ -+ do { \ -+ *(__le16 *)(pbuf) &= cpu_to_le16(~(BIT(7) | BIT(6) | \ -+ BIT(5) | BIT(4) | BIT(3) | BIT(2))); \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(type); \ -+ } while (0) -+ -+#define GetSequence(pbuf) \ -+ (le16_to_cpu(*(__le16 *)((size_t)(pbuf) + 22)) >> 4) -+ -+#define GetFragNum(pbuf) \ -+ (le16_to_cpu(*(__le16 *)((size_t)(pbuf) + 22)) & 0x0f) -+ -+#define GetTupleCache(pbuf) \ -+ (cpu_to_le16(*(unsigned short *)((size_t)(pbuf) + 22))) -+ -+#define SetFragNum(pbuf, num) \ -+ do { \ -+ *(unsigned short *)((size_t)(pbuf) + 22) = \ -+ ((*(unsigned short *)((size_t)(pbuf) + 22)) & \ -+ le16_to_cpu(~(0x000f))) | \ -+ cpu_to_le16(0x0f & (num)); \ -+ } while (0) -+ -+#define SetSeqNum(pbuf, num) \ -+ do { \ -+ *(__le16 *)((size_t)(pbuf) + 22) = \ -+ ((*(__le16 *)((size_t)(pbuf) + 22)) & cpu_to_le16((unsigned short)0x000f)) | \ -+ cpu_to_le16((unsigned short)(0xfff0 & (num << 4))); \ -+ } while (0) -+ -+#define SetDuration(pbuf, dur) \ -+ *(__le16 *)((size_t)(pbuf) + 2) = cpu_to_le16(0xffff & (dur)) -+ -+ -+#define SetPriority(pbuf, tid) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16(tid & 0xf) -+ -+#define GetPriority(pbuf) ((le16_to_cpu(*(__le16 *)(pbuf))) & 0xf) -+ -+#define SetEOSP(pbuf, eosp) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16((eosp & 1) << 4) -+ -+#define SetAckpolicy(pbuf, ack) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16((ack & 3) << 5) -+ -+#define GetAckpolicy(pbuf) (((le16_to_cpu(*(__le16 *)pbuf)) >> 5) & 0x3) -+ -+#define GetAMsdu(pbuf) (((le16_to_cpu(*(__le16 *)pbuf)) >> 7) & 0x1) -+ -+#define SetAMsdu(pbuf, amsdu) \ -+ *(__le16 *)(pbuf) |= cpu_to_le16((amsdu & 1) << 7) -+ -+#define GetAid(pbuf) (le16_to_cpu(*(__le16 *)((size_t)(pbuf) + 2)) & 0x3fff) -+ -+#define GetTid(pbuf) (le16_to_cpu(*(__le16 *)((size_t)(pbuf) + \ -+ (((GetToDs(pbuf)<<1) | GetFrDs(pbuf)) == 3 ? \ -+ 30 : 24))) & 0x000f) -+ -+#define GetAddr1Ptr(pbuf) ((unsigned char *)((size_t)(pbuf) + 4)) -+ -+#define GetAddr2Ptr(pbuf) ((unsigned char *)((size_t)(pbuf) + 10)) -+ -+#define GetAddr3Ptr(pbuf) ((unsigned char *)((size_t)(pbuf) + 16)) -+ -+#define GetAddr4Ptr(pbuf) ((unsigned char *)((size_t)(pbuf) + 24)) -+ -+#define MacAddr_isBcst(addr) \ -+( \ -+ ( (addr[0] == 0xff) && (addr[1] == 0xff) && \ -+ (addr[2] == 0xff) && (addr[3] == 0xff) && \ -+ (addr[4] == 0xff) && (addr[5] == 0xff) ) ? true : false \ -+) -+ -+__inline static int IS_MCAST(unsigned char *da) -+{ -+ if ((*da) & 0x01) -+ return true; -+ else -+ return false; -+} -+ -+ -+__inline static unsigned char * get_da(unsigned char *pframe) -+{ -+ unsigned char *da; -+ unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); -+ -+ switch (to_fr_ds) { -+ case 0x00: // ToDs=0, FromDs=0 -+ da = GetAddr1Ptr(pframe); -+ break; -+ case 0x01: // ToDs=0, FromDs=1 -+ da = GetAddr1Ptr(pframe); -+ break; -+ case 0x02: // ToDs=1, FromDs=0 -+ da = GetAddr3Ptr(pframe); -+ break; -+ default: // ToDs=1, FromDs=1 -+ da = GetAddr3Ptr(pframe); -+ break; -+ } -+ -+ return da; -+} -+ -+ -+__inline static unsigned char * get_sa(unsigned char *pframe) -+{ -+ unsigned char *sa; -+ unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); -+ -+ switch (to_fr_ds) { -+ case 0x00: // ToDs=0, FromDs=0 -+ sa = GetAddr2Ptr(pframe); -+ break; -+ case 0x01: // ToDs=0, FromDs=1 -+ sa = GetAddr3Ptr(pframe); -+ break; -+ case 0x02: // ToDs=1, FromDs=0 -+ sa = GetAddr2Ptr(pframe); -+ break; -+ default: // ToDs=1, FromDs=1 -+ sa = GetAddr4Ptr(pframe); -+ break; -+ } -+ -+ return sa; -+} -+ -+__inline static unsigned char * get_hdr_bssid(unsigned char *pframe) -+{ -+ unsigned char *sa; -+ unsigned int to_fr_ds = (GetToDs(pframe) << 1) | GetFrDs(pframe); -+ -+ switch (to_fr_ds) { -+ case 0x00: // ToDs=0, FromDs=0 -+ sa = GetAddr3Ptr(pframe); -+ break; -+ case 0x01: // ToDs=0, FromDs=1 -+ sa = GetAddr2Ptr(pframe); -+ break; -+ case 0x02: // ToDs=1, FromDs=0 -+ sa = GetAddr1Ptr(pframe); -+ break; -+ case 0x03: // ToDs=1, FromDs=1 -+ sa = GetAddr1Ptr(pframe); -+ break; -+ default: -+ sa =NULL; //??????? -+ break; -+ } -+ -+ return sa; -+} -+ -+ -+__inline static int IsFrameTypeCtrl(unsigned char *pframe) -+{ -+ if(WIFI_CTRL_TYPE == GetFrameType(pframe)) -+ return true; -+ else -+ return false; -+} -+/*----------------------------------------------------------------------------- -+ Below is for the security related definition -+------------------------------------------------------------------------------*/ -+#define _RESERVED_FRAME_TYPE_ 0 -+#define _SKB_FRAME_TYPE_ 2 -+#define _PRE_ALLOCMEM_ 1 -+#define _PRE_ALLOCHDR_ 3 -+#define _PRE_ALLOCLLCHDR_ 4 -+#define _PRE_ALLOCICVHDR_ 5 -+#define _PRE_ALLOCMICHDR_ 6 -+ -+#define _SIFSTIME_ ((priv->pmib->dot11BssType.net_work_type&WIRELESS_11A)?16:10) -+#define _ACKCTSLNG_ 14 //14 bytes long, including crclng -+#define _CRCLNG_ 4 -+ -+#define _ASOCREQ_IE_OFFSET_ 4 // excluding wlan_hdr -+#define _ASOCRSP_IE_OFFSET_ 6 -+#define _REASOCREQ_IE_OFFSET_ 10 -+#define _REASOCRSP_IE_OFFSET_ 6 -+#define _PROBEREQ_IE_OFFSET_ 0 -+#define _PROBERSP_IE_OFFSET_ 12 -+#define _AUTH_IE_OFFSET_ 6 -+#define _DEAUTH_IE_OFFSET_ 0 -+#define _BEACON_IE_OFFSET_ 12 -+#define _PUBLIC_ACTION_IE_OFFSET_ 8 -+ -+#define _FIXED_IE_LENGTH_ _BEACON_IE_OFFSET_ -+ -+#define _SSID_IE_ 0 -+#define _SUPPORTEDRATES_IE_ 1 -+#define _DSSET_IE_ 3 -+#define _TIM_IE_ 5 -+#define _IBSS_PARA_IE_ 6 -+#define _COUNTRY_IE_ 7 -+#define _CHLGETXT_IE_ 16 -+#define _SUPPORTED_CH_IE_ 36 -+#define _CH_SWTICH_ANNOUNCE_ 37 //Secondary Channel Offset -+#define _RSN_IE_2_ 48 -+#define _SSN_IE_1_ 221 -+#define _ERPINFO_IE_ 42 -+#define _EXT_SUPPORTEDRATES_IE_ 50 -+ -+#define _HT_CAPABILITY_IE_ 45 -+#define _FTIE_ 55 -+#define _TIMEOUT_ITVL_IE_ 56 -+#define _SRC_IE_ 59 -+#define _HT_EXTRA_INFO_IE_ 61 -+#define _HT_ADD_INFO_IE_ 61 //_HT_EXTRA_INFO_IE_ -+#define _WAPI_IE_ 68 -+ -+ -+//#define EID_BSSCoexistence 72 // 20/40 BSS Coexistence -+//#define EID_BSSIntolerantChlReport 73 -+#define _RIC_Descriptor_IE_ 75 -+ -+#define _LINK_ID_IE_ 101 -+#define _CH_SWITCH_TIMING_ 104 -+#define _PTI_BUFFER_STATUS_ 106 -+#define _EXT_CAP_IE_ 127 -+#define _VENDOR_SPECIFIC_IE_ 221 -+ -+#define _RESERVED47_ 47 -+ -+typedef enum _ELEMENT_ID{ -+ EID_SsId = 0, /* service set identifier (0:32) */ -+ EID_SupRates = 1, /* supported rates (1:8) */ -+ EID_FHParms = 2, /* FH parameter set (5) */ -+ EID_DSParms = 3, /* DS parameter set (1) */ -+ EID_CFParms = 4, /* CF parameter set (6) */ -+ EID_Tim = 5, /* Traffic Information Map (4:254) */ -+ EID_IbssParms = 6, /* IBSS parameter set (2) */ -+ EID_Country = 7, /* */ -+ -+ // Form 7.3.2: Information elements in 802.11E/D13.0, page 46. -+ EID_QBSSLoad = 11, -+ EID_EDCAParms = 12, -+ EID_TSpec = 13, -+ EID_TClass = 14, -+ EID_Schedule = 15, -+ // -+ -+ EID_Ctext = 16, /* challenge text*/ -+ EID_POWER_CONSTRAINT = 32, /* Power Constraint*/ -+ -+ //vivi for WIFITest, 802.11h AP, 20100427 -+ // 2010/12/26 MH The definition we can declare always!! -+ EID_PowerCap = 33, -+ EID_SupportedChannels = 36, -+ EID_ChlSwitchAnnounce = 37, -+ -+ EID_MeasureRequest = 38, // Measurement Request -+ EID_MeasureReport = 39, // Measurement Report -+ -+ EID_ERPInfo = 42, -+ -+ // Form 7.3.2: Information elements in 802.11E/D13.0, page 46. -+ EID_TSDelay = 43, -+ EID_TCLASProc = 44, -+ EID_HTCapability = 45, -+ EID_QoSCap = 46, -+ // -+ -+ EID_WPA2 = 48, -+ EID_ExtSupRates = 50, -+ -+ EID_FTIE = 55, // Defined in 802.11r -+ EID_Timeout = 56, // Defined in 802.11r -+ -+ EID_SupRegulatory = 59, // Supported Requlatory Classes 802.11y -+ EID_HTInfo = 61, -+ EID_SecondaryChnlOffset = 62, -+ -+ EID_BSSCoexistence = 72, // 20/40 BSS Coexistence -+ EID_BSSIntolerantChlReport = 73, -+ EID_OBSS = 74, // Overlapping BSS Scan Parameters -+ -+ EID_LinkIdentifier = 101, // Defined in 802.11z -+ EID_WakeupSchedule = 102, // Defined in 802.11z -+ EID_ChnlSwitchTimeing = 104, // Defined in 802.11z -+ EID_PTIControl = 105, // Defined in 802.11z -+ EID_PUBufferStatus = 106, // Defined in 802.11z -+ -+ EID_EXTCapability = 127, // Extended Capabilities -+ // From S19:Aironet IE and S21:AP IP address IE in CCX v1.13, p16 and p18. -+ EID_Aironet = 133, // 0x85: Aironet Element for Cisco CCX -+ EID_CiscoIP = 149, // 0x95: IP Address IE for Cisco CCX -+ -+ EID_CellPwr = 150, // 0x96: Cell Power Limit IE. Ref. 0x96. -+ -+ EID_CCKM = 156, -+ -+ EID_Vendor = 221, // 0xDD: Vendor Specific -+ -+ EID_WAPI = 68, -+ EID_VHTCapability = 191, // Based on 802.11ac D2.0 -+ EID_VHTOperation = 192, // Based on 802.11ac D2.0 -+ EID_OpModeNotification = 199, // Based on 802.11ac D3.0 -+}ELEMENT_ID, *PELEMENT_ID; -+ -+/* --------------------------------------------------------------------------- -+ Below is the fixed elements... -+-----------------------------------------------------------------------------*/ -+#define _AUTH_ALGM_NUM_ 2 -+#define _AUTH_SEQ_NUM_ 2 -+#define _BEACON_ITERVAL_ 2 -+#define _CAPABILITY_ 2 -+#define _CURRENT_APADDR_ 6 -+#define _LISTEN_INTERVAL_ 2 -+#define _RSON_CODE_ 2 -+#define _ASOC_ID_ 2 -+#define _STATUS_CODE_ 2 -+#define _TIMESTAMP_ 8 -+ -+#define AUTH_ODD_TO 0 -+#define AUTH_EVEN_TO 1 -+ -+#define WLAN_ETHCONV_ENCAP 1 -+#define WLAN_ETHCONV_RFC1042 2 -+#define WLAN_ETHCONV_8021h 3 -+ -+#define cap_ESS BIT(0) -+#define cap_IBSS BIT(1) -+#define cap_CFPollable BIT(2) -+#define cap_CFRequest BIT(3) -+#define cap_Privacy BIT(4) -+#define cap_ShortPremble BIT(5) -+#define cap_PBCC BIT(6) -+#define cap_ChAgility BIT(7) -+#define cap_SpecMgmt BIT(8) -+#define cap_QoS BIT(9) -+#define cap_ShortSlot BIT(10) -+ -+/*----------------------------------------------------------------------------- -+ Below is the definition for 802.11i / 802.1x -+------------------------------------------------------------------------------*/ -+#define _IEEE8021X_MGT_ 1 // WPA -+#define _IEEE8021X_PSK_ 2 // WPA with pre-shared key -+ -+/* -+#define _NO_PRIVACY_ 0 -+#define _WEP_40_PRIVACY_ 1 -+#define _TKIP_PRIVACY_ 2 -+#define _WRAP_PRIVACY_ 3 -+#define _CCMP_PRIVACY_ 4 -+#define _WEP_104_PRIVACY_ 5 -+#define _WEP_WPA_MIXED_PRIVACY_ 6 // WEP + WPA -+*/ -+ -+/*----------------------------------------------------------------------------- -+ Below is the definition for WMM -+------------------------------------------------------------------------------*/ -+#define _WMM_IE_Length_ 7 // for WMM STA -+#define _WMM_Para_Element_Length_ 24 -+ -+ -+/*----------------------------------------------------------------------------- -+ Below is the definition for 802.11n -+------------------------------------------------------------------------------*/ -+ -+//#ifdef CONFIG_80211N_HT -+ -+#define SetOrderBit(pbuf) \ -+ do { \ -+ *(unsigned short *)(pbuf) |= cpu_to_le16(_ORDER_); \ -+ } while(0) -+ -+#define GetOrderBit(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_ORDER_)) != 0) -+ -+ -+/** -+ * struct rtw_ieee80211_bar - HT Block Ack Request -+ * -+ * This structure refers to "HT BlockAckReq" as -+ * described in 802.11n draft section 7.2.1.7.1 -+ */ -+struct rtw_ieee80211_bar { -+ __le16 frame_control; -+ __le16 duration; -+ unsigned char ra[6]; -+ unsigned char ta[6]; -+ __le16 control; -+ __le16 start_seq_num; -+} __attribute__((packed)); -+ -+/* 802.11 BAR control masks */ -+#define IEEE80211_BAR_CTRL_ACK_POLICY_NORMAL 0x0000 -+#define IEEE80211_BAR_CTRL_CBMTID_COMPRESSED_BA 0x0004 -+ -+ /** -+ * struct rtw_ieee80211_ht_cap - HT capabilities -+ * -+ * This structure refers to "HT capabilities element" as -+ * described in 802.11n draft section 7.3.2.52 -+ */ -+ -+struct rtw_ieee80211_ht_cap { -+ __le16 cap_info; -+ unsigned char ampdu_params_info; -+ unsigned char supp_mcs_set[16]; -+ __le16 extended_ht_cap_info; -+ __le16 tx_BF_cap_info; -+ unsigned char antenna_selection_info; -+} __attribute__ ((packed)); -+ -+/** -+ * struct rtw_ieee80211_ht_cap - HT additional information -+ * -+ * This structure refers to "HT information element" as -+ * described in 802.11n draft section 7.3.2.53 -+ */ -+struct ieee80211_ht_addt_info { -+ unsigned char control_chan; -+ unsigned char ht_param; -+ __le16 operation_mode; -+ __le16 stbc_param; -+ unsigned char basic_set[16]; -+} __attribute__ ((packed)); -+ -+struct HT_caps_element -+{ -+ union -+ { -+ struct -+ { -+ __le16 HT_caps_info; -+ unsigned char AMPDU_para; -+ unsigned char MCS_rate[16]; -+ __le16 HT_ext_caps; -+ __le16 Beamforming_caps; -+ unsigned char ASEL_caps; -+ } HT_cap_element; -+ unsigned char HT_cap[26]; -+ }u; -+} __attribute__ ((packed)); -+ -+struct HT_info_element -+{ -+ unsigned char primary_channel; -+ unsigned char infos[5]; -+ unsigned char MCS_rate[16]; -+} __attribute__ ((packed)); -+ -+struct AC_param -+{ -+ unsigned char ACI_AIFSN; -+ unsigned char CW; -+ __le16 TXOP_limit; -+} __attribute__ ((packed)); -+ -+struct WMM_para_element -+{ -+ unsigned char QoS_info; -+ unsigned char reserved; -+ struct AC_param ac_param[4]; -+} __attribute__ ((packed)); -+ -+struct ADDBA_request -+{ -+ unsigned char dialog_token; -+ __le16 BA_para_set; -+ __le16 BA_timeout_value; -+ __le16 BA_starting_seqctrl; -+} __attribute__ ((packed)); -+ -+typedef enum _HT_CAP_AMPDU_FACTOR { -+ MAX_AMPDU_FACTOR_8K = 0, -+ MAX_AMPDU_FACTOR_16K = 1, -+ MAX_AMPDU_FACTOR_32K = 2, -+ MAX_AMPDU_FACTOR_64K = 3, -+}HT_CAP_AMPDU_FACTOR; -+ -+/* 802.11n HT capabilities masks */ -+#define IEEE80211_HT_CAP_SUP_WIDTH 0x0002 -+#define IEEE80211_HT_CAP_SM_PS 0x000C -+#define IEEE80211_HT_CAP_GRN_FLD 0x0010 -+#define IEEE80211_HT_CAP_SGI_20 0x0020 -+#define IEEE80211_HT_CAP_SGI_40 0x0040 -+#define IEEE80211_HT_CAP_TX_STBC 0x0080 -+#define IEEE80211_HT_CAP_RX_STBC 0x0300 -+#define IEEE80211_HT_CAP_DELAY_BA 0x0400 -+#define IEEE80211_HT_CAP_MAX_AMSDU 0x0800 -+#define IEEE80211_HT_CAP_DSSSCCK40 0x1000 -+/* 802.11n HT capability AMPDU settings */ -+#define IEEE80211_HT_CAP_AMPDU_FACTOR 0x03 -+#define IEEE80211_HT_CAP_AMPDU_DENSITY 0x1C -+/* 802.11n HT capability MSC set */ -+#define IEEE80211_SUPP_MCS_SET_UEQM 4 -+#define IEEE80211_HT_CAP_MAX_STREAMS 4 -+#define IEEE80211_SUPP_MCS_SET_LEN 10 -+/* maximum streams the spec allows */ -+#define IEEE80211_HT_CAP_MCS_TX_DEFINED 0x01 -+#define IEEE80211_HT_CAP_MCS_TX_RX_DIFF 0x02 -+#define IEEE80211_HT_CAP_MCS_TX_STREAMS 0x0C -+#define IEEE80211_HT_CAP_MCS_TX_UEQM 0x10 -+/* 802.11n HT IE masks */ -+#define IEEE80211_HT_IE_CHA_SEC_OFFSET 0x03 -+#define IEEE80211_HT_IE_CHA_SEC_NONE 0x00 -+#define IEEE80211_HT_IE_CHA_SEC_ABOVE 0x01 -+#define IEEE80211_HT_IE_CHA_SEC_BELOW 0x03 -+#define IEEE80211_HT_IE_CHA_WIDTH 0x04 -+#define IEEE80211_HT_IE_HT_PROTECTION 0x0003 -+#define IEEE80211_HT_IE_NON_GF_STA_PRSNT 0x0004 -+#define IEEE80211_HT_IE_NON_HT_STA_PRSNT 0x0010 -+ -+/* block-ack parameters */ -+#define IEEE80211_ADDBA_PARAM_POLICY_MASK 0x0002 -+#define IEEE80211_ADDBA_PARAM_TID_MASK 0x003C -+#define RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK 0xFFC0 -+#define IEEE80211_DELBA_PARAM_TID_MASK 0xF000 -+#define IEEE80211_DELBA_PARAM_INITIATOR_MASK 0x0800 -+ -+/* -+ * A-PMDU buffer sizes -+ * According to IEEE802.11n spec size varies from 8K to 64K (in powers of 2) -+ */ -+#define IEEE80211_MIN_AMPDU_BUF 0x8 -+#define IEEE80211_MAX_AMPDU_BUF 0x40 -+ -+ -+/* Spatial Multiplexing Power Save Modes */ -+#define WLAN_HT_CAP_SM_PS_STATIC 0 -+#define WLAN_HT_CAP_SM_PS_DYNAMIC 1 -+#define WLAN_HT_CAP_SM_PS_INVALID 2 -+#define WLAN_HT_CAP_SM_PS_DISABLED 3 -+ -+ -+#define OP_MODE_PURE 0 -+#define OP_MODE_MAY_BE_LEGACY_STAS 1 -+#define OP_MODE_20MHZ_HT_STA_ASSOCED 2 -+#define OP_MODE_MIXED 3 -+ -+#define HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK ((u8) BIT(0) | BIT(1)) -+#define HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE ((u8) BIT(0)) -+#define HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW ((u8) BIT(0) | BIT(1)) -+#define HT_INFO_HT_PARAM_REC_TRANS_CHNL_WIDTH ((u8) BIT(2)) -+#define HT_INFO_HT_PARAM_RIFS_MODE ((u8) BIT(3)) -+#define HT_INFO_HT_PARAM_CTRL_ACCESS_ONLY ((u8) BIT(4)) -+#define HT_INFO_HT_PARAM_SRV_INTERVAL_GRANULARITY ((u8) BIT(5)) -+ -+#define HT_INFO_OPERATION_MODE_OP_MODE_MASK \ -+ ((u16) (0x0001 | 0x0002)) -+#define HT_INFO_OPERATION_MODE_OP_MODE_OFFSET 0 -+#define HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT ((u8) BIT(2)) -+#define HT_INFO_OPERATION_MODE_TRANSMIT_BURST_LIMIT ((u8) BIT(3)) -+#define HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT ((u8) BIT(4)) -+ -+#define HT_INFO_STBC_PARAM_DUAL_BEACON ((u16) BIT(6)) -+#define HT_INFO_STBC_PARAM_DUAL_STBC_PROTECT ((u16) BIT(7)) -+#define HT_INFO_STBC_PARAM_SECONDARY_BCN ((u16) BIT(8)) -+#define HT_INFO_STBC_PARAM_LSIG_TXOP_PROTECT_ALLOWED ((u16) BIT(9)) -+#define HT_INFO_STBC_PARAM_PCO_ACTIVE ((u16) BIT(10)) -+#define HT_INFO_STBC_PARAM_PCO_PHASE ((u16) BIT(11)) -+ -+ -+ -+//#endif -+ -+// ===============WPS Section=============== -+// For WPSv1.0 -+#define WPSOUI 0x0050f204 -+// WPS attribute ID -+#define WPS_ATTR_VER1 0x104A -+#define WPS_ATTR_SIMPLE_CONF_STATE 0x1044 -+#define WPS_ATTR_RESP_TYPE 0x103B -+#define WPS_ATTR_UUID_E 0x1047 -+#define WPS_ATTR_MANUFACTURER 0x1021 -+#define WPS_ATTR_MODEL_NAME 0x1023 -+#define WPS_ATTR_MODEL_NUMBER 0x1024 -+#define WPS_ATTR_SERIAL_NUMBER 0x1042 -+#define WPS_ATTR_PRIMARY_DEV_TYPE 0x1054 -+#define WPS_ATTR_SEC_DEV_TYPE_LIST 0x1055 -+#define WPS_ATTR_DEVICE_NAME 0x1011 -+#define WPS_ATTR_CONF_METHOD 0x1008 -+#define WPS_ATTR_RF_BANDS 0x103C -+#define WPS_ATTR_DEVICE_PWID 0x1012 -+#define WPS_ATTR_REQUEST_TYPE 0x103A -+#define WPS_ATTR_ASSOCIATION_STATE 0x1002 -+#define WPS_ATTR_CONFIG_ERROR 0x1009 -+#define WPS_ATTR_VENDOR_EXT 0x1049 -+#define WPS_ATTR_SELECTED_REGISTRAR 0x1041 -+ -+// Value of WPS attribute "WPS_ATTR_DEVICE_NAME -+#define WPS_MAX_DEVICE_NAME_LEN 32 -+ -+// Value of WPS Request Type Attribute -+#define WPS_REQ_TYPE_ENROLLEE_INFO_ONLY 0x00 -+#define WPS_REQ_TYPE_ENROLLEE_OPEN_8021X 0x01 -+#define WPS_REQ_TYPE_REGISTRAR 0x02 -+#define WPS_REQ_TYPE_WLAN_MANAGER_REGISTRAR 0x03 -+ -+// Value of WPS Response Type Attribute -+#define WPS_RESPONSE_TYPE_INFO_ONLY 0x00 -+#define WPS_RESPONSE_TYPE_8021X 0x01 -+#define WPS_RESPONSE_TYPE_REGISTRAR 0x02 -+#define WPS_RESPONSE_TYPE_AP 0x03 -+ -+// Value of WPS WiFi Simple Configuration State Attribute -+#define WPS_WSC_STATE_NOT_CONFIG 0x01 -+#define WPS_WSC_STATE_CONFIG 0x02 -+ -+// Value of WPS Version Attribute -+#define WPS_VERSION_1 0x10 -+ -+// Value of WPS Configuration Method Attribute -+#define WPS_CONFIG_METHOD_FLASH 0x0001 -+#define WPS_CONFIG_METHOD_ETHERNET 0x0002 -+#define WPS_CONFIG_METHOD_LABEL 0x0004 -+#define WPS_CONFIG_METHOD_DISPLAY 0x0008 -+#define WPS_CONFIG_METHOD_E_NFC 0x0010 -+#define WPS_CONFIG_METHOD_I_NFC 0x0020 -+#define WPS_CONFIG_METHOD_NFC 0x0040 -+#define WPS_CONFIG_METHOD_PBC 0x0080 -+#define WPS_CONFIG_METHOD_KEYPAD 0x0100 -+#define WPS_CONFIG_METHOD_VPBC 0x0280 -+#define WPS_CONFIG_METHOD_PPBC 0x0480 -+#define WPS_CONFIG_METHOD_VDISPLAY 0x2008 -+#define WPS_CONFIG_METHOD_PDISPLAY 0x4008 -+ -+// Value of Category ID of WPS Primary Device Type Attribute -+#define WPS_PDT_CID_DISPLAYS 0x0007 -+#define WPS_PDT_CID_MULIT_MEDIA 0x0008 -+#define WPS_PDT_CID_RTK_WIDI WPS_PDT_CID_MULIT_MEDIA -+ -+// Value of Sub Category ID of WPS Primary Device Type Attribute -+#define WPS_PDT_SCID_MEDIA_SERVER 0x0005 -+#define WPS_PDT_SCID_RTK_DMP WPS_PDT_SCID_MEDIA_SERVER -+ -+// Value of Device Password ID -+#define WPS_DPID_PIN 0x0000 -+#define WPS_DPID_USER_SPEC 0x0001 -+#define WPS_DPID_MACHINE_SPEC 0x0002 -+#define WPS_DPID_REKEY 0x0003 -+#define WPS_DPID_PBC 0x0004 -+#define WPS_DPID_REGISTRAR_SPEC 0x0005 -+ -+// Value of WPS RF Bands Attribute -+#define WPS_RF_BANDS_2_4_GHZ 0x01 -+#define WPS_RF_BANDS_5_GHZ 0x02 -+ -+// Value of WPS Association State Attribute -+#define WPS_ASSOC_STATE_NOT_ASSOCIATED 0x00 -+#define WPS_ASSOC_STATE_CONNECTION_SUCCESS 0x01 -+#define WPS_ASSOC_STATE_CONFIGURATION_FAILURE 0x02 -+#define WPS_ASSOC_STATE_ASSOCIATION_FAILURE 0x03 -+#define WPS_ASSOC_STATE_IP_FAILURE 0x04 -+ -+// =====================P2P Section===================== -+// For P2P -+#define P2POUI 0x506F9A09 -+ -+// P2P Attribute ID -+#define P2P_ATTR_STATUS 0x00 -+#define P2P_ATTR_MINOR_REASON_CODE 0x01 -+#define P2P_ATTR_CAPABILITY 0x02 -+#define P2P_ATTR_DEVICE_ID 0x03 -+#define P2P_ATTR_GO_INTENT 0x04 -+#define P2P_ATTR_CONF_TIMEOUT 0x05 -+#define P2P_ATTR_LISTEN_CH 0x06 -+#define P2P_ATTR_GROUP_BSSID 0x07 -+#define P2P_ATTR_EX_LISTEN_TIMING 0x08 -+#define P2P_ATTR_INTENTED_IF_ADDR 0x09 -+#define P2P_ATTR_MANAGEABILITY 0x0A -+#define P2P_ATTR_CH_LIST 0x0B -+#define P2P_ATTR_NOA 0x0C -+#define P2P_ATTR_DEVICE_INFO 0x0D -+#define P2P_ATTR_GROUP_INFO 0x0E -+#define P2P_ATTR_GROUP_ID 0x0F -+#define P2P_ATTR_INTERFACE 0x10 -+#define P2P_ATTR_OPERATING_CH 0x11 -+#define P2P_ATTR_INVITATION_FLAGS 0x12 -+ -+// Value of Status Attribute -+#define P2P_STATUS_SUCCESS 0x00 -+#define P2P_STATUS_FAIL_INFO_UNAVAILABLE 0x01 -+#define P2P_STATUS_FAIL_INCOMPATIBLE_PARAM 0x02 -+#define P2P_STATUS_FAIL_LIMIT_REACHED 0x03 -+#define P2P_STATUS_FAIL_INVALID_PARAM 0x04 -+#define P2P_STATUS_FAIL_REQUEST_UNABLE 0x05 -+#define P2P_STATUS_FAIL_PREVOUS_PROTO_ERR 0x06 -+#define P2P_STATUS_FAIL_NO_COMMON_CH 0x07 -+#define P2P_STATUS_FAIL_UNKNOWN_P2PGROUP 0x08 -+#define P2P_STATUS_FAIL_BOTH_GOINTENT_15 0x09 -+#define P2P_STATUS_FAIL_INCOMPATIBLE_PROVSION 0x0A -+#define P2P_STATUS_FAIL_USER_REJECT 0x0B -+ -+// Value of Inviation Flags Attribute -+#define P2P_INVITATION_FLAGS_PERSISTENT BIT(0) -+ -+#define DMP_P2P_DEVCAP_SUPPORT (P2P_DEVCAP_SERVICE_DISCOVERY | \ -+ P2P_DEVCAP_CLIENT_DISCOVERABILITY | \ -+ P2P_DEVCAP_CONCURRENT_OPERATION | \ -+ P2P_DEVCAP_INVITATION_PROC) -+ -+#define DMP_P2P_GRPCAP_SUPPORT (P2P_GRPCAP_INTRABSS) -+ -+// Value of Device Capability Bitmap -+#define P2P_DEVCAP_SERVICE_DISCOVERY BIT(0) -+#define P2P_DEVCAP_CLIENT_DISCOVERABILITY BIT(1) -+#define P2P_DEVCAP_CONCURRENT_OPERATION BIT(2) -+#define P2P_DEVCAP_INFRA_MANAGED BIT(3) -+#define P2P_DEVCAP_DEVICE_LIMIT BIT(4) -+#define P2P_DEVCAP_INVITATION_PROC BIT(5) -+ -+// Value of Group Capability Bitmap -+#define P2P_GRPCAP_GO BIT(0) -+#define P2P_GRPCAP_PERSISTENT_GROUP BIT(1) -+#define P2P_GRPCAP_GROUP_LIMIT BIT(2) -+#define P2P_GRPCAP_INTRABSS BIT(3) -+#define P2P_GRPCAP_CROSS_CONN BIT(4) -+#define P2P_GRPCAP_PERSISTENT_RECONN BIT(5) -+#define P2P_GRPCAP_GROUP_FORMATION BIT(6) -+ -+// P2P Public Action Frame ( Management Frame ) -+#define P2P_PUB_ACTION_ACTION 0x09 -+ -+// P2P Public Action Frame Type -+#define P2P_GO_NEGO_REQ 0 -+#define P2P_GO_NEGO_RESP 1 -+#define P2P_GO_NEGO_CONF 2 -+#define P2P_INVIT_REQ 3 -+#define P2P_INVIT_RESP 4 -+#define P2P_DEVDISC_REQ 5 -+#define P2P_DEVDISC_RESP 6 -+#define P2P_PROVISION_DISC_REQ 7 -+#define P2P_PROVISION_DISC_RESP 8 -+ -+// P2P Action Frame Type -+#define P2P_NOTICE_OF_ABSENCE 0 -+#define P2P_PRESENCE_REQUEST 1 -+#define P2P_PRESENCE_RESPONSE 2 -+#define P2P_GO_DISC_REQUEST 3 -+ -+ -+#define P2P_MAX_PERSISTENT_GROUP_NUM 10 -+ -+#define P2P_PROVISIONING_SCAN_CNT 3 -+ -+#define P2P_WILDCARD_SSID_LEN 7 -+ -+#define P2P_FINDPHASE_EX_NONE 0 // default value, used when: (1)p2p disabed or (2)p2p enabled but only do 1 scan phase -+#define P2P_FINDPHASE_EX_FULL 1 // used when p2p enabled and want to do 1 scan phase and P2P_FINDPHASE_EX_MAX-1 find phase -+#define P2P_FINDPHASE_EX_SOCIAL_FIRST (P2P_FINDPHASE_EX_FULL+1) -+#define P2P_FINDPHASE_EX_MAX 4 -+#define P2P_FINDPHASE_EX_SOCIAL_LAST P2P_FINDPHASE_EX_MAX -+ -+#define P2P_PROVISION_TIMEOUT 5000 // 5 seconds timeout for sending the provision discovery request -+#define P2P_CONCURRENT_PROVISION_TIMEOUT 3000 // 3 seconds timeout for sending the provision discovery request under concurrent mode -+#define P2P_GO_NEGO_TIMEOUT 5000 // 5 seconds timeout for receiving the group negotation response -+#define P2P_CONCURRENT_GO_NEGO_TIMEOUT 3000 // 3 seconds timeout for sending the negotiation request under concurrent mode -+#define P2P_TX_PRESCAN_TIMEOUT 100 // 100ms -+#define P2P_INVITE_TIMEOUT 5000 // 5 seconds timeout for sending the invitation request -+#define P2P_CONCURRENT_INVITE_TIMEOUT 3000 // 3 seconds timeout for sending the invitation request under concurrent mode -+#define P2P_RESET_SCAN_CH 25000 // 25 seconds timeout to reset the scan channel ( based on channel plan ) -+#define P2P_MAX_INTENT 15 -+ -+#define P2P_MAX_NOA_NUM 2 -+ -+// WPS Configuration Method -+#define WPS_CM_NONE 0x0000 -+#define WPS_CM_LABEL 0x0004 -+#define WPS_CM_DISPLYA 0x0008 -+#define WPS_CM_EXTERNAL_NFC_TOKEN 0x0010 -+#define WPS_CM_INTEGRATED_NFC_TOKEN 0x0020 -+#define WPS_CM_NFC_INTERFACE 0x0040 -+#define WPS_CM_PUSH_BUTTON 0x0080 -+#define WPS_CM_KEYPAD 0x0100 -+#define WPS_CM_SW_PUHS_BUTTON 0x0280 -+#define WPS_CM_HW_PUHS_BUTTON 0x0480 -+#define WPS_CM_SW_DISPLAY_PIN 0x2008 -+#define WPS_CM_LCD_DISPLAY_PIN 0x4008 -+ -+enum P2P_ROLE { -+ P2P_ROLE_DISABLE = 0, -+ P2P_ROLE_DEVICE = 1, -+ P2P_ROLE_CLIENT = 2, -+ P2P_ROLE_GO = 3 -+}; -+ -+enum P2P_STATE { -+ P2P_STATE_NONE = 0, // P2P disable -+ P2P_STATE_IDLE = 1, // P2P had enabled and do nothing -+ P2P_STATE_LISTEN = 2, // In pure listen state -+ P2P_STATE_SCAN = 3, // In scan phase -+ P2P_STATE_FIND_PHASE_LISTEN = 4, // In the listen state of find phase -+ P2P_STATE_FIND_PHASE_SEARCH = 5, // In the search state of find phase -+ P2P_STATE_TX_PROVISION_DIS_REQ = 6, // In P2P provisioning discovery -+ P2P_STATE_RX_PROVISION_DIS_RSP = 7, -+ P2P_STATE_RX_PROVISION_DIS_REQ = 8, -+ P2P_STATE_GONEGO_ING = 9, // Doing the group owner negoitation handshake -+ P2P_STATE_GONEGO_OK = 10, // finish the group negoitation handshake with success -+ P2P_STATE_GONEGO_FAIL = 11, // finish the group negoitation handshake with failure -+ P2P_STATE_RECV_INVITE_REQ_MATCH = 12, // receiving the P2P Inviation request and match with the profile. -+ P2P_STATE_PROVISIONING_ING = 13, // Doing the P2P WPS -+ P2P_STATE_PROVISIONING_DONE = 14, // Finish the P2P WPS -+ P2P_STATE_TX_INVITE_REQ = 15, // Transmit the P2P Invitation request -+ P2P_STATE_RX_INVITE_RESP_OK = 16, // Receiving the P2P Invitation response -+ P2P_STATE_RECV_INVITE_REQ_DISMATCH = 17, // receiving the P2P Inviation request and dismatch with the profile. -+ P2P_STATE_RECV_INVITE_REQ_GO = 18, // receiving the P2P Inviation request and this wifi is GO. -+ P2P_STATE_RECV_INVITE_REQ_JOIN = 19, // receiving the P2P Inviation request to join an existing P2P Group. -+ P2P_STATE_RX_INVITE_RESP_FAIL = 20, // recveing the P2P Inviation response with failure -+ P2P_STATE_RX_INFOR_NOREADY = 21, // receiving p2p negoitation response with information is not available -+ P2P_STATE_TX_INFOR_NOREADY = 22, // sending p2p negoitation response with information is not available -+}; -+ -+enum P2P_WPSINFO { -+ P2P_NO_WPSINFO = 0, -+ P2P_GOT_WPSINFO_PEER_DISPLAY_PIN = 1, -+ P2P_GOT_WPSINFO_SELF_DISPLAY_PIN = 2, -+ P2P_GOT_WPSINFO_PBC = 3, -+}; -+ -+#define P2P_PRIVATE_IOCTL_SET_LEN 64 -+ -+enum P2P_PROTO_WK_ID -+{ -+ P2P_FIND_PHASE_WK = 0, -+ P2P_RESTORE_STATE_WK = 1, -+ P2P_PRE_TX_PROVDISC_PROCESS_WK = 2, -+ P2P_PRE_TX_NEGOREQ_PROCESS_WK = 3, -+ P2P_PRE_TX_INVITEREQ_PROCESS_WK = 4, -+ P2P_AP_P2P_CH_SWITCH_PROCESS_WK =5, -+ P2P_RO_CH_WK = 6, -+}; -+ -+#ifdef CONFIG_P2P_PS -+enum P2P_PS_STATE -+{ -+ P2P_PS_DISABLE = 0, -+ P2P_PS_ENABLE = 1, -+ P2P_PS_SCAN = 2, -+ P2P_PS_SCAN_DONE = 3, -+ P2P_PS_ALLSTASLEEP = 4, // for P2P GO -+}; -+ -+enum P2P_PS_MODE -+{ -+ P2P_PS_NONE = 0, -+ P2P_PS_CTWINDOW = 1, -+ P2P_PS_NOA = 2, -+ P2P_PS_MIX = 3, // CTWindow and NoA -+}; -+#endif // CONFIG_P2P_PS -+ -+// =====================WFD Section===================== -+// For Wi-Fi Display -+#define WFD_ATTR_DEVICE_INFO 0x00 -+#define WFD_ATTR_ASSOC_BSSID 0x01 -+#define WFD_ATTR_COUPLED_SINK_INFO 0x06 -+#define WFD_ATTR_LOCAL_IP_ADDR 0x08 -+#define WFD_ATTR_SESSION_INFO 0x09 -+#define WFD_ATTR_ALTER_MAC 0x0a -+ -+// For WFD Device Information Attribute -+#define WFD_DEVINFO_SOURCE 0x0000 -+#define WFD_DEVINFO_PSINK 0x0001 -+#define WFD_DEVINFO_SSINK 0x0002 -+#define WFD_DEVINFO_DUAL 0x0003 -+ -+#define WFD_DEVINFO_SESSION_AVAIL 0x0010 -+#define WFD_DEVINFO_WSD 0x0040 -+#define WFD_DEVINFO_PC_TDLS 0x0080 -+#define WFD_DEVINFO_HDCP_SUPPORT 0x0100 -+ -+#ifdef CONFIG_TX_MCAST2UNI -+#define IP_MCAST_MAC(mac) ((mac[0]==0x01)&&(mac[1]==0x00)&&(mac[2]==0x5e)) -+#define ICMPV6_MCAST_MAC(mac) ((mac[0]==0x33)&&(mac[1]==0x33)&&(mac[2]!=0xff)) -+#endif // CONFIG_TX_MCAST2UNI -+ -+ -+ -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef IW_AUTH_WAPI_VERSION_1 -+#define IW_AUTH_WAPI_VERSION_1 0x00000008 -+#endif -+#ifndef IW_AUTH_KEY_MGMT_WAPI_PSK -+#define IW_AUTH_KEY_MGMT_WAPI_PSK 0x04 -+#endif -+#ifndef IW_AUTH_WAPI_ENABLED -+#define IW_AUTH_WAPI_ENABLED 0x20 -+#endif -+#ifndef IW_ENCODE_ALG_SM4 -+#define IW_ENCODE_ALG_SM4 0x20 -+#endif -+#endif -+ -+#endif // _WIFI_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/wlan_bssdef.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/wlan_bssdef.h ---- linux-4.14.17/3rdparty/rtl8812au/include/wlan_bssdef.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/wlan_bssdef.h 2018-02-06 17:42:30.722967342 +0200 -@@ -0,0 +1,381 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __WLAN_BSSDEF_H__ -+#define __WLAN_BSSDEF_H__ -+ -+ -+#define MAX_IE_SZ 768 -+ -+#define NDIS_802_11_LENGTH_SSID 32 -+#define NDIS_802_11_LENGTH_RATES 8 -+#define NDIS_802_11_LENGTH_RATES_EX 16 -+ -+typedef unsigned char NDIS_802_11_MAC_ADDRESS[6]; -+typedef long NDIS_802_11_RSSI; // in dBm -+typedef unsigned char NDIS_802_11_RATES[NDIS_802_11_LENGTH_RATES]; // Set of 8 data rates -+typedef unsigned char NDIS_802_11_RATES_EX[NDIS_802_11_LENGTH_RATES_EX]; // Set of 16 data rates -+ -+typedef u32 NDIS_802_11_KEY_INDEX; -+typedef unsigned long long NDIS_802_11_KEY_RSC; -+ -+typedef struct _NDIS_802_11_SSID -+{ -+ u32 SsidLength; -+ u8 Ssid[32]; -+} NDIS_802_11_SSID, *PNDIS_802_11_SSID; -+ -+typedef enum _NDIS_802_11_NETWORK_TYPE -+{ -+ Ndis802_11FH, -+ Ndis802_11DS, -+ Ndis802_11OFDM5, -+ Ndis802_11OFDM24, -+ Ndis802_11NetworkTypeMax // not a real type, defined as an upper bound -+} NDIS_802_11_NETWORK_TYPE, *PNDIS_802_11_NETWORK_TYPE; -+ -+typedef struct _NDIS_802_11_CONFIGURATION_FH -+{ -+ u32 Length; // Length of structure -+ u32 HopPattern; // As defined by 802.11, MSB set -+ u32 HopSet; // to one if non-802.11 -+ u32 DwellTime; // units are Kusec -+} NDIS_802_11_CONFIGURATION_FH, *PNDIS_802_11_CONFIGURATION_FH; -+ -+/* -+ FW will only save the channel number in DSConfig. -+ ODI Handler will convert the channel number to freq. number. -+*/ -+typedef struct _NDIS_802_11_CONFIGURATION -+{ -+ u32 Length; // Length of structure -+ u32 BeaconPeriod; // units are Kusec -+ u32 ATIMWindow; // units are Kusec -+ u32 DSConfig; // Frequency, units are kHz -+ NDIS_802_11_CONFIGURATION_FH FHConfig; -+} NDIS_802_11_CONFIGURATION, *PNDIS_802_11_CONFIGURATION; -+ -+typedef enum _NDIS_802_11_NETWORK_INFRASTRUCTURE -+{ -+ Ndis802_11IBSS, -+ Ndis802_11Infrastructure, -+ Ndis802_11AutoUnknown, -+ Ndis802_11InfrastructureMax, // Not a real value, defined as upper bound -+ Ndis802_11APMode -+} NDIS_802_11_NETWORK_INFRASTRUCTURE, *PNDIS_802_11_NETWORK_INFRASTRUCTURE; -+ -+typedef struct _NDIS_802_11_FIXED_IEs -+{ -+ u8 Timestamp[8]; -+ u16 BeaconInterval; -+ u16 Capabilities; -+} NDIS_802_11_FIXED_IEs, *PNDIS_802_11_FIXED_IEs; -+ -+typedef struct _NDIS_802_11_VARIABLE_IEs -+{ -+ u8 ElementID; -+ u8 Length; -+ u8 data[1]; -+} NDIS_802_11_VARIABLE_IEs, *PNDIS_802_11_VARIABLE_IEs; -+ -+/* -+Length is the 4 bytes multiples of the sume of -+ sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + sizeof (NDIS_802_11_SSID) + sizeof (u32) -++ sizeof (NDIS_802_11_RSSI) + sizeof (NDIS_802_11_NETWORK_TYPE) + sizeof (NDIS_802_11_CONFIGURATION) -++ sizeof (NDIS_802_11_RATES_EX) + IELength -+ -+Except the IELength, all other fields are fixed length. Therefore, we can define a marco to present the -+partial sum. -+ -+*/ -+ -+typedef enum _NDIS_802_11_AUTHENTICATION_MODE -+{ -+ Ndis802_11AuthModeOpen, -+ Ndis802_11AuthModeShared, -+ Ndis802_11AuthModeAutoSwitch, -+ Ndis802_11AuthModeWPA, -+ Ndis802_11AuthModeWPAPSK, -+ Ndis802_11AuthModeWPANone, -+ Ndis802_11AuthModeWAPI, -+ Ndis802_11AuthModeMax // Not a real mode, defined as upper bound -+} NDIS_802_11_AUTHENTICATION_MODE, *PNDIS_802_11_AUTHENTICATION_MODE; -+ -+typedef enum _NDIS_802_11_WEP_STATUS -+{ -+ Ndis802_11WEPEnabled, -+ Ndis802_11Encryption1Enabled = Ndis802_11WEPEnabled, -+ Ndis802_11WEPDisabled, -+ Ndis802_11EncryptionDisabled = Ndis802_11WEPDisabled, -+ Ndis802_11WEPKeyAbsent, -+ Ndis802_11Encryption1KeyAbsent = Ndis802_11WEPKeyAbsent, -+ Ndis802_11WEPNotSupported, -+ Ndis802_11EncryptionNotSupported = Ndis802_11WEPNotSupported, -+ Ndis802_11Encryption2Enabled, -+ Ndis802_11Encryption2KeyAbsent, -+ Ndis802_11Encryption3Enabled, -+ Ndis802_11Encryption3KeyAbsent, -+ Ndis802_11_EncrypteionWAPI -+} NDIS_802_11_WEP_STATUS, *PNDIS_802_11_WEP_STATUS, -+ NDIS_802_11_ENCRYPTION_STATUS, *PNDIS_802_11_ENCRYPTION_STATUS; -+ -+ -+#define NDIS_802_11_AI_REQFI_CAPABILITIES 1 -+#define NDIS_802_11_AI_REQFI_LISTENINTERVAL 2 -+#define NDIS_802_11_AI_REQFI_CURRENTAPADDRESS 4 -+ -+#define NDIS_802_11_AI_RESFI_CAPABILITIES 1 -+#define NDIS_802_11_AI_RESFI_STATUSCODE 2 -+#define NDIS_802_11_AI_RESFI_ASSOCIATIONID 4 -+ -+typedef struct _NDIS_802_11_AI_REQFI -+{ -+ u16 Capabilities; -+ u16 ListenInterval; -+ NDIS_802_11_MAC_ADDRESS CurrentAPAddress; -+} NDIS_802_11_AI_REQFI, *PNDIS_802_11_AI_REQFI; -+ -+typedef struct _NDIS_802_11_AI_RESFI -+{ -+ u16 Capabilities; -+ u16 StatusCode; -+ u16 AssociationId; -+} NDIS_802_11_AI_RESFI, *PNDIS_802_11_AI_RESFI; -+ -+typedef struct _NDIS_802_11_ASSOCIATION_INFORMATION -+{ -+ u32 Length; -+ u16 AvailableRequestFixedIEs; -+ NDIS_802_11_AI_REQFI RequestFixedIEs; -+ u32 RequestIELength; -+ u32 OffsetRequestIEs; -+ u16 AvailableResponseFixedIEs; -+ NDIS_802_11_AI_RESFI ResponseFixedIEs; -+ u32 ResponseIELength; -+ u32 OffsetResponseIEs; -+} NDIS_802_11_ASSOCIATION_INFORMATION, *PNDIS_802_11_ASSOCIATION_INFORMATION; -+ -+typedef enum _NDIS_802_11_RELOAD_DEFAULTS -+{ -+ Ndis802_11ReloadWEPKeys -+} NDIS_802_11_RELOAD_DEFAULTS, *PNDIS_802_11_RELOAD_DEFAULTS; -+ -+ -+// Key mapping keys require a BSSID -+typedef struct _NDIS_802_11_KEY -+{ -+ u32 Length; // Length of this structure -+ u32 KeyIndex; -+ u32 KeyLength; // length of key in bytes -+ NDIS_802_11_MAC_ADDRESS BSSID; -+ NDIS_802_11_KEY_RSC KeyRSC; -+ u8 KeyMaterial[32]; // variable length depending on above field -+} NDIS_802_11_KEY, *PNDIS_802_11_KEY; -+ -+typedef struct _NDIS_802_11_REMOVE_KEY -+{ -+ u32 Length; // Length of this structure -+ u32 KeyIndex; -+ NDIS_802_11_MAC_ADDRESS BSSID; -+} NDIS_802_11_REMOVE_KEY, *PNDIS_802_11_REMOVE_KEY; -+ -+typedef struct _NDIS_802_11_WEP -+{ -+ u32 Length; // Length of this structure -+ u32 KeyIndex; // 0 is the per-client key, 1-N are the global keys -+ u32 KeyLength; // length of key in bytes -+ u8 KeyMaterial[16];// variable length depending on above field -+} NDIS_802_11_WEP, *PNDIS_802_11_WEP; -+ -+typedef struct _NDIS_802_11_AUTHENTICATION_REQUEST -+{ -+ u32 Length; // Length of structure -+ NDIS_802_11_MAC_ADDRESS Bssid; -+ u32 Flags; -+} NDIS_802_11_AUTHENTICATION_REQUEST, *PNDIS_802_11_AUTHENTICATION_REQUEST; -+ -+typedef enum _NDIS_802_11_STATUS_TYPE -+{ -+ Ndis802_11StatusType_Authentication, -+ Ndis802_11StatusType_MediaStreamMode, -+ Ndis802_11StatusType_PMKID_CandidateList, -+ Ndis802_11StatusTypeMax // not a real type, defined as an upper bound -+} NDIS_802_11_STATUS_TYPE, *PNDIS_802_11_STATUS_TYPE; -+ -+typedef struct _NDIS_802_11_STATUS_INDICATION -+{ -+ NDIS_802_11_STATUS_TYPE StatusType; -+} NDIS_802_11_STATUS_INDICATION, *PNDIS_802_11_STATUS_INDICATION; -+ -+// mask for authentication/integrity fields -+#define NDIS_802_11_AUTH_REQUEST_AUTH_FIELDS 0x0f -+#define NDIS_802_11_AUTH_REQUEST_REAUTH 0x01 -+#define NDIS_802_11_AUTH_REQUEST_KEYUPDATE 0x02 -+#define NDIS_802_11_AUTH_REQUEST_PAIRWISE_ERROR 0x06 -+#define NDIS_802_11_AUTH_REQUEST_GROUP_ERROR 0x0E -+ -+// MIC check time, 60 seconds. -+#define MIC_CHECK_TIME 60000000 -+ -+typedef struct _NDIS_802_11_AUTHENTICATION_EVENT -+{ -+ NDIS_802_11_STATUS_INDICATION Status; -+ NDIS_802_11_AUTHENTICATION_REQUEST Request[1]; -+} NDIS_802_11_AUTHENTICATION_EVENT, *PNDIS_802_11_AUTHENTICATION_EVENT; -+ -+typedef struct _NDIS_802_11_TEST -+{ -+ u32 Length; -+ u32 Type; -+ union -+ { -+ NDIS_802_11_AUTHENTICATION_EVENT AuthenticationEvent; -+ NDIS_802_11_RSSI RssiTrigger; -+ }tt; -+} NDIS_802_11_TEST, *PNDIS_802_11_TEST; -+ -+#ifndef Ndis802_11APMode -+#define Ndis802_11APMode (Ndis802_11InfrastructureMax+1) -+#endif -+ -+typedef struct _WLAN_PHY_INFO -+{ -+ u8 SignalStrength;//(in percentage) -+ u8 SignalQuality;//(in percentage) -+ u8 Optimum_antenna; //for Antenna diversity -+ u8 Reserved_0; -+}WLAN_PHY_INFO,*PWLAN_PHY_INFO; -+ -+typedef struct _WLAN_BCN_INFO -+{ -+ /* these infor get from rtw_get_encrypt_info when -+ * * translate scan to UI */ -+ u8 encryp_protocol;//ENCRYP_PROTOCOL_E: OPEN/WEP/WPA/WPA2/WAPI -+ int group_cipher; //WPA/WPA2 group cipher -+ int pairwise_cipher;////WPA/WPA2/WEP pairwise cipher -+ int is_8021x; -+ -+ /* bwmode 20/40 and ch_offset UP/LOW */ -+ unsigned short ht_cap_info; -+ unsigned char ht_info_infos_0; -+}WLAN_BCN_INFO,*PWLAN_BCN_INFO; -+ -+typedef struct _WLAN_BSSID_EX -+{ -+ u32 Length; -+ NDIS_802_11_MAC_ADDRESS MacAddress; -+ u8 Reserved[2];//[0]: IS beacon frame -+ NDIS_802_11_SSID Ssid; -+ u32 Privacy; -+ NDIS_802_11_RSSI Rssi;//(in dBM,raw data ,get from PHY) -+ NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; -+ NDIS_802_11_CONFIGURATION Configuration; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; -+ NDIS_802_11_RATES_EX SupportedRates; -+ WLAN_PHY_INFO PhyInfo; -+ u32 IELength; -+ u8 IEs[MAX_IE_SZ]; //(timestamp, beacon interval, and capability information) -+} -+__attribute__((packed)) -+WLAN_BSSID_EX, *PWLAN_BSSID_EX; -+ -+__inline static uint get_WLAN_BSSID_EX_sz(WLAN_BSSID_EX *bss) -+{ -+ return (sizeof(WLAN_BSSID_EX) -MAX_IE_SZ + bss->IELength); -+} -+ -+struct wlan_network { -+ _list list; -+ int network_type; //refer to ieee80211.h for WIRELESS_11A/B/G -+ int fixed; // set to fixed when not to be removed as site-surveying -+ unsigned long last_scanned; //timestamp for the network -+ int aid; //will only be valid when a BSS is joinned. -+ int join_res; -+ WLAN_BSSID_EX network; //must be the last item -+ WLAN_BCN_INFO BcnInfo; -+}; -+ -+enum VRTL_CARRIER_SENSE -+{ -+ DISABLE_VCS, -+ ENABLE_VCS, -+ AUTO_VCS -+}; -+ -+enum VCS_TYPE -+{ -+ NONE_VCS, -+ RTS_CTS, -+ CTS_TO_SELF -+}; -+ -+ -+ -+ -+#define PWR_CAM 0 -+#define PWR_MINPS 1 -+#define PWR_MAXPS 2 -+#define PWR_UAPSD 3 -+#define PWR_VOIP 4 -+ -+ -+enum UAPSD_MAX_SP -+{ -+ NO_LIMIT, -+ TWO_MSDU, -+ FOUR_MSDU, -+ SIX_MSDU -+}; -+ -+ -+//john -+#define NUM_PRE_AUTH_KEY 16 -+#define NUM_PMKID_CACHE NUM_PRE_AUTH_KEY -+ -+/* -+* WPA2 -+*/ -+ -+typedef struct _PMKID_CANDIDATE { -+ NDIS_802_11_MAC_ADDRESS BSSID; -+ u32 Flags; -+} PMKID_CANDIDATE, *PPMKID_CANDIDATE; -+ -+typedef struct _NDIS_802_11_PMKID_CANDIDATE_LIST -+{ -+ u32 Version; // Version of the structure -+ u32 NumCandidates; // No. of pmkid candidates -+ PMKID_CANDIDATE CandidateList[1]; -+} NDIS_802_11_PMKID_CANDIDATE_LIST, *PNDIS_802_11_PMKID_CANDIDATE_LIST; -+ -+ -+typedef struct _NDIS_802_11_AUTHENTICATION_ENCRYPTION -+{ -+ NDIS_802_11_AUTHENTICATION_MODE AuthModeSupported; -+ NDIS_802_11_ENCRYPTION_STATUS EncryptStatusSupported; -+ -+} NDIS_802_11_AUTHENTICATION_ENCRYPTION, *PNDIS_802_11_AUTHENTICATION_ENCRYPTION; -+ -+typedef struct _NDIS_802_11_CAPABILITY -+{ -+ u32 Length; -+ u32 Version; -+ u32 NoOfPMKIDs; -+ u32 NoOfAuthEncryptPairsSupported; -+ NDIS_802_11_AUTHENTICATION_ENCRYPTION AuthenticationEncryptionSupported[1]; -+ -+} NDIS_802_11_CAPABILITY, *PNDIS_802_11_CAPABILITY; -+ -+ -+#endif //#ifndef WLAN_BSSDEF_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/include/xmit_osdep.h linux-4.14.17-3rd/3rdparty/rtl8812au/include/xmit_osdep.h ---- linux-4.14.17/3rdparty/rtl8812au/include/xmit_osdep.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/include/xmit_osdep.h 2018-02-06 17:42:30.722967342 +0200 -@@ -0,0 +1,53 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#ifndef __XMIT_OSDEP_H_ -+#define __XMIT_OSDEP_H_ -+ -+ -+struct pkt_file { -+ _pkt *pkt; -+ SIZE_T pkt_len; //the remainder length of the open_file -+ _buffer *cur_buffer; -+ u8 *buf_start; -+ u8 *cur_addr; -+ SIZE_T buf_len; -+}; -+ -+#define NR_XMITFRAME 256 -+ -+struct xmit_priv; -+struct pkt_attrib; -+struct sta_xmit_priv; -+struct xmit_frame; -+struct xmit_buf; -+ -+extern int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev); -+ -+void rtw_os_xmit_schedule(_adapter *padapter); -+ -+int rtw_os_xmit_resource_alloc(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 alloc_sz, u8 flag); -+void rtw_os_xmit_resource_free(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 free_sz, u8 flag); -+ -+extern void rtw_set_tx_chksum_offload(_pkt *pkt, struct pkt_attrib *pattrib); -+ -+extern uint rtw_remainder_len(struct pkt_file *pfile); -+extern void _rtw_open_pktfile(_pkt *pkt, struct pkt_file *pfile); -+extern uint _rtw_pktfile_read (struct pkt_file *pfile, u8 *rmem, uint rlen); -+extern sint rtw_endofpktfile (struct pkt_file *pfile); -+ -+extern void rtw_os_pkt_complete(_adapter *padapter, _pkt *pkt); -+extern void rtw_os_xmit_complete(_adapter *padapter, struct xmit_frame *pxframe); -+ -+#endif //__XMIT_OSDEP_H_ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/Kconfig linux-4.14.17-3rd/3rdparty/rtl8812au/Kconfig ---- linux-4.14.17/3rdparty/rtl8812au/Kconfig 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/Kconfig 2018-02-06 17:42:30.692966898 +0200 -@@ -0,0 +1,6 @@ -+config RTL8812AU -+ tristate "Realtek 8812 USB WiFi" -+ depends on USB -+ ---help--- -+ Help message of RTL8812AU -+ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/Makefile linux-4.14.17-3rd/3rdparty/rtl8812au/Makefile ---- linux-4.14.17/3rdparty/rtl8812au/Makefile 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/Makefile 2018-02-06 17:42:30.692966898 +0200 -@@ -0,0 +1,276 @@ -+EXTRA_CFLAGS += $(USER_EXTRA_CFLAGS) -+EXTRA_CFLAGS += -O1 -+#EXTRA_CFLAGS += -O3 -+#EXTRA_CFLAGS += -Wall -+#EXTRA_CFLAGS += -Wextra -+#EXTRA_CFLAGS += -Werror -+#EXTRA_CFLAGS += -pedantic -+#EXTRA_CFLAGS += -Wshadow -Wpointer-arith -Wcast-qual -Wstrict-prototypes -Wmissing-prototypes -+ -+EXTRA_CFLAGS += -Wno-unused-variable -+EXTRA_CFLAGS += -Wno-unused-value -+EXTRA_CFLAGS += -Wno-unused-label -+EXTRA_CFLAGS += -Wno-unused-parameter -+EXTRA_CFLAGS += -Wno-unused-function -+EXTRA_CFLAGS += -Wno-unused -+ -+EXTRA_CFLAGS += -Wno-uninitialized -+EXTRA_CFLAGS += -Wno-int-to-pointer-cast -+ -+EXTRA_CFLAGS += -I$(src)/include -+ -+CONFIG_AUTOCFG_CP = n -+ -+CONFIG_MULTIDRV = n -+ -+CONFIG_USB_HCI = y -+CONFIG_PCI_HCI = n -+CONFIG_SDIO_HCI = n -+CONFIG_GSPI_HCI = n -+ -+CONFIG_MP_INCLUDED = y -+CONFIG_POWER_SAVING = y -+CONFIG_USB_AUTOSUSPEND = n -+CONFIG_HW_PWRP_DETECTION = n -+CONFIG_WIFI_TEST = n -+CONFIG_BT_COEXIST = n -+CONFIG_INTEL_WIDI = n -+CONFIG_WAPI_SUPPORT = n -+CONFIG_EFUSE_CONFIG_FILE = n -+CONFIG_EXT_CLK = n -+CONFIG_FTP_PROTECT = n -+CONFIG_WOWLAN = n -+ -+CONFIG_DRVEXT_MODULE = n -+ -+export TopDIR ?= $(shell pwd) -+ -+########### COMMON ################################# -+HCI_NAME = usb -+ -+ -+ -+_OS_INTFS_FILES := os_dep/osdep_service.o \ -+ os_dep/os_intfs.o \ -+ os_dep/usb_intf.o \ -+ os_dep/usb_ops_linux.o \ -+ os_dep/ioctl_linux.o \ -+ os_dep/xmit_linux.o \ -+ os_dep/mlme_linux.o \ -+ os_dep/recv_linux.o \ -+ os_dep/ioctl_cfg80211.o \ -+ os_dep/rtw_android.o -+ -+_HAL_INTFS_FILES := hal/hal_intf.o \ -+ hal/hal_com.o \ -+ hal/hal_com_phycfg.o \ -+ hal/hal_phy.o \ -+ hal/hal_usb_led.o -+ -+_OUTSRC_FILES := hal/odm_debug.o \ -+ hal/odm_interface.o\ -+ hal/odm_HWConfig.o\ -+ hal/odm.o\ -+ hal/HalPhyRf.o -+ -+ -+########### HAL_RTL8812A_RTL8821A ################################# -+ -+rtl8812a = rtl8812a -+MODULE_NAME = 8812au -+ -+_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ -+ hal/Hal8812PwrSeq.o \ -+ hal/Hal8821APwrSeq.o\ -+ hal/$(rtl8812a)_xmit.o\ -+ hal/$(rtl8812a)_sreset.o -+ -+_HAL_INTFS_FILES += hal/$(rtl8812a)_hal_init.o \ -+ hal/$(rtl8812a)_phycfg.o \ -+ hal/$(rtl8812a)_rf6052.o \ -+ hal/$(rtl8812a)_dm.o \ -+ hal/$(rtl8812a)_rxdesc.o \ -+ hal/$(rtl8812a)_cmd.o \ -+ hal/usb_halinit.o \ -+ hal/rtl$(MODULE_NAME)_led.o \ -+ hal/rtl$(MODULE_NAME)_xmit.o \ -+ hal/rtl$(MODULE_NAME)_recv.o -+ -+_HAL_INTFS_FILES += hal/usb_ops_linux.o -+ -+ifeq ($(CONFIG_MP_INCLUDED), y) -+_HAL_INTFS_FILES += hal/$(rtl8812a)_mp.o -+endif -+ -+_OUTSRC_FILES += hal/HalHWImg8812A_FW.o\ -+ hal/HalHWImg8812A_MAC.o\ -+ hal/HalHWImg8812A_BB.o\ -+ hal/HalHWImg8812A_RF.o\ -+ hal/HalHWImg8812A_TestChip_FW.o\ -+ hal/HalHWImg8812A_TestChip_MAC.o\ -+ hal/HalHWImg8812A_TestChip_BB.o\ -+ hal/HalHWImg8812A_TestChip_RF.o\ -+ hal/HalPhyRf_8812A.o\ -+ hal/odm_RegConfig8812A.o -+ -+_OUTSRC_FILES += hal/HalHWImg8821A_FW.o\ -+ hal/HalHWImg8821A_MAC.o\ -+ hal/HalHWImg8821A_BB.o\ -+ hal/HalHWImg8821A_RF.o\ -+ hal/HalHWImg8821A_TestChip_MAC.o\ -+ hal/HalHWImg8821A_TestChip_BB.o\ -+ hal/HalHWImg8821A_TestChip_RF.o\ -+ hal/HalPhyRf_8812A.o\ -+ hal/HalPhyRf_8821A.o\ -+ hal/odm_RegConfig8821A.o -+ -+########### AUTO_CFG ################################# -+ -+ifeq ($(CONFIG_AUTOCFG_CP), y) -+ -+ifeq ($(CONFIG_MULTIDRV), y) -+$(shell cp $(TopDIR)/autoconf_multidrv_usb_linux.h $(TopDIR)/include/autoconf.h) -+else -+$(shell cp $(TopDIR)/autoconf_$(rtl8812a)_usb_linux.h $(TopDIR)/include/autoconf.h) -+endif -+ -+endif -+ -+########### END OF PATH ################################# -+ -+ -+ifeq ($(CONFIG_USB_AUTOSUSPEND), y) -+EXTRA_CFLAGS += -DCONFIG_USB_AUTOSUSPEND -+endif -+ -+ifeq ($(CONFIG_MP_INCLUDED), y) -+#MODULE_NAME := $(MODULE_NAME)_mp -+EXTRA_CFLAGS += -DCONFIG_MP_INCLUDED -+endif -+ -+ifeq ($(CONFIG_POWER_SAVING), y) -+EXTRA_CFLAGS += -DCONFIG_POWER_SAVING -+endif -+ -+ifeq ($(CONFIG_HW_PWRP_DETECTION), y) -+EXTRA_CFLAGS += -DCONFIG_HW_PWRP_DETECTION -+endif -+ -+ifeq ($(CONFIG_WIFI_TEST), y) -+EXTRA_CFLAGS += -DCONFIG_WIFI_TEST -+endif -+ -+ifeq ($(CONFIG_BT_COEXIST), y) -+EXTRA_CFLAGS += -DCONFIG_BT_COEXIST -+endif -+ -+ifeq ($(CONFIG_INTEL_WIDI), y) -+EXTRA_CFLAGS += -DCONFIG_INTEL_WIDI -+endif -+ -+ifeq ($(CONFIG_WAPI_SUPPORT), y) -+EXTRA_CFLAGS += -DCONFIG_WAPI_SUPPORT -+endif -+ -+ifeq ($(CONFIG_EFUSE_CONFIG_FILE), y) -+EXTRA_CFLAGS += -DCONFIG_EFUSE_CONFIG_FILE -+endif -+ -+ifeq ($(CONFIG_EXT_CLK), y) -+EXTRA_CFLAGS += -DCONFIG_EXT_CLK -+endif -+ -+ifeq ($(CONFIG_FTP_PROTECT), y) -+EXTRA_CFLAGS += -DCONFIG_FTP_PROTECT -+endif -+ -+SUBARCH := $(shell uname -m | sed -e s/i.86/i386/) -+ARCH ?= $(SUBARCH) -+CROSS_COMPILE ?= -+KVER := $(shell uname -r) -+KSRC := /lib/modules/$(KVER)/build -+MODDESTDIR := /lib/modules/$(KVER)/kernel/drivers/net/wireless/ -+INSTALL_PREFIX := -+ -+ifneq ($(USER_MODULE_NAME),) -+MODULE_NAME := $(USER_MODULE_NAME) -+endif -+ -+ifneq ($(KERNELRELEASE),) -+ -+rtk_core := core/rtw_cmd.o \ -+ core/rtw_security.o \ -+ core/rtw_debug.o \ -+ core/rtw_io.o \ -+ core/rtw_ioctl_query.o \ -+ core/rtw_ioctl_set.o \ -+ core/rtw_ieee80211.o \ -+ core/rtw_mlme.o \ -+ core/rtw_mlme_ext.o \ -+ core/rtw_wlan_util.o \ -+ core/rtw_vht.o \ -+ core/rtw_pwrctrl.o \ -+ core/rtw_rf.o \ -+ core/rtw_recv.o \ -+ core/rtw_sta_mgt.o \ -+ core/rtw_ap.o \ -+ core/rtw_xmit.o \ -+ core/rtw_p2p.o \ -+ core/rtw_tdls.o \ -+ core/rtw_br_ext.o \ -+ core/rtw_iol.o \ -+ core/rtw_sreset.o\ -+ core/efuse/rtw_efuse.o -+ -+$(MODULE_NAME)-y += $(rtk_core) -+ -+$(MODULE_NAME)-$(CONFIG_INTEL_WIDI) += core/rtw_intel_widi.o -+ -+$(MODULE_NAME)-$(CONFIG_WAPI_SUPPORT) += core/rtw_wapi.o \ -+ core/rtw_wapi_sms4.o -+ -+$(MODULE_NAME)-y += $(_OS_INTFS_FILES) -+$(MODULE_NAME)-y += $(_HAL_INTFS_FILES) -+$(MODULE_NAME)-y += $(_OUTSRC_FILES) -+ -+$(MODULE_NAME)-$(CONFIG_MP_INCLUDED) += core/rtw_mp.o \ -+ core/rtw_mp_ioctl.o -+ -+obj-m := $(MODULE_NAME).o -+ -+else -+ -+all: modules -+ -+modules: -+ $(MAKE) CROSS_COMPILE=$(CROSS_COMPILE) -C $(KSRC) M=$(shell pwd) modules -+ -+strip: -+ $(CROSS_COMPILE)strip $(MODULE_NAME).ko --strip-unneeded -+ -+install: -+ install -p -m 644 $(MODULE_NAME).ko $(MODDESTDIR) -+ /sbin/depmod -a ${KVER} -+ -+uninstall: -+ rm -f $(MODDESTDIR)/$(MODULE_NAME).ko -+ /sbin/depmod -a ${KVER} -+ -+config_r: -+ @echo "make config" -+ /bin/bash script/Configure script/config.in -+ -+.PHONY: modules clean -+ -+clean: -+ cd hal ; rm -fr */*.mod.c */*.mod */*.o */.*.cmd */*.ko -+ cd hal ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ cd core/efuse ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ cd core ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ cd os_dep/linux ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ cd os_dep ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko -+ rm -fr Module.symvers ; rm -fr Module.markers ; rm -fr modules.order -+ rm -fr *.mod.c *.mod *.o .*.cmd *.ko *~ -+ rm -fr .tmp_versions -+endif -+ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/custom_gpio_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/custom_gpio_linux.c ---- linux-4.14.17/3rdparty/rtl8812au/os_dep/custom_gpio_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/custom_gpio_linux.c 2018-02-06 17:42:30.722967342 +0200 -@@ -0,0 +1,25 @@ -+/****************************************************************************** -+ * Customer code to add GPIO control during WLAN start/stop -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#include "drv_types.h" -+ -+int rtw_wifi_gpio_init(void) -+{ -+ return 0; -+} -+ -+void rtw_wifi_gpio_wlan_ctrl(int onoff) -+{ -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/ioctl_cfg80211.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/ioctl_cfg80211.c ---- linux-4.14.17/3rdparty/rtl8812au/os_dep/ioctl_cfg80211.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/ioctl_cfg80211.c 2018-02-06 17:42:30.723967357 +0200 -@@ -0,0 +1,5346 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _IOCTL_CFG80211_C_ -+ -+#include -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ -+#define RTW_MAX_MGMT_TX_CNT (8) -+ -+#define RTW_SCAN_IE_LEN_MAX 2304 -+#define RTW_MAX_REMAIN_ON_CHANNEL_DURATION 65535 //ms -+#define RTW_MAX_NUM_PMKIDS 4 -+ -+#define RTW_CH_MAX_2G_CHANNEL 14 /* Max channel in 2G band */ -+ -+static const u32 rtw_cipher_suites[] = { -+ WLAN_CIPHER_SUITE_WEP40, -+ WLAN_CIPHER_SUITE_WEP104, -+ WLAN_CIPHER_SUITE_TKIP, -+ WLAN_CIPHER_SUITE_CCMP, -+#ifdef CONFIG_WAPI_SUPPORT -+ WLAN_CIPHER_SUITE_SMS4, -+#endif // CONFIG_WAPI_SUPPORT -+}; -+ -+#define RATETAB_ENT(_rate, _rateid, _flags) \ -+ { \ -+ .bitrate = (_rate), \ -+ .hw_value = (_rateid), \ -+ .flags = (_flags), \ -+ } -+ -+#define CHAN2G(_channel, _freq, _flags) { \ -+ .band = IEEE80211_BAND_2GHZ, \ -+ .center_freq = (_freq), \ -+ .hw_value = (_channel), \ -+ .flags = (_flags), \ -+ .max_antenna_gain = 0, \ -+ .max_power = 30, \ -+} -+ -+#define CHAN5G(_channel, _flags) { \ -+ .band = IEEE80211_BAND_5GHZ, \ -+ .center_freq = 5000 + (5 * (_channel)), \ -+ .hw_value = (_channel), \ -+ .flags = (_flags), \ -+ .max_antenna_gain = 0, \ -+ .max_power = 30, \ -+} -+ -+static struct ieee80211_rate rtw_rates[] = { -+ RATETAB_ENT(10, 0x1, 0), -+ RATETAB_ENT(20, 0x2, 0), -+ RATETAB_ENT(55, 0x4, 0), -+ RATETAB_ENT(110, 0x8, 0), -+ RATETAB_ENT(60, 0x10, 0), -+ RATETAB_ENT(90, 0x20, 0), -+ RATETAB_ENT(120, 0x40, 0), -+ RATETAB_ENT(180, 0x80, 0), -+ RATETAB_ENT(240, 0x100, 0), -+ RATETAB_ENT(360, 0x200, 0), -+ RATETAB_ENT(480, 0x400, 0), -+ RATETAB_ENT(540, 0x800, 0), -+}; -+ -+#define rtw_a_rates (rtw_rates + 4) -+#define RTW_A_RATES_NUM 8 -+#define rtw_g_rates (rtw_rates + 0) -+#define RTW_G_RATES_NUM 12 -+ -+#define RTW_2G_CHANNELS_NUM 14 -+#define RTW_5G_CHANNELS_NUM 37 -+ -+static struct ieee80211_channel rtw_2ghz_channels[] = { -+ CHAN2G(1, 2412, 0), -+ CHAN2G(2, 2417, 0), -+ CHAN2G(3, 2422, 0), -+ CHAN2G(4, 2427, 0), -+ CHAN2G(5, 2432, 0), -+ CHAN2G(6, 2437, 0), -+ CHAN2G(7, 2442, 0), -+ CHAN2G(8, 2447, 0), -+ CHAN2G(9, 2452, 0), -+ CHAN2G(10, 2457, 0), -+ CHAN2G(11, 2462, 0), -+ CHAN2G(12, 2467, 0), -+ CHAN2G(13, 2472, 0), -+ CHAN2G(14, 2484, 0), -+}; -+ -+static struct ieee80211_channel rtw_5ghz_a_channels[] = { -+ CHAN5G(34, 0), CHAN5G(36, 0), -+ CHAN5G(38, 0), CHAN5G(40, 0), -+ CHAN5G(42, 0), CHAN5G(44, 0), -+ CHAN5G(46, 0), CHAN5G(48, 0), -+ CHAN5G(52, 0), CHAN5G(56, 0), -+ CHAN5G(60, 0), CHAN5G(64, 0), -+ CHAN5G(100, 0), CHAN5G(104, 0), -+ CHAN5G(108, 0), CHAN5G(112, 0), -+ CHAN5G(116, 0), CHAN5G(120, 0), -+ CHAN5G(124, 0), CHAN5G(128, 0), -+ CHAN5G(132, 0), CHAN5G(136, 0), -+ CHAN5G(140, 0), CHAN5G(149, 0), -+ CHAN5G(153, 0), CHAN5G(157, 0), -+ CHAN5G(161, 0), CHAN5G(165, 0), -+ CHAN5G(184, 0), CHAN5G(188, 0), -+ CHAN5G(192, 0), CHAN5G(196, 0), -+ CHAN5G(200, 0), CHAN5G(204, 0), -+ CHAN5G(208, 0), CHAN5G(212, 0), -+ CHAN5G(216, 0), -+}; -+ -+ -+void rtw_2g_channels_init(struct ieee80211_channel *channels) -+{ -+ _rtw_memcpy((void*)channels, (void*)rtw_2ghz_channels, -+ sizeof(struct ieee80211_channel)*RTW_2G_CHANNELS_NUM -+ ); -+} -+ -+void rtw_5g_channels_init(struct ieee80211_channel *channels) -+{ -+ _rtw_memcpy((void*)channels, (void*)rtw_5ghz_a_channels, -+ sizeof(struct ieee80211_channel)*RTW_5G_CHANNELS_NUM -+ ); -+} -+ -+void rtw_2g_rates_init(struct ieee80211_rate *rates) -+{ -+ _rtw_memcpy(rates, rtw_g_rates, -+ sizeof(struct ieee80211_rate)*RTW_G_RATES_NUM -+ ); -+} -+ -+void rtw_5g_rates_init(struct ieee80211_rate *rates) -+{ -+ _rtw_memcpy(rates, rtw_a_rates, -+ sizeof(struct ieee80211_rate)*RTW_A_RATES_NUM -+ ); -+} -+ -+struct ieee80211_supported_band *rtw_spt_band_alloc( -+ enum ieee80211_band band -+ ) -+{ -+ struct ieee80211_supported_band *spt_band = NULL; -+ int n_channels, n_bitrates; -+ -+ if(band == IEEE80211_BAND_2GHZ) -+ { -+ n_channels = RTW_2G_CHANNELS_NUM; -+ n_bitrates = RTW_G_RATES_NUM; -+ } -+ else if(band == IEEE80211_BAND_5GHZ) -+ { -+ n_channels = RTW_5G_CHANNELS_NUM; -+ n_bitrates = RTW_A_RATES_NUM; -+ } -+ else -+ { -+ goto exit; -+ } -+ -+ spt_band = (struct ieee80211_supported_band *)rtw_zmalloc( -+ sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel)*n_channels -+ + sizeof(struct ieee80211_rate)*n_bitrates -+ ); -+ if(!spt_band) -+ goto exit; -+ -+ spt_band->channels = (struct ieee80211_channel*)(((u8*)spt_band)+sizeof(struct ieee80211_supported_band)); -+ spt_band->bitrates= (struct ieee80211_rate*)(((u8*)spt_band->channels)+sizeof(struct ieee80211_channel)*n_channels); -+ spt_band->band = band; -+ spt_band->n_channels = n_channels; -+ spt_band->n_bitrates = n_bitrates; -+ -+ if(band == IEEE80211_BAND_2GHZ) -+ { -+ rtw_2g_channels_init(spt_band->channels); -+ rtw_2g_rates_init(spt_band->bitrates); -+ } -+ else if(band == IEEE80211_BAND_5GHZ) -+ { -+ rtw_5g_channels_init(spt_band->channels); -+ rtw_5g_rates_init(spt_band->bitrates); -+ } -+ -+ //spt_band.ht_cap -+ -+exit: -+ -+ return spt_band; -+} -+ -+void rtw_spt_band_free(struct ieee80211_supported_band *spt_band) -+{ -+ u32 size; -+ -+ if(!spt_band) -+ return; -+ -+ if(spt_band->band == IEEE80211_BAND_2GHZ) -+ { -+ size = sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel)*RTW_2G_CHANNELS_NUM -+ + sizeof(struct ieee80211_rate)*RTW_G_RATES_NUM; -+ } -+ else if(spt_band->band == IEEE80211_BAND_5GHZ) -+ { -+ size = sizeof(struct ieee80211_supported_band) -+ + sizeof(struct ieee80211_channel)*RTW_5G_CHANNELS_NUM -+ + sizeof(struct ieee80211_rate)*RTW_A_RATES_NUM; -+ } -+ else -+ { -+ -+ } -+ rtw_mfree((u8*)spt_band, size); -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+static const struct ieee80211_txrx_stypes -+rtw_cfg80211_default_mgmt_stypes[NUM_NL80211_IFTYPES] = { -+ [NL80211_IFTYPE_ADHOC] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+ [NL80211_IFTYPE_STATION] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) -+ }, -+ [NL80211_IFTYPE_AP] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | -+ BIT(IEEE80211_STYPE_DISASSOC >> 4) | -+ BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_DEAUTH >> 4) | -+ BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+ [NL80211_IFTYPE_AP_VLAN] = { -+ /* copy AP */ -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | -+ BIT(IEEE80211_STYPE_DISASSOC >> 4) | -+ BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_DEAUTH >> 4) | -+ BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+ [NL80211_IFTYPE_P2P_CLIENT] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) -+ }, -+ [NL80211_IFTYPE_P2P_GO] = { -+ .tx = 0xffff, -+ .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | -+ BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | -+ BIT(IEEE80211_STYPE_DISASSOC >> 4) | -+ BIT(IEEE80211_STYPE_AUTH >> 4) | -+ BIT(IEEE80211_STYPE_DEAUTH >> 4) | -+ BIT(IEEE80211_STYPE_ACTION >> 4) -+ }, -+}; -+#endif -+ -+static int rtw_ieee80211_channel_to_frequency(int chan, int band) -+{ -+ /* see 802.11 17.3.8.3.2 and Annex J -+ * there are overlapping channel numbers in 5GHz and 2GHz bands */ -+ -+ if (band == IEEE80211_BAND_5GHZ) { -+ if (chan >= 182 && chan <= 196) -+ return 4000 + chan * 5; -+ else -+ return 5000 + chan * 5; -+ } else { /* IEEE80211_BAND_2GHZ */ -+ if (chan == 14) -+ return 2484; -+ else if (chan < 14) -+ return 2407 + chan * 5; -+ else -+ return 0; /* not supported */ -+ } -+} -+ -+#define MAX_BSSINFO_LEN 1000 -+static int rtw_cfg80211_inform_bss(_adapter *padapter, struct wlan_network *pnetwork) -+{ -+ int ret=0; -+ struct ieee80211_channel *notify_channel; -+ struct cfg80211_bss *bss; -+ //struct ieee80211_supported_band *band; -+ u16 channel; -+ u32 freq; -+ u64 notify_timestamp; -+ u16 notify_capability; -+ u16 notify_interval; -+ u8 *notify_ie; -+ size_t notify_ielen; -+ s32 notify_signal; -+ u8 buf[MAX_BSSINFO_LEN], *pbuf; -+ size_t len,bssinf_len=0; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ -+ struct wireless_dev *wdev = padapter->rtw_wdev; -+ struct wiphy *wiphy = wdev->wiphy; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ -+ //DBG_8192C("%s\n", __func__); -+ -+ bssinf_len = pnetwork->network.IELength+sizeof (struct rtw_ieee80211_hdr_3addr); -+ if(bssinf_len > MAX_BSSINFO_LEN){ -+ DBG_871X("%s IE Length too long > %d byte \n",__FUNCTION__,MAX_BSSINFO_LEN); -+ goto exit; -+ } -+ -+ channel = pnetwork->network.Configuration.DSConfig; -+ if (channel <= RTW_CH_MAX_2G_CHANNEL) -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); -+ else -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); -+ -+ notify_channel = ieee80211_get_channel(wiphy, freq); -+ -+ //rtw_get_timestampe_from_ie() -+ notify_timestamp = jiffies_to_msecs(jiffies)*1000; /* uSec */ -+ -+ notify_interval = le16_to_cpu(*(u16*)rtw_get_beacon_interval_from_ie(pnetwork->network.IEs)); -+ notify_capability = le16_to_cpu(*(u16*)rtw_get_capability_from_ie(pnetwork->network.IEs)); -+ -+ -+ notify_ie = pnetwork->network.IEs+_FIXED_IE_LENGTH_; -+ notify_ielen = pnetwork->network.IELength-_FIXED_IE_LENGTH_; -+ -+ //We've set wiphy's signal_type as CFG80211_SIGNAL_TYPE_MBM: signal strength in mBm (100*dBm) -+ if ( check_fwstate(pmlmepriv, _FW_LINKED)== true && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network)) { -+ notify_signal = 100*translate_percentage_to_dbm(padapter->recvpriv.signal_strength);//dbm -+ } else { -+ notify_signal = 100*translate_percentage_to_dbm(pnetwork->network.PhyInfo.SignalStrength);//dbm -+ } -+ -+/* -+ DBG_8192C("bssid: %2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X\n", -+ pnetwork->network.MacAddress[0], pnetwork->network.MacAddress[1], pnetwork->network.MacAddress[2], -+ pnetwork->network.MacAddress[3], pnetwork->network.MacAddress[4], pnetwork->network.MacAddress[5]); -+ DBG_8192C("Channel: %d(%d)\n", channel, freq); -+ DBG_8192C("Capability: %X\n", notify_capability); -+ DBG_8192C("Beacon interval: %d\n", notify_interval); -+ DBG_8192C("Signal: %d\n", notify_signal); -+ DBG_8192C("notify_timestamp: %#018llx\n", notify_timestamp); -+*/ -+ -+ pbuf = buf; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pbuf; -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); -+ //pmlmeext->mgnt_seq++; -+ -+ if (pnetwork->network.Reserved[0] == 1) { // WIFI_BEACON -+ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); -+ SetFrameSubType(pbuf, WIFI_BEACON); -+ } else { -+ _rtw_memcpy(pwlanhdr->addr1, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ SetFrameSubType(pbuf, WIFI_PROBERSP); -+ } -+ -+ _rtw_memcpy(pwlanhdr->addr2, pnetwork->network.MacAddress, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pnetwork->network.MacAddress, ETH_ALEN); -+ -+ -+ pbuf += sizeof(struct rtw_ieee80211_hdr_3addr); -+ len = sizeof (struct rtw_ieee80211_hdr_3addr); -+ -+ _rtw_memcpy(pbuf, pnetwork->network.IEs, pnetwork->network.IELength); -+ len += pnetwork->network.IELength; -+ -+ //#ifdef CONFIG_P2P -+ //if(rtw_get_p2p_ie(pnetwork->network.IEs+12, pnetwork->network.IELength-12, NULL, NULL)) -+ //{ -+ // DBG_8192C("%s, got p2p_ie\n", __func__); -+ //} -+ //#endif -+ -+ -+#if 1 -+ bss = cfg80211_inform_bss_frame(wiphy, notify_channel, (struct ieee80211_mgmt *)buf, -+ len, notify_signal, GFP_ATOMIC); -+#else -+ -+ bss = cfg80211_inform_bss(wiphy, notify_channel, (const u8 *)pnetwork->network.MacAddress, -+ notify_timestamp, notify_capability, notify_interval, notify_ie, -+ notify_ielen, notify_signal, GFP_ATOMIC/*GFP_KERNEL*/); -+#endif -+ -+ if (unlikely(!bss)) { -+ DBG_8192C("rtw_cfg80211_inform_bss error\n"); -+ return -EINVAL; -+ } -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)) -+#ifndef COMPAT_KERNEL_RELEASE -+ //patch for cfg80211, update beacon ies to information_elements -+ if (pnetwork->network.Reserved[0] == 1) { // WIFI_BEACON -+ -+ if(bss->len_information_elements != bss->len_beacon_ies) -+ { -+ bss->information_elements = bss->beacon_ies; -+ bss->len_information_elements = bss->len_beacon_ies; -+ } -+ } -+#endif //COMPAT_KERNEL_RELEASE -+#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38) -+ -+/* -+ { -+ if( bss->information_elements == bss->proberesp_ies) -+ { -+ if( bss->len_information_elements != bss->len_proberesp_ies) -+ { -+ DBG_8192C("error!, len_information_elements != bss->len_proberesp_ies\n"); -+ } -+ -+ } -+ else if(bss->len_information_elements < bss->len_beacon_ies) -+ { -+ bss->information_elements = bss->beacon_ies; -+ bss->len_information_elements = bss->len_beacon_ies; -+ } -+ } -+*/ -+ -+ cfg80211_put_bss(bss); -+ -+exit: -+ return ret; -+ -+} -+ -+void rtw_cfg80211_indicate_connect(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif -+ -+ -+ DBG_8192C("%s(padapter=%p)\n", __func__, padapter); -+ -+ if (pwdev->iftype != NL80211_IFTYPE_STATION -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ && pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT -+ #endif -+ ) { -+ return; -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ return; -+ -+#ifdef CONFIG_P2P -+ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ DBG_8192C("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); -+ } -+ } -+#endif //CONFIG_P2P -+ -+ #ifdef CONFIG_LAYER2_ROAMING -+ if (rtw_to_roaming(padapter) > 0) { -+ #if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 39) || defined(COMPAT_KERNEL_RELEASE) -+ struct wiphy *wiphy = pwdev->wiphy; -+ struct ieee80211_channel *notify_channel; -+ u32 freq; -+ u16 channel = cur_network->network.Configuration.DSConfig; -+ -+ if (channel <= RTW_CH_MAX_2G_CHANNEL) -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); -+ else -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); -+ -+ notify_channel = ieee80211_get_channel(wiphy, freq); -+ #endif -+ -+ DBG_871X("%s call cfg80211_roamed\n", __FUNCTION__); -+ cfg80211_roamed(padapter->pnetdev -+ #if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 39) || defined(COMPAT_KERNEL_RELEASE) -+ , notify_channel -+ #endif -+ , cur_network->network.MacAddress -+ , pmlmepriv->assoc_req+sizeof(struct rtw_ieee80211_hdr_3addr)+2 -+ , pmlmepriv->assoc_req_len-sizeof(struct rtw_ieee80211_hdr_3addr)-2 -+ , pmlmepriv->assoc_rsp+sizeof(struct rtw_ieee80211_hdr_3addr)+6 -+ , pmlmepriv->assoc_rsp_len-sizeof(struct rtw_ieee80211_hdr_3addr)-6 -+ , GFP_ATOMIC); -+ } -+ else -+ #endif -+ { -+ DBG_8192C("pwdev->sme_state(b)=%d\n", pwdev->sme_state); -+ cfg80211_connect_result(padapter->pnetdev, cur_network->network.MacAddress -+ , pmlmepriv->assoc_req+sizeof(struct rtw_ieee80211_hdr_3addr)+2 -+ , pmlmepriv->assoc_req_len-sizeof(struct rtw_ieee80211_hdr_3addr)-2 -+ , pmlmepriv->assoc_rsp+sizeof(struct rtw_ieee80211_hdr_3addr)+6 -+ , pmlmepriv->assoc_rsp_len-sizeof(struct rtw_ieee80211_hdr_3addr)-6 -+ , WLAN_STATUS_SUCCESS, GFP_ATOMIC); -+ DBG_8192C("pwdev->sme_state(a)=%d\n", pwdev->sme_state); -+ } -+} -+ -+void rtw_cfg80211_indicate_disconnect(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif -+ -+ DBG_8192C("%s(padapter=%p)\n", __func__, padapter); -+ -+ if (pwdev->iftype != NL80211_IFTYPE_STATION -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ && pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT -+ #endif -+ ) { -+ return; -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ return; -+ -+#ifdef CONFIG_P2P -+ if( pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ _cancel_timer_ex( &pwdinfo->find_phase_timer ); -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ _cancel_timer_ex( &pwdinfo->pre_tx_scan_timer); -+ -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ -+ DBG_8192C("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); -+ } -+ } -+#endif //CONFIG_P2P -+ -+ if (!padapter->mlmepriv.not_indic_disco) { -+ DBG_8192C("pwdev->sme_state(b)=%d\n", pwdev->sme_state); -+ -+ if(pwdev->sme_state==CFG80211_SME_CONNECTING) -+ cfg80211_connect_result(padapter->pnetdev, NULL, NULL, 0, NULL, 0, -+ WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC/*GFP_KERNEL*/); -+ else if(pwdev->sme_state==CFG80211_SME_CONNECTED) -+ cfg80211_disconnected(padapter->pnetdev, 0, NULL, 0, GFP_ATOMIC); -+ //else -+ //DBG_8192C("pwdev->sme_state=%d\n", pwdev->sme_state); -+ -+ DBG_8192C("pwdev->sme_state(a)=%d\n", pwdev->sme_state); -+ } -+} -+ -+ -+#ifdef CONFIG_AP_MODE -+static int rtw_cfg80211_ap_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len,wep_total_len; -+ struct sta_info *psta = NULL, *pbcmc_sta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_8192C("%s\n", __FUNCTION__); -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ //sizeof(struct ieee_param) = 64 bytes; -+ //if (param_len != (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) -+ if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ if (param->u.crypt.idx >= WEP_KEYS) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ else -+ { -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if(!psta) -+ { -+ //ret = -EINVAL; -+ DBG_8192C("rtw_set_encryption(), sta has already been removed or never been added\n"); -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "none") == 0 && (psta==NULL)) -+ { -+ //todo:clear default encryption keys -+ -+ DBG_8192C("clear default encryption keys, keyid=%d\n", param->u.crypt.idx); -+ -+ goto exit; -+ } -+ -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta==NULL)) -+ { -+ DBG_8192C("r871x_set_encryption, crypt.alg = WEP\n"); -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ DBG_8192C("r871x_set_encryption, wep_key_idx=%d, len=%d\n", wep_key_idx, wep_key_len); -+ -+ if((wep_key_idx >= WEP_KEYS) || (wep_key_len<=0)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (wep_key_len > 0) -+ { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ } -+ -+ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) -+ { -+ //wep default key has not been set, so use this key index as default key. -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ psecuritypriv->dot11PrivacyAlgrthm=_WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy=_WEP40_; -+ -+ if(wep_key_len == 13) -+ { -+ psecuritypriv->dot11PrivacyAlgrthm=_WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy=_WEP104_; -+ } -+ -+ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ } -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; -+ -+ rtw_ap_set_wep_key(padapter, param->u.crypt.key, wep_key_len, wep_key_idx, 1); -+ -+ goto exit; -+ -+ } -+ -+ -+ if(!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) // //group key -+ { -+ if(param->u.crypt.set_tx == 0) //group key -+ { -+ if(strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ DBG_8192C("%s, set group_key, WEP\n", __FUNCTION__); -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if(param->u.crypt.key_len==13) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ } -+ else if(strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ DBG_8192C("%s, set group_key, TKIP\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); -+ //set mic key -+ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = true; -+ -+ } -+ else if(strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ DBG_8192C("%s, set group_key, CCMP\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ } -+ else -+ { -+ DBG_8192C("%s, set group_key, none\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = true; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;//!!! -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta=rtw_get_bcmc_stainfo(padapter); -+ if(pbcmc_sta) -+ { -+ pbcmc_sta->ieee8021x_blocked = false; -+ pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy -+ } -+ -+ } -+ -+ goto exit; -+ -+ } -+ -+ if(psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) // psk/802_1x -+ { -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ { -+ if(param->u.crypt.set_tx ==1) //pairwise key -+ { -+ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ if(strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ DBG_8192C("%s, set pairwise key, WEP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _WEP40_; -+ if(param->u.crypt.key_len==13) -+ { -+ psta->dot118021XPrivacy = _WEP104_; -+ } -+ } -+ else if(strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ DBG_8192C("%s, set pairwise key, TKIP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _TKIP_; -+ -+ //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); -+ //set mic key -+ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = true; -+ -+ } -+ else if(strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ -+ DBG_8192C("%s, set pairwise key, CCMP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _AES_; -+ } -+ else -+ { -+ DBG_8192C("%s, set pairwise key, none\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _NO_PRIVACY_; -+ } -+ -+ rtw_ap_set_pairwise_key(padapter, psta); -+ -+ psta->ieee8021x_blocked = false; -+ -+ psta->bpairwise_key_installed = true; -+ -+ } -+ else//group key??? -+ { -+ if(strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if(param->u.crypt.key_len==13) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ } -+ else if(strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); -+ //set mic key -+ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = true; -+ -+ } -+ else if(strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ } -+ else -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = true; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;//!!! -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta=rtw_get_bcmc_stainfo(padapter); -+ if(pbcmc_sta) -+ { -+ pbcmc_sta->ieee8021x_blocked = false; -+ pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy -+ } -+ -+ } -+ -+ } -+ -+ } -+ -+exit: -+ -+ return ret; -+ -+} -+#endif -+ -+static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len,wep_total_len; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info* pwdinfo = &padapter->wdinfo; -+#endif //CONFIG_P2P -+ -+ -+ -+ DBG_8192C("%s\n", __func__); -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ if (param_len < (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ if (param->u.crypt.idx >= WEP_KEYS) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } else { -+#ifdef CONFIG_WAPI_SUPPORT -+ if (strcmp(param->u.crypt.alg, "SMS4")) -+#endif -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("wpa_set_encryption, crypt.alg = WEP\n")); -+ DBG_8192C("wpa_set_encryption, crypt.alg = WEP\n"); -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ if ((wep_key_idx > WEP_KEYS) || (wep_key_len <= 0)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (psecuritypriv->bWepDefaultKeyIdxSet == 0) -+ { -+ //wep default key has not been set, so use this key index as default key. -+ -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ -+ if(wep_key_len==13) -+ { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ } -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len; -+ -+ rtw_set_key(padapter, psecuritypriv, wep_key_idx, 0); -+ -+ goto exit; -+ } -+ -+ if(padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) // 802_1x -+ { -+ struct sta_info * psta,*pbcmc_sta; -+ struct sta_priv * pstapriv = &padapter->stapriv; -+ -+ //DBG_8192C("%s, : dot11AuthAlgrthm == dot11AuthAlgrthm_8021X \n", __func__); -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == true) //sta mode -+ { -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ //DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail \n")); -+ DBG_8192C("%s, : Obtain Sta_info fail \n", __func__); -+ } -+ else -+ { -+ //Jeff: don't disable ieee8021x_blocked while clearing key -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ psta->ieee8021x_blocked = false; -+ -+ -+ if((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ { -+ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ -+ if(param->u.crypt.set_tx ==1)//pairwise key -+ { -+ -+ DBG_8192C("%s, : param->u.crypt.set_tx ==1 \n", __func__); -+ -+ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ if(strcmp(param->u.crypt.alg, "TKIP") == 0)//set mic key -+ { -+ //DEBUG_ERR(("\nset key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); -+ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ padapter->securitypriv.busetkipkey=false; -+ //_set_timer(&padapter->securitypriv.tkip_timer, 50); -+ } -+ -+ //DEBUG_ERR((" param->u.crypt.key_len=%d\n",param->u.crypt.key_len)); -+ DBG_871X(" ~~~~set sta key:unicastkey\n"); -+ -+ rtw_setstakey_cmd(padapter, (unsigned char *)psta, true); -+ } -+ else//group key -+ { -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key,(param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[16]),8); -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[24]),8); -+ padapter->securitypriv.binstallGrpkey = true; -+ //DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); -+ DBG_871X(" ~~~~set sta key:groupkey\n"); -+ -+ padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ rtw_set_key(padapter,&padapter->securitypriv,param->u.crypt.idx, 1); -+#ifdef CONFIG_P2P -+ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_DONE); -+ } -+ } -+#endif //CONFIG_P2P -+ -+ } -+ } -+ -+ pbcmc_sta=rtw_get_bcmc_stainfo(padapter); -+ if(pbcmc_sta==NULL) -+ { -+ //DEBUG_ERR( ("Set OID_802_11_ADD_KEY: bcmc stainfo is null \n")); -+ } -+ else -+ { -+ //Jeff: don't disable ieee8021x_blocked while clearing key -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ pbcmc_sta->ieee8021x_blocked = false; -+ -+ if((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ { -+ pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ } -+ } -+ else if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) //adhoc mode -+ { -+ } -+ } -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (strcmp(param->u.crypt.alg, "SMS4") == 0) -+ { -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_STA_INFO pWapiSta; -+ u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ -+ if(param->u.crypt.set_tx == 1) -+ { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if(_rtw_memcmp(pWapiSta->PeerMacAddr,param->sta_addr,6)) -+ { -+ _rtw_memcpy(pWapiSta->lastTxUnicastPN,WapiASUEPNInitialValueSrc,16); -+ -+ pWapiSta->wapiUsk.bSet = true; -+ _rtw_memcpy(pWapiSta->wapiUsk.dataKey,param->u.crypt.key,16); -+ _rtw_memcpy(pWapiSta->wapiUsk.micKey,param->u.crypt.key+16,16); -+ pWapiSta->wapiUsk.keyId = param->u.crypt.idx ; -+ pWapiSta->wapiUsk.bTxEnable = true; -+ -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPN,WapiAEPNInitialValueSrc,16); -+ pWapiSta->wapiUskUpdate.bTxEnable = false; -+ pWapiSta->wapiUskUpdate.bSet = false; -+ -+ if (psecuritypriv->sw_encrypt== false || psecuritypriv->sw_decrypt == false) -+ { -+ //set unicast key for ASUE -+ rtw_wapi_set_key(padapter, &pWapiSta->wapiUsk, pWapiSta, false, false); -+ } -+ } -+ } -+ } -+ else -+ { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if(_rtw_memcmp(pWapiSta->PeerMacAddr,get_bssid(pmlmepriv),6)) -+ { -+ pWapiSta->wapiMsk.bSet = true; -+ _rtw_memcpy(pWapiSta->wapiMsk.dataKey,param->u.crypt.key,16); -+ _rtw_memcpy(pWapiSta->wapiMsk.micKey,param->u.crypt.key+16,16); -+ pWapiSta->wapiMsk.keyId = param->u.crypt.idx ; -+ pWapiSta->wapiMsk.bTxEnable = false; -+ if(!pWapiSta->bSetkeyOk) -+ pWapiSta->bSetkeyOk = true; -+ pWapiSta->bAuthenticateInProgress = false; -+ -+ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); -+ -+ if (psecuritypriv->sw_decrypt == false) -+ { -+ //set rx broadcast key for ASUE -+ rtw_wapi_set_key(padapter, &pWapiSta->wapiMsk, pWapiSta, true, false); -+ } -+ } -+ -+ } -+ } -+ } -+#endif -+ -+ -+exit: -+ -+ DBG_8192C("%s, ret=%d\n", __func__, ret); -+ -+ -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_add_key(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ u8 key_index, bool pairwise, const u8 *mac_addr, -+#else // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ u8 key_index, const u8 *mac_addr, -+#endif // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ struct key_params *params) -+{ -+ char *alg_name; -+ u32 param_len; -+ struct ieee_param *param = NULL; -+ int ret=0; -+ struct wireless_dev *rtw_wdev = wiphy_to_wdev(wiphy); -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ DBG_871X(FUNC_NDEV_FMT" adding key for %pM\n", FUNC_NDEV_ARG(ndev), mac_addr); -+ DBG_871X("cipher=0x%x\n", params->cipher); -+ DBG_871X("key_len=0x%x\n", params->key_len); -+ DBG_871X("seq_len=0x%x\n", params->seq_len); -+ DBG_871X("key_index=%d\n", key_index); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ DBG_871X("pairwise=%d\n", pairwise); -+#endif // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ -+ param_len = sizeof(struct ieee_param) + params->key_len; -+ param = (struct ieee_param *)rtw_malloc(param_len); -+ if (param == NULL) -+ return -1; -+ -+ _rtw_memset(param, 0, param_len); -+ -+ param->cmd = IEEE_CMD_SET_ENCRYPTION; -+ _rtw_memset(param->sta_addr, 0xff, ETH_ALEN); -+ -+ switch (params->cipher) { -+ case IW_AUTH_CIPHER_NONE: -+ //todo: remove key -+ //remove = 1; -+ alg_name = "none"; -+ break; -+ case WLAN_CIPHER_SUITE_WEP40: -+ case WLAN_CIPHER_SUITE_WEP104: -+ alg_name = "WEP"; -+ break; -+ case WLAN_CIPHER_SUITE_TKIP: -+ alg_name = "TKIP"; -+ break; -+ case WLAN_CIPHER_SUITE_CCMP: -+ alg_name = "CCMP"; -+ break; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ case WLAN_CIPHER_SUITE_SMS4: -+ alg_name= "SMS4"; -+ if(pairwise == NL80211_KEYTYPE_PAIRWISE) { -+ if (key_index != 0 && key_index != 1) { -+ ret = -ENOTSUPP; -+ goto addkey_end; -+ } -+ _rtw_memcpy((void*)param->sta_addr, (void*)mac_addr, ETH_ALEN); -+ } else { -+ DBG_871X("mac_addr is null \n"); -+ } -+ DBG_871X("rtw_wx_set_enc_ext: SMS4 case \n"); -+ break; -+#endif -+ -+ default: -+ ret = -ENOTSUPP; -+ goto addkey_end; -+ } -+ -+ strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN); -+ -+ -+ if (!mac_addr || is_broadcast_ether_addr(mac_addr)) -+ { -+ param->u.crypt.set_tx = 0; //for wpa/wpa2 group key -+ } else { -+ param->u.crypt.set_tx = 1; //for wpa/wpa2 pairwise key -+ } -+ -+ -+ //param->u.crypt.idx = key_index - 1; -+ param->u.crypt.idx = key_index; -+ -+ if (params->seq_len && params->seq) -+ { -+ _rtw_memcpy(param->u.crypt.seq, params->seq, params->seq_len); -+ } -+ -+ if(params->key_len && params->key) -+ { -+ param->u.crypt.key_len = params->key_len; -+ _rtw_memcpy(param->u.crypt.key, params->key, params->key_len); -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) -+ { -+ ret = rtw_cfg80211_set_encryption(ndev, param, param_len); -+ } -+ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+#ifdef CONFIG_AP_MODE -+ if(mac_addr) -+ _rtw_memcpy(param->sta_addr, (void*)mac_addr, ETH_ALEN); -+ -+ ret = rtw_cfg80211_ap_set_encryption(ndev, param, param_len); -+#endif -+ } -+ else -+ { -+ DBG_8192C("error! fw_state=0x%x, iftype=%d\n", pmlmepriv->fw_state, rtw_wdev->iftype); -+ -+ } -+ -+addkey_end: -+ if(param) -+ { -+ rtw_mfree((u8*)param, param_len); -+ } -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_get_key(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ u8 key_index, bool pairwise, const u8 *mac_addr, -+#else // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ u8 key_index, const u8 *mac_addr, -+#endif // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ void *cookie, -+ void (*callback)(void *cookie, -+ struct key_params*)) -+{ -+#if 0 -+ struct iwm_priv *iwm = ndev_to_iwm(ndev); -+ struct iwm_key *key = &iwm->keys[key_index]; -+ struct key_params params; -+ -+ IWM_DBG_WEXT(iwm, DBG, "Getting key %d\n", key_index); -+ -+ memset(¶ms, 0, sizeof(params)); -+ -+ params.cipher = key->cipher; -+ params.key_len = key->key_len; -+ params.seq_len = key->seq_len; -+ params.seq = key->seq; -+ params.key = key->key; -+ -+ callback(cookie, ¶ms); -+ -+ return key->key_len ? 0 : -ENOENT; -+#endif -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+static int cfg80211_rtw_del_key(struct wiphy *wiphy, struct net_device *ndev, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ u8 key_index, bool pairwise, const u8 *mac_addr) -+#else // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ u8 key_index, const u8 *mac_addr) -+#endif // (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ DBG_871X(FUNC_NDEV_FMT" key_index=%d\n", FUNC_NDEV_ARG(ndev), key_index); -+ -+ if (key_index == psecuritypriv->dot11PrivacyKeyIndex) -+ { -+ //clear the flag of wep default key set. -+ psecuritypriv->bWepDefaultKeyIdxSet = 0; -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_set_default_key(struct wiphy *wiphy, -+ struct net_device *ndev, u8 key_index -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+ , bool unicast, bool multicast -+ #endif -+ ) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ DBG_871X(FUNC_NDEV_FMT" key_index=%d" -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+ ", unicast=%d, multicast=%d" -+ #endif -+ ".\n", FUNC_NDEV_ARG(ndev), key_index -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+ , unicast, multicast -+ #endif -+ ); -+ -+ if ((key_index < WEP_KEYS) && ((psecuritypriv->dot11PrivacyAlgrthm == _WEP40_) || (psecuritypriv->dot11PrivacyAlgrthm == _WEP104_))) //set wep default key -+ { -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+ psecuritypriv->dot11PrivacyKeyIndex = key_index; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if (psecuritypriv->dot11DefKeylen[key_index] == 13) -+ { -+ psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ psecuritypriv->bWepDefaultKeyIdxSet = 1; //set the flag to represent that wep default key has been set -+ } -+ -+ return 0; -+ -+} -+ -+static int cfg80211_rtw_get_station(struct wiphy *wiphy, -+ struct net_device *ndev, -+ u8 *mac, struct station_info *sinfo) -+{ -+ int ret = 0; -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ sinfo->filled = 0; -+ -+ if (!mac) { -+ DBG_871X(FUNC_NDEV_FMT" mac==%p\n", FUNC_NDEV_ARG(ndev), mac); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, mac); -+ if (psta == NULL) { -+ DBG_8192C("%s, sta_info is null\n", __func__); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X(FUNC_NDEV_FMT" mac="MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(mac)); -+#endif -+ -+ //for infra./P2PClient mode -+ if( check_fwstate(pmlmepriv, WIFI_STATION_STATE) -+ && check_fwstate(pmlmepriv, _FW_LINKED) -+ ) -+ { -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ -+ if (_rtw_memcmp(mac, cur_network->network.MacAddress, ETH_ALEN) == false) { -+ DBG_871X("%s, mismatch bssid="MAC_FMT"\n", __func__, MAC_ARG(cur_network->network.MacAddress)); -+ ret = -ENOENT; -+ goto exit; -+ } -+ -+ sinfo->filled |= STATION_INFO_SIGNAL; -+ sinfo->signal = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); -+ -+ sinfo->filled |= STATION_INFO_TX_BITRATE; -+ sinfo->txrate.legacy = rtw_get_cur_max_rate(padapter); -+ -+ sinfo->filled |= STATION_INFO_RX_PACKETS; -+ sinfo->rx_packets = sta_rx_data_pkts(psta); -+ -+ sinfo->filled |= STATION_INFO_TX_PACKETS; -+ sinfo->tx_packets = psta->sta_stats.tx_pkts; -+ -+ } -+ -+ //for Ad-Hoc/AP mode -+ if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) -+ ||check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) -+ ||check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ && check_fwstate(pmlmepriv, _FW_LINKED) -+ ) -+ { -+ //TODO: should acquire station info... -+ } -+ -+exit: -+ return ret; -+} -+ -+extern int netdev_open(struct net_device *pnetdev); -+#ifdef CONFIG_CONCURRENT_MODE -+extern int netdev_if2_open(struct net_device *pnetdev); -+#endif -+ -+/* -+enum nl80211_iftype { -+ NL80211_IFTYPE_UNSPECIFIED, -+ NL80211_IFTYPE_ADHOC, //1 -+ NL80211_IFTYPE_STATION, //2 -+ NL80211_IFTYPE_AP, //3 -+ NL80211_IFTYPE_AP_VLAN, -+ NL80211_IFTYPE_WDS, -+ NL80211_IFTYPE_MONITOR, //6 -+ NL80211_IFTYPE_MESH_POINT, -+ NL80211_IFTYPE_P2P_CLIENT, //8 -+ NL80211_IFTYPE_P2P_GO, //9 -+ //keep last -+ NUM_NL80211_IFTYPES, -+ NL80211_IFTYPE_MAX = NUM_NL80211_IFTYPES - 1 -+}; -+*/ -+static int cfg80211_rtw_change_iface(struct wiphy *wiphy, -+ struct net_device *ndev, -+ enum nl80211_iftype type, u32 *flags, -+ struct vif_params *params) -+{ -+ enum nl80211_iftype old_type; -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType ; -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct wireless_dev *rtw_wdev = wiphy_to_wdev(wiphy); -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif -+ int ret = 0; -+ u8 change = false; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->adapter_type == SECONDARY_ADAPTER) -+ { -+ DBG_871X(FUNC_NDEV_FMT" call netdev_if2_open\n", FUNC_NDEV_ARG(ndev)); -+ if(netdev_if2_open(ndev) != 0) { -+ ret= -EPERM; -+ goto exit; -+ } -+ } -+ else if(padapter->adapter_type == PRIMARY_ADAPTER) -+#endif //CONFIG_CONCURRENT_MODE -+ { -+ DBG_871X(FUNC_NDEV_FMT" call netdev_open\n", FUNC_NDEV_ARG(ndev)); -+ if(netdev_open(ndev) != 0) { -+ ret= -EPERM; -+ goto exit; -+ } -+ } -+ -+ if(_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret= -EPERM; -+ goto exit; -+ } -+ -+ old_type = rtw_wdev->iftype; -+ DBG_871X(FUNC_NDEV_FMT" old_iftype=%d, new_iftype=%d\n", -+ FUNC_NDEV_ARG(ndev), old_type, type); -+ -+ if(old_type != type) -+ { -+ change = true; -+ pmlmeext->action_public_rxseq = 0xffff; -+ pmlmeext->action_public_dialog_token = 0xff; -+ } -+ -+ switch (type) { -+ case NL80211_IFTYPE_ADHOC: -+ networkType = Ndis802_11IBSS; -+ break; -+#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE)) -+ case NL80211_IFTYPE_P2P_CLIENT: -+#endif -+ case NL80211_IFTYPE_STATION: -+ networkType = Ndis802_11Infrastructure; -+ #ifdef CONFIG_P2P -+ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(change && rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ _cancel_timer_ex( &pwdinfo->find_phase_timer ); -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ _cancel_timer_ex( &pwdinfo->pre_tx_scan_timer); -+ -+ //it means remove GO and change mode from AP(GO) to station(P2P DEVICE) -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+ -+ DBG_8192C("%s, role=%d, p2p_state=%d, pre_p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), rtw_p2p_pre_state(pwdinfo)); -+ } -+ } -+ #endif //CONFIG_P2P -+ break; -+#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE)) -+ case NL80211_IFTYPE_P2P_GO: -+#endif -+ case NL80211_IFTYPE_AP: -+ networkType = Ndis802_11APMode; -+ #ifdef CONFIG_P2P -+ if(pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(change && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ //it means P2P Group created, we will be GO and change mode from P2P DEVICE to AP(GO) -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ } -+ } -+ #endif //CONFIG_P2P -+ break; -+ default: -+ return -EOPNOTSUPP; -+ } -+ -+ rtw_wdev->iftype = type; -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, networkType) ==false) -+ { -+ rtw_wdev->iftype = old_type; -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ rtw_setopmode_cmd(padapter, networkType); -+ -+exit: -+ -+ return ret; -+} -+ -+void rtw_cfg80211_indicate_scan_done(struct rtw_wdev_priv *pwdev_priv, bool aborted) -+{ -+ _irqL irqL; -+ -+ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ if(pwdev_priv->scan_request != NULL) -+ { -+ //struct cfg80211_scan_request *scan_request = pwdev_priv->scan_request; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("%s with scan req\n", __FUNCTION__); -+ #endif -+ -+ //avoid WARN_ON(request != wiphy_to_dev(request->wiphy)->scan_req); -+ //if(scan_request == wiphy_to_dev(scan_request->wiphy)->scan_req) -+ if(pwdev_priv->scan_request->wiphy != pwdev_priv->rtw_wdev->wiphy) -+ { -+ DBG_8192C("error wiphy compare\n"); -+ } -+ else -+ { -+ cfg80211_scan_done(pwdev_priv->scan_request, aborted); -+ } -+ -+ pwdev_priv->scan_request = NULL; -+ -+ } else { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("%s without scan req\n", __FUNCTION__); -+ #endif -+ } -+ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+} -+ -+void rtw_cfg80211_surveydone_event_callback(_adapter *padapter) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u32 cnt=0; -+ u32 wait_for_surveydone; -+ sint wait_status; -+#ifdef CONFIG_P2P -+ struct wifidirect_info* pwdinfo = &padapter->wdinfo; -+#endif //CONFIG_P2P -+ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s\n", __func__); -+#endif -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while(1) -+ { -+ if (rtw_end_of_queue_search(phead,plist)== true) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ //report network only if the current channel set contains the channel to which this network belongs -+ if(rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 -+ #ifdef CONFIG_VALIDATE_SSID -+ && true == rtw_validate_ssid(&(pnetwork->network.Ssid)) -+ #endif -+ ) -+ { -+ //ev=translate_scan(padapter, a, pnetwork, ev, stop); -+ rtw_cfg80211_inform_bss(padapter, pnetwork); -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ //call this after other things have been done -+ rtw_cfg80211_indicate_scan_done(wdev_to_priv(padapter->rtw_wdev), false); -+} -+ -+static int rtw_cfg80211_set_probe_req_wpsp2pie(_adapter *padapter, char *buf, int len) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u8 *wps_ie; -+ u32 p2p_ielen = 0; -+ u8 *p2p_ie; -+ u32 wfd_ielen = 0; -+ u8 *wfd_ie; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ielen=%d\n", __func__, len); -+#endif -+ -+ if(len>0) -+ { -+ if((wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen))) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_req_wps_ielen=%d\n", wps_ielen); -+ #endif -+ -+ if(pmlmepriv->wps_probe_req_ie) -+ { -+ u32 free_len = pmlmepriv->wps_probe_req_ie_len; -+ pmlmepriv->wps_probe_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); -+ pmlmepriv->wps_probe_req_ie = NULL; -+ } -+ -+ pmlmepriv->wps_probe_req_ie = rtw_malloc(wps_ielen); -+ if ( pmlmepriv->wps_probe_req_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->wps_probe_req_ie, wps_ie, wps_ielen); -+ pmlmepriv->wps_probe_req_ie_len = wps_ielen; -+ } -+ -+ //buf += wps_ielen; -+ //len -= wps_ielen; -+ -+ #ifdef CONFIG_P2P -+ if((p2p_ie=rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen))) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_req_p2p_ielen=%d\n", p2p_ielen); -+ #endif -+ -+ if(pmlmepriv->p2p_probe_req_ie) -+ { -+ u32 free_len = pmlmepriv->p2p_probe_req_ie_len; -+ pmlmepriv->p2p_probe_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_probe_req_ie, free_len); -+ pmlmepriv->p2p_probe_req_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_probe_req_ie = rtw_malloc(p2p_ielen); -+ if ( pmlmepriv->p2p_probe_req_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->p2p_probe_req_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_probe_req_ie_len = p2p_ielen; -+ } -+ #endif //CONFIG_P2P -+ -+ //buf += p2p_ielen; -+ //len -= p2p_ielen; -+ -+ #ifdef CONFIG_WFD -+ if(rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen)) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_req_wfd_ielen=%d\n", wfd_ielen); -+ #endif -+ -+ if(pmlmepriv->wfd_probe_req_ie) -+ { -+ u32 free_len = pmlmepriv->wfd_probe_req_ie_len; -+ pmlmepriv->wfd_probe_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->wfd_probe_req_ie, free_len); -+ pmlmepriv->wfd_probe_req_ie = NULL; -+ } -+ -+ pmlmepriv->wfd_probe_req_ie = rtw_malloc(wfd_ielen); -+ if ( pmlmepriv->wfd_probe_req_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ rtw_get_wfd_ie(buf, len, pmlmepriv->wfd_probe_req_ie, &pmlmepriv->wfd_probe_req_ie_len); -+ } -+ #endif //CONFIG_WFD -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_scan(struct wiphy *wiphy -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) -+ , struct net_device *ndev -+ #endif -+ , struct cfg80211_scan_request *request) -+{ -+ int i; -+ u8 _status = false; -+ int ret = 0; -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct mlme_priv *pmlmepriv= &padapter->mlmepriv; -+ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; -+ struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; -+ _irqL irqL; -+ u8 *wps_ie=NULL; -+ uint wps_ielen=0; -+ u8 *p2p_ie=NULL; -+ uint p2p_ielen=0; -+ u8 survey_times=3; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif //CONFIG_P2P -+ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); -+ struct cfg80211_ssid *ssids = request->ssids; -+ int social_channel = 0, j = 0; -+ bool need_indicate_scan_done = false; -+#ifdef CONFIG_CONCURRENT_MODE -+ PADAPTER pbuddy_adapter = NULL; -+ struct mlme_priv *pbuddy_mlmepriv = NULL; -+#endif //CONFIG_CONCURRENT_MODE -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+#endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->pbuddy_adapter) { -+ pbuddy_adapter = padapter->pbuddy_adapter; -+ pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+ } -+#endif //CONFIG_CONCURRENT_MODE -+ -+#ifdef CONFIG_MP_INCLUDED -+if (padapter->registrypriv.mp_mode == 1) -+{ -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) -+ { -+ ret = -EPERM; -+ goto exit; -+ } -+} -+#endif -+ -+ _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ pwdev_priv->scan_request = request; -+ _exit_critical_bh(&pwdev_priv->scan_req_lock, &irqL); -+ -+ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X("%s under WIFI_AP_STATE\n", __FUNCTION__); -+#endif -+ //need_indicate_scan_done = true; -+ //goto check_need_indicate_scan_done; -+ } -+ -+ if(_FAIL == rtw_pwr_wakeup(padapter)) { -+ need_indicate_scan_done = true; -+ goto check_need_indicate_scan_done; -+ } -+ -+ #ifdef CONFIG_P2P -+ if( pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(ssids->ssid != NULL -+ && _rtw_memcmp(ssids->ssid, "DIRECT-", 7) -+ && rtw_get_p2p_ie((u8 *)request->ie, request->ie_len, NULL, NULL) -+ ) -+ { -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); -+ wdev_to_priv(padapter->rtw_wdev)->p2p_enabled = true; -+ } -+ else -+ { -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); -+ #endif -+ } -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+ -+ if(request->n_channels == 3 && -+ request->channels[0]->hw_value == 1 && -+ request->channels[1]->hw_value == 6 && -+ request->channels[2]->hw_value == 11 -+ ) -+ { -+ social_channel = 1; -+ } -+ } -+ } -+ #endif //CONFIG_P2P -+ -+ if(request->ie && request->ie_len>0) -+ { -+ rtw_cfg80211_set_probe_req_wpsp2pie(padapter, (u8 *)request->ie, request->ie_len ); -+ } -+ -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == true) -+ { -+ DBG_8192C("%s, bBusyTraffic == true\n", __func__); -+ need_indicate_scan_done = true; -+ goto check_need_indicate_scan_done; -+ } -+ if (rtw_is_scan_deny(padapter)){ -+ DBG_871X(FUNC_ADPT_FMT ": scan deny\n", FUNC_ADPT_ARG(padapter)); -+ need_indicate_scan_done = true; -+ goto check_need_indicate_scan_done; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(pbuddy_mlmepriv && (pbuddy_mlmepriv->LinkDetectInfo.bBusyTraffic == true)) -+ { -+ DBG_8192C("%s, bBusyTraffic == true at buddy_intf\n", __func__); -+ need_indicate_scan_done = true; -+ goto check_need_indicate_scan_done; -+ } -+#endif //CONFIG_CONCURRENT_MODE -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) -+ { -+ DBG_8192C("%s, fwstate=0x%x\n", __func__, pmlmepriv->fw_state); -+ need_indicate_scan_done = true; -+ goto check_need_indicate_scan_done; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, -+ _FW_UNDER_SURVEY|_FW_UNDER_LINKING|WIFI_UNDER_WPS) == true) -+ { -+ if(check_buddy_fwstate(padapter, _FW_UNDER_SURVEY)) -+ { -+ DBG_8192C("scanning_via_buddy_intf\n"); -+ pmlmepriv->scanning_via_buddy_intf = true; -+ } -+ -+ DBG_8192C("buddy_intf's mlme state:0x%x\n", pbuddy_mlmepriv->fw_state); -+ -+ need_indicate_scan_done = true; -+ goto check_need_indicate_scan_done; -+ } -+#endif -+ -+ -+#ifdef CONFIG_P2P -+ if( pwdinfo->driver_interface == DRIVER_CFG80211 ) -+ { -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ rtw_free_network_queue(padapter, true); -+ -+ if(social_channel == 0) -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+ else -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_SOCIAL_LAST); -+ } -+ } -+#endif //CONFIG_P2P -+ -+ -+ _rtw_memset(ssid, 0, sizeof(NDIS_802_11_SSID)*RTW_SSID_SCAN_AMOUNT); -+ //parsing request ssids, n_ssids -+ for (i = 0; i < request->n_ssids && i < RTW_SSID_SCAN_AMOUNT; i++) { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("ssid=%s, len=%d\n", ssids[i].ssid, ssids[i].ssid_len); -+ #endif -+ _rtw_memcpy(ssid[i].Ssid, ssids[i].ssid, ssids[i].ssid_len); -+ ssid[i].SsidLength = ssids[i].ssid_len; -+ } -+ -+ -+ /* parsing channels, n_channels */ -+ _rtw_memset(ch, 0, sizeof(struct rtw_ieee80211_channel)*RTW_CHANNEL_SCAN_AMOUNT); -+ for (i=0;in_channels && ichannels[i])); -+ #endif -+ ch[i].hw_value = request->channels[i]->hw_value; -+ ch[i].flags = request->channels[i]->flags; -+ } -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ if (request->n_channels == 1) { -+ for(i=1;in_channels == 2) { -+ _rtw_memcpy(&ch[survey_times], &ch[1], sizeof(struct rtw_ieee80211_channel)); -+ for(i=1;ilock, &irqL); -+ -+ -+ if(_status == false) -+ { -+ ret = -1; -+ } -+ -+check_need_indicate_scan_done: -+ if(need_indicate_scan_done) -+ rtw_cfg80211_surveydone_event_callback(padapter); -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_set_wiphy_params(struct wiphy *wiphy, u32 changed) -+{ -+#if 0 -+ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); -+ -+ if (changed & WIPHY_PARAM_RTS_THRESHOLD && -+ (iwm->conf.rts_threshold != wiphy->rts_threshold)) { -+ int ret; -+ -+ iwm->conf.rts_threshold = wiphy->rts_threshold; -+ -+ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX, -+ CFG_RTS_THRESHOLD, -+ iwm->conf.rts_threshold); -+ if (ret < 0) -+ return ret; -+ } -+ -+ if (changed & WIPHY_PARAM_FRAG_THRESHOLD && -+ (iwm->conf.frag_threshold != wiphy->frag_threshold)) { -+ int ret; -+ -+ iwm->conf.frag_threshold = wiphy->frag_threshold; -+ -+ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_FA_CFG_FIX, -+ CFG_FRAG_THRESHOLD, -+ iwm->conf.frag_threshold); -+ if (ret < 0) -+ return ret; -+ } -+#endif -+ DBG_8192C("%s\n", __func__); -+ return 0; -+} -+ -+static int cfg80211_rtw_join_ibss(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_ibss_params *params) -+{ -+#if 0 -+ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); -+ struct ieee80211_channel *chan = params->channel; -+ -+ if (!test_bit(IWM_STATUS_READY, &iwm->status)) -+ return -EIO; -+ -+ /* UMAC doesn't support creating or joining an IBSS network -+ * with specified bssid. */ -+ if (params->bssid) -+ return -EOPNOTSUPP; -+ -+ iwm->channel = ieee80211_frequency_to_channel(chan->center_freq); -+ iwm->umac_profile->ibss.band = chan->band; -+ iwm->umac_profile->ibss.channel = iwm->channel; -+ iwm->umac_profile->ssid.ssid_len = params->ssid_len; -+ memcpy(iwm->umac_profile->ssid.ssid, params->ssid, params->ssid_len); -+ -+ return iwm_send_mlme_profile(iwm); -+#endif -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+static int cfg80211_rtw_leave_ibss(struct wiphy *wiphy, struct net_device *ndev) -+{ -+#if 0 -+ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); -+ -+ if (iwm->umac_profile_active) -+ return iwm_invalidate_mlme_profile(iwm); -+#endif -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+static int rtw_cfg80211_set_wpa_version(struct security_priv *psecuritypriv, u32 wpa_version) -+{ -+ DBG_8192C("%s, wpa_version=%d\n", __func__, wpa_version); -+ -+ if (!wpa_version) { -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ return 0; -+ } -+ -+ -+ if (wpa_version & (NL80211_WPA_VERSION_1 | NL80211_WPA_VERSION_2)) -+ { -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPAPSK; -+ } -+ -+/* -+ if (wpa_version & NL80211_WPA_VERSION_2) -+ { -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; -+ } -+*/ -+ -+ return 0; -+ -+} -+ -+static int rtw_cfg80211_set_auth_type(struct security_priv *psecuritypriv, -+ enum nl80211_auth_type sme_auth_type) -+{ -+ DBG_8192C("%s, nl80211_auth_type=%d\n", __func__, sme_auth_type); -+ -+ -+ switch (sme_auth_type) { -+ case NL80211_AUTHTYPE_AUTOMATIC: -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ -+ break; -+ case NL80211_AUTHTYPE_OPEN_SYSTEM: -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ -+ if(psecuritypriv->ndisauthtype>Ndis802_11AuthModeWPA) -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(psecuritypriv->ndisauthtype == Ndis802_11AuthModeWAPI) -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; -+#endif -+ -+ break; -+ case NL80211_AUTHTYPE_SHARED_KEY: -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+ -+ break; -+ default: -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ //return -ENOTSUPP; -+ } -+ -+ return 0; -+ -+} -+ -+static int rtw_cfg80211_set_cipher(struct security_priv *psecuritypriv, u32 cipher, bool ucast) -+{ -+ u32 ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ -+ u32 *profile_cipher = ucast ? &psecuritypriv->dot11PrivacyAlgrthm : -+ &psecuritypriv->dot118021XGrpPrivacy; -+ -+ DBG_8192C("%s, ucast=%d, cipher=0x%x\n", __func__, ucast, cipher); -+ -+ -+ if (!cipher) { -+ *profile_cipher = _NO_PRIVACY_; -+ psecuritypriv->ndisencryptstatus = ndisencryptstatus; -+ return 0; -+ } -+ -+ switch (cipher) { -+ case IW_AUTH_CIPHER_NONE: -+ *profile_cipher = _NO_PRIVACY_; -+ ndisencryptstatus = Ndis802_11EncryptionDisabled; -+#ifdef CONFIG_WAPI_SUPPORT -+ if(psecuritypriv->dot11PrivacyAlgrthm ==_SMS4_ ) -+ { -+ *profile_cipher = _SMS4_; -+ } -+#endif -+ break; -+ case WLAN_CIPHER_SUITE_WEP40: -+ *profile_cipher = _WEP40_; -+ ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WLAN_CIPHER_SUITE_WEP104: -+ *profile_cipher = _WEP104_; -+ ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WLAN_CIPHER_SUITE_TKIP: -+ *profile_cipher = _TKIP_; -+ ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WLAN_CIPHER_SUITE_CCMP: -+ *profile_cipher = _AES_; -+ ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+ case WLAN_CIPHER_SUITE_SMS4: -+ *profile_cipher = _SMS4_; -+ ndisencryptstatus = Ndis802_11_EncrypteionWAPI; -+ break; -+#endif -+ default: -+ DBG_8192C("Unsupported cipher: 0x%x\n", cipher); -+ return -ENOTSUPP; -+ } -+ -+ if(ucast) -+ { -+ psecuritypriv->ndisencryptstatus = ndisencryptstatus; -+ -+ //if(psecuritypriv->dot11PrivacyAlgrthm >= _AES_) -+ // psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; -+ } -+ -+ return 0; -+} -+ -+static int rtw_cfg80211_set_key_mgt(struct security_priv *psecuritypriv, u32 key_mgt) -+{ -+ DBG_8192C("%s, key_mgt=0x%x\n", __func__, key_mgt); -+ -+ if (key_mgt == WLAN_AKM_SUITE_8021X) -+ //*auth_type = UMAC_AUTH_TYPE_8021X; -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ else if (key_mgt == WLAN_AKM_SUITE_PSK) { -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; -+ } -+#ifdef CONFIG_WAPI_SUPPORT -+ else if(key_mgt ==WLAN_AKM_SUITE_WAPI_PSK){ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; -+ } -+ else if(key_mgt ==WLAN_AKM_SUITE_WAPI_CERT){ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; -+ } -+#endif -+ -+ -+ else { -+ DBG_8192C("Invalid key mgt: 0x%x\n", key_mgt); -+ //return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int rtw_cfg80211_set_wpa_ie(_adapter *padapter, u8 *pie, size_t ielen) -+{ -+ u8 *buf=NULL, *pos=NULL; -+ u32 left; -+ int group_cipher = 0, pairwise_cipher = 0; -+ int ret = 0; -+ int wpa_ielen=0; -+ int wpa2_ielen=0; -+ u8 *pwpa, *pwpa2; -+ u8 null_addr[]= {0,0,0,0,0,0}; -+ -+ if (pie == NULL || !ielen) { -+ /* Treat this as normal case, but need to clear WIFI_UNDER_WPS */ -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ goto exit; -+ } -+ -+ if (ielen > MAX_WPA_IE_LEN+MAX_WPS_IE_LEN+MAX_P2P_IE_LEN) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ buf = rtw_zmalloc(ielen); -+ if (buf == NULL){ -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ _rtw_memcpy(buf, pie , ielen); -+ -+ //dump -+ { -+ int i; -+ DBG_8192C("set wpa_ie(length:%zu):\n", ielen); -+ for(i=0;i0) -+ { -+ if(rtw_parse_wpa_ie(pwpa, wpa_ielen+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPAPSK; -+ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &pwpa[0], wpa_ielen+2); -+ -+ DBG_8192C("got wpa_ie, wpa_ielen:%u\n", wpa_ielen); -+ } -+ } -+ -+ pwpa2 = rtw_get_wpa2_ie(buf, &wpa2_ielen, ielen); -+ if(pwpa2 && wpa2_ielen>0) -+ { -+ if(rtw_parse_wpa2_ie(pwpa2, wpa2_ielen+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPA2PSK; -+ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &pwpa2[0], wpa2_ielen+2); -+ -+ DBG_8192C("got wpa2_ie, wpa2_ielen:%u\n", wpa2_ielen); -+ } -+ } -+ -+ if (group_cipher == 0) -+ { -+ group_cipher = WPA_CIPHER_NONE; -+ } -+ if (pairwise_cipher == 0) -+ { -+ pairwise_cipher = WPA_CIPHER_NONE; -+ } -+ -+ switch(group_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus=Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot118021XGrpPrivacy=_WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot118021XGrpPrivacy=_TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot118021XGrpPrivacy=_AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot118021XGrpPrivacy=_WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ switch(pairwise_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus=Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ {/* handle wps_ie */ -+ uint wps_ielen; -+ u8 *wps_ie; -+ -+ wps_ie = rtw_get_wps_ie(buf, ielen, NULL, &wps_ielen); -+ if (wps_ie && wps_ielen > 0) { -+ DBG_8192C("got wps_ie, wps_ielen:%u\n", wps_ielen); -+ padapter->securitypriv.wps_ie_len = wps_ielensecuritypriv.wps_ie, wps_ie, padapter->securitypriv.wps_ie_len); -+ set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ } else { -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ } -+ } -+ -+ #ifdef CONFIG_P2P -+ {//check p2p_ie for assoc req; -+ uint p2p_ielen=0; -+ u8 *p2p_ie; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if((p2p_ie=rtw_get_p2p_ie(buf, ielen, NULL, &p2p_ielen))) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s p2p_assoc_req_ielen=%d\n", __FUNCTION__, p2p_ielen); -+ #endif -+ -+ if(pmlmepriv->p2p_assoc_req_ie) -+ { -+ u32 free_len = pmlmepriv->p2p_assoc_req_ie_len; -+ pmlmepriv->p2p_assoc_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_assoc_req_ie, free_len); -+ pmlmepriv->p2p_assoc_req_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_assoc_req_ie = rtw_malloc(p2p_ielen); -+ if ( pmlmepriv->p2p_assoc_req_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ goto exit; -+ } -+ _rtw_memcpy(pmlmepriv->p2p_assoc_req_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_assoc_req_ie_len = p2p_ielen; -+ } -+ } -+ #endif //CONFIG_P2P -+ -+ #ifdef CONFIG_WFD -+ {//check wfd_ie for assoc req; -+ uint wfd_ielen=0; -+ u8 *wfd_ie; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if(rtw_get_wfd_ie(buf, ielen, NULL, &wfd_ielen)) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s wfd_assoc_req_ielen=%d\n", __FUNCTION__, wfd_ielen); -+ #endif -+ -+ if(pmlmepriv->wfd_assoc_req_ie) -+ { -+ u32 free_len = pmlmepriv->wfd_assoc_req_ie_len; -+ pmlmepriv->wfd_assoc_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->wfd_assoc_req_ie, free_len); -+ pmlmepriv->wfd_assoc_req_ie = NULL; -+ } -+ -+ pmlmepriv->wfd_assoc_req_ie = rtw_malloc(wfd_ielen); -+ if ( pmlmepriv->wfd_assoc_req_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ goto exit; -+ } -+ rtw_get_wfd_ie(buf, ielen, pmlmepriv->wfd_assoc_req_ie, &pmlmepriv->wfd_assoc_req_ie_len); -+ } -+ } -+ #endif //CONFIG_WFD -+ -+ //TKIP and AES disallow multicast packets until installing group key -+ if(padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) -+ //WPS open need to enable multicast -+ //|| check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == true) -+ rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr); -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("rtw_set_wpa_ie: pairwise_cipher=0x%08x padapter->securitypriv.ndisencryptstatus=%d padapter->securitypriv.ndisauthtype=%d\n", -+ pairwise_cipher, padapter->securitypriv.ndisencryptstatus, padapter->securitypriv.ndisauthtype)); -+ -+exit: -+ if (buf) -+ rtw_mfree(buf, ielen); -+ if (ret) -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ return ret; -+} -+ -+static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_connect_params *sme) -+{ -+ int ret=0; -+ _irqL irqL; -+ _list *phead; -+ struct wlan_network *pnetwork = NULL; -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ NDIS_802_11_SSID ndis_ssid; -+ u8 *dst_ssid, *src_ssid; -+ u8 *dst_bssid, *src_bssid; -+ //u8 matched_by_bssid=false; -+ //u8 matched_by_ssid=false; -+ u8 matched=false; -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ _queue *queue = &pmlmepriv->scanned_queue; -+ -+ DBG_871X("=>"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ DBG_871X("privacy=%d, key=%p, key_len=%d, key_idx=%d\n", -+ sme->privacy, sme->key, sme->key_len, sme->key_idx); -+ -+ -+ if(wdev_to_priv(padapter->rtw_wdev)->block == true) -+ { -+ ret = -EBUSY; -+ DBG_871X("%s wdev_priv.block is set\n", __FUNCTION__); -+ goto exit; -+ } -+ -+ if(_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret= -EPERM; -+ goto exit; -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, _FW_UNDER_LINKING) == true) { -+ DBG_8192C("%s, but buddy_intf is under linking\n", __FUNCTION__); -+ ret = -EINVAL; -+ goto exit; -+ } -+ if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY) == true) { -+ rtw_scan_abort(padapter->pbuddy_adapter); -+ } -+#endif -+ -+ if (!sme->ssid || !sme->ssid_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (sme->ssid_len > IW_ESSID_MAX_SIZE){ -+ -+ ret= -E2BIG; -+ goto exit; -+ } -+ -+ -+ _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ ndis_ssid.SsidLength = sme->ssid_len; -+ _rtw_memcpy(ndis_ssid.Ssid, sme->ssid, sme->ssid_len); -+ -+ DBG_8192C("ssid=%s, len=%zu\n", ndis_ssid.Ssid, sme->ssid_len); -+ -+ -+ if (sme->bssid) -+ DBG_8192C("bssid="MAC_FMT"\n", MAC_ARG(sme->bssid)); -+ -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) { -+ ret = -EBUSY; -+ DBG_8192C("%s, fw_state=0x%x, goto exit\n", __FUNCTION__, pmlmepriv->fw_state); -+ goto exit; -+ } -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) { -+ rtw_scan_abort(padapter); -+ } -+ -+ _enter_critical_bh(&queue->lock, &irqL); -+ -+ phead = get_list_head(queue); -+ pmlmepriv->pscanned = get_next(phead); -+ -+ while (1) -+ { -+ if (rtw_end_of_queue_search(phead, pmlmepriv->pscanned) == true) -+ { -+ break; -+ } -+ -+ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); -+ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); -+ -+ dst_ssid = pnetwork->network.Ssid.Ssid; -+ dst_bssid = pnetwork->network.MacAddress; -+ -+ if(sme->bssid) { -+ if(_rtw_memcmp(pnetwork->network.MacAddress, sme->bssid, ETH_ALEN) == false) -+ continue; -+ } -+ -+ if(sme->ssid && sme->ssid_len) { -+ if( pnetwork->network.Ssid.SsidLength != sme->ssid_len -+ || _rtw_memcmp(pnetwork->network.Ssid.Ssid, sme->ssid, sme->ssid_len) == false -+ ) -+ continue; -+ } -+ -+ -+ if (sme->bssid) -+ { -+ src_bssid = sme->bssid; -+ -+ if ((_rtw_memcmp(dst_bssid, src_bssid, ETH_ALEN)) == true) -+ { -+ DBG_8192C("matched by bssid\n"); -+ -+ ndis_ssid.SsidLength = pnetwork->network.Ssid.SsidLength; -+ _rtw_memcpy(ndis_ssid.Ssid, pnetwork->network.Ssid.Ssid, pnetwork->network.Ssid.SsidLength); -+ -+ matched=true; -+ break; -+ } -+ -+ } -+ else if (sme->ssid && sme->ssid_len) -+ { -+ src_ssid = ndis_ssid.Ssid; -+ -+ if ((_rtw_memcmp(dst_ssid, src_ssid, ndis_ssid.SsidLength) == true) && -+ (pnetwork->network.Ssid.SsidLength==ndis_ssid.SsidLength)) -+ { -+ DBG_8192C("matched by ssid\n"); -+ matched=true; -+ break; -+ } -+ } -+ -+ } -+ -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ if((matched == false) || (pnetwork== NULL)) -+ { -+ ret = -ENOENT; -+ DBG_8192C("connect, matched == false, goto exit\n"); -+ goto exit; -+ } -+ -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode) == false) -+ { -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; //open system -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ padapter->wapiInfo.bWapiEnable = false; -+#endif -+ -+ ret = rtw_cfg80211_set_wpa_version(psecuritypriv, sme->crypto.wpa_versions); -+ if (ret < 0) -+ goto exit; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(sme->crypto.wpa_versions & NL80211_WAPI_VERSION_1) -+ { -+ padapter->wapiInfo.bWapiEnable = true; -+ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; -+ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; -+ } -+#endif -+ -+ ret = rtw_cfg80211_set_auth_type(psecuritypriv, sme->auth_type); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_WAPI) -+ padapter->mlmeextpriv.mlmext_info.auth_algo = psecuritypriv->dot11AuthAlgrthm; -+#endif -+ -+ -+ if (ret < 0) -+ goto exit; -+ -+ DBG_8192C("%s, ie_len=%zu\n", __func__, sme->ie_len); -+ -+ ret = rtw_cfg80211_set_wpa_ie(padapter, sme->ie, sme->ie_len); -+ if (ret < 0) -+ goto exit; -+ -+ if (sme->crypto.n_ciphers_pairwise) { -+ ret = rtw_cfg80211_set_cipher(psecuritypriv, sme->crypto.ciphers_pairwise[0], true); -+ if (ret < 0) -+ goto exit; -+ } -+ -+ //For WEP Shared auth -+ if((psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_Shared -+ || psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_Auto) && sme->key -+ ) -+ { -+ u32 wep_key_idx, wep_key_len,wep_total_len; -+ NDIS_802_11_WEP *pwep = NULL; -+ DBG_871X("%s(): Shared/Auto WEP\n",__FUNCTION__); -+ -+ wep_key_idx = sme->key_idx; -+ wep_key_len = sme->key_len; -+ -+ if (sme->key_idx > WEP_KEYS) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (wep_key_len > 0) -+ { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); -+ pwep =(NDIS_802_11_WEP *) rtw_malloc(wep_total_len); -+ if(pwep == NULL){ -+ DBG_871X(" wpa_set_encryption: pwep allocate fail !!!\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ _rtw_memset(pwep, 0, wep_total_len); -+ -+ pwep->KeyLength = wep_key_len; -+ pwep->Length = wep_total_len; -+ -+ if(wep_key_len==13) -+ { -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; -+ padapter->securitypriv.dot118021XGrpPrivacy=_WEP104_; -+ } -+ } -+ else { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ pwep->KeyIndex = wep_key_idx; -+ pwep->KeyIndex |= 0x80000000; -+ -+ _rtw_memcpy(pwep->KeyMaterial, (void *)sme->key, pwep->KeyLength); -+ -+ if(rtw_set_802_11_add_wep(padapter, pwep) == (u8)_FAIL) -+ { -+ ret = -EOPNOTSUPP ; -+ } -+ -+ if (pwep) { -+ rtw_mfree((u8 *)pwep,wep_total_len); -+ } -+ -+ if(ret < 0) -+ goto exit; -+ } -+ -+ ret = rtw_cfg80211_set_cipher(psecuritypriv, sme->crypto.cipher_group, false); -+ if (ret < 0) -+ return ret; -+ -+ if (sme->crypto.n_akm_suites) { -+ ret = rtw_cfg80211_set_key_mgt(psecuritypriv, sme->crypto.akm_suites[0]); -+ if (ret < 0) -+ goto exit; -+ } -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if(sme->crypto.akm_suites[0] ==WLAN_AKM_SUITE_WAPI_PSK){ -+ padapter->wapiInfo.bWapiPSK = true; -+ } -+ else if(sme->crypto.akm_suites[0] ==WLAN_AKM_SUITE_WAPI_CERT){ -+ padapter->wapiInfo.bWapiPSK = false; -+ } -+#endif -+ -+ authmode = psecuritypriv->ndisauthtype; -+ rtw_set_802_11_authentication_mode(padapter, authmode); -+ -+ //rtw_set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); -+ -+ if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == false) { -+ ret = -1; -+ goto exit; -+ } -+ -+ -+ DBG_8192C("set ssid:dot11AuthAlgrthm=%d, dot11PrivacyAlgrthm=%d, dot118021XGrpPrivacy=%d\n", psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, psecuritypriv->dot118021XGrpPrivacy); -+ -+exit: -+ -+ DBG_8192C("<=%s, ret %d\n",__FUNCTION__, ret); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_disconnect(struct wiphy *wiphy, struct net_device *ndev, -+ u16 reason_code) -+{ -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ rtw_set_roaming(padapter, 0); -+ -+ if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)) -+ { -+ rtw_scan_abort(padapter); -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, false); -+ -+ DBG_871X("%s...call rtw_indicate_disconnect\n", __FUNCTION__); -+ -+ padapter->mlmepriv.not_indic_disco = true; -+ rtw_indicate_disconnect(padapter); -+ padapter->mlmepriv.not_indic_disco = false; -+ -+ rtw_free_assoc_resources(padapter, 1); -+ rtw_pwr_wakeup(padapter); -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_set_txpower(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,8,0)) -+ struct wireless_dev *wdev, -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,36)) || defined(COMPAT_KERNEL_RELEASE) -+ enum nl80211_tx_power_setting type, int mbm) -+#else -+ enum tx_power_setting type, int dbm) -+#endif -+{ -+#if 0 -+ struct iwm_priv *iwm = wiphy_to_iwm(wiphy); -+ int ret; -+ -+ switch (type) { -+ case NL80211_TX_POWER_AUTOMATIC: -+ return 0; -+ case NL80211_TX_POWER_FIXED: -+ if (mbm < 0 || (mbm % 100)) -+ return -EOPNOTSUPP; -+ -+ if (!test_bit(IWM_STATUS_READY, &iwm->status)) -+ return 0; -+ -+ ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX, -+ CFG_TX_PWR_LIMIT_USR, -+ MBM_TO_DBM(mbm) * 2); -+ if (ret < 0) -+ return ret; -+ -+ return iwm_tx_power_trigger(iwm); -+ default: -+ IWM_ERR(iwm, "Unsupported power type: %d\n", type); -+ return -EOPNOTSUPP; -+ } -+#endif -+ DBG_8192C("%s\n", __func__); -+ return 0; -+} -+ -+static int cfg80211_rtw_get_txpower(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,8,0)) -+ struct wireless_dev *wdev, -+#endif -+ int *dbm) -+{ -+ //_adapter *padapter = wiphy_to_adapter(wiphy); -+ -+ DBG_8192C("%s\n", __func__); -+ -+ *dbm = (12); -+ -+ return 0; -+} -+ -+inline bool rtw_cfg80211_pwr_mgmt(_adapter *adapter) -+{ -+ struct rtw_wdev_priv *rtw_wdev_priv = wdev_to_priv(adapter->rtw_wdev); -+ return rtw_wdev_priv->power_mgmt; -+} -+ -+static int cfg80211_rtw_set_power_mgmt(struct wiphy *wiphy, -+ struct net_device *ndev, -+ bool enabled, int timeout) -+{ -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct rtw_wdev_priv *rtw_wdev_priv = wdev_to_priv(padapter->rtw_wdev); -+ -+ DBG_871X(FUNC_NDEV_FMT" enabled:%u, timeout:%d\n", FUNC_NDEV_ARG(ndev), -+ enabled, timeout); -+ -+ rtw_wdev_priv->power_mgmt = enabled; -+ -+ #ifdef CONFIG_LPS -+ if (!enabled) -+ LPS_Leave(padapter); -+ #endif -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_set_pmksa(struct wiphy *wiphy, -+ struct net_device *netdev, -+ struct cfg80211_pmksa *pmksa) -+{ -+ u8 index,blInserted = false; -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u8 strZeroMacAddress[ ETH_ALEN ] = { 0x00 }; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(netdev)); -+ -+ if ( _rtw_memcmp( pmksa->bssid, strZeroMacAddress, ETH_ALEN ) == true ) -+ { -+ return -EINVAL; -+ } -+ -+ blInserted = false; -+ -+ //overwrite PMKID -+ for(index=0 ; indexPMKIDList[index].Bssid, pmksa->bssid, ETH_ALEN) ==true ) -+ { // BSSID is matched, the same AP => rewrite with new PMKID. -+ DBG_871X(FUNC_NDEV_FMT" BSSID exists in the PMKList.\n", FUNC_NDEV_ARG(netdev)); -+ -+ _rtw_memcpy( psecuritypriv->PMKIDList[index].PMKID, pmksa->pmkid, WLAN_PMKID_LEN); -+ psecuritypriv->PMKIDList[index].bUsed = true; -+ psecuritypriv->PMKIDIndex = index+1; -+ blInserted = true; -+ break; -+ } -+ } -+ -+ if(!blInserted) -+ { -+ // Find a new entry -+ DBG_871X(FUNC_NDEV_FMT" Use the new entry index = %d for this PMKID.\n", -+ FUNC_NDEV_ARG(netdev), psecuritypriv->PMKIDIndex ); -+ -+ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, pmksa->bssid, ETH_ALEN); -+ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, pmksa->pmkid, WLAN_PMKID_LEN); -+ -+ psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].bUsed = true; -+ psecuritypriv->PMKIDIndex++ ; -+ if(psecuritypriv->PMKIDIndex==16) -+ { -+ psecuritypriv->PMKIDIndex =0; -+ } -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_del_pmksa(struct wiphy *wiphy, -+ struct net_device *netdev, -+ struct cfg80211_pmksa *pmksa) -+{ -+ u8 index, bMatched = false; -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(netdev)); -+ -+ for(index=0 ; indexPMKIDList[index].Bssid, pmksa->bssid, ETH_ALEN) ==true ) -+ { // BSSID is matched, the same AP => Remove this PMKID information and reset it. -+ _rtw_memset( psecuritypriv->PMKIDList[index].Bssid, 0x00, ETH_ALEN ); -+ _rtw_memset( psecuritypriv->PMKIDList[index].PMKID, 0x00, WLAN_PMKID_LEN ); -+ psecuritypriv->PMKIDList[index].bUsed = false; -+ bMatched = true; -+ break; -+ } -+ } -+ -+ if(false == bMatched) -+ { -+ DBG_871X(FUNC_NDEV_FMT" do not have matched BSSID\n" -+ , FUNC_NDEV_ARG(netdev)); -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_flush_pmksa(struct wiphy *wiphy, -+ struct net_device *netdev) -+{ -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(netdev)); -+ -+ _rtw_memset( &psecuritypriv->PMKIDList[ 0 ], 0x00, sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE ); -+ psecuritypriv->PMKIDIndex = 0; -+ -+ return 0; -+} -+ -+#ifdef CONFIG_AP_MODE -+void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) -+{ -+ s32 freq; -+ int channel; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct net_device *ndev = padapter->pnetdev; -+ -+ DBG_8192C("%s(padapter=%p,%s)\n", __func__, padapter, ndev->name); -+ -+#if defined(RTW_USE_CFG80211_STA_EVENT) || defined(COMPAT_KERNEL_RELEASE) -+ { -+ struct station_info sinfo; -+ u8 ie_offset; -+ if (GetFrameSubType(pmgmt_frame) == WIFI_ASSOCREQ) -+ ie_offset = _ASOCREQ_IE_OFFSET_; -+ else // WIFI_REASSOCREQ -+ ie_offset = _REASOCREQ_IE_OFFSET_; -+ -+ sinfo.filled = 0; -+ sinfo.filled = STATION_INFO_ASSOC_REQ_IES; -+ sinfo.assoc_req_ies = pmgmt_frame + WLAN_HDR_A3_LEN + ie_offset; -+ sinfo.assoc_req_ies_len = frame_len - WLAN_HDR_A3_LEN - ie_offset; -+ cfg80211_new_sta(ndev, GetAddr2Ptr(pmgmt_frame), &sinfo, GFP_ATOMIC); -+ } -+#else /* defined(RTW_USE_CFG80211_STA_EVENT) */ -+ channel = pmlmeext->cur_channel; -+ if (channel <= RTW_CH_MAX_2G_CHANNEL) -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); -+ else -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); -+ -+ #ifdef COMPAT_KERNEL_RELEASE -+ rtw_cfg80211_rx_mgmt(padapter, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); -+ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ rtw_cfg80211_rx_mgmt(padapter, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); -+ #else //COMPAT_KERNEL_RELEASE -+ { -+ //to avoid WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION) when calling cfg80211_send_rx_assoc() -+ pwdev->iftype = NL80211_IFTYPE_STATION; -+ DBG_8192C("iftype=%d before call cfg80211_send_rx_assoc()\n", pwdev->iftype); -+ rtw_cfg80211_send_rx_assoc(padapter, NULL, pmgmt_frame, frame_len); -+ DBG_8192C("iftype=%d after call cfg80211_send_rx_assoc()\n", pwdev->iftype); -+ pwdev->iftype = NL80211_IFTYPE_AP; -+ } -+ #endif //COMPAT_KERNEL_RELEASE -+#endif /* defined(RTW_USE_CFG80211_STA_EVENT) */ -+} -+ -+void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, unsigned short reason) -+{ -+ s32 freq; -+ int channel; -+ u8 *pmgmt_frame; -+ uint frame_len; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ u8 mgmt_buf[128] = {0}; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct net_device *ndev = padapter->pnetdev; -+ -+ DBG_8192C("%s(padapter=%p,%s)\n", __func__, padapter, ndev->name); -+ -+#if defined(RTW_USE_CFG80211_STA_EVENT) || defined(COMPAT_KERNEL_RELEASE) -+ cfg80211_del_sta(ndev, da, GFP_ATOMIC); -+#else /* defined(RTW_USE_CFG80211_STA_EVENT) */ -+ channel = pmlmeext->cur_channel; -+ if (channel <= RTW_CH_MAX_2G_CHANNEL) -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); -+ else -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); -+ -+ pmgmt_frame = mgmt_buf; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pmgmt_frame; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ //_rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); -+ //_rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr1, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, da, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pmgmt_frame, WIFI_DEAUTH); -+ -+ pmgmt_frame += sizeof(struct rtw_ieee80211_hdr_3addr); -+ frame_len = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ reason = cpu_to_le16(reason); -+ pmgmt_frame = rtw_set_fixed_ie(pmgmt_frame, _RSON_CODE_ , (unsigned char *)&reason, &frame_len); -+ -+ #ifdef COMPAT_KERNEL_RELEASE -+ rtw_cfg80211_rx_mgmt(padapter, freq, 0, mgmt_buf, frame_len, GFP_ATOMIC); -+ #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) -+ rtw_cfg80211_rx_mgmt(padapter, freq, 0, mgmt_buf, frame_len, GFP_ATOMIC); -+ #else //COMPAT_KERNEL_RELEASE -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0)) // TODO: Fix -+ cfg80211_send_disassoc(padapter->pnetdev, mgmt_buf, frame_len); -+ #endif -+ #endif //COMPAT_KERNEL_RELEASE -+#endif /* defined(RTW_USE_CFG80211_STA_EVENT) */ -+} -+ -+static int rtw_cfg80211_monitor_if_open(struct net_device *ndev) -+{ -+ int ret = 0; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ return ret; -+} -+ -+static int rtw_cfg80211_monitor_if_close(struct net_device *ndev) -+{ -+ int ret = 0; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ return ret; -+} -+ -+static int rtw_cfg80211_monitor_if_xmit_entry(struct sk_buff *skb, struct net_device *ndev) -+{ -+ int ret = 0; -+ int rtap_len; -+ int qos_len = 0; -+ int dot11_hdr_len = 24; -+ int snap_len = 6; -+ unsigned char *pdata; -+ u16 frame_ctl; -+ unsigned char src_mac_addr[6]; -+ unsigned char dst_mac_addr[6]; -+ struct ieee80211_hdr *dot11_hdr; -+ struct ieee80211_radiotap_header *rtap_hdr; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header))) -+ goto fail; -+ -+ rtap_hdr = (struct ieee80211_radiotap_header *)skb->data; -+ if (unlikely(rtap_hdr->it_version)) -+ goto fail; -+ -+ rtap_len = ieee80211_get_radiotap_len(skb->data); -+ if (unlikely(skb->len < rtap_len)) -+ goto fail; -+ -+ if(rtap_len != 14) -+ { -+ DBG_8192C("radiotap len (should be 14): %d\n", rtap_len); -+ goto fail; -+ } -+ -+ /* Skip the ratio tap header */ -+ skb_pull(skb, rtap_len); -+ -+ dot11_hdr = (struct ieee80211_hdr *)skb->data; -+ frame_ctl = le16_to_cpu(dot11_hdr->frame_control); -+ /* Check if the QoS bit is set */ -+ if ((frame_ctl & RTW_IEEE80211_FCTL_FTYPE) == RTW_IEEE80211_FTYPE_DATA) { -+ /* Check if this ia a Wireless Distribution System (WDS) frame -+ * which has 4 MAC addresses -+ */ -+ if (dot11_hdr->frame_control & 0x0080) -+ qos_len = 2; -+ if ((dot11_hdr->frame_control & 0x0300) == 0x0300) -+ dot11_hdr_len += 6; -+ -+ memcpy(dst_mac_addr, dot11_hdr->addr1, sizeof(dst_mac_addr)); -+ memcpy(src_mac_addr, dot11_hdr->addr2, sizeof(src_mac_addr)); -+ -+ /* Skip the 802.11 header, QoS (if any) and SNAP, but leave spaces for -+ * for two MAC addresses -+ */ -+ skb_pull(skb, dot11_hdr_len + qos_len + snap_len - sizeof(src_mac_addr) * 2); -+ pdata = (unsigned char*)skb->data; -+ memcpy(pdata, dst_mac_addr, sizeof(dst_mac_addr)); -+ memcpy(pdata + sizeof(dst_mac_addr), src_mac_addr, sizeof(src_mac_addr)); -+ -+ DBG_8192C("should be eapol packet\n"); -+ -+ /* Use the real net device to transmit the packet */ -+ ret = rtw_xmit_entry(skb, padapter->pnetdev); -+ -+ return ret; -+ -+ } -+ else if ((frame_ctl & (RTW_IEEE80211_FCTL_FTYPE|RTW_IEEE80211_FCTL_STYPE)) -+ == (RTW_IEEE80211_FTYPE_MGMT|RTW_IEEE80211_STYPE_ACTION) -+ ) -+ { -+ //only for action frames -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ //u8 category, action, OUI_Subtype, dialogToken=0; -+ //unsigned char *frame_body; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ u8 *buf = skb->data; -+ u32 len = skb->len; -+ u8 category, action; -+ int type = -1; -+ -+ if (rtw_action_frame_parse(buf, len, &category, &action) == false) { -+ DBG_8192C(FUNC_NDEV_FMT" frame_control:0x%x\n", FUNC_NDEV_ARG(ndev), -+ le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl)); -+ goto fail; -+ } -+ -+ DBG_8192C("RTW_Tx:da="MAC_FMT" via "FUNC_NDEV_FMT"\n", -+ MAC_ARG(GetAddr1Ptr(buf)), FUNC_NDEV_ARG(ndev)); -+ #ifdef CONFIG_P2P -+ if((type = rtw_p2p_check_frames(padapter, buf, len, true)) >= 0) -+ goto dump; -+ #endif -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) -+ DBG_871X("RTW_Tx:%s\n", action_public_str(action)); -+ else -+ DBG_871X("RTW_Tx:category(%u), action(%u)\n", category, action); -+ -+dump: -+ //starting alloc mgmt frame to dump it -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ goto fail; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = false; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ _rtw_memcpy(pframe, (void*)buf, len); -+ #ifdef CONFIG_WFD -+ if (type >= 0) -+ { -+ struct wifi_display_info *pwfd_info; -+ -+ pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if ( true == pwfd_info->wfd_enable ) -+ { -+ rtw_append_wfd_ie( padapter, pframe, &len ); -+ } -+ } -+ #endif // CONFIG_WFD -+ pattrib->pktlen = len; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ //update seq number -+ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ pmlmeext->mgnt_seq++; -+ -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ dump_mgntframe(padapter, pmgntframe); -+ -+ } -+ else -+ { -+ DBG_8192C("frame_ctl=0x%x\n", frame_ctl & (RTW_IEEE80211_FCTL_FTYPE|RTW_IEEE80211_FCTL_STYPE)); -+ } -+ -+ -+fail: -+ -+ dev_kfree_skb(skb); -+ -+ return 0; -+ -+} -+ -+static void rtw_cfg80211_monitor_if_set_multicast_list(struct net_device *ndev) -+{ -+ DBG_8192C("%s\n", __func__); -+} -+ -+static int rtw_cfg80211_monitor_if_set_mac_address(struct net_device *ndev, void *addr) -+{ -+ int ret = 0; -+ -+ DBG_8192C("%s\n", __func__); -+ -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+static const struct net_device_ops rtw_cfg80211_monitor_if_ops = { -+ .ndo_open = rtw_cfg80211_monitor_if_open, -+ .ndo_stop = rtw_cfg80211_monitor_if_close, -+ .ndo_start_xmit = rtw_cfg80211_monitor_if_xmit_entry, -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,2,0)) -+ .ndo_set_multicast_list = rtw_cfg80211_monitor_if_set_multicast_list, -+ #endif -+ .ndo_set_mac_address = rtw_cfg80211_monitor_if_set_mac_address, -+}; -+#endif -+ -+static int rtw_cfg80211_add_monitor_if(_adapter *padapter, char *name, struct net_device **ndev) -+{ -+ int ret = 0; -+ struct net_device* mon_ndev = NULL; -+ struct wireless_dev* mon_wdev = NULL; -+ struct rtw_netdev_priv_indicator *pnpi; -+ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); -+ -+ if (!name ) { -+ DBG_871X(FUNC_ADPT_FMT" without specific name\n", FUNC_ADPT_ARG(padapter)); -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ if (pwdev_priv->pmon_ndev) { -+ DBG_871X(FUNC_ADPT_FMT" monitor interface exist: "NDEV_FMT"\n", -+ FUNC_ADPT_ARG(padapter), NDEV_ARG(pwdev_priv->pmon_ndev)); -+ ret = -EBUSY; -+ goto out; -+ } -+ -+ mon_ndev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); -+ if (!mon_ndev) { -+ DBG_871X(FUNC_ADPT_FMT" allocate ndev fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ mon_ndev->type = ARPHRD_IEEE80211_RADIOTAP; -+ strncpy(mon_ndev->name, name, IFNAMSIZ); -+ mon_ndev->name[IFNAMSIZ - 1] = 0; -+ mon_ndev->destructor = rtw_ndev_destructor; -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+ mon_ndev->netdev_ops = &rtw_cfg80211_monitor_if_ops; -+#else -+ mon_ndev->open = rtw_cfg80211_monitor_if_open; -+ mon_ndev->stop = rtw_cfg80211_monitor_if_close; -+ mon_ndev->hard_start_xmit = rtw_cfg80211_monitor_if_xmit_entry; -+ mon_ndev->set_mac_address = rtw_cfg80211_monitor_if_set_mac_address; -+#endif -+ -+ pnpi = netdev_priv(mon_ndev); -+ pnpi->priv = padapter; -+ pnpi->sizeof_priv = sizeof(_adapter); -+ -+ /* wdev */ -+ mon_wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); -+ if (!mon_wdev) { -+ DBG_871X(FUNC_ADPT_FMT" allocate mon_wdev fail\n", FUNC_ADPT_ARG(padapter)); -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ mon_wdev->wiphy = padapter->rtw_wdev->wiphy; -+ mon_wdev->netdev = mon_ndev; -+ mon_wdev->iftype = NL80211_IFTYPE_MONITOR; -+ mon_ndev->ieee80211_ptr = mon_wdev; -+ -+ ret = register_netdevice(mon_ndev); -+ if (ret) { -+ goto out; -+ } -+ -+ *ndev = pwdev_priv->pmon_ndev = mon_ndev; -+ _rtw_memcpy(pwdev_priv->ifname_mon, name, IFNAMSIZ+1); -+ -+out: -+ if (ret && mon_wdev) { -+ rtw_mfree((u8*)mon_wdev, sizeof(struct wireless_dev)); -+ mon_wdev = NULL; -+ } -+ -+ if (ret && mon_ndev) { -+ free_netdev(mon_ndev); -+ *ndev = mon_ndev = NULL; -+ } -+ -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+static struct wireless_dev * -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+static struct net_device * -+#else -+static int -+#endif -+ cfg80211_rtw_add_virtual_intf( -+ struct wiphy *wiphy, -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,0)) -+ const char *name, -+ #else -+ char *name, -+ #endif -+ enum nl80211_iftype type, u32 *flags, struct vif_params *params) -+{ -+ int ret = 0; -+ struct net_device* ndev = NULL; -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ -+ DBG_871X(FUNC_ADPT_FMT " wiphy:%s, name:%s, type:%d\n", -+ FUNC_ADPT_ARG(padapter), wiphy_name(wiphy), name, type); -+ -+ switch (type) { -+ case NL80211_IFTYPE_ADHOC: -+ case NL80211_IFTYPE_AP_VLAN: -+ case NL80211_IFTYPE_WDS: -+ case NL80211_IFTYPE_MESH_POINT: -+ ret = -ENODEV; -+ break; -+ case NL80211_IFTYPE_MONITOR: -+ ret = rtw_cfg80211_add_monitor_if(padapter, (char *)name, &ndev); -+ break; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ case NL80211_IFTYPE_P2P_CLIENT: -+#endif -+ case NL80211_IFTYPE_STATION: -+ ret = -ENODEV; -+ break; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ case NL80211_IFTYPE_P2P_GO: -+#endif -+ case NL80211_IFTYPE_AP: -+ ret = -ENODEV; -+ break; -+ default: -+ ret = -ENODEV; -+ DBG_871X("Unsupported interface type\n"); -+ break; -+ } -+ -+ DBG_871X(FUNC_ADPT_FMT" ndev:%p, ret:%d\n", FUNC_ADPT_ARG(padapter), ndev, ret); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ return ndev ? ndev->ieee80211_ptr : ERR_PTR(ret); -+#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+ return ndev ? ndev : ERR_PTR(ret); -+#else -+ return ret; -+#endif -+} -+ -+static int cfg80211_rtw_del_virtual_intf(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct wireless_dev *wdev -+#else -+ struct net_device *ndev -+#endif -+) -+{ -+ struct rtw_wdev_priv *pwdev_priv = (struct rtw_wdev_priv *)wiphy_priv(wiphy); -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct net_device *ndev; -+ ndev = wdev ? wdev->netdev : NULL; -+#endif -+ -+ if (!ndev) -+ goto exit; -+ -+ unregister_netdevice(ndev); -+ -+ if (ndev == pwdev_priv->pmon_ndev) { -+ pwdev_priv->pmon_ndev = NULL; -+ pwdev_priv->ifname_mon[0] = '\0'; -+ DBG_871X(FUNC_NDEV_FMT" remove monitor interface\n", FUNC_NDEV_ARG(ndev)); -+ } -+ -+exit: -+ return 0; -+} -+ -+static int rtw_add_beacon(_adapter *adapter, const u8 *head, size_t head_len, const u8 *tail, size_t tail_len) -+{ -+ int ret=0; -+ u8 *pbuf = NULL; -+ uint len, wps_ielen=0; -+ uint p2p_ielen=0; -+ u8 *p2p_ie; -+ u8 got_p2p_ie = false; -+ struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); -+ //struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ -+ DBG_8192C("%s beacon_head_len=%zu, beacon_tail_len=%zu\n", __FUNCTION__, head_len, tail_len); -+ -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ if(head_len<24) -+ return -EINVAL; -+ -+ -+ pbuf = rtw_zmalloc(head_len+tail_len); -+ if(!pbuf) -+ return -ENOMEM; -+ -+ -+ //_rtw_memcpy(&pstapriv->max_num_sta, param->u.bcn_ie.reserved, 2); -+ -+ //if((pstapriv->max_num_sta>NUM_STA) || (pstapriv->max_num_sta<=0)) -+ // pstapriv->max_num_sta = NUM_STA; -+ -+ -+ _rtw_memcpy(pbuf, (void *)head+24, head_len-24);// 24=beacon header len. -+ _rtw_memcpy(pbuf+head_len-24, (void *)tail, tail_len); -+ -+ len = head_len+tail_len-24; -+ -+ //check wps ie if inclued -+ if(rtw_get_wps_ie(pbuf+_FIXED_IE_LENGTH_, len-_FIXED_IE_LENGTH_, NULL, &wps_ielen)) -+ DBG_8192C("add bcn, wps_ielen=%d\n", wps_ielen); -+ -+#ifdef CONFIG_P2P -+ if( adapter->wdinfo.driver_interface == DRIVER_CFG80211 ) -+ { -+ if(rtw_get_p2p_ie(pbuf+_FIXED_IE_LENGTH_, len-_FIXED_IE_LENGTH_, NULL, &p2p_ielen)) -+ { -+ DBG_8192C("got p2p_ie, len=%d\n", p2p_ielen); -+ got_p2p_ie = true; -+ } -+ } -+#endif -+ -+ /* pbss_network->IEs will not include p2p_ie, wfd ie */ -+ rtw_ies_remove_ie(pbuf, &len, _BEACON_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, P2P_OUI, 4); -+ rtw_ies_remove_ie(pbuf, &len, _BEACON_IE_OFFSET_, _VENDOR_SPECIFIC_IE_, WFD_OUI, 4); -+ -+ if (rtw_check_beacon_data(adapter, pbuf, len) == _SUCCESS) { -+#ifdef CONFIG_P2P -+ //check p2p if enable -+ if(got_p2p_ie == true) -+ { -+ struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; -+ struct wifidirect_info *pwdinfo= &(adapter->wdinfo); -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ DBG_8192C("Enable P2P function for the first time\n"); -+ rtw_p2p_enable(adapter, P2P_ROLE_GO); -+ wdev_to_priv(adapter->rtw_wdev)->p2p_enabled = true; -+ } -+ else -+ { -+ _cancel_timer_ex( &pwdinfo->find_phase_timer ); -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ _cancel_timer_ex( &pwdinfo->pre_tx_scan_timer); -+ -+ DBG_8192C("enter GO Mode, p2p_ielen=%d\n", p2p_ielen); -+ -+ rtw_p2p_set_role(pwdinfo, P2P_ROLE_GO); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_OK); -+ pwdinfo->intent = 15; -+ } -+ -+ pwdinfo->operating_channel = pmlmeext->cur_channel; -+ -+ } -+#endif //CONFIG_P2P -+ -+ ret = 0; -+ -+ } -+ else -+ { -+ ret = -EINVAL; -+ } -+ -+ -+ rtw_mfree(pbuf, head_len+tail_len); -+ -+ return ret; -+} -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0)) && !defined(COMPAT_KERNEL_RELEASE) -+static int cfg80211_rtw_add_beacon(struct wiphy *wiphy, struct net_device *ndev, -+ struct beacon_parameters *info) -+{ -+ int ret=0; -+ _adapter *adapter = wiphy_to_adapter(wiphy); -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_set_beacon(struct wiphy *wiphy, struct net_device *ndev, -+ struct beacon_parameters *info) -+{ -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ pmlmeext->bstart_bss = true; -+ -+ cfg80211_rtw_add_beacon(wiphy, ndev, info); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_del_beacon(struct wiphy *wiphy, struct net_device *ndev) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+#else -+static int cfg80211_rtw_start_ap(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_ap_settings *settings) -+{ -+ int ret = 0; -+ _adapter *adapter = wiphy_to_adapter(wiphy); -+ -+ DBG_871X(FUNC_NDEV_FMT" hidden_ssid:%d, auth_type:%d\n", FUNC_NDEV_ARG(ndev), -+ settings->hidden_ssid, settings->auth_type); -+ -+ ret = rtw_add_beacon(adapter, settings->beacon.head, settings->beacon.head_len, -+ settings->beacon.tail, settings->beacon.tail_len); -+ -+ adapter->mlmeextpriv.mlmext_info.hidden_ssid_mode = settings->hidden_ssid; -+ -+ if (settings->ssid && settings->ssid_len) { -+ WLAN_BSSID_EX *pbss_network = &adapter->mlmepriv.cur_network.network; -+ WLAN_BSSID_EX *pbss_network_ext = &adapter->mlmeextpriv.mlmext_info.network; -+ -+ if(0) -+ DBG_871X(FUNC_ADPT_FMT" ssid:(%s,%d), from ie:(%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ settings->ssid, (int)settings->ssid_len, -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength); -+ -+ _rtw_memcpy(pbss_network->Ssid.Ssid, (void *)settings->ssid, settings->ssid_len); -+ pbss_network->Ssid.SsidLength = settings->ssid_len; -+ _rtw_memcpy(pbss_network_ext->Ssid.Ssid, (void *)settings->ssid, settings->ssid_len); -+ pbss_network_ext->Ssid.SsidLength = settings->ssid_len; -+ -+ if(0) -+ DBG_871X(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, -+ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); -+ } -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_change_beacon(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_beacon_data *info) -+{ -+ int ret = 0; -+ _adapter *adapter = wiphy_to_adapter(wiphy); -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); -+ -+ return ret; -+} -+ -+static int cfg80211_rtw_stop_ap(struct wiphy *wiphy, struct net_device *ndev) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ return 0; -+} -+ -+#endif //(LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0)) -+ -+static int cfg80211_rtw_add_station(struct wiphy *wiphy, struct net_device *ndev, -+ u8 *mac, struct station_parameters *params) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_del_station(struct wiphy *wiphy, struct net_device *ndev, -+ u8 *mac) -+{ -+ int ret=0; -+ _irqL irqL; -+ _list *phead, *plist; -+ u8 updated; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("+"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) -+ { -+ DBG_8192C("%s, fw_state != FW_LINKED|WIFI_AP_STATE\n", __func__); -+ return -EINVAL; -+ } -+ -+ -+ if(!mac) -+ { -+ DBG_8192C("flush all sta, and cam_entry\n"); -+ -+ flush_all_cam_entry(padapter); //clear CAM -+ -+ ret = rtw_sta_flush(padapter); -+ -+ return ret; -+ } -+ -+ -+ DBG_8192C("free sta macaddr =" MAC_FMT "\n", MAC_ARG(mac)); -+ -+ if (mac[0] == 0xff && mac[1] == 0xff && -+ mac[2] == 0xff && mac[3] == 0xff && -+ mac[4] == 0xff && mac[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ //check asoc_queue -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ -+ plist = get_next(plist); -+ -+ if(_rtw_memcmp(mac, psta->hwaddr, ETH_ALEN)) -+ { -+ if(psta->dot8021xalg == 1 && psta->bpairwise_key_installed == false) -+ { -+ DBG_8192C("%s, sta's dot8021xalg = 1 and key_installed = false\n", __func__); -+ } -+ else -+ { -+ DBG_8192C("free psta=%p, aid=%d\n", psta, psta->aid); -+ -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ -+ //_exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ updated = ap_free_sta(padapter, psta, true, WLAN_REASON_DEAUTH_LEAVING); -+ //_enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ psta = NULL; -+ -+ break; -+ } -+ -+ } -+ -+ } -+ -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(padapter, updated); -+ -+ DBG_871X("-"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_change_station(struct wiphy *wiphy, struct net_device *ndev, -+ u8 *mac, struct station_parameters *params) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_dump_station(struct wiphy *wiphy, struct net_device *ndev, -+ int idx, u8 *mac, struct station_info *sinfo) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ //TODO: dump scanned queue -+ -+ return -ENOENT; -+} -+ -+static int cfg80211_rtw_change_bss(struct wiphy *wiphy, struct net_device *ndev, -+ struct bss_parameters *params) -+{ -+ u8 i; -+ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+/* -+ DBG_8192C("use_cts_prot=%d\n", params->use_cts_prot); -+ DBG_8192C("use_short_preamble=%d\n", params->use_short_preamble); -+ DBG_8192C("use_short_slot_time=%d\n", params->use_short_slot_time); -+ DBG_8192C("ap_isolate=%d\n", params->ap_isolate); -+ -+ DBG_8192C("basic_rates_len=%d\n", params->basic_rates_len); -+ for(i=0; ibasic_rates_len; i++) -+ { -+ DBG_8192C("basic_rates=%d\n", params->basic_rates[i]); -+ -+ } -+*/ -+ return 0; -+ -+} -+ -+static int cfg80211_rtw_set_channel(struct wiphy *wiphy -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ , struct net_device *ndev -+ #endif -+ , struct ieee80211_channel *chan, enum nl80211_channel_type channel_type) -+{ -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ #endif -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_auth(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_auth_request *req) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+ -+static int cfg80211_rtw_assoc(struct wiphy *wiphy, struct net_device *ndev, -+ struct cfg80211_assoc_request *req) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+ return 0; -+} -+#endif //CONFIG_AP_MODE -+ -+void rtw_cfg80211_rx_action_p2p(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) -+{ -+ int type; -+ s32 freq; -+ int channel; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ u8 category, action; -+ -+ channel = rtw_get_oper_ch(padapter); -+ -+ DBG_8192C("RTW_Rx:cur_ch=%d\n", channel); -+ #ifdef CONFIG_P2P -+ type = rtw_p2p_check_frames(padapter, pmgmt_frame, frame_len, false); -+ if (type >= 0) -+ goto indicate; -+ #endif -+ rtw_action_frame_parse(pmgmt_frame, frame_len, &category, &action); -+ DBG_871X("RTW_Rx:category(%u), action(%u)\n", category, action); -+ -+indicate: -+ if (channel <= RTW_CH_MAX_2G_CHANNEL) -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); -+ else -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_rx_mgmt(padapter, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); -+#else -+ cfg80211_rx_action(padapter->pnetdev, freq, pmgmt_frame, frame_len, GFP_ATOMIC); -+#endif -+} -+ -+void rtw_cfg80211_rx_p2p_action_public(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) -+{ -+ int type; -+ s32 freq; -+ int channel; -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ u8 category, action; -+ -+ channel = rtw_get_oper_ch(padapter); -+ -+ DBG_8192C("RTW_Rx:cur_ch=%d\n", channel); -+ #ifdef CONFIG_P2P -+ type = rtw_p2p_check_frames(padapter, pmgmt_frame, frame_len, false); -+ if (type >= 0) { -+ switch (type) { -+ case P2P_GO_NEGO_CONF: -+ case P2P_PROVISION_DISC_RESP: -+ rtw_clear_scan_deny(padapter); -+ } -+ goto indicate; -+ } -+ #endif -+ rtw_action_frame_parse(pmgmt_frame, frame_len, &category, &action); -+ DBG_871X("RTW_Rx:category(%u), action(%u)\n", category, action); -+ -+indicate: -+ if (channel <= RTW_CH_MAX_2G_CHANNEL) -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); -+ else -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_rx_mgmt(padapter, freq, 0, pmgmt_frame, frame_len, GFP_ATOMIC); -+#else -+ cfg80211_rx_action(padapter->pnetdev, freq, pmgmt_frame, frame_len, GFP_ATOMIC); -+#endif -+} -+ -+void rtw_cfg80211_rx_action(_adapter *adapter, u8 *frame, uint frame_len, const char*msg) -+{ -+ s32 freq; -+ int channel; -+ struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); -+ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(adapter->rtw_wdev); -+ u8 category, action; -+ -+ channel = rtw_get_oper_ch(adapter); -+ -+ rtw_action_frame_parse(frame, frame_len, &category, &action); -+ -+ DBG_8192C("RTW_Rx:cur_ch=%d\n", channel); -+ if (msg) -+ DBG_871X("RTW_Rx:%s\n", msg); -+ else -+ DBG_871X("RTW_Rx:category(%u), action(%u)\n", category, action); -+ -+ if (channel <= RTW_CH_MAX_2G_CHANNEL) -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_2GHZ); -+ else -+ freq = rtw_ieee80211_channel_to_frequency(channel, IEEE80211_BAND_5GHZ); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_rx_mgmt(adapter, freq, 0, frame, frame_len, GFP_ATOMIC); -+#else -+ cfg80211_rx_action(adapter->pnetdev, freq, frame, frame_len, GFP_ATOMIC); -+#endif -+ -+} -+ -+#ifdef CONFIG_P2P -+void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, size_t len) -+{ -+ u16 wps_devicepassword_id = 0x0000; -+ uint wps_devicepassword_id_len = 0; -+ u8 wpsie[ 255 ] = { 0x00 }, p2p_ie[ 255 ] = { 0x00 }; -+ uint p2p_ielen = 0; -+ uint wpsielen = 0; -+ u32 devinfo_contentlen = 0; -+ u8 devinfo_content[64] = { 0x00 }; -+ u16 capability = 0; -+ uint capability_len = 0; -+ -+ unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; -+ u8 action = P2P_PUB_ACTION_ACTION; -+ u8 dialogToken = 1; -+ u32 p2poui = cpu_to_be32(P2POUI); -+ u8 oui_subtype = P2P_PROVISION_DISC_REQ; -+ u32 p2pielen = 0; -+#ifdef CONFIG_WFD -+ u32 wfdielen = 0; -+#endif //CONFIG_WFD -+ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ unsigned short *fctrl; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -+ u8 *frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); -+ size_t frame_body_len = len - sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ -+ DBG_871X( "[%s] In\n", __FUNCTION__ ); -+ -+ //prepare for building provision_request frame -+ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerIFAddr, GetAddr1Ptr(buf), ETH_ALEN); -+ _rtw_memcpy(pwdinfo->tx_prov_disc_info.peerDevAddr, GetAddr1Ptr(buf), ETH_ALEN); -+ -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; -+ -+ rtw_get_wps_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, wpsie, &wpsielen); -+ rtw_get_wps_attr_content( wpsie, wpsielen, WPS_ATTR_DEVICE_PWID, (u8*) &wps_devicepassword_id, &wps_devicepassword_id_len); -+ wps_devicepassword_id = be16_to_cpu( wps_devicepassword_id ); -+ -+ switch(wps_devicepassword_id) -+ { -+ case WPS_DPID_PIN: -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_LABEL; -+ break; -+ case WPS_DPID_USER_SPEC: -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_DISPLYA; -+ break; -+ case WPS_DPID_MACHINE_SPEC: -+ break; -+ case WPS_DPID_REKEY: -+ break; -+ case WPS_DPID_PBC: -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; -+ break; -+ case WPS_DPID_REGISTRAR_SPEC: -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_KEYPAD; -+ break; -+ default: -+ break; -+ } -+ -+ -+ if ( rtw_get_p2p_ie( frame_body + _PUBLIC_ACTION_IE_OFFSET_, frame_body_len - _PUBLIC_ACTION_IE_OFFSET_, p2p_ie, &p2p_ielen ) ) -+ { -+ -+ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_DEVICE_INFO, devinfo_content, &devinfo_contentlen); -+ rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8*)&capability, &capability_len); -+ -+ } -+ -+ -+ //start to build provision_request frame -+ _rtw_memset(wpsie, 0, sizeof(wpsie)); -+ _rtw_memset(p2p_ie, 0, sizeof(p2p_ie)); -+ p2p_ielen = 0; -+ -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ return; -+ } -+ -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ -+ fctrl = &(pwlanhdr->frame_ctl); -+ *(fctrl) = 0; -+ -+ _rtw_memcpy(pwlanhdr->addr1, pwdinfo->tx_prov_disc_info.peerDevAddr, ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr2, myid(&(padapter->eeprompriv)), ETH_ALEN); -+ _rtw_memcpy(pwlanhdr->addr3, pwdinfo->tx_prov_disc_info.peerDevAddr, ETH_ALEN); -+ -+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); -+ pmlmeext->mgnt_seq++; -+ SetFrameSubType(pframe, WIFI_ACTION); -+ -+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr); -+ pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); -+ -+ pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 4, (unsigned char *) &(p2poui), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(oui_subtype), &(pattrib->pktlen)); -+ pframe = rtw_set_fixed_ie(pframe, 1, &(dialogToken), &(pattrib->pktlen)); -+ -+ -+ //build_prov_disc_request_p2p_ie -+ // P2P OUI -+ p2pielen = 0; -+ p2p_ie[ p2pielen++ ] = 0x50; -+ p2p_ie[ p2pielen++ ] = 0x6F; -+ p2p_ie[ p2pielen++ ] = 0x9A; -+ p2p_ie[ p2pielen++ ] = 0x09; // WFA P2P v1.0 -+ -+ // Commented by Albert 20110301 -+ // According to the P2P Specification, the provision discovery request frame should contain 3 P2P attributes -+ // 1. P2P Capability -+ // 2. Device Info -+ // 3. Group ID ( When joining an operating P2P Group ) -+ -+ // P2P Capability ATTR -+ // Type: -+ p2p_ie[ p2pielen++ ] = P2P_ATTR_CAPABILITY; -+ -+ // Length: -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 0x0002 ); -+ RTW_PUT_LE16(p2p_ie + p2pielen, 0x0002); -+ p2pielen += 2; -+ -+ // Value: -+ // Device Capability Bitmap, 1 byte -+ // Group Capability Bitmap, 1 byte -+ _rtw_memcpy(p2p_ie + p2pielen, &capability, 2); -+ p2pielen += 2; -+ -+ -+ // Device Info ATTR -+ // Type: -+ p2p_ie[ p2pielen++ ] = P2P_ATTR_DEVICE_INFO; -+ -+ // Length: -+ // 21 -> P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) -+ // + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) -+ //*(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); -+ RTW_PUT_LE16(p2p_ie + p2pielen, devinfo_contentlen); -+ p2pielen += 2; -+ -+ // Value: -+ _rtw_memcpy(p2p_ie + p2pielen, devinfo_content, devinfo_contentlen); -+ p2pielen += devinfo_contentlen; -+ -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2p_ie, &p2p_ielen); -+ //p2pielen = build_prov_disc_request_p2p_ie( pwdinfo, pframe, NULL, 0, pwdinfo->tx_prov_disc_info.peerDevAddr); -+ //pframe += p2pielen; -+ pattrib->pktlen += p2p_ielen; -+ -+ wpsielen = 0; -+ // WPS OUI -+ *(u32*) ( wpsie ) = cpu_to_be32( WPSOUI ); -+ wpsielen += 4; -+ -+ // WPS version -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_VER1 ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0001 ); -+ wpsielen += 2; -+ -+ // Value: -+ wpsie[wpsielen++] = WPS_VERSION_1; // Version 1.0 -+ -+ // Config Method -+ // Type: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( WPS_ATTR_CONF_METHOD ); -+ wpsielen += 2; -+ -+ // Length: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( 0x0002 ); -+ wpsielen += 2; -+ -+ // Value: -+ *(u16*) ( wpsie + wpsielen ) = cpu_to_be16( pwdinfo->tx_prov_disc_info.wps_config_method_request ); -+ wpsielen += 2; -+ -+ pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wpsielen, (unsigned char *) wpsie, &pattrib->pktlen ); -+ -+ -+#ifdef CONFIG_WFD -+ wfdielen = build_provdisc_req_wfd_ie(pwdinfo, pframe); -+ pframe += wfdielen; -+ pattrib->pktlen += wfdielen; -+#endif //CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ //dump_mgntframe(padapter, pmgntframe); -+ if (dump_mgntframe_and_wait_ack(padapter, pmgntframe) != _SUCCESS) -+ DBG_8192C("%s, ack to\n", __func__); -+ -+ //if(wps_devicepassword_id == WPS_DPID_REGISTRAR_SPEC) -+ //{ -+ // DBG_8192C("waiting for p2p peer key-in PIN CODE\n"); -+ // rtw_msleep_os(15000); // 15 sec for key in PIN CODE, workaround for GS2 before issuing Nego Req. -+ //} -+ -+} -+ -+static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct wireless_dev *wdev, -+#else -+ struct net_device *ndev, -+#endif -+ struct ieee80211_channel * channel, -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) -+ enum nl80211_channel_type channel_type, -+#endif -+ unsigned int duration, u64 *cookie) -+{ -+ s32 err = 0; -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+ u8 remain_ch = (u8) ieee80211_frequency_to_channel(channel->center_freq); -+ u8 ready_on_channel = false; -+ -+ DBG_871X(FUNC_ADPT_FMT" ch:%u duration:%d\n", FUNC_ADPT_ARG(padapter), remain_ch, duration); -+ -+ if(pcfg80211_wdinfo->is_ro_ch == true) -+ { -+ DBG_8192C("%s, cancel ro ch timer\n", __func__); -+ -+ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_SET(&pwdev_priv->ro_ch_to, 1); -+#endif //CONFIG_CONCURRENT_MODE -+ -+ p2p_protocol_wk_hdl(padapter, P2P_RO_CH_WK); -+ } -+ -+ pcfg80211_wdinfo->is_ro_ch = true; -+ -+ if(_FAIL == rtw_pwr_wakeup(padapter)) { -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ _rtw_memcpy(&pcfg80211_wdinfo->remain_on_ch_channel, channel, sizeof(struct ieee80211_channel)); -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) -+ pcfg80211_wdinfo->remain_on_ch_type= channel_type; -+ #endif -+ pcfg80211_wdinfo->remain_on_ch_cookie= *cookie; -+ -+ rtw_scan_abort(padapter); -+#ifdef CONFIG_CONCURRENT_MODE -+ if(rtw_buddy_adapter_up(padapter)) -+ rtw_scan_abort(padapter->pbuddy_adapter); -+#endif //CONFIG_CONCURRENT_MODE -+ -+ //if(!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); -+ wdev_to_priv(padapter->rtw_wdev)->p2p_enabled = true; -+ } -+ else -+ { -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); -+#endif -+ } -+ -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); -+ -+ -+ if(duration < 400) -+ duration = duration*3;//extend from exper. -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(check_buddy_fwstate(padapter, _FW_LINKED) && -+ (durationext_listen_interval)) -+ { -+ duration = duration + pwdinfo->ext_listen_interval; -+ } -+#endif -+ -+ pcfg80211_wdinfo->restore_channel = pmlmeext->cur_channel; -+ -+ if(rtw_ch_set_search_ch(pmlmeext->channel_set, remain_ch) >= 0) { -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_buddy_fwstate(padapter, _FW_LINKED ) ) -+ { -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ if(remain_ch != pbuddy_mlmeext->cur_channel) -+ { -+ if(ATOMIC_READ(&pwdev_priv->switch_ch_to)==1 || -+ (remain_ch != pmlmeext->cur_channel)) -+ { -+ DBG_8192C("%s, issue nulldata pwrbit=1\n", __func__); -+ issue_nulldata(padapter->pbuddy_adapter, NULL, 1, 3, 500); -+ -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); -+ -+ DBG_8192C("%s, set switch ch timer, duration=%d\n", __func__, duration-pwdinfo->ext_listen_interval); -+ _set_timer(&pwdinfo->ap_p2p_switch_timer, duration-pwdinfo->ext_listen_interval); -+ } -+ } -+ -+ ready_on_channel = true; -+ //pmlmeext->cur_channel = remain_ch; -+ //set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ }else -+#endif //CONFIG_CONCURRENT_MODE -+ if(remain_ch != pmlmeext->cur_channel ) -+ { -+ ready_on_channel = true; -+ //pmlmeext->cur_channel = remain_ch; -+ //set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ } else { -+ DBG_871X("%s remain_ch:%u not in channel plan!!!!\n", __FUNCTION__, remain_ch); -+ } -+ -+ -+ //call this after other things have been done -+#ifdef CONFIG_CONCURRENT_MODE -+ if(ATOMIC_READ(&pwdev_priv->ro_ch_to)==1 || -+ (remain_ch != pmlmeext->cur_channel)) -+ { -+ u8 co_channel = 0xff; -+ ATOMIC_SET(&pwdev_priv->ro_ch_to, 0); -+#endif -+ -+ if(ready_on_channel == true) -+ { -+ if ( !check_fwstate(&padapter->mlmepriv, _FW_LINKED ) ) -+ pmlmeext->cur_channel = remain_ch; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ co_channel = rtw_get_oper_ch(padapter); -+ -+ if(co_channel !=remain_ch) -+#endif -+ { -+ if (!padapter->mlmepriv.LinkDetectInfo.bBusyTraffic) -+ set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ } -+ DBG_8192C("%s, set ro ch timer, duration=%d\n", __func__, duration); -+ _set_timer( &pcfg80211_wdinfo->remain_on_ch_timer, duration); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ } -+#endif -+ -+ rtw_cfg80211_ready_on_channel(padapter, *cookie, channel, channel_type, duration, GFP_KERNEL); -+ -+ pwdinfo->listen_channel = pmlmeext->cur_channel; -+ -+exit: -+ if (err) -+ pcfg80211_wdinfo->is_ro_ch = false; -+ -+ return err; -+} -+ -+static s32 cfg80211_rtw_cancel_remain_on_channel(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct wireless_dev *wdev, -+#else -+ struct net_device *ndev, -+#endif -+ u64 cookie) -+{ -+ s32 err = 0; -+ _adapter *padapter = wiphy_to_adapter(wiphy); -+ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+ -+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -+ -+ if (pcfg80211_wdinfo->is_ro_ch == true) { -+ DBG_8192C("%s, cancel ro ch timer\n", __func__); -+ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); -+ #ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_SET(&pwdev_priv->ro_ch_to, 1); -+ #endif -+ p2p_protocol_wk_hdl(padapter, P2P_RO_CH_WK); -+ } -+ -+ #if 0 -+ // Disable P2P Listen State -+ if(!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ _cancel_timer_ex( &pwdinfo->find_phase_timer ); -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ _cancel_timer_ex( &pwdinfo->pre_tx_scan_timer); -+ -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE); -+ _rtw_memset(pwdinfo, 0x00, sizeof(struct wifidirect_info)); -+ } -+ } -+ else -+ #endif -+ { -+ rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); -+#endif -+ } -+ pcfg80211_wdinfo->is_ro_ch = false; -+ -+ return err; -+} -+ -+#endif //CONFIG_P2P -+ -+static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, const u8 *buf, size_t len) -+{ -+ struct xmit_frame *pmgntframe; -+ struct pkt_attrib *pattrib; -+ unsigned char *pframe; -+ int ret = _FAIL; -+ bool ack = true; -+ struct rtw_ieee80211_hdr *pwlanhdr; -+ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ //struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -+ -+ if(_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ rtw_set_scan_deny(padapter, 1000); -+ -+ rtw_scan_abort(padapter); -+ #ifdef CONFIG_CONCURRENT_MODE -+ if(rtw_buddy_adapter_up(padapter)) -+ rtw_scan_abort(padapter->pbuddy_adapter); -+ #endif /* CONFIG_CONCURRENT_MODE */ -+ -+ if (padapter->cfg80211_wdinfo.is_ro_ch == true) { -+ //DBG_8192C("%s, cancel ro ch timer\n", __func__); -+ //_cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); -+ //padapter->cfg80211_wdinfo.is_ro_ch = false; -+ #ifdef CONFIG_CONCURRENT_MODE -+ DBG_8192C("%s, extend ro ch time\n", __func__); -+ _set_timer( &padapter->cfg80211_wdinfo.remain_on_ch_timer, pwdinfo->ext_listen_period); -+ #endif //CONFIG_CONCURRENT_MODE -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, _FW_LINKED )) { -+ u8 co_channel=0xff; -+ PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ co_channel = rtw_get_oper_ch(padapter); -+ -+ if (tx_ch != pbuddy_mlmeext->cur_channel) { -+ if (ATOMIC_READ(&pwdev_priv->switch_ch_to)==1) { -+ DBG_8192C("%s, issue nulldata pwrbit=1\n", __func__); -+ issue_nulldata(padapter->pbuddy_adapter, NULL, 1, 3, 500); -+ -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); -+ -+ //DBG_8192C("%s, set switch ch timer, period=%d\n", __func__, pwdinfo->ext_listen_period); -+ //_set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period); -+ } -+ -+ DBG_8192C("%s, set switch ch timer, period=%d\n", __func__, pwdinfo->ext_listen_period); -+ _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period); -+ } -+ -+ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED )) -+ pmlmeext->cur_channel = tx_ch; -+ -+ if (tx_ch != co_channel) -+ set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ }else -+#endif //CONFIG_CONCURRENT_MODE -+ //if (tx_ch != pmlmeext->cur_channel) { -+ if(tx_ch != rtw_get_oper_ch(padapter)) { -+ if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED )) -+ pmlmeext->cur_channel = tx_ch; -+ set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ -+ //starting alloc mgmt frame to dump it -+ if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) -+ { -+ //ret = -ENOMEM; -+ ret = _FAIL; -+ goto exit; -+ } -+ -+ //update attribute -+ pattrib = &pmgntframe->attrib; -+ update_mgntframe_attrib(padapter, pattrib); -+ pattrib->retry_ctrl = false; -+ -+ _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); -+ -+ pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; -+ -+ _rtw_memcpy(pframe, (void*)buf, len); -+ pattrib->pktlen = len; -+ -+ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; -+ //update seq number -+ pmlmeext->mgnt_seq = GetSequence(pwlanhdr); -+ pattrib->seqnum = pmlmeext->mgnt_seq; -+ pmlmeext->mgnt_seq++; -+ -+#ifdef CONFIG_WFD -+ { -+ struct wifi_display_info *pwfd_info; -+ -+ pwfd_info = padapter->wdinfo.wfd_info; -+ -+ if ( true == pwfd_info->wfd_enable ) -+ { -+ rtw_append_wfd_ie( padapter, pframe, &pattrib->pktlen ); -+ } -+ } -+#endif // CONFIG_WFD -+ -+ pattrib->last_txcmdsz = pattrib->pktlen; -+ -+ if (dump_mgntframe_and_wait_ack(padapter, pmgntframe) != _SUCCESS) -+ { -+ ack = false; -+ ret = _FAIL; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ack == _FAIL\n", __func__); -+ #endif -+ } -+ else -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ack=%d, ok!\n", __func__, ack); -+ #endif -+ ret = _SUCCESS; -+ } -+ -+exit: -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ret=%d\n", __func__, ret); -+ #endif -+ -+ return ret; -+ -+} -+ -+static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)) -+ struct wireless_dev *wdev, -+#else -+ struct net_device *ndev, -+#endif -+ struct ieee80211_channel *chan, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+ bool offchan, -+#endif -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) -+ enum nl80211_channel_type channel_type, -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ bool channel_type_valid, -+ #endif -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+ unsigned int wait, -+#endif -+ const u8 *buf, size_t len, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,2,0)) -+ bool no_cck, -+#endif -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,3,0)) -+ bool dont_wait_for_ack, -+#endif -+ u64 *cookie) -+{ -+ _adapter *padapter = (_adapter *)wiphy_to_adapter(wiphy); -+ struct rtw_wdev_priv *pwdev_priv = wdev_to_priv(padapter->rtw_wdev); -+ int ret = 0; -+ int tx_ret; -+ u32 dump_limit = RTW_MAX_MGMT_TX_CNT; -+ u32 dump_cnt = 0; -+ bool ack = true; -+ u8 tx_ch = (u8)ieee80211_frequency_to_channel(chan->center_freq); -+ u8 category, action; -+ int type = (-1); -+ u32 start = rtw_get_current_time(); -+ -+ /* cookie generation */ -+ *cookie = (unsigned long) buf; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X(FUNC_ADPT_FMT" len=%zu, ch=%d" -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) -+ ", ch_type=%d" -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ ", channel_type_valid=%d" -+ #endif -+ #endif -+ "\n", FUNC_ADPT_ARG(padapter), -+ len, tx_ch -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)) -+ , channel_type -+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ , channel_type_valid -+ #endif -+ #endif -+ ); -+#endif /* CONFIG_DEBUG_CFG80211 */ -+ -+ /* indicate ack before issue frame to avoid racing with rsp frame */ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ rtw_cfg80211_mgmt_tx_status(padapter, *cookie, buf, len, ack, GFP_KERNEL); -+#elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,34) && LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,35)) -+ cfg80211_action_tx_status(ndev, *cookie, buf, len, ack, GFP_KERNEL); -+#endif -+ -+ if (rtw_action_frame_parse(buf, len, &category, &action) == false) { -+ DBG_8192C(FUNC_ADPT_FMT" frame_control:0x%x\n", FUNC_ADPT_ARG(padapter), -+ le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl)); -+ goto exit; -+ } -+ -+ DBG_8192C("RTW_Tx:tx_ch=%d, da="MAC_FMT"\n", tx_ch, MAC_ARG(GetAddr1Ptr(buf))); -+ #ifdef CONFIG_P2P -+ if((type = rtw_p2p_check_frames(padapter, buf, len, true)) >= 0) -+ goto dump; -+ #endif -+ if (category == RTW_WLAN_CATEGORY_PUBLIC) -+ DBG_871X("RTW_Tx:%s\n", action_public_str(action)); -+ else -+ DBG_871X("RTW_Tx:category(%u), action(%u)\n", category, action); -+ -+dump: -+ do { -+ dump_cnt++; -+ tx_ret = _cfg80211_rtw_mgmt_tx(padapter, tx_ch, buf, len); -+ } while (dump_cnt < dump_limit && tx_ret != _SUCCESS); -+ -+ if (tx_ret != _SUCCESS || dump_cnt > 1) { -+ DBG_871X(FUNC_ADPT_FMT" %s (%d/%d) in %d ms\n", FUNC_ADPT_ARG(padapter), -+ tx_ret==_SUCCESS?"OK":"FAIL", dump_cnt, dump_limit, rtw_get_passing_time_ms(start)); -+ } -+ -+ switch (type) { -+ case P2P_GO_NEGO_CONF: -+ rtw_clear_scan_deny(padapter); -+ break; -+ case P2P_INVIT_RESP: -+ if (pwdev_priv->invit_info.flags & BIT(0) -+ && pwdev_priv->invit_info.status == 0) -+ { -+ DBG_871X(FUNC_ADPT_FMT" agree with invitation of persistent group\n", -+ FUNC_ADPT_ARG(padapter)); -+ rtw_set_scan_deny(padapter, 5000); -+ rtw_pwr_wakeup_ex(padapter, 5000); -+ rtw_clear_scan_deny(padapter); -+ } -+ break; -+ } -+ -+exit: -+ return ret; -+} -+ -+static void cfg80211_rtw_mgmt_frame_register(struct wiphy *wiphy, -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) -+ struct wireless_dev *wdev, -+#else -+ struct net_device *ndev, -+#endif -+ u16 frame_type, bool reg) -+{ -+ _adapter *adapter = wiphy_to_adapter(wiphy); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_871X(FUNC_ADPT_FMT" frame_type:%x, reg:%d\n", FUNC_ADPT_ARG(adapter), -+ frame_type, reg); -+#endif -+ -+ if (frame_type != (IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_PROBE_REQ)) -+ return; -+ -+ return; -+} -+ -+static int rtw_cfg80211_set_beacon_wpsp2pie(struct net_device *ndev, char *buf, int len) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u8 *wps_ie; -+ u32 p2p_ielen = 0; -+ u8 wps_oui[8]={0x0,0x50,0xf2,0x04}; -+ u8 *p2p_ie; -+ u32 wfd_ielen = 0; -+ u8 *wfd_ie; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ -+ DBG_871X(FUNC_NDEV_FMT" ielen=%d\n", FUNC_NDEV_ARG(ndev), len); -+ -+ if(len>0) -+ { -+ if((wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen))) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("bcn_wps_ielen=%d\n", wps_ielen); -+ #endif -+ -+ if(pmlmepriv->wps_beacon_ie) -+ { -+ u32 free_len = pmlmepriv->wps_beacon_ie_len; -+ pmlmepriv->wps_beacon_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_beacon_ie, free_len); -+ pmlmepriv->wps_beacon_ie = NULL; -+ } -+ -+ pmlmepriv->wps_beacon_ie = rtw_malloc(wps_ielen); -+ if ( pmlmepriv->wps_beacon_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ -+ _rtw_memcpy(pmlmepriv->wps_beacon_ie, wps_ie, wps_ielen); -+ pmlmepriv->wps_beacon_ie_len = wps_ielen; -+ -+ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, true); -+ -+ } -+ -+ //buf += wps_ielen; -+ //len -= wps_ielen; -+ -+ #ifdef CONFIG_P2P -+ if((p2p_ie=rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen))) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("bcn_p2p_ielen=%d\n", p2p_ielen); -+ #endif -+ -+ if(pmlmepriv->p2p_beacon_ie) -+ { -+ u32 free_len = pmlmepriv->p2p_beacon_ie_len; -+ pmlmepriv->p2p_beacon_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_beacon_ie, free_len); -+ pmlmepriv->p2p_beacon_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_beacon_ie = rtw_malloc(p2p_ielen); -+ if ( pmlmepriv->p2p_beacon_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ -+ _rtw_memcpy(pmlmepriv->p2p_beacon_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_beacon_ie_len = p2p_ielen; -+ -+ } -+ #endif //CONFIG_P2P -+ -+ //buf += p2p_ielen; -+ //len -= p2p_ielen; -+ -+ #ifdef CONFIG_WFD -+ if(rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen)) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("bcn_wfd_ielen=%d\n", wfd_ielen); -+ #endif -+ -+ if(pmlmepriv->wfd_beacon_ie) -+ { -+ u32 free_len = pmlmepriv->wfd_beacon_ie_len; -+ pmlmepriv->wfd_beacon_ie_len = 0; -+ rtw_mfree(pmlmepriv->wfd_beacon_ie, free_len); -+ pmlmepriv->wfd_beacon_ie = NULL; -+ } -+ -+ pmlmepriv->wfd_beacon_ie = rtw_malloc(wfd_ielen); -+ if ( pmlmepriv->wfd_beacon_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ rtw_get_wfd_ie(buf, len, pmlmepriv->wfd_beacon_ie, &pmlmepriv->wfd_beacon_ie_len); -+ } -+ #endif //CONFIG_WFD -+ -+ pmlmeext->bstart_bss = true; -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_cfg80211_set_probe_resp_wpsp2pie(struct net_device *net, char *buf, int len) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u8 *wps_ie; -+ u32 p2p_ielen = 0; -+ u8 *p2p_ie; -+ u32 wfd_ielen = 0; -+ u8 *wfd_ie; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ielen=%d\n", __func__, len); -+#endif -+ -+ if(len>0) -+ { -+ if((wps_ie = rtw_get_wps_ie(buf, len, NULL, &wps_ielen))) -+ { -+ uint attr_contentlen = 0; -+ u16 uconfig_method, *puconfig_method = NULL; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_resp_wps_ielen=%d\n", wps_ielen); -+ #endif -+ -+ if(pmlmepriv->wps_probe_resp_ie) -+ { -+ u32 free_len = pmlmepriv->wps_probe_resp_ie_len; -+ pmlmepriv->wps_probe_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_probe_resp_ie, free_len); -+ pmlmepriv->wps_probe_resp_ie = NULL; -+ } -+ -+ pmlmepriv->wps_probe_resp_ie = rtw_malloc(wps_ielen); -+ if ( pmlmepriv->wps_probe_resp_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ -+ //add PUSH_BUTTON config_method by driver self in wpsie of probe_resp at GO Mode -+ if ( (puconfig_method = (u16*)rtw_get_wps_attr_content( wps_ie, wps_ielen, WPS_ATTR_CONF_METHOD , NULL, &attr_contentlen)) != NULL ) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ //printk("config_method in wpsie of probe_resp = 0x%x\n", be16_to_cpu(*puconfig_method)); -+ #endif -+ -+ uconfig_method = WPS_CM_PUSH_BUTTON; -+ uconfig_method = cpu_to_be16( uconfig_method ); -+ -+ *puconfig_method |= uconfig_method; -+ } -+ -+ _rtw_memcpy(pmlmepriv->wps_probe_resp_ie, wps_ie, wps_ielen); -+ pmlmepriv->wps_probe_resp_ie_len = wps_ielen; -+ -+ } -+ -+ //buf += wps_ielen; -+ //len -= wps_ielen; -+ -+ #ifdef CONFIG_P2P -+ if((p2p_ie=rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen))) -+ { -+ u8 is_GO = false; -+ u32 attr_contentlen = 0; -+ u16 cap_attr=0; -+ -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_resp_p2p_ielen=%d\n", p2p_ielen); -+ #endif -+ -+ //Check P2P Capability ATTR -+ if( rtw_get_p2p_attr_content( p2p_ie, p2p_ielen, P2P_ATTR_CAPABILITY, (u8*)&cap_attr, (uint*) &attr_contentlen) ) -+ { -+ u8 grp_cap=0; -+ //DBG_8192C( "[%s] Got P2P Capability Attr!!\n", __FUNCTION__ ); -+ cap_attr = le16_to_cpu(cap_attr); -+ grp_cap = (u8)((cap_attr >> 8)&0xff); -+ -+ is_GO = (grp_cap&BIT(0)) ? true:false; -+ -+ if(is_GO) -+ DBG_8192C("Got P2P Capability Attr, grp_cap=0x%x, is_GO\n", grp_cap); -+ } -+ -+ -+ if(is_GO == false) -+ { -+ if(pmlmepriv->p2p_probe_resp_ie) -+ { -+ u32 free_len = pmlmepriv->p2p_probe_resp_ie_len; -+ pmlmepriv->p2p_probe_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_probe_resp_ie, free_len); -+ pmlmepriv->p2p_probe_resp_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_probe_resp_ie = rtw_malloc(p2p_ielen); -+ if ( pmlmepriv->p2p_probe_resp_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->p2p_probe_resp_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_probe_resp_ie_len = p2p_ielen; -+ } -+ else -+ { -+ if(pmlmepriv->p2p_go_probe_resp_ie) -+ { -+ u32 free_len = pmlmepriv->p2p_go_probe_resp_ie_len; -+ pmlmepriv->p2p_go_probe_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->p2p_go_probe_resp_ie, free_len); -+ pmlmepriv->p2p_go_probe_resp_ie = NULL; -+ } -+ -+ pmlmepriv->p2p_go_probe_resp_ie = rtw_malloc(p2p_ielen); -+ if ( pmlmepriv->p2p_go_probe_resp_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->p2p_go_probe_resp_ie, p2p_ie, p2p_ielen); -+ pmlmepriv->p2p_go_probe_resp_ie_len = p2p_ielen; -+ } -+ -+ } -+ #endif //CONFIG_P2P -+ -+ //buf += p2p_ielen; -+ //len -= p2p_ielen; -+ -+ #ifdef CONFIG_WFD -+ if(rtw_get_wfd_ie(buf, len, NULL, &wfd_ielen)) -+ { -+ #ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("probe_resp_wfd_ielen=%d\n", wfd_ielen); -+ #endif -+ -+ if(pmlmepriv->wfd_probe_resp_ie) -+ { -+ u32 free_len = pmlmepriv->wfd_probe_resp_ie_len; -+ pmlmepriv->wfd_probe_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->wfd_probe_resp_ie, free_len); -+ pmlmepriv->wfd_probe_resp_ie = NULL; -+ } -+ -+ pmlmepriv->wfd_probe_resp_ie = rtw_malloc(wfd_ielen); -+ if ( pmlmepriv->wfd_probe_resp_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ rtw_get_wfd_ie(buf, len, pmlmepriv->wfd_probe_resp_ie, &pmlmepriv->wfd_probe_resp_ie_len); -+ } -+ #endif //CONFIG_WFD -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_cfg80211_set_assoc_resp_wpsp2pie(struct net_device *net, char *buf, int len) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ DBG_8192C("%s, ielen=%d\n", __func__, len); -+ -+ if(len>0) -+ { -+ if(pmlmepriv->wps_assoc_resp_ie) -+ { -+ u32 free_len = pmlmepriv->wps_assoc_resp_ie_len; -+ pmlmepriv->wps_assoc_resp_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_assoc_resp_ie, free_len); -+ pmlmepriv->wps_assoc_resp_ie = NULL; -+ } -+ -+ pmlmepriv->wps_assoc_resp_ie = rtw_malloc(len); -+ if ( pmlmepriv->wps_assoc_resp_ie == NULL) { -+ DBG_8192C("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ -+ } -+ _rtw_memcpy(pmlmepriv->wps_assoc_resp_ie, buf, len); -+ pmlmepriv->wps_assoc_resp_ie_len = len; -+ } -+ -+ return ret; -+ -+} -+ -+int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, -+ int type) -+{ -+ int ret = 0; -+ uint wps_ielen = 0; -+ u32 p2p_ielen = 0; -+ -+#ifdef CONFIG_DEBUG_CFG80211 -+ DBG_8192C("%s, ielen=%d\n", __func__, len); -+#endif -+ -+ if( (rtw_get_wps_ie(buf, len, NULL, &wps_ielen) && (wps_ielen>0)) -+ #ifdef CONFIG_P2P -+ || (rtw_get_p2p_ie(buf, len, NULL, &p2p_ielen) && (p2p_ielen>0)) -+ #endif -+ ) -+ { -+ if (net != NULL) -+ { -+ switch (type) -+ { -+ case 0x1: //BEACON -+ ret = rtw_cfg80211_set_beacon_wpsp2pie(net, buf, len); -+ break; -+ case 0x2: //PROBE_RESP -+ ret = rtw_cfg80211_set_probe_resp_wpsp2pie(net, buf, len); -+ break; -+ case 0x4: //ASSOC_RESP -+ ret = rtw_cfg80211_set_assoc_resp_wpsp2pie(net, buf, len); -+ break; -+ } -+ } -+ } -+ -+ return ret; -+ -+} -+ -+static struct cfg80211_ops rtw_cfg80211_ops = { -+ .change_virtual_intf = cfg80211_rtw_change_iface, -+ .add_key = cfg80211_rtw_add_key, -+ .get_key = cfg80211_rtw_get_key, -+ .del_key = cfg80211_rtw_del_key, -+ .set_default_key = cfg80211_rtw_set_default_key, -+ .get_station = cfg80211_rtw_get_station, -+ .scan = cfg80211_rtw_scan, -+ .set_wiphy_params = cfg80211_rtw_set_wiphy_params, -+ .connect = cfg80211_rtw_connect, -+ .disconnect = cfg80211_rtw_disconnect, -+ .join_ibss = cfg80211_rtw_join_ibss, -+ .leave_ibss = cfg80211_rtw_leave_ibss, -+ .set_tx_power = cfg80211_rtw_set_txpower, -+ .get_tx_power = cfg80211_rtw_get_txpower, -+ .set_power_mgmt = cfg80211_rtw_set_power_mgmt, -+ .set_pmksa = cfg80211_rtw_set_pmksa, -+ .del_pmksa = cfg80211_rtw_del_pmksa, -+ .flush_pmksa = cfg80211_rtw_flush_pmksa, -+ -+#ifdef CONFIG_AP_MODE -+ .add_virtual_intf = cfg80211_rtw_add_virtual_intf, -+ .del_virtual_intf = cfg80211_rtw_del_virtual_intf, -+ -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) && !defined(COMPAT_KERNEL_RELEASE) -+ .add_beacon = cfg80211_rtw_add_beacon, -+ .set_beacon = cfg80211_rtw_set_beacon, -+ .del_beacon = cfg80211_rtw_del_beacon, -+ #else -+ .start_ap = cfg80211_rtw_start_ap, -+ .change_beacon = cfg80211_rtw_change_beacon, -+ .stop_ap = cfg80211_rtw_stop_ap, -+ #endif -+ -+ .add_station = cfg80211_rtw_add_station, -+ .del_station = cfg80211_rtw_del_station, -+ .change_station = cfg80211_rtw_change_station, -+ .dump_station = cfg80211_rtw_dump_station, -+ .change_bss = cfg80211_rtw_change_bss, -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) -+ .set_channel = cfg80211_rtw_set_channel, -+ #endif -+ //.auth = cfg80211_rtw_auth, -+ //.assoc = cfg80211_rtw_assoc, -+#endif //CONFIG_AP_MODE -+ -+#ifdef CONFIG_P2P -+ .remain_on_channel = cfg80211_rtw_remain_on_channel, -+ .cancel_remain_on_channel = cfg80211_rtw_cancel_remain_on_channel, -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+ .mgmt_tx = cfg80211_rtw_mgmt_tx, -+ .mgmt_frame_register = cfg80211_rtw_mgmt_frame_register, -+#elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,34) && LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,35)) -+ .action = cfg80211_rtw_mgmt_tx, -+#endif -+}; -+ -+static void rtw_cfg80211_init_ht_capab(struct ieee80211_sta_ht_cap *ht_cap, enum ieee80211_band band, u8 rf_type) -+{ -+ -+#define MAX_BIT_RATE_40MHZ_MCS15 300 /* Mbps */ -+#define MAX_BIT_RATE_40MHZ_MCS7 150 /* Mbps */ -+ -+ ht_cap->ht_supported = true; -+ -+ ht_cap->cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 | -+ IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_SGI_20 | -+ IEEE80211_HT_CAP_DSSSCCK40 | IEEE80211_HT_CAP_MAX_AMSDU; -+ -+ /* -+ *Maximum length of AMPDU that the STA can receive. -+ *Length = 2 ^ (13 + max_ampdu_length_exp) - 1 (octets) -+ */ -+ ht_cap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K; -+ -+ /*Minimum MPDU start spacing , */ -+ ht_cap->ampdu_density = IEEE80211_HT_MPDU_DENSITY_16; -+ -+ ht_cap->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED; -+ -+ /* -+ *hw->wiphy->bands[IEEE80211_BAND_2GHZ] -+ *base on ant_num -+ *rx_mask: RX mask -+ *if rx_ant =1 rx_mask[0]=0xff;==>MCS0-MCS7 -+ *if rx_ant =2 rx_mask[1]=0xff;==>MCS8-MCS15 -+ *if rx_ant >=3 rx_mask[2]=0xff; -+ *if BW_40 rx_mask[4]=0x01; -+ *highest supported RX rate -+ */ -+ if(rf_type == RF_1T1R) -+ { -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ ht_cap->mcs.rx_mask[1] = 0x00; -+ ht_cap->mcs.rx_mask[4] = 0x01; -+ -+ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS7; -+ } -+ else if((rf_type == RF_1T2R) || (rf_type==RF_2T2R)) -+ { -+ ht_cap->mcs.rx_mask[0] = 0xFF; -+ ht_cap->mcs.rx_mask[1] = 0xFF; -+ ht_cap->mcs.rx_mask[4] = 0x01; -+ -+ ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS15; -+ } -+ else -+ { -+ DBG_8192C("%s, error rf_type=%d\n", __func__, rf_type); -+ } -+ -+} -+ -+void rtw_cfg80211_init_wiphy(_adapter *padapter) -+{ -+ u8 rf_type; -+ struct ieee80211_supported_band *bands; -+ struct wireless_dev *pwdev = padapter->rtw_wdev; -+ struct wiphy *wiphy = pwdev->wiphy; -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ DBG_8192C("%s:rf_type=%d\n", __func__, rf_type); -+ -+ /* if (padapter->registrypriv.wireless_mode & WIRELESS_11G) */ -+ { -+ bands = wiphy->bands[IEEE80211_BAND_2GHZ]; -+ if(bands) -+ rtw_cfg80211_init_ht_capab(&bands->ht_cap, IEEE80211_BAND_2GHZ, rf_type); -+ } -+ -+ /* if (padapter->registrypriv.wireless_mode & WIRELESS_11A) */ -+ { -+ bands = wiphy->bands[IEEE80211_BAND_5GHZ]; -+ if(bands) -+ rtw_cfg80211_init_ht_capab(&bands->ht_cap, IEEE80211_BAND_5GHZ, rf_type); -+ } -+} -+ -+/* -+struct ieee80211_iface_limit rtw_limits[] = { -+ { .max = 1, .types = BIT(NL80211_IFTYPE_STATION) -+ | BIT(NL80211_IFTYPE_ADHOC) -+#ifdef CONFIG_AP_MODE -+ | BIT(NL80211_IFTYPE_AP) -+#endif -+#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE)) -+ | BIT(NL80211_IFTYPE_P2P_CLIENT) -+ | BIT(NL80211_IFTYPE_P2P_GO) -+#endif -+ }, -+ {.max = 1, .types = BIT(NL80211_IFTYPE_MONITOR)}, -+}; -+ -+struct ieee80211_iface_combination rtw_combinations = { -+ .limits = rtw_limits, -+ .n_limits = ARRAY_SIZE(rtw_limits), -+ .max_interfaces = 2, -+ .num_different_channels = 1, -+}; -+*/ -+ -+static void rtw_cfg80211_preinit_wiphy(_adapter *padapter, struct wiphy *wiphy) -+{ -+ -+ wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; -+ -+ wiphy->max_scan_ssids = RTW_SSID_SCAN_AMOUNT; -+ wiphy->max_scan_ie_len = RTW_SCAN_IE_LEN_MAX; -+ wiphy->max_num_pmkids = RTW_MAX_NUM_PMKIDS; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38)) || defined(COMPAT_KERNEL_RELEASE) -+ wiphy->max_remain_on_channel_duration = RTW_MAX_REMAIN_ON_CHANNEL_DURATION; -+#endif -+ -+ wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) -+ | BIT(NL80211_IFTYPE_ADHOC) -+#ifdef CONFIG_AP_MODE -+ | BIT(NL80211_IFTYPE_AP) -+ | BIT(NL80211_IFTYPE_MONITOR) -+#endif -+#if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE)) -+ | BIT(NL80211_IFTYPE_P2P_CLIENT) -+ | BIT(NL80211_IFTYPE_P2P_GO) -+#endif -+ ; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) -+#ifdef CONFIG_AP_MODE -+ wiphy->mgmt_stypes = rtw_cfg80211_default_mgmt_stypes; -+#endif //CONFIG_AP_MODE -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,0,0)) -+ wiphy->software_iftypes |= BIT(NL80211_IFTYPE_MONITOR); -+#endif -+ -+ /* -+ wiphy->iface_combinations = &rtw_combinations; -+ wiphy->n_iface_combinations = 1; -+ */ -+ -+ wiphy->cipher_suites = rtw_cipher_suites; -+ wiphy->n_cipher_suites = ARRAY_SIZE(rtw_cipher_suites); -+ -+ /* if (padapter->registrypriv.wireless_mode & WIRELESS_11G) */ -+ wiphy->bands[IEEE80211_BAND_2GHZ] = rtw_spt_band_alloc(IEEE80211_BAND_2GHZ); -+ /* if (padapter->registrypriv.wireless_mode & WIRELESS_11A) */ -+ wiphy->bands[IEEE80211_BAND_5GHZ] = rtw_spt_band_alloc(IEEE80211_BAND_5GHZ); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,38) && LINUX_VERSION_CODE < KERNEL_VERSION(3,0,0)) -+ wiphy->flags |= WIPHY_FLAG_SUPPORTS_SEPARATE_DEFAULT_KEYS; -+#endif -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,3,0)) -+ wiphy->flags |= WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL; -+ wiphy->flags |= WIPHY_FLAG_OFFCHAN_TX | WIPHY_FLAG_HAVE_AP_SME; -+#endif -+ -+ if(padapter->registrypriv.power_mgnt != PS_MODE_ACTIVE) -+ wiphy->flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT; -+ else -+ wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT; -+} -+ -+int rtw_wdev_alloc(_adapter *padapter, struct device *dev) -+{ -+ int ret = 0; -+ struct wiphy *wiphy; -+ struct wireless_dev *wdev; -+ struct rtw_wdev_priv *pwdev_priv; -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ DBG_8192C("%s(padapter=%p)\n", __func__, padapter); -+ -+ /* wiphy */ -+ wiphy = wiphy_new(&rtw_cfg80211_ops, sizeof(struct rtw_wdev_priv)); -+ if (!wiphy) { -+ DBG_8192C("Couldn't allocate wiphy device\n"); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ set_wiphy_dev(wiphy, dev); -+ rtw_cfg80211_preinit_wiphy(padapter, wiphy); -+ -+ ret = wiphy_register(wiphy); -+ if (ret < 0) { -+ DBG_8192C("Couldn't register wiphy device\n"); -+ goto free_wiphy; -+ } -+ -+ /* wdev */ -+ wdev = (struct wireless_dev *)rtw_zmalloc(sizeof(struct wireless_dev)); -+ if (!wdev) { -+ DBG_8192C("Couldn't allocate wireless device\n"); -+ ret = -ENOMEM; -+ goto unregister_wiphy; -+ } -+ wdev->wiphy = wiphy; -+ wdev->netdev = pnetdev; -+ //wdev->iftype = NL80211_IFTYPE_STATION; -+ wdev->iftype = NL80211_IFTYPE_MONITOR; // for rtw_setopmode_cmd() in cfg80211_rtw_change_iface() -+ padapter->rtw_wdev = wdev; -+ pnetdev->ieee80211_ptr = wdev; -+ -+ //init pwdev_priv -+ pwdev_priv = wdev_to_priv(wdev); -+ pwdev_priv->rtw_wdev = wdev; -+ pwdev_priv->pmon_ndev = NULL; -+ pwdev_priv->ifname_mon[0] = '\0'; -+ pwdev_priv->padapter = padapter; -+ pwdev_priv->scan_request = NULL; -+ _rtw_spinlock_init(&pwdev_priv->scan_req_lock); -+ -+ pwdev_priv->p2p_enabled = false; -+ pwdev_priv->provdisc_req_issued = false; -+ rtw_wdev_invit_info_init(&pwdev_priv->invit_info); -+ -+ pwdev_priv->bandroid_scan = false; -+ -+ if(padapter->registrypriv.power_mgnt != PS_MODE_ACTIVE) -+ pwdev_priv->power_mgmt = true; -+ else -+ pwdev_priv->power_mgmt = false; -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); -+ ATOMIC_SET(&pwdev_priv->ro_ch_to, 1); -+#endif -+ -+ return ret; -+ -+ rtw_mfree((u8*)wdev, sizeof(struct wireless_dev)); -+unregister_wiphy: -+ wiphy_unregister(wiphy); -+ free_wiphy: -+ wiphy_free(wiphy); -+exit: -+ return ret; -+ -+} -+ -+void rtw_wdev_free(struct wireless_dev *wdev) -+{ -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ DBG_8192C("%s(wdev=%p)\n", __func__, wdev); -+ -+ if (!wdev) -+ return; -+ -+ pwdev_priv = wdev_to_priv(wdev); -+ -+ rtw_spt_band_free(wdev->wiphy->bands[IEEE80211_BAND_2GHZ]); -+ rtw_spt_band_free(wdev->wiphy->bands[IEEE80211_BAND_5GHZ]); -+ -+ wiphy_free(wdev->wiphy); -+ -+ rtw_mfree((u8*)wdev, sizeof(struct wireless_dev)); -+} -+ -+void rtw_wdev_unregister(struct wireless_dev *wdev) -+{ -+ struct rtw_wdev_priv *pwdev_priv; -+ -+ DBG_8192C("%s(wdev=%p)\n", __func__, wdev); -+ -+ if (!wdev) -+ return; -+ -+ pwdev_priv = wdev_to_priv(wdev); -+ -+ rtw_cfg80211_indicate_scan_done(pwdev_priv, true); -+ -+ if (pwdev_priv->pmon_ndev) { -+ DBG_8192C("%s, unregister monitor interface\n", __func__); -+ unregister_netdev(pwdev_priv->pmon_ndev); -+ } -+ -+ wiphy_unregister(wdev->wiphy); -+} -+ -+#endif //CONFIG_IOCTL_CFG80211 -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/ioctl_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/ioctl_linux.c ---- linux-4.14.17/3rdparty/rtl8812au/os_dep/ioctl_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/ioctl_linux.c 2018-02-06 17:42:30.724967372 +0200 -@@ -0,0 +1,12843 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _IOCTL_LINUX_C_ -+ -+#include -+ -+//#ifdef CONFIG_MP_INCLUDED -+#include -+#include "../hal/odm_precomp.h" -+//#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,27)) -+#define iwe_stream_add_event(a, b, c, d, e) iwe_stream_add_event(b, c, d, e) -+#define iwe_stream_add_point(a, b, c, d, e) iwe_stream_add_point(b, c, d, e) -+#endif -+ -+ -+#define RTL_IOCTL_WPA_SUPPLICANT SIOCIWFIRSTPRIV+30 -+ -+#define SCAN_ITEM_SIZE 768 -+#define MAX_CUSTOM_LEN 64 -+#define RATE_COUNT 4 -+ -+#ifdef CONFIG_GLOBAL_UI_PID -+extern int ui_pid[3]; -+#endif -+ -+// combo scan -+#define WEXT_CSCAN_AMOUNT 9 -+#define WEXT_CSCAN_BUF_LEN 360 -+#define WEXT_CSCAN_HEADER "CSCAN S\x01\x00\x00S\x00" -+#define WEXT_CSCAN_HEADER_SIZE 12 -+#define WEXT_CSCAN_SSID_SECTION 'S' -+#define WEXT_CSCAN_CHANNEL_SECTION 'C' -+#define WEXT_CSCAN_NPROBE_SECTION 'N' -+#define WEXT_CSCAN_ACTV_DWELL_SECTION 'A' -+#define WEXT_CSCAN_PASV_DWELL_SECTION 'P' -+#define WEXT_CSCAN_HOME_DWELL_SECTION 'H' -+#define WEXT_CSCAN_TYPE_SECTION 'T' -+ -+ -+extern u8 key_2char2num(u8 hch, u8 lch); -+extern u8 str_2char2num(u8 hch, u8 lch); -+extern u8 convert_ip_addr(u8 hch, u8 mch, u8 lch); -+ -+static u32 rtw_rates[] = {1000000,2000000,5500000,11000000, -+ 6000000,9000000,12000000,18000000,24000000,36000000,48000000,54000000}; -+ -+static const char * const iw_operation_mode[] = -+{ -+ "Auto", "Ad-Hoc", "Managed", "Master", "Repeater", "Secondary", "Monitor" -+}; -+ -+static int hex2num_i(char c) -+{ -+ if (c >= '0' && c <= '9') -+ return c - '0'; -+ if (c >= 'a' && c <= 'f') -+ return c - 'a' + 10; -+ if (c >= 'A' && c <= 'F') -+ return c - 'A' + 10; -+ return -1; -+} -+ -+static int hex2byte_i(const char *hex) -+{ -+ int a, b; -+ a = hex2num_i(*hex++); -+ if (a < 0) -+ return -1; -+ b = hex2num_i(*hex++); -+ if (b < 0) -+ return -1; -+ return (a << 4) | b; -+} -+ -+/** -+ * hwaddr_aton - Convert ASCII string to MAC address -+ * @txt: MAC address as a string (e.g., "00:11:22:33:44:55") -+ * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes) -+ * Returns: 0 on success, -1 on failure (e.g., string not a MAC address) -+ */ -+static int hwaddr_aton_i(const char *txt, u8 *addr) -+{ -+ int i; -+ -+ for (i = 0; i < 6; i++) { -+ int a, b; -+ -+ a = hex2num_i(*txt++); -+ if (a < 0) -+ return -1; -+ b = hex2num_i(*txt++); -+ if (b < 0) -+ return -1; -+ *addr++ = (a << 4) | b; -+ if (i < 5 && *txt++ != ':') -+ return -1; -+ } -+ -+ return 0; -+} -+ -+static void indicate_wx_custom_event(_adapter *padapter, char *msg) -+{ -+ u8 *buff, *p; -+ union iwreq_data wrqu; -+ -+ if (strlen(msg) > IW_CUSTOM_MAX) { -+ DBG_871X("%s strlen(msg):%zu > IW_CUSTOM_MAX:%u\n", __FUNCTION__ , strlen(msg), IW_CUSTOM_MAX); -+ return; -+ } -+ -+ buff = rtw_zmalloc(IW_CUSTOM_MAX+1); -+ if(!buff) -+ return; -+ -+ _rtw_memcpy(buff, msg, strlen(msg)); -+ -+ _rtw_memset(&wrqu,0,sizeof(wrqu)); -+ wrqu.data.length = strlen(msg); -+ -+ DBG_871X("%s %s\n", __FUNCTION__, buff); -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(padapter->pnetdev, IWEVCUSTOM, &wrqu, buff); -+#endif -+ -+ rtw_mfree(buff, IW_CUSTOM_MAX+1); -+ -+} -+ -+ -+static void request_wps_pbc_event(_adapter *padapter) -+{ -+ u8 *buff, *p; -+ union iwreq_data wrqu; -+ -+ -+ buff = rtw_malloc(IW_CUSTOM_MAX); -+ if(!buff) -+ return; -+ -+ _rtw_memset(buff, 0, IW_CUSTOM_MAX); -+ -+ p=buff; -+ -+ p+=sprintf(p, "WPS_PBC_START.request=TRUE"); -+ -+ _rtw_memset(&wrqu,0,sizeof(wrqu)); -+ -+ wrqu.data.length = p-buff; -+ -+ wrqu.data.length = (wrqu.data.lengthpnetdev, IWEVCUSTOM, &wrqu, buff); -+#endif -+ -+ if(buff) -+ { -+ rtw_mfree(buff, IW_CUSTOM_MAX); -+ } -+ -+} -+ -+void rtw_request_wps_pbc_event(_adapter *padapter) -+{ -+ if ( padapter->pid[0] == 0 ) -+ { // 0 is the default value and it means the application monitors the HW PBC doesn't privde its pid to driver. -+ return; -+ } -+ -+ rtw_signal_process(padapter->pid[0], SIGUSR1); -+ -+ rtw_led_control(padapter, LED_CTL_START_WPS_BOTTON); -+} -+ -+void indicate_wx_scan_complete_event(_adapter *padapter) -+{ -+ union iwreq_data wrqu; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); -+ -+ //DBG_871X("+rtw_indicate_wx_scan_complete_event\n"); -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(padapter->pnetdev, SIOCGIWSCAN, &wrqu, NULL); -+#endif -+} -+ -+void rtw_indicate_wx_assoc_event(_adapter *padapter) -+{ -+ union iwreq_data wrqu; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); -+ -+ wrqu.ap_addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memcpy(wrqu.ap_addr.sa_data, pmlmepriv->cur_network.network.MacAddress, ETH_ALEN); -+ DBG_871X("BSSID:" MAC_FMT "\n", MAC_ARG(pmlmepriv->cur_network.network.MacAddress)); -+ DBG_871X_LEVEL(_drv_always_, "assoc success\n"); -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(padapter->pnetdev, SIOCGIWAP, &wrqu, NULL); -+#endif -+} -+ -+void rtw_indicate_wx_disassoc_event(_adapter *padapter) -+{ -+ union iwreq_data wrqu; -+ -+ _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); -+ -+ wrqu.ap_addr.sa_family = ARPHRD_ETHER; -+ _rtw_memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN); -+ -+#ifndef CONFIG_IOCTL_CFG80211 -+ DBG_871X_LEVEL(_drv_always_, "indicate disassoc\n"); -+ wireless_send_event(padapter->pnetdev, SIOCGIWAP, &wrqu, NULL); -+#endif -+} -+ -+/* -+uint rtw_is_cckrates_included(u8 *rate) -+{ -+ u32 i = 0; -+ -+ while(rate[i]!=0) -+ { -+ if ( (((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) || -+ (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22) ) -+ return true; -+ i++; -+ } -+ -+ return false; -+} -+ -+uint rtw_is_cckratesonly_included(u8 *rate) -+{ -+ u32 i = 0; -+ -+ while(rate[i]!=0) -+ { -+ if ( (((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) && -+ (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22) ) -+ return false; -+ i++; -+ } -+ -+ return true; -+} -+*/ -+ -+static char *translate_scan(_adapter *padapter, -+ struct iw_request_info* info, struct wlan_network *pnetwork, -+ char *start, char *stop) -+{ -+ struct iw_event iwe; -+ u16 cap; -+ __le16 le_tmp; -+ u32 ht_ielen = 0, vht_ielen = 0; -+ char custom[MAX_CUSTOM_LEN]; -+ char *p; -+ u16 max_rate=0, rate, ht_cap=false, vht_cap = false; -+ u32 i = 0; -+ char *current_val; -+ long rssi; -+ u8 bw_40MHz=0, short_GI=0, bw_160MHz=0, vht_highest_rate = 0; -+ u16 mcs_rate=0, vht_data_rate=0; -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+#endif //CONFIG_P2P -+ -+#ifdef CONFIG_P2P -+#ifdef CONFIG_WFD -+ if ( SCAN_RESULT_ALL == pwdinfo->wfd_info->scan_result_type ) -+ { -+ -+ } -+ else if ( ( SCAN_RESULT_P2P_ONLY == pwdinfo->wfd_info->scan_result_type ) || -+ ( SCAN_RESULT_WFD_TYPE == pwdinfo->wfd_info->scan_result_type ) ) -+#endif // CONFIG_WFD -+ { -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ u32 blnGotP2PIE = false; -+ -+ // User is doing the P2P device discovery -+ // The prefix of SSID should be "DIRECT-" and the IE should contains the P2P IE. -+ // If not, the driver should ignore this AP and go to the next AP. -+ -+ // Verifying the SSID -+ if ( _rtw_memcmp( pnetwork->network.Ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN ) ) -+ { -+ u32 p2pielen = 0; -+ -+ // Verifying the P2P IE -+ if ( rtw_get_p2p_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen) ) -+ { -+ blnGotP2PIE = true; -+ } -+ } -+ -+ if ( blnGotP2PIE == false ) -+ { -+ return start; -+ } -+ -+ } -+ } -+ -+#ifdef CONFIG_WFD -+ if ( SCAN_RESULT_WFD_TYPE == pwdinfo->wfd_info->scan_result_type ) -+ { -+ u32 blnGotWFD = false; -+ u8 wfd_ie[ 128 ] = { 0x00 }; -+ uint wfd_ielen = 0; -+ -+ if ( rtw_get_wfd_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, wfd_ie, &wfd_ielen ) ) -+ { -+ u8 wfd_devinfo[ 6 ] = { 0x00 }; -+ uint wfd_devlen = 6; -+ -+ if ( rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, wfd_devinfo, &wfd_devlen) ) -+ { -+ if ( pwdinfo->wfd_info->wfd_device_type == WFD_DEVINFO_PSINK ) -+ { -+ // the first two bits will indicate the WFD device type -+ if ( ( wfd_devinfo[ 1 ] & 0x03 ) == WFD_DEVINFO_SOURCE ) -+ { -+ // If this device is Miracast PSink device, the scan reuslt should just provide the Miracast source. -+ blnGotWFD = true; -+ } -+ } -+ else if ( pwdinfo->wfd_info->wfd_device_type == WFD_DEVINFO_SOURCE ) -+ { -+ // the first two bits will indicate the WFD device type -+ if ( ( wfd_devinfo[ 1 ] & 0x03 ) == WFD_DEVINFO_PSINK ) -+ { -+ // If this device is Miracast source device, the scan reuslt should just provide the Miracast PSink. -+ // Todo: How about the SSink?! -+ blnGotWFD = true; -+ } -+ } -+ } -+ } -+ -+ if ( blnGotWFD == false ) -+ { -+ return start; -+ } -+ } -+#endif // CONFIG_WFD -+ -+#endif //CONFIG_P2P -+ -+ /* AP MAC address */ -+ iwe.cmd = SIOCGIWAP; -+ iwe.u.ap_addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memcpy(iwe.u.ap_addr.sa_data, pnetwork->network.MacAddress, ETH_ALEN); -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_ADDR_LEN); -+ -+ /* Add the ESSID */ -+ iwe.cmd = SIOCGIWESSID; -+ iwe.u.data.flags = 1; -+ iwe.u.data.length = min((u16)pnetwork->network.Ssid.SsidLength, (u16)32); -+ start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid); -+ -+ //parsing HT_CAP_IE -+ p = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength-12); -+ -+ if(p && ht_ielen>0) -+ { -+ struct rtw_ieee80211_ht_cap *pht_capie; -+ ht_cap = true; -+ pht_capie = (struct rtw_ieee80211_ht_cap *)(p+2); -+ _rtw_memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2); -+ bw_40MHz = (le16_to_cpu(pht_capie->cap_info)&IEEE80211_HT_CAP_SUP_WIDTH) ? 1:0; -+ short_GI = (le16_to_cpu(pht_capie->cap_info)&(IEEE80211_HT_CAP_SGI_20|IEEE80211_HT_CAP_SGI_40)) ? 1:0; -+ } -+ -+#ifdef CONFIG_80211AC_VHT -+ //parsing VHT_CAP_IE -+ p = rtw_get_ie(&pnetwork->network.IEs[12], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength-12); -+ if(p && vht_ielen>0) -+ { -+ u8 mcs_map[2]; -+ -+ vht_cap = true; -+ bw_160MHz = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p+2); -+ if(bw_160MHz) -+ short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI160M(p+2); -+ else -+ short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI80M(p+2); -+ -+ _rtw_memcpy(mcs_map, GET_VHT_CAPABILITY_ELE_TX_MCS(p+2), 2); -+ -+ vht_highest_rate = rtw_get_vht_highest_rate(padapter, mcs_map); -+ vht_data_rate = rtw_vht_data_rate(CHANNEL_WIDTH_80, short_GI, vht_highest_rate); -+ } -+#endif -+ -+ /* Add the protocol name */ -+ iwe.cmd = SIOCGIWNAME; -+ if ((rtw_is_cckratesonly_included((u8*)&pnetwork->network.SupportedRates)) == true) -+ { -+ if(ht_cap == true) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bn"); -+ else -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11b"); -+ } -+ else if ((rtw_is_cckrates_included((u8*)&pnetwork->network.SupportedRates)) == true) -+ { -+ if(ht_cap == true) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bgn"); -+ else -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bg"); -+ } -+ else -+ { -+ if(pnetwork->network.Configuration.DSConfig > 14) -+ { -+ if(vht_cap == true) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11AC"); -+ else if(ht_cap == true) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11an"); -+ else -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11a"); -+ } -+ else -+ { -+ if(ht_cap == true) -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11gn"); -+ else -+ snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11g"); -+ } -+ } -+ -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_CHAR_LEN); -+ -+ /* Add mode */ -+ iwe.cmd = SIOCGIWMODE; -+ _rtw_memcpy(&le_tmp, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); -+ -+ -+ cap = le16_to_cpu(le_tmp); -+ -+ if(cap & (WLAN_CAPABILITY_IBSS |WLAN_CAPABILITY_BSS)){ -+ if (cap & WLAN_CAPABILITY_BSS) -+ iwe.u.mode = IW_MODE_MASTER; -+ else -+ iwe.u.mode = IW_MODE_ADHOC; -+ -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_UINT_LEN); -+ } -+ -+ if(pnetwork->network.Configuration.DSConfig<1 /*|| pnetwork->network.Configuration.DSConfig>14*/) -+ pnetwork->network.Configuration.DSConfig = 1; -+ -+ /* Add frequency/channel */ -+ iwe.cmd = SIOCGIWFREQ; -+ iwe.u.freq.m = rtw_ch2freq(pnetwork->network.Configuration.DSConfig) * 100000; -+ iwe.u.freq.e = 1; -+ iwe.u.freq.i = pnetwork->network.Configuration.DSConfig; -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_FREQ_LEN); -+ -+ /* Add encryption capability */ -+ iwe.cmd = SIOCGIWENCODE; -+ if (cap & WLAN_CAPABILITY_PRIVACY) -+ iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; -+ else -+ iwe.u.data.flags = IW_ENCODE_DISABLED; -+ iwe.u.data.length = 0; -+ start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid); -+ -+ /*Add basic and extended rates */ -+ max_rate = 0; -+ p = custom; -+ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): "); -+ while(pnetwork->network.SupportedRates[i]!=0) -+ { -+ rate = pnetwork->network.SupportedRates[i]&0x7F; -+ if (rate > max_rate) -+ max_rate = rate; -+ p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), -+ "%d%s ", rate >> 1, (rate & 1) ? ".5" : ""); -+ i++; -+ } -+ -+ if(vht_cap == true) { -+ max_rate = vht_data_rate; -+ } -+ else if(ht_cap == true) -+ { -+ if(mcs_rate&0x8000)//MCS15 -+ { -+ max_rate = (bw_40MHz) ? ((short_GI)?300:270):((short_GI)?144:130); -+ -+ } -+ else if(mcs_rate&0x0080)//MCS7 -+ { -+ max_rate = (bw_40MHz) ? ((short_GI)?150:135):((short_GI)?72:65); -+ } -+ else//default MCS7 -+ { -+ //DBG_871X("wx_get_scan, mcs_rate_bitmap=0x%x\n", mcs_rate); -+ max_rate = (bw_40MHz) ? ((short_GI)?150:135):((short_GI)?72:65); -+ } -+ -+ max_rate = max_rate*2;//Mbps/2; -+ } -+ -+ iwe.cmd = SIOCGIWRATE; -+ iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0; -+ iwe.u.bitrate.value = max_rate * 500000; -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_PARAM_LEN); -+ -+ //parsing WPA/WPA2 IE -+ { -+ u8 buf[MAX_WPA_IE_LEN]; -+ u8 wpa_ie[255],rsn_ie[255]; -+ u16 wpa_len=0,rsn_len=0; -+ u8 *p; -+ sint out_len=0; -+ out_len=rtw_get_sec_ie(pnetwork->network.IEs ,pnetwork->network.IELength,rsn_ie,&rsn_len,wpa_ie,&wpa_len); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan: ssid=%s\n",pnetwork->network.Ssid.Ssid)); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan: wpa_len=%d rsn_len=%d\n",wpa_len,rsn_len)); -+ -+ if (wpa_len > 0) -+ { -+ p=buf; -+ _rtw_memset(buf, 0, MAX_WPA_IE_LEN); -+ p += sprintf(p, "wpa_ie="); -+ for (i = 0; i < wpa_len; i++) { -+ p += sprintf(p, "%02x", wpa_ie[i]); -+ } -+ -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ iwe.u.data.length = strlen(buf); -+ start = iwe_stream_add_point(info, start, stop, &iwe,buf); -+ -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd =IWEVGENIE; -+ iwe.u.data.length = wpa_len; -+ start = iwe_stream_add_point(info, start, stop, &iwe, wpa_ie); -+ } -+ if (rsn_len > 0) -+ { -+ p = buf; -+ _rtw_memset(buf, 0, MAX_WPA_IE_LEN); -+ p += sprintf(p, "rsn_ie="); -+ for (i = 0; i < rsn_len; i++) { -+ p += sprintf(p, "%02x", rsn_ie[i]); -+ } -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ iwe.u.data.length = strlen(buf); -+ start = iwe_stream_add_point(info, start, stop, &iwe,buf); -+ -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd =IWEVGENIE; -+ iwe.u.data.length = rsn_len; -+ start = iwe_stream_add_point(info, start, stop, &iwe, rsn_ie); -+ } -+ } -+ -+ { //parsing WPS IE -+ uint cnt = 0,total_ielen; -+ u8 *wpsie_ptr=NULL; -+ uint wps_ielen = 0; -+ -+ u8 *ie_ptr = pnetwork->network.IEs +_FIXED_IE_LENGTH_; -+ total_ielen= pnetwork->network.IELength - _FIXED_IE_LENGTH_; -+ -+ while(cnt < total_ielen) -+ { -+ if(rtw_is_wps_ie(&ie_ptr[cnt], &wps_ielen) && (wps_ielen>2)) -+ { -+ wpsie_ptr = &ie_ptr[cnt]; -+ iwe.cmd =IWEVGENIE; -+ iwe.u.data.length = (u16)wps_ielen; -+ start = iwe_stream_add_point(info, start, stop, &iwe, wpsie_ptr); -+ } -+ cnt+=ie_ptr[cnt+1]+2; //goto next -+ } -+ } -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ { -+ sint out_len_wapi=0; -+ /* here use static for stack size */ -+ static u8 buf_wapi[MAX_WAPI_IE_LEN]; -+ static u8 wapi_ie[MAX_WAPI_IE_LEN]; -+ u16 wapi_len=0; -+ u16 i; -+ -+ _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN); -+ _rtw_memset(wapi_ie, 0, MAX_WAPI_IE_LEN); -+ -+ out_len_wapi=rtw_get_wapi_ie(pnetwork->network.IEs ,pnetwork->network.IELength,wapi_ie,&wapi_len); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan: ssid=%s\n",pnetwork->network.Ssid.Ssid)); -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan: wapi_len=%d \n",wapi_len)); -+ -+ DBG_871X("rtw_wx_get_scan: %s ",pnetwork->network.Ssid.Ssid); -+ DBG_871X("rtw_wx_get_scan: ssid = %d ",wapi_len); -+ -+ -+ if (wapi_len > 0) -+ { -+ p=buf_wapi; -+ _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN); -+ p += sprintf(p, "wapi_ie="); -+ for (i = 0; i < wapi_len; i++) { -+ p += sprintf(p, "%02x", wapi_ie[i]); -+ } -+ -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd = IWEVCUSTOM; -+ iwe.u.data.length = strlen(buf_wapi); -+ start = iwe_stream_add_point(info, start, stop, &iwe,buf_wapi); -+ -+ _rtw_memset(&iwe, 0, sizeof(iwe)); -+ iwe.cmd =IWEVGENIE; -+ iwe.u.data.length = wapi_len; -+ start = iwe_stream_add_point(info, start, stop, &iwe, wapi_ie); -+ } -+ } -+#endif -+ -+{ -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 ss, sq; -+ -+ /* Add quality statistics */ -+ iwe.cmd = IWEVQUAL; -+ iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED | IW_QUAL_NOISE_INVALID -+ #ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ | IW_QUAL_DBM -+ #endif -+ ; -+ -+ if ( check_fwstate(pmlmepriv, _FW_LINKED)== true && -+ is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network)) { -+ ss = padapter->recvpriv.signal_strength; -+ sq = padapter->recvpriv.signal_qual; -+ } else { -+ ss = pnetwork->network.PhyInfo.SignalStrength; -+ sq = pnetwork->network.PhyInfo.SignalQuality; -+ } -+ -+ -+ #ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ iwe.u.qual.level = (u8) translate_percentage_to_dbm(ss);//dbm -+ #else -+ iwe.u.qual.level = (u8)ss;//% -+ #ifdef CONFIG_BT_COEXIST -+ BT_SignalCompensation(padapter, &iwe.u.qual.level, NULL); -+ #endif // CONFIG_BT_COEXIST -+ #endif -+ -+ iwe.u.qual.qual = (u8)sq; // signal quality -+ -+ iwe.u.qual.noise = 0; // noise level -+ -+ //DBG_871X("iqual=%d, ilevel=%d, inoise=%d, iupdated=%d\n", iwe.u.qual.qual, iwe.u.qual.level , iwe.u.qual.noise, iwe.u.qual.updated); -+ -+ start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_QUAL_LEN); -+} -+ -+ return start; -+} -+ -+static int wpa_set_auth_algs(struct net_device *dev, u32 value) -+{ -+ _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); -+ int ret = 0; -+ -+ if ((value & AUTH_ALG_SHARED_KEY)&&(value & AUTH_ALG_OPEN_SYSTEM)) -+ { -+ DBG_871X("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY and AUTH_ALG_OPEN_SYSTEM [value:0x%x]\n",value); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ } -+ else if (value & AUTH_ALG_SHARED_KEY) -+ { -+ DBG_871X("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY [value:0x%x]\n",value); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeShared; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Shared; -+ } -+ else if(value & AUTH_ALG_OPEN_SYSTEM) -+ { -+ DBG_871X("wpa_set_auth_algs, AUTH_ALG_OPEN_SYSTEM\n"); -+ //padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ if(padapter->securitypriv.ndisauthtype < Ndis802_11AuthModeWPAPSK) -+ { -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ } -+ -+ } -+ else if(value & AUTH_ALG_LEAP) -+ { -+ DBG_871X("wpa_set_auth_algs, AUTH_ALG_LEAP\n"); -+ } -+ else -+ { -+ DBG_871X("wpa_set_auth_algs, error!\n"); -+ ret = -EINVAL; -+ } -+ -+ return ret; -+ -+} -+ -+static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len,wep_total_len; -+ NDIS_802_11_WEP *pwep = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+#ifdef CONFIG_P2P -+ struct wifidirect_info* pwdinfo = &padapter->wdinfo; -+#endif //CONFIG_P2P -+ -+ -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ if (param_len < (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ if (param->u.crypt.idx >= WEP_KEYS) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } else { -+#ifdef CONFIG_WAPI_SUPPORT -+ if (strcmp(param->u.crypt.alg, "SMS4")) -+#endif -+ { -+ -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("wpa_set_encryption, crypt.alg = WEP\n")); -+ DBG_871X("wpa_set_encryption, crypt.alg = WEP\n"); -+ -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_; -+ padapter->securitypriv.dot118021XGrpPrivacy=_WEP40_; -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("(1)wep_key_idx=%d\n", wep_key_idx)); -+ DBG_871X("(1)wep_key_idx=%d\n", wep_key_idx); -+ -+ if (wep_key_idx > WEP_KEYS) -+ return -EINVAL; -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("(2)wep_key_idx=%d\n", wep_key_idx)); -+ -+ if (wep_key_len > 0) -+ { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); -+ pwep =(NDIS_802_11_WEP *) rtw_malloc(wep_total_len); -+ if(pwep == NULL){ -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,(" wpa_set_encryption: pwep allocate fail !!!\n")); -+ goto exit; -+ } -+ -+ _rtw_memset(pwep, 0, wep_total_len); -+ -+ pwep->KeyLength = wep_key_len; -+ pwep->Length = wep_total_len; -+ -+ if(wep_key_len==13) -+ { -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; -+ padapter->securitypriv.dot118021XGrpPrivacy=_WEP104_; -+ } -+ } -+ else { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ pwep->KeyIndex = wep_key_idx; -+ pwep->KeyIndex |= 0x80000000; -+ -+ _rtw_memcpy(pwep->KeyMaterial, param->u.crypt.key, pwep->KeyLength); -+ -+ if(param->u.crypt.set_tx) -+ { -+ DBG_871X("wep, set_tx=1\n"); -+ -+ if(rtw_set_802_11_add_wep(padapter, pwep) == (u8)_FAIL) -+ { -+ ret = -EOPNOTSUPP ; -+ } -+ } -+ else -+ { -+ DBG_871X("wep, set_tx=0\n"); -+ -+ //don't update "psecuritypriv->dot11PrivacyAlgrthm" and -+ //"psecuritypriv->dot11PrivacyKeyIndex=keyid", but can rtw_set_key to fw/cam -+ -+ if (wep_key_idx >= WEP_KEYS) { -+ ret = -EOPNOTSUPP ; -+ goto exit; -+ } -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); -+ psecuritypriv->dot11DefKeylen[wep_key_idx]=pwep->KeyLength; -+ rtw_set_key(padapter, psecuritypriv, wep_key_idx, 0); -+ } -+ -+ goto exit; -+ } -+ -+ if(padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) // 802_1x -+ { -+ struct sta_info * psta,*pbcmc_sta; -+ struct sta_priv * pstapriv = &padapter->stapriv; -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == true) //sta mode -+ { -+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); -+ if (psta == NULL) { -+ //DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail \n")); -+ } -+ else -+ { -+ //Jeff: don't disable ieee8021x_blocked while clearing key -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ psta->ieee8021x_blocked = false; -+ -+ if((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ { -+ psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ -+ if(param->u.crypt.set_tx ==1)//pairwise key -+ { -+ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ if(strcmp(param->u.crypt.alg, "TKIP") == 0)//set mic key -+ { -+ //DEBUG_ERR(("\nset key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); -+ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ padapter->securitypriv.busetkipkey=false; -+ //_set_timer(&padapter->securitypriv.tkip_timer, 50); -+ } -+ -+ //DEBUG_ERR((" param->u.crypt.key_len=%d\n",param->u.crypt.key_len)); -+ DBG_871X(" ~~~~set sta key:unicastkey\n"); -+ -+ rtw_setstakey_cmd(padapter, (unsigned char *)psta, true); -+ } -+ else//group key -+ { -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key,(param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[16]),8); -+ _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey,&(param->u.crypt.key[24]),8); -+ padapter->securitypriv.binstallGrpkey = true; -+ //DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); -+ DBG_871X(" ~~~~set sta key:groupkey\n"); -+ -+ padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ rtw_set_key(padapter,&padapter->securitypriv,param->u.crypt.idx, 1); -+#ifdef CONFIG_P2P -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_DONE); -+ } -+#endif //CONFIG_P2P -+ -+ } -+ } -+ -+ pbcmc_sta=rtw_get_bcmc_stainfo(padapter); -+ if(pbcmc_sta==NULL) -+ { -+ //DEBUG_ERR( ("Set OID_802_11_ADD_KEY: bcmc stainfo is null \n")); -+ } -+ else -+ { -+ //Jeff: don't disable ieee8021x_blocked while clearing key -+ if (strcmp(param->u.crypt.alg, "none") != 0) -+ pbcmc_sta->ieee8021x_blocked = false; -+ -+ if((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled)|| -+ (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) -+ { -+ pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; -+ } -+ } -+ } -+ else if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) //adhoc mode -+ { -+ } -+ } -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (strcmp(param->u.crypt.alg, "SMS4") == 0) -+ { -+ PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; -+ PRT_WAPI_STA_INFO pWapiSta; -+ u8 WapiASUEPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEPNInitialValueSrc[16] = {0x37,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C,0x36,0x5C} ; -+ -+ if(param->u.crypt.set_tx == 1) -+ { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if(_rtw_memcmp(pWapiSta->PeerMacAddr,param->sta_addr,6)) -+ { -+ _rtw_memcpy(pWapiSta->lastTxUnicastPN,WapiASUEPNInitialValueSrc,16); -+ -+ pWapiSta->wapiUsk.bSet = true; -+ _rtw_memcpy(pWapiSta->wapiUsk.dataKey,param->u.crypt.key,16); -+ _rtw_memcpy(pWapiSta->wapiUsk.micKey,param->u.crypt.key+16,16); -+ pWapiSta->wapiUsk.keyId = param->u.crypt.idx ; -+ pWapiSta->wapiUsk.bTxEnable = true; -+ -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue,WapiAEPNInitialValueSrc,16); -+ _rtw_memcpy(pWapiSta->lastRxUnicastPN,WapiAEPNInitialValueSrc,16); -+ pWapiSta->wapiUskUpdate.bTxEnable = false; -+ pWapiSta->wapiUskUpdate.bSet = false; -+ -+ if (psecuritypriv->sw_encrypt== false || psecuritypriv->sw_decrypt == false) -+ { -+ //set unicast key for ASUE -+ rtw_wapi_set_key(padapter, &pWapiSta->wapiUsk, pWapiSta, false, false); -+ } -+ } -+ } -+ } -+ else -+ { -+ list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { -+ if(_rtw_memcmp(pWapiSta->PeerMacAddr,get_bssid(pmlmepriv),6)) -+ { -+ pWapiSta->wapiMsk.bSet = true; -+ _rtw_memcpy(pWapiSta->wapiMsk.dataKey,param->u.crypt.key,16); -+ _rtw_memcpy(pWapiSta->wapiMsk.micKey,param->u.crypt.key+16,16); -+ pWapiSta->wapiMsk.keyId = param->u.crypt.idx ; -+ pWapiSta->wapiMsk.bTxEnable = false; -+ if(!pWapiSta->bSetkeyOk) -+ pWapiSta->bSetkeyOk = true; -+ pWapiSta->bAuthenticateInProgress = false; -+ -+ _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); -+ -+ if (psecuritypriv->sw_decrypt == false) -+ { -+ //set rx broadcast key for ASUE -+ rtw_wapi_set_key(padapter, &pWapiSta->wapiMsk, pWapiSta, true, false); -+ } -+ } -+ -+ } -+ } -+ } -+#endif -+ -+exit: -+ -+ if (pwep) { -+ rtw_mfree((u8 *)pwep, wep_total_len); -+ } -+ -+ -+ -+ return ret; -+} -+ -+static int rtw_set_wpa_ie(_adapter *padapter, char *pie, unsigned short ielen) -+{ -+ u8 *buf=NULL, *pos=NULL; -+ u32 left; -+ int group_cipher = 0, pairwise_cipher = 0; -+ int ret = 0; -+ u8 null_addr[]= {0,0,0,0,0,0}; -+#ifdef CONFIG_P2P -+ struct wifidirect_info* pwdinfo = &padapter->wdinfo; -+#endif //CONFIG_P2P -+ -+ if((ielen > MAX_WPA_IE_LEN) || (pie == NULL)){ -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ if(pie == NULL) -+ return ret; -+ else -+ return -EINVAL; -+ } -+ -+ if(ielen) -+ { -+ buf = rtw_zmalloc(ielen); -+ if (buf == NULL){ -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ _rtw_memcpy(buf, pie , ielen); -+ -+ //dump -+ { -+ int i; -+ DBG_871X("\n wpa_ie(length:%d):\n", ielen); -+ for(i=0;i= RSN_SELECTOR_LEN){ -+ pos += RSN_SELECTOR_LEN; -+ left -= RSN_SELECTOR_LEN; -+ } -+ else if (left > 0){ -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("Ie length mismatch, %u too much \n", left)); -+ ret =-1; -+ goto exit; -+ } -+#endif -+ -+ if(rtw_parse_wpa_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPAPSK; -+ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); -+ } -+ -+ if(rtw_parse_wpa2_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) -+ { -+ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; -+ padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeWPA2PSK; -+ _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); -+ } -+ -+ if (group_cipher == 0) -+ { -+ group_cipher = WPA_CIPHER_NONE; -+ } -+ if (pairwise_cipher == 0) -+ { -+ pairwise_cipher = WPA_CIPHER_NONE; -+ } -+ -+ switch(group_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus=Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot118021XGrpPrivacy=_WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot118021XGrpPrivacy=_TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot118021XGrpPrivacy=_AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot118021XGrpPrivacy=_WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ switch(pairwise_cipher) -+ { -+ case WPA_CIPHER_NONE: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; -+ padapter->securitypriv.ndisencryptstatus=Ndis802_11EncryptionDisabled; -+ break; -+ case WPA_CIPHER_WEP40: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ case WPA_CIPHER_TKIP: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_TKIP_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case WPA_CIPHER_CCMP: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_AES_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ case WPA_CIPHER_WEP104: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ break; -+ } -+ -+ _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ {//set wps_ie -+ u16 cnt = 0; -+ u8 eid, wps_oui[4]={0x0,0x50,0xf2,0x04}; -+ -+ while( cnt < ielen ) -+ { -+ eid = buf[cnt]; -+ -+ if((eid==_VENDOR_SPECIFIC_IE_)&&(_rtw_memcmp(&buf[cnt+2], wps_oui, 4)==true)) -+ { -+ DBG_871X("SET WPS_IE\n"); -+ -+ padapter->securitypriv.wps_ie_len = ( (buf[cnt+1]+2) < (MAX_WPA_IE_LEN<<2)) ? (buf[cnt+1]+2):(MAX_WPA_IE_LEN<<2); -+ -+ _rtw_memcpy(padapter->securitypriv.wps_ie, &buf[cnt], padapter->securitypriv.wps_ie_len); -+ -+ set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS); -+ -+#ifdef CONFIG_P2P -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_OK)) -+ { -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_ING); -+ } -+#endif //CONFIG_P2P -+ cnt += buf[cnt+1]+2; -+ -+ break; -+ } else { -+ cnt += buf[cnt+1]+2; //goto next -+ } -+ } -+ } -+ } -+ -+ //TKIP and AES disallow multicast packets until installing group key -+ if(padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_ -+ || padapter->securitypriv.dot11PrivacyAlgrthm == _AES_) -+ //WPS open need to enable multicast -+ //|| check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == true) -+ rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr); -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("rtw_set_wpa_ie: pairwise_cipher=0x%08x padapter->securitypriv.ndisencryptstatus=%d padapter->securitypriv.ndisauthtype=%d\n", -+ pairwise_cipher, padapter->securitypriv.ndisencryptstatus, padapter->securitypriv.ndisauthtype)); -+ -+exit: -+ -+ if (buf) rtw_mfree(buf, ielen); -+ -+ return ret; -+} -+ -+static int rtw_wx_get_name(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u16 cap; -+ u32 ht_ielen = 0; -+ char *p; -+ u8 ht_cap=false, vht_cap=false; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ NDIS_802_11_RATES_EX* prates = NULL; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("cmd_code=%x\n", info->cmd)); -+ -+ -+ -+ if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) -+ { -+ //parsing HT_CAP_IE -+ p = rtw_get_ie(&pcur_bss->IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pcur_bss->IELength-12); -+ if(p && ht_ielen>0) -+ { -+ ht_cap = true; -+ } -+ -+#ifdef CONFIG_80211AC_VHT -+ if(pmlmepriv->vhtpriv.vht_option == true) -+ vht_cap = true; -+#endif -+ -+ prates = &pcur_bss->SupportedRates; -+ -+ if (rtw_is_cckratesonly_included((u8*)prates) == true) -+ { -+ if(ht_cap == true) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bn"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11b"); -+ } -+ else if ((rtw_is_cckrates_included((u8*)prates)) == true) -+ { -+ if(ht_cap == true) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bgn"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bg"); -+ } -+ else -+ { -+ if(pcur_bss->Configuration.DSConfig > 14) -+ { -+ if(vht_cap == true) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11AC"); -+ else if(ht_cap == true) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11an"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11a"); -+ } -+ else -+ { -+ if(ht_cap == true) -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11gn"); -+ else -+ snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g"); -+ } -+ } -+ } -+ else -+ { -+ //prates = &padapter->registrypriv.dev_network.SupportedRates; -+ //snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g"); -+ snprintf(wrqu->name, IFNAMSIZ, "unassociated"); -+ } -+ -+ -+ -+ return 0; -+} -+ -+static int rtw_wx_set_freq(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_notice_, ("+rtw_wx_set_freq\n")); -+ -+ -+ -+ return 0; -+} -+ -+static int rtw_wx_get_freq(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == true) -+ { -+ //wrqu->freq.m = ieee80211_wlan_frequencies[pcur_bss->Configuration.DSConfig-1] * 100000; -+ wrqu->freq.m = rtw_ch2freq(pcur_bss->Configuration.DSConfig) * 100000; -+ wrqu->freq.e = 1; -+ wrqu->freq.i = pcur_bss->Configuration.DSConfig; -+ -+ } -+ else{ -+ wrqu->freq.m = rtw_ch2freq(padapter->mlmeextpriv.cur_channel) * 100000; -+ wrqu->freq.e = 1; -+ wrqu->freq.i = padapter->mlmeextpriv.cur_channel; -+ } -+ -+ return 0; -+} -+ -+static int rtw_wx_set_mode(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType ; -+ int ret = 0; -+ -+ -+ -+ if(_FAIL == rtw_pwr_wakeup(padapter)) { -+ ret= -EPERM; -+ goto exit; -+ } -+ -+ if (padapter->hw_init_completed==false){ -+ ret = -EPERM; -+ goto exit; -+ } -+ -+ switch(wrqu->mode) -+ { -+ case IW_MODE_AUTO: -+ networkType = Ndis802_11AutoUnknown; -+ DBG_871X("set_mode = IW_MODE_AUTO\n"); -+ break; -+ case IW_MODE_ADHOC: -+ networkType = Ndis802_11IBSS; -+ DBG_871X("set_mode = IW_MODE_ADHOC\n"); -+ break; -+ case IW_MODE_MASTER: -+ networkType = Ndis802_11APMode; -+ DBG_871X("set_mode = IW_MODE_MASTER\n"); -+ //rtw_setopmode_cmd(padapter, networkType); -+ break; -+ case IW_MODE_INFRA: -+ networkType = Ndis802_11Infrastructure; -+ DBG_871X("set_mode = IW_MODE_INFRA\n"); -+ break; -+ -+ default : -+ ret = -EINVAL;; -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("\n Mode: %s is not supported \n", iw_operation_mode[wrqu->mode])); -+ goto exit; -+ } -+ -+/* -+ if(Ndis802_11APMode == networkType) -+ { -+ rtw_setopmode_cmd(padapter, networkType); -+ } -+ else -+ { -+ rtw_setopmode_cmd(padapter, Ndis802_11AutoUnknown); -+ } -+*/ -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, networkType) ==false){ -+ -+ ret = -EPERM; -+ goto exit; -+ -+ } -+ -+ rtw_setopmode_cmd(padapter, networkType); -+ -+exit: -+ -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_wx_get_mode(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,(" rtw_wx_get_mode \n")); -+ -+ -+ -+ if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) -+ { -+ wrqu->mode = IW_MODE_INFRA; -+ } -+ else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true)) -+ -+ { -+ wrqu->mode = IW_MODE_ADHOC; -+ } -+ else if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ wrqu->mode = IW_MODE_MASTER; -+ } -+ else -+ { -+ wrqu->mode = IW_MODE_AUTO; -+ } -+ -+ -+ -+ return 0; -+ -+} -+ -+ -+static int rtw_wx_set_pmkid(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 j,blInserted = false; -+ int intReturn = false; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct iw_pmksa* pPMK = ( struct iw_pmksa* ) extra; -+ u8 strZeroMacAddress[ ETH_ALEN ] = { 0x00 }; -+ u8 strIssueBssid[ ETH_ALEN ] = { 0x00 }; -+ -+/* -+ struct iw_pmksa -+ { -+ __u32 cmd; -+ struct sockaddr bssid; -+ __u8 pmkid[IW_PMKID_LEN]; //IW_PMKID_LEN=16 -+ } -+ There are the BSSID information in the bssid.sa_data array. -+ If cmd is IW_PMKSA_FLUSH, it means the wpa_suppplicant wants to clear all the PMKID information. -+ If cmd is IW_PMKSA_ADD, it means the wpa_supplicant wants to add a PMKID/BSSID to driver. -+ If cmd is IW_PMKSA_REMOVE, it means the wpa_supplicant wants to remove a PMKID/BSSID from driver. -+ */ -+ -+ _rtw_memcpy( strIssueBssid, pPMK->bssid.sa_data, ETH_ALEN); -+ if ( pPMK->cmd == IW_PMKSA_ADD ) -+ { -+ DBG_871X( "[rtw_wx_set_pmkid] IW_PMKSA_ADD!\n" ); -+ if ( _rtw_memcmp( strIssueBssid, strZeroMacAddress, ETH_ALEN ) == true ) -+ { -+ return( intReturn ); -+ } -+ else -+ { -+ intReturn = true; -+ } -+ blInserted = false; -+ -+ //overwrite PMKID -+ for(j=0 ; jPMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) ==true ) -+ { // BSSID is matched, the same AP => rewrite with new PMKID. -+ -+ DBG_871X( "[rtw_wx_set_pmkid] BSSID exists in the PMKList.\n" ); -+ -+ _rtw_memcpy( psecuritypriv->PMKIDList[j].PMKID, pPMK->pmkid, IW_PMKID_LEN); -+ psecuritypriv->PMKIDList[ j ].bUsed = true; -+ psecuritypriv->PMKIDIndex = j+1; -+ blInserted = true; -+ break; -+ } -+ } -+ -+ if(!blInserted) -+ { -+ // Find a new entry -+ DBG_871X( "[rtw_wx_set_pmkid] Use the new entry index = %d for this PMKID.\n", -+ psecuritypriv->PMKIDIndex ); -+ -+ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, strIssueBssid, ETH_ALEN); -+ _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, pPMK->pmkid, IW_PMKID_LEN); -+ -+ psecuritypriv->PMKIDList[ psecuritypriv->PMKIDIndex ].bUsed = true; -+ psecuritypriv->PMKIDIndex++ ; -+ if(psecuritypriv->PMKIDIndex==16) -+ { -+ psecuritypriv->PMKIDIndex =0; -+ } -+ } -+ } -+ else if ( pPMK->cmd == IW_PMKSA_REMOVE ) -+ { -+ DBG_871X( "[rtw_wx_set_pmkid] IW_PMKSA_REMOVE!\n" ); -+ intReturn = true; -+ for(j=0 ; jPMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) ==true ) -+ { // BSSID is matched, the same AP => Remove this PMKID information and reset it. -+ _rtw_memset( psecuritypriv->PMKIDList[ j ].Bssid, 0x00, ETH_ALEN ); -+ psecuritypriv->PMKIDList[ j ].bUsed = false; -+ break; -+ } -+ } -+ } -+ else if ( pPMK->cmd == IW_PMKSA_FLUSH ) -+ { -+ DBG_871X( "[rtw_wx_set_pmkid] IW_PMKSA_FLUSH!\n" ); -+ _rtw_memset( &psecuritypriv->PMKIDList[ 0 ], 0x00, sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE ); -+ psecuritypriv->PMKIDIndex = 0; -+ intReturn = true; -+ } -+ return( intReturn ); -+} -+ -+static int rtw_wx_get_sens(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ wrqu->sens.value = 0; -+ wrqu->sens.fixed = 0; /* no auto select */ -+ wrqu->sens.disabled = 1; -+ return 0; -+} -+ -+static int rtw_wx_get_range(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ struct iw_range *range = (struct iw_range *)extra; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ u16 val; -+ int i; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_range. cmd_code=%x\n", info->cmd)); -+ -+ wrqu->data.length = sizeof(*range); -+ _rtw_memset(range, 0, sizeof(*range)); -+ -+ /* Let's try to keep this struct in the same order as in -+ * linux/include/wireless.h -+ */ -+ -+ /* TODO: See what values we can set, and remove the ones we can't -+ * set, or fill them with some default data. -+ */ -+ -+ /* ~5 Mb/s real (802.11b) */ -+ range->throughput = 5 * 1000 * 1000; -+ -+ // TODO: Not used in 802.11b? -+// range->min_nwid; /* Minimal NWID we are able to set */ -+ // TODO: Not used in 802.11b? -+// range->max_nwid; /* Maximal NWID we are able to set */ -+ -+ /* Old Frequency (backward compat - moved lower ) */ -+// range->old_num_channels; -+// range->old_num_frequency; -+// range->old_freq[6]; /* Filler to keep "version" at the same offset */ -+ -+ /* signal level threshold range */ -+ -+ //percent values between 0 and 100. -+ range->max_qual.qual = 100; -+ range->max_qual.level = 100; -+ range->max_qual.noise = 100; -+ range->max_qual.updated = 7; /* Updated all three */ -+ -+ -+ range->avg_qual.qual = 92; /* > 8% missed beacons is 'bad' */ -+ /* TODO: Find real 'good' to 'bad' threshol value for RSSI */ -+ range->avg_qual.level = 20 + -98; -+ range->avg_qual.noise = 0; -+ range->avg_qual.updated = 7; /* Updated all three */ -+ -+ range->num_bitrates = RATE_COUNT; -+ -+ for (i = 0; i < RATE_COUNT && i < IW_MAX_BITRATES; i++) { -+ range->bitrate[i] = rtw_rates[i]; -+ } -+ -+ range->min_frag = MIN_FRAG_THRESHOLD; -+ range->max_frag = MAX_FRAG_THRESHOLD; -+ -+ range->pm_capa = 0; -+ -+ range->we_version_compiled = WIRELESS_EXT; -+ range->we_version_source = 16; -+ -+// range->retry_capa; /* What retry options are supported */ -+// range->retry_flags; /* How to decode max/min retry limit */ -+// range->r_time_flags; /* How to decode max/min retry life */ -+// range->min_retry; /* Minimal number of retries */ -+// range->max_retry; /* Maximal number of retries */ -+// range->min_r_time; /* Minimal retry lifetime */ -+// range->max_r_time; /* Maximal retry lifetime */ -+ -+ for (i = 0, val = 0; i < MAX_CHANNEL_NUM; i++) { -+ -+ // Include only legal frequencies for some countries -+ if(pmlmeext->channel_set[i].ChannelNum != 0) -+ { -+ range->freq[val].i = pmlmeext->channel_set[i].ChannelNum; -+ range->freq[val].m = rtw_ch2freq(pmlmeext->channel_set[i].ChannelNum) * 100000; -+ range->freq[val].e = 1; -+ val++; -+ } -+ -+ if (val == IW_MAX_FREQUENCIES) -+ break; -+ } -+ -+ range->num_channels = val; -+ range->num_frequency = val; -+ -+// Commented by Albert 2009/10/13 -+// The following code will proivde the security capability to network manager. -+// If the driver doesn't provide this capability to network manager, -+// the WPA/WPA2 routers can't be choosen in the network manager. -+ -+/* -+#define IW_SCAN_CAPA_NONE 0x00 -+#define IW_SCAN_CAPA_ESSID 0x01 -+#define IW_SCAN_CAPA_BSSID 0x02 -+#define IW_SCAN_CAPA_CHANNEL 0x04 -+#define IW_SCAN_CAPA_MODE 0x08 -+#define IW_SCAN_CAPA_RATE 0x10 -+#define IW_SCAN_CAPA_TYPE 0x20 -+#define IW_SCAN_CAPA_TIME 0x40 -+*/ -+ -+#if WIRELESS_EXT > 17 -+ range->enc_capa = IW_ENC_CAPA_WPA|IW_ENC_CAPA_WPA2| -+ IW_ENC_CAPA_CIPHER_TKIP|IW_ENC_CAPA_CIPHER_CCMP; -+#endif -+ -+#ifdef IW_SCAN_CAPA_ESSID //WIRELESS_EXT > 21 -+ range->scan_capa = IW_SCAN_CAPA_ESSID | IW_SCAN_CAPA_TYPE |IW_SCAN_CAPA_BSSID| -+ IW_SCAN_CAPA_CHANNEL|IW_SCAN_CAPA_MODE|IW_SCAN_CAPA_RATE; -+#endif -+ -+ -+ -+ -+ return 0; -+ -+} -+ -+//set bssid flow -+//s1. rtw_set_802_11_infrastructure_mode() -+//s2. rtw_set_802_11_authentication_mode() -+//s3. set_802_11_encryption_mode() -+//s4. rtw_set_802_11_bssid() -+static int rtw_wx_set_wap(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *awrq, -+ char *extra) -+{ -+ _irqL irqL; -+ uint ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sockaddr *temp = (struct sockaddr *)awrq; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _list *phead; -+ u8 *dst_bssid, *src_bssid; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ -+ -+/* -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->iface_type > PRIMARY_IFACE) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+#endif -+*/ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) -+ { -+ DBG_871X("set bssid, but buddy_intf is under scanning or linking\n"); -+ -+ ret = -EINVAL; -+ -+ goto exit; -+ } -+#endif -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ if (dc_check_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)== true) -+ { -+ DBG_871X("set bssid, but buddy_intf is under scanning or linking\n"); -+ ret = -EINVAL; -+ goto exit; -+ } -+#endif -+ -+ if(_FAIL == rtw_pwr_wakeup(padapter)) -+ { -+ ret= -1; -+ goto exit; -+ } -+ -+ if(!padapter->bup){ -+ ret = -1; -+ goto exit; -+ } -+ -+ -+ if (temp->sa_family != ARPHRD_ETHER){ -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ authmode = padapter->securitypriv.ndisauthtype; -+ _enter_critical_bh(&queue->lock, &irqL); -+ phead = get_list_head(queue); -+ pmlmepriv->pscanned = get_next(phead); -+ -+ while (1) -+ { -+ -+ if ((rtw_end_of_queue_search(phead, pmlmepriv->pscanned)) == true) -+ { -+#if 0 -+ ret = -EINVAL; -+ goto exit; -+ -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) -+ { -+ rtw_set_802_11_bssid(padapter, temp->sa_data); -+ goto exit; -+ } -+ else -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+#endif -+ -+ break; -+ } -+ -+ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); -+ -+ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); -+ -+ dst_bssid = pnetwork->network.MacAddress; -+ -+ src_bssid = temp->sa_data; -+ -+ if ((_rtw_memcmp(dst_bssid, src_bssid, ETH_ALEN)) == true) -+ { -+ if(!rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode)) -+ { -+ ret = -1; -+ _exit_critical_bh(&queue->lock, &irqL); -+ goto exit; -+ } -+ -+ break; -+ } -+ -+ } -+ _exit_critical_bh(&queue->lock, &irqL); -+ -+ rtw_set_802_11_authentication_mode(padapter, authmode); -+ //set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); -+ if (rtw_set_802_11_bssid(padapter, temp->sa_data) == false) { -+ ret = -1; -+ goto exit; -+ } -+ -+exit: -+ -+ -+ -+ return ret; -+} -+ -+static int rtw_wx_get_wap(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ -+ wrqu->ap_addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN); -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_wap\n")); -+ -+ -+ -+ if ( ((check_fwstate(pmlmepriv, _FW_LINKED)) == true) || -+ ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == true) || -+ ((check_fwstate(pmlmepriv, WIFI_AP_STATE)) == true) ) -+ { -+ -+ _rtw_memcpy(wrqu->ap_addr.sa_data, pcur_bss->MacAddress, ETH_ALEN); -+ } -+ else -+ { -+ _rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN); -+ } -+ -+ -+ -+ return 0; -+ -+} -+ -+static int rtw_wx_set_mlme(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret=0; -+ u16 reason; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_mlme *mlme = (struct iw_mlme *) extra; -+ -+ if(mlme==NULL) -+ return -1; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ reason = mlme->reason_code; -+ -+ DBG_871X("%s, cmd=%d, reason=%d\n", __FUNCTION__, mlme->cmd, reason); -+ -+ -+ switch (mlme->cmd) -+ { -+ case IW_MLME_DEAUTH: -+ if(!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ break; -+ -+ case IW_MLME_DISASSOC: -+ if(!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ -+ break; -+ -+ default: -+ return -EOPNOTSUPP; -+ } -+ -+ return ret; -+} -+ -+static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ u8 _status = false; -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv= &padapter->mlmepriv; -+ NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; -+ _irqL irqL; -+#ifdef CONFIG_P2P -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif //CONFIG_P2P -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_set_scan\n")); -+ -+ -+ -+ #ifdef DBG_IOCTL -+ DBG_871X("DBG_IOCTL %s:%d\n",__FUNCTION__, __LINE__); -+ #endif -+/* -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->iface_type > PRIMARY_IFACE) -+ { -+ ret = -1; -+ goto exit; -+ } -+#endif -+*/ -+ -+#ifdef CONFIG_MP_INCLUDED -+if (padapter->registrypriv.mp_mode == 1) -+{ -+ if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) -+ { -+ ret = -1; -+ goto exit; -+ } -+} -+#endif -+ if(_FAIL == rtw_pwr_wakeup(padapter)) -+ { -+ ret= -1; -+ goto exit; -+ } -+ -+ if(padapter->bDriverStopped){ -+ DBG_871X("bDriverStopped=%d\n", padapter->bDriverStopped); -+ ret= -1; -+ goto exit; -+ } -+ -+ if(!padapter->bup){ -+ ret = -1; -+ goto exit; -+ } -+ -+ if (padapter->hw_init_completed==false){ -+ ret = -1; -+ goto exit; -+ } -+ -+ // When Busy Traffic, driver do not site survey. So driver return success. -+ // wpa_supplicant will not issue SIOCSIWSCAN cmd again after scan timeout. -+ // modify by thomas 2011-02-22. -+ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == true) -+ { -+ indicate_wx_scan_complete_event(padapter); -+ goto exit; -+ } -+ -+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) -+ { -+ indicate_wx_scan_complete_event(padapter); -+ goto exit; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, -+ _FW_UNDER_SURVEY|_FW_UNDER_LINKING|WIFI_UNDER_WPS) == true) -+ { -+ if(check_buddy_fwstate(padapter, _FW_UNDER_SURVEY)) -+ { -+ DBG_871X("scanning_via_buddy_intf\n"); -+ pmlmepriv->scanning_via_buddy_intf = true; -+ } -+ -+ indicate_wx_scan_complete_event(padapter); -+ -+ goto exit; -+ } -+#endif -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ if (dc_check_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)== true) -+ { -+ indicate_wx_scan_complete_event(padapter); -+ goto exit; -+ } -+#endif -+ -+// Mareded by Albert 20101103 -+// For the DMP WiFi Display project, the driver won't to scan because -+// the pmlmepriv->scan_interval is always equal to 3. -+// So, the wpa_supplicant won't find out the WPS SoftAP. -+ -+/* -+ if(pmlmepriv->scan_interval>10) -+ pmlmepriv->scan_interval = 0; -+ -+ if(pmlmepriv->scan_interval > 0) -+ { -+ DBG_871X("scan done\n"); -+ ret = 0; -+ goto exit; -+ } -+ -+*/ -+#ifdef CONFIG_P2P -+ if ( pwdinfo->p2p_state != P2P_STATE_NONE ) -+ { -+ rtw_p2p_set_pre_state( pwdinfo, rtw_p2p_state( pwdinfo ) ); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_FULL); -+ rtw_free_network_queue(padapter, true); -+ } -+#endif //CONFIG_P2P -+ -+ _rtw_memset(ssid, 0, sizeof(NDIS_802_11_SSID)*RTW_SSID_SCAN_AMOUNT); -+ -+#if WIRELESS_EXT >= 17 -+ if (wrqu->data.length == sizeof(struct iw_scan_req)) -+ { -+ struct iw_scan_req *req = (struct iw_scan_req *)extra; -+ -+ if (wrqu->data.flags & IW_SCAN_THIS_ESSID) -+ { -+ int len = min((int)req->essid_len, IW_ESSID_MAX_SIZE); -+ -+ _rtw_memcpy(ssid[0].Ssid, req->essid, len); -+ ssid[0].SsidLength = len; -+ -+ DBG_871X("IW_SCAN_THIS_ESSID, ssid=%s, len=%d\n", req->essid, req->essid_len); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ _status = rtw_sitesurvey_cmd(padapter, ssid, 1, NULL, 0); -+ -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+ } -+ else if (req->scan_type == IW_SCAN_TYPE_PASSIVE) -+ { -+ DBG_871X("rtw_wx_set_scan, req->scan_type == IW_SCAN_TYPE_PASSIVE\n"); -+ } -+ -+ } -+ else -+#endif -+ -+ if( wrqu->data.length >= WEXT_CSCAN_HEADER_SIZE -+ && _rtw_memcmp(extra, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == true -+ ) -+ { -+ int len = wrqu->data.length -WEXT_CSCAN_HEADER_SIZE; -+ char *pos = extra+WEXT_CSCAN_HEADER_SIZE; -+ char section; -+ char sec_len; -+ int ssid_index = 0; -+ -+ //DBG_871X("%s COMBO_SCAN header is recognized\n", __FUNCTION__); -+ -+ while(len >= 1) { -+ section = *(pos++); len-=1; -+ -+ switch(section) { -+ case WEXT_CSCAN_SSID_SECTION: -+ //DBG_871X("WEXT_CSCAN_SSID_SECTION\n"); -+ if(len < 1) { -+ len = 0; -+ break; -+ } -+ -+ sec_len = *(pos++); len-=1; -+ -+ if(sec_len>0 && sec_len<=len) { -+ ssid[ssid_index].SsidLength = sec_len; -+ _rtw_memcpy(ssid[ssid_index].Ssid, pos, ssid[ssid_index].SsidLength); -+ //DBG_871X("%s COMBO_SCAN with specific ssid:%s, %d\n", __FUNCTION__ -+ // , ssid[ssid_index].Ssid, ssid[ssid_index].SsidLength); -+ ssid_index++; -+ } -+ -+ pos+=sec_len; len-=sec_len; -+ break; -+ -+ -+ case WEXT_CSCAN_CHANNEL_SECTION: -+ //DBG_871X("WEXT_CSCAN_CHANNEL_SECTION\n"); -+ pos+=1; len-=1; -+ break; -+ case WEXT_CSCAN_ACTV_DWELL_SECTION: -+ //DBG_871X("WEXT_CSCAN_ACTV_DWELL_SECTION\n"); -+ pos+=2; len-=2; -+ break; -+ case WEXT_CSCAN_PASV_DWELL_SECTION: -+ //DBG_871X("WEXT_CSCAN_PASV_DWELL_SECTION\n"); -+ pos+=2; len-=2; -+ break; -+ case WEXT_CSCAN_HOME_DWELL_SECTION: -+ //DBG_871X("WEXT_CSCAN_HOME_DWELL_SECTION\n"); -+ pos+=2; len-=2; -+ break; -+ case WEXT_CSCAN_TYPE_SECTION: -+ //DBG_871X("WEXT_CSCAN_TYPE_SECTION\n"); -+ pos+=1; len-=1; -+ break; -+ #if 0 -+ case WEXT_CSCAN_NPROBE_SECTION: -+ DBG_871X("WEXT_CSCAN_NPROBE_SECTION\n"); -+ break; -+ #endif -+ -+ default: -+ //DBG_871X("Unknown CSCAN section %c\n", section); -+ len = 0; // stop parsing -+ } -+ //DBG_871X("len:%d\n", len); -+ -+ } -+ -+ //jeff: it has still some scan paramater to parse, we only do this now... -+ _status = rtw_set_802_11_bssid_list_scan(padapter, ssid, RTW_SSID_SCAN_AMOUNT); -+ -+ } else -+ -+ { -+ _status = rtw_set_802_11_bssid_list_scan(padapter, NULL, 0); -+ } -+ -+ if(_status == false) -+ ret = -1; -+ -+exit: -+ #ifdef DBG_IOCTL -+ DBG_871X("DBG_IOCTL %s:%d return %d\n",__FUNCTION__, __LINE__, ret); -+ #endif -+ -+ -+ -+ return ret; -+} -+ -+static int rtw_wx_get_scan(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _irqL irqL; -+ _list *plist, *phead; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ char *ev = extra; -+ char *stop = ev + wrqu->data.length; -+ u32 ret = 0; -+ u32 cnt=0; -+ u32 wait_for_surveydone; -+ sint wait_status; -+#ifdef CONFIG_CONCURRENT_MODE -+ //PADAPTER pbuddy_adapter = padapter->pbuddy_adapter; -+ //struct mlme_priv *pbuddy_mlmepriv = &(pbuddy_adapter->mlmepriv); -+#endif -+#ifdef CONFIG_P2P -+ struct wifidirect_info* pwdinfo = &padapter->wdinfo; -+#endif //CONFIG_P2P -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_scan\n")); -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_, (" Start of Query SIOCGIWSCAN .\n")); -+ -+ -+ -+ #ifdef DBG_IOCTL -+ DBG_871X("DBG_IOCTL %s:%d\n",__FUNCTION__, __LINE__); -+ #endif -+ -+/* -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->iface_type > PRIMARY_IFACE) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+#endif -+*/ -+ if(padapter->pwrctrlpriv.brfoffbyhw && padapter->bDriverStopped) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+#ifdef CONFIG_P2P -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ // P2P is enabled -+ if ( padapter->chip_type == RTL8192D ) -+ wait_for_surveydone = 300; // Because the 8192du supports more channels. -+ else -+ wait_for_surveydone = 200; -+ } -+ else -+ { -+ // P2P is disabled -+ wait_for_surveydone = 100; -+ } -+#else -+ { -+ wait_for_surveydone = 100; -+ } -+#endif //CONFIG_P2P -+ -+/* -+#ifdef CONFIG_CONCURRENT_MODE -+ if(pmlmepriv->scanning_via_buddy_intf == true) -+ { -+ pmlmepriv->scanning_via_buddy_intf = false;//reset -+ -+ // change pointers to buddy interface -+ padapter = pbuddy_adapter; -+ pmlmepriv = pbuddy_mlmepriv; -+ queue = &(pbuddy_mlmepriv->scanned_queue); -+ -+ } -+#endif // CONFIG_CONCURRENT_MODE -+*/ -+ -+ wait_status = _FW_UNDER_SURVEY -+ #ifndef CONFIG_ANDROID -+ |_FW_UNDER_LINKING -+ #endif -+ ; -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ while(dc_check_fwstate(padapter, wait_status)== true) -+ { -+ rtw_msleep_os(30); -+ cnt++; -+ if(cnt > wait_for_surveydone ) -+ break; -+ } -+#endif // CONFIG_DUALMAC_CONCURRENT -+ -+ while(check_fwstate(pmlmepriv, wait_status) == true) -+ { -+ rtw_msleep_os(30); -+ cnt++; -+ if(cnt > wait_for_surveydone ) -+ break; -+ } -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while(1) -+ { -+ if (rtw_end_of_queue_search(phead,plist)== true) -+ break; -+ -+ if((stop - ev) < SCAN_ITEM_SIZE) { -+ ret = -E2BIG; -+ break; -+ } -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ //report network only if the current channel set contains the channel to which this network belongs -+ if(rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 -+ #ifdef CONFIG_VALIDATE_SSID -+ && true == rtw_validate_ssid(&(pnetwork->network.Ssid)) -+ #endif -+ ) -+ { -+ ev=translate_scan(padapter, a, pnetwork, ev, stop); -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ wrqu->data.length = ev-extra; -+ wrqu->data.flags = 0; -+ -+exit: -+ -+ -+ -+ #ifdef DBG_IOCTL -+ DBG_871X("DBG_IOCTL %s:%d return %d\n",__FUNCTION__, __LINE__, ret); -+ #endif -+ -+ return ret ; -+ -+} -+ -+//set ssid flow -+//s1. rtw_set_802_11_infrastructure_mode() -+//s2. set_802_11_authenticaion_mode() -+//s3. set_802_11_encryption_mode() -+//s4. rtw_set_802_11_ssid() -+static int rtw_wx_set_essid(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _irqL irqL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _queue *queue = &pmlmepriv->scanned_queue; -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ _list *phead; -+ s8 status = true; -+ struct wlan_network *pnetwork = NULL; -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ NDIS_802_11_SSID ndis_ssid; -+ u8 *dst_ssid, *src_ssid; -+ -+ uint ret = 0, len; -+ -+ -+ -+ #ifdef DBG_IOCTL -+ DBG_871X("DBG_IOCTL %s:%d\n",__FUNCTION__, __LINE__); -+ #endif -+ -+/* -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->iface_type > PRIMARY_IFACE) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+#endif -+*/ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if (check_buddy_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) -+ { -+ DBG_871X("set ssid, but buddy_intf is under scanning or linking\n"); -+ -+ ret = -EINVAL; -+ -+ goto exit; -+ } -+#endif -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ if (dc_check_fwstate(padapter, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)== true) -+ { -+ DBG_871X("set bssid, but buddy_intf is under scanning or linking\n"); -+ ret = -EINVAL; -+ goto exit; -+ } -+#endif -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("+rtw_wx_set_essid: fw_state=0x%08x\n", get_fwstate(pmlmepriv))); -+ if(_FAIL == rtw_pwr_wakeup(padapter)) -+ { -+ ret = -1; -+ goto exit; -+ } -+ -+ if(!padapter->bup){ -+ ret = -1; -+ goto exit; -+ } -+ -+#if WIRELESS_EXT <= 20 -+ if ((wrqu->essid.length-1) > IW_ESSID_MAX_SIZE){ -+#else -+ if (wrqu->essid.length > IW_ESSID_MAX_SIZE){ -+#endif -+ ret= -E2BIG; -+ goto exit; -+ } -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) { -+ ret = -1; -+ goto exit; -+ } -+ -+ authmode = padapter->securitypriv.ndisauthtype; -+ DBG_871X("=>%s\n",__FUNCTION__); -+ if (wrqu->essid.flags && wrqu->essid.length) -+ { -+ // Commented by Albert 20100519 -+ // We got the codes in "set_info" function of iwconfig source code. -+ // ========================================= -+ // wrq.u.essid.length = strlen(essid) + 1; -+ // if(we_kernel_version > 20) -+ // wrq.u.essid.length--; -+ // ========================================= -+ // That means, if the WIRELESS_EXT less than or equal to 20, the correct ssid len should subtract 1. -+#if WIRELESS_EXT <= 20 -+ len = ((wrqu->essid.length-1) < IW_ESSID_MAX_SIZE) ? (wrqu->essid.length-1) : IW_ESSID_MAX_SIZE; -+#else -+ len = (wrqu->essid.length < IW_ESSID_MAX_SIZE) ? wrqu->essid.length : IW_ESSID_MAX_SIZE; -+#endif -+ -+ if( wrqu->essid.length != 33 ) -+ DBG_871X("ssid=%s, len=%d\n", extra, wrqu->essid.length); -+ -+ _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ ndis_ssid.SsidLength = len; -+ _rtw_memcpy(ndis_ssid.Ssid, extra, len); -+ src_ssid = ndis_ssid.Ssid; -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, ("rtw_wx_set_essid: ssid=[%s]\n", src_ssid)); -+ _enter_critical_bh(&queue->lock, &irqL); -+ phead = get_list_head(queue); -+ pmlmepriv->pscanned = get_next(phead); -+ -+ while (1) -+ { -+ if (rtw_end_of_queue_search(phead, pmlmepriv->pscanned) == true) -+ { -+#if 0 -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) -+ { -+ rtw_set_802_11_ssid(padapter, &ndis_ssid); -+ -+ goto exit; -+ } -+ else -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("rtw_wx_set_ssid(): scanned_queue is empty\n")); -+ ret = -EINVAL; -+ goto exit; -+ } -+#endif -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_warning_, -+ ("rtw_wx_set_essid: scan_q is empty, set ssid to check if scanning again!\n")); -+ -+ break; -+ } -+ -+ pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list); -+ -+ pmlmepriv->pscanned = get_next(pmlmepriv->pscanned); -+ -+ dst_ssid = pnetwork->network.Ssid.Ssid; -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("rtw_wx_set_essid: dst_ssid=%s\n", -+ pnetwork->network.Ssid.Ssid)); -+ -+ if ((_rtw_memcmp(dst_ssid, src_ssid, ndis_ssid.SsidLength) == true) && -+ (pnetwork->network.Ssid.SsidLength==ndis_ssid.SsidLength)) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("rtw_wx_set_essid: find match, set infra mode\n")); -+ -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) -+ { -+ if(pnetwork->network.InfrastructureMode != pmlmepriv->cur_network.network.InfrastructureMode) -+ continue; -+ } -+ -+ if (rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode) == false) -+ { -+ ret = -1; -+ _exit_critical_bh(&queue->lock, &irqL); -+ goto exit; -+ } -+ -+ break; -+ } -+ } -+ _exit_critical_bh(&queue->lock, &irqL); -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("set ssid: set_802_11_auth. mode=%d\n", authmode)); -+ rtw_set_802_11_authentication_mode(padapter, authmode); -+ //set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); -+ if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == false) { -+ ret = -1; -+ goto exit; -+ } -+ } -+ -+exit: -+ -+ DBG_871X("<=%s, ret %d\n",__FUNCTION__, ret); -+ -+ #ifdef DBG_IOCTL -+ DBG_871X("DBG_IOCTL %s:%d return %d\n",__FUNCTION__, __LINE__, ret); -+ #endif -+ -+ -+ -+ return ret; -+} -+ -+static int rtw_wx_get_essid(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ u32 len,ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,("rtw_wx_get_essid\n")); -+ -+ -+ -+ if ( (check_fwstate(pmlmepriv, _FW_LINKED) == true) || -+ (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) -+ { -+ len = pcur_bss->Ssid.SsidLength; -+ -+ wrqu->essid.length = len; -+ -+ _rtw_memcpy(extra, pcur_bss->Ssid.Ssid, len); -+ -+ wrqu->essid.flags = 1; -+ } -+ else -+ { -+ ret = -1; -+ goto exit; -+ } -+ -+exit: -+ -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_wx_set_rate(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int i, ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 datarates[NumRates]; -+ u32 target_rate = wrqu->bitrate.value; -+ u32 fixed = wrqu->bitrate.fixed; -+ u32 ratevalue = 0; -+ u8 mpdatarate[NumRates]={11, 10, 9, 8, 7, 6, 5, 4, 3, 2, 1, 0, 0xff}; -+ -+ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_,_drv_info_,(" rtw_wx_set_rate \n")); -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("target_rate = %d, fixed = %d\n",target_rate,fixed)); -+ -+ if(target_rate == -1){ -+ ratevalue = 11; -+ goto set_rate; -+ } -+ target_rate = target_rate/100000; -+ -+ switch(target_rate){ -+ case 10: -+ ratevalue = 0; -+ break; -+ case 20: -+ ratevalue = 1; -+ break; -+ case 55: -+ ratevalue = 2; -+ break; -+ case 60: -+ ratevalue = 3; -+ break; -+ case 90: -+ ratevalue = 4; -+ break; -+ case 110: -+ ratevalue = 5; -+ break; -+ case 120: -+ ratevalue = 6; -+ break; -+ case 180: -+ ratevalue = 7; -+ break; -+ case 240: -+ ratevalue = 8; -+ break; -+ case 360: -+ ratevalue = 9; -+ break; -+ case 480: -+ ratevalue = 10; -+ break; -+ case 540: -+ ratevalue = 11; -+ break; -+ default: -+ ratevalue = 11; -+ break; -+ } -+ -+set_rate: -+ -+ for(i=0; ibitrate.fixed = 0; /* no auto select */ -+ wrqu->bitrate.value = max_rate * 100000; -+ -+ return 0; -+} -+ -+static int rtw_wx_set_rts(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ -+ if (wrqu->rts.disabled) -+ padapter->registrypriv.rts_thresh = 2347; -+ else { -+ if (wrqu->rts.value < 0 || -+ wrqu->rts.value > 2347) -+ return -EINVAL; -+ -+ padapter->registrypriv.rts_thresh = wrqu->rts.value; -+ } -+ -+ DBG_871X("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh); -+ -+ -+ -+ return 0; -+ -+} -+ -+static int rtw_wx_get_rts(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ -+ DBG_871X("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh); -+ -+ wrqu->rts.value = padapter->registrypriv.rts_thresh; -+ wrqu->rts.fixed = 0; /* no auto select */ -+ //wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD); -+ -+ -+ -+ return 0; -+} -+ -+static int rtw_wx_set_frag(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ -+ if (wrqu->frag.disabled) -+ padapter->xmitpriv.frag_len = MAX_FRAG_THRESHOLD; -+ else { -+ if (wrqu->frag.value < MIN_FRAG_THRESHOLD || -+ wrqu->frag.value > MAX_FRAG_THRESHOLD) -+ return -EINVAL; -+ -+ padapter->xmitpriv.frag_len = wrqu->frag.value & ~0x1; -+ } -+ -+ DBG_871X("%s, frag_len=%d\n", __func__, padapter->xmitpriv.frag_len); -+ -+ -+ -+ return 0; -+ -+} -+ -+static int rtw_wx_get_frag(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ -+ DBG_871X("%s, frag_len=%d\n", __func__, padapter->xmitpriv.frag_len); -+ -+ wrqu->frag.value = padapter->xmitpriv.frag_len; -+ wrqu->frag.fixed = 0; /* no auto select */ -+ //wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FRAG_THRESHOLD); -+ -+ -+ -+ return 0; -+} -+ -+static int rtw_wx_get_retry(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ -+ wrqu->retry.value = 7; -+ wrqu->retry.fixed = 0; /* no auto select */ -+ wrqu->retry.disabled = 1; -+ -+ return 0; -+ -+} -+ -+#if 0 -+#define IW_ENCODE_INDEX 0x00FF /* Token index (if needed) */ -+#define IW_ENCODE_FLAGS 0xFF00 /* Flags defined below */ -+#define IW_ENCODE_MODE 0xF000 /* Modes defined below */ -+#define IW_ENCODE_DISABLED 0x8000 /* Encoding disabled */ -+#define IW_ENCODE_ENABLED 0x0000 /* Encoding enabled */ -+#define IW_ENCODE_RESTRICTED 0x4000 /* Refuse non-encoded packets */ -+#define IW_ENCODE_OPEN 0x2000 /* Accept non-encoded packets */ -+#define IW_ENCODE_NOKEY 0x0800 /* Key is write only, so not present */ -+#define IW_ENCODE_TEMP 0x0400 /* Temporary key */ -+/* -+iwconfig wlan0 key on -> flags = 0x6001 -> maybe it means auto -+iwconfig wlan0 key off -> flags = 0x8800 -+iwconfig wlan0 key open -> flags = 0x2800 -+iwconfig wlan0 key open 1234567890 -> flags = 0x2000 -+iwconfig wlan0 key restricted -> flags = 0x4800 -+iwconfig wlan0 key open [3] 1234567890 -> flags = 0x2003 -+iwconfig wlan0 key restricted [2] 1234567890 -> flags = 0x4002 -+iwconfig wlan0 key open [3] -> flags = 0x2803 -+iwconfig wlan0 key restricted [2] -> flags = 0x4802 -+*/ -+#endif -+ -+static int rtw_wx_set_enc(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *keybuf) -+{ -+ u32 key, ret = 0; -+ u32 keyindex_provided; -+ NDIS_802_11_WEP wep; -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ -+ struct iw_point *erq = &(wrqu->encoding); -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ DBG_871X("+rtw_wx_set_enc, flags=0x%x\n", erq->flags); -+ -+ _rtw_memset(&wep, 0, sizeof(NDIS_802_11_WEP)); -+ -+ key = erq->flags & IW_ENCODE_INDEX; -+ -+ -+ -+ if (erq->flags & IW_ENCODE_DISABLED) -+ { -+ DBG_871X("EncryptionDisabled\n"); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; -+ padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_; -+ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Open; //open system -+ authmode = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisauthtype=authmode; -+ -+ goto exit; -+ } -+ -+ if (key) { -+ if (key > WEP_KEYS) -+ return -EINVAL; -+ key--; -+ keyindex_provided = 1; -+ } -+ else -+ { -+ keyindex_provided = 0; -+ key = padapter->securitypriv.dot11PrivacyKeyIndex; -+ DBG_871X("rtw_wx_set_enc, key=%d\n", key); -+ } -+ -+ //set authentication mode -+ if(erq->flags & IW_ENCODE_OPEN) -+ { -+ DBG_871X("rtw_wx_set_enc():IW_ENCODE_OPEN\n"); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;//Ndis802_11EncryptionDisabled; -+ -+ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Open; -+ -+ padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; -+ padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_; -+ authmode = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisauthtype=authmode; -+ } -+ else if(erq->flags & IW_ENCODE_RESTRICTED) -+ { -+ DBG_871X("rtw_wx_set_enc():IW_ENCODE_RESTRICTED\n"); -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ -+ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Shared; -+ -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_; -+ padapter->securitypriv.dot118021XGrpPrivacy=_WEP40_; -+ authmode = Ndis802_11AuthModeShared; -+ padapter->securitypriv.ndisauthtype=authmode; -+ } -+ else -+ { -+ DBG_871X("rtw_wx_set_enc():erq->flags=0x%x\n", erq->flags); -+ -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;//Ndis802_11EncryptionDisabled; -+ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Open; //open system -+ padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; -+ padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_; -+ authmode = Ndis802_11AuthModeOpen; -+ padapter->securitypriv.ndisauthtype=authmode; -+ } -+ -+ wep.KeyIndex = key; -+ if (erq->length > 0) -+ { -+ wep.KeyLength = erq->length <= 5 ? 5 : 13; -+ -+ wep.Length = wep.KeyLength + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); -+ } -+ else -+ { -+ wep.KeyLength = 0 ; -+ -+ if(keyindex_provided == 1)// set key_id only, no given KeyMaterial(erq->length==0). -+ { -+ padapter->securitypriv.dot11PrivacyKeyIndex = key; -+ -+ DBG_871X("(keyindex_provided == 1), keyid=%d, key_len=%d\n", key, padapter->securitypriv.dot11DefKeylen[key]); -+ -+ switch(padapter->securitypriv.dot11DefKeylen[key]) -+ { -+ case 5: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_; -+ break; -+ case 13: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_; -+ break; -+ default: -+ padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; -+ break; -+ } -+ -+ goto exit; -+ -+ } -+ -+ } -+ -+ wep.KeyIndex |= 0x80000000; -+ -+ _rtw_memcpy(wep.KeyMaterial, keybuf, wep.KeyLength); -+ -+ if (rtw_set_802_11_add_wep(padapter, &wep) == false) { -+ if(rf_on == pwrpriv->rf_pwrstate ) -+ ret = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+exit: -+ -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_wx_get_enc(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *keybuf) -+{ -+ uint key, ret =0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *erq = &(wrqu->encoding); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED) != true) -+ { -+ if(check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != true) -+ { -+ erq->length = 0; -+ erq->flags |= IW_ENCODE_DISABLED; -+ return 0; -+ } -+ } -+ -+ -+ key = erq->flags & IW_ENCODE_INDEX; -+ -+ if (key) { -+ if (key > WEP_KEYS) -+ return -EINVAL; -+ key--; -+ } else -+ { -+ key = padapter->securitypriv.dot11PrivacyKeyIndex; -+ } -+ -+ erq->flags = key + 1; -+ -+ //if(padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen) -+ //{ -+ // erq->flags |= IW_ENCODE_OPEN; -+ //} -+ -+ switch(padapter->securitypriv.ndisencryptstatus) -+ { -+ case Ndis802_11EncryptionNotSupported: -+ case Ndis802_11EncryptionDisabled: -+ -+ erq->length = 0; -+ erq->flags |= IW_ENCODE_DISABLED; -+ -+ break; -+ -+ case Ndis802_11Encryption1Enabled: -+ -+ erq->length = padapter->securitypriv.dot11DefKeylen[key]; -+ -+ if(erq->length) -+ { -+ _rtw_memcpy(keybuf, padapter->securitypriv.dot11DefKey[key].skey, padapter->securitypriv.dot11DefKeylen[key]); -+ -+ erq->flags |= IW_ENCODE_ENABLED; -+ -+ if(padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen) -+ { -+ erq->flags |= IW_ENCODE_OPEN; -+ } -+ else if(padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeShared) -+ { -+ erq->flags |= IW_ENCODE_RESTRICTED; -+ } -+ } -+ else -+ { -+ erq->length = 0; -+ erq->flags |= IW_ENCODE_DISABLED; -+ } -+ -+ break; -+ -+ case Ndis802_11Encryption2Enabled: -+ case Ndis802_11Encryption3Enabled: -+ -+ erq->length = 16; -+ erq->flags |= (IW_ENCODE_ENABLED | IW_ENCODE_OPEN | IW_ENCODE_NOKEY); -+ -+ break; -+ -+ default: -+ erq->length = 0; -+ erq->flags |= IW_ENCODE_DISABLED; -+ -+ break; -+ -+ } -+ -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_wx_get_power(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ wrqu->power.value = 0; -+ wrqu->power.fixed = 0; /* no auto select */ -+ wrqu->power.disabled = 1; -+ -+ return 0; -+ -+} -+ -+static int rtw_wx_set_gen_ie(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ ret = rtw_set_wpa_ie(padapter, extra, wrqu->data.length); -+ -+ return ret; -+} -+ -+static int rtw_wx_set_auth(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_param *param = (struct iw_param*)&(wrqu->param); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u32 value = param->value; -+ int ret = 0; -+ -+ switch (param->flags & IW_AUTH_INDEX) { -+ -+ case IW_AUTH_WPA_VERSION: -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef CONFIG_IOCTL_CFG80211 -+ padapter->wapiInfo.bWapiEnable = false; -+ if(value == IW_AUTH_WAPI_VERSION_1) -+ { -+ padapter->wapiInfo.bWapiEnable = true; -+ psecuritypriv->dot11PrivacyAlgrthm = _SMS4_; -+ psecuritypriv->dot118021XGrpPrivacy = _SMS4_; -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI; -+ pmlmeinfo->auth_algo = psecuritypriv->dot11AuthAlgrthm; -+ padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN; -+ padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN; -+ } -+#endif -+#endif -+ break; -+ case IW_AUTH_CIPHER_PAIRWISE: -+ -+ break; -+ case IW_AUTH_CIPHER_GROUP: -+ -+ break; -+ case IW_AUTH_KEY_MGMT: -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef CONFIG_IOCTL_CFG80211 -+ DBG_871X("rtw_wx_set_auth: IW_AUTH_KEY_MGMT case \n"); -+ if(value == IW_AUTH_KEY_MGMT_WAPI_PSK) -+ padapter->wapiInfo.bWapiPSK = true; -+ else -+ padapter->wapiInfo.bWapiPSK = false; -+ DBG_871X("rtw_wx_set_auth: IW_AUTH_KEY_MGMT bwapipsk %d \n",padapter->wapiInfo.bWapiPSK); -+#endif -+#endif -+ /* -+ * ??? does not use these parameters -+ */ -+ break; -+ -+ case IW_AUTH_TKIP_COUNTERMEASURES: -+ { -+ if ( param->value ) -+ { // wpa_supplicant is enabling the tkip countermeasure. -+ padapter->securitypriv.btkip_countermeasure = true; -+ } -+ else -+ { // wpa_supplicant is disabling the tkip countermeasure. -+ padapter->securitypriv.btkip_countermeasure = false; -+ } -+ break; -+ } -+ case IW_AUTH_DROP_UNENCRYPTED: -+ { -+ /* HACK: -+ * -+ * wpa_supplicant calls set_wpa_enabled when the driver -+ * is loaded and unloaded, regardless of if WPA is being -+ * used. No other calls are made which can be used to -+ * determine if encryption will be used or not prior to -+ * association being expected. If encryption is not being -+ * used, drop_unencrypted is set to false, else true -- we -+ * can use this to determine if the CAP_PRIVACY_ON bit should -+ * be set. -+ */ -+ -+ if(padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption1Enabled) -+ { -+ break;//it means init value, or using wep, ndisencryptstatus = Ndis802_11Encryption1Enabled, -+ // then it needn't reset it; -+ } -+ -+ if(param->value){ -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_; -+ padapter->securitypriv.dot118021XGrpPrivacy=_NO_PRIVACY_; -+ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_Open; //open system -+ padapter->securitypriv.ndisauthtype=Ndis802_11AuthModeOpen; -+ } -+ -+ break; -+ } -+ -+ case IW_AUTH_80211_AUTH_ALG: -+ -+ #if defined(CONFIG_ANDROID) || 1 -+ /* -+ * It's the starting point of a link layer connection using wpa_supplicant -+ */ -+ if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, false); -+ DBG_871X("%s...call rtw_indicate_disconnect\n ",__FUNCTION__); -+ rtw_indicate_disconnect(padapter); -+ rtw_free_assoc_resources(padapter, 1); -+ } -+ #endif -+ -+ -+ ret = wpa_set_auth_algs(dev, (u32)param->value); -+ -+ break; -+ -+ case IW_AUTH_WPA_ENABLED: -+ -+ //if(param->value) -+ // padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; //802.1x -+ //else -+ // padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open;//open system -+ -+ //_disassociate(priv); -+ -+ break; -+ -+ case IW_AUTH_RX_UNENCRYPTED_EAPOL: -+ //ieee->ieee802_1x = param->value; -+ break; -+ -+ case IW_AUTH_PRIVACY_INVOKED: -+ //ieee->privacy_invoked = param->value; -+ break; -+ -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef CONFIG_IOCTL_CFG80211 -+ case IW_AUTH_WAPI_ENABLED: -+ break; -+#endif -+#endif -+ -+ default: -+ return -EOPNOTSUPP; -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_wx_set_enc_ext(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ char *alg_name; -+ u32 param_len; -+ struct ieee_param *param = NULL; -+ struct iw_point *pencoding = &wrqu->encoding; -+ struct iw_encode_ext *pext = (struct iw_encode_ext *)extra; -+ int ret=0; -+ -+ param_len = sizeof(struct ieee_param) + pext->key_len; -+ param = (struct ieee_param *)rtw_malloc(param_len); -+ if (param == NULL) -+ return -1; -+ -+ _rtw_memset(param, 0, param_len); -+ -+ param->cmd = IEEE_CMD_SET_ENCRYPTION; -+ _rtw_memset(param->sta_addr, 0xff, ETH_ALEN); -+ -+ -+ switch (pext->alg) { -+ case IW_ENCODE_ALG_NONE: -+ //todo: remove key -+ //remove = 1; -+ alg_name = "none"; -+ break; -+ case IW_ENCODE_ALG_WEP: -+ alg_name = "WEP"; -+ break; -+ case IW_ENCODE_ALG_TKIP: -+ alg_name = "TKIP"; -+ break; -+ case IW_ENCODE_ALG_CCMP: -+ alg_name = "CCMP"; -+ break; -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef CONFIG_IOCTL_CFG80211 -+ case IW_ENCODE_ALG_SM4: -+ alg_name= "SMS4"; -+ _rtw_memcpy(param->sta_addr, pext->addr.sa_data, ETH_ALEN); -+ DBG_871X("rtw_wx_set_enc_ext: SMS4 case \n"); -+ break; -+#endif -+#endif -+ default: -+ return -1; -+ } -+ -+ strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN); -+ -+ if (pext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) -+ { -+ param->u.crypt.set_tx = 1; -+ } -+ -+ /* cliW: WEP does not have group key -+ * just not checking GROUP key setting -+ */ -+ if ((pext->alg != IW_ENCODE_ALG_WEP) && -+ (pext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)) -+ { -+ param->u.crypt.set_tx = 0; -+ } -+ -+ param->u.crypt.idx = (pencoding->flags&0x00FF) -1 ; -+ -+ if (pext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) -+ { -+#ifdef CONFIG_WAPI_SUPPORT -+#ifndef CONFIG_IOCTL_CFG80211 -+ if(pext->alg == IW_ENCODE_ALG_SM4) -+ _rtw_memcpy(param->u.crypt.seq, pext->rx_seq, 16); -+ else -+#endif -+#endif -+ _rtw_memcpy(param->u.crypt.seq, pext->rx_seq, 8); -+ } -+ -+ if(pext->key_len) -+ { -+ param->u.crypt.key_len = pext->key_len; -+ //_rtw_memcpy(param + 1, pext + 1, pext->key_len); -+ _rtw_memcpy(param->u.crypt.key, pext + 1, pext->key_len); -+ } -+ -+ if (pencoding->flags & IW_ENCODE_DISABLED) -+ { -+ //todo: remove key -+ //remove = 1; -+ } -+ -+ ret = wpa_set_encryption(dev, param, param_len); -+ -+ if(param) -+ { -+ rtw_mfree((u8*)param, param_len); -+ } -+ -+ return ret; -+} -+ -+ -+static int rtw_wx_get_nick(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ //struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ //struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ if(extra) -+ { -+ wrqu->data.length = 14; -+ wrqu->data.flags = 1; -+ _rtw_memcpy(extra, "", 14); -+ } -+ -+ //rtw_signal_process(pid, SIGUSR1); //for test -+ -+ //dump debug info here -+/* -+ u32 dot11AuthAlgrthm; // 802.11 auth, could be open, shared, and 8021x -+ u32 dot11PrivacyAlgrthm; // This specify the privacy for shared auth. algorithm. -+ u32 dot118021XGrpPrivacy; // This specify the privacy algthm. used for Grp key -+ u32 ndisauthtype; -+ u32 ndisencryptstatus; -+*/ -+ -+ //DBG_871X("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", -+ // psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, -+ // psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus); -+ -+ //DBG_871X("enc_alg=0x%x\n", psecuritypriv->dot11PrivacyAlgrthm); -+ //DBG_871X("auth_type=0x%x\n", psecuritypriv->ndisauthtype); -+ //DBG_871X("enc_type=0x%x\n", psecuritypriv->ndisencryptstatus); -+ -+#if 0 -+ DBG_871X("dbg(0x210)=0x%x\n", rtw_read32(padapter, 0x210)); -+ DBG_871X("dbg(0x608)=0x%x\n", rtw_read32(padapter, 0x608)); -+ DBG_871X("dbg(0x280)=0x%x\n", rtw_read32(padapter, 0x280)); -+ DBG_871X("dbg(0x284)=0x%x\n", rtw_read32(padapter, 0x284)); -+ DBG_871X("dbg(0x288)=0x%x\n", rtw_read32(padapter, 0x288)); -+ -+ DBG_871X("dbg(0x664)=0x%x\n", rtw_read32(padapter, 0x664)); -+ -+ -+ DBG_871X("\n"); -+ -+ DBG_871X("dbg(0x430)=0x%x\n", rtw_read32(padapter, 0x430)); -+ DBG_871X("dbg(0x438)=0x%x\n", rtw_read32(padapter, 0x438)); -+ -+ DBG_871X("dbg(0x440)=0x%x\n", rtw_read32(padapter, 0x440)); -+ -+ DBG_871X("dbg(0x458)=0x%x\n", rtw_read32(padapter, 0x458)); -+ -+ DBG_871X("dbg(0x484)=0x%x\n", rtw_read32(padapter, 0x484)); -+ DBG_871X("dbg(0x488)=0x%x\n", rtw_read32(padapter, 0x488)); -+ -+ DBG_871X("dbg(0x444)=0x%x\n", rtw_read32(padapter, 0x444)); -+ DBG_871X("dbg(0x448)=0x%x\n", rtw_read32(padapter, 0x448)); -+ DBG_871X("dbg(0x44c)=0x%x\n", rtw_read32(padapter, 0x44c)); -+ DBG_871X("dbg(0x450)=0x%x\n", rtw_read32(padapter, 0x450)); -+#endif -+ -+ return 0; -+ -+} -+ -+static int rtw_wx_read32(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter; -+ struct iw_point *p; -+ u16 len; -+ u32 addr; -+ u32 data32; -+ u32 bytes; -+ u8 *ptmp; -+ -+ -+ padapter = (PADAPTER)rtw_netdev_priv(dev); -+ p = &wrqu->data; -+ len = p->length; -+ ptmp = (u8*)rtw_malloc(len); -+ if (NULL == ptmp) -+ return -ENOMEM; -+ -+ if (copy_from_user(ptmp, p->pointer, len)) { -+ rtw_mfree(ptmp, len); -+ return -EFAULT; -+ } -+ -+ bytes = 0; -+ addr = 0; -+ sscanf(ptmp, "%d,%x", &bytes, &addr); -+ -+ switch (bytes) { -+ case 1: -+ data32 = rtw_read8(padapter, addr); -+ sprintf(extra, "0x%02X", data32); -+ break; -+ case 2: -+ data32 = rtw_read16(padapter, addr); -+ sprintf(extra, "0x%04X", data32); -+ break; -+ case 4: -+ data32 = rtw_read32(padapter, addr); -+ sprintf(extra, "0x%08X", data32); -+ break; -+ default: -+ DBG_871X(KERN_INFO "%s: usage> read [bytes],[address(hex)]\n", __func__); -+ return -EINVAL; -+ } -+ DBG_871X(KERN_INFO "%s: addr=0x%08X data=%s\n", __func__, addr, extra); -+ -+ rtw_mfree(ptmp, len); -+ -+ return 0; -+} -+ -+static int rtw_wx_write32(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev); -+ -+ u32 addr; -+ u32 data32; -+ u32 bytes; -+ -+ -+ bytes = 0; -+ addr = 0; -+ data32 = 0; -+ sscanf(extra, "%d,%x,%x", &bytes, &addr, &data32); -+ -+ switch (bytes) { -+ case 1: -+ rtw_write8(padapter, addr, (u8)data32); -+ DBG_871X(KERN_INFO "%s: addr=0x%08X data=0x%02X\n", __func__, addr, (u8)data32); -+ break; -+ case 2: -+ rtw_write16(padapter, addr, (u16)data32); -+ DBG_871X(KERN_INFO "%s: addr=0x%08X data=0x%04X\n", __func__, addr, (u16)data32); -+ break; -+ case 4: -+ rtw_write32(padapter, addr, data32); -+ DBG_871X(KERN_INFO "%s: addr=0x%08X data=0x%08X\n", __func__, addr, data32); -+ break; -+ default: -+ DBG_871X(KERN_INFO "%s: usage> write [bytes],[address(hex)],[data(hex)]\n", __func__); -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int rtw_wx_read_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u32 path, addr, data32; -+ -+ -+ path = *(u32*)extra; -+ addr = *((u32*)extra + 1); -+ data32 = rtw_hal_read_rfreg(padapter, path, addr, 0xFFFFF); -+// DBG_871X("%s: path=%d addr=0x%02x data=0x%05x\n", __func__, path, addr, data32); -+ /* -+ * IMPORTANT!! -+ * Only when wireless private ioctl is at odd order, -+ * "extra" would be copied to user space. -+ */ -+ sprintf(extra, "0x%05x", data32); -+ -+ return 0; -+} -+ -+static int rtw_wx_write_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u32 path, addr, data32; -+ -+ -+ path = *(u32*)extra; -+ addr = *((u32*)extra + 1); -+ data32 = *((u32*)extra + 2); -+// DBG_871X("%s: path=%d addr=0x%02x data=0x%05x\n", __func__, path, addr, data32); -+ rtw_hal_write_rfreg(padapter, path, addr, 0xFFFFF, data32); -+ -+ return 0; -+} -+ -+static int rtw_wx_priv_null(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ return -1; -+} -+ -+static int dummy(struct net_device *dev, struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ //_adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ //struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ //DBG_871X("cmd_code=%x, fwstate=0x%x\n", a->cmd, get_fwstate(pmlmepriv)); -+ -+ return -1; -+ -+} -+ -+static int rtw_wx_set_channel_plan(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct registry_priv *pregistrypriv = &padapter->registrypriv; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ extern int rtw_channel_plan; -+ u8 channel_plan_req = (u8) (*((int *)wrqu)); -+ -+ #if 0 -+ rtw_channel_plan = (int)wrqu->data.pointer; -+ pregistrypriv->channel_plan = rtw_channel_plan; -+ pmlmepriv->ChannelPlan = pregistrypriv->channel_plan; -+ #endif -+ -+ if( _SUCCESS == rtw_set_chplan_cmd(padapter, channel_plan_req, 1) ) { -+ DBG_871X("%s set channel_plan = 0x%02X\n", __func__, pmlmepriv->ChannelPlan); -+ } else -+ return -EPERM; -+ -+ return 0; -+} -+ -+static int rtw_wx_set_mtk_wps_probe_ie(struct net_device *dev, -+ struct iw_request_info *a, -+ union iwreq_data *wrqu, char *b) -+{ -+ return 0; -+} -+ -+static int rtw_wx_get_sensitivity(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *buf) -+{ -+ return 0; -+} -+ -+static int rtw_wx_set_mtk_wps_ie(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ return 0; -+} -+ -+/* -+typedef int (*iw_handler)(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra); -+*/ -+/* -+ * For all data larger than 16 octets, we need to use a -+ * pointer to memory allocated in user space. -+ */ -+static int rtw_drvext_hdl(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ #if 0 -+struct iw_point -+{ -+ void __user *pointer; /* Pointer to the data (in user space) */ -+ __u16 length; /* number of fields or size in bytes */ -+ __u16 flags; /* Optional params */ -+}; -+ #endif -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ u8 res; -+ struct drvext_handler *phandler; -+ struct drvext_oidparam *poidparam; -+ int ret; -+ u16 len; -+ u8 *pparmbuf, bset; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *p = &wrqu->data; -+ -+ if( (!p->length) || (!p->pointer)){ -+ ret = -EINVAL; -+ goto _rtw_drvext_hdl_exit; -+ } -+ -+ -+ bset = (u8)(p->flags&0xFFFF); -+ len = p->length; -+ pparmbuf = (u8*)rtw_malloc(len); -+ if (pparmbuf == NULL){ -+ ret = -ENOMEM; -+ goto _rtw_drvext_hdl_exit; -+ } -+ -+ if(bset)//set info -+ { -+ if (copy_from_user(pparmbuf, p->pointer,len)) { -+ rtw_mfree(pparmbuf, len); -+ ret = -EFAULT; -+ goto _rtw_drvext_hdl_exit; -+ } -+ } -+ else//query info -+ { -+ -+ } -+ -+ -+ // -+ poidparam = (struct drvext_oidparam *)pparmbuf; -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("drvext set oid subcode [%d], len[%d], InformationBufferLength[%d]\r\n", -+ poidparam->subcode, poidparam->len, len)); -+ -+ -+ //check subcode -+ if ( poidparam->subcode >= MAX_DRVEXT_HANDLERS) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("no matching drvext handlers\r\n")); -+ ret = -EINVAL; -+ goto _rtw_drvext_hdl_exit; -+ } -+ -+ -+ if ( poidparam->subcode >= MAX_DRVEXT_OID_SUBCODES) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("no matching drvext subcodes\r\n")); -+ ret = -EINVAL; -+ goto _rtw_drvext_hdl_exit; -+ } -+ -+ -+ phandler = drvextoidhandlers + poidparam->subcode; -+ -+ if (poidparam->len != phandler->parmsize) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_err_,("no matching drvext param size %d vs %d\r\n", -+ poidparam->len , phandler->parmsize)); -+ ret = -EINVAL; -+ goto _rtw_drvext_hdl_exit; -+ } -+ -+ -+ res = phandler->handler(&padapter->drvextpriv, bset, poidparam->data); -+ -+ if(res==0) -+ { -+ ret = 0; -+ -+ if (bset == 0x00) {//query info -+ //_rtw_memcpy(p->pointer, pparmbuf, len); -+ if (copy_to_user(p->pointer, pparmbuf, len)) -+ ret = -EFAULT; -+ } -+ } -+ else -+ ret = -EFAULT; -+ -+ -+_rtw_drvext_hdl_exit: -+ -+ return ret; -+ -+#endif -+ -+ return 0; -+ -+} -+ -+static void rtw_dbg_mode_hdl(_adapter *padapter, u32 id, u8 *pdata, u32 len) -+{ -+ pRW_Reg RegRWStruct; -+ struct rf_reg_param *prfreg; -+ u8 path; -+ u8 offset; -+ u32 value; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ switch(id) -+ { -+ case GEN_MP_IOCTL_SUBCODE(MP_START): -+ DBG_871X("871x_driver is only for normal mode, can't enter mp mode\n"); -+ break; -+ case GEN_MP_IOCTL_SUBCODE(READ_REG): -+ RegRWStruct = (pRW_Reg)pdata; -+ switch (RegRWStruct->width) -+ { -+ case 1: -+ RegRWStruct->value = rtw_read8(padapter, RegRWStruct->offset); -+ break; -+ case 2: -+ RegRWStruct->value = rtw_read16(padapter, RegRWStruct->offset); -+ break; -+ case 4: -+ RegRWStruct->value = rtw_read32(padapter, RegRWStruct->offset); -+ break; -+ default: -+ break; -+ } -+ -+ break; -+ case GEN_MP_IOCTL_SUBCODE(WRITE_REG): -+ RegRWStruct = (pRW_Reg)pdata; -+ switch (RegRWStruct->width) -+ { -+ case 1: -+ rtw_write8(padapter, RegRWStruct->offset, (u8)RegRWStruct->value); -+ break; -+ case 2: -+ rtw_write16(padapter, RegRWStruct->offset, (u16)RegRWStruct->value); -+ break; -+ case 4: -+ rtw_write32(padapter, RegRWStruct->offset, (u32)RegRWStruct->value); -+ break; -+ default: -+ break; -+ } -+ -+ break; -+ case GEN_MP_IOCTL_SUBCODE(READ_RF_REG): -+ -+ prfreg = (struct rf_reg_param *)pdata; -+ -+ path = (u8)prfreg->path; -+ offset = (u8)prfreg->offset; -+ -+ value = rtw_hal_read_rfreg(padapter, path, offset, 0xffffffff); -+ -+ prfreg->value = value; -+ -+ break; -+ case GEN_MP_IOCTL_SUBCODE(WRITE_RF_REG): -+ -+ prfreg = (struct rf_reg_param *)pdata; -+ -+ path = (u8)prfreg->path; -+ offset = (u8)prfreg->offset; -+ value = prfreg->value; -+ -+ rtw_hal_write_rfreg(padapter, path, offset, 0xffffffff, value); -+ -+ break; -+ case GEN_MP_IOCTL_SUBCODE(TRIGGER_GPIO): -+ DBG_871X("==> trigger gpio 0\n"); -+ rtw_hal_set_hwreg(padapter, HW_VAR_TRIGGER_GPIO_0, NULL); -+ break; -+#ifdef CONFIG_BT_COEXIST -+ case GEN_MP_IOCTL_SUBCODE(SET_DM_BT): -+ DBG_871X("==> set dm_bt_coexist:%x\n",*(u8 *)pdata); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BT_SET_COEXIST, pdata); -+ break; -+ case GEN_MP_IOCTL_SUBCODE(DEL_BA): -+ DBG_871X("==> delete ba:%x\n",*(u8 *)pdata); -+ rtw_hal_set_hwreg(padapter, HW_VAR_BT_ISSUE_DELBA, pdata); -+ break; -+#endif -+#ifdef DBG_CONFIG_ERROR_DETECT -+ case GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS): -+ *pdata = rtw_hal_sreset_get_wifi_status(padapter); -+ break; -+#endif -+ -+ default: -+ break; -+ } -+ -+} -+ -+static int rtw_mp_ioctl_hdl(struct net_device *dev, struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ u32 BytesRead, BytesWritten, BytesNeeded; -+ struct oid_par_priv oid_par; -+ struct mp_ioctl_handler *phandler; -+ struct mp_ioctl_param *poidparam; -+ uint status=0; -+ u16 len; -+ u8 *pparmbuf = NULL, bset; -+ PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev); -+ struct iw_point *p = &wrqu->data; -+ -+ //DBG_871X("+rtw_mp_ioctl_hdl\n"); -+ -+ //mutex_lock(&ioctl_mutex); -+ -+ if ((!p->length) || (!p->pointer)) { -+ ret = -EINVAL; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ -+ pparmbuf = NULL; -+ bset = (u8)(p->flags & 0xFFFF); -+ len = p->length; -+ pparmbuf = (u8*)rtw_malloc(len); -+ if (pparmbuf == NULL){ -+ ret = -ENOMEM; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ -+ if (copy_from_user(pparmbuf, p->pointer, len)) { -+ ret = -EFAULT; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ -+ poidparam = (struct mp_ioctl_param *)pparmbuf; -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_info_, -+ ("rtw_mp_ioctl_hdl: subcode [%d], len[%d], buffer_len[%d]\r\n", -+ poidparam->subcode, poidparam->len, len)); -+ -+ if (poidparam->subcode >= MAX_MP_IOCTL_SUBCODE) { -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_err_, ("no matching drvext subcodes\r\n")); -+ ret = -EINVAL; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ -+ //DBG_871X("%s: %d\n", __func__, poidparam->subcode); -+#ifdef CONFIG_MP_INCLUDED -+if (padapter->registrypriv.mp_mode == 1) -+{ -+ phandler = mp_ioctl_hdl + poidparam->subcode; -+ -+ if ((phandler->paramsize != 0) && (poidparam->len < phandler->paramsize)) -+ { -+ RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_err_, -+ ("no matching drvext param size %d vs %d\r\n", -+ poidparam->len, phandler->paramsize)); -+ ret = -EINVAL; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ -+ if (phandler->handler) -+ { -+ oid_par.adapter_context = padapter; -+ oid_par.oid = phandler->oid; -+ oid_par.information_buf = poidparam->data; -+ oid_par.information_buf_len = poidparam->len; -+ oid_par.dbg = 0; -+ -+ BytesWritten = 0; -+ BytesNeeded = 0; -+ -+ if (bset) { -+ oid_par.bytes_rw = &BytesRead; -+ oid_par.bytes_needed = &BytesNeeded; -+ oid_par.type_of_oid = SET_OID; -+ } else { -+ oid_par.bytes_rw = &BytesWritten; -+ oid_par.bytes_needed = &BytesNeeded; -+ oid_par.type_of_oid = QUERY_OID; -+ } -+ -+ status = phandler->handler(&oid_par); -+ -+ //todo:check status, BytesNeeded, etc. -+ } -+ else { -+ DBG_871X("rtw_mp_ioctl_hdl(): err!, subcode=%d, oid=%d, handler=%p\n", -+ poidparam->subcode, phandler->oid, phandler->handler); -+ ret = -EFAULT; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+} -+else -+#endif -+{ -+ rtw_dbg_mode_hdl(padapter, poidparam->subcode, poidparam->data, poidparam->len); -+} -+ -+ if (bset == 0x00) {//query info -+ if (copy_to_user(p->pointer, pparmbuf, len)) -+ ret = -EFAULT; -+ } -+ -+ if (status) { -+ ret = -EFAULT; -+ goto _rtw_mp_ioctl_hdl_exit; -+ } -+ -+_rtw_mp_ioctl_hdl_exit: -+ -+ if (pparmbuf) -+ rtw_mfree(pparmbuf, len); -+ -+ //mutex_unlock(&ioctl_mutex); -+ -+ return ret; -+} -+ -+static int rtw_get_ap_info(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int bssid_match, ret = 0; -+ u32 cnt=0, wpa_ielen; -+ _irqL irqL; -+ _list *plist, *phead; -+ unsigned char *pbuf; -+ u8 bssid[ETH_ALEN]; -+ char data[32]; -+ struct wlan_network *pnetwork = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct iw_point *pdata = &wrqu->data; -+ -+ DBG_871X("+rtw_get_aplist_info\n"); -+ -+ if((padapter->bDriverStopped) || (pdata==NULL)) -+ { -+ ret= -EINVAL; -+ goto exit; -+ } -+ -+ while((check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))) == true) -+ { -+ rtw_msleep_os(30); -+ cnt++; -+ if(cnt > 100) -+ break; -+ } -+ -+ -+ //pdata->length = 0;//? -+ pdata->flags = 0; -+ if(pdata->length>=32) -+ { -+ if(copy_from_user(data, pdata->pointer, 32)) -+ { -+ ret= -EINVAL; -+ goto exit; -+ } -+ } -+ else -+ { -+ ret= -EINVAL; -+ goto exit; -+ } -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while(1) -+ { -+ if (rtw_end_of_queue_search(phead,plist)== true) -+ break; -+ -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ //if(hwaddr_aton_i(pdata->pointer, bssid)) -+ if(hwaddr_aton_i(data, bssid)) -+ { -+ DBG_871X("Invalid BSSID '%s'.\n", (u8*)data); -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ return -EINVAL; -+ } -+ -+ -+ if(_rtw_memcmp(bssid, pnetwork->network.MacAddress, ETH_ALEN) == true)//BSSID match, then check if supporting wpa/wpa2 -+ { -+ DBG_871X("BSSID:" MAC_FMT "\n", MAC_ARG(bssid)); -+ -+ pbuf = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength-12); -+ if(pbuf && (wpa_ielen>0)) -+ { -+ pdata->flags = 1; -+ break; -+ } -+ -+ pbuf = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength-12); -+ if(pbuf && (wpa_ielen>0)) -+ { -+ pdata->flags = 2; -+ break; -+ } -+ -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if(pdata->length>=34) -+ { -+ if(copy_to_user((u8 __user *)pdata->pointer+32, (u8*)&pdata->flags, 1)) -+ { -+ ret= -EINVAL; -+ goto exit; -+ } -+ } -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_set_pid(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = rtw_netdev_priv(dev); -+ int *pdata = (int *)wrqu; -+ int selector; -+ -+ if((padapter->bDriverStopped) || (pdata==NULL)) -+ { -+ ret= -EINVAL; -+ goto exit; -+ } -+ -+ selector = *pdata; -+ if(selector < 3 && selector >=0) { -+ padapter->pid[selector] = *(pdata+1); -+ #ifdef CONFIG_GLOBAL_UI_PID -+ ui_pid[selector] = *(pdata+1); -+ #endif -+ DBG_871X("%s set pid[%d]=%d\n", __FUNCTION__, selector ,padapter->pid[selector]); -+ } -+ else -+ DBG_871X("%s selector %d error\n", __FUNCTION__, selector); -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_wps_start(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ u32 u32wps_start = 0; -+ unsigned int uintRet = 0; -+ -+ uintRet = copy_from_user( ( void* ) &u32wps_start, pdata->pointer, 4 ); -+ -+ if((padapter->bDriverStopped) || (pdata==NULL)) -+ { -+ ret= -EINVAL; -+ goto exit; -+ } -+ -+ if ( u32wps_start == 0 ) -+ { -+ u32wps_start = *extra; -+ } -+ -+ DBG_871X( "[%s] wps_start = %d\n", __FUNCTION__, u32wps_start ); -+ -+ if ( u32wps_start == 1 ) // WPS Start -+ { -+ rtw_led_control(padapter, LED_CTL_START_WPS); -+ } -+ else if ( u32wps_start == 2 ) // WPS Stop because of wps success -+ { -+ rtw_led_control(padapter, LED_CTL_STOP_WPS); -+ } -+ else if ( u32wps_start == 3 ) // WPS Stop because of wps fail -+ { -+ rtw_led_control(padapter, LED_CTL_STOP_WPS_FAIL); -+ } -+ -+#ifdef CONFIG_INTEL_WIDI -+ process_intel_widi_wps_status(padapter, u32wps_start); -+#endif //CONFIG_INTEL_WIDI -+ -+exit: -+ -+ return ret; -+ -+} -+ -+#ifdef CONFIG_P2P -+static int rtw_wext_p2p_enable(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ enum P2P_ROLE init_role = P2P_ROLE_DISABLE; -+ -+ if(*extra == '0' ) -+ init_role = P2P_ROLE_DISABLE; -+ else if(*extra == '1') -+ init_role = P2P_ROLE_DEVICE; -+ else if(*extra == '2') -+ init_role = P2P_ROLE_CLIENT; -+ else if(*extra == '3') -+ init_role = P2P_ROLE_GO; -+ -+ if(_FAIL == rtw_p2p_enable(padapter, init_role)) -+ { -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ //set channel/bandwidth -+ if(init_role != P2P_ROLE_DISABLE) -+ { -+ u8 channel, ch_offset; -+ u16 bwmode; -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN)) -+ { -+ // Stay at the listen state and wait for discovery. -+ channel = pwdinfo->listen_channel; -+ pwdinfo->operating_channel = pwdinfo->listen_channel; -+ ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; -+ bwmode = CHANNEL_WIDTH_20; -+ } -+#ifdef CONFIG_CONCURRENT_MODE -+ else if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) -+ { -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ //struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo; -+ struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+ -+ _set_timer( &pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_interval ); -+ if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) -+ { -+ pwdinfo->operating_channel = pbuddy_mlmeext->cur_channel; -+ // How about the ch_offset and bwmode ?? -+ } -+ else -+ { -+ pwdinfo->operating_channel = pwdinfo->listen_channel; -+ } -+ -+ channel = pbuddy_mlmeext->cur_channel; -+ ch_offset = pbuddy_mlmeext->cur_ch_offset; -+ bwmode = pbuddy_mlmeext->cur_bwmode; -+ } -+#endif -+ else -+ { -+ pwdinfo->operating_channel = pmlmeext->cur_channel; -+ -+ channel = pwdinfo->operating_channel; -+ ch_offset = pmlmeext->cur_ch_offset; -+ bwmode = pmlmeext->cur_bwmode; -+ } -+ -+ set_channel_bwmode(padapter, channel, ch_offset, bwmode); -+ } -+ -+exit: -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_go_nego_ssid(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ -+ DBG_871X( "[%s] ssid = %s, len = %zu\n", __FUNCTION__, extra, strlen( extra ) ); -+ _rtw_memcpy( pwdinfo->nego_ssid, extra, strlen( extra ) ); -+ pwdinfo->nego_ssidlen = strlen( extra ); -+ -+ return ret; -+ -+} -+ -+ -+static int rtw_p2p_set_intent(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ u8 intent = pwdinfo->intent; -+ -+ switch( wrqu->data.length ) -+ { -+ case 1: -+ { -+ intent = extra[ 0 ] - '0'; -+ break; -+ } -+ case 2: -+ { -+ intent = str_2char2num( extra[ 0 ], extra[ 1 ]); -+ break; -+ } -+ } -+ -+ if ( intent <= 15 ) -+ { -+ pwdinfo->intent= intent; -+ } -+ else -+ { -+ ret = -1; -+ } -+ -+ DBG_871X( "[%s] intent = %d\n", __FUNCTION__, intent); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_listen_ch(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ u8 listen_ch = pwdinfo->listen_channel; // Listen channel number -+ -+ switch( wrqu->data.length ) -+ { -+ case 1: -+ { -+ listen_ch = extra[ 0 ] - '0'; -+ break; -+ } -+ case 2: -+ { -+ listen_ch = str_2char2num( extra[ 0 ], extra[ 1 ]); -+ break; -+ } -+ } -+ -+ if ( ( listen_ch == 1 ) || ( listen_ch == 6 ) || ( listen_ch == 11 ) ) -+ { -+ pwdinfo->listen_channel = listen_ch; -+ set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+ else -+ { -+ ret = -1; -+ } -+ -+ DBG_871X( "[%s] listen_ch = %d\n", __FUNCTION__, pwdinfo->listen_channel ); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_op_ch(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+// Commented by Albert 20110524 -+// This function is used to set the operating channel if the driver will become the group owner -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ u8 op_ch = pwdinfo->operating_channel; // Operating channel number -+ -+ switch( wrqu->data.length ) -+ { -+ case 1: -+ { -+ op_ch = extra[ 0 ] - '0'; -+ break; -+ } -+ case 2: -+ { -+ op_ch = str_2char2num( extra[ 0 ], extra[ 1 ]); -+ break; -+ } -+ } -+ -+ if ( op_ch > 0 ) -+ { -+ pwdinfo->operating_channel = op_ch; -+ } -+ else -+ { -+ ret = -1; -+ } -+ -+ DBG_871X( "[%s] op_ch = %d\n", __FUNCTION__, pwdinfo->operating_channel ); -+ -+ return ret; -+ -+} -+ -+ -+static int rtw_p2p_profilefound(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ -+ // Comment by Albert 2010/10/13 -+ // Input data format: -+ // Ex: 0 -+ // Ex: 1XX:XX:XX:XX:XX:XXYYSSID -+ // 0 => Reflush the profile record list. -+ // 1 => Add the profile list -+ // XX:XX:XX:XX:XX:XX => peer's MAC Address ( ex: 00:E0:4C:00:00:01 ) -+ // YY => SSID Length -+ // SSID => SSID for persistence group -+ -+ DBG_871X( "[%s] In value = %s, len = %d \n", __FUNCTION__, extra, wrqu->data.length -1); -+ -+ -+ // The upper application should pass the SSID to driver by using this rtw_p2p_profilefound function. -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ if ( extra[ 0 ] == '0' ) -+ { -+ // Remove all the profile information of wifidirect_info structure. -+ _rtw_memset( &pwdinfo->profileinfo[ 0 ], 0x00, sizeof( struct profile_info ) * P2P_MAX_PERSISTENT_GROUP_NUM ); -+ pwdinfo->profileindex = 0; -+ } -+ else -+ { -+ if ( pwdinfo->profileindex >= P2P_MAX_PERSISTENT_GROUP_NUM ) -+ { -+ ret = -1; -+ } -+ else -+ { -+ int jj, kk; -+ -+ // Add this profile information into pwdinfo->profileinfo -+ // Ex: 1XX:XX:XX:XX:XX:XXYYSSID -+ for( jj = 0, kk = 1; jj < ETH_ALEN; jj++, kk += 3 ) -+ { -+ pwdinfo->profileinfo[ pwdinfo->profileindex ].peermac[ jj ] = key_2char2num(extra[ kk ], extra[ kk+ 1 ]); -+ } -+ -+ //pwdinfo->profileinfo[ pwdinfo->profileindex ].ssidlen = ( extra[18] - '0' ) * 10 + ( extra[ 19 ] - '0' ); -+ //_rtw_memcpy( pwdinfo->profileinfo[ pwdinfo->profileindex ].ssid, &extra[ 20 ], pwdinfo->profileinfo[ pwdinfo->profileindex ].ssidlen ); -+ pwdinfo->profileindex++; -+ } -+ } -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_setDN(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ -+ -+ DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); -+ _rtw_memset( pwdinfo->device_name, 0x00, WPS_MAX_DEVICE_NAME_LEN ); -+ _rtw_memcpy( pwdinfo->device_name, extra, wrqu->data.length - 1 ); -+ pwdinfo->device_name_len = wrqu->data.length - 1; -+ -+ return ret; -+ -+} -+ -+ -+static int rtw_p2p_get_status(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct wifidirect_info *pbuddy_wdinfo = &pbuddy_adapter->wdinfo; -+ struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif -+ -+ if ( padapter->bShowGetP2PState ) -+ { -+ DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), -+ pwdinfo->p2p_peer_interface_addr[ 0 ], pwdinfo->p2p_peer_interface_addr[ 1 ], pwdinfo->p2p_peer_interface_addr[ 2 ], -+ pwdinfo->p2p_peer_interface_addr[ 3 ], pwdinfo->p2p_peer_interface_addr[ 4 ], pwdinfo->p2p_peer_interface_addr[ 5 ]); -+ } -+ -+ // Commented by Albert 2010/10/12 -+ // Because of the output size limitation, I had removed the "Role" information. -+ // About the "Role" information, we will use the new private IOCTL to get the "Role" information. -+ sprintf( extra, "\n\nStatus=%.2d\n", rtw_p2p_state(pwdinfo) ); -+ wrqu->data.length = strlen( extra ); -+ -+ return ret; -+ -+} -+ -+// Commented by Albert 20110520 -+// This function will return the config method description -+// This config method description will show us which config method the remote P2P device is intented to use -+// by sending the provisioning discovery request frame. -+ -+static int rtw_p2p_get_req_cm(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+ sprintf( extra, "\n\nCM=%s\n", pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req ); -+ wrqu->data.length = strlen( extra ); -+ return ret; -+ -+} -+ -+ -+static int rtw_p2p_get_role(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+ -+ DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), -+ pwdinfo->p2p_peer_interface_addr[ 0 ], pwdinfo->p2p_peer_interface_addr[ 1 ], pwdinfo->p2p_peer_interface_addr[ 2 ], -+ pwdinfo->p2p_peer_interface_addr[ 3 ], pwdinfo->p2p_peer_interface_addr[ 4 ], pwdinfo->p2p_peer_interface_addr[ 5 ]); -+ -+ sprintf( extra, "\n\nRole=%.2d\n", rtw_p2p_role(pwdinfo) ); -+ wrqu->data.length = strlen( extra ); -+ return ret; -+ -+} -+ -+ -+static int rtw_p2p_get_peer_ifaddr(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+ -+ DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), -+ pwdinfo->p2p_peer_interface_addr[ 0 ], pwdinfo->p2p_peer_interface_addr[ 1 ], pwdinfo->p2p_peer_interface_addr[ 2 ], -+ pwdinfo->p2p_peer_interface_addr[ 3 ], pwdinfo->p2p_peer_interface_addr[ 4 ], pwdinfo->p2p_peer_interface_addr[ 5 ]); -+ -+ sprintf( extra, "\nMAC %.2X:%.2X:%.2X:%.2X:%.2X:%.2X", -+ pwdinfo->p2p_peer_interface_addr[ 0 ], pwdinfo->p2p_peer_interface_addr[ 1 ], pwdinfo->p2p_peer_interface_addr[ 2 ], -+ pwdinfo->p2p_peer_interface_addr[ 3 ], pwdinfo->p2p_peer_interface_addr[ 4 ], pwdinfo->p2p_peer_interface_addr[ 5 ]); -+ wrqu->data.length = strlen( extra ); -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_peer_devaddr(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+ -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+ DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), -+ pwdinfo->rx_prov_disc_info.peerDevAddr[ 0 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 1 ], -+ pwdinfo->rx_prov_disc_info.peerDevAddr[ 2 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 3 ], -+ pwdinfo->rx_prov_disc_info.peerDevAddr[ 4 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 5 ]); -+ sprintf( extra, "\n%.2X%.2X%.2X%.2X%.2X%.2X", -+ pwdinfo->rx_prov_disc_info.peerDevAddr[ 0 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 1 ], -+ pwdinfo->rx_prov_disc_info.peerDevAddr[ 2 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 3 ], -+ pwdinfo->rx_prov_disc_info.peerDevAddr[ 4 ], pwdinfo->rx_prov_disc_info.peerDevAddr[ 5 ]); -+ wrqu->data.length = strlen( extra ); -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_peer_devaddr_by_invitation(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+ -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+ DBG_871X( "[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), -+ pwdinfo->p2p_peer_device_addr[ 0 ], pwdinfo->p2p_peer_device_addr[ 1 ], -+ pwdinfo->p2p_peer_device_addr[ 2 ], pwdinfo->p2p_peer_device_addr[ 3 ], -+ pwdinfo->p2p_peer_device_addr[ 4 ], pwdinfo->p2p_peer_device_addr[ 5 ]); -+ sprintf( extra, "\nMAC %.2X:%.2X:%.2X:%.2X:%.2X:%.2X", -+ pwdinfo->p2p_peer_device_addr[ 0 ], pwdinfo->p2p_peer_device_addr[ 1 ], -+ pwdinfo->p2p_peer_device_addr[ 2 ], pwdinfo->p2p_peer_device_addr[ 3 ], -+ pwdinfo->p2p_peer_device_addr[ 4 ], pwdinfo->p2p_peer_device_addr[ 5 ]); -+ wrqu->data.length = strlen( extra ); -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_groupid(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+ -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+ sprintf( extra, "\n%.2X:%.2X:%.2X:%.2X:%.2X:%.2X %s", -+ pwdinfo->groupid_info.go_device_addr[ 0 ], pwdinfo->groupid_info.go_device_addr[ 1 ], -+ pwdinfo->groupid_info.go_device_addr[ 2 ], pwdinfo->groupid_info.go_device_addr[ 3 ], -+ pwdinfo->groupid_info.go_device_addr[ 4 ], pwdinfo->groupid_info.go_device_addr[ 5 ], -+ pwdinfo->groupid_info.ssid); -+ wrqu->data.length = strlen( extra ); -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_op_ch(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+ -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+ -+ DBG_871X( "[%s] Op_ch = %02x\n", __FUNCTION__, pwdinfo->operating_channel); -+ -+ sprintf( extra, "\n\nOp_ch=%.2d\n", pwdinfo->operating_channel ); -+ wrqu->data.length = strlen( extra ); -+ return ret; -+ -+} -+ -+inline static void macstr2num(u8 *dst, u8 *src) -+{ -+ int jj, kk; -+ for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3) -+ { -+ dst[jj] = key_2char2num(src[kk], src[kk + 1]); -+ } -+} -+ -+static int rtw_p2p_get_wps_configmethod(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list * plist,*phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 blnMatch = 0; -+ u16 attr_content = 0; -+ __be16 be_tmp; -+ uint attr_contentlen = 0; -+ u8 attr_content_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; -+ -+ // Commented by Albert 20110727 -+ // The input data is the MAC address which the application wants to know its WPS config method. -+ // After knowing its WPS config method, the application can decide the config method for provisioning discovery. -+ // Format: iwpriv wlanx p2p_get_wpsCM 00:E0:4C:00:00:05 -+ -+ DBG_871X("[%s] data = %s\n", __FUNCTION__, subcmd); -+ -+ macstr2num(peerMAC, subcmd); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) -+ { -+ if (rtw_end_of_queue_search(phead, plist) == true) break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) -+ { -+ u8 *wpsie; -+ uint wpsie_len = 0; -+ -+ // The mac address is matched. -+ -+ if ((wpsie = rtw_get_wps_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &wpsie_len))) -+ { -+ rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_CONF_METHOD, (u8 *)&be_tmp, &attr_contentlen); -+ if (attr_contentlen) -+ { -+ attr_content = be16_to_cpu(be_tmp); -+ sprintf(attr_content_str, "\n\nM=%.4d", attr_content); -+ blnMatch = 1; -+ } -+ } -+ -+ break; -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (!blnMatch) -+ { -+ sprintf(attr_content_str, "\n\nM=0000"); -+ } -+ -+ wrqu->data.length = strlen(attr_content_str); -+ _rtw_memcpy(extra, attr_content_str, wrqu->data.length); -+ -+ return ret; -+ -+} -+ -+#ifdef CONFIG_WFD -+static int rtw_p2p_get_peer_wfd_port(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+ DBG_871X( "[%s] p2p_state = %d\n", __FUNCTION__, rtw_p2p_state(pwdinfo) ); -+ -+ sprintf( extra, "\n\nPort=%d\n", pwdinfo->wfd_info->peer_rtsp_ctrlport ); -+ DBG_871X( "[%s] remote port = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_rtsp_ctrlport ); -+ -+ wrqu->data.length = strlen( extra ); -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_peer_wfd_preferred_connection(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+ sprintf( extra, "\n\nwfd_pc=%d\n", pwdinfo->wfd_info->wfd_pc ); -+ DBG_871X( "[%s] wfd_pc = %d\n", __FUNCTION__, pwdinfo->wfd_info->wfd_pc ); -+ -+ wrqu->data.length = strlen( extra ); -+ pwdinfo->wfd_info->wfd_pc = false; // Reset the WFD preferred connection to P2P -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_peer_wfd_session_available(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+ sprintf( extra, "\n\nwfd_sa=%d\n", pwdinfo->wfd_info->peer_session_avail ); -+ DBG_871X( "[%s] wfd_sa = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_session_avail ); -+ -+ wrqu->data.length = strlen( extra ); -+ pwdinfo->wfd_info->peer_session_avail = true; // Reset the WFD session available -+ return ret; -+ -+} -+ -+#endif // CONFIG_WFD -+ -+static int rtw_p2p_get_go_device_address(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 blnMatch = 0; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 0; -+ u8 attr_content[100] = { 0x00 }; -+ u8 go_devadd_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; -+ -+ // Commented by Albert 20121209 -+ // The input data is the GO's interface address which the application wants to know its device address. -+ // Format: iwpriv wlanx p2p_get2 go_devadd=00:E0:4C:00:00:05 -+ -+ DBG_871X("[%s] data = %s\n", __FUNCTION__, subcmd); -+ -+ macstr2num(peerMAC, subcmd); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) -+ { -+ if (rtw_end_of_queue_search(phead, plist) == true) break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) -+ { -+ // Commented by Albert 2011/05/18 -+ // Match the device address located in the P2P IE -+ // This is for the case that the P2P device address is not the same as the P2P interface address. -+ -+ if ((p2pie = rtw_get_p2p_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen))) -+ { -+ while (p2pie) -+ { -+ // The P2P Device ID attribute is included in the Beacon frame. -+ // The P2P Device Info attribute is included in the probe response frame. -+ -+ _rtw_memset(attr_content, 0x00, 100); -+ if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) -+ { -+ // Handle the P2P Device ID attribute of Beacon first -+ blnMatch = 1; -+ break; -+ -+ } else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) -+ { -+ // Handle the P2P Device Info attribute of probe response -+ blnMatch = 1; -+ break; -+ } -+ -+ //Get the next P2P IE -+ p2pie = rtw_get_p2p_ie(p2pie + p2pielen, pnetwork->network.IELength - 12 - (p2pie - &pnetwork->network.IEs[12] + p2pielen), NULL, &p2pielen); -+ } -+ } -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (!blnMatch) -+ { -+ sprintf(go_devadd_str, "\n\ndev_add=NULL"); -+ } else -+ { -+ sprintf(go_devadd_str, "\n\ndev_add=%.2X:%.2X:%.2X:%.2X:%.2X:%.2X", -+ attr_content[0], attr_content[1], attr_content[2], attr_content[3], attr_content[4], attr_content[5]); -+ } -+ -+ wrqu->data.length = strlen(go_devadd_str); -+ _rtw_memcpy(extra, go_devadd_str, wrqu->data.length); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_device_type(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 blnMatch = 0; -+ u8 dev_type[8] = { 0x00 }; -+ uint dev_type_len = 0; -+ u8 dev_type_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; // +9 is for the str "dev_type=", we have to clear it at wrqu->data.pointer -+ -+ // Commented by Albert 20121209 -+ // The input data is the MAC address which the application wants to know its device type. -+ // Such user interface could know the device type. -+ // Format: iwpriv wlanx p2p_get2 dev_type=00:E0:4C:00:00:05 -+ -+ DBG_871X("[%s] data = %s\n", __FUNCTION__, subcmd); -+ -+ macstr2num(peerMAC, subcmd); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) -+ { -+ if (rtw_end_of_queue_search(phead, plist) == true) break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) -+ { -+ u8 *wpsie; -+ uint wpsie_len = 0; -+ -+ // The mac address is matched. -+ -+ if ((wpsie = rtw_get_wps_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &wpsie_len))) -+ { -+ rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_PRIMARY_DEV_TYPE, dev_type, &dev_type_len); -+ if (dev_type_len) -+ { -+ u16 type; -+ __be16 be_tmp; -+ -+ _rtw_memcpy(&be_tmp, dev_type, 2); -+ type = be16_to_cpu(be_tmp); -+ sprintf(dev_type_str, "\n\nN=%.2d", type); -+ blnMatch = 1; -+ } -+ } -+ break; -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (!blnMatch) -+ { -+ sprintf(dev_type_str, "\n\nN=00"); -+ } -+ -+ wrqu->data.length = strlen(dev_type_str); -+ _rtw_memcpy(extra, dev_type_str, wrqu->data.length); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_device_name(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 blnMatch = 0; -+ u8 dev_name[WPS_MAX_DEVICE_NAME_LEN] = { 0x00 }; -+ uint dev_len = 0; -+ u8 dev_name_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; -+ -+ // Commented by Albert 20121225 -+ // The input data is the MAC address which the application wants to know its device name. -+ // Such user interface could show peer device's device name instead of ssid. -+ // Format: iwpriv wlanx p2p_get2 devN=00:E0:4C:00:00:05 -+ -+ DBG_871X("[%s] data = %s\n", __FUNCTION__, subcmd); -+ -+ macstr2num(peerMAC, subcmd); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) -+ { -+ if (rtw_end_of_queue_search(phead, plist) == true) break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) -+ { -+ u8 *wpsie; -+ uint wpsie_len = 0; -+ -+ // The mac address is matched. -+ -+ if ((wpsie = rtw_get_wps_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &wpsie_len))) -+ { -+ rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_DEVICE_NAME, dev_name, &dev_len); -+ if (dev_len) -+ { -+ sprintf(dev_name_str, "\n\nN=%s", dev_name); -+ blnMatch = 1; -+ } -+ } -+ break; -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (!blnMatch) -+ { -+ sprintf(dev_name_str, "\n\nN=0000"); -+ } -+ -+ wrqu->data.length = strlen(dev_name_str); -+ _rtw_memcpy(extra, dev_name_str, wrqu->data.length); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get_invitation_procedure(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra, char *subcmd) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 peerMAC[ETH_ALEN] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 blnMatch = 0; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 0; -+ u8 attr_content[2] = { 0x00 }; -+ u8 inv_proc_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; -+ -+ // Commented by Ouden 20121226 -+ // The application wants to know P2P initation procedure is support or not. -+ // Format: iwpriv wlanx p2p_get2 InvProc=00:E0:4C:00:00:05 -+ -+ DBG_871X("[%s] data = %s\n", __FUNCTION__, subcmd); -+ -+ macstr2num(peerMAC, subcmd); -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while (1) -+ { -+ if (rtw_end_of_queue_search(phead, plist) == true) break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) -+ { -+ // Commented by Albert 20121226 -+ // Match the device address located in the P2P IE -+ // This is for the case that the P2P device address is not the same as the P2P interface address. -+ -+ if ((p2pie = rtw_get_p2p_ie(&pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen))) -+ { -+ while (p2pie) -+ { -+ //_rtw_memset( attr_content, 0x00, 2); -+ if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_CAPABILITY, attr_content, &attr_contentlen)) -+ { -+ // Handle the P2P capability attribute -+ blnMatch = 1; -+ break; -+ -+ } -+ -+ //Get the next P2P IE -+ p2pie = rtw_get_p2p_ie(p2pie + p2pielen, pnetwork->network.IELength - 12 - (p2pie - &pnetwork->network.IEs[12] + p2pielen), NULL, &p2pielen); -+ } -+ } -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if (!blnMatch) -+ { -+ sprintf(inv_proc_str, "\nIP=-1"); -+ } else -+ { -+ if (attr_content[0] && 0x20) -+ { -+ sprintf(inv_proc_str, "\nIP=1"); -+ } else -+ { -+ sprintf(inv_proc_str, "\nIP=0"); -+ } -+ } -+ -+ wrqu->data.length = strlen(inv_proc_str); -+ _rtw_memcpy(extra, inv_proc_str, wrqu->data.length); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_connect(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ u8 peerMAC[ ETH_ALEN ] = { 0x00 }; -+ int jj,kk; -+ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _irqL irqL; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ uint uintPeerChannel = 0; -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif // CONFIG_CONCURRENT_MODE -+ -+ // Commented by Albert 20110304 -+ // The input data contains two informations. -+ // 1. First information is the MAC address which wants to formate with -+ // 2. Second information is the WPS PINCode or "pbc" string for push button method -+ // Format: 00:E0:4C:00:00:05 -+ // Format: 00:E0:4C:00:00:05 -+ -+ DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra ); -+ -+ if ( pwdinfo->p2p_state == P2P_STATE_NONE ) -+ { -+ DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ ); -+ return ret; -+ } -+ -+ if ( pwdinfo->ui_got_wps_info == P2P_NO_WPSINFO ) -+ { -+ return -1; -+ } -+ -+ for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 ) -+ { -+ peerMAC[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] ); -+ } -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while(1) -+ { -+ if (rtw_end_of_queue_search(phead,plist)== true) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ if ( _rtw_memcmp( pnetwork->network.MacAddress, peerMAC, ETH_ALEN ) ) -+ { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if ( uintPeerChannel ) -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) -+ { -+ _cancel_timer_ex( &pwdinfo->ap_p2p_switch_timer ); -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ -+ _rtw_memset( &pwdinfo->nego_req_info, 0x00, sizeof( struct tx_nego_req_info ) ); -+ _rtw_memset( &pwdinfo->groupid_info, 0x00, sizeof( struct group_id_info ) ); -+ -+ pwdinfo->nego_req_info.peer_channel_num[ 0 ] = uintPeerChannel; -+ _rtw_memcpy( pwdinfo->nego_req_info.peerDevAddr, pnetwork->network.MacAddress, ETH_ALEN ); -+ pwdinfo->nego_req_info.benable = true; -+ -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ if ( rtw_p2p_state(pwdinfo) != P2P_STATE_GONEGO_OK ) -+ { -+ // Restore to the listen state if the current p2p state is not nego OK -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN ); -+ } -+ -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_ING); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) -+ { -+ // Have to enter the power saving with the AP -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ -+ issue_nulldata(pbuddy_adapter, NULL, 1, 3, 500); -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ -+ DBG_871X( "[%s] Start PreTx Procedure!\n", __FUNCTION__ ); -+ _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) -+ { -+ _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_GO_NEGO_TIMEOUT ); -+ } -+ else -+ { -+ _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_GO_NEGO_TIMEOUT ); -+ } -+#else -+ _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_GO_NEGO_TIMEOUT ); -+#endif // CONFIG_CONCURRENT_MODE -+ -+ } -+ else -+ { -+ DBG_871X( "[%s] Not Found in Scanning Queue~\n", __FUNCTION__ ); -+ ret = -1; -+ } -+exit: -+ return ret; -+} -+ -+static int rtw_p2p_invite_req(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ int jj,kk; -+ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ uint uintPeerChannel = 0; -+ u8 attr_content[50] = { 0x00 }, _status = 0; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 0; -+ _irqL irqL; -+ struct tx_invite_req_info* pinvite_req_info = &pwdinfo->invitereq_info; -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif // CONFIG_CONCURRENT_MODE -+ -+#ifdef CONFIG_WFD -+ struct wifi_display_info* pwfd_info = pwdinfo->wfd_info; -+#endif // CONFIG_WFD -+ -+ // Commented by Albert 20120321 -+ // The input data contains two informations. -+ // 1. First information is the P2P device address which you want to send to. -+ // 2. Second information is the group id which combines with GO's mac address, space and GO's ssid. -+ // Command line sample: iwpriv wlan0 p2p_set invite="00:11:22:33:44:55 00:E0:4C:00:00:05 DIRECT-xy" -+ // Format: 00:11:22:33:44:55 00:E0:4C:00:00:05 DIRECT-xy -+ -+ DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra ); -+ -+ if ( wrqu->data.length <= 37 ) -+ { -+ DBG_871X( "[%s] Wrong format!\n", __FUNCTION__ ); -+ return ret; -+ } -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ ); -+ return ret; -+ } -+ else -+ { -+ // Reset the content of struct tx_invite_req_info -+ pinvite_req_info->benable = false; -+ _rtw_memset( pinvite_req_info->go_bssid, 0x00, ETH_ALEN ); -+ _rtw_memset( pinvite_req_info->go_ssid, 0x00, WLAN_SSID_MAXLEN ); -+ pinvite_req_info->ssidlen = 0x00; -+ pinvite_req_info->operating_ch = pwdinfo->operating_channel; -+ _rtw_memset( pinvite_req_info->peer_macaddr, 0x00, ETH_ALEN ); -+ pinvite_req_info->token = 3; -+ } -+ -+ for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 ) -+ { -+ pinvite_req_info->peer_macaddr[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] ); -+ } -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while(1) -+ { -+ if (rtw_end_of_queue_search(phead,plist)== true) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ // Commented by Albert 2011/05/18 -+ // Match the device address located in the P2P IE -+ // This is for the case that the P2P device address is not the same as the P2P interface address. -+ -+ if ( (p2pie=rtw_get_p2p_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen)) ) -+ { -+ // The P2P Device ID attribute is included in the Beacon frame. -+ // The P2P Device Info attribute is included in the probe response frame. -+ -+ if ( rtw_get_p2p_attr_content( p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen) ) -+ { -+ // Handle the P2P Device ID attribute of Beacon first -+ if ( _rtw_memcmp( attr_content, pinvite_req_info->peer_macaddr, ETH_ALEN ) ) -+ { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } -+ else if ( rtw_get_p2p_attr_content( p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen) ) -+ { -+ // Handle the P2P Device Info attribute of probe response -+ if ( _rtw_memcmp( attr_content, pinvite_req_info->peer_macaddr, ETH_ALEN ) ) -+ { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } -+ -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+#ifdef CONFIG_WFD -+ if ( uintPeerChannel ) -+ { -+ u8 wfd_ie[ 128 ] = { 0x00 }; -+ uint wfd_ielen = 0; -+ -+ if ( rtw_get_wfd_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, wfd_ie, &wfd_ielen ) ) -+ { -+ u8 wfd_devinfo[ 6 ] = { 0x00 }; -+ uint wfd_devlen = 6; -+ -+ DBG_871X( "[%s] Found WFD IE!\n", __FUNCTION__ ); -+ if ( rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, wfd_devinfo, &wfd_devlen ) ) -+ { -+ u16 wfd_devinfo_field = 0; -+ -+ // Commented by Albert 20120319 -+ // The first two bytes are the WFD device information field of WFD device information subelement. -+ // In big endian format. -+ wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo); -+ if ( wfd_devinfo_field & WFD_DEVINFO_SESSION_AVAIL ) -+ { -+ pwfd_info->peer_session_avail = true; -+ } -+ else -+ { -+ pwfd_info->peer_session_avail = false; -+ } -+ } -+ } -+ -+ if ( false == pwfd_info->peer_session_avail ) -+ { -+ DBG_871X( "[%s] WFD Session not avaiable!\n", __FUNCTION__ ); -+ goto exit; -+ } -+ } -+#endif // CONFIG_WFD -+ -+ if ( uintPeerChannel ) -+ { -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) -+ { -+ _cancel_timer_ex( &pwdinfo->ap_p2p_switch_timer ); -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ -+ // Store the GO's bssid -+ for( jj = 0, kk = 18; jj < ETH_ALEN; jj++, kk += 3 ) -+ { -+ pinvite_req_info->go_bssid[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] ); -+ } -+ -+ // Store the GO's ssid -+ pinvite_req_info->ssidlen = wrqu->data.length - 36; -+ _rtw_memcpy( pinvite_req_info->go_ssid, &extra[ 36 ], (u32) pinvite_req_info->ssidlen ); -+ pinvite_req_info->benable = true; -+ pinvite_req_info->peer_ch = uintPeerChannel; -+ -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_INVITE_REQ); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) -+ { -+ // Have to enter the power saving with the AP -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ -+ issue_nulldata(pbuddy_adapter, NULL, 1, 3, 500); -+ } -+ else -+ { -+ set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+#else -+ set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+#endif -+ -+ _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) -+ { -+ _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_INVITE_TIMEOUT ); -+ } -+ else -+ { -+ _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_INVITE_TIMEOUT ); -+ } -+#else -+ _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_INVITE_TIMEOUT ); -+#endif // CONFIG_CONCURRENT_MODE -+ -+ -+ } -+ else -+ { -+ DBG_871X( "[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__ ); -+ } -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_persistent(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ int jj,kk; -+ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ uint uintPeerChannel = 0; -+ u8 attr_content[50] = { 0x00 }, _status = 0; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 0; -+ _irqL irqL; -+ struct tx_invite_req_info* pinvite_req_info = &pwdinfo->invitereq_info; -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif // CONFIG_CONCURRENT_MODE -+ -+#ifdef CONFIG_WFD -+ struct wifi_display_info* pwfd_info = pwdinfo->wfd_info; -+#endif // CONFIG_WFD -+ -+ // Commented by Albert 20120328 -+ // The input data is 0 or 1 -+ // 0: disable persistent group functionality -+ // 1: enable persistent group founctionality -+ -+ DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra ); -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ ); -+ return ret; -+ } -+ else -+ { -+ if ( extra[ 0 ] == '0' ) // Disable the persistent group function. -+ { -+ pwdinfo->persistent_supported = false; -+ } -+ else if ( extra[ 0 ] == '1' ) // Enable the persistent group function. -+ { -+ pwdinfo->persistent_supported = true; -+ } -+ else -+ { -+ pwdinfo->persistent_supported = false; -+ } -+ } -+ printk( "[%s] persistent_supported = %d\n", __FUNCTION__, pwdinfo->persistent_supported ); -+ -+exit: -+ -+ return ret; -+ -+} -+ -+#ifdef CONFIG_WFD -+static int rtw_p2p_set_pc(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ u8 peerMAC[ ETH_ALEN ] = { 0x00 }; -+ int jj,kk; -+ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ u8 attr_content[50] = { 0x00 }, _status = 0; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 0; -+ _irqL irqL; -+ uint uintPeerChannel = 0; -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif // CONFIG_CONCURRENT_MODE -+ -+ struct wifi_display_info* pwfd_info = pwdinfo->wfd_info; -+ -+ // Commented by Albert 20120512 -+ // 1. Input information is the MAC address which wants to know the Preferred Connection bit (PC bit) -+ // Format: 00:E0:4C:00:00:05 -+ -+ DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra ); -+ -+ if(rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ ); -+ return ret; -+ } -+ -+ for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 ) -+ { -+ peerMAC[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] ); -+ } -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while(1) -+ { -+ if (rtw_end_of_queue_search(phead,plist)== true) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ // Commented by Albert 2011/05/18 -+ // Match the device address located in the P2P IE -+ // This is for the case that the P2P device address is not the same as the P2P interface address. -+ -+ if ( (p2pie=rtw_get_p2p_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, NULL, &p2pielen)) ) -+ { -+ // The P2P Device ID attribute is included in the Beacon frame. -+ // The P2P Device Info attribute is included in the probe response frame. -+ printk( "[%s] Got P2P IE\n", __FUNCTION__ ); -+ if ( rtw_get_p2p_attr_content( p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen) ) -+ { -+ // Handle the P2P Device ID attribute of Beacon first -+ printk( "[%s] P2P_ATTR_DEVICE_ID \n", __FUNCTION__ ); -+ if ( _rtw_memcmp( attr_content, peerMAC, ETH_ALEN ) ) -+ { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } -+ else if ( rtw_get_p2p_attr_content( p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen) ) -+ { -+ // Handle the P2P Device Info attribute of probe response -+ printk( "[%s] P2P_ATTR_DEVICE_INFO \n", __FUNCTION__ ); -+ if ( _rtw_memcmp( attr_content, peerMAC, ETH_ALEN ) ) -+ { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } -+ -+ } -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ printk( "[%s] channel = %d\n", __FUNCTION__, uintPeerChannel ); -+ -+ if ( uintPeerChannel ) -+ { -+ u8 wfd_ie[ 128 ] = { 0x00 }; -+ uint wfd_ielen = 0; -+ -+ if ( rtw_get_wfd_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, wfd_ie, &wfd_ielen ) ) -+ { -+ u8 wfd_devinfo[ 6 ] = { 0x00 }; -+ uint wfd_devlen = 6; -+ -+ DBG_871X( "[%s] Found WFD IE!\n", __FUNCTION__ ); -+ if ( rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, wfd_devinfo, &wfd_devlen ) ) -+ { -+ u16 wfd_devinfo_field = 0; -+ -+ // Commented by Albert 20120319 -+ // The first two bytes are the WFD device information field of WFD device information subelement. -+ // In big endian format. -+ wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo); -+ if ( wfd_devinfo_field & WFD_DEVINFO_PC_TDLS ) -+ { -+ pwfd_info->wfd_pc = true; -+ } -+ else -+ { -+ pwfd_info->wfd_pc = false; -+ } -+ } -+ } -+ } -+ else -+ { -+ DBG_871X( "[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__ ); -+ } -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_wfd_device_type(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; -+ -+ // Commented by Albert 20120328 -+ // The input data is 0 or 1 -+ // 0: specify to Miracast source device -+ // 1 or others: specify to Miracast sink device (display device) -+ -+ DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra ); -+ -+ if ( extra[ 0 ] == '0' ) // Set to Miracast source device. -+ { -+ pwfd_info->wfd_device_type = WFD_DEVINFO_SOURCE; -+ } -+ else // Set to Miracast sink device. -+ { -+ pwfd_info->wfd_device_type = WFD_DEVINFO_PSINK; -+ } -+ -+exit: -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_wfd_enable(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+// Commented by Kurt 20121206 -+// This function is used to set wfd enabled -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ -+ if(*extra == '0' ) -+ pwdinfo->wfd_info->wfd_enable = false; -+ else if(*extra == '1') -+ pwdinfo->wfd_info->wfd_enable = true; -+ -+ DBG_871X( "[%s] wfd_enable = %d\n", __FUNCTION__, pwdinfo->wfd_info->wfd_enable ); -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_set_driver_iface(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+// Commented by Kurt 20121206 -+// This function is used to set driver iface is WEXT or CFG80211 -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ -+ if(*extra == '1' ) -+ { -+ pwdinfo->driver_interface = DRIVER_WEXT; -+ DBG_871X( "[%s] driver_interface = WEXT\n", __FUNCTION__); -+ } -+ else if(*extra == '2') -+ { -+ pwdinfo->driver_interface = DRIVER_CFG80211; -+ DBG_871X( "[%s] driver_interface = CFG80211\n", __FUNCTION__); -+ } -+ -+ return ret; -+ -+} -+ -+// To set the WFD session available to enable or disable -+static int rtw_p2p_set_sa(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; -+ -+ DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra ); -+ -+ if( 0 ) -+ { -+ DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ ); -+ return ret; -+ } -+ else -+ { -+ if ( extra[ 0 ] == '0' ) // Disable the session available. -+ { -+ pwdinfo->session_available = false; -+ } -+ else if ( extra[ 0 ] == '1' ) // Enable the session available. -+ { -+ pwdinfo->session_available = true; -+ } -+ else -+ { -+ pwdinfo->session_available = false; -+ } -+ } -+ printk( "[%s] session available = %d\n", __FUNCTION__, pwdinfo->session_available ); -+ -+exit: -+ -+ return ret; -+ -+} -+#endif // CONFIG_WFD -+ -+static int rtw_p2p_prov_disc(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ u8 peerMAC[ ETH_ALEN ] = { 0x00 }; -+ int jj,kk; -+ u8 peerMACStr[ ETH_ALEN * 2 ] = { 0x00 }; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ _list *plist, *phead; -+ _queue *queue = &(pmlmepriv->scanned_queue); -+ struct wlan_network *pnetwork = NULL; -+ uint uintPeerChannel = 0; -+ u8 attr_content[100] = { 0x00 }, _status = 0; -+ u8 *p2pie; -+ uint p2pielen = 0, attr_contentlen = 0; -+ _irqL irqL; -+ u8 ie_offset; -+#ifdef CONFIG_CONCURRENT_MODE -+ _adapter *pbuddy_adapter = padapter->pbuddy_adapter; -+ struct mlme_priv *pbuddy_mlmepriv = &pbuddy_adapter->mlmepriv; -+ struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv; -+#endif // CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_WFD -+ struct wifi_display_info* pwfd_info = pwdinfo->wfd_info; -+#endif // CONFIG_WFD -+ -+ // Commented by Albert 20110301 -+ // The input data contains two informations. -+ // 1. First information is the MAC address which wants to issue the provisioning discovery request frame. -+ // 2. Second information is the WPS configuration method which wants to discovery -+ // Format: 00:E0:4C:00:00:05_display -+ // Format: 00:E0:4C:00:00:05_keypad -+ // Format: 00:E0:4C:00:00:05_pbc -+ // Format: 00:E0:4C:00:00:05_label -+ -+ DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra ); -+ -+ if ( pwdinfo->p2p_state == P2P_STATE_NONE ) -+ { -+ DBG_871X( "[%s] WiFi Direct is disable!\n", __FUNCTION__ ); -+ return ret; -+ } -+ else -+ { -+#ifdef CONFIG_INTEL_WIDI -+ if(check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true){ -+ DBG_871X( "[%s] WiFi is under survey!\n", __FUNCTION__ ); -+ return ret; -+ } -+#endif //CONFIG_INTEL_WIDI -+ -+ // Reset the content of struct tx_provdisc_req_info excluded the wps_config_method_request. -+ _rtw_memset( pwdinfo->tx_prov_disc_info.peerDevAddr, 0x00, ETH_ALEN ); -+ _rtw_memset( pwdinfo->tx_prov_disc_info.peerIFAddr, 0x00, ETH_ALEN ); -+ _rtw_memset( &pwdinfo->tx_prov_disc_info.ssid, 0x00, sizeof( NDIS_802_11_SSID ) ); -+ pwdinfo->tx_prov_disc_info.peer_channel_num[ 0 ] = 0; -+ pwdinfo->tx_prov_disc_info.peer_channel_num[ 1 ] = 0; -+ pwdinfo->tx_prov_disc_info.benable = false; -+ } -+ -+ for( jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3 ) -+ { -+ peerMAC[ jj ] = key_2char2num( extra[kk], extra[kk+ 1] ); -+ } -+ -+ if ( _rtw_memcmp( &extra[ 18 ], "display", 7 ) ) -+ { -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_DISPLYA; -+ } -+ else if ( _rtw_memcmp( &extra[ 18 ], "keypad", 7 ) ) -+ { -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_KEYPAD; -+ } -+ else if ( _rtw_memcmp( &extra[ 18 ], "pbc", 3 ) ) -+ { -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON; -+ } -+ else if ( _rtw_memcmp( &extra[ 18 ], "label", 5 ) ) -+ { -+ pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_LABEL; -+ } -+ else -+ { -+ DBG_871X( "[%s] Unknown WPS config methodn", __FUNCTION__ ); -+ return( ret ); -+ } -+ -+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ phead = get_list_head(queue); -+ plist = get_next(phead); -+ -+ while(1) -+ { -+ if (rtw_end_of_queue_search(phead,plist)== true) -+ break; -+ -+ if( uintPeerChannel != 0 ) -+ break; -+ -+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); -+ -+ // Commented by Albert 2011/05/18 -+ // Match the device address located in the P2P IE -+ // This is for the case that the P2P device address is not the same as the P2P interface address. -+ -+ if (pnetwork->network.Reserved[0] == 2) { // Probe Request -+ ie_offset = 0; -+ } else { // Beacon or Probe Respones -+ ie_offset = 12; -+ } -+ if ( (p2pie=rtw_get_p2p_ie( &pnetwork->network.IEs[ie_offset], pnetwork->network.IELength - ie_offset, NULL, &p2pielen)) ) -+ { -+ while ( p2pie ) -+ { -+ // The P2P Device ID attribute is included in the Beacon frame. -+ // The P2P Device Info attribute is included in the probe response frame. -+ -+ if ( rtw_get_p2p_attr_content( p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen) ) -+ { -+ // Handle the P2P Device ID attribute of Beacon first -+ if ( _rtw_memcmp( attr_content, peerMAC, ETH_ALEN ) ) -+ { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } -+ else if ( rtw_get_p2p_attr_content( p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen) ) -+ { -+ // Handle the P2P Device Info attribute of probe response -+ if ( _rtw_memcmp( attr_content, peerMAC, ETH_ALEN ) ) -+ { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } -+ -+ //Get the next P2P IE -+ p2pie = rtw_get_p2p_ie(p2pie+p2pielen, pnetwork->network.IELength - ie_offset -(p2pie -&pnetwork->network.IEs[ie_offset] + p2pielen), NULL, &p2pielen); -+ } -+ -+ } -+ -+#ifdef CONFIG_INTEL_WIDI -+ // Some Intel WiDi source may not provide P2P IE, -+ // so we could only compare mac addr by 802.11 Source Address -+ if( pmlmepriv->widi_state == INTEL_WIDI_STATE_WFD_CONNECTION -+ && uintPeerChannel == 0 ) -+ { -+ if ( _rtw_memcmp( pnetwork->network.MacAddress, peerMAC, ETH_ALEN ) ) -+ { -+ uintPeerChannel = pnetwork->network.Configuration.DSConfig; -+ break; -+ } -+ } -+#endif //CONFIG_INTEL_WIDI -+ -+ plist = get_next(plist); -+ -+ } -+ -+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -+ -+ if ( uintPeerChannel ) -+ { -+#ifdef CONFIG_WFD -+ { -+ u8 wfd_ie[ 128 ] = { 0x00 }; -+ uint wfd_ielen = 0; -+ -+ if ( rtw_get_wfd_ie( &pnetwork->network.IEs[12], pnetwork->network.IELength - 12, wfd_ie, &wfd_ielen ) ) -+ { -+ u8 wfd_devinfo[ 6 ] = { 0x00 }; -+ uint wfd_devlen = 6; -+ -+ DBG_871X( "[%s] Found WFD IE!\n", __FUNCTION__ ); -+ if ( rtw_get_wfd_attr_content( wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, wfd_devinfo, &wfd_devlen ) ) -+ { -+ u16 wfd_devinfo_field = 0; -+ -+ // Commented by Albert 20120319 -+ // The first two bytes are the WFD device information field of WFD device information subelement. -+ // In big endian format. -+ wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo); -+ if ( wfd_devinfo_field & WFD_DEVINFO_SESSION_AVAIL ) -+ { -+ pwfd_info->peer_session_avail = true; -+ } -+ else -+ { -+ pwfd_info->peer_session_avail = false; -+ } -+ } -+ } -+ -+ if ( false == pwfd_info->peer_session_avail ) -+ { -+ DBG_871X( "[%s] WFD Session not avaiable!\n", __FUNCTION__ ); -+ goto exit; -+ } -+ } -+#endif // CONFIG_WFD -+ -+ DBG_871X( "[%s] peer channel: %d!\n", __FUNCTION__, uintPeerChannel ); -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) -+ { -+ _cancel_timer_ex( &pwdinfo->ap_p2p_switch_timer ); -+ } -+#endif // CONFIG_CONCURRENT_MODE -+ _rtw_memcpy( pwdinfo->tx_prov_disc_info.peerIFAddr, pnetwork->network.MacAddress, ETH_ALEN ); -+ _rtw_memcpy( pwdinfo->tx_prov_disc_info.peerDevAddr, peerMAC, ETH_ALEN ); -+ pwdinfo->tx_prov_disc_info.peer_channel_num[0] = ( u16 ) uintPeerChannel; -+ pwdinfo->tx_prov_disc_info.benable = true; -+ rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ); -+ -+ if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) -+ { -+ _rtw_memcpy( &pwdinfo->tx_prov_disc_info.ssid, &pnetwork->network.Ssid, sizeof( NDIS_802_11_SSID ) ); -+ } -+ else if(rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) -+ { -+ _rtw_memcpy( pwdinfo->tx_prov_disc_info.ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN ); -+ pwdinfo->tx_prov_disc_info.ssid.SsidLength= P2P_WILDCARD_SSID_LEN; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) -+ { -+ // Have to enter the power saving with the AP -+ set_channel_bwmode(padapter, pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode); -+ -+ issue_nulldata(pbuddy_adapter, NULL, 1, 3, 500); -+ } -+ else -+ { -+ set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+ } -+#else -+ set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -+#endif -+ -+ _set_timer( &pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT ); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if ( check_fwstate( pbuddy_mlmepriv, _FW_LINKED ) ) -+ { -+ _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_PROVISION_TIMEOUT ); -+ } -+ else -+ { -+ _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT ); -+ } -+#else -+ _set_timer( &pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT ); -+#endif // CONFIG_CONCURRENT_MODE -+ -+ } -+ else -+ { -+ DBG_871X( "[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__ ); -+#ifdef CONFIG_INTEL_WIDI -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); -+ rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); -+ rtw_free_network_queue(padapter, true); -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ rtw_sitesurvey_cmd(padapter, NULL, 0, NULL, 0); -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+#endif //CONFIG_INTEL_WIDI -+ } -+exit: -+ -+ return ret; -+ -+} -+ -+// Added by Albert 20110328 -+// This function is used to inform the driver the user had specified the pin code value or pbc -+// to application. -+ -+static int rtw_p2p_got_wpsinfo(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct wifidirect_info *pwdinfo = &( padapter->wdinfo ); -+ -+ -+ DBG_871X( "[%s] data = %s\n", __FUNCTION__, extra ); -+ // Added by Albert 20110328 -+ // if the input data is P2P_NO_WPSINFO -> reset the wpsinfo -+ // if the input data is P2P_GOT_WPSINFO_PEER_DISPLAY_PIN -> the utility just input the PIN code got from the peer P2P device. -+ // if the input data is P2P_GOT_WPSINFO_SELF_DISPLAY_PIN -> the utility just got the PIN code from itself. -+ // if the input data is P2P_GOT_WPSINFO_PBC -> the utility just determine to use the PBC -+ -+ if ( *extra == '0' ) -+ { -+ pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO; -+ } -+ else if ( *extra == '1' ) -+ { -+ pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_PEER_DISPLAY_PIN; -+ } -+ else if ( *extra == '2' ) -+ { -+ pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_SELF_DISPLAY_PIN; -+ } -+ else if ( *extra == '3' ) -+ { -+ pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_PBC; -+ } -+ else -+ { -+ pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO; -+ } -+ -+ return ret; -+ -+} -+ -+#endif //CONFIG_P2P -+ -+static int rtw_p2p_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+#ifdef CONFIG_P2P -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ DBG_871X( "[%s] extra = %s\n", __FUNCTION__, extra ); -+ -+ if ( _rtw_memcmp( extra, "enable=", 7 ) ) -+ { -+ rtw_wext_p2p_enable( dev, info, wrqu, &extra[7] ); -+ } -+ else if ( _rtw_memcmp( extra, "setDN=", 6 ) ) -+ { -+ wrqu->data.length -= 6; -+ rtw_p2p_setDN( dev, info, wrqu, &extra[6] ); -+ } -+ else if ( _rtw_memcmp( extra, "profilefound=", 13 ) ) -+ { -+ wrqu->data.length -= 13; -+ rtw_p2p_profilefound( dev, info, wrqu, &extra[13] ); -+ } -+ else if ( _rtw_memcmp( extra, "prov_disc=", 10 ) ) -+ { -+ wrqu->data.length -= 10; -+ rtw_p2p_prov_disc( dev, info, wrqu, &extra[10] ); -+ } -+ else if ( _rtw_memcmp( extra, "nego=", 5 ) ) -+ { -+ wrqu->data.length -= 5; -+ rtw_p2p_connect( dev, info, wrqu, &extra[5] ); -+ } -+ else if ( _rtw_memcmp( extra, "intent=", 7 ) ) -+ { -+ // Commented by Albert 2011/03/23 -+ // The wrqu->data.length will include the null character -+ // So, we will decrease 7 + 1 -+ wrqu->data.length -= 8; -+ rtw_p2p_set_intent( dev, info, wrqu, &extra[7] ); -+ } -+ else if ( _rtw_memcmp( extra, "ssid=", 5 ) ) -+ { -+ wrqu->data.length -= 5; -+ rtw_p2p_set_go_nego_ssid( dev, info, wrqu, &extra[5] ); -+ } -+ else if ( _rtw_memcmp( extra, "got_wpsinfo=", 12 ) ) -+ { -+ wrqu->data.length -= 12; -+ rtw_p2p_got_wpsinfo( dev, info, wrqu, &extra[12] ); -+ } -+ else if ( _rtw_memcmp( extra, "listen_ch=", 10 ) ) -+ { -+ // Commented by Albert 2011/05/24 -+ // The wrqu->data.length will include the null character -+ // So, we will decrease (10 + 1) -+ wrqu->data.length -= 11; -+ rtw_p2p_set_listen_ch( dev, info, wrqu, &extra[10] ); -+ } -+ else if ( _rtw_memcmp( extra, "op_ch=", 6 ) ) -+ { -+ // Commented by Albert 2011/05/24 -+ // The wrqu->data.length will include the null character -+ // So, we will decrease (6 + 1) -+ wrqu->data.length -= 7; -+ rtw_p2p_set_op_ch( dev, info, wrqu, &extra[6] ); -+ } -+ else if ( _rtw_memcmp( extra, "invite=", 7 ) ) -+ { -+ wrqu->data.length -= 8; -+ rtw_p2p_invite_req( dev, info, wrqu, &extra[7] ); -+ } -+ else if ( _rtw_memcmp( extra, "persistent=", 11 ) ) -+ { -+ wrqu->data.length -= 11; -+ rtw_p2p_set_persistent( dev, info, wrqu, &extra[11] ); -+ } -+#ifdef CONFIG_WFD -+ else if ( _rtw_memcmp( extra, "sa=", 3 ) ) -+ { -+ // sa: WFD Session Available information -+ wrqu->data.length -= 3; -+ rtw_p2p_set_sa( dev, info, wrqu, &extra[3] ); -+ } -+ else if ( _rtw_memcmp( extra, "pc=", 3 ) ) -+ { -+ // pc: WFD Preferred Connection -+ wrqu->data.length -= 3; -+ rtw_p2p_set_pc( dev, info, wrqu, &extra[3] ); -+ } -+ else if ( _rtw_memcmp( extra, "wfd_type=", 9 ) ) -+ { -+ // pc: WFD Preferred Connection -+ wrqu->data.length -= 9; -+ rtw_p2p_set_wfd_device_type( dev, info, wrqu, &extra[9] ); -+ } -+ else if ( _rtw_memcmp( extra, "wfd_enable=", 11 ) ) -+ { -+ wrqu->data.length -= 11; -+ rtw_p2p_set_wfd_enable( dev, info, wrqu, &extra[11] ); -+ } -+ else if ( _rtw_memcmp( extra, "driver_iface=", 13 ) ) -+ { -+ wrqu->data.length -= 13; -+ rtw_p2p_set_driver_iface( dev, info, wrqu, &extra[13] ); -+ } -+#endif //CONFIG_WFD -+ -+#endif //CONFIG_P2P -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+#ifdef CONFIG_P2P -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct iw_point *pdata = &wrqu->data; -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+ if ( padapter->bShowGetP2PState ) -+ { -+ DBG_871X( "[%s] extra = %s\n", __FUNCTION__, (char*) wrqu->data.pointer ); -+ } -+ -+ if (_rtw_memcmp((__force void *)wrqu->data.pointer, "status", 6 ) ) -+ { -+ rtw_p2p_get_status( dev, info, wrqu, extra ); -+ } -+ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "role", 4 ) ) -+ { -+ rtw_p2p_get_role( dev, info, wrqu, extra); -+ } -+ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "peer_ifa", 8 ) ) -+ { -+ rtw_p2p_get_peer_ifaddr( dev, info, wrqu, extra); -+ } -+ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "req_cm", 6 ) ) -+ { -+ rtw_p2p_get_req_cm( dev, info, wrqu, extra); -+ } -+ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "peer_deva", 9 ) ) -+ { -+ // Get the P2P device address when receiving the provision discovery request frame. -+ rtw_p2p_get_peer_devaddr( dev, info, wrqu, extra); -+ } -+ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "group_id", 8 ) ) -+ { -+ rtw_p2p_get_groupid( dev, info, wrqu, extra); -+ } -+ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "inv_peer_deva", 13 ) ) -+ { -+ // Get the P2P device address when receiving the P2P Invitation request frame. -+ rtw_p2p_get_peer_devaddr_by_invitation( dev, info, wrqu, extra); -+ } -+ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "op_ch", 5 ) ) -+ { -+ rtw_p2p_get_op_ch( dev, info, wrqu, extra); -+ } -+#ifdef CONFIG_WFD -+ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "peer_port", 9 ) ) -+ { -+ rtw_p2p_get_peer_wfd_port( dev, info, wrqu, extra ); -+ } -+ else if ( _rtw_memcmp((__force void *)wrqu->data.pointer, "wfd_sa", 6 ) ) -+ { -+ rtw_p2p_get_peer_wfd_session_available( dev, info, wrqu, extra ); -+ } -+ else if (_rtw_memcmp((__force void *)wrqu->data.pointer, "wfd_pc", 6 ) ) -+ { -+ rtw_p2p_get_peer_wfd_preferred_connection( dev, info, wrqu, extra ); -+ } -+#endif // CONFIG_WFD -+ -+#endif //CONFIG_P2P -+ -+ return ret; -+ -+} -+ -+static int rtw_p2p_get2(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+#ifdef CONFIG_P2P -+ -+ int length = wrqu->data.length; -+ char *buffer = (u8 *)rtw_malloc(length); -+ -+ if (buffer == NULL) -+ { -+ ret = -ENOMEM; -+ goto bad; -+ } -+ -+ if (copy_from_user(buffer, wrqu->data.pointer, wrqu->data.length)) -+ { -+ ret - EFAULT; -+ goto bad; -+ } -+ -+ DBG_871X("[%s] buffer = %s\n", __FUNCTION__, buffer); -+ -+ if (_rtw_memcmp(buffer, "wpsCM=", 6)) -+ { -+ ret = rtw_p2p_get_wps_configmethod(dev, info, wrqu, extra, &buffer[6]); -+ } else if (_rtw_memcmp(buffer, "devN=", 5)) -+ { -+ ret = rtw_p2p_get_device_name(dev, info, wrqu, extra, &buffer[5]); -+ } else if (_rtw_memcmp(buffer, "dev_type=", 9)) -+ { -+ ret = rtw_p2p_get_device_type(dev, info, wrqu, extra, &buffer[9]); -+ } else if (_rtw_memcmp(buffer, "go_devadd=", 10)) -+ { -+ ret = rtw_p2p_get_go_device_address(dev, info, wrqu, extra, &buffer[10]); -+ } else if (_rtw_memcmp(buffer, "InvProc=", 8)) -+ { -+ ret = rtw_p2p_get_invitation_procedure(dev, info, wrqu, extra, &buffer[8]); -+ } else -+ { -+ snprintf(extra, sizeof("Command not found."), "Command not found."); -+ wrqu->data.length = strlen(extra); -+ } -+ -+bad: -+ if (buffer) -+ { -+ _rtw_mfree(buffer, length); -+ } -+ -+#endif //CONFIG_P2P -+ -+ return ret; -+ -+} -+ -+static int rtw_cta_test_start(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ DBG_871X("%s %s\n", __func__, extra); -+ if (!strcmp(extra, "1")) -+ padapter->in_cta_test = 1; -+ else -+ padapter->in_cta_test = 0; -+ -+ if(padapter->in_cta_test) -+ { -+ u32 v = rtw_read32(padapter, REG_RCR); -+ v &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN );//| RCR_ADF -+ rtw_write32(padapter, REG_RCR, v); -+ DBG_871X("enable RCR_ADF\n"); -+ } -+ else -+ { -+ u32 v = rtw_read32(padapter, REG_RCR); -+ v |= RCR_CBSSID_DATA | RCR_CBSSID_BCN ;//| RCR_ADF -+ rtw_write32(padapter, REG_RCR, v); -+ DBG_871X("disable RCR_ADF\n"); -+ } -+ return ret; -+} -+ -+ -+static int rtw_rereg_nd_name(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ _adapter *padapter = rtw_netdev_priv(dev); -+ struct rereg_nd_name_data *rereg_priv = &padapter->rereg_nd_name_priv; -+ char new_ifname[IFNAMSIZ]; -+ -+ if(rereg_priv->old_ifname[0] == 0) { -+ char *reg_ifname; -+#ifdef CONFIG_CONCURRENT_MODE -+ if (padapter->isprimary) -+ reg_ifname = padapter->registrypriv.ifname; -+ else -+#endif -+ reg_ifname = padapter->registrypriv.if2name; -+ -+ strncpy(rereg_priv->old_ifname, reg_ifname, IFNAMSIZ); -+ rereg_priv->old_ifname[IFNAMSIZ-1] = 0; -+ } -+ -+ //DBG_871X("%s wrqu->data.length:%d\n", __FUNCTION__, wrqu->data.length); -+ if(wrqu->data.length > IFNAMSIZ) -+ return -EFAULT; -+ -+ if ( copy_from_user(new_ifname, wrqu->data.pointer, IFNAMSIZ) ) { -+ return -EFAULT; -+ } -+ -+ if( 0 == strcmp(rereg_priv->old_ifname, new_ifname) ) { -+ return ret; -+ } -+ -+ DBG_871X("%s new_ifname:%s\n", __FUNCTION__, new_ifname); -+ if( 0 != (ret = rtw_change_ifname(padapter, new_ifname)) ) { -+ goto exit; -+ } -+ -+ if(_rtw_memcmp(rereg_priv->old_ifname, "disable%d", 9) == true) { -+ padapter->ledpriv.bRegUseLed= rereg_priv->old_bRegUseLed; -+ rtw_hal_sw_led_init(padapter); -+ rtw_ips_mode_req(&padapter->pwrctrlpriv, rereg_priv->old_ips_mode); -+ } -+ -+ strncpy(rereg_priv->old_ifname, new_ifname, IFNAMSIZ); -+ rereg_priv->old_ifname[IFNAMSIZ-1] = 0; -+ -+ if(_rtw_memcmp(new_ifname, "disable%d", 9) == true) { -+ -+ DBG_871X("%s disable\n", __FUNCTION__); -+ // free network queue for Android's timming issue -+ rtw_free_network_queue(padapter, true); -+ -+ // close led -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ rereg_priv->old_bRegUseLed = padapter->ledpriv.bRegUseLed; -+ padapter->ledpriv.bRegUseLed= false; -+ rtw_hal_sw_led_deinit(padapter); -+ -+ // the interface is being "disabled", we can do deeper IPS -+ rereg_priv->old_ips_mode = rtw_get_ips_mode_req(&padapter->pwrctrlpriv); -+ rtw_ips_mode_req(&padapter->pwrctrlpriv, IPS_NORMAL); -+ } -+exit: -+ return ret; -+ -+} -+ -+#if 0 -+void mac_reg_dump(_adapter *padapter) -+{ -+ int i,j=1; -+ DBG_871X("\n======= MAC REG =======\n"); -+ for(i=0x0;i<0x300;i+=4) -+ { -+ if(j%4==1) DBG_871X("0x%02x",i); -+ DBG_871X(" 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) DBG_871X("\n"); -+ } -+ for(i=0x400;i<0x800;i+=4) -+ { -+ if(j%4==1) DBG_871X("0x%02x",i); -+ DBG_871X(" 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) DBG_871X("\n"); -+ } -+} -+void bb_reg_dump(_adapter *padapter) -+{ -+ int i,j=1; -+ DBG_871X("\n======= BB REG =======\n"); -+ for(i=0x800;i<0x1000;i+=4) -+ { -+ if(j%4==1) DBG_871X("0x%02x",i); -+ -+ DBG_871X(" 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) DBG_871X("\n"); -+ } -+} -+void rf_reg_dump(_adapter *padapter) -+{ -+ int i,j=1,path; -+ u32 value; -+ DBG_871X("\n======= RF REG =======\n"); -+ for(path=0;path<2;path++) -+ { -+ DBG_871X("\nRF_Path(%x)\n",path); -+ for(i=0;i<0x100;i++) -+ { -+ value = PHY_QueryRFReg(padapter, path,i, bMaskDWord); -+ if(j%4==1) DBG_871X("0x%02x ",i); -+ DBG_871X(" 0x%08x ",value); -+ if((j++)%4==0) DBG_871X("\n"); -+ } -+ } -+} -+ -+#endif -+ -+static void mac_reg_dump(_adapter *padapter) -+{ -+ int i,j=1; -+ printk("\n======= MAC REG =======\n"); -+ for(i=0x0;i<0x300;i+=4) -+ { -+ if(j%4==1) printk("0x%02x",i); -+ printk(" 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) printk("\n"); -+ } -+ for(i=0x400;i<0x800;i+=4) -+ { -+ if(j%4==1) printk("0x%02x",i); -+ printk(" 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) printk("\n"); -+ } -+} -+ -+static void bb_reg_dump(_adapter *padapter) -+{ -+ int i,j=1; -+ printk("\n======= BB REG =======\n"); -+ for(i=0x800;i<0x1000;i+=4) -+ { -+ if(j%4==1) printk("0x%02x",i); -+ -+ printk(" 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) printk("\n"); -+ } -+} -+ -+static void rf_reg_dump(_adapter *padapter) -+{ -+ int i,j=1,path; -+ u32 value; -+ u8 rf_type,path_nums = 0; -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ printk("\n======= RF REG =======\n"); -+ if((RF_1T2R == rf_type) ||(RF_1T1R ==rf_type )) -+ path_nums = 1; -+ else -+ path_nums = 2; -+ -+ for(path=0;path -+#endif -+static int rtw_dbg_port(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ _irqL irqL; -+ int ret = 0; -+ u8 major_cmd, minor_cmd; -+ u16 arg; -+ u32 extra_arg, *pdata, val32; -+ struct sta_info *psta; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ struct wlan_network *cur_network = &(pmlmepriv->cur_network); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ -+ pdata = (u32*)&wrqu->data; -+ -+ val32 = *pdata; -+ arg = (u16)(val32&0x0000ffff); -+ major_cmd = (u8)(val32>>24); -+ minor_cmd = (u8)((val32>>16)&0x00ff); -+ -+ extra_arg = *(pdata+1); -+ -+ switch(major_cmd) -+ { -+ case 0x70://read_reg -+ switch(minor_cmd) -+ { -+ case 1: -+ DBG_871X("rtw_read8(0x%x)=0x%02x\n", arg, rtw_read8(padapter, arg)); -+ break; -+ case 2: -+ DBG_871X("rtw_read16(0x%x)=0x%04x\n", arg, rtw_read16(padapter, arg)); -+ break; -+ case 4: -+ DBG_871X("rtw_read32(0x%x)=0x%08x\n", arg, rtw_read32(padapter, arg)); -+ break; -+ } -+ break; -+ case 0x71://write_reg -+ switch(minor_cmd) -+ { -+ case 1: -+ rtw_write8(padapter, arg, extra_arg); -+ DBG_871X("rtw_write8(0x%x)=0x%02x\n", arg, rtw_read8(padapter, arg)); -+ break; -+ case 2: -+ rtw_write16(padapter, arg, extra_arg); -+ DBG_871X("rtw_write16(0x%x)=0x%04x\n", arg, rtw_read16(padapter, arg)); -+ break; -+ case 4: -+ rtw_write32(padapter, arg, extra_arg); -+ DBG_871X("rtw_write32(0x%x)=0x%08x\n", arg, rtw_read32(padapter, arg)); -+ break; -+ } -+ break; -+ case 0x72://read_bb -+ DBG_871X("read_bbreg(0x%x)=0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff)); -+ break; -+ case 0x73://write_bb -+ rtw_hal_write_bbreg(padapter, arg, 0xffffffff, extra_arg); -+ DBG_871X("write_bbreg(0x%x)=0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff)); -+ break; -+ case 0x74://read_rf -+ DBG_871X("read RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n",minor_cmd,arg,rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff)); -+ break; -+ case 0x75://write_rf -+ rtw_hal_write_rfreg(padapter, minor_cmd, arg, 0xffffffff, extra_arg); -+ DBG_871X("write RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n",minor_cmd,arg, rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff)); -+ break; -+ -+ case 0x76: -+ switch(minor_cmd) -+ { -+ case 0x00: //normal mode, -+ padapter->recvpriv.is_signal_dbg = 0; -+ break; -+ case 0x01: //dbg mode -+ padapter->recvpriv.is_signal_dbg = 1; -+ extra_arg = extra_arg>100?100:extra_arg; -+ extra_arg = extra_arg<0?0:extra_arg; -+ padapter->recvpriv.signal_strength_dbg=extra_arg; -+ break; -+ } -+ break; -+ case 0x78: //IOL test -+ #ifdef CONFIG_IOL -+ switch(minor_cmd) -+ { -+ case 0x04: //LLT table initialization test -+ { -+ u8 page_boundary = 0xf9; -+ { -+ struct xmit_frame *xmit_frame; -+ -+ if((xmit_frame=rtw_IOL_accquire_xmit_frame(padapter)) == NULL) { -+ ret = -ENOMEM; -+ break; -+ } -+ -+ rtw_IOL_append_LLT_cmd(xmit_frame, page_boundary); -+ -+ -+ if(_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 500,0) ) -+ ret = -EPERM; -+ } -+ } -+ break; -+ case 0x05: //blink LED test -+ { -+ u16 reg = 0x4c; -+ u32 blink_num = 50; -+ u32 blink_delay_ms = 200; -+ int i; -+ -+ { -+ struct xmit_frame *xmit_frame; -+ -+ if((xmit_frame=rtw_IOL_accquire_xmit_frame(padapter)) == NULL) { -+ ret = -ENOMEM; -+ break; -+ } -+ -+ for(i=0;inetwork.MacAddress -+ , WLAN_REASON_EXPIRATION_CHK); -+ break; -+ case 0x7F: -+ switch(minor_cmd) -+ { -+ case 0x0: -+ DBG_871X("fwstate=0x%x\n", get_fwstate(pmlmepriv)); -+ break; -+ case 0x01: -+ DBG_871X("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", -+ psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, -+ psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus); -+ break; -+ case 0x02: -+ DBG_871X("pmlmeinfo->state=0x%x\n", pmlmeinfo->state); -+ break; -+ case 0x03: -+ DBG_871X("qos_option=%d\n", pmlmepriv->qospriv.qos_option); -+#ifdef CONFIG_80211N_HT -+ DBG_871X("ht_option=%d\n", pmlmepriv->htpriv.ht_option); -+#endif //CONFIG_80211N_HT -+ break; -+ case 0x04: -+ DBG_871X("cur_ch=%d\n", pmlmeext->cur_channel); -+ DBG_871X("cur_bw=%d\n", pmlmeext->cur_bwmode); -+ DBG_871X("cur_ch_off=%d\n", pmlmeext->cur_ch_offset); -+ break; -+ case 0x05: -+ psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); -+ if(psta) -+ { -+ int i; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ -+ DBG_871X("SSID=%s\n", cur_network->network.Ssid.Ssid); -+ DBG_871X("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ DBG_871X("cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); -+ DBG_871X("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); -+ DBG_871X("state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); -+#ifdef CONFIG_80211N_HT -+ DBG_871X("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ DBG_871X("bwmode=%d, ch_offset=%d, sgi=%d\n", psta->htpriv.bwmode, psta->htpriv.ch_offset, psta->htpriv.sgi); -+ DBG_871X("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ DBG_871X("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); -+#endif //CONFIG_80211N_HT -+ -+ for(i=0;i<16;i++) -+ { -+ preorder_ctrl = &psta->recvreorder_ctrl[i]; -+ if(preorder_ctrl->enable) -+ { -+ DBG_871X("tid=%d, indicate_seq=%d\n", i, preorder_ctrl->indicate_seq); -+ } -+ } -+ -+ } -+ else -+ { -+ DBG_871X("can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); -+ } -+ break; -+ case 0x06: -+ { -+ u32 ODMFlag; -+ rtw_hal_get_hwreg(padapter, HW_VAR_DM_FLAG, (u8*)(&ODMFlag)); -+ DBG_871X("(B)DMFlag=0x%x, arg=0x%x\n", ODMFlag, arg); -+ ODMFlag = (u32)(0x0f&arg); -+ DBG_871X("(A)DMFlag=0x%x\n", ODMFlag); -+ rtw_hal_set_hwreg(padapter, HW_VAR_DM_FLAG, (u8 *)(&ODMFlag)); -+ } -+ break; -+ case 0x07: -+ DBG_871X("bSurpriseRemoved=%d, bDriverStopped=%d\n", -+ padapter->bSurpriseRemoved, padapter->bDriverStopped); -+ break; -+ case 0x08: -+ { -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ DBG_871X("free_xmitbuf_cnt=%d, free_xmitframe_cnt=%d" -+ ", free_xmit_extbuf_cnt=%d, free_xframe_ext_cnt=%d" -+ ", free_recvframe_cnt=%d\n", -+ pxmitpriv->free_xmitbuf_cnt, pxmitpriv->free_xmitframe_cnt, -+ pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xframe_ext_cnt, -+ precvpriv->free_recvframe_cnt); -+ DBG_871X("rx_urb_pending_cn=%d\n", precvpriv->rx_pending_cnt); -+ } -+ break; -+ case 0x09: -+ { -+ int i, j; -+ _list *plist, *phead; -+ struct recv_reorder_ctrl *preorder_ctrl; -+ -+#ifdef CONFIG_AP_MODE -+ DBG_871X("sta_dz_bitmap=0x%x, tim_bitmap=0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); -+#endif -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for(i=0; i< NUM_STA; i++) -+ { -+ phead = &(pstapriv->sta_hash[i]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); -+ -+ plist = get_next(plist); -+ -+ if(extra_arg == psta->aid) -+ { -+ DBG_871X("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); -+ DBG_871X("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); -+ DBG_871X("state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); -+#ifdef CONFIG_80211N_HT -+ DBG_871X("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); -+ DBG_871X("bwmode=%d, ch_offset=%d, sgi=%d\n", psta->htpriv.bwmode, psta->htpriv.ch_offset, psta->htpriv.sgi); -+ DBG_871X("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); -+ DBG_871X("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); -+#endif //CONFIG_80211N_HT -+ -+#ifdef CONFIG_AP_MODE -+ DBG_871X("capability=0x%x\n", psta->capability); -+ DBG_871X("flags=0x%x\n", psta->flags); -+ DBG_871X("wpa_psk=0x%x\n", psta->wpa_psk); -+ DBG_871X("wpa2_group_cipher=0x%x\n", psta->wpa2_group_cipher); -+ DBG_871X("wpa2_pairwise_cipher=0x%x\n", psta->wpa2_pairwise_cipher); -+ DBG_871X("qos_info=0x%x\n", psta->qos_info); -+#endif -+ DBG_871X("dot118021XPrivacy=0x%x\n", psta->dot118021XPrivacy); -+ -+ -+ -+ for(j=0;j<16;j++) -+ { -+ preorder_ctrl = &psta->recvreorder_ctrl[j]; -+ if(preorder_ctrl->enable) -+ { -+ DBG_871X("tid=%d, indicate_seq=%d\n", j, preorder_ctrl->indicate_seq); -+ } -+ } -+ -+ } -+ -+ } -+ } -+ -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ } -+ break; -+ -+ case 0x0c://dump rx/tx packet -+ { -+ if(arg == 0){ -+ DBG_871X("dump rx packet (%d)\n",extra_arg); -+ //pHalData->bDumpRxPkt =extra_arg; -+ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_RXPKT, &(extra_arg)); -+ } -+ else if(arg==1){ -+ DBG_871X("dump tx packet (%d)\n",extra_arg); -+ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_TXPKT, &(extra_arg)); -+ } -+ } -+ break; -+#if 0 -+ case 0x0d://dump cam -+ { -+ //u8 entry = (u8) extra_arg; -+ u8 entry=0; -+ //dump cam -+ for(entry=0;entry<32;entry++) -+ read_cam(padapter,entry); -+ } -+ break; -+#endif -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ case 0x0f: -+ { -+ if(extra_arg == 0){ -+ DBG_871X("###### silent reset test.......#####\n"); -+ rtw_hal_sreset_reset(padapter); -+ } else { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ struct sreset_priv *psrtpriv = &pHalData->srestpriv; -+ psrtpriv->dbg_trigger_point = extra_arg; -+ } -+ -+ } -+ break; -+ case 0x15: -+ { -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ DBG_871X("==>silent resete cnts:%d\n",pwrpriv->ips_enter_cnts); -+ } -+ break; -+ -+ #endif -+ -+ case 0x10:// driver version display -+ DBG_871X("rtw driver version=%s\n", DRIVERVERSION); -+ break; -+ case 0x11: -+ { -+ DBG_871X("linked info dump func %s \n",(extra_arg>=1)?"enable":"disable"); -+ DBG_871X("extra_arg_ID: RA Info BIT-0 ,DIG Info BIT-1, FA Info BIT-2 \n"); -+ padapter->bLinkInfoDump = extra_arg ; -+ -+ } -+ break; -+#ifdef CONFIG_80211N_HT -+ case 0x12: //set rx_stbc -+ { -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ // 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, 0x3: enable both 2.4g and 5g -+ //default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ -+ if( pregpriv && (extra_arg == 0 || extra_arg == 1|| extra_arg == 2 || extra_arg == 3)) -+ { -+ pregpriv->rx_stbc= extra_arg; -+ DBG_871X("set rx_stbc=%d\n",pregpriv->rx_stbc); -+ } -+ else -+ DBG_871X("get rx_stbc=%d\n",pregpriv->rx_stbc); -+ -+ } -+ break; -+ case 0x13: //set ampdu_enable -+ { -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ // 0: disable, 0x1:enable (but wifi_spec should be 0), 0x2: force enable (don't care wifi_spec) -+ if( pregpriv && extra_arg >= 0 && extra_arg < 3 ) -+ { -+ pregpriv->ampdu_enable= extra_arg; -+ DBG_871X("set ampdu_enable=%d\n",pregpriv->ampdu_enable); -+ } -+ else -+ DBG_871X("get ampdu_enable=%d\n",pregpriv->ampdu_enable); -+ -+ } -+ break; -+#endif -+ case 0x14: //get wifi_spec -+ { -+ struct registry_priv *pregpriv = &padapter->registrypriv; -+ DBG_871X("get wifi_spec=%d\n",pregpriv->wifi_spec); -+ -+ } -+ break; -+ case 0x16: -+ { -+ if(arg == 0xff){ -+ printk("ODM_COMP_DIG\t\tBIT0\n"); -+ printk("ODM_COMP_RA_MASK\t\tBIT1\n"); -+ printk("ODM_COMP_DYNAMIC_TXPWR\tBIT2\n"); -+ printk("ODM_COMP_FA_CNT\t\tBIT3\n"); -+ printk("ODM_COMP_RSSI_MONITOR\tBIT4\n"); -+ printk("ODM_COMP_CCK_PD\t\tBIT5\n"); -+ printk("ODM_COMP_ANT_DIV\t\tBIT6\n"); -+ printk("ODM_COMP_PWR_SAVE\t\tBIT7\n"); -+ printk("ODM_COMP_PWR_TRAIN\tBIT8\n"); -+ printk("ODM_COMP_RATE_ADAPTIVE\tBIT9\n"); -+ printk("ODM_COMP_PATH_DIV\t\tBIT10\n"); -+ printk("ODM_COMP_PSD \tBIT11\n"); -+ printk("ODM_COMP_DYNAMIC_PRICCA\tBIT12\n"); -+ printk("ODM_COMP_RXHP\t\tBIT13\n"); -+ printk("ODM_COMP_EDCA_TURBO\tBIT16\n"); -+ printk("ODM_COMP_EARLY_MODE\tBIT17\n"); -+ printk("ODM_COMP_TX_PWR_TRACK\tBIT24\n"); -+ printk("ODM_COMP_RX_GAIN_TRACK\tBIT25\n"); -+ printk("ODM_COMP_CALIBRATION\tBIT26\n"); -+ rtw_hal_get_def_var(padapter, HW_DEF_ODM_DBG_FLAG,&extra_arg); -+ } -+ else{ -+ rtw_hal_set_def_var(padapter, HW_DEF_ODM_DBG_FLAG,&extra_arg); -+ } -+ } -+ break; -+#ifdef DBG_FIXED_CHAN -+ case 0x17: -+ { -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ printk("===> Fixed channel to %d \n",extra_arg); -+ pmlmeext->fixed_chan = extra_arg; -+ -+ } -+ break; -+#endif -+ case 0x18: -+ { -+ printk("===> Switch USB Mode %d \n",extra_arg); -+ rtw_hal_set_hwreg(padapter, HW_VAR_USB_MODE, (u8 *)&extra_arg); -+ } -+ break; -+ case 0x23: -+ { -+ DBG_871X("turn %s the bNotifyChannelChange Variable\n",(extra_arg==1)?"on":"off"); -+ padapter->bNotifyChannelChange = extra_arg; -+ break; -+ } -+ case 0x24: -+ { -+#ifdef CONFIG_P2P -+ DBG_871X("turn %s the bShowGetP2PState Variable\n",(extra_arg==1)?"on":"off"); -+ padapter->bShowGetP2PState = extra_arg; -+#endif // CONFIG_P2P -+ break; -+ } -+ case 0xaa: -+ { -+ if(extra_arg> 0x3F) extra_arg = 0xFF; -+ DBG_871X("chang data rate to :0x%02x\n",extra_arg); -+ padapter->fix_rate = extra_arg; -+ } -+ break; -+ case 0xdd://registers dump , 0 for mac reg,1 for bb reg, 2 for rf reg -+ { -+ if(extra_arg==0){ -+ mac_reg_dump(padapter); -+ } -+ else if(extra_arg==1){ -+ bb_reg_dump(padapter); -+ } -+ else if(extra_arg==2){ -+ rf_reg_dump(padapter); -+ } -+ -+ } -+ break; -+ -+ case 0xee://turn on/off dynamic funcs -+ { -+ u32 odm_flag; -+ -+ if(0xf==extra_arg){ -+ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DM_FUNC,&odm_flag); -+ DBG_871X(" === DMFlag(0x%08x) === \n",odm_flag); -+ DBG_871X("extra_arg = 0 - disable all dynamic func \n"); -+ DBG_871X("extra_arg = 1 - disable DIG- BIT(0)\n"); -+ DBG_871X("extra_arg = 2 - disable High power - BIT(1)\n"); -+ DBG_871X("extra_arg = 3 - disable tx power tracking - BIT(2)\n"); -+ DBG_871X("extra_arg = 4 - disable BT coexistence - BIT(3)\n"); -+ DBG_871X("extra_arg = 5 - disable antenna diversity - BIT(4)\n"); -+ DBG_871X("extra_arg = 6 - enable all dynamic func \n"); -+ } -+ else{ -+ /* extra_arg = 0 - disable all dynamic func -+ extra_arg = 1 - disable DIG -+ extra_arg = 2 - disable tx power tracking -+ extra_arg = 3 - turn on all dynamic func -+ */ -+ rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DM_FUNC, &(extra_arg)); -+ rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DM_FUNC,&odm_flag); -+ DBG_871X(" === DMFlag(0x%08x) === \n",odm_flag); -+ } -+ } -+ break; -+ -+ case 0xfd: -+ rtw_write8(padapter, 0xc50, arg); -+ DBG_871X("wr(0xc50)=0x%x\n", rtw_read8(padapter, 0xc50)); -+ rtw_write8(padapter, 0xc58, arg); -+ DBG_871X("wr(0xc58)=0x%x\n", rtw_read8(padapter, 0xc58)); -+ break; -+ case 0xfe: -+ DBG_871X("rd(0xc50)=0x%x\n", rtw_read8(padapter, 0xc50)); -+ DBG_871X("rd(0xc58)=0x%x\n", rtw_read8(padapter, 0xc58)); -+ break; -+ case 0xff: -+ { -+ DBG_871X("dbg(0x210)=0x%x\n", rtw_read32(padapter, 0x210)); -+ DBG_871X("dbg(0x608)=0x%x\n", rtw_read32(padapter, 0x608)); -+ DBG_871X("dbg(0x280)=0x%x\n", rtw_read32(padapter, 0x280)); -+ DBG_871X("dbg(0x284)=0x%x\n", rtw_read32(padapter, 0x284)); -+ DBG_871X("dbg(0x288)=0x%x\n", rtw_read32(padapter, 0x288)); -+ -+ DBG_871X("dbg(0x664)=0x%x\n", rtw_read32(padapter, 0x664)); -+ -+ -+ DBG_871X("\n"); -+ -+ DBG_871X("dbg(0x430)=0x%x\n", rtw_read32(padapter, 0x430)); -+ DBG_871X("dbg(0x438)=0x%x\n", rtw_read32(padapter, 0x438)); -+ -+ DBG_871X("dbg(0x440)=0x%x\n", rtw_read32(padapter, 0x440)); -+ -+ DBG_871X("dbg(0x458)=0x%x\n", rtw_read32(padapter, 0x458)); -+ -+ DBG_871X("dbg(0x484)=0x%x\n", rtw_read32(padapter, 0x484)); -+ DBG_871X("dbg(0x488)=0x%x\n", rtw_read32(padapter, 0x488)); -+ -+ DBG_871X("dbg(0x444)=0x%x\n", rtw_read32(padapter, 0x444)); -+ DBG_871X("dbg(0x448)=0x%x\n", rtw_read32(padapter, 0x448)); -+ DBG_871X("dbg(0x44c)=0x%x\n", rtw_read32(padapter, 0x44c)); -+ DBG_871X("dbg(0x450)=0x%x\n", rtw_read32(padapter, 0x450)); -+ } -+ break; -+ } -+ break; -+ default: -+ DBG_871X("error dbg cmd!\n"); -+ break; -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int wpa_set_param(struct net_device *dev, u8 name, u32 value) -+{ -+ uint ret=0; -+ u32 flags; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ switch (name){ -+ case IEEE_PARAM_WPA_ENABLED: -+ -+ padapter->securitypriv.dot11AuthAlgrthm= dot11AuthAlgrthm_8021X; //802.1x -+ -+ //ret = ieee80211_wpa_enable(ieee, value); -+ -+ switch((value)&0xff) -+ { -+ case 1 : //WPA -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPAPSK; //WPA_PSK -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled; -+ break; -+ case 2: //WPA2 -+ padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK; //WPA2_PSK -+ padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled; -+ break; -+ } -+ -+ RT_TRACE(_module_rtl871x_ioctl_os_c,_drv_info_,("wpa_set_param:padapter->securitypriv.ndisauthtype=%d\n", padapter->securitypriv.ndisauthtype)); -+ -+ break; -+ -+ case IEEE_PARAM_TKIP_COUNTERMEASURES: -+ //ieee->tkip_countermeasures=value; -+ break; -+ -+ case IEEE_PARAM_DROP_UNENCRYPTED: -+ { -+ /* HACK: -+ * -+ * wpa_supplicant calls set_wpa_enabled when the driver -+ * is loaded and unloaded, regardless of if WPA is being -+ * used. No other calls are made which can be used to -+ * determine if encryption will be used or not prior to -+ * association being expected. If encryption is not being -+ * used, drop_unencrypted is set to false, else true -- we -+ * can use this to determine if the CAP_PRIVACY_ON bit should -+ * be set. -+ */ -+ -+#if 0 -+ struct ieee80211_security sec = { -+ .flags = SEC_ENABLED, -+ .enabled = value, -+ }; -+ ieee->drop_unencrypted = value; -+ /* We only change SEC_LEVEL for open mode. Others -+ * are set by ipw_wpa_set_encryption. -+ */ -+ if (!value) { -+ sec.flags |= SEC_LEVEL; -+ sec.level = SEC_LEVEL_0; -+ } -+ else { -+ sec.flags |= SEC_LEVEL; -+ sec.level = SEC_LEVEL_1; -+ } -+ if (ieee->set_security) -+ ieee->set_security(ieee->dev, &sec); -+#endif -+ break; -+ -+ } -+ case IEEE_PARAM_PRIVACY_INVOKED: -+ -+ //ieee->privacy_invoked=value; -+ -+ break; -+ -+ case IEEE_PARAM_AUTH_ALGS: -+ -+ ret = wpa_set_auth_algs(dev, value); -+ -+ break; -+ -+ case IEEE_PARAM_IEEE_802_1X: -+ -+ //ieee->ieee802_1x=value; -+ -+ break; -+ -+ case IEEE_PARAM_WPAX_SELECT: -+ -+ // added for WPA2 mixed mode -+ //DBG_871X(KERN_WARNING "------------------------>wpax value = %x\n", value); -+ /* -+ spin_lock_irqsave(&ieee->wpax_suitlist_lock,flags); -+ ieee->wpax_type_set = 1; -+ ieee->wpax_type_notify = value; -+ spin_unlock_irqrestore(&ieee->wpax_suitlist_lock,flags); -+ */ -+ -+ break; -+ -+ default: -+ -+ -+ -+ ret = -EOPNOTSUPP; -+ -+ -+ break; -+ -+ } -+ -+ return ret; -+ -+} -+ -+static int wpa_mlme(struct net_device *dev, u32 command, u32 reason) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ switch (command) -+ { -+ case IEEE_MLME_STA_DEAUTH: -+ -+ if(!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ -+ break; -+ -+ case IEEE_MLME_STA_DISASSOC: -+ -+ if(!rtw_set_802_11_disassociate(padapter)) -+ ret = -1; -+ -+ break; -+ -+ default: -+ ret = -EOPNOTSUPP; -+ break; -+ } -+ -+ return ret; -+ -+} -+ -+static int wpa_supplicant_ioctl(struct net_device *dev, struct iw_point *p) -+{ -+ struct ieee_param *param; -+ uint ret=0; -+ -+ //down(&ieee->wx_sem); -+ -+ if (p->length < sizeof(struct ieee_param) || !p->pointer){ -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ param = (struct ieee_param *)rtw_malloc(p->length); -+ if (param == NULL) -+ { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ if (copy_from_user(param, p->pointer, p->length)) -+ { -+ rtw_mfree((u8*)param, p->length); -+ ret = -EFAULT; -+ goto out; -+ } -+ -+ switch (param->cmd) { -+ -+ case IEEE_CMD_SET_WPA_PARAM: -+ ret = wpa_set_param(dev, param->u.wpa_param.name, param->u.wpa_param.value); -+ break; -+ -+ case IEEE_CMD_SET_WPA_IE: -+ //ret = wpa_set_wpa_ie(dev, param, p->length); -+ ret = rtw_set_wpa_ie((_adapter *)rtw_netdev_priv(dev), (char*)param->u.wpa_ie.data, (u16)param->u.wpa_ie.len); -+ break; -+ -+ case IEEE_CMD_SET_ENCRYPTION: -+ ret = wpa_set_encryption(dev, param, p->length); -+ break; -+ -+ case IEEE_CMD_MLME: -+ ret = wpa_mlme(dev, param->u.mlme.command, param->u.mlme.reason_code); -+ break; -+ -+ default: -+ DBG_871X("Unknown WPA supplicant request: %d\n", param->cmd); -+ ret = -EOPNOTSUPP; -+ break; -+ -+ } -+ -+ if (ret == 0 && copy_to_user(p->pointer, param, p->length)) -+ ret = -EFAULT; -+ -+ rtw_mfree((u8 *)param, p->length); -+ -+out: -+ -+ //up(&ieee->wx_sem); -+ -+ return ret; -+ -+} -+ -+#ifdef CONFIG_AP_MODE -+static int rtw_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) -+{ -+ int ret = 0; -+ u32 wep_key_idx, wep_key_len,wep_total_len; -+ NDIS_802_11_WEP *pwep = NULL; -+ struct sta_info *psta = NULL, *pbcmc_sta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ param->u.crypt.err = 0; -+ param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; -+ -+ //sizeof(struct ieee_param) = 64 bytes; -+ //if (param_len != (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) -+ if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ if (param->u.crypt.idx >= WEP_KEYS) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ } -+ else -+ { -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if(!psta) -+ { -+ //ret = -EINVAL; -+ DBG_871X("rtw_set_encryption(), sta has already been removed or never been added\n"); -+ goto exit; -+ } -+ } -+ -+ if (strcmp(param->u.crypt.alg, "none") == 0 && (psta==NULL)) -+ { -+ //todo:clear default encryption keys -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; -+ psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled; -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ -+ DBG_871X("clear default encryption keys, keyid=%d\n", param->u.crypt.idx); -+ -+ goto exit; -+ } -+ -+ -+ if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta==NULL)) -+ { -+ DBG_871X("r871x_set_encryption, crypt.alg = WEP\n"); -+ -+ wep_key_idx = param->u.crypt.idx; -+ wep_key_len = param->u.crypt.key_len; -+ -+ DBG_871X("r871x_set_encryption, wep_key_idx=%d, len=%d\n", wep_key_idx, wep_key_len); -+ -+ if((wep_key_idx >= WEP_KEYS) || (wep_key_len<=0)) -+ { -+ ret = -EINVAL; -+ goto exit; -+ } -+ -+ -+ if (wep_key_len > 0) -+ { -+ wep_key_len = wep_key_len <= 5 ? 5 : 13; -+ wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial); -+ pwep =(NDIS_802_11_WEP *)rtw_malloc(wep_total_len); -+ if(pwep == NULL){ -+ DBG_871X(" r871x_set_encryption: pwep allocate fail !!!\n"); -+ goto exit; -+ } -+ -+ _rtw_memset(pwep, 0, wep_total_len); -+ -+ pwep->KeyLength = wep_key_len; -+ pwep->Length = wep_total_len; -+ -+ } -+ -+ pwep->KeyIndex = wep_key_idx; -+ -+ _rtw_memcpy(pwep->KeyMaterial, param->u.crypt.key, pwep->KeyLength); -+ -+ if(param->u.crypt.set_tx) -+ { -+ DBG_871X("wep, set_tx=1\n"); -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto; -+ psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled; -+ psecuritypriv->dot11PrivacyAlgrthm=_WEP40_; -+ psecuritypriv->dot118021XGrpPrivacy=_WEP40_; -+ -+ if(pwep->KeyLength==13) -+ { -+ psecuritypriv->dot11PrivacyAlgrthm=_WEP104_; -+ psecuritypriv->dot118021XGrpPrivacy=_WEP104_; -+ } -+ -+ -+ psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx; -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx]=pwep->KeyLength; -+ -+ rtw_ap_set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx, 1); -+ } -+ else -+ { -+ DBG_871X("wep, set_tx=0\n"); -+ -+ //don't update "psecuritypriv->dot11PrivacyAlgrthm" and -+ //"psecuritypriv->dot11PrivacyKeyIndex=keyid", but can rtw_set_key to cam -+ -+ _rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength); -+ -+ psecuritypriv->dot11DefKeylen[wep_key_idx] = pwep->KeyLength; -+ -+ rtw_ap_set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx, 0); -+ } -+ -+ goto exit; -+ -+ } -+ -+ -+ if(!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) // //group key -+ { -+ if(param->u.crypt.set_tx ==1) -+ { -+ if(strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ DBG_871X("%s, set group_key, WEP\n", __FUNCTION__); -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if(param->u.crypt.key_len==13) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ -+ } -+ else if(strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ DBG_871X("%s, set group_key, TKIP\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); -+ //set mic key -+ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = true; -+ -+ } -+ else if(strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ DBG_871X("%s, set group_key, CCMP\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ } -+ else -+ { -+ DBG_871X("%s, set group_key, none\n", __FUNCTION__); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = true; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;//!!! -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta=rtw_get_bcmc_stainfo(padapter); -+ if(pbcmc_sta) -+ { -+ pbcmc_sta->ieee8021x_blocked = false; -+ pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy -+ } -+ -+ } -+ -+ goto exit; -+ -+ } -+ -+ if(psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) // psk/802_1x -+ { -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) -+ { -+ if(param->u.crypt.set_tx ==1) -+ { -+ _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ if(strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ DBG_871X("%s, set pairwise key, WEP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _WEP40_; -+ if(param->u.crypt.key_len==13) -+ { -+ psta->dot118021XPrivacy = _WEP104_; -+ } -+ } -+ else if(strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ DBG_871X("%s, set pairwise key, TKIP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _TKIP_; -+ -+ //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); -+ //set mic key -+ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = true; -+ -+ } -+ else if(strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ -+ DBG_871X("%s, set pairwise key, CCMP\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _AES_; -+ } -+ else -+ { -+ DBG_871X("%s, set pairwise key, none\n", __FUNCTION__); -+ -+ psta->dot118021XPrivacy = _NO_PRIVACY_; -+ } -+ -+ rtw_ap_set_pairwise_key(padapter, psta); -+ -+ psta->ieee8021x_blocked = false; -+ -+ } -+ else//group key??? -+ { -+ if(strcmp(param->u.crypt.alg, "WEP") == 0) -+ { -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ psecuritypriv->dot118021XGrpPrivacy = _WEP40_; -+ if(param->u.crypt.key_len==13) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _WEP104_; -+ } -+ } -+ else if(strcmp(param->u.crypt.alg, "TKIP") == 0) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _TKIP_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ -+ //DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); -+ //set mic key -+ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); -+ _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); -+ -+ psecuritypriv->busetkipkey = true; -+ -+ } -+ else if(strcmp(param->u.crypt.alg, "CCMP") == 0) -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _AES_; -+ -+ _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len>16 ?16:param->u.crypt.key_len)); -+ } -+ else -+ { -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ } -+ -+ psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; -+ -+ psecuritypriv->binstallGrpkey = true; -+ -+ psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;//!!! -+ -+ rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); -+ -+ pbcmc_sta=rtw_get_bcmc_stainfo(padapter); -+ if(pbcmc_sta) -+ { -+ pbcmc_sta->ieee8021x_blocked = false; -+ pbcmc_sta->dot118021XPrivacy= psecuritypriv->dot118021XGrpPrivacy;//rx will use bmc_sta's dot118021XPrivacy -+ } -+ -+ } -+ -+ } -+ -+ } -+ -+exit: -+ -+ if(pwep) -+ { -+ rtw_mfree((u8 *)pwep, wep_total_len); -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_set_beacon(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ unsigned char *pbuf = param->u.bcn_ie.buf; -+ -+ -+ DBG_871X("%s, len=%d\n", __FUNCTION__, len); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ _rtw_memcpy(&pstapriv->max_num_sta, param->u.bcn_ie.reserved, 2); -+ -+ if((pstapriv->max_num_sta>NUM_STA) || (pstapriv->max_num_sta<=0)) -+ pstapriv->max_num_sta = NUM_STA; -+ -+ -+ if(rtw_check_beacon_data(padapter, pbuf, (len-12-2)) == _SUCCESS)// 12 = param header, 2:no packed -+ ret = 0; -+ else -+ ret = -EINVAL; -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_hostapd_sta_flush(struct net_device *dev) -+{ -+ //_irqL irqL; -+ //_list *phead, *plist; -+ int ret=0; -+ //struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ //struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ flush_all_cam_entry(padapter); //clear CAM -+ -+ ret = rtw_sta_flush(padapter); -+ -+ return ret; -+ -+} -+ -+static int rtw_add_sta(struct net_device *dev, struct ieee_param *param) -+{ -+ _irqL irqL; -+ int ret=0; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("rtw_add_sta(aid=%d)=" MAC_FMT "\n", param->u.add_sta.aid, MAC_ARG(param->sta_addr)); -+ -+ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) -+ { -+ return -EINVAL; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+/* -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if(psta) -+ { -+ DBG_871X("rtw_add_sta(), free has been added psta=%p\n", psta); -+ _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ rtw_free_stainfo(padapter, psta); -+ _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); -+ -+ psta = NULL; -+ } -+*/ -+ //psta = rtw_alloc_stainfo(pstapriv, param->sta_addr); -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if(psta) -+ { -+ int flags = param->u.add_sta.flags; -+ -+ //DBG_871X("rtw_add_sta(), init sta's variables, psta=%p\n", psta); -+ -+ psta->aid = param->u.add_sta.aid;//aid=1~2007 -+ -+ _rtw_memcpy(psta->bssrateset, param->u.add_sta.tx_supp_rates, 16); -+ -+ -+ //check wmm cap. -+ if(WLAN_STA_WME&flags) -+ psta->qos_option = 1; -+ else -+ psta->qos_option = 0; -+ -+ if(pmlmepriv->qospriv.qos_option == 0) -+ psta->qos_option = 0; -+ -+ -+#ifdef CONFIG_80211N_HT -+ //chec 802.11n ht cap. -+ if(WLAN_STA_HT&flags) -+ { -+ psta->htpriv.ht_option = true; -+ psta->qos_option = 1; -+ _rtw_memcpy((void*)&psta->htpriv.ht_cap, (void*)¶m->u.add_sta.ht_cap, sizeof(struct rtw_ieee80211_ht_cap)); -+ } -+ else -+ { -+ psta->htpriv.ht_option = false; -+ } -+ -+ if(pmlmepriv->htpriv.ht_option == false) -+ psta->htpriv.ht_option = false; -+#endif -+ -+ -+ update_sta_info_apmode(padapter, psta); -+ -+ -+ } -+ else -+ { -+ ret = -ENOMEM; -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_del_sta(struct net_device *dev, struct ieee_param *param) -+{ -+ _irqL irqL; -+ int ret=0; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("rtw_del_sta=" MAC_FMT "\n", MAC_ARG(param->sta_addr)); -+ -+ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) -+ { -+ return -EINVAL; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if(psta) -+ { -+ u8 updated; -+ -+ //DBG_871X("free psta=%p, aid=%d\n", psta, psta->aid); -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ if(rtw_is_list_empty(&psta->asoc_list)==false) -+ { -+ rtw_list_delete(&psta->asoc_list); -+ pstapriv->asoc_list_cnt--; -+ updated = ap_free_sta(padapter, psta, true, WLAN_REASON_DEAUTH_LEAVING); -+ -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ associated_clients_update(padapter, updated); -+ -+ psta = NULL; -+ -+ } -+ else -+ { -+ DBG_871X("rtw_del_sta(), sta has already been removed or never been added\n"); -+ -+ //ret = -1; -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_ioctl_get_sta_data(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret=0; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct ieee_param_ex *param_ex = (struct ieee_param_ex *)param; -+ struct sta_data *psta_data = (struct sta_data *)param_ex->data; -+ -+ DBG_871X("rtw_ioctl_get_sta_info, sta_addr: " MAC_FMT "\n", MAC_ARG(param_ex->sta_addr)); -+ -+ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) -+ { -+ return -EINVAL; -+ } -+ -+ if (param_ex->sta_addr[0] == 0xff && param_ex->sta_addr[1] == 0xff && -+ param_ex->sta_addr[2] == 0xff && param_ex->sta_addr[3] == 0xff && -+ param_ex->sta_addr[4] == 0xff && param_ex->sta_addr[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, param_ex->sta_addr); -+ if(psta) -+ { -+#if 0 -+ struct { -+ u16 aid; -+ u16 capability; -+ int flags; -+ u32 sta_set; -+ u8 tx_supp_rates[16]; -+ u32 tx_supp_rates_len; -+ struct rtw_ieee80211_ht_cap ht_cap; -+ u64 rx_pkts; -+ u64 rx_bytes; -+ u64 rx_drops; -+ u64 tx_pkts; -+ u64 tx_bytes; -+ u64 tx_drops; -+ } get_sta; -+#endif -+ psta_data->aid = (u16)psta->aid; -+ psta_data->capability = psta->capability; -+ psta_data->flags = psta->flags; -+ -+/* -+ nonerp_set : BIT(0) -+ no_short_slot_time_set : BIT(1) -+ no_short_preamble_set : BIT(2) -+ no_ht_gf_set : BIT(3) -+ no_ht_set : BIT(4) -+ ht_20mhz_set : BIT(5) -+*/ -+ -+ psta_data->sta_set =((psta->nonerp_set) | -+ (psta->no_short_slot_time_set <<1) | -+ (psta->no_short_preamble_set <<2) | -+ (psta->no_ht_gf_set <<3) | -+ (psta->no_ht_set <<4) | -+ (psta->ht_20mhz_set <<5)); -+ -+ psta_data->tx_supp_rates_len = psta->bssratelen; -+ _rtw_memcpy(psta_data->tx_supp_rates, psta->bssrateset, psta->bssratelen); -+#ifdef CONFIG_80211N_HT -+ _rtw_memcpy(&psta_data->ht_cap, &psta->htpriv.ht_cap, sizeof(struct rtw_ieee80211_ht_cap)); -+#endif //CONFIG_80211N_HT -+ psta_data->rx_pkts = psta->sta_stats.rx_data_pkts; -+ psta_data->rx_bytes = psta->sta_stats.rx_bytes; -+ psta_data->rx_drops = psta->sta_stats.rx_drops; -+ -+ psta_data->tx_pkts = psta->sta_stats.tx_pkts; -+ psta_data->tx_bytes = psta->sta_stats.tx_bytes; -+ psta_data->tx_drops = psta->sta_stats.tx_drops; -+ -+ -+ } -+ else -+ { -+ ret = -1; -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_get_sta_wpaie(struct net_device *dev, struct ieee_param *param) -+{ -+ int ret=0; -+ struct sta_info *psta = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ DBG_871X("rtw_get_sta_wpaie, sta_addr: " MAC_FMT "\n", MAC_ARG(param->sta_addr)); -+ -+ if(check_fwstate(pmlmepriv, (_FW_LINKED|WIFI_AP_STATE)) != true) -+ { -+ return -EINVAL; -+ } -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ psta = rtw_get_stainfo(pstapriv, param->sta_addr); -+ if(psta) -+ { -+ if((psta->wpa_ie[0] == WLAN_EID_RSN) || (psta->wpa_ie[0] == WLAN_EID_GENERIC)) -+ { -+ int wpa_ie_len; -+ int copy_len; -+ -+ wpa_ie_len = psta->wpa_ie[1]; -+ -+ copy_len = ((wpa_ie_len+2) > sizeof(psta->wpa_ie)) ? (sizeof(psta->wpa_ie)):(wpa_ie_len+2); -+ -+ param->u.wpa_ie.len = copy_len; -+ -+ _rtw_memcpy(param->u.wpa_ie.reserved, psta->wpa_ie, copy_len); -+ } -+ else -+ { -+ //ret = -1; -+ DBG_871X("sta's wpa_ie is NONE\n"); -+ } -+ } -+ else -+ { -+ ret = -1; -+ } -+ -+ return ret; -+ -+} -+ -+static int rtw_set_wps_beacon(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret=0; -+ unsigned char wps_oui[4]={0x0,0x50,0xf2,0x04}; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ int ie_len; -+ -+ DBG_871X("%s, len=%d\n", __FUNCTION__, len); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ ie_len = len-12-2;// 12 = param header, 2:no packed -+ -+ -+ if(pmlmepriv->wps_beacon_ie) -+ { -+ rtw_mfree(pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len); -+ pmlmepriv->wps_beacon_ie = NULL; -+ } -+ -+ if(ie_len>0) -+ { -+ pmlmepriv->wps_beacon_ie = rtw_malloc(ie_len); -+ pmlmepriv->wps_beacon_ie_len = ie_len; -+ if ( pmlmepriv->wps_beacon_ie == NULL) { -+ DBG_871X("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ } -+ -+ _rtw_memcpy(pmlmepriv->wps_beacon_ie, param->u.bcn_ie.buf, ie_len); -+ -+ update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, true); -+ -+ pmlmeext->bstart_bss = true; -+ -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_set_wps_probe_resp(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ int ie_len; -+ -+ DBG_871X("%s, len=%d\n", __FUNCTION__, len); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ ie_len = len-12-2;// 12 = param header, 2:no packed -+ -+ -+ if(pmlmepriv->wps_probe_resp_ie) -+ { -+ rtw_mfree(pmlmepriv->wps_probe_resp_ie, pmlmepriv->wps_probe_resp_ie_len); -+ pmlmepriv->wps_probe_resp_ie = NULL; -+ } -+ -+ if(ie_len>0) -+ { -+ pmlmepriv->wps_probe_resp_ie = rtw_malloc(ie_len); -+ pmlmepriv->wps_probe_resp_ie_len = ie_len; -+ if ( pmlmepriv->wps_probe_resp_ie == NULL) { -+ DBG_871X("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ } -+ _rtw_memcpy(pmlmepriv->wps_probe_resp_ie, param->u.bcn_ie.buf, ie_len); -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_set_wps_assoc_resp(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ int ie_len; -+ -+ DBG_871X("%s, len=%d\n", __FUNCTION__, len); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ ie_len = len-12-2;// 12 = param header, 2:no packed -+ -+ -+ if(pmlmepriv->wps_assoc_resp_ie) -+ { -+ rtw_mfree(pmlmepriv->wps_assoc_resp_ie, pmlmepriv->wps_assoc_resp_ie_len); -+ pmlmepriv->wps_assoc_resp_ie = NULL; -+ } -+ -+ if(ie_len>0) -+ { -+ pmlmepriv->wps_assoc_resp_ie = rtw_malloc(ie_len); -+ pmlmepriv->wps_assoc_resp_ie_len = ie_len; -+ if ( pmlmepriv->wps_assoc_resp_ie == NULL) { -+ DBG_871X("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ return -EINVAL; -+ } -+ -+ _rtw_memcpy(pmlmepriv->wps_assoc_resp_ie, param->u.bcn_ie.buf, ie_len); -+ } -+ -+ -+ return ret; -+ -+} -+ -+static int rtw_set_hidden_ssid(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret=0; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *mlmepriv = &(adapter->mlmepriv); -+ struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); -+ struct mlme_ext_info *mlmeinfo = &(mlmeext->mlmext_info); -+ int ie_len; -+ u8 *ssid_ie; -+ char ssid[NDIS_802_11_LENGTH_SSID + 1]; -+ sint ssid_len; -+ u8 ignore_broadcast_ssid; -+ -+ if(check_fwstate(mlmepriv, WIFI_AP_STATE) != true) -+ return -EPERM; -+ -+ if (param->u.bcn_ie.reserved[0] != 0xea) -+ return -EINVAL; -+ -+ mlmeinfo->hidden_ssid_mode = ignore_broadcast_ssid = param->u.bcn_ie.reserved[1]; -+ -+ ie_len = len-12-2;// 12 = param header, 2:no packed -+ ssid_ie = rtw_get_ie(param->u.bcn_ie.buf, WLAN_EID_SSID, &ssid_len, ie_len); -+ -+ if (ssid_ie && ssid_len) { -+ WLAN_BSSID_EX *pbss_network = &mlmepriv->cur_network.network; -+ WLAN_BSSID_EX *pbss_network_ext = &mlmeinfo->network; -+ -+ _rtw_memcpy(ssid, ssid_ie+2, ssid_len); -+ ssid[ssid_len>NDIS_802_11_LENGTH_SSID?NDIS_802_11_LENGTH_SSID:ssid_len] = 0x0; -+ -+ if(0) -+ DBG_871X(FUNC_ADPT_FMT" ssid:(%s,%d), from ie:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ ssid, ssid_len, -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, -+ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); -+ -+ _rtw_memcpy(pbss_network->Ssid.Ssid, (void *)ssid, ssid_len); -+ pbss_network->Ssid.SsidLength = ssid_len; -+ _rtw_memcpy(pbss_network_ext->Ssid.Ssid, (void *)ssid, ssid_len); -+ pbss_network_ext->Ssid.SsidLength = ssid_len; -+ -+ if(0) -+ DBG_871X(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter), -+ pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength, -+ pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); -+ } -+ -+ DBG_871X(FUNC_ADPT_FMT" ignore_broadcast_ssid:%d, %s,%d\n", FUNC_ADPT_ARG(adapter), -+ ignore_broadcast_ssid, ssid, ssid_len); -+ -+ return ret; -+} -+ -+static int rtw_ioctl_acl_remove_sta(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ ret = rtw_acl_remove_sta(padapter, param->sta_addr); -+ -+ return ret; -+ -+} -+ -+static int rtw_ioctl_acl_add_sta(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && -+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && -+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) -+ { -+ return -EINVAL; -+ } -+ -+ ret = rtw_acl_add_sta(padapter, param->sta_addr); -+ -+ return ret; -+ -+} -+ -+static int rtw_ioctl_set_macaddr_acl(struct net_device *dev, struct ieee_param *param, int len) -+{ -+ int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != true) -+ return -EINVAL; -+ -+ rtw_set_macaddr_acl(padapter, param->u.mlme.command); -+ -+ return ret; -+} -+ -+static int rtw_hostapd_ioctl(struct net_device *dev, struct iw_point *p) -+{ -+ struct ieee_param *param; -+ int ret=0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ /* -+ * this function is expect to call in master mode, which allows no power saving -+ * so, we just check hw_init_completed -+ */ -+ -+ if (padapter->hw_init_completed==false){ -+ ret = -EPERM; -+ goto out; -+ } -+ -+ -+ //if (p->length < sizeof(struct ieee_param) || !p->pointer){ -+ if(!p->pointer){ -+ ret = -EINVAL; -+ goto out; -+ } -+ -+ param = (struct ieee_param *)rtw_malloc(p->length); -+ if (param == NULL) -+ { -+ ret = -ENOMEM; -+ goto out; -+ } -+ -+ if (copy_from_user(param, p->pointer, p->length)) -+ { -+ rtw_mfree((u8*)param, p->length); -+ ret = -EFAULT; -+ goto out; -+ } -+ -+ //DBG_871X("%s, cmd=%d\n", __FUNCTION__, param->cmd); -+ -+ switch (param->cmd) -+ { -+ case RTL871X_HOSTAPD_FLUSH: -+ -+ ret = rtw_hostapd_sta_flush(dev); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_ADD_STA: -+ -+ ret = rtw_add_sta(dev, param); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_REMOVE_STA: -+ -+ ret = rtw_del_sta(dev, param); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_BEACON: -+ -+ ret = rtw_set_beacon(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_SET_ENCRYPTION: -+ -+ ret = rtw_set_encryption(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_GET_WPAIE_STA: -+ -+ ret = rtw_get_sta_wpaie(dev, param); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_WPS_BEACON: -+ -+ ret = rtw_set_wps_beacon(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_WPS_PROBE_RESP: -+ -+ ret = rtw_set_wps_probe_resp(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_WPS_ASSOC_RESP: -+ -+ ret = rtw_set_wps_assoc_resp(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_HIDDEN_SSID: -+ -+ ret = rtw_set_hidden_ssid(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_GET_INFO_STA: -+ -+ ret = rtw_ioctl_get_sta_data(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_SET_MACADDR_ACL: -+ -+ ret = rtw_ioctl_set_macaddr_acl(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_ACL_ADD_STA: -+ -+ ret = rtw_ioctl_acl_add_sta(dev, param, p->length); -+ -+ break; -+ -+ case RTL871X_HOSTAPD_ACL_REMOVE_STA: -+ -+ ret = rtw_ioctl_acl_remove_sta(dev, param, p->length); -+ -+ break; -+ -+ default: -+ DBG_871X("Unknown hostapd request: %d\n", param->cmd); -+ ret = -EOPNOTSUPP; -+ break; -+ -+ } -+ -+ if (ret == 0 && copy_to_user(p->pointer, param, p->length)) -+ ret = -EFAULT; -+ -+ -+ rtw_mfree((u8 *)param, p->length); -+ -+out: -+ -+ return ret; -+ -+} -+#endif -+ -+static int rtw_wx_set_priv(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *awrq, -+ char *extra) -+{ -+ -+#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ char *ext_dbg; -+#endif -+ -+ int ret = 0; -+ int len = 0; -+ char *ext; -+ int i; -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_point *dwrq = (struct iw_point*)awrq; -+ -+ //RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_notice_, ("+rtw_wx_set_priv\n")); -+ if(dwrq->length == 0) -+ return -EFAULT; -+ -+ len = dwrq->length; -+ if (!(ext = rtw_vmalloc(len))) -+ return -ENOMEM; -+ -+ if (copy_from_user(ext, dwrq->pointer, len)) { -+ rtw_vmfree(ext, len); -+ return -EFAULT; -+ } -+ -+ -+ //RT_TRACE(_module_rtl871x_ioctl_os_c, _drv_notice_, -+ // ("rtw_wx_set_priv: %s req=%s\n", -+ // dev->name, ext)); -+ -+ #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ if (!(ext_dbg = rtw_vmalloc(len))) -+ { -+ rtw_vmfree(ext, len); -+ return -ENOMEM; -+ } -+ -+ _rtw_memcpy(ext_dbg, ext, len); -+ #endif -+ -+ //added for wps2.0 @20110524 -+ if(dwrq->flags == 0x8766 && len > 8) -+ { -+ u32 cp_sz; -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ u8 *probereq_wpsie = ext; -+ int probereq_wpsie_len = len; -+ u8 wps_oui[4]={0x0,0x50,0xf2,0x04}; -+ -+ if((_VENDOR_SPECIFIC_IE_ == probereq_wpsie[0]) && -+ (_rtw_memcmp(&probereq_wpsie[2], wps_oui, 4) ==true)) -+ { -+ cp_sz = probereq_wpsie_len>MAX_WPS_IE_LEN ? MAX_WPS_IE_LEN:probereq_wpsie_len; -+ -+ //_rtw_memcpy(pmlmepriv->probereq_wpsie, probereq_wpsie, cp_sz); -+ //pmlmepriv->probereq_wpsie_len = cp_sz; -+ if(pmlmepriv->wps_probe_req_ie) -+ { -+ u32 free_len = pmlmepriv->wps_probe_req_ie_len; -+ pmlmepriv->wps_probe_req_ie_len = 0; -+ rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len); -+ pmlmepriv->wps_probe_req_ie = NULL; -+ } -+ -+ pmlmepriv->wps_probe_req_ie = rtw_malloc(cp_sz); -+ if ( pmlmepriv->wps_probe_req_ie == NULL) { -+ printk("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__); -+ ret = -EINVAL; -+ goto FREE_EXT; -+ -+ } -+ -+ _rtw_memcpy(pmlmepriv->wps_probe_req_ie, probereq_wpsie, cp_sz); -+ pmlmepriv->wps_probe_req_ie_len = cp_sz; -+ -+ } -+ -+ goto FREE_EXT; -+ -+ } -+ -+ if( len >= WEXT_CSCAN_HEADER_SIZE -+ && _rtw_memcmp(ext, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == true -+ ){ -+ ret = rtw_wx_set_scan(dev, info, awrq, ext); -+ goto FREE_EXT; -+ } -+ -+#ifdef CONFIG_ANDROID -+ //DBG_871X("rtw_wx_set_priv: %s req=%s\n", dev->name, ext); -+ -+ i = rtw_android_cmdstr_to_num(ext); -+ -+ switch(i) { -+ case ANDROID_WIFI_CMD_START : -+ indicate_wx_custom_event(padapter, "START"); -+ break; -+ case ANDROID_WIFI_CMD_STOP : -+ indicate_wx_custom_event(padapter, "STOP"); -+ break; -+ case ANDROID_WIFI_CMD_RSSI : -+ { -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *pcur_network = &pmlmepriv->cur_network; -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == true) { -+ sprintf(ext, "%s rssi %d", pcur_network->network.Ssid.Ssid, padapter->recvpriv.rssi); -+ } else { -+ sprintf(ext, "OK"); -+ } -+ } -+ break; -+ case ANDROID_WIFI_CMD_LINKSPEED : -+ { -+ u16 mbps = rtw_get_cur_max_rate(padapter)/10; -+ sprintf(ext, "LINKSPEED %d", mbps); -+ } -+ break; -+ case ANDROID_WIFI_CMD_MACADDR : -+ sprintf(ext, "MACADDR = " MAC_FMT, MAC_ARG(dev->dev_addr)); -+ break; -+ case ANDROID_WIFI_CMD_SCAN_ACTIVE : -+ { -+ //rtw_set_scan_mode(padapter, SCAN_ACTIVE); -+ sprintf(ext, "OK"); -+ } -+ break; -+ case ANDROID_WIFI_CMD_SCAN_PASSIVE : -+ { -+ //rtw_set_scan_mode(padapter, SCAN_PASSIVE); -+ sprintf(ext, "OK"); -+ } -+ break; -+ -+ case ANDROID_WIFI_CMD_COUNTRY : -+ { -+ char country_code[10]; -+ sscanf(ext, "%*s %s", country_code); -+ rtw_set_country(padapter, country_code); -+ sprintf(ext, "OK"); -+ } -+ break; -+ default : -+ #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ DBG_871X("%s: %s unknowned req=%s\n", __FUNCTION__, -+ dev->name, ext_dbg); -+ #endif -+ -+ sprintf(ext, "OK"); -+ -+ } -+ -+ if (copy_to_user(dwrq->pointer, ext, min(dwrq->length, (u16)(strlen(ext)+1)) ) ) -+ ret = -EFAULT; -+ -+ #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ DBG_871X("%s: %s req=%s rep=%s dwrq->length=%d, strlen(ext)+1=%d\n", __FUNCTION__, -+ dev->name, ext_dbg ,ext, dwrq->length, (u16)(strlen(ext)+1)); -+ #endif -+#endif //end of CONFIG_ANDROID -+ -+ -+FREE_EXT: -+ -+ rtw_vmfree(ext, len); -+ #ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV -+ rtw_vmfree(ext_dbg, len); -+ #endif -+ -+ //DBG_871X("rtw_wx_set_priv: (SIOCSIWPRIV) %s ret=%d\n", -+ // dev->name, ret); -+ -+ return ret; -+ -+} -+ -+static int rtw_pm_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ unsigned mode = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X( "[%s] extra = %s\n", __FUNCTION__, extra ); -+ -+ if ( _rtw_memcmp( extra, "lps=", 4 ) ) -+ { -+ sscanf(extra+4, "%u", &mode); -+ ret = rtw_pm_set_lps(padapter,mode); -+ } -+ else if ( _rtw_memcmp( extra, "ips=", 4 ) ) -+ { -+ sscanf(extra+4, "%u", &mode); -+ ret = rtw_pm_set_ips(padapter,mode); -+ } -+ else{ -+ ret = -EINVAL; -+ } -+ -+ return ret; -+} -+ -+static int rtw_mp_efuse_get(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wdata, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); -+ PEFUSE_HAL pEfuseHal; -+ struct iw_point *wrqu; -+ -+ u8 *PROMContent = pEEPROM->efuse_eeprom_data; -+ u8 ips_mode,lps_mode; -+ struct pwrctrl_priv *pwrctrlpriv ; -+ u8 *data = NULL; -+ u8 *rawdata = NULL; -+ char *pch, *ptmp, *token, *tmp[3]={NULL, NULL, NULL}; -+ u16 i=0, j=0, mapLen=0, addr=0, cnts=0; -+ u16 max_available_size=0, raw_cursize=0, raw_maxsize=0; -+ int err; -+ #ifdef CONFIG_IOL -+ u8 org_fw_iol = padapter->registrypriv.fw_iol;// 0:Disable, 1:enable, 2:by usb speed -+ #endif -+ -+ wrqu = (struct iw_point*)wdata; -+ pwrctrlpriv = &padapter->pwrctrlpriv; -+ pEfuseHal = &pHalData->EfuseHal; -+ -+ err = 0; -+ data = _rtw_zmalloc(EFUSE_BT_MAX_MAP_LEN); -+ if (data == NULL) -+ { -+ err = -ENOMEM; -+ goto exit; -+ } -+ rawdata = _rtw_zmalloc(EFUSE_BT_MAX_MAP_LEN); -+ if (rawdata == NULL) -+ { -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) -+ { -+ err = -EFAULT; -+ goto exit; -+ } -+ #ifdef CONFIG_LPS -+ lps_mode = pwrctrlpriv->power_mgnt;//keep org value -+ rtw_pm_set_lps(padapter,PS_MODE_ACTIVE); -+ #endif -+ -+ #ifdef CONFIG_IPS -+ ips_mode = pwrctrlpriv->ips_mode;//keep org value -+ rtw_pm_set_ips(padapter,IPS_NONE); -+ #endif -+ -+ pch = extra; -+ DBG_871X("%s: in=%s\n", __FUNCTION__, extra); -+ -+ i = 0; -+ //mac 16 "00e04c871200" rmap,00,2 -+ while ((token = strsep(&pch, ",")) != NULL) -+ { -+ if (i > 2) break; -+ tmp[i] = token; -+ i++; -+ } -+ #ifdef CONFIG_IOL -+ padapter->registrypriv.fw_iol = 0;// 0:Disable, 1:enable, 2:by usb speed -+ #endif -+ -+ if(strcmp(tmp[0], "status") == 0){ -+ sprintf(extra, "Load File efuse=%s,Load File MAC=%s",(pEEPROM->bloadfile_fail_flag? "FAIL" : "OK"),(pEEPROM->bloadmac_fail_flag? "FAIL" : "OK")); -+ -+ goto exit; -+ } -+ else if (strcmp(tmp[0], "filemap") == 0) -+ { -+ mapLen = EFUSE_MAP_SIZE; -+ -+ sprintf(extra, "\n"); -+ for (i = 0; i < EFUSE_MAP_SIZE; i += 16) -+ { -+// DBG_871X("0x%02x\t", i); -+ sprintf(extra, "%s0x%02x\t", extra, i); -+ for (j=0; j<8; j++) { -+// DBG_871X("%02X ", data[i+j]); -+ sprintf(extra, "%s%02X ", extra, PROMContent[i+j]); -+ } -+// DBG_871X("\t"); -+ sprintf(extra, "%s\t", extra); -+ for (; j<16; j++) { -+// DBG_871X("%02X ", data[i+j]); -+ sprintf(extra, "%s%02X ", extra, PROMContent[i+j]); -+ } -+// DBG_871X("\n"); -+ sprintf(extra,"%s\n",extra); -+ } -+// DBG_871X("\n"); -+ } -+ else if (strcmp(tmp[0], "realmap") == 0) -+ { -+ mapLen = EFUSE_MAP_SIZE; -+ if (rtw_efuse_map_read(padapter, 0, mapLen, pEfuseHal->fakeEfuseInitMap) == _FAIL) -+ { -+ DBG_871X("%s: read realmap Fail!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+// DBG_871X("OFFSET\tVALUE(hex)\n"); -+ sprintf(extra, "\n"); -+ for (i = 0; i < EFUSE_MAP_SIZE; i += 16) -+ { -+// DBG_871X("0x%02x\t", i); -+ sprintf(extra, "%s0x%02x\t", extra, i); -+ for (j=0; j<8 && i+jfakeEfuseInitMap[i+j]); -+ } -+// DBG_871X("\t"); -+ sprintf(extra, "%s\t", extra); -+ for (; j<16 && i+jfakeEfuseInitMap[i+j]); -+ } -+// DBG_871X("\n"); -+ sprintf(extra,"%s\n",extra); -+ } -+// DBG_871X("\n"); -+ } -+ else if (strcmp(tmp[0], "rmap") == 0) -+ { -+ if ((tmp[1]==NULL) || (tmp[2]==NULL)) -+ { -+ DBG_871X("%s: rmap Fail!! Parameters error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ // rmap addr cnts -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ DBG_871X("%s: addr=%x\n", __FUNCTION__, addr); -+ -+ cnts = simple_strtoul(tmp[2], &ptmp, 10); -+ if (cnts == 0) -+ { -+ DBG_871X("%s: rmap Fail!! cnts error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); -+ if ((addr + cnts) > max_available_size) -+ { -+ DBG_871X("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ if (rtw_efuse_map_read(padapter, addr, cnts, data) == _FAIL) -+ { -+ DBG_871X("%s: rtw_efuse_map_read error!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+// DBG_871X("%s: data={", __FUNCTION__); -+ *extra = 0; -+ for (i=0; i max_available_size) { -+ DBG_871X("%s: addr(0x%02x)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_efuse_map_read(padapter, addr, cnts, data) == _FAIL) -+ { -+ DBG_871X("%s: rtw_efuse_map_read error!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ *extra = 0; -+ for (i=0; i max_available_size) -+ { -+ DBG_871X("%s: addr(0x%02x)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ if (rtw_efuse_map_read(padapter, addr, cnts, data) == _FAIL) -+ { -+ DBG_871X("%s: rtw_efuse_access error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ *extra = 0; -+ for (i=0; iBTEfuseInitMap) == _FAIL) -+ { -+ DBG_871X("%s: rtw_BT_efuse_map_read Fail!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+// DBG_871X("OFFSET\tVALUE(hex)\n"); -+ sprintf(extra, "\n"); -+ for (i=0; i<512; i+=16) // set 512 because the iwpriv's extra size have limit 0x7FF -+ { -+// DBG_871X("0x%03x\t", i); -+ sprintf(extra, "%s0x%03x\t", extra, i); -+ for (j=0; j<8; j++) { -+// DBG_871X("%02X ", pEfuseHal->BTEfuseInitMap[i+j]); -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i+j]); -+ } -+// DBG_871X("\t"); -+ sprintf(extra,"%s\t",extra); -+ for (; j<16; j++) { -+// DBG_871X("%02X ", pEfuseHal->BTEfuseInitMap[i+j]); -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i+j]); -+ } -+// DBG_871X("\n"); -+ sprintf(extra, "%s\n", extra); -+ } -+// DBG_871X("\n"); -+ } -+ else if (strcmp(tmp[0],"btbmap") == 0) -+ { -+ mapLen = EFUSE_BT_MAX_MAP_LEN; -+ if (rtw_BT_efuse_map_read(padapter, 0, mapLen, pEfuseHal->BTEfuseInitMap) == _FAIL) -+ { -+ DBG_871X("%s: rtw_BT_efuse_map_read Fail!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+// DBG_871X("OFFSET\tVALUE(hex)\n"); -+ sprintf(extra, "\n"); -+ for (i=512; i<1024 ; i+=16) -+ { -+// DBG_871X("0x%03x\t", i); -+ sprintf(extra, "%s0x%03x\t", extra, i); -+ for (j=0; j<8; j++) -+ { -+// DBG_871X("%02X ", data[i+j]); -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i+j]); -+ } -+// DBG_871X("\t"); -+ sprintf(extra,"%s\t",extra); -+ for (; j<16; j++) { -+// DBG_871X("%02X ", data[i+j]); -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i+j]); -+ } -+// DBG_871X("\n"); -+ sprintf(extra, "%s\n", extra); -+ } -+// DBG_871X("\n"); -+ } -+ else if (strcmp(tmp[0],"btrmap") == 0) -+ { -+ if ((tmp[1]==NULL) || (tmp[2]==NULL)) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ // rmap addr cnts -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ DBG_871X("%s: addr=0x%X\n", __FUNCTION__, addr); -+ -+ cnts = simple_strtoul(tmp[2], &ptmp, 10); -+ if (cnts == 0) -+ { -+ DBG_871X("%s: btrmap Fail!! cnts error!\n", __FUNCTION__); -+ err = -EINVAL; -+ goto exit; -+ } -+ DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); -+ if ((addr + cnts) > max_available_size) -+ { -+ DBG_871X("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_BT_efuse_map_read(padapter, addr, cnts, data) == _FAIL) -+ { -+ DBG_871X("%s: rtw_BT_efuse_map_read error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ *extra = 0; -+// DBG_871X("%s: bt efuse data={", __FUNCTION__); -+ for (i=0; ifakeBTEfuseModifiedMap[i+j]); -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ } -+// DBG_871X("\t"); -+ sprintf(extra, "%s\t", extra); -+ for (; j<16; j++) { -+// DBG_871X("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ } -+// DBG_871X("\n"); -+ sprintf(extra, "%s\n", extra); -+ } -+// DBG_871X("\n"); -+ } -+ else if (strcmp(tmp[0],"btbfake") == 0) -+ { -+// DBG_871X("OFFSET\tVALUE(hex)\n"); -+ sprintf(extra, "\n"); -+ for (i=512; i<1024; i+=16) -+ { -+// DBG_871X("0x%03x\t", i); -+ sprintf(extra, "%s0x%03x\t", extra, i); -+ for (j=0; j<8; j++) { -+// DBG_871X("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ } -+// DBG_871X("\t"); -+ sprintf(extra, "%s\t", extra); -+ for (; j<16; j++) { -+// DBG_871X("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i+j]); -+ } -+// DBG_871X("\n"); -+ sprintf(extra, "%s\n", extra); -+ } -+// DBG_871X("\n"); -+ } -+ else if (strcmp(tmp[0],"wlrfkmap")== 0) -+ { -+// DBG_871X("OFFSET\tVALUE(hex)\n"); -+ sprintf(extra, "\n"); -+ for (i=0; ifakeEfuseModifiedMap[i+j]); -+ sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeEfuseModifiedMap[i+j]); -+ } -+// DBG_871X("\t"); -+ sprintf(extra, "%s\t", extra); -+ for (; j<16 && i+jfakeEfuseModifiedMap[i+j]); -+ sprintf(extra, "%s %02X", extra, pEfuseHal->fakeEfuseModifiedMap[i+j]); -+ } -+// DBG_871X("\n"); -+ sprintf(extra, "%s\n", extra); -+ } -+// DBG_871X("\n"); -+ } -+ else -+ { -+ sprintf(extra, "Command not found!"); -+ } -+ -+exit: -+ if (data) -+ _rtw_mfree(data, EFUSE_BT_MAX_MAP_LEN); -+ if (rawdata) -+ _rtw_mfree(rawdata, EFUSE_BT_MAX_MAP_LEN); -+ if (!err) -+ wrqu->length = strlen(extra); -+ -+ #ifdef CONFIG_IPS -+ rtw_pm_set_ips(padapter, ips_mode); -+ #endif -+ #ifdef CONFIG_LPS -+ rtw_pm_set_lps(padapter, lps_mode); -+ #endif -+ #ifdef CONFIG_IOL -+ padapter->registrypriv.fw_iol = org_fw_iol;// 0:Disable, 1:enable, 2:by usb speed -+ #endif -+ return err; -+} -+ -+static int rtw_mp_efuse_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wdata, char *extra) -+{ -+ struct iw_point *wrqu; -+ PADAPTER padapter; -+ struct pwrctrl_priv *pwrctrlpriv ; -+ PHAL_DATA_TYPE pHalData; -+ PEFUSE_HAL pEfuseHal; -+ -+ u8 ips_mode,lps_mode; -+ u32 i, jj, kk; -+ u8 *setdata = NULL; -+ u8 *ShadowMapBT = NULL; -+ u8 *ShadowMapWiFi = NULL; -+ u8 *setrawdata = NULL; -+ char *pch, *ptmp, *token, *tmp[3]={NULL, NULL, NULL}; -+ u16 addr=0, cnts=0, max_available_size=0; -+ int err; -+ -+ -+ wrqu = (struct iw_point*)wdata; -+ padapter = rtw_netdev_priv(dev); -+ pwrctrlpriv = &padapter->pwrctrlpriv; -+ pHalData = GET_HAL_DATA(padapter); -+ pEfuseHal = &pHalData->EfuseHal; -+ err = 0; -+ setdata = _rtw_zmalloc(1024); -+ if (setdata == NULL) -+ { -+ err = -ENOMEM; -+ goto exit; -+ } -+ ShadowMapBT = _rtw_malloc(EFUSE_BT_MAX_MAP_LEN); -+ if (ShadowMapBT == NULL) -+ { -+ err = -ENOMEM; -+ goto exit; -+ } -+ ShadowMapWiFi = _rtw_malloc(EFUSE_MAP_SIZE); -+ if (ShadowMapWiFi == NULL) -+ { -+ err = -ENOMEM; -+ goto exit; -+ } -+ setrawdata = _rtw_malloc(EFUSE_MAX_SIZE); -+ if (setrawdata == NULL) -+ { -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ #ifdef CONFIG_LPS -+ lps_mode = pwrctrlpriv->power_mgnt;//keep org value -+ rtw_pm_set_lps(padapter,PS_MODE_ACTIVE); -+ #endif -+ -+ #ifdef CONFIG_IPS -+ ips_mode = pwrctrlpriv->ips_mode;//keep org value -+ rtw_pm_set_ips(padapter,IPS_NONE); -+ #endif -+ -+ pch = extra; -+ DBG_871X("%s: in=%s\n", __FUNCTION__, extra); -+ -+ i = 0; -+ while ((token = strsep(&pch, ",")) != NULL) -+ { -+ if (i > 2) break; -+ tmp[i] = token; -+ i++; -+ } -+ -+ // tmp[0],[1],[2] -+ // wmap,addr,00e04c871200 -+ if (strcmp(tmp[0], "wmap") == 0) -+ { -+ if ((tmp[1]==NULL) || (tmp[2]==NULL)) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ addr &= 0xFFF; -+ -+ cnts = strlen(tmp[2]); -+ if (cnts%2) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ DBG_871X("%s: addr=0x%X\n", __FUNCTION__, addr); -+ DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); -+ DBG_871X("%s: map data=%s\n", __FUNCTION__, tmp[2]); -+ -+ for (jj=0, kk=0; jj max_available_size) -+ { -+ DBG_871X("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) -+ { -+ DBG_871X("%s: rtw_efuse_map_write error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ } -+ else if (strcmp(tmp[0], "wraw") == 0) -+ { -+ if ((tmp[1]==NULL) || (tmp[2]==NULL)) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ addr = simple_strtoul( tmp[1], &ptmp, 16 ); -+ addr &= 0xFFF; -+ -+ cnts = strlen(tmp[2]); -+ if (cnts%2) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ DBG_871X("%s: addr=0x%X\n", __FUNCTION__, addr); -+ DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); -+ DBG_871X("%s: raw data=%s\n", __FUNCTION__, tmp[2]); -+ -+ for (jj=0, kk=0; jj 6) -+ { -+ DBG_871X("%s: error data for mac addr=\"%s\"\n", __FUNCTION__, tmp[1]); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ DBG_871X("%s: addr=0x%X\n", __FUNCTION__, addr); -+ DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); -+ DBG_871X("%s: MAC address=%s\n", __FUNCTION__, tmp[1]); -+ -+ for (jj=0, kk=0; jj max_available_size) -+ { -+ DBG_871X("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) -+ { -+ DBG_871X("%s: rtw_efuse_map_write error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ } -+ else if (strcmp(tmp[0], "vidpid") == 0) -+ { -+ if (tmp[1]==NULL) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ // pidvid,da0b7881 -+ cnts = strlen(tmp[1]); -+ if (cnts%2) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ DBG_871X("%s: addr=0x%X\n", __FUNCTION__, addr); -+ DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); -+ DBG_871X("%s: VID/PID=%s\n", __FUNCTION__, tmp[1]); -+ -+ for (jj=0, kk=0; jj max_available_size) -+ { -+ DBG_871X("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) -+ { -+ DBG_871X("%s: rtw_efuse_map_write error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ } -+ else if (strcmp(tmp[0], "btwmap") == 0) -+ { -+ if ((tmp[1]==NULL) || (tmp[2]==NULL)) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ addr &= 0xFFF; -+ -+ cnts = strlen(tmp[2]); -+ if (cnts%2) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ DBG_871X("%s: addr=0x%X\n", __FUNCTION__, addr); -+ DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); -+ DBG_871X("%s: BT data=%s\n", __FUNCTION__, tmp[2]); -+ -+ for (jj=0, kk=0; jj max_available_size) -+ { -+ DBG_871X("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_BT_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) -+ { -+ DBG_871X("%s: rtw_BT_efuse_map_write error!!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ } -+ else if (strcmp(tmp[0], "btwfake") == 0) -+ { -+ if ((tmp[1]==NULL) || (tmp[2]==NULL)) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ addr &= 0xFFF; -+ -+ cnts = strlen(tmp[2]); -+ if (cnts%2) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ DBG_871X("%s: addr=0x%X\n", __FUNCTION__, addr); -+ DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); -+ DBG_871X("%s: BT tmp data=%s\n", __FUNCTION__, tmp[2]); -+ -+ for (jj=0, kk=0; jjfakeBTEfuseModifiedMap[addr+jj] = key_2char2num(tmp[2][kk], tmp[2][kk+1]); -+ } -+ } -+ else if (strcmp(tmp[0], "btdumpfake") == 0) -+ { -+ if (rtw_BT_efuse_map_read(padapter, 0, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseModifiedMap) == _SUCCESS) { -+ DBG_871X("%s: BT read all map success\n", __FUNCTION__); -+ } else { -+ DBG_871X("%s: BT read all map Fail!\n", __FUNCTION__); -+ err = -EFAULT; -+ } -+ } -+ else if (strcmp(tmp[0], "wldumpfake") == 0) -+ { -+ if (rtw_efuse_map_read(padapter, 0, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeEfuseModifiedMap) == _SUCCESS) { -+ DBG_871X("%s: BT read all map success \n", __FUNCTION__); -+ } else { -+ DBG_871X("%s: BT read all map Fail \n", __FUNCTION__); -+ err = -EFAULT; -+ } -+ } -+ else if (strcmp(tmp[0], "btfk2map") == 0) -+ { -+ _rtw_memcpy(pEfuseHal->BTEfuseModifiedMap, pEfuseHal->fakeBTEfuseModifiedMap, EFUSE_BT_MAX_MAP_LEN); -+ -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); -+ if (max_available_size < 1) -+ { -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_BT_efuse_map_write(padapter, 0x00, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseModifiedMap) == _FAIL) -+ { -+ DBG_871X("%s: rtw_BT_efuse_map_write error!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ } -+ else if (strcmp(tmp[0], "wlfk2map") == 0) -+ { -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); -+ if (max_available_size < 1) -+ { -+ err = -EFAULT; -+ goto exit; -+ } -+ -+ if (rtw_efuse_map_write(padapter, 0x00, EFUSE_MAX_MAP_LEN, pEfuseHal->fakeEfuseModifiedMap) == _FAIL) -+ { -+ DBG_871X("%s: rtw_efuse_map_write error!\n", __FUNCTION__); -+ err = -EFAULT; -+ goto exit; -+ } -+ } -+ else if (strcmp(tmp[0], "wlwfake") == 0) -+ { -+ if ((tmp[1]==NULL) || (tmp[2]==NULL)) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ addr = simple_strtoul(tmp[1], &ptmp, 16); -+ addr &= 0xFFF; -+ -+ cnts = strlen(tmp[2]); -+ if (cnts%2) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ cnts /= 2; -+ if (cnts == 0) -+ { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ DBG_871X("%s: addr=0x%X\n", __FUNCTION__, addr); -+ DBG_871X("%s: cnts=%d\n", __FUNCTION__, cnts); -+ DBG_871X("%s: map tmp data=%s\n", __FUNCTION__, tmp[2]); -+ -+ for (jj=0, kk=0; jjfakeEfuseModifiedMap[addr+jj] = key_2char2num(tmp[2][kk], tmp[2][kk+1]); -+ } -+ } -+ -+exit: -+ if (setdata) -+ _rtw_mfree(setdata, 1024); -+ if (ShadowMapBT) -+ _rtw_mfree(ShadowMapBT, EFUSE_BT_MAX_MAP_LEN); -+ if (ShadowMapWiFi) -+ _rtw_mfree(ShadowMapWiFi, EFUSE_MAP_SIZE); -+ if (setrawdata) -+ _rtw_mfree(setrawdata, EFUSE_MAX_SIZE); -+ -+ #ifdef CONFIG_IPS -+ rtw_pm_set_ips(padapter, ips_mode); -+ #endif -+ #ifdef CONFIG_LPS -+ rtw_pm_set_lps(padapter, lps_mode); -+ #endif -+ -+ return err; -+} -+ -+#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_MP_IWPRIV_SUPPORT) -+/* -+ * Input Format: %s,%d,%d -+ * %s is width, could be -+ * "b" for 1 byte -+ * "w" for WORD (2 bytes) -+ * "dw" for DWORD (4 bytes) -+ * 1st %d is address(offset) -+ * 2st %d is data to write -+ */ -+static int rtw_mp_write_reg(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ char *pch, *pnext, *ptmp; -+ char *width_str; -+ char width; -+ u32 addr, data; -+ int ret; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ -+ pch = extra; -+ pnext = strpbrk(pch, " ,.-"); -+ if (pnext == NULL) return -EINVAL; -+ *pnext = 0; -+ width_str = pch; -+ -+ pch = pnext + 1; -+ pnext = strpbrk(pch, " ,.-"); -+ if (pnext == NULL) return -EINVAL; -+ *pnext = 0; -+ addr = simple_strtoul(pch, &ptmp, 16); -+ if (addr > 0x3FFF) return -EINVAL; -+ -+ pch = pnext + 1; -+ if ((pch - extra) >= wrqu->length) return -EINVAL; -+ data = simple_strtoul(pch, &ptmp, 16); -+ -+ ret = 0; -+ width = width_str[0]; -+ switch (width) { -+ case 'b': -+ // 1 byte -+ if (data > 0xFF) { -+ ret = -EINVAL; -+ break; -+ } -+ rtw_write8(padapter, addr, data); -+ break; -+ case 'w': -+ // 2 bytes -+ if (data > 0xFFFF) { -+ ret = -EINVAL; -+ break; -+ } -+ rtw_write16(padapter, addr, data); -+ break; -+ case 'd': -+ // 4 bytes -+ rtw_write32(padapter, addr, data); -+ break; -+ default: -+ ret = -EINVAL; -+ break; -+ } -+ -+ return ret; -+} -+ -+/* -+ * Input Format: %s,%d -+ * %s is width, could be -+ * "b" for 1 byte -+ * "w" for WORD (2 bytes) -+ * "dw" for DWORD (4 bytes) -+ * %d is address(offset) -+ * -+ * Return: -+ * %d for data readed -+ */ -+static int rtw_mp_read_reg(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ char input[wrqu->length]; -+ char *pch, *pnext, *ptmp; -+ char *width_str; -+ char width; -+ char data[20],tmp[20]; -+ u32 addr; -+ //u32 *data = (u32*)extra; -+ u32 ret, i=0, j=0, strtout=0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ -+ if (wrqu->length > 128) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ _rtw_memset(data, 0, 20); -+ _rtw_memset(tmp, 0, 20); -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ pch = input; -+ pnext = strpbrk(pch, " ,.-"); -+ if (pnext == NULL) return -EINVAL; -+ *pnext = 0; -+ width_str = pch; -+ -+ pch = pnext + 1; -+ if ((pch - input) >= wrqu->length) return -EINVAL; -+ -+ addr = simple_strtoul(pch, &ptmp, 16); -+ if (addr > 0x3FFF) return -EINVAL; -+ -+ ret = 0; -+ width = width_str[0]; -+ switch (width) -+ { -+ case 'b': -+ // 1 byte -+ // *(u8*)data = rtw_read8(padapter, addr); -+ sprintf(extra, "%d\n", rtw_read8(padapter, addr)); -+ wrqu->length = strlen(extra); -+ break; -+ case 'w': -+ // 2 bytes -+ //*(u16*)data = rtw_read16(padapter, addr); -+ sprintf(data, "%04x\n", rtw_read16(padapter, addr)); -+ for (i = 0; i <= strlen(data); i++) { -+ if (i % 2 == 0) { -+ tmp[j] = ' '; -+ j++; -+ } -+ if (data[i] != '\0') { -+ tmp[j] = data[i]; -+ j++; -+ } -+ } -+ pch = tmp; -+ DBG_871X("pch=%s",pch); -+ -+ while( *pch != '\0' ) { -+ pnext = strpbrk(pch, " "); -+ if (!pnext) -+ break; -+ -+ pnext++; -+ if ( *pnext != '\0' ) { -+ strtout = simple_strtoul (pnext , &ptmp, 16); -+ sprintf( extra, "%s %d" ,extra ,strtout ); -+ } else { -+ break; -+ } -+ pch = pnext; -+ } -+ wrqu->length = 6; -+ break; -+ case 'd': -+ // 4 bytes -+ //*data = rtw_read32(padapter, addr); -+ sprintf(data, "%08x", rtw_read32(padapter, addr)); -+ //add read data format blank -+ for( i=0 ; i <= strlen(data) ; i++) -+ { -+ if( i%2==0 ) -+ { -+ tmp[j]=' '; -+ j++; -+ } -+ if ( data[i] != '\0' ) -+ tmp[j] = data[i]; -+ -+ j++; -+ } -+ pch = tmp; -+ DBG_871X("pch=%s",pch); -+ -+ while( *pch != '\0' ) -+ { -+ pnext = strpbrk(pch, " "); -+ if (!pnext) -+ break; -+ -+ pnext++; -+ if ( *pnext != '\0' ) -+ { -+ strtout = simple_strtoul (pnext , &ptmp, 16); -+ sprintf( extra, "%s %d" ,extra ,strtout ); -+ } -+ else{ -+ break; -+ } -+ pch = pnext; -+ } -+ wrqu->length = strlen(extra); -+ break; -+ -+ default: -+ wrqu->length = 0; -+ ret = -EINVAL; -+ break; -+ -+ } -+ -+ return ret; -+} -+ -+/* -+ * Input Format: %d,%x,%x -+ * %d is RF path, should be smaller than MAX_RF_PATH_NUMS -+ * 1st %x is address(offset) -+ * 2st %x is data to write -+ */ -+ static int rtw_mp_write_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+/*static int rtw_mp_write_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+*/ -+ u32 path, addr, data; -+ int ret; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ -+ ret = sscanf(extra, "%d,%x,%x", &path, &addr, &data); -+ if (ret < 3) return -EINVAL; -+ -+ if (path >= GET_HAL_RFPATH_NUM(padapter)) return -EINVAL; -+ if (addr > 0xFF) return -EINVAL; -+ if (data > 0xFFFFF) return -EINVAL; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ write_rfreg(padapter, path, addr, data); -+ -+ sprintf(extra, "write_rf completed \n"); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+/* -+ * Input Format: %d,%x -+ * %d is RF path, should be smaller than MAX_RF_PATH_NUMS -+ * %x is address(offset) -+ * -+ * Return: -+ * %d for data readed -+ */ -+static int rtw_mp_read_rf(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ char input[wrqu->length]; -+ char *pch, *pnext, *ptmp; -+ char data[20],tmp[20]; -+ //u32 *data = (u32*)extra; -+ u32 path, addr; -+ u32 ret,i=0 ,j=0,strtou=0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ -+ if (wrqu->length > 128) return -EFAULT; -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ ret = sscanf(input, "%d,%x", &path, &addr); -+ if (ret < 2) return -EINVAL; -+ -+ if (path >= GET_HAL_RFPATH_NUM(padapter)) return -EINVAL; -+ if (addr > 0xFF) return -EINVAL; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ //*data = read_rfreg(padapter, path, addr); -+ sprintf(data, "%08x", read_rfreg(padapter, path, addr)); -+ //add read data format blank -+ for( i=0 ; i <= strlen(data) ; i++) -+ { -+ if( i%2==0 ) -+ { -+ tmp[j]=' '; -+ j++; -+ } -+ tmp[j] = data[i]; -+ j++; -+ } -+ pch = tmp; -+ DBG_871X("pch=%s",pch); -+ -+ while( *pch != '\0' ) -+ { -+ pnext = strpbrk(pch, " "); -+ pnext++; -+ if ( *pnext != '\0' ) -+ { -+ strtou = simple_strtoul (pnext , &ptmp, 16); -+ sprintf( extra, "%s %d" ,extra ,strtou ); -+ } -+ else{ -+ break; -+ } -+ pch = pnext; -+ } -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+static int rtw_mp_start(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 val8; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if(padapter->registrypriv.mp_mode ==0) -+ { -+ padapter->registrypriv.mp_mode =1; -+ -+ rtw_pm_set_ips(padapter,IPS_NONE); -+ LeaveAllPowerSaveMode(padapter); -+ -+ MPT_InitializeAdapter(padapter, 1); -+ } -+ -+ if (padapter->registrypriv.mp_mode == 0) -+ return -EPERM; -+ -+ if (padapter->mppriv.mode == MP_OFF) { -+ if (mp_start_test(padapter) == _FAIL) -+ return -EPERM; -+ padapter->mppriv.mode = MP_ON; -+ } -+ -+ return 0; -+} -+ -+static int rtw_mp_stop(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if(padapter->registrypriv.mp_mode ==1) -+ { -+ MPT_DeInitAdapter(padapter); -+ padapter->registrypriv.mp_mode=0; -+ } -+ -+ if (padapter->mppriv.mode != MP_OFF) { -+ mp_stop_test(padapter); -+ padapter->mppriv.mode = MP_OFF; -+ } -+ -+ return 0; -+} -+ -+extern int wifirate2_ratetbl_inx(unsigned char rate); -+ -+static int rtw_mp_rate(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 rate = MPT_RATE_1M; -+ u8 input[wrqu->length]; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ rate = rtw_atoi(input); -+ sprintf( extra, "Set data rate to %d" , rate ); -+ -+ if(rate <= 0x7f) -+ rate = wifirate2_ratetbl_inx( (u8)rate); -+ else -+ rate =(rate-0x80+MPT_RATE_MCS0); -+ -+ //DBG_871X("%s: rate=%d\n", __func__, rate); -+ -+ if (rate >= MPT_RATE_LAST ) -+ return -EINVAL; -+ -+ padapter->mppriv.rateidx = rate; -+ Hal_SetDataRate(padapter); -+ -+ wrqu->length = strlen(extra) + 1; -+ return 0; -+} -+ -+static int rtw_mp_channel(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ u8 input[wrqu->length]; -+ u32 channel = 1; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ channel = rtw_atoi(input); -+ //DBG_871X("%s: channel=%d\n", __func__, channel); -+ sprintf( extra, "Change channel %d to channel %d", padapter->mppriv.channel , channel ); -+ padapter->mppriv.channel = channel; -+ Hal_SetChannel(padapter); -+ -+ wrqu->length = strlen(extra) + 1; -+ return 0; -+} -+ -+static int rtw_mp_bandwidth(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 bandwidth=0, sg=0; -+ //u8 buffer[40]; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ //if (copy_from_user(buffer, (void*)wrqu->data.pointer, wrqu->data.length)) -+ // return -EFAULT; -+ -+ //DBG_871X("%s:iwpriv in=%s\n", __func__, extra); -+ -+ sscanf(extra, "40M=%d,shortGI=%d", &bandwidth, &sg); -+ -+ if (bandwidth == 1) -+ bandwidth=CHANNEL_WIDTH_40; -+ else if (bandwidth == 2) -+ bandwidth=CHANNEL_WIDTH_80; -+ DBG_871X("%s: bw=%d sg=%d \n", __func__, bandwidth , sg); -+ -+ padapter->mppriv.bandwidth = (u8)bandwidth; -+ padapter->mppriv.preamble = sg; -+ -+ SetBandwidth(padapter); -+ -+ return 0; -+} -+ -+ -+static int rtw_mp_txpower_index(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->length]; -+ u32 rfpath; -+ u32 txpower_inx; -+ -+ if (wrqu->length > 128) -+ return -EFAULT; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ rfpath = rtw_atoi(input); -+ txpower_inx = mpt_ProQueryCalTxPower(padapter, rfpath); -+ sprintf(extra, " %d", txpower_inx); -+ wrqu->length = strlen(extra) + 1; -+ -+ return 0; -+} -+ -+ -+static int rtw_mp_txpower(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 idx_a=0,idx_b=0; -+ u8 input[wrqu->length]; -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ sscanf(input,"patha=%d,pathb=%d",&idx_a,&idx_b); -+ //DBG_871X("%s: tx_pwr_idx_a=%x b=%x\n", __func__, idx_a, idx_b); -+ -+ sprintf( extra, "Set power level path_A:%d path_B:%d", idx_a , idx_b ); -+ padapter->mppriv.txpoweridx = (u8)idx_a; -+ padapter->mppriv.txpoweridx_b = (u8)idx_b; -+ padapter->mppriv.bSetTxPower = 1; -+ //Hal_SetAntennaPathPower(padapter); -+ SetTxPower(padapter); -+ -+ wrqu->length = strlen(extra) + 1; -+ return 0; -+} -+ -+static int rtw_mp_ant_tx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 i; -+ u8 input[wrqu->length]; -+ u16 antenna = 0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ //DBG_871X("%s: input=%s\n", __func__, input); -+ -+ sprintf( extra, "switch Tx antenna to %s", input ); -+ -+ for (i=0; i < strlen(input); i++) -+ { -+ switch(input[i]) -+ { -+ case 'a' : -+ antenna|=ANTENNA_A; -+ break; -+ case 'b': -+ antenna|=ANTENNA_B; -+ break; -+ } -+ } -+ //antenna |= BIT(extra[i]-'a'); -+ //DBG_871X("%s: antenna=0x%x\n", __func__, antenna); -+ padapter->mppriv.antenna_tx = antenna; -+ //DBG_871X("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_tx); -+ -+ Hal_SetAntenna(padapter); -+ -+ wrqu->length = strlen(extra) + 1; -+ return 0; -+} -+ -+static int rtw_mp_ant_rx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 i; -+ u16 antenna = 0; -+ u8 input[wrqu->length]; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ //DBG_871X("%s: input=%s\n", __func__, input); -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ sprintf( extra, "switch Rx antenna to %s", input ); -+ -+ for (i=0; i < strlen(input); i++) { -+ switch( input[i] ) -+ { -+ case 'a' : -+ antenna|=ANTENNA_A; -+ break; -+ case 'b': -+ antenna|=ANTENNA_B; -+ break; -+ case 'c' : -+ antenna|=ANTENNA_C; -+ break; -+ } -+ } -+ -+ //DBG_871X("%s: antenna=0x%x\n", __func__, antenna); -+ padapter->mppriv.antenna_rx = antenna; -+ //DBG_871X("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_rx); -+ Hal_SetAntenna(padapter); -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+static int rtw_mp_ctx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 pkTx = 1, countPkTx = 1, cotuTx = 1, CarrSprTx = 1, scTx = 1, sgleTx = 1, stop = 1; -+ u32 bStartTest = 1; -+ u32 count = 0; -+ struct mp_priv *pmp_priv; -+ struct pkt_attrib *pattrib; -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ -+ pmp_priv = &padapter->mppriv; -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ DBG_871X("%s: in=%s\n", __func__, extra); -+ -+ countPkTx = strncmp(extra, "count=", 5); // strncmp TRUE is 0 -+ cotuTx = strncmp(extra, "background", 20); -+ CarrSprTx = strncmp(extra, "background,cs", 20); -+ scTx = strncmp(extra, "background,sc", 20); -+ sgleTx = strncmp(extra, "background,stone", 20); -+ pkTx = strncmp(extra, "background,pkt", 20); -+ stop = strncmp(extra, "stop", 4); -+ sscanf(extra, "count=%d,pkt", &count); -+ -+ //DBG_871X("%s: count=%d countPkTx=%d cotuTx=%d CarrSprTx=%d scTx=%d sgleTx=%d pkTx=%d stop=%d\n", __func__, count, countPkTx, cotuTx, CarrSprTx, pkTx, sgleTx, scTx, stop); -+ _rtw_memset(extra, '\0', sizeof(extra)); -+ -+ if (stop == 0) { -+ bStartTest = 0; // To set Stop -+ pmp_priv->tx.stop = 1; -+ sprintf( extra, "Stop continuous Tx"); -+ } else { -+ bStartTest = 1; -+ if (pmp_priv->mode != MP_ON) { -+ if (pmp_priv->tx.stop != 1) { -+ DBG_871X("%s: MP_MODE != ON %d\n", __func__, pmp_priv->mode); -+ return -EFAULT; -+ } -+ } -+ } -+ -+ if (pkTx == 0 || countPkTx == 0) -+ pmp_priv->mode = MP_PACKET_TX; -+ if (sgleTx == 0) -+ pmp_priv->mode = MP_SINGLE_TONE_TX; -+ if (cotuTx == 0) -+ pmp_priv->mode = MP_CONTINUOUS_TX; -+ if (CarrSprTx == 0) -+ pmp_priv->mode = MP_CARRIER_SUPPRISSION_TX; -+ if (scTx == 0) -+ pmp_priv->mode = MP_SINGLE_CARRIER_TX; -+ -+ switch (pmp_priv->mode) -+ { -+ case MP_PACKET_TX: -+ -+ //DBG_871X("%s:pkTx %d\n", __func__,bStartTest); -+ if (bStartTest == 0) -+ { -+ pmp_priv->tx.stop = 1; -+ pmp_priv->mode = MP_ON; -+ sprintf( extra, "Stop continuous Tx"); -+ } -+ else if (pmp_priv->tx.stop == 1) -+ { -+ sprintf( extra, "Start continuous DA=ffffffffffff len=1500 count=%u,\n",count); -+ //DBG_871X("%s:countPkTx %d\n", __func__,count); -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx.count = count; -+ pmp_priv->tx.payload = 2; -+ pattrib = &pmp_priv->tx.attrib; -+ pattrib->pktlen = 1000; -+ _rtw_memset(pattrib->dst, 0xFF, ETH_ALEN); -+ SetPacketTx(padapter); -+ } -+ else { -+ //DBG_871X("%s: pkTx not stop\n", __func__); -+ return -EFAULT; -+ } -+ wrqu->length = strlen(extra); -+ return 0; -+ -+ case MP_SINGLE_TONE_TX: -+ //DBG_871X("%s: sgleTx %d \n", __func__, bStartTest); -+ if (bStartTest != 0){ -+ sprintf( extra, "Start continuous DA=ffffffffffff len=1500 \n infinite=yes."); -+ } -+ Hal_SetSingleToneTx(padapter, (u8)bStartTest); -+ break; -+ -+ case MP_CONTINUOUS_TX: -+ //DBG_871X("%s: cotuTx %d\n", __func__, bStartTest); -+ if (bStartTest != 0){ -+ sprintf( extra, "Start continuous DA=ffffffffffff len=1500 \n infinite=yes."); -+ } -+ Hal_SetContinuousTx(padapter, (u8)bStartTest); -+ break; -+ -+ case MP_CARRIER_SUPPRISSION_TX: -+ //DBG_871X("%s: CarrSprTx %d\n", __func__, bStartTest); -+ if (bStartTest != 0){ -+ if( pmp_priv->rateidx <= MPT_RATE_11M ) -+ { -+ sprintf( extra, "Start continuous DA=ffffffffffff len=1500 \n infinite=yes."); -+ Hal_SetCarrierSuppressionTx(padapter, (u8)bStartTest); -+ }else -+ sprintf( extra, "Specify carrier suppression but not CCK rate"); -+ } -+ break; -+ -+ case MP_SINGLE_CARRIER_TX: -+ //DBG_871X("%s: scTx %d\n", __func__, bStartTest); -+ if (bStartTest != 0){ -+ sprintf( extra, "Start continuous DA=ffffffffffff len=1500 \n infinite=yes."); -+ } -+ Hal_SetSingleCarrierTx(padapter, (u8)bStartTest); -+ break; -+ -+ default: -+ //DBG_871X("%s:No Match MP_MODE\n", __func__); -+ sprintf( extra, "Error! Continuous-Tx is not on-going."); -+ return -EFAULT; -+ } -+ -+ if ( bStartTest==1 && pmp_priv->mode != MP_ON) { -+ struct mp_priv *pmp_priv = &padapter->mppriv; -+ if (pmp_priv->tx.stop == 0) { -+ pmp_priv->tx.stop = 1; -+ //DBG_871X("%s: pkt tx is running...\n", __func__); -+ rtw_msleep_os(5); -+ } -+ pmp_priv->tx.stop = 0; -+ pmp_priv->tx.count = 1; -+ SetPacketTx(padapter); -+ } else { -+ pmp_priv->mode = MP_ON; -+ } -+ -+ wrqu->length = strlen(extra); -+ return 0; -+} -+ -+static int rtw_mp_arx(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 bStartRx=0,bStopRx=0,bQueryPhy; -+ u32 cckok=0,cckcrc=0,ofdmok=0,ofdmcrc=0,htok=0,htcrc=0,OFDM_FA=0,CCK_FA=0; -+ u8 input[wrqu->length]; -+ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ DBG_871X("%s: %s\n", __func__, input); -+ -+ bStartRx = (strncmp(input, "start", 5)==0)?1:0; // strncmp TRUE is 0 -+ bStopRx = (strncmp(input, "stop", 5)==0)?1:0; // strncmp TRUE is 0 -+ bQueryPhy = (strncmp(input, "phy", 3)==0)?1:0; // strncmp TRUE is 0 -+ -+ if(bStartRx) -+ { -+ sprintf( extra, "start"); -+ SetPacketRx(padapter, bStartRx); -+ } -+ else if(bStopRx) -+ { -+ SetPacketRx(padapter, 0); -+ sprintf( extra, "Received packet OK:%d CRC error:%d",padapter->mppriv.rx_pktcount,padapter->mppriv.rx_crcerrpktcount); -+ } -+ else if(bQueryPhy) -+ { -+ /* -+ OFDM FA -+ RegCF0[15:0] -+ RegCF2[31:16] -+ RegDA0[31:16] -+ RegDA4[15:0] -+ RegDA4[31:16] -+ RegDA8[15:0] -+ CCK FA -+ (RegA5B<<8) | RegA5C -+ */ -+ cckok = read_bbreg(padapter, 0xf88, 0xffffffff ); -+ cckcrc = read_bbreg(padapter, 0xf84, 0xffffffff ); -+ ofdmok = read_bbreg(padapter, 0xf94, 0x0000FFFF ); -+ ofdmcrc = read_bbreg(padapter, 0xf94 , 0xFFFF0000 ); -+ htok = read_bbreg(padapter, 0xf90, 0x0000FFFF ); -+ htcrc = read_bbreg(padapter,0xf90, 0xFFFF0000 ); -+ -+ OFDM_FA=+read_bbreg(padapter, 0xcf0, 0x0000FFFF ); -+ OFDM_FA=+read_bbreg(padapter, 0xcf2, 0xFFFF0000 ); -+ OFDM_FA=+read_bbreg(padapter, 0xda0, 0xFFFF0000 ); -+ OFDM_FA=+read_bbreg(padapter, 0xda4, 0x0000FFFF ); -+ OFDM_FA=+read_bbreg(padapter, 0xda4, 0xFFFF0000 ); -+ OFDM_FA=+read_bbreg(padapter, 0xda8, 0x0000FFFF ); -+ CCK_FA=(rtw_read8(padapter, 0xa5b )<<8 ) | (rtw_read8(padapter, 0xa5c)); -+ -+ sprintf( extra, "Phy Received packet OK:%d CRC error:%d FA Counter: %d",cckok+ofdmok+htok,cckcrc+ofdmcrc+htcrc,OFDM_FA+CCK_FA); -+ } -+ wrqu->length = strlen(extra) + 1; -+ return 0; -+} -+ -+static int rtw_mp_trx_query(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u32 txok,txfail,rxok,rxfail; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ //if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ // return -EFAULT; -+ -+ txok=padapter->mppriv.tx.sended; -+ txfail=0; -+ rxok = padapter->mppriv.rx_pktcount; -+ rxfail = padapter->mppriv.rx_crcerrpktcount; -+ -+ _rtw_memset(extra, '\0', 128); -+ -+ sprintf(extra, "Tx OK:%d, Tx Fail:%d, Rx OK:%d, CRC error:%d ", txok, txfail,rxok,rxfail); -+ -+ wrqu->length=strlen(extra)+1; -+ -+ return 0; -+} -+ -+static int rtw_mp_pwrtrk(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 enable; -+ u32 thermal; -+ s32 ret; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ u8 input[wrqu->length]; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ _rtw_memset(extra, 0, wrqu->length); -+ -+ enable = 1; -+ if (wrqu->length > 1) { // not empty string -+ if (strncmp(input, "stop", 4) == 0) -+ { -+ enable = 0; -+ sprintf(extra, "mp tx power tracking stop"); -+ pHalData->TxPowerTrackControl = false; -+ } -+ else if (sscanf(input, "ther=%d", &thermal)) { -+ pHalData->TxPowerTrackControl = true; -+ ret = Hal_SetThermalMeter(padapter, (u8)thermal); -+ if (ret == _FAIL) return -EPERM; -+ sprintf(extra, "mp tx power tracking start,target value=%d ok ",thermal); -+ }else { -+ return -EINVAL; -+ } -+ } -+ -+ ret = Hal_SetPowerTracking(padapter, enable); -+ if (ret == _FAIL) return -EPERM; -+ -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+static int rtw_mp_psd(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ u8 input[wrqu->length]; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ strcpy(extra,input); -+ -+ wrqu->length = mp_query_psd(padapter, extra); -+ -+ return 0; -+} -+ -+static int rtw_mp_thermal(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ u8 val; -+ u16 bwrite=1; -+ u16 addr=EEPROM_THERMAL_METER_8812; -+ u16 cnt=1; -+ u16 max_available_size=0; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if (copy_from_user(extra, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ bwrite = strncmp(extra, "write", 6); // strncmp TRUE is 0 -+ -+ Hal_GetThermalMeter(padapter, &val); -+ -+ if( bwrite == 0 ) -+ { -+ EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, false); -+ if( 2 > max_available_size ) -+ { -+ DBG_871X("no available efuse!\n"); -+ return -EFAULT; -+ } -+ if ( rtw_efuse_map_write(padapter, addr, cnt, &val) == _FAIL ) -+ { -+ DBG_871X("rtw_efuse_map_write error \n"); -+ return -EFAULT; -+ } -+ else -+ { -+ sprintf(extra, " efuse write ok :%d", val); -+ } -+ } -+ else -+ { -+ sprintf(extra, "%d", val); -+ } -+ wrqu->length = strlen(extra); -+ -+ return 0; -+} -+ -+static int rtw_mp_reset_stats(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ struct mp_priv *pmp_priv; -+ struct pkt_attrib *pattrib; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ pmp_priv = &padapter->mppriv; -+ -+ pmp_priv->tx.sended = 0; -+ pmp_priv->tx_pktcount = 0; -+ pmp_priv->rx_pktcount = 0; -+ pmp_priv->rx_crcerrpktcount = 0; -+ -+ //reset phy counter -+ write_bbreg(padapter,0xf14,BIT16,0x1); -+ rtw_msleep_os(10); -+ write_bbreg(padapter,0xf14,BIT16,0x0); -+ -+ return 0; -+} -+ -+static int rtw_mp_dump(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ struct mp_priv *pmp_priv; -+ struct pkt_attrib *pattrib; -+ u32 value; -+ u8 rf_type,path_nums = 0; -+ u32 i,j=1,path; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ pmp_priv = &padapter->mppriv; -+ -+ -+ //if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) -+ // return -EFAULT; -+ -+ if ( strncmp(extra, "all", 4)==0 ) -+ { -+ DBG_871X("\n======= MAC REG =======\n"); -+ for ( i=0x0;i<0x300;i+=4 ) -+ { -+ if(j%4==1) DBG_871X("0x%02x",i); -+ DBG_871X(" 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) DBG_871X("\n"); -+ } -+ for( i=0x400;i<0x1000;i+=4 ) -+ { -+ if(j%4==1) DBG_871X("0x%02x",i); -+ DBG_871X(" 0x%08x ",rtw_read32(padapter,i)); -+ if((j++)%4 == 0) DBG_871X("\n"); -+ } -+ -+ i,j=1; -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ -+ DBG_871X("\n======= RF REG =======\n"); -+ if(( RF_1T2R == rf_type ) ||( RF_1T1R ==rf_type )) -+ path_nums = 1; -+ else -+ path_nums = 2; -+ -+ for(path=0;pathlength]; -+ u32 valxcap; -+ -+ if (copy_from_user(input, wrqu->pointer, wrqu->length)) -+ return -EFAULT; -+ -+ DBG_871X("%s:iwpriv in=%s\n", __func__, input); -+ -+ sscanf(input, "xcap=%d", &valxcap); -+ -+ Hal_ProSetCrystalCap( padapter , valxcap ); -+ -+ sprintf( extra, "Set xcap=%d",valxcap ); -+ wrqu->length = strlen(extra) + 1; -+ -+return 0; -+ -+} -+ -+static int rtw_mp_SetRFPath(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->data.length]; -+ u8 bMain=1,bTurnoff=1; -+ -+ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ DBG_871X("%s:iwpriv in=%s\n", __func__, input); -+ -+ bMain = strncmp(input, "1", 2); // strncmp TRUE is 0 -+ bTurnoff = strncmp(input, "0", 3); // strncmp TRUE is 0 -+ -+ if(bMain==0) -+ { -+ MP_PHY_SetRFPathSwitch(padapter,true); -+ DBG_871X("%s:PHY_SetRFPathSwitch=TRUE\n", __func__); -+ } -+ else if(bTurnoff==0) -+ { -+ MP_PHY_SetRFPathSwitch(padapter,false); -+ DBG_871X("%s:PHY_SetRFPathSwitch=FALSE\n", __func__); -+ } -+ -+ return 0; -+} -+ -+static int rtw_mp_QueryDrv(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ char input[wrqu->data.length]; -+ u8 qAutoLoad=1; -+ -+ EEPROM_EFUSE_PRIV *pEEPROM = GET_EEPROM_EFUSE_PRIV(padapter); -+ -+ if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) -+ return -EFAULT; -+ DBG_871X("%s:iwpriv in=%s\n", __func__, input); -+ -+ qAutoLoad = strncmp(input, "autoload", 8); // strncmp TRUE is 0 -+ -+ if(qAutoLoad==0) -+ { -+ DBG_871X("%s:qAutoLoad\n", __func__); -+ -+ if(pEEPROM->bautoload_fail_flag) -+ sprintf(extra, "fail"); -+ else -+ sprintf(extra, "ok"); -+ } -+ wrqu->data.length = strlen(extra) + 1; -+ return 0; -+} -+ -+/* update Tx AGC offset */ -+static int rtw_mp_antBdiff(struct net_device *dev, -+ struct iw_request_info *info, -+ struct iw_point *wrqu, char *extra) -+{ -+ -+ -+ // MPT_ProSetTxAGCOffset -+ return 0; -+} -+ -+static int rtw_mp_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wdata, char *extra) -+{ -+ struct iw_point *wrqu = (struct iw_point *)wdata; -+ u32 subcmd = wrqu->flags; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ if (padapter == NULL) -+ { -+ return -ENETDOWN; -+ } -+ -+ if (extra == NULL) -+ { -+ wrqu->length = 0; -+ return -EIO; -+ } -+ -+ switch(subcmd) -+ { -+ case MP_START: -+ DBG_871X("set case mp_start \n"); -+ rtw_mp_start (dev,info,wrqu,extra); -+ break; -+ -+ case MP_STOP: -+ DBG_871X("set case mp_stop \n"); -+ rtw_mp_stop (dev,info,wrqu,extra); -+ break; -+ -+ case MP_BANDWIDTH: -+ DBG_871X("set case mp_bandwidth \n"); -+ rtw_mp_bandwidth (dev,info,wrqu,extra); -+ break; -+ -+ case MP_RESET_STATS: -+ DBG_871X("set case MP_RESET_STATS \n"); -+ rtw_mp_reset_stats (dev,info,wrqu,extra); -+ break; -+ -+ -+ case MP_SetRFPathSwh: -+ DBG_871X("set MP_SetRFPathSwitch \n"); -+ rtw_mp_SetRFPath (dev,info,wdata,extra); -+ break; -+ case CTA_TEST: -+ DBG_871X("set CTA_TEST\n"); -+ rtw_cta_test_start (dev, info, wdata, extra); -+ break; -+ } -+ -+ -+ return 0; -+} -+ -+ -+static int rtw_mp_get(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wdata, char *extra) -+{ -+ struct iw_point *wrqu = (struct iw_point *)wdata; -+ u32 subcmd = wrqu->flags; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ //DBG_871X("in mp_get extra= %s \n",extra); -+ -+ if (padapter == NULL) -+ { -+ return -ENETDOWN; -+ } -+ if (extra == NULL) -+ { -+ wrqu->length = 0; -+ return -EIO; -+ } -+ -+ switch(subcmd) -+ { -+ case WRITE_REG : -+ rtw_mp_write_reg (dev,info,wrqu,extra); -+ break; -+ -+ case WRITE_RF: -+ rtw_mp_write_rf (dev,info,wrqu,extra); -+ break; -+ -+ case MP_PHYPARA: -+ DBG_871X("mp_get MP_PHYPARA \n"); -+ rtw_mp_phypara(dev,info,wrqu,extra); -+ break; -+ -+ case MP_CHANNEL: -+ DBG_871X("set case mp_channel \n"); -+ rtw_mp_channel (dev,info,wrqu,extra); -+ break; -+ -+ case READ_REG: -+ DBG_871X("mp_get READ_REG \n"); -+ rtw_mp_read_reg (dev,info,wrqu,extra); -+ break; -+ case READ_RF: -+ DBG_871X("mp_get READ_RF \n"); -+ rtw_mp_read_rf (dev,info,wrqu,extra); -+ break; -+ -+ case MP_RATE: -+ DBG_871X("set case mp_rate \n"); -+ rtw_mp_rate (dev,info,wrqu,extra); -+ break; -+ -+ case MP_TXPOWER: -+ DBG_871X("set case MP_TXPOWER \n"); -+ rtw_mp_txpower (dev,info,wrqu,extra); -+ break; -+ -+ case MP_ANT_TX: -+ DBG_871X("set case MP_ANT_TX \n"); -+ rtw_mp_ant_tx (dev,info,wrqu,extra); -+ break; -+ -+ case MP_ANT_RX: -+ DBG_871X("set case MP_ANT_RX \n"); -+ rtw_mp_ant_rx (dev,info,wrqu,extra); -+ break; -+ -+ case MP_QUERY: -+ //DBG_871X("mp_get mp_query MP_QUERY \n"); -+ rtw_mp_trx_query(dev,info,wrqu,extra); -+ break; -+ -+ case MP_CTX: -+ DBG_871X("set case MP_CTX \n"); -+ rtw_mp_ctx (dev,info,wrqu,extra); -+ break; -+ -+ case MP_ARX: -+ DBG_871X("set case MP_ARX \n"); -+ rtw_mp_arx (dev,info,wrqu,extra); -+ break; -+ -+ case EFUSE_GET: -+ DBG_871X("efuse get EFUSE_GET \n"); -+ rtw_mp_efuse_get(dev,info,wdata,extra); -+ break; -+ -+ case MP_DUMP: -+ DBG_871X("set case MP_DUMP \n"); -+ rtw_mp_dump (dev,info,wrqu,extra); -+ break; -+ case MP_PSD: -+ DBG_871X("set case MP_PSD \n"); -+ rtw_mp_psd (dev,info,wrqu,extra); -+ break; -+ -+ case MP_THER: -+ DBG_871X("set case MP_THER \n"); -+ rtw_mp_thermal (dev,info,wrqu,extra); -+ break; -+ -+ case MP_QueryDrvStats: -+ DBG_871X("mp_get MP_QueryDrvStats \n"); -+ rtw_mp_QueryDrv (dev,info,wdata,extra); -+ break; -+ case MP_PWRTRK: -+ DBG_871X("set case MP_PWRTRK \n"); -+ rtw_mp_pwrtrk (dev,info,wrqu,extra); -+ break; -+ case EFUSE_SET: -+ DBG_871X("set case efuse set \n"); -+ rtw_mp_efuse_set (dev,info,wdata,extra); -+ break; -+ case MP_GET_TXPOWER_INX: -+ DBG_871X("mp_get MP_GET_TXPOWER_INX \n"); -+ rtw_mp_txpower_index (dev,info,wrqu,extra); -+ break; -+ } -+ -+ rtw_msleep_os(10); //delay 5ms for sending pkt before exit adb shell operation -+return 0; -+} -+ -+#endif //#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_MP_IWPRIV_SUPPORT) -+ -+static int rtw_wfd_tdls_enable(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_WFD -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); -+ -+ if ( extra[ 0 ] == '0' ) -+ { -+ padapter->wdinfo.wfd_tdls_enable = 0; -+ } -+ else -+ { -+ padapter->wdinfo.wfd_tdls_enable = 1; -+ } -+ -+#endif //CONFIG_WFD -+#endif //CONFIG_TDLS -+ -+ return ret; -+} -+ -+static int rtw_tdls_weaksec(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ u8 i, j; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); -+ -+ if ( extra[ 0 ] == '0' ) -+ { -+ padapter->wdinfo.wfd_tdls_weaksec = 0; -+ } -+ else -+ { -+ padapter->wdinfo.wfd_tdls_weaksec = 1; -+ } -+#endif -+ -+ return ret; -+} -+ -+ -+static int rtw_tdls_enable(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ _irqL irqL; -+ _list *plist, *phead; -+ s32 index; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ u8 tdls_sta[NUM_STA][ETH_ALEN]; -+ u8 empty_hwaddr[ETH_ALEN] = { 0x00 }; -+ -+ printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); -+ -+ _rtw_memset(tdls_sta, 0x00, sizeof(tdls_sta)); -+ -+ if ( extra[ 0 ] == '0' ) -+ { -+ ptdlsinfo->enable = 0; -+ -+ if(pstapriv->asoc_sta_count==1) -+ return ret; -+ -+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ for(index=0; index< NUM_STA; index++) -+ { -+ phead = &(pstapriv->sta_hash[index]); -+ plist = get_next(phead); -+ -+ while ((rtw_end_of_queue_search(phead, plist)) == false) -+ { -+ psta = LIST_CONTAINOR(plist, struct sta_info ,hash_list); -+ -+ plist = get_next(plist); -+ -+ if(psta->tdls_sta_state != TDLS_STATE_NONE) -+ { -+ _rtw_memcpy(tdls_sta[index], psta->hwaddr, ETH_ALEN); -+ } -+ } -+ } -+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); -+ -+ for(index=0; index< NUM_STA; index++) -+ { -+ if( !_rtw_memcmp(tdls_sta[index], empty_hwaddr, ETH_ALEN) ) -+ { -+ printk("issue tear down to "MAC_FMT"\n", MAC_ARG(tdls_sta[index])); -+ issue_tdls_teardown(padapter, tdls_sta[index]); -+ } -+ } -+ rtw_tdls_cmd(padapter, myid(&(padapter->eeprompriv)), TDLS_RS_RCR); -+ rtw_reset_tdls_info(padapter); -+ } -+ else if ( extra[ 0 ] == '1' ) -+ { -+ ptdlsinfo->enable = 1; -+ } -+#endif //CONFIG_TDLS -+ -+ return ret; -+} -+ -+static int rtw_tdls_setup(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ u8 i, j; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 mac_addr[ETH_ALEN]; -+ -+#ifdef CONFIG_WFD -+ struct wifidirect_info *pwdinfo= &(padapter->wdinfo); -+#endif // CONFIG_WFD -+ -+ printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); -+ -+ for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ -+ mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); -+ } -+ -+#ifdef CONFIG_WFD -+ if ( _AES_ != padapter->securitypriv.dot11PrivacyAlgrthm ) -+ { -+ // Weak Security situation with AP. -+ if ( 0 == pwdinfo->wfd_tdls_weaksec ) -+ { -+ // Can't send the tdls setup request out!! -+ DBG_871X( "[%s] Current link is not AES, SKIP sending the tdls setup request!!\n", __FUNCTION__ ); -+ } -+ else -+ { -+ issue_tdls_setup_req(padapter, mac_addr); -+ } -+ } -+ else -+#endif // CONFIG_WFD -+ { -+ issue_tdls_setup_req(padapter, mac_addr); -+ } -+#endif -+ -+ return ret; -+} -+ -+static int rtw_tdls_teardown(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ u8 i,j; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct sta_info *ptdls_sta = NULL; -+ u8 mac_addr[ETH_ALEN]; -+ -+ DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); -+ -+ for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ -+ mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); -+ } -+ -+ ptdls_sta = rtw_get_stainfo( &(padapter->stapriv), mac_addr); -+ -+ if(ptdls_sta != NULL) -+ { -+ ptdls_sta->stat_code = _RSON_TDLS_TEAR_UN_RSN_; -+ issue_tdls_teardown(padapter, mac_addr); -+ } -+ -+#endif //CONFIG_TDLS -+ -+ return ret; -+} -+ -+static int rtw_tdls_discovery(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ -+ DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); -+ -+ issue_tdls_dis_req(padapter, NULL); -+ -+#endif //CONFIG_TDLS -+ -+ return ret; -+} -+ -+static int rtw_tdls_ch_switch(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ u8 i, j, mac_addr[ETH_ALEN]; -+ struct sta_info *ptdls_sta = NULL; -+ -+ DBG_8192C( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); -+ -+ for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ -+ mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); -+ } -+ -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); -+ if( ptdls_sta == NULL ) -+ return ret; -+ ptdlsinfo->ch_sensing=1; -+ -+ rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_INIT_CH_SEN); -+ -+#endif //CONFIG_TDLS -+ -+ return ret; -+} -+ -+static int rtw_tdls_pson(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 i, j, mac_addr[ETH_ALEN]; -+ struct sta_info *ptdls_sta = NULL; -+ -+ DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); -+ -+ for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ -+ mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); -+ } -+ -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); -+ -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta, 1); -+ -+#endif //CONFIG_TDLS -+ -+ return ret; -+} -+ -+static int rtw_tdls_psoff(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ u8 i, j, mac_addr[ETH_ALEN]; -+ struct sta_info *ptdls_sta = NULL; -+ -+ DBG_8192C( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); -+ -+ for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ -+ mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); -+ } -+ -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); -+ -+ issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta, 0); -+ -+#endif //CONFIG_TDLS -+ -+ return ret; -+} -+ -+static int rtw_tdls_setip(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_WFD -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; -+ u8 i=0, j=0, k=0, tag=0, ip[3] = { 0xff }, *ptr = extra; -+ -+ printk( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1 ); -+ -+ -+ while( i < 4 ) -+ { -+ for( j=0; j < 4; j++) -+ { -+ if( *( extra + j + tag ) == '.' || *( extra + j + tag ) == '\0' ) -+ { -+ if( j == 1 ) -+ pwfd_info->ip_address[i]=convert_ip_addr( '0', '0', *(extra+(j-1)+tag)); -+ if( j == 2 ) -+ pwfd_info->ip_address[i]=convert_ip_addr( '0', *(extra+(j-2)+tag), *(extra+(j-1)+tag)); -+ if( j == 3 ) -+ pwfd_info->ip_address[i]=convert_ip_addr( *(extra+(j-3)+tag), *(extra+(j-2)+tag), *(extra+(j-1)+tag)); -+ -+ tag += j + 1; -+ break; -+ } -+ } -+ i++; -+ } -+ -+ printk( "[%s] Set IP = %u.%u.%u.%u \n", __FUNCTION__, -+ ptdlsinfo->wfd_info->ip_address[0], ptdlsinfo->wfd_info->ip_address[1], -+ ptdlsinfo->wfd_info->ip_address[2], ptdlsinfo->wfd_info->ip_address[3] -+ ); -+ -+#endif //CONFIG_WFD -+#endif //CONFIG_TDLS -+ -+ return ret; -+} -+ -+static int rtw_tdls_getip(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_WFD -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; -+ -+ printk( "[%s]\n", __FUNCTION__); -+ -+ sprintf( extra, "\n\n%u.%u.%u.%u\n", -+ pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1], -+ pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3] -+ ); -+ -+ printk( "[%s] IP=%u.%u.%u.%u\n", __FUNCTION__, -+ pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1], -+ pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3] -+ ); -+ -+ wrqu->data.length = strlen( extra ); -+ -+#endif //CONFIG_WFD -+#endif //CONFIG_TDLS -+ -+ return ret; -+} -+ -+static int rtw_tdls_getport(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_WFD -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; -+ -+ printk( "[%s]\n", __FUNCTION__); -+ -+ sprintf( extra, "\n\n%d\n", pwfd_info->peer_rtsp_ctrlport ); -+ printk( "[%s] remote port = %d\n", __FUNCTION__, pwfd_info->peer_rtsp_ctrlport ); -+ -+ wrqu->data.length = strlen( extra ); -+ -+#endif //CONFIG_WFD -+#endif //CONFIG_TDLS -+ -+ return ret; -+ -+} -+ -+//WFDTDLS, for sigma test -+static int rtw_tdls_dis_result(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_WFD -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; -+ -+ printk( "[%s]\n", __FUNCTION__); -+ -+ if(ptdlsinfo->dev_discovered == 1 ) -+ { -+ sprintf( extra, "\n\nDis=1\n" ); -+ ptdlsinfo->dev_discovered = 0; -+ } -+ -+ wrqu->data.length = strlen( extra ); -+ -+#endif //CONFIG_WFD -+#endif //CONFIG_TDLS -+ -+ return ret; -+ -+} -+ -+//WFDTDLS, for sigma test -+static int rtw_wfd_tdls_status(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+#ifdef CONFIG_WFD -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; -+ struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info; -+ -+ printk( "[%s]\n", __FUNCTION__); -+ -+ if(ptdlsinfo->setup_state == TDLS_LINKED_STATE ) -+ { -+ sprintf( extra, "\n\nStatus=1\n" ); -+ } -+ else -+ { -+ sprintf( extra, "\n\nStatus=0\n" ); -+ } -+ -+ wrqu->data.length = strlen( extra ); -+ -+#endif //CONFIG_WFD -+#endif //CONFIG_TDLS -+ -+ return ret; -+ -+} -+ -+static int rtw_tdls_ch_switch_off(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ u8 i, j, mac_addr[ETH_ALEN]; -+ struct sta_info *ptdls_sta = NULL; -+ -+ DBG_871X( "[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length -1 ); -+ -+ for( i=0, j=0 ; i < ETH_ALEN; i++, j+=3 ){ -+ mac_addr[i]=key_2char2num(*(extra+j), *(extra+j+1)); -+ } -+ -+ ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); -+ -+ ptdls_sta->tdls_sta_state |= TDLS_SW_OFF_STATE; -+/* -+ if((ptdls_sta->tdls_sta_state & TDLS_AT_OFF_CH_STATE) && (ptdls_sta->tdls_sta_state & TDLS_PEER_AT_OFF_STATE)){ -+ pmlmeinfo->tdls_candidate_ch= pmlmeext->cur_channel; -+ issue_tdls_ch_switch_req(padapter, mac_addr); -+ DBG_871X("issue tdls ch switch req back to base channel\n"); -+ } -+*/ -+ -+#endif //CONFIG_TDLS -+ -+ return ret; -+} -+ -+static int rtw_tdls(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_TDLS -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ DBG_871X( "[%s] extra = %s\n", __FUNCTION__, extra ); -+ // WFD Sigma will use the tdls enable command to let the driver know we want to test the tdls now! -+ if ( _rtw_memcmp( extra, "wfdenable=", 10 ) ) -+ { -+ wrqu->data.length -=10; -+ rtw_wfd_tdls_enable( dev, info, wrqu, &extra[10] ); -+ return ret; -+ } -+ else if ( _rtw_memcmp( extra, "weaksec=", 8 ) ) -+ { -+ wrqu->data.length -=8; -+ rtw_tdls_weaksec( dev, info, wrqu, &extra[8] ); -+ return ret; -+ } -+ else if ( _rtw_memcmp( extra, "tdlsenable=", 11 ) ) -+ { -+ wrqu->data.length -=11; -+ rtw_tdls_enable( dev, info, wrqu, &extra[11] ); -+ return ret; -+ } -+ -+ if( padapter->tdlsinfo.enable == 0 ) -+ { -+ printk("tdls haven't enabled\n"); -+ return 0; -+ } -+ -+ if ( _rtw_memcmp( extra, "setup=", 6 ) ) -+ { -+ wrqu->data.length -=6; -+ rtw_tdls_setup( dev, info, wrqu, &extra[6] ); -+ } -+ else if (_rtw_memcmp( extra, "tear=", 5 ) ) -+ { -+ wrqu->data.length -= 5; -+ rtw_tdls_teardown( dev, info, wrqu, &extra[5] ); -+ } -+ else if (_rtw_memcmp( extra, "dis=", 4 ) ) -+ { -+ wrqu->data.length -= 4; -+ rtw_tdls_discovery( dev, info, wrqu, &extra[4] ); -+ } -+ else if (_rtw_memcmp( extra, "sw=", 3 ) ) -+ { -+ wrqu->data.length -= 3; -+ rtw_tdls_ch_switch( dev, info, wrqu, &extra[3] ); -+ } -+ else if (_rtw_memcmp( extra, "swoff=", 6 ) ) -+ { -+ wrqu->data.length -= 6; -+ rtw_tdls_ch_switch_off( dev, info, wrqu, &extra[6] ); -+ } -+ else if (_rtw_memcmp( extra, "pson=", 5 ) ) -+ { -+ wrqu->data.length -= 5; -+ rtw_tdls_pson( dev, info, wrqu, &extra[5] ); -+ } -+ else if (_rtw_memcmp( extra, "psoff=", 6 ) ) -+ { -+ wrqu->data.length -= 6; -+ rtw_tdls_psoff( dev, info, wrqu, &extra[6] ); -+ } -+#ifdef CONFIG_WFD -+ else if (_rtw_memcmp( extra, "setip=", 6 ) ) -+ { -+ wrqu->data.length -= 6; -+ rtw_tdls_setip( dev, info, wrqu, &extra[6] ); -+ } -+ else if (_rtw_memcmp( extra, "tprobe=", 6 ) ) -+ { -+ issue_tunneled_probe_req((_adapter *)rtw_netdev_priv(dev)); -+ } -+#endif //CONFIG_WFD -+ -+#endif //CONFIG_TDLS -+ -+ return ret; -+} -+ -+ -+static int rtw_tdls_get(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ -+#ifdef CONFIG_WFD -+ -+ DBG_871X( "[%s] extra = %s\n", __FUNCTION__, (char*) wrqu->data.pointer ); -+ -+ if ( _rtw_memcmp((__force void *)wrqu->data.pointer, "ip", 2 ) ) -+ { -+ rtw_tdls_getip( dev, info, wrqu, extra ); -+ } -+ if ( _rtw_memcmp((__force void *)wrqu->data.pointer, "port", 4 ) ) -+ { -+ rtw_tdls_getport( dev, info, wrqu, extra ); -+ } -+ //WFDTDLS, for sigma test -+ if ( _rtw_memcmp((__force void *)wrqu->data.pointer, "dis", 3 ) ) -+ { -+ rtw_tdls_dis_result( dev, info, wrqu, extra ); -+ } -+ if ( _rtw_memcmp((__force void *)wrqu->data.pointer, "status", 6 ) ) -+ { -+ rtw_wfd_tdls_status( dev, info, wrqu, extra ); -+ } -+ -+#endif //CONFIG_WFD -+ -+ return ret; -+} -+ -+ -+ -+ -+ -+#ifdef CONFIG_INTEL_WIDI -+static int rtw_widi_set(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ process_intel_widi_cmd(padapter, extra); -+ -+ return ret; -+} -+ -+static int rtw_widi_set_probe_request(struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ int ret = 0; -+ u8 *pbuf = NULL; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ -+ pbuf = rtw_malloc(sizeof(l2_msg_t)); -+ if(pbuf) -+ { -+ copy_from_user(pbuf, wrqu->data.pointer, wrqu->data.length); -+ //_rtw_memcpy(pbuf, wrqu->data.pointer, wrqu->data.length); -+ -+ if( wrqu->data.flags == 0 ) -+ intel_widi_wk_cmd(padapter, INTEL_WIDI_ISSUE_PROB_WK, pbuf); -+ else if( wrqu->data.flags == 1 ) -+ rtw_set_wfd_rds_sink_info( padapter, (l2_msg_t *)pbuf ); -+ } -+ return ret; -+} -+#endif // CONFIG_INTEL_WIDI -+ -+#ifdef CONFIG_MAC_LOOPBACK_DRIVER -+ -+static s32 initLoopback(PADAPTER padapter) -+{ -+ PLOOPBACKDATA ploopback; -+ -+ -+ if (padapter->ploopback == NULL) { -+ ploopback = (PLOOPBACKDATA)rtw_zmalloc(sizeof(LOOPBACKDATA)); -+ if (ploopback == NULL) return -ENOMEM; -+ -+ _rtw_init_sema(&ploopback->sema, 0); -+ ploopback->bstop = true; -+ ploopback->cnt = 0; -+ ploopback->size = 300; -+ _rtw_memset(ploopback->msg, 0, sizeof(ploopback->msg)); -+ -+ padapter->ploopback = ploopback; -+ } -+ -+ return 0; -+} -+ -+static void freeLoopback(PADAPTER padapter) -+{ -+ PLOOPBACKDATA ploopback; -+ -+ -+ ploopback = padapter->ploopback; -+ if (ploopback) { -+ rtw_mfree((u8*)ploopback, sizeof(LOOPBACKDATA)); -+ padapter->ploopback = NULL; -+ } -+} -+ -+static s32 initpseudoadhoc(PADAPTER padapter) -+{ -+ NDIS_802_11_NETWORK_INFRASTRUCTURE networkType; -+ s32 err; -+ -+ networkType = Ndis802_11IBSS; -+ err = rtw_set_802_11_infrastructure_mode(padapter, networkType); -+ if (err == false) return _FAIL; -+ -+ err = rtw_setopmode_cmd(padapter, networkType); -+ if (err == _FAIL) return _FAIL; -+ -+ return _SUCCESS; -+} -+ -+static s32 createpseudoadhoc(PADAPTER padapter) -+{ -+ NDIS_802_11_AUTHENTICATION_MODE authmode; -+ struct mlme_priv *pmlmepriv; -+ NDIS_802_11_SSID *passoc_ssid; -+ WLAN_BSSID_EX *pdev_network; -+ u8 *pibss; -+ u8 ssid[] = "pseduo_ad-hoc"; -+ s32 err; -+ _irqL irqL; -+ -+ -+ pmlmepriv = &padapter->mlmepriv; -+ -+ authmode = Ndis802_11AuthModeOpen; -+ err = rtw_set_802_11_authentication_mode(padapter, authmode); -+ if (err == false) return _FAIL; -+ -+ passoc_ssid = &pmlmepriv->assoc_ssid; -+ _rtw_memset(passoc_ssid, 0, sizeof(NDIS_802_11_SSID)); -+ passoc_ssid->SsidLength = sizeof(ssid) - 1; -+ _rtw_memcpy(passoc_ssid->Ssid, ssid, passoc_ssid->SsidLength); -+ -+ pdev_network = &padapter->registrypriv.dev_network; -+ pibss = padapter->registrypriv.dev_network.MacAddress; -+ _rtw_memcpy(&pdev_network->Ssid, passoc_ssid, sizeof(NDIS_802_11_SSID)); -+ -+ rtw_update_registrypriv_dev_network(padapter); -+ rtw_generate_random_ibss(pibss); -+ -+ _enter_critical_bh(&pmlmepriv->lock, &irqL); -+ pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE; -+ _exit_critical_bh(&pmlmepriv->lock, &irqL); -+ -+#if 0 -+ err = rtw_createbss_cmd(padapter); -+ if (err == _FAIL) return _FAIL; -+#else -+{ -+ struct wlan_network *pcur_network; -+ struct sta_info *psta; -+ -+ //3 create a new psta -+ pcur_network = &pmlmepriv->cur_network; -+ -+ //clear psta in the cur_network, if any -+ psta = rtw_get_stainfo(&padapter->stapriv, pcur_network->network.MacAddress); -+ if (psta) rtw_free_stainfo(padapter, psta); -+ -+ psta = rtw_alloc_stainfo(&padapter->stapriv, pibss); -+ if (psta == NULL) return _FAIL; -+ -+ //3 join psudo AdHoc -+ pcur_network->join_res = 1; -+ pcur_network->aid = psta->aid = 1; -+ _rtw_memcpy(&pcur_network->network, pdev_network, get_WLAN_BSSID_EX_sz(pdev_network)); -+ -+ // set msr to WIFI_FW_ADHOC_STATE -+ { -+ u8 val8; -+ -+ val8 = rtw_read8(padapter, MSR); -+ val8 &= 0xFC; // clear NETYPE0 -+ val8 |= WIFI_FW_ADHOC_STATE & 0x3; -+ rtw_write8(padapter, MSR, val8); -+ } -+} -+#endif -+ -+ return _SUCCESS; -+} -+ -+static struct xmit_frame* createloopbackpkt(PADAPTER padapter, u32 size) -+{ -+ struct xmit_priv *pxmitpriv; -+ struct xmit_frame *pframe; -+ struct xmit_buf *pxmitbuf; -+ struct pkt_attrib *pattrib; -+ struct tx_desc *desc; -+ u8 *pkt_start, *pkt_end, *ptr; -+ struct rtw_ieee80211_hdr *hdr; -+ s32 bmcast; -+ _irqL irqL; -+ -+ -+ if ((TXDESC_SIZE + WLANHDR_OFFSET + size) > MAX_XMITBUF_SZ) return NULL; -+ -+ pxmitpriv = &padapter->xmitpriv; -+ pframe = NULL; -+ -+ //2 1. allocate xmit frame -+ pframe = rtw_alloc_xmitframe(pxmitpriv); -+ if (pframe == NULL) return NULL; -+ pframe->padapter = padapter; -+ -+ //2 2. allocate xmit buffer -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv); -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+ if (pxmitbuf == NULL) { -+ rtw_free_xmitframe(pxmitpriv, pframe); -+ return NULL; -+ } -+ -+ pframe->pxmitbuf = pxmitbuf; -+ pframe->buf_addr = pxmitbuf->pbuf; -+ pxmitbuf->priv_data = pframe; -+ -+ //2 3. update_attrib() -+ pattrib = &pframe->attrib; -+ -+ // init xmitframe attribute -+ _rtw_memset(pattrib, 0, sizeof(struct pkt_attrib)); -+ -+ pattrib->ether_type = 0x8723; -+ _rtw_memcpy(pattrib->src, padapter->eeprompriv.mac_addr, ETH_ALEN); -+ _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); -+ _rtw_memset(pattrib->dst, 0xFF, ETH_ALEN); -+ _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); -+ -+// pattrib->dhcp_pkt = 0; -+// pattrib->pktlen = 0; -+ pattrib->ack_policy = 0; -+// pattrib->pkt_hdrlen = ETH_HLEN; -+ pattrib->hdrlen = WLAN_HDR_A3_LEN; -+ pattrib->subtype = WIFI_DATA; -+ pattrib->priority = 0; -+ pattrib->qsel = pattrib->priority; -+// do_queue_select(padapter, pattrib); -+ pattrib->nr_frags = 1; -+ pattrib->encrypt = 0; -+ pattrib->bswenc = false; -+ pattrib->qos_en = false; -+ -+ bmcast = IS_MCAST(pattrib->ra); -+ if (bmcast) { -+ pattrib->mac_id = 1; -+ pattrib->psta = rtw_get_bcmc_stainfo(padapter); -+ } else { -+ pattrib->mac_id = 0; -+ pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); -+ } -+ -+ pattrib->pktlen = size; -+ pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->pktlen; -+ -+ //2 4. fill TX descriptor -+ desc = (struct tx_desc*)pframe->buf_addr; -+ _rtw_memset(desc, 0, TXDESC_SIZE); -+ -+ fill_default_txdesc(pframe, (u8*)desc); -+ -+ // Hw set sequence number -+ ((PTXDESC)desc)->hwseq_en = 0; // HWSEQ_EN, 0:disable, 1:enable -+// ((PTXDESC)desc)->hwseq_sel = 0; // HWSEQ_SEL -+ -+ ((PTXDESC)desc)->disdatafb = 1; -+ -+ // convert to little endian -+ desc->txdw0 = cpu_to_le32(desc->txdw0); -+ desc->txdw1 = cpu_to_le32(desc->txdw1); -+ desc->txdw2 = cpu_to_le32(desc->txdw2); -+ desc->txdw3 = cpu_to_le32(desc->txdw3); -+ desc->txdw4 = cpu_to_le32(desc->txdw4); -+ desc->txdw5 = cpu_to_le32(desc->txdw5); -+ desc->txdw6 = cpu_to_le32(desc->txdw6); -+ desc->txdw7 = cpu_to_le32(desc->txdw7); -+ -+ cal_txdesc_chksum(desc); -+ -+ //2 5. coalesce -+ pkt_start = pframe->buf_addr + TXDESC_SIZE; -+ pkt_end = pkt_start + pattrib->last_txcmdsz; -+ -+ //3 5.1. make wlan header, make_wlanhdr() -+ hdr = (struct rtw_ieee80211_hdr *)pkt_start; -+ SetFrameSubType(&hdr->frame_ctl, pattrib->subtype); -+ _rtw_memcpy(hdr->addr1, pattrib->dst, ETH_ALEN); // DA -+ _rtw_memcpy(hdr->addr2, pattrib->src, ETH_ALEN); // SA -+ _rtw_memcpy(hdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); // RA, BSSID -+ -+ //3 5.2. make payload -+ ptr = pkt_start + pattrib->hdrlen; -+ get_random_bytes(ptr, pkt_end - ptr); -+ -+ pxmitbuf->len = TXDESC_SIZE + pattrib->last_txcmdsz; -+ pxmitbuf->ptail += pxmitbuf->len; -+ -+ return pframe; -+} -+ -+static void freeloopbackpkt(PADAPTER padapter, struct xmit_frame *pframe) -+{ -+ struct xmit_priv *pxmitpriv; -+ struct xmit_buf *pxmitbuf; -+ -+ -+ pxmitpriv = &padapter->xmitpriv; -+ pxmitbuf = pframe->pxmitbuf; -+ -+ rtw_free_xmitframe(pxmitpriv, pframe); -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+} -+ -+static void printdata(u8 *pbuf, u32 len) -+{ -+ u32 i, val; -+ -+ -+ for (i = 0; (i+4) <= len; i+=4) { -+ printk("%08X", *(u32*)(pbuf + i)); -+ if ((i+4) & 0x1F) printk(" "); -+ else printk("\n"); -+ } -+ -+ if (i < len) -+ { -+#ifdef __BIG_ENDIAN -+ for (; i < len, i++) -+ printk("%02X", pbuf+i); -+#else // __LITTLE_ENDIAN -+ u8 str[9]; -+ u8 n; -+ val = 0; -+ n = len - i; -+ _rtw_memcpy(&val, pbuf+i, n); -+ sprintf(str, "%08X", val); -+ n = (4 - n) * 2; -+ printk("%8s", str+n); -+#endif // __LITTLE_ENDIAN -+ } -+ printk("\n"); -+} -+ -+static u8 pktcmp(PADAPTER padapter, u8 *txbuf, u32 txsz, u8 *rxbuf, u32 rxsz) -+{ -+ PHAL_DATA_TYPE phal; -+ struct recv_stat *prxstat; -+ struct recv_stat report; -+ PRXREPORT prxreport; -+ u32 drvinfosize; -+ u32 rxpktsize; -+ u8 fcssize; -+ u8 ret = false; -+ -+ prxstat = (struct recv_stat*)rxbuf; -+ report.rxdw0 = le32_to_cpu(prxstat->rxdw0); -+ report.rxdw1 = le32_to_cpu(prxstat->rxdw1); -+ report.rxdw2 = le32_to_cpu(prxstat->rxdw2); -+ report.rxdw3 = le32_to_cpu(prxstat->rxdw3); -+ report.rxdw4 = le32_to_cpu(prxstat->rxdw4); -+ report.rxdw5 = le32_to_cpu(prxstat->rxdw5); -+ -+ prxreport = (PRXREPORT)&report; -+ drvinfosize = prxreport->drvinfosize << 3; -+ rxpktsize = prxreport->pktlen; -+ -+ phal = GET_HAL_DATA(padapter); -+ if (phal->ReceiveConfig & RCR_APPFCS) fcssize = IEEE80211_FCS_LEN; -+ else fcssize = 0; -+ -+ if ((txsz - TXDESC_SIZE) != (rxpktsize - fcssize)) { -+ DBG_8192C("%s: ERROR! size not match tx/rx=%d/%d !\n", -+ __func__, txsz - TXDESC_SIZE, rxpktsize - fcssize); -+ ret = false; -+ } else { -+ ret = _rtw_memcmp(txbuf + TXDESC_SIZE,\ -+ rxbuf + RXDESC_SIZE + drvinfosize,\ -+ txsz - TXDESC_SIZE); -+ if (ret == false) { -+ DBG_8192C("%s: ERROR! pkt content mismatch!\n", __func__); -+ } -+ } -+ -+ if (ret == false) -+ { -+ DBG_8192C("\n%s: TX PKT total=%d, desc=%d, content=%d\n", -+ __func__, txsz, TXDESC_SIZE, txsz - TXDESC_SIZE); -+ DBG_8192C("%s: TX DESC size=%d\n", __func__, TXDESC_SIZE); -+ printdata(txbuf, TXDESC_SIZE); -+ DBG_8192C("%s: TX content size=%d\n", __func__, txsz - TXDESC_SIZE); -+ printdata(txbuf + TXDESC_SIZE, txsz - TXDESC_SIZE); -+ -+ DBG_8192C("\n%s: RX PKT read=%d offset=%d(%d,%d) content=%d\n", -+ __func__, rxsz, RXDESC_SIZE + drvinfosize, RXDESC_SIZE, drvinfosize, rxpktsize); -+ if (rxpktsize != 0) -+ { -+ DBG_8192C("%s: RX DESC size=%d\n", __func__, RXDESC_SIZE); -+ printdata(rxbuf, RXDESC_SIZE); -+ DBG_8192C("%s: RX drvinfo size=%d\n", __func__, drvinfosize); -+ printdata(rxbuf + RXDESC_SIZE, drvinfosize); -+ DBG_8192C("%s: RX content size=%d\n", __func__, rxpktsize); -+ printdata(rxbuf + RXDESC_SIZE + drvinfosize, rxpktsize); -+ } else { -+ DBG_8192C("%s: RX data size=%d\n", __func__, rxsz); -+ printdata(rxbuf, rxsz); -+ } -+ } -+ -+ return ret; -+} -+ -+thread_return lbk_thread(thread_context context) -+{ -+ s32 err; -+ PADAPTER padapter; -+ PLOOPBACKDATA ploopback; -+ struct xmit_frame *pxmitframe; -+ u32 cnt, ok, fail, headerlen; -+ u32 pktsize; -+ u32 ff_hwaddr; -+ -+ -+ padapter = (PADAPTER)context; -+ ploopback = padapter->ploopback; -+ if (ploopback == NULL) return -1; -+ cnt = 0; -+ ok = 0; -+ fail = 0; -+ -+ daemonize("%s", "RTW_LBK_THREAD"); -+ allow_signal(SIGTERM); -+ -+ do { -+ if (ploopback->size == 0) { -+ get_random_bytes(&pktsize, 4); -+ pktsize = (pktsize % 1535) + 1; // 1~1535 -+ } else -+ pktsize = ploopback->size; -+ -+ pxmitframe = createloopbackpkt(padapter, pktsize); -+ if (pxmitframe == NULL) { -+ sprintf(ploopback->msg, "loopback FAIL! 3. create Packet FAIL!"); -+ break; -+ } -+ -+ ploopback->txsize = TXDESC_SIZE + pxmitframe->attrib.last_txcmdsz; -+ _rtw_memcpy(ploopback->txbuf, pxmitframe->buf_addr, ploopback->txsize); -+ ff_hwaddr = rtw_get_ff_hwaddr(pxmitframe); -+ cnt++; -+ DBG_8192C("%s: wirte port cnt=%d size=%d\n", __func__, cnt, ploopback->txsize); -+ pxmitframe->pxmitbuf->pdata = ploopback->txbuf; -+ rtw_write_port(padapter, ff_hwaddr, ploopback->txsize, (u8 *)pxmitframe->pxmitbuf); -+ -+ // wait for rx pkt -+ _rtw_down_sema(&ploopback->sema); -+ -+ err = pktcmp(padapter, ploopback->txbuf, ploopback->txsize, ploopback->rxbuf, ploopback->rxsize); -+ if (err == true) -+ ok++; -+ else -+ fail++; -+ -+ ploopback->txsize = 0; -+ _rtw_memset(ploopback->txbuf, 0, 0x8000); -+ ploopback->rxsize = 0; -+ _rtw_memset(ploopback->rxbuf, 0, 0x8000); -+ -+ freeloopbackpkt(padapter, pxmitframe); -+ pxmitframe = NULL; -+ -+ if (signal_pending(current)) { -+ flush_signals(current); -+ } -+ -+ if ((ploopback->bstop == true) || -+ ((ploopback->cnt != 0) && (ploopback->cnt == cnt))) -+ { -+ u32 ok_rate, fail_rate, all; -+ all = cnt; -+ ok_rate = (ok*100)/all; -+ fail_rate = (fail*100)/all; -+ sprintf(ploopback->msg,\ -+ "loopback result: ok=%d%%(%d/%d),error=%d%%(%d/%d)",\ -+ ok_rate, ok, all, fail_rate, fail, all); -+ break; -+ } -+ } while (1); -+ -+ ploopback->bstop = true; -+ -+ thread_exit(); -+} -+ -+static void loopbackTest(PADAPTER padapter, u32 cnt, u32 size, u8* pmsg) -+{ -+ PLOOPBACKDATA ploopback; -+ u32 len; -+ s32 err; -+ -+ -+ ploopback = padapter->ploopback; -+ -+ if (ploopback) -+ { -+ if (ploopback->bstop == false) { -+ ploopback->bstop = true; -+ _rtw_up_sema(&ploopback->sema); -+ } -+ len = 0; -+ do { -+ len = strlen(ploopback->msg); -+ if (len) break; -+ rtw_msleep_os(1); -+ } while (1); -+ _rtw_memcpy(pmsg, ploopback->msg, len+1); -+ freeLoopback(padapter); -+ -+ return; -+ } -+ -+ // disable dynamic algorithm -+ { -+ u32 DMFlag = DYNAMIC_FUNC_DISABLE; -+ rtw_hal_get_hwreg(padapter, HW_VAR_DM_FLAG, (u8*)&DMFlag); -+ } -+ -+ // create pseudo ad-hoc connection -+ err = initpseudoadhoc(padapter); -+ if (err == _FAIL) { -+ sprintf(pmsg, "loopback FAIL! 1.1 init ad-hoc FAIL!"); -+ return; -+ } -+ -+ err = createpseudoadhoc(padapter); -+ if (err == _FAIL) { -+ sprintf(pmsg, "loopback FAIL! 1.2 create ad-hoc master FAIL!"); -+ return; -+ } -+ -+ err = initLoopback(padapter); -+ if (err) { -+ sprintf(pmsg, "loopback FAIL! 2. init FAIL! error code=%d", err); -+ return; -+ } -+ -+ ploopback = padapter->ploopback; -+ -+ ploopback->bstop = false; -+ ploopback->cnt = cnt; -+ ploopback->size = size; -+ ploopback->lbkthread = kthread_run(lbk_thread, padapter, "RTW_LBK_THREAD"); -+ if (IS_ERR(padapter->lbkthread)) -+ { -+ freeLoopback(padapter); -+ sprintf(pmsg, "loopback start FAIL! cnt=%d", cnt); -+ return; -+ } -+ -+ sprintf(pmsg, "loopback start! cnt=%d", cnt); -+} -+#endif // CONFIG_MAC_LOOPBACK_DRIVER -+ -+static int rtw_test( -+ struct net_device *dev, -+ struct iw_request_info *info, -+ union iwreq_data *wrqu, char *extra) -+{ -+ u32 len; -+ u8 *pbuf, *pch; -+ char *ptmp; -+ u8 *delim = ","; -+ PADAPTER padapter = rtw_netdev_priv(dev); -+ -+ -+ DBG_871X("+%s\n", __func__); -+ len = wrqu->data.length; -+ -+ pbuf = (u8*)rtw_zmalloc(len); -+ if (pbuf == NULL) { -+ DBG_871X("%s: no memory!\n", __func__); -+ return -ENOMEM; -+ } -+ -+ if (copy_from_user(pbuf, wrqu->data.pointer, len)) { -+ rtw_mfree(pbuf, len); -+ DBG_871X("%s: copy from user fail!\n", __func__); -+ return -EFAULT; -+ } -+ DBG_871X("%s: string=\"%s\"\n", __func__, pbuf); -+ -+ ptmp = (char*)pbuf; -+ pch = strsep(&ptmp, delim); -+ if ((pch == NULL) || (strlen(pch) == 0)) { -+ rtw_mfree(pbuf, len); -+ DBG_871X("%s: parameter error(level 1)!\n", __func__); -+ return -EFAULT; -+ } -+ -+#ifdef CONFIG_MAC_LOOPBACK_DRIVER -+ if (strcmp(pch, "loopback") == 0) -+ { -+ s32 cnt = 0; -+ u32 size = 64; -+ -+ pch = strsep(&ptmp, delim); -+ if ((pch == NULL) || (strlen(pch) == 0)) { -+ rtw_mfree(pbuf, len); -+ DBG_871X("%s: parameter error(level 2)!\n", __func__); -+ return -EFAULT; -+ } -+ -+ sscanf(pch, "%d", &cnt); -+ DBG_871X("%s: loopback cnt=%d\n", __func__, cnt); -+ -+ pch = strsep(&ptmp, delim); -+ if ((pch == NULL) || (strlen(pch) == 0)) { -+ rtw_mfree(pbuf, len); -+ DBG_871X("%s: parameter error(level 2)!\n", __func__); -+ return -EFAULT; -+ } -+ -+ sscanf(pch, "%d", &size); -+ DBG_871X("%s: loopback size=%d\n", __func__, size); -+ -+ loopbackTest(padapter, cnt, size, extra); -+ wrqu->data.length = strlen(extra) + 1; -+ -+ rtw_mfree(pbuf, len); -+ return 0; -+ } -+#endif -+ -+ rtw_mfree(pbuf, len); -+ return 0; -+} -+ -+static iw_handler rtw_handlers[] = -+{ -+ NULL, /* SIOCSIWCOMMIT */ -+ rtw_wx_get_name, /* SIOCGIWNAME */ -+ dummy, /* SIOCSIWNWID */ -+ dummy, /* SIOCGIWNWID */ -+ rtw_wx_set_freq, /* SIOCSIWFREQ */ -+ rtw_wx_get_freq, /* SIOCGIWFREQ */ -+ rtw_wx_set_mode, /* SIOCSIWMODE */ -+ rtw_wx_get_mode, /* SIOCGIWMODE */ -+ dummy, /* SIOCSIWSENS */ -+ rtw_wx_get_sens, /* SIOCGIWSENS */ -+ NULL, /* SIOCSIWRANGE */ -+ rtw_wx_get_range, /* SIOCGIWRANGE */ -+ rtw_wx_set_priv, /* SIOCSIWPRIV */ -+ NULL, /* SIOCGIWPRIV */ -+ NULL, /* SIOCSIWSTATS */ -+ NULL, /* SIOCGIWSTATS */ -+ dummy, /* SIOCSIWSPY */ -+ dummy, /* SIOCGIWSPY */ -+ NULL, /* SIOCGIWTHRSPY */ -+ NULL, /* SIOCWIWTHRSPY */ -+ rtw_wx_set_wap, /* SIOCSIWAP */ -+ rtw_wx_get_wap, /* SIOCGIWAP */ -+ rtw_wx_set_mlme, /* request MLME operation; uses struct iw_mlme */ -+ dummy, /* SIOCGIWAPLIST -- depricated */ -+ rtw_wx_set_scan, /* SIOCSIWSCAN */ -+ rtw_wx_get_scan, /* SIOCGIWSCAN */ -+ rtw_wx_set_essid, /* SIOCSIWESSID */ -+ rtw_wx_get_essid, /* SIOCGIWESSID */ -+ dummy, /* SIOCSIWNICKN */ -+ rtw_wx_get_nick, /* SIOCGIWNICKN */ -+ NULL, /* -- hole -- */ -+ NULL, /* -- hole -- */ -+ rtw_wx_set_rate, /* SIOCSIWRATE */ -+ rtw_wx_get_rate, /* SIOCGIWRATE */ -+ rtw_wx_set_rts, /* SIOCSIWRTS */ -+ rtw_wx_get_rts, /* SIOCGIWRTS */ -+ rtw_wx_set_frag, /* SIOCSIWFRAG */ -+ rtw_wx_get_frag, /* SIOCGIWFRAG */ -+ dummy, /* SIOCSIWTXPOW */ -+ dummy, /* SIOCGIWTXPOW */ -+ dummy, /* SIOCSIWRETRY */ -+ rtw_wx_get_retry, /* SIOCGIWRETRY */ -+ rtw_wx_set_enc, /* SIOCSIWENCODE */ -+ rtw_wx_get_enc, /* SIOCGIWENCODE */ -+ dummy, /* SIOCSIWPOWER */ -+ rtw_wx_get_power, /* SIOCGIWPOWER */ -+ NULL, /*---hole---*/ -+ NULL, /*---hole---*/ -+ rtw_wx_set_gen_ie, /* SIOCSIWGENIE */ -+ NULL, /* SIOCGWGENIE */ -+ rtw_wx_set_auth, /* SIOCSIWAUTH */ -+ NULL, /* SIOCGIWAUTH */ -+ rtw_wx_set_enc_ext, /* SIOCSIWENCODEEXT */ -+ NULL, /* SIOCGIWENCODEEXT */ -+ rtw_wx_set_pmkid, /* SIOCSIWPMKSA */ -+ NULL, /*---hole---*/ -+}; -+ -+static const struct iw_priv_args rtw_private_args[] = { -+ { -+ SIOCIWFIRSTPRIV + 0x0, -+ IW_PRIV_TYPE_CHAR | 0x7FF, 0, "write" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x1, -+ IW_PRIV_TYPE_CHAR | 0x7FF, -+ IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ, "read" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x2, 0, 0, "driver_ext" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x3, 0, 0, "mp_ioctl" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x4, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "apinfo" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x5, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "setpid" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x6, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_start" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x7, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "get_sensitivity" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x8, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_prob_req_ie" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x9, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "wps_assoc_req_ie" -+ }, -+ -+ { -+ SIOCIWFIRSTPRIV + 0xA, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "channel_plan" -+ }, -+ -+ { -+ SIOCIWFIRSTPRIV + 0xB, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "dbg" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0xC, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 3, 0, "rfw" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0xD, -+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ, "rfr" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x10, -+ IW_PRIV_TYPE_CHAR | P2P_PRIVATE_IOCTL_SET_LEN, 0, "p2p_set" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x11, -+ IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , "p2p_get" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x12, 0, 0, "NULL" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x13, -+ IW_PRIV_TYPE_CHAR | 64, IW_PRIV_TYPE_CHAR | 64 , "p2p_get2" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x14, -+ IW_PRIV_TYPE_CHAR | 64, 0, "tdls" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x15, -+ IW_PRIV_TYPE_CHAR | P2P_PRIVATE_IOCTL_SET_LEN, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | P2P_PRIVATE_IOCTL_SET_LEN , "tdls_get" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x16, -+ IW_PRIV_TYPE_CHAR | 64, 0, "pm_set" -+ }, -+ -+ {SIOCIWFIRSTPRIV + 0x18, IW_PRIV_TYPE_CHAR | IFNAMSIZ , 0 , "rereg_nd_name"}, -+ -+ {SIOCIWFIRSTPRIV + 0x1A, IW_PRIV_TYPE_CHAR | 1024, 0, "efuse_set"}, -+ {SIOCIWFIRSTPRIV + 0x1B, IW_PRIV_TYPE_CHAR | 128, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_get"}, -+ { -+ SIOCIWFIRSTPRIV + 0x1D, -+ IW_PRIV_TYPE_CHAR | 40, IW_PRIV_TYPE_CHAR | 0x7FF, "test" -+ }, -+ -+#ifdef CONFIG_INTEL_WIDI -+ { -+ SIOCIWFIRSTPRIV + 0x1E, -+ IW_PRIV_TYPE_CHAR | 64, 0, "widi_set" -+ }, -+ { -+ SIOCIWFIRSTPRIV + 0x1F, -+ IW_PRIV_TYPE_CHAR | 128, 0, "widi_prob_req" -+ }, -+#endif // CONFIG_INTEL_WIDI -+ -+#ifdef CONFIG_MP_INCLUDED -+ { SIOCIWFIRSTPRIV + 0x0E, IW_PRIV_TYPE_CHAR | 1024, 0 , ""}, //set -+ { SIOCIWFIRSTPRIV + 0x0F, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , ""},//get -+/* --- sub-ioctls definitions --- */ -+ { MP_START , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_start" }, //set -+ { MP_PHYPARA, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_phypara" },//get -+ { MP_STOP , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_stop" }, //set -+ { MP_CHANNEL , IW_PRIV_TYPE_CHAR | 1024 , IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_channel" },//get -+ { MP_BANDWIDTH , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_bandwidth"}, //set -+ { MP_RATE , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rate" },//get -+ { MP_RESET_STATS , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_reset_stats"}, -+ { MP_QUERY , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , "mp_query"}, //get -+ { READ_REG , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "read_reg" }, -+ { MP_RATE , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rate" }, -+ { READ_RF , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "read_rf" }, -+ { MP_PSD , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_psd"}, -+ { MP_DUMP, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_dump" }, -+ { MP_TXPOWER , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_txpower"}, -+ { MP_ANT_TX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ant_tx"}, -+ { MP_ANT_RX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ant_rx"}, -+ { WRITE_REG , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "write_reg" }, -+ { WRITE_RF , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "write_rf" }, -+ { MP_CTX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ctx"}, -+ { MP_ARX , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_arx"}, -+ { MP_THER , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ther"}, -+ { EFUSE_SET, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_set" }, -+ { EFUSE_GET, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_get" }, -+ { MP_PWRTRK , IW_PRIV_TYPE_CHAR | 1024, 0, "mp_pwrtrk"}, -+ { MP_QueryDrvStats, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_drvquery" }, -+ { MP_IOCTL, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_ioctl"}, // mp_ioctl -+ { MP_SetRFPathSwh, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_setrfpath" }, -+ { MP_GET_TXPOWER_INX, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_get_txpower" }, -+ { CTA_TEST, IW_PRIV_TYPE_CHAR | 1024, 0, "cta_test"}, -+}; -+ -+static iw_handler rtw_private_handler[] = -+{ -+ rtw_wx_write32, //0x00 -+ rtw_wx_read32, //0x01 -+ rtw_drvext_hdl, //0x02 -+ rtw_mp_ioctl_hdl, //0x03 -+ -+// for MM DTV platform -+ rtw_get_ap_info, //0x04 -+ -+ rtw_set_pid, //0x05 -+ rtw_wps_start, //0x06 -+ -+ rtw_wx_get_sensitivity, //0x07 -+ rtw_wx_set_mtk_wps_probe_ie, //0x08 -+ rtw_wx_set_mtk_wps_ie, //0x09 -+ -+// Set Channel depend on the country code -+ rtw_wx_set_channel_plan, //0x0A -+ -+ rtw_dbg_port, //0x0B -+ rtw_wx_write_rf, //0x0C -+ rtw_wx_read_rf, //0x0D -+ -+#ifndef CONFIG_MP_INCLUDED -+ rtw_wx_priv_null, //0x0E -+ rtw_wx_priv_null, //0x0F -+#else -+ rtw_mp_set, //0x0E -+ rtw_mp_get, //0x0F -+#endif -+ rtw_p2p_set, //0x10 -+ rtw_p2p_get, //0x11 -+ NULL, //0x12 -+ rtw_p2p_get2, //0x13 -+ -+ rtw_tdls, //0x14 -+ rtw_tdls_get, //0x15 -+ -+ rtw_pm_set, //0x16 -+ rtw_wx_priv_null, //0x17 -+ rtw_rereg_nd_name, //0x18 -+ rtw_wx_priv_null, //0x19 -+ -+ rtw_mp_efuse_set, //0x1A -+ rtw_mp_efuse_get, //0x1B -+ NULL, // 0x1C is reserved for hostapd -+ rtw_test, // 0x1D -+#ifdef CONFIG_INTEL_WIDI -+ rtw_widi_set, //0x1E -+ rtw_widi_set_probe_request, //0x1F -+#endif // CONFIG_INTEL_WIDI -+}; -+ -+#endif // #if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_MP_IWPRIV_SUPPORT) -+ -+#if WIRELESS_EXT >= 17 -+static struct iw_statistics *rtw_get_wireless_stats(struct net_device *dev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); -+ struct iw_statistics *piwstats=&padapter->iwstats; -+ int tmp_level = 0; -+ int tmp_qual = 0; -+ int tmp_noise = 0; -+ -+ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) != true) -+ { -+ piwstats->qual.qual = 0; -+ piwstats->qual.level = 0; -+ piwstats->qual.noise = 0; -+ //DBG_871X("No link level:%d, qual:%d, noise:%d\n", tmp_level, tmp_qual, tmp_noise); -+ } -+ else{ -+ #ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ tmp_level = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); -+ #else -+ tmp_level = padapter->recvpriv.signal_strength; -+ #ifdef CONFIG_BT_COEXIST -+ { -+ u8 signal = (u8)tmp_level; -+ BT_SignalCompensation(padapter, &signal, NULL); -+ tmp_level= signal; -+ } -+ #endif // CONFIG_BT_COEXIST -+ #endif -+ -+ tmp_qual = padapter->recvpriv.signal_qual; -+ tmp_noise =padapter->recvpriv.noise; -+ //DBG_871X("level:%d, qual:%d, noise:%d, rssi (%d)\n", tmp_level, tmp_qual, tmp_noise,padapter->recvpriv.rssi); -+ -+ piwstats->qual.level = tmp_level; -+ piwstats->qual.qual = tmp_qual; -+ piwstats->qual.noise = tmp_noise; -+ } -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,14)) -+ piwstats->qual.updated = IW_QUAL_ALL_UPDATED ;//|IW_QUAL_DBM; -+#else -+ piwstats->qual.updated = 0x0f; -+#endif -+ -+ #ifdef CONFIG_SIGNAL_DISPLAY_DBM -+ piwstats->qual.updated = piwstats->qual.updated | IW_QUAL_DBM; -+ #endif -+ -+ return &padapter->iwstats; -+} -+#endif -+ -+#ifdef CONFIG_WIRELESS_EXT -+struct iw_handler_def rtw_handlers_def = -+{ -+ .standard = rtw_handlers, -+ .num_standard = sizeof(rtw_handlers) / sizeof(iw_handler), -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,33)) || defined(CONFIG_WEXT_PRIV) -+ .private = rtw_private_handler, -+ .private_args = (struct iw_priv_args *)rtw_private_args, -+ .num_private = sizeof(rtw_private_handler) / sizeof(iw_handler), -+ .num_private_args = sizeof(rtw_private_args) / sizeof(struct iw_priv_args), -+#endif -+#if WIRELESS_EXT >= 17 -+ .get_wireless_stats = rtw_get_wireless_stats, -+#endif -+}; -+#endif -+ -+// copy from net/wireless/wext.c start -+/* ---------------------------------------------------------------- */ -+/* -+ * Calculate size of private arguments -+ */ -+static const char iw_priv_type_size[] = { -+ 0, /* IW_PRIV_TYPE_NONE */ -+ 1, /* IW_PRIV_TYPE_BYTE */ -+ 1, /* IW_PRIV_TYPE_CHAR */ -+ 0, /* Not defined */ -+ sizeof(__u32), /* IW_PRIV_TYPE_INT */ -+ sizeof(struct iw_freq), /* IW_PRIV_TYPE_FLOAT */ -+ sizeof(struct sockaddr), /* IW_PRIV_TYPE_ADDR */ -+ 0, /* Not defined */ -+}; -+ -+static int get_priv_size(__u16 args) -+{ -+ int num = args & IW_PRIV_SIZE_MASK; -+ int type = (args & IW_PRIV_TYPE_MASK) >> 12; -+ -+ return num * iw_priv_type_size[type]; -+} -+// copy from net/wireless/wext.c end -+ -+static int rtw_ioctl_wext_private(struct net_device *dev, union iwreq_data *wrq_data) -+{ -+ int err = 0; -+ u8 *input = NULL; -+ u32 input_len = 0; -+ const char delim[] = " "; -+ u8 *output = NULL; -+ u32 output_len = 0; -+ u32 count = 0; -+ u8 *buffer= NULL; -+ u32 buffer_len = 0; -+ char *ptr = NULL; -+ u8 cmdname[17] = {0}; // IFNAMSIZ+1 -+ u32 cmdlen; -+ s32 len; -+ u8 *extra = NULL; -+ u32 extra_size = 0; -+ -+ s32 k; -+ const iw_handler *priv; /* Private ioctl */ -+ const struct iw_priv_args *priv_args; /* Private ioctl description */ -+ u32 num_priv; /* Number of ioctl */ -+ u32 num_priv_args; /* Number of descriptions */ -+ iw_handler handler; -+ int temp; -+ int subcmd = 0; /* sub-ioctl index */ -+ int offset = 0; /* Space for sub-ioctl index */ -+ -+ union iwreq_data wdata; -+ -+ -+ _rtw_memcpy(&wdata, wrq_data, sizeof(wdata)); -+ -+ input_len = wdata.data.length; -+ input = rtw_zmalloc(input_len); -+ if (NULL == input) -+ return -ENOMEM; -+ if (copy_from_user(input, wdata.data.pointer, input_len)) { -+ err = -EFAULT; -+ goto exit; -+ } -+ ptr = input; -+ len = input_len; -+ -+ sscanf(ptr, "%16s", cmdname); -+ cmdlen = strlen(cmdname); -+ DBG_8192C("%s: cmd=%s\n", __func__, cmdname); -+ -+ // skip command string -+ if (cmdlen > 0) -+ cmdlen += 1; // skip one space -+ ptr += cmdlen; -+ len -= cmdlen; -+ DBG_8192C("%s: parameters=%s\n", __func__, ptr); -+ -+ priv = rtw_private_handler; -+ priv_args = rtw_private_args; -+ num_priv = sizeof(rtw_private_handler) / sizeof(iw_handler); -+ num_priv_args = sizeof(rtw_private_args) / sizeof(struct iw_priv_args); -+ -+ if (num_priv_args == 0) { -+ err = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+ /* Search the correct ioctl */ -+ k = -1; -+ while((++k < num_priv_args) && strcmp(priv_args[k].name, cmdname)); -+ -+ /* If not found... */ -+ if (k == num_priv_args) { -+ err = -EOPNOTSUPP; -+ goto exit; -+ } -+ -+ /* Watch out for sub-ioctls ! */ -+ if (priv_args[k].cmd < SIOCDEVPRIVATE) -+ { -+ int j = -1; -+ -+ /* Find the matching *real* ioctl */ -+ while ((++j < num_priv_args) && ((priv_args[j].name[0] != '\0') || -+ (priv_args[j].set_args != priv_args[k].set_args) || -+ (priv_args[j].get_args != priv_args[k].get_args))); -+ -+ /* If not found... */ -+ if (j == num_priv_args) { -+ err = -EINVAL; -+ goto exit; -+ } -+ -+ /* Save sub-ioctl number */ -+ subcmd = priv_args[k].cmd; -+ /* Reserve one int (simplify alignment issues) */ -+ offset = sizeof(__u32); -+ /* Use real ioctl definition from now on */ -+ k = j; -+ } -+ -+ buffer = rtw_zmalloc(4096); -+ if (NULL == buffer) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ /* If we have to set some data */ -+ if ((priv_args[k].set_args & IW_PRIV_TYPE_MASK) && -+ (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) -+ { -+ u8 *str; -+ -+ switch (priv_args[k].set_args & IW_PRIV_TYPE_MASK) -+ { -+ case IW_PRIV_TYPE_BYTE: -+ /* Fetch args */ -+ count = 0; -+ do { -+ str = strsep(&ptr, delim); -+ if (NULL == str) break; -+ sscanf(str, "%i", &temp); -+ buffer[count++] = (u8)temp; -+ } while (1); -+ buffer_len = count; -+ -+ /* Number of args to fetch */ -+ wdata.data.length = count; -+ if (wdata.data.length > (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) -+ wdata.data.length = priv_args[k].set_args & IW_PRIV_SIZE_MASK; -+ -+ break; -+ -+ case IW_PRIV_TYPE_INT: -+ /* Fetch args */ -+ count = 0; -+ do { -+ str = strsep(&ptr, delim); -+ if (NULL == str) break; -+ sscanf(str, "%i", &temp); -+ ((s32*)buffer)[count++] = (s32)temp; -+ } while (1); -+ buffer_len = count * sizeof(s32); -+ -+ /* Number of args to fetch */ -+ wdata.data.length = count; -+ if (wdata.data.length > (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) -+ wdata.data.length = priv_args[k].set_args & IW_PRIV_SIZE_MASK; -+ -+ break; -+ -+ case IW_PRIV_TYPE_CHAR: -+ if (len > 0) -+ { -+ /* Size of the string to fetch */ -+ wdata.data.length = len; -+ if (wdata.data.length > (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) -+ wdata.data.length = priv_args[k].set_args & IW_PRIV_SIZE_MASK; -+ -+ /* Fetch string */ -+ _rtw_memcpy(buffer, ptr, wdata.data.length); -+ } -+ else -+ { -+ wdata.data.length = 1; -+ buffer[0] = '\0'; -+ } -+ buffer_len = wdata.data.length; -+ break; -+ -+ default: -+ DBG_8192C("%s: Not yet implemented...\n", __func__); -+ err = -1; -+ goto exit; -+ } -+ -+ if ((priv_args[k].set_args & IW_PRIV_SIZE_FIXED) && -+ (wdata.data.length != (priv_args[k].set_args & IW_PRIV_SIZE_MASK))) -+ { -+ DBG_8192C("%s: The command %s needs exactly %d argument(s)...\n", -+ __func__, cmdname, priv_args[k].set_args & IW_PRIV_SIZE_MASK); -+ err = -EINVAL; -+ goto exit; -+ } -+ } /* if args to set */ -+ else -+ { -+ wdata.data.length = 0L; -+ } -+ -+ /* Those two tests are important. They define how the driver -+ * will have to handle the data */ -+ if ((priv_args[k].set_args & IW_PRIV_SIZE_FIXED) && -+ ((get_priv_size(priv_args[k].set_args) + offset) <= IFNAMSIZ)) -+ { -+ /* First case : all SET args fit within wrq */ -+ if (offset) -+ wdata.mode = subcmd; -+ _rtw_memcpy(wdata.name + offset, buffer, IFNAMSIZ - offset); -+ } -+ else -+ { -+ if ((priv_args[k].set_args == 0) && -+ (priv_args[k].get_args & IW_PRIV_SIZE_FIXED) && -+ (get_priv_size(priv_args[k].get_args) <= IFNAMSIZ)) -+ { -+ /* Second case : no SET args, GET args fit within wrq */ -+ if (offset) -+ wdata.mode = subcmd; -+ } -+ else -+ { -+ /* Third case : args won't fit in wrq, or variable number of args */ -+ if (copy_to_user(wdata.data.pointer, buffer, buffer_len)) { -+ err = -EFAULT; -+ goto exit; -+ } -+ wdata.data.flags = subcmd; -+ } -+ } -+ -+ rtw_mfree(input, input_len); -+ input = NULL; -+ -+ extra_size = 0; -+ if (IW_IS_SET(priv_args[k].cmd)) -+ { -+ /* Size of set arguments */ -+ extra_size = get_priv_size(priv_args[k].set_args); -+ -+ /* Does it fits in iwr ? */ -+ if ((priv_args[k].set_args & IW_PRIV_SIZE_FIXED) && -+ ((extra_size + offset) <= IFNAMSIZ)) -+ extra_size = 0; -+ } else { -+ /* Size of get arguments */ -+ extra_size = get_priv_size(priv_args[k].get_args); -+ -+ /* Does it fits in iwr ? */ -+ if ((priv_args[k].get_args & IW_PRIV_SIZE_FIXED) && -+ (extra_size <= IFNAMSIZ)) -+ extra_size = 0; -+ } -+ -+ if (extra_size == 0) { -+ extra = (u8*)&wdata; -+ rtw_mfree(buffer, 4096); -+ buffer = NULL; -+ } else -+ extra = buffer; -+ -+ handler = priv[priv_args[k].cmd - SIOCIWFIRSTPRIV]; -+ err = handler(dev, NULL, &wdata, extra); -+ -+ /* If we have to get some data */ -+ if ((priv_args[k].get_args & IW_PRIV_TYPE_MASK) && -+ (priv_args[k].get_args & IW_PRIV_SIZE_MASK)) -+ { -+ int j; -+ int n = 0; /* number of args */ -+ u8 str[20] = {0}; -+ -+ /* Check where is the returned data */ -+ if ((priv_args[k].get_args & IW_PRIV_SIZE_FIXED) && -+ (get_priv_size(priv_args[k].get_args) <= IFNAMSIZ)) -+ n = priv_args[k].get_args & IW_PRIV_SIZE_MASK; -+ else -+ n = wdata.data.length; -+ -+ output = rtw_zmalloc(4096); -+ if (NULL == output) { -+ err = -ENOMEM; -+ goto exit; -+ } -+ -+ switch (priv_args[k].get_args & IW_PRIV_TYPE_MASK) -+ { -+ case IW_PRIV_TYPE_BYTE: -+ /* Display args */ -+ for (j = 0; j < n; j++) -+ { -+ sprintf(str, "%d ", extra[j]); -+ len = strlen(str); -+ output_len = strlen(output); -+ if ((output_len + len + 1) > 4096) { -+ err = -E2BIG; -+ goto exit; -+ } -+ _rtw_memcpy(output+output_len, str, len); -+ } -+ break; -+ -+ case IW_PRIV_TYPE_INT: -+ /* Display args */ -+ for (j = 0; j < n; j++) -+ { -+ sprintf(str, "%d ", ((__s32*)extra)[j]); -+ len = strlen(str); -+ output_len = strlen(output); -+ if ((output_len + len + 1) > 4096) { -+ err = -E2BIG; -+ goto exit; -+ } -+ _rtw_memcpy(output+output_len, str, len); -+ } -+ break; -+ -+ case IW_PRIV_TYPE_CHAR: -+ /* Display args */ -+ _rtw_memcpy(output, extra, n); -+ break; -+ -+ default: -+ DBG_8192C("%s: Not yet implemented...\n", __func__); -+ err = -1; -+ goto exit; -+ } -+ -+ output_len = strlen(output) + 1; -+ wrq_data->data.length = output_len; -+ if (copy_to_user(wrq_data->data.pointer, output, output_len)) { -+ err = -EFAULT; -+ goto exit; -+ } -+ } /* if args to set */ -+ else -+ { -+ wrq_data->data.length = 0; -+ } -+ -+exit: -+ if (input) -+ rtw_mfree(input, input_len); -+ if (buffer) -+ rtw_mfree(buffer, 4096); -+ if (output) -+ rtw_mfree(output, 4096); -+ -+ return err; -+} -+ -+int rtw_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) -+{ -+ struct iwreq *wrq = (struct iwreq *)rq; -+ int ret=0; -+ -+ switch (cmd) -+ { -+ case RTL_IOCTL_WPA_SUPPLICANT: -+ ret = wpa_supplicant_ioctl(dev, &wrq->u.data); -+ break; -+#ifdef CONFIG_AP_MODE -+ case RTL_IOCTL_HOSTAPD: -+ ret = rtw_hostapd_ioctl(dev, &wrq->u.data); -+ break; -+#ifdef CONFIG_NO_WIRELESS_HANDLERS -+ case SIOCSIWMODE: -+ ret = rtw_wx_set_mode(dev, NULL, &wrq->u, NULL); -+ break; -+#endif -+#endif // CONFIG_AP_MODE -+ case SIOCDEVPRIVATE: -+ ret = rtw_ioctl_wext_private(dev, &wrq->u); -+ break; -+ case (SIOCDEVPRIVATE+1): -+ ret = rtw_android_priv_cmd(dev, rq, cmd); -+ break; -+ default: -+ ret = -EOPNOTSUPP; -+ break; -+ } -+ -+ return ret; -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/mlme_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/mlme_linux.c ---- linux-4.14.17/3rdparty/rtl8812au/os_dep/mlme_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/mlme_linux.c 2018-02-06 17:42:30.724967372 +0200 -@@ -0,0 +1,567 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#define _MLME_OSDEP_C_ -+ -+#include -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+void rtw_join_timeout_handler(void *FunctionContext) -+#else -+void rtw_join_timeout_handler(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *adapter = (_adapter *)FunctionContext; -+#else -+ _adapter *adapter = from_timer(adapter, t, mlmepriv.assoc_timer); -+#endif -+ -+ _rtw_join_timeout_handler(adapter); -+} -+ -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+void _rtw_scan_timeout_handler(void *FunctionContext) -+#else -+void _rtw_scan_timeout_handler(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *adapter = (_adapter *)FunctionContext; -+#else -+ _adapter *adapter = from_timer(adapter, t, mlmepriv.scan_to_timer); -+#endif -+ rtw_scan_timeout_handler(adapter); -+} -+ -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+static void _dynamic_check_timer_handlder(void *FunctionContext) -+#else -+static void _dynamic_check_timer_handlder(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *adapter = (_adapter *)FunctionContext; -+#else -+ _adapter *adapter = from_timer(adapter, t, mlmepriv.dynamic_chk_timer); -+#endif -+ -+#if (MP_DRIVER == 1) -+ if (adapter->registrypriv.mp_mode == 1) -+ return; -+#endif -+ rtw_dynamic_check_timer_handlder(adapter); -+ -+ _set_timer(&adapter->mlmepriv.dynamic_chk_timer, 2000); -+} -+ -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+void _rtw_set_scan_deny_timer_hdl(void *FunctionContext) -+#else -+void _rtw_set_scan_deny_timer_hdl(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *adapter = (_adapter *)FunctionContext; -+#else -+ _adapter *adapter = from_timer(adapter, t, mlmepriv.set_scan_deny_timer); -+#endif -+ -+ rtw_set_scan_deny_timer_hdl(adapter); -+} -+#endif -+ -+ -+void rtw_init_mlme_timer(_adapter *padapter) -+{ -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _init_timer(&(pmlmepriv->assoc_timer), padapter->pnetdev, rtw_join_timeout_handler, padapter); -+ _init_timer(&(pmlmepriv->scan_to_timer), padapter->pnetdev, _rtw_scan_timeout_handler, padapter); -+ _init_timer(&(pmlmepriv->dynamic_chk_timer), padapter->pnetdev, _dynamic_check_timer_handlder, padapter); -+ #ifdef CONFIG_SET_SCAN_DENY_TIMER -+ _init_timer(&(pmlmepriv->set_scan_deny_timer), padapter->pnetdev, _rtw_set_scan_deny_timer_hdl, padapter); -+ #endif -+#else -+ timer_setup(&pmlmepriv->assoc_timer, rtw_join_timeout_handler, 0); -+ timer_setup(&pmlmepriv->scan_to_timer, _rtw_scan_timeout_handler, 0); -+ timer_setup(&pmlmepriv->dynamic_chk_timer, _dynamic_check_timer_handlder, 0); -+ #ifdef CONFIG_SET_SCAN_DENY_TIMER -+ timer_setup(&pmlmepriv->set_scan_deny_timer, _rtw_set_scan_deny_timer_hdl, 0); -+ #endif -+#endif -+} -+ -+void rtw_os_indicate_connect(_adapter *adapter) -+{ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_indicate_connect(adapter); -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ rtw_indicate_wx_assoc_event(adapter); -+ netif_carrier_on(adapter->pnetdev); -+ -+ if(adapter->pid[2] !=0) -+ rtw_signal_process(adapter->pid[2], SIGALRM); -+} -+ -+extern void indicate_wx_scan_complete_event(_adapter *padapter); -+void rtw_os_indicate_scan_done( _adapter *padapter, bool aborted) -+{ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_indicate_scan_done(wdev_to_priv(padapter->rtw_wdev), aborted); -+#endif -+ indicate_wx_scan_complete_event(padapter); -+} -+ -+static RT_PMKID_LIST backupPMKIDList[ NUM_PMKID_CACHE ]; -+void rtw_reset_securitypriv( _adapter *adapter ) -+{ -+ u8 backupPMKIDIndex = 0; -+ u8 backupTKIPCountermeasure = 0x00; -+ u32 backupTKIPcountermeasure_time = 0; -+ -+ if(adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X)//802.1x -+ { -+ // Added by Albert 2009/02/18 -+ // We have to backup the PMK information for WiFi PMK Caching test item. -+ // -+ // Backup the btkip_countermeasure information. -+ // When the countermeasure is trigger, the driver have to disconnect with AP for 60 seconds. -+ -+ _rtw_memset( &backupPMKIDList[ 0 ], 0x00, sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE ); -+ -+ _rtw_memcpy( &backupPMKIDList[ 0 ], &adapter->securitypriv.PMKIDList[ 0 ], sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE ); -+ backupPMKIDIndex = adapter->securitypriv.PMKIDIndex; -+ backupTKIPCountermeasure = adapter->securitypriv.btkip_countermeasure; -+ backupTKIPcountermeasure_time = adapter->securitypriv.btkip_countermeasure_time; -+ -+ _rtw_memset((unsigned char *)&adapter->securitypriv, 0, sizeof (struct security_priv)); -+ //_init_timer(&(adapter->securitypriv.tkip_timer),adapter->pnetdev, rtw_use_tkipkey_handler, adapter); -+ -+ // Added by Albert 2009/02/18 -+ // Restore the PMK information to securitypriv structure for the following connection. -+ _rtw_memcpy( &adapter->securitypriv.PMKIDList[ 0 ], &backupPMKIDList[ 0 ], sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE ); -+ adapter->securitypriv.PMKIDIndex = backupPMKIDIndex; -+ adapter->securitypriv.btkip_countermeasure = backupTKIPCountermeasure; -+ adapter->securitypriv.btkip_countermeasure_time = backupTKIPcountermeasure_time; -+ -+ adapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; -+ adapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; -+ -+ } -+ else //reset values in securitypriv -+ { -+ //if(adapter->mlmepriv.fw_state & WIFI_STATION_STATE) -+ //{ -+ struct security_priv *psec_priv=&adapter->securitypriv; -+ -+ psec_priv->dot11AuthAlgrthm =dot11AuthAlgrthm_Open; //open system -+ psec_priv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ psec_priv->dot11PrivacyKeyIndex = 0; -+ -+ psec_priv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psec_priv->dot118021XGrpKeyid = 1; -+ -+ psec_priv->ndisauthtype = Ndis802_11AuthModeOpen; -+ psec_priv->ndisencryptstatus = Ndis802_11WEPDisabled; -+ //} -+ } -+} -+ -+void rtw_os_indicate_disconnect( _adapter *adapter ) -+{ -+ //RT_PMKID_LIST backupPMKIDList[ NUM_PMKID_CACHE ]; -+ -+ -+ -+ netif_carrier_off(adapter->pnetdev); // Do it first for tx broadcast pkt after disconnection issue! -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_indicate_disconnect(adapter); -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ rtw_indicate_wx_disassoc_event(adapter); -+ -+ rtw_reset_securitypriv( adapter ); -+} -+ -+void rtw_report_sec_ie(_adapter *adapter,u8 authmode,u8 *sec_ie) -+{ -+ uint len; -+ u8 *buff,*p,i; -+ union iwreq_data wrqu; -+ -+ -+ -+ RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("+rtw_report_sec_ie, authmode=%d\n", authmode)); -+ -+ buff = NULL; -+ if(authmode==_WPA_IE_ID_) -+ { -+ RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("rtw_report_sec_ie, authmode=%d\n", authmode)); -+ -+ buff = rtw_malloc(IW_CUSTOM_MAX); -+ -+ _rtw_memset(buff,0,IW_CUSTOM_MAX); -+ -+ p=buff; -+ -+ p+=sprintf(p,"ASSOCINFO(ReqIEs="); -+ -+ len = sec_ie[1]+2; -+ len = (len < IW_CUSTOM_MAX) ? len:IW_CUSTOM_MAX; -+ -+ for(i=0;ipnetdev,IWEVCUSTOM,&wrqu,buff); -+#endif -+ -+ if(buff) -+ rtw_mfree(buff, IW_CUSTOM_MAX); -+ -+ } -+ -+ -+ -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+static void _survey_timer_hdl(void *FunctionContext) -+#else -+static void _survey_timer_hdl(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *padapter = (_adapter *)FunctionContext; -+#else -+ _adapter *padapter = from_timer(padapter, t, mlmeextpriv.survey_timer); -+#endif -+ -+ survey_timer_hdl(padapter); -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+static void _link_timer_hdl (void *FunctionContext) -+#else -+static void _link_timer_hdl(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *padapter = (_adapter *)FunctionContext; -+#else -+ _adapter *padapter = from_timer(padapter, t, mlmeextpriv.link_timer); -+#endif -+ link_timer_hdl(padapter); -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+static void _addba_timer_hdl(void *FunctionContext) -+#else -+static void _addba_timer_hdl(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ struct sta_info *psta = (struct sta_info *)FunctionContext; -+#else -+ struct sta_info *psta = from_timer(psta, t, addba_retry_timer); -+#endif -+ addba_timer_hdl(psta); -+} -+ -+void init_addba_retry_timer(_adapter *padapter, struct sta_info *psta) -+{ -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _init_timer(&psta->addba_retry_timer, padapter->pnetdev, _addba_timer_hdl, psta); -+#else -+ timer_setup(&psta->addba_retry_timer, _addba_timer_hdl, 0); -+#endif -+} -+ -+void init_mlme_ext_timer(_adapter *padapter) -+{ -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _init_timer(&pmlmeext->survey_timer, padapter->pnetdev, _survey_timer_hdl, padapter); -+ _init_timer(&pmlmeext->link_timer, padapter->pnetdev, _link_timer_hdl, padapter); -+#else -+ timer_setup(&pmlmeext->survey_timer, _survey_timer_hdl, 0); -+ timer_setup(&pmlmeext->link_timer, _link_timer_hdl, 0); -+#endif -+} -+ -+u8 rtw_handle_tkip_countermeasure(_adapter* padapter) -+{ -+ u8 status = _SUCCESS; -+ u32 cur_time = 0; -+ -+ if (padapter->securitypriv.btkip_countermeasure == true) { -+ cur_time = rtw_get_current_time(); -+ -+ if( (cur_time - padapter->securitypriv.btkip_countermeasure_time) > 60 * HZ ) -+ { -+ padapter->securitypriv.btkip_countermeasure = false; -+ padapter->securitypriv.btkip_countermeasure_time = 0; -+ } -+ else -+ { -+ status = _FAIL; -+ } -+ } -+ -+ return status; -+ -+} -+ -+#ifdef CONFIG_AP_MODE -+ -+void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta) -+{ -+ union iwreq_data wrqu; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ if(psta==NULL) -+ return; -+ -+ if(psta->aid > NUM_STA) -+ return; -+ -+ if(pstapriv->sta_aid[psta->aid - 1] != psta) -+ return; -+ -+ -+ wrqu.addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN); -+ -+ DBG_871X("+rtw_indicate_sta_assoc_event\n"); -+ -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(padapter->pnetdev, IWEVREGISTERED, &wrqu, NULL); -+#endif -+ -+} -+ -+void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta) -+{ -+ union iwreq_data wrqu; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ -+ if(psta==NULL) -+ return; -+ -+ if(psta->aid > NUM_STA) -+ return; -+ -+ if(pstapriv->sta_aid[psta->aid - 1] != psta) -+ return; -+ -+ -+ wrqu.addr.sa_family = ARPHRD_ETHER; -+ -+ _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN); -+ -+ DBG_871X("+rtw_indicate_sta_disassoc_event\n"); -+ -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event(padapter->pnetdev, IWEVEXPIRED, &wrqu, NULL); -+#endif -+ -+} -+ -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ -+static int mgnt_xmit_entry(struct sk_buff *skb, struct net_device *pnetdev) -+{ -+ struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev); -+ _adapter *padapter = (_adapter *)phostapdpriv->padapter; -+ -+ //DBG_871X("%s\n", __FUNCTION__); -+ -+ return rtw_hal_hostap_mgnt_xmit_entry(padapter, skb); -+} -+ -+static int mgnt_netdev_open(struct net_device *pnetdev) -+{ -+ struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev); -+ -+ DBG_871X("mgnt_netdev_open: MAC Address:" MAC_FMT "\n", MAC_ARG(pnetdev->dev_addr)); -+ -+ -+ init_usb_anchor(&phostapdpriv->anchored); -+ -+ if(!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_start_queue(pnetdev); -+ else -+ rtw_netif_wake_queue(pnetdev); -+ -+ -+ netif_carrier_on(pnetdev); -+ -+ //rtw_write16(phostapdpriv->padapter, 0x0116, 0x0100);//only excluding beacon -+ -+ return 0; -+} -+static int mgnt_netdev_close(struct net_device *pnetdev) -+{ -+ struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev); -+ -+ DBG_871X("%s\n", __FUNCTION__); -+ -+ usb_kill_anchored_urbs(&phostapdpriv->anchored); -+ -+ netif_carrier_off(pnetdev); -+ -+ if (!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_stop_queue(pnetdev); -+ -+ //rtw_write16(phostapdpriv->padapter, 0x0116, 0x3f3f); -+ -+ return 0; -+} -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+static const struct net_device_ops rtl871x_mgnt_netdev_ops = { -+ .ndo_open = mgnt_netdev_open, -+ .ndo_stop = mgnt_netdev_close, -+ .ndo_start_xmit = mgnt_xmit_entry, -+ //.ndo_set_mac_address = r871x_net_set_mac_address, -+ //.ndo_get_stats = r871x_net_get_stats, -+ //.ndo_do_ioctl = r871x_mp_ioctl, -+}; -+#endif -+ -+int hostapd_mode_init(_adapter *padapter) -+{ -+ unsigned char mac[ETH_ALEN]; -+ struct hostapd_priv *phostapdpriv; -+ struct net_device *pnetdev; -+ -+ pnetdev = rtw_alloc_etherdev(sizeof(struct hostapd_priv)); -+ if (!pnetdev) -+ return -ENOMEM; -+ -+ //SET_MODULE_OWNER(pnetdev); -+ ether_setup(pnetdev); -+ -+ //pnetdev->type = ARPHRD_IEEE80211; -+ -+ phostapdpriv = rtw_netdev_priv(pnetdev); -+ phostapdpriv->pmgnt_netdev = pnetdev; -+ phostapdpriv->padapter= padapter; -+ padapter->phostapdpriv = phostapdpriv; -+ -+ //pnetdev->init = NULL; -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+ -+ DBG_871X("register rtl871x_mgnt_netdev_ops to netdev_ops\n"); -+ -+ pnetdev->netdev_ops = &rtl871x_mgnt_netdev_ops; -+ -+#else -+ -+ pnetdev->open = mgnt_netdev_open; -+ -+ pnetdev->stop = mgnt_netdev_close; -+ -+ pnetdev->hard_start_xmit = mgnt_xmit_entry; -+ -+ //pnetdev->set_mac_address = r871x_net_set_mac_address; -+ -+ //pnetdev->get_stats = r871x_net_get_stats; -+ -+ //pnetdev->do_ioctl = r871x_mp_ioctl; -+ -+#endif -+ -+ pnetdev->watchdog_timeo = HZ; /* 1 second timeout */ -+ -+ //pnetdev->wireless_handlers = NULL; -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ pnetdev->features |= NETIF_F_IP_CSUM; -+#endif -+ -+ -+ -+ if(dev_alloc_name(pnetdev,"mgnt.wlan%d") < 0) -+ { -+ DBG_871X("hostapd_mode_init(): dev_alloc_name, fail! \n"); -+ } -+ -+ -+ //SET_NETDEV_DEV(pnetdev, pintfpriv->udev); -+ -+ -+ mac[0]=0x00; -+ mac[1]=0xe0; -+ mac[2]=0x4c; -+ mac[3]=0x87; -+ mac[4]=0x11; -+ mac[5]=0x12; -+ -+ _rtw_memcpy(pnetdev->dev_addr, mac, ETH_ALEN); -+ -+ -+ netif_carrier_off(pnetdev); -+ -+ -+ /* Tell the network stack we exist */ -+ if (register_netdev(pnetdev) != 0) -+ { -+ DBG_871X("hostapd_mode_init(): register_netdev fail!\n"); -+ -+ if(pnetdev) -+ { -+ rtw_free_netdev(pnetdev); -+ } -+ } -+ -+ return 0; -+ -+} -+ -+void hostapd_mode_unload(_adapter *padapter) -+{ -+ struct hostapd_priv *phostapdpriv = padapter->phostapdpriv; -+ struct net_device *pnetdev = phostapdpriv->pmgnt_netdev; -+ -+ unregister_netdev(pnetdev); -+ rtw_free_netdev(pnetdev); -+ -+} -+ -+#endif -+#endif -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/osdep_service.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/osdep_service.c ---- linux-4.14.17/3rdparty/rtl8812au/os_dep/osdep_service.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/osdep_service.c 2018-02-06 17:42:30.725967387 +0200 -@@ -0,0 +1,1236 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+ -+#define _OSDEP_SERVICE_C_ -+ -+#include -+ -+#define RT_TAG '1178' -+ -+#ifdef DBG_MEMORY_LEAK -+atomic_t _malloc_cnt = ATOMIC_INIT(0); -+atomic_t _malloc_size = ATOMIC_INIT(0); -+#endif /* DBG_MEMORY_LEAK */ -+ -+/* -+* Translate the OS dependent @param error_code to OS independent RTW_STATUS_CODE -+* @return: one of RTW_STATUS_CODE -+*/ -+inline int RTW_STATUS_CODE(int error_code){ -+ if(error_code >=0) -+ return _SUCCESS; -+ -+ switch(error_code) { -+ //case -ETIMEDOUT: -+ // return RTW_STATUS_TIMEDOUT; -+ default: -+ return _FAIL; -+ } -+} -+ -+u32 rtw_atoi(u8* s) -+{ -+ -+ int num=0,flag=0; -+ int i; -+ for(i=0;i<=strlen(s);i++) -+ { -+ if(s[i] >= '0' && s[i] <= '9') -+ num = num * 10 + s[i] -'0'; -+ else if(s[0] == '-' && i==0) -+ flag =1; -+ else -+ break; -+ } -+ -+ if(flag == 1) -+ num = num * -1; -+ -+ return(num); -+ -+} -+ -+inline u8* _rtw_vmalloc(u32 sz) -+{ -+ u8 *pbuf; -+ pbuf = vmalloc(sz); -+#ifdef DBG_MEMORY_LEAK -+ if ( pbuf != NULL) { -+ atomic_inc(&_malloc_cnt); -+ atomic_add(sz, &_malloc_size); -+ } -+#endif /* DBG_MEMORY_LEAK */ -+ -+ return pbuf; -+} -+ -+inline u8* _rtw_zvmalloc(u32 sz) -+{ -+ u8 *pbuf; -+ pbuf = _rtw_vmalloc(sz); -+ if (pbuf != NULL) -+ memset(pbuf, 0, sz); -+ return pbuf; -+} -+ -+inline void _rtw_vmfree(u8 *pbuf, u32 sz) -+{ -+ vfree(pbuf); -+#ifdef DBG_MEMORY_LEAK -+ atomic_dec(&_malloc_cnt); -+ atomic_sub(sz, &_malloc_size); -+#endif /* DBG_MEMORY_LEAK */ -+} -+ -+u8* _rtw_malloc(u32 sz) -+{ -+ -+ u8 *pbuf=NULL; -+ -+ pbuf = kmalloc(sz,in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); -+ -+#ifdef DBG_MEMORY_LEAK -+ if ( pbuf != NULL) { -+ atomic_inc(&_malloc_cnt); -+ atomic_add(sz, &_malloc_size); -+ } -+#endif /* DBG_MEMORY_LEAK */ -+ -+ return pbuf; -+} -+ -+u8* _rtw_zmalloc(u32 sz) -+{ -+ u8 *pbuf = _rtw_malloc(sz); -+ -+ if (pbuf != NULL) { -+ memset(pbuf, 0, sz); -+ } -+ return pbuf; -+} -+ -+void _rtw_mfree(u8 *pbuf, u32 sz) -+{ -+ kfree(pbuf); -+#ifdef DBG_MEMORY_LEAK -+ atomic_dec(&_malloc_cnt); -+ atomic_sub(sz, &_malloc_size); -+#endif /* DBG_MEMORY_LEAK */ -+} -+ -+#ifdef DBG_MEM_ALLOC -+ -+struct rtw_dbg_mem_stat { -+ ATOMIC_T vir_alloc; // the memory bytes we allocate now -+ ATOMIC_T vir_peak; // the peak memory bytes we allocate -+ ATOMIC_T vir_alloc_err; // the error times we fail to allocate memory -+ -+ ATOMIC_T phy_alloc; -+ ATOMIC_T phy_peak; -+ ATOMIC_T phy_alloc_err; -+ -+ ATOMIC_T tx_alloc; -+ ATOMIC_T tx_peak; -+ ATOMIC_T tx_alloc_err; -+ -+ ATOMIC_T rx_alloc; -+ ATOMIC_T rx_peak; -+ ATOMIC_T rx_alloc_err; -+} rtw_dbg_mem_stat; -+ -+void rtw_dump_mem_stat (void) -+{ -+ int vir_alloc, vir_peak, vir_alloc_err, phy_alloc, phy_peak, phy_alloc_err; -+ int tx_alloc, tx_peak, tx_alloc_err, rx_alloc, rx_peak, rx_alloc_err; -+ -+ vir_alloc=ATOMIC_READ(&rtw_dbg_mem_stat.vir_alloc); -+ vir_peak=ATOMIC_READ(&rtw_dbg_mem_stat.vir_peak); -+ vir_alloc_err=ATOMIC_READ(&rtw_dbg_mem_stat.vir_alloc_err); -+ -+ phy_alloc=ATOMIC_READ(&rtw_dbg_mem_stat.phy_alloc); -+ phy_peak=ATOMIC_READ(&rtw_dbg_mem_stat.phy_peak); -+ phy_alloc_err=ATOMIC_READ(&rtw_dbg_mem_stat.phy_alloc_err); -+ -+ tx_alloc=ATOMIC_READ(&rtw_dbg_mem_stat.tx_alloc); -+ tx_peak=ATOMIC_READ(&rtw_dbg_mem_stat.tx_peak); -+ tx_alloc_err=ATOMIC_READ(&rtw_dbg_mem_stat.tx_alloc_err); -+ -+ rx_alloc=ATOMIC_READ(&rtw_dbg_mem_stat.rx_alloc); -+ rx_peak=ATOMIC_READ(&rtw_dbg_mem_stat.rx_peak); -+ rx_alloc_err=ATOMIC_READ(&rtw_dbg_mem_stat.rx_alloc_err); -+ -+ DBG_871X( "vir_alloc:%d, vir_peak:%d, vir_alloc_err:%d\n" -+ "phy_alloc:%d, phy_peak:%d, phy_alloc_err:%d\n" -+ "tx_alloc:%d, tx_peak:%d, tx_alloc_err:%d\n" -+ "rx_alloc:%d, rx_peak:%d, rx_alloc_err:%d\n" -+ , vir_alloc, vir_peak, vir_alloc_err -+ , phy_alloc, phy_peak, phy_alloc_err -+ , tx_alloc, tx_peak, tx_alloc_err -+ , rx_alloc, rx_peak, rx_alloc_err -+ ); -+} -+ -+void rtw_update_mem_stat(u8 flag, u32 sz) -+{ -+ static u32 update_time = 0; -+ int peak, alloc; -+ -+ if(!update_time) { -+ ATOMIC_SET(&rtw_dbg_mem_stat.vir_alloc,0); -+ ATOMIC_SET(&rtw_dbg_mem_stat.vir_peak,0); -+ ATOMIC_SET(&rtw_dbg_mem_stat.vir_alloc_err,0); -+ ATOMIC_SET(&rtw_dbg_mem_stat.phy_alloc,0); -+ ATOMIC_SET(&rtw_dbg_mem_stat.phy_peak,0); -+ ATOMIC_SET(&rtw_dbg_mem_stat.phy_alloc_err,0); -+ } -+ -+ switch(flag) { -+ case MEM_STAT_VIR_ALLOC_SUCCESS: -+ alloc = ATOMIC_ADD_RETURN(&rtw_dbg_mem_stat.vir_alloc, sz); -+ peak=ATOMIC_READ(&rtw_dbg_mem_stat.vir_peak); -+ if (peak 5000) { -+ rtw_dump_mem_stat(); -+ update_time=rtw_get_current_time(); -+ } -+ -+ -+} -+ -+ -+inline u8* dbg_rtw_vmalloc(u32 sz, const char *func, int line) -+{ -+ u8 *p; -+ //DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ p=_rtw_vmalloc((sz)); -+ -+ rtw_update_mem_stat( -+ p ? MEM_STAT_VIR_ALLOC_SUCCESS : MEM_STAT_VIR_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+} -+ -+inline u8* dbg_rtw_zvmalloc(u32 sz, const char *func, int line) -+{ -+ u8 *p; -+ //DBG_871X("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ p=_rtw_zvmalloc((sz)); -+ -+ rtw_update_mem_stat( -+ p ? MEM_STAT_VIR_ALLOC_SUCCESS : MEM_STAT_VIR_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+} -+ -+inline void dbg_rtw_vmfree(u8 *pbuf, u32 sz, const char *func, int line) -+{ -+ //DBG_871X("DBG_MEM_ALLOC %s:%d %s(%p,%d)\n", func, line, __FUNCTION__, (pbuf), (sz)); -+ -+ _rtw_vmfree((pbuf), (sz)); -+ -+ rtw_update_mem_stat( -+ MEM_STAT_VIR_FREE -+ , sz -+ ); -+ -+} -+ -+inline u8* dbg_rtw_malloc(u32 sz, const char *func, int line) -+{ -+ u8 *p; -+ -+ if((sz)>4096) -+ DBG_871X("DBG_MEM_ALLOC !!!!!!!!!!!!!! %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ p=_rtw_malloc((sz)); -+ -+ rtw_update_mem_stat( -+ p ? MEM_STAT_PHY_ALLOC_SUCCESS : MEM_STAT_PHY_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+} -+ -+inline u8* dbg_rtw_zmalloc(u32 sz, const char *func, int line) -+{ -+ u8 *p; -+ -+ if((sz)>4096) -+ DBG_871X("DBG_MEM_ALLOC !!!!!!!!!!!!!! %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); -+ -+ p = _rtw_zmalloc((sz)); -+ -+ rtw_update_mem_stat( -+ p ? MEM_STAT_PHY_ALLOC_SUCCESS : MEM_STAT_PHY_ALLOC_FAIL -+ , sz -+ ); -+ -+ return p; -+ -+} -+ -+inline void dbg_rtw_mfree(u8 *pbuf, u32 sz, const char *func, int line) -+{ -+ if((sz)>4096) -+ DBG_871X("DBG_MEM_ALLOC !!!!!!!!!!!!!! %s:%d %s(%p,%d)\n", func, line, __FUNCTION__, (pbuf), (sz)); -+ -+ _rtw_mfree((pbuf), (sz)); -+ -+ rtw_update_mem_stat( -+ MEM_STAT_PHY_FREE -+ , sz -+ ); -+} -+#endif -+ -+void* rtw_malloc2d(int h, int w, int size) -+{ -+ int j; -+ -+ void **a = (void **) rtw_zmalloc( h*sizeof(void *) + h*w*size ); -+ if(a == NULL) -+ { -+ DBG_871X("%s: alloc memory fail!\n", __FUNCTION__); -+ return NULL; -+ } -+ -+ for( j=0; jpnetdev, pfunc, adapter); -+} -+#endif -+ -+/* -+ -+Caller must check if the list is empty before calling rtw_list_delete -+ -+*/ -+ -+ -+void _rtw_init_sema(_sema *sema, int init_val) -+{ -+ sema_init(sema, init_val); -+} -+ -+void _rtw_free_sema(_sema *sema) -+{ -+} -+ -+void _rtw_up_sema(_sema *sema) -+{ -+ up(sema); -+} -+ -+u32 _rtw_down_sema(_sema *sema) -+{ -+ if (down_interruptible(sema)) -+ return _FAIL; -+ else -+ return _SUCCESS; -+} -+ -+void _rtw_mutex_init(_mutex *pmutex) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ mutex_init(pmutex); -+#else -+ init_MUTEX(pmutex); -+#endif -+} -+ -+void _rtw_mutex_free(_mutex *pmutex) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) -+ mutex_destroy(pmutex); -+#endif -+} -+ -+void _rtw_spinlock_init(_lock *plock) -+{ -+ spin_lock_init(plock); -+} -+ -+void _rtw_spinlock_free(_lock *plock) -+{ -+} -+ -+void _rtw_spinlock(_lock *plock) -+{ -+ spin_lock(plock); -+} -+ -+void _rtw_spinunlock(_lock *plock) -+{ -+ spin_unlock(plock); -+} -+ -+void _rtw_spinlock_ex(_lock *plock) -+{ -+ spin_lock(plock); -+} -+ -+void _rtw_spinunlock_ex(_lock *plock) -+{ -+ spin_unlock(plock); -+} -+ -+void _rtw_init_queue(_queue *pqueue) -+{ -+ -+ _rtw_init_listhead(&(pqueue->queue)); -+ -+ _rtw_spinlock_init(&(pqueue->lock)); -+ -+} -+ -+u32 _rtw_queue_empty(_queue *pqueue) -+{ -+ return (rtw_is_list_empty(&(pqueue->queue))); -+} -+ -+ -+u32 rtw_end_of_queue_search(_list *head, _list *plist) -+{ -+ if (head == plist) -+ return true; -+ else -+ return false; -+} -+ -+ -+u32 rtw_get_current_time(void) -+{ -+ return jiffies; -+} -+ -+inline u32 rtw_systime_to_ms(u32 systime) -+{ -+ return systime * 1000 / HZ; -+} -+ -+inline u32 rtw_ms_to_systime(u32 ms) -+{ -+ return ms * HZ / 1000; -+} -+ -+// the input parameter start use the same unit as returned by rtw_get_current_time -+inline s32 rtw_get_passing_time_ms(u32 start) -+{ -+ return rtw_systime_to_ms(jiffies-start); -+} -+ -+inline s32 rtw_get_time_interval_ms(u32 start, u32 end) -+{ -+ return rtw_systime_to_ms(end-start); -+} -+ -+void rtw_sleep_schedulable(int ms) -+{ -+ u32 delta; -+ -+ delta = (ms * HZ)/1000;//(ms) -+ if (delta == 0) { -+ delta = 1;// 1 ms -+ } -+ set_current_state(TASK_INTERRUPTIBLE); -+ if (schedule_timeout(delta) != 0) { -+ return ; -+ } -+} -+ -+void rtw_msleep_os(int ms) -+{ -+ msleep((unsigned int)ms); -+} -+ -+void rtw_usleep_os(int us) -+{ -+ if ( 1 < (us/1000) ) -+ msleep(1); -+ else -+ msleep( (us/1000) + 1); -+} -+ -+#ifdef DBG_DELAY_OS -+void _rtw_mdelay_os(int ms, const char *func, const int line) -+{ -+ DBG_871X("%s:%d %s(%d)\n", func, line, __FUNCTION__, ms); -+ -+ mdelay((unsigned long)ms); -+} -+ -+void _rtw_udelay_os(int us, const char *func, const int line) -+{ -+ DBG_871X("%s:%d %s(%d)\n", func, line, __FUNCTION__, us); -+ -+ udelay((unsigned long)us); -+} -+#else -+void rtw_mdelay_os(int ms) -+{ -+ mdelay((unsigned long)ms); -+} -+ -+void rtw_udelay_os(int us) -+{ -+ udelay((unsigned long)us); -+} -+#endif -+ -+void rtw_yield_os(void) -+{ -+ yield(); -+} -+ -+#define RTW_SUSPEND_LOCK_NAME "rtw_wifi" -+ -+#ifdef CONFIG_WAKELOCK -+static struct wake_lock rtw_suspend_lock; -+#elif defined(CONFIG_ANDROID_POWER) -+static android_suspend_lock_t rtw_suspend_lock ={ -+ .name = RTW_SUSPEND_LOCK_NAME -+}; -+#endif -+ -+void rtw_suspend_lock_init(void) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock_init(&rtw_suspend_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_LOCK_NAME); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_init_suspend_lock(&rtw_suspend_lock); -+ #endif -+} -+ -+void rtw_suspend_lock_uninit(void) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock_destroy(&rtw_suspend_lock); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_uninit_suspend_lock(&rtw_suspend_lock); -+ #endif -+} -+ -+void rtw_lock_suspend(void) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock(&rtw_suspend_lock); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend(&rtw_suspend_lock); -+ #endif -+ -+ #if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) -+ //DBG_871X("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); -+ #endif -+} -+ -+void rtw_unlock_suspend(void) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_unlock(&rtw_suspend_lock); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_unlock_suspend(&rtw_suspend_lock); -+ #endif -+ -+ #if defined(CONFIG_WAKELOCK) || defined(CONFIG_ANDROID_POWER) -+ //DBG_871X("####%s: suspend_lock_count:%d####\n", __FUNCTION__, rtw_suspend_lock.stat.count); -+ #endif -+} -+ -+#ifdef CONFIG_WOWLAN -+void rtw_lock_suspend_timeout(long timeout) -+{ -+ #ifdef CONFIG_WAKELOCK -+ wake_lock_timeout(&rtw_suspend_lock, timeout); -+ #elif defined(CONFIG_ANDROID_POWER) -+ android_lock_suspend_auto_expire(&rtw_suspend_lock, timeout); -+ #endif -+} -+#endif //CONFIG_WOWLAN -+ -+inline void ATOMIC_SET(ATOMIC_T *v, int i) -+{ -+ atomic_set(v,i); -+} -+ -+inline int ATOMIC_READ(ATOMIC_T *v) -+{ -+ return atomic_read(v); -+} -+ -+inline void ATOMIC_ADD(ATOMIC_T *v, int i) -+{ -+ atomic_add(i,v); -+} -+ -+inline void ATOMIC_SUB(ATOMIC_T *v, int i) -+{ -+ atomic_sub(i,v); -+} -+ -+inline void ATOMIC_INC(ATOMIC_T *v) -+{ -+ atomic_inc(v); -+} -+ -+inline void ATOMIC_DEC(ATOMIC_T *v) -+{ -+ atomic_dec(v); -+} -+ -+inline int ATOMIC_ADD_RETURN(ATOMIC_T *v, int i) -+{ -+ return atomic_add_return(i,v); -+} -+ -+inline int ATOMIC_SUB_RETURN(ATOMIC_T *v, int i) -+{ -+ return atomic_sub_return(i,v); -+} -+ -+inline int ATOMIC_INC_RETURN(ATOMIC_T *v) -+{ -+ return atomic_inc_return(v); -+} -+ -+inline int ATOMIC_DEC_RETURN(ATOMIC_T *v) -+{ -+ return atomic_dec_return(v); -+} -+ -+/* -+* Open a file with the specific @param path, @param flag, @param mode -+* @param fpp the pointer of struct file pointer to get struct file pointer while file opening is success -+* @param path the path of the file to open -+* @param flag file operation flags, please refer to linux document -+* @param mode please refer to linux document -+* @return Linux specific error code -+*/ -+static int openFile(struct file **fpp, char *path, int flag, int mode) -+{ -+ struct file *fp; -+ -+ fp=filp_open(path, flag, mode); -+ if(IS_ERR(fp)) { -+ *fpp=NULL; -+ return PTR_ERR(fp); -+ } -+ else { -+ *fpp=fp; -+ return 0; -+ } -+} -+ -+/* -+* Close the file with the specific @param fp -+* @param fp the pointer of struct file to close -+* @return always 0 -+*/ -+static int closeFile(struct file *fp) -+{ -+ filp_close(fp,NULL); -+ return 0; -+} -+ -+static int readFile(struct file *fp,char *buf,int len) -+{ -+ int rlen=0, sum=0; -+ -+ if (!fp->f_op || !fp->f_op->read) -+ return -EPERM; -+ -+ while(sumf_op->read(fp,buf+sum,len-sum, &fp->f_pos); -+ if(rlen>0) -+ sum+=rlen; -+ else if(0 != rlen) -+ return rlen; -+ else -+ break; -+ } -+ -+ return sum; -+ -+} -+ -+static int writeFile(struct file *fp,char *buf,int len) -+{ -+ int wlen=0, sum=0; -+ -+ if (!fp->f_op || !fp->f_op->write) -+ return -EPERM; -+ -+ while(sumf_op->write(fp,buf+sum,len-sum, &fp->f_pos); -+ if(wlen>0) -+ sum+=wlen; -+ else if(0 != wlen) -+ return wlen; -+ else -+ break; -+ } -+ -+ return sum; -+ -+} -+ -+/* -+* Test if the specifi @param path is a file and readable -+* @param path the path of the file to test -+* @return Linux specific error code -+*/ -+static int isFileReadable(char *path) -+{ -+ struct file *fp; -+ int ret = 0; -+ mm_segment_t oldfs; -+ char buf; -+ -+ fp=filp_open(path, O_RDONLY, 0); -+ if(IS_ERR(fp)) { -+ ret = PTR_ERR(fp); -+ } -+ else { -+ oldfs = get_fs(); set_fs(get_ds()); -+ -+ if(1!=readFile(fp, &buf, 1)) -+ ret = PTR_ERR(fp); -+ -+ set_fs(oldfs); -+ filp_close(fp,NULL); -+ } -+ return ret; -+} -+ -+/* -+* Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most -+* @param path the path of the file to open and read -+* @param buf the starting address of the buffer to store file content -+* @param sz how many bytes to read at most -+* @return the byte we've read, or Linux specific error code -+*/ -+static int retriveFromFile(char *path, u8* buf, u32 sz) -+{ -+ int ret =-1; -+ mm_segment_t oldfs; -+ struct file *fp; -+ -+ if(path && buf) { -+ if( 0 == (ret=openFile(&fp,path, O_RDONLY, 0)) ){ -+ DBG_871X("%s openFile path:%s fp=%p\n",__FUNCTION__, path ,fp); -+ -+ oldfs = get_fs(); set_fs(get_ds()); -+ ret=readFile(fp, buf, sz); -+ set_fs(oldfs); -+ closeFile(fp); -+ -+ DBG_871X("%s readFile, ret:%d\n",__FUNCTION__, ret); -+ -+ } else { -+ DBG_871X("%s openFile path:%s Fail, ret:%d\n",__FUNCTION__, path, ret); -+ } -+ } else { -+ DBG_871X("%s NULL pointer\n",__FUNCTION__); -+ ret = -EINVAL; -+ } -+ return ret; -+} -+ -+/* -+* Open the file with @param path and wirte @param sz byte of data starting from @param buf into the file -+* @param path the path of the file to open and write -+* @param buf the starting address of the data to write into file -+* @param sz how many bytes to write at most -+* @return the byte we've written, or Linux specific error code -+*/ -+static int storeToFile(char *path, u8* buf, u32 sz) -+{ -+ int ret =0; -+ mm_segment_t oldfs; -+ struct file *fp; -+ -+ if(path && buf) { -+ if( 0 == (ret=openFile(&fp, path, O_CREAT|O_WRONLY, 0666)) ) { -+ DBG_871X("%s openFile path:%s fp=%p\n",__FUNCTION__, path ,fp); -+ -+ oldfs = get_fs(); set_fs(get_ds()); -+ ret=writeFile(fp, buf, sz); -+ set_fs(oldfs); -+ closeFile(fp); -+ -+ DBG_871X("%s writeFile, ret:%d\n",__FUNCTION__, ret); -+ -+ } else { -+ DBG_871X("%s openFile path:%s Fail, ret:%d\n",__FUNCTION__, path, ret); -+ } -+ } else { -+ DBG_871X("%s NULL pointer\n",__FUNCTION__); -+ ret = -EINVAL; -+ } -+ return ret; -+} -+ -+/* -+* Test if the specifi @param path is a file and readable -+* @param path the path of the file to test -+* @return true or false -+*/ -+int rtw_is_file_readable(char *path) -+{ -+ if(isFileReadable(path) == 0) -+ return true; -+ else -+ return false; -+} -+ -+/* -+* Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most -+* @param path the path of the file to open and read -+* @param buf the starting address of the buffer to store file content -+* @param sz how many bytes to read at most -+* @return the byte we've read -+*/ -+int rtw_retrive_from_file(char *path, u8* buf, u32 sz) -+{ -+ int ret =retriveFromFile(path, buf, sz); -+ return ret>=0?ret:0; -+} -+ -+/* -+* Open the file with @param path and wirte @param sz byte of data starting from @param buf into the file -+* @param path the path of the file to open and write -+* @param buf the starting address of the data to write into file -+* @param sz how many bytes to write at most -+* @return the byte we've written -+*/ -+int rtw_store_to_file(char *path, u8* buf, u32 sz) -+{ -+ int ret =storeToFile(path, buf, sz); -+ return ret>=0?ret:0; -+} -+ -+struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv) -+{ -+ struct net_device *pnetdev; -+ struct rtw_netdev_priv_indicator *pnpi; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); -+#else -+ pnetdev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); -+#endif -+ if (!pnetdev) -+ goto RETURN; -+ -+ pnpi = netdev_priv(pnetdev); -+ pnpi->priv=old_priv; -+ pnpi->sizeof_priv=sizeof_priv; -+ -+RETURN: -+ return pnetdev; -+} -+ -+struct net_device *rtw_alloc_etherdev(int sizeof_priv) -+{ -+ struct net_device *pnetdev; -+ struct rtw_netdev_priv_indicator *pnpi; -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); -+#else -+ pnetdev = alloc_etherdev(sizeof(struct rtw_netdev_priv_indicator)); -+#endif -+ if (!pnetdev) -+ goto RETURN; -+ -+ pnpi = netdev_priv(pnetdev); -+ -+ pnpi->priv = rtw_zvmalloc(sizeof_priv); -+ if (!pnpi->priv) { -+ free_netdev(pnetdev); -+ pnetdev = NULL; -+ goto RETURN; -+ } -+ -+ pnpi->sizeof_priv=sizeof_priv; -+RETURN: -+ return pnetdev; -+} -+ -+void rtw_free_netdev(struct net_device * netdev) -+{ -+ struct rtw_netdev_priv_indicator *pnpi; -+ -+ if(!netdev) -+ goto RETURN; -+ -+ pnpi = netdev_priv(netdev); -+ -+ if(!pnpi->priv) -+ goto RETURN; -+ -+ rtw_vmfree(pnpi->priv, pnpi->sizeof_priv); -+ free_netdev(netdev); -+ -+RETURN: -+ return; -+} -+ -+/* -+* Jeff: this function should be called under ioctl (rtnl_lock is accquired) while -+* LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26) -+*/ -+int rtw_change_ifname(_adapter *padapter, const char *ifname) -+{ -+ struct net_device *pnetdev; -+ struct net_device *cur_pnetdev = padapter->pnetdev; -+ struct rereg_nd_name_data *rereg_priv; -+ int ret; -+ -+ if(!padapter) -+ goto error; -+ -+ rereg_priv = &padapter->rereg_nd_name_priv; -+ -+ //free the old_pnetdev -+ if(rereg_priv->old_pnetdev) { -+ free_netdev(rereg_priv->old_pnetdev); -+ rereg_priv->old_pnetdev = NULL; -+ } -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,26)) -+ if(!rtnl_is_locked()) -+ unregister_netdev(cur_pnetdev); -+ else -+#endif -+ unregister_netdevice(cur_pnetdev); -+ -+ rtw_proc_remove_one(cur_pnetdev); -+ -+ rereg_priv->old_pnetdev=cur_pnetdev; -+ -+ pnetdev = rtw_init_netdev(padapter); -+ if (!pnetdev) { -+ ret = -1; -+ goto error; -+ } -+ -+ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(adapter_to_dvobj(padapter))); -+ -+ rtw_init_netdev_name(pnetdev, ifname); -+ -+ _rtw_memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,26)) -+ if(!rtnl_is_locked()) -+ ret = register_netdev(pnetdev); -+ else -+#endif -+ ret = register_netdevice(pnetdev); -+ -+ if ( ret != 0) { -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("register_netdev() failed\n")); -+ goto error; -+ } -+ -+ rtw_proc_init_one(pnetdev); -+ -+ return 0; -+ -+error: -+ -+ return -1; -+ -+} -+ -+u64 rtw_modular64(u64 x, u64 y) -+{ -+ return do_div(x, y); -+} -+ -+u64 rtw_division64(u64 x, u64 y) -+{ -+ do_div(x, y); -+ return x; -+} -+ -+void rtw_buf_free(u8 **buf, u32 *buf_len) -+{ -+ u32 ori_len; -+ -+ if (!buf || !buf_len) -+ return; -+ -+ ori_len = *buf_len; -+ -+ if (*buf) { -+ *buf_len = 0; -+ _rtw_mfree(*buf, *buf_len); -+ *buf = NULL; -+ } -+} -+ -+void rtw_buf_update(u8 **buf, u32 *buf_len, u8 *src, u32 src_len) -+{ -+ u32 ori_len = 0, dup_len = 0; -+ u8 *ori = NULL; -+ u8 *dup = NULL; -+ -+ if (!buf || !buf_len) -+ return; -+ -+ if (!src || !src_len) -+ goto keep_ori; -+ -+ /* duplicate src */ -+ dup = rtw_malloc(src_len); -+ if (dup) { -+ dup_len = src_len; -+ _rtw_memcpy(dup, src, dup_len); -+ } -+ -+keep_ori: -+ ori = *buf; -+ ori_len = *buf_len; -+ -+ /* replace buf with dup */ -+ *buf_len = 0; -+ *buf = dup; -+ *buf_len = dup_len; -+ -+ /* free ori */ -+ if (ori && ori_len > 0) -+ _rtw_mfree(ori, ori_len); -+} -+ -+ -+/** -+ * rtw_cbuf_full - test if cbuf is full -+ * @cbuf: pointer of struct rtw_cbuf -+ * -+ * Returns: true if cbuf is full -+ */ -+inline bool rtw_cbuf_full(struct rtw_cbuf *cbuf) -+{ -+ return (cbuf->write == cbuf->read-1)? true : false; -+} -+ -+/** -+ * rtw_cbuf_empty - test if cbuf is empty -+ * @cbuf: pointer of struct rtw_cbuf -+ * -+ * Returns: true if cbuf is empty -+ */ -+inline bool rtw_cbuf_empty(struct rtw_cbuf *cbuf) -+{ -+ return (cbuf->write == cbuf->read)? true : false; -+} -+ -+/** -+ * rtw_cbuf_push - push a pointer into cbuf -+ * @cbuf: pointer of struct rtw_cbuf -+ * @buf: pointer to push in -+ * -+ * Lock free operation, be careful of the use scheme -+ * Returns: true push success -+ */ -+bool rtw_cbuf_push(struct rtw_cbuf *cbuf, void *buf) -+{ -+ if (rtw_cbuf_full(cbuf)) -+ return _FAIL; -+ -+ if (0) -+ DBG_871X("%s on %u\n", __func__, cbuf->write); -+ cbuf->bufs[cbuf->write] = buf; -+ cbuf->write = (cbuf->write+1)%cbuf->size; -+ -+ return _SUCCESS; -+} -+ -+/** -+ * rtw_cbuf_pop - pop a pointer from cbuf -+ * @cbuf: pointer of struct rtw_cbuf -+ * -+ * Lock free operation, be careful of the use scheme -+ * Returns: pointer popped out -+ */ -+void *rtw_cbuf_pop(struct rtw_cbuf *cbuf) -+{ -+ void *buf; -+ if (rtw_cbuf_empty(cbuf)) -+ return NULL; -+ -+ if (0) -+ DBG_871X("%s on %u\n", __func__, cbuf->read); -+ buf = cbuf->bufs[cbuf->read]; -+ cbuf->read = (cbuf->read+1)%cbuf->size; -+ -+ return buf; -+} -+ -+/** -+ * rtw_cbuf_alloc - allocte a rtw_cbuf with given size and do initialization -+ * @size: size of pointer -+ * -+ * Returns: pointer of srtuct rtw_cbuf, NULL for allocation failure -+ */ -+struct rtw_cbuf *rtw_cbuf_alloc(u32 size) -+{ -+ struct rtw_cbuf *cbuf; -+ -+ cbuf = (struct rtw_cbuf *)rtw_malloc(sizeof(*cbuf) + sizeof(void*)*size); -+ -+ if (cbuf) { -+ cbuf->write = cbuf->read = 0; -+ cbuf->size = size; -+ } -+ -+ return cbuf; -+} -+ -+/** -+ * rtw_cbuf_free - free the given rtw_cbuf -+ * @cbuf: pointer of struct rtw_cbuf to free -+ */ -+void rtw_cbuf_free(struct rtw_cbuf *cbuf) -+{ -+ rtw_mfree((u8*)cbuf, sizeof(*cbuf) + sizeof(void*)*cbuf->size); -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/os_intfs.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/os_intfs.c ---- linux-4.14.17/3rdparty/rtl8812au/os_dep/os_intfs.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/os_intfs.c 2018-02-06 17:42:30.725967387 +0200 -@@ -0,0 +1,2756 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _OS_INTFS_C_ -+ -+#include -+ -+MODULE_LICENSE("GPL"); -+MODULE_DESCRIPTION("Realtek Wireless Lan Driver"); -+MODULE_AUTHOR("Realtek Semiconductor Corp."); -+MODULE_VERSION(DRIVERVERSION); -+ -+/* module param defaults */ -+static int rtw_chip_version = 0x00; -+static int rtw_rfintfs = HWPI; -+static int rtw_lbkmode = 0;//RTL8712_AIR_TRX; -+ -+ -+static int rtw_network_mode = Ndis802_11IBSS;//Ndis802_11Infrastructure;//infra, ad-hoc, auto -+//NDIS_802_11_SSID ssid; -+static int rtw_channel = 1;//ad-hoc support requirement -+static int rtw_wireless_mode = WIRELESS_MODE_MAX; -+static int rtw_vrtl_carrier_sense = AUTO_VCS; -+static int rtw_vcs_type = RTS_CTS;//* -+static int rtw_rts_thresh = 2347;//* -+static int rtw_frag_thresh = 2346;//* -+static int rtw_preamble = PREAMBLE_LONG;//long, short, auto -+static int rtw_scan_mode = 1;//active, passive -+static int rtw_adhoc_tx_pwr = 1; -+static int rtw_soft_ap = 0; -+//int smart_ps = 1; -+#ifdef CONFIG_POWER_SAVING -+static int rtw_power_mgnt = 1; -+#ifdef CONFIG_IPS_LEVEL_2 -+static int rtw_ips_mode = IPS_LEVEL_2; -+#else -+static int rtw_ips_mode = IPS_NORMAL; -+#endif -+#else -+static int rtw_power_mgnt = PS_MODE_ACTIVE; -+static int rtw_ips_mode = IPS_NONE; -+#endif -+ -+static int rtw_smart_ps = 2; -+ -+#ifdef CONFIG_TX_EARLY_MODE -+static int rtw_early_mode=1; -+#endif -+module_param(rtw_ips_mode, int, 0644); -+MODULE_PARM_DESC(rtw_ips_mode,"The default IPS mode"); -+ -+static int rtw_radio_enable = 1; -+static int rtw_long_retry_lmt = 7; -+static int rtw_short_retry_lmt = 7; -+static int rtw_busy_thresh = 40; -+//int qos_enable = 0; //* -+static int rtw_ack_policy = NORMAL_ACK; -+ -+static int rtw_mp_mode = 0; -+ -+static int rtw_software_encrypt = 0; -+static int rtw_software_decrypt = 0; -+ -+static int rtw_acm_method = 0;// 0:By SW 1:By HW. -+ -+static int rtw_wmm_enable = 1;// default is set to enable the wmm. -+static int rtw_uapsd_enable = 0; -+static int rtw_uapsd_max_sp = NO_LIMIT; -+static int rtw_uapsd_acbk_en = 0; -+static int rtw_uapsd_acbe_en = 0; -+static int rtw_uapsd_acvi_en = 0; -+static int rtw_uapsd_acvo_en = 0; -+ -+#ifdef CONFIG_80211N_HT -+int rtw_ht_enable = 1; -+// 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz, 4: 80+80MHz -+// 2.4G use bit 0 ~ 3, 5G use bit 4 ~ 7 -+// 0x21 means enable 2.4G 40MHz & 5G 80MHz -+int rtw_bw_mode = 0x21; -+static int rtw_cbw40_enable = 3; // 0 :diable, bit(0): enable 2.4g, bit(1): enable 5g -+int rtw_ampdu_enable = 1;//for enable tx_ampdu -+static int rtw_rx_stbc = 1;// 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ -+static int rtw_ampdu_amsdu = 0;// 0: disabled, 1:enabled, 2:auto -+// Short GI support Bit Map -+// BIT0 - 20MHz, 0: support, 1: non-support -+// BIT1 - 40MHz, 0: support, 1: non-support -+// BIT2 - 80MHz, 0: support, 1: non-support -+// BIT3 - 160MHz, 0: support, 1: non-support -+static int rtw_short_gi = 0xf; -+#endif //CONFIG_80211N_HT -+ -+#ifdef CONFIG_80211AC_VHT -+static int rtw_vht_enable = 1; -+static int rtw_ampdu_factor = 7; -+static int rtw_vht_rate_sel = 0; -+// BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx -+static int rtw_ldpc_cap = 0x33; -+// BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx -+static int rtw_stbc_cap = 0x3; -+// BIT0: Enable VHT Beamformer, BIT1: Enable VHT Beamformee, BIT4: Enable HT Beamformer, BIT5: Enable HT Beamformee -+static int rtw_beamform_cap = 0; -+#endif //CONFIG_80211AC_VHT -+ -+static int rtw_lowrate_two_xmit = 1;//Use 2 path Tx to transmit MCS0~7 and legacy mode -+ -+//int rf_config = RF_1T2R; // 1T2R -+static int rtw_rf_config = RF_MAX_TYPE; //auto -+static int rtw_low_power = 0; -+#ifdef CONFIG_WIFI_TEST -+static int rtw_wifi_spec = 1;//for wifi test -+#else -+static int rtw_wifi_spec = 0; -+#endif -+static int rtw_channel_plan = RT_CHANNEL_DOMAIN_MAX; -+ -+#ifdef CONFIG_BT_COEXIST -+int rtw_btcoex_enable = 1; -+int rtw_bt_iso = 2;// 0:Low, 1:High, 2:From Efuse -+int rtw_bt_sco = 3;// 0:Idle, 1:None-SCO, 2:SCO, 3:From Counter, 4.Busy, 5.OtherBusy -+int rtw_bt_ampdu =1 ;// 0:Disable BT control A-MPDU, 1:Enable BT control A-MPDU. -+#endif -+ -+static int rtw_AcceptAddbaReq = true;// 0:Reject AP's Add BA req, 1:Accept AP's Add BA req. -+ -+static int rtw_antdiv_cfg = 2; // 0:OFF , 1:ON, 2:decide by Efuse config -+static int rtw_antdiv_type = 0 ; //0:decide by efuse 1: for 88EE, 1Tx and 1RxCG are diversity.(2 Ant with SPDT), 2: for 88EE, 1Tx and 2Rx are diversity.( 2 Ant, Tx and RxCG are both on aux port, RxCS is on main port ), 3: for 88EE, 1Tx and 1RxCG are fixed.(1Ant, Tx and RxCG are both on aux port) -+ -+ -+#ifdef CONFIG_USB_AUTOSUSPEND -+static int rtw_enusbss = 1;//0:disable,1:enable -+#else -+static int rtw_enusbss = 0;//0:disable,1:enable -+#endif -+ -+static int rtw_hwpdn_mode=2;//0:disable,1:enable,2: by EFUSE config -+ -+#ifdef CONFIG_HW_PWRP_DETECTION -+static int rtw_hwpwrp_detect = 1; -+#else -+static int rtw_hwpwrp_detect = 0; //HW power ping detect 0:disable , 1:enable -+#endif -+ -+static int rtw_hw_wps_pbc = 1; -+ -+#ifdef CONFIG_TX_MCAST2UNI -+int rtw_mc2u_disable = 0; -+#endif // CONFIG_TX_MCAST2UNI -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+int rtw_dmsp = 0; -+#endif // CONFIG_DUALMAC_CONCURRENT -+ -+#ifdef CONFIG_80211D -+static int rtw_80211d = 0; -+#endif -+ -+#ifdef CONFIG_REGULATORY_CTRL -+static int rtw_regulatory_id =2; -+#else -+static int rtw_regulatory_id = 0xff;// Regulatory tab id, 0xff = follow efuse's setting -+#endif -+module_param(rtw_regulatory_id, int, 0644); -+ -+ -+#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+int rtw_force_ant = 2;//0 :normal, 1:Main ant, 2:Aux ant -+int rtw_force_igi =0;//0 :normal -+module_param(rtw_force_ant, int, 0644); -+module_param(rtw_force_igi, int, 0644); -+#endif -+ -+static char* ifname = "wlan%d"; -+module_param(ifname, charp, 0644); -+MODULE_PARM_DESC(ifname, "The default name to allocate for first interface"); -+ -+static char* if2name = "wlan%d"; -+module_param(if2name, charp, 0644); -+MODULE_PARM_DESC(if2name, "The default name to allocate for second interface"); -+ -+char* rtw_initmac = NULL; // temp mac address if users want to use instead of the mac address in Efuse -+ -+#ifdef CONFIG_MULTI_VIR_IFACES -+int rtw_ext_iface_num = 1;//primary/secondary iface is excluded -+module_param(rtw_ext_iface_num, int, 0644); -+#endif //CONFIG_MULTI_VIR_IFACES -+ -+module_param(rtw_initmac, charp, 0644); -+module_param(rtw_channel_plan, int, 0644); -+module_param(rtw_chip_version, int, 0644); -+module_param(rtw_rfintfs, int, 0644); -+module_param(rtw_lbkmode, int, 0644); -+module_param(rtw_network_mode, int, 0644); -+module_param(rtw_channel, int, 0644); -+module_param(rtw_mp_mode, int, 0644); -+module_param(rtw_wmm_enable, int, 0644); -+module_param(rtw_vrtl_carrier_sense, int, 0644); -+module_param(rtw_vcs_type, int, 0644); -+module_param(rtw_busy_thresh, int, 0644); -+ -+#ifdef CONFIG_80211N_HT -+module_param(rtw_ht_enable, int, 0644); -+module_param(rtw_bw_mode, int, 0644); -+module_param(rtw_ampdu_enable, int, 0644); -+module_param(rtw_rx_stbc, int, 0644); -+module_param(rtw_ampdu_amsdu, int, 0644); -+#endif //CONFIG_80211N_HT -+#ifdef CONFIG_80211AC_VHT -+module_param(rtw_vht_enable, int, 0644); -+#endif //CONFIG_80211AC_VHT -+ -+module_param(rtw_lowrate_two_xmit, int, 0644); -+ -+module_param(rtw_rf_config, int, 0644); -+module_param(rtw_power_mgnt, int, 0644); -+module_param(rtw_smart_ps, int, 0644); -+module_param(rtw_low_power, int, 0644); -+module_param(rtw_wifi_spec, int, 0644); -+ -+module_param(rtw_antdiv_cfg, int, 0644); -+module_param(rtw_antdiv_type, int, 0644); -+ -+module_param(rtw_enusbss, int, 0644); -+module_param(rtw_hwpdn_mode, int, 0644); -+module_param(rtw_hwpwrp_detect, int, 0644); -+ -+module_param(rtw_hw_wps_pbc, int, 0644); -+ -+#ifdef CONFIG_TX_EARLY_MODE -+module_param(rtw_early_mode, int, 0644); -+#endif -+#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+char *rtw_adaptor_info_caching_file_path= "/data/misc/wifi/rtw_cache"; -+module_param(rtw_adaptor_info_caching_file_path, charp, 0644); -+MODULE_PARM_DESC(rtw_adaptor_info_caching_file_path, "The path of adapter info cache file"); -+#endif //CONFIG_ADAPTOR_INFO_CACHING_FILE -+ -+#ifdef CONFIG_LAYER2_ROAMING -+static uint rtw_max_roaming_times=2; -+module_param(rtw_max_roaming_times, uint, 0644); -+MODULE_PARM_DESC(rtw_max_roaming_times,"The max roaming times to try"); -+#endif //CONFIG_LAYER2_ROAMING -+ -+#ifdef CONFIG_IOL -+int rtw_fw_iol=1;// 0:Disable, 1:enable, 2:by usb speed -+module_param(rtw_fw_iol, int, 0644); -+MODULE_PARM_DESC(rtw_fw_iol,"FW IOL"); -+#endif //CONFIG_IOL -+ -+#ifdef CONFIG_FILE_FWIMG -+char *rtw_fw_file_path= ""; -+module_param(rtw_fw_file_path, charp, 0644); -+MODULE_PARM_DESC(rtw_fw_file_path, "The path of fw image"); -+#endif //CONFIG_FILE_FWIMG -+ -+#ifdef CONFIG_TX_MCAST2UNI -+module_param(rtw_mc2u_disable, int, 0644); -+#endif // CONFIG_TX_MCAST2UNI -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+module_param(rtw_dmsp, int, 0644); -+#endif // CONFIG_DUALMAC_CONCURRENT -+ -+#ifdef CONFIG_80211D -+module_param(rtw_80211d, int, 0644); -+MODULE_PARM_DESC(rtw_80211d, "Enable 802.11d mechanism"); -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+module_param(rtw_btcoex_enable, int, 0644); -+MODULE_PARM_DESC(rtw_btcoex_enable, "Enable BT co-existence mechanism"); -+#endif -+ -+static uint rtw_notch_filter = RTW_NOTCH_FILTER; -+module_param(rtw_notch_filter, uint, 0644); -+MODULE_PARM_DESC(rtw_notch_filter, "0:Disable, 1:Enable, 2:Enable only for P2P"); -+ -+static uint loadparam(PADAPTER padapter, _nic_hdl pnetdev); -+int _netdev_open(struct net_device *pnetdev); -+int netdev_open (struct net_device *pnetdev); -+static int netdev_close (struct net_device *pnetdev); -+ -+#ifdef CONFIG_PROC_DEBUG -+#define RTL8192C_PROC_NAME "rtl819xC" -+#define RTL8192D_PROC_NAME "rtl819xD" -+static char rtw_proc_name[IFNAMSIZ]; -+static struct proc_dir_entry *rtw_proc = NULL; -+static int rtw_proc_cnt = 0; -+ -+#define RTW_PROC_NAME DRV_NAME -+ -+#if(LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0)) -+typedef ssize_t (*read_proc_t) (struct file *, char __user *, size_t, loff_t *); -+static inline struct proc_dir_entry *create_proc_read_entry(const char *name, -+ mode_t mode, struct proc_dir_entry *base, -+ read_proc_t *read_proc, void * data) -+{ -+ struct file_operations fops = { -+ owner: THIS_MODULE, -+ read: read_proc -+ }; -+ struct proc_dir_entry *res = proc_create_data(name, mode, base, &fops, data); -+ return res; -+} -+typedef ssize_t (*write_proc_t) (struct file *, const char __user *, ssize_t, loff_t *); -+static inline struct proc_dir_entry *create_proc_read_write_entry(const char *name, -+ mode_t mode, struct proc_dir_entry *base, -+ read_proc_t *read_proc, void * data, write_proc_t *write_proc) -+{ -+ struct file_operations fops = { -+ owner: THIS_MODULE, -+ read: read_proc, -+ write: write_proc -+ }; -+ struct proc_dir_entry *res = proc_create_data(name, mode, base, &fops, data); -+ return res; -+} -+#endif -+ -+void rtw_proc_init_one(struct net_device *dev) -+{ -+ struct proc_dir_entry *dir_dev = NULL; -+ struct proc_dir_entry *entry=NULL; -+ _adapter *padapter = rtw_netdev_priv(dev); -+ u8 rf_type; -+ -+ if(rtw_proc == NULL) -+ { -+ if(padapter->chip_type == RTL8188C_8192C) -+ { -+ _rtw_memcpy(rtw_proc_name, RTL8192C_PROC_NAME, sizeof(RTL8192C_PROC_NAME)); -+ } -+ else if(padapter->chip_type == RTL8192D) -+ { -+ _rtw_memcpy(rtw_proc_name, RTL8192D_PROC_NAME, sizeof(RTL8192D_PROC_NAME)); -+ } -+ else if(padapter->chip_type == RTL8723A) -+ { -+ _rtw_memcpy(rtw_proc_name, RTW_PROC_NAME, sizeof(RTW_PROC_NAME)); -+ } -+ else if(padapter->chip_type == RTL8188E) -+ { -+ _rtw_memcpy(rtw_proc_name, RTW_PROC_NAME, sizeof(RTW_PROC_NAME)); -+ } -+ else -+ { -+ _rtw_memcpy(rtw_proc_name, RTW_PROC_NAME, sizeof(RTW_PROC_NAME)); -+ } -+ -+#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) -+ rtw_proc=create_proc_entry(rtw_proc_name, S_IFDIR, proc_net); -+#elif(LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0)) -+ rtw_proc=create_proc_entry(rtw_proc_name, S_IFDIR, init_net.proc_net); -+#else -+ rtw_proc=proc_create(rtw_proc_name, S_IFDIR, init_net.proc_net, NULL); -+#endif -+ if (rtw_proc == NULL) { -+ DBG_871X(KERN_ERR "Unable to create rtw_proc directory\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("ver_info", S_IFREG | S_IRUGO, rtw_proc, proc_get_drv_version, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ } -+ -+ -+ -+ if(padapter->dir_dev == NULL) -+ { -+#if(LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0)) -+ padapter->dir_dev = create_proc_entry(dev->name, -+ S_IFDIR | S_IRUGO | S_IXUGO, -+ rtw_proc); -+#else -+ padapter->dir_dev = proc_create(dev->name, -+ S_IFDIR | S_IRUGO | S_IXUGO, -+ rtw_proc, NULL); -+#endif -+ -+ dir_dev = padapter->dir_dev; -+ -+ if(dir_dev==NULL) -+ { -+ if(rtw_proc_cnt == 0) -+ { -+ if(rtw_proc){ -+#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) -+ remove_proc_entry(rtw_proc_name, proc_net); -+#else -+ remove_proc_entry(rtw_proc_name, init_net.proc_net); -+#endif -+ rtw_proc = NULL; -+ } -+ } -+ -+ DBG_871X("Unable to create dir_dev directory\n"); -+ return; -+ } -+ } -+ else -+ { -+ return; -+ } -+ -+ rtw_proc_cnt++; -+ -+ entry = create_proc_read_write_entry("write_reg", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_write_reg, dev, proc_set_write_reg); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_write_entry("read_reg", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_read_reg, dev, proc_set_read_reg); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("fwstate", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_fwstate, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("sec_info", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_sec_info, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("mlmext_state", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_mlmext_state, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("qos_option", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_qos_option, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("ht_option", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_ht_option, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("rf_info", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_rf_info, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("ap_info", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_ap_info, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("adapter_state", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_adapter_state, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("trx_info", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_trx_info, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("mac_reg_dump1", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_mac_reg_dump1, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("mac_reg_dump2", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_mac_reg_dump2, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("mac_reg_dump3", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_mac_reg_dump3, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("bb_reg_dump1", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_bb_reg_dump1, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("bb_reg_dump2", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_bb_reg_dump2, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("bb_reg_dump3", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_bb_reg_dump3, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("rf_reg_dump1", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_rf_reg_dump1, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("rf_reg_dump2", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_rf_reg_dump2, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if((RF_1T2R == rf_type) ||(RF_1T1R ==rf_type )) { -+ entry = create_proc_read_entry("rf_reg_dump3", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_rf_reg_dump3, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_entry("rf_reg_dump4", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_rf_reg_dump4, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ } -+ -+#ifdef CONFIG_AP_MODE -+ -+ entry = create_proc_read_entry("all_sta_info", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_all_sta_info, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+#endif -+ -+#ifdef DBG_MEMORY_LEAK -+ entry = create_proc_read_entry("_malloc_cnt", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_malloc_cnt, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+#endif -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ entry = create_proc_read_entry("best_channel", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_best_channel, dev); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+#endif -+ -+ entry = create_proc_read_write_entry("rx_signal", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_rx_signal, dev, proc_set_rx_signal); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+#ifdef CONFIG_80211N_HT -+ entry = create_proc_read_write_entry("ht_enable", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_ht_enable, dev, proc_set_ht_enable); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_write_entry("bw_mode", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_bw_mode, dev, proc_set_bw_mode); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_write_entry("ampdu_enable", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_ampdu_enable, dev, proc_set_ampdu_enable); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+ -+ entry = create_proc_read_write_entry("rx_stbc", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_rx_stbc, dev, proc_set_rx_stbc); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+#endif //CONFIG_80211N_HT -+ -+ entry = create_proc_read_entry("path_rssi", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_two_path_rssi, dev); -+ -+ entry = create_proc_read_write_entry("rssi_disp", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_rssi_disp, dev, proc_set_rssi_disp); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+#ifdef CONFIG_BT_COEXIST -+ entry = create_proc_read_write_entry("btcoex_dbg", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_btcoex_dbg, dev, proc_set_btcoex_dbg); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+#endif /*CONFIG_BT_COEXIST*/ -+ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ entry = create_proc_read_write_entry("sreset", S_IFREG | S_IRUGO, -+ dir_dev, proc_get_sreset, dev, proc_set_sreset); -+ if (!entry) { -+ DBG_871X("Unable to create_proc_read_entry!\n"); -+ return; -+ } -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ -+} -+ -+void rtw_proc_remove_one(struct net_device *dev) -+{ -+ struct proc_dir_entry *dir_dev = NULL; -+ _adapter *padapter = rtw_netdev_priv(dev); -+ u8 rf_type; -+ -+ dir_dev = padapter->dir_dev; -+ padapter->dir_dev = NULL; -+ -+ if (dir_dev) { -+ -+ remove_proc_entry("write_reg", dir_dev); -+ remove_proc_entry("read_reg", dir_dev); -+ remove_proc_entry("fwstate", dir_dev); -+ remove_proc_entry("sec_info", dir_dev); -+ remove_proc_entry("mlmext_state", dir_dev); -+ remove_proc_entry("qos_option", dir_dev); -+ remove_proc_entry("ht_option", dir_dev); -+ remove_proc_entry("rf_info", dir_dev); -+ remove_proc_entry("ap_info", dir_dev); -+ remove_proc_entry("adapter_state", dir_dev); -+ remove_proc_entry("trx_info", dir_dev); -+ -+ remove_proc_entry("mac_reg_dump1", dir_dev); -+ remove_proc_entry("mac_reg_dump2", dir_dev); -+ remove_proc_entry("mac_reg_dump3", dir_dev); -+ remove_proc_entry("bb_reg_dump1", dir_dev); -+ remove_proc_entry("bb_reg_dump2", dir_dev); -+ remove_proc_entry("bb_reg_dump3", dir_dev); -+ remove_proc_entry("rf_reg_dump1", dir_dev); -+ remove_proc_entry("rf_reg_dump2", dir_dev); -+ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); -+ if((RF_1T2R == rf_type) ||(RF_1T1R ==rf_type )) { -+ remove_proc_entry("rf_reg_dump3", dir_dev); -+ remove_proc_entry("rf_reg_dump4", dir_dev); -+ } -+#ifdef CONFIG_AP_MODE -+ remove_proc_entry("all_sta_info", dir_dev); -+#endif -+ -+#ifdef DBG_MEMORY_LEAK -+ remove_proc_entry("_malloc_cnt", dir_dev); -+#endif -+ -+#ifdef CONFIG_FIND_BEST_CHANNEL -+ remove_proc_entry("best_channel", dir_dev); -+#endif -+ remove_proc_entry("rx_signal", dir_dev); -+#ifdef CONFIG_80211N_HT -+ remove_proc_entry("bw_mode", dir_dev); -+ -+ remove_proc_entry("ht_enable", dir_dev); -+ -+ remove_proc_entry("ampdu_enable", dir_dev); -+ -+ remove_proc_entry("rx_stbc", dir_dev); -+#endif //CONFIG_80211N_HT -+ remove_proc_entry("path_rssi", dir_dev); -+ -+ remove_proc_entry("rssi_disp", dir_dev); -+ -+#ifdef CONFIG_BT_COEXIST -+ remove_proc_entry("btcoex_dbg", dir_dev); -+#endif //CONFIG_BT_COEXIST -+ -+#if defined(DBG_CONFIG_ERROR_DETECT) -+ remove_proc_entry("sreset", dir_dev); -+#endif /* DBG_CONFIG_ERROR_DETECT */ -+ -+ remove_proc_entry(dev->name, rtw_proc); -+ dir_dev = NULL; -+ -+ } -+ else -+ { -+ return; -+ } -+ -+ rtw_proc_cnt--; -+ -+ if(rtw_proc_cnt == 0) -+ { -+ if(rtw_proc){ -+ remove_proc_entry("ver_info", rtw_proc); -+ -+#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) -+ remove_proc_entry(rtw_proc_name, proc_net); -+#else -+ remove_proc_entry(rtw_proc_name, init_net.proc_net); -+#endif -+ rtw_proc = NULL; -+ } -+ } -+} -+#endif -+ -+static uint loadparam( _adapter *padapter, _nic_hdl pnetdev) -+{ -+ -+ uint status = _SUCCESS; -+ struct registry_priv *registry_par = &padapter->registrypriv; -+ -+ -+ -+ registry_par->chip_version = (u8)rtw_chip_version; -+ registry_par->rfintfs = (u8)rtw_rfintfs; -+ registry_par->lbkmode = (u8)rtw_lbkmode; -+ //registry_par->hci = (u8)hci; -+ registry_par->network_mode = (u8)rtw_network_mode; -+ -+ _rtw_memcpy(registry_par->ssid.Ssid, "ANY", 3); -+ registry_par->ssid.SsidLength = 3; -+ -+ registry_par->channel = (u8)rtw_channel; -+ registry_par->wireless_mode = (u8)rtw_wireless_mode; -+ -+ if (IsSupported24G(registry_par->wireless_mode) && (!IsSupported5G(registry_par->wireless_mode)) -+ && (registry_par->channel > 14)) { -+ registry_par->channel = 1; -+ } -+ else if (IsSupported5G(registry_par->wireless_mode) && (!IsSupported24G(registry_par->wireless_mode)) -+ && (registry_par->channel <= 14)) { -+ registry_par->channel = 36; -+ } -+ -+ registry_par->vrtl_carrier_sense = (u8)rtw_vrtl_carrier_sense ; -+ registry_par->vcs_type = (u8)rtw_vcs_type; -+ registry_par->rts_thresh=(u16)rtw_rts_thresh; -+ registry_par->frag_thresh=(u16)rtw_frag_thresh; -+ registry_par->preamble = (u8)rtw_preamble; -+ registry_par->scan_mode = (u8)rtw_scan_mode; -+ registry_par->adhoc_tx_pwr = (u8)rtw_adhoc_tx_pwr; -+ registry_par->soft_ap= (u8)rtw_soft_ap; -+ registry_par->smart_ps = (u8)rtw_smart_ps; -+ registry_par->power_mgnt = (u8)rtw_power_mgnt; -+ registry_par->ips_mode = (u8)rtw_ips_mode; -+ registry_par->radio_enable = (u8)rtw_radio_enable; -+ registry_par->long_retry_lmt = (u8)rtw_long_retry_lmt; -+ registry_par->short_retry_lmt = (u8)rtw_short_retry_lmt; -+ registry_par->busy_thresh = (u16)rtw_busy_thresh; -+ //registry_par->qos_enable = (u8)rtw_qos_enable; -+ registry_par->ack_policy = (u8)rtw_ack_policy; -+ registry_par->mp_mode = (u8)rtw_mp_mode; -+ registry_par->software_encrypt = (u8)rtw_software_encrypt; -+ registry_par->software_decrypt = (u8)rtw_software_decrypt; -+ -+ registry_par->acm_method = (u8)rtw_acm_method; -+ -+ //UAPSD -+ registry_par->wmm_enable = (u8)rtw_wmm_enable; -+ registry_par->uapsd_enable = (u8)rtw_uapsd_enable; -+ registry_par->uapsd_max_sp = (u8)rtw_uapsd_max_sp; -+ registry_par->uapsd_acbk_en = (u8)rtw_uapsd_acbk_en; -+ registry_par->uapsd_acbe_en = (u8)rtw_uapsd_acbe_en; -+ registry_par->uapsd_acvi_en = (u8)rtw_uapsd_acvi_en; -+ registry_par->uapsd_acvo_en = (u8)rtw_uapsd_acvo_en; -+ -+#ifdef CONFIG_80211N_HT -+ registry_par->ht_enable = (u8)rtw_ht_enable; -+ registry_par->bw_mode = (u8)rtw_bw_mode; -+ registry_par->ampdu_enable = (u8)rtw_ampdu_enable; -+ registry_par->rx_stbc = (u8)rtw_rx_stbc; -+ registry_par->ampdu_amsdu = (u8)rtw_ampdu_amsdu; -+ registry_par->short_gi = (u8)rtw_short_gi; -+#endif -+ -+#ifdef CONFIG_80211AC_VHT -+ registry_par->vht_enable = (u8)rtw_vht_enable; -+ registry_par->ampdu_factor = (u8)rtw_ampdu_factor; -+ registry_par->vht_rate_sel = (u8)rtw_vht_rate_sel; -+ registry_par->ldpc_cap = (u8)rtw_ldpc_cap; -+ registry_par->stbc_cap = (u8)rtw_stbc_cap; -+ registry_par->beamform_cap = (u8)rtw_beamform_cap; -+#endif -+ -+#ifdef CONFIG_TX_EARLY_MODE -+ registry_par->early_mode = (u8)rtw_early_mode; -+#endif -+ registry_par->lowrate_two_xmit = (u8)rtw_lowrate_two_xmit; -+ registry_par->rf_config = (u8)rtw_rf_config; -+ registry_par->low_power = (u8)rtw_low_power; -+ -+ -+ registry_par->wifi_spec = (u8)rtw_wifi_spec; -+ -+ registry_par->channel_plan = (u8)rtw_channel_plan; -+ -+#ifdef CONFIG_BT_COEXIST -+ registry_par->btcoex = (u8)rtw_btcoex_enable; -+ registry_par->bt_iso = (u8)rtw_bt_iso; -+ registry_par->bt_sco = (u8)rtw_bt_sco; -+ registry_par->bt_ampdu = (u8)rtw_bt_ampdu; -+#endif -+ -+ registry_par->bAcceptAddbaReq = (u8)rtw_AcceptAddbaReq; -+ -+ registry_par->antdiv_cfg = (u8)rtw_antdiv_cfg; -+ registry_par->antdiv_type = (u8)rtw_antdiv_type; -+ -+#ifdef CONFIG_AUTOSUSPEND -+ registry_par->usbss_enable = (u8)rtw_enusbss;//0:disable,1:enable -+#endif -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+ registry_par->hwpdn_mode = (u8)rtw_hwpdn_mode;//0:disable,1:enable,2:by EFUSE config -+ registry_par->hwpwrp_detect = (u8)rtw_hwpwrp_detect;//0:disable,1:enable -+#endif -+ -+ registry_par->hw_wps_pbc = (u8)rtw_hw_wps_pbc; -+ -+#ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE -+ snprintf(registry_par->adaptor_info_caching_file_path, PATH_LENGTH_MAX, "%s", rtw_adaptor_info_caching_file_path); -+ registry_par->adaptor_info_caching_file_path[PATH_LENGTH_MAX-1]=0; -+#endif -+ -+#ifdef CONFIG_LAYER2_ROAMING -+ registry_par->max_roaming_times = (u8)rtw_max_roaming_times; -+#ifdef CONFIG_INTEL_WIDI -+ registry_par->max_roaming_times = (u8)rtw_max_roaming_times + 2; -+#endif // CONFIG_INTEL_WIDI -+#endif -+ -+#ifdef CONFIG_IOL -+ registry_par->fw_iol = rtw_fw_iol; -+#endif -+ -+#ifdef CONFIG_DUALMAC_CONCURRENT -+ registry_par->dmsp= (u8)rtw_dmsp; -+#endif -+ -+#ifdef CONFIG_80211D -+ registry_par->enable80211d = (u8)rtw_80211d; -+#endif -+ -+ snprintf(registry_par->ifname, 16, "%s", ifname); -+ snprintf(registry_par->if2name, 16, "%s", if2name); -+ -+ registry_par->notch_filter = (u8)rtw_notch_filter; -+ -+#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -+ registry_par->force_ant = (u8)rtw_force_ant; -+ registry_par->force_igi = (u8)rtw_force_igi; -+#endif -+ -+ registry_par->regulatory_tid = (u8)rtw_regulatory_id; -+ -+#ifdef CONFIG_MULTI_VIR_IFACES -+ registry_par->ext_iface_num = (u8)rtw_ext_iface_num; -+#endif //CONFIG_MULTI_VIR_IFACES -+ -+ -+ -+ return status; -+} -+ -+static int rtw_net_set_mac_address(struct net_device *pnetdev, void *p) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct sockaddr *addr = p; -+ -+ if(padapter->bup == false) -+ { -+ //DBG_871X("r8711_net_set_mac_address(), MAC=%x:%x:%x:%x:%x:%x\n", addr->sa_data[0], addr->sa_data[1], addr->sa_data[2], addr->sa_data[3], -+ //addr->sa_data[4], addr->sa_data[5]); -+ _rtw_memcpy(padapter->eeprompriv.mac_addr, addr->sa_data, ETH_ALEN); -+ //_rtw_memcpy(pnetdev->dev_addr, addr->sa_data, ETH_ALEN); -+ //padapter->bset_hwaddr = true; -+ } -+ -+ return 0; -+} -+ -+static struct net_device_stats *rtw_net_get_stats(struct net_device *pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ struct recv_priv *precvpriv = &(padapter->recvpriv); -+ -+ padapter->stats.tx_packets = pxmitpriv->tx_pkts;//pxmitpriv->tx_pkts++; -+ padapter->stats.rx_packets = precvpriv->rx_pkts;//precvpriv->rx_pkts++; -+ padapter->stats.tx_dropped = pxmitpriv->tx_drop; -+ padapter->stats.rx_dropped = precvpriv->rx_drop; -+ padapter->stats.tx_bytes = pxmitpriv->tx_bytes; -+ padapter->stats.rx_bytes = precvpriv->rx_bytes; -+ -+ return &padapter->stats; -+} -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+/* -+ * AC to queue mapping -+ * -+ * AC_VO -> queue 0 -+ * AC_VI -> queue 1 -+ * AC_BE -> queue 2 -+ * AC_BK -> queue 3 -+ */ -+static const u16 rtw_1d_to_queue[8] = { 2, 3, 3, 2, 1, 1, 0, 0 }; -+ -+/* Given a data frame determine the 802.1p/1d tag to use. */ -+static unsigned int rtw_classify8021d(struct sk_buff *skb) -+{ -+ unsigned int dscp; -+ -+ /* skb->priority values from 256->263 are magic values to -+ * directly indicate a specific 802.1d priority. This is used -+ * to allow 802.1d priority to be passed directly in from VLAN -+ * tags, etc. -+ */ -+ if (skb->priority >= 256 && skb->priority <= 263) -+ return skb->priority - 256; -+ -+ switch (skb->protocol) { -+ case htons(ETH_P_IP): -+ dscp = ip_hdr(skb)->tos & 0xfc; -+ break; -+ default: -+ return 0; -+ } -+ -+ return dscp >> 5; -+} -+ -+static u16 rtw_select_queue(struct net_device *dev, struct sk_buff *skb, void *accel_priv, select_queue_fallback_t fallback) -+{ -+ _adapter *padapter = rtw_netdev_priv(dev); -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ skb->priority = rtw_classify8021d(skb); -+ -+ if(pmlmepriv->acm_mask != 0) -+ { -+ skb->priority = qos_acm(pmlmepriv->acm_mask, skb->priority); -+ } -+ -+ return rtw_1d_to_queue[skb->priority]; -+} -+ -+u16 rtw_recv_select_queue(struct sk_buff *skb) -+{ -+ struct iphdr *piphdr; -+ unsigned int dscp; -+ u16 eth_type; -+ u32 priority; -+ u8 *pdata = skb->data; -+ -+ _rtw_memcpy(ð_type, pdata+(ETH_ALEN<<1), 2); -+ -+ switch (eth_type) { -+ case be16_to_cpu(htons(ETH_P_IP)): -+ piphdr = (struct iphdr *)(pdata+ETH_HLEN); -+ -+ dscp = piphdr->tos & 0xfc; -+ -+ priority = dscp >> 5; -+ -+ break; -+ default: -+ priority = 0; -+ } -+ -+ return rtw_1d_to_queue[priority]; -+ -+} -+ -+#endif -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+static const struct net_device_ops rtw_netdev_ops = { -+ .ndo_open = netdev_open, -+ .ndo_stop = netdev_close, -+ .ndo_start_xmit = rtw_xmit_entry, -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ .ndo_select_queue = rtw_select_queue, -+#endif -+ .ndo_set_mac_address = rtw_net_set_mac_address, -+ .ndo_get_stats = rtw_net_get_stats, -+ .ndo_do_ioctl = rtw_ioctl, -+}; -+#endif -+ -+int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname) -+{ -+ _adapter *padapter = rtw_netdev_priv(pnetdev); -+ -+#ifdef CONFIG_EASY_REPLACEMENT -+ struct net_device *TargetNetdev = NULL; -+ _adapter *TargetAdapter = NULL; -+ struct net *devnet = NULL; -+ -+ if(padapter->bDongle == 1) -+ { -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) -+ TargetNetdev = dev_get_by_name("wlan0"); -+#else -+ #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26)) -+ devnet = pnetdev->nd_net; -+ #else -+ devnet = dev_net(pnetdev); -+ #endif -+ TargetNetdev = dev_get_by_name(devnet, "wlan0"); -+#endif -+ if(TargetNetdev) { -+ DBG_871X("Force onboard module driver disappear !!!\n"); -+ TargetAdapter = rtw_netdev_priv(TargetNetdev); -+ TargetAdapter->DriverState = DRIVER_DISAPPEAR; -+ -+ padapter->pid[0] = TargetAdapter->pid[0]; -+ padapter->pid[1] = TargetAdapter->pid[1]; -+ padapter->pid[2] = TargetAdapter->pid[2]; -+ -+ dev_put(TargetNetdev); -+ unregister_netdev(TargetNetdev); -+ -+ if(TargetAdapter->chip_type == padapter->chip_type) -+ rtw_proc_remove_one(TargetNetdev); -+ -+ padapter->DriverState = DRIVER_REPLACE_DONGLE; -+ } -+ } -+#endif //CONFIG_EASY_REPLACEMENT -+ -+ if(dev_alloc_name(pnetdev, ifname) < 0) -+ { -+ RT_TRACE(_module_os_intfs_c_,_drv_err_,("dev_alloc_name, fail! \n")); -+ } -+ -+ netif_carrier_off(pnetdev); -+ //rtw_netif_stop_queue(pnetdev); -+ -+ return 0; -+} -+ -+struct net_device *rtw_init_netdev(_adapter *old_padapter) -+{ -+ _adapter *padapter; -+ struct net_device *pnetdev; -+ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("+init_net_dev\n")); -+ -+ if(old_padapter != NULL) -+ pnetdev = rtw_alloc_etherdev_with_old_priv(sizeof(_adapter), (void *)old_padapter); -+ else -+ pnetdev = rtw_alloc_etherdev(sizeof(_adapter)); -+ -+ if (!pnetdev) -+ return NULL; -+ -+ padapter = rtw_netdev_priv(pnetdev); -+ padapter->pnetdev = pnetdev; -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24) -+ SET_MODULE_OWNER(pnetdev); -+#endif -+ -+ //pnetdev->init = NULL; -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+ DBG_871X("register rtw_netdev_ops to netdev_ops\n"); -+ pnetdev->netdev_ops = &rtw_netdev_ops; -+#else -+ pnetdev->open = netdev_open; -+ pnetdev->stop = netdev_close; -+ pnetdev->hard_start_xmit = rtw_xmit_entry; -+ pnetdev->set_mac_address = rtw_net_set_mac_address; -+ pnetdev->get_stats = rtw_net_get_stats; -+ pnetdev->do_ioctl = rtw_ioctl; -+#endif -+ -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ pnetdev->features |= NETIF_F_IP_CSUM; -+#endif -+ //pnetdev->tx_timeout = NULL; -+ pnetdev->watchdog_timeo = HZ*3; /* 3 second timeout */ -+#ifdef CONFIG_WIRELESS_EXT -+ pnetdev->wireless_handlers = (struct iw_handler_def *)&rtw_handlers_def; -+#endif -+ -+#ifdef WIRELESS_SPY -+ //priv->wireless_data.spy_data = &priv->spy_data; -+ //pnetdev->wireless_data = &priv->wireless_data; -+#endif -+ -+ //step 2. -+ loadparam(padapter, pnetdev); -+ -+ return pnetdev; -+ -+} -+ -+u32 rtw_start_drv_threads(_adapter *padapter) -+{ -+ u32 _status = _SUCCESS; -+ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("+rtw_start_drv_threads\n")); -+#ifdef CONFIG_XMIT_THREAD_MODE -+ padapter->xmitThread = kthread_run(rtw_xmit_thread, padapter, "RTW_XMIT_THREAD"); -+ if(IS_ERR(padapter->xmitThread)) -+ _status = _FAIL; -+#endif -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+ padapter->recvThread = kthread_run(rtw_recv_thread, padapter, "RTW_RECV_THREAD"); -+ if(IS_ERR(padapter->recvThread)) -+ _status = _FAIL; -+#endif -+ -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->isprimary == true) -+#endif //CONFIG_CONCURRENT_MODE -+ { -+ padapter->cmdThread = kthread_run(rtw_cmd_thread, padapter, "RTW_CMD_THREAD"); -+ if(IS_ERR(padapter->cmdThread)) -+ _status = _FAIL; -+ else -+ _rtw_down_sema(&padapter->cmdpriv.terminate_cmdthread_sema); //wait for cmd_thread to run -+ } -+ -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+ padapter->evtThread = kthread_run(event_thread, padapter, "RTW_EVENT_THREAD"); -+ if(IS_ERR(padapter->evtThread)) -+ _status = _FAIL; -+#endif -+ -+ rtw_hal_start_thread(padapter); -+ return _status; -+ -+} -+ -+void rtw_stop_drv_threads (_adapter *padapter) -+{ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("+rtw_stop_drv_threads\n")); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->isprimary == true) -+#endif //CONFIG_CONCURRENT_MODE -+ { -+ //Below is to termindate rtw_cmd_thread & event_thread... -+ _rtw_up_sema(&padapter->cmdpriv.cmd_queue_sema); -+ //_rtw_up_sema(&padapter->cmdpriv.cmd_done_sema); -+ if(padapter->cmdThread){ -+ _rtw_down_sema(&padapter->cmdpriv.terminate_cmdthread_sema); -+ } -+ } -+ -+#ifdef CONFIG_EVENT_THREAD_MODE -+ _rtw_up_sema(&padapter->evtpriv.evt_notify); -+ if(padapter->evtThread){ -+ _rtw_down_sema(&padapter->evtpriv.terminate_evtthread_sema); -+ } -+#endif -+ -+#ifdef CONFIG_XMIT_THREAD_MODE -+ // Below is to termindate tx_thread... -+ _rtw_up_sema(&padapter->xmitpriv.xmit_sema); -+ _rtw_down_sema(&padapter->xmitpriv.terminate_xmitthread_sema); -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("\n drv_halt: rtw_xmit_thread can be terminated ! \n")); -+#endif -+ -+#ifdef CONFIG_RECV_THREAD_MODE -+ // Below is to termindate rx_thread... -+ _rtw_up_sema(&padapter->recvpriv.recv_sema); -+ _rtw_down_sema(&padapter->recvpriv.terminate_recvthread_sema); -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("\n drv_halt:recv_thread can be terminated! \n")); -+#endif -+ -+ rtw_hal_stop_thread(padapter); -+} -+ -+u8 rtw_init_default_value(_adapter *padapter); -+u8 rtw_init_default_value(_adapter *padapter) -+{ -+ u8 ret = _SUCCESS; -+ struct registry_priv* pregistrypriv = &padapter->registrypriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct mlme_priv *pmlmepriv= &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ -+ //xmit_priv -+ pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense; -+ pxmitpriv->vcs = pregistrypriv->vcs_type; -+ pxmitpriv->vcs_type = pregistrypriv->vcs_type; -+ //pxmitpriv->rts_thresh = pregistrypriv->rts_thresh; -+ pxmitpriv->frag_len = pregistrypriv->frag_thresh; -+ -+ //recv_priv -+ -+ //mlme_priv -+ pmlmepriv->scan_interval = SCAN_INTERVAL;// 30*2 sec = 60sec -+ pmlmepriv->scan_mode = SCAN_ACTIVE; -+ -+ //qos_priv -+ //pmlmepriv->qospriv.qos_option = pregistrypriv->wmm_enable; -+ -+ //ht_priv -+#ifdef CONFIG_80211N_HT -+ pmlmepriv->htpriv.ampdu_enable = false;//set to disabled -+#endif -+ -+ //security_priv -+ //rtw_get_encrypt_decrypt_from_registrypriv(padapter); -+ psecuritypriv->binstallGrpkey = _FAIL; -+ psecuritypriv->sw_encrypt=pregistrypriv->software_encrypt; -+ psecuritypriv->sw_decrypt=pregistrypriv->software_decrypt; -+ -+ psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; //open system -+ psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; -+ -+ psecuritypriv->dot11PrivacyKeyIndex = 0; -+ -+ psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; -+ psecuritypriv->dot118021XGrpKeyid = 1; -+ -+ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; -+ psecuritypriv->ndisencryptstatus = Ndis802_11WEPDisabled; -+ -+ -+ //pwrctrl_priv -+ -+ -+ //registry_priv -+ rtw_init_registrypriv_dev_network(padapter); -+ rtw_update_registrypriv_dev_network(padapter); -+ -+ -+ //hal_priv -+ rtw_hal_def_value_init(padapter); -+ -+ //misc. -+ padapter->bReadPortCancel = false; -+ padapter->bWritePortCancel = false; -+ padapter->bLinkInfoDump = 0; -+ padapter->bNotifyChannelChange = 0; -+#ifdef CONFIG_P2P -+ padapter->bShowGetP2PState = 1; -+#endif -+ -+ return ret; -+} -+ -+u8 rtw_reset_drv_sw(_adapter *padapter) -+{ -+ u8 ret8=_SUCCESS; -+ struct mlme_priv *pmlmepriv= &padapter->mlmepriv; -+ struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; -+ -+ //hal_priv -+ rtw_hal_def_value_init(padapter); -+ padapter->bReadPortCancel = false; -+ padapter->bWritePortCancel = false; -+ padapter->bLinkInfoDump = 0; -+ pmlmepriv->scan_interval = SCAN_INTERVAL;// 30*2 sec = 60sec -+ -+ padapter->xmitpriv.tx_pkts = 0; -+ padapter->recvpriv.rx_pkts = 0; -+ -+ pmlmepriv->LinkDetectInfo.bBusyTraffic = false; -+ -+ _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY |_FW_UNDER_LINKING); -+ -+#ifdef CONFIG_AUTOSUSPEND -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,22) && LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,34)) -+ adapter_to_dvobj(padapter)->pusbdev->autosuspend_disabled = 1;//autosuspend disabled by the user -+ #endif -+#endif -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ rtw_hal_sreset_reset_value(padapter); -+#endif -+ pwrctrlpriv->pwr_state_check_cnts = 0; -+ -+ //mlmeextpriv -+ padapter->mlmeextpriv.sitesurvey_res.state= SCAN_DISABLE; -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ rtw_set_signal_stat_timer(&padapter->recvpriv); -+#endif -+ -+ return ret8; -+} -+ -+ -+u8 rtw_init_drv_sw(_adapter *padapter) -+{ -+ -+ u8 ret8=_SUCCESS; -+ -+ -+ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("+rtw_init_drv_sw\n")); -+ -+ ret8 = rtw_init_default_value(padapter); -+ -+ if ((rtw_init_cmd_priv(&padapter->cmdpriv)) == _FAIL) -+ { -+ RT_TRACE(_module_os_intfs_c_,_drv_err_,("\n Can't init cmd_priv\n")); -+ ret8=_FAIL; -+ goto exit; -+ } -+ -+ padapter->cmdpriv.padapter=padapter; -+ -+ if ((rtw_init_evt_priv(&padapter->evtpriv)) == _FAIL) -+ { -+ RT_TRACE(_module_os_intfs_c_,_drv_err_,("\n Can't init evt_priv\n")); -+ ret8=_FAIL; -+ goto exit; -+ } -+ -+ -+ if (rtw_init_mlme_priv(padapter) == _FAIL) -+ { -+ RT_TRACE(_module_os_intfs_c_,_drv_err_,("\n Can't init mlme_priv\n")); -+ ret8=_FAIL; -+ goto exit; -+ } -+ -+#ifdef CONFIG_P2P -+ rtw_init_wifidirect_timers(padapter); -+ init_wifidirect_info(padapter, P2P_ROLE_DISABLE); -+ reset_global_wifidirect_info(padapter); -+ #ifdef CONFIG_IOCTL_CFG80211 -+ rtw_init_cfg80211_wifidirect_info(padapter); -+ #endif -+#ifdef CONFIG_WFD -+ if(rtw_init_wifi_display_info(padapter) == _FAIL) -+ RT_TRACE(_module_os_intfs_c_,_drv_err_,("\n Can't init init_wifi_display_info\n")); -+#endif -+#endif /* CONFIG_P2P */ -+ -+ if(init_mlme_ext_priv(padapter) == _FAIL) -+ { -+ RT_TRACE(_module_os_intfs_c_,_drv_err_,("\n Can't init mlme_ext_priv\n")); -+ ret8=_FAIL; -+ goto exit; -+ } -+ -+#ifdef CONFIG_TDLS -+ if(rtw_init_tdls_info(padapter) == _FAIL) -+ { -+ DBG_871X("Can't rtw_init_tdls_info\n"); -+ ret8=_FAIL; -+ goto exit; -+ } -+#endif //CONFIG_TDLS -+ -+ if(_rtw_init_xmit_priv(&padapter->xmitpriv, padapter) == _FAIL) -+ { -+ DBG_871X("Can't _rtw_init_xmit_priv\n"); -+ ret8=_FAIL; -+ goto exit; -+ } -+ -+ if(_rtw_init_recv_priv(&padapter->recvpriv, padapter) == _FAIL) -+ { -+ DBG_871X("Can't _rtw_init_recv_priv\n"); -+ ret8=_FAIL; -+ goto exit; -+ } -+ -+ // We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). -+ //_rtw_memset((unsigned char *)&padapter->securitypriv, 0, sizeof (struct security_priv)); -+ -+ //_init_timer(&(padapter->securitypriv.tkip_timer), padapter->pifp, rtw_use_tkipkey_handler, padapter); -+ -+ if(_rtw_init_sta_priv(&padapter->stapriv) == _FAIL) -+ { -+ DBG_871X("Can't _rtw_init_sta_priv\n"); -+ ret8=_FAIL; -+ goto exit; -+ } -+ -+ padapter->stapriv.padapter = padapter; -+ padapter->setband = GHZ24_50; -+ rtw_init_bcmc_stainfo(padapter); -+ -+ rtw_init_pwrctrl_priv(padapter); -+ -+ //_rtw_memset((u8 *)&padapter->qospriv, 0, sizeof (struct qos_priv));//move to mlme_priv -+ -+#ifdef CONFIG_MP_INCLUDED -+ if (init_mp_priv(padapter) == _FAIL) { -+ DBG_871X("%s: initialize MP private data Fail!\n", __func__); -+ } -+#endif -+ -+ rtw_hal_dm_init(padapter); -+ rtw_hal_sw_led_init(padapter); -+ -+#ifdef DBG_CONFIG_ERROR_DETECT -+ rtw_hal_sreset_init(padapter); -+#endif -+ -+#ifdef CONFIG_INTEL_WIDI -+ if(rtw_init_intel_widi(padapter) == _FAIL) -+ { -+ DBG_871X("Can't rtw_init_intel_widi\n"); -+ ret8=_FAIL; -+ goto exit; -+ } -+#endif //CONFIG_INTEL_WIDI -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ padapter->WapiSupport = true; //set true temp, will revise according to Efuse or Registry value later. -+ rtw_wapi_init(padapter); -+#endif -+ -+#ifdef CONFIG_BR_EXT -+ _rtw_spinlock_init(&padapter->br_ext_lock); -+#endif // CONFIG_BR_EXT -+ -+exit: -+ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("-rtw_init_drv_sw\n")); -+ -+ -+ -+ return ret8; -+ -+} -+ -+#ifdef CONFIG_WOWLAN -+void rtw_cancel_dynamic_chk_timer(_adapter *padapter) -+{ -+ _cancel_timer_ex(&padapter->mlmepriv.dynamic_chk_timer); -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel dynamic_chk_timer! \n")); -+} -+#endif -+ -+void rtw_cancel_all_timer(_adapter *padapter) -+{ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("+rtw_cancel_all_timer\n")); -+ -+ _cancel_timer_ex(&padapter->mlmepriv.assoc_timer); -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel association timer complete! \n")); -+ -+ //_cancel_timer_ex(&padapter->securitypriv.tkip_timer); -+ //RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel tkip_timer! \n")); -+ -+ _cancel_timer_ex(&padapter->mlmepriv.scan_to_timer); -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel scan_to_timer! \n")); -+ -+ _cancel_timer_ex(&padapter->mlmepriv.dynamic_chk_timer); -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel dynamic_chk_timer! \n")); -+ -+ // cancel sw led timer -+ rtw_hal_sw_led_deinit(padapter); -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel DeInitSwLeds! \n")); -+ -+ _cancel_timer_ex(&padapter->pwrctrlpriv.pwr_state_check_timer); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+#ifdef CONFIG_P2P -+ _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); -+#endif //CONFIG_P2P -+#endif //CONFIG_IOCTL_CFG80211 -+ -+#ifdef CONFIG_SET_SCAN_DENY_TIMER -+ _cancel_timer_ex(&padapter->mlmepriv.set_scan_deny_timer); -+ rtw_clear_scan_deny(padapter); -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel set_scan_deny_timer! \n")); -+#endif -+ -+#ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -+ _cancel_timer_ex(&padapter->recvpriv.signal_stat_timer); -+#endif -+ //cancel dm timer -+ rtw_hal_dm_deinit(padapter); -+} -+ -+u8 rtw_free_drv_sw(_adapter *padapter) -+{ -+ struct net_device *pnetdev = (struct net_device*)padapter->pnetdev; -+ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("==>rtw_free_drv_sw")); -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_free(padapter); -+#endif -+ -+ //we can call rtw_p2p_enable here, but: -+ // 1. rtw_p2p_enable may have IO operation -+ // 2. rtw_p2p_enable is bundled with wext interface -+ #ifdef CONFIG_P2P -+ { -+ struct wifidirect_info *pwdinfo = &padapter->wdinfo; -+ if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) -+ { -+ _cancel_timer_ex( &pwdinfo->find_phase_timer ); -+ _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer ); -+ _cancel_timer_ex( &pwdinfo->pre_tx_scan_timer); -+#ifdef CONFIG_CONCURRENT_MODE -+ _cancel_timer_ex( &pwdinfo->ap_p2p_switch_timer ); -+#endif // CONFIG_CONCURRENT_MODE -+ rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE); -+ } -+ } -+ #endif -+ -+ -+#ifdef CONFIG_BR_EXT -+ _rtw_spinlock_free(&padapter->br_ext_lock); -+#endif // CONFIG_BR_EXT -+ -+#ifdef CONFIG_INTEL_WIDI -+ rtw_free_intel_widi(padapter); -+#endif //CONFIG_INTEL_WIDI -+ -+ free_mlme_ext_priv(&padapter->mlmeextpriv); -+ -+#ifdef CONFIG_TDLS -+ //rtw_free_tdls_info(&padapter->tdlsinfo); -+#endif //CONFIG_TDLS -+ -+ rtw_free_cmd_priv(&padapter->cmdpriv); -+ -+ rtw_free_evt_priv(&padapter->evtpriv); -+ -+ rtw_free_mlme_priv(&padapter->mlmepriv); -+ -+ //free_io_queue(padapter); -+ -+ _rtw_free_xmit_priv(&padapter->xmitpriv); -+ -+ _rtw_free_sta_priv(&padapter->stapriv); //will free bcmc_stainfo here -+ -+ _rtw_free_recv_priv(&padapter->recvpriv); -+ -+ rtw_free_pwrctrl_priv(padapter); -+ -+ //rtw_mfree((void *)padapter, sizeof (padapter)); -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ free_drvext(&padapter->drvextpriv); -+#endif -+ -+ rtw_hal_free_data(padapter); -+ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("<==rtw_free_drv_sw\n")); -+ -+ //free the old_pnetdev -+ if(padapter->rereg_nd_name_priv.old_pnetdev) { -+ free_netdev(padapter->rereg_nd_name_priv.old_pnetdev); -+ padapter->rereg_nd_name_priv.old_pnetdev = NULL; -+ } -+ -+ // clear pbuddy_adapter to avoid access wrong pointer. -+ if(padapter->pbuddy_adapter != NULL) { -+ padapter->pbuddy_adapter->pbuddy_adapter = NULL; -+ } -+ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("-rtw_free_drv_sw\n")); -+ -+ return _SUCCESS; -+ -+} -+ -+#ifdef CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_MULTI_VIR_IFACES -+int _netdev_vir_if_open(struct net_device *pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ _adapter *primary_padapter = GET_PRIMARY_ADAPTER(padapter); -+ -+ DBG_871X(FUNC_NDEV_FMT" enter\n", FUNC_NDEV_ARG(pnetdev)); -+ -+ if(!primary_padapter) -+ goto _netdev_virtual_iface_open_error; -+ -+ if(primary_padapter->bup == false || primary_padapter->hw_init_completed == false) -+ { -+ _netdev_open(primary_padapter->pnetdev); -+ } -+ -+ if(padapter->bup == false && primary_padapter->bup == true && -+ primary_padapter->hw_init_completed == true) -+ { -+ int i; -+ -+ padapter->bDriverStopped = false; -+ padapter->bSurpriseRemoved = false; -+ padapter->bCardDisableWOHSM = false; -+ -+ rtw_hal_clone_data(padapter, primary_padapter); -+ -+ padapter->bFWReady = primary_padapter->bFWReady; -+ -+ if(rtw_start_drv_threads(padapter) == _FAIL) -+ { -+ goto _netdev_virtual_iface_open_error; -+ } -+ -+ padapter->dir_dev = NULL; -+ rtw_proc_init_one(pnetdev); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_init_wiphy(padapter); -+#endif -+ -+ padapter->bup = true; -+ padapter->hw_init_completed = true; -+ -+ } -+ -+ padapter->net_closed = false; -+ -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); -+ -+ if(!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_start_queue(pnetdev); -+ else -+ rtw_netif_wake_queue(pnetdev); -+ -+ -+ DBG_871X(FUNC_NDEV_FMT" exit\n", FUNC_NDEV_ARG(pnetdev)); -+ return 0; -+ -+_netdev_virtual_iface_open_error: -+ -+ padapter->bup = false; -+ -+ netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ -+ return (-1); -+ -+} -+ -+int netdev_vir_if_open(struct net_device *pnetdev) -+{ -+ int ret; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ ret = _netdev_vir_if_open(pnetdev); -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ //if(padapter->iface_id == 2) -+ // rtw_start_auto_ap(padapter); -+#endif -+ -+ return ret; -+} -+ -+static int netdev_vir_if_close(struct net_device *pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ -+ padapter->net_closed = true; -+ -+ if(pnetdev) -+ { -+ if (!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_stop_queue(pnetdev); -+ } -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_scan_abort(padapter); -+ wdev_to_priv(padapter->rtw_wdev)->bandroid_scan = false; -+#endif -+ -+ return 0; -+} -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+static const struct net_device_ops rtw_netdev_vir_if_ops = { -+ .ndo_open = netdev_vir_if_open, -+ .ndo_stop = netdev_vir_if_close, -+ .ndo_start_xmit = rtw_xmit_entry, -+ .ndo_set_mac_address = rtw_net_set_mac_address, -+ .ndo_get_stats = rtw_net_get_stats, -+ .ndo_do_ioctl = rtw_ioctl, -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ .ndo_select_queue = rtw_select_queue, -+#endif -+}; -+#endif -+ -+_adapter *rtw_drv_add_vir_if(_adapter *primary_padapter, -+ void (*set_intf_ops)(_adapter *primary_padapter,struct _io_ops *pops)) -+{ -+ -+ int res = _FAIL; -+ struct net_device *pnetdev=NULL; -+ _adapter *padapter = NULL; -+ struct dvobj_priv *pdvobjpriv; -+ u8 mac[ETH_ALEN]; -+ -+/* -+ if((primary_padapter->bup == false) || -+ (rtw_buddy_adapter_up(primary_padapter) == false)) -+ { -+ goto error_rtw_drv_add_iface; -+ } -+ -+*/ -+ /****** init netdev ******/ -+ pnetdev = rtw_init_netdev(NULL); -+ if (!pnetdev) -+ goto error_rtw_drv_add_iface; -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+ DBG_871X("register rtw_netdev_virtual_iface_ops to netdev_ops\n"); -+ pnetdev->netdev_ops = &rtw_netdev_vir_if_ops; -+#else -+ pnetdev->open = netdev_vir_if_open; -+ pnetdev->stop = netdev_vir_if_close; -+#endif -+ -+#ifdef CONFIG_NO_WIRELESS_HANDLERS -+ pnetdev->wireless_handlers = NULL; -+#endif -+ -+ /****** init adapter ******/ -+ padapter = rtw_netdev_priv(pnetdev); -+ _rtw_memcpy(padapter, primary_padapter, sizeof(_adapter)); -+ -+ // -+ padapter->bup = false; -+ padapter->net_closed = true; -+ padapter->hw_init_completed = false; -+ -+ -+ //set adapter_type/iface type -+ padapter->isprimary = false; -+ padapter->adapter_type = MAX_ADAPTER; -+ padapter->pbuddy_adapter = primary_padapter; -+#if 0 -+#ifndef CONFIG_HWPORT_SWAP //Port0 -> Pri , Port1 -> Sec -+ padapter->iface_type = IFACE_PORT1; -+#else -+ padapter->iface_type = IFACE_PORT0; -+#endif //CONFIG_HWPORT_SWAP -+#else -+ //extended virtual interfaces always are set to port0 -+ padapter->iface_type = IFACE_PORT0; -+#endif -+ // -+ padapter->pnetdev = pnetdev; -+ -+ /****** setup dvobj ******/ -+ pdvobjpriv = adapter_to_dvobj(padapter); -+ padapter->iface_id = pdvobjpriv->iface_nums; -+ pdvobjpriv->padapters[pdvobjpriv->iface_nums++] = padapter; -+ -+ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(pdvobjpriv)); -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_wdev_alloc(padapter, dvobj_to_dev(pdvobjpriv)); -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ //set interface_type/chip_type/HardwareType -+ padapter->interface_type = primary_padapter->interface_type; -+ padapter->chip_type = primary_padapter->chip_type; -+ padapter->HardwareType = primary_padapter->HardwareType; -+ -+ //step 2. hook HalFunc, allocate HalData -+ //hal_set_hal_ops(padapter); -+ rtw_set_hal_ops(padapter); -+ -+ padapter->HalFunc.inirp_init = NULL; -+ padapter->HalFunc.inirp_deinit = NULL; -+ padapter->intf_start = NULL; -+ padapter->intf_stop = NULL; -+ -+ //step init_io_priv -+ if ((rtw_init_io_priv(padapter, set_intf_ops)) == _FAIL) { -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,(" \n Can't init io_reqs\n")); -+ } -+ -+ //step read_chip_version -+ rtw_hal_read_chip_version(padapter); -+ -+ //step usb endpoint mapping -+ rtw_hal_chip_configure(padapter); -+ -+ -+ //init drv data -+ if(rtw_init_drv_sw(padapter)!= _SUCCESS) -+ goto error_rtw_drv_add_iface; -+ -+ -+ //get mac address from primary_padapter -+ _rtw_memcpy(mac, primary_padapter->eeprompriv.mac_addr, ETH_ALEN); -+ -+ if (((mac[0]==0xff) &&(mac[1]==0xff) && (mac[2]==0xff) && -+ (mac[3]==0xff) && (mac[4]==0xff) &&(mac[5]==0xff)) || -+ ((mac[0]==0x0) && (mac[1]==0x0) && (mac[2]==0x0) && -+ (mac[3]==0x0) && (mac[4]==0x0) &&(mac[5]==0x0))) -+ { -+ mac[0] = 0x00; -+ mac[1] = 0xe0; -+ mac[2] = 0x4c; -+ mac[3] = 0x87; -+ mac[4] = 0x11; -+ mac[5] = 0x22; -+ } -+ else -+ { -+ //If the BIT1 is 0, the address is universally administered. -+ //If it is 1, the address is locally administered -+#if 1 //needs enable MBSSID CAM -+ mac[0] |= BIT(1); // locally administered -+ mac[0] |= (padapter->iface_id-1)<<4; -+#endif -+ } -+ -+ _rtw_memcpy(padapter->eeprompriv.mac_addr, mac, ETH_ALEN); -+ -+ padapter->dir_dev = NULL; -+ -+ res = _SUCCESS; -+ -+ return padapter; -+ -+ -+error_rtw_drv_add_iface: -+ -+ if(padapter) -+ rtw_free_drv_sw(padapter); -+ -+ if (pnetdev) -+ rtw_free_netdev(pnetdev); -+ -+ return NULL; -+ -+} -+ -+void rtw_drv_stop_vir_if(_adapter *padapter) -+{ -+ struct net_device *pnetdev=NULL; -+ -+ if (padapter == NULL) -+ return; -+ -+ pnetdev = padapter->pnetdev; -+ -+ if(pnetdev) -+ { -+ unregister_netdev(pnetdev); //will call netdev_close() -+ rtw_proc_remove_one(pnetdev); -+ } -+ -+ rtw_cancel_all_timer(padapter); -+ -+ if(padapter->bup == true) -+ { -+ padapter->bDriverStopped = true; -+ -+ #ifdef CONFIG_XMIT_ACK -+ if (padapter->xmitpriv.ack_tx) -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP); -+ #endif -+ -+ if(padapter->intf_stop) -+ { -+ padapter->intf_stop(padapter); -+ } -+ -+ rtw_stop_drv_threads(padapter); -+ -+ padapter->bup = false; -+ } -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_wdev_unregister(padapter->rtw_wdev); -+#endif //CONFIG_IOCTL_CFG80211 -+ -+} -+ -+void rtw_drv_free_vir_if(_adapter *padapter) -+{ -+ struct net_device *pnetdev=NULL; -+ -+ if (padapter == NULL) -+ return; -+ -+ padapter->pbuddy_adapter = NULL; -+ -+ pnetdev = padapter->pnetdev; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_wdev_free(padapter->rtw_wdev); -+#endif //CONFIG_IOCTL_CFG80211 -+ -+ rtw_free_drv_sw(padapter); -+ -+ rtw_free_netdev(pnetdev); -+} -+ -+void rtw_drv_stop_vir_ifaces(struct dvobj_priv *dvobj) -+{ -+ int i; -+ //struct dvobj_priv *dvobj = primary_padapter->dvobj; -+ -+ for(i=2;iiface_nums;i++) -+ { -+ rtw_drv_stop_vir_if(dvobj->padapters[i]); -+ } -+} -+ -+void rtw_drv_free_vir_ifaces(struct dvobj_priv *dvobj) -+{ -+ int i; -+ //struct dvobj_priv *dvobj = primary_padapter->dvobj; -+ -+ for(i=2;iiface_nums;i++) -+ { -+ rtw_drv_free_vir_if(dvobj->padapters[i]); -+ } -+} -+ -+void rtw_drv_del_vir_if(_adapter *padapter) -+{ -+ rtw_drv_stop_vir_if(padapter); -+ rtw_drv_free_vir_if(padapter); -+} -+ -+void rtw_drv_del_vir_ifaces(_adapter *primary_padapter) -+{ -+ int i; -+ struct dvobj_priv *dvobj = primary_padapter->dvobj; -+ -+ for(i=2;iiface_nums;i++) -+ { -+ rtw_drv_del_vir_if(dvobj->padapters[i]); -+ } -+} -+#endif //CONFIG_MULTI_VIR_IFACES -+ -+int _netdev_if2_open(struct net_device *pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ _adapter *primary_padapter = padapter->pbuddy_adapter; -+ -+ DBG_871X("+871x_drv - if2_open, bup=%d\n", padapter->bup); -+ -+ if(primary_padapter->bup == false || primary_padapter->hw_init_completed == false) -+ { -+ _netdev_open(primary_padapter->pnetdev); -+ } -+ -+ if(padapter->bup == false && primary_padapter->bup == true && -+ primary_padapter->hw_init_completed == true) -+ { -+ int i; -+ -+ padapter->bDriverStopped = false; -+ padapter->bSurpriseRemoved = false; -+ padapter->bCardDisableWOHSM = false; -+ -+// _rtw_memcpy(padapter->HalData, primary_padapter->HalData, padapter->hal_data_sz); -+ rtw_hal_clone_data(padapter, primary_padapter); -+ -+ padapter->bFWReady = primary_padapter->bFWReady; -+ -+ //if (init_mlme_ext_priv(padapter) == _FAIL) -+ // goto netdev_if2_open_error; -+ -+ -+ if(rtw_start_drv_threads(padapter) == _FAIL) -+ { -+ goto netdev_if2_open_error; -+ } -+ -+ -+ if(padapter->intf_start) -+ { -+ padapter->intf_start(padapter); -+ } -+ -+ -+ padapter->hw_init_completed = true; -+ -+ padapter->dir_dev = NULL; -+ rtw_proc_init_one(pnetdev); -+ -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_init_wiphy(padapter); -+#endif -+ -+ padapter->bup = true; -+ -+ } -+ -+ padapter->net_closed = false; -+ -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); -+ -+ if(!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_start_queue(pnetdev); -+ else -+ rtw_netif_wake_queue(pnetdev); -+ -+ DBG_871X("-871x_drv - if2_open, bup=%d\n", padapter->bup); -+ return 0; -+ -+netdev_if2_open_error: -+ -+ padapter->bup = false; -+ -+ netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ -+ return (-1); -+ -+} -+ -+int netdev_if2_open(struct net_device *pnetdev) -+{ -+ int ret; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ ret = _netdev_if2_open(pnetdev); -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ -+#ifdef CONFIG_AUTO_AP_MODE -+ //if(padapter->iface_id == 2) -+ rtw_start_auto_ap(padapter); -+#endif -+ -+ return ret; -+} -+ -+static int netdev_if2_close(struct net_device *pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ -+ padapter->net_closed = true; -+ -+ if(pnetdev) -+ { -+ if (!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_stop_queue(pnetdev); -+ } -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_scan_abort(padapter); -+ wdev_to_priv(padapter->rtw_wdev)->bandroid_scan = false; -+#endif -+ -+ return 0; -+} -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+static const struct net_device_ops rtw_netdev_if2_ops = { -+ .ndo_open = netdev_if2_open, -+ .ndo_stop = netdev_if2_close, -+ .ndo_start_xmit = rtw_xmit_entry, -+ .ndo_set_mac_address = rtw_net_set_mac_address, -+ .ndo_get_stats = rtw_net_get_stats, -+ .ndo_do_ioctl = rtw_ioctl, -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ .ndo_select_queue = rtw_select_queue, -+#endif -+}; -+#endif -+ -+_adapter *rtw_drv_if2_init(_adapter *primary_padapter, -+ void (*set_intf_ops)(_adapter *primary_padapter,struct _io_ops *pops)) -+{ -+ int res = _FAIL; -+ struct net_device *pnetdev = NULL; -+ _adapter *padapter = NULL; -+ struct dvobj_priv *pdvobjpriv; -+ u8 mac[ETH_ALEN]; -+ -+ /****** init netdev ******/ -+ pnetdev = rtw_init_netdev(NULL); -+ if (!pnetdev) -+ goto error_rtw_drv_if2_init; -+ -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29)) -+ DBG_871X("register rtw_netdev_if2_ops to netdev_ops\n"); -+ pnetdev->netdev_ops = &rtw_netdev_if2_ops; -+#else -+ pnetdev->open = netdev_if2_open; -+ pnetdev->stop = netdev_if2_close; -+#endif -+ -+#ifdef CONFIG_NO_WIRELESS_HANDLERS -+ pnetdev->wireless_handlers = NULL; -+#endif -+ -+ /****** init adapter ******/ -+ padapter = rtw_netdev_priv(pnetdev); -+ _rtw_memcpy(padapter, primary_padapter, sizeof(_adapter)); -+ -+ // -+ padapter->bup = false; -+ padapter->net_closed = true; -+ padapter->hw_init_completed = false; -+ -+ //set adapter_type/iface type -+ padapter->isprimary = false; -+ padapter->adapter_type = SECONDARY_ADAPTER; -+ padapter->pbuddy_adapter = primary_padapter; -+ padapter->iface_id = IFACE_ID1; -+#ifndef CONFIG_HWPORT_SWAP //Port0 -> Pri , Port1 -> Sec -+ padapter->iface_type = IFACE_PORT1; -+#else -+ padapter->iface_type = IFACE_PORT0; -+#endif //CONFIG_HWPORT_SWAP -+ // -+ padapter->pnetdev = pnetdev; -+ -+ /****** setup dvobj ******/ -+ pdvobjpriv = adapter_to_dvobj(padapter); -+ pdvobjpriv->if2 = padapter; -+ pdvobjpriv->padapters[pdvobjpriv->iface_nums++] = padapter; -+ -+ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(pdvobjpriv)); -+ #ifdef CONFIG_IOCTL_CFG80211 -+ rtw_wdev_alloc(padapter, dvobj_to_dev(pdvobjpriv)); -+ #endif //CONFIG_IOCTL_CFG80211 -+ -+ //set interface_type/chip_type/HardwareType -+ padapter->interface_type = primary_padapter->interface_type; -+ padapter->chip_type = primary_padapter->chip_type; -+ padapter->HardwareType = primary_padapter->HardwareType; -+ -+ //step 2. hook HalFunc, allocate HalData -+ //hal_set_hal_ops(padapter); -+ rtw_set_hal_ops(padapter); -+ -+ padapter->HalFunc.inirp_init = NULL; -+ padapter->HalFunc.inirp_deinit = NULL; -+ -+ // -+ padapter->intf_start = primary_padapter->intf_start; -+ padapter->intf_stop = primary_padapter->intf_stop; -+ -+ //step init_io_priv -+ if ((rtw_init_io_priv(padapter, set_intf_ops)) == _FAIL) { -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,(" \n Can't init io_reqs\n")); -+ } -+ -+ //step read_chip_version -+ rtw_hal_read_chip_version(padapter); -+ -+ //step usb endpoint mapping -+ rtw_hal_chip_configure(padapter); -+ -+ -+ //init drv data -+ if(rtw_init_drv_sw(padapter)!= _SUCCESS) -+ goto error_rtw_drv_if2_init; -+ -+ -+ //get mac address from primary_padapter -+ _rtw_memcpy(mac, primary_padapter->eeprompriv.mac_addr, ETH_ALEN); -+ -+ if (((mac[0]==0xff) &&(mac[1]==0xff) && (mac[2]==0xff) && -+ (mac[3]==0xff) && (mac[4]==0xff) &&(mac[5]==0xff)) || -+ ((mac[0]==0x0) && (mac[1]==0x0) && (mac[2]==0x0) && -+ (mac[3]==0x0) && (mac[4]==0x0) &&(mac[5]==0x0))) -+ { -+ mac[0] = 0x00; -+ mac[1] = 0xe0; -+ mac[2] = 0x4c; -+ mac[3] = 0x87; -+ mac[4] = 0x11; -+ mac[5] = 0x22; -+ } -+ else -+ { -+ //If the BIT1 is 0, the address is universally administered. -+ //If it is 1, the address is locally administered -+ mac[0] |= BIT(1); // locally administered -+ -+ } -+ -+ _rtw_memcpy(padapter->eeprompriv.mac_addr, mac, ETH_ALEN); -+ rtw_init_wifidirect_addrs(padapter, padapter->eeprompriv.mac_addr, padapter->eeprompriv.mac_addr); -+ -+ primary_padapter->pbuddy_adapter = padapter; -+ -+ padapter->dir_dev = NULL; -+ -+ -+ res = _SUCCESS; -+ -+ return padapter; -+ -+ -+error_rtw_drv_if2_init: -+ -+ if(padapter) -+ rtw_free_drv_sw(padapter); -+ -+ if (pnetdev) -+ rtw_free_netdev(pnetdev); -+ -+ return NULL; -+ -+} -+ -+void rtw_drv_if2_free(_adapter *if2) -+{ -+ _adapter *padapter = if2; -+ struct net_device *pnetdev = NULL; -+ -+ if (padapter == NULL) -+ return; -+ -+ pnetdev = padapter->pnetdev; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_wdev_free(padapter->rtw_wdev); -+#endif /* CONFIG_IOCTL_CFG80211 */ -+ -+ -+ rtw_free_drv_sw(padapter); -+ -+ rtw_free_netdev(pnetdev); -+ -+} -+ -+void rtw_drv_if2_stop(_adapter *if2) -+{ -+ _adapter *padapter = if2; -+ struct net_device *pnetdev = NULL; -+ -+ if (padapter == NULL) -+ return; -+ -+ pnetdev = padapter->pnetdev; -+ -+ if (pnetdev) { -+ unregister_netdev(pnetdev); //will call netdev_close() -+ rtw_proc_remove_one(pnetdev); -+ } -+ -+ rtw_cancel_all_timer(padapter); -+ -+ if (padapter->bup == true) { -+ padapter->bDriverStopped = true; -+ #ifdef CONFIG_XMIT_ACK -+ if (padapter->xmitpriv.ack_tx) -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP); -+ #endif -+ -+ if(padapter->intf_stop) -+ { -+ padapter->intf_stop(padapter); -+ } -+ -+ rtw_stop_drv_threads(padapter); -+ -+ padapter->bup = false; -+ } -+ -+ #ifdef CONFIG_IOCTL_CFG80211 -+ rtw_wdev_unregister(padapter->rtw_wdev); -+ #endif -+ -+} -+#endif //end of CONFIG_CONCURRENT_MODE -+ -+#ifdef CONFIG_BR_EXT -+void netdev_br_init(struct net_device *netdev) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+ rcu_read_lock(); -+#endif // (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+ -+ //if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == true) -+ { -+ //struct net_bridge *br = netdev->br_port->br;//->dev->dev_addr; -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ if (netdev->br_port) -+#else // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ if (rcu_dereference(adapter->pnetdev->rx_handler_data)) -+#endif // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ { -+ struct net_device *br_netdev; -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) -+ br_netdev = dev_get_by_name(CONFIG_BR_EXT_BRNAME); -+#else // (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) -+ struct net *devnet = NULL; -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26)) -+ devnet = netdev->nd_net; -+#else // (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26)) -+ devnet = dev_net(netdev); -+#endif // (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26)) -+ -+ br_netdev = dev_get_by_name(devnet, CONFIG_BR_EXT_BRNAME); -+#endif // (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) -+ -+ if (br_netdev) { -+ memcpy(adapter->br_mac, br_netdev->dev_addr, ETH_ALEN); -+ dev_put(br_netdev); -+ } else -+ printk("%s()-%d: dev_get_by_name(%s) failed!", __FUNCTION__, __LINE__, CONFIG_BR_EXT_BRNAME); -+ } -+ -+ adapter->ethBrExtInfo.addPPPoETag = 1; -+ } -+ -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+ rcu_read_unlock(); -+#endif // (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) -+} -+#endif //CONFIG_BR_EXT -+ -+static int _rtw_drv_register_netdev(_adapter *padapter, char *name) -+{ -+ int ret = _SUCCESS; -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ /* alloc netdev name */ -+ rtw_init_netdev_name(pnetdev, name); -+ -+ _rtw_memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN); -+ -+ /* Tell the network stack we exist */ -+ if (register_netdev(pnetdev) != 0) { -+ DBG_871X(FUNC_NDEV_FMT "Failed!\n", FUNC_NDEV_ARG(pnetdev)); -+ ret = _FAIL; -+ goto error_register_netdev; -+ } -+ -+ DBG_871X("%s, MAC Address (if%d) = " MAC_FMT "\n", __FUNCTION__, (padapter->iface_id+1), MAC_ARG(pnetdev->dev_addr)); -+ -+ return ret; -+ -+error_register_netdev: -+ -+ if(padapter->iface_id > IFACE_ID0) -+ { -+ rtw_free_drv_sw(padapter); -+ -+ rtw_free_netdev(pnetdev); -+ } -+ -+ return ret; -+} -+ -+int rtw_drv_register_netdev(_adapter *if1) -+{ -+ int i, status = _SUCCESS; -+ struct dvobj_priv *dvobj = if1->dvobj; -+ -+ if(dvobj->iface_nums < IFACE_ID_MAX) -+ { -+ for(i=0; iiface_nums; i++) -+ { -+ _adapter *padapter = dvobj->padapters[i]; -+ -+ if(padapter) -+ { -+ char *name; -+ -+ if(padapter->iface_id == IFACE_ID0) -+ name = if1->registrypriv.ifname; -+ else if(padapter->iface_id == IFACE_ID1) -+ name = if1->registrypriv.if2name; -+ else -+ name = "wlan%d"; -+ -+ if((status = _rtw_drv_register_netdev(padapter, name)) != _SUCCESS) { -+ break; -+ } -+ } -+ } -+ } -+ -+ return status; -+} -+ -+int _netdev_open(struct net_device *pnetdev) -+{ -+ uint status; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv; -+ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("+871x_drv - dev_open\n")); -+ DBG_871X("+871x_drv - drv_open, bup=%d\n", padapter->bup); -+ -+ if(pwrctrlpriv->ps_flag == true){ -+ padapter->net_closed = false; -+ goto netdev_open_normal_process; -+ } -+ -+ if(padapter->bup == false) -+ { -+ padapter->bDriverStopped = false; -+ padapter->bSurpriseRemoved = false; -+ padapter->bCardDisableWOHSM = false; -+ -+ status = rtw_hal_init(padapter); -+ if (status ==_FAIL) -+ { -+ RT_TRACE(_module_os_intfs_c_,_drv_err_,("rtl871x_hal_init(): Can't init h/w!\n")); -+ goto netdev_open_error; -+ } -+ -+ DBG_871X("MAC Address = "MAC_FMT"\n", MAC_ARG(pnetdev->dev_addr)); -+ -+ status=rtw_start_drv_threads(padapter); -+ if(status ==_FAIL) -+ { -+ DBG_871X("Initialize driver software resource Failed!\n"); -+ goto netdev_open_error; -+ } -+ -+ if (init_hw_mlme_ext(padapter) == _FAIL) -+ { -+ DBG_871X("can't init mlme_ext_priv\n"); -+ goto netdev_open_error; -+ } -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ init_drvext(padapter); -+#endif -+ -+ if(padapter->intf_start) -+ { -+ padapter->intf_start(padapter); -+ } -+ -+ rtw_proc_init_one(pnetdev); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_cfg80211_init_wiphy(padapter); -+#endif -+ -+ rtw_led_control(padapter, LED_CTL_NO_LINK); -+ -+ padapter->bup = true; -+ } -+ padapter->net_closed = false; -+ -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000); -+ -+ padapter->pwrctrlpriv.bips_processing = false; -+ rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv); -+ -+ //netif_carrier_on(pnetdev);//call this func when rtw_joinbss_event_callback return success -+ if(!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_start_queue(pnetdev); -+ else -+ rtw_netif_wake_queue(pnetdev); -+ -+#ifdef CONFIG_BR_EXT -+ netdev_br_init(pnetdev); -+#endif // CONFIG_BR_EXT -+ -+netdev_open_normal_process: -+ -+ #ifdef CONFIG_CONCURRENT_MODE -+ { -+ _adapter *sec_adapter = padapter->pbuddy_adapter; -+ if(sec_adapter && (sec_adapter->bup == false || sec_adapter->hw_init_completed == false)) -+ _netdev_if2_open(sec_adapter->pnetdev); -+ } -+ #endif -+ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("-871x_drv - dev_open\n")); -+ DBG_871X("-871x_drv - drv_open, bup=%d\n", padapter->bup); -+ -+ return 0; -+ -+netdev_open_error: -+ -+ padapter->bup = false; -+ -+ netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ -+ RT_TRACE(_module_os_intfs_c_,_drv_err_,("-871x_drv - dev_open, fail!\n")); -+ DBG_871X("-871x_drv - drv_open fail, bup=%d\n", padapter->bup); -+ -+ return (-1); -+ -+} -+ -+int netdev_open(struct net_device *pnetdev) -+{ -+ int ret; -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ -+ _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ ret = _netdev_open(pnetdev); -+ _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); -+ -+ return ret; -+} -+ -+#ifdef CONFIG_IPS -+static int ips_netdrv_open(_adapter *padapter) -+{ -+ int status = _SUCCESS; -+ padapter->net_closed = false; -+ DBG_871X("===> %s.........\n",__FUNCTION__); -+ -+ -+ padapter->bDriverStopped = false; -+ padapter->bSurpriseRemoved = false; -+ padapter->bCardDisableWOHSM = false; -+ //padapter->bup = true; -+ -+ status = rtw_hal_init(padapter); -+ if (status ==_FAIL) -+ { -+ RT_TRACE(_module_os_intfs_c_,_drv_err_,("ips_netdrv_open(): Can't init h/w!\n")); -+ goto netdev_open_error; -+ } -+ -+ if(padapter->intf_start) -+ { -+ padapter->intf_start(padapter); -+ } -+ -+ rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv); -+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer,5000); -+ -+ return _SUCCESS; -+ -+netdev_open_error: -+ //padapter->bup = false; -+ DBG_871X("-ips_netdrv_open - drv_open failure, bup=%d\n", padapter->bup); -+ -+ return _FAIL; -+} -+ -+ -+int rtw_ips_pwr_up(_adapter *padapter) -+{ -+ int result; -+ u32 start_time = rtw_get_current_time(); -+ DBG_871X("===> rtw_ips_pwr_up..............\n"); -+ rtw_reset_drv_sw(padapter); -+ -+ result = ips_netdrv_open(padapter); -+ -+ rtw_led_control(padapter, LED_CTL_NO_LINK); -+ -+ DBG_871X("<=== rtw_ips_pwr_up.............. in %dms\n", rtw_get_passing_time_ms(start_time)); -+ return result; -+ -+} -+ -+void rtw_ips_pwr_down(_adapter *padapter) -+{ -+ u32 start_time = rtw_get_current_time(); -+ DBG_871X("===> rtw_ips_pwr_down...................\n"); -+ -+ padapter->bCardDisableWOHSM = true; -+ padapter->net_closed = true; -+ -+ rtw_ips_dev_unload(padapter); -+ padapter->bCardDisableWOHSM = false; -+ DBG_871X("<=== rtw_ips_pwr_down..................... in %dms\n", rtw_get_passing_time_ms(start_time)); -+} -+#endif -+ -+void rtw_ips_dev_unload(_adapter *padapter) -+{ -+ struct net_device *pnetdev= (struct net_device*)padapter->pnetdev; -+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); -+ DBG_871X("====> %s...\n",__FUNCTION__); -+ -+ rtw_hal_set_hwreg(padapter, HW_VAR_FIFO_CLEARN_UP, NULL); -+ -+ if(padapter->intf_stop) -+ { -+ padapter->intf_stop(padapter); -+ } -+ -+ //s5. -+ if(padapter->bSurpriseRemoved == false) -+ { -+ rtw_hal_deinit(padapter); -+ } -+ -+} -+ -+int pm_netdev_open(struct net_device *pnetdev,u8 bnormal) -+{ -+ int status; -+ -+ -+ if (true == bnormal) -+ status = netdev_open(pnetdev); -+#ifdef CONFIG_IPS -+ else -+ status = (_SUCCESS == ips_netdrv_open((_adapter *)rtw_netdev_priv(pnetdev)))?(0):(-1); -+#endif -+ -+ return status; -+} -+ -+static int netdev_close(struct net_device *pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("+871x_drv - drv_close\n")); -+ -+ if(padapter->pwrctrlpriv.bInternalAutoSuspend == true) -+ { -+ //rtw_pwr_wakeup(padapter); -+ if(padapter->pwrctrlpriv.rf_pwrstate == rf_off) -+ padapter->pwrctrlpriv.ps_flag = true; -+ } -+ padapter->net_closed = true; -+ -+/* if(!padapter->hw_init_completed) -+ { -+ DBG_871X("(1)871x_drv - drv_close, bup=%d, hw_init_completed=%d\n", padapter->bup, padapter->hw_init_completed); -+ -+ padapter->bDriverStopped = true; -+ -+ rtw_dev_unload(padapter); -+ } -+ else*/ -+ if(padapter->pwrctrlpriv.rf_pwrstate == rf_on){ -+ DBG_871X("(2)871x_drv - drv_close, bup=%d, hw_init_completed=%d\n", padapter->bup, padapter->hw_init_completed); -+ -+ //s1. -+ if(pnetdev) -+ { -+ if (!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_stop_queue(pnetdev); -+ } -+ -+#ifndef CONFIG_ANDROID -+ //s2. -+ LeaveAllPowerSaveMode(padapter); -+ rtw_disassoc_cmd(padapter, 500, false); -+ //s2-2. indicate disconnect to os -+ rtw_indicate_disconnect(padapter); -+ //s2-3. -+ rtw_free_assoc_resources(padapter, 1); -+ //s2-4. -+ rtw_free_network_queue(padapter,true); -+#endif -+ // Close LED -+ rtw_led_control(padapter, LED_CTL_POWER_OFF); -+ } -+ -+#ifdef CONFIG_BR_EXT -+ //if (OPMODE & (WIFI_STATION_STATE | WIFI_ADHOC_STATE)) -+ { -+ //void nat25_db_cleanup(_adapter *priv); -+ nat25_db_cleanup(padapter); -+ } -+#endif // CONFIG_BR_EXT -+ -+#ifdef CONFIG_P2P -+#ifdef CONFIG_IOCTL_CFG80211 -+ if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) -+ { -+ if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled == true) -+ wdev_to_priv(padapter->rtw_wdev)->p2p_enabled = false; -+ } -+#endif //CONFIG_IOCTL_CFG80211 -+ rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); -+#endif //CONFIG_P2P -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ rtw_scan_abort(padapter); -+ wdev_to_priv(padapter->rtw_wdev)->bandroid_scan = false; -+ padapter->rtw_wdev->iftype = NL80211_IFTYPE_MONITOR; //set this at the end -+#endif //CONFIG_IOCTL_CFG80211 -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ rtw_wapi_disable_tx(padapter); -+#endif -+ -+ RT_TRACE(_module_os_intfs_c_,_drv_info_,("-871x_drv - drv_close\n")); -+ DBG_871X("-871x_drv - drv_close, bup=%d\n", padapter->bup); -+ -+ return 0; -+ -+} -+ -+void rtw_ndev_destructor(struct net_device *ndev) -+{ -+ DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if (ndev->ieee80211_ptr) -+ rtw_mfree((u8 *)ndev->ieee80211_ptr, sizeof(struct wireless_dev)); -+#endif -+ free_netdev(ndev); -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/recv_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/recv_linux.c ---- linux-4.14.17/3rdparty/rtl8812au/os_dep/recv_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/recv_linux.c 2018-02-06 17:42:30.725967387 +0200 -@@ -0,0 +1,667 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _RECV_OSDEP_C_ -+ -+#include -+ -+int rtw_os_alloc_recvframe(_adapter *padapter, union recv_frame *precvframe, u8 *pdata, _pkt *pskb) -+{ -+ int res = _SUCCESS; -+ u8 shift_sz = 0; -+ u32 skb_len, alloc_sz; -+ _pkt *pkt_copy = NULL; -+ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; -+ -+ -+ if(pdata == NULL) -+ { -+ precvframe->u.hdr.pkt = NULL; -+ res = _FAIL; -+ return res; -+ } -+ -+ -+ // Modified by Albert 20101213 -+ // For 8 bytes IP header alignment. -+ shift_sz = pattrib->qos ? 6:0;// Qos data, wireless lan header length is 26 -+ -+ skb_len = pattrib->pkt_len; -+ -+ // for first fragment packet, driver need allocate 1536+drvinfo_sz+RXDESC_SIZE to defrag packet. -+ // modify alloc_sz for recvive crc error packet by thomas 2011-06-02 -+ if((pattrib->mfrag == 1)&&(pattrib->frag_num == 0)) -+ { -+ //alloc_sz = 1664; //1664 is 128 alignment. -+ alloc_sz = (skb_len <= 1650) ? 1664:(skb_len + 14); -+ } -+ else -+ { -+ alloc_sz = skb_len; -+ // 6 is for IP header 8 bytes alignment in QoS packet case. -+ // 8 is for skb->data 4 bytes alignment. -+ alloc_sz += 14; -+ } -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18)) // http://www.mail-archive.com/netdev@vger.kernel.org/msg17214.html -+ pkt_copy = dev_alloc_skb(alloc_sz); -+#else -+ pkt_copy = netdev_alloc_skb(padapter->pnetdev, alloc_sz); -+#endif -+ -+ if(pkt_copy) -+ { -+ pkt_copy->dev = padapter->pnetdev; -+ precvframe->u.hdr.pkt = pkt_copy; -+ precvframe->u.hdr.rx_head = pkt_copy->data; -+ precvframe->u.hdr.rx_end = pkt_copy->data + alloc_sz; -+ skb_reserve(pkt_copy, 8 - ((SIZE_PTR)( pkt_copy->data) & 7 ));//force pkt_copy->data at 8-byte alignment address -+ skb_reserve(pkt_copy, shift_sz);//force ip_hdr at 8-byte alignment address according to shift_sz. -+ _rtw_memcpy(pkt_copy->data, pdata, skb_len); -+ precvframe->u.hdr.rx_data = precvframe->u.hdr.rx_tail = pkt_copy->data; -+ } -+ else -+ { -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ DBG_871X("%s:can not allocate memory for skb copy\n", __FUNCTION__); -+ -+ precvframe->u.hdr.pkt = NULL; -+ -+ //rtw_free_recvframe(precvframe, pfree_recv_queue); -+ //goto _exit_recvbuf2recvframe; -+ -+ res = _FAIL; -+#else -+ if((pattrib->mfrag == 1)&&(pattrib->frag_num == 0)) -+ { -+ DBG_871X("%s: alloc_skb fail , drop frag frame \n", __FUNCTION__); -+ //rtw_free_recvframe(precvframe, pfree_recv_queue); -+ res = _FAIL; -+ goto exit_rtw_os_recv_resource_alloc; -+ } -+ -+ if(pskb == NULL) -+ { -+ res = _FAIL; -+ goto exit_rtw_os_recv_resource_alloc; -+ } -+ -+ precvframe->u.hdr.pkt = skb_clone(pskb, GFP_ATOMIC); -+ if(precvframe->u.hdr.pkt) -+ { -+ precvframe->u.hdr.rx_head = precvframe->u.hdr.rx_data = precvframe->u.hdr.rx_tail = pdata; -+ precvframe->u.hdr.rx_end = pdata + alloc_sz; -+ } -+ else -+ { -+ DBG_871X("%s: skb_clone fail\n", __FUNCTION__); -+ //rtw_free_recvframe(precvframe, pfree_recv_queue); -+ //goto _exit_recvbuf2recvframe; -+ res = _FAIL; -+ } -+#endif -+ } -+ -+exit_rtw_os_recv_resource_alloc: -+ -+ return res; -+ -+} -+ -+void rtw_os_free_recvframe(union recv_frame *precvframe) -+{ -+ if(precvframe->u.hdr.pkt) -+ { -+ dev_kfree_skb_any(precvframe->u.hdr.pkt);//free skb by driver -+ -+ precvframe->u.hdr.pkt = NULL; -+ } -+} -+ -+//init os related resource in struct recv_priv -+int rtw_os_recv_resource_init(struct recv_priv *precvpriv, _adapter *padapter) -+{ -+ int res=_SUCCESS; -+ -+ return res; -+} -+ -+//alloc os related resource in union recv_frame -+int rtw_os_recv_resource_alloc(_adapter *padapter, union recv_frame *precvframe) -+{ -+ int res=_SUCCESS; -+ -+ precvframe->u.hdr.pkt_newalloc = precvframe->u.hdr.pkt = NULL; -+ -+ return res; -+} -+ -+//free os related resource in union recv_frame -+void rtw_os_recv_resource_free(struct recv_priv *precvpriv) -+{ -+ -+} -+ -+//alloc os related resource in struct recv_buf -+int rtw_os_recvbuf_resource_alloc(_adapter *padapter, struct recv_buf *precvbuf) -+{ -+ int res=_SUCCESS; -+ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct usb_device *pusbd = pdvobjpriv->pusbdev; -+ -+ precvbuf->irp_pending = false; -+ precvbuf->purb = usb_alloc_urb(0, GFP_KERNEL); -+ if(precvbuf->purb == NULL){ -+ res = _FAIL; -+ } -+ -+ precvbuf->pskb = NULL; -+ -+ precvbuf->reuse = false; -+ -+ precvbuf->pallocated_buf = precvbuf->pbuf = NULL; -+ -+ precvbuf->pdata = precvbuf->phead = precvbuf->ptail = precvbuf->pend = NULL; -+ -+ precvbuf->transfer_len = 0; -+ -+ precvbuf->len = 0; -+ -+ #ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ precvbuf->pallocated_buf = rtw_usb_buffer_alloc(pusbd, (size_t)precvbuf->alloc_sz, &precvbuf->dma_transfer_addr); -+ precvbuf->pbuf = precvbuf->pallocated_buf; -+ if(precvbuf->pallocated_buf == NULL) -+ return _FAIL; -+ #endif //CONFIG_USE_USB_BUFFER_ALLOC_RX -+ -+ return res; -+} -+ -+//free os related resource in struct recv_buf -+int rtw_os_recvbuf_resource_free(_adapter *padapter, struct recv_buf *precvbuf) -+{ -+ int ret = _SUCCESS; -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX -+ -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct usb_device *pusbd = pdvobjpriv->pusbdev; -+ -+ rtw_usb_buffer_free(pusbd, (size_t)precvbuf->alloc_sz, precvbuf->pallocated_buf, precvbuf->dma_transfer_addr); -+ precvbuf->pallocated_buf = NULL; -+ precvbuf->dma_transfer_addr = 0; -+ -+#endif //CONFIG_USE_USB_BUFFER_ALLOC_RX -+ -+ if(precvbuf->purb) -+ { -+ //usb_kill_urb(precvbuf->purb); -+ usb_free_urb(precvbuf->purb); -+ } -+ -+ if(precvbuf->pskb) -+ dev_kfree_skb_any(precvbuf->pskb); -+ -+ return ret; -+} -+ -+_pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 *pdata) -+{ -+ u16 eth_type; -+ u8 *data_ptr; -+ _pkt *sub_skb; -+ struct rx_pkt_attrib *pattrib; -+ -+ pattrib = &prframe->u.hdr.attrib; -+ -+#ifdef CONFIG_SKB_COPY -+ sub_skb = dev_alloc_skb(nSubframe_Length + 12); -+ if(sub_skb) -+ { -+ skb_reserve(sub_skb, 12); -+ data_ptr = (u8 *)skb_put(sub_skb, nSubframe_Length); -+ _rtw_memcpy(data_ptr, (pdata + ETH_HLEN), nSubframe_Length); -+ } -+ else -+#endif // CONFIG_SKB_COPY -+ { -+ sub_skb = skb_clone(prframe->u.hdr.pkt, GFP_ATOMIC); -+ if(sub_skb) -+ { -+ sub_skb->data = pdata + ETH_HLEN; -+ sub_skb->len = nSubframe_Length; -+ skb_set_tail_pointer(sub_skb, nSubframe_Length); -+ } -+ else -+ { -+ DBG_871X("%s(): skb_clone() Fail!!!\n",__FUNCTION__); -+ return NULL; -+ } -+ } -+ -+ eth_type = RTW_GET_BE16(&sub_skb->data[6]); -+ -+ if (sub_skb->len >= 8 && -+ ((_rtw_memcmp(sub_skb->data, rtw_rfc1042_header, SNAP_SIZE) && -+ eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || -+ _rtw_memcmp(sub_skb->data, rtw_bridge_tunnel_header, SNAP_SIZE) )) { -+ /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ -+ skb_pull(sub_skb, SNAP_SIZE); -+ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->src, ETH_ALEN); -+ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->dst, ETH_ALEN); -+ } else { -+ __be16 len; -+ /* Leave Ethernet header part of hdr and full payload */ -+ len = htons(sub_skb->len); -+ _rtw_memcpy(skb_push(sub_skb, 2), &len, 2); -+ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->src, ETH_ALEN); -+ _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->dst, ETH_ALEN); -+ } -+ -+ return sub_skb; -+} -+ -+void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, struct rx_pkt_attrib *pattrib) -+{ -+ struct mlme_priv*pmlmepriv = &padapter->mlmepriv; -+#ifdef CONFIG_BR_EXT -+ void *br_port = NULL; -+#endif -+ -+ /* Indicat the packets to upper layer */ -+ if (pkt) { -+ if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) -+ { -+ _pkt *pskb2=NULL; -+ struct sta_info *psta = NULL; -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ int bmcast = IS_MCAST(pattrib->dst); -+ -+ //DBG_871X("bmcast=%d\n", bmcast); -+ -+ if(_rtw_memcmp(pattrib->dst, myid(&padapter->eeprompriv), ETH_ALEN)==false) -+ { -+ //DBG_871X("not ap psta=%p, addr=%pM\n", psta, pattrib->dst); -+ -+ if(bmcast) -+ { -+ psta = rtw_get_bcmc_stainfo(padapter); -+ pskb2 = skb_clone(pkt, GFP_ATOMIC); -+ } else { -+ psta = rtw_get_stainfo(pstapriv, pattrib->dst); -+ } -+ -+ if(psta) -+ { -+ struct net_device *pnetdev= (struct net_device*)padapter->pnetdev; -+ -+ //DBG_871X("directly forwarding to the rtw_xmit_entry\n"); -+ -+ //skb->ip_summed = CHECKSUM_NONE; -+ pkt->dev = pnetdev; -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ skb_set_queue_mapping(pkt, rtw_recv_select_queue(pkt)); -+#endif //LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35) -+ -+ rtw_xmit_entry(pkt, pnetdev); -+ -+ if(bmcast && (pskb2 != NULL) ) { -+ pkt = pskb2; -+ } else { -+ return; -+ } -+ } -+ } -+ else// to APself -+ { -+ //DBG_871X("to APSelf\n"); -+ } -+ } -+ -+#ifdef CONFIG_BR_EXT -+ // Insert NAT2.5 RX here! -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ br_port = padapter->pnetdev->br_port; -+#else // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ rcu_read_lock(); -+ br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); -+ rcu_read_unlock(); -+#endif // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) -+ -+ -+ if( br_port && (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == true) ) -+ { -+ if (nat25_handle_frame(padapter, pkt) == -1) { -+ //priv->ext_stats.rx_data_drops++; -+ //DEBUG_ERR("RX DROP: nat25_handle_frame fail!\n"); -+ //return FAIL; -+ -+#if 1 -+ // bypass this frame to upper layer!! -+#else -+ dev_kfree_skb_any(sub_skb); -+ continue; -+#endif -+ } -+ } -+#endif // CONFIG_BR_EXT -+ -+ pkt->protocol = eth_type_trans(pkt, padapter->pnetdev); -+ pkt->dev = padapter->pnetdev; -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_RX -+ if ( (pattrib->tcpchk_valid == 1) && (pattrib->tcp_chkrpt == 1) ) { -+ pkt->ip_summed = CHECKSUM_UNNECESSARY; -+ } else { -+ pkt->ip_summed = CHECKSUM_NONE; -+ } -+#else /* !CONFIG_TCP_CSUM_OFFLOAD_RX */ -+ pkt->ip_summed = CHECKSUM_NONE; -+#endif //CONFIG_TCP_CSUM_OFFLOAD_RX -+ -+ netif_rx(pkt); -+ } -+} -+ -+void rtw_handle_tkip_mic_err(_adapter *padapter,u8 bgroup) -+{ -+#ifdef CONFIG_IOCTL_CFG80211 -+ enum nl80211_key_type key_type; -+#endif -+ union iwreq_data wrqu; -+ struct iw_michaelmicfailure ev; -+ struct mlme_priv* pmlmepriv = &padapter->mlmepriv; -+ struct security_priv *psecuritypriv = &padapter->securitypriv; -+ u32 cur_time = 0; -+ -+ if( psecuritypriv->last_mic_err_time == 0 ) -+ { -+ psecuritypriv->last_mic_err_time = rtw_get_current_time(); -+ } -+ else -+ { -+ cur_time = rtw_get_current_time(); -+ -+ if( cur_time - psecuritypriv->last_mic_err_time < 60*HZ ) -+ { -+ psecuritypriv->btkip_countermeasure = true; -+ psecuritypriv->last_mic_err_time = 0; -+ psecuritypriv->btkip_countermeasure_time = cur_time; -+ } -+ else -+ { -+ psecuritypriv->last_mic_err_time = rtw_get_current_time(); -+ } -+ } -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if ( bgroup ) -+ { -+ key_type |= NL80211_KEYTYPE_GROUP; -+ } -+ else -+ { -+ key_type |= NL80211_KEYTYPE_PAIRWISE; -+ } -+ -+ cfg80211_michael_mic_failure(padapter->pnetdev, (u8 *)&pmlmepriv->assoc_bssid[ 0 ], key_type, -1, -+ NULL, GFP_ATOMIC); -+#endif -+ -+ _rtw_memset( &ev, 0x00, sizeof( ev ) ); -+ if ( bgroup ) -+ { -+ ev.flags |= IW_MICFAILURE_GROUP; -+ } -+ else -+ { -+ ev.flags |= IW_MICFAILURE_PAIRWISE; -+ } -+ -+ ev.src_addr.sa_family = ARPHRD_ETHER; -+ _rtw_memcpy( ev.src_addr.sa_data, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN ); -+ -+ _rtw_memset( &wrqu, 0x00, sizeof( wrqu ) ); -+ wrqu.data.length = sizeof( ev ); -+ -+#ifndef CONFIG_IOCTL_CFG80211 -+ wireless_send_event( padapter->pnetdev, IWEVMICHAELMICFAILURE, &wrqu, (char*) &ev ); -+#endif -+} -+ -+void rtw_hostapd_mlme_rx(_adapter *padapter, union recv_frame *precv_frame) -+{ -+#ifdef CONFIG_HOSTAPD_MLME -+ _pkt *skb; -+ struct hostapd_priv *phostapdpriv = padapter->phostapdpriv; -+ struct net_device *pmgnt_netdev = phostapdpriv->pmgnt_netdev; -+ -+ RT_TRACE(_module_recv_osdep_c_, _drv_info_, ("+rtw_hostapd_mlme_rx\n")); -+ -+ skb = precv_frame->u.hdr.pkt; -+ -+ if (skb == NULL) -+ return; -+ -+ skb->data = precv_frame->u.hdr.rx_data; -+ skb->tail = precv_frame->u.hdr.rx_tail; -+ skb->len = precv_frame->u.hdr.len; -+ -+ //pskb_copy = skb_copy(skb, GFP_ATOMIC); -+// if(skb == NULL) goto _exit; -+ -+ skb->dev = pmgnt_netdev; -+ skb->ip_summed = CHECKSUM_NONE; -+ skb->pkt_type = PACKET_OTHERHOST; -+ //skb->protocol = __constant_htons(0x0019); /*ETH_P_80211_RAW*/ -+ skb->protocol = __constant_htons(0x0003); /*ETH_P_80211_RAW*/ -+ -+ //DBG_871X("(1)data=0x%x, head=0x%x, tail=0x%x, mac_header=0x%x, len=%d\n", skb->data, skb->head, skb->tail, skb->mac_header, skb->len); -+ -+ //skb->mac.raw = skb->data; -+ skb_reset_mac_header(skb); -+ -+ //skb_pull(skb, 24); -+ _rtw_memset(skb->cb, 0, sizeof(skb->cb)); -+ -+ netif_rx(skb); -+ -+ precv_frame->u.hdr.pkt = NULL; // set pointer to NULL before rtw_free_recvframe() if call netif_rx() -+#endif -+} -+ -+#ifdef CONFIG_AUTO_AP_MODE -+static void rtw_os_ksocket_send(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ _pkt *skb = precv_frame->u.hdr.pkt; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ struct sta_info *psta = precv_frame->u.hdr.psta; -+ -+ DBG_871X("eth rx: got eth_type=0x%x\n", pattrib->eth_type); -+ -+ if (psta && psta->isrc && psta->pid>0) -+ { -+ u16 rx_pid; -+ -+ rx_pid = *(u16*)(skb->data+ETH_HLEN); -+ -+ DBG_871X("eth rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", -+ rx_pid, MAC_ARG(psta->hwaddr), psta->pid); -+ -+ if(rx_pid == psta->pid) -+ { -+ int i; -+ u16 len = *(u16*)(skb->data+ETH_HLEN+2); -+ //u16 ctrl_type = *(u16*)(skb->data+ETH_HLEN+4); -+ -+ //DBG_871X("eth, RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); -+ DBG_871X("eth, RC: len=0x%x\n", len); -+ -+ for(i=0;idata+ETH_HLEN+4+i)); -+ //DBG_871X("0x%x\n", *(skb->data+ETH_HLEN+6+i)); -+ -+ DBG_871X("eth, RC-end\n"); -+ -+#if 0 -+ //send_sz = ksocket_send(padapter->ksock_send, &padapter->kaddr_send, (skb->data+ETH_HLEN+2), len); -+ rtw_recv_ksocket_send_cmd(padapter, (skb->data+ETH_HLEN+2), len); -+ -+ //DBG_871X("ksocket_send size=%d\n", send_sz); -+#endif -+ } -+ -+ } -+ -+} -+#endif //CONFIG_AUTO_AP_MODE -+ -+int rtw_recv_indicatepkt(_adapter *padapter, union recv_frame *precv_frame) -+{ -+ struct recv_priv *precvpriv; -+ _queue *pfree_recv_queue; -+ _pkt *skb; -+ struct mlme_priv*pmlmepriv = &padapter->mlmepriv; -+ struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; -+ -+ -+ -+ precvpriv = &(padapter->recvpriv); -+ pfree_recv_queue = &(precvpriv->free_recv_queue); -+ -+#ifdef CONFIG_DRVEXT_MODULE -+ if (drvext_rx_handler(padapter, precv_frame->u.hdr.rx_data, precv_frame->u.hdr.len) == _SUCCESS) -+ { -+ goto _recv_indicatepkt_drop; -+ } -+#endif -+ -+#ifdef CONFIG_WAPI_SUPPORT -+ if (rtw_wapi_check_for_drop(padapter,precv_frame)) -+ { -+ WAPI_TRACE(WAPI_ERR, "%s(): Rx Reorder Drop case!!\n", __FUNCTION__); -+ goto _recv_indicatepkt_drop; -+ } -+#endif -+ -+ skb = precv_frame->u.hdr.pkt; -+ if(skb == NULL) -+ { -+ RT_TRACE(_module_recv_osdep_c_,_drv_err_,("rtw_recv_indicatepkt():skb==NULL something wrong!!!!\n")); -+ goto _recv_indicatepkt_drop; -+ } -+ -+ RT_TRACE(_module_recv_osdep_c_,_drv_info_,("rtw_recv_indicatepkt():skb != NULL !!!\n")); -+ RT_TRACE(_module_recv_osdep_c_,_drv_info_,("rtw_recv_indicatepkt():precv_frame->u.hdr.rx_head=%p precv_frame->hdr.rx_data=%p\n", precv_frame->u.hdr.rx_head, precv_frame->u.hdr.rx_data)); -+ RT_TRACE(_module_recv_osdep_c_,_drv_info_,("precv_frame->hdr.rx_tail=%p precv_frame->u.hdr.rx_end=%p precv_frame->hdr.len=%d \n", precv_frame->u.hdr.rx_tail, precv_frame->u.hdr.rx_end, precv_frame->u.hdr.len)); -+ -+ skb->data = precv_frame->u.hdr.rx_data; -+ -+ skb_set_tail_pointer(skb, precv_frame->u.hdr.len); -+ -+ skb->len = precv_frame->u.hdr.len; -+ -+ RT_TRACE(_module_recv_osdep_c_,_drv_info_,("\n skb->head=%p skb->data=%p skb->tail=%p skb->end=%p skb->len=%d\n", skb->head, skb->data, skb->tail, skb->end, skb->len)); -+ -+#ifdef CONFIG_AUTO_AP_MODE -+#if 1 //for testing -+#if 1 -+ if (0x8899 == pattrib->eth_type) -+ { -+ rtw_os_ksocket_send(padapter, precv_frame); -+ -+ //goto _recv_indicatepkt_drop; -+ } -+#else -+ if (0x8899 == pattrib->eth_type) -+ { -+ rtw_auto_ap_mode_rx(padapter, precv_frame); -+ -+ goto _recv_indicatepkt_end; -+ } -+#endif -+#endif -+#endif //CONFIG_AUTO_AP_MODE -+ -+ rtw_os_recv_indicate_pkt(padapter, skb, pattrib); -+ -+_recv_indicatepkt_end: -+ -+ precv_frame->u.hdr.pkt = NULL; // pointers to NULL before rtw_free_recvframe() -+ -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ -+ RT_TRACE(_module_recv_osdep_c_,_drv_info_,("\n rtw_recv_indicatepkt :after netif_rx!!!!\n")); -+ -+ -+ -+ return _SUCCESS; -+ -+_recv_indicatepkt_drop: -+ -+ //enqueue back to free_recv_queue -+ if(precv_frame) -+ rtw_free_recvframe(precv_frame, pfree_recv_queue); -+ -+ return _FAIL; -+ -+ -+ -+} -+ -+void rtw_os_read_port(_adapter *padapter, struct recv_buf *precvbuf) -+{ -+ struct recv_priv *precvpriv = &padapter->recvpriv; -+ -+ precvbuf->ref_cnt--; -+ -+ //free skb in recv_buf -+ dev_kfree_skb_any(precvbuf->pskb); -+ -+ precvbuf->pskb = NULL; -+ precvbuf->reuse = false; -+ -+ if(precvbuf->irp_pending == false) -+ { -+ rtw_read_port(padapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf); -+ } -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+static void _rtw_reordering_ctrl_timeout_handler(void *FunctionContext) -+#else -+static void _rtw_reordering_ctrl_timeout_handler(struct timer_list *t) -+#endif -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ struct recv_reorder_ctrl *preorder_ctrl = (struct recv_reorder_ctrl *)FunctionContext; -+#else -+ struct recv_reorder_ctrl *preorder_ctrl = from_timer(preorder_ctrl, t, reordering_ctrl_timer); -+#endif -+ -+ rtw_reordering_ctrl_timeout_handler(preorder_ctrl); -+} -+ -+void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl) -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+ _adapter *padapter = preorder_ctrl->padapter; -+ -+ _init_timer(&(preorder_ctrl->reordering_ctrl_timer), padapter->pnetdev, _rtw_reordering_ctrl_timeout_handler, preorder_ctrl); -+#else -+ -+ timer_setup(&preorder_ctrl->reordering_ctrl_timer, _rtw_reordering_ctrl_timeout_handler, 0); -+#endif -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/rtw_android.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/rtw_android.c ---- linux-4.14.17/3rdparty/rtl8812au/os_dep/rtw_android.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/rtw_android.c 2018-02-06 17:42:30.725967387 +0200 -@@ -0,0 +1,810 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+ -+#include -+ -+ -+#if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) -+#include -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+#include -+#else -+#include -+#endif -+#endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -+#define strnicmp strncasecmp -+#endif -+ -+const char *android_wifi_cmd_str[ANDROID_WIFI_CMD_MAX] = { -+ "START", -+ "STOP", -+ "SCAN-ACTIVE", -+ "SCAN-PASSIVE", -+ "RSSI", -+ "LINKSPEED", -+ "RXFILTER-START", -+ "RXFILTER-STOP", -+ "RXFILTER-ADD", -+ "RXFILTER-REMOVE", -+ "BTCOEXSCAN-START", -+ "BTCOEXSCAN-STOP", -+ "BTCOEXMODE", -+ "SETSUSPENDOPT", -+ "P2P_DEV_ADDR", -+ "SETFWPATH", -+ "SETBAND", -+ "GETBAND", -+ "COUNTRY", -+ "P2P_SET_NOA", -+ "P2P_GET_NOA", -+ "P2P_SET_PS", -+ "SET_AP_WPS_P2P_IE", -+#ifdef PNO_SUPPORT -+ "PNOSSIDCLR", -+ "PNOSETUP ", -+ "PNOFORCE", -+ "PNODEBUG", -+#endif -+ -+ "MACADDR", -+ -+ "BLOCK", -+ "WFD-ENABLE", -+ "WFD-DISABLE", -+ "WFD-SET-TCPPORT", -+ "WFD-SET-MAXTPUT", -+ "WFD-SET-DEVTYPE", -+}; -+ -+#ifdef PNO_SUPPORT -+#define PNO_TLV_PREFIX 'S' -+#define PNO_TLV_VERSION '1' -+#define PNO_TLV_SUBVERSION '2' -+#define PNO_TLV_RESERVED '0' -+#define PNO_TLV_TYPE_SSID_IE 'S' -+#define PNO_TLV_TYPE_TIME 'T' -+#define PNO_TLV_FREQ_REPEAT 'R' -+#define PNO_TLV_FREQ_EXPO_MAX 'M' -+ -+typedef struct cmd_tlv { -+ char prefix; -+ char version; -+ char subver; -+ char reserved; -+} cmd_tlv_t; -+#endif /* PNO_SUPPORT */ -+ -+typedef struct android_wifi_priv_cmd { -+ -+#ifdef CONFIG_COMPAT -+ compat_uptr_t buf; -+#else -+ char *buf; -+#endif -+ -+ int used_len; -+ int total_len; -+} android_wifi_priv_cmd; -+ -+/** -+ * Local (static) functions and variables -+ */ -+ -+/* Initialize g_wifi_on to 1 so dhd_bus_start will be called for the first -+ * time (only) in dhd_open, subsequential wifi on will be handled by -+ * wl_android_wifi_on -+ */ -+static int g_wifi_on = true; -+ -+ -+#ifdef PNO_SUPPORT -+static int wl_android_set_pno_setup(struct net_device *dev, char *command, int total_len) -+{ -+ wlc_ssid_t ssids_local[MAX_PFN_LIST_COUNT]; -+ int res = -1; -+ int nssid = 0; -+ cmd_tlv_t *cmd_tlv_temp; -+ char *str_ptr; -+ int tlv_size_left; -+ int pno_time = 0; -+ int pno_repeat = 0; -+ int pno_freq_expo_max = 0; -+ -+#ifdef PNO_SET_DEBUG -+ int i; -+ char pno_in_example[] = { -+ 'P', 'N', 'O', 'S', 'E', 'T', 'U', 'P', ' ', -+ 'S', '1', '2', '0', -+ 'S', -+ 0x05, -+ 'd', 'l', 'i', 'n', 'k', -+ 'S', -+ 0x04, -+ 'G', 'O', 'O', 'G', -+ 'T', -+ '0', 'B', -+ 'R', -+ '2', -+ 'M', -+ '2', -+ 0x00 -+ }; -+#endif /* PNO_SET_DEBUG */ -+ -+ DHD_INFO(("%s: command=%s, len=%d\n", __FUNCTION__, command, total_len)); -+ -+ if (total_len < (strlen(CMD_PNOSETUP_SET) + sizeof(cmd_tlv_t))) { -+ DBG_871X("%s argument=%d less min size\n", __FUNCTION__, total_len); -+ goto exit_proc; -+ } -+ -+#ifdef PNO_SET_DEBUG -+ memcpy(command, pno_in_example, sizeof(pno_in_example)); -+ for (i = 0; i < sizeof(pno_in_example); i++) -+ printf("%02X ", command[i]); -+ printf("\n"); -+ total_len = sizeof(pno_in_example); -+#endif -+ -+ str_ptr = command + strlen(CMD_PNOSETUP_SET); -+ tlv_size_left = total_len - strlen(CMD_PNOSETUP_SET); -+ -+ cmd_tlv_temp = (cmd_tlv_t *)str_ptr; -+ memset(ssids_local, 0, sizeof(ssids_local)); -+ -+ if ((cmd_tlv_temp->prefix == PNO_TLV_PREFIX) && -+ (cmd_tlv_temp->version == PNO_TLV_VERSION) && -+ (cmd_tlv_temp->subver == PNO_TLV_SUBVERSION)) { -+ -+ str_ptr += sizeof(cmd_tlv_t); -+ tlv_size_left -= sizeof(cmd_tlv_t); -+ -+ if ((nssid = wl_iw_parse_ssid_list_tlv(&str_ptr, ssids_local, -+ MAX_PFN_LIST_COUNT, &tlv_size_left)) <= 0) { -+ DBG_871X("SSID is not presented or corrupted ret=%d\n", nssid); -+ goto exit_proc; -+ } else { -+ if ((str_ptr[0] != PNO_TLV_TYPE_TIME) || (tlv_size_left <= 1)) { -+ DBG_871X("%s scan duration corrupted field size %d\n", -+ __FUNCTION__, tlv_size_left); -+ goto exit_proc; -+ } -+ str_ptr++; -+ pno_time = simple_strtoul(str_ptr, &str_ptr, 16); -+ DHD_INFO(("%s: pno_time=%d\n", __FUNCTION__, pno_time)); -+ -+ if (str_ptr[0] != 0) { -+ if ((str_ptr[0] != PNO_TLV_FREQ_REPEAT)) { -+ DBG_871X("%s pno repeat : corrupted field\n", -+ __FUNCTION__); -+ goto exit_proc; -+ } -+ str_ptr++; -+ pno_repeat = simple_strtoul(str_ptr, &str_ptr, 16); -+ DHD_INFO(("%s :got pno_repeat=%d\n", __FUNCTION__, pno_repeat)); -+ if (str_ptr[0] != PNO_TLV_FREQ_EXPO_MAX) { -+ DBG_871X("%s FREQ_EXPO_MAX corrupted field size\n", -+ __FUNCTION__); -+ goto exit_proc; -+ } -+ str_ptr++; -+ pno_freq_expo_max = simple_strtoul(str_ptr, &str_ptr, 16); -+ DHD_INFO(("%s: pno_freq_expo_max=%d\n", -+ __FUNCTION__, pno_freq_expo_max)); -+ } -+ } -+ } else { -+ DBG_871X("%s get wrong TLV command\n", __FUNCTION__); -+ goto exit_proc; -+ } -+ -+ res = dhd_dev_pno_set(dev, ssids_local, nssid, pno_time, pno_repeat, pno_freq_expo_max); -+ -+exit_proc: -+ return res; -+} -+#endif /* PNO_SUPPORT */ -+ -+int rtw_android_cmdstr_to_num(char *cmdstr) -+{ -+ int cmd_num; -+ for(cmd_num=0 ; cmd_nummlmepriv); -+ struct wlan_network *pcur_network = &pmlmepriv->cur_network; -+ int bytes_written = 0; -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED) == true) { -+ bytes_written += snprintf(&command[bytes_written], total_len, "%s rssi %d", -+ pcur_network->network.Ssid.Ssid, padapter->recvpriv.rssi); -+ } -+ -+ return bytes_written; -+} -+ -+int rtw_android_get_link_speed(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(net); -+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); -+ struct wlan_network *pcur_network = &pmlmepriv->cur_network; -+ int bytes_written = 0; -+ u16 link_speed = 0; -+ -+ link_speed = rtw_get_cur_max_rate(padapter)/10; -+ bytes_written = snprintf(command, total_len, "LinkSpeed %d", link_speed); -+ -+ return bytes_written; -+} -+ -+int rtw_android_get_macaddr(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ int bytes_written = 0; -+ -+ bytes_written = snprintf(command, total_len, "Macaddr = "MAC_FMT, MAC_ARG(net->dev_addr)); -+ return bytes_written; -+} -+ -+int rtw_android_set_country(struct net_device *net, char *command, int total_len) -+{ -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ char *country_code = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_COUNTRY]) + 1; -+ int ret; -+ -+ ret = rtw_set_country(adapter, country_code); -+ -+ return (ret==_SUCCESS)?0:-1; -+} -+ -+int rtw_android_get_p2p_dev_addr(struct net_device *net, char *command, int total_len) -+{ -+ int ret; -+ int bytes_written = 0; -+ -+ //We use the same address as our HW MAC address -+ _rtw_memcpy(command, net->dev_addr, ETH_ALEN); -+ -+ bytes_written = ETH_ALEN; -+ return bytes_written; -+} -+ -+int rtw_android_set_block(struct net_device *net, char *command, int total_len) -+{ -+ int ret; -+ _adapter *adapter = (_adapter *)rtw_netdev_priv(net); -+ char *block_value = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_BLOCK]) + 1; -+ -+ #ifdef CONFIG_IOCTL_CFG80211 -+ wdev_to_priv(adapter->rtw_wdev)->block = (*block_value=='0')?false:true; -+ #endif -+ -+ return 0; -+} -+ -+int get_int_from_command( char* pcmd ) -+{ -+ int i = 0; -+ -+ for( i = 0; i < strlen( pcmd ); i++ ) -+ { -+ if ( pcmd[ i ] == '=' ) -+ { -+ // Skip the '=' and space characters. -+ i += 2; -+ break; -+ } -+ } -+ return ( rtw_atoi( pcmd + i ) ); -+} -+ -+int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) -+{ -+ int ret = 0; -+ char *command = NULL; -+ int cmd_num; -+ int bytes_written = 0; -+ android_wifi_priv_cmd priv_cmd; -+ -+ rtw_lock_suspend(); -+ -+ if (!ifr->ifr_data) { -+ ret = -EINVAL; -+ goto exit; -+ } -+ if (copy_from_user(&priv_cmd, ifr->ifr_data, sizeof(android_wifi_priv_cmd))) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ //DBG_871X("%s priv_cmd.buf=%p priv_cmd.total_len=%d priv_cmd.used_len=%d\n",__func__,priv_cmd.buf,priv_cmd.total_len,priv_cmd.used_len); -+ command = rtw_zmalloc(priv_cmd.total_len); -+ if (!command) -+ { -+ DBG_871X("%s: failed to allocate memory\n", __FUNCTION__); -+ ret = -ENOMEM; -+ goto exit; -+ } -+ -+ if (!access_ok(VERIFY_READ, priv_cmd.buf, priv_cmd.total_len)){ -+ DBG_871X("%s: failed to access memory\n", __FUNCTION__); -+ ret = -EFAULT; -+ goto exit; -+ } -+ if (copy_from_user(command, (void *)priv_cmd.buf, priv_cmd.total_len)) { -+ ret = -EFAULT; -+ goto exit; -+ } -+ -+ DBG_871X("%s: Android private cmd \"%s\" on %s\n" -+ , __FUNCTION__, command, ifr->ifr_name); -+ -+ cmd_num = rtw_android_cmdstr_to_num(command); -+ -+ switch(cmd_num) { -+ case ANDROID_WIFI_CMD_START: -+ //bytes_written = wl_android_wifi_on(net); -+ goto response; -+ case ANDROID_WIFI_CMD_SETFWPATH: -+ goto response; -+ } -+ -+ if (!g_wifi_on) { -+ DBG_871X("%s: Ignore private cmd \"%s\" - iface %s is down\n" -+ ,__FUNCTION__, command, ifr->ifr_name); -+ ret = 0; -+ goto exit; -+ } -+ -+ switch(cmd_num) { -+ -+ case ANDROID_WIFI_CMD_STOP: -+ //bytes_written = wl_android_wifi_off(net); -+ break; -+ -+ case ANDROID_WIFI_CMD_SCAN_ACTIVE: -+ break; -+ case ANDROID_WIFI_CMD_SCAN_PASSIVE: -+ break; -+ -+ case ANDROID_WIFI_CMD_RSSI: -+ bytes_written = rtw_android_get_rssi(net, command, priv_cmd.total_len); -+ break; -+ case ANDROID_WIFI_CMD_LINKSPEED: -+ bytes_written = rtw_android_get_link_speed(net, command, priv_cmd.total_len); -+ break; -+ -+ case ANDROID_WIFI_CMD_MACADDR: -+ bytes_written = rtw_android_get_macaddr(net, command, priv_cmd.total_len); -+ break; -+ -+ case ANDROID_WIFI_CMD_BLOCK: -+ bytes_written = rtw_android_set_block(net, command, priv_cmd.total_len); -+ break; -+ -+ case ANDROID_WIFI_CMD_RXFILTER_START: -+ //bytes_written = net_os_set_packet_filter(net, 1); -+ break; -+ case ANDROID_WIFI_CMD_RXFILTER_STOP: -+ //bytes_written = net_os_set_packet_filter(net, 0); -+ break; -+ case ANDROID_WIFI_CMD_RXFILTER_ADD: -+ //int filter_num = *(command + strlen(CMD_RXFILTER_ADD) + 1) - '0'; -+ //bytes_written = net_os_rxfilter_add_remove(net, TRUE, filter_num); -+ break; -+ case ANDROID_WIFI_CMD_RXFILTER_REMOVE: -+ //int filter_num = *(command + strlen(CMD_RXFILTER_REMOVE) + 1) - '0'; -+ //bytes_written = net_os_rxfilter_add_remove(net, FALSE, filter_num); -+ break; -+ -+ case ANDROID_WIFI_CMD_BTCOEXSCAN_START: -+ /* TBD: BTCOEXSCAN-START */ -+ break; -+ case ANDROID_WIFI_CMD_BTCOEXSCAN_STOP: -+ /* TBD: BTCOEXSCAN-STOP */ -+ break; -+ case ANDROID_WIFI_CMD_BTCOEXMODE: -+ #if 0 -+ uint mode = *(command + strlen(CMD_BTCOEXMODE) + 1) - '0'; -+ if (mode == 1) -+ net_os_set_packet_filter(net, 0); /* DHCP starts */ -+ else -+ net_os_set_packet_filter(net, 1); /* DHCP ends */ -+#ifdef WL_CFG80211 -+ bytes_written = wl_cfg80211_set_btcoex_dhcp(net, command); -+#endif -+ #endif -+ break; -+ -+ case ANDROID_WIFI_CMD_SETSUSPENDOPT: -+ //bytes_written = wl_android_set_suspendopt(net, command, priv_cmd.total_len); -+ break; -+ -+ case ANDROID_WIFI_CMD_SETBAND: -+ { -+ uint band = *(command + strlen("SETBAND") + 1) - '0'; -+ _adapter* padapter = ( _adapter * ) rtw_netdev_priv(net); -+ -+ if (padapter->chip_type == RTL8192D) -+ padapter->setband = band; -+ -+ break; -+ } -+ case ANDROID_WIFI_CMD_GETBAND: -+ //bytes_written = wl_android_get_band(net, command, priv_cmd.total_len); -+ break; -+ -+ case ANDROID_WIFI_CMD_COUNTRY: -+ bytes_written = rtw_android_set_country(net, command, priv_cmd.total_len); -+ break; -+ -+#ifdef PNO_SUPPORT -+ case ANDROID_WIFI_CMD_PNOSSIDCLR_SET: -+ //bytes_written = dhd_dev_pno_reset(net); -+ break; -+ case ANDROID_WIFI_CMD_PNOSETUP_SET: -+ //bytes_written = wl_android_set_pno_setup(net, command, priv_cmd.total_len); -+ break; -+ case ANDROID_WIFI_CMD_PNOENABLE_SET: -+ //uint pfn_enabled = *(command + strlen(CMD_PNOENABLE_SET) + 1) - '0'; -+ //bytes_written = dhd_dev_pno_enable(net, pfn_enabled); -+ break; -+#endif -+ -+ case ANDROID_WIFI_CMD_P2P_DEV_ADDR: -+ bytes_written = rtw_android_get_p2p_dev_addr(net, command, priv_cmd.total_len); -+ break; -+ case ANDROID_WIFI_CMD_P2P_SET_NOA: -+ //int skip = strlen(CMD_P2P_SET_NOA) + 1; -+ //bytes_written = wl_cfg80211_set_p2p_noa(net, command + skip, priv_cmd.total_len - skip); -+ break; -+ case ANDROID_WIFI_CMD_P2P_GET_NOA: -+ //bytes_written = wl_cfg80211_get_p2p_noa(net, command, priv_cmd.total_len); -+ break; -+ case ANDROID_WIFI_CMD_P2P_SET_PS: -+ //int skip = strlen(CMD_P2P_SET_PS) + 1; -+ //bytes_written = wl_cfg80211_set_p2p_ps(net, command + skip, priv_cmd.total_len - skip); -+ break; -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ case ANDROID_WIFI_CMD_SET_AP_WPS_P2P_IE: -+ { -+ int skip = strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_SET_AP_WPS_P2P_IE]) + 3; -+ bytes_written = rtw_cfg80211_set_mgnt_wpsp2pie(net, command + skip, priv_cmd.total_len - skip, *(command + skip - 2) - '0'); -+ break; -+ } -+#endif //CONFIG_IOCTL_CFG80211 -+ -+#ifdef CONFIG_WFD -+ case ANDROID_WIFI_CMD_WFD_ENABLE: -+ { -+ // Commented by Albert 2012/07/24 -+ // We can enable the WFD function by using the following command: -+ // wpa_cli driver wfd-enable -+ -+ struct wifi_display_info *pwfd_info; -+ _adapter* padapter = ( _adapter * ) rtw_netdev_priv(net); -+ -+ pwfd_info = &padapter->wfd_info; -+ if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) -+ pwfd_info->wfd_enable = true; -+ break; -+ } -+ -+ case ANDROID_WIFI_CMD_WFD_DISABLE: -+ { -+ // Commented by Albert 2012/07/24 -+ // We can disable the WFD function by using the following command: -+ // wpa_cli driver wfd-disable -+ -+ struct wifi_display_info *pwfd_info; -+ _adapter* padapter = ( _adapter * ) rtw_netdev_priv(net); -+ -+ pwfd_info = &padapter->wfd_info; -+ if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) -+ pwfd_info->wfd_enable = false; -+ break; -+ } -+ case ANDROID_WIFI_CMD_WFD_SET_TCPPORT: -+ { -+ // Commented by Albert 2012/07/24 -+ // We can set the tcp port number by using the following command: -+ // wpa_cli driver wfd-set-tcpport = 554 -+ -+ struct wifi_display_info *pwfd_info; -+ _adapter* padapter = ( _adapter * ) rtw_netdev_priv(net); -+ -+ pwfd_info = &padapter->wfd_info; -+ if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) -+ pwfd_info->rtsp_ctrlport = ( u16 ) get_int_from_command( (char*)priv_cmd.buf ); -+ break; -+ } -+ case ANDROID_WIFI_CMD_WFD_SET_MAX_TPUT: -+ { -+ -+ -+ break; -+ } -+ case ANDROID_WIFI_CMD_WFD_SET_DEVTYPE: -+ { -+ // Commented by Albert 2012/08/28 -+ // Specify the WFD device type ( WFD source/primary sink ) -+ -+ struct wifi_display_info *pwfd_info; -+ _adapter* padapter = ( _adapter * ) rtw_netdev_priv(net); -+ -+ pwfd_info = &padapter->wfd_info; -+ if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 ) -+ { -+ pwfd_info->wfd_device_type = ( u8 ) get_int_from_command( (char*)priv_cmd.buf ); -+ -+ pwfd_info->wfd_device_type &= WFD_DEVINFO_DUAL; -+ } -+ break; -+ } -+#endif -+ default: -+ DBG_871X("Unknown PRIVATE command %s - ignored\n", command); -+ snprintf(command, 3, "OK"); -+ bytes_written = strlen("OK"); -+ } -+ -+response: -+ if (bytes_written >= 0) { -+ if ((bytes_written == 0) && (priv_cmd.total_len > 0)) -+ command[0] = '\0'; -+ if (bytes_written >= priv_cmd.total_len) { -+ DBG_871X("%s: bytes_written = %d\n", __FUNCTION__, bytes_written); -+ bytes_written = priv_cmd.total_len; -+ } else { -+ bytes_written++; -+ } -+ priv_cmd.used_len = bytes_written; -+ if (copy_to_user((void *)priv_cmd.buf, command, bytes_written)) { -+ DBG_871X("%s: failed to copy data to user buffer\n", __FUNCTION__); -+ ret = -EFAULT; -+ } -+ } -+ else { -+ ret = bytes_written; -+ } -+ -+exit: -+ rtw_unlock_suspend(); -+ if (command) { -+ kfree(command); -+ } -+ -+ return ret; -+} -+ -+ -+/** -+ * Functions for Android WiFi card detection -+ */ -+#if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) -+ -+static int g_wifidev_registered = 0; -+static struct semaphore wifi_control_sem; -+static struct wifi_platform_data *wifi_control_data = NULL; -+static struct resource *wifi_irqres = NULL; -+ -+static int wifi_add_dev(void); -+static void wifi_del_dev(void); -+ -+int rtw_android_wifictrl_func_add(void) -+{ -+ int ret = 0; -+ sema_init(&wifi_control_sem, 0); -+ -+ ret = wifi_add_dev(); -+ if (ret) { -+ DBG_871X("%s: platform_driver_register failed\n", __FUNCTION__); -+ return ret; -+ } -+ g_wifidev_registered = 1; -+ -+ /* Waiting callback after platform_driver_register is done or exit with error */ -+ if (down_timeout(&wifi_control_sem, msecs_to_jiffies(1000)) != 0) { -+ ret = -EINVAL; -+ DBG_871X("%s: platform_driver_register timeout\n", __FUNCTION__); -+ } -+ -+ return ret; -+} -+ -+void rtw_android_wifictrl_func_del(void) -+{ -+ if (g_wifidev_registered) -+ { -+ wifi_del_dev(); -+ g_wifidev_registered = 0; -+ } -+} -+ -+void *wl_android_prealloc(int section, unsigned long size) -+{ -+ void *alloc_ptr = NULL; -+ if (wifi_control_data && wifi_control_data->mem_prealloc) { -+ alloc_ptr = wifi_control_data->mem_prealloc(section, size); -+ if (alloc_ptr) { -+ DBG_871X("success alloc section %d\n", section); -+ if (size != 0L) -+ memset(alloc_ptr, 0, size); -+ return alloc_ptr; -+ } -+ } -+ -+ DBG_871X("can't alloc section %d\n", section); -+ return NULL; -+} -+ -+int wifi_get_irq_number(unsigned long *irq_flags_ptr) -+{ -+ if (wifi_irqres) { -+ *irq_flags_ptr = wifi_irqres->flags & IRQF_TRIGGER_MASK; -+ return (int)wifi_irqres->start; -+ } -+#ifdef CUSTOM_OOB_GPIO_NUM -+ return CUSTOM_OOB_GPIO_NUM; -+#else -+ return -1; -+#endif -+} -+ -+int wifi_set_power(int on, unsigned long msec) -+{ -+ DBG_871X("%s = %d\n", __FUNCTION__, on); -+ if (wifi_control_data && wifi_control_data->set_power) { -+ wifi_control_data->set_power(on); -+ } -+ if (msec) -+ msleep(msec); -+ return 0; -+} -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) -+int wifi_get_mac_addr(unsigned char *buf) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ if (!buf) -+ return -EINVAL; -+ if (wifi_control_data && wifi_control_data->get_mac_addr) { -+ return wifi_control_data->get_mac_addr(buf); -+ } -+ return -EOPNOTSUPP; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) */ -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39)) || defined(COMPAT_KERNEL_RELEASE) -+void *wifi_get_country_code(char *ccode) -+{ -+ DBG_871X("%s\n", __FUNCTION__); -+ if (!ccode) -+ return NULL; -+ if (wifi_control_data && wifi_control_data->get_country_code) { -+ return wifi_control_data->get_country_code(ccode); -+ } -+ return NULL; -+} -+#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39)) */ -+ -+static int wifi_set_carddetect(int on) -+{ -+ DBG_871X("%s = %d\n", __FUNCTION__, on); -+ if (wifi_control_data && wifi_control_data->set_carddetect) { -+ wifi_control_data->set_carddetect(on); -+ } -+ return 0; -+} -+ -+static int wifi_probe(struct platform_device *pdev) -+{ -+ struct wifi_platform_data *wifi_ctrl = -+ (struct wifi_platform_data *)(pdev->dev.platform_data); -+ -+ DBG_871X("## %s\n", __FUNCTION__); -+ wifi_irqres = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "bcmdhd_wlan_irq"); -+ if (wifi_irqres == NULL) -+ wifi_irqres = platform_get_resource_byname(pdev, -+ IORESOURCE_IRQ, "bcm4329_wlan_irq"); -+ wifi_control_data = wifi_ctrl; -+ -+ wifi_set_power(1, 0); /* Power On */ -+ wifi_set_carddetect(1); /* CardDetect (0->1) */ -+ -+ up(&wifi_control_sem); -+ return 0; -+} -+ -+static int wifi_remove(struct platform_device *pdev) -+{ -+ struct wifi_platform_data *wifi_ctrl = -+ (struct wifi_platform_data *)(pdev->dev.platform_data); -+ -+ DBG_871X("## %s\n", __FUNCTION__); -+ wifi_control_data = wifi_ctrl; -+ -+ wifi_set_power(0, 0); /* Power Off */ -+ wifi_set_carddetect(0); /* CardDetect (1->0) */ -+ -+ up(&wifi_control_sem); -+ return 0; -+} -+ -+static int wifi_suspend(struct platform_device *pdev, pm_message_t state) -+{ -+ DBG_871X("##> %s\n", __FUNCTION__); -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 39)) && defined(OOB_INTR_ONLY) -+ bcmsdh_oob_intr_set(0); -+#endif -+ return 0; -+} -+ -+static int wifi_resume(struct platform_device *pdev) -+{ -+ DBG_871X("##> %s\n", __FUNCTION__); -+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 39)) && defined(OOB_INTR_ONLY) -+ if (dhd_os_check_if_up(bcmsdh_get_drvdata())) -+ bcmsdh_oob_intr_set(1); -+#endif -+ return 0; -+} -+ -+/* temporarily use these two */ -+static struct platform_driver wifi_device = { -+ .probe = wifi_probe, -+ .remove = wifi_remove, -+ .suspend = wifi_suspend, -+ .resume = wifi_resume, -+ .driver = { -+ .name = "bcmdhd_wlan", -+ } -+}; -+ -+static struct platform_driver wifi_device_legacy = { -+ .probe = wifi_probe, -+ .remove = wifi_remove, -+ .suspend = wifi_suspend, -+ .resume = wifi_resume, -+ .driver = { -+ .name = "bcm4329_wlan", -+ } -+}; -+ -+static int wifi_add_dev(void) -+{ -+ DBG_871X("## Calling platform_driver_register\n"); -+ platform_driver_register(&wifi_device); -+ platform_driver_register(&wifi_device_legacy); -+ return 0; -+} -+ -+static void wifi_del_dev(void) -+{ -+ DBG_871X("## Unregister platform_driver_register\n"); -+ platform_driver_unregister(&wifi_device); -+ platform_driver_unregister(&wifi_device_legacy); -+} -+#endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/usb_intf.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/usb_intf.c ---- linux-4.14.17/3rdparty/rtl8812au/os_dep/usb_intf.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/usb_intf.c 2018-02-06 17:42:30.725967387 +0200 -@@ -0,0 +1,1704 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _HCI_INTF_C_ -+ -+#include -+ -+#ifdef CONFIG_80211N_HT -+extern int rtw_ht_enable; -+extern int rtw_bw_mode; -+extern int rtw_ampdu_enable;//for enable tx_ampdu -+#endif -+ -+#ifdef CONFIG_GLOBAL_UI_PID -+int ui_pid[3] = {0, 0, 0}; -+#endif -+ -+ -+extern int pm_netdev_open(struct net_device *pnetdev,u8 bnormal); -+static int rtw_suspend(struct usb_interface *intf, pm_message_t message); -+static int rtw_resume(struct usb_interface *intf); -+int rtw_resume_process(_adapter *padapter); -+ -+ -+static int rtw_drv_init(struct usb_interface *pusb_intf,const struct usb_device_id *pdid); -+static void rtw_dev_remove(struct usb_interface *pusb_intf); -+ -+#if (LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,23)) -+/* Some useful macros to use to create struct usb_device_id */ -+ #define USB_DEVICE_ID_MATCH_VENDOR 0x0001 -+ #define USB_DEVICE_ID_MATCH_PRODUCT 0x0002 -+ #define USB_DEVICE_ID_MATCH_DEV_LO 0x0004 -+ #define USB_DEVICE_ID_MATCH_DEV_HI 0x0008 -+ #define USB_DEVICE_ID_MATCH_DEV_CLASS 0x0010 -+ #define USB_DEVICE_ID_MATCH_DEV_SUBCLASS 0x0020 -+ #define USB_DEVICE_ID_MATCH_DEV_PROTOCOL 0x0040 -+ #define USB_DEVICE_ID_MATCH_INT_CLASS 0x0080 -+ #define USB_DEVICE_ID_MATCH_INT_SUBCLASS 0x0100 -+ #define USB_DEVICE_ID_MATCH_INT_PROTOCOL 0x0200 -+ #define USB_DEVICE_ID_MATCH_INT_NUMBER 0x0400 -+ -+ -+#define USB_DEVICE_ID_MATCH_INT_INFO \ -+ (USB_DEVICE_ID_MATCH_INT_CLASS | \ -+ USB_DEVICE_ID_MATCH_INT_SUBCLASS | \ -+ USB_DEVICE_ID_MATCH_INT_PROTOCOL) -+ -+ -+#define USB_DEVICE_AND_INTERFACE_INFO(vend, prod, cl, sc, pr) \ -+ .match_flags = USB_DEVICE_ID_MATCH_INT_INFO \ -+ | USB_DEVICE_ID_MATCH_DEVICE, \ -+ .idVendor = (vend), \ -+ .idProduct = (prod), \ -+ .bInterfaceClass = (cl), \ -+ .bInterfaceSubClass = (sc), \ -+ .bInterfaceProtocol = (pr) -+ -+ /** -+ * USB_VENDOR_AND_INTERFACE_INFO - describe a specific usb vendor with a class of usb interfaces -+ * @vend: the 16 bit USB Vendor ID -+ * @cl: bInterfaceClass value -+ * @sc: bInterfaceSubClass value -+ * @pr: bInterfaceProtocol value -+ * -+ * This macro is used to create a struct usb_device_id that matches a -+ * specific vendor with a specific class of interfaces. -+ * -+ * This is especially useful when explicitly matching devices that have -+ * vendor specific bDeviceClass values, but standards-compliant interfaces. -+ */ -+#define USB_VENDOR_AND_INTERFACE_INFO(vend, cl, sc, pr) \ -+ .match_flags = USB_DEVICE_ID_MATCH_INT_INFO \ -+ | USB_DEVICE_ID_MATCH_VENDOR, \ -+ .idVendor = (vend), \ -+ .bInterfaceClass = (cl), \ -+ .bInterfaceSubClass = (sc), \ -+ .bInterfaceProtocol = (pr) -+ -+/* ----------------------------------------------------------------------- */ -+#endif -+ -+ -+#define USB_VENDER_ID_REALTEK 0x0BDA -+ -+ -+/* DID_USB_v916_20130116 */ -+static struct usb_device_id rtw_usb_id_tbl[] ={ -+ -+ /*=== Realtek demoboard ===*/ -+ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x8812),.driver_info = RTL8812},/* Default ID */ -+ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x881A),.driver_info = RTL8812},/* Default ID */ -+ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x881B),.driver_info = RTL8812},/* Default ID */ -+ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x881C),.driver_info = RTL8812},/* Default ID */ -+ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0xA811),.driver_info = RTL8812},/* Default ID */ -+ /*=== Customer ID ===*/ -+ {USB_DEVICE(0x050D, 0x1106),.driver_info = RTL8812}, /* Belkin - sercomm */ -+ {USB_DEVICE(0x2001, 0x330E),.driver_info = RTL8812}, /* D-Link - ALPHA */ -+ {USB_DEVICE(0x7392, 0xA822),.driver_info = RTL8812}, /* Edimax - Edimax */ -+ {USB_DEVICE(0x0DF6, 0x0074),.driver_info = RTL8812}, /* Sitecom - Edimax */ -+ {USB_DEVICE(0x04BB, 0x0952),.driver_info = RTL8812}, /* I-O DATA - Edimax */ -+ {USB_DEVICE(0x0789, 0x016E),.driver_info = RTL8812}, /* Logitec - Edimax */ -+ {USB_DEVICE(0x0409, 0x0408),.driver_info = RTL8812}, /* NEC - */ -+ {USB_DEVICE(0x0B05, 0x17D2),.driver_info = RTL8812}, /* ASUS - Edimax */ -+ {USB_DEVICE(0x0E66, 0x0022),.driver_info = RTL8812}, /* HAWKING - Edimax */ -+ {USB_DEVICE(0x0586, 0x3426),.driver_info = RTL8812}, /* ZyXEL - */ -+ {USB_DEVICE(0x2001, 0x3313),.driver_info = RTL8812}, /* D-Link - ALPHA */ -+ {USB_DEVICE(0x1058, 0x0632),.driver_info = RTL8812}, /* WD - Cybertan*/ -+ {USB_DEVICE(0x13b1, 0x003f),.driver_info = RTL8812}, /* Linksys WUSB6300 */ -+ {USB_DEVICE(0x1740, 0x0100),.driver_info = RTL8812}, /* EnGenius - EnGenius */ -+ {USB_DEVICE(0x2019, 0xAB30),.driver_info = RTL8812}, /* Planex - Abocom */ -+ {USB_DEVICE(0x07B8, 0x8812),.driver_info = RTL8812}, /* Abocom - Abocom */ -+ {USB_DEVICE(0x2001, 0x3315),.driver_info = RTL8812}, /* D-Link - Cameo */ -+ {USB_DEVICE(0x2001, 0x3316),.driver_info = RTL8812}, /* D-Link - Cameo */ -+ {USB_DEVICE(0x20f4, 0x805b),.driver_info = RTL8812}, /* TRENDnet - */ -+ {USB_DEVICE(0x2357, 0x0101),.driver_info = RTL8812}, /* TP-Link - Archer T4U */ -+ {USB_DEVICE(0x0411, 0x025d),.driver_info = RTL8812}, /* Buffalo - WI-U3-866D */ -+ -+ /*=== Realtek demoboard ===*/ -+ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x0811),.driver_info = RTL8821},/* Default ID */ -+ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x0821),.driver_info = RTL8821},/* Default ID */ -+ {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x8822),.driver_info = RTL8821},/* Default ID */ -+ /*=== Customer ID ===*/ -+ {USB_DEVICE(0x7392, 0xA811),.driver_info = RTL8821}, /* Edimax - Edimax */ -+ {USB_DEVICE(0x7392, 0xA812),.driver_info = RTL8821}, /* Edimax - EW-7811UTC */ -+ {USB_DEVICE(0x7392, 0xA813),.driver_info = RTL8821}, /* Edimax - EW-7811UAC */ -+ {USB_DEVICE(0x2001, 0x3314),.driver_info = RTL8821}, /* D-Link - Cameo */ -+ {USB_DEVICE(0x0846, 0x9052),.driver_info = RTL8821}, /* Netgear - A6100 */ -+ {USB_DEVICE(0x2019, 0xAB32),.driver_info = RTL8821}, /* Planex - GW-450S */ -+ {USB_DEVICE(0x0411, 0x0242),.driver_info = RTL8821}, /* BUFFALO - Edimax */ -+ {USB_DEVICE(0x056E, 0x4007),.driver_info = RTL8821}, /* ELECOM - WDC-433DU2H */ -+ -+ {} /* Terminating entry */ -+}; -+ -+MODULE_DEVICE_TABLE(usb, rtw_usb_id_tbl); -+ -+int const rtw_usb_id_len = sizeof(rtw_usb_id_tbl) / sizeof(struct usb_device_id); -+ -+static struct specific_device_id specific_device_id_tbl[] = { -+ {.idVendor=USB_VENDER_ID_REALTEK, .idProduct=0x8177, .flags=SPEC_DEV_ID_DISABLE_HT},//8188cu 1*1 dongole, (b/g mode only) -+ {.idVendor=USB_VENDER_ID_REALTEK, .idProduct=0x817E, .flags=SPEC_DEV_ID_DISABLE_HT},//8188CE-VAU USB minCard (b/g mode only) -+ {.idVendor=0x0b05, .idProduct=0x1791, .flags=SPEC_DEV_ID_DISABLE_HT}, -+ {.idVendor=0x13D3, .idProduct=0x3311, .flags=SPEC_DEV_ID_DISABLE_HT}, -+ {.idVendor=0x13D3, .idProduct=0x3359, .flags=SPEC_DEV_ID_DISABLE_HT},//Russian customer -Azwave (8188CE-VAU g mode) -+ {} -+}; -+ -+struct rtw_usb_drv { -+ struct usb_driver usbdrv; -+ int drv_registered; -+ u8 hw_type; -+}; -+ -+struct rtw_usb_drv usb_drv = { -+ .usbdrv.name =(char*)DRV_NAME, -+ .usbdrv.probe = rtw_drv_init, -+ .usbdrv.disconnect = rtw_dev_remove, -+ .usbdrv.id_table = rtw_usb_id_tbl, -+ .usbdrv.suspend = rtw_suspend, -+ .usbdrv.resume = rtw_resume, -+ #if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 22)) -+ .usbdrv.reset_resume = rtw_resume, -+ #endif -+ #ifdef CONFIG_AUTOSUSPEND -+ .usbdrv.supports_autosuspend = 1, -+ #endif -+}; -+ -+static inline int RT_usb_endpoint_dir_in(const struct usb_endpoint_descriptor *epd) -+{ -+ return ((epd->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_IN); -+} -+ -+static inline int RT_usb_endpoint_dir_out(const struct usb_endpoint_descriptor *epd) -+{ -+ return ((epd->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT); -+} -+ -+static inline int RT_usb_endpoint_xfer_int(const struct usb_endpoint_descriptor *epd) -+{ -+ return ((epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_INT); -+} -+ -+static inline int RT_usb_endpoint_xfer_bulk(const struct usb_endpoint_descriptor *epd) -+{ -+ return ((epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_BULK); -+} -+ -+static inline int RT_usb_endpoint_is_bulk_in(const struct usb_endpoint_descriptor *epd) -+{ -+ return (RT_usb_endpoint_xfer_bulk(epd) && RT_usb_endpoint_dir_in(epd)); -+} -+ -+static inline int RT_usb_endpoint_is_bulk_out(const struct usb_endpoint_descriptor *epd) -+{ -+ return (RT_usb_endpoint_xfer_bulk(epd) && RT_usb_endpoint_dir_out(epd)); -+} -+ -+static inline int RT_usb_endpoint_is_int_in(const struct usb_endpoint_descriptor *epd) -+{ -+ return (RT_usb_endpoint_xfer_int(epd) && RT_usb_endpoint_dir_in(epd)); -+} -+ -+static inline int RT_usb_endpoint_num(const struct usb_endpoint_descriptor *epd) -+{ -+ return epd->bEndpointAddress & USB_ENDPOINT_NUMBER_MASK; -+} -+ -+static u8 rtw_init_intf_priv(struct dvobj_priv *dvobj) -+{ -+ u8 rst = _SUCCESS; -+ -+ #ifdef CONFIG_USB_VENDOR_REQ_MUTEX -+ _rtw_mutex_init(&dvobj->usb_vendor_req_mutex); -+ #endif -+ -+ -+ #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC -+ dvobj->usb_alloc_vendor_req_buf = rtw_zmalloc(MAX_USB_IO_CTL_SIZE); -+ if (dvobj->usb_alloc_vendor_req_buf == NULL) { -+ DBG_871X("alloc usb_vendor_req_buf failed... /n"); -+ rst = _FAIL; -+ goto exit; -+ } -+ dvobj->usb_vendor_req_buf = -+ (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(dvobj->usb_alloc_vendor_req_buf ), ALIGNMENT_UNIT); -+exit: -+ #endif -+ -+ return rst; -+ -+} -+ -+static u8 rtw_deinit_intf_priv(struct dvobj_priv *dvobj) -+{ -+ u8 rst = _SUCCESS; -+ -+ #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC -+ if(dvobj->usb_vendor_req_buf) -+ rtw_mfree(dvobj->usb_alloc_vendor_req_buf, MAX_USB_IO_CTL_SIZE); -+ #endif -+ -+ #ifdef CONFIG_USB_VENDOR_REQ_MUTEX -+ _rtw_mutex_free(&dvobj->usb_vendor_req_mutex); -+ #endif -+ -+ return rst; -+} -+ -+static struct dvobj_priv *usb_dvobj_init(struct usb_interface *usb_intf) -+{ -+ int i; -+ u8 val8; -+ int status = _FAIL; -+ struct dvobj_priv *pdvobjpriv; -+ struct usb_device_descriptor *pdev_desc; -+ struct usb_host_config *phost_conf; -+ struct usb_config_descriptor *pconf_desc; -+ struct usb_host_interface *phost_iface; -+ struct usb_interface_descriptor *piface_desc; -+ struct usb_host_endpoint *phost_endp; -+ struct usb_endpoint_descriptor *pendp_desc; -+ struct usb_device *pusbd; -+ -+ -+ -+ if ((pdvobjpriv = (struct dvobj_priv*)rtw_zmalloc(sizeof(*pdvobjpriv))) == NULL) { -+ goto exit; -+ } -+ -+ _rtw_mutex_init(&pdvobjpriv->hw_init_mutex); -+ _rtw_mutex_init(&pdvobjpriv->h2c_fwcmd_mutex); -+ _rtw_mutex_init(&pdvobjpriv->setch_mutex); -+ _rtw_mutex_init(&pdvobjpriv->setbw_mutex); -+ -+ _rtw_spinlock_init(&pdvobjpriv->lock); -+ -+ pdvobjpriv->macid[1] = true; //macid=1 for bc/mc stainfo -+ -+ -+ pdvobjpriv->pusbintf = usb_intf ; -+ pusbd = pdvobjpriv->pusbdev = interface_to_usbdev(usb_intf); -+ usb_set_intfdata(usb_intf, pdvobjpriv); -+ -+ pdvobjpriv->RtNumInPipes = 0; -+ pdvobjpriv->RtNumOutPipes = 0; -+ -+ //padapter->EepromAddressSize = 6; -+ //pdvobjpriv->nr_endpoint = 6; -+ -+ pdev_desc = &pusbd->descriptor; -+ -+#if 0 -+ DBG_871X("\n8712_usb_device_descriptor:\n"); -+ DBG_871X("bLength=%x\n", pdev_desc->bLength); -+ DBG_871X("bDescriptorType=%x\n", pdev_desc->bDescriptorType); -+ DBG_871X("bcdUSB=%x\n", pdev_desc->bcdUSB); -+ DBG_871X("bDeviceClass=%x\n", pdev_desc->bDeviceClass); -+ DBG_871X("bDeviceSubClass=%x\n", pdev_desc->bDeviceSubClass); -+ DBG_871X("bDeviceProtocol=%x\n", pdev_desc->bDeviceProtocol); -+ DBG_871X("bMaxPacketSize0=%x\n", pdev_desc->bMaxPacketSize0); -+ DBG_871X("idVendor=%x\n", pdev_desc->idVendor); -+ DBG_871X("idProduct=%x\n", pdev_desc->idProduct); -+ DBG_871X("bcdDevice=%x\n", pdev_desc->bcdDevice); -+ DBG_871X("iManufacturer=%x\n", pdev_desc->iManufacturer); -+ DBG_871X("iProduct=%x\n", pdev_desc->iProduct); -+ DBG_871X("iSerialNumber=%x\n", pdev_desc->iSerialNumber); -+ DBG_871X("bNumConfigurations=%x\n", pdev_desc->bNumConfigurations); -+#endif -+ -+ phost_conf = pusbd->actconfig; -+ pconf_desc = &phost_conf->desc; -+ -+#if 0 -+ DBG_871X("\n8712_usb_configuration_descriptor:\n"); -+ DBG_871X("bLength=%x\n", pconf_desc->bLength); -+ DBG_871X("bDescriptorType=%x\n", pconf_desc->bDescriptorType); -+ DBG_871X("wTotalLength=%x\n", pconf_desc->wTotalLength); -+ DBG_871X("bNumInterfaces=%x\n", pconf_desc->bNumInterfaces); -+ DBG_871X("bConfigurationValue=%x\n", pconf_desc->bConfigurationValue); -+ DBG_871X("iConfiguration=%x\n", pconf_desc->iConfiguration); -+ DBG_871X("bmAttributes=%x\n", pconf_desc->bmAttributes); -+ DBG_871X("bMaxPower=%x\n", pconf_desc->bMaxPower); -+#endif -+ -+ //DBG_871X("\n/****** num of altsetting = (%d) ******/\n", pusb_interface->num_altsetting); -+ -+ phost_iface = &usb_intf->altsetting[0]; -+ piface_desc = &phost_iface->desc; -+ -+#if 0 -+ DBG_871X("\n8712_usb_interface_descriptor:\n"); -+ DBG_871X("bLength=%x\n", piface_desc->bLength); -+ DBG_871X("bDescriptorType=%x\n", piface_desc->bDescriptorType); -+ DBG_871X("bInterfaceNumber=%x\n", piface_desc->bInterfaceNumber); -+ DBG_871X("bAlternateSetting=%x\n", piface_desc->bAlternateSetting); -+ DBG_871X("bNumEndpoints=%x\n", piface_desc->bNumEndpoints); -+ DBG_871X("bInterfaceClass=%x\n", piface_desc->bInterfaceClass); -+ DBG_871X("bInterfaceSubClass=%x\n", piface_desc->bInterfaceSubClass); -+ DBG_871X("bInterfaceProtocol=%x\n", piface_desc->bInterfaceProtocol); -+ DBG_871X("iInterface=%x\n", piface_desc->iInterface); -+#endif -+ -+ pdvobjpriv->NumInterfaces = pconf_desc->bNumInterfaces; -+ pdvobjpriv->InterfaceNumber = piface_desc->bInterfaceNumber; -+ pdvobjpriv->nr_endpoint = piface_desc->bNumEndpoints; -+ -+ //DBG_871X("\ndump usb_endpoint_descriptor:\n"); -+ -+ for (i = 0; i < pdvobjpriv->nr_endpoint; i++) -+ { -+ phost_endp = phost_iface->endpoint + i; -+ if (phost_endp) -+ { -+ pendp_desc = &phost_endp->desc; -+ -+ DBG_871X("\nusb_endpoint_descriptor(%d):\n", i); -+ DBG_871X("bLength=%x\n",pendp_desc->bLength); -+ DBG_871X("bDescriptorType=%x\n",pendp_desc->bDescriptorType); -+ DBG_871X("bEndpointAddress=%x\n",pendp_desc->bEndpointAddress); -+ //DBG_871X("bmAttributes=%x\n",pendp_desc->bmAttributes); -+ DBG_871X("wMaxPacketSize=%d\n",le16_to_cpu(pendp_desc->wMaxPacketSize)); -+ DBG_871X("bInterval=%x\n",pendp_desc->bInterval); -+ //DBG_871X("bRefresh=%x\n",pendp_desc->bRefresh); -+ //DBG_871X("bSynchAddress=%x\n",pendp_desc->bSynchAddress); -+ -+ if (RT_usb_endpoint_is_bulk_in(pendp_desc)) -+ { -+ DBG_871X("RT_usb_endpoint_is_bulk_in = %x\n", RT_usb_endpoint_num(pendp_desc)); -+ pdvobjpriv->RtInPipe[pdvobjpriv->RtNumInPipes] = RT_usb_endpoint_num(pendp_desc); -+ pdvobjpriv->RtNumInPipes++; -+ } -+ else if (RT_usb_endpoint_is_int_in(pendp_desc)) -+ { -+ DBG_871X("RT_usb_endpoint_is_int_in = %x, Interval = %x\n", RT_usb_endpoint_num(pendp_desc),pendp_desc->bInterval); -+ pdvobjpriv->RtInPipe[pdvobjpriv->RtNumInPipes] = RT_usb_endpoint_num(pendp_desc); -+ pdvobjpriv->RtNumInPipes++; -+ } -+ else if (RT_usb_endpoint_is_bulk_out(pendp_desc)) -+ { -+ DBG_871X("RT_usb_endpoint_is_bulk_out = %x\n", RT_usb_endpoint_num(pendp_desc)); -+ pdvobjpriv->RtOutPipe[pdvobjpriv->RtNumOutPipes] = RT_usb_endpoint_num(pendp_desc); -+ pdvobjpriv->RtNumOutPipes++; -+ } -+ pdvobjpriv->ep_num[i] = RT_usb_endpoint_num(pendp_desc); -+ } -+ } -+ -+ DBG_871X("nr_endpoint=%d, in_num=%d, out_num=%d\n\n", pdvobjpriv->nr_endpoint, pdvobjpriv->RtNumInPipes, pdvobjpriv->RtNumOutPipes); -+ -+ switch(pusbd->speed) { -+ case USB_SPEED_LOW: -+ DBG_871X("USB_SPEED_LOW\n"); -+ pdvobjpriv->usb_speed = RTW_USB_SPEED_1_1; -+ break; -+ case USB_SPEED_FULL: -+ DBG_871X("USB_SPEED_FULL\n"); -+ pdvobjpriv->usb_speed = RTW_USB_SPEED_1_1; -+ break; -+ case USB_SPEED_HIGH: -+ DBG_871X("USB_SPEED_HIGH\n"); -+ pdvobjpriv->usb_speed = RTW_USB_SPEED_2; -+ break; -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,31)) -+ case USB_SPEED_SUPER: -+ DBG_871X("USB_SPEED_SUPER\n"); -+ pdvobjpriv->usb_speed = RTW_USB_SPEED_3; -+ break; -+#endif -+ default: -+ DBG_871X("USB_SPEED_UNKNOWN(%x)\n",pusbd->speed); -+ pdvobjpriv->usb_speed = RTW_USB_SPEED_UNKNOWN; -+ break; -+ } -+ -+ if (pdvobjpriv->usb_speed == RTW_USB_SPEED_UNKNOWN) { -+ DBG_871X("UNKNOWN USB SPEED MODE, ERROR !!!\n"); -+ goto free_dvobj; -+ } -+ -+ if (rtw_init_intf_priv(pdvobjpriv) == _FAIL) { -+ RT_TRACE(_module_os_intfs_c_,_drv_err_,("\n Can't INIT rtw_init_intf_priv\n")); -+ goto free_dvobj; -+ } -+ -+ //.3 misc -+ _rtw_init_sema(&(pdvobjpriv->usb_suspend_sema), 0); -+ rtw_reset_continual_urb_error(pdvobjpriv); -+ -+ usb_get_dev(pusbd); -+ -+ status = _SUCCESS; -+ -+free_dvobj: -+ if (status != _SUCCESS && pdvobjpriv) { -+ usb_set_intfdata(usb_intf, NULL); -+ _rtw_spinlock_free(&pdvobjpriv->lock); -+ _rtw_mutex_free(&pdvobjpriv->hw_init_mutex); -+ _rtw_mutex_free(&pdvobjpriv->h2c_fwcmd_mutex); -+ _rtw_mutex_free(&pdvobjpriv->setch_mutex); -+ _rtw_mutex_free(&pdvobjpriv->setbw_mutex); -+ rtw_mfree((u8*)pdvobjpriv, sizeof(*pdvobjpriv)); -+ pdvobjpriv = NULL; -+ } -+exit: -+ -+ return pdvobjpriv; -+} -+ -+static void usb_dvobj_deinit(struct usb_interface *usb_intf) -+{ -+ struct dvobj_priv *dvobj = usb_get_intfdata(usb_intf); -+ -+ -+ -+ usb_set_intfdata(usb_intf, NULL); -+ if (dvobj) { -+ //Modify condition for 92DU DMDP 2010.11.18, by Thomas -+ if ((dvobj->NumInterfaces != 2 && dvobj->NumInterfaces != 3) -+ || (dvobj->InterfaceNumber == 1)) { -+ if (interface_to_usbdev(usb_intf)->state != USB_STATE_NOTATTACHED) { -+ //If we didn't unplug usb dongle and remove/insert modlue, driver fails on sitesurvey for the first time when device is up . -+ //Reset usb port for sitesurvey fail issue. 2009.8.13, by Thomas -+ DBG_871X("usb attached..., try to reset usb device\n"); -+ usb_reset_device(interface_to_usbdev(usb_intf)); -+ } -+ } -+ rtw_deinit_intf_priv(dvobj); -+ _rtw_spinlock_free(&dvobj->lock); -+ _rtw_mutex_free(&dvobj->hw_init_mutex); -+ _rtw_mutex_free(&dvobj->h2c_fwcmd_mutex); -+ _rtw_mutex_free(&dvobj->setch_mutex); -+ _rtw_mutex_free(&dvobj->setbw_mutex); -+ rtw_mfree((u8*)dvobj, sizeof(*dvobj)); -+ } -+ -+ //DBG_871X("%s %d\n", __func__, ATOMIC_READ(&usb_intf->dev.kobj.kref.refcount)); -+ usb_put_dev(interface_to_usbdev(usb_intf)); -+ -+ -+} -+ -+static void rtw_decide_chip_type_by_usb_info(_adapter *padapter, const struct usb_device_id *pdid) -+{ -+ padapter->chip_type = pdid->driver_info; -+ -+ if(padapter->chip_type == RTL8812 || padapter->chip_type == RTL8821) -+ rtl8812au_set_hw_type(padapter); -+} -+void rtw_set_hal_ops(_adapter *padapter) -+{ -+ if(padapter->chip_type == RTL8812 || padapter->chip_type == RTL8821) -+ rtl8812au_set_hal_ops(padapter); -+} -+ -+void usb_set_intf_ops(_adapter *padapter,struct _io_ops *pops) -+{ -+ if(padapter->chip_type == RTL8812 || padapter->chip_type == RTL8821) -+ rtl8812au_set_intf_ops(pops); -+} -+ -+static void usb_intf_start(_adapter *padapter) -+{ -+ -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("+usb_intf_start\n")); -+ -+ rtw_hal_inirp_init(padapter); -+ -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("-usb_intf_start\n")); -+ -+} -+ -+static void usb_intf_stop(_adapter *padapter) -+{ -+ -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("+usb_intf_stop\n")); -+ -+ //disabel_hw_interrupt -+ if(padapter->bSurpriseRemoved == false) -+ { -+ //device still exists, so driver can do i/o operation -+ //TODO: -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("SurpriseRemoved==false\n")); -+ } -+ -+ //cancel in irp -+ rtw_hal_inirp_deinit(padapter); -+ -+ //cancel out irp -+ rtw_write_port_cancel(padapter); -+ -+ //todo:cancel other irps -+ -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("-usb_intf_stop\n")); -+ -+} -+ -+static void rtw_dev_unload(_adapter *padapter) -+{ -+ struct net_device *pnetdev= (struct net_device*)padapter->pnetdev; -+ u8 val8; -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("+rtw_dev_unload\n")); -+ -+ if(padapter->bup == true) -+ { -+ DBG_871X("===> rtw_dev_unload\n"); -+ -+ padapter->bDriverStopped = true; -+ #ifdef CONFIG_XMIT_ACK -+ if (padapter->xmitpriv.ack_tx) -+ rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP); -+ #endif -+ -+ //s3. -+ if(padapter->intf_stop) -+ { -+ padapter->intf_stop(padapter); -+ } -+ -+ //s4. -+ if(!padapter->pwrctrlpriv.bInternalAutoSuspend ) -+ rtw_stop_drv_threads(padapter); -+ -+ -+ //s5. -+ if(padapter->bSurpriseRemoved == false) -+ { -+ //DBG_871X("r871x_dev_unload()->rtl871x_hal_deinit()\n"); -+#ifdef CONFIG_WOWLAN -+ if((padapter->pwrctrlpriv.bSupportRemoteWakeup==true)&&(padapter->pwrctrlpriv.wowlan_mode==true)){ -+ DBG_871X("%s bSupportWakeOnWlan==true do not run rtw_hal_deinit()\n",__FUNCTION__); -+ } -+ else -+#endif //CONFIG_WOWLAN -+ { -+ rtw_hal_deinit(padapter); -+ } -+ padapter->bSurpriseRemoved = true; -+ } -+ -+ padapter->bup = false; -+#ifdef CONFIG_WOWLAN -+ padapter->hw_init_completed=false; -+#endif //CONFIG_WOWLAN -+ } -+ else -+ { -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("r871x_dev_unload():padapter->bup == false\n" )); -+ } -+ -+ DBG_871X("<=== rtw_dev_unload\n"); -+ -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("-rtw_dev_unload\n")); -+ -+} -+ -+static void process_spec_devid(const struct usb_device_id *pdid) -+{ -+ u16 vid, pid; -+ u32 flags; -+ int i; -+ int num = sizeof(specific_device_id_tbl)/sizeof(struct specific_device_id); -+ -+ for(i=0; iidVendor==vid) && (pdid->idProduct==pid) && (flags&SPEC_DEV_ID_DISABLE_HT)) -+ { -+ rtw_ht_enable = 0; -+ rtw_bw_mode = 0; -+ rtw_ampdu_enable = 0; -+ } -+#endif -+ -+ } -+} -+ -+#ifdef SUPPORT_HW_RFOFF_DETECTED -+int rtw_hw_suspend(_adapter *padapter ) -+{ -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct usb_interface *pusb_intf = adapter_to_dvobj(padapter)->pusbintf; -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ -+ -+ if((!padapter->bup) || (padapter->bDriverStopped)||(padapter->bSurpriseRemoved)) -+ { -+ DBG_871X("padapter->bup=%d bDriverStopped=%d bSurpriseRemoved = %d\n", -+ padapter->bup, padapter->bDriverStopped,padapter->bSurpriseRemoved); -+ goto error_exit; -+ } -+ -+ if(padapter)//system suspend -+ { -+ LeaveAllPowerSaveMode(padapter); -+ -+ DBG_871X("==> rtw_hw_suspend\n"); -+ _enter_pwrlock(&pwrpriv->lock); -+ pwrpriv->bips_processing = true; -+ //padapter->net_closed = true; -+ //s1. -+ if(pnetdev) -+ { -+ netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ } -+ -+ //s2. -+ rtw_disassoc_cmd(padapter, 500, false); -+ -+ //s2-2. indicate disconnect to os -+ //rtw_indicate_disconnect(padapter); -+ { -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED)) -+ { -+ _clr_fwstate_(pmlmepriv, _FW_LINKED); -+ -+ rtw_led_control(padapter, LED_CTL_NO_LINK); -+ -+ rtw_os_indicate_disconnect(padapter); -+ -+ #ifdef CONFIG_LPS -+ //donnot enqueue cmd -+ rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, 0); -+ #endif -+ } -+ -+ } -+ //s2-3. -+ rtw_free_assoc_resources(padapter, 1); -+ -+ //s2-4. -+ rtw_free_network_queue(padapter,true); -+ #ifdef CONFIG_IPS -+ rtw_ips_dev_unload(padapter); -+ #endif -+ pwrpriv->rf_pwrstate = rf_off; -+ pwrpriv->bips_processing = false; -+ -+ _exit_pwrlock(&pwrpriv->lock); -+ } -+ else -+ goto error_exit; -+ -+ -+ return 0; -+ -+error_exit: -+ DBG_871X("%s, failed \n",__FUNCTION__); -+ return (-1); -+ -+} -+ -+int rtw_hw_resume(_adapter *padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct usb_interface *pusb_intf = adapter_to_dvobj(padapter)->pusbintf; -+ struct net_device *pnetdev = padapter->pnetdev; -+ -+ -+ -+ if(padapter)//system resume -+ { -+ DBG_871X("==> rtw_hw_resume\n"); -+ _enter_pwrlock(&pwrpriv->lock); -+ pwrpriv->bips_processing = true; -+ rtw_reset_drv_sw(padapter); -+ -+ if(pm_netdev_open(pnetdev,false) != 0) -+ { -+ _exit_pwrlock(&pwrpriv->lock); -+ goto error_exit; -+ } -+ -+ netif_device_attach(pnetdev); -+ netif_carrier_on(pnetdev); -+ -+ if(!rtw_netif_queue_stopped(pnetdev)) -+ rtw_netif_start_queue(pnetdev); -+ else -+ rtw_netif_wake_queue(pnetdev); -+ -+ pwrpriv->bkeepfwalive = false; -+ pwrpriv->brfoffbyhw = false; -+ -+ pwrpriv->rf_pwrstate = rf_on; -+ pwrpriv->bips_processing = false; -+ -+ _exit_pwrlock(&pwrpriv->lock); -+ } -+ else -+ { -+ goto error_exit; -+ } -+ -+ -+ -+ return 0; -+error_exit: -+ DBG_871X("%s, Open net dev failed \n",__FUNCTION__); -+ return (-1); -+} -+#endif -+ -+static int rtw_suspend(struct usb_interface *pusb_intf, pm_message_t message) -+{ -+ struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf); -+ _adapter *padapter = dvobj->if1; -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct usb_device *usb_dev = interface_to_usbdev(pusb_intf); -+#ifdef CONFIG_WOWLAN -+ struct wowlan_ioctl_param poidparam; -+#endif // CONFIG_WOWLAN -+ -+ int ret = 0; -+ u32 start_time = rtw_get_current_time(); -+ -+ -+ -+ DBG_871X("==> %s (%s:%d)\n",__FUNCTION__, current->comm, current->pid); -+ -+#ifdef CONFIG_WOWLAN -+ if (check_fwstate(pmlmepriv, _FW_LINKED)) -+ padapter->pwrctrlpriv.wowlan_mode = true; -+ else -+ padapter->pwrctrlpriv.wowlan_mode = false; -+#endif -+ -+ if((!padapter->bup) || (padapter->bDriverStopped)||(padapter->bSurpriseRemoved)) -+ { -+ DBG_871X("padapter->bup=%d bDriverStopped=%d bSurpriseRemoved = %d\n", -+ padapter->bup, padapter->bDriverStopped,padapter->bSurpriseRemoved); -+ goto exit; -+ } -+ -+ if(pwrpriv->bInternalAutoSuspend ) -+ { -+ #ifdef CONFIG_AUTOSUSPEND -+ #ifdef SUPPORT_HW_RFOFF_DETECTED -+ // The FW command register update must after MAC and FW init ready. -+ if((padapter->bFWReady) && ( padapter->pwrctrlpriv.bHWPwrPindetect ) && (padapter->registrypriv.usbss_enable )) -+ { -+ u8 bOpen = true; -+ rtw_interface_ps_func(padapter,HAL_USB_SELECT_SUSPEND,&bOpen); -+ //rtl8192c_set_FwSelectSuspend_cmd(padapter,true ,500);//note fw to support hw power down ping detect -+ } -+ #endif -+ #endif -+ } -+ pwrpriv->bInSuspend = true; -+ rtw_cancel_all_timer(padapter); -+ LeaveAllPowerSaveMode(padapter); -+ -+ _enter_pwrlock(&pwrpriv->lock); -+ //padapter->net_closed = true; -+ //s1. -+ if(pnetdev) -+ { -+ netif_carrier_off(pnetdev); -+ rtw_netif_stop_queue(pnetdev); -+ } -+ -+#ifdef CONFIG_WOWLAN -+ if(padapter->pwrctrlpriv.bSupportRemoteWakeup==true&&padapter->pwrctrlpriv.wowlan_mode==true){ -+ //set H2C command -+ poidparam.subcode=WOWLAN_ENABLE; -+ padapter->HalFunc.SetHwRegHandler(padapter,HW_VAR_WOWLAN,(u8 *)&poidparam); -+ } -+ else -+#else -+ { -+ //s2. -+ rtw_disassoc_cmd(padapter, 0, false); -+ } -+#endif //CONFIG_WOWLAN -+ -+#ifdef CONFIG_LAYER2_ROAMING_RESUME -+ if(check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, _FW_LINKED) ) -+ { -+ //DBG_871X("%s:%d assoc_ssid:%s\n", __FUNCTION__, __LINE__, pmlmepriv->assoc_ssid.Ssid); -+ DBG_871X("%s:%d %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n",__FUNCTION__, __LINE__, -+ pmlmepriv->cur_network.network.Ssid.Ssid, -+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress), -+ pmlmepriv->cur_network.network.Ssid.SsidLength, -+ pmlmepriv->assoc_ssid.SsidLength); -+ -+ rtw_set_roaming(padapter, 1); -+ } -+#endif -+ //s2-2. indicate disconnect to os -+ rtw_indicate_disconnect(padapter); -+ //s2-3. -+ rtw_free_assoc_resources(padapter, 1); -+#ifdef CONFIG_AUTOSUSPEND -+ if(!pwrpriv->bInternalAutoSuspend ) -+#endif -+ //s2-4. -+ rtw_free_network_queue(padapter, true); -+ -+ rtw_dev_unload(padapter); -+#ifdef CONFIG_AUTOSUSPEND -+ pwrpriv->rf_pwrstate = rf_off; -+ pwrpriv->bips_processing = false; -+#endif -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ if(check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) -+ rtw_indicate_scan_done(padapter, 1); -+ -+ if(check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) -+ rtw_indicate_disconnect(padapter); -+ -+exit: -+ DBG_871X("<=== %s return %d.............. in %dms\n", __FUNCTION__ -+ , ret, rtw_get_passing_time_ms(start_time)); -+ -+ -+ return ret; -+} -+ -+static int rtw_resume(struct usb_interface *pusb_intf) -+{ -+ struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf); -+ _adapter *padapter = dvobj->if1; -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ int ret = 0; -+ -+ if(pwrpriv->bInternalAutoSuspend ){ -+ ret = rtw_resume_process(padapter); -+ } else { -+#ifdef CONFIG_RESUME_IN_WORKQUEUE -+ rtw_resume_in_workqueue(pwrpriv); -+#else -+ if (rtw_is_earlysuspend_registered(pwrpriv) -+ #ifdef CONFIG_WOWLAN -+ && !padapter->pwrctrlpriv.wowlan_mode -+ #endif /* CONFIG_WOWLAN */ -+ ) { -+ /* jeff: bypass resume here, do in late_resume */ -+ rtw_set_do_late_resume(pwrpriv, true); -+ } else { -+ ret = rtw_resume_process(padapter); -+ } -+#endif /* CONFIG_RESUME_IN_WORKQUEUE */ -+ } -+ -+ return ret; -+ -+} -+ -+int rtw_resume_process(_adapter *padapter) -+{ -+ struct net_device *pnetdev; -+ struct pwrctrl_priv *pwrpriv; -+ int ret = -1; -+ u32 start_time = rtw_get_current_time(); -+#ifdef CONFIG_BT_COEXIST -+ u8 pm_cnt; -+#endif //#ifdef CONFIG_BT_COEXIST -+ -+ -+ DBG_871X("==> %s (%s:%d)\n",__FUNCTION__, current->comm, current->pid); -+ -+ if(padapter) { -+ pnetdev= padapter->pnetdev; -+ pwrpriv = &padapter->pwrctrlpriv; -+ } else { -+ goto exit; -+ } -+ -+ _enter_pwrlock(&pwrpriv->lock); -+#ifdef CONFIG_BT_COEXIST -+#ifdef CONFIG_AUTOSUSPEND -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,32)) -+ DBG_871X("%s...pm_usage_cnt(%d) pwrpriv->bAutoResume=%x. ....\n",__func__,atomic_read(&(adapter_to_dvobj(padapter)->pusbintf->pm_usage_cnt)),pwrpriv->bAutoResume); -+ pm_cnt=atomic_read(&(adapter_to_dvobj(padapter)->pusbintf->pm_usage_cnt)); -+ #else -+ DBG_871X("...pm_usage_cnt(%d).....\n", adapter_to_dvobj(padapter)->pusbintf->pm_usage_cnt); -+ pm_cnt = adapter_to_dvobj(padapter)->pusbintf->pm_usage_cnt; -+ #endif -+ -+ DBG_871X("pwrpriv->bAutoResume (%x)\n",pwrpriv->bAutoResume ); -+ if( true == pwrpriv->bAutoResume ){ -+ pwrpriv->bInternalAutoSuspend = false; -+ pwrpriv->bAutoResume=false; -+ DBG_871X("pwrpriv->bAutoResume (%x) pwrpriv->bInternalAutoSuspend(%x)\n",pwrpriv->bAutoResume,pwrpriv->bInternalAutoSuspend ); -+ -+ } -+#endif //#ifdef CONFIG_AUTOSUSPEND -+#endif //#ifdef CONFIG_BT_COEXIST -+ rtw_reset_drv_sw(padapter); -+ pwrpriv->bkeepfwalive = false; -+ -+ DBG_871X("bkeepfwalive(%x)\n",pwrpriv->bkeepfwalive); -+ if(pm_netdev_open(pnetdev,true) != 0){ -+ _exit_pwrlock(&pwrpriv->lock); -+ goto exit; -+ } -+ -+ netif_device_attach(pnetdev); -+ netif_carrier_on(pnetdev); -+ -+#ifdef CONFIG_AUTOSUSPEND -+ if(pwrpriv->bInternalAutoSuspend ) -+ { -+ #ifdef CONFIG_AUTOSUSPEND -+ #ifdef SUPPORT_HW_RFOFF_DETECTED -+ // The FW command register update must after MAC and FW init ready. -+ if((padapter->bFWReady) && ( padapter->pwrctrlpriv.bHWPwrPindetect ) && (padapter->registrypriv.usbss_enable )) -+ { -+ //rtl8192c_set_FwSelectSuspend_cmd(padapter,false ,500);//note fw to support hw power down ping detect -+ u8 bOpen = false; -+ rtw_interface_ps_func(padapter,HAL_USB_SELECT_SUSPEND,&bOpen); -+ } -+ #endif -+ #endif -+#ifdef CONFIG_BT_COEXIST -+ DBG_871X("pwrpriv->bAutoResume (%x)\n",pwrpriv->bAutoResume ); -+ if( true == pwrpriv->bAutoResume ){ -+ pwrpriv->bInternalAutoSuspend = false; -+ pwrpriv->bAutoResume=false; -+ DBG_871X("pwrpriv->bAutoResume (%x) pwrpriv->bInternalAutoSuspend(%x)\n",pwrpriv->bAutoResume,pwrpriv->bInternalAutoSuspend ); -+ } -+ -+#else //#ifdef CONFIG_BT_COEXIST -+ pwrpriv->bInternalAutoSuspend = false; -+#endif //#ifdef CONFIG_BT_COEXIST -+ pwrpriv->brfoffbyhw = false; -+ { -+ DBG_871X("enc_algorithm(%x),wepkeymask(%x)\n", -+ padapter->securitypriv.dot11PrivacyAlgrthm,pwrpriv->wepkeymask); -+ if( (_WEP40_ == padapter->securitypriv.dot11PrivacyAlgrthm) || -+ (_WEP104_ == padapter->securitypriv.dot11PrivacyAlgrthm)) -+ { -+ sint keyid; -+ -+ for(keyid=0;keyid<4;keyid++){ -+ if(pwrpriv->wepkeymask & BIT(keyid)) { -+ if(keyid == padapter->securitypriv.dot11PrivacyKeyIndex) -+ rtw_set_key(padapter,&padapter->securitypriv, keyid, 1); -+ else -+ rtw_set_key(padapter,&padapter->securitypriv, keyid, 0); -+ } -+ } -+ } -+ } -+ } -+#endif -+ _exit_pwrlock(&pwrpriv->lock); -+ -+ if( padapter->pid[1]!=0) { -+ DBG_871X("pid[1]:%d\n",padapter->pid[1]); -+ rtw_signal_process(padapter->pid[1], SIGUSR2); -+ } -+ -+ #ifdef CONFIG_LAYER2_ROAMING_RESUME -+ rtw_roaming(padapter, NULL); -+ #endif -+ -+ ret = 0; -+exit: -+ #ifdef CONFIG_RESUME_IN_WORKQUEUE -+ rtw_unlock_suspend(); -+ #endif //CONFIG_RESUME_IN_WORKQUEUE -+ -+ pwrpriv->bInSuspend = false; -+ DBG_871X("<=== %s return %d.............. in %dms\n", __FUNCTION__ -+ , ret, rtw_get_passing_time_ms(start_time)); -+ -+ -+ -+ return ret; -+} -+ -+#ifdef CONFIG_AUTOSUSPEND -+void autosuspend_enter(_adapter* padapter) -+{ -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ DBG_871X("==>autosuspend_enter...........\n"); -+ -+ pwrpriv->bInternalAutoSuspend = true; -+ pwrpriv->bips_processing = true; -+ -+ if(rf_off == pwrpriv->change_rfpwrstate ) -+ { -+#ifndef CONFIG_BT_COEXIST -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ usb_enable_autosuspend(dvobj->pusbdev); -+ #else -+ dvobj->pusbdev->autosuspend_disabled = 0;//autosuspend disabled by the user -+ #endif -+ -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,33)) -+ usb_autopm_put_interface(dvobj->pusbintf); -+ #elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,20)) -+ usb_autopm_enable(dvobj->pusbintf); -+ #else -+ usb_autosuspend_device(dvobj->pusbdev, 1); -+ #endif -+#else //#ifndef CONFIG_BT_COEXIST -+ if(1==pwrpriv->autopm_cnt){ -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ usb_enable_autosuspend(dvobj->pusbdev); -+ #else -+ dvobj->pusbdev->autosuspend_disabled = 0;//autosuspend disabled by the user -+ #endif -+ -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,33)) -+ usb_autopm_put_interface(dvobj->pusbintf); -+ #elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,20)) -+ usb_autopm_enable(dvobj->pusbintf); -+ #else -+ usb_autosuspend_device(dvobj->pusbdev, 1); -+ #endif -+ pwrpriv->autopm_cnt --; -+ } -+ else -+ DBG_871X("0!=pwrpriv->autopm_cnt[%d] didn't usb_autopm_put_interface\n", pwrpriv->autopm_cnt); -+ -+#endif //#ifndef CONFIG_BT_COEXIST -+ } -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,32)) -+ DBG_871X("...pm_usage_cnt(%d).....\n", atomic_read(&(dvobj->pusbintf->pm_usage_cnt))); -+ #else -+ DBG_871X("...pm_usage_cnt(%d).....\n", dvobj->pusbintf->pm_usage_cnt); -+ #endif -+ -+} -+int autoresume_enter(_adapter* padapter) -+{ -+ int result = _SUCCESS; -+ struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv; -+ struct security_priv* psecuritypriv=&(padapter->securitypriv); -+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -+ struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); -+ -+ DBG_871X("====> autoresume_enter \n"); -+ -+ if(rf_off == pwrpriv->rf_pwrstate ) -+ { -+ pwrpriv->ps_flag = false; -+#ifndef CONFIG_BT_COEXIST -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,33)) -+ if (usb_autopm_get_interface(dvobj->pusbintf) < 0) -+ { -+ DBG_871X( "can't get autopm: %d\n", result); -+ result = _FAIL; -+ goto error_exit; -+ } -+ #elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,20)) -+ usb_autopm_disable(dvobj->pusbintf); -+ #else -+ usb_autoresume_device(dvobj->pusbdev, 1); -+ #endif -+ -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,32)) -+ DBG_871X("...pm_usage_cnt(%d).....\n", atomic_read(&(dvobj->pusbintf->pm_usage_cnt))); -+ #else -+ DBG_871X("...pm_usage_cnt(%d).....\n", dvobj->pusbintf->pm_usage_cnt); -+ #endif -+#else //#ifndef CONFIG_BT_COEXIST -+ pwrpriv->bAutoResume=true; -+ if(0==pwrpriv->autopm_cnt){ -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,33)) -+ if (usb_autopm_get_interface(dvobj->pusbintf) < 0) -+ { -+ DBG_871X( "can't get autopm: %d\n", result); -+ result = _FAIL; -+ goto error_exit; -+ } -+ #elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,20)) -+ usb_autopm_disable(dvobj->pusbintf); -+ #else -+ usb_autoresume_device(dvobj->pusbdev, 1); -+ #endif -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,32)) -+ DBG_871X("...pm_usage_cnt(%d).....\n", atomic_read(&(dvobj->pusbintf->pm_usage_cnt))); -+ #else -+ DBG_871X("...pm_usage_cnt(%d).....\n", dvobj->pusbintf->pm_usage_cnt); -+ #endif -+ pwrpriv->autopm_cnt++; -+ } -+ else -+ DBG_871X("0!=pwrpriv->autopm_cnt[%d] didn't usb_autopm_get_interface\n",pwrpriv->autopm_cnt); -+#endif //#ifndef CONFIG_BT_COEXIST -+ } -+ DBG_871X("<==== autoresume_enter \n"); -+error_exit: -+ -+ return result; -+} -+#endif -+ -+/* -+ * drv_init() - a device potentially for us -+ * -+ * notes: drv_init() is called when the bus driver has located a card for us to support. -+ * We accept the new device by returning 0. -+*/ -+ -+_adapter *rtw_sw_export = NULL; -+ -+_adapter *rtw_usb_if1_init(struct dvobj_priv *dvobj, -+ struct usb_interface *pusb_intf, const struct usb_device_id *pdid) -+{ -+ _adapter *padapter = NULL; -+ struct net_device *pnetdev = NULL; -+ int status = _FAIL; -+ -+ if ((padapter = (_adapter *)rtw_zvmalloc(sizeof(*padapter))) == NULL) { -+ goto exit; -+ } -+ padapter->dvobj = dvobj; -+ dvobj->if1 = padapter; -+ -+ padapter->bDriverStopped=true; -+ -+ dvobj->padapters[dvobj->iface_nums++] = padapter; -+ padapter->iface_id = IFACE_ID0; -+ -+#if defined(CONFIG_CONCURRENT_MODE) || defined(CONFIG_DUALMAC_CONCURRENT) -+ //set adapter_type/iface type for primary padapter -+ padapter->isprimary = true; -+ padapter->adapter_type = PRIMARY_ADAPTER; -+ #ifndef CONFIG_HWPORT_SWAP -+ padapter->iface_type = IFACE_PORT0; -+ #else -+ padapter->iface_type = IFACE_PORT1; -+ #endif -+#endif -+ -+ //step 1-1., decide the chip_type via driver_info -+ padapter->interface_type = RTW_USB; -+ rtw_decide_chip_type_by_usb_info(padapter, pdid); -+ -+ if (rtw_handle_dualmac(padapter, 1) != _SUCCESS) -+ goto free_adapter; -+ -+ if((pnetdev = rtw_init_netdev(padapter)) == NULL) { -+ goto handle_dualmac; -+ } -+ SET_NETDEV_DEV(pnetdev, dvobj_to_dev(dvobj)); -+ padapter = rtw_netdev_priv(pnetdev); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(rtw_wdev_alloc(padapter, dvobj_to_dev(dvobj)) != 0) { -+ goto handle_dualmac; -+ } -+#endif -+ -+ //step 2. hook HalFunc, allocate HalData -+ //hal_set_hal_ops(padapter); -+ rtw_set_hal_ops(padapter); -+ -+ padapter->intf_start=&usb_intf_start; -+ padapter->intf_stop=&usb_intf_stop; -+ -+ //step init_io_priv -+ rtw_init_io_priv(padapter,usb_set_intf_ops); -+ -+ //step read_chip_version -+ rtw_hal_read_chip_version(padapter); -+ -+ //step usb endpoint mapping -+ rtw_hal_chip_configure(padapter); -+ -+ //step read efuse/eeprom data and get mac_addr -+ rtw_hal_read_chip_info(padapter); -+ -+ //step 5. -+ if(rtw_init_drv_sw(padapter) ==_FAIL) { -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("Initialize driver software resource Failed!\n")); -+ goto free_hal_data; -+ } -+ -+#ifdef CONFIG_PM -+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,18)) -+ if(padapter->pwrctrlpriv.bSupportRemoteWakeup) -+ { -+ dvobj->pusbdev->do_remote_wakeup=1; -+ pusb_intf->needs_remote_wakeup = 1; -+ device_init_wakeup(&pusb_intf->dev, 1); -+ DBG_871X("\n padapter->pwrctrlpriv.bSupportRemoteWakeup~~~~~~\n"); -+ DBG_871X("\n padapter->pwrctrlpriv.bSupportRemoteWakeup~~~[%d]~~~\n",device_may_wakeup(&pusb_intf->dev)); -+ } -+#endif -+#endif -+ -+#ifdef CONFIG_AUTOSUSPEND -+ if( padapter->registrypriv.power_mgnt != PS_MODE_ACTIVE ) -+ { -+ if(padapter->registrypriv.usbss_enable ){ /* autosuspend (2s delay) */ -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,38)) -+ dvobj->pusbdev->dev.power.autosuspend_delay = 0 * HZ;//15 * HZ; idle-delay time -+ #else -+ dvobj->pusbdev->autosuspend_delay = 0 * HZ;//15 * HZ; idle-delay time -+ #endif -+ -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ usb_enable_autosuspend(dvobj->pusbdev); -+ #elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,22) && LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,34)) -+ padapter->bDisableAutosuspend = dvobj->pusbdev->autosuspend_disabled ; -+ dvobj->pusbdev->autosuspend_disabled = 0;//autosuspend disabled by the user -+ #endif -+ -+ //usb_autopm_get_interface(adapter_to_dvobj(padapter)->pusbintf );//init pm_usage_cnt ,let it start from 1 -+ -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,32)) -+ DBG_871X("%s...pm_usage_cnt(%d).....\n",__FUNCTION__,atomic_read(&(dvobj->pusbintf ->pm_usage_cnt))); -+ #else -+ DBG_871X("%s...pm_usage_cnt(%d).....\n",__FUNCTION__,dvobj->pusbintf ->pm_usage_cnt); -+ #endif -+ } -+ } -+#endif -+ //2012-07-11 Move here to prevent the 8723AS-VAU BT auto suspend influence -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,33)) -+ if (usb_autopm_get_interface(pusb_intf) < 0) -+ { -+ DBG_871X( "can't get autopm: \n"); -+ } -+ #endif -+#ifdef CONFIG_BT_COEXIST -+ padapter->pwrctrlpriv.autopm_cnt=1; -+#endif -+ -+ // set mac addr -+ rtw_macaddr_cfg(padapter->eeprompriv.mac_addr); -+ rtw_init_wifidirect_addrs(padapter, padapter->eeprompriv.mac_addr, padapter->eeprompriv.mac_addr); -+ -+ DBG_871X("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n" -+ , padapter->bDriverStopped -+ , padapter->bSurpriseRemoved -+ , padapter->bup -+ , padapter->hw_init_completed -+ ); -+ -+ status = _SUCCESS; -+ -+free_hal_data: -+ if(status != _SUCCESS && padapter->HalData) -+ rtw_mfree(padapter->HalData, sizeof(*(padapter->HalData))); -+free_wdev: -+ if(status != _SUCCESS) { -+ #ifdef CONFIG_IOCTL_CFG80211 -+ rtw_wdev_unregister(padapter->rtw_wdev); -+ rtw_wdev_free(padapter->rtw_wdev); -+ #endif -+ } -+handle_dualmac: -+ if (status != _SUCCESS) -+ rtw_handle_dualmac(padapter, 0); -+free_adapter: -+ if (status != _SUCCESS) { -+ if (pnetdev) -+ rtw_free_netdev(pnetdev); -+ else if (padapter) -+ rtw_vmfree((u8*)padapter, sizeof(*padapter)); -+ padapter = NULL; -+ } -+exit: -+ return padapter; -+} -+ -+static void rtw_usb_if1_deinit(_adapter *if1) -+{ -+ struct net_device *pnetdev = if1->pnetdev; -+ struct mlme_priv *pmlmepriv= &if1->mlmepriv; -+ -+ if(check_fwstate(pmlmepriv, _FW_LINKED)) -+ rtw_disassoc_cmd(if1, 0, false); -+ -+ -+#ifdef CONFIG_AP_MODE -+ free_mlme_ap_info(if1); -+ #ifdef CONFIG_HOSTAPD_MLME -+ hostapd_mode_unload(if1); -+ #endif -+#endif -+ -+ if(if1->DriverState != DRIVER_DISAPPEAR) { -+ if(pnetdev) { -+ unregister_netdev(pnetdev); //will call netdev_close() -+ rtw_proc_remove_one(pnetdev); -+ } -+ } -+ -+ rtw_cancel_all_timer(if1); -+ -+#ifdef CONFIG_WOWLAN -+ if1->pwrctrlpriv.wowlan_mode=false; -+#endif //CONFIG_WOWLAN -+ -+ rtw_dev_unload(if1); -+ -+ DBG_871X("+r871xu_dev_remove, hw_init_completed=%d\n", if1->hw_init_completed); -+ -+ rtw_handle_dualmac(if1, 0); -+ -+#ifdef CONFIG_IOCTL_CFG80211 -+ if(if1->rtw_wdev) -+ { -+ rtw_wdev_unregister(if1->rtw_wdev); -+ rtw_wdev_free(if1->rtw_wdev); -+ } -+#endif -+ -+#ifdef CONFIG_BT_COEXIST -+ if(1 == if1->pwrctrlpriv.autopm_cnt){ -+ #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,33)) -+ usb_autopm_put_interface(adapter_to_dvobj(if1)->pusbintf); -+ #elif (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,20)) -+ usb_autopm_enable(adapter_to_dvobj(if1)->pusbintf); -+ #else -+ usb_autosuspend_device(adapter_to_dvobj(if1)->pusbdev, 1); -+ #endif -+ if1->pwrctrlpriv.autopm_cnt --; -+ } -+#endif -+ -+ rtw_free_drv_sw(if1); -+ -+ if(pnetdev) -+ rtw_free_netdev(pnetdev); -+} -+ -+static void dump_usb_interface(struct usb_interface *usb_intf) -+{ -+ int i; -+ u8 val8; -+ -+ struct usb_device *udev = interface_to_usbdev(usb_intf); -+ struct usb_device_descriptor *dev_desc = &udev->descriptor; -+ -+ struct usb_host_config *act_conf = udev->actconfig; -+ struct usb_config_descriptor *act_conf_desc = &act_conf->desc; -+ -+ struct usb_host_interface *host_iface; -+ struct usb_interface_descriptor *iface_desc; -+ struct usb_host_endpoint *host_endp; -+ struct usb_endpoint_descriptor *endp_desc; -+ -+#if 1 /* The usb device this usb interface belongs to */ -+ DBG_871X("usb_interface:%p, usb_device:%p(num:%d, path:%s), usb_device_descriptor:%p\n", usb_intf, udev, udev->devnum, udev->devpath, dev_desc); -+ DBG_871X("bLength:%u\n", dev_desc->bLength); -+ DBG_871X("bDescriptorType:0x%02x\n", dev_desc->bDescriptorType); -+ DBG_871X("bcdUSB:0x%04x\n", le16_to_cpu(dev_desc->bcdUSB)); -+ DBG_871X("bDeviceClass:0x%02x\n", dev_desc->bDeviceClass); -+ DBG_871X("bDeviceSubClass:0x%02x\n", dev_desc->bDeviceSubClass); -+ DBG_871X("bDeviceProtocol:0x%02x\n", dev_desc->bDeviceProtocol); -+ DBG_871X("bMaxPacketSize0:%u\n", dev_desc->bMaxPacketSize0); -+ DBG_871X("idVendor:0x%04x\n", le16_to_cpu(dev_desc->idVendor)); -+ DBG_871X("idProduct:0x%04x\n", le16_to_cpu(dev_desc->idProduct)); -+ DBG_871X("bcdDevice:0x%04x\n", le16_to_cpu(dev_desc->bcdDevice)); -+ DBG_871X("iManufacturer:0x02%x\n", dev_desc->iManufacturer); -+ DBG_871X("iProduct:0x%02x\n", dev_desc->iProduct); -+ DBG_871X("iSerialNumber:0x%02x\n", dev_desc->iSerialNumber); -+ DBG_871X("bNumConfigurations:%u\n", dev_desc->bNumConfigurations); -+#endif -+ -+ -+#if 1 /* The acting usb_config_descriptor */ -+ DBG_871X("\nact_conf_desc:%p\n", act_conf_desc); -+ DBG_871X("bLength:%u\n", act_conf_desc->bLength); -+ DBG_871X("bDescriptorType:0x%02x\n", act_conf_desc->bDescriptorType); -+ DBG_871X("wTotalLength:%u\n", le16_to_cpu(act_conf_desc->wTotalLength)); -+ DBG_871X("bNumInterfaces:%u\n", act_conf_desc->bNumInterfaces); -+ DBG_871X("bConfigurationValue:0x%02x\n", act_conf_desc->bConfigurationValue); -+ DBG_871X("iConfiguration:0x%02x\n", act_conf_desc->iConfiguration); -+ DBG_871X("bmAttributes:0x%02x\n", act_conf_desc->bmAttributes); -+ DBG_871X("bMaxPower=%u\n", act_conf_desc->bMaxPower); -+#endif -+ -+ -+ DBG_871X("****** num of altsetting = (%d) ******/\n", usb_intf->num_altsetting); -+ /* Get he host side alternate setting (the current alternate setting) for this interface*/ -+ host_iface = usb_intf->cur_altsetting; -+ iface_desc = &host_iface->desc; -+ -+#if 1 /* The current alternate setting*/ -+ DBG_871X("\nusb_interface_descriptor:%p:\n", iface_desc); -+ DBG_871X("bLength:%u\n", iface_desc->bLength); -+ DBG_871X("bDescriptorType:0x%02x\n", iface_desc->bDescriptorType); -+ DBG_871X("bInterfaceNumber:0x%02x\n", iface_desc->bInterfaceNumber); -+ DBG_871X("bAlternateSetting=%x\n", iface_desc->bAlternateSetting); -+ DBG_871X("bNumEndpoints=%x\n", iface_desc->bNumEndpoints); -+ DBG_871X("bInterfaceClass=%x\n", iface_desc->bInterfaceClass); -+ DBG_871X("bInterfaceSubClass=%x\n", iface_desc->bInterfaceSubClass); -+ DBG_871X("bInterfaceProtocol=%x\n", iface_desc->bInterfaceProtocol); -+ DBG_871X("iInterface=%x\n", iface_desc->iInterface); -+#endif -+ -+ -+#if 1 -+ //DBG_871X("\ndump usb_endpoint_descriptor:\n"); -+ -+ for (i = 0; i < iface_desc->bNumEndpoints; i++) -+ { -+ host_endp = host_iface->endpoint + i; -+ if (host_endp) -+ { -+ endp_desc = &host_endp->desc; -+ -+ DBG_871X("\nusb_endpoint_descriptor(%d):\n", i); -+ DBG_871X("bLength=%x\n",endp_desc->bLength); -+ DBG_871X("bDescriptorType=%x\n",endp_desc->bDescriptorType); -+ DBG_871X("bEndpointAddress=%x\n",endp_desc->bEndpointAddress); -+ DBG_871X("bmAttributes=%x\n",endp_desc->bmAttributes); -+ DBG_871X("wMaxPacketSize=%x\n",endp_desc->wMaxPacketSize); -+ DBG_871X("wMaxPacketSize=%x\n",le16_to_cpu(endp_desc->wMaxPacketSize)); -+ DBG_871X("bInterval=%x\n",endp_desc->bInterval); -+ //DBG_871X("bRefresh=%x\n",pendp_desc->bRefresh); -+ //DBG_871X("bSynchAddress=%x\n",pendp_desc->bSynchAddress); -+ -+ if (RT_usb_endpoint_is_bulk_in(endp_desc)) -+ { -+ DBG_871X("RT_usb_endpoint_is_bulk_in = %x\n", RT_usb_endpoint_num(endp_desc)); -+ //pdvobjpriv->RtNumInPipes++; -+ } -+ else if (RT_usb_endpoint_is_int_in(endp_desc)) -+ { -+ DBG_871X("RT_usb_endpoint_is_int_in = %x, Interval = %x\n", RT_usb_endpoint_num(endp_desc),endp_desc->bInterval); -+ //pdvobjpriv->RtNumInPipes++; -+ } -+ else if (RT_usb_endpoint_is_bulk_out(endp_desc)) -+ { -+ DBG_871X("RT_usb_endpoint_is_bulk_out = %x\n", RT_usb_endpoint_num(endp_desc)); -+ //pdvobjpriv->RtNumOutPipes++; -+ } -+ //pdvobjpriv->ep_num[i] = RT_usb_endpoint_num(pendp_desc); -+ } -+ } -+ -+ //DBG_871X("nr_endpoint=%d, in_num=%d, out_num=%d\n\n", pdvobjpriv->nr_endpoint, pdvobjpriv->RtNumInPipes, pdvobjpriv->RtNumOutPipes); -+#endif -+ -+ if (udev->speed == USB_SPEED_HIGH) -+ DBG_871X("USB_SPEED_HIGH\n"); -+ else -+ DBG_871X("NON USB_SPEED_HIGH\n"); -+ -+} -+ -+ -+static int rtw_drv_init(struct usb_interface *pusb_intf, const struct usb_device_id *pdid) -+{ -+ _adapter *if1 = NULL, *if2 = NULL; -+ int status; -+ struct dvobj_priv *dvobj; -+#ifdef CONFIG_MULTI_VIR_IFACES -+ int i; -+#endif //CONFIG_MULTI_VIR_IFACES -+ -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("+rtw_drv_init\n")); -+ //DBG_871X("+rtw_drv_init\n"); -+ -+ //step 0. -+ process_spec_devid(pdid); -+ -+ /* Initialize dvobj_priv */ -+ if ((dvobj = usb_dvobj_init(pusb_intf)) == NULL) { -+ RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("initialize device object priv Failed!\n")); -+ goto exit; -+ } -+ -+ if ((if1 = rtw_usb_if1_init(dvobj, pusb_intf, pdid)) == NULL) { -+ DBG_871X("rtw_usb_if1_init Failed!\n"); -+ goto free_dvobj; -+ } -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if((if2 = rtw_drv_if2_init(if1, usb_set_intf_ops)) == NULL) { -+ goto free_if1; -+ } -+#ifdef CONFIG_MULTI_VIR_IFACES -+ for(i=0; iregistrypriv.ext_iface_num;i++) -+ { -+ if(rtw_drv_add_vir_if(if1, usb_set_intf_ops) == NULL) -+ { -+ DBG_871X("rtw_drv_add_iface failed! (%d)\n", i); -+ goto free_if2; -+ } -+ } -+#endif //CONFIG_MULTI_VIR_IFACES -+#endif -+ -+#ifdef CONFIG_INTEL_PROXIM -+ rtw_sw_export=if1; -+#endif -+ -+#ifdef CONFIG_GLOBAL_UI_PID -+ if(ui_pid[1]!=0) { -+ DBG_871X("ui_pid[1]:%d\n",ui_pid[1]); -+ rtw_signal_process(ui_pid[1], SIGUSR2); -+ } -+#endif -+ -+ //dev_alloc_name && register_netdev -+ if((status = rtw_drv_register_netdev(if1)) != _SUCCESS) { -+ goto free_if2; -+ } -+ -+#ifdef CONFIG_HOSTAPD_MLME -+ hostapd_mode_init(if1); -+#endif -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("-871x_drv - drv_init, success!\n")); -+ -+ status = _SUCCESS; -+ -+free_if2: -+ if(status != _SUCCESS && if2) { -+ #ifdef CONFIG_CONCURRENT_MODE -+ rtw_drv_if2_stop(if2); -+ rtw_drv_if2_free(if2); -+ #endif -+ } -+free_if1: -+ if (status != _SUCCESS && if1) { -+ rtw_usb_if1_deinit(if1); -+ } -+free_dvobj: -+ if (status != _SUCCESS) -+ usb_dvobj_deinit(pusb_intf); -+exit: -+ return status == _SUCCESS?0:-ENODEV; -+} -+ -+/* -+ * dev_remove() - our device is being removed -+*/ -+//rmmod module & unplug(SurpriseRemoved) will call r871xu_dev_remove() => how to recognize both -+static void rtw_dev_remove(struct usb_interface *pusb_intf) -+{ -+ struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf); -+ _adapter *padapter = dvobj->if1; -+ struct net_device *pnetdev = padapter->pnetdev; -+ struct mlme_priv *pmlmepriv= &padapter->mlmepriv; -+ -+ -+ -+ DBG_871X("+rtw_dev_remove\n"); -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("+dev_remove()\n")); -+ -+ if(usb_drv.drv_registered == true) -+ { -+ //DBG_871X("r871xu_dev_remove():padapter->bSurpriseRemoved == true\n"); -+ padapter->bSurpriseRemoved = true; -+ } -+ /*else -+ { -+ //DBG_871X("r871xu_dev_remove():module removed\n"); -+ padapter->hw_init_completed = false; -+ }*/ -+ -+#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) -+ rtw_unregister_early_suspend(&padapter->pwrctrlpriv); -+#endif -+ -+ rtw_pm_set_ips(padapter, IPS_NONE); -+ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); -+ -+ LeaveAllPowerSaveMode(padapter); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_MULTI_VIR_IFACES -+ rtw_drv_stop_vir_ifaces(dvobj); -+#endif //CONFIG_MULTI_VIR_IFACES -+ rtw_drv_if2_stop(dvobj->if2); -+#endif //CONFIG_CONCURRENT_MODE -+ -+ rtw_usb_if1_deinit(padapter); -+ -+#ifdef CONFIG_CONCURRENT_MODE -+#ifdef CONFIG_MULTI_VIR_IFACES -+ rtw_drv_free_vir_ifaces(dvobj); -+#endif //CONFIG_MULTI_VIR_IFACES -+ rtw_drv_if2_free(dvobj->if2); -+#endif //CONFIG_CONCURRENT_MODE -+ -+ usb_dvobj_deinit(pusb_intf); -+ -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("-dev_remove()\n")); -+ DBG_871X("-r871xu_dev_remove, done\n"); -+ -+ -+#ifdef CONFIG_INTEL_PROXIM -+ rtw_sw_export=NULL; -+#endif -+ -+ #ifdef DBG_MEM_ALLOC -+ rtw_dump_mem_stat (); -+ #endif -+ -+ -+ return; -+ -+} -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,24)) -+extern int console_suspend_enabled; -+#endif -+ -+static int __init rtw_drv_entry(void) -+{ -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("+rtw_drv_entry\n")); -+ -+ DBG_871X(DRV_NAME " driver version=%s\n", DRIVERVERSION); -+ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,24)) -+ //console_suspend_enabled=0; -+#endif -+ -+ rtw_suspend_lock_init(); -+ -+ usb_drv.drv_registered = true; -+ return usb_register(&usb_drv.usbdrv); -+} -+ -+static void __exit rtw_drv_halt(void) -+{ -+ RT_TRACE(_module_hci_intfs_c_,_drv_err_,("+rtw_drv_halt\n")); -+ DBG_871X("+rtw_drv_halt\n"); -+ -+ rtw_suspend_lock_uninit(); -+ -+ usb_drv.drv_registered = false; -+ usb_deregister(&usb_drv.usbdrv); -+ -+ DBG_871X("-rtw_drv_halt\n"); -+} -+ -+module_init(rtw_drv_entry); -+module_exit(rtw_drv_halt); -+ -+#ifdef CONFIG_INTEL_PROXIM -+_adapter *rtw_usb_get_sw_pointer(void) -+{ -+ return rtw_sw_export; -+} -+EXPORT_SYMBOL(rtw_usb_get_sw_pointer); -+#endif //CONFIG_INTEL_PROXIM -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/usb_ops_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/usb_ops_linux.c ---- linux-4.14.17/3rdparty/rtl8812au/os_dep/usb_ops_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/usb_ops_linux.c 2018-02-06 17:42:30.725967387 +0200 -@@ -0,0 +1,772 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _USB_OPS_LINUX_C_ -+ -+#include -+#include -+#include -+ -+int usbctrl_vendorreq(struct intf_hdl *pintfhdl, u8 request, u16 value, u16 index, void *pdata, u16 len, u8 requesttype) -+{ -+ _adapter *padapter = pintfhdl->padapter; -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct usb_device *udev=pdvobjpriv->pusbdev; -+ -+ unsigned int pipe; -+ int status = 0; -+ u32 tmp_buflen=0; -+ u8 reqtype; -+ u8 *pIo_buf; -+ int vendorreq_times = 0; -+ -+ #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE -+ u8 *tmp_buf; -+ #else // use stack memory -+ u8 tmp_buf[MAX_USB_IO_CTL_SIZE]; -+ #endif -+ -+#ifdef CONFIG_CONCURRENT_MODE -+ if(padapter->adapter_type > PRIMARY_ADAPTER) -+ { -+ padapter = padapter->pbuddy_adapter; -+ pdvobjpriv = adapter_to_dvobj(padapter); -+ udev = pdvobjpriv->pusbdev; -+ } -+#endif -+ -+ //DBG_871X("%s %s:%d\n",__FUNCTION__, current->comm, current->pid); -+ -+ if((padapter->bSurpriseRemoved) ||(padapter->pwrctrlpriv.pnp_bstop_trx)){ -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usbctrl_vendorreq:(padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n")); -+ status = -EPERM; -+ goto exit; -+ } -+ -+ if(len>MAX_VENDOR_REQ_CMD_SIZE){ -+ DBG_8192C( "[%s] Buffer len error ,vendor request failed\n", __FUNCTION__ ); -+ status = -EINVAL; -+ goto exit; -+ } -+ -+ #ifdef CONFIG_USB_VENDOR_REQ_MUTEX -+ _enter_critical_mutex(&pdvobjpriv->usb_vendor_req_mutex, NULL); -+ #endif -+ -+ -+ // Acquire IO memory for vendorreq -+#ifdef CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC -+ pIo_buf = pdvobjpriv->usb_vendor_req_buf; -+#else -+ #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE -+ tmp_buf = rtw_malloc( (u32) len + ALIGNMENT_UNIT); -+ tmp_buflen = (u32)len + ALIGNMENT_UNIT; -+ #else // use stack memory -+ tmp_buflen = MAX_USB_IO_CTL_SIZE; -+ #endif -+ -+ // Added by Albert 2010/02/09 -+ // For mstar platform, mstar suggests the address for USB IO should be 16 bytes alignment. -+ // Trying to fix it here. -+ pIo_buf = (tmp_buf==NULL)?NULL:tmp_buf + ALIGNMENT_UNIT -((SIZE_PTR)(tmp_buf) & 0x0f ); -+#endif -+ -+ if ( pIo_buf== NULL) { -+ DBG_8192C( "[%s] pIo_buf == NULL \n", __FUNCTION__ ); -+ status = -ENOMEM; -+ goto release_mutex; -+ } -+ -+ while(++vendorreq_times<= MAX_USBCTRL_VENDORREQ_TIMES) -+ { -+ _rtw_memset(pIo_buf, 0, len); -+ -+ if (requesttype == 0x01) -+ { -+ pipe = usb_rcvctrlpipe(udev, 0);//read_in -+ reqtype = REALTEK_USB_VENQT_READ; -+ } -+ else -+ { -+ pipe = usb_sndctrlpipe(udev, 0);//write_out -+ reqtype = REALTEK_USB_VENQT_WRITE; -+ _rtw_memcpy( pIo_buf, pdata, len); -+ } -+ -+ status = rtw_usb_control_msg(udev, pipe, request, reqtype, value, index, pIo_buf, len, RTW_USB_CONTROL_MSG_TIMEOUT); -+ -+ if ( status == len) // Success this control transfer. -+ { -+ rtw_reset_continual_urb_error(pdvobjpriv); -+ if ( requesttype == 0x01 ) -+ { // For Control read transfer, we have to copy the read data from pIo_buf to pdata. -+ _rtw_memcpy( pdata, pIo_buf, len ); -+ } -+ } -+ else { // error cases -+ DBG_8192C("reg 0x%x, usb %s %u fail, status:%d value=0x%x, vendorreq_times:%d\n" -+ , value,(requesttype == 0x01)?"read":"write" , len, status, *(u32*)pdata, vendorreq_times); -+ -+ if (status < 0) { -+ if(status == (-ESHUTDOWN) || status == -ENODEV ) -+ { -+ padapter->bSurpriseRemoved = true; -+ } else { -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.Wifi_Error_Status = USB_VEN_REQ_CMD_FAIL; -+ } -+ #endif -+ } -+ } -+ else // status != len && status >= 0 -+ { -+ if(status > 0) { -+ if ( requesttype == 0x01 ) -+ { // For Control read transfer, we have to copy the read data from pIo_buf to pdata. -+ _rtw_memcpy( pdata, pIo_buf, len ); -+ } -+ } -+ } -+ -+ if(rtw_inc_and_chk_continual_urb_error(pdvobjpriv) == true ){ -+ padapter->bSurpriseRemoved = true; -+ break; -+ } -+ -+ } -+ -+ // firmware download is checksumed, don't retry -+ if( (value >= FW_START_ADDRESS ) || status == len ) -+ break; -+ -+ } -+ -+ // release IO memory used by vendorreq -+ #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE -+ rtw_mfree(tmp_buf, tmp_buflen); -+ #endif -+ -+release_mutex: -+ #ifdef CONFIG_USB_VENDOR_REQ_MUTEX -+ _exit_critical_mutex(&pdvobjpriv->usb_vendor_req_mutex, NULL); -+ #endif -+exit: -+ return status; -+ -+} -+ -+#ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ -+static void _usbctrl_vendorreq_async_callback(struct urb *urb, struct pt_regs *regs) -+{ -+ if (urb) { -+ if (urb->context) { -+ kfree(urb->context); -+ } -+ usb_free_urb(urb); -+ } -+} -+ -+static int _usbctrl_vendorreq_async_write(struct usb_device *udev, u8 request, -+ u16 value, u16 index, void *pdata, u16 len, u8 requesttype) -+{ -+ int rc; -+ unsigned int pipe; -+ u8 reqtype; -+ struct usb_ctrlrequest *dr; -+ struct urb *urb; -+ struct rtl819x_async_write_data { -+ u8 data[VENDOR_CMD_MAX_DATA_LEN]; -+ struct usb_ctrlrequest dr; -+ } *buf; -+ -+ -+ if (requesttype == VENDOR_READ) { -+ pipe = usb_rcvctrlpipe(udev, 0);//read_in -+ reqtype = REALTEK_USB_VENQT_READ; -+ } -+ else { -+ pipe = usb_sndctrlpipe(udev, 0);//write_out -+ reqtype = REALTEK_USB_VENQT_WRITE; -+ } -+ -+ buf = (struct rtl819x_async_write_data *)rtw_zmalloc(sizeof(*buf)); -+ if (!buf) { -+ rc = -ENOMEM; -+ goto exit; -+ } -+ -+ urb = usb_alloc_urb(0, GFP_ATOMIC); -+ if (!urb) { -+ rtw_mfree((u8*)buf, sizeof(*buf)); -+ rc = -ENOMEM; -+ goto exit; -+ } -+ -+ dr = &buf->dr; -+ -+ dr->bRequestType = reqtype; -+ dr->bRequest = request; -+ dr->wValue = cpu_to_le16(value); -+ dr->wIndex = cpu_to_le16(index); -+ dr->wLength = cpu_to_le16(len); -+ -+ _rtw_memcpy(buf, pdata, len); -+ -+ usb_fill_control_urb(urb, udev, pipe, (unsigned char *)dr, buf, len, -+ _usbctrl_vendorreq_async_callback, buf); -+ -+ rc = usb_submit_urb(urb, GFP_ATOMIC); -+ if (rc < 0) { -+ rtw_mfree((u8*)buf, sizeof(*buf)); -+ usb_free_urb(urb); -+ } -+ -+exit: -+ return rc; -+} -+ -+int usb_write_async(struct usb_device *udev, u32 addr, void *pdata, u16 len) -+{ -+ u8 request; -+ u8 requesttype; -+ u16 wvalue; -+ u16 index; -+ -+ int ret; -+ -+ requesttype = VENDOR_WRITE;//write_out -+ request = REALTEK_USB_VENQT_CMD_REQ; -+ index = REALTEK_USB_VENQT_CMD_IDX;//n/a -+ -+ wvalue = (u16)(addr&0x0000ffff); -+ -+ ret = _usbctrl_vendorreq_async_write(udev, request, wvalue, index, pdata, len, requesttype); -+ -+ return ret; -+} -+ -+int usb_async_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val) -+{ -+ u8 data; -+ int ret; -+ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; -+ struct usb_device *udev=pdvobjpriv->pusbdev; -+ -+ -+ data = val; -+ ret = usb_write_async(udev, addr, &data, 1); -+ -+ -+ return ret; -+} -+ -+int usb_async_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val) -+{ -+ u16 data; -+ int ret; -+ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; -+ struct usb_device *udev=pdvobjpriv->pusbdev; -+ -+ -+ data = val; -+ ret = usb_write_async(udev, addr, &data, 2); -+ -+ -+ return ret; -+} -+ -+int usb_async_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val) -+{ -+ u32 data; -+ int ret; -+ struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *)pintfhdl->pintf_dev; -+ struct usb_device *udev=pdvobjpriv->pusbdev; -+ -+ -+ data = val; -+ ret = usb_write_async(udev, addr, &data, 4); -+ -+ -+ return ret; -+} -+#endif /* CONFIG_USB_SUPPORT_ASYNC_VDN_REQ */ -+ -+unsigned int ffaddr2pipehdl(struct dvobj_priv *pdvobj, u32 addr) -+{ -+ unsigned int pipe=0, ep_num=0; -+ struct usb_device *pusbd = pdvobj->pusbdev; -+ -+ if (addr == RECV_BULK_IN_ADDR) { -+ pipe=usb_rcvbulkpipe(pusbd, pdvobj->RtInPipe[0]); -+ -+ } else if (addr == RECV_INT_IN_ADDR) { -+ pipe=usb_rcvbulkpipe(pusbd, pdvobj->RtInPipe[1]); -+ -+ } else if (addr < HW_QUEUE_ENTRY) { -+ ep_num = pdvobj->Queue2Pipe[addr]; -+ pipe = usb_sndbulkpipe(pusbd, ep_num); -+ } -+ -+ return pipe; -+} -+ -+struct zero_bulkout_context{ -+ void *pbuf; -+ void *purb; -+ void *pirp; -+ void *padapter; -+}; -+ -+static void usb_bulkout_zero_complete(struct urb *purb, struct pt_regs *regs) -+{ -+ struct zero_bulkout_context *pcontext = (struct zero_bulkout_context *)purb->context; -+ -+ //DBG_8192C("+usb_bulkout_zero_complete\n"); -+ -+ if(pcontext) -+ { -+ if(pcontext->pbuf) -+ { -+ rtw_mfree(pcontext->pbuf, sizeof(int)); -+ } -+ -+ if(pcontext->purb && (pcontext->purb==purb)) -+ { -+ usb_free_urb(pcontext->purb); -+ } -+ -+ -+ rtw_mfree((u8*)pcontext, sizeof(struct zero_bulkout_context)); -+ } -+ -+ -+} -+ -+static u32 usb_bulkout_zero(struct intf_hdl *pintfhdl, u32 addr) -+{ -+ int pipe, status, len; -+ u32 ret; -+ unsigned char *pbuf; -+ struct zero_bulkout_context *pcontext; -+ PURB purb = NULL; -+ _adapter *padapter = (_adapter *)pintfhdl->padapter; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ struct usb_device *pusbd = pdvobj->pusbdev; -+ -+ //DBG_871X("%s\n", __func__); -+ -+ -+ if((padapter->bDriverStopped) || (padapter->bSurpriseRemoved) ||(padapter->pwrctrlpriv.pnp_bstop_trx)) -+ { -+ return _FAIL; -+ } -+ -+ -+ pcontext = (struct zero_bulkout_context *)rtw_zmalloc(sizeof(struct zero_bulkout_context)); -+ -+ pbuf = (unsigned char *)rtw_zmalloc(sizeof(int)); -+ purb = usb_alloc_urb(0, GFP_ATOMIC); -+ -+ len = 0; -+ pcontext->pbuf = pbuf; -+ pcontext->purb = purb; -+ pcontext->pirp = NULL; -+ pcontext->padapter = padapter; -+ -+ -+ //translate DMA FIFO addr to pipehandle -+ //pipe = ffaddr2pipehdl(pdvobj, addr); -+ -+ usb_fill_bulk_urb(purb, pusbd, pipe, -+ pbuf, -+ len, -+ usb_bulkout_zero_complete, -+ pcontext);//context is pcontext -+ -+ status = usb_submit_urb(purb, GFP_ATOMIC); -+ -+ if (!status) -+ { -+ ret= _SUCCESS; -+ } -+ else -+ { -+ ret= _FAIL; -+ } -+ -+ -+ return _SUCCESS; -+ -+} -+ -+void usb_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) -+{ -+ -+} -+ -+void usb_write_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) -+{ -+ -+} -+ -+ -+void usb_read_port_cancel(struct intf_hdl *pintfhdl) -+{ -+ int i; -+ struct recv_buf *precvbuf; -+ _adapter *padapter = pintfhdl->padapter; -+ precvbuf = (struct recv_buf *)padapter->recvpriv.precv_buf; -+ -+ DBG_871X("%s\n", __func__); -+ -+ padapter->bReadPortCancel = true; -+ -+ for (i=0; i < NR_RECVBUFF ; i++) { -+ -+ precvbuf->reuse = true; -+ if (precvbuf->purb) { -+ //DBG_8192C("usb_read_port_cancel : usb_kill_urb \n"); -+ usb_kill_urb(precvbuf->purb); -+ } -+ precvbuf++; -+ } -+ -+#ifdef CONFIG_USB_INTERRUPT_IN_PIPE -+ usb_kill_urb(padapter->recvpriv.int_in_urb); -+#endif -+} -+ -+static void usb_write_port_complete(struct urb *purb, struct pt_regs *regs) -+{ -+ _irqL irqL; -+ int i; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)purb->context; -+ //struct xmit_frame *pxmitframe = (struct xmit_frame *)pxmitbuf->priv_data; -+ //_adapter *padapter = pxmitframe->padapter; -+ _adapter *padapter = pxmitbuf->padapter; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ //struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+ -+ -+ switch(pxmitbuf->flags) -+ { -+ case VO_QUEUE_INX: -+ pxmitpriv->voq_cnt--; -+ break; -+ case VI_QUEUE_INX: -+ pxmitpriv->viq_cnt--; -+ break; -+ case BE_QUEUE_INX: -+ pxmitpriv->beq_cnt--; -+ break; -+ case BK_QUEUE_INX: -+ pxmitpriv->bkq_cnt--; -+ break; -+ case HIGH_QUEUE_INX: -+#ifdef CONFIG_AP_MODE -+ rtw_chk_hi_queue_cmd(padapter); -+#endif -+ break; -+ default: -+ break; -+ } -+ -+ -+/* -+ _enter_critical(&pxmitpriv->lock, &irqL); -+ -+ pxmitpriv->txirp_cnt--; -+ -+ switch(pattrib->priority) -+ { -+ case 1: -+ case 2: -+ pxmitpriv->bkq_cnt--; -+ //DBG_8192C("pxmitpriv->bkq_cnt=%d\n", pxmitpriv->bkq_cnt); -+ break; -+ case 4: -+ case 5: -+ pxmitpriv->viq_cnt--; -+ //DBG_8192C("pxmitpriv->viq_cnt=%d\n", pxmitpriv->viq_cnt); -+ break; -+ case 6: -+ case 7: -+ pxmitpriv->voq_cnt--; -+ //DBG_8192C("pxmitpriv->voq_cnt=%d\n", pxmitpriv->voq_cnt); -+ break; -+ case 0: -+ case 3: -+ default: -+ pxmitpriv->beq_cnt--; -+ //DBG_8192C("pxmitpriv->beq_cnt=%d\n", pxmitpriv->beq_cnt); -+ break; -+ -+ } -+ -+ _exit_critical(&pxmitpriv->lock, &irqL); -+ -+ -+ if(pxmitpriv->txirp_cnt==0) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete: txirp_cnt== 0, set allrxreturnevt!\n")); -+ _rtw_up_sema(&(pxmitpriv->tx_retevt)); -+ } -+*/ -+ //rtw_free_xmitframe(pxmitpriv, pxmitframe); -+ -+ if(padapter->bSurpriseRemoved || padapter->bDriverStopped ||padapter->bWritePortCancel) -+ { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete:bDriverStopped(%d) OR bSurpriseRemoved(%d)", padapter->bDriverStopped, padapter->bSurpriseRemoved)); -+ DBG_8192C("%s(): TX Warning! bDriverStopped(%d) OR bSurpriseRemoved(%d) bWritePortCancel(%d) pxmitbuf->buf_tag(%x) \n", -+ __FUNCTION__,padapter->bDriverStopped, padapter->bSurpriseRemoved,padapter->bReadPortCancel,pxmitbuf->buf_tag); -+ -+ goto check_completion; -+ } -+ -+ -+ if (purb->status==0) { -+ -+ } else { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete : purb->status(%d) != 0 \n", purb->status)); -+ DBG_871X("###=> urb_write_port_complete status(%d)\n",purb->status); -+ if((purb->status==-EPIPE)||(purb->status==-EPROTO)) -+ { -+ //usb_clear_halt(pusbdev, purb->pipe); -+ //msleep(10); -+ sreset_set_wifi_error_status(padapter, USB_WRITE_PORT_FAIL); -+ } else if (purb->status == -EINPROGRESS) { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete: EINPROGESS\n")); -+ goto check_completion; -+ -+ } else if (purb->status == -ENOENT) { -+ DBG_871X("%s: -ENOENT\n", __func__); -+ goto check_completion; -+ -+ } else if (purb->status == -ECONNRESET) { -+ DBG_871X("%s: -ECONNRESET\n", __func__); -+ goto check_completion; -+ -+ } else if (purb->status == -ESHUTDOWN) { -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete: ESHUTDOWN\n")); -+ padapter->bDriverStopped=true; -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete:bDriverStopped=TRUE\n")); -+ -+ goto check_completion; -+ } -+ else -+ { -+ padapter->bSurpriseRemoved=true; -+ DBG_8192C("bSurpriseRemoved=TRUE\n"); -+ //rtl8192cu_trigger_gpio_0(padapter); -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port_complete:bSurpriseRemoved=TRUE\n")); -+ -+ goto check_completion; -+ } -+ } -+ -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.last_tx_complete_time = rtw_get_current_time(); -+ } -+ #endif -+ -+check_completion: -+ _enter_critical(&pxmitpriv->lock_sctx, &irqL); -+ rtw_sctx_done_err(&pxmitbuf->sctx, -+ purb->status ? RTW_SCTX_DONE_WRITE_PORT_ERR : RTW_SCTX_DONE_SUCCESS); -+ _exit_critical(&pxmitpriv->lock_sctx, &irqL); -+ -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ -+ //if(rtw_txframes_pending(padapter)) -+ { -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+ } -+ -+ -+ -+} -+ -+u32 usb_write_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) -+{ -+ _irqL irqL; -+ unsigned int pipe; -+ int status; -+ u32 ret = _FAIL, bwritezero = false; -+ PURB purb = NULL; -+ _adapter *padapter = (_adapter *)pintfhdl->padapter; -+ struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)wmem; -+ struct xmit_frame *pxmitframe = (struct xmit_frame *)pxmitbuf->priv_data; -+ struct usb_device *pusbd = pdvobj->pusbdev; -+ struct pkt_attrib *pattrib = &pxmitframe->attrib; -+ -+ -+ -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("+usb_write_port\n")); -+ -+ if ((padapter->bDriverStopped) || (padapter->bSurpriseRemoved) ||(padapter->pwrctrlpriv.pnp_bstop_trx)) { -+ #ifdef DBG_TX -+ DBG_871X(" DBG_TX %s:%d bDriverStopped%d, bSurpriseRemoved:%d, pnp_bstop_trx:%d\n",__FUNCTION__, __LINE__ -+ ,padapter->bDriverStopped, padapter->bSurpriseRemoved, padapter->pwrctrlpriv.pnp_bstop_trx ); -+ #endif -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port:( padapter->bDriverStopped ||padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n")); -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_TX_DENY); -+ goto exit; -+ } -+ -+ _enter_critical(&pxmitpriv->lock, &irqL); -+ -+ switch(addr) -+ { -+ case VO_QUEUE_INX: -+ pxmitpriv->voq_cnt++; -+ pxmitbuf->flags = VO_QUEUE_INX; -+ break; -+ case VI_QUEUE_INX: -+ pxmitpriv->viq_cnt++; -+ pxmitbuf->flags = VI_QUEUE_INX; -+ break; -+ case BE_QUEUE_INX: -+ pxmitpriv->beq_cnt++; -+ pxmitbuf->flags = BE_QUEUE_INX; -+ break; -+ case BK_QUEUE_INX: -+ pxmitpriv->bkq_cnt++; -+ pxmitbuf->flags = BK_QUEUE_INX; -+ break; -+ case HIGH_QUEUE_INX: -+ pxmitbuf->flags = HIGH_QUEUE_INX; -+ break; -+ default: -+ pxmitbuf->flags = MGT_QUEUE_INX; -+ break; -+ } -+ -+ _exit_critical(&pxmitpriv->lock, &irqL); -+ -+ purb = pxmitbuf->pxmit_urb[0]; -+ -+ //translate DMA FIFO addr to pipehandle -+ pipe = ffaddr2pipehdl(pdvobj, addr); -+ -+#ifdef CONFIG_REDUCE_USB_TX_INT -+ if ( (pxmitpriv->free_xmitbuf_cnt%NR_XMITBUFF == 0) -+ || (pxmitbuf->buf_tag > XMITBUF_DATA) ) -+ { -+ purb->transfer_flags &= (~URB_NO_INTERRUPT); -+ } else { -+ purb->transfer_flags |= URB_NO_INTERRUPT; -+ //DBG_8192C("URB_NO_INTERRUPT "); -+ } -+#endif -+ -+ -+ usb_fill_bulk_urb(purb, pusbd, pipe, -+ pxmitframe->buf_addr, //= pxmitbuf->pbuf -+ cnt, -+ usb_write_port_complete, -+ pxmitbuf);//context is pxmitbuf -+ -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ purb->transfer_dma = pxmitbuf->dma_transfer_addr; -+ purb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; -+ purb->transfer_flags |= URB_ZERO_PACKET; -+#endif // CONFIG_USE_USB_BUFFER_ALLOC_TX -+ -+#if 0 -+ if (bwritezero) -+ { -+ purb->transfer_flags |= URB_ZERO_PACKET; -+ } -+#endif -+ -+ status = usb_submit_urb(purb, GFP_ATOMIC); -+ if (!status) { -+ #ifdef DBG_CONFIG_ERROR_DETECT -+ { -+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -+ pHalData->srestpriv.last_tx_time = rtw_get_current_time(); -+ } -+ #endif -+ } else { -+ rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_WRITE_PORT_ERR); -+ DBG_871X("usb_write_port, status=%d\n", status); -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_write_port(): usb_submit_urb, status=%x\n", status)); -+ -+ switch (status) { -+ case -ENODEV: -+ padapter->bDriverStopped=true; -+ break; -+ default: -+ break; -+ } -+ goto exit; -+ } -+ -+ ret= _SUCCESS; -+ -+// Commented by Albert 2009/10/13 -+// We add the URB_ZERO_PACKET flag to urb so that the host will send the zero packet automatically. -+/* -+ if(bwritezero == true) -+ { -+ usb_bulkout_zero(pintfhdl, addr); -+ } -+*/ -+ -+ RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("-usb_write_port\n")); -+ -+exit: -+ if (ret != _SUCCESS) -+ rtw_free_xmitbuf(pxmitpriv, pxmitbuf); -+ -+ return ret; -+ -+} -+ -+void usb_write_port_cancel(struct intf_hdl *pintfhdl) -+{ -+ int i, j; -+ _adapter *padapter = pintfhdl->padapter; -+ struct xmit_buf *pxmitbuf = (struct xmit_buf *)padapter->xmitpriv.pxmitbuf; -+ -+ DBG_871X("%s \n", __func__); -+ -+ padapter->bWritePortCancel = true; -+ -+ for (i=0; ipxmit_urb[j]) { -+ usb_kill_urb(pxmitbuf->pxmit_urb[j]); -+ } -+ } -+ pxmitbuf++; -+ } -+ -+ pxmitbuf = (struct xmit_buf*)padapter->xmitpriv.pxmit_extbuf; -+ for (i = 0; i < NR_XMIT_EXTBUFF; i++) { -+ for (j=0; j<8; j++) { -+ if(pxmitbuf->pxmit_urb[j]) { -+ usb_kill_urb(pxmitbuf->pxmit_urb[j]); -+ } -+ } -+ pxmitbuf++; -+ } -+} -diff -Nurp linux-4.14.17/3rdparty/rtl8812au/os_dep/xmit_linux.c linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/xmit_linux.c ---- linux-4.14.17/3rdparty/rtl8812au/os_dep/xmit_linux.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-4.14.17-3rd/3rdparty/rtl8812au/os_dep/xmit_linux.c 2018-02-06 17:42:30.726967401 +0200 -@@ -0,0 +1,407 @@ -+/****************************************************************************** -+ * -+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but WITHOUT -+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or -+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for -+ * more details. -+ * -+ ******************************************************************************/ -+#define _XMIT_OSDEP_C_ -+ -+#include -+ -+ -+uint rtw_remainder_len(struct pkt_file *pfile) -+{ -+ return (pfile->buf_len - ((SIZE_PTR)(pfile->cur_addr) - (SIZE_PTR)(pfile->buf_start))); -+} -+ -+void _rtw_open_pktfile (_pkt *pktptr, struct pkt_file *pfile) -+{ -+ -+ -+ pfile->pkt = pktptr; -+ pfile->cur_addr = pfile->buf_start = pktptr->data; -+ pfile->pkt_len = pfile->buf_len = pktptr->len; -+ -+ pfile->cur_buffer = pfile->buf_start ; -+ -+ -+} -+ -+uint _rtw_pktfile_read (struct pkt_file *pfile, u8 *rmem, uint rlen) -+{ -+ uint len = 0; -+ -+ -+ -+ len = rtw_remainder_len(pfile); -+ len = (rlen > len)? len: rlen; -+ -+ if(rmem) -+ skb_copy_bits(pfile->pkt, pfile->buf_len-pfile->pkt_len, rmem, len); -+ -+ pfile->cur_addr += len; -+ pfile->pkt_len -= len; -+ -+ -+ -+ return len; -+} -+ -+sint rtw_endofpktfile(struct pkt_file *pfile) -+{ -+ -+ -+ if (pfile->pkt_len == 0) { -+ -+ return true; -+ } -+ -+ -+ -+ return false; -+} -+ -+void rtw_set_tx_chksum_offload(_pkt *pkt, struct pkt_attrib *pattrib) -+{ -+ -+#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX -+ struct sk_buff *skb = (struct sk_buff *)pkt; -+ pattrib->hw_tcp_csum = 0; -+ -+ if (skb->ip_summed == CHECKSUM_PARTIAL) { -+ if (skb_shinfo(skb)->nr_frags == 0) -+ { -+ const struct iphdr *ip = ip_hdr(skb); -+ if (ip->protocol == IPPROTO_TCP) { -+ // TCP checksum offload by HW -+ DBG_871X("CHECKSUM_PARTIAL TCP\n"); -+ pattrib->hw_tcp_csum = 1; -+ //skb_checksum_help(skb); -+ } else if (ip->protocol == IPPROTO_UDP) { -+ //DBG_871X("CHECKSUM_PARTIAL UDP\n"); -+#if 1 -+ skb_checksum_help(skb); -+#else -+ // Set UDP checksum = 0 to skip checksum check -+ struct udphdr *udp = skb_transport_header(skb); -+ udp->check = 0; -+#endif -+ } else { -+ DBG_871X("%s-%d TCP CSUM offload Error!!\n", __FUNCTION__, __LINE__); -+ WARN_ON(1); /* we need a WARN() */ -+ } -+ } -+ else { // IP fragmentation case -+ DBG_871X("%s-%d nr_frags != 0, using skb_checksum_help(skb);!!\n", __FUNCTION__, __LINE__); -+ skb_checksum_help(skb); -+ } -+ } -+#endif -+ -+} -+ -+int rtw_os_xmit_resource_alloc(_adapter *padapter, struct xmit_buf *pxmitbuf, u32 alloc_sz, u8 flag) -+{ -+ if (alloc_sz > 0) { -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct usb_device *pusbd = pdvobjpriv->pusbdev; -+ -+ pxmitbuf->pallocated_buf = rtw_usb_buffer_alloc(pusbd, (size_t)alloc_sz, &pxmitbuf->dma_transfer_addr); -+ pxmitbuf->pbuf = pxmitbuf->pallocated_buf; -+ if(pxmitbuf->pallocated_buf == NULL) -+ return _FAIL; -+#else // CONFIG_USE_USB_BUFFER_ALLOC_TX -+ -+ pxmitbuf->pallocated_buf = rtw_zmalloc(alloc_sz); -+ if (pxmitbuf->pallocated_buf == NULL) -+ { -+ return _FAIL; -+ } -+ -+ pxmitbuf->pbuf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(pxmitbuf->pallocated_buf), XMITBUF_ALIGN_SZ); -+ -+#endif // CONFIG_USE_USB_BUFFER_ALLOC_TX -+ } -+ -+ if (flag) { -+ int i; -+ for(i=0; i<8; i++) -+ { -+ pxmitbuf->pxmit_urb[i] = usb_alloc_urb(0, GFP_KERNEL); -+ if(pxmitbuf->pxmit_urb[i] == NULL) -+ { -+ DBG_871X("pxmitbuf->pxmit_urb[i]==NULL"); -+ return _FAIL; -+ } -+ } -+ } -+ return _SUCCESS; -+} -+ -+void rtw_os_xmit_resource_free(_adapter *padapter, struct xmit_buf *pxmitbuf,u32 free_sz, u8 flag) -+{ -+ if (flag) { -+ int i; -+ -+ for(i=0; i<8; i++) -+ { -+ if(pxmitbuf->pxmit_urb[i]) -+ usb_free_urb(pxmitbuf->pxmit_urb[i]); -+ } -+ } -+ -+ if (free_sz > 0 ) { -+#ifdef CONFIG_USE_USB_BUFFER_ALLOC_TX -+ struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); -+ struct usb_device *pusbd = pdvobjpriv->pusbdev; -+ -+ rtw_usb_buffer_free(pusbd, (size_t)free_sz, pxmitbuf->pallocated_buf, pxmitbuf->dma_transfer_addr); -+ pxmitbuf->pallocated_buf = NULL; -+ pxmitbuf->dma_transfer_addr = 0; -+#else // CONFIG_USE_USB_BUFFER_ALLOC_TX -+ if(pxmitbuf->pallocated_buf) -+ rtw_mfree(pxmitbuf->pallocated_buf, free_sz); -+#endif // CONFIG_USE_USB_BUFFER_ALLOC_TX -+ } -+} -+ -+#define WMM_XMIT_THRESHOLD (NR_XMITFRAME*2/5) -+ -+void rtw_os_pkt_complete(_adapter *padapter, _pkt *pkt) -+{ -+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35)) -+ u16 queue; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ -+ queue = skb_get_queue_mapping(pkt); -+ if (padapter->registrypriv.wifi_spec) { -+ if(__netif_subqueue_stopped(padapter->pnetdev, queue) && -+ (pxmitpriv->hwxmits[queue].accnt < WMM_XMIT_THRESHOLD)) -+ { -+ netif_wake_subqueue(padapter->pnetdev, queue); -+ } -+ } else { -+ if(__netif_subqueue_stopped(padapter->pnetdev, queue)) -+ netif_wake_subqueue(padapter->pnetdev, queue); -+ } -+#else -+ if (netif_queue_stopped(padapter->pnetdev)) -+ netif_wake_queue(padapter->pnetdev); -+#endif -+ -+ dev_kfree_skb_any(pkt); -+} -+ -+void rtw_os_xmit_complete(_adapter *padapter, struct xmit_frame *pxframe) -+{ -+ if(pxframe->pkt) -+ { -+ //RT_TRACE(_module_xmit_osdep_c_,_drv_err_,("linux : rtw_os_xmit_complete, dev_kfree_skb()\n")); -+ -+ //dev_kfree_skb_any(pxframe->pkt); -+ rtw_os_pkt_complete(padapter, pxframe->pkt); -+ -+ } -+ -+ pxframe->pkt = NULL; -+} -+ -+void rtw_os_xmit_schedule(_adapter *padapter) -+{ -+ _adapter *pri_adapter = padapter; -+ _irqL irqL; -+ struct xmit_priv *pxmitpriv; -+ -+ if(!padapter) -+ return; -+ -+ pxmitpriv = &padapter->xmitpriv; -+ -+ _enter_critical_bh(&pxmitpriv->lock, &irqL); -+ -+ if(rtw_txframes_pending(padapter)) -+ { -+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); -+ } -+ -+ _exit_critical_bh(&pxmitpriv->lock, &irqL); -+} -+ -+static void rtw_check_xmit_resource(_adapter *padapter, _pkt *pkt) -+{ -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ u16 queue; -+ -+ queue = skb_get_queue_mapping(pkt); -+ if (padapter->registrypriv.wifi_spec) { -+ /* No free space for Tx, tx_worker is too slow */ -+ if (pxmitpriv->hwxmits[queue].accnt > WMM_XMIT_THRESHOLD) { -+ //DBG_871X("%s(): stop netif_subqueue[%d]\n", __FUNCTION__, queue); -+ netif_stop_subqueue(padapter->pnetdev, queue); -+ } -+ } else { -+ if(pxmitpriv->free_xmitframe_cnt<=4) { -+ if (!netif_tx_queue_stopped(netdev_get_tx_queue(padapter->pnetdev, queue))) -+ netif_stop_subqueue(padapter->pnetdev, queue); -+ } -+ } -+#else -+ if(pxmitpriv->free_xmitframe_cnt<=4) -+ { -+ if (!rtw_netif_queue_stopped(padapter->pnetdev)) -+ rtw_netif_stop_queue(padapter->pnetdev); -+ } -+#endif -+} -+ -+#ifdef CONFIG_TX_MCAST2UNI -+int rtw_mlcst2unicst(_adapter *padapter, struct sk_buff *skb) -+{ -+ struct sta_priv *pstapriv = &padapter->stapriv; -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+ _irqL irqL; -+ _list *phead, *plist; -+ struct sk_buff *newskb; -+ struct sta_info *psta = NULL; -+ u8 chk_alive_num = 0; -+ char chk_alive_list[NUM_STA]; -+ u8 bc_addr[6]={0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; -+ u8 null_addr[6]={0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; -+ -+ int i; -+ s32 res; -+ -+ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ phead = &pstapriv->asoc_list; -+ plist = get_next(phead); -+ -+ //free sta asoc_queue -+ while ((rtw_end_of_queue_search(phead, plist)) == false) { -+ int stainfo_offset; -+ psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); -+ plist = get_next(plist); -+ -+ stainfo_offset = rtw_stainfo_offset(pstapriv, psta); -+ if (stainfo_offset_valid(stainfo_offset)) { -+ chk_alive_list[chk_alive_num++] = stainfo_offset; -+ } -+ } -+ _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -+ -+ for (i = 0; i < chk_alive_num; i++) { -+ psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); -+ if(!(psta->state &_FW_LINKED)) -+ continue; -+ -+ /* avoid come from STA1 and send back STA1 */ -+ if (_rtw_memcmp(psta->hwaddr, &skb->data[6], 6) == true -+ || _rtw_memcmp(psta->hwaddr, null_addr, 6) == true -+ || _rtw_memcmp(psta->hwaddr, bc_addr, 6) == true -+ ) -+ continue; -+ -+ newskb = skb_copy(skb, GFP_ATOMIC); -+ -+ if (newskb) { -+ _rtw_memcpy(newskb->data, psta->hwaddr, 6); -+ res = rtw_xmit(padapter, &newskb); -+ if (res < 0) { -+ DBG_871X("%s()-%d: rtw_xmit() return error!\n", __FUNCTION__, __LINE__); -+ pxmitpriv->tx_drop++; -+ dev_kfree_skb_any(newskb); -+ } else -+ pxmitpriv->tx_pkts++; -+ } else { -+ DBG_871X("%s-%d: skb_copy() failed!\n", __FUNCTION__, __LINE__); -+ pxmitpriv->tx_drop++; -+ //dev_kfree_skb_any(skb); -+ return false; // Caller shall tx this multicast frame via normal way. -+ } -+ } -+ -+ dev_kfree_skb_any(skb); -+ return true; -+} -+#endif // CONFIG_TX_MCAST2UNI -+ -+ -+int rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) -+{ -+ _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); -+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv; -+#ifdef CONFIG_TX_MCAST2UNI -+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -+ extern int rtw_mc2u_disable; -+#endif // CONFIG_TX_MCAST2UNI -+ s32 res = 0; -+#if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35)) -+ u16 queue; -+#endif -+ -+ -+ -+ RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("+xmit_enry\n")); -+ -+ if (rtw_if_up(padapter) == false) { -+ RT_TRACE(_module_xmit_osdep_c_, _drv_err_, ("rtw_xmit_entry: rtw_if_up fail\n")); -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s if_up fail\n", __FUNCTION__); -+ #endif -+ goto drop_packet; -+ } -+ -+ rtw_check_xmit_resource(padapter, pkt); -+ -+#ifdef CONFIG_TX_MCAST2UNI -+ if ( !rtw_mc2u_disable -+ && check_fwstate(pmlmepriv, WIFI_AP_STATE) == true -+ && ( IP_MCAST_MAC(pkt->data) -+ || ICMPV6_MCAST_MAC(pkt->data) ) -+ && (padapter->registrypriv.wifi_spec == 0) -+ ) -+ { -+ if ( pxmitpriv->free_xmitframe_cnt > (NR_XMITFRAME/4) ) { -+ res = rtw_mlcst2unicst(padapter, pkt); -+ if (res == true) { -+ goto exit; -+ } -+ } else { -+ //DBG_871X("Stop M2U(%d, %d)! ", pxmitpriv->free_xmitframe_cnt, pxmitpriv->free_xmitbuf_cnt); -+ //DBG_871X("!m2u ); -+ } -+ } -+#endif // CONFIG_TX_MCAST2UNI -+ -+ res = rtw_xmit(padapter, &pkt); -+ if (res < 0) { -+ #ifdef DBG_TX_DROP_FRAME -+ DBG_871X("DBG_TX_DROP_FRAME %s rtw_xmit fail\n", __FUNCTION__); -+ #endif -+ goto drop_packet; -+ } -+ -+ pxmitpriv->tx_pkts++; -+ RT_TRACE(_module_xmit_osdep_c_, _drv_info_, ("rtw_xmit_entry: tx_pkts=%d\n", (u32)pxmitpriv->tx_pkts)); -+ goto exit; -+ -+drop_packet: -+ pxmitpriv->tx_drop++; -+ dev_kfree_skb_any(pkt); -+ RT_TRACE(_module_xmit_osdep_c_, _drv_notice_, ("rtw_xmit_entry: drop, tx_drop=%d\n", (u32)pxmitpriv->tx_drop)); -+ -+exit: -+ -+ -+ -+ return 0; -+} diff --git a/kernel/kernel/files/patches/mageia/3rd-viahss-0.92.patch b/kernel/kernel/files/patches/mageia/3rd-viahss-0.92.patch deleted file mode 100644 index bc9a5678..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-viahss-0.92.patch +++ /dev/null @@ -1,189 +0,0 @@ - 3rdparty/viahss/Kconfig | 14 +++++++ - 3rdparty/viahss/Makefile | 3 + - 3rdparty/viahss/README.html | 68 ++++++++++++++++++++++++++++++++++++ - 3rdparty/viahss/viahss.c | 83 ++++++++++++++++++++++++++++++++++++++++++++ - 4 files changed, 168 insertions(+) -diff -Nurp linux-2.6.37/3rdparty/viahss/Kconfig linux-2.6.37.3rdparty/3rdparty/viahss/Kconfig ---- linux-2.6.37/3rdparty/viahss/Kconfig 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/viahss/Kconfig 2003-12-01 01:53:51.000000000 +0200 -@@ -0,0 +1,14 @@ -+config VIAHSS -+ tristate "VIA High Speed Serial" -+ depends on SERIAL_CORE && m -+ ---help--- -+ VIA High Speed Serial is a little kernel module (1 KB) which enables -+ high speed serial port modes of VIA VT82C686A or VT82C686B -+ southbridge-equipped motherboards. With this module, you can use the -+ serial port at 230400 bit/s so that you can get the full 128000 bit/s -+ from ISDN-TA. The module has been tested with both 686A and 686B -+ chipsets. -+ -+ To compile this driver as a module, choose M here: the -+ module will be called viahss. -+ -diff -Nurp linux-2.6.37/3rdparty/viahss/Makefile linux-2.6.37.3rdparty/3rdparty/viahss/Makefile ---- linux-2.6.37/3rdparty/viahss/Makefile 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/viahss/Makefile 2003-12-01 01:43:23.000000000 +0200 -@@ -0,0 +1,3 @@ -+ -+obj-$(CONFIG_VIAHSS) += viahss.o -+ -diff -Nurp linux-2.6.37/3rdparty/viahss/README.html linux-2.6.37.3rdparty/3rdparty/viahss/README.html ---- linux-2.6.37/3rdparty/viahss/README.html 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/viahss/README.html 2003-12-01 01:58:23.000000000 +0200 -@@ -0,0 +1,68 @@ -+ -+ -+ -+ -+ High speed serial port for VIA VT82C686 chipsets for linux -+ -+ -+

Setting the serial port speed over 115,200bps

-+
-+If you have motherboard which has VIA VT82C686A or VT82C686B chipset -+you can set serial ports in high speed mode with this kernel module. -+I use module with external ISDN-TA and haven't had any problems -+so far but I cannot guarantee that you won't have buffer overflows if -+you use full 230K or 460K speed all the time (FIFO's are still 16550A size). -+ISDN with two channels maxes out at 128 Kb which means that it doesn't -+really stress serial ports at 230400. Unlike SHSMOD-patches you don't have -+to patch serial driver and module takes only 1KB of memory when it's -+loaded which should leave enough room for other programs. It should -+be also possible to make this work from userspace but accessing -+pci devices is so much easier from kernel. -+ -+

How to use module

-+Get the package -+and compile it using included makefiles. -+

For 2.4

-+If you have kernel in some other location than /usr/src/linux edit Makefile -+before compiling. You can also install module with "make install". After -+you have loaded module in kernel (use modprobe or insmod) you can set serial -+ports to use high speed modes with setserial.
-+

For 2.5/2.6

-+Copy Makefile-2.6 on top of Makefile and do make. After loading module set -+serial speed with setserial. (NOTE: This gives a warning on depracated -+method). -+ -+
-+# setserial /dev/ttyS0 spd_cust divisor 0x8002 -+

-+which sets COM1: speed to 230400. With 0x8001 you should get 460800 -+but I haven't tested it. If you want to use COM2: use ttyS1 instead of ttyS0. -+ -+After this you should set program which you are using to use 38400 bps -+speed which is now actually 230K or 460K. For more information check -+setserial man page (spd_cust). -+ -+You can use serial port work as normal if you do
-+
-+# setserial /dev/ttyS0 spd_normal

-+After this you can also remove viahss module with rmmod if you need to. Module doesn't intefere with normal serial port usage so you can leave -+it loaded if you don't need that extra 1KB which module uses. -+

Download

-+viahss-0.92.tar.gz -+ -+

Acknowledgments

-+ -+Thanks to Kimmo Rintala for help with divisor settings.
-+I also like to thank Jeff Garzik for help with VIA datasheets.
-+Port to 2.5/2.6 by Kingsly John with the help of LWN -+ -+

Version History

-+0.90 First release
-+0.91 Fixed Makefile
-+0.92 Fixed for 2.5/2.6
-+ -+

Contact

-+ -+You can reach me by email: jrauti@iki.fi -+ -+ -diff -Nurp linux-2.6.37/3rdparty/viahss/viahss.c linux-2.6.37.3rdparty/3rdparty/viahss/viahss.c ---- linux-2.6.37/3rdparty/viahss/viahss.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3rdparty/3rdparty/viahss/viahss.c 2003-07-17 09:49:59.000000000 +0300 -@@ -0,0 +1,83 @@ -+/* -+ * VIA VT 82c686[AB] high speed serial port enabler -+ * Version 0.92 -+ * Copyright (c) 2000-2001 Juhani Rautiainen -+ * -+ * 0.92: -+ * Ported to 2.5/2.6 by Kingsly John -+ * - Corrected locking (no more cli() and sti()) -+ * - New makefile -+ * -+ * Can be freely distributed and used under the terms of the GNU GPL. -+*/ -+ -+#include -+#include -+#include -+#include -+#include -+ -+const unsigned short confindex=0x3F0,confdata=0x3F1; -+const unsigned char spcidx=0xEE; -+ -+spinlock_t driver_lock = SPIN_LOCK_UNLOCKED; -+ -+static int __init viahss_init(void) -+{ -+ struct pci_dev *pcidev = NULL; -+ unsigned char confval,val; -+ pcidev = pci_find_device (PCI_VENDOR_ID_VIA,PCI_DEVICE_ID_VIA_82C686,NULL); -+ if (pcidev) { -+ spin_lock_irq(&driver_lock); -+ /* start config */ -+ pci_read_config_byte(pcidev,0x85,&confval); -+ confval |= 0x2; -+ pci_write_config_byte (pcidev, 0x85,confval); -+ /* activate high speed bits */ -+ outb(spcidx,confindex); /* set index */ -+ val = (unsigned char) inb(confdata); -+ val |= 0xC0; /* both ports on high speed*/ -+ outb (spcidx,confindex); -+ outb (val,confdata); -+ /*stop config*/ -+ confval &= ~0x2; -+ pci_write_config_byte(pcidev, 0x85, confval); -+ spin_unlock_irq(&driver_lock); -+ printk (KERN_INFO "VIA VT82C686[AB] serial port high speed enabled\n"); -+ } -+ else { -+ printk (KERN_INFO "Couldn't locate VIA chipset\n"); -+ return -ENODEV; -+ } -+ return 0; -+} -+ -+static void __exit viahss_exit(void) -+{ -+ struct pci_dev *pcidev = NULL; -+ unsigned char confval,val; -+ pcidev = pci_find_device (PCI_VENDOR_ID_VIA,PCI_DEVICE_ID_VIA_82C686,NULL); -+ if (pcidev) { -+ spin_lock_irq(&driver_lock); -+ /* start config */ -+ pci_read_config_byte(pcidev,0x85,&confval); -+ confval |= 0x2; -+ pci_write_config_byte (pcidev, 0x85,confval); -+ /* activate high speed bits */ -+ outb(spcidx,confindex); /* set index */ -+ val = (unsigned char) inb(confdata); -+ val &= ~0xC0; /* both ports off high speed*/ -+ outb (spcidx,confindex); -+ outb (val,confdata); -+ /*stop config*/ -+ confval &= ~0x2; -+ pci_write_config_byte(pcidev, 0x85, confval); -+ spin_unlock_irq(&driver_lock); -+ printk (KERN_INFO "VIA VT82C686[AB] serial port high speed disabled\n"); -+ } -+} -+ -+module_init(viahss_init); -+module_exit(viahss_exit); -+MODULE_DESCRIPTION("VIA VT82C686[AB] high speed serial port enabler"); -+MODULE_AUTHOR("Juhani Rautiainen "); diff --git a/kernel/kernel/files/patches/mageia/3rd-viahss-2.6.35-buildfix.patch b/kernel/kernel/files/patches/mageia/3rd-viahss-2.6.35-buildfix.patch deleted file mode 100644 index 5ae42e92..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-viahss-2.6.35-buildfix.patch +++ /dev/null @@ -1,20 +0,0 @@ ---- linux-2.6.35-rc6-git-mnb0.1/3rdparty/viahss/viahss.c.orig 2010-07-30 21:17:30.000000000 +0300 -+++ linux-2.6.35-rc6-git-mnb0.1/3rdparty/viahss/viahss.c 2010-07-30 23:10:21.324978822 +0300 -@@ -25,7 +25,7 @@ static int __init viahss_init(void) - { - struct pci_dev *pcidev = NULL; - unsigned char confval,val; -- pcidev = pci_find_device (PCI_VENDOR_ID_VIA,PCI_DEVICE_ID_VIA_82C686,NULL); -+ pcidev = pci_get_device (PCI_VENDOR_ID_VIA,PCI_DEVICE_ID_VIA_82C686,NULL); - if (pcidev) { - spin_lock_irq(&driver_lock); - /* start config */ -@@ -55,7 +55,7 @@ static void __exit viahss_exit(void) - { - struct pci_dev *pcidev = NULL; - unsigned char confval,val; -- pcidev = pci_find_device (PCI_VENDOR_ID_VIA,PCI_DEVICE_ID_VIA_82C686,NULL); -+ pcidev = pci_get_device (PCI_VENDOR_ID_VIA,PCI_DEVICE_ID_VIA_82C686,NULL); - if (pcidev) { - spin_lock_irq(&driver_lock); - /* start config */ diff --git a/kernel/kernel/files/patches/mageia/3rd-viahss-3.0-buildfix.patch b/kernel/kernel/files/patches/mageia/3rd-viahss-3.0-buildfix.patch deleted file mode 100644 index 7db73881..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-viahss-3.0-buildfix.patch +++ /dev/null @@ -1,19 +0,0 @@ - -fix build with 3.0 - -Signed-off-by: Thomas Backlund - - 3rdparty/viahss/viahss.c | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - ---- a/3rdparty/viahss/viahss.c.orig 2011-07-15 02:37:27.000000000 +0300 -+++ a/3rdparty/viahss/viahss.c 2011-07-15 13:48:13.204291256 +0300 -@@ -19,7 +19,7 @@ - const unsigned short confindex=0x3F0,confdata=0x3F1; - const unsigned char spcidx=0xEE; - --spinlock_t driver_lock = SPIN_LOCK_UNLOCKED; -+DEFINE_SPINLOCK(driver_lock); - - static int __init viahss_init(void) - { diff --git a/kernel/kernel/files/patches/mageia/3rd-viahss-config.patch b/kernel/kernel/files/patches/mageia/3rd-viahss-config.patch deleted file mode 100644 index 0d1bdbd3..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-viahss-config.patch +++ /dev/null @@ -1,18 +0,0 @@ -linux/config.h is gone in 2.6.21 - ---- - 3rdparty/viahss/viahss.c | 1 0 + 1 - 0 ! - 1 files changed, 1 deletion(-) - -Index: linux-2.6.21/3rdparty/viahss/viahss.c -=================================================================== ---- linux-2.6.21.orig/3rdparty/viahss/viahss.c 2003-07-17 08:49:59.000000000 +0200 -+++ linux-2.6.21/3rdparty/viahss/viahss.c 2007-05-14 17:06:56.000000000 +0200 -@@ -12,7 +12,6 @@ - */ - - #include --#include - #include - #include - #include diff --git a/kernel/kernel/files/patches/mageia/3rd-viahss-module-license.patch b/kernel/kernel/files/patches/mageia/3rd-viahss-module-license.patch deleted file mode 100644 index 540538f2..00000000 --- a/kernel/kernel/files/patches/mageia/3rd-viahss-module-license.patch +++ /dev/null @@ -1,7 +0,0 @@ ---- linux-2.6.25/3rdparty/viahss/viahss.c.orig 2008-06-28 22:50:05.000000000 +0300 -+++ linux-2.6.25/3rdparty/viahss/viahss.c 2008-06-29 14:26:55.000000000 +0300 -@@ -80,3 +80,4 @@ module_init(viahss_init); - module_exit(viahss_exit); - MODULE_DESCRIPTION("VIA VT82C686[AB] high speed serial port enabler"); - MODULE_AUTHOR("Juhani Rautiainen "); -+MODULE_LICENSE("GPL"); diff --git a/kernel/kernel/files/patches/mageia/3rdparty.series b/kernel/kernel/files/patches/mageia/3rdparty.series deleted file mode 100644 index 17ace736..00000000 --- a/kernel/kernel/files/patches/mageia/3rdparty.series +++ /dev/null @@ -1,3 +0,0 @@ -# Mageia SVN does not like binaries in /packages tree -# it can still be used for out ov svn builds - diff --git a/kernel/kernel/files/patches/mageia/ACPI-video-Add-a-quirk-to-force-acpi-video-backlight.patch b/kernel/kernel/files/patches/mageia/ACPI-video-Add-a-quirk-to-force-acpi-video-backlight.patch deleted file mode 100644 index ff64a1e1..00000000 --- a/kernel/kernel/files/patches/mageia/ACPI-video-Add-a-quirk-to-force-acpi-video-backlight.patch +++ /dev/null @@ -1,40 +0,0 @@ -From 61f9738d65094a6b18d22c7beb6bb8c3dc0606b9 Mon Sep 17 00:00:00 2001 -From: Hans de Goede -Date: Mon, 26 Oct 2015 15:20:46 +0100 -Subject: [PATCH] ACPI / video: Add a quirk to force acpi-video backlight on - Dell XPS L421X - -Just like the Dell XPS 15 (L521X) the Dell XPS 14 (L421X) needs to use -the acpi-video backlight interface rather then the native one for backlight -control to work, add a quirk for this. - -Link: https://bugzilla.redhat.com/show_bug.cgi?id=1272633 -Signed-off-by: Hans de Goede -Signed-off-by: Rafael J. Wysocki ---- - drivers/acpi/video_detect.c | 9 +++++++++ - 1 file changed, 9 insertions(+) - -diff --git a/drivers/acpi/video_detect.c b/drivers/acpi/video_detect.c -index 0d3a384..daaf1c4 100644 ---- a/drivers/acpi/video_detect.c -+++ b/drivers/acpi/video_detect.c -@@ -233,6 +233,15 @@ static const struct dmi_system_id video_detect_dmi_table[] = { - }, - }, - { -+ /* https://bugzilla.redhat.com/show_bug.cgi?id=1272633 */ -+ .callback = video_detect_force_video, -+ .ident = "Dell XPS14 L421X", -+ .matches = { -+ DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."), -+ DMI_MATCH(DMI_PRODUCT_NAME, "XPS L421X"), -+ }, -+ }, -+ { - /* https://bugzilla.redhat.com/show_bug.cgi?id=1163574 */ - .callback = video_detect_force_video, - .ident = "Dell XPS15 L521X", --- -2.3.10 - diff --git a/kernel/kernel/files/patches/mageia/PCI-Add-function-1-DMA-alias-quirk-for-Highpoint-RocketRAID-644L.patch b/kernel/kernel/files/patches/mageia/PCI-Add-function-1-DMA-alias-quirk-for-Highpoint-RocketRAID-644L.patch deleted file mode 100644 index b3c56fe0..00000000 --- a/kernel/kernel/files/patches/mageia/PCI-Add-function-1-DMA-alias-quirk-for-Highpoint-RocketRAID-644L.patch +++ /dev/null @@ -1,34 +0,0 @@ -From: Hans de Goede -Subject: [PATCH 2/2] PCI: Add function 1 DMA alias quirk for Highpoint RocketRAID 644L -Date: Fri, 2 Mar 2018 11:36:33 +0100 - -The Highpoint RocketRAID 644L uses a Marvel 88SE9235 controller, as with -other Marvel controllers this needs a function 1 DMA alias quirk. - -Note the RocketRAID 642L uses the same Marvel 88SE9235 controller and -already is listed with a function 1 DMA alias quirk. - -Cc: stable@vger.kernel.org -BugLink: https://bugzilla.redhat.com/show_bug.cgi?id=1534106 -Signed-off-by: Hans de Goede ---- - drivers/pci/quirks.c | 2 ++ - 1 file changed, 2 insertions(+) - -diff --git a/drivers/pci/quirks.c b/drivers/pci/quirks.c -index 8b14bd326d4a..46d47bd6ca1f 100644 ---- a/drivers/pci/quirks.c -+++ b/drivers/pci/quirks.c -@@ -3908,6 +3908,8 @@ DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_MARVELL_EXT, 0x9230, - quirk_dma_func1_alias); - DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_TTI, 0x0642, - quirk_dma_func1_alias); -+DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_TTI, 0x0645, -+ quirk_dma_func1_alias); - /* https://bugs.gentoo.org/show_bug.cgi?id=497630 */ - DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_JMICRON, - PCI_DEVICE_ID_JMICRON_JMB388_ESD, --- -2.14.3 - - diff --git a/kernel/kernel/files/patches/mageia/Revert-cpufreq-pcc-Enable-autoload-of-pcc-cpufreq-fo.patch b/kernel/kernel/files/patches/mageia/Revert-cpufreq-pcc-Enable-autoload-of-pcc-cpufreq-fo.patch deleted file mode 100644 index c3fffdfa..00000000 --- a/kernel/kernel/files/patches/mageia/Revert-cpufreq-pcc-Enable-autoload-of-pcc-cpufreq-fo.patch +++ /dev/null @@ -1,32 +0,0 @@ -From 88299efb05387c2c94120fdc9661aab2ec3a1ad8 Mon Sep 17 00:00:00 2001 -From: Thomas Backlund -Date: Fri, 3 Apr 2015 00:10:34 +0259 -Subject: [PATCH] Revert "cpufreq: pcc: Enable autoload of pcc-cpufreq for ACPI - processors" - -This reverts commit 7e7e8fe69820c6fa31395dbbd8e348e3c69cd2a9. ---- - drivers/cpufreq/pcc-cpufreq.c | 7 ------- - 1 file changed, 7 deletions(-) - -diff --git a/drivers/cpufreq/pcc-cpufreq.c b/drivers/cpufreq/pcc-cpufreq.c -index 2a0d589..4d2c8e8 100644 ---- a/drivers/cpufreq/pcc-cpufreq.c -+++ b/drivers/cpufreq/pcc-cpufreq.c -@@ -603,13 +603,6 @@ static void __exit pcc_cpufreq_exit(void) - free_percpu(pcc_cpu_info); - } - --static const struct acpi_device_id processor_device_ids[] = { -- {ACPI_PROCESSOR_OBJECT_HID, }, -- {ACPI_PROCESSOR_DEVICE_HID, }, -- {}, --}; --MODULE_DEVICE_TABLE(acpi, processor_device_ids); -- - MODULE_AUTHOR("Matthew Garrett, Naga Chumbalkar"); - MODULE_VERSION(PCC_VERSION); - MODULE_DESCRIPTION("Processor Clocking Control interface driver"); --- -2.3.1 - diff --git a/kernel/kernel/files/patches/mageia/acpi-CLEVO-M360S-disable_acpi_irq.patch b/kernel/kernel/files/patches/mageia/acpi-CLEVO-M360S-disable_acpi_irq.patch deleted file mode 100644 index 1ac3254c..00000000 --- a/kernel/kernel/files/patches/mageia/acpi-CLEVO-M360S-disable_acpi_irq.patch +++ /dev/null @@ -1,28 +0,0 @@ -Subject: CLEVO M360S acpi irq workaround - -Some Hardware vendor use CLEVO M360S Laptop OEM. -This acpi IRQ routing is not correct. we use normal IRQ routing for default. - -Signed-off-by: Go Taniguchi - ---- - arch/x86/kernel/acpi/boot.c | 8 ++++++++ - 1 file changed, 8 insertions(+) - ---- a/arch/x86/kernel/acpi/boot.c -+++ b/arch/x86/kernel/acpi/boot.c -@@ -1615,6 +1615,14 @@ static struct dmi_system_id __initdata a - }, - }, - { -+ .callback = disable_acpi_irq, -+ .ident = "CLEVO M360S", -+ .matches = { -+ DMI_MATCH(DMI_SYS_VENDOR, "CLEVO Co."), -+ DMI_MATCH(DMI_PRODUCT_NAME, "M360S"), -+ }, -+ }, -+ { - /* - * Latest BIOS for IBM 600E (1.16) has bad pcinum - * for LPC bridge, which is needed for the PCI diff --git a/kernel/kernel/files/patches/mageia/acpi-ec-restore-polling-during-noirq-suspend_resume-phases.patch b/kernel/kernel/files/patches/mageia/acpi-ec-restore-polling-during-noirq-suspend_resume-phases.patch deleted file mode 100644 index df41e9dc..00000000 --- a/kernel/kernel/files/patches/mageia/acpi-ec-restore-polling-during-noirq-suspend_resume-phases.patch +++ /dev/null @@ -1,49 +0,0 @@ -From: "Rafael J. Wysocki" -Subject: [PATCH] ACPI / EC: Restore polling during noirq suspend/resume phases -Date: Fri, 09 Feb 2018 22:55:28 +0100 - -From: Rafael J. Wysocki - -Commit 662591461c4b (ACPI / EC: Drop EC noirq hooks to fix a -regression) modified the ACPI EC driver so that it doesn't switch -over to busy polling mode during noirq stages of system suspend and -resume in an attempt to fix an issue resulting from that behavior. - -However, that modification introduced a system resume regression on -Thinkpad X240, so make the EC driver switch over to the polling mode -during noirq stages of system suspend and resume again, which -effectively reverts the problematic commit. - -Fixes: 662591461c4b (ACPI / EC: Drop EC noirq hooks to fix a regression) -Link: https://bugzilla.kernel.org/show_bug.cgi?id=197863 -Reported-by: Markus Demleitner -Tested-by: Markus Demleitner -Signed-off-by: Rafael J. Wysocki ---- - drivers/acpi/ec.c | 6 ++++++ - 1 file changed, 6 insertions(+) - -Index: linux-pm/drivers/acpi/ec.c -=================================================================== ---- linux-pm.orig/drivers/acpi/ec.c -+++ linux-pm/drivers/acpi/ec.c -@@ -1927,6 +1927,9 @@ static int acpi_ec_suspend_noirq(struct - ec->reference_count >= 1) - acpi_set_gpe(NULL, ec->gpe, ACPI_GPE_DISABLE); - -+ if (acpi_sleep_no_ec_events()) -+ acpi_ec_enter_noirq(ec); -+ - return 0; - } - -@@ -1934,6 +1937,9 @@ static int acpi_ec_resume_noirq(struct d - { - struct acpi_ec *ec = acpi_driver_data(to_acpi_device(dev)); - -+ if (acpi_sleep_no_ec_events()) -+ acpi_ec_leave_noirq(ec); -+ - if (ec_no_wakeup && test_bit(EC_FLAGS_STARTED, &ec->flags) && - ec->reference_count >= 1) - acpi_set_gpe(NULL, ec->gpe, ACPI_GPE_ENABLE); diff --git a/kernel/kernel/files/patches/mageia/acpi-processor-M720SR-limit-to-C2.patch b/kernel/kernel/files/patches/mageia/acpi-processor-M720SR-limit-to-C2.patch deleted file mode 100644 index a3608628..00000000 --- a/kernel/kernel/files/patches/mageia/acpi-processor-M720SR-limit-to-C2.patch +++ /dev/null @@ -1,21 +0,0 @@ -Limit Clevo M720SR to C2, going to C3 makes the machine freeze. This -needs more investigation, sis chipset/bios problem may be? - -Signed-off-by: Herton Ronaldo Krzesinski - ---- - drivers/acpi/processor_idle.c | 3 +++ - 1 file changed, 3 insertions(+) - ---- linux-2.6.33-rc8-git4-t2/drivers/acpi/processor_idle.c.orig 2010-02-20 12:45:35.000000000 +0200 -+++ linux-2.6.33-rc8-git4-t2/drivers/acpi/processor_idle.c 2010-02-20 12:53:39.679099592 +0200 -@@ -110,6 +110,9 @@ static struct dmi_system_id __cpuinitdat - DMI_MATCH(DMI_BIOS_VENDOR,"Phoenix Technologies LTD"), - DMI_MATCH(DMI_BIOS_VERSION,"SHE845M0.86C.0013.D.0302131307")}, - (void *)2}, -+ { set_max_cstate, "Clevo M720SR", { -+ DMI_MATCH(DMI_BIOS_VENDOR,"Phoenix Technologies LTD"), -+ DMI_MATCH(DMI_PRODUCT_NAME,"M720SR")}, (void *)2}, - { set_max_cstate, "Pavilion zv5000", { - DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"), - DMI_MATCH(DMI_PRODUCT_NAME,"Pavilion zv5000 (DS502A#ABA)")}, diff --git a/kernel/kernel/files/patches/mageia/arch-ARM-omap2-hide-omap3_save_secure_ram-on-non-OMAP3-bu.patch b/kernel/kernel/files/patches/mageia/arch-ARM-omap2-hide-omap3_save_secure_ram-on-non-OMAP3-bu.patch deleted file mode 100644 index e2783603..00000000 --- a/kernel/kernel/files/patches/mageia/arch-ARM-omap2-hide-omap3_save_secure_ram-on-non-OMAP3-bu.patch +++ /dev/null @@ -1,46 +0,0 @@ -From 863204cfdae98626a92535ac928ad79f4d6b74ff Mon Sep 17 00:00:00 2001 -From: Arnd Bergmann -Date: Wed, 6 Dec 2017 14:17:17 +0100 -Subject: [PATCH] ARM: omap2: hide omap3_save_secure_ram on non-OMAP3 builds - -In configurations without CONFIG_OMAP3 but with secure RAM support, -we now run into a link failure: - -arch/arm/mach-omap2/omap-secure.o: In function `omap3_save_secure_ram': -omap-secure.c:(.text+0x130): undefined reference to `save_secure_ram_context' - -The omap3_save_secure_ram() function is only called from the OMAP34xx -power management code, so we can simply hide that function in the -appropriate #ifdef. - -Fixes: d09220a887f7 ("ARM: OMAP2+: Fix SRAM virt to phys translation for save_secure_ram_context") -Acked-by: Tony Lindgren -Tested-by: Dan Murphy -Signed-off-by: Arnd Bergmann ---- - arch/arm/mach-omap2/omap-secure.c | 2 ++ - 1 file changed, 2 insertions(+) - -diff --git a/arch/arm/mach-omap2/omap-secure.c b/arch/arm/mach-omap2/omap-secure.c -index 9ff92050053c..fa7f308c9027 100644 ---- a/arch/arm/mach-omap2/omap-secure.c -+++ b/arch/arm/mach-omap2/omap-secure.c -@@ -73,6 +73,7 @@ phys_addr_t omap_secure_ram_mempool_base(void) - return omap_secure_memblock_base; - } - -+#if defined(CONFIG_ARCH_OMAP3) && defined(CONFIG_PM) - u32 omap3_save_secure_ram(void __iomem *addr, int size) - { - u32 ret; -@@ -91,6 +92,7 @@ u32 omap3_save_secure_ram(void __iomem *addr, int size) - - return ret; - } -+#endif - - /** - * rx51_secure_dispatcher: Routine to dispatch secure PPA API calls --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/ata-ahci-Add-PCI-id-for-the-Highpoint-Rocketraid-644L-card.patch b/kernel/kernel/files/patches/mageia/ata-ahci-Add-PCI-id-for-the-Highpoint-Rocketraid-644L-card.patch deleted file mode 100644 index cf6a1a2c..00000000 --- a/kernel/kernel/files/patches/mageia/ata-ahci-Add-PCI-id-for-the-Highpoint-Rocketraid-644L-card.patch +++ /dev/null @@ -1,37 +0,0 @@ -From: Hans de Goede -Subject: [PATCH 1/2] ahci: Add PCI-id for the Highpoint Rocketraid 644L card -Date: Fri, 2 Mar 2018 11:36:32 +0100 - -Like the Highpoint Rocketraid 642L and cards using a Marvel 88SE9235 -controller in general, this RAID card also supports AHCI mode and short -of a custom driver, this is the only way to make it work under Linux. - -Note that even though the card is called to 644L, it has a product-id -of 0x0645. - -Cc: stable@vger.kernel.org -BugLink: https://bugzilla.redhat.com/show_bug.cgi?id=1534106 -Signed-off-by: Hans de Goede ---- - drivers/ata/ahci.c | 4 +++- - 1 file changed, 3 insertions(+), 1 deletion(-) - -diff --git a/drivers/ata/ahci.c b/drivers/ata/ahci.c -index 355a95a83a34..1ff17799769d 100644 ---- a/drivers/ata/ahci.c -+++ b/drivers/ata/ahci.c -@@ -550,7 +550,9 @@ static const struct pci_device_id ahci_pci_tbl[] = { - .driver_data = board_ahci_yes_fbs }, - { PCI_DEVICE(PCI_VENDOR_ID_MARVELL_EXT, 0x9230), - .driver_data = board_ahci_yes_fbs }, -- { PCI_DEVICE(PCI_VENDOR_ID_TTI, 0x0642), -+ { PCI_DEVICE(PCI_VENDOR_ID_TTI, 0x0642), /* highpoint rocketraid 642L */ -+ .driver_data = board_ahci_yes_fbs }, -+ { PCI_DEVICE(PCI_VENDOR_ID_TTI, 0x0645), /* highpoint rocketraid 644L */ - .driver_data = board_ahci_yes_fbs }, - - /* Promise */ --- -2.14.3 - - diff --git a/kernel/kernel/files/patches/mageia/ata-prefer-ata-drivers-over-ide-drivers-when-both-are-built.patch b/kernel/kernel/files/patches/mageia/ata-prefer-ata-drivers-over-ide-drivers-when-both-are-built.patch deleted file mode 100644 index 8ba0f029..00000000 --- a/kernel/kernel/files/patches/mageia/ata-prefer-ata-drivers-over-ide-drivers-when-both-are-built.patch +++ /dev/null @@ -1,34 +0,0 @@ ->From 9f04e51293b130474504216a477bb2a73cbf59e1 Mon Sep 17 00:00:00 2001 -From: Anssi Hannula -Date: Thu, 22 Mar 2012 22:29:11 +0200 -Subject: [PATCH] ata: prefer ata drivers over ide drivers when both are built - -Currently the old IDE drivers are preferred over ATA drivers when both -are built, since ide/ is listed first in drivers/Makefile and therefore -the IDE drivers end up before ATA drivers in modules.order which is used -by depmod/modprobe for module ordering. - -Change it so that ATA drivers are preferred over IDE driver by moving -the ide/ entry under ata/ in drivers/Makefile. - -Signed-off-by: Anssi Hannula ---- - drivers/Makefile | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - -diff --git a/drivers/Makefile b/drivers/Makefile -index 932e8bf..e8df3d0 100644 ---- a/drivers/Makefile -+++ b/drivers/Makefile -@@ -69,10 +69,10 @@ obj-$(CONFIG_LIBNVDIMM) += nvdimm/ - obj-$(CONFIG_DMA_SHARED_BUFFER) += dma-buf/ - obj-$(CONFIG_NUBUS) += nubus/ - obj-y += macintosh/ --obj-$(CONFIG_IDE) += ide/ - obj-$(CONFIG_SCSI) += scsi/ - obj-y += nvme/ - obj-$(CONFIG_ATA) += ata/ -+obj-$(CONFIG_IDE) += ide/ - obj-$(CONFIG_TARGET_CORE) += target/ - obj-$(CONFIG_MTD) += mtd/ - obj-$(CONFIG_SPI) += spi/ diff --git a/kernel/kernel/files/patches/mageia/block-bfq-add-missing-invocations-of-bfqg_stats_upda.patch b/kernel/kernel/files/patches/mageia/block-bfq-add-missing-invocations-of-bfqg_stats_upda.patch deleted file mode 100644 index 91c92f0b..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-add-missing-invocations-of-bfqg_stats_upda.patch +++ /dev/null @@ -1,107 +0,0 @@ -From 614822f81f606e0064acdae11d9ec1efd3db4190 Mon Sep 17 00:00:00 2001 -From: Luca Miccio -Date: Mon, 13 Nov 2017 07:34:08 +0100 -Subject: [PATCH] block, bfq: add missing invocations of - bfqg_stats_update_io_add/remove - -bfqg_stats_update_io_add and bfqg_stats_update_io_remove are to be -invoked, respectively, when an I/O request enters and when an I/O -request exits the scheduler. Unfortunately, bfq does not fully comply -with this scheme, because it does not invoke these functions for -requests that are inserted into or extracted from its priority -dispatch list. This commit fixes this mistake. - -Tested-by: Lee Tibbert -Tested-by: Oleksandr Natalenko -Signed-off-by: Paolo Valente -Signed-off-by: Luca Miccio -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 21 ++++++++++++++++++--- - 1 file changed, 18 insertions(+), 3 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 889a8549d97f..91703eba63f0 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -1359,7 +1359,6 @@ static void bfq_bfqq_handle_idle_busy_switch(struct bfq_data *bfqd, - bfqq->ttime.last_end_request + - bfqd->bfq_slice_idle * 3; - -- bfqg_stats_update_io_add(bfqq_group(RQ_BFQQ(rq)), bfqq, rq->cmd_flags); - - /* - * bfqq deserves to be weight-raised if: -@@ -1633,7 +1632,6 @@ static void bfq_remove_request(struct request_queue *q, - if (rq->cmd_flags & REQ_META) - bfqq->meta_pending--; - -- bfqg_stats_update_io_remove(bfqq_group(bfqq), rq->cmd_flags); - } - - static bool bfq_bio_merge(struct blk_mq_hw_ctx *hctx, struct bio *bio) -@@ -1746,6 +1744,7 @@ static void bfq_requests_merged(struct request_queue *q, struct request *rq, - bfqq->next_rq = rq; - - bfq_remove_request(q, next); -+ bfqg_stats_update_io_remove(bfqq_group(bfqq), next->cmd_flags); - - spin_unlock_irq(&bfqq->bfqd->lock); - end: -@@ -3700,6 +3699,9 @@ static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) - spin_lock_irq(&bfqd->lock); - - rq = __bfq_dispatch_request(hctx); -+ if (rq && RQ_BFQQ(rq)) -+ bfqg_stats_update_io_remove(bfqq_group(RQ_BFQQ(rq)), -+ rq->cmd_flags); - spin_unlock_irq(&bfqd->lock); - - return rq; -@@ -4224,6 +4226,7 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - { - struct request_queue *q = hctx->queue; - struct bfq_data *bfqd = q->elevator->elevator_data; -+ struct bfq_queue *bfqq = RQ_BFQQ(rq); - - spin_lock_irq(&bfqd->lock); - if (blk_mq_sched_try_insert_merge(q, rq)) { -@@ -4243,6 +4246,12 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - list_add_tail(&rq->queuelist, &bfqd->dispatch); - } else { - __bfq_insert_request(bfqd, rq); -+ /* -+ * Update bfqq, because, if a queue merge has occurred -+ * in __bfq_insert_request, then rq has been -+ * redirected into a new queue. -+ */ -+ bfqq = RQ_BFQQ(rq); - - if (rq_mergeable(rq)) { - elv_rqhash_add(q, rq); -@@ -4251,6 +4260,9 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - } - } - -+ if (bfqq) -+ bfqg_stats_update_io_add(bfqq_group(bfqq), bfqq, rq->cmd_flags); -+ - spin_unlock_irq(&bfqd->lock); - } - -@@ -4428,8 +4440,11 @@ static void bfq_finish_request(struct request *rq) - * lock is held. - */ - -- if (!RB_EMPTY_NODE(&rq->rb_node)) -+ if (!RB_EMPTY_NODE(&rq->rb_node)) { - bfq_remove_request(rq->q, rq); -+ bfqg_stats_update_io_remove(bfqq_group(bfqq), -+ rq->cmd_flags); -+ } - bfq_put_rq_priv_body(bfqq); - } - --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-add-missing-rq_pos_tree-update-on-rq-remov.patch b/kernel/kernel/files/patches/mageia/block-bfq-add-missing-rq_pos_tree-update-on-rq-remov.patch deleted file mode 100644 index addcb7ac..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-add-missing-rq_pos_tree-update-on-rq-remov.patch +++ /dev/null @@ -1,41 +0,0 @@ -From 05e90283561648301e30232fe0c91bd345ceba03 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Wed, 20 Dec 2017 12:38:31 +0100 -Subject: [PATCH] block, bfq: add missing rq_pos_tree update on rq removal - -If two processes do I/O close to each other, then BFQ merges the -bfq_queues associated with these processes, to get a more sequential -I/O, and thus a higher throughput. In this respect, to detect whether -two processes are doing I/O close to each other, BFQ keeps a list of -the head-of-line I/O requests of all active bfq_queues. The list is -ordered by initial sectors, and implemented through a red-black tree -(rq_pos_tree). - -Unfortunately, the update of the rq_pos_tree was incomplete, because -the tree was not updated on the removal of the head-of-line I/O -request of a bfq_queue, in case the queue did not remain empty. This -commit adds the missing update. - -Signed-off-by: Paolo Valente -Signed-off-by: Angelo Ruocco -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 2 ++ - 1 file changed, 2 insertions(+) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 0f48583b9380..fa395a260a23 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -1627,6 +1627,8 @@ static void bfq_remove_request(struct request_queue *q, - rb_erase(&bfqq->pos_node, bfqq->pos_root); - bfqq->pos_root = NULL; - } -+ } else { -+ bfq_pos_tree_add_move(bfqd, bfqq); - } - - if (rq->cmd_flags & REQ_META) --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-add-requeue-request-hook.patch b/kernel/kernel/files/patches/mageia/block-bfq-add-requeue-request-hook.patch deleted file mode 100644 index c963b98f..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-add-requeue-request-hook.patch +++ /dev/null @@ -1,224 +0,0 @@ -From a7877390614770965a6925dfed79cbd3eeeb61e0 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Wed, 7 Feb 2018 22:19:20 +0100 -Subject: [PATCH] block, bfq: add requeue-request hook - -Commit 'a6a252e64914 ("blk-mq-sched: decide how to handle flush rq via -RQF_FLUSH_SEQ")' makes all non-flush re-prepared requests for a device -be re-inserted into the active I/O scheduler for that device. As a -consequence, I/O schedulers may get the same request inserted again, -even several times, without a finish_request invoked on that request -before each re-insertion. - -This fact is the cause of the failure reported in [1]. For an I/O -scheduler, every re-insertion of the same re-prepared request is -equivalent to the insertion of a new request. For schedulers like -mq-deadline or kyber, this fact causes no harm. In contrast, it -confuses a stateful scheduler like BFQ, which keeps state for an I/O -request, until the finish_request hook is invoked on the request. In -particular, BFQ may get stuck, waiting forever for the number of -request dispatches, of the same request, to be balanced by an equal -number of request completions (while there will be one completion for -that request). In this state, BFQ may refuse to serve I/O requests -from other bfq_queues. The hang reported in [1] then follows. - -However, the above re-prepared requests undergo a requeue, thus the -requeue_request hook of the active elevator is invoked for these -requests, if set. This commit then addresses the above issue by -properly implementing the hook requeue_request in BFQ. - -[1] https://marc.info/?l=linux-block&m=151211117608676 - -Reported-by: Ivan Kozik -Reported-by: Alban Browaeys -Tested-by: Mike Galbraith -Signed-off-by: Paolo Valente -Signed-off-by: Serena Ziviani -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 107 ++++++++++++++++++++++++++++++++++++++++------------ - 1 file changed, 82 insertions(+), 25 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 47e6ec7427c4..aeca22d91101 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -3823,24 +3823,26 @@ static struct request *__bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) - } - - /* -- * We exploit the bfq_finish_request hook to decrement -- * rq_in_driver, but bfq_finish_request will not be -- * invoked on this request. So, to avoid unbalance, -- * just start this request, without incrementing -- * rq_in_driver. As a negative consequence, -- * rq_in_driver is deceptively lower than it should be -- * while this request is in service. This may cause -- * bfq_schedule_dispatch to be invoked uselessly. -+ * We exploit the bfq_finish_requeue_request hook to -+ * decrement rq_in_driver, but -+ * bfq_finish_requeue_request will not be invoked on -+ * this request. So, to avoid unbalance, just start -+ * this request, without incrementing rq_in_driver. As -+ * a negative consequence, rq_in_driver is deceptively -+ * lower than it should be while this request is in -+ * service. This may cause bfq_schedule_dispatch to be -+ * invoked uselessly. - * - * As for implementing an exact solution, the -- * bfq_finish_request hook, if defined, is probably -- * invoked also on this request. So, by exploiting -- * this hook, we could 1) increment rq_in_driver here, -- * and 2) decrement it in bfq_finish_request. Such a -- * solution would let the value of the counter be -- * always accurate, but it would entail using an extra -- * interface function. This cost seems higher than the -- * benefit, being the frequency of non-elevator-private -+ * bfq_finish_requeue_request hook, if defined, is -+ * probably invoked also on this request. So, by -+ * exploiting this hook, we could 1) increment -+ * rq_in_driver here, and 2) decrement it in -+ * bfq_finish_requeue_request. Such a solution would -+ * let the value of the counter be always accurate, -+ * but it would entail using an extra interface -+ * function. This cost seems higher than the benefit, -+ * being the frequency of non-elevator-private - * requests very low. - */ - goto start_rq; -@@ -4515,6 +4517,8 @@ static inline void bfq_update_insert_stats(struct request_queue *q, - unsigned int cmd_flags) {} - #endif - -+static void bfq_prepare_request(struct request *rq, struct bio *bio); -+ - static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - bool at_head) - { -@@ -4541,6 +4545,18 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - else - list_add_tail(&rq->queuelist, &bfqd->dispatch); - } else { -+ if (WARN_ON_ONCE(!bfqq)) { -+ /* -+ * This should never happen. Most likely rq is -+ * a requeued regular request, being -+ * re-inserted without being first -+ * re-prepared. Do a prepare, to avoid -+ * failure. -+ */ -+ bfq_prepare_request(rq, rq->bio); -+ bfqq = RQ_BFQQ(rq); -+ } -+ - idle_timer_disabled = __bfq_insert_request(bfqd, rq); - /* - * Update bfqq, because, if a queue merge has occurred -@@ -4697,22 +4713,44 @@ static void bfq_completed_request(struct bfq_queue *bfqq, struct bfq_data *bfqd) - bfq_schedule_dispatch(bfqd); - } - --static void bfq_finish_request_body(struct bfq_queue *bfqq) -+static void bfq_finish_requeue_request_body(struct bfq_queue *bfqq) - { - bfqq->allocated--; - - bfq_put_queue(bfqq); - } - --static void bfq_finish_request(struct request *rq) -+/* -+ * Handle either a requeue or a finish for rq. The things to do are -+ * the same in both cases: all references to rq are to be dropped. In -+ * particular, rq is considered completed from the point of view of -+ * the scheduler. -+ */ -+static void bfq_finish_requeue_request(struct request *rq) - { -- struct bfq_queue *bfqq; -+ struct bfq_queue *bfqq = RQ_BFQQ(rq); - struct bfq_data *bfqd; - -- if (!rq->elv.icq) -+ /* -+ * Requeue and finish hooks are invoked in blk-mq without -+ * checking whether the involved request is actually still -+ * referenced in the scheduler. To handle this fact, the -+ * following two checks make this function exit in case of -+ * spurious invocations, for which there is nothing to do. -+ * -+ * First, check whether rq has nothing to do with an elevator. -+ */ -+ if (unlikely(!(rq->rq_flags & RQF_ELVPRIV))) -+ return; -+ -+ /* -+ * rq either is not associated with any icq, or is an already -+ * requeued request that has not (yet) been re-inserted into -+ * a bfq_queue. -+ */ -+ if (!rq->elv.icq || !bfqq) - return; - -- bfqq = RQ_BFQQ(rq); - bfqd = bfqq->bfqd; - - if (rq->rq_flags & RQF_STARTED) -@@ -4727,13 +4765,14 @@ static void bfq_finish_request(struct request *rq) - spin_lock_irqsave(&bfqd->lock, flags); - - bfq_completed_request(bfqq, bfqd); -- bfq_finish_request_body(bfqq); -+ bfq_finish_requeue_request_body(bfqq); - - spin_unlock_irqrestore(&bfqd->lock, flags); - } else { - /* - * Request rq may be still/already in the scheduler, -- * in which case we need to remove it. And we cannot -+ * in which case we need to remove it (this should -+ * never happen in case of requeue). And we cannot - * defer such a check and removal, to avoid - * inconsistencies in the time interval from the end - * of this function to the start of the deferred work. -@@ -4748,9 +4787,26 @@ static void bfq_finish_request(struct request *rq) - bfqg_stats_update_io_remove(bfqq_group(bfqq), - rq->cmd_flags); - } -- bfq_finish_request_body(bfqq); -+ bfq_finish_requeue_request_body(bfqq); - } - -+ /* -+ * Reset private fields. In case of a requeue, this allows -+ * this function to correctly do nothing if it is spuriously -+ * invoked again on this same request (see the check at the -+ * beginning of the function). Probably, a better general -+ * design would be to prevent blk-mq from invoking the requeue -+ * or finish hooks of an elevator, for a request that is not -+ * referred by that elevator. -+ * -+ * Resetting the following fields would break the -+ * request-insertion logic if rq is re-inserted into a bfq -+ * internal queue, without a re-preparation. Here we assume -+ * that re-insertions of requeued requests, without -+ * re-preparation, can happen only for pass_through or at_head -+ * requests (which are not re-inserted into bfq internal -+ * queues). -+ */ - rq->elv.priv[0] = NULL; - rq->elv.priv[1] = NULL; - } -@@ -5426,7 +5482,8 @@ static struct elevator_type iosched_bfq_mq = { - .ops.mq = { - .limit_depth = bfq_limit_depth, - .prepare_request = bfq_prepare_request, -- .finish_request = bfq_finish_request, -+ .requeue_request = bfq_finish_requeue_request, -+ .finish_request = bfq_finish_requeue_request, - .exit_icq = bfq_exit_icq, - .insert_requests = bfq_insert_requests, - .dispatch_request = bfq_dispatch_request, --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-check-and-switch-back-to-interactive-wr-al.patch b/kernel/kernel/files/patches/mageia/block-bfq-check-and-switch-back-to-interactive-wr-al.patch deleted file mode 100644 index fa28c722..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-check-and-switch-back-to-interactive-wr-al.patch +++ /dev/null @@ -1,163 +0,0 @@ -From 3e2bdd6dff239afd8386e8758eee69ad61e5a3d6 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Thu, 21 Sep 2017 11:04:01 +0200 -Subject: [PATCH] block, bfq: check and switch back to interactive wr also on - queue split - -As already explained in the message of commit "block, bfq: fix -wrong init of saved start time for weight raising", if a soft -real-time weight-raising period happens to be nested in a larger -interactive weight-raising period, then BFQ restores the interactive -weight raising at the end of the soft real-time weight raising. In -particular, BFQ checks whether the latter has ended only on request -dispatches. - -Unfortunately, the above scheme fails to restore interactive weight -raising in the following corner case: if a bfq_queue, say Q, -1) Is merged with another bfq_queue while it is in a nested soft -real-time weight-raising period. The weight-raising state of Q is -then saved, and not considered any longer until a split occurs. -2) Is split from the other bfq_queue(s) at a time instant when its -soft real-time weight raising is already finished. -On the split, while resuming the previous, soft real-time -weight-raised state of the bfq_queue Q, BFQ checks whether the -current soft real-time weight-raising period is actually over. If so, -BFQ switches weight raising off for Q, *without* checking whether the -soft real-time period was actually nested in a non-yet-finished -interactive weight-raising period. - -This commit addresses this issue by adding the above missing check in -bfq_queue splits, and restoring interactive weight raising if needed. - -Signed-off-by: Paolo Valente -Tested-by: Angelo Ruocco -Tested-by: Mirko Montanari -Tested-by: Oleksandr Natalenko -Tested-by: Lee Tibbert -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 87 ++++++++++++++++++++++++++++++----------------------- - 1 file changed, 49 insertions(+), 38 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index c25955c25e03..33b63bc4a64b 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -724,6 +724,44 @@ static void bfq_updated_next_req(struct bfq_data *bfqd, - } - } - -+static unsigned int bfq_wr_duration(struct bfq_data *bfqd) -+{ -+ u64 dur; -+ -+ if (bfqd->bfq_wr_max_time > 0) -+ return bfqd->bfq_wr_max_time; -+ -+ dur = bfqd->RT_prod; -+ do_div(dur, bfqd->peak_rate); -+ -+ /* -+ * Limit duration between 3 and 13 seconds. Tests show that -+ * higher values than 13 seconds often yield the opposite of -+ * the desired result, i.e., worsen responsiveness by letting -+ * non-interactive and non-soft-real-time applications -+ * preserve weight raising for a too long time interval. -+ * -+ * On the other end, lower values than 3 seconds make it -+ * difficult for most interactive tasks to complete their jobs -+ * before weight-raising finishes. -+ */ -+ if (dur > msecs_to_jiffies(13000)) -+ dur = msecs_to_jiffies(13000); -+ else if (dur < msecs_to_jiffies(3000)) -+ dur = msecs_to_jiffies(3000); -+ -+ return dur; -+} -+ -+/* switch back from soft real-time to interactive weight raising */ -+static void switch_back_to_interactive_wr(struct bfq_queue *bfqq, -+ struct bfq_data *bfqd) -+{ -+ bfqq->wr_coeff = bfqd->bfq_wr_coeff; -+ bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); -+ bfqq->last_wr_start_finish = bfqq->wr_start_at_switch_to_srt; -+} -+ - static void - bfq_bfqq_resume_state(struct bfq_queue *bfqq, struct bfq_data *bfqd, - struct bfq_io_cq *bic, bool bfq_already_existing) -@@ -750,10 +788,16 @@ bfq_bfqq_resume_state(struct bfq_queue *bfqq, struct bfq_data *bfqd, - if (bfqq->wr_coeff > 1 && (bfq_bfqq_in_large_burst(bfqq) || - time_is_before_jiffies(bfqq->last_wr_start_finish + - bfqq->wr_cur_max_time))) { -- bfq_log_bfqq(bfqq->bfqd, bfqq, -- "resume state: switching off wr"); -- -- bfqq->wr_coeff = 1; -+ if (bfqq->wr_cur_max_time == bfqd->bfq_wr_rt_max_time && -+ !bfq_bfqq_in_large_burst(bfqq) && -+ time_is_after_eq_jiffies(bfqq->wr_start_at_switch_to_srt + -+ bfq_wr_duration(bfqd))) { -+ switch_back_to_interactive_wr(bfqq, bfqd); -+ } else { -+ bfqq->wr_coeff = 1; -+ bfq_log_bfqq(bfqq->bfqd, bfqq, -+ "resume state: switching off wr"); -+ } - } - - /* make sure weight will be updated, however we got here */ -@@ -1173,35 +1217,6 @@ static bool bfq_bfqq_update_budg_for_activation(struct bfq_data *bfqd, - return wr_or_deserves_wr; - } - --static unsigned int bfq_wr_duration(struct bfq_data *bfqd) --{ -- u64 dur; -- -- if (bfqd->bfq_wr_max_time > 0) -- return bfqd->bfq_wr_max_time; -- -- dur = bfqd->RT_prod; -- do_div(dur, bfqd->peak_rate); -- -- /* -- * Limit duration between 3 and 13 seconds. Tests show that -- * higher values than 13 seconds often yield the opposite of -- * the desired result, i.e., worsen responsiveness by letting -- * non-interactive and non-soft-real-time applications -- * preserve weight raising for a too long time interval. -- * -- * On the other end, lower values than 3 seconds make it -- * difficult for most interactive tasks to complete their jobs -- * before weight-raising finishes. -- */ -- if (dur > msecs_to_jiffies(13000)) -- dur = msecs_to_jiffies(13000); -- else if (dur < msecs_to_jiffies(3000)) -- dur = msecs_to_jiffies(3000); -- -- return dur; --} -- - /* - * Return the farthest future time instant according to jiffies - * macros. -@@ -3501,11 +3516,7 @@ static void bfq_update_wr_data(struct bfq_data *bfqd, struct bfq_queue *bfqq) - bfq_wr_duration(bfqd))) - bfq_bfqq_end_wr(bfqq); - else { -- /* switch back to interactive wr */ -- bfqq->wr_coeff = bfqd->bfq_wr_coeff; -- bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); -- bfqq->last_wr_start_finish = -- bfqq->wr_start_at_switch_to_srt; -+ switch_back_to_interactive_wr(bfqq, bfqd); - bfqq->entity.prio_changed = 1; - } - } --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-check-low_latency-flag-in-bfq_bfqq_save_st.patch b/kernel/kernel/files/patches/mageia/block-bfq-check-low_latency-flag-in-bfq_bfqq_save_st.patch deleted file mode 100644 index 3bd4379c..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-check-low_latency-flag-in-bfq_bfqq_save_st.patch +++ /dev/null @@ -1,48 +0,0 @@ -From 1be6e8a964ee9aa8d4daac523ce29e5f486dd756 Mon Sep 17 00:00:00 2001 -From: Angelo Ruocco -Date: Wed, 20 Dec 2017 12:38:32 +0100 -Subject: [PATCH] block, bfq: check low_latency flag in bfq_bfqq_save_state() - -A just-created bfq_queue will certainly be deemed as interactive on -the arrival of its first I/O request, if the low_latency flag is -set. Yet, if the queue is merged with another queue on the arrival of -its first I/O request, it will not have the chance to be flagged as -interactive. Nevertheless, if the queue is then split soon enough, it -has to be flagged as interactive after the split. - -To handle this early-merge scenario correctly, BFQ saves the state of -the queue, on the merge, as if the latter had already been deemed -interactive. So, if the queue is split soon, it will get -weight-raised, because the previous state of the queue is resumed on -the split. - -Unfortunately, in the act of saving the state of the newly-created -queue, BFQ doesn't check whether the low_latency flag is set, and this -causes early-merged queues to be then weight-raised, on queue splits, -even if low_latency is off. This commit addresses this problem by -adding the missing check. - -Signed-off-by: Angelo Ruocco -Signed-off-by: Paolo Valente -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 3 ++- - 1 file changed, 2 insertions(+), 1 deletion(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index fa395a260a23..2cf395daee80 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -2064,7 +2064,8 @@ static void bfq_bfqq_save_state(struct bfq_queue *bfqq) - bic->saved_in_large_burst = bfq_bfqq_in_large_burst(bfqq); - bic->was_in_burst_list = !hlist_unhashed(&bfqq->burst_list_node); - if (unlikely(bfq_bfqq_just_created(bfqq) && -- !bfq_bfqq_in_large_burst(bfqq))) { -+ !bfq_bfqq_in_large_burst(bfqq) && -+ bfqq->bfqd->low_latency)) { - /* - * bfqq being merged right after being created: bfqq - * would have deserved interactive weight raising, but --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-consider-also-past-I-O-in-soft-real-time-d.patch b/kernel/kernel/files/patches/mageia/block-bfq-consider-also-past-I-O-in-soft-real-time-d.patch deleted file mode 100644 index 987378a9..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-consider-also-past-I-O-in-soft-real-time-d.patch +++ /dev/null @@ -1,206 +0,0 @@ -From a34b024448eb71b0e51ad011fa1862236e366034 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Fri, 15 Dec 2017 07:23:12 +0100 -Subject: [PATCH] block, bfq: consider also past I/O in soft real-time - detection - -BFQ privileges the I/O of soft real-time applications, such as video -players, to guarantee to these application a high bandwidth and a low -latency. In this respect, it is not easy to correctly detect when an -application is soft real-time. A particularly nasty false positive is -that of an I/O-bound application that occasionally happens to meet all -requirements to be deemed as soft real-time. After being detected as -soft real-time, such an application monopolizes the device. Fortunately, -BFQ will realize soon that the application is actually not soft -real-time and suspend every privilege. Yet, the application may happen -again to be wrongly detected as soft real-time, and so on. - -As highlighted by our tests, this problem causes BFQ to occasionally -fail to guarantee a high responsiveness, in the presence of heavy -background I/O workloads. The reason is that the background workload -happens to be detected as soft real-time, more or less frequently, -during the execution of the interactive task under test. To give an -idea, because of this problem, Libreoffice Writer occasionally takes 8 -seconds, instead of 3, to start up, if there are sequential reads and -writes in the background, on a Kingston SSDNow V300. - -This commit addresses this issue by leveraging the following facts. - -The reason why some applications are detected as soft real-time despite -all BFQ checks to avoid false positives, is simply that, during high -CPU or storage-device load, I/O-bound applications may happen to do -I/O slowly enough to meet all soft real-time requirements, and pass -all BFQ extra checks. Yet, this happens only for limited time periods: -slow-speed time intervals are usually interspersed between other time -intervals during which these applications do I/O at a very high speed. -To exploit these facts, this commit introduces a little change, in the -detection of soft real-time behavior, to systematically consider also -the recent past: the higher the speed was in the recent past, the -later next I/O should arrive for the application to be considered as -soft real-time. At the beginning of a slow-speed interval, the minimum -arrival time allowed for the next I/O usually happens to still be so -high, to fall *after* the end of the slow-speed period itself. As a -consequence, the application does not risk to be deemed as soft -real-time during the slow-speed interval. Then, during the next -high-speed interval, the application cannot, evidently, be deemed as -soft real-time (exactly because of its speed), and so on. - -This extra filtering proved to be rather effective: in the above test, -the frequency of false positives became so low that the start-up time -was 3 seconds in all iterations (apart from occasional outliers, -caused by page-cache-management issues, which are out of the scope of -this commit, and cannot be solved by an I/O scheduler). - -Tested-by: Lee Tibbert -Signed-off-by: Paolo Valente -Signed-off-by: Angelo Ruocco -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 115 ++++++++++++++++++++++++++++++++++++---------------- - 1 file changed, 81 insertions(+), 34 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 9625550b2f85..e33c5c4c9856 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -2940,45 +2940,87 @@ static bool bfq_bfqq_is_slow(struct bfq_data *bfqd, struct bfq_queue *bfqq, - * whereas soft_rt_next_start is set to infinity for applications that do - * not. - * -- * Unfortunately, even a greedy application may happen to behave in an -- * isochronous way if the CPU load is high. In fact, the application may -- * stop issuing requests while the CPUs are busy serving other processes, -- * then restart, then stop again for a while, and so on. In addition, if -- * the disk achieves a low enough throughput with the request pattern -- * issued by the application (e.g., because the request pattern is random -- * and/or the device is slow), then the application may meet the above -- * bandwidth requirement too. To prevent such a greedy application to be -- * deemed as soft real-time, a further rule is used in the computation of -- * soft_rt_next_start: soft_rt_next_start must be higher than the current -- * time plus the maximum time for which the arrival of a request is waited -- * for when a sync queue becomes idle, namely bfqd->bfq_slice_idle. -- * This filters out greedy applications, as the latter issue instead their -- * next request as soon as possible after the last one has been completed -- * (in contrast, when a batch of requests is completed, a soft real-time -- * application spends some time processing data). -+ * Unfortunately, even a greedy (i.e., I/O-bound) application may -+ * happen to meet, occasionally or systematically, both the above -+ * bandwidth and isochrony requirements. This may happen at least in -+ * the following circumstances. First, if the CPU load is high. The -+ * application may stop issuing requests while the CPUs are busy -+ * serving other processes, then restart, then stop again for a while, -+ * and so on. The other circumstances are related to the storage -+ * device: the storage device is highly loaded or reaches a low-enough -+ * throughput with the I/O of the application (e.g., because the I/O -+ * is random and/or the device is slow). In all these cases, the -+ * I/O of the application may be simply slowed down enough to meet -+ * the bandwidth and isochrony requirements. To reduce the probability -+ * that greedy applications are deemed as soft real-time in these -+ * corner cases, a further rule is used in the computation of -+ * soft_rt_next_start: the return value of this function is forced to -+ * be higher than the maximum between the following two quantities. - * -- * Unfortunately, the last filter may easily generate false positives if -- * only bfqd->bfq_slice_idle is used as a reference time interval and one -- * or both the following cases occur: -- * 1) HZ is so low that the duration of a jiffy is comparable to or higher -- * than bfqd->bfq_slice_idle. This happens, e.g., on slow devices with -- * HZ=100. -+ * (a) Current time plus: (1) the maximum time for which the arrival -+ * of a request is waited for when a sync queue becomes idle, -+ * namely bfqd->bfq_slice_idle, and (2) a few extra jiffies. We -+ * postpone for a moment the reason for adding a few extra -+ * jiffies; we get back to it after next item (b). Lower-bounding -+ * the return value of this function with the current time plus -+ * bfqd->bfq_slice_idle tends to filter out greedy applications, -+ * because the latter issue their next request as soon as possible -+ * after the last one has been completed. In contrast, a soft -+ * real-time application spends some time processing data, after a -+ * batch of its requests has been completed. -+ * -+ * (b) Current value of bfqq->soft_rt_next_start. As pointed out -+ * above, greedy applications may happen to meet both the -+ * bandwidth and isochrony requirements under heavy CPU or -+ * storage-device load. In more detail, in these scenarios, these -+ * applications happen, only for limited time periods, to do I/O -+ * slowly enough to meet all the requirements described so far, -+ * including the filtering in above item (a). These slow-speed -+ * time intervals are usually interspersed between other time -+ * intervals during which these applications do I/O at a very high -+ * speed. Fortunately, exactly because of the high speed of the -+ * I/O in the high-speed intervals, the values returned by this -+ * function happen to be so high, near the end of any such -+ * high-speed interval, to be likely to fall *after* the end of -+ * the low-speed time interval that follows. These high values are -+ * stored in bfqq->soft_rt_next_start after each invocation of -+ * this function. As a consequence, if the last value of -+ * bfqq->soft_rt_next_start is constantly used to lower-bound the -+ * next value that this function may return, then, from the very -+ * beginning of a low-speed interval, bfqq->soft_rt_next_start is -+ * likely to be constantly kept so high that any I/O request -+ * issued during the low-speed interval is considered as arriving -+ * to soon for the application to be deemed as soft -+ * real-time. Then, in the high-speed interval that follows, the -+ * application will not be deemed as soft real-time, just because -+ * it will do I/O at a high speed. And so on. -+ * -+ * Getting back to the filtering in item (a), in the following two -+ * cases this filtering might be easily passed by a greedy -+ * application, if the reference quantity was just -+ * bfqd->bfq_slice_idle: -+ * 1) HZ is so low that the duration of a jiffy is comparable to or -+ * higher than bfqd->bfq_slice_idle. This happens, e.g., on slow -+ * devices with HZ=100. The time granularity may be so coarse -+ * that the approximation, in jiffies, of bfqd->bfq_slice_idle -+ * is rather lower than the exact value. - * 2) jiffies, instead of increasing at a constant rate, may stop increasing - * for a while, then suddenly 'jump' by several units to recover the lost - * increments. This seems to happen, e.g., inside virtual machines. -- * To address this issue, we do not use as a reference time interval just -- * bfqd->bfq_slice_idle, but bfqd->bfq_slice_idle plus a few jiffies. In -- * particular we add the minimum number of jiffies for which the filter -- * seems to be quite precise also in embedded systems and KVM/QEMU virtual -- * machines. -+ * To address this issue, in the filtering in (a) we do not use as a -+ * reference time interval just bfqd->bfq_slice_idle, but -+ * bfqd->bfq_slice_idle plus a few jiffies. In particular, we add the -+ * minimum number of jiffies for which the filter seems to be quite -+ * precise also in embedded systems and KVM/QEMU virtual machines. - */ - static unsigned long bfq_bfqq_softrt_next_start(struct bfq_data *bfqd, - struct bfq_queue *bfqq) - { -- return max(bfqq->last_idle_bklogged + -- HZ * bfqq->service_from_backlogged / -- bfqd->bfq_wr_max_softrt_rate, -- jiffies + nsecs_to_jiffies(bfqq->bfqd->bfq_slice_idle) + 4); -+ return max3(bfqq->soft_rt_next_start, -+ bfqq->last_idle_bklogged + -+ HZ * bfqq->service_from_backlogged / -+ bfqd->bfq_wr_max_softrt_rate, -+ jiffies + nsecs_to_jiffies(bfqq->bfqd->bfq_slice_idle) + 4); - } - - /** -@@ -4014,10 +4056,15 @@ static void bfq_init_bfqq(struct bfq_data *bfqd, struct bfq_queue *bfqq, - bfqq->split_time = bfq_smallest_from_now(); - - /* -- * Set to the value for which bfqq will not be deemed as -- * soft rt when it becomes backlogged. -+ * To not forget the possibly high bandwidth consumed by a -+ * process/queue in the recent past, -+ * bfq_bfqq_softrt_next_start() returns a value at least equal -+ * to the current value of bfqq->soft_rt_next_start (see -+ * comments on bfq_bfqq_softrt_next_start). Set -+ * soft_rt_next_start to now, to mean that bfqq has consumed -+ * no bandwidth so far. - */ -- bfqq->soft_rt_next_start = bfq_greatest_from_now(); -+ bfqq->soft_rt_next_start = jiffies; - - /* first request is almost certainly seeky */ - bfqq->seek_history = 1; --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-decrease-burst-size-when-queues-in-burst-e.patch b/kernel/kernel/files/patches/mageia/block-bfq-decrease-burst-size-when-queues-in-burst-e.patch deleted file mode 100644 index c799fe1e..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-decrease-burst-size-when-queues-in-burst-e.patch +++ /dev/null @@ -1,82 +0,0 @@ -From 7cb04004fa371a626c1a5ebe6d977f70285759ed Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Thu, 21 Sep 2017 11:04:03 +0200 -Subject: [PATCH] block, bfq: decrease burst size when queues in burst exit - -If many queues belonging to the same group happen to be created -shortly after each other, then the concurrent processes associated -with these queues have typically a common goal, and they get it done -as soon as possible if not hampered by device idling. Examples are -processes spawned by git grep, or by systemd during boot. As for -device idling, this mechanism is currently necessary for weight -raising to succeed in its goal: privileging I/O. In view of these -facts, BFQ does not provide the above queues with either weight -raising or device idling. - -On the other hand, a burst of queue creations may be caused also by -the start-up of a complex application. In this case, these queues need -usually to be served one after the other, and as quickly as possible, -to maximise responsiveness. Therefore, in this case the best strategy -is to weight-raise all the queues created during the burst, i.e., the -exact opposite of the strategy for the above case. - -To distinguish between the two cases, BFQ uses an empirical burst-size -threshold, found through extensive tests and monitoring of daily -usage. Only large bursts, i.e., burst with a size above this -threshold, are considered as generated by a high number of parallel -processes. In this respect, upstart-based boot proved to be rather -hard to detect as generating a large burst of queue creations, because -with upstart most of the queues created in a burst exit *before* the -next queues in the same burst are created. To address this issue, I -changed the burst-detection mechanism so as to not decrease the size -of the current burst even if one of the queues in the burst is -eliminated. - -Unfortunately, this missing decrease causes false positives on very -fast systems: on the start-up of a complex application, such as -libreoffice writer, so many queues are created, served and exited -shortly after each other, that a large burst of queue creations is -wrongly detected as occurring. These false positives just disappear if -the size of a burst is decreased when one of the queues in the burst -exits. This commit restores the missing burst-size decrease, relying -of the fact that upstart is apparently unlikely to be used on systems -running this and future versions of the kernel. - -Signed-off-by: Paolo Valente -Signed-off-by: Mauro Andreolini -Signed-off-by: Angelo Ruocco -Tested-by: Mirko Montanari -Tested-by: Oleksandr Natalenko -Tested-by: Lee Tibbert -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 12 +++--------- - 1 file changed, 3 insertions(+), 9 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 115747fe43c8..70f9177c4f5b 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -3725,16 +3725,10 @@ void bfq_put_queue(struct bfq_queue *bfqq) - if (bfqq->ref) - return; - -- if (bfq_bfqq_sync(bfqq)) -- /* -- * The fact that this queue is being destroyed does not -- * invalidate the fact that this queue may have been -- * activated during the current burst. As a consequence, -- * although the queue does not exist anymore, and hence -- * needs to be removed from the burst list if there, -- * the burst size has not to be decremented. -- */ -+ if (bfq_bfqq_sync(bfqq) && !hlist_unhashed(&bfqq->burst_list_node)) { - hlist_del_init(&bfqq->burst_list_node); -+ bfqq->bfqd->burst_size--; -+ } - - kmem_cache_free(bfq_pool, bfqq); - #ifdef CONFIG_BFQ_GROUP_IOSCHED --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-fix-occurrences-of-request-finish-method-s.patch b/kernel/kernel/files/patches/mageia/block-bfq-fix-occurrences-of-request-finish-method-s.patch deleted file mode 100644 index 6c97a9d0..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-fix-occurrences-of-request-finish-method-s.patch +++ /dev/null @@ -1,91 +0,0 @@ -From 8993d445df388e3541f48920a2353cfc904b220a Mon Sep 17 00:00:00 2001 -From: Chiara Bruschi -Date: Mon, 18 Dec 2017 16:21:59 +0000 -Subject: [PATCH] block, bfq: fix occurrences of request finish method's old - name - -Commit '7b9e93616399' ("blk-mq-sched: unify request finished methods") -changed the old name of current bfq_finish_request method, but left it -unchanged elsewhere in the code (related comments, part of function -name bfq_put_rq_priv_body). - -This commit fixes all occurrences of the old name of this method by -changing them into the current name. - -Fixes: 7b9e93616399 ("blk-mq-sched: unify request finished methods") -Reviewed-by: Paolo Valente -Signed-off-by: Federico Motta -Signed-off-by: Chiara Bruschi -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 26 +++++++++++++------------- - 1 file changed, 13 insertions(+), 13 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 5e6f837f663e..f352b1677143 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -3684,8 +3684,8 @@ static struct request *__bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) - } - - /* -- * We exploit the put_rq_private hook to decrement -- * rq_in_driver, but put_rq_private will not be -+ * We exploit the bfq_finish_request hook to decrement -+ * rq_in_driver, but bfq_finish_request will not be - * invoked on this request. So, to avoid unbalance, - * just start this request, without incrementing - * rq_in_driver. As a negative consequence, -@@ -3694,14 +3694,14 @@ static struct request *__bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) - * bfq_schedule_dispatch to be invoked uselessly. - * - * As for implementing an exact solution, the -- * put_request hook, if defined, is probably invoked -- * also on this request. So, by exploiting this hook, -- * we could 1) increment rq_in_driver here, and 2) -- * decrement it in put_request. Such a solution would -- * let the value of the counter be always accurate, -- * but it would entail using an extra interface -- * function. This cost seems higher than the benefit, -- * being the frequency of non-elevator-private -+ * bfq_finish_request hook, if defined, is probably -+ * invoked also on this request. So, by exploiting -+ * this hook, we could 1) increment rq_in_driver here, -+ * and 2) decrement it in bfq_finish_request. Such a -+ * solution would let the value of the counter be -+ * always accurate, but it would entail using an extra -+ * interface function. This cost seems higher than the -+ * benefit, being the frequency of non-elevator-private - * requests very low. - */ - goto start_rq; -@@ -4558,7 +4558,7 @@ static void bfq_completed_request(struct bfq_queue *bfqq, struct bfq_data *bfqd) - bfq_schedule_dispatch(bfqd); - } - --static void bfq_put_rq_priv_body(struct bfq_queue *bfqq) -+static void bfq_finish_request_body(struct bfq_queue *bfqq) - { - bfqq->allocated--; - -@@ -4588,7 +4588,7 @@ static void bfq_finish_request(struct request *rq) - spin_lock_irqsave(&bfqd->lock, flags); - - bfq_completed_request(bfqq, bfqd); -- bfq_put_rq_priv_body(bfqq); -+ bfq_finish_request_body(bfqq); - - spin_unlock_irqrestore(&bfqd->lock, flags); - } else { -@@ -4609,7 +4609,7 @@ static void bfq_finish_request(struct request *rq) - bfqg_stats_update_io_remove(bfqq_group(bfqq), - rq->cmd_flags); - } -- bfq_put_rq_priv_body(bfqq); -+ bfq_finish_request_body(bfqq); - } - - rq->elv.priv[0] = NULL; --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-fix-unbalanced-decrements-of-burst-size.patch b/kernel/kernel/files/patches/mageia/block-bfq-fix-unbalanced-decrements-of-burst-size.patch deleted file mode 100644 index fe9cf75e..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-fix-unbalanced-decrements-of-burst-size.patch +++ /dev/null @@ -1,141 +0,0 @@ -From 99fead8d38e5302b1be9403d4de815ce9174a3df Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Mon, 9 Oct 2017 13:11:23 +0200 -Subject: [PATCH] block, bfq: fix unbalanced decrements of burst size -MIME-Version: 1.0 -Content-Type: text/plain; charset=UTF-8 -Content-Transfer-Encoding: 8bit - -The commit "block, bfq: decrease burst size when queues in burst -exit" introduced the decrement of burst_size on the removal of a -bfq_queue from the burst list. Unfortunately, this decrement can -happen to be performed even when burst size is already equal to 0, -because of unbalanced decrements. A description follows of the cause -of these unbalanced decrements, namely a wrong assumption, and of the -way how this wrong assumption leads to unbalanced decrements. - -The wrong assumption is that a bfq_queue can exit only if the process -associated with the bfq_queue has exited. This is false, because a -bfq_queue, say Q, may exit also as a consequence of a merge with -another bfq_queue. In this case, Q exits because the I/O of its -associated process has been redirected to another bfq_queue. - -The decrement unbalance occurs because Q may then be re-created after -a split, and added back to the current burst list, *without* -incrementing burst_size. burst_size is not incremented because Q is -not a new bfq_queue added to the burst list, but a bfq_queue only -temporarily removed from the list, and, before the commit "bfq-sq, -bfq-mq: decrease burst size when queues in burst exit", burst_size was -not decremented when Q was removed. - -This commit addresses this issue by just checking whether the exiting -bfq_queue is a merged bfq_queue, and, in that case, not decrementing -burst_size. Unfortunately, this still leaves room for unbalanced -decrements, in the following rarer case: on a split, the bfq_queue -happens to be inserted into a different burst list than that it was -removed from when merged. If this happens, the number of elements in -the new burst list becomes higher than burst_size (by one). When the -bfq_queue then exits, it is of course not in a merged state any -longer, thus burst_size is decremented, which results in an unbalanced -decrement. To handle this sporadic, unlucky case in a simple way, -this commit also checks that burst_size is larger than 0 before -decrementing it. - -Finally, this commit removes an useless, extra check: the check that -the bfq_queue is sync, performed before checking whether the bfq_queue -is in the burst list. This extra check is redundant, because only sync -bfq_queues can be inserted into the burst list. - -Fixes: 7cb04004fa37 ("block, bfq: decrease burst size when queues in burst exit") -Reported-by: Philip Müller -Signed-off-by: Paolo Valente -Signed-off-by: Angelo Ruocco -Tested-by: Philip Müller -Tested-by: Oleksandr Natalenko -Tested-by: Lee Tibbert -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 59 +++++++++++++++++++++++++++++++++++++++++++++++++++-- - 1 file changed, 57 insertions(+), 2 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 261f98695910..889a8549d97f 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -3726,9 +3726,36 @@ void bfq_put_queue(struct bfq_queue *bfqq) - if (bfqq->ref) - return; - -- if (bfq_bfqq_sync(bfqq) && !hlist_unhashed(&bfqq->burst_list_node)) { -+ if (!hlist_unhashed(&bfqq->burst_list_node)) { - hlist_del_init(&bfqq->burst_list_node); -- bfqq->bfqd->burst_size--; -+ /* -+ * Decrement also burst size after the removal, if the -+ * process associated with bfqq is exiting, and thus -+ * does not contribute to the burst any longer. This -+ * decrement helps filter out false positives of large -+ * bursts, when some short-lived process (often due to -+ * the execution of commands by some service) happens -+ * to start and exit while a complex application is -+ * starting, and thus spawning several processes that -+ * do I/O (and that *must not* be treated as a large -+ * burst, see comments on bfq_handle_burst). -+ * -+ * In particular, the decrement is performed only if: -+ * 1) bfqq is not a merged queue, because, if it is, -+ * then this free of bfqq is not triggered by the exit -+ * of the process bfqq is associated with, but exactly -+ * by the fact that bfqq has just been merged. -+ * 2) burst_size is greater than 0, to handle -+ * unbalanced decrements. Unbalanced decrements may -+ * happen in te following case: bfqq is inserted into -+ * the current burst list--without incrementing -+ * bust_size--because of a split, but the current -+ * burst list is not the burst list bfqq belonged to -+ * (see comments on the case of a split in -+ * bfq_set_request). -+ */ -+ if (bfqq->bic && bfqq->bfqd->burst_size > 0) -+ bfqq->bfqd->burst_size--; - } - - kmem_cache_free(bfq_pool, bfqq); -@@ -4460,6 +4487,34 @@ static struct bfq_queue *bfq_get_bfqq_handle_split(struct bfq_data *bfqd, - else { - bfq_clear_bfqq_in_large_burst(bfqq); - if (bic->was_in_burst_list) -+ /* -+ * If bfqq was in the current -+ * burst list before being -+ * merged, then we have to add -+ * it back. And we do not need -+ * to increase burst_size, as -+ * we did not decrement -+ * burst_size when we removed -+ * bfqq from the burst list as -+ * a consequence of a merge -+ * (see comments in -+ * bfq_put_queue). In this -+ * respect, it would be rather -+ * costly to know whether the -+ * current burst list is still -+ * the same burst list from -+ * which bfqq was removed on -+ * the merge. To avoid this -+ * cost, if bfqq was in a -+ * burst list, then we add -+ * bfqq to the current burst -+ * list without any further -+ * check. This can cause -+ * inappropriate insertions, -+ * but rarely enough to not -+ * harm the detection of large -+ * bursts significantly. -+ */ - hlist_add_head(&bfqq->burst_list_node, - &bfqd->burst_list); - } --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-fix-wrong-init-of-saved-start-time-for-wei.patch b/kernel/kernel/files/patches/mageia/block-bfq-fix-wrong-init-of-saved-start-time-for-wei.patch deleted file mode 100644 index c702e4a1..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-fix-wrong-init-of-saved-start-time-for-wei.patch +++ /dev/null @@ -1,146 +0,0 @@ -From 4baa8bb13f41307f3eb62fe91f93a1a798ebef53 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Thu, 21 Sep 2017 11:04:00 +0200 -Subject: [PATCH] block, bfq: fix wrong init of saved start time for weight - raising - -This commit fixes a bug that causes bfq to fail to guarantee a high -responsiveness on some drives, if there is heavy random read+write I/O -in the background. More precisely, such a failure allowed this bug to -be found [1], but the bug may well cause other yet unreported -anomalies. - -BFQ raises the weight of the bfq_queues associated with soft real-time -applications, to privilege the I/O, and thus reduce latency, for these -applications. This mechanism is named soft-real-time weight raising in -BFQ. A soft real-time period may happen to be nested into an -interactive weight raising period, i.e., it may happen that, when a -bfq_queue switches to a soft real-time weight-raised state, the -bfq_queue is already being weight-raised because deemed interactive -too. In this case, BFQ saves in a special variable -wr_start_at_switch_to_srt, the time instant when the interactive -weight-raising period started for the bfq_queue, i.e., the time -instant when BFQ started to deem the bfq_queue interactive. This value -is then used to check whether the interactive weight-raising period -would still be in progress when the soft real-time weight-raising -period ends. If so, interactive weight raising is restored for the -bfq_queue. This restore is useful, in particular, because it prevents -bfq_queues from losing their interactive weight raising prematurely, -as a consequence of spurious, short-lived soft real-time -weight-raising periods caused by wrong detections as soft real-time. - -If, instead, a bfq_queue switches to soft-real-time weight raising -while it *is not* already in an interactive weight-raising period, -then the variable wr_start_at_switch_to_srt has no meaning during the -following soft real-time weight-raising period. Unfortunately the -handling of this case is wrong in BFQ: not only the variable is not -flagged somehow as meaningless, but it is also set to the time when -the switch to soft real-time weight-raising occurs. This may cause an -interactive weight-raising period to be considered mistakenly as still -in progress, and thus a spurious interactive weight-raising period to -start for the bfq_queue, at the end of the soft-real-time -weight-raising period. In particular the spurious interactive -weight-raising period will be considered as still in progress, if the -soft-real-time weight-raising period does not last very long. The -bfq_queue will then be wrongly privileged and, if I/O bound, will -unjustly steal bandwidth to truly interactive or soft real-time -bfq_queues, harming responsiveness and low latency. - -This commit fixes this issue by just setting wr_start_at_switch_to_srt -to minus infinity (farthest past time instant according to jiffies -macros): when the soft-real-time weight-raising period ends, certainly -no interactive weight-raising period will be considered as still in -progress. - -[1] Background I/O Type: Random - Background I/O mix: Reads and writes -- Application to start: LibreOffice Writer in -http://www.phoronix.com/scan.php?page=news_item&px=Linux-4.13-IO-Laptop - -Signed-off-by: Paolo Valente -Signed-off-by: Angelo Ruocco -Tested-by: Oleksandr Natalenko -Tested-by: Lee Tibbert -Tested-by: Mirko Montanari -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 50 +++++++++++++++++++++++++++++++------------------- - 1 file changed, 31 insertions(+), 19 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index a4783da90ba8..c25955c25e03 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -1202,6 +1202,24 @@ static unsigned int bfq_wr_duration(struct bfq_data *bfqd) - return dur; - } - -+/* -+ * Return the farthest future time instant according to jiffies -+ * macros. -+ */ -+static unsigned long bfq_greatest_from_now(void) -+{ -+ return jiffies + MAX_JIFFY_OFFSET; -+} -+ -+/* -+ * Return the farthest past time instant according to jiffies -+ * macros. -+ */ -+static unsigned long bfq_smallest_from_now(void) -+{ -+ return jiffies - MAX_JIFFY_OFFSET; -+} -+ - static void bfq_update_bfqq_wr_on_rq_arrival(struct bfq_data *bfqd, - struct bfq_queue *bfqq, - unsigned int old_wr_coeff, -@@ -1216,7 +1234,19 @@ static void bfq_update_bfqq_wr_on_rq_arrival(struct bfq_data *bfqd, - bfqq->wr_coeff = bfqd->bfq_wr_coeff; - bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); - } else { -- bfqq->wr_start_at_switch_to_srt = jiffies; -+ /* -+ * No interactive weight raising in progress -+ * here: assign minus infinity to -+ * wr_start_at_switch_to_srt, to make sure -+ * that, at the end of the soft-real-time -+ * weight raising periods that is starting -+ * now, no interactive weight-raising period -+ * may be wrongly considered as still in -+ * progress (and thus actually started by -+ * mistake). -+ */ -+ bfqq->wr_start_at_switch_to_srt = -+ bfq_smallest_from_now(); - bfqq->wr_coeff = bfqd->bfq_wr_coeff * - BFQ_SOFTRT_WEIGHT_FACTOR; - bfqq->wr_cur_max_time = -@@ -2897,24 +2927,6 @@ static unsigned long bfq_bfqq_softrt_next_start(struct bfq_data *bfqd, - jiffies + nsecs_to_jiffies(bfqq->bfqd->bfq_slice_idle) + 4); - } - --/* -- * Return the farthest future time instant according to jiffies -- * macros. -- */ --static unsigned long bfq_greatest_from_now(void) --{ -- return jiffies + MAX_JIFFY_OFFSET; --} -- --/* -- * Return the farthest past time instant according to jiffies -- * macros. -- */ --static unsigned long bfq_smallest_from_now(void) --{ -- return jiffies - MAX_JIFFY_OFFSET; --} -- - /** - * bfq_bfqq_expire - expire a queue. - * @bfqd: device owning the queue. --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-increase-threshold-to-deem-I-O-as-random.patch b/kernel/kernel/files/patches/mageia/block-bfq-increase-threshold-to-deem-I-O-as-random.patch deleted file mode 100644 index ddbf7c5f..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-increase-threshold-to-deem-I-O-as-random.patch +++ /dev/null @@ -1,68 +0,0 @@ -From f0ba5ea2fe45c0ad24a7dedae84a97f7aa046494 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Wed, 20 Dec 2017 17:27:36 +0100 -Subject: [PATCH] block, bfq: increase threshold to deem I/O as random - -If two processes do I/O close to each other, i.e., are cooperating -processes in BFQ (and CFQ'S) nomenclature, then BFQ merges their -associated bfq_queues, so as to get sequential I/O from the union of -the I/O requests of the processes, and thus reach a higher -throughput. A merged queue is then split if its I/O stops being -sequential. In this respect, BFQ deems the I/O of a bfq_queue as -(mostly) sequential only if less than 4 I/O requests are random, out -of the last 32 requests inserted into the queue. - -Unfortunately, extensive testing (with the interleaved_io benchmark of -the S suite [1], and with real applications spawning cooperating -processes) has clearly shown that, with such a low threshold, only a -rather low I/O throughput may be reached when several cooperating -processes do I/O. In particular, the outcome of each test run was -bimodal: if queue merging occurred and was stable during the test, -then the throughput was close to the peak rate of the storage device, -otherwise the throughput was arbitrarily low (usually around 1/10 of -the peak rate with a rotational device). The probability to get the -unlucky outcomes grew with the number of cooperating processes: it was -already significant with 5 processes, and close to one with 7 or more -processes. - -The cause of the low throughput in the unlucky runs was that the -merged queues containing the I/O of these cooperating processes were -soon split, because they contained more random I/O requests than those -tolerated by the 4/32 threshold, but -- that I/O would have however allowed the storage device to reach - peak throughput or almost peak throughput; -- in contrast, the I/O of these processes, if served individually - (from separate queues) yielded a rather low throughput. - -So we repeated our tests with increasing values of the threshold, -until we found the minimum value (19) for which we obtained maximum -throughput, reliably, with at least up to 9 cooperating -processes. Then we checked that the use of that higher threshold value -did not cause any regression for any other benchmark in the suite [1]. -This commit raises the threshold to such a higher value. - -[1] https://github.com/Algodev-github/S - -Signed-off-by: Angelo Ruocco -Signed-off-by: Paolo Valente -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index bcb6d21baf12..0f48583b9380 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -178,7 +178,7 @@ static struct kmem_cache *bfq_pool; - #define BFQQ_SEEK_THR (sector_t)(8 * 100) - #define BFQQ_SECT_THR_NONROT (sector_t)(2 * 32) - #define BFQQ_CLOSE_THR (sector_t)(8 * 1024) --#define BFQQ_SEEKY(bfqq) (hweight32(bfqq->seek_history) > 32/8) -+#define BFQQ_SEEKY(bfqq) (hweight32(bfqq->seek_history) > 19) - - /* Min number of samples required to perform peak-rate update */ - #define BFQ_RATE_MIN_SAMPLES 32 --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-iosched-don-t-call-bfqg_and_blkg_put-for-CONFIG_.patch b/kernel/kernel/files/patches/mageia/block-bfq-iosched-don-t-call-bfqg_and_blkg_put-for-CONFIG_.patch deleted file mode 100644 index 059027fa..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-iosched-don-t-call-bfqg_and_blkg_put-for-CONFIG_.patch +++ /dev/null @@ -1,34 +0,0 @@ -From 8abef10b3de1144cfe968f454946f13eb1ac3d0a Mon Sep 17 00:00:00 2001 -From: Jens Axboe -Date: Tue, 9 Jan 2018 12:20:51 -0700 -Subject: [PATCH] bfq-iosched: don't call bfqg_and_blkg_put for - !CONFIG_BFQ_GROUP_IOSCHED - -It's not available if we don't have group io scheduling set, and -there's no need to call it. - -Fixes: 0d52af590552 ("block, bfq: release oom-queue ref to root group on exit") -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 7c0b7f60811c..5e6f837f663e 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -4893,10 +4893,10 @@ static void bfq_exit_queue(struct elevator_queue *e) - - hrtimer_cancel(&bfqd->idle_slice_timer); - -+#ifdef CONFIG_BFQ_GROUP_IOSCHED - /* release oom-queue reference to root group */ - bfqg_and_blkg_put(bfqd->root_group); - --#ifdef CONFIG_BFQ_GROUP_IOSCHED - blkcg_deactivate_policy(bfqd->queue, &blkcg_policy_bfq); - #else - spin_lock_irq(&bfqd->lock); --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-let-a-queue-be-merged-only-shortly-after-s.patch b/kernel/kernel/files/patches/mageia/block-bfq-let-a-queue-be-merged-only-shortly-after-s.patch deleted file mode 100644 index 5a316e71..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-let-a-queue-be-merged-only-shortly-after-s.patch +++ /dev/null @@ -1,186 +0,0 @@ -From 7b8fa3b900a087bc03b11329a92398fde563ba37 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Wed, 20 Dec 2017 12:38:33 +0100 -Subject: [PATCH] block, bfq: let a queue be merged only shortly after starting - I/O - -In BFQ and CFQ, two processes are said to be cooperating if they do -I/O in such a way that the union of their I/O requests yields a -sequential I/O pattern. To get such a sequential I/O pattern out of -the non-sequential pattern of each cooperating process, BFQ and CFQ -merge the queues associated with these processes. In more detail, -cooperating processes, and thus their associated queues, usually -start, or restart, to do I/O shortly after each other. This is the -case, e.g., for the I/O threads of KVM/QEMU and of the dump -utility. Basing on this assumption, this commit allows a bfq_queue to -be merged only during a short time interval (100ms) after it starts, -or re-starts, to do I/O. This filtering provides two important -benefits. - -First, it greatly reduces the probability that two non-cooperating -processes have their queues merged by mistake, if they just happen to -do I/O close to each other for a short time interval. These spurious -merges cause loss of service guarantees. A low-weight bfq_queue may -unjustly get more than its expected share of the throughput: if such a -low-weight queue is merged with a high-weight queue, then the I/O for -the low-weight queue is served as if the queue had a high weight. This -may damage other high-weight queues unexpectedly. For instance, -because of this issue, lxterminal occasionally took 7.5 seconds to -start, instead of 6.5 seconds, when some sequential readers and -writers did I/O in the background on a FUJITSU MHX2300BT HDD. The -reason is that the bfq_queues associated with some of the readers or -the writers were merged with the high-weight queues of some processes -that had to do some urgent but little I/O. The readers then exploited -the inherited high weight for all or most of their I/O, during the -start-up of terminal. The filtering introduced by this commit -eliminated any outlier caused by spurious queue merges in our start-up -time tests. - -This filtering also provides a little boost of the throughput -sustainable by BFQ: 3-4%, depending on the CPU. The reason is that, -once a bfq_queue cannot be merged any longer, this commit makes BFQ -stop updating the data needed to handle merging for the queue. - -Signed-off-by: Paolo Valente -Signed-off-by: Angelo Ruocco -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 57 ++++++++++++++++++++++++++++++++++++++++++----------- - block/bfq-iosched.h | 2 ++ - block/bfq-wf2q.c | 4 ++++ - 3 files changed, 52 insertions(+), 11 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 2cf395daee80..7066d90f09df 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -166,6 +166,20 @@ static const int bfq_async_charge_factor = 10; - /* Default timeout values, in jiffies, approximating CFQ defaults. */ - const int bfq_timeout = HZ / 8; - -+/* -+ * Time limit for merging (see comments in bfq_setup_cooperator). Set -+ * to the slowest value that, in our tests, proved to be effective in -+ * removing false positives, while not causing true positives to miss -+ * queue merging. -+ * -+ * As can be deduced from the low time limit below, queue merging, if -+ * successful, happens at the very beggining of the I/O of the involved -+ * cooperating processes, as a consequence of the arrival of the very -+ * first requests from each cooperator. After that, there is very -+ * little chance to find cooperators. -+ */ -+static const unsigned long bfq_merge_time_limit = HZ/10; -+ - static struct kmem_cache *bfq_pool; - - /* Below this threshold (in ns), we consider thinktime immediate. */ -@@ -444,6 +458,13 @@ bfq_rq_pos_tree_lookup(struct bfq_data *bfqd, struct rb_root *root, - return bfqq; - } - -+static bool bfq_too_late_for_merging(struct bfq_queue *bfqq) -+{ -+ return bfqq->service_from_backlogged > 0 && -+ time_is_before_jiffies(bfqq->first_IO_time + -+ bfq_merge_time_limit); -+} -+ - void bfq_pos_tree_add_move(struct bfq_data *bfqd, struct bfq_queue *bfqq) - { - struct rb_node **p, *parent; -@@ -454,6 +475,14 @@ void bfq_pos_tree_add_move(struct bfq_data *bfqd, struct bfq_queue *bfqq) - bfqq->pos_root = NULL; - } - -+ /* -+ * bfqq cannot be merged any longer (see comments in -+ * bfq_setup_cooperator): no point in adding bfqq into the -+ * position tree. -+ */ -+ if (bfq_too_late_for_merging(bfqq)) -+ return; -+ - if (bfq_class_idle(bfqq)) - return; - if (!bfqq->next_rq) -@@ -1935,6 +1964,9 @@ bfq_setup_merge(struct bfq_queue *bfqq, struct bfq_queue *new_bfqq) - static bool bfq_may_be_close_cooperator(struct bfq_queue *bfqq, - struct bfq_queue *new_bfqq) - { -+ if (bfq_too_late_for_merging(new_bfqq)) -+ return false; -+ - if (bfq_class_idle(bfqq) || bfq_class_idle(new_bfqq) || - (bfqq->ioprio_class != new_bfqq->ioprio_class)) - return false; -@@ -2003,6 +2035,20 @@ bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, - { - struct bfq_queue *in_service_bfqq, *new_bfqq; - -+ /* -+ * Prevent bfqq from being merged if it has been created too -+ * long ago. The idea is that true cooperating processes, and -+ * thus their associated bfq_queues, are supposed to be -+ * created shortly after each other. This is the case, e.g., -+ * for KVM/QEMU and dump I/O threads. Basing on this -+ * assumption, the following filtering greatly reduces the -+ * probability that two non-cooperating processes, which just -+ * happen to do close I/O for some short time interval, have -+ * their queues merged by mistake. -+ */ -+ if (bfq_too_late_for_merging(bfqq)) -+ return NULL; -+ - if (bfqq->new_bfqq) - return bfqq->new_bfqq; - -@@ -3002,17 +3048,6 @@ void bfq_bfqq_expire(struct bfq_data *bfqd, - */ - slow = bfq_bfqq_is_slow(bfqd, bfqq, compensate, reason, &delta); - -- /* -- * Increase service_from_backlogged before next statement, -- * because the possible next invocation of -- * bfq_bfqq_charge_time would likely inflate -- * entity->service. In contrast, service_from_backlogged must -- * contain real service, to enable the soft real-time -- * heuristic to correctly compute the bandwidth consumed by -- * bfqq. -- */ -- bfqq->service_from_backlogged += entity->service; -- - /* - * As above explained, charge slow (typically seeky) and - * timed-out queues with the time and not the service -diff --git a/block/bfq-iosched.h b/block/bfq-iosched.h -index 91c4390903a1..5d47b58d5fc8 100644 ---- a/block/bfq-iosched.h -+++ b/block/bfq-iosched.h -@@ -344,6 +344,8 @@ struct bfq_queue { - unsigned long wr_start_at_switch_to_srt; - - unsigned long split_time; /* time of last split */ -+ -+ unsigned long first_IO_time; /* time of first I/O for this queue */ - }; - - /** -diff --git a/block/bfq-wf2q.c b/block/bfq-wf2q.c -index e495d3f9b4b0..4456eda34e48 100644 ---- a/block/bfq-wf2q.c -+++ b/block/bfq-wf2q.c -@@ -835,6 +835,10 @@ void bfq_bfqq_served(struct bfq_queue *bfqq, int served) - struct bfq_entity *entity = &bfqq->entity; - struct bfq_service_tree *st; - -+ if (!bfqq->service_from_backlogged) -+ bfqq->first_IO_time = jiffies; -+ -+ bfqq->service_from_backlogged += served; - for_each_entity(entity) { - st = bfq_entity_service_tree(entity); - --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-let-early-merged-queues-be-weight-raised-o.patch b/kernel/kernel/files/patches/mageia/block-bfq-let-early-merged-queues-be-weight-raised-o.patch deleted file mode 100644 index 698490a2..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-let-early-merged-queues-be-weight-raised-o.patch +++ /dev/null @@ -1,89 +0,0 @@ -From 894df937e06a56ed6f054a75a416aff84147c5a2 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Thu, 21 Sep 2017 11:04:02 +0200 -Subject: [PATCH] block, bfq: let early-merged queues be weight-raised on split - too - -A just-created bfq_queue, say Q, may happen to be merged with another -bfq_queue on the very first invocation of the function -__bfq_insert_request. In such a case, even if Q would clearly deserve -interactive weight raising (as it has just been created), the function -bfq_add_request does not make it to be invoked for Q, and thus to -activate weight raising for Q. As a consequence, when the state of Q -is saved for a possible future restore, after a split of Q from the -other bfq_queue(s), such a state happens to be (unjustly) -non-weight-raised. Then the bfq_queue will not enjoy any weight -raising on the split, even if should still be in an interactive -weight-raising period when the split occurs. - -This commit solves this problem as follows, for a just-created -bfq_queue that is being early-merged: it stores directly, in the saved -state of the bfq_queue, the weight-raising state that would have been -assigned to the bfq_queue if not early-merged. - -Signed-off-by: Paolo Valente -Tested-by: Angelo Ruocco -Tested-by: Mirko Montanari -Tested-by: Oleksandr Natalenko -Tested-by: Lee Tibbert -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 28 +++++++++++++++++++++++----- - 1 file changed, 23 insertions(+), 5 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 33b63bc4a64b..115747fe43c8 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -2061,10 +2061,27 @@ static void bfq_bfqq_save_state(struct bfq_queue *bfqq) - bic->saved_IO_bound = bfq_bfqq_IO_bound(bfqq); - bic->saved_in_large_burst = bfq_bfqq_in_large_burst(bfqq); - bic->was_in_burst_list = !hlist_unhashed(&bfqq->burst_list_node); -- bic->saved_wr_coeff = bfqq->wr_coeff; -- bic->saved_wr_start_at_switch_to_srt = bfqq->wr_start_at_switch_to_srt; -- bic->saved_last_wr_start_finish = bfqq->last_wr_start_finish; -- bic->saved_wr_cur_max_time = bfqq->wr_cur_max_time; -+ if (unlikely(bfq_bfqq_just_created(bfqq) && -+ !bfq_bfqq_in_large_burst(bfqq))) { -+ /* -+ * bfqq being merged right after being created: bfqq -+ * would have deserved interactive weight raising, but -+ * did not make it to be set in a weight-raised state, -+ * because of this early merge. Store directly the -+ * weight-raising state that would have been assigned -+ * to bfqq, so that to avoid that bfqq unjustly fails -+ * to enjoy weight raising if split soon. -+ */ -+ bic->saved_wr_coeff = bfqq->bfqd->bfq_wr_coeff; -+ bic->saved_wr_cur_max_time = bfq_wr_duration(bfqq->bfqd); -+ bic->saved_last_wr_start_finish = jiffies; -+ } else { -+ bic->saved_wr_coeff = bfqq->wr_coeff; -+ bic->saved_wr_start_at_switch_to_srt = -+ bfqq->wr_start_at_switch_to_srt; -+ bic->saved_last_wr_start_finish = bfqq->last_wr_start_finish; -+ bic->saved_wr_cur_max_time = bfqq->wr_cur_max_time; -+ } - } - - static void -@@ -4150,7 +4167,6 @@ static void __bfq_insert_request(struct bfq_data *bfqd, struct request *rq) - new_bfqq->allocated++; - bfqq->allocated--; - new_bfqq->ref++; -- bfq_clear_bfqq_just_created(bfqq); - /* - * If the bic associated with the process - * issuing this request still points to bfqq -@@ -4162,6 +4178,8 @@ static void __bfq_insert_request(struct bfq_data *bfqd, struct request *rq) - if (bic_to_bfqq(RQ_BIC(rq), 1) == bfqq) - bfq_merge_bfqqs(bfqd, RQ_BIC(rq), - bfqq, new_bfqq); -+ -+ bfq_clear_bfqq_just_created(bfqq); - /* - * rq is about to be enqueued into new_bfqq, - * release rq reference on bfqq --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-limit-sectors-served-with-interactive-weig.patch b/kernel/kernel/files/patches/mageia/block-bfq-limit-sectors-served-with-interactive-weig.patch deleted file mode 100644 index f2dcc192..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-limit-sectors-served-with-interactive-weig.patch +++ /dev/null @@ -1,202 +0,0 @@ -From 8a8747dc01cee6f92a52c03ba686e9f60cb46c87 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Sat, 13 Jan 2018 12:05:18 +0100 -Subject: [PATCH] block, bfq: limit sectors served with interactive weight - raising -MIME-Version: 1.0 -Content-Type: text/plain; charset=UTF-8 -Content-Transfer-Encoding: 8bit - -To maximise responsiveness, BFQ raises the weight, and performs device -idling, for bfq_queues associated with processes deemed as -interactive. In particular, weight raising has a maximum duration, -equal to the time needed to start a large application. If a -weight-raised process goes on doing I/O beyond this maximum duration, -it loses weight-raising. - -This mechanism is evidently vulnerable to the following false -positives: I/O-bound applications that will go on doing I/O for much -longer than the duration of weight-raising. These applications have -basically no benefit from being weight-raised at the beginning of -their I/O. On the opposite end, while being weight-raised, these -applications -a) unjustly steal throughput to applications that may truly need -low latency; -b) make BFQ uselessly perform device idling; device idling results -in loss of device throughput with most flash-based storage, and may -increase latencies when used purposelessly. - -This commit adds a countermeasure to reduce both the above -problems. To introduce this countermeasure, we provide the following -extra piece of information (full details in the comments added by this -commit). During the start-up of the large application used as a -reference to set the duration of weight-raising, involved processes -transfer at most ~110K sectors each. Accordingly, a process initially -deemed as interactive has no right to be weight-raised any longer, -once transferred 110K sectors or more. - -Basing on this consideration, this commit early-ends weight-raising -for a bfq_queue if the latter happens to have received an amount of -service at least equal to 110K sectors (actually, a little bit more, -to keep a safety margin). I/O-bound applications that reach a high -throughput, such as file copy, get to this threshold much before the -allowed weight-raising period finishes. Thus this early ending of -weight-raising reduces the amount of time during which these -applications cause the problems described above. - -Tested-by: Oleksandr Natalenko -Tested-by: Holger Hoffstätte -Signed-off-by: Paolo Valente -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 81 +++++++++++++++++++++++++++++++++++++++++++++++------ - block/bfq-iosched.h | 5 ++++ - block/bfq-wf2q.c | 3 ++ - 3 files changed, 80 insertions(+), 9 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index a7ab0cb50733..47e6ec7427c4 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -209,15 +209,17 @@ static struct kmem_cache *bfq_pool; - * interactive applications automatically, using the following formula: - * duration = (R / r) * T, where r is the peak rate of the device, and - * R and T are two reference parameters. -- * In particular, R is the peak rate of the reference device (see below), -- * and T is a reference time: given the systems that are likely to be -- * installed on the reference device according to its speed class, T is -- * about the maximum time needed, under BFQ and while reading two files in -- * parallel, to load typical large applications on these systems. -- * In practice, the slower/faster the device at hand is, the more/less it -- * takes to load applications with respect to the reference device. -- * Accordingly, the longer/shorter BFQ grants weight raising to interactive -- * applications. -+ * In particular, R is the peak rate of the reference device (see -+ * below), and T is a reference time: given the systems that are -+ * likely to be installed on the reference device according to its -+ * speed class, T is about the maximum time needed, under BFQ and -+ * while reading two files in parallel, to load typical large -+ * applications on these systems (see the comments on -+ * max_service_from_wr below, for more details on how T is obtained). -+ * In practice, the slower/faster the device at hand is, the more/less -+ * it takes to load applications with respect to the reference device. -+ * Accordingly, the longer/shorter BFQ grants weight raising to -+ * interactive applications. - * - * BFQ uses four different reference pairs (R, T), depending on: - * . whether the device is rotational or non-rotational; -@@ -254,6 +256,60 @@ static int T_slow[2]; - static int T_fast[2]; - static int device_speed_thresh[2]; - -+/* -+ * BFQ uses the above-detailed, time-based weight-raising mechanism to -+ * privilege interactive tasks. This mechanism is vulnerable to the -+ * following false positives: I/O-bound applications that will go on -+ * doing I/O for much longer than the duration of weight -+ * raising. These applications have basically no benefit from being -+ * weight-raised at the beginning of their I/O. On the opposite end, -+ * while being weight-raised, these applications -+ * a) unjustly steal throughput to applications that may actually need -+ * low latency; -+ * b) make BFQ uselessly perform device idling; device idling results -+ * in loss of device throughput with most flash-based storage, and may -+ * increase latencies when used purposelessly. -+ * -+ * BFQ tries to reduce these problems, by adopting the following -+ * countermeasure. To introduce this countermeasure, we need first to -+ * finish explaining how the duration of weight-raising for -+ * interactive tasks is computed. -+ * -+ * For a bfq_queue deemed as interactive, the duration of weight -+ * raising is dynamically adjusted, as a function of the estimated -+ * peak rate of the device, so as to be equal to the time needed to -+ * execute the 'largest' interactive task we benchmarked so far. By -+ * largest task, we mean the task for which each involved process has -+ * to do more I/O than for any of the other tasks we benchmarked. This -+ * reference interactive task is the start-up of LibreOffice Writer, -+ * and in this task each process/bfq_queue needs to have at most ~110K -+ * sectors transferred. -+ * -+ * This last piece of information enables BFQ to reduce the actual -+ * duration of weight-raising for at least one class of I/O-bound -+ * applications: those doing sequential or quasi-sequential I/O. An -+ * example is file copy. In fact, once started, the main I/O-bound -+ * processes of these applications usually consume the above 110K -+ * sectors in much less time than the processes of an application that -+ * is starting, because these I/O-bound processes will greedily devote -+ * almost all their CPU cycles only to their target, -+ * throughput-friendly I/O operations. This is even more true if BFQ -+ * happens to be underestimating the device peak rate, and thus -+ * overestimating the duration of weight raising. But, according to -+ * our measurements, once transferred 110K sectors, these processes -+ * have no right to be weight-raised any longer. -+ * -+ * Basing on the last consideration, BFQ ends weight-raising for a -+ * bfq_queue if the latter happens to have received an amount of -+ * service at least equal to the following constant. The constant is -+ * set to slightly more than 110K, to have a minimum safety margin. -+ * -+ * This early ending of weight-raising reduces the amount of time -+ * during which interactive false positives cause the two problems -+ * described at the beginning of these comments. -+ */ -+static const unsigned long max_service_from_wr = 120000; -+ - #define RQ_BIC(rq) icq_to_bic((rq)->elv.priv[0]) - #define RQ_BFQQ(rq) ((rq)->elv.priv[1]) - -@@ -1352,6 +1408,7 @@ static void bfq_update_bfqq_wr_on_rq_arrival(struct bfq_data *bfqd, - if (old_wr_coeff == 1 && wr_or_deserves_wr) { - /* start a weight-raising period */ - if (interactive) { -+ bfqq->service_from_wr = 0; - bfqq->wr_coeff = bfqd->bfq_wr_coeff; - bfqq->wr_cur_max_time = bfq_wr_duration(bfqd); - } else { -@@ -3665,6 +3722,12 @@ static void bfq_update_wr_data(struct bfq_data *bfqd, struct bfq_queue *bfqq) - bfqq->entity.prio_changed = 1; - } - } -+ if (bfqq->wr_coeff > 1 && -+ bfqq->wr_cur_max_time != bfqd->bfq_wr_rt_max_time && -+ bfqq->service_from_wr > max_service_from_wr) { -+ /* see comments on max_service_from_wr */ -+ bfq_bfqq_end_wr(bfqq); -+ } - } - /* - * To improve latency (for this or other queues), immediately -diff --git a/block/bfq-iosched.h b/block/bfq-iosched.h -index fcd941008127..350c39ae2896 100644 ---- a/block/bfq-iosched.h -+++ b/block/bfq-iosched.h -@@ -337,6 +337,11 @@ struct bfq_queue { - * last transition from idle to backlogged. - */ - unsigned long service_from_backlogged; -+ /* -+ * Cumulative service received from the @bfq_queue since its -+ * last transition to weight-raised state. -+ */ -+ unsigned long service_from_wr; - - /* - * Value of wr start time when switching to soft rt -diff --git a/block/bfq-wf2q.c b/block/bfq-wf2q.c -index 4456eda34e48..4498c43245e2 100644 ---- a/block/bfq-wf2q.c -+++ b/block/bfq-wf2q.c -@@ -838,6 +838,9 @@ void bfq_bfqq_served(struct bfq_queue *bfqq, int served) - if (!bfqq->service_from_backlogged) - bfqq->first_IO_time = jiffies; - -+ if (bfqq->wr_coeff > 1) -+ bfqq->service_from_wr += served; -+ - bfqq->service_from_backlogged += served; - for_each_entity(entity) { - st = bfq_entity_service_tree(entity); --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-limit-tags-for-writes-and-async-I-O.patch b/kernel/kernel/files/patches/mageia/block-bfq-limit-tags-for-writes-and-async-I-O.patch deleted file mode 100644 index e165539e..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-limit-tags-for-writes-and-async-I-O.patch +++ /dev/null @@ -1,162 +0,0 @@ -From a52a69ea89dc12e6f4572f554940789c1ab23c7a Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Sat, 13 Jan 2018 12:05:17 +0100 -Subject: [PATCH] block, bfq: limit tags for writes and async I/O -MIME-Version: 1.0 -Content-Type: text/plain; charset=UTF-8 -Content-Transfer-Encoding: 8bit - -Asynchronous I/O can easily starve synchronous I/O (both sync reads -and sync writes), by consuming all request tags. Similarly, storms of -synchronous writes, such as those that sync(2) may trigger, can starve -synchronous reads. In their turn, these two problems may also cause -BFQ to loose control on latency for interactive and soft real-time -applications. For example, on a PLEXTOR PX-256M5S SSD, LibreOffice -Writer takes 0.6 seconds to start if the device is idle, but it takes -more than 45 seconds (!) if there are sequential writes in the -background. - -This commit addresses this issue by limiting the maximum percentage of -tags that asynchronous I/O requests and synchronous write requests can -consume. In particular, this commit grants a higher threshold to -synchronous writes, to prevent the latter from being starved by -asynchronous I/O. - -According to the above test, LibreOffice Writer now starts in about -1.2 seconds on average, regardless of the background workload, and -apart from some rare outlier. To check this improvement, run, e.g., -sudo ./comm_startup_lat.sh bfq 5 5 seq 10 "lowriter --terminate_after_init" -for the comm_startup_lat benchmark in the S suite [1]. - -[1] https://github.com/Algodev-github/S - -Tested-by: Oleksandr Natalenko -Tested-by: Holger Hoffstätte -Signed-off-by: Paolo Valente -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 77 +++++++++++++++++++++++++++++++++++++++++++++++++++++ - block/bfq-iosched.h | 12 +++++++++ - 2 files changed, 89 insertions(+) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index f352b1677143..a7ab0cb50733 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -417,6 +417,82 @@ static struct request *bfq_choose_req(struct bfq_data *bfqd, - } - } - -+/* -+ * See the comments on bfq_limit_depth for the purpose of -+ * the depths set in the function. -+ */ -+static void bfq_update_depths(struct bfq_data *bfqd, struct sbitmap_queue *bt) -+{ -+ bfqd->sb_shift = bt->sb.shift; -+ -+ /* -+ * In-word depths if no bfq_queue is being weight-raised: -+ * leaving 25% of tags only for sync reads. -+ * -+ * In next formulas, right-shift the value -+ * (1U<sb_shift), instead of computing directly -+ * (1U<<(bfqd->sb_shift - something)), to be robust against -+ * any possible value of bfqd->sb_shift, without having to -+ * limit 'something'. -+ */ -+ /* no more than 50% of tags for async I/O */ -+ bfqd->word_depths[0][0] = max((1U<sb_shift)>>1, 1U); -+ /* -+ * no more than 75% of tags for sync writes (25% extra tags -+ * w.r.t. async I/O, to prevent async I/O from starving sync -+ * writes) -+ */ -+ bfqd->word_depths[0][1] = max(((1U<sb_shift) * 3)>>2, 1U); -+ -+ /* -+ * In-word depths in case some bfq_queue is being weight- -+ * raised: leaving ~63% of tags for sync reads. This is the -+ * highest percentage for which, in our tests, application -+ * start-up times didn't suffer from any regression due to tag -+ * shortage. -+ */ -+ /* no more than ~18% of tags for async I/O */ -+ bfqd->word_depths[1][0] = max(((1U<sb_shift) * 3)>>4, 1U); -+ /* no more than ~37% of tags for sync writes (~20% extra tags) */ -+ bfqd->word_depths[1][1] = max(((1U<sb_shift) * 6)>>4, 1U); -+} -+ -+/* -+ * Async I/O can easily starve sync I/O (both sync reads and sync -+ * writes), by consuming all tags. Similarly, storms of sync writes, -+ * such as those that sync(2) may trigger, can starve sync reads. -+ * Limit depths of async I/O and sync writes so as to counter both -+ * problems. -+ */ -+static void bfq_limit_depth(unsigned int op, struct blk_mq_alloc_data *data) -+{ -+ struct blk_mq_tags *tags = blk_mq_tags_from_data(data); -+ struct bfq_data *bfqd = data->q->elevator->elevator_data; -+ struct sbitmap_queue *bt; -+ -+ if (op_is_sync(op) && !op_is_write(op)) -+ return; -+ -+ if (data->flags & BLK_MQ_REQ_RESERVED) { -+ if (unlikely(!tags->nr_reserved_tags)) { -+ WARN_ON_ONCE(1); -+ return; -+ } -+ bt = &tags->breserved_tags; -+ } else -+ bt = &tags->bitmap_tags; -+ -+ if (unlikely(bfqd->sb_shift != bt->sb.shift)) -+ bfq_update_depths(bfqd, bt); -+ -+ data->shallow_depth = -+ bfqd->word_depths[!!bfqd->wr_busy_queues][op_is_sync(op)]; -+ -+ bfq_log(bfqd, "[%s] wr_busy %d sync %d depth %u", -+ __func__, bfqd->wr_busy_queues, op_is_sync(op), -+ data->shallow_depth); -+} -+ - static struct bfq_queue * - bfq_rq_pos_tree_lookup(struct bfq_data *bfqd, struct rb_root *root, - sector_t sector, struct rb_node **ret_parent, -@@ -5285,6 +5361,7 @@ static struct elv_fs_entry bfq_attrs[] = { - - static struct elevator_type iosched_bfq_mq = { - .ops.mq = { -+ .limit_depth = bfq_limit_depth, - .prepare_request = bfq_prepare_request, - .finish_request = bfq_finish_request, - .exit_icq = bfq_exit_icq, -diff --git a/block/bfq-iosched.h b/block/bfq-iosched.h -index 5d47b58d5fc8..fcd941008127 100644 ---- a/block/bfq-iosched.h -+++ b/block/bfq-iosched.h -@@ -629,6 +629,18 @@ struct bfq_data { - struct bfq_io_cq *bio_bic; - /* bfqq associated with the task issuing current bio for merging */ - struct bfq_queue *bio_bfqq; -+ -+ /* -+ * Cached sbitmap shift, used to compute depth limits in -+ * bfq_update_depths. -+ */ -+ unsigned int sb_shift; -+ -+ /* -+ * Depth limits used in bfq_limit_depth (see comments on the -+ * function) -+ */ -+ unsigned int word_depths[2][2]; - }; - - enum bfqq_state_flags { --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-move-debug-blkio-stats-behind-CONFIG_DEBUG.patch b/kernel/kernel/files/patches/mageia/block-bfq-move-debug-blkio-stats-behind-CONFIG_DEBUG.patch deleted file mode 100644 index 6bf8c497..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-move-debug-blkio-stats-behind-CONFIG_DEBUG.patch +++ /dev/null @@ -1,467 +0,0 @@ -From a33801e8b4735b8d473f963e5854172f9cde3e8b Mon Sep 17 00:00:00 2001 -From: Luca Miccio -Date: Mon, 13 Nov 2017 07:34:10 +0100 -Subject: [PATCH] block, bfq: move debug blkio stats behind - CONFIG_DEBUG_BLK_CGROUP - -BFQ currently creates, and updates, its own instance of the whole -set of blkio statistics that cfq creates. Yet, from the comments -of Tejun Heo in [1], it turned out that most of these statistics -are meant/useful only for debugging. This commit makes BFQ create -the latter, debugging statistics only if the option -CONFIG_DEBUG_BLK_CGROUP is set. - -By doing so, this commit also enables BFQ to enjoy a high perfomance -boost. The reason is that, if CONFIG_DEBUG_BLK_CGROUP is not set, then -BFQ has to update far fewer statistics, and, in particular, not the -heaviest to update. To give an idea of the benefits, if -CONFIG_DEBUG_BLK_CGROUP is not set, then, on an Intel i7-4850HQ, and -with 8 threads doing random I/O in parallel on null_blk (configured -with 0 latency), the throughput of BFQ grows from 310 to 400 KIOPS -(+30%). We have measured similar or even much higher boosts with other -CPUs: e.g., +45% with an ARM CortexTM-A53 Octa-core. Our results have -been obtained and can be reproduced very easily with the script in [1]. - -[1] https://www.spinics.net/lists/linux-block/msg18943.html - -Suggested-by: Tejun Heo -Suggested-by: Ulf Hansson -Tested-by: Lee Tibbert -Tested-by: Oleksandr Natalenko -Signed-off-by: Luca Miccio -Signed-off-by: Paolo Valente -Signed-off-by: Jens Axboe ---- - Documentation/block/bfq-iosched.txt | 38 +++++++-- - block/bfq-cgroup.c | 148 ++++++++++++++++++++---------------- - block/bfq-iosched.c | 14 ++-- - block/bfq-iosched.h | 4 +- - 4 files changed, 125 insertions(+), 79 deletions(-) - -diff --git a/Documentation/block/bfq-iosched.txt b/Documentation/block/bfq-iosched.txt -index 7fad6c061470..8d8d8f06cab2 100644 ---- a/Documentation/block/bfq-iosched.txt -+++ b/Documentation/block/bfq-iosched.txt -@@ -20,12 +20,22 @@ for that device, by setting low_latency to 0. See Section 3 for - details on how to configure BFQ for the desired tradeoff between - latency and throughput, or on how to maximize throughput. - --BFQ has a non-null overhead, which limits the maximum IOPS that the --CPU can process for a device scheduled with BFQ. To give an idea of --the limits on slow or average CPUs, here are BFQ limits for three --different CPUs, on, respectively, an average laptop, an old desktop, --and a cheap embedded system, in case full hierarchical support is --enabled (i.e., CONFIG_BFQ_GROUP_IOSCHED is set): -+BFQ has a non-null overhead, which limits the maximum IOPS that a CPU -+can process for a device scheduled with BFQ. To give an idea of the -+limits on slow or average CPUs, here are, first, the limits of BFQ for -+three different CPUs, on, respectively, an average laptop, an old -+desktop, and a cheap embedded system, in case full hierarchical -+support is enabled (i.e., CONFIG_BFQ_GROUP_IOSCHED is set), but -+CONFIG_DEBUG_BLK_CGROUP is not set (Section 4-2): -+- Intel i7-4850HQ: 400 KIOPS -+- AMD A8-3850: 250 KIOPS -+- ARM CortexTM-A53 Octa-core: 80 KIOPS -+ -+If CONFIG_DEBUG_BLK_CGROUP is set (and of course full hierarchical -+support is enabled), then the sustainable throughput with BFQ -+decreases, because all blkio.bfq* statistics are created and updated -+(Section 4-2). For BFQ, this leads to the following maximum -+sustainable throughputs, on the same systems as above: - - Intel i7-4850HQ: 310 KIOPS - - AMD A8-3850: 200 KIOPS - - ARM CortexTM-A53 Octa-core: 56 KIOPS -@@ -505,6 +515,22 @@ BFQ-specific files is "blkio.bfq." or "io.bfq." For example, the group - parameter to set the weight of a group with BFQ is blkio.bfq.weight - or io.bfq.weight. - -+As for cgroups-v1 (blkio controller), the exact set of stat files -+created, and kept up-to-date by bfq, depends on whether -+CONFIG_DEBUG_BLK_CGROUP is set. If it is set, then bfq creates all -+the stat files documented in -+Documentation/cgroup-v1/blkio-controller.txt. If, instead, -+CONFIG_DEBUG_BLK_CGROUP is not set, then bfq creates only the files -+blkio.bfq.io_service_bytes -+blkio.bfq.io_service_bytes_recursive -+blkio.bfq.io_serviced -+blkio.bfq.io_serviced_recursive -+ -+The value of CONFIG_DEBUG_BLK_CGROUP greatly influences the maximum -+throughput sustainable with bfq, because updating the blkio.bfq.* -+stats is rather costly, especially for some of the stats enabled by -+CONFIG_DEBUG_BLK_CGROUP. -+ - Parameters to set - ----------------- - -diff --git a/block/bfq-cgroup.c b/block/bfq-cgroup.c -index ceefb9a706d6..da1525ec4c87 100644 ---- a/block/bfq-cgroup.c -+++ b/block/bfq-cgroup.c -@@ -24,7 +24,7 @@ - - #include "bfq-iosched.h" - --#ifdef CONFIG_BFQ_GROUP_IOSCHED -+#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) - - /* bfqg stats flags */ - enum bfqg_stats_flags { -@@ -152,6 +152,57 @@ void bfqg_stats_update_avg_queue_size(struct bfq_group *bfqg) - bfqg_stats_update_group_wait_time(stats); - } - -+void bfqg_stats_update_io_add(struct bfq_group *bfqg, struct bfq_queue *bfqq, -+ unsigned int op) -+{ -+ blkg_rwstat_add(&bfqg->stats.queued, op, 1); -+ bfqg_stats_end_empty_time(&bfqg->stats); -+ if (!(bfqq == ((struct bfq_data *)bfqg->bfqd)->in_service_queue)) -+ bfqg_stats_set_start_group_wait_time(bfqg, bfqq_group(bfqq)); -+} -+ -+void bfqg_stats_update_io_remove(struct bfq_group *bfqg, unsigned int op) -+{ -+ blkg_rwstat_add(&bfqg->stats.queued, op, -1); -+} -+ -+void bfqg_stats_update_io_merged(struct bfq_group *bfqg, unsigned int op) -+{ -+ blkg_rwstat_add(&bfqg->stats.merged, op, 1); -+} -+ -+void bfqg_stats_update_completion(struct bfq_group *bfqg, uint64_t start_time, -+ uint64_t io_start_time, unsigned int op) -+{ -+ struct bfqg_stats *stats = &bfqg->stats; -+ unsigned long long now = sched_clock(); -+ -+ if (time_after64(now, io_start_time)) -+ blkg_rwstat_add(&stats->service_time, op, -+ now - io_start_time); -+ if (time_after64(io_start_time, start_time)) -+ blkg_rwstat_add(&stats->wait_time, op, -+ io_start_time - start_time); -+} -+ -+#else /* CONFIG_BFQ_GROUP_IOSCHED && CONFIG_DEBUG_BLK_CGROUP */ -+ -+void bfqg_stats_update_io_add(struct bfq_group *bfqg, struct bfq_queue *bfqq, -+ unsigned int op) { } -+void bfqg_stats_update_io_remove(struct bfq_group *bfqg, unsigned int op) { } -+void bfqg_stats_update_io_merged(struct bfq_group *bfqg, unsigned int op) { } -+void bfqg_stats_update_completion(struct bfq_group *bfqg, uint64_t start_time, -+ uint64_t io_start_time, unsigned int op) { } -+void bfqg_stats_update_dequeue(struct bfq_group *bfqg) { } -+void bfqg_stats_set_start_empty_time(struct bfq_group *bfqg) { } -+void bfqg_stats_update_idle_time(struct bfq_group *bfqg) { } -+void bfqg_stats_set_start_idle_time(struct bfq_group *bfqg) { } -+void bfqg_stats_update_avg_queue_size(struct bfq_group *bfqg) { } -+ -+#endif /* CONFIG_BFQ_GROUP_IOSCHED && CONFIG_DEBUG_BLK_CGROUP */ -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ - /* - * blk-cgroup policy-related handlers - * The following functions help in converting between blk-cgroup -@@ -229,42 +280,10 @@ void bfqg_and_blkg_put(struct bfq_group *bfqg) - blkg_put(bfqg_to_blkg(bfqg)); - } - --void bfqg_stats_update_io_add(struct bfq_group *bfqg, struct bfq_queue *bfqq, -- unsigned int op) --{ -- blkg_rwstat_add(&bfqg->stats.queued, op, 1); -- bfqg_stats_end_empty_time(&bfqg->stats); -- if (!(bfqq == ((struct bfq_data *)bfqg->bfqd)->in_service_queue)) -- bfqg_stats_set_start_group_wait_time(bfqg, bfqq_group(bfqq)); --} -- --void bfqg_stats_update_io_remove(struct bfq_group *bfqg, unsigned int op) --{ -- blkg_rwstat_add(&bfqg->stats.queued, op, -1); --} -- --void bfqg_stats_update_io_merged(struct bfq_group *bfqg, unsigned int op) --{ -- blkg_rwstat_add(&bfqg->stats.merged, op, 1); --} -- --void bfqg_stats_update_completion(struct bfq_group *bfqg, uint64_t start_time, -- uint64_t io_start_time, unsigned int op) --{ -- struct bfqg_stats *stats = &bfqg->stats; -- unsigned long long now = sched_clock(); -- -- if (time_after64(now, io_start_time)) -- blkg_rwstat_add(&stats->service_time, op, -- now - io_start_time); -- if (time_after64(io_start_time, start_time)) -- blkg_rwstat_add(&stats->wait_time, op, -- io_start_time - start_time); --} -- - /* @stats = 0 */ - static void bfqg_stats_reset(struct bfqg_stats *stats) - { -+#ifdef CONFIG_DEBUG_BLK_CGROUP - /* queued stats shouldn't be cleared */ - blkg_rwstat_reset(&stats->merged); - blkg_rwstat_reset(&stats->service_time); -@@ -276,6 +295,7 @@ static void bfqg_stats_reset(struct bfqg_stats *stats) - blkg_stat_reset(&stats->group_wait_time); - blkg_stat_reset(&stats->idle_time); - blkg_stat_reset(&stats->empty_time); -+#endif - } - - /* @to += @from */ -@@ -284,6 +304,7 @@ static void bfqg_stats_add_aux(struct bfqg_stats *to, struct bfqg_stats *from) - if (!to || !from) - return; - -+#ifdef CONFIG_DEBUG_BLK_CGROUP - /* queued stats shouldn't be cleared */ - blkg_rwstat_add_aux(&to->merged, &from->merged); - blkg_rwstat_add_aux(&to->service_time, &from->service_time); -@@ -296,6 +317,7 @@ static void bfqg_stats_add_aux(struct bfqg_stats *to, struct bfqg_stats *from) - blkg_stat_add_aux(&to->group_wait_time, &from->group_wait_time); - blkg_stat_add_aux(&to->idle_time, &from->idle_time); - blkg_stat_add_aux(&to->empty_time, &from->empty_time); -+#endif - } - - /* -@@ -342,6 +364,7 @@ void bfq_init_entity(struct bfq_entity *entity, struct bfq_group *bfqg) - - static void bfqg_stats_exit(struct bfqg_stats *stats) - { -+#ifdef CONFIG_DEBUG_BLK_CGROUP - blkg_rwstat_exit(&stats->merged); - blkg_rwstat_exit(&stats->service_time); - blkg_rwstat_exit(&stats->wait_time); -@@ -353,10 +376,12 @@ static void bfqg_stats_exit(struct bfqg_stats *stats) - blkg_stat_exit(&stats->group_wait_time); - blkg_stat_exit(&stats->idle_time); - blkg_stat_exit(&stats->empty_time); -+#endif - } - - static int bfqg_stats_init(struct bfqg_stats *stats, gfp_t gfp) - { -+#ifdef CONFIG_DEBUG_BLK_CGROUP - if (blkg_rwstat_init(&stats->merged, gfp) || - blkg_rwstat_init(&stats->service_time, gfp) || - blkg_rwstat_init(&stats->wait_time, gfp) || -@@ -371,6 +396,7 @@ static int bfqg_stats_init(struct bfqg_stats *stats, gfp_t gfp) - bfqg_stats_exit(stats); - return -ENOMEM; - } -+#endif - - return 0; - } -@@ -887,6 +913,7 @@ static ssize_t bfq_io_set_weight(struct kernfs_open_file *of, - return bfq_io_set_weight_legacy(of_css(of), NULL, weight); - } - -+#ifdef CONFIG_DEBUG_BLK_CGROUP - static int bfqg_print_stat(struct seq_file *sf, void *v) - { - blkcg_print_blkgs(sf, css_to_blkcg(seq_css(sf)), blkg_prfill_stat, -@@ -991,6 +1018,7 @@ static int bfqg_print_avg_queue_size(struct seq_file *sf, void *v) - 0, false); - return 0; - } -+#endif /* CONFIG_DEBUG_BLK_CGROUP */ - - struct bfq_group *bfq_create_group_hierarchy(struct bfq_data *bfqd, int node) - { -@@ -1028,15 +1056,6 @@ struct cftype bfq_blkcg_legacy_files[] = { - }, - - /* statistics, covers only the tasks in the bfqg */ -- { -- .name = "bfq.time", -- .private = offsetof(struct bfq_group, stats.time), -- .seq_show = bfqg_print_stat, -- }, -- { -- .name = "bfq.sectors", -- .seq_show = bfqg_print_stat_sectors, -- }, - { - .name = "bfq.io_service_bytes", - .private = (unsigned long)&blkcg_policy_bfq, -@@ -1047,6 +1066,16 @@ struct cftype bfq_blkcg_legacy_files[] = { - .private = (unsigned long)&blkcg_policy_bfq, - .seq_show = blkg_print_stat_ios, - }, -+#ifdef CONFIG_DEBUG_BLK_CGROUP -+ { -+ .name = "bfq.time", -+ .private = offsetof(struct bfq_group, stats.time), -+ .seq_show = bfqg_print_stat, -+ }, -+ { -+ .name = "bfq.sectors", -+ .seq_show = bfqg_print_stat_sectors, -+ }, - { - .name = "bfq.io_service_time", - .private = offsetof(struct bfq_group, stats.service_time), -@@ -1067,17 +1096,9 @@ struct cftype bfq_blkcg_legacy_files[] = { - .private = offsetof(struct bfq_group, stats.queued), - .seq_show = bfqg_print_rwstat, - }, -+#endif /* CONFIG_DEBUG_BLK_CGROUP */ - - /* the same statictics which cover the bfqg and its descendants */ -- { -- .name = "bfq.time_recursive", -- .private = offsetof(struct bfq_group, stats.time), -- .seq_show = bfqg_print_stat_recursive, -- }, -- { -- .name = "bfq.sectors_recursive", -- .seq_show = bfqg_print_stat_sectors_recursive, -- }, - { - .name = "bfq.io_service_bytes_recursive", - .private = (unsigned long)&blkcg_policy_bfq, -@@ -1088,6 +1109,16 @@ struct cftype bfq_blkcg_legacy_files[] = { - .private = (unsigned long)&blkcg_policy_bfq, - .seq_show = blkg_print_stat_ios_recursive, - }, -+#ifdef CONFIG_DEBUG_BLK_CGROUP -+ { -+ .name = "bfq.time_recursive", -+ .private = offsetof(struct bfq_group, stats.time), -+ .seq_show = bfqg_print_stat_recursive, -+ }, -+ { -+ .name = "bfq.sectors_recursive", -+ .seq_show = bfqg_print_stat_sectors_recursive, -+ }, - { - .name = "bfq.io_service_time_recursive", - .private = offsetof(struct bfq_group, stats.service_time), -@@ -1132,6 +1163,7 @@ struct cftype bfq_blkcg_legacy_files[] = { - .private = offsetof(struct bfq_group, stats.dequeue), - .seq_show = bfqg_print_stat, - }, -+#endif /* CONFIG_DEBUG_BLK_CGROUP */ - { } /* terminate */ - }; - -@@ -1147,18 +1179,6 @@ struct cftype bfq_blkg_files[] = { - - #else /* CONFIG_BFQ_GROUP_IOSCHED */ - --void bfqg_stats_update_io_add(struct bfq_group *bfqg, struct bfq_queue *bfqq, -- unsigned int op) { } --void bfqg_stats_update_io_remove(struct bfq_group *bfqg, unsigned int op) { } --void bfqg_stats_update_io_merged(struct bfq_group *bfqg, unsigned int op) { } --void bfqg_stats_update_completion(struct bfq_group *bfqg, uint64_t start_time, -- uint64_t io_start_time, unsigned int op) { } --void bfqg_stats_update_dequeue(struct bfq_group *bfqg) { } --void bfqg_stats_set_start_empty_time(struct bfq_group *bfqg) { } --void bfqg_stats_update_idle_time(struct bfq_group *bfqg) { } --void bfqg_stats_set_start_idle_time(struct bfq_group *bfqg) { } --void bfqg_stats_update_avg_queue_size(struct bfq_group *bfqg) { } -- - void bfq_bfqq_move(struct bfq_data *bfqd, struct bfq_queue *bfqq, - struct bfq_group *bfqg) {} - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 69e05f861daf..bcb6d21baf12 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -3693,14 +3693,14 @@ static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) - { - struct bfq_data *bfqd = hctx->queue->elevator->elevator_data; - struct request *rq; --#ifdef CONFIG_BFQ_GROUP_IOSCHED -+#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) - struct bfq_queue *in_serv_queue, *bfqq; - bool waiting_rq, idle_timer_disabled; - #endif - - spin_lock_irq(&bfqd->lock); - --#ifdef CONFIG_BFQ_GROUP_IOSCHED -+#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) - in_serv_queue = bfqd->in_service_queue; - waiting_rq = in_serv_queue && bfq_bfqq_wait_request(in_serv_queue); - -@@ -3714,7 +3714,7 @@ static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) - #endif - spin_unlock_irq(&bfqd->lock); - --#ifdef CONFIG_BFQ_GROUP_IOSCHED -+#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) - bfqq = rq ? RQ_BFQQ(rq) : NULL; - if (!idle_timer_disabled && !bfqq) - return rq; -@@ -4281,7 +4281,7 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - { - struct request_queue *q = hctx->queue; - struct bfq_data *bfqd = q->elevator->elevator_data; --#ifdef CONFIG_BFQ_GROUP_IOSCHED -+#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) - struct bfq_queue *bfqq = RQ_BFQQ(rq); - bool idle_timer_disabled = false; - unsigned int cmd_flags; -@@ -4304,7 +4304,7 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - else - list_add_tail(&rq->queuelist, &bfqd->dispatch); - } else { --#ifdef CONFIG_BFQ_GROUP_IOSCHED -+#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) - idle_timer_disabled = __bfq_insert_request(bfqd, rq); - /* - * Update bfqq, because, if a queue merge has occurred -@@ -4323,7 +4323,7 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - } - } - --#ifdef CONFIG_BFQ_GROUP_IOSCHED -+#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) - /* - * Cache cmd_flags before releasing scheduler lock, because rq - * may disappear afterwards (for example, because of a request -@@ -4333,7 +4333,7 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - #endif - spin_unlock_irq(&bfqd->lock); - --#ifdef CONFIG_BFQ_GROUP_IOSCHED -+#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) - if (!bfqq) - return; - /* -diff --git a/block/bfq-iosched.h b/block/bfq-iosched.h -index ac0809c72c98..91c4390903a1 100644 ---- a/block/bfq-iosched.h -+++ b/block/bfq-iosched.h -@@ -689,7 +689,7 @@ enum bfqq_expiration { - }; - - struct bfqg_stats { --#ifdef CONFIG_BFQ_GROUP_IOSCHED -+#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) - /* number of ios merged */ - struct blkg_rwstat merged; - /* total time spent on device in ns, may not be accurate w/ queueing */ -@@ -717,7 +717,7 @@ struct bfqg_stats { - uint64_t start_idle_time; - uint64_t start_empty_time; - uint16_t flags; --#endif /* CONFIG_BFQ_GROUP_IOSCHED */ -+#endif /* CONFIG_BFQ_GROUP_IOSCHED && CONFIG_DEBUG_BLK_CGROUP */ - }; - - #ifdef CONFIG_BFQ_GROUP_IOSCHED --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-put-async-queues-for-root-bfq-groups-too.patch b/kernel/kernel/files/patches/mageia/block-bfq-put-async-queues-for-root-bfq-groups-too.patch deleted file mode 100644 index 11f33137..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-put-async-queues-for-root-bfq-groups-too.patch +++ /dev/null @@ -1,67 +0,0 @@ -From 52257ffbfcaf58d247b13fb148e27ed17c33e526 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Tue, 9 Jan 2018 10:27:58 +0100 -Subject: [PATCH] block, bfq: put async queues for root bfq groups too -MIME-Version: 1.0 -Content-Type: text/plain; charset=UTF-8 -Content-Transfer-Encoding: 8bit - -For each pair [device for which bfq is selected as I/O scheduler, -group in blkio/io], bfq maintains a corresponding bfq group. Each such -bfq group contains a set of async queues, with each async queue -created on demand, i.e., when some I/O request arrives for it. On -creation, an async queue gets an extra reference, to make sure that -the queue is not freed as long as its bfq group exists. Accordingly, -to allow the queue to be freed after the group exited, this extra -reference must released on group exit. - -The above holds also for a bfq root group, i.e., for the bfq group -corresponding to the root blkio/io root for a given device. Yet, by -mistake, the references to the existing async queues of a root group -are not released when the latter exits. This causes a memory leak when -the instance of bfq for a given device exits. In a similar vein, -bfqg_stats_xfer_dead is not executed for a root group. - -This commit fixes bfq_pd_offline so that the latter executes the above -missing operations for a root group too. - -Reported-by: Holger Hoffstätte -Reported-by: Guoqing Jiang -Tested-by: Holger Hoffstätte -Signed-off-by: Davide Ferrari -Signed-off-by: Paolo Valente -Signed-off-by: Jens Axboe ---- - block/bfq-cgroup.c | 7 +++++-- - 1 file changed, 5 insertions(+), 2 deletions(-) - -diff --git a/block/bfq-cgroup.c b/block/bfq-cgroup.c -index da1525ec4c87..d819dc77fe65 100644 ---- a/block/bfq-cgroup.c -+++ b/block/bfq-cgroup.c -@@ -775,10 +775,11 @@ static void bfq_pd_offline(struct blkg_policy_data *pd) - unsigned long flags; - int i; - -+ spin_lock_irqsave(&bfqd->lock, flags); -+ - if (!entity) /* root group */ -- return; -+ goto put_async_queues; - -- spin_lock_irqsave(&bfqd->lock, flags); - /* - * Empty all service_trees belonging to this group before - * deactivating the group itself. -@@ -809,6 +810,8 @@ static void bfq_pd_offline(struct blkg_policy_data *pd) - } - - __bfq_deactivate_entity(entity, false); -+ -+put_async_queues: - bfq_put_async_queues(bfqd, bfqg); - - spin_unlock_irqrestore(&bfqd->lock, flags); --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-release-oom-queue-ref-to-root-group-on-exi.patch b/kernel/kernel/files/patches/mageia/block-bfq-release-oom-queue-ref-to-root-group-on-exi.patch deleted file mode 100644 index 3f965e25..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-release-oom-queue-ref-to-root-group-on-exi.patch +++ /dev/null @@ -1,39 +0,0 @@ -From 0d52af590552473666da5b6111e7182d6cd23f92 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Tue, 9 Jan 2018 10:27:59 +0100 -Subject: [PATCH] block, bfq: release oom-queue ref to root group on exit -MIME-Version: 1.0 -Content-Type: text/plain; charset=UTF-8 -Content-Transfer-Encoding: 8bit - -On scheduler init, a reference to the root group, and a reference to -its corresponding blkg are taken for the oom queue. Yet these -references are not released on scheduler exit, which prevents these -objects from be freed. This commit adds the missing reference -releases. - -Reported-by: Davide Ferrari -Tested-by: Holger Hoffstätte -Signed-off-by: Paolo Valente -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 3 +++ - 1 file changed, 3 insertions(+) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 7bd789da7a29..7c0b7f60811c 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -4893,6 +4893,9 @@ static void bfq_exit_queue(struct elevator_queue *e) - - hrtimer_cancel(&bfqd->idle_slice_timer); - -+ /* release oom-queue reference to root group */ -+ bfqg_and_blkg_put(bfqd->root_group); -+ - #ifdef CONFIG_BFQ_GROUP_IOSCHED - blkcg_deactivate_policy(bfqd->queue, &blkcg_policy_bfq); - #else --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-remove-batches-of-confusing-ifdefs.patch b/kernel/kernel/files/patches/mageia/block-bfq-remove-batches-of-confusing-ifdefs.patch deleted file mode 100644 index be493afd..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-remove-batches-of-confusing-ifdefs.patch +++ /dev/null @@ -1,225 +0,0 @@ -From 9b25bd0368d562d1929059e8eb9de4102567b923 Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Mon, 4 Dec 2017 11:42:05 +0100 -Subject: [PATCH] block, bfq: remove batches of confusing ifdefs - -Commit a33801e8b473 ("block, bfq: move debug blkio stats behind -CONFIG_DEBUG_BLK_CGROUP") introduced two batches of confusing ifdefs: -one reported in [1], plus a similar one in another function. This -commit removes both batches, in the way suggested in [1]. - -[1] https://www.spinics.net/lists/linux-block/msg20043.html - -Fixes: a33801e8b473 ("block, bfq: move debug blkio stats behind CONFIG_DEBUG_BLK_CGROUP") -Reported-by: Linus Torvalds -Tested-by: Luca Miccio -Signed-off-by: Paolo Valente -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 127 +++++++++++++++++++++++++++++----------------------- - 1 file changed, 72 insertions(+), 55 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index e33c5c4c9856..7bd789da7a29 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -3743,35 +3743,16 @@ static struct request *__bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) - return rq; - } - --static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) --{ -- struct bfq_data *bfqd = hctx->queue->elevator->elevator_data; -- struct request *rq; - #if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) -- struct bfq_queue *in_serv_queue, *bfqq; -- bool waiting_rq, idle_timer_disabled; --#endif -- -- spin_lock_irq(&bfqd->lock); -- --#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) -- in_serv_queue = bfqd->in_service_queue; -- waiting_rq = in_serv_queue && bfq_bfqq_wait_request(in_serv_queue); -- -- rq = __bfq_dispatch_request(hctx); -- -- idle_timer_disabled = -- waiting_rq && !bfq_bfqq_wait_request(in_serv_queue); -- --#else -- rq = __bfq_dispatch_request(hctx); --#endif -- spin_unlock_irq(&bfqd->lock); -+static void bfq_update_dispatch_stats(struct request_queue *q, -+ struct request *rq, -+ struct bfq_queue *in_serv_queue, -+ bool idle_timer_disabled) -+{ -+ struct bfq_queue *bfqq = rq ? RQ_BFQQ(rq) : NULL; - --#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) -- bfqq = rq ? RQ_BFQQ(rq) : NULL; - if (!idle_timer_disabled && !bfqq) -- return rq; -+ return; - - /* - * rq and bfqq are guaranteed to exist until this function -@@ -3786,7 +3767,7 @@ static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) - * In addition, the following queue lock guarantees that - * bfqq_group(bfqq) exists as well. - */ -- spin_lock_irq(hctx->queue->queue_lock); -+ spin_lock_irq(q->queue_lock); - if (idle_timer_disabled) - /* - * Since the idle timer has been disabled, -@@ -3805,9 +3786,37 @@ static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) - bfqg_stats_set_start_empty_time(bfqg); - bfqg_stats_update_io_remove(bfqg, rq->cmd_flags); - } -- spin_unlock_irq(hctx->queue->queue_lock); -+ spin_unlock_irq(q->queue_lock); -+} -+#else -+static inline void bfq_update_dispatch_stats(struct request_queue *q, -+ struct request *rq, -+ struct bfq_queue *in_serv_queue, -+ bool idle_timer_disabled) {} - #endif - -+static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) -+{ -+ struct bfq_data *bfqd = hctx->queue->elevator->elevator_data; -+ struct request *rq; -+ struct bfq_queue *in_serv_queue; -+ bool waiting_rq, idle_timer_disabled; -+ -+ spin_lock_irq(&bfqd->lock); -+ -+ in_serv_queue = bfqd->in_service_queue; -+ waiting_rq = in_serv_queue && bfq_bfqq_wait_request(in_serv_queue); -+ -+ rq = __bfq_dispatch_request(hctx); -+ -+ idle_timer_disabled = -+ waiting_rq && !bfq_bfqq_wait_request(in_serv_queue); -+ -+ spin_unlock_irq(&bfqd->lock); -+ -+ bfq_update_dispatch_stats(hctx->queue, rq, in_serv_queue, -+ idle_timer_disabled); -+ - return rq; - } - -@@ -4335,16 +4344,46 @@ static bool __bfq_insert_request(struct bfq_data *bfqd, struct request *rq) - return idle_timer_disabled; - } - -+#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) -+static void bfq_update_insert_stats(struct request_queue *q, -+ struct bfq_queue *bfqq, -+ bool idle_timer_disabled, -+ unsigned int cmd_flags) -+{ -+ if (!bfqq) -+ return; -+ -+ /* -+ * bfqq still exists, because it can disappear only after -+ * either it is merged with another queue, or the process it -+ * is associated with exits. But both actions must be taken by -+ * the same process currently executing this flow of -+ * instructions. -+ * -+ * In addition, the following queue lock guarantees that -+ * bfqq_group(bfqq) exists as well. -+ */ -+ spin_lock_irq(q->queue_lock); -+ bfqg_stats_update_io_add(bfqq_group(bfqq), bfqq, cmd_flags); -+ if (idle_timer_disabled) -+ bfqg_stats_update_idle_time(bfqq_group(bfqq)); -+ spin_unlock_irq(q->queue_lock); -+} -+#else -+static inline void bfq_update_insert_stats(struct request_queue *q, -+ struct bfq_queue *bfqq, -+ bool idle_timer_disabled, -+ unsigned int cmd_flags) {} -+#endif -+ - static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - bool at_head) - { - struct request_queue *q = hctx->queue; - struct bfq_data *bfqd = q->elevator->elevator_data; --#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) - struct bfq_queue *bfqq = RQ_BFQQ(rq); - bool idle_timer_disabled = false; - unsigned int cmd_flags; --#endif - - spin_lock_irq(&bfqd->lock); - if (blk_mq_sched_try_insert_merge(q, rq)) { -@@ -4363,7 +4402,6 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - else - list_add_tail(&rq->queuelist, &bfqd->dispatch); - } else { --#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) - idle_timer_disabled = __bfq_insert_request(bfqd, rq); - /* - * Update bfqq, because, if a queue merge has occurred -@@ -4371,9 +4409,6 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - * redirected into a new queue. - */ - bfqq = RQ_BFQQ(rq); --#else -- __bfq_insert_request(bfqd, rq); --#endif - - if (rq_mergeable(rq)) { - elv_rqhash_add(q, rq); -@@ -4382,35 +4417,17 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - } - } - --#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) - /* - * Cache cmd_flags before releasing scheduler lock, because rq - * may disappear afterwards (for example, because of a request - * merge). - */ - cmd_flags = rq->cmd_flags; --#endif -+ - spin_unlock_irq(&bfqd->lock); - --#if defined(CONFIG_BFQ_GROUP_IOSCHED) && defined(CONFIG_DEBUG_BLK_CGROUP) -- if (!bfqq) -- return; -- /* -- * bfqq still exists, because it can disappear only after -- * either it is merged with another queue, or the process it -- * is associated with exits. But both actions must be taken by -- * the same process currently executing this flow of -- * instruction. -- * -- * In addition, the following queue lock guarantees that -- * bfqq_group(bfqq) exists as well. -- */ -- spin_lock_irq(q->queue_lock); -- bfqg_stats_update_io_add(bfqq_group(bfqq), bfqq, cmd_flags); -- if (idle_timer_disabled) -- bfqg_stats_update_idle_time(bfqq_group(bfqq)); -- spin_unlock_irq(q->queue_lock); --#endif -+ bfq_update_insert_stats(q, bfqq, idle_timer_disabled, -+ cmd_flags); - } - - static void bfq_insert_requests(struct blk_mq_hw_ctx *hctx, --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-remove-superfluous-check-in-queue-merging-.patch b/kernel/kernel/files/patches/mageia/block-bfq-remove-superfluous-check-in-queue-merging-.patch deleted file mode 100644 index 5a206955..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-remove-superfluous-check-in-queue-merging-.patch +++ /dev/null @@ -1,112 +0,0 @@ -From 4403e4e467c365b4189e3e3d3ad35cf67b8c36ed Mon Sep 17 00:00:00 2001 -From: Angelo Ruocco -Date: Wed, 20 Dec 2017 12:38:34 +0100 -Subject: [PATCH] block, bfq: remove superfluous check in queue-merging setup - -When two or more processes do I/O in a way that the their requests are -sequential in respect to one another, BFQ merges the bfq_queues associated -with the processes. This way the overall I/O pattern becomes sequential, -and thus there is a boost in througput. -These cooperating processes usually start or restart to do I/O shortly -after each other. So, in order to avoid merging non-cooperating processes, -BFQ ensures that none of these queues has been in weight raising for too -long. - -In this respect, from commit "block, bfq-sq, bfq-mq: let a queue be merged -only shortly after being created", BFQ checks whether any queue (and not -only weight-raised ones) is doing I/O continuously from too long to be -merged. - -This new additional check makes the first one useless: a queue doing -I/O from long enough, if being weight-raised, is also a queue in -weight raising for too long to be merged. Accordingly, this commit -removes the first check. - -Signed-off-by: Angelo Ruocco -Signed-off-by: Paolo Valente -Signed-off-by: Jens Axboe ---- - block/bfq-iosched.c | 36 +++++------------------------------- - 1 file changed, 5 insertions(+), 31 deletions(-) - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 7066d90f09df..9625550b2f85 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -1990,20 +1990,6 @@ static bool bfq_may_be_close_cooperator(struct bfq_queue *bfqq, - return true; - } - --/* -- * If this function returns true, then bfqq cannot be merged. The idea -- * is that true cooperation happens very early after processes start -- * to do I/O. Usually, late cooperations are just accidental false -- * positives. In case bfqq is weight-raised, such false positives -- * would evidently degrade latency guarantees for bfqq. -- */ --static bool wr_from_too_long(struct bfq_queue *bfqq) --{ -- return bfqq->wr_coeff > 1 && -- time_is_before_jiffies(bfqq->last_wr_start_finish + -- msecs_to_jiffies(100)); --} -- - /* - * Attempt to schedule a merge of bfqq with the currently in-service - * queue or with a close queue among the scheduled queues. Return -@@ -2017,11 +2003,6 @@ static bool wr_from_too_long(struct bfq_queue *bfqq) - * to maintain. Besides, in such a critical condition as an out of memory, - * the benefits of queue merging may be little relevant, or even negligible. - * -- * Weight-raised queues can be merged only if their weight-raising -- * period has just started. In fact cooperating processes are usually -- * started together. Thus, with this filter we avoid false positives -- * that would jeopardize low-latency guarantees. -- * - * WARNING: queue merging may impair fairness among non-weight raised - * queues, for at least two reasons: 1) the original weight of a - * merged queue may change during the merged state, 2) even being the -@@ -2052,9 +2033,7 @@ bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, - if (bfqq->new_bfqq) - return bfqq->new_bfqq; - -- if (!io_struct || -- wr_from_too_long(bfqq) || -- unlikely(bfqq == &bfqd->oom_bfqq)) -+ if (!io_struct || unlikely(bfqq == &bfqd->oom_bfqq)) - return NULL; - - /* If there is only one backlogged queue, don't search. */ -@@ -2063,12 +2042,9 @@ bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, - - in_service_bfqq = bfqd->in_service_queue; - -- if (!in_service_bfqq || in_service_bfqq == bfqq -- || wr_from_too_long(in_service_bfqq) || -- unlikely(in_service_bfqq == &bfqd->oom_bfqq)) -- goto check_scheduled; -- -- if (bfq_rq_close_to_sector(io_struct, request, bfqd->last_position) && -+ if (in_service_bfqq && in_service_bfqq != bfqq && -+ likely(in_service_bfqq != &bfqd->oom_bfqq) && -+ bfq_rq_close_to_sector(io_struct, request, bfqd->last_position) && - bfqq->entity.parent == in_service_bfqq->entity.parent && - bfq_may_be_close_cooperator(bfqq, in_service_bfqq)) { - new_bfqq = bfq_setup_merge(bfqq, in_service_bfqq); -@@ -2080,12 +2056,10 @@ bfq_setup_cooperator(struct bfq_data *bfqd, struct bfq_queue *bfqq, - * queues. The only thing we need is that the bio/request is not - * NULL, as we need it to establish whether a cooperator exists. - */ --check_scheduled: - new_bfqq = bfq_find_close_cooperator(bfqd, bfqq, - bfq_io_struct_pos(io_struct, request)); - -- if (new_bfqq && !wr_from_too_long(new_bfqq) && -- likely(new_bfqq != &bfqd->oom_bfqq) && -+ if (new_bfqq && likely(new_bfqq != &bfqd->oom_bfqq) && - bfq_may_be_close_cooperator(bfqq, new_bfqq)) - return bfq_setup_merge(bfqq, new_bfqq); - --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-bfq-update-blkio-stats-outside-the-scheduler-l.patch b/kernel/kernel/files/patches/mageia/block-bfq-update-blkio-stats-outside-the-scheduler-l.patch deleted file mode 100644 index e92dd564..00000000 --- a/kernel/kernel/files/patches/mageia/block-bfq-update-blkio-stats-outside-the-scheduler-l.patch +++ /dev/null @@ -1,283 +0,0 @@ -From 24bfd19bb7890255693ee5cb6dc100d8d215d00b Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Mon, 13 Nov 2017 07:34:09 +0100 -Subject: [PATCH] block, bfq: update blkio stats outside the scheduler lock - -bfq invokes various blkg_*stats_* functions to update the statistics -contained in the special files blkio.bfq.* in the blkio controller -groups, i.e., the I/O accounting related to the proportional-share -policy provided by bfq. The execution of these functions takes a -considerable percentage, about 40%, of the total per-request execution -time of bfq (i.e., of the sum of the execution time of all the bfq -functions that have to be executed to process an I/O request from its -creation to its destruction). This reduces the request-processing -rate sustainable by bfq noticeably, even on a multicore CPU. In fact, -the bfq functions that invoke blkg_*stats_* functions cannot be -executed in parallel with the rest of the code of bfq, because both -are executed under the same same per-device scheduler lock. - -To reduce this slowdown, this commit moves, wherever possible, the -invocation of these functions (more precisely, of the bfq functions -that invoke blkg_*stats_* functions) outside the critical sections -protected by the scheduler lock. - -With this change, and with all blkio.bfq.* statistics enabled, the -throughput grows, e.g., from 250 to 310 KIOPS (+25%) on an Intel -i7-4850HQ, in case of 8 threads doing random I/O in parallel on -null_blk, with the latter configured with 0 latency. We obtained the -same or higher throughput boosts, up to +30%, with other processors -(some figures are reported in the documentation). For our tests, we -used the script [1], with which our results can be easily reproduced. - -NOTE. This commit still protects the invocation of blkg_*stats_* -functions with the request_queue lock, because the group these -functions are invoked on may otherwise disappear before or while these -functions are executed. Fortunately, tests without even this lock -show, by difference, that the serialization caused by this lock has a -little impact (at most ~5% of throughput reduction). - -[1] https://github.com/Algodev-github/IOSpeed - -Tested-by: Lee Tibbert -Tested-by: Oleksandr Natalenko -Signed-off-by: Paolo Valente -Signed-off-by: Luca Miccio -Signed-off-by: Jens Axboe ---- - Documentation/block/bfq-iosched.txt | 6 +- - block/bfq-iosched.c | 110 ++++++++++++++++++++++++++++++++---- - block/bfq-wf2q.c | 1 - - 3 files changed, 102 insertions(+), 15 deletions(-) - -diff --git a/Documentation/block/bfq-iosched.txt b/Documentation/block/bfq-iosched.txt -index 7a9361508157..7fad6c061470 100644 ---- a/Documentation/block/bfq-iosched.txt -+++ b/Documentation/block/bfq-iosched.txt -@@ -26,9 +26,9 @@ the limits on slow or average CPUs, here are BFQ limits for three - different CPUs, on, respectively, an average laptop, an old desktop, - and a cheap embedded system, in case full hierarchical support is - enabled (i.e., CONFIG_BFQ_GROUP_IOSCHED is set): --- Intel i7-4850HQ: 250 KIOPS --- AMD A8-3850: 170 KIOPS --- ARM CortexTM-A53 Octa-core: 45 KIOPS -+- Intel i7-4850HQ: 310 KIOPS -+- AMD A8-3850: 200 KIOPS -+- ARM CortexTM-A53 Octa-core: 56 KIOPS - - BFQ works for multi-queue devices too. - -diff --git a/block/bfq-iosched.c b/block/bfq-iosched.c -index 91703eba63f0..69e05f861daf 100644 ---- a/block/bfq-iosched.c -+++ b/block/bfq-iosched.c -@@ -2228,7 +2228,6 @@ static void __bfq_set_in_service_queue(struct bfq_data *bfqd, - struct bfq_queue *bfqq) - { - if (bfqq) { -- bfqg_stats_update_avg_queue_size(bfqq_group(bfqq)); - bfq_clear_bfqq_fifo_expire(bfqq); - - bfqd->budgets_assigned = (bfqd->budgets_assigned * 7 + 256) / 8; -@@ -3469,7 +3468,6 @@ static struct bfq_queue *bfq_select_queue(struct bfq_data *bfqd) - */ - bfq_clear_bfqq_wait_request(bfqq); - hrtimer_try_to_cancel(&bfqd->idle_slice_timer); -- bfqg_stats_update_idle_time(bfqq_group(bfqq)); - } - goto keep_queue; - } -@@ -3695,15 +3693,67 @@ static struct request *bfq_dispatch_request(struct blk_mq_hw_ctx *hctx) - { - struct bfq_data *bfqd = hctx->queue->elevator->elevator_data; - struct request *rq; -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ struct bfq_queue *in_serv_queue, *bfqq; -+ bool waiting_rq, idle_timer_disabled; -+#endif - - spin_lock_irq(&bfqd->lock); - -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ in_serv_queue = bfqd->in_service_queue; -+ waiting_rq = in_serv_queue && bfq_bfqq_wait_request(in_serv_queue); -+ -+ rq = __bfq_dispatch_request(hctx); -+ -+ idle_timer_disabled = -+ waiting_rq && !bfq_bfqq_wait_request(in_serv_queue); -+ -+#else - rq = __bfq_dispatch_request(hctx); -- if (rq && RQ_BFQQ(rq)) -- bfqg_stats_update_io_remove(bfqq_group(RQ_BFQQ(rq)), -- rq->cmd_flags); -+#endif - spin_unlock_irq(&bfqd->lock); - -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ bfqq = rq ? RQ_BFQQ(rq) : NULL; -+ if (!idle_timer_disabled && !bfqq) -+ return rq; -+ -+ /* -+ * rq and bfqq are guaranteed to exist until this function -+ * ends, for the following reasons. First, rq can be -+ * dispatched to the device, and then can be completed and -+ * freed, only after this function ends. Second, rq cannot be -+ * merged (and thus freed because of a merge) any longer, -+ * because it has already started. Thus rq cannot be freed -+ * before this function ends, and, since rq has a reference to -+ * bfqq, the same guarantee holds for bfqq too. -+ * -+ * In addition, the following queue lock guarantees that -+ * bfqq_group(bfqq) exists as well. -+ */ -+ spin_lock_irq(hctx->queue->queue_lock); -+ if (idle_timer_disabled) -+ /* -+ * Since the idle timer has been disabled, -+ * in_serv_queue contained some request when -+ * __bfq_dispatch_request was invoked above, which -+ * implies that rq was picked exactly from -+ * in_serv_queue. Thus in_serv_queue == bfqq, and is -+ * therefore guaranteed to exist because of the above -+ * arguments. -+ */ -+ bfqg_stats_update_idle_time(bfqq_group(in_serv_queue)); -+ if (bfqq) { -+ struct bfq_group *bfqg = bfqq_group(bfqq); -+ -+ bfqg_stats_update_avg_queue_size(bfqg); -+ bfqg_stats_set_start_empty_time(bfqg); -+ bfqg_stats_update_io_remove(bfqg, rq->cmd_flags); -+ } -+ spin_unlock_irq(hctx->queue->queue_lock); -+#endif -+ - return rq; - } - -@@ -4161,7 +4211,6 @@ static void bfq_rq_enqueued(struct bfq_data *bfqd, struct bfq_queue *bfqq, - */ - bfq_clear_bfqq_wait_request(bfqq); - hrtimer_try_to_cancel(&bfqd->idle_slice_timer); -- bfqg_stats_update_idle_time(bfqq_group(bfqq)); - - /* - * The queue is not empty, because a new request just -@@ -4176,10 +4225,12 @@ static void bfq_rq_enqueued(struct bfq_data *bfqd, struct bfq_queue *bfqq, - } - } - --static void __bfq_insert_request(struct bfq_data *bfqd, struct request *rq) -+/* returns true if it causes the idle timer to be disabled */ -+static bool __bfq_insert_request(struct bfq_data *bfqd, struct request *rq) - { - struct bfq_queue *bfqq = RQ_BFQQ(rq), - *new_bfqq = bfq_setup_cooperator(bfqd, bfqq, rq, true); -+ bool waiting, idle_timer_disabled = false; - - if (new_bfqq) { - if (bic_to_bfqq(RQ_BIC(rq), 1) != bfqq) -@@ -4213,12 +4264,16 @@ static void __bfq_insert_request(struct bfq_data *bfqd, struct request *rq) - bfqq = new_bfqq; - } - -+ waiting = bfqq && bfq_bfqq_wait_request(bfqq); - bfq_add_request(rq); -+ idle_timer_disabled = waiting && !bfq_bfqq_wait_request(bfqq); - - rq->fifo_time = ktime_get_ns() + bfqd->bfq_fifo_expire[rq_is_sync(rq)]; - list_add_tail(&rq->queuelist, &bfqq->fifo); - - bfq_rq_enqueued(bfqd, bfqq, rq); -+ -+ return idle_timer_disabled; - } - - static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, -@@ -4226,7 +4281,11 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - { - struct request_queue *q = hctx->queue; - struct bfq_data *bfqd = q->elevator->elevator_data; -+#ifdef CONFIG_BFQ_GROUP_IOSCHED - struct bfq_queue *bfqq = RQ_BFQQ(rq); -+ bool idle_timer_disabled = false; -+ unsigned int cmd_flags; -+#endif - - spin_lock_irq(&bfqd->lock); - if (blk_mq_sched_try_insert_merge(q, rq)) { -@@ -4245,13 +4304,17 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - else - list_add_tail(&rq->queuelist, &bfqd->dispatch); - } else { -- __bfq_insert_request(bfqd, rq); -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ idle_timer_disabled = __bfq_insert_request(bfqd, rq); - /* - * Update bfqq, because, if a queue merge has occurred - * in __bfq_insert_request, then rq has been - * redirected into a new queue. - */ - bfqq = RQ_BFQQ(rq); -+#else -+ __bfq_insert_request(bfqd, rq); -+#endif - - if (rq_mergeable(rq)) { - elv_rqhash_add(q, rq); -@@ -4260,10 +4323,35 @@ static void bfq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq, - } - } - -- if (bfqq) -- bfqg_stats_update_io_add(bfqq_group(bfqq), bfqq, rq->cmd_flags); -- -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ /* -+ * Cache cmd_flags before releasing scheduler lock, because rq -+ * may disappear afterwards (for example, because of a request -+ * merge). -+ */ -+ cmd_flags = rq->cmd_flags; -+#endif - spin_unlock_irq(&bfqd->lock); -+ -+#ifdef CONFIG_BFQ_GROUP_IOSCHED -+ if (!bfqq) -+ return; -+ /* -+ * bfqq still exists, because it can disappear only after -+ * either it is merged with another queue, or the process it -+ * is associated with exits. But both actions must be taken by -+ * the same process currently executing this flow of -+ * instruction. -+ * -+ * In addition, the following queue lock guarantees that -+ * bfqq_group(bfqq) exists as well. -+ */ -+ spin_lock_irq(q->queue_lock); -+ bfqg_stats_update_io_add(bfqq_group(bfqq), bfqq, cmd_flags); -+ if (idle_timer_disabled) -+ bfqg_stats_update_idle_time(bfqq_group(bfqq)); -+ spin_unlock_irq(q->queue_lock); -+#endif - } - - static void bfq_insert_requests(struct blk_mq_hw_ctx *hctx, -diff --git a/block/bfq-wf2q.c b/block/bfq-wf2q.c -index 414ba686a847..e495d3f9b4b0 100644 ---- a/block/bfq-wf2q.c -+++ b/block/bfq-wf2q.c -@@ -843,7 +843,6 @@ void bfq_bfqq_served(struct bfq_queue *bfqq, int served) - st->vtime += bfq_delta(served, st->wsum); - bfq_forget_idle(st); - } -- bfqg_stats_set_start_empty_time(bfqq_group(bfqq)); - bfq_log_bfqq(bfqq->bfqd, bfqq, "bfqq_served %d secs", served); - } - --- -2.15.1 - diff --git a/kernel/kernel/files/patches/mageia/block-floppy-disable-pnp-modalias.patch b/kernel/kernel/files/patches/mageia/block-floppy-disable-pnp-modalias.patch deleted file mode 100644 index c994472a..00000000 --- a/kernel/kernel/files/patches/mageia/block-floppy-disable-pnp-modalias.patch +++ /dev/null @@ -1,21 +0,0 @@ - -Disable floppy autoloading as it makes systems without real hw, -but that has the pnp headers hang. - -See https://bugs.mageia.org/show_bug.cgi?id=4696 - -Signed-off-by: Thomas Backlund - -diff -Nurp linux-3.3.3-rc1/drivers/block/floppy.c.orig linux-3.3.3-rc1/drivers/block/floppy.c ---- linux-3.3.3-rc1/drivers/block/floppy.c.orig 2012-03-19 01:15:34.000000000 +0200 -+++ linux-3.3.3-rc1/drivers/block/floppy.c 2012-04-22 02:58:10.238498303 +0300 -@@ -4621,8 +4621,7 @@ static const struct pnp_device_id floppy - {"PNP0700", 0}, - {} - }; -- --MODULE_DEVICE_TABLE(pnp, floppy_pnpids); -+/* MODULE_DEVICE_TABLE(pnp, floppy_pnpids); */ - - #else - diff --git a/kernel/kernel/files/patches/mageia/char-agp-intel-new-Q57-id.patch b/kernel/kernel/files/patches/mageia/char-agp-intel-new-Q57-id.patch deleted file mode 100644 index 7093e9c0..00000000 --- a/kernel/kernel/files/patches/mageia/char-agp-intel-new-Q57-id.patch +++ /dev/null @@ -1,35 +0,0 @@ - -agp/intel: add new host bridge id for Q57 system - -Add new Host Bridge ID found on a Q57 based system from Positivo. I -don't know what abbreviation id for this would be best, may be Q_HB -instead of UNKNOWN currently used would be better. - -Signed-off-by: Herton Ronaldo Krzesinski - -[ rebased for 3.8-rc3 /tmb ] -Signed-off-by: Thomas Backlund - -Removed the parts of the patch that are already applied in the kernel by -the commit 67384fe3fd450536342330f684ea1f7dcaef8130: - "char/agp: add another Ironlake host bridge" - -Rediffed for kernel 3.10.24. - -Signed-off-by: Eugene A. Shatokhin - - drivers/char/agp/intel-gtt.c | 2 ++ - 1 file changed, 2 insertions(+) - -diff -Nurp linux-3.8-rc3/drivers/char/agp/intel-gtt.c linux-3.8-rc3.q57/drivers/char/agp/intel-gtt.c ---- linux-3.8-rc3/drivers/char/agp/intel-gtt.c 2013-01-10 08:17:09.690594184 +0200 -+++ linux-3.8-rc3.q57/drivers/char/agp/intel-gtt.c 2013-01-10 08:38:56.649888839 +0200 -@@ -1303,6 +1303,8 @@ static const struct intel_gtt_driver_des - &g4x_gtt_driver }, - { PCI_DEVICE_ID_INTEL_IRONLAKE_D_IG, - "HD Graphics", &ironlake_gtt_driver }, -+ { PCI_DEVICE_ID_INTEL_IRONLAKE_D2_HB, -+ "HD Graphics", &ironlake_gtt_driver }, - { PCI_DEVICE_ID_INTEL_IRONLAKE_M_IG, - "HD Graphics", &ironlake_gtt_driver }, - { 0, NULL, NULL } diff --git a/kernel/kernel/files/patches/mageia/disable-mrproper-in-devel-rpms.patch b/kernel/kernel/files/patches/mageia/disable-mrproper-in-devel-rpms.patch deleted file mode 100644 index 150d8e1e..00000000 --- a/kernel/kernel/files/patches/mageia/disable-mrproper-in-devel-rpms.patch +++ /dev/null @@ -1,74 +0,0 @@ - - Makefile | 18 +++++------------- - scripts/kconfig/Makefile | 4 ---- - 2 files changed, 5 insertions(+), 17 deletions(-) - -diff -Nurp linux-5.4.orig/Makefile linux-5.4/Makefile ---- linux-5.4.orig/Makefile 2019-11-30 23:06:49.394199628 +0200 -+++ linux-5.4/Makefile 2019-11-30 23:08:00.927203318 +0200 -@@ -1093,8 +1093,7 @@ include/config/kernel.release: FORCE - # Carefully list dependencies so we do not try to build scripts twice - # in parallel - PHONY += scripts --scripts: scripts_basic scripts_dtc -- $(Q)$(MAKE) $(build)=$(@) -+scripts: - - # Things we need to do before we recursively start building the kernel - # or the modules are listed in "prepare". -@@ -1112,7 +1111,7 @@ prepare0: archprepare - $(Q)$(MAKE) $(build)=. - - # All the preparing.. --prepare: prepare0 prepare-objtool -+prepare: - - # Support for using generic headers in asm-generic - asm-generic := -f $(srctree)/scripts/Makefile.asm-generic obj -@@ -1363,15 +1362,8 @@ CLEAN_DIRS += include/ksym - CLEAN_FILES += modules.builtin.modinfo - - # Directories & files removed with 'make mrproper' --MRPROPER_DIRS += include/config include/generated \ -- arch/$(SRCARCH)/include/generated .tmp_objdiff \ -- debian/ snap/ tar-install/ --MRPROPER_FILES += .config .config.old .version \ -- Module.symvers \ -- signing_key.pem signing_key.priv signing_key.x509 \ -- x509.genkey extra_certificates signing_key.x509.keyid \ -- signing_key.x509.signer vmlinux-gdb.py \ -- *.spec -+MRPROPER_DIRS += "" -+MRPROPER_FILES += "" - - # Directories & files removed with 'make distclean' - DISTCLEAN_DIRS += -@@ -1394,7 +1386,7 @@ clean: archclean vmlinuxclean - # - mrproper: rm-dirs := $(wildcard $(MRPROPER_DIRS)) - mrproper: rm-files := $(wildcard $(MRPROPER_FILES)) --mrproper-dirs := $(addprefix _mrproper_,scripts) -+mrproper-dirs := $(addprefix _mrproper_,scripts) - - PHONY += $(mrproper-dirs) mrproper - $(mrproper-dirs): -diff -Nurp linux-5.4.orig/scripts/kconfig/Makefile linux-5.4/scripts/kconfig/Makefile ---- linux-5.4.orig/scripts/kconfig/Makefile 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4/scripts/kconfig/Makefile 2019-11-30 23:07:24.957201462 +0200 -@@ -24,16 +24,12 @@ endif - unexport CONFIG_ - - xconfig: $(obj)/qconf -- $< $(silent) $(Kconfig) - - gconfig: $(obj)/gconf -- $< $(silent) $(Kconfig) - - menuconfig: $(obj)/mconf -- $< $(silent) $(Kconfig) - - config: $(obj)/conf -- $< $(silent) --oldaskconfig $(Kconfig) - - nconfig: $(obj)/nconf - $< $(silent) $(Kconfig) diff --git a/kernel/kernel/files/patches/mageia/dm-raid-aliases.patch b/kernel/kernel/files/patches/mageia/dm-raid-aliases.patch deleted file mode 100644 index 4bb20cf1..00000000 --- a/kernel/kernel/files/patches/mageia/dm-raid-aliases.patch +++ /dev/null @@ -1,21 +0,0 @@ - -This patch adds module aliases for matching the old dm-raid45 patch -by heinzm@redhat.com carried by kernel-tmb series in order to make -sure there is an upgrade path. - -Signed-off-by: Thomas Backlund - - drivers/md/dm-raid.c | 2 ++ - 1 file changed, 2 insertions(+) - ---- linux/drivers/md/dm-raid.c.orig -+++ linux/drivers/md/dm-raid.c -@@ -3689,6 +3689,8 @@ MODULE_ALIAS("dm-raid10"); - MODULE_ALIAS("dm-raid4"); - MODULE_ALIAS("dm-raid5"); - MODULE_ALIAS("dm-raid6"); -+MODULE_ALIAS("dm-raid45"); -+MODULE_ALIAS("dm-raid4-5"); - MODULE_AUTHOR("Neil Brown "); - MODULE_AUTHOR("Heinz Mauelshagen "); - MODULE_LICENSE("GPL"); diff --git a/kernel/kernel/files/patches/mageia/doc-block-bfq-update-max-IOPS-sustainable-with-BFQ.patch b/kernel/kernel/files/patches/mageia/doc-block-bfq-update-max-IOPS-sustainable-with-BFQ.patch deleted file mode 100644 index 41823486..00000000 --- a/kernel/kernel/files/patches/mageia/doc-block-bfq-update-max-IOPS-sustainable-with-BFQ.patch +++ /dev/null @@ -1,61 +0,0 @@ -From 68017e5d87a2477d40476f1a0a06f202ee79316b Mon Sep 17 00:00:00 2001 -From: Paolo Valente -Date: Mon, 13 Nov 2017 07:34:07 +0100 -Subject: [PATCH] doc, block, bfq: update max IOPS sustainable with BFQ - -We have investigated more deeply the performance of BFQ, in terms of -number of IOPS that can be processed by the CPU when BFQ is used as -I/O scheduler. In more detail, using the script [1], we have measured -the number of IOPS reached on top of a null block device configured -with zero latency, as a function of the workload (sequential read, -sequential write, random read, random write) and of the system (we -considered desktops, laptops and embedded systems). - -Basing on the resulting figures, with this commit we update the -current, conservative IOPS range reported in BFQ documentation. In -particular, the documentation now reports, for each of three different -systems, the lowest number of IOPS obtained for that system with the -above test (namely, the value obtained with the workload leading to -the lowest IOPS). - -[1] https://github.com/Algodev-github/IOSpeed - -Reviewed-by: Lee Tibbert -Signed-off-by: Paolo Valente -Signed-off-by: Luca Miccio -Signed-off-by: Jens Axboe ---- - Documentation/block/bfq-iosched.txt | 17 +++++++++++------ - 1 file changed, 11 insertions(+), 6 deletions(-) - -diff --git a/Documentation/block/bfq-iosched.txt b/Documentation/block/bfq-iosched.txt -index 3d6951d63489..7a9361508157 100644 ---- a/Documentation/block/bfq-iosched.txt -+++ b/Documentation/block/bfq-iosched.txt -@@ -20,12 +20,17 @@ for that device, by setting low_latency to 0. See Section 3 for - details on how to configure BFQ for the desired tradeoff between - latency and throughput, or on how to maximize throughput. - --On average CPUs, the current version of BFQ can handle devices --performing at most ~30K IOPS; at most ~50 KIOPS on faster CPUs. As a --reference, 30-50 KIOPS correspond to very high bandwidths with --sequential I/O (e.g., 8-12 GB/s if I/O requests are 256 KB large), and --to 120-200 MB/s with 4KB random I/O. BFQ is currently being tested on --multi-queue devices too. -+BFQ has a non-null overhead, which limits the maximum IOPS that the -+CPU can process for a device scheduled with BFQ. To give an idea of -+the limits on slow or average CPUs, here are BFQ limits for three -+different CPUs, on, respectively, an average laptop, an old desktop, -+and a cheap embedded system, in case full hierarchical support is -+enabled (i.e., CONFIG_BFQ_GROUP_IOSCHED is set): -+- Intel i7-4850HQ: 250 KIOPS -+- AMD A8-3850: 170 KIOPS -+- ARM CortexTM-A53 Octa-core: 45 KIOPS -+ -+BFQ works for multi-queue devices too. - - The table of contents follow. Impatients can just jump to Section 3. - --- -2.13.6 - diff --git a/kernel/kernel/files/patches/mageia/firewire-ieee1394-module-aliases.patch b/kernel/kernel/files/patches/mageia/firewire-ieee1394-module-aliases.patch deleted file mode 100644 index 34c4d489..00000000 --- a/kernel/kernel/files/patches/mageia/firewire-ieee1394-module-aliases.patch +++ /dev/null @@ -1,29 +0,0 @@ - -This patch adds missing module aliases for the old ieee1394 stack -to make it easier for endusers. - -Note: firewire-sbp2 and firewire-ohci already contains the needed aliases. - -Signed-off-by: Thomas Backlund - -diff -Nurp linux-2.6.38.4/drivers/firewire/core-transaction.c linux-2.6.38.4.fw/drivers/firewire/core-transaction.c ---- linux-2.6.38.4/drivers/firewire/core-transaction.c 2011-03-15 03:20:32.000000000 +0200 -+++ linux-2.6.38.4.fw/drivers/firewire/core-transaction.c 2011-04-22 16:22:28.461386738 +0300 -@@ -1174,6 +1174,9 @@ static struct fw_address_handler registe - MODULE_AUTHOR("Kristian Hoegsberg "); - MODULE_DESCRIPTION("Core IEEE1394 transaction logic"); - MODULE_LICENSE("GPL"); -+MODULE_ALIAS("ieee1394"); -+MODULE_ALIAS("raw1394"); -+MODULE_ALIAS("video1394"); - - static const u32 vendor_textual_descriptor[] = { - /* textual descriptor leaf () */ -diff -Nurp linux-2.6.38.4/drivers/firewire/net.c linux-2.6.38.4.fw/drivers/firewire/net.c ---- linux-2.6.38.4/drivers/firewire/net.c 2011-03-15 03:20:32.000000000 +0200 -+++ linux-2.6.38.4.fw/drivers/firewire/net.c 2011-04-22 16:20:34.008883920 +0300 -@@ -1719,3 +1719,4 @@ MODULE_AUTHOR("Jay Fenlason +Date: Mon, 2 Mar 2020 15:21:43 +0900 +Subject: [PATCH 12/14] MAINTAINERS: add exfat filesystem +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +Add myself and Sungjong Seo as exfat maintainer. + +Signed-off-by: Namjae Jeon +Signed-off-by: Sungjong Seo +Reviewed-by: Pali Rohár +Reviewed-by: Christoph Hellwig +Signed-off-by: Al Viro +--- + MAINTAINERS | 7 +++++++ + 1 file changed, 7 insertions(+) + +diff --git a/MAINTAINERS b/MAINTAINERS +index 38fe2f3f7b6f..27d912bc5ae2 100644 +--- a/MAINTAINERS ++++ b/MAINTAINERS +@@ -6240,6 +6240,13 @@ F: include/trace/events/mdio.h + F: include/uapi/linux/mdio.h + F: include/uapi/linux/mii.h + ++EXFAT FILE SYSTEM ++M: Namjae Jeon ++M: Sungjong Seo ++L: linux-fsdevel@vger.kernel.org ++S: Maintained ++F: fs/exfat/ ++ + EXT2 FILE SYSTEM + M: Jan Kara + L: linux-ext4@vger.kernel.org +-- +2.25.1 diff --git a/kernel/kernel/files/patches/mageia/fs-aufs-4.14-modular.patch b/kernel/kernel/files/patches/mageia/fs-aufs-4.14-modular.patch deleted file mode 100644 index 786c03ea..00000000 --- a/kernel/kernel/files/patches/mageia/fs-aufs-4.14-modular.patch +++ /dev/null @@ -1,431 +0,0 @@ - - fs/aufs/Kconfig | 2 +- - fs/dcache.c | 2 ++ - fs/exec.c | 1 + - fs/fcntl.c | 1 + - fs/file_table.c | 4 ++++ - fs/inode.c | 1 + - fs/namespace.c | 2 ++ - fs/notify/group.c | 4 ++++ - fs/notify/mark.c | 4 ++++ - fs/open.c | 2 ++ - fs/read_write.c | 4 ++++ - fs/splice.c | 2 ++ - fs/sync.c | 1 + - fs/xattr.c | 1 + - kernel/task_work.c | 1 + - security/commoncap.c | 2 ++ - security/device_cgroup.c | 2 ++ - security/security.c | 10 ++++++++++ - 18 files changed, 45 insertions(+), 1 deletion(-) - -diff -Nurp linux-4.14.14-aufs/fs/aufs/Kconfig linux-4.14.14-aufs.mod/fs/aufs/Kconfig ---- linux-4.14.14-aufs/fs/aufs/Kconfig 2018-01-17 11:17:42.191975391 +0200 -+++ linux-4.14.14-aufs.mod/fs/aufs/Kconfig 2018-01-17 11:18:22.784556755 +0200 -@@ -1,6 +1,6 @@ - # SPDX-License-Identifier: GPL-2.0 - config AUFS_FS -- bool "Aufs (Advanced multi layered unification filesystem) support" -+ tristate "Aufs (Advanced multi layered unification filesystem) support" - help - Aufs is a stackable unification filesystem such as Unionfs, - which unifies several directories and provides a merged single -diff -Nurp linux-4.14.14-aufs/fs/dcache.c linux-4.14.14-aufs.mod/fs/dcache.c ---- linux-4.14.14-aufs/fs/dcache.c 2018-01-17 11:17:42.200975519 +0200 -+++ linux-4.14.14-aufs.mod/fs/dcache.c 2018-01-17 11:18:22.784556755 +0200 -@@ -1305,6 +1305,7 @@ rename_retry: - seq = 1; - goto again; - } -+EXPORT_SYMBOL_GPL(d_walk); - - struct check_mount { - struct vfsmount *mnt; -@@ -2894,6 +2895,7 @@ void d_exchange(struct dentry *dentry1, - - write_sequnlock(&rename_lock); - } -+EXPORT_SYMBOL_GPL(d_exchange); - - /** - * d_ancestor - search for an ancestor -diff -Nurp linux-4.14.14-aufs/fs/exec.c linux-4.14.14-aufs.mod/fs/exec.c ---- linux-4.14.14-aufs/fs/exec.c 2018-01-17 11:08:18.957908605 +0200 -+++ linux-4.14.14-aufs.mod/fs/exec.c 2018-01-17 11:18:22.785556770 +0200 -@@ -109,6 +109,7 @@ bool path_noexec(const struct path *path - return (path->mnt->mnt_flags & MNT_NOEXEC) || - (path->mnt->mnt_sb->s_iflags & SB_I_NOEXEC); - } -+EXPORT_SYMBOL_GPL(path_noexec); - - #ifdef CONFIG_USELIB - /* -diff -Nurp linux-4.14.14-aufs/fs/fcntl.c linux-4.14.14-aufs.mod/fs/fcntl.c ---- linux-4.14.14-aufs/fs/fcntl.c 2018-01-17 11:17:42.200975519 +0200 -+++ linux-4.14.14-aufs.mod/fs/fcntl.c 2018-01-17 11:18:22.785556770 +0200 -@@ -85,6 +85,7 @@ int setfl(int fd, struct file * filp, un - out: - return error; - } -+EXPORT_SYMBOL_GPL(setfl); - - static void f_modown(struct file *filp, struct pid *pid, enum pid_type type, - int force) -diff -Nurp linux-4.14.14-aufs/fs/file_table.c linux-4.14.14-aufs.mod/fs/file_table.c ---- linux-4.14.14-aufs/fs/file_table.c 2017-11-12 20:46:13.000000000 +0200 -+++ linux-4.14.14-aufs.mod/fs/file_table.c 2018-01-17 11:18:22.785556770 +0200 -@@ -148,6 +148,7 @@ over: - } - return ERR_PTR(-ENFILE); - } -+EXPORT_SYMBOL_GPL(get_empty_filp); - - /** - * alloc_file - allocate and initialize a 'struct file' -@@ -258,6 +259,7 @@ void flush_delayed_fput(void) - { - delayed_fput(NULL); - } -+EXPORT_SYMBOL_GPL(flush_delayed_fput); - - static DECLARE_DELAYED_WORK(delayed_fput_work, delayed_fput); - -@@ -300,6 +302,7 @@ void __fput_sync(struct file *file) - } - - EXPORT_SYMBOL(fput); -+EXPORT_SYMBOL_GPL(__fput_sync); - - void put_filp(struct file *file) - { -@@ -308,6 +311,7 @@ void put_filp(struct file *file) - file_free(file); - } - } -+EXPORT_SYMBOL_GPL(put_filp); - - void __init files_init(void) - { -diff -Nurp linux-4.14.14-aufs/fs/inode.c linux-4.14.14-aufs.mod/fs/inode.c ---- linux-4.14.14-aufs/fs/inode.c 2018-01-17 11:17:42.200975519 +0200 -+++ linux-4.14.14-aufs.mod/fs/inode.c 2018-01-17 11:18:22.785556770 +0200 -@@ -1664,6 +1664,7 @@ int update_time(struct inode *inode, str - - return update_time(inode, time, flags); - } -+EXPORT_SYMBOL_GPL(update_time); - - /** - * touch_atime - update the access time -diff -Nurp linux-4.14.14-aufs/fs/namespace.c linux-4.14.14-aufs.mod/fs/namespace.c ---- linux-4.14.14-aufs/fs/namespace.c 2018-01-17 11:17:42.201975534 +0200 -+++ linux-4.14.14-aufs.mod/fs/namespace.c 2018-01-17 11:18:22.785556770 +0200 -@@ -517,6 +517,7 @@ void __mnt_drop_write(struct vfsmount *m - mnt_dec_writers(real_mount(mnt)); - preempt_enable(); - } -+EXPORT_SYMBOL_GPL(__mnt_drop_write); - - /** - * mnt_drop_write - give up write access to a mount -@@ -1887,6 +1888,7 @@ int iterate_mounts(int (*f)(struct vfsmo - } - return 0; - } -+EXPORT_SYMBOL_GPL(iterate_mounts); - - static void cleanup_group_ids(struct mount *mnt, struct mount *end) - { -diff -Nurp linux-4.14.14-aufs/fs/notify/group.c linux-4.14.14-aufs.mod/fs/notify/group.c ---- linux-4.14.14-aufs/fs/notify/group.c 2017-11-12 20:46:13.000000000 +0200 -+++ linux-4.14.14-aufs.mod/fs/notify/group.c 2018-01-17 11:18:22.786556784 +0200 -@@ -22,6 +22,7 @@ - #include - #include - #include -+#include - - #include - #include "fsnotify.h" -@@ -109,6 +110,7 @@ void fsnotify_get_group(struct fsnotify_ - { - atomic_inc(&group->refcnt); - } -+EXPORT_SYMBOL_GPL(fsnotify_get_group); - - /* - * Drop a reference to a group. Free it if it's through. -@@ -118,6 +120,7 @@ void fsnotify_put_group(struct fsnotify_ - if (atomic_dec_and_test(&group->refcnt)) - fsnotify_final_destroy_group(group); - } -+EXPORT_SYMBOL_GPL(fsnotify_put_group); - - /* - * Create a new fsnotify_group and hold a reference for the group returned. -@@ -147,6 +150,7 @@ struct fsnotify_group *fsnotify_alloc_gr - - return group; - } -+EXPORT_SYMBOL_GPL(fsnotify_alloc_group); - - int fsnotify_fasync(int fd, struct file *file, int on) - { -diff -Nurp linux-4.14.14-aufs/fs/notify/mark.c linux-4.14.14-aufs.mod/fs/notify/mark.c ---- linux-4.14.14-aufs/fs/notify/mark.c 2018-01-17 11:08:18.963908691 +0200 -+++ linux-4.14.14-aufs.mod/fs/notify/mark.c 2018-01-17 11:18:22.786556784 +0200 -@@ -124,6 +124,7 @@ static void __fsnotify_recalc_mask(struc - else if (conn->flags & FSNOTIFY_OBJ_TYPE_VFSMOUNT) - real_mount(conn->mnt)->mnt_fsnotify_mask = new_mask; - } -+EXPORT_SYMBOL_GPL(fsnotify_put_mark); - - /* - * Calculate mask of events for a list of marks. The caller must make sure -@@ -271,6 +272,7 @@ static bool fsnotify_get_mark_safe(struc - } - return false; - } -+EXPORT_SYMBOL_GPL(fsnotify_destroy_mark); - - /* - * Puts marks and wakes up group destruction if necessary. -@@ -428,6 +430,7 @@ int fsnotify_compare_groups(struct fsnot - return 1; - return -1; - } -+EXPORT_SYMBOL_GPL(fsnotify_add_mark); - - static int fsnotify_attach_connector_to_object( - struct fsnotify_mark_connector __rcu **connp, -@@ -557,6 +560,7 @@ out_err: - spin_unlock(&mark->lock); - return err; - } -+EXPORT_SYMBOL_GPL(fsnotify_init_mark); - - /* - * Attach an initialized mark to a given group and fs object. -diff -Nurp linux-4.14.14-aufs/fs/open.c linux-4.14.14-aufs.mod/fs/open.c ---- linux-4.14.14-aufs/fs/open.c 2017-11-12 20:46:13.000000000 +0200 -+++ linux-4.14.14-aufs.mod/fs/open.c 2018-01-17 11:18:22.786556784 +0200 -@@ -64,6 +64,7 @@ int do_truncate(struct dentry *dentry, l - inode_unlock(dentry->d_inode); - return ret; - } -+EXPORT_SYMBOL_GPL(do_truncate); - - long vfs_truncate(const struct path *path, loff_t length) - { -@@ -691,6 +692,7 @@ int open_check_o_direct(struct file *f) - } - return 0; - } -+EXPORT_SYMBOL_GPL(open_check_o_direct); - - static int do_dentry_open(struct file *f, - struct inode *inode, -diff -Nurp linux-4.14.14-aufs/fs/read_write.c linux-4.14.14-aufs.mod/fs/read_write.c ---- linux-4.14.14-aufs/fs/read_write.c 2018-01-17 11:17:42.201975534 +0200 -+++ linux-4.14.14-aufs.mod/fs/read_write.c 2018-01-17 11:18:22.790556841 +0200 -@@ -454,6 +454,7 @@ ssize_t vfs_read(struct file *file, char - - return ret; - } -+EXPORT_SYMBOL_GPL(vfs_read); - - static ssize_t new_sync_write(struct file *filp, const char __user *buf, size_t len, loff_t *ppos) - { -@@ -494,6 +495,7 @@ vfs_readf_t vfs_readf(struct file *file) - return new_sync_read; - return ERR_PTR(-ENOSYS); - } -+EXPORT_SYMBOL_GPL(vfs_readf); - - vfs_writef_t vfs_writef(struct file *file) - { -@@ -505,6 +507,7 @@ vfs_writef_t vfs_writef(struct file *fil - return new_sync_write; - return ERR_PTR(-ENOSYS); - } -+EXPORT_SYMBOL_GPL(vfs_writef); - - ssize_t __kernel_write(struct file *file, const void *buf, size_t count, loff_t *pos) - { -@@ -574,6 +577,7 @@ ssize_t vfs_write(struct file *file, con - - return ret; - } -+EXPORT_SYMBOL_GPL(vfs_write); - - static inline loff_t file_pos_read(struct file *file) - { -diff -Nurp linux-4.14.14-aufs/fs/splice.c linux-4.14.14-aufs.mod/fs/splice.c ---- linux-4.14.14-aufs/fs/splice.c 2018-01-17 11:17:42.201975534 +0200 -+++ linux-4.14.14-aufs.mod/fs/splice.c 2018-01-17 11:18:22.791556855 +0200 -@@ -850,6 +850,7 @@ long do_splice_from(struct pipe_inode_in - - return splice_write(pipe, out, ppos, len, flags); - } -+EXPORT_SYMBOL_GPL(do_splice_from); - - /* - * Attempt to initiate a splice from a file to a pipe. -@@ -879,6 +880,7 @@ long do_splice_to(struct file *in, loff_ - - return splice_read(in, ppos, pipe, len, flags); - } -+EXPORT_SYMBOL_GPL(do_splice_to); - - /** - * splice_direct_to_actor - splices data directly between two non-pipes -diff -Nurp linux-4.14.14-aufs/fs/sync.c linux-4.14.14-aufs.mod/fs/sync.c ---- linux-4.14.14-aufs/fs/sync.c 2018-01-17 11:17:42.201975534 +0200 -+++ linux-4.14.14-aufs.mod/fs/sync.c 2018-01-17 11:18:22.791556855 +0200 -@@ -39,6 +39,7 @@ int __sync_filesystem(struct super_block - sb->s_op->sync_fs(sb, wait); - return __sync_blockdev(sb->s_bdev, wait); - } -+EXPORT_SYMBOL_GPL(__sync_filesystem); - - /* - * Write out and wait upon all dirty data associated with this -diff -Nurp linux-4.14.14-aufs/fs/xattr.c linux-4.14.14-aufs.mod/fs/xattr.c ---- linux-4.14.14-aufs/fs/xattr.c 2017-11-12 20:46:13.000000000 +0200 -+++ linux-4.14.14-aufs.mod/fs/xattr.c 2018-01-17 11:18:22.791556855 +0200 -@@ -297,6 +297,7 @@ vfs_getxattr_alloc(struct dentry *dentry - *xattr_value = value; - return error; - } -+EXPORT_SYMBOL_GPL(vfs_getxattr_alloc); - - ssize_t - __vfs_getxattr(struct dentry *dentry, struct inode *inode, const char *name, -diff -Nurp linux-4.14.14-aufs/kernel/task_work.c linux-4.14.14-aufs.mod/kernel/task_work.c ---- linux-4.14.14-aufs/kernel/task_work.c 2018-01-17 11:08:18.979908919 +0200 -+++ linux-4.14.14-aufs.mod/kernel/task_work.c 2018-01-17 11:18:22.791556855 +0200 -@@ -116,3 +116,4 @@ void task_work_run(void) - } while (work); - } - } -+EXPORT_SYMBOL_GPL(task_work_run); -diff -Nurp linux-4.14.14-aufs/security/commoncap.c linux-4.14.14-aufs.mod/security/commoncap.c ---- linux-4.14.14-aufs/security/commoncap.c 2018-01-17 11:08:18.999909204 +0200 -+++ linux-4.14.14-aufs.mod/security/commoncap.c 2018-01-17 11:18:22.791556855 +0200 -@@ -1267,12 +1267,14 @@ int cap_mmap_addr(unsigned long addr) - } - return ret; - } -+EXPORT_SYMBOL_GPL(cap_mmap_addr); - - int cap_mmap_file(struct file *file, unsigned long reqprot, - unsigned long prot, unsigned long flags) - { - return 0; - } -+EXPORT_SYMBOL_GPL(cap_mmap_file); - - #ifdef CONFIG_SECURITY - -diff -Nurp linux-4.14.14-aufs/security/device_cgroup.c linux-4.14.14-aufs.mod/security/device_cgroup.c ---- linux-4.14.14-aufs/security/device_cgroup.c 2017-11-12 20:46:13.000000000 +0200 -+++ linux-4.14.14-aufs.mod/security/device_cgroup.c 2018-01-17 11:18:22.791556855 +0200 -@@ -8,6 +8,7 @@ - #include - #include - #include -+#include - #include - #include - #include -@@ -850,6 +851,7 @@ int __devcgroup_inode_permission(struct - return __devcgroup_check_permission(type, imajor(inode), iminor(inode), - access); - } -+EXPORT_SYMBOL_GPL(__devcgroup_inode_permission); - - int devcgroup_inode_mknod(int mode, dev_t dev) - { -diff -Nurp linux-4.14.14-aufs/security/security.c linux-4.14.14-aufs.mod/security/security.c ---- linux-4.14.14-aufs/security/security.c 2017-11-12 20:46:13.000000000 +0200 -+++ linux-4.14.14-aufs.mod/security/security.c 2018-01-17 11:18:22.791556855 +0200 -@@ -530,6 +530,7 @@ int security_path_rmdir(const struct pat - return 0; - return call_int_hook(path_rmdir, 0, dir, dentry); - } -+EXPORT_SYMBOL_GPL(security_path_rmdir); - - int security_path_unlink(const struct path *dir, struct dentry *dentry) - { -@@ -546,6 +547,7 @@ int security_path_symlink(const struct p - return 0; - return call_int_hook(path_symlink, 0, dir, dentry, old_name); - } -+EXPORT_SYMBOL_GPL(security_path_symlink); - - int security_path_link(struct dentry *old_dentry, const struct path *new_dir, - struct dentry *new_dentry) -@@ -554,6 +556,7 @@ int security_path_link(struct dentry *ol - return 0; - return call_int_hook(path_link, 0, old_dentry, new_dir, new_dentry); - } -+EXPORT_SYMBOL_GPL(security_path_link); - - int security_path_rename(const struct path *old_dir, struct dentry *old_dentry, - const struct path *new_dir, struct dentry *new_dentry, -@@ -581,6 +584,7 @@ int security_path_truncate(const struct - return 0; - return call_int_hook(path_truncate, 0, path); - } -+EXPORT_SYMBOL_GPL(security_path_truncate); - - int security_path_chmod(const struct path *path, umode_t mode) - { -@@ -588,6 +592,7 @@ int security_path_chmod(const struct pat - return 0; - return call_int_hook(path_chmod, 0, path, mode); - } -+EXPORT_SYMBOL_GPL(security_path_chmod); - - int security_path_chown(const struct path *path, kuid_t uid, kgid_t gid) - { -@@ -595,6 +600,7 @@ int security_path_chown(const struct pat - return 0; - return call_int_hook(path_chown, 0, path, uid, gid); - } -+EXPORT_SYMBOL_GPL(security_path_chown); - - int security_path_chroot(const struct path *path) - { -@@ -680,6 +686,7 @@ int security_inode_readlink(struct dentr - return 0; - return call_int_hook(inode_readlink, 0, dentry); - } -+EXPORT_SYMBOL_GPL(security_inode_readlink); - - int security_inode_follow_link(struct dentry *dentry, struct inode *inode, - bool rcu) -@@ -695,6 +702,7 @@ int security_inode_permission(struct ino - return 0; - return call_int_hook(inode_permission, 0, inode, mask); - } -+EXPORT_SYMBOL_GPL(security_inode_permission); - - int security_inode_setattr(struct dentry *dentry, struct iattr *attr) - { -@@ -866,6 +874,7 @@ int security_file_permission(struct file - - return fsnotify_perm(file, mask); - } -+EXPORT_SYMBOL_GPL(security_file_permission); - - int security_file_alloc(struct file *file) - { -@@ -925,6 +934,7 @@ int security_mmap_file(struct file *file - return ret; - return ima_file_mmap(file, prot); - } -+EXPORT_SYMBOL_GPL(security_mmap_file); - - int security_mmap_addr(unsigned long addr) - { diff --git a/kernel/kernel/files/patches/mageia/fs-aufs-4.14.patch b/kernel/kernel/files/patches/mageia/fs-aufs-4.14.patch deleted file mode 100644 index 8672929f..00000000 --- a/kernel/kernel/files/patches/mageia/fs-aufs-4.14.patch +++ /dev/null @@ -1,37170 +0,0 @@ - Documentation/ABI/testing/debugfs-aufs | 50 + - Documentation/ABI/testing/sysfs-aufs | 31 + - Documentation/filesystems/aufs/README | 393 ++++ - Documentation/filesystems/aufs/design/01intro.txt | 158 ++ - Documentation/filesystems/aufs/design/02struct.txt | 245 +++ - .../filesystems/aufs/design/03atomic_open.txt | 72 + - Documentation/filesystems/aufs/design/03lookup.txt | 100 ++ - Documentation/filesystems/aufs/design/04branch.txt | 61 + - .../filesystems/aufs/design/05wbr_policy.txt | 51 + - Documentation/filesystems/aufs/design/06dirren.dot | 31 + - Documentation/filesystems/aufs/design/06dirren.txt | 89 + - Documentation/filesystems/aufs/design/06fhsm.txt | 105 ++ - Documentation/filesystems/aufs/design/06mmap.txt | 59 + - Documentation/filesystems/aufs/design/06xattr.txt | 81 + - Documentation/filesystems/aufs/design/07export.txt | 45 + - Documentation/filesystems/aufs/design/08shwh.txt | 39 + - Documentation/filesystems/aufs/design/10dynop.txt | 34 + - MAINTAINERS | 13 + - drivers/block/loop.c | 18 + - fs/Kconfig | 1 + - fs/Makefile | 1 + - fs/aufs/Kconfig | 199 +++ - fs/aufs/Makefile | 38 + - fs/aufs/aufs.h | 48 + - fs/aufs/branch.c | 1420 +++++++++++++++ - fs/aufs/branch.h | 321 ++++ - fs/aufs/cpup.c | 1430 +++++++++++++++ - fs/aufs/cpup.h | 87 + - fs/aufs/dbgaufs.c | 425 +++++ - fs/aufs/dbgaufs.h | 36 + - fs/aufs/dcsub.c | 213 +++ - fs/aufs/dcsub.h | 124 ++ - fs/aufs/debug.c | 428 +++++ - fs/aufs/debug.h | 213 +++ - fs/aufs/dentry.c | 1140 ++++++++++++ - fs/aufs/dentry.h | 254 +++ - fs/aufs/dinfo.c | 541 ++++++ - fs/aufs/dir.c | 747 ++++++++ - fs/aufs/dir.h | 119 ++ - fs/aufs/dirren.c | 1303 ++++++++++++++ - fs/aufs/dirren.h | 127 ++ - fs/aufs/dynop.c | 357 ++++ - fs/aufs/dynop.h | 62 + - fs/aufs/export.c | 824 +++++++++ - fs/aufs/f_op.c | 805 +++++++++ - fs/aufs/fhsm.c | 413 +++++ - fs/aufs/file.c | 844 +++++++++ - fs/aufs/file.h | 328 ++++ - fs/aufs/finfo.c | 136 ++ - fs/aufs/fstype.h | 388 ++++ - fs/aufs/hbl.h | 52 + - fs/aufs/hfsnotify.c | 277 +++ - fs/aufs/hfsplus.c | 44 + - fs/aufs/hnotify.c | 707 ++++++++ - fs/aufs/i_op.c | 1447 +++++++++++++++ - fs/aufs/i_op_add.c | 908 ++++++++++ - fs/aufs/i_op_del.c | 499 ++++++ - fs/aufs/i_op_ren.c | 1234 +++++++++++++ - fs/aufs/iinfo.c | 273 +++ - fs/aufs/inode.c | 515 ++++++ - fs/aufs/inode.h | 683 +++++++ - fs/aufs/ioctl.c | 207 +++ - fs/aufs/loop.c | 135 ++ - fs/aufs/loop.h | 40 + - fs/aufs/magic.mk | 31 + - fs/aufs/module.c | 253 +++ - fs/aufs/module.h | 89 + - fs/aufs/mvdown.c | 692 +++++++ - fs/aufs/opts.c | 1879 ++++++++++++++++++++ - fs/aufs/opts.h | 212 +++ - fs/aufs/plink.c | 503 ++++++ - fs/aufs/poll.c | 40 + - fs/aufs/posix_acl.c | 90 + - fs/aufs/procfs.c | 158 ++ - fs/aufs/rdu.c | 369 ++++ - fs/aufs/rwsem.h | 60 + - fs/aufs/sbinfo.c | 292 +++ - fs/aufs/super.c | 1034 +++++++++++ - fs/aufs/super.h | 614 +++++++ - fs/aufs/sysaufs.c | 92 + - fs/aufs/sysaufs.h | 89 + - fs/aufs/sysfs.c | 341 ++++ - fs/aufs/sysrq.c | 147 ++ - fs/aufs/vdir.c | 880 +++++++++ - fs/aufs/vfsub.c | 882 +++++++++ - fs/aufs/vfsub.h | 348 ++++ - fs/aufs/wbr_policy.c | 818 +++++++++ - fs/aufs/whout.c | 1049 +++++++++++ - fs/aufs/whout.h | 73 + - fs/aufs/wkq.c | 378 ++++ - fs/aufs/wkq.h | 81 + - fs/aufs/xattr.c | 343 ++++ - fs/aufs/xino.c | 1457 +++++++++++++++ - fs/dcache.c | 2 +- - fs/fcntl.c | 4 +- - fs/inode.c | 2 +- - fs/namespace.c | 6 + - fs/proc/base.c | 2 +- - fs/proc/nommu.c | 5 +- - fs/proc/task_mmu.c | 7 +- - fs/proc/task_nommu.c | 5 +- - fs/read_write.c | 22 + - fs/splice.c | 10 +- - fs/sync.c | 2 +- - include/linux/file.h | 1 + - include/linux/fs.h | 10 + - include/linux/lockdep.h | 3 + - include/linux/mm.h | 22 + - include/linux/mm_types.h | 2 + - include/linux/mnt_namespace.h | 3 + - include/linux/splice.h | 6 + - include/uapi/linux/aufs_type.h | 435 +++++ - kernel/fork.c | 2 +- - kernel/locking/lockdep.c | 3 +- - mm/Makefile | 2 +- - mm/filemap.c | 2 +- - mm/mmap.c | 33 +- - mm/nommu.c | 10 +- - mm/prfile.c | 86 + - 119 files changed, 36018 insertions(+), 31 deletions(-) - -diff --git a/Documentation/ABI/testing/debugfs-aufs b/Documentation/ABI/testing/debugfs-aufs -new file mode 100644 -index 000000000000..99642d1055a2 ---- /dev/null -+++ b/Documentation/ABI/testing/debugfs-aufs -@@ -0,0 +1,50 @@ -+What: /debug/aufs/si_/ -+Date: March 2009 -+Contact: J. R. Okajima -+Description: -+ Under /debug/aufs, a directory named si_ is created -+ per aufs mount, where is a unique id generated -+ internally. -+ -+What: /debug/aufs/si_/plink -+Date: Apr 2013 -+Contact: J. R. Okajima -+Description: -+ It has three lines and shows the information about the -+ pseudo-link. The first line is a single number -+ representing a number of buckets. The second line is a -+ number of pseudo-links per buckets (separated by a -+ blank). The last line is a single number representing a -+ total number of psedo-links. -+ When the aufs mount option 'noplink' is specified, it -+ will show "1\n0\n0\n". -+ -+What: /debug/aufs/si_/xib -+Date: March 2009 -+Contact: J. R. Okajima -+Description: -+ It shows the consumed blocks by xib (External Inode Number -+ Bitmap), its block size and file size. -+ When the aufs mount option 'noxino' is specified, it -+ will be empty. About XINO files, see the aufs manual. -+ -+What: /debug/aufs/si_/xino0, xino1 ... xinoN -+Date: March 2009 -+Contact: J. R. Okajima -+Description: -+ It shows the consumed blocks by xino (External Inode Number -+ Translation Table), its link count, block size and file -+ size. -+ When the aufs mount option 'noxino' is specified, it -+ will be empty. About XINO files, see the aufs manual. -+ -+What: /debug/aufs/si_/xigen -+Date: March 2009 -+Contact: J. R. Okajima -+Description: -+ It shows the consumed blocks by xigen (External Inode -+ Generation Table), its block size and file size. -+ If CONFIG_AUFS_EXPORT is disabled, this entry will not -+ be created. -+ When the aufs mount option 'noxino' is specified, it -+ will be empty. About XINO files, see the aufs manual. -diff --git a/Documentation/ABI/testing/sysfs-aufs b/Documentation/ABI/testing/sysfs-aufs -new file mode 100644 -index 000000000000..82f9518495ea ---- /dev/null -+++ b/Documentation/ABI/testing/sysfs-aufs -@@ -0,0 +1,31 @@ -+What: /sys/fs/aufs/si_/ -+Date: March 2009 -+Contact: J. R. Okajima -+Description: -+ Under /sys/fs/aufs, a directory named si_ is created -+ per aufs mount, where is a unique id generated -+ internally. -+ -+What: /sys/fs/aufs/si_/br0, br1 ... brN -+Date: March 2009 -+Contact: J. R. Okajima -+Description: -+ It shows the abolute path of a member directory (which -+ is called branch) in aufs, and its permission. -+ -+What: /sys/fs/aufs/si_/brid0, brid1 ... bridN -+Date: July 2013 -+Contact: J. R. Okajima -+Description: -+ It shows the id of a member directory (which is called -+ branch) in aufs. -+ -+What: /sys/fs/aufs/si_/xi_path -+Date: March 2009 -+Contact: J. R. Okajima -+Description: -+ It shows the abolute path of XINO (External Inode Number -+ Bitmap, Translation Table and Generation Table) file -+ even if it is the default path. -+ When the aufs mount option 'noxino' is specified, it -+ will be empty. About XINO files, see the aufs manual. -diff --git a/Documentation/filesystems/aufs/README b/Documentation/filesystems/aufs/README -new file mode 100644 -index 000000000000..fa82b6394f69 ---- /dev/null -+++ b/Documentation/filesystems/aufs/README -@@ -0,0 +1,393 @@ -+ -+Aufs4 -- advanced multi layered unification filesystem version 4.x -+http://aufs.sf.net -+Junjiro R. Okajima -+ -+ -+0. Introduction -+---------------------------------------- -+In the early days, aufs was entirely re-designed and re-implemented -+Unionfs Version 1.x series. Adding many original ideas, approaches, -+improvements and implementations, it becomes totally different from -+Unionfs while keeping the basic features. -+Recently, Unionfs Version 2.x series begin taking some of the same -+approaches to aufs1's. -+Unionfs is being developed by Professor Erez Zadok at Stony Brook -+University and his team. -+ -+Aufs4 supports linux-4.0 and later, and for linux-3.x series try aufs3. -+If you want older kernel version support, try aufs2-2.6.git or -+aufs2-standalone.git repository, aufs1 from CVS on SourceForge. -+ -+Note: it becomes clear that "Aufs was rejected. Let's give it up." -+ According to Christoph Hellwig, linux rejects all union-type -+ filesystems but UnionMount. -+ -+ -+PS. Al Viro seems have a plan to merge aufs as well as overlayfs and -+ UnionMount, and he pointed out an issue around a directory mutex -+ lock and aufs addressed it. But it is still unsure whether aufs will -+ be merged (or any other union solution). -+ -+ -+ -+1. Features -+---------------------------------------- -+- unite several directories into a single virtual filesystem. The member -+ directory is called as a branch. -+- you can specify the permission flags to the branch, which are 'readonly', -+ 'readwrite' and 'whiteout-able.' -+- by upper writable branch, internal copyup and whiteout, files/dirs on -+ readonly branch are modifiable logically. -+- dynamic branch manipulation, add, del. -+- etc... -+ -+Also there are many enhancements in aufs, such as: -+- test only the highest one for the directory permission (dirperm1) -+- copyup on open (coo=) -+- 'move' policy for copy-up between two writable branches, after -+ checking free space. -+- xattr, acl -+- readdir(3) in userspace. -+- keep inode number by external inode number table -+- keep the timestamps of file/dir in internal copyup operation -+- seekable directory, supporting NFS readdir. -+- whiteout is hardlinked in order to reduce the consumption of inodes -+ on branch -+- do not copyup, nor create a whiteout when it is unnecessary -+- revert a single systemcall when an error occurs in aufs -+- remount interface instead of ioctl -+- maintain /etc/mtab by an external command, /sbin/mount.aufs. -+- loopback mounted filesystem as a branch -+- kernel thread for removing the dir who has a plenty of whiteouts -+- support copyup sparse file (a file which has a 'hole' in it) -+- default permission flags for branches -+- selectable permission flags for ro branch, whether whiteout can -+ exist or not -+- export via NFS. -+- support /fs/aufs and /aufs. -+- support multiple writable branches, some policies to select one -+ among multiple writable branches. -+- a new semantics for link(2) and rename(2) to support multiple -+ writable branches. -+- no glibc changes are required. -+- pseudo hardlink (hardlink over branches) -+- allow a direct access manually to a file on branch, e.g. bypassing aufs. -+ including NFS or remote filesystem branch. -+- userspace wrapper for pathconf(3)/fpathconf(3) with _PC_LINK_MAX. -+- and more... -+ -+Currently these features are dropped temporary from aufs4. -+See design/08plan.txt in detail. -+- nested mount, i.e. aufs as readonly no-whiteout branch of another aufs -+ (robr) -+- statistics of aufs thread (/sys/fs/aufs/stat) -+ -+Features or just an idea in the future (see also design/*.txt), -+- reorder the branch index without del/re-add. -+- permanent xino files for NFSD -+- an option for refreshing the opened files after add/del branches -+- light version, without branch manipulation. (unnecessary?) -+- copyup in userspace -+- inotify in userspace -+- readv/writev -+ -+ -+2. Download -+---------------------------------------- -+There are three GIT trees for aufs4, aufs4-linux.git, -+aufs4-standalone.git, and aufs-util.git. Note that there is no "4" in -+"aufs-util.git." -+While the aufs-util is always necessary, you need either of aufs4-linux -+or aufs4-standalone. -+ -+The aufs4-linux tree includes the whole linux mainline GIT tree, -+git://git.kernel.org/.../torvalds/linux.git. -+And you cannot select CONFIG_AUFS_FS=m for this version, eg. you cannot -+build aufs4 as an external kernel module. -+Several extra patches are not included in this tree. Only -+aufs4-standalone tree contains them. They are described in the later -+section "Configuration and Compilation." -+ -+On the other hand, the aufs4-standalone tree has only aufs source files -+and necessary patches, and you can select CONFIG_AUFS_FS=m. -+But you need to apply all aufs patches manually. -+ -+You will find GIT branches whose name is in form of "aufs4.x" where "x" -+represents the linux kernel version, "linux-4.x". For instance, -+"aufs4.0" is for linux-4.0. For latest "linux-4.x-rcN", use -+"aufs4.x-rcN" branch. -+ -+o aufs4-linux tree -+$ git clone --reference /your/linux/git/tree \ -+ git://github.com/sfjro/aufs4-linux.git aufs4-linux.git -+- if you don't have linux GIT tree, then remove "--reference ..." -+$ cd aufs4-linux.git -+$ git checkout origin/aufs4.0 -+ -+Or You may want to directly git-pull aufs into your linux GIT tree, and -+leave the patch-work to GIT. -+$ cd /your/linux/git/tree -+$ git remote add aufs4 git://github.com/sfjro/aufs4-linux.git -+$ git fetch aufs4 -+$ git checkout -b my4.0 v4.0 -+$ (add your local change...) -+$ git pull aufs4 aufs4.0 -+- now you have v4.0 + your_changes + aufs4.0 in you my4.0 branch. -+- you may need to solve some conflicts between your_changes and -+ aufs4.0. in this case, git-rerere is recommended so that you can -+ solve the similar conflicts automatically when you upgrade to 4.1 or -+ later in the future. -+ -+o aufs4-standalone tree -+$ git clone git://github.com/sfjro/aufs4-standalone.git aufs4-standalone.git -+$ cd aufs4-standalone.git -+$ git checkout origin/aufs4.0 -+ -+o aufs-util tree -+$ git clone git://git.code.sf.net/p/aufs/aufs-util aufs-util.git -+- note that the public aufs-util.git is on SourceForge instead of -+ GitHUB. -+$ cd aufs-util.git -+$ git checkout origin/aufs4.0 -+ -+Note: The 4.x-rcN branch is to be used with `rc' kernel versions ONLY. -+The minor version number, 'x' in '4.x', of aufs may not always -+follow the minor version number of the kernel. -+Because changes in the kernel that cause the use of a new -+minor version number do not always require changes to aufs-util. -+ -+Since aufs-util has its own minor version number, you may not be -+able to find a GIT branch in aufs-util for your kernel's -+exact minor version number. -+In this case, you should git-checkout the branch for the -+nearest lower number. -+ -+For (an unreleased) example: -+If you are using "linux-4.10" and the "aufs4.10" branch -+does not exist in aufs-util repository, then "aufs4.9", "aufs4.8" -+or something numerically smaller is the branch for your kernel. -+ -+Also you can view all branches by -+ $ git branch -a -+ -+ -+3. Configuration and Compilation -+---------------------------------------- -+Make sure you have git-checkout'ed the correct branch. -+ -+For aufs4-linux tree, -+- enable CONFIG_AUFS_FS. -+- set other aufs configurations if necessary. -+ -+For aufs4-standalone tree, -+There are several ways to build. -+ -+1. -+- apply ./aufs4-kbuild.patch to your kernel source files. -+- apply ./aufs4-base.patch too. -+- apply ./aufs4-mmap.patch too. -+- apply ./aufs4-standalone.patch too, if you have a plan to set -+ CONFIG_AUFS_FS=m. otherwise you don't need ./aufs4-standalone.patch. -+- copy ./{Documentation,fs,include/uapi/linux/aufs_type.h} files to your -+ kernel source tree. Never copy $PWD/include/uapi/linux/Kbuild. -+- enable CONFIG_AUFS_FS, you can select either -+ =m or =y. -+- and build your kernel as usual. -+- install the built kernel. -+ Note: Since linux-3.9, every filesystem module requires an alias -+ "fs-". You should make sure that "fs-aufs" is listed in your -+ modules.aliases file if you set CONFIG_AUFS_FS=m. -+- install the header files too by "make headers_install" to the -+ directory where you specify. By default, it is $PWD/usr. -+ "make help" shows a brief note for headers_install. -+- and reboot your system. -+ -+2. -+- module only (CONFIG_AUFS_FS=m). -+- apply ./aufs4-base.patch to your kernel source files. -+- apply ./aufs4-mmap.patch too. -+- apply ./aufs4-standalone.patch too. -+- build your kernel, don't forget "make headers_install", and reboot. -+- edit ./config.mk and set other aufs configurations if necessary. -+ Note: You should read $PWD/fs/aufs/Kconfig carefully which describes -+ every aufs configurations. -+- build the module by simple "make". -+ Note: Since linux-3.9, every filesystem module requires an alias -+ "fs-". You should make sure that "fs-aufs" is listed in your -+ modules.aliases file. -+- you can specify ${KDIR} make variable which points to your kernel -+ source tree. -+- install the files -+ + run "make install" to install the aufs module, or copy the built -+ $PWD/aufs.ko to /lib/modules/... and run depmod -a (or reboot simply). -+ + run "make install_headers" (instead of headers_install) to install -+ the modified aufs header file (you can specify DESTDIR which is -+ available in aufs standalone version's Makefile only), or copy -+ $PWD/usr/include/linux/aufs_type.h to /usr/include/linux or wherever -+ you like manually. By default, the target directory is $PWD/usr. -+- no need to apply aufs4-kbuild.patch, nor copying source files to your -+ kernel source tree. -+ -+Note: The header file aufs_type.h is necessary to build aufs-util -+ as well as "make headers_install" in the kernel source tree. -+ headers_install is subject to be forgotten, but it is essentially -+ necessary, not only for building aufs-util. -+ You may not meet problems without headers_install in some older -+ version though. -+ -+And then, -+- read README in aufs-util, build and install it -+- note that your distribution may contain an obsoleted version of -+ aufs_type.h in /usr/include/linux or something. When you build aufs -+ utilities, make sure that your compiler refers the correct aufs header -+ file which is built by "make headers_install." -+- if you want to use readdir(3) in userspace or pathconf(3) wrapper, -+ then run "make install_ulib" too. And refer to the aufs manual in -+ detail. -+ -+There several other patches in aufs4-standalone.git. They are all -+optional. When you meet some problems, they will help you. -+- aufs4-loopback.patch -+ Supports a nested loopback mount in a branch-fs. This patch is -+ unnecessary until aufs produces a message like "you may want to try -+ another patch for loopback file". -+- vfs-ino.patch -+ Modifies a system global kernel internal function get_next_ino() in -+ order to stop assigning 0 for an inode-number. Not directly related to -+ aufs, but recommended generally. -+- tmpfs-idr.patch -+ Keeps the tmpfs inode number as the lowest value. Effective to reduce -+ the size of aufs XINO files for tmpfs branch. Also it prevents the -+ duplication of inode number, which is important for backup tools and -+ other utilities. When you find aufs XINO files for tmpfs branch -+ growing too much, try this patch. -+- lockdep-debug.patch -+ Because aufs is not only an ordinary filesystem (callee of VFS), but -+ also a caller of VFS functions for branch filesystems, subclassing of -+ the internal locks for LOCKDEP is necessary. LOCKDEP is a debugging -+ feature of linux kernel. If you enable CONFIG_LOCKDEP, then you will -+ need to apply this debug patch to expand several constant values. -+ If don't know what LOCKDEP, then you don't have apply this patch. -+ -+ -+4. Usage -+---------------------------------------- -+At first, make sure aufs-util are installed, and please read the aufs -+manual, aufs.5 in aufs-util.git tree. -+$ man -l aufs.5 -+ -+And then, -+$ mkdir /tmp/rw /tmp/aufs -+# mount -t aufs -o br=/tmp/rw:${HOME} none /tmp/aufs -+ -+Here is another example. The result is equivalent. -+# mount -t aufs -o br=/tmp/rw=rw:${HOME}=ro none /tmp/aufs -+ Or -+# mount -t aufs -o br:/tmp/rw none /tmp/aufs -+# mount -o remount,append:${HOME} /tmp/aufs -+ -+Then, you can see whole tree of your home dir through /tmp/aufs. If -+you modify a file under /tmp/aufs, the one on your home directory is -+not affected, instead the same named file will be newly created under -+/tmp/rw. And all of your modification to a file will be applied to -+the one under /tmp/rw. This is called the file based Copy on Write -+(COW) method. -+Aufs mount options are described in aufs.5. -+If you run chroot or something and make your aufs as a root directory, -+then you need to customize the shutdown script. See the aufs manual in -+detail. -+ -+Additionally, there are some sample usages of aufs which are a -+diskless system with network booting, and LiveCD over NFS. -+See sample dir in CVS tree on SourceForge. -+ -+ -+5. Contact -+---------------------------------------- -+When you have any problems or strange behaviour in aufs, please let me -+know with: -+- /proc/mounts (instead of the output of mount(8)) -+- /sys/module/aufs/* -+- /sys/fs/aufs/* (if you have them) -+- /debug/aufs/* (if you have them) -+- linux kernel version -+ if your kernel is not plain, for example modified by distributor, -+ the url where i can download its source is necessary too. -+- aufs version which was printed at loading the module or booting the -+ system, instead of the date you downloaded. -+- configuration (define/undefine CONFIG_AUFS_xxx) -+- kernel configuration or /proc/config.gz (if you have it) -+- behaviour which you think to be incorrect -+- actual operation, reproducible one is better -+- mailto: aufs-users at lists.sourceforge.net -+ -+Usually, I don't watch the Public Areas(Bugs, Support Requests, Patches, -+and Feature Requests) on SourceForge. Please join and write to -+aufs-users ML. -+ -+ -+6. Acknowledgements -+---------------------------------------- -+Thanks to everyone who have tried and are using aufs, whoever -+have reported a bug or any feedback. -+ -+Especially donators: -+Tomas Matejicek(slax.org) made a donation (much more than once). -+ Since Apr 2010, Tomas M (the author of Slax and Linux Live -+ scripts) is making "doubling" donations. -+ Unfortunately I cannot list all of the donators, but I really -+ appreciate. -+ It ends Aug 2010, but the ordinary donation URL is still available. -+ -+Dai Itasaka made a donation (2007/8). -+Chuck Smith made a donation (2008/4, 10 and 12). -+Henk Schoneveld made a donation (2008/9). -+Chih-Wei Huang, ASUS, CTC donated Eee PC 4G (2008/10). -+Francois Dupoux made a donation (2008/11). -+Bruno Cesar Ribas and Luis Carlos Erpen de Bona, C3SL serves public -+ aufs2 GIT tree (2009/2). -+William Grant made a donation (2009/3). -+Patrick Lane made a donation (2009/4). -+The Mail Archive (mail-archive.com) made donations (2009/5). -+Nippy Networks (Ed Wildgoose) made a donation (2009/7). -+New Dream Network, LLC (www.dreamhost.com) made a donation (2009/11). -+Pavel Pronskiy made a donation (2011/2). -+Iridium and Inmarsat satellite phone retailer (www.mailasail.com), Nippy -+ Networks (Ed Wildgoose) made a donation for hardware (2011/3). -+Max Lekomcev (DOM-TV project) made a donation (2011/7, 12, 2012/3, 6 and -+11). -+Sam Liddicott made a donation (2011/9). -+Era Scarecrow made a donation (2013/4). -+Bor Ratajc made a donation (2013/4). -+Alessandro Gorreta made a donation (2013/4). -+POIRETTE Marc made a donation (2013/4). -+Alessandro Gorreta made a donation (2013/4). -+lauri kasvandik made a donation (2013/5). -+"pemasu from Finland" made a donation (2013/7). -+The Parted Magic Project made a donation (2013/9 and 11). -+Pavel Barta made a donation (2013/10). -+Nikolay Pertsev made a donation (2014/5). -+James B made a donation (2014/7 and 2015/7). -+Stefano Di Biase made a donation (2014/8). -+Daniel Epellei made a donation (2015/1). -+OmegaPhil made a donation (2016/1). -+Tomasz Szewczyk made a donation (2016/4). -+James Burry made a donation (2016/12). -+ -+Thank you very much. -+Donations are always, including future donations, very important and -+helpful for me to keep on developing aufs. -+ -+ -+7. -+---------------------------------------- -+If you are an experienced user, no explanation is needed. Aufs is -+just a linux filesystem. -+ -+ -+Enjoy! -+ -+# Local variables: ; -+# mode: text; -+# End: ; -diff --git a/Documentation/filesystems/aufs/design/01intro.txt b/Documentation/filesystems/aufs/design/01intro.txt -new file mode 100644 -index 000000000000..0cabbfc90903 ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/01intro.txt -@@ -0,0 +1,158 @@ -+ -+# Copyright (C) 2005-2017 Junjiro R. Okajima -+ -+Introduction -+---------------------------------------- -+ -+aufs [ei ju: ef es] | /ey-yoo-ef-es/ | [a u f s] -+1. abbrev. for "advanced multi-layered unification filesystem". -+2. abbrev. for "another unionfs". -+3. abbrev. for "auf das" in German which means "on the" in English. -+ Ex. "Butter aufs Brot"(G) means "butter onto bread"(E). -+ But "Filesystem aufs Filesystem" is hard to understand. -+4. abbrev. for "African Urban Fashion Show". -+ -+AUFS is a filesystem with features: -+- multi layered stackable unification filesystem, the member directory -+ is called as a branch. -+- branch permission and attribute, 'readonly', 'real-readonly', -+ 'readwrite', 'whiteout-able', 'link-able whiteout', etc. and their -+ combination. -+- internal "file copy-on-write". -+- logical deletion, whiteout. -+- dynamic branch manipulation, adding, deleting and changing permission. -+- allow bypassing aufs, user's direct branch access. -+- external inode number translation table and bitmap which maintains the -+ persistent aufs inode number. -+- seekable directory, including NFS readdir. -+- file mapping, mmap and sharing pages. -+- pseudo-link, hardlink over branches. -+- loopback mounted filesystem as a branch. -+- several policies to select one among multiple writable branches. -+- revert a single systemcall when an error occurs in aufs. -+- and more... -+ -+ -+Multi Layered Stackable Unification Filesystem -+---------------------------------------------------------------------- -+Most people already knows what it is. -+It is a filesystem which unifies several directories and provides a -+merged single directory. When users access a file, the access will be -+passed/re-directed/converted (sorry, I am not sure which English word is -+correct) to the real file on the member filesystem. The member -+filesystem is called 'lower filesystem' or 'branch' and has a mode -+'readonly' and 'readwrite.' And the deletion for a file on the lower -+readonly branch is handled by creating 'whiteout' on the upper writable -+branch. -+ -+On LKML, there have been discussions about UnionMount (Jan Blunck, -+Bharata B Rao and Valerie Aurora) and Unionfs (Erez Zadok). They took -+different approaches to implement the merged-view. -+The former tries putting it into VFS, and the latter implements as a -+separate filesystem. -+(If I misunderstand about these implementations, please let me know and -+I shall correct it. Because it is a long time ago when I read their -+source files last time). -+ -+UnionMount's approach will be able to small, but may be hard to share -+branches between several UnionMount since the whiteout in it is -+implemented in the inode on branch filesystem and always -+shared. According to Bharata's post, readdir does not seems to be -+finished yet. -+There are several missing features known in this implementations such as -+- for users, the inode number may change silently. eg. copy-up. -+- link(2) may break by copy-up. -+- read(2) may get an obsoleted filedata (fstat(2) too). -+- fcntl(F_SETLK) may be broken by copy-up. -+- unnecessary copy-up may happen, for example mmap(MAP_PRIVATE) after -+ open(O_RDWR). -+ -+In linux-3.18, "overlay" filesystem (formerly known as "overlayfs") was -+merged into mainline. This is another implementation of UnionMount as a -+separated filesystem. All the limitations and known problems which -+UnionMount are equally inherited to "overlay" filesystem. -+ -+Unionfs has a longer history. When I started implementing a stackable -+filesystem (Aug 2005), it already existed. It has virtual super_block, -+inode, dentry and file objects and they have an array pointing lower -+same kind objects. After contributing many patches for Unionfs, I -+re-started my project AUFS (Jun 2006). -+ -+In AUFS, the structure of filesystem resembles to Unionfs, but I -+implemented my own ideas, approaches and enhancements and it became -+totally different one. -+ -+Comparing DM snapshot and fs based implementation -+- the number of bytes to be copied between devices is much smaller. -+- the type of filesystem must be one and only. -+- the fs must be writable, no readonly fs, even for the lower original -+ device. so the compression fs will not be usable. but if we use -+ loopback mount, we may address this issue. -+ for instance, -+ mount /cdrom/squashfs.img /sq -+ losetup /sq/ext2.img -+ losetup /somewhere/cow -+ dmsetup "snapshot /dev/loop0 /dev/loop1 ..." -+- it will be difficult (or needs more operations) to extract the -+ difference between the original device and COW. -+- DM snapshot-merge may help a lot when users try merging. in the -+ fs-layer union, users will use rsync(1). -+ -+You may want to read my old paper "Filesystems in LiveCD" -+(http://aufs.sourceforge.net/aufs2/report/sq/sq.pdf). -+ -+ -+Several characters/aspects/persona of aufs -+---------------------------------------------------------------------- -+ -+Aufs has several characters, aspects or persona. -+1. a filesystem, callee of VFS helper -+2. sub-VFS, caller of VFS helper for branches -+3. a virtual filesystem which maintains persistent inode number -+4. reader/writer of files on branches such like an application -+ -+1. Callee of VFS Helper -+As an ordinary linux filesystem, aufs is a callee of VFS. For instance, -+unlink(2) from an application reaches sys_unlink() kernel function and -+then vfs_unlink() is called. vfs_unlink() is one of VFS helper and it -+calls filesystem specific unlink operation. Actually aufs implements the -+unlink operation but it behaves like a redirector. -+ -+2. Caller of VFS Helper for Branches -+aufs_unlink() passes the unlink request to the branch filesystem as if -+it were called from VFS. So the called unlink operation of the branch -+filesystem acts as usual. As a caller of VFS helper, aufs should handle -+every necessary pre/post operation for the branch filesystem. -+- acquire the lock for the parent dir on a branch -+- lookup in a branch -+- revalidate dentry on a branch -+- mnt_want_write() for a branch -+- vfs_unlink() for a branch -+- mnt_drop_write() for a branch -+- release the lock on a branch -+ -+3. Persistent Inode Number -+One of the most important issue for a filesystem is to maintain inode -+numbers. This is particularly important to support exporting a -+filesystem via NFS. Aufs is a virtual filesystem which doesn't have a -+backend block device for its own. But some storage is necessary to -+keep and maintain the inode numbers. It may be a large space and may not -+suit to keep in memory. Aufs rents some space from its first writable -+branch filesystem (by default) and creates file(s) on it. These files -+are created by aufs internally and removed soon (currently) keeping -+opened. -+Note: Because these files are removed, they are totally gone after -+ unmounting aufs. It means the inode numbers are not persistent -+ across unmount or reboot. I have a plan to make them really -+ persistent which will be important for aufs on NFS server. -+ -+4. Read/Write Files Internally (copy-on-write) -+Because a branch can be readonly, when you write a file on it, aufs will -+"copy-up" it to the upper writable branch internally. And then write the -+originally requested thing to the file. Generally kernel doesn't -+open/read/write file actively. In aufs, even a single write may cause a -+internal "file copy". This behaviour is very similar to cp(1) command. -+ -+Some people may think it is better to pass such work to user space -+helper, instead of doing in kernel space. Actually I am still thinking -+about it. But currently I have implemented it in kernel space. -diff --git a/Documentation/filesystems/aufs/design/02struct.txt b/Documentation/filesystems/aufs/design/02struct.txt -new file mode 100644 -index 000000000000..cec903ec2c48 ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/02struct.txt -@@ -0,0 +1,245 @@ -+ -+# Copyright (C) 2005-2017 Junjiro R. Okajima -+ -+Basic Aufs Internal Structure -+ -+Superblock/Inode/Dentry/File Objects -+---------------------------------------------------------------------- -+As like an ordinary filesystem, aufs has its own -+superblock/inode/dentry/file objects. All these objects have a -+dynamically allocated array and store the same kind of pointers to the -+lower filesystem, branch. -+For example, when you build a union with one readwrite branch and one -+readonly, mounted /au, /rw and /ro respectively. -+- /au = /rw + /ro -+- /ro/fileA exists but /rw/fileA -+ -+Aufs lookup operation finds /ro/fileA and gets dentry for that. These -+pointers are stored in a aufs dentry. The array in aufs dentry will be, -+- [0] = NULL (because /rw/fileA doesn't exist) -+- [1] = /ro/fileA -+ -+This style of an array is essentially same to the aufs -+superblock/inode/dentry/file objects. -+ -+Because aufs supports manipulating branches, ie. add/delete/change -+branches dynamically, these objects has its own generation. When -+branches are changed, the generation in aufs superblock is -+incremented. And a generation in other object are compared when it is -+accessed. When a generation in other objects are obsoleted, aufs -+refreshes the internal array. -+ -+ -+Superblock -+---------------------------------------------------------------------- -+Additionally aufs superblock has some data for policies to select one -+among multiple writable branches, XIB files, pseudo-links and kobject. -+See below in detail. -+About the policies which supports copy-down a directory, see -+wbr_policy.txt too. -+ -+ -+Branch and XINO(External Inode Number Translation Table) -+---------------------------------------------------------------------- -+Every branch has its own xino (external inode number translation table) -+file. The xino file is created and unlinked by aufs internally. When two -+members of a union exist on the same filesystem, they share the single -+xino file. -+The struct of a xino file is simple, just a sequence of aufs inode -+numbers which is indexed by the lower inode number. -+In the above sample, assume the inode number of /ro/fileA is i111 and -+aufs assigns the inode number i999 for fileA. Then aufs writes 999 as -+4(8) bytes at 111 * 4(8) bytes offset in the xino file. -+ -+When the inode numbers are not contiguous, the xino file will be sparse -+which has a hole in it and doesn't consume as much disk space as it -+might appear. If your branch filesystem consumes disk space for such -+holes, then you should specify 'xino=' option at mounting aufs. -+ -+Aufs has a mount option to free the disk blocks for such holes in XINO -+files on tmpfs or ramdisk. But it is not so effective actually. If you -+meet a problem of disk shortage due to XINO files, then you should try -+"tmpfs-ino.patch" (and "vfs-ino.patch" too) in aufs4-standalone.git. -+The patch localizes the assignment inumbers per tmpfs-mount and avoid -+the holes in XINO files. -+ -+Also a writable branch has three kinds of "whiteout bases". All these -+are existed when the branch is joined to aufs, and their names are -+whiteout-ed doubly, so that users will never see their names in aufs -+hierarchy. -+1. a regular file which will be hardlinked to all whiteouts. -+2. a directory to store a pseudo-link. -+3. a directory to store an "orphan"-ed file temporary. -+ -+1. Whiteout Base -+ When you remove a file on a readonly branch, aufs handles it as a -+ logical deletion and creates a whiteout on the upper writable branch -+ as a hardlink of this file in order not to consume inode on the -+ writable branch. -+2. Pseudo-link Dir -+ See below, Pseudo-link. -+3. Step-Parent Dir -+ When "fileC" exists on the lower readonly branch only and it is -+ opened and removed with its parent dir, and then user writes -+ something into it, then aufs copies-up fileC to this -+ directory. Because there is no other dir to store fileC. After -+ creating a file under this dir, the file is unlinked. -+ -+Because aufs supports manipulating branches, ie. add/delete/change -+dynamically, a branch has its own id. When the branch order changes, -+aufs finds the new index by searching the branch id. -+ -+ -+Pseudo-link -+---------------------------------------------------------------------- -+Assume "fileA" exists on the lower readonly branch only and it is -+hardlinked to "fileB" on the branch. When you write something to fileA, -+aufs copies-up it to the upper writable branch. Additionally aufs -+creates a hardlink under the Pseudo-link Directory of the writable -+branch. The inode of a pseudo-link is kept in aufs super_block as a -+simple list. If fileB is read after unlinking fileA, aufs returns -+filedata from the pseudo-link instead of the lower readonly -+branch. Because the pseudo-link is based upon the inode, to keep the -+inode number by xino (see above) is essentially necessary. -+ -+All the hardlinks under the Pseudo-link Directory of the writable branch -+should be restored in a proper location later. Aufs provides a utility -+to do this. The userspace helpers executed at remounting and unmounting -+aufs by default. -+During this utility is running, it puts aufs into the pseudo-link -+maintenance mode. In this mode, only the process which began the -+maintenance mode (and its child processes) is allowed to operate in -+aufs. Some other processes which are not related to the pseudo-link will -+be allowed to run too, but the rest have to return an error or wait -+until the maintenance mode ends. If a process already acquires an inode -+mutex (in VFS), it has to return an error. -+ -+ -+XIB(external inode number bitmap) -+---------------------------------------------------------------------- -+Addition to the xino file per a branch, aufs has an external inode number -+bitmap in a superblock object. It is also an internal file such like a -+xino file. -+It is a simple bitmap to mark whether the aufs inode number is in-use or -+not. -+To reduce the file I/O, aufs prepares a single memory page to cache xib. -+ -+As well as XINO files, aufs has a feature to truncate/refresh XIB to -+reduce the number of consumed disk blocks for these files. -+ -+ -+Virtual or Vertical Dir, and Readdir in Userspace -+---------------------------------------------------------------------- -+In order to support multiple layers (branches), aufs readdir operation -+constructs a virtual dir block on memory. For readdir, aufs calls -+vfs_readdir() internally for each dir on branches, merges their entries -+with eliminating the whiteout-ed ones, and sets it to file (dir) -+object. So the file object has its entry list until it is closed. The -+entry list will be updated when the file position is zero and becomes -+obsoleted. This decision is made in aufs automatically. -+ -+The dynamically allocated memory block for the name of entries has a -+unit of 512 bytes (by default) and stores the names contiguously (no -+padding). Another block for each entry is handled by kmem_cache too. -+During building dir blocks, aufs creates hash list and judging whether -+the entry is whiteouted by its upper branch or already listed. -+The merged result is cached in the corresponding inode object and -+maintained by a customizable life-time option. -+ -+Some people may call it can be a security hole or invite DoS attack -+since the opened and once readdir-ed dir (file object) holds its entry -+list and becomes a pressure for system memory. But I'd say it is similar -+to files under /proc or /sys. The virtual files in them also holds a -+memory page (generally) while they are opened. When an idea to reduce -+memory for them is introduced, it will be applied to aufs too. -+For those who really hate this situation, I've developed readdir(3) -+library which operates this merging in userspace. You just need to set -+LD_PRELOAD environment variable, and aufs will not consume no memory in -+kernel space for readdir(3). -+ -+ -+Workqueue -+---------------------------------------------------------------------- -+Aufs sometimes requires privilege access to a branch. For instance, -+in copy-up/down operation. When a user process is going to make changes -+to a file which exists in the lower readonly branch only, and the mode -+of one of ancestor directories may not be writable by a user -+process. Here aufs copy-up the file with its ancestors and they may -+require privilege to set its owner/group/mode/etc. -+This is a typical case of a application character of aufs (see -+Introduction). -+ -+Aufs uses workqueue synchronously for this case. It creates its own -+workqueue. The workqueue is a kernel thread and has privilege. Aufs -+passes the request to call mkdir or write (for example), and wait for -+its completion. This approach solves a problem of a signal handler -+simply. -+If aufs didn't adopt the workqueue and changed the privilege of the -+process, then the process may receive the unexpected SIGXFSZ or other -+signals. -+ -+Also aufs uses the system global workqueue ("events" kernel thread) too -+for asynchronous tasks, such like handling inotify/fsnotify, re-creating a -+whiteout base and etc. This is unrelated to a privilege. -+Most of aufs operation tries acquiring a rw_semaphore for aufs -+superblock at the beginning, at the same time waits for the completion -+of all queued asynchronous tasks. -+ -+ -+Whiteout -+---------------------------------------------------------------------- -+The whiteout in aufs is very similar to Unionfs's. That is represented -+by its filename. UnionMount takes an approach of a file mode, but I am -+afraid several utilities (find(1) or something) will have to support it. -+ -+Basically the whiteout represents "logical deletion" which stops aufs to -+lookup further, but also it represents "dir is opaque" which also stop -+further lookup. -+ -+In aufs, rmdir(2) and rename(2) for dir uses whiteout alternatively. -+In order to make several functions in a single systemcall to be -+revertible, aufs adopts an approach to rename a directory to a temporary -+unique whiteouted name. -+For example, in rename(2) dir where the target dir already existed, aufs -+renames the target dir to a temporary unique whiteouted name before the -+actual rename on a branch, and then handles other actions (make it opaque, -+update the attributes, etc). If an error happens in these actions, aufs -+simply renames the whiteouted name back and returns an error. If all are -+succeeded, aufs registers a function to remove the whiteouted unique -+temporary name completely and asynchronously to the system global -+workqueue. -+ -+ -+Copy-up -+---------------------------------------------------------------------- -+It is a well-known feature or concept. -+When user modifies a file on a readonly branch, aufs operate "copy-up" -+internally and makes change to the new file on the upper writable branch. -+When the trigger systemcall does not update the timestamps of the parent -+dir, aufs reverts it after copy-up. -+ -+ -+Move-down (aufs3.9 and later) -+---------------------------------------------------------------------- -+"Copy-up" is one of the essential feature in aufs. It copies a file from -+the lower readonly branch to the upper writable branch when a user -+changes something about the file. -+"Move-down" is an opposite action of copy-up. Basically this action is -+ran manually instead of automatically and internally. -+For desgin and implementation, aufs has to consider these issues. -+- whiteout for the file may exist on the lower branch. -+- ancestor directories may not exist on the lower branch. -+- diropq for the ancestor directories may exist on the upper branch. -+- free space on the lower branch will reduce. -+- another access to the file may happen during moving-down, including -+ UDBA (see "Revalidate Dentry and UDBA"). -+- the file should not be hard-linked nor pseudo-linked. they should be -+ handled by auplink utility later. -+ -+Sometimes users want to move-down a file from the upper writable branch -+to the lower readonly or writable branch. For instance, -+- the free space of the upper writable branch is going to run out. -+- create a new intermediate branch between the upper and lower branch. -+- etc. -+ -+For this purpose, use "aumvdown" command in aufs-util.git. -diff --git a/Documentation/filesystems/aufs/design/03atomic_open.txt b/Documentation/filesystems/aufs/design/03atomic_open.txt -new file mode 100644 -index 000000000000..12117ae5772b ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/03atomic_open.txt -@@ -0,0 +1,72 @@ -+ -+# Copyright (C) 2015-2017 Junjiro R. Okajima -+ -+Support for a branch who has its ->atomic_open() -+---------------------------------------------------------------------- -+The filesystems who implement its ->atomic_open() are not majority. For -+example NFSv4 does, and aufs should call NFSv4 ->atomic_open, -+particularly for open(O_CREAT|O_EXCL, 0400) case. Other than -+->atomic_open(), NFSv4 returns an error for this open(2). While I am not -+sure whether all filesystems who have ->atomic_open() behave like this, -+but NFSv4 surely returns the error. -+ -+In order to support ->atomic_open() for aufs, there are a few -+approaches. -+ -+A. Introduce aufs_atomic_open() -+ - calls one of VFS:do_last(), lookup_open() or atomic_open() for -+ branch fs. -+B. Introduce aufs_atomic_open() calling create, open and chmod. this is -+ an aufs user Pip Cet's approach -+ - calls aufs_create(), VFS finish_open() and notify_change(). -+ - pass fake-mode to finish_open(), and then correct the mode by -+ notify_change(). -+C. Extend aufs_open() to call branch fs's ->atomic_open() -+ - no aufs_atomic_open(). -+ - aufs_lookup() registers the TID to an aufs internal object. -+ - aufs_create() does nothing when the matching TID is registered, but -+ registers the mode. -+ - aufs_open() calls branch fs's ->atomic_open() when the matching -+ TID is registered. -+D. Extend aufs_open() to re-try branch fs's ->open() with superuser's -+ credential -+ - no aufs_atomic_open(). -+ - aufs_create() registers the TID to an internal object. this info -+ represents "this process created this file just now." -+ - when aufs gets EACCES from branch fs's ->open(), then confirm the -+ registered TID and re-try open() with superuser's credential. -+ -+Pros and cons for each approach. -+ -+A. -+ - straightforward but highly depends upon VFS internal. -+ - the atomic behavaiour is kept. -+ - some of parameters such as nameidata are hard to reproduce for -+ branch fs. -+ - large overhead. -+B. -+ - easy to implement. -+ - the atomic behavaiour is lost. -+C. -+ - the atomic behavaiour is kept. -+ - dirty and tricky. -+ - VFS checks whether the file is created correctly after calling -+ ->create(), which means this approach doesn't work. -+D. -+ - easy to implement. -+ - the atomic behavaiour is lost. -+ - to open a file with superuser's credential and give it to a user -+ process is a bad idea, since the file object keeps the credential -+ in it. It may affect LSM or something. This approach doesn't work -+ either. -+ -+The approach A is ideal, but it hard to implement. So here is a -+variation of A, which is to be implemented. -+ -+A-1. Introduce aufs_atomic_open() -+ - calls branch fs ->atomic_open() if exists. otherwise calls -+ vfs_create() and finish_open(). -+ - the demerit is that the several checks after branch fs -+ ->atomic_open() are lost. in the ordinary case, the checks are -+ done by VFS:do_last(), lookup_open() and atomic_open(). some can -+ be implemented in aufs, but not all I am afraid. -diff --git a/Documentation/filesystems/aufs/design/03lookup.txt b/Documentation/filesystems/aufs/design/03lookup.txt -new file mode 100644 -index 000000000000..9421550324a2 ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/03lookup.txt -@@ -0,0 +1,100 @@ -+ -+# Copyright (C) 2005-2017 Junjiro R. Okajima -+ -+Lookup in a Branch -+---------------------------------------------------------------------- -+Since aufs has a character of sub-VFS (see Introduction), it operates -+lookup for branches as VFS does. It may be a heavy work. But almost all -+lookup operation in aufs is the simplest case, ie. lookup only an entry -+directly connected to its parent. Digging down the directory hierarchy -+is unnecessary. VFS has a function lookup_one_len() for that use, and -+aufs calls it. -+ -+When a branch is a remote filesystem, aufs basically relies upon its -+->d_revalidate(), also aufs forces the hardest revalidate tests for -+them. -+For d_revalidate, aufs implements three levels of revalidate tests. See -+"Revalidate Dentry and UDBA" in detail. -+ -+ -+Test Only the Highest One for the Directory Permission (dirperm1 option) -+---------------------------------------------------------------------- -+Let's try case study. -+- aufs has two branches, upper readwrite and lower readonly. -+ /au = /rw + /ro -+- "dirA" exists under /ro, but /rw. and its mode is 0700. -+- user invoked "chmod a+rx /au/dirA" -+- the internal copy-up is activated and "/rw/dirA" is created and its -+ permission bits are set to world readable. -+- then "/au/dirA" becomes world readable? -+ -+In this case, /ro/dirA is still 0700 since it exists in readonly branch, -+or it may be a natively readonly filesystem. If aufs respects the lower -+branch, it should not respond readdir request from other users. But user -+allowed it by chmod. Should really aufs rejects showing the entries -+under /ro/dirA? -+ -+To be honest, I don't have a good solution for this case. So aufs -+implements 'dirperm1' and 'nodirperm1' mount options, and leave it to -+users. -+When dirperm1 is specified, aufs checks only the highest one for the -+directory permission, and shows the entries. Otherwise, as usual, checks -+every dir existing on all branches and rejects the request. -+ -+As a side effect, dirperm1 option improves the performance of aufs -+because the number of permission check is reduced when the number of -+branch is many. -+ -+ -+Revalidate Dentry and UDBA (User's Direct Branch Access) -+---------------------------------------------------------------------- -+Generally VFS helpers re-validate a dentry as a part of lookup. -+0. digging down the directory hierarchy. -+1. lock the parent dir by its i_mutex. -+2. lookup the final (child) entry. -+3. revalidate it. -+4. call the actual operation (create, unlink, etc.) -+5. unlock the parent dir -+ -+If the filesystem implements its ->d_revalidate() (step 3), then it is -+called. Actually aufs implements it and checks the dentry on a branch is -+still valid. -+But it is not enough. Because aufs has to release the lock for the -+parent dir on a branch at the end of ->lookup() (step 2) and -+->d_revalidate() (step 3) while the i_mutex of the aufs dir is still -+held by VFS. -+If the file on a branch is changed directly, eg. bypassing aufs, after -+aufs released the lock, then the subsequent operation may cause -+something unpleasant result. -+ -+This situation is a result of VFS architecture, ->lookup() and -+->d_revalidate() is separated. But I never say it is wrong. It is a good -+design from VFS's point of view. It is just not suitable for sub-VFS -+character in aufs. -+ -+Aufs supports such case by three level of revalidation which is -+selectable by user. -+1. Simple Revalidate -+ Addition to the native flow in VFS's, confirm the child-parent -+ relationship on the branch just after locking the parent dir on the -+ branch in the "actual operation" (step 4). When this validation -+ fails, aufs returns EBUSY. ->d_revalidate() (step 3) in aufs still -+ checks the validation of the dentry on branches. -+2. Monitor Changes Internally by Inotify/Fsnotify -+ Addition to above, in the "actual operation" (step 4) aufs re-lookup -+ the dentry on the branch, and returns EBUSY if it finds different -+ dentry. -+ Additionally, aufs sets the inotify/fsnotify watch for every dir on branches -+ during it is in cache. When the event is notified, aufs registers a -+ function to kernel 'events' thread by schedule_work(). And the -+ function sets some special status to the cached aufs dentry and inode -+ private data. If they are not cached, then aufs has nothing to -+ do. When the same file is accessed through aufs (step 0-3) later, -+ aufs will detect the status and refresh all necessary data. -+ In this mode, aufs has to ignore the event which is fired by aufs -+ itself. -+3. No Extra Validation -+ This is the simplest test and doesn't add any additional revalidation -+ test, and skip the revalidation in step 4. It is useful and improves -+ aufs performance when system surely hide the aufs branches from user, -+ by over-mounting something (or another method). -diff --git a/Documentation/filesystems/aufs/design/04branch.txt b/Documentation/filesystems/aufs/design/04branch.txt -new file mode 100644 -index 000000000000..ec59427ad94f ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/04branch.txt -@@ -0,0 +1,61 @@ -+ -+# Copyright (C) 2005-2017 Junjiro R. Okajima -+ -+Branch Manipulation -+ -+Since aufs supports dynamic branch manipulation, ie. add/remove a branch -+and changing its permission/attribute, there are a lot of works to do. -+ -+ -+Add a Branch -+---------------------------------------------------------------------- -+o Confirm the adding dir exists outside of aufs, including loopback -+ mount, and its various attributes. -+o Initialize the xino file and whiteout bases if necessary. -+ See struct.txt. -+ -+o Check the owner/group/mode of the directory -+ When the owner/group/mode of the adding directory differs from the -+ existing branch, aufs issues a warning because it may impose a -+ security risk. -+ For example, when a upper writable branch has a world writable empty -+ top directory, a malicious user can create any files on the writable -+ branch directly, like copy-up and modify manually. If something like -+ /etc/{passwd,shadow} exists on the lower readonly branch but the upper -+ writable branch, and the writable branch is world-writable, then a -+ malicious guy may create /etc/passwd on the writable branch directly -+ and the infected file will be valid in aufs. -+ I am afraid it can be a security issue, but aufs can do nothing except -+ producing a warning. -+ -+ -+Delete a Branch -+---------------------------------------------------------------------- -+o Confirm the deleting branch is not busy -+ To be general, there is one merit to adopt "remount" interface to -+ manipulate branches. It is to discard caches. At deleting a branch, -+ aufs checks the still cached (and connected) dentries and inodes. If -+ there are any, then they are all in-use. An inode without its -+ corresponding dentry can be alive alone (for example, inotify/fsnotify case). -+ -+ For the cached one, aufs checks whether the same named entry exists on -+ other branches. -+ If the cached one is a directory, because aufs provides a merged view -+ to users, as long as one dir is left on any branch aufs can show the -+ dir to users. In this case, the branch can be removed from aufs. -+ Otherwise aufs rejects deleting the branch. -+ -+ If any file on the deleting branch is opened by aufs, then aufs -+ rejects deleting. -+ -+ -+Modify the Permission of a Branch -+---------------------------------------------------------------------- -+o Re-initialize or remove the xino file and whiteout bases if necessary. -+ See struct.txt. -+ -+o rw --> ro: Confirm the modifying branch is not busy -+ Aufs rejects the request if any of these conditions are true. -+ - a file on the branch is mmap-ed. -+ - a regular file on the branch is opened for write and there is no -+ same named entry on the upper branch. -diff --git a/Documentation/filesystems/aufs/design/05wbr_policy.txt b/Documentation/filesystems/aufs/design/05wbr_policy.txt -new file mode 100644 -index 000000000000..89df0e2819d2 ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/05wbr_policy.txt -@@ -0,0 +1,51 @@ -+ -+# Copyright (C) 2005-2017 Junjiro R. Okajima -+ -+Policies to Select One among Multiple Writable Branches -+---------------------------------------------------------------------- -+When the number of writable branch is more than one, aufs has to decide -+the target branch for file creation or copy-up. By default, the highest -+writable branch which has the parent (or ancestor) dir of the target -+file is chosen (top-down-parent policy). -+By user's request, aufs implements some other policies to select the -+writable branch, for file creation several policies, round-robin, -+most-free-space, and other policies. For copy-up, top-down-parent, -+bottom-up-parent, bottom-up and others. -+ -+As expected, the round-robin policy selects the branch in circular. When -+you have two writable branches and creates 10 new files, 5 files will be -+created for each branch. mkdir(2) systemcall is an exception. When you -+create 10 new directories, all will be created on the same branch. -+And the most-free-space policy selects the one which has most free -+space among the writable branches. The amount of free space will be -+checked by aufs internally, and users can specify its time interval. -+ -+The policies for copy-up is more simple, -+top-down-parent is equivalent to the same named on in create policy, -+bottom-up-parent selects the writable branch where the parent dir -+exists and the nearest upper one from the copyup-source, -+bottom-up selects the nearest upper writable branch from the -+copyup-source, regardless the existence of the parent dir. -+ -+There are some rules or exceptions to apply these policies. -+- If there is a readonly branch above the policy-selected branch and -+ the parent dir is marked as opaque (a variation of whiteout), or the -+ target (creating) file is whiteout-ed on the upper readonly branch, -+ then the result of the policy is ignored and the target file will be -+ created on the nearest upper writable branch than the readonly branch. -+- If there is a writable branch above the policy-selected branch and -+ the parent dir is marked as opaque or the target file is whiteouted -+ on the branch, then the result of the policy is ignored and the target -+ file will be created on the highest one among the upper writable -+ branches who has diropq or whiteout. In case of whiteout, aufs removes -+ it as usual. -+- link(2) and rename(2) systemcalls are exceptions in every policy. -+ They try selecting the branch where the source exists as possible -+ since copyup a large file will take long time. If it can't be, -+ ie. the branch where the source exists is readonly, then they will -+ follow the copyup policy. -+- There is an exception for rename(2) when the target exists. -+ If the rename target exists, aufs compares the index of the branches -+ where the source and the target exists and selects the higher -+ one. If the selected branch is readonly, then aufs follows the -+ copyup policy. -diff --git a/Documentation/filesystems/aufs/design/06dirren.dot b/Documentation/filesystems/aufs/design/06dirren.dot -new file mode 100644 -index 000000000000..2d62bb6dd55f ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/06dirren.dot -@@ -0,0 +1,31 @@ -+ -+// to view this graph, run dot(1) command in GRAPHVIZ. -+ -+digraph G { -+node [shape=box]; -+whinfo [label="detailed info file\n(lower_brid_root-hinum, h_inum, namelen, old name)"]; -+ -+node [shape=oval]; -+ -+aufs_rename -> whinfo [label="store/remove"]; -+ -+node [shape=oval]; -+inode_list [label="h_inum list in branch\ncache"]; -+ -+node [shape=box]; -+whinode [label="h_inum list file"]; -+ -+node [shape=oval]; -+brmgmt [label="br_add/del/mod/umount"]; -+ -+brmgmt -> inode_list [label="create/remove"]; -+brmgmt -> whinode [label="load/store"]; -+ -+inode_list -> whinode [style=dashed,dir=both]; -+ -+aufs_rename -> inode_list [label="add/del"]; -+ -+aufs_lookup -> inode_list [label="search"]; -+ -+aufs_lookup -> whinfo [label="load/remove"]; -+} -diff --git a/Documentation/filesystems/aufs/design/06dirren.txt b/Documentation/filesystems/aufs/design/06dirren.txt -new file mode 100644 -index 000000000000..7aed1889d91e ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/06dirren.txt -@@ -0,0 +1,89 @@ -+ -+# Copyright (C) 2017 Junjiro R. Okajima -+ -+Special handling for renaming a directory (DIRREN) -+---------------------------------------------------------------------- -+First, let's assume we have a simple usecase. -+ -+- /u = /rw + /ro -+- /rw/dirA exists -+- /ro/dirA and /ro/dirA/file exist too -+- there is no dirB on both branches -+- a user issues rename("dirA", "dirB") -+ -+Now, what should aufs behave against this rename(2)? -+There are a few possible cases. -+ -+A. returns EROFS. -+ since dirA exists on a readonly branch which cannot be renamed. -+B. returns EXDEV. -+ it is possible to copy-up dirA (only the dir itself), but the child -+ entries ("file" in this case) should not be. it must be a bad -+ approach to copy-up recursively. -+C. returns a success. -+ even the branch /ro is readonly, aufs tries renaming it. Obviously it -+ is a violation of aufs' policy. -+D. construct an extra information which indicates that /ro/dirA should -+ be handled as the name of dirB. -+ overlayfs has a similar feature called REDIRECT. -+ -+Until now, aufs implements the case B only which returns EXDEV, and -+expects the userspace application behaves like mv(1) which tries -+issueing rename(2) recursively. -+ -+A new aufs feature called DIRREN is introduced which implements the case -+D. There are several "extra information" added. -+ -+1. detailed info per renamed directory -+ path: /rw/dirB/$AUFS_WH_DR_INFO_PFX. -+2. the inode-number list of directories on a branch -+ path: /rw/dirB/$AUFS_WH_DR_BRHINO -+ -+The filename of "detailed info per directory" represents the lower -+branch, and its format is -+- a type of the branch id -+ one of these. -+ + uuid (not implemented yet) -+ + fsid -+ + dev -+- the inode-number of the branch root dir -+ -+And it contains these info in a single regular file. -+- magic number -+- branch's inode-number of the logically renamed dir -+- the name of the before-renamed dir -+ -+The "detailed info per directory" file is created in aufs rename(2), and -+loaded in any lookup. -+The info is considered in lookup for the matching case only. Here -+"matching" means that the root of branch (in the info filename) is same -+to the current looking-up branch. After looking-up the before-renamed -+name, the inode-number is compared. And the matched dentry is used. -+ -+The "inode-number list of directories" is a regular file which contains -+simply the inode-numbers on the branch. The file is created or updated -+in removing the branch, and loaded in adding the branch. Its lifetime is -+equal to the branch. -+The list is refered in lookup, and when the current target inode is -+found in the list, the aufs tries loading the "detailed info per -+directory" and get the changed and valid name of the dir. -+ -+Theoretically these "extra informaiton" may be able to be put into XATTR -+in the dir inode. But aufs doesn't choose this way because -+1. XATTR may not be supported by the branch (or its configuration) -+2. XATTR may have its size limit. -+3. XATTR may be less easy to convert than a regular file, when the -+ format of the info is changed in the future. -+At the same time, I agree that the regular file approach is much slower -+than XATTR approach. So, in the future, aufs may take the XATTR or other -+better approach. -+ -+This DIRREN feature is enabled by aufs configuration, and is activated -+by a new mount option. -+ -+For the more complicated case, there is a work with UDBA option, which -+is to dected the direct access to the branches (by-passing aufs) and to -+maintain the cashes in aufs. Since a single cached aufs dentry may -+contains two names, before- and after-rename, the name comparision in -+UDBA handler may not work correctly. In this case, the behaviour will be -+equivalen to udba=reval case. -diff --git a/Documentation/filesystems/aufs/design/06fhsm.txt b/Documentation/filesystems/aufs/design/06fhsm.txt -new file mode 100644 -index 000000000000..dc8451fc3ac2 ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/06fhsm.txt -@@ -0,0 +1,105 @@ -+ -+# Copyright (C) 2011-2017 Junjiro R. Okajima -+ -+File-based Hierarchical Storage Management (FHSM) -+---------------------------------------------------------------------- -+Hierarchical Storage Management (or HSM) is a well-known feature in the -+storage world. Aufs provides this feature as file-based with multiple -+writable branches, based upon the principle of "Colder, the Lower". -+Here the word "colder" means that the less used files, and "lower" means -+that the position in the order of the stacked branches vertically. -+These multiple writable branches are prioritized, ie. the topmost one -+should be the fastest drive and be used heavily. -+ -+o Characters in aufs FHSM story -+- aufs itself and a new branch attribute. -+- a new ioctl interface to move-down and to establish a connection with -+ the daemon ("move-down" is a converse of "copy-up"). -+- userspace tool and daemon. -+ -+The userspace daemon establishes a connection with aufs and waits for -+the notification. The notified information is very similar to struct -+statfs containing the number of consumed blocks and inodes. -+When the consumed blocks/inodes of a branch exceeds the user-specified -+upper watermark, the daemon activates its move-down process until the -+consumed blocks/inodes reaches the user-specified lower watermark. -+ -+The actual move-down is done by aufs based upon the request from -+user-space since we need to maintain the inode number and the internal -+pointer arrays in aufs. -+ -+Currently aufs FHSM handles the regular files only. Additionally they -+must not be hard-linked nor pseudo-linked. -+ -+ -+o Cowork of aufs and the user-space daemon -+ During the userspace daemon established the connection, aufs sends a -+ small notification to it whenever aufs writes something into the -+ writable branch. But it may cost high since aufs issues statfs(2) -+ internally. So user can specify a new option to cache the -+ info. Actually the notification is controlled by these factors. -+ + the specified cache time. -+ + classified as "force" by aufs internally. -+ Until the specified time expires, aufs doesn't send the info -+ except the forced cases. When aufs decide forcing, the info is always -+ notified to userspace. -+ For example, the number of free inodes is generally large enough and -+ the shortage of it happens rarely. So aufs doesn't force the -+ notification when creating a new file, directory and others. This is -+ the typical case which aufs doesn't force. -+ When aufs writes the actual filedata and the files consumes any of new -+ blocks, the aufs forces notifying. -+ -+ -+o Interfaces in aufs -+- New branch attribute. -+ + fhsm -+ Specifies that the branch is managed by FHSM feature. In other word, -+ participant in the FHSM. -+ When nofhsm is set to the branch, it will not be the source/target -+ branch of the move-down operation. This attribute is set -+ independently from coo and moo attributes, and if you want full -+ FHSM, you should specify them as well. -+- New mount option. -+ + fhsm_sec -+ Specifies a second to suppress many less important info to be -+ notified. -+- New ioctl. -+ + AUFS_CTL_FHSM_FD -+ create a new file descriptor which userspace can read the notification -+ (a subset of struct statfs) from aufs. -+- Module parameter 'brs' -+ It has to be set to 1. Otherwise the new mount option 'fhsm' will not -+ be set. -+- mount helpers /sbin/mount.aufs and /sbin/umount.aufs -+ When there are two or more branches with fhsm attributes, -+ /sbin/mount.aufs invokes the user-space daemon and /sbin/umount.aufs -+ terminates it. As a result of remounting and branch-manipulation, the -+ number of branches with fhsm attribute can be one. In this case, -+ /sbin/mount.aufs will terminate the user-space daemon. -+ -+ -+Finally the operation is done as these steps in kernel-space. -+- make sure that, -+ + no one else is using the file. -+ + the file is not hard-linked. -+ + the file is not pseudo-linked. -+ + the file is a regular file. -+ + the parent dir is not opaqued. -+- find the target writable branch. -+- make sure the file is not whiteout-ed by the upper (than the target) -+ branch. -+- make the parent dir on the target branch. -+- mutex lock the inode on the branch. -+- unlink the whiteout on the target branch (if exists). -+- lookup and create the whiteout-ed temporary name on the target branch. -+- copy the file as the whiteout-ed temporary name on the target branch. -+- rename the whiteout-ed temporary name to the original name. -+- unlink the file on the source branch. -+- maintain the internal pointer array and the external inode number -+ table (XINO). -+- maintain the timestamps and other attributes of the parent dir and the -+ file. -+ -+And of course, in every step, an error may happen. So the operation -+should restore the original file state after an error happens. -diff --git a/Documentation/filesystems/aufs/design/06mmap.txt b/Documentation/filesystems/aufs/design/06mmap.txt -new file mode 100644 -index 000000000000..d79f7ad01162 ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/06mmap.txt -@@ -0,0 +1,59 @@ -+ -+# Copyright (C) 2005-2017 Junjiro R. Okajima -+ -+mmap(2) -- File Memory Mapping -+---------------------------------------------------------------------- -+In aufs, the file-mapped pages are handled by a branch fs directly, no -+interaction with aufs. It means aufs_mmap() calls the branch fs's -+->mmap(). -+This approach is simple and good, but there is one problem. -+Under /proc, several entries show the mmapped files by its path (with -+device and inode number), and the printed path will be the path on the -+branch fs's instead of virtual aufs's. -+This is not a problem in most cases, but some utilities lsof(1) (and its -+user) may expect the path on aufs. -+ -+To address this issue, aufs adds a new member called vm_prfile in struct -+vm_area_struct (and struct vm_region). The original vm_file points to -+the file on the branch fs in order to handle everything correctly as -+usual. The new vm_prfile points to a virtual file in aufs, and the -+show-functions in procfs refers to vm_prfile if it is set. -+Also we need to maintain several other places where touching vm_file -+such like -+- fork()/clone() copies vma and the reference count of vm_file is -+ incremented. -+- merging vma maintains the ref count too. -+ -+This is not a good approach. It just fakes the printed path. But it -+leaves all behaviour around f_mapping unchanged. This is surely an -+advantage. -+Actually aufs had adopted another complicated approach which calls -+generic_file_mmap() and handles struct vm_operations_struct. In this -+approach, aufs met a hard problem and I could not solve it without -+switching the approach. -+ -+There may be one more another approach which is -+- bind-mount the branch-root onto the aufs-root internally -+- grab the new vfsmount (ie. struct mount) -+- lazy-umount the branch-root internally -+- in open(2) the aufs-file, open the branch-file with the hidden -+ vfsmount (instead of the original branch's vfsmount) -+- ideally this "bind-mount and lazy-umount" should be done atomically, -+ but it may be possible from userspace by the mount helper. -+ -+Adding the internal hidden vfsmount and using it in opening a file, the -+file path under /proc will be printed correctly. This approach looks -+smarter, but is not possible I am afraid. -+- aufs-root may be bind-mount later. when it happens, another hidden -+ vfsmount will be required. -+- it is hard to get the chance to bind-mount and lazy-umount -+ + in kernel-space, FS can have vfsmount in open(2) via -+ file->f_path, and aufs can know its vfsmount. But several locks are -+ already acquired, and if aufs tries to bind-mount and lazy-umount -+ here, then it may cause a deadlock. -+ + in user-space, bind-mount doesn't invoke the mount helper. -+- since /proc shows dev and ino, aufs has to give vma these info. it -+ means a new member vm_prinode will be necessary. this is essentially -+ equivalent to vm_prfile described above. -+ -+I have to give up this "looks-smater" approach. -diff --git a/Documentation/filesystems/aufs/design/06xattr.txt b/Documentation/filesystems/aufs/design/06xattr.txt -new file mode 100644 -index 000000000000..1ff7d53f9b07 ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/06xattr.txt -@@ -0,0 +1,81 @@ -+ -+# Copyright (C) 2014-2017 Junjiro R. Okajima -+ -+Listing XATTR/EA and getting the value -+---------------------------------------------------------------------- -+For the inode standard attributes (owner, group, timestamps, etc.), aufs -+shows the values from the topmost existing file. This behaviour is good -+for the non-dir entries since the bahaviour exactly matches the shown -+information. But for the directories, aufs considers all the same named -+entries on the lower branches. Which means, if one of the lower entry -+rejects readdir call, then aufs returns an error even if the topmost -+entry allows it. This behaviour is necessary to respect the branch fs's -+security, but can make users confused since the user-visible standard -+attributes don't match the behaviour. -+To address this issue, aufs has a mount option called dirperm1 which -+checks the permission for the topmost entry only, and ignores the lower -+entry's permission. -+ -+A similar issue can happen around XATTR. -+getxattr(2) and listxattr(2) families behave as if dirperm1 option is -+always set. Otherwise these very unpleasant situation would happen. -+- listxattr(2) may return the duplicated entries. -+- users may not be able to remove or reset the XATTR forever, -+ -+ -+XATTR/EA support in the internal (copy,move)-(up,down) -+---------------------------------------------------------------------- -+Generally the extended attributes of inode are categorized as these. -+- "security" for LSM and capability. -+- "system" for posix ACL, 'acl' mount option is required for the branch -+ fs generally. -+- "trusted" for userspace, CAP_SYS_ADMIN is required. -+- "user" for userspace, 'user_xattr' mount option is required for the -+ branch fs generally. -+ -+Moreover there are some other categories. Aufs handles these rather -+unpopular categories as the ordinary ones, ie. there is no special -+condition nor exception. -+ -+In copy-up, the support for XATTR on the dst branch may differ from the -+src branch. In this case, the copy-up operation will get an error and -+the original user operation which triggered the copy-up will fail. It -+can happen that even all copy-up will fail. -+When both of src and dst branches support XATTR and if an error occurs -+during copying XATTR, then the copy-up should fail obviously. That is a -+good reason and aufs should return an error to userspace. But when only -+the src branch support that XATTR, aufs should not return an error. -+For example, the src branch supports ACL but the dst branch doesn't -+because the dst branch may natively un-support it or temporary -+un-support it due to "noacl" mount option. Of course, the dst branch fs -+may NOT return an error even if the XATTR is not supported. It is -+totally up to the branch fs. -+ -+Anyway when the aufs internal copy-up gets an error from the dst branch -+fs, then aufs tries removing the just copied entry and returns the error -+to the userspace. The worst case of this situation will be all copy-up -+will fail. -+ -+For the copy-up operation, there two basic approaches. -+- copy the specified XATTR only (by category above), and return the -+ error unconditionally if it happens. -+- copy all XATTR, and ignore the error on the specified category only. -+ -+In order to support XATTR and to implement the correct behaviour, aufs -+chooses the latter approach and introduces some new branch attributes, -+"icexsec", "icexsys", "icextr", "icexusr", and "icexoth". -+They correspond to the XATTR namespaces (see above). Additionally, to be -+convenient, "icex" is also provided which means all "icex*" attributes -+are set (here the word "icex" stands for "ignore copy-error on XATTR"). -+ -+The meaning of these attributes is to ignore the error from setting -+XATTR on that branch. -+Note that aufs tries copying all XATTR unconditionally, and ignores the -+error from the dst branch according to the specified attributes. -+ -+Some XATTR may have its default value. The default value may come from -+the parent dir or the environment. If the default value is set at the -+file creating-time, it will be overwritten by copy-up. -+Some contradiction may happen I am afraid. -+Do we need another attribute to stop copying XATTR? I am unsure. For -+now, aufs implements the branch attributes to ignore the error. -diff --git a/Documentation/filesystems/aufs/design/07export.txt b/Documentation/filesystems/aufs/design/07export.txt -new file mode 100644 -index 000000000000..d50dcb8eb7fe ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/07export.txt -@@ -0,0 +1,45 @@ -+ -+# Copyright (C) 2005-2017 Junjiro R. Okajima -+ -+Export Aufs via NFS -+---------------------------------------------------------------------- -+Here is an approach. -+- like xino/xib, add a new file 'xigen' which stores aufs inode -+ generation. -+- iget_locked(): initialize aufs inode generation for a new inode, and -+ store it in xigen file. -+- destroy_inode(): increment aufs inode generation and store it in xigen -+ file. it is necessary even if it is not unlinked, because any data of -+ inode may be changed by UDBA. -+- encode_fh(): for a root dir, simply return FILEID_ROOT. otherwise -+ build file handle by -+ + branch id (4 bytes) -+ + superblock generation (4 bytes) -+ + inode number (4 or 8 bytes) -+ + parent dir inode number (4 or 8 bytes) -+ + inode generation (4 bytes)) -+ + return value of exportfs_encode_fh() for the parent on a branch (4 -+ bytes) -+ + file handle for a branch (by exportfs_encode_fh()) -+- fh_to_dentry(): -+ + find the index of a branch from its id in handle, and check it is -+ still exist in aufs. -+ + 1st level: get the inode number from handle and search it in cache. -+ + 2nd level: if not found in cache, get the parent inode number from -+ the handle and search it in cache. and then open the found parent -+ dir, find the matching inode number by vfs_readdir() and get its -+ name, and call lookup_one_len() for the target dentry. -+ + 3rd level: if the parent dir is not cached, call -+ exportfs_decode_fh() for a branch and get the parent on a branch, -+ build a pathname of it, convert it a pathname in aufs, call -+ path_lookup(). now aufs gets a parent dir dentry, then handle it as -+ the 2nd level. -+ + to open the dir, aufs needs struct vfsmount. aufs keeps vfsmount -+ for every branch, but not itself. to get this, (currently) aufs -+ searches in current->nsproxy->mnt_ns list. it may not be a good -+ idea, but I didn't get other approach. -+ + test the generation of the gotten inode. -+- every inode operation: they may get EBUSY due to UDBA. in this case, -+ convert it into ESTALE for NFSD. -+- readdir(): call lockdep_on/off() because filldir in NFSD calls -+ lookup_one_len(), vfs_getattr(), encode_fh() and others. -diff --git a/Documentation/filesystems/aufs/design/08shwh.txt b/Documentation/filesystems/aufs/design/08shwh.txt -new file mode 100644 -index 000000000000..7b57de50fbc7 ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/08shwh.txt -@@ -0,0 +1,39 @@ -+ -+# Copyright (C) 2005-2017 Junjiro R. Okajima -+ -+Show Whiteout Mode (shwh) -+---------------------------------------------------------------------- -+Generally aufs hides the name of whiteouts. But in some cases, to show -+them is very useful for users. For instance, creating a new middle layer -+(branch) by merging existing layers. -+ -+(borrowing aufs1 HOW-TO from a user, Michael Towers) -+When you have three branches, -+- Bottom: 'system', squashfs (underlying base system), read-only -+- Middle: 'mods', squashfs, read-only -+- Top: 'overlay', ram (tmpfs), read-write -+ -+The top layer is loaded at boot time and saved at shutdown, to preserve -+the changes made to the system during the session. -+When larger changes have been made, or smaller changes have accumulated, -+the size of the saved top layer data grows. At this point, it would be -+nice to be able to merge the two overlay branches ('mods' and 'overlay') -+and rewrite the 'mods' squashfs, clearing the top layer and thus -+restoring save and load speed. -+ -+This merging is simplified by the use of another aufs mount, of just the -+two overlay branches using the 'shwh' option. -+# mount -t aufs -o ro,shwh,br:/livesys/overlay=ro+wh:/livesys/mods=rr+wh \ -+ aufs /livesys/merge_union -+ -+A merged view of these two branches is then available at -+/livesys/merge_union, and the new feature is that the whiteouts are -+visible! -+Note that in 'shwh' mode the aufs mount must be 'ro', which will disable -+writing to all branches. Also the default mode for all branches is 'ro'. -+It is now possible to save the combined contents of the two overlay -+branches to a new squashfs, e.g.: -+# mksquashfs /livesys/merge_union /path/to/newmods.squash -+ -+This new squashfs archive can be stored on the boot device and the -+initramfs will use it to replace the old one at the next boot. -diff --git a/Documentation/filesystems/aufs/design/10dynop.txt b/Documentation/filesystems/aufs/design/10dynop.txt -new file mode 100644 -index 000000000000..1c38e65a43bd ---- /dev/null -+++ b/Documentation/filesystems/aufs/design/10dynop.txt -@@ -0,0 +1,34 @@ -+ -+# Copyright (C) 2010-2017 Junjiro R. Okajima -+ -+Dynamically customizable FS operations -+---------------------------------------------------------------------- -+Generally FS operations (struct inode_operations, struct -+address_space_operations, struct file_operations, etc.) are defined as -+"static const", but it never means that FS have only one set of -+operation. Some FS have multiple sets of them. For instance, ext2 has -+three sets, one for XIP, for NOBH, and for normal. -+Since aufs overrides and redirects these operations, sometimes aufs has -+to change its behaviour according to the branch FS type. More importantly -+VFS acts differently if a function (member in the struct) is set or -+not. It means aufs should have several sets of operations and select one -+among them according to the branch FS definition. -+ -+In order to solve this problem and not to affect the behaviour of VFS, -+aufs defines these operations dynamically. For instance, aufs defines -+dummy direct_IO function for struct address_space_operations, but it may -+not be set to the address_space_operations actually. When the branch FS -+doesn't have it, aufs doesn't set it to its address_space_operations -+while the function definition itself is still alive. So the behaviour -+itself will not change, and it will return an error when direct_IO is -+not set. -+ -+The lifetime of these dynamically generated operation object is -+maintained by aufs branch object. When the branch is removed from aufs, -+the reference counter of the object is decremented. When it reaches -+zero, the dynamically generated operation object will be freed. -+ -+This approach is designed to support AIO (io_submit), Direct I/O and -+XIP (DAX) mainly. -+Currently this approach is applied to address_space_operations for -+regular files only. -diff --git a/MAINTAINERS b/MAINTAINERS -index 2811a211632c..02b6deb1f5bc 100644 ---- a/MAINTAINERS -+++ b/MAINTAINERS -@@ -2465,6 +2465,19 @@ F: include/linux/audit.h - F: include/uapi/linux/audit.h - F: kernel/audit* - -+AUFS (advanced multi layered unification filesystem) FILESYSTEM -+M: "J. R. Okajima" -+L: linux-unionfs@vger.kernel.org -+L: aufs-users@lists.sourceforge.net (members only) -+W: http://aufs.sourceforge.net -+T: git://github.com/sfjro/aufs4-linux.git -+S: Supported -+F: Documentation/filesystems/aufs/ -+F: Documentation/ABI/testing/debugfs-aufs -+F: Documentation/ABI/testing/sysfs-aufs -+F: fs/aufs/ -+F: include/uapi/linux/aufs_type.h -+ - AUXILIARY DISPLAY DRIVERS - M: Miguel Ojeda Sandonis - W: http://miguelojeda.es/auxdisplay.htm -diff --git a/drivers/block/loop.c b/drivers/block/loop.c -index 85de67334695..d44de9dbaddf 100644 ---- a/drivers/block/loop.c -+++ b/drivers/block/loop.c -@@ -686,6 +686,24 @@ static inline int is_loop_device(struct file *file) - return i && S_ISBLK(i->i_mode) && MAJOR(i->i_rdev) == LOOP_MAJOR; - } - -+/* -+ * for AUFS -+ * no get/put for file. -+ */ -+struct file *loop_backing_file(struct super_block *sb) -+{ -+ struct file *ret; -+ struct loop_device *l; -+ -+ ret = NULL; -+ if (MAJOR(sb->s_dev) == LOOP_MAJOR) { -+ l = sb->s_bdev->bd_disk->private_data; -+ ret = l->lo_backing_file; -+ } -+ return ret; -+} -+EXPORT_SYMBOL_GPL(loop_backing_file); -+ - /* loop sysfs attributes */ - - static ssize_t loop_attr_show(struct device *dev, char *page, -diff --git a/fs/Kconfig b/fs/Kconfig -index 7aee6d699fd6..ec92031204c5 100644 ---- a/fs/Kconfig -+++ b/fs/Kconfig -@@ -248,6 +248,7 @@ source "fs/pstore/Kconfig" - source "fs/sysv/Kconfig" - source "fs/ufs/Kconfig" - source "fs/exofs/Kconfig" -+source "fs/aufs/Kconfig" - - endif # MISC_FILESYSTEMS - -diff --git a/fs/Makefile b/fs/Makefile -index ef772f1eaff8..51779e68c0d0 100644 ---- a/fs/Makefile -+++ b/fs/Makefile -@@ -129,3 +129,4 @@ obj-y += exofs/ # Multiple modules - obj-$(CONFIG_CEPH_FS) += ceph/ - obj-$(CONFIG_PSTORE) += pstore/ - obj-$(CONFIG_EFIVAR_FS) += efivarfs/ -+obj-$(CONFIG_AUFS_FS) += aufs/ -diff --git a/fs/aufs/Kconfig b/fs/aufs/Kconfig -new file mode 100644 -index 000000000000..0b442aeb7b45 ---- /dev/null -+++ b/fs/aufs/Kconfig -@@ -0,0 +1,199 @@ -+# SPDX-License-Identifier: GPL-2.0 -+config AUFS_FS -+ bool "Aufs (Advanced multi layered unification filesystem) support" -+ help -+ Aufs is a stackable unification filesystem such as Unionfs, -+ which unifies several directories and provides a merged single -+ directory. -+ In the early days, aufs was entirely re-designed and -+ re-implemented Unionfs Version 1.x series. Introducing many -+ original ideas, approaches and improvements, it becomes totally -+ different from Unionfs while keeping the basic features. -+ -+if AUFS_FS -+choice -+ prompt "Maximum number of branches" -+ default AUFS_BRANCH_MAX_127 -+ help -+ Specifies the maximum number of branches (or member directories) -+ in a single aufs. The larger value consumes more system -+ resources and has a minor impact to performance. -+config AUFS_BRANCH_MAX_127 -+ bool "127" -+ help -+ Specifies the maximum number of branches (or member directories) -+ in a single aufs. The larger value consumes more system -+ resources and has a minor impact to performance. -+config AUFS_BRANCH_MAX_511 -+ bool "511" -+ help -+ Specifies the maximum number of branches (or member directories) -+ in a single aufs. The larger value consumes more system -+ resources and has a minor impact to performance. -+config AUFS_BRANCH_MAX_1023 -+ bool "1023" -+ help -+ Specifies the maximum number of branches (or member directories) -+ in a single aufs. The larger value consumes more system -+ resources and has a minor impact to performance. -+config AUFS_BRANCH_MAX_32767 -+ bool "32767" -+ help -+ Specifies the maximum number of branches (or member directories) -+ in a single aufs. The larger value consumes more system -+ resources and has a minor impact to performance. -+endchoice -+ -+config AUFS_SBILIST -+ bool -+ depends on AUFS_MAGIC_SYSRQ || PROC_FS -+ default y -+ help -+ Automatic configuration for internal use. -+ When aufs supports Magic SysRq or /proc, enabled automatically. -+ -+config AUFS_HNOTIFY -+ bool "Detect direct branch access (bypassing aufs)" -+ help -+ If you want to modify files on branches directly, eg. bypassing aufs, -+ and want aufs to detect the changes of them fully, then enable this -+ option and use 'udba=notify' mount option. -+ Currently there is only one available configuration, "fsnotify". -+ It will have a negative impact to the performance. -+ See detail in aufs.5. -+ -+choice -+ prompt "method" if AUFS_HNOTIFY -+ default AUFS_HFSNOTIFY -+config AUFS_HFSNOTIFY -+ bool "fsnotify" -+ select FSNOTIFY -+endchoice -+ -+config AUFS_EXPORT -+ bool "NFS-exportable aufs" -+ depends on EXPORTFS = y -+ help -+ If you want to export your mounted aufs via NFS, then enable this -+ option. There are several requirements for this configuration. -+ See detail in aufs.5. -+ -+config AUFS_INO_T_64 -+ bool -+ depends on AUFS_EXPORT -+ depends on 64BIT && !(ALPHA || S390) -+ default y -+ help -+ Automatic configuration for internal use. -+ /* typedef unsigned long/int __kernel_ino_t */ -+ /* alpha and s390x are int */ -+ -+config AUFS_XATTR -+ bool "support for XATTR/EA (including Security Labels)" -+ help -+ If your branch fs supports XATTR/EA and you want to make them -+ available in aufs too, then enable this opsion and specify the -+ branch attributes for EA. -+ See detail in aufs.5. -+ -+config AUFS_FHSM -+ bool "File-based Hierarchical Storage Management" -+ help -+ Hierarchical Storage Management (or HSM) is a well-known feature -+ in the storage world. Aufs provides this feature as file-based. -+ with multiple branches. -+ These multiple branches are prioritized, ie. the topmost one -+ should be the fastest drive and be used heavily. -+ -+config AUFS_RDU -+ bool "Readdir in userspace" -+ help -+ Aufs has two methods to provide a merged view for a directory, -+ by a user-space library and by kernel-space natively. The latter -+ is always enabled but sometimes large and slow. -+ If you enable this option, install the library in aufs2-util -+ package, and set some environment variables for your readdir(3), -+ then the work will be handled in user-space which generally -+ shows better performance in most cases. -+ See detail in aufs.5. -+ -+config AUFS_DIRREN -+ bool "Workaround for rename(2)-ing a directory" -+ help -+ By default, aufs returns EXDEV error in renameing a dir who has -+ his child on the lower branch, since it is a bad idea to issue -+ rename(2) internally for every lower branch. But user may not -+ accept this behaviour. So here is a workaround to allow such -+ rename(2) and store some extra infromation on the writable -+ branch. Obviously this costs high (and I don't like it). -+ To use this feature, you need to enable this configuration AND -+ to specify the mount option `dirren.' -+ See details in aufs.5 and the design documents. -+ -+config AUFS_SHWH -+ bool "Show whiteouts" -+ help -+ If you want to make the whiteouts in aufs visible, then enable -+ this option and specify 'shwh' mount option. Although it may -+ sounds like philosophy or something, but in technically it -+ simply shows the name of whiteout with keeping its behaviour. -+ -+config AUFS_BR_RAMFS -+ bool "Ramfs (initramfs/rootfs) as an aufs branch" -+ help -+ If you want to use ramfs as an aufs branch fs, then enable this -+ option. Generally tmpfs is recommended. -+ Aufs prohibited them to be a branch fs by default, because -+ initramfs becomes unusable after switch_root or something -+ generally. If you sets initramfs as an aufs branch and boot your -+ system by switch_root, you will meet a problem easily since the -+ files in initramfs may be inaccessible. -+ Unless you are going to use ramfs as an aufs branch fs without -+ switch_root or something, leave it N. -+ -+config AUFS_BR_FUSE -+ bool "Fuse fs as an aufs branch" -+ depends on FUSE_FS -+ select AUFS_POLL -+ help -+ If you want to use fuse-based userspace filesystem as an aufs -+ branch fs, then enable this option. -+ It implements the internal poll(2) operation which is -+ implemented by fuse only (curretnly). -+ -+config AUFS_POLL -+ bool -+ help -+ Automatic configuration for internal use. -+ -+config AUFS_BR_HFSPLUS -+ bool "Hfsplus as an aufs branch" -+ depends on HFSPLUS_FS -+ default y -+ help -+ If you want to use hfsplus fs as an aufs branch fs, then enable -+ this option. This option introduces a small overhead at -+ copying-up a file on hfsplus. -+ -+config AUFS_BDEV_LOOP -+ bool -+ depends on BLK_DEV_LOOP -+ default y -+ help -+ Automatic configuration for internal use. -+ Convert =[ym] into =y. -+ -+config AUFS_DEBUG -+ bool "Debug aufs" -+ help -+ Enable this to compile aufs internal debug code. -+ It will have a negative impact to the performance. -+ -+config AUFS_MAGIC_SYSRQ -+ bool -+ depends on AUFS_DEBUG && MAGIC_SYSRQ -+ default y -+ help -+ Automatic configuration for internal use. -+ When aufs supports Magic SysRq, enabled automatically. -+endif -diff --git a/fs/aufs/Makefile b/fs/aufs/Makefile -new file mode 100644 -index 000000000000..aa43f916b5ef ---- /dev/null -+++ b/fs/aufs/Makefile -@@ -0,0 +1,38 @@ -+# SPDX-License-Identifier: GPL-2.0 -+ -+include ${srctree}/${src}/magic.mk -+ -+# cf. include/linux/kernel.h -+# enable pr_debug -+ccflags-y += -DDEBUG -+# sparse requires the full pathname -+ccflags-y += -include ${srctree}/include/uapi/linux/aufs_type.h -+ -+obj-$(CONFIG_AUFS_FS) += aufs.o -+aufs-y := module.o sbinfo.o super.o branch.o xino.o sysaufs.o opts.o \ -+ wkq.o vfsub.o dcsub.o \ -+ cpup.o whout.o wbr_policy.o \ -+ dinfo.o dentry.o \ -+ dynop.o \ -+ finfo.o file.o f_op.o \ -+ dir.o vdir.o \ -+ iinfo.o inode.o i_op.o i_op_add.o i_op_del.o i_op_ren.o \ -+ mvdown.o ioctl.o -+ -+# all are boolean -+aufs-$(CONFIG_PROC_FS) += procfs.o plink.o -+aufs-$(CONFIG_SYSFS) += sysfs.o -+aufs-$(CONFIG_DEBUG_FS) += dbgaufs.o -+aufs-$(CONFIG_AUFS_BDEV_LOOP) += loop.o -+aufs-$(CONFIG_AUFS_HNOTIFY) += hnotify.o -+aufs-$(CONFIG_AUFS_HFSNOTIFY) += hfsnotify.o -+aufs-$(CONFIG_AUFS_EXPORT) += export.o -+aufs-$(CONFIG_AUFS_XATTR) += xattr.o -+aufs-$(CONFIG_FS_POSIX_ACL) += posix_acl.o -+aufs-$(CONFIG_AUFS_DIRREN) += dirren.o -+aufs-$(CONFIG_AUFS_FHSM) += fhsm.o -+aufs-$(CONFIG_AUFS_POLL) += poll.o -+aufs-$(CONFIG_AUFS_RDU) += rdu.o -+aufs-$(CONFIG_AUFS_BR_HFSPLUS) += hfsplus.o -+aufs-$(CONFIG_AUFS_DEBUG) += debug.o -+aufs-$(CONFIG_AUFS_MAGIC_SYSRQ) += sysrq.o -diff --git a/fs/aufs/aufs.h b/fs/aufs/aufs.h -new file mode 100644 -index 000000000000..73a0cae76784 ---- /dev/null -+++ b/fs/aufs/aufs.h -@@ -0,0 +1,48 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * all header files -+ */ -+ -+#ifndef __AUFS_H__ -+#define __AUFS_H__ -+ -+#ifdef __KERNEL__ -+ -+#define AuStub(type, name, body, ...) \ -+ static inline type name(__VA_ARGS__) { body; } -+ -+#define AuStubVoid(name, ...) \ -+ AuStub(void, name, , __VA_ARGS__) -+#define AuStubInt0(name, ...) \ -+ AuStub(int, name, return 0, __VA_ARGS__) -+ -+#include "debug.h" -+ -+#include "branch.h" -+#include "cpup.h" -+#include "dcsub.h" -+#include "dbgaufs.h" -+#include "dentry.h" -+#include "dir.h" -+#include "dirren.h" -+#include "dynop.h" -+#include "file.h" -+#include "fstype.h" -+#include "hbl.h" -+#include "inode.h" -+#include "loop.h" -+#include "module.h" -+#include "opts.h" -+#include "rwsem.h" -+#include "super.h" -+#include "sysaufs.h" -+#include "vfsub.h" -+#include "whout.h" -+#include "wkq.h" -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_H__ */ -diff --git a/fs/aufs/branch.c b/fs/aufs/branch.c -new file mode 100644 -index 000000000000..1027fce6a0ec ---- /dev/null -+++ b/fs/aufs/branch.c -@@ -0,0 +1,1420 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * branch management -+ */ -+ -+#include -+#include -+#include "aufs.h" -+ -+/* -+ * free a single branch -+ */ -+static void au_br_do_free(struct au_branch *br) -+{ -+ int i; -+ struct au_wbr *wbr; -+ struct au_dykey **key; -+ -+ au_hnotify_fin_br(br); -+ /* always, regardless the mount option */ -+ au_dr_hino_free(&br->br_dirren); -+ -+ if (br->br_xino.xi_file) -+ fput(br->br_xino.xi_file); -+ for (i = br->br_xino.xi_nondir.total - 1; i >= 0; i--) -+ AuDebugOn(br->br_xino.xi_nondir.array[i]); -+ kfree(br->br_xino.xi_nondir.array); -+ -+ AuDebugOn(au_br_count(br)); -+ au_br_count_fin(br); -+ -+ wbr = br->br_wbr; -+ if (wbr) { -+ for (i = 0; i < AuBrWh_Last; i++) -+ dput(wbr->wbr_wh[i]); -+ AuDebugOn(atomic_read(&wbr->wbr_wh_running)); -+ AuRwDestroy(&wbr->wbr_wh_rwsem); -+ } -+ -+ if (br->br_fhsm) { -+ au_br_fhsm_fin(br->br_fhsm); -+ kfree(br->br_fhsm); -+ } -+ -+ key = br->br_dykey; -+ for (i = 0; i < AuBrDynOp; i++, key++) -+ if (*key) -+ au_dy_put(*key); -+ else -+ break; -+ -+ /* recursive lock, s_umount of branch's */ -+ lockdep_off(); -+ path_put(&br->br_path); -+ lockdep_on(); -+ kfree(wbr); -+ kfree(br); -+} -+ -+/* -+ * frees all branches -+ */ -+void au_br_free(struct au_sbinfo *sbinfo) -+{ -+ aufs_bindex_t bmax; -+ struct au_branch **br; -+ -+ AuRwMustWriteLock(&sbinfo->si_rwsem); -+ -+ bmax = sbinfo->si_bbot + 1; -+ br = sbinfo->si_branch; -+ while (bmax--) -+ au_br_do_free(*br++); -+} -+ -+/* -+ * find the index of a branch which is specified by @br_id. -+ */ -+int au_br_index(struct super_block *sb, aufs_bindex_t br_id) -+{ -+ aufs_bindex_t bindex, bbot; -+ -+ bbot = au_sbbot(sb); -+ for (bindex = 0; bindex <= bbot; bindex++) -+ if (au_sbr_id(sb, bindex) == br_id) -+ return bindex; -+ return -1; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * add a branch -+ */ -+ -+static int test_overlap(struct super_block *sb, struct dentry *h_adding, -+ struct dentry *h_root) -+{ -+ if (unlikely(h_adding == h_root -+ || au_test_loopback_overlap(sb, h_adding))) -+ return 1; -+ if (h_adding->d_sb != h_root->d_sb) -+ return 0; -+ return au_test_subdir(h_adding, h_root) -+ || au_test_subdir(h_root, h_adding); -+} -+ -+/* -+ * returns a newly allocated branch. @new_nbranch is a number of branches -+ * after adding a branch. -+ */ -+static struct au_branch *au_br_alloc(struct super_block *sb, int new_nbranch, -+ int perm) -+{ -+ struct au_branch *add_branch; -+ struct dentry *root; -+ struct inode *inode; -+ int err; -+ -+ err = -ENOMEM; -+ add_branch = kzalloc(sizeof(*add_branch), GFP_NOFS); -+ if (unlikely(!add_branch)) -+ goto out; -+ add_branch->br_xino.xi_nondir.total = 8; /* initial size */ -+ add_branch->br_xino.xi_nondir.array -+ = kcalloc(add_branch->br_xino.xi_nondir.total, sizeof(ino_t), -+ GFP_NOFS); -+ if (unlikely(!add_branch->br_xino.xi_nondir.array)) -+ goto out_br; -+ -+ err = au_hnotify_init_br(add_branch, perm); -+ if (unlikely(err)) -+ goto out_xinondir; -+ -+ if (au_br_writable(perm)) { -+ /* may be freed separately at changing the branch permission */ -+ add_branch->br_wbr = kzalloc(sizeof(*add_branch->br_wbr), -+ GFP_NOFS); -+ if (unlikely(!add_branch->br_wbr)) -+ goto out_hnotify; -+ } -+ -+ if (au_br_fhsm(perm)) { -+ err = au_fhsm_br_alloc(add_branch); -+ if (unlikely(err)) -+ goto out_wbr; -+ } -+ -+ root = sb->s_root; -+ err = au_sbr_realloc(au_sbi(sb), new_nbranch, /*may_shrink*/0); -+ if (!err) -+ err = au_di_realloc(au_di(root), new_nbranch, /*may_shrink*/0); -+ if (!err) { -+ inode = d_inode(root); -+ err = au_hinode_realloc(au_ii(inode), new_nbranch, -+ /*may_shrink*/0); -+ } -+ if (!err) -+ return add_branch; /* success */ -+ -+out_wbr: -+ kfree(add_branch->br_wbr); -+out_hnotify: -+ au_hnotify_fin_br(add_branch); -+out_xinondir: -+ kfree(add_branch->br_xino.xi_nondir.array); -+out_br: -+ kfree(add_branch); -+out: -+ return ERR_PTR(err); -+} -+ -+/* -+ * test if the branch permission is legal or not. -+ */ -+static int test_br(struct inode *inode, int brperm, char *path) -+{ -+ int err; -+ -+ err = (au_br_writable(brperm) && IS_RDONLY(inode)); -+ if (!err) -+ goto out; -+ -+ err = -EINVAL; -+ pr_err("write permission for readonly mount or inode, %s\n", path); -+ -+out: -+ return err; -+} -+ -+/* -+ * returns: -+ * 0: success, the caller will add it -+ * plus: success, it is already unified, the caller should ignore it -+ * minus: error -+ */ -+static int test_add(struct super_block *sb, struct au_opt_add *add, int remount) -+{ -+ int err; -+ aufs_bindex_t bbot, bindex; -+ struct dentry *root, *h_dentry; -+ struct inode *inode, *h_inode; -+ -+ root = sb->s_root; -+ bbot = au_sbbot(sb); -+ if (unlikely(bbot >= 0 -+ && au_find_dbindex(root, add->path.dentry) >= 0)) { -+ err = 1; -+ if (!remount) { -+ err = -EINVAL; -+ pr_err("%s duplicated\n", add->pathname); -+ } -+ goto out; -+ } -+ -+ err = -ENOSPC; /* -E2BIG; */ -+ if (unlikely(AUFS_BRANCH_MAX <= add->bindex -+ || AUFS_BRANCH_MAX - 1 <= bbot)) { -+ pr_err("number of branches exceeded %s\n", add->pathname); -+ goto out; -+ } -+ -+ err = -EDOM; -+ if (unlikely(add->bindex < 0 || bbot + 1 < add->bindex)) { -+ pr_err("bad index %d\n", add->bindex); -+ goto out; -+ } -+ -+ inode = d_inode(add->path.dentry); -+ err = -ENOENT; -+ if (unlikely(!inode->i_nlink)) { -+ pr_err("no existence %s\n", add->pathname); -+ goto out; -+ } -+ -+ err = -EINVAL; -+ if (unlikely(inode->i_sb == sb)) { -+ pr_err("%s must be outside\n", add->pathname); -+ goto out; -+ } -+ -+ if (unlikely(au_test_fs_unsuppoted(inode->i_sb))) { -+ pr_err("unsupported filesystem, %s (%s)\n", -+ add->pathname, au_sbtype(inode->i_sb)); -+ goto out; -+ } -+ -+ if (unlikely(inode->i_sb->s_stack_depth)) { -+ pr_err("already stacked, %s (%s)\n", -+ add->pathname, au_sbtype(inode->i_sb)); -+ goto out; -+ } -+ -+ err = test_br(d_inode(add->path.dentry), add->perm, add->pathname); -+ if (unlikely(err)) -+ goto out; -+ -+ if (bbot < 0) -+ return 0; /* success */ -+ -+ err = -EINVAL; -+ for (bindex = 0; bindex <= bbot; bindex++) -+ if (unlikely(test_overlap(sb, add->path.dentry, -+ au_h_dptr(root, bindex)))) { -+ pr_err("%s is overlapped\n", add->pathname); -+ goto out; -+ } -+ -+ err = 0; -+ if (au_opt_test(au_mntflags(sb), WARN_PERM)) { -+ h_dentry = au_h_dptr(root, 0); -+ h_inode = d_inode(h_dentry); -+ if ((h_inode->i_mode & S_IALLUGO) != (inode->i_mode & S_IALLUGO) -+ || !uid_eq(h_inode->i_uid, inode->i_uid) -+ || !gid_eq(h_inode->i_gid, inode->i_gid)) -+ pr_warn("uid/gid/perm %s %u/%u/0%o, %u/%u/0%o\n", -+ add->pathname, -+ i_uid_read(inode), i_gid_read(inode), -+ (inode->i_mode & S_IALLUGO), -+ i_uid_read(h_inode), i_gid_read(h_inode), -+ (h_inode->i_mode & S_IALLUGO)); -+ } -+ -+out: -+ return err; -+} -+ -+/* -+ * initialize or clean the whiteouts for an adding branch -+ */ -+static int au_br_init_wh(struct super_block *sb, struct au_branch *br, -+ int new_perm) -+{ -+ int err, old_perm; -+ aufs_bindex_t bindex; -+ struct inode *h_inode; -+ struct au_wbr *wbr; -+ struct au_hinode *hdir; -+ struct dentry *h_dentry; -+ -+ err = vfsub_mnt_want_write(au_br_mnt(br)); -+ if (unlikely(err)) -+ goto out; -+ -+ wbr = br->br_wbr; -+ old_perm = br->br_perm; -+ br->br_perm = new_perm; -+ hdir = NULL; -+ h_inode = NULL; -+ bindex = au_br_index(sb, br->br_id); -+ if (0 <= bindex) { -+ hdir = au_hi(d_inode(sb->s_root), bindex); -+ au_hn_inode_lock_nested(hdir, AuLsc_I_PARENT); -+ } else { -+ h_dentry = au_br_dentry(br); -+ h_inode = d_inode(h_dentry); -+ inode_lock_nested(h_inode, AuLsc_I_PARENT); -+ } -+ if (!wbr) -+ err = au_wh_init(br, sb); -+ else { -+ wbr_wh_write_lock(wbr); -+ err = au_wh_init(br, sb); -+ wbr_wh_write_unlock(wbr); -+ } -+ if (hdir) -+ au_hn_inode_unlock(hdir); -+ else -+ inode_unlock(h_inode); -+ vfsub_mnt_drop_write(au_br_mnt(br)); -+ br->br_perm = old_perm; -+ -+ if (!err && wbr && !au_br_writable(new_perm)) { -+ kfree(wbr); -+ br->br_wbr = NULL; -+ } -+ -+out: -+ return err; -+} -+ -+static int au_wbr_init(struct au_branch *br, struct super_block *sb, -+ int perm) -+{ -+ int err; -+ struct kstatfs kst; -+ struct au_wbr *wbr; -+ -+ wbr = br->br_wbr; -+ au_rw_init(&wbr->wbr_wh_rwsem); -+ atomic_set(&wbr->wbr_wh_running, 0); -+ -+ /* -+ * a limit for rmdir/rename a dir -+ * cf. AUFS_MAX_NAMELEN in include/uapi/linux/aufs_type.h -+ */ -+ err = vfs_statfs(&br->br_path, &kst); -+ if (unlikely(err)) -+ goto out; -+ err = -EINVAL; -+ if (kst.f_namelen >= NAME_MAX) -+ err = au_br_init_wh(sb, br, perm); -+ else -+ pr_err("%pd(%s), unsupported namelen %ld\n", -+ au_br_dentry(br), -+ au_sbtype(au_br_dentry(br)->d_sb), kst.f_namelen); -+ -+out: -+ return err; -+} -+ -+/* initialize a new branch */ -+static int au_br_init(struct au_branch *br, struct super_block *sb, -+ struct au_opt_add *add) -+{ -+ int err; -+ struct inode *h_inode; -+ -+ err = 0; -+ spin_lock_init(&br->br_xino.xi_nondir.spin); -+ init_waitqueue_head(&br->br_xino.xi_nondir.wqh); -+ br->br_perm = add->perm; -+ br->br_path = add->path; /* set first, path_get() later */ -+ spin_lock_init(&br->br_dykey_lock); -+ au_br_count_init(br); -+ atomic_set(&br->br_xino_running, 0); -+ br->br_id = au_new_br_id(sb); -+ AuDebugOn(br->br_id < 0); -+ -+ /* always, regardless the given option */ -+ err = au_dr_br_init(sb, br, &add->path); -+ if (unlikely(err)) -+ goto out_err; -+ -+ if (au_br_writable(add->perm)) { -+ err = au_wbr_init(br, sb, add->perm); -+ if (unlikely(err)) -+ goto out_err; -+ } -+ -+ if (au_opt_test(au_mntflags(sb), XINO)) { -+ h_inode = d_inode(add->path.dentry); -+ err = au_xino_br(sb, br, h_inode->i_ino, -+ au_sbr(sb, 0)->br_xino.xi_file, /*do_test*/1); -+ if (unlikely(err)) { -+ AuDebugOn(br->br_xino.xi_file); -+ goto out_err; -+ } -+ } -+ -+ sysaufs_br_init(br); -+ path_get(&br->br_path); -+ goto out; /* success */ -+ -+out_err: -+ memset(&br->br_path, 0, sizeof(br->br_path)); -+out: -+ return err; -+} -+ -+static void au_br_do_add_brp(struct au_sbinfo *sbinfo, aufs_bindex_t bindex, -+ struct au_branch *br, aufs_bindex_t bbot, -+ aufs_bindex_t amount) -+{ -+ struct au_branch **brp; -+ -+ AuRwMustWriteLock(&sbinfo->si_rwsem); -+ -+ brp = sbinfo->si_branch + bindex; -+ memmove(brp + 1, brp, sizeof(*brp) * amount); -+ *brp = br; -+ sbinfo->si_bbot++; -+ if (unlikely(bbot < 0)) -+ sbinfo->si_bbot = 0; -+} -+ -+static void au_br_do_add_hdp(struct au_dinfo *dinfo, aufs_bindex_t bindex, -+ aufs_bindex_t bbot, aufs_bindex_t amount) -+{ -+ struct au_hdentry *hdp; -+ -+ AuRwMustWriteLock(&dinfo->di_rwsem); -+ -+ hdp = au_hdentry(dinfo, bindex); -+ memmove(hdp + 1, hdp, sizeof(*hdp) * amount); -+ au_h_dentry_init(hdp); -+ dinfo->di_bbot++; -+ if (unlikely(bbot < 0)) -+ dinfo->di_btop = 0; -+} -+ -+static void au_br_do_add_hip(struct au_iinfo *iinfo, aufs_bindex_t bindex, -+ aufs_bindex_t bbot, aufs_bindex_t amount) -+{ -+ struct au_hinode *hip; -+ -+ AuRwMustWriteLock(&iinfo->ii_rwsem); -+ -+ hip = au_hinode(iinfo, bindex); -+ memmove(hip + 1, hip, sizeof(*hip) * amount); -+ au_hinode_init(hip); -+ iinfo->ii_bbot++; -+ if (unlikely(bbot < 0)) -+ iinfo->ii_btop = 0; -+} -+ -+static void au_br_do_add(struct super_block *sb, struct au_branch *br, -+ aufs_bindex_t bindex) -+{ -+ struct dentry *root, *h_dentry; -+ struct inode *root_inode, *h_inode; -+ aufs_bindex_t bbot, amount; -+ -+ root = sb->s_root; -+ root_inode = d_inode(root); -+ bbot = au_sbbot(sb); -+ amount = bbot + 1 - bindex; -+ h_dentry = au_br_dentry(br); -+ au_sbilist_lock(); -+ au_br_do_add_brp(au_sbi(sb), bindex, br, bbot, amount); -+ au_br_do_add_hdp(au_di(root), bindex, bbot, amount); -+ au_br_do_add_hip(au_ii(root_inode), bindex, bbot, amount); -+ au_set_h_dptr(root, bindex, dget(h_dentry)); -+ h_inode = d_inode(h_dentry); -+ au_set_h_iptr(root_inode, bindex, au_igrab(h_inode), /*flags*/0); -+ au_sbilist_unlock(); -+} -+ -+int au_br_add(struct super_block *sb, struct au_opt_add *add, int remount) -+{ -+ int err; -+ aufs_bindex_t bbot, add_bindex; -+ struct dentry *root, *h_dentry; -+ struct inode *root_inode; -+ struct au_branch *add_branch; -+ -+ root = sb->s_root; -+ root_inode = d_inode(root); -+ IMustLock(root_inode); -+ IiMustWriteLock(root_inode); -+ err = test_add(sb, add, remount); -+ if (unlikely(err < 0)) -+ goto out; -+ if (err) { -+ err = 0; -+ goto out; /* success */ -+ } -+ -+ bbot = au_sbbot(sb); -+ add_branch = au_br_alloc(sb, bbot + 2, add->perm); -+ err = PTR_ERR(add_branch); -+ if (IS_ERR(add_branch)) -+ goto out; -+ -+ err = au_br_init(add_branch, sb, add); -+ if (unlikely(err)) { -+ au_br_do_free(add_branch); -+ goto out; -+ } -+ -+ add_bindex = add->bindex; -+ if (!remount) -+ au_br_do_add(sb, add_branch, add_bindex); -+ else { -+ sysaufs_brs_del(sb, add_bindex); -+ au_br_do_add(sb, add_branch, add_bindex); -+ sysaufs_brs_add(sb, add_bindex); -+ } -+ -+ h_dentry = add->path.dentry; -+ if (!add_bindex) { -+ au_cpup_attr_all(root_inode, /*force*/1); -+ sb->s_maxbytes = h_dentry->d_sb->s_maxbytes; -+ } else -+ au_add_nlink(root_inode, d_inode(h_dentry)); -+ -+ /* -+ * this test/set prevents aufs from handling unnecesary notify events -+ * of xino files, in case of re-adding a writable branch which was -+ * once detached from aufs. -+ */ -+ if (au_xino_brid(sb) < 0 -+ && au_br_writable(add_branch->br_perm) -+ && !au_test_fs_bad_xino(h_dentry->d_sb) -+ && add_branch->br_xino.xi_file -+ && add_branch->br_xino.xi_file->f_path.dentry->d_parent == h_dentry) -+ au_xino_brid_set(sb, add_branch->br_id); -+ -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static unsigned long long au_farray_cb(struct super_block *sb, void *a, -+ unsigned long long max __maybe_unused, -+ void *arg) -+{ -+ unsigned long long n; -+ struct file **p, *f; -+ struct hlist_bl_head *files; -+ struct hlist_bl_node *pos; -+ struct au_finfo *finfo; -+ -+ n = 0; -+ p = a; -+ files = &au_sbi(sb)->si_files; -+ hlist_bl_lock(files); -+ hlist_bl_for_each_entry(finfo, pos, files, fi_hlist) { -+ f = finfo->fi_file; -+ if (file_count(f) -+ && !special_file(file_inode(f)->i_mode)) { -+ get_file(f); -+ *p++ = f; -+ n++; -+ AuDebugOn(n > max); -+ } -+ } -+ hlist_bl_unlock(files); -+ -+ return n; -+} -+ -+static struct file **au_farray_alloc(struct super_block *sb, -+ unsigned long long *max) -+{ -+ *max = au_nfiles(sb); -+ return au_array_alloc(max, au_farray_cb, sb, /*arg*/NULL); -+} -+ -+static void au_farray_free(struct file **a, unsigned long long max) -+{ -+ unsigned long long ull; -+ -+ for (ull = 0; ull < max; ull++) -+ if (a[ull]) -+ fput(a[ull]); -+ kvfree(a); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * delete a branch -+ */ -+ -+/* to show the line number, do not make it inlined function */ -+#define AuVerbose(do_info, fmt, ...) do { \ -+ if (do_info) \ -+ pr_info(fmt, ##__VA_ARGS__); \ -+} while (0) -+ -+static int au_test_ibusy(struct inode *inode, aufs_bindex_t btop, -+ aufs_bindex_t bbot) -+{ -+ return (inode && !S_ISDIR(inode->i_mode)) || btop == bbot; -+} -+ -+static int au_test_dbusy(struct dentry *dentry, aufs_bindex_t btop, -+ aufs_bindex_t bbot) -+{ -+ return au_test_ibusy(d_inode(dentry), btop, bbot); -+} -+ -+/* -+ * test if the branch is deletable or not. -+ */ -+static int test_dentry_busy(struct dentry *root, aufs_bindex_t bindex, -+ unsigned int sigen, const unsigned int verbose) -+{ -+ int err, i, j, ndentry; -+ aufs_bindex_t btop, bbot; -+ struct au_dcsub_pages dpages; -+ struct au_dpage *dpage; -+ struct dentry *d; -+ -+ err = au_dpages_init(&dpages, GFP_NOFS); -+ if (unlikely(err)) -+ goto out; -+ err = au_dcsub_pages(&dpages, root, NULL, NULL); -+ if (unlikely(err)) -+ goto out_dpages; -+ -+ for (i = 0; !err && i < dpages.ndpage; i++) { -+ dpage = dpages.dpages + i; -+ ndentry = dpage->ndentry; -+ for (j = 0; !err && j < ndentry; j++) { -+ d = dpage->dentries[j]; -+ AuDebugOn(au_dcount(d) <= 0); -+ if (!au_digen_test(d, sigen)) { -+ di_read_lock_child(d, AuLock_IR); -+ if (unlikely(au_dbrange_test(d))) { -+ di_read_unlock(d, AuLock_IR); -+ continue; -+ } -+ } else { -+ di_write_lock_child(d); -+ if (unlikely(au_dbrange_test(d))) { -+ di_write_unlock(d); -+ continue; -+ } -+ err = au_reval_dpath(d, sigen); -+ if (!err) -+ di_downgrade_lock(d, AuLock_IR); -+ else { -+ di_write_unlock(d); -+ break; -+ } -+ } -+ -+ /* AuDbgDentry(d); */ -+ btop = au_dbtop(d); -+ bbot = au_dbbot(d); -+ if (btop <= bindex -+ && bindex <= bbot -+ && au_h_dptr(d, bindex) -+ && au_test_dbusy(d, btop, bbot)) { -+ err = -EBUSY; -+ AuVerbose(verbose, "busy %pd\n", d); -+ AuDbgDentry(d); -+ } -+ di_read_unlock(d, AuLock_IR); -+ } -+ } -+ -+out_dpages: -+ au_dpages_free(&dpages); -+out: -+ return err; -+} -+ -+static int test_inode_busy(struct super_block *sb, aufs_bindex_t bindex, -+ unsigned int sigen, const unsigned int verbose) -+{ -+ int err; -+ unsigned long long max, ull; -+ struct inode *i, **array; -+ aufs_bindex_t btop, bbot; -+ -+ array = au_iarray_alloc(sb, &max); -+ err = PTR_ERR(array); -+ if (IS_ERR(array)) -+ goto out; -+ -+ err = 0; -+ AuDbg("b%d\n", bindex); -+ for (ull = 0; !err && ull < max; ull++) { -+ i = array[ull]; -+ if (unlikely(!i)) -+ break; -+ if (i->i_ino == AUFS_ROOT_INO) -+ continue; -+ -+ /* AuDbgInode(i); */ -+ if (au_iigen(i, NULL) == sigen) -+ ii_read_lock_child(i); -+ else { -+ ii_write_lock_child(i); -+ err = au_refresh_hinode_self(i); -+ au_iigen_dec(i); -+ if (!err) -+ ii_downgrade_lock(i); -+ else { -+ ii_write_unlock(i); -+ break; -+ } -+ } -+ -+ btop = au_ibtop(i); -+ bbot = au_ibbot(i); -+ if (btop <= bindex -+ && bindex <= bbot -+ && au_h_iptr(i, bindex) -+ && au_test_ibusy(i, btop, bbot)) { -+ err = -EBUSY; -+ AuVerbose(verbose, "busy i%lu\n", i->i_ino); -+ AuDbgInode(i); -+ } -+ ii_read_unlock(i); -+ } -+ au_iarray_free(array, max); -+ -+out: -+ return err; -+} -+ -+static int test_children_busy(struct dentry *root, aufs_bindex_t bindex, -+ const unsigned int verbose) -+{ -+ int err; -+ unsigned int sigen; -+ -+ sigen = au_sigen(root->d_sb); -+ DiMustNoWaiters(root); -+ IiMustNoWaiters(d_inode(root)); -+ di_write_unlock(root); -+ err = test_dentry_busy(root, bindex, sigen, verbose); -+ if (!err) -+ err = test_inode_busy(root->d_sb, bindex, sigen, verbose); -+ di_write_lock_child(root); /* aufs_write_lock() calls ..._child() */ -+ -+ return err; -+} -+ -+static int test_dir_busy(struct file *file, aufs_bindex_t br_id, -+ struct file **to_free, int *idx) -+{ -+ int err; -+ unsigned char matched, root; -+ aufs_bindex_t bindex, bbot; -+ struct au_fidir *fidir; -+ struct au_hfile *hfile; -+ -+ err = 0; -+ root = IS_ROOT(file->f_path.dentry); -+ if (root) { -+ get_file(file); -+ to_free[*idx] = file; -+ (*idx)++; -+ goto out; -+ } -+ -+ matched = 0; -+ fidir = au_fi(file)->fi_hdir; -+ AuDebugOn(!fidir); -+ bbot = au_fbbot_dir(file); -+ for (bindex = au_fbtop(file); bindex <= bbot; bindex++) { -+ hfile = fidir->fd_hfile + bindex; -+ if (!hfile->hf_file) -+ continue; -+ -+ if (hfile->hf_br->br_id == br_id) { -+ matched = 1; -+ break; -+ } -+ } -+ if (matched) -+ err = -EBUSY; -+ -+out: -+ return err; -+} -+ -+static int test_file_busy(struct super_block *sb, aufs_bindex_t br_id, -+ struct file **to_free, int opened) -+{ -+ int err, idx; -+ unsigned long long ull, max; -+ aufs_bindex_t btop; -+ struct file *file, **array; -+ struct dentry *root; -+ struct au_hfile *hfile; -+ -+ array = au_farray_alloc(sb, &max); -+ err = PTR_ERR(array); -+ if (IS_ERR(array)) -+ goto out; -+ -+ err = 0; -+ idx = 0; -+ root = sb->s_root; -+ di_write_unlock(root); -+ for (ull = 0; ull < max; ull++) { -+ file = array[ull]; -+ if (unlikely(!file)) -+ break; -+ -+ /* AuDbg("%pD\n", file); */ -+ fi_read_lock(file); -+ btop = au_fbtop(file); -+ if (!d_is_dir(file->f_path.dentry)) { -+ hfile = &au_fi(file)->fi_htop; -+ if (hfile->hf_br->br_id == br_id) -+ err = -EBUSY; -+ } else -+ err = test_dir_busy(file, br_id, to_free, &idx); -+ fi_read_unlock(file); -+ if (unlikely(err)) -+ break; -+ } -+ di_write_lock_child(root); -+ au_farray_free(array, max); -+ AuDebugOn(idx > opened); -+ -+out: -+ return err; -+} -+ -+static void br_del_file(struct file **to_free, unsigned long long opened, -+ aufs_bindex_t br_id) -+{ -+ unsigned long long ull; -+ aufs_bindex_t bindex, btop, bbot, bfound; -+ struct file *file; -+ struct au_fidir *fidir; -+ struct au_hfile *hfile; -+ -+ for (ull = 0; ull < opened; ull++) { -+ file = to_free[ull]; -+ if (unlikely(!file)) -+ break; -+ -+ /* AuDbg("%pD\n", file); */ -+ AuDebugOn(!d_is_dir(file->f_path.dentry)); -+ bfound = -1; -+ fidir = au_fi(file)->fi_hdir; -+ AuDebugOn(!fidir); -+ fi_write_lock(file); -+ btop = au_fbtop(file); -+ bbot = au_fbbot_dir(file); -+ for (bindex = btop; bindex <= bbot; bindex++) { -+ hfile = fidir->fd_hfile + bindex; -+ if (!hfile->hf_file) -+ continue; -+ -+ if (hfile->hf_br->br_id == br_id) { -+ bfound = bindex; -+ break; -+ } -+ } -+ AuDebugOn(bfound < 0); -+ au_set_h_fptr(file, bfound, NULL); -+ if (bfound == btop) { -+ for (btop++; btop <= bbot; btop++) -+ if (au_hf_dir(file, btop)) { -+ au_set_fbtop(file, btop); -+ break; -+ } -+ } -+ fi_write_unlock(file); -+ } -+} -+ -+static void au_br_do_del_brp(struct au_sbinfo *sbinfo, -+ const aufs_bindex_t bindex, -+ const aufs_bindex_t bbot) -+{ -+ struct au_branch **brp, **p; -+ -+ AuRwMustWriteLock(&sbinfo->si_rwsem); -+ -+ brp = sbinfo->si_branch + bindex; -+ if (bindex < bbot) -+ memmove(brp, brp + 1, sizeof(*brp) * (bbot - bindex)); -+ sbinfo->si_branch[0 + bbot] = NULL; -+ sbinfo->si_bbot--; -+ -+ p = au_krealloc(sbinfo->si_branch, sizeof(*p) * bbot, AuGFP_SBILIST, -+ /*may_shrink*/1); -+ if (p) -+ sbinfo->si_branch = p; -+ /* harmless error */ -+} -+ -+static void au_br_do_del_hdp(struct au_dinfo *dinfo, const aufs_bindex_t bindex, -+ const aufs_bindex_t bbot) -+{ -+ struct au_hdentry *hdp, *p; -+ -+ AuRwMustWriteLock(&dinfo->di_rwsem); -+ -+ hdp = au_hdentry(dinfo, bindex); -+ if (bindex < bbot) -+ memmove(hdp, hdp + 1, sizeof(*hdp) * (bbot - bindex)); -+ /* au_h_dentry_init(au_hdentry(dinfo, bbot); */ -+ dinfo->di_bbot--; -+ -+ p = au_krealloc(dinfo->di_hdentry, sizeof(*p) * bbot, AuGFP_SBILIST, -+ /*may_shrink*/1); -+ if (p) -+ dinfo->di_hdentry = p; -+ /* harmless error */ -+} -+ -+static void au_br_do_del_hip(struct au_iinfo *iinfo, const aufs_bindex_t bindex, -+ const aufs_bindex_t bbot) -+{ -+ struct au_hinode *hip, *p; -+ -+ AuRwMustWriteLock(&iinfo->ii_rwsem); -+ -+ hip = au_hinode(iinfo, bindex); -+ if (bindex < bbot) -+ memmove(hip, hip + 1, sizeof(*hip) * (bbot - bindex)); -+ /* au_hinode_init(au_hinode(iinfo, bbot)); */ -+ iinfo->ii_bbot--; -+ -+ p = au_krealloc(iinfo->ii_hinode, sizeof(*p) * bbot, AuGFP_SBILIST, -+ /*may_shrink*/1); -+ if (p) -+ iinfo->ii_hinode = p; -+ /* harmless error */ -+} -+ -+static void au_br_do_del(struct super_block *sb, aufs_bindex_t bindex, -+ struct au_branch *br) -+{ -+ aufs_bindex_t bbot; -+ struct au_sbinfo *sbinfo; -+ struct dentry *root, *h_root; -+ struct inode *inode, *h_inode; -+ struct au_hinode *hinode; -+ -+ SiMustWriteLock(sb); -+ -+ root = sb->s_root; -+ inode = d_inode(root); -+ sbinfo = au_sbi(sb); -+ bbot = sbinfo->si_bbot; -+ -+ h_root = au_h_dptr(root, bindex); -+ hinode = au_hi(inode, bindex); -+ h_inode = au_igrab(hinode->hi_inode); -+ au_hiput(hinode); -+ -+ au_sbilist_lock(); -+ au_br_do_del_brp(sbinfo, bindex, bbot); -+ au_br_do_del_hdp(au_di(root), bindex, bbot); -+ au_br_do_del_hip(au_ii(inode), bindex, bbot); -+ au_sbilist_unlock(); -+ -+ /* ignore an error */ -+ au_dr_br_fin(sb, br); /* always, regardless the mount option */ -+ -+ dput(h_root); -+ iput(h_inode); -+ au_br_do_free(br); -+} -+ -+static unsigned long long empty_cb(struct super_block *sb, void *array, -+ unsigned long long max, void *arg) -+{ -+ return max; -+} -+ -+int au_br_del(struct super_block *sb, struct au_opt_del *del, int remount) -+{ -+ int err, rerr, i; -+ unsigned long long opened; -+ unsigned int mnt_flags; -+ aufs_bindex_t bindex, bbot, br_id; -+ unsigned char do_wh, verbose; -+ struct au_branch *br; -+ struct au_wbr *wbr; -+ struct dentry *root; -+ struct file **to_free; -+ -+ err = 0; -+ opened = 0; -+ to_free = NULL; -+ root = sb->s_root; -+ bindex = au_find_dbindex(root, del->h_path.dentry); -+ if (bindex < 0) { -+ if (remount) -+ goto out; /* success */ -+ err = -ENOENT; -+ pr_err("%s no such branch\n", del->pathname); -+ goto out; -+ } -+ AuDbg("bindex b%d\n", bindex); -+ -+ err = -EBUSY; -+ mnt_flags = au_mntflags(sb); -+ verbose = !!au_opt_test(mnt_flags, VERBOSE); -+ bbot = au_sbbot(sb); -+ if (unlikely(!bbot)) { -+ AuVerbose(verbose, "no more branches left\n"); -+ goto out; -+ } -+ br = au_sbr(sb, bindex); -+ AuDebugOn(!path_equal(&br->br_path, &del->h_path)); -+ -+ br_id = br->br_id; -+ opened = au_br_count(br); -+ if (unlikely(opened)) { -+ to_free = au_array_alloc(&opened, empty_cb, sb, NULL); -+ err = PTR_ERR(to_free); -+ if (IS_ERR(to_free)) -+ goto out; -+ -+ err = test_file_busy(sb, br_id, to_free, opened); -+ if (unlikely(err)) { -+ AuVerbose(verbose, "%llu file(s) opened\n", opened); -+ goto out; -+ } -+ } -+ -+ wbr = br->br_wbr; -+ do_wh = wbr && (wbr->wbr_whbase || wbr->wbr_plink || wbr->wbr_orph); -+ if (do_wh) { -+ /* instead of WbrWhMustWriteLock(wbr) */ -+ SiMustWriteLock(sb); -+ for (i = 0; i < AuBrWh_Last; i++) { -+ dput(wbr->wbr_wh[i]); -+ wbr->wbr_wh[i] = NULL; -+ } -+ } -+ -+ err = test_children_busy(root, bindex, verbose); -+ if (unlikely(err)) { -+ if (do_wh) -+ goto out_wh; -+ goto out; -+ } -+ -+ err = 0; -+ if (to_free) { -+ /* -+ * now we confirmed the branch is deletable. -+ * let's free the remaining opened dirs on the branch. -+ */ -+ di_write_unlock(root); -+ br_del_file(to_free, opened, br_id); -+ di_write_lock_child(root); -+ } -+ -+ if (!remount) -+ au_br_do_del(sb, bindex, br); -+ else { -+ sysaufs_brs_del(sb, bindex); -+ au_br_do_del(sb, bindex, br); -+ sysaufs_brs_add(sb, bindex); -+ } -+ -+ if (!bindex) { -+ au_cpup_attr_all(d_inode(root), /*force*/1); -+ sb->s_maxbytes = au_sbr_sb(sb, 0)->s_maxbytes; -+ } else -+ au_sub_nlink(d_inode(root), d_inode(del->h_path.dentry)); -+ if (au_opt_test(mnt_flags, PLINK)) -+ au_plink_half_refresh(sb, br_id); -+ -+ if (au_xino_brid(sb) == br_id) -+ au_xino_brid_set(sb, -1); -+ goto out; /* success */ -+ -+out_wh: -+ /* revert */ -+ rerr = au_br_init_wh(sb, br, br->br_perm); -+ if (rerr) -+ pr_warn("failed re-creating base whiteout, %s. (%d)\n", -+ del->pathname, rerr); -+out: -+ if (to_free) -+ au_farray_free(to_free, opened); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_ibusy(struct super_block *sb, struct aufs_ibusy __user *arg) -+{ -+ int err; -+ aufs_bindex_t btop, bbot; -+ struct aufs_ibusy ibusy; -+ struct inode *inode, *h_inode; -+ -+ err = -EPERM; -+ if (unlikely(!capable(CAP_SYS_ADMIN))) -+ goto out; -+ -+ err = copy_from_user(&ibusy, arg, sizeof(ibusy)); -+ if (!err) -+ err = !access_ok(VERIFY_WRITE, &arg->h_ino, sizeof(arg->h_ino)); -+ if (unlikely(err)) { -+ err = -EFAULT; -+ AuTraceErr(err); -+ goto out; -+ } -+ -+ err = -EINVAL; -+ si_read_lock(sb, AuLock_FLUSH); -+ if (unlikely(ibusy.bindex < 0 || ibusy.bindex > au_sbbot(sb))) -+ goto out_unlock; -+ -+ err = 0; -+ ibusy.h_ino = 0; /* invalid */ -+ inode = ilookup(sb, ibusy.ino); -+ if (!inode -+ || inode->i_ino == AUFS_ROOT_INO -+ || au_is_bad_inode(inode)) -+ goto out_unlock; -+ -+ ii_read_lock_child(inode); -+ btop = au_ibtop(inode); -+ bbot = au_ibbot(inode); -+ if (btop <= ibusy.bindex && ibusy.bindex <= bbot) { -+ h_inode = au_h_iptr(inode, ibusy.bindex); -+ if (h_inode && au_test_ibusy(inode, btop, bbot)) -+ ibusy.h_ino = h_inode->i_ino; -+ } -+ ii_read_unlock(inode); -+ iput(inode); -+ -+out_unlock: -+ si_read_unlock(sb); -+ if (!err) { -+ err = __put_user(ibusy.h_ino, &arg->h_ino); -+ if (unlikely(err)) { -+ err = -EFAULT; -+ AuTraceErr(err); -+ } -+ } -+out: -+ return err; -+} -+ -+long au_ibusy_ioctl(struct file *file, unsigned long arg) -+{ -+ return au_ibusy(file->f_path.dentry->d_sb, (void __user *)arg); -+} -+ -+#ifdef CONFIG_COMPAT -+long au_ibusy_compat_ioctl(struct file *file, unsigned long arg) -+{ -+ return au_ibusy(file->f_path.dentry->d_sb, compat_ptr(arg)); -+} -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * change a branch permission -+ */ -+ -+static void au_warn_ima(void) -+{ -+#ifdef CONFIG_IMA -+ /* since it doesn't support mark_files_ro() */ -+ AuWarn1("RW -> RO makes IMA to produce wrong message\n"); -+#endif -+} -+ -+static int do_need_sigen_inc(int a, int b) -+{ -+ return au_br_whable(a) && !au_br_whable(b); -+} -+ -+static int need_sigen_inc(int old, int new) -+{ -+ return do_need_sigen_inc(old, new) -+ || do_need_sigen_inc(new, old); -+} -+ -+static int au_br_mod_files_ro(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ int err, do_warn; -+ unsigned int mnt_flags; -+ unsigned long long ull, max; -+ aufs_bindex_t br_id; -+ unsigned char verbose, writer; -+ struct file *file, *hf, **array; -+ struct au_hfile *hfile; -+ -+ mnt_flags = au_mntflags(sb); -+ verbose = !!au_opt_test(mnt_flags, VERBOSE); -+ -+ array = au_farray_alloc(sb, &max); -+ err = PTR_ERR(array); -+ if (IS_ERR(array)) -+ goto out; -+ -+ do_warn = 0; -+ br_id = au_sbr_id(sb, bindex); -+ for (ull = 0; ull < max; ull++) { -+ file = array[ull]; -+ if (unlikely(!file)) -+ break; -+ -+ /* AuDbg("%pD\n", file); */ -+ fi_read_lock(file); -+ if (unlikely(au_test_mmapped(file))) { -+ err = -EBUSY; -+ AuVerbose(verbose, "mmapped %pD\n", file); -+ AuDbgFile(file); -+ FiMustNoWaiters(file); -+ fi_read_unlock(file); -+ goto out_array; -+ } -+ -+ hfile = &au_fi(file)->fi_htop; -+ hf = hfile->hf_file; -+ if (!d_is_reg(file->f_path.dentry) -+ || !(file->f_mode & FMODE_WRITE) -+ || hfile->hf_br->br_id != br_id -+ || !(hf->f_mode & FMODE_WRITE)) -+ array[ull] = NULL; -+ else { -+ do_warn = 1; -+ get_file(file); -+ } -+ -+ FiMustNoWaiters(file); -+ fi_read_unlock(file); -+ fput(file); -+ } -+ -+ err = 0; -+ if (do_warn) -+ au_warn_ima(); -+ -+ for (ull = 0; ull < max; ull++) { -+ file = array[ull]; -+ if (!file) -+ continue; -+ -+ /* todo: already flushed? */ -+ /* -+ * fs/super.c:mark_files_ro() is gone, but aufs keeps its -+ * approach which resets f_mode and calls mnt_drop_write() and -+ * file_release_write() for each file, because the branch -+ * attribute in aufs world is totally different from the native -+ * fs rw/ro mode. -+ */ -+ /* fi_read_lock(file); */ -+ hfile = &au_fi(file)->fi_htop; -+ hf = hfile->hf_file; -+ /* fi_read_unlock(file); */ -+ spin_lock(&hf->f_lock); -+ writer = !!(hf->f_mode & FMODE_WRITER); -+ hf->f_mode &= ~(FMODE_WRITE | FMODE_WRITER); -+ spin_unlock(&hf->f_lock); -+ if (writer) { -+ put_write_access(file_inode(hf)); -+ __mnt_drop_write(hf->f_path.mnt); -+ } -+ } -+ -+out_array: -+ au_farray_free(array, max); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+int au_br_mod(struct super_block *sb, struct au_opt_mod *mod, int remount, -+ int *do_refresh) -+{ -+ int err, rerr; -+ aufs_bindex_t bindex; -+ struct dentry *root; -+ struct au_branch *br; -+ struct au_br_fhsm *bf; -+ -+ root = sb->s_root; -+ bindex = au_find_dbindex(root, mod->h_root); -+ if (bindex < 0) { -+ if (remount) -+ return 0; /* success */ -+ err = -ENOENT; -+ pr_err("%s no such branch\n", mod->path); -+ goto out; -+ } -+ AuDbg("bindex b%d\n", bindex); -+ -+ err = test_br(d_inode(mod->h_root), mod->perm, mod->path); -+ if (unlikely(err)) -+ goto out; -+ -+ br = au_sbr(sb, bindex); -+ AuDebugOn(mod->h_root != au_br_dentry(br)); -+ if (br->br_perm == mod->perm) -+ return 0; /* success */ -+ -+ /* pre-allocate for non-fhsm --> fhsm */ -+ bf = NULL; -+ if (!au_br_fhsm(br->br_perm) && au_br_fhsm(mod->perm)) { -+ err = au_fhsm_br_alloc(br); -+ if (unlikely(err)) -+ goto out; -+ bf = br->br_fhsm; -+ br->br_fhsm = NULL; -+ } -+ -+ if (au_br_writable(br->br_perm)) { -+ /* remove whiteout base */ -+ err = au_br_init_wh(sb, br, mod->perm); -+ if (unlikely(err)) -+ goto out_bf; -+ -+ if (!au_br_writable(mod->perm)) { -+ /* rw --> ro, file might be mmapped */ -+ DiMustNoWaiters(root); -+ IiMustNoWaiters(d_inode(root)); -+ di_write_unlock(root); -+ err = au_br_mod_files_ro(sb, bindex); -+ /* aufs_write_lock() calls ..._child() */ -+ di_write_lock_child(root); -+ -+ if (unlikely(err)) { -+ rerr = -ENOMEM; -+ br->br_wbr = kzalloc(sizeof(*br->br_wbr), -+ GFP_NOFS); -+ if (br->br_wbr) -+ rerr = au_wbr_init(br, sb, br->br_perm); -+ if (unlikely(rerr)) { -+ AuIOErr("nested error %d (%d)\n", -+ rerr, err); -+ br->br_perm = mod->perm; -+ } -+ } -+ } -+ } else if (au_br_writable(mod->perm)) { -+ /* ro --> rw */ -+ err = -ENOMEM; -+ br->br_wbr = kzalloc(sizeof(*br->br_wbr), GFP_NOFS); -+ if (br->br_wbr) { -+ err = au_wbr_init(br, sb, mod->perm); -+ if (unlikely(err)) { -+ kfree(br->br_wbr); -+ br->br_wbr = NULL; -+ } -+ } -+ } -+ if (unlikely(err)) -+ goto out_bf; -+ -+ if (au_br_fhsm(br->br_perm)) { -+ if (!au_br_fhsm(mod->perm)) { -+ /* fhsm --> non-fhsm */ -+ au_br_fhsm_fin(br->br_fhsm); -+ kfree(br->br_fhsm); -+ br->br_fhsm = NULL; -+ } -+ } else if (au_br_fhsm(mod->perm)) -+ /* non-fhsm --> fhsm */ -+ br->br_fhsm = bf; -+ -+ *do_refresh |= need_sigen_inc(br->br_perm, mod->perm); -+ br->br_perm = mod->perm; -+ goto out; /* success */ -+ -+out_bf: -+ kfree(bf); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int au_br_stfs(struct au_branch *br, struct aufs_stfs *stfs) -+{ -+ int err; -+ struct kstatfs kstfs; -+ -+ err = vfs_statfs(&br->br_path, &kstfs); -+ if (!err) { -+ stfs->f_blocks = kstfs.f_blocks; -+ stfs->f_bavail = kstfs.f_bavail; -+ stfs->f_files = kstfs.f_files; -+ stfs->f_ffree = kstfs.f_ffree; -+ } -+ -+ return err; -+} -diff --git a/fs/aufs/branch.h b/fs/aufs/branch.h -new file mode 100644 -index 000000000000..4d00945fae8d ---- /dev/null -+++ b/fs/aufs/branch.h -@@ -0,0 +1,321 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * branch filesystems and xino for them -+ */ -+ -+#ifndef __AUFS_BRANCH_H__ -+#define __AUFS_BRANCH_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+#include "dirren.h" -+#include "dynop.h" -+#include "rwsem.h" -+#include "super.h" -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* a xino file */ -+struct au_xino_file { -+ struct file *xi_file; -+ struct { -+ spinlock_t spin; -+ ino_t *array; -+ int total; -+ /* reserved for future use */ -+ /* unsigned long *bitmap; */ -+ wait_queue_head_t wqh; -+ } xi_nondir; -+ -+ /* todo: make xino files an array to support huge inode number */ -+ -+#ifdef CONFIG_DEBUG_FS -+ struct dentry *xi_dbgaufs; -+#endif -+}; -+ -+/* File-based Hierarchical Storage Management */ -+struct au_br_fhsm { -+#ifdef CONFIG_AUFS_FHSM -+ struct mutex bf_lock; -+ unsigned long bf_jiffy; -+ struct aufs_stfs bf_stfs; -+ int bf_readable; -+#endif -+}; -+ -+/* members for writable branch only */ -+enum {AuBrWh_BASE, AuBrWh_PLINK, AuBrWh_ORPH, AuBrWh_Last}; -+struct au_wbr { -+ struct au_rwsem wbr_wh_rwsem; -+ struct dentry *wbr_wh[AuBrWh_Last]; -+ atomic_t wbr_wh_running; -+#define wbr_whbase wbr_wh[AuBrWh_BASE] /* whiteout base */ -+#define wbr_plink wbr_wh[AuBrWh_PLINK] /* pseudo-link dir */ -+#define wbr_orph wbr_wh[AuBrWh_ORPH] /* dir for orphans */ -+ -+ /* mfs mode */ -+ unsigned long long wbr_bytes; -+}; -+ -+/* ext2 has 3 types of operations at least, ext3 has 4 */ -+#define AuBrDynOp (AuDyLast * 4) -+ -+#ifdef CONFIG_AUFS_HFSNOTIFY -+/* support for asynchronous destruction */ -+struct au_br_hfsnotify { -+ struct fsnotify_group *hfsn_group; -+}; -+#endif -+ -+/* sysfs entries */ -+struct au_brsysfs { -+ char name[16]; -+ struct attribute attr; -+}; -+ -+enum { -+ AuBrSysfs_BR, -+ AuBrSysfs_BRID, -+ AuBrSysfs_Last -+}; -+ -+/* protected by superblock rwsem */ -+struct au_branch { -+ struct au_xino_file br_xino; -+ -+ aufs_bindex_t br_id; -+ -+ int br_perm; -+ struct path br_path; -+ spinlock_t br_dykey_lock; -+ struct au_dykey *br_dykey[AuBrDynOp]; -+ struct percpu_counter br_count; -+ -+ struct au_wbr *br_wbr; -+ struct au_br_fhsm *br_fhsm; -+ -+ /* xino truncation */ -+ atomic_t br_xino_running; -+ -+#ifdef CONFIG_AUFS_HFSNOTIFY -+ struct au_br_hfsnotify *br_hfsn; -+#endif -+ -+#ifdef CONFIG_SYSFS -+ /* entries under sysfs per mount-point */ -+ struct au_brsysfs br_sysfs[AuBrSysfs_Last]; -+#endif -+ -+ struct au_dr_br br_dirren; -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline struct vfsmount *au_br_mnt(struct au_branch *br) -+{ -+ return br->br_path.mnt; -+} -+ -+static inline struct dentry *au_br_dentry(struct au_branch *br) -+{ -+ return br->br_path.dentry; -+} -+ -+static inline struct super_block *au_br_sb(struct au_branch *br) -+{ -+ return au_br_mnt(br)->mnt_sb; -+} -+ -+static inline void au_br_get(struct au_branch *br) -+{ -+ percpu_counter_inc(&br->br_count); -+} -+ -+static inline void au_br_put(struct au_branch *br) -+{ -+ percpu_counter_dec(&br->br_count); -+} -+ -+static inline s64 au_br_count(struct au_branch *br) -+{ -+ return percpu_counter_sum(&br->br_count); -+} -+ -+static inline void au_br_count_init(struct au_branch *br) -+{ -+ percpu_counter_init(&br->br_count, 0, GFP_NOFS); -+} -+ -+static inline void au_br_count_fin(struct au_branch *br) -+{ -+ percpu_counter_destroy(&br->br_count); -+} -+ -+static inline int au_br_rdonly(struct au_branch *br) -+{ -+ return (sb_rdonly(au_br_sb(br)) -+ || !au_br_writable(br->br_perm)) -+ ? -EROFS : 0; -+} -+ -+static inline int au_br_hnotifyable(int brperm __maybe_unused) -+{ -+#ifdef CONFIG_AUFS_HNOTIFY -+ return !(brperm & AuBrPerm_RR); -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_br_test_oflag(int oflag, struct au_branch *br) -+{ -+ int err, exec_flag; -+ -+ err = 0; -+ exec_flag = oflag & __FMODE_EXEC; -+ if (unlikely(exec_flag && path_noexec(&br->br_path))) -+ err = -EACCES; -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* branch.c */ -+struct au_sbinfo; -+void au_br_free(struct au_sbinfo *sinfo); -+int au_br_index(struct super_block *sb, aufs_bindex_t br_id); -+struct au_opt_add; -+int au_br_add(struct super_block *sb, struct au_opt_add *add, int remount); -+struct au_opt_del; -+int au_br_del(struct super_block *sb, struct au_opt_del *del, int remount); -+long au_ibusy_ioctl(struct file *file, unsigned long arg); -+#ifdef CONFIG_COMPAT -+long au_ibusy_compat_ioctl(struct file *file, unsigned long arg); -+#endif -+struct au_opt_mod; -+int au_br_mod(struct super_block *sb, struct au_opt_mod *mod, int remount, -+ int *do_refresh); -+struct aufs_stfs; -+int au_br_stfs(struct au_branch *br, struct aufs_stfs *stfs); -+ -+/* xino.c */ -+static const loff_t au_loff_max = LLONG_MAX; -+ -+int au_xib_trunc(struct super_block *sb); -+ssize_t xino_fread(vfs_readf_t func, struct file *file, void *buf, size_t size, -+ loff_t *pos); -+ssize_t xino_fwrite(vfs_writef_t func, struct file *file, void *buf, -+ size_t size, loff_t *pos); -+struct file *au_xino_create2(struct file *base_file, struct file *copy_src); -+struct file *au_xino_create(struct super_block *sb, char *fname, int silent); -+ino_t au_xino_new_ino(struct super_block *sb); -+void au_xino_delete_inode(struct inode *inode, const int unlinked); -+int au_xino_write(struct super_block *sb, aufs_bindex_t bindex, ino_t h_ino, -+ ino_t ino); -+int au_xino_read(struct super_block *sb, aufs_bindex_t bindex, ino_t h_ino, -+ ino_t *ino); -+int au_xino_br(struct super_block *sb, struct au_branch *br, ino_t hino, -+ struct file *base_file, int do_test); -+int au_xino_trunc(struct super_block *sb, aufs_bindex_t bindex); -+ -+struct au_opt_xino; -+int au_xino_set(struct super_block *sb, struct au_opt_xino *xino, int remount); -+void au_xino_clr(struct super_block *sb); -+struct file *au_xino_def(struct super_block *sb); -+int au_xino_path(struct seq_file *seq, struct file *file); -+ -+void au_xinondir_leave(struct super_block *sb, aufs_bindex_t bindex, -+ ino_t h_ino, int idx); -+int au_xinondir_enter(struct super_block *sb, aufs_bindex_t bindex, ino_t h_ino, -+ int *idx); -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* Superblock to branch */ -+static inline -+aufs_bindex_t au_sbr_id(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ return au_sbr(sb, bindex)->br_id; -+} -+ -+static inline -+struct vfsmount *au_sbr_mnt(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ return au_br_mnt(au_sbr(sb, bindex)); -+} -+ -+static inline -+struct super_block *au_sbr_sb(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ return au_br_sb(au_sbr(sb, bindex)); -+} -+ -+static inline void au_sbr_get(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ au_br_get(au_sbr(sb, bindex)); -+} -+ -+static inline void au_sbr_put(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ au_br_put(au_sbr(sb, bindex)); -+} -+ -+static inline int au_sbr_perm(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ return au_sbr(sb, bindex)->br_perm; -+} -+ -+static inline int au_sbr_whable(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ return au_br_whable(au_sbr_perm(sb, bindex)); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+#define wbr_wh_read_lock(wbr) au_rw_read_lock(&(wbr)->wbr_wh_rwsem) -+#define wbr_wh_write_lock(wbr) au_rw_write_lock(&(wbr)->wbr_wh_rwsem) -+#define wbr_wh_read_trylock(wbr) au_rw_read_trylock(&(wbr)->wbr_wh_rwsem) -+#define wbr_wh_write_trylock(wbr) au_rw_write_trylock(&(wbr)->wbr_wh_rwsem) -+/* -+#define wbr_wh_read_trylock_nested(wbr) \ -+ au_rw_read_trylock_nested(&(wbr)->wbr_wh_rwsem) -+#define wbr_wh_write_trylock_nested(wbr) \ -+ au_rw_write_trylock_nested(&(wbr)->wbr_wh_rwsem) -+*/ -+ -+#define wbr_wh_read_unlock(wbr) au_rw_read_unlock(&(wbr)->wbr_wh_rwsem) -+#define wbr_wh_write_unlock(wbr) au_rw_write_unlock(&(wbr)->wbr_wh_rwsem) -+#define wbr_wh_downgrade_lock(wbr) au_rw_dgrade_lock(&(wbr)->wbr_wh_rwsem) -+ -+#define WbrWhMustNoWaiters(wbr) AuRwMustNoWaiters(&(wbr)->wbr_wh_rwsem) -+#define WbrWhMustAnyLock(wbr) AuRwMustAnyLock(&(wbr)->wbr_wh_rwsem) -+#define WbrWhMustWriteLock(wbr) AuRwMustWriteLock(&(wbr)->wbr_wh_rwsem) -+ -+/* ---------------------------------------------------------------------- */ -+ -+#ifdef CONFIG_AUFS_FHSM -+static inline void au_br_fhsm_init(struct au_br_fhsm *brfhsm) -+{ -+ mutex_init(&brfhsm->bf_lock); -+ brfhsm->bf_jiffy = 0; -+ brfhsm->bf_readable = 0; -+} -+ -+static inline void au_br_fhsm_fin(struct au_br_fhsm *brfhsm) -+{ -+ mutex_destroy(&brfhsm->bf_lock); -+} -+#else -+AuStubVoid(au_br_fhsm_init, struct au_br_fhsm *brfhsm) -+AuStubVoid(au_br_fhsm_fin, struct au_br_fhsm *brfhsm) -+#endif -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_BRANCH_H__ */ -diff --git a/fs/aufs/cpup.c b/fs/aufs/cpup.c -new file mode 100644 -index 000000000000..3678bacc40b3 ---- /dev/null -+++ b/fs/aufs/cpup.c -@@ -0,0 +1,1430 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * copy-up functions, see wbr_policy.c for copy-down -+ */ -+ -+#include -+#include -+#include -+#include "aufs.h" -+ -+void au_cpup_attr_flags(struct inode *dst, unsigned int iflags) -+{ -+ const unsigned int mask = S_DEAD | S_SWAPFILE | S_PRIVATE -+ | S_NOATIME | S_NOCMTIME | S_AUTOMOUNT; -+ -+ BUILD_BUG_ON(sizeof(iflags) != sizeof(dst->i_flags)); -+ -+ dst->i_flags |= iflags & ~mask; -+ if (au_test_fs_notime(dst->i_sb)) -+ dst->i_flags |= S_NOATIME | S_NOCMTIME; -+} -+ -+void au_cpup_attr_timesizes(struct inode *inode) -+{ -+ struct inode *h_inode; -+ -+ h_inode = au_h_iptr(inode, au_ibtop(inode)); -+ fsstack_copy_attr_times(inode, h_inode); -+ fsstack_copy_inode_size(inode, h_inode); -+} -+ -+void au_cpup_attr_nlink(struct inode *inode, int force) -+{ -+ struct inode *h_inode; -+ struct super_block *sb; -+ aufs_bindex_t bindex, bbot; -+ -+ sb = inode->i_sb; -+ bindex = au_ibtop(inode); -+ h_inode = au_h_iptr(inode, bindex); -+ if (!force -+ && !S_ISDIR(h_inode->i_mode) -+ && au_opt_test(au_mntflags(sb), PLINK) -+ && au_plink_test(inode)) -+ return; -+ -+ /* -+ * 0 can happen in revalidating. -+ * h_inode->i_mutex may not be held here, but it is harmless since once -+ * i_nlink reaches 0, it will never become positive except O_TMPFILE -+ * case. -+ * todo: O_TMPFILE+linkat(AT_SYMLINK_FOLLOW) bypassing aufs may cause -+ * the incorrect link count. -+ */ -+ set_nlink(inode, h_inode->i_nlink); -+ -+ /* -+ * fewer nlink makes find(1) noisy, but larger nlink doesn't. -+ * it may includes whplink directory. -+ */ -+ if (S_ISDIR(h_inode->i_mode)) { -+ bbot = au_ibbot(inode); -+ for (bindex++; bindex <= bbot; bindex++) { -+ h_inode = au_h_iptr(inode, bindex); -+ if (h_inode) -+ au_add_nlink(inode, h_inode); -+ } -+ } -+} -+ -+void au_cpup_attr_changeable(struct inode *inode) -+{ -+ struct inode *h_inode; -+ -+ h_inode = au_h_iptr(inode, au_ibtop(inode)); -+ inode->i_mode = h_inode->i_mode; -+ inode->i_uid = h_inode->i_uid; -+ inode->i_gid = h_inode->i_gid; -+ au_cpup_attr_timesizes(inode); -+ au_cpup_attr_flags(inode, h_inode->i_flags); -+} -+ -+void au_cpup_igen(struct inode *inode, struct inode *h_inode) -+{ -+ struct au_iinfo *iinfo = au_ii(inode); -+ -+ IiMustWriteLock(inode); -+ -+ iinfo->ii_higen = h_inode->i_generation; -+ iinfo->ii_hsb1 = h_inode->i_sb; -+} -+ -+void au_cpup_attr_all(struct inode *inode, int force) -+{ -+ struct inode *h_inode; -+ -+ h_inode = au_h_iptr(inode, au_ibtop(inode)); -+ au_cpup_attr_changeable(inode); -+ if (inode->i_nlink > 0) -+ au_cpup_attr_nlink(inode, force); -+ inode->i_rdev = h_inode->i_rdev; -+ inode->i_blkbits = h_inode->i_blkbits; -+ au_cpup_igen(inode, h_inode); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* Note: dt_dentry and dt_h_dentry are not dget/dput-ed */ -+ -+/* keep the timestamps of the parent dir when cpup */ -+void au_dtime_store(struct au_dtime *dt, struct dentry *dentry, -+ struct path *h_path) -+{ -+ struct inode *h_inode; -+ -+ dt->dt_dentry = dentry; -+ dt->dt_h_path = *h_path; -+ h_inode = d_inode(h_path->dentry); -+ dt->dt_atime = h_inode->i_atime; -+ dt->dt_mtime = h_inode->i_mtime; -+ /* smp_mb(); */ -+} -+ -+void au_dtime_revert(struct au_dtime *dt) -+{ -+ struct iattr attr; -+ int err; -+ -+ attr.ia_atime = dt->dt_atime; -+ attr.ia_mtime = dt->dt_mtime; -+ attr.ia_valid = ATTR_FORCE | ATTR_MTIME | ATTR_MTIME_SET -+ | ATTR_ATIME | ATTR_ATIME_SET; -+ -+ /* no delegation since this is a directory */ -+ err = vfsub_notify_change(&dt->dt_h_path, &attr, /*delegated*/NULL); -+ if (unlikely(err)) -+ pr_warn("restoring timestamps failed(%d). ignored\n", err); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* internal use only */ -+struct au_cpup_reg_attr { -+ int valid; -+ struct kstat st; -+ unsigned int iflags; /* inode->i_flags */ -+}; -+ -+static noinline_for_stack -+int cpup_iattr(struct dentry *dst, aufs_bindex_t bindex, struct dentry *h_src, -+ struct au_cpup_reg_attr *h_src_attr) -+{ -+ int err, sbits, icex; -+ unsigned int mnt_flags; -+ unsigned char verbose; -+ struct iattr ia; -+ struct path h_path; -+ struct inode *h_isrc, *h_idst; -+ struct kstat *h_st; -+ struct au_branch *br; -+ -+ h_path.dentry = au_h_dptr(dst, bindex); -+ h_idst = d_inode(h_path.dentry); -+ br = au_sbr(dst->d_sb, bindex); -+ h_path.mnt = au_br_mnt(br); -+ h_isrc = d_inode(h_src); -+ ia.ia_valid = ATTR_FORCE | ATTR_UID | ATTR_GID -+ | ATTR_ATIME | ATTR_MTIME -+ | ATTR_ATIME_SET | ATTR_MTIME_SET; -+ if (h_src_attr && h_src_attr->valid) { -+ h_st = &h_src_attr->st; -+ ia.ia_uid = h_st->uid; -+ ia.ia_gid = h_st->gid; -+ ia.ia_atime = h_st->atime; -+ ia.ia_mtime = h_st->mtime; -+ if (h_idst->i_mode != h_st->mode -+ && !S_ISLNK(h_idst->i_mode)) { -+ ia.ia_valid |= ATTR_MODE; -+ ia.ia_mode = h_st->mode; -+ } -+ sbits = !!(h_st->mode & (S_ISUID | S_ISGID)); -+ au_cpup_attr_flags(h_idst, h_src_attr->iflags); -+ } else { -+ ia.ia_uid = h_isrc->i_uid; -+ ia.ia_gid = h_isrc->i_gid; -+ ia.ia_atime = h_isrc->i_atime; -+ ia.ia_mtime = h_isrc->i_mtime; -+ if (h_idst->i_mode != h_isrc->i_mode -+ && !S_ISLNK(h_idst->i_mode)) { -+ ia.ia_valid |= ATTR_MODE; -+ ia.ia_mode = h_isrc->i_mode; -+ } -+ sbits = !!(h_isrc->i_mode & (S_ISUID | S_ISGID)); -+ au_cpup_attr_flags(h_idst, h_isrc->i_flags); -+ } -+ /* no delegation since it is just created */ -+ err = vfsub_notify_change(&h_path, &ia, /*delegated*/NULL); -+ -+ /* is this nfs only? */ -+ if (!err && sbits && au_test_nfs(h_path.dentry->d_sb)) { -+ ia.ia_valid = ATTR_FORCE | ATTR_MODE; -+ ia.ia_mode = h_isrc->i_mode; -+ err = vfsub_notify_change(&h_path, &ia, /*delegated*/NULL); -+ } -+ -+ icex = br->br_perm & AuBrAttr_ICEX; -+ if (!err) { -+ mnt_flags = au_mntflags(dst->d_sb); -+ verbose = !!au_opt_test(mnt_flags, VERBOSE); -+ err = au_cpup_xattr(h_path.dentry, h_src, icex, verbose); -+ } -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_do_copy_file(struct file *dst, struct file *src, loff_t len, -+ char *buf, unsigned long blksize) -+{ -+ int err; -+ size_t sz, rbytes, wbytes; -+ unsigned char all_zero; -+ char *p, *zp; -+ struct inode *h_inode; -+ /* reduce stack usage */ -+ struct iattr *ia; -+ -+ zp = page_address(ZERO_PAGE(0)); -+ if (unlikely(!zp)) -+ return -ENOMEM; /* possible? */ -+ -+ err = 0; -+ all_zero = 0; -+ while (len) { -+ AuDbg("len %lld\n", len); -+ sz = blksize; -+ if (len < blksize) -+ sz = len; -+ -+ rbytes = 0; -+ /* todo: signal_pending? */ -+ while (!rbytes || err == -EAGAIN || err == -EINTR) { -+ rbytes = vfsub_read_k(src, buf, sz, &src->f_pos); -+ err = rbytes; -+ } -+ if (unlikely(err < 0)) -+ break; -+ -+ all_zero = 0; -+ if (len >= rbytes && rbytes == blksize) -+ all_zero = !memcmp(buf, zp, rbytes); -+ if (!all_zero) { -+ wbytes = rbytes; -+ p = buf; -+ while (wbytes) { -+ size_t b; -+ -+ b = vfsub_write_k(dst, p, wbytes, &dst->f_pos); -+ err = b; -+ /* todo: signal_pending? */ -+ if (unlikely(err == -EAGAIN || err == -EINTR)) -+ continue; -+ if (unlikely(err < 0)) -+ break; -+ wbytes -= b; -+ p += b; -+ } -+ if (unlikely(err < 0)) -+ break; -+ } else { -+ loff_t res; -+ -+ AuLabel(hole); -+ res = vfsub_llseek(dst, rbytes, SEEK_CUR); -+ err = res; -+ if (unlikely(res < 0)) -+ break; -+ } -+ len -= rbytes; -+ err = 0; -+ } -+ -+ /* the last block may be a hole */ -+ if (!err && all_zero) { -+ AuLabel(last hole); -+ -+ err = 1; -+ if (au_test_nfs(dst->f_path.dentry->d_sb)) { -+ /* nfs requires this step to make last hole */ -+ /* is this only nfs? */ -+ do { -+ /* todo: signal_pending? */ -+ err = vfsub_write_k(dst, "\0", 1, &dst->f_pos); -+ } while (err == -EAGAIN || err == -EINTR); -+ if (err == 1) -+ dst->f_pos--; -+ } -+ -+ if (err == 1) { -+ ia = (void *)buf; -+ ia->ia_size = dst->f_pos; -+ ia->ia_valid = ATTR_SIZE | ATTR_FILE; -+ ia->ia_file = dst; -+ h_inode = file_inode(dst); -+ inode_lock_nested(h_inode, AuLsc_I_CHILD2); -+ /* no delegation since it is just created */ -+ err = vfsub_notify_change(&dst->f_path, ia, -+ /*delegated*/NULL); -+ inode_unlock(h_inode); -+ } -+ } -+ -+ return err; -+} -+ -+int au_copy_file(struct file *dst, struct file *src, loff_t len) -+{ -+ int err; -+ unsigned long blksize; -+ unsigned char do_kfree; -+ char *buf; -+ -+ err = -ENOMEM; -+ blksize = dst->f_path.dentry->d_sb->s_blocksize; -+ if (!blksize || PAGE_SIZE < blksize) -+ blksize = PAGE_SIZE; -+ AuDbg("blksize %lu\n", blksize); -+ do_kfree = (blksize != PAGE_SIZE && blksize >= sizeof(struct iattr *)); -+ if (do_kfree) -+ buf = kmalloc(blksize, GFP_NOFS); -+ else -+ buf = (void *)__get_free_page(GFP_NOFS); -+ if (unlikely(!buf)) -+ goto out; -+ -+ if (len > (1 << 22)) -+ AuDbg("copying a large file %lld\n", (long long)len); -+ -+ src->f_pos = 0; -+ dst->f_pos = 0; -+ err = au_do_copy_file(dst, src, len, buf, blksize); -+ if (do_kfree) -+ kfree(buf); -+ else -+ free_page((unsigned long)buf); -+ -+out: -+ return err; -+} -+ -+static int au_do_copy(struct file *dst, struct file *src, loff_t len) -+{ -+ int err; -+ struct super_block *h_src_sb; -+ struct inode *h_src_inode; -+ -+ h_src_inode = file_inode(src); -+ h_src_sb = h_src_inode->i_sb; -+ -+ /* XFS acquires inode_lock */ -+ if (!au_test_xfs(h_src_sb)) -+ err = au_copy_file(dst, src, len); -+ else { -+ inode_unlock_shared(h_src_inode); -+ err = au_copy_file(dst, src, len); -+ vfsub_inode_lock_shared_nested(h_src_inode, AuLsc_I_CHILD); -+ } -+ -+ return err; -+} -+ -+static int au_clone_or_copy(struct file *dst, struct file *src, loff_t len) -+{ -+ int err; -+ struct super_block *h_src_sb; -+ struct inode *h_src_inode; -+ -+ h_src_inode = file_inode(src); -+ h_src_sb = h_src_inode->i_sb; -+ if (h_src_sb != file_inode(dst)->i_sb -+ || !dst->f_op->clone_file_range) { -+ err = au_do_copy(dst, src, len); -+ goto out; -+ } -+ -+ if (!au_test_nfs(h_src_sb)) { -+ inode_unlock_shared(h_src_inode); -+ err = vfsub_clone_file_range(src, dst, len); -+ vfsub_inode_lock_shared_nested(h_src_inode, AuLsc_I_CHILD); -+ } else -+ err = vfsub_clone_file_range(src, dst, len); -+ /* older XFS has a condition in cloning */ -+ if (unlikely(err != -EOPNOTSUPP)) -+ goto out; -+ -+ /* the backend fs on NFS may not support cloning */ -+ err = au_do_copy(dst, src, len); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* -+ * to support a sparse file which is opened with O_APPEND, -+ * we need to close the file. -+ */ -+static int au_cp_regular(struct au_cp_generic *cpg) -+{ -+ int err, i; -+ enum { SRC, DST }; -+ struct { -+ aufs_bindex_t bindex; -+ unsigned int flags; -+ struct dentry *dentry; -+ int force_wr; -+ struct file *file; -+ void *label; -+ } *f, file[] = { -+ { -+ .bindex = cpg->bsrc, -+ .flags = O_RDONLY | O_NOATIME | O_LARGEFILE, -+ .label = &&out -+ }, -+ { -+ .bindex = cpg->bdst, -+ .flags = O_WRONLY | O_NOATIME | O_LARGEFILE, -+ .force_wr = !!au_ftest_cpup(cpg->flags, RWDST), -+ .label = &&out_src -+ } -+ }; -+ struct super_block *sb, *h_src_sb; -+ struct inode *h_src_inode; -+ struct task_struct *tsk = current; -+ -+ /* bsrc branch can be ro/rw. */ -+ sb = cpg->dentry->d_sb; -+ f = file; -+ for (i = 0; i < 2; i++, f++) { -+ f->dentry = au_h_dptr(cpg->dentry, f->bindex); -+ f->file = au_h_open(cpg->dentry, f->bindex, f->flags, -+ /*file*/NULL, f->force_wr); -+ err = PTR_ERR(f->file); -+ if (IS_ERR(f->file)) -+ goto *f->label; -+ } -+ -+ /* try stopping to update while we copyup */ -+ h_src_inode = d_inode(file[SRC].dentry); -+ h_src_sb = h_src_inode->i_sb; -+ if (!au_test_nfs(h_src_sb)) -+ IMustLock(h_src_inode); -+ err = au_clone_or_copy(file[DST].file, file[SRC].file, cpg->len); -+ -+ /* i wonder if we had O_NO_DELAY_FPUT flag */ -+ if (tsk->flags & PF_KTHREAD) -+ __fput_sync(file[DST].file); -+ else { -+ /* it happend actually */ -+ fput(file[DST].file); -+ /* -+ * too bad. -+ * we have to call both since we don't know which place the file -+ * was added to. -+ */ -+ task_work_run(); -+ flush_delayed_fput(); -+ } -+ au_sbr_put(sb, file[DST].bindex); -+ -+out_src: -+ fput(file[SRC].file); -+ au_sbr_put(sb, file[SRC].bindex); -+out: -+ return err; -+} -+ -+static int au_do_cpup_regular(struct au_cp_generic *cpg, -+ struct au_cpup_reg_attr *h_src_attr) -+{ -+ int err, rerr; -+ loff_t l; -+ struct path h_path; -+ struct inode *h_src_inode, *h_dst_inode; -+ -+ err = 0; -+ h_src_inode = au_h_iptr(d_inode(cpg->dentry), cpg->bsrc); -+ l = i_size_read(h_src_inode); -+ if (cpg->len == -1 || l < cpg->len) -+ cpg->len = l; -+ if (cpg->len) { -+ /* try stopping to update while we are referencing */ -+ vfsub_inode_lock_shared_nested(h_src_inode, AuLsc_I_CHILD); -+ au_pin_hdir_unlock(cpg->pin); -+ -+ h_path.dentry = au_h_dptr(cpg->dentry, cpg->bsrc); -+ h_path.mnt = au_sbr_mnt(cpg->dentry->d_sb, cpg->bsrc); -+ h_src_attr->iflags = h_src_inode->i_flags; -+ if (!au_test_nfs(h_src_inode->i_sb)) -+ err = vfsub_getattr(&h_path, &h_src_attr->st); -+ else { -+ inode_unlock_shared(h_src_inode); -+ err = vfsub_getattr(&h_path, &h_src_attr->st); -+ vfsub_inode_lock_shared_nested(h_src_inode, -+ AuLsc_I_CHILD); -+ } -+ if (unlikely(err)) { -+ inode_unlock_shared(h_src_inode); -+ goto out; -+ } -+ h_src_attr->valid = 1; -+ if (!au_test_nfs(h_src_inode->i_sb)) { -+ err = au_cp_regular(cpg); -+ inode_unlock_shared(h_src_inode); -+ } else { -+ inode_unlock_shared(h_src_inode); -+ err = au_cp_regular(cpg); -+ } -+ rerr = au_pin_hdir_relock(cpg->pin); -+ if (!err && rerr) -+ err = rerr; -+ } -+ if (!err && (h_src_inode->i_state & I_LINKABLE)) { -+ h_path.dentry = au_h_dptr(cpg->dentry, cpg->bdst); -+ h_dst_inode = d_inode(h_path.dentry); -+ spin_lock(&h_dst_inode->i_lock); -+ h_dst_inode->i_state |= I_LINKABLE; -+ spin_unlock(&h_dst_inode->i_lock); -+ } -+ -+out: -+ return err; -+} -+ -+static int au_do_cpup_symlink(struct path *h_path, struct dentry *h_src, -+ struct inode *h_dir) -+{ -+ int err, symlen; -+ mm_segment_t old_fs; -+ union { -+ char *k; -+ char __user *u; -+ } sym; -+ -+ err = -ENOMEM; -+ sym.k = (void *)__get_free_page(GFP_NOFS); -+ if (unlikely(!sym.k)) -+ goto out; -+ -+ /* unnecessary to support mmap_sem since symlink is not mmap-able */ -+ old_fs = get_fs(); -+ set_fs(KERNEL_DS); -+ symlen = vfs_readlink(h_src, sym.u, PATH_MAX); -+ err = symlen; -+ set_fs(old_fs); -+ -+ if (symlen > 0) { -+ sym.k[symlen] = 0; -+ err = vfsub_symlink(h_dir, h_path, sym.k); -+ } -+ free_page((unsigned long)sym.k); -+ -+out: -+ return err; -+} -+ -+/* -+ * regardless 'acl' option, reset all ACL. -+ * All ACL will be copied up later from the original entry on the lower branch. -+ */ -+static int au_reset_acl(struct inode *h_dir, struct path *h_path, umode_t mode) -+{ -+ int err; -+ struct dentry *h_dentry; -+ struct inode *h_inode; -+ -+ h_dentry = h_path->dentry; -+ h_inode = d_inode(h_dentry); -+ /* forget_all_cached_acls(h_inode)); */ -+ err = vfsub_removexattr(h_dentry, XATTR_NAME_POSIX_ACL_ACCESS); -+ AuTraceErr(err); -+ if (err == -EOPNOTSUPP) -+ err = 0; -+ if (!err) -+ err = vfsub_acl_chmod(h_inode, mode); -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+static int au_do_cpup_dir(struct au_cp_generic *cpg, struct dentry *dst_parent, -+ struct inode *h_dir, struct path *h_path) -+{ -+ int err; -+ struct inode *dir, *inode; -+ -+ err = vfsub_removexattr(h_path->dentry, XATTR_NAME_POSIX_ACL_DEFAULT); -+ AuTraceErr(err); -+ if (err == -EOPNOTSUPP) -+ err = 0; -+ if (unlikely(err)) -+ goto out; -+ -+ /* -+ * strange behaviour from the users view, -+ * particularry setattr case -+ */ -+ dir = d_inode(dst_parent); -+ if (au_ibtop(dir) == cpg->bdst) -+ au_cpup_attr_nlink(dir, /*force*/1); -+ inode = d_inode(cpg->dentry); -+ au_cpup_attr_nlink(inode, /*force*/1); -+ -+out: -+ return err; -+} -+ -+static noinline_for_stack -+int cpup_entry(struct au_cp_generic *cpg, struct dentry *dst_parent, -+ struct au_cpup_reg_attr *h_src_attr) -+{ -+ int err; -+ umode_t mode; -+ unsigned int mnt_flags; -+ unsigned char isdir, isreg, force; -+ const unsigned char do_dt = !!au_ftest_cpup(cpg->flags, DTIME); -+ struct au_dtime dt; -+ struct path h_path; -+ struct dentry *h_src, *h_dst, *h_parent; -+ struct inode *h_inode, *h_dir; -+ struct super_block *sb; -+ -+ /* bsrc branch can be ro/rw. */ -+ h_src = au_h_dptr(cpg->dentry, cpg->bsrc); -+ h_inode = d_inode(h_src); -+ AuDebugOn(h_inode != au_h_iptr(d_inode(cpg->dentry), cpg->bsrc)); -+ -+ /* try stopping to be referenced while we are creating */ -+ h_dst = au_h_dptr(cpg->dentry, cpg->bdst); -+ if (au_ftest_cpup(cpg->flags, RENAME)) -+ AuDebugOn(strncmp(h_dst->d_name.name, AUFS_WH_PFX, -+ AUFS_WH_PFX_LEN)); -+ h_parent = h_dst->d_parent; /* dir inode is locked */ -+ h_dir = d_inode(h_parent); -+ IMustLock(h_dir); -+ AuDebugOn(h_parent != h_dst->d_parent); -+ -+ sb = cpg->dentry->d_sb; -+ h_path.mnt = au_sbr_mnt(sb, cpg->bdst); -+ if (do_dt) { -+ h_path.dentry = h_parent; -+ au_dtime_store(&dt, dst_parent, &h_path); -+ } -+ h_path.dentry = h_dst; -+ -+ isreg = 0; -+ isdir = 0; -+ mode = h_inode->i_mode; -+ switch (mode & S_IFMT) { -+ case S_IFREG: -+ isreg = 1; -+ err = vfsub_create(h_dir, &h_path, S_IRUSR | S_IWUSR, -+ /*want_excl*/true); -+ if (!err) -+ err = au_do_cpup_regular(cpg, h_src_attr); -+ break; -+ case S_IFDIR: -+ isdir = 1; -+ err = vfsub_mkdir(h_dir, &h_path, mode); -+ if (!err) -+ err = au_do_cpup_dir(cpg, dst_parent, h_dir, &h_path); -+ break; -+ case S_IFLNK: -+ err = au_do_cpup_symlink(&h_path, h_src, h_dir); -+ break; -+ case S_IFCHR: -+ case S_IFBLK: -+ AuDebugOn(!capable(CAP_MKNOD)); -+ /*FALLTHROUGH*/ -+ case S_IFIFO: -+ case S_IFSOCK: -+ err = vfsub_mknod(h_dir, &h_path, mode, h_inode->i_rdev); -+ break; -+ default: -+ AuIOErr("Unknown inode type 0%o\n", mode); -+ err = -EIO; -+ } -+ if (!err) -+ err = au_reset_acl(h_dir, &h_path, mode); -+ -+ mnt_flags = au_mntflags(sb); -+ if (!au_opt_test(mnt_flags, UDBA_NONE) -+ && !isdir -+ && au_opt_test(mnt_flags, XINO) -+ && (h_inode->i_nlink == 1 -+ || (h_inode->i_state & I_LINKABLE)) -+ /* todo: unnecessary? */ -+ /* && d_inode(cpg->dentry)->i_nlink == 1 */ -+ && cpg->bdst < cpg->bsrc -+ && !au_ftest_cpup(cpg->flags, KEEPLINO)) -+ au_xino_write(sb, cpg->bsrc, h_inode->i_ino, /*ino*/0); -+ /* ignore this error */ -+ -+ if (!err) { -+ force = 0; -+ if (isreg) { -+ force = !!cpg->len; -+ if (cpg->len == -1) -+ force = !!i_size_read(h_inode); -+ } -+ au_fhsm_wrote(sb, cpg->bdst, force); -+ } -+ -+ if (do_dt) -+ au_dtime_revert(&dt); -+ return err; -+} -+ -+static int au_do_ren_after_cpup(struct au_cp_generic *cpg, struct path *h_path) -+{ -+ int err; -+ struct dentry *dentry, *h_dentry, *h_parent, *parent; -+ struct inode *h_dir; -+ aufs_bindex_t bdst; -+ -+ dentry = cpg->dentry; -+ bdst = cpg->bdst; -+ h_dentry = au_h_dptr(dentry, bdst); -+ if (!au_ftest_cpup(cpg->flags, OVERWRITE)) { -+ dget(h_dentry); -+ au_set_h_dptr(dentry, bdst, NULL); -+ err = au_lkup_neg(dentry, bdst, /*wh*/0); -+ if (!err) -+ h_path->dentry = dget(au_h_dptr(dentry, bdst)); -+ au_set_h_dptr(dentry, bdst, h_dentry); -+ } else { -+ err = 0; -+ parent = dget_parent(dentry); -+ h_parent = au_h_dptr(parent, bdst); -+ dput(parent); -+ h_path->dentry = vfsub_lkup_one(&dentry->d_name, h_parent); -+ if (IS_ERR(h_path->dentry)) -+ err = PTR_ERR(h_path->dentry); -+ } -+ if (unlikely(err)) -+ goto out; -+ -+ h_parent = h_dentry->d_parent; /* dir inode is locked */ -+ h_dir = d_inode(h_parent); -+ IMustLock(h_dir); -+ AuDbg("%pd %pd\n", h_dentry, h_path->dentry); -+ /* no delegation since it is just created */ -+ err = vfsub_rename(h_dir, h_dentry, h_dir, h_path, /*delegated*/NULL, -+ /*flags*/0); -+ dput(h_path->dentry); -+ -+out: -+ return err; -+} -+ -+/* -+ * copyup the @dentry from @bsrc to @bdst. -+ * the caller must set the both of lower dentries. -+ * @len is for truncating when it is -1 copyup the entire file. -+ * in link/rename cases, @dst_parent may be different from the real one. -+ * basic->bsrc can be larger than basic->bdst. -+ * aufs doesn't touch the credential so -+ * security_inode_copy_up{,_xattr}() are unnecrssary. -+ */ -+static int au_cpup_single(struct au_cp_generic *cpg, struct dentry *dst_parent) -+{ -+ int err, rerr; -+ aufs_bindex_t old_ibtop; -+ unsigned char isdir, plink; -+ struct dentry *h_src, *h_dst, *h_parent; -+ struct inode *dst_inode, *h_dir, *inode, *delegated, *src_inode; -+ struct super_block *sb; -+ struct au_branch *br; -+ /* to reuduce stack size */ -+ struct { -+ struct au_dtime dt; -+ struct path h_path; -+ struct au_cpup_reg_attr h_src_attr; -+ } *a; -+ -+ err = -ENOMEM; -+ a = kmalloc(sizeof(*a), GFP_NOFS); -+ if (unlikely(!a)) -+ goto out; -+ a->h_src_attr.valid = 0; -+ -+ sb = cpg->dentry->d_sb; -+ br = au_sbr(sb, cpg->bdst); -+ a->h_path.mnt = au_br_mnt(br); -+ h_dst = au_h_dptr(cpg->dentry, cpg->bdst); -+ h_parent = h_dst->d_parent; /* dir inode is locked */ -+ h_dir = d_inode(h_parent); -+ IMustLock(h_dir); -+ -+ h_src = au_h_dptr(cpg->dentry, cpg->bsrc); -+ inode = d_inode(cpg->dentry); -+ -+ if (!dst_parent) -+ dst_parent = dget_parent(cpg->dentry); -+ else -+ dget(dst_parent); -+ -+ plink = !!au_opt_test(au_mntflags(sb), PLINK); -+ dst_inode = au_h_iptr(inode, cpg->bdst); -+ if (dst_inode) { -+ if (unlikely(!plink)) { -+ err = -EIO; -+ AuIOErr("hi%lu(i%lu) exists on b%d " -+ "but plink is disabled\n", -+ dst_inode->i_ino, inode->i_ino, cpg->bdst); -+ goto out_parent; -+ } -+ -+ if (dst_inode->i_nlink) { -+ const int do_dt = au_ftest_cpup(cpg->flags, DTIME); -+ -+ h_src = au_plink_lkup(inode, cpg->bdst); -+ err = PTR_ERR(h_src); -+ if (IS_ERR(h_src)) -+ goto out_parent; -+ if (unlikely(d_is_negative(h_src))) { -+ err = -EIO; -+ AuIOErr("i%lu exists on b%d " -+ "but not pseudo-linked\n", -+ inode->i_ino, cpg->bdst); -+ dput(h_src); -+ goto out_parent; -+ } -+ -+ if (do_dt) { -+ a->h_path.dentry = h_parent; -+ au_dtime_store(&a->dt, dst_parent, &a->h_path); -+ } -+ -+ a->h_path.dentry = h_dst; -+ delegated = NULL; -+ err = vfsub_link(h_src, h_dir, &a->h_path, &delegated); -+ if (!err && au_ftest_cpup(cpg->flags, RENAME)) -+ err = au_do_ren_after_cpup(cpg, &a->h_path); -+ if (do_dt) -+ au_dtime_revert(&a->dt); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal link\n"); -+ iput(delegated); -+ } -+ dput(h_src); -+ goto out_parent; -+ } else -+ /* todo: cpup_wh_file? */ -+ /* udba work */ -+ au_update_ibrange(inode, /*do_put_zero*/1); -+ } -+ -+ isdir = S_ISDIR(inode->i_mode); -+ old_ibtop = au_ibtop(inode); -+ err = cpup_entry(cpg, dst_parent, &a->h_src_attr); -+ if (unlikely(err)) -+ goto out_rev; -+ dst_inode = d_inode(h_dst); -+ inode_lock_nested(dst_inode, AuLsc_I_CHILD2); -+ /* todo: necessary? */ -+ /* au_pin_hdir_unlock(cpg->pin); */ -+ -+ err = cpup_iattr(cpg->dentry, cpg->bdst, h_src, &a->h_src_attr); -+ if (unlikely(err)) { -+ /* todo: necessary? */ -+ /* au_pin_hdir_relock(cpg->pin); */ /* ignore an error */ -+ inode_unlock(dst_inode); -+ goto out_rev; -+ } -+ -+ if (cpg->bdst < old_ibtop) { -+ if (S_ISREG(inode->i_mode)) { -+ err = au_dy_iaop(inode, cpg->bdst, dst_inode); -+ if (unlikely(err)) { -+ /* ignore an error */ -+ /* au_pin_hdir_relock(cpg->pin); */ -+ inode_unlock(dst_inode); -+ goto out_rev; -+ } -+ } -+ au_set_ibtop(inode, cpg->bdst); -+ } else -+ au_set_ibbot(inode, cpg->bdst); -+ au_set_h_iptr(inode, cpg->bdst, au_igrab(dst_inode), -+ au_hi_flags(inode, isdir)); -+ -+ /* todo: necessary? */ -+ /* err = au_pin_hdir_relock(cpg->pin); */ -+ inode_unlock(dst_inode); -+ if (unlikely(err)) -+ goto out_rev; -+ -+ src_inode = d_inode(h_src); -+ if (!isdir -+ && (src_inode->i_nlink > 1 -+ || src_inode->i_state & I_LINKABLE) -+ && plink) -+ au_plink_append(inode, cpg->bdst, h_dst); -+ -+ if (au_ftest_cpup(cpg->flags, RENAME)) { -+ a->h_path.dentry = h_dst; -+ err = au_do_ren_after_cpup(cpg, &a->h_path); -+ } -+ if (!err) -+ goto out_parent; /* success */ -+ -+ /* revert */ -+out_rev: -+ a->h_path.dentry = h_parent; -+ au_dtime_store(&a->dt, dst_parent, &a->h_path); -+ a->h_path.dentry = h_dst; -+ rerr = 0; -+ if (d_is_positive(h_dst)) { -+ if (!isdir) { -+ /* no delegation since it is just created */ -+ rerr = vfsub_unlink(h_dir, &a->h_path, -+ /*delegated*/NULL, /*force*/0); -+ } else -+ rerr = vfsub_rmdir(h_dir, &a->h_path); -+ } -+ au_dtime_revert(&a->dt); -+ if (rerr) { -+ AuIOErr("failed removing broken entry(%d, %d)\n", err, rerr); -+ err = -EIO; -+ } -+out_parent: -+ dput(dst_parent); -+ kfree(a); -+out: -+ return err; -+} -+ -+#if 0 /* reserved */ -+struct au_cpup_single_args { -+ int *errp; -+ struct au_cp_generic *cpg; -+ struct dentry *dst_parent; -+}; -+ -+static void au_call_cpup_single(void *args) -+{ -+ struct au_cpup_single_args *a = args; -+ -+ au_pin_hdir_acquire_nest(a->cpg->pin); -+ *a->errp = au_cpup_single(a->cpg, a->dst_parent); -+ au_pin_hdir_release(a->cpg->pin); -+} -+#endif -+ -+/* -+ * prevent SIGXFSZ in copy-up. -+ * testing CAP_MKNOD is for generic fs, -+ * but CAP_FSETID is for xfs only, currently. -+ */ -+static int au_cpup_sio_test(struct au_pin *pin, umode_t mode) -+{ -+ int do_sio; -+ struct super_block *sb; -+ struct inode *h_dir; -+ -+ do_sio = 0; -+ sb = au_pinned_parent(pin)->d_sb; -+ if (!au_wkq_test() -+ && (!au_sbi(sb)->si_plink_maint_pid -+ || au_plink_maint(sb, AuLock_NOPLM))) { -+ switch (mode & S_IFMT) { -+ case S_IFREG: -+ /* no condition about RLIMIT_FSIZE and the file size */ -+ do_sio = 1; -+ break; -+ case S_IFCHR: -+ case S_IFBLK: -+ do_sio = !capable(CAP_MKNOD); -+ break; -+ } -+ if (!do_sio) -+ do_sio = ((mode & (S_ISUID | S_ISGID)) -+ && !capable(CAP_FSETID)); -+ /* this workaround may be removed in the future */ -+ if (!do_sio) { -+ h_dir = au_pinned_h_dir(pin); -+ do_sio = h_dir->i_mode & S_ISVTX; -+ } -+ } -+ -+ return do_sio; -+} -+ -+#if 0 /* reserved */ -+int au_sio_cpup_single(struct au_cp_generic *cpg, struct dentry *dst_parent) -+{ -+ int err, wkq_err; -+ struct dentry *h_dentry; -+ -+ h_dentry = au_h_dptr(cpg->dentry, cpg->bsrc); -+ if (!au_cpup_sio_test(pin, d_inode(h_dentry)->i_mode)) -+ err = au_cpup_single(cpg, dst_parent); -+ else { -+ struct au_cpup_single_args args = { -+ .errp = &err, -+ .cpg = cpg, -+ .dst_parent = dst_parent -+ }; -+ wkq_err = au_wkq_wait(au_call_cpup_single, &args); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ } -+ -+ return err; -+} -+#endif -+ -+/* -+ * copyup the @dentry from the first active lower branch to @bdst, -+ * using au_cpup_single(). -+ */ -+static int au_cpup_simple(struct au_cp_generic *cpg) -+{ -+ int err; -+ unsigned int flags_orig; -+ struct dentry *dentry; -+ -+ AuDebugOn(cpg->bsrc < 0); -+ -+ dentry = cpg->dentry; -+ DiMustWriteLock(dentry); -+ -+ err = au_lkup_neg(dentry, cpg->bdst, /*wh*/1); -+ if (!err) { -+ flags_orig = cpg->flags; -+ au_fset_cpup(cpg->flags, RENAME); -+ err = au_cpup_single(cpg, NULL); -+ cpg->flags = flags_orig; -+ if (!err) -+ return 0; /* success */ -+ -+ /* revert */ -+ au_set_h_dptr(dentry, cpg->bdst, NULL); -+ au_set_dbtop(dentry, cpg->bsrc); -+ } -+ -+ return err; -+} -+ -+struct au_cpup_simple_args { -+ int *errp; -+ struct au_cp_generic *cpg; -+}; -+ -+static void au_call_cpup_simple(void *args) -+{ -+ struct au_cpup_simple_args *a = args; -+ -+ au_pin_hdir_acquire_nest(a->cpg->pin); -+ *a->errp = au_cpup_simple(a->cpg); -+ au_pin_hdir_release(a->cpg->pin); -+} -+ -+static int au_do_sio_cpup_simple(struct au_cp_generic *cpg) -+{ -+ int err, wkq_err; -+ struct dentry *dentry, *parent; -+ struct file *h_file; -+ struct inode *h_dir; -+ -+ dentry = cpg->dentry; -+ h_file = NULL; -+ if (au_ftest_cpup(cpg->flags, HOPEN)) { -+ AuDebugOn(cpg->bsrc < 0); -+ h_file = au_h_open_pre(dentry, cpg->bsrc, /*force_wr*/0); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ } -+ -+ parent = dget_parent(dentry); -+ h_dir = au_h_iptr(d_inode(parent), cpg->bdst); -+ if (!au_test_h_perm_sio(h_dir, MAY_EXEC | MAY_WRITE) -+ && !au_cpup_sio_test(cpg->pin, d_inode(dentry)->i_mode)) -+ err = au_cpup_simple(cpg); -+ else { -+ struct au_cpup_simple_args args = { -+ .errp = &err, -+ .cpg = cpg -+ }; -+ wkq_err = au_wkq_wait(au_call_cpup_simple, &args); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ } -+ -+ dput(parent); -+ if (h_file) -+ au_h_open_post(dentry, cpg->bsrc, h_file); -+ -+out: -+ return err; -+} -+ -+int au_sio_cpup_simple(struct au_cp_generic *cpg) -+{ -+ aufs_bindex_t bsrc, bbot; -+ struct dentry *dentry, *h_dentry; -+ -+ if (cpg->bsrc < 0) { -+ dentry = cpg->dentry; -+ bbot = au_dbbot(dentry); -+ for (bsrc = cpg->bdst + 1; bsrc <= bbot; bsrc++) { -+ h_dentry = au_h_dptr(dentry, bsrc); -+ if (h_dentry) { -+ AuDebugOn(d_is_negative(h_dentry)); -+ break; -+ } -+ } -+ AuDebugOn(bsrc > bbot); -+ cpg->bsrc = bsrc; -+ } -+ AuDebugOn(cpg->bsrc <= cpg->bdst); -+ return au_do_sio_cpup_simple(cpg); -+} -+ -+int au_sio_cpdown_simple(struct au_cp_generic *cpg) -+{ -+ AuDebugOn(cpg->bdst <= cpg->bsrc); -+ return au_do_sio_cpup_simple(cpg); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * copyup the deleted file for writing. -+ */ -+static int au_do_cpup_wh(struct au_cp_generic *cpg, struct dentry *wh_dentry, -+ struct file *file) -+{ -+ int err; -+ unsigned int flags_orig; -+ aufs_bindex_t bsrc_orig; -+ struct au_dinfo *dinfo; -+ struct { -+ struct au_hdentry *hd; -+ struct dentry *h_dentry; -+ } hdst, hsrc; -+ -+ dinfo = au_di(cpg->dentry); -+ AuRwMustWriteLock(&dinfo->di_rwsem); -+ -+ bsrc_orig = cpg->bsrc; -+ cpg->bsrc = dinfo->di_btop; -+ hdst.hd = au_hdentry(dinfo, cpg->bdst); -+ hdst.h_dentry = hdst.hd->hd_dentry; -+ hdst.hd->hd_dentry = wh_dentry; -+ dinfo->di_btop = cpg->bdst; -+ -+ hsrc.h_dentry = NULL; -+ if (file) { -+ hsrc.hd = au_hdentry(dinfo, cpg->bsrc); -+ hsrc.h_dentry = hsrc.hd->hd_dentry; -+ hsrc.hd->hd_dentry = au_hf_top(file)->f_path.dentry; -+ } -+ flags_orig = cpg->flags; -+ cpg->flags = !AuCpup_DTIME; -+ err = au_cpup_single(cpg, /*h_parent*/NULL); -+ cpg->flags = flags_orig; -+ if (file) { -+ if (!err) -+ err = au_reopen_nondir(file); -+ hsrc.hd->hd_dentry = hsrc.h_dentry; -+ } -+ hdst.hd->hd_dentry = hdst.h_dentry; -+ dinfo->di_btop = cpg->bsrc; -+ cpg->bsrc = bsrc_orig; -+ -+ return err; -+} -+ -+static int au_cpup_wh(struct au_cp_generic *cpg, struct file *file) -+{ -+ int err; -+ aufs_bindex_t bdst; -+ struct au_dtime dt; -+ struct dentry *dentry, *parent, *h_parent, *wh_dentry; -+ struct au_branch *br; -+ struct path h_path; -+ -+ dentry = cpg->dentry; -+ bdst = cpg->bdst; -+ br = au_sbr(dentry->d_sb, bdst); -+ parent = dget_parent(dentry); -+ h_parent = au_h_dptr(parent, bdst); -+ wh_dentry = au_whtmp_lkup(h_parent, br, &dentry->d_name); -+ err = PTR_ERR(wh_dentry); -+ if (IS_ERR(wh_dentry)) -+ goto out; -+ -+ h_path.dentry = h_parent; -+ h_path.mnt = au_br_mnt(br); -+ au_dtime_store(&dt, parent, &h_path); -+ err = au_do_cpup_wh(cpg, wh_dentry, file); -+ if (unlikely(err)) -+ goto out_wh; -+ -+ dget(wh_dentry); -+ h_path.dentry = wh_dentry; -+ if (!d_is_dir(wh_dentry)) { -+ /* no delegation since it is just created */ -+ err = vfsub_unlink(d_inode(h_parent), &h_path, -+ /*delegated*/NULL, /*force*/0); -+ } else -+ err = vfsub_rmdir(d_inode(h_parent), &h_path); -+ if (unlikely(err)) { -+ AuIOErr("failed remove copied-up tmp file %pd(%d)\n", -+ wh_dentry, err); -+ err = -EIO; -+ } -+ au_dtime_revert(&dt); -+ au_set_hi_wh(d_inode(dentry), bdst, wh_dentry); -+ -+out_wh: -+ dput(wh_dentry); -+out: -+ dput(parent); -+ return err; -+} -+ -+struct au_cpup_wh_args { -+ int *errp; -+ struct au_cp_generic *cpg; -+ struct file *file; -+}; -+ -+static void au_call_cpup_wh(void *args) -+{ -+ struct au_cpup_wh_args *a = args; -+ -+ au_pin_hdir_acquire_nest(a->cpg->pin); -+ *a->errp = au_cpup_wh(a->cpg, a->file); -+ au_pin_hdir_release(a->cpg->pin); -+} -+ -+int au_sio_cpup_wh(struct au_cp_generic *cpg, struct file *file) -+{ -+ int err, wkq_err; -+ aufs_bindex_t bdst; -+ struct dentry *dentry, *parent, *h_orph, *h_parent; -+ struct inode *dir, *h_dir, *h_tmpdir; -+ struct au_wbr *wbr; -+ struct au_pin wh_pin, *pin_orig; -+ -+ dentry = cpg->dentry; -+ bdst = cpg->bdst; -+ parent = dget_parent(dentry); -+ dir = d_inode(parent); -+ h_orph = NULL; -+ h_parent = NULL; -+ h_dir = au_igrab(au_h_iptr(dir, bdst)); -+ h_tmpdir = h_dir; -+ pin_orig = NULL; -+ if (!h_dir->i_nlink) { -+ wbr = au_sbr(dentry->d_sb, bdst)->br_wbr; -+ h_orph = wbr->wbr_orph; -+ -+ h_parent = dget(au_h_dptr(parent, bdst)); -+ au_set_h_dptr(parent, bdst, dget(h_orph)); -+ h_tmpdir = d_inode(h_orph); -+ au_set_h_iptr(dir, bdst, au_igrab(h_tmpdir), /*flags*/0); -+ -+ inode_lock_nested(h_tmpdir, AuLsc_I_PARENT3); -+ /* todo: au_h_open_pre()? */ -+ -+ pin_orig = cpg->pin; -+ au_pin_init(&wh_pin, dentry, bdst, AuLsc_DI_PARENT, -+ AuLsc_I_PARENT3, cpg->pin->udba, AuPin_DI_LOCKED); -+ cpg->pin = &wh_pin; -+ } -+ -+ if (!au_test_h_perm_sio(h_tmpdir, MAY_EXEC | MAY_WRITE) -+ && !au_cpup_sio_test(cpg->pin, d_inode(dentry)->i_mode)) -+ err = au_cpup_wh(cpg, file); -+ else { -+ struct au_cpup_wh_args args = { -+ .errp = &err, -+ .cpg = cpg, -+ .file = file -+ }; -+ wkq_err = au_wkq_wait(au_call_cpup_wh, &args); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ } -+ -+ if (h_orph) { -+ inode_unlock(h_tmpdir); -+ /* todo: au_h_open_post()? */ -+ au_set_h_iptr(dir, bdst, au_igrab(h_dir), /*flags*/0); -+ au_set_h_dptr(parent, bdst, h_parent); -+ AuDebugOn(!pin_orig); -+ cpg->pin = pin_orig; -+ } -+ iput(h_dir); -+ dput(parent); -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * generic routine for both of copy-up and copy-down. -+ */ -+/* cf. revalidate function in file.c */ -+int au_cp_dirs(struct dentry *dentry, aufs_bindex_t bdst, -+ int (*cp)(struct dentry *dentry, aufs_bindex_t bdst, -+ struct au_pin *pin, -+ struct dentry *h_parent, void *arg), -+ void *arg) -+{ -+ int err; -+ struct au_pin pin; -+ struct dentry *d, *parent, *h_parent, *real_parent, *h_dentry; -+ -+ err = 0; -+ parent = dget_parent(dentry); -+ if (IS_ROOT(parent)) -+ goto out; -+ -+ au_pin_init(&pin, dentry, bdst, AuLsc_DI_PARENT2, AuLsc_I_PARENT2, -+ au_opt_udba(dentry->d_sb), AuPin_MNT_WRITE); -+ -+ /* do not use au_dpage */ -+ real_parent = parent; -+ while (1) { -+ dput(parent); -+ parent = dget_parent(dentry); -+ h_parent = au_h_dptr(parent, bdst); -+ if (h_parent) -+ goto out; /* success */ -+ -+ /* find top dir which is necessary to cpup */ -+ do { -+ d = parent; -+ dput(parent); -+ parent = dget_parent(d); -+ di_read_lock_parent3(parent, !AuLock_IR); -+ h_parent = au_h_dptr(parent, bdst); -+ di_read_unlock(parent, !AuLock_IR); -+ } while (!h_parent); -+ -+ if (d != real_parent) -+ di_write_lock_child3(d); -+ -+ /* somebody else might create while we were sleeping */ -+ h_dentry = au_h_dptr(d, bdst); -+ if (!h_dentry || d_is_negative(h_dentry)) { -+ if (h_dentry) -+ au_update_dbtop(d); -+ -+ au_pin_set_dentry(&pin, d); -+ err = au_do_pin(&pin); -+ if (!err) { -+ err = cp(d, bdst, &pin, h_parent, arg); -+ au_unpin(&pin); -+ } -+ } -+ -+ if (d != real_parent) -+ di_write_unlock(d); -+ if (unlikely(err)) -+ break; -+ } -+ -+out: -+ dput(parent); -+ return err; -+} -+ -+static int au_cpup_dir(struct dentry *dentry, aufs_bindex_t bdst, -+ struct au_pin *pin, -+ struct dentry *h_parent __maybe_unused, -+ void *arg __maybe_unused) -+{ -+ struct au_cp_generic cpg = { -+ .dentry = dentry, -+ .bdst = bdst, -+ .bsrc = -1, -+ .len = 0, -+ .pin = pin, -+ .flags = AuCpup_DTIME -+ }; -+ return au_sio_cpup_simple(&cpg); -+} -+ -+int au_cpup_dirs(struct dentry *dentry, aufs_bindex_t bdst) -+{ -+ return au_cp_dirs(dentry, bdst, au_cpup_dir, NULL); -+} -+ -+int au_test_and_cpup_dirs(struct dentry *dentry, aufs_bindex_t bdst) -+{ -+ int err; -+ struct dentry *parent; -+ struct inode *dir; -+ -+ parent = dget_parent(dentry); -+ dir = d_inode(parent); -+ err = 0; -+ if (au_h_iptr(dir, bdst)) -+ goto out; -+ -+ di_read_unlock(parent, AuLock_IR); -+ di_write_lock_parent(parent); -+ /* someone else might change our inode while we were sleeping */ -+ if (!au_h_iptr(dir, bdst)) -+ err = au_cpup_dirs(dentry, bdst); -+ di_downgrade_lock(parent, AuLock_IR); -+ -+out: -+ dput(parent); -+ return err; -+} -diff --git a/fs/aufs/cpup.h b/fs/aufs/cpup.h -new file mode 100644 -index 000000000000..22c5f5402939 ---- /dev/null -+++ b/fs/aufs/cpup.h -@@ -0,0 +1,87 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * copy-up/down functions -+ */ -+ -+#ifndef __AUFS_CPUP_H__ -+#define __AUFS_CPUP_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+ -+struct inode; -+struct file; -+struct au_pin; -+ -+void au_cpup_attr_flags(struct inode *dst, unsigned int iflags); -+void au_cpup_attr_timesizes(struct inode *inode); -+void au_cpup_attr_nlink(struct inode *inode, int force); -+void au_cpup_attr_changeable(struct inode *inode); -+void au_cpup_igen(struct inode *inode, struct inode *h_inode); -+void au_cpup_attr_all(struct inode *inode, int force); -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct au_cp_generic { -+ struct dentry *dentry; -+ aufs_bindex_t bdst, bsrc; -+ loff_t len; -+ struct au_pin *pin; -+ unsigned int flags; -+}; -+ -+/* cpup flags */ -+#define AuCpup_DTIME 1 /* do dtime_store/revert */ -+#define AuCpup_KEEPLINO (1 << 1) /* do not clear the lower xino, -+ for link(2) */ -+#define AuCpup_RENAME (1 << 2) /* rename after cpup */ -+#define AuCpup_HOPEN (1 << 3) /* call h_open_pre/post() in -+ cpup */ -+#define AuCpup_OVERWRITE (1 << 4) /* allow overwriting the -+ existing entry */ -+#define AuCpup_RWDST (1 << 5) /* force write target even if -+ the branch is marked as RO */ -+ -+#ifndef CONFIG_AUFS_BR_HFSPLUS -+#undef AuCpup_HOPEN -+#define AuCpup_HOPEN 0 -+#endif -+ -+#define au_ftest_cpup(flags, name) ((flags) & AuCpup_##name) -+#define au_fset_cpup(flags, name) \ -+ do { (flags) |= AuCpup_##name; } while (0) -+#define au_fclr_cpup(flags, name) \ -+ do { (flags) &= ~AuCpup_##name; } while (0) -+ -+int au_copy_file(struct file *dst, struct file *src, loff_t len); -+int au_sio_cpup_simple(struct au_cp_generic *cpg); -+int au_sio_cpdown_simple(struct au_cp_generic *cpg); -+int au_sio_cpup_wh(struct au_cp_generic *cpg, struct file *file); -+ -+int au_cp_dirs(struct dentry *dentry, aufs_bindex_t bdst, -+ int (*cp)(struct dentry *dentry, aufs_bindex_t bdst, -+ struct au_pin *pin, -+ struct dentry *h_parent, void *arg), -+ void *arg); -+int au_cpup_dirs(struct dentry *dentry, aufs_bindex_t bdst); -+int au_test_and_cpup_dirs(struct dentry *dentry, aufs_bindex_t bdst); -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* keep timestamps when copyup */ -+struct au_dtime { -+ struct dentry *dt_dentry; -+ struct path dt_h_path; -+ struct timespec dt_atime, dt_mtime; -+}; -+void au_dtime_store(struct au_dtime *dt, struct dentry *dentry, -+ struct path *h_path); -+void au_dtime_revert(struct au_dtime *dt); -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_CPUP_H__ */ -diff --git a/fs/aufs/dbgaufs.c b/fs/aufs/dbgaufs.c -new file mode 100644 -index 000000000000..ec512d378dda ---- /dev/null -+++ b/fs/aufs/dbgaufs.c -@@ -0,0 +1,425 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * debugfs interface -+ */ -+ -+#include -+#include "aufs.h" -+ -+#ifndef CONFIG_SYSFS -+#error DEBUG_FS depends upon SYSFS -+#endif -+ -+static struct dentry *dbgaufs; -+static const mode_t dbgaufs_mode = S_IRUSR | S_IRGRP | S_IROTH; -+ -+/* 20 is max digits length of ulong 64 */ -+struct dbgaufs_arg { -+ int n; -+ char a[20 * 4]; -+}; -+ -+/* -+ * common function for all XINO files -+ */ -+static int dbgaufs_xi_release(struct inode *inode __maybe_unused, -+ struct file *file) -+{ -+ kfree(file->private_data); -+ return 0; -+} -+ -+static int dbgaufs_xi_open(struct file *xf, struct file *file, int do_fcnt) -+{ -+ int err; -+ struct kstat st; -+ struct dbgaufs_arg *p; -+ -+ err = -ENOMEM; -+ p = kmalloc(sizeof(*p), GFP_NOFS); -+ if (unlikely(!p)) -+ goto out; -+ -+ err = 0; -+ p->n = 0; -+ file->private_data = p; -+ if (!xf) -+ goto out; -+ -+ err = vfsub_getattr(&xf->f_path, &st); -+ if (!err) { -+ if (do_fcnt) -+ p->n = snprintf -+ (p->a, sizeof(p->a), "%ld, %llux%u %lld\n", -+ (long)file_count(xf), st.blocks, st.blksize, -+ (long long)st.size); -+ else -+ p->n = snprintf(p->a, sizeof(p->a), "%llux%u %lld\n", -+ st.blocks, st.blksize, -+ (long long)st.size); -+ AuDebugOn(p->n >= sizeof(p->a)); -+ } else { -+ p->n = snprintf(p->a, sizeof(p->a), "err %d\n", err); -+ err = 0; -+ } -+ -+out: -+ return err; -+ -+} -+ -+static ssize_t dbgaufs_xi_read(struct file *file, char __user *buf, -+ size_t count, loff_t *ppos) -+{ -+ struct dbgaufs_arg *p; -+ -+ p = file->private_data; -+ return simple_read_from_buffer(buf, count, ppos, p->a, p->n); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct dbgaufs_plink_arg { -+ int n; -+ char a[]; -+}; -+ -+static int dbgaufs_plink_release(struct inode *inode __maybe_unused, -+ struct file *file) -+{ -+ free_page((unsigned long)file->private_data); -+ return 0; -+} -+ -+static int dbgaufs_plink_open(struct inode *inode, struct file *file) -+{ -+ int err, i, limit; -+ unsigned long n, sum; -+ struct dbgaufs_plink_arg *p; -+ struct au_sbinfo *sbinfo; -+ struct super_block *sb; -+ struct hlist_bl_head *hbl; -+ -+ err = -ENOMEM; -+ p = (void *)get_zeroed_page(GFP_NOFS); -+ if (unlikely(!p)) -+ goto out; -+ -+ err = -EFBIG; -+ sbinfo = inode->i_private; -+ sb = sbinfo->si_sb; -+ si_noflush_read_lock(sb); -+ if (au_opt_test(au_mntflags(sb), PLINK)) { -+ limit = PAGE_SIZE - sizeof(p->n); -+ -+ /* the number of buckets */ -+ n = snprintf(p->a + p->n, limit, "%d\n", AuPlink_NHASH); -+ p->n += n; -+ limit -= n; -+ -+ sum = 0; -+ for (i = 0, hbl = sbinfo->si_plink; i < AuPlink_NHASH; -+ i++, hbl++) { -+ n = au_hbl_count(hbl); -+ sum += n; -+ -+ n = snprintf(p->a + p->n, limit, "%lu ", n); -+ p->n += n; -+ limit -= n; -+ if (unlikely(limit <= 0)) -+ goto out_free; -+ } -+ p->a[p->n - 1] = '\n'; -+ -+ /* the sum of plinks */ -+ n = snprintf(p->a + p->n, limit, "%lu\n", sum); -+ p->n += n; -+ limit -= n; -+ if (unlikely(limit <= 0)) -+ goto out_free; -+ } else { -+#define str "1\n0\n0\n" -+ p->n = sizeof(str) - 1; -+ strcpy(p->a, str); -+#undef str -+ } -+ si_read_unlock(sb); -+ -+ err = 0; -+ file->private_data = p; -+ goto out; /* success */ -+ -+out_free: -+ free_page((unsigned long)p); -+out: -+ return err; -+} -+ -+static ssize_t dbgaufs_plink_read(struct file *file, char __user *buf, -+ size_t count, loff_t *ppos) -+{ -+ struct dbgaufs_plink_arg *p; -+ -+ p = file->private_data; -+ return simple_read_from_buffer(buf, count, ppos, p->a, p->n); -+} -+ -+static const struct file_operations dbgaufs_plink_fop = { -+ .owner = THIS_MODULE, -+ .open = dbgaufs_plink_open, -+ .release = dbgaufs_plink_release, -+ .read = dbgaufs_plink_read -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int dbgaufs_xib_open(struct inode *inode, struct file *file) -+{ -+ int err; -+ struct au_sbinfo *sbinfo; -+ struct super_block *sb; -+ -+ sbinfo = inode->i_private; -+ sb = sbinfo->si_sb; -+ si_noflush_read_lock(sb); -+ err = dbgaufs_xi_open(sbinfo->si_xib, file, /*do_fcnt*/0); -+ si_read_unlock(sb); -+ return err; -+} -+ -+static const struct file_operations dbgaufs_xib_fop = { -+ .owner = THIS_MODULE, -+ .open = dbgaufs_xib_open, -+ .release = dbgaufs_xi_release, -+ .read = dbgaufs_xi_read -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+#define DbgaufsXi_PREFIX "xi" -+ -+static int dbgaufs_xino_open(struct inode *inode, struct file *file) -+{ -+ int err; -+ long l; -+ struct au_sbinfo *sbinfo; -+ struct super_block *sb; -+ struct file *xf; -+ struct qstr *name; -+ -+ err = -ENOENT; -+ xf = NULL; -+ name = &file->f_path.dentry->d_name; -+ if (unlikely(name->len < sizeof(DbgaufsXi_PREFIX) -+ || memcmp(name->name, DbgaufsXi_PREFIX, -+ sizeof(DbgaufsXi_PREFIX) - 1))) -+ goto out; -+ err = kstrtol(name->name + sizeof(DbgaufsXi_PREFIX) - 1, 10, &l); -+ if (unlikely(err)) -+ goto out; -+ -+ sbinfo = inode->i_private; -+ sb = sbinfo->si_sb; -+ si_noflush_read_lock(sb); -+ if (l <= au_sbbot(sb)) { -+ xf = au_sbr(sb, (aufs_bindex_t)l)->br_xino.xi_file; -+ err = dbgaufs_xi_open(xf, file, /*do_fcnt*/1); -+ } else -+ err = -ENOENT; -+ si_read_unlock(sb); -+ -+out: -+ return err; -+} -+ -+static const struct file_operations dbgaufs_xino_fop = { -+ .owner = THIS_MODULE, -+ .open = dbgaufs_xino_open, -+ .release = dbgaufs_xi_release, -+ .read = dbgaufs_xi_read -+}; -+ -+void dbgaufs_brs_del(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ aufs_bindex_t bbot; -+ struct au_branch *br; -+ struct au_xino_file *xi; -+ -+ if (!au_sbi(sb)->si_dbgaufs) -+ return; -+ -+ bbot = au_sbbot(sb); -+ for (; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ xi = &br->br_xino; -+ /* debugfs acquires the parent i_mutex */ -+ lockdep_off(); -+ debugfs_remove(xi->xi_dbgaufs); -+ lockdep_on(); -+ xi->xi_dbgaufs = NULL; -+ } -+} -+ -+void dbgaufs_brs_add(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ struct au_sbinfo *sbinfo; -+ struct dentry *parent; -+ struct au_branch *br; -+ struct au_xino_file *xi; -+ aufs_bindex_t bbot; -+ char name[sizeof(DbgaufsXi_PREFIX) + 5]; /* "xi" bindex NULL */ -+ -+ sbinfo = au_sbi(sb); -+ parent = sbinfo->si_dbgaufs; -+ if (!parent) -+ return; -+ -+ bbot = au_sbbot(sb); -+ for (; bindex <= bbot; bindex++) { -+ snprintf(name, sizeof(name), DbgaufsXi_PREFIX "%d", bindex); -+ br = au_sbr(sb, bindex); -+ xi = &br->br_xino; -+ AuDebugOn(xi->xi_dbgaufs); -+ /* debugfs acquires the parent i_mutex */ -+ lockdep_off(); -+ xi->xi_dbgaufs = debugfs_create_file(name, dbgaufs_mode, parent, -+ sbinfo, &dbgaufs_xino_fop); -+ lockdep_on(); -+ /* ignore an error */ -+ if (unlikely(!xi->xi_dbgaufs)) -+ AuWarn1("failed %s under debugfs\n", name); -+ } -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+#ifdef CONFIG_AUFS_EXPORT -+static int dbgaufs_xigen_open(struct inode *inode, struct file *file) -+{ -+ int err; -+ struct au_sbinfo *sbinfo; -+ struct super_block *sb; -+ -+ sbinfo = inode->i_private; -+ sb = sbinfo->si_sb; -+ si_noflush_read_lock(sb); -+ err = dbgaufs_xi_open(sbinfo->si_xigen, file, /*do_fcnt*/0); -+ si_read_unlock(sb); -+ return err; -+} -+ -+static const struct file_operations dbgaufs_xigen_fop = { -+ .owner = THIS_MODULE, -+ .open = dbgaufs_xigen_open, -+ .release = dbgaufs_xi_release, -+ .read = dbgaufs_xi_read -+}; -+ -+static int dbgaufs_xigen_init(struct au_sbinfo *sbinfo) -+{ -+ int err; -+ -+ /* -+ * This function is a dynamic '__init' function actually, -+ * so the tiny check for si_rwsem is unnecessary. -+ */ -+ /* AuRwMustWriteLock(&sbinfo->si_rwsem); */ -+ -+ err = -EIO; -+ sbinfo->si_dbgaufs_xigen = debugfs_create_file -+ ("xigen", dbgaufs_mode, sbinfo->si_dbgaufs, sbinfo, -+ &dbgaufs_xigen_fop); -+ if (sbinfo->si_dbgaufs_xigen) -+ err = 0; -+ -+ return err; -+} -+#else -+static int dbgaufs_xigen_init(struct au_sbinfo *sbinfo) -+{ -+ return 0; -+} -+#endif /* CONFIG_AUFS_EXPORT */ -+ -+/* ---------------------------------------------------------------------- */ -+ -+void dbgaufs_si_fin(struct au_sbinfo *sbinfo) -+{ -+ /* -+ * This function is a dynamic '__fin' function actually, -+ * so the tiny check for si_rwsem is unnecessary. -+ */ -+ /* AuRwMustWriteLock(&sbinfo->si_rwsem); */ -+ -+ debugfs_remove_recursive(sbinfo->si_dbgaufs); -+ sbinfo->si_dbgaufs = NULL; -+ kobject_put(&sbinfo->si_kobj); -+} -+ -+int dbgaufs_si_init(struct au_sbinfo *sbinfo) -+{ -+ int err; -+ char name[SysaufsSiNameLen]; -+ -+ /* -+ * This function is a dynamic '__init' function actually, -+ * so the tiny check for si_rwsem is unnecessary. -+ */ -+ /* AuRwMustWriteLock(&sbinfo->si_rwsem); */ -+ -+ err = -ENOENT; -+ if (!dbgaufs) { -+ AuErr1("/debug/aufs is uninitialized\n"); -+ goto out; -+ } -+ -+ err = -EIO; -+ sysaufs_name(sbinfo, name); -+ sbinfo->si_dbgaufs = debugfs_create_dir(name, dbgaufs); -+ if (unlikely(!sbinfo->si_dbgaufs)) -+ goto out; -+ kobject_get(&sbinfo->si_kobj); -+ -+ sbinfo->si_dbgaufs_xib = debugfs_create_file -+ ("xib", dbgaufs_mode, sbinfo->si_dbgaufs, sbinfo, -+ &dbgaufs_xib_fop); -+ if (unlikely(!sbinfo->si_dbgaufs_xib)) -+ goto out_dir; -+ -+ sbinfo->si_dbgaufs_plink = debugfs_create_file -+ ("plink", dbgaufs_mode, sbinfo->si_dbgaufs, sbinfo, -+ &dbgaufs_plink_fop); -+ if (unlikely(!sbinfo->si_dbgaufs_plink)) -+ goto out_dir; -+ -+ err = dbgaufs_xigen_init(sbinfo); -+ if (!err) -+ goto out; /* success */ -+ -+out_dir: -+ dbgaufs_si_fin(sbinfo); -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void dbgaufs_fin(void) -+{ -+ debugfs_remove(dbgaufs); -+} -+ -+int __init dbgaufs_init(void) -+{ -+ int err; -+ -+ err = -EIO; -+ dbgaufs = debugfs_create_dir(AUFS_NAME, NULL); -+ if (dbgaufs) -+ err = 0; -+ return err; -+} -diff --git a/fs/aufs/dbgaufs.h b/fs/aufs/dbgaufs.h -new file mode 100644 -index 000000000000..323a96962aef ---- /dev/null -+++ b/fs/aufs/dbgaufs.h -@@ -0,0 +1,36 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * debugfs interface -+ */ -+ -+#ifndef __DBGAUFS_H__ -+#define __DBGAUFS_H__ -+ -+#ifdef __KERNEL__ -+ -+struct super_block; -+struct au_sbinfo; -+ -+#ifdef CONFIG_DEBUG_FS -+/* dbgaufs.c */ -+void dbgaufs_brs_del(struct super_block *sb, aufs_bindex_t bindex); -+void dbgaufs_brs_add(struct super_block *sb, aufs_bindex_t bindex); -+void dbgaufs_si_fin(struct au_sbinfo *sbinfo); -+int dbgaufs_si_init(struct au_sbinfo *sbinfo); -+void dbgaufs_fin(void); -+int __init dbgaufs_init(void); -+#else -+AuStubVoid(dbgaufs_brs_del, struct super_block *sb, aufs_bindex_t bindex) -+AuStubVoid(dbgaufs_brs_add, struct super_block *sb, aufs_bindex_t bindex) -+AuStubVoid(dbgaufs_si_fin, struct au_sbinfo *sbinfo) -+AuStubInt0(dbgaufs_si_init, struct au_sbinfo *sbinfo) -+AuStubVoid(dbgaufs_fin, void) -+AuStubInt0(__init dbgaufs_init, void) -+#endif /* CONFIG_DEBUG_FS */ -+ -+#endif /* __KERNEL__ */ -+#endif /* __DBGAUFS_H__ */ -diff --git a/fs/aufs/dcsub.c b/fs/aufs/dcsub.c -new file mode 100644 -index 000000000000..0541d11207f2 ---- /dev/null -+++ b/fs/aufs/dcsub.c -@@ -0,0 +1,213 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * sub-routines for dentry cache -+ */ -+ -+#include "aufs.h" -+ -+static void au_dpage_free(struct au_dpage *dpage) -+{ -+ int i; -+ struct dentry **p; -+ -+ p = dpage->dentries; -+ for (i = 0; i < dpage->ndentry; i++) -+ dput(*p++); -+ free_page((unsigned long)dpage->dentries); -+} -+ -+int au_dpages_init(struct au_dcsub_pages *dpages, gfp_t gfp) -+{ -+ int err; -+ void *p; -+ -+ err = -ENOMEM; -+ dpages->dpages = kmalloc(sizeof(*dpages->dpages), gfp); -+ if (unlikely(!dpages->dpages)) -+ goto out; -+ -+ p = (void *)__get_free_page(gfp); -+ if (unlikely(!p)) -+ goto out_dpages; -+ -+ dpages->dpages[0].ndentry = 0; -+ dpages->dpages[0].dentries = p; -+ dpages->ndpage = 1; -+ return 0; /* success */ -+ -+out_dpages: -+ kfree(dpages->dpages); -+out: -+ return err; -+} -+ -+void au_dpages_free(struct au_dcsub_pages *dpages) -+{ -+ int i; -+ struct au_dpage *p; -+ -+ p = dpages->dpages; -+ for (i = 0; i < dpages->ndpage; i++) -+ au_dpage_free(p++); -+ kfree(dpages->dpages); -+} -+ -+static int au_dpages_append(struct au_dcsub_pages *dpages, -+ struct dentry *dentry, gfp_t gfp) -+{ -+ int err, sz; -+ struct au_dpage *dpage; -+ void *p; -+ -+ dpage = dpages->dpages + dpages->ndpage - 1; -+ sz = PAGE_SIZE / sizeof(dentry); -+ if (unlikely(dpage->ndentry >= sz)) { -+ AuLabel(new dpage); -+ err = -ENOMEM; -+ sz = dpages->ndpage * sizeof(*dpages->dpages); -+ p = au_kzrealloc(dpages->dpages, sz, -+ sz + sizeof(*dpages->dpages), gfp, -+ /*may_shrink*/0); -+ if (unlikely(!p)) -+ goto out; -+ -+ dpages->dpages = p; -+ dpage = dpages->dpages + dpages->ndpage; -+ p = (void *)__get_free_page(gfp); -+ if (unlikely(!p)) -+ goto out; -+ -+ dpage->ndentry = 0; -+ dpage->dentries = p; -+ dpages->ndpage++; -+ } -+ -+ AuDebugOn(au_dcount(dentry) <= 0); -+ dpage->dentries[dpage->ndentry++] = dget_dlock(dentry); -+ return 0; /* success */ -+ -+out: -+ return err; -+} -+ -+/* todo: BAD approach */ -+/* copied from linux/fs/dcache.c */ -+enum d_walk_ret { -+ D_WALK_CONTINUE, -+ D_WALK_QUIT, -+ D_WALK_NORETRY, -+ D_WALK_SKIP, -+}; -+ -+extern void d_walk(struct dentry *parent, void *data, -+ enum d_walk_ret (*enter)(void *, struct dentry *), -+ void (*finish)(void *)); -+ -+struct ac_dpages_arg { -+ int err; -+ struct au_dcsub_pages *dpages; -+ struct super_block *sb; -+ au_dpages_test test; -+ void *arg; -+}; -+ -+static enum d_walk_ret au_call_dpages_append(void *_arg, struct dentry *dentry) -+{ -+ enum d_walk_ret ret; -+ struct ac_dpages_arg *arg = _arg; -+ -+ ret = D_WALK_CONTINUE; -+ if (dentry->d_sb == arg->sb -+ && !IS_ROOT(dentry) -+ && au_dcount(dentry) > 0 -+ && au_di(dentry) -+ && (!arg->test || arg->test(dentry, arg->arg))) { -+ arg->err = au_dpages_append(arg->dpages, dentry, GFP_ATOMIC); -+ if (unlikely(arg->err)) -+ ret = D_WALK_QUIT; -+ } -+ -+ return ret; -+} -+ -+int au_dcsub_pages(struct au_dcsub_pages *dpages, struct dentry *root, -+ au_dpages_test test, void *arg) -+{ -+ struct ac_dpages_arg args = { -+ .err = 0, -+ .dpages = dpages, -+ .sb = root->d_sb, -+ .test = test, -+ .arg = arg -+ }; -+ -+ d_walk(root, &args, au_call_dpages_append, NULL); -+ -+ return args.err; -+} -+ -+int au_dcsub_pages_rev(struct au_dcsub_pages *dpages, struct dentry *dentry, -+ int do_include, au_dpages_test test, void *arg) -+{ -+ int err; -+ -+ err = 0; -+ write_seqlock(&rename_lock); -+ spin_lock(&dentry->d_lock); -+ if (do_include -+ && au_dcount(dentry) > 0 -+ && (!test || test(dentry, arg))) -+ err = au_dpages_append(dpages, dentry, GFP_ATOMIC); -+ spin_unlock(&dentry->d_lock); -+ if (unlikely(err)) -+ goto out; -+ -+ /* -+ * RCU for vfsmount is unnecessary since this is a traverse in a single -+ * mount -+ */ -+ while (!IS_ROOT(dentry)) { -+ dentry = dentry->d_parent; /* rename_lock is locked */ -+ spin_lock(&dentry->d_lock); -+ if (au_dcount(dentry) > 0 -+ && (!test || test(dentry, arg))) -+ err = au_dpages_append(dpages, dentry, GFP_ATOMIC); -+ spin_unlock(&dentry->d_lock); -+ if (unlikely(err)) -+ break; -+ } -+ -+out: -+ write_sequnlock(&rename_lock); -+ return err; -+} -+ -+static inline int au_dcsub_dpages_aufs(struct dentry *dentry, void *arg) -+{ -+ return au_di(dentry) && dentry->d_sb == arg; -+} -+ -+int au_dcsub_pages_rev_aufs(struct au_dcsub_pages *dpages, -+ struct dentry *dentry, int do_include) -+{ -+ return au_dcsub_pages_rev(dpages, dentry, do_include, -+ au_dcsub_dpages_aufs, dentry->d_sb); -+} -+ -+int au_test_subdir(struct dentry *d1, struct dentry *d2) -+{ -+ struct path path[2] = { -+ { -+ .dentry = d1 -+ }, -+ { -+ .dentry = d2 -+ } -+ }; -+ -+ return path_is_under(path + 0, path + 1); -+} -diff --git a/fs/aufs/dcsub.h b/fs/aufs/dcsub.h -new file mode 100644 -index 000000000000..3b19330c1f50 ---- /dev/null -+++ b/fs/aufs/dcsub.h -@@ -0,0 +1,124 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * sub-routines for dentry cache -+ */ -+ -+#ifndef __AUFS_DCSUB_H__ -+#define __AUFS_DCSUB_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+#include -+ -+struct au_dpage { -+ int ndentry; -+ struct dentry **dentries; -+}; -+ -+struct au_dcsub_pages { -+ int ndpage; -+ struct au_dpage *dpages; -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* dcsub.c */ -+int au_dpages_init(struct au_dcsub_pages *dpages, gfp_t gfp); -+void au_dpages_free(struct au_dcsub_pages *dpages); -+typedef int (*au_dpages_test)(struct dentry *dentry, void *arg); -+int au_dcsub_pages(struct au_dcsub_pages *dpages, struct dentry *root, -+ au_dpages_test test, void *arg); -+int au_dcsub_pages_rev(struct au_dcsub_pages *dpages, struct dentry *dentry, -+ int do_include, au_dpages_test test, void *arg); -+int au_dcsub_pages_rev_aufs(struct au_dcsub_pages *dpages, -+ struct dentry *dentry, int do_include); -+int au_test_subdir(struct dentry *d1, struct dentry *d2); -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * todo: in linux-3.13, several similar (but faster) helpers are added to -+ * include/linux/dcache.h. Try them (in the future). -+ */ -+ -+static inline int au_d_hashed_positive(struct dentry *d) -+{ -+ int err; -+ struct inode *inode = d_inode(d); -+ -+ err = 0; -+ if (unlikely(d_unhashed(d) -+ || d_is_negative(d) -+ || !inode->i_nlink)) -+ err = -ENOENT; -+ return err; -+} -+ -+static inline int au_d_linkable(struct dentry *d) -+{ -+ int err; -+ struct inode *inode = d_inode(d); -+ -+ err = au_d_hashed_positive(d); -+ if (err -+ && d_is_positive(d) -+ && (inode->i_state & I_LINKABLE)) -+ err = 0; -+ return err; -+} -+ -+static inline int au_d_alive(struct dentry *d) -+{ -+ int err; -+ struct inode *inode; -+ -+ err = 0; -+ if (!IS_ROOT(d)) -+ err = au_d_hashed_positive(d); -+ else { -+ inode = d_inode(d); -+ if (unlikely(d_unlinked(d) -+ || d_is_negative(d) -+ || !inode->i_nlink)) -+ err = -ENOENT; -+ } -+ return err; -+} -+ -+static inline int au_alive_dir(struct dentry *d) -+{ -+ int err; -+ -+ err = au_d_alive(d); -+ if (unlikely(err || IS_DEADDIR(d_inode(d)))) -+ err = -ENOENT; -+ return err; -+} -+ -+static inline int au_qstreq(struct qstr *a, struct qstr *b) -+{ -+ return a->len == b->len -+ && !memcmp(a->name, b->name, a->len); -+} -+ -+/* -+ * by the commit -+ * 360f547 2015-01-25 dcache: let the dentry count go down to zero without -+ * taking d_lock -+ * the type of d_lockref.count became int, but the inlined function d_count() -+ * still returns unsigned int. -+ * I don't know why. Maybe it is for every d_count() users? -+ * Anyway au_dcount() lives on. -+ */ -+static inline int au_dcount(struct dentry *d) -+{ -+ return (int)d_count(d); -+} -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_DCSUB_H__ */ -diff --git a/fs/aufs/debug.c b/fs/aufs/debug.c -new file mode 100644 -index 000000000000..7b39a8d5965d ---- /dev/null -+++ b/fs/aufs/debug.c -@@ -0,0 +1,428 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * debug print functions -+ */ -+ -+#include "aufs.h" -+ -+/* Returns 0, or -errno. arg is in kp->arg. */ -+static int param_atomic_t_set(const char *val, const struct kernel_param *kp) -+{ -+ int err, n; -+ -+ err = kstrtoint(val, 0, &n); -+ if (!err) { -+ if (n > 0) -+ au_debug_on(); -+ else -+ au_debug_off(); -+ } -+ return err; -+} -+ -+/* Returns length written or -errno. Buffer is 4k (ie. be short!) */ -+static int param_atomic_t_get(char *buffer, const struct kernel_param *kp) -+{ -+ atomic_t *a; -+ -+ a = kp->arg; -+ return sprintf(buffer, "%d", atomic_read(a)); -+} -+ -+static struct kernel_param_ops param_ops_atomic_t = { -+ .set = param_atomic_t_set, -+ .get = param_atomic_t_get -+ /* void (*free)(void *arg) */ -+}; -+ -+atomic_t aufs_debug = ATOMIC_INIT(0); -+MODULE_PARM_DESC(debug, "debug print"); -+module_param_named(debug, aufs_debug, atomic_t, S_IRUGO | S_IWUSR | S_IWGRP); -+ -+DEFINE_MUTEX(au_dbg_mtx); /* just to serialize the dbg msgs */ -+char *au_plevel = KERN_DEBUG; -+#define dpri(fmt, ...) do { \ -+ if ((au_plevel \ -+ && strcmp(au_plevel, KERN_DEBUG)) \ -+ || au_debug_test()) \ -+ printk("%s" fmt, au_plevel, ##__VA_ARGS__); \ -+} while (0) -+ -+/* ---------------------------------------------------------------------- */ -+ -+void au_dpri_whlist(struct au_nhash *whlist) -+{ -+ unsigned long ul, n; -+ struct hlist_head *head; -+ struct au_vdir_wh *pos; -+ -+ n = whlist->nh_num; -+ head = whlist->nh_head; -+ for (ul = 0; ul < n; ul++) { -+ hlist_for_each_entry(pos, head, wh_hash) -+ dpri("b%d, %.*s, %d\n", -+ pos->wh_bindex, -+ pos->wh_str.len, pos->wh_str.name, -+ pos->wh_str.len); -+ head++; -+ } -+} -+ -+void au_dpri_vdir(struct au_vdir *vdir) -+{ -+ unsigned long ul; -+ union au_vdir_deblk_p p; -+ unsigned char *o; -+ -+ if (!vdir || IS_ERR(vdir)) { -+ dpri("err %ld\n", PTR_ERR(vdir)); -+ return; -+ } -+ -+ dpri("deblk %u, nblk %lu, deblk %p, last{%lu, %p}, ver %lu\n", -+ vdir->vd_deblk_sz, vdir->vd_nblk, vdir->vd_deblk, -+ vdir->vd_last.ul, vdir->vd_last.p.deblk, vdir->vd_version); -+ for (ul = 0; ul < vdir->vd_nblk; ul++) { -+ p.deblk = vdir->vd_deblk[ul]; -+ o = p.deblk; -+ dpri("[%lu]: %p\n", ul, o); -+ } -+} -+ -+static int do_pri_inode(aufs_bindex_t bindex, struct inode *inode, int hn, -+ struct dentry *wh) -+{ -+ char *n = NULL; -+ int l = 0; -+ -+ if (!inode || IS_ERR(inode)) { -+ dpri("i%d: err %ld\n", bindex, PTR_ERR(inode)); -+ return -1; -+ } -+ -+ /* the type of i_blocks depends upon CONFIG_LBDAF */ -+ BUILD_BUG_ON(sizeof(inode->i_blocks) != sizeof(unsigned long) -+ && sizeof(inode->i_blocks) != sizeof(u64)); -+ if (wh) { -+ n = (void *)wh->d_name.name; -+ l = wh->d_name.len; -+ } -+ -+ dpri("i%d: %p, i%lu, %s, cnt %d, nl %u, 0%o, sz %llu, blk %llu," -+ " hn %d, ct %lld, np %lu, st 0x%lx, f 0x%x, v %llu, g %x%s%.*s\n", -+ bindex, inode, -+ inode->i_ino, inode->i_sb ? au_sbtype(inode->i_sb) : "??", -+ atomic_read(&inode->i_count), inode->i_nlink, inode->i_mode, -+ i_size_read(inode), (unsigned long long)inode->i_blocks, -+ hn, (long long)timespec_to_ns(&inode->i_ctime) & 0x0ffff, -+ inode->i_mapping ? inode->i_mapping->nrpages : 0, -+ inode->i_state, inode->i_flags, inode->i_version, -+ inode->i_generation, -+ l ? ", wh " : "", l, n); -+ return 0; -+} -+ -+void au_dpri_inode(struct inode *inode) -+{ -+ struct au_iinfo *iinfo; -+ struct au_hinode *hi; -+ aufs_bindex_t bindex; -+ int err, hn; -+ -+ err = do_pri_inode(-1, inode, -1, NULL); -+ if (err || !au_test_aufs(inode->i_sb) || au_is_bad_inode(inode)) -+ return; -+ -+ iinfo = au_ii(inode); -+ dpri("i-1: btop %d, bbot %d, gen %d\n", -+ iinfo->ii_btop, iinfo->ii_bbot, au_iigen(inode, NULL)); -+ if (iinfo->ii_btop < 0) -+ return; -+ hn = 0; -+ for (bindex = iinfo->ii_btop; bindex <= iinfo->ii_bbot; bindex++) { -+ hi = au_hinode(iinfo, bindex); -+ hn = !!au_hn(hi); -+ do_pri_inode(bindex, hi->hi_inode, hn, hi->hi_whdentry); -+ } -+} -+ -+void au_dpri_dalias(struct inode *inode) -+{ -+ struct dentry *d; -+ -+ spin_lock(&inode->i_lock); -+ hlist_for_each_entry(d, &inode->i_dentry, d_u.d_alias) -+ au_dpri_dentry(d); -+ spin_unlock(&inode->i_lock); -+} -+ -+static int do_pri_dentry(aufs_bindex_t bindex, struct dentry *dentry) -+{ -+ struct dentry *wh = NULL; -+ int hn; -+ struct inode *inode; -+ struct au_iinfo *iinfo; -+ struct au_hinode *hi; -+ -+ if (!dentry || IS_ERR(dentry)) { -+ dpri("d%d: err %ld\n", bindex, PTR_ERR(dentry)); -+ return -1; -+ } -+ /* do not call dget_parent() here */ -+ /* note: access d_xxx without d_lock */ -+ dpri("d%d: %p, %pd2?, %s, cnt %d, flags 0x%x, %shashed\n", -+ bindex, dentry, dentry, -+ dentry->d_sb ? au_sbtype(dentry->d_sb) : "??", -+ au_dcount(dentry), dentry->d_flags, -+ d_unhashed(dentry) ? "un" : ""); -+ hn = -1; -+ inode = NULL; -+ if (d_is_positive(dentry)) -+ inode = d_inode(dentry); -+ if (inode -+ && au_test_aufs(dentry->d_sb) -+ && bindex >= 0 -+ && !au_is_bad_inode(inode)) { -+ iinfo = au_ii(inode); -+ hi = au_hinode(iinfo, bindex); -+ hn = !!au_hn(hi); -+ wh = hi->hi_whdentry; -+ } -+ do_pri_inode(bindex, inode, hn, wh); -+ return 0; -+} -+ -+void au_dpri_dentry(struct dentry *dentry) -+{ -+ struct au_dinfo *dinfo; -+ aufs_bindex_t bindex; -+ int err; -+ -+ err = do_pri_dentry(-1, dentry); -+ if (err || !au_test_aufs(dentry->d_sb)) -+ return; -+ -+ dinfo = au_di(dentry); -+ if (!dinfo) -+ return; -+ dpri("d-1: btop %d, bbot %d, bwh %d, bdiropq %d, gen %d, tmp %d\n", -+ dinfo->di_btop, dinfo->di_bbot, -+ dinfo->di_bwh, dinfo->di_bdiropq, au_digen(dentry), -+ dinfo->di_tmpfile); -+ if (dinfo->di_btop < 0) -+ return; -+ for (bindex = dinfo->di_btop; bindex <= dinfo->di_bbot; bindex++) -+ do_pri_dentry(bindex, au_hdentry(dinfo, bindex)->hd_dentry); -+} -+ -+static int do_pri_file(aufs_bindex_t bindex, struct file *file) -+{ -+ char a[32]; -+ -+ if (!file || IS_ERR(file)) { -+ dpri("f%d: err %ld\n", bindex, PTR_ERR(file)); -+ return -1; -+ } -+ a[0] = 0; -+ if (bindex < 0 -+ && !IS_ERR_OR_NULL(file->f_path.dentry) -+ && au_test_aufs(file->f_path.dentry->d_sb) -+ && au_fi(file)) -+ snprintf(a, sizeof(a), ", gen %d, mmapped %d", -+ au_figen(file), atomic_read(&au_fi(file)->fi_mmapped)); -+ dpri("f%d: mode 0x%x, flags 0%o, cnt %ld, v %llu, pos %llu%s\n", -+ bindex, file->f_mode, file->f_flags, (long)file_count(file), -+ file->f_version, file->f_pos, a); -+ if (!IS_ERR_OR_NULL(file->f_path.dentry)) -+ do_pri_dentry(bindex, file->f_path.dentry); -+ return 0; -+} -+ -+void au_dpri_file(struct file *file) -+{ -+ struct au_finfo *finfo; -+ struct au_fidir *fidir; -+ struct au_hfile *hfile; -+ aufs_bindex_t bindex; -+ int err; -+ -+ err = do_pri_file(-1, file); -+ if (err -+ || IS_ERR_OR_NULL(file->f_path.dentry) -+ || !au_test_aufs(file->f_path.dentry->d_sb)) -+ return; -+ -+ finfo = au_fi(file); -+ if (!finfo) -+ return; -+ if (finfo->fi_btop < 0) -+ return; -+ fidir = finfo->fi_hdir; -+ if (!fidir) -+ do_pri_file(finfo->fi_btop, finfo->fi_htop.hf_file); -+ else -+ for (bindex = finfo->fi_btop; -+ bindex >= 0 && bindex <= fidir->fd_bbot; -+ bindex++) { -+ hfile = fidir->fd_hfile + bindex; -+ do_pri_file(bindex, hfile ? hfile->hf_file : NULL); -+ } -+} -+ -+static int do_pri_br(aufs_bindex_t bindex, struct au_branch *br) -+{ -+ struct vfsmount *mnt; -+ struct super_block *sb; -+ -+ if (!br || IS_ERR(br)) -+ goto out; -+ mnt = au_br_mnt(br); -+ if (!mnt || IS_ERR(mnt)) -+ goto out; -+ sb = mnt->mnt_sb; -+ if (!sb || IS_ERR(sb)) -+ goto out; -+ -+ dpri("s%d: {perm 0x%x, id %d, cnt %lld, wbr %p}, " -+ "%s, dev 0x%02x%02x, flags 0x%lx, cnt %d, active %d, " -+ "xino %d\n", -+ bindex, br->br_perm, br->br_id, au_br_count(br), -+ br->br_wbr, au_sbtype(sb), MAJOR(sb->s_dev), MINOR(sb->s_dev), -+ sb->s_flags, sb->s_count, -+ atomic_read(&sb->s_active), !!br->br_xino.xi_file); -+ return 0; -+ -+out: -+ dpri("s%d: err %ld\n", bindex, PTR_ERR(br)); -+ return -1; -+} -+ -+void au_dpri_sb(struct super_block *sb) -+{ -+ struct au_sbinfo *sbinfo; -+ aufs_bindex_t bindex; -+ int err; -+ /* to reuduce stack size */ -+ struct { -+ struct vfsmount mnt; -+ struct au_branch fake; -+ } *a; -+ -+ /* this function can be called from magic sysrq */ -+ a = kzalloc(sizeof(*a), GFP_ATOMIC); -+ if (unlikely(!a)) { -+ dpri("no memory\n"); -+ return; -+ } -+ -+ a->mnt.mnt_sb = sb; -+ a->fake.br_path.mnt = &a->mnt; -+ au_br_count_init(&a->fake); -+ err = do_pri_br(-1, &a->fake); -+ au_br_count_fin(&a->fake); -+ kfree(a); -+ dpri("dev 0x%x\n", sb->s_dev); -+ if (err || !au_test_aufs(sb)) -+ return; -+ -+ sbinfo = au_sbi(sb); -+ if (!sbinfo) -+ return; -+ dpri("nw %d, gen %u, kobj %d\n", -+ atomic_read(&sbinfo->si_nowait.nw_len), sbinfo->si_generation, -+ kref_read(&sbinfo->si_kobj.kref)); -+ for (bindex = 0; bindex <= sbinfo->si_bbot; bindex++) -+ do_pri_br(bindex, sbinfo->si_branch[0 + bindex]); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void __au_dbg_verify_dinode(struct dentry *dentry, const char *func, int line) -+{ -+ struct inode *h_inode, *inode = d_inode(dentry); -+ struct dentry *h_dentry; -+ aufs_bindex_t bindex, bbot, bi; -+ -+ if (!inode /* || au_di(dentry)->di_lsc == AuLsc_DI_TMP */) -+ return; -+ -+ bbot = au_dbbot(dentry); -+ bi = au_ibbot(inode); -+ if (bi < bbot) -+ bbot = bi; -+ bindex = au_dbtop(dentry); -+ bi = au_ibtop(inode); -+ if (bi > bindex) -+ bindex = bi; -+ -+ for (; bindex <= bbot; bindex++) { -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (!h_dentry) -+ continue; -+ h_inode = au_h_iptr(inode, bindex); -+ if (unlikely(h_inode != d_inode(h_dentry))) { -+ au_debug_on(); -+ AuDbg("b%d, %s:%d\n", bindex, func, line); -+ AuDbgDentry(dentry); -+ AuDbgInode(inode); -+ au_debug_off(); -+ BUG(); -+ } -+ } -+} -+ -+void au_dbg_verify_gen(struct dentry *parent, unsigned int sigen) -+{ -+ int err, i, j; -+ struct au_dcsub_pages dpages; -+ struct au_dpage *dpage; -+ struct dentry **dentries; -+ -+ err = au_dpages_init(&dpages, GFP_NOFS); -+ AuDebugOn(err); -+ err = au_dcsub_pages_rev_aufs(&dpages, parent, /*do_include*/1); -+ AuDebugOn(err); -+ for (i = dpages.ndpage - 1; !err && i >= 0; i--) { -+ dpage = dpages.dpages + i; -+ dentries = dpage->dentries; -+ for (j = dpage->ndentry - 1; !err && j >= 0; j--) -+ AuDebugOn(au_digen_test(dentries[j], sigen)); -+ } -+ au_dpages_free(&dpages); -+} -+ -+void au_dbg_verify_kthread(void) -+{ -+ if (au_wkq_test()) { -+ au_dbg_blocked(); -+ /* -+ * It may be recursive, but udba=notify between two aufs mounts, -+ * where a single ro branch is shared, is not a problem. -+ */ -+ /* WARN_ON(1); */ -+ } -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int __init au_debug_init(void) -+{ -+ aufs_bindex_t bindex; -+ struct au_vdir_destr destr; -+ -+ bindex = -1; -+ AuDebugOn(bindex >= 0); -+ -+ destr.len = -1; -+ AuDebugOn(destr.len < NAME_MAX); -+ -+#ifdef CONFIG_4KSTACKS -+ pr_warn("CONFIG_4KSTACKS is defined.\n"); -+#endif -+ -+ return 0; -+} -diff --git a/fs/aufs/debug.h b/fs/aufs/debug.h -new file mode 100644 -index 000000000000..5f3245be378e ---- /dev/null -+++ b/fs/aufs/debug.h -@@ -0,0 +1,213 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * debug print functions -+ */ -+ -+#ifndef __AUFS_DEBUG_H__ -+#define __AUFS_DEBUG_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+#include -+#include -+#include -+ -+#ifdef CONFIG_AUFS_DEBUG -+#define AuDebugOn(a) BUG_ON(a) -+ -+/* module parameter */ -+extern atomic_t aufs_debug; -+static inline void au_debug_on(void) -+{ -+ atomic_inc(&aufs_debug); -+} -+static inline void au_debug_off(void) -+{ -+ atomic_dec_if_positive(&aufs_debug); -+} -+ -+static inline int au_debug_test(void) -+{ -+ return atomic_read(&aufs_debug) > 0; -+} -+#else -+#define AuDebugOn(a) do {} while (0) -+AuStubVoid(au_debug_on, void) -+AuStubVoid(au_debug_off, void) -+AuStubInt0(au_debug_test, void) -+#endif /* CONFIG_AUFS_DEBUG */ -+ -+#define param_check_atomic_t(name, p) __param_check(name, p, atomic_t) -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* debug print */ -+ -+#define AuDbg(fmt, ...) do { \ -+ if (au_debug_test()) \ -+ pr_debug("DEBUG: " fmt, ##__VA_ARGS__); \ -+} while (0) -+#define AuLabel(l) AuDbg(#l "\n") -+#define AuIOErr(fmt, ...) pr_err("I/O Error, " fmt, ##__VA_ARGS__) -+#define AuWarn1(fmt, ...) do { \ -+ static unsigned char _c; \ -+ if (!_c++) \ -+ pr_warn(fmt, ##__VA_ARGS__); \ -+} while (0) -+ -+#define AuErr1(fmt, ...) do { \ -+ static unsigned char _c; \ -+ if (!_c++) \ -+ pr_err(fmt, ##__VA_ARGS__); \ -+} while (0) -+ -+#define AuIOErr1(fmt, ...) do { \ -+ static unsigned char _c; \ -+ if (!_c++) \ -+ AuIOErr(fmt, ##__VA_ARGS__); \ -+} while (0) -+ -+#define AuUnsupportMsg "This operation is not supported." \ -+ " Please report this application to aufs-users ML." -+#define AuUnsupport(fmt, ...) do { \ -+ pr_err(AuUnsupportMsg "\n" fmt, ##__VA_ARGS__); \ -+ dump_stack(); \ -+} while (0) -+ -+#define AuTraceErr(e) do { \ -+ if (unlikely((e) < 0)) \ -+ AuDbg("err %d\n", (int)(e)); \ -+} while (0) -+ -+#define AuTraceErrPtr(p) do { \ -+ if (IS_ERR(p)) \ -+ AuDbg("err %ld\n", PTR_ERR(p)); \ -+} while (0) -+ -+/* dirty macros for debug print, use with "%.*s" and caution */ -+#define AuLNPair(qstr) (qstr)->len, (qstr)->name -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct dentry; -+#ifdef CONFIG_AUFS_DEBUG -+extern struct mutex au_dbg_mtx; -+extern char *au_plevel; -+struct au_nhash; -+void au_dpri_whlist(struct au_nhash *whlist); -+struct au_vdir; -+void au_dpri_vdir(struct au_vdir *vdir); -+struct inode; -+void au_dpri_inode(struct inode *inode); -+void au_dpri_dalias(struct inode *inode); -+void au_dpri_dentry(struct dentry *dentry); -+struct file; -+void au_dpri_file(struct file *filp); -+struct super_block; -+void au_dpri_sb(struct super_block *sb); -+ -+#define au_dbg_verify_dinode(d) __au_dbg_verify_dinode(d, __func__, __LINE__) -+void __au_dbg_verify_dinode(struct dentry *dentry, const char *func, int line); -+void au_dbg_verify_gen(struct dentry *parent, unsigned int sigen); -+void au_dbg_verify_kthread(void); -+ -+int __init au_debug_init(void); -+ -+#define AuDbgWhlist(w) do { \ -+ mutex_lock(&au_dbg_mtx); \ -+ AuDbg(#w "\n"); \ -+ au_dpri_whlist(w); \ -+ mutex_unlock(&au_dbg_mtx); \ -+} while (0) -+ -+#define AuDbgVdir(v) do { \ -+ mutex_lock(&au_dbg_mtx); \ -+ AuDbg(#v "\n"); \ -+ au_dpri_vdir(v); \ -+ mutex_unlock(&au_dbg_mtx); \ -+} while (0) -+ -+#define AuDbgInode(i) do { \ -+ mutex_lock(&au_dbg_mtx); \ -+ AuDbg(#i "\n"); \ -+ au_dpri_inode(i); \ -+ mutex_unlock(&au_dbg_mtx); \ -+} while (0) -+ -+#define AuDbgDAlias(i) do { \ -+ mutex_lock(&au_dbg_mtx); \ -+ AuDbg(#i "\n"); \ -+ au_dpri_dalias(i); \ -+ mutex_unlock(&au_dbg_mtx); \ -+} while (0) -+ -+#define AuDbgDentry(d) do { \ -+ mutex_lock(&au_dbg_mtx); \ -+ AuDbg(#d "\n"); \ -+ au_dpri_dentry(d); \ -+ mutex_unlock(&au_dbg_mtx); \ -+} while (0) -+ -+#define AuDbgFile(f) do { \ -+ mutex_lock(&au_dbg_mtx); \ -+ AuDbg(#f "\n"); \ -+ au_dpri_file(f); \ -+ mutex_unlock(&au_dbg_mtx); \ -+} while (0) -+ -+#define AuDbgSb(sb) do { \ -+ mutex_lock(&au_dbg_mtx); \ -+ AuDbg(#sb "\n"); \ -+ au_dpri_sb(sb); \ -+ mutex_unlock(&au_dbg_mtx); \ -+} while (0) -+ -+#define AuDbgSym(addr) do { \ -+ char sym[KSYM_SYMBOL_LEN]; \ -+ sprint_symbol(sym, (unsigned long)addr); \ -+ AuDbg("%s\n", sym); \ -+} while (0) -+#else -+AuStubVoid(au_dbg_verify_dinode, struct dentry *dentry) -+AuStubVoid(au_dbg_verify_gen, struct dentry *parent, unsigned int sigen) -+AuStubVoid(au_dbg_verify_kthread, void) -+AuStubInt0(__init au_debug_init, void) -+ -+#define AuDbgWhlist(w) do {} while (0) -+#define AuDbgVdir(v) do {} while (0) -+#define AuDbgInode(i) do {} while (0) -+#define AuDbgDAlias(i) do {} while (0) -+#define AuDbgDentry(d) do {} while (0) -+#define AuDbgFile(f) do {} while (0) -+#define AuDbgSb(sb) do {} while (0) -+#define AuDbgSym(addr) do {} while (0) -+#endif /* CONFIG_AUFS_DEBUG */ -+ -+/* ---------------------------------------------------------------------- */ -+ -+#ifdef CONFIG_AUFS_MAGIC_SYSRQ -+int __init au_sysrq_init(void); -+void au_sysrq_fin(void); -+ -+#ifdef CONFIG_HW_CONSOLE -+#define au_dbg_blocked() do { \ -+ WARN_ON(1); \ -+ handle_sysrq('w'); \ -+} while (0) -+#else -+AuStubVoid(au_dbg_blocked, void) -+#endif -+ -+#else -+AuStubInt0(__init au_sysrq_init, void) -+AuStubVoid(au_sysrq_fin, void) -+AuStubVoid(au_dbg_blocked, void) -+#endif /* CONFIG_AUFS_MAGIC_SYSRQ */ -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_DEBUG_H__ */ -diff --git a/fs/aufs/dentry.c b/fs/aufs/dentry.c -new file mode 100644 -index 000000000000..de83d9e5b94d ---- /dev/null -+++ b/fs/aufs/dentry.c -@@ -0,0 +1,1140 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * lookup and dentry operations -+ */ -+ -+#include -+#include "aufs.h" -+ -+/* -+ * returns positive/negative dentry, NULL or an error. -+ * NULL means whiteout-ed or not-found. -+ */ -+static struct dentry* -+au_do_lookup(struct dentry *h_parent, struct dentry *dentry, -+ aufs_bindex_t bindex, struct au_do_lookup_args *args) -+{ -+ struct dentry *h_dentry; -+ struct inode *h_inode; -+ struct au_branch *br; -+ int wh_found, opq; -+ unsigned char wh_able; -+ const unsigned char allow_neg = !!au_ftest_lkup(args->flags, ALLOW_NEG); -+ const unsigned char ignore_perm = !!au_ftest_lkup(args->flags, -+ IGNORE_PERM); -+ -+ wh_found = 0; -+ br = au_sbr(dentry->d_sb, bindex); -+ wh_able = !!au_br_whable(br->br_perm); -+ if (wh_able) -+ wh_found = au_wh_test(h_parent, &args->whname, ignore_perm); -+ h_dentry = ERR_PTR(wh_found); -+ if (!wh_found) -+ goto real_lookup; -+ if (unlikely(wh_found < 0)) -+ goto out; -+ -+ /* We found a whiteout */ -+ /* au_set_dbbot(dentry, bindex); */ -+ au_set_dbwh(dentry, bindex); -+ if (!allow_neg) -+ return NULL; /* success */ -+ -+real_lookup: -+ if (!ignore_perm) -+ h_dentry = vfsub_lkup_one(args->name, h_parent); -+ else -+ h_dentry = au_sio_lkup_one(args->name, h_parent); -+ if (IS_ERR(h_dentry)) { -+ if (PTR_ERR(h_dentry) == -ENAMETOOLONG -+ && !allow_neg) -+ h_dentry = NULL; -+ goto out; -+ } -+ -+ h_inode = d_inode(h_dentry); -+ if (d_is_negative(h_dentry)) { -+ if (!allow_neg) -+ goto out_neg; -+ } else if (wh_found -+ || (args->type && args->type != (h_inode->i_mode & S_IFMT))) -+ goto out_neg; -+ else if (au_ftest_lkup(args->flags, DIRREN) -+ /* && h_inode */ -+ && !au_dr_lkup_h_ino(args, bindex, h_inode->i_ino)) { -+ AuDbg("b%d %pd ignored hi%llu\n", bindex, h_dentry, -+ (unsigned long long)h_inode->i_ino); -+ goto out_neg; -+ } -+ -+ if (au_dbbot(dentry) <= bindex) -+ au_set_dbbot(dentry, bindex); -+ if (au_dbtop(dentry) < 0 || bindex < au_dbtop(dentry)) -+ au_set_dbtop(dentry, bindex); -+ au_set_h_dptr(dentry, bindex, h_dentry); -+ -+ if (!d_is_dir(h_dentry) -+ || !wh_able -+ || (d_really_is_positive(dentry) && !d_is_dir(dentry))) -+ goto out; /* success */ -+ -+ vfsub_inode_lock_shared_nested(h_inode, AuLsc_I_CHILD); -+ opq = au_diropq_test(h_dentry); -+ inode_unlock_shared(h_inode); -+ if (opq > 0) -+ au_set_dbdiropq(dentry, bindex); -+ else if (unlikely(opq < 0)) { -+ au_set_h_dptr(dentry, bindex, NULL); -+ h_dentry = ERR_PTR(opq); -+ } -+ goto out; -+ -+out_neg: -+ dput(h_dentry); -+ h_dentry = NULL; -+out: -+ return h_dentry; -+} -+ -+static int au_test_shwh(struct super_block *sb, const struct qstr *name) -+{ -+ if (unlikely(!au_opt_test(au_mntflags(sb), SHWH) -+ && !strncmp(name->name, AUFS_WH_PFX, AUFS_WH_PFX_LEN))) -+ return -EPERM; -+ return 0; -+} -+ -+/* -+ * returns the number of lower positive dentries, -+ * otherwise an error. -+ * can be called at unlinking with @type is zero. -+ */ -+int au_lkup_dentry(struct dentry *dentry, aufs_bindex_t btop, -+ unsigned int flags) -+{ -+ int npositive, err; -+ aufs_bindex_t bindex, btail, bdiropq; -+ unsigned char isdir, dirperm1, dirren; -+ struct au_do_lookup_args args = { -+ .flags = flags, -+ .name = &dentry->d_name -+ }; -+ struct dentry *parent; -+ struct super_block *sb; -+ -+ sb = dentry->d_sb; -+ err = au_test_shwh(sb, args.name); -+ if (unlikely(err)) -+ goto out; -+ -+ err = au_wh_name_alloc(&args.whname, args.name); -+ if (unlikely(err)) -+ goto out; -+ -+ isdir = !!d_is_dir(dentry); -+ dirperm1 = !!au_opt_test(au_mntflags(sb), DIRPERM1); -+ dirren = !!au_opt_test(au_mntflags(sb), DIRREN); -+ if (dirren) -+ au_fset_lkup(args.flags, DIRREN); -+ -+ npositive = 0; -+ parent = dget_parent(dentry); -+ btail = au_dbtaildir(parent); -+ for (bindex = btop; bindex <= btail; bindex++) { -+ struct dentry *h_parent, *h_dentry; -+ struct inode *h_inode, *h_dir; -+ struct au_branch *br; -+ -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (h_dentry) { -+ if (d_is_positive(h_dentry)) -+ npositive++; -+ break; -+ } -+ h_parent = au_h_dptr(parent, bindex); -+ if (!h_parent || !d_is_dir(h_parent)) -+ continue; -+ -+ if (dirren) { -+ /* if the inum matches, then use the prepared name */ -+ err = au_dr_lkup_name(&args, bindex); -+ if (unlikely(err)) -+ goto out_parent; -+ } -+ -+ h_dir = d_inode(h_parent); -+ vfsub_inode_lock_shared_nested(h_dir, AuLsc_I_PARENT); -+ h_dentry = au_do_lookup(h_parent, dentry, bindex, &args); -+ inode_unlock_shared(h_dir); -+ err = PTR_ERR(h_dentry); -+ if (IS_ERR(h_dentry)) -+ goto out_parent; -+ if (h_dentry) -+ au_fclr_lkup(args.flags, ALLOW_NEG); -+ if (dirperm1) -+ au_fset_lkup(args.flags, IGNORE_PERM); -+ -+ if (au_dbwh(dentry) == bindex) -+ break; -+ if (!h_dentry) -+ continue; -+ if (d_is_negative(h_dentry)) -+ continue; -+ h_inode = d_inode(h_dentry); -+ npositive++; -+ if (!args.type) -+ args.type = h_inode->i_mode & S_IFMT; -+ if (args.type != S_IFDIR) -+ break; -+ else if (isdir) { -+ /* the type of lower may be different */ -+ bdiropq = au_dbdiropq(dentry); -+ if (bdiropq >= 0 && bdiropq <= bindex) -+ break; -+ } -+ br = au_sbr(sb, bindex); -+ if (dirren -+ && au_dr_hino_test_add(&br->br_dirren, h_inode->i_ino, -+ /*add_ent*/NULL)) { -+ /* prepare next name to lookup */ -+ err = au_dr_lkup(&args, dentry, bindex); -+ if (unlikely(err)) -+ goto out_parent; -+ } -+ } -+ -+ if (npositive) { -+ AuLabel(positive); -+ au_update_dbtop(dentry); -+ } -+ err = npositive; -+ if (unlikely(!au_opt_test(au_mntflags(sb), UDBA_NONE) -+ && au_dbtop(dentry) < 0)) { -+ err = -EIO; -+ AuIOErr("both of real entry and whiteout found, %pd, err %d\n", -+ dentry, err); -+ } -+ -+out_parent: -+ dput(parent); -+ kfree(args.whname.name); -+ if (dirren) -+ au_dr_lkup_fin(&args); -+out: -+ return err; -+} -+ -+struct dentry *au_sio_lkup_one(struct qstr *name, struct dentry *parent) -+{ -+ struct dentry *dentry; -+ int wkq_err; -+ -+ if (!au_test_h_perm_sio(d_inode(parent), MAY_EXEC)) -+ dentry = vfsub_lkup_one(name, parent); -+ else { -+ struct vfsub_lkup_one_args args = { -+ .errp = &dentry, -+ .name = name, -+ .parent = parent -+ }; -+ -+ wkq_err = au_wkq_wait(vfsub_call_lkup_one, &args); -+ if (unlikely(wkq_err)) -+ dentry = ERR_PTR(wkq_err); -+ } -+ -+ return dentry; -+} -+ -+/* -+ * lookup @dentry on @bindex which should be negative. -+ */ -+int au_lkup_neg(struct dentry *dentry, aufs_bindex_t bindex, int wh) -+{ -+ int err; -+ struct dentry *parent, *h_parent, *h_dentry; -+ struct au_branch *br; -+ -+ parent = dget_parent(dentry); -+ h_parent = au_h_dptr(parent, bindex); -+ br = au_sbr(dentry->d_sb, bindex); -+ if (wh) -+ h_dentry = au_whtmp_lkup(h_parent, br, &dentry->d_name); -+ else -+ h_dentry = au_sio_lkup_one(&dentry->d_name, h_parent); -+ err = PTR_ERR(h_dentry); -+ if (IS_ERR(h_dentry)) -+ goto out; -+ if (unlikely(d_is_positive(h_dentry))) { -+ err = -EIO; -+ AuIOErr("%pd should be negative on b%d.\n", h_dentry, bindex); -+ dput(h_dentry); -+ goto out; -+ } -+ -+ err = 0; -+ if (bindex < au_dbtop(dentry)) -+ au_set_dbtop(dentry, bindex); -+ if (au_dbbot(dentry) < bindex) -+ au_set_dbbot(dentry, bindex); -+ au_set_h_dptr(dentry, bindex, h_dentry); -+ -+out: -+ dput(parent); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* subset of struct inode */ -+struct au_iattr { -+ unsigned long i_ino; -+ /* unsigned int i_nlink; */ -+ kuid_t i_uid; -+ kgid_t i_gid; -+ u64 i_version; -+/* -+ loff_t i_size; -+ blkcnt_t i_blocks; -+*/ -+ umode_t i_mode; -+}; -+ -+static void au_iattr_save(struct au_iattr *ia, struct inode *h_inode) -+{ -+ ia->i_ino = h_inode->i_ino; -+ /* ia->i_nlink = h_inode->i_nlink; */ -+ ia->i_uid = h_inode->i_uid; -+ ia->i_gid = h_inode->i_gid; -+ ia->i_version = h_inode->i_version; -+/* -+ ia->i_size = h_inode->i_size; -+ ia->i_blocks = h_inode->i_blocks; -+*/ -+ ia->i_mode = (h_inode->i_mode & S_IFMT); -+} -+ -+static int au_iattr_test(struct au_iattr *ia, struct inode *h_inode) -+{ -+ return ia->i_ino != h_inode->i_ino -+ /* || ia->i_nlink != h_inode->i_nlink */ -+ || !uid_eq(ia->i_uid, h_inode->i_uid) -+ || !gid_eq(ia->i_gid, h_inode->i_gid) -+ || ia->i_version != h_inode->i_version -+/* -+ || ia->i_size != h_inode->i_size -+ || ia->i_blocks != h_inode->i_blocks -+*/ -+ || ia->i_mode != (h_inode->i_mode & S_IFMT); -+} -+ -+static int au_h_verify_dentry(struct dentry *h_dentry, struct dentry *h_parent, -+ struct au_branch *br) -+{ -+ int err; -+ struct au_iattr ia; -+ struct inode *h_inode; -+ struct dentry *h_d; -+ struct super_block *h_sb; -+ -+ err = 0; -+ memset(&ia, -1, sizeof(ia)); -+ h_sb = h_dentry->d_sb; -+ h_inode = NULL; -+ if (d_is_positive(h_dentry)) { -+ h_inode = d_inode(h_dentry); -+ au_iattr_save(&ia, h_inode); -+ } else if (au_test_nfs(h_sb) || au_test_fuse(h_sb)) -+ /* nfs d_revalidate may return 0 for negative dentry */ -+ /* fuse d_revalidate always return 0 for negative dentry */ -+ goto out; -+ -+ /* main purpose is namei.c:cached_lookup() and d_revalidate */ -+ h_d = vfsub_lkup_one(&h_dentry->d_name, h_parent); -+ err = PTR_ERR(h_d); -+ if (IS_ERR(h_d)) -+ goto out; -+ -+ err = 0; -+ if (unlikely(h_d != h_dentry -+ || d_inode(h_d) != h_inode -+ || (h_inode && au_iattr_test(&ia, h_inode)))) -+ err = au_busy_or_stale(); -+ dput(h_d); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+int au_h_verify(struct dentry *h_dentry, unsigned int udba, struct inode *h_dir, -+ struct dentry *h_parent, struct au_branch *br) -+{ -+ int err; -+ -+ err = 0; -+ if (udba == AuOpt_UDBA_REVAL -+ && !au_test_fs_remote(h_dentry->d_sb)) { -+ IMustLock(h_dir); -+ err = (d_inode(h_dentry->d_parent) != h_dir); -+ } else if (udba != AuOpt_UDBA_NONE) -+ err = au_h_verify_dentry(h_dentry, h_parent, br); -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_do_refresh_hdentry(struct dentry *dentry, struct dentry *parent) -+{ -+ int err; -+ aufs_bindex_t new_bindex, bindex, bbot, bwh, bdiropq; -+ struct au_hdentry tmp, *p, *q; -+ struct au_dinfo *dinfo; -+ struct super_block *sb; -+ -+ DiMustWriteLock(dentry); -+ -+ sb = dentry->d_sb; -+ dinfo = au_di(dentry); -+ bbot = dinfo->di_bbot; -+ bwh = dinfo->di_bwh; -+ bdiropq = dinfo->di_bdiropq; -+ bindex = dinfo->di_btop; -+ p = au_hdentry(dinfo, bindex); -+ for (; bindex <= bbot; bindex++, p++) { -+ if (!p->hd_dentry) -+ continue; -+ -+ new_bindex = au_br_index(sb, p->hd_id); -+ if (new_bindex == bindex) -+ continue; -+ -+ if (dinfo->di_bwh == bindex) -+ bwh = new_bindex; -+ if (dinfo->di_bdiropq == bindex) -+ bdiropq = new_bindex; -+ if (new_bindex < 0) { -+ au_hdput(p); -+ p->hd_dentry = NULL; -+ continue; -+ } -+ -+ /* swap two lower dentries, and loop again */ -+ q = au_hdentry(dinfo, new_bindex); -+ tmp = *q; -+ *q = *p; -+ *p = tmp; -+ if (tmp.hd_dentry) { -+ bindex--; -+ p--; -+ } -+ } -+ -+ dinfo->di_bwh = -1; -+ if (bwh >= 0 && bwh <= au_sbbot(sb) && au_sbr_whable(sb, bwh)) -+ dinfo->di_bwh = bwh; -+ -+ dinfo->di_bdiropq = -1; -+ if (bdiropq >= 0 -+ && bdiropq <= au_sbbot(sb) -+ && au_sbr_whable(sb, bdiropq)) -+ dinfo->di_bdiropq = bdiropq; -+ -+ err = -EIO; -+ dinfo->di_btop = -1; -+ dinfo->di_bbot = -1; -+ bbot = au_dbbot(parent); -+ bindex = 0; -+ p = au_hdentry(dinfo, bindex); -+ for (; bindex <= bbot; bindex++, p++) -+ if (p->hd_dentry) { -+ dinfo->di_btop = bindex; -+ break; -+ } -+ -+ if (dinfo->di_btop >= 0) { -+ bindex = bbot; -+ p = au_hdentry(dinfo, bindex); -+ for (; bindex >= 0; bindex--, p--) -+ if (p->hd_dentry) { -+ dinfo->di_bbot = bindex; -+ err = 0; -+ break; -+ } -+ } -+ -+ return err; -+} -+ -+static void au_do_hide(struct dentry *dentry) -+{ -+ struct inode *inode; -+ -+ if (d_really_is_positive(dentry)) { -+ inode = d_inode(dentry); -+ if (!d_is_dir(dentry)) { -+ if (inode->i_nlink && !d_unhashed(dentry)) -+ drop_nlink(inode); -+ } else { -+ clear_nlink(inode); -+ /* stop next lookup */ -+ inode->i_flags |= S_DEAD; -+ } -+ smp_mb(); /* necessary? */ -+ } -+ d_drop(dentry); -+} -+ -+static int au_hide_children(struct dentry *parent) -+{ -+ int err, i, j, ndentry; -+ struct au_dcsub_pages dpages; -+ struct au_dpage *dpage; -+ struct dentry *dentry; -+ -+ err = au_dpages_init(&dpages, GFP_NOFS); -+ if (unlikely(err)) -+ goto out; -+ err = au_dcsub_pages(&dpages, parent, NULL, NULL); -+ if (unlikely(err)) -+ goto out_dpages; -+ -+ /* in reverse order */ -+ for (i = dpages.ndpage - 1; i >= 0; i--) { -+ dpage = dpages.dpages + i; -+ ndentry = dpage->ndentry; -+ for (j = ndentry - 1; j >= 0; j--) { -+ dentry = dpage->dentries[j]; -+ if (dentry != parent) -+ au_do_hide(dentry); -+ } -+ } -+ -+out_dpages: -+ au_dpages_free(&dpages); -+out: -+ return err; -+} -+ -+static void au_hide(struct dentry *dentry) -+{ -+ int err; -+ -+ AuDbgDentry(dentry); -+ if (d_is_dir(dentry)) { -+ /* shrink_dcache_parent(dentry); */ -+ err = au_hide_children(dentry); -+ if (unlikely(err)) -+ AuIOErr("%pd, failed hiding children, ignored %d\n", -+ dentry, err); -+ } -+ au_do_hide(dentry); -+} -+ -+/* -+ * By adding a dirty branch, a cached dentry may be affected in various ways. -+ * -+ * a dirty branch is added -+ * - on the top of layers -+ * - in the middle of layers -+ * - to the bottom of layers -+ * -+ * on the added branch there exists -+ * - a whiteout -+ * - a diropq -+ * - a same named entry -+ * + exist -+ * * negative --> positive -+ * * positive --> positive -+ * - type is unchanged -+ * - type is changed -+ * + doesn't exist -+ * * negative --> negative -+ * * positive --> negative (rejected by au_br_del() for non-dir case) -+ * - none -+ */ -+static int au_refresh_by_dinfo(struct dentry *dentry, struct au_dinfo *dinfo, -+ struct au_dinfo *tmp) -+{ -+ int err; -+ aufs_bindex_t bindex, bbot; -+ struct { -+ struct dentry *dentry; -+ struct inode *inode; -+ mode_t mode; -+ } orig_h, tmp_h = { -+ .dentry = NULL -+ }; -+ struct au_hdentry *hd; -+ struct inode *inode, *h_inode; -+ struct dentry *h_dentry; -+ -+ err = 0; -+ AuDebugOn(dinfo->di_btop < 0); -+ orig_h.mode = 0; -+ orig_h.dentry = au_hdentry(dinfo, dinfo->di_btop)->hd_dentry; -+ orig_h.inode = NULL; -+ if (d_is_positive(orig_h.dentry)) { -+ orig_h.inode = d_inode(orig_h.dentry); -+ orig_h.mode = orig_h.inode->i_mode & S_IFMT; -+ } -+ if (tmp->di_btop >= 0) { -+ tmp_h.dentry = au_hdentry(tmp, tmp->di_btop)->hd_dentry; -+ if (d_is_positive(tmp_h.dentry)) { -+ tmp_h.inode = d_inode(tmp_h.dentry); -+ tmp_h.mode = tmp_h.inode->i_mode & S_IFMT; -+ } -+ } -+ -+ inode = NULL; -+ if (d_really_is_positive(dentry)) -+ inode = d_inode(dentry); -+ if (!orig_h.inode) { -+ AuDbg("nagative originally\n"); -+ if (inode) { -+ au_hide(dentry); -+ goto out; -+ } -+ AuDebugOn(inode); -+ AuDebugOn(dinfo->di_btop != dinfo->di_bbot); -+ AuDebugOn(dinfo->di_bdiropq != -1); -+ -+ if (!tmp_h.inode) { -+ AuDbg("negative --> negative\n"); -+ /* should have only one negative lower */ -+ if (tmp->di_btop >= 0 -+ && tmp->di_btop < dinfo->di_btop) { -+ AuDebugOn(tmp->di_btop != tmp->di_bbot); -+ AuDebugOn(dinfo->di_btop != dinfo->di_bbot); -+ au_set_h_dptr(dentry, dinfo->di_btop, NULL); -+ au_di_cp(dinfo, tmp); -+ hd = au_hdentry(tmp, tmp->di_btop); -+ au_set_h_dptr(dentry, tmp->di_btop, -+ dget(hd->hd_dentry)); -+ } -+ au_dbg_verify_dinode(dentry); -+ } else { -+ AuDbg("negative --> positive\n"); -+ /* -+ * similar to the behaviour of creating with bypassing -+ * aufs. -+ * unhash it in order to force an error in the -+ * succeeding create operation. -+ * we should not set S_DEAD here. -+ */ -+ d_drop(dentry); -+ /* au_di_swap(tmp, dinfo); */ -+ au_dbg_verify_dinode(dentry); -+ } -+ } else { -+ AuDbg("positive originally\n"); -+ /* inode may be NULL */ -+ AuDebugOn(inode && (inode->i_mode & S_IFMT) != orig_h.mode); -+ if (!tmp_h.inode) { -+ AuDbg("positive --> negative\n"); -+ /* or bypassing aufs */ -+ au_hide(dentry); -+ if (tmp->di_bwh >= 0 && tmp->di_bwh <= dinfo->di_btop) -+ dinfo->di_bwh = tmp->di_bwh; -+ if (inode) -+ err = au_refresh_hinode_self(inode); -+ au_dbg_verify_dinode(dentry); -+ } else if (orig_h.mode == tmp_h.mode) { -+ AuDbg("positive --> positive, same type\n"); -+ if (!S_ISDIR(orig_h.mode) -+ && dinfo->di_btop > tmp->di_btop) { -+ /* -+ * similar to the behaviour of removing and -+ * creating. -+ */ -+ au_hide(dentry); -+ if (inode) -+ err = au_refresh_hinode_self(inode); -+ au_dbg_verify_dinode(dentry); -+ } else { -+ /* fill empty slots */ -+ if (dinfo->di_btop > tmp->di_btop) -+ dinfo->di_btop = tmp->di_btop; -+ if (dinfo->di_bbot < tmp->di_bbot) -+ dinfo->di_bbot = tmp->di_bbot; -+ dinfo->di_bwh = tmp->di_bwh; -+ dinfo->di_bdiropq = tmp->di_bdiropq; -+ bbot = dinfo->di_bbot; -+ bindex = tmp->di_btop; -+ hd = au_hdentry(tmp, bindex); -+ for (; bindex <= bbot; bindex++, hd++) { -+ if (au_h_dptr(dentry, bindex)) -+ continue; -+ h_dentry = hd->hd_dentry; -+ if (!h_dentry) -+ continue; -+ AuDebugOn(d_is_negative(h_dentry)); -+ h_inode = d_inode(h_dentry); -+ AuDebugOn(orig_h.mode -+ != (h_inode->i_mode -+ & S_IFMT)); -+ au_set_h_dptr(dentry, bindex, -+ dget(h_dentry)); -+ } -+ if (inode) -+ err = au_refresh_hinode(inode, dentry); -+ au_dbg_verify_dinode(dentry); -+ } -+ } else { -+ AuDbg("positive --> positive, different type\n"); -+ /* similar to the behaviour of removing and creating */ -+ au_hide(dentry); -+ if (inode) -+ err = au_refresh_hinode_self(inode); -+ au_dbg_verify_dinode(dentry); -+ } -+ } -+ -+out: -+ return err; -+} -+ -+void au_refresh_dop(struct dentry *dentry, int force_reval) -+{ -+ const struct dentry_operations *dop -+ = force_reval ? &aufs_dop : dentry->d_sb->s_d_op; -+ static const unsigned int mask -+ = DCACHE_OP_REVALIDATE | DCACHE_OP_WEAK_REVALIDATE; -+ -+ BUILD_BUG_ON(sizeof(mask) != sizeof(dentry->d_flags)); -+ -+ if (dentry->d_op == dop) -+ return; -+ -+ AuDbg("%pd\n", dentry); -+ spin_lock(&dentry->d_lock); -+ if (dop == &aufs_dop) -+ dentry->d_flags |= mask; -+ else -+ dentry->d_flags &= ~mask; -+ dentry->d_op = dop; -+ spin_unlock(&dentry->d_lock); -+} -+ -+int au_refresh_dentry(struct dentry *dentry, struct dentry *parent) -+{ -+ int err, ebrange, nbr; -+ unsigned int sigen; -+ struct au_dinfo *dinfo, *tmp; -+ struct super_block *sb; -+ struct inode *inode; -+ -+ DiMustWriteLock(dentry); -+ AuDebugOn(IS_ROOT(dentry)); -+ AuDebugOn(d_really_is_negative(parent)); -+ -+ sb = dentry->d_sb; -+ sigen = au_sigen(sb); -+ err = au_digen_test(parent, sigen); -+ if (unlikely(err)) -+ goto out; -+ -+ nbr = au_sbbot(sb) + 1; -+ dinfo = au_di(dentry); -+ err = au_di_realloc(dinfo, nbr, /*may_shrink*/0); -+ if (unlikely(err)) -+ goto out; -+ ebrange = au_dbrange_test(dentry); -+ if (!ebrange) -+ ebrange = au_do_refresh_hdentry(dentry, parent); -+ -+ if (d_unhashed(dentry) || ebrange /* || dinfo->di_tmpfile */) { -+ AuDebugOn(au_dbtop(dentry) < 0 && au_dbbot(dentry) >= 0); -+ if (d_really_is_positive(dentry)) { -+ inode = d_inode(dentry); -+ err = au_refresh_hinode_self(inode); -+ } -+ au_dbg_verify_dinode(dentry); -+ if (!err) -+ goto out_dgen; /* success */ -+ goto out; -+ } -+ -+ /* temporary dinfo */ -+ AuDbgDentry(dentry); -+ err = -ENOMEM; -+ tmp = au_di_alloc(sb, AuLsc_DI_TMP); -+ if (unlikely(!tmp)) -+ goto out; -+ au_di_swap(tmp, dinfo); -+ /* returns the number of positive dentries */ -+ /* -+ * if current working dir is removed, it returns an error. -+ * but the dentry is legal. -+ */ -+ err = au_lkup_dentry(dentry, /*btop*/0, AuLkup_ALLOW_NEG); -+ AuDbgDentry(dentry); -+ au_di_swap(tmp, dinfo); -+ if (err == -ENOENT) -+ err = 0; -+ if (err >= 0) { -+ /* compare/refresh by dinfo */ -+ AuDbgDentry(dentry); -+ err = au_refresh_by_dinfo(dentry, dinfo, tmp); -+ au_dbg_verify_dinode(dentry); -+ AuTraceErr(err); -+ } -+ au_di_realloc(dinfo, nbr, /*may_shrink*/1); /* harmless if err */ -+ au_rw_write_unlock(&tmp->di_rwsem); -+ au_di_free(tmp); -+ if (unlikely(err)) -+ goto out; -+ -+out_dgen: -+ au_update_digen(dentry); -+out: -+ if (unlikely(err && !(dentry->d_flags & DCACHE_NFSFS_RENAMED))) { -+ AuIOErr("failed refreshing %pd, %d\n", dentry, err); -+ AuDbgDentry(dentry); -+ } -+ AuTraceErr(err); -+ return err; -+} -+ -+static int au_do_h_d_reval(struct dentry *h_dentry, unsigned int flags, -+ struct dentry *dentry, aufs_bindex_t bindex) -+{ -+ int err, valid; -+ -+ err = 0; -+ if (!(h_dentry->d_flags & DCACHE_OP_REVALIDATE)) -+ goto out; -+ -+ AuDbg("b%d\n", bindex); -+ /* -+ * gave up supporting LOOKUP_CREATE/OPEN for lower fs, -+ * due to whiteout and branch permission. -+ */ -+ flags &= ~(/*LOOKUP_PARENT |*/ LOOKUP_OPEN | LOOKUP_CREATE -+ | LOOKUP_FOLLOW | LOOKUP_EXCL); -+ /* it may return tri-state */ -+ valid = h_dentry->d_op->d_revalidate(h_dentry, flags); -+ -+ if (unlikely(valid < 0)) -+ err = valid; -+ else if (!valid) -+ err = -EINVAL; -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* todo: remove this */ -+static int h_d_revalidate(struct dentry *dentry, struct inode *inode, -+ unsigned int flags, int do_udba, int dirren) -+{ -+ int err; -+ umode_t mode, h_mode; -+ aufs_bindex_t bindex, btail, btop, ibs, ibe; -+ unsigned char plus, unhashed, is_root, h_plus, h_nfs, tmpfile; -+ struct inode *h_inode, *h_cached_inode; -+ struct dentry *h_dentry; -+ struct qstr *name, *h_name; -+ -+ err = 0; -+ plus = 0; -+ mode = 0; -+ ibs = -1; -+ ibe = -1; -+ unhashed = !!d_unhashed(dentry); -+ is_root = !!IS_ROOT(dentry); -+ name = &dentry->d_name; -+ tmpfile = au_di(dentry)->di_tmpfile; -+ -+ /* -+ * Theoretically, REVAL test should be unnecessary in case of -+ * {FS,I}NOTIFY. -+ * But {fs,i}notify doesn't fire some necessary events, -+ * IN_ATTRIB for atime/nlink/pageio -+ * Let's do REVAL test too. -+ */ -+ if (do_udba && inode) { -+ mode = (inode->i_mode & S_IFMT); -+ plus = (inode->i_nlink > 0); -+ ibs = au_ibtop(inode); -+ ibe = au_ibbot(inode); -+ } -+ -+ btop = au_dbtop(dentry); -+ btail = btop; -+ if (inode && S_ISDIR(inode->i_mode)) -+ btail = au_dbtaildir(dentry); -+ for (bindex = btop; bindex <= btail; bindex++) { -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (!h_dentry) -+ continue; -+ -+ AuDbg("b%d, %pd\n", bindex, h_dentry); -+ h_nfs = !!au_test_nfs(h_dentry->d_sb); -+ spin_lock(&h_dentry->d_lock); -+ h_name = &h_dentry->d_name; -+ if (unlikely(do_udba -+ && !is_root -+ && ((!h_nfs -+ && (unhashed != !!d_unhashed(h_dentry) -+ || (!tmpfile && !dirren -+ && !au_qstreq(name, h_name)) -+ )) -+ || (h_nfs -+ && !(flags & LOOKUP_OPEN) -+ && (h_dentry->d_flags -+ & DCACHE_NFSFS_RENAMED))) -+ )) { -+ int h_unhashed; -+ -+ h_unhashed = d_unhashed(h_dentry); -+ spin_unlock(&h_dentry->d_lock); -+ AuDbg("unhash 0x%x 0x%x, %pd %pd\n", -+ unhashed, h_unhashed, dentry, h_dentry); -+ goto err; -+ } -+ spin_unlock(&h_dentry->d_lock); -+ -+ err = au_do_h_d_reval(h_dentry, flags, dentry, bindex); -+ if (unlikely(err)) -+ /* do not goto err, to keep the errno */ -+ break; -+ -+ /* todo: plink too? */ -+ if (!do_udba) -+ continue; -+ -+ /* UDBA tests */ -+ if (unlikely(!!inode != d_is_positive(h_dentry))) -+ goto err; -+ -+ h_inode = NULL; -+ if (d_is_positive(h_dentry)) -+ h_inode = d_inode(h_dentry); -+ h_plus = plus; -+ h_mode = mode; -+ h_cached_inode = h_inode; -+ if (h_inode) { -+ h_mode = (h_inode->i_mode & S_IFMT); -+ h_plus = (h_inode->i_nlink > 0); -+ } -+ if (inode && ibs <= bindex && bindex <= ibe) -+ h_cached_inode = au_h_iptr(inode, bindex); -+ -+ if (!h_nfs) { -+ if (unlikely(plus != h_plus && !tmpfile)) -+ goto err; -+ } else { -+ if (unlikely(!(h_dentry->d_flags & DCACHE_NFSFS_RENAMED) -+ && !is_root -+ && !IS_ROOT(h_dentry) -+ && unhashed != d_unhashed(h_dentry))) -+ goto err; -+ } -+ if (unlikely(mode != h_mode -+ || h_cached_inode != h_inode)) -+ goto err; -+ continue; -+ -+err: -+ err = -EINVAL; -+ break; -+ } -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+/* todo: consolidate with do_refresh() and au_reval_for_attr() */ -+static int simple_reval_dpath(struct dentry *dentry, unsigned int sigen) -+{ -+ int err; -+ struct dentry *parent; -+ -+ if (!au_digen_test(dentry, sigen)) -+ return 0; -+ -+ parent = dget_parent(dentry); -+ di_read_lock_parent(parent, AuLock_IR); -+ AuDebugOn(au_digen_test(parent, sigen)); -+ au_dbg_verify_gen(parent, sigen); -+ err = au_refresh_dentry(dentry, parent); -+ di_read_unlock(parent, AuLock_IR); -+ dput(parent); -+ AuTraceErr(err); -+ return err; -+} -+ -+int au_reval_dpath(struct dentry *dentry, unsigned int sigen) -+{ -+ int err; -+ struct dentry *d, *parent; -+ -+ if (!au_ftest_si(au_sbi(dentry->d_sb), FAILED_REFRESH_DIR)) -+ return simple_reval_dpath(dentry, sigen); -+ -+ /* slow loop, keep it simple and stupid */ -+ /* cf: au_cpup_dirs() */ -+ err = 0; -+ parent = NULL; -+ while (au_digen_test(dentry, sigen)) { -+ d = dentry; -+ while (1) { -+ dput(parent); -+ parent = dget_parent(d); -+ if (!au_digen_test(parent, sigen)) -+ break; -+ d = parent; -+ } -+ -+ if (d != dentry) -+ di_write_lock_child2(d); -+ -+ /* someone might update our dentry while we were sleeping */ -+ if (au_digen_test(d, sigen)) { -+ /* -+ * todo: consolidate with simple_reval_dpath(), -+ * do_refresh() and au_reval_for_attr(). -+ */ -+ di_read_lock_parent(parent, AuLock_IR); -+ err = au_refresh_dentry(d, parent); -+ di_read_unlock(parent, AuLock_IR); -+ } -+ -+ if (d != dentry) -+ di_write_unlock(d); -+ dput(parent); -+ if (unlikely(err)) -+ break; -+ } -+ -+ return err; -+} -+ -+/* -+ * if valid returns 1, otherwise 0. -+ */ -+static int aufs_d_revalidate(struct dentry *dentry, unsigned int flags) -+{ -+ int valid, err; -+ unsigned int sigen; -+ unsigned char do_udba, dirren; -+ struct super_block *sb; -+ struct inode *inode; -+ -+ /* todo: support rcu-walk? */ -+ if (flags & LOOKUP_RCU) -+ return -ECHILD; -+ -+ valid = 0; -+ if (unlikely(!au_di(dentry))) -+ goto out; -+ -+ valid = 1; -+ sb = dentry->d_sb; -+ /* -+ * todo: very ugly -+ * i_mutex of parent dir may be held, -+ * but we should not return 'invalid' due to busy. -+ */ -+ err = aufs_read_lock(dentry, AuLock_FLUSH | AuLock_DW | AuLock_NOPLM); -+ if (unlikely(err)) { -+ valid = err; -+ AuTraceErr(err); -+ goto out; -+ } -+ inode = NULL; -+ if (d_really_is_positive(dentry)) -+ inode = d_inode(dentry); -+ if (unlikely(inode && au_is_bad_inode(inode))) { -+ err = -EINVAL; -+ AuTraceErr(err); -+ goto out_dgrade; -+ } -+ if (unlikely(au_dbrange_test(dentry))) { -+ err = -EINVAL; -+ AuTraceErr(err); -+ goto out_dgrade; -+ } -+ -+ sigen = au_sigen(sb); -+ if (au_digen_test(dentry, sigen)) { -+ AuDebugOn(IS_ROOT(dentry)); -+ err = au_reval_dpath(dentry, sigen); -+ if (unlikely(err)) { -+ AuTraceErr(err); -+ goto out_dgrade; -+ } -+ } -+ di_downgrade_lock(dentry, AuLock_IR); -+ -+ err = -EINVAL; -+ if (!(flags & (LOOKUP_OPEN | LOOKUP_EMPTY)) -+ && inode -+ && !(inode->i_state && I_LINKABLE) -+ && (IS_DEADDIR(inode) || !inode->i_nlink)) { -+ AuTraceErr(err); -+ goto out_inval; -+ } -+ -+ do_udba = !au_opt_test(au_mntflags(sb), UDBA_NONE); -+ if (do_udba && inode) { -+ aufs_bindex_t btop = au_ibtop(inode); -+ struct inode *h_inode; -+ -+ if (btop >= 0) { -+ h_inode = au_h_iptr(inode, btop); -+ if (h_inode && au_test_higen(inode, h_inode)) { -+ AuTraceErr(err); -+ goto out_inval; -+ } -+ } -+ } -+ -+ dirren = !!au_opt_test(au_mntflags(sb), DIRREN); -+ err = h_d_revalidate(dentry, inode, flags, do_udba, dirren); -+ if (unlikely(!err && do_udba && au_dbtop(dentry) < 0)) { -+ err = -EIO; -+ AuDbg("both of real entry and whiteout found, %p, err %d\n", -+ dentry, err); -+ } -+ goto out_inval; -+ -+out_dgrade: -+ di_downgrade_lock(dentry, AuLock_IR); -+out_inval: -+ aufs_read_unlock(dentry, AuLock_IR); -+ AuTraceErr(err); -+ valid = !err; -+out: -+ if (!valid) { -+ AuDbg("%pd invalid, %d\n", dentry, valid); -+ d_drop(dentry); -+ } -+ return valid; -+} -+ -+static void aufs_d_release(struct dentry *dentry) -+{ -+ if (au_di(dentry)) { -+ au_di_fin(dentry); -+ au_hn_di_reinit(dentry); -+ } -+} -+ -+const struct dentry_operations aufs_dop = { -+ .d_revalidate = aufs_d_revalidate, -+ .d_weak_revalidate = aufs_d_revalidate, -+ .d_release = aufs_d_release -+}; -+ -+/* aufs_dop without d_revalidate */ -+const struct dentry_operations aufs_dop_noreval = { -+ .d_release = aufs_d_release -+}; -diff --git a/fs/aufs/dentry.h b/fs/aufs/dentry.h -new file mode 100644 -index 000000000000..4f3f8b838bb4 ---- /dev/null -+++ b/fs/aufs/dentry.h -@@ -0,0 +1,254 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * lookup and dentry operations -+ */ -+ -+#ifndef __AUFS_DENTRY_H__ -+#define __AUFS_DENTRY_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+#include "dirren.h" -+#include "rwsem.h" -+ -+struct au_hdentry { -+ struct dentry *hd_dentry; -+ aufs_bindex_t hd_id; -+}; -+ -+struct au_dinfo { -+ atomic_t di_generation; -+ -+ struct au_rwsem di_rwsem; -+ aufs_bindex_t di_btop, di_bbot, di_bwh, di_bdiropq; -+ unsigned char di_tmpfile; /* to allow the different name */ -+ struct au_hdentry *di_hdentry; -+} ____cacheline_aligned_in_smp; -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* flags for au_lkup_dentry() */ -+#define AuLkup_ALLOW_NEG 1 -+#define AuLkup_IGNORE_PERM (1 << 1) -+#define AuLkup_DIRREN (1 << 2) -+#define au_ftest_lkup(flags, name) ((flags) & AuLkup_##name) -+#define au_fset_lkup(flags, name) \ -+ do { (flags) |= AuLkup_##name; } while (0) -+#define au_fclr_lkup(flags, name) \ -+ do { (flags) &= ~AuLkup_##name; } while (0) -+ -+#ifndef CONFIG_AUFS_DIRREN -+#undef AuLkup_DIRREN -+#define AuLkup_DIRREN 0 -+#endif -+ -+struct au_do_lookup_args { -+ unsigned int flags; -+ mode_t type; -+ struct qstr whname, *name; -+ struct au_dr_lookup dirren; -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* dentry.c */ -+extern const struct dentry_operations aufs_dop, aufs_dop_noreval; -+struct au_branch; -+struct dentry *au_sio_lkup_one(struct qstr *name, struct dentry *parent); -+int au_h_verify(struct dentry *h_dentry, unsigned int udba, struct inode *h_dir, -+ struct dentry *h_parent, struct au_branch *br); -+ -+int au_lkup_dentry(struct dentry *dentry, aufs_bindex_t btop, -+ unsigned int flags); -+int au_lkup_neg(struct dentry *dentry, aufs_bindex_t bindex, int wh); -+int au_refresh_dentry(struct dentry *dentry, struct dentry *parent); -+int au_reval_dpath(struct dentry *dentry, unsigned int sigen); -+void au_refresh_dop(struct dentry *dentry, int force_reval); -+ -+/* dinfo.c */ -+void au_di_init_once(void *_di); -+struct au_dinfo *au_di_alloc(struct super_block *sb, unsigned int lsc); -+void au_di_free(struct au_dinfo *dinfo); -+void au_di_swap(struct au_dinfo *a, struct au_dinfo *b); -+void au_di_cp(struct au_dinfo *dst, struct au_dinfo *src); -+int au_di_init(struct dentry *dentry); -+void au_di_fin(struct dentry *dentry); -+int au_di_realloc(struct au_dinfo *dinfo, int nbr, int may_shrink); -+ -+void di_read_lock(struct dentry *d, int flags, unsigned int lsc); -+void di_read_unlock(struct dentry *d, int flags); -+void di_downgrade_lock(struct dentry *d, int flags); -+void di_write_lock(struct dentry *d, unsigned int lsc); -+void di_write_unlock(struct dentry *d); -+void di_write_lock2_child(struct dentry *d1, struct dentry *d2, int isdir); -+void di_write_lock2_parent(struct dentry *d1, struct dentry *d2, int isdir); -+void di_write_unlock2(struct dentry *d1, struct dentry *d2); -+ -+struct dentry *au_h_dptr(struct dentry *dentry, aufs_bindex_t bindex); -+struct dentry *au_h_d_alias(struct dentry *dentry, aufs_bindex_t bindex); -+aufs_bindex_t au_dbtail(struct dentry *dentry); -+aufs_bindex_t au_dbtaildir(struct dentry *dentry); -+ -+void au_set_h_dptr(struct dentry *dentry, aufs_bindex_t bindex, -+ struct dentry *h_dentry); -+int au_digen_test(struct dentry *dentry, unsigned int sigen); -+int au_dbrange_test(struct dentry *dentry); -+void au_update_digen(struct dentry *dentry); -+void au_update_dbrange(struct dentry *dentry, int do_put_zero); -+void au_update_dbtop(struct dentry *dentry); -+void au_update_dbbot(struct dentry *dentry); -+int au_find_dbindex(struct dentry *dentry, struct dentry *h_dentry); -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline struct au_dinfo *au_di(struct dentry *dentry) -+{ -+ return dentry->d_fsdata; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* lock subclass for dinfo */ -+enum { -+ AuLsc_DI_CHILD, /* child first */ -+ AuLsc_DI_CHILD2, /* rename(2), link(2), and cpup at hnotify */ -+ AuLsc_DI_CHILD3, /* copyup dirs */ -+ AuLsc_DI_PARENT, -+ AuLsc_DI_PARENT2, -+ AuLsc_DI_PARENT3, -+ AuLsc_DI_TMP /* temp for replacing dinfo */ -+}; -+ -+/* -+ * di_read_lock_child, di_write_lock_child, -+ * di_read_lock_child2, di_write_lock_child2, -+ * di_read_lock_child3, di_write_lock_child3, -+ * di_read_lock_parent, di_write_lock_parent, -+ * di_read_lock_parent2, di_write_lock_parent2, -+ * di_read_lock_parent3, di_write_lock_parent3, -+ */ -+#define AuReadLockFunc(name, lsc) \ -+static inline void di_read_lock_##name(struct dentry *d, int flags) \ -+{ di_read_lock(d, flags, AuLsc_DI_##lsc); } -+ -+#define AuWriteLockFunc(name, lsc) \ -+static inline void di_write_lock_##name(struct dentry *d) \ -+{ di_write_lock(d, AuLsc_DI_##lsc); } -+ -+#define AuRWLockFuncs(name, lsc) \ -+ AuReadLockFunc(name, lsc) \ -+ AuWriteLockFunc(name, lsc) -+ -+AuRWLockFuncs(child, CHILD); -+AuRWLockFuncs(child2, CHILD2); -+AuRWLockFuncs(child3, CHILD3); -+AuRWLockFuncs(parent, PARENT); -+AuRWLockFuncs(parent2, PARENT2); -+AuRWLockFuncs(parent3, PARENT3); -+ -+#undef AuReadLockFunc -+#undef AuWriteLockFunc -+#undef AuRWLockFuncs -+ -+#define DiMustNoWaiters(d) AuRwMustNoWaiters(&au_di(d)->di_rwsem) -+#define DiMustAnyLock(d) AuRwMustAnyLock(&au_di(d)->di_rwsem) -+#define DiMustWriteLock(d) AuRwMustWriteLock(&au_di(d)->di_rwsem) -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* todo: memory barrier? */ -+static inline unsigned int au_digen(struct dentry *d) -+{ -+ return atomic_read(&au_di(d)->di_generation); -+} -+ -+static inline void au_h_dentry_init(struct au_hdentry *hdentry) -+{ -+ hdentry->hd_dentry = NULL; -+} -+ -+static inline struct au_hdentry *au_hdentry(struct au_dinfo *di, -+ aufs_bindex_t bindex) -+{ -+ return di->di_hdentry + bindex; -+} -+ -+static inline void au_hdput(struct au_hdentry *hd) -+{ -+ if (hd) -+ dput(hd->hd_dentry); -+} -+ -+static inline aufs_bindex_t au_dbtop(struct dentry *dentry) -+{ -+ DiMustAnyLock(dentry); -+ return au_di(dentry)->di_btop; -+} -+ -+static inline aufs_bindex_t au_dbbot(struct dentry *dentry) -+{ -+ DiMustAnyLock(dentry); -+ return au_di(dentry)->di_bbot; -+} -+ -+static inline aufs_bindex_t au_dbwh(struct dentry *dentry) -+{ -+ DiMustAnyLock(dentry); -+ return au_di(dentry)->di_bwh; -+} -+ -+static inline aufs_bindex_t au_dbdiropq(struct dentry *dentry) -+{ -+ DiMustAnyLock(dentry); -+ return au_di(dentry)->di_bdiropq; -+} -+ -+/* todo: hard/soft set? */ -+static inline void au_set_dbtop(struct dentry *dentry, aufs_bindex_t bindex) -+{ -+ DiMustWriteLock(dentry); -+ au_di(dentry)->di_btop = bindex; -+} -+ -+static inline void au_set_dbbot(struct dentry *dentry, aufs_bindex_t bindex) -+{ -+ DiMustWriteLock(dentry); -+ au_di(dentry)->di_bbot = bindex; -+} -+ -+static inline void au_set_dbwh(struct dentry *dentry, aufs_bindex_t bindex) -+{ -+ DiMustWriteLock(dentry); -+ /* dbwh can be outside of btop - bbot range */ -+ au_di(dentry)->di_bwh = bindex; -+} -+ -+static inline void au_set_dbdiropq(struct dentry *dentry, aufs_bindex_t bindex) -+{ -+ DiMustWriteLock(dentry); -+ au_di(dentry)->di_bdiropq = bindex; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+#ifdef CONFIG_AUFS_HNOTIFY -+static inline void au_digen_dec(struct dentry *d) -+{ -+ atomic_dec(&au_di(d)->di_generation); -+} -+ -+static inline void au_hn_di_reinit(struct dentry *dentry) -+{ -+ dentry->d_fsdata = NULL; -+} -+#else -+AuStubVoid(au_hn_di_reinit, struct dentry *dentry __maybe_unused) -+#endif /* CONFIG_AUFS_HNOTIFY */ -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_DENTRY_H__ */ -diff --git a/fs/aufs/dinfo.c b/fs/aufs/dinfo.c -new file mode 100644 -index 000000000000..ad8e3487db0b ---- /dev/null -+++ b/fs/aufs/dinfo.c -@@ -0,0 +1,541 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * dentry private data -+ */ -+ -+#include "aufs.h" -+ -+void au_di_init_once(void *_dinfo) -+{ -+ struct au_dinfo *dinfo = _dinfo; -+ -+ au_rw_init(&dinfo->di_rwsem); -+} -+ -+struct au_dinfo *au_di_alloc(struct super_block *sb, unsigned int lsc) -+{ -+ struct au_dinfo *dinfo; -+ int nbr, i; -+ -+ dinfo = au_cache_alloc_dinfo(); -+ if (unlikely(!dinfo)) -+ goto out; -+ -+ nbr = au_sbbot(sb) + 1; -+ if (nbr <= 0) -+ nbr = 1; -+ dinfo->di_hdentry = kcalloc(nbr, sizeof(*dinfo->di_hdentry), GFP_NOFS); -+ if (dinfo->di_hdentry) { -+ au_rw_write_lock_nested(&dinfo->di_rwsem, lsc); -+ dinfo->di_btop = -1; -+ dinfo->di_bbot = -1; -+ dinfo->di_bwh = -1; -+ dinfo->di_bdiropq = -1; -+ dinfo->di_tmpfile = 0; -+ for (i = 0; i < nbr; i++) -+ dinfo->di_hdentry[i].hd_id = -1; -+ goto out; -+ } -+ -+ au_cache_free_dinfo(dinfo); -+ dinfo = NULL; -+ -+out: -+ return dinfo; -+} -+ -+void au_di_free(struct au_dinfo *dinfo) -+{ -+ struct au_hdentry *p; -+ aufs_bindex_t bbot, bindex; -+ -+ /* dentry may not be revalidated */ -+ bindex = dinfo->di_btop; -+ if (bindex >= 0) { -+ bbot = dinfo->di_bbot; -+ p = au_hdentry(dinfo, bindex); -+ while (bindex++ <= bbot) -+ au_hdput(p++); -+ } -+ kfree(dinfo->di_hdentry); -+ au_cache_free_dinfo(dinfo); -+} -+ -+void au_di_swap(struct au_dinfo *a, struct au_dinfo *b) -+{ -+ struct au_hdentry *p; -+ aufs_bindex_t bi; -+ -+ AuRwMustWriteLock(&a->di_rwsem); -+ AuRwMustWriteLock(&b->di_rwsem); -+ -+#define DiSwap(v, name) \ -+ do { \ -+ v = a->di_##name; \ -+ a->di_##name = b->di_##name; \ -+ b->di_##name = v; \ -+ } while (0) -+ -+ DiSwap(p, hdentry); -+ DiSwap(bi, btop); -+ DiSwap(bi, bbot); -+ DiSwap(bi, bwh); -+ DiSwap(bi, bdiropq); -+ /* smp_mb(); */ -+ -+#undef DiSwap -+} -+ -+void au_di_cp(struct au_dinfo *dst, struct au_dinfo *src) -+{ -+ AuRwMustWriteLock(&dst->di_rwsem); -+ AuRwMustWriteLock(&src->di_rwsem); -+ -+ dst->di_btop = src->di_btop; -+ dst->di_bbot = src->di_bbot; -+ dst->di_bwh = src->di_bwh; -+ dst->di_bdiropq = src->di_bdiropq; -+ /* smp_mb(); */ -+} -+ -+int au_di_init(struct dentry *dentry) -+{ -+ int err; -+ struct super_block *sb; -+ struct au_dinfo *dinfo; -+ -+ err = 0; -+ sb = dentry->d_sb; -+ dinfo = au_di_alloc(sb, AuLsc_DI_CHILD); -+ if (dinfo) { -+ atomic_set(&dinfo->di_generation, au_sigen(sb)); -+ /* smp_mb(); */ /* atomic_set */ -+ dentry->d_fsdata = dinfo; -+ } else -+ err = -ENOMEM; -+ -+ return err; -+} -+ -+void au_di_fin(struct dentry *dentry) -+{ -+ struct au_dinfo *dinfo; -+ -+ dinfo = au_di(dentry); -+ AuRwDestroy(&dinfo->di_rwsem); -+ au_di_free(dinfo); -+} -+ -+int au_di_realloc(struct au_dinfo *dinfo, int nbr, int may_shrink) -+{ -+ int err, sz; -+ struct au_hdentry *hdp; -+ -+ AuRwMustWriteLock(&dinfo->di_rwsem); -+ -+ err = -ENOMEM; -+ sz = sizeof(*hdp) * (dinfo->di_bbot + 1); -+ if (!sz) -+ sz = sizeof(*hdp); -+ hdp = au_kzrealloc(dinfo->di_hdentry, sz, sizeof(*hdp) * nbr, GFP_NOFS, -+ may_shrink); -+ if (hdp) { -+ dinfo->di_hdentry = hdp; -+ err = 0; -+ } -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static void do_ii_write_lock(struct inode *inode, unsigned int lsc) -+{ -+ switch (lsc) { -+ case AuLsc_DI_CHILD: -+ ii_write_lock_child(inode); -+ break; -+ case AuLsc_DI_CHILD2: -+ ii_write_lock_child2(inode); -+ break; -+ case AuLsc_DI_CHILD3: -+ ii_write_lock_child3(inode); -+ break; -+ case AuLsc_DI_PARENT: -+ ii_write_lock_parent(inode); -+ break; -+ case AuLsc_DI_PARENT2: -+ ii_write_lock_parent2(inode); -+ break; -+ case AuLsc_DI_PARENT3: -+ ii_write_lock_parent3(inode); -+ break; -+ default: -+ BUG(); -+ } -+} -+ -+static void do_ii_read_lock(struct inode *inode, unsigned int lsc) -+{ -+ switch (lsc) { -+ case AuLsc_DI_CHILD: -+ ii_read_lock_child(inode); -+ break; -+ case AuLsc_DI_CHILD2: -+ ii_read_lock_child2(inode); -+ break; -+ case AuLsc_DI_CHILD3: -+ ii_read_lock_child3(inode); -+ break; -+ case AuLsc_DI_PARENT: -+ ii_read_lock_parent(inode); -+ break; -+ case AuLsc_DI_PARENT2: -+ ii_read_lock_parent2(inode); -+ break; -+ case AuLsc_DI_PARENT3: -+ ii_read_lock_parent3(inode); -+ break; -+ default: -+ BUG(); -+ } -+} -+ -+void di_read_lock(struct dentry *d, int flags, unsigned int lsc) -+{ -+ struct inode *inode; -+ -+ au_rw_read_lock_nested(&au_di(d)->di_rwsem, lsc); -+ if (d_really_is_positive(d)) { -+ inode = d_inode(d); -+ if (au_ftest_lock(flags, IW)) -+ do_ii_write_lock(inode, lsc); -+ else if (au_ftest_lock(flags, IR)) -+ do_ii_read_lock(inode, lsc); -+ } -+} -+ -+void di_read_unlock(struct dentry *d, int flags) -+{ -+ struct inode *inode; -+ -+ if (d_really_is_positive(d)) { -+ inode = d_inode(d); -+ if (au_ftest_lock(flags, IW)) { -+ au_dbg_verify_dinode(d); -+ ii_write_unlock(inode); -+ } else if (au_ftest_lock(flags, IR)) { -+ au_dbg_verify_dinode(d); -+ ii_read_unlock(inode); -+ } -+ } -+ au_rw_read_unlock(&au_di(d)->di_rwsem); -+} -+ -+void di_downgrade_lock(struct dentry *d, int flags) -+{ -+ if (d_really_is_positive(d) && au_ftest_lock(flags, IR)) -+ ii_downgrade_lock(d_inode(d)); -+ au_rw_dgrade_lock(&au_di(d)->di_rwsem); -+} -+ -+void di_write_lock(struct dentry *d, unsigned int lsc) -+{ -+ au_rw_write_lock_nested(&au_di(d)->di_rwsem, lsc); -+ if (d_really_is_positive(d)) -+ do_ii_write_lock(d_inode(d), lsc); -+} -+ -+void di_write_unlock(struct dentry *d) -+{ -+ au_dbg_verify_dinode(d); -+ if (d_really_is_positive(d)) -+ ii_write_unlock(d_inode(d)); -+ au_rw_write_unlock(&au_di(d)->di_rwsem); -+} -+ -+void di_write_lock2_child(struct dentry *d1, struct dentry *d2, int isdir) -+{ -+ AuDebugOn(d1 == d2 -+ || d_inode(d1) == d_inode(d2) -+ || d1->d_sb != d2->d_sb); -+ -+ if ((isdir && au_test_subdir(d1, d2)) -+ || d1 < d2) { -+ di_write_lock_child(d1); -+ di_write_lock_child2(d2); -+ } else { -+ di_write_lock_child(d2); -+ di_write_lock_child2(d1); -+ } -+} -+ -+void di_write_lock2_parent(struct dentry *d1, struct dentry *d2, int isdir) -+{ -+ AuDebugOn(d1 == d2 -+ || d_inode(d1) == d_inode(d2) -+ || d1->d_sb != d2->d_sb); -+ -+ if ((isdir && au_test_subdir(d1, d2)) -+ || d1 < d2) { -+ di_write_lock_parent(d1); -+ di_write_lock_parent2(d2); -+ } else { -+ di_write_lock_parent(d2); -+ di_write_lock_parent2(d1); -+ } -+} -+ -+void di_write_unlock2(struct dentry *d1, struct dentry *d2) -+{ -+ di_write_unlock(d1); -+ if (d_inode(d1) == d_inode(d2)) -+ au_rw_write_unlock(&au_di(d2)->di_rwsem); -+ else -+ di_write_unlock(d2); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct dentry *au_h_dptr(struct dentry *dentry, aufs_bindex_t bindex) -+{ -+ struct dentry *d; -+ -+ DiMustAnyLock(dentry); -+ -+ if (au_dbtop(dentry) < 0 || bindex < au_dbtop(dentry)) -+ return NULL; -+ AuDebugOn(bindex < 0); -+ d = au_hdentry(au_di(dentry), bindex)->hd_dentry; -+ AuDebugOn(d && au_dcount(d) <= 0); -+ return d; -+} -+ -+/* -+ * extended version of au_h_dptr(). -+ * returns a hashed and positive (or linkable) h_dentry in bindex, NULL, or -+ * error. -+ */ -+struct dentry *au_h_d_alias(struct dentry *dentry, aufs_bindex_t bindex) -+{ -+ struct dentry *h_dentry; -+ struct inode *inode, *h_inode; -+ -+ AuDebugOn(d_really_is_negative(dentry)); -+ -+ h_dentry = NULL; -+ if (au_dbtop(dentry) <= bindex -+ && bindex <= au_dbbot(dentry)) -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (h_dentry && !au_d_linkable(h_dentry)) { -+ dget(h_dentry); -+ goto out; /* success */ -+ } -+ -+ inode = d_inode(dentry); -+ AuDebugOn(bindex < au_ibtop(inode)); -+ AuDebugOn(au_ibbot(inode) < bindex); -+ h_inode = au_h_iptr(inode, bindex); -+ h_dentry = d_find_alias(h_inode); -+ if (h_dentry) { -+ if (!IS_ERR(h_dentry)) { -+ if (!au_d_linkable(h_dentry)) -+ goto out; /* success */ -+ dput(h_dentry); -+ } else -+ goto out; -+ } -+ -+ if (au_opt_test(au_mntflags(dentry->d_sb), PLINK)) { -+ h_dentry = au_plink_lkup(inode, bindex); -+ AuDebugOn(!h_dentry); -+ if (!IS_ERR(h_dentry)) { -+ if (!au_d_hashed_positive(h_dentry)) -+ goto out; /* success */ -+ dput(h_dentry); -+ h_dentry = NULL; -+ } -+ } -+ -+out: -+ AuDbgDentry(h_dentry); -+ return h_dentry; -+} -+ -+aufs_bindex_t au_dbtail(struct dentry *dentry) -+{ -+ aufs_bindex_t bbot, bwh; -+ -+ bbot = au_dbbot(dentry); -+ if (0 <= bbot) { -+ bwh = au_dbwh(dentry); -+ if (!bwh) -+ return bwh; -+ if (0 < bwh && bwh < bbot) -+ return bwh - 1; -+ } -+ return bbot; -+} -+ -+aufs_bindex_t au_dbtaildir(struct dentry *dentry) -+{ -+ aufs_bindex_t bbot, bopq; -+ -+ bbot = au_dbtail(dentry); -+ if (0 <= bbot) { -+ bopq = au_dbdiropq(dentry); -+ if (0 <= bopq && bopq < bbot) -+ bbot = bopq; -+ } -+ return bbot; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void au_set_h_dptr(struct dentry *dentry, aufs_bindex_t bindex, -+ struct dentry *h_dentry) -+{ -+ struct au_dinfo *dinfo; -+ struct au_hdentry *hd; -+ struct au_branch *br; -+ -+ DiMustWriteLock(dentry); -+ -+ dinfo = au_di(dentry); -+ hd = au_hdentry(dinfo, bindex); -+ au_hdput(hd); -+ hd->hd_dentry = h_dentry; -+ if (h_dentry) { -+ br = au_sbr(dentry->d_sb, bindex); -+ hd->hd_id = br->br_id; -+ } -+} -+ -+int au_dbrange_test(struct dentry *dentry) -+{ -+ int err; -+ aufs_bindex_t btop, bbot; -+ -+ err = 0; -+ btop = au_dbtop(dentry); -+ bbot = au_dbbot(dentry); -+ if (btop >= 0) -+ AuDebugOn(bbot < 0 && btop > bbot); -+ else { -+ err = -EIO; -+ AuDebugOn(bbot >= 0); -+ } -+ -+ return err; -+} -+ -+int au_digen_test(struct dentry *dentry, unsigned int sigen) -+{ -+ int err; -+ -+ err = 0; -+ if (unlikely(au_digen(dentry) != sigen -+ || au_iigen_test(d_inode(dentry), sigen))) -+ err = -EIO; -+ -+ return err; -+} -+ -+void au_update_digen(struct dentry *dentry) -+{ -+ atomic_set(&au_di(dentry)->di_generation, au_sigen(dentry->d_sb)); -+ /* smp_mb(); */ /* atomic_set */ -+} -+ -+void au_update_dbrange(struct dentry *dentry, int do_put_zero) -+{ -+ struct au_dinfo *dinfo; -+ struct dentry *h_d; -+ struct au_hdentry *hdp; -+ aufs_bindex_t bindex, bbot; -+ -+ DiMustWriteLock(dentry); -+ -+ dinfo = au_di(dentry); -+ if (!dinfo || dinfo->di_btop < 0) -+ return; -+ -+ if (do_put_zero) { -+ bbot = dinfo->di_bbot; -+ bindex = dinfo->di_btop; -+ hdp = au_hdentry(dinfo, bindex); -+ for (; bindex <= bbot; bindex++, hdp++) { -+ h_d = hdp->hd_dentry; -+ if (h_d && d_is_negative(h_d)) -+ au_set_h_dptr(dentry, bindex, NULL); -+ } -+ } -+ -+ dinfo->di_btop = 0; -+ hdp = au_hdentry(dinfo, dinfo->di_btop); -+ for (; dinfo->di_btop <= dinfo->di_bbot; dinfo->di_btop++, hdp++) -+ if (hdp->hd_dentry) -+ break; -+ if (dinfo->di_btop > dinfo->di_bbot) { -+ dinfo->di_btop = -1; -+ dinfo->di_bbot = -1; -+ return; -+ } -+ -+ hdp = au_hdentry(dinfo, dinfo->di_bbot); -+ for (; dinfo->di_bbot >= 0; dinfo->di_bbot--, hdp--) -+ if (hdp->hd_dentry) -+ break; -+ AuDebugOn(dinfo->di_btop > dinfo->di_bbot || dinfo->di_bbot < 0); -+} -+ -+void au_update_dbtop(struct dentry *dentry) -+{ -+ aufs_bindex_t bindex, bbot; -+ struct dentry *h_dentry; -+ -+ bbot = au_dbbot(dentry); -+ for (bindex = au_dbtop(dentry); bindex <= bbot; bindex++) { -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (!h_dentry) -+ continue; -+ if (d_is_positive(h_dentry)) { -+ au_set_dbtop(dentry, bindex); -+ return; -+ } -+ au_set_h_dptr(dentry, bindex, NULL); -+ } -+} -+ -+void au_update_dbbot(struct dentry *dentry) -+{ -+ aufs_bindex_t bindex, btop; -+ struct dentry *h_dentry; -+ -+ btop = au_dbtop(dentry); -+ for (bindex = au_dbbot(dentry); bindex >= btop; bindex--) { -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (!h_dentry) -+ continue; -+ if (d_is_positive(h_dentry)) { -+ au_set_dbbot(dentry, bindex); -+ return; -+ } -+ au_set_h_dptr(dentry, bindex, NULL); -+ } -+} -+ -+int au_find_dbindex(struct dentry *dentry, struct dentry *h_dentry) -+{ -+ aufs_bindex_t bindex, bbot; -+ -+ bbot = au_dbbot(dentry); -+ for (bindex = au_dbtop(dentry); bindex <= bbot; bindex++) -+ if (au_h_dptr(dentry, bindex) == h_dentry) -+ return bindex; -+ return -1; -+} -diff --git a/fs/aufs/dir.c b/fs/aufs/dir.c -new file mode 100644 -index 000000000000..aab6ff4c412b ---- /dev/null -+++ b/fs/aufs/dir.c -@@ -0,0 +1,747 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * directory operations -+ */ -+ -+#include -+#include "aufs.h" -+ -+void au_add_nlink(struct inode *dir, struct inode *h_dir) -+{ -+ unsigned int nlink; -+ -+ AuDebugOn(!S_ISDIR(dir->i_mode) || !S_ISDIR(h_dir->i_mode)); -+ -+ nlink = dir->i_nlink; -+ nlink += h_dir->i_nlink - 2; -+ if (h_dir->i_nlink < 2) -+ nlink += 2; -+ smp_mb(); /* for i_nlink */ -+ /* 0 can happen in revaliding */ -+ set_nlink(dir, nlink); -+} -+ -+void au_sub_nlink(struct inode *dir, struct inode *h_dir) -+{ -+ unsigned int nlink; -+ -+ AuDebugOn(!S_ISDIR(dir->i_mode) || !S_ISDIR(h_dir->i_mode)); -+ -+ nlink = dir->i_nlink; -+ nlink -= h_dir->i_nlink - 2; -+ if (h_dir->i_nlink < 2) -+ nlink -= 2; -+ smp_mb(); /* for i_nlink */ -+ /* nlink == 0 means the branch-fs is broken */ -+ set_nlink(dir, nlink); -+} -+ -+loff_t au_dir_size(struct file *file, struct dentry *dentry) -+{ -+ loff_t sz; -+ aufs_bindex_t bindex, bbot; -+ struct file *h_file; -+ struct dentry *h_dentry; -+ -+ sz = 0; -+ if (file) { -+ AuDebugOn(!d_is_dir(file->f_path.dentry)); -+ -+ bbot = au_fbbot_dir(file); -+ for (bindex = au_fbtop(file); -+ bindex <= bbot && sz < KMALLOC_MAX_SIZE; -+ bindex++) { -+ h_file = au_hf_dir(file, bindex); -+ if (h_file && file_inode(h_file)) -+ sz += vfsub_f_size_read(h_file); -+ } -+ } else { -+ AuDebugOn(!dentry); -+ AuDebugOn(!d_is_dir(dentry)); -+ -+ bbot = au_dbtaildir(dentry); -+ for (bindex = au_dbtop(dentry); -+ bindex <= bbot && sz < KMALLOC_MAX_SIZE; -+ bindex++) { -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (h_dentry && d_is_positive(h_dentry)) -+ sz += i_size_read(d_inode(h_dentry)); -+ } -+ } -+ if (sz < KMALLOC_MAX_SIZE) -+ sz = roundup_pow_of_two(sz); -+ if (sz > KMALLOC_MAX_SIZE) -+ sz = KMALLOC_MAX_SIZE; -+ else if (sz < NAME_MAX) { -+ BUILD_BUG_ON(AUFS_RDBLK_DEF < NAME_MAX); -+ sz = AUFS_RDBLK_DEF; -+ } -+ return sz; -+} -+ -+struct au_dir_ts_arg { -+ struct dentry *dentry; -+ aufs_bindex_t brid; -+}; -+ -+static void au_do_dir_ts(void *arg) -+{ -+ struct au_dir_ts_arg *a = arg; -+ struct au_dtime dt; -+ struct path h_path; -+ struct inode *dir, *h_dir; -+ struct super_block *sb; -+ struct au_branch *br; -+ struct au_hinode *hdir; -+ int err; -+ aufs_bindex_t btop, bindex; -+ -+ sb = a->dentry->d_sb; -+ if (d_really_is_negative(a->dentry)) -+ goto out; -+ /* no dir->i_mutex lock */ -+ aufs_read_lock(a->dentry, AuLock_DW); /* noflush */ -+ -+ dir = d_inode(a->dentry); -+ btop = au_ibtop(dir); -+ bindex = au_br_index(sb, a->brid); -+ if (bindex < btop) -+ goto out_unlock; -+ -+ br = au_sbr(sb, bindex); -+ h_path.dentry = au_h_dptr(a->dentry, bindex); -+ if (!h_path.dentry) -+ goto out_unlock; -+ h_path.mnt = au_br_mnt(br); -+ au_dtime_store(&dt, a->dentry, &h_path); -+ -+ br = au_sbr(sb, btop); -+ if (!au_br_writable(br->br_perm)) -+ goto out_unlock; -+ h_path.dentry = au_h_dptr(a->dentry, btop); -+ h_path.mnt = au_br_mnt(br); -+ err = vfsub_mnt_want_write(h_path.mnt); -+ if (err) -+ goto out_unlock; -+ hdir = au_hi(dir, btop); -+ au_hn_inode_lock_nested(hdir, AuLsc_I_PARENT); -+ h_dir = au_h_iptr(dir, btop); -+ if (h_dir->i_nlink -+ && timespec_compare(&h_dir->i_mtime, &dt.dt_mtime) < 0) { -+ dt.dt_h_path = h_path; -+ au_dtime_revert(&dt); -+ } -+ au_hn_inode_unlock(hdir); -+ vfsub_mnt_drop_write(h_path.mnt); -+ au_cpup_attr_timesizes(dir); -+ -+out_unlock: -+ aufs_read_unlock(a->dentry, AuLock_DW); -+out: -+ dput(a->dentry); -+ au_nwt_done(&au_sbi(sb)->si_nowait); -+ kfree(arg); -+} -+ -+void au_dir_ts(struct inode *dir, aufs_bindex_t bindex) -+{ -+ int perm, wkq_err; -+ aufs_bindex_t btop; -+ struct au_dir_ts_arg *arg; -+ struct dentry *dentry; -+ struct super_block *sb; -+ -+ IMustLock(dir); -+ -+ dentry = d_find_any_alias(dir); -+ AuDebugOn(!dentry); -+ sb = dentry->d_sb; -+ btop = au_ibtop(dir); -+ if (btop == bindex) { -+ au_cpup_attr_timesizes(dir); -+ goto out; -+ } -+ -+ perm = au_sbr_perm(sb, btop); -+ if (!au_br_writable(perm)) -+ goto out; -+ -+ arg = kmalloc(sizeof(*arg), GFP_NOFS); -+ if (!arg) -+ goto out; -+ -+ arg->dentry = dget(dentry); /* will be dput-ted by au_do_dir_ts() */ -+ arg->brid = au_sbr_id(sb, bindex); -+ wkq_err = au_wkq_nowait(au_do_dir_ts, arg, sb, /*flags*/0); -+ if (unlikely(wkq_err)) { -+ pr_err("wkq %d\n", wkq_err); -+ dput(dentry); -+ kfree(arg); -+ } -+ -+out: -+ dput(dentry); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int reopen_dir(struct file *file) -+{ -+ int err; -+ unsigned int flags; -+ aufs_bindex_t bindex, btail, btop; -+ struct dentry *dentry, *h_dentry; -+ struct file *h_file; -+ -+ /* open all lower dirs */ -+ dentry = file->f_path.dentry; -+ btop = au_dbtop(dentry); -+ for (bindex = au_fbtop(file); bindex < btop; bindex++) -+ au_set_h_fptr(file, bindex, NULL); -+ au_set_fbtop(file, btop); -+ -+ btail = au_dbtaildir(dentry); -+ for (bindex = au_fbbot_dir(file); btail < bindex; bindex--) -+ au_set_h_fptr(file, bindex, NULL); -+ au_set_fbbot_dir(file, btail); -+ -+ flags = vfsub_file_flags(file); -+ for (bindex = btop; bindex <= btail; bindex++) { -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (!h_dentry) -+ continue; -+ h_file = au_hf_dir(file, bindex); -+ if (h_file) -+ continue; -+ -+ h_file = au_h_open(dentry, bindex, flags, file, /*force_wr*/0); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; /* close all? */ -+ au_set_h_fptr(file, bindex, h_file); -+ } -+ au_update_figen(file); -+ /* todo: necessary? */ -+ /* file->f_ra = h_file->f_ra; */ -+ err = 0; -+ -+out: -+ return err; -+} -+ -+static int do_open_dir(struct file *file, int flags, struct file *h_file) -+{ -+ int err; -+ aufs_bindex_t bindex, btail; -+ struct dentry *dentry, *h_dentry; -+ struct vfsmount *mnt; -+ -+ FiMustWriteLock(file); -+ AuDebugOn(h_file); -+ -+ err = 0; -+ mnt = file->f_path.mnt; -+ dentry = file->f_path.dentry; -+ file->f_version = d_inode(dentry)->i_version; -+ bindex = au_dbtop(dentry); -+ au_set_fbtop(file, bindex); -+ btail = au_dbtaildir(dentry); -+ au_set_fbbot_dir(file, btail); -+ for (; !err && bindex <= btail; bindex++) { -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (!h_dentry) -+ continue; -+ -+ err = vfsub_test_mntns(mnt, h_dentry->d_sb); -+ if (unlikely(err)) -+ break; -+ h_file = au_h_open(dentry, bindex, flags, file, /*force_wr*/0); -+ if (IS_ERR(h_file)) { -+ err = PTR_ERR(h_file); -+ break; -+ } -+ au_set_h_fptr(file, bindex, h_file); -+ } -+ au_update_figen(file); -+ /* todo: necessary? */ -+ /* file->f_ra = h_file->f_ra; */ -+ if (!err) -+ return 0; /* success */ -+ -+ /* close all */ -+ for (bindex = au_fbtop(file); bindex <= btail; bindex++) -+ au_set_h_fptr(file, bindex, NULL); -+ au_set_fbtop(file, -1); -+ au_set_fbbot_dir(file, -1); -+ -+ return err; -+} -+ -+static int aufs_open_dir(struct inode *inode __maybe_unused, -+ struct file *file) -+{ -+ int err; -+ struct super_block *sb; -+ struct au_fidir *fidir; -+ -+ err = -ENOMEM; -+ sb = file->f_path.dentry->d_sb; -+ si_read_lock(sb, AuLock_FLUSH); -+ fidir = au_fidir_alloc(sb); -+ if (fidir) { -+ struct au_do_open_args args = { -+ .open = do_open_dir, -+ .fidir = fidir -+ }; -+ err = au_do_open(file, &args); -+ if (unlikely(err)) -+ kfree(fidir); -+ } -+ si_read_unlock(sb); -+ return err; -+} -+ -+static int aufs_release_dir(struct inode *inode __maybe_unused, -+ struct file *file) -+{ -+ struct au_vdir *vdir_cache; -+ struct au_finfo *finfo; -+ struct au_fidir *fidir; -+ struct au_hfile *hf; -+ aufs_bindex_t bindex, bbot; -+ -+ finfo = au_fi(file); -+ fidir = finfo->fi_hdir; -+ if (fidir) { -+ au_hbl_del(&finfo->fi_hlist, -+ &au_sbi(file->f_path.dentry->d_sb)->si_files); -+ vdir_cache = fidir->fd_vdir_cache; /* lock-free */ -+ if (vdir_cache) -+ au_vdir_free(vdir_cache); -+ -+ bindex = finfo->fi_btop; -+ if (bindex >= 0) { -+ hf = fidir->fd_hfile + bindex; -+ /* -+ * calls fput() instead of filp_close(), -+ * since no dnotify or lock for the lower file. -+ */ -+ bbot = fidir->fd_bbot; -+ for (; bindex <= bbot; bindex++, hf++) -+ if (hf->hf_file) -+ au_hfput(hf, /*execed*/0); -+ } -+ kfree(fidir); -+ finfo->fi_hdir = NULL; -+ } -+ au_finfo_fin(file); -+ return 0; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_do_flush_dir(struct file *file, fl_owner_t id) -+{ -+ int err; -+ aufs_bindex_t bindex, bbot; -+ struct file *h_file; -+ -+ err = 0; -+ bbot = au_fbbot_dir(file); -+ for (bindex = au_fbtop(file); !err && bindex <= bbot; bindex++) { -+ h_file = au_hf_dir(file, bindex); -+ if (h_file) -+ err = vfsub_flush(h_file, id); -+ } -+ return err; -+} -+ -+static int aufs_flush_dir(struct file *file, fl_owner_t id) -+{ -+ return au_do_flush(file, id, au_do_flush_dir); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_do_fsync_dir_no_file(struct dentry *dentry, int datasync) -+{ -+ int err; -+ aufs_bindex_t bbot, bindex; -+ struct inode *inode; -+ struct super_block *sb; -+ -+ err = 0; -+ sb = dentry->d_sb; -+ inode = d_inode(dentry); -+ IMustLock(inode); -+ bbot = au_dbbot(dentry); -+ for (bindex = au_dbtop(dentry); !err && bindex <= bbot; bindex++) { -+ struct path h_path; -+ -+ if (au_test_ro(sb, bindex, inode)) -+ continue; -+ h_path.dentry = au_h_dptr(dentry, bindex); -+ if (!h_path.dentry) -+ continue; -+ -+ h_path.mnt = au_sbr_mnt(sb, bindex); -+ err = vfsub_fsync(NULL, &h_path, datasync); -+ } -+ -+ return err; -+} -+ -+static int au_do_fsync_dir(struct file *file, int datasync) -+{ -+ int err; -+ aufs_bindex_t bbot, bindex; -+ struct file *h_file; -+ struct super_block *sb; -+ struct inode *inode; -+ -+ err = au_reval_and_lock_fdi(file, reopen_dir, /*wlock*/1, /*fi_lsc*/0); -+ if (unlikely(err)) -+ goto out; -+ -+ inode = file_inode(file); -+ sb = inode->i_sb; -+ bbot = au_fbbot_dir(file); -+ for (bindex = au_fbtop(file); !err && bindex <= bbot; bindex++) { -+ h_file = au_hf_dir(file, bindex); -+ if (!h_file || au_test_ro(sb, bindex, inode)) -+ continue; -+ -+ err = vfsub_fsync(h_file, &h_file->f_path, datasync); -+ } -+ -+out: -+ return err; -+} -+ -+/* -+ * @file may be NULL -+ */ -+static int aufs_fsync_dir(struct file *file, loff_t start, loff_t end, -+ int datasync) -+{ -+ int err; -+ struct dentry *dentry; -+ struct inode *inode; -+ struct super_block *sb; -+ -+ err = 0; -+ dentry = file->f_path.dentry; -+ inode = d_inode(dentry); -+ inode_lock(inode); -+ sb = dentry->d_sb; -+ si_noflush_read_lock(sb); -+ if (file) -+ err = au_do_fsync_dir(file, datasync); -+ else { -+ di_write_lock_child(dentry); -+ err = au_do_fsync_dir_no_file(dentry, datasync); -+ } -+ au_cpup_attr_timesizes(inode); -+ di_write_unlock(dentry); -+ if (file) -+ fi_write_unlock(file); -+ -+ si_read_unlock(sb); -+ inode_unlock(inode); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int aufs_iterate_shared(struct file *file, struct dir_context *ctx) -+{ -+ int err; -+ struct dentry *dentry; -+ struct inode *inode, *h_inode; -+ struct super_block *sb; -+ -+ AuDbg("%pD, ctx{%pf, %llu}\n", file, ctx->actor, ctx->pos); -+ -+ dentry = file->f_path.dentry; -+ inode = d_inode(dentry); -+ IMustLock(inode); -+ -+ sb = dentry->d_sb; -+ si_read_lock(sb, AuLock_FLUSH); -+ err = au_reval_and_lock_fdi(file, reopen_dir, /*wlock*/1, /*fi_lsc*/0); -+ if (unlikely(err)) -+ goto out; -+ err = au_alive_dir(dentry); -+ if (!err) -+ err = au_vdir_init(file); -+ di_downgrade_lock(dentry, AuLock_IR); -+ if (unlikely(err)) -+ goto out_unlock; -+ -+ h_inode = au_h_iptr(inode, au_ibtop(inode)); -+ if (!au_test_nfsd()) { -+ err = au_vdir_fill_de(file, ctx); -+ fsstack_copy_attr_atime(inode, h_inode); -+ } else { -+ /* -+ * nfsd filldir may call lookup_one_len(), vfs_getattr(), -+ * encode_fh() and others. -+ */ -+ atomic_inc(&h_inode->i_count); -+ di_read_unlock(dentry, AuLock_IR); -+ si_read_unlock(sb); -+ err = au_vdir_fill_de(file, ctx); -+ fsstack_copy_attr_atime(inode, h_inode); -+ fi_write_unlock(file); -+ iput(h_inode); -+ -+ AuTraceErr(err); -+ return err; -+ } -+ -+out_unlock: -+ di_read_unlock(dentry, AuLock_IR); -+ fi_write_unlock(file); -+out: -+ si_read_unlock(sb); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+#define AuTestEmpty_WHONLY 1 -+#define AuTestEmpty_CALLED (1 << 1) -+#define AuTestEmpty_SHWH (1 << 2) -+#define au_ftest_testempty(flags, name) ((flags) & AuTestEmpty_##name) -+#define au_fset_testempty(flags, name) \ -+ do { (flags) |= AuTestEmpty_##name; } while (0) -+#define au_fclr_testempty(flags, name) \ -+ do { (flags) &= ~AuTestEmpty_##name; } while (0) -+ -+#ifndef CONFIG_AUFS_SHWH -+#undef AuTestEmpty_SHWH -+#define AuTestEmpty_SHWH 0 -+#endif -+ -+struct test_empty_arg { -+ struct dir_context ctx; -+ struct au_nhash *whlist; -+ unsigned int flags; -+ int err; -+ aufs_bindex_t bindex; -+}; -+ -+static int test_empty_cb(struct dir_context *ctx, const char *__name, -+ int namelen, loff_t offset __maybe_unused, u64 ino, -+ unsigned int d_type) -+{ -+ struct test_empty_arg *arg = container_of(ctx, struct test_empty_arg, -+ ctx); -+ char *name = (void *)__name; -+ -+ arg->err = 0; -+ au_fset_testempty(arg->flags, CALLED); -+ /* smp_mb(); */ -+ if (name[0] == '.' -+ && (namelen == 1 || (name[1] == '.' && namelen == 2))) -+ goto out; /* success */ -+ -+ if (namelen <= AUFS_WH_PFX_LEN -+ || memcmp(name, AUFS_WH_PFX, AUFS_WH_PFX_LEN)) { -+ if (au_ftest_testempty(arg->flags, WHONLY) -+ && !au_nhash_test_known_wh(arg->whlist, name, namelen)) -+ arg->err = -ENOTEMPTY; -+ goto out; -+ } -+ -+ name += AUFS_WH_PFX_LEN; -+ namelen -= AUFS_WH_PFX_LEN; -+ if (!au_nhash_test_known_wh(arg->whlist, name, namelen)) -+ arg->err = au_nhash_append_wh -+ (arg->whlist, name, namelen, ino, d_type, arg->bindex, -+ au_ftest_testempty(arg->flags, SHWH)); -+ -+out: -+ /* smp_mb(); */ -+ AuTraceErr(arg->err); -+ return arg->err; -+} -+ -+static int do_test_empty(struct dentry *dentry, struct test_empty_arg *arg) -+{ -+ int err; -+ struct file *h_file; -+ -+ h_file = au_h_open(dentry, arg->bindex, -+ O_RDONLY | O_NONBLOCK | O_DIRECTORY | O_LARGEFILE, -+ /*file*/NULL, /*force_wr*/0); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ -+ err = 0; -+ if (!au_opt_test(au_mntflags(dentry->d_sb), UDBA_NONE) -+ && !file_inode(h_file)->i_nlink) -+ goto out_put; -+ -+ do { -+ arg->err = 0; -+ au_fclr_testempty(arg->flags, CALLED); -+ /* smp_mb(); */ -+ err = vfsub_iterate_dir(h_file, &arg->ctx); -+ if (err >= 0) -+ err = arg->err; -+ } while (!err && au_ftest_testempty(arg->flags, CALLED)); -+ -+out_put: -+ fput(h_file); -+ au_sbr_put(dentry->d_sb, arg->bindex); -+out: -+ return err; -+} -+ -+struct do_test_empty_args { -+ int *errp; -+ struct dentry *dentry; -+ struct test_empty_arg *arg; -+}; -+ -+static void call_do_test_empty(void *args) -+{ -+ struct do_test_empty_args *a = args; -+ *a->errp = do_test_empty(a->dentry, a->arg); -+} -+ -+static int sio_test_empty(struct dentry *dentry, struct test_empty_arg *arg) -+{ -+ int err, wkq_err; -+ struct dentry *h_dentry; -+ struct inode *h_inode; -+ -+ h_dentry = au_h_dptr(dentry, arg->bindex); -+ h_inode = d_inode(h_dentry); -+ /* todo: i_mode changes anytime? */ -+ vfsub_inode_lock_shared_nested(h_inode, AuLsc_I_CHILD); -+ err = au_test_h_perm_sio(h_inode, MAY_EXEC | MAY_READ); -+ inode_unlock_shared(h_inode); -+ if (!err) -+ err = do_test_empty(dentry, arg); -+ else { -+ struct do_test_empty_args args = { -+ .errp = &err, -+ .dentry = dentry, -+ .arg = arg -+ }; -+ unsigned int flags = arg->flags; -+ -+ wkq_err = au_wkq_wait(call_do_test_empty, &args); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ arg->flags = flags; -+ } -+ -+ return err; -+} -+ -+int au_test_empty_lower(struct dentry *dentry) -+{ -+ int err; -+ unsigned int rdhash; -+ aufs_bindex_t bindex, btop, btail; -+ struct au_nhash whlist; -+ struct test_empty_arg arg = { -+ .ctx = { -+ .actor = test_empty_cb -+ } -+ }; -+ int (*test_empty)(struct dentry *dentry, struct test_empty_arg *arg); -+ -+ SiMustAnyLock(dentry->d_sb); -+ -+ rdhash = au_sbi(dentry->d_sb)->si_rdhash; -+ if (!rdhash) -+ rdhash = au_rdhash_est(au_dir_size(/*file*/NULL, dentry)); -+ err = au_nhash_alloc(&whlist, rdhash, GFP_NOFS); -+ if (unlikely(err)) -+ goto out; -+ -+ arg.flags = 0; -+ arg.whlist = &whlist; -+ btop = au_dbtop(dentry); -+ if (au_opt_test(au_mntflags(dentry->d_sb), SHWH)) -+ au_fset_testempty(arg.flags, SHWH); -+ test_empty = do_test_empty; -+ if (au_opt_test(au_mntflags(dentry->d_sb), DIRPERM1)) -+ test_empty = sio_test_empty; -+ arg.bindex = btop; -+ err = test_empty(dentry, &arg); -+ if (unlikely(err)) -+ goto out_whlist; -+ -+ au_fset_testempty(arg.flags, WHONLY); -+ btail = au_dbtaildir(dentry); -+ for (bindex = btop + 1; !err && bindex <= btail; bindex++) { -+ struct dentry *h_dentry; -+ -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (h_dentry && d_is_positive(h_dentry)) { -+ arg.bindex = bindex; -+ err = test_empty(dentry, &arg); -+ } -+ } -+ -+out_whlist: -+ au_nhash_wh_free(&whlist); -+out: -+ return err; -+} -+ -+int au_test_empty(struct dentry *dentry, struct au_nhash *whlist) -+{ -+ int err; -+ struct test_empty_arg arg = { -+ .ctx = { -+ .actor = test_empty_cb -+ } -+ }; -+ aufs_bindex_t bindex, btail; -+ -+ err = 0; -+ arg.whlist = whlist; -+ arg.flags = AuTestEmpty_WHONLY; -+ if (au_opt_test(au_mntflags(dentry->d_sb), SHWH)) -+ au_fset_testempty(arg.flags, SHWH); -+ btail = au_dbtaildir(dentry); -+ for (bindex = au_dbtop(dentry); !err && bindex <= btail; bindex++) { -+ struct dentry *h_dentry; -+ -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (h_dentry && d_is_positive(h_dentry)) { -+ arg.bindex = bindex; -+ err = sio_test_empty(dentry, &arg); -+ } -+ } -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+const struct file_operations aufs_dir_fop = { -+ .owner = THIS_MODULE, -+ .llseek = default_llseek, -+ .read = generic_read_dir, -+ .iterate_shared = aufs_iterate_shared, -+ .unlocked_ioctl = aufs_ioctl_dir, -+#ifdef CONFIG_COMPAT -+ .compat_ioctl = aufs_compat_ioctl_dir, -+#endif -+ .open = aufs_open_dir, -+ .release = aufs_release_dir, -+ .flush = aufs_flush_dir, -+ .fsync = aufs_fsync_dir -+}; -diff --git a/fs/aufs/dir.h b/fs/aufs/dir.h -new file mode 100644 -index 000000000000..04b652f787d6 ---- /dev/null -+++ b/fs/aufs/dir.h -@@ -0,0 +1,119 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * directory operations -+ */ -+ -+#ifndef __AUFS_DIR_H__ -+#define __AUFS_DIR_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* need to be faster and smaller */ -+ -+struct au_nhash { -+ unsigned int nh_num; -+ struct hlist_head *nh_head; -+}; -+ -+struct au_vdir_destr { -+ unsigned char len; -+ unsigned char name[0]; -+} __packed; -+ -+struct au_vdir_dehstr { -+ struct hlist_node hash; -+ struct au_vdir_destr *str; -+} ____cacheline_aligned_in_smp; -+ -+struct au_vdir_de { -+ ino_t de_ino; -+ unsigned char de_type; -+ /* caution: packed */ -+ struct au_vdir_destr de_str; -+} __packed; -+ -+struct au_vdir_wh { -+ struct hlist_node wh_hash; -+#ifdef CONFIG_AUFS_SHWH -+ ino_t wh_ino; -+ aufs_bindex_t wh_bindex; -+ unsigned char wh_type; -+#else -+ aufs_bindex_t wh_bindex; -+#endif -+ /* caution: packed */ -+ struct au_vdir_destr wh_str; -+} __packed; -+ -+union au_vdir_deblk_p { -+ unsigned char *deblk; -+ struct au_vdir_de *de; -+}; -+ -+struct au_vdir { -+ unsigned char **vd_deblk; -+ unsigned long vd_nblk; -+ struct { -+ unsigned long ul; -+ union au_vdir_deblk_p p; -+ } vd_last; -+ -+ unsigned long vd_version; -+ unsigned int vd_deblk_sz; -+ unsigned long vd_jiffy; -+} ____cacheline_aligned_in_smp; -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* dir.c */ -+extern const struct file_operations aufs_dir_fop; -+void au_add_nlink(struct inode *dir, struct inode *h_dir); -+void au_sub_nlink(struct inode *dir, struct inode *h_dir); -+loff_t au_dir_size(struct file *file, struct dentry *dentry); -+void au_dir_ts(struct inode *dir, aufs_bindex_t bsrc); -+int au_test_empty_lower(struct dentry *dentry); -+int au_test_empty(struct dentry *dentry, struct au_nhash *whlist); -+ -+/* vdir.c */ -+unsigned int au_rdhash_est(loff_t sz); -+int au_nhash_alloc(struct au_nhash *nhash, unsigned int num_hash, gfp_t gfp); -+void au_nhash_wh_free(struct au_nhash *whlist); -+int au_nhash_test_longer_wh(struct au_nhash *whlist, aufs_bindex_t btgt, -+ int limit); -+int au_nhash_test_known_wh(struct au_nhash *whlist, char *name, int nlen); -+int au_nhash_append_wh(struct au_nhash *whlist, char *name, int nlen, ino_t ino, -+ unsigned int d_type, aufs_bindex_t bindex, -+ unsigned char shwh); -+void au_vdir_free(struct au_vdir *vdir); -+int au_vdir_init(struct file *file); -+int au_vdir_fill_de(struct file *file, struct dir_context *ctx); -+ -+/* ioctl.c */ -+long aufs_ioctl_dir(struct file *file, unsigned int cmd, unsigned long arg); -+ -+#ifdef CONFIG_AUFS_RDU -+/* rdu.c */ -+long au_rdu_ioctl(struct file *file, unsigned int cmd, unsigned long arg); -+#ifdef CONFIG_COMPAT -+long au_rdu_compat_ioctl(struct file *file, unsigned int cmd, -+ unsigned long arg); -+#endif -+#else -+AuStub(long, au_rdu_ioctl, return -EINVAL, struct file *file, -+ unsigned int cmd, unsigned long arg) -+#ifdef CONFIG_COMPAT -+AuStub(long, au_rdu_compat_ioctl, return -EINVAL, struct file *file, -+ unsigned int cmd, unsigned long arg) -+#endif -+#endif -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_DIR_H__ */ -diff --git a/fs/aufs/dirren.c b/fs/aufs/dirren.c -new file mode 100644 -index 000000000000..56fec6307e6b ---- /dev/null -+++ b/fs/aufs/dirren.c -@@ -0,0 +1,1303 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * special handling in renaming a directoy -+ * in order to support looking-up the before-renamed name on the lower readonly -+ * branches -+ */ -+ -+#include -+#include "aufs.h" -+ -+static void au_dr_hino_del(struct au_dr_br *dr, struct au_dr_hino *ent) -+{ -+ int idx; -+ -+ idx = au_dr_ihash(ent->dr_h_ino); -+ au_hbl_del(&ent->dr_hnode, dr->dr_h_ino + idx); -+} -+ -+static int au_dr_hino_test_empty(struct au_dr_br *dr) -+{ -+ int ret, i; -+ struct hlist_bl_head *hbl; -+ -+ ret = 1; -+ for (i = 0; ret && i < AuDirren_NHASH; i++) { -+ hbl = dr->dr_h_ino + i; -+ hlist_bl_lock(hbl); -+ ret &= hlist_bl_empty(hbl); -+ hlist_bl_unlock(hbl); -+ } -+ -+ return ret; -+} -+ -+static struct au_dr_hino *au_dr_hino_find(struct au_dr_br *dr, ino_t ino) -+{ -+ struct au_dr_hino *found, *ent; -+ struct hlist_bl_head *hbl; -+ struct hlist_bl_node *pos; -+ int idx; -+ -+ found = NULL; -+ idx = au_dr_ihash(ino); -+ hbl = dr->dr_h_ino + idx; -+ hlist_bl_lock(hbl); -+ hlist_bl_for_each_entry(ent, pos, hbl, dr_hnode) -+ if (ent->dr_h_ino == ino) { -+ found = ent; -+ break; -+ } -+ hlist_bl_unlock(hbl); -+ -+ return found; -+} -+ -+int au_dr_hino_test_add(struct au_dr_br *dr, ino_t ino, -+ struct au_dr_hino *add_ent) -+{ -+ int found, idx; -+ struct hlist_bl_head *hbl; -+ struct hlist_bl_node *pos; -+ struct au_dr_hino *ent; -+ -+ found = 0; -+ idx = au_dr_ihash(ino); -+ hbl = dr->dr_h_ino + idx; -+#if 0 -+ { -+ struct hlist_bl_node *tmp; -+ -+ hlist_bl_for_each_entry_safe(ent, pos, tmp, hbl, dr_hnode) -+ AuDbg("hi%llu\n", (unsigned long long)ent->dr_h_ino); -+ } -+#endif -+ hlist_bl_lock(hbl); -+ hlist_bl_for_each_entry(ent, pos, hbl, dr_hnode) -+ if (ent->dr_h_ino == ino) { -+ found = 1; -+ break; -+ } -+ if (!found && add_ent) -+ hlist_bl_add_head(&add_ent->dr_hnode, hbl); -+ hlist_bl_unlock(hbl); -+ -+ if (!found && add_ent) -+ AuDbg("i%llu added\n", (unsigned long long)add_ent->dr_h_ino); -+ -+ return found; -+} -+ -+void au_dr_hino_free(struct au_dr_br *dr) -+{ -+ int i; -+ struct hlist_bl_head *hbl; -+ struct hlist_bl_node *pos, *tmp; -+ struct au_dr_hino *ent; -+ -+ /* SiMustWriteLock(sb); */ -+ -+ for (i = 0; i < AuDirren_NHASH; i++) { -+ hbl = dr->dr_h_ino + i; -+ /* no spinlock since sbinfo must be write-locked */ -+ hlist_bl_for_each_entry_safe(ent, pos, tmp, hbl, dr_hnode) -+ kfree(ent); -+ INIT_HLIST_BL_HEAD(hbl); -+ } -+} -+ -+/* returns the number of inodes or an error */ -+static int au_dr_hino_store(struct super_block *sb, struct au_branch *br, -+ struct file *hinofile) -+{ -+ int err, i; -+ ssize_t ssz; -+ loff_t pos, oldsize; -+ __be64 u64; -+ struct inode *hinoinode; -+ struct hlist_bl_head *hbl; -+ struct hlist_bl_node *n1, *n2; -+ struct au_dr_hino *ent; -+ -+ SiMustWriteLock(sb); -+ AuDebugOn(!au_br_writable(br->br_perm)); -+ -+ hinoinode = file_inode(hinofile); -+ oldsize = i_size_read(hinoinode); -+ -+ err = 0; -+ pos = 0; -+ hbl = br->br_dirren.dr_h_ino; -+ for (i = 0; !err && i < AuDirren_NHASH; i++, hbl++) { -+ /* no bit-lock since sbinfo must be write-locked */ -+ hlist_bl_for_each_entry_safe(ent, n1, n2, hbl, dr_hnode) { -+ AuDbg("hi%llu, %pD2\n", -+ (unsigned long long)ent->dr_h_ino, hinofile); -+ u64 = cpu_to_be64(ent->dr_h_ino); -+ ssz = vfsub_write_k(hinofile, &u64, sizeof(u64), &pos); -+ if (ssz == sizeof(u64)) -+ continue; -+ -+ /* write error */ -+ pr_err("ssz %zd, %pD2\n", ssz, hinofile); -+ err = -ENOSPC; -+ if (ssz < 0) -+ err = ssz; -+ break; -+ } -+ } -+ /* regardless the error */ -+ if (pos < oldsize) { -+ err = vfsub_trunc(&hinofile->f_path, pos, /*attr*/0, hinofile); -+ AuTraceErr(err); -+ } -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+static int au_dr_hino_load(struct au_dr_br *dr, struct file *hinofile) -+{ -+ int err, hidx; -+ ssize_t ssz; -+ size_t sz, n; -+ loff_t pos; -+ uint64_t u64; -+ struct au_dr_hino *ent; -+ struct inode *hinoinode; -+ struct hlist_bl_head *hbl; -+ -+ err = 0; -+ pos = 0; -+ hbl = dr->dr_h_ino; -+ hinoinode = file_inode(hinofile); -+ sz = i_size_read(hinoinode); -+ AuDebugOn(sz % sizeof(u64)); -+ n = sz / sizeof(u64); -+ while (n--) { -+ ssz = vfsub_read_k(hinofile, &u64, sizeof(u64), &pos); -+ if (unlikely(ssz != sizeof(u64))) { -+ pr_err("ssz %zd, %pD2\n", ssz, hinofile); -+ err = -EINVAL; -+ if (ssz < 0) -+ err = ssz; -+ goto out_free; -+ } -+ -+ ent = kmalloc(sizeof(*ent), GFP_NOFS); -+ if (!ent) { -+ err = -ENOMEM; -+ AuTraceErr(err); -+ goto out_free; -+ } -+ ent->dr_h_ino = be64_to_cpu((__force __be64)u64); -+ AuDbg("hi%llu, %pD2\n", -+ (unsigned long long)ent->dr_h_ino, hinofile); -+ hidx = au_dr_ihash(ent->dr_h_ino); -+ au_hbl_add(&ent->dr_hnode, hbl + hidx); -+ } -+ goto out; /* success */ -+ -+out_free: -+ au_dr_hino_free(dr); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* -+ * @bindex/@br is a switch to distinguish whether suspending hnotify or not. -+ * @path is a switch to distinguish load and store. -+ */ -+static int au_dr_hino(struct super_block *sb, aufs_bindex_t bindex, -+ struct au_branch *br, const struct path *path) -+{ -+ int err, flags; -+ unsigned char load, suspend; -+ struct file *hinofile; -+ struct au_hinode *hdir; -+ struct inode *dir, *delegated; -+ struct path hinopath; -+ struct qstr hinoname = QSTR_INIT(AUFS_WH_DR_BRHINO, -+ sizeof(AUFS_WH_DR_BRHINO) - 1); -+ -+ AuDebugOn(bindex < 0 && !br); -+ AuDebugOn(bindex >= 0 && br); -+ -+ err = -EINVAL; -+ suspend = !br; -+ if (suspend) -+ br = au_sbr(sb, bindex); -+ load = !!path; -+ if (!load) { -+ path = &br->br_path; -+ AuDebugOn(!au_br_writable(br->br_perm)); -+ if (unlikely(!au_br_writable(br->br_perm))) -+ goto out; -+ } -+ -+ hdir = NULL; -+ if (suspend) { -+ dir = d_inode(sb->s_root); -+ hdir = au_hinode(au_ii(dir), bindex); -+ dir = hdir->hi_inode; -+ au_hn_inode_lock_nested(hdir, AuLsc_I_CHILD); -+ } else { -+ dir = d_inode(path->dentry); -+ inode_lock_nested(dir, AuLsc_I_CHILD); -+ } -+ hinopath.dentry = vfsub_lkup_one(&hinoname, path->dentry); -+ err = PTR_ERR(hinopath.dentry); -+ if (IS_ERR(hinopath.dentry)) -+ goto out_unlock; -+ -+ err = 0; -+ flags = O_RDONLY; -+ if (load) { -+ if (d_is_negative(hinopath.dentry)) -+ goto out_dput; /* success */ -+ } else { -+ if (au_dr_hino_test_empty(&br->br_dirren)) { -+ if (d_is_positive(hinopath.dentry)) { -+ delegated = NULL; -+ err = vfsub_unlink(dir, &hinopath, &delegated, -+ /*force*/0); -+ AuTraceErr(err); -+ if (unlikely(err)) -+ pr_err("ignored err %d, %pd2\n", -+ err, hinopath.dentry); -+ if (unlikely(err == -EWOULDBLOCK)) -+ iput(delegated); -+ err = 0; -+ } -+ goto out_dput; -+ } else if (!d_is_positive(hinopath.dentry)) { -+ err = vfsub_create(dir, &hinopath, 0600, -+ /*want_excl*/false); -+ AuTraceErr(err); -+ if (unlikely(err)) -+ goto out_dput; -+ } -+ flags = O_WRONLY; -+ } -+ hinopath.mnt = path->mnt; -+ hinofile = vfsub_dentry_open(&hinopath, flags); -+ if (suspend) -+ au_hn_inode_unlock(hdir); -+ else -+ inode_unlock(dir); -+ dput(hinopath.dentry); -+ AuTraceErrPtr(hinofile); -+ if (IS_ERR(hinofile)) { -+ err = PTR_ERR(hinofile); -+ goto out; -+ } -+ -+ if (load) -+ err = au_dr_hino_load(&br->br_dirren, hinofile); -+ else -+ err = au_dr_hino_store(sb, br, hinofile); -+ fput(hinofile); -+ goto out; -+ -+out_dput: -+ dput(hinopath.dentry); -+out_unlock: -+ if (suspend) -+ au_hn_inode_unlock(hdir); -+ else -+ inode_unlock(dir); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_dr_brid_init(struct au_dr_brid *brid, const struct path *path) -+{ -+ int err; -+ struct kstatfs kstfs; -+ dev_t dev; -+ struct dentry *dentry; -+ struct super_block *sb; -+ -+ err = vfs_statfs((void *)path, &kstfs); -+ AuTraceErr(err); -+ if (unlikely(err)) -+ goto out; -+ -+ /* todo: support for UUID */ -+ -+ if (kstfs.f_fsid.val[0] || kstfs.f_fsid.val[1]) { -+ brid->type = AuBrid_FSID; -+ brid->fsid = kstfs.f_fsid; -+ } else { -+ dentry = path->dentry; -+ sb = dentry->d_sb; -+ dev = sb->s_dev; -+ if (dev) { -+ brid->type = AuBrid_DEV; -+ brid->dev = dev; -+ } -+ } -+ -+out: -+ return err; -+} -+ -+int au_dr_br_init(struct super_block *sb, struct au_branch *br, -+ const struct path *path) -+{ -+ int err, i; -+ struct au_dr_br *dr; -+ struct hlist_bl_head *hbl; -+ -+ dr = &br->br_dirren; -+ hbl = dr->dr_h_ino; -+ for (i = 0; i < AuDirren_NHASH; i++, hbl++) -+ INIT_HLIST_BL_HEAD(hbl); -+ -+ err = au_dr_brid_init(&dr->dr_brid, path); -+ if (unlikely(err)) -+ goto out; -+ -+ if (au_opt_test(au_mntflags(sb), DIRREN)) -+ err = au_dr_hino(sb, /*bindex*/-1, br, path); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+int au_dr_br_fin(struct super_block *sb, struct au_branch *br) -+{ -+ int err; -+ -+ err = 0; -+ if (au_br_writable(br->br_perm)) -+ err = au_dr_hino(sb, /*bindex*/-1, br, /*path*/NULL); -+ if (!err) -+ au_dr_hino_free(&br->br_dirren); -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_brid_str(struct au_dr_brid *brid, struct inode *h_inode, -+ char *buf, size_t sz) -+{ -+ int err; -+ unsigned int major, minor; -+ char *p; -+ -+ p = buf; -+ err = snprintf(p, sz, "%d_", brid->type); -+ AuDebugOn(err > sz); -+ p += err; -+ sz -= err; -+ switch (brid->type) { -+ case AuBrid_Unset: -+ return -EINVAL; -+ case AuBrid_UUID: -+ err = snprintf(p, sz, "%pU", brid->uuid.b); -+ break; -+ case AuBrid_FSID: -+ err = snprintf(p, sz, "%08x-%08x", -+ brid->fsid.val[0], brid->fsid.val[1]); -+ break; -+ case AuBrid_DEV: -+ major = MAJOR(brid->dev); -+ minor = MINOR(brid->dev); -+ if (major <= 0xff && minor <= 0xff) -+ err = snprintf(p, sz, "%02x%02x", major, minor); -+ else -+ err = snprintf(p, sz, "%03x:%05x", major, minor); -+ break; -+ } -+ AuDebugOn(err > sz); -+ p += err; -+ sz -= err; -+ err = snprintf(p, sz, "_%llu", (unsigned long long)h_inode->i_ino); -+ AuDebugOn(err > sz); -+ p += err; -+ sz -= err; -+ -+ return p - buf; -+} -+ -+static int au_drinfo_name(struct au_branch *br, char *name, int len) -+{ -+ int rlen; -+ struct dentry *br_dentry; -+ struct inode *br_inode; -+ -+ br_dentry = au_br_dentry(br); -+ br_inode = d_inode(br_dentry); -+ rlen = au_brid_str(&br->br_dirren.dr_brid, br_inode, name, len); -+ AuDebugOn(rlen >= AUFS_DIRREN_ENV_VAL_SZ); -+ AuDebugOn(rlen > len); -+ -+ return rlen; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * from the given @h_dentry, construct drinfo at @*fdata. -+ * when the size of @*fdata is not enough, reallocate and return new @fdata and -+ * @allocated. -+ */ -+static int au_drinfo_construct(struct au_drinfo_fdata **fdata, -+ struct dentry *h_dentry, -+ unsigned char *allocated) -+{ -+ int err, v; -+ struct au_drinfo_fdata *f, *p; -+ struct au_drinfo *drinfo; -+ struct inode *h_inode; -+ struct qstr *qname; -+ -+ err = 0; -+ f = *fdata; -+ h_inode = d_inode(h_dentry); -+ qname = &h_dentry->d_name; -+ drinfo = &f->drinfo; -+ drinfo->ino = (__force uint64_t)cpu_to_be64(h_inode->i_ino); -+ drinfo->oldnamelen = qname->len; -+ if (*allocated < sizeof(*f) + qname->len) { -+ v = roundup_pow_of_two(*allocated + qname->len); -+ p = au_krealloc(f, v, GFP_NOFS, /*may_shrink*/0); -+ if (unlikely(!p)) { -+ err = -ENOMEM; -+ AuTraceErr(err); -+ goto out; -+ } -+ f = p; -+ *fdata = f; -+ *allocated = v; -+ drinfo = &f->drinfo; -+ } -+ memcpy(drinfo->oldname, qname->name, qname->len); -+ AuDbg("i%llu, %.*s\n", -+ be64_to_cpu((__force __be64)drinfo->ino), drinfo->oldnamelen, -+ drinfo->oldname); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* callers have to free the return value */ -+static struct au_drinfo *au_drinfo_read_k(struct file *file, ino_t h_ino) -+{ -+ struct au_drinfo *ret, *drinfo; -+ struct au_drinfo_fdata fdata; -+ int len; -+ loff_t pos; -+ ssize_t ssz; -+ -+ ret = ERR_PTR(-EIO); -+ pos = 0; -+ ssz = vfsub_read_k(file, &fdata, sizeof(fdata), &pos); -+ if (unlikely(ssz != sizeof(fdata))) { -+ AuIOErr("ssz %zd, %u, %pD2\n", -+ ssz, (unsigned int)sizeof(fdata), file); -+ goto out; -+ } -+ -+ fdata.magic = ntohl((__force __be32)fdata.magic); -+ switch (fdata.magic) { -+ case AUFS_DRINFO_MAGIC_V1: -+ break; -+ default: -+ AuIOErr("magic-num 0x%x, 0x%x, %pD2\n", -+ fdata.magic, AUFS_DRINFO_MAGIC_V1, file); -+ goto out; -+ } -+ -+ drinfo = &fdata.drinfo; -+ len = drinfo->oldnamelen; -+ if (!len) { -+ AuIOErr("broken drinfo %pD2\n", file); -+ goto out; -+ } -+ -+ ret = NULL; -+ drinfo->ino = be64_to_cpu((__force __be64)drinfo->ino); -+ if (unlikely(h_ino && drinfo->ino != h_ino)) { -+ AuDbg("ignored i%llu, i%llu, %pD2\n", -+ (unsigned long long)drinfo->ino, -+ (unsigned long long)h_ino, file); -+ goto out; /* success */ -+ } -+ -+ ret = kmalloc(sizeof(*ret) + len, GFP_NOFS); -+ if (unlikely(!ret)) { -+ ret = ERR_PTR(-ENOMEM); -+ AuTraceErrPtr(ret); -+ goto out; -+ } -+ -+ *ret = *drinfo; -+ ssz = vfsub_read_k(file, (void *)ret->oldname, len, &pos); -+ if (unlikely(ssz != len)) { -+ kfree(ret); -+ ret = ERR_PTR(-EIO); -+ AuIOErr("ssz %zd, %u, %pD2\n", ssz, len, file); -+ goto out; -+ } -+ -+ AuDbg("oldname %.*s\n", ret->oldnamelen, ret->oldname); -+ -+out: -+ return ret; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* in order to be revertible */ -+struct au_drinfo_rev_elm { -+ int created; -+ struct dentry *info_dentry; -+ struct au_drinfo *info_last; -+}; -+ -+struct au_drinfo_rev { -+ unsigned char already; -+ aufs_bindex_t nelm; -+ struct au_drinfo_rev_elm elm[0]; -+}; -+ -+/* todo: isn't it too large? */ -+struct au_drinfo_store { -+ struct path h_ppath; -+ struct dentry *h_dentry; -+ struct au_drinfo_fdata *fdata; -+ char *infoname; /* inside of whname, just after PFX */ -+ char whname[sizeof(AUFS_WH_DR_INFO_PFX) + AUFS_DIRREN_ENV_VAL_SZ]; -+ aufs_bindex_t btgt, btail; -+ unsigned char no_sio, -+ allocated, /* current size of *fdata */ -+ infonamelen, /* room size for p */ -+ whnamelen, /* length of the genarated name */ -+ renameback; /* renamed back */ -+}; -+ -+/* on rename(2) error, the caller should revert it using @elm */ -+static int au_drinfo_do_store(struct au_drinfo_store *w, -+ struct au_drinfo_rev_elm *elm) -+{ -+ int err, len; -+ ssize_t ssz; -+ loff_t pos; -+ struct path infopath = { -+ .mnt = w->h_ppath.mnt -+ }; -+ struct inode *h_dir, *h_inode, *delegated; -+ struct file *infofile; -+ struct qstr *qname; -+ -+ AuDebugOn(elm -+ && memcmp(elm, page_address(ZERO_PAGE(0)), sizeof(*elm))); -+ -+ infopath.dentry = vfsub_lookup_one_len(w->whname, w->h_ppath.dentry, -+ w->whnamelen); -+ AuTraceErrPtr(infopath.dentry); -+ if (IS_ERR(infopath.dentry)) { -+ err = PTR_ERR(infopath.dentry); -+ goto out; -+ } -+ -+ err = 0; -+ h_dir = d_inode(w->h_ppath.dentry); -+ if (elm && d_is_negative(infopath.dentry)) { -+ err = vfsub_create(h_dir, &infopath, 0600, /*want_excl*/true); -+ AuTraceErr(err); -+ if (unlikely(err)) -+ goto out_dput; -+ elm->created = 1; -+ elm->info_dentry = dget(infopath.dentry); -+ } -+ -+ infofile = vfsub_dentry_open(&infopath, O_RDWR); -+ AuTraceErrPtr(infofile); -+ if (IS_ERR(infofile)) { -+ err = PTR_ERR(infofile); -+ goto out_dput; -+ } -+ -+ h_inode = d_inode(infopath.dentry); -+ if (elm && i_size_read(h_inode)) { -+ h_inode = d_inode(w->h_dentry); -+ elm->info_last = au_drinfo_read_k(infofile, h_inode->i_ino); -+ AuTraceErrPtr(elm->info_last); -+ if (IS_ERR(elm->info_last)) { -+ err = PTR_ERR(elm->info_last); -+ elm->info_last = NULL; -+ AuDebugOn(elm->info_dentry); -+ goto out_fput; -+ } -+ } -+ -+ if (elm && w->renameback) { -+ delegated = NULL; -+ err = vfsub_unlink(h_dir, &infopath, &delegated, /*force*/0); -+ AuTraceErr(err); -+ if (unlikely(err == -EWOULDBLOCK)) -+ iput(delegated); -+ goto out_fput; -+ } -+ -+ pos = 0; -+ qname = &w->h_dentry->d_name; -+ len = sizeof(*w->fdata) + qname->len; -+ if (!elm) -+ len = sizeof(*w->fdata) + w->fdata->drinfo.oldnamelen; -+ ssz = vfsub_write_k(infofile, w->fdata, len, &pos); -+ if (ssz == len) { -+ AuDbg("hi%llu, %.*s\n", w->fdata->drinfo.ino, -+ w->fdata->drinfo.oldnamelen, w->fdata->drinfo.oldname); -+ goto out_fput; /* success */ -+ } else { -+ err = -EIO; -+ if (ssz < 0) -+ err = ssz; -+ /* the caller should revert it using @elm */ -+ } -+ -+out_fput: -+ fput(infofile); -+out_dput: -+ dput(infopath.dentry); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+struct au_call_drinfo_do_store_args { -+ int *errp; -+ struct au_drinfo_store *w; -+ struct au_drinfo_rev_elm *elm; -+}; -+ -+static void au_call_drinfo_do_store(void *args) -+{ -+ struct au_call_drinfo_do_store_args *a = args; -+ -+ *a->errp = au_drinfo_do_store(a->w, a->elm); -+} -+ -+static int au_drinfo_store_sio(struct au_drinfo_store *w, -+ struct au_drinfo_rev_elm *elm) -+{ -+ int err, wkq_err; -+ -+ if (w->no_sio) -+ err = au_drinfo_do_store(w, elm); -+ else { -+ struct au_call_drinfo_do_store_args a = { -+ .errp = &err, -+ .w = w, -+ .elm = elm -+ }; -+ wkq_err = au_wkq_wait(au_call_drinfo_do_store, &a); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ } -+ AuTraceErr(err); -+ -+ return err; -+} -+ -+static int au_drinfo_store_work_init(struct au_drinfo_store *w, -+ aufs_bindex_t btgt) -+{ -+ int err; -+ -+ memset(w, 0, sizeof(*w)); -+ w->allocated = roundup_pow_of_two(sizeof(*w->fdata) + 40); -+ strcpy(w->whname, AUFS_WH_DR_INFO_PFX); -+ w->infoname = w->whname + sizeof(AUFS_WH_DR_INFO_PFX) - 1; -+ w->infonamelen = sizeof(w->whname) - sizeof(AUFS_WH_DR_INFO_PFX); -+ w->btgt = btgt; -+ w->no_sio = !!uid_eq(current_fsuid(), GLOBAL_ROOT_UID); -+ -+ err = -ENOMEM; -+ w->fdata = kcalloc(1, w->allocated, GFP_NOFS); -+ if (unlikely(!w->fdata)) { -+ AuTraceErr(err); -+ goto out; -+ } -+ w->fdata->magic = (__force uint32_t)htonl(AUFS_DRINFO_MAGIC_V1); -+ err = 0; -+ -+out: -+ return err; -+} -+ -+static void au_drinfo_store_work_fin(struct au_drinfo_store *w) -+{ -+ kfree(w->fdata); -+} -+ -+static void au_drinfo_store_rev(struct au_drinfo_rev *rev, -+ struct au_drinfo_store *w) -+{ -+ struct au_drinfo_rev_elm *elm; -+ struct inode *h_dir, *delegated; -+ int err, nelm; -+ struct path infopath = { -+ .mnt = w->h_ppath.mnt -+ }; -+ -+ h_dir = d_inode(w->h_ppath.dentry); -+ IMustLock(h_dir); -+ -+ err = 0; -+ elm = rev->elm; -+ for (nelm = rev->nelm; nelm > 0; nelm--, elm++) { -+ AuDebugOn(elm->created && elm->info_last); -+ if (elm->created) { -+ AuDbg("here\n"); -+ delegated = NULL; -+ infopath.dentry = elm->info_dentry; -+ err = vfsub_unlink(h_dir, &infopath, &delegated, -+ !w->no_sio); -+ AuTraceErr(err); -+ if (unlikely(err == -EWOULDBLOCK)) -+ iput(delegated); -+ dput(elm->info_dentry); -+ } else if (elm->info_last) { -+ AuDbg("here\n"); -+ w->fdata->drinfo = *elm->info_last; -+ memcpy(w->fdata->drinfo.oldname, -+ elm->info_last->oldname, -+ elm->info_last->oldnamelen); -+ err = au_drinfo_store_sio(w, /*elm*/NULL); -+ kfree(elm->info_last); -+ } -+ if (unlikely(err)) -+ AuIOErr("%d, %s\n", err, w->whname); -+ /* go on even if err */ -+ } -+} -+ -+/* caller has to call au_dr_rename_fin() later */ -+static int au_drinfo_store(struct dentry *dentry, aufs_bindex_t btgt, -+ struct qstr *dst_name, void *_rev) -+{ -+ int err, sz, nelm; -+ aufs_bindex_t bindex, btail; -+ struct au_drinfo_store work; -+ struct au_drinfo_rev *rev, **p; -+ struct au_drinfo_rev_elm *elm; -+ struct super_block *sb; -+ struct au_branch *br; -+ struct au_hinode *hdir; -+ -+ err = au_drinfo_store_work_init(&work, btgt); -+ AuTraceErr(err); -+ if (unlikely(err)) -+ goto out; -+ -+ err = -ENOMEM; -+ btail = au_dbtaildir(dentry); -+ nelm = btail - btgt; -+ sz = sizeof(*rev) + sizeof(*elm) * nelm; -+ rev = kcalloc(1, sz, GFP_NOFS); -+ if (unlikely(!rev)) { -+ AuTraceErr(err); -+ goto out_args; -+ } -+ rev->nelm = nelm; -+ elm = rev->elm; -+ p = _rev; -+ *p = rev; -+ -+ err = 0; -+ sb = dentry->d_sb; -+ work.h_ppath.dentry = au_h_dptr(dentry, btgt); -+ work.h_ppath.mnt = au_sbr_mnt(sb, btgt); -+ hdir = au_hi(d_inode(dentry), btgt); -+ au_hn_inode_lock_nested(hdir, AuLsc_I_CHILD); -+ for (bindex = btgt + 1; bindex <= btail; bindex++, elm++) { -+ work.h_dentry = au_h_dptr(dentry, bindex); -+ if (!work.h_dentry) -+ continue; -+ -+ err = au_drinfo_construct(&work.fdata, work.h_dentry, -+ &work.allocated); -+ AuTraceErr(err); -+ if (unlikely(err)) -+ break; -+ -+ work.renameback = au_qstreq(&work.h_dentry->d_name, dst_name); -+ br = au_sbr(sb, bindex); -+ work.whnamelen = sizeof(AUFS_WH_DR_INFO_PFX) - 1; -+ work.whnamelen += au_drinfo_name(br, work.infoname, -+ work.infonamelen); -+ AuDbg("whname %.*s, i%llu, %.*s\n", -+ work.whnamelen, work.whname, -+ be64_to_cpu((__force __be64)work.fdata->drinfo.ino), -+ work.fdata->drinfo.oldnamelen, -+ work.fdata->drinfo.oldname); -+ -+ err = au_drinfo_store_sio(&work, elm); -+ AuTraceErr(err); -+ if (unlikely(err)) -+ break; -+ } -+ if (unlikely(err)) { -+ /* revert all drinfo */ -+ au_drinfo_store_rev(rev, &work); -+ kfree(rev); -+ *p = NULL; -+ } -+ au_hn_inode_unlock(hdir); -+ -+out_args: -+ au_drinfo_store_work_fin(&work); -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int au_dr_rename(struct dentry *src, aufs_bindex_t bindex, -+ struct qstr *dst_name, void *_rev) -+{ -+ int err, already; -+ ino_t ino; -+ struct super_block *sb; -+ struct au_branch *br; -+ struct au_dr_br *dr; -+ struct dentry *h_dentry; -+ struct inode *h_inode; -+ struct au_dr_hino *ent; -+ struct au_drinfo_rev *rev, **p; -+ -+ AuDbg("bindex %d\n", bindex); -+ -+ err = -ENOMEM; -+ ent = kmalloc(sizeof(*ent), GFP_NOFS); -+ if (unlikely(!ent)) -+ goto out; -+ -+ sb = src->d_sb; -+ br = au_sbr(sb, bindex); -+ dr = &br->br_dirren; -+ h_dentry = au_h_dptr(src, bindex); -+ h_inode = d_inode(h_dentry); -+ ino = h_inode->i_ino; -+ ent->dr_h_ino = ino; -+ already = au_dr_hino_test_add(dr, ino, ent); -+ AuDbg("b%d, hi%llu, already %d\n", -+ bindex, (unsigned long long)ino, already); -+ -+ err = au_drinfo_store(src, bindex, dst_name, _rev); -+ AuTraceErr(err); -+ if (!err) { -+ p = _rev; -+ rev = *p; -+ rev->already = already; -+ goto out; /* success */ -+ } -+ -+ /* revert */ -+ if (!already) -+ au_dr_hino_del(dr, ent); -+ kfree(ent); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+void au_dr_rename_fin(struct dentry *src, aufs_bindex_t btgt, void *_rev) -+{ -+ struct au_drinfo_rev *rev; -+ struct au_drinfo_rev_elm *elm; -+ int nelm; -+ -+ rev = _rev; -+ elm = rev->elm; -+ for (nelm = rev->nelm; nelm > 0; nelm--, elm++) { -+ dput(elm->info_dentry); -+ kfree(elm->info_last); -+ } -+ kfree(rev); -+} -+ -+void au_dr_rename_rev(struct dentry *src, aufs_bindex_t btgt, void *_rev) -+{ -+ int err; -+ struct au_drinfo_store work; -+ struct au_drinfo_rev *rev = _rev; -+ struct super_block *sb; -+ struct au_branch *br; -+ struct inode *h_inode; -+ struct au_dr_br *dr; -+ struct au_dr_hino *ent; -+ -+ err = au_drinfo_store_work_init(&work, btgt); -+ if (unlikely(err)) -+ goto out; -+ -+ sb = src->d_sb; -+ br = au_sbr(sb, btgt); -+ work.h_ppath.dentry = au_h_dptr(src, btgt); -+ work.h_ppath.mnt = au_br_mnt(br); -+ au_drinfo_store_rev(rev, &work); -+ au_drinfo_store_work_fin(&work); -+ if (rev->already) -+ goto out; -+ -+ dr = &br->br_dirren; -+ h_inode = d_inode(work.h_ppath.dentry); -+ ent = au_dr_hino_find(dr, h_inode->i_ino); -+ BUG_ON(!ent); -+ au_dr_hino_del(dr, ent); -+ kfree(ent); -+ -+out: -+ kfree(rev); -+ if (unlikely(err)) -+ pr_err("failed to remove dirren info\n"); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static struct au_drinfo *au_drinfo_do_load(struct path *h_ppath, -+ char *whname, int whnamelen, -+ struct dentry **info_dentry) -+{ -+ struct au_drinfo *drinfo; -+ struct file *f; -+ struct inode *h_dir; -+ struct path infopath; -+ int unlocked; -+ -+ AuDbg("%pd/%.*s\n", h_ppath->dentry, whnamelen, whname); -+ -+ *info_dentry = NULL; -+ drinfo = NULL; -+ unlocked = 0; -+ h_dir = d_inode(h_ppath->dentry); -+ vfsub_inode_lock_shared_nested(h_dir, AuLsc_I_PARENT); -+ infopath.dentry = vfsub_lookup_one_len(whname, h_ppath->dentry, -+ whnamelen); -+ if (IS_ERR(infopath.dentry)) { -+ drinfo = (void *)infopath.dentry; -+ goto out; -+ } -+ -+ if (d_is_negative(infopath.dentry)) -+ goto out_dput; /* success */ -+ -+ infopath.mnt = h_ppath->mnt; -+ f = vfsub_dentry_open(&infopath, O_RDONLY); -+ inode_unlock_shared(h_dir); -+ unlocked = 1; -+ if (IS_ERR(f)) { -+ drinfo = (void *)f; -+ goto out_dput; -+ } -+ -+ drinfo = au_drinfo_read_k(f, /*h_ino*/0); -+ if (IS_ERR_OR_NULL(drinfo)) -+ goto out_fput; -+ -+ AuDbg("oldname %.*s\n", drinfo->oldnamelen, drinfo->oldname); -+ *info_dentry = dget(infopath.dentry); /* keep it alive */ -+ -+out_fput: -+ fput(f); -+out_dput: -+ dput(infopath.dentry); -+out: -+ if (!unlocked) -+ inode_unlock_shared(h_dir); -+ AuTraceErrPtr(drinfo); -+ return drinfo; -+} -+ -+struct au_drinfo_do_load_args { -+ struct au_drinfo **drinfop; -+ struct path *h_ppath; -+ char *whname; -+ int whnamelen; -+ struct dentry **info_dentry; -+}; -+ -+static void au_call_drinfo_do_load(void *args) -+{ -+ struct au_drinfo_do_load_args *a = args; -+ -+ *a->drinfop = au_drinfo_do_load(a->h_ppath, a->whname, a->whnamelen, -+ a->info_dentry); -+} -+ -+struct au_drinfo_load { -+ struct path h_ppath; -+ struct qstr *qname; -+ unsigned char no_sio; -+ -+ aufs_bindex_t ninfo; -+ struct au_drinfo **drinfo; -+}; -+ -+static int au_drinfo_load(struct au_drinfo_load *w, aufs_bindex_t bindex, -+ struct au_branch *br) -+{ -+ int err, wkq_err, whnamelen, e; -+ char whname[sizeof(AUFS_WH_DR_INFO_PFX) + AUFS_DIRREN_ENV_VAL_SZ] -+ = AUFS_WH_DR_INFO_PFX; -+ struct au_drinfo *drinfo; -+ struct qstr oldname; -+ struct inode *h_dir, *delegated; -+ struct dentry *info_dentry; -+ struct path infopath; -+ -+ whnamelen = sizeof(AUFS_WH_DR_INFO_PFX) - 1; -+ whnamelen += au_drinfo_name(br, whname + whnamelen, -+ sizeof(whname) - whnamelen); -+ if (w->no_sio) -+ drinfo = au_drinfo_do_load(&w->h_ppath, whname, whnamelen, -+ &info_dentry); -+ else { -+ struct au_drinfo_do_load_args args = { -+ .drinfop = &drinfo, -+ .h_ppath = &w->h_ppath, -+ .whname = whname, -+ .whnamelen = whnamelen, -+ .info_dentry = &info_dentry -+ }; -+ wkq_err = au_wkq_wait(au_call_drinfo_do_load, &args); -+ if (unlikely(wkq_err)) -+ drinfo = ERR_PTR(wkq_err); -+ } -+ err = PTR_ERR(drinfo); -+ if (IS_ERR_OR_NULL(drinfo)) -+ goto out; -+ -+ err = 0; -+ oldname.len = drinfo->oldnamelen; -+ oldname.name = drinfo->oldname; -+ if (au_qstreq(w->qname, &oldname)) { -+ /* the name is renamed back */ -+ kfree(drinfo); -+ drinfo = NULL; -+ -+ infopath.dentry = info_dentry; -+ infopath.mnt = w->h_ppath.mnt; -+ h_dir = d_inode(w->h_ppath.dentry); -+ delegated = NULL; -+ inode_lock_nested(h_dir, AuLsc_I_PARENT); -+ e = vfsub_unlink(h_dir, &infopath, &delegated, !w->no_sio); -+ inode_unlock(h_dir); -+ if (unlikely(e)) -+ AuIOErr("ignored %d, %pd2\n", e, &infopath.dentry); -+ if (unlikely(e == -EWOULDBLOCK)) -+ iput(delegated); -+ } -+ kfree(w->drinfo[bindex]); -+ w->drinfo[bindex] = drinfo; -+ dput(info_dentry); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static void au_dr_lkup_free(struct au_drinfo **drinfo, int n) -+{ -+ struct au_drinfo **p = drinfo; -+ -+ while (n-- > 0) -+ kfree(*drinfo++); -+ kfree(p); -+} -+ -+int au_dr_lkup(struct au_do_lookup_args *lkup, struct dentry *dentry, -+ aufs_bindex_t btgt) -+{ -+ int err, ninfo; -+ struct au_drinfo_load w; -+ aufs_bindex_t bindex, bbot; -+ struct au_branch *br; -+ struct inode *h_dir; -+ struct au_dr_hino *ent; -+ struct super_block *sb; -+ -+ AuDbg("%.*s, name %.*s, whname %.*s, b%d\n", -+ AuLNPair(&dentry->d_name), AuLNPair(&lkup->dirren.dr_name), -+ AuLNPair(&lkup->whname), btgt); -+ -+ sb = dentry->d_sb; -+ bbot = au_sbbot(sb); -+ w.ninfo = bbot + 1; -+ if (!lkup->dirren.drinfo) { -+ lkup->dirren.drinfo = kcalloc(w.ninfo, -+ sizeof(*lkup->dirren.drinfo), -+ GFP_NOFS); -+ if (unlikely(!lkup->dirren.drinfo)) { -+ err = -ENOMEM; -+ goto out; -+ } -+ lkup->dirren.ninfo = w.ninfo; -+ } -+ w.drinfo = lkup->dirren.drinfo; -+ w.no_sio = !!uid_eq(current_fsuid(), GLOBAL_ROOT_UID); -+ w.h_ppath.dentry = au_h_dptr(dentry, btgt); -+ AuDebugOn(!w.h_ppath.dentry); -+ w.h_ppath.mnt = au_sbr_mnt(sb, btgt); -+ w.qname = &dentry->d_name; -+ -+ ninfo = 0; -+ for (bindex = btgt + 1; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ err = au_drinfo_load(&w, bindex, br); -+ if (unlikely(err)) -+ goto out_free; -+ if (w.drinfo[bindex]) -+ ninfo++; -+ } -+ if (!ninfo) { -+ br = au_sbr(sb, btgt); -+ h_dir = d_inode(w.h_ppath.dentry); -+ ent = au_dr_hino_find(&br->br_dirren, h_dir->i_ino); -+ AuDebugOn(!ent); -+ au_dr_hino_del(&br->br_dirren, ent); -+ kfree(ent); -+ } -+ goto out; /* success */ -+ -+out_free: -+ au_dr_lkup_free(lkup->dirren.drinfo, lkup->dirren.ninfo); -+ lkup->dirren.ninfo = 0; -+ lkup->dirren.drinfo = NULL; -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+void au_dr_lkup_fin(struct au_do_lookup_args *lkup) -+{ -+ au_dr_lkup_free(lkup->dirren.drinfo, lkup->dirren.ninfo); -+} -+ -+int au_dr_lkup_name(struct au_do_lookup_args *lkup, aufs_bindex_t btgt) -+{ -+ int err; -+ struct au_drinfo *drinfo; -+ -+ err = 0; -+ if (!lkup->dirren.drinfo) -+ goto out; -+ AuDebugOn(lkup->dirren.ninfo < btgt + 1); -+ drinfo = lkup->dirren.drinfo[btgt + 1]; -+ if (!drinfo) -+ goto out; -+ -+ kfree(lkup->whname.name); -+ lkup->whname.name = NULL; -+ lkup->dirren.dr_name.len = drinfo->oldnamelen; -+ lkup->dirren.dr_name.name = drinfo->oldname; -+ lkup->name = &lkup->dirren.dr_name; -+ err = au_wh_name_alloc(&lkup->whname, lkup->name); -+ if (!err) -+ AuDbg("name %.*s, whname %.*s, b%d\n", -+ AuLNPair(lkup->name), AuLNPair(&lkup->whname), -+ btgt); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+int au_dr_lkup_h_ino(struct au_do_lookup_args *lkup, aufs_bindex_t bindex, -+ ino_t h_ino) -+{ -+ int match; -+ struct au_drinfo *drinfo; -+ -+ match = 1; -+ if (!lkup->dirren.drinfo) -+ goto out; -+ AuDebugOn(lkup->dirren.ninfo < bindex + 1); -+ drinfo = lkup->dirren.drinfo[bindex + 1]; -+ if (!drinfo) -+ goto out; -+ -+ match = (drinfo->ino == h_ino); -+ AuDbg("match %d\n", match); -+ -+out: -+ return match; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int au_dr_opt_set(struct super_block *sb) -+{ -+ int err; -+ aufs_bindex_t bindex, bbot; -+ struct au_branch *br; -+ -+ err = 0; -+ bbot = au_sbbot(sb); -+ for (bindex = 0; !err && bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ err = au_dr_hino(sb, bindex, /*br*/NULL, &br->br_path); -+ } -+ -+ return err; -+} -+ -+int au_dr_opt_flush(struct super_block *sb) -+{ -+ int err; -+ aufs_bindex_t bindex, bbot; -+ struct au_branch *br; -+ -+ err = 0; -+ bbot = au_sbbot(sb); -+ for (bindex = 0; !err && bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ if (au_br_writable(br->br_perm)) -+ err = au_dr_hino(sb, bindex, /*br*/NULL, /*path*/NULL); -+ } -+ -+ return err; -+} -+ -+int au_dr_opt_clr(struct super_block *sb, int no_flush) -+{ -+ int err; -+ aufs_bindex_t bindex, bbot; -+ struct au_branch *br; -+ -+ err = 0; -+ if (!no_flush) { -+ err = au_dr_opt_flush(sb); -+ if (unlikely(err)) -+ goto out; -+ } -+ -+ bbot = au_sbbot(sb); -+ for (bindex = 0; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ au_dr_hino_free(&br->br_dirren); -+ } -+ -+out: -+ return err; -+} -diff --git a/fs/aufs/dirren.h b/fs/aufs/dirren.h -new file mode 100644 -index 000000000000..4b672fb11f02 ---- /dev/null -+++ b/fs/aufs/dirren.h -@@ -0,0 +1,127 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * renamed dir info -+ */ -+ -+#ifndef __AUFS_DIRREN_H__ -+#define __AUFS_DIRREN_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+#include -+#include -+#include "hbl.h" -+ -+#define AuDirren_NHASH 100 -+ -+#ifdef CONFIG_AUFS_DIRREN -+enum au_brid_type { -+ AuBrid_Unset, -+ AuBrid_UUID, -+ AuBrid_FSID, -+ AuBrid_DEV -+}; -+ -+struct au_dr_brid { -+ enum au_brid_type type; -+ union { -+ uuid_t uuid; /* unimplemented yet */ -+ fsid_t fsid; -+ dev_t dev; -+ }; -+}; -+ -+/* 20 is the max digits length of ulong 64 */ -+/* brid-type "_" uuid "_" inum */ -+#define AUFS_DIRREN_FNAME_SZ (1 + 1 + UUID_STRING_LEN + 20) -+#define AUFS_DIRREN_ENV_VAL_SZ (AUFS_DIRREN_FNAME_SZ + 1 + 20) -+ -+struct au_dr_hino { -+ struct hlist_bl_node dr_hnode; -+ ino_t dr_h_ino; -+}; -+ -+struct au_dr_br { -+ struct hlist_bl_head dr_h_ino[AuDirren_NHASH]; -+ struct au_dr_brid dr_brid; -+}; -+ -+struct au_dr_lookup { -+ /* dr_name is pointed by struct au_do_lookup_args.name */ -+ struct qstr dr_name; /* subset of dr_info */ -+ aufs_bindex_t ninfo; -+ struct au_drinfo **drinfo; -+}; -+#else -+struct au_dr_hino; -+/* empty */ -+struct au_dr_br { }; -+struct au_dr_lookup { }; -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct au_branch; -+struct au_do_lookup_args; -+struct au_hinode; -+#ifdef CONFIG_AUFS_DIRREN -+int au_dr_hino_test_add(struct au_dr_br *dr, ino_t h_ino, -+ struct au_dr_hino *add_ent); -+void au_dr_hino_free(struct au_dr_br *dr); -+int au_dr_br_init(struct super_block *sb, struct au_branch *br, -+ const struct path *path); -+int au_dr_br_fin(struct super_block *sb, struct au_branch *br); -+int au_dr_rename(struct dentry *src, aufs_bindex_t bindex, -+ struct qstr *dst_name, void *_rev); -+void au_dr_rename_fin(struct dentry *src, aufs_bindex_t btgt, void *rev); -+void au_dr_rename_rev(struct dentry *src, aufs_bindex_t bindex, void *rev); -+int au_dr_lkup(struct au_do_lookup_args *lkup, struct dentry *dentry, -+ aufs_bindex_t bindex); -+int au_dr_lkup_name(struct au_do_lookup_args *lkup, aufs_bindex_t btgt); -+int au_dr_lkup_h_ino(struct au_do_lookup_args *lkup, aufs_bindex_t bindex, -+ ino_t h_ino); -+void au_dr_lkup_fin(struct au_do_lookup_args *lkup); -+int au_dr_opt_set(struct super_block *sb); -+int au_dr_opt_flush(struct super_block *sb); -+int au_dr_opt_clr(struct super_block *sb, int no_flush); -+#else -+AuStubInt0(au_dr_hino_test_add, struct au_dr_br *dr, ino_t h_ino, -+ struct au_dr_hino *add_ent); -+AuStubVoid(au_dr_hino_free, struct au_dr_br *dr); -+AuStubInt0(au_dr_br_init, struct super_block *sb, struct au_branch *br, -+ const struct path *path); -+AuStubInt0(au_dr_br_fin, struct super_block *sb, struct au_branch *br); -+AuStubInt0(au_dr_rename, struct dentry *src, aufs_bindex_t bindex, -+ struct qstr *dst_name, void *_rev); -+AuStubVoid(au_dr_rename_fin, struct dentry *src, aufs_bindex_t btgt, void *rev); -+AuStubVoid(au_dr_rename_rev, struct dentry *src, aufs_bindex_t bindex, -+ void *rev); -+AuStubInt0(au_dr_lkup, struct au_do_lookup_args *lkup, struct dentry *dentry, -+ aufs_bindex_t bindex); -+AuStubInt0(au_dr_lkup_name, struct au_do_lookup_args *lkup, aufs_bindex_t btgt); -+AuStubInt0(au_dr_lkup_h_ino, struct au_do_lookup_args *lkup, -+ aufs_bindex_t bindex, ino_t h_ino); -+AuStubVoid(au_dr_lkup_fin, struct au_do_lookup_args *lkup); -+AuStubInt0(au_dr_opt_set, struct super_block *sb); -+AuStubInt0(au_dr_opt_flush, struct super_block *sb); -+AuStubInt0(au_dr_opt_clr, struct super_block *sb, int no_flush); -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+#ifdef CONFIG_AUFS_DIRREN -+static inline int au_dr_ihash(ino_t h_ino) -+{ -+ return h_ino % AuDirren_NHASH; -+} -+#else -+AuStubInt0(au_dr_ihash, ino_t h_ino); -+#endif -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_DIRREN_H__ */ -diff --git a/fs/aufs/dynop.c b/fs/aufs/dynop.c -new file mode 100644 -index 000000000000..706c2f4bf347 ---- /dev/null -+++ b/fs/aufs/dynop.c -@@ -0,0 +1,357 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2010-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * dynamically customizable operations for regular files -+ */ -+ -+#include "aufs.h" -+ -+#define DyPrSym(key) AuDbgSym(key->dk_op.dy_hop) -+ -+/* -+ * How large will these lists be? -+ * Usually just a few elements, 20-30 at most for each, I guess. -+ */ -+static struct hlist_bl_head dynop[AuDyLast]; -+ -+static struct au_dykey *dy_gfind_get(struct hlist_bl_head *hbl, -+ const void *h_op) -+{ -+ struct au_dykey *key, *tmp; -+ struct hlist_bl_node *pos; -+ -+ key = NULL; -+ hlist_bl_lock(hbl); -+ hlist_bl_for_each_entry(tmp, pos, hbl, dk_hnode) -+ if (tmp->dk_op.dy_hop == h_op) { -+ key = tmp; -+ kref_get(&key->dk_kref); -+ break; -+ } -+ hlist_bl_unlock(hbl); -+ -+ return key; -+} -+ -+static struct au_dykey *dy_bradd(struct au_branch *br, struct au_dykey *key) -+{ -+ struct au_dykey **k, *found; -+ const void *h_op = key->dk_op.dy_hop; -+ int i; -+ -+ found = NULL; -+ k = br->br_dykey; -+ for (i = 0; i < AuBrDynOp; i++) -+ if (k[i]) { -+ if (k[i]->dk_op.dy_hop == h_op) { -+ found = k[i]; -+ break; -+ } -+ } else -+ break; -+ if (!found) { -+ spin_lock(&br->br_dykey_lock); -+ for (; i < AuBrDynOp; i++) -+ if (k[i]) { -+ if (k[i]->dk_op.dy_hop == h_op) { -+ found = k[i]; -+ break; -+ } -+ } else { -+ k[i] = key; -+ break; -+ } -+ spin_unlock(&br->br_dykey_lock); -+ BUG_ON(i == AuBrDynOp); /* expand the array */ -+ } -+ -+ return found; -+} -+ -+/* kref_get() if @key is already added */ -+static struct au_dykey *dy_gadd(struct hlist_bl_head *hbl, struct au_dykey *key) -+{ -+ struct au_dykey *tmp, *found; -+ struct hlist_bl_node *pos; -+ const void *h_op = key->dk_op.dy_hop; -+ -+ found = NULL; -+ hlist_bl_lock(hbl); -+ hlist_bl_for_each_entry(tmp, pos, hbl, dk_hnode) -+ if (tmp->dk_op.dy_hop == h_op) { -+ kref_get(&tmp->dk_kref); -+ found = tmp; -+ break; -+ } -+ if (!found) -+ hlist_bl_add_head(&key->dk_hnode, hbl); -+ hlist_bl_unlock(hbl); -+ -+ if (!found) -+ DyPrSym(key); -+ return found; -+} -+ -+static void dy_free_rcu(struct rcu_head *rcu) -+{ -+ struct au_dykey *key; -+ -+ key = container_of(rcu, struct au_dykey, dk_rcu); -+ DyPrSym(key); -+ kfree(key); -+} -+ -+static void dy_free(struct kref *kref) -+{ -+ struct au_dykey *key; -+ struct hlist_bl_head *hbl; -+ -+ key = container_of(kref, struct au_dykey, dk_kref); -+ hbl = dynop + key->dk_op.dy_type; -+ au_hbl_del(&key->dk_hnode, hbl); -+ call_rcu(&key->dk_rcu, dy_free_rcu); -+} -+ -+void au_dy_put(struct au_dykey *key) -+{ -+ kref_put(&key->dk_kref, dy_free); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+#define DyDbgSize(cnt, op) AuDebugOn(cnt != sizeof(op)/sizeof(void *)) -+ -+#ifdef CONFIG_AUFS_DEBUG -+#define DyDbgDeclare(cnt) unsigned int cnt = 0 -+#define DyDbgInc(cnt) do { cnt++; } while (0) -+#else -+#define DyDbgDeclare(cnt) do {} while (0) -+#define DyDbgInc(cnt) do {} while (0) -+#endif -+ -+#define DySet(func, dst, src, h_op, h_sb) do { \ -+ DyDbgInc(cnt); \ -+ if (h_op->func) { \ -+ if (src.func) \ -+ dst.func = src.func; \ -+ else \ -+ AuDbg("%s %s\n", au_sbtype(h_sb), #func); \ -+ } \ -+} while (0) -+ -+#define DySetForce(func, dst, src) do { \ -+ AuDebugOn(!src.func); \ -+ DyDbgInc(cnt); \ -+ dst.func = src.func; \ -+} while (0) -+ -+#define DySetAop(func) \ -+ DySet(func, dyaop->da_op, aufs_aop, h_aop, h_sb) -+#define DySetAopForce(func) \ -+ DySetForce(func, dyaop->da_op, aufs_aop) -+ -+static void dy_aop(struct au_dykey *key, const void *h_op, -+ struct super_block *h_sb __maybe_unused) -+{ -+ struct au_dyaop *dyaop = (void *)key; -+ const struct address_space_operations *h_aop = h_op; -+ DyDbgDeclare(cnt); -+ -+ AuDbg("%s\n", au_sbtype(h_sb)); -+ -+ DySetAop(writepage); -+ DySetAopForce(readpage); /* force */ -+ DySetAop(writepages); -+ DySetAop(set_page_dirty); -+ DySetAop(readpages); -+ DySetAop(write_begin); -+ DySetAop(write_end); -+ DySetAop(bmap); -+ DySetAop(invalidatepage); -+ DySetAop(releasepage); -+ DySetAop(freepage); -+ /* this one will be changed according to an aufs mount option */ -+ DySetAop(direct_IO); -+ DySetAop(migratepage); -+ DySetAop(isolate_page); -+ DySetAop(putback_page); -+ DySetAop(launder_page); -+ DySetAop(is_partially_uptodate); -+ DySetAop(is_dirty_writeback); -+ DySetAop(error_remove_page); -+ DySetAop(swap_activate); -+ DySetAop(swap_deactivate); -+ -+ DyDbgSize(cnt, *h_aop); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static void dy_bug(struct kref *kref) -+{ -+ BUG(); -+} -+ -+static struct au_dykey *dy_get(struct au_dynop *op, struct au_branch *br) -+{ -+ struct au_dykey *key, *old; -+ struct hlist_bl_head *hbl; -+ struct op { -+ unsigned int sz; -+ void (*set)(struct au_dykey *key, const void *h_op, -+ struct super_block *h_sb __maybe_unused); -+ }; -+ static const struct op a[] = { -+ [AuDy_AOP] = { -+ .sz = sizeof(struct au_dyaop), -+ .set = dy_aop -+ } -+ }; -+ const struct op *p; -+ -+ hbl = dynop + op->dy_type; -+ key = dy_gfind_get(hbl, op->dy_hop); -+ if (key) -+ goto out_add; /* success */ -+ -+ p = a + op->dy_type; -+ key = kzalloc(p->sz, GFP_NOFS); -+ if (unlikely(!key)) { -+ key = ERR_PTR(-ENOMEM); -+ goto out; -+ } -+ -+ key->dk_op.dy_hop = op->dy_hop; -+ kref_init(&key->dk_kref); -+ p->set(key, op->dy_hop, au_br_sb(br)); -+ old = dy_gadd(hbl, key); -+ if (old) { -+ kfree(key); -+ key = old; -+ } -+ -+out_add: -+ old = dy_bradd(br, key); -+ if (old) -+ /* its ref-count should never be zero here */ -+ kref_put(&key->dk_kref, dy_bug); -+out: -+ return key; -+} -+ -+/* ---------------------------------------------------------------------- */ -+/* -+ * Aufs prohibits O_DIRECT by defaut even if the branch supports it. -+ * This behaviour is necessary to return an error from open(O_DIRECT) instead -+ * of the succeeding I/O. The dio mount option enables O_DIRECT and makes -+ * open(O_DIRECT) always succeed, but the succeeding I/O may return an error. -+ * See the aufs manual in detail. -+ */ -+static void dy_adx(struct au_dyaop *dyaop, int do_dx) -+{ -+ if (!do_dx) -+ dyaop->da_op.direct_IO = NULL; -+ else -+ dyaop->da_op.direct_IO = aufs_aop.direct_IO; -+} -+ -+static struct au_dyaop *dy_aget(struct au_branch *br, -+ const struct address_space_operations *h_aop, -+ int do_dx) -+{ -+ struct au_dyaop *dyaop; -+ struct au_dynop op; -+ -+ op.dy_type = AuDy_AOP; -+ op.dy_haop = h_aop; -+ dyaop = (void *)dy_get(&op, br); -+ if (IS_ERR(dyaop)) -+ goto out; -+ dy_adx(dyaop, do_dx); -+ -+out: -+ return dyaop; -+} -+ -+int au_dy_iaop(struct inode *inode, aufs_bindex_t bindex, -+ struct inode *h_inode) -+{ -+ int err, do_dx; -+ struct super_block *sb; -+ struct au_branch *br; -+ struct au_dyaop *dyaop; -+ -+ AuDebugOn(!S_ISREG(h_inode->i_mode)); -+ IiMustWriteLock(inode); -+ -+ sb = inode->i_sb; -+ br = au_sbr(sb, bindex); -+ do_dx = !!au_opt_test(au_mntflags(sb), DIO); -+ dyaop = dy_aget(br, h_inode->i_mapping->a_ops, do_dx); -+ err = PTR_ERR(dyaop); -+ if (IS_ERR(dyaop)) -+ /* unnecessary to call dy_fput() */ -+ goto out; -+ -+ err = 0; -+ inode->i_mapping->a_ops = &dyaop->da_op; -+ -+out: -+ return err; -+} -+ -+/* -+ * Is it safe to replace a_ops during the inode/file is in operation? -+ * Yes, I hope so. -+ */ -+int au_dy_irefresh(struct inode *inode) -+{ -+ int err; -+ aufs_bindex_t btop; -+ struct inode *h_inode; -+ -+ err = 0; -+ if (S_ISREG(inode->i_mode)) { -+ btop = au_ibtop(inode); -+ h_inode = au_h_iptr(inode, btop); -+ err = au_dy_iaop(inode, btop, h_inode); -+ } -+ return err; -+} -+ -+void au_dy_arefresh(int do_dx) -+{ -+ struct hlist_bl_head *hbl; -+ struct hlist_bl_node *pos; -+ struct au_dykey *key; -+ -+ hbl = dynop + AuDy_AOP; -+ hlist_bl_lock(hbl); -+ hlist_bl_for_each_entry(key, pos, hbl, dk_hnode) -+ dy_adx((void *)key, do_dx); -+ hlist_bl_unlock(hbl); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void __init au_dy_init(void) -+{ -+ int i; -+ -+ /* make sure that 'struct au_dykey *' can be any type */ -+ BUILD_BUG_ON(offsetof(struct au_dyaop, da_key)); -+ -+ for (i = 0; i < AuDyLast; i++) -+ INIT_HLIST_BL_HEAD(dynop + i); -+} -+ -+void au_dy_fin(void) -+{ -+ int i; -+ -+ for (i = 0; i < AuDyLast; i++) -+ WARN_ON(!hlist_bl_empty(dynop + i)); -+} -diff --git a/fs/aufs/dynop.h b/fs/aufs/dynop.h -new file mode 100644 -index 000000000000..9a48883f520d ---- /dev/null -+++ b/fs/aufs/dynop.h -@@ -0,0 +1,62 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2010-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * dynamically customizable operations (for regular files only) -+ */ -+ -+#ifndef __AUFS_DYNOP_H__ -+#define __AUFS_DYNOP_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+#include -+ -+enum {AuDy_AOP, AuDyLast}; -+ -+struct au_dynop { -+ int dy_type; -+ union { -+ const void *dy_hop; -+ const struct address_space_operations *dy_haop; -+ }; -+}; -+ -+struct au_dykey { -+ union { -+ struct hlist_bl_node dk_hnode; -+ struct rcu_head dk_rcu; -+ }; -+ struct au_dynop dk_op; -+ -+ /* -+ * during I am in the branch local array, kref is gotten. when the -+ * branch is removed, kref is put. -+ */ -+ struct kref dk_kref; -+}; -+ -+/* stop unioning since their sizes are very different from each other */ -+struct au_dyaop { -+ struct au_dykey da_key; -+ struct address_space_operations da_op; /* not const */ -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* dynop.c */ -+struct au_branch; -+void au_dy_put(struct au_dykey *key); -+int au_dy_iaop(struct inode *inode, aufs_bindex_t bindex, -+ struct inode *h_inode); -+int au_dy_irefresh(struct inode *inode); -+void au_dy_arefresh(int do_dio); -+ -+void __init au_dy_init(void); -+void au_dy_fin(void); -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_DYNOP_H__ */ -diff --git a/fs/aufs/export.c b/fs/aufs/export.c -new file mode 100644 -index 000000000000..a7e471fd6c6a ---- /dev/null -+++ b/fs/aufs/export.c -@@ -0,0 +1,824 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * export via nfs -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include "aufs.h" -+ -+union conv { -+#ifdef CONFIG_AUFS_INO_T_64 -+ __u32 a[2]; -+#else -+ __u32 a[1]; -+#endif -+ ino_t ino; -+}; -+ -+static ino_t decode_ino(__u32 *a) -+{ -+ union conv u; -+ -+ BUILD_BUG_ON(sizeof(u.ino) != sizeof(u.a)); -+ u.a[0] = a[0]; -+#ifdef CONFIG_AUFS_INO_T_64 -+ u.a[1] = a[1]; -+#endif -+ return u.ino; -+} -+ -+static void encode_ino(__u32 *a, ino_t ino) -+{ -+ union conv u; -+ -+ u.ino = ino; -+ a[0] = u.a[0]; -+#ifdef CONFIG_AUFS_INO_T_64 -+ a[1] = u.a[1]; -+#endif -+} -+ -+/* NFS file handle */ -+enum { -+ Fh_br_id, -+ Fh_sigen, -+#ifdef CONFIG_AUFS_INO_T_64 -+ /* support 64bit inode number */ -+ Fh_ino1, -+ Fh_ino2, -+ Fh_dir_ino1, -+ Fh_dir_ino2, -+#else -+ Fh_ino1, -+ Fh_dir_ino1, -+#endif -+ Fh_igen, -+ Fh_h_type, -+ Fh_tail, -+ -+ Fh_ino = Fh_ino1, -+ Fh_dir_ino = Fh_dir_ino1 -+}; -+ -+static int au_test_anon(struct dentry *dentry) -+{ -+ /* note: read d_flags without d_lock */ -+ return !!(dentry->d_flags & DCACHE_DISCONNECTED); -+} -+ -+int au_test_nfsd(void) -+{ -+ int ret; -+ struct task_struct *tsk = current; -+ char comm[sizeof(tsk->comm)]; -+ -+ ret = 0; -+ if (tsk->flags & PF_KTHREAD) { -+ get_task_comm(comm, tsk); -+ ret = !strcmp(comm, "nfsd"); -+ } -+ -+ return ret; -+} -+ -+/* ---------------------------------------------------------------------- */ -+/* inode generation external table */ -+ -+void au_xigen_inc(struct inode *inode) -+{ -+ loff_t pos; -+ ssize_t sz; -+ __u32 igen; -+ struct super_block *sb; -+ struct au_sbinfo *sbinfo; -+ -+ sb = inode->i_sb; -+ AuDebugOn(!au_opt_test(au_mntflags(sb), XINO)); -+ -+ sbinfo = au_sbi(sb); -+ pos = inode->i_ino; -+ pos *= sizeof(igen); -+ igen = inode->i_generation + 1; -+ sz = xino_fwrite(sbinfo->si_xwrite, sbinfo->si_xigen, &igen, -+ sizeof(igen), &pos); -+ if (sz == sizeof(igen)) -+ return; /* success */ -+ -+ if (unlikely(sz >= 0)) -+ AuIOErr("xigen error (%zd)\n", sz); -+} -+ -+int au_xigen_new(struct inode *inode) -+{ -+ int err; -+ loff_t pos; -+ ssize_t sz; -+ struct super_block *sb; -+ struct au_sbinfo *sbinfo; -+ struct file *file; -+ -+ err = 0; -+ /* todo: dirty, at mount time */ -+ if (inode->i_ino == AUFS_ROOT_INO) -+ goto out; -+ sb = inode->i_sb; -+ SiMustAnyLock(sb); -+ if (unlikely(!au_opt_test(au_mntflags(sb), XINO))) -+ goto out; -+ -+ err = -EFBIG; -+ pos = inode->i_ino; -+ if (unlikely(au_loff_max / sizeof(inode->i_generation) - 1 < pos)) { -+ AuIOErr1("too large i%lld\n", pos); -+ goto out; -+ } -+ pos *= sizeof(inode->i_generation); -+ -+ err = 0; -+ sbinfo = au_sbi(sb); -+ file = sbinfo->si_xigen; -+ BUG_ON(!file); -+ -+ if (vfsub_f_size_read(file) -+ < pos + sizeof(inode->i_generation)) { -+ inode->i_generation = atomic_inc_return(&sbinfo->si_xigen_next); -+ sz = xino_fwrite(sbinfo->si_xwrite, file, &inode->i_generation, -+ sizeof(inode->i_generation), &pos); -+ } else -+ sz = xino_fread(sbinfo->si_xread, file, &inode->i_generation, -+ sizeof(inode->i_generation), &pos); -+ if (sz == sizeof(inode->i_generation)) -+ goto out; /* success */ -+ -+ err = sz; -+ if (unlikely(sz >= 0)) { -+ err = -EIO; -+ AuIOErr("xigen error (%zd)\n", sz); -+ } -+ -+out: -+ return err; -+} -+ -+int au_xigen_set(struct super_block *sb, struct file *base) -+{ -+ int err; -+ struct au_sbinfo *sbinfo; -+ struct file *file; -+ -+ SiMustWriteLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ file = au_xino_create2(base, sbinfo->si_xigen); -+ err = PTR_ERR(file); -+ if (IS_ERR(file)) -+ goto out; -+ err = 0; -+ if (sbinfo->si_xigen) -+ fput(sbinfo->si_xigen); -+ sbinfo->si_xigen = file; -+ -+out: -+ return err; -+} -+ -+void au_xigen_clr(struct super_block *sb) -+{ -+ struct au_sbinfo *sbinfo; -+ -+ SiMustWriteLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ if (sbinfo->si_xigen) { -+ fput(sbinfo->si_xigen); -+ sbinfo->si_xigen = NULL; -+ } -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static struct dentry *decode_by_ino(struct super_block *sb, ino_t ino, -+ ino_t dir_ino) -+{ -+ struct dentry *dentry, *d; -+ struct inode *inode; -+ unsigned int sigen; -+ -+ dentry = NULL; -+ inode = ilookup(sb, ino); -+ if (!inode) -+ goto out; -+ -+ dentry = ERR_PTR(-ESTALE); -+ sigen = au_sigen(sb); -+ if (unlikely(au_is_bad_inode(inode) -+ || IS_DEADDIR(inode) -+ || sigen != au_iigen(inode, NULL))) -+ goto out_iput; -+ -+ dentry = NULL; -+ if (!dir_ino || S_ISDIR(inode->i_mode)) -+ dentry = d_find_alias(inode); -+ else { -+ spin_lock(&inode->i_lock); -+ hlist_for_each_entry(d, &inode->i_dentry, d_u.d_alias) { -+ spin_lock(&d->d_lock); -+ if (!au_test_anon(d) -+ && d_inode(d->d_parent)->i_ino == dir_ino) { -+ dentry = dget_dlock(d); -+ spin_unlock(&d->d_lock); -+ break; -+ } -+ spin_unlock(&d->d_lock); -+ } -+ spin_unlock(&inode->i_lock); -+ } -+ if (unlikely(dentry && au_digen_test(dentry, sigen))) { -+ /* need to refresh */ -+ dput(dentry); -+ dentry = NULL; -+ } -+ -+out_iput: -+ iput(inode); -+out: -+ AuTraceErrPtr(dentry); -+ return dentry; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* todo: dirty? */ -+/* if exportfs_decode_fh() passed vfsmount*, we could be happy */ -+ -+struct au_compare_mnt_args { -+ /* input */ -+ struct super_block *sb; -+ -+ /* output */ -+ struct vfsmount *mnt; -+}; -+ -+static int au_compare_mnt(struct vfsmount *mnt, void *arg) -+{ -+ struct au_compare_mnt_args *a = arg; -+ -+ if (mnt->mnt_sb != a->sb) -+ return 0; -+ a->mnt = mntget(mnt); -+ return 1; -+} -+ -+static struct vfsmount *au_mnt_get(struct super_block *sb) -+{ -+ int err; -+ struct path root; -+ struct au_compare_mnt_args args = { -+ .sb = sb -+ }; -+ -+ get_fs_root(current->fs, &root); -+ rcu_read_lock(); -+ err = iterate_mounts(au_compare_mnt, &args, root.mnt); -+ rcu_read_unlock(); -+ path_put(&root); -+ AuDebugOn(!err); -+ AuDebugOn(!args.mnt); -+ return args.mnt; -+} -+ -+struct au_nfsd_si_lock { -+ unsigned int sigen; -+ aufs_bindex_t bindex, br_id; -+ unsigned char force_lock; -+}; -+ -+static int si_nfsd_read_lock(struct super_block *sb, -+ struct au_nfsd_si_lock *nsi_lock) -+{ -+ int err; -+ aufs_bindex_t bindex; -+ -+ si_read_lock(sb, AuLock_FLUSH); -+ -+ /* branch id may be wrapped around */ -+ err = 0; -+ bindex = au_br_index(sb, nsi_lock->br_id); -+ if (bindex >= 0 && nsi_lock->sigen + AUFS_BRANCH_MAX > au_sigen(sb)) -+ goto out; /* success */ -+ -+ err = -ESTALE; -+ bindex = -1; -+ if (!nsi_lock->force_lock) -+ si_read_unlock(sb); -+ -+out: -+ nsi_lock->bindex = bindex; -+ return err; -+} -+ -+struct find_name_by_ino { -+ struct dir_context ctx; -+ int called, found; -+ ino_t ino; -+ char *name; -+ int namelen; -+}; -+ -+static int -+find_name_by_ino(struct dir_context *ctx, const char *name, int namelen, -+ loff_t offset, u64 ino, unsigned int d_type) -+{ -+ struct find_name_by_ino *a = container_of(ctx, struct find_name_by_ino, -+ ctx); -+ -+ a->called++; -+ if (a->ino != ino) -+ return 0; -+ -+ memcpy(a->name, name, namelen); -+ a->namelen = namelen; -+ a->found = 1; -+ return 1; -+} -+ -+static struct dentry *au_lkup_by_ino(struct path *path, ino_t ino, -+ struct au_nfsd_si_lock *nsi_lock) -+{ -+ struct dentry *dentry, *parent; -+ struct file *file; -+ struct inode *dir; -+ struct find_name_by_ino arg = { -+ .ctx = { -+ .actor = find_name_by_ino -+ } -+ }; -+ int err; -+ -+ parent = path->dentry; -+ if (nsi_lock) -+ si_read_unlock(parent->d_sb); -+ file = vfsub_dentry_open(path, au_dir_roflags); -+ dentry = (void *)file; -+ if (IS_ERR(file)) -+ goto out; -+ -+ dentry = ERR_PTR(-ENOMEM); -+ arg.name = (void *)__get_free_page(GFP_NOFS); -+ if (unlikely(!arg.name)) -+ goto out_file; -+ arg.ino = ino; -+ arg.found = 0; -+ do { -+ arg.called = 0; -+ /* smp_mb(); */ -+ err = vfsub_iterate_dir(file, &arg.ctx); -+ } while (!err && !arg.found && arg.called); -+ dentry = ERR_PTR(err); -+ if (unlikely(err)) -+ goto out_name; -+ /* instead of ENOENT */ -+ dentry = ERR_PTR(-ESTALE); -+ if (!arg.found) -+ goto out_name; -+ -+ /* do not call vfsub_lkup_one() */ -+ dir = d_inode(parent); -+ dentry = vfsub_lookup_one_len_unlocked(arg.name, parent, arg.namelen); -+ AuTraceErrPtr(dentry); -+ if (IS_ERR(dentry)) -+ goto out_name; -+ AuDebugOn(au_test_anon(dentry)); -+ if (unlikely(d_really_is_negative(dentry))) { -+ dput(dentry); -+ dentry = ERR_PTR(-ENOENT); -+ } -+ -+out_name: -+ free_page((unsigned long)arg.name); -+out_file: -+ fput(file); -+out: -+ if (unlikely(nsi_lock -+ && si_nfsd_read_lock(parent->d_sb, nsi_lock) < 0)) -+ if (!IS_ERR(dentry)) { -+ dput(dentry); -+ dentry = ERR_PTR(-ESTALE); -+ } -+ AuTraceErrPtr(dentry); -+ return dentry; -+} -+ -+static struct dentry *decode_by_dir_ino(struct super_block *sb, ino_t ino, -+ ino_t dir_ino, -+ struct au_nfsd_si_lock *nsi_lock) -+{ -+ struct dentry *dentry; -+ struct path path; -+ -+ if (dir_ino != AUFS_ROOT_INO) { -+ path.dentry = decode_by_ino(sb, dir_ino, 0); -+ dentry = path.dentry; -+ if (!path.dentry || IS_ERR(path.dentry)) -+ goto out; -+ AuDebugOn(au_test_anon(path.dentry)); -+ } else -+ path.dentry = dget(sb->s_root); -+ -+ path.mnt = au_mnt_get(sb); -+ dentry = au_lkup_by_ino(&path, ino, nsi_lock); -+ path_put(&path); -+ -+out: -+ AuTraceErrPtr(dentry); -+ return dentry; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int h_acceptable(void *expv, struct dentry *dentry) -+{ -+ return 1; -+} -+ -+static char *au_build_path(struct dentry *h_parent, struct path *h_rootpath, -+ char *buf, int len, struct super_block *sb) -+{ -+ char *p; -+ int n; -+ struct path path; -+ -+ p = d_path(h_rootpath, buf, len); -+ if (IS_ERR(p)) -+ goto out; -+ n = strlen(p); -+ -+ path.mnt = h_rootpath->mnt; -+ path.dentry = h_parent; -+ p = d_path(&path, buf, len); -+ if (IS_ERR(p)) -+ goto out; -+ if (n != 1) -+ p += n; -+ -+ path.mnt = au_mnt_get(sb); -+ path.dentry = sb->s_root; -+ p = d_path(&path, buf, len - strlen(p)); -+ mntput(path.mnt); -+ if (IS_ERR(p)) -+ goto out; -+ if (n != 1) -+ p[strlen(p)] = '/'; -+ -+out: -+ AuTraceErrPtr(p); -+ return p; -+} -+ -+static -+struct dentry *decode_by_path(struct super_block *sb, ino_t ino, __u32 *fh, -+ int fh_len, struct au_nfsd_si_lock *nsi_lock) -+{ -+ struct dentry *dentry, *h_parent, *root; -+ struct super_block *h_sb; -+ char *pathname, *p; -+ struct vfsmount *h_mnt; -+ struct au_branch *br; -+ int err; -+ struct path path; -+ -+ br = au_sbr(sb, nsi_lock->bindex); -+ h_mnt = au_br_mnt(br); -+ h_sb = h_mnt->mnt_sb; -+ /* todo: call lower fh_to_dentry()? fh_to_parent()? */ -+ lockdep_off(); -+ h_parent = exportfs_decode_fh(h_mnt, (void *)(fh + Fh_tail), -+ fh_len - Fh_tail, fh[Fh_h_type], -+ h_acceptable, /*context*/NULL); -+ lockdep_on(); -+ dentry = h_parent; -+ if (unlikely(!h_parent || IS_ERR(h_parent))) { -+ AuWarn1("%s decode_fh failed, %ld\n", -+ au_sbtype(h_sb), PTR_ERR(h_parent)); -+ goto out; -+ } -+ dentry = NULL; -+ if (unlikely(au_test_anon(h_parent))) { -+ AuWarn1("%s decode_fh returned a disconnected dentry\n", -+ au_sbtype(h_sb)); -+ goto out_h_parent; -+ } -+ -+ dentry = ERR_PTR(-ENOMEM); -+ pathname = (void *)__get_free_page(GFP_NOFS); -+ if (unlikely(!pathname)) -+ goto out_h_parent; -+ -+ root = sb->s_root; -+ path.mnt = h_mnt; -+ di_read_lock_parent(root, !AuLock_IR); -+ path.dentry = au_h_dptr(root, nsi_lock->bindex); -+ di_read_unlock(root, !AuLock_IR); -+ p = au_build_path(h_parent, &path, pathname, PAGE_SIZE, sb); -+ dentry = (void *)p; -+ if (IS_ERR(p)) -+ goto out_pathname; -+ -+ si_read_unlock(sb); -+ err = vfsub_kern_path(p, LOOKUP_FOLLOW | LOOKUP_DIRECTORY, &path); -+ dentry = ERR_PTR(err); -+ if (unlikely(err)) -+ goto out_relock; -+ -+ dentry = ERR_PTR(-ENOENT); -+ AuDebugOn(au_test_anon(path.dentry)); -+ if (unlikely(d_really_is_negative(path.dentry))) -+ goto out_path; -+ -+ if (ino != d_inode(path.dentry)->i_ino) -+ dentry = au_lkup_by_ino(&path, ino, /*nsi_lock*/NULL); -+ else -+ dentry = dget(path.dentry); -+ -+out_path: -+ path_put(&path); -+out_relock: -+ if (unlikely(si_nfsd_read_lock(sb, nsi_lock) < 0)) -+ if (!IS_ERR(dentry)) { -+ dput(dentry); -+ dentry = ERR_PTR(-ESTALE); -+ } -+out_pathname: -+ free_page((unsigned long)pathname); -+out_h_parent: -+ dput(h_parent); -+out: -+ AuTraceErrPtr(dentry); -+ return dentry; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static struct dentry * -+aufs_fh_to_dentry(struct super_block *sb, struct fid *fid, int fh_len, -+ int fh_type) -+{ -+ struct dentry *dentry; -+ __u32 *fh = fid->raw; -+ struct au_branch *br; -+ ino_t ino, dir_ino; -+ struct au_nfsd_si_lock nsi_lock = { -+ .force_lock = 0 -+ }; -+ -+ dentry = ERR_PTR(-ESTALE); -+ /* it should never happen, but the file handle is unreliable */ -+ if (unlikely(fh_len < Fh_tail)) -+ goto out; -+ nsi_lock.sigen = fh[Fh_sigen]; -+ nsi_lock.br_id = fh[Fh_br_id]; -+ -+ /* branch id may be wrapped around */ -+ br = NULL; -+ if (unlikely(si_nfsd_read_lock(sb, &nsi_lock))) -+ goto out; -+ nsi_lock.force_lock = 1; -+ -+ /* is this inode still cached? */ -+ ino = decode_ino(fh + Fh_ino); -+ /* it should never happen */ -+ if (unlikely(ino == AUFS_ROOT_INO)) -+ goto out_unlock; -+ -+ dir_ino = decode_ino(fh + Fh_dir_ino); -+ dentry = decode_by_ino(sb, ino, dir_ino); -+ if (IS_ERR(dentry)) -+ goto out_unlock; -+ if (dentry) -+ goto accept; -+ -+ /* is the parent dir cached? */ -+ br = au_sbr(sb, nsi_lock.bindex); -+ au_br_get(br); -+ dentry = decode_by_dir_ino(sb, ino, dir_ino, &nsi_lock); -+ if (IS_ERR(dentry)) -+ goto out_unlock; -+ if (dentry) -+ goto accept; -+ -+ /* lookup path */ -+ dentry = decode_by_path(sb, ino, fh, fh_len, &nsi_lock); -+ if (IS_ERR(dentry)) -+ goto out_unlock; -+ if (unlikely(!dentry)) -+ /* todo?: make it ESTALE */ -+ goto out_unlock; -+ -+accept: -+ if (!au_digen_test(dentry, au_sigen(sb)) -+ && d_inode(dentry)->i_generation == fh[Fh_igen]) -+ goto out_unlock; /* success */ -+ -+ dput(dentry); -+ dentry = ERR_PTR(-ESTALE); -+out_unlock: -+ if (br) -+ au_br_put(br); -+ si_read_unlock(sb); -+out: -+ AuTraceErrPtr(dentry); -+ return dentry; -+} -+ -+#if 0 /* reserved for future use */ -+/* support subtreecheck option */ -+static struct dentry *aufs_fh_to_parent(struct super_block *sb, struct fid *fid, -+ int fh_len, int fh_type) -+{ -+ struct dentry *parent; -+ __u32 *fh = fid->raw; -+ ino_t dir_ino; -+ -+ dir_ino = decode_ino(fh + Fh_dir_ino); -+ parent = decode_by_ino(sb, dir_ino, 0); -+ if (IS_ERR(parent)) -+ goto out; -+ if (!parent) -+ parent = decode_by_path(sb, au_br_index(sb, fh[Fh_br_id]), -+ dir_ino, fh, fh_len); -+ -+out: -+ AuTraceErrPtr(parent); -+ return parent; -+} -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int aufs_encode_fh(struct inode *inode, __u32 *fh, int *max_len, -+ struct inode *dir) -+{ -+ int err; -+ aufs_bindex_t bindex; -+ struct super_block *sb, *h_sb; -+ struct dentry *dentry, *parent, *h_parent; -+ struct inode *h_dir; -+ struct au_branch *br; -+ -+ err = -ENOSPC; -+ if (unlikely(*max_len <= Fh_tail)) { -+ AuWarn1("NFSv2 client (max_len %d)?\n", *max_len); -+ goto out; -+ } -+ -+ err = FILEID_ROOT; -+ if (inode->i_ino == AUFS_ROOT_INO) { -+ AuDebugOn(inode->i_ino != AUFS_ROOT_INO); -+ goto out; -+ } -+ -+ h_parent = NULL; -+ sb = inode->i_sb; -+ err = si_read_lock(sb, AuLock_FLUSH); -+ if (unlikely(err)) -+ goto out; -+ -+#ifdef CONFIG_AUFS_DEBUG -+ if (unlikely(!au_opt_test(au_mntflags(sb), XINO))) -+ AuWarn1("NFS-exporting requires xino\n"); -+#endif -+ err = -EIO; -+ parent = NULL; -+ ii_read_lock_child(inode); -+ bindex = au_ibtop(inode); -+ if (!dir) { -+ dentry = d_find_any_alias(inode); -+ if (unlikely(!dentry)) -+ goto out_unlock; -+ AuDebugOn(au_test_anon(dentry)); -+ parent = dget_parent(dentry); -+ dput(dentry); -+ if (unlikely(!parent)) -+ goto out_unlock; -+ if (d_really_is_positive(parent)) -+ dir = d_inode(parent); -+ } -+ -+ ii_read_lock_parent(dir); -+ h_dir = au_h_iptr(dir, bindex); -+ ii_read_unlock(dir); -+ if (unlikely(!h_dir)) -+ goto out_parent; -+ h_parent = d_find_any_alias(h_dir); -+ if (unlikely(!h_parent)) -+ goto out_hparent; -+ -+ err = -EPERM; -+ br = au_sbr(sb, bindex); -+ h_sb = au_br_sb(br); -+ if (unlikely(!h_sb->s_export_op)) { -+ AuErr1("%s branch is not exportable\n", au_sbtype(h_sb)); -+ goto out_hparent; -+ } -+ -+ fh[Fh_br_id] = br->br_id; -+ fh[Fh_sigen] = au_sigen(sb); -+ encode_ino(fh + Fh_ino, inode->i_ino); -+ encode_ino(fh + Fh_dir_ino, dir->i_ino); -+ fh[Fh_igen] = inode->i_generation; -+ -+ *max_len -= Fh_tail; -+ fh[Fh_h_type] = exportfs_encode_fh(h_parent, (void *)(fh + Fh_tail), -+ max_len, -+ /*connectable or subtreecheck*/0); -+ err = fh[Fh_h_type]; -+ *max_len += Fh_tail; -+ /* todo: macros? */ -+ if (err != FILEID_INVALID) -+ err = 99; -+ else -+ AuWarn1("%s encode_fh failed\n", au_sbtype(h_sb)); -+ -+out_hparent: -+ dput(h_parent); -+out_parent: -+ dput(parent); -+out_unlock: -+ ii_read_unlock(inode); -+ si_read_unlock(sb); -+out: -+ if (unlikely(err < 0)) -+ err = FILEID_INVALID; -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int aufs_commit_metadata(struct inode *inode) -+{ -+ int err; -+ aufs_bindex_t bindex; -+ struct super_block *sb; -+ struct inode *h_inode; -+ int (*f)(struct inode *inode); -+ -+ sb = inode->i_sb; -+ si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); -+ ii_write_lock_child(inode); -+ bindex = au_ibtop(inode); -+ AuDebugOn(bindex < 0); -+ h_inode = au_h_iptr(inode, bindex); -+ -+ f = h_inode->i_sb->s_export_op->commit_metadata; -+ if (f) -+ err = f(h_inode); -+ else { -+ struct writeback_control wbc = { -+ .sync_mode = WB_SYNC_ALL, -+ .nr_to_write = 0 /* metadata only */ -+ }; -+ -+ err = sync_inode(h_inode, &wbc); -+ } -+ -+ au_cpup_attr_timesizes(inode); -+ ii_write_unlock(inode); -+ si_read_unlock(sb); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static struct export_operations aufs_export_op = { -+ .fh_to_dentry = aufs_fh_to_dentry, -+ /* .fh_to_parent = aufs_fh_to_parent, */ -+ .encode_fh = aufs_encode_fh, -+ .commit_metadata = aufs_commit_metadata -+}; -+ -+void au_export_init(struct super_block *sb) -+{ -+ struct au_sbinfo *sbinfo; -+ __u32 u; -+ -+ BUILD_BUG_ON_MSG(IS_BUILTIN(CONFIG_AUFS_FS) -+ && IS_MODULE(CONFIG_EXPORTFS), -+ AUFS_NAME ": unsupported configuration " -+ "CONFIG_EXPORTFS=m and CONFIG_AUFS_FS=y"); -+ -+ sb->s_export_op = &aufs_export_op; -+ sbinfo = au_sbi(sb); -+ sbinfo->si_xigen = NULL; -+ get_random_bytes(&u, sizeof(u)); -+ BUILD_BUG_ON(sizeof(u) != sizeof(int)); -+ atomic_set(&sbinfo->si_xigen_next, u); -+} -diff --git a/fs/aufs/f_op.c b/fs/aufs/f_op.c -new file mode 100644 -index 000000000000..3ea06e5a1610 ---- /dev/null -+++ b/fs/aufs/f_op.c -@@ -0,0 +1,805 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * file and vm operations -+ */ -+ -+#include -+#include -+#include -+#include -+#include "aufs.h" -+ -+int au_do_open_nondir(struct file *file, int flags, struct file *h_file) -+{ -+ int err; -+ aufs_bindex_t bindex; -+ struct dentry *dentry, *h_dentry; -+ struct au_finfo *finfo; -+ struct inode *h_inode; -+ -+ FiMustWriteLock(file); -+ -+ err = 0; -+ dentry = file->f_path.dentry; -+ AuDebugOn(IS_ERR_OR_NULL(dentry)); -+ finfo = au_fi(file); -+ memset(&finfo->fi_htop, 0, sizeof(finfo->fi_htop)); -+ atomic_set(&finfo->fi_mmapped, 0); -+ bindex = au_dbtop(dentry); -+ if (!h_file) { -+ h_dentry = au_h_dptr(dentry, bindex); -+ err = vfsub_test_mntns(file->f_path.mnt, h_dentry->d_sb); -+ if (unlikely(err)) -+ goto out; -+ h_file = au_h_open(dentry, bindex, flags, file, /*force_wr*/0); -+ } else { -+ h_dentry = h_file->f_path.dentry; -+ err = vfsub_test_mntns(file->f_path.mnt, h_dentry->d_sb); -+ if (unlikely(err)) -+ goto out; -+ get_file(h_file); -+ } -+ if (IS_ERR(h_file)) -+ err = PTR_ERR(h_file); -+ else { -+ if ((flags & __O_TMPFILE) -+ && !(flags & O_EXCL)) { -+ h_inode = file_inode(h_file); -+ spin_lock(&h_inode->i_lock); -+ h_inode->i_state |= I_LINKABLE; -+ spin_unlock(&h_inode->i_lock); -+ } -+ au_set_fbtop(file, bindex); -+ au_set_h_fptr(file, bindex, h_file); -+ au_update_figen(file); -+ /* todo: necessary? */ -+ /* file->f_ra = h_file->f_ra; */ -+ } -+ -+out: -+ return err; -+} -+ -+static int aufs_open_nondir(struct inode *inode __maybe_unused, -+ struct file *file) -+{ -+ int err; -+ struct super_block *sb; -+ struct au_do_open_args args = { -+ .open = au_do_open_nondir -+ }; -+ -+ AuDbg("%pD, f_flags 0x%x, f_mode 0x%x\n", -+ file, vfsub_file_flags(file), file->f_mode); -+ -+ sb = file->f_path.dentry->d_sb; -+ si_read_lock(sb, AuLock_FLUSH); -+ err = au_do_open(file, &args); -+ si_read_unlock(sb); -+ return err; -+} -+ -+int aufs_release_nondir(struct inode *inode __maybe_unused, struct file *file) -+{ -+ struct au_finfo *finfo; -+ aufs_bindex_t bindex; -+ -+ finfo = au_fi(file); -+ au_hbl_del(&finfo->fi_hlist, -+ &au_sbi(file->f_path.dentry->d_sb)->si_files); -+ bindex = finfo->fi_btop; -+ if (bindex >= 0) -+ au_set_h_fptr(file, bindex, NULL); -+ -+ au_finfo_fin(file); -+ return 0; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_do_flush_nondir(struct file *file, fl_owner_t id) -+{ -+ int err; -+ struct file *h_file; -+ -+ err = 0; -+ h_file = au_hf_top(file); -+ if (h_file) -+ err = vfsub_flush(h_file, id); -+ return err; -+} -+ -+static int aufs_flush_nondir(struct file *file, fl_owner_t id) -+{ -+ return au_do_flush(file, id, au_do_flush_nondir); -+} -+ -+/* ---------------------------------------------------------------------- */ -+/* -+ * read and write functions acquire [fdi]_rwsem once, but release before -+ * mmap_sem. This is because to stop a race condition between mmap(2). -+ * Releasing these aufs-rwsem should be safe, no branch-mamagement (by keeping -+ * si_rwsem), no harmful copy-up should happen. Actually copy-up may happen in -+ * read functions after [fdi]_rwsem are released, but it should be harmless. -+ */ -+ -+/* Callers should call au_read_post() or fput() in the end */ -+struct file *au_read_pre(struct file *file, int keep_fi, unsigned int lsc) -+{ -+ struct file *h_file; -+ int err; -+ -+ err = au_reval_and_lock_fdi(file, au_reopen_nondir, /*wlock*/0, lsc); -+ if (!err) { -+ di_read_unlock(file->f_path.dentry, AuLock_IR); -+ h_file = au_hf_top(file); -+ get_file(h_file); -+ if (!keep_fi) -+ fi_read_unlock(file); -+ } else -+ h_file = ERR_PTR(err); -+ -+ return h_file; -+} -+ -+static void au_read_post(struct inode *inode, struct file *h_file) -+{ -+ /* update without lock, I don't think it a problem */ -+ fsstack_copy_attr_atime(inode, file_inode(h_file)); -+ fput(h_file); -+} -+ -+struct au_write_pre { -+ /* input */ -+ unsigned int lsc; -+ -+ /* output */ -+ blkcnt_t blks; -+ aufs_bindex_t btop; -+}; -+ -+/* -+ * return with iinfo is write-locked -+ * callers should call au_write_post() or iinfo_write_unlock() + fput() in the -+ * end -+ */ -+static struct file *au_write_pre(struct file *file, int do_ready, -+ struct au_write_pre *wpre) -+{ -+ struct file *h_file; -+ struct dentry *dentry; -+ int err; -+ unsigned int lsc; -+ struct au_pin pin; -+ -+ lsc = 0; -+ if (wpre) -+ lsc = wpre->lsc; -+ err = au_reval_and_lock_fdi(file, au_reopen_nondir, /*wlock*/1, lsc); -+ h_file = ERR_PTR(err); -+ if (unlikely(err)) -+ goto out; -+ -+ dentry = file->f_path.dentry; -+ if (do_ready) { -+ err = au_ready_to_write(file, -1, &pin); -+ if (unlikely(err)) { -+ h_file = ERR_PTR(err); -+ di_write_unlock(dentry); -+ goto out_fi; -+ } -+ } -+ -+ di_downgrade_lock(dentry, /*flags*/0); -+ if (wpre) -+ wpre->btop = au_fbtop(file); -+ h_file = au_hf_top(file); -+ get_file(h_file); -+ if (wpre) -+ wpre->blks = file_inode(h_file)->i_blocks; -+ if (do_ready) -+ au_unpin(&pin); -+ di_read_unlock(dentry, /*flags*/0); -+ -+out_fi: -+ fi_write_unlock(file); -+out: -+ return h_file; -+} -+ -+static void au_write_post(struct inode *inode, struct file *h_file, -+ struct au_write_pre *wpre, ssize_t written) -+{ -+ struct inode *h_inode; -+ -+ au_cpup_attr_timesizes(inode); -+ AuDebugOn(au_ibtop(inode) != wpre->btop); -+ h_inode = file_inode(h_file); -+ inode->i_mode = h_inode->i_mode; -+ ii_write_unlock(inode); -+ /* AuDbg("blks %llu, %llu\n", (u64)blks, (u64)h_inode->i_blocks); */ -+ if (written > 0) -+ au_fhsm_wrote(inode->i_sb, wpre->btop, -+ /*force*/h_inode->i_blocks > wpre->blks); -+ fput(h_file); -+} -+ -+static ssize_t aufs_read(struct file *file, char __user *buf, size_t count, -+ loff_t *ppos) -+{ -+ ssize_t err; -+ struct inode *inode; -+ struct file *h_file; -+ struct super_block *sb; -+ -+ inode = file_inode(file); -+ sb = inode->i_sb; -+ si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); -+ -+ h_file = au_read_pre(file, /*keep_fi*/0, /*lsc*/0); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ -+ /* filedata may be obsoleted by concurrent copyup, but no problem */ -+ err = vfsub_read_u(h_file, buf, count, ppos); -+ /* todo: necessary? */ -+ /* file->f_ra = h_file->f_ra; */ -+ au_read_post(inode, h_file); -+ -+out: -+ si_read_unlock(sb); -+ return err; -+} -+ -+/* -+ * todo: very ugly -+ * it locks both of i_mutex and si_rwsem for read in safe. -+ * if the plink maintenance mode continues forever (that is the problem), -+ * may loop forever. -+ */ -+static void au_mtx_and_read_lock(struct inode *inode) -+{ -+ int err; -+ struct super_block *sb = inode->i_sb; -+ -+ while (1) { -+ inode_lock(inode); -+ err = si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLM); -+ if (!err) -+ break; -+ inode_unlock(inode); -+ si_read_lock(sb, AuLock_NOPLMW); -+ si_read_unlock(sb); -+ } -+} -+ -+static ssize_t aufs_write(struct file *file, const char __user *ubuf, -+ size_t count, loff_t *ppos) -+{ -+ ssize_t err; -+ struct au_write_pre wpre; -+ struct inode *inode; -+ struct file *h_file; -+ char __user *buf = (char __user *)ubuf; -+ -+ inode = file_inode(file); -+ au_mtx_and_read_lock(inode); -+ -+ wpre.lsc = 0; -+ h_file = au_write_pre(file, /*do_ready*/1, &wpre); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ -+ err = vfsub_write_u(h_file, buf, count, ppos); -+ au_write_post(inode, h_file, &wpre, err); -+ -+out: -+ si_read_unlock(inode->i_sb); -+ inode_unlock(inode); -+ return err; -+} -+ -+static ssize_t au_do_iter(struct file *h_file, int rw, struct kiocb *kio, -+ struct iov_iter *iov_iter) -+{ -+ ssize_t err; -+ struct file *file; -+ ssize_t (*iter)(struct kiocb *, struct iov_iter *); -+ -+ err = security_file_permission(h_file, rw); -+ if (unlikely(err)) -+ goto out; -+ -+ err = -ENOSYS; -+ iter = NULL; -+ if (rw == MAY_READ) -+ iter = h_file->f_op->read_iter; -+ else if (rw == MAY_WRITE) -+ iter = h_file->f_op->write_iter; -+ -+ file = kio->ki_filp; -+ kio->ki_filp = h_file; -+ if (iter) { -+ lockdep_off(); -+ err = iter(kio, iov_iter); -+ lockdep_on(); -+ } else -+ /* currently there is no such fs */ -+ WARN_ON_ONCE(1); -+ kio->ki_filp = file; -+ -+out: -+ return err; -+} -+ -+static ssize_t aufs_read_iter(struct kiocb *kio, struct iov_iter *iov_iter) -+{ -+ ssize_t err; -+ struct file *file, *h_file; -+ struct inode *inode; -+ struct super_block *sb; -+ -+ file = kio->ki_filp; -+ inode = file_inode(file); -+ sb = inode->i_sb; -+ si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); -+ -+ h_file = au_read_pre(file, /*keep_fi*/1, /*lsc*/0); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ -+ if (au_test_loopback_kthread()) { -+ au_warn_loopback(h_file->f_path.dentry->d_sb); -+ if (file->f_mapping != h_file->f_mapping) { -+ file->f_mapping = h_file->f_mapping; -+ smp_mb(); /* unnecessary? */ -+ } -+ } -+ fi_read_unlock(file); -+ -+ err = au_do_iter(h_file, MAY_READ, kio, iov_iter); -+ /* todo: necessary? */ -+ /* file->f_ra = h_file->f_ra; */ -+ au_read_post(inode, h_file); -+ -+out: -+ si_read_unlock(sb); -+ return err; -+} -+ -+static ssize_t aufs_write_iter(struct kiocb *kio, struct iov_iter *iov_iter) -+{ -+ ssize_t err; -+ struct au_write_pre wpre; -+ struct inode *inode; -+ struct file *file, *h_file; -+ -+ file = kio->ki_filp; -+ inode = file_inode(file); -+ au_mtx_and_read_lock(inode); -+ -+ wpre.lsc = 0; -+ h_file = au_write_pre(file, /*do_ready*/1, &wpre); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ -+ err = au_do_iter(h_file, MAY_WRITE, kio, iov_iter); -+ au_write_post(inode, h_file, &wpre, err); -+ -+out: -+ si_read_unlock(inode->i_sb); -+ inode_unlock(inode); -+ return err; -+} -+ -+static ssize_t aufs_splice_read(struct file *file, loff_t *ppos, -+ struct pipe_inode_info *pipe, size_t len, -+ unsigned int flags) -+{ -+ ssize_t err; -+ struct file *h_file; -+ struct inode *inode; -+ struct super_block *sb; -+ -+ inode = file_inode(file); -+ sb = inode->i_sb; -+ si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); -+ -+ h_file = au_read_pre(file, /*keep_fi*/0, /*lsc*/0); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ -+ err = vfsub_splice_to(h_file, ppos, pipe, len, flags); -+ /* todo: necessasry? */ -+ /* file->f_ra = h_file->f_ra; */ -+ au_read_post(inode, h_file); -+ -+out: -+ si_read_unlock(sb); -+ return err; -+} -+ -+static ssize_t -+aufs_splice_write(struct pipe_inode_info *pipe, struct file *file, loff_t *ppos, -+ size_t len, unsigned int flags) -+{ -+ ssize_t err; -+ struct au_write_pre wpre; -+ struct inode *inode; -+ struct file *h_file; -+ -+ inode = file_inode(file); -+ au_mtx_and_read_lock(inode); -+ -+ wpre.lsc = 0; -+ h_file = au_write_pre(file, /*do_ready*/1, &wpre); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ -+ err = vfsub_splice_from(pipe, h_file, ppos, len, flags); -+ au_write_post(inode, h_file, &wpre, err); -+ -+out: -+ si_read_unlock(inode->i_sb); -+ inode_unlock(inode); -+ return err; -+} -+ -+static long aufs_fallocate(struct file *file, int mode, loff_t offset, -+ loff_t len) -+{ -+ long err; -+ struct au_write_pre wpre; -+ struct inode *inode; -+ struct file *h_file; -+ -+ inode = file_inode(file); -+ au_mtx_and_read_lock(inode); -+ -+ wpre.lsc = 0; -+ h_file = au_write_pre(file, /*do_ready*/1, &wpre); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ -+ lockdep_off(); -+ err = vfs_fallocate(h_file, mode, offset, len); -+ lockdep_on(); -+ au_write_post(inode, h_file, &wpre, /*written*/1); -+ -+out: -+ si_read_unlock(inode->i_sb); -+ inode_unlock(inode); -+ return err; -+} -+ -+static ssize_t aufs_copy_file_range(struct file *src, loff_t src_pos, -+ struct file *dst, loff_t dst_pos, -+ size_t len, unsigned int flags) -+{ -+ ssize_t err; -+ struct au_write_pre wpre; -+ enum { SRC, DST }; -+ struct { -+ struct inode *inode; -+ struct file *h_file; -+ struct super_block *h_sb; -+ } a[2]; -+#define a_src a[SRC] -+#define a_dst a[DST] -+ -+ err = -EINVAL; -+ a_src.inode = file_inode(src); -+ if (unlikely(!S_ISREG(a_src.inode->i_mode))) -+ goto out; -+ a_dst.inode = file_inode(dst); -+ if (unlikely(!S_ISREG(a_dst.inode->i_mode))) -+ goto out; -+ -+ au_mtx_and_read_lock(a_dst.inode); -+ /* -+ * in order to match the order in di_write_lock2_{child,parent}(), -+ * use f_path.dentry for this comparision. -+ */ -+ if (src->f_path.dentry < dst->f_path.dentry) { -+ a_src.h_file = au_read_pre(src, /*keep_fi*/1, AuLsc_FI_1); -+ err = PTR_ERR(a_src.h_file); -+ if (IS_ERR(a_src.h_file)) -+ goto out_si; -+ -+ wpre.lsc = AuLsc_FI_2; -+ a_dst.h_file = au_write_pre(dst, /*do_ready*/1, &wpre); -+ err = PTR_ERR(a_dst.h_file); -+ if (IS_ERR(a_dst.h_file)) { -+ au_read_post(a_src.inode, a_src.h_file); -+ goto out_si; -+ } -+ } else { -+ wpre.lsc = AuLsc_FI_1; -+ a_dst.h_file = au_write_pre(dst, /*do_ready*/1, &wpre); -+ err = PTR_ERR(a_dst.h_file); -+ if (IS_ERR(a_dst.h_file)) -+ goto out_si; -+ -+ a_src.h_file = au_read_pre(src, /*keep_fi*/1, AuLsc_FI_2); -+ err = PTR_ERR(a_src.h_file); -+ if (IS_ERR(a_src.h_file)) { -+ au_write_post(a_dst.inode, a_dst.h_file, &wpre, -+ /*written*/0); -+ goto out_si; -+ } -+ } -+ -+ err = -EXDEV; -+ a_src.h_sb = file_inode(a_src.h_file)->i_sb; -+ a_dst.h_sb = file_inode(a_dst.h_file)->i_sb; -+ if (unlikely(a_src.h_sb != a_dst.h_sb)) { -+ AuDbgFile(src); -+ AuDbgFile(dst); -+ goto out_file; -+ } -+ -+ err = vfsub_copy_file_range(a_src.h_file, src_pos, a_dst.h_file, -+ dst_pos, len, flags); -+ -+out_file: -+ au_write_post(a_dst.inode, a_dst.h_file, &wpre, err); -+ fi_read_unlock(src); -+ au_read_post(a_src.inode, a_src.h_file); -+out_si: -+ si_read_unlock(a_dst.inode->i_sb); -+ inode_unlock(a_dst.inode); -+out: -+ return err; -+#undef a_src -+#undef a_dst -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * The locking order around current->mmap_sem. -+ * - in most and regular cases -+ * file I/O syscall -- aufs_read() or something -+ * -- si_rwsem for read -- mmap_sem -+ * (Note that [fdi]i_rwsem are released before mmap_sem). -+ * - in mmap case -+ * mmap(2) -- mmap_sem -- aufs_mmap() -- si_rwsem for read -- [fdi]i_rwsem -+ * This AB-BA order is definitly bad, but is not a problem since "si_rwsem for -+ * read" allows muliple processes to acquire it and [fdi]i_rwsem are not held in -+ * file I/O. Aufs needs to stop lockdep in aufs_mmap() though. -+ * It means that when aufs acquires si_rwsem for write, the process should never -+ * acquire mmap_sem. -+ * -+ * Actually aufs_iterate() holds [fdi]i_rwsem before mmap_sem, but this is not a -+ * problem either since any directory is not able to be mmap-ed. -+ * The similar scenario is applied to aufs_readlink() too. -+ */ -+ -+#if 0 /* stop calling security_file_mmap() */ -+/* cf. linux/include/linux/mman.h: calc_vm_prot_bits() */ -+#define AuConv_VM_PROT(f, b) _calc_vm_trans(f, VM_##b, PROT_##b) -+ -+static unsigned long au_arch_prot_conv(unsigned long flags) -+{ -+ /* currently ppc64 only */ -+#ifdef CONFIG_PPC64 -+ /* cf. linux/arch/powerpc/include/asm/mman.h */ -+ AuDebugOn(arch_calc_vm_prot_bits(-1) != VM_SAO); -+ return AuConv_VM_PROT(flags, SAO); -+#else -+ AuDebugOn(arch_calc_vm_prot_bits(-1)); -+ return 0; -+#endif -+} -+ -+static unsigned long au_prot_conv(unsigned long flags) -+{ -+ return AuConv_VM_PROT(flags, READ) -+ | AuConv_VM_PROT(flags, WRITE) -+ | AuConv_VM_PROT(flags, EXEC) -+ | au_arch_prot_conv(flags); -+} -+ -+/* cf. linux/include/linux/mman.h: calc_vm_flag_bits() */ -+#define AuConv_VM_MAP(f, b) _calc_vm_trans(f, VM_##b, MAP_##b) -+ -+static unsigned long au_flag_conv(unsigned long flags) -+{ -+ return AuConv_VM_MAP(flags, GROWSDOWN) -+ | AuConv_VM_MAP(flags, DENYWRITE) -+ | AuConv_VM_MAP(flags, LOCKED); -+} -+#endif -+ -+static int aufs_mmap(struct file *file, struct vm_area_struct *vma) -+{ -+ int err; -+ const unsigned char wlock -+ = (file->f_mode & FMODE_WRITE) && (vma->vm_flags & VM_SHARED); -+ struct super_block *sb; -+ struct file *h_file; -+ struct inode *inode; -+ -+ AuDbgVmRegion(file, vma); -+ -+ inode = file_inode(file); -+ sb = inode->i_sb; -+ lockdep_off(); -+ si_read_lock(sb, AuLock_NOPLMW); -+ -+ h_file = au_write_pre(file, wlock, /*wpre*/NULL); -+ lockdep_on(); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ -+ err = 0; -+ au_set_mmapped(file); -+ au_vm_file_reset(vma, h_file); -+ /* -+ * we cannot call security_mmap_file() here since it may acquire -+ * mmap_sem or i_mutex. -+ * -+ * err = security_mmap_file(h_file, au_prot_conv(vma->vm_flags), -+ * au_flag_conv(vma->vm_flags)); -+ */ -+ if (!err) -+ err = call_mmap(h_file, vma); -+ if (!err) { -+ au_vm_prfile_set(vma, file); -+ fsstack_copy_attr_atime(inode, file_inode(h_file)); -+ goto out_fput; /* success */ -+ } -+ au_unset_mmapped(file); -+ au_vm_file_reset(vma, file); -+ -+out_fput: -+ lockdep_off(); -+ ii_write_unlock(inode); -+ lockdep_on(); -+ fput(h_file); -+out: -+ lockdep_off(); -+ si_read_unlock(sb); -+ lockdep_on(); -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int aufs_fsync_nondir(struct file *file, loff_t start, loff_t end, -+ int datasync) -+{ -+ int err; -+ struct au_write_pre wpre; -+ struct inode *inode; -+ struct file *h_file; -+ -+ err = 0; /* -EBADF; */ /* posix? */ -+ if (unlikely(!(file->f_mode & FMODE_WRITE))) -+ goto out; -+ -+ inode = file_inode(file); -+ au_mtx_and_read_lock(inode); -+ -+ wpre.lsc = 0; -+ h_file = au_write_pre(file, /*do_ready*/1, &wpre); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out_unlock; -+ -+ err = vfsub_fsync(h_file, &h_file->f_path, datasync); -+ au_write_post(inode, h_file, &wpre, /*written*/0); -+ -+out_unlock: -+ si_read_unlock(inode->i_sb); -+ inode_unlock(inode); -+out: -+ return err; -+} -+ -+static int aufs_fasync(int fd, struct file *file, int flag) -+{ -+ int err; -+ struct file *h_file; -+ struct super_block *sb; -+ -+ sb = file->f_path.dentry->d_sb; -+ si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); -+ -+ h_file = au_read_pre(file, /*keep_fi*/0, /*lsc*/0); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ -+ if (h_file->f_op->fasync) -+ err = h_file->f_op->fasync(fd, h_file, flag); -+ fput(h_file); /* instead of au_read_post() */ -+ -+out: -+ si_read_unlock(sb); -+ return err; -+} -+ -+static int aufs_setfl(struct file *file, unsigned long arg) -+{ -+ int err; -+ struct file *h_file; -+ struct super_block *sb; -+ -+ sb = file->f_path.dentry->d_sb; -+ si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); -+ -+ h_file = au_read_pre(file, /*keep_fi*/0, /*lsc*/0); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ -+ /* stop calling h_file->fasync */ -+ arg |= vfsub_file_flags(file) & FASYNC; -+ err = setfl(/*unused fd*/-1, h_file, arg); -+ fput(h_file); /* instead of au_read_post() */ -+ -+out: -+ si_read_unlock(sb); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* no one supports this operation, currently */ -+#if 0 -+static ssize_t aufs_sendpage(struct file *file, struct page *page, int offset, -+ size_t len, loff_t *pos, int more) -+{ -+} -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+const struct file_operations aufs_file_fop = { -+ .owner = THIS_MODULE, -+ -+ .llseek = default_llseek, -+ -+ .read = aufs_read, -+ .write = aufs_write, -+ .read_iter = aufs_read_iter, -+ .write_iter = aufs_write_iter, -+ -+#ifdef CONFIG_AUFS_POLL -+ .poll = aufs_poll, -+#endif -+ .unlocked_ioctl = aufs_ioctl_nondir, -+#ifdef CONFIG_COMPAT -+ .compat_ioctl = aufs_compat_ioctl_nondir, -+#endif -+ .mmap = aufs_mmap, -+ .open = aufs_open_nondir, -+ .flush = aufs_flush_nondir, -+ .release = aufs_release_nondir, -+ .fsync = aufs_fsync_nondir, -+ .fasync = aufs_fasync, -+ /* .sendpage = aufs_sendpage, */ -+ .setfl = aufs_setfl, -+ .splice_write = aufs_splice_write, -+ .splice_read = aufs_splice_read, -+#if 0 -+ .aio_splice_write = aufs_aio_splice_write, -+ .aio_splice_read = aufs_aio_splice_read, -+#endif -+ .fallocate = aufs_fallocate, -+ .copy_file_range = aufs_copy_file_range -+}; -diff --git a/fs/aufs/fhsm.c b/fs/aufs/fhsm.c -new file mode 100644 -index 000000000000..c55abb1b846f ---- /dev/null -+++ b/fs/aufs/fhsm.c -@@ -0,0 +1,413 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2011-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * File-based Hierarchy Storage Management -+ */ -+ -+#include -+#include -+#include -+#include -+#include "aufs.h" -+ -+static aufs_bindex_t au_fhsm_bottom(struct super_block *sb) -+{ -+ struct au_sbinfo *sbinfo; -+ struct au_fhsm *fhsm; -+ -+ SiMustAnyLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ fhsm = &sbinfo->si_fhsm; -+ AuDebugOn(!fhsm); -+ return fhsm->fhsm_bottom; -+} -+ -+void au_fhsm_set_bottom(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ struct au_sbinfo *sbinfo; -+ struct au_fhsm *fhsm; -+ -+ SiMustWriteLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ fhsm = &sbinfo->si_fhsm; -+ AuDebugOn(!fhsm); -+ fhsm->fhsm_bottom = bindex; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_fhsm_test_jiffy(struct au_sbinfo *sbinfo, struct au_branch *br) -+{ -+ struct au_br_fhsm *bf; -+ -+ bf = br->br_fhsm; -+ MtxMustLock(&bf->bf_lock); -+ -+ return !bf->bf_readable -+ || time_after(jiffies, -+ bf->bf_jiffy + sbinfo->si_fhsm.fhsm_expire); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static void au_fhsm_notify(struct super_block *sb, int val) -+{ -+ struct au_sbinfo *sbinfo; -+ struct au_fhsm *fhsm; -+ -+ SiMustAnyLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ fhsm = &sbinfo->si_fhsm; -+ if (au_fhsm_pid(fhsm) -+ && atomic_read(&fhsm->fhsm_readable) != -1) { -+ atomic_set(&fhsm->fhsm_readable, val); -+ if (val) -+ wake_up(&fhsm->fhsm_wqh); -+ } -+} -+ -+static int au_fhsm_stfs(struct super_block *sb, aufs_bindex_t bindex, -+ struct aufs_stfs *rstfs, int do_lock, int do_notify) -+{ -+ int err; -+ struct au_branch *br; -+ struct au_br_fhsm *bf; -+ -+ br = au_sbr(sb, bindex); -+ AuDebugOn(au_br_rdonly(br)); -+ bf = br->br_fhsm; -+ AuDebugOn(!bf); -+ -+ if (do_lock) -+ mutex_lock(&bf->bf_lock); -+ else -+ MtxMustLock(&bf->bf_lock); -+ -+ /* sb->s_root for NFS is unreliable */ -+ err = au_br_stfs(br, &bf->bf_stfs); -+ if (unlikely(err)) { -+ AuErr1("FHSM failed (%d), b%d, ignored.\n", bindex, err); -+ goto out; -+ } -+ -+ bf->bf_jiffy = jiffies; -+ bf->bf_readable = 1; -+ if (do_notify) -+ au_fhsm_notify(sb, /*val*/1); -+ if (rstfs) -+ *rstfs = bf->bf_stfs; -+ -+out: -+ if (do_lock) -+ mutex_unlock(&bf->bf_lock); -+ au_fhsm_notify(sb, /*val*/1); -+ -+ return err; -+} -+ -+void au_fhsm_wrote(struct super_block *sb, aufs_bindex_t bindex, int force) -+{ -+ int err; -+ struct au_sbinfo *sbinfo; -+ struct au_fhsm *fhsm; -+ struct au_branch *br; -+ struct au_br_fhsm *bf; -+ -+ AuDbg("b%d, force %d\n", bindex, force); -+ SiMustAnyLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ fhsm = &sbinfo->si_fhsm; -+ if (!au_ftest_si(sbinfo, FHSM) -+ || fhsm->fhsm_bottom == bindex) -+ return; -+ -+ br = au_sbr(sb, bindex); -+ bf = br->br_fhsm; -+ AuDebugOn(!bf); -+ mutex_lock(&bf->bf_lock); -+ if (force -+ || au_fhsm_pid(fhsm) -+ || au_fhsm_test_jiffy(sbinfo, br)) -+ err = au_fhsm_stfs(sb, bindex, /*rstfs*/NULL, /*do_lock*/0, -+ /*do_notify*/1); -+ mutex_unlock(&bf->bf_lock); -+} -+ -+void au_fhsm_wrote_all(struct super_block *sb, int force) -+{ -+ aufs_bindex_t bindex, bbot; -+ struct au_branch *br; -+ -+ /* exclude the bottom */ -+ bbot = au_fhsm_bottom(sb); -+ for (bindex = 0; bindex < bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ if (au_br_fhsm(br->br_perm)) -+ au_fhsm_wrote(sb, bindex, force); -+ } -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static unsigned int au_fhsm_poll(struct file *file, -+ struct poll_table_struct *wait) -+{ -+ unsigned int mask; -+ struct au_sbinfo *sbinfo; -+ struct au_fhsm *fhsm; -+ -+ mask = 0; -+ sbinfo = file->private_data; -+ fhsm = &sbinfo->si_fhsm; -+ poll_wait(file, &fhsm->fhsm_wqh, wait); -+ if (atomic_read(&fhsm->fhsm_readable)) -+ mask = POLLIN /* | POLLRDNORM */; -+ -+ AuTraceErr((int)mask); -+ return mask; -+} -+ -+static int au_fhsm_do_read_one(struct aufs_stbr __user *stbr, -+ struct aufs_stfs *stfs, __s16 brid) -+{ -+ int err; -+ -+ err = copy_to_user(&stbr->stfs, stfs, sizeof(*stfs)); -+ if (!err) -+ err = __put_user(brid, &stbr->brid); -+ if (unlikely(err)) -+ err = -EFAULT; -+ -+ return err; -+} -+ -+static ssize_t au_fhsm_do_read(struct super_block *sb, -+ struct aufs_stbr __user *stbr, size_t count) -+{ -+ ssize_t err; -+ int nstbr; -+ aufs_bindex_t bindex, bbot; -+ struct au_branch *br; -+ struct au_br_fhsm *bf; -+ -+ /* except the bottom branch */ -+ err = 0; -+ nstbr = 0; -+ bbot = au_fhsm_bottom(sb); -+ for (bindex = 0; !err && bindex < bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ if (!au_br_fhsm(br->br_perm)) -+ continue; -+ -+ bf = br->br_fhsm; -+ mutex_lock(&bf->bf_lock); -+ if (bf->bf_readable) { -+ err = -EFAULT; -+ if (count >= sizeof(*stbr)) -+ err = au_fhsm_do_read_one(stbr++, &bf->bf_stfs, -+ br->br_id); -+ if (!err) { -+ bf->bf_readable = 0; -+ count -= sizeof(*stbr); -+ nstbr++; -+ } -+ } -+ mutex_unlock(&bf->bf_lock); -+ } -+ if (!err) -+ err = sizeof(*stbr) * nstbr; -+ -+ return err; -+} -+ -+static ssize_t au_fhsm_read(struct file *file, char __user *buf, size_t count, -+ loff_t *pos) -+{ -+ ssize_t err; -+ int readable; -+ aufs_bindex_t nfhsm, bindex, bbot; -+ struct au_sbinfo *sbinfo; -+ struct au_fhsm *fhsm; -+ struct au_branch *br; -+ struct super_block *sb; -+ -+ err = 0; -+ sbinfo = file->private_data; -+ fhsm = &sbinfo->si_fhsm; -+need_data: -+ spin_lock_irq(&fhsm->fhsm_wqh.lock); -+ if (!atomic_read(&fhsm->fhsm_readable)) { -+ if (vfsub_file_flags(file) & O_NONBLOCK) -+ err = -EAGAIN; -+ else -+ err = wait_event_interruptible_locked_irq -+ (fhsm->fhsm_wqh, -+ atomic_read(&fhsm->fhsm_readable)); -+ } -+ spin_unlock_irq(&fhsm->fhsm_wqh.lock); -+ if (unlikely(err)) -+ goto out; -+ -+ /* sb may already be dead */ -+ au_rw_read_lock(&sbinfo->si_rwsem); -+ readable = atomic_read(&fhsm->fhsm_readable); -+ if (readable > 0) { -+ sb = sbinfo->si_sb; -+ AuDebugOn(!sb); -+ /* exclude the bottom branch */ -+ nfhsm = 0; -+ bbot = au_fhsm_bottom(sb); -+ for (bindex = 0; bindex < bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ if (au_br_fhsm(br->br_perm)) -+ nfhsm++; -+ } -+ err = -EMSGSIZE; -+ if (nfhsm * sizeof(struct aufs_stbr) <= count) { -+ atomic_set(&fhsm->fhsm_readable, 0); -+ err = au_fhsm_do_read(sbinfo->si_sb, (void __user *)buf, -+ count); -+ } -+ } -+ au_rw_read_unlock(&sbinfo->si_rwsem); -+ if (!readable) -+ goto need_data; -+ -+out: -+ return err; -+} -+ -+static int au_fhsm_release(struct inode *inode, struct file *file) -+{ -+ struct au_sbinfo *sbinfo; -+ struct au_fhsm *fhsm; -+ -+ /* sb may already be dead */ -+ sbinfo = file->private_data; -+ fhsm = &sbinfo->si_fhsm; -+ spin_lock(&fhsm->fhsm_spin); -+ fhsm->fhsm_pid = 0; -+ spin_unlock(&fhsm->fhsm_spin); -+ kobject_put(&sbinfo->si_kobj); -+ -+ return 0; -+} -+ -+static const struct file_operations au_fhsm_fops = { -+ .owner = THIS_MODULE, -+ .llseek = noop_llseek, -+ .read = au_fhsm_read, -+ .poll = au_fhsm_poll, -+ .release = au_fhsm_release -+}; -+ -+int au_fhsm_fd(struct super_block *sb, int oflags) -+{ -+ int err, fd; -+ struct au_sbinfo *sbinfo; -+ struct au_fhsm *fhsm; -+ -+ err = -EPERM; -+ if (unlikely(!capable(CAP_SYS_ADMIN))) -+ goto out; -+ -+ err = -EINVAL; -+ if (unlikely(oflags & ~(O_CLOEXEC | O_NONBLOCK))) -+ goto out; -+ -+ err = 0; -+ sbinfo = au_sbi(sb); -+ fhsm = &sbinfo->si_fhsm; -+ spin_lock(&fhsm->fhsm_spin); -+ if (!fhsm->fhsm_pid) -+ fhsm->fhsm_pid = current->pid; -+ else -+ err = -EBUSY; -+ spin_unlock(&fhsm->fhsm_spin); -+ if (unlikely(err)) -+ goto out; -+ -+ oflags |= O_RDONLY; -+ /* oflags |= FMODE_NONOTIFY; */ -+ fd = anon_inode_getfd("[aufs_fhsm]", &au_fhsm_fops, sbinfo, oflags); -+ err = fd; -+ if (unlikely(fd < 0)) -+ goto out_pid; -+ -+ /* succeed reglardless 'fhsm' status */ -+ kobject_get(&sbinfo->si_kobj); -+ si_noflush_read_lock(sb); -+ if (au_ftest_si(sbinfo, FHSM)) -+ au_fhsm_wrote_all(sb, /*force*/0); -+ si_read_unlock(sb); -+ goto out; /* success */ -+ -+out_pid: -+ spin_lock(&fhsm->fhsm_spin); -+ fhsm->fhsm_pid = 0; -+ spin_unlock(&fhsm->fhsm_spin); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int au_fhsm_br_alloc(struct au_branch *br) -+{ -+ int err; -+ -+ err = 0; -+ br->br_fhsm = kmalloc(sizeof(*br->br_fhsm), GFP_NOFS); -+ if (br->br_fhsm) -+ au_br_fhsm_init(br->br_fhsm); -+ else -+ err = -ENOMEM; -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void au_fhsm_fin(struct super_block *sb) -+{ -+ au_fhsm_notify(sb, /*val*/-1); -+} -+ -+void au_fhsm_init(struct au_sbinfo *sbinfo) -+{ -+ struct au_fhsm *fhsm; -+ -+ fhsm = &sbinfo->si_fhsm; -+ spin_lock_init(&fhsm->fhsm_spin); -+ init_waitqueue_head(&fhsm->fhsm_wqh); -+ atomic_set(&fhsm->fhsm_readable, 0); -+ fhsm->fhsm_expire -+ = msecs_to_jiffies(AUFS_FHSM_CACHE_DEF_SEC * MSEC_PER_SEC); -+ fhsm->fhsm_bottom = -1; -+} -+ -+void au_fhsm_set(struct au_sbinfo *sbinfo, unsigned int sec) -+{ -+ sbinfo->si_fhsm.fhsm_expire -+ = msecs_to_jiffies(sec * MSEC_PER_SEC); -+} -+ -+void au_fhsm_show(struct seq_file *seq, struct au_sbinfo *sbinfo) -+{ -+ unsigned int u; -+ -+ if (!au_ftest_si(sbinfo, FHSM)) -+ return; -+ -+ u = jiffies_to_msecs(sbinfo->si_fhsm.fhsm_expire) / MSEC_PER_SEC; -+ if (u != AUFS_FHSM_CACHE_DEF_SEC) -+ seq_printf(seq, ",fhsm_sec=%u", u); -+} -diff --git a/fs/aufs/file.c b/fs/aufs/file.c -new file mode 100644 -index 000000000000..83e69022c64c ---- /dev/null -+++ b/fs/aufs/file.c -@@ -0,0 +1,844 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * handling file/dir, and address_space operation -+ */ -+ -+#ifdef CONFIG_AUFS_DEBUG -+#include -+#endif -+#include -+#include "aufs.h" -+ -+/* drop flags for writing */ -+unsigned int au_file_roflags(unsigned int flags) -+{ -+ flags &= ~(O_WRONLY | O_RDWR | O_APPEND | O_CREAT | O_TRUNC); -+ flags |= O_RDONLY | O_NOATIME; -+ return flags; -+} -+ -+/* common functions to regular file and dir */ -+struct file *au_h_open(struct dentry *dentry, aufs_bindex_t bindex, int flags, -+ struct file *file, int force_wr) -+{ -+ struct file *h_file; -+ struct dentry *h_dentry; -+ struct inode *h_inode; -+ struct super_block *sb; -+ struct au_branch *br; -+ struct path h_path; -+ int err; -+ -+ /* a race condition can happen between open and unlink/rmdir */ -+ h_file = ERR_PTR(-ENOENT); -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (au_test_nfsd() && (!h_dentry || d_is_negative(h_dentry))) -+ goto out; -+ h_inode = d_inode(h_dentry); -+ spin_lock(&h_dentry->d_lock); -+ err = (!d_unhashed(dentry) && d_unlinked(h_dentry)) -+ /* || !d_inode(dentry)->i_nlink */ -+ ; -+ spin_unlock(&h_dentry->d_lock); -+ if (unlikely(err)) -+ goto out; -+ -+ sb = dentry->d_sb; -+ br = au_sbr(sb, bindex); -+ err = au_br_test_oflag(flags, br); -+ h_file = ERR_PTR(err); -+ if (unlikely(err)) -+ goto out; -+ -+ /* drop flags for writing */ -+ if (au_test_ro(sb, bindex, d_inode(dentry))) { -+ if (force_wr && !(flags & O_WRONLY)) -+ force_wr = 0; -+ flags = au_file_roflags(flags); -+ if (force_wr) { -+ h_file = ERR_PTR(-EROFS); -+ flags = au_file_roflags(flags); -+ if (unlikely(vfsub_native_ro(h_inode) -+ || IS_APPEND(h_inode))) -+ goto out; -+ flags &= ~O_ACCMODE; -+ flags |= O_WRONLY; -+ } -+ } -+ flags &= ~O_CREAT; -+ au_br_get(br); -+ h_path.dentry = h_dentry; -+ h_path.mnt = au_br_mnt(br); -+ h_file = vfsub_dentry_open(&h_path, flags); -+ if (IS_ERR(h_file)) -+ goto out_br; -+ -+ if (flags & __FMODE_EXEC) { -+ err = deny_write_access(h_file); -+ if (unlikely(err)) { -+ fput(h_file); -+ h_file = ERR_PTR(err); -+ goto out_br; -+ } -+ } -+ fsnotify_open(h_file); -+ goto out; /* success */ -+ -+out_br: -+ au_br_put(br); -+out: -+ return h_file; -+} -+ -+static int au_cmoo(struct dentry *dentry) -+{ -+ int err, cmoo, matched; -+ unsigned int udba; -+ struct path h_path; -+ struct au_pin pin; -+ struct au_cp_generic cpg = { -+ .dentry = dentry, -+ .bdst = -1, -+ .bsrc = -1, -+ .len = -1, -+ .pin = &pin, -+ .flags = AuCpup_DTIME | AuCpup_HOPEN -+ }; -+ struct inode *delegated; -+ struct super_block *sb; -+ struct au_sbinfo *sbinfo; -+ struct au_fhsm *fhsm; -+ pid_t pid; -+ struct au_branch *br; -+ struct dentry *parent; -+ struct au_hinode *hdir; -+ -+ DiMustWriteLock(dentry); -+ IiMustWriteLock(d_inode(dentry)); -+ -+ err = 0; -+ if (IS_ROOT(dentry)) -+ goto out; -+ cpg.bsrc = au_dbtop(dentry); -+ if (!cpg.bsrc) -+ goto out; -+ -+ sb = dentry->d_sb; -+ sbinfo = au_sbi(sb); -+ fhsm = &sbinfo->si_fhsm; -+ pid = au_fhsm_pid(fhsm); -+ rcu_read_lock(); -+ matched = (pid -+ && (current->pid == pid -+ || rcu_dereference(current->real_parent)->pid == pid)); -+ rcu_read_unlock(); -+ if (matched) -+ goto out; -+ -+ br = au_sbr(sb, cpg.bsrc); -+ cmoo = au_br_cmoo(br->br_perm); -+ if (!cmoo) -+ goto out; -+ if (!d_is_reg(dentry)) -+ cmoo &= AuBrAttr_COO_ALL; -+ if (!cmoo) -+ goto out; -+ -+ parent = dget_parent(dentry); -+ di_write_lock_parent(parent); -+ err = au_wbr_do_copyup_bu(dentry, cpg.bsrc - 1); -+ cpg.bdst = err; -+ if (unlikely(err < 0)) { -+ err = 0; /* there is no upper writable branch */ -+ goto out_dgrade; -+ } -+ AuDbg("bsrc %d, bdst %d\n", cpg.bsrc, cpg.bdst); -+ -+ /* do not respect the coo attrib for the target branch */ -+ err = au_cpup_dirs(dentry, cpg.bdst); -+ if (unlikely(err)) -+ goto out_dgrade; -+ -+ di_downgrade_lock(parent, AuLock_IR); -+ udba = au_opt_udba(sb); -+ err = au_pin(&pin, dentry, cpg.bdst, udba, -+ AuPin_DI_LOCKED | AuPin_MNT_WRITE); -+ if (unlikely(err)) -+ goto out_parent; -+ -+ err = au_sio_cpup_simple(&cpg); -+ au_unpin(&pin); -+ if (unlikely(err)) -+ goto out_parent; -+ if (!(cmoo & AuBrWAttr_MOO)) -+ goto out_parent; /* success */ -+ -+ err = au_pin(&pin, dentry, cpg.bsrc, udba, -+ AuPin_DI_LOCKED | AuPin_MNT_WRITE); -+ if (unlikely(err)) -+ goto out_parent; -+ -+ h_path.mnt = au_br_mnt(br); -+ h_path.dentry = au_h_dptr(dentry, cpg.bsrc); -+ hdir = au_hi(d_inode(parent), cpg.bsrc); -+ delegated = NULL; -+ err = vfsub_unlink(hdir->hi_inode, &h_path, &delegated, /*force*/1); -+ au_unpin(&pin); -+ /* todo: keep h_dentry or not? */ -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal unlink\n"); -+ iput(delegated); -+ } -+ if (unlikely(err)) { -+ pr_err("unlink %pd after coo failed (%d), ignored\n", -+ dentry, err); -+ err = 0; -+ } -+ goto out_parent; /* success */ -+ -+out_dgrade: -+ di_downgrade_lock(parent, AuLock_IR); -+out_parent: -+ di_read_unlock(parent, AuLock_IR); -+ dput(parent); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+int au_do_open(struct file *file, struct au_do_open_args *args) -+{ -+ int err, aopen = args->aopen; -+ struct dentry *dentry; -+ struct au_finfo *finfo; -+ -+ if (!aopen) -+ err = au_finfo_init(file, args->fidir); -+ else { -+ lockdep_off(); -+ err = au_finfo_init(file, args->fidir); -+ lockdep_on(); -+ } -+ if (unlikely(err)) -+ goto out; -+ -+ dentry = file->f_path.dentry; -+ AuDebugOn(IS_ERR_OR_NULL(dentry)); -+ di_write_lock_child(dentry); -+ err = au_cmoo(dentry); -+ di_downgrade_lock(dentry, AuLock_IR); -+ if (!err) { -+ if (!aopen) -+ err = args->open(file, vfsub_file_flags(file), NULL); -+ else { -+ lockdep_off(); -+ err = args->open(file, vfsub_file_flags(file), NULL); -+ lockdep_on(); -+ } -+ } -+ di_read_unlock(dentry, AuLock_IR); -+ -+ finfo = au_fi(file); -+ if (!err) { -+ finfo->fi_file = file; -+ au_hbl_add(&finfo->fi_hlist, -+ &au_sbi(file->f_path.dentry->d_sb)->si_files); -+ } -+ if (!aopen) -+ fi_write_unlock(file); -+ else { -+ lockdep_off(); -+ fi_write_unlock(file); -+ lockdep_on(); -+ } -+ if (unlikely(err)) { -+ finfo->fi_hdir = NULL; -+ au_finfo_fin(file); -+ } -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+int au_reopen_nondir(struct file *file) -+{ -+ int err; -+ aufs_bindex_t btop; -+ struct dentry *dentry; -+ struct file *h_file, *h_file_tmp; -+ -+ dentry = file->f_path.dentry; -+ btop = au_dbtop(dentry); -+ h_file_tmp = NULL; -+ if (au_fbtop(file) == btop) { -+ h_file = au_hf_top(file); -+ if (file->f_mode == h_file->f_mode) -+ return 0; /* success */ -+ h_file_tmp = h_file; -+ get_file(h_file_tmp); -+ au_set_h_fptr(file, btop, NULL); -+ } -+ AuDebugOn(au_fi(file)->fi_hdir); -+ /* -+ * it can happen -+ * file exists on both of rw and ro -+ * open --> dbtop and fbtop are both 0 -+ * prepend a branch as rw, "rw" become ro -+ * remove rw/file -+ * delete the top branch, "rw" becomes rw again -+ * --> dbtop is 1, fbtop is still 0 -+ * write --> fbtop is 0 but dbtop is 1 -+ */ -+ /* AuDebugOn(au_fbtop(file) < btop); */ -+ -+ h_file = au_h_open(dentry, btop, vfsub_file_flags(file) & ~O_TRUNC, -+ file, /*force_wr*/0); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) { -+ if (h_file_tmp) { -+ au_sbr_get(dentry->d_sb, btop); -+ au_set_h_fptr(file, btop, h_file_tmp); -+ h_file_tmp = NULL; -+ } -+ goto out; /* todo: close all? */ -+ } -+ -+ err = 0; -+ au_set_fbtop(file, btop); -+ au_set_h_fptr(file, btop, h_file); -+ au_update_figen(file); -+ /* todo: necessary? */ -+ /* file->f_ra = h_file->f_ra; */ -+ -+out: -+ if (h_file_tmp) -+ fput(h_file_tmp); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_reopen_wh(struct file *file, aufs_bindex_t btgt, -+ struct dentry *hi_wh) -+{ -+ int err; -+ aufs_bindex_t btop; -+ struct au_dinfo *dinfo; -+ struct dentry *h_dentry; -+ struct au_hdentry *hdp; -+ -+ dinfo = au_di(file->f_path.dentry); -+ AuRwMustWriteLock(&dinfo->di_rwsem); -+ -+ btop = dinfo->di_btop; -+ dinfo->di_btop = btgt; -+ hdp = au_hdentry(dinfo, btgt); -+ h_dentry = hdp->hd_dentry; -+ hdp->hd_dentry = hi_wh; -+ err = au_reopen_nondir(file); -+ hdp->hd_dentry = h_dentry; -+ dinfo->di_btop = btop; -+ -+ return err; -+} -+ -+static int au_ready_to_write_wh(struct file *file, loff_t len, -+ aufs_bindex_t bcpup, struct au_pin *pin) -+{ -+ int err; -+ struct inode *inode, *h_inode; -+ struct dentry *h_dentry, *hi_wh; -+ struct au_cp_generic cpg = { -+ .dentry = file->f_path.dentry, -+ .bdst = bcpup, -+ .bsrc = -1, -+ .len = len, -+ .pin = pin -+ }; -+ -+ au_update_dbtop(cpg.dentry); -+ inode = d_inode(cpg.dentry); -+ h_inode = NULL; -+ if (au_dbtop(cpg.dentry) <= bcpup -+ && au_dbbot(cpg.dentry) >= bcpup) { -+ h_dentry = au_h_dptr(cpg.dentry, bcpup); -+ if (h_dentry && d_is_positive(h_dentry)) -+ h_inode = d_inode(h_dentry); -+ } -+ hi_wh = au_hi_wh(inode, bcpup); -+ if (!hi_wh && !h_inode) -+ err = au_sio_cpup_wh(&cpg, file); -+ else -+ /* already copied-up after unlink */ -+ err = au_reopen_wh(file, bcpup, hi_wh); -+ -+ if (!err -+ && (inode->i_nlink > 1 -+ || (inode->i_state & I_LINKABLE)) -+ && au_opt_test(au_mntflags(cpg.dentry->d_sb), PLINK)) -+ au_plink_append(inode, bcpup, au_h_dptr(cpg.dentry, bcpup)); -+ -+ return err; -+} -+ -+/* -+ * prepare the @file for writing. -+ */ -+int au_ready_to_write(struct file *file, loff_t len, struct au_pin *pin) -+{ -+ int err; -+ aufs_bindex_t dbtop; -+ struct dentry *parent; -+ struct inode *inode; -+ struct super_block *sb; -+ struct file *h_file; -+ struct au_cp_generic cpg = { -+ .dentry = file->f_path.dentry, -+ .bdst = -1, -+ .bsrc = -1, -+ .len = len, -+ .pin = pin, -+ .flags = AuCpup_DTIME -+ }; -+ -+ sb = cpg.dentry->d_sb; -+ inode = d_inode(cpg.dentry); -+ cpg.bsrc = au_fbtop(file); -+ err = au_test_ro(sb, cpg.bsrc, inode); -+ if (!err && (au_hf_top(file)->f_mode & FMODE_WRITE)) { -+ err = au_pin(pin, cpg.dentry, cpg.bsrc, AuOpt_UDBA_NONE, -+ /*flags*/0); -+ goto out; -+ } -+ -+ /* need to cpup or reopen */ -+ parent = dget_parent(cpg.dentry); -+ di_write_lock_parent(parent); -+ err = AuWbrCopyup(au_sbi(sb), cpg.dentry); -+ cpg.bdst = err; -+ if (unlikely(err < 0)) -+ goto out_dgrade; -+ err = 0; -+ -+ if (!d_unhashed(cpg.dentry) && !au_h_dptr(parent, cpg.bdst)) { -+ err = au_cpup_dirs(cpg.dentry, cpg.bdst); -+ if (unlikely(err)) -+ goto out_dgrade; -+ } -+ -+ err = au_pin(pin, cpg.dentry, cpg.bdst, AuOpt_UDBA_NONE, -+ AuPin_DI_LOCKED | AuPin_MNT_WRITE); -+ if (unlikely(err)) -+ goto out_dgrade; -+ -+ dbtop = au_dbtop(cpg.dentry); -+ if (dbtop <= cpg.bdst) -+ cpg.bsrc = cpg.bdst; -+ -+ if (dbtop <= cpg.bdst /* just reopen */ -+ || !d_unhashed(cpg.dentry) /* copyup and reopen */ -+ ) { -+ h_file = au_h_open_pre(cpg.dentry, cpg.bsrc, /*force_wr*/0); -+ if (IS_ERR(h_file)) -+ err = PTR_ERR(h_file); -+ else { -+ di_downgrade_lock(parent, AuLock_IR); -+ if (dbtop > cpg.bdst) -+ err = au_sio_cpup_simple(&cpg); -+ if (!err) -+ err = au_reopen_nondir(file); -+ au_h_open_post(cpg.dentry, cpg.bsrc, h_file); -+ } -+ } else { /* copyup as wh and reopen */ -+ /* -+ * since writable hfsplus branch is not supported, -+ * h_open_pre/post() are unnecessary. -+ */ -+ err = au_ready_to_write_wh(file, len, cpg.bdst, pin); -+ di_downgrade_lock(parent, AuLock_IR); -+ } -+ -+ if (!err) { -+ au_pin_set_parent_lflag(pin, /*lflag*/0); -+ goto out_dput; /* success */ -+ } -+ au_unpin(pin); -+ goto out_unlock; -+ -+out_dgrade: -+ di_downgrade_lock(parent, AuLock_IR); -+out_unlock: -+ di_read_unlock(parent, AuLock_IR); -+out_dput: -+ dput(parent); -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int au_do_flush(struct file *file, fl_owner_t id, -+ int (*flush)(struct file *file, fl_owner_t id)) -+{ -+ int err; -+ struct super_block *sb; -+ struct inode *inode; -+ -+ inode = file_inode(file); -+ sb = inode->i_sb; -+ si_noflush_read_lock(sb); -+ fi_read_lock(file); -+ ii_read_lock_child(inode); -+ -+ err = flush(file, id); -+ au_cpup_attr_timesizes(inode); -+ -+ ii_read_unlock(inode); -+ fi_read_unlock(file); -+ si_read_unlock(sb); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_file_refresh_by_inode(struct file *file, int *need_reopen) -+{ -+ int err; -+ struct au_pin pin; -+ struct au_finfo *finfo; -+ struct dentry *parent, *hi_wh; -+ struct inode *inode; -+ struct super_block *sb; -+ struct au_cp_generic cpg = { -+ .dentry = file->f_path.dentry, -+ .bdst = -1, -+ .bsrc = -1, -+ .len = -1, -+ .pin = &pin, -+ .flags = AuCpup_DTIME -+ }; -+ -+ FiMustWriteLock(file); -+ -+ err = 0; -+ finfo = au_fi(file); -+ sb = cpg.dentry->d_sb; -+ inode = d_inode(cpg.dentry); -+ cpg.bdst = au_ibtop(inode); -+ if (cpg.bdst == finfo->fi_btop || IS_ROOT(cpg.dentry)) -+ goto out; -+ -+ parent = dget_parent(cpg.dentry); -+ if (au_test_ro(sb, cpg.bdst, inode)) { -+ di_read_lock_parent(parent, !AuLock_IR); -+ err = AuWbrCopyup(au_sbi(sb), cpg.dentry); -+ cpg.bdst = err; -+ di_read_unlock(parent, !AuLock_IR); -+ if (unlikely(err < 0)) -+ goto out_parent; -+ err = 0; -+ } -+ -+ di_read_lock_parent(parent, AuLock_IR); -+ hi_wh = au_hi_wh(inode, cpg.bdst); -+ if (!S_ISDIR(inode->i_mode) -+ && au_opt_test(au_mntflags(sb), PLINK) -+ && au_plink_test(inode) -+ && !d_unhashed(cpg.dentry) -+ && cpg.bdst < au_dbtop(cpg.dentry)) { -+ err = au_test_and_cpup_dirs(cpg.dentry, cpg.bdst); -+ if (unlikely(err)) -+ goto out_unlock; -+ -+ /* always superio. */ -+ err = au_pin(&pin, cpg.dentry, cpg.bdst, AuOpt_UDBA_NONE, -+ AuPin_DI_LOCKED | AuPin_MNT_WRITE); -+ if (!err) { -+ err = au_sio_cpup_simple(&cpg); -+ au_unpin(&pin); -+ } -+ } else if (hi_wh) { -+ /* already copied-up after unlink */ -+ err = au_reopen_wh(file, cpg.bdst, hi_wh); -+ *need_reopen = 0; -+ } -+ -+out_unlock: -+ di_read_unlock(parent, AuLock_IR); -+out_parent: -+ dput(parent); -+out: -+ return err; -+} -+ -+static void au_do_refresh_dir(struct file *file) -+{ -+ aufs_bindex_t bindex, bbot, new_bindex, brid; -+ struct au_hfile *p, tmp, *q; -+ struct au_finfo *finfo; -+ struct super_block *sb; -+ struct au_fidir *fidir; -+ -+ FiMustWriteLock(file); -+ -+ sb = file->f_path.dentry->d_sb; -+ finfo = au_fi(file); -+ fidir = finfo->fi_hdir; -+ AuDebugOn(!fidir); -+ p = fidir->fd_hfile + finfo->fi_btop; -+ brid = p->hf_br->br_id; -+ bbot = fidir->fd_bbot; -+ for (bindex = finfo->fi_btop; bindex <= bbot; bindex++, p++) { -+ if (!p->hf_file) -+ continue; -+ -+ new_bindex = au_br_index(sb, p->hf_br->br_id); -+ if (new_bindex == bindex) -+ continue; -+ if (new_bindex < 0) { -+ au_set_h_fptr(file, bindex, NULL); -+ continue; -+ } -+ -+ /* swap two lower inode, and loop again */ -+ q = fidir->fd_hfile + new_bindex; -+ tmp = *q; -+ *q = *p; -+ *p = tmp; -+ if (tmp.hf_file) { -+ bindex--; -+ p--; -+ } -+ } -+ -+ p = fidir->fd_hfile; -+ if (!au_test_mmapped(file) && !d_unlinked(file->f_path.dentry)) { -+ bbot = au_sbbot(sb); -+ for (finfo->fi_btop = 0; finfo->fi_btop <= bbot; -+ finfo->fi_btop++, p++) -+ if (p->hf_file) { -+ if (file_inode(p->hf_file)) -+ break; -+ au_hfput(p, /*execed*/0); -+ } -+ } else { -+ bbot = au_br_index(sb, brid); -+ for (finfo->fi_btop = 0; finfo->fi_btop < bbot; -+ finfo->fi_btop++, p++) -+ if (p->hf_file) -+ au_hfput(p, /*execed*/0); -+ bbot = au_sbbot(sb); -+ } -+ -+ p = fidir->fd_hfile + bbot; -+ for (fidir->fd_bbot = bbot; fidir->fd_bbot >= finfo->fi_btop; -+ fidir->fd_bbot--, p--) -+ if (p->hf_file) { -+ if (file_inode(p->hf_file)) -+ break; -+ au_hfput(p, /*execed*/0); -+ } -+ AuDebugOn(fidir->fd_bbot < finfo->fi_btop); -+} -+ -+/* -+ * after branch manipulating, refresh the file. -+ */ -+static int refresh_file(struct file *file, int (*reopen)(struct file *file)) -+{ -+ int err, need_reopen, nbr; -+ aufs_bindex_t bbot, bindex; -+ struct dentry *dentry; -+ struct super_block *sb; -+ struct au_finfo *finfo; -+ struct au_hfile *hfile; -+ -+ dentry = file->f_path.dentry; -+ sb = dentry->d_sb; -+ nbr = au_sbbot(sb) + 1; -+ finfo = au_fi(file); -+ if (!finfo->fi_hdir) { -+ hfile = &finfo->fi_htop; -+ AuDebugOn(!hfile->hf_file); -+ bindex = au_br_index(sb, hfile->hf_br->br_id); -+ AuDebugOn(bindex < 0); -+ if (bindex != finfo->fi_btop) -+ au_set_fbtop(file, bindex); -+ } else { -+ err = au_fidir_realloc(finfo, nbr, /*may_shrink*/0); -+ if (unlikely(err)) -+ goto out; -+ au_do_refresh_dir(file); -+ } -+ -+ err = 0; -+ need_reopen = 1; -+ if (!au_test_mmapped(file)) -+ err = au_file_refresh_by_inode(file, &need_reopen); -+ if (finfo->fi_hdir) -+ /* harmless if err */ -+ au_fidir_realloc(finfo, nbr, /*may_shrink*/1); -+ if (!err && need_reopen && !d_unlinked(dentry)) -+ err = reopen(file); -+ if (!err) { -+ au_update_figen(file); -+ goto out; /* success */ -+ } -+ -+ /* error, close all lower files */ -+ if (finfo->fi_hdir) { -+ bbot = au_fbbot_dir(file); -+ for (bindex = au_fbtop(file); bindex <= bbot; bindex++) -+ au_set_h_fptr(file, bindex, NULL); -+ } -+ -+out: -+ return err; -+} -+ -+/* common function to regular file and dir */ -+int au_reval_and_lock_fdi(struct file *file, int (*reopen)(struct file *file), -+ int wlock, unsigned int fi_lsc) -+{ -+ int err; -+ unsigned int sigen, figen; -+ aufs_bindex_t btop; -+ unsigned char pseudo_link; -+ struct dentry *dentry; -+ struct inode *inode; -+ -+ err = 0; -+ dentry = file->f_path.dentry; -+ inode = d_inode(dentry); -+ sigen = au_sigen(dentry->d_sb); -+ fi_write_lock_nested(file, fi_lsc); -+ figen = au_figen(file); -+ if (!fi_lsc) -+ di_write_lock_child(dentry); -+ else -+ di_write_lock_child2(dentry); -+ btop = au_dbtop(dentry); -+ pseudo_link = (btop != au_ibtop(inode)); -+ if (sigen == figen && !pseudo_link && au_fbtop(file) == btop) { -+ if (!wlock) { -+ di_downgrade_lock(dentry, AuLock_IR); -+ fi_downgrade_lock(file); -+ } -+ goto out; /* success */ -+ } -+ -+ AuDbg("sigen %d, figen %d\n", sigen, figen); -+ if (au_digen_test(dentry, sigen)) { -+ err = au_reval_dpath(dentry, sigen); -+ AuDebugOn(!err && au_digen_test(dentry, sigen)); -+ } -+ -+ if (!err) -+ err = refresh_file(file, reopen); -+ if (!err) { -+ if (!wlock) { -+ di_downgrade_lock(dentry, AuLock_IR); -+ fi_downgrade_lock(file); -+ } -+ } else { -+ di_write_unlock(dentry); -+ fi_write_unlock(file); -+ } -+ -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* cf. aufs_nopage() */ -+/* for madvise(2) */ -+static int aufs_readpage(struct file *file __maybe_unused, struct page *page) -+{ -+ unlock_page(page); -+ return 0; -+} -+ -+/* it will never be called, but necessary to support O_DIRECT */ -+static ssize_t aufs_direct_IO(struct kiocb *iocb, struct iov_iter *iter) -+{ BUG(); return 0; } -+ -+/* they will never be called. */ -+#ifdef CONFIG_AUFS_DEBUG -+static int aufs_write_begin(struct file *file, struct address_space *mapping, -+ loff_t pos, unsigned len, unsigned flags, -+ struct page **pagep, void **fsdata) -+{ AuUnsupport(); return 0; } -+static int aufs_write_end(struct file *file, struct address_space *mapping, -+ loff_t pos, unsigned len, unsigned copied, -+ struct page *page, void *fsdata) -+{ AuUnsupport(); return 0; } -+static int aufs_writepage(struct page *page, struct writeback_control *wbc) -+{ AuUnsupport(); return 0; } -+ -+static int aufs_set_page_dirty(struct page *page) -+{ AuUnsupport(); return 0; } -+static void aufs_invalidatepage(struct page *page, unsigned int offset, -+ unsigned int length) -+{ AuUnsupport(); } -+static int aufs_releasepage(struct page *page, gfp_t gfp) -+{ AuUnsupport(); return 0; } -+#if 0 /* called by memory compaction regardless file */ -+static int aufs_migratepage(struct address_space *mapping, struct page *newpage, -+ struct page *page, enum migrate_mode mode) -+{ AuUnsupport(); return 0; } -+#endif -+static bool aufs_isolate_page(struct page *page, isolate_mode_t mode) -+{ AuUnsupport(); return true; } -+static void aufs_putback_page(struct page *page) -+{ AuUnsupport(); } -+static int aufs_launder_page(struct page *page) -+{ AuUnsupport(); return 0; } -+static int aufs_is_partially_uptodate(struct page *page, -+ unsigned long from, -+ unsigned long count) -+{ AuUnsupport(); return 0; } -+static void aufs_is_dirty_writeback(struct page *page, bool *dirty, -+ bool *writeback) -+{ AuUnsupport(); } -+static int aufs_error_remove_page(struct address_space *mapping, -+ struct page *page) -+{ AuUnsupport(); return 0; } -+static int aufs_swap_activate(struct swap_info_struct *sis, struct file *file, -+ sector_t *span) -+{ AuUnsupport(); return 0; } -+static void aufs_swap_deactivate(struct file *file) -+{ AuUnsupport(); } -+#endif /* CONFIG_AUFS_DEBUG */ -+ -+const struct address_space_operations aufs_aop = { -+ .readpage = aufs_readpage, -+ .direct_IO = aufs_direct_IO, -+#ifdef CONFIG_AUFS_DEBUG -+ .writepage = aufs_writepage, -+ /* no writepages, because of writepage */ -+ .set_page_dirty = aufs_set_page_dirty, -+ /* no readpages, because of readpage */ -+ .write_begin = aufs_write_begin, -+ .write_end = aufs_write_end, -+ /* no bmap, no block device */ -+ .invalidatepage = aufs_invalidatepage, -+ .releasepage = aufs_releasepage, -+ /* is fallback_migrate_page ok? */ -+ /* .migratepage = aufs_migratepage, */ -+ .isolate_page = aufs_isolate_page, -+ .putback_page = aufs_putback_page, -+ .launder_page = aufs_launder_page, -+ .is_partially_uptodate = aufs_is_partially_uptodate, -+ .is_dirty_writeback = aufs_is_dirty_writeback, -+ .error_remove_page = aufs_error_remove_page, -+ .swap_activate = aufs_swap_activate, -+ .swap_deactivate = aufs_swap_deactivate -+#endif /* CONFIG_AUFS_DEBUG */ -+}; -diff --git a/fs/aufs/file.h b/fs/aufs/file.h -new file mode 100644 -index 000000000000..c767a785227c ---- /dev/null -+++ b/fs/aufs/file.h -@@ -0,0 +1,328 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * file operations -+ */ -+ -+#ifndef __AUFS_FILE_H__ -+#define __AUFS_FILE_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+#include -+#include -+#include -+#include "rwsem.h" -+ -+struct au_branch; -+struct au_hfile { -+ struct file *hf_file; -+ struct au_branch *hf_br; -+}; -+ -+struct au_vdir; -+struct au_fidir { -+ aufs_bindex_t fd_bbot; -+ aufs_bindex_t fd_nent; -+ struct au_vdir *fd_vdir_cache; -+ struct au_hfile fd_hfile[]; -+}; -+ -+static inline int au_fidir_sz(int nent) -+{ -+ AuDebugOn(nent < 0); -+ return sizeof(struct au_fidir) + sizeof(struct au_hfile) * nent; -+} -+ -+struct au_finfo { -+ atomic_t fi_generation; -+ -+ struct au_rwsem fi_rwsem; -+ aufs_bindex_t fi_btop; -+ -+ /* do not union them */ -+ struct { /* for non-dir */ -+ struct au_hfile fi_htop; -+ atomic_t fi_mmapped; -+ }; -+ struct au_fidir *fi_hdir; /* for dir only */ -+ -+ struct hlist_bl_node fi_hlist; -+ struct file *fi_file; /* very ugly */ -+} ____cacheline_aligned_in_smp; -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* file.c */ -+extern const struct address_space_operations aufs_aop; -+unsigned int au_file_roflags(unsigned int flags); -+struct file *au_h_open(struct dentry *dentry, aufs_bindex_t bindex, int flags, -+ struct file *file, int force_wr); -+struct au_do_open_args { -+ int aopen; -+ int (*open)(struct file *file, int flags, -+ struct file *h_file); -+ struct au_fidir *fidir; -+ struct file *h_file; -+}; -+int au_do_open(struct file *file, struct au_do_open_args *args); -+int au_reopen_nondir(struct file *file); -+struct au_pin; -+int au_ready_to_write(struct file *file, loff_t len, struct au_pin *pin); -+int au_reval_and_lock_fdi(struct file *file, int (*reopen)(struct file *file), -+ int wlock, unsigned int fi_lsc); -+int au_do_flush(struct file *file, fl_owner_t id, -+ int (*flush)(struct file *file, fl_owner_t id)); -+ -+/* poll.c */ -+#ifdef CONFIG_AUFS_POLL -+unsigned int aufs_poll(struct file *file, poll_table *wait); -+#endif -+ -+#ifdef CONFIG_AUFS_BR_HFSPLUS -+/* hfsplus.c */ -+struct file *au_h_open_pre(struct dentry *dentry, aufs_bindex_t bindex, -+ int force_wr); -+void au_h_open_post(struct dentry *dentry, aufs_bindex_t bindex, -+ struct file *h_file); -+#else -+AuStub(struct file *, au_h_open_pre, return NULL, struct dentry *dentry, -+ aufs_bindex_t bindex, int force_wr) -+AuStubVoid(au_h_open_post, struct dentry *dentry, aufs_bindex_t bindex, -+ struct file *h_file); -+#endif -+ -+/* f_op.c */ -+extern const struct file_operations aufs_file_fop; -+int au_do_open_nondir(struct file *file, int flags, struct file *h_file); -+int aufs_release_nondir(struct inode *inode __maybe_unused, struct file *file); -+struct file *au_read_pre(struct file *file, int keep_fi, unsigned int lsc); -+ -+/* finfo.c */ -+void au_hfput(struct au_hfile *hf, int execed); -+void au_set_h_fptr(struct file *file, aufs_bindex_t bindex, -+ struct file *h_file); -+ -+void au_update_figen(struct file *file); -+struct au_fidir *au_fidir_alloc(struct super_block *sb); -+int au_fidir_realloc(struct au_finfo *finfo, int nbr, int may_shrink); -+ -+void au_fi_init_once(void *_fi); -+void au_finfo_fin(struct file *file); -+int au_finfo_init(struct file *file, struct au_fidir *fidir); -+ -+/* ioctl.c */ -+long aufs_ioctl_nondir(struct file *file, unsigned int cmd, unsigned long arg); -+#ifdef CONFIG_COMPAT -+long aufs_compat_ioctl_dir(struct file *file, unsigned int cmd, -+ unsigned long arg); -+long aufs_compat_ioctl_nondir(struct file *file, unsigned int cmd, -+ unsigned long arg); -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline struct au_finfo *au_fi(struct file *file) -+{ -+ return file->private_data; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+#define fi_read_lock(f) au_rw_read_lock(&au_fi(f)->fi_rwsem) -+#define fi_write_lock(f) au_rw_write_lock(&au_fi(f)->fi_rwsem) -+#define fi_read_trylock(f) au_rw_read_trylock(&au_fi(f)->fi_rwsem) -+#define fi_write_trylock(f) au_rw_write_trylock(&au_fi(f)->fi_rwsem) -+/* -+#define fi_read_trylock_nested(f) \ -+ au_rw_read_trylock_nested(&au_fi(f)->fi_rwsem) -+#define fi_write_trylock_nested(f) \ -+ au_rw_write_trylock_nested(&au_fi(f)->fi_rwsem) -+*/ -+ -+#define fi_read_unlock(f) au_rw_read_unlock(&au_fi(f)->fi_rwsem) -+#define fi_write_unlock(f) au_rw_write_unlock(&au_fi(f)->fi_rwsem) -+#define fi_downgrade_lock(f) au_rw_dgrade_lock(&au_fi(f)->fi_rwsem) -+ -+/* lock subclass for finfo */ -+enum { -+ AuLsc_FI_1, -+ AuLsc_FI_2 -+}; -+ -+static inline void fi_read_lock_nested(struct file *f, unsigned int lsc) -+{ -+ au_rw_read_lock_nested(&au_fi(f)->fi_rwsem, lsc); -+} -+ -+static inline void fi_write_lock_nested(struct file *f, unsigned int lsc) -+{ -+ au_rw_write_lock_nested(&au_fi(f)->fi_rwsem, lsc); -+} -+ -+/* -+ * fi_read_lock_1, fi_write_lock_1, -+ * fi_read_lock_2, fi_write_lock_2 -+ */ -+#define AuReadLockFunc(name) \ -+static inline void fi_read_lock_##name(struct file *f) \ -+{ fi_read_lock_nested(f, AuLsc_FI_##name); } -+ -+#define AuWriteLockFunc(name) \ -+static inline void fi_write_lock_##name(struct file *f) \ -+{ fi_write_lock_nested(f, AuLsc_FI_##name); } -+ -+#define AuRWLockFuncs(name) \ -+ AuReadLockFunc(name) \ -+ AuWriteLockFunc(name) -+ -+AuRWLockFuncs(1); -+AuRWLockFuncs(2); -+ -+#undef AuReadLockFunc -+#undef AuWriteLockFunc -+#undef AuRWLockFuncs -+ -+#define FiMustNoWaiters(f) AuRwMustNoWaiters(&au_fi(f)->fi_rwsem) -+#define FiMustAnyLock(f) AuRwMustAnyLock(&au_fi(f)->fi_rwsem) -+#define FiMustWriteLock(f) AuRwMustWriteLock(&au_fi(f)->fi_rwsem) -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* todo: hard/soft set? */ -+static inline aufs_bindex_t au_fbtop(struct file *file) -+{ -+ FiMustAnyLock(file); -+ return au_fi(file)->fi_btop; -+} -+ -+static inline aufs_bindex_t au_fbbot_dir(struct file *file) -+{ -+ FiMustAnyLock(file); -+ AuDebugOn(!au_fi(file)->fi_hdir); -+ return au_fi(file)->fi_hdir->fd_bbot; -+} -+ -+static inline struct au_vdir *au_fvdir_cache(struct file *file) -+{ -+ FiMustAnyLock(file); -+ AuDebugOn(!au_fi(file)->fi_hdir); -+ return au_fi(file)->fi_hdir->fd_vdir_cache; -+} -+ -+static inline void au_set_fbtop(struct file *file, aufs_bindex_t bindex) -+{ -+ FiMustWriteLock(file); -+ au_fi(file)->fi_btop = bindex; -+} -+ -+static inline void au_set_fbbot_dir(struct file *file, aufs_bindex_t bindex) -+{ -+ FiMustWriteLock(file); -+ AuDebugOn(!au_fi(file)->fi_hdir); -+ au_fi(file)->fi_hdir->fd_bbot = bindex; -+} -+ -+static inline void au_set_fvdir_cache(struct file *file, -+ struct au_vdir *vdir_cache) -+{ -+ FiMustWriteLock(file); -+ AuDebugOn(!au_fi(file)->fi_hdir); -+ au_fi(file)->fi_hdir->fd_vdir_cache = vdir_cache; -+} -+ -+static inline struct file *au_hf_top(struct file *file) -+{ -+ FiMustAnyLock(file); -+ AuDebugOn(au_fi(file)->fi_hdir); -+ return au_fi(file)->fi_htop.hf_file; -+} -+ -+static inline struct file *au_hf_dir(struct file *file, aufs_bindex_t bindex) -+{ -+ FiMustAnyLock(file); -+ AuDebugOn(!au_fi(file)->fi_hdir); -+ return au_fi(file)->fi_hdir->fd_hfile[0 + bindex].hf_file; -+} -+ -+/* todo: memory barrier? */ -+static inline unsigned int au_figen(struct file *f) -+{ -+ return atomic_read(&au_fi(f)->fi_generation); -+} -+ -+static inline void au_set_mmapped(struct file *f) -+{ -+ if (atomic_inc_return(&au_fi(f)->fi_mmapped)) -+ return; -+ pr_warn("fi_mmapped wrapped around\n"); -+ while (!atomic_inc_return(&au_fi(f)->fi_mmapped)) -+ ; -+} -+ -+static inline void au_unset_mmapped(struct file *f) -+{ -+ atomic_dec(&au_fi(f)->fi_mmapped); -+} -+ -+static inline int au_test_mmapped(struct file *f) -+{ -+ return atomic_read(&au_fi(f)->fi_mmapped); -+} -+ -+/* customize vma->vm_file */ -+ -+static inline void au_do_vm_file_reset(struct vm_area_struct *vma, -+ struct file *file) -+{ -+ struct file *f; -+ -+ f = vma->vm_file; -+ get_file(file); -+ vma->vm_file = file; -+ fput(f); -+} -+ -+#ifdef CONFIG_MMU -+#define AuDbgVmRegion(file, vma) do {} while (0) -+ -+static inline void au_vm_file_reset(struct vm_area_struct *vma, -+ struct file *file) -+{ -+ au_do_vm_file_reset(vma, file); -+} -+#else -+#define AuDbgVmRegion(file, vma) \ -+ AuDebugOn((vma)->vm_region && (vma)->vm_region->vm_file != (file)) -+ -+static inline void au_vm_file_reset(struct vm_area_struct *vma, -+ struct file *file) -+{ -+ struct file *f; -+ -+ au_do_vm_file_reset(vma, file); -+ f = vma->vm_region->vm_file; -+ get_file(file); -+ vma->vm_region->vm_file = file; -+ fput(f); -+} -+#endif /* CONFIG_MMU */ -+ -+/* handle vma->vm_prfile */ -+static inline void au_vm_prfile_set(struct vm_area_struct *vma, -+ struct file *file) -+{ -+ get_file(file); -+ vma->vm_prfile = file; -+#ifndef CONFIG_MMU -+ get_file(file); -+ vma->vm_region->vm_prfile = file; -+#endif -+} -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_FILE_H__ */ -diff --git a/fs/aufs/finfo.c b/fs/aufs/finfo.c -new file mode 100644 -index 000000000000..ca55e38058f1 ---- /dev/null -+++ b/fs/aufs/finfo.c -@@ -0,0 +1,136 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * file private data -+ */ -+ -+#include "aufs.h" -+ -+void au_hfput(struct au_hfile *hf, int execed) -+{ -+ if (execed) -+ allow_write_access(hf->hf_file); -+ fput(hf->hf_file); -+ hf->hf_file = NULL; -+ au_br_put(hf->hf_br); -+ hf->hf_br = NULL; -+} -+ -+void au_set_h_fptr(struct file *file, aufs_bindex_t bindex, struct file *val) -+{ -+ struct au_finfo *finfo = au_fi(file); -+ struct au_hfile *hf; -+ struct au_fidir *fidir; -+ -+ fidir = finfo->fi_hdir; -+ if (!fidir) { -+ AuDebugOn(finfo->fi_btop != bindex); -+ hf = &finfo->fi_htop; -+ } else -+ hf = fidir->fd_hfile + bindex; -+ -+ if (hf && hf->hf_file) -+ au_hfput(hf, vfsub_file_execed(file)); -+ if (val) { -+ FiMustWriteLock(file); -+ AuDebugOn(IS_ERR_OR_NULL(file->f_path.dentry)); -+ hf->hf_file = val; -+ hf->hf_br = au_sbr(file->f_path.dentry->d_sb, bindex); -+ } -+} -+ -+void au_update_figen(struct file *file) -+{ -+ atomic_set(&au_fi(file)->fi_generation, au_digen(file->f_path.dentry)); -+ /* smp_mb(); */ /* atomic_set */ -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct au_fidir *au_fidir_alloc(struct super_block *sb) -+{ -+ struct au_fidir *fidir; -+ int nbr; -+ -+ nbr = au_sbbot(sb) + 1; -+ if (nbr < 2) -+ nbr = 2; /* initial allocate for 2 branches */ -+ fidir = kzalloc(au_fidir_sz(nbr), GFP_NOFS); -+ if (fidir) { -+ fidir->fd_bbot = -1; -+ fidir->fd_nent = nbr; -+ } -+ -+ return fidir; -+} -+ -+int au_fidir_realloc(struct au_finfo *finfo, int nbr, int may_shrink) -+{ -+ int err; -+ struct au_fidir *fidir, *p; -+ -+ AuRwMustWriteLock(&finfo->fi_rwsem); -+ fidir = finfo->fi_hdir; -+ AuDebugOn(!fidir); -+ -+ err = -ENOMEM; -+ p = au_kzrealloc(fidir, au_fidir_sz(fidir->fd_nent), au_fidir_sz(nbr), -+ GFP_NOFS, may_shrink); -+ if (p) { -+ p->fd_nent = nbr; -+ finfo->fi_hdir = p; -+ err = 0; -+ } -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void au_finfo_fin(struct file *file) -+{ -+ struct au_finfo *finfo; -+ -+ au_nfiles_dec(file->f_path.dentry->d_sb); -+ -+ finfo = au_fi(file); -+ AuDebugOn(finfo->fi_hdir); -+ AuRwDestroy(&finfo->fi_rwsem); -+ au_cache_free_finfo(finfo); -+} -+ -+void au_fi_init_once(void *_finfo) -+{ -+ struct au_finfo *finfo = _finfo; -+ -+ au_rw_init(&finfo->fi_rwsem); -+} -+ -+int au_finfo_init(struct file *file, struct au_fidir *fidir) -+{ -+ int err; -+ struct au_finfo *finfo; -+ struct dentry *dentry; -+ -+ err = -ENOMEM; -+ dentry = file->f_path.dentry; -+ finfo = au_cache_alloc_finfo(); -+ if (unlikely(!finfo)) -+ goto out; -+ -+ err = 0; -+ au_nfiles_inc(dentry->d_sb); -+ au_rw_write_lock(&finfo->fi_rwsem); -+ finfo->fi_btop = -1; -+ finfo->fi_hdir = fidir; -+ atomic_set(&finfo->fi_generation, au_digen(dentry)); -+ /* smp_mb(); */ /* atomic_set */ -+ -+ file->private_data = finfo; -+ -+out: -+ return err; -+} -diff --git a/fs/aufs/fstype.h b/fs/aufs/fstype.h -new file mode 100644 -index 000000000000..702f4280c196 ---- /dev/null -+++ b/fs/aufs/fstype.h -@@ -0,0 +1,388 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * judging filesystem type -+ */ -+ -+#ifndef __AUFS_FSTYPE_H__ -+#define __AUFS_FSTYPE_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+#include -+#include -+#include -+ -+static inline int au_test_aufs(struct super_block *sb) -+{ -+ return sb->s_magic == AUFS_SUPER_MAGIC; -+} -+ -+static inline const char *au_sbtype(struct super_block *sb) -+{ -+ return sb->s_type->name; -+} -+ -+static inline int au_test_iso9660(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_ISO9660_FS) -+ return sb->s_magic == ISOFS_SUPER_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_romfs(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_ROMFS_FS) -+ return sb->s_magic == ROMFS_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_cramfs(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_CRAMFS) -+ return sb->s_magic == CRAMFS_MAGIC; -+#endif -+ return 0; -+} -+ -+static inline int au_test_nfs(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_NFS_FS) -+ return sb->s_magic == NFS_SUPER_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_fuse(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_FUSE_FS) -+ return sb->s_magic == FUSE_SUPER_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_xfs(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_XFS_FS) -+ return sb->s_magic == XFS_SB_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_tmpfs(struct super_block *sb __maybe_unused) -+{ -+#ifdef CONFIG_TMPFS -+ return sb->s_magic == TMPFS_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_ecryptfs(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_ECRYPT_FS) -+ return !strcmp(au_sbtype(sb), "ecryptfs"); -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_ramfs(struct super_block *sb) -+{ -+ return sb->s_magic == RAMFS_MAGIC; -+} -+ -+static inline int au_test_ubifs(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_UBIFS_FS) -+ return sb->s_magic == UBIFS_SUPER_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_procfs(struct super_block *sb __maybe_unused) -+{ -+#ifdef CONFIG_PROC_FS -+ return sb->s_magic == PROC_SUPER_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_sysfs(struct super_block *sb __maybe_unused) -+{ -+#ifdef CONFIG_SYSFS -+ return sb->s_magic == SYSFS_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_configfs(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_CONFIGFS_FS) -+ return sb->s_magic == CONFIGFS_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_minix(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_MINIX_FS) -+ return sb->s_magic == MINIX3_SUPER_MAGIC -+ || sb->s_magic == MINIX2_SUPER_MAGIC -+ || sb->s_magic == MINIX2_SUPER_MAGIC2 -+ || sb->s_magic == MINIX_SUPER_MAGIC -+ || sb->s_magic == MINIX_SUPER_MAGIC2; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_fat(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_FAT_FS) -+ return sb->s_magic == MSDOS_SUPER_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_msdos(struct super_block *sb) -+{ -+ return au_test_fat(sb); -+} -+ -+static inline int au_test_vfat(struct super_block *sb) -+{ -+ return au_test_fat(sb); -+} -+ -+static inline int au_test_securityfs(struct super_block *sb __maybe_unused) -+{ -+#ifdef CONFIG_SECURITYFS -+ return sb->s_magic == SECURITYFS_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_squashfs(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_SQUASHFS) -+ return sb->s_magic == SQUASHFS_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_btrfs(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_BTRFS_FS) -+ return sb->s_magic == BTRFS_SUPER_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_xenfs(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_XENFS) -+ return sb->s_magic == XENFS_SUPER_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_debugfs(struct super_block *sb __maybe_unused) -+{ -+#ifdef CONFIG_DEBUG_FS -+ return sb->s_magic == DEBUGFS_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_nilfs(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_NILFS) -+ return sb->s_magic == NILFS_SUPER_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+static inline int au_test_hfsplus(struct super_block *sb __maybe_unused) -+{ -+#if IS_ENABLED(CONFIG_HFSPLUS_FS) -+ return sb->s_magic == HFSPLUS_SUPER_MAGIC; -+#else -+ return 0; -+#endif -+} -+ -+/* ---------------------------------------------------------------------- */ -+/* -+ * they can't be an aufs branch. -+ */ -+static inline int au_test_fs_unsuppoted(struct super_block *sb) -+{ -+ return -+#ifndef CONFIG_AUFS_BR_RAMFS -+ au_test_ramfs(sb) || -+#endif -+ au_test_procfs(sb) -+ || au_test_sysfs(sb) -+ || au_test_configfs(sb) -+ || au_test_debugfs(sb) -+ || au_test_securityfs(sb) -+ || au_test_xenfs(sb) -+ || au_test_ecryptfs(sb) -+ /* || !strcmp(au_sbtype(sb), "unionfs") */ -+ || au_test_aufs(sb); /* will be supported in next version */ -+} -+ -+static inline int au_test_fs_remote(struct super_block *sb) -+{ -+ return !au_test_tmpfs(sb) -+#ifdef CONFIG_AUFS_BR_RAMFS -+ && !au_test_ramfs(sb) -+#endif -+ && !(sb->s_type->fs_flags & FS_REQUIRES_DEV); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * Note: these functions (below) are created after reading ->getattr() in all -+ * filesystems under linux/fs. it means we have to do so in every update... -+ */ -+ -+/* -+ * some filesystems require getattr to refresh the inode attributes before -+ * referencing. -+ * in most cases, we can rely on the inode attribute in NFS (or every remote fs) -+ * and leave the work for d_revalidate() -+ */ -+static inline int au_test_fs_refresh_iattr(struct super_block *sb) -+{ -+ return au_test_nfs(sb) -+ || au_test_fuse(sb) -+ /* || au_test_btrfs(sb) */ /* untested */ -+ ; -+} -+ -+/* -+ * filesystems which don't maintain i_size or i_blocks. -+ */ -+static inline int au_test_fs_bad_iattr_size(struct super_block *sb) -+{ -+ return au_test_xfs(sb) -+ || au_test_btrfs(sb) -+ || au_test_ubifs(sb) -+ || au_test_hfsplus(sb) /* maintained, but incorrect */ -+ /* || au_test_minix(sb) */ /* untested */ -+ ; -+} -+ -+/* -+ * filesystems which don't store the correct value in some of their inode -+ * attributes. -+ */ -+static inline int au_test_fs_bad_iattr(struct super_block *sb) -+{ -+ return au_test_fs_bad_iattr_size(sb) -+ || au_test_fat(sb) -+ || au_test_msdos(sb) -+ || au_test_vfat(sb); -+} -+ -+/* they don't check i_nlink in link(2) */ -+static inline int au_test_fs_no_limit_nlink(struct super_block *sb) -+{ -+ return au_test_tmpfs(sb) -+#ifdef CONFIG_AUFS_BR_RAMFS -+ || au_test_ramfs(sb) -+#endif -+ || au_test_ubifs(sb) -+ || au_test_hfsplus(sb); -+} -+ -+/* -+ * filesystems which sets S_NOATIME and S_NOCMTIME. -+ */ -+static inline int au_test_fs_notime(struct super_block *sb) -+{ -+ return au_test_nfs(sb) -+ || au_test_fuse(sb) -+ || au_test_ubifs(sb) -+ ; -+} -+ -+/* temporary support for i#1 in cramfs */ -+static inline int au_test_fs_unique_ino(struct inode *inode) -+{ -+ if (au_test_cramfs(inode->i_sb)) -+ return inode->i_ino != 1; -+ return 1; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * the filesystem where the xino files placed must support i/o after unlink and -+ * maintain i_size and i_blocks. -+ */ -+static inline int au_test_fs_bad_xino(struct super_block *sb) -+{ -+ return au_test_fs_remote(sb) -+ || au_test_fs_bad_iattr_size(sb) -+ /* don't want unnecessary work for xino */ -+ || au_test_aufs(sb) -+ || au_test_ecryptfs(sb) -+ || au_test_nilfs(sb); -+} -+ -+static inline int au_test_fs_trunc_xino(struct super_block *sb) -+{ -+ return au_test_tmpfs(sb) -+ || au_test_ramfs(sb); -+} -+ -+/* -+ * test if the @sb is real-readonly. -+ */ -+static inline int au_test_fs_rr(struct super_block *sb) -+{ -+ return au_test_squashfs(sb) -+ || au_test_iso9660(sb) -+ || au_test_cramfs(sb) -+ || au_test_romfs(sb); -+} -+ -+/* -+ * test if the @inode is nfs with 'noacl' option -+ * NFS always sets MS_POSIXACL regardless its mount option 'noacl.' -+ */ -+static inline int au_test_nfs_noacl(struct inode *inode) -+{ -+ return au_test_nfs(inode->i_sb) -+ /* && IS_POSIXACL(inode) */ -+ && !nfs_server_capable(inode, NFS_CAP_ACLS); -+} -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_FSTYPE_H__ */ -diff --git a/fs/aufs/hbl.h b/fs/aufs/hbl.h -new file mode 100644 -index 000000000000..5b40d113b9ea ---- /dev/null -+++ b/fs/aufs/hbl.h -@@ -0,0 +1,52 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * helpers for hlist_bl.h -+ */ -+ -+#ifndef __AUFS_HBL_H__ -+#define __AUFS_HBL_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+ -+static inline void au_hbl_add(struct hlist_bl_node *node, -+ struct hlist_bl_head *hbl) -+{ -+ hlist_bl_lock(hbl); -+ hlist_bl_add_head(node, hbl); -+ hlist_bl_unlock(hbl); -+} -+ -+static inline void au_hbl_del(struct hlist_bl_node *node, -+ struct hlist_bl_head *hbl) -+{ -+ hlist_bl_lock(hbl); -+ hlist_bl_del(node); -+ hlist_bl_unlock(hbl); -+} -+ -+#define au_hbl_for_each(pos, head) \ -+ for (pos = hlist_bl_first(head); \ -+ pos; \ -+ pos = pos->next) -+ -+static inline unsigned long au_hbl_count(struct hlist_bl_head *hbl) -+{ -+ unsigned long cnt; -+ struct hlist_bl_node *pos; -+ -+ cnt = 0; -+ hlist_bl_lock(hbl); -+ au_hbl_for_each(pos, hbl) -+ cnt++; -+ hlist_bl_unlock(hbl); -+ return cnt; -+} -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_HBL_H__ */ -diff --git a/fs/aufs/hfsnotify.c b/fs/aufs/hfsnotify.c -new file mode 100644 -index 000000000000..b11a88a33416 ---- /dev/null -+++ b/fs/aufs/hfsnotify.c -@@ -0,0 +1,277 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * fsnotify for the lower directories -+ */ -+ -+#include "aufs.h" -+ -+/* FS_IN_IGNORED is unnecessary */ -+static const __u32 AuHfsnMask = (FS_MOVED_TO | FS_MOVED_FROM | FS_DELETE -+ | FS_CREATE | FS_EVENT_ON_CHILD); -+static DECLARE_WAIT_QUEUE_HEAD(au_hfsn_wq); -+static __cacheline_aligned_in_smp atomic64_t au_hfsn_ifree = ATOMIC64_INIT(0); -+ -+static void au_hfsn_free_mark(struct fsnotify_mark *mark) -+{ -+ struct au_hnotify *hn = container_of(mark, struct au_hnotify, -+ hn_mark); -+ /* AuDbg("here\n"); */ -+ au_cache_free_hnotify(hn); -+ smp_mb__before_atomic(); /* for atomic64_dec */ -+ if (atomic64_dec_and_test(&au_hfsn_ifree)) -+ wake_up(&au_hfsn_wq); -+} -+ -+static int au_hfsn_alloc(struct au_hinode *hinode) -+{ -+ int err; -+ struct au_hnotify *hn; -+ struct super_block *sb; -+ struct au_branch *br; -+ struct fsnotify_mark *mark; -+ aufs_bindex_t bindex; -+ -+ hn = hinode->hi_notify; -+ sb = hn->hn_aufs_inode->i_sb; -+ bindex = au_br_index(sb, hinode->hi_id); -+ br = au_sbr(sb, bindex); -+ AuDebugOn(!br->br_hfsn); -+ -+ mark = &hn->hn_mark; -+ fsnotify_init_mark(mark, br->br_hfsn->hfsn_group); -+ mark->mask = AuHfsnMask; -+ /* -+ * by udba rename or rmdir, aufs assign a new inode to the known -+ * h_inode, so specify 1 to allow dups. -+ */ -+ lockdep_off(); -+ err = fsnotify_add_mark(mark, hinode->hi_inode, /*mnt*/NULL, -+ /*allow_dups*/1); -+ lockdep_on(); -+ -+ return err; -+} -+ -+static int au_hfsn_free(struct au_hinode *hinode, struct au_hnotify *hn) -+{ -+ struct fsnotify_mark *mark; -+ unsigned long long ull; -+ struct fsnotify_group *group; -+ -+ ull = atomic64_inc_return(&au_hfsn_ifree); -+ BUG_ON(!ull); -+ -+ mark = &hn->hn_mark; -+ spin_lock(&mark->lock); -+ group = mark->group; -+ fsnotify_get_group(group); -+ spin_unlock(&mark->lock); -+ lockdep_off(); -+ fsnotify_destroy_mark(mark, group); -+ fsnotify_put_mark(mark); -+ fsnotify_put_group(group); -+ lockdep_on(); -+ -+ /* free hn by myself */ -+ return 0; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static void au_hfsn_ctl(struct au_hinode *hinode, int do_set) -+{ -+ struct fsnotify_mark *mark; -+ -+ mark = &hinode->hi_notify->hn_mark; -+ spin_lock(&mark->lock); -+ if (do_set) { -+ AuDebugOn(mark->mask & AuHfsnMask); -+ mark->mask |= AuHfsnMask; -+ } else { -+ AuDebugOn(!(mark->mask & AuHfsnMask)); -+ mark->mask &= ~AuHfsnMask; -+ } -+ spin_unlock(&mark->lock); -+ /* fsnotify_recalc_inode_mask(hinode->hi_inode); */ -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* #define AuDbgHnotify */ -+#ifdef AuDbgHnotify -+static char *au_hfsn_name(u32 mask) -+{ -+#ifdef CONFIG_AUFS_DEBUG -+#define test_ret(flag) \ -+ do { \ -+ if (mask & flag) \ -+ return #flag; \ -+ } while (0) -+ test_ret(FS_ACCESS); -+ test_ret(FS_MODIFY); -+ test_ret(FS_ATTRIB); -+ test_ret(FS_CLOSE_WRITE); -+ test_ret(FS_CLOSE_NOWRITE); -+ test_ret(FS_OPEN); -+ test_ret(FS_MOVED_FROM); -+ test_ret(FS_MOVED_TO); -+ test_ret(FS_CREATE); -+ test_ret(FS_DELETE); -+ test_ret(FS_DELETE_SELF); -+ test_ret(FS_MOVE_SELF); -+ test_ret(FS_UNMOUNT); -+ test_ret(FS_Q_OVERFLOW); -+ test_ret(FS_IN_IGNORED); -+ test_ret(FS_ISDIR); -+ test_ret(FS_IN_ONESHOT); -+ test_ret(FS_EVENT_ON_CHILD); -+ return ""; -+#undef test_ret -+#else -+ return "??"; -+#endif -+} -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+static void au_hfsn_free_group(struct fsnotify_group *group) -+{ -+ struct au_br_hfsnotify *hfsn = group->private; -+ -+ /* AuDbg("here\n"); */ -+ kfree(hfsn); -+} -+ -+static int au_hfsn_handle_event(struct fsnotify_group *group, -+ struct inode *inode, -+ struct fsnotify_mark *inode_mark, -+ struct fsnotify_mark *vfsmount_mark, -+ u32 mask, const void *data, int data_type, -+ const unsigned char *file_name, u32 cookie, -+ struct fsnotify_iter_info *iter_info) -+{ -+ int err; -+ struct au_hnotify *hnotify; -+ struct inode *h_dir, *h_inode; -+ struct qstr h_child_qstr = QSTR_INIT(file_name, strlen(file_name)); -+ -+ AuDebugOn(data_type != FSNOTIFY_EVENT_INODE); -+ -+ err = 0; -+ /* if FS_UNMOUNT happens, there must be another bug */ -+ AuDebugOn(mask & FS_UNMOUNT); -+ if (mask & (FS_IN_IGNORED | FS_UNMOUNT)) -+ goto out; -+ -+ h_dir = inode; -+ h_inode = NULL; -+#ifdef AuDbgHnotify -+ au_debug_on(); -+ if (1 || h_child_qstr.len != sizeof(AUFS_XINO_FNAME) - 1 -+ || strncmp(h_child_qstr.name, AUFS_XINO_FNAME, h_child_qstr.len)) { -+ AuDbg("i%lu, mask 0x%x %s, hcname %.*s, hi%lu\n", -+ h_dir->i_ino, mask, au_hfsn_name(mask), -+ AuLNPair(&h_child_qstr), h_inode ? h_inode->i_ino : 0); -+ /* WARN_ON(1); */ -+ } -+ au_debug_off(); -+#endif -+ -+ AuDebugOn(!inode_mark); -+ hnotify = container_of(inode_mark, struct au_hnotify, hn_mark); -+ err = au_hnotify(h_dir, hnotify, mask, &h_child_qstr, h_inode); -+ -+out: -+ return err; -+} -+ -+static struct fsnotify_ops au_hfsn_ops = { -+ .handle_event = au_hfsn_handle_event, -+ .free_group_priv = au_hfsn_free_group, -+ .free_mark = au_hfsn_free_mark -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+static void au_hfsn_fin_br(struct au_branch *br) -+{ -+ struct au_br_hfsnotify *hfsn; -+ -+ hfsn = br->br_hfsn; -+ if (hfsn) { -+ lockdep_off(); -+ fsnotify_put_group(hfsn->hfsn_group); -+ lockdep_on(); -+ } -+} -+ -+static int au_hfsn_init_br(struct au_branch *br, int perm) -+{ -+ int err; -+ struct fsnotify_group *group; -+ struct au_br_hfsnotify *hfsn; -+ -+ err = 0; -+ br->br_hfsn = NULL; -+ if (!au_br_hnotifyable(perm)) -+ goto out; -+ -+ err = -ENOMEM; -+ hfsn = kmalloc(sizeof(*hfsn), GFP_NOFS); -+ if (unlikely(!hfsn)) -+ goto out; -+ -+ err = 0; -+ group = fsnotify_alloc_group(&au_hfsn_ops); -+ if (IS_ERR(group)) { -+ err = PTR_ERR(group); -+ pr_err("fsnotify_alloc_group() failed, %d\n", err); -+ goto out_hfsn; -+ } -+ -+ group->private = hfsn; -+ hfsn->hfsn_group = group; -+ br->br_hfsn = hfsn; -+ goto out; /* success */ -+ -+out_hfsn: -+ kfree(hfsn); -+out: -+ return err; -+} -+ -+static int au_hfsn_reset_br(unsigned int udba, struct au_branch *br, int perm) -+{ -+ int err; -+ -+ err = 0; -+ if (!br->br_hfsn) -+ err = au_hfsn_init_br(br, perm); -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static void au_hfsn_fin(void) -+{ -+ AuDbg("au_hfsn_ifree %lld\n", (long long)atomic64_read(&au_hfsn_ifree)); -+ wait_event(au_hfsn_wq, !atomic64_read(&au_hfsn_ifree)); -+} -+ -+const struct au_hnotify_op au_hnotify_op = { -+ .ctl = au_hfsn_ctl, -+ .alloc = au_hfsn_alloc, -+ .free = au_hfsn_free, -+ -+ .fin = au_hfsn_fin, -+ -+ .reset_br = au_hfsn_reset_br, -+ .fin_br = au_hfsn_fin_br, -+ .init_br = au_hfsn_init_br -+}; -diff --git a/fs/aufs/hfsplus.c b/fs/aufs/hfsplus.c -new file mode 100644 -index 000000000000..2596935ce744 ---- /dev/null -+++ b/fs/aufs/hfsplus.c -@@ -0,0 +1,44 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2010-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * special support for filesystems which aqucires an inode mutex -+ * at final closing a file, eg, hfsplus. -+ * -+ * This trick is very simple and stupid, just to open the file before really -+ * neceeary open to tell hfsplus that this is not the final closing. -+ * The caller should call au_h_open_pre() after acquiring the inode mutex, -+ * and au_h_open_post() after releasing it. -+ */ -+ -+#include "aufs.h" -+ -+struct file *au_h_open_pre(struct dentry *dentry, aufs_bindex_t bindex, -+ int force_wr) -+{ -+ struct file *h_file; -+ struct dentry *h_dentry; -+ -+ h_dentry = au_h_dptr(dentry, bindex); -+ AuDebugOn(!h_dentry); -+ AuDebugOn(d_is_negative(h_dentry)); -+ -+ h_file = NULL; -+ if (au_test_hfsplus(h_dentry->d_sb) -+ && d_is_reg(h_dentry)) -+ h_file = au_h_open(dentry, bindex, -+ O_RDONLY | O_NOATIME | O_LARGEFILE, -+ /*file*/NULL, force_wr); -+ return h_file; -+} -+ -+void au_h_open_post(struct dentry *dentry, aufs_bindex_t bindex, -+ struct file *h_file) -+{ -+ if (h_file) { -+ fput(h_file); -+ au_sbr_put(dentry->d_sb, bindex); -+ } -+} -diff --git a/fs/aufs/hnotify.c b/fs/aufs/hnotify.c -new file mode 100644 -index 000000000000..e55c6c04d147 ---- /dev/null -+++ b/fs/aufs/hnotify.c -@@ -0,0 +1,707 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * abstraction to notify the direct changes on lower directories -+ */ -+ -+#include "aufs.h" -+ -+int au_hn_alloc(struct au_hinode *hinode, struct inode *inode) -+{ -+ int err; -+ struct au_hnotify *hn; -+ -+ err = -ENOMEM; -+ hn = au_cache_alloc_hnotify(); -+ if (hn) { -+ hn->hn_aufs_inode = inode; -+ hinode->hi_notify = hn; -+ err = au_hnotify_op.alloc(hinode); -+ AuTraceErr(err); -+ if (unlikely(err)) { -+ hinode->hi_notify = NULL; -+ au_cache_free_hnotify(hn); -+ /* -+ * The upper dir was removed by udba, but the same named -+ * dir left. In this case, aufs assignes a new inode -+ * number and set the monitor again. -+ * For the lower dir, the old monitnor is still left. -+ */ -+ if (err == -EEXIST) -+ err = 0; -+ } -+ } -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+void au_hn_free(struct au_hinode *hinode) -+{ -+ struct au_hnotify *hn; -+ -+ hn = hinode->hi_notify; -+ if (hn) { -+ hinode->hi_notify = NULL; -+ if (au_hnotify_op.free(hinode, hn)) -+ au_cache_free_hnotify(hn); -+ } -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void au_hn_ctl(struct au_hinode *hinode, int do_set) -+{ -+ if (hinode->hi_notify) -+ au_hnotify_op.ctl(hinode, do_set); -+} -+ -+void au_hn_reset(struct inode *inode, unsigned int flags) -+{ -+ aufs_bindex_t bindex, bbot; -+ struct inode *hi; -+ struct dentry *iwhdentry; -+ -+ bbot = au_ibbot(inode); -+ for (bindex = au_ibtop(inode); bindex <= bbot; bindex++) { -+ hi = au_h_iptr(inode, bindex); -+ if (!hi) -+ continue; -+ -+ /* inode_lock_nested(hi, AuLsc_I_CHILD); */ -+ iwhdentry = au_hi_wh(inode, bindex); -+ if (iwhdentry) -+ dget(iwhdentry); -+ au_igrab(hi); -+ au_set_h_iptr(inode, bindex, NULL, 0); -+ au_set_h_iptr(inode, bindex, au_igrab(hi), -+ flags & ~AuHi_XINO); -+ iput(hi); -+ dput(iwhdentry); -+ /* inode_unlock(hi); */ -+ } -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int hn_xino(struct inode *inode, struct inode *h_inode) -+{ -+ int err; -+ aufs_bindex_t bindex, bbot, bfound, btop; -+ struct inode *h_i; -+ -+ err = 0; -+ if (unlikely(inode->i_ino == AUFS_ROOT_INO)) { -+ pr_warn("branch root dir was changed\n"); -+ goto out; -+ } -+ -+ bfound = -1; -+ bbot = au_ibbot(inode); -+ btop = au_ibtop(inode); -+#if 0 /* reserved for future use */ -+ if (bindex == bbot) { -+ /* keep this ino in rename case */ -+ goto out; -+ } -+#endif -+ for (bindex = btop; bindex <= bbot; bindex++) -+ if (au_h_iptr(inode, bindex) == h_inode) { -+ bfound = bindex; -+ break; -+ } -+ if (bfound < 0) -+ goto out; -+ -+ for (bindex = btop; bindex <= bbot; bindex++) { -+ h_i = au_h_iptr(inode, bindex); -+ if (!h_i) -+ continue; -+ -+ err = au_xino_write(inode->i_sb, bindex, h_i->i_ino, /*ino*/0); -+ /* ignore this error */ -+ /* bad action? */ -+ } -+ -+ /* children inode number will be broken */ -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+static int hn_gen_tree(struct dentry *dentry) -+{ -+ int err, i, j, ndentry; -+ struct au_dcsub_pages dpages; -+ struct au_dpage *dpage; -+ struct dentry **dentries; -+ -+ err = au_dpages_init(&dpages, GFP_NOFS); -+ if (unlikely(err)) -+ goto out; -+ err = au_dcsub_pages(&dpages, dentry, NULL, NULL); -+ if (unlikely(err)) -+ goto out_dpages; -+ -+ for (i = 0; i < dpages.ndpage; i++) { -+ dpage = dpages.dpages + i; -+ dentries = dpage->dentries; -+ ndentry = dpage->ndentry; -+ for (j = 0; j < ndentry; j++) { -+ struct dentry *d; -+ -+ d = dentries[j]; -+ if (IS_ROOT(d)) -+ continue; -+ -+ au_digen_dec(d); -+ if (d_really_is_positive(d)) -+ /* todo: reset children xino? -+ cached children only? */ -+ au_iigen_dec(d_inode(d)); -+ } -+ } -+ -+out_dpages: -+ au_dpages_free(&dpages); -+ -+#if 0 -+ /* discard children */ -+ dentry_unhash(dentry); -+ dput(dentry); -+#endif -+out: -+ return err; -+} -+ -+/* -+ * return 0 if processed. -+ */ -+static int hn_gen_by_inode(char *name, unsigned int nlen, struct inode *inode, -+ const unsigned int isdir) -+{ -+ int err; -+ struct dentry *d; -+ struct qstr *dname; -+ -+ err = 1; -+ if (unlikely(inode->i_ino == AUFS_ROOT_INO)) { -+ pr_warn("branch root dir was changed\n"); -+ err = 0; -+ goto out; -+ } -+ -+ if (!isdir) { -+ AuDebugOn(!name); -+ au_iigen_dec(inode); -+ spin_lock(&inode->i_lock); -+ hlist_for_each_entry(d, &inode->i_dentry, d_u.d_alias) { -+ spin_lock(&d->d_lock); -+ dname = &d->d_name; -+ if (dname->len != nlen -+ && memcmp(dname->name, name, nlen)) { -+ spin_unlock(&d->d_lock); -+ continue; -+ } -+ err = 0; -+ au_digen_dec(d); -+ spin_unlock(&d->d_lock); -+ break; -+ } -+ spin_unlock(&inode->i_lock); -+ } else { -+ au_fset_si(au_sbi(inode->i_sb), FAILED_REFRESH_DIR); -+ d = d_find_any_alias(inode); -+ if (!d) { -+ au_iigen_dec(inode); -+ goto out; -+ } -+ -+ spin_lock(&d->d_lock); -+ dname = &d->d_name; -+ if (dname->len == nlen && !memcmp(dname->name, name, nlen)) { -+ spin_unlock(&d->d_lock); -+ err = hn_gen_tree(d); -+ spin_lock(&d->d_lock); -+ } -+ spin_unlock(&d->d_lock); -+ dput(d); -+ } -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+static int hn_gen_by_name(struct dentry *dentry, const unsigned int isdir) -+{ -+ int err; -+ -+ if (IS_ROOT(dentry)) { -+ pr_warn("branch root dir was changed\n"); -+ return 0; -+ } -+ -+ err = 0; -+ if (!isdir) { -+ au_digen_dec(dentry); -+ if (d_really_is_positive(dentry)) -+ au_iigen_dec(d_inode(dentry)); -+ } else { -+ au_fset_si(au_sbi(dentry->d_sb), FAILED_REFRESH_DIR); -+ if (d_really_is_positive(dentry)) -+ err = hn_gen_tree(dentry); -+ } -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* hnotify job flags */ -+#define AuHnJob_XINO0 1 -+#define AuHnJob_GEN (1 << 1) -+#define AuHnJob_DIRENT (1 << 2) -+#define AuHnJob_ISDIR (1 << 3) -+#define AuHnJob_TRYXINO0 (1 << 4) -+#define AuHnJob_MNTPNT (1 << 5) -+#define au_ftest_hnjob(flags, name) ((flags) & AuHnJob_##name) -+#define au_fset_hnjob(flags, name) \ -+ do { (flags) |= AuHnJob_##name; } while (0) -+#define au_fclr_hnjob(flags, name) \ -+ do { (flags) &= ~AuHnJob_##name; } while (0) -+ -+enum { -+ AuHn_CHILD, -+ AuHn_PARENT, -+ AuHnLast -+}; -+ -+struct au_hnotify_args { -+ struct inode *h_dir, *dir, *h_child_inode; -+ u32 mask; -+ unsigned int flags[AuHnLast]; -+ unsigned int h_child_nlen; -+ char h_child_name[]; -+}; -+ -+struct hn_job_args { -+ unsigned int flags; -+ struct inode *inode, *h_inode, *dir, *h_dir; -+ struct dentry *dentry; -+ char *h_name; -+ int h_nlen; -+}; -+ -+static int hn_job(struct hn_job_args *a) -+{ -+ const unsigned int isdir = au_ftest_hnjob(a->flags, ISDIR); -+ int e; -+ -+ /* reset xino */ -+ if (au_ftest_hnjob(a->flags, XINO0) && a->inode) -+ hn_xino(a->inode, a->h_inode); /* ignore this error */ -+ -+ if (au_ftest_hnjob(a->flags, TRYXINO0) -+ && a->inode -+ && a->h_inode) { -+ vfsub_inode_lock_shared_nested(a->h_inode, AuLsc_I_CHILD); -+ if (!a->h_inode->i_nlink -+ && !(a->h_inode->i_state & I_LINKABLE)) -+ hn_xino(a->inode, a->h_inode); /* ignore this error */ -+ inode_unlock_shared(a->h_inode); -+ } -+ -+ /* make the generation obsolete */ -+ if (au_ftest_hnjob(a->flags, GEN)) { -+ e = -1; -+ if (a->inode) -+ e = hn_gen_by_inode(a->h_name, a->h_nlen, a->inode, -+ isdir); -+ if (e && a->dentry) -+ hn_gen_by_name(a->dentry, isdir); -+ /* ignore this error */ -+ } -+ -+ /* make dir entries obsolete */ -+ if (au_ftest_hnjob(a->flags, DIRENT) && a->inode) { -+ struct au_vdir *vdir; -+ -+ vdir = au_ivdir(a->inode); -+ if (vdir) -+ vdir->vd_jiffy = 0; -+ /* IMustLock(a->inode); */ -+ /* a->inode->i_version++; */ -+ } -+ -+ /* can do nothing but warn */ -+ if (au_ftest_hnjob(a->flags, MNTPNT) -+ && a->dentry -+ && d_mountpoint(a->dentry)) -+ pr_warn("mount-point %pd is removed or renamed\n", a->dentry); -+ -+ return 0; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static struct dentry *lookup_wlock_by_name(char *name, unsigned int nlen, -+ struct inode *dir) -+{ -+ struct dentry *dentry, *d, *parent; -+ struct qstr *dname; -+ -+ parent = d_find_any_alias(dir); -+ if (!parent) -+ return NULL; -+ -+ dentry = NULL; -+ spin_lock(&parent->d_lock); -+ list_for_each_entry(d, &parent->d_subdirs, d_child) { -+ /* AuDbg("%pd\n", d); */ -+ spin_lock_nested(&d->d_lock, DENTRY_D_LOCK_NESTED); -+ dname = &d->d_name; -+ if (dname->len != nlen || memcmp(dname->name, name, nlen)) -+ goto cont_unlock; -+ if (au_di(d)) -+ au_digen_dec(d); -+ else -+ goto cont_unlock; -+ if (au_dcount(d) > 0) { -+ dentry = dget_dlock(d); -+ spin_unlock(&d->d_lock); -+ break; -+ } -+ -+cont_unlock: -+ spin_unlock(&d->d_lock); -+ } -+ spin_unlock(&parent->d_lock); -+ dput(parent); -+ -+ if (dentry) -+ di_write_lock_child(dentry); -+ -+ return dentry; -+} -+ -+static struct inode *lookup_wlock_by_ino(struct super_block *sb, -+ aufs_bindex_t bindex, ino_t h_ino) -+{ -+ struct inode *inode; -+ ino_t ino; -+ int err; -+ -+ inode = NULL; -+ err = au_xino_read(sb, bindex, h_ino, &ino); -+ if (!err && ino) -+ inode = ilookup(sb, ino); -+ if (!inode) -+ goto out; -+ -+ if (unlikely(inode->i_ino == AUFS_ROOT_INO)) { -+ pr_warn("wrong root branch\n"); -+ iput(inode); -+ inode = NULL; -+ goto out; -+ } -+ -+ ii_write_lock_child(inode); -+ -+out: -+ return inode; -+} -+ -+static void au_hn_bh(void *_args) -+{ -+ struct au_hnotify_args *a = _args; -+ struct super_block *sb; -+ aufs_bindex_t bindex, bbot, bfound; -+ unsigned char xino, try_iput; -+ int err; -+ struct inode *inode; -+ ino_t h_ino; -+ struct hn_job_args args; -+ struct dentry *dentry; -+ struct au_sbinfo *sbinfo; -+ -+ AuDebugOn(!_args); -+ AuDebugOn(!a->h_dir); -+ AuDebugOn(!a->dir); -+ AuDebugOn(!a->mask); -+ AuDbg("mask 0x%x, i%lu, hi%lu, hci%lu\n", -+ a->mask, a->dir->i_ino, a->h_dir->i_ino, -+ a->h_child_inode ? a->h_child_inode->i_ino : 0); -+ -+ inode = NULL; -+ dentry = NULL; -+ /* -+ * do not lock a->dir->i_mutex here -+ * because of d_revalidate() may cause a deadlock. -+ */ -+ sb = a->dir->i_sb; -+ AuDebugOn(!sb); -+ sbinfo = au_sbi(sb); -+ AuDebugOn(!sbinfo); -+ si_write_lock(sb, AuLock_NOPLMW); -+ -+ if (au_opt_test(sbinfo->si_mntflags, DIRREN)) -+ switch (a->mask & FS_EVENTS_POSS_ON_CHILD) { -+ case FS_MOVED_FROM: -+ case FS_MOVED_TO: -+ AuWarn1("DIRREN with UDBA may not work correctly " -+ "for the direct rename(2)\n"); -+ } -+ -+ ii_read_lock_parent(a->dir); -+ bfound = -1; -+ bbot = au_ibbot(a->dir); -+ for (bindex = au_ibtop(a->dir); bindex <= bbot; bindex++) -+ if (au_h_iptr(a->dir, bindex) == a->h_dir) { -+ bfound = bindex; -+ break; -+ } -+ ii_read_unlock(a->dir); -+ if (unlikely(bfound < 0)) -+ goto out; -+ -+ xino = !!au_opt_test(au_mntflags(sb), XINO); -+ h_ino = 0; -+ if (a->h_child_inode) -+ h_ino = a->h_child_inode->i_ino; -+ -+ if (a->h_child_nlen -+ && (au_ftest_hnjob(a->flags[AuHn_CHILD], GEN) -+ || au_ftest_hnjob(a->flags[AuHn_CHILD], MNTPNT))) -+ dentry = lookup_wlock_by_name(a->h_child_name, a->h_child_nlen, -+ a->dir); -+ try_iput = 0; -+ if (dentry && d_really_is_positive(dentry)) -+ inode = d_inode(dentry); -+ if (xino && !inode && h_ino -+ && (au_ftest_hnjob(a->flags[AuHn_CHILD], XINO0) -+ || au_ftest_hnjob(a->flags[AuHn_CHILD], TRYXINO0) -+ || au_ftest_hnjob(a->flags[AuHn_CHILD], GEN))) { -+ inode = lookup_wlock_by_ino(sb, bfound, h_ino); -+ try_iput = 1; -+ } -+ -+ args.flags = a->flags[AuHn_CHILD]; -+ args.dentry = dentry; -+ args.inode = inode; -+ args.h_inode = a->h_child_inode; -+ args.dir = a->dir; -+ args.h_dir = a->h_dir; -+ args.h_name = a->h_child_name; -+ args.h_nlen = a->h_child_nlen; -+ err = hn_job(&args); -+ if (dentry) { -+ if (au_di(dentry)) -+ di_write_unlock(dentry); -+ dput(dentry); -+ } -+ if (inode && try_iput) { -+ ii_write_unlock(inode); -+ iput(inode); -+ } -+ -+ ii_write_lock_parent(a->dir); -+ args.flags = a->flags[AuHn_PARENT]; -+ args.dentry = NULL; -+ args.inode = a->dir; -+ args.h_inode = a->h_dir; -+ args.dir = NULL; -+ args.h_dir = NULL; -+ args.h_name = NULL; -+ args.h_nlen = 0; -+ err = hn_job(&args); -+ ii_write_unlock(a->dir); -+ -+out: -+ iput(a->h_child_inode); -+ iput(a->h_dir); -+ iput(a->dir); -+ si_write_unlock(sb); -+ au_nwt_done(&sbinfo->si_nowait); -+ kfree(a); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int au_hnotify(struct inode *h_dir, struct au_hnotify *hnotify, u32 mask, -+ struct qstr *h_child_qstr, struct inode *h_child_inode) -+{ -+ int err, len; -+ unsigned int flags[AuHnLast], f; -+ unsigned char isdir, isroot, wh; -+ struct inode *dir; -+ struct au_hnotify_args *args; -+ char *p, *h_child_name; -+ -+ err = 0; -+ AuDebugOn(!hnotify || !hnotify->hn_aufs_inode); -+ dir = igrab(hnotify->hn_aufs_inode); -+ if (!dir) -+ goto out; -+ -+ isroot = (dir->i_ino == AUFS_ROOT_INO); -+ wh = 0; -+ h_child_name = (void *)h_child_qstr->name; -+ len = h_child_qstr->len; -+ if (h_child_name) { -+ if (len > AUFS_WH_PFX_LEN -+ && !memcmp(h_child_name, AUFS_WH_PFX, AUFS_WH_PFX_LEN)) { -+ h_child_name += AUFS_WH_PFX_LEN; -+ len -= AUFS_WH_PFX_LEN; -+ wh = 1; -+ } -+ } -+ -+ isdir = 0; -+ if (h_child_inode) -+ isdir = !!S_ISDIR(h_child_inode->i_mode); -+ flags[AuHn_PARENT] = AuHnJob_ISDIR; -+ flags[AuHn_CHILD] = 0; -+ if (isdir) -+ flags[AuHn_CHILD] = AuHnJob_ISDIR; -+ au_fset_hnjob(flags[AuHn_PARENT], DIRENT); -+ au_fset_hnjob(flags[AuHn_CHILD], GEN); -+ switch (mask & FS_EVENTS_POSS_ON_CHILD) { -+ case FS_MOVED_FROM: -+ case FS_MOVED_TO: -+ au_fset_hnjob(flags[AuHn_CHILD], XINO0); -+ au_fset_hnjob(flags[AuHn_CHILD], MNTPNT); -+ /*FALLTHROUGH*/ -+ case FS_CREATE: -+ AuDebugOn(!h_child_name); -+ break; -+ -+ case FS_DELETE: -+ /* -+ * aufs never be able to get this child inode. -+ * revalidation should be in d_revalidate() -+ * by checking i_nlink, i_generation or d_unhashed(). -+ */ -+ AuDebugOn(!h_child_name); -+ au_fset_hnjob(flags[AuHn_CHILD], TRYXINO0); -+ au_fset_hnjob(flags[AuHn_CHILD], MNTPNT); -+ break; -+ -+ default: -+ AuDebugOn(1); -+ } -+ -+ if (wh) -+ h_child_inode = NULL; -+ -+ err = -ENOMEM; -+ /* iput() and kfree() will be called in au_hnotify() */ -+ args = kmalloc(sizeof(*args) + len + 1, GFP_NOFS); -+ if (unlikely(!args)) { -+ AuErr1("no memory\n"); -+ iput(dir); -+ goto out; -+ } -+ args->flags[AuHn_PARENT] = flags[AuHn_PARENT]; -+ args->flags[AuHn_CHILD] = flags[AuHn_CHILD]; -+ args->mask = mask; -+ args->dir = dir; -+ args->h_dir = igrab(h_dir); -+ if (h_child_inode) -+ h_child_inode = igrab(h_child_inode); /* can be NULL */ -+ args->h_child_inode = h_child_inode; -+ args->h_child_nlen = len; -+ if (len) { -+ p = (void *)args; -+ p += sizeof(*args); -+ memcpy(p, h_child_name, len); -+ p[len] = 0; -+ } -+ -+ /* NFS fires the event for silly-renamed one from kworker */ -+ f = 0; -+ if (!dir->i_nlink -+ || (au_test_nfs(h_dir->i_sb) && (mask & FS_DELETE))) -+ f = AuWkq_NEST; -+ err = au_wkq_nowait(au_hn_bh, args, dir->i_sb, f); -+ if (unlikely(err)) { -+ pr_err("wkq %d\n", err); -+ iput(args->h_child_inode); -+ iput(args->h_dir); -+ iput(args->dir); -+ kfree(args); -+ } -+ -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int au_hnotify_reset_br(unsigned int udba, struct au_branch *br, int perm) -+{ -+ int err; -+ -+ AuDebugOn(!(udba & AuOptMask_UDBA)); -+ -+ err = 0; -+ if (au_hnotify_op.reset_br) -+ err = au_hnotify_op.reset_br(udba, br, perm); -+ -+ return err; -+} -+ -+int au_hnotify_init_br(struct au_branch *br, int perm) -+{ -+ int err; -+ -+ err = 0; -+ if (au_hnotify_op.init_br) -+ err = au_hnotify_op.init_br(br, perm); -+ -+ return err; -+} -+ -+void au_hnotify_fin_br(struct au_branch *br) -+{ -+ if (au_hnotify_op.fin_br) -+ au_hnotify_op.fin_br(br); -+} -+ -+static void au_hn_destroy_cache(void) -+{ -+ kmem_cache_destroy(au_cache[AuCache_HNOTIFY]); -+ au_cache[AuCache_HNOTIFY] = NULL; -+} -+ -+int __init au_hnotify_init(void) -+{ -+ int err; -+ -+ err = -ENOMEM; -+ au_cache[AuCache_HNOTIFY] = AuCache(au_hnotify); -+ if (au_cache[AuCache_HNOTIFY]) { -+ err = 0; -+ if (au_hnotify_op.init) -+ err = au_hnotify_op.init(); -+ if (unlikely(err)) -+ au_hn_destroy_cache(); -+ } -+ AuTraceErr(err); -+ return err; -+} -+ -+void au_hnotify_fin(void) -+{ -+ if (au_hnotify_op.fin) -+ au_hnotify_op.fin(); -+ -+ /* cf. au_cache_fin() */ -+ if (au_cache[AuCache_HNOTIFY]) -+ au_hn_destroy_cache(); -+} -diff --git a/fs/aufs/i_op.c b/fs/aufs/i_op.c -new file mode 100644 -index 000000000000..6d9381769876 ---- /dev/null -+++ b/fs/aufs/i_op.c -@@ -0,0 +1,1447 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * inode operations (except add/del/rename) -+ */ -+ -+#include -+#include -+#include -+#include -+#include "aufs.h" -+ -+static int h_permission(struct inode *h_inode, int mask, -+ struct path *h_path, int brperm) -+{ -+ int err; -+ const unsigned char write_mask = !!(mask & (MAY_WRITE | MAY_APPEND)); -+ -+ err = -EPERM; -+ if (write_mask && IS_IMMUTABLE(h_inode)) -+ goto out; -+ -+ err = -EACCES; -+ if (((mask & MAY_EXEC) -+ && S_ISREG(h_inode->i_mode) -+ && (path_noexec(h_path) -+ || !(h_inode->i_mode & S_IXUGO)))) -+ goto out; -+ -+ /* -+ * - skip the lower fs test in the case of write to ro branch. -+ * - nfs dir permission write check is optimized, but a policy for -+ * link/rename requires a real check. -+ * - nfs always sets MS_POSIXACL regardless its mount option 'noacl.' -+ * in this case, generic_permission() returns -EOPNOTSUPP. -+ */ -+ if ((write_mask && !au_br_writable(brperm)) -+ || (au_test_nfs(h_inode->i_sb) && S_ISDIR(h_inode->i_mode) -+ && write_mask && !(mask & MAY_READ)) -+ || !h_inode->i_op->permission) { -+ /* AuLabel(generic_permission); */ -+ /* AuDbg("get_acl %pf\n", h_inode->i_op->get_acl); */ -+ err = generic_permission(h_inode, mask); -+ if (err == -EOPNOTSUPP && au_test_nfs_noacl(h_inode)) -+ err = h_inode->i_op->permission(h_inode, mask); -+ AuTraceErr(err); -+ } else { -+ /* AuLabel(h_inode->permission); */ -+ err = h_inode->i_op->permission(h_inode, mask); -+ AuTraceErr(err); -+ } -+ -+ if (!err) -+ err = devcgroup_inode_permission(h_inode, mask); -+ if (!err) -+ err = security_inode_permission(h_inode, mask); -+ -+#if 0 -+ if (!err) { -+ /* todo: do we need to call ima_path_check()? */ -+ struct path h_path = { -+ .dentry = -+ .mnt = h_mnt -+ }; -+ err = ima_path_check(&h_path, -+ mask & (MAY_READ | MAY_WRITE | MAY_EXEC), -+ IMA_COUNT_LEAVE); -+ } -+#endif -+ -+out: -+ return err; -+} -+ -+static int aufs_permission(struct inode *inode, int mask) -+{ -+ int err; -+ aufs_bindex_t bindex, bbot; -+ const unsigned char isdir = !!S_ISDIR(inode->i_mode), -+ write_mask = !!(mask & (MAY_WRITE | MAY_APPEND)); -+ struct inode *h_inode; -+ struct super_block *sb; -+ struct au_branch *br; -+ -+ /* todo: support rcu-walk? */ -+ if (mask & MAY_NOT_BLOCK) -+ return -ECHILD; -+ -+ sb = inode->i_sb; -+ si_read_lock(sb, AuLock_FLUSH); -+ ii_read_lock_child(inode); -+#if 0 -+ err = au_iigen_test(inode, au_sigen(sb)); -+ if (unlikely(err)) -+ goto out; -+#endif -+ -+ if (!isdir -+ || write_mask -+ || au_opt_test(au_mntflags(sb), DIRPERM1)) { -+ err = au_busy_or_stale(); -+ h_inode = au_h_iptr(inode, au_ibtop(inode)); -+ if (unlikely(!h_inode -+ || (h_inode->i_mode & S_IFMT) -+ != (inode->i_mode & S_IFMT))) -+ goto out; -+ -+ err = 0; -+ bindex = au_ibtop(inode); -+ br = au_sbr(sb, bindex); -+ err = h_permission(h_inode, mask, &br->br_path, br->br_perm); -+ if (write_mask -+ && !err -+ && !special_file(h_inode->i_mode)) { -+ /* test whether the upper writable branch exists */ -+ err = -EROFS; -+ for (; bindex >= 0; bindex--) -+ if (!au_br_rdonly(au_sbr(sb, bindex))) { -+ err = 0; -+ break; -+ } -+ } -+ goto out; -+ } -+ -+ /* non-write to dir */ -+ err = 0; -+ bbot = au_ibbot(inode); -+ for (bindex = au_ibtop(inode); !err && bindex <= bbot; bindex++) { -+ h_inode = au_h_iptr(inode, bindex); -+ if (h_inode) { -+ err = au_busy_or_stale(); -+ if (unlikely(!S_ISDIR(h_inode->i_mode))) -+ break; -+ -+ br = au_sbr(sb, bindex); -+ err = h_permission(h_inode, mask, &br->br_path, -+ br->br_perm); -+ } -+ } -+ -+out: -+ ii_read_unlock(inode); -+ si_read_unlock(sb); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static struct dentry *aufs_lookup(struct inode *dir, struct dentry *dentry, -+ unsigned int flags) -+{ -+ struct dentry *ret, *parent; -+ struct inode *inode; -+ struct super_block *sb; -+ int err, npositive; -+ -+ IMustLock(dir); -+ -+ /* todo: support rcu-walk? */ -+ ret = ERR_PTR(-ECHILD); -+ if (flags & LOOKUP_RCU) -+ goto out; -+ -+ ret = ERR_PTR(-ENAMETOOLONG); -+ if (unlikely(dentry->d_name.len > AUFS_MAX_NAMELEN)) -+ goto out; -+ -+ sb = dir->i_sb; -+ err = si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLM); -+ ret = ERR_PTR(err); -+ if (unlikely(err)) -+ goto out; -+ -+ err = au_di_init(dentry); -+ ret = ERR_PTR(err); -+ if (unlikely(err)) -+ goto out_si; -+ -+ inode = NULL; -+ npositive = 0; /* suppress a warning */ -+ parent = dentry->d_parent; /* dir inode is locked */ -+ di_read_lock_parent(parent, AuLock_IR); -+ err = au_alive_dir(parent); -+ if (!err) -+ err = au_digen_test(parent, au_sigen(sb)); -+ if (!err) { -+ /* regardless LOOKUP_CREATE, always ALLOW_NEG */ -+ npositive = au_lkup_dentry(dentry, au_dbtop(parent), -+ AuLkup_ALLOW_NEG); -+ err = npositive; -+ } -+ di_read_unlock(parent, AuLock_IR); -+ ret = ERR_PTR(err); -+ if (unlikely(err < 0)) -+ goto out_unlock; -+ -+ if (npositive) { -+ inode = au_new_inode(dentry, /*must_new*/0); -+ if (IS_ERR(inode)) { -+ ret = (void *)inode; -+ inode = NULL; -+ goto out_unlock; -+ } -+ } -+ -+ if (inode) -+ atomic_inc(&inode->i_count); -+ ret = d_splice_alias(inode, dentry); -+#if 0 -+ if (unlikely(d_need_lookup(dentry))) { -+ spin_lock(&dentry->d_lock); -+ dentry->d_flags &= ~DCACHE_NEED_LOOKUP; -+ spin_unlock(&dentry->d_lock); -+ } else -+#endif -+ if (inode) { -+ if (!IS_ERR(ret)) { -+ iput(inode); -+ if (ret && ret != dentry) -+ ii_write_unlock(inode); -+ } else { -+ ii_write_unlock(inode); -+ iput(inode); -+ inode = NULL; -+ } -+ } -+ -+out_unlock: -+ di_write_unlock(dentry); -+out_si: -+ si_read_unlock(sb); -+out: -+ return ret; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct aopen_node { -+ struct hlist_bl_node hblist; -+ struct file *file, *h_file; -+}; -+ -+static int au_do_aopen(struct inode *inode, struct file *file) -+{ -+ struct hlist_bl_head *aopen; -+ struct hlist_bl_node *pos; -+ struct aopen_node *node; -+ struct au_do_open_args args = { -+ .aopen = 1, -+ .open = au_do_open_nondir -+ }; -+ -+ aopen = &au_sbi(inode->i_sb)->si_aopen; -+ hlist_bl_lock(aopen); -+ hlist_bl_for_each_entry(node, pos, aopen, hblist) -+ if (node->file == file) { -+ args.h_file = node->h_file; -+ break; -+ } -+ hlist_bl_unlock(aopen); -+ /* AuDebugOn(!args.h_file); */ -+ -+ return au_do_open(file, &args); -+} -+ -+static int aufs_atomic_open(struct inode *dir, struct dentry *dentry, -+ struct file *file, unsigned int open_flag, -+ umode_t create_mode, int *opened) -+{ -+ int err, unlocked, h_opened = *opened; -+ unsigned int lkup_flags; -+ struct dentry *parent, *d; -+ struct hlist_bl_head *aopen; -+ struct vfsub_aopen_args args = { -+ .open_flag = open_flag, -+ .create_mode = create_mode, -+ .opened = &h_opened -+ }; -+ struct aopen_node aopen_node = { -+ .file = file -+ }; -+ -+ IMustLock(dir); -+ AuDbg("open_flag 0%o\n", open_flag); -+ AuDbgDentry(dentry); -+ -+ err = 0; -+ if (!au_di(dentry)) { -+ lkup_flags = LOOKUP_OPEN; -+ if (open_flag & O_CREAT) -+ lkup_flags |= LOOKUP_CREATE; -+ d = aufs_lookup(dir, dentry, lkup_flags); -+ if (IS_ERR(d)) { -+ err = PTR_ERR(d); -+ AuTraceErr(err); -+ goto out; -+ } else if (d) { -+ /* -+ * obsoleted dentry found. -+ * another error will be returned later. -+ */ -+ d_drop(d); -+ AuDbgDentry(d); -+ dput(d); -+ } -+ AuDbgDentry(dentry); -+ } -+ -+ if (d_is_positive(dentry) -+ || d_unhashed(dentry) -+ || d_unlinked(dentry) -+ || !(open_flag & O_CREAT)) -+ goto out_no_open; -+ -+ unlocked = 0; -+ err = aufs_read_lock(dentry, AuLock_DW | AuLock_FLUSH | AuLock_GEN); -+ if (unlikely(err)) -+ goto out; -+ -+ parent = dentry->d_parent; /* dir is locked */ -+ di_write_lock_parent(parent); -+ err = au_lkup_dentry(dentry, /*btop*/0, AuLkup_ALLOW_NEG); -+ if (unlikely(err)) -+ goto out_unlock; -+ -+ AuDbgDentry(dentry); -+ if (d_is_positive(dentry)) -+ goto out_unlock; -+ -+ args.file = get_empty_filp(); -+ err = PTR_ERR(args.file); -+ if (IS_ERR(args.file)) -+ goto out_unlock; -+ -+ args.file->f_flags = file->f_flags; -+ err = au_aopen_or_create(dir, dentry, &args); -+ AuTraceErr(err); -+ AuDbgFile(args.file); -+ if (unlikely(err < 0)) { -+ if (h_opened & FILE_OPENED) -+ fput(args.file); -+ else -+ put_filp(args.file); -+ goto out_unlock; -+ } -+ di_write_unlock(parent); -+ di_write_unlock(dentry); -+ unlocked = 1; -+ -+ /* some filesystems don't set FILE_CREATED while succeeded? */ -+ *opened |= FILE_CREATED; -+ if (h_opened & FILE_OPENED) -+ aopen_node.h_file = args.file; -+ else { -+ put_filp(args.file); -+ args.file = NULL; -+ } -+ aopen = &au_sbi(dir->i_sb)->si_aopen; -+ au_hbl_add(&aopen_node.hblist, aopen); -+ err = finish_open(file, dentry, au_do_aopen, opened); -+ au_hbl_del(&aopen_node.hblist, aopen); -+ AuTraceErr(err); -+ AuDbgFile(file); -+ if (aopen_node.h_file) -+ fput(aopen_node.h_file); -+ -+out_unlock: -+ if (unlocked) -+ si_read_unlock(dentry->d_sb); -+ else { -+ di_write_unlock(parent); -+ aufs_read_unlock(dentry, AuLock_DW); -+ } -+ AuDbgDentry(dentry); -+ if (unlikely(err < 0)) -+ goto out; -+out_no_open: -+ if (err >= 0 && !(*opened & FILE_CREATED)) { -+ AuLabel(out_no_open); -+ dget(dentry); -+ err = finish_no_open(file, dentry); -+ } -+out: -+ AuDbg("%pd%s%s\n", dentry, -+ (*opened & FILE_CREATED) ? " created" : "", -+ (*opened & FILE_OPENED) ? " opened" : ""); -+ AuTraceErr(err); -+ return err; -+} -+ -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_wr_dir_cpup(struct dentry *dentry, struct dentry *parent, -+ const unsigned char add_entry, aufs_bindex_t bcpup, -+ aufs_bindex_t btop) -+{ -+ int err; -+ struct dentry *h_parent; -+ struct inode *h_dir; -+ -+ if (add_entry) -+ IMustLock(d_inode(parent)); -+ else -+ di_write_lock_parent(parent); -+ -+ err = 0; -+ if (!au_h_dptr(parent, bcpup)) { -+ if (btop > bcpup) -+ err = au_cpup_dirs(dentry, bcpup); -+ else if (btop < bcpup) -+ err = au_cpdown_dirs(dentry, bcpup); -+ else -+ BUG(); -+ } -+ if (!err && add_entry && !au_ftest_wrdir(add_entry, TMPFILE)) { -+ h_parent = au_h_dptr(parent, bcpup); -+ h_dir = d_inode(h_parent); -+ vfsub_inode_lock_shared_nested(h_dir, AuLsc_I_PARENT); -+ err = au_lkup_neg(dentry, bcpup, /*wh*/0); -+ /* todo: no unlock here */ -+ inode_unlock_shared(h_dir); -+ -+ AuDbg("bcpup %d\n", bcpup); -+ if (!err) { -+ if (d_really_is_negative(dentry)) -+ au_set_h_dptr(dentry, btop, NULL); -+ au_update_dbrange(dentry, /*do_put_zero*/0); -+ } -+ } -+ -+ if (!add_entry) -+ di_write_unlock(parent); -+ if (!err) -+ err = bcpup; /* success */ -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+/* -+ * decide the branch and the parent dir where we will create a new entry. -+ * returns new bindex or an error. -+ * copyup the parent dir if needed. -+ */ -+int au_wr_dir(struct dentry *dentry, struct dentry *src_dentry, -+ struct au_wr_dir_args *args) -+{ -+ int err; -+ unsigned int flags; -+ aufs_bindex_t bcpup, btop, src_btop; -+ const unsigned char add_entry -+ = au_ftest_wrdir(args->flags, ADD_ENTRY) -+ | au_ftest_wrdir(args->flags, TMPFILE); -+ struct super_block *sb; -+ struct dentry *parent; -+ struct au_sbinfo *sbinfo; -+ -+ sb = dentry->d_sb; -+ sbinfo = au_sbi(sb); -+ parent = dget_parent(dentry); -+ btop = au_dbtop(dentry); -+ bcpup = btop; -+ if (args->force_btgt < 0) { -+ if (src_dentry) { -+ src_btop = au_dbtop(src_dentry); -+ if (src_btop < btop) -+ bcpup = src_btop; -+ } else if (add_entry) { -+ flags = 0; -+ if (au_ftest_wrdir(args->flags, ISDIR)) -+ au_fset_wbr(flags, DIR); -+ err = AuWbrCreate(sbinfo, dentry, flags); -+ bcpup = err; -+ } -+ -+ if (bcpup < 0 || au_test_ro(sb, bcpup, d_inode(dentry))) { -+ if (add_entry) -+ err = AuWbrCopyup(sbinfo, dentry); -+ else { -+ if (!IS_ROOT(dentry)) { -+ di_read_lock_parent(parent, !AuLock_IR); -+ err = AuWbrCopyup(sbinfo, dentry); -+ di_read_unlock(parent, !AuLock_IR); -+ } else -+ err = AuWbrCopyup(sbinfo, dentry); -+ } -+ bcpup = err; -+ if (unlikely(err < 0)) -+ goto out; -+ } -+ } else { -+ bcpup = args->force_btgt; -+ AuDebugOn(au_test_ro(sb, bcpup, d_inode(dentry))); -+ } -+ -+ AuDbg("btop %d, bcpup %d\n", btop, bcpup); -+ err = bcpup; -+ if (bcpup == btop) -+ goto out; /* success */ -+ -+ /* copyup the new parent into the branch we process */ -+ err = au_wr_dir_cpup(dentry, parent, add_entry, bcpup, btop); -+ if (err >= 0) { -+ if (d_really_is_negative(dentry)) { -+ au_set_h_dptr(dentry, btop, NULL); -+ au_set_dbtop(dentry, bcpup); -+ au_set_dbbot(dentry, bcpup); -+ } -+ AuDebugOn(add_entry -+ && !au_ftest_wrdir(args->flags, TMPFILE) -+ && !au_h_dptr(dentry, bcpup)); -+ } -+ -+out: -+ dput(parent); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void au_pin_hdir_unlock(struct au_pin *p) -+{ -+ if (p->hdir) -+ au_hn_inode_unlock(p->hdir); -+} -+ -+int au_pin_hdir_lock(struct au_pin *p) -+{ -+ int err; -+ -+ err = 0; -+ if (!p->hdir) -+ goto out; -+ -+ /* even if an error happens later, keep this lock */ -+ au_hn_inode_lock_nested(p->hdir, p->lsc_hi); -+ -+ err = -EBUSY; -+ if (unlikely(p->hdir->hi_inode != d_inode(p->h_parent))) -+ goto out; -+ -+ err = 0; -+ if (p->h_dentry) -+ err = au_h_verify(p->h_dentry, p->udba, p->hdir->hi_inode, -+ p->h_parent, p->br); -+ -+out: -+ return err; -+} -+ -+int au_pin_hdir_relock(struct au_pin *p) -+{ -+ int err, i; -+ struct inode *h_i; -+ struct dentry *h_d[] = { -+ p->h_dentry, -+ p->h_parent -+ }; -+ -+ err = au_pin_hdir_lock(p); -+ if (unlikely(err)) -+ goto out; -+ -+ for (i = 0; !err && i < sizeof(h_d)/sizeof(*h_d); i++) { -+ if (!h_d[i]) -+ continue; -+ if (d_is_positive(h_d[i])) { -+ h_i = d_inode(h_d[i]); -+ err = !h_i->i_nlink; -+ } -+ } -+ -+out: -+ return err; -+} -+ -+static void au_pin_hdir_set_owner(struct au_pin *p, struct task_struct *task) -+{ -+#if !defined(CONFIG_RWSEM_GENERIC_SPINLOCK) && defined(CONFIG_RWSEM_SPIN_ON_OWNER) -+ p->hdir->hi_inode->i_rwsem.owner = task; -+#endif -+} -+ -+void au_pin_hdir_acquire_nest(struct au_pin *p) -+{ -+ if (p->hdir) { -+ rwsem_acquire_nest(&p->hdir->hi_inode->i_rwsem.dep_map, -+ p->lsc_hi, 0, NULL, _RET_IP_); -+ au_pin_hdir_set_owner(p, current); -+ } -+} -+ -+void au_pin_hdir_release(struct au_pin *p) -+{ -+ if (p->hdir) { -+ au_pin_hdir_set_owner(p, p->task); -+ rwsem_release(&p->hdir->hi_inode->i_rwsem.dep_map, 1, _RET_IP_); -+ } -+} -+ -+struct dentry *au_pinned_h_parent(struct au_pin *pin) -+{ -+ if (pin && pin->parent) -+ return au_h_dptr(pin->parent, pin->bindex); -+ return NULL; -+} -+ -+void au_unpin(struct au_pin *p) -+{ -+ if (p->hdir) -+ au_pin_hdir_unlock(p); -+ if (p->h_mnt && au_ftest_pin(p->flags, MNT_WRITE)) -+ vfsub_mnt_drop_write(p->h_mnt); -+ if (!p->hdir) -+ return; -+ -+ if (!au_ftest_pin(p->flags, DI_LOCKED)) -+ di_read_unlock(p->parent, AuLock_IR); -+ iput(p->hdir->hi_inode); -+ dput(p->parent); -+ p->parent = NULL; -+ p->hdir = NULL; -+ p->h_mnt = NULL; -+ /* do not clear p->task */ -+} -+ -+int au_do_pin(struct au_pin *p) -+{ -+ int err; -+ struct super_block *sb; -+ struct inode *h_dir; -+ -+ err = 0; -+ sb = p->dentry->d_sb; -+ p->br = au_sbr(sb, p->bindex); -+ if (IS_ROOT(p->dentry)) { -+ if (au_ftest_pin(p->flags, MNT_WRITE)) { -+ p->h_mnt = au_br_mnt(p->br); -+ err = vfsub_mnt_want_write(p->h_mnt); -+ if (unlikely(err)) { -+ au_fclr_pin(p->flags, MNT_WRITE); -+ goto out_err; -+ } -+ } -+ goto out; -+ } -+ -+ p->h_dentry = NULL; -+ if (p->bindex <= au_dbbot(p->dentry)) -+ p->h_dentry = au_h_dptr(p->dentry, p->bindex); -+ -+ p->parent = dget_parent(p->dentry); -+ if (!au_ftest_pin(p->flags, DI_LOCKED)) -+ di_read_lock(p->parent, AuLock_IR, p->lsc_di); -+ -+ h_dir = NULL; -+ p->h_parent = au_h_dptr(p->parent, p->bindex); -+ p->hdir = au_hi(d_inode(p->parent), p->bindex); -+ if (p->hdir) -+ h_dir = p->hdir->hi_inode; -+ -+ /* -+ * udba case, or -+ * if DI_LOCKED is not set, then p->parent may be different -+ * and h_parent can be NULL. -+ */ -+ if (unlikely(!p->hdir || !h_dir || !p->h_parent)) { -+ err = -EBUSY; -+ if (!au_ftest_pin(p->flags, DI_LOCKED)) -+ di_read_unlock(p->parent, AuLock_IR); -+ dput(p->parent); -+ p->parent = NULL; -+ goto out_err; -+ } -+ -+ if (au_ftest_pin(p->flags, MNT_WRITE)) { -+ p->h_mnt = au_br_mnt(p->br); -+ err = vfsub_mnt_want_write(p->h_mnt); -+ if (unlikely(err)) { -+ au_fclr_pin(p->flags, MNT_WRITE); -+ if (!au_ftest_pin(p->flags, DI_LOCKED)) -+ di_read_unlock(p->parent, AuLock_IR); -+ dput(p->parent); -+ p->parent = NULL; -+ goto out_err; -+ } -+ } -+ -+ au_igrab(h_dir); -+ err = au_pin_hdir_lock(p); -+ if (!err) -+ goto out; /* success */ -+ -+ au_unpin(p); -+ -+out_err: -+ pr_err("err %d\n", err); -+ err = au_busy_or_stale(); -+out: -+ return err; -+} -+ -+void au_pin_init(struct au_pin *p, struct dentry *dentry, -+ aufs_bindex_t bindex, int lsc_di, int lsc_hi, -+ unsigned int udba, unsigned char flags) -+{ -+ p->dentry = dentry; -+ p->udba = udba; -+ p->lsc_di = lsc_di; -+ p->lsc_hi = lsc_hi; -+ p->flags = flags; -+ p->bindex = bindex; -+ -+ p->parent = NULL; -+ p->hdir = NULL; -+ p->h_mnt = NULL; -+ -+ p->h_dentry = NULL; -+ p->h_parent = NULL; -+ p->br = NULL; -+ p->task = current; -+} -+ -+int au_pin(struct au_pin *pin, struct dentry *dentry, aufs_bindex_t bindex, -+ unsigned int udba, unsigned char flags) -+{ -+ au_pin_init(pin, dentry, bindex, AuLsc_DI_PARENT, AuLsc_I_PARENT2, -+ udba, flags); -+ return au_do_pin(pin); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * ->setattr() and ->getattr() are called in various cases. -+ * chmod, stat: dentry is revalidated. -+ * fchmod, fstat: file and dentry are not revalidated, additionally they may be -+ * unhashed. -+ * for ->setattr(), ia->ia_file is passed from ftruncate only. -+ */ -+/* todo: consolidate with do_refresh() and simple_reval_dpath() */ -+int au_reval_for_attr(struct dentry *dentry, unsigned int sigen) -+{ -+ int err; -+ struct dentry *parent; -+ -+ err = 0; -+ if (au_digen_test(dentry, sigen)) { -+ parent = dget_parent(dentry); -+ di_read_lock_parent(parent, AuLock_IR); -+ err = au_refresh_dentry(dentry, parent); -+ di_read_unlock(parent, AuLock_IR); -+ dput(parent); -+ } -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+int au_pin_and_icpup(struct dentry *dentry, struct iattr *ia, -+ struct au_icpup_args *a) -+{ -+ int err; -+ loff_t sz; -+ aufs_bindex_t btop, ibtop; -+ struct dentry *hi_wh, *parent; -+ struct inode *inode; -+ struct au_wr_dir_args wr_dir_args = { -+ .force_btgt = -1, -+ .flags = 0 -+ }; -+ -+ if (d_is_dir(dentry)) -+ au_fset_wrdir(wr_dir_args.flags, ISDIR); -+ /* plink or hi_wh() case */ -+ btop = au_dbtop(dentry); -+ inode = d_inode(dentry); -+ ibtop = au_ibtop(inode); -+ if (btop != ibtop && !au_test_ro(inode->i_sb, ibtop, inode)) -+ wr_dir_args.force_btgt = ibtop; -+ err = au_wr_dir(dentry, /*src_dentry*/NULL, &wr_dir_args); -+ if (unlikely(err < 0)) -+ goto out; -+ a->btgt = err; -+ if (err != btop) -+ au_fset_icpup(a->flags, DID_CPUP); -+ -+ err = 0; -+ a->pin_flags = AuPin_MNT_WRITE; -+ parent = NULL; -+ if (!IS_ROOT(dentry)) { -+ au_fset_pin(a->pin_flags, DI_LOCKED); -+ parent = dget_parent(dentry); -+ di_write_lock_parent(parent); -+ } -+ -+ err = au_pin(&a->pin, dentry, a->btgt, a->udba, a->pin_flags); -+ if (unlikely(err)) -+ goto out_parent; -+ -+ sz = -1; -+ a->h_path.dentry = au_h_dptr(dentry, btop); -+ a->h_inode = d_inode(a->h_path.dentry); -+ if (ia && (ia->ia_valid & ATTR_SIZE)) { -+ vfsub_inode_lock_shared_nested(a->h_inode, AuLsc_I_CHILD); -+ if (ia->ia_size < i_size_read(a->h_inode)) -+ sz = ia->ia_size; -+ inode_unlock_shared(a->h_inode); -+ } -+ -+ hi_wh = NULL; -+ if (au_ftest_icpup(a->flags, DID_CPUP) && d_unlinked(dentry)) { -+ hi_wh = au_hi_wh(inode, a->btgt); -+ if (!hi_wh) { -+ struct au_cp_generic cpg = { -+ .dentry = dentry, -+ .bdst = a->btgt, -+ .bsrc = -1, -+ .len = sz, -+ .pin = &a->pin -+ }; -+ err = au_sio_cpup_wh(&cpg, /*file*/NULL); -+ if (unlikely(err)) -+ goto out_unlock; -+ hi_wh = au_hi_wh(inode, a->btgt); -+ /* todo: revalidate hi_wh? */ -+ } -+ } -+ -+ if (parent) { -+ au_pin_set_parent_lflag(&a->pin, /*lflag*/0); -+ di_downgrade_lock(parent, AuLock_IR); -+ dput(parent); -+ parent = NULL; -+ } -+ if (!au_ftest_icpup(a->flags, DID_CPUP)) -+ goto out; /* success */ -+ -+ if (!d_unhashed(dentry)) { -+ struct au_cp_generic cpg = { -+ .dentry = dentry, -+ .bdst = a->btgt, -+ .bsrc = btop, -+ .len = sz, -+ .pin = &a->pin, -+ .flags = AuCpup_DTIME | AuCpup_HOPEN -+ }; -+ err = au_sio_cpup_simple(&cpg); -+ if (!err) -+ a->h_path.dentry = au_h_dptr(dentry, a->btgt); -+ } else if (!hi_wh) -+ a->h_path.dentry = au_h_dptr(dentry, a->btgt); -+ else -+ a->h_path.dentry = hi_wh; /* do not dget here */ -+ -+out_unlock: -+ a->h_inode = d_inode(a->h_path.dentry); -+ if (!err) -+ goto out; /* success */ -+ au_unpin(&a->pin); -+out_parent: -+ if (parent) { -+ di_write_unlock(parent); -+ dput(parent); -+ } -+out: -+ if (!err) -+ inode_lock_nested(a->h_inode, AuLsc_I_CHILD); -+ return err; -+} -+ -+static int aufs_setattr(struct dentry *dentry, struct iattr *ia) -+{ -+ int err; -+ struct inode *inode, *delegated; -+ struct super_block *sb; -+ struct file *file; -+ struct au_icpup_args *a; -+ -+ inode = d_inode(dentry); -+ IMustLock(inode); -+ -+ err = setattr_prepare(dentry, ia); -+ if (unlikely(err)) -+ goto out; -+ -+ err = -ENOMEM; -+ a = kzalloc(sizeof(*a), GFP_NOFS); -+ if (unlikely(!a)) -+ goto out; -+ -+ if (ia->ia_valid & (ATTR_KILL_SUID | ATTR_KILL_SGID)) -+ ia->ia_valid &= ~ATTR_MODE; -+ -+ file = NULL; -+ sb = dentry->d_sb; -+ err = si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLM); -+ if (unlikely(err)) -+ goto out_kfree; -+ -+ if (ia->ia_valid & ATTR_FILE) { -+ /* currently ftruncate(2) only */ -+ AuDebugOn(!d_is_reg(dentry)); -+ file = ia->ia_file; -+ err = au_reval_and_lock_fdi(file, au_reopen_nondir, /*wlock*/1, -+ /*fi_lsc*/0); -+ if (unlikely(err)) -+ goto out_si; -+ ia->ia_file = au_hf_top(file); -+ a->udba = AuOpt_UDBA_NONE; -+ } else { -+ /* fchmod() doesn't pass ia_file */ -+ a->udba = au_opt_udba(sb); -+ di_write_lock_child(dentry); -+ /* no d_unlinked(), to set UDBA_NONE for root */ -+ if (d_unhashed(dentry)) -+ a->udba = AuOpt_UDBA_NONE; -+ if (a->udba != AuOpt_UDBA_NONE) { -+ AuDebugOn(IS_ROOT(dentry)); -+ err = au_reval_for_attr(dentry, au_sigen(sb)); -+ if (unlikely(err)) -+ goto out_dentry; -+ } -+ } -+ -+ err = au_pin_and_icpup(dentry, ia, a); -+ if (unlikely(err < 0)) -+ goto out_dentry; -+ if (au_ftest_icpup(a->flags, DID_CPUP)) { -+ ia->ia_file = NULL; -+ ia->ia_valid &= ~ATTR_FILE; -+ } -+ -+ a->h_path.mnt = au_sbr_mnt(sb, a->btgt); -+ if ((ia->ia_valid & (ATTR_MODE | ATTR_CTIME)) -+ == (ATTR_MODE | ATTR_CTIME)) { -+ err = security_path_chmod(&a->h_path, ia->ia_mode); -+ if (unlikely(err)) -+ goto out_unlock; -+ } else if ((ia->ia_valid & (ATTR_UID | ATTR_GID)) -+ && (ia->ia_valid & ATTR_CTIME)) { -+ err = security_path_chown(&a->h_path, ia->ia_uid, ia->ia_gid); -+ if (unlikely(err)) -+ goto out_unlock; -+ } -+ -+ if (ia->ia_valid & ATTR_SIZE) { -+ struct file *f; -+ -+ if (ia->ia_size < i_size_read(inode)) -+ /* unmap only */ -+ truncate_setsize(inode, ia->ia_size); -+ -+ f = NULL; -+ if (ia->ia_valid & ATTR_FILE) -+ f = ia->ia_file; -+ inode_unlock(a->h_inode); -+ err = vfsub_trunc(&a->h_path, ia->ia_size, ia->ia_valid, f); -+ inode_lock_nested(a->h_inode, AuLsc_I_CHILD); -+ } else { -+ delegated = NULL; -+ while (1) { -+ err = vfsub_notify_change(&a->h_path, ia, &delegated); -+ if (delegated) { -+ err = break_deleg_wait(&delegated); -+ if (!err) -+ continue; -+ } -+ break; -+ } -+ } -+ /* -+ * regardless aufs 'acl' option setting. -+ * why don't all acl-aware fs call this func from their ->setattr()? -+ */ -+ if (!err && (ia->ia_valid & ATTR_MODE)) -+ err = vfsub_acl_chmod(a->h_inode, ia->ia_mode); -+ if (!err) -+ au_cpup_attr_changeable(inode); -+ -+out_unlock: -+ inode_unlock(a->h_inode); -+ au_unpin(&a->pin); -+ if (unlikely(err)) -+ au_update_dbtop(dentry); -+out_dentry: -+ di_write_unlock(dentry); -+ if (file) { -+ fi_write_unlock(file); -+ ia->ia_file = file; -+ ia->ia_valid |= ATTR_FILE; -+ } -+out_si: -+ si_read_unlock(sb); -+out_kfree: -+ kfree(a); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+#if IS_ENABLED(CONFIG_AUFS_XATTR) || IS_ENABLED(CONFIG_FS_POSIX_ACL) -+static int au_h_path_to_set_attr(struct dentry *dentry, -+ struct au_icpup_args *a, struct path *h_path) -+{ -+ int err; -+ struct super_block *sb; -+ -+ sb = dentry->d_sb; -+ a->udba = au_opt_udba(sb); -+ /* no d_unlinked(), to set UDBA_NONE for root */ -+ if (d_unhashed(dentry)) -+ a->udba = AuOpt_UDBA_NONE; -+ if (a->udba != AuOpt_UDBA_NONE) { -+ AuDebugOn(IS_ROOT(dentry)); -+ err = au_reval_for_attr(dentry, au_sigen(sb)); -+ if (unlikely(err)) -+ goto out; -+ } -+ err = au_pin_and_icpup(dentry, /*ia*/NULL, a); -+ if (unlikely(err < 0)) -+ goto out; -+ -+ h_path->dentry = a->h_path.dentry; -+ h_path->mnt = au_sbr_mnt(sb, a->btgt); -+ -+out: -+ return err; -+} -+ -+ssize_t au_sxattr(struct dentry *dentry, struct inode *inode, -+ struct au_sxattr *arg) -+{ -+ int err; -+ struct path h_path; -+ struct super_block *sb; -+ struct au_icpup_args *a; -+ struct inode *h_inode; -+ -+ IMustLock(inode); -+ -+ err = -ENOMEM; -+ a = kzalloc(sizeof(*a), GFP_NOFS); -+ if (unlikely(!a)) -+ goto out; -+ -+ sb = dentry->d_sb; -+ err = si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLM); -+ if (unlikely(err)) -+ goto out_kfree; -+ -+ h_path.dentry = NULL; /* silence gcc */ -+ di_write_lock_child(dentry); -+ err = au_h_path_to_set_attr(dentry, a, &h_path); -+ if (unlikely(err)) -+ goto out_di; -+ -+ inode_unlock(a->h_inode); -+ switch (arg->type) { -+ case AU_XATTR_SET: -+ AuDebugOn(d_is_negative(h_path.dentry)); -+ err = vfsub_setxattr(h_path.dentry, -+ arg->u.set.name, arg->u.set.value, -+ arg->u.set.size, arg->u.set.flags); -+ break; -+ case AU_ACL_SET: -+ err = -EOPNOTSUPP; -+ h_inode = d_inode(h_path.dentry); -+ if (h_inode->i_op->set_acl) -+ /* this will call posix_acl_update_mode */ -+ err = h_inode->i_op->set_acl(h_inode, -+ arg->u.acl_set.acl, -+ arg->u.acl_set.type); -+ break; -+ } -+ if (!err) -+ au_cpup_attr_timesizes(inode); -+ -+ au_unpin(&a->pin); -+ if (unlikely(err)) -+ au_update_dbtop(dentry); -+ -+out_di: -+ di_write_unlock(dentry); -+ si_read_unlock(sb); -+out_kfree: -+ kfree(a); -+out: -+ AuTraceErr(err); -+ return err; -+} -+#endif -+ -+static void au_refresh_iattr(struct inode *inode, struct kstat *st, -+ unsigned int nlink) -+{ -+ unsigned int n; -+ -+ inode->i_mode = st->mode; -+ /* don't i_[ug]id_write() here */ -+ inode->i_uid = st->uid; -+ inode->i_gid = st->gid; -+ inode->i_atime = st->atime; -+ inode->i_mtime = st->mtime; -+ inode->i_ctime = st->ctime; -+ -+ au_cpup_attr_nlink(inode, /*force*/0); -+ if (S_ISDIR(inode->i_mode)) { -+ n = inode->i_nlink; -+ n -= nlink; -+ n += st->nlink; -+ smp_mb(); /* for i_nlink */ -+ /* 0 can happen */ -+ set_nlink(inode, n); -+ } -+ -+ spin_lock(&inode->i_lock); -+ inode->i_blocks = st->blocks; -+ i_size_write(inode, st->size); -+ spin_unlock(&inode->i_lock); -+} -+ -+/* -+ * common routine for aufs_getattr() and au_getxattr(). -+ * returns zero or negative (an error). -+ * @dentry will be read-locked in success. -+ */ -+int au_h_path_getattr(struct dentry *dentry, int force, struct path *h_path, -+ int locked) -+{ -+ int err; -+ unsigned int mnt_flags, sigen; -+ unsigned char udba_none; -+ aufs_bindex_t bindex; -+ struct super_block *sb, *h_sb; -+ struct inode *inode; -+ -+ h_path->mnt = NULL; -+ h_path->dentry = NULL; -+ -+ err = 0; -+ sb = dentry->d_sb; -+ mnt_flags = au_mntflags(sb); -+ udba_none = !!au_opt_test(mnt_flags, UDBA_NONE); -+ -+ if (unlikely(locked)) -+ goto body; /* skip locking dinfo */ -+ -+ /* support fstat(2) */ -+ if (!d_unlinked(dentry) && !udba_none) { -+ sigen = au_sigen(sb); -+ err = au_digen_test(dentry, sigen); -+ if (!err) { -+ di_read_lock_child(dentry, AuLock_IR); -+ err = au_dbrange_test(dentry); -+ if (unlikely(err)) { -+ di_read_unlock(dentry, AuLock_IR); -+ goto out; -+ } -+ } else { -+ AuDebugOn(IS_ROOT(dentry)); -+ di_write_lock_child(dentry); -+ err = au_dbrange_test(dentry); -+ if (!err) -+ err = au_reval_for_attr(dentry, sigen); -+ if (!err) -+ di_downgrade_lock(dentry, AuLock_IR); -+ else { -+ di_write_unlock(dentry); -+ goto out; -+ } -+ } -+ } else -+ di_read_lock_child(dentry, AuLock_IR); -+ -+body: -+ inode = d_inode(dentry); -+ bindex = au_ibtop(inode); -+ h_path->mnt = au_sbr_mnt(sb, bindex); -+ h_sb = h_path->mnt->mnt_sb; -+ if (!force -+ && !au_test_fs_bad_iattr(h_sb) -+ && udba_none) -+ goto out; /* success */ -+ -+ if (au_dbtop(dentry) == bindex) -+ h_path->dentry = au_h_dptr(dentry, bindex); -+ else if (au_opt_test(mnt_flags, PLINK) && au_plink_test(inode)) { -+ h_path->dentry = au_plink_lkup(inode, bindex); -+ if (IS_ERR(h_path->dentry)) -+ /* pretending success */ -+ h_path->dentry = NULL; -+ else -+ dput(h_path->dentry); -+ } -+ -+out: -+ return err; -+} -+ -+static int aufs_getattr(const struct path *path, struct kstat *st, -+ u32 request, unsigned int query) -+{ -+ int err; -+ unsigned char positive; -+ struct path h_path; -+ struct dentry *dentry; -+ struct inode *inode; -+ struct super_block *sb; -+ -+ dentry = path->dentry; -+ inode = d_inode(dentry); -+ sb = dentry->d_sb; -+ err = si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLM); -+ if (unlikely(err)) -+ goto out; -+ err = au_h_path_getattr(dentry, /*force*/0, &h_path, /*locked*/0); -+ if (unlikely(err)) -+ goto out_si; -+ if (unlikely(!h_path.dentry)) -+ /* illegally overlapped or something */ -+ goto out_fill; /* pretending success */ -+ -+ positive = d_is_positive(h_path.dentry); -+ if (positive) -+ /* no vfsub version */ -+ err = vfs_getattr(&h_path, st, request, query); -+ if (!err) { -+ if (positive) -+ au_refresh_iattr(inode, st, -+ d_inode(h_path.dentry)->i_nlink); -+ goto out_fill; /* success */ -+ } -+ AuTraceErr(err); -+ goto out_di; -+ -+out_fill: -+ generic_fillattr(inode, st); -+out_di: -+ di_read_unlock(dentry, AuLock_IR); -+out_si: -+ si_read_unlock(sb); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static const char *aufs_get_link(struct dentry *dentry, struct inode *inode, -+ struct delayed_call *done) -+{ -+ const char *ret; -+ struct dentry *h_dentry; -+ struct inode *h_inode; -+ int err; -+ aufs_bindex_t bindex; -+ -+ ret = NULL; /* suppress a warning */ -+ err = -ECHILD; -+ if (!dentry) -+ goto out; -+ -+ err = aufs_read_lock(dentry, AuLock_IR | AuLock_GEN); -+ if (unlikely(err)) -+ goto out; -+ -+ err = au_d_hashed_positive(dentry); -+ if (unlikely(err)) -+ goto out_unlock; -+ -+ err = -EINVAL; -+ inode = d_inode(dentry); -+ bindex = au_ibtop(inode); -+ h_inode = au_h_iptr(inode, bindex); -+ if (unlikely(!h_inode->i_op->get_link)) -+ goto out_unlock; -+ -+ err = -EBUSY; -+ h_dentry = NULL; -+ if (au_dbtop(dentry) <= bindex) { -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (h_dentry) -+ dget(h_dentry); -+ } -+ if (!h_dentry) { -+ h_dentry = d_find_any_alias(h_inode); -+ if (IS_ERR(h_dentry)) { -+ err = PTR_ERR(h_dentry); -+ goto out_unlock; -+ } -+ } -+ if (unlikely(!h_dentry)) -+ goto out_unlock; -+ -+ err = 0; -+ AuDbg("%pf\n", h_inode->i_op->get_link); -+ AuDbgDentry(h_dentry); -+ ret = vfs_get_link(h_dentry, done); -+ dput(h_dentry); -+ if (IS_ERR(ret)) -+ err = PTR_ERR(ret); -+ -+out_unlock: -+ aufs_read_unlock(dentry, AuLock_IR); -+out: -+ if (unlikely(err)) -+ ret = ERR_PTR(err); -+ AuTraceErrPtr(ret); -+ return ret; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_is_special(struct inode *inode) -+{ -+ return (inode->i_mode & (S_IFBLK | S_IFCHR | S_IFIFO | S_IFSOCK)); -+} -+ -+static int aufs_update_time(struct inode *inode, struct timespec *ts, int flags) -+{ -+ int err; -+ aufs_bindex_t bindex; -+ struct super_block *sb; -+ struct inode *h_inode; -+ struct vfsmount *h_mnt; -+ -+ sb = inode->i_sb; -+ WARN_ONCE((flags & S_ATIME) && !IS_NOATIME(inode), -+ "unexpected s_flags 0x%lx", sb->s_flags); -+ -+ /* mmap_sem might be acquired already, cf. aufs_mmap() */ -+ lockdep_off(); -+ si_read_lock(sb, AuLock_FLUSH); -+ ii_write_lock_child(inode); -+ -+ err = 0; -+ bindex = au_ibtop(inode); -+ h_inode = au_h_iptr(inode, bindex); -+ if (!au_test_ro(sb, bindex, inode)) { -+ h_mnt = au_sbr_mnt(sb, bindex); -+ err = vfsub_mnt_want_write(h_mnt); -+ if (!err) { -+ err = vfsub_update_time(h_inode, ts, flags); -+ vfsub_mnt_drop_write(h_mnt); -+ } -+ } else if (au_is_special(h_inode)) { -+ /* -+ * Never copy-up here. -+ * These special files may already be opened and used for -+ * communicating. If we copied it up, then the communication -+ * would be corrupted. -+ */ -+ AuWarn1("timestamps for i%lu are ignored " -+ "since it is on readonly branch (hi%lu).\n", -+ inode->i_ino, h_inode->i_ino); -+ } else if (flags & ~S_ATIME) { -+ err = -EIO; -+ AuIOErr1("unexpected flags 0x%x\n", flags); -+ AuDebugOn(1); -+ } -+ -+ if (!err) -+ au_cpup_attr_timesizes(inode); -+ ii_write_unlock(inode); -+ si_read_unlock(sb); -+ lockdep_on(); -+ -+ if (!err && (flags & S_VERSION)) -+ inode_inc_iversion(inode); -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* no getattr version will be set by module.c:aufs_init() */ -+struct inode_operations aufs_iop_nogetattr[AuIop_Last], -+ aufs_iop[] = { -+ [AuIop_SYMLINK] = { -+ .permission = aufs_permission, -+#ifdef CONFIG_FS_POSIX_ACL -+ .get_acl = aufs_get_acl, -+ .set_acl = aufs_set_acl, /* unsupport for symlink? */ -+#endif -+ -+ .setattr = aufs_setattr, -+ .getattr = aufs_getattr, -+ -+#ifdef CONFIG_AUFS_XATTR -+ .listxattr = aufs_listxattr, -+#endif -+ -+ .get_link = aufs_get_link, -+ -+ /* .update_time = aufs_update_time */ -+ }, -+ [AuIop_DIR] = { -+ .create = aufs_create, -+ .lookup = aufs_lookup, -+ .link = aufs_link, -+ .unlink = aufs_unlink, -+ .symlink = aufs_symlink, -+ .mkdir = aufs_mkdir, -+ .rmdir = aufs_rmdir, -+ .mknod = aufs_mknod, -+ .rename = aufs_rename, -+ -+ .permission = aufs_permission, -+#ifdef CONFIG_FS_POSIX_ACL -+ .get_acl = aufs_get_acl, -+ .set_acl = aufs_set_acl, -+#endif -+ -+ .setattr = aufs_setattr, -+ .getattr = aufs_getattr, -+ -+#ifdef CONFIG_AUFS_XATTR -+ .listxattr = aufs_listxattr, -+#endif -+ -+ .update_time = aufs_update_time, -+ .atomic_open = aufs_atomic_open, -+ .tmpfile = aufs_tmpfile -+ }, -+ [AuIop_OTHER] = { -+ .permission = aufs_permission, -+#ifdef CONFIG_FS_POSIX_ACL -+ .get_acl = aufs_get_acl, -+ .set_acl = aufs_set_acl, -+#endif -+ -+ .setattr = aufs_setattr, -+ .getattr = aufs_getattr, -+ -+#ifdef CONFIG_AUFS_XATTR -+ .listxattr = aufs_listxattr, -+#endif -+ -+ .update_time = aufs_update_time -+ } -+}; -diff --git a/fs/aufs/i_op_add.c b/fs/aufs/i_op_add.c -new file mode 100644 -index 000000000000..5523be8edd6a ---- /dev/null -+++ b/fs/aufs/i_op_add.c -@@ -0,0 +1,908 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * inode operations (add entry) -+ */ -+ -+#include "aufs.h" -+ -+/* -+ * final procedure of adding a new entry, except link(2). -+ * remove whiteout, instantiate, copyup the parent dir's times and size -+ * and update version. -+ * if it failed, re-create the removed whiteout. -+ */ -+static int epilog(struct inode *dir, aufs_bindex_t bindex, -+ struct dentry *wh_dentry, struct dentry *dentry) -+{ -+ int err, rerr; -+ aufs_bindex_t bwh; -+ struct path h_path; -+ struct super_block *sb; -+ struct inode *inode, *h_dir; -+ struct dentry *wh; -+ -+ bwh = -1; -+ sb = dir->i_sb; -+ if (wh_dentry) { -+ h_dir = d_inode(wh_dentry->d_parent); /* dir inode is locked */ -+ IMustLock(h_dir); -+ AuDebugOn(au_h_iptr(dir, bindex) != h_dir); -+ bwh = au_dbwh(dentry); -+ h_path.dentry = wh_dentry; -+ h_path.mnt = au_sbr_mnt(sb, bindex); -+ err = au_wh_unlink_dentry(au_h_iptr(dir, bindex), &h_path, -+ dentry); -+ if (unlikely(err)) -+ goto out; -+ } -+ -+ inode = au_new_inode(dentry, /*must_new*/1); -+ if (!IS_ERR(inode)) { -+ d_instantiate(dentry, inode); -+ dir = d_inode(dentry->d_parent); /* dir inode is locked */ -+ IMustLock(dir); -+ au_dir_ts(dir, bindex); -+ dir->i_version++; -+ au_fhsm_wrote(sb, bindex, /*force*/0); -+ return 0; /* success */ -+ } -+ -+ err = PTR_ERR(inode); -+ if (!wh_dentry) -+ goto out; -+ -+ /* revert */ -+ /* dir inode is locked */ -+ wh = au_wh_create(dentry, bwh, wh_dentry->d_parent); -+ rerr = PTR_ERR(wh); -+ if (IS_ERR(wh)) { -+ AuIOErr("%pd reverting whiteout failed(%d, %d)\n", -+ dentry, err, rerr); -+ err = -EIO; -+ } else -+ dput(wh); -+ -+out: -+ return err; -+} -+ -+static int au_d_may_add(struct dentry *dentry) -+{ -+ int err; -+ -+ err = 0; -+ if (unlikely(d_unhashed(dentry))) -+ err = -ENOENT; -+ if (unlikely(d_really_is_positive(dentry))) -+ err = -EEXIST; -+ return err; -+} -+ -+/* -+ * simple tests for the adding inode operations. -+ * following the checks in vfs, plus the parent-child relationship. -+ */ -+int au_may_add(struct dentry *dentry, aufs_bindex_t bindex, -+ struct dentry *h_parent, int isdir) -+{ -+ int err; -+ umode_t h_mode; -+ struct dentry *h_dentry; -+ struct inode *h_inode; -+ -+ err = -ENAMETOOLONG; -+ if (unlikely(dentry->d_name.len > AUFS_MAX_NAMELEN)) -+ goto out; -+ -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (d_really_is_negative(dentry)) { -+ err = -EEXIST; -+ if (unlikely(d_is_positive(h_dentry))) -+ goto out; -+ } else { -+ /* rename(2) case */ -+ err = -EIO; -+ if (unlikely(d_is_negative(h_dentry))) -+ goto out; -+ h_inode = d_inode(h_dentry); -+ if (unlikely(!h_inode->i_nlink)) -+ goto out; -+ -+ h_mode = h_inode->i_mode; -+ if (!isdir) { -+ err = -EISDIR; -+ if (unlikely(S_ISDIR(h_mode))) -+ goto out; -+ } else if (unlikely(!S_ISDIR(h_mode))) { -+ err = -ENOTDIR; -+ goto out; -+ } -+ } -+ -+ err = 0; -+ /* expected parent dir is locked */ -+ if (unlikely(h_parent != h_dentry->d_parent)) -+ err = -EIO; -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* -+ * initial procedure of adding a new entry. -+ * prepare writable branch and the parent dir, lock it, -+ * and lookup whiteout for the new entry. -+ */ -+static struct dentry* -+lock_hdir_lkup_wh(struct dentry *dentry, struct au_dtime *dt, -+ struct dentry *src_dentry, struct au_pin *pin, -+ struct au_wr_dir_args *wr_dir_args) -+{ -+ struct dentry *wh_dentry, *h_parent; -+ struct super_block *sb; -+ struct au_branch *br; -+ int err; -+ unsigned int udba; -+ aufs_bindex_t bcpup; -+ -+ AuDbg("%pd\n", dentry); -+ -+ err = au_wr_dir(dentry, src_dentry, wr_dir_args); -+ bcpup = err; -+ wh_dentry = ERR_PTR(err); -+ if (unlikely(err < 0)) -+ goto out; -+ -+ sb = dentry->d_sb; -+ udba = au_opt_udba(sb); -+ err = au_pin(pin, dentry, bcpup, udba, -+ AuPin_DI_LOCKED | AuPin_MNT_WRITE); -+ wh_dentry = ERR_PTR(err); -+ if (unlikely(err)) -+ goto out; -+ -+ h_parent = au_pinned_h_parent(pin); -+ if (udba != AuOpt_UDBA_NONE -+ && au_dbtop(dentry) == bcpup) -+ err = au_may_add(dentry, bcpup, h_parent, -+ au_ftest_wrdir(wr_dir_args->flags, ISDIR)); -+ else if (unlikely(dentry->d_name.len > AUFS_MAX_NAMELEN)) -+ err = -ENAMETOOLONG; -+ wh_dentry = ERR_PTR(err); -+ if (unlikely(err)) -+ goto out_unpin; -+ -+ br = au_sbr(sb, bcpup); -+ if (dt) { -+ struct path tmp = { -+ .dentry = h_parent, -+ .mnt = au_br_mnt(br) -+ }; -+ au_dtime_store(dt, au_pinned_parent(pin), &tmp); -+ } -+ -+ wh_dentry = NULL; -+ if (bcpup != au_dbwh(dentry)) -+ goto out; /* success */ -+ -+ /* -+ * ENAMETOOLONG here means that if we allowed create such name, then it -+ * would not be able to removed in the future. So we don't allow such -+ * name here and we don't handle ENAMETOOLONG differently here. -+ */ -+ wh_dentry = au_wh_lkup(h_parent, &dentry->d_name, br); -+ -+out_unpin: -+ if (IS_ERR(wh_dentry)) -+ au_unpin(pin); -+out: -+ return wh_dentry; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+enum { Mknod, Symlink, Creat }; -+struct simple_arg { -+ int type; -+ union { -+ struct { -+ umode_t mode; -+ bool want_excl; -+ bool try_aopen; -+ struct vfsub_aopen_args *aopen; -+ } c; -+ struct { -+ const char *symname; -+ } s; -+ struct { -+ umode_t mode; -+ dev_t dev; -+ } m; -+ } u; -+}; -+ -+static int add_simple(struct inode *dir, struct dentry *dentry, -+ struct simple_arg *arg) -+{ -+ int err, rerr; -+ aufs_bindex_t btop; -+ unsigned char created; -+ const unsigned char try_aopen -+ = (arg->type == Creat && arg->u.c.try_aopen); -+ struct dentry *wh_dentry, *parent; -+ struct inode *h_dir; -+ struct super_block *sb; -+ struct au_branch *br; -+ /* to reuduce stack size */ -+ struct { -+ struct au_dtime dt; -+ struct au_pin pin; -+ struct path h_path; -+ struct au_wr_dir_args wr_dir_args; -+ } *a; -+ -+ AuDbg("%pd\n", dentry); -+ IMustLock(dir); -+ -+ err = -ENOMEM; -+ a = kmalloc(sizeof(*a), GFP_NOFS); -+ if (unlikely(!a)) -+ goto out; -+ a->wr_dir_args.force_btgt = -1; -+ a->wr_dir_args.flags = AuWrDir_ADD_ENTRY; -+ -+ parent = dentry->d_parent; /* dir inode is locked */ -+ if (!try_aopen) { -+ err = aufs_read_lock(dentry, AuLock_DW | AuLock_GEN); -+ if (unlikely(err)) -+ goto out_free; -+ } -+ err = au_d_may_add(dentry); -+ if (unlikely(err)) -+ goto out_unlock; -+ if (!try_aopen) -+ di_write_lock_parent(parent); -+ wh_dentry = lock_hdir_lkup_wh(dentry, &a->dt, /*src_dentry*/NULL, -+ &a->pin, &a->wr_dir_args); -+ err = PTR_ERR(wh_dentry); -+ if (IS_ERR(wh_dentry)) -+ goto out_parent; -+ -+ btop = au_dbtop(dentry); -+ sb = dentry->d_sb; -+ br = au_sbr(sb, btop); -+ a->h_path.dentry = au_h_dptr(dentry, btop); -+ a->h_path.mnt = au_br_mnt(br); -+ h_dir = au_pinned_h_dir(&a->pin); -+ switch (arg->type) { -+ case Creat: -+ err = 0; -+ if (!try_aopen || !h_dir->i_op->atomic_open) -+ err = vfsub_create(h_dir, &a->h_path, arg->u.c.mode, -+ arg->u.c.want_excl); -+ else -+ err = vfsub_atomic_open(h_dir, a->h_path.dentry, -+ arg->u.c.aopen, br); -+ break; -+ case Symlink: -+ err = vfsub_symlink(h_dir, &a->h_path, arg->u.s.symname); -+ break; -+ case Mknod: -+ err = vfsub_mknod(h_dir, &a->h_path, arg->u.m.mode, -+ arg->u.m.dev); -+ break; -+ default: -+ BUG(); -+ } -+ created = !err; -+ if (!err) -+ err = epilog(dir, btop, wh_dentry, dentry); -+ -+ /* revert */ -+ if (unlikely(created && err && d_is_positive(a->h_path.dentry))) { -+ /* no delegation since it is just created */ -+ rerr = vfsub_unlink(h_dir, &a->h_path, /*delegated*/NULL, -+ /*force*/0); -+ if (rerr) { -+ AuIOErr("%pd revert failure(%d, %d)\n", -+ dentry, err, rerr); -+ err = -EIO; -+ } -+ au_dtime_revert(&a->dt); -+ } -+ -+ if (!err && try_aopen && !h_dir->i_op->atomic_open) -+ *arg->u.c.aopen->opened |= FILE_CREATED; -+ -+ au_unpin(&a->pin); -+ dput(wh_dentry); -+ -+out_parent: -+ if (!try_aopen) -+ di_write_unlock(parent); -+out_unlock: -+ if (unlikely(err)) { -+ au_update_dbtop(dentry); -+ d_drop(dentry); -+ } -+ if (!try_aopen) -+ aufs_read_unlock(dentry, AuLock_DW); -+out_free: -+ kfree(a); -+out: -+ return err; -+} -+ -+int aufs_mknod(struct inode *dir, struct dentry *dentry, umode_t mode, -+ dev_t dev) -+{ -+ struct simple_arg arg = { -+ .type = Mknod, -+ .u.m = { -+ .mode = mode, -+ .dev = dev -+ } -+ }; -+ return add_simple(dir, dentry, &arg); -+} -+ -+int aufs_symlink(struct inode *dir, struct dentry *dentry, const char *symname) -+{ -+ struct simple_arg arg = { -+ .type = Symlink, -+ .u.s.symname = symname -+ }; -+ return add_simple(dir, dentry, &arg); -+} -+ -+int aufs_create(struct inode *dir, struct dentry *dentry, umode_t mode, -+ bool want_excl) -+{ -+ struct simple_arg arg = { -+ .type = Creat, -+ .u.c = { -+ .mode = mode, -+ .want_excl = want_excl -+ } -+ }; -+ return add_simple(dir, dentry, &arg); -+} -+ -+int au_aopen_or_create(struct inode *dir, struct dentry *dentry, -+ struct vfsub_aopen_args *aopen_args) -+{ -+ struct simple_arg arg = { -+ .type = Creat, -+ .u.c = { -+ .mode = aopen_args->create_mode, -+ .want_excl = aopen_args->open_flag & O_EXCL, -+ .try_aopen = true, -+ .aopen = aopen_args -+ } -+ }; -+ return add_simple(dir, dentry, &arg); -+} -+ -+int aufs_tmpfile(struct inode *dir, struct dentry *dentry, umode_t mode) -+{ -+ int err; -+ aufs_bindex_t bindex; -+ struct super_block *sb; -+ struct dentry *parent, *h_parent, *h_dentry; -+ struct inode *h_dir, *inode; -+ struct vfsmount *h_mnt; -+ struct au_wr_dir_args wr_dir_args = { -+ .force_btgt = -1, -+ .flags = AuWrDir_TMPFILE -+ }; -+ -+ /* copy-up may happen */ -+ inode_lock(dir); -+ -+ sb = dir->i_sb; -+ err = si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLM); -+ if (unlikely(err)) -+ goto out; -+ -+ err = au_di_init(dentry); -+ if (unlikely(err)) -+ goto out_si; -+ -+ err = -EBUSY; -+ parent = d_find_any_alias(dir); -+ AuDebugOn(!parent); -+ di_write_lock_parent(parent); -+ if (unlikely(d_inode(parent) != dir)) -+ goto out_parent; -+ -+ err = au_digen_test(parent, au_sigen(sb)); -+ if (unlikely(err)) -+ goto out_parent; -+ -+ bindex = au_dbtop(parent); -+ au_set_dbtop(dentry, bindex); -+ au_set_dbbot(dentry, bindex); -+ err = au_wr_dir(dentry, /*src_dentry*/NULL, &wr_dir_args); -+ bindex = err; -+ if (unlikely(err < 0)) -+ goto out_parent; -+ -+ err = -EOPNOTSUPP; -+ h_dir = au_h_iptr(dir, bindex); -+ if (unlikely(!h_dir->i_op->tmpfile)) -+ goto out_parent; -+ -+ h_mnt = au_sbr_mnt(sb, bindex); -+ err = vfsub_mnt_want_write(h_mnt); -+ if (unlikely(err)) -+ goto out_parent; -+ -+ h_parent = au_h_dptr(parent, bindex); -+ h_dentry = vfs_tmpfile(h_parent, mode, /*open_flag*/0); -+ if (IS_ERR(h_dentry)) { -+ err = PTR_ERR(h_dentry); -+ goto out_mnt; -+ } -+ -+ au_set_dbtop(dentry, bindex); -+ au_set_dbbot(dentry, bindex); -+ au_set_h_dptr(dentry, bindex, dget(h_dentry)); -+ inode = au_new_inode(dentry, /*must_new*/1); -+ if (IS_ERR(inode)) { -+ err = PTR_ERR(inode); -+ au_set_h_dptr(dentry, bindex, NULL); -+ au_set_dbtop(dentry, -1); -+ au_set_dbbot(dentry, -1); -+ } else { -+ if (!inode->i_nlink) -+ set_nlink(inode, 1); -+ d_tmpfile(dentry, inode); -+ au_di(dentry)->di_tmpfile = 1; -+ -+ /* update without i_mutex */ -+ if (au_ibtop(dir) == au_dbtop(dentry)) -+ au_cpup_attr_timesizes(dir); -+ } -+ dput(h_dentry); -+ -+out_mnt: -+ vfsub_mnt_drop_write(h_mnt); -+out_parent: -+ di_write_unlock(parent); -+ dput(parent); -+ di_write_unlock(dentry); -+ if (unlikely(err)) { -+ au_di_fin(dentry); -+ dentry->d_fsdata = NULL; -+ } -+out_si: -+ si_read_unlock(sb); -+out: -+ inode_unlock(dir); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct au_link_args { -+ aufs_bindex_t bdst, bsrc; -+ struct au_pin pin; -+ struct path h_path; -+ struct dentry *src_parent, *parent; -+}; -+ -+static int au_cpup_before_link(struct dentry *src_dentry, -+ struct au_link_args *a) -+{ -+ int err; -+ struct dentry *h_src_dentry; -+ struct au_cp_generic cpg = { -+ .dentry = src_dentry, -+ .bdst = a->bdst, -+ .bsrc = a->bsrc, -+ .len = -1, -+ .pin = &a->pin, -+ .flags = AuCpup_DTIME | AuCpup_HOPEN /* | AuCpup_KEEPLINO */ -+ }; -+ -+ di_read_lock_parent(a->src_parent, AuLock_IR); -+ err = au_test_and_cpup_dirs(src_dentry, a->bdst); -+ if (unlikely(err)) -+ goto out; -+ -+ h_src_dentry = au_h_dptr(src_dentry, a->bsrc); -+ err = au_pin(&a->pin, src_dentry, a->bdst, -+ au_opt_udba(src_dentry->d_sb), -+ AuPin_DI_LOCKED | AuPin_MNT_WRITE); -+ if (unlikely(err)) -+ goto out; -+ -+ err = au_sio_cpup_simple(&cpg); -+ au_unpin(&a->pin); -+ -+out: -+ di_read_unlock(a->src_parent, AuLock_IR); -+ return err; -+} -+ -+static int au_cpup_or_link(struct dentry *src_dentry, struct dentry *dentry, -+ struct au_link_args *a) -+{ -+ int err; -+ unsigned char plink; -+ aufs_bindex_t bbot; -+ struct dentry *h_src_dentry; -+ struct inode *h_inode, *inode, *delegated; -+ struct super_block *sb; -+ struct file *h_file; -+ -+ plink = 0; -+ h_inode = NULL; -+ sb = src_dentry->d_sb; -+ inode = d_inode(src_dentry); -+ if (au_ibtop(inode) <= a->bdst) -+ h_inode = au_h_iptr(inode, a->bdst); -+ if (!h_inode || !h_inode->i_nlink) { -+ /* copyup src_dentry as the name of dentry. */ -+ bbot = au_dbbot(dentry); -+ if (bbot < a->bsrc) -+ au_set_dbbot(dentry, a->bsrc); -+ au_set_h_dptr(dentry, a->bsrc, -+ dget(au_h_dptr(src_dentry, a->bsrc))); -+ dget(a->h_path.dentry); -+ au_set_h_dptr(dentry, a->bdst, NULL); -+ AuDbg("temporary d_inode...\n"); -+ spin_lock(&dentry->d_lock); -+ dentry->d_inode = d_inode(src_dentry); /* tmp */ -+ spin_unlock(&dentry->d_lock); -+ h_file = au_h_open_pre(dentry, a->bsrc, /*force_wr*/0); -+ if (IS_ERR(h_file)) -+ err = PTR_ERR(h_file); -+ else { -+ struct au_cp_generic cpg = { -+ .dentry = dentry, -+ .bdst = a->bdst, -+ .bsrc = -1, -+ .len = -1, -+ .pin = &a->pin, -+ .flags = AuCpup_KEEPLINO -+ }; -+ err = au_sio_cpup_simple(&cpg); -+ au_h_open_post(dentry, a->bsrc, h_file); -+ if (!err) { -+ dput(a->h_path.dentry); -+ a->h_path.dentry = au_h_dptr(dentry, a->bdst); -+ } else -+ au_set_h_dptr(dentry, a->bdst, -+ a->h_path.dentry); -+ } -+ spin_lock(&dentry->d_lock); -+ dentry->d_inode = NULL; /* restore */ -+ spin_unlock(&dentry->d_lock); -+ AuDbg("temporary d_inode...done\n"); -+ au_set_h_dptr(dentry, a->bsrc, NULL); -+ au_set_dbbot(dentry, bbot); -+ } else { -+ /* the inode of src_dentry already exists on a.bdst branch */ -+ h_src_dentry = d_find_alias(h_inode); -+ if (!h_src_dentry && au_plink_test(inode)) { -+ plink = 1; -+ h_src_dentry = au_plink_lkup(inode, a->bdst); -+ err = PTR_ERR(h_src_dentry); -+ if (IS_ERR(h_src_dentry)) -+ goto out; -+ -+ if (unlikely(d_is_negative(h_src_dentry))) { -+ dput(h_src_dentry); -+ h_src_dentry = NULL; -+ } -+ -+ } -+ if (h_src_dentry) { -+ delegated = NULL; -+ err = vfsub_link(h_src_dentry, au_pinned_h_dir(&a->pin), -+ &a->h_path, &delegated); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal link\n"); -+ iput(delegated); -+ } -+ dput(h_src_dentry); -+ } else { -+ AuIOErr("no dentry found for hi%lu on b%d\n", -+ h_inode->i_ino, a->bdst); -+ err = -EIO; -+ } -+ } -+ -+ if (!err && !plink) -+ au_plink_append(inode, a->bdst, a->h_path.dentry); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+int aufs_link(struct dentry *src_dentry, struct inode *dir, -+ struct dentry *dentry) -+{ -+ int err, rerr; -+ struct au_dtime dt; -+ struct au_link_args *a; -+ struct dentry *wh_dentry, *h_src_dentry; -+ struct inode *inode, *delegated; -+ struct super_block *sb; -+ struct au_wr_dir_args wr_dir_args = { -+ /* .force_btgt = -1, */ -+ .flags = AuWrDir_ADD_ENTRY -+ }; -+ -+ IMustLock(dir); -+ inode = d_inode(src_dentry); -+ IMustLock(inode); -+ -+ err = -ENOMEM; -+ a = kzalloc(sizeof(*a), GFP_NOFS); -+ if (unlikely(!a)) -+ goto out; -+ -+ a->parent = dentry->d_parent; /* dir inode is locked */ -+ err = aufs_read_and_write_lock2(dentry, src_dentry, -+ AuLock_NOPLM | AuLock_GEN); -+ if (unlikely(err)) -+ goto out_kfree; -+ err = au_d_linkable(src_dentry); -+ if (unlikely(err)) -+ goto out_unlock; -+ err = au_d_may_add(dentry); -+ if (unlikely(err)) -+ goto out_unlock; -+ -+ a->src_parent = dget_parent(src_dentry); -+ wr_dir_args.force_btgt = au_ibtop(inode); -+ -+ di_write_lock_parent(a->parent); -+ wr_dir_args.force_btgt = au_wbr(dentry, wr_dir_args.force_btgt); -+ wh_dentry = lock_hdir_lkup_wh(dentry, &dt, src_dentry, &a->pin, -+ &wr_dir_args); -+ err = PTR_ERR(wh_dentry); -+ if (IS_ERR(wh_dentry)) -+ goto out_parent; -+ -+ err = 0; -+ sb = dentry->d_sb; -+ a->bdst = au_dbtop(dentry); -+ a->h_path.dentry = au_h_dptr(dentry, a->bdst); -+ a->h_path.mnt = au_sbr_mnt(sb, a->bdst); -+ a->bsrc = au_ibtop(inode); -+ h_src_dentry = au_h_d_alias(src_dentry, a->bsrc); -+ if (!h_src_dentry && au_di(src_dentry)->di_tmpfile) -+ h_src_dentry = dget(au_hi_wh(inode, a->bsrc)); -+ if (!h_src_dentry) { -+ a->bsrc = au_dbtop(src_dentry); -+ h_src_dentry = au_h_d_alias(src_dentry, a->bsrc); -+ AuDebugOn(!h_src_dentry); -+ } else if (IS_ERR(h_src_dentry)) { -+ err = PTR_ERR(h_src_dentry); -+ goto out_parent; -+ } -+ -+ /* -+ * aufs doesn't touch the credential so -+ * security_dentry_create_files_as() is unnecrssary. -+ */ -+ if (au_opt_test(au_mntflags(sb), PLINK)) { -+ if (a->bdst < a->bsrc -+ /* && h_src_dentry->d_sb != a->h_path.dentry->d_sb */) -+ err = au_cpup_or_link(src_dentry, dentry, a); -+ else { -+ delegated = NULL; -+ err = vfsub_link(h_src_dentry, au_pinned_h_dir(&a->pin), -+ &a->h_path, &delegated); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal link\n"); -+ iput(delegated); -+ } -+ } -+ dput(h_src_dentry); -+ } else { -+ /* -+ * copyup src_dentry to the branch we process, -+ * and then link(2) to it. -+ */ -+ dput(h_src_dentry); -+ if (a->bdst < a->bsrc -+ /* && h_src_dentry->d_sb != a->h_path.dentry->d_sb */) { -+ au_unpin(&a->pin); -+ di_write_unlock(a->parent); -+ err = au_cpup_before_link(src_dentry, a); -+ di_write_lock_parent(a->parent); -+ if (!err) -+ err = au_pin(&a->pin, dentry, a->bdst, -+ au_opt_udba(sb), -+ AuPin_DI_LOCKED | AuPin_MNT_WRITE); -+ if (unlikely(err)) -+ goto out_wh; -+ } -+ if (!err) { -+ h_src_dentry = au_h_dptr(src_dentry, a->bdst); -+ err = -ENOENT; -+ if (h_src_dentry && d_is_positive(h_src_dentry)) { -+ delegated = NULL; -+ err = vfsub_link(h_src_dentry, -+ au_pinned_h_dir(&a->pin), -+ &a->h_path, &delegated); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry" -+ " for NFSv4 delegation" -+ " for an internal link\n"); -+ iput(delegated); -+ } -+ } -+ } -+ } -+ if (unlikely(err)) -+ goto out_unpin; -+ -+ if (wh_dentry) { -+ a->h_path.dentry = wh_dentry; -+ err = au_wh_unlink_dentry(au_pinned_h_dir(&a->pin), &a->h_path, -+ dentry); -+ if (unlikely(err)) -+ goto out_revert; -+ } -+ -+ au_dir_ts(dir, a->bdst); -+ dir->i_version++; -+ inc_nlink(inode); -+ inode->i_ctime = dir->i_ctime; -+ d_instantiate(dentry, au_igrab(inode)); -+ if (d_unhashed(a->h_path.dentry)) -+ /* some filesystem calls d_drop() */ -+ d_drop(dentry); -+ /* some filesystems consume an inode even hardlink */ -+ au_fhsm_wrote(sb, a->bdst, /*force*/0); -+ goto out_unpin; /* success */ -+ -+out_revert: -+ /* no delegation since it is just created */ -+ rerr = vfsub_unlink(au_pinned_h_dir(&a->pin), &a->h_path, -+ /*delegated*/NULL, /*force*/0); -+ if (unlikely(rerr)) { -+ AuIOErr("%pd reverting failed(%d, %d)\n", dentry, err, rerr); -+ err = -EIO; -+ } -+ au_dtime_revert(&dt); -+out_unpin: -+ au_unpin(&a->pin); -+out_wh: -+ dput(wh_dentry); -+out_parent: -+ di_write_unlock(a->parent); -+ dput(a->src_parent); -+out_unlock: -+ if (unlikely(err)) { -+ au_update_dbtop(dentry); -+ d_drop(dentry); -+ } -+ aufs_read_and_write_unlock2(dentry, src_dentry); -+out_kfree: -+ kfree(a); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+int aufs_mkdir(struct inode *dir, struct dentry *dentry, umode_t mode) -+{ -+ int err, rerr; -+ aufs_bindex_t bindex; -+ unsigned char diropq; -+ struct path h_path; -+ struct dentry *wh_dentry, *parent, *opq_dentry; -+ struct inode *h_inode; -+ struct super_block *sb; -+ struct { -+ struct au_pin pin; -+ struct au_dtime dt; -+ } *a; /* reduce the stack usage */ -+ struct au_wr_dir_args wr_dir_args = { -+ .force_btgt = -1, -+ .flags = AuWrDir_ADD_ENTRY | AuWrDir_ISDIR -+ }; -+ -+ IMustLock(dir); -+ -+ err = -ENOMEM; -+ a = kmalloc(sizeof(*a), GFP_NOFS); -+ if (unlikely(!a)) -+ goto out; -+ -+ err = aufs_read_lock(dentry, AuLock_DW | AuLock_GEN); -+ if (unlikely(err)) -+ goto out_free; -+ err = au_d_may_add(dentry); -+ if (unlikely(err)) -+ goto out_unlock; -+ -+ parent = dentry->d_parent; /* dir inode is locked */ -+ di_write_lock_parent(parent); -+ wh_dentry = lock_hdir_lkup_wh(dentry, &a->dt, /*src_dentry*/NULL, -+ &a->pin, &wr_dir_args); -+ err = PTR_ERR(wh_dentry); -+ if (IS_ERR(wh_dentry)) -+ goto out_parent; -+ -+ sb = dentry->d_sb; -+ bindex = au_dbtop(dentry); -+ h_path.dentry = au_h_dptr(dentry, bindex); -+ h_path.mnt = au_sbr_mnt(sb, bindex); -+ err = vfsub_mkdir(au_pinned_h_dir(&a->pin), &h_path, mode); -+ if (unlikely(err)) -+ goto out_unpin; -+ -+ /* make the dir opaque */ -+ diropq = 0; -+ h_inode = d_inode(h_path.dentry); -+ if (wh_dentry -+ || au_opt_test(au_mntflags(sb), ALWAYS_DIROPQ)) { -+ inode_lock_nested(h_inode, AuLsc_I_CHILD); -+ opq_dentry = au_diropq_create(dentry, bindex); -+ inode_unlock(h_inode); -+ err = PTR_ERR(opq_dentry); -+ if (IS_ERR(opq_dentry)) -+ goto out_dir; -+ dput(opq_dentry); -+ diropq = 1; -+ } -+ -+ err = epilog(dir, bindex, wh_dentry, dentry); -+ if (!err) { -+ inc_nlink(dir); -+ goto out_unpin; /* success */ -+ } -+ -+ /* revert */ -+ if (diropq) { -+ AuLabel(revert opq); -+ inode_lock_nested(h_inode, AuLsc_I_CHILD); -+ rerr = au_diropq_remove(dentry, bindex); -+ inode_unlock(h_inode); -+ if (rerr) { -+ AuIOErr("%pd reverting diropq failed(%d, %d)\n", -+ dentry, err, rerr); -+ err = -EIO; -+ } -+ } -+ -+out_dir: -+ AuLabel(revert dir); -+ rerr = vfsub_rmdir(au_pinned_h_dir(&a->pin), &h_path); -+ if (rerr) { -+ AuIOErr("%pd reverting dir failed(%d, %d)\n", -+ dentry, err, rerr); -+ err = -EIO; -+ } -+ au_dtime_revert(&a->dt); -+out_unpin: -+ au_unpin(&a->pin); -+ dput(wh_dentry); -+out_parent: -+ di_write_unlock(parent); -+out_unlock: -+ if (unlikely(err)) { -+ au_update_dbtop(dentry); -+ d_drop(dentry); -+ } -+ aufs_read_unlock(dentry, AuLock_DW); -+out_free: -+ kfree(a); -+out: -+ return err; -+} -diff --git a/fs/aufs/i_op_del.c b/fs/aufs/i_op_del.c -new file mode 100644 -index 000000000000..4a22fbcfc348 ---- /dev/null -+++ b/fs/aufs/i_op_del.c -@@ -0,0 +1,499 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * inode operations (del entry) -+ */ -+ -+#include "aufs.h" -+ -+/* -+ * decide if a new whiteout for @dentry is necessary or not. -+ * when it is necessary, prepare the parent dir for the upper branch whose -+ * branch index is @bcpup for creation. the actual creation of the whiteout will -+ * be done by caller. -+ * return value: -+ * 0: wh is unnecessary -+ * plus: wh is necessary -+ * minus: error -+ */ -+int au_wr_dir_need_wh(struct dentry *dentry, int isdir, aufs_bindex_t *bcpup) -+{ -+ int need_wh, err; -+ aufs_bindex_t btop; -+ struct super_block *sb; -+ -+ sb = dentry->d_sb; -+ btop = au_dbtop(dentry); -+ if (*bcpup < 0) { -+ *bcpup = btop; -+ if (au_test_ro(sb, btop, d_inode(dentry))) { -+ err = AuWbrCopyup(au_sbi(sb), dentry); -+ *bcpup = err; -+ if (unlikely(err < 0)) -+ goto out; -+ } -+ } else -+ AuDebugOn(btop < *bcpup -+ || au_test_ro(sb, *bcpup, d_inode(dentry))); -+ AuDbg("bcpup %d, btop %d\n", *bcpup, btop); -+ -+ if (*bcpup != btop) { -+ err = au_cpup_dirs(dentry, *bcpup); -+ if (unlikely(err)) -+ goto out; -+ need_wh = 1; -+ } else { -+ struct au_dinfo *dinfo, *tmp; -+ -+ need_wh = -ENOMEM; -+ dinfo = au_di(dentry); -+ tmp = au_di_alloc(sb, AuLsc_DI_TMP); -+ if (tmp) { -+ au_di_cp(tmp, dinfo); -+ au_di_swap(tmp, dinfo); -+ /* returns the number of positive dentries */ -+ need_wh = au_lkup_dentry(dentry, btop + 1, -+ /* AuLkup_IGNORE_PERM */ 0); -+ au_di_swap(tmp, dinfo); -+ au_rw_write_unlock(&tmp->di_rwsem); -+ au_di_free(tmp); -+ } -+ } -+ AuDbg("need_wh %d\n", need_wh); -+ err = need_wh; -+ -+out: -+ return err; -+} -+ -+/* -+ * simple tests for the del-entry operations. -+ * following the checks in vfs, plus the parent-child relationship. -+ */ -+int au_may_del(struct dentry *dentry, aufs_bindex_t bindex, -+ struct dentry *h_parent, int isdir) -+{ -+ int err; -+ umode_t h_mode; -+ struct dentry *h_dentry, *h_latest; -+ struct inode *h_inode; -+ -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (d_really_is_positive(dentry)) { -+ err = -ENOENT; -+ if (unlikely(d_is_negative(h_dentry))) -+ goto out; -+ h_inode = d_inode(h_dentry); -+ if (unlikely(!h_inode->i_nlink)) -+ goto out; -+ -+ h_mode = h_inode->i_mode; -+ if (!isdir) { -+ err = -EISDIR; -+ if (unlikely(S_ISDIR(h_mode))) -+ goto out; -+ } else if (unlikely(!S_ISDIR(h_mode))) { -+ err = -ENOTDIR; -+ goto out; -+ } -+ } else { -+ /* rename(2) case */ -+ err = -EIO; -+ if (unlikely(d_is_positive(h_dentry))) -+ goto out; -+ } -+ -+ err = -ENOENT; -+ /* expected parent dir is locked */ -+ if (unlikely(h_parent != h_dentry->d_parent)) -+ goto out; -+ err = 0; -+ -+ /* -+ * rmdir a dir may break the consistency on some filesystem. -+ * let's try heavy test. -+ */ -+ err = -EACCES; -+ if (unlikely(!au_opt_test(au_mntflags(dentry->d_sb), DIRPERM1) -+ && au_test_h_perm(d_inode(h_parent), -+ MAY_EXEC | MAY_WRITE))) -+ goto out; -+ -+ h_latest = au_sio_lkup_one(&dentry->d_name, h_parent); -+ err = -EIO; -+ if (IS_ERR(h_latest)) -+ goto out; -+ if (h_latest == h_dentry) -+ err = 0; -+ dput(h_latest); -+ -+out: -+ return err; -+} -+ -+/* -+ * decide the branch where we operate for @dentry. the branch index will be set -+ * @rbcpup. after diciding it, 'pin' it and store the timestamps of the parent -+ * dir for reverting. -+ * when a new whiteout is necessary, create it. -+ */ -+static struct dentry* -+lock_hdir_create_wh(struct dentry *dentry, int isdir, aufs_bindex_t *rbcpup, -+ struct au_dtime *dt, struct au_pin *pin) -+{ -+ struct dentry *wh_dentry; -+ struct super_block *sb; -+ struct path h_path; -+ int err, need_wh; -+ unsigned int udba; -+ aufs_bindex_t bcpup; -+ -+ need_wh = au_wr_dir_need_wh(dentry, isdir, rbcpup); -+ wh_dentry = ERR_PTR(need_wh); -+ if (unlikely(need_wh < 0)) -+ goto out; -+ -+ sb = dentry->d_sb; -+ udba = au_opt_udba(sb); -+ bcpup = *rbcpup; -+ err = au_pin(pin, dentry, bcpup, udba, -+ AuPin_DI_LOCKED | AuPin_MNT_WRITE); -+ wh_dentry = ERR_PTR(err); -+ if (unlikely(err)) -+ goto out; -+ -+ h_path.dentry = au_pinned_h_parent(pin); -+ if (udba != AuOpt_UDBA_NONE -+ && au_dbtop(dentry) == bcpup) { -+ err = au_may_del(dentry, bcpup, h_path.dentry, isdir); -+ wh_dentry = ERR_PTR(err); -+ if (unlikely(err)) -+ goto out_unpin; -+ } -+ -+ h_path.mnt = au_sbr_mnt(sb, bcpup); -+ au_dtime_store(dt, au_pinned_parent(pin), &h_path); -+ wh_dentry = NULL; -+ if (!need_wh) -+ goto out; /* success, no need to create whiteout */ -+ -+ wh_dentry = au_wh_create(dentry, bcpup, h_path.dentry); -+ if (IS_ERR(wh_dentry)) -+ goto out_unpin; -+ -+ /* returns with the parent is locked and wh_dentry is dget-ed */ -+ goto out; /* success */ -+ -+out_unpin: -+ au_unpin(pin); -+out: -+ return wh_dentry; -+} -+ -+/* -+ * when removing a dir, rename it to a unique temporary whiteout-ed name first -+ * in order to be revertible and save time for removing many child whiteouts -+ * under the dir. -+ * returns 1 when there are too many child whiteout and caller should remove -+ * them asynchronously. returns 0 when the number of children is enough small to -+ * remove now or the branch fs is a remote fs. -+ * otherwise return an error. -+ */ -+static int renwh_and_rmdir(struct dentry *dentry, aufs_bindex_t bindex, -+ struct au_nhash *whlist, struct inode *dir) -+{ -+ int rmdir_later, err, dirwh; -+ struct dentry *h_dentry; -+ struct super_block *sb; -+ struct inode *inode; -+ -+ sb = dentry->d_sb; -+ SiMustAnyLock(sb); -+ h_dentry = au_h_dptr(dentry, bindex); -+ err = au_whtmp_ren(h_dentry, au_sbr(sb, bindex)); -+ if (unlikely(err)) -+ goto out; -+ -+ /* stop monitoring */ -+ inode = d_inode(dentry); -+ au_hn_free(au_hi(inode, bindex)); -+ -+ if (!au_test_fs_remote(h_dentry->d_sb)) { -+ dirwh = au_sbi(sb)->si_dirwh; -+ rmdir_later = (dirwh <= 1); -+ if (!rmdir_later) -+ rmdir_later = au_nhash_test_longer_wh(whlist, bindex, -+ dirwh); -+ if (rmdir_later) -+ return rmdir_later; -+ } -+ -+ err = au_whtmp_rmdir(dir, bindex, h_dentry, whlist); -+ if (unlikely(err)) { -+ AuIOErr("rmdir %pd, b%d failed, %d. ignored\n", -+ h_dentry, bindex, err); -+ err = 0; -+ } -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* -+ * final procedure for deleting a entry. -+ * maintain dentry and iattr. -+ */ -+static void epilog(struct inode *dir, struct dentry *dentry, -+ aufs_bindex_t bindex) -+{ -+ struct inode *inode; -+ -+ inode = d_inode(dentry); -+ d_drop(dentry); -+ inode->i_ctime = dir->i_ctime; -+ -+ au_dir_ts(dir, bindex); -+ dir->i_version++; -+} -+ -+/* -+ * when an error happened, remove the created whiteout and revert everything. -+ */ -+static int do_revert(int err, struct inode *dir, aufs_bindex_t bindex, -+ aufs_bindex_t bwh, struct dentry *wh_dentry, -+ struct dentry *dentry, struct au_dtime *dt) -+{ -+ int rerr; -+ struct path h_path = { -+ .dentry = wh_dentry, -+ .mnt = au_sbr_mnt(dir->i_sb, bindex) -+ }; -+ -+ rerr = au_wh_unlink_dentry(au_h_iptr(dir, bindex), &h_path, dentry); -+ if (!rerr) { -+ au_set_dbwh(dentry, bwh); -+ au_dtime_revert(dt); -+ return 0; -+ } -+ -+ AuIOErr("%pd reverting whiteout failed(%d, %d)\n", dentry, err, rerr); -+ return -EIO; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int aufs_unlink(struct inode *dir, struct dentry *dentry) -+{ -+ int err; -+ aufs_bindex_t bwh, bindex, btop; -+ struct inode *inode, *h_dir, *delegated; -+ struct dentry *parent, *wh_dentry; -+ /* to reuduce stack size */ -+ struct { -+ struct au_dtime dt; -+ struct au_pin pin; -+ struct path h_path; -+ } *a; -+ -+ IMustLock(dir); -+ -+ err = -ENOMEM; -+ a = kmalloc(sizeof(*a), GFP_NOFS); -+ if (unlikely(!a)) -+ goto out; -+ -+ err = aufs_read_lock(dentry, AuLock_DW | AuLock_GEN); -+ if (unlikely(err)) -+ goto out_free; -+ err = au_d_hashed_positive(dentry); -+ if (unlikely(err)) -+ goto out_unlock; -+ inode = d_inode(dentry); -+ IMustLock(inode); -+ err = -EISDIR; -+ if (unlikely(d_is_dir(dentry))) -+ goto out_unlock; /* possible? */ -+ -+ btop = au_dbtop(dentry); -+ bwh = au_dbwh(dentry); -+ bindex = -1; -+ parent = dentry->d_parent; /* dir inode is locked */ -+ di_write_lock_parent(parent); -+ wh_dentry = lock_hdir_create_wh(dentry, /*isdir*/0, &bindex, &a->dt, -+ &a->pin); -+ err = PTR_ERR(wh_dentry); -+ if (IS_ERR(wh_dentry)) -+ goto out_parent; -+ -+ a->h_path.mnt = au_sbr_mnt(dentry->d_sb, btop); -+ a->h_path.dentry = au_h_dptr(dentry, btop); -+ dget(a->h_path.dentry); -+ if (bindex == btop) { -+ h_dir = au_pinned_h_dir(&a->pin); -+ delegated = NULL; -+ err = vfsub_unlink(h_dir, &a->h_path, &delegated, /*force*/0); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal unlink\n"); -+ iput(delegated); -+ } -+ } else { -+ /* dir inode is locked */ -+ h_dir = d_inode(wh_dentry->d_parent); -+ IMustLock(h_dir); -+ err = 0; -+ } -+ -+ if (!err) { -+ vfsub_drop_nlink(inode); -+ epilog(dir, dentry, bindex); -+ -+ /* update target timestamps */ -+ if (bindex == btop) { -+ vfsub_update_h_iattr(&a->h_path, /*did*/NULL); -+ /*ignore*/ -+ inode->i_ctime = d_inode(a->h_path.dentry)->i_ctime; -+ } else -+ /* todo: this timestamp may be reverted later */ -+ inode->i_ctime = h_dir->i_ctime; -+ goto out_unpin; /* success */ -+ } -+ -+ /* revert */ -+ if (wh_dentry) { -+ int rerr; -+ -+ rerr = do_revert(err, dir, bindex, bwh, wh_dentry, dentry, -+ &a->dt); -+ if (rerr) -+ err = rerr; -+ } -+ -+out_unpin: -+ au_unpin(&a->pin); -+ dput(wh_dentry); -+ dput(a->h_path.dentry); -+out_parent: -+ di_write_unlock(parent); -+out_unlock: -+ aufs_read_unlock(dentry, AuLock_DW); -+out_free: -+ kfree(a); -+out: -+ return err; -+} -+ -+int aufs_rmdir(struct inode *dir, struct dentry *dentry) -+{ -+ int err, rmdir_later; -+ aufs_bindex_t bwh, bindex, btop; -+ struct inode *inode; -+ struct dentry *parent, *wh_dentry, *h_dentry; -+ struct au_whtmp_rmdir *args; -+ /* to reuduce stack size */ -+ struct { -+ struct au_dtime dt; -+ struct au_pin pin; -+ } *a; -+ -+ IMustLock(dir); -+ -+ err = -ENOMEM; -+ a = kmalloc(sizeof(*a), GFP_NOFS); -+ if (unlikely(!a)) -+ goto out; -+ -+ err = aufs_read_lock(dentry, AuLock_DW | AuLock_FLUSH | AuLock_GEN); -+ if (unlikely(err)) -+ goto out_free; -+ err = au_alive_dir(dentry); -+ if (unlikely(err)) -+ goto out_unlock; -+ inode = d_inode(dentry); -+ IMustLock(inode); -+ err = -ENOTDIR; -+ if (unlikely(!d_is_dir(dentry))) -+ goto out_unlock; /* possible? */ -+ -+ err = -ENOMEM; -+ args = au_whtmp_rmdir_alloc(dir->i_sb, GFP_NOFS); -+ if (unlikely(!args)) -+ goto out_unlock; -+ -+ parent = dentry->d_parent; /* dir inode is locked */ -+ di_write_lock_parent(parent); -+ err = au_test_empty(dentry, &args->whlist); -+ if (unlikely(err)) -+ goto out_parent; -+ -+ btop = au_dbtop(dentry); -+ bwh = au_dbwh(dentry); -+ bindex = -1; -+ wh_dentry = lock_hdir_create_wh(dentry, /*isdir*/1, &bindex, &a->dt, -+ &a->pin); -+ err = PTR_ERR(wh_dentry); -+ if (IS_ERR(wh_dentry)) -+ goto out_parent; -+ -+ h_dentry = au_h_dptr(dentry, btop); -+ dget(h_dentry); -+ rmdir_later = 0; -+ if (bindex == btop) { -+ err = renwh_and_rmdir(dentry, btop, &args->whlist, dir); -+ if (err > 0) { -+ rmdir_later = err; -+ err = 0; -+ } -+ } else { -+ /* stop monitoring */ -+ au_hn_free(au_hi(inode, btop)); -+ -+ /* dir inode is locked */ -+ IMustLock(d_inode(wh_dentry->d_parent)); -+ err = 0; -+ } -+ -+ if (!err) { -+ vfsub_dead_dir(inode); -+ au_set_dbdiropq(dentry, -1); -+ epilog(dir, dentry, bindex); -+ -+ if (rmdir_later) { -+ au_whtmp_kick_rmdir(dir, btop, h_dentry, args); -+ args = NULL; -+ } -+ -+ goto out_unpin; /* success */ -+ } -+ -+ /* revert */ -+ AuLabel(revert); -+ if (wh_dentry) { -+ int rerr; -+ -+ rerr = do_revert(err, dir, bindex, bwh, wh_dentry, dentry, -+ &a->dt); -+ if (rerr) -+ err = rerr; -+ } -+ -+out_unpin: -+ au_unpin(&a->pin); -+ dput(wh_dentry); -+ dput(h_dentry); -+out_parent: -+ di_write_unlock(parent); -+ if (args) -+ au_whtmp_rmdir_free(args); -+out_unlock: -+ aufs_read_unlock(dentry, AuLock_DW); -+out_free: -+ kfree(a); -+out: -+ AuTraceErr(err); -+ return err; -+} -diff --git a/fs/aufs/i_op_ren.c b/fs/aufs/i_op_ren.c -new file mode 100644 -index 000000000000..7071c57d3d63 ---- /dev/null -+++ b/fs/aufs/i_op_ren.c -@@ -0,0 +1,1234 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * inode operation (rename entry) -+ * todo: this is crazy monster -+ */ -+ -+#include "aufs.h" -+ -+enum { AuSRC, AuDST, AuSrcDst }; -+enum { AuPARENT, AuCHILD, AuParentChild }; -+ -+#define AuRen_ISDIR_SRC 1 -+#define AuRen_ISDIR_DST (1 << 1) -+#define AuRen_ISSAMEDIR (1 << 2) -+#define AuRen_WHSRC (1 << 3) -+#define AuRen_WHDST (1 << 4) -+#define AuRen_MNT_WRITE (1 << 5) -+#define AuRen_DT_DSTDIR (1 << 6) -+#define AuRen_DIROPQ_SRC (1 << 7) -+#define AuRen_DIROPQ_DST (1 << 8) -+#define AuRen_DIRREN (1 << 9) -+#define AuRen_DROPPED_SRC (1 << 10) -+#define AuRen_DROPPED_DST (1 << 11) -+#define au_ftest_ren(flags, name) ((flags) & AuRen_##name) -+#define au_fset_ren(flags, name) \ -+ do { (flags) |= AuRen_##name; } while (0) -+#define au_fclr_ren(flags, name) \ -+ do { (flags) &= ~AuRen_##name; } while (0) -+ -+#ifndef CONFIG_AUFS_DIRREN -+#undef AuRen_DIRREN -+#define AuRen_DIRREN 0 -+#endif -+ -+struct au_ren_args { -+ struct { -+ struct dentry *dentry, *h_dentry, *parent, *h_parent, -+ *wh_dentry; -+ struct inode *dir, *inode; -+ struct au_hinode *hdir, *hinode; -+ struct au_dtime dt[AuParentChild]; -+ aufs_bindex_t btop, bdiropq; -+ } sd[AuSrcDst]; -+ -+#define src_dentry sd[AuSRC].dentry -+#define src_dir sd[AuSRC].dir -+#define src_inode sd[AuSRC].inode -+#define src_h_dentry sd[AuSRC].h_dentry -+#define src_parent sd[AuSRC].parent -+#define src_h_parent sd[AuSRC].h_parent -+#define src_wh_dentry sd[AuSRC].wh_dentry -+#define src_hdir sd[AuSRC].hdir -+#define src_hinode sd[AuSRC].hinode -+#define src_h_dir sd[AuSRC].hdir->hi_inode -+#define src_dt sd[AuSRC].dt -+#define src_btop sd[AuSRC].btop -+#define src_bdiropq sd[AuSRC].bdiropq -+ -+#define dst_dentry sd[AuDST].dentry -+#define dst_dir sd[AuDST].dir -+#define dst_inode sd[AuDST].inode -+#define dst_h_dentry sd[AuDST].h_dentry -+#define dst_parent sd[AuDST].parent -+#define dst_h_parent sd[AuDST].h_parent -+#define dst_wh_dentry sd[AuDST].wh_dentry -+#define dst_hdir sd[AuDST].hdir -+#define dst_hinode sd[AuDST].hinode -+#define dst_h_dir sd[AuDST].hdir->hi_inode -+#define dst_dt sd[AuDST].dt -+#define dst_btop sd[AuDST].btop -+#define dst_bdiropq sd[AuDST].bdiropq -+ -+ struct dentry *h_trap; -+ struct au_branch *br; -+ struct path h_path; -+ struct au_nhash whlist; -+ aufs_bindex_t btgt, src_bwh; -+ -+ struct { -+ unsigned short auren_flags; -+ unsigned char flags; /* syscall parameter */ -+ unsigned char exchange; -+ } __packed; -+ -+ struct au_whtmp_rmdir *thargs; -+ struct dentry *h_dst; -+ struct au_hinode *h_root; -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * functions for reverting. -+ * when an error happened in a single rename systemcall, we should revert -+ * everything as if nothing happened. -+ * we don't need to revert the copied-up/down the parent dir since they are -+ * harmless. -+ */ -+ -+#define RevertFailure(fmt, ...) do { \ -+ AuIOErr("revert failure: " fmt " (%d, %d)\n", \ -+ ##__VA_ARGS__, err, rerr); \ -+ err = -EIO; \ -+} while (0) -+ -+static void au_ren_do_rev_diropq(int err, struct au_ren_args *a, int idx) -+{ -+ int rerr; -+ struct dentry *d; -+#define src_or_dst(member) a->sd[idx].member -+ -+ d = src_or_dst(dentry); /* {src,dst}_dentry */ -+ au_hn_inode_lock_nested(src_or_dst(hinode), AuLsc_I_CHILD); -+ rerr = au_diropq_remove(d, a->btgt); -+ au_hn_inode_unlock(src_or_dst(hinode)); -+ au_set_dbdiropq(d, src_or_dst(bdiropq)); -+ if (rerr) -+ RevertFailure("remove diropq %pd", d); -+ -+#undef src_or_dst_ -+} -+ -+static void au_ren_rev_diropq(int err, struct au_ren_args *a) -+{ -+ if (au_ftest_ren(a->auren_flags, DIROPQ_SRC)) -+ au_ren_do_rev_diropq(err, a, AuSRC); -+ if (au_ftest_ren(a->auren_flags, DIROPQ_DST)) -+ au_ren_do_rev_diropq(err, a, AuDST); -+} -+ -+static void au_ren_rev_rename(int err, struct au_ren_args *a) -+{ -+ int rerr; -+ struct inode *delegated; -+ -+ a->h_path.dentry = vfsub_lkup_one(&a->src_dentry->d_name, -+ a->src_h_parent); -+ rerr = PTR_ERR(a->h_path.dentry); -+ if (IS_ERR(a->h_path.dentry)) { -+ RevertFailure("lkup one %pd", a->src_dentry); -+ return; -+ } -+ -+ delegated = NULL; -+ rerr = vfsub_rename(a->dst_h_dir, -+ au_h_dptr(a->src_dentry, a->btgt), -+ a->src_h_dir, &a->h_path, &delegated, a->flags); -+ if (unlikely(rerr == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal rename\n"); -+ iput(delegated); -+ } -+ d_drop(a->h_path.dentry); -+ dput(a->h_path.dentry); -+ /* au_set_h_dptr(a->src_dentry, a->btgt, NULL); */ -+ if (rerr) -+ RevertFailure("rename %pd", a->src_dentry); -+} -+ -+static void au_ren_rev_whtmp(int err, struct au_ren_args *a) -+{ -+ int rerr; -+ struct inode *delegated; -+ -+ a->h_path.dentry = vfsub_lkup_one(&a->dst_dentry->d_name, -+ a->dst_h_parent); -+ rerr = PTR_ERR(a->h_path.dentry); -+ if (IS_ERR(a->h_path.dentry)) { -+ RevertFailure("lkup one %pd", a->dst_dentry); -+ return; -+ } -+ if (d_is_positive(a->h_path.dentry)) { -+ d_drop(a->h_path.dentry); -+ dput(a->h_path.dentry); -+ return; -+ } -+ -+ delegated = NULL; -+ rerr = vfsub_rename(a->dst_h_dir, a->h_dst, a->dst_h_dir, &a->h_path, -+ &delegated, a->flags); -+ if (unlikely(rerr == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal rename\n"); -+ iput(delegated); -+ } -+ d_drop(a->h_path.dentry); -+ dput(a->h_path.dentry); -+ if (!rerr) -+ au_set_h_dptr(a->dst_dentry, a->btgt, dget(a->h_dst)); -+ else -+ RevertFailure("rename %pd", a->h_dst); -+} -+ -+static void au_ren_rev_whsrc(int err, struct au_ren_args *a) -+{ -+ int rerr; -+ -+ a->h_path.dentry = a->src_wh_dentry; -+ rerr = au_wh_unlink_dentry(a->src_h_dir, &a->h_path, a->src_dentry); -+ au_set_dbwh(a->src_dentry, a->src_bwh); -+ if (rerr) -+ RevertFailure("unlink %pd", a->src_wh_dentry); -+} -+#undef RevertFailure -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * when we have to copyup the renaming entry, do it with the rename-target name -+ * in order to minimize the cost (the later actual rename is unnecessary). -+ * otherwise rename it on the target branch. -+ */ -+static int au_ren_or_cpup(struct au_ren_args *a) -+{ -+ int err; -+ struct dentry *d; -+ struct inode *delegated; -+ -+ d = a->src_dentry; -+ if (au_dbtop(d) == a->btgt) { -+ a->h_path.dentry = a->dst_h_dentry; -+ AuDebugOn(au_dbtop(d) != a->btgt); -+ delegated = NULL; -+ err = vfsub_rename(a->src_h_dir, au_h_dptr(d, a->btgt), -+ a->dst_h_dir, &a->h_path, &delegated, -+ a->flags); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal rename\n"); -+ iput(delegated); -+ } -+ } else -+ BUG(); -+ -+ if (!err && a->h_dst) -+ /* it will be set to dinfo later */ -+ dget(a->h_dst); -+ -+ return err; -+} -+ -+/* cf. aufs_rmdir() */ -+static int au_ren_del_whtmp(struct au_ren_args *a) -+{ -+ int err; -+ struct inode *dir; -+ -+ dir = a->dst_dir; -+ SiMustAnyLock(dir->i_sb); -+ if (!au_nhash_test_longer_wh(&a->whlist, a->btgt, -+ au_sbi(dir->i_sb)->si_dirwh) -+ || au_test_fs_remote(a->h_dst->d_sb)) { -+ err = au_whtmp_rmdir(dir, a->btgt, a->h_dst, &a->whlist); -+ if (unlikely(err)) -+ pr_warn("failed removing whtmp dir %pd (%d), " -+ "ignored.\n", a->h_dst, err); -+ } else { -+ au_nhash_wh_free(&a->thargs->whlist); -+ a->thargs->whlist = a->whlist; -+ a->whlist.nh_num = 0; -+ au_whtmp_kick_rmdir(dir, a->btgt, a->h_dst, a->thargs); -+ dput(a->h_dst); -+ a->thargs = NULL; -+ } -+ -+ return 0; -+} -+ -+/* make it 'opaque' dir. */ -+static int au_ren_do_diropq(struct au_ren_args *a, int idx) -+{ -+ int err; -+ struct dentry *d, *diropq; -+#define src_or_dst(member) a->sd[idx].member -+ -+ err = 0; -+ d = src_or_dst(dentry); /* {src,dst}_dentry */ -+ src_or_dst(bdiropq) = au_dbdiropq(d); -+ src_or_dst(hinode) = au_hi(src_or_dst(inode), a->btgt); -+ au_hn_inode_lock_nested(src_or_dst(hinode), AuLsc_I_CHILD); -+ diropq = au_diropq_create(d, a->btgt); -+ au_hn_inode_unlock(src_or_dst(hinode)); -+ if (IS_ERR(diropq)) -+ err = PTR_ERR(diropq); -+ else -+ dput(diropq); -+ -+#undef src_or_dst_ -+ return err; -+} -+ -+static int au_ren_diropq(struct au_ren_args *a) -+{ -+ int err; -+ unsigned char always; -+ struct dentry *d; -+ -+ err = 0; -+ d = a->dst_dentry; /* already renamed on the branch */ -+ always = !!au_opt_test(au_mntflags(d->d_sb), ALWAYS_DIROPQ); -+ if (au_ftest_ren(a->auren_flags, ISDIR_SRC) -+ && !au_ftest_ren(a->auren_flags, DIRREN) -+ && a->btgt != au_dbdiropq(a->src_dentry) -+ && (a->dst_wh_dentry -+ || a->btgt <= au_dbdiropq(d) -+ /* hide the lower to keep xino */ -+ /* the lowers may not be a dir, but we hide them anyway */ -+ || a->btgt < au_dbbot(d) -+ || always)) { -+ AuDbg("here\n"); -+ err = au_ren_do_diropq(a, AuSRC); -+ if (unlikely(err)) -+ goto out; -+ au_fset_ren(a->auren_flags, DIROPQ_SRC); -+ } -+ if (!a->exchange) -+ goto out; /* success */ -+ -+ d = a->src_dentry; /* already renamed on the branch */ -+ if (au_ftest_ren(a->auren_flags, ISDIR_DST) -+ && a->btgt != au_dbdiropq(a->dst_dentry) -+ && (a->btgt < au_dbdiropq(d) -+ || a->btgt < au_dbbot(d) -+ || always)) { -+ AuDbgDentry(a->src_dentry); -+ AuDbgDentry(a->dst_dentry); -+ err = au_ren_do_diropq(a, AuDST); -+ if (unlikely(err)) -+ goto out_rev_src; -+ au_fset_ren(a->auren_flags, DIROPQ_DST); -+ } -+ goto out; /* success */ -+ -+out_rev_src: -+ AuDbg("err %d, reverting src\n", err); -+ au_ren_rev_diropq(err, a); -+out: -+ return err; -+} -+ -+static int do_rename(struct au_ren_args *a) -+{ -+ int err; -+ struct dentry *d, *h_d; -+ -+ if (!a->exchange) { -+ /* prepare workqueue args for asynchronous rmdir */ -+ h_d = a->dst_h_dentry; -+ if (au_ftest_ren(a->auren_flags, ISDIR_DST) -+ /* && !au_ftest_ren(a->auren_flags, DIRREN) */ -+ && d_is_positive(h_d)) { -+ err = -ENOMEM; -+ a->thargs = au_whtmp_rmdir_alloc(a->src_dentry->d_sb, -+ GFP_NOFS); -+ if (unlikely(!a->thargs)) -+ goto out; -+ a->h_dst = dget(h_d); -+ } -+ -+ /* create whiteout for src_dentry */ -+ if (au_ftest_ren(a->auren_flags, WHSRC)) { -+ a->src_bwh = au_dbwh(a->src_dentry); -+ AuDebugOn(a->src_bwh >= 0); -+ a->src_wh_dentry = au_wh_create(a->src_dentry, a->btgt, -+ a->src_h_parent); -+ err = PTR_ERR(a->src_wh_dentry); -+ if (IS_ERR(a->src_wh_dentry)) -+ goto out_thargs; -+ } -+ -+ /* lookup whiteout for dentry */ -+ if (au_ftest_ren(a->auren_flags, WHDST)) { -+ h_d = au_wh_lkup(a->dst_h_parent, -+ &a->dst_dentry->d_name, a->br); -+ err = PTR_ERR(h_d); -+ if (IS_ERR(h_d)) -+ goto out_whsrc; -+ if (d_is_negative(h_d)) -+ dput(h_d); -+ else -+ a->dst_wh_dentry = h_d; -+ } -+ -+ /* rename dentry to tmpwh */ -+ if (a->thargs) { -+ err = au_whtmp_ren(a->dst_h_dentry, a->br); -+ if (unlikely(err)) -+ goto out_whdst; -+ -+ d = a->dst_dentry; -+ au_set_h_dptr(d, a->btgt, NULL); -+ err = au_lkup_neg(d, a->btgt, /*wh*/0); -+ if (unlikely(err)) -+ goto out_whtmp; -+ a->dst_h_dentry = au_h_dptr(d, a->btgt); -+ } -+ } -+ -+ BUG_ON(d_is_positive(a->dst_h_dentry) && a->src_btop != a->btgt); -+#if 0 -+ BUG_ON(!au_ftest_ren(a->auren_flags, DIRREN) -+ && d_is_positive(a->dst_h_dentry) -+ && a->src_btop != a->btgt); -+#endif -+ -+ /* rename by vfs_rename or cpup */ -+ err = au_ren_or_cpup(a); -+ if (unlikely(err)) -+ /* leave the copied-up one */ -+ goto out_whtmp; -+ -+ /* make dir opaque */ -+ err = au_ren_diropq(a); -+ if (unlikely(err)) -+ goto out_rename; -+ -+ /* update target timestamps */ -+ if (a->exchange) { -+ AuDebugOn(au_dbtop(a->dst_dentry) != a->btgt); -+ a->h_path.dentry = au_h_dptr(a->dst_dentry, a->btgt); -+ vfsub_update_h_iattr(&a->h_path, /*did*/NULL); /*ignore*/ -+ a->dst_inode->i_ctime = d_inode(a->h_path.dentry)->i_ctime; -+ } -+ AuDebugOn(au_dbtop(a->src_dentry) != a->btgt); -+ a->h_path.dentry = au_h_dptr(a->src_dentry, a->btgt); -+ vfsub_update_h_iattr(&a->h_path, /*did*/NULL); /*ignore*/ -+ a->src_inode->i_ctime = d_inode(a->h_path.dentry)->i_ctime; -+ -+ if (!a->exchange) { -+ /* remove whiteout for dentry */ -+ if (a->dst_wh_dentry) { -+ a->h_path.dentry = a->dst_wh_dentry; -+ err = au_wh_unlink_dentry(a->dst_h_dir, &a->h_path, -+ a->dst_dentry); -+ if (unlikely(err)) -+ goto out_diropq; -+ } -+ -+ /* remove whtmp */ -+ if (a->thargs) -+ au_ren_del_whtmp(a); /* ignore this error */ -+ -+ au_fhsm_wrote(a->src_dentry->d_sb, a->btgt, /*force*/0); -+ } -+ err = 0; -+ goto out_success; -+ -+out_diropq: -+ au_ren_rev_diropq(err, a); -+out_rename: -+ au_ren_rev_rename(err, a); -+ dput(a->h_dst); -+out_whtmp: -+ if (a->thargs) -+ au_ren_rev_whtmp(err, a); -+out_whdst: -+ dput(a->dst_wh_dentry); -+ a->dst_wh_dentry = NULL; -+out_whsrc: -+ if (a->src_wh_dentry) -+ au_ren_rev_whsrc(err, a); -+out_success: -+ dput(a->src_wh_dentry); -+ dput(a->dst_wh_dentry); -+out_thargs: -+ if (a->thargs) { -+ dput(a->h_dst); -+ au_whtmp_rmdir_free(a->thargs); -+ a->thargs = NULL; -+ } -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * test if @dentry dir can be rename destination or not. -+ * success means, it is a logically empty dir. -+ */ -+static int may_rename_dstdir(struct dentry *dentry, struct au_nhash *whlist) -+{ -+ return au_test_empty(dentry, whlist); -+} -+ -+/* -+ * test if @a->src_dentry dir can be rename source or not. -+ * if it can, return 0. -+ * success means, -+ * - it is a logically empty dir. -+ * - or, it exists on writable branch and has no children including whiteouts -+ * on the lower branch unless DIRREN is on. -+ */ -+static int may_rename_srcdir(struct au_ren_args *a) -+{ -+ int err; -+ unsigned int rdhash; -+ aufs_bindex_t btop, btgt; -+ struct dentry *dentry; -+ struct super_block *sb; -+ struct au_sbinfo *sbinfo; -+ -+ dentry = a->src_dentry; -+ sb = dentry->d_sb; -+ sbinfo = au_sbi(sb); -+ if (au_opt_test(sbinfo->si_mntflags, DIRREN)) -+ au_fset_ren(a->auren_flags, DIRREN); -+ -+ btgt = a->btgt; -+ btop = au_dbtop(dentry); -+ if (btop != btgt) { -+ struct au_nhash whlist; -+ -+ SiMustAnyLock(sb); -+ rdhash = sbinfo->si_rdhash; -+ if (!rdhash) -+ rdhash = au_rdhash_est(au_dir_size(/*file*/NULL, -+ dentry)); -+ err = au_nhash_alloc(&whlist, rdhash, GFP_NOFS); -+ if (unlikely(err)) -+ goto out; -+ err = au_test_empty(dentry, &whlist); -+ au_nhash_wh_free(&whlist); -+ goto out; -+ } -+ -+ if (btop == au_dbtaildir(dentry)) -+ return 0; /* success */ -+ -+ err = au_test_empty_lower(dentry); -+ -+out: -+ if (err == -ENOTEMPTY) { -+ if (au_ftest_ren(a->auren_flags, DIRREN)) { -+ err = 0; -+ } else { -+ AuWarn1("renaming dir who has child(ren) on multiple " -+ "branches, is not supported\n"); -+ err = -EXDEV; -+ } -+ } -+ return err; -+} -+ -+/* side effect: sets whlist and h_dentry */ -+static int au_ren_may_dir(struct au_ren_args *a) -+{ -+ int err; -+ unsigned int rdhash; -+ struct dentry *d; -+ -+ d = a->dst_dentry; -+ SiMustAnyLock(d->d_sb); -+ -+ err = 0; -+ if (au_ftest_ren(a->auren_flags, ISDIR_DST) && a->dst_inode) { -+ rdhash = au_sbi(d->d_sb)->si_rdhash; -+ if (!rdhash) -+ rdhash = au_rdhash_est(au_dir_size(/*file*/NULL, d)); -+ err = au_nhash_alloc(&a->whlist, rdhash, GFP_NOFS); -+ if (unlikely(err)) -+ goto out; -+ -+ if (!a->exchange) { -+ au_set_dbtop(d, a->dst_btop); -+ err = may_rename_dstdir(d, &a->whlist); -+ au_set_dbtop(d, a->btgt); -+ } else -+ err = may_rename_srcdir(a); -+ } -+ a->dst_h_dentry = au_h_dptr(d, au_dbtop(d)); -+ if (unlikely(err)) -+ goto out; -+ -+ d = a->src_dentry; -+ a->src_h_dentry = au_h_dptr(d, au_dbtop(d)); -+ if (au_ftest_ren(a->auren_flags, ISDIR_SRC)) { -+ err = may_rename_srcdir(a); -+ if (unlikely(err)) { -+ au_nhash_wh_free(&a->whlist); -+ a->whlist.nh_num = 0; -+ } -+ } -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * simple tests for rename. -+ * following the checks in vfs, plus the parent-child relationship. -+ */ -+static int au_may_ren(struct au_ren_args *a) -+{ -+ int err, isdir; -+ struct inode *h_inode; -+ -+ if (a->src_btop == a->btgt) { -+ err = au_may_del(a->src_dentry, a->btgt, a->src_h_parent, -+ au_ftest_ren(a->auren_flags, ISDIR_SRC)); -+ if (unlikely(err)) -+ goto out; -+ err = -EINVAL; -+ if (unlikely(a->src_h_dentry == a->h_trap)) -+ goto out; -+ } -+ -+ err = 0; -+ if (a->dst_btop != a->btgt) -+ goto out; -+ -+ err = -ENOTEMPTY; -+ if (unlikely(a->dst_h_dentry == a->h_trap)) -+ goto out; -+ -+ err = -EIO; -+ isdir = !!au_ftest_ren(a->auren_flags, ISDIR_DST); -+ if (d_really_is_negative(a->dst_dentry)) { -+ if (d_is_negative(a->dst_h_dentry)) -+ err = au_may_add(a->dst_dentry, a->btgt, -+ a->dst_h_parent, isdir); -+ } else { -+ if (unlikely(d_is_negative(a->dst_h_dentry))) -+ goto out; -+ h_inode = d_inode(a->dst_h_dentry); -+ if (h_inode->i_nlink) -+ err = au_may_del(a->dst_dentry, a->btgt, -+ a->dst_h_parent, isdir); -+ } -+ -+out: -+ if (unlikely(err == -ENOENT || err == -EEXIST)) -+ err = -EIO; -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * locking order -+ * (VFS) -+ * - src_dir and dir by lock_rename() -+ * - inode if exitsts -+ * (aufs) -+ * - lock all -+ * + src_dentry and dentry by aufs_read_and_write_lock2() which calls, -+ * + si_read_lock -+ * + di_write_lock2_child() -+ * + di_write_lock_child() -+ * + ii_write_lock_child() -+ * + di_write_lock_child2() -+ * + ii_write_lock_child2() -+ * + src_parent and parent -+ * + di_write_lock_parent() -+ * + ii_write_lock_parent() -+ * + di_write_lock_parent2() -+ * + ii_write_lock_parent2() -+ * + lower src_dir and dir by vfsub_lock_rename() -+ * + verify the every relationships between child and parent. if any -+ * of them failed, unlock all and return -EBUSY. -+ */ -+static void au_ren_unlock(struct au_ren_args *a) -+{ -+ vfsub_unlock_rename(a->src_h_parent, a->src_hdir, -+ a->dst_h_parent, a->dst_hdir); -+ if (au_ftest_ren(a->auren_flags, DIRREN) -+ && a->h_root) -+ au_hn_inode_unlock(a->h_root); -+ if (au_ftest_ren(a->auren_flags, MNT_WRITE)) -+ vfsub_mnt_drop_write(au_br_mnt(a->br)); -+} -+ -+static int au_ren_lock(struct au_ren_args *a) -+{ -+ int err; -+ unsigned int udba; -+ -+ err = 0; -+ a->src_h_parent = au_h_dptr(a->src_parent, a->btgt); -+ a->src_hdir = au_hi(a->src_dir, a->btgt); -+ a->dst_h_parent = au_h_dptr(a->dst_parent, a->btgt); -+ a->dst_hdir = au_hi(a->dst_dir, a->btgt); -+ -+ err = vfsub_mnt_want_write(au_br_mnt(a->br)); -+ if (unlikely(err)) -+ goto out; -+ au_fset_ren(a->auren_flags, MNT_WRITE); -+ if (au_ftest_ren(a->auren_flags, DIRREN)) { -+ struct dentry *root; -+ struct inode *dir; -+ -+ /* -+ * sbinfo is already locked, so this ii_read_lock is -+ * unnecessary. but our debugging feature checks it. -+ */ -+ root = a->src_inode->i_sb->s_root; -+ if (root != a->src_parent && root != a->dst_parent) { -+ dir = d_inode(root); -+ ii_read_lock_parent3(dir); -+ a->h_root = au_hi(dir, a->btgt); -+ ii_read_unlock(dir); -+ au_hn_inode_lock_nested(a->h_root, AuLsc_I_PARENT3); -+ } -+ } -+ a->h_trap = vfsub_lock_rename(a->src_h_parent, a->src_hdir, -+ a->dst_h_parent, a->dst_hdir); -+ udba = au_opt_udba(a->src_dentry->d_sb); -+ if (unlikely(a->src_hdir->hi_inode != d_inode(a->src_h_parent) -+ || a->dst_hdir->hi_inode != d_inode(a->dst_h_parent))) -+ err = au_busy_or_stale(); -+ if (!err && au_dbtop(a->src_dentry) == a->btgt) -+ err = au_h_verify(a->src_h_dentry, udba, -+ d_inode(a->src_h_parent), a->src_h_parent, -+ a->br); -+ if (!err && au_dbtop(a->dst_dentry) == a->btgt) -+ err = au_h_verify(a->dst_h_dentry, udba, -+ d_inode(a->dst_h_parent), a->dst_h_parent, -+ a->br); -+ if (!err) -+ goto out; /* success */ -+ -+ err = au_busy_or_stale(); -+ au_ren_unlock(a); -+ -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static void au_ren_refresh_dir(struct au_ren_args *a) -+{ -+ struct inode *dir; -+ -+ dir = a->dst_dir; -+ dir->i_version++; -+ if (au_ftest_ren(a->auren_flags, ISDIR_SRC)) { -+ /* is this updating defined in POSIX? */ -+ au_cpup_attr_timesizes(a->src_inode); -+ au_cpup_attr_nlink(dir, /*force*/1); -+ } -+ au_dir_ts(dir, a->btgt); -+ -+ if (a->exchange) { -+ dir = a->src_dir; -+ dir->i_version++; -+ if (au_ftest_ren(a->auren_flags, ISDIR_DST)) { -+ /* is this updating defined in POSIX? */ -+ au_cpup_attr_timesizes(a->dst_inode); -+ au_cpup_attr_nlink(dir, /*force*/1); -+ } -+ au_dir_ts(dir, a->btgt); -+ } -+ -+ if (au_ftest_ren(a->auren_flags, ISSAMEDIR)) -+ return; -+ -+ dir = a->src_dir; -+ dir->i_version++; -+ if (au_ftest_ren(a->auren_flags, ISDIR_SRC)) -+ au_cpup_attr_nlink(dir, /*force*/1); -+ au_dir_ts(dir, a->btgt); -+} -+ -+static void au_ren_refresh(struct au_ren_args *a) -+{ -+ aufs_bindex_t bbot, bindex; -+ struct dentry *d, *h_d; -+ struct inode *i, *h_i; -+ struct super_block *sb; -+ -+ d = a->dst_dentry; -+ d_drop(d); -+ if (a->h_dst) -+ /* already dget-ed by au_ren_or_cpup() */ -+ au_set_h_dptr(d, a->btgt, a->h_dst); -+ -+ i = a->dst_inode; -+ if (i) { -+ if (!a->exchange) { -+ if (!au_ftest_ren(a->auren_flags, ISDIR_DST)) -+ vfsub_drop_nlink(i); -+ else { -+ vfsub_dead_dir(i); -+ au_cpup_attr_timesizes(i); -+ } -+ au_update_dbrange(d, /*do_put_zero*/1); -+ } else -+ au_cpup_attr_nlink(i, /*force*/1); -+ } else { -+ bbot = a->btgt; -+ for (bindex = au_dbtop(d); bindex < bbot; bindex++) -+ au_set_h_dptr(d, bindex, NULL); -+ bbot = au_dbbot(d); -+ for (bindex = a->btgt + 1; bindex <= bbot; bindex++) -+ au_set_h_dptr(d, bindex, NULL); -+ au_update_dbrange(d, /*do_put_zero*/0); -+ } -+ -+ if (a->exchange -+ || au_ftest_ren(a->auren_flags, DIRREN)) { -+ d_drop(a->src_dentry); -+ if (au_ftest_ren(a->auren_flags, DIRREN)) -+ au_set_dbwh(a->src_dentry, -1); -+ return; -+ } -+ -+ d = a->src_dentry; -+ au_set_dbwh(d, -1); -+ bbot = au_dbbot(d); -+ for (bindex = a->btgt + 1; bindex <= bbot; bindex++) { -+ h_d = au_h_dptr(d, bindex); -+ if (h_d) -+ au_set_h_dptr(d, bindex, NULL); -+ } -+ au_set_dbbot(d, a->btgt); -+ -+ sb = d->d_sb; -+ i = a->src_inode; -+ if (au_opt_test(au_mntflags(sb), PLINK) && au_plink_test(i)) -+ return; /* success */ -+ -+ bbot = au_ibbot(i); -+ for (bindex = a->btgt + 1; bindex <= bbot; bindex++) { -+ h_i = au_h_iptr(i, bindex); -+ if (h_i) { -+ au_xino_write(sb, bindex, h_i->i_ino, /*ino*/0); -+ /* ignore this error */ -+ au_set_h_iptr(i, bindex, NULL, 0); -+ } -+ } -+ au_set_ibbot(i, a->btgt); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* mainly for link(2) and rename(2) */ -+int au_wbr(struct dentry *dentry, aufs_bindex_t btgt) -+{ -+ aufs_bindex_t bdiropq, bwh; -+ struct dentry *parent; -+ struct au_branch *br; -+ -+ parent = dentry->d_parent; -+ IMustLock(d_inode(parent)); /* dir is locked */ -+ -+ bdiropq = au_dbdiropq(parent); -+ bwh = au_dbwh(dentry); -+ br = au_sbr(dentry->d_sb, btgt); -+ if (au_br_rdonly(br) -+ || (0 <= bdiropq && bdiropq < btgt) -+ || (0 <= bwh && bwh < btgt)) -+ btgt = -1; -+ -+ AuDbg("btgt %d\n", btgt); -+ return btgt; -+} -+ -+/* sets src_btop, dst_btop and btgt */ -+static int au_ren_wbr(struct au_ren_args *a) -+{ -+ int err; -+ struct au_wr_dir_args wr_dir_args = { -+ /* .force_btgt = -1, */ -+ .flags = AuWrDir_ADD_ENTRY -+ }; -+ -+ a->src_btop = au_dbtop(a->src_dentry); -+ a->dst_btop = au_dbtop(a->dst_dentry); -+ if (au_ftest_ren(a->auren_flags, ISDIR_SRC) -+ || au_ftest_ren(a->auren_flags, ISDIR_DST)) -+ au_fset_wrdir(wr_dir_args.flags, ISDIR); -+ wr_dir_args.force_btgt = a->src_btop; -+ if (a->dst_inode && a->dst_btop < a->src_btop) -+ wr_dir_args.force_btgt = a->dst_btop; -+ wr_dir_args.force_btgt = au_wbr(a->dst_dentry, wr_dir_args.force_btgt); -+ err = au_wr_dir(a->dst_dentry, a->src_dentry, &wr_dir_args); -+ a->btgt = err; -+ if (a->exchange) -+ au_update_dbtop(a->dst_dentry); -+ -+ return err; -+} -+ -+static void au_ren_dt(struct au_ren_args *a) -+{ -+ a->h_path.dentry = a->src_h_parent; -+ au_dtime_store(a->src_dt + AuPARENT, a->src_parent, &a->h_path); -+ if (!au_ftest_ren(a->auren_flags, ISSAMEDIR)) { -+ a->h_path.dentry = a->dst_h_parent; -+ au_dtime_store(a->dst_dt + AuPARENT, a->dst_parent, &a->h_path); -+ } -+ -+ au_fclr_ren(a->auren_flags, DT_DSTDIR); -+ if (!au_ftest_ren(a->auren_flags, ISDIR_SRC) -+ && !a->exchange) -+ return; -+ -+ a->h_path.dentry = a->src_h_dentry; -+ au_dtime_store(a->src_dt + AuCHILD, a->src_dentry, &a->h_path); -+ if (d_is_positive(a->dst_h_dentry)) { -+ au_fset_ren(a->auren_flags, DT_DSTDIR); -+ a->h_path.dentry = a->dst_h_dentry; -+ au_dtime_store(a->dst_dt + AuCHILD, a->dst_dentry, &a->h_path); -+ } -+} -+ -+static void au_ren_rev_dt(int err, struct au_ren_args *a) -+{ -+ struct dentry *h_d; -+ struct inode *h_inode; -+ -+ au_dtime_revert(a->src_dt + AuPARENT); -+ if (!au_ftest_ren(a->auren_flags, ISSAMEDIR)) -+ au_dtime_revert(a->dst_dt + AuPARENT); -+ -+ if (au_ftest_ren(a->auren_flags, ISDIR_SRC) && err != -EIO) { -+ h_d = a->src_dt[AuCHILD].dt_h_path.dentry; -+ h_inode = d_inode(h_d); -+ inode_lock_nested(h_inode, AuLsc_I_CHILD); -+ au_dtime_revert(a->src_dt + AuCHILD); -+ inode_unlock(h_inode); -+ -+ if (au_ftest_ren(a->auren_flags, DT_DSTDIR)) { -+ h_d = a->dst_dt[AuCHILD].dt_h_path.dentry; -+ h_inode = d_inode(h_d); -+ inode_lock_nested(h_inode, AuLsc_I_CHILD); -+ au_dtime_revert(a->dst_dt + AuCHILD); -+ inode_unlock(h_inode); -+ } -+ } -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int aufs_rename(struct inode *_src_dir, struct dentry *_src_dentry, -+ struct inode *_dst_dir, struct dentry *_dst_dentry, -+ unsigned int _flags) -+{ -+ int err, lock_flags; -+ void *rev; -+ /* reduce stack space */ -+ struct au_ren_args *a; -+ struct au_pin pin; -+ -+ AuDbg("%pd, %pd, 0x%x\n", _src_dentry, _dst_dentry, _flags); -+ IMustLock(_src_dir); -+ IMustLock(_dst_dir); -+ -+ err = -EINVAL; -+ if (unlikely(_flags & RENAME_WHITEOUT)) -+ goto out; -+ -+ err = -ENOMEM; -+ BUILD_BUG_ON(sizeof(*a) > PAGE_SIZE); -+ a = kzalloc(sizeof(*a), GFP_NOFS); -+ if (unlikely(!a)) -+ goto out; -+ -+ a->flags = _flags; -+ a->exchange = _flags & RENAME_EXCHANGE; -+ a->src_dir = _src_dir; -+ a->src_dentry = _src_dentry; -+ a->src_inode = NULL; -+ if (d_really_is_positive(a->src_dentry)) -+ a->src_inode = d_inode(a->src_dentry); -+ a->src_parent = a->src_dentry->d_parent; /* dir inode is locked */ -+ a->dst_dir = _dst_dir; -+ a->dst_dentry = _dst_dentry; -+ a->dst_inode = NULL; -+ if (d_really_is_positive(a->dst_dentry)) -+ a->dst_inode = d_inode(a->dst_dentry); -+ a->dst_parent = a->dst_dentry->d_parent; /* dir inode is locked */ -+ if (a->dst_inode) { -+ /* -+ * if EXCHANGE && src is non-dir && dst is dir, -+ * dst is not locked. -+ */ -+ /* IMustLock(a->dst_inode); */ -+ au_igrab(a->dst_inode); -+ } -+ -+ err = -ENOTDIR; -+ lock_flags = AuLock_FLUSH | AuLock_NOPLM | AuLock_GEN; -+ if (d_is_dir(a->src_dentry)) { -+ au_fset_ren(a->auren_flags, ISDIR_SRC); -+ if (unlikely(!a->exchange -+ && d_really_is_positive(a->dst_dentry) -+ && !d_is_dir(a->dst_dentry))) -+ goto out_free; -+ lock_flags |= AuLock_DIRS; -+ } -+ if (a->dst_inode && d_is_dir(a->dst_dentry)) { -+ au_fset_ren(a->auren_flags, ISDIR_DST); -+ if (unlikely(!a->exchange -+ && d_really_is_positive(a->src_dentry) -+ && !d_is_dir(a->src_dentry))) -+ goto out_free; -+ lock_flags |= AuLock_DIRS; -+ } -+ err = aufs_read_and_write_lock2(a->dst_dentry, a->src_dentry, -+ lock_flags); -+ if (unlikely(err)) -+ goto out_free; -+ -+ err = au_d_hashed_positive(a->src_dentry); -+ if (unlikely(err)) -+ goto out_unlock; -+ err = -ENOENT; -+ if (a->dst_inode) { -+ /* -+ * If it is a dir, VFS unhash it before this -+ * function. It means we cannot rely upon d_unhashed(). -+ */ -+ if (unlikely(!a->dst_inode->i_nlink)) -+ goto out_unlock; -+ if (!au_ftest_ren(a->auren_flags, ISDIR_DST)) { -+ err = au_d_hashed_positive(a->dst_dentry); -+ if (unlikely(err && !a->exchange)) -+ goto out_unlock; -+ } else if (unlikely(IS_DEADDIR(a->dst_inode))) -+ goto out_unlock; -+ } else if (unlikely(d_unhashed(a->dst_dentry))) -+ goto out_unlock; -+ -+ /* -+ * is it possible? -+ * yes, it happened (in linux-3.3-rcN) but I don't know why. -+ * there may exist a problem somewhere else. -+ */ -+ err = -EINVAL; -+ if (unlikely(d_inode(a->dst_parent) == d_inode(a->src_dentry))) -+ goto out_unlock; -+ -+ au_fset_ren(a->auren_flags, ISSAMEDIR); /* temporary */ -+ di_write_lock_parent(a->dst_parent); -+ -+ /* which branch we process */ -+ err = au_ren_wbr(a); -+ if (unlikely(err < 0)) -+ goto out_parent; -+ a->br = au_sbr(a->dst_dentry->d_sb, a->btgt); -+ a->h_path.mnt = au_br_mnt(a->br); -+ -+ /* are they available to be renamed */ -+ err = au_ren_may_dir(a); -+ if (unlikely(err)) -+ goto out_children; -+ -+ /* prepare the writable parent dir on the same branch */ -+ if (a->dst_btop == a->btgt) { -+ au_fset_ren(a->auren_flags, WHDST); -+ } else { -+ err = au_cpup_dirs(a->dst_dentry, a->btgt); -+ if (unlikely(err)) -+ goto out_children; -+ } -+ -+ err = 0; -+ if (!a->exchange) { -+ if (a->src_dir != a->dst_dir) { -+ /* -+ * this temporary unlock is safe, -+ * because both dir->i_mutex are locked. -+ */ -+ di_write_unlock(a->dst_parent); -+ di_write_lock_parent(a->src_parent); -+ err = au_wr_dir_need_wh(a->src_dentry, -+ au_ftest_ren(a->auren_flags, -+ ISDIR_SRC), -+ &a->btgt); -+ di_write_unlock(a->src_parent); -+ di_write_lock2_parent(a->src_parent, a->dst_parent, -+ /*isdir*/1); -+ au_fclr_ren(a->auren_flags, ISSAMEDIR); -+ } else -+ err = au_wr_dir_need_wh(a->src_dentry, -+ au_ftest_ren(a->auren_flags, -+ ISDIR_SRC), -+ &a->btgt); -+ } -+ if (unlikely(err < 0)) -+ goto out_children; -+ if (err) -+ au_fset_ren(a->auren_flags, WHSRC); -+ -+ /* cpup src */ -+ if (a->src_btop != a->btgt) { -+ err = au_pin(&pin, a->src_dentry, a->btgt, -+ au_opt_udba(a->src_dentry->d_sb), -+ AuPin_DI_LOCKED | AuPin_MNT_WRITE); -+ if (!err) { -+ struct au_cp_generic cpg = { -+ .dentry = a->src_dentry, -+ .bdst = a->btgt, -+ .bsrc = a->src_btop, -+ .len = -1, -+ .pin = &pin, -+ .flags = AuCpup_DTIME | AuCpup_HOPEN -+ }; -+ AuDebugOn(au_dbtop(a->src_dentry) != a->src_btop); -+ err = au_sio_cpup_simple(&cpg); -+ au_unpin(&pin); -+ } -+ if (unlikely(err)) -+ goto out_children; -+ a->src_btop = a->btgt; -+ a->src_h_dentry = au_h_dptr(a->src_dentry, a->btgt); -+ if (!a->exchange) -+ au_fset_ren(a->auren_flags, WHSRC); -+ } -+ -+ /* cpup dst */ -+ if (a->exchange && a->dst_inode -+ && a->dst_btop != a->btgt) { -+ err = au_pin(&pin, a->dst_dentry, a->btgt, -+ au_opt_udba(a->dst_dentry->d_sb), -+ AuPin_DI_LOCKED | AuPin_MNT_WRITE); -+ if (!err) { -+ struct au_cp_generic cpg = { -+ .dentry = a->dst_dentry, -+ .bdst = a->btgt, -+ .bsrc = a->dst_btop, -+ .len = -1, -+ .pin = &pin, -+ .flags = AuCpup_DTIME | AuCpup_HOPEN -+ }; -+ err = au_sio_cpup_simple(&cpg); -+ au_unpin(&pin); -+ } -+ if (unlikely(err)) -+ goto out_children; -+ a->dst_btop = a->btgt; -+ a->dst_h_dentry = au_h_dptr(a->dst_dentry, a->btgt); -+ } -+ -+ /* lock them all */ -+ err = au_ren_lock(a); -+ if (unlikely(err)) -+ /* leave the copied-up one */ -+ goto out_children; -+ -+ if (!a->exchange) { -+ if (!au_opt_test(au_mntflags(a->dst_dir->i_sb), UDBA_NONE)) -+ err = au_may_ren(a); -+ else if (unlikely(a->dst_dentry->d_name.len > AUFS_MAX_NAMELEN)) -+ err = -ENAMETOOLONG; -+ if (unlikely(err)) -+ goto out_hdir; -+ } -+ -+ /* store timestamps to be revertible */ -+ au_ren_dt(a); -+ -+ /* store dirren info */ -+ if (au_ftest_ren(a->auren_flags, DIRREN)) { -+ err = au_dr_rename(a->src_dentry, a->btgt, -+ &a->dst_dentry->d_name, &rev); -+ AuTraceErr(err); -+ if (unlikely(err)) -+ goto out_dt; -+ } -+ -+ /* here we go */ -+ err = do_rename(a); -+ if (unlikely(err)) -+ goto out_dirren; -+ -+ if (au_ftest_ren(a->auren_flags, DIRREN)) -+ au_dr_rename_fin(a->src_dentry, a->btgt, rev); -+ -+ /* update dir attributes */ -+ au_ren_refresh_dir(a); -+ -+ /* dput/iput all lower dentries */ -+ au_ren_refresh(a); -+ -+ goto out_hdir; /* success */ -+ -+out_dirren: -+ if (au_ftest_ren(a->auren_flags, DIRREN)) -+ au_dr_rename_rev(a->src_dentry, a->btgt, rev); -+out_dt: -+ au_ren_rev_dt(err, a); -+out_hdir: -+ au_ren_unlock(a); -+out_children: -+ au_nhash_wh_free(&a->whlist); -+ if (err && a->dst_inode && a->dst_btop != a->btgt) { -+ AuDbg("btop %d, btgt %d\n", a->dst_btop, a->btgt); -+ au_set_h_dptr(a->dst_dentry, a->btgt, NULL); -+ au_set_dbtop(a->dst_dentry, a->dst_btop); -+ } -+out_parent: -+ if (!err) { -+ if (d_unhashed(a->src_dentry)) -+ au_fset_ren(a->auren_flags, DROPPED_SRC); -+ if (d_unhashed(a->dst_dentry)) -+ au_fset_ren(a->auren_flags, DROPPED_DST); -+ if (!a->exchange) -+ d_move(a->src_dentry, a->dst_dentry); -+ else { -+ d_exchange(a->src_dentry, a->dst_dentry); -+ if (au_ftest_ren(a->auren_flags, DROPPED_DST)) -+ d_drop(a->dst_dentry); -+ } -+ if (au_ftest_ren(a->auren_flags, DROPPED_SRC)) -+ d_drop(a->src_dentry); -+ } else { -+ au_update_dbtop(a->dst_dentry); -+ if (!a->dst_inode) -+ d_drop(a->dst_dentry); -+ } -+ if (au_ftest_ren(a->auren_flags, ISSAMEDIR)) -+ di_write_unlock(a->dst_parent); -+ else -+ di_write_unlock2(a->src_parent, a->dst_parent); -+out_unlock: -+ aufs_read_and_write_unlock2(a->dst_dentry, a->src_dentry); -+out_free: -+ iput(a->dst_inode); -+ if (a->thargs) -+ au_whtmp_rmdir_free(a->thargs); -+ kfree(a); -+out: -+ AuTraceErr(err); -+ return err; -+} -diff --git a/fs/aufs/iinfo.c b/fs/aufs/iinfo.c -new file mode 100644 -index 000000000000..df293a889764 ---- /dev/null -+++ b/fs/aufs/iinfo.c -@@ -0,0 +1,273 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * inode private data -+ */ -+ -+#include "aufs.h" -+ -+struct inode *au_h_iptr(struct inode *inode, aufs_bindex_t bindex) -+{ -+ struct inode *h_inode; -+ struct au_hinode *hinode; -+ -+ IiMustAnyLock(inode); -+ -+ hinode = au_hinode(au_ii(inode), bindex); -+ h_inode = hinode->hi_inode; -+ AuDebugOn(h_inode && atomic_read(&h_inode->i_count) <= 0); -+ return h_inode; -+} -+ -+/* todo: hard/soft set? */ -+void au_hiput(struct au_hinode *hinode) -+{ -+ au_hn_free(hinode); -+ dput(hinode->hi_whdentry); -+ iput(hinode->hi_inode); -+} -+ -+unsigned int au_hi_flags(struct inode *inode, int isdir) -+{ -+ unsigned int flags; -+ const unsigned int mnt_flags = au_mntflags(inode->i_sb); -+ -+ flags = 0; -+ if (au_opt_test(mnt_flags, XINO)) -+ au_fset_hi(flags, XINO); -+ if (isdir && au_opt_test(mnt_flags, UDBA_HNOTIFY)) -+ au_fset_hi(flags, HNOTIFY); -+ return flags; -+} -+ -+void au_set_h_iptr(struct inode *inode, aufs_bindex_t bindex, -+ struct inode *h_inode, unsigned int flags) -+{ -+ struct au_hinode *hinode; -+ struct inode *hi; -+ struct au_iinfo *iinfo = au_ii(inode); -+ -+ IiMustWriteLock(inode); -+ -+ hinode = au_hinode(iinfo, bindex); -+ hi = hinode->hi_inode; -+ AuDebugOn(h_inode && atomic_read(&h_inode->i_count) <= 0); -+ -+ if (hi) -+ au_hiput(hinode); -+ hinode->hi_inode = h_inode; -+ if (h_inode) { -+ int err; -+ struct super_block *sb = inode->i_sb; -+ struct au_branch *br; -+ -+ AuDebugOn(inode->i_mode -+ && (h_inode->i_mode & S_IFMT) -+ != (inode->i_mode & S_IFMT)); -+ if (bindex == iinfo->ii_btop) -+ au_cpup_igen(inode, h_inode); -+ br = au_sbr(sb, bindex); -+ hinode->hi_id = br->br_id; -+ if (au_ftest_hi(flags, XINO)) { -+ err = au_xino_write(sb, bindex, h_inode->i_ino, -+ inode->i_ino); -+ if (unlikely(err)) -+ AuIOErr1("failed au_xino_write() %d\n", err); -+ } -+ -+ if (au_ftest_hi(flags, HNOTIFY) -+ && au_br_hnotifyable(br->br_perm)) { -+ err = au_hn_alloc(hinode, inode); -+ if (unlikely(err)) -+ AuIOErr1("au_hn_alloc() %d\n", err); -+ } -+ } -+} -+ -+void au_set_hi_wh(struct inode *inode, aufs_bindex_t bindex, -+ struct dentry *h_wh) -+{ -+ struct au_hinode *hinode; -+ -+ IiMustWriteLock(inode); -+ -+ hinode = au_hinode(au_ii(inode), bindex); -+ AuDebugOn(hinode->hi_whdentry); -+ hinode->hi_whdentry = h_wh; -+} -+ -+void au_update_iigen(struct inode *inode, int half) -+{ -+ struct au_iinfo *iinfo; -+ struct au_iigen *iigen; -+ unsigned int sigen; -+ -+ sigen = au_sigen(inode->i_sb); -+ iinfo = au_ii(inode); -+ iigen = &iinfo->ii_generation; -+ spin_lock(&iigen->ig_spin); -+ iigen->ig_generation = sigen; -+ if (half) -+ au_ig_fset(iigen->ig_flags, HALF_REFRESHED); -+ else -+ au_ig_fclr(iigen->ig_flags, HALF_REFRESHED); -+ spin_unlock(&iigen->ig_spin); -+} -+ -+/* it may be called at remount time, too */ -+void au_update_ibrange(struct inode *inode, int do_put_zero) -+{ -+ struct au_iinfo *iinfo; -+ aufs_bindex_t bindex, bbot; -+ -+ AuDebugOn(au_is_bad_inode(inode)); -+ IiMustWriteLock(inode); -+ -+ iinfo = au_ii(inode); -+ if (do_put_zero && iinfo->ii_btop >= 0) { -+ for (bindex = iinfo->ii_btop; bindex <= iinfo->ii_bbot; -+ bindex++) { -+ struct inode *h_i; -+ -+ h_i = au_hinode(iinfo, bindex)->hi_inode; -+ if (h_i -+ && !h_i->i_nlink -+ && !(h_i->i_state & I_LINKABLE)) -+ au_set_h_iptr(inode, bindex, NULL, 0); -+ } -+ } -+ -+ iinfo->ii_btop = -1; -+ iinfo->ii_bbot = -1; -+ bbot = au_sbbot(inode->i_sb); -+ for (bindex = 0; bindex <= bbot; bindex++) -+ if (au_hinode(iinfo, bindex)->hi_inode) { -+ iinfo->ii_btop = bindex; -+ break; -+ } -+ if (iinfo->ii_btop >= 0) -+ for (bindex = bbot; bindex >= iinfo->ii_btop; bindex--) -+ if (au_hinode(iinfo, bindex)->hi_inode) { -+ iinfo->ii_bbot = bindex; -+ break; -+ } -+ AuDebugOn(iinfo->ii_btop > iinfo->ii_bbot); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void au_icntnr_init_once(void *_c) -+{ -+ struct au_icntnr *c = _c; -+ struct au_iinfo *iinfo = &c->iinfo; -+ -+ spin_lock_init(&iinfo->ii_generation.ig_spin); -+ au_rw_init(&iinfo->ii_rwsem); -+ inode_init_once(&c->vfs_inode); -+} -+ -+void au_hinode_init(struct au_hinode *hinode) -+{ -+ hinode->hi_inode = NULL; -+ hinode->hi_id = -1; -+ au_hn_init(hinode); -+ hinode->hi_whdentry = NULL; -+} -+ -+int au_iinfo_init(struct inode *inode) -+{ -+ struct au_iinfo *iinfo; -+ struct super_block *sb; -+ struct au_hinode *hi; -+ int nbr, i; -+ -+ sb = inode->i_sb; -+ iinfo = &(container_of(inode, struct au_icntnr, vfs_inode)->iinfo); -+ nbr = au_sbbot(sb) + 1; -+ if (unlikely(nbr <= 0)) -+ nbr = 1; -+ hi = kmalloc_array(nbr, sizeof(*iinfo->ii_hinode), GFP_NOFS); -+ if (hi) { -+ au_ninodes_inc(sb); -+ -+ iinfo->ii_hinode = hi; -+ for (i = 0; i < nbr; i++, hi++) -+ au_hinode_init(hi); -+ -+ iinfo->ii_generation.ig_generation = au_sigen(sb); -+ iinfo->ii_btop = -1; -+ iinfo->ii_bbot = -1; -+ iinfo->ii_vdir = NULL; -+ return 0; -+ } -+ return -ENOMEM; -+} -+ -+int au_hinode_realloc(struct au_iinfo *iinfo, int nbr, int may_shrink) -+{ -+ int err, i; -+ struct au_hinode *hip; -+ -+ AuRwMustWriteLock(&iinfo->ii_rwsem); -+ -+ err = -ENOMEM; -+ hip = au_krealloc(iinfo->ii_hinode, sizeof(*hip) * nbr, GFP_NOFS, -+ may_shrink); -+ if (hip) { -+ iinfo->ii_hinode = hip; -+ i = iinfo->ii_bbot + 1; -+ hip += i; -+ for (; i < nbr; i++, hip++) -+ au_hinode_init(hip); -+ err = 0; -+ } -+ -+ return err; -+} -+ -+void au_iinfo_fin(struct inode *inode) -+{ -+ struct au_iinfo *iinfo; -+ struct au_hinode *hi; -+ struct super_block *sb; -+ aufs_bindex_t bindex, bbot; -+ const unsigned char unlinked = !inode->i_nlink; -+ -+ AuDebugOn(au_is_bad_inode(inode)); -+ -+ sb = inode->i_sb; -+ au_ninodes_dec(sb); -+ if (si_pid_test(sb)) -+ au_xino_delete_inode(inode, unlinked); -+ else { -+ /* -+ * it is safe to hide the dependency between sbinfo and -+ * sb->s_umount. -+ */ -+ lockdep_off(); -+ si_noflush_read_lock(sb); -+ au_xino_delete_inode(inode, unlinked); -+ si_read_unlock(sb); -+ lockdep_on(); -+ } -+ -+ iinfo = au_ii(inode); -+ if (iinfo->ii_vdir) -+ au_vdir_free(iinfo->ii_vdir); -+ -+ bindex = iinfo->ii_btop; -+ if (bindex >= 0) { -+ hi = au_hinode(iinfo, bindex); -+ bbot = iinfo->ii_bbot; -+ while (bindex++ <= bbot) { -+ if (hi->hi_inode) -+ au_hiput(hi); -+ hi++; -+ } -+ } -+ kfree(iinfo->ii_hinode); -+ AuRwDestroy(&iinfo->ii_rwsem); -+} -diff --git a/fs/aufs/inode.c b/fs/aufs/inode.c -new file mode 100644 -index 000000000000..8638aa04bbfa ---- /dev/null -+++ b/fs/aufs/inode.c -@@ -0,0 +1,515 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * inode functions -+ */ -+ -+#include "aufs.h" -+ -+struct inode *au_igrab(struct inode *inode) -+{ -+ if (inode) { -+ AuDebugOn(!atomic_read(&inode->i_count)); -+ ihold(inode); -+ } -+ return inode; -+} -+ -+static void au_refresh_hinode_attr(struct inode *inode, int do_version) -+{ -+ au_cpup_attr_all(inode, /*force*/0); -+ au_update_iigen(inode, /*half*/1); -+ if (do_version) -+ inode->i_version++; -+} -+ -+static int au_ii_refresh(struct inode *inode, int *update) -+{ -+ int err, e, nbr; -+ umode_t type; -+ aufs_bindex_t bindex, new_bindex; -+ struct super_block *sb; -+ struct au_iinfo *iinfo; -+ struct au_hinode *p, *q, tmp; -+ -+ AuDebugOn(au_is_bad_inode(inode)); -+ IiMustWriteLock(inode); -+ -+ *update = 0; -+ sb = inode->i_sb; -+ nbr = au_sbbot(sb) + 1; -+ type = inode->i_mode & S_IFMT; -+ iinfo = au_ii(inode); -+ err = au_hinode_realloc(iinfo, nbr, /*may_shrink*/0); -+ if (unlikely(err)) -+ goto out; -+ -+ AuDebugOn(iinfo->ii_btop < 0); -+ p = au_hinode(iinfo, iinfo->ii_btop); -+ for (bindex = iinfo->ii_btop; bindex <= iinfo->ii_bbot; -+ bindex++, p++) { -+ if (!p->hi_inode) -+ continue; -+ -+ AuDebugOn(type != (p->hi_inode->i_mode & S_IFMT)); -+ new_bindex = au_br_index(sb, p->hi_id); -+ if (new_bindex == bindex) -+ continue; -+ -+ if (new_bindex < 0) { -+ *update = 1; -+ au_hiput(p); -+ p->hi_inode = NULL; -+ continue; -+ } -+ -+ if (new_bindex < iinfo->ii_btop) -+ iinfo->ii_btop = new_bindex; -+ if (iinfo->ii_bbot < new_bindex) -+ iinfo->ii_bbot = new_bindex; -+ /* swap two lower inode, and loop again */ -+ q = au_hinode(iinfo, new_bindex); -+ tmp = *q; -+ *q = *p; -+ *p = tmp; -+ if (tmp.hi_inode) { -+ bindex--; -+ p--; -+ } -+ } -+ au_update_ibrange(inode, /*do_put_zero*/0); -+ au_hinode_realloc(iinfo, nbr, /*may_shrink*/1); /* harmless if err */ -+ e = au_dy_irefresh(inode); -+ if (unlikely(e && !err)) -+ err = e; -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+void au_refresh_iop(struct inode *inode, int force_getattr) -+{ -+ int type; -+ struct au_sbinfo *sbi = au_sbi(inode->i_sb); -+ const struct inode_operations *iop -+ = force_getattr ? aufs_iop : sbi->si_iop_array; -+ -+ if (inode->i_op == iop) -+ return; -+ -+ switch (inode->i_mode & S_IFMT) { -+ case S_IFDIR: -+ type = AuIop_DIR; -+ break; -+ case S_IFLNK: -+ type = AuIop_SYMLINK; -+ break; -+ default: -+ type = AuIop_OTHER; -+ break; -+ } -+ -+ inode->i_op = iop + type; -+ /* unnecessary smp_wmb() */ -+} -+ -+int au_refresh_hinode_self(struct inode *inode) -+{ -+ int err, update; -+ -+ err = au_ii_refresh(inode, &update); -+ if (!err) -+ au_refresh_hinode_attr(inode, update && S_ISDIR(inode->i_mode)); -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+int au_refresh_hinode(struct inode *inode, struct dentry *dentry) -+{ -+ int err, e, update; -+ unsigned int flags; -+ umode_t mode; -+ aufs_bindex_t bindex, bbot; -+ unsigned char isdir; -+ struct au_hinode *p; -+ struct au_iinfo *iinfo; -+ -+ err = au_ii_refresh(inode, &update); -+ if (unlikely(err)) -+ goto out; -+ -+ update = 0; -+ iinfo = au_ii(inode); -+ p = au_hinode(iinfo, iinfo->ii_btop); -+ mode = (inode->i_mode & S_IFMT); -+ isdir = S_ISDIR(mode); -+ flags = au_hi_flags(inode, isdir); -+ bbot = au_dbbot(dentry); -+ for (bindex = au_dbtop(dentry); bindex <= bbot; bindex++) { -+ struct inode *h_i, *h_inode; -+ struct dentry *h_d; -+ -+ h_d = au_h_dptr(dentry, bindex); -+ if (!h_d || d_is_negative(h_d)) -+ continue; -+ -+ h_inode = d_inode(h_d); -+ AuDebugOn(mode != (h_inode->i_mode & S_IFMT)); -+ if (iinfo->ii_btop <= bindex && bindex <= iinfo->ii_bbot) { -+ h_i = au_h_iptr(inode, bindex); -+ if (h_i) { -+ if (h_i == h_inode) -+ continue; -+ err = -EIO; -+ break; -+ } -+ } -+ if (bindex < iinfo->ii_btop) -+ iinfo->ii_btop = bindex; -+ if (iinfo->ii_bbot < bindex) -+ iinfo->ii_bbot = bindex; -+ au_set_h_iptr(inode, bindex, au_igrab(h_inode), flags); -+ update = 1; -+ } -+ au_update_ibrange(inode, /*do_put_zero*/0); -+ e = au_dy_irefresh(inode); -+ if (unlikely(e && !err)) -+ err = e; -+ if (!err) -+ au_refresh_hinode_attr(inode, update && isdir); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+static int set_inode(struct inode *inode, struct dentry *dentry) -+{ -+ int err; -+ unsigned int flags; -+ umode_t mode; -+ aufs_bindex_t bindex, btop, btail; -+ unsigned char isdir; -+ struct dentry *h_dentry; -+ struct inode *h_inode; -+ struct au_iinfo *iinfo; -+ struct inode_operations *iop; -+ -+ IiMustWriteLock(inode); -+ -+ err = 0; -+ isdir = 0; -+ iop = au_sbi(inode->i_sb)->si_iop_array; -+ btop = au_dbtop(dentry); -+ h_dentry = au_h_dptr(dentry, btop); -+ h_inode = d_inode(h_dentry); -+ mode = h_inode->i_mode; -+ switch (mode & S_IFMT) { -+ case S_IFREG: -+ btail = au_dbtail(dentry); -+ inode->i_op = iop + AuIop_OTHER; -+ inode->i_fop = &aufs_file_fop; -+ err = au_dy_iaop(inode, btop, h_inode); -+ if (unlikely(err)) -+ goto out; -+ break; -+ case S_IFDIR: -+ isdir = 1; -+ btail = au_dbtaildir(dentry); -+ inode->i_op = iop + AuIop_DIR; -+ inode->i_fop = &aufs_dir_fop; -+ break; -+ case S_IFLNK: -+ btail = au_dbtail(dentry); -+ inode->i_op = iop + AuIop_SYMLINK; -+ break; -+ case S_IFBLK: -+ case S_IFCHR: -+ case S_IFIFO: -+ case S_IFSOCK: -+ btail = au_dbtail(dentry); -+ inode->i_op = iop + AuIop_OTHER; -+ init_special_inode(inode, mode, h_inode->i_rdev); -+ break; -+ default: -+ AuIOErr("Unknown file type 0%o\n", mode); -+ err = -EIO; -+ goto out; -+ } -+ -+ /* do not set hnotify for whiteouted dirs (SHWH mode) */ -+ flags = au_hi_flags(inode, isdir); -+ if (au_opt_test(au_mntflags(dentry->d_sb), SHWH) -+ && au_ftest_hi(flags, HNOTIFY) -+ && dentry->d_name.len > AUFS_WH_PFX_LEN -+ && !memcmp(dentry->d_name.name, AUFS_WH_PFX, AUFS_WH_PFX_LEN)) -+ au_fclr_hi(flags, HNOTIFY); -+ iinfo = au_ii(inode); -+ iinfo->ii_btop = btop; -+ iinfo->ii_bbot = btail; -+ for (bindex = btop; bindex <= btail; bindex++) { -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (h_dentry) -+ au_set_h_iptr(inode, bindex, -+ au_igrab(d_inode(h_dentry)), flags); -+ } -+ au_cpup_attr_all(inode, /*force*/1); -+ /* -+ * to force calling aufs_get_acl() every time, -+ * do not call cache_no_acl() for aufs inode. -+ */ -+ -+out: -+ return err; -+} -+ -+/* -+ * successful returns with iinfo write_locked -+ * minus: errno -+ * zero: success, matched -+ * plus: no error, but unmatched -+ */ -+static int reval_inode(struct inode *inode, struct dentry *dentry) -+{ -+ int err; -+ unsigned int gen, igflags; -+ aufs_bindex_t bindex, bbot; -+ struct inode *h_inode, *h_dinode; -+ struct dentry *h_dentry; -+ -+ /* -+ * before this function, if aufs got any iinfo lock, it must be only -+ * one, the parent dir. -+ * it can happen by UDBA and the obsoleted inode number. -+ */ -+ err = -EIO; -+ if (unlikely(inode->i_ino == parent_ino(dentry))) -+ goto out; -+ -+ err = 1; -+ ii_write_lock_new_child(inode); -+ h_dentry = au_h_dptr(dentry, au_dbtop(dentry)); -+ h_dinode = d_inode(h_dentry); -+ bbot = au_ibbot(inode); -+ for (bindex = au_ibtop(inode); bindex <= bbot; bindex++) { -+ h_inode = au_h_iptr(inode, bindex); -+ if (!h_inode || h_inode != h_dinode) -+ continue; -+ -+ err = 0; -+ gen = au_iigen(inode, &igflags); -+ if (gen == au_digen(dentry) -+ && !au_ig_ftest(igflags, HALF_REFRESHED)) -+ break; -+ -+ /* fully refresh inode using dentry */ -+ err = au_refresh_hinode(inode, dentry); -+ if (!err) -+ au_update_iigen(inode, /*half*/0); -+ break; -+ } -+ -+ if (unlikely(err)) -+ ii_write_unlock(inode); -+out: -+ return err; -+} -+ -+int au_ino(struct super_block *sb, aufs_bindex_t bindex, ino_t h_ino, -+ unsigned int d_type, ino_t *ino) -+{ -+ int err, idx; -+ const int isnondir = d_type != DT_DIR; -+ -+ /* prevent hardlinked inode number from race condition */ -+ if (isnondir) { -+ err = au_xinondir_enter(sb, bindex, h_ino, &idx); -+ if (unlikely(err)) -+ goto out; -+ } -+ -+ err = au_xino_read(sb, bindex, h_ino, ino); -+ if (unlikely(err)) -+ goto out_xinondir; -+ -+ if (!*ino) { -+ err = -EIO; -+ *ino = au_xino_new_ino(sb); -+ if (unlikely(!*ino)) -+ goto out_xinondir; -+ err = au_xino_write(sb, bindex, h_ino, *ino); -+ if (unlikely(err)) -+ goto out_xinondir; -+ } -+ -+out_xinondir: -+ if (isnondir && idx >= 0) -+ au_xinondir_leave(sb, bindex, h_ino, idx); -+out: -+ return err; -+} -+ -+/* successful returns with iinfo write_locked */ -+/* todo: return with unlocked? */ -+struct inode *au_new_inode(struct dentry *dentry, int must_new) -+{ -+ struct inode *inode, *h_inode; -+ struct dentry *h_dentry; -+ struct super_block *sb; -+ ino_t h_ino, ino; -+ int err, idx, hlinked; -+ aufs_bindex_t btop; -+ -+ sb = dentry->d_sb; -+ btop = au_dbtop(dentry); -+ h_dentry = au_h_dptr(dentry, btop); -+ h_inode = d_inode(h_dentry); -+ h_ino = h_inode->i_ino; -+ hlinked = !d_is_dir(h_dentry) && h_inode->i_nlink > 1; -+ -+new_ino: -+ /* -+ * stop 'race'-ing between hardlinks under different -+ * parents. -+ */ -+ if (hlinked) { -+ err = au_xinondir_enter(sb, btop, h_ino, &idx); -+ inode = ERR_PTR(err); -+ if (unlikely(err)) -+ goto out; -+ } -+ -+ err = au_xino_read(sb, btop, h_ino, &ino); -+ inode = ERR_PTR(err); -+ if (unlikely(err)) -+ goto out_xinondir; -+ -+ if (!ino) { -+ ino = au_xino_new_ino(sb); -+ if (unlikely(!ino)) { -+ inode = ERR_PTR(-EIO); -+ goto out_xinondir; -+ } -+ } -+ -+ AuDbg("i%lu\n", (unsigned long)ino); -+ inode = au_iget_locked(sb, ino); -+ err = PTR_ERR(inode); -+ if (IS_ERR(inode)) -+ goto out_xinondir; -+ -+ AuDbg("%lx, new %d\n", inode->i_state, !!(inode->i_state & I_NEW)); -+ if (inode->i_state & I_NEW) { -+ ii_write_lock_new_child(inode); -+ err = set_inode(inode, dentry); -+ if (!err) { -+ unlock_new_inode(inode); -+ goto out_xinondir; /* success */ -+ } -+ -+ /* -+ * iget_failed() calls iput(), but we need to call -+ * ii_write_unlock() after iget_failed(). so dirty hack for -+ * i_count. -+ */ -+ atomic_inc(&inode->i_count); -+ iget_failed(inode); -+ ii_write_unlock(inode); -+ au_xino_write(sb, btop, h_ino, /*ino*/0); -+ /* ignore this error */ -+ goto out_iput; -+ } else if (!must_new && !IS_DEADDIR(inode) && inode->i_nlink) { -+ /* -+ * horrible race condition between lookup, readdir and copyup -+ * (or something). -+ */ -+ if (hlinked && idx >= 0) -+ au_xinondir_leave(sb, btop, h_ino, idx); -+ err = reval_inode(inode, dentry); -+ if (unlikely(err < 0)) { -+ hlinked = 0; -+ goto out_iput; -+ } -+ if (!err) -+ goto out; /* success */ -+ else if (hlinked && idx >= 0) { -+ err = au_xinondir_enter(sb, btop, h_ino, &idx); -+ if (unlikely(err)) { -+ iput(inode); -+ inode = ERR_PTR(err); -+ goto out; -+ } -+ } -+ } -+ -+ if (unlikely(au_test_fs_unique_ino(h_inode))) -+ AuWarn1("Warning: Un-notified UDBA or repeatedly renamed dir," -+ " b%d, %s, %pd, hi%lu, i%lu.\n", -+ btop, au_sbtype(h_dentry->d_sb), dentry, -+ (unsigned long)h_ino, (unsigned long)ino); -+ ino = 0; -+ err = au_xino_write(sb, btop, h_ino, /*ino*/0); -+ if (!err) { -+ iput(inode); -+ if (hlinked && idx >= 0) -+ au_xinondir_leave(sb, btop, h_ino, idx); -+ goto new_ino; -+ } -+ -+out_iput: -+ iput(inode); -+ inode = ERR_PTR(err); -+out_xinondir: -+ if (hlinked && idx >= 0) -+ au_xinondir_leave(sb, btop, h_ino, idx); -+out: -+ return inode; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int au_test_ro(struct super_block *sb, aufs_bindex_t bindex, -+ struct inode *inode) -+{ -+ int err; -+ struct inode *hi; -+ -+ err = au_br_rdonly(au_sbr(sb, bindex)); -+ -+ /* pseudo-link after flushed may happen out of bounds */ -+ if (!err -+ && inode -+ && au_ibtop(inode) <= bindex -+ && bindex <= au_ibbot(inode)) { -+ /* -+ * permission check is unnecessary since vfsub routine -+ * will be called later -+ */ -+ hi = au_h_iptr(inode, bindex); -+ if (hi) -+ err = IS_IMMUTABLE(hi) ? -EROFS : 0; -+ } -+ -+ return err; -+} -+ -+int au_test_h_perm(struct inode *h_inode, int mask) -+{ -+ if (uid_eq(current_fsuid(), GLOBAL_ROOT_UID)) -+ return 0; -+ return inode_permission(h_inode, mask); -+} -+ -+int au_test_h_perm_sio(struct inode *h_inode, int mask) -+{ -+ if (au_test_nfs(h_inode->i_sb) -+ && (mask & MAY_WRITE) -+ && S_ISDIR(h_inode->i_mode)) -+ mask |= MAY_READ; /* force permission check */ -+ return au_test_h_perm(h_inode, mask); -+} -diff --git a/fs/aufs/inode.h b/fs/aufs/inode.h -new file mode 100644 -index 000000000000..2f8e518b283f ---- /dev/null -+++ b/fs/aufs/inode.h -@@ -0,0 +1,683 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * inode operations -+ */ -+ -+#ifndef __AUFS_INODE_H__ -+#define __AUFS_INODE_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+#include "rwsem.h" -+ -+struct vfsmount; -+ -+struct au_hnotify { -+#ifdef CONFIG_AUFS_HNOTIFY -+#ifdef CONFIG_AUFS_HFSNOTIFY -+ /* never use fsnotify_add_vfsmount_mark() */ -+ struct fsnotify_mark hn_mark; -+#endif -+ struct inode *hn_aufs_inode; /* no get/put */ -+#endif -+} ____cacheline_aligned_in_smp; -+ -+struct au_hinode { -+ struct inode *hi_inode; -+ aufs_bindex_t hi_id; -+#ifdef CONFIG_AUFS_HNOTIFY -+ struct au_hnotify *hi_notify; -+#endif -+ -+ /* reference to the copied-up whiteout with get/put */ -+ struct dentry *hi_whdentry; -+}; -+ -+/* ig_flags */ -+#define AuIG_HALF_REFRESHED 1 -+#define au_ig_ftest(flags, name) ((flags) & AuIG_##name) -+#define au_ig_fset(flags, name) \ -+ do { (flags) |= AuIG_##name; } while (0) -+#define au_ig_fclr(flags, name) \ -+ do { (flags) &= ~AuIG_##name; } while (0) -+ -+struct au_iigen { -+ spinlock_t ig_spin; -+ __u32 ig_generation, ig_flags; -+}; -+ -+struct au_vdir; -+struct au_iinfo { -+ struct au_iigen ii_generation; -+ struct super_block *ii_hsb1; /* no get/put */ -+ -+ struct au_rwsem ii_rwsem; -+ aufs_bindex_t ii_btop, ii_bbot; -+ __u32 ii_higen; -+ struct au_hinode *ii_hinode; -+ struct au_vdir *ii_vdir; -+}; -+ -+struct au_icntnr { -+ struct au_iinfo iinfo; -+ struct inode vfs_inode; -+ struct hlist_bl_node plink; -+} ____cacheline_aligned_in_smp; -+ -+/* au_pin flags */ -+#define AuPin_DI_LOCKED 1 -+#define AuPin_MNT_WRITE (1 << 1) -+#define au_ftest_pin(flags, name) ((flags) & AuPin_##name) -+#define au_fset_pin(flags, name) \ -+ do { (flags) |= AuPin_##name; } while (0) -+#define au_fclr_pin(flags, name) \ -+ do { (flags) &= ~AuPin_##name; } while (0) -+ -+struct au_pin { -+ /* input */ -+ struct dentry *dentry; -+ unsigned int udba; -+ unsigned char lsc_di, lsc_hi, flags; -+ aufs_bindex_t bindex; -+ -+ /* output */ -+ struct dentry *parent; -+ struct au_hinode *hdir; -+ struct vfsmount *h_mnt; -+ -+ /* temporary unlock/relock for copyup */ -+ struct dentry *h_dentry, *h_parent; -+ struct au_branch *br; -+ struct task_struct *task; -+}; -+ -+void au_pin_hdir_unlock(struct au_pin *p); -+int au_pin_hdir_lock(struct au_pin *p); -+int au_pin_hdir_relock(struct au_pin *p); -+void au_pin_hdir_acquire_nest(struct au_pin *p); -+void au_pin_hdir_release(struct au_pin *p); -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline struct au_iinfo *au_ii(struct inode *inode) -+{ -+ BUG_ON(is_bad_inode(inode)); -+ return &(container_of(inode, struct au_icntnr, vfs_inode)->iinfo); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* inode.c */ -+struct inode *au_igrab(struct inode *inode); -+void au_refresh_iop(struct inode *inode, int force_getattr); -+int au_refresh_hinode_self(struct inode *inode); -+int au_refresh_hinode(struct inode *inode, struct dentry *dentry); -+int au_ino(struct super_block *sb, aufs_bindex_t bindex, ino_t h_ino, -+ unsigned int d_type, ino_t *ino); -+struct inode *au_new_inode(struct dentry *dentry, int must_new); -+int au_test_ro(struct super_block *sb, aufs_bindex_t bindex, -+ struct inode *inode); -+int au_test_h_perm(struct inode *h_inode, int mask); -+int au_test_h_perm_sio(struct inode *h_inode, int mask); -+ -+static inline int au_wh_ino(struct super_block *sb, aufs_bindex_t bindex, -+ ino_t h_ino, unsigned int d_type, ino_t *ino) -+{ -+#ifdef CONFIG_AUFS_SHWH -+ return au_ino(sb, bindex, h_ino, d_type, ino); -+#else -+ return 0; -+#endif -+} -+ -+/* i_op.c */ -+enum { -+ AuIop_SYMLINK, -+ AuIop_DIR, -+ AuIop_OTHER, -+ AuIop_Last -+}; -+extern struct inode_operations aufs_iop[AuIop_Last], -+ aufs_iop_nogetattr[AuIop_Last]; -+ -+/* au_wr_dir flags */ -+#define AuWrDir_ADD_ENTRY 1 -+#define AuWrDir_ISDIR (1 << 1) -+#define AuWrDir_TMPFILE (1 << 2) -+#define au_ftest_wrdir(flags, name) ((flags) & AuWrDir_##name) -+#define au_fset_wrdir(flags, name) \ -+ do { (flags) |= AuWrDir_##name; } while (0) -+#define au_fclr_wrdir(flags, name) \ -+ do { (flags) &= ~AuWrDir_##name; } while (0) -+ -+struct au_wr_dir_args { -+ aufs_bindex_t force_btgt; -+ unsigned char flags; -+}; -+int au_wr_dir(struct dentry *dentry, struct dentry *src_dentry, -+ struct au_wr_dir_args *args); -+ -+struct dentry *au_pinned_h_parent(struct au_pin *pin); -+void au_pin_init(struct au_pin *pin, struct dentry *dentry, -+ aufs_bindex_t bindex, int lsc_di, int lsc_hi, -+ unsigned int udba, unsigned char flags); -+int au_pin(struct au_pin *pin, struct dentry *dentry, aufs_bindex_t bindex, -+ unsigned int udba, unsigned char flags) __must_check; -+int au_do_pin(struct au_pin *pin) __must_check; -+void au_unpin(struct au_pin *pin); -+int au_reval_for_attr(struct dentry *dentry, unsigned int sigen); -+ -+#define AuIcpup_DID_CPUP 1 -+#define au_ftest_icpup(flags, name) ((flags) & AuIcpup_##name) -+#define au_fset_icpup(flags, name) \ -+ do { (flags) |= AuIcpup_##name; } while (0) -+#define au_fclr_icpup(flags, name) \ -+ do { (flags) &= ~AuIcpup_##name; } while (0) -+ -+struct au_icpup_args { -+ unsigned char flags; -+ unsigned char pin_flags; -+ aufs_bindex_t btgt; -+ unsigned int udba; -+ struct au_pin pin; -+ struct path h_path; -+ struct inode *h_inode; -+}; -+ -+int au_pin_and_icpup(struct dentry *dentry, struct iattr *ia, -+ struct au_icpup_args *a); -+ -+int au_h_path_getattr(struct dentry *dentry, int force, struct path *h_path, -+ int locked); -+ -+/* i_op_add.c */ -+int au_may_add(struct dentry *dentry, aufs_bindex_t bindex, -+ struct dentry *h_parent, int isdir); -+int aufs_mknod(struct inode *dir, struct dentry *dentry, umode_t mode, -+ dev_t dev); -+int aufs_symlink(struct inode *dir, struct dentry *dentry, const char *symname); -+int aufs_create(struct inode *dir, struct dentry *dentry, umode_t mode, -+ bool want_excl); -+struct vfsub_aopen_args; -+int au_aopen_or_create(struct inode *dir, struct dentry *dentry, -+ struct vfsub_aopen_args *args); -+int aufs_tmpfile(struct inode *dir, struct dentry *dentry, umode_t mode); -+int aufs_link(struct dentry *src_dentry, struct inode *dir, -+ struct dentry *dentry); -+int aufs_mkdir(struct inode *dir, struct dentry *dentry, umode_t mode); -+ -+/* i_op_del.c */ -+int au_wr_dir_need_wh(struct dentry *dentry, int isdir, aufs_bindex_t *bcpup); -+int au_may_del(struct dentry *dentry, aufs_bindex_t bindex, -+ struct dentry *h_parent, int isdir); -+int aufs_unlink(struct inode *dir, struct dentry *dentry); -+int aufs_rmdir(struct inode *dir, struct dentry *dentry); -+ -+/* i_op_ren.c */ -+int au_wbr(struct dentry *dentry, aufs_bindex_t btgt); -+int aufs_rename(struct inode *src_dir, struct dentry *src_dentry, -+ struct inode *dir, struct dentry *dentry, -+ unsigned int flags); -+ -+/* iinfo.c */ -+struct inode *au_h_iptr(struct inode *inode, aufs_bindex_t bindex); -+void au_hiput(struct au_hinode *hinode); -+void au_set_hi_wh(struct inode *inode, aufs_bindex_t bindex, -+ struct dentry *h_wh); -+unsigned int au_hi_flags(struct inode *inode, int isdir); -+ -+/* hinode flags */ -+#define AuHi_XINO 1 -+#define AuHi_HNOTIFY (1 << 1) -+#define au_ftest_hi(flags, name) ((flags) & AuHi_##name) -+#define au_fset_hi(flags, name) \ -+ do { (flags) |= AuHi_##name; } while (0) -+#define au_fclr_hi(flags, name) \ -+ do { (flags) &= ~AuHi_##name; } while (0) -+ -+#ifndef CONFIG_AUFS_HNOTIFY -+#undef AuHi_HNOTIFY -+#define AuHi_HNOTIFY 0 -+#endif -+ -+void au_set_h_iptr(struct inode *inode, aufs_bindex_t bindex, -+ struct inode *h_inode, unsigned int flags); -+ -+void au_update_iigen(struct inode *inode, int half); -+void au_update_ibrange(struct inode *inode, int do_put_zero); -+ -+void au_icntnr_init_once(void *_c); -+void au_hinode_init(struct au_hinode *hinode); -+int au_iinfo_init(struct inode *inode); -+void au_iinfo_fin(struct inode *inode); -+int au_hinode_realloc(struct au_iinfo *iinfo, int nbr, int may_shrink); -+ -+#ifdef CONFIG_PROC_FS -+/* plink.c */ -+int au_plink_maint(struct super_block *sb, int flags); -+struct au_sbinfo; -+void au_plink_maint_leave(struct au_sbinfo *sbinfo); -+int au_plink_maint_enter(struct super_block *sb); -+#ifdef CONFIG_AUFS_DEBUG -+void au_plink_list(struct super_block *sb); -+#else -+AuStubVoid(au_plink_list, struct super_block *sb) -+#endif -+int au_plink_test(struct inode *inode); -+struct dentry *au_plink_lkup(struct inode *inode, aufs_bindex_t bindex); -+void au_plink_append(struct inode *inode, aufs_bindex_t bindex, -+ struct dentry *h_dentry); -+void au_plink_put(struct super_block *sb, int verbose); -+void au_plink_clean(struct super_block *sb, int verbose); -+void au_plink_half_refresh(struct super_block *sb, aufs_bindex_t br_id); -+#else -+AuStubInt0(au_plink_maint, struct super_block *sb, int flags); -+AuStubVoid(au_plink_maint_leave, struct au_sbinfo *sbinfo); -+AuStubInt0(au_plink_maint_enter, struct super_block *sb); -+AuStubVoid(au_plink_list, struct super_block *sb); -+AuStubInt0(au_plink_test, struct inode *inode); -+AuStub(struct dentry *, au_plink_lkup, return NULL, -+ struct inode *inode, aufs_bindex_t bindex); -+AuStubVoid(au_plink_append, struct inode *inode, aufs_bindex_t bindex, -+ struct dentry *h_dentry); -+AuStubVoid(au_plink_put, struct super_block *sb, int verbose); -+AuStubVoid(au_plink_clean, struct super_block *sb, int verbose); -+AuStubVoid(au_plink_half_refresh, struct super_block *sb, aufs_bindex_t br_id); -+#endif /* CONFIG_PROC_FS */ -+ -+#ifdef CONFIG_AUFS_XATTR -+/* xattr.c */ -+int au_cpup_xattr(struct dentry *h_dst, struct dentry *h_src, int ignore_flags, -+ unsigned int verbose); -+ssize_t aufs_listxattr(struct dentry *dentry, char *list, size_t size); -+void au_xattr_init(struct super_block *sb); -+#else -+AuStubInt0(au_cpup_xattr, struct dentry *h_dst, struct dentry *h_src, -+ int ignore_flags, unsigned int verbose); -+AuStubVoid(au_xattr_init, struct super_block *sb); -+#endif -+ -+#ifdef CONFIG_FS_POSIX_ACL -+struct posix_acl *aufs_get_acl(struct inode *inode, int type); -+int aufs_set_acl(struct inode *inode, struct posix_acl *acl, int type); -+#endif -+ -+#if IS_ENABLED(CONFIG_AUFS_XATTR) || IS_ENABLED(CONFIG_FS_POSIX_ACL) -+enum { -+ AU_XATTR_SET, -+ AU_ACL_SET -+}; -+ -+struct au_sxattr { -+ int type; -+ union { -+ struct { -+ const char *name; -+ const void *value; -+ size_t size; -+ int flags; -+ } set; -+ struct { -+ struct posix_acl *acl; -+ int type; -+ } acl_set; -+ } u; -+}; -+ssize_t au_sxattr(struct dentry *dentry, struct inode *inode, -+ struct au_sxattr *arg); -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* lock subclass for iinfo */ -+enum { -+ AuLsc_II_CHILD, /* child first */ -+ AuLsc_II_CHILD2, /* rename(2), link(2), and cpup at hnotify */ -+ AuLsc_II_CHILD3, /* copyup dirs */ -+ AuLsc_II_PARENT, /* see AuLsc_I_PARENT in vfsub.h */ -+ AuLsc_II_PARENT2, -+ AuLsc_II_PARENT3, /* copyup dirs */ -+ AuLsc_II_NEW_CHILD -+}; -+ -+/* -+ * ii_read_lock_child, ii_write_lock_child, -+ * ii_read_lock_child2, ii_write_lock_child2, -+ * ii_read_lock_child3, ii_write_lock_child3, -+ * ii_read_lock_parent, ii_write_lock_parent, -+ * ii_read_lock_parent2, ii_write_lock_parent2, -+ * ii_read_lock_parent3, ii_write_lock_parent3, -+ * ii_read_lock_new_child, ii_write_lock_new_child, -+ */ -+#define AuReadLockFunc(name, lsc) \ -+static inline void ii_read_lock_##name(struct inode *i) \ -+{ \ -+ au_rw_read_lock_nested(&au_ii(i)->ii_rwsem, AuLsc_II_##lsc); \ -+} -+ -+#define AuWriteLockFunc(name, lsc) \ -+static inline void ii_write_lock_##name(struct inode *i) \ -+{ \ -+ au_rw_write_lock_nested(&au_ii(i)->ii_rwsem, AuLsc_II_##lsc); \ -+} -+ -+#define AuRWLockFuncs(name, lsc) \ -+ AuReadLockFunc(name, lsc) \ -+ AuWriteLockFunc(name, lsc) -+ -+AuRWLockFuncs(child, CHILD); -+AuRWLockFuncs(child2, CHILD2); -+AuRWLockFuncs(child3, CHILD3); -+AuRWLockFuncs(parent, PARENT); -+AuRWLockFuncs(parent2, PARENT2); -+AuRWLockFuncs(parent3, PARENT3); -+AuRWLockFuncs(new_child, NEW_CHILD); -+ -+#undef AuReadLockFunc -+#undef AuWriteLockFunc -+#undef AuRWLockFuncs -+ -+#define ii_read_unlock(i) au_rw_read_unlock(&au_ii(i)->ii_rwsem) -+#define ii_write_unlock(i) au_rw_write_unlock(&au_ii(i)->ii_rwsem) -+#define ii_downgrade_lock(i) au_rw_dgrade_lock(&au_ii(i)->ii_rwsem) -+ -+#define IiMustNoWaiters(i) AuRwMustNoWaiters(&au_ii(i)->ii_rwsem) -+#define IiMustAnyLock(i) AuRwMustAnyLock(&au_ii(i)->ii_rwsem) -+#define IiMustWriteLock(i) AuRwMustWriteLock(&au_ii(i)->ii_rwsem) -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline void au_icntnr_init(struct au_icntnr *c) -+{ -+#ifdef CONFIG_AUFS_DEBUG -+ c->vfs_inode.i_mode = 0; -+#endif -+} -+ -+static inline unsigned int au_iigen(struct inode *inode, unsigned int *igflags) -+{ -+ unsigned int gen; -+ struct au_iinfo *iinfo; -+ struct au_iigen *iigen; -+ -+ iinfo = au_ii(inode); -+ iigen = &iinfo->ii_generation; -+ spin_lock(&iigen->ig_spin); -+ if (igflags) -+ *igflags = iigen->ig_flags; -+ gen = iigen->ig_generation; -+ spin_unlock(&iigen->ig_spin); -+ -+ return gen; -+} -+ -+/* tiny test for inode number */ -+/* tmpfs generation is too rough */ -+static inline int au_test_higen(struct inode *inode, struct inode *h_inode) -+{ -+ struct au_iinfo *iinfo; -+ -+ iinfo = au_ii(inode); -+ AuRwMustAnyLock(&iinfo->ii_rwsem); -+ return !(iinfo->ii_hsb1 == h_inode->i_sb -+ && iinfo->ii_higen == h_inode->i_generation); -+} -+ -+static inline void au_iigen_dec(struct inode *inode) -+{ -+ struct au_iinfo *iinfo; -+ struct au_iigen *iigen; -+ -+ iinfo = au_ii(inode); -+ iigen = &iinfo->ii_generation; -+ spin_lock(&iigen->ig_spin); -+ iigen->ig_generation--; -+ spin_unlock(&iigen->ig_spin); -+} -+ -+static inline int au_iigen_test(struct inode *inode, unsigned int sigen) -+{ -+ int err; -+ -+ err = 0; -+ if (unlikely(inode && au_iigen(inode, NULL) != sigen)) -+ err = -EIO; -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline struct au_hinode *au_hinode(struct au_iinfo *iinfo, -+ aufs_bindex_t bindex) -+{ -+ return iinfo->ii_hinode + bindex; -+} -+ -+static inline int au_is_bad_inode(struct inode *inode) -+{ -+ return !!(is_bad_inode(inode) || !au_hinode(au_ii(inode), 0)); -+} -+ -+static inline aufs_bindex_t au_ii_br_id(struct inode *inode, -+ aufs_bindex_t bindex) -+{ -+ IiMustAnyLock(inode); -+ return au_hinode(au_ii(inode), bindex)->hi_id; -+} -+ -+static inline aufs_bindex_t au_ibtop(struct inode *inode) -+{ -+ IiMustAnyLock(inode); -+ return au_ii(inode)->ii_btop; -+} -+ -+static inline aufs_bindex_t au_ibbot(struct inode *inode) -+{ -+ IiMustAnyLock(inode); -+ return au_ii(inode)->ii_bbot; -+} -+ -+static inline struct au_vdir *au_ivdir(struct inode *inode) -+{ -+ IiMustAnyLock(inode); -+ return au_ii(inode)->ii_vdir; -+} -+ -+static inline struct dentry *au_hi_wh(struct inode *inode, aufs_bindex_t bindex) -+{ -+ IiMustAnyLock(inode); -+ return au_hinode(au_ii(inode), bindex)->hi_whdentry; -+} -+ -+static inline void au_set_ibtop(struct inode *inode, aufs_bindex_t bindex) -+{ -+ IiMustWriteLock(inode); -+ au_ii(inode)->ii_btop = bindex; -+} -+ -+static inline void au_set_ibbot(struct inode *inode, aufs_bindex_t bindex) -+{ -+ IiMustWriteLock(inode); -+ au_ii(inode)->ii_bbot = bindex; -+} -+ -+static inline void au_set_ivdir(struct inode *inode, struct au_vdir *vdir) -+{ -+ IiMustWriteLock(inode); -+ au_ii(inode)->ii_vdir = vdir; -+} -+ -+static inline struct au_hinode *au_hi(struct inode *inode, aufs_bindex_t bindex) -+{ -+ IiMustAnyLock(inode); -+ return au_hinode(au_ii(inode), bindex); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline struct dentry *au_pinned_parent(struct au_pin *pin) -+{ -+ if (pin) -+ return pin->parent; -+ return NULL; -+} -+ -+static inline struct inode *au_pinned_h_dir(struct au_pin *pin) -+{ -+ if (pin && pin->hdir) -+ return pin->hdir->hi_inode; -+ return NULL; -+} -+ -+static inline struct au_hinode *au_pinned_hdir(struct au_pin *pin) -+{ -+ if (pin) -+ return pin->hdir; -+ return NULL; -+} -+ -+static inline void au_pin_set_dentry(struct au_pin *pin, struct dentry *dentry) -+{ -+ if (pin) -+ pin->dentry = dentry; -+} -+ -+static inline void au_pin_set_parent_lflag(struct au_pin *pin, -+ unsigned char lflag) -+{ -+ if (pin) { -+ if (lflag) -+ au_fset_pin(pin->flags, DI_LOCKED); -+ else -+ au_fclr_pin(pin->flags, DI_LOCKED); -+ } -+} -+ -+#if 0 /* reserved */ -+static inline void au_pin_set_parent(struct au_pin *pin, struct dentry *parent) -+{ -+ if (pin) { -+ dput(pin->parent); -+ pin->parent = dget(parent); -+ } -+} -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct au_branch; -+#ifdef CONFIG_AUFS_HNOTIFY -+struct au_hnotify_op { -+ void (*ctl)(struct au_hinode *hinode, int do_set); -+ int (*alloc)(struct au_hinode *hinode); -+ -+ /* -+ * if it returns true, the the caller should free hinode->hi_notify, -+ * otherwise ->free() frees it. -+ */ -+ int (*free)(struct au_hinode *hinode, -+ struct au_hnotify *hn) __must_check; -+ -+ void (*fin)(void); -+ int (*init)(void); -+ -+ int (*reset_br)(unsigned int udba, struct au_branch *br, int perm); -+ void (*fin_br)(struct au_branch *br); -+ int (*init_br)(struct au_branch *br, int perm); -+}; -+ -+/* hnotify.c */ -+int au_hn_alloc(struct au_hinode *hinode, struct inode *inode); -+void au_hn_free(struct au_hinode *hinode); -+void au_hn_ctl(struct au_hinode *hinode, int do_set); -+void au_hn_reset(struct inode *inode, unsigned int flags); -+int au_hnotify(struct inode *h_dir, struct au_hnotify *hnotify, u32 mask, -+ struct qstr *h_child_qstr, struct inode *h_child_inode); -+int au_hnotify_reset_br(unsigned int udba, struct au_branch *br, int perm); -+int au_hnotify_init_br(struct au_branch *br, int perm); -+void au_hnotify_fin_br(struct au_branch *br); -+int __init au_hnotify_init(void); -+void au_hnotify_fin(void); -+ -+/* hfsnotify.c */ -+extern const struct au_hnotify_op au_hnotify_op; -+ -+static inline -+void au_hn_init(struct au_hinode *hinode) -+{ -+ hinode->hi_notify = NULL; -+} -+ -+static inline struct au_hnotify *au_hn(struct au_hinode *hinode) -+{ -+ return hinode->hi_notify; -+} -+ -+#else -+AuStub(int, au_hn_alloc, return -EOPNOTSUPP, -+ struct au_hinode *hinode __maybe_unused, -+ struct inode *inode __maybe_unused) -+AuStub(struct au_hnotify *, au_hn, return NULL, struct au_hinode *hinode) -+AuStubVoid(au_hn_free, struct au_hinode *hinode __maybe_unused) -+AuStubVoid(au_hn_ctl, struct au_hinode *hinode __maybe_unused, -+ int do_set __maybe_unused) -+AuStubVoid(au_hn_reset, struct inode *inode __maybe_unused, -+ unsigned int flags __maybe_unused) -+AuStubInt0(au_hnotify_reset_br, unsigned int udba __maybe_unused, -+ struct au_branch *br __maybe_unused, -+ int perm __maybe_unused) -+AuStubInt0(au_hnotify_init_br, struct au_branch *br __maybe_unused, -+ int perm __maybe_unused) -+AuStubVoid(au_hnotify_fin_br, struct au_branch *br __maybe_unused) -+AuStubInt0(__init au_hnotify_init, void) -+AuStubVoid(au_hnotify_fin, void) -+AuStubVoid(au_hn_init, struct au_hinode *hinode __maybe_unused) -+#endif /* CONFIG_AUFS_HNOTIFY */ -+ -+static inline void au_hn_suspend(struct au_hinode *hdir) -+{ -+ au_hn_ctl(hdir, /*do_set*/0); -+} -+ -+static inline void au_hn_resume(struct au_hinode *hdir) -+{ -+ au_hn_ctl(hdir, /*do_set*/1); -+} -+ -+static inline void au_hn_inode_lock(struct au_hinode *hdir) -+{ -+ inode_lock(hdir->hi_inode); -+ au_hn_suspend(hdir); -+} -+ -+static inline void au_hn_inode_lock_nested(struct au_hinode *hdir, -+ unsigned int sc __maybe_unused) -+{ -+ inode_lock_nested(hdir->hi_inode, sc); -+ au_hn_suspend(hdir); -+} -+ -+#if 0 /* unused */ -+#include "vfsub.h" -+static inline void au_hn_inode_lock_shared_nested(struct au_hinode *hdir, -+ unsigned int sc) -+{ -+ vfsub_inode_lock_shared_nested(hdir->hi_inode, sc); -+ au_hn_suspend(hdir); -+} -+#endif -+ -+static inline void au_hn_inode_unlock(struct au_hinode *hdir) -+{ -+ au_hn_resume(hdir); -+ inode_unlock(hdir->hi_inode); -+} -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_INODE_H__ */ -diff --git a/fs/aufs/ioctl.c b/fs/aufs/ioctl.c -new file mode 100644 -index 000000000000..4714d2167447 ---- /dev/null -+++ b/fs/aufs/ioctl.c -@@ -0,0 +1,207 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * ioctl -+ * plink-management and readdir in userspace. -+ * assist the pathconf(3) wrapper library. -+ * move-down -+ * File-based Hierarchical Storage Management. -+ */ -+ -+#include -+#include -+#include "aufs.h" -+ -+static int au_wbr_fd(struct path *path, struct aufs_wbr_fd __user *arg) -+{ -+ int err, fd; -+ aufs_bindex_t wbi, bindex, bbot; -+ struct file *h_file; -+ struct super_block *sb; -+ struct dentry *root; -+ struct au_branch *br; -+ struct aufs_wbr_fd wbrfd = { -+ .oflags = au_dir_roflags, -+ .brid = -1 -+ }; -+ const int valid = O_RDONLY | O_NONBLOCK | O_LARGEFILE | O_DIRECTORY -+ | O_NOATIME | O_CLOEXEC; -+ -+ AuDebugOn(wbrfd.oflags & ~valid); -+ -+ if (arg) { -+ err = copy_from_user(&wbrfd, arg, sizeof(wbrfd)); -+ if (unlikely(err)) { -+ err = -EFAULT; -+ goto out; -+ } -+ -+ err = -EINVAL; -+ AuDbg("wbrfd{0%o, %d}\n", wbrfd.oflags, wbrfd.brid); -+ wbrfd.oflags |= au_dir_roflags; -+ AuDbg("0%o\n", wbrfd.oflags); -+ if (unlikely(wbrfd.oflags & ~valid)) -+ goto out; -+ } -+ -+ fd = get_unused_fd_flags(0); -+ err = fd; -+ if (unlikely(fd < 0)) -+ goto out; -+ -+ h_file = ERR_PTR(-EINVAL); -+ wbi = 0; -+ br = NULL; -+ sb = path->dentry->d_sb; -+ root = sb->s_root; -+ aufs_read_lock(root, AuLock_IR); -+ bbot = au_sbbot(sb); -+ if (wbrfd.brid >= 0) { -+ wbi = au_br_index(sb, wbrfd.brid); -+ if (unlikely(wbi < 0 || wbi > bbot)) -+ goto out_unlock; -+ } -+ -+ h_file = ERR_PTR(-ENOENT); -+ br = au_sbr(sb, wbi); -+ if (!au_br_writable(br->br_perm)) { -+ if (arg) -+ goto out_unlock; -+ -+ bindex = wbi + 1; -+ wbi = -1; -+ for (; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ if (au_br_writable(br->br_perm)) { -+ wbi = bindex; -+ br = au_sbr(sb, wbi); -+ break; -+ } -+ } -+ } -+ AuDbg("wbi %d\n", wbi); -+ if (wbi >= 0) -+ h_file = au_h_open(root, wbi, wbrfd.oflags, NULL, -+ /*force_wr*/0); -+ -+out_unlock: -+ aufs_read_unlock(root, AuLock_IR); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out_fd; -+ -+ au_br_put(br); /* cf. au_h_open() */ -+ fd_install(fd, h_file); -+ err = fd; -+ goto out; /* success */ -+ -+out_fd: -+ put_unused_fd(fd); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+long aufs_ioctl_dir(struct file *file, unsigned int cmd, unsigned long arg) -+{ -+ long err; -+ struct dentry *dentry; -+ -+ switch (cmd) { -+ case AUFS_CTL_RDU: -+ case AUFS_CTL_RDU_INO: -+ err = au_rdu_ioctl(file, cmd, arg); -+ break; -+ -+ case AUFS_CTL_WBR_FD: -+ err = au_wbr_fd(&file->f_path, (void __user *)arg); -+ break; -+ -+ case AUFS_CTL_IBUSY: -+ err = au_ibusy_ioctl(file, arg); -+ break; -+ -+ case AUFS_CTL_BRINFO: -+ err = au_brinfo_ioctl(file, arg); -+ break; -+ -+ case AUFS_CTL_FHSM_FD: -+ dentry = file->f_path.dentry; -+ if (IS_ROOT(dentry)) -+ err = au_fhsm_fd(dentry->d_sb, arg); -+ else -+ err = -ENOTTY; -+ break; -+ -+ default: -+ /* do not call the lower */ -+ AuDbg("0x%x\n", cmd); -+ err = -ENOTTY; -+ } -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+long aufs_ioctl_nondir(struct file *file, unsigned int cmd, unsigned long arg) -+{ -+ long err; -+ -+ switch (cmd) { -+ case AUFS_CTL_MVDOWN: -+ err = au_mvdown(file->f_path.dentry, (void __user *)arg); -+ break; -+ -+ case AUFS_CTL_WBR_FD: -+ err = au_wbr_fd(&file->f_path, (void __user *)arg); -+ break; -+ -+ default: -+ /* do not call the lower */ -+ AuDbg("0x%x\n", cmd); -+ err = -ENOTTY; -+ } -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+#ifdef CONFIG_COMPAT -+long aufs_compat_ioctl_dir(struct file *file, unsigned int cmd, -+ unsigned long arg) -+{ -+ long err; -+ -+ switch (cmd) { -+ case AUFS_CTL_RDU: -+ case AUFS_CTL_RDU_INO: -+ err = au_rdu_compat_ioctl(file, cmd, arg); -+ break; -+ -+ case AUFS_CTL_IBUSY: -+ err = au_ibusy_compat_ioctl(file, arg); -+ break; -+ -+ case AUFS_CTL_BRINFO: -+ err = au_brinfo_compat_ioctl(file, arg); -+ break; -+ -+ default: -+ err = aufs_ioctl_dir(file, cmd, arg); -+ } -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+long aufs_compat_ioctl_nondir(struct file *file, unsigned int cmd, -+ unsigned long arg) -+{ -+ return aufs_ioctl_nondir(file, cmd, (unsigned long)compat_ptr(arg)); -+} -+#endif -diff --git a/fs/aufs/loop.c b/fs/aufs/loop.c -new file mode 100644 -index 000000000000..3b217c24dd12 ---- /dev/null -+++ b/fs/aufs/loop.c -@@ -0,0 +1,135 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * support for loopback block device as a branch -+ */ -+ -+#include "aufs.h" -+ -+/* added into drivers/block/loop.c */ -+static struct file *(*backing_file_func)(struct super_block *sb); -+ -+/* -+ * test if two lower dentries have overlapping branches. -+ */ -+int au_test_loopback_overlap(struct super_block *sb, struct dentry *h_adding) -+{ -+ struct super_block *h_sb; -+ struct file *backing_file; -+ -+ if (unlikely(!backing_file_func)) { -+ /* don't load "loop" module here */ -+ backing_file_func = symbol_get(loop_backing_file); -+ if (unlikely(!backing_file_func)) -+ /* "loop" module is not loaded */ -+ return 0; -+ } -+ -+ h_sb = h_adding->d_sb; -+ backing_file = backing_file_func(h_sb); -+ if (!backing_file) -+ return 0; -+ -+ h_adding = backing_file->f_path.dentry; -+ /* -+ * h_adding can be local NFS. -+ * in this case aufs cannot detect the loop. -+ */ -+ if (unlikely(h_adding->d_sb == sb)) -+ return 1; -+ return !!au_test_subdir(h_adding, sb->s_root); -+} -+ -+/* true if a kernel thread named 'loop[0-9].*' accesses a file */ -+int au_test_loopback_kthread(void) -+{ -+ int ret; -+ struct task_struct *tsk = current; -+ char c, comm[sizeof(tsk->comm)]; -+ -+ ret = 0; -+ if (tsk->flags & PF_KTHREAD) { -+ get_task_comm(comm, tsk); -+ c = comm[4]; -+ ret = ('0' <= c && c <= '9' -+ && !strncmp(comm, "loop", 4)); -+ } -+ -+ return ret; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+#define au_warn_loopback_step 16 -+static int au_warn_loopback_nelem = au_warn_loopback_step; -+static unsigned long *au_warn_loopback_array; -+ -+void au_warn_loopback(struct super_block *h_sb) -+{ -+ int i, new_nelem; -+ unsigned long *a, magic; -+ static DEFINE_SPINLOCK(spin); -+ -+ magic = h_sb->s_magic; -+ spin_lock(&spin); -+ a = au_warn_loopback_array; -+ for (i = 0; i < au_warn_loopback_nelem && *a; i++) -+ if (a[i] == magic) { -+ spin_unlock(&spin); -+ return; -+ } -+ -+ /* h_sb is new to us, print it */ -+ if (i < au_warn_loopback_nelem) { -+ a[i] = magic; -+ goto pr; -+ } -+ -+ /* expand the array */ -+ new_nelem = au_warn_loopback_nelem + au_warn_loopback_step; -+ a = au_kzrealloc(au_warn_loopback_array, -+ au_warn_loopback_nelem * sizeof(unsigned long), -+ new_nelem * sizeof(unsigned long), GFP_ATOMIC, -+ /*may_shrink*/0); -+ if (a) { -+ au_warn_loopback_nelem = new_nelem; -+ au_warn_loopback_array = a; -+ a[i] = magic; -+ goto pr; -+ } -+ -+ spin_unlock(&spin); -+ AuWarn1("realloc failed, ignored\n"); -+ return; -+ -+pr: -+ spin_unlock(&spin); -+ pr_warn("you may want to try another patch for loopback file " -+ "on %s(0x%lx) branch\n", au_sbtype(h_sb), magic); -+} -+ -+int au_loopback_init(void) -+{ -+ int err; -+ struct super_block *sb __maybe_unused; -+ -+ BUILD_BUG_ON(sizeof(sb->s_magic) != sizeof(unsigned long)); -+ -+ err = 0; -+ au_warn_loopback_array = kcalloc(au_warn_loopback_step, -+ sizeof(unsigned long), GFP_NOFS); -+ if (unlikely(!au_warn_loopback_array)) -+ err = -ENOMEM; -+ -+ return err; -+} -+ -+void au_loopback_fin(void) -+{ -+ if (backing_file_func) -+ symbol_put(loop_backing_file); -+ kfree(au_warn_loopback_array); -+} -diff --git a/fs/aufs/loop.h b/fs/aufs/loop.h -new file mode 100644 -index 000000000000..7d7bf342c4d8 ---- /dev/null -+++ b/fs/aufs/loop.h -@@ -0,0 +1,40 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * support for loopback mount as a branch -+ */ -+ -+#ifndef __AUFS_LOOP_H__ -+#define __AUFS_LOOP_H__ -+ -+#ifdef __KERNEL__ -+ -+struct dentry; -+struct super_block; -+ -+#ifdef CONFIG_AUFS_BDEV_LOOP -+/* drivers/block/loop.c */ -+struct file *loop_backing_file(struct super_block *sb); -+ -+/* loop.c */ -+int au_test_loopback_overlap(struct super_block *sb, struct dentry *h_adding); -+int au_test_loopback_kthread(void); -+void au_warn_loopback(struct super_block *h_sb); -+ -+int au_loopback_init(void); -+void au_loopback_fin(void); -+#else -+AuStubInt0(au_test_loopback_overlap, struct super_block *sb, -+ struct dentry *h_adding) -+AuStubInt0(au_test_loopback_kthread, void) -+AuStubVoid(au_warn_loopback, struct super_block *h_sb) -+ -+AuStubInt0(au_loopback_init, void) -+AuStubVoid(au_loopback_fin, void) -+#endif /* BLK_DEV_LOOP */ -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_LOOP_H__ */ -diff --git a/fs/aufs/magic.mk b/fs/aufs/magic.mk -new file mode 100644 -index 000000000000..7bc9eef3ffec ---- /dev/null -+++ b/fs/aufs/magic.mk -@@ -0,0 +1,31 @@ -+# SPDX-License-Identifier: GPL-2.0 -+ -+# defined in ${srctree}/fs/fuse/inode.c -+# tristate -+ifdef CONFIG_FUSE_FS -+ccflags-y += -DFUSE_SUPER_MAGIC=0x65735546 -+endif -+ -+# defined in ${srctree}/fs/xfs/xfs_sb.h -+# tristate -+ifdef CONFIG_XFS_FS -+ccflags-y += -DXFS_SB_MAGIC=0x58465342 -+endif -+ -+# defined in ${srctree}/fs/configfs/mount.c -+# tristate -+ifdef CONFIG_CONFIGFS_FS -+ccflags-y += -DCONFIGFS_MAGIC=0x62656570 -+endif -+ -+# defined in ${srctree}/fs/ubifs/ubifs.h -+# tristate -+ifdef CONFIG_UBIFS_FS -+ccflags-y += -DUBIFS_SUPER_MAGIC=0x24051905 -+endif -+ -+# defined in ${srctree}/fs/hfsplus/hfsplus_raw.h -+# tristate -+ifdef CONFIG_HFSPLUS_FS -+ccflags-y += -DHFSPLUS_SUPER_MAGIC=0x482b -+endif -diff --git a/fs/aufs/module.c b/fs/aufs/module.c -new file mode 100644 -index 000000000000..7cde174ad9e1 ---- /dev/null -+++ b/fs/aufs/module.c -@@ -0,0 +1,253 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * module global variables and operations -+ */ -+ -+#include -+#include -+#include "aufs.h" -+ -+/* shrinkable realloc */ -+void *au_krealloc(void *p, unsigned int new_sz, gfp_t gfp, int may_shrink) -+{ -+ size_t sz; -+ int diff; -+ -+ sz = 0; -+ diff = -1; -+ if (p) { -+#if 0 /* unused */ -+ if (!new_sz) { -+ kfree(p); -+ p = NULL; -+ goto out; -+ } -+#else -+ AuDebugOn(!new_sz); -+#endif -+ sz = ksize(p); -+ diff = au_kmidx_sub(sz, new_sz); -+ } -+ if (sz && !diff) -+ goto out; -+ -+ if (sz < new_sz) -+ /* expand or SLOB */ -+ p = krealloc(p, new_sz, gfp); -+ else if (new_sz < sz && may_shrink) { -+ /* shrink */ -+ void *q; -+ -+ q = kmalloc(new_sz, gfp); -+ if (q) { -+ if (p) { -+ memcpy(q, p, new_sz); -+ kfree(p); -+ } -+ p = q; -+ } else -+ p = NULL; -+ } -+ -+out: -+ return p; -+} -+ -+void *au_kzrealloc(void *p, unsigned int nused, unsigned int new_sz, gfp_t gfp, -+ int may_shrink) -+{ -+ p = au_krealloc(p, new_sz, gfp, may_shrink); -+ if (p && new_sz > nused) -+ memset(p + nused, 0, new_sz - nused); -+ return p; -+} -+ -+/* ---------------------------------------------------------------------- */ -+/* -+ * aufs caches -+ */ -+struct kmem_cache *au_cache[AuCache_Last]; -+ -+static void au_cache_fin(void) -+{ -+ int i; -+ -+ /* -+ * Make sure all delayed rcu free inodes are flushed before we -+ * destroy cache. -+ */ -+ rcu_barrier(); -+ -+ /* excluding AuCache_HNOTIFY */ -+ BUILD_BUG_ON(AuCache_HNOTIFY + 1 != AuCache_Last); -+ for (i = 0; i < AuCache_HNOTIFY; i++) { -+ kmem_cache_destroy(au_cache[i]); -+ au_cache[i] = NULL; -+ } -+} -+ -+static int __init au_cache_init(void) -+{ -+ au_cache[AuCache_DINFO] = AuCacheCtor(au_dinfo, au_di_init_once); -+ if (au_cache[AuCache_DINFO]) -+ /* SLAB_DESTROY_BY_RCU */ -+ au_cache[AuCache_ICNTNR] = AuCacheCtor(au_icntnr, -+ au_icntnr_init_once); -+ if (au_cache[AuCache_ICNTNR]) -+ au_cache[AuCache_FINFO] = AuCacheCtor(au_finfo, -+ au_fi_init_once); -+ if (au_cache[AuCache_FINFO]) -+ au_cache[AuCache_VDIR] = AuCache(au_vdir); -+ if (au_cache[AuCache_VDIR]) -+ au_cache[AuCache_DEHSTR] = AuCache(au_vdir_dehstr); -+ if (au_cache[AuCache_DEHSTR]) -+ return 0; -+ -+ au_cache_fin(); -+ return -ENOMEM; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int au_dir_roflags; -+ -+#ifdef CONFIG_AUFS_SBILIST -+/* -+ * iterate_supers_type() doesn't protect us from -+ * remounting (branch management) -+ */ -+struct hlist_bl_head au_sbilist; -+#endif -+ -+/* -+ * functions for module interface. -+ */ -+MODULE_LICENSE("GPL"); -+/* MODULE_LICENSE("GPL v2"); */ -+MODULE_AUTHOR("Junjiro R. Okajima "); -+MODULE_DESCRIPTION(AUFS_NAME -+ " -- Advanced multi layered unification filesystem"); -+MODULE_VERSION(AUFS_VERSION); -+ -+/* this module parameter has no meaning when SYSFS is disabled */ -+int sysaufs_brs = 1; -+MODULE_PARM_DESC(brs, "use /fs/aufs/si_*/brN"); -+module_param_named(brs, sysaufs_brs, int, S_IRUGO); -+ -+/* this module parameter has no meaning when USER_NS is disabled */ -+bool au_userns; -+MODULE_PARM_DESC(allow_userns, "allow unprivileged to mount under userns"); -+module_param_named(allow_userns, au_userns, bool, S_IRUGO); -+ -+/* ---------------------------------------------------------------------- */ -+ -+static char au_esc_chars[0x20 + 3]; /* 0x01-0x20, backslash, del, and NULL */ -+ -+int au_seq_path(struct seq_file *seq, struct path *path) -+{ -+ int err; -+ -+ err = seq_path(seq, path, au_esc_chars); -+ if (err >= 0) -+ err = 0; -+ else -+ err = -ENOMEM; -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int __init aufs_init(void) -+{ -+ int err, i; -+ char *p; -+ -+ p = au_esc_chars; -+ for (i = 1; i <= ' '; i++) -+ *p++ = i; -+ *p++ = '\\'; -+ *p++ = '\x7f'; -+ *p = 0; -+ -+ au_dir_roflags = au_file_roflags(O_DIRECTORY | O_LARGEFILE); -+ -+ memcpy(aufs_iop_nogetattr, aufs_iop, sizeof(aufs_iop)); -+ for (i = 0; i < AuIop_Last; i++) -+ aufs_iop_nogetattr[i].getattr = NULL; -+ -+ memset(au_cache, 0, sizeof(au_cache)); /* including hnotify */ -+ -+ au_sbilist_init(); -+ sysaufs_brs_init(); -+ au_debug_init(); -+ au_dy_init(); -+ err = sysaufs_init(); -+ if (unlikely(err)) -+ goto out; -+ err = au_procfs_init(); -+ if (unlikely(err)) -+ goto out_sysaufs; -+ err = au_wkq_init(); -+ if (unlikely(err)) -+ goto out_procfs; -+ err = au_loopback_init(); -+ if (unlikely(err)) -+ goto out_wkq; -+ err = au_hnotify_init(); -+ if (unlikely(err)) -+ goto out_loopback; -+ err = au_sysrq_init(); -+ if (unlikely(err)) -+ goto out_hin; -+ err = au_cache_init(); -+ if (unlikely(err)) -+ goto out_sysrq; -+ -+ aufs_fs_type.fs_flags |= au_userns ? FS_USERNS_MOUNT : 0; -+ err = register_filesystem(&aufs_fs_type); -+ if (unlikely(err)) -+ goto out_cache; -+ -+ /* since we define pr_fmt, call printk directly */ -+ printk(KERN_INFO AUFS_NAME " " AUFS_VERSION "\n"); -+ goto out; /* success */ -+ -+out_cache: -+ au_cache_fin(); -+out_sysrq: -+ au_sysrq_fin(); -+out_hin: -+ au_hnotify_fin(); -+out_loopback: -+ au_loopback_fin(); -+out_wkq: -+ au_wkq_fin(); -+out_procfs: -+ au_procfs_fin(); -+out_sysaufs: -+ sysaufs_fin(); -+ au_dy_fin(); -+out: -+ return err; -+} -+ -+static void __exit aufs_exit(void) -+{ -+ unregister_filesystem(&aufs_fs_type); -+ au_cache_fin(); -+ au_sysrq_fin(); -+ au_hnotify_fin(); -+ au_loopback_fin(); -+ au_wkq_fin(); -+ au_procfs_fin(); -+ sysaufs_fin(); -+ au_dy_fin(); -+} -+ -+module_init(aufs_init); -+module_exit(aufs_exit); -diff --git a/fs/aufs/module.h b/fs/aufs/module.h -new file mode 100644 -index 000000000000..f5f31430427d ---- /dev/null -+++ b/fs/aufs/module.h -@@ -0,0 +1,89 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * module initialization and module-global -+ */ -+ -+#ifndef __AUFS_MODULE_H__ -+#define __AUFS_MODULE_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+ -+struct path; -+struct seq_file; -+ -+/* module parameters */ -+extern int sysaufs_brs; -+extern bool au_userns; -+ -+/* ---------------------------------------------------------------------- */ -+ -+extern int au_dir_roflags; -+ -+void *au_krealloc(void *p, unsigned int new_sz, gfp_t gfp, int may_shrink); -+void *au_kzrealloc(void *p, unsigned int nused, unsigned int new_sz, gfp_t gfp, -+ int may_shrink); -+ -+static inline int au_kmidx_sub(size_t sz, size_t new_sz) -+{ -+#ifndef CONFIG_SLOB -+ return kmalloc_index(sz) - kmalloc_index(new_sz); -+#else -+ return -1; /* SLOB is untested */ -+#endif -+} -+ -+int au_seq_path(struct seq_file *seq, struct path *path); -+ -+#ifdef CONFIG_PROC_FS -+/* procfs.c */ -+int __init au_procfs_init(void); -+void au_procfs_fin(void); -+#else -+AuStubInt0(au_procfs_init, void); -+AuStubVoid(au_procfs_fin, void); -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* kmem cache */ -+enum { -+ AuCache_DINFO, -+ AuCache_ICNTNR, -+ AuCache_FINFO, -+ AuCache_VDIR, -+ AuCache_DEHSTR, -+ AuCache_HNOTIFY, /* must be last */ -+ AuCache_Last -+}; -+ -+extern struct kmem_cache *au_cache[AuCache_Last]; -+ -+#define AuCacheFlags (SLAB_RECLAIM_ACCOUNT | SLAB_MEM_SPREAD) -+#define AuCache(type) KMEM_CACHE(type, AuCacheFlags) -+#define AuCacheCtor(type, ctor) \ -+ kmem_cache_create(#type, sizeof(struct type), \ -+ __alignof__(struct type), AuCacheFlags, ctor) -+ -+#define AuCacheFuncs(name, index) \ -+static inline struct au_##name *au_cache_alloc_##name(void) \ -+{ return kmem_cache_alloc(au_cache[AuCache_##index], GFP_NOFS); } \ -+static inline void au_cache_free_##name(struct au_##name *p) \ -+{ kmem_cache_free(au_cache[AuCache_##index], p); } -+ -+AuCacheFuncs(dinfo, DINFO); -+AuCacheFuncs(icntnr, ICNTNR); -+AuCacheFuncs(finfo, FINFO); -+AuCacheFuncs(vdir, VDIR); -+AuCacheFuncs(vdir_dehstr, DEHSTR); -+#ifdef CONFIG_AUFS_HNOTIFY -+AuCacheFuncs(hnotify, HNOTIFY); -+#endif -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_MODULE_H__ */ -diff --git a/fs/aufs/mvdown.c b/fs/aufs/mvdown.c -new file mode 100644 -index 000000000000..57f24f22e4a6 ---- /dev/null -+++ b/fs/aufs/mvdown.c -@@ -0,0 +1,692 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2011-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * move-down, opposite of copy-up -+ */ -+ -+#include "aufs.h" -+ -+struct au_mvd_args { -+ struct { -+ struct super_block *h_sb; -+ struct dentry *h_parent; -+ struct au_hinode *hdir; -+ struct inode *h_dir, *h_inode; -+ struct au_pin pin; -+ } info[AUFS_MVDOWN_NARRAY]; -+ -+ struct aufs_mvdown mvdown; -+ struct dentry *dentry, *parent; -+ struct inode *inode, *dir; -+ struct super_block *sb; -+ aufs_bindex_t bopq, bwh, bfound; -+ unsigned char rename_lock; -+}; -+ -+#define mvd_errno mvdown.au_errno -+#define mvd_bsrc mvdown.stbr[AUFS_MVDOWN_UPPER].bindex -+#define mvd_src_brid mvdown.stbr[AUFS_MVDOWN_UPPER].brid -+#define mvd_bdst mvdown.stbr[AUFS_MVDOWN_LOWER].bindex -+#define mvd_dst_brid mvdown.stbr[AUFS_MVDOWN_LOWER].brid -+ -+#define mvd_h_src_sb info[AUFS_MVDOWN_UPPER].h_sb -+#define mvd_h_src_parent info[AUFS_MVDOWN_UPPER].h_parent -+#define mvd_hdir_src info[AUFS_MVDOWN_UPPER].hdir -+#define mvd_h_src_dir info[AUFS_MVDOWN_UPPER].h_dir -+#define mvd_h_src_inode info[AUFS_MVDOWN_UPPER].h_inode -+#define mvd_pin_src info[AUFS_MVDOWN_UPPER].pin -+ -+#define mvd_h_dst_sb info[AUFS_MVDOWN_LOWER].h_sb -+#define mvd_h_dst_parent info[AUFS_MVDOWN_LOWER].h_parent -+#define mvd_hdir_dst info[AUFS_MVDOWN_LOWER].hdir -+#define mvd_h_dst_dir info[AUFS_MVDOWN_LOWER].h_dir -+#define mvd_h_dst_inode info[AUFS_MVDOWN_LOWER].h_inode -+#define mvd_pin_dst info[AUFS_MVDOWN_LOWER].pin -+ -+#define AU_MVD_PR(flag, ...) do { \ -+ if (flag) \ -+ pr_err(__VA_ARGS__); \ -+ } while (0) -+ -+static int find_lower_writable(struct au_mvd_args *a) -+{ -+ struct super_block *sb; -+ aufs_bindex_t bindex, bbot; -+ struct au_branch *br; -+ -+ sb = a->sb; -+ bindex = a->mvd_bsrc; -+ bbot = au_sbbot(sb); -+ if (a->mvdown.flags & AUFS_MVDOWN_FHSM_LOWER) -+ for (bindex++; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ if (au_br_fhsm(br->br_perm) -+ && !sb_rdonly(au_br_sb(br))) -+ return bindex; -+ } -+ else if (!(a->mvdown.flags & AUFS_MVDOWN_ROLOWER)) -+ for (bindex++; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ if (!au_br_rdonly(br)) -+ return bindex; -+ } -+ else -+ for (bindex++; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ if (!sb_rdonly(au_br_sb(br))) { -+ if (au_br_rdonly(br)) -+ a->mvdown.flags -+ |= AUFS_MVDOWN_ROLOWER_R; -+ return bindex; -+ } -+ } -+ -+ return -1; -+} -+ -+/* make the parent dir on bdst */ -+static int au_do_mkdir(const unsigned char dmsg, struct au_mvd_args *a) -+{ -+ int err; -+ -+ err = 0; -+ a->mvd_hdir_src = au_hi(a->dir, a->mvd_bsrc); -+ a->mvd_hdir_dst = au_hi(a->dir, a->mvd_bdst); -+ a->mvd_h_src_parent = au_h_dptr(a->parent, a->mvd_bsrc); -+ a->mvd_h_dst_parent = NULL; -+ if (au_dbbot(a->parent) >= a->mvd_bdst) -+ a->mvd_h_dst_parent = au_h_dptr(a->parent, a->mvd_bdst); -+ if (!a->mvd_h_dst_parent) { -+ err = au_cpdown_dirs(a->dentry, a->mvd_bdst); -+ if (unlikely(err)) { -+ AU_MVD_PR(dmsg, "cpdown_dirs failed\n"); -+ goto out; -+ } -+ a->mvd_h_dst_parent = au_h_dptr(a->parent, a->mvd_bdst); -+ } -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* lock them all */ -+static int au_do_lock(const unsigned char dmsg, struct au_mvd_args *a) -+{ -+ int err; -+ struct dentry *h_trap; -+ -+ a->mvd_h_src_sb = au_sbr_sb(a->sb, a->mvd_bsrc); -+ a->mvd_h_dst_sb = au_sbr_sb(a->sb, a->mvd_bdst); -+ err = au_pin(&a->mvd_pin_dst, a->dentry, a->mvd_bdst, -+ au_opt_udba(a->sb), -+ AuPin_MNT_WRITE | AuPin_DI_LOCKED); -+ AuTraceErr(err); -+ if (unlikely(err)) { -+ AU_MVD_PR(dmsg, "pin_dst failed\n"); -+ goto out; -+ } -+ -+ if (a->mvd_h_src_sb != a->mvd_h_dst_sb) { -+ a->rename_lock = 0; -+ au_pin_init(&a->mvd_pin_src, a->dentry, a->mvd_bsrc, -+ AuLsc_DI_PARENT, AuLsc_I_PARENT3, -+ au_opt_udba(a->sb), -+ AuPin_MNT_WRITE | AuPin_DI_LOCKED); -+ err = au_do_pin(&a->mvd_pin_src); -+ AuTraceErr(err); -+ a->mvd_h_src_dir = d_inode(a->mvd_h_src_parent); -+ if (unlikely(err)) { -+ AU_MVD_PR(dmsg, "pin_src failed\n"); -+ goto out_dst; -+ } -+ goto out; /* success */ -+ } -+ -+ a->rename_lock = 1; -+ au_pin_hdir_unlock(&a->mvd_pin_dst); -+ err = au_pin(&a->mvd_pin_src, a->dentry, a->mvd_bsrc, -+ au_opt_udba(a->sb), -+ AuPin_MNT_WRITE | AuPin_DI_LOCKED); -+ AuTraceErr(err); -+ a->mvd_h_src_dir = d_inode(a->mvd_h_src_parent); -+ if (unlikely(err)) { -+ AU_MVD_PR(dmsg, "pin_src failed\n"); -+ au_pin_hdir_lock(&a->mvd_pin_dst); -+ goto out_dst; -+ } -+ au_pin_hdir_unlock(&a->mvd_pin_src); -+ h_trap = vfsub_lock_rename(a->mvd_h_src_parent, a->mvd_hdir_src, -+ a->mvd_h_dst_parent, a->mvd_hdir_dst); -+ if (h_trap) { -+ err = (h_trap != a->mvd_h_src_parent); -+ if (err) -+ err = (h_trap != a->mvd_h_dst_parent); -+ } -+ BUG_ON(err); /* it should never happen */ -+ if (unlikely(a->mvd_h_src_dir != au_pinned_h_dir(&a->mvd_pin_src))) { -+ err = -EBUSY; -+ AuTraceErr(err); -+ vfsub_unlock_rename(a->mvd_h_src_parent, a->mvd_hdir_src, -+ a->mvd_h_dst_parent, a->mvd_hdir_dst); -+ au_pin_hdir_lock(&a->mvd_pin_src); -+ au_unpin(&a->mvd_pin_src); -+ au_pin_hdir_lock(&a->mvd_pin_dst); -+ goto out_dst; -+ } -+ goto out; /* success */ -+ -+out_dst: -+ au_unpin(&a->mvd_pin_dst); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+static void au_do_unlock(const unsigned char dmsg, struct au_mvd_args *a) -+{ -+ if (!a->rename_lock) -+ au_unpin(&a->mvd_pin_src); -+ else { -+ vfsub_unlock_rename(a->mvd_h_src_parent, a->mvd_hdir_src, -+ a->mvd_h_dst_parent, a->mvd_hdir_dst); -+ au_pin_hdir_lock(&a->mvd_pin_src); -+ au_unpin(&a->mvd_pin_src); -+ au_pin_hdir_lock(&a->mvd_pin_dst); -+ } -+ au_unpin(&a->mvd_pin_dst); -+} -+ -+/* copy-down the file */ -+static int au_do_cpdown(const unsigned char dmsg, struct au_mvd_args *a) -+{ -+ int err; -+ struct au_cp_generic cpg = { -+ .dentry = a->dentry, -+ .bdst = a->mvd_bdst, -+ .bsrc = a->mvd_bsrc, -+ .len = -1, -+ .pin = &a->mvd_pin_dst, -+ .flags = AuCpup_DTIME | AuCpup_HOPEN -+ }; -+ -+ AuDbg("b%d, b%d\n", cpg.bsrc, cpg.bdst); -+ if (a->mvdown.flags & AUFS_MVDOWN_OWLOWER) -+ au_fset_cpup(cpg.flags, OVERWRITE); -+ if (a->mvdown.flags & AUFS_MVDOWN_ROLOWER) -+ au_fset_cpup(cpg.flags, RWDST); -+ err = au_sio_cpdown_simple(&cpg); -+ if (unlikely(err)) -+ AU_MVD_PR(dmsg, "cpdown failed\n"); -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+/* -+ * unlink the whiteout on bdst if exist which may be created by UDBA while we -+ * were sleeping -+ */ -+static int au_do_unlink_wh(const unsigned char dmsg, struct au_mvd_args *a) -+{ -+ int err; -+ struct path h_path; -+ struct au_branch *br; -+ struct inode *delegated; -+ -+ br = au_sbr(a->sb, a->mvd_bdst); -+ h_path.dentry = au_wh_lkup(a->mvd_h_dst_parent, &a->dentry->d_name, br); -+ err = PTR_ERR(h_path.dentry); -+ if (IS_ERR(h_path.dentry)) { -+ AU_MVD_PR(dmsg, "wh_lkup failed\n"); -+ goto out; -+ } -+ -+ err = 0; -+ if (d_is_positive(h_path.dentry)) { -+ h_path.mnt = au_br_mnt(br); -+ delegated = NULL; -+ err = vfsub_unlink(d_inode(a->mvd_h_dst_parent), &h_path, -+ &delegated, /*force*/0); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal unlink\n"); -+ iput(delegated); -+ } -+ if (unlikely(err)) -+ AU_MVD_PR(dmsg, "wh_unlink failed\n"); -+ } -+ dput(h_path.dentry); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* -+ * unlink the topmost h_dentry -+ */ -+static int au_do_unlink(const unsigned char dmsg, struct au_mvd_args *a) -+{ -+ int err; -+ struct path h_path; -+ struct inode *delegated; -+ -+ h_path.mnt = au_sbr_mnt(a->sb, a->mvd_bsrc); -+ h_path.dentry = au_h_dptr(a->dentry, a->mvd_bsrc); -+ delegated = NULL; -+ err = vfsub_unlink(a->mvd_h_src_dir, &h_path, &delegated, /*force*/0); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal unlink\n"); -+ iput(delegated); -+ } -+ if (unlikely(err)) -+ AU_MVD_PR(dmsg, "unlink failed\n"); -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+/* Since mvdown succeeded, we ignore an error of this function */ -+static void au_do_stfs(const unsigned char dmsg, struct au_mvd_args *a) -+{ -+ int err; -+ struct au_branch *br; -+ -+ a->mvdown.flags |= AUFS_MVDOWN_STFS_FAILED; -+ br = au_sbr(a->sb, a->mvd_bsrc); -+ err = au_br_stfs(br, &a->mvdown.stbr[AUFS_MVDOWN_UPPER].stfs); -+ if (!err) { -+ br = au_sbr(a->sb, a->mvd_bdst); -+ a->mvdown.stbr[AUFS_MVDOWN_LOWER].brid = br->br_id; -+ err = au_br_stfs(br, &a->mvdown.stbr[AUFS_MVDOWN_LOWER].stfs); -+ } -+ if (!err) -+ a->mvdown.flags &= ~AUFS_MVDOWN_STFS_FAILED; -+ else -+ AU_MVD_PR(dmsg, "statfs failed (%d), ignored\n", err); -+} -+ -+/* -+ * copy-down the file and unlink the bsrc file. -+ * - unlink the bdst whout if exist -+ * - copy-down the file (with whtmp name and rename) -+ * - unlink the bsrc file -+ */ -+static int au_do_mvdown(const unsigned char dmsg, struct au_mvd_args *a) -+{ -+ int err; -+ -+ err = au_do_mkdir(dmsg, a); -+ if (!err) -+ err = au_do_lock(dmsg, a); -+ if (unlikely(err)) -+ goto out; -+ -+ /* -+ * do not revert the activities we made on bdst since they should be -+ * harmless in aufs. -+ */ -+ -+ err = au_do_cpdown(dmsg, a); -+ if (!err) -+ err = au_do_unlink_wh(dmsg, a); -+ if (!err && !(a->mvdown.flags & AUFS_MVDOWN_KUPPER)) -+ err = au_do_unlink(dmsg, a); -+ if (unlikely(err)) -+ goto out_unlock; -+ -+ AuDbg("%pd2, 0x%x, %d --> %d\n", -+ a->dentry, a->mvdown.flags, a->mvd_bsrc, a->mvd_bdst); -+ if (find_lower_writable(a) < 0) -+ a->mvdown.flags |= AUFS_MVDOWN_BOTTOM; -+ -+ if (a->mvdown.flags & AUFS_MVDOWN_STFS) -+ au_do_stfs(dmsg, a); -+ -+ /* maintain internal array */ -+ if (!(a->mvdown.flags & AUFS_MVDOWN_KUPPER)) { -+ au_set_h_dptr(a->dentry, a->mvd_bsrc, NULL); -+ au_set_dbtop(a->dentry, a->mvd_bdst); -+ au_set_h_iptr(a->inode, a->mvd_bsrc, NULL, /*flags*/0); -+ au_set_ibtop(a->inode, a->mvd_bdst); -+ } else { -+ /* hide the lower */ -+ au_set_h_dptr(a->dentry, a->mvd_bdst, NULL); -+ au_set_dbbot(a->dentry, a->mvd_bsrc); -+ au_set_h_iptr(a->inode, a->mvd_bdst, NULL, /*flags*/0); -+ au_set_ibbot(a->inode, a->mvd_bsrc); -+ } -+ if (au_dbbot(a->dentry) < a->mvd_bdst) -+ au_set_dbbot(a->dentry, a->mvd_bdst); -+ if (au_ibbot(a->inode) < a->mvd_bdst) -+ au_set_ibbot(a->inode, a->mvd_bdst); -+ -+out_unlock: -+ au_do_unlock(dmsg, a); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* make sure the file is idle */ -+static int au_mvd_args_busy(const unsigned char dmsg, struct au_mvd_args *a) -+{ -+ int err, plinked; -+ -+ err = 0; -+ plinked = !!au_opt_test(au_mntflags(a->sb), PLINK); -+ if (au_dbtop(a->dentry) == a->mvd_bsrc -+ && au_dcount(a->dentry) == 1 -+ && atomic_read(&a->inode->i_count) == 1 -+ /* && a->mvd_h_src_inode->i_nlink == 1 */ -+ && (!plinked || !au_plink_test(a->inode)) -+ && a->inode->i_nlink == 1) -+ goto out; -+ -+ err = -EBUSY; -+ AU_MVD_PR(dmsg, -+ "b%d, d{b%d, c%d?}, i{c%d?, l%u}, hi{l%u}, p{%d, %d}\n", -+ a->mvd_bsrc, au_dbtop(a->dentry), au_dcount(a->dentry), -+ atomic_read(&a->inode->i_count), a->inode->i_nlink, -+ a->mvd_h_src_inode->i_nlink, -+ plinked, plinked ? au_plink_test(a->inode) : 0); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* make sure the parent dir is fine */ -+static int au_mvd_args_parent(const unsigned char dmsg, -+ struct au_mvd_args *a) -+{ -+ int err; -+ aufs_bindex_t bindex; -+ -+ err = 0; -+ if (unlikely(au_alive_dir(a->parent))) { -+ err = -ENOENT; -+ AU_MVD_PR(dmsg, "parent dir is dead\n"); -+ goto out; -+ } -+ -+ a->bopq = au_dbdiropq(a->parent); -+ bindex = au_wbr_nonopq(a->dentry, a->mvd_bdst); -+ AuDbg("b%d\n", bindex); -+ if (unlikely((bindex >= 0 && bindex < a->mvd_bdst) -+ || (a->bopq != -1 && a->bopq < a->mvd_bdst))) { -+ err = -EINVAL; -+ a->mvd_errno = EAU_MVDOWN_OPAQUE; -+ AU_MVD_PR(dmsg, "ancestor is opaque b%d, b%d\n", -+ a->bopq, a->mvd_bdst); -+ } -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+static int au_mvd_args_intermediate(const unsigned char dmsg, -+ struct au_mvd_args *a) -+{ -+ int err; -+ struct au_dinfo *dinfo, *tmp; -+ -+ /* lookup the next lower positive entry */ -+ err = -ENOMEM; -+ tmp = au_di_alloc(a->sb, AuLsc_DI_TMP); -+ if (unlikely(!tmp)) -+ goto out; -+ -+ a->bfound = -1; -+ a->bwh = -1; -+ dinfo = au_di(a->dentry); -+ au_di_cp(tmp, dinfo); -+ au_di_swap(tmp, dinfo); -+ -+ /* returns the number of positive dentries */ -+ err = au_lkup_dentry(a->dentry, a->mvd_bsrc + 1, -+ /* AuLkup_IGNORE_PERM */ 0); -+ if (!err) -+ a->bwh = au_dbwh(a->dentry); -+ else if (err > 0) -+ a->bfound = au_dbtop(a->dentry); -+ -+ au_di_swap(tmp, dinfo); -+ au_rw_write_unlock(&tmp->di_rwsem); -+ au_di_free(tmp); -+ if (unlikely(err < 0)) -+ AU_MVD_PR(dmsg, "failed look-up lower\n"); -+ -+ /* -+ * here, we have these cases. -+ * bfound == -1 -+ * no positive dentry under bsrc. there are more sub-cases. -+ * bwh < 0 -+ * there no whiteout, we can safely move-down. -+ * bwh <= bsrc -+ * impossible -+ * bsrc < bwh && bwh < bdst -+ * there is a whiteout on RO branch. cannot proceed. -+ * bwh == bdst -+ * there is a whiteout on the RW target branch. it should -+ * be removed. -+ * bdst < bwh -+ * there is a whiteout somewhere unrelated branch. -+ * -1 < bfound && bfound <= bsrc -+ * impossible. -+ * bfound < bdst -+ * found, but it is on RO branch between bsrc and bdst. cannot -+ * proceed. -+ * bfound == bdst -+ * found, replace it if AUFS_MVDOWN_FORCE is set. otherwise return -+ * error. -+ * bdst < bfound -+ * found, after we create the file on bdst, it will be hidden. -+ */ -+ -+ AuDebugOn(a->bfound == -1 -+ && a->bwh != -1 -+ && a->bwh <= a->mvd_bsrc); -+ AuDebugOn(-1 < a->bfound -+ && a->bfound <= a->mvd_bsrc); -+ -+ err = -EINVAL; -+ if (a->bfound == -1 -+ && a->mvd_bsrc < a->bwh -+ && a->bwh != -1 -+ && a->bwh < a->mvd_bdst) { -+ a->mvd_errno = EAU_MVDOWN_WHITEOUT; -+ AU_MVD_PR(dmsg, "bsrc %d, bdst %d, bfound %d, bwh %d\n", -+ a->mvd_bsrc, a->mvd_bdst, a->bfound, a->bwh); -+ goto out; -+ } else if (a->bfound != -1 && a->bfound < a->mvd_bdst) { -+ a->mvd_errno = EAU_MVDOWN_UPPER; -+ AU_MVD_PR(dmsg, "bdst %d, bfound %d\n", -+ a->mvd_bdst, a->bfound); -+ goto out; -+ } -+ -+ err = 0; /* success */ -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+static int au_mvd_args_exist(const unsigned char dmsg, struct au_mvd_args *a) -+{ -+ int err; -+ -+ err = 0; -+ if (!(a->mvdown.flags & AUFS_MVDOWN_OWLOWER) -+ && a->bfound == a->mvd_bdst) -+ err = -EEXIST; -+ AuTraceErr(err); -+ return err; -+} -+ -+static int au_mvd_args(const unsigned char dmsg, struct au_mvd_args *a) -+{ -+ int err; -+ struct au_branch *br; -+ -+ err = -EISDIR; -+ if (unlikely(S_ISDIR(a->inode->i_mode))) -+ goto out; -+ -+ err = -EINVAL; -+ if (!(a->mvdown.flags & AUFS_MVDOWN_BRID_UPPER)) -+ a->mvd_bsrc = au_ibtop(a->inode); -+ else { -+ a->mvd_bsrc = au_br_index(a->sb, a->mvd_src_brid); -+ if (unlikely(a->mvd_bsrc < 0 -+ || (a->mvd_bsrc < au_dbtop(a->dentry) -+ || au_dbbot(a->dentry) < a->mvd_bsrc -+ || !au_h_dptr(a->dentry, a->mvd_bsrc)) -+ || (a->mvd_bsrc < au_ibtop(a->inode) -+ || au_ibbot(a->inode) < a->mvd_bsrc -+ || !au_h_iptr(a->inode, a->mvd_bsrc)))) { -+ a->mvd_errno = EAU_MVDOWN_NOUPPER; -+ AU_MVD_PR(dmsg, "no upper\n"); -+ goto out; -+ } -+ } -+ if (unlikely(a->mvd_bsrc == au_sbbot(a->sb))) { -+ a->mvd_errno = EAU_MVDOWN_BOTTOM; -+ AU_MVD_PR(dmsg, "on the bottom\n"); -+ goto out; -+ } -+ a->mvd_h_src_inode = au_h_iptr(a->inode, a->mvd_bsrc); -+ br = au_sbr(a->sb, a->mvd_bsrc); -+ err = au_br_rdonly(br); -+ if (!(a->mvdown.flags & AUFS_MVDOWN_ROUPPER)) { -+ if (unlikely(err)) -+ goto out; -+ } else if (!(vfsub_native_ro(a->mvd_h_src_inode) -+ || IS_APPEND(a->mvd_h_src_inode))) { -+ if (err) -+ a->mvdown.flags |= AUFS_MVDOWN_ROUPPER_R; -+ /* go on */ -+ } else -+ goto out; -+ -+ err = -EINVAL; -+ if (!(a->mvdown.flags & AUFS_MVDOWN_BRID_LOWER)) { -+ a->mvd_bdst = find_lower_writable(a); -+ if (unlikely(a->mvd_bdst < 0)) { -+ a->mvd_errno = EAU_MVDOWN_BOTTOM; -+ AU_MVD_PR(dmsg, "no writable lower branch\n"); -+ goto out; -+ } -+ } else { -+ a->mvd_bdst = au_br_index(a->sb, a->mvd_dst_brid); -+ if (unlikely(a->mvd_bdst < 0 -+ || au_sbbot(a->sb) < a->mvd_bdst)) { -+ a->mvd_errno = EAU_MVDOWN_NOLOWERBR; -+ AU_MVD_PR(dmsg, "no lower brid\n"); -+ goto out; -+ } -+ } -+ -+ err = au_mvd_args_busy(dmsg, a); -+ if (!err) -+ err = au_mvd_args_parent(dmsg, a); -+ if (!err) -+ err = au_mvd_args_intermediate(dmsg, a); -+ if (!err) -+ err = au_mvd_args_exist(dmsg, a); -+ if (!err) -+ AuDbg("b%d, b%d\n", a->mvd_bsrc, a->mvd_bdst); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+int au_mvdown(struct dentry *dentry, struct aufs_mvdown __user *uarg) -+{ -+ int err, e; -+ unsigned char dmsg; -+ struct au_mvd_args *args; -+ struct inode *inode; -+ -+ inode = d_inode(dentry); -+ err = -EPERM; -+ if (unlikely(!capable(CAP_SYS_ADMIN))) -+ goto out; -+ -+ err = -ENOMEM; -+ args = kmalloc(sizeof(*args), GFP_NOFS); -+ if (unlikely(!args)) -+ goto out; -+ -+ err = copy_from_user(&args->mvdown, uarg, sizeof(args->mvdown)); -+ if (!err) -+ err = !access_ok(VERIFY_WRITE, uarg, sizeof(*uarg)); -+ if (unlikely(err)) { -+ err = -EFAULT; -+ AuTraceErr(err); -+ goto out_free; -+ } -+ AuDbg("flags 0x%x\n", args->mvdown.flags); -+ args->mvdown.flags &= ~(AUFS_MVDOWN_ROLOWER_R | AUFS_MVDOWN_ROUPPER_R); -+ args->mvdown.au_errno = 0; -+ args->dentry = dentry; -+ args->inode = inode; -+ args->sb = dentry->d_sb; -+ -+ err = -ENOENT; -+ dmsg = !!(args->mvdown.flags & AUFS_MVDOWN_DMSG); -+ args->parent = dget_parent(dentry); -+ args->dir = d_inode(args->parent); -+ inode_lock_nested(args->dir, I_MUTEX_PARENT); -+ dput(args->parent); -+ if (unlikely(args->parent != dentry->d_parent)) { -+ AU_MVD_PR(dmsg, "parent dir is moved\n"); -+ goto out_dir; -+ } -+ -+ inode_lock_nested(inode, I_MUTEX_CHILD); -+ err = aufs_read_lock(dentry, AuLock_DW | AuLock_FLUSH | AuLock_NOPLMW); -+ if (unlikely(err)) -+ goto out_inode; -+ -+ di_write_lock_parent(args->parent); -+ err = au_mvd_args(dmsg, args); -+ if (unlikely(err)) -+ goto out_parent; -+ -+ err = au_do_mvdown(dmsg, args); -+ if (unlikely(err)) -+ goto out_parent; -+ -+ au_cpup_attr_timesizes(args->dir); -+ au_cpup_attr_timesizes(inode); -+ if (!(args->mvdown.flags & AUFS_MVDOWN_KUPPER)) -+ au_cpup_igen(inode, au_h_iptr(inode, args->mvd_bdst)); -+ /* au_digen_dec(dentry); */ -+ -+out_parent: -+ di_write_unlock(args->parent); -+ aufs_read_unlock(dentry, AuLock_DW); -+out_inode: -+ inode_unlock(inode); -+out_dir: -+ inode_unlock(args->dir); -+out_free: -+ e = copy_to_user(uarg, &args->mvdown, sizeof(args->mvdown)); -+ if (unlikely(e)) -+ err = -EFAULT; -+ kfree(args); -+out: -+ AuTraceErr(err); -+ return err; -+} -diff --git a/fs/aufs/opts.c b/fs/aufs/opts.c -new file mode 100644 -index 000000000000..40c506207806 ---- /dev/null -+++ b/fs/aufs/opts.c -@@ -0,0 +1,1879 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * mount options/flags -+ */ -+ -+#include -+#include /* a distribution requires */ -+#include -+#include "aufs.h" -+ -+/* ---------------------------------------------------------------------- */ -+ -+enum { -+ Opt_br, -+ Opt_add, Opt_del, Opt_mod, Opt_append, Opt_prepend, -+ Opt_idel, Opt_imod, -+ Opt_dirwh, Opt_rdcache, Opt_rdblk, Opt_rdhash, -+ Opt_rdblk_def, Opt_rdhash_def, -+ Opt_xino, Opt_noxino, -+ Opt_trunc_xino, Opt_trunc_xino_v, Opt_notrunc_xino, -+ Opt_trunc_xino_path, Opt_itrunc_xino, -+ Opt_trunc_xib, Opt_notrunc_xib, -+ Opt_shwh, Opt_noshwh, -+ Opt_plink, Opt_noplink, Opt_list_plink, -+ Opt_udba, -+ Opt_dio, Opt_nodio, -+ Opt_diropq_a, Opt_diropq_w, -+ Opt_warn_perm, Opt_nowarn_perm, -+ Opt_wbr_copyup, Opt_wbr_create, -+ Opt_fhsm_sec, -+ Opt_verbose, Opt_noverbose, -+ Opt_sum, Opt_nosum, Opt_wsum, -+ Opt_dirperm1, Opt_nodirperm1, -+ Opt_dirren, Opt_nodirren, -+ Opt_acl, Opt_noacl, -+ Opt_tail, Opt_ignore, Opt_ignore_silent, Opt_err -+}; -+ -+static match_table_t options = { -+ {Opt_br, "br=%s"}, -+ {Opt_br, "br:%s"}, -+ -+ {Opt_add, "add=%d:%s"}, -+ {Opt_add, "add:%d:%s"}, -+ {Opt_add, "ins=%d:%s"}, -+ {Opt_add, "ins:%d:%s"}, -+ {Opt_append, "append=%s"}, -+ {Opt_append, "append:%s"}, -+ {Opt_prepend, "prepend=%s"}, -+ {Opt_prepend, "prepend:%s"}, -+ -+ {Opt_del, "del=%s"}, -+ {Opt_del, "del:%s"}, -+ /* {Opt_idel, "idel:%d"}, */ -+ {Opt_mod, "mod=%s"}, -+ {Opt_mod, "mod:%s"}, -+ /* {Opt_imod, "imod:%d:%s"}, */ -+ -+ {Opt_dirwh, "dirwh=%d"}, -+ -+ {Opt_xino, "xino=%s"}, -+ {Opt_noxino, "noxino"}, -+ {Opt_trunc_xino, "trunc_xino"}, -+ {Opt_trunc_xino_v, "trunc_xino_v=%d:%d"}, -+ {Opt_notrunc_xino, "notrunc_xino"}, -+ {Opt_trunc_xino_path, "trunc_xino=%s"}, -+ {Opt_itrunc_xino, "itrunc_xino=%d"}, -+ /* {Opt_zxino, "zxino=%s"}, */ -+ {Opt_trunc_xib, "trunc_xib"}, -+ {Opt_notrunc_xib, "notrunc_xib"}, -+ -+#ifdef CONFIG_PROC_FS -+ {Opt_plink, "plink"}, -+#else -+ {Opt_ignore_silent, "plink"}, -+#endif -+ -+ {Opt_noplink, "noplink"}, -+ -+#ifdef CONFIG_AUFS_DEBUG -+ {Opt_list_plink, "list_plink"}, -+#endif -+ -+ {Opt_udba, "udba=%s"}, -+ -+ {Opt_dio, "dio"}, -+ {Opt_nodio, "nodio"}, -+ -+#ifdef CONFIG_AUFS_DIRREN -+ {Opt_dirren, "dirren"}, -+ {Opt_nodirren, "nodirren"}, -+#else -+ {Opt_ignore, "dirren"}, -+ {Opt_ignore_silent, "nodirren"}, -+#endif -+ -+#ifdef CONFIG_AUFS_FHSM -+ {Opt_fhsm_sec, "fhsm_sec=%d"}, -+#else -+ {Opt_ignore, "fhsm_sec=%d"}, -+#endif -+ -+ {Opt_diropq_a, "diropq=always"}, -+ {Opt_diropq_a, "diropq=a"}, -+ {Opt_diropq_w, "diropq=whiteouted"}, -+ {Opt_diropq_w, "diropq=w"}, -+ -+ {Opt_warn_perm, "warn_perm"}, -+ {Opt_nowarn_perm, "nowarn_perm"}, -+ -+ /* keep them temporary */ -+ {Opt_ignore_silent, "nodlgt"}, -+ {Opt_ignore, "clean_plink"}, -+ -+#ifdef CONFIG_AUFS_SHWH -+ {Opt_shwh, "shwh"}, -+#endif -+ {Opt_noshwh, "noshwh"}, -+ -+ {Opt_dirperm1, "dirperm1"}, -+ {Opt_nodirperm1, "nodirperm1"}, -+ -+ {Opt_verbose, "verbose"}, -+ {Opt_verbose, "v"}, -+ {Opt_noverbose, "noverbose"}, -+ {Opt_noverbose, "quiet"}, -+ {Opt_noverbose, "q"}, -+ {Opt_noverbose, "silent"}, -+ -+ {Opt_sum, "sum"}, -+ {Opt_nosum, "nosum"}, -+ {Opt_wsum, "wsum"}, -+ -+ {Opt_rdcache, "rdcache=%d"}, -+ {Opt_rdblk, "rdblk=%d"}, -+ {Opt_rdblk_def, "rdblk=def"}, -+ {Opt_rdhash, "rdhash=%d"}, -+ {Opt_rdhash_def, "rdhash=def"}, -+ -+ {Opt_wbr_create, "create=%s"}, -+ {Opt_wbr_create, "create_policy=%s"}, -+ {Opt_wbr_copyup, "cpup=%s"}, -+ {Opt_wbr_copyup, "copyup=%s"}, -+ {Opt_wbr_copyup, "copyup_policy=%s"}, -+ -+ /* generic VFS flag */ -+#ifdef CONFIG_FS_POSIX_ACL -+ {Opt_acl, "acl"}, -+ {Opt_noacl, "noacl"}, -+#else -+ {Opt_ignore, "acl"}, -+ {Opt_ignore_silent, "noacl"}, -+#endif -+ -+ /* internal use for the scripts */ -+ {Opt_ignore_silent, "si=%s"}, -+ -+ {Opt_br, "dirs=%s"}, -+ {Opt_ignore, "debug=%d"}, -+ {Opt_ignore, "delete=whiteout"}, -+ {Opt_ignore, "delete=all"}, -+ {Opt_ignore, "imap=%s"}, -+ -+ /* temporary workaround, due to old mount(8)? */ -+ {Opt_ignore_silent, "relatime"}, -+ -+ {Opt_err, NULL} -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+static const char *au_parser_pattern(int val, match_table_t tbl) -+{ -+ struct match_token *p; -+ -+ p = tbl; -+ while (p->pattern) { -+ if (p->token == val) -+ return p->pattern; -+ p++; -+ } -+ BUG(); -+ return "??"; -+} -+ -+static const char *au_optstr(int *val, match_table_t tbl) -+{ -+ struct match_token *p; -+ int v; -+ -+ v = *val; -+ if (!v) -+ goto out; -+ p = tbl; -+ while (p->pattern) { -+ if (p->token -+ && (v & p->token) == p->token) { -+ *val &= ~p->token; -+ return p->pattern; -+ } -+ p++; -+ } -+ -+out: -+ return NULL; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static match_table_t brperm = { -+ {AuBrPerm_RO, AUFS_BRPERM_RO}, -+ {AuBrPerm_RR, AUFS_BRPERM_RR}, -+ {AuBrPerm_RW, AUFS_BRPERM_RW}, -+ {0, NULL} -+}; -+ -+static match_table_t brattr = { -+ /* general */ -+ {AuBrAttr_COO_REG, AUFS_BRATTR_COO_REG}, -+ {AuBrAttr_COO_ALL, AUFS_BRATTR_COO_ALL}, -+ /* 'unpin' attrib is meaningless since linux-3.18-rc1 */ -+ {AuBrAttr_UNPIN, AUFS_BRATTR_UNPIN}, -+#ifdef CONFIG_AUFS_FHSM -+ {AuBrAttr_FHSM, AUFS_BRATTR_FHSM}, -+#endif -+#ifdef CONFIG_AUFS_XATTR -+ {AuBrAttr_ICEX, AUFS_BRATTR_ICEX}, -+ {AuBrAttr_ICEX_SEC, AUFS_BRATTR_ICEX_SEC}, -+ {AuBrAttr_ICEX_SYS, AUFS_BRATTR_ICEX_SYS}, -+ {AuBrAttr_ICEX_TR, AUFS_BRATTR_ICEX_TR}, -+ {AuBrAttr_ICEX_USR, AUFS_BRATTR_ICEX_USR}, -+ {AuBrAttr_ICEX_OTH, AUFS_BRATTR_ICEX_OTH}, -+#endif -+ -+ /* ro/rr branch */ -+ {AuBrRAttr_WH, AUFS_BRRATTR_WH}, -+ -+ /* rw branch */ -+ {AuBrWAttr_MOO, AUFS_BRWATTR_MOO}, -+ {AuBrWAttr_NoLinkWH, AUFS_BRWATTR_NLWH}, -+ -+ {0, NULL} -+}; -+ -+static int br_attr_val(char *str, match_table_t table, substring_t args[]) -+{ -+ int attr, v; -+ char *p; -+ -+ attr = 0; -+ do { -+ p = strchr(str, '+'); -+ if (p) -+ *p = 0; -+ v = match_token(str, table, args); -+ if (v) { -+ if (v & AuBrAttr_CMOO_Mask) -+ attr &= ~AuBrAttr_CMOO_Mask; -+ attr |= v; -+ } else { -+ if (p) -+ *p = '+'; -+ pr_warn("ignored branch attribute %s\n", str); -+ break; -+ } -+ if (p) -+ str = p + 1; -+ } while (p); -+ -+ return attr; -+} -+ -+static int au_do_optstr_br_attr(au_br_perm_str_t *str, int perm) -+{ -+ int sz; -+ const char *p; -+ char *q; -+ -+ q = str->a; -+ *q = 0; -+ p = au_optstr(&perm, brattr); -+ if (p) { -+ sz = strlen(p); -+ memcpy(q, p, sz + 1); -+ q += sz; -+ } else -+ goto out; -+ -+ do { -+ p = au_optstr(&perm, brattr); -+ if (p) { -+ *q++ = '+'; -+ sz = strlen(p); -+ memcpy(q, p, sz + 1); -+ q += sz; -+ } -+ } while (p); -+ -+out: -+ return q - str->a; -+} -+ -+static int noinline_for_stack br_perm_val(char *perm) -+{ -+ int val, bad, sz; -+ char *p; -+ substring_t args[MAX_OPT_ARGS]; -+ au_br_perm_str_t attr; -+ -+ p = strchr(perm, '+'); -+ if (p) -+ *p = 0; -+ val = match_token(perm, brperm, args); -+ if (!val) { -+ if (p) -+ *p = '+'; -+ pr_warn("ignored branch permission %s\n", perm); -+ val = AuBrPerm_RO; -+ goto out; -+ } -+ if (!p) -+ goto out; -+ -+ val |= br_attr_val(p + 1, brattr, args); -+ -+ bad = 0; -+ switch (val & AuBrPerm_Mask) { -+ case AuBrPerm_RO: -+ case AuBrPerm_RR: -+ bad = val & AuBrWAttr_Mask; -+ val &= ~AuBrWAttr_Mask; -+ break; -+ case AuBrPerm_RW: -+ bad = val & AuBrRAttr_Mask; -+ val &= ~AuBrRAttr_Mask; -+ break; -+ } -+ -+ /* -+ * 'unpin' attrib becomes meaningless since linux-3.18-rc1, but aufs -+ * does not treat it as an error, just warning. -+ * this is a tiny guard for the user operation. -+ */ -+ if (val & AuBrAttr_UNPIN) { -+ bad |= AuBrAttr_UNPIN; -+ val &= ~AuBrAttr_UNPIN; -+ } -+ -+ if (unlikely(bad)) { -+ sz = au_do_optstr_br_attr(&attr, bad); -+ AuDebugOn(!sz); -+ pr_warn("ignored branch attribute %s\n", attr.a); -+ } -+ -+out: -+ return val; -+} -+ -+void au_optstr_br_perm(au_br_perm_str_t *str, int perm) -+{ -+ au_br_perm_str_t attr; -+ const char *p; -+ char *q; -+ int sz; -+ -+ q = str->a; -+ p = au_optstr(&perm, brperm); -+ AuDebugOn(!p || !*p); -+ sz = strlen(p); -+ memcpy(q, p, sz + 1); -+ q += sz; -+ -+ sz = au_do_optstr_br_attr(&attr, perm); -+ if (sz) { -+ *q++ = '+'; -+ memcpy(q, attr.a, sz + 1); -+ } -+ -+ AuDebugOn(strlen(str->a) >= sizeof(str->a)); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static match_table_t udbalevel = { -+ {AuOpt_UDBA_REVAL, "reval"}, -+ {AuOpt_UDBA_NONE, "none"}, -+#ifdef CONFIG_AUFS_HNOTIFY -+ {AuOpt_UDBA_HNOTIFY, "notify"}, /* abstraction */ -+#ifdef CONFIG_AUFS_HFSNOTIFY -+ {AuOpt_UDBA_HNOTIFY, "fsnotify"}, -+#endif -+#endif -+ {-1, NULL} -+}; -+ -+static int noinline_for_stack udba_val(char *str) -+{ -+ substring_t args[MAX_OPT_ARGS]; -+ -+ return match_token(str, udbalevel, args); -+} -+ -+const char *au_optstr_udba(int udba) -+{ -+ return au_parser_pattern(udba, udbalevel); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static match_table_t au_wbr_create_policy = { -+ {AuWbrCreate_TDP, "tdp"}, -+ {AuWbrCreate_TDP, "top-down-parent"}, -+ {AuWbrCreate_RR, "rr"}, -+ {AuWbrCreate_RR, "round-robin"}, -+ {AuWbrCreate_MFS, "mfs"}, -+ {AuWbrCreate_MFS, "most-free-space"}, -+ {AuWbrCreate_MFSV, "mfs:%d"}, -+ {AuWbrCreate_MFSV, "most-free-space:%d"}, -+ -+ /* top-down regardless the parent, and then mfs */ -+ {AuWbrCreate_TDMFS, "tdmfs:%d"}, -+ {AuWbrCreate_TDMFSV, "tdmfs:%d:%d"}, -+ -+ {AuWbrCreate_MFSRR, "mfsrr:%d"}, -+ {AuWbrCreate_MFSRRV, "mfsrr:%d:%d"}, -+ {AuWbrCreate_PMFS, "pmfs"}, -+ {AuWbrCreate_PMFSV, "pmfs:%d"}, -+ {AuWbrCreate_PMFSRR, "pmfsrr:%d"}, -+ {AuWbrCreate_PMFSRRV, "pmfsrr:%d:%d"}, -+ -+ {-1, NULL} -+}; -+ -+static int au_wbr_mfs_wmark(substring_t *arg, char *str, -+ struct au_opt_wbr_create *create) -+{ -+ int err; -+ unsigned long long ull; -+ -+ err = 0; -+ if (!match_u64(arg, &ull)) -+ create->mfsrr_watermark = ull; -+ else { -+ pr_err("bad integer in %s\n", str); -+ err = -EINVAL; -+ } -+ -+ return err; -+} -+ -+static int au_wbr_mfs_sec(substring_t *arg, char *str, -+ struct au_opt_wbr_create *create) -+{ -+ int n, err; -+ -+ err = 0; -+ if (!match_int(arg, &n) && 0 <= n && n <= AUFS_MFS_MAX_SEC) -+ create->mfs_second = n; -+ else { -+ pr_err("bad integer in %s\n", str); -+ err = -EINVAL; -+ } -+ -+ return err; -+} -+ -+static int noinline_for_stack -+au_wbr_create_val(char *str, struct au_opt_wbr_create *create) -+{ -+ int err, e; -+ substring_t args[MAX_OPT_ARGS]; -+ -+ err = match_token(str, au_wbr_create_policy, args); -+ create->wbr_create = err; -+ switch (err) { -+ case AuWbrCreate_MFSRRV: -+ case AuWbrCreate_TDMFSV: -+ case AuWbrCreate_PMFSRRV: -+ e = au_wbr_mfs_wmark(&args[0], str, create); -+ if (!e) -+ e = au_wbr_mfs_sec(&args[1], str, create); -+ if (unlikely(e)) -+ err = e; -+ break; -+ case AuWbrCreate_MFSRR: -+ case AuWbrCreate_TDMFS: -+ case AuWbrCreate_PMFSRR: -+ e = au_wbr_mfs_wmark(&args[0], str, create); -+ if (unlikely(e)) { -+ err = e; -+ break; -+ } -+ /*FALLTHROUGH*/ -+ case AuWbrCreate_MFS: -+ case AuWbrCreate_PMFS: -+ create->mfs_second = AUFS_MFS_DEF_SEC; -+ break; -+ case AuWbrCreate_MFSV: -+ case AuWbrCreate_PMFSV: -+ e = au_wbr_mfs_sec(&args[0], str, create); -+ if (unlikely(e)) -+ err = e; -+ break; -+ } -+ -+ return err; -+} -+ -+const char *au_optstr_wbr_create(int wbr_create) -+{ -+ return au_parser_pattern(wbr_create, au_wbr_create_policy); -+} -+ -+static match_table_t au_wbr_copyup_policy = { -+ {AuWbrCopyup_TDP, "tdp"}, -+ {AuWbrCopyup_TDP, "top-down-parent"}, -+ {AuWbrCopyup_BUP, "bup"}, -+ {AuWbrCopyup_BUP, "bottom-up-parent"}, -+ {AuWbrCopyup_BU, "bu"}, -+ {AuWbrCopyup_BU, "bottom-up"}, -+ {-1, NULL} -+}; -+ -+static int noinline_for_stack au_wbr_copyup_val(char *str) -+{ -+ substring_t args[MAX_OPT_ARGS]; -+ -+ return match_token(str, au_wbr_copyup_policy, args); -+} -+ -+const char *au_optstr_wbr_copyup(int wbr_copyup) -+{ -+ return au_parser_pattern(wbr_copyup, au_wbr_copyup_policy); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static const int lkup_dirflags = LOOKUP_FOLLOW | LOOKUP_DIRECTORY; -+ -+static void dump_opts(struct au_opts *opts) -+{ -+#ifdef CONFIG_AUFS_DEBUG -+ /* reduce stack space */ -+ union { -+ struct au_opt_add *add; -+ struct au_opt_del *del; -+ struct au_opt_mod *mod; -+ struct au_opt_xino *xino; -+ struct au_opt_xino_itrunc *xino_itrunc; -+ struct au_opt_wbr_create *create; -+ } u; -+ struct au_opt *opt; -+ -+ opt = opts->opt; -+ while (opt->type != Opt_tail) { -+ switch (opt->type) { -+ case Opt_add: -+ u.add = &opt->add; -+ AuDbg("add {b%d, %s, 0x%x, %p}\n", -+ u.add->bindex, u.add->pathname, u.add->perm, -+ u.add->path.dentry); -+ break; -+ case Opt_del: -+ case Opt_idel: -+ u.del = &opt->del; -+ AuDbg("del {%s, %p}\n", -+ u.del->pathname, u.del->h_path.dentry); -+ break; -+ case Opt_mod: -+ case Opt_imod: -+ u.mod = &opt->mod; -+ AuDbg("mod {%s, 0x%x, %p}\n", -+ u.mod->path, u.mod->perm, u.mod->h_root); -+ break; -+ case Opt_append: -+ u.add = &opt->add; -+ AuDbg("append {b%d, %s, 0x%x, %p}\n", -+ u.add->bindex, u.add->pathname, u.add->perm, -+ u.add->path.dentry); -+ break; -+ case Opt_prepend: -+ u.add = &opt->add; -+ AuDbg("prepend {b%d, %s, 0x%x, %p}\n", -+ u.add->bindex, u.add->pathname, u.add->perm, -+ u.add->path.dentry); -+ break; -+ case Opt_dirwh: -+ AuDbg("dirwh %d\n", opt->dirwh); -+ break; -+ case Opt_rdcache: -+ AuDbg("rdcache %d\n", opt->rdcache); -+ break; -+ case Opt_rdblk: -+ AuDbg("rdblk %u\n", opt->rdblk); -+ break; -+ case Opt_rdblk_def: -+ AuDbg("rdblk_def\n"); -+ break; -+ case Opt_rdhash: -+ AuDbg("rdhash %u\n", opt->rdhash); -+ break; -+ case Opt_rdhash_def: -+ AuDbg("rdhash_def\n"); -+ break; -+ case Opt_xino: -+ u.xino = &opt->xino; -+ AuDbg("xino {%s %pD}\n", u.xino->path, u.xino->file); -+ break; -+ case Opt_trunc_xino: -+ AuLabel(trunc_xino); -+ break; -+ case Opt_notrunc_xino: -+ AuLabel(notrunc_xino); -+ break; -+ case Opt_trunc_xino_path: -+ case Opt_itrunc_xino: -+ u.xino_itrunc = &opt->xino_itrunc; -+ AuDbg("trunc_xino %d\n", u.xino_itrunc->bindex); -+ break; -+ case Opt_noxino: -+ AuLabel(noxino); -+ break; -+ case Opt_trunc_xib: -+ AuLabel(trunc_xib); -+ break; -+ case Opt_notrunc_xib: -+ AuLabel(notrunc_xib); -+ break; -+ case Opt_shwh: -+ AuLabel(shwh); -+ break; -+ case Opt_noshwh: -+ AuLabel(noshwh); -+ break; -+ case Opt_dirperm1: -+ AuLabel(dirperm1); -+ break; -+ case Opt_nodirperm1: -+ AuLabel(nodirperm1); -+ break; -+ case Opt_plink: -+ AuLabel(plink); -+ break; -+ case Opt_noplink: -+ AuLabel(noplink); -+ break; -+ case Opt_list_plink: -+ AuLabel(list_plink); -+ break; -+ case Opt_udba: -+ AuDbg("udba %d, %s\n", -+ opt->udba, au_optstr_udba(opt->udba)); -+ break; -+ case Opt_dio: -+ AuLabel(dio); -+ break; -+ case Opt_nodio: -+ AuLabel(nodio); -+ break; -+ case Opt_diropq_a: -+ AuLabel(diropq_a); -+ break; -+ case Opt_diropq_w: -+ AuLabel(diropq_w); -+ break; -+ case Opt_warn_perm: -+ AuLabel(warn_perm); -+ break; -+ case Opt_nowarn_perm: -+ AuLabel(nowarn_perm); -+ break; -+ case Opt_verbose: -+ AuLabel(verbose); -+ break; -+ case Opt_noverbose: -+ AuLabel(noverbose); -+ break; -+ case Opt_sum: -+ AuLabel(sum); -+ break; -+ case Opt_nosum: -+ AuLabel(nosum); -+ break; -+ case Opt_wsum: -+ AuLabel(wsum); -+ break; -+ case Opt_wbr_create: -+ u.create = &opt->wbr_create; -+ AuDbg("create %d, %s\n", u.create->wbr_create, -+ au_optstr_wbr_create(u.create->wbr_create)); -+ switch (u.create->wbr_create) { -+ case AuWbrCreate_MFSV: -+ case AuWbrCreate_PMFSV: -+ AuDbg("%d sec\n", u.create->mfs_second); -+ break; -+ case AuWbrCreate_MFSRR: -+ case AuWbrCreate_TDMFS: -+ AuDbg("%llu watermark\n", -+ u.create->mfsrr_watermark); -+ break; -+ case AuWbrCreate_MFSRRV: -+ case AuWbrCreate_TDMFSV: -+ case AuWbrCreate_PMFSRRV: -+ AuDbg("%llu watermark, %d sec\n", -+ u.create->mfsrr_watermark, -+ u.create->mfs_second); -+ break; -+ } -+ break; -+ case Opt_wbr_copyup: -+ AuDbg("copyup %d, %s\n", opt->wbr_copyup, -+ au_optstr_wbr_copyup(opt->wbr_copyup)); -+ break; -+ case Opt_fhsm_sec: -+ AuDbg("fhsm_sec %u\n", opt->fhsm_second); -+ break; -+ case Opt_dirren: -+ AuLabel(dirren); -+ break; -+ case Opt_nodirren: -+ AuLabel(nodirren); -+ break; -+ case Opt_acl: -+ AuLabel(acl); -+ break; -+ case Opt_noacl: -+ AuLabel(noacl); -+ break; -+ default: -+ BUG(); -+ } -+ opt++; -+ } -+#endif -+} -+ -+void au_opts_free(struct au_opts *opts) -+{ -+ struct au_opt *opt; -+ -+ opt = opts->opt; -+ while (opt->type != Opt_tail) { -+ switch (opt->type) { -+ case Opt_add: -+ case Opt_append: -+ case Opt_prepend: -+ path_put(&opt->add.path); -+ break; -+ case Opt_del: -+ case Opt_idel: -+ path_put(&opt->del.h_path); -+ break; -+ case Opt_mod: -+ case Opt_imod: -+ dput(opt->mod.h_root); -+ break; -+ case Opt_xino: -+ fput(opt->xino.file); -+ break; -+ } -+ opt++; -+ } -+} -+ -+static int opt_add(struct au_opt *opt, char *opt_str, unsigned long sb_flags, -+ aufs_bindex_t bindex) -+{ -+ int err; -+ struct au_opt_add *add = &opt->add; -+ char *p; -+ -+ add->bindex = bindex; -+ add->perm = AuBrPerm_RO; -+ add->pathname = opt_str; -+ p = strchr(opt_str, '='); -+ if (p) { -+ *p++ = 0; -+ if (*p) -+ add->perm = br_perm_val(p); -+ } -+ -+ err = vfsub_kern_path(add->pathname, lkup_dirflags, &add->path); -+ if (!err) { -+ if (!p) { -+ add->perm = AuBrPerm_RO; -+ if (au_test_fs_rr(add->path.dentry->d_sb)) -+ add->perm = AuBrPerm_RR; -+ else if (!bindex && !(sb_flags & MS_RDONLY)) -+ add->perm = AuBrPerm_RW; -+ } -+ opt->type = Opt_add; -+ goto out; -+ } -+ pr_err("lookup failed %s (%d)\n", add->pathname, err); -+ err = -EINVAL; -+ -+out: -+ return err; -+} -+ -+static int au_opts_parse_del(struct au_opt_del *del, substring_t args[]) -+{ -+ int err; -+ -+ del->pathname = args[0].from; -+ AuDbg("del path %s\n", del->pathname); -+ -+ err = vfsub_kern_path(del->pathname, lkup_dirflags, &del->h_path); -+ if (unlikely(err)) -+ pr_err("lookup failed %s (%d)\n", del->pathname, err); -+ -+ return err; -+} -+ -+#if 0 /* reserved for future use */ -+static int au_opts_parse_idel(struct super_block *sb, aufs_bindex_t bindex, -+ struct au_opt_del *del, substring_t args[]) -+{ -+ int err; -+ struct dentry *root; -+ -+ err = -EINVAL; -+ root = sb->s_root; -+ aufs_read_lock(root, AuLock_FLUSH); -+ if (bindex < 0 || au_sbbot(sb) < bindex) { -+ pr_err("out of bounds, %d\n", bindex); -+ goto out; -+ } -+ -+ err = 0; -+ del->h_path.dentry = dget(au_h_dptr(root, bindex)); -+ del->h_path.mnt = mntget(au_sbr_mnt(sb, bindex)); -+ -+out: -+ aufs_read_unlock(root, !AuLock_IR); -+ return err; -+} -+#endif -+ -+static int noinline_for_stack -+au_opts_parse_mod(struct au_opt_mod *mod, substring_t args[]) -+{ -+ int err; -+ struct path path; -+ char *p; -+ -+ err = -EINVAL; -+ mod->path = args[0].from; -+ p = strchr(mod->path, '='); -+ if (unlikely(!p)) { -+ pr_err("no permssion %s\n", args[0].from); -+ goto out; -+ } -+ -+ *p++ = 0; -+ err = vfsub_kern_path(mod->path, lkup_dirflags, &path); -+ if (unlikely(err)) { -+ pr_err("lookup failed %s (%d)\n", mod->path, err); -+ goto out; -+ } -+ -+ mod->perm = br_perm_val(p); -+ AuDbg("mod path %s, perm 0x%x, %s\n", mod->path, mod->perm, p); -+ mod->h_root = dget(path.dentry); -+ path_put(&path); -+ -+out: -+ return err; -+} -+ -+#if 0 /* reserved for future use */ -+static int au_opts_parse_imod(struct super_block *sb, aufs_bindex_t bindex, -+ struct au_opt_mod *mod, substring_t args[]) -+{ -+ int err; -+ struct dentry *root; -+ -+ err = -EINVAL; -+ root = sb->s_root; -+ aufs_read_lock(root, AuLock_FLUSH); -+ if (bindex < 0 || au_sbbot(sb) < bindex) { -+ pr_err("out of bounds, %d\n", bindex); -+ goto out; -+ } -+ -+ err = 0; -+ mod->perm = br_perm_val(args[1].from); -+ AuDbg("mod path %s, perm 0x%x, %s\n", -+ mod->path, mod->perm, args[1].from); -+ mod->h_root = dget(au_h_dptr(root, bindex)); -+ -+out: -+ aufs_read_unlock(root, !AuLock_IR); -+ return err; -+} -+#endif -+ -+static int au_opts_parse_xino(struct super_block *sb, struct au_opt_xino *xino, -+ substring_t args[]) -+{ -+ int err; -+ struct file *file; -+ -+ file = au_xino_create(sb, args[0].from, /*silent*/0); -+ err = PTR_ERR(file); -+ if (IS_ERR(file)) -+ goto out; -+ -+ err = -EINVAL; -+ if (unlikely(file->f_path.dentry->d_sb == sb)) { -+ fput(file); -+ pr_err("%s must be outside\n", args[0].from); -+ goto out; -+ } -+ -+ err = 0; -+ xino->file = file; -+ xino->path = args[0].from; -+ -+out: -+ return err; -+} -+ -+static int noinline_for_stack -+au_opts_parse_xino_itrunc_path(struct super_block *sb, -+ struct au_opt_xino_itrunc *xino_itrunc, -+ substring_t args[]) -+{ -+ int err; -+ aufs_bindex_t bbot, bindex; -+ struct path path; -+ struct dentry *root; -+ -+ err = vfsub_kern_path(args[0].from, lkup_dirflags, &path); -+ if (unlikely(err)) { -+ pr_err("lookup failed %s (%d)\n", args[0].from, err); -+ goto out; -+ } -+ -+ xino_itrunc->bindex = -1; -+ root = sb->s_root; -+ aufs_read_lock(root, AuLock_FLUSH); -+ bbot = au_sbbot(sb); -+ for (bindex = 0; bindex <= bbot; bindex++) { -+ if (au_h_dptr(root, bindex) == path.dentry) { -+ xino_itrunc->bindex = bindex; -+ break; -+ } -+ } -+ aufs_read_unlock(root, !AuLock_IR); -+ path_put(&path); -+ -+ if (unlikely(xino_itrunc->bindex < 0)) { -+ pr_err("no such branch %s\n", args[0].from); -+ err = -EINVAL; -+ } -+ -+out: -+ return err; -+} -+ -+/* called without aufs lock */ -+int au_opts_parse(struct super_block *sb, char *str, struct au_opts *opts) -+{ -+ int err, n, token; -+ aufs_bindex_t bindex; -+ unsigned char skipped; -+ struct dentry *root; -+ struct au_opt *opt, *opt_tail; -+ char *opt_str; -+ /* reduce the stack space */ -+ union { -+ struct au_opt_xino_itrunc *xino_itrunc; -+ struct au_opt_wbr_create *create; -+ } u; -+ struct { -+ substring_t args[MAX_OPT_ARGS]; -+ } *a; -+ -+ err = -ENOMEM; -+ a = kmalloc(sizeof(*a), GFP_NOFS); -+ if (unlikely(!a)) -+ goto out; -+ -+ root = sb->s_root; -+ err = 0; -+ bindex = 0; -+ opt = opts->opt; -+ opt_tail = opt + opts->max_opt - 1; -+ opt->type = Opt_tail; -+ while (!err && (opt_str = strsep(&str, ",")) && *opt_str) { -+ err = -EINVAL; -+ skipped = 0; -+ token = match_token(opt_str, options, a->args); -+ switch (token) { -+ case Opt_br: -+ err = 0; -+ while (!err && (opt_str = strsep(&a->args[0].from, ":")) -+ && *opt_str) { -+ err = opt_add(opt, opt_str, opts->sb_flags, -+ bindex++); -+ if (unlikely(!err && ++opt > opt_tail)) { -+ err = -E2BIG; -+ break; -+ } -+ opt->type = Opt_tail; -+ skipped = 1; -+ } -+ break; -+ case Opt_add: -+ if (unlikely(match_int(&a->args[0], &n))) { -+ pr_err("bad integer in %s\n", opt_str); -+ break; -+ } -+ bindex = n; -+ err = opt_add(opt, a->args[1].from, opts->sb_flags, -+ bindex); -+ if (!err) -+ opt->type = token; -+ break; -+ case Opt_append: -+ err = opt_add(opt, a->args[0].from, opts->sb_flags, -+ /*dummy bindex*/1); -+ if (!err) -+ opt->type = token; -+ break; -+ case Opt_prepend: -+ err = opt_add(opt, a->args[0].from, opts->sb_flags, -+ /*bindex*/0); -+ if (!err) -+ opt->type = token; -+ break; -+ case Opt_del: -+ err = au_opts_parse_del(&opt->del, a->args); -+ if (!err) -+ opt->type = token; -+ break; -+#if 0 /* reserved for future use */ -+ case Opt_idel: -+ del->pathname = "(indexed)"; -+ if (unlikely(match_int(&args[0], &n))) { -+ pr_err("bad integer in %s\n", opt_str); -+ break; -+ } -+ err = au_opts_parse_idel(sb, n, &opt->del, a->args); -+ if (!err) -+ opt->type = token; -+ break; -+#endif -+ case Opt_mod: -+ err = au_opts_parse_mod(&opt->mod, a->args); -+ if (!err) -+ opt->type = token; -+ break; -+#ifdef IMOD /* reserved for future use */ -+ case Opt_imod: -+ u.mod->path = "(indexed)"; -+ if (unlikely(match_int(&a->args[0], &n))) { -+ pr_err("bad integer in %s\n", opt_str); -+ break; -+ } -+ err = au_opts_parse_imod(sb, n, &opt->mod, a->args); -+ if (!err) -+ opt->type = token; -+ break; -+#endif -+ case Opt_xino: -+ err = au_opts_parse_xino(sb, &opt->xino, a->args); -+ if (!err) -+ opt->type = token; -+ break; -+ -+ case Opt_trunc_xino_path: -+ err = au_opts_parse_xino_itrunc_path -+ (sb, &opt->xino_itrunc, a->args); -+ if (!err) -+ opt->type = token; -+ break; -+ -+ case Opt_itrunc_xino: -+ u.xino_itrunc = &opt->xino_itrunc; -+ if (unlikely(match_int(&a->args[0], &n))) { -+ pr_err("bad integer in %s\n", opt_str); -+ break; -+ } -+ u.xino_itrunc->bindex = n; -+ aufs_read_lock(root, AuLock_FLUSH); -+ if (n < 0 || au_sbbot(sb) < n) { -+ pr_err("out of bounds, %d\n", n); -+ aufs_read_unlock(root, !AuLock_IR); -+ break; -+ } -+ aufs_read_unlock(root, !AuLock_IR); -+ err = 0; -+ opt->type = token; -+ break; -+ -+ case Opt_dirwh: -+ if (unlikely(match_int(&a->args[0], &opt->dirwh))) -+ break; -+ err = 0; -+ opt->type = token; -+ break; -+ -+ case Opt_rdcache: -+ if (unlikely(match_int(&a->args[0], &n))) { -+ pr_err("bad integer in %s\n", opt_str); -+ break; -+ } -+ if (unlikely(n > AUFS_RDCACHE_MAX)) { -+ pr_err("rdcache must be smaller than %d\n", -+ AUFS_RDCACHE_MAX); -+ break; -+ } -+ opt->rdcache = n; -+ err = 0; -+ opt->type = token; -+ break; -+ case Opt_rdblk: -+ if (unlikely(match_int(&a->args[0], &n) -+ || n < 0 -+ || n > KMALLOC_MAX_SIZE)) { -+ pr_err("bad integer in %s\n", opt_str); -+ break; -+ } -+ if (unlikely(n && n < NAME_MAX)) { -+ pr_err("rdblk must be larger than %d\n", -+ NAME_MAX); -+ break; -+ } -+ opt->rdblk = n; -+ err = 0; -+ opt->type = token; -+ break; -+ case Opt_rdhash: -+ if (unlikely(match_int(&a->args[0], &n) -+ || n < 0 -+ || n * sizeof(struct hlist_head) -+ > KMALLOC_MAX_SIZE)) { -+ pr_err("bad integer in %s\n", opt_str); -+ break; -+ } -+ opt->rdhash = n; -+ err = 0; -+ opt->type = token; -+ break; -+ -+ case Opt_trunc_xino: -+ case Opt_notrunc_xino: -+ case Opt_noxino: -+ case Opt_trunc_xib: -+ case Opt_notrunc_xib: -+ case Opt_shwh: -+ case Opt_noshwh: -+ case Opt_dirperm1: -+ case Opt_nodirperm1: -+ case Opt_plink: -+ case Opt_noplink: -+ case Opt_list_plink: -+ case Opt_dio: -+ case Opt_nodio: -+ case Opt_diropq_a: -+ case Opt_diropq_w: -+ case Opt_warn_perm: -+ case Opt_nowarn_perm: -+ case Opt_verbose: -+ case Opt_noverbose: -+ case Opt_sum: -+ case Opt_nosum: -+ case Opt_wsum: -+ case Opt_rdblk_def: -+ case Opt_rdhash_def: -+ case Opt_dirren: -+ case Opt_nodirren: -+ case Opt_acl: -+ case Opt_noacl: -+ err = 0; -+ opt->type = token; -+ break; -+ -+ case Opt_udba: -+ opt->udba = udba_val(a->args[0].from); -+ if (opt->udba >= 0) { -+ err = 0; -+ opt->type = token; -+ } else -+ pr_err("wrong value, %s\n", opt_str); -+ break; -+ -+ case Opt_wbr_create: -+ u.create = &opt->wbr_create; -+ u.create->wbr_create -+ = au_wbr_create_val(a->args[0].from, u.create); -+ if (u.create->wbr_create >= 0) { -+ err = 0; -+ opt->type = token; -+ } else -+ pr_err("wrong value, %s\n", opt_str); -+ break; -+ case Opt_wbr_copyup: -+ opt->wbr_copyup = au_wbr_copyup_val(a->args[0].from); -+ if (opt->wbr_copyup >= 0) { -+ err = 0; -+ opt->type = token; -+ } else -+ pr_err("wrong value, %s\n", opt_str); -+ break; -+ -+ case Opt_fhsm_sec: -+ if (unlikely(match_int(&a->args[0], &n) -+ || n < 0)) { -+ pr_err("bad integer in %s\n", opt_str); -+ break; -+ } -+ if (sysaufs_brs) { -+ opt->fhsm_second = n; -+ opt->type = token; -+ } else -+ pr_warn("ignored %s\n", opt_str); -+ err = 0; -+ break; -+ -+ case Opt_ignore: -+ pr_warn("ignored %s\n", opt_str); -+ /*FALLTHROUGH*/ -+ case Opt_ignore_silent: -+ skipped = 1; -+ err = 0; -+ break; -+ case Opt_err: -+ pr_err("unknown option %s\n", opt_str); -+ break; -+ } -+ -+ if (!err && !skipped) { -+ if (unlikely(++opt > opt_tail)) { -+ err = -E2BIG; -+ opt--; -+ opt->type = Opt_tail; -+ break; -+ } -+ opt->type = Opt_tail; -+ } -+ } -+ -+ kfree(a); -+ dump_opts(opts); -+ if (unlikely(err)) -+ au_opts_free(opts); -+ -+out: -+ return err; -+} -+ -+static int au_opt_wbr_create(struct super_block *sb, -+ struct au_opt_wbr_create *create) -+{ -+ int err; -+ struct au_sbinfo *sbinfo; -+ -+ SiMustWriteLock(sb); -+ -+ err = 1; /* handled */ -+ sbinfo = au_sbi(sb); -+ if (sbinfo->si_wbr_create_ops->fin) { -+ err = sbinfo->si_wbr_create_ops->fin(sb); -+ if (!err) -+ err = 1; -+ } -+ -+ sbinfo->si_wbr_create = create->wbr_create; -+ sbinfo->si_wbr_create_ops = au_wbr_create_ops + create->wbr_create; -+ switch (create->wbr_create) { -+ case AuWbrCreate_MFSRRV: -+ case AuWbrCreate_MFSRR: -+ case AuWbrCreate_TDMFS: -+ case AuWbrCreate_TDMFSV: -+ case AuWbrCreate_PMFSRR: -+ case AuWbrCreate_PMFSRRV: -+ sbinfo->si_wbr_mfs.mfsrr_watermark = create->mfsrr_watermark; -+ /*FALLTHROUGH*/ -+ case AuWbrCreate_MFS: -+ case AuWbrCreate_MFSV: -+ case AuWbrCreate_PMFS: -+ case AuWbrCreate_PMFSV: -+ sbinfo->si_wbr_mfs.mfs_expire -+ = msecs_to_jiffies(create->mfs_second * MSEC_PER_SEC); -+ break; -+ } -+ -+ if (sbinfo->si_wbr_create_ops->init) -+ sbinfo->si_wbr_create_ops->init(sb); /* ignore */ -+ -+ return err; -+} -+ -+/* -+ * returns, -+ * plus: processed without an error -+ * zero: unprocessed -+ */ -+static int au_opt_simple(struct super_block *sb, struct au_opt *opt, -+ struct au_opts *opts) -+{ -+ int err; -+ struct au_sbinfo *sbinfo; -+ -+ SiMustWriteLock(sb); -+ -+ err = 1; /* handled */ -+ sbinfo = au_sbi(sb); -+ switch (opt->type) { -+ case Opt_udba: -+ sbinfo->si_mntflags &= ~AuOptMask_UDBA; -+ sbinfo->si_mntflags |= opt->udba; -+ opts->given_udba |= opt->udba; -+ break; -+ -+ case Opt_plink: -+ au_opt_set(sbinfo->si_mntflags, PLINK); -+ break; -+ case Opt_noplink: -+ if (au_opt_test(sbinfo->si_mntflags, PLINK)) -+ au_plink_put(sb, /*verbose*/1); -+ au_opt_clr(sbinfo->si_mntflags, PLINK); -+ break; -+ case Opt_list_plink: -+ if (au_opt_test(sbinfo->si_mntflags, PLINK)) -+ au_plink_list(sb); -+ break; -+ -+ case Opt_dio: -+ au_opt_set(sbinfo->si_mntflags, DIO); -+ au_fset_opts(opts->flags, REFRESH_DYAOP); -+ break; -+ case Opt_nodio: -+ au_opt_clr(sbinfo->si_mntflags, DIO); -+ au_fset_opts(opts->flags, REFRESH_DYAOP); -+ break; -+ -+ case Opt_fhsm_sec: -+ au_fhsm_set(sbinfo, opt->fhsm_second); -+ break; -+ -+ case Opt_diropq_a: -+ au_opt_set(sbinfo->si_mntflags, ALWAYS_DIROPQ); -+ break; -+ case Opt_diropq_w: -+ au_opt_clr(sbinfo->si_mntflags, ALWAYS_DIROPQ); -+ break; -+ -+ case Opt_warn_perm: -+ au_opt_set(sbinfo->si_mntflags, WARN_PERM); -+ break; -+ case Opt_nowarn_perm: -+ au_opt_clr(sbinfo->si_mntflags, WARN_PERM); -+ break; -+ -+ case Opt_verbose: -+ au_opt_set(sbinfo->si_mntflags, VERBOSE); -+ break; -+ case Opt_noverbose: -+ au_opt_clr(sbinfo->si_mntflags, VERBOSE); -+ break; -+ -+ case Opt_sum: -+ au_opt_set(sbinfo->si_mntflags, SUM); -+ break; -+ case Opt_wsum: -+ au_opt_clr(sbinfo->si_mntflags, SUM); -+ au_opt_set(sbinfo->si_mntflags, SUM_W); -+ case Opt_nosum: -+ au_opt_clr(sbinfo->si_mntflags, SUM); -+ au_opt_clr(sbinfo->si_mntflags, SUM_W); -+ break; -+ -+ case Opt_wbr_create: -+ err = au_opt_wbr_create(sb, &opt->wbr_create); -+ break; -+ case Opt_wbr_copyup: -+ sbinfo->si_wbr_copyup = opt->wbr_copyup; -+ sbinfo->si_wbr_copyup_ops = au_wbr_copyup_ops + opt->wbr_copyup; -+ break; -+ -+ case Opt_dirwh: -+ sbinfo->si_dirwh = opt->dirwh; -+ break; -+ -+ case Opt_rdcache: -+ sbinfo->si_rdcache -+ = msecs_to_jiffies(opt->rdcache * MSEC_PER_SEC); -+ break; -+ case Opt_rdblk: -+ sbinfo->si_rdblk = opt->rdblk; -+ break; -+ case Opt_rdblk_def: -+ sbinfo->si_rdblk = AUFS_RDBLK_DEF; -+ break; -+ case Opt_rdhash: -+ sbinfo->si_rdhash = opt->rdhash; -+ break; -+ case Opt_rdhash_def: -+ sbinfo->si_rdhash = AUFS_RDHASH_DEF; -+ break; -+ -+ case Opt_shwh: -+ au_opt_set(sbinfo->si_mntflags, SHWH); -+ break; -+ case Opt_noshwh: -+ au_opt_clr(sbinfo->si_mntflags, SHWH); -+ break; -+ -+ case Opt_dirperm1: -+ au_opt_set(sbinfo->si_mntflags, DIRPERM1); -+ break; -+ case Opt_nodirperm1: -+ au_opt_clr(sbinfo->si_mntflags, DIRPERM1); -+ break; -+ -+ case Opt_trunc_xino: -+ au_opt_set(sbinfo->si_mntflags, TRUNC_XINO); -+ break; -+ case Opt_notrunc_xino: -+ au_opt_clr(sbinfo->si_mntflags, TRUNC_XINO); -+ break; -+ -+ case Opt_trunc_xino_path: -+ case Opt_itrunc_xino: -+ err = au_xino_trunc(sb, opt->xino_itrunc.bindex); -+ if (!err) -+ err = 1; -+ break; -+ -+ case Opt_trunc_xib: -+ au_fset_opts(opts->flags, TRUNC_XIB); -+ break; -+ case Opt_notrunc_xib: -+ au_fclr_opts(opts->flags, TRUNC_XIB); -+ break; -+ -+ case Opt_dirren: -+ err = 1; -+ if (!au_opt_test(sbinfo->si_mntflags, DIRREN)) { -+ err = au_dr_opt_set(sb); -+ if (!err) -+ err = 1; -+ } -+ if (err == 1) -+ au_opt_set(sbinfo->si_mntflags, DIRREN); -+ break; -+ case Opt_nodirren: -+ err = 1; -+ if (au_opt_test(sbinfo->si_mntflags, DIRREN)) { -+ err = au_dr_opt_clr(sb, au_ftest_opts(opts->flags, -+ DR_FLUSHED)); -+ if (!err) -+ err = 1; -+ } -+ if (err == 1) -+ au_opt_clr(sbinfo->si_mntflags, DIRREN); -+ break; -+ -+ case Opt_acl: -+ sb->s_flags |= MS_POSIXACL; -+ break; -+ case Opt_noacl: -+ sb->s_flags &= ~MS_POSIXACL; -+ break; -+ -+ default: -+ err = 0; -+ break; -+ } -+ -+ return err; -+} -+ -+/* -+ * returns tri-state. -+ * plus: processed without an error -+ * zero: unprocessed -+ * minus: error -+ */ -+static int au_opt_br(struct super_block *sb, struct au_opt *opt, -+ struct au_opts *opts) -+{ -+ int err, do_refresh; -+ -+ err = 0; -+ switch (opt->type) { -+ case Opt_append: -+ opt->add.bindex = au_sbbot(sb) + 1; -+ if (opt->add.bindex < 0) -+ opt->add.bindex = 0; -+ goto add; -+ case Opt_prepend: -+ opt->add.bindex = 0; -+ add: /* indented label */ -+ case Opt_add: -+ err = au_br_add(sb, &opt->add, -+ au_ftest_opts(opts->flags, REMOUNT)); -+ if (!err) { -+ err = 1; -+ au_fset_opts(opts->flags, REFRESH); -+ } -+ break; -+ -+ case Opt_del: -+ case Opt_idel: -+ err = au_br_del(sb, &opt->del, -+ au_ftest_opts(opts->flags, REMOUNT)); -+ if (!err) { -+ err = 1; -+ au_fset_opts(opts->flags, TRUNC_XIB); -+ au_fset_opts(opts->flags, REFRESH); -+ } -+ break; -+ -+ case Opt_mod: -+ case Opt_imod: -+ err = au_br_mod(sb, &opt->mod, -+ au_ftest_opts(opts->flags, REMOUNT), -+ &do_refresh); -+ if (!err) { -+ err = 1; -+ if (do_refresh) -+ au_fset_opts(opts->flags, REFRESH); -+ } -+ break; -+ } -+ return err; -+} -+ -+static int au_opt_xino(struct super_block *sb, struct au_opt *opt, -+ struct au_opt_xino **opt_xino, -+ struct au_opts *opts) -+{ -+ int err; -+ aufs_bindex_t bbot, bindex; -+ struct dentry *root, *parent, *h_root; -+ -+ err = 0; -+ switch (opt->type) { -+ case Opt_xino: -+ err = au_xino_set(sb, &opt->xino, -+ !!au_ftest_opts(opts->flags, REMOUNT)); -+ if (unlikely(err)) -+ break; -+ -+ *opt_xino = &opt->xino; -+ au_xino_brid_set(sb, -1); -+ -+ /* safe d_parent access */ -+ parent = opt->xino.file->f_path.dentry->d_parent; -+ root = sb->s_root; -+ bbot = au_sbbot(sb); -+ for (bindex = 0; bindex <= bbot; bindex++) { -+ h_root = au_h_dptr(root, bindex); -+ if (h_root == parent) { -+ au_xino_brid_set(sb, au_sbr_id(sb, bindex)); -+ break; -+ } -+ } -+ break; -+ -+ case Opt_noxino: -+ au_xino_clr(sb); -+ au_xino_brid_set(sb, -1); -+ *opt_xino = (void *)-1; -+ break; -+ } -+ -+ return err; -+} -+ -+int au_opts_verify(struct super_block *sb, unsigned long sb_flags, -+ unsigned int pending) -+{ -+ int err, fhsm; -+ aufs_bindex_t bindex, bbot; -+ unsigned char do_plink, skip, do_free, can_no_dreval; -+ struct au_branch *br; -+ struct au_wbr *wbr; -+ struct dentry *root, *dentry; -+ struct inode *dir, *h_dir; -+ struct au_sbinfo *sbinfo; -+ struct au_hinode *hdir; -+ -+ SiMustAnyLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ AuDebugOn(!(sbinfo->si_mntflags & AuOptMask_UDBA)); -+ -+ if (!(sb_flags & MS_RDONLY)) { -+ if (unlikely(!au_br_writable(au_sbr_perm(sb, 0)))) -+ pr_warn("first branch should be rw\n"); -+ if (unlikely(au_opt_test(sbinfo->si_mntflags, SHWH))) -+ pr_warn_once("shwh should be used with ro\n"); -+ } -+ -+ if (au_opt_test((sbinfo->si_mntflags | pending), UDBA_HNOTIFY) -+ && !au_opt_test(sbinfo->si_mntflags, XINO)) -+ pr_warn_once("udba=*notify requires xino\n"); -+ -+ if (au_opt_test(sbinfo->si_mntflags, DIRPERM1)) -+ pr_warn_once("dirperm1 breaks the protection" -+ " by the permission bits on the lower branch\n"); -+ -+ err = 0; -+ fhsm = 0; -+ root = sb->s_root; -+ dir = d_inode(root); -+ do_plink = !!au_opt_test(sbinfo->si_mntflags, PLINK); -+ can_no_dreval = !!au_opt_test((sbinfo->si_mntflags | pending), -+ UDBA_NONE); -+ bbot = au_sbbot(sb); -+ for (bindex = 0; !err && bindex <= bbot; bindex++) { -+ skip = 0; -+ h_dir = au_h_iptr(dir, bindex); -+ br = au_sbr(sb, bindex); -+ -+ if ((br->br_perm & AuBrAttr_ICEX) -+ && !h_dir->i_op->listxattr) -+ br->br_perm &= ~AuBrAttr_ICEX; -+#if 0 -+ if ((br->br_perm & AuBrAttr_ICEX_SEC) -+ && (au_br_sb(br)->s_flags & MS_NOSEC)) -+ br->br_perm &= ~AuBrAttr_ICEX_SEC; -+#endif -+ -+ do_free = 0; -+ wbr = br->br_wbr; -+ if (wbr) -+ wbr_wh_read_lock(wbr); -+ -+ if (!au_br_writable(br->br_perm)) { -+ do_free = !!wbr; -+ skip = (!wbr -+ || (!wbr->wbr_whbase -+ && !wbr->wbr_plink -+ && !wbr->wbr_orph)); -+ } else if (!au_br_wh_linkable(br->br_perm)) { -+ /* skip = (!br->br_whbase && !br->br_orph); */ -+ skip = (!wbr || !wbr->wbr_whbase); -+ if (skip && wbr) { -+ if (do_plink) -+ skip = !!wbr->wbr_plink; -+ else -+ skip = !wbr->wbr_plink; -+ } -+ } else { -+ /* skip = (br->br_whbase && br->br_ohph); */ -+ skip = (wbr && wbr->wbr_whbase); -+ if (skip) { -+ if (do_plink) -+ skip = !!wbr->wbr_plink; -+ else -+ skip = !wbr->wbr_plink; -+ } -+ } -+ if (wbr) -+ wbr_wh_read_unlock(wbr); -+ -+ if (can_no_dreval) { -+ dentry = br->br_path.dentry; -+ spin_lock(&dentry->d_lock); -+ if (dentry->d_flags & -+ (DCACHE_OP_REVALIDATE | DCACHE_OP_WEAK_REVALIDATE)) -+ can_no_dreval = 0; -+ spin_unlock(&dentry->d_lock); -+ } -+ -+ if (au_br_fhsm(br->br_perm)) { -+ fhsm++; -+ AuDebugOn(!br->br_fhsm); -+ } -+ -+ if (skip) -+ continue; -+ -+ hdir = au_hi(dir, bindex); -+ au_hn_inode_lock_nested(hdir, AuLsc_I_PARENT); -+ if (wbr) -+ wbr_wh_write_lock(wbr); -+ err = au_wh_init(br, sb); -+ if (wbr) -+ wbr_wh_write_unlock(wbr); -+ au_hn_inode_unlock(hdir); -+ -+ if (!err && do_free) { -+ kfree(wbr); -+ br->br_wbr = NULL; -+ } -+ } -+ -+ if (can_no_dreval) -+ au_fset_si(sbinfo, NO_DREVAL); -+ else -+ au_fclr_si(sbinfo, NO_DREVAL); -+ -+ if (fhsm >= 2) { -+ au_fset_si(sbinfo, FHSM); -+ for (bindex = bbot; bindex >= 0; bindex--) { -+ br = au_sbr(sb, bindex); -+ if (au_br_fhsm(br->br_perm)) { -+ au_fhsm_set_bottom(sb, bindex); -+ break; -+ } -+ } -+ } else { -+ au_fclr_si(sbinfo, FHSM); -+ au_fhsm_set_bottom(sb, -1); -+ } -+ -+ return err; -+} -+ -+int au_opts_mount(struct super_block *sb, struct au_opts *opts) -+{ -+ int err; -+ unsigned int tmp; -+ aufs_bindex_t bindex, bbot; -+ struct au_opt *opt; -+ struct au_opt_xino *opt_xino, xino; -+ struct au_sbinfo *sbinfo; -+ struct au_branch *br; -+ struct inode *dir; -+ -+ SiMustWriteLock(sb); -+ -+ err = 0; -+ opt_xino = NULL; -+ opt = opts->opt; -+ while (err >= 0 && opt->type != Opt_tail) -+ err = au_opt_simple(sb, opt++, opts); -+ if (err > 0) -+ err = 0; -+ else if (unlikely(err < 0)) -+ goto out; -+ -+ /* disable xino and udba temporary */ -+ sbinfo = au_sbi(sb); -+ tmp = sbinfo->si_mntflags; -+ au_opt_clr(sbinfo->si_mntflags, XINO); -+ au_opt_set_udba(sbinfo->si_mntflags, UDBA_REVAL); -+ -+ opt = opts->opt; -+ while (err >= 0 && opt->type != Opt_tail) -+ err = au_opt_br(sb, opt++, opts); -+ if (err > 0) -+ err = 0; -+ else if (unlikely(err < 0)) -+ goto out; -+ -+ bbot = au_sbbot(sb); -+ if (unlikely(bbot < 0)) { -+ err = -EINVAL; -+ pr_err("no branches\n"); -+ goto out; -+ } -+ -+ if (au_opt_test(tmp, XINO)) -+ au_opt_set(sbinfo->si_mntflags, XINO); -+ opt = opts->opt; -+ while (!err && opt->type != Opt_tail) -+ err = au_opt_xino(sb, opt++, &opt_xino, opts); -+ if (unlikely(err)) -+ goto out; -+ -+ err = au_opts_verify(sb, sb->s_flags, tmp); -+ if (unlikely(err)) -+ goto out; -+ -+ /* restore xino */ -+ if (au_opt_test(tmp, XINO) && !opt_xino) { -+ xino.file = au_xino_def(sb); -+ err = PTR_ERR(xino.file); -+ if (IS_ERR(xino.file)) -+ goto out; -+ -+ err = au_xino_set(sb, &xino, /*remount*/0); -+ fput(xino.file); -+ if (unlikely(err)) -+ goto out; -+ } -+ -+ /* restore udba */ -+ tmp &= AuOptMask_UDBA; -+ sbinfo->si_mntflags &= ~AuOptMask_UDBA; -+ sbinfo->si_mntflags |= tmp; -+ bbot = au_sbbot(sb); -+ for (bindex = 0; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ err = au_hnotify_reset_br(tmp, br, br->br_perm); -+ if (unlikely(err)) -+ AuIOErr("hnotify failed on br %d, %d, ignored\n", -+ bindex, err); -+ /* go on even if err */ -+ } -+ if (au_opt_test(tmp, UDBA_HNOTIFY)) { -+ dir = d_inode(sb->s_root); -+ au_hn_reset(dir, au_hi_flags(dir, /*isdir*/1) & ~AuHi_XINO); -+ } -+ -+out: -+ return err; -+} -+ -+int au_opts_remount(struct super_block *sb, struct au_opts *opts) -+{ -+ int err, rerr; -+ unsigned char no_dreval; -+ struct inode *dir; -+ struct au_opt_xino *opt_xino; -+ struct au_opt *opt; -+ struct au_sbinfo *sbinfo; -+ -+ SiMustWriteLock(sb); -+ -+ err = au_dr_opt_flush(sb); -+ if (unlikely(err)) -+ goto out; -+ au_fset_opts(opts->flags, DR_FLUSHED); -+ -+ dir = d_inode(sb->s_root); -+ sbinfo = au_sbi(sb); -+ opt_xino = NULL; -+ opt = opts->opt; -+ while (err >= 0 && opt->type != Opt_tail) { -+ err = au_opt_simple(sb, opt, opts); -+ if (!err) -+ err = au_opt_br(sb, opt, opts); -+ if (!err) -+ err = au_opt_xino(sb, opt, &opt_xino, opts); -+ opt++; -+ } -+ if (err > 0) -+ err = 0; -+ AuTraceErr(err); -+ /* go on even err */ -+ -+ no_dreval = !!au_ftest_si(sbinfo, NO_DREVAL); -+ rerr = au_opts_verify(sb, opts->sb_flags, /*pending*/0); -+ if (unlikely(rerr && !err)) -+ err = rerr; -+ -+ if (no_dreval != !!au_ftest_si(sbinfo, NO_DREVAL)) -+ au_fset_opts(opts->flags, REFRESH_IDOP); -+ -+ if (au_ftest_opts(opts->flags, TRUNC_XIB)) { -+ rerr = au_xib_trunc(sb); -+ if (unlikely(rerr && !err)) -+ err = rerr; -+ } -+ -+ /* will be handled by the caller */ -+ if (!au_ftest_opts(opts->flags, REFRESH) -+ && (opts->given_udba -+ || au_opt_test(sbinfo->si_mntflags, XINO) -+ || au_ftest_opts(opts->flags, REFRESH_IDOP) -+ )) -+ au_fset_opts(opts->flags, REFRESH); -+ -+ AuDbg("status 0x%x\n", opts->flags); -+ -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+unsigned int au_opt_udba(struct super_block *sb) -+{ -+ return au_mntflags(sb) & AuOptMask_UDBA; -+} -diff --git a/fs/aufs/opts.h b/fs/aufs/opts.h -new file mode 100644 -index 000000000000..82f8c3258b1f ---- /dev/null -+++ b/fs/aufs/opts.h -@@ -0,0 +1,212 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * mount options/flags -+ */ -+ -+#ifndef __AUFS_OPTS_H__ -+#define __AUFS_OPTS_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+ -+struct file; -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* mount flags */ -+#define AuOpt_XINO 1 /* external inode number bitmap -+ and translation table */ -+#define AuOpt_TRUNC_XINO (1 << 1) /* truncate xino files */ -+#define AuOpt_UDBA_NONE (1 << 2) /* users direct branch access */ -+#define AuOpt_UDBA_REVAL (1 << 3) -+#define AuOpt_UDBA_HNOTIFY (1 << 4) -+#define AuOpt_SHWH (1 << 5) /* show whiteout */ -+#define AuOpt_PLINK (1 << 6) /* pseudo-link */ -+#define AuOpt_DIRPERM1 (1 << 7) /* ignore the lower dir's perm -+ bits */ -+#define AuOpt_ALWAYS_DIROPQ (1 << 9) /* policy to creating diropq */ -+#define AuOpt_SUM (1 << 10) /* summation for statfs(2) */ -+#define AuOpt_SUM_W (1 << 11) /* unimplemented */ -+#define AuOpt_WARN_PERM (1 << 12) /* warn when add-branch */ -+#define AuOpt_VERBOSE (1 << 13) /* busy inode when del-branch */ -+#define AuOpt_DIO (1 << 14) /* direct io */ -+#define AuOpt_DIRREN (1 << 15) /* directory rename */ -+ -+#ifndef CONFIG_AUFS_HNOTIFY -+#undef AuOpt_UDBA_HNOTIFY -+#define AuOpt_UDBA_HNOTIFY 0 -+#endif -+#ifndef CONFIG_AUFS_DIRREN -+#undef AuOpt_DIRREN -+#define AuOpt_DIRREN 0 -+#endif -+#ifndef CONFIG_AUFS_SHWH -+#undef AuOpt_SHWH -+#define AuOpt_SHWH 0 -+#endif -+ -+#define AuOpt_Def (AuOpt_XINO \ -+ | AuOpt_UDBA_REVAL \ -+ | AuOpt_PLINK \ -+ /* | AuOpt_DIRPERM1 */ \ -+ | AuOpt_WARN_PERM) -+#define AuOptMask_UDBA (AuOpt_UDBA_NONE \ -+ | AuOpt_UDBA_REVAL \ -+ | AuOpt_UDBA_HNOTIFY) -+ -+#define au_opt_test(flags, name) (flags & AuOpt_##name) -+#define au_opt_set(flags, name) do { \ -+ BUILD_BUG_ON(AuOpt_##name & AuOptMask_UDBA); \ -+ ((flags) |= AuOpt_##name); \ -+} while (0) -+#define au_opt_set_udba(flags, name) do { \ -+ (flags) &= ~AuOptMask_UDBA; \ -+ ((flags) |= AuOpt_##name); \ -+} while (0) -+#define au_opt_clr(flags, name) do { \ -+ ((flags) &= ~AuOpt_##name); \ -+} while (0) -+ -+static inline unsigned int au_opts_plink(unsigned int mntflags) -+{ -+#ifdef CONFIG_PROC_FS -+ return mntflags; -+#else -+ return mntflags & ~AuOpt_PLINK; -+#endif -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* policies to select one among multiple writable branches */ -+enum { -+ AuWbrCreate_TDP, /* top down parent */ -+ AuWbrCreate_RR, /* round robin */ -+ AuWbrCreate_MFS, /* most free space */ -+ AuWbrCreate_MFSV, /* mfs with seconds */ -+ AuWbrCreate_MFSRR, /* mfs then rr */ -+ AuWbrCreate_MFSRRV, /* mfs then rr with seconds */ -+ AuWbrCreate_TDMFS, /* top down regardless parent and mfs */ -+ AuWbrCreate_TDMFSV, /* top down regardless parent and mfs */ -+ AuWbrCreate_PMFS, /* parent and mfs */ -+ AuWbrCreate_PMFSV, /* parent and mfs with seconds */ -+ AuWbrCreate_PMFSRR, /* parent, mfs and round-robin */ -+ AuWbrCreate_PMFSRRV, /* plus seconds */ -+ -+ AuWbrCreate_Def = AuWbrCreate_TDP -+}; -+ -+enum { -+ AuWbrCopyup_TDP, /* top down parent */ -+ AuWbrCopyup_BUP, /* bottom up parent */ -+ AuWbrCopyup_BU, /* bottom up */ -+ -+ AuWbrCopyup_Def = AuWbrCopyup_TDP -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct au_opt_add { -+ aufs_bindex_t bindex; -+ char *pathname; -+ int perm; -+ struct path path; -+}; -+ -+struct au_opt_del { -+ char *pathname; -+ struct path h_path; -+}; -+ -+struct au_opt_mod { -+ char *path; -+ int perm; -+ struct dentry *h_root; -+}; -+ -+struct au_opt_xino { -+ char *path; -+ struct file *file; -+}; -+ -+struct au_opt_xino_itrunc { -+ aufs_bindex_t bindex; -+}; -+ -+struct au_opt_wbr_create { -+ int wbr_create; -+ int mfs_second; -+ unsigned long long mfsrr_watermark; -+}; -+ -+struct au_opt { -+ int type; -+ union { -+ struct au_opt_xino xino; -+ struct au_opt_xino_itrunc xino_itrunc; -+ struct au_opt_add add; -+ struct au_opt_del del; -+ struct au_opt_mod mod; -+ int dirwh; -+ int rdcache; -+ unsigned int rdblk; -+ unsigned int rdhash; -+ int udba; -+ struct au_opt_wbr_create wbr_create; -+ int wbr_copyup; -+ unsigned int fhsm_second; -+ }; -+}; -+ -+/* opts flags */ -+#define AuOpts_REMOUNT 1 -+#define AuOpts_REFRESH (1 << 1) -+#define AuOpts_TRUNC_XIB (1 << 2) -+#define AuOpts_REFRESH_DYAOP (1 << 3) -+#define AuOpts_REFRESH_IDOP (1 << 4) -+#define AuOpts_DR_FLUSHED (1 << 5) -+#define au_ftest_opts(flags, name) ((flags) & AuOpts_##name) -+#define au_fset_opts(flags, name) \ -+ do { (flags) |= AuOpts_##name; } while (0) -+#define au_fclr_opts(flags, name) \ -+ do { (flags) &= ~AuOpts_##name; } while (0) -+ -+#ifndef CONFIG_AUFS_DIRREN -+#undef AuOpts_DR_FLUSHED -+#define AuOpts_DR_FLUSHED 0 -+#endif -+ -+struct au_opts { -+ struct au_opt *opt; -+ int max_opt; -+ -+ unsigned int given_udba; -+ unsigned int flags; -+ unsigned long sb_flags; -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* opts.c */ -+void au_optstr_br_perm(au_br_perm_str_t *str, int perm); -+const char *au_optstr_udba(int udba); -+const char *au_optstr_wbr_copyup(int wbr_copyup); -+const char *au_optstr_wbr_create(int wbr_create); -+ -+void au_opts_free(struct au_opts *opts); -+struct super_block; -+int au_opts_parse(struct super_block *sb, char *str, struct au_opts *opts); -+int au_opts_verify(struct super_block *sb, unsigned long sb_flags, -+ unsigned int pending); -+int au_opts_mount(struct super_block *sb, struct au_opts *opts); -+int au_opts_remount(struct super_block *sb, struct au_opts *opts); -+ -+unsigned int au_opt_udba(struct super_block *sb); -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_OPTS_H__ */ -diff --git a/fs/aufs/plink.c b/fs/aufs/plink.c -new file mode 100644 -index 000000000000..3fe5ef527f5f ---- /dev/null -+++ b/fs/aufs/plink.c -@@ -0,0 +1,503 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * pseudo-link -+ */ -+ -+#include "aufs.h" -+ -+/* -+ * the pseudo-link maintenance mode. -+ * during a user process maintains the pseudo-links, -+ * prohibit adding a new plink and branch manipulation. -+ * -+ * Flags -+ * NOPLM: -+ * For entry functions which will handle plink, and i_mutex is already held -+ * in VFS. -+ * They cannot wait and should return an error at once. -+ * Callers has to check the error. -+ * NOPLMW: -+ * For entry functions which will handle plink, but i_mutex is not held -+ * in VFS. -+ * They can wait the plink maintenance mode to finish. -+ * -+ * They behave like F_SETLK and F_SETLKW. -+ * If the caller never handle plink, then both flags are unnecessary. -+ */ -+ -+int au_plink_maint(struct super_block *sb, int flags) -+{ -+ int err; -+ pid_t pid, ppid; -+ struct task_struct *parent, *prev; -+ struct au_sbinfo *sbi; -+ -+ SiMustAnyLock(sb); -+ -+ err = 0; -+ if (!au_opt_test(au_mntflags(sb), PLINK)) -+ goto out; -+ -+ sbi = au_sbi(sb); -+ pid = sbi->si_plink_maint_pid; -+ if (!pid || pid == current->pid) -+ goto out; -+ -+ /* todo: it highly depends upon /sbin/mount.aufs */ -+ prev = NULL; -+ parent = current; -+ ppid = 0; -+ rcu_read_lock(); -+ while (1) { -+ parent = rcu_dereference(parent->real_parent); -+ if (parent == prev) -+ break; -+ ppid = task_pid_vnr(parent); -+ if (pid == ppid) { -+ rcu_read_unlock(); -+ goto out; -+ } -+ prev = parent; -+ } -+ rcu_read_unlock(); -+ -+ if (au_ftest_lock(flags, NOPLMW)) { -+ /* if there is no i_mutex lock in VFS, we don't need to wait */ -+ /* AuDebugOn(!lockdep_depth(current)); */ -+ while (sbi->si_plink_maint_pid) { -+ si_read_unlock(sb); -+ /* gave up wake_up_bit() */ -+ wait_event(sbi->si_plink_wq, !sbi->si_plink_maint_pid); -+ -+ if (au_ftest_lock(flags, FLUSH)) -+ au_nwt_flush(&sbi->si_nowait); -+ si_noflush_read_lock(sb); -+ } -+ } else if (au_ftest_lock(flags, NOPLM)) { -+ AuDbg("ppid %d, pid %d\n", ppid, pid); -+ err = -EAGAIN; -+ } -+ -+out: -+ return err; -+} -+ -+void au_plink_maint_leave(struct au_sbinfo *sbinfo) -+{ -+ spin_lock(&sbinfo->si_plink_maint_lock); -+ sbinfo->si_plink_maint_pid = 0; -+ spin_unlock(&sbinfo->si_plink_maint_lock); -+ wake_up_all(&sbinfo->si_plink_wq); -+} -+ -+int au_plink_maint_enter(struct super_block *sb) -+{ -+ int err; -+ struct au_sbinfo *sbinfo; -+ -+ err = 0; -+ sbinfo = au_sbi(sb); -+ /* make sure i am the only one in this fs */ -+ si_write_lock(sb, AuLock_FLUSH); -+ if (au_opt_test(au_mntflags(sb), PLINK)) { -+ spin_lock(&sbinfo->si_plink_maint_lock); -+ if (!sbinfo->si_plink_maint_pid) -+ sbinfo->si_plink_maint_pid = current->pid; -+ else -+ err = -EBUSY; -+ spin_unlock(&sbinfo->si_plink_maint_lock); -+ } -+ si_write_unlock(sb); -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+#ifdef CONFIG_AUFS_DEBUG -+void au_plink_list(struct super_block *sb) -+{ -+ int i; -+ struct au_sbinfo *sbinfo; -+ struct hlist_bl_head *hbl; -+ struct hlist_bl_node *pos; -+ struct au_icntnr *icntnr; -+ -+ SiMustAnyLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ AuDebugOn(!au_opt_test(au_mntflags(sb), PLINK)); -+ AuDebugOn(au_plink_maint(sb, AuLock_NOPLM)); -+ -+ for (i = 0; i < AuPlink_NHASH; i++) { -+ hbl = sbinfo->si_plink + i; -+ hlist_bl_lock(hbl); -+ hlist_bl_for_each_entry(icntnr, pos, hbl, plink) -+ AuDbg("%lu\n", icntnr->vfs_inode.i_ino); -+ hlist_bl_unlock(hbl); -+ } -+} -+#endif -+ -+/* is the inode pseudo-linked? */ -+int au_plink_test(struct inode *inode) -+{ -+ int found, i; -+ struct au_sbinfo *sbinfo; -+ struct hlist_bl_head *hbl; -+ struct hlist_bl_node *pos; -+ struct au_icntnr *icntnr; -+ -+ sbinfo = au_sbi(inode->i_sb); -+ AuRwMustAnyLock(&sbinfo->si_rwsem); -+ AuDebugOn(!au_opt_test(au_mntflags(inode->i_sb), PLINK)); -+ AuDebugOn(au_plink_maint(inode->i_sb, AuLock_NOPLM)); -+ -+ found = 0; -+ i = au_plink_hash(inode->i_ino); -+ hbl = sbinfo->si_plink + i; -+ hlist_bl_lock(hbl); -+ hlist_bl_for_each_entry(icntnr, pos, hbl, plink) -+ if (&icntnr->vfs_inode == inode) { -+ found = 1; -+ break; -+ } -+ hlist_bl_unlock(hbl); -+ return found; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * generate a name for plink. -+ * the file will be stored under AUFS_WH_PLINKDIR. -+ */ -+/* 20 is max digits length of ulong 64 */ -+#define PLINK_NAME_LEN ((20 + 1) * 2) -+ -+static int plink_name(char *name, int len, struct inode *inode, -+ aufs_bindex_t bindex) -+{ -+ int rlen; -+ struct inode *h_inode; -+ -+ h_inode = au_h_iptr(inode, bindex); -+ rlen = snprintf(name, len, "%lu.%lu", inode->i_ino, h_inode->i_ino); -+ return rlen; -+} -+ -+struct au_do_plink_lkup_args { -+ struct dentry **errp; -+ struct qstr *tgtname; -+ struct dentry *h_parent; -+ struct au_branch *br; -+}; -+ -+static struct dentry *au_do_plink_lkup(struct qstr *tgtname, -+ struct dentry *h_parent, -+ struct au_branch *br) -+{ -+ struct dentry *h_dentry; -+ struct inode *h_inode; -+ -+ h_inode = d_inode(h_parent); -+ vfsub_inode_lock_shared_nested(h_inode, AuLsc_I_CHILD2); -+ h_dentry = vfsub_lkup_one(tgtname, h_parent); -+ inode_unlock_shared(h_inode); -+ return h_dentry; -+} -+ -+static void au_call_do_plink_lkup(void *args) -+{ -+ struct au_do_plink_lkup_args *a = args; -+ *a->errp = au_do_plink_lkup(a->tgtname, a->h_parent, a->br); -+} -+ -+/* lookup the plink-ed @inode under the branch at @bindex */ -+struct dentry *au_plink_lkup(struct inode *inode, aufs_bindex_t bindex) -+{ -+ struct dentry *h_dentry, *h_parent; -+ struct au_branch *br; -+ int wkq_err; -+ char a[PLINK_NAME_LEN]; -+ struct qstr tgtname = QSTR_INIT(a, 0); -+ -+ AuDebugOn(au_plink_maint(inode->i_sb, AuLock_NOPLM)); -+ -+ br = au_sbr(inode->i_sb, bindex); -+ h_parent = br->br_wbr->wbr_plink; -+ tgtname.len = plink_name(a, sizeof(a), inode, bindex); -+ -+ if (!uid_eq(current_fsuid(), GLOBAL_ROOT_UID)) { -+ struct au_do_plink_lkup_args args = { -+ .errp = &h_dentry, -+ .tgtname = &tgtname, -+ .h_parent = h_parent, -+ .br = br -+ }; -+ -+ wkq_err = au_wkq_wait(au_call_do_plink_lkup, &args); -+ if (unlikely(wkq_err)) -+ h_dentry = ERR_PTR(wkq_err); -+ } else -+ h_dentry = au_do_plink_lkup(&tgtname, h_parent, br); -+ -+ return h_dentry; -+} -+ -+/* create a pseudo-link */ -+static int do_whplink(struct qstr *tgt, struct dentry *h_parent, -+ struct dentry *h_dentry, struct au_branch *br) -+{ -+ int err; -+ struct path h_path = { -+ .mnt = au_br_mnt(br) -+ }; -+ struct inode *h_dir, *delegated; -+ -+ h_dir = d_inode(h_parent); -+ inode_lock_nested(h_dir, AuLsc_I_CHILD2); -+again: -+ h_path.dentry = vfsub_lkup_one(tgt, h_parent); -+ err = PTR_ERR(h_path.dentry); -+ if (IS_ERR(h_path.dentry)) -+ goto out; -+ -+ err = 0; -+ /* wh.plink dir is not monitored */ -+ /* todo: is it really safe? */ -+ if (d_is_positive(h_path.dentry) -+ && d_inode(h_path.dentry) != d_inode(h_dentry)) { -+ delegated = NULL; -+ err = vfsub_unlink(h_dir, &h_path, &delegated, /*force*/0); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal unlink\n"); -+ iput(delegated); -+ } -+ dput(h_path.dentry); -+ h_path.dentry = NULL; -+ if (!err) -+ goto again; -+ } -+ if (!err && d_is_negative(h_path.dentry)) { -+ delegated = NULL; -+ err = vfsub_link(h_dentry, h_dir, &h_path, &delegated); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal link\n"); -+ iput(delegated); -+ } -+ } -+ dput(h_path.dentry); -+ -+out: -+ inode_unlock(h_dir); -+ return err; -+} -+ -+struct do_whplink_args { -+ int *errp; -+ struct qstr *tgt; -+ struct dentry *h_parent; -+ struct dentry *h_dentry; -+ struct au_branch *br; -+}; -+ -+static void call_do_whplink(void *args) -+{ -+ struct do_whplink_args *a = args; -+ *a->errp = do_whplink(a->tgt, a->h_parent, a->h_dentry, a->br); -+} -+ -+static int whplink(struct dentry *h_dentry, struct inode *inode, -+ aufs_bindex_t bindex, struct au_branch *br) -+{ -+ int err, wkq_err; -+ struct au_wbr *wbr; -+ struct dentry *h_parent; -+ char a[PLINK_NAME_LEN]; -+ struct qstr tgtname = QSTR_INIT(a, 0); -+ -+ wbr = au_sbr(inode->i_sb, bindex)->br_wbr; -+ h_parent = wbr->wbr_plink; -+ tgtname.len = plink_name(a, sizeof(a), inode, bindex); -+ -+ /* always superio. */ -+ if (!uid_eq(current_fsuid(), GLOBAL_ROOT_UID)) { -+ struct do_whplink_args args = { -+ .errp = &err, -+ .tgt = &tgtname, -+ .h_parent = h_parent, -+ .h_dentry = h_dentry, -+ .br = br -+ }; -+ wkq_err = au_wkq_wait(call_do_whplink, &args); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ } else -+ err = do_whplink(&tgtname, h_parent, h_dentry, br); -+ -+ return err; -+} -+ -+/* -+ * create a new pseudo-link for @h_dentry on @bindex. -+ * the linked inode is held in aufs @inode. -+ */ -+void au_plink_append(struct inode *inode, aufs_bindex_t bindex, -+ struct dentry *h_dentry) -+{ -+ struct super_block *sb; -+ struct au_sbinfo *sbinfo; -+ struct hlist_bl_head *hbl; -+ struct hlist_bl_node *pos; -+ struct au_icntnr *icntnr; -+ int found, err, cnt, i; -+ -+ sb = inode->i_sb; -+ sbinfo = au_sbi(sb); -+ AuDebugOn(!au_opt_test(au_mntflags(sb), PLINK)); -+ AuDebugOn(au_plink_maint(sb, AuLock_NOPLM)); -+ -+ found = au_plink_test(inode); -+ if (found) -+ return; -+ -+ i = au_plink_hash(inode->i_ino); -+ hbl = sbinfo->si_plink + i; -+ au_igrab(inode); -+ -+ hlist_bl_lock(hbl); -+ hlist_bl_for_each_entry(icntnr, pos, hbl, plink) { -+ if (&icntnr->vfs_inode == inode) { -+ found = 1; -+ break; -+ } -+ } -+ if (!found) { -+ icntnr = container_of(inode, struct au_icntnr, vfs_inode); -+ hlist_bl_add_head(&icntnr->plink, hbl); -+ } -+ hlist_bl_unlock(hbl); -+ if (!found) { -+ cnt = au_hbl_count(hbl); -+#define msg "unexpectedly unblanced or too many pseudo-links" -+ if (cnt > AUFS_PLINK_WARN) -+ AuWarn1(msg ", %d\n", cnt); -+#undef msg -+ err = whplink(h_dentry, inode, bindex, au_sbr(sb, bindex)); -+ if (unlikely(err)) { -+ pr_warn("err %d, damaged pseudo link.\n", err); -+ au_hbl_del(&icntnr->plink, hbl); -+ iput(&icntnr->vfs_inode); -+ } -+ } else -+ iput(&icntnr->vfs_inode); -+} -+ -+/* free all plinks */ -+void au_plink_put(struct super_block *sb, int verbose) -+{ -+ int i, warned; -+ struct au_sbinfo *sbinfo; -+ struct hlist_bl_head *hbl; -+ struct hlist_bl_node *pos, *tmp; -+ struct au_icntnr *icntnr; -+ -+ SiMustWriteLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ AuDebugOn(!au_opt_test(au_mntflags(sb), PLINK)); -+ AuDebugOn(au_plink_maint(sb, AuLock_NOPLM)); -+ -+ /* no spin_lock since sbinfo is write-locked */ -+ warned = 0; -+ for (i = 0; i < AuPlink_NHASH; i++) { -+ hbl = sbinfo->si_plink + i; -+ if (!warned && verbose && !hlist_bl_empty(hbl)) { -+ pr_warn("pseudo-link is not flushed"); -+ warned = 1; -+ } -+ hlist_bl_for_each_entry_safe(icntnr, pos, tmp, hbl, plink) -+ iput(&icntnr->vfs_inode); -+ INIT_HLIST_BL_HEAD(hbl); -+ } -+} -+ -+void au_plink_clean(struct super_block *sb, int verbose) -+{ -+ struct dentry *root; -+ -+ root = sb->s_root; -+ aufs_write_lock(root); -+ if (au_opt_test(au_mntflags(sb), PLINK)) -+ au_plink_put(sb, verbose); -+ aufs_write_unlock(root); -+} -+ -+static int au_plink_do_half_refresh(struct inode *inode, aufs_bindex_t br_id) -+{ -+ int do_put; -+ aufs_bindex_t btop, bbot, bindex; -+ -+ do_put = 0; -+ btop = au_ibtop(inode); -+ bbot = au_ibbot(inode); -+ if (btop >= 0) { -+ for (bindex = btop; bindex <= bbot; bindex++) { -+ if (!au_h_iptr(inode, bindex) -+ || au_ii_br_id(inode, bindex) != br_id) -+ continue; -+ au_set_h_iptr(inode, bindex, NULL, 0); -+ do_put = 1; -+ break; -+ } -+ if (do_put) -+ for (bindex = btop; bindex <= bbot; bindex++) -+ if (au_h_iptr(inode, bindex)) { -+ do_put = 0; -+ break; -+ } -+ } else -+ do_put = 1; -+ -+ return do_put; -+} -+ -+/* free the plinks on a branch specified by @br_id */ -+void au_plink_half_refresh(struct super_block *sb, aufs_bindex_t br_id) -+{ -+ struct au_sbinfo *sbinfo; -+ struct hlist_bl_head *hbl; -+ struct hlist_bl_node *pos, *tmp; -+ struct au_icntnr *icntnr; -+ struct inode *inode; -+ int i, do_put; -+ -+ SiMustWriteLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ AuDebugOn(!au_opt_test(au_mntflags(sb), PLINK)); -+ AuDebugOn(au_plink_maint(sb, AuLock_NOPLM)); -+ -+ /* no bit_lock since sbinfo is write-locked */ -+ for (i = 0; i < AuPlink_NHASH; i++) { -+ hbl = sbinfo->si_plink + i; -+ hlist_bl_for_each_entry_safe(icntnr, pos, tmp, hbl, plink) { -+ inode = au_igrab(&icntnr->vfs_inode); -+ ii_write_lock_child(inode); -+ do_put = au_plink_do_half_refresh(inode, br_id); -+ if (do_put) { -+ hlist_bl_del(&icntnr->plink); -+ iput(inode); -+ } -+ ii_write_unlock(inode); -+ iput(inode); -+ } -+ } -+} -diff --git a/fs/aufs/poll.c b/fs/aufs/poll.c -new file mode 100644 -index 000000000000..0ecc465e505e ---- /dev/null -+++ b/fs/aufs/poll.c -@@ -0,0 +1,40 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * poll operation -+ * There is only one filesystem which implements ->poll operation, currently. -+ */ -+ -+#include "aufs.h" -+ -+unsigned int aufs_poll(struct file *file, poll_table *wait) -+{ -+ unsigned int mask; -+ int err; -+ struct file *h_file; -+ struct super_block *sb; -+ -+ /* We should pretend an error happened. */ -+ mask = POLLERR /* | POLLIN | POLLOUT */; -+ sb = file->f_path.dentry->d_sb; -+ si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLMW); -+ -+ h_file = au_read_pre(file, /*keep_fi*/0, /*lsc*/0); -+ err = PTR_ERR(h_file); -+ if (IS_ERR(h_file)) -+ goto out; -+ -+ /* it is not an error if h_file has no operation */ -+ mask = DEFAULT_POLLMASK; -+ if (h_file->f_op->poll) -+ mask = h_file->f_op->poll(h_file, wait); -+ fput(h_file); /* instead of au_read_post() */ -+ -+out: -+ si_read_unlock(sb); -+ AuTraceErr((int)mask); -+ return mask; -+} -diff --git a/fs/aufs/posix_acl.c b/fs/aufs/posix_acl.c -new file mode 100644 -index 000000000000..dee01d657850 ---- /dev/null -+++ b/fs/aufs/posix_acl.c -@@ -0,0 +1,90 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2014-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * posix acl operations -+ */ -+ -+#include -+#include "aufs.h" -+ -+struct posix_acl *aufs_get_acl(struct inode *inode, int type) -+{ -+ struct posix_acl *acl; -+ int err; -+ aufs_bindex_t bindex; -+ struct inode *h_inode; -+ struct super_block *sb; -+ -+ acl = NULL; -+ sb = inode->i_sb; -+ si_read_lock(sb, AuLock_FLUSH); -+ ii_read_lock_child(inode); -+ if (!(sb->s_flags & MS_POSIXACL)) -+ goto out; -+ -+ bindex = au_ibtop(inode); -+ h_inode = au_h_iptr(inode, bindex); -+ if (unlikely(!h_inode -+ || ((h_inode->i_mode & S_IFMT) -+ != (inode->i_mode & S_IFMT)))) { -+ err = au_busy_or_stale(); -+ acl = ERR_PTR(err); -+ goto out; -+ } -+ -+ /* always topmost only */ -+ acl = get_acl(h_inode, type); -+ if (!IS_ERR_OR_NULL(acl)) -+ set_cached_acl(inode, type, acl); -+ -+out: -+ ii_read_unlock(inode); -+ si_read_unlock(sb); -+ -+ AuTraceErrPtr(acl); -+ return acl; -+} -+ -+int aufs_set_acl(struct inode *inode, struct posix_acl *acl, int type) -+{ -+ int err; -+ ssize_t ssz; -+ struct dentry *dentry; -+ struct au_sxattr arg = { -+ .type = AU_ACL_SET, -+ .u.acl_set = { -+ .acl = acl, -+ .type = type -+ }, -+ }; -+ -+ IMustLock(inode); -+ -+ if (inode->i_ino == AUFS_ROOT_INO) -+ dentry = dget(inode->i_sb->s_root); -+ else { -+ dentry = d_find_alias(inode); -+ if (!dentry) -+ dentry = d_find_any_alias(inode); -+ if (!dentry) { -+ pr_warn("cannot handle this inode, " -+ "please report to aufs-users ML\n"); -+ err = -ENOENT; -+ goto out; -+ } -+ } -+ -+ ssz = au_sxattr(dentry, inode, &arg); -+ dput(dentry); -+ err = ssz; -+ if (ssz >= 0) { -+ err = 0; -+ set_cached_acl(inode, type, acl); -+ } -+ -+out: -+ return err; -+} -diff --git a/fs/aufs/procfs.c b/fs/aufs/procfs.c -new file mode 100644 -index 000000000000..7481906e90ee ---- /dev/null -+++ b/fs/aufs/procfs.c -@@ -0,0 +1,158 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2010-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * procfs interfaces -+ */ -+ -+#include -+#include "aufs.h" -+ -+static int au_procfs_plm_release(struct inode *inode, struct file *file) -+{ -+ struct au_sbinfo *sbinfo; -+ -+ sbinfo = file->private_data; -+ if (sbinfo) { -+ au_plink_maint_leave(sbinfo); -+ kobject_put(&sbinfo->si_kobj); -+ } -+ -+ return 0; -+} -+ -+static void au_procfs_plm_write_clean(struct file *file) -+{ -+ struct au_sbinfo *sbinfo; -+ -+ sbinfo = file->private_data; -+ if (sbinfo) -+ au_plink_clean(sbinfo->si_sb, /*verbose*/0); -+} -+ -+static int au_procfs_plm_write_si(struct file *file, unsigned long id) -+{ -+ int err; -+ struct super_block *sb; -+ struct au_sbinfo *sbinfo; -+ struct hlist_bl_node *pos; -+ -+ err = -EBUSY; -+ if (unlikely(file->private_data)) -+ goto out; -+ -+ sb = NULL; -+ /* don't use au_sbilist_lock() here */ -+ hlist_bl_lock(&au_sbilist); -+ hlist_bl_for_each_entry(sbinfo, pos, &au_sbilist, si_list) -+ if (id == sysaufs_si_id(sbinfo)) { -+ kobject_get(&sbinfo->si_kobj); -+ sb = sbinfo->si_sb; -+ break; -+ } -+ hlist_bl_unlock(&au_sbilist); -+ -+ err = -EINVAL; -+ if (unlikely(!sb)) -+ goto out; -+ -+ err = au_plink_maint_enter(sb); -+ if (!err) -+ /* keep kobject_get() */ -+ file->private_data = sbinfo; -+ else -+ kobject_put(&sbinfo->si_kobj); -+out: -+ return err; -+} -+ -+/* -+ * Accept a valid "si=xxxx" only. -+ * Once it is accepted successfully, accept "clean" too. -+ */ -+static ssize_t au_procfs_plm_write(struct file *file, const char __user *ubuf, -+ size_t count, loff_t *ppos) -+{ -+ ssize_t err; -+ unsigned long id; -+ /* last newline is allowed */ -+ char buf[3 + sizeof(unsigned long) * 2 + 1]; -+ -+ err = -EACCES; -+ if (unlikely(!capable(CAP_SYS_ADMIN))) -+ goto out; -+ -+ err = -EINVAL; -+ if (unlikely(count > sizeof(buf))) -+ goto out; -+ -+ err = copy_from_user(buf, ubuf, count); -+ if (unlikely(err)) { -+ err = -EFAULT; -+ goto out; -+ } -+ buf[count] = 0; -+ -+ err = -EINVAL; -+ if (!strcmp("clean", buf)) { -+ au_procfs_plm_write_clean(file); -+ goto out_success; -+ } else if (unlikely(strncmp("si=", buf, 3))) -+ goto out; -+ -+ err = kstrtoul(buf + 3, 16, &id); -+ if (unlikely(err)) -+ goto out; -+ -+ err = au_procfs_plm_write_si(file, id); -+ if (unlikely(err)) -+ goto out; -+ -+out_success: -+ err = count; /* success */ -+out: -+ return err; -+} -+ -+static const struct file_operations au_procfs_plm_fop = { -+ .write = au_procfs_plm_write, -+ .release = au_procfs_plm_release, -+ .owner = THIS_MODULE -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+static struct proc_dir_entry *au_procfs_dir; -+ -+void au_procfs_fin(void) -+{ -+ remove_proc_entry(AUFS_PLINK_MAINT_NAME, au_procfs_dir); -+ remove_proc_entry(AUFS_PLINK_MAINT_DIR, NULL); -+} -+ -+int __init au_procfs_init(void) -+{ -+ int err; -+ struct proc_dir_entry *entry; -+ -+ err = -ENOMEM; -+ au_procfs_dir = proc_mkdir(AUFS_PLINK_MAINT_DIR, NULL); -+ if (unlikely(!au_procfs_dir)) -+ goto out; -+ -+ entry = proc_create(AUFS_PLINK_MAINT_NAME, S_IFREG | S_IWUSR, -+ au_procfs_dir, &au_procfs_plm_fop); -+ if (unlikely(!entry)) -+ goto out_dir; -+ -+ err = 0; -+ goto out; /* success */ -+ -+ -+out_dir: -+ remove_proc_entry(AUFS_PLINK_MAINT_DIR, NULL); -+out: -+ return err; -+} -diff --git a/fs/aufs/rdu.c b/fs/aufs/rdu.c -new file mode 100644 -index 000000000000..94128e655471 ---- /dev/null -+++ b/fs/aufs/rdu.c -@@ -0,0 +1,369 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * readdir in userspace. -+ */ -+ -+#include -+#include -+#include -+#include "aufs.h" -+ -+/* bits for struct aufs_rdu.flags */ -+#define AuRdu_CALLED 1 -+#define AuRdu_CONT (1 << 1) -+#define AuRdu_FULL (1 << 2) -+#define au_ftest_rdu(flags, name) ((flags) & AuRdu_##name) -+#define au_fset_rdu(flags, name) \ -+ do { (flags) |= AuRdu_##name; } while (0) -+#define au_fclr_rdu(flags, name) \ -+ do { (flags) &= ~AuRdu_##name; } while (0) -+ -+struct au_rdu_arg { -+ struct dir_context ctx; -+ struct aufs_rdu *rdu; -+ union au_rdu_ent_ul ent; -+ unsigned long end; -+ -+ struct super_block *sb; -+ int err; -+}; -+ -+static int au_rdu_fill(struct dir_context *ctx, const char *name, int nlen, -+ loff_t offset, u64 h_ino, unsigned int d_type) -+{ -+ int err, len; -+ struct au_rdu_arg *arg = container_of(ctx, struct au_rdu_arg, ctx); -+ struct aufs_rdu *rdu = arg->rdu; -+ struct au_rdu_ent ent; -+ -+ err = 0; -+ arg->err = 0; -+ au_fset_rdu(rdu->cookie.flags, CALLED); -+ len = au_rdu_len(nlen); -+ if (arg->ent.ul + len < arg->end) { -+ ent.ino = h_ino; -+ ent.bindex = rdu->cookie.bindex; -+ ent.type = d_type; -+ ent.nlen = nlen; -+ if (unlikely(nlen > AUFS_MAX_NAMELEN)) -+ ent.type = DT_UNKNOWN; -+ -+ /* unnecessary to support mmap_sem since this is a dir */ -+ err = -EFAULT; -+ if (copy_to_user(arg->ent.e, &ent, sizeof(ent))) -+ goto out; -+ if (copy_to_user(arg->ent.e->name, name, nlen)) -+ goto out; -+ /* the terminating NULL */ -+ if (__put_user(0, arg->ent.e->name + nlen)) -+ goto out; -+ err = 0; -+ /* AuDbg("%p, %.*s\n", arg->ent.p, nlen, name); */ -+ arg->ent.ul += len; -+ rdu->rent++; -+ } else { -+ err = -EFAULT; -+ au_fset_rdu(rdu->cookie.flags, FULL); -+ rdu->full = 1; -+ rdu->tail = arg->ent; -+ } -+ -+out: -+ /* AuTraceErr(err); */ -+ return err; -+} -+ -+static int au_rdu_do(struct file *h_file, struct au_rdu_arg *arg) -+{ -+ int err; -+ loff_t offset; -+ struct au_rdu_cookie *cookie = &arg->rdu->cookie; -+ -+ /* we don't have to care (FMODE_32BITHASH | FMODE_64BITHASH) for ext4 */ -+ offset = vfsub_llseek(h_file, cookie->h_pos, SEEK_SET); -+ err = offset; -+ if (unlikely(offset != cookie->h_pos)) -+ goto out; -+ -+ err = 0; -+ do { -+ arg->err = 0; -+ au_fclr_rdu(cookie->flags, CALLED); -+ /* smp_mb(); */ -+ err = vfsub_iterate_dir(h_file, &arg->ctx); -+ if (err >= 0) -+ err = arg->err; -+ } while (!err -+ && au_ftest_rdu(cookie->flags, CALLED) -+ && !au_ftest_rdu(cookie->flags, FULL)); -+ cookie->h_pos = h_file->f_pos; -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+static int au_rdu(struct file *file, struct aufs_rdu *rdu) -+{ -+ int err; -+ aufs_bindex_t bbot; -+ struct au_rdu_arg arg = { -+ .ctx = { -+ .actor = au_rdu_fill -+ } -+ }; -+ struct dentry *dentry; -+ struct inode *inode; -+ struct file *h_file; -+ struct au_rdu_cookie *cookie = &rdu->cookie; -+ -+ err = !access_ok(VERIFY_WRITE, rdu->ent.e, rdu->sz); -+ if (unlikely(err)) { -+ err = -EFAULT; -+ AuTraceErr(err); -+ goto out; -+ } -+ rdu->rent = 0; -+ rdu->tail = rdu->ent; -+ rdu->full = 0; -+ arg.rdu = rdu; -+ arg.ent = rdu->ent; -+ arg.end = arg.ent.ul; -+ arg.end += rdu->sz; -+ -+ err = -ENOTDIR; -+ if (unlikely(!file->f_op->iterate && !file->f_op->iterate_shared)) -+ goto out; -+ -+ err = security_file_permission(file, MAY_READ); -+ AuTraceErr(err); -+ if (unlikely(err)) -+ goto out; -+ -+ dentry = file->f_path.dentry; -+ inode = d_inode(dentry); -+ inode_lock_shared(inode); -+ -+ arg.sb = inode->i_sb; -+ err = si_read_lock(arg.sb, AuLock_FLUSH | AuLock_NOPLM); -+ if (unlikely(err)) -+ goto out_mtx; -+ err = au_alive_dir(dentry); -+ if (unlikely(err)) -+ goto out_si; -+ /* todo: reval? */ -+ fi_read_lock(file); -+ -+ err = -EAGAIN; -+ if (unlikely(au_ftest_rdu(cookie->flags, CONT) -+ && cookie->generation != au_figen(file))) -+ goto out_unlock; -+ -+ err = 0; -+ if (!rdu->blk) { -+ rdu->blk = au_sbi(arg.sb)->si_rdblk; -+ if (!rdu->blk) -+ rdu->blk = au_dir_size(file, /*dentry*/NULL); -+ } -+ bbot = au_fbtop(file); -+ if (cookie->bindex < bbot) -+ cookie->bindex = bbot; -+ bbot = au_fbbot_dir(file); -+ /* AuDbg("b%d, b%d\n", cookie->bindex, bbot); */ -+ for (; !err && cookie->bindex <= bbot; -+ cookie->bindex++, cookie->h_pos = 0) { -+ h_file = au_hf_dir(file, cookie->bindex); -+ if (!h_file) -+ continue; -+ -+ au_fclr_rdu(cookie->flags, FULL); -+ err = au_rdu_do(h_file, &arg); -+ AuTraceErr(err); -+ if (unlikely(au_ftest_rdu(cookie->flags, FULL) || err)) -+ break; -+ } -+ AuDbg("rent %llu\n", rdu->rent); -+ -+ if (!err && !au_ftest_rdu(cookie->flags, CONT)) { -+ rdu->shwh = !!au_opt_test(au_sbi(arg.sb)->si_mntflags, SHWH); -+ au_fset_rdu(cookie->flags, CONT); -+ cookie->generation = au_figen(file); -+ } -+ -+ ii_read_lock_child(inode); -+ fsstack_copy_attr_atime(inode, au_h_iptr(inode, au_ibtop(inode))); -+ ii_read_unlock(inode); -+ -+out_unlock: -+ fi_read_unlock(file); -+out_si: -+ si_read_unlock(arg.sb); -+out_mtx: -+ inode_unlock_shared(inode); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+static int au_rdu_ino(struct file *file, struct aufs_rdu *rdu) -+{ -+ int err; -+ ino_t ino; -+ unsigned long long nent; -+ union au_rdu_ent_ul *u; -+ struct au_rdu_ent ent; -+ struct super_block *sb; -+ -+ err = 0; -+ nent = rdu->nent; -+ u = &rdu->ent; -+ sb = file->f_path.dentry->d_sb; -+ si_read_lock(sb, AuLock_FLUSH); -+ while (nent-- > 0) { -+ /* unnecessary to support mmap_sem since this is a dir */ -+ err = copy_from_user(&ent, u->e, sizeof(ent)); -+ if (!err) -+ err = !access_ok(VERIFY_WRITE, &u->e->ino, sizeof(ino)); -+ if (unlikely(err)) { -+ err = -EFAULT; -+ AuTraceErr(err); -+ break; -+ } -+ -+ /* AuDbg("b%d, i%llu\n", ent.bindex, ent.ino); */ -+ if (!ent.wh) -+ err = au_ino(sb, ent.bindex, ent.ino, ent.type, &ino); -+ else -+ err = au_wh_ino(sb, ent.bindex, ent.ino, ent.type, -+ &ino); -+ if (unlikely(err)) { -+ AuTraceErr(err); -+ break; -+ } -+ -+ err = __put_user(ino, &u->e->ino); -+ if (unlikely(err)) { -+ err = -EFAULT; -+ AuTraceErr(err); -+ break; -+ } -+ u->ul += au_rdu_len(ent.nlen); -+ } -+ si_read_unlock(sb); -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_rdu_verify(struct aufs_rdu *rdu) -+{ -+ AuDbg("rdu{%llu, %p, %u | %u | %llu, %u, %u | " -+ "%llu, b%d, 0x%x, g%u}\n", -+ rdu->sz, rdu->ent.e, rdu->verify[AufsCtlRduV_SZ], -+ rdu->blk, -+ rdu->rent, rdu->shwh, rdu->full, -+ rdu->cookie.h_pos, rdu->cookie.bindex, rdu->cookie.flags, -+ rdu->cookie.generation); -+ -+ if (rdu->verify[AufsCtlRduV_SZ] == sizeof(*rdu)) -+ return 0; -+ -+ AuDbg("%u:%u\n", -+ rdu->verify[AufsCtlRduV_SZ], (unsigned int)sizeof(*rdu)); -+ return -EINVAL; -+} -+ -+long au_rdu_ioctl(struct file *file, unsigned int cmd, unsigned long arg) -+{ -+ long err, e; -+ struct aufs_rdu rdu; -+ void __user *p = (void __user *)arg; -+ -+ err = copy_from_user(&rdu, p, sizeof(rdu)); -+ if (unlikely(err)) { -+ err = -EFAULT; -+ AuTraceErr(err); -+ goto out; -+ } -+ err = au_rdu_verify(&rdu); -+ if (unlikely(err)) -+ goto out; -+ -+ switch (cmd) { -+ case AUFS_CTL_RDU: -+ err = au_rdu(file, &rdu); -+ if (unlikely(err)) -+ break; -+ -+ e = copy_to_user(p, &rdu, sizeof(rdu)); -+ if (unlikely(e)) { -+ err = -EFAULT; -+ AuTraceErr(err); -+ } -+ break; -+ case AUFS_CTL_RDU_INO: -+ err = au_rdu_ino(file, &rdu); -+ break; -+ -+ default: -+ /* err = -ENOTTY; */ -+ err = -EINVAL; -+ } -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+#ifdef CONFIG_COMPAT -+long au_rdu_compat_ioctl(struct file *file, unsigned int cmd, unsigned long arg) -+{ -+ long err, e; -+ struct aufs_rdu rdu; -+ void __user *p = compat_ptr(arg); -+ -+ /* todo: get_user()? */ -+ err = copy_from_user(&rdu, p, sizeof(rdu)); -+ if (unlikely(err)) { -+ err = -EFAULT; -+ AuTraceErr(err); -+ goto out; -+ } -+ rdu.ent.e = compat_ptr(rdu.ent.ul); -+ err = au_rdu_verify(&rdu); -+ if (unlikely(err)) -+ goto out; -+ -+ switch (cmd) { -+ case AUFS_CTL_RDU: -+ err = au_rdu(file, &rdu); -+ if (unlikely(err)) -+ break; -+ -+ rdu.ent.ul = ptr_to_compat(rdu.ent.e); -+ rdu.tail.ul = ptr_to_compat(rdu.tail.e); -+ e = copy_to_user(p, &rdu, sizeof(rdu)); -+ if (unlikely(e)) { -+ err = -EFAULT; -+ AuTraceErr(err); -+ } -+ break; -+ case AUFS_CTL_RDU_INO: -+ err = au_rdu_ino(file, &rdu); -+ break; -+ -+ default: -+ /* err = -ENOTTY; */ -+ err = -EINVAL; -+ } -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+#endif -diff --git a/fs/aufs/rwsem.h b/fs/aufs/rwsem.h -new file mode 100644 -index 000000000000..8a3713b409cc ---- /dev/null -+++ b/fs/aufs/rwsem.h -@@ -0,0 +1,60 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * simple read-write semaphore wrappers -+ */ -+ -+#ifndef __AUFS_RWSEM_H__ -+#define __AUFS_RWSEM_H__ -+ -+#ifdef __KERNEL__ -+ -+#include "debug.h" -+ -+/* in the futre, the name 'au_rwsem' will be totally gone */ -+#define au_rwsem rw_semaphore -+ -+/* to debug easier, do not make them inlined functions */ -+#define AuRwMustNoWaiters(rw) AuDebugOn(rwsem_is_contended(rw)) -+/* rwsem_is_locked() is unusable */ -+#define AuRwMustReadLock(rw) AuDebugOn(!lockdep_recursing(current) \ -+ && debug_locks \ -+ && !lockdep_is_held_type(rw, 1)) -+#define AuRwMustWriteLock(rw) AuDebugOn(!lockdep_recursing(current) \ -+ && debug_locks \ -+ && !lockdep_is_held_type(rw, 0)) -+#define AuRwMustAnyLock(rw) AuDebugOn(!lockdep_recursing(current) \ -+ && debug_locks \ -+ && !lockdep_is_held(rw)) -+#define AuRwDestroy(rw) AuDebugOn(!lockdep_recursing(current) \ -+ && debug_locks \ -+ && lockdep_is_held(rw)) -+ -+#define au_rw_init(rw) init_rwsem(rw) -+ -+#define au_rw_init_wlock(rw) do { \ -+ au_rw_init(rw); \ -+ down_write(rw); \ -+ } while (0) -+ -+#define au_rw_init_wlock_nested(rw, lsc) do { \ -+ au_rw_init(rw); \ -+ down_write_nested(rw, lsc); \ -+ } while (0) -+ -+#define au_rw_read_lock(rw) down_read(rw) -+#define au_rw_read_lock_nested(rw, lsc) down_read_nested(rw, lsc) -+#define au_rw_read_unlock(rw) up_read(rw) -+#define au_rw_dgrade_lock(rw) downgrade_write(rw) -+#define au_rw_write_lock(rw) down_write(rw) -+#define au_rw_write_lock_nested(rw, lsc) down_write_nested(rw, lsc) -+#define au_rw_write_unlock(rw) up_write(rw) -+/* why is not _nested version defined? */ -+#define au_rw_read_trylock(rw) down_read_trylock(rw) -+#define au_rw_write_trylock(rw) down_write_trylock(rw) -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_RWSEM_H__ */ -diff --git a/fs/aufs/sbinfo.c b/fs/aufs/sbinfo.c -new file mode 100644 -index 000000000000..1d862c4e1105 ---- /dev/null -+++ b/fs/aufs/sbinfo.c -@@ -0,0 +1,292 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * superblock private data -+ */ -+ -+#include "aufs.h" -+ -+/* -+ * they are necessary regardless sysfs is disabled. -+ */ -+void au_si_free(struct kobject *kobj) -+{ -+ int i; -+ struct au_sbinfo *sbinfo; -+ char *locked __maybe_unused; /* debug only */ -+ -+ sbinfo = container_of(kobj, struct au_sbinfo, si_kobj); -+ for (i = 0; i < AuPlink_NHASH; i++) -+ AuDebugOn(!hlist_bl_empty(sbinfo->si_plink + i)); -+ AuDebugOn(atomic_read(&sbinfo->si_nowait.nw_len)); -+ -+ AuDebugOn(percpu_counter_sum(&sbinfo->si_ninodes)); -+ percpu_counter_destroy(&sbinfo->si_ninodes); -+ AuDebugOn(percpu_counter_sum(&sbinfo->si_nfiles)); -+ percpu_counter_destroy(&sbinfo->si_nfiles); -+ -+ au_rw_write_lock(&sbinfo->si_rwsem); -+ au_br_free(sbinfo); -+ au_rw_write_unlock(&sbinfo->si_rwsem); -+ -+ kfree(sbinfo->si_branch); -+ mutex_destroy(&sbinfo->si_xib_mtx); -+ AuRwDestroy(&sbinfo->si_rwsem); -+ -+ kfree(sbinfo); -+} -+ -+int au_si_alloc(struct super_block *sb) -+{ -+ int err, i; -+ struct au_sbinfo *sbinfo; -+ -+ err = -ENOMEM; -+ sbinfo = kzalloc(sizeof(*sbinfo), GFP_NOFS); -+ if (unlikely(!sbinfo)) -+ goto out; -+ -+ /* will be reallocated separately */ -+ sbinfo->si_branch = kzalloc(sizeof(*sbinfo->si_branch), GFP_NOFS); -+ if (unlikely(!sbinfo->si_branch)) -+ goto out_sbinfo; -+ -+ err = sysaufs_si_init(sbinfo); -+ if (unlikely(err)) -+ goto out_br; -+ -+ au_nwt_init(&sbinfo->si_nowait); -+ au_rw_init_wlock(&sbinfo->si_rwsem); -+ -+ percpu_counter_init(&sbinfo->si_ninodes, 0, GFP_NOFS); -+ percpu_counter_init(&sbinfo->si_nfiles, 0, GFP_NOFS); -+ -+ sbinfo->si_bbot = -1; -+ sbinfo->si_last_br_id = AUFS_BRANCH_MAX / 2; -+ -+ sbinfo->si_wbr_copyup = AuWbrCopyup_Def; -+ sbinfo->si_wbr_create = AuWbrCreate_Def; -+ sbinfo->si_wbr_copyup_ops = au_wbr_copyup_ops + sbinfo->si_wbr_copyup; -+ sbinfo->si_wbr_create_ops = au_wbr_create_ops + sbinfo->si_wbr_create; -+ -+ au_fhsm_init(sbinfo); -+ -+ sbinfo->si_mntflags = au_opts_plink(AuOpt_Def); -+ -+ sbinfo->si_xino_jiffy = jiffies; -+ sbinfo->si_xino_expire -+ = msecs_to_jiffies(AUFS_XINO_DEF_SEC * MSEC_PER_SEC); -+ mutex_init(&sbinfo->si_xib_mtx); -+ sbinfo->si_xino_brid = -1; -+ /* leave si_xib_last_pindex and si_xib_next_bit */ -+ -+ INIT_HLIST_BL_HEAD(&sbinfo->si_aopen); -+ -+ sbinfo->si_rdcache = msecs_to_jiffies(AUFS_RDCACHE_DEF * MSEC_PER_SEC); -+ sbinfo->si_rdblk = AUFS_RDBLK_DEF; -+ sbinfo->si_rdhash = AUFS_RDHASH_DEF; -+ sbinfo->si_dirwh = AUFS_DIRWH_DEF; -+ -+ for (i = 0; i < AuPlink_NHASH; i++) -+ INIT_HLIST_BL_HEAD(sbinfo->si_plink + i); -+ init_waitqueue_head(&sbinfo->si_plink_wq); -+ spin_lock_init(&sbinfo->si_plink_maint_lock); -+ -+ INIT_HLIST_BL_HEAD(&sbinfo->si_files); -+ -+ /* with getattr by default */ -+ sbinfo->si_iop_array = aufs_iop; -+ -+ /* leave other members for sysaufs and si_mnt. */ -+ sbinfo->si_sb = sb; -+ sb->s_fs_info = sbinfo; -+ si_pid_set(sb); -+ return 0; /* success */ -+ -+out_br: -+ kfree(sbinfo->si_branch); -+out_sbinfo: -+ kfree(sbinfo); -+out: -+ return err; -+} -+ -+int au_sbr_realloc(struct au_sbinfo *sbinfo, int nbr, int may_shrink) -+{ -+ int err, sz; -+ struct au_branch **brp; -+ -+ AuRwMustWriteLock(&sbinfo->si_rwsem); -+ -+ err = -ENOMEM; -+ sz = sizeof(*brp) * (sbinfo->si_bbot + 1); -+ if (unlikely(!sz)) -+ sz = sizeof(*brp); -+ brp = au_kzrealloc(sbinfo->si_branch, sz, sizeof(*brp) * nbr, GFP_NOFS, -+ may_shrink); -+ if (brp) { -+ sbinfo->si_branch = brp; -+ err = 0; -+ } -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+unsigned int au_sigen_inc(struct super_block *sb) -+{ -+ unsigned int gen; -+ struct inode *inode; -+ -+ SiMustWriteLock(sb); -+ -+ gen = ++au_sbi(sb)->si_generation; -+ au_update_digen(sb->s_root); -+ inode = d_inode(sb->s_root); -+ au_update_iigen(inode, /*half*/0); -+ inode->i_version++; -+ return gen; -+} -+ -+aufs_bindex_t au_new_br_id(struct super_block *sb) -+{ -+ aufs_bindex_t br_id; -+ int i; -+ struct au_sbinfo *sbinfo; -+ -+ SiMustWriteLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ for (i = 0; i <= AUFS_BRANCH_MAX; i++) { -+ br_id = ++sbinfo->si_last_br_id; -+ AuDebugOn(br_id < 0); -+ if (br_id && au_br_index(sb, br_id) < 0) -+ return br_id; -+ } -+ -+ return -1; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* it is ok that new 'nwt' tasks are appended while we are sleeping */ -+int si_read_lock(struct super_block *sb, int flags) -+{ -+ int err; -+ -+ err = 0; -+ if (au_ftest_lock(flags, FLUSH)) -+ au_nwt_flush(&au_sbi(sb)->si_nowait); -+ -+ si_noflush_read_lock(sb); -+ err = au_plink_maint(sb, flags); -+ if (unlikely(err)) -+ si_read_unlock(sb); -+ -+ return err; -+} -+ -+int si_write_lock(struct super_block *sb, int flags) -+{ -+ int err; -+ -+ if (au_ftest_lock(flags, FLUSH)) -+ au_nwt_flush(&au_sbi(sb)->si_nowait); -+ -+ si_noflush_write_lock(sb); -+ err = au_plink_maint(sb, flags); -+ if (unlikely(err)) -+ si_write_unlock(sb); -+ -+ return err; -+} -+ -+/* dentry and super_block lock. call at entry point */ -+int aufs_read_lock(struct dentry *dentry, int flags) -+{ -+ int err; -+ struct super_block *sb; -+ -+ sb = dentry->d_sb; -+ err = si_read_lock(sb, flags); -+ if (unlikely(err)) -+ goto out; -+ -+ if (au_ftest_lock(flags, DW)) -+ di_write_lock_child(dentry); -+ else -+ di_read_lock_child(dentry, flags); -+ -+ if (au_ftest_lock(flags, GEN)) { -+ err = au_digen_test(dentry, au_sigen(sb)); -+ if (!au_opt_test(au_mntflags(sb), UDBA_NONE)) -+ AuDebugOn(!err && au_dbrange_test(dentry)); -+ else if (!err) -+ err = au_dbrange_test(dentry); -+ if (unlikely(err)) -+ aufs_read_unlock(dentry, flags); -+ } -+ -+out: -+ return err; -+} -+ -+void aufs_read_unlock(struct dentry *dentry, int flags) -+{ -+ if (au_ftest_lock(flags, DW)) -+ di_write_unlock(dentry); -+ else -+ di_read_unlock(dentry, flags); -+ si_read_unlock(dentry->d_sb); -+} -+ -+void aufs_write_lock(struct dentry *dentry) -+{ -+ si_write_lock(dentry->d_sb, AuLock_FLUSH | AuLock_NOPLMW); -+ di_write_lock_child(dentry); -+} -+ -+void aufs_write_unlock(struct dentry *dentry) -+{ -+ di_write_unlock(dentry); -+ si_write_unlock(dentry->d_sb); -+} -+ -+int aufs_read_and_write_lock2(struct dentry *d1, struct dentry *d2, int flags) -+{ -+ int err; -+ unsigned int sigen; -+ struct super_block *sb; -+ -+ sb = d1->d_sb; -+ err = si_read_lock(sb, flags); -+ if (unlikely(err)) -+ goto out; -+ -+ di_write_lock2_child(d1, d2, au_ftest_lock(flags, DIRS)); -+ -+ if (au_ftest_lock(flags, GEN)) { -+ sigen = au_sigen(sb); -+ err = au_digen_test(d1, sigen); -+ AuDebugOn(!err && au_dbrange_test(d1)); -+ if (!err) { -+ err = au_digen_test(d2, sigen); -+ AuDebugOn(!err && au_dbrange_test(d2)); -+ } -+ if (unlikely(err)) -+ aufs_read_and_write_unlock2(d1, d2); -+ } -+ -+out: -+ return err; -+} -+ -+void aufs_read_and_write_unlock2(struct dentry *d1, struct dentry *d2) -+{ -+ di_write_unlock2(d1, d2); -+ si_read_unlock(d1->d_sb); -+} -diff --git a/fs/aufs/super.c b/fs/aufs/super.c -new file mode 100644 -index 000000000000..75c2e173fde1 ---- /dev/null -+++ b/fs/aufs/super.c -@@ -0,0 +1,1034 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * mount and super_block operations -+ */ -+ -+#include -+#include -+#include -+#include -+#include "aufs.h" -+ -+/* -+ * super_operations -+ */ -+static struct inode *aufs_alloc_inode(struct super_block *sb __maybe_unused) -+{ -+ struct au_icntnr *c; -+ -+ c = au_cache_alloc_icntnr(); -+ if (c) { -+ au_icntnr_init(c); -+ c->vfs_inode.i_version = 1; /* sigen(sb); */ -+ c->iinfo.ii_hinode = NULL; -+ return &c->vfs_inode; -+ } -+ return NULL; -+} -+ -+static void aufs_destroy_inode_cb(struct rcu_head *head) -+{ -+ struct inode *inode = container_of(head, struct inode, i_rcu); -+ -+ au_cache_free_icntnr(container_of(inode, struct au_icntnr, vfs_inode)); -+} -+ -+static void aufs_destroy_inode(struct inode *inode) -+{ -+ if (!au_is_bad_inode(inode)) -+ au_iinfo_fin(inode); -+ call_rcu(&inode->i_rcu, aufs_destroy_inode_cb); -+} -+ -+struct inode *au_iget_locked(struct super_block *sb, ino_t ino) -+{ -+ struct inode *inode; -+ int err; -+ -+ inode = iget_locked(sb, ino); -+ if (unlikely(!inode)) { -+ inode = ERR_PTR(-ENOMEM); -+ goto out; -+ } -+ if (!(inode->i_state & I_NEW)) -+ goto out; -+ -+ err = au_xigen_new(inode); -+ if (!err) -+ err = au_iinfo_init(inode); -+ if (!err) -+ inode->i_version++; -+ else { -+ iget_failed(inode); -+ inode = ERR_PTR(err); -+ } -+ -+out: -+ /* never return NULL */ -+ AuDebugOn(!inode); -+ AuTraceErrPtr(inode); -+ return inode; -+} -+ -+/* lock free root dinfo */ -+static int au_show_brs(struct seq_file *seq, struct super_block *sb) -+{ -+ int err; -+ aufs_bindex_t bindex, bbot; -+ struct path path; -+ struct au_hdentry *hdp; -+ struct au_branch *br; -+ au_br_perm_str_t perm; -+ -+ err = 0; -+ bbot = au_sbbot(sb); -+ bindex = 0; -+ hdp = au_hdentry(au_di(sb->s_root), bindex); -+ for (; !err && bindex <= bbot; bindex++, hdp++) { -+ br = au_sbr(sb, bindex); -+ path.mnt = au_br_mnt(br); -+ path.dentry = hdp->hd_dentry; -+ err = au_seq_path(seq, &path); -+ if (!err) { -+ au_optstr_br_perm(&perm, br->br_perm); -+ seq_printf(seq, "=%s", perm.a); -+ if (bindex != bbot) -+ seq_putc(seq, ':'); -+ } -+ } -+ if (unlikely(err || seq_has_overflowed(seq))) -+ err = -E2BIG; -+ -+ return err; -+} -+ -+static void au_gen_fmt(char *fmt, int len __maybe_unused, const char *pat, -+ const char *append) -+{ -+ char *p; -+ -+ p = fmt; -+ while (*pat != ':') -+ *p++ = *pat++; -+ *p++ = *pat++; -+ strcpy(p, append); -+ AuDebugOn(strlen(fmt) >= len); -+} -+ -+static void au_show_wbr_create(struct seq_file *m, int v, -+ struct au_sbinfo *sbinfo) -+{ -+ const char *pat; -+ char fmt[32]; -+ struct au_wbr_mfs *mfs; -+ -+ AuRwMustAnyLock(&sbinfo->si_rwsem); -+ -+ seq_puts(m, ",create="); -+ pat = au_optstr_wbr_create(v); -+ mfs = &sbinfo->si_wbr_mfs; -+ switch (v) { -+ case AuWbrCreate_TDP: -+ case AuWbrCreate_RR: -+ case AuWbrCreate_MFS: -+ case AuWbrCreate_PMFS: -+ seq_puts(m, pat); -+ break; -+ case AuWbrCreate_MFSRR: -+ case AuWbrCreate_TDMFS: -+ case AuWbrCreate_PMFSRR: -+ au_gen_fmt(fmt, sizeof(fmt), pat, "%llu"); -+ seq_printf(m, fmt, mfs->mfsrr_watermark); -+ break; -+ case AuWbrCreate_MFSV: -+ case AuWbrCreate_PMFSV: -+ au_gen_fmt(fmt, sizeof(fmt), pat, "%lu"); -+ seq_printf(m, fmt, -+ jiffies_to_msecs(mfs->mfs_expire) -+ / MSEC_PER_SEC); -+ break; -+ case AuWbrCreate_MFSRRV: -+ case AuWbrCreate_TDMFSV: -+ case AuWbrCreate_PMFSRRV: -+ au_gen_fmt(fmt, sizeof(fmt), pat, "%llu:%lu"); -+ seq_printf(m, fmt, mfs->mfsrr_watermark, -+ jiffies_to_msecs(mfs->mfs_expire) / MSEC_PER_SEC); -+ break; -+ default: -+ BUG(); -+ } -+} -+ -+static int au_show_xino(struct seq_file *seq, struct super_block *sb) -+{ -+#ifdef CONFIG_SYSFS -+ return 0; -+#else -+ int err; -+ const int len = sizeof(AUFS_XINO_FNAME) - 1; -+ aufs_bindex_t bindex, brid; -+ struct qstr *name; -+ struct file *f; -+ struct dentry *d, *h_root; -+ -+ AuRwMustAnyLock(&sbinfo->si_rwsem); -+ -+ err = 0; -+ f = au_sbi(sb)->si_xib; -+ if (!f) -+ goto out; -+ -+ /* stop printing the default xino path on the first writable branch */ -+ h_root = NULL; -+ brid = au_xino_brid(sb); -+ if (brid >= 0) { -+ bindex = au_br_index(sb, brid); -+ h_root = au_hdentry(au_di(sb->s_root), bindex)->hd_dentry; -+ } -+ d = f->f_path.dentry; -+ name = &d->d_name; -+ /* safe ->d_parent because the file is unlinked */ -+ if (d->d_parent == h_root -+ && name->len == len -+ && !memcmp(name->name, AUFS_XINO_FNAME, len)) -+ goto out; -+ -+ seq_puts(seq, ",xino="); -+ err = au_xino_path(seq, f); -+ -+out: -+ return err; -+#endif -+} -+ -+/* seq_file will re-call me in case of too long string */ -+static int aufs_show_options(struct seq_file *m, struct dentry *dentry) -+{ -+ int err; -+ unsigned int mnt_flags, v; -+ struct super_block *sb; -+ struct au_sbinfo *sbinfo; -+ -+#define AuBool(name, str) do { \ -+ v = au_opt_test(mnt_flags, name); \ -+ if (v != au_opt_test(AuOpt_Def, name)) \ -+ seq_printf(m, ",%s" #str, v ? "" : "no"); \ -+} while (0) -+ -+#define AuStr(name, str) do { \ -+ v = mnt_flags & AuOptMask_##name; \ -+ if (v != (AuOpt_Def & AuOptMask_##name)) \ -+ seq_printf(m, "," #str "=%s", au_optstr_##str(v)); \ -+} while (0) -+ -+#define AuUInt(name, str, val) do { \ -+ if (val != AUFS_##name##_DEF) \ -+ seq_printf(m, "," #str "=%u", val); \ -+} while (0) -+ -+ sb = dentry->d_sb; -+ if (sb->s_flags & MS_POSIXACL) -+ seq_puts(m, ",acl"); -+ -+ /* lock free root dinfo */ -+ si_noflush_read_lock(sb); -+ sbinfo = au_sbi(sb); -+ seq_printf(m, ",si=%lx", sysaufs_si_id(sbinfo)); -+ -+ mnt_flags = au_mntflags(sb); -+ if (au_opt_test(mnt_flags, XINO)) { -+ err = au_show_xino(m, sb); -+ if (unlikely(err)) -+ goto out; -+ } else -+ seq_puts(m, ",noxino"); -+ -+ AuBool(TRUNC_XINO, trunc_xino); -+ AuStr(UDBA, udba); -+ AuBool(SHWH, shwh); -+ AuBool(PLINK, plink); -+ AuBool(DIO, dio); -+ AuBool(DIRPERM1, dirperm1); -+ -+ v = sbinfo->si_wbr_create; -+ if (v != AuWbrCreate_Def) -+ au_show_wbr_create(m, v, sbinfo); -+ -+ v = sbinfo->si_wbr_copyup; -+ if (v != AuWbrCopyup_Def) -+ seq_printf(m, ",cpup=%s", au_optstr_wbr_copyup(v)); -+ -+ v = au_opt_test(mnt_flags, ALWAYS_DIROPQ); -+ if (v != au_opt_test(AuOpt_Def, ALWAYS_DIROPQ)) -+ seq_printf(m, ",diropq=%c", v ? 'a' : 'w'); -+ -+ AuUInt(DIRWH, dirwh, sbinfo->si_dirwh); -+ -+ v = jiffies_to_msecs(sbinfo->si_rdcache) / MSEC_PER_SEC; -+ AuUInt(RDCACHE, rdcache, v); -+ -+ AuUInt(RDBLK, rdblk, sbinfo->si_rdblk); -+ AuUInt(RDHASH, rdhash, sbinfo->si_rdhash); -+ -+ au_fhsm_show(m, sbinfo); -+ -+ AuBool(DIRREN, dirren); -+ AuBool(SUM, sum); -+ /* AuBool(SUM_W, wsum); */ -+ AuBool(WARN_PERM, warn_perm); -+ AuBool(VERBOSE, verbose); -+ -+out: -+ /* be sure to print "br:" last */ -+ if (!sysaufs_brs) { -+ seq_puts(m, ",br:"); -+ au_show_brs(m, sb); -+ } -+ si_read_unlock(sb); -+ return 0; -+ -+#undef AuBool -+#undef AuStr -+#undef AuUInt -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* sum mode which returns the summation for statfs(2) */ -+ -+static u64 au_add_till_max(u64 a, u64 b) -+{ -+ u64 old; -+ -+ old = a; -+ a += b; -+ if (old <= a) -+ return a; -+ return ULLONG_MAX; -+} -+ -+static u64 au_mul_till_max(u64 a, long mul) -+{ -+ u64 old; -+ -+ old = a; -+ a *= mul; -+ if (old <= a) -+ return a; -+ return ULLONG_MAX; -+} -+ -+static int au_statfs_sum(struct super_block *sb, struct kstatfs *buf) -+{ -+ int err; -+ long bsize, factor; -+ u64 blocks, bfree, bavail, files, ffree; -+ aufs_bindex_t bbot, bindex, i; -+ unsigned char shared; -+ struct path h_path; -+ struct super_block *h_sb; -+ -+ err = 0; -+ bsize = LONG_MAX; -+ files = 0; -+ ffree = 0; -+ blocks = 0; -+ bfree = 0; -+ bavail = 0; -+ bbot = au_sbbot(sb); -+ for (bindex = 0; bindex <= bbot; bindex++) { -+ h_path.mnt = au_sbr_mnt(sb, bindex); -+ h_sb = h_path.mnt->mnt_sb; -+ shared = 0; -+ for (i = 0; !shared && i < bindex; i++) -+ shared = (au_sbr_sb(sb, i) == h_sb); -+ if (shared) -+ continue; -+ -+ /* sb->s_root for NFS is unreliable */ -+ h_path.dentry = h_path.mnt->mnt_root; -+ err = vfs_statfs(&h_path, buf); -+ if (unlikely(err)) -+ goto out; -+ -+ if (bsize > buf->f_bsize) { -+ /* -+ * we will reduce bsize, so we have to expand blocks -+ * etc. to match them again -+ */ -+ factor = (bsize / buf->f_bsize); -+ blocks = au_mul_till_max(blocks, factor); -+ bfree = au_mul_till_max(bfree, factor); -+ bavail = au_mul_till_max(bavail, factor); -+ bsize = buf->f_bsize; -+ } -+ -+ factor = (buf->f_bsize / bsize); -+ blocks = au_add_till_max(blocks, -+ au_mul_till_max(buf->f_blocks, factor)); -+ bfree = au_add_till_max(bfree, -+ au_mul_till_max(buf->f_bfree, factor)); -+ bavail = au_add_till_max(bavail, -+ au_mul_till_max(buf->f_bavail, factor)); -+ files = au_add_till_max(files, buf->f_files); -+ ffree = au_add_till_max(ffree, buf->f_ffree); -+ } -+ -+ buf->f_bsize = bsize; -+ buf->f_blocks = blocks; -+ buf->f_bfree = bfree; -+ buf->f_bavail = bavail; -+ buf->f_files = files; -+ buf->f_ffree = ffree; -+ buf->f_frsize = 0; -+ -+out: -+ return err; -+} -+ -+static int aufs_statfs(struct dentry *dentry, struct kstatfs *buf) -+{ -+ int err; -+ struct path h_path; -+ struct super_block *sb; -+ -+ /* lock free root dinfo */ -+ sb = dentry->d_sb; -+ si_noflush_read_lock(sb); -+ if (!au_opt_test(au_mntflags(sb), SUM)) { -+ /* sb->s_root for NFS is unreliable */ -+ h_path.mnt = au_sbr_mnt(sb, 0); -+ h_path.dentry = h_path.mnt->mnt_root; -+ err = vfs_statfs(&h_path, buf); -+ } else -+ err = au_statfs_sum(sb, buf); -+ si_read_unlock(sb); -+ -+ if (!err) { -+ buf->f_type = AUFS_SUPER_MAGIC; -+ buf->f_namelen = AUFS_MAX_NAMELEN; -+ memset(&buf->f_fsid, 0, sizeof(buf->f_fsid)); -+ } -+ /* buf->f_bsize = buf->f_blocks = buf->f_bfree = buf->f_bavail = -1; */ -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int aufs_sync_fs(struct super_block *sb, int wait) -+{ -+ int err, e; -+ aufs_bindex_t bbot, bindex; -+ struct au_branch *br; -+ struct super_block *h_sb; -+ -+ err = 0; -+ si_noflush_read_lock(sb); -+ bbot = au_sbbot(sb); -+ for (bindex = 0; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ if (!au_br_writable(br->br_perm)) -+ continue; -+ -+ h_sb = au_sbr_sb(sb, bindex); -+ e = vfsub_sync_filesystem(h_sb, wait); -+ if (unlikely(e && !err)) -+ err = e; -+ /* go on even if an error happens */ -+ } -+ si_read_unlock(sb); -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* final actions when unmounting a file system */ -+static void aufs_put_super(struct super_block *sb) -+{ -+ struct au_sbinfo *sbinfo; -+ -+ sbinfo = au_sbi(sb); -+ if (!sbinfo) -+ return; -+ -+ dbgaufs_si_fin(sbinfo); -+ kobject_put(&sbinfo->si_kobj); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void *au_array_alloc(unsigned long long *hint, au_arraycb_t cb, -+ struct super_block *sb, void *arg) -+{ -+ void *array; -+ unsigned long long n, sz; -+ -+ array = NULL; -+ n = 0; -+ if (!*hint) -+ goto out; -+ -+ if (*hint > ULLONG_MAX / sizeof(array)) { -+ array = ERR_PTR(-EMFILE); -+ pr_err("hint %llu\n", *hint); -+ goto out; -+ } -+ -+ sz = sizeof(array) * *hint; -+ array = kzalloc(sz, GFP_NOFS); -+ if (unlikely(!array)) -+ array = vzalloc(sz); -+ if (unlikely(!array)) { -+ array = ERR_PTR(-ENOMEM); -+ goto out; -+ } -+ -+ n = cb(sb, array, *hint, arg); -+ AuDebugOn(n > *hint); -+ -+out: -+ *hint = n; -+ return array; -+} -+ -+static unsigned long long au_iarray_cb(struct super_block *sb, void *a, -+ unsigned long long max __maybe_unused, -+ void *arg) -+{ -+ unsigned long long n; -+ struct inode **p, *inode; -+ struct list_head *head; -+ -+ n = 0; -+ p = a; -+ head = arg; -+ spin_lock(&sb->s_inode_list_lock); -+ list_for_each_entry(inode, head, i_sb_list) { -+ if (!au_is_bad_inode(inode) -+ && au_ii(inode)->ii_btop >= 0) { -+ spin_lock(&inode->i_lock); -+ if (atomic_read(&inode->i_count)) { -+ au_igrab(inode); -+ *p++ = inode; -+ n++; -+ AuDebugOn(n > max); -+ } -+ spin_unlock(&inode->i_lock); -+ } -+ } -+ spin_unlock(&sb->s_inode_list_lock); -+ -+ return n; -+} -+ -+struct inode **au_iarray_alloc(struct super_block *sb, unsigned long long *max) -+{ -+ *max = au_ninodes(sb); -+ return au_array_alloc(max, au_iarray_cb, sb, &sb->s_inodes); -+} -+ -+void au_iarray_free(struct inode **a, unsigned long long max) -+{ -+ unsigned long long ull; -+ -+ for (ull = 0; ull < max; ull++) -+ iput(a[ull]); -+ kvfree(a); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * refresh dentry and inode at remount time. -+ */ -+/* todo: consolidate with simple_reval_dpath() and au_reval_for_attr() */ -+static int au_do_refresh(struct dentry *dentry, unsigned int dir_flags, -+ struct dentry *parent) -+{ -+ int err; -+ -+ di_write_lock_child(dentry); -+ di_read_lock_parent(parent, AuLock_IR); -+ err = au_refresh_dentry(dentry, parent); -+ if (!err && dir_flags) -+ au_hn_reset(d_inode(dentry), dir_flags); -+ di_read_unlock(parent, AuLock_IR); -+ di_write_unlock(dentry); -+ -+ return err; -+} -+ -+static int au_do_refresh_d(struct dentry *dentry, unsigned int sigen, -+ struct au_sbinfo *sbinfo, -+ const unsigned int dir_flags, unsigned int do_idop) -+{ -+ int err; -+ struct dentry *parent; -+ -+ err = 0; -+ parent = dget_parent(dentry); -+ if (!au_digen_test(parent, sigen) && au_digen_test(dentry, sigen)) { -+ if (d_really_is_positive(dentry)) { -+ if (!d_is_dir(dentry)) -+ err = au_do_refresh(dentry, /*dir_flags*/0, -+ parent); -+ else { -+ err = au_do_refresh(dentry, dir_flags, parent); -+ if (unlikely(err)) -+ au_fset_si(sbinfo, FAILED_REFRESH_DIR); -+ } -+ } else -+ err = au_do_refresh(dentry, /*dir_flags*/0, parent); -+ AuDbgDentry(dentry); -+ } -+ dput(parent); -+ -+ if (!err) { -+ if (do_idop) -+ au_refresh_dop(dentry, /*force_reval*/0); -+ } else -+ au_refresh_dop(dentry, /*force_reval*/1); -+ -+ AuTraceErr(err); -+ return err; -+} -+ -+static int au_refresh_d(struct super_block *sb, unsigned int do_idop) -+{ -+ int err, i, j, ndentry, e; -+ unsigned int sigen; -+ struct au_dcsub_pages dpages; -+ struct au_dpage *dpage; -+ struct dentry **dentries, *d; -+ struct au_sbinfo *sbinfo; -+ struct dentry *root = sb->s_root; -+ const unsigned int dir_flags = au_hi_flags(d_inode(root), /*isdir*/1); -+ -+ if (do_idop) -+ au_refresh_dop(root, /*force_reval*/0); -+ -+ err = au_dpages_init(&dpages, GFP_NOFS); -+ if (unlikely(err)) -+ goto out; -+ err = au_dcsub_pages(&dpages, root, NULL, NULL); -+ if (unlikely(err)) -+ goto out_dpages; -+ -+ sigen = au_sigen(sb); -+ sbinfo = au_sbi(sb); -+ for (i = 0; i < dpages.ndpage; i++) { -+ dpage = dpages.dpages + i; -+ dentries = dpage->dentries; -+ ndentry = dpage->ndentry; -+ for (j = 0; j < ndentry; j++) { -+ d = dentries[j]; -+ e = au_do_refresh_d(d, sigen, sbinfo, dir_flags, -+ do_idop); -+ if (unlikely(e && !err)) -+ err = e; -+ /* go on even err */ -+ } -+ } -+ -+out_dpages: -+ au_dpages_free(&dpages); -+out: -+ return err; -+} -+ -+static int au_refresh_i(struct super_block *sb, unsigned int do_idop) -+{ -+ int err, e; -+ unsigned int sigen; -+ unsigned long long max, ull; -+ struct inode *inode, **array; -+ -+ array = au_iarray_alloc(sb, &max); -+ err = PTR_ERR(array); -+ if (IS_ERR(array)) -+ goto out; -+ -+ err = 0; -+ sigen = au_sigen(sb); -+ for (ull = 0; ull < max; ull++) { -+ inode = array[ull]; -+ if (unlikely(!inode)) -+ break; -+ -+ e = 0; -+ ii_write_lock_child(inode); -+ if (au_iigen(inode, NULL) != sigen) { -+ e = au_refresh_hinode_self(inode); -+ if (unlikely(e)) { -+ au_refresh_iop(inode, /*force_getattr*/1); -+ pr_err("error %d, i%lu\n", e, inode->i_ino); -+ if (!err) -+ err = e; -+ /* go on even if err */ -+ } -+ } -+ if (!e && do_idop) -+ au_refresh_iop(inode, /*force_getattr*/0); -+ ii_write_unlock(inode); -+ } -+ -+ au_iarray_free(array, max); -+ -+out: -+ return err; -+} -+ -+static void au_remount_refresh(struct super_block *sb, unsigned int do_idop) -+{ -+ int err, e; -+ unsigned int udba; -+ aufs_bindex_t bindex, bbot; -+ struct dentry *root; -+ struct inode *inode; -+ struct au_branch *br; -+ struct au_sbinfo *sbi; -+ -+ au_sigen_inc(sb); -+ sbi = au_sbi(sb); -+ au_fclr_si(sbi, FAILED_REFRESH_DIR); -+ -+ root = sb->s_root; -+ DiMustNoWaiters(root); -+ inode = d_inode(root); -+ IiMustNoWaiters(inode); -+ -+ udba = au_opt_udba(sb); -+ bbot = au_sbbot(sb); -+ for (bindex = 0; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ err = au_hnotify_reset_br(udba, br, br->br_perm); -+ if (unlikely(err)) -+ AuIOErr("hnotify failed on br %d, %d, ignored\n", -+ bindex, err); -+ /* go on even if err */ -+ } -+ au_hn_reset(inode, au_hi_flags(inode, /*isdir*/1)); -+ -+ if (do_idop) { -+ if (au_ftest_si(sbi, NO_DREVAL)) { -+ AuDebugOn(sb->s_d_op == &aufs_dop_noreval); -+ sb->s_d_op = &aufs_dop_noreval; -+ AuDebugOn(sbi->si_iop_array == aufs_iop_nogetattr); -+ sbi->si_iop_array = aufs_iop_nogetattr; -+ } else { -+ AuDebugOn(sb->s_d_op == &aufs_dop); -+ sb->s_d_op = &aufs_dop; -+ AuDebugOn(sbi->si_iop_array == aufs_iop); -+ sbi->si_iop_array = aufs_iop; -+ } -+ pr_info("reset to %pf and %pf\n", -+ sb->s_d_op, sbi->si_iop_array); -+ } -+ -+ di_write_unlock(root); -+ err = au_refresh_d(sb, do_idop); -+ e = au_refresh_i(sb, do_idop); -+ if (unlikely(e && !err)) -+ err = e; -+ /* aufs_write_lock() calls ..._child() */ -+ di_write_lock_child(root); -+ -+ au_cpup_attr_all(inode, /*force*/1); -+ -+ if (unlikely(err)) -+ AuIOErr("refresh failed, ignored, %d\n", err); -+} -+ -+/* stop extra interpretation of errno in mount(8), and strange error messages */ -+static int cvt_err(int err) -+{ -+ AuTraceErr(err); -+ -+ switch (err) { -+ case -ENOENT: -+ case -ENOTDIR: -+ case -EEXIST: -+ case -EIO: -+ err = -EINVAL; -+ } -+ return err; -+} -+ -+static int aufs_remount_fs(struct super_block *sb, int *flags, char *data) -+{ -+ int err, do_dx; -+ unsigned int mntflags; -+ struct au_opts opts = { -+ .opt = NULL -+ }; -+ struct dentry *root; -+ struct inode *inode; -+ struct au_sbinfo *sbinfo; -+ -+ err = 0; -+ root = sb->s_root; -+ if (!data || !*data) { -+ err = si_write_lock(sb, AuLock_FLUSH | AuLock_NOPLM); -+ if (!err) { -+ di_write_lock_child(root); -+ err = au_opts_verify(sb, *flags, /*pending*/0); -+ aufs_write_unlock(root); -+ } -+ goto out; -+ } -+ -+ err = -ENOMEM; -+ opts.opt = (void *)__get_free_page(GFP_NOFS); -+ if (unlikely(!opts.opt)) -+ goto out; -+ opts.max_opt = PAGE_SIZE / sizeof(*opts.opt); -+ opts.flags = AuOpts_REMOUNT; -+ opts.sb_flags = *flags; -+ -+ /* parse it before aufs lock */ -+ err = au_opts_parse(sb, data, &opts); -+ if (unlikely(err)) -+ goto out_opts; -+ -+ sbinfo = au_sbi(sb); -+ inode = d_inode(root); -+ inode_lock(inode); -+ err = si_write_lock(sb, AuLock_FLUSH | AuLock_NOPLM); -+ if (unlikely(err)) -+ goto out_mtx; -+ di_write_lock_child(root); -+ -+ /* au_opts_remount() may return an error */ -+ err = au_opts_remount(sb, &opts); -+ au_opts_free(&opts); -+ -+ if (au_ftest_opts(opts.flags, REFRESH)) -+ au_remount_refresh(sb, au_ftest_opts(opts.flags, REFRESH_IDOP)); -+ -+ if (au_ftest_opts(opts.flags, REFRESH_DYAOP)) { -+ mntflags = au_mntflags(sb); -+ do_dx = !!au_opt_test(mntflags, DIO); -+ au_dy_arefresh(do_dx); -+ } -+ -+ au_fhsm_wrote_all(sb, /*force*/1); /* ?? */ -+ aufs_write_unlock(root); -+ -+out_mtx: -+ inode_unlock(inode); -+out_opts: -+ free_page((unsigned long)opts.opt); -+out: -+ err = cvt_err(err); -+ AuTraceErr(err); -+ return err; -+} -+ -+static const struct super_operations aufs_sop = { -+ .alloc_inode = aufs_alloc_inode, -+ .destroy_inode = aufs_destroy_inode, -+ /* always deleting, no clearing */ -+ .drop_inode = generic_delete_inode, -+ .show_options = aufs_show_options, -+ .statfs = aufs_statfs, -+ .put_super = aufs_put_super, -+ .sync_fs = aufs_sync_fs, -+ .remount_fs = aufs_remount_fs -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int alloc_root(struct super_block *sb) -+{ -+ int err; -+ struct inode *inode; -+ struct dentry *root; -+ -+ err = -ENOMEM; -+ inode = au_iget_locked(sb, AUFS_ROOT_INO); -+ err = PTR_ERR(inode); -+ if (IS_ERR(inode)) -+ goto out; -+ -+ inode->i_op = aufs_iop + AuIop_DIR; /* with getattr by default */ -+ inode->i_fop = &aufs_dir_fop; -+ inode->i_mode = S_IFDIR; -+ set_nlink(inode, 2); -+ unlock_new_inode(inode); -+ -+ root = d_make_root(inode); -+ if (unlikely(!root)) -+ goto out; -+ err = PTR_ERR(root); -+ if (IS_ERR(root)) -+ goto out; -+ -+ err = au_di_init(root); -+ if (!err) { -+ sb->s_root = root; -+ return 0; /* success */ -+ } -+ dput(root); -+ -+out: -+ return err; -+} -+ -+static int aufs_fill_super(struct super_block *sb, void *raw_data, -+ int silent __maybe_unused) -+{ -+ int err; -+ struct au_opts opts = { -+ .opt = NULL -+ }; -+ struct au_sbinfo *sbinfo; -+ struct dentry *root; -+ struct inode *inode; -+ char *arg = raw_data; -+ -+ if (unlikely(!arg || !*arg)) { -+ err = -EINVAL; -+ pr_err("no arg\n"); -+ goto out; -+ } -+ -+ err = -ENOMEM; -+ opts.opt = (void *)__get_free_page(GFP_NOFS); -+ if (unlikely(!opts.opt)) -+ goto out; -+ opts.max_opt = PAGE_SIZE / sizeof(*opts.opt); -+ opts.sb_flags = sb->s_flags; -+ -+ err = au_si_alloc(sb); -+ if (unlikely(err)) -+ goto out_opts; -+ sbinfo = au_sbi(sb); -+ -+ /* all timestamps always follow the ones on the branch */ -+ sb->s_flags |= MS_NOATIME | MS_NODIRATIME; -+ sb->s_op = &aufs_sop; -+ sb->s_d_op = &aufs_dop; -+ sb->s_magic = AUFS_SUPER_MAGIC; -+ sb->s_maxbytes = 0; -+ sb->s_stack_depth = 1; -+ au_export_init(sb); -+ au_xattr_init(sb); -+ -+ err = alloc_root(sb); -+ if (unlikely(err)) { -+ si_write_unlock(sb); -+ goto out_info; -+ } -+ root = sb->s_root; -+ inode = d_inode(root); -+ -+ /* -+ * actually we can parse options regardless aufs lock here. -+ * but at remount time, parsing must be done before aufs lock. -+ * so we follow the same rule. -+ */ -+ ii_write_lock_parent(inode); -+ aufs_write_unlock(root); -+ err = au_opts_parse(sb, arg, &opts); -+ if (unlikely(err)) -+ goto out_root; -+ -+ /* lock vfs_inode first, then aufs. */ -+ inode_lock(inode); -+ aufs_write_lock(root); -+ err = au_opts_mount(sb, &opts); -+ au_opts_free(&opts); -+ if (!err && au_ftest_si(sbinfo, NO_DREVAL)) { -+ sb->s_d_op = &aufs_dop_noreval; -+ pr_info("%pf\n", sb->s_d_op); -+ au_refresh_dop(root, /*force_reval*/0); -+ sbinfo->si_iop_array = aufs_iop_nogetattr; -+ au_refresh_iop(inode, /*force_getattr*/0); -+ } -+ aufs_write_unlock(root); -+ inode_unlock(inode); -+ if (!err) -+ goto out_opts; /* success */ -+ -+out_root: -+ dput(root); -+ sb->s_root = NULL; -+out_info: -+ dbgaufs_si_fin(sbinfo); -+ kobject_put(&sbinfo->si_kobj); -+ sb->s_fs_info = NULL; -+out_opts: -+ free_page((unsigned long)opts.opt); -+out: -+ AuTraceErr(err); -+ err = cvt_err(err); -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static struct dentry *aufs_mount(struct file_system_type *fs_type, int flags, -+ const char *dev_name __maybe_unused, -+ void *raw_data) -+{ -+ struct dentry *root; -+ struct super_block *sb; -+ -+ /* all timestamps always follow the ones on the branch */ -+ /* mnt->mnt_flags |= MNT_NOATIME | MNT_NODIRATIME; */ -+ root = mount_nodev(fs_type, flags, raw_data, aufs_fill_super); -+ if (IS_ERR(root)) -+ goto out; -+ -+ sb = root->d_sb; -+ si_write_lock(sb, !AuLock_FLUSH); -+ sysaufs_brs_add(sb, 0); -+ si_write_unlock(sb); -+ au_sbilist_add(sb); -+ -+out: -+ return root; -+} -+ -+static void aufs_kill_sb(struct super_block *sb) -+{ -+ struct au_sbinfo *sbinfo; -+ -+ sbinfo = au_sbi(sb); -+ if (sbinfo) { -+ au_sbilist_del(sb); -+ aufs_write_lock(sb->s_root); -+ au_fhsm_fin(sb); -+ if (sbinfo->si_wbr_create_ops->fin) -+ sbinfo->si_wbr_create_ops->fin(sb); -+ if (au_opt_test(sbinfo->si_mntflags, UDBA_HNOTIFY)) { -+ au_opt_set_udba(sbinfo->si_mntflags, UDBA_NONE); -+ au_remount_refresh(sb, /*do_idop*/0); -+ } -+ if (au_opt_test(sbinfo->si_mntflags, PLINK)) -+ au_plink_put(sb, /*verbose*/1); -+ au_xino_clr(sb); -+ au_dr_opt_flush(sb); -+ sbinfo->si_sb = NULL; -+ aufs_write_unlock(sb->s_root); -+ au_nwt_flush(&sbinfo->si_nowait); -+ } -+ kill_anon_super(sb); -+} -+ -+struct file_system_type aufs_fs_type = { -+ .name = AUFS_FSTYPE, -+ /* a race between rename and others */ -+ .fs_flags = FS_RENAME_DOES_D_MOVE, -+ .mount = aufs_mount, -+ .kill_sb = aufs_kill_sb, -+ /* no need to __module_get() and module_put(). */ -+ .owner = THIS_MODULE, -+}; -diff --git a/fs/aufs/super.h b/fs/aufs/super.h -new file mode 100644 -index 000000000000..9562f4debe9f ---- /dev/null -+++ b/fs/aufs/super.h -@@ -0,0 +1,614 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * super_block operations -+ */ -+ -+#ifndef __AUFS_SUPER_H__ -+#define __AUFS_SUPER_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+#include -+#include "hbl.h" -+#include "rwsem.h" -+#include "wkq.h" -+ -+/* policies to select one among multiple writable branches */ -+struct au_wbr_copyup_operations { -+ int (*copyup)(struct dentry *dentry); -+}; -+ -+#define AuWbr_DIR 1 /* target is a dir */ -+#define AuWbr_PARENT (1 << 1) /* always require a parent */ -+ -+#define au_ftest_wbr(flags, name) ((flags) & AuWbr_##name) -+#define au_fset_wbr(flags, name) { (flags) |= AuWbr_##name; } -+#define au_fclr_wbr(flags, name) { (flags) &= ~AuWbr_##name; } -+ -+struct au_wbr_create_operations { -+ int (*create)(struct dentry *dentry, unsigned int flags); -+ int (*init)(struct super_block *sb); -+ int (*fin)(struct super_block *sb); -+}; -+ -+struct au_wbr_mfs { -+ struct mutex mfs_lock; /* protect this structure */ -+ unsigned long mfs_jiffy; -+ unsigned long mfs_expire; -+ aufs_bindex_t mfs_bindex; -+ -+ unsigned long long mfsrr_bytes; -+ unsigned long long mfsrr_watermark; -+}; -+ -+#define AuPlink_NHASH 100 -+static inline int au_plink_hash(ino_t ino) -+{ -+ return ino % AuPlink_NHASH; -+} -+ -+/* File-based Hierarchical Storage Management */ -+struct au_fhsm { -+#ifdef CONFIG_AUFS_FHSM -+ /* allow only one process who can receive the notification */ -+ spinlock_t fhsm_spin; -+ pid_t fhsm_pid; -+ wait_queue_head_t fhsm_wqh; -+ atomic_t fhsm_readable; -+ -+ /* these are protected by si_rwsem */ -+ unsigned long fhsm_expire; -+ aufs_bindex_t fhsm_bottom; -+#endif -+}; -+ -+struct au_branch; -+struct au_sbinfo { -+ /* nowait tasks in the system-wide workqueue */ -+ struct au_nowait_tasks si_nowait; -+ -+ /* -+ * tried sb->s_umount, but failed due to the dependecy between i_mutex. -+ * rwsem for au_sbinfo is necessary. -+ */ -+ struct au_rwsem si_rwsem; -+ -+ /* -+ * dirty approach to protect sb->sb_inodes and ->s_files (gone) from -+ * remount. -+ */ -+ struct percpu_counter si_ninodes, si_nfiles; -+ -+ /* branch management */ -+ unsigned int si_generation; -+ -+ /* see AuSi_ flags */ -+ unsigned char au_si_status; -+ -+ aufs_bindex_t si_bbot; -+ -+ /* dirty trick to keep br_id plus */ -+ unsigned int si_last_br_id : -+ sizeof(aufs_bindex_t) * BITS_PER_BYTE - 1; -+ struct au_branch **si_branch; -+ -+ /* policy to select a writable branch */ -+ unsigned char si_wbr_copyup; -+ unsigned char si_wbr_create; -+ struct au_wbr_copyup_operations *si_wbr_copyup_ops; -+ struct au_wbr_create_operations *si_wbr_create_ops; -+ -+ /* round robin */ -+ atomic_t si_wbr_rr_next; -+ -+ /* most free space */ -+ struct au_wbr_mfs si_wbr_mfs; -+ -+ /* File-based Hierarchical Storage Management */ -+ struct au_fhsm si_fhsm; -+ -+ /* mount flags */ -+ /* include/asm-ia64/siginfo.h defines a macro named si_flags */ -+ unsigned int si_mntflags; -+ -+ /* external inode number (bitmap and translation table) */ -+ vfs_readf_t si_xread; -+ vfs_writef_t si_xwrite; -+ struct file *si_xib; -+ struct mutex si_xib_mtx; /* protect xib members */ -+ unsigned long *si_xib_buf; -+ unsigned long si_xib_last_pindex; -+ int si_xib_next_bit; -+ aufs_bindex_t si_xino_brid; -+ unsigned long si_xino_jiffy; -+ unsigned long si_xino_expire; -+ /* reserved for future use */ -+ /* unsigned long long si_xib_limit; */ /* Max xib file size */ -+ -+#ifdef CONFIG_AUFS_EXPORT -+ /* i_generation */ -+ struct file *si_xigen; -+ atomic_t si_xigen_next; -+#endif -+ -+ /* dirty trick to suppoer atomic_open */ -+ struct hlist_bl_head si_aopen; -+ -+ /* vdir parameters */ -+ unsigned long si_rdcache; /* max cache time in jiffies */ -+ unsigned int si_rdblk; /* deblk size */ -+ unsigned int si_rdhash; /* hash size */ -+ -+ /* -+ * If the number of whiteouts are larger than si_dirwh, leave all of -+ * them after au_whtmp_ren to reduce the cost of rmdir(2). -+ * future fsck.aufs or kernel thread will remove them later. -+ * Otherwise, remove all whiteouts and the dir in rmdir(2). -+ */ -+ unsigned int si_dirwh; -+ -+ /* pseudo_link list */ -+ struct hlist_bl_head si_plink[AuPlink_NHASH]; -+ wait_queue_head_t si_plink_wq; -+ spinlock_t si_plink_maint_lock; -+ pid_t si_plink_maint_pid; -+ -+ /* file list */ -+ struct hlist_bl_head si_files; -+ -+ /* with/without getattr, brother of sb->s_d_op */ -+ struct inode_operations *si_iop_array; -+ -+ /* -+ * sysfs and lifetime management. -+ * this is not a small structure and it may be a waste of memory in case -+ * of sysfs is disabled, particulary when many aufs-es are mounted. -+ * but using sysfs is majority. -+ */ -+ struct kobject si_kobj; -+#ifdef CONFIG_DEBUG_FS -+ struct dentry *si_dbgaufs; -+ struct dentry *si_dbgaufs_plink; -+ struct dentry *si_dbgaufs_xib; -+#ifdef CONFIG_AUFS_EXPORT -+ struct dentry *si_dbgaufs_xigen; -+#endif -+#endif -+ -+#ifdef CONFIG_AUFS_SBILIST -+ struct hlist_bl_node si_list; -+#endif -+ -+ /* dirty, necessary for unmounting, sysfs and sysrq */ -+ struct super_block *si_sb; -+}; -+ -+/* sbinfo status flags */ -+/* -+ * set true when refresh_dirs() failed at remount time. -+ * then try refreshing dirs at access time again. -+ * if it is false, refreshing dirs at access time is unnecesary -+ */ -+#define AuSi_FAILED_REFRESH_DIR 1 -+#define AuSi_FHSM (1 << 1) /* fhsm is active now */ -+#define AuSi_NO_DREVAL (1 << 2) /* disable all d_revalidate */ -+ -+#ifndef CONFIG_AUFS_FHSM -+#undef AuSi_FHSM -+#define AuSi_FHSM 0 -+#endif -+ -+static inline unsigned char au_do_ftest_si(struct au_sbinfo *sbi, -+ unsigned int flag) -+{ -+ AuRwMustAnyLock(&sbi->si_rwsem); -+ return sbi->au_si_status & flag; -+} -+#define au_ftest_si(sbinfo, name) au_do_ftest_si(sbinfo, AuSi_##name) -+#define au_fset_si(sbinfo, name) do { \ -+ AuRwMustWriteLock(&(sbinfo)->si_rwsem); \ -+ (sbinfo)->au_si_status |= AuSi_##name; \ -+} while (0) -+#define au_fclr_si(sbinfo, name) do { \ -+ AuRwMustWriteLock(&(sbinfo)->si_rwsem); \ -+ (sbinfo)->au_si_status &= ~AuSi_##name; \ -+} while (0) -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* policy to select one among writable branches */ -+#define AuWbrCopyup(sbinfo, ...) \ -+ ((sbinfo)->si_wbr_copyup_ops->copyup(__VA_ARGS__)) -+#define AuWbrCreate(sbinfo, ...) \ -+ ((sbinfo)->si_wbr_create_ops->create(__VA_ARGS__)) -+ -+/* flags for si_read_lock()/aufs_read_lock()/di_read_lock() */ -+#define AuLock_DW 1 /* write-lock dentry */ -+#define AuLock_IR (1 << 1) /* read-lock inode */ -+#define AuLock_IW (1 << 2) /* write-lock inode */ -+#define AuLock_FLUSH (1 << 3) /* wait for 'nowait' tasks */ -+#define AuLock_DIRS (1 << 4) /* target is a pair of dirs */ -+ /* except RENAME_EXCHANGE */ -+#define AuLock_NOPLM (1 << 5) /* return err in plm mode */ -+#define AuLock_NOPLMW (1 << 6) /* wait for plm mode ends */ -+#define AuLock_GEN (1 << 7) /* test digen/iigen */ -+#define au_ftest_lock(flags, name) ((flags) & AuLock_##name) -+#define au_fset_lock(flags, name) \ -+ do { (flags) |= AuLock_##name; } while (0) -+#define au_fclr_lock(flags, name) \ -+ do { (flags) &= ~AuLock_##name; } while (0) -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* super.c */ -+extern struct file_system_type aufs_fs_type; -+struct inode *au_iget_locked(struct super_block *sb, ino_t ino); -+typedef unsigned long long (*au_arraycb_t)(struct super_block *sb, void *array, -+ unsigned long long max, void *arg); -+void *au_array_alloc(unsigned long long *hint, au_arraycb_t cb, -+ struct super_block *sb, void *arg); -+struct inode **au_iarray_alloc(struct super_block *sb, unsigned long long *max); -+void au_iarray_free(struct inode **a, unsigned long long max); -+ -+/* sbinfo.c */ -+void au_si_free(struct kobject *kobj); -+int au_si_alloc(struct super_block *sb); -+int au_sbr_realloc(struct au_sbinfo *sbinfo, int nbr, int may_shrink); -+ -+unsigned int au_sigen_inc(struct super_block *sb); -+aufs_bindex_t au_new_br_id(struct super_block *sb); -+ -+int si_read_lock(struct super_block *sb, int flags); -+int si_write_lock(struct super_block *sb, int flags); -+int aufs_read_lock(struct dentry *dentry, int flags); -+void aufs_read_unlock(struct dentry *dentry, int flags); -+void aufs_write_lock(struct dentry *dentry); -+void aufs_write_unlock(struct dentry *dentry); -+int aufs_read_and_write_lock2(struct dentry *d1, struct dentry *d2, int flags); -+void aufs_read_and_write_unlock2(struct dentry *d1, struct dentry *d2); -+ -+/* wbr_policy.c */ -+extern struct au_wbr_copyup_operations au_wbr_copyup_ops[]; -+extern struct au_wbr_create_operations au_wbr_create_ops[]; -+int au_cpdown_dirs(struct dentry *dentry, aufs_bindex_t bdst); -+int au_wbr_nonopq(struct dentry *dentry, aufs_bindex_t bindex); -+int au_wbr_do_copyup_bu(struct dentry *dentry, aufs_bindex_t btop); -+ -+/* mvdown.c */ -+int au_mvdown(struct dentry *dentry, struct aufs_mvdown __user *arg); -+ -+#ifdef CONFIG_AUFS_FHSM -+/* fhsm.c */ -+ -+static inline pid_t au_fhsm_pid(struct au_fhsm *fhsm) -+{ -+ pid_t pid; -+ -+ spin_lock(&fhsm->fhsm_spin); -+ pid = fhsm->fhsm_pid; -+ spin_unlock(&fhsm->fhsm_spin); -+ -+ return pid; -+} -+ -+void au_fhsm_wrote(struct super_block *sb, aufs_bindex_t bindex, int force); -+void au_fhsm_wrote_all(struct super_block *sb, int force); -+int au_fhsm_fd(struct super_block *sb, int oflags); -+int au_fhsm_br_alloc(struct au_branch *br); -+void au_fhsm_set_bottom(struct super_block *sb, aufs_bindex_t bindex); -+void au_fhsm_fin(struct super_block *sb); -+void au_fhsm_init(struct au_sbinfo *sbinfo); -+void au_fhsm_set(struct au_sbinfo *sbinfo, unsigned int sec); -+void au_fhsm_show(struct seq_file *seq, struct au_sbinfo *sbinfo); -+#else -+AuStubVoid(au_fhsm_wrote, struct super_block *sb, aufs_bindex_t bindex, -+ int force) -+AuStubVoid(au_fhsm_wrote_all, struct super_block *sb, int force) -+AuStub(int, au_fhsm_fd, return -EOPNOTSUPP, struct super_block *sb, int oflags) -+AuStub(pid_t, au_fhsm_pid, return 0, struct au_fhsm *fhsm) -+AuStubInt0(au_fhsm_br_alloc, struct au_branch *br) -+AuStubVoid(au_fhsm_set_bottom, struct super_block *sb, aufs_bindex_t bindex) -+AuStubVoid(au_fhsm_fin, struct super_block *sb) -+AuStubVoid(au_fhsm_init, struct au_sbinfo *sbinfo) -+AuStubVoid(au_fhsm_set, struct au_sbinfo *sbinfo, unsigned int sec) -+AuStubVoid(au_fhsm_show, struct seq_file *seq, struct au_sbinfo *sbinfo) -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline struct au_sbinfo *au_sbi(struct super_block *sb) -+{ -+ return sb->s_fs_info; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+#ifdef CONFIG_AUFS_EXPORT -+int au_test_nfsd(void); -+void au_export_init(struct super_block *sb); -+void au_xigen_inc(struct inode *inode); -+int au_xigen_new(struct inode *inode); -+int au_xigen_set(struct super_block *sb, struct file *base); -+void au_xigen_clr(struct super_block *sb); -+ -+static inline int au_busy_or_stale(void) -+{ -+ if (!au_test_nfsd()) -+ return -EBUSY; -+ return -ESTALE; -+} -+#else -+AuStubInt0(au_test_nfsd, void) -+AuStubVoid(au_export_init, struct super_block *sb) -+AuStubVoid(au_xigen_inc, struct inode *inode) -+AuStubInt0(au_xigen_new, struct inode *inode) -+AuStubInt0(au_xigen_set, struct super_block *sb, struct file *base) -+AuStubVoid(au_xigen_clr, struct super_block *sb) -+AuStub(int, au_busy_or_stale, return -EBUSY, void) -+#endif /* CONFIG_AUFS_EXPORT */ -+ -+/* ---------------------------------------------------------------------- */ -+ -+#ifdef CONFIG_AUFS_SBILIST -+/* module.c */ -+extern struct hlist_bl_head au_sbilist; -+ -+static inline void au_sbilist_init(void) -+{ -+ INIT_HLIST_BL_HEAD(&au_sbilist); -+} -+ -+static inline void au_sbilist_add(struct super_block *sb) -+{ -+ au_hbl_add(&au_sbi(sb)->si_list, &au_sbilist); -+} -+ -+static inline void au_sbilist_del(struct super_block *sb) -+{ -+ au_hbl_del(&au_sbi(sb)->si_list, &au_sbilist); -+} -+ -+#ifdef CONFIG_AUFS_MAGIC_SYSRQ -+static inline void au_sbilist_lock(void) -+{ -+ hlist_bl_lock(&au_sbilist); -+} -+ -+static inline void au_sbilist_unlock(void) -+{ -+ hlist_bl_unlock(&au_sbilist); -+} -+#define AuGFP_SBILIST GFP_ATOMIC -+#else -+AuStubVoid(au_sbilist_lock, void) -+AuStubVoid(au_sbilist_unlock, void) -+#define AuGFP_SBILIST GFP_NOFS -+#endif /* CONFIG_AUFS_MAGIC_SYSRQ */ -+#else -+AuStubVoid(au_sbilist_init, void) -+AuStubVoid(au_sbilist_add, struct super_block *sb) -+AuStubVoid(au_sbilist_del, struct super_block *sb) -+AuStubVoid(au_sbilist_lock, void) -+AuStubVoid(au_sbilist_unlock, void) -+#define AuGFP_SBILIST GFP_NOFS -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline void dbgaufs_si_null(struct au_sbinfo *sbinfo) -+{ -+ /* -+ * This function is a dynamic '__init' function actually, -+ * so the tiny check for si_rwsem is unnecessary. -+ */ -+ /* AuRwMustWriteLock(&sbinfo->si_rwsem); */ -+#ifdef CONFIG_DEBUG_FS -+ sbinfo->si_dbgaufs = NULL; -+ sbinfo->si_dbgaufs_plink = NULL; -+ sbinfo->si_dbgaufs_xib = NULL; -+#ifdef CONFIG_AUFS_EXPORT -+ sbinfo->si_dbgaufs_xigen = NULL; -+#endif -+#endif -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* current->atomic_flags */ -+/* this value should never corrupt the ones defined in linux/sched.h */ -+#define PFA_AUFS 7 -+ -+TASK_PFA_TEST(AUFS, test_aufs) /* task_test_aufs */ -+TASK_PFA_SET(AUFS, aufs) /* task_set_aufs */ -+TASK_PFA_CLEAR(AUFS, aufs) /* task_clear_aufs */ -+ -+static inline int si_pid_test(struct super_block *sb) -+{ -+ return !!task_test_aufs(current); -+} -+ -+static inline void si_pid_clr(struct super_block *sb) -+{ -+ AuDebugOn(!task_test_aufs(current)); -+ task_clear_aufs(current); -+} -+ -+static inline void si_pid_set(struct super_block *sb) -+{ -+ AuDebugOn(task_test_aufs(current)); -+ task_set_aufs(current); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* lock superblock. mainly for entry point functions */ -+#define __si_read_lock(sb) au_rw_read_lock(&au_sbi(sb)->si_rwsem) -+#define __si_write_lock(sb) au_rw_write_lock(&au_sbi(sb)->si_rwsem) -+#define __si_read_trylock(sb) au_rw_read_trylock(&au_sbi(sb)->si_rwsem) -+#define __si_write_trylock(sb) au_rw_write_trylock(&au_sbi(sb)->si_rwsem) -+/* -+#define __si_read_trylock_nested(sb) \ -+ au_rw_read_trylock_nested(&au_sbi(sb)->si_rwsem) -+#define __si_write_trylock_nested(sb) \ -+ au_rw_write_trylock_nested(&au_sbi(sb)->si_rwsem) -+*/ -+ -+#define __si_read_unlock(sb) au_rw_read_unlock(&au_sbi(sb)->si_rwsem) -+#define __si_write_unlock(sb) au_rw_write_unlock(&au_sbi(sb)->si_rwsem) -+#define __si_downgrade_lock(sb) au_rw_dgrade_lock(&au_sbi(sb)->si_rwsem) -+ -+#define SiMustNoWaiters(sb) AuRwMustNoWaiters(&au_sbi(sb)->si_rwsem) -+#define SiMustAnyLock(sb) AuRwMustAnyLock(&au_sbi(sb)->si_rwsem) -+#define SiMustWriteLock(sb) AuRwMustWriteLock(&au_sbi(sb)->si_rwsem) -+ -+static inline void si_noflush_read_lock(struct super_block *sb) -+{ -+ __si_read_lock(sb); -+ si_pid_set(sb); -+} -+ -+static inline int si_noflush_read_trylock(struct super_block *sb) -+{ -+ int locked; -+ -+ locked = __si_read_trylock(sb); -+ if (locked) -+ si_pid_set(sb); -+ return locked; -+} -+ -+static inline void si_noflush_write_lock(struct super_block *sb) -+{ -+ __si_write_lock(sb); -+ si_pid_set(sb); -+} -+ -+static inline int si_noflush_write_trylock(struct super_block *sb) -+{ -+ int locked; -+ -+ locked = __si_write_trylock(sb); -+ if (locked) -+ si_pid_set(sb); -+ return locked; -+} -+ -+#if 0 /* reserved */ -+static inline int si_read_trylock(struct super_block *sb, int flags) -+{ -+ if (au_ftest_lock(flags, FLUSH)) -+ au_nwt_flush(&au_sbi(sb)->si_nowait); -+ return si_noflush_read_trylock(sb); -+} -+#endif -+ -+static inline void si_read_unlock(struct super_block *sb) -+{ -+ si_pid_clr(sb); -+ __si_read_unlock(sb); -+} -+ -+#if 0 /* reserved */ -+static inline int si_write_trylock(struct super_block *sb, int flags) -+{ -+ if (au_ftest_lock(flags, FLUSH)) -+ au_nwt_flush(&au_sbi(sb)->si_nowait); -+ return si_noflush_write_trylock(sb); -+} -+#endif -+ -+static inline void si_write_unlock(struct super_block *sb) -+{ -+ si_pid_clr(sb); -+ __si_write_unlock(sb); -+} -+ -+#if 0 /* reserved */ -+static inline void si_downgrade_lock(struct super_block *sb) -+{ -+ __si_downgrade_lock(sb); -+} -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline aufs_bindex_t au_sbbot(struct super_block *sb) -+{ -+ SiMustAnyLock(sb); -+ return au_sbi(sb)->si_bbot; -+} -+ -+static inline unsigned int au_mntflags(struct super_block *sb) -+{ -+ SiMustAnyLock(sb); -+ return au_sbi(sb)->si_mntflags; -+} -+ -+static inline unsigned int au_sigen(struct super_block *sb) -+{ -+ SiMustAnyLock(sb); -+ return au_sbi(sb)->si_generation; -+} -+ -+static inline unsigned long long au_ninodes(struct super_block *sb) -+{ -+ s64 n = percpu_counter_sum(&au_sbi(sb)->si_ninodes); -+ -+ BUG_ON(n < 0); -+ return n; -+} -+ -+static inline void au_ninodes_inc(struct super_block *sb) -+{ -+ percpu_counter_inc(&au_sbi(sb)->si_ninodes); -+} -+ -+static inline void au_ninodes_dec(struct super_block *sb) -+{ -+ percpu_counter_dec(&au_sbi(sb)->si_ninodes); -+} -+ -+static inline unsigned long long au_nfiles(struct super_block *sb) -+{ -+ s64 n = percpu_counter_sum(&au_sbi(sb)->si_nfiles); -+ -+ BUG_ON(n < 0); -+ return n; -+} -+ -+static inline void au_nfiles_inc(struct super_block *sb) -+{ -+ percpu_counter_inc(&au_sbi(sb)->si_nfiles); -+} -+ -+static inline void au_nfiles_dec(struct super_block *sb) -+{ -+ percpu_counter_dec(&au_sbi(sb)->si_nfiles); -+} -+ -+static inline struct au_branch *au_sbr(struct super_block *sb, -+ aufs_bindex_t bindex) -+{ -+ SiMustAnyLock(sb); -+ return au_sbi(sb)->si_branch[0 + bindex]; -+} -+ -+static inline void au_xino_brid_set(struct super_block *sb, aufs_bindex_t brid) -+{ -+ SiMustWriteLock(sb); -+ au_sbi(sb)->si_xino_brid = brid; -+} -+ -+static inline aufs_bindex_t au_xino_brid(struct super_block *sb) -+{ -+ SiMustAnyLock(sb); -+ return au_sbi(sb)->si_xino_brid; -+} -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_SUPER_H__ */ -diff --git a/fs/aufs/sysaufs.c b/fs/aufs/sysaufs.c -new file mode 100644 -index 000000000000..505d6ef3371c ---- /dev/null -+++ b/fs/aufs/sysaufs.c -@@ -0,0 +1,92 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * sysfs interface and lifetime management -+ * they are necessary regardless sysfs is disabled. -+ */ -+ -+#include -+#include "aufs.h" -+ -+unsigned long sysaufs_si_mask; -+struct kset *sysaufs_kset; -+ -+#define AuSiAttr(_name) { \ -+ .attr = { .name = __stringify(_name), .mode = 0444 }, \ -+ .show = sysaufs_si_##_name, \ -+} -+ -+static struct sysaufs_si_attr sysaufs_si_attr_xi_path = AuSiAttr(xi_path); -+struct attribute *sysaufs_si_attrs[] = { -+ &sysaufs_si_attr_xi_path.attr, -+ NULL, -+}; -+ -+static const struct sysfs_ops au_sbi_ops = { -+ .show = sysaufs_si_show -+}; -+ -+static struct kobj_type au_sbi_ktype = { -+ .release = au_si_free, -+ .sysfs_ops = &au_sbi_ops, -+ .default_attrs = sysaufs_si_attrs -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+int sysaufs_si_init(struct au_sbinfo *sbinfo) -+{ -+ int err; -+ -+ sbinfo->si_kobj.kset = sysaufs_kset; -+ /* cf. sysaufs_name() */ -+ err = kobject_init_and_add -+ (&sbinfo->si_kobj, &au_sbi_ktype, /*&sysaufs_kset->kobj*/NULL, -+ SysaufsSiNamePrefix "%lx", sysaufs_si_id(sbinfo)); -+ -+ dbgaufs_si_null(sbinfo); -+ if (!err) { -+ err = dbgaufs_si_init(sbinfo); -+ if (unlikely(err)) -+ kobject_put(&sbinfo->si_kobj); -+ } -+ return err; -+} -+ -+void sysaufs_fin(void) -+{ -+ dbgaufs_fin(); -+ sysfs_remove_group(&sysaufs_kset->kobj, sysaufs_attr_group); -+ kset_unregister(sysaufs_kset); -+} -+ -+int __init sysaufs_init(void) -+{ -+ int err; -+ -+ do { -+ get_random_bytes(&sysaufs_si_mask, sizeof(sysaufs_si_mask)); -+ } while (!sysaufs_si_mask); -+ -+ err = -EINVAL; -+ sysaufs_kset = kset_create_and_add(AUFS_NAME, NULL, fs_kobj); -+ if (unlikely(!sysaufs_kset)) -+ goto out; -+ err = PTR_ERR(sysaufs_kset); -+ if (IS_ERR(sysaufs_kset)) -+ goto out; -+ err = sysfs_create_group(&sysaufs_kset->kobj, sysaufs_attr_group); -+ if (unlikely(err)) { -+ kset_unregister(sysaufs_kset); -+ goto out; -+ } -+ -+ err = dbgaufs_init(); -+ if (unlikely(err)) -+ sysaufs_fin(); -+out: -+ return err; -+} -diff --git a/fs/aufs/sysaufs.h b/fs/aufs/sysaufs.h -new file mode 100644 -index 000000000000..a4d84ce79e32 ---- /dev/null -+++ b/fs/aufs/sysaufs.h -@@ -0,0 +1,89 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * sysfs interface and mount lifetime management -+ */ -+ -+#ifndef __SYSAUFS_H__ -+#define __SYSAUFS_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+#include "module.h" -+ -+struct super_block; -+struct au_sbinfo; -+ -+struct sysaufs_si_attr { -+ struct attribute attr; -+ int (*show)(struct seq_file *seq, struct super_block *sb); -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* sysaufs.c */ -+extern unsigned long sysaufs_si_mask; -+extern struct kset *sysaufs_kset; -+extern struct attribute *sysaufs_si_attrs[]; -+int sysaufs_si_init(struct au_sbinfo *sbinfo); -+int __init sysaufs_init(void); -+void sysaufs_fin(void); -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* some people doesn't like to show a pointer in kernel */ -+static inline unsigned long sysaufs_si_id(struct au_sbinfo *sbinfo) -+{ -+ return sysaufs_si_mask ^ (unsigned long)sbinfo; -+} -+ -+#define SysaufsSiNamePrefix "si_" -+#define SysaufsSiNameLen (sizeof(SysaufsSiNamePrefix) + 16) -+static inline void sysaufs_name(struct au_sbinfo *sbinfo, char *name) -+{ -+ snprintf(name, SysaufsSiNameLen, SysaufsSiNamePrefix "%lx", -+ sysaufs_si_id(sbinfo)); -+} -+ -+struct au_branch; -+#ifdef CONFIG_SYSFS -+/* sysfs.c */ -+extern struct attribute_group *sysaufs_attr_group; -+ -+int sysaufs_si_xi_path(struct seq_file *seq, struct super_block *sb); -+ssize_t sysaufs_si_show(struct kobject *kobj, struct attribute *attr, -+ char *buf); -+long au_brinfo_ioctl(struct file *file, unsigned long arg); -+#ifdef CONFIG_COMPAT -+long au_brinfo_compat_ioctl(struct file *file, unsigned long arg); -+#endif -+ -+void sysaufs_br_init(struct au_branch *br); -+void sysaufs_brs_add(struct super_block *sb, aufs_bindex_t bindex); -+void sysaufs_brs_del(struct super_block *sb, aufs_bindex_t bindex); -+ -+#define sysaufs_brs_init() do {} while (0) -+ -+#else -+#define sysaufs_attr_group NULL -+ -+AuStubInt0(sysaufs_si_xi_path, struct seq_file *seq, struct super_block *sb) -+AuStub(ssize_t, sysaufs_si_show, return 0, struct kobject *kobj, -+ struct attribute *attr, char *buf) -+AuStubVoid(sysaufs_br_init, struct au_branch *br) -+AuStubVoid(sysaufs_brs_add, struct super_block *sb, aufs_bindex_t bindex) -+AuStubVoid(sysaufs_brs_del, struct super_block *sb, aufs_bindex_t bindex) -+ -+static inline void sysaufs_brs_init(void) -+{ -+ sysaufs_brs = 0; -+} -+ -+#endif /* CONFIG_SYSFS */ -+ -+#endif /* __KERNEL__ */ -+#endif /* __SYSAUFS_H__ */ -diff --git a/fs/aufs/sysfs.c b/fs/aufs/sysfs.c -new file mode 100644 -index 000000000000..d00aa523e242 ---- /dev/null -+++ b/fs/aufs/sysfs.c -@@ -0,0 +1,341 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * sysfs interface -+ */ -+ -+#include -+#include -+#include "aufs.h" -+ -+static struct attribute *au_attr[] = { -+ NULL, /* need to NULL terminate the list of attributes */ -+}; -+ -+static struct attribute_group sysaufs_attr_group_body = { -+ .attrs = au_attr -+}; -+ -+struct attribute_group *sysaufs_attr_group = &sysaufs_attr_group_body; -+ -+/* ---------------------------------------------------------------------- */ -+ -+int sysaufs_si_xi_path(struct seq_file *seq, struct super_block *sb) -+{ -+ int err; -+ -+ SiMustAnyLock(sb); -+ -+ err = 0; -+ if (au_opt_test(au_mntflags(sb), XINO)) { -+ err = au_xino_path(seq, au_sbi(sb)->si_xib); -+ seq_putc(seq, '\n'); -+ } -+ return err; -+} -+ -+/* -+ * the lifetime of branch is independent from the entry under sysfs. -+ * sysfs handles the lifetime of the entry, and never call ->show() after it is -+ * unlinked. -+ */ -+static int sysaufs_si_br(struct seq_file *seq, struct super_block *sb, -+ aufs_bindex_t bindex, int idx) -+{ -+ int err; -+ struct path path; -+ struct dentry *root; -+ struct au_branch *br; -+ au_br_perm_str_t perm; -+ -+ AuDbg("b%d\n", bindex); -+ -+ err = 0; -+ root = sb->s_root; -+ di_read_lock_parent(root, !AuLock_IR); -+ br = au_sbr(sb, bindex); -+ -+ switch (idx) { -+ case AuBrSysfs_BR: -+ path.mnt = au_br_mnt(br); -+ path.dentry = au_h_dptr(root, bindex); -+ err = au_seq_path(seq, &path); -+ if (!err) { -+ au_optstr_br_perm(&perm, br->br_perm); -+ seq_printf(seq, "=%s\n", perm.a); -+ } -+ break; -+ case AuBrSysfs_BRID: -+ seq_printf(seq, "%d\n", br->br_id); -+ break; -+ } -+ di_read_unlock(root, !AuLock_IR); -+ if (unlikely(err || seq_has_overflowed(seq))) -+ err = -E2BIG; -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static struct seq_file *au_seq(char *p, ssize_t len) -+{ -+ struct seq_file *seq; -+ -+ seq = kzalloc(sizeof(*seq), GFP_NOFS); -+ if (seq) { -+ /* mutex_init(&seq.lock); */ -+ seq->buf = p; -+ seq->size = len; -+ return seq; /* success */ -+ } -+ -+ seq = ERR_PTR(-ENOMEM); -+ return seq; -+} -+ -+#define SysaufsBr_PREFIX "br" -+#define SysaufsBrid_PREFIX "brid" -+ -+/* todo: file size may exceed PAGE_SIZE */ -+ssize_t sysaufs_si_show(struct kobject *kobj, struct attribute *attr, -+ char *buf) -+{ -+ ssize_t err; -+ int idx; -+ long l; -+ aufs_bindex_t bbot; -+ struct au_sbinfo *sbinfo; -+ struct super_block *sb; -+ struct seq_file *seq; -+ char *name; -+ struct attribute **cattr; -+ -+ sbinfo = container_of(kobj, struct au_sbinfo, si_kobj); -+ sb = sbinfo->si_sb; -+ -+ /* -+ * prevent a race condition between sysfs and aufs. -+ * for instance, sysfs_file_read() calls sysfs_get_active_two() which -+ * prohibits maintaining the sysfs entries. -+ * hew we acquire read lock after sysfs_get_active_two(). -+ * on the other hand, the remount process may maintain the sysfs/aufs -+ * entries after acquiring write lock. -+ * it can cause a deadlock. -+ * simply we gave up processing read here. -+ */ -+ err = -EBUSY; -+ if (unlikely(!si_noflush_read_trylock(sb))) -+ goto out; -+ -+ seq = au_seq(buf, PAGE_SIZE); -+ err = PTR_ERR(seq); -+ if (IS_ERR(seq)) -+ goto out_unlock; -+ -+ name = (void *)attr->name; -+ cattr = sysaufs_si_attrs; -+ while (*cattr) { -+ if (!strcmp(name, (*cattr)->name)) { -+ err = container_of(*cattr, struct sysaufs_si_attr, attr) -+ ->show(seq, sb); -+ goto out_seq; -+ } -+ cattr++; -+ } -+ -+ if (!strncmp(name, SysaufsBrid_PREFIX, -+ sizeof(SysaufsBrid_PREFIX) - 1)) { -+ idx = AuBrSysfs_BRID; -+ name += sizeof(SysaufsBrid_PREFIX) - 1; -+ } else if (!strncmp(name, SysaufsBr_PREFIX, -+ sizeof(SysaufsBr_PREFIX) - 1)) { -+ idx = AuBrSysfs_BR; -+ name += sizeof(SysaufsBr_PREFIX) - 1; -+ } else -+ BUG(); -+ -+ err = kstrtol(name, 10, &l); -+ if (!err) { -+ bbot = au_sbbot(sb); -+ if (l <= bbot) -+ err = sysaufs_si_br(seq, sb, (aufs_bindex_t)l, idx); -+ else -+ err = -ENOENT; -+ } -+ -+out_seq: -+ if (!err) { -+ err = seq->count; -+ /* sysfs limit */ -+ if (unlikely(err == PAGE_SIZE)) -+ err = -EFBIG; -+ } -+ kfree(seq); -+out_unlock: -+ si_read_unlock(sb); -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_brinfo(struct super_block *sb, union aufs_brinfo __user *arg) -+{ -+ int err; -+ int16_t brid; -+ aufs_bindex_t bindex, bbot; -+ size_t sz; -+ char *buf; -+ struct seq_file *seq; -+ struct au_branch *br; -+ -+ si_read_lock(sb, AuLock_FLUSH); -+ bbot = au_sbbot(sb); -+ err = bbot + 1; -+ if (!arg) -+ goto out; -+ -+ err = -ENOMEM; -+ buf = (void *)__get_free_page(GFP_NOFS); -+ if (unlikely(!buf)) -+ goto out; -+ -+ seq = au_seq(buf, PAGE_SIZE); -+ err = PTR_ERR(seq); -+ if (IS_ERR(seq)) -+ goto out_buf; -+ -+ sz = sizeof(*arg) - offsetof(union aufs_brinfo, path); -+ for (bindex = 0; bindex <= bbot; bindex++, arg++) { -+ err = !access_ok(VERIFY_WRITE, arg, sizeof(*arg)); -+ if (unlikely(err)) -+ break; -+ -+ br = au_sbr(sb, bindex); -+ brid = br->br_id; -+ BUILD_BUG_ON(sizeof(brid) != sizeof(arg->id)); -+ err = __put_user(brid, &arg->id); -+ if (unlikely(err)) -+ break; -+ -+ BUILD_BUG_ON(sizeof(br->br_perm) != sizeof(arg->perm)); -+ err = __put_user(br->br_perm, &arg->perm); -+ if (unlikely(err)) -+ break; -+ -+ err = au_seq_path(seq, &br->br_path); -+ if (unlikely(err)) -+ break; -+ seq_putc(seq, '\0'); -+ if (!seq_has_overflowed(seq)) { -+ err = copy_to_user(arg->path, seq->buf, seq->count); -+ seq->count = 0; -+ if (unlikely(err)) -+ break; -+ } else { -+ err = -E2BIG; -+ goto out_seq; -+ } -+ } -+ if (unlikely(err)) -+ err = -EFAULT; -+ -+out_seq: -+ kfree(seq); -+out_buf: -+ free_page((unsigned long)buf); -+out: -+ si_read_unlock(sb); -+ return err; -+} -+ -+long au_brinfo_ioctl(struct file *file, unsigned long arg) -+{ -+ return au_brinfo(file->f_path.dentry->d_sb, (void __user *)arg); -+} -+ -+#ifdef CONFIG_COMPAT -+long au_brinfo_compat_ioctl(struct file *file, unsigned long arg) -+{ -+ return au_brinfo(file->f_path.dentry->d_sb, compat_ptr(arg)); -+} -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+void sysaufs_br_init(struct au_branch *br) -+{ -+ int i; -+ struct au_brsysfs *br_sysfs; -+ struct attribute *attr; -+ -+ br_sysfs = br->br_sysfs; -+ for (i = 0; i < ARRAY_SIZE(br->br_sysfs); i++) { -+ attr = &br_sysfs->attr; -+ sysfs_attr_init(attr); -+ attr->name = br_sysfs->name; -+ attr->mode = S_IRUGO; -+ br_sysfs++; -+ } -+} -+ -+void sysaufs_brs_del(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ struct au_branch *br; -+ struct kobject *kobj; -+ struct au_brsysfs *br_sysfs; -+ int i; -+ aufs_bindex_t bbot; -+ -+ dbgaufs_brs_del(sb, bindex); -+ -+ if (!sysaufs_brs) -+ return; -+ -+ kobj = &au_sbi(sb)->si_kobj; -+ bbot = au_sbbot(sb); -+ for (; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ br_sysfs = br->br_sysfs; -+ for (i = 0; i < ARRAY_SIZE(br->br_sysfs); i++) { -+ sysfs_remove_file(kobj, &br_sysfs->attr); -+ br_sysfs++; -+ } -+ } -+} -+ -+void sysaufs_brs_add(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ int err, i; -+ aufs_bindex_t bbot; -+ struct kobject *kobj; -+ struct au_branch *br; -+ struct au_brsysfs *br_sysfs; -+ -+ dbgaufs_brs_add(sb, bindex); -+ -+ if (!sysaufs_brs) -+ return; -+ -+ kobj = &au_sbi(sb)->si_kobj; -+ bbot = au_sbbot(sb); -+ for (; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ br_sysfs = br->br_sysfs; -+ snprintf(br_sysfs[AuBrSysfs_BR].name, sizeof(br_sysfs->name), -+ SysaufsBr_PREFIX "%d", bindex); -+ snprintf(br_sysfs[AuBrSysfs_BRID].name, sizeof(br_sysfs->name), -+ SysaufsBrid_PREFIX "%d", bindex); -+ for (i = 0; i < ARRAY_SIZE(br->br_sysfs); i++) { -+ err = sysfs_create_file(kobj, &br_sysfs->attr); -+ if (unlikely(err)) -+ pr_warn("failed %s under sysfs(%d)\n", -+ br_sysfs->name, err); -+ br_sysfs++; -+ } -+ } -+} -diff --git a/fs/aufs/sysrq.c b/fs/aufs/sysrq.c -new file mode 100644 -index 000000000000..d928d408d1e5 ---- /dev/null -+++ b/fs/aufs/sysrq.c -@@ -0,0 +1,147 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * magic sysrq hanlder -+ */ -+ -+/* #include */ -+#include -+#include "aufs.h" -+ -+/* ---------------------------------------------------------------------- */ -+ -+static void sysrq_sb(struct super_block *sb) -+{ -+ char *plevel; -+ struct au_sbinfo *sbinfo; -+ struct file *file; -+ struct hlist_bl_head *files; -+ struct hlist_bl_node *pos; -+ struct au_finfo *finfo; -+ -+ plevel = au_plevel; -+ au_plevel = KERN_WARNING; -+ -+ /* since we define pr_fmt, call printk directly */ -+#define pr(str) printk(KERN_WARNING AUFS_NAME ": " str) -+ -+ sbinfo = au_sbi(sb); -+ printk(KERN_WARNING "si=%lx\n", sysaufs_si_id(sbinfo)); -+ pr("superblock\n"); -+ au_dpri_sb(sb); -+ -+#if 0 -+ pr("root dentry\n"); -+ au_dpri_dentry(sb->s_root); -+ pr("root inode\n"); -+ au_dpri_inode(d_inode(sb->s_root)); -+#endif -+ -+#if 0 -+ do { -+ int err, i, j, ndentry; -+ struct au_dcsub_pages dpages; -+ struct au_dpage *dpage; -+ -+ err = au_dpages_init(&dpages, GFP_ATOMIC); -+ if (unlikely(err)) -+ break; -+ err = au_dcsub_pages(&dpages, sb->s_root, NULL, NULL); -+ if (!err) -+ for (i = 0; i < dpages.ndpage; i++) { -+ dpage = dpages.dpages + i; -+ ndentry = dpage->ndentry; -+ for (j = 0; j < ndentry; j++) -+ au_dpri_dentry(dpage->dentries[j]); -+ } -+ au_dpages_free(&dpages); -+ } while (0); -+#endif -+ -+#if 1 -+ { -+ struct inode *i; -+ -+ pr("isolated inode\n"); -+ spin_lock(&sb->s_inode_list_lock); -+ list_for_each_entry(i, &sb->s_inodes, i_sb_list) { -+ spin_lock(&i->i_lock); -+ if (1 || hlist_empty(&i->i_dentry)) -+ au_dpri_inode(i); -+ spin_unlock(&i->i_lock); -+ } -+ spin_unlock(&sb->s_inode_list_lock); -+ } -+#endif -+ pr("files\n"); -+ files = &au_sbi(sb)->si_files; -+ hlist_bl_lock(files); -+ hlist_bl_for_each_entry(finfo, pos, files, fi_hlist) { -+ umode_t mode; -+ -+ file = finfo->fi_file; -+ mode = file_inode(file)->i_mode; -+ if (!special_file(mode)) -+ au_dpri_file(file); -+ } -+ hlist_bl_unlock(files); -+ pr("done\n"); -+ -+#undef pr -+ au_plevel = plevel; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* module parameter */ -+static char *aufs_sysrq_key = "a"; -+module_param_named(sysrq, aufs_sysrq_key, charp, S_IRUGO); -+MODULE_PARM_DESC(sysrq, "MagicSysRq key for " AUFS_NAME); -+ -+static void au_sysrq(int key __maybe_unused) -+{ -+ struct au_sbinfo *sbinfo; -+ struct hlist_bl_node *pos; -+ -+ lockdep_off(); -+ au_sbilist_lock(); -+ hlist_bl_for_each_entry(sbinfo, pos, &au_sbilist, si_list) -+ sysrq_sb(sbinfo->si_sb); -+ au_sbilist_unlock(); -+ lockdep_on(); -+} -+ -+static struct sysrq_key_op au_sysrq_op = { -+ .handler = au_sysrq, -+ .help_msg = "Aufs", -+ .action_msg = "Aufs", -+ .enable_mask = SYSRQ_ENABLE_DUMP -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+int __init au_sysrq_init(void) -+{ -+ int err; -+ char key; -+ -+ err = -1; -+ key = *aufs_sysrq_key; -+ if ('a' <= key && key <= 'z') -+ err = register_sysrq_key(key, &au_sysrq_op); -+ if (unlikely(err)) -+ pr_err("err %d, sysrq=%c\n", err, key); -+ return err; -+} -+ -+void au_sysrq_fin(void) -+{ -+ int err; -+ -+ err = unregister_sysrq_key(*aufs_sysrq_key, &au_sysrq_op); -+ if (unlikely(err)) -+ pr_err("err %d (ignored)\n", err); -+} -diff --git a/fs/aufs/vdir.c b/fs/aufs/vdir.c -new file mode 100644 -index 000000000000..7afd018b94ef ---- /dev/null -+++ b/fs/aufs/vdir.c -@@ -0,0 +1,880 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * virtual or vertical directory -+ */ -+ -+#include "aufs.h" -+ -+static unsigned int calc_size(int nlen) -+{ -+ return ALIGN(sizeof(struct au_vdir_de) + nlen, sizeof(ino_t)); -+} -+ -+static int set_deblk_end(union au_vdir_deblk_p *p, -+ union au_vdir_deblk_p *deblk_end) -+{ -+ if (calc_size(0) <= deblk_end->deblk - p->deblk) { -+ p->de->de_str.len = 0; -+ /* smp_mb(); */ -+ return 0; -+ } -+ return -1; /* error */ -+} -+ -+/* returns true or false */ -+static int is_deblk_end(union au_vdir_deblk_p *p, -+ union au_vdir_deblk_p *deblk_end) -+{ -+ if (calc_size(0) <= deblk_end->deblk - p->deblk) -+ return !p->de->de_str.len; -+ return 1; -+} -+ -+static unsigned char *last_deblk(struct au_vdir *vdir) -+{ -+ return vdir->vd_deblk[vdir->vd_nblk - 1]; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* estimate the appropriate size for name hash table */ -+unsigned int au_rdhash_est(loff_t sz) -+{ -+ unsigned int n; -+ -+ n = UINT_MAX; -+ sz >>= 10; -+ if (sz < n) -+ n = sz; -+ if (sz < AUFS_RDHASH_DEF) -+ n = AUFS_RDHASH_DEF; -+ /* pr_info("n %u\n", n); */ -+ return n; -+} -+ -+/* -+ * the allocated memory has to be freed by -+ * au_nhash_wh_free() or au_nhash_de_free(). -+ */ -+int au_nhash_alloc(struct au_nhash *nhash, unsigned int num_hash, gfp_t gfp) -+{ -+ struct hlist_head *head; -+ unsigned int u; -+ size_t sz; -+ -+ sz = sizeof(*nhash->nh_head) * num_hash; -+ head = kmalloc(sz, gfp); -+ if (head) { -+ nhash->nh_num = num_hash; -+ nhash->nh_head = head; -+ for (u = 0; u < num_hash; u++) -+ INIT_HLIST_HEAD(head++); -+ return 0; /* success */ -+ } -+ -+ return -ENOMEM; -+} -+ -+static void nhash_count(struct hlist_head *head) -+{ -+#if 0 -+ unsigned long n; -+ struct hlist_node *pos; -+ -+ n = 0; -+ hlist_for_each(pos, head) -+ n++; -+ pr_info("%lu\n", n); -+#endif -+} -+ -+static void au_nhash_wh_do_free(struct hlist_head *head) -+{ -+ struct au_vdir_wh *pos; -+ struct hlist_node *node; -+ -+ hlist_for_each_entry_safe(pos, node, head, wh_hash) -+ kfree(pos); -+} -+ -+static void au_nhash_de_do_free(struct hlist_head *head) -+{ -+ struct au_vdir_dehstr *pos; -+ struct hlist_node *node; -+ -+ hlist_for_each_entry_safe(pos, node, head, hash) -+ au_cache_free_vdir_dehstr(pos); -+} -+ -+static void au_nhash_do_free(struct au_nhash *nhash, -+ void (*free)(struct hlist_head *head)) -+{ -+ unsigned int n; -+ struct hlist_head *head; -+ -+ n = nhash->nh_num; -+ if (!n) -+ return; -+ -+ head = nhash->nh_head; -+ while (n-- > 0) { -+ nhash_count(head); -+ free(head++); -+ } -+ kfree(nhash->nh_head); -+} -+ -+void au_nhash_wh_free(struct au_nhash *whlist) -+{ -+ au_nhash_do_free(whlist, au_nhash_wh_do_free); -+} -+ -+static void au_nhash_de_free(struct au_nhash *delist) -+{ -+ au_nhash_do_free(delist, au_nhash_de_do_free); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int au_nhash_test_longer_wh(struct au_nhash *whlist, aufs_bindex_t btgt, -+ int limit) -+{ -+ int num; -+ unsigned int u, n; -+ struct hlist_head *head; -+ struct au_vdir_wh *pos; -+ -+ num = 0; -+ n = whlist->nh_num; -+ head = whlist->nh_head; -+ for (u = 0; u < n; u++, head++) -+ hlist_for_each_entry(pos, head, wh_hash) -+ if (pos->wh_bindex == btgt && ++num > limit) -+ return 1; -+ return 0; -+} -+ -+static struct hlist_head *au_name_hash(struct au_nhash *nhash, -+ unsigned char *name, -+ unsigned int len) -+{ -+ unsigned int v; -+ /* const unsigned int magic_bit = 12; */ -+ -+ AuDebugOn(!nhash->nh_num || !nhash->nh_head); -+ -+ v = 0; -+ if (len > 8) -+ len = 8; -+ while (len--) -+ v += *name++; -+ /* v = hash_long(v, magic_bit); */ -+ v %= nhash->nh_num; -+ return nhash->nh_head + v; -+} -+ -+static int au_nhash_test_name(struct au_vdir_destr *str, const char *name, -+ int nlen) -+{ -+ return str->len == nlen && !memcmp(str->name, name, nlen); -+} -+ -+/* returns found or not */ -+int au_nhash_test_known_wh(struct au_nhash *whlist, char *name, int nlen) -+{ -+ struct hlist_head *head; -+ struct au_vdir_wh *pos; -+ struct au_vdir_destr *str; -+ -+ head = au_name_hash(whlist, name, nlen); -+ hlist_for_each_entry(pos, head, wh_hash) { -+ str = &pos->wh_str; -+ AuDbg("%.*s\n", str->len, str->name); -+ if (au_nhash_test_name(str, name, nlen)) -+ return 1; -+ } -+ return 0; -+} -+ -+/* returns found(true) or not */ -+static int test_known(struct au_nhash *delist, char *name, int nlen) -+{ -+ struct hlist_head *head; -+ struct au_vdir_dehstr *pos; -+ struct au_vdir_destr *str; -+ -+ head = au_name_hash(delist, name, nlen); -+ hlist_for_each_entry(pos, head, hash) { -+ str = pos->str; -+ AuDbg("%.*s\n", str->len, str->name); -+ if (au_nhash_test_name(str, name, nlen)) -+ return 1; -+ } -+ return 0; -+} -+ -+static void au_shwh_init_wh(struct au_vdir_wh *wh, ino_t ino, -+ unsigned char d_type) -+{ -+#ifdef CONFIG_AUFS_SHWH -+ wh->wh_ino = ino; -+ wh->wh_type = d_type; -+#endif -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int au_nhash_append_wh(struct au_nhash *whlist, char *name, int nlen, ino_t ino, -+ unsigned int d_type, aufs_bindex_t bindex, -+ unsigned char shwh) -+{ -+ int err; -+ struct au_vdir_destr *str; -+ struct au_vdir_wh *wh; -+ -+ AuDbg("%.*s\n", nlen, name); -+ AuDebugOn(!whlist->nh_num || !whlist->nh_head); -+ -+ err = -ENOMEM; -+ wh = kmalloc(sizeof(*wh) + nlen, GFP_NOFS); -+ if (unlikely(!wh)) -+ goto out; -+ -+ err = 0; -+ wh->wh_bindex = bindex; -+ if (shwh) -+ au_shwh_init_wh(wh, ino, d_type); -+ str = &wh->wh_str; -+ str->len = nlen; -+ memcpy(str->name, name, nlen); -+ hlist_add_head(&wh->wh_hash, au_name_hash(whlist, name, nlen)); -+ /* smp_mb(); */ -+ -+out: -+ return err; -+} -+ -+static int append_deblk(struct au_vdir *vdir) -+{ -+ int err; -+ unsigned long ul; -+ const unsigned int deblk_sz = vdir->vd_deblk_sz; -+ union au_vdir_deblk_p p, deblk_end; -+ unsigned char **o; -+ -+ err = -ENOMEM; -+ o = au_krealloc(vdir->vd_deblk, sizeof(*o) * (vdir->vd_nblk + 1), -+ GFP_NOFS, /*may_shrink*/0); -+ if (unlikely(!o)) -+ goto out; -+ -+ vdir->vd_deblk = o; -+ p.deblk = kmalloc(deblk_sz, GFP_NOFS); -+ if (p.deblk) { -+ ul = vdir->vd_nblk++; -+ vdir->vd_deblk[ul] = p.deblk; -+ vdir->vd_last.ul = ul; -+ vdir->vd_last.p.deblk = p.deblk; -+ deblk_end.deblk = p.deblk + deblk_sz; -+ err = set_deblk_end(&p, &deblk_end); -+ } -+ -+out: -+ return err; -+} -+ -+static int append_de(struct au_vdir *vdir, char *name, int nlen, ino_t ino, -+ unsigned int d_type, struct au_nhash *delist) -+{ -+ int err; -+ unsigned int sz; -+ const unsigned int deblk_sz = vdir->vd_deblk_sz; -+ union au_vdir_deblk_p p, *room, deblk_end; -+ struct au_vdir_dehstr *dehstr; -+ -+ p.deblk = last_deblk(vdir); -+ deblk_end.deblk = p.deblk + deblk_sz; -+ room = &vdir->vd_last.p; -+ AuDebugOn(room->deblk < p.deblk || deblk_end.deblk <= room->deblk -+ || !is_deblk_end(room, &deblk_end)); -+ -+ sz = calc_size(nlen); -+ if (unlikely(sz > deblk_end.deblk - room->deblk)) { -+ err = append_deblk(vdir); -+ if (unlikely(err)) -+ goto out; -+ -+ p.deblk = last_deblk(vdir); -+ deblk_end.deblk = p.deblk + deblk_sz; -+ /* smp_mb(); */ -+ AuDebugOn(room->deblk != p.deblk); -+ } -+ -+ err = -ENOMEM; -+ dehstr = au_cache_alloc_vdir_dehstr(); -+ if (unlikely(!dehstr)) -+ goto out; -+ -+ dehstr->str = &room->de->de_str; -+ hlist_add_head(&dehstr->hash, au_name_hash(delist, name, nlen)); -+ room->de->de_ino = ino; -+ room->de->de_type = d_type; -+ room->de->de_str.len = nlen; -+ memcpy(room->de->de_str.name, name, nlen); -+ -+ err = 0; -+ room->deblk += sz; -+ if (unlikely(set_deblk_end(room, &deblk_end))) -+ err = append_deblk(vdir); -+ /* smp_mb(); */ -+ -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void au_vdir_free(struct au_vdir *vdir) -+{ -+ unsigned char **deblk; -+ -+ deblk = vdir->vd_deblk; -+ while (vdir->vd_nblk--) -+ kfree(*deblk++); -+ kfree(vdir->vd_deblk); -+ au_cache_free_vdir(vdir); -+} -+ -+static struct au_vdir *alloc_vdir(struct file *file) -+{ -+ struct au_vdir *vdir; -+ struct super_block *sb; -+ int err; -+ -+ sb = file->f_path.dentry->d_sb; -+ SiMustAnyLock(sb); -+ -+ err = -ENOMEM; -+ vdir = au_cache_alloc_vdir(); -+ if (unlikely(!vdir)) -+ goto out; -+ -+ vdir->vd_deblk = kzalloc(sizeof(*vdir->vd_deblk), GFP_NOFS); -+ if (unlikely(!vdir->vd_deblk)) -+ goto out_free; -+ -+ vdir->vd_deblk_sz = au_sbi(sb)->si_rdblk; -+ if (!vdir->vd_deblk_sz) { -+ /* estimate the appropriate size for deblk */ -+ vdir->vd_deblk_sz = au_dir_size(file, /*dentry*/NULL); -+ /* pr_info("vd_deblk_sz %u\n", vdir->vd_deblk_sz); */ -+ } -+ vdir->vd_nblk = 0; -+ vdir->vd_version = 0; -+ vdir->vd_jiffy = 0; -+ err = append_deblk(vdir); -+ if (!err) -+ return vdir; /* success */ -+ -+ kfree(vdir->vd_deblk); -+ -+out_free: -+ au_cache_free_vdir(vdir); -+out: -+ vdir = ERR_PTR(err); -+ return vdir; -+} -+ -+static int reinit_vdir(struct au_vdir *vdir) -+{ -+ int err; -+ union au_vdir_deblk_p p, deblk_end; -+ -+ while (vdir->vd_nblk > 1) { -+ kfree(vdir->vd_deblk[vdir->vd_nblk - 1]); -+ /* vdir->vd_deblk[vdir->vd_nblk - 1] = NULL; */ -+ vdir->vd_nblk--; -+ } -+ p.deblk = vdir->vd_deblk[0]; -+ deblk_end.deblk = p.deblk + vdir->vd_deblk_sz; -+ err = set_deblk_end(&p, &deblk_end); -+ /* keep vd_dblk_sz */ -+ vdir->vd_last.ul = 0; -+ vdir->vd_last.p.deblk = vdir->vd_deblk[0]; -+ vdir->vd_version = 0; -+ vdir->vd_jiffy = 0; -+ /* smp_mb(); */ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+#define AuFillVdir_CALLED 1 -+#define AuFillVdir_WHABLE (1 << 1) -+#define AuFillVdir_SHWH (1 << 2) -+#define au_ftest_fillvdir(flags, name) ((flags) & AuFillVdir_##name) -+#define au_fset_fillvdir(flags, name) \ -+ do { (flags) |= AuFillVdir_##name; } while (0) -+#define au_fclr_fillvdir(flags, name) \ -+ do { (flags) &= ~AuFillVdir_##name; } while (0) -+ -+#ifndef CONFIG_AUFS_SHWH -+#undef AuFillVdir_SHWH -+#define AuFillVdir_SHWH 0 -+#endif -+ -+struct fillvdir_arg { -+ struct dir_context ctx; -+ struct file *file; -+ struct au_vdir *vdir; -+ struct au_nhash delist; -+ struct au_nhash whlist; -+ aufs_bindex_t bindex; -+ unsigned int flags; -+ int err; -+}; -+ -+static int fillvdir(struct dir_context *ctx, const char *__name, int nlen, -+ loff_t offset __maybe_unused, u64 h_ino, -+ unsigned int d_type) -+{ -+ struct fillvdir_arg *arg = container_of(ctx, struct fillvdir_arg, ctx); -+ char *name = (void *)__name; -+ struct super_block *sb; -+ ino_t ino; -+ const unsigned char shwh = !!au_ftest_fillvdir(arg->flags, SHWH); -+ -+ arg->err = 0; -+ sb = arg->file->f_path.dentry->d_sb; -+ au_fset_fillvdir(arg->flags, CALLED); -+ /* smp_mb(); */ -+ if (nlen <= AUFS_WH_PFX_LEN -+ || memcmp(name, AUFS_WH_PFX, AUFS_WH_PFX_LEN)) { -+ if (test_known(&arg->delist, name, nlen) -+ || au_nhash_test_known_wh(&arg->whlist, name, nlen)) -+ goto out; /* already exists or whiteouted */ -+ -+ arg->err = au_ino(sb, arg->bindex, h_ino, d_type, &ino); -+ if (!arg->err) { -+ if (unlikely(nlen > AUFS_MAX_NAMELEN)) -+ d_type = DT_UNKNOWN; -+ arg->err = append_de(arg->vdir, name, nlen, ino, -+ d_type, &arg->delist); -+ } -+ } else if (au_ftest_fillvdir(arg->flags, WHABLE)) { -+ name += AUFS_WH_PFX_LEN; -+ nlen -= AUFS_WH_PFX_LEN; -+ if (au_nhash_test_known_wh(&arg->whlist, name, nlen)) -+ goto out; /* already whiteouted */ -+ -+ if (shwh) -+ arg->err = au_wh_ino(sb, arg->bindex, h_ino, d_type, -+ &ino); -+ if (!arg->err) { -+ if (nlen <= AUFS_MAX_NAMELEN + AUFS_WH_PFX_LEN) -+ d_type = DT_UNKNOWN; -+ arg->err = au_nhash_append_wh -+ (&arg->whlist, name, nlen, ino, d_type, -+ arg->bindex, shwh); -+ } -+ } -+ -+out: -+ if (!arg->err) -+ arg->vdir->vd_jiffy = jiffies; -+ /* smp_mb(); */ -+ AuTraceErr(arg->err); -+ return arg->err; -+} -+ -+static int au_handle_shwh(struct super_block *sb, struct au_vdir *vdir, -+ struct au_nhash *whlist, struct au_nhash *delist) -+{ -+#ifdef CONFIG_AUFS_SHWH -+ int err; -+ unsigned int nh, u; -+ struct hlist_head *head; -+ struct au_vdir_wh *pos; -+ struct hlist_node *n; -+ char *p, *o; -+ struct au_vdir_destr *destr; -+ -+ AuDebugOn(!au_opt_test(au_mntflags(sb), SHWH)); -+ -+ err = -ENOMEM; -+ o = p = (void *)__get_free_page(GFP_NOFS); -+ if (unlikely(!p)) -+ goto out; -+ -+ err = 0; -+ nh = whlist->nh_num; -+ memcpy(p, AUFS_WH_PFX, AUFS_WH_PFX_LEN); -+ p += AUFS_WH_PFX_LEN; -+ for (u = 0; u < nh; u++) { -+ head = whlist->nh_head + u; -+ hlist_for_each_entry_safe(pos, n, head, wh_hash) { -+ destr = &pos->wh_str; -+ memcpy(p, destr->name, destr->len); -+ err = append_de(vdir, o, destr->len + AUFS_WH_PFX_LEN, -+ pos->wh_ino, pos->wh_type, delist); -+ if (unlikely(err)) -+ break; -+ } -+ } -+ -+ free_page((unsigned long)o); -+ -+out: -+ AuTraceErr(err); -+ return err; -+#else -+ return 0; -+#endif -+} -+ -+static int au_do_read_vdir(struct fillvdir_arg *arg) -+{ -+ int err; -+ unsigned int rdhash; -+ loff_t offset; -+ aufs_bindex_t bbot, bindex, btop; -+ unsigned char shwh; -+ struct file *hf, *file; -+ struct super_block *sb; -+ -+ file = arg->file; -+ sb = file->f_path.dentry->d_sb; -+ SiMustAnyLock(sb); -+ -+ rdhash = au_sbi(sb)->si_rdhash; -+ if (!rdhash) -+ rdhash = au_rdhash_est(au_dir_size(file, /*dentry*/NULL)); -+ err = au_nhash_alloc(&arg->delist, rdhash, GFP_NOFS); -+ if (unlikely(err)) -+ goto out; -+ err = au_nhash_alloc(&arg->whlist, rdhash, GFP_NOFS); -+ if (unlikely(err)) -+ goto out_delist; -+ -+ err = 0; -+ arg->flags = 0; -+ shwh = 0; -+ if (au_opt_test(au_mntflags(sb), SHWH)) { -+ shwh = 1; -+ au_fset_fillvdir(arg->flags, SHWH); -+ } -+ btop = au_fbtop(file); -+ bbot = au_fbbot_dir(file); -+ for (bindex = btop; !err && bindex <= bbot; bindex++) { -+ hf = au_hf_dir(file, bindex); -+ if (!hf) -+ continue; -+ -+ offset = vfsub_llseek(hf, 0, SEEK_SET); -+ err = offset; -+ if (unlikely(offset)) -+ break; -+ -+ arg->bindex = bindex; -+ au_fclr_fillvdir(arg->flags, WHABLE); -+ if (shwh -+ || (bindex != bbot -+ && au_br_whable(au_sbr_perm(sb, bindex)))) -+ au_fset_fillvdir(arg->flags, WHABLE); -+ do { -+ arg->err = 0; -+ au_fclr_fillvdir(arg->flags, CALLED); -+ /* smp_mb(); */ -+ err = vfsub_iterate_dir(hf, &arg->ctx); -+ if (err >= 0) -+ err = arg->err; -+ } while (!err && au_ftest_fillvdir(arg->flags, CALLED)); -+ -+ /* -+ * dir_relax() may be good for concurrency, but aufs should not -+ * use it since it will cause a lockdep problem. -+ */ -+ } -+ -+ if (!err && shwh) -+ err = au_handle_shwh(sb, arg->vdir, &arg->whlist, &arg->delist); -+ -+ au_nhash_wh_free(&arg->whlist); -+ -+out_delist: -+ au_nhash_de_free(&arg->delist); -+out: -+ return err; -+} -+ -+static int read_vdir(struct file *file, int may_read) -+{ -+ int err; -+ unsigned long expire; -+ unsigned char do_read; -+ struct fillvdir_arg arg = { -+ .ctx = { -+ .actor = fillvdir -+ } -+ }; -+ struct inode *inode; -+ struct au_vdir *vdir, *allocated; -+ -+ err = 0; -+ inode = file_inode(file); -+ IMustLock(inode); -+ IiMustWriteLock(inode); -+ SiMustAnyLock(inode->i_sb); -+ -+ allocated = NULL; -+ do_read = 0; -+ expire = au_sbi(inode->i_sb)->si_rdcache; -+ vdir = au_ivdir(inode); -+ if (!vdir) { -+ do_read = 1; -+ vdir = alloc_vdir(file); -+ err = PTR_ERR(vdir); -+ if (IS_ERR(vdir)) -+ goto out; -+ err = 0; -+ allocated = vdir; -+ } else if (may_read -+ && (inode->i_version != vdir->vd_version -+ || time_after(jiffies, vdir->vd_jiffy + expire))) { -+ do_read = 1; -+ err = reinit_vdir(vdir); -+ if (unlikely(err)) -+ goto out; -+ } -+ -+ if (!do_read) -+ return 0; /* success */ -+ -+ arg.file = file; -+ arg.vdir = vdir; -+ err = au_do_read_vdir(&arg); -+ if (!err) { -+ /* file->f_pos = 0; */ /* todo: ctx->pos? */ -+ vdir->vd_version = inode->i_version; -+ vdir->vd_last.ul = 0; -+ vdir->vd_last.p.deblk = vdir->vd_deblk[0]; -+ if (allocated) -+ au_set_ivdir(inode, allocated); -+ } else if (allocated) -+ au_vdir_free(allocated); -+ -+out: -+ return err; -+} -+ -+static int copy_vdir(struct au_vdir *tgt, struct au_vdir *src) -+{ -+ int err, rerr; -+ unsigned long ul, n; -+ const unsigned int deblk_sz = src->vd_deblk_sz; -+ -+ AuDebugOn(tgt->vd_nblk != 1); -+ -+ err = -ENOMEM; -+ if (tgt->vd_nblk < src->vd_nblk) { -+ unsigned char **p; -+ -+ p = au_krealloc(tgt->vd_deblk, sizeof(*p) * src->vd_nblk, -+ GFP_NOFS, /*may_shrink*/0); -+ if (unlikely(!p)) -+ goto out; -+ tgt->vd_deblk = p; -+ } -+ -+ if (tgt->vd_deblk_sz != deblk_sz) { -+ unsigned char *p; -+ -+ tgt->vd_deblk_sz = deblk_sz; -+ p = au_krealloc(tgt->vd_deblk[0], deblk_sz, GFP_NOFS, -+ /*may_shrink*/1); -+ if (unlikely(!p)) -+ goto out; -+ tgt->vd_deblk[0] = p; -+ } -+ memcpy(tgt->vd_deblk[0], src->vd_deblk[0], deblk_sz); -+ tgt->vd_version = src->vd_version; -+ tgt->vd_jiffy = src->vd_jiffy; -+ -+ n = src->vd_nblk; -+ for (ul = 1; ul < n; ul++) { -+ tgt->vd_deblk[ul] = kmemdup(src->vd_deblk[ul], deblk_sz, -+ GFP_NOFS); -+ if (unlikely(!tgt->vd_deblk[ul])) -+ goto out; -+ tgt->vd_nblk++; -+ } -+ tgt->vd_nblk = n; -+ tgt->vd_last.ul = tgt->vd_last.ul; -+ tgt->vd_last.p.deblk = tgt->vd_deblk[tgt->vd_last.ul]; -+ tgt->vd_last.p.deblk += src->vd_last.p.deblk -+ - src->vd_deblk[src->vd_last.ul]; -+ /* smp_mb(); */ -+ return 0; /* success */ -+ -+out: -+ rerr = reinit_vdir(tgt); -+ BUG_ON(rerr); -+ return err; -+} -+ -+int au_vdir_init(struct file *file) -+{ -+ int err; -+ struct inode *inode; -+ struct au_vdir *vdir_cache, *allocated; -+ -+ /* test file->f_pos here instead of ctx->pos */ -+ err = read_vdir(file, !file->f_pos); -+ if (unlikely(err)) -+ goto out; -+ -+ allocated = NULL; -+ vdir_cache = au_fvdir_cache(file); -+ if (!vdir_cache) { -+ vdir_cache = alloc_vdir(file); -+ err = PTR_ERR(vdir_cache); -+ if (IS_ERR(vdir_cache)) -+ goto out; -+ allocated = vdir_cache; -+ } else if (!file->f_pos && vdir_cache->vd_version != file->f_version) { -+ /* test file->f_pos here instead of ctx->pos */ -+ err = reinit_vdir(vdir_cache); -+ if (unlikely(err)) -+ goto out; -+ } else -+ return 0; /* success */ -+ -+ inode = file_inode(file); -+ err = copy_vdir(vdir_cache, au_ivdir(inode)); -+ if (!err) { -+ file->f_version = inode->i_version; -+ if (allocated) -+ au_set_fvdir_cache(file, allocated); -+ } else if (allocated) -+ au_vdir_free(allocated); -+ -+out: -+ return err; -+} -+ -+static loff_t calc_offset(struct au_vdir *vdir) -+{ -+ loff_t offset; -+ union au_vdir_deblk_p p; -+ -+ p.deblk = vdir->vd_deblk[vdir->vd_last.ul]; -+ offset = vdir->vd_last.p.deblk - p.deblk; -+ offset += vdir->vd_deblk_sz * vdir->vd_last.ul; -+ return offset; -+} -+ -+/* returns true or false */ -+static int seek_vdir(struct file *file, struct dir_context *ctx) -+{ -+ int valid; -+ unsigned int deblk_sz; -+ unsigned long ul, n; -+ loff_t offset; -+ union au_vdir_deblk_p p, deblk_end; -+ struct au_vdir *vdir_cache; -+ -+ valid = 1; -+ vdir_cache = au_fvdir_cache(file); -+ offset = calc_offset(vdir_cache); -+ AuDbg("offset %lld\n", offset); -+ if (ctx->pos == offset) -+ goto out; -+ -+ vdir_cache->vd_last.ul = 0; -+ vdir_cache->vd_last.p.deblk = vdir_cache->vd_deblk[0]; -+ if (!ctx->pos) -+ goto out; -+ -+ valid = 0; -+ deblk_sz = vdir_cache->vd_deblk_sz; -+ ul = div64_u64(ctx->pos, deblk_sz); -+ AuDbg("ul %lu\n", ul); -+ if (ul >= vdir_cache->vd_nblk) -+ goto out; -+ -+ n = vdir_cache->vd_nblk; -+ for (; ul < n; ul++) { -+ p.deblk = vdir_cache->vd_deblk[ul]; -+ deblk_end.deblk = p.deblk + deblk_sz; -+ offset = ul; -+ offset *= deblk_sz; -+ while (!is_deblk_end(&p, &deblk_end) && offset < ctx->pos) { -+ unsigned int l; -+ -+ l = calc_size(p.de->de_str.len); -+ offset += l; -+ p.deblk += l; -+ } -+ if (!is_deblk_end(&p, &deblk_end)) { -+ valid = 1; -+ vdir_cache->vd_last.ul = ul; -+ vdir_cache->vd_last.p = p; -+ break; -+ } -+ } -+ -+out: -+ /* smp_mb(); */ -+ AuTraceErr(!valid); -+ return valid; -+} -+ -+int au_vdir_fill_de(struct file *file, struct dir_context *ctx) -+{ -+ unsigned int l, deblk_sz; -+ union au_vdir_deblk_p deblk_end; -+ struct au_vdir *vdir_cache; -+ struct au_vdir_de *de; -+ -+ vdir_cache = au_fvdir_cache(file); -+ if (!seek_vdir(file, ctx)) -+ return 0; -+ -+ deblk_sz = vdir_cache->vd_deblk_sz; -+ while (1) { -+ deblk_end.deblk = vdir_cache->vd_deblk[vdir_cache->vd_last.ul]; -+ deblk_end.deblk += deblk_sz; -+ while (!is_deblk_end(&vdir_cache->vd_last.p, &deblk_end)) { -+ de = vdir_cache->vd_last.p.de; -+ AuDbg("%.*s, off%lld, i%lu, dt%d\n", -+ de->de_str.len, de->de_str.name, ctx->pos, -+ (unsigned long)de->de_ino, de->de_type); -+ if (unlikely(!dir_emit(ctx, de->de_str.name, -+ de->de_str.len, de->de_ino, -+ de->de_type))) { -+ /* todo: ignore the error caused by udba? */ -+ /* return err; */ -+ return 0; -+ } -+ -+ l = calc_size(de->de_str.len); -+ vdir_cache->vd_last.p.deblk += l; -+ ctx->pos += l; -+ } -+ if (vdir_cache->vd_last.ul < vdir_cache->vd_nblk - 1) { -+ vdir_cache->vd_last.ul++; -+ vdir_cache->vd_last.p.deblk -+ = vdir_cache->vd_deblk[vdir_cache->vd_last.ul]; -+ ctx->pos = deblk_sz * vdir_cache->vd_last.ul; -+ continue; -+ } -+ break; -+ } -+ -+ /* smp_mb(); */ -+ return 0; -+} -diff --git a/fs/aufs/vfsub.c b/fs/aufs/vfsub.c -new file mode 100644 -index 000000000000..f70a954d11c1 ---- /dev/null -+++ b/fs/aufs/vfsub.c -@@ -0,0 +1,882 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * sub-routines for VFS -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include "aufs.h" -+ -+#ifdef CONFIG_AUFS_BR_FUSE -+int vfsub_test_mntns(struct vfsmount *mnt, struct super_block *h_sb) -+{ -+ if (!au_test_fuse(h_sb) || !au_userns) -+ return 0; -+ -+ return is_current_mnt_ns(mnt) ? 0 : -EACCES; -+} -+#endif -+ -+int vfsub_sync_filesystem(struct super_block *h_sb, int wait) -+{ -+ int err; -+ -+ lockdep_off(); -+ down_read(&h_sb->s_umount); -+ err = __sync_filesystem(h_sb, wait); -+ up_read(&h_sb->s_umount); -+ lockdep_on(); -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int vfsub_update_h_iattr(struct path *h_path, int *did) -+{ -+ int err; -+ struct kstat st; -+ struct super_block *h_sb; -+ -+ /* for remote fs, leave work for its getattr or d_revalidate */ -+ /* for bad i_attr fs, handle them in aufs_getattr() */ -+ /* still some fs may acquire i_mutex. we need to skip them */ -+ err = 0; -+ if (!did) -+ did = &err; -+ h_sb = h_path->dentry->d_sb; -+ *did = (!au_test_fs_remote(h_sb) && au_test_fs_refresh_iattr(h_sb)); -+ if (*did) -+ err = vfsub_getattr(h_path, &st); -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct file *vfsub_dentry_open(struct path *path, int flags) -+{ -+ struct file *file; -+ -+ file = dentry_open(path, flags /* | __FMODE_NONOTIFY */, -+ current_cred()); -+ if (!IS_ERR_OR_NULL(file) -+ && (file->f_mode & (FMODE_READ | FMODE_WRITE)) == FMODE_READ) -+ i_readcount_inc(d_inode(path->dentry)); -+ -+ return file; -+} -+ -+struct file *vfsub_filp_open(const char *path, int oflags, int mode) -+{ -+ struct file *file; -+ -+ lockdep_off(); -+ file = filp_open(path, -+ oflags /* | __FMODE_NONOTIFY */, -+ mode); -+ lockdep_on(); -+ if (IS_ERR(file)) -+ goto out; -+ vfsub_update_h_iattr(&file->f_path, /*did*/NULL); /*ignore*/ -+ -+out: -+ return file; -+} -+ -+/* -+ * Ideally this function should call VFS:do_last() in order to keep all its -+ * checkings. But it is very hard for aufs to regenerate several VFS internal -+ * structure such as nameidata. This is a second (or third) best approach. -+ * cf. linux/fs/namei.c:do_last(), lookup_open() and atomic_open(). -+ */ -+int vfsub_atomic_open(struct inode *dir, struct dentry *dentry, -+ struct vfsub_aopen_args *args, struct au_branch *br) -+{ -+ int err; -+ struct file *file = args->file; -+ /* copied from linux/fs/namei.c:atomic_open() */ -+ struct dentry *const DENTRY_NOT_SET = (void *)-1UL; -+ -+ IMustLock(dir); -+ AuDebugOn(!dir->i_op->atomic_open); -+ -+ err = au_br_test_oflag(args->open_flag, br); -+ if (unlikely(err)) -+ goto out; -+ -+ args->file->f_path.dentry = DENTRY_NOT_SET; -+ args->file->f_path.mnt = au_br_mnt(br); -+ err = dir->i_op->atomic_open(dir, dentry, file, args->open_flag, -+ args->create_mode, args->opened); -+ if (err >= 0) { -+ /* some filesystems don't set FILE_CREATED while succeeded? */ -+ if (*args->opened & FILE_CREATED) -+ fsnotify_create(dir, dentry); -+ } else -+ goto out; -+ -+ -+ if (!err) { -+ /* todo: call VFS:may_open() here */ -+ err = open_check_o_direct(file); -+ /* todo: ima_file_check() too? */ -+ if (!err && (args->open_flag & __FMODE_EXEC)) -+ err = deny_write_access(file); -+ if (unlikely(err)) -+ /* note that the file is created and still opened */ -+ goto out; -+ } -+ -+ au_br_get(br); -+ fsnotify_open(file); -+ -+out: -+ return err; -+} -+ -+int vfsub_kern_path(const char *name, unsigned int flags, struct path *path) -+{ -+ int err; -+ -+ err = kern_path(name, flags, path); -+ if (!err && d_is_positive(path->dentry)) -+ vfsub_update_h_iattr(path, /*did*/NULL); /*ignore*/ -+ return err; -+} -+ -+struct dentry *vfsub_lookup_one_len_unlocked(const char *name, -+ struct dentry *parent, int len) -+{ -+ struct path path = { -+ .mnt = NULL -+ }; -+ -+ path.dentry = lookup_one_len_unlocked(name, parent, len); -+ if (IS_ERR(path.dentry)) -+ goto out; -+ if (d_is_positive(path.dentry)) -+ vfsub_update_h_iattr(&path, /*did*/NULL); /*ignore*/ -+ -+out: -+ AuTraceErrPtr(path.dentry); -+ return path.dentry; -+} -+ -+struct dentry *vfsub_lookup_one_len(const char *name, struct dentry *parent, -+ int len) -+{ -+ struct path path = { -+ .mnt = NULL -+ }; -+ -+ /* VFS checks it too, but by WARN_ON_ONCE() */ -+ IMustLock(d_inode(parent)); -+ -+ path.dentry = lookup_one_len(name, parent, len); -+ if (IS_ERR(path.dentry)) -+ goto out; -+ if (d_is_positive(path.dentry)) -+ vfsub_update_h_iattr(&path, /*did*/NULL); /*ignore*/ -+ -+out: -+ AuTraceErrPtr(path.dentry); -+ return path.dentry; -+} -+ -+void vfsub_call_lkup_one(void *args) -+{ -+ struct vfsub_lkup_one_args *a = args; -+ *a->errp = vfsub_lkup_one(a->name, a->parent); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct dentry *vfsub_lock_rename(struct dentry *d1, struct au_hinode *hdir1, -+ struct dentry *d2, struct au_hinode *hdir2) -+{ -+ struct dentry *d; -+ -+ lockdep_off(); -+ d = lock_rename(d1, d2); -+ lockdep_on(); -+ au_hn_suspend(hdir1); -+ if (hdir1 != hdir2) -+ au_hn_suspend(hdir2); -+ -+ return d; -+} -+ -+void vfsub_unlock_rename(struct dentry *d1, struct au_hinode *hdir1, -+ struct dentry *d2, struct au_hinode *hdir2) -+{ -+ au_hn_resume(hdir1); -+ if (hdir1 != hdir2) -+ au_hn_resume(hdir2); -+ lockdep_off(); -+ unlock_rename(d1, d2); -+ lockdep_on(); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int vfsub_create(struct inode *dir, struct path *path, int mode, bool want_excl) -+{ -+ int err; -+ struct dentry *d; -+ -+ IMustLock(dir); -+ -+ d = path->dentry; -+ path->dentry = d->d_parent; -+ err = security_path_mknod(path, d, mode, 0); -+ path->dentry = d; -+ if (unlikely(err)) -+ goto out; -+ -+ lockdep_off(); -+ err = vfs_create(dir, path->dentry, mode, want_excl); -+ lockdep_on(); -+ if (!err) { -+ struct path tmp = *path; -+ int did; -+ -+ vfsub_update_h_iattr(&tmp, &did); -+ if (did) { -+ tmp.dentry = path->dentry->d_parent; -+ vfsub_update_h_iattr(&tmp, /*did*/NULL); -+ } -+ /*ignore*/ -+ } -+ -+out: -+ return err; -+} -+ -+int vfsub_symlink(struct inode *dir, struct path *path, const char *symname) -+{ -+ int err; -+ struct dentry *d; -+ -+ IMustLock(dir); -+ -+ d = path->dentry; -+ path->dentry = d->d_parent; -+ err = security_path_symlink(path, d, symname); -+ path->dentry = d; -+ if (unlikely(err)) -+ goto out; -+ -+ lockdep_off(); -+ err = vfs_symlink(dir, path->dentry, symname); -+ lockdep_on(); -+ if (!err) { -+ struct path tmp = *path; -+ int did; -+ -+ vfsub_update_h_iattr(&tmp, &did); -+ if (did) { -+ tmp.dentry = path->dentry->d_parent; -+ vfsub_update_h_iattr(&tmp, /*did*/NULL); -+ } -+ /*ignore*/ -+ } -+ -+out: -+ return err; -+} -+ -+int vfsub_mknod(struct inode *dir, struct path *path, int mode, dev_t dev) -+{ -+ int err; -+ struct dentry *d; -+ -+ IMustLock(dir); -+ -+ d = path->dentry; -+ path->dentry = d->d_parent; -+ err = security_path_mknod(path, d, mode, new_encode_dev(dev)); -+ path->dentry = d; -+ if (unlikely(err)) -+ goto out; -+ -+ lockdep_off(); -+ err = vfs_mknod(dir, path->dentry, mode, dev); -+ lockdep_on(); -+ if (!err) { -+ struct path tmp = *path; -+ int did; -+ -+ vfsub_update_h_iattr(&tmp, &did); -+ if (did) { -+ tmp.dentry = path->dentry->d_parent; -+ vfsub_update_h_iattr(&tmp, /*did*/NULL); -+ } -+ /*ignore*/ -+ } -+ -+out: -+ return err; -+} -+ -+static int au_test_nlink(struct inode *inode) -+{ -+ const unsigned int link_max = UINT_MAX >> 1; /* rough margin */ -+ -+ if (!au_test_fs_no_limit_nlink(inode->i_sb) -+ || inode->i_nlink < link_max) -+ return 0; -+ return -EMLINK; -+} -+ -+int vfsub_link(struct dentry *src_dentry, struct inode *dir, struct path *path, -+ struct inode **delegated_inode) -+{ -+ int err; -+ struct dentry *d; -+ -+ IMustLock(dir); -+ -+ err = au_test_nlink(d_inode(src_dentry)); -+ if (unlikely(err)) -+ return err; -+ -+ /* we don't call may_linkat() */ -+ d = path->dentry; -+ path->dentry = d->d_parent; -+ err = security_path_link(src_dentry, path, d); -+ path->dentry = d; -+ if (unlikely(err)) -+ goto out; -+ -+ lockdep_off(); -+ err = vfs_link(src_dentry, dir, path->dentry, delegated_inode); -+ lockdep_on(); -+ if (!err) { -+ struct path tmp = *path; -+ int did; -+ -+ /* fuse has different memory inode for the same inumber */ -+ vfsub_update_h_iattr(&tmp, &did); -+ if (did) { -+ tmp.dentry = path->dentry->d_parent; -+ vfsub_update_h_iattr(&tmp, /*did*/NULL); -+ tmp.dentry = src_dentry; -+ vfsub_update_h_iattr(&tmp, /*did*/NULL); -+ } -+ /*ignore*/ -+ } -+ -+out: -+ return err; -+} -+ -+int vfsub_rename(struct inode *src_dir, struct dentry *src_dentry, -+ struct inode *dir, struct path *path, -+ struct inode **delegated_inode, unsigned int flags) -+{ -+ int err; -+ struct path tmp = { -+ .mnt = path->mnt -+ }; -+ struct dentry *d; -+ -+ IMustLock(dir); -+ IMustLock(src_dir); -+ -+ d = path->dentry; -+ path->dentry = d->d_parent; -+ tmp.dentry = src_dentry->d_parent; -+ err = security_path_rename(&tmp, src_dentry, path, d, /*flags*/0); -+ path->dentry = d; -+ if (unlikely(err)) -+ goto out; -+ -+ lockdep_off(); -+ err = vfs_rename(src_dir, src_dentry, dir, path->dentry, -+ delegated_inode, flags); -+ lockdep_on(); -+ if (!err) { -+ int did; -+ -+ tmp.dentry = d->d_parent; -+ vfsub_update_h_iattr(&tmp, &did); -+ if (did) { -+ tmp.dentry = src_dentry; -+ vfsub_update_h_iattr(&tmp, /*did*/NULL); -+ tmp.dentry = src_dentry->d_parent; -+ vfsub_update_h_iattr(&tmp, /*did*/NULL); -+ } -+ /*ignore*/ -+ } -+ -+out: -+ return err; -+} -+ -+int vfsub_mkdir(struct inode *dir, struct path *path, int mode) -+{ -+ int err; -+ struct dentry *d; -+ -+ IMustLock(dir); -+ -+ d = path->dentry; -+ path->dentry = d->d_parent; -+ err = security_path_mkdir(path, d, mode); -+ path->dentry = d; -+ if (unlikely(err)) -+ goto out; -+ -+ lockdep_off(); -+ err = vfs_mkdir(dir, path->dentry, mode); -+ lockdep_on(); -+ if (!err) { -+ struct path tmp = *path; -+ int did; -+ -+ vfsub_update_h_iattr(&tmp, &did); -+ if (did) { -+ tmp.dentry = path->dentry->d_parent; -+ vfsub_update_h_iattr(&tmp, /*did*/NULL); -+ } -+ /*ignore*/ -+ } -+ -+out: -+ return err; -+} -+ -+int vfsub_rmdir(struct inode *dir, struct path *path) -+{ -+ int err; -+ struct dentry *d; -+ -+ IMustLock(dir); -+ -+ d = path->dentry; -+ path->dentry = d->d_parent; -+ err = security_path_rmdir(path, d); -+ path->dentry = d; -+ if (unlikely(err)) -+ goto out; -+ -+ lockdep_off(); -+ err = vfs_rmdir(dir, path->dentry); -+ lockdep_on(); -+ if (!err) { -+ struct path tmp = { -+ .dentry = path->dentry->d_parent, -+ .mnt = path->mnt -+ }; -+ -+ vfsub_update_h_iattr(&tmp, /*did*/NULL); /*ignore*/ -+ } -+ -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* todo: support mmap_sem? */ -+ssize_t vfsub_read_u(struct file *file, char __user *ubuf, size_t count, -+ loff_t *ppos) -+{ -+ ssize_t err; -+ -+ lockdep_off(); -+ err = vfs_read(file, ubuf, count, ppos); -+ lockdep_on(); -+ if (err >= 0) -+ vfsub_update_h_iattr(&file->f_path, /*did*/NULL); /*ignore*/ -+ return err; -+} -+ -+/* todo: kernel_read()? */ -+ssize_t vfsub_read_k(struct file *file, void *kbuf, size_t count, -+ loff_t *ppos) -+{ -+ ssize_t err; -+ mm_segment_t oldfs; -+ union { -+ void *k; -+ char __user *u; -+ } buf; -+ -+ buf.k = kbuf; -+ oldfs = get_fs(); -+ set_fs(KERNEL_DS); -+ err = vfsub_read_u(file, buf.u, count, ppos); -+ set_fs(oldfs); -+ return err; -+} -+ -+ssize_t vfsub_write_u(struct file *file, const char __user *ubuf, size_t count, -+ loff_t *ppos) -+{ -+ ssize_t err; -+ -+ lockdep_off(); -+ err = vfs_write(file, ubuf, count, ppos); -+ lockdep_on(); -+ if (err >= 0) -+ vfsub_update_h_iattr(&file->f_path, /*did*/NULL); /*ignore*/ -+ return err; -+} -+ -+ssize_t vfsub_write_k(struct file *file, void *kbuf, size_t count, loff_t *ppos) -+{ -+ ssize_t err; -+ mm_segment_t oldfs; -+ union { -+ void *k; -+ const char __user *u; -+ } buf; -+ -+ buf.k = kbuf; -+ oldfs = get_fs(); -+ set_fs(KERNEL_DS); -+ err = vfsub_write_u(file, buf.u, count, ppos); -+ set_fs(oldfs); -+ return err; -+} -+ -+int vfsub_flush(struct file *file, fl_owner_t id) -+{ -+ int err; -+ -+ err = 0; -+ if (file->f_op->flush) { -+ if (!au_test_nfs(file->f_path.dentry->d_sb)) -+ err = file->f_op->flush(file, id); -+ else { -+ lockdep_off(); -+ err = file->f_op->flush(file, id); -+ lockdep_on(); -+ } -+ if (!err) -+ vfsub_update_h_iattr(&file->f_path, /*did*/NULL); -+ /*ignore*/ -+ } -+ return err; -+} -+ -+int vfsub_iterate_dir(struct file *file, struct dir_context *ctx) -+{ -+ int err; -+ -+ AuDbg("%pD, ctx{%pf, %llu}\n", file, ctx->actor, ctx->pos); -+ -+ lockdep_off(); -+ err = iterate_dir(file, ctx); -+ lockdep_on(); -+ if (err >= 0) -+ vfsub_update_h_iattr(&file->f_path, /*did*/NULL); /*ignore*/ -+ -+ return err; -+} -+ -+long vfsub_splice_to(struct file *in, loff_t *ppos, -+ struct pipe_inode_info *pipe, size_t len, -+ unsigned int flags) -+{ -+ long err; -+ -+ lockdep_off(); -+ err = do_splice_to(in, ppos, pipe, len, flags); -+ lockdep_on(); -+ file_accessed(in); -+ if (err >= 0) -+ vfsub_update_h_iattr(&in->f_path, /*did*/NULL); /*ignore*/ -+ return err; -+} -+ -+long vfsub_splice_from(struct pipe_inode_info *pipe, struct file *out, -+ loff_t *ppos, size_t len, unsigned int flags) -+{ -+ long err; -+ -+ lockdep_off(); -+ err = do_splice_from(pipe, out, ppos, len, flags); -+ lockdep_on(); -+ if (err >= 0) -+ vfsub_update_h_iattr(&out->f_path, /*did*/NULL); /*ignore*/ -+ return err; -+} -+ -+int vfsub_fsync(struct file *file, struct path *path, int datasync) -+{ -+ int err; -+ -+ /* file can be NULL */ -+ lockdep_off(); -+ err = vfs_fsync(file, datasync); -+ lockdep_on(); -+ if (!err) { -+ if (!path) { -+ AuDebugOn(!file); -+ path = &file->f_path; -+ } -+ vfsub_update_h_iattr(path, /*did*/NULL); /*ignore*/ -+ } -+ return err; -+} -+ -+/* cf. open.c:do_sys_truncate() and do_sys_ftruncate() */ -+int vfsub_trunc(struct path *h_path, loff_t length, unsigned int attr, -+ struct file *h_file) -+{ -+ int err; -+ struct inode *h_inode; -+ struct super_block *h_sb; -+ -+ if (!h_file) { -+ err = vfsub_truncate(h_path, length); -+ goto out; -+ } -+ -+ h_inode = d_inode(h_path->dentry); -+ h_sb = h_inode->i_sb; -+ lockdep_off(); -+ sb_start_write(h_sb); -+ lockdep_on(); -+ err = locks_verify_truncate(h_inode, h_file, length); -+ if (!err) -+ err = security_path_truncate(h_path); -+ if (!err) { -+ lockdep_off(); -+ err = do_truncate(h_path->dentry, length, attr, h_file); -+ lockdep_on(); -+ } -+ lockdep_off(); -+ sb_end_write(h_sb); -+ lockdep_on(); -+ -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct au_vfsub_mkdir_args { -+ int *errp; -+ struct inode *dir; -+ struct path *path; -+ int mode; -+}; -+ -+static void au_call_vfsub_mkdir(void *args) -+{ -+ struct au_vfsub_mkdir_args *a = args; -+ *a->errp = vfsub_mkdir(a->dir, a->path, a->mode); -+} -+ -+int vfsub_sio_mkdir(struct inode *dir, struct path *path, int mode) -+{ -+ int err, do_sio, wkq_err; -+ -+ do_sio = au_test_h_perm_sio(dir, MAY_EXEC | MAY_WRITE); -+ if (!do_sio) { -+ lockdep_off(); -+ err = vfsub_mkdir(dir, path, mode); -+ lockdep_on(); -+ } else { -+ struct au_vfsub_mkdir_args args = { -+ .errp = &err, -+ .dir = dir, -+ .path = path, -+ .mode = mode -+ }; -+ wkq_err = au_wkq_wait(au_call_vfsub_mkdir, &args); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ } -+ -+ return err; -+} -+ -+struct au_vfsub_rmdir_args { -+ int *errp; -+ struct inode *dir; -+ struct path *path; -+}; -+ -+static void au_call_vfsub_rmdir(void *args) -+{ -+ struct au_vfsub_rmdir_args *a = args; -+ *a->errp = vfsub_rmdir(a->dir, a->path); -+} -+ -+int vfsub_sio_rmdir(struct inode *dir, struct path *path) -+{ -+ int err, do_sio, wkq_err; -+ -+ do_sio = au_test_h_perm_sio(dir, MAY_EXEC | MAY_WRITE); -+ if (!do_sio) { -+ lockdep_off(); -+ err = vfsub_rmdir(dir, path); -+ lockdep_on(); -+ } else { -+ struct au_vfsub_rmdir_args args = { -+ .errp = &err, -+ .dir = dir, -+ .path = path -+ }; -+ wkq_err = au_wkq_wait(au_call_vfsub_rmdir, &args); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ } -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct notify_change_args { -+ int *errp; -+ struct path *path; -+ struct iattr *ia; -+ struct inode **delegated_inode; -+}; -+ -+static void call_notify_change(void *args) -+{ -+ struct notify_change_args *a = args; -+ struct inode *h_inode; -+ -+ h_inode = d_inode(a->path->dentry); -+ IMustLock(h_inode); -+ -+ *a->errp = -EPERM; -+ if (!IS_IMMUTABLE(h_inode) && !IS_APPEND(h_inode)) { -+ lockdep_off(); -+ *a->errp = notify_change(a->path->dentry, a->ia, -+ a->delegated_inode); -+ lockdep_on(); -+ if (!*a->errp) -+ vfsub_update_h_iattr(a->path, /*did*/NULL); /*ignore*/ -+ } -+ AuTraceErr(*a->errp); -+} -+ -+int vfsub_notify_change(struct path *path, struct iattr *ia, -+ struct inode **delegated_inode) -+{ -+ int err; -+ struct notify_change_args args = { -+ .errp = &err, -+ .path = path, -+ .ia = ia, -+ .delegated_inode = delegated_inode -+ }; -+ -+ call_notify_change(&args); -+ -+ return err; -+} -+ -+int vfsub_sio_notify_change(struct path *path, struct iattr *ia, -+ struct inode **delegated_inode) -+{ -+ int err, wkq_err; -+ struct notify_change_args args = { -+ .errp = &err, -+ .path = path, -+ .ia = ia, -+ .delegated_inode = delegated_inode -+ }; -+ -+ wkq_err = au_wkq_wait(call_notify_change, &args); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct unlink_args { -+ int *errp; -+ struct inode *dir; -+ struct path *path; -+ struct inode **delegated_inode; -+}; -+ -+static void call_unlink(void *args) -+{ -+ struct unlink_args *a = args; -+ struct dentry *d = a->path->dentry; -+ struct inode *h_inode; -+ const int stop_sillyrename = (au_test_nfs(d->d_sb) -+ && au_dcount(d) == 1); -+ -+ IMustLock(a->dir); -+ -+ a->path->dentry = d->d_parent; -+ *a->errp = security_path_unlink(a->path, d); -+ a->path->dentry = d; -+ if (unlikely(*a->errp)) -+ return; -+ -+ if (!stop_sillyrename) -+ dget(d); -+ h_inode = NULL; -+ if (d_is_positive(d)) { -+ h_inode = d_inode(d); -+ ihold(h_inode); -+ } -+ -+ lockdep_off(); -+ *a->errp = vfs_unlink(a->dir, d, a->delegated_inode); -+ lockdep_on(); -+ if (!*a->errp) { -+ struct path tmp = { -+ .dentry = d->d_parent, -+ .mnt = a->path->mnt -+ }; -+ vfsub_update_h_iattr(&tmp, /*did*/NULL); /*ignore*/ -+ } -+ -+ if (!stop_sillyrename) -+ dput(d); -+ if (h_inode) -+ iput(h_inode); -+ -+ AuTraceErr(*a->errp); -+} -+ -+/* -+ * @dir: must be locked. -+ * @dentry: target dentry. -+ */ -+int vfsub_unlink(struct inode *dir, struct path *path, -+ struct inode **delegated_inode, int force) -+{ -+ int err; -+ struct unlink_args args = { -+ .errp = &err, -+ .dir = dir, -+ .path = path, -+ .delegated_inode = delegated_inode -+ }; -+ -+ if (!force) -+ call_unlink(&args); -+ else { -+ int wkq_err; -+ -+ wkq_err = au_wkq_wait(call_unlink, &args); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ } -+ -+ return err; -+} -diff --git a/fs/aufs/vfsub.h b/fs/aufs/vfsub.h -new file mode 100644 -index 000000000000..85739f295e07 ---- /dev/null -+++ b/fs/aufs/vfsub.h -@@ -0,0 +1,348 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * sub-routines for VFS -+ */ -+ -+#ifndef __AUFS_VFSUB_H__ -+#define __AUFS_VFSUB_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+#include -+#include -+#include -+#include "debug.h" -+ -+/* copied from linux/fs/internal.h */ -+/* todo: BAD approach!! */ -+extern void __mnt_drop_write(struct vfsmount *); -+extern int open_check_o_direct(struct file *f); -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* lock subclass for lower inode */ -+/* default MAX_LOCKDEP_SUBCLASSES(8) is not enough */ -+/* reduce? gave up. */ -+enum { -+ AuLsc_I_Begin = I_MUTEX_PARENT2, /* 5 */ -+ AuLsc_I_PARENT, /* lower inode, parent first */ -+ AuLsc_I_PARENT2, /* copyup dirs */ -+ AuLsc_I_PARENT3, /* copyup wh */ -+ AuLsc_I_CHILD, -+ AuLsc_I_CHILD2, -+ AuLsc_I_End -+}; -+ -+/* to debug easier, do not make them inlined functions */ -+#define MtxMustLock(mtx) AuDebugOn(!mutex_is_locked(mtx)) -+#define IMustLock(i) AuDebugOn(!inode_is_locked(i)) -+ -+/* why VFS doesn't define it? */ -+static inline -+void vfsub_inode_lock_shared_nested(struct inode *inode, unsigned int sc) -+{ -+ down_read_nested(&inode->i_rwsem, sc); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline void vfsub_drop_nlink(struct inode *inode) -+{ -+ AuDebugOn(!inode->i_nlink); -+ drop_nlink(inode); -+} -+ -+static inline void vfsub_dead_dir(struct inode *inode) -+{ -+ AuDebugOn(!S_ISDIR(inode->i_mode)); -+ inode->i_flags |= S_DEAD; -+ clear_nlink(inode); -+} -+ -+static inline int vfsub_native_ro(struct inode *inode) -+{ -+ return sb_rdonly(inode->i_sb) -+ || IS_RDONLY(inode) -+ /* || IS_APPEND(inode) */ -+ || IS_IMMUTABLE(inode); -+} -+ -+#ifdef CONFIG_AUFS_BR_FUSE -+int vfsub_test_mntns(struct vfsmount *mnt, struct super_block *h_sb); -+#else -+AuStubInt0(vfsub_test_mntns, struct vfsmount *mnt, struct super_block *h_sb); -+#endif -+ -+int vfsub_sync_filesystem(struct super_block *h_sb, int wait); -+ -+/* ---------------------------------------------------------------------- */ -+ -+int vfsub_update_h_iattr(struct path *h_path, int *did); -+struct file *vfsub_dentry_open(struct path *path, int flags); -+struct file *vfsub_filp_open(const char *path, int oflags, int mode); -+struct vfsub_aopen_args { -+ struct file *file; -+ unsigned int open_flag; -+ umode_t create_mode; -+ int *opened; -+}; -+struct au_branch; -+int vfsub_atomic_open(struct inode *dir, struct dentry *dentry, -+ struct vfsub_aopen_args *args, struct au_branch *br); -+int vfsub_kern_path(const char *name, unsigned int flags, struct path *path); -+ -+struct dentry *vfsub_lookup_one_len_unlocked(const char *name, -+ struct dentry *parent, int len); -+struct dentry *vfsub_lookup_one_len(const char *name, struct dentry *parent, -+ int len); -+ -+struct vfsub_lkup_one_args { -+ struct dentry **errp; -+ struct qstr *name; -+ struct dentry *parent; -+}; -+ -+static inline struct dentry *vfsub_lkup_one(struct qstr *name, -+ struct dentry *parent) -+{ -+ return vfsub_lookup_one_len(name->name, parent, name->len); -+} -+ -+void vfsub_call_lkup_one(void *args); -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline int vfsub_mnt_want_write(struct vfsmount *mnt) -+{ -+ int err; -+ -+ lockdep_off(); -+ err = mnt_want_write(mnt); -+ lockdep_on(); -+ return err; -+} -+ -+static inline void vfsub_mnt_drop_write(struct vfsmount *mnt) -+{ -+ lockdep_off(); -+ mnt_drop_write(mnt); -+ lockdep_on(); -+} -+ -+#if 0 /* reserved */ -+static inline void vfsub_mnt_drop_write_file(struct file *file) -+{ -+ lockdep_off(); -+ mnt_drop_write_file(file); -+ lockdep_on(); -+} -+#endif -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct au_hinode; -+struct dentry *vfsub_lock_rename(struct dentry *d1, struct au_hinode *hdir1, -+ struct dentry *d2, struct au_hinode *hdir2); -+void vfsub_unlock_rename(struct dentry *d1, struct au_hinode *hdir1, -+ struct dentry *d2, struct au_hinode *hdir2); -+ -+int vfsub_create(struct inode *dir, struct path *path, int mode, -+ bool want_excl); -+int vfsub_symlink(struct inode *dir, struct path *path, -+ const char *symname); -+int vfsub_mknod(struct inode *dir, struct path *path, int mode, dev_t dev); -+int vfsub_link(struct dentry *src_dentry, struct inode *dir, -+ struct path *path, struct inode **delegated_inode); -+int vfsub_rename(struct inode *src_hdir, struct dentry *src_dentry, -+ struct inode *hdir, struct path *path, -+ struct inode **delegated_inode, unsigned int flags); -+int vfsub_mkdir(struct inode *dir, struct path *path, int mode); -+int vfsub_rmdir(struct inode *dir, struct path *path); -+ -+/* ---------------------------------------------------------------------- */ -+ -+ssize_t vfsub_read_u(struct file *file, char __user *ubuf, size_t count, -+ loff_t *ppos); -+ssize_t vfsub_read_k(struct file *file, void *kbuf, size_t count, -+ loff_t *ppos); -+ssize_t vfsub_write_u(struct file *file, const char __user *ubuf, size_t count, -+ loff_t *ppos); -+ssize_t vfsub_write_k(struct file *file, void *kbuf, size_t count, -+ loff_t *ppos); -+int vfsub_flush(struct file *file, fl_owner_t id); -+int vfsub_iterate_dir(struct file *file, struct dir_context *ctx); -+ -+static inline loff_t vfsub_f_size_read(struct file *file) -+{ -+ return i_size_read(file_inode(file)); -+} -+ -+static inline unsigned int vfsub_file_flags(struct file *file) -+{ -+ unsigned int flags; -+ -+ spin_lock(&file->f_lock); -+ flags = file->f_flags; -+ spin_unlock(&file->f_lock); -+ -+ return flags; -+} -+ -+static inline int vfsub_file_execed(struct file *file) -+{ -+ /* todo: direct access f_flags */ -+ return !!(vfsub_file_flags(file) & __FMODE_EXEC); -+} -+ -+#if 0 /* reserved */ -+static inline void vfsub_file_accessed(struct file *h_file) -+{ -+ file_accessed(h_file); -+ vfsub_update_h_iattr(&h_file->f_path, /*did*/NULL); /*ignore*/ -+} -+#endif -+ -+#if 0 /* reserved */ -+static inline void vfsub_touch_atime(struct vfsmount *h_mnt, -+ struct dentry *h_dentry) -+{ -+ struct path h_path = { -+ .dentry = h_dentry, -+ .mnt = h_mnt -+ }; -+ touch_atime(&h_path); -+ vfsub_update_h_iattr(&h_path, /*did*/NULL); /*ignore*/ -+} -+#endif -+ -+static inline int vfsub_update_time(struct inode *h_inode, struct timespec *ts, -+ int flags) -+{ -+ return update_time(h_inode, ts, flags); -+ /* no vfsub_update_h_iattr() since we don't have struct path */ -+} -+ -+#ifdef CONFIG_FS_POSIX_ACL -+static inline int vfsub_acl_chmod(struct inode *h_inode, umode_t h_mode) -+{ -+ int err; -+ -+ err = posix_acl_chmod(h_inode, h_mode); -+ if (err == -EOPNOTSUPP) -+ err = 0; -+ return err; -+} -+#else -+AuStubInt0(vfsub_acl_chmod, struct inode *h_inode, umode_t h_mode); -+#endif -+ -+long vfsub_splice_to(struct file *in, loff_t *ppos, -+ struct pipe_inode_info *pipe, size_t len, -+ unsigned int flags); -+long vfsub_splice_from(struct pipe_inode_info *pipe, struct file *out, -+ loff_t *ppos, size_t len, unsigned int flags); -+ -+static inline long vfsub_truncate(struct path *path, loff_t length) -+{ -+ long err; -+ -+ lockdep_off(); -+ err = vfs_truncate(path, length); -+ lockdep_on(); -+ return err; -+} -+ -+int vfsub_trunc(struct path *h_path, loff_t length, unsigned int attr, -+ struct file *h_file); -+int vfsub_fsync(struct file *file, struct path *path, int datasync); -+ -+/* -+ * re-use branch fs's ioctl(FICLONE) while aufs itself doesn't support such -+ * ioctl. -+ */ -+static inline int vfsub_clone_file_range(struct file *src, struct file *dst, -+ u64 len) -+{ -+ int err; -+ -+ lockdep_off(); -+ err = vfs_clone_file_range(src, 0, dst, 0, len); -+ lockdep_on(); -+ -+ return err; -+} -+ -+/* copy_file_range(2) is a systemcall */ -+static inline ssize_t vfsub_copy_file_range(struct file *src, loff_t src_pos, -+ struct file *dst, loff_t dst_pos, -+ size_t len, unsigned int flags) -+{ -+ ssize_t ssz; -+ -+ lockdep_off(); -+ ssz = vfs_copy_file_range(src, src_pos, dst, dst_pos, len, flags); -+ lockdep_on(); -+ -+ return ssz; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline loff_t vfsub_llseek(struct file *file, loff_t offset, int origin) -+{ -+ loff_t err; -+ -+ lockdep_off(); -+ err = vfs_llseek(file, offset, origin); -+ lockdep_on(); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int vfsub_sio_mkdir(struct inode *dir, struct path *path, int mode); -+int vfsub_sio_rmdir(struct inode *dir, struct path *path); -+int vfsub_sio_notify_change(struct path *path, struct iattr *ia, -+ struct inode **delegated_inode); -+int vfsub_notify_change(struct path *path, struct iattr *ia, -+ struct inode **delegated_inode); -+int vfsub_unlink(struct inode *dir, struct path *path, -+ struct inode **delegated_inode, int force); -+ -+static inline int vfsub_getattr(const struct path *path, struct kstat *st) -+{ -+ return vfs_getattr(path, st, STATX_BASIC_STATS, AT_STATX_SYNC_AS_STAT); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline int vfsub_setxattr(struct dentry *dentry, const char *name, -+ const void *value, size_t size, int flags) -+{ -+ int err; -+ -+ lockdep_off(); -+ err = vfs_setxattr(dentry, name, value, size, flags); -+ lockdep_on(); -+ -+ return err; -+} -+ -+static inline int vfsub_removexattr(struct dentry *dentry, const char *name) -+{ -+ int err; -+ -+ lockdep_off(); -+ err = vfs_removexattr(dentry, name); -+ lockdep_on(); -+ -+ return err; -+} -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_VFSUB_H__ */ -diff --git a/fs/aufs/wbr_policy.c b/fs/aufs/wbr_policy.c -new file mode 100644 -index 000000000000..c18e0dc4d236 ---- /dev/null -+++ b/fs/aufs/wbr_policy.c -@@ -0,0 +1,818 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * policies for selecting one among multiple writable branches -+ */ -+ -+#include -+#include "aufs.h" -+ -+/* subset of cpup_attr() */ -+static noinline_for_stack -+int au_cpdown_attr(struct path *h_path, struct dentry *h_src) -+{ -+ int err, sbits; -+ struct iattr ia; -+ struct inode *h_isrc; -+ -+ h_isrc = d_inode(h_src); -+ ia.ia_valid = ATTR_FORCE | ATTR_MODE | ATTR_UID | ATTR_GID; -+ ia.ia_mode = h_isrc->i_mode; -+ ia.ia_uid = h_isrc->i_uid; -+ ia.ia_gid = h_isrc->i_gid; -+ sbits = !!(ia.ia_mode & (S_ISUID | S_ISGID)); -+ au_cpup_attr_flags(d_inode(h_path->dentry), h_isrc->i_flags); -+ /* no delegation since it is just created */ -+ err = vfsub_sio_notify_change(h_path, &ia, /*delegated*/NULL); -+ -+ /* is this nfs only? */ -+ if (!err && sbits && au_test_nfs(h_path->dentry->d_sb)) { -+ ia.ia_valid = ATTR_FORCE | ATTR_MODE; -+ ia.ia_mode = h_isrc->i_mode; -+ err = vfsub_sio_notify_change(h_path, &ia, /*delegated*/NULL); -+ } -+ -+ return err; -+} -+ -+#define AuCpdown_PARENT_OPQ 1 -+#define AuCpdown_WHED (1 << 1) -+#define AuCpdown_MADE_DIR (1 << 2) -+#define AuCpdown_DIROPQ (1 << 3) -+#define au_ftest_cpdown(flags, name) ((flags) & AuCpdown_##name) -+#define au_fset_cpdown(flags, name) \ -+ do { (flags) |= AuCpdown_##name; } while (0) -+#define au_fclr_cpdown(flags, name) \ -+ do { (flags) &= ~AuCpdown_##name; } while (0) -+ -+static int au_cpdown_dir_opq(struct dentry *dentry, aufs_bindex_t bdst, -+ unsigned int *flags) -+{ -+ int err; -+ struct dentry *opq_dentry; -+ -+ opq_dentry = au_diropq_create(dentry, bdst); -+ err = PTR_ERR(opq_dentry); -+ if (IS_ERR(opq_dentry)) -+ goto out; -+ dput(opq_dentry); -+ au_fset_cpdown(*flags, DIROPQ); -+ -+out: -+ return err; -+} -+ -+static int au_cpdown_dir_wh(struct dentry *dentry, struct dentry *h_parent, -+ struct inode *dir, aufs_bindex_t bdst) -+{ -+ int err; -+ struct path h_path; -+ struct au_branch *br; -+ -+ br = au_sbr(dentry->d_sb, bdst); -+ h_path.dentry = au_wh_lkup(h_parent, &dentry->d_name, br); -+ err = PTR_ERR(h_path.dentry); -+ if (IS_ERR(h_path.dentry)) -+ goto out; -+ -+ err = 0; -+ if (d_is_positive(h_path.dentry)) { -+ h_path.mnt = au_br_mnt(br); -+ err = au_wh_unlink_dentry(au_h_iptr(dir, bdst), &h_path, -+ dentry); -+ } -+ dput(h_path.dentry); -+ -+out: -+ return err; -+} -+ -+static int au_cpdown_dir(struct dentry *dentry, aufs_bindex_t bdst, -+ struct au_pin *pin, -+ struct dentry *h_parent, void *arg) -+{ -+ int err, rerr; -+ aufs_bindex_t bopq, btop; -+ struct path h_path; -+ struct dentry *parent; -+ struct inode *h_dir, *h_inode, *inode, *dir; -+ unsigned int *flags = arg; -+ -+ btop = au_dbtop(dentry); -+ /* dentry is di-locked */ -+ parent = dget_parent(dentry); -+ dir = d_inode(parent); -+ h_dir = d_inode(h_parent); -+ AuDebugOn(h_dir != au_h_iptr(dir, bdst)); -+ IMustLock(h_dir); -+ -+ err = au_lkup_neg(dentry, bdst, /*wh*/0); -+ if (unlikely(err < 0)) -+ goto out; -+ h_path.dentry = au_h_dptr(dentry, bdst); -+ h_path.mnt = au_sbr_mnt(dentry->d_sb, bdst); -+ err = vfsub_sio_mkdir(au_h_iptr(dir, bdst), &h_path, -+ S_IRWXU | S_IRUGO | S_IXUGO); -+ if (unlikely(err)) -+ goto out_put; -+ au_fset_cpdown(*flags, MADE_DIR); -+ -+ bopq = au_dbdiropq(dentry); -+ au_fclr_cpdown(*flags, WHED); -+ au_fclr_cpdown(*flags, DIROPQ); -+ if (au_dbwh(dentry) == bdst) -+ au_fset_cpdown(*flags, WHED); -+ if (!au_ftest_cpdown(*flags, PARENT_OPQ) && bopq <= bdst) -+ au_fset_cpdown(*flags, PARENT_OPQ); -+ h_inode = d_inode(h_path.dentry); -+ inode_lock_nested(h_inode, AuLsc_I_CHILD); -+ if (au_ftest_cpdown(*flags, WHED)) { -+ err = au_cpdown_dir_opq(dentry, bdst, flags); -+ if (unlikely(err)) { -+ inode_unlock(h_inode); -+ goto out_dir; -+ } -+ } -+ -+ err = au_cpdown_attr(&h_path, au_h_dptr(dentry, btop)); -+ inode_unlock(h_inode); -+ if (unlikely(err)) -+ goto out_opq; -+ -+ if (au_ftest_cpdown(*flags, WHED)) { -+ err = au_cpdown_dir_wh(dentry, h_parent, dir, bdst); -+ if (unlikely(err)) -+ goto out_opq; -+ } -+ -+ inode = d_inode(dentry); -+ if (au_ibbot(inode) < bdst) -+ au_set_ibbot(inode, bdst); -+ au_set_h_iptr(inode, bdst, au_igrab(h_inode), -+ au_hi_flags(inode, /*isdir*/1)); -+ au_fhsm_wrote(dentry->d_sb, bdst, /*force*/0); -+ goto out; /* success */ -+ -+ /* revert */ -+out_opq: -+ if (au_ftest_cpdown(*flags, DIROPQ)) { -+ inode_lock_nested(h_inode, AuLsc_I_CHILD); -+ rerr = au_diropq_remove(dentry, bdst); -+ inode_unlock(h_inode); -+ if (unlikely(rerr)) { -+ AuIOErr("failed removing diropq for %pd b%d (%d)\n", -+ dentry, bdst, rerr); -+ err = -EIO; -+ goto out; -+ } -+ } -+out_dir: -+ if (au_ftest_cpdown(*flags, MADE_DIR)) { -+ rerr = vfsub_sio_rmdir(au_h_iptr(dir, bdst), &h_path); -+ if (unlikely(rerr)) { -+ AuIOErr("failed removing %pd b%d (%d)\n", -+ dentry, bdst, rerr); -+ err = -EIO; -+ } -+ } -+out_put: -+ au_set_h_dptr(dentry, bdst, NULL); -+ if (au_dbbot(dentry) == bdst) -+ au_update_dbbot(dentry); -+out: -+ dput(parent); -+ return err; -+} -+ -+int au_cpdown_dirs(struct dentry *dentry, aufs_bindex_t bdst) -+{ -+ int err; -+ unsigned int flags; -+ -+ flags = 0; -+ err = au_cp_dirs(dentry, bdst, au_cpdown_dir, &flags); -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* policies for create */ -+ -+int au_wbr_nonopq(struct dentry *dentry, aufs_bindex_t bindex) -+{ -+ int err, i, j, ndentry; -+ aufs_bindex_t bopq; -+ struct au_dcsub_pages dpages; -+ struct au_dpage *dpage; -+ struct dentry **dentries, *parent, *d; -+ -+ err = au_dpages_init(&dpages, GFP_NOFS); -+ if (unlikely(err)) -+ goto out; -+ parent = dget_parent(dentry); -+ err = au_dcsub_pages_rev_aufs(&dpages, parent, /*do_include*/0); -+ if (unlikely(err)) -+ goto out_free; -+ -+ err = bindex; -+ for (i = 0; i < dpages.ndpage; i++) { -+ dpage = dpages.dpages + i; -+ dentries = dpage->dentries; -+ ndentry = dpage->ndentry; -+ for (j = 0; j < ndentry; j++) { -+ d = dentries[j]; -+ di_read_lock_parent2(d, !AuLock_IR); -+ bopq = au_dbdiropq(d); -+ di_read_unlock(d, !AuLock_IR); -+ if (bopq >= 0 && bopq < err) -+ err = bopq; -+ } -+ } -+ -+out_free: -+ dput(parent); -+ au_dpages_free(&dpages); -+out: -+ return err; -+} -+ -+static int au_wbr_bu(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ for (; bindex >= 0; bindex--) -+ if (!au_br_rdonly(au_sbr(sb, bindex))) -+ return bindex; -+ return -EROFS; -+} -+ -+/* top down parent */ -+static int au_wbr_create_tdp(struct dentry *dentry, -+ unsigned int flags __maybe_unused) -+{ -+ int err; -+ aufs_bindex_t btop, bindex; -+ struct super_block *sb; -+ struct dentry *parent, *h_parent; -+ -+ sb = dentry->d_sb; -+ btop = au_dbtop(dentry); -+ err = btop; -+ if (!au_br_rdonly(au_sbr(sb, btop))) -+ goto out; -+ -+ err = -EROFS; -+ parent = dget_parent(dentry); -+ for (bindex = au_dbtop(parent); bindex < btop; bindex++) { -+ h_parent = au_h_dptr(parent, bindex); -+ if (!h_parent || d_is_negative(h_parent)) -+ continue; -+ -+ if (!au_br_rdonly(au_sbr(sb, bindex))) { -+ err = bindex; -+ break; -+ } -+ } -+ dput(parent); -+ -+ /* bottom up here */ -+ if (unlikely(err < 0)) { -+ err = au_wbr_bu(sb, btop - 1); -+ if (err >= 0) -+ err = au_wbr_nonopq(dentry, err); -+ } -+ -+out: -+ AuDbg("b%d\n", err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* an exception for the policy other than tdp */ -+static int au_wbr_create_exp(struct dentry *dentry) -+{ -+ int err; -+ aufs_bindex_t bwh, bdiropq; -+ struct dentry *parent; -+ -+ err = -1; -+ bwh = au_dbwh(dentry); -+ parent = dget_parent(dentry); -+ bdiropq = au_dbdiropq(parent); -+ if (bwh >= 0) { -+ if (bdiropq >= 0) -+ err = min(bdiropq, bwh); -+ else -+ err = bwh; -+ AuDbg("%d\n", err); -+ } else if (bdiropq >= 0) { -+ err = bdiropq; -+ AuDbg("%d\n", err); -+ } -+ dput(parent); -+ -+ if (err >= 0) -+ err = au_wbr_nonopq(dentry, err); -+ -+ if (err >= 0 && au_br_rdonly(au_sbr(dentry->d_sb, err))) -+ err = -1; -+ -+ AuDbg("%d\n", err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* round robin */ -+static int au_wbr_create_init_rr(struct super_block *sb) -+{ -+ int err; -+ -+ err = au_wbr_bu(sb, au_sbbot(sb)); -+ atomic_set(&au_sbi(sb)->si_wbr_rr_next, -err); /* less important */ -+ /* smp_mb(); */ -+ -+ AuDbg("b%d\n", err); -+ return err; -+} -+ -+static int au_wbr_create_rr(struct dentry *dentry, unsigned int flags) -+{ -+ int err, nbr; -+ unsigned int u; -+ aufs_bindex_t bindex, bbot; -+ struct super_block *sb; -+ atomic_t *next; -+ -+ err = au_wbr_create_exp(dentry); -+ if (err >= 0) -+ goto out; -+ -+ sb = dentry->d_sb; -+ next = &au_sbi(sb)->si_wbr_rr_next; -+ bbot = au_sbbot(sb); -+ nbr = bbot + 1; -+ for (bindex = 0; bindex <= bbot; bindex++) { -+ if (!au_ftest_wbr(flags, DIR)) { -+ err = atomic_dec_return(next) + 1; -+ /* modulo for 0 is meaningless */ -+ if (unlikely(!err)) -+ err = atomic_dec_return(next) + 1; -+ } else -+ err = atomic_read(next); -+ AuDbg("%d\n", err); -+ u = err; -+ err = u % nbr; -+ AuDbg("%d\n", err); -+ if (!au_br_rdonly(au_sbr(sb, err))) -+ break; -+ err = -EROFS; -+ } -+ -+ if (err >= 0) -+ err = au_wbr_nonopq(dentry, err); -+ -+out: -+ AuDbg("%d\n", err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* most free space */ -+static void au_mfs(struct dentry *dentry, struct dentry *parent) -+{ -+ struct super_block *sb; -+ struct au_branch *br; -+ struct au_wbr_mfs *mfs; -+ struct dentry *h_parent; -+ aufs_bindex_t bindex, bbot; -+ int err; -+ unsigned long long b, bavail; -+ struct path h_path; -+ /* reduce the stack usage */ -+ struct kstatfs *st; -+ -+ st = kmalloc(sizeof(*st), GFP_NOFS); -+ if (unlikely(!st)) { -+ AuWarn1("failed updating mfs(%d), ignored\n", -ENOMEM); -+ return; -+ } -+ -+ bavail = 0; -+ sb = dentry->d_sb; -+ mfs = &au_sbi(sb)->si_wbr_mfs; -+ MtxMustLock(&mfs->mfs_lock); -+ mfs->mfs_bindex = -EROFS; -+ mfs->mfsrr_bytes = 0; -+ if (!parent) { -+ bindex = 0; -+ bbot = au_sbbot(sb); -+ } else { -+ bindex = au_dbtop(parent); -+ bbot = au_dbtaildir(parent); -+ } -+ -+ for (; bindex <= bbot; bindex++) { -+ if (parent) { -+ h_parent = au_h_dptr(parent, bindex); -+ if (!h_parent || d_is_negative(h_parent)) -+ continue; -+ } -+ br = au_sbr(sb, bindex); -+ if (au_br_rdonly(br)) -+ continue; -+ -+ /* sb->s_root for NFS is unreliable */ -+ h_path.mnt = au_br_mnt(br); -+ h_path.dentry = h_path.mnt->mnt_root; -+ err = vfs_statfs(&h_path, st); -+ if (unlikely(err)) { -+ AuWarn1("failed statfs, b%d, %d\n", bindex, err); -+ continue; -+ } -+ -+ /* when the available size is equal, select the lower one */ -+ BUILD_BUG_ON(sizeof(b) < sizeof(st->f_bavail) -+ || sizeof(b) < sizeof(st->f_bsize)); -+ b = st->f_bavail * st->f_bsize; -+ br->br_wbr->wbr_bytes = b; -+ if (b >= bavail) { -+ bavail = b; -+ mfs->mfs_bindex = bindex; -+ mfs->mfs_jiffy = jiffies; -+ } -+ } -+ -+ mfs->mfsrr_bytes = bavail; -+ AuDbg("b%d\n", mfs->mfs_bindex); -+ kfree(st); -+} -+ -+static int au_wbr_create_mfs(struct dentry *dentry, unsigned int flags) -+{ -+ int err; -+ struct dentry *parent; -+ struct super_block *sb; -+ struct au_wbr_mfs *mfs; -+ -+ err = au_wbr_create_exp(dentry); -+ if (err >= 0) -+ goto out; -+ -+ sb = dentry->d_sb; -+ parent = NULL; -+ if (au_ftest_wbr(flags, PARENT)) -+ parent = dget_parent(dentry); -+ mfs = &au_sbi(sb)->si_wbr_mfs; -+ mutex_lock(&mfs->mfs_lock); -+ if (time_after(jiffies, mfs->mfs_jiffy + mfs->mfs_expire) -+ || mfs->mfs_bindex < 0 -+ || au_br_rdonly(au_sbr(sb, mfs->mfs_bindex))) -+ au_mfs(dentry, parent); -+ mutex_unlock(&mfs->mfs_lock); -+ err = mfs->mfs_bindex; -+ dput(parent); -+ -+ if (err >= 0) -+ err = au_wbr_nonopq(dentry, err); -+ -+out: -+ AuDbg("b%d\n", err); -+ return err; -+} -+ -+static int au_wbr_create_init_mfs(struct super_block *sb) -+{ -+ struct au_wbr_mfs *mfs; -+ -+ mfs = &au_sbi(sb)->si_wbr_mfs; -+ mutex_init(&mfs->mfs_lock); -+ mfs->mfs_jiffy = 0; -+ mfs->mfs_bindex = -EROFS; -+ -+ return 0; -+} -+ -+static int au_wbr_create_fin_mfs(struct super_block *sb __maybe_unused) -+{ -+ mutex_destroy(&au_sbi(sb)->si_wbr_mfs.mfs_lock); -+ return 0; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* top down regardless parent, and then mfs */ -+static int au_wbr_create_tdmfs(struct dentry *dentry, -+ unsigned int flags __maybe_unused) -+{ -+ int err; -+ aufs_bindex_t bwh, btail, bindex, bfound, bmfs; -+ unsigned long long watermark; -+ struct super_block *sb; -+ struct au_wbr_mfs *mfs; -+ struct au_branch *br; -+ struct dentry *parent; -+ -+ sb = dentry->d_sb; -+ mfs = &au_sbi(sb)->si_wbr_mfs; -+ mutex_lock(&mfs->mfs_lock); -+ if (time_after(jiffies, mfs->mfs_jiffy + mfs->mfs_expire) -+ || mfs->mfs_bindex < 0) -+ au_mfs(dentry, /*parent*/NULL); -+ watermark = mfs->mfsrr_watermark; -+ bmfs = mfs->mfs_bindex; -+ mutex_unlock(&mfs->mfs_lock); -+ -+ /* another style of au_wbr_create_exp() */ -+ bwh = au_dbwh(dentry); -+ parent = dget_parent(dentry); -+ btail = au_dbtaildir(parent); -+ if (bwh >= 0 && bwh < btail) -+ btail = bwh; -+ -+ err = au_wbr_nonopq(dentry, btail); -+ if (unlikely(err < 0)) -+ goto out; -+ btail = err; -+ bfound = -1; -+ for (bindex = 0; bindex <= btail; bindex++) { -+ br = au_sbr(sb, bindex); -+ if (au_br_rdonly(br)) -+ continue; -+ if (br->br_wbr->wbr_bytes > watermark) { -+ bfound = bindex; -+ break; -+ } -+ } -+ err = bfound; -+ if (err < 0) -+ err = bmfs; -+ -+out: -+ dput(parent); -+ AuDbg("b%d\n", err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* most free space and then round robin */ -+static int au_wbr_create_mfsrr(struct dentry *dentry, unsigned int flags) -+{ -+ int err; -+ struct au_wbr_mfs *mfs; -+ -+ err = au_wbr_create_mfs(dentry, flags); -+ if (err >= 0) { -+ mfs = &au_sbi(dentry->d_sb)->si_wbr_mfs; -+ mutex_lock(&mfs->mfs_lock); -+ if (mfs->mfsrr_bytes < mfs->mfsrr_watermark) -+ err = au_wbr_create_rr(dentry, flags); -+ mutex_unlock(&mfs->mfs_lock); -+ } -+ -+ AuDbg("b%d\n", err); -+ return err; -+} -+ -+static int au_wbr_create_init_mfsrr(struct super_block *sb) -+{ -+ int err; -+ -+ au_wbr_create_init_mfs(sb); /* ignore */ -+ err = au_wbr_create_init_rr(sb); -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* top down parent and most free space */ -+static int au_wbr_create_pmfs(struct dentry *dentry, unsigned int flags) -+{ -+ int err, e2; -+ unsigned long long b; -+ aufs_bindex_t bindex, btop, bbot; -+ struct super_block *sb; -+ struct dentry *parent, *h_parent; -+ struct au_branch *br; -+ -+ err = au_wbr_create_tdp(dentry, flags); -+ if (unlikely(err < 0)) -+ goto out; -+ parent = dget_parent(dentry); -+ btop = au_dbtop(parent); -+ bbot = au_dbtaildir(parent); -+ if (btop == bbot) -+ goto out_parent; /* success */ -+ -+ e2 = au_wbr_create_mfs(dentry, flags); -+ if (e2 < 0) -+ goto out_parent; /* success */ -+ -+ /* when the available size is equal, select upper one */ -+ sb = dentry->d_sb; -+ br = au_sbr(sb, err); -+ b = br->br_wbr->wbr_bytes; -+ AuDbg("b%d, %llu\n", err, b); -+ -+ for (bindex = btop; bindex <= bbot; bindex++) { -+ h_parent = au_h_dptr(parent, bindex); -+ if (!h_parent || d_is_negative(h_parent)) -+ continue; -+ -+ br = au_sbr(sb, bindex); -+ if (!au_br_rdonly(br) && br->br_wbr->wbr_bytes > b) { -+ b = br->br_wbr->wbr_bytes; -+ err = bindex; -+ AuDbg("b%d, %llu\n", err, b); -+ } -+ } -+ -+ if (err >= 0) -+ err = au_wbr_nonopq(dentry, err); -+ -+out_parent: -+ dput(parent); -+out: -+ AuDbg("b%d\n", err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * - top down parent -+ * - most free space with parent -+ * - most free space round-robin regardless parent -+ */ -+static int au_wbr_create_pmfsrr(struct dentry *dentry, unsigned int flags) -+{ -+ int err; -+ unsigned long long watermark; -+ struct super_block *sb; -+ struct au_branch *br; -+ struct au_wbr_mfs *mfs; -+ -+ err = au_wbr_create_pmfs(dentry, flags | AuWbr_PARENT); -+ if (unlikely(err < 0)) -+ goto out; -+ -+ sb = dentry->d_sb; -+ br = au_sbr(sb, err); -+ mfs = &au_sbi(sb)->si_wbr_mfs; -+ mutex_lock(&mfs->mfs_lock); -+ watermark = mfs->mfsrr_watermark; -+ mutex_unlock(&mfs->mfs_lock); -+ if (br->br_wbr->wbr_bytes < watermark) -+ /* regardless the parent dir */ -+ err = au_wbr_create_mfsrr(dentry, flags); -+ -+out: -+ AuDbg("b%d\n", err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* policies for copyup */ -+ -+/* top down parent */ -+static int au_wbr_copyup_tdp(struct dentry *dentry) -+{ -+ return au_wbr_create_tdp(dentry, /*flags, anything is ok*/0); -+} -+ -+/* bottom up parent */ -+static int au_wbr_copyup_bup(struct dentry *dentry) -+{ -+ int err; -+ aufs_bindex_t bindex, btop; -+ struct dentry *parent, *h_parent; -+ struct super_block *sb; -+ -+ err = -EROFS; -+ sb = dentry->d_sb; -+ parent = dget_parent(dentry); -+ btop = au_dbtop(parent); -+ for (bindex = au_dbtop(dentry); bindex >= btop; bindex--) { -+ h_parent = au_h_dptr(parent, bindex); -+ if (!h_parent || d_is_negative(h_parent)) -+ continue; -+ -+ if (!au_br_rdonly(au_sbr(sb, bindex))) { -+ err = bindex; -+ break; -+ } -+ } -+ dput(parent); -+ -+ /* bottom up here */ -+ if (unlikely(err < 0)) -+ err = au_wbr_bu(sb, btop - 1); -+ -+ AuDbg("b%d\n", err); -+ return err; -+} -+ -+/* bottom up */ -+int au_wbr_do_copyup_bu(struct dentry *dentry, aufs_bindex_t btop) -+{ -+ int err; -+ -+ err = au_wbr_bu(dentry->d_sb, btop); -+ AuDbg("b%d\n", err); -+ if (err > btop) -+ err = au_wbr_nonopq(dentry, err); -+ -+ AuDbg("b%d\n", err); -+ return err; -+} -+ -+static int au_wbr_copyup_bu(struct dentry *dentry) -+{ -+ int err; -+ aufs_bindex_t btop; -+ -+ btop = au_dbtop(dentry); -+ err = au_wbr_do_copyup_bu(dentry, btop); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct au_wbr_copyup_operations au_wbr_copyup_ops[] = { -+ [AuWbrCopyup_TDP] = { -+ .copyup = au_wbr_copyup_tdp -+ }, -+ [AuWbrCopyup_BUP] = { -+ .copyup = au_wbr_copyup_bup -+ }, -+ [AuWbrCopyup_BU] = { -+ .copyup = au_wbr_copyup_bu -+ } -+}; -+ -+struct au_wbr_create_operations au_wbr_create_ops[] = { -+ [AuWbrCreate_TDP] = { -+ .create = au_wbr_create_tdp -+ }, -+ [AuWbrCreate_RR] = { -+ .create = au_wbr_create_rr, -+ .init = au_wbr_create_init_rr -+ }, -+ [AuWbrCreate_MFS] = { -+ .create = au_wbr_create_mfs, -+ .init = au_wbr_create_init_mfs, -+ .fin = au_wbr_create_fin_mfs -+ }, -+ [AuWbrCreate_MFSV] = { -+ .create = au_wbr_create_mfs, -+ .init = au_wbr_create_init_mfs, -+ .fin = au_wbr_create_fin_mfs -+ }, -+ [AuWbrCreate_MFSRR] = { -+ .create = au_wbr_create_mfsrr, -+ .init = au_wbr_create_init_mfsrr, -+ .fin = au_wbr_create_fin_mfs -+ }, -+ [AuWbrCreate_MFSRRV] = { -+ .create = au_wbr_create_mfsrr, -+ .init = au_wbr_create_init_mfsrr, -+ .fin = au_wbr_create_fin_mfs -+ }, -+ [AuWbrCreate_TDMFS] = { -+ .create = au_wbr_create_tdmfs, -+ .init = au_wbr_create_init_mfs, -+ .fin = au_wbr_create_fin_mfs -+ }, -+ [AuWbrCreate_TDMFSV] = { -+ .create = au_wbr_create_tdmfs, -+ .init = au_wbr_create_init_mfs, -+ .fin = au_wbr_create_fin_mfs -+ }, -+ [AuWbrCreate_PMFS] = { -+ .create = au_wbr_create_pmfs, -+ .init = au_wbr_create_init_mfs, -+ .fin = au_wbr_create_fin_mfs -+ }, -+ [AuWbrCreate_PMFSV] = { -+ .create = au_wbr_create_pmfs, -+ .init = au_wbr_create_init_mfs, -+ .fin = au_wbr_create_fin_mfs -+ }, -+ [AuWbrCreate_PMFSRR] = { -+ .create = au_wbr_create_pmfsrr, -+ .init = au_wbr_create_init_mfsrr, -+ .fin = au_wbr_create_fin_mfs -+ }, -+ [AuWbrCreate_PMFSRRV] = { -+ .create = au_wbr_create_pmfsrr, -+ .init = au_wbr_create_init_mfsrr, -+ .fin = au_wbr_create_fin_mfs -+ } -+}; -diff --git a/fs/aufs/whout.c b/fs/aufs/whout.c -new file mode 100644 -index 000000000000..9ed0b30b56f4 ---- /dev/null -+++ b/fs/aufs/whout.c -@@ -0,0 +1,1049 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * whiteout for logical deletion and opaque directory -+ */ -+ -+#include "aufs.h" -+ -+#define WH_MASK S_IRUGO -+ -+/* -+ * If a directory contains this file, then it is opaque. We start with the -+ * .wh. flag so that it is blocked by lookup. -+ */ -+static struct qstr diropq_name = QSTR_INIT(AUFS_WH_DIROPQ, -+ sizeof(AUFS_WH_DIROPQ) - 1); -+ -+/* -+ * generate whiteout name, which is NOT terminated by NULL. -+ * @name: original d_name.name -+ * @len: original d_name.len -+ * @wh: whiteout qstr -+ * returns zero when succeeds, otherwise error. -+ * succeeded value as wh->name should be freed by kfree(). -+ */ -+int au_wh_name_alloc(struct qstr *wh, const struct qstr *name) -+{ -+ char *p; -+ -+ if (unlikely(name->len > PATH_MAX - AUFS_WH_PFX_LEN)) -+ return -ENAMETOOLONG; -+ -+ wh->len = name->len + AUFS_WH_PFX_LEN; -+ p = kmalloc(wh->len, GFP_NOFS); -+ wh->name = p; -+ if (p) { -+ memcpy(p, AUFS_WH_PFX, AUFS_WH_PFX_LEN); -+ memcpy(p + AUFS_WH_PFX_LEN, name->name, name->len); -+ /* smp_mb(); */ -+ return 0; -+ } -+ return -ENOMEM; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * test if the @wh_name exists under @h_parent. -+ * @try_sio specifies the necessary of super-io. -+ */ -+int au_wh_test(struct dentry *h_parent, struct qstr *wh_name, int try_sio) -+{ -+ int err; -+ struct dentry *wh_dentry; -+ -+ if (!try_sio) -+ wh_dentry = vfsub_lkup_one(wh_name, h_parent); -+ else -+ wh_dentry = au_sio_lkup_one(wh_name, h_parent); -+ err = PTR_ERR(wh_dentry); -+ if (IS_ERR(wh_dentry)) { -+ if (err == -ENAMETOOLONG) -+ err = 0; -+ goto out; -+ } -+ -+ err = 0; -+ if (d_is_negative(wh_dentry)) -+ goto out_wh; /* success */ -+ -+ err = 1; -+ if (d_is_reg(wh_dentry)) -+ goto out_wh; /* success */ -+ -+ err = -EIO; -+ AuIOErr("%pd Invalid whiteout entry type 0%o.\n", -+ wh_dentry, d_inode(wh_dentry)->i_mode); -+ -+out_wh: -+ dput(wh_dentry); -+out: -+ return err; -+} -+ -+/* -+ * test if the @h_dentry sets opaque or not. -+ */ -+int au_diropq_test(struct dentry *h_dentry) -+{ -+ int err; -+ struct inode *h_dir; -+ -+ h_dir = d_inode(h_dentry); -+ err = au_wh_test(h_dentry, &diropq_name, -+ au_test_h_perm_sio(h_dir, MAY_EXEC)); -+ return err; -+} -+ -+/* -+ * returns a negative dentry whose name is unique and temporary. -+ */ -+struct dentry *au_whtmp_lkup(struct dentry *h_parent, struct au_branch *br, -+ struct qstr *prefix) -+{ -+ struct dentry *dentry; -+ int i; -+ char defname[NAME_MAX - AUFS_MAX_NAMELEN + DNAME_INLINE_LEN + 1], -+ *name, *p; -+ /* strict atomic_t is unnecessary here */ -+ static unsigned short cnt; -+ struct qstr qs; -+ -+ BUILD_BUG_ON(sizeof(cnt) * 2 > AUFS_WH_TMP_LEN); -+ -+ name = defname; -+ qs.len = sizeof(defname) - DNAME_INLINE_LEN + prefix->len - 1; -+ if (unlikely(prefix->len > DNAME_INLINE_LEN)) { -+ dentry = ERR_PTR(-ENAMETOOLONG); -+ if (unlikely(qs.len > NAME_MAX)) -+ goto out; -+ dentry = ERR_PTR(-ENOMEM); -+ name = kmalloc(qs.len + 1, GFP_NOFS); -+ if (unlikely(!name)) -+ goto out; -+ } -+ -+ /* doubly whiteout-ed */ -+ memcpy(name, AUFS_WH_PFX AUFS_WH_PFX, AUFS_WH_PFX_LEN * 2); -+ p = name + AUFS_WH_PFX_LEN * 2; -+ memcpy(p, prefix->name, prefix->len); -+ p += prefix->len; -+ *p++ = '.'; -+ AuDebugOn(name + qs.len + 1 - p <= AUFS_WH_TMP_LEN); -+ -+ qs.name = name; -+ for (i = 0; i < 3; i++) { -+ sprintf(p, "%.*x", AUFS_WH_TMP_LEN, cnt++); -+ dentry = au_sio_lkup_one(&qs, h_parent); -+ if (IS_ERR(dentry) || d_is_negative(dentry)) -+ goto out_name; -+ dput(dentry); -+ } -+ /* pr_warn("could not get random name\n"); */ -+ dentry = ERR_PTR(-EEXIST); -+ AuDbg("%.*s\n", AuLNPair(&qs)); -+ BUG(); -+ -+out_name: -+ if (name != defname) -+ kfree(name); -+out: -+ AuTraceErrPtr(dentry); -+ return dentry; -+} -+ -+/* -+ * rename the @h_dentry on @br to the whiteouted temporary name. -+ */ -+int au_whtmp_ren(struct dentry *h_dentry, struct au_branch *br) -+{ -+ int err; -+ struct path h_path = { -+ .mnt = au_br_mnt(br) -+ }; -+ struct inode *h_dir, *delegated; -+ struct dentry *h_parent; -+ -+ h_parent = h_dentry->d_parent; /* dir inode is locked */ -+ h_dir = d_inode(h_parent); -+ IMustLock(h_dir); -+ -+ h_path.dentry = au_whtmp_lkup(h_parent, br, &h_dentry->d_name); -+ err = PTR_ERR(h_path.dentry); -+ if (IS_ERR(h_path.dentry)) -+ goto out; -+ -+ /* under the same dir, no need to lock_rename() */ -+ delegated = NULL; -+ err = vfsub_rename(h_dir, h_dentry, h_dir, &h_path, &delegated, -+ /*flags*/0); -+ AuTraceErr(err); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal rename\n"); -+ iput(delegated); -+ } -+ dput(h_path.dentry); -+ -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+/* -+ * functions for removing a whiteout -+ */ -+ -+static int do_unlink_wh(struct inode *h_dir, struct path *h_path) -+{ -+ int err, force; -+ struct inode *delegated; -+ -+ /* -+ * forces superio when the dir has a sticky bit. -+ * this may be a violation of unix fs semantics. -+ */ -+ force = (h_dir->i_mode & S_ISVTX) -+ && !uid_eq(current_fsuid(), d_inode(h_path->dentry)->i_uid); -+ delegated = NULL; -+ err = vfsub_unlink(h_dir, h_path, &delegated, force); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal unlink\n"); -+ iput(delegated); -+ } -+ return err; -+} -+ -+int au_wh_unlink_dentry(struct inode *h_dir, struct path *h_path, -+ struct dentry *dentry) -+{ -+ int err; -+ -+ err = do_unlink_wh(h_dir, h_path); -+ if (!err && dentry) -+ au_set_dbwh(dentry, -1); -+ -+ return err; -+} -+ -+static int unlink_wh_name(struct dentry *h_parent, struct qstr *wh, -+ struct au_branch *br) -+{ -+ int err; -+ struct path h_path = { -+ .mnt = au_br_mnt(br) -+ }; -+ -+ err = 0; -+ h_path.dentry = vfsub_lkup_one(wh, h_parent); -+ if (IS_ERR(h_path.dentry)) -+ err = PTR_ERR(h_path.dentry); -+ else { -+ if (d_is_reg(h_path.dentry)) -+ err = do_unlink_wh(d_inode(h_parent), &h_path); -+ dput(h_path.dentry); -+ } -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+/* -+ * initialize/clean whiteout for a branch -+ */ -+ -+static void au_wh_clean(struct inode *h_dir, struct path *whpath, -+ const int isdir) -+{ -+ int err; -+ struct inode *delegated; -+ -+ if (d_is_negative(whpath->dentry)) -+ return; -+ -+ if (isdir) -+ err = vfsub_rmdir(h_dir, whpath); -+ else { -+ delegated = NULL; -+ err = vfsub_unlink(h_dir, whpath, &delegated, /*force*/0); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal unlink\n"); -+ iput(delegated); -+ } -+ } -+ if (unlikely(err)) -+ pr_warn("failed removing %pd (%d), ignored.\n", -+ whpath->dentry, err); -+} -+ -+static int test_linkable(struct dentry *h_root) -+{ -+ struct inode *h_dir = d_inode(h_root); -+ -+ if (h_dir->i_op->link) -+ return 0; -+ -+ pr_err("%pd (%s) doesn't support link(2), use noplink and rw+nolwh\n", -+ h_root, au_sbtype(h_root->d_sb)); -+ return -ENOSYS; -+} -+ -+/* todo: should this mkdir be done in /sbin/mount.aufs helper? */ -+static int au_whdir(struct inode *h_dir, struct path *path) -+{ -+ int err; -+ -+ err = -EEXIST; -+ if (d_is_negative(path->dentry)) { -+ int mode = S_IRWXU; -+ -+ if (au_test_nfs(path->dentry->d_sb)) -+ mode |= S_IXUGO; -+ err = vfsub_mkdir(h_dir, path, mode); -+ } else if (d_is_dir(path->dentry)) -+ err = 0; -+ else -+ pr_err("unknown %pd exists\n", path->dentry); -+ -+ return err; -+} -+ -+struct au_wh_base { -+ const struct qstr *name; -+ struct dentry *dentry; -+}; -+ -+static void au_wh_init_ro(struct inode *h_dir, struct au_wh_base base[], -+ struct path *h_path) -+{ -+ h_path->dentry = base[AuBrWh_BASE].dentry; -+ au_wh_clean(h_dir, h_path, /*isdir*/0); -+ h_path->dentry = base[AuBrWh_PLINK].dentry; -+ au_wh_clean(h_dir, h_path, /*isdir*/1); -+ h_path->dentry = base[AuBrWh_ORPH].dentry; -+ au_wh_clean(h_dir, h_path, /*isdir*/1); -+} -+ -+/* -+ * returns tri-state, -+ * minus: error, caller should print the message -+ * zero: succuess -+ * plus: error, caller should NOT print the message -+ */ -+static int au_wh_init_rw_nolink(struct dentry *h_root, struct au_wbr *wbr, -+ int do_plink, struct au_wh_base base[], -+ struct path *h_path) -+{ -+ int err; -+ struct inode *h_dir; -+ -+ h_dir = d_inode(h_root); -+ h_path->dentry = base[AuBrWh_BASE].dentry; -+ au_wh_clean(h_dir, h_path, /*isdir*/0); -+ h_path->dentry = base[AuBrWh_PLINK].dentry; -+ if (do_plink) { -+ err = test_linkable(h_root); -+ if (unlikely(err)) { -+ err = 1; -+ goto out; -+ } -+ -+ err = au_whdir(h_dir, h_path); -+ if (unlikely(err)) -+ goto out; -+ wbr->wbr_plink = dget(base[AuBrWh_PLINK].dentry); -+ } else -+ au_wh_clean(h_dir, h_path, /*isdir*/1); -+ h_path->dentry = base[AuBrWh_ORPH].dentry; -+ err = au_whdir(h_dir, h_path); -+ if (unlikely(err)) -+ goto out; -+ wbr->wbr_orph = dget(base[AuBrWh_ORPH].dentry); -+ -+out: -+ return err; -+} -+ -+/* -+ * for the moment, aufs supports the branch filesystem which does not support -+ * link(2). testing on FAT which does not support i_op->setattr() fully either, -+ * copyup failed. finally, such filesystem will not be used as the writable -+ * branch. -+ * -+ * returns tri-state, see above. -+ */ -+static int au_wh_init_rw(struct dentry *h_root, struct au_wbr *wbr, -+ int do_plink, struct au_wh_base base[], -+ struct path *h_path) -+{ -+ int err; -+ struct inode *h_dir; -+ -+ WbrWhMustWriteLock(wbr); -+ -+ err = test_linkable(h_root); -+ if (unlikely(err)) { -+ err = 1; -+ goto out; -+ } -+ -+ /* -+ * todo: should this create be done in /sbin/mount.aufs helper? -+ */ -+ err = -EEXIST; -+ h_dir = d_inode(h_root); -+ if (d_is_negative(base[AuBrWh_BASE].dentry)) { -+ h_path->dentry = base[AuBrWh_BASE].dentry; -+ err = vfsub_create(h_dir, h_path, WH_MASK, /*want_excl*/true); -+ } else if (d_is_reg(base[AuBrWh_BASE].dentry)) -+ err = 0; -+ else -+ pr_err("unknown %pd2 exists\n", base[AuBrWh_BASE].dentry); -+ if (unlikely(err)) -+ goto out; -+ -+ h_path->dentry = base[AuBrWh_PLINK].dentry; -+ if (do_plink) { -+ err = au_whdir(h_dir, h_path); -+ if (unlikely(err)) -+ goto out; -+ wbr->wbr_plink = dget(base[AuBrWh_PLINK].dentry); -+ } else -+ au_wh_clean(h_dir, h_path, /*isdir*/1); -+ wbr->wbr_whbase = dget(base[AuBrWh_BASE].dentry); -+ -+ h_path->dentry = base[AuBrWh_ORPH].dentry; -+ err = au_whdir(h_dir, h_path); -+ if (unlikely(err)) -+ goto out; -+ wbr->wbr_orph = dget(base[AuBrWh_ORPH].dentry); -+ -+out: -+ return err; -+} -+ -+/* -+ * initialize the whiteout base file/dir for @br. -+ */ -+int au_wh_init(struct au_branch *br, struct super_block *sb) -+{ -+ int err, i; -+ const unsigned char do_plink -+ = !!au_opt_test(au_mntflags(sb), PLINK); -+ struct inode *h_dir; -+ struct path path = br->br_path; -+ struct dentry *h_root = path.dentry; -+ struct au_wbr *wbr = br->br_wbr; -+ static const struct qstr base_name[] = { -+ [AuBrWh_BASE] = QSTR_INIT(AUFS_BASE_NAME, -+ sizeof(AUFS_BASE_NAME) - 1), -+ [AuBrWh_PLINK] = QSTR_INIT(AUFS_PLINKDIR_NAME, -+ sizeof(AUFS_PLINKDIR_NAME) - 1), -+ [AuBrWh_ORPH] = QSTR_INIT(AUFS_ORPHDIR_NAME, -+ sizeof(AUFS_ORPHDIR_NAME) - 1) -+ }; -+ struct au_wh_base base[] = { -+ [AuBrWh_BASE] = { -+ .name = base_name + AuBrWh_BASE, -+ .dentry = NULL -+ }, -+ [AuBrWh_PLINK] = { -+ .name = base_name + AuBrWh_PLINK, -+ .dentry = NULL -+ }, -+ [AuBrWh_ORPH] = { -+ .name = base_name + AuBrWh_ORPH, -+ .dentry = NULL -+ } -+ }; -+ -+ if (wbr) -+ WbrWhMustWriteLock(wbr); -+ -+ for (i = 0; i < AuBrWh_Last; i++) { -+ /* doubly whiteouted */ -+ struct dentry *d; -+ -+ d = au_wh_lkup(h_root, (void *)base[i].name, br); -+ err = PTR_ERR(d); -+ if (IS_ERR(d)) -+ goto out; -+ -+ base[i].dentry = d; -+ AuDebugOn(wbr -+ && wbr->wbr_wh[i] -+ && wbr->wbr_wh[i] != base[i].dentry); -+ } -+ -+ if (wbr) -+ for (i = 0; i < AuBrWh_Last; i++) { -+ dput(wbr->wbr_wh[i]); -+ wbr->wbr_wh[i] = NULL; -+ } -+ -+ err = 0; -+ if (!au_br_writable(br->br_perm)) { -+ h_dir = d_inode(h_root); -+ au_wh_init_ro(h_dir, base, &path); -+ } else if (!au_br_wh_linkable(br->br_perm)) { -+ err = au_wh_init_rw_nolink(h_root, wbr, do_plink, base, &path); -+ if (err > 0) -+ goto out; -+ else if (err) -+ goto out_err; -+ } else { -+ err = au_wh_init_rw(h_root, wbr, do_plink, base, &path); -+ if (err > 0) -+ goto out; -+ else if (err) -+ goto out_err; -+ } -+ goto out; /* success */ -+ -+out_err: -+ pr_err("an error(%d) on the writable branch %pd(%s)\n", -+ err, h_root, au_sbtype(h_root->d_sb)); -+out: -+ for (i = 0; i < AuBrWh_Last; i++) -+ dput(base[i].dentry); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+/* -+ * whiteouts are all hard-linked usually. -+ * when its link count reaches a ceiling, we create a new whiteout base -+ * asynchronously. -+ */ -+ -+struct reinit_br_wh { -+ struct super_block *sb; -+ struct au_branch *br; -+}; -+ -+static void reinit_br_wh(void *arg) -+{ -+ int err; -+ aufs_bindex_t bindex; -+ struct path h_path; -+ struct reinit_br_wh *a = arg; -+ struct au_wbr *wbr; -+ struct inode *dir, *delegated; -+ struct dentry *h_root; -+ struct au_hinode *hdir; -+ -+ err = 0; -+ wbr = a->br->br_wbr; -+ /* big aufs lock */ -+ si_noflush_write_lock(a->sb); -+ if (!au_br_writable(a->br->br_perm)) -+ goto out; -+ bindex = au_br_index(a->sb, a->br->br_id); -+ if (unlikely(bindex < 0)) -+ goto out; -+ -+ di_read_lock_parent(a->sb->s_root, AuLock_IR); -+ dir = d_inode(a->sb->s_root); -+ hdir = au_hi(dir, bindex); -+ h_root = au_h_dptr(a->sb->s_root, bindex); -+ AuDebugOn(h_root != au_br_dentry(a->br)); -+ -+ au_hn_inode_lock_nested(hdir, AuLsc_I_PARENT); -+ wbr_wh_write_lock(wbr); -+ err = au_h_verify(wbr->wbr_whbase, au_opt_udba(a->sb), hdir->hi_inode, -+ h_root, a->br); -+ if (!err) { -+ h_path.dentry = wbr->wbr_whbase; -+ h_path.mnt = au_br_mnt(a->br); -+ delegated = NULL; -+ err = vfsub_unlink(hdir->hi_inode, &h_path, &delegated, -+ /*force*/0); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal unlink\n"); -+ iput(delegated); -+ } -+ } else { -+ pr_warn("%pd is moved, ignored\n", wbr->wbr_whbase); -+ err = 0; -+ } -+ dput(wbr->wbr_whbase); -+ wbr->wbr_whbase = NULL; -+ if (!err) -+ err = au_wh_init(a->br, a->sb); -+ wbr_wh_write_unlock(wbr); -+ au_hn_inode_unlock(hdir); -+ di_read_unlock(a->sb->s_root, AuLock_IR); -+ if (!err) -+ au_fhsm_wrote(a->sb, bindex, /*force*/0); -+ -+out: -+ if (wbr) -+ atomic_dec(&wbr->wbr_wh_running); -+ au_br_put(a->br); -+ si_write_unlock(a->sb); -+ au_nwt_done(&au_sbi(a->sb)->si_nowait); -+ kfree(arg); -+ if (unlikely(err)) -+ AuIOErr("err %d\n", err); -+} -+ -+static void kick_reinit_br_wh(struct super_block *sb, struct au_branch *br) -+{ -+ int do_dec, wkq_err; -+ struct reinit_br_wh *arg; -+ -+ do_dec = 1; -+ if (atomic_inc_return(&br->br_wbr->wbr_wh_running) != 1) -+ goto out; -+ -+ /* ignore ENOMEM */ -+ arg = kmalloc(sizeof(*arg), GFP_NOFS); -+ if (arg) { -+ /* -+ * dec(wh_running), kfree(arg) and dec(br_count) -+ * in reinit function -+ */ -+ arg->sb = sb; -+ arg->br = br; -+ au_br_get(br); -+ wkq_err = au_wkq_nowait(reinit_br_wh, arg, sb, /*flags*/0); -+ if (unlikely(wkq_err)) { -+ atomic_dec(&br->br_wbr->wbr_wh_running); -+ au_br_put(br); -+ kfree(arg); -+ } -+ do_dec = 0; -+ } -+ -+out: -+ if (do_dec) -+ atomic_dec(&br->br_wbr->wbr_wh_running); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * create the whiteout @wh. -+ */ -+static int link_or_create_wh(struct super_block *sb, aufs_bindex_t bindex, -+ struct dentry *wh) -+{ -+ int err; -+ struct path h_path = { -+ .dentry = wh -+ }; -+ struct au_branch *br; -+ struct au_wbr *wbr; -+ struct dentry *h_parent; -+ struct inode *h_dir, *delegated; -+ -+ h_parent = wh->d_parent; /* dir inode is locked */ -+ h_dir = d_inode(h_parent); -+ IMustLock(h_dir); -+ -+ br = au_sbr(sb, bindex); -+ h_path.mnt = au_br_mnt(br); -+ wbr = br->br_wbr; -+ wbr_wh_read_lock(wbr); -+ if (wbr->wbr_whbase) { -+ delegated = NULL; -+ err = vfsub_link(wbr->wbr_whbase, h_dir, &h_path, &delegated); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal link\n"); -+ iput(delegated); -+ } -+ if (!err || err != -EMLINK) -+ goto out; -+ -+ /* link count full. re-initialize br_whbase. */ -+ kick_reinit_br_wh(sb, br); -+ } -+ -+ /* return this error in this context */ -+ err = vfsub_create(h_dir, &h_path, WH_MASK, /*want_excl*/true); -+ if (!err) -+ au_fhsm_wrote(sb, bindex, /*force*/0); -+ -+out: -+ wbr_wh_read_unlock(wbr); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * create or remove the diropq. -+ */ -+static struct dentry *do_diropq(struct dentry *dentry, aufs_bindex_t bindex, -+ unsigned int flags) -+{ -+ struct dentry *opq_dentry, *h_dentry; -+ struct super_block *sb; -+ struct au_branch *br; -+ int err; -+ -+ sb = dentry->d_sb; -+ br = au_sbr(sb, bindex); -+ h_dentry = au_h_dptr(dentry, bindex); -+ opq_dentry = vfsub_lkup_one(&diropq_name, h_dentry); -+ if (IS_ERR(opq_dentry)) -+ goto out; -+ -+ if (au_ftest_diropq(flags, CREATE)) { -+ err = link_or_create_wh(sb, bindex, opq_dentry); -+ if (!err) { -+ au_set_dbdiropq(dentry, bindex); -+ goto out; /* success */ -+ } -+ } else { -+ struct path tmp = { -+ .dentry = opq_dentry, -+ .mnt = au_br_mnt(br) -+ }; -+ err = do_unlink_wh(au_h_iptr(d_inode(dentry), bindex), &tmp); -+ if (!err) -+ au_set_dbdiropq(dentry, -1); -+ } -+ dput(opq_dentry); -+ opq_dentry = ERR_PTR(err); -+ -+out: -+ return opq_dentry; -+} -+ -+struct do_diropq_args { -+ struct dentry **errp; -+ struct dentry *dentry; -+ aufs_bindex_t bindex; -+ unsigned int flags; -+}; -+ -+static void call_do_diropq(void *args) -+{ -+ struct do_diropq_args *a = args; -+ *a->errp = do_diropq(a->dentry, a->bindex, a->flags); -+} -+ -+struct dentry *au_diropq_sio(struct dentry *dentry, aufs_bindex_t bindex, -+ unsigned int flags) -+{ -+ struct dentry *diropq, *h_dentry; -+ -+ h_dentry = au_h_dptr(dentry, bindex); -+ if (!au_test_h_perm_sio(d_inode(h_dentry), MAY_EXEC | MAY_WRITE)) -+ diropq = do_diropq(dentry, bindex, flags); -+ else { -+ int wkq_err; -+ struct do_diropq_args args = { -+ .errp = &diropq, -+ .dentry = dentry, -+ .bindex = bindex, -+ .flags = flags -+ }; -+ -+ wkq_err = au_wkq_wait(call_do_diropq, &args); -+ if (unlikely(wkq_err)) -+ diropq = ERR_PTR(wkq_err); -+ } -+ -+ return diropq; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * lookup whiteout dentry. -+ * @h_parent: lower parent dentry which must exist and be locked -+ * @base_name: name of dentry which will be whiteouted -+ * returns dentry for whiteout. -+ */ -+struct dentry *au_wh_lkup(struct dentry *h_parent, struct qstr *base_name, -+ struct au_branch *br) -+{ -+ int err; -+ struct qstr wh_name; -+ struct dentry *wh_dentry; -+ -+ err = au_wh_name_alloc(&wh_name, base_name); -+ wh_dentry = ERR_PTR(err); -+ if (!err) { -+ wh_dentry = vfsub_lkup_one(&wh_name, h_parent); -+ kfree(wh_name.name); -+ } -+ return wh_dentry; -+} -+ -+/* -+ * link/create a whiteout for @dentry on @bindex. -+ */ -+struct dentry *au_wh_create(struct dentry *dentry, aufs_bindex_t bindex, -+ struct dentry *h_parent) -+{ -+ struct dentry *wh_dentry; -+ struct super_block *sb; -+ int err; -+ -+ sb = dentry->d_sb; -+ wh_dentry = au_wh_lkup(h_parent, &dentry->d_name, au_sbr(sb, bindex)); -+ if (!IS_ERR(wh_dentry) && d_is_negative(wh_dentry)) { -+ err = link_or_create_wh(sb, bindex, wh_dentry); -+ if (!err) { -+ au_set_dbwh(dentry, bindex); -+ au_fhsm_wrote(sb, bindex, /*force*/0); -+ } else { -+ dput(wh_dentry); -+ wh_dentry = ERR_PTR(err); -+ } -+ } -+ -+ return wh_dentry; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* Delete all whiteouts in this directory on branch bindex. */ -+static int del_wh_children(struct dentry *h_dentry, struct au_nhash *whlist, -+ aufs_bindex_t bindex, struct au_branch *br) -+{ -+ int err; -+ unsigned long ul, n; -+ struct qstr wh_name; -+ char *p; -+ struct hlist_head *head; -+ struct au_vdir_wh *pos; -+ struct au_vdir_destr *str; -+ -+ err = -ENOMEM; -+ p = (void *)__get_free_page(GFP_NOFS); -+ wh_name.name = p; -+ if (unlikely(!wh_name.name)) -+ goto out; -+ -+ err = 0; -+ memcpy(p, AUFS_WH_PFX, AUFS_WH_PFX_LEN); -+ p += AUFS_WH_PFX_LEN; -+ n = whlist->nh_num; -+ head = whlist->nh_head; -+ for (ul = 0; !err && ul < n; ul++, head++) { -+ hlist_for_each_entry(pos, head, wh_hash) { -+ if (pos->wh_bindex != bindex) -+ continue; -+ -+ str = &pos->wh_str; -+ if (str->len + AUFS_WH_PFX_LEN <= PATH_MAX) { -+ memcpy(p, str->name, str->len); -+ wh_name.len = AUFS_WH_PFX_LEN + str->len; -+ err = unlink_wh_name(h_dentry, &wh_name, br); -+ if (!err) -+ continue; -+ break; -+ } -+ AuIOErr("whiteout name too long %.*s\n", -+ str->len, str->name); -+ err = -EIO; -+ break; -+ } -+ } -+ free_page((unsigned long)wh_name.name); -+ -+out: -+ return err; -+} -+ -+struct del_wh_children_args { -+ int *errp; -+ struct dentry *h_dentry; -+ struct au_nhash *whlist; -+ aufs_bindex_t bindex; -+ struct au_branch *br; -+}; -+ -+static void call_del_wh_children(void *args) -+{ -+ struct del_wh_children_args *a = args; -+ *a->errp = del_wh_children(a->h_dentry, a->whlist, a->bindex, a->br); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct au_whtmp_rmdir *au_whtmp_rmdir_alloc(struct super_block *sb, gfp_t gfp) -+{ -+ struct au_whtmp_rmdir *whtmp; -+ int err; -+ unsigned int rdhash; -+ -+ SiMustAnyLock(sb); -+ -+ whtmp = kzalloc(sizeof(*whtmp), gfp); -+ if (unlikely(!whtmp)) { -+ whtmp = ERR_PTR(-ENOMEM); -+ goto out; -+ } -+ -+ /* no estimation for dir size */ -+ rdhash = au_sbi(sb)->si_rdhash; -+ if (!rdhash) -+ rdhash = AUFS_RDHASH_DEF; -+ err = au_nhash_alloc(&whtmp->whlist, rdhash, gfp); -+ if (unlikely(err)) { -+ kfree(whtmp); -+ whtmp = ERR_PTR(err); -+ } -+ -+out: -+ return whtmp; -+} -+ -+void au_whtmp_rmdir_free(struct au_whtmp_rmdir *whtmp) -+{ -+ if (whtmp->br) -+ au_br_put(whtmp->br); -+ dput(whtmp->wh_dentry); -+ iput(whtmp->dir); -+ au_nhash_wh_free(&whtmp->whlist); -+ kfree(whtmp); -+} -+ -+/* -+ * rmdir the whiteouted temporary named dir @h_dentry. -+ * @whlist: whiteouted children. -+ */ -+int au_whtmp_rmdir(struct inode *dir, aufs_bindex_t bindex, -+ struct dentry *wh_dentry, struct au_nhash *whlist) -+{ -+ int err; -+ unsigned int h_nlink; -+ struct path h_tmp; -+ struct inode *wh_inode, *h_dir; -+ struct au_branch *br; -+ -+ h_dir = d_inode(wh_dentry->d_parent); /* dir inode is locked */ -+ IMustLock(h_dir); -+ -+ br = au_sbr(dir->i_sb, bindex); -+ wh_inode = d_inode(wh_dentry); -+ inode_lock_nested(wh_inode, AuLsc_I_CHILD); -+ -+ /* -+ * someone else might change some whiteouts while we were sleeping. -+ * it means this whlist may have an obsoleted entry. -+ */ -+ if (!au_test_h_perm_sio(wh_inode, MAY_EXEC | MAY_WRITE)) -+ err = del_wh_children(wh_dentry, whlist, bindex, br); -+ else { -+ int wkq_err; -+ struct del_wh_children_args args = { -+ .errp = &err, -+ .h_dentry = wh_dentry, -+ .whlist = whlist, -+ .bindex = bindex, -+ .br = br -+ }; -+ -+ wkq_err = au_wkq_wait(call_del_wh_children, &args); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ } -+ inode_unlock(wh_inode); -+ -+ if (!err) { -+ h_tmp.dentry = wh_dentry; -+ h_tmp.mnt = au_br_mnt(br); -+ h_nlink = h_dir->i_nlink; -+ err = vfsub_rmdir(h_dir, &h_tmp); -+ /* some fs doesn't change the parent nlink in some cases */ -+ h_nlink -= h_dir->i_nlink; -+ } -+ -+ if (!err) { -+ if (au_ibtop(dir) == bindex) { -+ /* todo: dir->i_mutex is necessary */ -+ au_cpup_attr_timesizes(dir); -+ if (h_nlink) -+ vfsub_drop_nlink(dir); -+ } -+ return 0; /* success */ -+ } -+ -+ pr_warn("failed removing %pd(%d), ignored\n", wh_dentry, err); -+ return err; -+} -+ -+static void call_rmdir_whtmp(void *args) -+{ -+ int err; -+ aufs_bindex_t bindex; -+ struct au_whtmp_rmdir *a = args; -+ struct super_block *sb; -+ struct dentry *h_parent; -+ struct inode *h_dir; -+ struct au_hinode *hdir; -+ -+ /* rmdir by nfsd may cause deadlock with this i_mutex */ -+ /* inode_lock(a->dir); */ -+ err = -EROFS; -+ sb = a->dir->i_sb; -+ si_read_lock(sb, !AuLock_FLUSH); -+ if (!au_br_writable(a->br->br_perm)) -+ goto out; -+ bindex = au_br_index(sb, a->br->br_id); -+ if (unlikely(bindex < 0)) -+ goto out; -+ -+ err = -EIO; -+ ii_write_lock_parent(a->dir); -+ h_parent = dget_parent(a->wh_dentry); -+ h_dir = d_inode(h_parent); -+ hdir = au_hi(a->dir, bindex); -+ err = vfsub_mnt_want_write(au_br_mnt(a->br)); -+ if (unlikely(err)) -+ goto out_mnt; -+ au_hn_inode_lock_nested(hdir, AuLsc_I_PARENT); -+ err = au_h_verify(a->wh_dentry, au_opt_udba(sb), h_dir, h_parent, -+ a->br); -+ if (!err) -+ err = au_whtmp_rmdir(a->dir, bindex, a->wh_dentry, &a->whlist); -+ au_hn_inode_unlock(hdir); -+ vfsub_mnt_drop_write(au_br_mnt(a->br)); -+ -+out_mnt: -+ dput(h_parent); -+ ii_write_unlock(a->dir); -+out: -+ /* inode_unlock(a->dir); */ -+ au_whtmp_rmdir_free(a); -+ si_read_unlock(sb); -+ au_nwt_done(&au_sbi(sb)->si_nowait); -+ if (unlikely(err)) -+ AuIOErr("err %d\n", err); -+} -+ -+void au_whtmp_kick_rmdir(struct inode *dir, aufs_bindex_t bindex, -+ struct dentry *wh_dentry, struct au_whtmp_rmdir *args) -+{ -+ int wkq_err; -+ struct super_block *sb; -+ -+ IMustLock(dir); -+ -+ /* all post-process will be done in do_rmdir_whtmp(). */ -+ sb = dir->i_sb; -+ args->dir = au_igrab(dir); -+ args->br = au_sbr(sb, bindex); -+ au_br_get(args->br); -+ args->wh_dentry = dget(wh_dentry); -+ wkq_err = au_wkq_nowait(call_rmdir_whtmp, args, sb, /*flags*/0); -+ if (unlikely(wkq_err)) { -+ pr_warn("rmdir error %pd (%d), ignored\n", wh_dentry, wkq_err); -+ au_whtmp_rmdir_free(args); -+ } -+} -diff --git a/fs/aufs/whout.h b/fs/aufs/whout.h -new file mode 100644 -index 000000000000..94a76217bbcb ---- /dev/null -+++ b/fs/aufs/whout.h -@@ -0,0 +1,73 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * whiteout for logical deletion and opaque directory -+ */ -+ -+#ifndef __AUFS_WHOUT_H__ -+#define __AUFS_WHOUT_H__ -+ -+#ifdef __KERNEL__ -+ -+#include "dir.h" -+ -+/* whout.c */ -+int au_wh_name_alloc(struct qstr *wh, const struct qstr *name); -+int au_wh_test(struct dentry *h_parent, struct qstr *wh_name, int try_sio); -+int au_diropq_test(struct dentry *h_dentry); -+struct au_branch; -+struct dentry *au_whtmp_lkup(struct dentry *h_parent, struct au_branch *br, -+ struct qstr *prefix); -+int au_whtmp_ren(struct dentry *h_dentry, struct au_branch *br); -+int au_wh_unlink_dentry(struct inode *h_dir, struct path *h_path, -+ struct dentry *dentry); -+int au_wh_init(struct au_branch *br, struct super_block *sb); -+ -+/* diropq flags */ -+#define AuDiropq_CREATE 1 -+#define au_ftest_diropq(flags, name) ((flags) & AuDiropq_##name) -+#define au_fset_diropq(flags, name) \ -+ do { (flags) |= AuDiropq_##name; } while (0) -+#define au_fclr_diropq(flags, name) \ -+ do { (flags) &= ~AuDiropq_##name; } while (0) -+ -+struct dentry *au_diropq_sio(struct dentry *dentry, aufs_bindex_t bindex, -+ unsigned int flags); -+struct dentry *au_wh_lkup(struct dentry *h_parent, struct qstr *base_name, -+ struct au_branch *br); -+struct dentry *au_wh_create(struct dentry *dentry, aufs_bindex_t bindex, -+ struct dentry *h_parent); -+ -+/* real rmdir for the whiteout-ed dir */ -+struct au_whtmp_rmdir { -+ struct inode *dir; -+ struct au_branch *br; -+ struct dentry *wh_dentry; -+ struct au_nhash whlist; -+}; -+ -+struct au_whtmp_rmdir *au_whtmp_rmdir_alloc(struct super_block *sb, gfp_t gfp); -+void au_whtmp_rmdir_free(struct au_whtmp_rmdir *whtmp); -+int au_whtmp_rmdir(struct inode *dir, aufs_bindex_t bindex, -+ struct dentry *wh_dentry, struct au_nhash *whlist); -+void au_whtmp_kick_rmdir(struct inode *dir, aufs_bindex_t bindex, -+ struct dentry *wh_dentry, struct au_whtmp_rmdir *args); -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline struct dentry *au_diropq_create(struct dentry *dentry, -+ aufs_bindex_t bindex) -+{ -+ return au_diropq_sio(dentry, bindex, AuDiropq_CREATE); -+} -+ -+static inline int au_diropq_remove(struct dentry *dentry, aufs_bindex_t bindex) -+{ -+ return PTR_ERR(au_diropq_sio(dentry, bindex, !AuDiropq_CREATE)); -+} -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_WHOUT_H__ */ -diff --git a/fs/aufs/wkq.c b/fs/aufs/wkq.c -new file mode 100644 -index 000000000000..df25631428d6 ---- /dev/null -+++ b/fs/aufs/wkq.c -@@ -0,0 +1,378 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * workqueue for asynchronous/super-io operations -+ * todo: try new dredential scheme -+ */ -+ -+#include -+#include "aufs.h" -+ -+/* internal workqueue named AUFS_WKQ_NAME */ -+ -+static struct workqueue_struct *au_wkq; -+ -+struct au_wkinfo { -+ struct work_struct wk; -+ struct kobject *kobj; -+ -+ unsigned int flags; /* see wkq.h */ -+ -+ au_wkq_func_t func; -+ void *args; -+ -+#ifdef CONFIG_LOCKDEP -+ int dont_check; -+ struct held_lock **hlock; -+#endif -+ -+ struct completion *comp; -+}; -+ -+/* ---------------------------------------------------------------------- */ -+/* -+ * Aufs passes some operations to the workqueue such as the internal copyup. -+ * This scheme looks rather unnatural for LOCKDEP debugging feature, since the -+ * job run by workqueue depends upon the locks acquired in the other task. -+ * Delegating a small operation to the workqueue, aufs passes its lockdep -+ * information too. And the job in the workqueue restores the info in order to -+ * pretend as if it acquired those locks. This is just to make LOCKDEP work -+ * correctly and expectedly. -+ */ -+ -+#ifndef CONFIG_LOCKDEP -+AuStubInt0(au_wkq_lockdep_alloc, struct au_wkinfo *wkinfo); -+AuStubVoid(au_wkq_lockdep_free, struct au_wkinfo *wkinfo); -+AuStubVoid(au_wkq_lockdep_pre, struct au_wkinfo *wkinfo); -+AuStubVoid(au_wkq_lockdep_post, struct au_wkinfo *wkinfo); -+AuStubVoid(au_wkq_lockdep_init, struct au_wkinfo *wkinfo); -+#else -+static void au_wkq_lockdep_init(struct au_wkinfo *wkinfo) -+{ -+ wkinfo->hlock = NULL; -+ wkinfo->dont_check = 0; -+} -+ -+/* -+ * 1: matched -+ * 0: unmatched -+ */ -+static int au_wkq_lockdep_test(struct lock_class_key *key, const char *name) -+{ -+ static DEFINE_SPINLOCK(spin); -+ static struct { -+ char *name; -+ struct lock_class_key *key; -+ } a[] = { -+ { .name = "&sbinfo->si_rwsem" }, -+ { .name = "&finfo->fi_rwsem" }, -+ { .name = "&dinfo->di_rwsem" }, -+ { .name = "&iinfo->ii_rwsem" } -+ }; -+ static int set; -+ int i; -+ -+ /* lockless read from 'set.' see below */ -+ if (set == ARRAY_SIZE(a)) { -+ for (i = 0; i < ARRAY_SIZE(a); i++) -+ if (a[i].key == key) -+ goto match; -+ goto unmatch; -+ } -+ -+ spin_lock(&spin); -+ if (set) -+ for (i = 0; i < ARRAY_SIZE(a); i++) -+ if (a[i].key == key) { -+ spin_unlock(&spin); -+ goto match; -+ } -+ for (i = 0; i < ARRAY_SIZE(a); i++) { -+ if (a[i].key) { -+ if (unlikely(a[i].key == key)) { /* rare but possible */ -+ spin_unlock(&spin); -+ goto match; -+ } else -+ continue; -+ } -+ if (strstr(a[i].name, name)) { -+ /* -+ * the order of these three lines is important for the -+ * lockless read above. -+ */ -+ a[i].key = key; -+ spin_unlock(&spin); -+ set++; -+ /* AuDbg("%d, %s\n", set, name); */ -+ goto match; -+ } -+ } -+ spin_unlock(&spin); -+ goto unmatch; -+ -+match: -+ return 1; -+unmatch: -+ return 0; -+} -+ -+static int au_wkq_lockdep_alloc(struct au_wkinfo *wkinfo) -+{ -+ int err, n; -+ struct task_struct *curr; -+ struct held_lock **hl, *held_locks, *p; -+ -+ err = 0; -+ curr = current; -+ wkinfo->dont_check = lockdep_recursing(curr); -+ if (wkinfo->dont_check) -+ goto out; -+ n = curr->lockdep_depth; -+ if (!n) -+ goto out; -+ -+ err = -ENOMEM; -+ wkinfo->hlock = kmalloc_array(n + 1, sizeof(*wkinfo->hlock), GFP_NOFS); -+ if (unlikely(!wkinfo->hlock)) -+ goto out; -+ -+ err = 0; -+#if 0 -+ if (0 && au_debug_test()) /* left for debugging */ -+ lockdep_print_held_locks(curr); -+#endif -+ held_locks = curr->held_locks; -+ hl = wkinfo->hlock; -+ while (n--) { -+ p = held_locks++; -+ if (au_wkq_lockdep_test(p->instance->key, p->instance->name)) -+ *hl++ = p; -+ } -+ *hl = NULL; -+ -+out: -+ return err; -+} -+ -+static void au_wkq_lockdep_free(struct au_wkinfo *wkinfo) -+{ -+ kfree(wkinfo->hlock); -+} -+ -+static void au_wkq_lockdep_pre(struct au_wkinfo *wkinfo) -+{ -+ struct held_lock *p, **hl = wkinfo->hlock; -+ int subclass; -+ -+ if (wkinfo->dont_check) -+ lockdep_off(); -+ if (!hl) -+ return; -+ while ((p = *hl++)) { /* assignment */ -+ subclass = lockdep_hlock_class(p)->subclass; -+ /* AuDbg("%s, %d\n", p->instance->name, subclass); */ -+ if (p->read) -+ rwsem_acquire_read(p->instance, subclass, 0, -+ /*p->acquire_ip*/_RET_IP_); -+ else -+ rwsem_acquire(p->instance, subclass, 0, -+ /*p->acquire_ip*/_RET_IP_); -+ } -+} -+ -+static void au_wkq_lockdep_post(struct au_wkinfo *wkinfo) -+{ -+ struct held_lock *p, **hl = wkinfo->hlock; -+ -+ if (wkinfo->dont_check) -+ lockdep_on(); -+ if (!hl) -+ return; -+ while ((p = *hl++)) /* assignment */ -+ rwsem_release(p->instance, 0, /*p->acquire_ip*/_RET_IP_); -+} -+#endif -+ -+static void wkq_func(struct work_struct *wk) -+{ -+ struct au_wkinfo *wkinfo = container_of(wk, struct au_wkinfo, wk); -+ -+ AuDebugOn(!uid_eq(current_fsuid(), GLOBAL_ROOT_UID)); -+ AuDebugOn(rlimit(RLIMIT_FSIZE) != RLIM_INFINITY); -+ -+ au_wkq_lockdep_pre(wkinfo); -+ wkinfo->func(wkinfo->args); -+ au_wkq_lockdep_post(wkinfo); -+ if (au_ftest_wkq(wkinfo->flags, WAIT)) -+ complete(wkinfo->comp); -+ else { -+ kobject_put(wkinfo->kobj); -+ module_put(THIS_MODULE); /* todo: ?? */ -+ kfree(wkinfo); -+ } -+} -+ -+/* -+ * Since struct completion is large, try allocating it dynamically. -+ */ -+#if 1 /* defined(CONFIG_4KSTACKS) || defined(AuTest4KSTACKS) */ -+#define AuWkqCompDeclare(name) struct completion *comp = NULL -+ -+static int au_wkq_comp_alloc(struct au_wkinfo *wkinfo, struct completion **comp) -+{ -+ *comp = kmalloc(sizeof(**comp), GFP_NOFS); -+ if (*comp) { -+ init_completion(*comp); -+ wkinfo->comp = *comp; -+ return 0; -+ } -+ return -ENOMEM; -+} -+ -+static void au_wkq_comp_free(struct completion *comp) -+{ -+ kfree(comp); -+} -+ -+#else -+ -+/* no braces */ -+#define AuWkqCompDeclare(name) \ -+ DECLARE_COMPLETION_ONSTACK(_ ## name); \ -+ struct completion *comp = &_ ## name -+ -+static int au_wkq_comp_alloc(struct au_wkinfo *wkinfo, struct completion **comp) -+{ -+ wkinfo->comp = *comp; -+ return 0; -+} -+ -+static void au_wkq_comp_free(struct completion *comp __maybe_unused) -+{ -+ /* empty */ -+} -+#endif /* 4KSTACKS */ -+ -+static void au_wkq_run(struct au_wkinfo *wkinfo) -+{ -+ if (au_ftest_wkq(wkinfo->flags, NEST)) { -+ if (au_wkq_test()) { -+ AuWarn1("wkq from wkq, unless silly-rename on NFS," -+ " due to a dead dir by UDBA?\n"); -+ AuDebugOn(au_ftest_wkq(wkinfo->flags, WAIT)); -+ } -+ } else -+ au_dbg_verify_kthread(); -+ -+ if (au_ftest_wkq(wkinfo->flags, WAIT)) { -+ INIT_WORK_ONSTACK(&wkinfo->wk, wkq_func); -+ queue_work(au_wkq, &wkinfo->wk); -+ } else { -+ INIT_WORK(&wkinfo->wk, wkq_func); -+ schedule_work(&wkinfo->wk); -+ } -+} -+ -+/* -+ * Be careful. It is easy to make deadlock happen. -+ * processA: lock, wkq and wait -+ * processB: wkq and wait, lock in wkq -+ * --> deadlock -+ */ -+int au_wkq_do_wait(unsigned int flags, au_wkq_func_t func, void *args) -+{ -+ int err; -+ AuWkqCompDeclare(comp); -+ struct au_wkinfo wkinfo = { -+ .flags = flags, -+ .func = func, -+ .args = args -+ }; -+ -+ err = au_wkq_comp_alloc(&wkinfo, &comp); -+ if (unlikely(err)) -+ goto out; -+ err = au_wkq_lockdep_alloc(&wkinfo); -+ if (unlikely(err)) -+ goto out_comp; -+ if (!err) { -+ au_wkq_run(&wkinfo); -+ /* no timeout, no interrupt */ -+ wait_for_completion(wkinfo.comp); -+ } -+ au_wkq_lockdep_free(&wkinfo); -+ -+out_comp: -+ au_wkq_comp_free(comp); -+out: -+ destroy_work_on_stack(&wkinfo.wk); -+ return err; -+} -+ -+/* -+ * Note: dget/dput() in func for aufs dentries are not supported. It will be a -+ * problem in a concurrent umounting. -+ */ -+int au_wkq_nowait(au_wkq_func_t func, void *args, struct super_block *sb, -+ unsigned int flags) -+{ -+ int err; -+ struct au_wkinfo *wkinfo; -+ -+ atomic_inc(&au_sbi(sb)->si_nowait.nw_len); -+ -+ /* -+ * wkq_func() must free this wkinfo. -+ * it highly depends upon the implementation of workqueue. -+ */ -+ err = 0; -+ wkinfo = kmalloc(sizeof(*wkinfo), GFP_NOFS); -+ if (wkinfo) { -+ wkinfo->kobj = &au_sbi(sb)->si_kobj; -+ wkinfo->flags = flags & ~AuWkq_WAIT; -+ wkinfo->func = func; -+ wkinfo->args = args; -+ wkinfo->comp = NULL; -+ au_wkq_lockdep_init(wkinfo); -+ kobject_get(wkinfo->kobj); -+ __module_get(THIS_MODULE); /* todo: ?? */ -+ -+ au_wkq_run(wkinfo); -+ } else { -+ err = -ENOMEM; -+ au_nwt_done(&au_sbi(sb)->si_nowait); -+ } -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void au_nwt_init(struct au_nowait_tasks *nwt) -+{ -+ atomic_set(&nwt->nw_len, 0); -+ /* smp_mb(); */ /* atomic_set */ -+ init_waitqueue_head(&nwt->nw_wq); -+} -+ -+void au_wkq_fin(void) -+{ -+ destroy_workqueue(au_wkq); -+} -+ -+int __init au_wkq_init(void) -+{ -+ int err; -+ -+ err = 0; -+ au_wkq = alloc_workqueue(AUFS_WKQ_NAME, 0, WQ_DFL_ACTIVE); -+ if (IS_ERR(au_wkq)) -+ err = PTR_ERR(au_wkq); -+ else if (!au_wkq) -+ err = -ENOMEM; -+ -+ return err; -+} -diff --git a/fs/aufs/wkq.h b/fs/aufs/wkq.h -new file mode 100644 -index 000000000000..43150d025ac3 ---- /dev/null -+++ b/fs/aufs/wkq.h -@@ -0,0 +1,81 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * workqueue for asynchronous/super-io operations -+ * todo: try new credentials management scheme -+ */ -+ -+#ifndef __AUFS_WKQ_H__ -+#define __AUFS_WKQ_H__ -+ -+#ifdef __KERNEL__ -+ -+#include -+ -+struct super_block; -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * in the next operation, wait for the 'nowait' tasks in system-wide workqueue -+ */ -+struct au_nowait_tasks { -+ atomic_t nw_len; -+ wait_queue_head_t nw_wq; -+}; -+ -+/* ---------------------------------------------------------------------- */ -+ -+typedef void (*au_wkq_func_t)(void *args); -+ -+/* wkq flags */ -+#define AuWkq_WAIT 1 -+#define AuWkq_NEST (1 << 1) -+#define au_ftest_wkq(flags, name) ((flags) & AuWkq_##name) -+#define au_fset_wkq(flags, name) \ -+ do { (flags) |= AuWkq_##name; } while (0) -+#define au_fclr_wkq(flags, name) \ -+ do { (flags) &= ~AuWkq_##name; } while (0) -+ -+#ifndef CONFIG_AUFS_HNOTIFY -+#undef AuWkq_NEST -+#define AuWkq_NEST 0 -+#endif -+ -+/* wkq.c */ -+int au_wkq_do_wait(unsigned int flags, au_wkq_func_t func, void *args); -+int au_wkq_nowait(au_wkq_func_t func, void *args, struct super_block *sb, -+ unsigned int flags); -+void au_nwt_init(struct au_nowait_tasks *nwt); -+int __init au_wkq_init(void); -+void au_wkq_fin(void); -+ -+/* ---------------------------------------------------------------------- */ -+ -+static inline int au_wkq_test(void) -+{ -+ return current->flags & PF_WQ_WORKER; -+} -+ -+static inline int au_wkq_wait(au_wkq_func_t func, void *args) -+{ -+ return au_wkq_do_wait(AuWkq_WAIT, func, args); -+} -+ -+static inline void au_nwt_done(struct au_nowait_tasks *nwt) -+{ -+ if (atomic_dec_and_test(&nwt->nw_len)) -+ wake_up_all(&nwt->nw_wq); -+} -+ -+static inline int au_nwt_flush(struct au_nowait_tasks *nwt) -+{ -+ wait_event(nwt->nw_wq, !atomic_read(&nwt->nw_len)); -+ return 0; -+} -+ -+#endif /* __KERNEL__ */ -+#endif /* __AUFS_WKQ_H__ */ -diff --git a/fs/aufs/xattr.c b/fs/aufs/xattr.c -new file mode 100644 -index 000000000000..dbe452868cd5 ---- /dev/null -+++ b/fs/aufs/xattr.c -@@ -0,0 +1,343 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2014-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * handling xattr functions -+ */ -+ -+#include -+#include -+#include -+#include "aufs.h" -+ -+static int au_xattr_ignore(int err, char *name, unsigned int ignore_flags) -+{ -+ if (!ignore_flags) -+ goto out; -+ switch (err) { -+ case -ENOMEM: -+ case -EDQUOT: -+ goto out; -+ } -+ -+ if ((ignore_flags & AuBrAttr_ICEX) == AuBrAttr_ICEX) { -+ err = 0; -+ goto out; -+ } -+ -+#define cmp(brattr, prefix) do { \ -+ if (!strncmp(name, XATTR_##prefix##_PREFIX, \ -+ XATTR_##prefix##_PREFIX_LEN)) { \ -+ if (ignore_flags & AuBrAttr_ICEX_##brattr) \ -+ err = 0; \ -+ goto out; \ -+ } \ -+ } while (0) -+ -+ cmp(SEC, SECURITY); -+ cmp(SYS, SYSTEM); -+ cmp(TR, TRUSTED); -+ cmp(USR, USER); -+#undef cmp -+ -+ if (ignore_flags & AuBrAttr_ICEX_OTH) -+ err = 0; -+ -+out: -+ return err; -+} -+ -+static const int au_xattr_out_of_list = AuBrAttr_ICEX_OTH << 1; -+ -+static int au_do_cpup_xattr(struct dentry *h_dst, struct dentry *h_src, -+ char *name, char **buf, unsigned int ignore_flags, -+ unsigned int verbose) -+{ -+ int err; -+ ssize_t ssz; -+ struct inode *h_idst; -+ -+ ssz = vfs_getxattr_alloc(h_src, name, buf, 0, GFP_NOFS); -+ err = ssz; -+ if (unlikely(err <= 0)) { -+ if (err == -ENODATA -+ || (err == -EOPNOTSUPP -+ && ((ignore_flags & au_xattr_out_of_list) -+ || (au_test_nfs_noacl(d_inode(h_src)) -+ && (!strcmp(name, XATTR_NAME_POSIX_ACL_ACCESS) -+ || !strcmp(name, -+ XATTR_NAME_POSIX_ACL_DEFAULT)))) -+ )) -+ err = 0; -+ if (err && (verbose || au_debug_test())) -+ pr_err("%s, err %d\n", name, err); -+ goto out; -+ } -+ -+ /* unlock it temporary */ -+ h_idst = d_inode(h_dst); -+ inode_unlock(h_idst); -+ err = vfsub_setxattr(h_dst, name, *buf, ssz, /*flags*/0); -+ inode_lock_nested(h_idst, AuLsc_I_CHILD2); -+ if (unlikely(err)) { -+ if (verbose || au_debug_test()) -+ pr_err("%s, err %d\n", name, err); -+ err = au_xattr_ignore(err, name, ignore_flags); -+ } -+ -+out: -+ return err; -+} -+ -+int au_cpup_xattr(struct dentry *h_dst, struct dentry *h_src, int ignore_flags, -+ unsigned int verbose) -+{ -+ int err, unlocked, acl_access, acl_default; -+ ssize_t ssz; -+ struct inode *h_isrc, *h_idst; -+ char *value, *p, *o, *e; -+ -+ /* try stopping to update the source inode while we are referencing */ -+ /* there should not be the parent-child relationship between them */ -+ h_isrc = d_inode(h_src); -+ h_idst = d_inode(h_dst); -+ inode_unlock(h_idst); -+ vfsub_inode_lock_shared_nested(h_isrc, AuLsc_I_CHILD); -+ inode_lock_nested(h_idst, AuLsc_I_CHILD2); -+ unlocked = 0; -+ -+ /* some filesystems don't list POSIX ACL, for example tmpfs */ -+ ssz = vfs_listxattr(h_src, NULL, 0); -+ err = ssz; -+ if (unlikely(err < 0)) { -+ AuTraceErr(err); -+ if (err == -ENODATA -+ || err == -EOPNOTSUPP) -+ err = 0; /* ignore */ -+ goto out; -+ } -+ -+ err = 0; -+ p = NULL; -+ o = NULL; -+ if (ssz) { -+ err = -ENOMEM; -+ p = kmalloc(ssz, GFP_NOFS); -+ o = p; -+ if (unlikely(!p)) -+ goto out; -+ err = vfs_listxattr(h_src, p, ssz); -+ } -+ inode_unlock_shared(h_isrc); -+ unlocked = 1; -+ AuDbg("err %d, ssz %zd\n", err, ssz); -+ if (unlikely(err < 0)) -+ goto out_free; -+ -+ err = 0; -+ e = p + ssz; -+ value = NULL; -+ acl_access = 0; -+ acl_default = 0; -+ while (!err && p < e) { -+ acl_access |= !strncmp(p, XATTR_NAME_POSIX_ACL_ACCESS, -+ sizeof(XATTR_NAME_POSIX_ACL_ACCESS) - 1); -+ acl_default |= !strncmp(p, XATTR_NAME_POSIX_ACL_DEFAULT, -+ sizeof(XATTR_NAME_POSIX_ACL_DEFAULT) -+ - 1); -+ err = au_do_cpup_xattr(h_dst, h_src, p, &value, ignore_flags, -+ verbose); -+ p += strlen(p) + 1; -+ } -+ AuTraceErr(err); -+ ignore_flags |= au_xattr_out_of_list; -+ if (!err && !acl_access) { -+ err = au_do_cpup_xattr(h_dst, h_src, -+ XATTR_NAME_POSIX_ACL_ACCESS, &value, -+ ignore_flags, verbose); -+ AuTraceErr(err); -+ } -+ if (!err && !acl_default) { -+ err = au_do_cpup_xattr(h_dst, h_src, -+ XATTR_NAME_POSIX_ACL_DEFAULT, &value, -+ ignore_flags, verbose); -+ AuTraceErr(err); -+ } -+ -+ kfree(value); -+ -+out_free: -+ kfree(o); -+out: -+ if (!unlocked) -+ inode_unlock_shared(h_isrc); -+ AuTraceErr(err); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_smack_reentering(struct super_block *sb) -+{ -+#if IS_ENABLED(CONFIG_SECURITY_SMACK) -+ /* -+ * as a part of lookup, smack_d_instantiate() is called, and it calls -+ * i_op->getxattr(). ouch. -+ */ -+ return si_pid_test(sb); -+#else -+ return 0; -+#endif -+} -+ -+enum { -+ AU_XATTR_LIST, -+ AU_XATTR_GET -+}; -+ -+struct au_lgxattr { -+ int type; -+ union { -+ struct { -+ char *list; -+ size_t size; -+ } list; -+ struct { -+ const char *name; -+ void *value; -+ size_t size; -+ } get; -+ } u; -+}; -+ -+static ssize_t au_lgxattr(struct dentry *dentry, struct au_lgxattr *arg) -+{ -+ ssize_t err; -+ int reenter; -+ struct path h_path; -+ struct super_block *sb; -+ -+ sb = dentry->d_sb; -+ reenter = au_smack_reentering(sb); -+ if (!reenter) { -+ err = si_read_lock(sb, AuLock_FLUSH | AuLock_NOPLM); -+ if (unlikely(err)) -+ goto out; -+ } -+ err = au_h_path_getattr(dentry, /*force*/1, &h_path, reenter); -+ if (unlikely(err)) -+ goto out_si; -+ if (unlikely(!h_path.dentry)) -+ /* illegally overlapped or something */ -+ goto out_di; /* pretending success */ -+ -+ /* always topmost entry only */ -+ switch (arg->type) { -+ case AU_XATTR_LIST: -+ err = vfs_listxattr(h_path.dentry, -+ arg->u.list.list, arg->u.list.size); -+ break; -+ case AU_XATTR_GET: -+ AuDebugOn(d_is_negative(h_path.dentry)); -+ err = vfs_getxattr(h_path.dentry, -+ arg->u.get.name, arg->u.get.value, -+ arg->u.get.size); -+ break; -+ } -+ -+out_di: -+ if (!reenter) -+ di_read_unlock(dentry, AuLock_IR); -+out_si: -+ if (!reenter) -+ si_read_unlock(sb); -+out: -+ AuTraceErr(err); -+ return err; -+} -+ -+ssize_t aufs_listxattr(struct dentry *dentry, char *list, size_t size) -+{ -+ struct au_lgxattr arg = { -+ .type = AU_XATTR_LIST, -+ .u.list = { -+ .list = list, -+ .size = size -+ }, -+ }; -+ -+ return au_lgxattr(dentry, &arg); -+} -+ -+static ssize_t au_getxattr(struct dentry *dentry, -+ struct inode *inode __maybe_unused, -+ const char *name, void *value, size_t size) -+{ -+ struct au_lgxattr arg = { -+ .type = AU_XATTR_GET, -+ .u.get = { -+ .name = name, -+ .value = value, -+ .size = size -+ }, -+ }; -+ -+ return au_lgxattr(dentry, &arg); -+} -+ -+static int au_setxattr(struct dentry *dentry, struct inode *inode, -+ const char *name, const void *value, size_t size, -+ int flags) -+{ -+ struct au_sxattr arg = { -+ .type = AU_XATTR_SET, -+ .u.set = { -+ .name = name, -+ .value = value, -+ .size = size, -+ .flags = flags -+ }, -+ }; -+ -+ return au_sxattr(dentry, inode, &arg); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_xattr_get(const struct xattr_handler *handler, -+ struct dentry *dentry, struct inode *inode, -+ const char *name, void *buffer, size_t size) -+{ -+ return au_getxattr(dentry, inode, name, buffer, size); -+} -+ -+static int au_xattr_set(const struct xattr_handler *handler, -+ struct dentry *dentry, struct inode *inode, -+ const char *name, const void *value, size_t size, -+ int flags) -+{ -+ return au_setxattr(dentry, inode, name, value, size, flags); -+} -+ -+static const struct xattr_handler au_xattr_handler = { -+ .name = "", -+ .prefix = "", -+ .get = au_xattr_get, -+ .set = au_xattr_set -+}; -+ -+static const struct xattr_handler *au_xattr_handlers[] = { -+#ifdef CONFIG_FS_POSIX_ACL -+ &posix_acl_access_xattr_handler, -+ &posix_acl_default_xattr_handler, -+#endif -+ &au_xattr_handler, /* must be last */ -+ NULL -+}; -+ -+void au_xattr_init(struct super_block *sb) -+{ -+ sb->s_xattr = au_xattr_handlers; -+} -diff --git a/fs/aufs/xino.c b/fs/aufs/xino.c -new file mode 100644 -index 000000000000..eea2c34cabf4 ---- /dev/null -+++ b/fs/aufs/xino.c -@@ -0,0 +1,1457 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+/* -+ * external inode number translation table and bitmap -+ */ -+ -+#include -+#include -+#include "aufs.h" -+ -+static ssize_t xino_fread_wkq(vfs_readf_t func, struct file *file, void *buf, -+ size_t size, loff_t *pos); -+ -+/* todo: unnecessary to support mmap_sem since kernel-space? */ -+ssize_t xino_fread(vfs_readf_t func, struct file *file, void *kbuf, size_t size, -+ loff_t *pos) -+{ -+ ssize_t err; -+ mm_segment_t oldfs; -+ union { -+ void *k; -+ char __user *u; -+ } buf; -+ int i; -+ const int prevent_endless = 10; -+ -+ i = 0; -+ buf.k = kbuf; -+ oldfs = get_fs(); -+ set_fs(KERNEL_DS); -+ do { -+ err = func(file, buf.u, size, pos); -+ if (err == -EINTR -+ && !au_wkq_test() -+ && fatal_signal_pending(current)) { -+ set_fs(oldfs); -+ err = xino_fread_wkq(func, file, kbuf, size, pos); -+ BUG_ON(err == -EINTR); -+ oldfs = get_fs(); -+ set_fs(KERNEL_DS); -+ } -+ } while (i++ < prevent_endless -+ && (err == -EAGAIN || err == -EINTR)); -+ set_fs(oldfs); -+ -+#if 0 /* reserved for future use */ -+ if (err > 0) -+ fsnotify_access(file->f_path.dentry); -+#endif -+ -+ return err; -+} -+ -+struct xino_fread_args { -+ ssize_t *errp; -+ vfs_readf_t func; -+ struct file *file; -+ void *buf; -+ size_t size; -+ loff_t *pos; -+}; -+ -+static void call_xino_fread(void *args) -+{ -+ struct xino_fread_args *a = args; -+ *a->errp = xino_fread(a->func, a->file, a->buf, a->size, a->pos); -+} -+ -+static ssize_t xino_fread_wkq(vfs_readf_t func, struct file *file, void *buf, -+ size_t size, loff_t *pos) -+{ -+ ssize_t err; -+ int wkq_err; -+ struct xino_fread_args args = { -+ .errp = &err, -+ .func = func, -+ .file = file, -+ .buf = buf, -+ .size = size, -+ .pos = pos -+ }; -+ -+ wkq_err = au_wkq_wait(call_xino_fread, &args); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static ssize_t xino_fwrite_wkq(vfs_writef_t func, struct file *file, void *buf, -+ size_t size, loff_t *pos); -+ -+static ssize_t do_xino_fwrite(vfs_writef_t func, struct file *file, void *kbuf, -+ size_t size, loff_t *pos) -+{ -+ ssize_t err; -+ mm_segment_t oldfs; -+ union { -+ void *k; -+ const char __user *u; -+ } buf; -+ int i; -+ const int prevent_endless = 10; -+ -+ i = 0; -+ buf.k = kbuf; -+ oldfs = get_fs(); -+ set_fs(KERNEL_DS); -+ do { -+ err = func(file, buf.u, size, pos); -+ if (err == -EINTR -+ && !au_wkq_test() -+ && fatal_signal_pending(current)) { -+ set_fs(oldfs); -+ err = xino_fwrite_wkq(func, file, kbuf, size, pos); -+ BUG_ON(err == -EINTR); -+ oldfs = get_fs(); -+ set_fs(KERNEL_DS); -+ } -+ } while (i++ < prevent_endless -+ && (err == -EAGAIN || err == -EINTR)); -+ set_fs(oldfs); -+ -+#if 0 /* reserved for future use */ -+ if (err > 0) -+ fsnotify_modify(file->f_path.dentry); -+#endif -+ -+ return err; -+} -+ -+struct do_xino_fwrite_args { -+ ssize_t *errp; -+ vfs_writef_t func; -+ struct file *file; -+ void *buf; -+ size_t size; -+ loff_t *pos; -+}; -+ -+static void call_do_xino_fwrite(void *args) -+{ -+ struct do_xino_fwrite_args *a = args; -+ *a->errp = do_xino_fwrite(a->func, a->file, a->buf, a->size, a->pos); -+} -+ -+static ssize_t xino_fwrite_wkq(vfs_writef_t func, struct file *file, void *buf, -+ size_t size, loff_t *pos) -+{ -+ ssize_t err; -+ int wkq_err; -+ struct do_xino_fwrite_args args = { -+ .errp = &err, -+ .func = func, -+ .file = file, -+ .buf = buf, -+ .size = size, -+ .pos = pos -+ }; -+ -+ /* -+ * it breaks RLIMIT_FSIZE and normal user's limit, -+ * users should care about quota and real 'filesystem full.' -+ */ -+ wkq_err = au_wkq_wait(call_do_xino_fwrite, &args); -+ if (unlikely(wkq_err)) -+ err = wkq_err; -+ -+ return err; -+} -+ -+ssize_t xino_fwrite(vfs_writef_t func, struct file *file, void *buf, -+ size_t size, loff_t *pos) -+{ -+ ssize_t err; -+ -+ if (rlimit(RLIMIT_FSIZE) == RLIM_INFINITY) { -+ lockdep_off(); -+ err = do_xino_fwrite(func, file, buf, size, pos); -+ lockdep_on(); -+ } else { -+ lockdep_off(); -+ err = xino_fwrite_wkq(func, file, buf, size, pos); -+ lockdep_on(); -+ } -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * create a new xinofile at the same place/path as @base_file. -+ */ -+struct file *au_xino_create2(struct file *base_file, struct file *copy_src) -+{ -+ struct file *file; -+ struct dentry *base, *parent; -+ struct inode *dir, *delegated; -+ struct qstr *name; -+ struct path path; -+ int err; -+ -+ base = base_file->f_path.dentry; -+ parent = base->d_parent; /* dir inode is locked */ -+ dir = d_inode(parent); -+ IMustLock(dir); -+ -+ file = ERR_PTR(-EINVAL); -+ name = &base->d_name; -+ path.dentry = vfsub_lookup_one_len(name->name, parent, name->len); -+ if (IS_ERR(path.dentry)) { -+ file = (void *)path.dentry; -+ pr_err("%pd lookup err %ld\n", -+ base, PTR_ERR(path.dentry)); -+ goto out; -+ } -+ -+ /* no need to mnt_want_write() since we call dentry_open() later */ -+ err = vfs_create(dir, path.dentry, S_IRUGO | S_IWUGO, NULL); -+ if (unlikely(err)) { -+ file = ERR_PTR(err); -+ pr_err("%pd create err %d\n", base, err); -+ goto out_dput; -+ } -+ -+ path.mnt = base_file->f_path.mnt; -+ file = vfsub_dentry_open(&path, -+ O_RDWR | O_CREAT | O_EXCL | O_LARGEFILE -+ /* | __FMODE_NONOTIFY */); -+ if (IS_ERR(file)) { -+ pr_err("%pd open err %ld\n", base, PTR_ERR(file)); -+ goto out_dput; -+ } -+ -+ delegated = NULL; -+ err = vfsub_unlink(dir, &file->f_path, &delegated, /*force*/0); -+ if (unlikely(err == -EWOULDBLOCK)) { -+ pr_warn("cannot retry for NFSv4 delegation" -+ " for an internal unlink\n"); -+ iput(delegated); -+ } -+ if (unlikely(err)) { -+ pr_err("%pd unlink err %d\n", base, err); -+ goto out_fput; -+ } -+ -+ if (copy_src) { -+ /* no one can touch copy_src xino */ -+ err = au_copy_file(file, copy_src, vfsub_f_size_read(copy_src)); -+ if (unlikely(err)) { -+ pr_err("%pd copy err %d\n", base, err); -+ goto out_fput; -+ } -+ } -+ goto out_dput; /* success */ -+ -+out_fput: -+ fput(file); -+ file = ERR_PTR(err); -+out_dput: -+ dput(path.dentry); -+out: -+ return file; -+} -+ -+struct au_xino_lock_dir { -+ struct au_hinode *hdir; -+ struct dentry *parent; -+ struct inode *dir; -+}; -+ -+static void au_xino_lock_dir(struct super_block *sb, struct file *xino, -+ struct au_xino_lock_dir *ldir) -+{ -+ aufs_bindex_t brid, bindex; -+ -+ ldir->hdir = NULL; -+ bindex = -1; -+ brid = au_xino_brid(sb); -+ if (brid >= 0) -+ bindex = au_br_index(sb, brid); -+ if (bindex >= 0) { -+ ldir->hdir = au_hi(d_inode(sb->s_root), bindex); -+ au_hn_inode_lock_nested(ldir->hdir, AuLsc_I_PARENT); -+ } else { -+ ldir->parent = dget_parent(xino->f_path.dentry); -+ ldir->dir = d_inode(ldir->parent); -+ inode_lock_nested(ldir->dir, AuLsc_I_PARENT); -+ } -+} -+ -+static void au_xino_unlock_dir(struct au_xino_lock_dir *ldir) -+{ -+ if (ldir->hdir) -+ au_hn_inode_unlock(ldir->hdir); -+ else { -+ inode_unlock(ldir->dir); -+ dput(ldir->parent); -+ } -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* trucate xino files asynchronously */ -+ -+int au_xino_trunc(struct super_block *sb, aufs_bindex_t bindex) -+{ -+ int err; -+ unsigned long jiffy; -+ blkcnt_t blocks; -+ aufs_bindex_t bi, bbot; -+ struct kstatfs *st; -+ struct au_branch *br; -+ struct file *new_xino, *file; -+ struct super_block *h_sb; -+ struct au_xino_lock_dir ldir; -+ -+ err = -ENOMEM; -+ st = kmalloc(sizeof(*st), GFP_NOFS); -+ if (unlikely(!st)) -+ goto out; -+ -+ err = -EINVAL; -+ bbot = au_sbbot(sb); -+ if (unlikely(bindex < 0 || bbot < bindex)) -+ goto out_st; -+ br = au_sbr(sb, bindex); -+ file = br->br_xino.xi_file; -+ if (!file) -+ goto out_st; -+ -+ err = vfs_statfs(&file->f_path, st); -+ if (unlikely(err)) -+ AuErr1("statfs err %d, ignored\n", err); -+ jiffy = jiffies; -+ blocks = file_inode(file)->i_blocks; -+ pr_info("begin truncating xino(b%d), ib%llu, %llu/%llu free blks\n", -+ bindex, (u64)blocks, st->f_bfree, st->f_blocks); -+ -+ au_xino_lock_dir(sb, file, &ldir); -+ /* mnt_want_write() is unnecessary here */ -+ new_xino = au_xino_create2(file, file); -+ au_xino_unlock_dir(&ldir); -+ err = PTR_ERR(new_xino); -+ if (IS_ERR(new_xino)) { -+ pr_err("err %d, ignored\n", err); -+ goto out_st; -+ } -+ err = 0; -+ fput(file); -+ br->br_xino.xi_file = new_xino; -+ -+ h_sb = au_br_sb(br); -+ for (bi = 0; bi <= bbot; bi++) { -+ if (unlikely(bi == bindex)) -+ continue; -+ br = au_sbr(sb, bi); -+ if (au_br_sb(br) != h_sb) -+ continue; -+ -+ fput(br->br_xino.xi_file); -+ br->br_xino.xi_file = new_xino; -+ get_file(new_xino); -+ } -+ -+ err = vfs_statfs(&new_xino->f_path, st); -+ if (!err) { -+ pr_info("end truncating xino(b%d), ib%llu, %llu/%llu free blks\n", -+ bindex, (u64)file_inode(new_xino)->i_blocks, -+ st->f_bfree, st->f_blocks); -+ if (file_inode(new_xino)->i_blocks < blocks) -+ au_sbi(sb)->si_xino_jiffy = jiffy; -+ } else -+ AuErr1("statfs err %d, ignored\n", err); -+ -+out_st: -+ kfree(st); -+out: -+ return err; -+} -+ -+struct xino_do_trunc_args { -+ struct super_block *sb; -+ struct au_branch *br; -+}; -+ -+static void xino_do_trunc(void *_args) -+{ -+ struct xino_do_trunc_args *args = _args; -+ struct super_block *sb; -+ struct au_branch *br; -+ struct inode *dir; -+ int err; -+ aufs_bindex_t bindex; -+ -+ err = 0; -+ sb = args->sb; -+ dir = d_inode(sb->s_root); -+ br = args->br; -+ -+ si_noflush_write_lock(sb); -+ ii_read_lock_parent(dir); -+ bindex = au_br_index(sb, br->br_id); -+ err = au_xino_trunc(sb, bindex); -+ ii_read_unlock(dir); -+ if (unlikely(err)) -+ pr_warn("err b%d, (%d)\n", bindex, err); -+ atomic_dec(&br->br_xino_running); -+ au_br_put(br); -+ si_write_unlock(sb); -+ au_nwt_done(&au_sbi(sb)->si_nowait); -+ kfree(args); -+} -+ -+static int xino_trunc_test(struct super_block *sb, struct au_branch *br) -+{ -+ int err; -+ struct kstatfs st; -+ struct au_sbinfo *sbinfo; -+ -+ /* todo: si_xino_expire and the ratio should be customizable */ -+ sbinfo = au_sbi(sb); -+ if (time_before(jiffies, -+ sbinfo->si_xino_jiffy + sbinfo->si_xino_expire)) -+ return 0; -+ -+ /* truncation border */ -+ err = vfs_statfs(&br->br_xino.xi_file->f_path, &st); -+ if (unlikely(err)) { -+ AuErr1("statfs err %d, ignored\n", err); -+ return 0; -+ } -+ if (div64_u64(st.f_bfree * 100, st.f_blocks) >= AUFS_XINO_DEF_TRUNC) -+ return 0; -+ -+ return 1; -+} -+ -+static void xino_try_trunc(struct super_block *sb, struct au_branch *br) -+{ -+ struct xino_do_trunc_args *args; -+ int wkq_err; -+ -+ if (!xino_trunc_test(sb, br)) -+ return; -+ -+ if (atomic_inc_return(&br->br_xino_running) > 1) -+ goto out; -+ -+ /* lock and kfree() will be called in trunc_xino() */ -+ args = kmalloc(sizeof(*args), GFP_NOFS); -+ if (unlikely(!args)) { -+ AuErr1("no memory\n"); -+ goto out; -+ } -+ -+ au_br_get(br); -+ args->sb = sb; -+ args->br = br; -+ wkq_err = au_wkq_nowait(xino_do_trunc, args, sb, /*flags*/0); -+ if (!wkq_err) -+ return; /* success */ -+ -+ pr_err("wkq %d\n", wkq_err); -+ au_br_put(br); -+ kfree(args); -+ -+out: -+ atomic_dec(&br->br_xino_running); -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static int au_xino_do_write(vfs_writef_t write, struct file *file, -+ ino_t h_ino, ino_t ino) -+{ -+ loff_t pos; -+ ssize_t sz; -+ -+ pos = h_ino; -+ if (unlikely(au_loff_max / sizeof(ino) - 1 < pos)) { -+ AuIOErr1("too large hi%lu\n", (unsigned long)h_ino); -+ return -EFBIG; -+ } -+ pos *= sizeof(ino); -+ sz = xino_fwrite(write, file, &ino, sizeof(ino), &pos); -+ if (sz == sizeof(ino)) -+ return 0; /* success */ -+ -+ AuIOErr("write failed (%zd)\n", sz); -+ return -EIO; -+} -+ -+/* -+ * write @ino to the xinofile for the specified branch{@sb, @bindex} -+ * at the position of @h_ino. -+ * even if @ino is zero, it is written to the xinofile and means no entry. -+ * if the size of the xino file on a specific filesystem exceeds the watermark, -+ * try truncating it. -+ */ -+int au_xino_write(struct super_block *sb, aufs_bindex_t bindex, ino_t h_ino, -+ ino_t ino) -+{ -+ int err; -+ unsigned int mnt_flags; -+ struct au_branch *br; -+ -+ BUILD_BUG_ON(sizeof(long long) != sizeof(au_loff_max) -+ || ((loff_t)-1) > 0); -+ SiMustAnyLock(sb); -+ -+ mnt_flags = au_mntflags(sb); -+ if (!au_opt_test(mnt_flags, XINO)) -+ return 0; -+ -+ br = au_sbr(sb, bindex); -+ err = au_xino_do_write(au_sbi(sb)->si_xwrite, br->br_xino.xi_file, -+ h_ino, ino); -+ if (!err) { -+ if (au_opt_test(mnt_flags, TRUNC_XINO) -+ && au_test_fs_trunc_xino(au_br_sb(br))) -+ xino_try_trunc(sb, br); -+ return 0; /* success */ -+ } -+ -+ AuIOErr("write failed (%d)\n", err); -+ return -EIO; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* aufs inode number bitmap */ -+ -+static const int page_bits = (int)PAGE_SIZE * BITS_PER_BYTE; -+static ino_t xib_calc_ino(unsigned long pindex, int bit) -+{ -+ ino_t ino; -+ -+ AuDebugOn(bit < 0 || page_bits <= bit); -+ ino = AUFS_FIRST_INO + pindex * page_bits + bit; -+ return ino; -+} -+ -+static void xib_calc_bit(ino_t ino, unsigned long *pindex, int *bit) -+{ -+ AuDebugOn(ino < AUFS_FIRST_INO); -+ ino -= AUFS_FIRST_INO; -+ *pindex = ino / page_bits; -+ *bit = ino % page_bits; -+} -+ -+static int xib_pindex(struct super_block *sb, unsigned long pindex) -+{ -+ int err; -+ loff_t pos; -+ ssize_t sz; -+ struct au_sbinfo *sbinfo; -+ struct file *xib; -+ unsigned long *p; -+ -+ sbinfo = au_sbi(sb); -+ MtxMustLock(&sbinfo->si_xib_mtx); -+ AuDebugOn(pindex > ULONG_MAX / PAGE_SIZE -+ || !au_opt_test(sbinfo->si_mntflags, XINO)); -+ -+ if (pindex == sbinfo->si_xib_last_pindex) -+ return 0; -+ -+ xib = sbinfo->si_xib; -+ p = sbinfo->si_xib_buf; -+ pos = sbinfo->si_xib_last_pindex; -+ pos *= PAGE_SIZE; -+ sz = xino_fwrite(sbinfo->si_xwrite, xib, p, PAGE_SIZE, &pos); -+ if (unlikely(sz != PAGE_SIZE)) -+ goto out; -+ -+ pos = pindex; -+ pos *= PAGE_SIZE; -+ if (vfsub_f_size_read(xib) >= pos + PAGE_SIZE) -+ sz = xino_fread(sbinfo->si_xread, xib, p, PAGE_SIZE, &pos); -+ else { -+ memset(p, 0, PAGE_SIZE); -+ sz = xino_fwrite(sbinfo->si_xwrite, xib, p, PAGE_SIZE, &pos); -+ } -+ if (sz == PAGE_SIZE) { -+ sbinfo->si_xib_last_pindex = pindex; -+ return 0; /* success */ -+ } -+ -+out: -+ AuIOErr1("write failed (%zd)\n", sz); -+ err = sz; -+ if (sz >= 0) -+ err = -EIO; -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+static void au_xib_clear_bit(struct inode *inode) -+{ -+ int err, bit; -+ unsigned long pindex; -+ struct super_block *sb; -+ struct au_sbinfo *sbinfo; -+ -+ AuDebugOn(inode->i_nlink); -+ -+ sb = inode->i_sb; -+ xib_calc_bit(inode->i_ino, &pindex, &bit); -+ AuDebugOn(page_bits <= bit); -+ sbinfo = au_sbi(sb); -+ mutex_lock(&sbinfo->si_xib_mtx); -+ err = xib_pindex(sb, pindex); -+ if (!err) { -+ clear_bit(bit, sbinfo->si_xib_buf); -+ sbinfo->si_xib_next_bit = bit; -+ } -+ mutex_unlock(&sbinfo->si_xib_mtx); -+} -+ -+/* for s_op->delete_inode() */ -+void au_xino_delete_inode(struct inode *inode, const int unlinked) -+{ -+ int err; -+ unsigned int mnt_flags; -+ aufs_bindex_t bindex, bbot, bi; -+ unsigned char try_trunc; -+ struct au_iinfo *iinfo; -+ struct super_block *sb; -+ struct au_hinode *hi; -+ struct inode *h_inode; -+ struct au_branch *br; -+ vfs_writef_t xwrite; -+ -+ AuDebugOn(au_is_bad_inode(inode)); -+ -+ sb = inode->i_sb; -+ mnt_flags = au_mntflags(sb); -+ if (!au_opt_test(mnt_flags, XINO) -+ || inode->i_ino == AUFS_ROOT_INO) -+ return; -+ -+ if (unlinked) { -+ au_xigen_inc(inode); -+ au_xib_clear_bit(inode); -+ } -+ -+ iinfo = au_ii(inode); -+ bindex = iinfo->ii_btop; -+ if (bindex < 0) -+ return; -+ -+ xwrite = au_sbi(sb)->si_xwrite; -+ try_trunc = !!au_opt_test(mnt_flags, TRUNC_XINO); -+ hi = au_hinode(iinfo, bindex); -+ bbot = iinfo->ii_bbot; -+ for (; bindex <= bbot; bindex++, hi++) { -+ h_inode = hi->hi_inode; -+ if (!h_inode -+ || (!unlinked && h_inode->i_nlink)) -+ continue; -+ -+ /* inode may not be revalidated */ -+ bi = au_br_index(sb, hi->hi_id); -+ if (bi < 0) -+ continue; -+ -+ br = au_sbr(sb, bi); -+ err = au_xino_do_write(xwrite, br->br_xino.xi_file, -+ h_inode->i_ino, /*ino*/0); -+ if (!err && try_trunc -+ && au_test_fs_trunc_xino(au_br_sb(br))) -+ xino_try_trunc(sb, br); -+ } -+} -+ -+/* get an unused inode number from bitmap */ -+ino_t au_xino_new_ino(struct super_block *sb) -+{ -+ ino_t ino; -+ unsigned long *p, pindex, ul, pend; -+ struct au_sbinfo *sbinfo; -+ struct file *file; -+ int free_bit, err; -+ -+ if (!au_opt_test(au_mntflags(sb), XINO)) -+ return iunique(sb, AUFS_FIRST_INO); -+ -+ sbinfo = au_sbi(sb); -+ mutex_lock(&sbinfo->si_xib_mtx); -+ p = sbinfo->si_xib_buf; -+ free_bit = sbinfo->si_xib_next_bit; -+ if (free_bit < page_bits && !test_bit(free_bit, p)) -+ goto out; /* success */ -+ free_bit = find_first_zero_bit(p, page_bits); -+ if (free_bit < page_bits) -+ goto out; /* success */ -+ -+ pindex = sbinfo->si_xib_last_pindex; -+ for (ul = pindex - 1; ul < ULONG_MAX; ul--) { -+ err = xib_pindex(sb, ul); -+ if (unlikely(err)) -+ goto out_err; -+ free_bit = find_first_zero_bit(p, page_bits); -+ if (free_bit < page_bits) -+ goto out; /* success */ -+ } -+ -+ file = sbinfo->si_xib; -+ pend = vfsub_f_size_read(file) / PAGE_SIZE; -+ for (ul = pindex + 1; ul <= pend; ul++) { -+ err = xib_pindex(sb, ul); -+ if (unlikely(err)) -+ goto out_err; -+ free_bit = find_first_zero_bit(p, page_bits); -+ if (free_bit < page_bits) -+ goto out; /* success */ -+ } -+ BUG(); -+ -+out: -+ set_bit(free_bit, p); -+ sbinfo->si_xib_next_bit = free_bit + 1; -+ pindex = sbinfo->si_xib_last_pindex; -+ mutex_unlock(&sbinfo->si_xib_mtx); -+ ino = xib_calc_ino(pindex, free_bit); -+ AuDbg("i%lu\n", (unsigned long)ino); -+ return ino; -+out_err: -+ mutex_unlock(&sbinfo->si_xib_mtx); -+ AuDbg("i0\n"); -+ return 0; -+} -+ -+/* -+ * read @ino from xinofile for the specified branch{@sb, @bindex} -+ * at the position of @h_ino. -+ * if @ino does not exist and @do_new is true, get new one. -+ */ -+int au_xino_read(struct super_block *sb, aufs_bindex_t bindex, ino_t h_ino, -+ ino_t *ino) -+{ -+ int err; -+ ssize_t sz; -+ loff_t pos; -+ struct file *file; -+ struct au_sbinfo *sbinfo; -+ -+ *ino = 0; -+ if (!au_opt_test(au_mntflags(sb), XINO)) -+ return 0; /* no xino */ -+ -+ err = 0; -+ sbinfo = au_sbi(sb); -+ pos = h_ino; -+ if (unlikely(au_loff_max / sizeof(*ino) - 1 < pos)) { -+ AuIOErr1("too large hi%lu\n", (unsigned long)h_ino); -+ return -EFBIG; -+ } -+ pos *= sizeof(*ino); -+ -+ file = au_sbr(sb, bindex)->br_xino.xi_file; -+ if (vfsub_f_size_read(file) < pos + sizeof(*ino)) -+ return 0; /* no ino */ -+ -+ sz = xino_fread(sbinfo->si_xread, file, ino, sizeof(*ino), &pos); -+ if (sz == sizeof(*ino)) -+ return 0; /* success */ -+ -+ err = sz; -+ if (unlikely(sz >= 0)) { -+ err = -EIO; -+ AuIOErr("xino read error (%zd)\n", sz); -+ } -+ -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* create and set a new xino file */ -+ -+struct file *au_xino_create(struct super_block *sb, char *fname, int silent) -+{ -+ struct file *file; -+ struct dentry *h_parent, *d; -+ struct inode *h_dir, *inode; -+ int err; -+ -+ /* -+ * at mount-time, and the xino file is the default path, -+ * hnotify is disabled so we have no notify events to ignore. -+ * when a user specified the xino, we cannot get au_hdir to be ignored. -+ */ -+ file = vfsub_filp_open(fname, O_RDWR | O_CREAT | O_EXCL | O_LARGEFILE -+ /* | __FMODE_NONOTIFY */, -+ S_IRUGO | S_IWUGO); -+ if (IS_ERR(file)) { -+ if (!silent) -+ pr_err("open %s(%ld)\n", fname, PTR_ERR(file)); -+ return file; -+ } -+ -+ /* keep file count */ -+ err = 0; -+ inode = file_inode(file); -+ h_parent = dget_parent(file->f_path.dentry); -+ h_dir = d_inode(h_parent); -+ inode_lock_nested(h_dir, AuLsc_I_PARENT); -+ /* mnt_want_write() is unnecessary here */ -+ /* no delegation since it is just created */ -+ if (inode->i_nlink) -+ err = vfsub_unlink(h_dir, &file->f_path, /*delegated*/NULL, -+ /*force*/0); -+ inode_unlock(h_dir); -+ dput(h_parent); -+ if (unlikely(err)) { -+ if (!silent) -+ pr_err("unlink %s(%d)\n", fname, err); -+ goto out; -+ } -+ -+ err = -EINVAL; -+ d = file->f_path.dentry; -+ if (unlikely(sb == d->d_sb)) { -+ if (!silent) -+ pr_err("%s must be outside\n", fname); -+ goto out; -+ } -+ if (unlikely(au_test_fs_bad_xino(d->d_sb))) { -+ if (!silent) -+ pr_err("xino doesn't support %s(%s)\n", -+ fname, au_sbtype(d->d_sb)); -+ goto out; -+ } -+ return file; /* success */ -+ -+out: -+ fput(file); -+ file = ERR_PTR(err); -+ return file; -+} -+ -+/* -+ * find another branch who is on the same filesystem of the specified -+ * branch{@btgt}. search until @bbot. -+ */ -+static int is_sb_shared(struct super_block *sb, aufs_bindex_t btgt, -+ aufs_bindex_t bbot) -+{ -+ aufs_bindex_t bindex; -+ struct super_block *tgt_sb = au_sbr_sb(sb, btgt); -+ -+ for (bindex = 0; bindex < btgt; bindex++) -+ if (unlikely(tgt_sb == au_sbr_sb(sb, bindex))) -+ return bindex; -+ for (bindex++; bindex <= bbot; bindex++) -+ if (unlikely(tgt_sb == au_sbr_sb(sb, bindex))) -+ return bindex; -+ return -1; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * initialize the xinofile for the specified branch @br -+ * at the place/path where @base_file indicates. -+ * test whether another branch is on the same filesystem or not, -+ * if @do_test is true. -+ */ -+int au_xino_br(struct super_block *sb, struct au_branch *br, ino_t h_ino, -+ struct file *base_file, int do_test) -+{ -+ int err; -+ ino_t ino; -+ aufs_bindex_t bbot, bindex; -+ struct au_branch *shared_br, *b; -+ struct file *file; -+ struct super_block *tgt_sb; -+ -+ shared_br = NULL; -+ bbot = au_sbbot(sb); -+ if (do_test) { -+ tgt_sb = au_br_sb(br); -+ for (bindex = 0; bindex <= bbot; bindex++) { -+ b = au_sbr(sb, bindex); -+ if (tgt_sb == au_br_sb(b)) { -+ shared_br = b; -+ break; -+ } -+ } -+ } -+ -+ if (!shared_br || !shared_br->br_xino.xi_file) { -+ struct au_xino_lock_dir ldir; -+ -+ au_xino_lock_dir(sb, base_file, &ldir); -+ /* mnt_want_write() is unnecessary here */ -+ file = au_xino_create2(base_file, NULL); -+ au_xino_unlock_dir(&ldir); -+ err = PTR_ERR(file); -+ if (IS_ERR(file)) -+ goto out; -+ br->br_xino.xi_file = file; -+ } else { -+ br->br_xino.xi_file = shared_br->br_xino.xi_file; -+ get_file(br->br_xino.xi_file); -+ } -+ -+ ino = AUFS_ROOT_INO; -+ err = au_xino_do_write(au_sbi(sb)->si_xwrite, br->br_xino.xi_file, -+ h_ino, ino); -+ if (unlikely(err)) { -+ fput(br->br_xino.xi_file); -+ br->br_xino.xi_file = NULL; -+ } -+ -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* trucate a xino bitmap file */ -+ -+/* todo: slow */ -+static int do_xib_restore(struct super_block *sb, struct file *file, void *page) -+{ -+ int err, bit; -+ ssize_t sz; -+ unsigned long pindex; -+ loff_t pos, pend; -+ struct au_sbinfo *sbinfo; -+ vfs_readf_t func; -+ ino_t *ino; -+ unsigned long *p; -+ -+ err = 0; -+ sbinfo = au_sbi(sb); -+ MtxMustLock(&sbinfo->si_xib_mtx); -+ p = sbinfo->si_xib_buf; -+ func = sbinfo->si_xread; -+ pend = vfsub_f_size_read(file); -+ pos = 0; -+ while (pos < pend) { -+ sz = xino_fread(func, file, page, PAGE_SIZE, &pos); -+ err = sz; -+ if (unlikely(sz <= 0)) -+ goto out; -+ -+ err = 0; -+ for (ino = page; sz > 0; ino++, sz -= sizeof(ino)) { -+ if (unlikely(*ino < AUFS_FIRST_INO)) -+ continue; -+ -+ xib_calc_bit(*ino, &pindex, &bit); -+ AuDebugOn(page_bits <= bit); -+ err = xib_pindex(sb, pindex); -+ if (!err) -+ set_bit(bit, p); -+ else -+ goto out; -+ } -+ } -+ -+out: -+ return err; -+} -+ -+static int xib_restore(struct super_block *sb) -+{ -+ int err; -+ aufs_bindex_t bindex, bbot; -+ void *page; -+ -+ err = -ENOMEM; -+ page = (void *)__get_free_page(GFP_NOFS); -+ if (unlikely(!page)) -+ goto out; -+ -+ err = 0; -+ bbot = au_sbbot(sb); -+ for (bindex = 0; !err && bindex <= bbot; bindex++) -+ if (!bindex || is_sb_shared(sb, bindex, bindex - 1) < 0) -+ err = do_xib_restore -+ (sb, au_sbr(sb, bindex)->br_xino.xi_file, page); -+ else -+ AuDbg("b%d\n", bindex); -+ free_page((unsigned long)page); -+ -+out: -+ return err; -+} -+ -+int au_xib_trunc(struct super_block *sb) -+{ -+ int err; -+ ssize_t sz; -+ loff_t pos; -+ struct au_xino_lock_dir ldir; -+ struct au_sbinfo *sbinfo; -+ unsigned long *p; -+ struct file *file; -+ -+ SiMustWriteLock(sb); -+ -+ err = 0; -+ sbinfo = au_sbi(sb); -+ if (!au_opt_test(sbinfo->si_mntflags, XINO)) -+ goto out; -+ -+ file = sbinfo->si_xib; -+ if (vfsub_f_size_read(file) <= PAGE_SIZE) -+ goto out; -+ -+ au_xino_lock_dir(sb, file, &ldir); -+ /* mnt_want_write() is unnecessary here */ -+ file = au_xino_create2(sbinfo->si_xib, NULL); -+ au_xino_unlock_dir(&ldir); -+ err = PTR_ERR(file); -+ if (IS_ERR(file)) -+ goto out; -+ fput(sbinfo->si_xib); -+ sbinfo->si_xib = file; -+ -+ p = sbinfo->si_xib_buf; -+ memset(p, 0, PAGE_SIZE); -+ pos = 0; -+ sz = xino_fwrite(sbinfo->si_xwrite, sbinfo->si_xib, p, PAGE_SIZE, &pos); -+ if (unlikely(sz != PAGE_SIZE)) { -+ err = sz; -+ AuIOErr("err %d\n", err); -+ if (sz >= 0) -+ err = -EIO; -+ goto out; -+ } -+ -+ mutex_lock(&sbinfo->si_xib_mtx); -+ /* mnt_want_write() is unnecessary here */ -+ err = xib_restore(sb); -+ mutex_unlock(&sbinfo->si_xib_mtx); -+ -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * xino mount option handlers -+ */ -+ -+/* xino bitmap */ -+static void xino_clear_xib(struct super_block *sb) -+{ -+ struct au_sbinfo *sbinfo; -+ -+ SiMustWriteLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ sbinfo->si_xread = NULL; -+ sbinfo->si_xwrite = NULL; -+ if (sbinfo->si_xib) -+ fput(sbinfo->si_xib); -+ sbinfo->si_xib = NULL; -+ if (sbinfo->si_xib_buf) -+ free_page((unsigned long)sbinfo->si_xib_buf); -+ sbinfo->si_xib_buf = NULL; -+} -+ -+static int au_xino_set_xib(struct super_block *sb, struct file *base) -+{ -+ int err; -+ loff_t pos; -+ struct au_sbinfo *sbinfo; -+ struct file *file; -+ -+ SiMustWriteLock(sb); -+ -+ sbinfo = au_sbi(sb); -+ file = au_xino_create2(base, sbinfo->si_xib); -+ err = PTR_ERR(file); -+ if (IS_ERR(file)) -+ goto out; -+ if (sbinfo->si_xib) -+ fput(sbinfo->si_xib); -+ sbinfo->si_xib = file; -+ sbinfo->si_xread = vfs_readf(file); -+ sbinfo->si_xwrite = vfs_writef(file); -+ -+ err = -ENOMEM; -+ if (!sbinfo->si_xib_buf) -+ sbinfo->si_xib_buf = (void *)get_zeroed_page(GFP_NOFS); -+ if (unlikely(!sbinfo->si_xib_buf)) -+ goto out_unset; -+ -+ sbinfo->si_xib_last_pindex = 0; -+ sbinfo->si_xib_next_bit = 0; -+ if (vfsub_f_size_read(file) < PAGE_SIZE) { -+ pos = 0; -+ err = xino_fwrite(sbinfo->si_xwrite, file, sbinfo->si_xib_buf, -+ PAGE_SIZE, &pos); -+ if (unlikely(err != PAGE_SIZE)) -+ goto out_free; -+ } -+ err = 0; -+ goto out; /* success */ -+ -+out_free: -+ if (sbinfo->si_xib_buf) -+ free_page((unsigned long)sbinfo->si_xib_buf); -+ sbinfo->si_xib_buf = NULL; -+ if (err >= 0) -+ err = -EIO; -+out_unset: -+ fput(sbinfo->si_xib); -+ sbinfo->si_xib = NULL; -+ sbinfo->si_xread = NULL; -+ sbinfo->si_xwrite = NULL; -+out: -+ return err; -+} -+ -+/* xino for each branch */ -+static void xino_clear_br(struct super_block *sb) -+{ -+ aufs_bindex_t bindex, bbot; -+ struct au_branch *br; -+ -+ bbot = au_sbbot(sb); -+ for (bindex = 0; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ if (!br || !br->br_xino.xi_file) -+ continue; -+ -+ fput(br->br_xino.xi_file); -+ br->br_xino.xi_file = NULL; -+ } -+} -+ -+static int au_xino_set_br(struct super_block *sb, struct file *base) -+{ -+ int err; -+ ino_t ino; -+ aufs_bindex_t bindex, bbot, bshared; -+ struct { -+ struct file *old, *new; -+ } *fpair, *p; -+ struct au_branch *br; -+ struct inode *inode; -+ vfs_writef_t writef; -+ -+ SiMustWriteLock(sb); -+ -+ err = -ENOMEM; -+ bbot = au_sbbot(sb); -+ fpair = kcalloc(bbot + 1, sizeof(*fpair), GFP_NOFS); -+ if (unlikely(!fpair)) -+ goto out; -+ -+ inode = d_inode(sb->s_root); -+ ino = AUFS_ROOT_INO; -+ writef = au_sbi(sb)->si_xwrite; -+ for (bindex = 0, p = fpair; bindex <= bbot; bindex++, p++) { -+ bshared = is_sb_shared(sb, bindex, bindex - 1); -+ if (bshared >= 0) { -+ /* shared xino */ -+ *p = fpair[bshared]; -+ get_file(p->new); -+ } -+ -+ if (!p->new) { -+ /* new xino */ -+ br = au_sbr(sb, bindex); -+ p->old = br->br_xino.xi_file; -+ p->new = au_xino_create2(base, br->br_xino.xi_file); -+ err = PTR_ERR(p->new); -+ if (IS_ERR(p->new)) { -+ p->new = NULL; -+ goto out_pair; -+ } -+ } -+ -+ err = au_xino_do_write(writef, p->new, -+ au_h_iptr(inode, bindex)->i_ino, ino); -+ if (unlikely(err)) -+ goto out_pair; -+ } -+ -+ for (bindex = 0, p = fpair; bindex <= bbot; bindex++, p++) { -+ br = au_sbr(sb, bindex); -+ if (br->br_xino.xi_file) -+ fput(br->br_xino.xi_file); -+ get_file(p->new); -+ br->br_xino.xi_file = p->new; -+ } -+ -+out_pair: -+ for (bindex = 0, p = fpair; bindex <= bbot; bindex++, p++) -+ if (p->new) -+ fput(p->new); -+ else -+ break; -+ kfree(fpair); -+out: -+ return err; -+} -+ -+void au_xino_clr(struct super_block *sb) -+{ -+ struct au_sbinfo *sbinfo; -+ -+ au_xigen_clr(sb); -+ xino_clear_xib(sb); -+ xino_clear_br(sb); -+ sbinfo = au_sbi(sb); -+ /* lvalue, do not call au_mntflags() */ -+ au_opt_clr(sbinfo->si_mntflags, XINO); -+} -+ -+int au_xino_set(struct super_block *sb, struct au_opt_xino *xino, int remount) -+{ -+ int err, skip; -+ struct dentry *parent, *cur_parent; -+ struct qstr *dname, *cur_name; -+ struct file *cur_xino; -+ struct inode *dir; -+ struct au_sbinfo *sbinfo; -+ -+ SiMustWriteLock(sb); -+ -+ err = 0; -+ sbinfo = au_sbi(sb); -+ parent = dget_parent(xino->file->f_path.dentry); -+ if (remount) { -+ skip = 0; -+ dname = &xino->file->f_path.dentry->d_name; -+ cur_xino = sbinfo->si_xib; -+ if (cur_xino) { -+ cur_parent = dget_parent(cur_xino->f_path.dentry); -+ cur_name = &cur_xino->f_path.dentry->d_name; -+ skip = (cur_parent == parent -+ && au_qstreq(dname, cur_name)); -+ dput(cur_parent); -+ } -+ if (skip) -+ goto out; -+ } -+ -+ au_opt_set(sbinfo->si_mntflags, XINO); -+ dir = d_inode(parent); -+ inode_lock_nested(dir, AuLsc_I_PARENT); -+ /* mnt_want_write() is unnecessary here */ -+ err = au_xino_set_xib(sb, xino->file); -+ if (!err) -+ err = au_xigen_set(sb, xino->file); -+ if (!err) -+ err = au_xino_set_br(sb, xino->file); -+ inode_unlock(dir); -+ if (!err) -+ goto out; /* success */ -+ -+ /* reset all */ -+ AuIOErr("failed creating xino(%d).\n", err); -+ au_xigen_clr(sb); -+ xino_clear_xib(sb); -+ -+out: -+ dput(parent); -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* -+ * create a xinofile at the default place/path. -+ */ -+struct file *au_xino_def(struct super_block *sb) -+{ -+ struct file *file; -+ char *page, *p; -+ struct au_branch *br; -+ struct super_block *h_sb; -+ struct path path; -+ aufs_bindex_t bbot, bindex, bwr; -+ -+ br = NULL; -+ bbot = au_sbbot(sb); -+ bwr = -1; -+ for (bindex = 0; bindex <= bbot; bindex++) { -+ br = au_sbr(sb, bindex); -+ if (au_br_writable(br->br_perm) -+ && !au_test_fs_bad_xino(au_br_sb(br))) { -+ bwr = bindex; -+ break; -+ } -+ } -+ -+ if (bwr >= 0) { -+ file = ERR_PTR(-ENOMEM); -+ page = (void *)__get_free_page(GFP_NOFS); -+ if (unlikely(!page)) -+ goto out; -+ path.mnt = au_br_mnt(br); -+ path.dentry = au_h_dptr(sb->s_root, bwr); -+ p = d_path(&path, page, PATH_MAX - sizeof(AUFS_XINO_FNAME)); -+ file = (void *)p; -+ if (!IS_ERR(p)) { -+ strcat(p, "/" AUFS_XINO_FNAME); -+ AuDbg("%s\n", p); -+ file = au_xino_create(sb, p, /*silent*/0); -+ if (!IS_ERR(file)) -+ au_xino_brid_set(sb, br->br_id); -+ } -+ free_page((unsigned long)page); -+ } else { -+ file = au_xino_create(sb, AUFS_XINO_DEFPATH, /*silent*/0); -+ if (IS_ERR(file)) -+ goto out; -+ h_sb = file->f_path.dentry->d_sb; -+ if (unlikely(au_test_fs_bad_xino(h_sb))) { -+ pr_err("xino doesn't support %s(%s)\n", -+ AUFS_XINO_DEFPATH, au_sbtype(h_sb)); -+ fput(file); -+ file = ERR_PTR(-EINVAL); -+ } -+ if (!IS_ERR(file)) -+ au_xino_brid_set(sb, -1); -+ } -+ -+out: -+ return file; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+int au_xino_path(struct seq_file *seq, struct file *file) -+{ -+ int err; -+ -+ err = au_seq_path(seq, &file->f_path); -+ if (unlikely(err)) -+ goto out; -+ -+#define Deleted "\\040(deleted)" -+ seq->count -= sizeof(Deleted) - 1; -+ AuDebugOn(memcmp(seq->buf + seq->count, Deleted, -+ sizeof(Deleted) - 1)); -+#undef Deleted -+ -+out: -+ return err; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+void au_xinondir_leave(struct super_block *sb, aufs_bindex_t bindex, -+ ino_t h_ino, int idx) -+{ -+ struct au_xino_file *xino; -+ -+ AuDebugOn(!au_opt_test(au_mntflags(sb), XINO)); -+ xino = &au_sbr(sb, bindex)->br_xino; -+ AuDebugOn(idx < 0 || xino->xi_nondir.total <= idx); -+ -+ spin_lock(&xino->xi_nondir.spin); -+ AuDebugOn(xino->xi_nondir.array[idx] != h_ino); -+ xino->xi_nondir.array[idx] = 0; -+ spin_unlock(&xino->xi_nondir.spin); -+ wake_up_all(&xino->xi_nondir.wqh); -+} -+ -+static int au_xinondir_find(struct au_xino_file *xino, ino_t h_ino) -+{ -+ int found, total, i; -+ -+ found = -1; -+ total = xino->xi_nondir.total; -+ for (i = 0; i < total; i++) { -+ if (xino->xi_nondir.array[i] != h_ino) -+ continue; -+ found = i; -+ break; -+ } -+ -+ return found; -+} -+ -+static int au_xinondir_expand(struct au_xino_file *xino) -+{ -+ int err, sz; -+ ino_t *p; -+ -+ BUILD_BUG_ON(KMALLOC_MAX_SIZE > INT_MAX); -+ -+ err = -ENOMEM; -+ sz = xino->xi_nondir.total * sizeof(ino_t); -+ if (unlikely(sz > KMALLOC_MAX_SIZE / 2)) -+ goto out; -+ p = au_kzrealloc(xino->xi_nondir.array, sz, sz << 1, GFP_ATOMIC, -+ /*may_shrink*/0); -+ if (p) { -+ xino->xi_nondir.array = p; -+ xino->xi_nondir.total <<= 1; -+ AuDbg("xi_nondir.total %d\n", xino->xi_nondir.total); -+ err = 0; -+ } -+ -+out: -+ return err; -+} -+ -+int au_xinondir_enter(struct super_block *sb, aufs_bindex_t bindex, ino_t h_ino, -+ int *idx) -+{ -+ int err, found, empty; -+ struct au_xino_file *xino; -+ -+ err = 0; -+ *idx = -1; -+ if (!au_opt_test(au_mntflags(sb), XINO)) -+ goto out; /* no xino */ -+ -+ xino = &au_sbr(sb, bindex)->br_xino; -+ -+again: -+ spin_lock(&xino->xi_nondir.spin); -+ found = au_xinondir_find(xino, h_ino); -+ if (found == -1) { -+ empty = au_xinondir_find(xino, /*h_ino*/0); -+ if (empty == -1) { -+ empty = xino->xi_nondir.total; -+ err = au_xinondir_expand(xino); -+ if (unlikely(err)) -+ goto out_unlock; -+ } -+ xino->xi_nondir.array[empty] = h_ino; -+ *idx = empty; -+ } else { -+ spin_unlock(&xino->xi_nondir.spin); -+ wait_event(xino->xi_nondir.wqh, -+ xino->xi_nondir.array[found] != h_ino); -+ goto again; -+ } -+ -+out_unlock: -+ spin_unlock(&xino->xi_nondir.spin); -+out: -+ return err; -+} -diff --git a/fs/dcache.c b/fs/dcache.c -index f90141387f01..e3719a5e45d9 100644 ---- a/fs/dcache.c -+++ b/fs/dcache.c -@@ -1197,7 +1197,7 @@ enum d_walk_ret { - * - * The @enter() and @finish() callbacks are called with d_lock held. - */ --static void d_walk(struct dentry *parent, void *data, -+void d_walk(struct dentry *parent, void *data, - enum d_walk_ret (*enter)(void *, struct dentry *), - void (*finish)(void *)) - { -diff --git a/fs/fcntl.c b/fs/fcntl.c -index 8d78ffd7b399..cffefab04504 100644 ---- a/fs/fcntl.c -+++ b/fs/fcntl.c -@@ -32,7 +32,7 @@ - - #define SETFL_MASK (O_APPEND | O_NONBLOCK | O_NDELAY | O_DIRECT | O_NOATIME) - --static int setfl(int fd, struct file * filp, unsigned long arg) -+int setfl(int fd, struct file * filp, unsigned long arg) - { - struct inode * inode = file_inode(filp); - int error = 0; -@@ -63,6 +63,8 @@ static int setfl(int fd, struct file * filp, unsigned long arg) - - if (filp->f_op->check_flags) - error = filp->f_op->check_flags(arg); -+ if (!error && filp->f_op->setfl) -+ error = filp->f_op->setfl(filp, arg); - if (error) - return error; - -diff --git a/fs/inode.c b/fs/inode.c -index d1e35b53bb23..f7800d6fd1a0 100644 ---- a/fs/inode.c -+++ b/fs/inode.c -@@ -1655,7 +1655,7 @@ EXPORT_SYMBOL(generic_update_time); - * This does the actual work of updating an inodes time or version. Must have - * had called mnt_want_write() before calling this. - */ --static int update_time(struct inode *inode, struct timespec *time, int flags) -+int update_time(struct inode *inode, struct timespec *time, int flags) - { - int (*update_time)(struct inode *, struct timespec *, int); - -diff --git a/fs/namespace.c b/fs/namespace.c -index d18deb4c410b..e5a4a7f8a249 100644 ---- a/fs/namespace.c -+++ b/fs/namespace.c -@@ -846,6 +846,12 @@ static inline int check_mnt(struct mount *mnt) - return mnt->mnt_ns == current->nsproxy->mnt_ns; - } - -+/* for aufs, CONFIG_AUFS_BR_FUSE */ -+int is_current_mnt_ns(struct vfsmount *mnt) -+{ -+ return check_mnt(real_mount(mnt)); -+} -+ - /* - * vfsmount lock must be held for write - */ -diff --git a/fs/proc/base.c b/fs/proc/base.c -index 9d357b2ea6cb..11f4f23b803e 100644 ---- a/fs/proc/base.c -+++ b/fs/proc/base.c -@@ -1988,7 +1988,7 @@ static int map_files_get_link(struct dentry *dentry, struct path *path) - down_read(&mm->mmap_sem); - vma = find_exact_vma(mm, vm_start, vm_end); - if (vma && vma->vm_file) { -- *path = vma->vm_file->f_path; -+ *path = vma_pr_or_file(vma)->f_path; - path_get(path); - rc = 0; - } -diff --git a/fs/proc/nommu.c b/fs/proc/nommu.c -index 75634379f82e..7c0dc0ff4882 100644 ---- a/fs/proc/nommu.c -+++ b/fs/proc/nommu.c -@@ -45,7 +45,10 @@ static int nommu_region_show(struct seq_file *m, struct vm_region *region) - file = region->vm_file; - - if (file) { -- struct inode *inode = file_inode(region->vm_file); -+ struct inode *inode; -+ -+ file = vmr_pr_or_file(region); -+ inode = file_inode(file); - dev = inode->i_sb->s_dev; - ino = inode->i_ino; - } -diff --git a/fs/proc/task_mmu.c b/fs/proc/task_mmu.c -index 6744bd706ecf..6d4dea31b008 100644 ---- a/fs/proc/task_mmu.c -+++ b/fs/proc/task_mmu.c -@@ -310,7 +310,10 @@ show_map_vma(struct seq_file *m, struct vm_area_struct *vma, int is_pid) - const char *name = NULL; - - if (file) { -- struct inode *inode = file_inode(vma->vm_file); -+ struct inode *inode; -+ -+ file = vma_pr_or_file(vma); -+ inode = file_inode(file); - dev = inode->i_sb->s_dev; - ino = inode->i_ino; - pgoff = ((loff_t)vma->vm_pgoff) << PAGE_SHIFT; -@@ -1739,7 +1742,7 @@ static int show_numa_map(struct seq_file *m, void *v, int is_pid) - struct proc_maps_private *proc_priv = &numa_priv->proc_maps; - struct vm_area_struct *vma = v; - struct numa_maps *md = &numa_priv->md; -- struct file *file = vma->vm_file; -+ struct file *file = vma_pr_or_file(vma); - struct mm_struct *mm = vma->vm_mm; - struct mm_walk walk = { - .hugetlb_entry = gather_hugetlb_stats, -diff --git a/fs/proc/task_nommu.c b/fs/proc/task_nommu.c -index 5b62f57bd9bc..dfb4a3bd0fac 100644 ---- a/fs/proc/task_nommu.c -+++ b/fs/proc/task_nommu.c -@@ -156,7 +156,10 @@ static int nommu_vma_show(struct seq_file *m, struct vm_area_struct *vma, - file = vma->vm_file; - - if (file) { -- struct inode *inode = file_inode(vma->vm_file); -+ struct inode *inode; -+ -+ file = vma_pr_or_file(vma); -+ inode = file_inode(file); - dev = inode->i_sb->s_dev; - ino = inode->i_ino; - pgoff = (loff_t)vma->vm_pgoff << PAGE_SHIFT; -diff --git a/fs/read_write.c b/fs/read_write.c -index 0046d72efe94..2388284447cf 100644 ---- a/fs/read_write.c -+++ b/fs/read_write.c -@@ -484,6 +484,28 @@ ssize_t __vfs_write(struct file *file, const char __user *p, size_t count, - return -EINVAL; - } - -+vfs_readf_t vfs_readf(struct file *file) -+{ -+ const struct file_operations *fop = file->f_op; -+ -+ if (fop->read) -+ return fop->read; -+ if (fop->read_iter) -+ return new_sync_read; -+ return ERR_PTR(-ENOSYS); -+} -+ -+vfs_writef_t vfs_writef(struct file *file) -+{ -+ const struct file_operations *fop = file->f_op; -+ -+ if (fop->write) -+ return fop->write; -+ if (fop->write_iter) -+ return new_sync_write; -+ return ERR_PTR(-ENOSYS); -+} -+ - ssize_t __kernel_write(struct file *file, const void *buf, size_t count, loff_t *pos) - { - mm_segment_t old_fs; -diff --git a/fs/splice.c b/fs/splice.c -index f3084cce0ea6..eb888c670aec 100644 ---- a/fs/splice.c -+++ b/fs/splice.c -@@ -837,8 +837,8 @@ EXPORT_SYMBOL(generic_splice_sendpage); - /* - * Attempt to initiate a splice from pipe to file. - */ --static long do_splice_from(struct pipe_inode_info *pipe, struct file *out, -- loff_t *ppos, size_t len, unsigned int flags) -+long do_splice_from(struct pipe_inode_info *pipe, struct file *out, -+ loff_t *ppos, size_t len, unsigned int flags) - { - ssize_t (*splice_write)(struct pipe_inode_info *, struct file *, - loff_t *, size_t, unsigned int); -@@ -854,9 +854,9 @@ static long do_splice_from(struct pipe_inode_info *pipe, struct file *out, - /* - * Attempt to initiate a splice from a file to a pipe. - */ --static long do_splice_to(struct file *in, loff_t *ppos, -- struct pipe_inode_info *pipe, size_t len, -- unsigned int flags) -+long do_splice_to(struct file *in, loff_t *ppos, -+ struct pipe_inode_info *pipe, size_t len, -+ unsigned int flags) - { - ssize_t (*splice_read)(struct file *, loff_t *, - struct pipe_inode_info *, size_t, unsigned int); -diff --git a/fs/sync.c b/fs/sync.c -index 83ac79a960dd..fe15900ed873 100644 ---- a/fs/sync.c -+++ b/fs/sync.c -@@ -28,7 +28,7 @@ - * wait == 1 case since in that case write_inode() functions do - * sync_dirty_buffer() and thus effectively write one block at a time. - */ --static int __sync_filesystem(struct super_block *sb, int wait) -+int __sync_filesystem(struct super_block *sb, int wait) - { - if (wait) - sync_inodes_sb(sb); -diff --git a/include/linux/file.h b/include/linux/file.h -index 279720db984a..76e38eade225 100644 ---- a/include/linux/file.h -+++ b/include/linux/file.h -@@ -20,6 +20,7 @@ struct dentry; - struct path; - extern struct file *alloc_file(const struct path *, fmode_t mode, - const struct file_operations *fop); -+extern struct file *get_empty_filp(void); - - static inline void fput_light(struct file *file, int fput_needed) - { -diff --git a/include/linux/fs.h b/include/linux/fs.h -index 885266aae2d7..e489e42d1a6d 100644 ---- a/include/linux/fs.h -+++ b/include/linux/fs.h -@@ -1265,6 +1265,7 @@ extern void fasync_free(struct fasync_struct *); - /* can be called from interrupts */ - extern void kill_fasync(struct fasync_struct **, int, int); - -+extern int setfl(int fd, struct file * filp, unsigned long arg); - extern void __f_setown(struct file *filp, struct pid *, enum pid_type, int force); - extern int f_setown(struct file *filp, unsigned long arg, int force); - extern void f_delown(struct file *filp); -@@ -1711,6 +1712,7 @@ struct file_operations { - ssize_t (*sendpage) (struct file *, struct page *, int, size_t, loff_t *, int); - unsigned long (*get_unmapped_area)(struct file *, unsigned long, unsigned long, unsigned long, unsigned long); - int (*check_flags)(int); -+ int (*setfl)(struct file *, unsigned long); - int (*flock) (struct file *, int, struct file_lock *); - ssize_t (*splice_write)(struct pipe_inode_info *, struct file *, loff_t *, size_t, unsigned int); - ssize_t (*splice_read)(struct file *, loff_t *, struct pipe_inode_info *, size_t, unsigned int); -@@ -1781,6 +1783,12 @@ ssize_t rw_copy_check_uvector(int type, const struct iovec __user * uvector, - struct iovec *fast_pointer, - struct iovec **ret_pointer); - -+typedef ssize_t (*vfs_readf_t)(struct file *, char __user *, size_t, loff_t *); -+typedef ssize_t (*vfs_writef_t)(struct file *, const char __user *, size_t, -+ loff_t *); -+vfs_readf_t vfs_readf(struct file *file); -+vfs_writef_t vfs_writef(struct file *file); -+ - extern ssize_t __vfs_read(struct file *, char __user *, size_t, loff_t *); - extern ssize_t vfs_read(struct file *, char __user *, size_t, loff_t *); - extern ssize_t vfs_write(struct file *, const char __user *, size_t, loff_t *); -@@ -2183,6 +2191,7 @@ extern int current_umask(void); - extern void ihold(struct inode * inode); - extern void iput(struct inode *); - extern int generic_update_time(struct inode *, struct timespec *, int); -+extern int update_time(struct inode *, struct timespec *, int); - - /* /sys/fs */ - extern struct kobject *fs_kobj; -@@ -2463,6 +2472,7 @@ static inline bool sb_is_blkdev_sb(struct super_block *sb) - return false; - } - #endif -+extern int __sync_filesystem(struct super_block *, int); - extern int sync_filesystem(struct super_block *); - extern const struct file_operations def_blk_fops; - extern const struct file_operations def_chr_fops; -diff --git a/include/linux/lockdep.h b/include/linux/lockdep.h -index f301d31b473c..c26f5b420464 100644 ---- a/include/linux/lockdep.h -+++ b/include/linux/lockdep.h -@@ -406,6 +406,8 @@ static inline int lockdep_match_key(struct lockdep_map *lock, - return lock->key == key; - } - -+struct lock_class *lockdep_hlock_class(struct held_lock *hlock); -+ - /* - * Acquire a lock. - * -@@ -530,6 +532,7 @@ struct lock_class_key { }; - - #define lockdep_depth(tsk) (0) - -+#define lockdep_is_held(lock) (1) - #define lockdep_is_held_type(l, r) (1) - - #define lockdep_assert_held(l) do { (void)(l); } while (0) -diff --git a/include/linux/mm.h b/include/linux/mm.h -index 43edf659453b..3f9acd93ae28 100644 ---- a/include/linux/mm.h -+++ b/include/linux/mm.h -@@ -1349,6 +1349,28 @@ static inline int fixup_user_fault(struct task_struct *tsk, - } - #endif - -+extern void vma_do_file_update_time(struct vm_area_struct *, const char[], int); -+extern struct file *vma_do_pr_or_file(struct vm_area_struct *, const char[], -+ int); -+extern void vma_do_get_file(struct vm_area_struct *, const char[], int); -+extern void vma_do_fput(struct vm_area_struct *, const char[], int); -+ -+#define vma_file_update_time(vma) vma_do_file_update_time(vma, __func__, \ -+ __LINE__) -+#define vma_pr_or_file(vma) vma_do_pr_or_file(vma, __func__, \ -+ __LINE__) -+#define vma_get_file(vma) vma_do_get_file(vma, __func__, __LINE__) -+#define vma_fput(vma) vma_do_fput(vma, __func__, __LINE__) -+ -+#ifndef CONFIG_MMU -+extern struct file *vmr_do_pr_or_file(struct vm_region *, const char[], int); -+extern void vmr_do_fput(struct vm_region *, const char[], int); -+ -+#define vmr_pr_or_file(region) vmr_do_pr_or_file(region, __func__, \ -+ __LINE__) -+#define vmr_fput(region) vmr_do_fput(region, __func__, __LINE__) -+#endif /* !CONFIG_MMU */ -+ - extern int access_process_vm(struct task_struct *tsk, unsigned long addr, void *buf, int len, - unsigned int gup_flags); - extern int access_remote_vm(struct mm_struct *mm, unsigned long addr, -diff --git a/include/linux/mm_types.h b/include/linux/mm_types.h -index c85f11dafd56..a63875a76849 100644 ---- a/include/linux/mm_types.h -+++ b/include/linux/mm_types.h -@@ -261,6 +261,7 @@ struct vm_region { - unsigned long vm_top; /* region allocated to here */ - unsigned long vm_pgoff; /* the offset in vm_file corresponding to vm_start */ - struct file *vm_file; /* the backing file or NULL */ -+ struct file *vm_prfile; /* the virtual backing file or NULL */ - - int vm_usage; /* region usage count (access under nommu_region_sem) */ - bool vm_icache_flushed : 1; /* true if the icache has been flushed for -@@ -335,6 +336,7 @@ struct vm_area_struct { - unsigned long vm_pgoff; /* Offset (within vm_file) in PAGE_SIZE - units */ - struct file * vm_file; /* File we map to (can be NULL). */ -+ struct file *vm_prfile; /* shadow of vm_file */ - void * vm_private_data; /* was vm_pte (shared mem) */ - - atomic_long_t swap_readahead_info; -diff --git a/include/linux/mnt_namespace.h b/include/linux/mnt_namespace.h -index 35942084cd40..24f5fd1a789d 100644 ---- a/include/linux/mnt_namespace.h -+++ b/include/linux/mnt_namespace.h -@@ -6,11 +6,14 @@ - struct mnt_namespace; - struct fs_struct; - struct user_namespace; -+struct vfsmount; - - extern struct mnt_namespace *copy_mnt_ns(unsigned long, struct mnt_namespace *, - struct user_namespace *, struct fs_struct *); - extern void put_mnt_ns(struct mnt_namespace *ns); - -+extern int is_current_mnt_ns(struct vfsmount *mnt); -+ - extern const struct file_operations proc_mounts_operations; - extern const struct file_operations proc_mountinfo_operations; - extern const struct file_operations proc_mountstats_operations; -diff --git a/include/linux/splice.h b/include/linux/splice.h -index 74b4911ac16d..19789fbea567 100644 ---- a/include/linux/splice.h -+++ b/include/linux/splice.h -@@ -87,4 +87,10 @@ extern void splice_shrink_spd(struct splice_pipe_desc *); - - extern const struct pipe_buf_operations page_cache_pipe_buf_ops; - extern const struct pipe_buf_operations default_pipe_buf_ops; -+ -+extern long do_splice_from(struct pipe_inode_info *pipe, struct file *out, -+ loff_t *ppos, size_t len, unsigned int flags); -+extern long do_splice_to(struct file *in, loff_t *ppos, -+ struct pipe_inode_info *pipe, size_t len, -+ unsigned int flags); - #endif -diff --git a/include/uapi/linux/aufs_type.h b/include/uapi/linux/aufs_type.h -new file mode 100644 -index 000000000000..95702c1e61e5 ---- /dev/null -+++ b/include/uapi/linux/aufs_type.h -@@ -0,0 +1,435 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Copyright (C) 2005-2017 Junjiro R. Okajima -+ */ -+ -+#ifndef __AUFS_TYPE_H__ -+#define __AUFS_TYPE_H__ -+ -+#define AUFS_NAME "aufs" -+ -+#ifdef __KERNEL__ -+/* -+ * define it before including all other headers. -+ * sched.h may use pr_* macros before defining "current", so define the -+ * no-current version first, and re-define later. -+ */ -+#define pr_fmt(fmt) AUFS_NAME " %s:%d: " fmt, __func__, __LINE__ -+#include -+#undef pr_fmt -+#define pr_fmt(fmt) \ -+ AUFS_NAME " %s:%d:%.*s[%d]: " fmt, __func__, __LINE__, \ -+ (int)sizeof(current->comm), current->comm, current->pid -+#else -+#include -+#include -+#endif /* __KERNEL__ */ -+ -+#include -+ -+#define AUFS_VERSION "4.14" -+ -+/* todo? move this to linux-2.6.19/include/magic.h */ -+#define AUFS_SUPER_MAGIC ('a' << 24 | 'u' << 16 | 'f' << 8 | 's') -+ -+/* ---------------------------------------------------------------------- */ -+ -+#ifdef CONFIG_AUFS_BRANCH_MAX_127 -+typedef int8_t aufs_bindex_t; -+#define AUFS_BRANCH_MAX 127 -+#else -+typedef int16_t aufs_bindex_t; -+#ifdef CONFIG_AUFS_BRANCH_MAX_511 -+#define AUFS_BRANCH_MAX 511 -+#elif defined(CONFIG_AUFS_BRANCH_MAX_1023) -+#define AUFS_BRANCH_MAX 1023 -+#elif defined(CONFIG_AUFS_BRANCH_MAX_32767) -+#define AUFS_BRANCH_MAX 32767 -+#endif -+#endif -+ -+#ifdef __KERNEL__ -+#ifndef AUFS_BRANCH_MAX -+#error unknown CONFIG_AUFS_BRANCH_MAX value -+#endif -+#endif /* __KERNEL__ */ -+ -+/* ---------------------------------------------------------------------- */ -+ -+#define AUFS_FSTYPE AUFS_NAME -+ -+#define AUFS_ROOT_INO 2 -+#define AUFS_FIRST_INO 11 -+ -+#define AUFS_WH_PFX ".wh." -+#define AUFS_WH_PFX_LEN ((int)sizeof(AUFS_WH_PFX) - 1) -+#define AUFS_WH_TMP_LEN 4 -+/* a limit for rmdir/rename a dir and copyup */ -+#define AUFS_MAX_NAMELEN (NAME_MAX \ -+ - AUFS_WH_PFX_LEN * 2 /* doubly whiteouted */\ -+ - 1 /* dot */\ -+ - AUFS_WH_TMP_LEN) /* hex */ -+#define AUFS_XINO_FNAME "." AUFS_NAME ".xino" -+#define AUFS_XINO_DEFPATH "/tmp/" AUFS_XINO_FNAME -+#define AUFS_XINO_DEF_SEC 30 /* seconds */ -+#define AUFS_XINO_DEF_TRUNC 45 /* percentage */ -+#define AUFS_DIRWH_DEF 3 -+#define AUFS_RDCACHE_DEF 10 /* seconds */ -+#define AUFS_RDCACHE_MAX 3600 /* seconds */ -+#define AUFS_RDBLK_DEF 512 /* bytes */ -+#define AUFS_RDHASH_DEF 32 -+#define AUFS_WKQ_NAME AUFS_NAME "d" -+#define AUFS_MFS_DEF_SEC 30 /* seconds */ -+#define AUFS_MFS_MAX_SEC 3600 /* seconds */ -+#define AUFS_FHSM_CACHE_DEF_SEC 30 /* seconds */ -+#define AUFS_PLINK_WARN 50 /* number of plinks in a single bucket */ -+ -+/* pseudo-link maintenace under /proc */ -+#define AUFS_PLINK_MAINT_NAME "plink_maint" -+#define AUFS_PLINK_MAINT_DIR "fs/" AUFS_NAME -+#define AUFS_PLINK_MAINT_PATH AUFS_PLINK_MAINT_DIR "/" AUFS_PLINK_MAINT_NAME -+ -+/* dirren, renamed dir */ -+#define AUFS_DR_INFO_PFX AUFS_WH_PFX ".dr." -+#define AUFS_DR_BRHINO_NAME AUFS_WH_PFX "hino" -+/* whiteouted doubly */ -+#define AUFS_WH_DR_INFO_PFX AUFS_WH_PFX AUFS_DR_INFO_PFX -+#define AUFS_WH_DR_BRHINO AUFS_WH_PFX AUFS_DR_BRHINO_NAME -+ -+#define AUFS_DIROPQ_NAME AUFS_WH_PFX ".opq" /* whiteouted doubly */ -+#define AUFS_WH_DIROPQ AUFS_WH_PFX AUFS_DIROPQ_NAME -+ -+#define AUFS_BASE_NAME AUFS_WH_PFX AUFS_NAME -+#define AUFS_PLINKDIR_NAME AUFS_WH_PFX "plnk" -+#define AUFS_ORPHDIR_NAME AUFS_WH_PFX "orph" -+ -+/* doubly whiteouted */ -+#define AUFS_WH_BASE AUFS_WH_PFX AUFS_BASE_NAME -+#define AUFS_WH_PLINKDIR AUFS_WH_PFX AUFS_PLINKDIR_NAME -+#define AUFS_WH_ORPHDIR AUFS_WH_PFX AUFS_ORPHDIR_NAME -+ -+/* branch permissions and attributes */ -+#define AUFS_BRPERM_RW "rw" -+#define AUFS_BRPERM_RO "ro" -+#define AUFS_BRPERM_RR "rr" -+#define AUFS_BRATTR_COO_REG "coo_reg" -+#define AUFS_BRATTR_COO_ALL "coo_all" -+#define AUFS_BRATTR_FHSM "fhsm" -+#define AUFS_BRATTR_UNPIN "unpin" -+#define AUFS_BRATTR_ICEX "icex" -+#define AUFS_BRATTR_ICEX_SEC "icexsec" -+#define AUFS_BRATTR_ICEX_SYS "icexsys" -+#define AUFS_BRATTR_ICEX_TR "icextr" -+#define AUFS_BRATTR_ICEX_USR "icexusr" -+#define AUFS_BRATTR_ICEX_OTH "icexoth" -+#define AUFS_BRRATTR_WH "wh" -+#define AUFS_BRWATTR_NLWH "nolwh" -+#define AUFS_BRWATTR_MOO "moo" -+ -+#define AuBrPerm_RW 1 /* writable, hardlinkable wh */ -+#define AuBrPerm_RO (1 << 1) /* readonly */ -+#define AuBrPerm_RR (1 << 2) /* natively readonly */ -+#define AuBrPerm_Mask (AuBrPerm_RW | AuBrPerm_RO | AuBrPerm_RR) -+ -+#define AuBrAttr_COO_REG (1 << 3) /* copy-up on open */ -+#define AuBrAttr_COO_ALL (1 << 4) -+#define AuBrAttr_COO_Mask (AuBrAttr_COO_REG | AuBrAttr_COO_ALL) -+ -+#define AuBrAttr_FHSM (1 << 5) /* file-based hsm */ -+#define AuBrAttr_UNPIN (1 << 6) /* rename-able top dir of -+ branch. meaningless since -+ linux-3.18-rc1 */ -+ -+/* ignore error in copying XATTR */ -+#define AuBrAttr_ICEX_SEC (1 << 7) -+#define AuBrAttr_ICEX_SYS (1 << 8) -+#define AuBrAttr_ICEX_TR (1 << 9) -+#define AuBrAttr_ICEX_USR (1 << 10) -+#define AuBrAttr_ICEX_OTH (1 << 11) -+#define AuBrAttr_ICEX (AuBrAttr_ICEX_SEC \ -+ | AuBrAttr_ICEX_SYS \ -+ | AuBrAttr_ICEX_TR \ -+ | AuBrAttr_ICEX_USR \ -+ | AuBrAttr_ICEX_OTH) -+ -+#define AuBrRAttr_WH (1 << 12) /* whiteout-able */ -+#define AuBrRAttr_Mask AuBrRAttr_WH -+ -+#define AuBrWAttr_NoLinkWH (1 << 13) /* un-hardlinkable whiteouts */ -+#define AuBrWAttr_MOO (1 << 14) /* move-up on open */ -+#define AuBrWAttr_Mask (AuBrWAttr_NoLinkWH | AuBrWAttr_MOO) -+ -+#define AuBrAttr_CMOO_Mask (AuBrAttr_COO_Mask | AuBrWAttr_MOO) -+ -+/* #warning test userspace */ -+#ifdef __KERNEL__ -+#ifndef CONFIG_AUFS_FHSM -+#undef AuBrAttr_FHSM -+#define AuBrAttr_FHSM 0 -+#endif -+#ifndef CONFIG_AUFS_XATTR -+#undef AuBrAttr_ICEX -+#define AuBrAttr_ICEX 0 -+#undef AuBrAttr_ICEX_SEC -+#define AuBrAttr_ICEX_SEC 0 -+#undef AuBrAttr_ICEX_SYS -+#define AuBrAttr_ICEX_SYS 0 -+#undef AuBrAttr_ICEX_TR -+#define AuBrAttr_ICEX_TR 0 -+#undef AuBrAttr_ICEX_USR -+#define AuBrAttr_ICEX_USR 0 -+#undef AuBrAttr_ICEX_OTH -+#define AuBrAttr_ICEX_OTH 0 -+#endif -+#endif -+ -+/* the longest combination */ -+/* AUFS_BRATTR_ICEX and AUFS_BRATTR_ICEX_TR don't affect here */ -+#define AuBrPermStrSz sizeof(AUFS_BRPERM_RW \ -+ "+" AUFS_BRATTR_COO_REG \ -+ "+" AUFS_BRATTR_FHSM \ -+ "+" AUFS_BRATTR_UNPIN \ -+ "+" AUFS_BRATTR_ICEX_SEC \ -+ "+" AUFS_BRATTR_ICEX_SYS \ -+ "+" AUFS_BRATTR_ICEX_USR \ -+ "+" AUFS_BRATTR_ICEX_OTH \ -+ "+" AUFS_BRWATTR_NLWH) -+ -+typedef struct { -+ char a[AuBrPermStrSz]; -+} au_br_perm_str_t; -+ -+static inline int au_br_writable(int brperm) -+{ -+ return brperm & AuBrPerm_RW; -+} -+ -+static inline int au_br_whable(int brperm) -+{ -+ return brperm & (AuBrPerm_RW | AuBrRAttr_WH); -+} -+ -+static inline int au_br_wh_linkable(int brperm) -+{ -+ return !(brperm & AuBrWAttr_NoLinkWH); -+} -+ -+static inline int au_br_cmoo(int brperm) -+{ -+ return brperm & AuBrAttr_CMOO_Mask; -+} -+ -+static inline int au_br_fhsm(int brperm) -+{ -+ return brperm & AuBrAttr_FHSM; -+} -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* ioctl */ -+enum { -+ /* readdir in userspace */ -+ AuCtl_RDU, -+ AuCtl_RDU_INO, -+ -+ AuCtl_WBR_FD, /* pathconf wrapper */ -+ AuCtl_IBUSY, /* busy inode */ -+ AuCtl_MVDOWN, /* move-down */ -+ AuCtl_BR, /* info about branches */ -+ AuCtl_FHSM_FD /* connection for fhsm */ -+}; -+ -+/* borrowed from linux/include/linux/kernel.h */ -+#ifndef ALIGN -+#define ALIGN(x, a) __ALIGN_MASK(x, (typeof(x))(a)-1) -+#define __ALIGN_MASK(x, mask) (((x)+(mask))&~(mask)) -+#endif -+ -+/* borrowed from linux/include/linux/compiler-gcc3.h */ -+#ifndef __aligned -+#define __aligned(x) __attribute__((aligned(x))) -+#endif -+ -+#ifdef __KERNEL__ -+#ifndef __packed -+#define __packed __attribute__((packed)) -+#endif -+#endif -+ -+struct au_rdu_cookie { -+ uint64_t h_pos; -+ int16_t bindex; -+ uint8_t flags; -+ uint8_t pad; -+ uint32_t generation; -+} __aligned(8); -+ -+struct au_rdu_ent { -+ uint64_t ino; -+ int16_t bindex; -+ uint8_t type; -+ uint8_t nlen; -+ uint8_t wh; -+ char name[0]; -+} __aligned(8); -+ -+static inline int au_rdu_len(int nlen) -+{ -+ /* include the terminating NULL */ -+ return ALIGN(sizeof(struct au_rdu_ent) + nlen + 1, -+ sizeof(uint64_t)); -+} -+ -+union au_rdu_ent_ul { -+ struct au_rdu_ent __user *e; -+ uint64_t ul; -+}; -+ -+enum { -+ AufsCtlRduV_SZ, -+ AufsCtlRduV_End -+}; -+ -+struct aufs_rdu { -+ /* input */ -+ union { -+ uint64_t sz; /* AuCtl_RDU */ -+ uint64_t nent; /* AuCtl_RDU_INO */ -+ }; -+ union au_rdu_ent_ul ent; -+ uint16_t verify[AufsCtlRduV_End]; -+ -+ /* input/output */ -+ uint32_t blk; -+ -+ /* output */ -+ union au_rdu_ent_ul tail; -+ /* number of entries which were added in a single call */ -+ uint64_t rent; -+ uint8_t full; -+ uint8_t shwh; -+ -+ struct au_rdu_cookie cookie; -+} __aligned(8); -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* dirren. the branch is identified by the filename who contains this */ -+struct au_drinfo { -+ uint64_t ino; -+ union { -+ uint8_t oldnamelen; -+ uint64_t _padding; -+ }; -+ uint8_t oldname[0]; -+} __aligned(8); -+ -+struct au_drinfo_fdata { -+ uint32_t magic; -+ struct au_drinfo drinfo; -+} __aligned(8); -+ -+#define AUFS_DRINFO_MAGIC_V1 ('a' << 24 | 'd' << 16 | 'r' << 8 | 0x01) -+/* future */ -+#define AUFS_DRINFO_MAGIC_V2 ('a' << 24 | 'd' << 16 | 'r' << 8 | 0x02) -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct aufs_wbr_fd { -+ uint32_t oflags; -+ int16_t brid; -+} __aligned(8); -+ -+/* ---------------------------------------------------------------------- */ -+ -+struct aufs_ibusy { -+ uint64_t ino, h_ino; -+ int16_t bindex; -+} __aligned(8); -+ -+/* ---------------------------------------------------------------------- */ -+ -+/* error code for move-down */ -+/* the actual message strings are implemented in aufs-util.git */ -+enum { -+ EAU_MVDOWN_OPAQUE = 1, -+ EAU_MVDOWN_WHITEOUT, -+ EAU_MVDOWN_UPPER, -+ EAU_MVDOWN_BOTTOM, -+ EAU_MVDOWN_NOUPPER, -+ EAU_MVDOWN_NOLOWERBR, -+ EAU_Last -+}; -+ -+/* flags for move-down */ -+#define AUFS_MVDOWN_DMSG 1 -+#define AUFS_MVDOWN_OWLOWER (1 << 1) /* overwrite lower */ -+#define AUFS_MVDOWN_KUPPER (1 << 2) /* keep upper */ -+#define AUFS_MVDOWN_ROLOWER (1 << 3) /* do even if lower is RO */ -+#define AUFS_MVDOWN_ROLOWER_R (1 << 4) /* did on lower RO */ -+#define AUFS_MVDOWN_ROUPPER (1 << 5) /* do even if upper is RO */ -+#define AUFS_MVDOWN_ROUPPER_R (1 << 6) /* did on upper RO */ -+#define AUFS_MVDOWN_BRID_UPPER (1 << 7) /* upper brid */ -+#define AUFS_MVDOWN_BRID_LOWER (1 << 8) /* lower brid */ -+#define AUFS_MVDOWN_FHSM_LOWER (1 << 9) /* find fhsm attr for lower */ -+#define AUFS_MVDOWN_STFS (1 << 10) /* req. stfs */ -+#define AUFS_MVDOWN_STFS_FAILED (1 << 11) /* output: stfs is unusable */ -+#define AUFS_MVDOWN_BOTTOM (1 << 12) /* output: no more lowers */ -+ -+/* index for move-down */ -+enum { -+ AUFS_MVDOWN_UPPER, -+ AUFS_MVDOWN_LOWER, -+ AUFS_MVDOWN_NARRAY -+}; -+ -+/* -+ * additional info of move-down -+ * number of free blocks and inodes. -+ * subset of struct kstatfs, but smaller and always 64bit. -+ */ -+struct aufs_stfs { -+ uint64_t f_blocks; -+ uint64_t f_bavail; -+ uint64_t f_files; -+ uint64_t f_ffree; -+}; -+ -+struct aufs_stbr { -+ int16_t brid; /* optional input */ -+ int16_t bindex; /* output */ -+ struct aufs_stfs stfs; /* output when AUFS_MVDOWN_STFS set */ -+} __aligned(8); -+ -+struct aufs_mvdown { -+ uint32_t flags; /* input/output */ -+ struct aufs_stbr stbr[AUFS_MVDOWN_NARRAY]; /* input/output */ -+ int8_t au_errno; /* output */ -+} __aligned(8); -+ -+/* ---------------------------------------------------------------------- */ -+ -+union aufs_brinfo { -+ /* PATH_MAX may differ between kernel-space and user-space */ -+ char _spacer[4096]; -+ struct { -+ int16_t id; -+ int perm; -+ char path[0]; -+ }; -+} __aligned(8); -+ -+/* ---------------------------------------------------------------------- */ -+ -+#define AuCtlType 'A' -+#define AUFS_CTL_RDU _IOWR(AuCtlType, AuCtl_RDU, struct aufs_rdu) -+#define AUFS_CTL_RDU_INO _IOWR(AuCtlType, AuCtl_RDU_INO, struct aufs_rdu) -+#define AUFS_CTL_WBR_FD _IOW(AuCtlType, AuCtl_WBR_FD, \ -+ struct aufs_wbr_fd) -+#define AUFS_CTL_IBUSY _IOWR(AuCtlType, AuCtl_IBUSY, struct aufs_ibusy) -+#define AUFS_CTL_MVDOWN _IOWR(AuCtlType, AuCtl_MVDOWN, \ -+ struct aufs_mvdown) -+#define AUFS_CTL_BRINFO _IOW(AuCtlType, AuCtl_BR, union aufs_brinfo) -+#define AUFS_CTL_FHSM_FD _IOW(AuCtlType, AuCtl_FHSM_FD, int) -+ -+#endif /* __AUFS_TYPE_H__ */ -diff --git a/kernel/fork.c b/kernel/fork.c -index 07cc743698d3..b1d2b4381ab7 100644 ---- a/kernel/fork.c -+++ b/kernel/fork.c -@@ -676,7 +676,7 @@ static __latent_entropy int dup_mmap(struct mm_struct *mm, - struct inode *inode = file_inode(file); - struct address_space *mapping = file->f_mapping; - -- get_file(file); -+ vma_get_file(tmp); - if (tmp->vm_flags & VM_DENYWRITE) - atomic_dec(&inode->i_writecount); - i_mmap_lock_write(mapping); -diff --git a/kernel/locking/lockdep.c b/kernel/locking/lockdep.c -index e36e652d996f..bc97a9799ba1 100644 ---- a/kernel/locking/lockdep.c -+++ b/kernel/locking/lockdep.c -@@ -144,7 +144,7 @@ static struct lock_list list_entries[MAX_LOCKDEP_ENTRIES]; - unsigned long nr_lock_classes; - static struct lock_class lock_classes[MAX_LOCKDEP_KEYS]; - --static inline struct lock_class *hlock_class(struct held_lock *hlock) -+inline struct lock_class *lockdep_hlock_class(struct held_lock *hlock) - { - if (!hlock->class_idx) { - /* -@@ -155,6 +155,7 @@ static inline struct lock_class *hlock_class(struct held_lock *hlock) - } - return lock_classes + hlock->class_idx - 1; - } -+#define hlock_class(hlock) lockdep_hlock_class(hlock) - - #ifdef CONFIG_LOCK_STAT - static DEFINE_PER_CPU(struct lock_class_stats[MAX_LOCKDEP_KEYS], cpu_lock_stats); -diff --git a/mm/Makefile b/mm/Makefile -index 4659b93cba43..844888411196 100644 ---- a/mm/Makefile -+++ b/mm/Makefile -@@ -40,7 +40,7 @@ obj-y := filemap.o mempool.o oom_kill.o \ - mm_init.o mmu_context.o percpu.o slab_common.o \ - compaction.o vmacache.o swap_slots.o \ - interval_tree.o list_lru.o workingset.o \ -- debug.o $(mmu-y) -+ prfile.o debug.o $(mmu-y) - - obj-y += init-mm.o - -diff --git a/mm/filemap.c b/mm/filemap.c -index 594d73fef8b4..7183aefa1551 100644 ---- a/mm/filemap.c -+++ b/mm/filemap.c -@@ -2590,7 +2590,7 @@ int filemap_page_mkwrite(struct vm_fault *vmf) - int ret = VM_FAULT_LOCKED; - - sb_start_pagefault(inode->i_sb); -- file_update_time(vmf->vma->vm_file); -+ vma_file_update_time(vmf->vma); - lock_page(page); - if (page->mapping != inode->i_mapping) { - unlock_page(page); -diff --git a/mm/mmap.c b/mm/mmap.c -index 680506faceae..081406a0aeec 100644 ---- a/mm/mmap.c -+++ b/mm/mmap.c -@@ -171,7 +171,7 @@ static struct vm_area_struct *remove_vma(struct vm_area_struct *vma) - if (vma->vm_ops && vma->vm_ops->close) - vma->vm_ops->close(vma); - if (vma->vm_file) -- fput(vma->vm_file); -+ vma_fput(vma); - mpol_put(vma_policy(vma)); - kmem_cache_free(vm_area_cachep, vma); - return next; -@@ -896,7 +896,7 @@ int __vma_adjust(struct vm_area_struct *vma, unsigned long start, - if (remove_next) { - if (file) { - uprobe_munmap(next, next->vm_start, next->vm_end); -- fput(file); -+ vma_fput(vma); - } - if (next->anon_vma) - anon_vma_merge(vma, next); -@@ -1746,8 +1746,8 @@ unsigned long mmap_region(struct file *file, unsigned long addr, - return addr; - - unmap_and_free_vma: -+ vma_fput(vma); - vma->vm_file = NULL; -- fput(file); - - /* Undo any partial mapping done by a device driver. */ - unmap_region(mm, vma, prev, vma->vm_start, vma->vm_end); -@@ -2569,7 +2569,7 @@ int __split_vma(struct mm_struct *mm, struct vm_area_struct *vma, - goto out_free_mpol; - - if (new->vm_file) -- get_file(new->vm_file); -+ vma_get_file(new); - - if (new->vm_ops && new->vm_ops->open) - new->vm_ops->open(new); -@@ -2588,7 +2588,7 @@ int __split_vma(struct mm_struct *mm, struct vm_area_struct *vma, - if (new->vm_ops && new->vm_ops->close) - new->vm_ops->close(new); - if (new->vm_file) -- fput(new->vm_file); -+ vma_fput(new); - unlink_anon_vmas(new); - out_free_mpol: - mpol_put(vma_policy(new)); -@@ -2750,7 +2750,7 @@ SYSCALL_DEFINE5(remap_file_pages, unsigned long, start, unsigned long, size, - struct vm_area_struct *vma; - unsigned long populate = 0; - unsigned long ret = -EINVAL; -- struct file *file; -+ struct file *file, *prfile; - - pr_warn_once("%s (%d) uses deprecated remap_file_pages() syscall. See Documentation/vm/remap_file_pages.txt.\n", - current->comm, current->pid); -@@ -2825,10 +2825,27 @@ SYSCALL_DEFINE5(remap_file_pages, unsigned long, start, unsigned long, size, - } - } - -- file = get_file(vma->vm_file); -+ vma_get_file(vma); -+ file = vma->vm_file; -+ prfile = vma->vm_prfile; - ret = do_mmap_pgoff(vma->vm_file, start, size, - prot, flags, pgoff, &populate, NULL); -+ if (!IS_ERR_VALUE(ret) && file && prfile) { -+ struct vm_area_struct *new_vma; -+ -+ new_vma = find_vma(mm, ret); -+ if (!new_vma->vm_prfile) -+ new_vma->vm_prfile = prfile; -+ if (new_vma != vma) -+ get_file(prfile); -+ } -+ /* -+ * two fput()s instead of vma_fput(vma), -+ * coz vma may not be available anymore. -+ */ - fput(file); -+ if (prfile) -+ fput(prfile); - out: - up_write(&mm->mmap_sem); - if (populate) -@@ -3136,7 +3153,7 @@ struct vm_area_struct *copy_vma(struct vm_area_struct **vmap, - if (anon_vma_clone(new_vma, vma)) - goto out_free_mempol; - if (new_vma->vm_file) -- get_file(new_vma->vm_file); -+ vma_get_file(new_vma); - if (new_vma->vm_ops && new_vma->vm_ops->open) - new_vma->vm_ops->open(new_vma); - vma_link(mm, new_vma, prev, rb_link, rb_parent); -diff --git a/mm/nommu.c b/mm/nommu.c -index 17c00d93de2e..4bcdf9448dd0 100644 ---- a/mm/nommu.c -+++ b/mm/nommu.c -@@ -641,7 +641,7 @@ static void __put_nommu_region(struct vm_region *region) - up_write(&nommu_region_sem); - - if (region->vm_file) -- fput(region->vm_file); -+ vmr_fput(region); - - /* IO memory and memory shared directly out of the pagecache - * from ramfs/tmpfs mustn't be released here */ -@@ -799,7 +799,7 @@ static void delete_vma(struct mm_struct *mm, struct vm_area_struct *vma) - if (vma->vm_ops && vma->vm_ops->close) - vma->vm_ops->close(vma); - if (vma->vm_file) -- fput(vma->vm_file); -+ vma_fput(vma); - put_nommu_region(vma->vm_region); - kmem_cache_free(vm_area_cachep, vma); - } -@@ -1321,7 +1321,7 @@ unsigned long do_mmap(struct file *file, - goto error_just_free; - } - } -- fput(region->vm_file); -+ vmr_fput(region); - kmem_cache_free(vm_region_jar, region); - region = pregion; - result = start; -@@ -1396,10 +1396,10 @@ unsigned long do_mmap(struct file *file, - up_write(&nommu_region_sem); - error: - if (region->vm_file) -- fput(region->vm_file); -+ vmr_fput(region); - kmem_cache_free(vm_region_jar, region); - if (vma->vm_file) -- fput(vma->vm_file); -+ vma_fput(vma); - kmem_cache_free(vm_area_cachep, vma); - return ret; - -diff --git a/mm/prfile.c b/mm/prfile.c -new file mode 100644 -index 000000000000..3f5666999b7c ---- /dev/null -+++ b/mm/prfile.c -@@ -0,0 +1,86 @@ -+/* -+ * SPDX-License-Identifier: GPL-2.0 -+ * Mainly for aufs which mmap(2) different file and wants to print different -+ * path in /proc/PID/maps. -+ * Call these functions via macros defined in linux/mm.h. -+ * -+ * See Documentation/filesystems/aufs/design/06mmap.txt -+ * -+ * Copyright (c) 2014-2017 Junjro R. Okajima -+ * Copyright (c) 2014 Ian Campbell -+ */ -+ -+#include -+#include -+#include -+ -+/* #define PRFILE_TRACE */ -+static inline void prfile_trace(struct file *f, struct file *pr, -+ const char func[], int line, const char func2[]) -+{ -+#ifdef PRFILE_TRACE -+ if (pr) -+ pr_info("%s:%d: %s, %pD2\n", func, line, func2, f); -+#endif -+} -+ -+void vma_do_file_update_time(struct vm_area_struct *vma, const char func[], -+ int line) -+{ -+ struct file *f = vma->vm_file, *pr = vma->vm_prfile; -+ -+ prfile_trace(f, pr, func, line, __func__); -+ file_update_time(f); -+ if (f && pr) -+ file_update_time(pr); -+} -+ -+struct file *vma_do_pr_or_file(struct vm_area_struct *vma, const char func[], -+ int line) -+{ -+ struct file *f = vma->vm_file, *pr = vma->vm_prfile; -+ -+ prfile_trace(f, pr, func, line, __func__); -+ return (f && pr) ? pr : f; -+} -+ -+void vma_do_get_file(struct vm_area_struct *vma, const char func[], int line) -+{ -+ struct file *f = vma->vm_file, *pr = vma->vm_prfile; -+ -+ prfile_trace(f, pr, func, line, __func__); -+ get_file(f); -+ if (f && pr) -+ get_file(pr); -+} -+ -+void vma_do_fput(struct vm_area_struct *vma, const char func[], int line) -+{ -+ struct file *f = vma->vm_file, *pr = vma->vm_prfile; -+ -+ prfile_trace(f, pr, func, line, __func__); -+ fput(f); -+ if (f && pr) -+ fput(pr); -+} -+ -+#ifndef CONFIG_MMU -+struct file *vmr_do_pr_or_file(struct vm_region *region, const char func[], -+ int line) -+{ -+ struct file *f = region->vm_file, *pr = region->vm_prfile; -+ -+ prfile_trace(f, pr, func, line, __func__); -+ return (f && pr) ? pr : f; -+} -+ -+void vmr_do_fput(struct vm_region *region, const char func[], int line) -+{ -+ struct file *f = region->vm_file, *pr = region->vm_prfile; -+ -+ prfile_trace(f, pr, func, line, __func__); -+ fput(f); -+ if (f && pr) -+ fput(pr); -+} -+#endif /* !CONFIG_MMU */ diff --git a/kernel/kernel/files/patches/mageia/fs-aufs-5.4-version.patch b/kernel/kernel/files/patches/mageia/fs-aufs-5.4-version.patch deleted file mode 100755 index 85c71bf3..00000000 --- a/kernel/kernel/files/patches/mageia/fs-aufs-5.4-version.patch +++ /dev/null @@ -1,12 +0,0 @@ -diff -Nurp linux-5.3-aufs/include/uapi/linux/aufs_type.h linux-5.3-aufs-ver/include/uapi/linux/aufs_type.h ---- linux-5.3-aufs/include/uapi/linux/aufs_type.h 2019-09-24 16:13:44.012259519 +0300 -+++ linux-5.3-aufs-ver/include/uapi/linux/aufs_type.h 2019-09-24 20:04:21.924707762 +0300 -@@ -27,7 +27,7 @@ - - #include - --#define AUFS_VERSION "5.x-rcN" -+#define AUFS_VERSION "5.4" - - /* todo? move this to linux-2.6.19/include/magic.h */ - #define AUFS_SUPER_MAGIC ('a' << 24 | 'u' << 16 | 'f' << 8 | 's') diff --git a/kernel/kernel/files/patches/mageia/fs-aufs-5.6-fix.patch b/kernel/kernel/files/patches/mageia/fs-aufs-5.6-fix.patch new file mode 100644 index 00000000..9fe6102a --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-aufs-5.6-fix.patch @@ -0,0 +1,39 @@ +diff -Nurp linux-5.6.3-aufs/fs/aufs/procfs.c linux-5.6.3-aufs-fix/fs/aufs/procfs.c +--- linux-5.6.3-aufs/fs/aufs/procfs.c 2020-04-10 12:40:52.192049502 +0300 ++++ linux-5.6.3-aufs-fix/fs/aufs/procfs.c 2020-04-10 17:46:50.019444421 +0300 +@@ -116,10 +116,9 @@ out: + return err; + } + +-static const struct file_operations au_procfs_plm_fop = { +- .write = au_procfs_plm_write, +- .release = au_procfs_plm_release, +- .owner = THIS_MODULE ++static const struct proc_ops au_procfs_plm_op = { ++ .proc_write = au_procfs_plm_write, ++ .proc_release = au_procfs_plm_release + }; + + /* ---------------------------------------------------------------------- */ +@@ -143,7 +142,7 @@ int __init au_procfs_init(void) + goto out; + + entry = proc_create(AUFS_PLINK_MAINT_NAME, S_IFREG | 0200, +- au_procfs_dir, &au_procfs_plm_fop); ++ au_procfs_dir, &au_procfs_plm_op); + if (unlikely(!entry)) + goto out_dir; + +diff -Nurp linux-5.6.3-aufs/fs/aufs/xino.c linux-5.6.3-aufs-fix/fs/aufs/xino.c +--- linux-5.6.3-aufs/fs/aufs/xino.c 2020-04-10 12:40:52.193049549 +0300 ++++ linux-5.6.3-aufs-fix/fs/aufs/xino.c 2020-04-10 17:46:25.165284147 +0300 +@@ -1344,7 +1344,8 @@ static void au_xino_release(struct kref + hlist_bl_lock(hbl); + hlist_bl_for_each_entry_safe(p, pos, n, hbl, node) { + hlist_bl_del(&p->node); +- au_kfree_rcu(p); ++ /* kmemleak reported au_kfree_rcu() doesn't free it */ ++ kfree(p); + } + hlist_bl_unlock(hbl); + } diff --git a/kernel/kernel/files/patches/mageia/fs-aufs-5.4-modular.patch b/kernel/kernel/files/patches/mageia/fs-aufs-5.6-modular.patch similarity index 55% rename from kernel/kernel/files/patches/mageia/fs-aufs-5.4-modular.patch rename to kernel/kernel/files/patches/mageia/fs-aufs-5.6-modular.patch index ec4a9135..ad296b9a 100644 --- a/kernel/kernel/files/patches/mageia/fs-aufs-5.4-modular.patch +++ b/kernel/kernel/files/patches/mageia/fs-aufs-5.6-modular.patch @@ -14,13 +14,12 @@ fs/xattr.c | 1 + kernel/locking/lockdep.c | 1 + kernel/task_work.c | 1 + - security/device_cgroup.c | 1 + security/security.c | 8 ++++++++ - 17 files changed, 32 insertions(+), 1 deletion(-) + 16 files changed, 31 insertions(+), 1 deletion(-) -diff -Nurp linux-5.4-aufs/fs/aufs/Kconfig linux-5.4-aufs-mod/fs/aufs/Kconfig ---- linux-5.4-aufs/fs/aufs/Kconfig 2019-11-28 01:25:59.062925618 +0200 -+++ linux-5.4-aufs-mod/fs/aufs/Kconfig 2019-11-28 01:38:40.564895255 +0200 +diff -Nurp linux-5.6.3-aufs/fs/aufs/Kconfig linux-5.6.3-aufs-mod/fs/aufs/Kconfig +--- linux-5.6.3-aufs/fs/aufs/Kconfig 2020-04-10 12:40:52.187049268 +0300 ++++ linux-5.6.3-aufs-mod/fs/aufs/Kconfig 2020-04-10 13:15:44.979742386 +0300 @@ -1,6 +1,6 @@ # SPDX-License-Identifier: GPL-2.0 config AUFS_FS @@ -29,10 +28,10 @@ diff -Nurp linux-5.4-aufs/fs/aufs/Kconfig linux-5.4-aufs-mod/fs/aufs/Kconfig help Aufs is a stackable unification filesystem such as Unionfs, which unifies several directories and provides a merged single -diff -Nurp linux-5.4-aufs/fs/dcache.c linux-5.4-aufs-mod/fs/dcache.c ---- linux-5.4-aufs/fs/dcache.c 2019-11-28 01:25:59.069925618 +0200 -+++ linux-5.4-aufs-mod/fs/dcache.c 2019-11-28 01:38:40.585895254 +0200 -@@ -1369,6 +1369,7 @@ rename_retry: +diff -Nurp linux-5.6.3-aufs/fs/dcache.c linux-5.6.3-aufs-mod/fs/dcache.c +--- linux-5.6.3-aufs/fs/dcache.c 2020-04-10 12:40:52.194049596 +0300 ++++ linux-5.6.3-aufs-mod/fs/dcache.c 2020-04-10 13:15:44.979742386 +0300 +@@ -1371,6 +1371,7 @@ rename_retry: seq = 1; goto again; } @@ -40,7 +39,7 @@ diff -Nurp linux-5.4-aufs/fs/dcache.c linux-5.4-aufs-mod/fs/dcache.c struct check_mount { struct vfsmount *mnt; -@@ -2914,6 +2915,7 @@ void d_exchange(struct dentry *dentry1, +@@ -2916,6 +2917,7 @@ void d_exchange(struct dentry *dentry1, write_sequnlock(&rename_lock); } @@ -48,10 +47,10 @@ diff -Nurp linux-5.4-aufs/fs/dcache.c linux-5.4-aufs-mod/fs/dcache.c /** * d_ancestor - search for an ancestor -diff -Nurp linux-5.4-aufs/fs/exec.c linux-5.4-aufs-mod/fs/exec.c ---- linux-5.4-aufs/fs/exec.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs-mod/fs/exec.c 2019-11-28 01:38:40.589895254 +0200 -@@ -110,6 +110,7 @@ bool path_noexec(const struct path *path +diff -Nurp linux-5.6.3-aufs/fs/exec.c linux-5.6.3-aufs-mod/fs/exec.c +--- linux-5.6.3-aufs/fs/exec.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs-mod/fs/exec.c 2020-04-10 13:15:44.979742386 +0300 +@@ -109,6 +109,7 @@ bool path_noexec(const struct path *path return (path->mnt->mnt_flags & MNT_NOEXEC) || (path->mnt->mnt_sb->s_iflags & SB_I_NOEXEC); } @@ -59,10 +58,10 @@ diff -Nurp linux-5.4-aufs/fs/exec.c linux-5.4-aufs-mod/fs/exec.c #ifdef CONFIG_USELIB /* -diff -Nurp linux-5.4-aufs/fs/fcntl.c linux-5.4-aufs-mod/fs/fcntl.c ---- linux-5.4-aufs/fs/fcntl.c 2019-11-28 01:25:59.069925618 +0200 -+++ linux-5.4-aufs-mod/fs/fcntl.c 2019-11-28 01:38:40.589895254 +0200 -@@ -85,6 +85,7 @@ int setfl(int fd, struct file * filp, un +diff -Nurp linux-5.6.3-aufs/fs/fcntl.c linux-5.6.3-aufs-mod/fs/fcntl.c +--- linux-5.6.3-aufs/fs/fcntl.c 2020-04-10 12:40:52.194049596 +0300 ++++ linux-5.6.3-aufs-mod/fs/fcntl.c 2020-04-10 13:15:44.979742386 +0300 +@@ -85,6 +85,7 @@ int setfl(int fd, struct file *filp, uns out: return error; } @@ -70,9 +69,9 @@ diff -Nurp linux-5.4-aufs/fs/fcntl.c linux-5.4-aufs-mod/fs/fcntl.c static void f_modown(struct file *filp, struct pid *pid, enum pid_type type, int force) -diff -Nurp linux-5.4-aufs/fs/file_table.c linux-5.4-aufs-mod/fs/file_table.c ---- linux-5.4-aufs/fs/file_table.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs-mod/fs/file_table.c 2019-11-28 01:38:40.589895254 +0200 +diff -Nurp linux-5.6.3-aufs/fs/file_table.c linux-5.6.3-aufs-mod/fs/file_table.c +--- linux-5.6.3-aufs/fs/file_table.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs-mod/fs/file_table.c 2020-04-10 13:15:44.979742386 +0300 @@ -162,6 +162,7 @@ over: } return ERR_PTR(-ENFILE); @@ -81,7 +80,7 @@ diff -Nurp linux-5.4-aufs/fs/file_table.c linux-5.4-aufs-mod/fs/file_table.c /* * Variant of alloc_empty_file() that doesn't check and modify nr_files. -@@ -375,6 +377,7 @@ void __fput_sync(struct file *file) +@@ -375,6 +376,7 @@ void __fput_sync(struct file *file) } EXPORT_SYMBOL(fput); @@ -89,20 +88,20 @@ diff -Nurp linux-5.4-aufs/fs/file_table.c linux-5.4-aufs-mod/fs/file_table.c void __init files_init(void) { -diff -Nurp linux-5.4-aufs/fs/inode.c linux-5.4-aufs-mod/fs/inode.c ---- linux-5.4-aufs/fs/inode.c 2019-11-28 01:25:59.070925617 +0200 -+++ linux-5.4-aufs-mod/fs/inode.c 2019-11-28 01:38:40.589895254 +0200 -@@ -1682,6 +1682,7 @@ int update_time(struct inode *inode, str - - return update_time(inode, time, flags); +diff -Nurp linux-5.6.3-aufs/fs/inode.c linux-5.6.3-aufs-mod/fs/inode.c +--- linux-5.6.3-aufs/fs/inode.c 2020-04-10 12:40:52.194049596 +0300 ++++ linux-5.6.3-aufs-mod/fs/inode.c 2020-04-10 13:15:44.980742432 +0300 +@@ -1694,6 +1694,7 @@ int update_time(struct inode *inode, str + return inode->i_op->update_time(inode, time, flags); + return generic_update_time(inode, time, flags); } +EXPORT_SYMBOL_GPL(update_time); /** * touch_atime - update the access time -diff -Nurp linux-5.4-aufs/fs/namespace.c linux-5.4-aufs-mod/fs/namespace.c ---- linux-5.4-aufs/fs/namespace.c 2019-11-28 01:25:59.070925617 +0200 -+++ linux-5.4-aufs-mod/fs/namespace.c 2019-11-28 01:38:40.589895254 +0200 +diff -Nurp linux-5.6.3-aufs/fs/namespace.c linux-5.6.3-aufs-mod/fs/namespace.c +--- linux-5.6.3-aufs/fs/namespace.c 2020-04-10 12:40:52.194049596 +0300 ++++ linux-5.6.3-aufs-mod/fs/namespace.c 2020-04-10 13:15:44.980742432 +0300 @@ -431,6 +431,7 @@ void __mnt_drop_write(struct vfsmount *m mnt_dec_writers(real_mount(mnt)); preempt_enable(); @@ -127,9 +126,9 @@ diff -Nurp linux-5.4-aufs/fs/namespace.c linux-5.4-aufs-mod/fs/namespace.c static void lock_mnt_tree(struct mount *mnt) { -diff -Nurp linux-5.4-aufs/fs/notify/group.c linux-5.4-aufs-mod/fs/notify/group.c ---- linux-5.4-aufs/fs/notify/group.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs-mod/fs/notify/group.c 2019-11-28 01:38:40.590895253 +0200 +diff -Nurp linux-5.6.3-aufs/fs/notify/group.c linux-5.6.3-aufs-mod/fs/notify/group.c +--- linux-5.6.3-aufs/fs/notify/group.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs-mod/fs/notify/group.c 2020-04-10 13:15:44.980742432 +0300 @@ -99,6 +99,7 @@ void fsnotify_get_group(struct fsnotify_ { refcount_inc(&group->refcnt); @@ -138,9 +137,9 @@ diff -Nurp linux-5.4-aufs/fs/notify/group.c linux-5.4-aufs-mod/fs/notify/group.c /* * Drop a reference to a group. Free it if it's through. -diff -Nurp linux-5.4-aufs/fs/open.c linux-5.4-aufs-mod/fs/open.c ---- linux-5.4-aufs/fs/open.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs-mod/fs/open.c 2019-11-28 01:38:48.762894928 +0200 +diff -Nurp linux-5.6.3-aufs/fs/open.c linux-5.6.3-aufs-mod/fs/open.c +--- linux-5.6.3-aufs/fs/open.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs-mod/fs/open.c 2020-04-10 13:15:44.980742432 +0300 @@ -65,6 +65,7 @@ int do_truncate(struct dentry *dentry, l inode_unlock(dentry->d_inode); return ret; @@ -149,9 +148,9 @@ diff -Nurp linux-5.4-aufs/fs/open.c linux-5.4-aufs-mod/fs/open.c long vfs_truncate(const struct path *path, loff_t length) { -diff -Nurp linux-5.4-aufs/fs/read_write.c linux-5.4-aufs-mod/fs/read_write.c ---- linux-5.4-aufs/fs/read_write.c 2019-11-28 01:25:59.070925617 +0200 -+++ linux-5.4-aufs-mod/fs/read_write.c 2019-11-28 01:38:48.780894927 +0200 +diff -Nurp linux-5.6.3-aufs/fs/read_write.c linux-5.6.3-aufs-mod/fs/read_write.c +--- linux-5.6.3-aufs/fs/read_write.c 2020-04-10 12:40:52.194049596 +0300 ++++ linux-5.6.3-aufs-mod/fs/read_write.c 2020-04-10 13:15:44.981742479 +0300 @@ -468,6 +468,7 @@ ssize_t vfs_read(struct file *file, char return ret; @@ -162,7 +161,7 @@ diff -Nurp linux-5.4-aufs/fs/read_write.c linux-5.4-aufs-mod/fs/read_write.c { @@ -508,6 +509,7 @@ vfs_readf_t vfs_readf(struct file *file) return new_sync_read; - return ERR_PTR(-ENOSYS); + return ERR_PTR(-ENOSYS); /* doesn't have ->read(|_iter)() op */ } +EXPORT_SYMBOL_GPL(vfs_readf); @@ -170,7 +169,7 @@ diff -Nurp linux-5.4-aufs/fs/read_write.c linux-5.4-aufs-mod/fs/read_write.c { @@ -519,6 +521,7 @@ vfs_writef_t vfs_writef(struct file *fil return new_sync_write; - return ERR_PTR(-ENOSYS); + return ERR_PTR(-ENOSYS); /* doesn't have ->write(|_iter)() op */ } +EXPORT_SYMBOL_GPL(vfs_writef); @@ -184,10 +183,10 @@ diff -Nurp linux-5.4-aufs/fs/read_write.c linux-5.4-aufs-mod/fs/read_write.c /* file_ppos returns &file->f_pos or NULL if file is stream */ static inline loff_t *file_ppos(struct file *file) -diff -Nurp linux-5.4-aufs/fs/splice.c linux-5.4-aufs-mod/fs/splice.c ---- linux-5.4-aufs/fs/splice.c 2019-11-28 01:25:59.071925617 +0200 -+++ linux-5.4-aufs-mod/fs/splice.c 2019-11-28 01:38:48.780894927 +0200 -@@ -847,6 +847,7 @@ long do_splice_from(struct pipe_inode_in +diff -Nurp linux-5.6.3-aufs/fs/splice.c linux-5.6.3-aufs-mod/fs/splice.c +--- linux-5.6.3-aufs/fs/splice.c 2020-04-10 12:40:52.194049596 +0300 ++++ linux-5.6.3-aufs-mod/fs/splice.c 2020-04-10 13:15:44.981742479 +0300 +@@ -862,6 +862,7 @@ long do_splice_from(struct pipe_inode_in return splice_write(pipe, out, ppos, len, flags); } @@ -195,7 +194,7 @@ diff -Nurp linux-5.4-aufs/fs/splice.c linux-5.4-aufs-mod/fs/splice.c /* * Attempt to initiate a splice from a file to a pipe. -@@ -876,6 +877,7 @@ long do_splice_to(struct file *in, loff_ +@@ -891,6 +892,7 @@ long do_splice_to(struct file *in, loff_ return splice_read(in, ppos, pipe, len, flags); } @@ -203,9 +202,9 @@ diff -Nurp linux-5.4-aufs/fs/splice.c linux-5.4-aufs-mod/fs/splice.c /** * splice_direct_to_actor - splices data directly between two non-pipes -diff -Nurp linux-5.4-aufs/fs/sync.c linux-5.4-aufs-mod/fs/sync.c ---- linux-5.4-aufs/fs/sync.c 2019-11-28 01:25:59.071925617 +0200 -+++ linux-5.4-aufs-mod/fs/sync.c 2019-11-28 01:38:48.780894927 +0200 +diff -Nurp linux-5.6.3-aufs/fs/sync.c linux-5.6.3-aufs-mod/fs/sync.c +--- linux-5.6.3-aufs/fs/sync.c 2020-04-10 12:40:52.194049596 +0300 ++++ linux-5.6.3-aufs-mod/fs/sync.c 2020-04-10 13:15:44.981742479 +0300 @@ -39,6 +39,7 @@ int __sync_filesystem(struct super_block sb->s_op->sync_fs(sb, wait); return __sync_blockdev(sb->s_bdev, wait); @@ -214,9 +213,9 @@ diff -Nurp linux-5.4-aufs/fs/sync.c linux-5.4-aufs-mod/fs/sync.c /* * Write out and wait upon all dirty data associated with this -diff -Nurp linux-5.4-aufs/fs/xattr.c linux-5.4-aufs-mod/fs/xattr.c ---- linux-5.4-aufs/fs/xattr.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs-mod/fs/xattr.c 2019-11-28 01:38:48.780894927 +0200 +diff -Nurp linux-5.6.3-aufs/fs/xattr.c linux-5.6.3-aufs-mod/fs/xattr.c +--- linux-5.6.3-aufs/fs/xattr.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs-mod/fs/xattr.c 2020-04-10 13:15:44.981742479 +0300 @@ -296,6 +296,7 @@ vfs_getxattr_alloc(struct dentry *dentry *xattr_value = value; return error; @@ -225,9 +224,9 @@ diff -Nurp linux-5.4-aufs/fs/xattr.c linux-5.4-aufs-mod/fs/xattr.c ssize_t __vfs_getxattr(struct dentry *dentry, struct inode *inode, const char *name, -diff -Nurp linux-5.4-aufs/kernel/locking/lockdep.c linux-5.4-aufs-mod/kernel/locking/lockdep.c ---- linux-5.4-aufs/kernel/locking/lockdep.c 2019-11-28 01:25:59.072925617 +0200 -+++ linux-5.4-aufs-mod/kernel/locking/lockdep.c 2019-11-28 01:38:48.780894927 +0200 +diff -Nurp linux-5.6.3-aufs/kernel/locking/lockdep.c linux-5.6.3-aufs-mod/kernel/locking/lockdep.c +--- linux-5.6.3-aufs/kernel/locking/lockdep.c 2020-04-10 12:40:52.195049643 +0300 ++++ linux-5.6.3-aufs-mod/kernel/locking/lockdep.c 2020-04-10 13:15:44.982742525 +0300 @@ -174,6 +174,7 @@ inline struct lock_class *lockdep_hlock_ */ return lock_classes + class_idx; @@ -236,26 +235,18 @@ diff -Nurp linux-5.4-aufs/kernel/locking/lockdep.c linux-5.4-aufs-mod/kernel/loc #define hlock_class(hlock) lockdep_hlock_class(hlock) #ifdef CONFIG_LOCK_STAT -diff -Nurp linux-5.4-aufs/kernel/task_work.c linux-5.4-aufs-mod/kernel/task_work.c ---- linux-5.4-aufs/kernel/task_work.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs-mod/kernel/task_work.c 2019-11-28 01:38:48.786894927 +0200 +diff -Nurp linux-5.6.3-aufs/kernel/task_work.c linux-5.6.3-aufs-mod/kernel/task_work.c +--- linux-5.6.3-aufs/kernel/task_work.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs-mod/kernel/task_work.c 2020-04-10 13:15:44.982742525 +0300 @@ -116,3 +116,4 @@ void task_work_run(void) } while (work); } } +EXPORT_SYMBOL_GPL(task_work_run); -diff -Nurp linux-5.4-aufs/security/device_cgroup.c linux-5.4-aufs-mod/security/device_cgroup.c ---- linux-5.4-aufs/security/device_cgroup.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs-mod/security/device_cgroup.c 2019-11-28 01:38:48.790894927 +0200 -@@ -824,3 +824,4 @@ int __devcgroup_check_permission(short t - - return 0; - } -+EXPORT_SYMBOL_GPL(__devcgroup_check_permission); -diff -Nurp linux-5.4-aufs/security/security.c linux-5.4-aufs-mod/security/security.c ---- linux-5.4-aufs/security/security.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs-mod/security/security.c 2019-11-28 01:38:48.794894926 +0200 -@@ -1036,6 +1036,7 @@ int security_path_rmdir(const struct pat +diff -Nurp linux-5.6.3-aufs/security/security.c linux-5.6.3-aufs-mod/security/security.c +--- linux-5.6.3-aufs/security/security.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs-mod/security/security.c 2020-04-10 13:15:44.982742525 +0300 +@@ -1068,6 +1068,7 @@ int security_path_rmdir(const struct pat return 0; return call_int_hook(path_rmdir, 0, dir, dentry); } @@ -263,7 +254,7 @@ diff -Nurp linux-5.4-aufs/security/security.c linux-5.4-aufs-mod/security/securi int security_path_unlink(const struct path *dir, struct dentry *dentry) { -@@ -1052,6 +1053,7 @@ int security_path_symlink(const struct p +@@ -1084,6 +1085,7 @@ int security_path_symlink(const struct p return 0; return call_int_hook(path_symlink, 0, dir, dentry, old_name); } @@ -271,7 +262,7 @@ diff -Nurp linux-5.4-aufs/security/security.c linux-5.4-aufs-mod/security/securi int security_path_link(struct dentry *old_dentry, const struct path *new_dir, struct dentry *new_dentry) -@@ -1060,6 +1062,7 @@ int security_path_link(struct dentry *ol +@@ -1092,6 +1094,7 @@ int security_path_link(struct dentry *ol return 0; return call_int_hook(path_link, 0, old_dentry, new_dir, new_dentry); } @@ -279,7 +270,7 @@ diff -Nurp linux-5.4-aufs/security/security.c linux-5.4-aufs-mod/security/securi int security_path_rename(const struct path *old_dir, struct dentry *old_dentry, const struct path *new_dir, struct dentry *new_dentry, -@@ -1087,6 +1090,7 @@ int security_path_truncate(const struct +@@ -1119,6 +1122,7 @@ int security_path_truncate(const struct return 0; return call_int_hook(path_truncate, 0, path); } @@ -287,7 +278,7 @@ diff -Nurp linux-5.4-aufs/security/security.c linux-5.4-aufs-mod/security/securi int security_path_chmod(const struct path *path, umode_t mode) { -@@ -1094,6 +1098,7 @@ int security_path_chmod(const struct pat +@@ -1126,6 +1130,7 @@ int security_path_chmod(const struct pat return 0; return call_int_hook(path_chmod, 0, path, mode); } @@ -295,7 +286,7 @@ diff -Nurp linux-5.4-aufs/security/security.c linux-5.4-aufs-mod/security/securi int security_path_chown(const struct path *path, kuid_t uid, kgid_t gid) { -@@ -1101,6 +1106,7 @@ int security_path_chown(const struct pat +@@ -1133,6 +1138,7 @@ int security_path_chown(const struct pat return 0; return call_int_hook(path_chown, 0, path, uid, gid); } @@ -303,7 +294,7 @@ diff -Nurp linux-5.4-aufs/security/security.c linux-5.4-aufs-mod/security/securi int security_path_chroot(const struct path *path) { -@@ -1201,6 +1207,7 @@ int security_inode_permission(struct ino +@@ -1233,6 +1239,7 @@ int security_inode_permission(struct ino return 0; return call_int_hook(inode_permission, 0, inode, mask); } @@ -311,7 +302,7 @@ diff -Nurp linux-5.4-aufs/security/security.c linux-5.4-aufs-mod/security/securi int security_inode_setattr(struct dentry *dentry, struct iattr *attr) { -@@ -1378,6 +1385,7 @@ int security_file_permission(struct file +@@ -1410,6 +1417,7 @@ int security_file_permission(struct file return fsnotify_perm(file, mask); } diff --git a/kernel/kernel/files/patches/mageia/fs-aufs-5.4.patch b/kernel/kernel/files/patches/mageia/fs-aufs-5.6.patch similarity index 96% rename from kernel/kernel/files/patches/mageia/fs-aufs-5.4.patch rename to kernel/kernel/files/patches/mageia/fs-aufs-5.6.patch index 0f717dbf..52c8cfbb 100644 --- a/kernel/kernel/files/patches/mageia/fs-aufs-5.4.patch +++ b/kernel/kernel/files/patches/mageia/fs-aufs-5.6.patch @@ -1,7 +1,7 @@ Documentation/ABI/testing/debugfs-aufs | 55 Documentation/ABI/testing/sysfs-aufs | 31 - Documentation/filesystems/aufs/README | 399 +++ + Documentation/filesystems/aufs/README | 401 +++ Documentation/filesystems/aufs/design/01intro.txt | 158 + Documentation/filesystems/aufs/design/02struct.txt | 245 ++ Documentation/filesystems/aufs/design/03atomic_open.txt | 72 @@ -52,8 +52,8 @@ fs/aufs/hbl.h | 52 fs/aufs/hfsnotify.c | 275 ++ fs/aufs/hfsplus.c | 47 - fs/aufs/hnotify.c | 708 +++++ - fs/aufs/i_op.c | 1492 ++++++++++++ + fs/aufs/hnotify.c | 702 +++++ + fs/aufs/i_op.c | 1485 ++++++++++++ fs/aufs/i_op_add.c | 923 +++++++ fs/aufs/i_op_del.c | 500 ++++ fs/aufs/i_op_ren.c | 1237 ++++++++++ @@ -82,14 +82,14 @@ fs/aufs/sysaufs.c | 80 fs/aufs/sysaufs.h | 89 fs/aufs/sysfs.c | 338 ++ - fs/aufs/sysrq.c | 147 + + fs/aufs/sysrq.c | 136 + fs/aufs/vdir.c | 883 +++++++ fs/aufs/vfsub.c | 889 +++++++ fs/aufs/vfsub.h | 341 ++ fs/aufs/wbr_policy.c | 817 ++++++ fs/aufs/whout.c | 1049 ++++++++ fs/aufs/whout.h | 73 - fs/aufs/wkq.c | 379 +++ + fs/aufs/wkq.c | 359 ++ fs/aufs/wkq.h | 76 fs/aufs/xattr.c | 343 ++ fs/aufs/xino.c | 1952 ++++++++++++++++ @@ -118,11 +118,11 @@ mm/mmap.c | 33 mm/nommu.c | 10 mm/prfile.c | 86 - 119 files changed, 36936 insertions(+), 31 deletions(-) + 119 files changed, 36894 insertions(+), 31 deletions(-) -diff -Nurp linux-5.4/Documentation/ABI/testing/debugfs-aufs linux-5.4-aufs/Documentation/ABI/testing/debugfs-aufs ---- linux-5.4/Documentation/ABI/testing/debugfs-aufs 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/ABI/testing/debugfs-aufs 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/ABI/testing/debugfs-aufs linux-5.6.3-aufs/Documentation/ABI/testing/debugfs-aufs +--- linux-5.6.3/Documentation/ABI/testing/debugfs-aufs 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/ABI/testing/debugfs-aufs 2020-04-10 12:40:52.184049128 +0300 @@ -0,0 +1,55 @@ +What: /debug/aufs/si_/ +Date: March 2009 @@ -179,9 +179,9 @@ diff -Nurp linux-5.4/Documentation/ABI/testing/debugfs-aufs linux-5.4-aufs/Docum + be created. + When the aufs mount option 'noxino' is specified, it + will be empty. About XINO files, see the aufs manual. -diff -Nurp linux-5.4/Documentation/ABI/testing/sysfs-aufs linux-5.4-aufs/Documentation/ABI/testing/sysfs-aufs ---- linux-5.4/Documentation/ABI/testing/sysfs-aufs 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/ABI/testing/sysfs-aufs 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/ABI/testing/sysfs-aufs linux-5.6.3-aufs/Documentation/ABI/testing/sysfs-aufs +--- linux-5.6.3/Documentation/ABI/testing/sysfs-aufs 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/ABI/testing/sysfs-aufs 2020-04-10 12:40:52.184049128 +0300 @@ -0,0 +1,31 @@ +What: /sys/fs/aufs/si_/ +Date: March 2009 @@ -214,12 +214,12 @@ diff -Nurp linux-5.4/Documentation/ABI/testing/sysfs-aufs linux-5.4-aufs/Documen + even if it is the default path. + When the aufs mount option 'noxino' is specified, it + will be empty. About XINO files, see the aufs manual. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/01intro.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/01intro.txt ---- linux-5.4/Documentation/filesystems/aufs/design/01intro.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/01intro.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/01intro.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/01intro.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/01intro.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/01intro.txt 2020-04-10 12:40:52.184049128 +0300 @@ -0,0 +1,158 @@ + -+# Copyright (C) 2005-2019 Junjiro R. Okajima ++# Copyright (C) 2005-2020 Junjiro R. Okajima + +Introduction +---------------------------------------- @@ -376,12 +376,12 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/01intro.txt linux-5.4 +Some people may think it is better to pass such work to user space +helper, instead of doing in kernel space. Actually I am still thinking +about it. But currently I have implemented it in kernel space. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/02struct.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/02struct.txt ---- linux-5.4/Documentation/filesystems/aufs/design/02struct.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/02struct.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/02struct.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/02struct.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/02struct.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/02struct.txt 2020-04-10 12:40:52.184049128 +0300 @@ -0,0 +1,245 @@ + -+# Copyright (C) 2005-2019 Junjiro R. Okajima ++# Copyright (C) 2005-2020 Junjiro R. Okajima + +Basic Aufs Internal Structure + @@ -625,12 +625,12 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/02struct.txt linux-5. +- etc. + +For this purpose, use "aumvdown" command in aufs-util.git. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/03atomic_open.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/03atomic_open.txt ---- linux-5.4/Documentation/filesystems/aufs/design/03atomic_open.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/03atomic_open.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/03atomic_open.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/03atomic_open.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/03atomic_open.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/03atomic_open.txt 2020-04-10 12:40:52.184049128 +0300 @@ -0,0 +1,72 @@ + -+# Copyright (C) 2015-2019 Junjiro R. Okajima ++# Copyright (C) 2015-2020 Junjiro R. Okajima + +Support for a branch who has its ->atomic_open() +---------------------------------------------------------------------- @@ -701,12 +701,12 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/03atomic_open.txt lin + ->atomic_open() are lost. in the ordinary case, the checks are + done by VFS:do_last(), lookup_open() and atomic_open(). some can + be implemented in aufs, but not all I am afraid. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/03lookup.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/03lookup.txt ---- linux-5.4/Documentation/filesystems/aufs/design/03lookup.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/03lookup.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/03lookup.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/03lookup.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/03lookup.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/03lookup.txt 2020-04-10 12:40:52.185049175 +0300 @@ -0,0 +1,100 @@ + -+# Copyright (C) 2005-2019 Junjiro R. Okajima ++# Copyright (C) 2005-2020 Junjiro R. Okajima + +Lookup in a Branch +---------------------------------------------------------------------- @@ -805,12 +805,12 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/03lookup.txt linux-5. + test, and skip the revalidation in step 4. It is useful and improves + aufs performance when system surely hide the aufs branches from user, + by over-mounting something (or another method). -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/04branch.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/04branch.txt ---- linux-5.4/Documentation/filesystems/aufs/design/04branch.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/04branch.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/04branch.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/04branch.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/04branch.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/04branch.txt 2020-04-10 12:40:52.185049175 +0300 @@ -0,0 +1,61 @@ + -+# Copyright (C) 2005-2019 Junjiro R. Okajima ++# Copyright (C) 2005-2020 Junjiro R. Okajima + +Branch Manipulation + @@ -870,12 +870,12 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/04branch.txt linux-5. + - a file on the branch is mmap-ed. + - a regular file on the branch is opened for write and there is no + same named entry on the upper branch. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/05wbr_policy.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/05wbr_policy.txt ---- linux-5.4/Documentation/filesystems/aufs/design/05wbr_policy.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/05wbr_policy.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/05wbr_policy.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/05wbr_policy.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/05wbr_policy.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/05wbr_policy.txt 2020-04-10 12:40:52.185049175 +0300 @@ -0,0 +1,51 @@ + -+# Copyright (C) 2005-2019 Junjiro R. Okajima ++# Copyright (C) 2005-2020 Junjiro R. Okajima + +Policies to Select One among Multiple Writable Branches +---------------------------------------------------------------------- @@ -925,9 +925,9 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/05wbr_policy.txt linu + where the source and the target exists and selects the higher + one. If the selected branch is readonly, then aufs follows the + copyup policy. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/06dirren.dot linux-5.4-aufs/Documentation/filesystems/aufs/design/06dirren.dot ---- linux-5.4/Documentation/filesystems/aufs/design/06dirren.dot 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/06dirren.dot 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/06dirren.dot linux-5.6.3-aufs/Documentation/filesystems/aufs/design/06dirren.dot +--- linux-5.6.3/Documentation/filesystems/aufs/design/06dirren.dot 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/06dirren.dot 2020-04-10 12:40:52.185049175 +0300 @@ -0,0 +1,31 @@ + +// to view this graph, run dot(1) command in GRAPHVIZ. @@ -960,12 +960,12 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/06dirren.dot linux-5. + +aufs_lookup -> whinfo [label="load/remove"]; +} -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/06dirren.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/06dirren.txt ---- linux-5.4/Documentation/filesystems/aufs/design/06dirren.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/06dirren.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/06dirren.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/06dirren.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/06dirren.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/06dirren.txt 2020-04-10 12:40:52.185049175 +0300 @@ -0,0 +1,89 @@ + -+# Copyright (C) 2017-2019 Junjiro R. Okajima ++# Copyright (C) 2017-2020 Junjiro R. Okajima + +Special handling for renaming a directory (DIRREN) +---------------------------------------------------------------------- @@ -1053,12 +1053,12 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/06dirren.txt linux-5. +contains two names, before- and after-rename, the name comparision in +UDBA handler may not work correctly. In this case, the behaviour will be +equivalen to udba=reval case. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/06fhsm.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/06fhsm.txt ---- linux-5.4/Documentation/filesystems/aufs/design/06fhsm.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/06fhsm.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/06fhsm.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/06fhsm.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/06fhsm.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/06fhsm.txt 2020-04-10 12:40:52.185049175 +0300 @@ -0,0 +1,105 @@ + -+# Copyright (C) 2011-2019 Junjiro R. Okajima ++# Copyright (C) 2011-2020 Junjiro R. Okajima + +File-based Hierarchical Storage Management (FHSM) +---------------------------------------------------------------------- @@ -1162,12 +1162,12 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/06fhsm.txt linux-5.4- + +And of course, in every step, an error may happen. So the operation +should restore the original file state after an error happens. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/06mmap.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/06mmap.txt ---- linux-5.4/Documentation/filesystems/aufs/design/06mmap.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/06mmap.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/06mmap.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/06mmap.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/06mmap.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/06mmap.txt 2020-04-10 12:40:52.185049175 +0300 @@ -0,0 +1,59 @@ + -+# Copyright (C) 2005-2019 Junjiro R. Okajima ++# Copyright (C) 2005-2020 Junjiro R. Okajima + +mmap(2) -- File Memory Mapping +---------------------------------------------------------------------- @@ -1225,12 +1225,12 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/06mmap.txt linux-5.4- + equivalent to vm_prfile described above. + +I have to give up this "looks-smater" approach. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/06xattr.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/06xattr.txt ---- linux-5.4/Documentation/filesystems/aufs/design/06xattr.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/06xattr.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/06xattr.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/06xattr.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/06xattr.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/06xattr.txt 2020-04-10 12:40:52.185049175 +0300 @@ -0,0 +1,81 @@ + -+# Copyright (C) 2014-2019 Junjiro R. Okajima ++# Copyright (C) 2014-2020 Junjiro R. Okajima + +Listing XATTR/EA and getting the value +---------------------------------------------------------------------- @@ -1310,12 +1310,12 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/06xattr.txt linux-5.4 +Some contradiction may happen I am afraid. +Do we need another attribute to stop copying XATTR? I am unsure. For +now, aufs implements the branch attributes to ignore the error. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/07export.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/07export.txt ---- linux-5.4/Documentation/filesystems/aufs/design/07export.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/07export.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/07export.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/07export.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/07export.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/07export.txt 2020-04-10 12:40:52.185049175 +0300 @@ -0,0 +1,45 @@ + -+# Copyright (C) 2005-2019 Junjiro R. Okajima ++# Copyright (C) 2005-2020 Junjiro R. Okajima + +Export Aufs via NFS +---------------------------------------------------------------------- @@ -1359,12 +1359,12 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/07export.txt linux-5. + convert it into ESTALE for NFSD. +- readdir(): call lockdep_on/off() because filldir in NFSD calls + lookup_one_len(), vfs_getattr(), encode_fh() and others. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/08shwh.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/08shwh.txt ---- linux-5.4/Documentation/filesystems/aufs/design/08shwh.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/08shwh.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/08shwh.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/08shwh.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/08shwh.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/08shwh.txt 2020-04-10 12:40:52.185049175 +0300 @@ -0,0 +1,39 @@ + -+# Copyright (C) 2005-2019 Junjiro R. Okajima ++# Copyright (C) 2005-2020 Junjiro R. Okajima + +Show Whiteout Mode (shwh) +---------------------------------------------------------------------- @@ -1402,12 +1402,12 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/08shwh.txt linux-5.4- + +This new squashfs archive can be stored on the boot device and the +initramfs will use it to replace the old one at the next boot. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/10dynop.txt linux-5.4-aufs/Documentation/filesystems/aufs/design/10dynop.txt ---- linux-5.4/Documentation/filesystems/aufs/design/10dynop.txt 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/design/10dynop.txt 2019-11-28 01:25:59.060925618 +0200 +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/design/10dynop.txt linux-5.6.3-aufs/Documentation/filesystems/aufs/design/10dynop.txt +--- linux-5.6.3/Documentation/filesystems/aufs/design/10dynop.txt 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/design/10dynop.txt 2020-04-10 12:40:52.185049175 +0300 @@ -0,0 +1,34 @@ + -+# Copyright (C) 2010-2019 Junjiro R. Okajima ++# Copyright (C) 2010-2020 Junjiro R. Okajima + +Dynamically customizable FS operations +---------------------------------------------------------------------- @@ -1440,10 +1440,10 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/design/10dynop.txt linux-5.4 +XIP (DAX) mainly. +Currently this approach is applied to address_space_operations for +regular files only. -diff -Nurp linux-5.4/Documentation/filesystems/aufs/README linux-5.4-aufs/Documentation/filesystems/aufs/README ---- linux-5.4/Documentation/filesystems/aufs/README 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/Documentation/filesystems/aufs/README 2019-11-28 01:25:59.060925618 +0200 -@@ -0,0 +1,399 @@ +diff -Nurp linux-5.6.3/Documentation/filesystems/aufs/README linux-5.6.3-aufs/Documentation/filesystems/aufs/README +--- linux-5.6.3/Documentation/filesystems/aufs/README 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/Documentation/filesystems/aufs/README 2020-04-10 12:40:52.184049128 +0300 +@@ -0,0 +1,401 @@ + +Aufs5 -- advanced multi layered unification filesystem version 5.x +http://aufs.sf.net @@ -1718,7 +1718,8 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/README linux-5.4-aufs/Docume + the internal locks for LOCKDEP is necessary. LOCKDEP is a debugging + feature of linux kernel. If you enable CONFIG_LOCKDEP, then you will + need to apply this debug patch to expand several constant values. -+ If don't know what LOCKDEP is, then you don't have apply this patch. ++ If you don't know what LOCKDEP is, then you don't have apply this ++ patch. + + +4. Usage @@ -1768,6 +1769,7 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/README linux-5.4-aufs/Docume + system, instead of the date you downloaded. +- configuration (define/undefine CONFIG_AUFS_xxx) +- kernel configuration or /proc/config.gz (if you have it) ++- LSM (linux security module, if you are using) +- behaviour which you think to be incorrect +- actual operation, reproducible one is better +- mailto: aufs-users at lists.sourceforge.net @@ -1843,10 +1845,10 @@ diff -Nurp linux-5.4/Documentation/filesystems/aufs/README linux-5.4-aufs/Docume +# Local variables: ; +# mode: text; +# End: ; -diff -Nurp linux-5.4/drivers/block/loop.c linux-5.4-aufs/drivers/block/loop.c ---- linux-5.4/drivers/block/loop.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/drivers/block/loop.c 2019-11-28 01:25:59.062925618 +0200 -@@ -738,6 +738,24 @@ out_err: +diff -Nurp linux-5.6.3/drivers/block/loop.c linux-5.6.3-aufs/drivers/block/loop.c +--- linux-5.6.3/drivers/block/loop.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/drivers/block/loop.c 2020-04-10 12:40:52.187049268 +0300 +@@ -750,6 +750,24 @@ out_err: return error; } @@ -1871,13 +1873,13 @@ diff -Nurp linux-5.4/drivers/block/loop.c linux-5.4-aufs/drivers/block/loop.c /* loop sysfs attributes */ static ssize_t loop_attr_show(struct device *dev, char *page, -diff -Nurp linux-5.4/fs/aufs/aufs.h linux-5.4-aufs/fs/aufs/aufs.h ---- linux-5.4/fs/aufs/aufs.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/aufs.h 2019-11-28 01:25:59.062925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/aufs.h linux-5.6.3-aufs/fs/aufs/aufs.h +--- linux-5.6.3/fs/aufs/aufs.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/aufs.h 2020-04-10 12:40:52.187049268 +0300 @@ -0,0 +1,49 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -1924,13 +1926,13 @@ diff -Nurp linux-5.4/fs/aufs/aufs.h linux-5.4-aufs/fs/aufs/aufs.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_H__ */ -diff -Nurp linux-5.4/fs/aufs/branch.c linux-5.4-aufs/fs/aufs/branch.c ---- linux-5.4/fs/aufs/branch.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/branch.c 2019-11-28 01:25:59.062925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/branch.c linux-5.6.3-aufs/fs/aufs/branch.c +--- linux-5.6.3/fs/aufs/branch.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/branch.c 2020-04-10 12:40:52.188049315 +0300 @@ -0,0 +1,1415 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -3343,13 +3345,13 @@ diff -Nurp linux-5.4/fs/aufs/branch.c linux-5.4-aufs/fs/aufs/branch.c + + return err; +} -diff -Nurp linux-5.4/fs/aufs/branch.h linux-5.4-aufs/fs/aufs/branch.h ---- linux-5.4/fs/aufs/branch.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/branch.h 2019-11-28 01:25:59.062925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/branch.h linux-5.6.3-aufs/fs/aufs/branch.h +--- linux-5.6.3/fs/aufs/branch.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/branch.h 2020-04-10 12:40:52.188049315 +0300 @@ -0,0 +1,353 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -3700,13 +3702,13 @@ diff -Nurp linux-5.4/fs/aufs/branch.h linux-5.4-aufs/fs/aufs/branch.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_BRANCH_H__ */ -diff -Nurp linux-5.4/fs/aufs/cpup.c linux-5.4-aufs/fs/aufs/cpup.c ---- linux-5.4/fs/aufs/cpup.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/cpup.c 2019-11-28 01:25:59.063925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/cpup.c linux-5.6.3-aufs/fs/aufs/cpup.c +--- linux-5.6.3/fs/aufs/cpup.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/cpup.c 2020-04-10 12:40:52.188049315 +0300 @@ -0,0 +1,1445 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -5149,13 +5151,13 @@ diff -Nurp linux-5.4/fs/aufs/cpup.c linux-5.4-aufs/fs/aufs/cpup.c + dput(parent); + return err; +} -diff -Nurp linux-5.4/fs/aufs/cpup.h linux-5.4-aufs/fs/aufs/cpup.h ---- linux-5.4/fs/aufs/cpup.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/cpup.h 2019-11-28 01:25:59.063925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/cpup.h linux-5.6.3-aufs/fs/aufs/cpup.h +--- linux-5.6.3/fs/aufs/cpup.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/cpup.h 2020-04-10 12:40:52.188049315 +0300 @@ -0,0 +1,87 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -5240,13 +5242,13 @@ diff -Nurp linux-5.4/fs/aufs/cpup.h linux-5.4-aufs/fs/aufs/cpup.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_CPUP_H__ */ -diff -Nurp linux-5.4/fs/aufs/dbgaufs.c linux-5.4-aufs/fs/aufs/dbgaufs.c ---- linux-5.4/fs/aufs/dbgaufs.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dbgaufs.c 2019-11-28 01:25:59.063925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dbgaufs.c linux-5.6.3-aufs/fs/aufs/dbgaufs.c +--- linux-5.6.3/fs/aufs/dbgaufs.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dbgaufs.c 2020-04-10 12:40:52.188049315 +0300 @@ -0,0 +1,513 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -5757,13 +5759,13 @@ diff -Nurp linux-5.4/fs/aufs/dbgaufs.c linux-5.4-aufs/fs/aufs/dbgaufs.c + err = 0; + return err; +} -diff -Nurp linux-5.4/fs/aufs/dbgaufs.h linux-5.4-aufs/fs/aufs/dbgaufs.h ---- linux-5.4/fs/aufs/dbgaufs.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dbgaufs.h 2019-11-28 01:25:59.063925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dbgaufs.h linux-5.6.3-aufs/fs/aufs/dbgaufs.h +--- linux-5.6.3/fs/aufs/dbgaufs.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dbgaufs.h 2020-04-10 12:40:52.188049315 +0300 @@ -0,0 +1,40 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -5801,13 +5803,13 @@ diff -Nurp linux-5.4/fs/aufs/dbgaufs.h linux-5.4-aufs/fs/aufs/dbgaufs.h + +#endif /* __KERNEL__ */ +#endif /* __DBGAUFS_H__ */ -diff -Nurp linux-5.4/fs/aufs/dcsub.c linux-5.4-aufs/fs/aufs/dcsub.c ---- linux-5.4/fs/aufs/dcsub.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dcsub.c 2019-11-28 01:25:59.063925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dcsub.c linux-5.6.3-aufs/fs/aufs/dcsub.c +--- linux-5.6.3/fs/aufs/dcsub.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dcsub.c 2020-04-10 12:40:52.189049362 +0300 @@ -0,0 +1,212 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -6017,13 +6019,13 @@ diff -Nurp linux-5.4/fs/aufs/dcsub.c linux-5.4-aufs/fs/aufs/dcsub.c + + return path_is_under(path + 0, path + 1); +} -diff -Nurp linux-5.4/fs/aufs/dcsub.h linux-5.4-aufs/fs/aufs/dcsub.h ---- linux-5.4/fs/aufs/dcsub.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dcsub.h 2019-11-28 01:25:59.063925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dcsub.h linux-5.6.3-aufs/fs/aufs/dcsub.h +--- linux-5.6.3/fs/aufs/dcsub.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dcsub.h 2020-04-10 12:40:52.189049362 +0300 @@ -0,0 +1,124 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -6145,13 +6147,13 @@ diff -Nurp linux-5.4/fs/aufs/dcsub.h linux-5.4-aufs/fs/aufs/dcsub.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_DCSUB_H__ */ -diff -Nurp linux-5.4/fs/aufs/debug.c linux-5.4-aufs/fs/aufs/debug.c ---- linux-5.4/fs/aufs/debug.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/debug.c 2019-11-28 01:25:59.063925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/debug.c linux-5.6.3-aufs/fs/aufs/debug.c +--- linux-5.6.3/fs/aufs/debug.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/debug.c 2020-04-10 12:40:52.189049362 +0300 @@ -0,0 +1,428 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -6577,13 +6579,13 @@ diff -Nurp linux-5.4/fs/aufs/debug.c linux-5.4-aufs/fs/aufs/debug.c + + return 0; +} -diff -Nurp linux-5.4/fs/aufs/debug.h linux-5.4-aufs/fs/aufs/debug.h ---- linux-5.4/fs/aufs/debug.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/debug.h 2019-11-28 01:25:59.063925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/debug.h linux-5.6.3-aufs/fs/aufs/debug.h +--- linux-5.6.3/fs/aufs/debug.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/debug.h 2020-04-10 12:40:52.189049362 +0300 @@ -0,0 +1,213 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -6794,13 +6796,13 @@ diff -Nurp linux-5.4/fs/aufs/debug.h linux-5.4-aufs/fs/aufs/debug.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_DEBUG_H__ */ -diff -Nurp linux-5.4/fs/aufs/dentry.c linux-5.4-aufs/fs/aufs/dentry.c ---- linux-5.4/fs/aufs/dentry.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dentry.c 2019-11-28 01:25:59.063925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dentry.c linux-5.6.3-aufs/fs/aufs/dentry.c +--- linux-5.6.3/fs/aufs/dentry.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dentry.c 2020-04-10 12:40:52.189049362 +0300 @@ -0,0 +1,1141 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -7939,13 +7941,13 @@ diff -Nurp linux-5.4/fs/aufs/dentry.c linux-5.4-aufs/fs/aufs/dentry.c +const struct dentry_operations aufs_dop_noreval = { + .d_release = aufs_d_release +}; -diff -Nurp linux-5.4/fs/aufs/dentry.h linux-5.4-aufs/fs/aufs/dentry.h ---- linux-5.4/fs/aufs/dentry.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dentry.h 2019-11-28 01:25:59.063925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dentry.h linux-5.6.3-aufs/fs/aufs/dentry.h +--- linux-5.6.3/fs/aufs/dentry.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dentry.h 2020-04-10 12:40:52.189049362 +0300 @@ -0,0 +1,255 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -8198,13 +8200,13 @@ diff -Nurp linux-5.4/fs/aufs/dentry.h linux-5.4-aufs/fs/aufs/dentry.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_DENTRY_H__ */ -diff -Nurp linux-5.4/fs/aufs/dinfo.c linux-5.4-aufs/fs/aufs/dinfo.c ---- linux-5.4/fs/aufs/dinfo.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dinfo.c 2019-11-28 01:25:59.063925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dinfo.c linux-5.6.3-aufs/fs/aufs/dinfo.c +--- linux-5.6.3/fs/aufs/dinfo.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dinfo.c 2020-04-10 12:40:52.189049362 +0300 @@ -0,0 +1,541 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -8743,13 +8745,13 @@ diff -Nurp linux-5.4/fs/aufs/dinfo.c linux-5.4-aufs/fs/aufs/dinfo.c + return bindex; + return -1; +} -diff -Nurp linux-5.4/fs/aufs/dir.c linux-5.4-aufs/fs/aufs/dir.c ---- linux-5.4/fs/aufs/dir.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dir.c 2019-11-28 01:25:59.064925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dir.c linux-5.6.3-aufs/fs/aufs/dir.c +--- linux-5.6.3/fs/aufs/dir.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dir.c 2020-04-10 12:40:52.189049362 +0300 @@ -0,0 +1,750 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -9497,13 +9499,13 @@ diff -Nurp linux-5.4/fs/aufs/dir.c linux-5.4-aufs/fs/aufs/dir.c + .flush = aufs_flush_dir, + .fsync = aufs_fsync_dir +}; -diff -Nurp linux-5.4/fs/aufs/dir.h linux-5.4-aufs/fs/aufs/dir.h ---- linux-5.4/fs/aufs/dir.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dir.h 2019-11-28 01:25:59.064925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dir.h linux-5.6.3-aufs/fs/aufs/dir.h +--- linux-5.6.3/fs/aufs/dir.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dir.h 2020-04-10 12:40:52.189049362 +0300 @@ -0,0 +1,121 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -9622,13 +9624,13 @@ diff -Nurp linux-5.4/fs/aufs/dir.h linux-5.4-aufs/fs/aufs/dir.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_DIR_H__ */ -diff -Nurp linux-5.4/fs/aufs/dirren.c linux-5.4-aufs/fs/aufs/dirren.c ---- linux-5.4/fs/aufs/dirren.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dirren.c 2019-11-28 01:25:59.064925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dirren.c linux-5.6.3-aufs/fs/aufs/dirren.c +--- linux-5.6.3/fs/aufs/dirren.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dirren.c 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,1303 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2017-2019 Junjiro R. Okajima ++ * Copyright (C) 2017-2020 Junjiro R. Okajima + */ + +/* @@ -9696,7 +9698,7 @@ diff -Nurp linux-5.4/fs/aufs/dirren.c linux-5.4-aufs/fs/aufs/dirren.c + found = 0; + idx = au_dr_ihash(ino); + hbl = dr->dr_h_ino + idx; -+#if 0 ++#if 0 /* debug print */ + { + struct hlist_bl_node *tmp; + @@ -10830,8 +10832,8 @@ diff -Nurp linux-5.4/fs/aufs/dirren.c linux-5.4-aufs/fs/aufs/dirren.c + err = 0; + if (!lkup->dirren.drinfo) + goto out; -+ AuDebugOn(lkup->dirren.ninfo < btgt + 1); -+ drinfo = lkup->dirren.drinfo[btgt + 1]; ++ AuDebugOn(lkup->dirren.ninfo <= btgt); ++ drinfo = lkup->dirren.drinfo[btgt]; + if (!drinfo) + goto out; + @@ -10860,8 +10862,8 @@ diff -Nurp linux-5.4/fs/aufs/dirren.c linux-5.4-aufs/fs/aufs/dirren.c + match = 1; + if (!lkup->dirren.drinfo) + goto out; -+ AuDebugOn(lkup->dirren.ninfo < bindex + 1); -+ drinfo = lkup->dirren.drinfo[bindex + 1]; ++ AuDebugOn(lkup->dirren.ninfo <= bindex); ++ drinfo = lkup->dirren.drinfo[bindex]; + if (!drinfo) + goto out; + @@ -10929,13 +10931,13 @@ diff -Nurp linux-5.4/fs/aufs/dirren.c linux-5.4-aufs/fs/aufs/dirren.c +out: + return err; +} -diff -Nurp linux-5.4/fs/aufs/dirren.h linux-5.4-aufs/fs/aufs/dirren.h ---- linux-5.4/fs/aufs/dirren.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dirren.h 2019-11-28 01:25:59.064925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dirren.h linux-5.6.3-aufs/fs/aufs/dirren.h +--- linux-5.6.3/fs/aufs/dirren.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dirren.h 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,127 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2017-2019 Junjiro R. Okajima ++ * Copyright (C) 2017-2020 Junjiro R. Okajima + */ + +/* @@ -11060,13 +11062,13 @@ diff -Nurp linux-5.4/fs/aufs/dirren.h linux-5.4-aufs/fs/aufs/dirren.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_DIRREN_H__ */ -diff -Nurp linux-5.4/fs/aufs/dynop.c linux-5.4-aufs/fs/aufs/dynop.c ---- linux-5.4/fs/aufs/dynop.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dynop.c 2019-11-28 01:25:59.064925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dynop.c linux-5.6.3-aufs/fs/aufs/dynop.c +--- linux-5.6.3/fs/aufs/dynop.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dynop.c 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,354 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2010-2019 Junjiro R. Okajima ++ * Copyright (C) 2010-2020 Junjiro R. Okajima + */ + +/* @@ -11418,13 +11420,13 @@ diff -Nurp linux-5.4/fs/aufs/dynop.c linux-5.4-aufs/fs/aufs/dynop.c + for (i = 0; i < AuDyLast; i++) + WARN_ON(!hlist_bl_empty(dynop + i)); +} -diff -Nurp linux-5.4/fs/aufs/dynop.h linux-5.4-aufs/fs/aufs/dynop.h ---- linux-5.4/fs/aufs/dynop.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/dynop.h 2019-11-28 01:25:59.064925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/dynop.h linux-5.6.3-aufs/fs/aufs/dynop.h +--- linux-5.6.3/fs/aufs/dynop.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/dynop.h 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,64 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2010-2019 Junjiro R. Okajima ++ * Copyright (C) 2010-2020 Junjiro R. Okajima + */ + +/* @@ -11486,13 +11488,13 @@ diff -Nurp linux-5.4/fs/aufs/dynop.h linux-5.4-aufs/fs/aufs/dynop.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_DYNOP_H__ */ -diff -Nurp linux-5.4/fs/aufs/export.c linux-5.4-aufs/fs/aufs/export.c ---- linux-5.4/fs/aufs/export.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/export.c 2019-11-28 01:25:59.064925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/export.c linux-5.6.3-aufs/fs/aufs/export.c +--- linux-5.6.3/fs/aufs/export.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/export.c 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,825 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -12315,13 +12317,13 @@ diff -Nurp linux-5.4/fs/aufs/export.c linux-5.4-aufs/fs/aufs/export.c + BUILD_BUG_ON(sizeof(u) != sizeof(int)); + atomic_set(&sbinfo->si_xigen_next, u); +} -diff -Nurp linux-5.4/fs/aufs/fhsm.c linux-5.4-aufs/fs/aufs/fhsm.c ---- linux-5.4/fs/aufs/fhsm.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/fhsm.c 2019-11-28 01:25:59.064925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/fhsm.c linux-5.6.3-aufs/fs/aufs/fhsm.c +--- linux-5.6.3/fs/aufs/fhsm.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/fhsm.c 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,413 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2011-2019 Junjiro R. Okajima ++ * Copyright (C) 2011-2020 Junjiro R. Okajima + */ + +/* @@ -12732,13 +12734,13 @@ diff -Nurp linux-5.4/fs/aufs/fhsm.c linux-5.4-aufs/fs/aufs/fhsm.c + if (u != AUFS_FHSM_CACHE_DEF_SEC) + seq_printf(seq, ",fhsm_sec=%u", u); +} -diff -Nurp linux-5.4/fs/aufs/file.c linux-5.4-aufs/fs/aufs/file.c ---- linux-5.4/fs/aufs/file.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/file.c 2019-11-28 01:25:59.065925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/file.c linux-5.6.3-aufs/fs/aufs/file.c +--- linux-5.6.3/fs/aufs/file.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/file.c 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,850 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -13586,13 +13588,13 @@ diff -Nurp linux-5.4/fs/aufs/file.c linux-5.4-aufs/fs/aufs/file.c + .swap_deactivate = aufs_swap_deactivate +#endif /* CONFIG_AUFS_DEBUG */ +}; -diff -Nurp linux-5.4/fs/aufs/file.h linux-5.4-aufs/fs/aufs/file.h ---- linux-5.4/fs/aufs/file.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/file.h 2019-11-28 01:25:59.065925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/file.h linux-5.6.3-aufs/fs/aufs/file.h +--- linux-5.6.3/fs/aufs/file.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/file.h 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,329 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -13919,13 +13921,13 @@ diff -Nurp linux-5.4/fs/aufs/file.h linux-5.4-aufs/fs/aufs/file.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_FILE_H__ */ -diff -Nurp linux-5.4/fs/aufs/finfo.c linux-5.4-aufs/fs/aufs/finfo.c ---- linux-5.4/fs/aufs/finfo.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/finfo.c 2019-11-28 01:25:59.065925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/finfo.c linux-5.6.3-aufs/fs/aufs/finfo.c +--- linux-5.6.3/fs/aufs/finfo.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/finfo.c 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,136 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -14059,13 +14061,13 @@ diff -Nurp linux-5.4/fs/aufs/finfo.c linux-5.4-aufs/fs/aufs/finfo.c +out: + return err; +} -diff -Nurp linux-5.4/fs/aufs/f_op.c linux-5.4-aufs/fs/aufs/f_op.c ---- linux-5.4/fs/aufs/f_op.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/f_op.c 2019-11-28 01:25:59.064925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/f_op.c linux-5.6.3-aufs/fs/aufs/f_op.c +--- linux-5.6.3/fs/aufs/f_op.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/f_op.c 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,806 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -14382,7 +14384,7 @@ diff -Nurp linux-5.4/fs/aufs/f_op.c linux-5.4-aufs/fs/aufs/f_op.c + if (unlikely(err)) + goto out; + -+ err = -ENOSYS; ++ err = -ENOSYS; /* the branch doesn't have its ->(read|write)_iter() */ + iter = NULL; + if (rw == MAY_READ) + iter = h_file->f_op->read_iter; @@ -14826,7 +14828,7 @@ diff -Nurp linux-5.4/fs/aufs/f_op.c linux-5.4-aufs/fs/aufs/f_op.c +/* ---------------------------------------------------------------------- */ + +/* no one supports this operation, currently */ -+#if 0 ++#if 0 /* reserved for future use */ +static ssize_t aufs_sendpage(struct file *file, struct page *page, int offset, + size_t len, loff_t *pos, int more) +{ @@ -14862,20 +14864,20 @@ diff -Nurp linux-5.4/fs/aufs/f_op.c linux-5.4-aufs/fs/aufs/f_op.c + .setfl = aufs_setfl, + .splice_write = aufs_splice_write, + .splice_read = aufs_splice_read, -+#if 0 ++#if 0 /* reserved for future use */ + .aio_splice_write = aufs_aio_splice_write, + .aio_splice_read = aufs_aio_splice_read, +#endif + .fallocate = aufs_fallocate, + .copy_file_range = aufs_copy_file_range +}; -diff -Nurp linux-5.4/fs/aufs/fstype.h linux-5.4-aufs/fs/aufs/fstype.h ---- linux-5.4/fs/aufs/fstype.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/fstype.h 2019-11-28 01:25:59.065925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/fstype.h linux-5.6.3-aufs/fs/aufs/fstype.h +--- linux-5.6.3/fs/aufs/fstype.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/fstype.h 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,388 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -15261,13 +15263,13 @@ diff -Nurp linux-5.4/fs/aufs/fstype.h linux-5.4-aufs/fs/aufs/fstype.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_FSTYPE_H__ */ -diff -Nurp linux-5.4/fs/aufs/hbl.h linux-5.4-aufs/fs/aufs/hbl.h ---- linux-5.4/fs/aufs/hbl.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/hbl.h 2019-11-28 01:25:59.065925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/hbl.h linux-5.6.3-aufs/fs/aufs/hbl.h +--- linux-5.6.3/fs/aufs/hbl.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/hbl.h 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,52 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2017-2019 Junjiro R. Okajima ++ * Copyright (C) 2017-2020 Junjiro R. Okajima + */ + +/* @@ -15317,13 +15319,13 @@ diff -Nurp linux-5.4/fs/aufs/hbl.h linux-5.4-aufs/fs/aufs/hbl.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_HBL_H__ */ -diff -Nurp linux-5.4/fs/aufs/hfsnotify.c linux-5.4-aufs/fs/aufs/hfsnotify.c ---- linux-5.4/fs/aufs/hfsnotify.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/hfsnotify.c 2019-11-28 01:25:59.065925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/hfsnotify.c linux-5.6.3-aufs/fs/aufs/hfsnotify.c +--- linux-5.6.3/fs/aufs/hfsnotify.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/hfsnotify.c 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,275 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -15596,13 +15598,13 @@ diff -Nurp linux-5.4/fs/aufs/hfsnotify.c linux-5.4-aufs/fs/aufs/hfsnotify.c + .fin_br = au_hfsn_fin_br, + .init_br = au_hfsn_init_br +}; -diff -Nurp linux-5.4/fs/aufs/hfsplus.c linux-5.4-aufs/fs/aufs/hfsplus.c ---- linux-5.4/fs/aufs/hfsplus.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/hfsplus.c 2019-11-28 01:25:59.065925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/hfsplus.c linux-5.6.3-aufs/fs/aufs/hfsplus.c +--- linux-5.6.3/fs/aufs/hfsplus.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/hfsplus.c 2020-04-10 12:40:52.190049409 +0300 @@ -0,0 +1,47 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2010-2019 Junjiro R. Okajima ++ * Copyright (C) 2010-2020 Junjiro R. Okajima + */ + +/* @@ -15647,13 +15649,13 @@ diff -Nurp linux-5.4/fs/aufs/hfsplus.c linux-5.4-aufs/fs/aufs/hfsplus.c + au_lcnt_dec(&br->br_nfiles); + } +} -diff -Nurp linux-5.4/fs/aufs/hnotify.c linux-5.4-aufs/fs/aufs/hnotify.c ---- linux-5.4/fs/aufs/hnotify.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/hnotify.c 2019-11-28 01:25:59.065925618 +0200 -@@ -0,0 +1,708 @@ +diff -Nurp linux-5.6.3/fs/aufs/hnotify.c linux-5.6.3-aufs/fs/aufs/hnotify.c +--- linux-5.6.3/fs/aufs/hnotify.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/hnotify.c 2020-04-10 12:40:52.190049409 +0300 +@@ -0,0 +1,702 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -15822,12 +15824,6 @@ diff -Nurp linux-5.4/fs/aufs/hnotify.c linux-5.4-aufs/fs/aufs/hnotify.c + +out_dpages: + au_dpages_free(&dpages); -+ -+#if 0 -+ /* discard children */ -+ dentry_unhash(dentry); -+ dput(dentry); -+#endif +out: + return err; +} @@ -16359,13 +16355,13 @@ diff -Nurp linux-5.4/fs/aufs/hnotify.c linux-5.4-aufs/fs/aufs/hnotify.c + if (au_cache[AuCache_HNOTIFY]) + au_hn_destroy_cache(); +} -diff -Nurp linux-5.4/fs/aufs/iinfo.c linux-5.4-aufs/fs/aufs/iinfo.c ---- linux-5.4/fs/aufs/iinfo.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/iinfo.c 2019-11-28 01:25:59.066925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/iinfo.c linux-5.6.3-aufs/fs/aufs/iinfo.c +--- linux-5.6.3/fs/aufs/iinfo.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/iinfo.c 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,273 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -16636,13 +16632,13 @@ diff -Nurp linux-5.4/fs/aufs/iinfo.c linux-5.4-aufs/fs/aufs/iinfo.c + au_kfree_rcu(iinfo->ii_hinode); + AuRwDestroy(&iinfo->ii_rwsem); +} -diff -Nurp linux-5.4/fs/aufs/inode.c linux-5.4-aufs/fs/aufs/inode.c ---- linux-5.4/fs/aufs/inode.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/inode.c 2019-11-28 01:25:59.066925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/inode.c linux-5.6.3-aufs/fs/aufs/inode.c +--- linux-5.6.3/fs/aufs/inode.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/inode.c 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,516 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -16841,7 +16837,7 @@ diff -Nurp linux-5.4/fs/aufs/inode.c linux-5.4-aufs/fs/aufs/inode.c + struct dentry *h_dentry; + struct inode *h_inode; + struct au_iinfo *iinfo; -+ struct inode_operations *iop; ++ const struct inode_operations *iop; + + IiMustWriteLock(inode); + @@ -17156,13 +17152,13 @@ diff -Nurp linux-5.4/fs/aufs/inode.c linux-5.4-aufs/fs/aufs/inode.c + mask |= MAY_READ; /* force permission check */ + return au_test_h_perm(h_inode, mask); +} -diff -Nurp linux-5.4/fs/aufs/inode.h linux-5.4-aufs/fs/aufs/inode.h ---- linux-5.4/fs/aufs/inode.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/inode.h 2019-11-28 01:25:59.066925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/inode.h linux-5.6.3-aufs/fs/aufs/inode.h +--- linux-5.6.3/fs/aufs/inode.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/inode.h 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,685 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -17306,7 +17302,7 @@ diff -Nurp linux-5.4/fs/aufs/inode.h linux-5.4-aufs/fs/aufs/inode.h + AuIop_OTHER, + AuIop_Last +}; -+extern struct inode_operations aufs_iop[AuIop_Last], ++extern struct inode_operations aufs_iop[AuIop_Last], /* not const */ + aufs_iop_nogetattr[AuIop_Last]; + +/* au_wr_dir flags */ @@ -17845,13 +17841,13 @@ diff -Nurp linux-5.4/fs/aufs/inode.h linux-5.4-aufs/fs/aufs/inode.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_INODE_H__ */ -diff -Nurp linux-5.4/fs/aufs/ioctl.c linux-5.4-aufs/fs/aufs/ioctl.c ---- linux-5.4/fs/aufs/ioctl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/ioctl.c 2019-11-28 01:25:59.066925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/ioctl.c linux-5.6.3-aufs/fs/aufs/ioctl.c +--- linux-5.6.3/fs/aufs/ioctl.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/ioctl.c 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,207 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -18056,13 +18052,13 @@ diff -Nurp linux-5.4/fs/aufs/ioctl.c linux-5.4-aufs/fs/aufs/ioctl.c + return aufs_ioctl_nondir(file, cmd, (unsigned long)compat_ptr(arg)); +} +#endif -diff -Nurp linux-5.4/fs/aufs/i_op_add.c linux-5.4-aufs/fs/aufs/i_op_add.c ---- linux-5.4/fs/aufs/i_op_add.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/i_op_add.c 2019-11-28 01:25:59.065925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/i_op_add.c linux-5.6.3-aufs/fs/aufs/i_op_add.c +--- linux-5.6.3/fs/aufs/i_op_add.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/i_op_add.c 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,923 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -18983,13 +18979,13 @@ diff -Nurp linux-5.4/fs/aufs/i_op_add.c linux-5.4-aufs/fs/aufs/i_op_add.c +out: + return err; +} -diff -Nurp linux-5.4/fs/aufs/i_op.c linux-5.4-aufs/fs/aufs/i_op.c ---- linux-5.4/fs/aufs/i_op.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/i_op.c 2019-11-28 01:25:59.065925618 +0200 -@@ -0,0 +1,1492 @@ +diff -Nurp linux-5.6.3/fs/aufs/i_op.c linux-5.6.3-aufs/fs/aufs/i_op.c +--- linux-5.6.3/fs/aufs/i_op.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/i_op.c 2020-04-10 12:40:52.191049456 +0300 +@@ -0,0 +1,1485 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -19048,19 +19044,6 @@ diff -Nurp linux-5.4/fs/aufs/i_op.c linux-5.4-aufs/fs/aufs/i_op.c + if (!err) + err = security_inode_permission(h_inode, mask); + -+#if 0 -+ if (!err) { -+ /* todo: do we need to call ima_path_check()? */ -+ struct path h_path = { -+ .dentry = -+ .mnt = h_mnt -+ }; -+ err = ima_path_check(&h_path, -+ mask & (MAY_READ | MAY_WRITE | MAY_EXEC), -+ IMA_COUNT_LEAVE); -+ } -+#endif -+ +out: + return err; +} @@ -19082,7 +19065,13 @@ diff -Nurp linux-5.4/fs/aufs/i_op.c linux-5.4-aufs/fs/aufs/i_op.c + sb = inode->i_sb; + si_read_lock(sb, AuLock_FLUSH); + ii_read_lock_child(inode); -+#if 0 ++#if 0 /* reserved for future use */ ++ /* ++ * This test may be rather 'too much' since the test is essentially done ++ * in the aufs_lookup(). Theoretically it is possible that the inode ++ * generation doesn't match to the superblock's here. But it isn't a ++ * big deal I suppose. ++ */ + err = au_iigen_test(inode, au_sigen(sb)); + if (unlikely(err)) + goto out; @@ -19200,7 +19189,7 @@ diff -Nurp linux-5.4/fs/aufs/i_op.c linux-5.4-aufs/fs/aufs/i_op.c + if (inode) + atomic_inc(&inode->i_count); + ret = d_splice_alias(inode, dentry); -+#if 0 ++#if 0 /* reserved for future use */ + if (unlikely(d_need_lookup(dentry))) { + spin_lock(&dentry->d_lock); + dentry->d_flags &= ~DCACHE_NEED_LOOKUP; @@ -19632,7 +19621,7 @@ diff -Nurp linux-5.4/fs/aufs/i_op.c linux-5.4-aufs/fs/aufs/i_op.c +{ + if (p->hdir) { + au_pin_hdir_set_owner(p, p->task); -+ rwsem_release(&p->hdir->hi_inode->i_rwsem.dep_map, 1, _RET_IP_); ++ rwsem_release(&p->hdir->hi_inode->i_rwsem.dep_map, _RET_IP_); + } +} + @@ -20479,13 +20468,13 @@ diff -Nurp linux-5.4/fs/aufs/i_op.c linux-5.4-aufs/fs/aufs/i_op.c + .update_time = aufs_update_time + } +}; -diff -Nurp linux-5.4/fs/aufs/i_op_del.c linux-5.4-aufs/fs/aufs/i_op_del.c ---- linux-5.4/fs/aufs/i_op_del.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/i_op_del.c 2019-11-28 01:25:59.066925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/i_op_del.c linux-5.6.3-aufs/fs/aufs/i_op_del.c +--- linux-5.6.3/fs/aufs/i_op_del.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/i_op_del.c 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,500 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -20983,13 +20972,13 @@ diff -Nurp linux-5.4/fs/aufs/i_op_del.c linux-5.4-aufs/fs/aufs/i_op_del.c + AuTraceErr(err); + return err; +} -diff -Nurp linux-5.4/fs/aufs/i_op_ren.c linux-5.4-aufs/fs/aufs/i_op_ren.c ---- linux-5.4/fs/aufs/i_op_ren.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/i_op_ren.c 2019-11-28 01:25:59.066925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/i_op_ren.c linux-5.6.3-aufs/fs/aufs/i_op_ren.c +--- linux-5.6.3/fs/aufs/i_op_ren.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/i_op_ren.c 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,1237 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -21391,7 +21380,7 @@ diff -Nurp linux-5.4/fs/aufs/i_op_ren.c linux-5.4-aufs/fs/aufs/i_op_ren.c + } + + BUG_ON(d_is_positive(a->dst_h_dentry) && a->src_btop != a->btgt); -+#if 0 ++#if 0 /* debugging */ + BUG_ON(!au_ftest_ren(a->auren_flags, DIRREN) + && d_is_positive(a->dst_h_dentry) + && a->src_btop != a->btgt); @@ -22224,9 +22213,9 @@ diff -Nurp linux-5.4/fs/aufs/i_op_ren.c linux-5.4-aufs/fs/aufs/i_op_ren.c + AuTraceErr(err); + return err; +} -diff -Nurp linux-5.4/fs/aufs/Kconfig linux-5.4-aufs/fs/aufs/Kconfig ---- linux-5.4/fs/aufs/Kconfig 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/Kconfig 2019-11-28 01:25:59.062925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/Kconfig linux-5.6.3-aufs/fs/aufs/Kconfig +--- linux-5.6.3/fs/aufs/Kconfig 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/Kconfig 2020-04-10 12:40:52.187049268 +0300 @@ -0,0 +1,199 @@ +# SPDX-License-Identifier: GPL-2.0 +config AUFS_FS @@ -22427,13 +22416,13 @@ diff -Nurp linux-5.4/fs/aufs/Kconfig linux-5.4-aufs/fs/aufs/Kconfig + Automatic configuration for internal use. + When aufs supports Magic SysRq, enabled automatically. +endif -diff -Nurp linux-5.4/fs/aufs/lcnt.h linux-5.4-aufs/fs/aufs/lcnt.h ---- linux-5.4/fs/aufs/lcnt.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/lcnt.h 2019-11-28 01:25:59.066925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/lcnt.h linux-5.6.3-aufs/fs/aufs/lcnt.h +--- linux-5.6.3/fs/aufs/lcnt.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/lcnt.h 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,173 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2018-2019 Junjiro R. Okajima ++ * Copyright (C) 2018-2020 Junjiro R. Okajima + */ + +/* @@ -22604,13 +22593,13 @@ diff -Nurp linux-5.4/fs/aufs/lcnt.h linux-5.4-aufs/fs/aufs/lcnt.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_LCNT_H__ */ -diff -Nurp linux-5.4/fs/aufs/loop.c linux-5.4-aufs/fs/aufs/loop.c ---- linux-5.4/fs/aufs/loop.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/loop.c 2019-11-28 01:25:59.066925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/loop.c linux-5.6.3-aufs/fs/aufs/loop.c +--- linux-5.6.3/fs/aufs/loop.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/loop.c 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,135 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -22743,13 +22732,13 @@ diff -Nurp linux-5.4/fs/aufs/loop.c linux-5.4-aufs/fs/aufs/loop.c + symbol_put(loop_backing_file); + au_kfree_try_rcu(au_warn_loopback_array); +} -diff -Nurp linux-5.4/fs/aufs/loop.h linux-5.4-aufs/fs/aufs/loop.h ---- linux-5.4/fs/aufs/loop.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/loop.h 2019-11-28 01:25:59.066925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/loop.h linux-5.6.3-aufs/fs/aufs/loop.h +--- linux-5.6.3/fs/aufs/loop.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/loop.h 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,42 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -22789,9 +22778,9 @@ diff -Nurp linux-5.4/fs/aufs/loop.h linux-5.4-aufs/fs/aufs/loop.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_LOOP_H__ */ -diff -Nurp linux-5.4/fs/aufs/magic.mk linux-5.4-aufs/fs/aufs/magic.mk ---- linux-5.4/fs/aufs/magic.mk 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/magic.mk 2019-11-28 01:25:59.066925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/magic.mk linux-5.6.3-aufs/fs/aufs/magic.mk +--- linux-5.6.3/fs/aufs/magic.mk 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/magic.mk 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,31 @@ +# SPDX-License-Identifier: GPL-2.0 + @@ -22824,9 +22813,9 @@ diff -Nurp linux-5.4/fs/aufs/magic.mk linux-5.4-aufs/fs/aufs/magic.mk +ifdef CONFIG_HFSPLUS_FS +ccflags-y += -DHFSPLUS_SUPER_MAGIC=0x482b +endif -diff -Nurp linux-5.4/fs/aufs/Makefile linux-5.4-aufs/fs/aufs/Makefile ---- linux-5.4/fs/aufs/Makefile 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/Makefile 2019-11-28 01:25:59.062925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/Makefile linux-5.6.3-aufs/fs/aufs/Makefile +--- linux-5.6.3/fs/aufs/Makefile 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/Makefile 2020-04-10 12:40:52.187049268 +0300 @@ -0,0 +1,39 @@ +# SPDX-License-Identifier: GPL-2.0 + @@ -22867,13 +22856,13 @@ diff -Nurp linux-5.4/fs/aufs/Makefile linux-5.4-aufs/fs/aufs/Makefile +aufs-$(CONFIG_AUFS_BR_HFSPLUS) += hfsplus.o +aufs-$(CONFIG_AUFS_DEBUG) += debug.o +aufs-$(CONFIG_AUFS_MAGIC_SYSRQ) += sysrq.o -diff -Nurp linux-5.4/fs/aufs/module.c linux-5.4-aufs/fs/aufs/module.c ---- linux-5.4/fs/aufs/module.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/module.c 2019-11-28 01:25:59.066925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/module.c linux-5.6.3-aufs/fs/aufs/module.c +--- linux-5.6.3/fs/aufs/module.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/module.c 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,259 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -23130,13 +23119,13 @@ diff -Nurp linux-5.4/fs/aufs/module.c linux-5.4-aufs/fs/aufs/module.c + +module_init(aufs_init); +module_exit(aufs_exit); -diff -Nurp linux-5.4/fs/aufs/module.h linux-5.4-aufs/fs/aufs/module.h ---- linux-5.4/fs/aufs/module.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/module.h 2019-11-28 01:25:59.066925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/module.h linux-5.6.3-aufs/fs/aufs/module.h +--- linux-5.6.3/fs/aufs/module.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/module.h 2020-04-10 12:40:52.191049456 +0300 @@ -0,0 +1,153 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -23287,13 +23276,13 @@ diff -Nurp linux-5.4/fs/aufs/module.h linux-5.4-aufs/fs/aufs/module.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_MODULE_H__ */ -diff -Nurp linux-5.4/fs/aufs/mvdown.c linux-5.4-aufs/fs/aufs/mvdown.c ---- linux-5.4/fs/aufs/mvdown.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/mvdown.c 2019-11-28 01:25:59.067925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/mvdown.c linux-5.6.3-aufs/fs/aufs/mvdown.c +--- linux-5.6.3/fs/aufs/mvdown.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/mvdown.c 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,693 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2011-2019 Junjiro R. Okajima ++ * Copyright (C) 2011-2020 Junjiro R. Okajima + */ + +/* @@ -23984,13 +23973,13 @@ diff -Nurp linux-5.4/fs/aufs/mvdown.c linux-5.4-aufs/fs/aufs/mvdown.c + AuTraceErr(err); + return err; +} -diff -Nurp linux-5.4/fs/aufs/opts.c linux-5.4-aufs/fs/aufs/opts.c ---- linux-5.4/fs/aufs/opts.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/opts.c 2019-11-28 01:25:59.067925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/opts.c linux-5.6.3-aufs/fs/aufs/opts.c +--- linux-5.6.3/fs/aufs/opts.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/opts.c 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,1867 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -25604,7 +25593,7 @@ diff -Nurp linux-5.4/fs/aufs/opts.c linux-5.4-aufs/fs/aufs/opts.c + if ((br->br_perm & AuBrAttr_ICEX) + && !h_dir->i_op->listxattr) + br->br_perm &= ~AuBrAttr_ICEX; -+#if 0 ++#if 0 /* untested */ + if ((br->br_perm & AuBrAttr_ICEX_SEC) + && (au_br_sb(br)->s_flags & SB_NOSEC)) + br->br_perm &= ~AuBrAttr_ICEX_SEC; @@ -25855,13 +25844,13 @@ diff -Nurp linux-5.4/fs/aufs/opts.c linux-5.4-aufs/fs/aufs/opts.c +{ + return au_mntflags(sb) & AuOptMask_UDBA; +} -diff -Nurp linux-5.4/fs/aufs/opts.h linux-5.4-aufs/fs/aufs/opts.h ---- linux-5.4/fs/aufs/opts.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/opts.h 2019-11-28 01:25:59.067925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/opts.h linux-5.6.3-aufs/fs/aufs/opts.h +--- linux-5.6.3/fs/aufs/opts.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/opts.h 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,212 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -26071,13 +26060,13 @@ diff -Nurp linux-5.4/fs/aufs/opts.h linux-5.4-aufs/fs/aufs/opts.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_OPTS_H__ */ -diff -Nurp linux-5.4/fs/aufs/plink.c linux-5.4-aufs/fs/aufs/plink.c ---- linux-5.4/fs/aufs/plink.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/plink.c 2019-11-28 01:25:59.067925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/plink.c linux-5.6.3-aufs/fs/aufs/plink.c +--- linux-5.6.3/fs/aufs/plink.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/plink.c 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,503 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -26578,13 +26567,13 @@ diff -Nurp linux-5.4/fs/aufs/plink.c linux-5.4-aufs/fs/aufs/plink.c + } + } +} -diff -Nurp linux-5.4/fs/aufs/poll.c linux-5.4-aufs/fs/aufs/poll.c ---- linux-5.4/fs/aufs/poll.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/poll.c 2019-11-28 01:25:59.067925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/poll.c linux-5.6.3-aufs/fs/aufs/poll.c +--- linux-5.6.3/fs/aufs/poll.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/poll.c 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,38 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -26620,13 +26609,13 @@ diff -Nurp linux-5.4/fs/aufs/poll.c linux-5.4-aufs/fs/aufs/poll.c + AuDbg("mask 0x%x\n", mask); + return mask; +} -diff -Nurp linux-5.4/fs/aufs/posix_acl.c linux-5.4-aufs/fs/aufs/posix_acl.c ---- linux-5.4/fs/aufs/posix_acl.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/posix_acl.c 2019-11-28 01:25:59.067925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/posix_acl.c linux-5.6.3-aufs/fs/aufs/posix_acl.c +--- linux-5.6.3/fs/aufs/posix_acl.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/posix_acl.c 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,92 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2014-2019 Junjiro R. Okajima ++ * Copyright (C) 2014-2020 Junjiro R. Okajima + */ + +/* @@ -26716,13 +26705,13 @@ diff -Nurp linux-5.4/fs/aufs/posix_acl.c linux-5.4-aufs/fs/aufs/posix_acl.c +out: + return err; +} -diff -Nurp linux-5.4/fs/aufs/procfs.c linux-5.4-aufs/fs/aufs/procfs.c ---- linux-5.4/fs/aufs/procfs.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/procfs.c 2019-11-28 01:25:59.067925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/procfs.c linux-5.6.3-aufs/fs/aufs/procfs.c +--- linux-5.6.3/fs/aufs/procfs.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/procfs.c 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,158 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2010-2019 Junjiro R. Okajima ++ * Copyright (C) 2010-2020 Junjiro R. Okajima + */ + +/* @@ -26878,13 +26867,13 @@ diff -Nurp linux-5.4/fs/aufs/procfs.c linux-5.4-aufs/fs/aufs/procfs.c +out: + return err; +} -diff -Nurp linux-5.4/fs/aufs/rdu.c linux-5.4-aufs/fs/aufs/rdu.c ---- linux-5.4/fs/aufs/rdu.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/rdu.c 2019-11-28 01:25:59.067925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/rdu.c linux-5.6.3-aufs/fs/aufs/rdu.c +--- linux-5.6.3/fs/aufs/rdu.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/rdu.c 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,371 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -27253,13 +27242,13 @@ diff -Nurp linux-5.4/fs/aufs/rdu.c linux-5.4-aufs/fs/aufs/rdu.c + return err; +} +#endif -diff -Nurp linux-5.4/fs/aufs/rwsem.h linux-5.4-aufs/fs/aufs/rwsem.h ---- linux-5.4/fs/aufs/rwsem.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/rwsem.h 2019-11-28 01:25:59.067925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/rwsem.h linux-5.6.3-aufs/fs/aufs/rwsem.h +--- linux-5.6.3/fs/aufs/rwsem.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/rwsem.h 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,60 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -27317,13 +27306,13 @@ diff -Nurp linux-5.4/fs/aufs/rwsem.h linux-5.4-aufs/fs/aufs/rwsem.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_RWSEM_H__ */ -diff -Nurp linux-5.4/fs/aufs/sbinfo.c linux-5.4-aufs/fs/aufs/sbinfo.c ---- linux-5.4/fs/aufs/sbinfo.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/sbinfo.c 2019-11-28 01:25:59.067925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/sbinfo.c linux-5.6.3-aufs/fs/aufs/sbinfo.c +--- linux-5.6.3/fs/aufs/sbinfo.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/sbinfo.c 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,301 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -27622,13 +27611,13 @@ diff -Nurp linux-5.4/fs/aufs/sbinfo.c linux-5.4-aufs/fs/aufs/sbinfo.c + di_write_unlock2(d1, d2); + si_read_unlock(d1->d_sb); +} -diff -Nurp linux-5.4/fs/aufs/super.c linux-5.4-aufs/fs/aufs/super.c ---- linux-5.4/fs/aufs/super.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/super.c 2019-11-28 01:25:59.067925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/super.c linux-5.6.3-aufs/fs/aufs/super.c +--- linux-5.6.3/fs/aufs/super.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/super.c 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,1034 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -27861,7 +27850,7 @@ diff -Nurp linux-5.4/fs/aufs/super.c linux-5.4-aufs/fs/aufs/super.c + sb = dentry->d_sb; + if (sb->s_flags & SB_POSIXACL) + seq_puts(m, ",acl"); -+#if 0 ++#if 0 /* reserved for future use */ + if (sb->s_flags & SB_I_VERSION) + seq_puts(m, ",i_version"); +#endif @@ -28660,13 +28649,13 @@ diff -Nurp linux-5.4/fs/aufs/super.c linux-5.4-aufs/fs/aufs/super.c + /* no need to __module_get() and module_put(). */ + .owner = THIS_MODULE, +}; -diff -Nurp linux-5.4/fs/aufs/super.h linux-5.4-aufs/fs/aufs/super.h ---- linux-5.4/fs/aufs/super.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/super.h 2019-11-28 01:25:59.068925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/super.h linux-5.6.3-aufs/fs/aufs/super.h +--- linux-5.6.3/fs/aufs/super.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/super.h 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,576 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -28832,7 +28821,7 @@ diff -Nurp linux-5.4/fs/aufs/super.h linux-5.4-aufs/fs/aufs/super.h + struct hlist_bl_head si_files; + + /* with/without getattr, brother of sb->s_d_op */ -+ struct inode_operations *si_iop_array; ++ const struct inode_operations *si_iop_array; + + /* + * sysfs and lifetime management. @@ -29240,13 +29229,13 @@ diff -Nurp linux-5.4/fs/aufs/super.h linux-5.4-aufs/fs/aufs/super.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_SUPER_H__ */ -diff -Nurp linux-5.4/fs/aufs/sysaufs.c linux-5.4-aufs/fs/aufs/sysaufs.c ---- linux-5.4/fs/aufs/sysaufs.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/sysaufs.c 2019-11-28 01:25:59.068925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/sysaufs.c linux-5.6.3-aufs/fs/aufs/sysaufs.c +--- linux-5.6.3/fs/aufs/sysaufs.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/sysaufs.c 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,80 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -29324,13 +29313,13 @@ diff -Nurp linux-5.4/fs/aufs/sysaufs.c linux-5.4-aufs/fs/aufs/sysaufs.c +out: + return err; +} -diff -Nurp linux-5.4/fs/aufs/sysaufs.h linux-5.4-aufs/fs/aufs/sysaufs.h ---- linux-5.4/fs/aufs/sysaufs.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/sysaufs.h 2019-11-28 01:25:59.068925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/sysaufs.h linux-5.6.3-aufs/fs/aufs/sysaufs.h +--- linux-5.6.3/fs/aufs/sysaufs.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/sysaufs.h 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,89 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -29417,13 +29406,13 @@ diff -Nurp linux-5.4/fs/aufs/sysaufs.h linux-5.4-aufs/fs/aufs/sysaufs.h + +#endif /* __KERNEL__ */ +#endif /* __SYSAUFS_H__ */ -diff -Nurp linux-5.4/fs/aufs/sysfs.c linux-5.4-aufs/fs/aufs/sysfs.c ---- linux-5.4/fs/aufs/sysfs.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/sysfs.c 2019-11-28 01:25:59.068925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/sysfs.c linux-5.6.3-aufs/fs/aufs/sysfs.c +--- linux-5.6.3/fs/aufs/sysfs.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/sysfs.c 2020-04-10 12:40:52.192049502 +0300 @@ -0,0 +1,338 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -29759,13 +29748,13 @@ diff -Nurp linux-5.4/fs/aufs/sysfs.c linux-5.4-aufs/fs/aufs/sysfs.c + } + } +} -diff -Nurp linux-5.4/fs/aufs/sysrq.c linux-5.4-aufs/fs/aufs/sysrq.c ---- linux-5.4/fs/aufs/sysrq.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/sysrq.c 2019-11-28 01:25:59.068925618 +0200 -@@ -0,0 +1,147 @@ +diff -Nurp linux-5.6.3/fs/aufs/sysrq.c linux-5.6.3-aufs/fs/aufs/sysrq.c +--- linux-5.6.3/fs/aufs/sysrq.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/sysrq.c 2020-04-10 12:40:52.192049502 +0300 +@@ -0,0 +1,136 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -29786,6 +29775,7 @@ diff -Nurp linux-5.4/fs/aufs/sysrq.c linux-5.4-aufs/fs/aufs/sysrq.c + struct hlist_bl_head *files; + struct hlist_bl_node *pos; + struct au_finfo *finfo; ++ struct inode *i; + + plevel = au_plevel; + au_plevel = KERN_WARNING; @@ -29798,14 +29788,7 @@ diff -Nurp linux-5.4/fs/aufs/sysrq.c linux-5.4-aufs/fs/aufs/sysrq.c + pr("superblock\n"); + au_dpri_sb(sb); + -+#if 0 -+ pr("root dentry\n"); -+ au_dpri_dentry(sb->s_root); -+ pr("root inode\n"); -+ au_dpri_inode(d_inode(sb->s_root)); -+#endif -+ -+#if 0 ++#if 0 /* reserved */ + do { + int err, i, j, ndentry; + struct au_dcsub_pages dpages; @@ -29826,21 +29809,16 @@ diff -Nurp linux-5.4/fs/aufs/sysrq.c linux-5.4-aufs/fs/aufs/sysrq.c + } while (0); +#endif + -+#if 1 -+ { -+ struct inode *i; -+ -+ pr("isolated inode\n"); -+ spin_lock(&sb->s_inode_list_lock); -+ list_for_each_entry(i, &sb->s_inodes, i_sb_list) { -+ spin_lock(&i->i_lock); -+ if (1 || hlist_empty(&i->i_dentry)) -+ au_dpri_inode(i); -+ spin_unlock(&i->i_lock); -+ } -+ spin_unlock(&sb->s_inode_list_lock); ++ pr("isolated inode\n"); ++ spin_lock(&sb->s_inode_list_lock); ++ list_for_each_entry(i, &sb->s_inodes, i_sb_list) { ++ spin_lock(&i->i_lock); ++ if (hlist_empty(&i->i_dentry)) ++ au_dpri_inode(i); ++ spin_unlock(&i->i_lock); + } -+#endif ++ spin_unlock(&sb->s_inode_list_lock); ++ + pr("files\n"); + files = &au_sbi(sb)->si_files; + hlist_bl_lock(files); @@ -29910,13 +29888,13 @@ diff -Nurp linux-5.4/fs/aufs/sysrq.c linux-5.4-aufs/fs/aufs/sysrq.c + if (unlikely(err)) + pr_err("err %d (ignored)\n", err); +} -diff -Nurp linux-5.4/fs/aufs/wbr_policy.c linux-5.4-aufs/fs/aufs/wbr_policy.c ---- linux-5.4/fs/aufs/wbr_policy.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/wbr_policy.c 2019-11-28 01:25:59.068925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/wbr_policy.c linux-5.6.3-aufs/fs/aufs/wbr_policy.c +--- linux-5.6.3/fs/aufs/wbr_policy.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/wbr_policy.c 2020-04-10 12:40:52.193049549 +0300 @@ -0,0 +1,817 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -30731,13 +30709,13 @@ diff -Nurp linux-5.4/fs/aufs/wbr_policy.c linux-5.4-aufs/fs/aufs/wbr_policy.c + .fin = au_wbr_create_fin_mfs + } +}; -diff -Nurp linux-5.4/fs/aufs/vdir.c linux-5.4-aufs/fs/aufs/vdir.c ---- linux-5.4/fs/aufs/vdir.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/vdir.c 2019-11-28 01:25:59.068925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/vdir.c linux-5.6.3-aufs/fs/aufs/vdir.c +--- linux-5.6.3/fs/aufs/vdir.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/vdir.c 2020-04-10 12:40:52.193049549 +0300 @@ -0,0 +1,883 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -30819,7 +30797,7 @@ diff -Nurp linux-5.4/fs/aufs/vdir.c linux-5.4-aufs/fs/aufs/vdir.c + +static void nhash_count(struct hlist_head *head) +{ -+#if 0 ++#if 0 /* debugging */ + unsigned long n; + struct hlist_node *pos; + @@ -31618,13 +31596,13 @@ diff -Nurp linux-5.4/fs/aufs/vdir.c linux-5.4-aufs/fs/aufs/vdir.c + /* smp_mb(); */ + return 0; +} -diff -Nurp linux-5.4/fs/aufs/vfsub.c linux-5.4-aufs/fs/aufs/vfsub.c ---- linux-5.4/fs/aufs/vfsub.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/vfsub.c 2019-11-28 01:25:59.068925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/vfsub.c linux-5.6.3-aufs/fs/aufs/vfsub.c +--- linux-5.6.3/fs/aufs/vfsub.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/vfsub.c 2020-04-10 12:40:52.193049549 +0300 @@ -0,0 +1,889 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -32511,13 +32489,13 @@ diff -Nurp linux-5.4/fs/aufs/vfsub.c linux-5.4-aufs/fs/aufs/vfsub.c + + return err; +} -diff -Nurp linux-5.4/fs/aufs/vfsub.h linux-5.4-aufs/fs/aufs/vfsub.h ---- linux-5.4/fs/aufs/vfsub.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/vfsub.h 2019-11-28 01:25:59.068925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/vfsub.h linux-5.6.3-aufs/fs/aufs/vfsub.h +--- linux-5.6.3/fs/aufs/vfsub.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/vfsub.h 2020-04-10 12:40:52.193049549 +0300 @@ -0,0 +1,341 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -32856,13 +32834,13 @@ diff -Nurp linux-5.4/fs/aufs/vfsub.h linux-5.4-aufs/fs/aufs/vfsub.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_VFSUB_H__ */ -diff -Nurp linux-5.4/fs/aufs/whout.c linux-5.4-aufs/fs/aufs/whout.c ---- linux-5.4/fs/aufs/whout.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/whout.c 2019-11-28 01:25:59.069925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/whout.c linux-5.6.3-aufs/fs/aufs/whout.c +--- linux-5.6.3/fs/aufs/whout.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/whout.c 2020-04-10 12:40:52.193049549 +0300 @@ -0,0 +1,1049 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -33154,7 +33132,7 @@ diff -Nurp linux-5.4/fs/aufs/whout.c linux-5.4-aufs/fs/aufs/whout.c + + pr_err("%pd (%s) doesn't support link(2), use noplink and rw+nolwh\n", + h_root, au_sbtype(h_root->d_sb)); -+ return -ENOSYS; ++ return -ENOSYS; /* the branch doesn't have its ->link() */ +} + +/* todo: should this mkdir be done in /sbin/mount.aufs helper? */ @@ -33909,13 +33887,13 @@ diff -Nurp linux-5.4/fs/aufs/whout.c linux-5.4-aufs/fs/aufs/whout.c + au_whtmp_rmdir_free(args); + } +} -diff -Nurp linux-5.4/fs/aufs/whout.h linux-5.4-aufs/fs/aufs/whout.h ---- linux-5.4/fs/aufs/whout.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/whout.h 2019-11-28 01:25:59.069925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/whout.h linux-5.6.3-aufs/fs/aufs/whout.h +--- linux-5.6.3/fs/aufs/whout.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/whout.h 2020-04-10 12:40:52.193049549 +0300 @@ -0,0 +1,73 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -33986,13 +33964,13 @@ diff -Nurp linux-5.4/fs/aufs/whout.h linux-5.4-aufs/fs/aufs/whout.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_WHOUT_H__ */ -diff -Nurp linux-5.4/fs/aufs/wkq.c linux-5.4-aufs/fs/aufs/wkq.c ---- linux-5.4/fs/aufs/wkq.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/wkq.c 2019-11-28 01:25:59.069925618 +0200 -@@ -0,0 +1,379 @@ +diff -Nurp linux-5.6.3/fs/aufs/wkq.c linux-5.6.3-aufs/fs/aufs/wkq.c +--- linux-5.6.3/fs/aufs/wkq.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/wkq.c 2020-04-10 12:40:52.193049549 +0300 +@@ -0,0 +1,359 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -34132,8 +34110,8 @@ diff -Nurp linux-5.4/fs/aufs/wkq.c linux-5.4-aufs/fs/aufs/wkq.c + goto out; + + err = 0; -+#if 0 -+ if (0 && au_debug_test()) /* left for debugging */ ++#if 0 /* left for debugging */ ++ if (0 && au_debug_test()) + lockdep_print_held_locks(curr); +#endif + held_locks = curr->held_locks; @@ -34184,7 +34162,7 @@ diff -Nurp linux-5.4/fs/aufs/wkq.c linux-5.4-aufs/fs/aufs/wkq.c + if (!hl) + return; + while ((p = *hl++)) /* assignment */ -+ rwsem_release(p->instance, 0, /*p->acquire_ip*/_RET_IP_); ++ rwsem_release(p->instance, /*p->acquire_ip*/_RET_IP_); +} +#endif + @@ -34210,7 +34188,6 @@ diff -Nurp linux-5.4/fs/aufs/wkq.c linux-5.4-aufs/fs/aufs/wkq.c +/* + * Since struct completion is large, try allocating it dynamically. + */ -+#if 1 /* defined(CONFIG_4KSTACKS) || defined(AuTest4KSTACKS) */ +#define AuWkqCompDeclare(name) struct completion *comp = NULL + +static int au_wkq_comp_alloc(struct au_wkinfo *wkinfo, struct completion **comp) @@ -34229,25 +34206,6 @@ diff -Nurp linux-5.4/fs/aufs/wkq.c linux-5.4-aufs/fs/aufs/wkq.c + au_kfree_rcu(comp); +} + -+#else -+ -+/* no braces */ -+#define AuWkqCompDeclare(name) \ -+ DECLARE_COMPLETION_ONSTACK(_ ## name); \ -+ struct completion *comp = &_ ## name -+ -+static int au_wkq_comp_alloc(struct au_wkinfo *wkinfo, struct completion **comp) -+{ -+ wkinfo->comp = *comp; -+ return 0; -+} -+ -+static void au_wkq_comp_free(struct completion *comp __maybe_unused) -+{ -+ /* empty */ -+} -+#endif /* 4KSTACKS */ -+ +static void au_wkq_run(struct au_wkinfo *wkinfo) +{ + if (au_ftest_wkq(wkinfo->flags, NEST)) { @@ -34369,13 +34327,13 @@ diff -Nurp linux-5.4/fs/aufs/wkq.c linux-5.4-aufs/fs/aufs/wkq.c + + return err; +} -diff -Nurp linux-5.4/fs/aufs/wkq.h linux-5.4-aufs/fs/aufs/wkq.h ---- linux-5.4/fs/aufs/wkq.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/wkq.h 2019-11-28 01:25:59.069925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/wkq.h linux-5.6.3-aufs/fs/aufs/wkq.h +--- linux-5.6.3/fs/aufs/wkq.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/wkq.h 2020-04-10 12:40:52.193049549 +0300 @@ -0,0 +1,76 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -34449,13 +34407,13 @@ diff -Nurp linux-5.4/fs/aufs/wkq.h linux-5.4-aufs/fs/aufs/wkq.h + +#endif /* __KERNEL__ */ +#endif /* __AUFS_WKQ_H__ */ -diff -Nurp linux-5.4/fs/aufs/xattr.c linux-5.4-aufs/fs/aufs/xattr.c ---- linux-5.4/fs/aufs/xattr.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/xattr.c 2019-11-28 01:25:59.069925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/xattr.c linux-5.6.3-aufs/fs/aufs/xattr.c +--- linux-5.6.3/fs/aufs/xattr.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/xattr.c 2020-04-10 12:40:52.193049549 +0300 @@ -0,0 +1,343 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2014-2019 Junjiro R. Okajima ++ * Copyright (C) 2014-2020 Junjiro R. Okajima + */ + +/* @@ -34796,13 +34754,13 @@ diff -Nurp linux-5.4/fs/aufs/xattr.c linux-5.4-aufs/fs/aufs/xattr.c +{ + sb->s_xattr = au_xattr_handlers; +} -diff -Nurp linux-5.4/fs/aufs/xino.c linux-5.4-aufs/fs/aufs/xino.c ---- linux-5.4/fs/aufs/xino.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/fs/aufs/xino.c 2019-11-28 01:25:59.069925618 +0200 +diff -Nurp linux-5.6.3/fs/aufs/xino.c linux-5.6.3-aufs/fs/aufs/xino.c +--- linux-5.6.3/fs/aufs/xino.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/fs/aufs/xino.c 2020-04-10 12:40:52.193049549 +0300 @@ -0,0 +1,1952 @@ +// SPDX-License-Identifier: GPL-2.0 +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +/* @@ -36144,7 +36102,7 @@ diff -Nurp linux-5.4/fs/aufs/xino.c linux-5.4-aufs/fs/aufs/xino.c + if (unlikely(ul)) { + pr_warn("xi_writing %lu\n", ul); + hlist_bl_lock(hbl); -+ hlist_bl_for_each_entry_safe (p, pos, n, hbl, node) { ++ hlist_bl_for_each_entry_safe(p, pos, n, hbl, node) { + hlist_bl_del(&p->node); + au_kfree_rcu(p); + } @@ -36752,10 +36710,10 @@ diff -Nurp linux-5.4/fs/aufs/xino.c linux-5.4-aufs/fs/aufs/xino.c +out: + return err; +} -diff -Nurp linux-5.4/fs/dcache.c linux-5.4-aufs/fs/dcache.c ---- linux-5.4/fs/dcache.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/dcache.c 2019-11-28 01:25:59.069925618 +0200 -@@ -1264,7 +1264,7 @@ enum d_walk_ret { +diff -Nurp linux-5.6.3/fs/dcache.c linux-5.6.3-aufs/fs/dcache.c +--- linux-5.6.3/fs/dcache.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/dcache.c 2020-04-10 12:40:52.194049596 +0300 +@@ -1266,7 +1266,7 @@ enum d_walk_ret { * * The @enter() callbacks are called with d_lock held. */ @@ -36764,15 +36722,15 @@ diff -Nurp linux-5.4/fs/dcache.c linux-5.4-aufs/fs/dcache.c enum d_walk_ret (*enter)(void *, struct dentry *)) { struct dentry *this_parent; -diff -Nurp linux-5.4/fs/fcntl.c linux-5.4-aufs/fs/fcntl.c ---- linux-5.4/fs/fcntl.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/fcntl.c 2019-11-28 01:25:59.069925618 +0200 +diff -Nurp linux-5.6.3/fs/fcntl.c linux-5.6.3-aufs/fs/fcntl.c +--- linux-5.6.3/fs/fcntl.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/fcntl.c 2020-04-10 12:40:52.194049596 +0300 @@ -32,7 +32,7 @@ #define SETFL_MASK (O_APPEND | O_NONBLOCK | O_NDELAY | O_DIRECT | O_NOATIME) -static int setfl(int fd, struct file * filp, unsigned long arg) -+int setfl(int fd, struct file * filp, unsigned long arg) ++int setfl(int fd, struct file *filp, unsigned long arg) { struct inode * inode = file_inode(filp); int error = 0; @@ -36785,22 +36743,22 @@ diff -Nurp linux-5.4/fs/fcntl.c linux-5.4-aufs/fs/fcntl.c if (error) return error; -diff -Nurp linux-5.4/fs/inode.c linux-5.4-aufs/fs/inode.c ---- linux-5.4/fs/inode.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/inode.c 2019-11-28 01:25:59.070925617 +0200 -@@ -1673,7 +1673,7 @@ EXPORT_SYMBOL(generic_update_time); +diff -Nurp linux-5.6.3/fs/inode.c linux-5.6.3-aufs/fs/inode.c +--- linux-5.6.3/fs/inode.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/inode.c 2020-04-10 12:40:52.194049596 +0300 +@@ -1688,7 +1688,7 @@ EXPORT_SYMBOL(generic_update_time); * This does the actual work of updating an inodes time or version. Must have * had called mnt_want_write() before calling this. */ -static int update_time(struct inode *inode, struct timespec64 *time, int flags) +int update_time(struct inode *inode, struct timespec64 *time, int flags) { - int (*update_time)(struct inode *, struct timespec64 *, int); - -diff -Nurp linux-5.4/fs/Kconfig linux-5.4-aufs/fs/Kconfig ---- linux-5.4/fs/Kconfig 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/Kconfig 2019-11-28 01:33:04.893908639 +0200 -@@ -121,6 +121,7 @@ source "fs/quota/Kconfig" + if (inode->i_op->update_time) + return inode->i_op->update_time(inode, time, flags); +diff -Nurp linux-5.6.3/fs/Kconfig linux-5.6.3-aufs/fs/Kconfig +--- linux-5.6.3/fs/Kconfig 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/Kconfig 2020-04-10 13:14:44.904937004 +0300 +@@ -122,6 +122,7 @@ source "fs/quota/Kconfig" source "fs/autofs/Kconfig" source "fs/fuse/Kconfig" source "fs/overlayfs/Kconfig" @@ -36808,20 +36766,20 @@ diff -Nurp linux-5.4/fs/Kconfig linux-5.4-aufs/fs/Kconfig menu "Caches" -diff -Nurp linux-5.4/fs/Makefile linux-5.4-aufs/fs/Makefile ---- linux-5.4/fs/Makefile 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/Makefile 2019-11-28 01:34:16.881905768 +0200 -@@ -110,6 +110,7 @@ obj-$(CONFIG_AUTOFS_FS) += autofs/ +diff -Nurp linux-5.6.3/fs/Makefile linux-5.6.3-aufs/fs/Makefile +--- linux-5.6.3/fs/Makefile 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/Makefile 2020-04-10 13:13:53.450534347 +0300 +@@ -111,6 +111,7 @@ obj-$(CONFIG_AUTOFS_FS) += autofs/ obj-$(CONFIG_ADFS_FS) += adfs/ obj-$(CONFIG_FUSE_FS) += fuse/ obj-$(CONFIG_OVERLAY_FS) += overlayfs/ -+obj-$(CONFIG_AUFS_FS) += aufs/ ++obj-$(CONFIG_AUFS_FS) += aufs/ obj-$(CONFIG_ORANGEFS_FS) += orangefs/ obj-$(CONFIG_UDF_FS) += udf/ obj-$(CONFIG_SUN_OPENPROMFS) += openpromfs/ -diff -Nurp linux-5.4/fs/namespace.c linux-5.4-aufs/fs/namespace.c ---- linux-5.4/fs/namespace.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/namespace.c 2019-11-28 01:25:59.070925617 +0200 +diff -Nurp linux-5.6.3/fs/namespace.c linux-5.6.3-aufs/fs/namespace.c +--- linux-5.6.3/fs/namespace.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/namespace.c 2020-04-10 12:40:52.194049596 +0300 @@ -776,6 +776,12 @@ static inline int check_mnt(struct mount return mnt->mnt_ns == current->nsproxy->mnt_ns; } @@ -36835,10 +36793,10 @@ diff -Nurp linux-5.4/fs/namespace.c linux-5.4-aufs/fs/namespace.c /* * vfsmount lock must be held for write */ -diff -Nurp linux-5.4/fs/proc/base.c linux-5.4-aufs/fs/proc/base.c ---- linux-5.4/fs/proc/base.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/proc/base.c 2019-11-28 01:25:59.070925617 +0200 -@@ -2037,7 +2037,7 @@ static int map_files_get_link(struct den +diff -Nurp linux-5.6.3/fs/proc/base.c linux-5.6.3-aufs/fs/proc/base.c +--- linux-5.6.3/fs/proc/base.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/proc/base.c 2020-04-10 12:40:52.194049596 +0300 +@@ -2128,7 +2128,7 @@ static int map_files_get_link(struct den rc = -ENOENT; vma = find_exact_vma(mm, vm_start, vm_end); if (vma && vma->vm_file) { @@ -36847,9 +36805,9 @@ diff -Nurp linux-5.4/fs/proc/base.c linux-5.4-aufs/fs/proc/base.c path_get(path); rc = 0; } -diff -Nurp linux-5.4/fs/proc/nommu.c linux-5.4-aufs/fs/proc/nommu.c ---- linux-5.4/fs/proc/nommu.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/proc/nommu.c 2019-11-28 01:25:59.070925617 +0200 +diff -Nurp linux-5.6.3/fs/proc/nommu.c linux-5.6.3-aufs/fs/proc/nommu.c +--- linux-5.6.3/fs/proc/nommu.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/proc/nommu.c 2020-04-10 12:40:52.194049596 +0300 @@ -41,7 +41,10 @@ static int nommu_region_show(struct seq_ file = region->vm_file; @@ -36862,9 +36820,9 @@ diff -Nurp linux-5.4/fs/proc/nommu.c linux-5.4-aufs/fs/proc/nommu.c dev = inode->i_sb->s_dev; ino = inode->i_ino; } -diff -Nurp linux-5.4/fs/proc/task_mmu.c linux-5.4-aufs/fs/proc/task_mmu.c ---- linux-5.4/fs/proc/task_mmu.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/proc/task_mmu.c 2019-11-28 01:25:59.070925617 +0200 +diff -Nurp linux-5.6.3/fs/proc/task_mmu.c linux-5.6.3-aufs/fs/proc/task_mmu.c +--- linux-5.6.3/fs/proc/task_mmu.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/proc/task_mmu.c 2020-04-10 12:40:52.194049596 +0300 @@ -309,7 +309,10 @@ show_map_vma(struct seq_file *m, struct const char *name = NULL; @@ -36886,9 +36844,9 @@ diff -Nurp linux-5.4/fs/proc/task_mmu.c linux-5.4-aufs/fs/proc/task_mmu.c struct mm_struct *mm = vma->vm_mm; struct mempolicy *pol; char buffer[64]; -diff -Nurp linux-5.4/fs/proc/task_nommu.c linux-5.4-aufs/fs/proc/task_nommu.c ---- linux-5.4/fs/proc/task_nommu.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/proc/task_nommu.c 2019-11-28 01:25:59.070925617 +0200 +diff -Nurp linux-5.6.3/fs/proc/task_nommu.c linux-5.6.3-aufs/fs/proc/task_nommu.c +--- linux-5.6.3/fs/proc/task_nommu.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/proc/task_nommu.c 2020-04-10 12:40:52.194049596 +0300 @@ -155,7 +155,10 @@ static int nommu_vma_show(struct seq_fil file = vma->vm_file; @@ -36901,9 +36859,9 @@ diff -Nurp linux-5.4/fs/proc/task_nommu.c linux-5.4-aufs/fs/proc/task_nommu.c dev = inode->i_sb->s_dev; ino = inode->i_ino; pgoff = (loff_t)vma->vm_pgoff << PAGE_SHIFT; -diff -Nurp linux-5.4/fs/read_write.c linux-5.4-aufs/fs/read_write.c ---- linux-5.4/fs/read_write.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/read_write.c 2019-11-28 01:25:59.070925617 +0200 +diff -Nurp linux-5.6.3/fs/read_write.c linux-5.6.3-aufs/fs/read_write.c +--- linux-5.6.3/fs/read_write.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/read_write.c 2020-04-10 12:40:52.194049596 +0300 @@ -498,6 +498,28 @@ static ssize_t __vfs_write(struct file * return -EINVAL; } @@ -36916,7 +36874,7 @@ diff -Nurp linux-5.4/fs/read_write.c linux-5.4-aufs/fs/read_write.c + return fop->read; + if (fop->read_iter) + return new_sync_read; -+ return ERR_PTR(-ENOSYS); ++ return ERR_PTR(-ENOSYS); /* doesn't have ->read(|_iter)() op */ +} + +vfs_writef_t vfs_writef(struct file *file) @@ -36927,16 +36885,16 @@ diff -Nurp linux-5.4/fs/read_write.c linux-5.4-aufs/fs/read_write.c + return fop->write; + if (fop->write_iter) + return new_sync_write; -+ return ERR_PTR(-ENOSYS); ++ return ERR_PTR(-ENOSYS); /* doesn't have ->write(|_iter)() op */ +} + ssize_t __kernel_write(struct file *file, const void *buf, size_t count, loff_t *pos) { mm_segment_t old_fs; -diff -Nurp linux-5.4/fs/splice.c linux-5.4-aufs/fs/splice.c ---- linux-5.4/fs/splice.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/splice.c 2019-11-28 01:25:59.071925617 +0200 -@@ -834,8 +834,8 @@ EXPORT_SYMBOL(generic_splice_sendpage); +diff -Nurp linux-5.6.3/fs/splice.c linux-5.6.3-aufs/fs/splice.c +--- linux-5.6.3/fs/splice.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/splice.c 2020-04-10 12:40:52.194049596 +0300 +@@ -849,8 +849,8 @@ EXPORT_SYMBOL(generic_splice_sendpage); /* * Attempt to initiate a splice from pipe to file. */ @@ -36947,7 +36905,7 @@ diff -Nurp linux-5.4/fs/splice.c linux-5.4-aufs/fs/splice.c { ssize_t (*splice_write)(struct pipe_inode_info *, struct file *, loff_t *, size_t, unsigned int); -@@ -851,9 +851,9 @@ static long do_splice_from(struct pipe_i +@@ -866,9 +866,9 @@ static long do_splice_from(struct pipe_i /* * Attempt to initiate a splice from a file to a pipe. */ @@ -36960,9 +36918,9 @@ diff -Nurp linux-5.4/fs/splice.c linux-5.4-aufs/fs/splice.c { ssize_t (*splice_read)(struct file *, loff_t *, struct pipe_inode_info *, size_t, unsigned int); -diff -Nurp linux-5.4/fs/sync.c linux-5.4-aufs/fs/sync.c ---- linux-5.4/fs/sync.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/fs/sync.c 2019-11-28 01:25:59.071925617 +0200 +diff -Nurp linux-5.6.3/fs/sync.c linux-5.6.3-aufs/fs/sync.c +--- linux-5.6.3/fs/sync.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/fs/sync.c 2020-04-10 12:40:52.194049596 +0300 @@ -28,7 +28,7 @@ * wait == 1 case since in that case write_inode() functions do * sync_dirty_buffer() and thus effectively write one block at a time. @@ -36972,18 +36930,18 @@ diff -Nurp linux-5.4/fs/sync.c linux-5.4-aufs/fs/sync.c { if (wait) sync_inodes_sb(sb); -diff -Nurp linux-5.4/include/linux/fs.h linux-5.4-aufs/include/linux/fs.h ---- linux-5.4/include/linux/fs.h 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/include/linux/fs.h 2019-11-28 01:25:59.071925617 +0200 -@@ -1349,6 +1349,7 @@ extern void fasync_free(struct fasync_st +diff -Nurp linux-5.6.3/include/linux/fs.h linux-5.6.3-aufs/include/linux/fs.h +--- linux-5.6.3/include/linux/fs.h 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/include/linux/fs.h 2020-04-10 12:40:52.195049643 +0300 +@@ -1350,6 +1350,7 @@ extern void fasync_free(struct fasync_st /* can be called from interrupts */ extern void kill_fasync(struct fasync_struct **, int, int); -+extern int setfl(int fd, struct file * filp, unsigned long arg); ++extern int setfl(int fd, struct file *filp, unsigned long arg); extern void __f_setown(struct file *filp, struct pid *, enum pid_type, int force); extern int f_setown(struct file *filp, unsigned long arg, int force); extern void f_delown(struct file *filp); -@@ -1835,6 +1836,7 @@ struct file_operations { +@@ -1842,6 +1843,7 @@ struct file_operations { ssize_t (*sendpage) (struct file *, struct page *, int, size_t, loff_t *, int); unsigned long (*get_unmapped_area)(struct file *, unsigned long, unsigned long, unsigned long, unsigned long); int (*check_flags)(int); @@ -36991,7 +36949,7 @@ diff -Nurp linux-5.4/include/linux/fs.h linux-5.4-aufs/include/linux/fs.h int (*flock) (struct file *, int, struct file_lock *); ssize_t (*splice_write)(struct pipe_inode_info *, struct file *, loff_t *, size_t, unsigned int); ssize_t (*splice_read)(struct file *, loff_t *, struct pipe_inode_info *, size_t, unsigned int); -@@ -1905,6 +1907,12 @@ ssize_t rw_copy_check_uvector(int type, +@@ -1912,6 +1914,12 @@ ssize_t rw_copy_check_uvector(int type, struct iovec *fast_pointer, struct iovec **ret_pointer); @@ -37004,7 +36962,7 @@ diff -Nurp linux-5.4/include/linux/fs.h linux-5.4-aufs/include/linux/fs.h extern ssize_t __vfs_read(struct file *, char __user *, size_t, loff_t *); extern ssize_t vfs_read(struct file *, char __user *, size_t, loff_t *); extern ssize_t vfs_write(struct file *, const char __user *, size_t, loff_t *); -@@ -2325,6 +2333,7 @@ extern int current_umask(void); +@@ -2344,6 +2352,7 @@ extern int current_umask(void); extern void ihold(struct inode * inode); extern void iput(struct inode *); extern int generic_update_time(struct inode *, struct timespec64 *, int); @@ -37012,7 +36970,7 @@ diff -Nurp linux-5.4/include/linux/fs.h linux-5.4-aufs/include/linux/fs.h /* /sys/fs */ extern struct kobject *fs_kobj; -@@ -2613,6 +2622,7 @@ static inline bool sb_is_blkdev_sb(struc +@@ -2628,6 +2637,7 @@ static inline bool sb_is_blkdev_sb(struc return false; } #endif @@ -37020,9 +36978,9 @@ diff -Nurp linux-5.4/include/linux/fs.h linux-5.4-aufs/include/linux/fs.h extern int sync_filesystem(struct super_block *); extern const struct file_operations def_blk_fops; extern const struct file_operations def_chr_fops; -diff -Nurp linux-5.4/include/linux/lockdep.h linux-5.4-aufs/include/linux/lockdep.h ---- linux-5.4/include/linux/lockdep.h 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/include/linux/lockdep.h 2019-11-28 01:25:59.071925617 +0200 +diff -Nurp linux-5.6.3/include/linux/lockdep.h linux-5.6.3-aufs/include/linux/lockdep.h +--- linux-5.6.3/include/linux/lockdep.h 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/include/linux/lockdep.h 2020-04-10 12:40:52.195049643 +0300 @@ -331,6 +331,8 @@ static inline int lockdep_match_key(stru return lock->key == key; } @@ -37032,7 +36990,7 @@ diff -Nurp linux-5.4/include/linux/lockdep.h linux-5.4-aufs/include/linux/lockde /* * Acquire a lock. * -@@ -473,6 +475,7 @@ struct lockdep_map { }; +@@ -472,6 +474,7 @@ struct lockdep_map { }; #define lockdep_depth(tsk) (0) @@ -37040,10 +36998,10 @@ diff -Nurp linux-5.4/include/linux/lockdep.h linux-5.4-aufs/include/linux/lockde #define lockdep_is_held_type(l, r) (1) #define lockdep_assert_held(l) do { (void)(l); } while (0) -diff -Nurp linux-5.4/include/linux/mm.h linux-5.4-aufs/include/linux/mm.h ---- linux-5.4/include/linux/mm.h 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/include/linux/mm.h 2019-11-28 01:25:59.071925617 +0200 -@@ -1510,6 +1510,28 @@ static inline void unmap_shared_mapping_ +diff -Nurp linux-5.6.3/include/linux/mm.h linux-5.6.3-aufs/include/linux/mm.h +--- linux-5.6.3/include/linux/mm.h 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/include/linux/mm.h 2020-04-10 12:40:52.195049643 +0300 +@@ -1487,6 +1487,28 @@ static inline void unmap_shared_mapping_ unmap_mapping_range(mapping, holebegin, holelen, 0); } @@ -37072,9 +37030,9 @@ diff -Nurp linux-5.4/include/linux/mm.h linux-5.4-aufs/include/linux/mm.h extern int access_process_vm(struct task_struct *tsk, unsigned long addr, void *buf, int len, unsigned int gup_flags); extern int access_remote_vm(struct mm_struct *mm, unsigned long addr, -diff -Nurp linux-5.4/include/linux/mm_types.h linux-5.4-aufs/include/linux/mm_types.h ---- linux-5.4/include/linux/mm_types.h 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/include/linux/mm_types.h 2019-11-28 01:25:59.071925617 +0200 +diff -Nurp linux-5.6.3/include/linux/mm_types.h linux-5.6.3-aufs/include/linux/mm_types.h +--- linux-5.6.3/include/linux/mm_types.h 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/include/linux/mm_types.h 2020-04-10 12:40:52.195049643 +0300 @@ -267,6 +267,7 @@ struct vm_region { unsigned long vm_top; /* region allocated to here */ unsigned long vm_pgoff; /* the offset in vm_file corresponding to vm_start */ @@ -37083,7 +37041,7 @@ diff -Nurp linux-5.4/include/linux/mm_types.h linux-5.4-aufs/include/linux/mm_ty int vm_usage; /* region usage count (access under nommu_region_sem) */ bool vm_icache_flushed : 1; /* true if the icache has been flushed for -@@ -341,6 +342,7 @@ struct vm_area_struct { +@@ -346,6 +347,7 @@ struct vm_area_struct { unsigned long vm_pgoff; /* Offset (within vm_file) in PAGE_SIZE units */ struct file * vm_file; /* File we map to (can be NULL). */ @@ -37091,9 +37049,9 @@ diff -Nurp linux-5.4/include/linux/mm_types.h linux-5.4-aufs/include/linux/mm_ty void * vm_private_data; /* was vm_pte (shared mem) */ #ifdef CONFIG_SWAP -diff -Nurp linux-5.4/include/linux/mnt_namespace.h linux-5.4-aufs/include/linux/mnt_namespace.h ---- linux-5.4/include/linux/mnt_namespace.h 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/include/linux/mnt_namespace.h 2019-11-28 01:25:59.071925617 +0200 +diff -Nurp linux-5.6.3/include/linux/mnt_namespace.h linux-5.6.3-aufs/include/linux/mnt_namespace.h +--- linux-5.6.3/include/linux/mnt_namespace.h 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/include/linux/mnt_namespace.h 2020-04-10 12:40:52.195049643 +0300 @@ -6,11 +6,14 @@ struct mnt_namespace; struct fs_struct; @@ -37109,9 +37067,9 @@ diff -Nurp linux-5.4/include/linux/mnt_namespace.h linux-5.4-aufs/include/linux/ extern const struct file_operations proc_mounts_operations; extern const struct file_operations proc_mountinfo_operations; extern const struct file_operations proc_mountstats_operations; -diff -Nurp linux-5.4/include/linux/splice.h linux-5.4-aufs/include/linux/splice.h ---- linux-5.4/include/linux/splice.h 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/include/linux/splice.h 2019-11-28 01:25:59.071925617 +0200 +diff -Nurp linux-5.6.3/include/linux/splice.h linux-5.6.3-aufs/include/linux/splice.h +--- linux-5.6.3/include/linux/splice.h 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/include/linux/splice.h 2020-04-10 12:40:52.195049643 +0300 @@ -87,4 +87,10 @@ extern void splice_shrink_spd(struct spl extern const struct pipe_buf_operations page_cache_pipe_buf_ops; @@ -37123,13 +37081,13 @@ diff -Nurp linux-5.4/include/linux/splice.h linux-5.4-aufs/include/linux/splice. + struct pipe_inode_info *pipe, size_t len, + unsigned int flags); #endif -diff -Nurp linux-5.4/include/uapi/linux/aufs_type.h linux-5.4-aufs/include/uapi/linux/aufs_type.h ---- linux-5.4/include/uapi/linux/aufs_type.h 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/include/uapi/linux/aufs_type.h 2019-11-28 01:25:59.071925617 +0200 +diff -Nurp linux-5.6.3/include/uapi/linux/aufs_type.h linux-5.6.3-aufs/include/uapi/linux/aufs_type.h +--- linux-5.6.3/include/uapi/linux/aufs_type.h 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/include/uapi/linux/aufs_type.h 2020-04-10 12:40:52.195049643 +0300 @@ -0,0 +1,439 @@ +/* SPDX-License-Identifier: GPL-2.0 WITH Linux-syscall-note */ +/* -+ * Copyright (C) 2005-2019 Junjiro R. Okajima ++ * Copyright (C) 2005-2020 Junjiro R. Okajima + */ + +#ifndef __AUFS_TYPE_H__ @@ -37149,20 +37107,21 @@ diff -Nurp linux-5.4/include/uapi/linux/aufs_type.h linux-5.4-aufs/include/uapi/ +#define pr_fmt(fmt) \ + AUFS_NAME " %s:%d:%.*s[%d]: " fmt, __func__, __LINE__, \ + (int)sizeof(current->comm), current->comm, current->pid ++#include +#else +#include +#include ++#include +#endif /* __KERNEL__ */ + -+#include -+ -+#define AUFS_VERSION "5.4" ++#define AUFS_VERSION "5.5" + +/* todo? move this to linux-2.6.19/include/magic.h */ +#define AUFS_SUPER_MAGIC ('a' << 24 | 'u' << 16 | 'f' << 8 | 's') + +/* ---------------------------------------------------------------------- */ + ++#ifdef __KERNEL__ +#ifdef CONFIG_AUFS_BRANCH_MAX_127 +typedef int8_t aufs_bindex_t; +#define AUFS_BRANCH_MAX 127 @@ -37177,7 +37136,6 @@ diff -Nurp linux-5.4/include/uapi/linux/aufs_type.h linux-5.4-aufs/include/uapi/ +#endif +#endif + -+#ifdef __KERNEL__ +#ifndef AUFS_BRANCH_MAX +#error unknown CONFIG_AUFS_BRANCH_MAX value +#endif @@ -37566,10 +37524,10 @@ diff -Nurp linux-5.4/include/uapi/linux/aufs_type.h linux-5.4-aufs/include/uapi/ +#define AUFS_CTL_FHSM_FD _IOW(AuCtlType, AuCtl_FHSM_FD, int) + +#endif /* __AUFS_TYPE_H__ */ -diff -Nurp linux-5.4/kernel/fork.c linux-5.4-aufs/kernel/fork.c ---- linux-5.4/kernel/fork.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/kernel/fork.c 2019-11-28 01:25:59.072925617 +0200 -@@ -562,7 +562,7 @@ static __latent_entropy int dup_mmap(str +diff -Nurp linux-5.6.3/kernel/fork.c linux-5.6.3-aufs/kernel/fork.c +--- linux-5.6.3/kernel/fork.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/kernel/fork.c 2020-04-10 12:40:52.195049643 +0300 +@@ -565,7 +565,7 @@ static __latent_entropy int dup_mmap(str struct inode *inode = file_inode(file); struct address_space *mapping = file->f_mapping; @@ -37578,9 +37536,9 @@ diff -Nurp linux-5.4/kernel/fork.c linux-5.4-aufs/kernel/fork.c if (tmp->vm_flags & VM_DENYWRITE) atomic_dec(&inode->i_writecount); i_mmap_lock_write(mapping); -diff -Nurp linux-5.4/kernel/locking/lockdep.c linux-5.4-aufs/kernel/locking/lockdep.c ---- linux-5.4/kernel/locking/lockdep.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/kernel/locking/lockdep.c 2019-11-28 01:25:59.072925617 +0200 +diff -Nurp linux-5.6.3/kernel/locking/lockdep.c linux-5.6.3-aufs/kernel/locking/lockdep.c +--- linux-5.6.3/kernel/locking/lockdep.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/kernel/locking/lockdep.c 2020-04-10 12:40:52.195049643 +0300 @@ -153,7 +153,7 @@ static struct lock_class lock_classes[MAX_LOCKDEP_KEYS]; static DECLARE_BITMAP(lock_classes_in_use, MAX_LOCKDEP_KEYS); @@ -37598,10 +37556,10 @@ diff -Nurp linux-5.4/kernel/locking/lockdep.c linux-5.4-aufs/kernel/locking/lock #ifdef CONFIG_LOCK_STAT static DEFINE_PER_CPU(struct lock_class_stats[MAX_LOCKDEP_KEYS], cpu_lock_stats); -diff -Nurp linux-5.4/MAINTAINERS linux-5.4-aufs/MAINTAINERS ---- linux-5.4/MAINTAINERS 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/MAINTAINERS 2019-11-28 01:25:59.062925618 +0200 -@@ -2832,6 +2832,19 @@ F: include/linux/audit.h +diff -Nurp linux-5.6.3/MAINTAINERS linux-5.6.3-aufs/MAINTAINERS +--- linux-5.6.3/MAINTAINERS 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/MAINTAINERS 2020-04-10 12:40:52.187049268 +0300 +@@ -2919,6 +2919,19 @@ F: include/linux/audit.h F: include/uapi/linux/audit.h F: kernel/audit* @@ -37621,10 +37579,10 @@ diff -Nurp linux-5.4/MAINTAINERS linux-5.4-aufs/MAINTAINERS AUXILIARY DISPLAY DRIVERS M: Miguel Ojeda Sandonis S: Maintained -diff -Nurp linux-5.4/mm/filemap.c linux-5.4-aufs/mm/filemap.c ---- linux-5.4/mm/filemap.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/mm/filemap.c 2019-11-28 01:25:59.072925617 +0200 -@@ -2696,7 +2696,7 @@ vm_fault_t filemap_page_mkwrite(struct v +diff -Nurp linux-5.6.3/mm/filemap.c linux-5.6.3-aufs/mm/filemap.c +--- linux-5.6.3/mm/filemap.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/mm/filemap.c 2020-04-10 12:40:52.196049690 +0300 +@@ -2653,7 +2653,7 @@ vm_fault_t filemap_page_mkwrite(struct v vm_fault_t ret = VM_FAULT_LOCKED; sb_start_pagefault(inode->i_sb); @@ -37633,10 +37591,10 @@ diff -Nurp linux-5.4/mm/filemap.c linux-5.4-aufs/mm/filemap.c lock_page(page); if (page->mapping != inode->i_mapping) { unlock_page(page); -diff -Nurp linux-5.4/mm/Makefile linux-5.4-aufs/mm/Makefile ---- linux-5.4/mm/Makefile 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/mm/Makefile 2019-11-28 01:25:59.072925617 +0200 -@@ -42,7 +42,7 @@ obj-y := filemap.o mempool.o oom_kill. +diff -Nurp linux-5.6.3/mm/Makefile linux-5.6.3-aufs/mm/Makefile +--- linux-5.6.3/mm/Makefile 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/mm/Makefile 2020-04-10 12:40:52.195049643 +0300 +@@ -43,7 +43,7 @@ obj-y := filemap.o mempool.o oom_kill. mm_init.o mmu_context.o percpu.o slab_common.o \ compaction.o vmacache.o \ interval_tree.o list_lru.o workingset.o \ @@ -37645,10 +37603,10 @@ diff -Nurp linux-5.4/mm/Makefile linux-5.4-aufs/mm/Makefile # Give 'page_alloc' its own module-parameter namespace page-alloc-y := page_alloc.o -diff -Nurp linux-5.4/mm/mmap.c linux-5.4-aufs/mm/mmap.c ---- linux-5.4/mm/mmap.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/mm/mmap.c 2019-11-28 01:25:59.073925617 +0200 -@@ -182,7 +182,7 @@ static struct vm_area_struct *remove_vma +diff -Nurp linux-5.6.3/mm/mmap.c linux-5.6.3-aufs/mm/mmap.c +--- linux-5.6.3/mm/mmap.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/mm/mmap.c 2020-04-10 12:40:52.196049690 +0300 +@@ -176,7 +176,7 @@ static struct vm_area_struct *remove_vma if (vma->vm_ops && vma->vm_ops->close) vma->vm_ops->close(vma); if (vma->vm_file) @@ -37657,7 +37615,7 @@ diff -Nurp linux-5.4/mm/mmap.c linux-5.4-aufs/mm/mmap.c mpol_put(vma_policy(vma)); vm_area_free(vma); return next; -@@ -940,7 +940,7 @@ again: +@@ -907,7 +907,7 @@ again: if (remove_next) { if (file) { uprobe_munmap(next, next->vm_start, next->vm_end); @@ -37666,7 +37624,7 @@ diff -Nurp linux-5.4/mm/mmap.c linux-5.4-aufs/mm/mmap.c } if (next->anon_vma) anon_vma_merge(vma, next); -@@ -1865,8 +1865,8 @@ out: +@@ -1829,8 +1829,8 @@ out: return addr; unmap_and_free_vma: @@ -37676,7 +37634,7 @@ diff -Nurp linux-5.4/mm/mmap.c linux-5.4-aufs/mm/mmap.c /* Undo any partial mapping done by a device driver. */ unmap_region(mm, vma, prev, vma->vm_start, vma->vm_end); -@@ -2695,7 +2695,7 @@ int __split_vma(struct mm_struct *mm, st +@@ -2659,7 +2659,7 @@ int __split_vma(struct mm_struct *mm, st goto out_free_mpol; if (new->vm_file) @@ -37685,7 +37643,7 @@ diff -Nurp linux-5.4/mm/mmap.c linux-5.4-aufs/mm/mmap.c if (new->vm_ops && new->vm_ops->open) new->vm_ops->open(new); -@@ -2714,7 +2714,7 @@ int __split_vma(struct mm_struct *mm, st +@@ -2678,7 +2678,7 @@ int __split_vma(struct mm_struct *mm, st if (new->vm_ops && new->vm_ops->close) new->vm_ops->close(new); if (new->vm_file) @@ -37694,7 +37652,7 @@ diff -Nurp linux-5.4/mm/mmap.c linux-5.4-aufs/mm/mmap.c unlink_anon_vmas(new); out_free_mpol: mpol_put(vma_policy(new)); -@@ -2906,7 +2906,7 @@ SYSCALL_DEFINE5(remap_file_pages, unsign +@@ -2870,7 +2870,7 @@ SYSCALL_DEFINE5(remap_file_pages, unsign struct vm_area_struct *vma; unsigned long populate = 0; unsigned long ret = -EINVAL; @@ -37703,7 +37661,7 @@ diff -Nurp linux-5.4/mm/mmap.c linux-5.4-aufs/mm/mmap.c pr_warn_once("%s (%d) uses deprecated remap_file_pages() syscall. See Documentation/vm/remap_file_pages.rst.\n", current->comm, current->pid); -@@ -2981,10 +2981,27 @@ SYSCALL_DEFINE5(remap_file_pages, unsign +@@ -2945,10 +2945,27 @@ SYSCALL_DEFINE5(remap_file_pages, unsign } } @@ -37732,7 +37690,7 @@ diff -Nurp linux-5.4/mm/mmap.c linux-5.4-aufs/mm/mmap.c out: up_write(&mm->mmap_sem); if (populate) -@@ -3274,7 +3291,7 @@ struct vm_area_struct *copy_vma(struct v +@@ -3239,7 +3256,7 @@ struct vm_area_struct *copy_vma(struct v if (anon_vma_clone(new_vma, vma)) goto out_free_mempol; if (new_vma->vm_file) @@ -37741,10 +37699,10 @@ diff -Nurp linux-5.4/mm/mmap.c linux-5.4-aufs/mm/mmap.c if (new_vma->vm_ops && new_vma->vm_ops->open) new_vma->vm_ops->open(new_vma); vma_link(mm, new_vma, prev, rb_link, rb_parent); -diff -Nurp linux-5.4/mm/nommu.c linux-5.4-aufs/mm/nommu.c ---- linux-5.4/mm/nommu.c 2019-11-25 02:32:01.000000000 +0200 -+++ linux-5.4-aufs/mm/nommu.c 2019-11-28 01:25:59.073925617 +0200 -@@ -552,7 +552,7 @@ static void __put_nommu_region(struct vm +diff -Nurp linux-5.6.3/mm/nommu.c linux-5.6.3-aufs/mm/nommu.c +--- linux-5.6.3/mm/nommu.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3-aufs/mm/nommu.c 2020-04-10 12:40:52.196049690 +0300 +@@ -567,7 +567,7 @@ static void __put_nommu_region(struct vm up_write(&nommu_region_sem); if (region->vm_file) @@ -37753,7 +37711,7 @@ diff -Nurp linux-5.4/mm/nommu.c linux-5.4-aufs/mm/nommu.c /* IO memory and memory shared directly out of the pagecache * from ramfs/tmpfs mustn't be released here */ -@@ -690,7 +690,7 @@ static void delete_vma(struct mm_struct +@@ -699,7 +699,7 @@ static void delete_vma(struct mm_struct if (vma->vm_ops && vma->vm_ops->close) vma->vm_ops->close(vma); if (vma->vm_file) @@ -37762,7 +37720,7 @@ diff -Nurp linux-5.4/mm/nommu.c linux-5.4-aufs/mm/nommu.c put_nommu_region(vma->vm_region); vm_area_free(vma); } -@@ -1213,7 +1213,7 @@ unsigned long do_mmap(struct file *file, +@@ -1222,7 +1222,7 @@ unsigned long do_mmap(struct file *file, goto error_just_free; } } @@ -37771,7 +37729,7 @@ diff -Nurp linux-5.4/mm/nommu.c linux-5.4-aufs/mm/nommu.c kmem_cache_free(vm_region_jar, region); region = pregion; result = start; -@@ -1290,10 +1290,10 @@ error_just_free: +@@ -1299,10 +1299,10 @@ error_just_free: up_write(&nommu_region_sem); error: if (region->vm_file) @@ -37784,9 +37742,9 @@ diff -Nurp linux-5.4/mm/nommu.c linux-5.4-aufs/mm/nommu.c vm_area_free(vma); return ret; -diff -Nurp linux-5.4/mm/prfile.c linux-5.4-aufs/mm/prfile.c ---- linux-5.4/mm/prfile.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-5.4-aufs/mm/prfile.c 2019-11-28 01:25:59.073925617 +0200 +diff -Nurp linux-5.6.3/mm/prfile.c linux-5.6.3-aufs/mm/prfile.c +--- linux-5.6.3/mm/prfile.c 1970-01-01 02:00:00.000000000 +0200 ++++ linux-5.6.3-aufs/mm/prfile.c 2020-04-10 12:40:52.196049690 +0300 @@ -0,0 +1,86 @@ +// SPDX-License-Identifier: GPL-2.0 +/* @@ -37796,7 +37754,7 @@ diff -Nurp linux-5.4/mm/prfile.c linux-5.4-aufs/mm/prfile.c + * + * See Documentation/filesystems/aufs/design/06mmap.txt + * -+ * Copyright (c) 2014-2019 Junjro R. Okajima ++ * Copyright (c) 2014-2020 Junjro R. Okajima + * Copyright (c) 2014 Ian Campbell + */ + diff --git a/kernel/kernel/files/patches/mageia/fs-aufs-include-vmalloc.patch b/kernel/kernel/files/patches/mageia/fs-aufs-include-vmalloc.patch deleted file mode 100644 index 0c413647..00000000 --- a/kernel/kernel/files/patches/mageia/fs-aufs-include-vmalloc.patch +++ /dev/null @@ -1,27 +0,0 @@ - -arm build fails with: - -n file included from fs/aufs/aufs.h:31:0, - from fs/aufs/module.c:11: -fs/aufs/file.h: In function 'au_do_vm_file_reset': -fs/aufs/file.h:273:9: error: dereferencing pointer to incomplete type 'struct vm_area_struct' - f = vma->vm_file; - ^ - -on x86(64) we seem to get covered by implict inclusion. - -So explicitly include it to avoid subtle breakage - -Signed-off-by: Thomas Backlund ---- - ---- ./fs/aufs/file.h.orig -+++ ./fs/aufs/file.h -@@ -15,6 +15,7 @@ - #include - #include - #include -+#include - #include "rwsem.h" - - struct au_branch; diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-add-Kconfig-and-Makefile.patch b/kernel/kernel/files/patches/mageia/fs-exfat-add-Kconfig-and-Makefile.patch new file mode 100644 index 00000000..674116ff --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-add-Kconfig-and-Makefile.patch @@ -0,0 +1,96 @@ +From b9d1e2e6265f5dc25e9f5dbfbde3e53d8a4958ac Mon Sep 17 00:00:00 2001 +From: Namjae Jeon +Date: Mon, 2 Mar 2020 15:21:42 +0900 +Subject: [PATCH 11/14] exfat: add Kconfig and Makefile +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +This adds the Kconfig and Makefile for exfat. + +Signed-off-by: Namjae Jeon +Signed-off-by: Sungjong Seo +Reviewed-by: Pali Rohár +Reviewed-by: Christoph Hellwig +Signed-off-by: Al Viro +--- + fs/Kconfig | 3 ++- + fs/Makefile | 1 + + fs/exfat/Kconfig | 21 +++++++++++++++++++++ + fs/exfat/Makefile | 8 ++++++++ + 4 files changed, 32 insertions(+), 1 deletion(-) + create mode 100644 fs/exfat/Kconfig + create mode 100644 fs/exfat/Makefile + +diff --git a/fs/Kconfig b/fs/Kconfig +index 708ba336e689..f08fbbfafd9a 100644 +--- a/fs/Kconfig ++++ b/fs/Kconfig +@@ -140,9 +140,10 @@ endmenu + endif # BLOCK + + if BLOCK +-menu "DOS/FAT/NT Filesystems" ++menu "DOS/FAT/EXFAT/NT Filesystems" + + source "fs/fat/Kconfig" ++source "fs/exfat/Kconfig" + source "fs/ntfs/Kconfig" + + endmenu +diff --git a/fs/Makefile b/fs/Makefile +index 505e51166973..2ce5112b02c8 100644 +--- a/fs/Makefile ++++ b/fs/Makefile +@@ -83,6 +83,7 @@ obj-$(CONFIG_HUGETLBFS) += hugetlbfs/ + obj-$(CONFIG_CODA_FS) += coda/ + obj-$(CONFIG_MINIX_FS) += minix/ + obj-$(CONFIG_FAT_FS) += fat/ ++obj-$(CONFIG_EXFAT_FS) += exfat/ + obj-$(CONFIG_BFS_FS) += bfs/ + obj-$(CONFIG_ISO9660_FS) += isofs/ + obj-$(CONFIG_HFSPLUS_FS) += hfsplus/ # Before hfs to find wrapped HFS+ +diff --git a/fs/exfat/Kconfig b/fs/exfat/Kconfig +new file mode 100644 +index 000000000000..2d3636dc5b8c +--- /dev/null ++++ b/fs/exfat/Kconfig +@@ -0,0 +1,21 @@ ++# SPDX-License-Identifier: GPL-2.0-or-later ++ ++config EXFAT_FS ++ tristate "exFAT filesystem support" ++ select NLS ++ help ++ This allows you to mount devices formatted with the exFAT file system. ++ exFAT is typically used on SD-Cards or USB sticks. ++ ++ To compile this as a module, choose M here: the module will be called ++ exfat. ++ ++config EXFAT_DEFAULT_IOCHARSET ++ string "Default iocharset for exFAT" ++ default "utf8" ++ depends on EXFAT_FS ++ help ++ Set this to the default input/output character set to use for ++ converting between the encoding is used for user visible filename and ++ UTF-16 character that exfat filesystem use, and can be overridden with ++ the "iocharset" mount option for exFAT filesystems. +diff --git a/fs/exfat/Makefile b/fs/exfat/Makefile +new file mode 100644 +index 000000000000..ed51926a4971 +--- /dev/null ++++ b/fs/exfat/Makefile +@@ -0,0 +1,8 @@ ++# SPDX-License-Identifier: GPL-2.0-or-later ++# ++# Makefile for the linux exFAT filesystem support. ++# ++obj-$(CONFIG_EXFAT_FS) += exfat.o ++ ++exfat-y := inode.o namei.o dir.o super.o fatent.o cache.o nls.o misc.o \ ++ file.o balloc.o +-- +2.25.1 + diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-add-bitmap-operations.patch b/kernel/kernel/files/patches/mageia/fs-exfat-add-bitmap-operations.patch new file mode 100644 index 00000000..5505b308 --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-add-bitmap-operations.patch @@ -0,0 +1,309 @@ +From 1e49a94cf707204b66a3fb242f2814712c941f52 Mon Sep 17 00:00:00 2001 +From: Namjae Jeon +Date: Mon, 2 Mar 2020 15:21:38 +0900 +Subject: [PATCH 07/14] exfat: add bitmap operations +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +This adds the implementation of bitmap operations for exfat. + +Signed-off-by: Namjae Jeon +Signed-off-by: Sungjong Seo +Reviewed-by: Pali Rohár +Reviewed-by: Christoph Hellwig +Signed-off-by: Al Viro +--- + fs/exfat/balloc.c | 280 ++++++++++++++++++++++++++++++++++++++++++++++ + 1 file changed, 280 insertions(+) + create mode 100644 fs/exfat/balloc.c + +diff --git a/fs/exfat/balloc.c b/fs/exfat/balloc.c +new file mode 100644 +index 000000000000..6a04cc02565a +--- /dev/null ++++ b/fs/exfat/balloc.c +@@ -0,0 +1,280 @@ ++// SPDX-License-Identifier: GPL-2.0-or-later ++/* ++ * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. ++ */ ++ ++#include ++#include ++#include ++ ++#include "exfat_raw.h" ++#include "exfat_fs.h" ++ ++static const unsigned char free_bit[] = { ++ 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2,/* 0 ~ 19*/ ++ 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 5, 0, 1, 0, 2, 0, 1, 0, 3,/* 20 ~ 39*/ ++ 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2,/* 40 ~ 59*/ ++ 0, 1, 0, 6, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4,/* 60 ~ 79*/ ++ 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 5, 0, 1, 0, 2,/* 80 ~ 99*/ ++ 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, 0, 1, 0, 3,/*100 ~ 119*/ ++ 0, 1, 0, 2, 0, 1, 0, 7, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2,/*120 ~ 139*/ ++ 0, 1, 0, 4, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 5,/*140 ~ 159*/ ++ 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2,/*160 ~ 179*/ ++ 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 6, 0, 1, 0, 2, 0, 1, 0, 3,/*180 ~ 199*/ ++ 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2,/*200 ~ 219*/ ++ 0, 1, 0, 5, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4,/*220 ~ 239*/ ++ 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0 /*240 ~ 254*/ ++}; ++ ++static const unsigned char used_bit[] = { ++ 0, 1, 1, 2, 1, 2, 2, 3, 1, 2, 2, 3, 2, 3, 3, 4, 1, 2, 2, 3,/* 0 ~ 19*/ ++ 2, 3, 3, 4, 2, 3, 3, 4, 3, 4, 4, 5, 1, 2, 2, 3, 2, 3, 3, 4,/* 20 ~ 39*/ ++ 2, 3, 3, 4, 3, 4, 4, 5, 2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5,/* 40 ~ 59*/ ++ 4, 5, 5, 6, 1, 2, 2, 3, 2, 3, 3, 4, 2, 3, 3, 4, 3, 4, 4, 5,/* 60 ~ 79*/ ++ 2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6, 2, 3, 3, 4,/* 80 ~ 99*/ ++ 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6, 3, 4, 4, 5, 4, 5, 5, 6,/*100 ~ 119*/ ++ 4, 5, 5, 6, 5, 6, 6, 7, 1, 2, 2, 3, 2, 3, 3, 4, 2, 3, 3, 4,/*120 ~ 139*/ ++ 3, 4, 4, 5, 2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6,/*140 ~ 159*/ ++ 2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6, 3, 4, 4, 5,/*160 ~ 179*/ ++ 4, 5, 5, 6, 4, 5, 5, 6, 5, 6, 6, 7, 2, 3, 3, 4, 3, 4, 4, 5,/*180 ~ 199*/ ++ 3, 4, 4, 5, 4, 5, 5, 6, 3, 4, 4, 5, 4, 5, 5, 6, 4, 5, 5, 6,/*200 ~ 219*/ ++ 5, 6, 6, 7, 3, 4, 4, 5, 4, 5, 5, 6, 4, 5, 5, 6, 5, 6, 6, 7,/*220 ~ 239*/ ++ 4, 5, 5, 6, 5, 6, 6, 7, 5, 6, 6, 7, 6, 7, 7, 8 /*240 ~ 255*/ ++}; ++ ++/* ++ * Allocation Bitmap Management Functions ++ */ ++static int exfat_allocate_bitmap(struct super_block *sb, ++ struct exfat_dentry *ep) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ long long map_size; ++ unsigned int i, need_map_size; ++ sector_t sector; ++ ++ sbi->map_clu = le32_to_cpu(ep->dentry.bitmap.start_clu); ++ map_size = le64_to_cpu(ep->dentry.bitmap.size); ++ need_map_size = ((EXFAT_DATA_CLUSTER_COUNT(sbi) - 1) / BITS_PER_BYTE) ++ + 1; ++ if (need_map_size != map_size) { ++ exfat_msg(sb, KERN_ERR, ++ "bogus allocation bitmap size(need : %u, cur : %lld)", ++ need_map_size, map_size); ++ /* ++ * Only allowed when bogus allocation ++ * bitmap size is large ++ */ ++ if (need_map_size > map_size) ++ return -EIO; ++ } ++ sbi->map_sectors = ((need_map_size - 1) >> ++ (sb->s_blocksize_bits)) + 1; ++ sbi->vol_amap = kmalloc_array(sbi->map_sectors, ++ sizeof(struct buffer_head *), GFP_KERNEL); ++ if (!sbi->vol_amap) ++ return -ENOMEM; ++ ++ sector = exfat_cluster_to_sector(sbi, sbi->map_clu); ++ for (i = 0; i < sbi->map_sectors; i++) { ++ sbi->vol_amap[i] = sb_bread(sb, sector + i); ++ if (!sbi->vol_amap[i]) { ++ /* release all buffers and free vol_amap */ ++ int j = 0; ++ ++ while (j < i) ++ brelse(sbi->vol_amap[j++]); ++ ++ kfree(sbi->vol_amap); ++ sbi->vol_amap = NULL; ++ return -EIO; ++ } ++ } ++ ++ sbi->pbr_bh = NULL; ++ return 0; ++} ++ ++int exfat_load_bitmap(struct super_block *sb) ++{ ++ unsigned int i, type; ++ struct exfat_chain clu; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ ++ exfat_chain_set(&clu, sbi->root_dir, 0, ALLOC_FAT_CHAIN); ++ while (clu.dir != EXFAT_EOF_CLUSTER) { ++ for (i = 0; i < sbi->dentries_per_clu; i++) { ++ struct exfat_dentry *ep; ++ struct buffer_head *bh; ++ ++ ep = exfat_get_dentry(sb, &clu, i, &bh, NULL); ++ if (!ep) ++ return -EIO; ++ ++ type = exfat_get_entry_type(ep); ++ if (type == TYPE_UNUSED) ++ break; ++ if (type != TYPE_BITMAP) ++ continue; ++ if (ep->dentry.bitmap.flags == 0x0) { ++ int err; ++ ++ err = exfat_allocate_bitmap(sb, ep); ++ brelse(bh); ++ return err; ++ } ++ brelse(bh); ++ } ++ ++ if (exfat_get_next_cluster(sb, &clu.dir)) ++ return -EIO; ++ } ++ ++ return -EINVAL; ++} ++ ++void exfat_free_bitmap(struct exfat_sb_info *sbi) ++{ ++ int i; ++ ++ brelse(sbi->pbr_bh); ++ ++ for (i = 0; i < sbi->map_sectors; i++) ++ __brelse(sbi->vol_amap[i]); ++ ++ kfree(sbi->vol_amap); ++} ++ ++/* ++ * If the value of "clu" is 0, it means cluster 2 which is the first cluster of ++ * the cluster heap. ++ */ ++int exfat_set_bitmap(struct inode *inode, unsigned int clu) ++{ ++ int i, b; ++ unsigned int ent_idx; ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ ++ WARN_ON(clu < EXFAT_FIRST_CLUSTER); ++ ent_idx = CLUSTER_TO_BITMAP_ENT(clu); ++ i = BITMAP_OFFSET_SECTOR_INDEX(sb, ent_idx); ++ b = BITMAP_OFFSET_BIT_IN_SECTOR(sb, ent_idx); ++ ++ set_bit_le(b, sbi->vol_amap[i]->b_data); ++ exfat_update_bh(sb, sbi->vol_amap[i], IS_DIRSYNC(inode)); ++ return 0; ++} ++ ++/* ++ * If the value of "clu" is 0, it means cluster 2 which is the first cluster of ++ * the cluster heap. ++ */ ++void exfat_clear_bitmap(struct inode *inode, unsigned int clu) ++{ ++ int i, b; ++ unsigned int ent_idx; ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_mount_options *opts = &sbi->options; ++ ++ WARN_ON(clu < EXFAT_FIRST_CLUSTER); ++ ent_idx = CLUSTER_TO_BITMAP_ENT(clu); ++ i = BITMAP_OFFSET_SECTOR_INDEX(sb, ent_idx); ++ b = BITMAP_OFFSET_BIT_IN_SECTOR(sb, ent_idx); ++ ++ clear_bit_le(b, sbi->vol_amap[i]->b_data); ++ exfat_update_bh(sb, sbi->vol_amap[i], IS_DIRSYNC(inode)); ++ ++ if (opts->discard) { ++ int ret_discard; ++ ++ ret_discard = sb_issue_discard(sb, ++ exfat_cluster_to_sector(sbi, clu + ++ EXFAT_RESERVED_CLUSTERS), ++ (1 << sbi->sect_per_clus_bits), GFP_NOFS, 0); ++ ++ if (ret_discard == -EOPNOTSUPP) { ++ exfat_msg(sb, KERN_ERR, ++ "discard not supported by device, disabling"); ++ opts->discard = 0; ++ } ++ } ++} ++ ++/* ++ * If the value of "clu" is 0, it means cluster 2 which is the first cluster of ++ * the cluster heap. ++ */ ++unsigned int exfat_find_free_bitmap(struct super_block *sb, unsigned int clu) ++{ ++ unsigned int i, map_i, map_b, ent_idx; ++ unsigned int clu_base, clu_free; ++ unsigned char k, clu_mask; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ ++ WARN_ON(clu < EXFAT_FIRST_CLUSTER); ++ ent_idx = CLUSTER_TO_BITMAP_ENT(clu); ++ clu_base = BITMAP_ENT_TO_CLUSTER(ent_idx & ~(BITS_PER_BYTE_MASK)); ++ clu_mask = IGNORED_BITS_REMAINED(clu, clu_base); ++ ++ map_i = BITMAP_OFFSET_SECTOR_INDEX(sb, ent_idx); ++ map_b = BITMAP_OFFSET_BYTE_IN_SECTOR(sb, ent_idx); ++ ++ for (i = EXFAT_FIRST_CLUSTER; i < sbi->num_clusters; ++ i += BITS_PER_BYTE) { ++ k = *(sbi->vol_amap[map_i]->b_data + map_b); ++ if (clu_mask > 0) { ++ k |= clu_mask; ++ clu_mask = 0; ++ } ++ if (k < 0xFF) { ++ clu_free = clu_base + free_bit[k]; ++ if (clu_free < sbi->num_clusters) ++ return clu_free; ++ } ++ clu_base += BITS_PER_BYTE; ++ ++ if (++map_b >= sb->s_blocksize || ++ clu_base >= sbi->num_clusters) { ++ if (++map_i >= sbi->map_sectors) { ++ clu_base = EXFAT_FIRST_CLUSTER; ++ map_i = 0; ++ } ++ map_b = 0; ++ } ++ } ++ ++ return EXFAT_EOF_CLUSTER; ++} ++ ++int exfat_count_used_clusters(struct super_block *sb, unsigned int *ret_count) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ unsigned int count = 0; ++ unsigned int i, map_i = 0, map_b = 0; ++ unsigned int total_clus = EXFAT_DATA_CLUSTER_COUNT(sbi); ++ unsigned int last_mask = total_clus & BITS_PER_BYTE_MASK; ++ unsigned char clu_bits; ++ const unsigned char last_bit_mask[] = {0, 0b00000001, 0b00000011, ++ 0b00000111, 0b00001111, 0b00011111, 0b00111111, 0b01111111}; ++ ++ total_clus &= ~last_mask; ++ for (i = 0; i < total_clus; i += BITS_PER_BYTE) { ++ clu_bits = *(sbi->vol_amap[map_i]->b_data + map_b); ++ count += used_bit[clu_bits]; ++ if (++map_b >= (unsigned int)sb->s_blocksize) { ++ map_i++; ++ map_b = 0; ++ } ++ } ++ ++ if (last_mask) { ++ clu_bits = *(sbi->vol_amap[map_i]->b_data + map_b); ++ clu_bits &= last_bit_mask[last_mask]; ++ count += used_bit[clu_bits]; ++ } ++ ++ *ret_count = count; ++ return 0; ++} +-- +2.25.1 + diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-add-directory-operations.patch b/kernel/kernel/files/patches/mageia/fs-exfat-add-directory-operations.patch new file mode 100644 index 00000000..857c1dbb --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-add-directory-operations.patch @@ -0,0 +1,1267 @@ +From ca06197382bde0a3bc20215595d1c9ce20c6e341 Mon Sep 17 00:00:00 2001 +From: Namjae Jeon +Date: Mon, 2 Mar 2020 15:21:35 +0900 +Subject: [PATCH 04/14] exfat: add directory operations +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +This adds the implementation of directory operations for exfat. + +Signed-off-by: Namjae Jeon +Signed-off-by: Sungjong Seo +Reviewed-by: Pali Rohár +Reviewed-by: Christoph Hellwig +Signed-off-by: Al Viro +--- + fs/exfat/dir.c | 1238 ++++++++++++++++++++++++++++++++++++++++++++++++ + 1 file changed, 1238 insertions(+) + create mode 100644 fs/exfat/dir.c + +diff --git a/fs/exfat/dir.c b/fs/exfat/dir.c +new file mode 100644 +index 000000000000..4b91afb0f051 +--- /dev/null ++++ b/fs/exfat/dir.c +@@ -0,0 +1,1238 @@ ++// SPDX-License-Identifier: GPL-2.0-or-later ++/* ++ * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. ++ */ ++ ++#include ++#include ++#include ++ ++#include "exfat_raw.h" ++#include "exfat_fs.h" ++ ++static int exfat_extract_uni_name(struct exfat_dentry *ep, ++ unsigned short *uniname) ++{ ++ int i, len = 0; ++ ++ for (i = 0; i < EXFAT_FILE_NAME_LEN; i++) { ++ *uniname = le16_to_cpu(ep->dentry.name.unicode_0_14[i]); ++ if (*uniname == 0x0) ++ return len; ++ uniname++; ++ len++; ++ } ++ ++ *uniname = 0x0; ++ return len; ++ ++} ++ ++static void exfat_get_uniname_from_ext_entry(struct super_block *sb, ++ struct exfat_chain *p_dir, int entry, unsigned short *uniname) ++{ ++ int i; ++ struct exfat_dentry *ep; ++ struct exfat_entry_set_cache *es; ++ ++ es = exfat_get_dentry_set(sb, p_dir, entry, ES_ALL_ENTRIES, &ep); ++ if (!es) ++ return; ++ ++ if (es->num_entries < 3) ++ goto free_es; ++ ++ ep += 2; ++ ++ /* ++ * First entry : file entry ++ * Second entry : stream-extension entry ++ * Third entry : first file-name entry ++ * So, the index of first file-name dentry should start from 2. ++ */ ++ for (i = 2; i < es->num_entries; i++, ep++) { ++ /* end of name entry */ ++ if (exfat_get_entry_type(ep) != TYPE_EXTEND) ++ goto free_es; ++ ++ exfat_extract_uni_name(ep, uniname); ++ uniname += EXFAT_FILE_NAME_LEN; ++ } ++ ++free_es: ++ kfree(es); ++} ++ ++/* read a directory entry from the opened directory */ ++static int exfat_readdir(struct inode *inode, struct exfat_dir_entry *dir_entry) ++{ ++ int i, dentries_per_clu, dentries_per_clu_bits = 0; ++ unsigned int type, clu_offset; ++ sector_t sector; ++ struct exfat_chain dir, clu; ++ struct exfat_uni_name uni_name; ++ struct exfat_dentry *ep; ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ unsigned int dentry = ei->rwoffset & 0xFFFFFFFF; ++ struct buffer_head *bh; ++ ++ /* check if the given file ID is opened */ ++ if (ei->type != TYPE_DIR) ++ return -EPERM; ++ ++ if (ei->entry == -1) ++ exfat_chain_set(&dir, sbi->root_dir, 0, ALLOC_FAT_CHAIN); ++ else ++ exfat_chain_set(&dir, ei->start_clu, ++ EXFAT_B_TO_CLU(i_size_read(inode), sbi), ei->flags); ++ ++ dentries_per_clu = sbi->dentries_per_clu; ++ dentries_per_clu_bits = ilog2(dentries_per_clu); ++ ++ clu_offset = dentry >> dentries_per_clu_bits; ++ exfat_chain_dup(&clu, &dir); ++ ++ if (clu.flags == ALLOC_NO_FAT_CHAIN) { ++ clu.dir += clu_offset; ++ clu.size -= clu_offset; ++ } else { ++ /* hint_information */ ++ if (clu_offset > 0 && ei->hint_bmap.off != EXFAT_EOF_CLUSTER && ++ ei->hint_bmap.off > 0 && clu_offset >= ei->hint_bmap.off) { ++ clu_offset -= ei->hint_bmap.off; ++ clu.dir = ei->hint_bmap.clu; ++ } ++ ++ while (clu_offset > 0) { ++ if (exfat_get_next_cluster(sb, &(clu.dir))) ++ return -EIO; ++ ++ clu_offset--; ++ } ++ } ++ ++ while (clu.dir != EXFAT_EOF_CLUSTER) { ++ i = dentry & (dentries_per_clu - 1); ++ ++ for ( ; i < dentries_per_clu; i++, dentry++) { ++ ep = exfat_get_dentry(sb, &clu, i, &bh, §or); ++ if (!ep) ++ return -EIO; ++ ++ type = exfat_get_entry_type(ep); ++ if (type == TYPE_UNUSED) { ++ brelse(bh); ++ break; ++ } ++ ++ if (type != TYPE_FILE && type != TYPE_DIR) { ++ brelse(bh); ++ continue; ++ } ++ ++ dir_entry->attr = le16_to_cpu(ep->dentry.file.attr); ++ exfat_get_entry_time(sbi, &dir_entry->crtime, ++ ep->dentry.file.create_tz, ++ ep->dentry.file.create_time, ++ ep->dentry.file.create_date, ++ ep->dentry.file.create_time_ms); ++ exfat_get_entry_time(sbi, &dir_entry->mtime, ++ ep->dentry.file.modify_tz, ++ ep->dentry.file.modify_time, ++ ep->dentry.file.modify_date, ++ ep->dentry.file.modify_time_ms); ++ exfat_get_entry_time(sbi, &dir_entry->atime, ++ ep->dentry.file.access_tz, ++ ep->dentry.file.access_time, ++ ep->dentry.file.access_date, ++ 0); ++ ++ *uni_name.name = 0x0; ++ exfat_get_uniname_from_ext_entry(sb, &dir, dentry, ++ uni_name.name); ++ exfat_utf16_to_nls(sb, &uni_name, ++ dir_entry->namebuf.lfn, ++ dir_entry->namebuf.lfnbuf_len); ++ brelse(bh); ++ ++ ep = exfat_get_dentry(sb, &clu, i + 1, &bh, NULL); ++ if (!ep) ++ return -EIO; ++ dir_entry->size = ++ le64_to_cpu(ep->dentry.stream.valid_size); ++ brelse(bh); ++ ++ ei->hint_bmap.off = dentry >> dentries_per_clu_bits; ++ ei->hint_bmap.clu = clu.dir; ++ ++ ei->rwoffset = ++dentry; ++ return 0; ++ } ++ ++ if (clu.flags == ALLOC_NO_FAT_CHAIN) { ++ if (--clu.size > 0) ++ clu.dir++; ++ else ++ clu.dir = EXFAT_EOF_CLUSTER; ++ } else { ++ if (exfat_get_next_cluster(sb, &(clu.dir))) ++ return -EIO; ++ } ++ } ++ ++ dir_entry->namebuf.lfn[0] = '\0'; ++ ei->rwoffset = dentry; ++ return 0; ++} ++ ++static void exfat_init_namebuf(struct exfat_dentry_namebuf *nb) ++{ ++ nb->lfn = NULL; ++ nb->lfnbuf_len = 0; ++} ++ ++static int exfat_alloc_namebuf(struct exfat_dentry_namebuf *nb) ++{ ++ nb->lfn = __getname(); ++ if (!nb->lfn) ++ return -ENOMEM; ++ nb->lfnbuf_len = MAX_VFSNAME_BUF_SIZE; ++ return 0; ++} ++ ++static void exfat_free_namebuf(struct exfat_dentry_namebuf *nb) ++{ ++ if (!nb->lfn) ++ return; ++ ++ __putname(nb->lfn); ++ exfat_init_namebuf(nb); ++} ++ ++/* skip iterating emit_dots when dir is empty */ ++#define ITER_POS_FILLED_DOTS (2) ++static int exfat_iterate(struct file *filp, struct dir_context *ctx) ++{ ++ struct inode *inode = filp->f_path.dentry->d_inode; ++ struct super_block *sb = inode->i_sb; ++ struct inode *tmp; ++ struct exfat_dir_entry de; ++ struct exfat_dentry_namebuf *nb = &(de.namebuf); ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ unsigned long inum; ++ loff_t cpos, i_pos; ++ int err = 0, fake_offset = 0; ++ ++ exfat_init_namebuf(nb); ++ mutex_lock(&EXFAT_SB(sb)->s_lock); ++ ++ cpos = ctx->pos; ++ if (!dir_emit_dots(filp, ctx)) ++ goto unlock; ++ ++ if (ctx->pos == ITER_POS_FILLED_DOTS) { ++ cpos = 0; ++ fake_offset = 1; ++ } ++ ++ if (cpos & (DENTRY_SIZE - 1)) { ++ err = -ENOENT; ++ goto unlock; ++ } ++ ++ /* name buffer should be allocated before use */ ++ err = exfat_alloc_namebuf(nb); ++ if (err) ++ goto unlock; ++get_new: ++ ei->rwoffset = EXFAT_B_TO_DEN(cpos); ++ ++ if (cpos >= i_size_read(inode)) ++ goto end_of_dir; ++ ++ err = exfat_readdir(inode, &de); ++ if (err) { ++ /* ++ * At least we tried to read a sector. Move cpos to next sector ++ * position (should be aligned). ++ */ ++ if (err == -EIO) { ++ cpos += 1 << (sb->s_blocksize_bits); ++ cpos &= ~(sb->s_blocksize - 1); ++ } ++ ++ err = -EIO; ++ goto end_of_dir; ++ } ++ ++ cpos = EXFAT_DEN_TO_B(ei->rwoffset); ++ ++ if (!nb->lfn[0]) ++ goto end_of_dir; ++ ++ i_pos = ((loff_t)ei->start_clu << 32) | ++ ((ei->rwoffset - 1) & 0xffffffff); ++ tmp = exfat_iget(sb, i_pos); ++ if (tmp) { ++ inum = tmp->i_ino; ++ iput(tmp); ++ } else { ++ inum = iunique(sb, EXFAT_ROOT_INO); ++ } ++ ++ /* ++ * Before calling dir_emit(), sb_lock should be released. ++ * Because page fault can occur in dir_emit() when the size ++ * of buffer given from user is larger than one page size. ++ */ ++ mutex_unlock(&EXFAT_SB(sb)->s_lock); ++ if (!dir_emit(ctx, nb->lfn, strlen(nb->lfn), inum, ++ (de.attr & ATTR_SUBDIR) ? DT_DIR : DT_REG)) ++ goto out_unlocked; ++ mutex_lock(&EXFAT_SB(sb)->s_lock); ++ ctx->pos = cpos; ++ goto get_new; ++ ++end_of_dir: ++ if (!cpos && fake_offset) ++ cpos = ITER_POS_FILLED_DOTS; ++ ctx->pos = cpos; ++unlock: ++ mutex_unlock(&EXFAT_SB(sb)->s_lock); ++out_unlocked: ++ /* ++ * To improve performance, free namebuf after unlock sb_lock. ++ * If namebuf is not allocated, this function do nothing ++ */ ++ exfat_free_namebuf(nb); ++ return err; ++} ++ ++const struct file_operations exfat_dir_operations = { ++ .llseek = generic_file_llseek, ++ .read = generic_read_dir, ++ .iterate = exfat_iterate, ++ .fsync = generic_file_fsync, ++}; ++ ++int exfat_alloc_new_dir(struct inode *inode, struct exfat_chain *clu) ++{ ++ int ret; ++ ++ exfat_chain_set(clu, EXFAT_EOF_CLUSTER, 0, ALLOC_NO_FAT_CHAIN); ++ ++ ret = exfat_alloc_cluster(inode, 1, clu); ++ if (ret) ++ return ret; ++ ++ return exfat_zeroed_cluster(inode, clu->dir); ++} ++ ++int exfat_calc_num_entries(struct exfat_uni_name *p_uniname) ++{ ++ int len; ++ ++ len = p_uniname->name_len; ++ if (len == 0) ++ return -EINVAL; ++ ++ /* 1 file entry + 1 stream entry + name entries */ ++ return ((len - 1) / EXFAT_FILE_NAME_LEN + 3); ++} ++ ++unsigned int exfat_get_entry_type(struct exfat_dentry *ep) ++{ ++ if (ep->type == EXFAT_UNUSED) ++ return TYPE_UNUSED; ++ if (IS_EXFAT_DELETED(ep->type)) ++ return TYPE_DELETED; ++ if (ep->type == EXFAT_INVAL) ++ return TYPE_INVALID; ++ if (IS_EXFAT_CRITICAL_PRI(ep->type)) { ++ if (ep->type == EXFAT_BITMAP) ++ return TYPE_BITMAP; ++ if (ep->type == EXFAT_UPCASE) ++ return TYPE_UPCASE; ++ if (ep->type == EXFAT_VOLUME) ++ return TYPE_VOLUME; ++ if (ep->type == EXFAT_FILE) { ++ if (le16_to_cpu(ep->dentry.file.attr) & ATTR_SUBDIR) ++ return TYPE_DIR; ++ return TYPE_FILE; ++ } ++ return TYPE_CRITICAL_PRI; ++ } ++ if (IS_EXFAT_BENIGN_PRI(ep->type)) { ++ if (ep->type == EXFAT_GUID) ++ return TYPE_GUID; ++ if (ep->type == EXFAT_PADDING) ++ return TYPE_PADDING; ++ if (ep->type == EXFAT_ACLTAB) ++ return TYPE_ACLTAB; ++ return TYPE_BENIGN_PRI; ++ } ++ if (IS_EXFAT_CRITICAL_SEC(ep->type)) { ++ if (ep->type == EXFAT_STREAM) ++ return TYPE_STREAM; ++ if (ep->type == EXFAT_NAME) ++ return TYPE_EXTEND; ++ if (ep->type == EXFAT_ACL) ++ return TYPE_ACL; ++ return TYPE_CRITICAL_SEC; ++ } ++ return TYPE_BENIGN_SEC; ++} ++ ++static void exfat_set_entry_type(struct exfat_dentry *ep, unsigned int type) ++{ ++ if (type == TYPE_UNUSED) { ++ ep->type = EXFAT_UNUSED; ++ } else if (type == TYPE_DELETED) { ++ ep->type &= EXFAT_DELETE; ++ } else if (type == TYPE_STREAM) { ++ ep->type = EXFAT_STREAM; ++ } else if (type == TYPE_EXTEND) { ++ ep->type = EXFAT_NAME; ++ } else if (type == TYPE_BITMAP) { ++ ep->type = EXFAT_BITMAP; ++ } else if (type == TYPE_UPCASE) { ++ ep->type = EXFAT_UPCASE; ++ } else if (type == TYPE_VOLUME) { ++ ep->type = EXFAT_VOLUME; ++ } else if (type == TYPE_DIR) { ++ ep->type = EXFAT_FILE; ++ ep->dentry.file.attr = cpu_to_le16(ATTR_SUBDIR); ++ } else if (type == TYPE_FILE) { ++ ep->type = EXFAT_FILE; ++ ep->dentry.file.attr = cpu_to_le16(ATTR_ARCHIVE); ++ } ++} ++ ++static void exfat_init_stream_entry(struct exfat_dentry *ep, ++ unsigned char flags, unsigned int start_clu, ++ unsigned long long size) ++{ ++ exfat_set_entry_type(ep, TYPE_STREAM); ++ ep->dentry.stream.flags = flags; ++ ep->dentry.stream.start_clu = cpu_to_le32(start_clu); ++ ep->dentry.stream.valid_size = cpu_to_le64(size); ++ ep->dentry.stream.size = cpu_to_le64(size); ++} ++ ++static void exfat_init_name_entry(struct exfat_dentry *ep, ++ unsigned short *uniname) ++{ ++ int i; ++ ++ exfat_set_entry_type(ep, TYPE_EXTEND); ++ ep->dentry.name.flags = 0x0; ++ ++ for (i = 0; i < EXFAT_FILE_NAME_LEN; i++) { ++ ep->dentry.name.unicode_0_14[i] = cpu_to_le16(*uniname); ++ if (*uniname == 0x0) ++ break; ++ uniname++; ++ } ++} ++ ++int exfat_init_dir_entry(struct inode *inode, struct exfat_chain *p_dir, ++ int entry, unsigned int type, unsigned int start_clu, ++ unsigned long long size) ++{ ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct timespec64 ts = current_time(inode); ++ sector_t sector; ++ struct exfat_dentry *ep; ++ struct buffer_head *bh; ++ ++ /* ++ * We cannot use exfat_get_dentry_set here because file ep is not ++ * initialized yet. ++ */ ++ ep = exfat_get_dentry(sb, p_dir, entry, &bh, §or); ++ if (!ep) ++ return -EIO; ++ ++ exfat_set_entry_type(ep, type); ++ exfat_set_entry_time(sbi, &ts, ++ &ep->dentry.file.create_tz, ++ &ep->dentry.file.create_time, ++ &ep->dentry.file.create_date, ++ &ep->dentry.file.create_time_ms); ++ exfat_set_entry_time(sbi, &ts, ++ &ep->dentry.file.modify_tz, ++ &ep->dentry.file.modify_time, ++ &ep->dentry.file.modify_date, ++ &ep->dentry.file.modify_time_ms); ++ exfat_set_entry_time(sbi, &ts, ++ &ep->dentry.file.access_tz, ++ &ep->dentry.file.access_time, ++ &ep->dentry.file.access_date, ++ NULL); ++ ++ exfat_update_bh(sb, bh, IS_DIRSYNC(inode)); ++ brelse(bh); ++ ++ ep = exfat_get_dentry(sb, p_dir, entry + 1, &bh, §or); ++ if (!ep) ++ return -EIO; ++ ++ exfat_init_stream_entry(ep, ++ (type == TYPE_FILE) ? ALLOC_FAT_CHAIN : ALLOC_NO_FAT_CHAIN, ++ start_clu, size); ++ exfat_update_bh(sb, bh, IS_DIRSYNC(inode)); ++ brelse(bh); ++ ++ return 0; ++} ++ ++int exfat_update_dir_chksum(struct inode *inode, struct exfat_chain *p_dir, ++ int entry) ++{ ++ struct super_block *sb = inode->i_sb; ++ int ret = 0; ++ int i, num_entries; ++ sector_t sector; ++ unsigned short chksum; ++ struct exfat_dentry *ep, *fep; ++ struct buffer_head *fbh, *bh; ++ ++ fep = exfat_get_dentry(sb, p_dir, entry, &fbh, §or); ++ if (!fep) ++ return -EIO; ++ ++ num_entries = fep->dentry.file.num_ext + 1; ++ chksum = exfat_calc_chksum_2byte(fep, DENTRY_SIZE, 0, CS_DIR_ENTRY); ++ ++ for (i = 1; i < num_entries; i++) { ++ ep = exfat_get_dentry(sb, p_dir, entry + i, &bh, NULL); ++ if (!ep) { ++ ret = -EIO; ++ goto release_fbh; ++ } ++ chksum = exfat_calc_chksum_2byte(ep, DENTRY_SIZE, chksum, ++ CS_DEFAULT); ++ brelse(bh); ++ } ++ ++ fep->dentry.file.checksum = cpu_to_le16(chksum); ++ exfat_update_bh(sb, fbh, IS_DIRSYNC(inode)); ++release_fbh: ++ brelse(fbh); ++ return ret; ++} ++ ++int exfat_init_ext_entry(struct inode *inode, struct exfat_chain *p_dir, ++ int entry, int num_entries, struct exfat_uni_name *p_uniname) ++{ ++ struct super_block *sb = inode->i_sb; ++ int i; ++ sector_t sector; ++ unsigned short *uniname = p_uniname->name; ++ struct exfat_dentry *ep; ++ struct buffer_head *bh; ++ int sync = IS_DIRSYNC(inode); ++ ++ ep = exfat_get_dentry(sb, p_dir, entry, &bh, §or); ++ if (!ep) ++ return -EIO; ++ ++ ep->dentry.file.num_ext = (unsigned char)(num_entries - 1); ++ exfat_update_bh(sb, bh, sync); ++ brelse(bh); ++ ++ ep = exfat_get_dentry(sb, p_dir, entry + 1, &bh, §or); ++ if (!ep) ++ return -EIO; ++ ++ ep->dentry.stream.name_len = p_uniname->name_len; ++ ep->dentry.stream.name_hash = cpu_to_le16(p_uniname->name_hash); ++ exfat_update_bh(sb, bh, sync); ++ brelse(bh); ++ ++ for (i = EXFAT_FIRST_CLUSTER; i < num_entries; i++) { ++ ep = exfat_get_dentry(sb, p_dir, entry + i, &bh, §or); ++ if (!ep) ++ return -EIO; ++ ++ exfat_init_name_entry(ep, uniname); ++ exfat_update_bh(sb, bh, sync); ++ brelse(bh); ++ uniname += EXFAT_FILE_NAME_LEN; ++ } ++ ++ exfat_update_dir_chksum(inode, p_dir, entry); ++ return 0; ++} ++ ++int exfat_remove_entries(struct inode *inode, struct exfat_chain *p_dir, ++ int entry, int order, int num_entries) ++{ ++ struct super_block *sb = inode->i_sb; ++ int i; ++ sector_t sector; ++ struct exfat_dentry *ep; ++ struct buffer_head *bh; ++ ++ for (i = order; i < num_entries; i++) { ++ ep = exfat_get_dentry(sb, p_dir, entry + i, &bh, §or); ++ if (!ep) ++ return -EIO; ++ ++ exfat_set_entry_type(ep, TYPE_DELETED); ++ exfat_update_bh(sb, bh, IS_DIRSYNC(inode)); ++ brelse(bh); ++ } ++ ++ return 0; ++} ++ ++int exfat_update_dir_chksum_with_entry_set(struct super_block *sb, ++ struct exfat_entry_set_cache *es, int sync) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct buffer_head *bh; ++ sector_t sec = es->sector; ++ unsigned int off = es->offset; ++ int chksum_type = CS_DIR_ENTRY, i, num_entries = es->num_entries; ++ unsigned int buf_off = (off - es->offset); ++ unsigned int remaining_byte_in_sector, copy_entries, clu; ++ unsigned short chksum = 0; ++ ++ for (i = 0; i < num_entries; i++) { ++ chksum = exfat_calc_chksum_2byte(&es->entries[i], DENTRY_SIZE, ++ chksum, chksum_type); ++ chksum_type = CS_DEFAULT; ++ } ++ ++ es->entries[0].dentry.file.checksum = cpu_to_le16(chksum); ++ ++ while (num_entries) { ++ /* write per sector base */ ++ remaining_byte_in_sector = (1 << sb->s_blocksize_bits) - off; ++ copy_entries = min_t(int, ++ EXFAT_B_TO_DEN(remaining_byte_in_sector), ++ num_entries); ++ bh = sb_bread(sb, sec); ++ if (!bh) ++ goto err_out; ++ memcpy(bh->b_data + off, ++ (unsigned char *)&es->entries[0] + buf_off, ++ EXFAT_DEN_TO_B(copy_entries)); ++ exfat_update_bh(sb, bh, sync); ++ brelse(bh); ++ num_entries -= copy_entries; ++ ++ if (num_entries) { ++ /* get next sector */ ++ if (exfat_is_last_sector_in_cluster(sbi, sec)) { ++ clu = exfat_sector_to_cluster(sbi, sec); ++ if (es->alloc_flag == ALLOC_NO_FAT_CHAIN) ++ clu++; ++ else if (exfat_get_next_cluster(sb, &clu)) ++ goto err_out; ++ sec = exfat_cluster_to_sector(sbi, clu); ++ } else { ++ sec++; ++ } ++ off = 0; ++ buf_off += EXFAT_DEN_TO_B(copy_entries); ++ } ++ } ++ ++ return 0; ++err_out: ++ return -EIO; ++} ++ ++static int exfat_walk_fat_chain(struct super_block *sb, ++ struct exfat_chain *p_dir, unsigned int byte_offset, ++ unsigned int *clu) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ unsigned int clu_offset; ++ unsigned int cur_clu; ++ ++ clu_offset = EXFAT_B_TO_CLU(byte_offset, sbi); ++ cur_clu = p_dir->dir; ++ ++ if (p_dir->flags == ALLOC_NO_FAT_CHAIN) { ++ cur_clu += clu_offset; ++ } else { ++ while (clu_offset > 0) { ++ if (exfat_get_next_cluster(sb, &cur_clu)) ++ return -EIO; ++ if (cur_clu == EXFAT_EOF_CLUSTER) { ++ exfat_fs_error(sb, ++ "invalid dentry access beyond EOF (clu : %u, eidx : %d)", ++ p_dir->dir, ++ EXFAT_B_TO_DEN(byte_offset)); ++ return -EIO; ++ } ++ clu_offset--; ++ } ++ } ++ ++ *clu = cur_clu; ++ return 0; ++} ++ ++int exfat_find_location(struct super_block *sb, struct exfat_chain *p_dir, ++ int entry, sector_t *sector, int *offset) ++{ ++ int ret; ++ unsigned int off, clu = 0; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ ++ off = EXFAT_DEN_TO_B(entry); ++ ++ ret = exfat_walk_fat_chain(sb, p_dir, off, &clu); ++ if (ret) ++ return ret; ++ ++ /* byte offset in cluster */ ++ off = EXFAT_CLU_OFFSET(off, sbi); ++ ++ /* byte offset in sector */ ++ *offset = EXFAT_BLK_OFFSET(off, sb); ++ ++ /* sector offset in cluster */ ++ *sector = EXFAT_B_TO_BLK(off, sb); ++ *sector += exfat_cluster_to_sector(sbi, clu); ++ return 0; ++} ++ ++#define EXFAT_MAX_RA_SIZE (128*1024) ++static int exfat_dir_readahead(struct super_block *sb, sector_t sec) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct buffer_head *bh; ++ unsigned int max_ra_count = EXFAT_MAX_RA_SIZE >> sb->s_blocksize_bits; ++ unsigned int page_ra_count = PAGE_SIZE >> sb->s_blocksize_bits; ++ unsigned int adj_ra_count = max(sbi->sect_per_clus, page_ra_count); ++ unsigned int ra_count = min(adj_ra_count, max_ra_count); ++ ++ /* Read-ahead is not required */ ++ if (sbi->sect_per_clus == 1) ++ return 0; ++ ++ if (sec < sbi->data_start_sector) { ++ exfat_msg(sb, KERN_ERR, ++ "requested sector is invalid(sect:%llu, root:%llu)", ++ (unsigned long long)sec, sbi->data_start_sector); ++ return -EIO; ++ } ++ ++ /* Not sector aligned with ra_count, resize ra_count to page size */ ++ if ((sec - sbi->data_start_sector) & (ra_count - 1)) ++ ra_count = page_ra_count; ++ ++ bh = sb_find_get_block(sb, sec); ++ if (!bh || !buffer_uptodate(bh)) { ++ unsigned int i; ++ ++ for (i = 0; i < ra_count; i++) ++ sb_breadahead(sb, (sector_t)(sec + i)); ++ } ++ brelse(bh); ++ return 0; ++} ++ ++struct exfat_dentry *exfat_get_dentry(struct super_block *sb, ++ struct exfat_chain *p_dir, int entry, struct buffer_head **bh, ++ sector_t *sector) ++{ ++ unsigned int dentries_per_page = EXFAT_B_TO_DEN(PAGE_SIZE); ++ int off; ++ sector_t sec; ++ ++ if (p_dir->dir == DIR_DELETED) { ++ exfat_msg(sb, KERN_ERR, "abnormal access to deleted dentry\n"); ++ return NULL; ++ } ++ ++ if (exfat_find_location(sb, p_dir, entry, &sec, &off)) ++ return NULL; ++ ++ if (p_dir->dir != EXFAT_FREE_CLUSTER && ++ !(entry & (dentries_per_page - 1))) ++ exfat_dir_readahead(sb, sec); ++ ++ *bh = sb_bread(sb, sec); ++ if (!*bh) ++ return NULL; ++ ++ if (sector) ++ *sector = sec; ++ return (struct exfat_dentry *)((*bh)->b_data + off); ++} ++ ++enum exfat_validate_dentry_mode { ++ ES_MODE_STARTED, ++ ES_MODE_GET_FILE_ENTRY, ++ ES_MODE_GET_STRM_ENTRY, ++ ES_MODE_GET_NAME_ENTRY, ++ ES_MODE_GET_CRITICAL_SEC_ENTRY, ++}; ++ ++static bool exfat_validate_entry(unsigned int type, ++ enum exfat_validate_dentry_mode *mode) ++{ ++ if (type == TYPE_UNUSED || type == TYPE_DELETED) ++ return false; ++ ++ switch (*mode) { ++ case ES_MODE_STARTED: ++ if (type != TYPE_FILE && type != TYPE_DIR) ++ return false; ++ *mode = ES_MODE_GET_FILE_ENTRY; ++ return true; ++ case ES_MODE_GET_FILE_ENTRY: ++ if (type != TYPE_STREAM) ++ return false; ++ *mode = ES_MODE_GET_STRM_ENTRY; ++ return true; ++ case ES_MODE_GET_STRM_ENTRY: ++ if (type != TYPE_EXTEND) ++ return false; ++ *mode = ES_MODE_GET_NAME_ENTRY; ++ return true; ++ case ES_MODE_GET_NAME_ENTRY: ++ if (type == TYPE_STREAM) ++ return false; ++ if (type != TYPE_EXTEND) { ++ if (!(type & TYPE_CRITICAL_SEC)) ++ return false; ++ *mode = ES_MODE_GET_CRITICAL_SEC_ENTRY; ++ } ++ return true; ++ case ES_MODE_GET_CRITICAL_SEC_ENTRY: ++ if (type == TYPE_EXTEND || type == TYPE_STREAM) ++ return false; ++ if ((type & TYPE_CRITICAL_SEC) != TYPE_CRITICAL_SEC) ++ return false; ++ return true; ++ default: ++ WARN_ON_ONCE(1); ++ return false; ++ } ++} ++ ++/* ++ * Returns a set of dentries for a file or dir. ++ * ++ * Note that this is a copy (dump) of dentries so that user should ++ * call write_entry_set() to apply changes made in this entry set ++ * to the real device. ++ * ++ * in: ++ * sb+p_dir+entry: indicates a file/dir ++ * type: specifies how many dentries should be included. ++ * out: ++ * file_ep: will point the first dentry(= file dentry) on success ++ * return: ++ * pointer of entry set on success, ++ * NULL on failure. ++ */ ++struct exfat_entry_set_cache *exfat_get_dentry_set(struct super_block *sb, ++ struct exfat_chain *p_dir, int entry, unsigned int type, ++ struct exfat_dentry **file_ep) ++{ ++ int ret; ++ unsigned int off, byte_offset, clu = 0; ++ unsigned int entry_type; ++ sector_t sec; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_entry_set_cache *es; ++ struct exfat_dentry *ep, *pos; ++ unsigned char num_entries; ++ enum exfat_validate_dentry_mode mode = ES_MODE_STARTED; ++ struct buffer_head *bh; ++ ++ if (p_dir->dir == DIR_DELETED) { ++ exfat_msg(sb, KERN_ERR, "access to deleted dentry\n"); ++ return NULL; ++ } ++ ++ byte_offset = EXFAT_DEN_TO_B(entry); ++ ret = exfat_walk_fat_chain(sb, p_dir, byte_offset, &clu); ++ if (ret) ++ return NULL; ++ ++ /* byte offset in cluster */ ++ byte_offset = EXFAT_CLU_OFFSET(byte_offset, sbi); ++ ++ /* byte offset in sector */ ++ off = EXFAT_BLK_OFFSET(byte_offset, sb); ++ ++ /* sector offset in cluster */ ++ sec = EXFAT_B_TO_BLK(byte_offset, sb); ++ sec += exfat_cluster_to_sector(sbi, clu); ++ ++ bh = sb_bread(sb, sec); ++ if (!bh) ++ return NULL; ++ ++ ep = (struct exfat_dentry *)(bh->b_data + off); ++ entry_type = exfat_get_entry_type(ep); ++ ++ if (entry_type != TYPE_FILE && entry_type != TYPE_DIR) ++ goto release_bh; ++ ++ num_entries = type == ES_ALL_ENTRIES ? ++ ep->dentry.file.num_ext + 1 : type; ++ es = kmalloc(struct_size(es, entries, num_entries), GFP_KERNEL); ++ if (!es) ++ goto release_bh; ++ ++ es->num_entries = num_entries; ++ es->sector = sec; ++ es->offset = off; ++ es->alloc_flag = p_dir->flags; ++ ++ pos = &es->entries[0]; ++ ++ while (num_entries) { ++ if (!exfat_validate_entry(exfat_get_entry_type(ep), &mode)) ++ goto free_es; ++ ++ /* copy dentry */ ++ memcpy(pos, ep, sizeof(struct exfat_dentry)); ++ ++ if (--num_entries == 0) ++ break; ++ ++ if (((off + DENTRY_SIZE) & (sb->s_blocksize - 1)) < ++ (off & (sb->s_blocksize - 1))) { ++ /* get the next sector */ ++ if (exfat_is_last_sector_in_cluster(sbi, sec)) { ++ if (es->alloc_flag == ALLOC_NO_FAT_CHAIN) ++ clu++; ++ else if (exfat_get_next_cluster(sb, &clu)) ++ goto free_es; ++ sec = exfat_cluster_to_sector(sbi, clu); ++ } else { ++ sec++; ++ } ++ ++ brelse(bh); ++ bh = sb_bread(sb, sec); ++ if (!bh) ++ goto free_es; ++ off = 0; ++ ep = (struct exfat_dentry *)bh->b_data; ++ } else { ++ ep++; ++ off += DENTRY_SIZE; ++ } ++ pos++; ++ } ++ ++ if (file_ep) ++ *file_ep = &es->entries[0]; ++ brelse(bh); ++ return es; ++ ++free_es: ++ kfree(es); ++release_bh: ++ brelse(bh); ++ return NULL; ++} ++ ++enum { ++ DIRENT_STEP_FILE, ++ DIRENT_STEP_STRM, ++ DIRENT_STEP_NAME, ++ DIRENT_STEP_SECD, ++}; ++ ++/* ++ * return values: ++ * >= 0 : return dir entiry position with the name in dir ++ * -EEXIST : (root dir, ".") it is the root dir itself ++ * -ENOENT : entry with the name does not exist ++ * -EIO : I/O error ++ */ ++int exfat_find_dir_entry(struct super_block *sb, struct exfat_inode_info *ei, ++ struct exfat_chain *p_dir, struct exfat_uni_name *p_uniname, ++ int num_entries, unsigned int type) ++{ ++ int i, rewind = 0, dentry = 0, end_eidx = 0, num_ext = 0, len; ++ int order, step, name_len = 0; ++ int dentries_per_clu, num_empty = 0; ++ unsigned int entry_type; ++ unsigned short *uniname = NULL; ++ struct exfat_chain clu; ++ struct exfat_hint *hint_stat = &ei->hint_stat; ++ struct exfat_hint_femp candi_empty; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ ++ dentries_per_clu = sbi->dentries_per_clu; ++ ++ exfat_chain_dup(&clu, p_dir); ++ ++ if (hint_stat->eidx) { ++ clu.dir = hint_stat->clu; ++ dentry = hint_stat->eidx; ++ end_eidx = dentry; ++ } ++ ++ candi_empty.eidx = EXFAT_HINT_NONE; ++rewind: ++ order = 0; ++ step = DIRENT_STEP_FILE; ++ while (clu.dir != EXFAT_EOF_CLUSTER) { ++ i = dentry & (dentries_per_clu - 1); ++ for (; i < dentries_per_clu; i++, dentry++) { ++ struct exfat_dentry *ep; ++ struct buffer_head *bh; ++ ++ if (rewind && dentry == end_eidx) ++ goto not_found; ++ ++ ep = exfat_get_dentry(sb, &clu, i, &bh, NULL); ++ if (!ep) ++ return -EIO; ++ ++ entry_type = exfat_get_entry_type(ep); ++ ++ if (entry_type == TYPE_UNUSED || ++ entry_type == TYPE_DELETED) { ++ step = DIRENT_STEP_FILE; ++ ++ num_empty++; ++ if (candi_empty.eidx == EXFAT_HINT_NONE && ++ num_empty == 1) { ++ exfat_chain_set(&candi_empty.cur, ++ clu.dir, clu.size, clu.flags); ++ } ++ ++ if (candi_empty.eidx == EXFAT_HINT_NONE && ++ num_empty >= num_entries) { ++ candi_empty.eidx = ++ dentry - (num_empty - 1); ++ WARN_ON(candi_empty.eidx < 0); ++ candi_empty.count = num_empty; ++ ++ if (ei->hint_femp.eidx == ++ EXFAT_HINT_NONE || ++ candi_empty.eidx <= ++ ei->hint_femp.eidx) { ++ memcpy(&ei->hint_femp, ++ &candi_empty, ++ sizeof(candi_empty)); ++ } ++ } ++ ++ brelse(bh); ++ if (entry_type == TYPE_UNUSED) ++ goto not_found; ++ continue; ++ } ++ ++ num_empty = 0; ++ candi_empty.eidx = EXFAT_HINT_NONE; ++ ++ if (entry_type == TYPE_FILE || entry_type == TYPE_DIR) { ++ step = DIRENT_STEP_FILE; ++ if (type == TYPE_ALL || type == entry_type) { ++ num_ext = ep->dentry.file.num_ext; ++ step = DIRENT_STEP_STRM; ++ } ++ brelse(bh); ++ continue; ++ } ++ ++ if (entry_type == TYPE_STREAM) { ++ unsigned short name_hash; ++ ++ if (step != DIRENT_STEP_STRM) { ++ step = DIRENT_STEP_FILE; ++ brelse(bh); ++ continue; ++ } ++ step = DIRENT_STEP_FILE; ++ name_hash = le16_to_cpu( ++ ep->dentry.stream.name_hash); ++ if (p_uniname->name_hash == name_hash && ++ p_uniname->name_len == ++ ep->dentry.stream.name_len) { ++ step = DIRENT_STEP_NAME; ++ order = 1; ++ name_len = 0; ++ } ++ brelse(bh); ++ continue; ++ } ++ ++ brelse(bh); ++ if (entry_type == TYPE_EXTEND) { ++ unsigned short entry_uniname[16], unichar; ++ ++ if (step != DIRENT_STEP_NAME) { ++ step = DIRENT_STEP_FILE; ++ continue; ++ } ++ ++ if (++order == 2) ++ uniname = p_uniname->name; ++ else ++ uniname += EXFAT_FILE_NAME_LEN; ++ ++ len = exfat_extract_uni_name(ep, entry_uniname); ++ name_len += len; ++ ++ unichar = *(uniname+len); ++ *(uniname+len) = 0x0; ++ ++ if (exfat_uniname_ncmp(sb, uniname, ++ entry_uniname, len)) { ++ step = DIRENT_STEP_FILE; ++ } else if (p_uniname->name_len == name_len) { ++ if (order == num_ext) ++ goto found; ++ step = DIRENT_STEP_SECD; ++ } ++ ++ *(uniname+len) = unichar; ++ continue; ++ } ++ ++ if (entry_type & ++ (TYPE_CRITICAL_SEC | TYPE_BENIGN_SEC)) { ++ if (step == DIRENT_STEP_SECD) { ++ if (++order == num_ext) ++ goto found; ++ continue; ++ } ++ } ++ step = DIRENT_STEP_FILE; ++ } ++ ++ if (clu.flags == ALLOC_NO_FAT_CHAIN) { ++ if (--clu.size > 0) ++ clu.dir++; ++ else ++ clu.dir = EXFAT_EOF_CLUSTER; ++ } else { ++ if (exfat_get_next_cluster(sb, &clu.dir)) ++ return -EIO; ++ } ++ } ++ ++not_found: ++ /* ++ * We started at not 0 index,so we should try to find target ++ * from 0 index to the index we started at. ++ */ ++ if (!rewind && end_eidx) { ++ rewind = 1; ++ dentry = 0; ++ clu.dir = p_dir->dir; ++ /* reset empty hint */ ++ num_empty = 0; ++ candi_empty.eidx = EXFAT_HINT_NONE; ++ goto rewind; ++ } ++ ++ /* initialized hint_stat */ ++ hint_stat->clu = p_dir->dir; ++ hint_stat->eidx = 0; ++ return -ENOENT; ++ ++found: ++ /* next dentry we'll find is out of this cluster */ ++ if (!((dentry + 1) & (dentries_per_clu - 1))) { ++ int ret = 0; ++ ++ if (clu.flags == ALLOC_NO_FAT_CHAIN) { ++ if (--clu.size > 0) ++ clu.dir++; ++ else ++ clu.dir = EXFAT_EOF_CLUSTER; ++ } else { ++ ret = exfat_get_next_cluster(sb, &clu.dir); ++ } ++ ++ if (ret || clu.dir != EXFAT_EOF_CLUSTER) { ++ /* just initialized hint_stat */ ++ hint_stat->clu = p_dir->dir; ++ hint_stat->eidx = 0; ++ return (dentry - num_ext); ++ } ++ } ++ ++ hint_stat->clu = clu.dir; ++ hint_stat->eidx = dentry + 1; ++ return dentry - num_ext; ++} ++ ++int exfat_count_ext_entries(struct super_block *sb, struct exfat_chain *p_dir, ++ int entry, struct exfat_dentry *ep) ++{ ++ int i, count = 0; ++ unsigned int type; ++ struct exfat_dentry *ext_ep; ++ struct buffer_head *bh; ++ ++ for (i = 0, entry++; i < ep->dentry.file.num_ext; i++, entry++) { ++ ext_ep = exfat_get_dentry(sb, p_dir, entry, &bh, NULL); ++ if (!ext_ep) ++ return -EIO; ++ ++ type = exfat_get_entry_type(ext_ep); ++ brelse(bh); ++ if (type == TYPE_EXTEND || type == TYPE_STREAM) ++ count++; ++ else ++ break; ++ } ++ return count; ++} ++ ++int exfat_count_dir_entries(struct super_block *sb, struct exfat_chain *p_dir) ++{ ++ int i, count = 0; ++ int dentries_per_clu; ++ unsigned int entry_type; ++ struct exfat_chain clu; ++ struct exfat_dentry *ep; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct buffer_head *bh; ++ ++ dentries_per_clu = sbi->dentries_per_clu; ++ ++ exfat_chain_dup(&clu, p_dir); ++ ++ while (clu.dir != EXFAT_EOF_CLUSTER) { ++ for (i = 0; i < dentries_per_clu; i++) { ++ ep = exfat_get_dentry(sb, &clu, i, &bh, NULL); ++ if (!ep) ++ return -EIO; ++ entry_type = exfat_get_entry_type(ep); ++ brelse(bh); ++ ++ if (entry_type == TYPE_UNUSED) ++ return count; ++ if (entry_type != TYPE_DIR) ++ continue; ++ count++; ++ } ++ ++ if (clu.flags == ALLOC_NO_FAT_CHAIN) { ++ if (--clu.size > 0) ++ clu.dir++; ++ else ++ clu.dir = EXFAT_EOF_CLUSTER; ++ } else { ++ if (exfat_get_next_cluster(sb, &(clu.dir))) ++ return -EIO; ++ } ++ } ++ ++ return count; ++} +-- +2.25.1 + diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-add-exfat-cache.patch b/kernel/kernel/files/patches/mageia/fs-exfat-add-exfat-cache.patch new file mode 100644 index 00000000..179a1226 --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-add-exfat-cache.patch @@ -0,0 +1,354 @@ +From c35b6810c4952ae5776607e2c1d6a587425d5834 Mon Sep 17 00:00:00 2001 +From: Namjae Jeon +Date: Mon, 2 Mar 2020 15:21:39 +0900 +Subject: [PATCH 08/14] exfat: add exfat cache +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +This adds the implementation of exfat cache. + +Signed-off-by: Namjae Jeon +Signed-off-by: Sungjong Seo +Reviewed-by: Pali Rohár +Reviewed-by: Christoph Hellwig +Signed-off-by: Al Viro +--- + fs/exfat/cache.c | 325 +++++++++++++++++++++++++++++++++++++++++++++++ + 1 file changed, 325 insertions(+) + create mode 100644 fs/exfat/cache.c + +diff --git a/fs/exfat/cache.c b/fs/exfat/cache.c +new file mode 100644 +index 000000000000..03d0824fc368 +--- /dev/null ++++ b/fs/exfat/cache.c +@@ -0,0 +1,325 @@ ++// SPDX-License-Identifier: GPL-2.0-or-later ++/* ++ * linux/fs/fat/cache.c ++ * ++ * Written 1992,1993 by Werner Almesberger ++ * ++ * Mar 1999. AV. Changed cache, so that it uses the starting cluster instead ++ * of inode number. ++ * May 1999. AV. Fixed the bogosity with FAT32 (read "FAT28"). Fscking lusers. ++ * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. ++ */ ++ ++#include ++#include ++#include ++ ++#include "exfat_raw.h" ++#include "exfat_fs.h" ++ ++#define EXFAT_CACHE_VALID 0 ++#define EXFAT_MAX_CACHE 16 ++ ++struct exfat_cache { ++ struct list_head cache_list; ++ unsigned int nr_contig; /* number of contiguous clusters */ ++ unsigned int fcluster; /* cluster number in the file. */ ++ unsigned int dcluster; /* cluster number on disk. */ ++}; ++ ++struct exfat_cache_id { ++ unsigned int id; ++ unsigned int nr_contig; ++ unsigned int fcluster; ++ unsigned int dcluster; ++}; ++ ++static struct kmem_cache *exfat_cachep; ++ ++static void exfat_cache_init_once(void *c) ++{ ++ struct exfat_cache *cache = (struct exfat_cache *)c; ++ ++ INIT_LIST_HEAD(&cache->cache_list); ++} ++ ++int exfat_cache_init(void) ++{ ++ exfat_cachep = kmem_cache_create("exfat_cache", ++ sizeof(struct exfat_cache), ++ 0, SLAB_RECLAIM_ACCOUNT|SLAB_MEM_SPREAD, ++ exfat_cache_init_once); ++ if (!exfat_cachep) ++ return -ENOMEM; ++ return 0; ++} ++ ++void exfat_cache_shutdown(void) ++{ ++ if (!exfat_cachep) ++ return; ++ kmem_cache_destroy(exfat_cachep); ++} ++ ++void exfat_cache_init_inode(struct inode *inode) ++{ ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ ++ spin_lock_init(&ei->cache_lru_lock); ++ ei->nr_caches = 0; ++ ei->cache_valid_id = EXFAT_CACHE_VALID + 1; ++ INIT_LIST_HEAD(&ei->cache_lru); ++} ++ ++static inline struct exfat_cache *exfat_cache_alloc(void) ++{ ++ return kmem_cache_alloc(exfat_cachep, GFP_NOFS); ++} ++ ++static inline void exfat_cache_free(struct exfat_cache *cache) ++{ ++ WARN_ON(!list_empty(&cache->cache_list)); ++ kmem_cache_free(exfat_cachep, cache); ++} ++ ++static inline void exfat_cache_update_lru(struct inode *inode, ++ struct exfat_cache *cache) ++{ ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ ++ if (ei->cache_lru.next != &cache->cache_list) ++ list_move(&cache->cache_list, &ei->cache_lru); ++} ++ ++static unsigned int exfat_cache_lookup(struct inode *inode, ++ unsigned int fclus, struct exfat_cache_id *cid, ++ unsigned int *cached_fclus, unsigned int *cached_dclus) ++{ ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ static struct exfat_cache nohit = { .fcluster = 0, }; ++ struct exfat_cache *hit = &nohit, *p; ++ unsigned int offset = EXFAT_EOF_CLUSTER; ++ ++ spin_lock(&ei->cache_lru_lock); ++ list_for_each_entry(p, &ei->cache_lru, cache_list) { ++ /* Find the cache of "fclus" or nearest cache. */ ++ if (p->fcluster <= fclus && hit->fcluster < p->fcluster) { ++ hit = p; ++ if (hit->fcluster + hit->nr_contig < fclus) { ++ offset = hit->nr_contig; ++ } else { ++ offset = fclus - hit->fcluster; ++ break; ++ } ++ } ++ } ++ if (hit != &nohit) { ++ exfat_cache_update_lru(inode, hit); ++ ++ cid->id = ei->cache_valid_id; ++ cid->nr_contig = hit->nr_contig; ++ cid->fcluster = hit->fcluster; ++ cid->dcluster = hit->dcluster; ++ *cached_fclus = cid->fcluster + offset; ++ *cached_dclus = cid->dcluster + offset; ++ } ++ spin_unlock(&ei->cache_lru_lock); ++ ++ return offset; ++} ++ ++static struct exfat_cache *exfat_cache_merge(struct inode *inode, ++ struct exfat_cache_id *new) ++{ ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ struct exfat_cache *p; ++ ++ list_for_each_entry(p, &ei->cache_lru, cache_list) { ++ /* Find the same part as "new" in cluster-chain. */ ++ if (p->fcluster == new->fcluster) { ++ if (new->nr_contig > p->nr_contig) ++ p->nr_contig = new->nr_contig; ++ return p; ++ } ++ } ++ return NULL; ++} ++ ++static void exfat_cache_add(struct inode *inode, ++ struct exfat_cache_id *new) ++{ ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ struct exfat_cache *cache, *tmp; ++ ++ if (new->fcluster == EXFAT_EOF_CLUSTER) /* dummy cache */ ++ return; ++ ++ spin_lock(&ei->cache_lru_lock); ++ if (new->id != EXFAT_CACHE_VALID && ++ new->id != ei->cache_valid_id) ++ goto unlock; /* this cache was invalidated */ ++ ++ cache = exfat_cache_merge(inode, new); ++ if (cache == NULL) { ++ if (ei->nr_caches < EXFAT_MAX_CACHE) { ++ ei->nr_caches++; ++ spin_unlock(&ei->cache_lru_lock); ++ ++ tmp = exfat_cache_alloc(); ++ if (!tmp) { ++ spin_lock(&ei->cache_lru_lock); ++ ei->nr_caches--; ++ spin_unlock(&ei->cache_lru_lock); ++ return; ++ } ++ ++ spin_lock(&ei->cache_lru_lock); ++ cache = exfat_cache_merge(inode, new); ++ if (cache != NULL) { ++ ei->nr_caches--; ++ exfat_cache_free(tmp); ++ goto out_update_lru; ++ } ++ cache = tmp; ++ } else { ++ struct list_head *p = ei->cache_lru.prev; ++ ++ cache = list_entry(p, ++ struct exfat_cache, cache_list); ++ } ++ cache->fcluster = new->fcluster; ++ cache->dcluster = new->dcluster; ++ cache->nr_contig = new->nr_contig; ++ } ++out_update_lru: ++ exfat_cache_update_lru(inode, cache); ++unlock: ++ spin_unlock(&ei->cache_lru_lock); ++} ++ ++/* ++ * Cache invalidation occurs rarely, thus the LRU chain is not updated. It ++ * fixes itself after a while. ++ */ ++static void __exfat_cache_inval_inode(struct inode *inode) ++{ ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ struct exfat_cache *cache; ++ ++ while (!list_empty(&ei->cache_lru)) { ++ cache = list_entry(ei->cache_lru.next, ++ struct exfat_cache, cache_list); ++ list_del_init(&cache->cache_list); ++ ei->nr_caches--; ++ exfat_cache_free(cache); ++ } ++ /* Update. The copy of caches before this id is discarded. */ ++ ei->cache_valid_id++; ++ if (ei->cache_valid_id == EXFAT_CACHE_VALID) ++ ei->cache_valid_id++; ++} ++ ++void exfat_cache_inval_inode(struct inode *inode) ++{ ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ ++ spin_lock(&ei->cache_lru_lock); ++ __exfat_cache_inval_inode(inode); ++ spin_unlock(&ei->cache_lru_lock); ++} ++ ++static inline int cache_contiguous(struct exfat_cache_id *cid, ++ unsigned int dclus) ++{ ++ cid->nr_contig++; ++ return cid->dcluster + cid->nr_contig == dclus; ++} ++ ++static inline void cache_init(struct exfat_cache_id *cid, ++ unsigned int fclus, unsigned int dclus) ++{ ++ cid->id = EXFAT_CACHE_VALID; ++ cid->fcluster = fclus; ++ cid->dcluster = dclus; ++ cid->nr_contig = 0; ++} ++ ++int exfat_get_cluster(struct inode *inode, unsigned int cluster, ++ unsigned int *fclus, unsigned int *dclus, ++ unsigned int *last_dclus, int allow_eof) ++{ ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ unsigned int limit = sbi->num_clusters; ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ struct exfat_cache_id cid; ++ unsigned int content; ++ ++ if (ei->start_clu == EXFAT_FREE_CLUSTER) { ++ exfat_fs_error(sb, ++ "invalid access to exfat cache (entry 0x%08x)", ++ ei->start_clu); ++ return -EIO; ++ } ++ ++ *fclus = 0; ++ *dclus = ei->start_clu; ++ *last_dclus = *dclus; ++ ++ /* ++ * Don`t use exfat_cache if zero offset or non-cluster allocation ++ */ ++ if (cluster == 0 || *dclus == EXFAT_EOF_CLUSTER) ++ return 0; ++ ++ cache_init(&cid, EXFAT_EOF_CLUSTER, EXFAT_EOF_CLUSTER); ++ ++ if (exfat_cache_lookup(inode, cluster, &cid, fclus, dclus) == ++ EXFAT_EOF_CLUSTER) { ++ /* ++ * dummy, always not contiguous ++ * This is reinitialized by cache_init(), later. ++ */ ++ WARN_ON(cid.id != EXFAT_CACHE_VALID || ++ cid.fcluster != EXFAT_EOF_CLUSTER || ++ cid.dcluster != EXFAT_EOF_CLUSTER || ++ cid.nr_contig != 0); ++ } ++ ++ if (*fclus == cluster) ++ return 0; ++ ++ while (*fclus < cluster) { ++ /* prevent the infinite loop of cluster chain */ ++ if (*fclus > limit) { ++ exfat_fs_error(sb, ++ "detected the cluster chain loop (i_pos %u)", ++ (*fclus)); ++ return -EIO; ++ } ++ ++ if (exfat_ent_get(sb, *dclus, &content)) ++ return -EIO; ++ ++ *last_dclus = *dclus; ++ *dclus = content; ++ (*fclus)++; ++ ++ if (content == EXFAT_EOF_CLUSTER) { ++ if (!allow_eof) { ++ exfat_fs_error(sb, ++ "invalid cluster chain (i_pos %u, last_clus 0x%08x is EOF)", ++ *fclus, (*last_dclus)); ++ return -EIO; ++ } ++ ++ break; ++ } ++ ++ if (!cache_contiguous(&cid, *dclus)) ++ cache_init(&cid, *fclus, *dclus); ++ } ++ ++ exfat_cache_add(inode, &cid); ++ return 0; ++} +-- +2.25.1 + diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-add-fat-entry-operations.patch b/kernel/kernel/files/patches/mageia/fs-exfat-add-fat-entry-operations.patch new file mode 100644 index 00000000..5d0f4f35 --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-add-fat-entry-operations.patch @@ -0,0 +1,492 @@ +From 31023864e67a5f390cefbe92f72343027dc3aa33 Mon Sep 17 00:00:00 2001 +From: Namjae Jeon +Date: Mon, 2 Mar 2020 15:21:37 +0900 +Subject: [PATCH 06/14] exfat: add fat entry operations +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +This adds the implementation of fat entry operations for exfat. + +Signed-off-by: Namjae Jeon +Signed-off-by: Sungjong Seo +Reviewed-by: Pali Rohár +Reviewed-by: Christoph Hellwig +Signed-off-by: Al Viro +--- + fs/exfat/fatent.c | 463 ++++++++++++++++++++++++++++++++++++++++++++++ + 1 file changed, 463 insertions(+) + create mode 100644 fs/exfat/fatent.c + +diff --git a/fs/exfat/fatent.c b/fs/exfat/fatent.c +new file mode 100644 +index 000000000000..a855b1769a96 +--- /dev/null ++++ b/fs/exfat/fatent.c +@@ -0,0 +1,463 @@ ++// SPDX-License-Identifier: GPL-2.0-or-later ++/* ++ * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. ++ */ ++ ++#include ++#include ++#include ++ ++#include "exfat_raw.h" ++#include "exfat_fs.h" ++ ++static int exfat_mirror_bh(struct super_block *sb, sector_t sec, ++ struct buffer_head *bh) ++{ ++ struct buffer_head *c_bh; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ sector_t sec2; ++ int err = 0; ++ ++ if (sbi->FAT2_start_sector != sbi->FAT1_start_sector) { ++ sec2 = sec - sbi->FAT1_start_sector + sbi->FAT2_start_sector; ++ c_bh = sb_getblk(sb, sec2); ++ if (!c_bh) ++ return -ENOMEM; ++ memcpy(c_bh->b_data, bh->b_data, sb->s_blocksize); ++ set_buffer_uptodate(c_bh); ++ mark_buffer_dirty(c_bh); ++ if (sb->s_flags & SB_SYNCHRONOUS) ++ err = sync_dirty_buffer(c_bh); ++ brelse(c_bh); ++ } ++ ++ return err; ++} ++ ++static int __exfat_ent_get(struct super_block *sb, unsigned int loc, ++ unsigned int *content) ++{ ++ unsigned int off; ++ sector_t sec; ++ struct buffer_head *bh; ++ ++ sec = FAT_ENT_OFFSET_SECTOR(sb, loc); ++ off = FAT_ENT_OFFSET_BYTE_IN_SECTOR(sb, loc); ++ ++ bh = sb_bread(sb, sec); ++ if (!bh) ++ return -EIO; ++ ++ *content = le32_to_cpu(*(__le32 *)(&bh->b_data[off])); ++ ++ /* remap reserved clusters to simplify code */ ++ if (*content > EXFAT_BAD_CLUSTER) ++ *content = EXFAT_EOF_CLUSTER; ++ ++ brelse(bh); ++ return 0; ++} ++ ++int exfat_ent_set(struct super_block *sb, unsigned int loc, ++ unsigned int content) ++{ ++ unsigned int off; ++ sector_t sec; ++ __le32 *fat_entry; ++ struct buffer_head *bh; ++ ++ sec = FAT_ENT_OFFSET_SECTOR(sb, loc); ++ off = FAT_ENT_OFFSET_BYTE_IN_SECTOR(sb, loc); ++ ++ bh = sb_bread(sb, sec); ++ if (!bh) ++ return -EIO; ++ ++ fat_entry = (__le32 *)&(bh->b_data[off]); ++ *fat_entry = cpu_to_le32(content); ++ exfat_update_bh(sb, bh, sb->s_flags & SB_SYNCHRONOUS); ++ exfat_mirror_bh(sb, sec, bh); ++ brelse(bh); ++ return 0; ++} ++ ++static inline bool is_valid_cluster(struct exfat_sb_info *sbi, ++ unsigned int clus) ++{ ++ if (clus < EXFAT_FIRST_CLUSTER || sbi->num_clusters <= clus) ++ return false; ++ return true; ++} ++ ++int exfat_ent_get(struct super_block *sb, unsigned int loc, ++ unsigned int *content) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ int err; ++ ++ if (!is_valid_cluster(sbi, loc)) { ++ exfat_fs_error(sb, "invalid access to FAT (entry 0x%08x)", ++ loc); ++ return -EIO; ++ } ++ ++ err = __exfat_ent_get(sb, loc, content); ++ if (err) { ++ exfat_fs_error(sb, ++ "failed to access to FAT (entry 0x%08x, err:%d)", ++ loc, err); ++ return err; ++ } ++ ++ if (*content == EXFAT_FREE_CLUSTER) { ++ exfat_fs_error(sb, ++ "invalid access to FAT free cluster (entry 0x%08x)", ++ loc); ++ return -EIO; ++ } ++ ++ if (*content == EXFAT_BAD_CLUSTER) { ++ exfat_fs_error(sb, ++ "invalid access to FAT bad cluster (entry 0x%08x)", ++ loc); ++ return -EIO; ++ } ++ ++ if (*content != EXFAT_EOF_CLUSTER && !is_valid_cluster(sbi, *content)) { ++ exfat_fs_error(sb, ++ "invalid access to FAT (entry 0x%08x) bogus content (0x%08x)", ++ loc, *content); ++ return -EIO; ++ } ++ ++ return 0; ++} ++ ++int exfat_chain_cont_cluster(struct super_block *sb, unsigned int chain, ++ unsigned int len) ++{ ++ if (!len) ++ return 0; ++ ++ while (len > 1) { ++ if (exfat_ent_set(sb, chain, chain + 1)) ++ return -EIO; ++ chain++; ++ len--; ++ } ++ ++ if (exfat_ent_set(sb, chain, EXFAT_EOF_CLUSTER)) ++ return -EIO; ++ return 0; ++} ++ ++int exfat_free_cluster(struct inode *inode, struct exfat_chain *p_chain) ++{ ++ unsigned int num_clusters = 0; ++ unsigned int clu; ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ ++ /* invalid cluster number */ ++ if (p_chain->dir == EXFAT_FREE_CLUSTER || ++ p_chain->dir == EXFAT_EOF_CLUSTER || ++ p_chain->dir < EXFAT_FIRST_CLUSTER) ++ return 0; ++ ++ /* no cluster to truncate */ ++ if (p_chain->size == 0) ++ return 0; ++ ++ /* check cluster validation */ ++ if (p_chain->dir < 2 && p_chain->dir >= sbi->num_clusters) { ++ exfat_msg(sb, KERN_ERR, "invalid start cluster (%u)", ++ p_chain->dir); ++ return -EIO; ++ } ++ ++ set_bit(EXFAT_SB_DIRTY, &sbi->s_state); ++ clu = p_chain->dir; ++ ++ if (p_chain->flags == ALLOC_NO_FAT_CHAIN) { ++ do { ++ exfat_clear_bitmap(inode, clu); ++ clu++; ++ ++ num_clusters++; ++ } while (num_clusters < p_chain->size); ++ } else { ++ do { ++ exfat_clear_bitmap(inode, clu); ++ ++ if (exfat_get_next_cluster(sb, &clu)) ++ goto dec_used_clus; ++ ++ num_clusters++; ++ } while (clu != EXFAT_EOF_CLUSTER); ++ } ++ ++dec_used_clus: ++ sbi->used_clusters -= num_clusters; ++ return 0; ++} ++ ++int exfat_find_last_cluster(struct super_block *sb, struct exfat_chain *p_chain, ++ unsigned int *ret_clu) ++{ ++ unsigned int clu, next; ++ unsigned int count = 0; ++ ++ next = p_chain->dir; ++ if (p_chain->flags == ALLOC_NO_FAT_CHAIN) { ++ *ret_clu = next + p_chain->size - 1; ++ return 0; ++ } ++ ++ do { ++ count++; ++ clu = next; ++ if (exfat_ent_get(sb, clu, &next)) ++ return -EIO; ++ } while (next != EXFAT_EOF_CLUSTER); ++ ++ if (p_chain->size != count) { ++ exfat_fs_error(sb, ++ "bogus directory size (clus : ondisk(%d) != counted(%d))", ++ p_chain->size, count); ++ return -EIO; ++ } ++ ++ *ret_clu = clu; ++ return 0; ++} ++ ++static inline int exfat_sync_bhs(struct buffer_head **bhs, int nr_bhs) ++{ ++ int i, err = 0; ++ ++ for (i = 0; i < nr_bhs; i++) ++ write_dirty_buffer(bhs[i], 0); ++ ++ for (i = 0; i < nr_bhs; i++) { ++ wait_on_buffer(bhs[i]); ++ if (!err && !buffer_uptodate(bhs[i])) ++ err = -EIO; ++ } ++ return err; ++} ++ ++int exfat_zeroed_cluster(struct inode *dir, unsigned int clu) ++{ ++ struct super_block *sb = dir->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct buffer_head *bhs[MAX_BUF_PER_PAGE]; ++ int nr_bhs = MAX_BUF_PER_PAGE; ++ sector_t blknr, last_blknr; ++ int err, i, n; ++ ++ blknr = exfat_cluster_to_sector(sbi, clu); ++ last_blknr = blknr + sbi->sect_per_clus; ++ ++ if (last_blknr > sbi->num_sectors && sbi->num_sectors > 0) { ++ exfat_fs_error_ratelimit(sb, ++ "%s: out of range(sect:%llu len:%u)", ++ __func__, (unsigned long long)blknr, ++ sbi->sect_per_clus); ++ return -EIO; ++ } ++ ++ /* Zeroing the unused blocks on this cluster */ ++ n = 0; ++ while (blknr < last_blknr) { ++ bhs[n] = sb_getblk(sb, blknr); ++ if (!bhs[n]) { ++ err = -ENOMEM; ++ goto release_bhs; ++ } ++ memset(bhs[n]->b_data, 0, sb->s_blocksize); ++ exfat_update_bh(sb, bhs[n], 0); ++ ++ n++; ++ blknr++; ++ ++ if (n == nr_bhs) { ++ if (IS_DIRSYNC(dir)) { ++ err = exfat_sync_bhs(bhs, n); ++ if (err) ++ goto release_bhs; ++ } ++ ++ for (i = 0; i < n; i++) ++ brelse(bhs[i]); ++ n = 0; ++ } ++ } ++ ++ if (IS_DIRSYNC(dir)) { ++ err = exfat_sync_bhs(bhs, n); ++ if (err) ++ goto release_bhs; ++ } ++ ++ for (i = 0; i < n; i++) ++ brelse(bhs[i]); ++ ++ return 0; ++ ++release_bhs: ++ exfat_msg(sb, KERN_ERR, "failed zeroed sect %llu\n", ++ (unsigned long long)blknr); ++ for (i = 0; i < n; i++) ++ bforget(bhs[i]); ++ return err; ++} ++ ++int exfat_alloc_cluster(struct inode *inode, unsigned int num_alloc, ++ struct exfat_chain *p_chain) ++{ ++ int ret = -ENOSPC; ++ unsigned int num_clusters = 0, total_cnt; ++ unsigned int hint_clu, new_clu, last_clu = EXFAT_EOF_CLUSTER; ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ ++ total_cnt = EXFAT_DATA_CLUSTER_COUNT(sbi); ++ ++ if (unlikely(total_cnt < sbi->used_clusters)) { ++ exfat_fs_error_ratelimit(sb, ++ "%s: invalid used clusters(t:%u,u:%u)\n", ++ __func__, total_cnt, sbi->used_clusters); ++ return -EIO; ++ } ++ ++ if (num_alloc > total_cnt - sbi->used_clusters) ++ return -ENOSPC; ++ ++ hint_clu = p_chain->dir; ++ /* find new cluster */ ++ if (hint_clu == EXFAT_EOF_CLUSTER) { ++ if (sbi->clu_srch_ptr < EXFAT_FIRST_CLUSTER) { ++ exfat_msg(sb, KERN_ERR, ++ "sbi->clu_srch_ptr is invalid (%u)\n", ++ sbi->clu_srch_ptr); ++ sbi->clu_srch_ptr = EXFAT_FIRST_CLUSTER; ++ } ++ ++ hint_clu = exfat_find_free_bitmap(sb, sbi->clu_srch_ptr); ++ if (hint_clu == EXFAT_EOF_CLUSTER) ++ return -ENOSPC; ++ } ++ ++ /* check cluster validation */ ++ if (hint_clu < EXFAT_FIRST_CLUSTER && hint_clu >= sbi->num_clusters) { ++ exfat_msg(sb, KERN_ERR, "hint_cluster is invalid (%u)\n", ++ hint_clu); ++ hint_clu = EXFAT_FIRST_CLUSTER; ++ if (p_chain->flags == ALLOC_NO_FAT_CHAIN) { ++ if (exfat_chain_cont_cluster(sb, p_chain->dir, ++ num_clusters)) ++ return -EIO; ++ p_chain->flags = ALLOC_FAT_CHAIN; ++ } ++ } ++ ++ set_bit(EXFAT_SB_DIRTY, &sbi->s_state); ++ ++ p_chain->dir = EXFAT_EOF_CLUSTER; ++ ++ while ((new_clu = exfat_find_free_bitmap(sb, hint_clu)) != ++ EXFAT_EOF_CLUSTER) { ++ if (new_clu != hint_clu && ++ p_chain->flags == ALLOC_NO_FAT_CHAIN) { ++ if (exfat_chain_cont_cluster(sb, p_chain->dir, ++ num_clusters)) { ++ ret = -EIO; ++ goto free_cluster; ++ } ++ p_chain->flags = ALLOC_FAT_CHAIN; ++ } ++ ++ /* update allocation bitmap */ ++ if (exfat_set_bitmap(inode, new_clu)) { ++ ret = -EIO; ++ goto free_cluster; ++ } ++ ++ num_clusters++; ++ ++ /* update FAT table */ ++ if (p_chain->flags == ALLOC_FAT_CHAIN) { ++ if (exfat_ent_set(sb, new_clu, EXFAT_EOF_CLUSTER)) { ++ ret = -EIO; ++ goto free_cluster; ++ } ++ } ++ ++ if (p_chain->dir == EXFAT_EOF_CLUSTER) { ++ p_chain->dir = new_clu; ++ } else if (p_chain->flags == ALLOC_FAT_CHAIN) { ++ if (exfat_ent_set(sb, last_clu, new_clu)) { ++ ret = -EIO; ++ goto free_cluster; ++ } ++ } ++ last_clu = new_clu; ++ ++ if (--num_alloc == 0) { ++ sbi->clu_srch_ptr = hint_clu; ++ sbi->used_clusters += num_clusters; ++ ++ p_chain->size += num_clusters; ++ return 0; ++ } ++ ++ hint_clu = new_clu + 1; ++ if (hint_clu >= sbi->num_clusters) { ++ hint_clu = EXFAT_FIRST_CLUSTER; ++ ++ if (p_chain->flags == ALLOC_NO_FAT_CHAIN) { ++ if (exfat_chain_cont_cluster(sb, p_chain->dir, ++ num_clusters)) { ++ ret = -EIO; ++ goto free_cluster; ++ } ++ p_chain->flags = ALLOC_FAT_CHAIN; ++ } ++ } ++ } ++free_cluster: ++ if (num_clusters) ++ exfat_free_cluster(inode, p_chain); ++ return ret; ++} ++ ++int exfat_count_num_clusters(struct super_block *sb, ++ struct exfat_chain *p_chain, unsigned int *ret_count) ++{ ++ unsigned int i, count; ++ unsigned int clu; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ ++ if (!p_chain->dir || p_chain->dir == EXFAT_EOF_CLUSTER) { ++ *ret_count = 0; ++ return 0; ++ } ++ ++ if (p_chain->flags == ALLOC_NO_FAT_CHAIN) { ++ *ret_count = p_chain->size; ++ return 0; ++ } ++ ++ clu = p_chain->dir; ++ count = 0; ++ for (i = EXFAT_FIRST_CLUSTER; i < sbi->num_clusters; i++) { ++ count++; ++ if (exfat_ent_get(sb, clu, &clu)) ++ return -EIO; ++ if (clu == EXFAT_EOF_CLUSTER) ++ break; ++ } ++ ++ *ret_count = count; ++ return 0; ++} +-- +2.25.1 + diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-add-file-operations.patch b/kernel/kernel/files/patches/mageia/fs-exfat-add-file-operations.patch new file mode 100644 index 00000000..49fd0d83 --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-add-file-operations.patch @@ -0,0 +1,390 @@ +From 98d917047e8b7f4bb2ff61d81b0ccd94a00444f9 Mon Sep 17 00:00:00 2001 +From: Namjae Jeon +Date: Mon, 2 Mar 2020 15:21:36 +0900 +Subject: [PATCH 05/14] exfat: add file operations +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +This adds the implementation of file operations for exfat. + +Signed-off-by: Namjae Jeon +Signed-off-by: Sungjong Seo +Reviewed-by: Pali Rohár +Reviewed-by: Christoph Hellwig +Reviewed-by: Arnd Bergmann +Signed-off-by: Al Viro +--- + fs/exfat/file.c | 360 ++++++++++++++++++++++++++++++++++++++++++++++++ + 1 file changed, 360 insertions(+) + create mode 100644 fs/exfat/file.c + +diff --git a/fs/exfat/file.c b/fs/exfat/file.c +new file mode 100644 +index 000000000000..483f683757aa +--- /dev/null ++++ b/fs/exfat/file.c +@@ -0,0 +1,360 @@ ++// SPDX-License-Identifier: GPL-2.0-or-later ++/* ++ * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. ++ */ ++ ++#include ++#include ++#include ++ ++#include "exfat_raw.h" ++#include "exfat_fs.h" ++ ++static int exfat_cont_expand(struct inode *inode, loff_t size) ++{ ++ struct address_space *mapping = inode->i_mapping; ++ loff_t start = i_size_read(inode), count = size - i_size_read(inode); ++ int err, err2; ++ ++ err = generic_cont_expand_simple(inode, size); ++ if (err) ++ return err; ++ ++ inode->i_ctime = inode->i_mtime = current_time(inode); ++ mark_inode_dirty(inode); ++ ++ if (!IS_SYNC(inode)) ++ return 0; ++ ++ err = filemap_fdatawrite_range(mapping, start, start + count - 1); ++ err2 = sync_mapping_buffers(mapping); ++ if (!err) ++ err = err2; ++ err2 = write_inode_now(inode, 1); ++ if (!err) ++ err = err2; ++ if (err) ++ return err; ++ ++ return filemap_fdatawait_range(mapping, start, start + count - 1); ++} ++ ++static bool exfat_allow_set_time(struct exfat_sb_info *sbi, struct inode *inode) ++{ ++ mode_t allow_utime = sbi->options.allow_utime; ++ ++ if (!uid_eq(current_fsuid(), inode->i_uid)) { ++ if (in_group_p(inode->i_gid)) ++ allow_utime >>= 3; ++ if (allow_utime & MAY_WRITE) ++ return true; ++ } ++ ++ /* use a default check */ ++ return false; ++} ++ ++static int exfat_sanitize_mode(const struct exfat_sb_info *sbi, ++ struct inode *inode, umode_t *mode_ptr) ++{ ++ mode_t i_mode, mask, perm; ++ ++ i_mode = inode->i_mode; ++ ++ mask = (S_ISREG(i_mode) || S_ISLNK(i_mode)) ? ++ sbi->options.fs_fmask : sbi->options.fs_dmask; ++ perm = *mode_ptr & ~(S_IFMT | mask); ++ ++ /* Of the r and x bits, all (subject to umask) must be present.*/ ++ if ((perm & 0555) != (i_mode & 0555)) ++ return -EPERM; ++ ++ if (exfat_mode_can_hold_ro(inode)) { ++ /* ++ * Of the w bits, either all (subject to umask) or none must ++ * be present. ++ */ ++ if ((perm & 0222) && ((perm & 0222) != (0222 & ~mask))) ++ return -EPERM; ++ } else { ++ /* ++ * If exfat_mode_can_hold_ro(inode) is false, can't change ++ * w bits. ++ */ ++ if ((perm & 0222) != (0222 & ~mask)) ++ return -EPERM; ++ } ++ ++ *mode_ptr &= S_IFMT | perm; ++ ++ return 0; ++} ++ ++/* resize the file length */ ++int __exfat_truncate(struct inode *inode, loff_t new_size) ++{ ++ unsigned int num_clusters_new, num_clusters_phys; ++ unsigned int last_clu = EXFAT_FREE_CLUSTER; ++ struct exfat_chain clu; ++ struct exfat_dentry *ep, *ep2; ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ struct exfat_entry_set_cache *es = NULL; ++ int evict = (ei->dir.dir == DIR_DELETED) ? 1 : 0; ++ ++ /* check if the given file ID is opened */ ++ if (ei->type != TYPE_FILE && ei->type != TYPE_DIR) ++ return -EPERM; ++ ++ exfat_set_vol_flags(sb, VOL_DIRTY); ++ ++ num_clusters_new = EXFAT_B_TO_CLU_ROUND_UP(i_size_read(inode), sbi); ++ num_clusters_phys = ++ EXFAT_B_TO_CLU_ROUND_UP(EXFAT_I(inode)->i_size_ondisk, sbi); ++ ++ exfat_chain_set(&clu, ei->start_clu, num_clusters_phys, ei->flags); ++ ++ if (new_size > 0) { ++ /* ++ * Truncate FAT chain num_clusters after the first cluster ++ * num_clusters = min(new, phys); ++ */ ++ unsigned int num_clusters = ++ min(num_clusters_new, num_clusters_phys); ++ ++ /* ++ * Follow FAT chain ++ * (defensive coding - works fine even with corrupted FAT table ++ */ ++ if (clu.flags == ALLOC_NO_FAT_CHAIN) { ++ clu.dir += num_clusters; ++ clu.size -= num_clusters; ++ } else { ++ while (num_clusters > 0) { ++ last_clu = clu.dir; ++ if (exfat_get_next_cluster(sb, &(clu.dir))) ++ return -EIO; ++ ++ num_clusters--; ++ clu.size--; ++ } ++ } ++ } else { ++ ei->flags = ALLOC_NO_FAT_CHAIN; ++ ei->start_clu = EXFAT_EOF_CLUSTER; ++ } ++ ++ i_size_write(inode, new_size); ++ ++ if (ei->type == TYPE_FILE) ++ ei->attr |= ATTR_ARCHIVE; ++ ++ /* update the directory entry */ ++ if (!evict) { ++ struct timespec64 ts; ++ ++ es = exfat_get_dentry_set(sb, &(ei->dir), ei->entry, ++ ES_ALL_ENTRIES, &ep); ++ if (!es) ++ return -EIO; ++ ep2 = ep + 1; ++ ++ ts = current_time(inode); ++ exfat_set_entry_time(sbi, &ts, ++ &ep->dentry.file.modify_tz, ++ &ep->dentry.file.modify_time, ++ &ep->dentry.file.modify_date, ++ &ep->dentry.file.modify_time_ms); ++ ep->dentry.file.attr = cpu_to_le16(ei->attr); ++ ++ /* File size should be zero if there is no cluster allocated */ ++ if (ei->start_clu == EXFAT_EOF_CLUSTER) { ++ ep->dentry.stream.valid_size = 0; ++ ep->dentry.stream.size = 0; ++ } else { ++ ep->dentry.stream.valid_size = cpu_to_le64(new_size); ++ ep->dentry.stream.size = ep->dentry.stream.valid_size; ++ } ++ ++ if (new_size == 0) { ++ /* Any directory can not be truncated to zero */ ++ WARN_ON(ei->type != TYPE_FILE); ++ ++ ep2->dentry.stream.flags = ALLOC_FAT_CHAIN; ++ ep2->dentry.stream.start_clu = EXFAT_FREE_CLUSTER; ++ } ++ ++ if (exfat_update_dir_chksum_with_entry_set(sb, es, ++ inode_needs_sync(inode))) ++ return -EIO; ++ kfree(es); ++ } ++ ++ /* cut off from the FAT chain */ ++ if (ei->flags == ALLOC_FAT_CHAIN && last_clu != EXFAT_FREE_CLUSTER && ++ last_clu != EXFAT_EOF_CLUSTER) { ++ if (exfat_ent_set(sb, last_clu, EXFAT_EOF_CLUSTER)) ++ return -EIO; ++ } ++ ++ /* invalidate cache and free the clusters */ ++ /* clear exfat cache */ ++ exfat_cache_inval_inode(inode); ++ ++ /* hint information */ ++ ei->hint_bmap.off = EXFAT_EOF_CLUSTER; ++ ei->hint_bmap.clu = EXFAT_EOF_CLUSTER; ++ if (ei->rwoffset > new_size) ++ ei->rwoffset = new_size; ++ ++ /* hint_stat will be used if this is directory. */ ++ ei->hint_stat.eidx = 0; ++ ei->hint_stat.clu = ei->start_clu; ++ ei->hint_femp.eidx = EXFAT_HINT_NONE; ++ ++ /* free the clusters */ ++ if (exfat_free_cluster(inode, &clu)) ++ return -EIO; ++ ++ exfat_set_vol_flags(sb, VOL_CLEAN); ++ ++ return 0; ++} ++ ++void exfat_truncate(struct inode *inode, loff_t size) ++{ ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ unsigned int blocksize = 1 << inode->i_blkbits; ++ loff_t aligned_size; ++ int err; ++ ++ mutex_lock(&sbi->s_lock); ++ if (EXFAT_I(inode)->start_clu == 0) { ++ /* ++ * Empty start_clu != ~0 (not allocated) ++ */ ++ exfat_fs_error(sb, "tried to truncate zeroed cluster."); ++ goto write_size; ++ } ++ ++ err = __exfat_truncate(inode, i_size_read(inode)); ++ if (err) ++ goto write_size; ++ ++ inode->i_ctime = inode->i_mtime = current_time(inode); ++ if (IS_DIRSYNC(inode)) ++ exfat_sync_inode(inode); ++ else ++ mark_inode_dirty(inode); ++ ++ inode->i_blocks = ((i_size_read(inode) + (sbi->cluster_size - 1)) & ++ ~(sbi->cluster_size - 1)) >> inode->i_blkbits; ++write_size: ++ aligned_size = i_size_read(inode); ++ if (aligned_size & (blocksize - 1)) { ++ aligned_size |= (blocksize - 1); ++ aligned_size++; ++ } ++ ++ if (EXFAT_I(inode)->i_size_ondisk > i_size_read(inode)) ++ EXFAT_I(inode)->i_size_ondisk = aligned_size; ++ ++ if (EXFAT_I(inode)->i_size_aligned > i_size_read(inode)) ++ EXFAT_I(inode)->i_size_aligned = aligned_size; ++ mutex_unlock(&sbi->s_lock); ++} ++ ++int exfat_getattr(const struct path *path, struct kstat *stat, ++ unsigned int request_mask, unsigned int query_flags) ++{ ++ struct inode *inode = d_backing_inode(path->dentry); ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ ++ generic_fillattr(inode, stat); ++ stat->result_mask |= STATX_BTIME; ++ stat->btime.tv_sec = ei->i_crtime.tv_sec; ++ stat->btime.tv_nsec = ei->i_crtime.tv_nsec; ++ stat->blksize = EXFAT_SB(inode->i_sb)->cluster_size; ++ return 0; ++} ++ ++int exfat_setattr(struct dentry *dentry, struct iattr *attr) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(dentry->d_sb); ++ struct inode *inode = dentry->d_inode; ++ unsigned int ia_valid; ++ int error; ++ ++ if ((attr->ia_valid & ATTR_SIZE) && ++ attr->ia_size > i_size_read(inode)) { ++ error = exfat_cont_expand(inode, attr->ia_size); ++ if (error || attr->ia_valid == ATTR_SIZE) ++ return error; ++ attr->ia_valid &= ~ATTR_SIZE; ++ } ++ ++ /* Check for setting the inode time. */ ++ ia_valid = attr->ia_valid; ++ if ((ia_valid & (ATTR_MTIME_SET | ATTR_ATIME_SET | ATTR_TIMES_SET)) && ++ exfat_allow_set_time(sbi, inode)) { ++ attr->ia_valid &= ~(ATTR_MTIME_SET | ATTR_ATIME_SET | ++ ATTR_TIMES_SET); ++ } ++ ++ error = setattr_prepare(dentry, attr); ++ attr->ia_valid = ia_valid; ++ if (error) ++ goto out; ++ ++ if (((attr->ia_valid & ATTR_UID) && ++ !uid_eq(attr->ia_uid, sbi->options.fs_uid)) || ++ ((attr->ia_valid & ATTR_GID) && ++ !gid_eq(attr->ia_gid, sbi->options.fs_gid)) || ++ ((attr->ia_valid & ATTR_MODE) && ++ (attr->ia_mode & ~(S_IFREG | S_IFLNK | S_IFDIR | 0777)))) { ++ error = -EPERM; ++ goto out; ++ } ++ ++ /* ++ * We don't return -EPERM here. Yes, strange, but this is too ++ * old behavior. ++ */ ++ if (attr->ia_valid & ATTR_MODE) { ++ if (exfat_sanitize_mode(sbi, inode, &attr->ia_mode) < 0) ++ attr->ia_valid &= ~ATTR_MODE; ++ } ++ ++ if (attr->ia_valid & ATTR_SIZE) { ++ error = exfat_block_truncate_page(inode, attr->ia_size); ++ if (error) ++ goto out; ++ ++ down_write(&EXFAT_I(inode)->truncate_lock); ++ truncate_setsize(inode, attr->ia_size); ++ exfat_truncate(inode, attr->ia_size); ++ up_write(&EXFAT_I(inode)->truncate_lock); ++ } ++ ++ setattr_copy(inode, attr); ++ mark_inode_dirty(inode); ++ ++out: ++ return error; ++} ++ ++const struct file_operations exfat_file_operations = { ++ .llseek = generic_file_llseek, ++ .read_iter = generic_file_read_iter, ++ .write_iter = generic_file_write_iter, ++ .mmap = generic_file_mmap, ++ .fsync = generic_file_fsync, ++ .splice_read = generic_file_splice_read, ++}; ++ ++const struct inode_operations exfat_file_inode_operations = { ++ .setattr = exfat_setattr, ++ .getattr = exfat_getattr, ++}; +-- +2.25.1 + diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-add-in-memory-and-on-disk-structures-and-heade.patch b/kernel/kernel/files/patches/mageia/fs-exfat-add-in-memory-and-on-disk-structures-and-heade.patch new file mode 100644 index 00000000..e347a9ee --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-add-in-memory-and-on-disk-structures-and-heade.patch @@ -0,0 +1,740 @@ +From 1acf1a564b6034b5af1e7fb23cb98cb3bb4f6003 Mon Sep 17 00:00:00 2001 +From: Namjae Jeon +Date: Mon, 2 Mar 2020 15:21:32 +0900 +Subject: [PATCH 01/14] exfat: add in-memory and on-disk structures and headers +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +This adds in-memory and on-disk structures and headers. + +Signed-off-by: Namjae Jeon +Signed-off-by: Sungjong Seo +Reviewed-by: Pali Rohár +Reviewed-by: Christoph Hellwig +Signed-off-by: Al Viro +--- + fs/exfat/exfat_fs.h | 519 +++++++++++++++++++++++++++++++++++++++++++ + fs/exfat/exfat_raw.h | 184 +++++++++++++++ + 2 files changed, 703 insertions(+) + create mode 100644 fs/exfat/exfat_fs.h + create mode 100644 fs/exfat/exfat_raw.h + +diff --git a/fs/exfat/exfat_fs.h b/fs/exfat/exfat_fs.h +new file mode 100644 +index 000000000000..67d4e46fb810 +--- /dev/null ++++ b/fs/exfat/exfat_fs.h +@@ -0,0 +1,519 @@ ++/* SPDX-License-Identifier: GPL-2.0-or-later */ ++/* ++ * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. ++ */ ++ ++#ifndef _EXFAT_FS_H ++#define _EXFAT_FS_H ++ ++#include ++#include ++#include ++ ++#define EXFAT_SUPER_MAGIC 0x2011BAB0UL ++#define EXFAT_ROOT_INO 1 ++ ++#define EXFAT_SB_DIRTY 0 ++ ++#define EXFAT_CLUSTERS_UNTRACKED (~0u) ++ ++/* ++ * exfat error flags ++ */ ++enum exfat_error_mode { ++ EXFAT_ERRORS_CONT, /* ignore error and continue */ ++ EXFAT_ERRORS_PANIC, /* panic on error */ ++ EXFAT_ERRORS_RO, /* remount r/o on error */ ++}; ++ ++/* ++ * exfat nls lossy flag ++ */ ++enum { ++ NLS_NAME_NO_LOSSY, /* no lossy */ ++ NLS_NAME_LOSSY, /* just detected incorrect filename(s) */ ++ NLS_NAME_OVERLEN, /* the length is over than its limit */ ++}; ++ ++#define EXFAT_HASH_BITS 8 ++#define EXFAT_HASH_SIZE (1UL << EXFAT_HASH_BITS) ++ ++/* ++ * Type Definitions ++ */ ++#define ES_2_ENTRIES 2 ++#define ES_ALL_ENTRIES 0 ++ ++#define DIR_DELETED 0xFFFF0321 ++ ++/* type values */ ++#define TYPE_UNUSED 0x0000 ++#define TYPE_DELETED 0x0001 ++#define TYPE_INVALID 0x0002 ++#define TYPE_CRITICAL_PRI 0x0100 ++#define TYPE_BITMAP 0x0101 ++#define TYPE_UPCASE 0x0102 ++#define TYPE_VOLUME 0x0103 ++#define TYPE_DIR 0x0104 ++#define TYPE_FILE 0x011F ++#define TYPE_CRITICAL_SEC 0x0200 ++#define TYPE_STREAM 0x0201 ++#define TYPE_EXTEND 0x0202 ++#define TYPE_ACL 0x0203 ++#define TYPE_BENIGN_PRI 0x0400 ++#define TYPE_GUID 0x0401 ++#define TYPE_PADDING 0x0402 ++#define TYPE_ACLTAB 0x0403 ++#define TYPE_BENIGN_SEC 0x0800 ++#define TYPE_ALL 0x0FFF ++ ++#define MAX_CHARSET_SIZE 6 /* max size of multi-byte character */ ++#define MAX_NAME_LENGTH 255 /* max len of file name excluding NULL */ ++#define MAX_VFSNAME_BUF_SIZE ((MAX_NAME_LENGTH + 1) * MAX_CHARSET_SIZE) ++ ++#define FAT_CACHE_SIZE 128 ++#define FAT_CACHE_HASH_SIZE 64 ++#define BUF_CACHE_SIZE 256 ++#define BUF_CACHE_HASH_SIZE 64 ++ ++#define EXFAT_HINT_NONE -1 ++#define EXFAT_MIN_SUBDIR 2 ++ ++/* ++ * helpers for cluster size to byte conversion. ++ */ ++#define EXFAT_CLU_TO_B(b, sbi) ((b) << (sbi)->cluster_size_bits) ++#define EXFAT_B_TO_CLU(b, sbi) ((b) >> (sbi)->cluster_size_bits) ++#define EXFAT_B_TO_CLU_ROUND_UP(b, sbi) \ ++ (((b - 1) >> (sbi)->cluster_size_bits) + 1) ++#define EXFAT_CLU_OFFSET(off, sbi) ((off) & ((sbi)->cluster_size - 1)) ++ ++/* ++ * helpers for block size to byte conversion. ++ */ ++#define EXFAT_BLK_TO_B(b, sb) ((b) << (sb)->s_blocksize_bits) ++#define EXFAT_B_TO_BLK(b, sb) ((b) >> (sb)->s_blocksize_bits) ++#define EXFAT_B_TO_BLK_ROUND_UP(b, sb) \ ++ (((b - 1) >> (sb)->s_blocksize_bits) + 1) ++#define EXFAT_BLK_OFFSET(off, sb) ((off) & ((sb)->s_blocksize - 1)) ++ ++/* ++ * helpers for block size to dentry size conversion. ++ */ ++#define EXFAT_B_TO_DEN_IDX(b, sbi) \ ++ ((b) << ((sbi)->cluster_size_bits - DENTRY_SIZE_BITS)) ++#define EXFAT_B_TO_DEN(b) ((b) >> DENTRY_SIZE_BITS) ++#define EXFAT_DEN_TO_B(b) ((b) << DENTRY_SIZE_BITS) ++ ++/* ++ * helpers for fat entry. ++ */ ++#define FAT_ENT_SIZE (4) ++#define FAT_ENT_SIZE_BITS (2) ++#define FAT_ENT_OFFSET_SECTOR(sb, loc) (EXFAT_SB(sb)->FAT1_start_sector + \ ++ (((u64)loc << FAT_ENT_SIZE_BITS) >> sb->s_blocksize_bits)) ++#define FAT_ENT_OFFSET_BYTE_IN_SECTOR(sb, loc) \ ++ ((loc << FAT_ENT_SIZE_BITS) & (sb->s_blocksize - 1)) ++ ++/* ++ * helpers for bitmap. ++ */ ++#define CLUSTER_TO_BITMAP_ENT(clu) ((clu) - EXFAT_RESERVED_CLUSTERS) ++#define BITMAP_ENT_TO_CLUSTER(ent) ((ent) + EXFAT_RESERVED_CLUSTERS) ++#define BITS_PER_SECTOR(sb) ((sb)->s_blocksize * BITS_PER_BYTE) ++#define BITS_PER_SECTOR_MASK(sb) (BITS_PER_SECTOR(sb) - 1) ++#define BITMAP_OFFSET_SECTOR_INDEX(sb, ent) \ ++ ((ent / BITS_PER_BYTE) >> (sb)->s_blocksize_bits) ++#define BITMAP_OFFSET_BIT_IN_SECTOR(sb, ent) (ent & BITS_PER_SECTOR_MASK(sb)) ++#define BITMAP_OFFSET_BYTE_IN_SECTOR(sb, ent) \ ++ ((ent / BITS_PER_BYTE) & ((sb)->s_blocksize - 1)) ++#define BITS_PER_BYTE_MASK 0x7 ++#define IGNORED_BITS_REMAINED(clu, clu_base) ((1 << ((clu) - (clu_base))) - 1) ++ ++struct exfat_dentry_namebuf { ++ char *lfn; ++ int lfnbuf_len; /* usally MAX_UNINAME_BUF_SIZE */ ++}; ++ ++/* unicode name structure */ ++struct exfat_uni_name { ++ /* +3 for null and for converting */ ++ unsigned short name[MAX_NAME_LENGTH + 3]; ++ unsigned short name_hash; ++ unsigned char name_len; ++}; ++ ++/* directory structure */ ++struct exfat_chain { ++ unsigned int dir; ++ unsigned int size; ++ unsigned char flags; ++}; ++ ++/* first empty entry hint information */ ++struct exfat_hint_femp { ++ /* entry index of a directory */ ++ int eidx; ++ /* count of continuous empty entry */ ++ int count; ++ /* the cluster that first empty slot exists in */ ++ struct exfat_chain cur; ++}; ++ ++/* hint structure */ ++struct exfat_hint { ++ unsigned int clu; ++ union { ++ unsigned int off; /* cluster offset */ ++ int eidx; /* entry index */ ++ }; ++}; ++ ++struct exfat_entry_set_cache { ++ /* sector number that contains file_entry */ ++ sector_t sector; ++ /* byte offset in the sector */ ++ unsigned int offset; ++ /* flag in stream entry. 01 for cluster chain, 03 for contig. */ ++ int alloc_flag; ++ unsigned int num_entries; ++ struct exfat_dentry entries[]; ++}; ++ ++struct exfat_dir_entry { ++ struct exfat_chain dir; ++ int entry; ++ unsigned int type; ++ unsigned int start_clu; ++ unsigned char flags; ++ unsigned short attr; ++ loff_t size; ++ unsigned int num_subdirs; ++ struct timespec64 atime; ++ struct timespec64 mtime; ++ struct timespec64 crtime; ++ struct exfat_dentry_namebuf namebuf; ++}; ++ ++/* ++ * exfat mount in-memory data ++ */ ++struct exfat_mount_options { ++ kuid_t fs_uid; ++ kgid_t fs_gid; ++ unsigned short fs_fmask; ++ unsigned short fs_dmask; ++ /* permission for setting the [am]time */ ++ unsigned short allow_utime; ++ /* charset for filename input/display */ ++ char *iocharset; ++ /* on error: continue, panic, remount-ro */ ++ enum exfat_error_mode errors; ++ unsigned utf8:1, /* Use of UTF-8 character set */ ++ discard:1; /* Issue discard requests on deletions */ ++ int time_offset; /* Offset of timestamps from UTC (in minutes) */ ++}; ++ ++/* ++ * EXFAT file system superblock in-memory data ++ */ ++struct exfat_sb_info { ++ unsigned long long num_sectors; /* num of sectors in volume */ ++ unsigned int num_clusters; /* num of clusters in volume */ ++ unsigned int cluster_size; /* cluster size in bytes */ ++ unsigned int cluster_size_bits; ++ unsigned int sect_per_clus; /* cluster size in sectors */ ++ unsigned int sect_per_clus_bits; ++ unsigned long long FAT1_start_sector; /* FAT1 start sector */ ++ unsigned long long FAT2_start_sector; /* FAT2 start sector */ ++ unsigned long long data_start_sector; /* data area start sector */ ++ unsigned int num_FAT_sectors; /* num of FAT sectors */ ++ unsigned int root_dir; /* root dir cluster */ ++ unsigned int dentries_per_clu; /* num of dentries per cluster */ ++ unsigned int vol_flag; /* volume dirty flag */ ++ struct buffer_head *pbr_bh; /* buffer_head of PBR sector */ ++ ++ unsigned int map_clu; /* allocation bitmap start cluster */ ++ unsigned int map_sectors; /* num of allocation bitmap sectors */ ++ struct buffer_head **vol_amap; /* allocation bitmap */ ++ ++ unsigned short *vol_utbl; /* upcase table */ ++ ++ unsigned int clu_srch_ptr; /* cluster search pointer */ ++ unsigned int used_clusters; /* number of used clusters */ ++ ++ unsigned long s_state; ++ struct mutex s_lock; /* superblock lock */ ++ struct exfat_mount_options options; ++ struct nls_table *nls_io; /* Charset used for input and display */ ++ struct ratelimit_state ratelimit; ++ ++ spinlock_t inode_hash_lock; ++ struct hlist_head inode_hashtable[EXFAT_HASH_SIZE]; ++ ++ struct rcu_head rcu; ++}; ++ ++/* ++ * EXFAT file system inode in-memory data ++ */ ++struct exfat_inode_info { ++ struct exfat_chain dir; ++ int entry; ++ unsigned int type; ++ unsigned short attr; ++ unsigned int start_clu; ++ unsigned char flags; ++ /* ++ * the copy of low 32bit of i_version to check ++ * the validation of hint_stat. ++ */ ++ unsigned int version; ++ /* file offset or dentry index for readdir */ ++ loff_t rwoffset; ++ ++ /* hint for cluster last accessed */ ++ struct exfat_hint hint_bmap; ++ /* hint for entry index we try to lookup next time */ ++ struct exfat_hint hint_stat; ++ /* hint for first empty entry */ ++ struct exfat_hint_femp hint_femp; ++ ++ spinlock_t cache_lru_lock; ++ struct list_head cache_lru; ++ int nr_caches; ++ /* for avoiding the race between alloc and free */ ++ unsigned int cache_valid_id; ++ ++ /* ++ * NOTE: i_size_ondisk is 64bits, so must hold ->inode_lock to access. ++ * physically allocated size. ++ */ ++ loff_t i_size_ondisk; ++ /* block-aligned i_size (used in cont_write_begin) */ ++ loff_t i_size_aligned; ++ /* on-disk position of directory entry or 0 */ ++ loff_t i_pos; ++ /* hash by i_location */ ++ struct hlist_node i_hash_fat; ++ /* protect bmap against truncate */ ++ struct rw_semaphore truncate_lock; ++ struct inode vfs_inode; ++ /* File creation time */ ++ struct timespec64 i_crtime; ++}; ++ ++static inline struct exfat_sb_info *EXFAT_SB(struct super_block *sb) ++{ ++ return sb->s_fs_info; ++} ++ ++static inline struct exfat_inode_info *EXFAT_I(struct inode *inode) ++{ ++ return container_of(inode, struct exfat_inode_info, vfs_inode); ++} ++ ++/* ++ * If ->i_mode can't hold 0222 (i.e. ATTR_RO), we use ->i_attrs to ++ * save ATTR_RO instead of ->i_mode. ++ * ++ * If it's directory and !sbi->options.rodir, ATTR_RO isn't read-only ++ * bit, it's just used as flag for app. ++ */ ++static inline int exfat_mode_can_hold_ro(struct inode *inode) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(inode->i_sb); ++ ++ if (S_ISDIR(inode->i_mode)) ++ return 0; ++ ++ if ((~sbi->options.fs_fmask) & 0222) ++ return 1; ++ return 0; ++} ++ ++/* Convert attribute bits and a mask to the UNIX mode. */ ++static inline mode_t exfat_make_mode(struct exfat_sb_info *sbi, ++ unsigned short attr, mode_t mode) ++{ ++ if ((attr & ATTR_READONLY) && !(attr & ATTR_SUBDIR)) ++ mode &= ~0222; ++ ++ if (attr & ATTR_SUBDIR) ++ return (mode & ~sbi->options.fs_dmask) | S_IFDIR; ++ ++ return (mode & ~sbi->options.fs_fmask) | S_IFREG; ++} ++ ++/* Return the FAT attribute byte for this inode */ ++static inline unsigned short exfat_make_attr(struct inode *inode) ++{ ++ unsigned short attr = EXFAT_I(inode)->attr; ++ ++ if (S_ISDIR(inode->i_mode)) ++ attr |= ATTR_SUBDIR; ++ if (exfat_mode_can_hold_ro(inode) && !(inode->i_mode & 0222)) ++ attr |= ATTR_READONLY; ++ return attr; ++} ++ ++static inline void exfat_save_attr(struct inode *inode, unsigned short attr) ++{ ++ if (exfat_mode_can_hold_ro(inode)) ++ EXFAT_I(inode)->attr = attr & (ATTR_RWMASK | ATTR_READONLY); ++ else ++ EXFAT_I(inode)->attr = attr & ATTR_RWMASK; ++} ++ ++static inline bool exfat_is_last_sector_in_cluster(struct exfat_sb_info *sbi, ++ sector_t sec) ++{ ++ return ((sec - sbi->data_start_sector + 1) & ++ ((1 << sbi->sect_per_clus_bits) - 1)) == 0; ++} ++ ++static inline sector_t exfat_cluster_to_sector(struct exfat_sb_info *sbi, ++ unsigned int clus) ++{ ++ return ((clus - EXFAT_RESERVED_CLUSTERS) << sbi->sect_per_clus_bits) + ++ sbi->data_start_sector; ++} ++ ++static inline int exfat_sector_to_cluster(struct exfat_sb_info *sbi, ++ sector_t sec) ++{ ++ return ((sec - sbi->data_start_sector) >> sbi->sect_per_clus_bits) + ++ EXFAT_RESERVED_CLUSTERS; ++} ++ ++/* super.c */ ++int exfat_set_vol_flags(struct super_block *sb, unsigned short new_flag); ++ ++/* fatent.c */ ++#define exfat_get_next_cluster(sb, pclu) exfat_ent_get(sb, *(pclu), pclu) ++ ++int exfat_alloc_cluster(struct inode *inode, unsigned int num_alloc, ++ struct exfat_chain *p_chain); ++int exfat_free_cluster(struct inode *inode, struct exfat_chain *p_chain); ++int exfat_ent_get(struct super_block *sb, unsigned int loc, ++ unsigned int *content); ++int exfat_ent_set(struct super_block *sb, unsigned int loc, ++ unsigned int content); ++int exfat_count_ext_entries(struct super_block *sb, struct exfat_chain *p_dir, ++ int entry, struct exfat_dentry *p_entry); ++int exfat_chain_cont_cluster(struct super_block *sb, unsigned int chain, ++ unsigned int len); ++int exfat_zeroed_cluster(struct inode *dir, unsigned int clu); ++int exfat_find_last_cluster(struct super_block *sb, struct exfat_chain *p_chain, ++ unsigned int *ret_clu); ++int exfat_count_num_clusters(struct super_block *sb, ++ struct exfat_chain *p_chain, unsigned int *ret_count); ++ ++/* balloc.c */ ++int exfat_load_bitmap(struct super_block *sb); ++void exfat_free_bitmap(struct exfat_sb_info *sbi); ++int exfat_set_bitmap(struct inode *inode, unsigned int clu); ++void exfat_clear_bitmap(struct inode *inode, unsigned int clu); ++unsigned int exfat_find_free_bitmap(struct super_block *sb, unsigned int clu); ++int exfat_count_used_clusters(struct super_block *sb, unsigned int *ret_count); ++ ++/* file.c */ ++extern const struct file_operations exfat_file_operations; ++int __exfat_truncate(struct inode *inode, loff_t new_size); ++void exfat_truncate(struct inode *inode, loff_t size); ++int exfat_setattr(struct dentry *dentry, struct iattr *attr); ++int exfat_getattr(const struct path *path, struct kstat *stat, ++ unsigned int request_mask, unsigned int query_flags); ++ ++/* namei.c */ ++extern const struct dentry_operations exfat_dentry_ops; ++extern const struct dentry_operations exfat_utf8_dentry_ops; ++ ++/* cache.c */ ++int exfat_cache_init(void); ++void exfat_cache_shutdown(void); ++void exfat_cache_init_inode(struct inode *inode); ++void exfat_cache_inval_inode(struct inode *inode); ++int exfat_get_cluster(struct inode *inode, unsigned int cluster, ++ unsigned int *fclus, unsigned int *dclus, ++ unsigned int *last_dclus, int allow_eof); ++ ++/* dir.c */ ++extern const struct inode_operations exfat_dir_inode_operations; ++extern const struct file_operations exfat_dir_operations; ++unsigned int exfat_get_entry_type(struct exfat_dentry *p_entry); ++int exfat_init_dir_entry(struct inode *inode, struct exfat_chain *p_dir, ++ int entry, unsigned int type, unsigned int start_clu, ++ unsigned long long size); ++int exfat_init_ext_entry(struct inode *inode, struct exfat_chain *p_dir, ++ int entry, int num_entries, struct exfat_uni_name *p_uniname); ++int exfat_remove_entries(struct inode *inode, struct exfat_chain *p_dir, ++ int entry, int order, int num_entries); ++int exfat_update_dir_chksum(struct inode *inode, struct exfat_chain *p_dir, ++ int entry); ++int exfat_update_dir_chksum_with_entry_set(struct super_block *sb, ++ struct exfat_entry_set_cache *es, int sync); ++int exfat_calc_num_entries(struct exfat_uni_name *p_uniname); ++int exfat_find_dir_entry(struct super_block *sb, struct exfat_inode_info *ei, ++ struct exfat_chain *p_dir, struct exfat_uni_name *p_uniname, ++ int num_entries, unsigned int type); ++int exfat_alloc_new_dir(struct inode *inode, struct exfat_chain *clu); ++int exfat_find_location(struct super_block *sb, struct exfat_chain *p_dir, ++ int entry, sector_t *sector, int *offset); ++struct exfat_dentry *exfat_get_dentry(struct super_block *sb, ++ struct exfat_chain *p_dir, int entry, struct buffer_head **bh, ++ sector_t *sector); ++struct exfat_entry_set_cache *exfat_get_dentry_set(struct super_block *sb, ++ struct exfat_chain *p_dir, int entry, unsigned int type, ++ struct exfat_dentry **file_ep); ++int exfat_count_dir_entries(struct super_block *sb, struct exfat_chain *p_dir); ++ ++/* inode.c */ ++extern const struct inode_operations exfat_file_inode_operations; ++void exfat_sync_inode(struct inode *inode); ++struct inode *exfat_build_inode(struct super_block *sb, ++ struct exfat_dir_entry *info, loff_t i_pos); ++void exfat_hash_inode(struct inode *inode, loff_t i_pos); ++void exfat_unhash_inode(struct inode *inode); ++struct inode *exfat_iget(struct super_block *sb, loff_t i_pos); ++int exfat_write_inode(struct inode *inode, struct writeback_control *wbc); ++void exfat_evict_inode(struct inode *inode); ++int exfat_block_truncate_page(struct inode *inode, loff_t from); ++ ++/* exfat/nls.c */ ++unsigned short exfat_toupper(struct super_block *sb, unsigned short a); ++int exfat_uniname_ncmp(struct super_block *sb, unsigned short *a, ++ unsigned short *b, unsigned int len); ++int exfat_utf16_to_nls(struct super_block *sb, ++ struct exfat_uni_name *uniname, unsigned char *p_cstring, ++ int len); ++int exfat_nls_to_utf16(struct super_block *sb, ++ const unsigned char *p_cstring, const int len, ++ struct exfat_uni_name *uniname, int *p_lossy); ++int exfat_create_upcase_table(struct super_block *sb); ++void exfat_free_upcase_table(struct exfat_sb_info *sbi); ++unsigned short exfat_high_surrogate(unicode_t u); ++unsigned short exfat_low_surrogate(unicode_t u); ++ ++/* exfat/misc.c */ ++void __exfat_fs_error(struct super_block *sb, int report, const char *fmt, ...) ++ __printf(3, 4) __cold; ++#define exfat_fs_error(sb, fmt, args...) \ ++ __exfat_fs_error(sb, 1, fmt, ## args) ++#define exfat_fs_error_ratelimit(sb, fmt, args...) \ ++ __exfat_fs_error(sb, __ratelimit(&EXFAT_SB(sb)->ratelimit), \ ++ fmt, ## args) ++void exfat_msg(struct super_block *sb, const char *lv, const char *fmt, ...) ++ __printf(3, 4) __cold; ++void exfat_get_entry_time(struct exfat_sb_info *sbi, struct timespec64 *ts, ++ u8 tz, __le16 time, __le16 date, u8 time_ms); ++void exfat_set_entry_time(struct exfat_sb_info *sbi, struct timespec64 *ts, ++ u8 *tz, __le16 *time, __le16 *date, u8 *time_ms); ++unsigned short exfat_calc_chksum_2byte(void *data, int len, ++ unsigned short chksum, int type); ++void exfat_update_bh(struct super_block *sb, struct buffer_head *bh, int sync); ++void exfat_chain_set(struct exfat_chain *ec, unsigned int dir, ++ unsigned int size, unsigned char flags); ++void exfat_chain_dup(struct exfat_chain *dup, struct exfat_chain *ec); ++ ++#endif /* !_EXFAT_FS_H */ +diff --git a/fs/exfat/exfat_raw.h b/fs/exfat/exfat_raw.h +new file mode 100644 +index 000000000000..2a841010e649 +--- /dev/null ++++ b/fs/exfat/exfat_raw.h +@@ -0,0 +1,184 @@ ++/* SPDX-License-Identifier: GPL-2.0-or-later */ ++/* ++ * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. ++ */ ++ ++#ifndef _EXFAT_RAW_H ++#define _EXFAT_RAW_H ++ ++#include ++ ++#define PBR_SIGNATURE 0xAA55 ++ ++#define EXFAT_MAX_FILE_LEN 255 ++ ++#define VOL_CLEAN 0x0000 ++#define VOL_DIRTY 0x0002 ++ ++#define EXFAT_EOF_CLUSTER 0xFFFFFFFFu ++#define EXFAT_BAD_CLUSTER 0xFFFFFFF7u ++#define EXFAT_FREE_CLUSTER 0 ++/* Cluster 0, 1 are reserved, the first cluster is 2 in the cluster heap. */ ++#define EXFAT_RESERVED_CLUSTERS 2 ++#define EXFAT_FIRST_CLUSTER 2 ++#define EXFAT_DATA_CLUSTER_COUNT(sbi) \ ++ ((sbi)->num_clusters - EXFAT_RESERVED_CLUSTERS) ++ ++/* AllocationPossible and NoFatChain field in GeneralSecondaryFlags Field */ ++#define ALLOC_FAT_CHAIN 0x01 ++#define ALLOC_NO_FAT_CHAIN 0x03 ++ ++#define DENTRY_SIZE 32 /* directory entry size */ ++#define DENTRY_SIZE_BITS 5 ++/* exFAT allows 8388608(256MB) directory entries */ ++#define MAX_EXFAT_DENTRIES 8388608 ++ ++/* dentry types */ ++#define EXFAT_UNUSED 0x00 /* end of directory */ ++#define EXFAT_DELETE (~0x80) ++#define IS_EXFAT_DELETED(x) ((x) < 0x80) /* deleted file (0x01~0x7F) */ ++#define EXFAT_INVAL 0x80 /* invalid value */ ++#define EXFAT_BITMAP 0x81 /* allocation bitmap */ ++#define EXFAT_UPCASE 0x82 /* upcase table */ ++#define EXFAT_VOLUME 0x83 /* volume label */ ++#define EXFAT_FILE 0x85 /* file or dir */ ++#define EXFAT_GUID 0xA0 ++#define EXFAT_PADDING 0xA1 ++#define EXFAT_ACLTAB 0xA2 ++#define EXFAT_STREAM 0xC0 /* stream entry */ ++#define EXFAT_NAME 0xC1 /* file name entry */ ++#define EXFAT_ACL 0xC2 /* stream entry */ ++ ++#define IS_EXFAT_CRITICAL_PRI(x) (x < 0xA0) ++#define IS_EXFAT_BENIGN_PRI(x) (x < 0xC0) ++#define IS_EXFAT_CRITICAL_SEC(x) (x < 0xE0) ++ ++/* checksum types */ ++#define CS_DIR_ENTRY 0 ++#define CS_PBR_SECTOR 1 ++#define CS_DEFAULT 2 ++ ++/* file attributes */ ++#define ATTR_READONLY 0x0001 ++#define ATTR_HIDDEN 0x0002 ++#define ATTR_SYSTEM 0x0004 ++#define ATTR_VOLUME 0x0008 ++#define ATTR_SUBDIR 0x0010 ++#define ATTR_ARCHIVE 0x0020 ++ ++#define ATTR_RWMASK (ATTR_HIDDEN | ATTR_SYSTEM | ATTR_VOLUME | \ ++ ATTR_SUBDIR | ATTR_ARCHIVE) ++ ++#define PBR64_JUMP_BOOT_LEN 3 ++#define PBR64_OEM_NAME_LEN 8 ++#define PBR64_RESERVED_LEN 53 ++ ++#define EXFAT_FILE_NAME_LEN 15 ++ ++/* EXFAT BIOS parameter block (64 bytes) */ ++struct bpb64 { ++ __u8 jmp_boot[PBR64_JUMP_BOOT_LEN]; ++ __u8 oem_name[PBR64_OEM_NAME_LEN]; ++ __u8 res_zero[PBR64_RESERVED_LEN]; ++} __packed; ++ ++/* EXFAT EXTEND BIOS parameter block (56 bytes) */ ++struct bsx64 { ++ __le64 vol_offset; ++ __le64 vol_length; ++ __le32 fat_offset; ++ __le32 fat_length; ++ __le32 clu_offset; ++ __le32 clu_count; ++ __le32 root_cluster; ++ __le32 vol_serial; ++ __u8 fs_version[2]; ++ __le16 vol_flags; ++ __u8 sect_size_bits; ++ __u8 sect_per_clus_bits; ++ __u8 num_fats; ++ __u8 phy_drv_no; ++ __u8 perc_in_use; ++ __u8 reserved2[7]; ++} __packed; ++ ++/* EXFAT PBR[BPB+BSX] (120 bytes) */ ++struct pbr64 { ++ struct bpb64 bpb; ++ struct bsx64 bsx; ++} __packed; ++ ++/* Common PBR[Partition Boot Record] (512 bytes) */ ++struct pbr { ++ union { ++ __u8 raw[64]; ++ struct bpb64 f64; ++ } bpb; ++ union { ++ __u8 raw[56]; ++ struct bsx64 f64; ++ } bsx; ++ __u8 boot_code[390]; ++ __le16 signature; ++} __packed; ++ ++struct exfat_dentry { ++ __u8 type; ++ union { ++ struct { ++ __u8 num_ext; ++ __le16 checksum; ++ __le16 attr; ++ __le16 reserved1; ++ __le16 create_time; ++ __le16 create_date; ++ __le16 modify_time; ++ __le16 modify_date; ++ __le16 access_time; ++ __le16 access_date; ++ __u8 create_time_ms; ++ __u8 modify_time_ms; ++ __u8 create_tz; ++ __u8 modify_tz; ++ __u8 access_tz; ++ __u8 reserved2[7]; ++ } __packed file; /* file directory entry */ ++ struct { ++ __u8 flags; ++ __u8 reserved1; ++ __u8 name_len; ++ __le16 name_hash; ++ __le16 reserved2; ++ __le64 valid_size; ++ __le32 reserved3; ++ __le32 start_clu; ++ __le64 size; ++ } __packed stream; /* stream extension directory entry */ ++ struct { ++ __u8 flags; ++ __le16 unicode_0_14[EXFAT_FILE_NAME_LEN]; ++ } __packed name; /* file name directory entry */ ++ struct { ++ __u8 flags; ++ __u8 reserved[18]; ++ __le32 start_clu; ++ __le64 size; ++ } __packed bitmap; /* allocation bitmap directory entry */ ++ struct { ++ __u8 reserved1[3]; ++ __le32 checksum; ++ __u8 reserved2[12]; ++ __le32 start_clu; ++ __le64 size; ++ } __packed upcase; /* up-case table directory entry */ ++ } __packed dentry; ++} __packed; ++ ++#define EXFAT_TZ_VALID (1 << 7) ++ ++/* Jan 1 GMT 00:00:00 1980 */ ++#define EXFAT_MIN_TIMESTAMP_SECS 315532800LL ++/* Dec 31 GMT 23:59:59 2107 */ ++#define EXFAT_MAX_TIMESTAMP_SECS 4354819199LL ++ ++#endif /* !_EXFAT_RAW_H */ +-- +2.25.1 + diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-add-inode-operations.patch b/kernel/kernel/files/patches/mageia/fs-exfat-add-inode-operations.patch new file mode 100644 index 00000000..0b47e8a9 --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-add-inode-operations.patch @@ -0,0 +1,2156 @@ +From 5f2aa075070cf5b2e6aae011d5a3390408d7d913 Mon Sep 17 00:00:00 2001 +From: Namjae Jeon +Date: Mon, 2 Mar 2020 15:21:34 +0900 +Subject: [PATCH 03/14] exfat: add inode operations +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +This adds the implementation of inode operations for exfat. + +Signed-off-by: Namjae Jeon +Signed-off-by: Sungjong Seo +Reviewed-by: Pali Rohár +Reviewed-by: Christoph Hellwig +Signed-off-by: Al Viro +--- + fs/exfat/inode.c | 671 +++++++++++++++++++++ + fs/exfat/namei.c | 1448 ++++++++++++++++++++++++++++++++++++++++++++++ + 2 files changed, 2119 insertions(+) + create mode 100644 fs/exfat/inode.c + create mode 100644 fs/exfat/namei.c + +diff --git a/fs/exfat/inode.c b/fs/exfat/inode.c +new file mode 100644 +index 000000000000..06887492f54b +--- /dev/null ++++ b/fs/exfat/inode.c +@@ -0,0 +1,671 @@ ++// SPDX-License-Identifier: GPL-2.0-or-later ++/* ++ * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. ++ */ ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++#include "exfat_raw.h" ++#include "exfat_fs.h" ++ ++static int __exfat_write_inode(struct inode *inode, int sync) ++{ ++ int ret = -EIO; ++ unsigned long long on_disk_size; ++ struct exfat_dentry *ep, *ep2; ++ struct exfat_entry_set_cache *es = NULL; ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ bool is_dir = (ei->type == TYPE_DIR) ? true : false; ++ ++ if (inode->i_ino == EXFAT_ROOT_INO) ++ return 0; ++ ++ /* ++ * If the indode is already unlinked, there is no need for updating it. ++ */ ++ if (ei->dir.dir == DIR_DELETED) ++ return 0; ++ ++ if (is_dir && ei->dir.dir == sbi->root_dir && ei->entry == -1) ++ return 0; ++ ++ exfat_set_vol_flags(sb, VOL_DIRTY); ++ ++ /* get the directory entry of given file or directory */ ++ es = exfat_get_dentry_set(sb, &(ei->dir), ei->entry, ES_ALL_ENTRIES, ++ &ep); ++ if (!es) ++ return -EIO; ++ ep2 = ep + 1; ++ ++ ep->dentry.file.attr = cpu_to_le16(exfat_make_attr(inode)); ++ ++ /* set FILE_INFO structure using the acquired struct exfat_dentry */ ++ exfat_set_entry_time(sbi, &ei->i_crtime, ++ &ep->dentry.file.create_tz, ++ &ep->dentry.file.create_time, ++ &ep->dentry.file.create_date, ++ &ep->dentry.file.create_time_ms); ++ exfat_set_entry_time(sbi, &inode->i_mtime, ++ &ep->dentry.file.modify_tz, ++ &ep->dentry.file.modify_time, ++ &ep->dentry.file.modify_date, ++ &ep->dentry.file.modify_time_ms); ++ exfat_set_entry_time(sbi, &inode->i_atime, ++ &ep->dentry.file.access_tz, ++ &ep->dentry.file.access_time, ++ &ep->dentry.file.access_date, ++ NULL); ++ ++ /* File size should be zero if there is no cluster allocated */ ++ on_disk_size = i_size_read(inode); ++ ++ if (ei->start_clu == EXFAT_EOF_CLUSTER) ++ on_disk_size = 0; ++ ++ ep2->dentry.stream.valid_size = cpu_to_le64(on_disk_size); ++ ep2->dentry.stream.size = ep2->dentry.stream.valid_size; ++ ++ ret = exfat_update_dir_chksum_with_entry_set(sb, es, sync); ++ kfree(es); ++ return ret; ++} ++ ++int exfat_write_inode(struct inode *inode, struct writeback_control *wbc) ++{ ++ int ret; ++ ++ mutex_lock(&EXFAT_SB(inode->i_sb)->s_lock); ++ ret = __exfat_write_inode(inode, wbc->sync_mode == WB_SYNC_ALL); ++ mutex_unlock(&EXFAT_SB(inode->i_sb)->s_lock); ++ ++ return ret; ++} ++ ++void exfat_sync_inode(struct inode *inode) ++{ ++ lockdep_assert_held(&EXFAT_SB(inode->i_sb)->s_lock); ++ __exfat_write_inode(inode, 1); ++} ++ ++/* ++ * Input: inode, (logical) clu_offset, target allocation area ++ * Output: errcode, cluster number ++ * *clu = (~0), if it's unable to allocate a new cluster ++ */ ++static int exfat_map_cluster(struct inode *inode, unsigned int clu_offset, ++ unsigned int *clu, int create) ++{ ++ int ret, modified = false; ++ unsigned int last_clu; ++ struct exfat_chain new_clu; ++ struct exfat_dentry *ep; ++ struct exfat_entry_set_cache *es = NULL; ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ unsigned int local_clu_offset = clu_offset; ++ unsigned int num_to_be_allocated = 0, num_clusters = 0; ++ ++ ei->rwoffset = EXFAT_CLU_TO_B(clu_offset, sbi); ++ ++ if (EXFAT_I(inode)->i_size_ondisk > 0) ++ num_clusters = ++ EXFAT_B_TO_CLU_ROUND_UP(EXFAT_I(inode)->i_size_ondisk, ++ sbi); ++ ++ if (clu_offset >= num_clusters) ++ num_to_be_allocated = clu_offset - num_clusters + 1; ++ ++ if (!create && (num_to_be_allocated > 0)) { ++ *clu = EXFAT_EOF_CLUSTER; ++ return 0; ++ } ++ ++ *clu = last_clu = ei->start_clu; ++ ++ if (ei->flags == ALLOC_NO_FAT_CHAIN) { ++ if (clu_offset > 0 && *clu != EXFAT_EOF_CLUSTER) { ++ last_clu += clu_offset - 1; ++ ++ if (clu_offset == num_clusters) ++ *clu = EXFAT_EOF_CLUSTER; ++ else ++ *clu += clu_offset; ++ } ++ } else if (ei->type == TYPE_FILE) { ++ unsigned int fclus = 0; ++ int err = exfat_get_cluster(inode, clu_offset, ++ &fclus, clu, &last_clu, 1); ++ if (err) ++ return -EIO; ++ ++ clu_offset -= fclus; ++ } else { ++ /* hint information */ ++ if (clu_offset > 0 && ei->hint_bmap.off != EXFAT_EOF_CLUSTER && ++ ei->hint_bmap.off > 0 && clu_offset >= ei->hint_bmap.off) { ++ clu_offset -= ei->hint_bmap.off; ++ /* hint_bmap.clu should be valid */ ++ WARN_ON(ei->hint_bmap.clu < 2); ++ *clu = ei->hint_bmap.clu; ++ } ++ ++ while (clu_offset > 0 && *clu != EXFAT_EOF_CLUSTER) { ++ last_clu = *clu; ++ if (exfat_get_next_cluster(sb, clu)) ++ return -EIO; ++ clu_offset--; ++ } ++ } ++ ++ if (*clu == EXFAT_EOF_CLUSTER) { ++ exfat_set_vol_flags(sb, VOL_DIRTY); ++ ++ new_clu.dir = (last_clu == EXFAT_EOF_CLUSTER) ? ++ EXFAT_EOF_CLUSTER : last_clu + 1; ++ new_clu.size = 0; ++ new_clu.flags = ei->flags; ++ ++ /* allocate a cluster */ ++ if (num_to_be_allocated < 1) { ++ /* Broken FAT (i_sze > allocated FAT) */ ++ exfat_fs_error(sb, "broken FAT chain."); ++ return -EIO; ++ } ++ ++ ret = exfat_alloc_cluster(inode, num_to_be_allocated, &new_clu); ++ if (ret) ++ return ret; ++ ++ if (new_clu.dir == EXFAT_EOF_CLUSTER || ++ new_clu.dir == EXFAT_FREE_CLUSTER) { ++ exfat_fs_error(sb, ++ "bogus cluster new allocated (last_clu : %u, new_clu : %u)", ++ last_clu, new_clu.dir); ++ return -EIO; ++ } ++ ++ /* append to the FAT chain */ ++ if (last_clu == EXFAT_EOF_CLUSTER) { ++ if (new_clu.flags == ALLOC_FAT_CHAIN) ++ ei->flags = ALLOC_FAT_CHAIN; ++ ei->start_clu = new_clu.dir; ++ modified = true; ++ } else { ++ if (new_clu.flags != ei->flags) { ++ /* no-fat-chain bit is disabled, ++ * so fat-chain should be synced with ++ * alloc-bitmap ++ */ ++ exfat_chain_cont_cluster(sb, ei->start_clu, ++ num_clusters); ++ ei->flags = ALLOC_FAT_CHAIN; ++ modified = true; ++ } ++ if (new_clu.flags == ALLOC_FAT_CHAIN) ++ if (exfat_ent_set(sb, last_clu, new_clu.dir)) ++ return -EIO; ++ } ++ ++ num_clusters += num_to_be_allocated; ++ *clu = new_clu.dir; ++ ++ if (ei->dir.dir != DIR_DELETED) { ++ es = exfat_get_dentry_set(sb, &(ei->dir), ei->entry, ++ ES_ALL_ENTRIES, &ep); ++ if (!es) ++ return -EIO; ++ /* get stream entry */ ++ ep++; ++ ++ /* update directory entry */ ++ if (modified) { ++ if (ep->dentry.stream.flags != ei->flags) ++ ep->dentry.stream.flags = ei->flags; ++ ++ if (le32_to_cpu(ep->dentry.stream.start_clu) != ++ ei->start_clu) ++ ep->dentry.stream.start_clu = ++ cpu_to_le32(ei->start_clu); ++ ++ ep->dentry.stream.valid_size = ++ cpu_to_le64(i_size_read(inode)); ++ ep->dentry.stream.size = ++ ep->dentry.stream.valid_size; ++ } ++ ++ if (exfat_update_dir_chksum_with_entry_set(sb, es, ++ inode_needs_sync(inode))) ++ return -EIO; ++ kfree(es); ++ ++ } /* end of if != DIR_DELETED */ ++ ++ inode->i_blocks += ++ num_to_be_allocated << sbi->sect_per_clus_bits; ++ ++ /* ++ * Move *clu pointer along FAT chains (hole care) because the ++ * caller of this function expect *clu to be the last cluster. ++ * This only works when num_to_be_allocated >= 2, ++ * *clu = (the first cluster of the allocated chain) => ++ * (the last cluster of ...) ++ */ ++ if (ei->flags == ALLOC_NO_FAT_CHAIN) { ++ *clu += num_to_be_allocated - 1; ++ } else { ++ while (num_to_be_allocated > 1) { ++ if (exfat_get_next_cluster(sb, clu)) ++ return -EIO; ++ num_to_be_allocated--; ++ } ++ } ++ ++ } ++ ++ /* hint information */ ++ ei->hint_bmap.off = local_clu_offset; ++ ei->hint_bmap.clu = *clu; ++ ++ return 0; ++} ++ ++static int exfat_map_new_buffer(struct exfat_inode_info *ei, ++ struct buffer_head *bh, loff_t pos) ++{ ++ if (buffer_delay(bh) && pos > ei->i_size_aligned) ++ return -EIO; ++ set_buffer_new(bh); ++ ++ /* ++ * Adjust i_size_aligned if i_size_ondisk is bigger than it. ++ */ ++ if (ei->i_size_ondisk > ei->i_size_aligned) ++ ei->i_size_aligned = ei->i_size_ondisk; ++ return 0; ++} ++ ++static int exfat_get_block(struct inode *inode, sector_t iblock, ++ struct buffer_head *bh_result, int create) ++{ ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ unsigned long max_blocks = bh_result->b_size >> inode->i_blkbits; ++ int err = 0; ++ unsigned long mapped_blocks = 0; ++ unsigned int cluster, sec_offset; ++ sector_t last_block; ++ sector_t phys = 0; ++ loff_t pos; ++ ++ mutex_lock(&sbi->s_lock); ++ last_block = EXFAT_B_TO_BLK_ROUND_UP(i_size_read(inode), sb); ++ if (iblock >= last_block && !create) ++ goto done; ++ ++ /* Is this block already allocated? */ ++ err = exfat_map_cluster(inode, iblock >> sbi->sect_per_clus_bits, ++ &cluster, create); ++ if (err) { ++ if (err != -ENOSPC) ++ exfat_fs_error_ratelimit(sb, ++ "failed to bmap (inode : %p iblock : %llu, err : %d)", ++ inode, (unsigned long long)iblock, err); ++ goto unlock_ret; ++ } ++ ++ if (cluster == EXFAT_EOF_CLUSTER) ++ goto done; ++ ++ /* sector offset in cluster */ ++ sec_offset = iblock & (sbi->sect_per_clus - 1); ++ ++ phys = exfat_cluster_to_sector(sbi, cluster) + sec_offset; ++ mapped_blocks = sbi->sect_per_clus - sec_offset; ++ max_blocks = min(mapped_blocks, max_blocks); ++ ++ /* Treat newly added block / cluster */ ++ if (iblock < last_block) ++ create = 0; ++ ++ if (create || buffer_delay(bh_result)) { ++ pos = EXFAT_BLK_TO_B((iblock + 1), sb); ++ if (ei->i_size_ondisk < pos) ++ ei->i_size_ondisk = pos; ++ } ++ ++ if (create) { ++ err = exfat_map_new_buffer(ei, bh_result, pos); ++ if (err) { ++ exfat_fs_error(sb, ++ "requested for bmap out of range(pos : (%llu) > i_size_aligned(%llu)\n", ++ pos, ei->i_size_aligned); ++ goto unlock_ret; ++ } ++ } ++ ++ if (buffer_delay(bh_result)) ++ clear_buffer_delay(bh_result); ++ map_bh(bh_result, sb, phys); ++done: ++ bh_result->b_size = EXFAT_BLK_TO_B(max_blocks, sb); ++unlock_ret: ++ mutex_unlock(&sbi->s_lock); ++ return err; ++} ++ ++static int exfat_readpage(struct file *file, struct page *page) ++{ ++ return mpage_readpage(page, exfat_get_block); ++} ++ ++static int exfat_readpages(struct file *file, struct address_space *mapping, ++ struct list_head *pages, unsigned int nr_pages) ++{ ++ return mpage_readpages(mapping, pages, nr_pages, exfat_get_block); ++} ++ ++static int exfat_writepage(struct page *page, struct writeback_control *wbc) ++{ ++ return block_write_full_page(page, exfat_get_block, wbc); ++} ++ ++static int exfat_writepages(struct address_space *mapping, ++ struct writeback_control *wbc) ++{ ++ return mpage_writepages(mapping, wbc, exfat_get_block); ++} ++ ++static void exfat_write_failed(struct address_space *mapping, loff_t to) ++{ ++ struct inode *inode = mapping->host; ++ ++ if (to > i_size_read(inode)) { ++ truncate_pagecache(inode, i_size_read(inode)); ++ exfat_truncate(inode, EXFAT_I(inode)->i_size_aligned); ++ } ++} ++ ++static int exfat_write_begin(struct file *file, struct address_space *mapping, ++ loff_t pos, unsigned int len, unsigned int flags, ++ struct page **pagep, void **fsdata) ++{ ++ int ret; ++ ++ *pagep = NULL; ++ ret = cont_write_begin(file, mapping, pos, len, flags, pagep, fsdata, ++ exfat_get_block, ++ &EXFAT_I(mapping->host)->i_size_ondisk); ++ ++ if (ret < 0) ++ exfat_write_failed(mapping, pos+len); ++ ++ return ret; ++} ++ ++static int exfat_write_end(struct file *file, struct address_space *mapping, ++ loff_t pos, unsigned int len, unsigned int copied, ++ struct page *pagep, void *fsdata) ++{ ++ struct inode *inode = mapping->host; ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ int err; ++ ++ err = generic_write_end(file, mapping, pos, len, copied, pagep, fsdata); ++ ++ if (EXFAT_I(inode)->i_size_aligned < i_size_read(inode)) { ++ exfat_fs_error(inode->i_sb, ++ "invalid size(size(%llu) > aligned(%llu)\n", ++ i_size_read(inode), EXFAT_I(inode)->i_size_aligned); ++ return -EIO; ++ } ++ ++ if (err < len) ++ exfat_write_failed(mapping, pos+len); ++ ++ if (!(err < 0) && !(ei->attr & ATTR_ARCHIVE)) { ++ inode->i_mtime = inode->i_ctime = current_time(inode); ++ ei->attr |= ATTR_ARCHIVE; ++ mark_inode_dirty(inode); ++ } ++ ++ return err; ++} ++ ++static ssize_t exfat_direct_IO(struct kiocb *iocb, struct iov_iter *iter) ++{ ++ struct address_space *mapping = iocb->ki_filp->f_mapping; ++ struct inode *inode = mapping->host; ++ loff_t size = iocb->ki_pos + iov_iter_count(iter); ++ int rw = iov_iter_rw(iter); ++ ssize_t ret; ++ ++ if (rw == WRITE) { ++ /* ++ * FIXME: blockdev_direct_IO() doesn't use ->write_begin(), ++ * so we need to update the ->i_size_aligned to block boundary. ++ * ++ * But we must fill the remaining area or hole by nul for ++ * updating ->i_size_aligned ++ * ++ * Return 0, and fallback to normal buffered write. ++ */ ++ if (EXFAT_I(inode)->i_size_aligned < size) ++ return 0; ++ } ++ ++ /* ++ * Need to use the DIO_LOCKING for avoiding the race ++ * condition of exfat_get_block() and ->truncate(). ++ */ ++ ret = blockdev_direct_IO(iocb, inode, iter, exfat_get_block); ++ if (ret < 0 && (rw & WRITE)) ++ exfat_write_failed(mapping, size); ++ return ret; ++} ++ ++static sector_t exfat_aop_bmap(struct address_space *mapping, sector_t block) ++{ ++ sector_t blocknr; ++ ++ /* exfat_get_cluster() assumes the requested blocknr isn't truncated. */ ++ down_read(&EXFAT_I(mapping->host)->truncate_lock); ++ blocknr = generic_block_bmap(mapping, block, exfat_get_block); ++ up_read(&EXFAT_I(mapping->host)->truncate_lock); ++ return blocknr; ++} ++ ++/* ++ * exfat_block_truncate_page() zeroes out a mapping from file offset `from' ++ * up to the end of the block which corresponds to `from'. ++ * This is required during truncate to physically zeroout the tail end ++ * of that block so it doesn't yield old data if the file is later grown. ++ * Also, avoid causing failure from fsx for cases of "data past EOF" ++ */ ++int exfat_block_truncate_page(struct inode *inode, loff_t from) ++{ ++ return block_truncate_page(inode->i_mapping, from, exfat_get_block); ++} ++ ++static const struct address_space_operations exfat_aops = { ++ .readpage = exfat_readpage, ++ .readpages = exfat_readpages, ++ .writepage = exfat_writepage, ++ .writepages = exfat_writepages, ++ .write_begin = exfat_write_begin, ++ .write_end = exfat_write_end, ++ .direct_IO = exfat_direct_IO, ++ .bmap = exfat_aop_bmap ++}; ++ ++static inline unsigned long exfat_hash(loff_t i_pos) ++{ ++ return hash_32(i_pos, EXFAT_HASH_BITS); ++} ++ ++void exfat_hash_inode(struct inode *inode, loff_t i_pos) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(inode->i_sb); ++ struct hlist_head *head = sbi->inode_hashtable + exfat_hash(i_pos); ++ ++ spin_lock(&sbi->inode_hash_lock); ++ EXFAT_I(inode)->i_pos = i_pos; ++ hlist_add_head(&EXFAT_I(inode)->i_hash_fat, head); ++ spin_unlock(&sbi->inode_hash_lock); ++} ++ ++void exfat_unhash_inode(struct inode *inode) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(inode->i_sb); ++ ++ spin_lock(&sbi->inode_hash_lock); ++ hlist_del_init(&EXFAT_I(inode)->i_hash_fat); ++ EXFAT_I(inode)->i_pos = 0; ++ spin_unlock(&sbi->inode_hash_lock); ++} ++ ++struct inode *exfat_iget(struct super_block *sb, loff_t i_pos) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_inode_info *info; ++ struct hlist_head *head = sbi->inode_hashtable + exfat_hash(i_pos); ++ struct inode *inode = NULL; ++ ++ spin_lock(&sbi->inode_hash_lock); ++ hlist_for_each_entry(info, head, i_hash_fat) { ++ WARN_ON(info->vfs_inode.i_sb != sb); ++ ++ if (i_pos != info->i_pos) ++ continue; ++ inode = igrab(&info->vfs_inode); ++ if (inode) ++ break; ++ } ++ spin_unlock(&sbi->inode_hash_lock); ++ return inode; ++} ++ ++/* doesn't deal with root inode */ ++static int exfat_fill_inode(struct inode *inode, struct exfat_dir_entry *info) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(inode->i_sb); ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ loff_t size = info->size; ++ ++ memcpy(&ei->dir, &info->dir, sizeof(struct exfat_chain)); ++ ei->entry = info->entry; ++ ei->attr = info->attr; ++ ei->start_clu = info->start_clu; ++ ei->flags = info->flags; ++ ei->type = info->type; ++ ++ ei->version = 0; ++ ei->hint_stat.eidx = 0; ++ ei->hint_stat.clu = info->start_clu; ++ ei->hint_femp.eidx = EXFAT_HINT_NONE; ++ ei->rwoffset = 0; ++ ei->hint_bmap.off = EXFAT_EOF_CLUSTER; ++ ei->i_pos = 0; ++ ++ inode->i_uid = sbi->options.fs_uid; ++ inode->i_gid = sbi->options.fs_gid; ++ inode_inc_iversion(inode); ++ inode->i_generation = prandom_u32(); ++ ++ if (info->attr & ATTR_SUBDIR) { /* directory */ ++ inode->i_generation &= ~1; ++ inode->i_mode = exfat_make_mode(sbi, info->attr, 0777); ++ inode->i_op = &exfat_dir_inode_operations; ++ inode->i_fop = &exfat_dir_operations; ++ set_nlink(inode, info->num_subdirs); ++ } else { /* regular file */ ++ inode->i_generation |= 1; ++ inode->i_mode = exfat_make_mode(sbi, info->attr, 0777); ++ inode->i_op = &exfat_file_inode_operations; ++ inode->i_fop = &exfat_file_operations; ++ inode->i_mapping->a_ops = &exfat_aops; ++ inode->i_mapping->nrpages = 0; ++ } ++ ++ i_size_write(inode, size); ++ ++ /* ondisk and aligned size should be aligned with block size */ ++ if (size & (inode->i_sb->s_blocksize - 1)) { ++ size |= (inode->i_sb->s_blocksize - 1); ++ size++; ++ } ++ ++ ei->i_size_aligned = size; ++ ei->i_size_ondisk = size; ++ ++ exfat_save_attr(inode, info->attr); ++ ++ inode->i_blocks = ((i_size_read(inode) + (sbi->cluster_size - 1)) & ++ ~(sbi->cluster_size - 1)) >> inode->i_blkbits; ++ inode->i_mtime = info->mtime; ++ inode->i_ctime = info->mtime; ++ ei->i_crtime = info->crtime; ++ inode->i_atime = info->atime; ++ ++ exfat_cache_init_inode(inode); ++ ++ return 0; ++} ++ ++struct inode *exfat_build_inode(struct super_block *sb, ++ struct exfat_dir_entry *info, loff_t i_pos) ++{ ++ struct inode *inode; ++ int err; ++ ++ inode = exfat_iget(sb, i_pos); ++ if (inode) ++ goto out; ++ inode = new_inode(sb); ++ if (!inode) { ++ inode = ERR_PTR(-ENOMEM); ++ goto out; ++ } ++ inode->i_ino = iunique(sb, EXFAT_ROOT_INO); ++ inode_set_iversion(inode, 1); ++ err = exfat_fill_inode(inode, info); ++ if (err) { ++ iput(inode); ++ inode = ERR_PTR(err); ++ goto out; ++ } ++ exfat_hash_inode(inode, i_pos); ++ insert_inode_hash(inode); ++out: ++ return inode; ++} ++ ++void exfat_evict_inode(struct inode *inode) ++{ ++ truncate_inode_pages(&inode->i_data, 0); ++ ++ if (!inode->i_nlink) { ++ i_size_write(inode, 0); ++ mutex_lock(&EXFAT_SB(inode->i_sb)->s_lock); ++ __exfat_truncate(inode, 0); ++ mutex_unlock(&EXFAT_SB(inode->i_sb)->s_lock); ++ } ++ ++ invalidate_inode_buffers(inode); ++ clear_inode(inode); ++ exfat_cache_inval_inode(inode); ++ exfat_unhash_inode(inode); ++} +diff --git a/fs/exfat/namei.c b/fs/exfat/namei.c +new file mode 100644 +index 000000000000..a8681d91f569 +--- /dev/null ++++ b/fs/exfat/namei.c +@@ -0,0 +1,1448 @@ ++// SPDX-License-Identifier: GPL-2.0-or-later ++/* ++ * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. ++ */ ++ ++#include ++#include ++#include ++#include ++#include ++ ++#include "exfat_raw.h" ++#include "exfat_fs.h" ++ ++static inline unsigned long exfat_d_version(struct dentry *dentry) ++{ ++ return (unsigned long) dentry->d_fsdata; ++} ++ ++static inline void exfat_d_version_set(struct dentry *dentry, ++ unsigned long version) ++{ ++ dentry->d_fsdata = (void *) version; ++} ++ ++/* ++ * If new entry was created in the parent, it could create the 8.3 alias (the ++ * shortname of logname). So, the parent may have the negative-dentry which ++ * matches the created 8.3 alias. ++ * ++ * If it happened, the negative dentry isn't actually negative anymore. So, ++ * drop it. ++ */ ++static int exfat_d_revalidate(struct dentry *dentry, unsigned int flags) ++{ ++ int ret; ++ ++ if (flags & LOOKUP_RCU) ++ return -ECHILD; ++ ++ /* ++ * This is not negative dentry. Always valid. ++ * ++ * Note, rename() to existing directory entry will have ->d_inode, and ++ * will use existing name which isn't specified name by user. ++ * ++ * We may be able to drop this positive dentry here. But dropping ++ * positive dentry isn't good idea. So it's unsupported like ++ * rename("filename", "FILENAME") for now. ++ */ ++ if (d_really_is_positive(dentry)) ++ return 1; ++ ++ /* ++ * Drop the negative dentry, in order to make sure to use the case ++ * sensitive name which is specified by user if this is for creation. ++ */ ++ if (flags & (LOOKUP_CREATE | LOOKUP_RENAME_TARGET)) ++ return 0; ++ ++ spin_lock(&dentry->d_lock); ++ ret = inode_eq_iversion(d_inode(dentry->d_parent), ++ exfat_d_version(dentry)); ++ spin_unlock(&dentry->d_lock); ++ return ret; ++} ++ ++/* returns the length of a struct qstr, ignoring trailing dots */ ++static unsigned int exfat_striptail_len(unsigned int len, const char *name) ++{ ++ while (len && name[len - 1] == '.') ++ len--; ++ return len; ++} ++ ++/* ++ * Compute the hash for the exfat name corresponding to the dentry. If the name ++ * is invalid, we leave the hash code unchanged so that the existing dentry can ++ * be used. The exfat fs routines will return ENOENT or EINVAL as appropriate. ++ */ ++static int exfat_d_hash(const struct dentry *dentry, struct qstr *qstr) ++{ ++ struct super_block *sb = dentry->d_sb; ++ struct nls_table *t = EXFAT_SB(sb)->nls_io; ++ const unsigned char *name = qstr->name; ++ unsigned int len = exfat_striptail_len(qstr->len, qstr->name); ++ unsigned long hash = init_name_hash(dentry); ++ int i, charlen; ++ wchar_t c; ++ ++ for (i = 0; i < len; i += charlen) { ++ charlen = t->char2uni(&name[i], len - i, &c); ++ if (charlen < 0) ++ return charlen; ++ hash = partial_name_hash(exfat_toupper(sb, c), hash); ++ } ++ ++ qstr->hash = end_name_hash(hash); ++ return 0; ++} ++ ++static int exfat_d_cmp(const struct dentry *dentry, unsigned int len, ++ const char *str, const struct qstr *name) ++{ ++ struct super_block *sb = dentry->d_sb; ++ struct nls_table *t = EXFAT_SB(sb)->nls_io; ++ unsigned int alen = exfat_striptail_len(name->len, name->name); ++ unsigned int blen = exfat_striptail_len(len, str); ++ wchar_t c1, c2; ++ int charlen, i; ++ ++ if (alen != blen) ++ return 1; ++ ++ for (i = 0; i < len; i += charlen) { ++ charlen = t->char2uni(&name->name[i], alen - i, &c1); ++ if (charlen < 0) ++ return 1; ++ if (charlen != t->char2uni(&str[i], blen - i, &c2)) ++ return 1; ++ ++ if (exfat_toupper(sb, c1) != exfat_toupper(sb, c2)) ++ return 1; ++ } ++ ++ return 0; ++} ++ ++const struct dentry_operations exfat_dentry_ops = { ++ .d_revalidate = exfat_d_revalidate, ++ .d_hash = exfat_d_hash, ++ .d_compare = exfat_d_cmp, ++}; ++ ++static int exfat_utf8_d_hash(const struct dentry *dentry, struct qstr *qstr) ++{ ++ struct super_block *sb = dentry->d_sb; ++ const unsigned char *name = qstr->name; ++ unsigned int len = exfat_striptail_len(qstr->len, qstr->name); ++ unsigned long hash = init_name_hash(dentry); ++ int i, charlen; ++ unicode_t u; ++ ++ for (i = 0; i < len; i += charlen) { ++ charlen = utf8_to_utf32(&name[i], len - i, &u); ++ if (charlen < 0) ++ return charlen; ++ ++ /* ++ * Convert to UTF-16: code points above U+FFFF are encoded as ++ * surrogate pairs. ++ * exfat_toupper() works only for code points up to the U+FFFF. ++ */ ++ if (u > 0xFFFF) { ++ hash = partial_name_hash(exfat_high_surrogate(u), hash); ++ hash = partial_name_hash(exfat_low_surrogate(u), hash); ++ } else { ++ hash = partial_name_hash(exfat_toupper(sb, u), hash); ++ } ++ } ++ ++ qstr->hash = end_name_hash(hash); ++ return 0; ++} ++ ++static int exfat_utf8_d_cmp(const struct dentry *dentry, unsigned int len, ++ const char *str, const struct qstr *name) ++{ ++ struct super_block *sb = dentry->d_sb; ++ unsigned int alen = exfat_striptail_len(name->len, name->name); ++ unsigned int blen = exfat_striptail_len(len, str); ++ unicode_t u_a, u_b; ++ int charlen, i; ++ ++ if (alen != blen) ++ return 1; ++ ++ for (i = 0; i < alen; i += charlen) { ++ charlen = utf8_to_utf32(&name->name[i], alen - i, &u_a); ++ if (charlen < 0) ++ return 1; ++ if (charlen != utf8_to_utf32(&str[i], blen - i, &u_b)) ++ return 1; ++ ++ if (u_a <= 0xFFFF && u_b <= 0xFFFF) { ++ if (exfat_toupper(sb, u_a) != exfat_toupper(sb, u_b)) ++ return 1; ++ } else if (u_a > 0xFFFF && u_b > 0xFFFF) { ++ if (exfat_low_surrogate(u_a) != ++ exfat_low_surrogate(u_b) || ++ exfat_high_surrogate(u_a) != ++ exfat_high_surrogate(u_b)) ++ return 1; ++ } else { ++ return 1; ++ } ++ } ++ ++ return 0; ++} ++ ++const struct dentry_operations exfat_utf8_dentry_ops = { ++ .d_revalidate = exfat_d_revalidate, ++ .d_hash = exfat_utf8_d_hash, ++ .d_compare = exfat_utf8_d_cmp, ++}; ++ ++/* used only in search empty_slot() */ ++#define CNT_UNUSED_NOHIT (-1) ++#define CNT_UNUSED_HIT (-2) ++/* search EMPTY CONTINUOUS "num_entries" entries */ ++static int exfat_search_empty_slot(struct super_block *sb, ++ struct exfat_hint_femp *hint_femp, struct exfat_chain *p_dir, ++ int num_entries) ++{ ++ int i, dentry, num_empty = 0; ++ int dentries_per_clu; ++ unsigned int type; ++ struct exfat_chain clu; ++ struct exfat_dentry *ep; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct buffer_head *bh; ++ ++ dentries_per_clu = sbi->dentries_per_clu; ++ ++ if (hint_femp->eidx != EXFAT_HINT_NONE) { ++ dentry = hint_femp->eidx; ++ if (num_entries <= hint_femp->count) { ++ hint_femp->eidx = EXFAT_HINT_NONE; ++ return dentry; ++ } ++ ++ exfat_chain_dup(&clu, &hint_femp->cur); ++ } else { ++ exfat_chain_dup(&clu, p_dir); ++ dentry = 0; ++ } ++ ++ while (clu.dir != EXFAT_EOF_CLUSTER) { ++ i = dentry & (dentries_per_clu - 1); ++ ++ for (; i < dentries_per_clu; i++, dentry++) { ++ ep = exfat_get_dentry(sb, &clu, i, &bh, NULL); ++ if (!ep) ++ return -EIO; ++ type = exfat_get_entry_type(ep); ++ brelse(bh); ++ ++ if (type == TYPE_UNUSED || type == TYPE_DELETED) { ++ num_empty++; ++ if (hint_femp->eidx == EXFAT_HINT_NONE) { ++ hint_femp->eidx = dentry; ++ hint_femp->count = CNT_UNUSED_NOHIT; ++ exfat_chain_set(&hint_femp->cur, ++ clu.dir, clu.size, clu.flags); ++ } ++ ++ if (type == TYPE_UNUSED && ++ hint_femp->count != CNT_UNUSED_HIT) ++ hint_femp->count = CNT_UNUSED_HIT; ++ } else { ++ if (hint_femp->eidx != EXFAT_HINT_NONE && ++ hint_femp->count == CNT_UNUSED_HIT) { ++ /* unused empty group means ++ * an empty group which includes ++ * unused dentry ++ */ ++ exfat_fs_error(sb, ++ "found bogus dentry(%d) beyond unused empty group(%d) (start_clu : %u, cur_clu : %u)", ++ dentry, hint_femp->eidx, ++ p_dir->dir, clu.dir); ++ return -EIO; ++ } ++ ++ num_empty = 0; ++ hint_femp->eidx = EXFAT_HINT_NONE; ++ } ++ ++ if (num_empty >= num_entries) { ++ /* found and invalidate hint_femp */ ++ hint_femp->eidx = EXFAT_HINT_NONE; ++ return (dentry - (num_entries - 1)); ++ } ++ } ++ ++ if (clu.flags == ALLOC_NO_FAT_CHAIN) { ++ if (--clu.size > 0) ++ clu.dir++; ++ else ++ clu.dir = EXFAT_EOF_CLUSTER; ++ } else { ++ if (exfat_get_next_cluster(sb, &clu.dir)) ++ return -EIO; ++ } ++ } ++ ++ return -ENOSPC; ++} ++ ++static int exfat_check_max_dentries(struct inode *inode) ++{ ++ if (EXFAT_B_TO_DEN(i_size_read(inode)) >= MAX_EXFAT_DENTRIES) { ++ /* ++ * exFAT spec allows a dir to grow upto 8388608(256MB) ++ * dentries ++ */ ++ return -ENOSPC; ++ } ++ return 0; ++} ++ ++/* find empty directory entry. ++ * if there isn't any empty slot, expand cluster chain. ++ */ ++static int exfat_find_empty_entry(struct inode *inode, ++ struct exfat_chain *p_dir, int num_entries) ++{ ++ int dentry; ++ unsigned int ret, last_clu; ++ sector_t sector; ++ loff_t size = 0; ++ struct exfat_chain clu; ++ struct exfat_dentry *ep = NULL; ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ struct exfat_hint_femp hint_femp; ++ ++ hint_femp.eidx = EXFAT_HINT_NONE; ++ ++ if (ei->hint_femp.eidx != EXFAT_HINT_NONE) { ++ memcpy(&hint_femp, &ei->hint_femp, ++ sizeof(struct exfat_hint_femp)); ++ ei->hint_femp.eidx = EXFAT_HINT_NONE; ++ } ++ ++ while ((dentry = exfat_search_empty_slot(sb, &hint_femp, p_dir, ++ num_entries)) < 0) { ++ if (dentry == -EIO) ++ break; ++ ++ if (exfat_check_max_dentries(inode)) ++ return -ENOSPC; ++ ++ /* we trust p_dir->size regardless of FAT type */ ++ if (exfat_find_last_cluster(sb, p_dir, &last_clu)) ++ return -EIO; ++ ++ /* ++ * Allocate new cluster to this directory ++ */ ++ exfat_chain_set(&clu, last_clu + 1, 0, p_dir->flags); ++ ++ /* allocate a cluster */ ++ ret = exfat_alloc_cluster(inode, 1, &clu); ++ if (ret) ++ return ret; ++ ++ if (exfat_zeroed_cluster(inode, clu.dir)) ++ return -EIO; ++ ++ /* append to the FAT chain */ ++ if (clu.flags != p_dir->flags) { ++ /* no-fat-chain bit is disabled, ++ * so fat-chain should be synced with alloc-bitmap ++ */ ++ exfat_chain_cont_cluster(sb, p_dir->dir, p_dir->size); ++ p_dir->flags = ALLOC_FAT_CHAIN; ++ hint_femp.cur.flags = ALLOC_FAT_CHAIN; ++ } ++ ++ if (clu.flags == ALLOC_FAT_CHAIN) ++ if (exfat_ent_set(sb, last_clu, clu.dir)) ++ return -EIO; ++ ++ if (hint_femp.eidx == EXFAT_HINT_NONE) { ++ /* the special case that new dentry ++ * should be allocated from the start of new cluster ++ */ ++ hint_femp.eidx = EXFAT_B_TO_DEN_IDX(p_dir->size, sbi); ++ hint_femp.count = sbi->dentries_per_clu; ++ ++ exfat_chain_set(&hint_femp.cur, clu.dir, 0, clu.flags); ++ } ++ hint_femp.cur.size++; ++ p_dir->size++; ++ size = EXFAT_CLU_TO_B(p_dir->size, sbi); ++ ++ /* update the directory entry */ ++ if (p_dir->dir != sbi->root_dir) { ++ struct buffer_head *bh; ++ ++ ep = exfat_get_dentry(sb, ++ &(ei->dir), ei->entry + 1, &bh, §or); ++ if (!ep) ++ return -EIO; ++ ++ ep->dentry.stream.valid_size = cpu_to_le64(size); ++ ep->dentry.stream.size = ep->dentry.stream.valid_size; ++ ep->dentry.stream.flags = p_dir->flags; ++ exfat_update_bh(sb, bh, IS_DIRSYNC(inode)); ++ brelse(bh); ++ if (exfat_update_dir_chksum(inode, &(ei->dir), ++ ei->entry)) ++ return -EIO; ++ } ++ ++ /* directory inode should be updated in here */ ++ i_size_write(inode, size); ++ EXFAT_I(inode)->i_size_ondisk += sbi->cluster_size; ++ EXFAT_I(inode)->i_size_aligned += sbi->cluster_size; ++ EXFAT_I(inode)->flags = p_dir->flags; ++ inode->i_blocks += 1 << sbi->sect_per_clus_bits; ++ } ++ ++ return dentry; ++} ++ ++/* ++ * Name Resolution Functions : ++ * Zero if it was successful; otherwise nonzero. ++ */ ++static int __exfat_resolve_path(struct inode *inode, const unsigned char *path, ++ struct exfat_chain *p_dir, struct exfat_uni_name *p_uniname, ++ int lookup) ++{ ++ int namelen; ++ int lossy = NLS_NAME_NO_LOSSY; ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ ++ /* strip all trailing periods */ ++ namelen = exfat_striptail_len(strlen(path), path); ++ if (!namelen) ++ return -ENOENT; ++ ++ if (strlen(path) > (MAX_NAME_LENGTH * MAX_CHARSET_SIZE)) ++ return -ENAMETOOLONG; ++ ++ /* ++ * strip all leading spaces : ++ * "MS windows 7" supports leading spaces. ++ * So we should skip this preprocessing for compatibility. ++ */ ++ ++ /* file name conversion : ++ * If lookup case, we allow bad-name for compatibility. ++ */ ++ namelen = exfat_nls_to_utf16(sb, path, namelen, p_uniname, ++ &lossy); ++ if (namelen < 0) ++ return namelen; /* return error value */ ++ ++ if ((lossy && !lookup) || !namelen) ++ return -EINVAL; ++ ++ exfat_chain_set(p_dir, ei->start_clu, ++ EXFAT_B_TO_CLU(i_size_read(inode), sbi), ei->flags); ++ ++ return 0; ++} ++ ++static inline int exfat_resolve_path(struct inode *inode, ++ const unsigned char *path, struct exfat_chain *dir, ++ struct exfat_uni_name *uni) ++{ ++ return __exfat_resolve_path(inode, path, dir, uni, 0); ++} ++ ++static inline int exfat_resolve_path_for_lookup(struct inode *inode, ++ const unsigned char *path, struct exfat_chain *dir, ++ struct exfat_uni_name *uni) ++{ ++ return __exfat_resolve_path(inode, path, dir, uni, 1); ++} ++ ++static inline loff_t exfat_make_i_pos(struct exfat_dir_entry *info) ++{ ++ return ((loff_t) info->dir.dir << 32) | (info->entry & 0xffffffff); ++} ++ ++static int exfat_add_entry(struct inode *inode, const char *path, ++ struct exfat_chain *p_dir, unsigned int type, ++ struct exfat_dir_entry *info) ++{ ++ int ret, dentry, num_entries; ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_uni_name uniname; ++ struct exfat_chain clu; ++ int clu_size = 0; ++ unsigned int start_clu = EXFAT_FREE_CLUSTER; ++ ++ ret = exfat_resolve_path(inode, path, p_dir, &uniname); ++ if (ret) ++ goto out; ++ ++ num_entries = exfat_calc_num_entries(&uniname); ++ if (num_entries < 0) { ++ ret = num_entries; ++ goto out; ++ } ++ ++ /* exfat_find_empty_entry must be called before alloc_cluster() */ ++ dentry = exfat_find_empty_entry(inode, p_dir, num_entries); ++ if (dentry < 0) { ++ ret = dentry; /* -EIO or -ENOSPC */ ++ goto out; ++ } ++ ++ if (type == TYPE_DIR) { ++ ret = exfat_alloc_new_dir(inode, &clu); ++ if (ret) ++ goto out; ++ start_clu = clu.dir; ++ clu_size = sbi->cluster_size; ++ } ++ ++ /* update the directory entry */ ++ /* fill the dos name directory entry information of the created file. ++ * the first cluster is not determined yet. (0) ++ */ ++ ret = exfat_init_dir_entry(inode, p_dir, dentry, type, ++ start_clu, clu_size); ++ if (ret) ++ goto out; ++ ++ ret = exfat_init_ext_entry(inode, p_dir, dentry, num_entries, &uniname); ++ if (ret) ++ goto out; ++ ++ memcpy(&info->dir, p_dir, sizeof(struct exfat_chain)); ++ info->entry = dentry; ++ info->flags = ALLOC_NO_FAT_CHAIN; ++ info->type = type; ++ ++ if (type == TYPE_FILE) { ++ info->attr = ATTR_ARCHIVE; ++ info->start_clu = EXFAT_EOF_CLUSTER; ++ info->size = 0; ++ info->num_subdirs = 0; ++ } else { ++ int count; ++ struct exfat_chain cdir; ++ ++ info->attr = ATTR_SUBDIR; ++ info->start_clu = start_clu; ++ info->size = clu_size; ++ ++ exfat_chain_set(&cdir, info->start_clu, ++ EXFAT_B_TO_CLU(info->size, sbi), info->flags); ++ count = exfat_count_dir_entries(sb, &cdir); ++ if (count < 0) ++ return -EIO; ++ info->num_subdirs = count + EXFAT_MIN_SUBDIR; ++ } ++ memset(&info->crtime, 0, sizeof(info->crtime)); ++ memset(&info->mtime, 0, sizeof(info->mtime)); ++ memset(&info->atime, 0, sizeof(info->atime)); ++out: ++ return ret; ++} ++ ++static int exfat_create(struct inode *dir, struct dentry *dentry, umode_t mode, ++ bool excl) ++{ ++ struct super_block *sb = dir->i_sb; ++ struct inode *inode; ++ struct exfat_chain cdir; ++ struct exfat_dir_entry info; ++ loff_t i_pos; ++ int err; ++ ++ mutex_lock(&EXFAT_SB(sb)->s_lock); ++ exfat_set_vol_flags(sb, VOL_DIRTY); ++ err = exfat_add_entry(dir, dentry->d_name.name, &cdir, TYPE_FILE, ++ &info); ++ exfat_set_vol_flags(sb, VOL_CLEAN); ++ if (err) ++ goto unlock; ++ ++ inode_inc_iversion(dir); ++ dir->i_ctime = dir->i_mtime = current_time(dir); ++ if (IS_DIRSYNC(dir)) ++ exfat_sync_inode(dir); ++ else ++ mark_inode_dirty(dir); ++ ++ i_pos = exfat_make_i_pos(&info); ++ inode = exfat_build_inode(sb, &info, i_pos); ++ if (IS_ERR(inode)) ++ goto unlock; ++ ++ inode_inc_iversion(inode); ++ inode->i_mtime = inode->i_atime = inode->i_ctime = ++ EXFAT_I(inode)->i_crtime = current_time(inode); ++ /* timestamp is already written, so mark_inode_dirty() is unneeded. */ ++ ++ d_instantiate(dentry, inode); ++unlock: ++ mutex_unlock(&EXFAT_SB(sb)->s_lock); ++ return err; ++} ++ ++/* lookup a file */ ++static int exfat_find(struct inode *dir, struct qstr *qname, ++ struct exfat_dir_entry *info) ++{ ++ int ret, dentry, num_entries, count; ++ struct exfat_chain cdir; ++ struct exfat_uni_name uni_name; ++ struct exfat_dentry *ep, *ep2; ++ struct exfat_entry_set_cache *es = NULL; ++ struct super_block *sb = dir->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_inode_info *ei = EXFAT_I(dir); ++ ++ if (qname->len == 0) ++ return -ENOENT; ++ ++ /* check the validity of directory name in the given pathname */ ++ ret = exfat_resolve_path_for_lookup(dir, qname->name, &cdir, &uni_name); ++ if (ret) ++ return ret; ++ ++ num_entries = exfat_calc_num_entries(&uni_name); ++ if (num_entries < 0) ++ return num_entries; ++ ++ /* check the validation of hint_stat and initialize it if required */ ++ if (ei->version != (inode_peek_iversion_raw(dir) & 0xffffffff)) { ++ ei->hint_stat.clu = cdir.dir; ++ ei->hint_stat.eidx = 0; ++ ei->version = (inode_peek_iversion_raw(dir) & 0xffffffff); ++ ei->hint_femp.eidx = EXFAT_HINT_NONE; ++ } ++ ++ /* search the file name for directories */ ++ dentry = exfat_find_dir_entry(sb, ei, &cdir, &uni_name, ++ num_entries, TYPE_ALL); ++ ++ if ((dentry < 0) && (dentry != -EEXIST)) ++ return dentry; /* -error value */ ++ ++ memcpy(&info->dir, &cdir.dir, sizeof(struct exfat_chain)); ++ info->entry = dentry; ++ info->num_subdirs = 0; ++ ++ /* root directory itself */ ++ if (unlikely(dentry == -EEXIST)) { ++ int num_clu = 0; ++ ++ info->type = TYPE_DIR; ++ info->attr = ATTR_SUBDIR; ++ info->flags = ALLOC_FAT_CHAIN; ++ info->start_clu = sbi->root_dir; ++ memset(&info->crtime, 0, sizeof(info->crtime)); ++ memset(&info->mtime, 0, sizeof(info->mtime)); ++ memset(&info->atime, 0, sizeof(info->atime)); ++ ++ exfat_chain_set(&cdir, sbi->root_dir, 0, ALLOC_FAT_CHAIN); ++ if (exfat_count_num_clusters(sb, &cdir, &num_clu)) ++ return -EIO; ++ info->size = num_clu << sbi->cluster_size_bits; ++ ++ count = exfat_count_dir_entries(sb, &cdir); ++ if (count < 0) ++ return -EIO; ++ ++ info->num_subdirs = count; ++ } else { ++ es = exfat_get_dentry_set(sb, &cdir, dentry, ES_2_ENTRIES, &ep); ++ if (!es) ++ return -EIO; ++ ep2 = ep + 1; ++ ++ info->type = exfat_get_entry_type(ep); ++ info->attr = le16_to_cpu(ep->dentry.file.attr); ++ info->size = le64_to_cpu(ep2->dentry.stream.valid_size); ++ if ((info->type == TYPE_FILE) && (info->size == 0)) { ++ info->flags = ALLOC_NO_FAT_CHAIN; ++ info->start_clu = EXFAT_EOF_CLUSTER; ++ } else { ++ info->flags = ep2->dentry.stream.flags; ++ info->start_clu = ++ le32_to_cpu(ep2->dentry.stream.start_clu); ++ } ++ ++ if (ei->start_clu == EXFAT_FREE_CLUSTER) { ++ exfat_fs_error(sb, ++ "non-zero size file starts with zero cluster (size : %llu, p_dir : %u, entry : 0x%08x)", ++ i_size_read(dir), ei->dir.dir, ei->entry); ++ return -EIO; ++ } ++ ++ exfat_get_entry_time(sbi, &info->crtime, ++ ep->dentry.file.create_tz, ++ ep->dentry.file.create_time, ++ ep->dentry.file.create_date, ++ ep->dentry.file.create_time_ms); ++ exfat_get_entry_time(sbi, &info->mtime, ++ ep->dentry.file.modify_tz, ++ ep->dentry.file.modify_time, ++ ep->dentry.file.modify_date, ++ ep->dentry.file.modify_time_ms); ++ exfat_get_entry_time(sbi, &info->atime, ++ ep->dentry.file.access_tz, ++ ep->dentry.file.access_time, ++ ep->dentry.file.access_date, ++ 0); ++ kfree(es); ++ ++ if (info->type == TYPE_DIR) { ++ exfat_chain_set(&cdir, info->start_clu, ++ EXFAT_B_TO_CLU(info->size, sbi), info->flags); ++ count = exfat_count_dir_entries(sb, &cdir); ++ if (count < 0) ++ return -EIO; ++ ++ info->num_subdirs = count + EXFAT_MIN_SUBDIR; ++ } ++ } ++ return 0; ++} ++ ++static int exfat_d_anon_disconn(struct dentry *dentry) ++{ ++ return IS_ROOT(dentry) && (dentry->d_flags & DCACHE_DISCONNECTED); ++} ++ ++static struct dentry *exfat_lookup(struct inode *dir, struct dentry *dentry, ++ unsigned int flags) ++{ ++ struct super_block *sb = dir->i_sb; ++ struct inode *inode; ++ struct dentry *alias; ++ struct exfat_dir_entry info; ++ int err; ++ loff_t i_pos; ++ mode_t i_mode; ++ ++ mutex_lock(&EXFAT_SB(sb)->s_lock); ++ err = exfat_find(dir, &dentry->d_name, &info); ++ if (err) { ++ if (err == -ENOENT) { ++ inode = NULL; ++ goto out; ++ } ++ goto unlock; ++ } ++ ++ i_pos = exfat_make_i_pos(&info); ++ inode = exfat_build_inode(sb, &info, i_pos); ++ if (IS_ERR(inode)) { ++ err = PTR_ERR(inode); ++ goto unlock; ++ } ++ ++ i_mode = inode->i_mode; ++ alias = d_find_alias(inode); ++ ++ /* ++ * Checking "alias->d_parent == dentry->d_parent" to make sure ++ * FS is not corrupted (especially double linked dir). ++ */ ++ if (alias && alias->d_parent == dentry->d_parent && ++ !exfat_d_anon_disconn(alias)) { ++ ++ /* ++ * Unhashed alias is able to exist because of revalidate() ++ * called by lookup_fast. You can easily make this status ++ * by calling create and lookup concurrently ++ * In such case, we reuse an alias instead of new dentry ++ */ ++ if (d_unhashed(alias)) { ++ WARN_ON(alias->d_name.hash_len != ++ dentry->d_name.hash_len); ++ exfat_msg(sb, KERN_INFO, ++ "rehashed a dentry(%p) in read lookup", alias); ++ d_drop(dentry); ++ d_rehash(alias); ++ } else if (!S_ISDIR(i_mode)) { ++ /* ++ * This inode has non anonymous-DCACHE_DISCONNECTED ++ * dentry. This means, the user did ->lookup() by an ++ * another name (longname vs 8.3 alias of it) in past. ++ * ++ * Switch to new one for reason of locality if possible. ++ */ ++ d_move(alias, dentry); ++ } ++ iput(inode); ++ mutex_unlock(&EXFAT_SB(sb)->s_lock); ++ return alias; ++ } ++ dput(alias); ++out: ++ mutex_unlock(&EXFAT_SB(sb)->s_lock); ++ if (!inode) ++ exfat_d_version_set(dentry, inode_query_iversion(dir)); ++ ++ return d_splice_alias(inode, dentry); ++unlock: ++ mutex_unlock(&EXFAT_SB(sb)->s_lock); ++ return ERR_PTR(err); ++} ++ ++/* remove an entry, BUT don't truncate */ ++static int exfat_unlink(struct inode *dir, struct dentry *dentry) ++{ ++ struct exfat_chain cdir; ++ struct exfat_dentry *ep; ++ struct super_block *sb = dir->i_sb; ++ struct inode *inode = dentry->d_inode; ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ struct buffer_head *bh; ++ sector_t sector; ++ int num_entries, entry, err = 0; ++ ++ mutex_lock(&EXFAT_SB(sb)->s_lock); ++ exfat_chain_dup(&cdir, &ei->dir); ++ entry = ei->entry; ++ if (ei->dir.dir == DIR_DELETED) { ++ exfat_msg(sb, KERN_ERR, "abnormal access to deleted dentry"); ++ err = -ENOENT; ++ goto unlock; ++ } ++ ++ ep = exfat_get_dentry(sb, &cdir, entry, &bh, §or); ++ if (!ep) { ++ err = -EIO; ++ goto unlock; ++ } ++ num_entries = exfat_count_ext_entries(sb, &cdir, entry, ep); ++ if (num_entries < 0) { ++ err = -EIO; ++ brelse(bh); ++ goto unlock; ++ } ++ num_entries++; ++ brelse(bh); ++ ++ exfat_set_vol_flags(sb, VOL_DIRTY); ++ /* update the directory entry */ ++ if (exfat_remove_entries(dir, &cdir, entry, 0, num_entries)) { ++ err = -EIO; ++ goto unlock; ++ } ++ ++ /* This doesn't modify ei */ ++ ei->dir.dir = DIR_DELETED; ++ exfat_set_vol_flags(sb, VOL_CLEAN); ++ ++ inode_inc_iversion(dir); ++ dir->i_mtime = dir->i_atime = current_time(dir); ++ if (IS_DIRSYNC(dir)) ++ exfat_sync_inode(dir); ++ else ++ mark_inode_dirty(dir); ++ ++ clear_nlink(inode); ++ inode->i_mtime = inode->i_atime = current_time(inode); ++ exfat_unhash_inode(inode); ++ exfat_d_version_set(dentry, inode_query_iversion(dir)); ++unlock: ++ mutex_unlock(&EXFAT_SB(sb)->s_lock); ++ return err; ++} ++ ++static int exfat_mkdir(struct inode *dir, struct dentry *dentry, umode_t mode) ++{ ++ struct super_block *sb = dir->i_sb; ++ struct inode *inode; ++ struct exfat_dir_entry info; ++ struct exfat_chain cdir; ++ loff_t i_pos; ++ int err; ++ ++ mutex_lock(&EXFAT_SB(sb)->s_lock); ++ exfat_set_vol_flags(sb, VOL_DIRTY); ++ err = exfat_add_entry(dir, dentry->d_name.name, &cdir, TYPE_DIR, ++ &info); ++ exfat_set_vol_flags(sb, VOL_CLEAN); ++ if (err) ++ goto unlock; ++ ++ inode_inc_iversion(dir); ++ dir->i_ctime = dir->i_mtime = current_time(dir); ++ if (IS_DIRSYNC(dir)) ++ exfat_sync_inode(dir); ++ else ++ mark_inode_dirty(dir); ++ inc_nlink(dir); ++ ++ i_pos = exfat_make_i_pos(&info); ++ inode = exfat_build_inode(sb, &info, i_pos); ++ if (IS_ERR(inode)) { ++ err = PTR_ERR(inode); ++ goto unlock; ++ } ++ ++ inode_inc_iversion(inode); ++ inode->i_mtime = inode->i_atime = inode->i_ctime = ++ EXFAT_I(inode)->i_crtime = current_time(inode); ++ /* timestamp is already written, so mark_inode_dirty() is unneeded. */ ++ ++ d_instantiate(dentry, inode); ++ ++unlock: ++ mutex_unlock(&EXFAT_SB(sb)->s_lock); ++ return err; ++} ++ ++static int exfat_check_dir_empty(struct super_block *sb, ++ struct exfat_chain *p_dir) ++{ ++ int i, dentries_per_clu; ++ unsigned int type; ++ struct exfat_chain clu; ++ struct exfat_dentry *ep; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct buffer_head *bh; ++ ++ dentries_per_clu = sbi->dentries_per_clu; ++ ++ exfat_chain_dup(&clu, p_dir); ++ ++ while (clu.dir != EXFAT_EOF_CLUSTER) { ++ for (i = 0; i < dentries_per_clu; i++) { ++ ep = exfat_get_dentry(sb, &clu, i, &bh, NULL); ++ if (!ep) ++ return -EIO; ++ type = exfat_get_entry_type(ep); ++ brelse(bh); ++ if (type == TYPE_UNUSED) ++ return 0; ++ ++ if (type != TYPE_FILE && type != TYPE_DIR) ++ continue; ++ ++ return -ENOTEMPTY; ++ } ++ ++ if (clu.flags == ALLOC_NO_FAT_CHAIN) { ++ if (--clu.size > 0) ++ clu.dir++; ++ else ++ clu.dir = EXFAT_EOF_CLUSTER; ++ } else { ++ if (exfat_get_next_cluster(sb, &(clu.dir))) ++ return -EIO; ++ } ++ } ++ ++ return 0; ++} ++ ++static int exfat_rmdir(struct inode *dir, struct dentry *dentry) ++{ ++ struct inode *inode = dentry->d_inode; ++ struct exfat_dentry *ep; ++ struct exfat_chain cdir, clu_to_free; ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ struct buffer_head *bh; ++ sector_t sector; ++ int num_entries, entry, err; ++ ++ mutex_lock(&EXFAT_SB(inode->i_sb)->s_lock); ++ ++ exfat_chain_dup(&cdir, &ei->dir); ++ entry = ei->entry; ++ ++ if (ei->dir.dir == DIR_DELETED) { ++ exfat_msg(sb, KERN_ERR, "abnormal access to deleted dentry"); ++ err = -ENOENT; ++ goto unlock; ++ } ++ ++ exfat_set_vol_flags(sb, VOL_DIRTY); ++ exfat_chain_set(&clu_to_free, ei->start_clu, ++ EXFAT_B_TO_CLU_ROUND_UP(i_size_read(inode), sbi), ei->flags); ++ ++ err = exfat_check_dir_empty(sb, &clu_to_free); ++ if (err) { ++ if (err == -EIO) ++ exfat_msg(sb, KERN_ERR, ++ "failed to exfat_check_dir_empty : err(%d)", ++ err); ++ goto unlock; ++ } ++ ++ ep = exfat_get_dentry(sb, &cdir, entry, &bh, §or); ++ if (!ep) { ++ err = -EIO; ++ goto unlock; ++ } ++ ++ num_entries = exfat_count_ext_entries(sb, &cdir, entry, ep); ++ if (num_entries < 0) { ++ err = -EIO; ++ brelse(bh); ++ goto unlock; ++ } ++ num_entries++; ++ brelse(bh); ++ ++ err = exfat_remove_entries(dir, &cdir, entry, 0, num_entries); ++ if (err) { ++ exfat_msg(sb, KERN_ERR, ++ "failed to exfat_remove_entries : err(%d)", ++ err); ++ goto unlock; ++ } ++ ei->dir.dir = DIR_DELETED; ++ exfat_set_vol_flags(sb, VOL_CLEAN); ++ ++ inode_inc_iversion(dir); ++ dir->i_mtime = dir->i_atime = current_time(dir); ++ if (IS_DIRSYNC(dir)) ++ exfat_sync_inode(dir); ++ else ++ mark_inode_dirty(dir); ++ drop_nlink(dir); ++ ++ clear_nlink(inode); ++ inode->i_mtime = inode->i_atime = current_time(inode); ++ exfat_unhash_inode(inode); ++ exfat_d_version_set(dentry, inode_query_iversion(dir)); ++unlock: ++ mutex_unlock(&EXFAT_SB(inode->i_sb)->s_lock); ++ return err; ++} ++ ++static int exfat_rename_file(struct inode *inode, struct exfat_chain *p_dir, ++ int oldentry, struct exfat_uni_name *p_uniname, ++ struct exfat_inode_info *ei) ++{ ++ int ret, num_old_entries, num_new_entries; ++ sector_t sector_old, sector_new; ++ struct exfat_dentry *epold, *epnew; ++ struct super_block *sb = inode->i_sb; ++ struct buffer_head *new_bh, *old_bh; ++ int sync = IS_DIRSYNC(inode); ++ ++ epold = exfat_get_dentry(sb, p_dir, oldentry, &old_bh, §or_old); ++ if (!epold) ++ return -EIO; ++ ++ num_old_entries = exfat_count_ext_entries(sb, p_dir, oldentry, epold); ++ if (num_old_entries < 0) ++ return -EIO; ++ num_old_entries++; ++ ++ num_new_entries = exfat_calc_num_entries(p_uniname); ++ if (num_new_entries < 0) ++ return num_new_entries; ++ ++ if (num_old_entries < num_new_entries) { ++ int newentry; ++ ++ newentry = ++ exfat_find_empty_entry(inode, p_dir, num_new_entries); ++ if (newentry < 0) ++ return newentry; /* -EIO or -ENOSPC */ ++ ++ epnew = exfat_get_dentry(sb, p_dir, newentry, &new_bh, ++ §or_new); ++ if (!epnew) ++ return -EIO; ++ ++ memcpy(epnew, epold, DENTRY_SIZE); ++ if (exfat_get_entry_type(epnew) == TYPE_FILE) { ++ epnew->dentry.file.attr |= cpu_to_le16(ATTR_ARCHIVE); ++ ei->attr |= ATTR_ARCHIVE; ++ } ++ exfat_update_bh(sb, new_bh, sync); ++ brelse(old_bh); ++ brelse(new_bh); ++ ++ epold = exfat_get_dentry(sb, p_dir, oldentry + 1, &old_bh, ++ §or_old); ++ epnew = exfat_get_dentry(sb, p_dir, newentry + 1, &new_bh, ++ §or_new); ++ if (!epold || !epnew) ++ return -EIO; ++ ++ memcpy(epnew, epold, DENTRY_SIZE); ++ exfat_update_bh(sb, new_bh, sync); ++ brelse(old_bh); ++ brelse(new_bh); ++ ++ ret = exfat_init_ext_entry(inode, p_dir, newentry, ++ num_new_entries, p_uniname); ++ if (ret) ++ return ret; ++ ++ exfat_remove_entries(inode, p_dir, oldentry, 0, ++ num_old_entries); ++ ei->entry = newentry; ++ } else { ++ if (exfat_get_entry_type(epold) == TYPE_FILE) { ++ epold->dentry.file.attr |= cpu_to_le16(ATTR_ARCHIVE); ++ ei->attr |= ATTR_ARCHIVE; ++ } ++ exfat_update_bh(sb, old_bh, sync); ++ brelse(old_bh); ++ ret = exfat_init_ext_entry(inode, p_dir, oldentry, ++ num_new_entries, p_uniname); ++ if (ret) ++ return ret; ++ ++ exfat_remove_entries(inode, p_dir, oldentry, num_new_entries, ++ num_old_entries); ++ } ++ return 0; ++} ++ ++static int exfat_move_file(struct inode *inode, struct exfat_chain *p_olddir, ++ int oldentry, struct exfat_chain *p_newdir, ++ struct exfat_uni_name *p_uniname, struct exfat_inode_info *ei) ++{ ++ int ret, newentry, num_new_entries, num_old_entries; ++ sector_t sector_mov, sector_new; ++ struct exfat_dentry *epmov, *epnew; ++ struct super_block *sb = inode->i_sb; ++ struct buffer_head *mov_bh, *new_bh; ++ ++ epmov = exfat_get_dentry(sb, p_olddir, oldentry, &mov_bh, §or_mov); ++ if (!epmov) ++ return -EIO; ++ ++ /* check if the source and target directory is the same */ ++ if (exfat_get_entry_type(epmov) == TYPE_DIR && ++ le32_to_cpu(epmov->dentry.stream.start_clu) == p_newdir->dir) ++ return -EINVAL; ++ ++ num_old_entries = exfat_count_ext_entries(sb, p_olddir, oldentry, ++ epmov); ++ if (num_old_entries < 0) ++ return -EIO; ++ num_old_entries++; ++ ++ num_new_entries = exfat_calc_num_entries(p_uniname); ++ if (num_new_entries < 0) ++ return num_new_entries; ++ ++ newentry = exfat_find_empty_entry(inode, p_newdir, num_new_entries); ++ if (newentry < 0) ++ return newentry; /* -EIO or -ENOSPC */ ++ ++ epnew = exfat_get_dentry(sb, p_newdir, newentry, &new_bh, §or_new); ++ if (!epnew) ++ return -EIO; ++ ++ memcpy(epnew, epmov, DENTRY_SIZE); ++ if (exfat_get_entry_type(epnew) == TYPE_FILE) { ++ epnew->dentry.file.attr |= cpu_to_le16(ATTR_ARCHIVE); ++ ei->attr |= ATTR_ARCHIVE; ++ } ++ exfat_update_bh(sb, new_bh, IS_DIRSYNC(inode)); ++ brelse(mov_bh); ++ brelse(new_bh); ++ ++ epmov = exfat_get_dentry(sb, p_olddir, oldentry + 1, &mov_bh, ++ §or_mov); ++ epnew = exfat_get_dentry(sb, p_newdir, newentry + 1, &new_bh, ++ §or_new); ++ if (!epmov || !epnew) ++ return -EIO; ++ ++ memcpy(epnew, epmov, DENTRY_SIZE); ++ exfat_update_bh(sb, new_bh, IS_DIRSYNC(inode)); ++ brelse(mov_bh); ++ brelse(new_bh); ++ ++ ret = exfat_init_ext_entry(inode, p_newdir, newentry, num_new_entries, ++ p_uniname); ++ if (ret) ++ return ret; ++ ++ exfat_remove_entries(inode, p_olddir, oldentry, 0, num_old_entries); ++ ++ exfat_chain_set(&ei->dir, p_newdir->dir, p_newdir->size, ++ p_newdir->flags); ++ ++ ei->entry = newentry; ++ return 0; ++} ++ ++static void exfat_update_parent_info(struct exfat_inode_info *ei, ++ struct inode *parent_inode) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(parent_inode->i_sb); ++ struct exfat_inode_info *parent_ei = EXFAT_I(parent_inode); ++ loff_t parent_isize = i_size_read(parent_inode); ++ ++ /* ++ * the problem that struct exfat_inode_info caches wrong parent info. ++ * ++ * because of flag-mismatch of ei->dir, ++ * there is abnormal traversing cluster chain. ++ */ ++ if (unlikely(parent_ei->flags != ei->dir.flags || ++ parent_isize != EXFAT_CLU_TO_B(ei->dir.size, sbi) || ++ parent_ei->start_clu != ei->dir.dir)) { ++ exfat_chain_set(&ei->dir, parent_ei->start_clu, ++ EXFAT_B_TO_CLU_ROUND_UP(parent_isize, sbi), ++ parent_ei->flags); ++ } ++} ++ ++/* rename or move a old file into a new file */ ++static int __exfat_rename(struct inode *old_parent_inode, ++ struct exfat_inode_info *ei, struct inode *new_parent_inode, ++ struct dentry *new_dentry) ++{ ++ int ret; ++ int dentry; ++ struct exfat_chain olddir, newdir; ++ struct exfat_chain *p_dir = NULL; ++ struct exfat_uni_name uni_name; ++ struct exfat_dentry *ep; ++ struct super_block *sb = old_parent_inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ const unsigned char *new_path = new_dentry->d_name.name; ++ struct inode *new_inode = new_dentry->d_inode; ++ int num_entries; ++ struct exfat_inode_info *new_ei = NULL; ++ unsigned int new_entry_type = TYPE_UNUSED; ++ int new_entry = 0; ++ struct buffer_head *old_bh, *new_bh = NULL; ++ ++ /* check the validity of pointer parameters */ ++ if (new_path == NULL || strlen(new_path) == 0) ++ return -EINVAL; ++ ++ if (ei->dir.dir == DIR_DELETED) { ++ exfat_msg(sb, KERN_ERR, ++ "abnormal access to deleted source dentry"); ++ return -ENOENT; ++ } ++ ++ exfat_update_parent_info(ei, old_parent_inode); ++ ++ exfat_chain_dup(&olddir, &ei->dir); ++ dentry = ei->entry; ++ ++ ep = exfat_get_dentry(sb, &olddir, dentry, &old_bh, NULL); ++ if (!ep) { ++ ret = -EIO; ++ goto out; ++ } ++ brelse(old_bh); ++ ++ /* check whether new dir is existing directory and empty */ ++ if (new_inode) { ++ ret = -EIO; ++ new_ei = EXFAT_I(new_inode); ++ ++ if (new_ei->dir.dir == DIR_DELETED) { ++ exfat_msg(sb, KERN_ERR, ++ "abnormal access to deleted target dentry"); ++ goto out; ++ } ++ ++ exfat_update_parent_info(new_ei, new_parent_inode); ++ ++ p_dir = &(new_ei->dir); ++ new_entry = new_ei->entry; ++ ep = exfat_get_dentry(sb, p_dir, new_entry, &new_bh, NULL); ++ if (!ep) ++ goto out; ++ ++ new_entry_type = exfat_get_entry_type(ep); ++ brelse(new_bh); ++ ++ /* if new_inode exists, update ei */ ++ if (new_entry_type == TYPE_DIR) { ++ struct exfat_chain new_clu; ++ ++ new_clu.dir = new_ei->start_clu; ++ new_clu.size = ++ EXFAT_B_TO_CLU_ROUND_UP(i_size_read(new_inode), ++ sbi); ++ new_clu.flags = new_ei->flags; ++ ++ ret = exfat_check_dir_empty(sb, &new_clu); ++ if (ret) ++ goto out; ++ } ++ } ++ ++ /* check the validity of directory name in the given new pathname */ ++ ret = exfat_resolve_path(new_parent_inode, new_path, &newdir, ++ &uni_name); ++ if (ret) ++ goto out; ++ ++ exfat_set_vol_flags(sb, VOL_DIRTY); ++ ++ if (olddir.dir == newdir.dir) ++ ret = exfat_rename_file(new_parent_inode, &olddir, dentry, ++ &uni_name, ei); ++ else ++ ret = exfat_move_file(new_parent_inode, &olddir, dentry, ++ &newdir, &uni_name, ei); ++ ++ if (!ret && new_inode) { ++ /* delete entries of new_dir */ ++ ep = exfat_get_dentry(sb, p_dir, new_entry, &new_bh, NULL); ++ if (!ep) { ++ ret = -EIO; ++ goto del_out; ++ } ++ ++ num_entries = exfat_count_ext_entries(sb, p_dir, new_entry, ep); ++ if (num_entries < 0) { ++ ret = -EIO; ++ goto del_out; ++ } ++ brelse(new_bh); ++ ++ if (exfat_remove_entries(new_inode, p_dir, new_entry, 0, ++ num_entries + 1)) { ++ ret = -EIO; ++ goto del_out; ++ } ++ ++ /* Free the clusters if new_inode is a dir(as if exfat_rmdir) */ ++ if (new_entry_type == TYPE_DIR) { ++ /* new_ei, new_clu_to_free */ ++ struct exfat_chain new_clu_to_free; ++ ++ exfat_chain_set(&new_clu_to_free, new_ei->start_clu, ++ EXFAT_B_TO_CLU_ROUND_UP(i_size_read(new_inode), ++ sbi), new_ei->flags); ++ ++ if (exfat_free_cluster(new_inode, &new_clu_to_free)) { ++ /* just set I/O error only */ ++ ret = -EIO; ++ } ++ ++ i_size_write(new_inode, 0); ++ new_ei->start_clu = EXFAT_EOF_CLUSTER; ++ new_ei->flags = ALLOC_NO_FAT_CHAIN; ++ } ++del_out: ++ /* Update new_inode ei ++ * Prevent syncing removed new_inode ++ * (new_ei is already initialized above code ("if (new_inode)") ++ */ ++ new_ei->dir.dir = DIR_DELETED; ++ } ++ exfat_set_vol_flags(sb, VOL_CLEAN); ++out: ++ return ret; ++} ++ ++static int exfat_rename(struct inode *old_dir, struct dentry *old_dentry, ++ struct inode *new_dir, struct dentry *new_dentry, ++ unsigned int flags) ++{ ++ struct inode *old_inode, *new_inode; ++ struct super_block *sb = old_dir->i_sb; ++ loff_t i_pos; ++ int err; ++ ++ /* ++ * The VFS already checks for existence, so for local filesystems ++ * the RENAME_NOREPLACE implementation is equivalent to plain rename. ++ * Don't support any other flags ++ */ ++ if (flags & ~RENAME_NOREPLACE) ++ return -EINVAL; ++ ++ mutex_lock(&EXFAT_SB(sb)->s_lock); ++ old_inode = old_dentry->d_inode; ++ new_inode = new_dentry->d_inode; ++ ++ err = __exfat_rename(old_dir, EXFAT_I(old_inode), new_dir, new_dentry); ++ if (err) ++ goto unlock; ++ ++ inode_inc_iversion(new_dir); ++ new_dir->i_ctime = new_dir->i_mtime = new_dir->i_atime = ++ EXFAT_I(new_dir)->i_crtime = current_time(new_dir); ++ if (IS_DIRSYNC(new_dir)) ++ exfat_sync_inode(new_dir); ++ else ++ mark_inode_dirty(new_dir); ++ ++ i_pos = ((loff_t)EXFAT_I(old_inode)->dir.dir << 32) | ++ (EXFAT_I(old_inode)->entry & 0xffffffff); ++ exfat_unhash_inode(old_inode); ++ exfat_hash_inode(old_inode, i_pos); ++ if (IS_DIRSYNC(new_dir)) ++ exfat_sync_inode(old_inode); ++ else ++ mark_inode_dirty(old_inode); ++ ++ if (S_ISDIR(old_inode->i_mode) && old_dir != new_dir) { ++ drop_nlink(old_dir); ++ if (!new_inode) ++ inc_nlink(new_dir); ++ } ++ ++ inode_inc_iversion(old_dir); ++ old_dir->i_ctime = old_dir->i_mtime = current_time(old_dir); ++ if (IS_DIRSYNC(old_dir)) ++ exfat_sync_inode(old_dir); ++ else ++ mark_inode_dirty(old_dir); ++ ++ if (new_inode) { ++ exfat_unhash_inode(new_inode); ++ ++ /* skip drop_nlink if new_inode already has been dropped */ ++ if (new_inode->i_nlink) { ++ drop_nlink(new_inode); ++ if (S_ISDIR(new_inode->i_mode)) ++ drop_nlink(new_inode); ++ } else { ++ exfat_msg(sb, KERN_WARNING, ++ "abnormal access to an inode dropped"); ++ WARN_ON(new_inode->i_nlink == 0); ++ } ++ new_inode->i_ctime = EXFAT_I(new_inode)->i_crtime = ++ current_time(new_inode); ++ } ++ ++unlock: ++ mutex_unlock(&EXFAT_SB(sb)->s_lock); ++ return err; ++} ++ ++const struct inode_operations exfat_dir_inode_operations = { ++ .create = exfat_create, ++ .lookup = exfat_lookup, ++ .unlink = exfat_unlink, ++ .mkdir = exfat_mkdir, ++ .rmdir = exfat_rmdir, ++ .rename = exfat_rename, ++ .setattr = exfat_setattr, ++ .getattr = exfat_getattr, ++}; +-- +2.25.1 + diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-add-misc-operations.patch b/kernel/kernel/files/patches/mageia/fs-exfat-add-misc-operations.patch new file mode 100644 index 00000000..5d461d19 --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-add-misc-operations.patch @@ -0,0 +1,193 @@ +From 772b29cca528fcb21374bb3e597d848779938d16 Mon Sep 17 00:00:00 2001 +From: Namjae Jeon +Date: Mon, 2 Mar 2020 15:21:40 +0900 +Subject: [PATCH 09/14] exfat: add misc operations +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +This adds the implementation of misc operations for exfat. + +Signed-off-by: Namjae Jeon +Signed-off-by: Sungjong Seo +Reviewed-by: Arnd Bergmann +Reviewed-by: Pali Rohár +Reviewed-by: Christoph Hellwig +Signed-off-by: Al Viro +--- + fs/exfat/misc.c | 163 ++++++++++++++++++++++++++++++++++++++++++++++++ + 1 file changed, 163 insertions(+) + create mode 100644 fs/exfat/misc.c + +diff --git a/fs/exfat/misc.c b/fs/exfat/misc.c +new file mode 100644 +index 000000000000..14a3300848f6 +--- /dev/null ++++ b/fs/exfat/misc.c +@@ -0,0 +1,163 @@ ++// SPDX-License-Identifier: GPL-2.0-or-later ++/* ++ * Written 1992,1993 by Werner Almesberger ++ * 22/11/2000 - Fixed fat_date_unix2dos for dates earlier than 01/01/1980 ++ * and date_dos2unix for date==0 by Igor Zhbanov(bsg@uniyar.ac.ru) ++ * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. ++ */ ++ ++#include ++#include ++#include ++#include ++ ++#include "exfat_raw.h" ++#include "exfat_fs.h" ++ ++/* ++ * exfat_fs_error reports a file system problem that might indicate fa data ++ * corruption/inconsistency. Depending on 'errors' mount option the ++ * panic() is called, or error message is printed FAT and nothing is done, ++ * or filesystem is remounted read-only (default behavior). ++ * In case the file system is remounted read-only, it can be made writable ++ * again by remounting it. ++ */ ++void __exfat_fs_error(struct super_block *sb, int report, const char *fmt, ...) ++{ ++ struct exfat_mount_options *opts = &EXFAT_SB(sb)->options; ++ va_list args; ++ struct va_format vaf; ++ ++ if (report) { ++ va_start(args, fmt); ++ vaf.fmt = fmt; ++ vaf.va = &args; ++ exfat_msg(sb, KERN_ERR, "error, %pV\n", &vaf); ++ va_end(args); ++ } ++ ++ if (opts->errors == EXFAT_ERRORS_PANIC) { ++ panic("exFAT-fs (%s): fs panic from previous error\n", ++ sb->s_id); ++ } else if (opts->errors == EXFAT_ERRORS_RO && !sb_rdonly(sb)) { ++ sb->s_flags |= SB_RDONLY; ++ exfat_msg(sb, KERN_ERR, "Filesystem has been set read-only"); ++ } ++} ++ ++/* ++ * exfat_msg() - print preformated EXFAT specific messages. ++ * All logs except what uses exfat_fs_error() should be written by exfat_msg() ++ */ ++void exfat_msg(struct super_block *sb, const char *level, const char *fmt, ...) ++{ ++ struct va_format vaf; ++ va_list args; ++ ++ va_start(args, fmt); ++ vaf.fmt = fmt; ++ vaf.va = &args; ++ /* level means KERN_ pacility level */ ++ printk("%sexFAT-fs (%s): %pV\n", level, sb->s_id, &vaf); ++ va_end(args); ++} ++ ++#define SECS_PER_MIN (60) ++#define TIMEZONE_SEC(x) ((x) * 15 * SECS_PER_MIN) ++ ++static void exfat_adjust_tz(struct timespec64 *ts, u8 tz_off) ++{ ++ if (tz_off <= 0x3F) ++ ts->tv_sec -= TIMEZONE_SEC(tz_off); ++ else /* 0x40 <= (tz_off & 0x7F) <=0x7F */ ++ ts->tv_sec += TIMEZONE_SEC(0x80 - tz_off); ++} ++ ++/* Convert a EXFAT time/date pair to a UNIX date (seconds since 1 1 70). */ ++void exfat_get_entry_time(struct exfat_sb_info *sbi, struct timespec64 *ts, ++ u8 tz, __le16 time, __le16 date, u8 time_ms) ++{ ++ u16 t = le16_to_cpu(time); ++ u16 d = le16_to_cpu(date); ++ ++ ts->tv_sec = mktime64(1980 + (d >> 9), d >> 5 & 0x000F, d & 0x001F, ++ t >> 11, (t >> 5) & 0x003F, (t & 0x001F) << 1); ++ ++ ++ /* time_ms field represent 0 ~ 199(1990 ms) */ ++ if (time_ms) { ++ ts->tv_sec += time_ms / 100; ++ ts->tv_nsec = (time_ms % 100) * 10 * NSEC_PER_MSEC; ++ } ++ ++ if (tz & EXFAT_TZ_VALID) ++ /* Adjust timezone to UTC0. */ ++ exfat_adjust_tz(ts, tz & ~EXFAT_TZ_VALID); ++ else ++ /* Convert from local time to UTC using time_offset. */ ++ ts->tv_sec -= sbi->options.time_offset * SECS_PER_MIN; ++} ++ ++/* Convert linear UNIX date to a EXFAT time/date pair. */ ++void exfat_set_entry_time(struct exfat_sb_info *sbi, struct timespec64 *ts, ++ u8 *tz, __le16 *time, __le16 *date, u8 *time_ms) ++{ ++ struct tm tm; ++ u16 t, d; ++ ++ time64_to_tm(ts->tv_sec, 0, &tm); ++ t = (tm.tm_hour << 11) | (tm.tm_min << 5) | (tm.tm_sec >> 1); ++ d = ((tm.tm_year - 80) << 9) | ((tm.tm_mon + 1) << 5) | tm.tm_mday; ++ ++ *time = cpu_to_le16(t); ++ *date = cpu_to_le16(d); ++ ++ /* time_ms field represent 0 ~ 199(1990 ms) */ ++ if (time_ms) ++ *time_ms = (tm.tm_sec & 1) * 100 + ++ ts->tv_nsec / (10 * NSEC_PER_MSEC); ++ ++ /* ++ * Record 00h value for OffsetFromUtc field and 1 value for OffsetValid ++ * to indicate that local time and UTC are the same. ++ */ ++ *tz = EXFAT_TZ_VALID; ++} ++ ++unsigned short exfat_calc_chksum_2byte(void *data, int len, ++ unsigned short chksum, int type) ++{ ++ int i; ++ unsigned char *c = (unsigned char *)data; ++ ++ for (i = 0; i < len; i++, c++) { ++ if (((i == 2) || (i == 3)) && (type == CS_DIR_ENTRY)) ++ continue; ++ chksum = (((chksum & 1) << 15) | ((chksum & 0xFFFE) >> 1)) + ++ (unsigned short)*c; ++ } ++ return chksum; ++} ++ ++void exfat_update_bh(struct super_block *sb, struct buffer_head *bh, int sync) ++{ ++ set_bit(EXFAT_SB_DIRTY, &EXFAT_SB(sb)->s_state); ++ set_buffer_uptodate(bh); ++ mark_buffer_dirty(bh); ++ ++ if (sync) ++ sync_dirty_buffer(bh); ++} ++ ++void exfat_chain_set(struct exfat_chain *ec, unsigned int dir, ++ unsigned int size, unsigned char flags) ++{ ++ ec->dir = dir; ++ ec->size = size; ++ ec->flags = flags; ++} ++ ++void exfat_chain_dup(struct exfat_chain *dup, struct exfat_chain *ec) ++{ ++ return exfat_chain_set(dup, ec->dir, ec->size, ec->flags); ++} +-- +2.25.1 + diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-add-module_alias_fs.patch b/kernel/kernel/files/patches/mageia/fs-exfat-add-module_alias_fs.patch new file mode 100644 index 00000000..6232c18b --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-add-module_alias_fs.patch @@ -0,0 +1,30 @@ +From c37f83b424911f9bb6c9f17a4543c9c77cd73282 Mon Sep 17 00:00:00 2001 +From: Thomas Backlund +Date: Sat, 4 Apr 2020 23:00:31 +0300 +Subject: [PATCH v2] exfat: add missing MODULE_ALIAS_FS() + +This adds the necessary MODULE_ALIAS_FS() to exfat so the module gets +automatically loaded when an exfat filesystem is mounted. + +Signed-off-by: Thomas Backlund +Cc: Namjae Jeon +Cc: Sungjong Seo +--- + fs/exfat/super.c | 1 + + 1 file changed, 1 insertion(+) + +diff --git a/fs/exfat/super.c b/fs/exfat/super.c +index 16ed202ef527..b4a4063a0272 100644 +--- a/fs/exfat/super.c ++++ b/fs/exfat/super.c +@@ -717,6 +717,7 @@ static void __exit exit_exfat_fs(void) + module_init(init_exfat_fs); + module_exit(exit_exfat_fs); + ++MODULE_ALIAS_FS("exfat"); + MODULE_LICENSE("GPL"); + MODULE_DESCRIPTION("exFAT filesystem support"); + MODULE_AUTHOR("Samsung Electronics Co., Ltd."); +-- +2.26.0 + diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-add-nls-operations.patch b/kernel/kernel/files/patches/mageia/fs-exfat-add-nls-operations.patch new file mode 100644 index 00000000..5c5792d5 --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-add-nls-operations.patch @@ -0,0 +1,860 @@ +From 370e812b3ec190fa492c9fd5a80c38b086d105c0 Mon Sep 17 00:00:00 2001 +From: Namjae Jeon +Date: Mon, 2 Mar 2020 15:21:41 +0900 +Subject: [PATCH 10/14] exfat: add nls operations +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +This adds the implementation of nls operations for exfat. + +Signed-off-by: Namjae Jeon +Signed-off-by: Sungjong Seo +Reviewed-by: Pali Rohár +Reviewed-by: Christoph Hellwig +Signed-off-by: Al Viro +--- + fs/exfat/nls.c | 831 +++++++++++++++++++++++++++++++++++++++++++++++++ + 1 file changed, 831 insertions(+) + create mode 100644 fs/exfat/nls.c + +diff --git a/fs/exfat/nls.c b/fs/exfat/nls.c +new file mode 100644 +index 000000000000..6d1c3ae130ff +--- /dev/null ++++ b/fs/exfat/nls.c +@@ -0,0 +1,831 @@ ++// SPDX-License-Identifier: GPL-2.0-or-later ++/* ++ * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. ++ */ ++ ++#include ++#include ++#include ++#include ++ ++#include "exfat_raw.h" ++#include "exfat_fs.h" ++ ++/* Upcase tabel macro */ ++#define EXFAT_NUM_UPCASE (2918) ++#define UTBL_COUNT (0x10000) ++ ++/* ++ * Upcase table in compressed format (7.2.5.1 Recommended Up-case Table ++ * in exfat specification, See: ++ * https://docs.microsoft.com/en-us/windows/win32/fileio/exfat-specification). ++ */ ++static const unsigned short uni_def_upcase[EXFAT_NUM_UPCASE] = { ++ 0x0000, 0x0001, 0x0002, 0x0003, 0x0004, 0x0005, 0x0006, 0x0007, ++ 0x0008, 0x0009, 0x000a, 0x000b, 0x000c, 0x000d, 0x000e, 0x000f, ++ 0x0010, 0x0011, 0x0012, 0x0013, 0x0014, 0x0015, 0x0016, 0x0017, ++ 0x0018, 0x0019, 0x001a, 0x001b, 0x001c, 0x001d, 0x001e, 0x001f, ++ 0x0020, 0x0021, 0x0022, 0x0023, 0x0024, 0x0025, 0x0026, 0x0027, ++ 0x0028, 0x0029, 0x002a, 0x002b, 0x002c, 0x002d, 0x002e, 0x002f, ++ 0x0030, 0x0031, 0x0032, 0x0033, 0x0034, 0x0035, 0x0036, 0x0037, ++ 0x0038, 0x0039, 0x003a, 0x003b, 0x003c, 0x003d, 0x003e, 0x003f, ++ 0x0040, 0x0041, 0x0042, 0x0043, 0x0044, 0x0045, 0x0046, 0x0047, ++ 0x0048, 0x0049, 0x004a, 0x004b, 0x004c, 0x004d, 0x004e, 0x004f, ++ 0x0050, 0x0051, 0x0052, 0x0053, 0x0054, 0x0055, 0x0056, 0x0057, ++ 0x0058, 0x0059, 0x005a, 0x005b, 0x005c, 0x005d, 0x005e, 0x005f, ++ 0x0060, 0x0041, 0x0042, 0x0043, 0x0044, 0x0045, 0x0046, 0x0047, ++ 0x0048, 0x0049, 0x004a, 0x004b, 0x004c, 0x004d, 0x004e, 0x004f, ++ 0x0050, 0x0051, 0x0052, 0x0053, 0x0054, 0x0055, 0x0056, 0x0057, ++ 0x0058, 0x0059, 0x005a, 0x007b, 0x007c, 0x007d, 0x007e, 0x007f, ++ 0x0080, 0x0081, 0x0082, 0x0083, 0x0084, 0x0085, 0x0086, 0x0087, ++ 0x0088, 0x0089, 0x008a, 0x008b, 0x008c, 0x008d, 0x008e, 0x008f, ++ 0x0090, 0x0091, 0x0092, 0x0093, 0x0094, 0x0095, 0x0096, 0x0097, ++ 0x0098, 0x0099, 0x009a, 0x009b, 0x009c, 0x009d, 0x009e, 0x009f, ++ 0x00a0, 0x00a1, 0x00a2, 0x00a3, 0x00a4, 0x00a5, 0x00a6, 0x00a7, ++ 0x00a8, 0x00a9, 0x00aa, 0x00ab, 0x00ac, 0x00ad, 0x00ae, 0x00af, ++ 0x00b0, 0x00b1, 0x00b2, 0x00b3, 0x00b4, 0x00b5, 0x00b6, 0x00b7, ++ 0x00b8, 0x00b9, 0x00ba, 0x00bb, 0x00bc, 0x00bd, 0x00be, 0x00bf, ++ 0x00c0, 0x00c1, 0x00c2, 0x00c3, 0x00c4, 0x00c5, 0x00c6, 0x00c7, ++ 0x00c8, 0x00c9, 0x00ca, 0x00cb, 0x00cc, 0x00cd, 0x00ce, 0x00cf, ++ 0x00d0, 0x00d1, 0x00d2, 0x00d3, 0x00d4, 0x00d5, 0x00d6, 0x00d7, ++ 0x00d8, 0x00d9, 0x00da, 0x00db, 0x00dc, 0x00dd, 0x00de, 0x00df, ++ 0x00c0, 0x00c1, 0x00c2, 0x00c3, 0x00c4, 0x00c5, 0x00c6, 0x00c7, ++ 0x00c8, 0x00c9, 0x00ca, 0x00cb, 0x00cc, 0x00cd, 0x00ce, 0x00cf, ++ 0x00d0, 0x00d1, 0x00d2, 0x00d3, 0x00d4, 0x00d5, 0x00d6, 0x00f7, ++ 0x00d8, 0x00d9, 0x00da, 0x00db, 0x00dc, 0x00dd, 0x00de, 0x0178, ++ 0x0100, 0x0100, 0x0102, 0x0102, 0x0104, 0x0104, 0x0106, 0x0106, ++ 0x0108, 0x0108, 0x010a, 0x010a, 0x010c, 0x010c, 0x010e, 0x010e, ++ 0x0110, 0x0110, 0x0112, 0x0112, 0x0114, 0x0114, 0x0116, 0x0116, ++ 0x0118, 0x0118, 0x011a, 0x011a, 0x011c, 0x011c, 0x011e, 0x011e, ++ 0x0120, 0x0120, 0x0122, 0x0122, 0x0124, 0x0124, 0x0126, 0x0126, ++ 0x0128, 0x0128, 0x012a, 0x012a, 0x012c, 0x012c, 0x012e, 0x012e, ++ 0x0130, 0x0131, 0x0132, 0x0132, 0x0134, 0x0134, 0x0136, 0x0136, ++ 0x0138, 0x0139, 0x0139, 0x013b, 0x013b, 0x013d, 0x013d, 0x013f, ++ 0x013f, 0x0141, 0x0141, 0x0143, 0x0143, 0x0145, 0x0145, 0x0147, ++ 0x0147, 0x0149, 0x014a, 0x014a, 0x014c, 0x014c, 0x014e, 0x014e, ++ 0x0150, 0x0150, 0x0152, 0x0152, 0x0154, 0x0154, 0x0156, 0x0156, ++ 0x0158, 0x0158, 0x015a, 0x015a, 0x015c, 0x015c, 0x015e, 0x015e, ++ 0x0160, 0x0160, 0x0162, 0x0162, 0x0164, 0x0164, 0x0166, 0x0166, ++ 0x0168, 0x0168, 0x016a, 0x016a, 0x016c, 0x016c, 0x016e, 0x016e, ++ 0x0170, 0x0170, 0x0172, 0x0172, 0x0174, 0x0174, 0x0176, 0x0176, ++ 0x0178, 0x0179, 0x0179, 0x017b, 0x017b, 0x017d, 0x017d, 0x017f, ++ 0x0243, 0x0181, 0x0182, 0x0182, 0x0184, 0x0184, 0x0186, 0x0187, ++ 0x0187, 0x0189, 0x018a, 0x018b, 0x018b, 0x018d, 0x018e, 0x018f, ++ 0x0190, 0x0191, 0x0191, 0x0193, 0x0194, 0x01f6, 0x0196, 0x0197, ++ 0x0198, 0x0198, 0x023d, 0x019b, 0x019c, 0x019d, 0x0220, 0x019f, ++ 0x01a0, 0x01a0, 0x01a2, 0x01a2, 0x01a4, 0x01a4, 0x01a6, 0x01a7, ++ 0x01a7, 0x01a9, 0x01aa, 0x01ab, 0x01ac, 0x01ac, 0x01ae, 0x01af, ++ 0x01af, 0x01b1, 0x01b2, 0x01b3, 0x01b3, 0x01b5, 0x01b5, 0x01b7, ++ 0x01b8, 0x01b8, 0x01ba, 0x01bb, 0x01bc, 0x01bc, 0x01be, 0x01f7, ++ 0x01c0, 0x01c1, 0x01c2, 0x01c3, 0x01c4, 0x01c5, 0x01c4, 0x01c7, ++ 0x01c8, 0x01c7, 0x01ca, 0x01cb, 0x01ca, 0x01cd, 0x01cd, 0x01cf, ++ 0x01cf, 0x01d1, 0x01d1, 0x01d3, 0x01d3, 0x01d5, 0x01d5, 0x01d7, ++ 0x01d7, 0x01d9, 0x01d9, 0x01db, 0x01db, 0x018e, 0x01de, 0x01de, ++ 0x01e0, 0x01e0, 0x01e2, 0x01e2, 0x01e4, 0x01e4, 0x01e6, 0x01e6, ++ 0x01e8, 0x01e8, 0x01ea, 0x01ea, 0x01ec, 0x01ec, 0x01ee, 0x01ee, ++ 0x01f0, 0x01f1, 0x01f2, 0x01f1, 0x01f4, 0x01f4, 0x01f6, 0x01f7, ++ 0x01f8, 0x01f8, 0x01fa, 0x01fa, 0x01fc, 0x01fc, 0x01fe, 0x01fe, ++ 0x0200, 0x0200, 0x0202, 0x0202, 0x0204, 0x0204, 0x0206, 0x0206, ++ 0x0208, 0x0208, 0x020a, 0x020a, 0x020c, 0x020c, 0x020e, 0x020e, ++ 0x0210, 0x0210, 0x0212, 0x0212, 0x0214, 0x0214, 0x0216, 0x0216, ++ 0x0218, 0x0218, 0x021a, 0x021a, 0x021c, 0x021c, 0x021e, 0x021e, ++ 0x0220, 0x0221, 0x0222, 0x0222, 0x0224, 0x0224, 0x0226, 0x0226, ++ 0x0228, 0x0228, 0x022a, 0x022a, 0x022c, 0x022c, 0x022e, 0x022e, ++ 0x0230, 0x0230, 0x0232, 0x0232, 0x0234, 0x0235, 0x0236, 0x0237, ++ 0x0238, 0x0239, 0x2c65, 0x023b, 0x023b, 0x023d, 0x2c66, 0x023f, ++ 0x0240, 0x0241, 0x0241, 0x0243, 0x0244, 0x0245, 0x0246, 0x0246, ++ 0x0248, 0x0248, 0x024a, 0x024a, 0x024c, 0x024c, 0x024e, 0x024e, ++ 0x0250, 0x0251, 0x0252, 0x0181, 0x0186, 0x0255, 0x0189, 0x018a, ++ 0x0258, 0x018f, 0x025a, 0x0190, 0x025c, 0x025d, 0x025e, 0x025f, ++ 0x0193, 0x0261, 0x0262, 0x0194, 0x0264, 0x0265, 0x0266, 0x0267, ++ 0x0197, 0x0196, 0x026a, 0x2c62, 0x026c, 0x026d, 0x026e, 0x019c, ++ 0x0270, 0x0271, 0x019d, 0x0273, 0x0274, 0x019f, 0x0276, 0x0277, ++ 0x0278, 0x0279, 0x027a, 0x027b, 0x027c, 0x2c64, 0x027e, 0x027f, ++ 0x01a6, 0x0281, 0x0282, 0x01a9, 0x0284, 0x0285, 0x0286, 0x0287, ++ 0x01ae, 0x0244, 0x01b1, 0x01b2, 0x0245, 0x028d, 0x028e, 0x028f, ++ 0x0290, 0x0291, 0x01b7, 0x0293, 0x0294, 0x0295, 0x0296, 0x0297, ++ 0x0298, 0x0299, 0x029a, 0x029b, 0x029c, 0x029d, 0x029e, 0x029f, ++ 0x02a0, 0x02a1, 0x02a2, 0x02a3, 0x02a4, 0x02a5, 0x02a6, 0x02a7, ++ 0x02a8, 0x02a9, 0x02aa, 0x02ab, 0x02ac, 0x02ad, 0x02ae, 0x02af, ++ 0x02b0, 0x02b1, 0x02b2, 0x02b3, 0x02b4, 0x02b5, 0x02b6, 0x02b7, ++ 0x02b8, 0x02b9, 0x02ba, 0x02bb, 0x02bc, 0x02bd, 0x02be, 0x02bf, ++ 0x02c0, 0x02c1, 0x02c2, 0x02c3, 0x02c4, 0x02c5, 0x02c6, 0x02c7, ++ 0x02c8, 0x02c9, 0x02ca, 0x02cb, 0x02cc, 0x02cd, 0x02ce, 0x02cf, ++ 0x02d0, 0x02d1, 0x02d2, 0x02d3, 0x02d4, 0x02d5, 0x02d6, 0x02d7, ++ 0x02d8, 0x02d9, 0x02da, 0x02db, 0x02dc, 0x02dd, 0x02de, 0x02df, ++ 0x02e0, 0x02e1, 0x02e2, 0x02e3, 0x02e4, 0x02e5, 0x02e6, 0x02e7, ++ 0x02e8, 0x02e9, 0x02ea, 0x02eb, 0x02ec, 0x02ed, 0x02ee, 0x02ef, ++ 0x02f0, 0x02f1, 0x02f2, 0x02f3, 0x02f4, 0x02f5, 0x02f6, 0x02f7, ++ 0x02f8, 0x02f9, 0x02fa, 0x02fb, 0x02fc, 0x02fd, 0x02fe, 0x02ff, ++ 0x0300, 0x0301, 0x0302, 0x0303, 0x0304, 0x0305, 0x0306, 0x0307, ++ 0x0308, 0x0309, 0x030a, 0x030b, 0x030c, 0x030d, 0x030e, 0x030f, ++ 0x0310, 0x0311, 0x0312, 0x0313, 0x0314, 0x0315, 0x0316, 0x0317, ++ 0x0318, 0x0319, 0x031a, 0x031b, 0x031c, 0x031d, 0x031e, 0x031f, ++ 0x0320, 0x0321, 0x0322, 0x0323, 0x0324, 0x0325, 0x0326, 0x0327, ++ 0x0328, 0x0329, 0x032a, 0x032b, 0x032c, 0x032d, 0x032e, 0x032f, ++ 0x0330, 0x0331, 0x0332, 0x0333, 0x0334, 0x0335, 0x0336, 0x0337, ++ 0x0338, 0x0339, 0x033a, 0x033b, 0x033c, 0x033d, 0x033e, 0x033f, ++ 0x0340, 0x0341, 0x0342, 0x0343, 0x0344, 0x0345, 0x0346, 0x0347, ++ 0x0348, 0x0349, 0x034a, 0x034b, 0x034c, 0x034d, 0x034e, 0x034f, ++ 0x0350, 0x0351, 0x0352, 0x0353, 0x0354, 0x0355, 0x0356, 0x0357, ++ 0x0358, 0x0359, 0x035a, 0x035b, 0x035c, 0x035d, 0x035e, 0x035f, ++ 0x0360, 0x0361, 0x0362, 0x0363, 0x0364, 0x0365, 0x0366, 0x0367, ++ 0x0368, 0x0369, 0x036a, 0x036b, 0x036c, 0x036d, 0x036e, 0x036f, ++ 0x0370, 0x0371, 0x0372, 0x0373, 0x0374, 0x0375, 0x0376, 0x0377, ++ 0x0378, 0x0379, 0x037a, 0x03fd, 0x03fe, 0x03ff, 0x037e, 0x037f, ++ 0x0380, 0x0381, 0x0382, 0x0383, 0x0384, 0x0385, 0x0386, 0x0387, ++ 0x0388, 0x0389, 0x038a, 0x038b, 0x038c, 0x038d, 0x038e, 0x038f, ++ 0x0390, 0x0391, 0x0392, 0x0393, 0x0394, 0x0395, 0x0396, 0x0397, ++ 0x0398, 0x0399, 0x039a, 0x039b, 0x039c, 0x039d, 0x039e, 0x039f, ++ 0x03a0, 0x03a1, 0x03a2, 0x03a3, 0x03a4, 0x03a5, 0x03a6, 0x03a7, ++ 0x03a8, 0x03a9, 0x03aa, 0x03ab, 0x0386, 0x0388, 0x0389, 0x038a, ++ 0x03b0, 0x0391, 0x0392, 0x0393, 0x0394, 0x0395, 0x0396, 0x0397, ++ 0x0398, 0x0399, 0x039a, 0x039b, 0x039c, 0x039d, 0x039e, 0x039f, ++ 0x03a0, 0x03a1, 0x03a3, 0x03a3, 0x03a4, 0x03a5, 0x03a6, 0x03a7, ++ 0x03a8, 0x03a9, 0x03aa, 0x03ab, 0x038c, 0x038e, 0x038f, 0x03cf, ++ 0x03d0, 0x03d1, 0x03d2, 0x03d3, 0x03d4, 0x03d5, 0x03d6, 0x03d7, ++ 0x03d8, 0x03d8, 0x03da, 0x03da, 0x03dc, 0x03dc, 0x03de, 0x03de, ++ 0x03e0, 0x03e0, 0x03e2, 0x03e2, 0x03e4, 0x03e4, 0x03e6, 0x03e6, ++ 0x03e8, 0x03e8, 0x03ea, 0x03ea, 0x03ec, 0x03ec, 0x03ee, 0x03ee, ++ 0x03f0, 0x03f1, 0x03f9, 0x03f3, 0x03f4, 0x03f5, 0x03f6, 0x03f7, ++ 0x03f7, 0x03f9, 0x03fa, 0x03fa, 0x03fc, 0x03fd, 0x03fe, 0x03ff, ++ 0x0400, 0x0401, 0x0402, 0x0403, 0x0404, 0x0405, 0x0406, 0x0407, ++ 0x0408, 0x0409, 0x040a, 0x040b, 0x040c, 0x040d, 0x040e, 0x040f, ++ 0x0410, 0x0411, 0x0412, 0x0413, 0x0414, 0x0415, 0x0416, 0x0417, ++ 0x0418, 0x0419, 0x041a, 0x041b, 0x041c, 0x041d, 0x041e, 0x041f, ++ 0x0420, 0x0421, 0x0422, 0x0423, 0x0424, 0x0425, 0x0426, 0x0427, ++ 0x0428, 0x0429, 0x042a, 0x042b, 0x042c, 0x042d, 0x042e, 0x042f, ++ 0x0410, 0x0411, 0x0412, 0x0413, 0x0414, 0x0415, 0x0416, 0x0417, ++ 0x0418, 0x0419, 0x041a, 0x041b, 0x041c, 0x041d, 0x041e, 0x041f, ++ 0x0420, 0x0421, 0x0422, 0x0423, 0x0424, 0x0425, 0x0426, 0x0427, ++ 0x0428, 0x0429, 0x042a, 0x042b, 0x042c, 0x042d, 0x042e, 0x042f, ++ 0x0400, 0x0401, 0x0402, 0x0403, 0x0404, 0x0405, 0x0406, 0x0407, ++ 0x0408, 0x0409, 0x040a, 0x040b, 0x040c, 0x040d, 0x040e, 0x040f, ++ 0x0460, 0x0460, 0x0462, 0x0462, 0x0464, 0x0464, 0x0466, 0x0466, ++ 0x0468, 0x0468, 0x046a, 0x046a, 0x046c, 0x046c, 0x046e, 0x046e, ++ 0x0470, 0x0470, 0x0472, 0x0472, 0x0474, 0x0474, 0x0476, 0x0476, ++ 0x0478, 0x0478, 0x047a, 0x047a, 0x047c, 0x047c, 0x047e, 0x047e, ++ 0x0480, 0x0480, 0x0482, 0x0483, 0x0484, 0x0485, 0x0486, 0x0487, ++ 0x0488, 0x0489, 0x048a, 0x048a, 0x048c, 0x048c, 0x048e, 0x048e, ++ 0x0490, 0x0490, 0x0492, 0x0492, 0x0494, 0x0494, 0x0496, 0x0496, ++ 0x0498, 0x0498, 0x049a, 0x049a, 0x049c, 0x049c, 0x049e, 0x049e, ++ 0x04a0, 0x04a0, 0x04a2, 0x04a2, 0x04a4, 0x04a4, 0x04a6, 0x04a6, ++ 0x04a8, 0x04a8, 0x04aa, 0x04aa, 0x04ac, 0x04ac, 0x04ae, 0x04ae, ++ 0x04b0, 0x04b0, 0x04b2, 0x04b2, 0x04b4, 0x04b4, 0x04b6, 0x04b6, ++ 0x04b8, 0x04b8, 0x04ba, 0x04ba, 0x04bc, 0x04bc, 0x04be, 0x04be, ++ 0x04c0, 0x04c1, 0x04c1, 0x04c3, 0x04c3, 0x04c5, 0x04c5, 0x04c7, ++ 0x04c7, 0x04c9, 0x04c9, 0x04cb, 0x04cb, 0x04cd, 0x04cd, 0x04c0, ++ 0x04d0, 0x04d0, 0x04d2, 0x04d2, 0x04d4, 0x04d4, 0x04d6, 0x04d6, ++ 0x04d8, 0x04d8, 0x04da, 0x04da, 0x04dc, 0x04dc, 0x04de, 0x04de, ++ 0x04e0, 0x04e0, 0x04e2, 0x04e2, 0x04e4, 0x04e4, 0x04e6, 0x04e6, ++ 0x04e8, 0x04e8, 0x04ea, 0x04ea, 0x04ec, 0x04ec, 0x04ee, 0x04ee, ++ 0x04f0, 0x04f0, 0x04f2, 0x04f2, 0x04f4, 0x04f4, 0x04f6, 0x04f6, ++ 0x04f8, 0x04f8, 0x04fa, 0x04fa, 0x04fc, 0x04fc, 0x04fe, 0x04fe, ++ 0x0500, 0x0500, 0x0502, 0x0502, 0x0504, 0x0504, 0x0506, 0x0506, ++ 0x0508, 0x0508, 0x050a, 0x050a, 0x050c, 0x050c, 0x050e, 0x050e, ++ 0x0510, 0x0510, 0x0512, 0x0512, 0x0514, 0x0515, 0x0516, 0x0517, ++ 0x0518, 0x0519, 0x051a, 0x051b, 0x051c, 0x051d, 0x051e, 0x051f, ++ 0x0520, 0x0521, 0x0522, 0x0523, 0x0524, 0x0525, 0x0526, 0x0527, ++ 0x0528, 0x0529, 0x052a, 0x052b, 0x052c, 0x052d, 0x052e, 0x052f, ++ 0x0530, 0x0531, 0x0532, 0x0533, 0x0534, 0x0535, 0x0536, 0x0537, ++ 0x0538, 0x0539, 0x053a, 0x053b, 0x053c, 0x053d, 0x053e, 0x053f, ++ 0x0540, 0x0541, 0x0542, 0x0543, 0x0544, 0x0545, 0x0546, 0x0547, ++ 0x0548, 0x0549, 0x054a, 0x054b, 0x054c, 0x054d, 0x054e, 0x054f, ++ 0x0550, 0x0551, 0x0552, 0x0553, 0x0554, 0x0555, 0x0556, 0x0557, ++ 0x0558, 0x0559, 0x055a, 0x055b, 0x055c, 0x055d, 0x055e, 0x055f, ++ 0x0560, 0x0531, 0x0532, 0x0533, 0x0534, 0x0535, 0x0536, 0x0537, ++ 0x0538, 0x0539, 0x053a, 0x053b, 0x053c, 0x053d, 0x053e, 0x053f, ++ 0x0540, 0x0541, 0x0542, 0x0543, 0x0544, 0x0545, 0x0546, 0x0547, ++ 0x0548, 0x0549, 0x054a, 0x054b, 0x054c, 0x054d, 0x054e, 0x054f, ++ 0x0550, 0x0551, 0x0552, 0x0553, 0x0554, 0x0555, 0x0556, 0xffff, ++ 0x17f6, 0x2c63, 0x1d7e, 0x1d7f, 0x1d80, 0x1d81, 0x1d82, 0x1d83, ++ 0x1d84, 0x1d85, 0x1d86, 0x1d87, 0x1d88, 0x1d89, 0x1d8a, 0x1d8b, ++ 0x1d8c, 0x1d8d, 0x1d8e, 0x1d8f, 0x1d90, 0x1d91, 0x1d92, 0x1d93, ++ 0x1d94, 0x1d95, 0x1d96, 0x1d97, 0x1d98, 0x1d99, 0x1d9a, 0x1d9b, ++ 0x1d9c, 0x1d9d, 0x1d9e, 0x1d9f, 0x1da0, 0x1da1, 0x1da2, 0x1da3, ++ 0x1da4, 0x1da5, 0x1da6, 0x1da7, 0x1da8, 0x1da9, 0x1daa, 0x1dab, ++ 0x1dac, 0x1dad, 0x1dae, 0x1daf, 0x1db0, 0x1db1, 0x1db2, 0x1db3, ++ 0x1db4, 0x1db5, 0x1db6, 0x1db7, 0x1db8, 0x1db9, 0x1dba, 0x1dbb, ++ 0x1dbc, 0x1dbd, 0x1dbe, 0x1dbf, 0x1dc0, 0x1dc1, 0x1dc2, 0x1dc3, ++ 0x1dc4, 0x1dc5, 0x1dc6, 0x1dc7, 0x1dc8, 0x1dc9, 0x1dca, 0x1dcb, ++ 0x1dcc, 0x1dcd, 0x1dce, 0x1dcf, 0x1dd0, 0x1dd1, 0x1dd2, 0x1dd3, ++ 0x1dd4, 0x1dd5, 0x1dd6, 0x1dd7, 0x1dd8, 0x1dd9, 0x1dda, 0x1ddb, ++ 0x1ddc, 0x1ddd, 0x1dde, 0x1ddf, 0x1de0, 0x1de1, 0x1de2, 0x1de3, ++ 0x1de4, 0x1de5, 0x1de6, 0x1de7, 0x1de8, 0x1de9, 0x1dea, 0x1deb, ++ 0x1dec, 0x1ded, 0x1dee, 0x1def, 0x1df0, 0x1df1, 0x1df2, 0x1df3, ++ 0x1df4, 0x1df5, 0x1df6, 0x1df7, 0x1df8, 0x1df9, 0x1dfa, 0x1dfb, ++ 0x1dfc, 0x1dfd, 0x1dfe, 0x1dff, 0x1e00, 0x1e00, 0x1e02, 0x1e02, ++ 0x1e04, 0x1e04, 0x1e06, 0x1e06, 0x1e08, 0x1e08, 0x1e0a, 0x1e0a, ++ 0x1e0c, 0x1e0c, 0x1e0e, 0x1e0e, 0x1e10, 0x1e10, 0x1e12, 0x1e12, ++ 0x1e14, 0x1e14, 0x1e16, 0x1e16, 0x1e18, 0x1e18, 0x1e1a, 0x1e1a, ++ 0x1e1c, 0x1e1c, 0x1e1e, 0x1e1e, 0x1e20, 0x1e20, 0x1e22, 0x1e22, ++ 0x1e24, 0x1e24, 0x1e26, 0x1e26, 0x1e28, 0x1e28, 0x1e2a, 0x1e2a, ++ 0x1e2c, 0x1e2c, 0x1e2e, 0x1e2e, 0x1e30, 0x1e30, 0x1e32, 0x1e32, ++ 0x1e34, 0x1e34, 0x1e36, 0x1e36, 0x1e38, 0x1e38, 0x1e3a, 0x1e3a, ++ 0x1e3c, 0x1e3c, 0x1e3e, 0x1e3e, 0x1e40, 0x1e40, 0x1e42, 0x1e42, ++ 0x1e44, 0x1e44, 0x1e46, 0x1e46, 0x1e48, 0x1e48, 0x1e4a, 0x1e4a, ++ 0x1e4c, 0x1e4c, 0x1e4e, 0x1e4e, 0x1e50, 0x1e50, 0x1e52, 0x1e52, ++ 0x1e54, 0x1e54, 0x1e56, 0x1e56, 0x1e58, 0x1e58, 0x1e5a, 0x1e5a, ++ 0x1e5c, 0x1e5c, 0x1e5e, 0x1e5e, 0x1e60, 0x1e60, 0x1e62, 0x1e62, ++ 0x1e64, 0x1e64, 0x1e66, 0x1e66, 0x1e68, 0x1e68, 0x1e6a, 0x1e6a, ++ 0x1e6c, 0x1e6c, 0x1e6e, 0x1e6e, 0x1e70, 0x1e70, 0x1e72, 0x1e72, ++ 0x1e74, 0x1e74, 0x1e76, 0x1e76, 0x1e78, 0x1e78, 0x1e7a, 0x1e7a, ++ 0x1e7c, 0x1e7c, 0x1e7e, 0x1e7e, 0x1e80, 0x1e80, 0x1e82, 0x1e82, ++ 0x1e84, 0x1e84, 0x1e86, 0x1e86, 0x1e88, 0x1e88, 0x1e8a, 0x1e8a, ++ 0x1e8c, 0x1e8c, 0x1e8e, 0x1e8e, 0x1e90, 0x1e90, 0x1e92, 0x1e92, ++ 0x1e94, 0x1e94, 0x1e96, 0x1e97, 0x1e98, 0x1e99, 0x1e9a, 0x1e9b, ++ 0x1e9c, 0x1e9d, 0x1e9e, 0x1e9f, 0x1ea0, 0x1ea0, 0x1ea2, 0x1ea2, ++ 0x1ea4, 0x1ea4, 0x1ea6, 0x1ea6, 0x1ea8, 0x1ea8, 0x1eaa, 0x1eaa, ++ 0x1eac, 0x1eac, 0x1eae, 0x1eae, 0x1eb0, 0x1eb0, 0x1eb2, 0x1eb2, ++ 0x1eb4, 0x1eb4, 0x1eb6, 0x1eb6, 0x1eb8, 0x1eb8, 0x1eba, 0x1eba, ++ 0x1ebc, 0x1ebc, 0x1ebe, 0x1ebe, 0x1ec0, 0x1ec0, 0x1ec2, 0x1ec2, ++ 0x1ec4, 0x1ec4, 0x1ec6, 0x1ec6, 0x1ec8, 0x1ec8, 0x1eca, 0x1eca, ++ 0x1ecc, 0x1ecc, 0x1ece, 0x1ece, 0x1ed0, 0x1ed0, 0x1ed2, 0x1ed2, ++ 0x1ed4, 0x1ed4, 0x1ed6, 0x1ed6, 0x1ed8, 0x1ed8, 0x1eda, 0x1eda, ++ 0x1edc, 0x1edc, 0x1ede, 0x1ede, 0x1ee0, 0x1ee0, 0x1ee2, 0x1ee2, ++ 0x1ee4, 0x1ee4, 0x1ee6, 0x1ee6, 0x1ee8, 0x1ee8, 0x1eea, 0x1eea, ++ 0x1eec, 0x1eec, 0x1eee, 0x1eee, 0x1ef0, 0x1ef0, 0x1ef2, 0x1ef2, ++ 0x1ef4, 0x1ef4, 0x1ef6, 0x1ef6, 0x1ef8, 0x1ef8, 0x1efa, 0x1efb, ++ 0x1efc, 0x1efd, 0x1efe, 0x1eff, 0x1f08, 0x1f09, 0x1f0a, 0x1f0b, ++ 0x1f0c, 0x1f0d, 0x1f0e, 0x1f0f, 0x1f08, 0x1f09, 0x1f0a, 0x1f0b, ++ 0x1f0c, 0x1f0d, 0x1f0e, 0x1f0f, 0x1f18, 0x1f19, 0x1f1a, 0x1f1b, ++ 0x1f1c, 0x1f1d, 0x1f16, 0x1f17, 0x1f18, 0x1f19, 0x1f1a, 0x1f1b, ++ 0x1f1c, 0x1f1d, 0x1f1e, 0x1f1f, 0x1f28, 0x1f29, 0x1f2a, 0x1f2b, ++ 0x1f2c, 0x1f2d, 0x1f2e, 0x1f2f, 0x1f28, 0x1f29, 0x1f2a, 0x1f2b, ++ 0x1f2c, 0x1f2d, 0x1f2e, 0x1f2f, 0x1f38, 0x1f39, 0x1f3a, 0x1f3b, ++ 0x1f3c, 0x1f3d, 0x1f3e, 0x1f3f, 0x1f38, 0x1f39, 0x1f3a, 0x1f3b, ++ 0x1f3c, 0x1f3d, 0x1f3e, 0x1f3f, 0x1f48, 0x1f49, 0x1f4a, 0x1f4b, ++ 0x1f4c, 0x1f4d, 0x1f46, 0x1f47, 0x1f48, 0x1f49, 0x1f4a, 0x1f4b, ++ 0x1f4c, 0x1f4d, 0x1f4e, 0x1f4f, 0x1f50, 0x1f59, 0x1f52, 0x1f5b, ++ 0x1f54, 0x1f5d, 0x1f56, 0x1f5f, 0x1f58, 0x1f59, 0x1f5a, 0x1f5b, ++ 0x1f5c, 0x1f5d, 0x1f5e, 0x1f5f, 0x1f68, 0x1f69, 0x1f6a, 0x1f6b, ++ 0x1f6c, 0x1f6d, 0x1f6e, 0x1f6f, 0x1f68, 0x1f69, 0x1f6a, 0x1f6b, ++ 0x1f6c, 0x1f6d, 0x1f6e, 0x1f6f, 0x1fba, 0x1fbb, 0x1fc8, 0x1fc9, ++ 0x1fca, 0x1fcb, 0x1fda, 0x1fdb, 0x1ff8, 0x1ff9, 0x1fea, 0x1feb, ++ 0x1ffa, 0x1ffb, 0x1f7e, 0x1f7f, 0x1f88, 0x1f89, 0x1f8a, 0x1f8b, ++ 0x1f8c, 0x1f8d, 0x1f8e, 0x1f8f, 0x1f88, 0x1f89, 0x1f8a, 0x1f8b, ++ 0x1f8c, 0x1f8d, 0x1f8e, 0x1f8f, 0x1f98, 0x1f99, 0x1f9a, 0x1f9b, ++ 0x1f9c, 0x1f9d, 0x1f9e, 0x1f9f, 0x1f98, 0x1f99, 0x1f9a, 0x1f9b, ++ 0x1f9c, 0x1f9d, 0x1f9e, 0x1f9f, 0x1fa8, 0x1fa9, 0x1faa, 0x1fab, ++ 0x1fac, 0x1fad, 0x1fae, 0x1faf, 0x1fa8, 0x1fa9, 0x1faa, 0x1fab, ++ 0x1fac, 0x1fad, 0x1fae, 0x1faf, 0x1fb8, 0x1fb9, 0x1fb2, 0x1fbc, ++ 0x1fb4, 0x1fb5, 0x1fb6, 0x1fb7, 0x1fb8, 0x1fb9, 0x1fba, 0x1fbb, ++ 0x1fbc, 0x1fbd, 0x1fbe, 0x1fbf, 0x1fc0, 0x1fc1, 0x1fc2, 0x1fc3, ++ 0x1fc4, 0x1fc5, 0x1fc6, 0x1fc7, 0x1fc8, 0x1fc9, 0x1fca, 0x1fcb, ++ 0x1fc3, 0x1fcd, 0x1fce, 0x1fcf, 0x1fd8, 0x1fd9, 0x1fd2, 0x1fd3, ++ 0x1fd4, 0x1fd5, 0x1fd6, 0x1fd7, 0x1fd8, 0x1fd9, 0x1fda, 0x1fdb, ++ 0x1fdc, 0x1fdd, 0x1fde, 0x1fdf, 0x1fe8, 0x1fe9, 0x1fe2, 0x1fe3, ++ 0x1fe4, 0x1fec, 0x1fe6, 0x1fe7, 0x1fe8, 0x1fe9, 0x1fea, 0x1feb, ++ 0x1fec, 0x1fed, 0x1fee, 0x1fef, 0x1ff0, 0x1ff1, 0x1ff2, 0x1ff3, ++ 0x1ff4, 0x1ff5, 0x1ff6, 0x1ff7, 0x1ff8, 0x1ff9, 0x1ffa, 0x1ffb, ++ 0x1ff3, 0x1ffd, 0x1ffe, 0x1fff, 0x2000, 0x2001, 0x2002, 0x2003, ++ 0x2004, 0x2005, 0x2006, 0x2007, 0x2008, 0x2009, 0x200a, 0x200b, ++ 0x200c, 0x200d, 0x200e, 0x200f, 0x2010, 0x2011, 0x2012, 0x2013, ++ 0x2014, 0x2015, 0x2016, 0x2017, 0x2018, 0x2019, 0x201a, 0x201b, ++ 0x201c, 0x201d, 0x201e, 0x201f, 0x2020, 0x2021, 0x2022, 0x2023, ++ 0x2024, 0x2025, 0x2026, 0x2027, 0x2028, 0x2029, 0x202a, 0x202b, ++ 0x202c, 0x202d, 0x202e, 0x202f, 0x2030, 0x2031, 0x2032, 0x2033, ++ 0x2034, 0x2035, 0x2036, 0x2037, 0x2038, 0x2039, 0x203a, 0x203b, ++ 0x203c, 0x203d, 0x203e, 0x203f, 0x2040, 0x2041, 0x2042, 0x2043, ++ 0x2044, 0x2045, 0x2046, 0x2047, 0x2048, 0x2049, 0x204a, 0x204b, ++ 0x204c, 0x204d, 0x204e, 0x204f, 0x2050, 0x2051, 0x2052, 0x2053, ++ 0x2054, 0x2055, 0x2056, 0x2057, 0x2058, 0x2059, 0x205a, 0x205b, ++ 0x205c, 0x205d, 0x205e, 0x205f, 0x2060, 0x2061, 0x2062, 0x2063, ++ 0x2064, 0x2065, 0x2066, 0x2067, 0x2068, 0x2069, 0x206a, 0x206b, ++ 0x206c, 0x206d, 0x206e, 0x206f, 0x2070, 0x2071, 0x2072, 0x2073, ++ 0x2074, 0x2075, 0x2076, 0x2077, 0x2078, 0x2079, 0x207a, 0x207b, ++ 0x207c, 0x207d, 0x207e, 0x207f, 0x2080, 0x2081, 0x2082, 0x2083, ++ 0x2084, 0x2085, 0x2086, 0x2087, 0x2088, 0x2089, 0x208a, 0x208b, ++ 0x208c, 0x208d, 0x208e, 0x208f, 0x2090, 0x2091, 0x2092, 0x2093, ++ 0x2094, 0x2095, 0x2096, 0x2097, 0x2098, 0x2099, 0x209a, 0x209b, ++ 0x209c, 0x209d, 0x209e, 0x209f, 0x20a0, 0x20a1, 0x20a2, 0x20a3, ++ 0x20a4, 0x20a5, 0x20a6, 0x20a7, 0x20a8, 0x20a9, 0x20aa, 0x20ab, ++ 0x20ac, 0x20ad, 0x20ae, 0x20af, 0x20b0, 0x20b1, 0x20b2, 0x20b3, ++ 0x20b4, 0x20b5, 0x20b6, 0x20b7, 0x20b8, 0x20b9, 0x20ba, 0x20bb, ++ 0x20bc, 0x20bd, 0x20be, 0x20bf, 0x20c0, 0x20c1, 0x20c2, 0x20c3, ++ 0x20c4, 0x20c5, 0x20c6, 0x20c7, 0x20c8, 0x20c9, 0x20ca, 0x20cb, ++ 0x20cc, 0x20cd, 0x20ce, 0x20cf, 0x20d0, 0x20d1, 0x20d2, 0x20d3, ++ 0x20d4, 0x20d5, 0x20d6, 0x20d7, 0x20d8, 0x20d9, 0x20da, 0x20db, ++ 0x20dc, 0x20dd, 0x20de, 0x20df, 0x20e0, 0x20e1, 0x20e2, 0x20e3, ++ 0x20e4, 0x20e5, 0x20e6, 0x20e7, 0x20e8, 0x20e9, 0x20ea, 0x20eb, ++ 0x20ec, 0x20ed, 0x20ee, 0x20ef, 0x20f0, 0x20f1, 0x20f2, 0x20f3, ++ 0x20f4, 0x20f5, 0x20f6, 0x20f7, 0x20f8, 0x20f9, 0x20fa, 0x20fb, ++ 0x20fc, 0x20fd, 0x20fe, 0x20ff, 0x2100, 0x2101, 0x2102, 0x2103, ++ 0x2104, 0x2105, 0x2106, 0x2107, 0x2108, 0x2109, 0x210a, 0x210b, ++ 0x210c, 0x210d, 0x210e, 0x210f, 0x2110, 0x2111, 0x2112, 0x2113, ++ 0x2114, 0x2115, 0x2116, 0x2117, 0x2118, 0x2119, 0x211a, 0x211b, ++ 0x211c, 0x211d, 0x211e, 0x211f, 0x2120, 0x2121, 0x2122, 0x2123, ++ 0x2124, 0x2125, 0x2126, 0x2127, 0x2128, 0x2129, 0x212a, 0x212b, ++ 0x212c, 0x212d, 0x212e, 0x212f, 0x2130, 0x2131, 0x2132, 0x2133, ++ 0x2134, 0x2135, 0x2136, 0x2137, 0x2138, 0x2139, 0x213a, 0x213b, ++ 0x213c, 0x213d, 0x213e, 0x213f, 0x2140, 0x2141, 0x2142, 0x2143, ++ 0x2144, 0x2145, 0x2146, 0x2147, 0x2148, 0x2149, 0x214a, 0x214b, ++ 0x214c, 0x214d, 0x2132, 0x214f, 0x2150, 0x2151, 0x2152, 0x2153, ++ 0x2154, 0x2155, 0x2156, 0x2157, 0x2158, 0x2159, 0x215a, 0x215b, ++ 0x215c, 0x215d, 0x215e, 0x215f, 0x2160, 0x2161, 0x2162, 0x2163, ++ 0x2164, 0x2165, 0x2166, 0x2167, 0x2168, 0x2169, 0x216a, 0x216b, ++ 0x216c, 0x216d, 0x216e, 0x216f, 0x2160, 0x2161, 0x2162, 0x2163, ++ 0x2164, 0x2165, 0x2166, 0x2167, 0x2168, 0x2169, 0x216a, 0x216b, ++ 0x216c, 0x216d, 0x216e, 0x216f, 0x2180, 0x2181, 0x2182, 0x2183, ++ 0x2183, 0xffff, 0x034b, 0x24b6, 0x24b7, 0x24b8, 0x24b9, 0x24ba, ++ 0x24bb, 0x24bc, 0x24bd, 0x24be, 0x24bf, 0x24c0, 0x24c1, 0x24c2, ++ 0x24c3, 0x24c4, 0x24c5, 0x24c6, 0x24c7, 0x24c8, 0x24c9, 0x24ca, ++ 0x24cb, 0x24cc, 0x24cd, 0x24ce, 0x24cf, 0xffff, 0x0746, 0x2c00, ++ 0x2c01, 0x2c02, 0x2c03, 0x2c04, 0x2c05, 0x2c06, 0x2c07, 0x2c08, ++ 0x2c09, 0x2c0a, 0x2c0b, 0x2c0c, 0x2c0d, 0x2c0e, 0x2c0f, 0x2c10, ++ 0x2c11, 0x2c12, 0x2c13, 0x2c14, 0x2c15, 0x2c16, 0x2c17, 0x2c18, ++ 0x2c19, 0x2c1a, 0x2c1b, 0x2c1c, 0x2c1d, 0x2c1e, 0x2c1f, 0x2c20, ++ 0x2c21, 0x2c22, 0x2c23, 0x2c24, 0x2c25, 0x2c26, 0x2c27, 0x2c28, ++ 0x2c29, 0x2c2a, 0x2c2b, 0x2c2c, 0x2c2d, 0x2c2e, 0x2c5f, 0x2c60, ++ 0x2c60, 0x2c62, 0x2c63, 0x2c64, 0x2c65, 0x2c66, 0x2c67, 0x2c67, ++ 0x2c69, 0x2c69, 0x2c6b, 0x2c6b, 0x2c6d, 0x2c6e, 0x2c6f, 0x2c70, ++ 0x2c71, 0x2c72, 0x2c73, 0x2c74, 0x2c75, 0x2c75, 0x2c77, 0x2c78, ++ 0x2c79, 0x2c7a, 0x2c7b, 0x2c7c, 0x2c7d, 0x2c7e, 0x2c7f, 0x2c80, ++ 0x2c80, 0x2c82, 0x2c82, 0x2c84, 0x2c84, 0x2c86, 0x2c86, 0x2c88, ++ 0x2c88, 0x2c8a, 0x2c8a, 0x2c8c, 0x2c8c, 0x2c8e, 0x2c8e, 0x2c90, ++ 0x2c90, 0x2c92, 0x2c92, 0x2c94, 0x2c94, 0x2c96, 0x2c96, 0x2c98, ++ 0x2c98, 0x2c9a, 0x2c9a, 0x2c9c, 0x2c9c, 0x2c9e, 0x2c9e, 0x2ca0, ++ 0x2ca0, 0x2ca2, 0x2ca2, 0x2ca4, 0x2ca4, 0x2ca6, 0x2ca6, 0x2ca8, ++ 0x2ca8, 0x2caa, 0x2caa, 0x2cac, 0x2cac, 0x2cae, 0x2cae, 0x2cb0, ++ 0x2cb0, 0x2cb2, 0x2cb2, 0x2cb4, 0x2cb4, 0x2cb6, 0x2cb6, 0x2cb8, ++ 0x2cb8, 0x2cba, 0x2cba, 0x2cbc, 0x2cbc, 0x2cbe, 0x2cbe, 0x2cc0, ++ 0x2cc0, 0x2cc2, 0x2cc2, 0x2cc4, 0x2cc4, 0x2cc6, 0x2cc6, 0x2cc8, ++ 0x2cc8, 0x2cca, 0x2cca, 0x2ccc, 0x2ccc, 0x2cce, 0x2cce, 0x2cd0, ++ 0x2cd0, 0x2cd2, 0x2cd2, 0x2cd4, 0x2cd4, 0x2cd6, 0x2cd6, 0x2cd8, ++ 0x2cd8, 0x2cda, 0x2cda, 0x2cdc, 0x2cdc, 0x2cde, 0x2cde, 0x2ce0, ++ 0x2ce0, 0x2ce2, 0x2ce2, 0x2ce4, 0x2ce5, 0x2ce6, 0x2ce7, 0x2ce8, ++ 0x2ce9, 0x2cea, 0x2ceb, 0x2cec, 0x2ced, 0x2cee, 0x2cef, 0x2cf0, ++ 0x2cf1, 0x2cf2, 0x2cf3, 0x2cf4, 0x2cf5, 0x2cf6, 0x2cf7, 0x2cf8, ++ 0x2cf9, 0x2cfa, 0x2cfb, 0x2cfc, 0x2cfd, 0x2cfe, 0x2cff, 0x10a0, ++ 0x10a1, 0x10a2, 0x10a3, 0x10a4, 0x10a5, 0x10a6, 0x10a7, 0x10a8, ++ 0x10a9, 0x10aa, 0x10ab, 0x10ac, 0x10ad, 0x10ae, 0x10af, 0x10b0, ++ 0x10b1, 0x10b2, 0x10b3, 0x10b4, 0x10b5, 0x10b6, 0x10b7, 0x10b8, ++ 0x10b9, 0x10ba, 0x10bb, 0x10bc, 0x10bd, 0x10be, 0x10bf, 0x10c0, ++ 0x10c1, 0x10c2, 0x10c3, 0x10c4, 0x10c5, 0xffff, 0xd21b, 0xff21, ++ 0xff22, 0xff23, 0xff24, 0xff25, 0xff26, 0xff27, 0xff28, 0xff29, ++ 0xff2a, 0xff2b, 0xff2c, 0xff2d, 0xff2e, 0xff2f, 0xff30, 0xff31, ++ 0xff32, 0xff33, 0xff34, 0xff35, 0xff36, 0xff37, 0xff38, 0xff39, ++ 0xff3a, 0xff5b, 0xff5c, 0xff5d, 0xff5e, 0xff5f, 0xff60, 0xff61, ++ 0xff62, 0xff63, 0xff64, 0xff65, 0xff66, 0xff67, 0xff68, 0xff69, ++ 0xff6a, 0xff6b, 0xff6c, 0xff6d, 0xff6e, 0xff6f, 0xff70, 0xff71, ++ 0xff72, 0xff73, 0xff74, 0xff75, 0xff76, 0xff77, 0xff78, 0xff79, ++ 0xff7a, 0xff7b, 0xff7c, 0xff7d, 0xff7e, 0xff7f, 0xff80, 0xff81, ++ 0xff82, 0xff83, 0xff84, 0xff85, 0xff86, 0xff87, 0xff88, 0xff89, ++ 0xff8a, 0xff8b, 0xff8c, 0xff8d, 0xff8e, 0xff8f, 0xff90, 0xff91, ++ 0xff92, 0xff93, 0xff94, 0xff95, 0xff96, 0xff97, 0xff98, 0xff99, ++ 0xff9a, 0xff9b, 0xff9c, 0xff9d, 0xff9e, 0xff9f, 0xffa0, 0xffa1, ++ 0xffa2, 0xffa3, 0xffa4, 0xffa5, 0xffa6, 0xffa7, 0xffa8, 0xffa9, ++ 0xffaa, 0xffab, 0xffac, 0xffad, 0xffae, 0xffaf, 0xffb0, 0xffb1, ++ 0xffb2, 0xffb3, 0xffb4, 0xffb5, 0xffb6, 0xffb7, 0xffb8, 0xffb9, ++ 0xffba, 0xffbb, 0xffbc, 0xffbd, 0xffbe, 0xffbf, 0xffc0, 0xffc1, ++ 0xffc2, 0xffc3, 0xffc4, 0xffc5, 0xffc6, 0xffc7, 0xffc8, 0xffc9, ++ 0xffca, 0xffcb, 0xffcc, 0xffcd, 0xffce, 0xffcf, 0xffd0, 0xffd1, ++ 0xffd2, 0xffd3, 0xffd4, 0xffd5, 0xffd6, 0xffd7, 0xffd8, 0xffd9, ++ 0xffda, 0xffdb, 0xffdc, 0xffdd, 0xffde, 0xffdf, 0xffe0, 0xffe1, ++ 0xffe2, 0xffe3, 0xffe4, 0xffe5, 0xffe6, 0xffe7, 0xffe8, 0xffe9, ++ 0xffea, 0xffeb, 0xffec, 0xffed, 0xffee, 0xffef, 0xfff0, 0xfff1, ++ 0xfff2, 0xfff3, 0xfff4, 0xfff5, 0xfff6, 0xfff7, 0xfff8, 0xfff9, ++ 0xfffa, 0xfffb, 0xfffc, 0xfffd, 0xfffe, 0xffff, ++}; ++ ++/* ++ * Allow full-width illegal characters : ++ * "MS windows 7" supports full-width-invalid-name-characters. ++ * So we should check half-width-invalid-name-characters(ASCII) only ++ * for compatibility. ++ * ++ * " * / : < > ? \ | ++ */ ++static unsigned short bad_uni_chars[] = { ++ 0x0022, 0x002A, 0x002F, 0x003A, ++ 0x003C, 0x003E, 0x003F, 0x005C, 0x007C, ++ 0 ++}; ++ ++static int exfat_convert_char_to_ucs2(struct nls_table *nls, ++ const unsigned char *ch, int ch_len, unsigned short *ucs2, ++ int *lossy) ++{ ++ int len; ++ ++ *ucs2 = 0x0; ++ ++ if (ch[0] < 0x80) { ++ *ucs2 = ch[0]; ++ return 1; ++ } ++ ++ len = nls->char2uni(ch, ch_len, ucs2); ++ if (len < 0) { ++ /* conversion failed */ ++ if (lossy != NULL) ++ *lossy |= NLS_NAME_LOSSY; ++ *ucs2 = '_'; ++ return 1; ++ } ++ return len; ++} ++ ++static int exfat_convert_ucs2_to_char(struct nls_table *nls, ++ unsigned short ucs2, unsigned char *ch, int *lossy) ++{ ++ int len; ++ ++ ch[0] = 0x0; ++ ++ if (ucs2 < 0x0080) { ++ ch[0] = ucs2; ++ return 1; ++ } ++ ++ len = nls->uni2char(ucs2, ch, MAX_CHARSET_SIZE); ++ if (len < 0) { ++ /* conversion failed */ ++ if (lossy != NULL) ++ *lossy |= NLS_NAME_LOSSY; ++ ch[0] = '_'; ++ return 1; ++ } ++ return len; ++} ++ ++unsigned short exfat_toupper(struct super_block *sb, unsigned short a) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ ++ return sbi->vol_utbl[a] ? sbi->vol_utbl[a] : a; ++} ++ ++static unsigned short *exfat_wstrchr(unsigned short *str, unsigned short wchar) ++{ ++ while (*str) { ++ if (*(str++) == wchar) ++ return str; ++ } ++ return NULL; ++} ++ ++int exfat_uniname_ncmp(struct super_block *sb, unsigned short *a, ++ unsigned short *b, unsigned int len) ++{ ++ int i; ++ ++ for (i = 0; i < len; i++, a++, b++) ++ if (exfat_toupper(sb, *a) != exfat_toupper(sb, *b)) ++ return 1; ++ return 0; ++} ++ ++static int exfat_utf16_to_utf8(struct super_block *sb, ++ struct exfat_uni_name *p_uniname, unsigned char *p_cstring, ++ int buflen) ++{ ++ int len; ++ const unsigned short *uniname = p_uniname->name; ++ ++ /* always len >= 0 */ ++ len = utf16s_to_utf8s(uniname, MAX_NAME_LENGTH, UTF16_HOST_ENDIAN, ++ p_cstring, buflen); ++ p_cstring[len] = '\0'; ++ return len; ++} ++ ++static int exfat_utf8_to_utf16(struct super_block *sb, ++ const unsigned char *p_cstring, const int len, ++ struct exfat_uni_name *p_uniname, int *p_lossy) ++{ ++ int i, unilen, lossy = NLS_NAME_NO_LOSSY; ++ unsigned short upname[MAX_NAME_LENGTH + 1]; ++ unsigned short *uniname = p_uniname->name; ++ ++ WARN_ON(!len); ++ ++ unilen = utf8s_to_utf16s(p_cstring, len, UTF16_HOST_ENDIAN, ++ (wchar_t *)uniname, MAX_NAME_LENGTH + 2); ++ if (unilen < 0) { ++ exfat_msg(sb, KERN_ERR, ++ "failed to %s (err : %d) nls len : %d", ++ __func__, unilen, len); ++ return unilen; ++ } ++ ++ if (unilen > MAX_NAME_LENGTH) { ++ exfat_msg(sb, KERN_ERR, ++ "failed to %s (estr:ENAMETOOLONG) nls len : %d, unilen : %d > %d", ++ __func__, len, unilen, MAX_NAME_LENGTH); ++ return -ENAMETOOLONG; ++ } ++ ++ p_uniname->name_len = unilen & 0xFF; ++ ++ for (i = 0; i < unilen; i++) { ++ if (*uniname < 0x0020 || ++ exfat_wstrchr(bad_uni_chars, *uniname)) ++ lossy |= NLS_NAME_LOSSY; ++ ++ upname[i] = exfat_toupper(sb, *uniname); ++ uniname++; ++ } ++ ++ *uniname = '\0'; ++ p_uniname->name_len = unilen; ++ p_uniname->name_hash = exfat_calc_chksum_2byte(upname, unilen << 1, 0, ++ CS_DEFAULT); ++ ++ if (p_lossy) ++ *p_lossy = lossy; ++ return unilen; ++} ++ ++#define PLANE_SIZE 0x00010000 ++#define SURROGATE_MASK 0xfffff800 ++#define SURROGATE_PAIR 0x0000d800 ++#define SURROGATE_LOW 0x00000400 ++#define SURROGATE_BITS 0x000003ff ++ ++unsigned short exfat_high_surrogate(unicode_t u) ++{ ++ return ((u - PLANE_SIZE) >> 10) + SURROGATE_PAIR; ++} ++ ++unsigned short exfat_low_surrogate(unicode_t u) ++{ ++ return ((u - PLANE_SIZE) & SURROGATE_BITS) | SURROGATE_PAIR | ++ SURROGATE_LOW; ++} ++ ++static int __exfat_utf16_to_nls(struct super_block *sb, ++ struct exfat_uni_name *p_uniname, unsigned char *p_cstring, ++ int buflen) ++{ ++ int i, j, len, out_len = 0; ++ unsigned char buf[MAX_CHARSET_SIZE]; ++ const unsigned short *uniname = p_uniname->name; ++ struct nls_table *nls = EXFAT_SB(sb)->nls_io; ++ ++ i = 0; ++ while (i < MAX_NAME_LENGTH && out_len < (buflen - 1)) { ++ if (*uniname == '\0') ++ break; ++ if ((*uniname & SURROGATE_MASK) != SURROGATE_PAIR) { ++ len = exfat_convert_ucs2_to_char(nls, *uniname, buf, ++ NULL); ++ } else { ++ /* Process UTF-16 surrogate pair as one character */ ++ if (!(*uniname & SURROGATE_LOW) && ++ i+1 < MAX_NAME_LENGTH && ++ (*(uniname+1) & SURROGATE_MASK) == SURROGATE_PAIR && ++ (*(uniname+1) & SURROGATE_LOW)) { ++ uniname++; ++ i++; ++ } ++ ++ /* ++ * UTF-16 surrogate pair encodes code points above ++ * U+FFFF. Code points above U+FFFF are not supported ++ * by kernel NLS framework therefore use replacement ++ * character ++ */ ++ len = 1; ++ buf[0] = '_'; ++ } ++ ++ if (out_len + len >= buflen) ++ len = buflen - 1 - out_len; ++ out_len += len; ++ ++ if (len > 1) { ++ for (j = 0; j < len; j++) ++ *p_cstring++ = buf[j]; ++ } else { /* len == 1 */ ++ *p_cstring++ = *buf; ++ } ++ ++ uniname++; ++ i++; ++ } ++ ++ *p_cstring = '\0'; ++ return out_len; ++} ++ ++static int exfat_nls_to_ucs2(struct super_block *sb, ++ const unsigned char *p_cstring, const int len, ++ struct exfat_uni_name *p_uniname, int *p_lossy) ++{ ++ int i = 0, unilen = 0, lossy = NLS_NAME_NO_LOSSY; ++ unsigned short upname[MAX_NAME_LENGTH + 1]; ++ unsigned short *uniname = p_uniname->name; ++ struct nls_table *nls = EXFAT_SB(sb)->nls_io; ++ ++ WARN_ON(!len); ++ ++ while (unilen < MAX_NAME_LENGTH && i < len) { ++ i += exfat_convert_char_to_ucs2(nls, p_cstring + i, len - i, ++ uniname, &lossy); ++ ++ if (*uniname < 0x0020 || ++ exfat_wstrchr(bad_uni_chars, *uniname)) ++ lossy |= NLS_NAME_LOSSY; ++ ++ upname[unilen] = exfat_toupper(sb, *uniname); ++ uniname++; ++ unilen++; ++ } ++ ++ if (p_cstring[i] != '\0') ++ lossy |= NLS_NAME_OVERLEN; ++ ++ *uniname = '\0'; ++ p_uniname->name_len = unilen; ++ p_uniname->name_hash = exfat_calc_chksum_2byte(upname, unilen << 1, 0, ++ CS_DEFAULT); ++ ++ if (p_lossy) ++ *p_lossy = lossy; ++ return unilen; ++} ++ ++int exfat_utf16_to_nls(struct super_block *sb, struct exfat_uni_name *uniname, ++ unsigned char *p_cstring, int buflen) ++{ ++ if (EXFAT_SB(sb)->options.utf8) ++ return exfat_utf16_to_utf8(sb, uniname, p_cstring, ++ buflen); ++ return __exfat_utf16_to_nls(sb, uniname, p_cstring, buflen); ++} ++ ++int exfat_nls_to_utf16(struct super_block *sb, const unsigned char *p_cstring, ++ const int len, struct exfat_uni_name *uniname, int *p_lossy) ++{ ++ if (EXFAT_SB(sb)->options.utf8) ++ return exfat_utf8_to_utf16(sb, p_cstring, len, ++ uniname, p_lossy); ++ return exfat_nls_to_ucs2(sb, p_cstring, len, uniname, p_lossy); ++} ++ ++static int exfat_load_upcase_table(struct super_block *sb, ++ sector_t sector, unsigned long long num_sectors, ++ unsigned int utbl_checksum) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ unsigned int sect_size = sb->s_blocksize; ++ unsigned int i, index = 0, checksum = 0; ++ int ret; ++ unsigned char skip = false; ++ unsigned short *upcase_table; ++ ++ upcase_table = kcalloc(UTBL_COUNT, sizeof(unsigned short), GFP_KERNEL); ++ if (!upcase_table) ++ return -ENOMEM; ++ ++ sbi->vol_utbl = upcase_table; ++ num_sectors += sector; ++ ++ while (sector < num_sectors) { ++ struct buffer_head *bh; ++ ++ bh = sb_bread(sb, sector); ++ if (!bh) { ++ exfat_msg(sb, KERN_ERR, ++ "failed to read sector(0x%llx)\n", ++ (unsigned long long)sector); ++ ret = -EIO; ++ goto free_table; ++ } ++ sector++; ++ for (i = 0; i < sect_size && index <= 0xFFFF; i += 2) { ++ unsigned short uni = get_unaligned_le16(bh->b_data + i); ++ ++ checksum = ((checksum & 1) ? 0x80000000 : 0) + ++ (checksum >> 1) + ++ *(((unsigned char *)bh->b_data) + i); ++ checksum = ((checksum & 1) ? 0x80000000 : 0) + ++ (checksum >> 1) + ++ *(((unsigned char *)bh->b_data) + (i + 1)); ++ ++ if (skip) { ++ index += uni; ++ skip = false; ++ } else if (uni == index) { ++ index++; ++ } else if (uni == 0xFFFF) { ++ skip = true; ++ } else { /* uni != index , uni != 0xFFFF */ ++ upcase_table[index] = uni; ++ index++; ++ } ++ } ++ brelse(bh); ++ } ++ ++ if (index >= 0xFFFF && utbl_checksum == checksum) ++ return 0; ++ ++ exfat_msg(sb, KERN_ERR, ++ "failed to load upcase table (idx : 0x%08x, chksum : 0x%08x, utbl_chksum : 0x%08x)\n", ++ index, checksum, utbl_checksum); ++ ret = -EINVAL; ++free_table: ++ exfat_free_upcase_table(sbi); ++ return ret; ++} ++ ++static int exfat_load_default_upcase_table(struct super_block *sb) ++{ ++ int i, ret = -EIO; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ unsigned char skip = false; ++ unsigned short uni = 0, *upcase_table; ++ unsigned int index = 0; ++ ++ upcase_table = kcalloc(UTBL_COUNT, sizeof(unsigned short), GFP_KERNEL); ++ if (!upcase_table) ++ return -ENOMEM; ++ ++ sbi->vol_utbl = upcase_table; ++ ++ for (i = 0; index <= 0xFFFF && i < EXFAT_NUM_UPCASE; i++) { ++ uni = uni_def_upcase[i]; ++ if (skip) { ++ index += uni; ++ skip = false; ++ } else if (uni == index) { ++ index++; ++ } else if (uni == 0xFFFF) { ++ skip = true; ++ } else { ++ upcase_table[index] = uni; ++ index++; ++ } ++ } ++ ++ if (index >= 0xFFFF) ++ return 0; ++ ++ /* FATAL error: default upcase table has error */ ++ exfat_free_upcase_table(sbi); ++ return ret; ++} ++ ++int exfat_create_upcase_table(struct super_block *sb) ++{ ++ int i, ret; ++ unsigned int tbl_clu, type; ++ sector_t sector; ++ unsigned long long tbl_size, num_sectors; ++ unsigned char blksize_bits = sb->s_blocksize_bits; ++ struct exfat_chain clu; ++ struct exfat_dentry *ep; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct buffer_head *bh; ++ ++ clu.dir = sbi->root_dir; ++ clu.flags = ALLOC_FAT_CHAIN; ++ ++ while (clu.dir != EXFAT_EOF_CLUSTER) { ++ for (i = 0; i < sbi->dentries_per_clu; i++) { ++ ep = exfat_get_dentry(sb, &clu, i, &bh, NULL); ++ if (!ep) ++ return -EIO; ++ ++ type = exfat_get_entry_type(ep); ++ if (type == TYPE_UNUSED) { ++ brelse(bh); ++ break; ++ } ++ ++ if (type != TYPE_UPCASE) { ++ brelse(bh); ++ continue; ++ } ++ ++ tbl_clu = le32_to_cpu(ep->dentry.upcase.start_clu); ++ tbl_size = le64_to_cpu(ep->dentry.upcase.size); ++ ++ sector = exfat_cluster_to_sector(sbi, tbl_clu); ++ num_sectors = ((tbl_size - 1) >> blksize_bits) + 1; ++ ret = exfat_load_upcase_table(sb, sector, num_sectors, ++ le32_to_cpu(ep->dentry.upcase.checksum)); ++ ++ brelse(bh); ++ if (ret && ret != -EIO) ++ goto load_default; ++ ++ /* load successfully */ ++ return ret; ++ } ++ ++ if (exfat_get_next_cluster(sb, &(clu.dir))) ++ return -EIO; ++ } ++ ++load_default: ++ /* load default upcase table */ ++ return exfat_load_default_upcase_table(sb); ++} ++ ++void exfat_free_upcase_table(struct exfat_sb_info *sbi) ++{ ++ kfree(sbi->vol_utbl); ++} +-- +2.25.1 + diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-add-super-block-operations.patch b/kernel/kernel/files/patches/mageia/fs-exfat-add-super-block-operations.patch new file mode 100644 index 00000000..f51a2518 --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-add-super-block-operations.patch @@ -0,0 +1,758 @@ +From 719c1e1829166da399903b13da6dcc5344e73449 Mon Sep 17 00:00:00 2001 +From: Namjae Jeon +Date: Mon, 2 Mar 2020 15:21:33 +0900 +Subject: [PATCH 02/14] exfat: add super block operations +MIME-Version: 1.0 +Content-Type: text/plain; charset=UTF-8 +Content-Transfer-Encoding: 8bit + +This adds the implementation of superblock operations for exfat. + +Signed-off-by: Namjae Jeon +Signed-off-by: Sungjong Seo +Reviewed-by: Pali Rohár +Reviewed-by: Christoph Hellwig +Reviewed-by: Arnd Bergmann +Signed-off-by: Al Viro +--- + fs/exfat/super.c | 728 +++++++++++++++++++++++++++++++++++++++++++++++ + 1 file changed, 728 insertions(+) + create mode 100644 fs/exfat/super.c + +diff --git a/fs/exfat/super.c b/fs/exfat/super.c +new file mode 100644 +index 000000000000..f06e0b53e393 +--- /dev/null ++++ b/fs/exfat/super.c +@@ -0,0 +1,728 @@ ++// SPDX-License-Identifier: GPL-2.0-or-later ++/* ++ * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. ++ */ ++ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++#include "exfat_raw.h" ++#include "exfat_fs.h" ++ ++static char exfat_default_iocharset[] = CONFIG_EXFAT_DEFAULT_IOCHARSET; ++static struct kmem_cache *exfat_inode_cachep; ++ ++static void exfat_free_iocharset(struct exfat_sb_info *sbi) ++{ ++ if (sbi->options.iocharset != exfat_default_iocharset) ++ kfree(sbi->options.iocharset); ++} ++ ++static void exfat_delayed_free(struct rcu_head *p) ++{ ++ struct exfat_sb_info *sbi = container_of(p, struct exfat_sb_info, rcu); ++ ++ unload_nls(sbi->nls_io); ++ exfat_free_iocharset(sbi); ++ exfat_free_upcase_table(sbi); ++ kfree(sbi); ++} ++ ++static void exfat_put_super(struct super_block *sb) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ ++ mutex_lock(&sbi->s_lock); ++ if (test_and_clear_bit(EXFAT_SB_DIRTY, &sbi->s_state)) ++ sync_blockdev(sb->s_bdev); ++ exfat_set_vol_flags(sb, VOL_CLEAN); ++ exfat_free_bitmap(sbi); ++ mutex_unlock(&sbi->s_lock); ++ ++ call_rcu(&sbi->rcu, exfat_delayed_free); ++} ++ ++static int exfat_sync_fs(struct super_block *sb, int wait) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ int err = 0; ++ ++ /* If there are some dirty buffers in the bdev inode */ ++ mutex_lock(&sbi->s_lock); ++ if (test_and_clear_bit(EXFAT_SB_DIRTY, &sbi->s_state)) { ++ sync_blockdev(sb->s_bdev); ++ if (exfat_set_vol_flags(sb, VOL_CLEAN)) ++ err = -EIO; ++ } ++ mutex_unlock(&sbi->s_lock); ++ return err; ++} ++ ++static int exfat_statfs(struct dentry *dentry, struct kstatfs *buf) ++{ ++ struct super_block *sb = dentry->d_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ unsigned long long id = huge_encode_dev(sb->s_bdev->bd_dev); ++ ++ if (sbi->used_clusters == EXFAT_CLUSTERS_UNTRACKED) { ++ mutex_lock(&sbi->s_lock); ++ if (exfat_count_used_clusters(sb, &sbi->used_clusters)) { ++ mutex_unlock(&sbi->s_lock); ++ return -EIO; ++ } ++ mutex_unlock(&sbi->s_lock); ++ } ++ ++ buf->f_type = sb->s_magic; ++ buf->f_bsize = sbi->cluster_size; ++ buf->f_blocks = sbi->num_clusters - 2; /* clu 0 & 1 */ ++ buf->f_bfree = buf->f_blocks - sbi->used_clusters; ++ buf->f_bavail = buf->f_bfree; ++ buf->f_fsid.val[0] = (unsigned int)id; ++ buf->f_fsid.val[1] = (unsigned int)(id >> 32); ++ /* Unicode utf16 255 characters */ ++ buf->f_namelen = EXFAT_MAX_FILE_LEN * NLS_MAX_CHARSET_SIZE; ++ return 0; ++} ++ ++int exfat_set_vol_flags(struct super_block *sb, unsigned short new_flag) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct pbr64 *bpb; ++ bool sync = 0; ++ ++ /* flags are not changed */ ++ if (sbi->vol_flag == new_flag) ++ return 0; ++ ++ sbi->vol_flag = new_flag; ++ ++ /* skip updating volume dirty flag, ++ * if this volume has been mounted with read-only ++ */ ++ if (sb_rdonly(sb)) ++ return 0; ++ ++ if (!sbi->pbr_bh) { ++ sbi->pbr_bh = sb_bread(sb, 0); ++ if (!sbi->pbr_bh) { ++ exfat_msg(sb, KERN_ERR, "failed to read boot sector"); ++ return -ENOMEM; ++ } ++ } ++ ++ bpb = (struct pbr64 *)sbi->pbr_bh->b_data; ++ bpb->bsx.vol_flags = cpu_to_le16(new_flag); ++ ++ if (new_flag == VOL_DIRTY && !buffer_dirty(sbi->pbr_bh)) ++ sync = true; ++ else ++ sync = false; ++ ++ set_buffer_uptodate(sbi->pbr_bh); ++ mark_buffer_dirty(sbi->pbr_bh); ++ ++ if (sync) ++ sync_dirty_buffer(sbi->pbr_bh); ++ return 0; ++} ++ ++static int exfat_show_options(struct seq_file *m, struct dentry *root) ++{ ++ struct super_block *sb = root->d_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_mount_options *opts = &sbi->options; ++ ++ /* Show partition info */ ++ if (!uid_eq(opts->fs_uid, GLOBAL_ROOT_UID)) ++ seq_printf(m, ",uid=%u", ++ from_kuid_munged(&init_user_ns, opts->fs_uid)); ++ if (!gid_eq(opts->fs_gid, GLOBAL_ROOT_GID)) ++ seq_printf(m, ",gid=%u", ++ from_kgid_munged(&init_user_ns, opts->fs_gid)); ++ seq_printf(m, ",fmask=%04o,dmask=%04o", opts->fs_fmask, opts->fs_dmask); ++ if (opts->allow_utime) ++ seq_printf(m, ",allow_utime=%04o", opts->allow_utime); ++ if (opts->utf8) ++ seq_puts(m, ",iocharset=utf8"); ++ else if (sbi->nls_io) ++ seq_printf(m, ",iocharset=%s", sbi->nls_io->charset); ++ seq_printf(m, ",bps=%ld", sb->s_blocksize); ++ if (opts->errors == EXFAT_ERRORS_CONT) ++ seq_puts(m, ",errors=continue"); ++ else if (opts->errors == EXFAT_ERRORS_PANIC) ++ seq_puts(m, ",errors=panic"); ++ else ++ seq_puts(m, ",errors=remount-ro"); ++ if (opts->discard) ++ seq_puts(m, ",discard"); ++ if (opts->time_offset) ++ seq_printf(m, ",time_offset=%d", opts->time_offset); ++ return 0; ++} ++ ++static struct inode *exfat_alloc_inode(struct super_block *sb) ++{ ++ struct exfat_inode_info *ei; ++ ++ ei = kmem_cache_alloc(exfat_inode_cachep, GFP_NOFS); ++ if (!ei) ++ return NULL; ++ ++ init_rwsem(&ei->truncate_lock); ++ return &ei->vfs_inode; ++} ++ ++static void exfat_free_inode(struct inode *inode) ++{ ++ kmem_cache_free(exfat_inode_cachep, EXFAT_I(inode)); ++} ++ ++static const struct super_operations exfat_sops = { ++ .alloc_inode = exfat_alloc_inode, ++ .free_inode = exfat_free_inode, ++ .write_inode = exfat_write_inode, ++ .evict_inode = exfat_evict_inode, ++ .put_super = exfat_put_super, ++ .sync_fs = exfat_sync_fs, ++ .statfs = exfat_statfs, ++ .show_options = exfat_show_options, ++}; ++ ++enum { ++ Opt_uid, ++ Opt_gid, ++ Opt_umask, ++ Opt_dmask, ++ Opt_fmask, ++ Opt_allow_utime, ++ Opt_charset, ++ Opt_errors, ++ Opt_discard, ++ Opt_time_offset, ++}; ++ ++static const struct fs_parameter_spec exfat_param_specs[] = { ++ fsparam_u32("uid", Opt_uid), ++ fsparam_u32("gid", Opt_gid), ++ fsparam_u32oct("umask", Opt_umask), ++ fsparam_u32oct("dmask", Opt_dmask), ++ fsparam_u32oct("fmask", Opt_fmask), ++ fsparam_u32oct("allow_utime", Opt_allow_utime), ++ fsparam_string("iocharset", Opt_charset), ++ fsparam_enum("errors", Opt_errors), ++ fsparam_flag("discard", Opt_discard), ++ fsparam_s32("time_offset", Opt_time_offset), ++ {} ++}; ++ ++static const struct fs_parameter_enum exfat_param_enums[] = { ++ { Opt_errors, "continue", EXFAT_ERRORS_CONT }, ++ { Opt_errors, "panic", EXFAT_ERRORS_PANIC }, ++ { Opt_errors, "remount-ro", EXFAT_ERRORS_RO }, ++ {} ++}; ++ ++static const struct fs_parameter_description exfat_parameters = { ++ .name = "exfat", ++ .specs = exfat_param_specs, ++ .enums = exfat_param_enums, ++}; ++ ++static int exfat_parse_param(struct fs_context *fc, struct fs_parameter *param) ++{ ++ struct exfat_sb_info *sbi = fc->s_fs_info; ++ struct exfat_mount_options *opts = &sbi->options; ++ struct fs_parse_result result; ++ int opt; ++ ++ opt = fs_parse(fc, &exfat_parameters, param, &result); ++ if (opt < 0) ++ return opt; ++ ++ switch (opt) { ++ case Opt_uid: ++ opts->fs_uid = make_kuid(current_user_ns(), result.uint_32); ++ break; ++ case Opt_gid: ++ opts->fs_gid = make_kgid(current_user_ns(), result.uint_32); ++ break; ++ case Opt_umask: ++ opts->fs_fmask = result.uint_32; ++ opts->fs_dmask = result.uint_32; ++ break; ++ case Opt_dmask: ++ opts->fs_dmask = result.uint_32; ++ break; ++ case Opt_fmask: ++ opts->fs_fmask = result.uint_32; ++ break; ++ case Opt_allow_utime: ++ opts->allow_utime = result.uint_32 & 0022; ++ break; ++ case Opt_charset: ++ exfat_free_iocharset(sbi); ++ opts->iocharset = kstrdup(param->string, GFP_KERNEL); ++ if (!opts->iocharset) ++ return -ENOMEM; ++ break; ++ case Opt_errors: ++ opts->errors = result.uint_32; ++ break; ++ case Opt_discard: ++ opts->discard = 1; ++ break; ++ case Opt_time_offset: ++ /* ++ * Make the limit 24 just in case someone invents something ++ * unusual. ++ */ ++ if (result.int_32 < -24 * 60 || result.int_32 > 24 * 60) ++ return -EINVAL; ++ opts->time_offset = result.int_32; ++ break; ++ default: ++ return -EINVAL; ++ } ++ ++ return 0; ++} ++ ++static void exfat_hash_init(struct super_block *sb) ++{ ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ int i; ++ ++ spin_lock_init(&sbi->inode_hash_lock); ++ for (i = 0; i < EXFAT_HASH_SIZE; i++) ++ INIT_HLIST_HEAD(&sbi->inode_hashtable[i]); ++} ++ ++static int exfat_read_root(struct inode *inode) ++{ ++ struct super_block *sb = inode->i_sb; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ struct exfat_inode_info *ei = EXFAT_I(inode); ++ struct exfat_chain cdir; ++ int num_subdirs, num_clu = 0; ++ ++ exfat_chain_set(&ei->dir, sbi->root_dir, 0, ALLOC_FAT_CHAIN); ++ ei->entry = -1; ++ ei->start_clu = sbi->root_dir; ++ ei->flags = ALLOC_FAT_CHAIN; ++ ei->type = TYPE_DIR; ++ ei->version = 0; ++ ei->rwoffset = 0; ++ ei->hint_bmap.off = EXFAT_EOF_CLUSTER; ++ ei->hint_stat.eidx = 0; ++ ei->hint_stat.clu = sbi->root_dir; ++ ei->hint_femp.eidx = EXFAT_HINT_NONE; ++ ++ exfat_chain_set(&cdir, sbi->root_dir, 0, ALLOC_FAT_CHAIN); ++ if (exfat_count_num_clusters(sb, &cdir, &num_clu)) ++ return -EIO; ++ i_size_write(inode, num_clu << sbi->cluster_size_bits); ++ ++ num_subdirs = exfat_count_dir_entries(sb, &cdir); ++ if (num_subdirs < 0) ++ return -EIO; ++ set_nlink(inode, num_subdirs + EXFAT_MIN_SUBDIR); ++ ++ inode->i_uid = sbi->options.fs_uid; ++ inode->i_gid = sbi->options.fs_gid; ++ inode_inc_iversion(inode); ++ inode->i_generation = 0; ++ inode->i_mode = exfat_make_mode(sbi, ATTR_SUBDIR, 0777); ++ inode->i_op = &exfat_dir_inode_operations; ++ inode->i_fop = &exfat_dir_operations; ++ ++ inode->i_blocks = ((i_size_read(inode) + (sbi->cluster_size - 1)) ++ & ~(sbi->cluster_size - 1)) >> inode->i_blkbits; ++ EXFAT_I(inode)->i_pos = ((loff_t)sbi->root_dir << 32) | 0xffffffff; ++ EXFAT_I(inode)->i_size_aligned = i_size_read(inode); ++ EXFAT_I(inode)->i_size_ondisk = i_size_read(inode); ++ ++ exfat_save_attr(inode, ATTR_SUBDIR); ++ inode->i_mtime = inode->i_atime = inode->i_ctime = ei->i_crtime = ++ current_time(inode); ++ exfat_cache_init_inode(inode); ++ return 0; ++} ++ ++static struct pbr *exfat_read_pbr_with_logical_sector(struct super_block *sb, ++ struct buffer_head **prev_bh) ++{ ++ struct pbr *p_pbr = (struct pbr *) (*prev_bh)->b_data; ++ unsigned short logical_sect = 0; ++ ++ logical_sect = 1 << p_pbr->bsx.f64.sect_size_bits; ++ ++ if (!is_power_of_2(logical_sect) || ++ logical_sect < 512 || logical_sect > 4096) { ++ exfat_msg(sb, KERN_ERR, "bogus logical sector size %u", ++ logical_sect); ++ return NULL; ++ } ++ ++ if (logical_sect < sb->s_blocksize) { ++ exfat_msg(sb, KERN_ERR, ++ "logical sector size too small for device (logical sector size = %u)", ++ logical_sect); ++ return NULL; ++ } ++ ++ if (logical_sect > sb->s_blocksize) { ++ struct buffer_head *bh = NULL; ++ ++ __brelse(*prev_bh); ++ *prev_bh = NULL; ++ ++ if (!sb_set_blocksize(sb, logical_sect)) { ++ exfat_msg(sb, KERN_ERR, ++ "unable to set blocksize %u", logical_sect); ++ return NULL; ++ } ++ bh = sb_bread(sb, 0); ++ if (!bh) { ++ exfat_msg(sb, KERN_ERR, ++ "unable to read boot sector (logical sector size = %lu)", ++ sb->s_blocksize); ++ return NULL; ++ } ++ ++ *prev_bh = bh; ++ p_pbr = (struct pbr *) bh->b_data; ++ } ++ return p_pbr; ++} ++ ++/* mount the file system volume */ ++static int __exfat_fill_super(struct super_block *sb) ++{ ++ int ret; ++ struct pbr *p_pbr; ++ struct pbr64 *p_bpb; ++ struct buffer_head *bh; ++ struct exfat_sb_info *sbi = EXFAT_SB(sb); ++ ++ /* set block size to read super block */ ++ sb_min_blocksize(sb, 512); ++ ++ /* read boot sector */ ++ bh = sb_bread(sb, 0); ++ if (!bh) { ++ exfat_msg(sb, KERN_ERR, "unable to read boot sector"); ++ return -EIO; ++ } ++ ++ /* PRB is read */ ++ p_pbr = (struct pbr *)bh->b_data; ++ ++ /* check the validity of PBR */ ++ if (le16_to_cpu((p_pbr->signature)) != PBR_SIGNATURE) { ++ exfat_msg(sb, KERN_ERR, "invalid boot record signature"); ++ ret = -EINVAL; ++ goto free_bh; ++ } ++ ++ ++ /* check logical sector size */ ++ p_pbr = exfat_read_pbr_with_logical_sector(sb, &bh); ++ if (!p_pbr) { ++ ret = -EIO; ++ goto free_bh; ++ } ++ ++ /* ++ * res_zero field must be filled with zero to prevent mounting ++ * from FAT volume. ++ */ ++ if (memchr_inv(p_pbr->bpb.f64.res_zero, 0, ++ sizeof(p_pbr->bpb.f64.res_zero))) { ++ ret = -EINVAL; ++ goto free_bh; ++ } ++ ++ p_bpb = (struct pbr64 *)p_pbr; ++ if (!p_bpb->bsx.num_fats) { ++ exfat_msg(sb, KERN_ERR, "bogus number of FAT structure"); ++ ret = -EINVAL; ++ goto free_bh; ++ } ++ ++ sbi->sect_per_clus = 1 << p_bpb->bsx.sect_per_clus_bits; ++ sbi->sect_per_clus_bits = p_bpb->bsx.sect_per_clus_bits; ++ sbi->cluster_size_bits = sbi->sect_per_clus_bits + sb->s_blocksize_bits; ++ sbi->cluster_size = 1 << sbi->cluster_size_bits; ++ sbi->num_FAT_sectors = le32_to_cpu(p_bpb->bsx.fat_length); ++ sbi->FAT1_start_sector = le32_to_cpu(p_bpb->bsx.fat_offset); ++ sbi->FAT2_start_sector = p_bpb->bsx.num_fats == 1 ? ++ sbi->FAT1_start_sector : ++ sbi->FAT1_start_sector + sbi->num_FAT_sectors; ++ sbi->data_start_sector = le32_to_cpu(p_bpb->bsx.clu_offset); ++ sbi->num_sectors = le64_to_cpu(p_bpb->bsx.vol_length); ++ /* because the cluster index starts with 2 */ ++ sbi->num_clusters = le32_to_cpu(p_bpb->bsx.clu_count) + ++ EXFAT_RESERVED_CLUSTERS; ++ ++ sbi->root_dir = le32_to_cpu(p_bpb->bsx.root_cluster); ++ sbi->dentries_per_clu = 1 << ++ (sbi->cluster_size_bits - DENTRY_SIZE_BITS); ++ ++ sbi->vol_flag = le16_to_cpu(p_bpb->bsx.vol_flags); ++ sbi->clu_srch_ptr = EXFAT_FIRST_CLUSTER; ++ sbi->used_clusters = EXFAT_CLUSTERS_UNTRACKED; ++ ++ if (le16_to_cpu(p_bpb->bsx.vol_flags) & VOL_DIRTY) { ++ sbi->vol_flag |= VOL_DIRTY; ++ exfat_msg(sb, KERN_WARNING, ++ "Volume was not properly unmounted. Some data may be corrupt. Please run fsck."); ++ } ++ ++ /* exFAT file size is limited by a disk volume size */ ++ sb->s_maxbytes = (u64)(sbi->num_clusters - EXFAT_RESERVED_CLUSTERS) << ++ sbi->cluster_size_bits; ++ ++ ret = exfat_create_upcase_table(sb); ++ if (ret) { ++ exfat_msg(sb, KERN_ERR, "failed to load upcase table"); ++ goto free_bh; ++ } ++ ++ ret = exfat_load_bitmap(sb); ++ if (ret) { ++ exfat_msg(sb, KERN_ERR, "failed to load alloc-bitmap"); ++ goto free_upcase_table; ++ } ++ ++ ret = exfat_count_used_clusters(sb, &sbi->used_clusters); ++ if (ret) { ++ exfat_msg(sb, KERN_ERR, "failed to scan clusters"); ++ goto free_alloc_bitmap; ++ } ++ ++ return 0; ++ ++free_alloc_bitmap: ++ exfat_free_bitmap(sbi); ++free_upcase_table: ++ exfat_free_upcase_table(sbi); ++free_bh: ++ brelse(bh); ++ return ret; ++} ++ ++static int exfat_fill_super(struct super_block *sb, struct fs_context *fc) ++{ ++ struct exfat_sb_info *sbi = sb->s_fs_info; ++ struct exfat_mount_options *opts = &sbi->options; ++ struct inode *root_inode; ++ int err; ++ ++ if (opts->allow_utime == (unsigned short)-1) ++ opts->allow_utime = ~opts->fs_dmask & 0022; ++ ++ if (opts->discard) { ++ struct request_queue *q = bdev_get_queue(sb->s_bdev); ++ ++ if (!blk_queue_discard(q)) ++ exfat_msg(sb, KERN_WARNING, ++ "mounting with \"discard\" option, but the device does not support discard"); ++ opts->discard = 0; ++ } ++ ++ sb->s_flags |= SB_NODIRATIME; ++ sb->s_magic = EXFAT_SUPER_MAGIC; ++ sb->s_op = &exfat_sops; ++ ++ sb->s_time_gran = 1; ++ sb->s_time_min = EXFAT_MIN_TIMESTAMP_SECS; ++ sb->s_time_max = EXFAT_MAX_TIMESTAMP_SECS; ++ ++ err = __exfat_fill_super(sb); ++ if (err) { ++ exfat_msg(sb, KERN_ERR, "failed to recognize exfat type"); ++ goto check_nls_io; ++ } ++ ++ /* set up enough so that it can read an inode */ ++ exfat_hash_init(sb); ++ ++ if (!strcmp(sbi->options.iocharset, "utf8")) ++ opts->utf8 = 1; ++ else { ++ sbi->nls_io = load_nls(sbi->options.iocharset); ++ if (!sbi->nls_io) { ++ exfat_msg(sb, KERN_ERR, "IO charset %s not found", ++ sbi->options.iocharset); ++ err = -EINVAL; ++ goto free_table; ++ } ++ } ++ ++ if (sbi->options.utf8) ++ sb->s_d_op = &exfat_utf8_dentry_ops; ++ else ++ sb->s_d_op = &exfat_dentry_ops; ++ ++ root_inode = new_inode(sb); ++ if (!root_inode) { ++ exfat_msg(sb, KERN_ERR, "failed to allocate root inode."); ++ err = -ENOMEM; ++ goto free_table; ++ } ++ ++ root_inode->i_ino = EXFAT_ROOT_INO; ++ inode_set_iversion(root_inode, 1); ++ err = exfat_read_root(root_inode); ++ if (err) { ++ exfat_msg(sb, KERN_ERR, "failed to initialize root inode."); ++ goto put_inode; ++ } ++ ++ exfat_hash_inode(root_inode, EXFAT_I(root_inode)->i_pos); ++ insert_inode_hash(root_inode); ++ ++ sb->s_root = d_make_root(root_inode); ++ if (!sb->s_root) { ++ exfat_msg(sb, KERN_ERR, "failed to get the root dentry"); ++ err = -ENOMEM; ++ goto put_inode; ++ } ++ ++ return 0; ++ ++put_inode: ++ iput(root_inode); ++ sb->s_root = NULL; ++ ++free_table: ++ exfat_free_upcase_table(sbi); ++ exfat_free_bitmap(sbi); ++ ++check_nls_io: ++ unload_nls(sbi->nls_io); ++ exfat_free_iocharset(sbi); ++ sb->s_fs_info = NULL; ++ kfree(sbi); ++ return err; ++} ++ ++static int exfat_get_tree(struct fs_context *fc) ++{ ++ return get_tree_bdev(fc, exfat_fill_super); ++} ++ ++static void exfat_free(struct fs_context *fc) ++{ ++ kfree(fc->s_fs_info); ++} ++ ++static const struct fs_context_operations exfat_context_ops = { ++ .parse_param = exfat_parse_param, ++ .get_tree = exfat_get_tree, ++ .free = exfat_free, ++}; ++ ++static int exfat_init_fs_context(struct fs_context *fc) ++{ ++ struct exfat_sb_info *sbi; ++ ++ sbi = kzalloc(sizeof(struct exfat_sb_info), GFP_KERNEL); ++ if (!sbi) ++ return -ENOMEM; ++ ++ mutex_init(&sbi->s_lock); ++ ratelimit_state_init(&sbi->ratelimit, DEFAULT_RATELIMIT_INTERVAL, ++ DEFAULT_RATELIMIT_BURST); ++ ++ sbi->options.fs_uid = current_uid(); ++ sbi->options.fs_gid = current_gid(); ++ sbi->options.fs_fmask = current->fs->umask; ++ sbi->options.fs_dmask = current->fs->umask; ++ sbi->options.allow_utime = -1; ++ sbi->options.iocharset = exfat_default_iocharset; ++ sbi->options.errors = EXFAT_ERRORS_RO; ++ ++ fc->s_fs_info = sbi; ++ fc->ops = &exfat_context_ops; ++ return 0; ++} ++ ++static struct file_system_type exfat_fs_type = { ++ .owner = THIS_MODULE, ++ .name = "exfat", ++ .init_fs_context = exfat_init_fs_context, ++ .parameters = &exfat_parameters, ++ .kill_sb = kill_block_super, ++ .fs_flags = FS_REQUIRES_DEV, ++}; ++ ++static void exfat_inode_init_once(void *foo) ++{ ++ struct exfat_inode_info *ei = (struct exfat_inode_info *)foo; ++ ++ INIT_HLIST_NODE(&ei->i_hash_fat); ++ inode_init_once(&ei->vfs_inode); ++} ++ ++static int __init init_exfat_fs(void) ++{ ++ int err; ++ ++ err = exfat_cache_init(); ++ if (err) ++ return err; ++ ++ exfat_inode_cachep = kmem_cache_create("exfat_inode_cache", ++ sizeof(struct exfat_inode_info), ++ 0, SLAB_RECLAIM_ACCOUNT | SLAB_MEM_SPREAD, ++ exfat_inode_init_once); ++ if (!exfat_inode_cachep) { ++ err = -ENOMEM; ++ goto shutdown_cache; ++ } ++ ++ err = register_filesystem(&exfat_fs_type); ++ if (err) ++ goto destroy_cache; ++ ++ return 0; ++ ++destroy_cache: ++ kmem_cache_destroy(exfat_inode_cachep); ++shutdown_cache: ++ exfat_cache_shutdown(); ++ return err; ++} ++ ++static void __exit exit_exfat_fs(void) ++{ ++ /* ++ * Make sure all delayed rcu free inodes are flushed before we ++ * destroy cache. ++ */ ++ rcu_barrier(); ++ kmem_cache_destroy(exfat_inode_cachep); ++ unregister_filesystem(&exfat_fs_type); ++ exfat_cache_shutdown(); ++} ++ ++module_init(init_exfat_fs); ++module_exit(exit_exfat_fs); ++ ++MODULE_LICENSE("GPL"); ++MODULE_DESCRIPTION("exFAT filesystem support"); ++MODULE_AUTHOR("Samsung Electronics Co., Ltd."); +-- +2.25.1 + diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-remove-from-staging.patch b/kernel/kernel/files/patches/mageia/fs-exfat-remove-from-staging.patch new file mode 100644 index 00000000..25268372 --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-remove-from-staging.patch @@ -0,0 +1,9152 @@ + +This removes the staging driver in favour of the one being merged upstream in 5.7 + +Signed-off-by: Thomas Backlund + +--- + MAINTAINERS | 6 + drivers/staging/Kconfig | 2 + drivers/staging/Makefile | 1 + drivers/staging/exfat/Kconfig | 41 -- + drivers/staging/exfat/Makefile | 10 + drivers/staging/exfat/TODO | 69 --- + drivers/staging/exfat/exfat.h | 824 ---------------------------------------- + drivers/staging/exfat/exfat_blkdev.c | 136 ------ + drivers/staging/exfat/exfat_cache.c | 555 --------------------------- + drivers/staging/exfat/exfat_core.c | 2582 -------------------------------------------------------------------------------------------------------------------------------- + drivers/staging/exfat/exfat_nls.c | 212 ---------- + drivers/staging/exfat/exfat_super.c | 3883 ------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------- + drivers/staging/exfat/exfat_upcase.c | 740 ------------------------------------ + 13 files changed, 9061 deletions(-) + +diff -Nurp linux-5.6.3.orig/drivers/staging/exfat/exfat_blkdev.c linux-5.6.3/drivers/staging/exfat/exfat_blkdev.c +--- linux-5.6.3.orig/drivers/staging/exfat/exfat_blkdev.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/drivers/staging/exfat/exfat_blkdev.c 1970-01-01 02:00:00.000000000 +0200 +@@ -1,136 +0,0 @@ +-// SPDX-License-Identifier: GPL-2.0-or-later +-/* +- * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. +- */ +- +-#include +-#include +-#include +-#include "exfat.h" +- +-void exfat_bdev_open(struct super_block *sb) +-{ +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- if (p_bd->opened) +- return; +- +- p_bd->sector_size = bdev_logical_block_size(sb->s_bdev); +- p_bd->sector_size_bits = ilog2(p_bd->sector_size); +- p_bd->sector_size_mask = p_bd->sector_size - 1; +- p_bd->num_sectors = i_size_read(sb->s_bdev->bd_inode) >> +- p_bd->sector_size_bits; +- p_bd->opened = true; +-} +- +-void exfat_bdev_close(struct super_block *sb) +-{ +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- p_bd->opened = false; +-} +- +-int exfat_bdev_read(struct super_block *sb, sector_t secno, struct buffer_head **bh, +- u32 num_secs, bool read) +-{ +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +-#ifdef CONFIG_STAGING_EXFAT_KERNEL_DEBUG +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- long flags = sbi->debug_flags; +- +- if (flags & EXFAT_DEBUGFLAGS_ERROR_RW) +- return -EIO; +-#endif /* CONFIG_STAGING_EXFAT_KERNEL_DEBUG */ +- +- if (!p_bd->opened) +- return -ENODEV; +- +- if (*bh) +- __brelse(*bh); +- +- if (read) +- *bh = __bread(sb->s_bdev, secno, +- num_secs << p_bd->sector_size_bits); +- else +- *bh = __getblk(sb->s_bdev, secno, +- num_secs << p_bd->sector_size_bits); +- +- if (*bh) +- return 0; +- +- WARN(!p_fs->dev_ejected, +- "[EXFAT] No bh, device seems wrong or to be ejected.\n"); +- +- return -EIO; +-} +- +-int exfat_bdev_write(struct super_block *sb, sector_t secno, struct buffer_head *bh, +- u32 num_secs, bool sync) +-{ +- s32 count; +- struct buffer_head *bh2; +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +-#ifdef CONFIG_STAGING_EXFAT_KERNEL_DEBUG +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- long flags = sbi->debug_flags; +- +- if (flags & EXFAT_DEBUGFLAGS_ERROR_RW) +- return -EIO; +-#endif /* CONFIG_STAGING_EXFAT_KERNEL_DEBUG */ +- +- if (!p_bd->opened) +- return -ENODEV; +- +- if (secno == bh->b_blocknr) { +- lock_buffer(bh); +- set_buffer_uptodate(bh); +- mark_buffer_dirty(bh); +- unlock_buffer(bh); +- if (sync && (sync_dirty_buffer(bh) != 0)) +- return -EIO; +- } else { +- count = num_secs << p_bd->sector_size_bits; +- +- bh2 = __getblk(sb->s_bdev, secno, count); +- if (!bh2) +- goto no_bh; +- +- lock_buffer(bh2); +- memcpy(bh2->b_data, bh->b_data, count); +- set_buffer_uptodate(bh2); +- mark_buffer_dirty(bh2); +- unlock_buffer(bh2); +- if (sync && (sync_dirty_buffer(bh2) != 0)) { +- __brelse(bh2); +- goto no_bh; +- } +- __brelse(bh2); +- } +- +- return 0; +- +-no_bh: +- WARN(!p_fs->dev_ejected, +- "[EXFAT] No bh, device seems wrong or to be ejected.\n"); +- +- return -EIO; +-} +- +-int exfat_bdev_sync(struct super_block *sb) +-{ +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +-#ifdef CONFIG_STAGING_EXFAT_KERNEL_DEBUG +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- long flags = sbi->debug_flags; +- +- if (flags & EXFAT_DEBUGFLAGS_ERROR_RW) +- return -EIO; +-#endif /* CONFIG_STAGING_EXFAT_KERNEL_DEBUG */ +- +- if (!p_bd->opened) +- return -ENODEV; +- +- return sync_blockdev(sb->s_bdev); +-} +diff -Nurp linux-5.6.3.orig/drivers/staging/exfat/exfat_cache.c linux-5.6.3/drivers/staging/exfat/exfat_cache.c +--- linux-5.6.3.orig/drivers/staging/exfat/exfat_cache.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/drivers/staging/exfat/exfat_cache.c 1970-01-01 02:00:00.000000000 +0200 +@@ -1,555 +0,0 @@ +-// SPDX-License-Identifier: GPL-2.0-or-later +-/* +- * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. +- */ +- +-#include +-#include +-#include +-#include "exfat.h" +- +-#define LOCKBIT 0x01 +-#define DIRTYBIT 0x02 +- +-/* Local variables */ +-static DEFINE_MUTEX(f_mutex); +-static DEFINE_MUTEX(b_mutex); +- +-static struct buf_cache_t *FAT_cache_find(struct super_block *sb, sector_t sec) +-{ +- s32 off; +- struct buf_cache_t *bp, *hp; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- off = (sec + +- (sec >> p_fs->sectors_per_clu_bits)) & (FAT_CACHE_HASH_SIZE - 1); +- +- hp = &p_fs->FAT_cache_hash_list[off]; +- for (bp = hp->hash_next; bp != hp; bp = bp->hash_next) { +- if ((bp->drv == p_fs->drv) && (bp->sec == sec)) { +- WARN(!bp->buf_bh, +- "[EXFAT] FAT_cache has no bh. It will make system panic.\n"); +- +- touch_buffer(bp->buf_bh); +- return bp; +- } +- } +- return NULL; +-} +- +-static void push_to_mru(struct buf_cache_t *bp, struct buf_cache_t *list) +-{ +- bp->next = list->next; +- bp->prev = list; +- list->next->prev = bp; +- list->next = bp; +-} +- +-static void push_to_lru(struct buf_cache_t *bp, struct buf_cache_t *list) +-{ +- bp->prev = list->prev; +- bp->next = list; +- list->prev->next = bp; +- list->prev = bp; +-} +- +-static void move_to_mru(struct buf_cache_t *bp, struct buf_cache_t *list) +-{ +- bp->prev->next = bp->next; +- bp->next->prev = bp->prev; +- push_to_mru(bp, list); +-} +- +-static void move_to_lru(struct buf_cache_t *bp, struct buf_cache_t *list) +-{ +- bp->prev->next = bp->next; +- bp->next->prev = bp->prev; +- push_to_lru(bp, list); +-} +- +-static struct buf_cache_t *FAT_cache_get(struct super_block *sb, sector_t sec) +-{ +- struct buf_cache_t *bp; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- bp = p_fs->FAT_cache_lru_list.prev; +- +- move_to_mru(bp, &p_fs->FAT_cache_lru_list); +- return bp; +-} +- +-static void FAT_cache_insert_hash(struct super_block *sb, +- struct buf_cache_t *bp) +-{ +- s32 off; +- struct buf_cache_t *hp; +- struct fs_info_t *p_fs; +- +- p_fs = &(EXFAT_SB(sb)->fs_info); +- off = (bp->sec + +- (bp->sec >> p_fs->sectors_per_clu_bits)) & +- (FAT_CACHE_HASH_SIZE - 1); +- +- hp = &p_fs->FAT_cache_hash_list[off]; +- bp->hash_next = hp->hash_next; +- bp->hash_prev = hp; +- hp->hash_next->hash_prev = bp; +- hp->hash_next = bp; +-} +- +-static void FAT_cache_remove_hash(struct buf_cache_t *bp) +-{ +- (bp->hash_prev)->hash_next = bp->hash_next; +- (bp->hash_next)->hash_prev = bp->hash_prev; +-} +- +-static void buf_cache_insert_hash(struct super_block *sb, +- struct buf_cache_t *bp) +-{ +- s32 off; +- struct buf_cache_t *hp; +- struct fs_info_t *p_fs; +- +- p_fs = &(EXFAT_SB(sb)->fs_info); +- off = (bp->sec + +- (bp->sec >> p_fs->sectors_per_clu_bits)) & +- (BUF_CACHE_HASH_SIZE - 1); +- +- hp = &p_fs->buf_cache_hash_list[off]; +- bp->hash_next = hp->hash_next; +- bp->hash_prev = hp; +- hp->hash_next->hash_prev = bp; +- hp->hash_next = bp; +-} +- +-static void buf_cache_remove_hash(struct buf_cache_t *bp) +-{ +- (bp->hash_prev)->hash_next = bp->hash_next; +- (bp->hash_next)->hash_prev = bp->hash_prev; +-} +- +-void exfat_buf_init(struct super_block *sb) +-{ +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- int i; +- +- /* LRU list */ +- p_fs->FAT_cache_lru_list.next = &p_fs->FAT_cache_lru_list; +- p_fs->FAT_cache_lru_list.prev = &p_fs->FAT_cache_lru_list; +- +- for (i = 0; i < FAT_CACHE_SIZE; i++) { +- p_fs->FAT_cache_array[i].drv = -1; +- p_fs->FAT_cache_array[i].sec = ~0; +- p_fs->FAT_cache_array[i].flag = 0; +- p_fs->FAT_cache_array[i].buf_bh = NULL; +- p_fs->FAT_cache_array[i].prev = NULL; +- p_fs->FAT_cache_array[i].next = NULL; +- push_to_mru(&p_fs->FAT_cache_array[i], +- &p_fs->FAT_cache_lru_list); +- } +- +- p_fs->buf_cache_lru_list.next = &p_fs->buf_cache_lru_list; +- p_fs->buf_cache_lru_list.prev = &p_fs->buf_cache_lru_list; +- +- for (i = 0; i < BUF_CACHE_SIZE; i++) { +- p_fs->buf_cache_array[i].drv = -1; +- p_fs->buf_cache_array[i].sec = ~0; +- p_fs->buf_cache_array[i].flag = 0; +- p_fs->buf_cache_array[i].buf_bh = NULL; +- p_fs->buf_cache_array[i].prev = NULL; +- p_fs->buf_cache_array[i].next = NULL; +- push_to_mru(&p_fs->buf_cache_array[i], +- &p_fs->buf_cache_lru_list); +- } +- +- /* HASH list */ +- for (i = 0; i < FAT_CACHE_HASH_SIZE; i++) { +- p_fs->FAT_cache_hash_list[i].drv = -1; +- p_fs->FAT_cache_hash_list[i].sec = ~0; +- p_fs->FAT_cache_hash_list[i].hash_next = +- &p_fs->FAT_cache_hash_list[i]; +- p_fs->FAT_cache_hash_list[i].hash_prev = +- &p_fs->FAT_cache_hash_list[i]; +- } +- +- for (i = 0; i < FAT_CACHE_SIZE; i++) +- FAT_cache_insert_hash(sb, &p_fs->FAT_cache_array[i]); +- +- for (i = 0; i < BUF_CACHE_HASH_SIZE; i++) { +- p_fs->buf_cache_hash_list[i].drv = -1; +- p_fs->buf_cache_hash_list[i].sec = ~0; +- p_fs->buf_cache_hash_list[i].hash_next = +- &p_fs->buf_cache_hash_list[i]; +- p_fs->buf_cache_hash_list[i].hash_prev = +- &p_fs->buf_cache_hash_list[i]; +- } +- +- for (i = 0; i < BUF_CACHE_SIZE; i++) +- buf_cache_insert_hash(sb, &p_fs->buf_cache_array[i]); +-} +- +-void exfat_buf_shutdown(struct super_block *sb) +-{ +-} +- +-static int __exfat_fat_read(struct super_block *sb, u32 loc, u32 *content) +-{ +- s32 off; +- u32 _content; +- sector_t sec; +- u8 *fat_sector, *fat_entry; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- sec = p_fs->FAT1_start_sector + +- (loc >> (p_bd->sector_size_bits - 2)); +- off = (loc << 2) & p_bd->sector_size_mask; +- +- fat_sector = exfat_fat_getblk(sb, sec); +- if (!fat_sector) +- return -1; +- +- fat_entry = &fat_sector[off]; +- _content = GET32_A(fat_entry); +- +- if (_content >= CLUSTER_32(0xFFFFFFF8)) { +- *content = CLUSTER_32(~0); +- return 0; +- } +- *content = CLUSTER_32(_content); +- return 0; +-} +- +-/* in : sb, loc +- * out: content +- * returns 0 on success +- * -1 on error +- */ +-int exfat_fat_read(struct super_block *sb, u32 loc, u32 *content) +-{ +- s32 ret; +- +- mutex_lock(&f_mutex); +- ret = __exfat_fat_read(sb, loc, content); +- mutex_unlock(&f_mutex); +- +- return ret; +-} +- +-static s32 __exfat_fat_write(struct super_block *sb, u32 loc, u32 content) +-{ +- s32 off; +- sector_t sec; +- u8 *fat_sector, *fat_entry; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- sec = p_fs->FAT1_start_sector + (loc >> +- (p_bd->sector_size_bits - 2)); +- off = (loc << 2) & p_bd->sector_size_mask; +- +- fat_sector = exfat_fat_getblk(sb, sec); +- if (!fat_sector) +- return -1; +- +- fat_entry = &fat_sector[off]; +- +- SET32_A(fat_entry, content); +- +- exfat_fat_modify(sb, sec); +- return 0; +-} +- +-int exfat_fat_write(struct super_block *sb, u32 loc, u32 content) +-{ +- s32 ret; +- +- mutex_lock(&f_mutex); +- ret = __exfat_fat_write(sb, loc, content); +- mutex_unlock(&f_mutex); +- +- return ret; +-} +- +-u8 *exfat_fat_getblk(struct super_block *sb, sector_t sec) +-{ +- struct buf_cache_t *bp; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- bp = FAT_cache_find(sb, sec); +- if (bp) { +- move_to_mru(bp, &p_fs->FAT_cache_lru_list); +- return bp->buf_bh->b_data; +- } +- +- bp = FAT_cache_get(sb, sec); +- +- FAT_cache_remove_hash(bp); +- +- bp->drv = p_fs->drv; +- bp->sec = sec; +- bp->flag = 0; +- +- FAT_cache_insert_hash(sb, bp); +- +- if (sector_read(sb, sec, &bp->buf_bh, 1) != 0) { +- FAT_cache_remove_hash(bp); +- bp->drv = -1; +- bp->sec = ~0; +- bp->flag = 0; +- bp->buf_bh = NULL; +- +- move_to_lru(bp, &p_fs->FAT_cache_lru_list); +- return NULL; +- } +- +- return bp->buf_bh->b_data; +-} +- +-void exfat_fat_modify(struct super_block *sb, sector_t sec) +-{ +- struct buf_cache_t *bp; +- +- bp = FAT_cache_find(sb, sec); +- if (bp) +- sector_write(sb, sec, bp->buf_bh, 0); +-} +- +-void exfat_fat_release_all(struct super_block *sb) +-{ +- struct buf_cache_t *bp; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- mutex_lock(&f_mutex); +- +- bp = p_fs->FAT_cache_lru_list.next; +- while (bp != &p_fs->FAT_cache_lru_list) { +- if (bp->drv == p_fs->drv) { +- bp->drv = -1; +- bp->sec = ~0; +- bp->flag = 0; +- +- if (bp->buf_bh) { +- __brelse(bp->buf_bh); +- bp->buf_bh = NULL; +- } +- } +- bp = bp->next; +- } +- +- mutex_unlock(&f_mutex); +-} +- +-void exfat_fat_sync(struct super_block *sb) +-{ +- struct buf_cache_t *bp; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- mutex_lock(&f_mutex); +- +- bp = p_fs->FAT_cache_lru_list.next; +- while (bp != &p_fs->FAT_cache_lru_list) { +- if ((bp->drv == p_fs->drv) && (bp->flag & DIRTYBIT)) { +- sync_dirty_buffer(bp->buf_bh); +- bp->flag &= ~(DIRTYBIT); +- } +- bp = bp->next; +- } +- +- mutex_unlock(&f_mutex); +-} +- +-static struct buf_cache_t *buf_cache_find(struct super_block *sb, sector_t sec) +-{ +- s32 off; +- struct buf_cache_t *bp, *hp; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- off = (sec + (sec >> p_fs->sectors_per_clu_bits)) & +- (BUF_CACHE_HASH_SIZE - 1); +- +- hp = &p_fs->buf_cache_hash_list[off]; +- for (bp = hp->hash_next; bp != hp; bp = bp->hash_next) { +- if ((bp->drv == p_fs->drv) && (bp->sec == sec)) { +- touch_buffer(bp->buf_bh); +- return bp; +- } +- } +- return NULL; +-} +- +-static struct buf_cache_t *buf_cache_get(struct super_block *sb, sector_t sec) +-{ +- struct buf_cache_t *bp; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- bp = p_fs->buf_cache_lru_list.prev; +- while (bp->flag & LOCKBIT) +- bp = bp->prev; +- +- move_to_mru(bp, &p_fs->buf_cache_lru_list); +- return bp; +-} +- +-static u8 *__exfat_buf_getblk(struct super_block *sb, sector_t sec) +-{ +- struct buf_cache_t *bp; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- bp = buf_cache_find(sb, sec); +- if (bp) { +- move_to_mru(bp, &p_fs->buf_cache_lru_list); +- return bp->buf_bh->b_data; +- } +- +- bp = buf_cache_get(sb, sec); +- +- buf_cache_remove_hash(bp); +- +- bp->drv = p_fs->drv; +- bp->sec = sec; +- bp->flag = 0; +- +- buf_cache_insert_hash(sb, bp); +- +- if (sector_read(sb, sec, &bp->buf_bh, 1) != 0) { +- buf_cache_remove_hash(bp); +- bp->drv = -1; +- bp->sec = ~0; +- bp->flag = 0; +- bp->buf_bh = NULL; +- +- move_to_lru(bp, &p_fs->buf_cache_lru_list); +- return NULL; +- } +- +- return bp->buf_bh->b_data; +-} +- +-u8 *exfat_buf_getblk(struct super_block *sb, sector_t sec) +-{ +- u8 *buf; +- +- mutex_lock(&b_mutex); +- buf = __exfat_buf_getblk(sb, sec); +- mutex_unlock(&b_mutex); +- +- return buf; +-} +- +-void exfat_buf_modify(struct super_block *sb, sector_t sec) +-{ +- struct buf_cache_t *bp; +- +- mutex_lock(&b_mutex); +- +- bp = buf_cache_find(sb, sec); +- if (likely(bp)) +- sector_write(sb, sec, bp->buf_bh, 0); +- +- WARN(!bp, "[EXFAT] failed to find buffer_cache(sector:%llu).\n", +- (unsigned long long)sec); +- +- mutex_unlock(&b_mutex); +-} +- +-void exfat_buf_lock(struct super_block *sb, sector_t sec) +-{ +- struct buf_cache_t *bp; +- +- mutex_lock(&b_mutex); +- +- bp = buf_cache_find(sb, sec); +- if (likely(bp)) +- bp->flag |= LOCKBIT; +- +- WARN(!bp, "[EXFAT] failed to find buffer_cache(sector:%llu).\n", +- (unsigned long long)sec); +- +- mutex_unlock(&b_mutex); +-} +- +-void exfat_buf_unlock(struct super_block *sb, sector_t sec) +-{ +- struct buf_cache_t *bp; +- +- mutex_lock(&b_mutex); +- +- bp = buf_cache_find(sb, sec); +- if (likely(bp)) +- bp->flag &= ~(LOCKBIT); +- +- WARN(!bp, "[EXFAT] failed to find buffer_cache(sector:%llu).\n", +- (unsigned long long)sec); +- +- mutex_unlock(&b_mutex); +-} +- +-void exfat_buf_release(struct super_block *sb, sector_t sec) +-{ +- struct buf_cache_t *bp; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- mutex_lock(&b_mutex); +- +- bp = buf_cache_find(sb, sec); +- if (likely(bp)) { +- bp->drv = -1; +- bp->sec = ~0; +- bp->flag = 0; +- +- if (bp->buf_bh) { +- __brelse(bp->buf_bh); +- bp->buf_bh = NULL; +- } +- +- move_to_lru(bp, &p_fs->buf_cache_lru_list); +- } +- +- mutex_unlock(&b_mutex); +-} +- +-void exfat_buf_release_all(struct super_block *sb) +-{ +- struct buf_cache_t *bp; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- mutex_lock(&b_mutex); +- +- bp = p_fs->buf_cache_lru_list.next; +- while (bp != &p_fs->buf_cache_lru_list) { +- if (bp->drv == p_fs->drv) { +- bp->drv = -1; +- bp->sec = ~0; +- bp->flag = 0; +- +- if (bp->buf_bh) { +- __brelse(bp->buf_bh); +- bp->buf_bh = NULL; +- } +- } +- bp = bp->next; +- } +- +- mutex_unlock(&b_mutex); +-} +- +-void exfat_buf_sync(struct super_block *sb) +-{ +- struct buf_cache_t *bp; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- mutex_lock(&b_mutex); +- +- bp = p_fs->buf_cache_lru_list.next; +- while (bp != &p_fs->buf_cache_lru_list) { +- if ((bp->drv == p_fs->drv) && (bp->flag & DIRTYBIT)) { +- sync_dirty_buffer(bp->buf_bh); +- bp->flag &= ~(DIRTYBIT); +- } +- bp = bp->next; +- } +- +- mutex_unlock(&b_mutex); +-} +diff -Nurp linux-5.6.3.orig/drivers/staging/exfat/exfat_core.c linux-5.6.3/drivers/staging/exfat/exfat_core.c +--- linux-5.6.3.orig/drivers/staging/exfat/exfat_core.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/drivers/staging/exfat/exfat_core.c 1970-01-01 02:00:00.000000000 +0200 +@@ -1,2582 +0,0 @@ +-// SPDX-License-Identifier: GPL-2.0-or-later +-/* +- * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. +- */ +- +-#include +-#include +-#include +-#include +-#include +-#include +-#include "exfat.h" +- +-static void __set_sb_dirty(struct super_block *sb) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- +- sbi->s_dirt = 1; +-} +- +-static u8 name_buf[MAX_PATH_LENGTH * MAX_CHARSET_SIZE]; +- +-static u8 free_bit[] = { +- 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, /* 0 ~ 19 */ +- 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 5, 0, 1, 0, 2, 0, 1, 0, 3, /* 20 ~ 39 */ +- 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, /* 40 ~ 59 */ +- 0, 1, 0, 6, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, /* 60 ~ 79 */ +- 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 5, 0, 1, 0, 2, /* 80 ~ 99 */ +- 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, 0, 1, 0, 3, /* 100 ~ 119 */ +- 0, 1, 0, 2, 0, 1, 0, 7, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, /* 120 ~ 139 */ +- 0, 1, 0, 4, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 5, /* 140 ~ 159 */ +- 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, /* 160 ~ 179 */ +- 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 6, 0, 1, 0, 2, 0, 1, 0, 3, /* 180 ~ 199 */ +- 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, /* 200 ~ 219 */ +- 0, 1, 0, 5, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, /* 220 ~ 239 */ +- 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0 /* 240 ~ 254 */ +-}; +- +-static u8 used_bit[] = { +- 0, 1, 1, 2, 1, 2, 2, 3, 1, 2, 2, 3, 2, 3, 3, 4, 1, 2, 2, 3, /* 0 ~ 19 */ +- 2, 3, 3, 4, 2, 3, 3, 4, 3, 4, 4, 5, 1, 2, 2, 3, 2, 3, 3, 4, /* 20 ~ 39 */ +- 2, 3, 3, 4, 3, 4, 4, 5, 2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, /* 40 ~ 59 */ +- 4, 5, 5, 6, 1, 2, 2, 3, 2, 3, 3, 4, 2, 3, 3, 4, 3, 4, 4, 5, /* 60 ~ 79 */ +- 2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6, 2, 3, 3, 4, /* 80 ~ 99 */ +- 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6, 3, 4, 4, 5, 4, 5, 5, 6, /* 100 ~ 119 */ +- 4, 5, 5, 6, 5, 6, 6, 7, 1, 2, 2, 3, 2, 3, 3, 4, 2, 3, 3, 4, /* 120 ~ 139 */ +- 3, 4, 4, 5, 2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6, /* 140 ~ 159 */ +- 2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6, 3, 4, 4, 5, /* 160 ~ 179 */ +- 4, 5, 5, 6, 4, 5, 5, 6, 5, 6, 6, 7, 2, 3, 3, 4, 3, 4, 4, 5, /* 180 ~ 199 */ +- 3, 4, 4, 5, 4, 5, 5, 6, 3, 4, 4, 5, 4, 5, 5, 6, 4, 5, 5, 6, /* 200 ~ 219 */ +- 5, 6, 6, 7, 3, 4, 4, 5, 4, 5, 5, 6, 4, 5, 5, 6, 5, 6, 6, 7, /* 220 ~ 239 */ +- 4, 5, 5, 6, 5, 6, 6, 7, 5, 6, 6, 7, 6, 7, 7, 8 /* 240 ~ 255 */ +-}; +- +-#define BITMAP_LOC(v) ((v) >> 3) +-#define BITMAP_SHIFT(v) ((v) & 0x07) +- +-static inline s32 exfat_bitmap_test(u8 *bitmap, int i) +-{ +- u8 data; +- +- data = bitmap[BITMAP_LOC(i)]; +- if ((data >> BITMAP_SHIFT(i)) & 0x01) +- return 1; +- return 0; +-} +- +-static inline void exfat_bitmap_set(u8 *bitmap, int i) +-{ +- bitmap[BITMAP_LOC(i)] |= (0x01 << BITMAP_SHIFT(i)); +-} +- +-static inline void exfat_bitmap_clear(u8 *bitmap, int i) +-{ +- bitmap[BITMAP_LOC(i)] &= ~(0x01 << BITMAP_SHIFT(i)); +-} +- +-/* +- * File System Management Functions +- */ +- +-void fs_set_vol_flags(struct super_block *sb, u32 new_flag) +-{ +- struct pbr_sector_t *p_pbr; +- struct bpbex_t *p_bpb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- if (p_fs->vol_flag == new_flag) +- return; +- +- p_fs->vol_flag = new_flag; +- +- if (!p_fs->pbr_bh) { +- if (sector_read(sb, p_fs->PBR_sector, +- &p_fs->pbr_bh, 1) != 0) +- return; +- } +- +- p_pbr = (struct pbr_sector_t *)p_fs->pbr_bh->b_data; +- p_bpb = (struct bpbex_t *)p_pbr->bpb; +- SET16(p_bpb->vol_flags, (u16)new_flag); +- +- /* XXX duyoung +- * what can we do here? (cuz fs_set_vol_flags() is void) +- */ +- if ((new_flag == VOL_DIRTY) && (!buffer_dirty(p_fs->pbr_bh))) +- sector_write(sb, p_fs->PBR_sector, p_fs->pbr_bh, 1); +- else +- sector_write(sb, p_fs->PBR_sector, p_fs->pbr_bh, 0); +-} +- +-void fs_error(struct super_block *sb) +-{ +- struct exfat_mount_options *opts = &EXFAT_SB(sb)->options; +- +- if (opts->errors == EXFAT_ERRORS_PANIC) { +- panic("[EXFAT] Filesystem panic from previous error\n"); +- } else if ((opts->errors == EXFAT_ERRORS_RO) && !sb_rdonly(sb)) { +- sb->s_flags |= SB_RDONLY; +- pr_err("[EXFAT] Filesystem has been set read-only\n"); +- } +-} +- +-/* +- * Cluster Management Functions +- */ +- +-static s32 clear_cluster(struct super_block *sb, u32 clu) +-{ +- sector_t s, n; +- s32 ret = 0; +- struct buffer_head *tmp_bh = NULL; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- if (clu == CLUSTER_32(0)) { /* FAT16 root_dir */ +- s = p_fs->root_start_sector; +- n = p_fs->data_start_sector; +- } else { +- s = START_SECTOR(clu); +- n = s + p_fs->sectors_per_clu; +- } +- +- for (; s < n; s++) { +- ret = sector_read(sb, s, &tmp_bh, 0); +- if (ret != 0) +- return ret; +- +- memset((char *)tmp_bh->b_data, 0x0, p_bd->sector_size); +- ret = sector_write(sb, s, tmp_bh, 0); +- if (ret != 0) +- break; +- } +- +- brelse(tmp_bh); +- return ret; +-} +- +-static s32 set_alloc_bitmap(struct super_block *sb, u32 clu) +-{ +- int i, b; +- sector_t sector; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- i = clu >> (p_bd->sector_size_bits + 3); +- b = clu & ((p_bd->sector_size << 3) - 1); +- +- sector = START_SECTOR(p_fs->map_clu) + i; +- +- exfat_bitmap_set((u8 *)p_fs->vol_amap[i]->b_data, b); +- +- return sector_write(sb, sector, p_fs->vol_amap[i], 0); +-} +- +-static s32 clr_alloc_bitmap(struct super_block *sb, u32 clu) +-{ +- int i, b; +- sector_t sector; +-#ifdef CONFIG_STAGING_EXFAT_DISCARD +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- struct exfat_mount_options *opts = &sbi->options; +- int ret; +-#endif /* CONFIG_STAGING_EXFAT_DISCARD */ +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- i = clu >> (p_bd->sector_size_bits + 3); +- b = clu & ((p_bd->sector_size << 3) - 1); +- +- sector = START_SECTOR(p_fs->map_clu) + i; +- +- exfat_bitmap_clear((u8 *)p_fs->vol_amap[i]->b_data, b); +- +-#ifdef CONFIG_STAGING_EXFAT_DISCARD +- if (opts->discard) { +- ret = sb_issue_discard(sb, START_SECTOR(clu), +- (1 << p_fs->sectors_per_clu_bits), +- GFP_NOFS, 0); +- if (ret == -EOPNOTSUPP) { +- pr_warn("discard not supported by device, disabling"); +- opts->discard = 0; +- } else { +- return ret; +- } +- } +-#endif /* CONFIG_STAGING_EXFAT_DISCARD */ +- +- return sector_write(sb, sector, p_fs->vol_amap[i], 0); +-} +- +-static u32 test_alloc_bitmap(struct super_block *sb, u32 clu) +-{ +- int i, map_i, map_b; +- u32 clu_base, clu_free; +- u8 k, clu_mask; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- clu_base = (clu & ~(0x7)) + 2; +- clu_mask = (1 << (clu - clu_base + 2)) - 1; +- +- map_i = clu >> (p_bd->sector_size_bits + 3); +- map_b = (clu >> 3) & p_bd->sector_size_mask; +- +- for (i = 2; i < p_fs->num_clusters; i += 8) { +- k = *(((u8 *)p_fs->vol_amap[map_i]->b_data) + map_b); +- if (clu_mask > 0) { +- k |= clu_mask; +- clu_mask = 0; +- } +- if (k < 0xFF) { +- clu_free = clu_base + free_bit[k]; +- if (clu_free < p_fs->num_clusters) +- return clu_free; +- } +- clu_base += 8; +- +- if (((++map_b) >= p_bd->sector_size) || +- (clu_base >= p_fs->num_clusters)) { +- if ((++map_i) >= p_fs->map_sectors) { +- clu_base = 2; +- map_i = 0; +- } +- map_b = 0; +- } +- } +- +- return CLUSTER_32(~0); +-} +- +-s32 exfat_alloc_cluster(struct super_block *sb, s32 num_alloc, +- struct chain_t *p_chain) +-{ +- s32 num_clusters = 0; +- u32 hint_clu, new_clu, last_clu = CLUSTER_32(~0); +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- hint_clu = p_chain->dir; +- if (hint_clu == CLUSTER_32(~0)) { +- hint_clu = test_alloc_bitmap(sb, p_fs->clu_srch_ptr - 2); +- if (hint_clu == CLUSTER_32(~0)) +- return 0; +- } else if (hint_clu >= p_fs->num_clusters) { +- hint_clu = 2; +- p_chain->flags = 0x01; +- } +- +- __set_sb_dirty(sb); +- +- p_chain->dir = CLUSTER_32(~0); +- +- while ((new_clu = test_alloc_bitmap(sb, hint_clu - 2)) != CLUSTER_32(~0)) { +- if (new_clu != hint_clu) { +- if (p_chain->flags == 0x03) { +- exfat_chain_cont_cluster(sb, p_chain->dir, +- num_clusters); +- p_chain->flags = 0x01; +- } +- } +- +- if (set_alloc_bitmap(sb, new_clu - 2) != 0) +- return -EIO; +- +- num_clusters++; +- +- if (p_chain->flags == 0x01) { +- if (exfat_fat_write(sb, new_clu, CLUSTER_32(~0)) < 0) +- return -EIO; +- } +- +- if (p_chain->dir == CLUSTER_32(~0)) { +- p_chain->dir = new_clu; +- } else { +- if (p_chain->flags == 0x01) { +- if (exfat_fat_write(sb, last_clu, new_clu) < 0) +- return -EIO; +- } +- } +- last_clu = new_clu; +- +- if ((--num_alloc) == 0) { +- p_fs->clu_srch_ptr = hint_clu; +- if (p_fs->used_clusters != UINT_MAX) +- p_fs->used_clusters += num_clusters; +- +- p_chain->size += num_clusters; +- return num_clusters; +- } +- +- hint_clu = new_clu + 1; +- if (hint_clu >= p_fs->num_clusters) { +- hint_clu = 2; +- +- if (p_chain->flags == 0x03) { +- exfat_chain_cont_cluster(sb, p_chain->dir, +- num_clusters); +- p_chain->flags = 0x01; +- } +- } +- } +- +- p_fs->clu_srch_ptr = hint_clu; +- if (p_fs->used_clusters != UINT_MAX) +- p_fs->used_clusters += num_clusters; +- +- p_chain->size += num_clusters; +- return num_clusters; +-} +- +-void exfat_free_cluster(struct super_block *sb, struct chain_t *p_chain, +- s32 do_relse) +-{ +- s32 num_clusters = 0; +- u32 clu; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- int i; +- sector_t sector; +- +- if ((p_chain->dir == CLUSTER_32(0)) || (p_chain->dir == CLUSTER_32(~0))) +- return; +- +- if (p_chain->size <= 0) { +- pr_err("[EXFAT] free_cluster : skip free-req clu:%u, because of zero-size truncation\n", +- p_chain->dir); +- return; +- } +- +- __set_sb_dirty(sb); +- clu = p_chain->dir; +- +- if (p_chain->flags == 0x03) { +- do { +- if (do_relse) { +- sector = START_SECTOR(clu); +- for (i = 0; i < p_fs->sectors_per_clu; i++) +- exfat_buf_release(sb, sector + i); +- } +- +- if (clr_alloc_bitmap(sb, clu - 2) != 0) +- break; +- clu++; +- +- num_clusters++; +- } while (num_clusters < p_chain->size); +- } else { +- do { +- if (p_fs->dev_ejected) +- break; +- +- if (do_relse) { +- sector = START_SECTOR(clu); +- for (i = 0; i < p_fs->sectors_per_clu; i++) +- exfat_buf_release(sb, sector + i); +- } +- +- if (clr_alloc_bitmap(sb, clu - 2) != 0) +- break; +- +- if (exfat_fat_read(sb, clu, &clu) == -1) +- break; +- num_clusters++; +- } while ((clu != CLUSTER_32(0)) && (clu != CLUSTER_32(~0))); +- } +- +- if (p_fs->used_clusters != UINT_MAX) +- p_fs->used_clusters -= num_clusters; +-} +- +-static u32 find_last_cluster(struct super_block *sb, struct chain_t *p_chain) +-{ +- u32 clu, next; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- clu = p_chain->dir; +- +- if (p_chain->flags == 0x03) { +- clu += p_chain->size - 1; +- } else { +- while ((exfat_fat_read(sb, clu, &next) == 0) && +- (next != CLUSTER_32(~0))) { +- if (p_fs->dev_ejected) +- break; +- clu = next; +- } +- } +- +- return clu; +-} +- +-s32 count_num_clusters(struct super_block *sb, struct chain_t *p_chain) +-{ +- int i, count = 0; +- u32 clu; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- if ((p_chain->dir == CLUSTER_32(0)) || (p_chain->dir == CLUSTER_32(~0))) +- return 0; +- +- clu = p_chain->dir; +- +- if (p_chain->flags == 0x03) { +- count = p_chain->size; +- } else { +- for (i = 2; i < p_fs->num_clusters; i++) { +- count++; +- if (exfat_fat_read(sb, clu, &clu) != 0) +- return 0; +- if (clu == CLUSTER_32(~0)) +- break; +- } +- } +- +- return count; +-} +- +-s32 exfat_count_used_clusters(struct super_block *sb) +-{ +- int i, map_i, map_b, count = 0; +- u8 k; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- map_i = 0; +- map_b = 0; +- +- for (i = 2; i < p_fs->num_clusters; i += 8) { +- k = *(((u8 *)p_fs->vol_amap[map_i]->b_data) + map_b); +- count += used_bit[k]; +- +- if ((++map_b) >= p_bd->sector_size) { +- map_i++; +- map_b = 0; +- } +- } +- +- return count; +-} +- +-void exfat_chain_cont_cluster(struct super_block *sb, u32 chain, s32 len) +-{ +- if (len == 0) +- return; +- +- while (len > 1) { +- if (exfat_fat_write(sb, chain, chain + 1) < 0) +- break; +- chain++; +- len--; +- } +- exfat_fat_write(sb, chain, CLUSTER_32(~0)); +-} +- +-/* +- * Allocation Bitmap Management Functions +- */ +- +-s32 load_alloc_bitmap(struct super_block *sb) +-{ +- int i, j, ret; +- u32 map_size; +- u32 type; +- sector_t sector; +- struct chain_t clu; +- struct bmap_dentry_t *ep; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- clu.dir = p_fs->root_dir; +- clu.flags = 0x01; +- +- while (clu.dir != CLUSTER_32(~0)) { +- if (p_fs->dev_ejected) +- break; +- +- for (i = 0; i < p_fs->dentries_per_clu; i++) { +- ep = (struct bmap_dentry_t *)get_entry_in_dir(sb, &clu, +- i, NULL); +- if (!ep) +- return -ENOENT; +- +- type = exfat_get_entry_type((struct dentry_t *)ep); +- +- if (type == TYPE_UNUSED) +- break; +- if (type != TYPE_BITMAP) +- continue; +- +- if (ep->flags == 0x0) { +- p_fs->map_clu = GET32_A(ep->start_clu); +- map_size = (u32)GET64_A(ep->size); +- +- p_fs->map_sectors = ((map_size - 1) >> p_bd->sector_size_bits) + 1; +- +- p_fs->vol_amap = kmalloc_array(p_fs->map_sectors, +- sizeof(struct buffer_head *), +- GFP_KERNEL); +- if (!p_fs->vol_amap) +- return -ENOMEM; +- +- sector = START_SECTOR(p_fs->map_clu); +- +- for (j = 0; j < p_fs->map_sectors; j++) { +- p_fs->vol_amap[j] = NULL; +- ret = sector_read(sb, sector + j, &p_fs->vol_amap[j], 1); +- if (ret != 0) { +- /* release all buffers and free vol_amap */ +- i = 0; +- while (i < j) +- brelse(p_fs->vol_amap[i++]); +- +- kfree(p_fs->vol_amap); +- p_fs->vol_amap = NULL; +- return ret; +- } +- } +- +- p_fs->pbr_bh = NULL; +- return 0; +- } +- } +- +- if (exfat_fat_read(sb, clu.dir, &clu.dir) != 0) +- return -EIO; +- } +- +- return -EFSCORRUPTED; +-} +- +-void free_alloc_bitmap(struct super_block *sb) +-{ +- int i; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- brelse(p_fs->pbr_bh); +- +- for (i = 0; i < p_fs->map_sectors; i++) +- __brelse(p_fs->vol_amap[i]); +- +- kfree(p_fs->vol_amap); +- p_fs->vol_amap = NULL; +-} +- +-void sync_alloc_bitmap(struct super_block *sb) +-{ +- int i; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- if (!p_fs->vol_amap) +- return; +- +- for (i = 0; i < p_fs->map_sectors; i++) +- sync_dirty_buffer(p_fs->vol_amap[i]); +-} +- +-/* +- * Upcase table Management Functions +- */ +-static s32 __load_upcase_table(struct super_block *sb, sector_t sector, +- u32 num_sectors, u32 utbl_checksum) +-{ +- int i, ret = -EINVAL; +- u32 j; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- struct buffer_head *tmp_bh = NULL; +- sector_t end_sector = num_sectors + sector; +- +- bool skip = false; +- u32 index = 0; +- u16 uni = 0; +- u16 **upcase_table; +- +- u32 checksum = 0; +- +- upcase_table = kmalloc_array(UTBL_COL_COUNT, sizeof(u16 *), GFP_KERNEL); +- p_fs->vol_utbl = upcase_table; +- if (!upcase_table) +- return -ENOMEM; +- memset(upcase_table, 0, UTBL_COL_COUNT * sizeof(u16 *)); +- +- while (sector < end_sector) { +- ret = sector_read(sb, sector, &tmp_bh, 1); +- if (ret != 0) { +- pr_debug("sector read (0x%llX)fail\n", +- (unsigned long long)sector); +- goto error; +- } +- sector++; +- +- for (i = 0; i < p_bd->sector_size && index <= 0xFFFF; i += 2) { +- uni = GET16(((u8 *)tmp_bh->b_data) + i); +- +- checksum = ((checksum & 1) ? 0x80000000 : 0) + +- (checksum >> 1) + *(((u8 *)tmp_bh->b_data) + +- i); +- checksum = ((checksum & 1) ? 0x80000000 : 0) + +- (checksum >> 1) + *(((u8 *)tmp_bh->b_data) + +- (i + 1)); +- +- if (skip) { +- pr_debug("skip from 0x%X ", index); +- index += uni; +- pr_debug("to 0x%X (amount of 0x%X)\n", +- index, uni); +- skip = false; +- } else if (uni == index) { +- index++; +- } else if (uni == 0xFFFF) { +- skip = true; +- } else { /* uni != index , uni != 0xFFFF */ +- u16 col_index = get_col_index(index); +- +- if (!upcase_table[col_index]) { +- pr_debug("alloc = 0x%X\n", col_index); +- upcase_table[col_index] = kmalloc_array(UTBL_ROW_COUNT, +- sizeof(u16), GFP_KERNEL); +- if (!upcase_table[col_index]) { +- ret = -ENOMEM; +- goto error; +- } +- +- for (j = 0; j < UTBL_ROW_COUNT; j++) +- upcase_table[col_index][j] = (col_index << LOW_INDEX_BIT) | j; +- } +- +- upcase_table[col_index][get_row_index(index)] = uni; +- index++; +- } +- } +- } +- if (index >= 0xFFFF && utbl_checksum == checksum) { +- if (tmp_bh) +- brelse(tmp_bh); +- return 0; +- } +- ret = -EINVAL; +-error: +- if (tmp_bh) +- brelse(tmp_bh); +- free_upcase_table(sb); +- return ret; +-} +- +-static s32 __load_default_upcase_table(struct super_block *sb) +-{ +- int i, ret = -EINVAL; +- u32 j; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- bool skip = false; +- u32 index = 0; +- u16 uni = 0; +- u16 **upcase_table; +- +- upcase_table = kmalloc_array(UTBL_COL_COUNT, sizeof(u16 *), GFP_KERNEL); +- p_fs->vol_utbl = upcase_table; +- if (!upcase_table) +- return -ENOMEM; +- memset(upcase_table, 0, UTBL_COL_COUNT * sizeof(u16 *)); +- +- for (i = 0; index <= 0xFFFF && i < NUM_UPCASE * 2; i += 2) { +- uni = GET16(uni_upcase + i); +- if (skip) { +- pr_debug("skip from 0x%X ", index); +- index += uni; +- pr_debug("to 0x%X (amount of 0x%X)\n", index, uni); +- skip = false; +- } else if (uni == index) { +- index++; +- } else if (uni == 0xFFFF) { +- skip = true; +- } else { /* uni != index , uni != 0xFFFF */ +- u16 col_index = get_col_index(index); +- +- if (!upcase_table[col_index]) { +- pr_debug("alloc = 0x%X\n", col_index); +- upcase_table[col_index] = kmalloc_array(UTBL_ROW_COUNT, +- sizeof(u16), +- GFP_KERNEL); +- if (!upcase_table[col_index]) { +- ret = -ENOMEM; +- goto error; +- } +- +- for (j = 0; j < UTBL_ROW_COUNT; j++) +- upcase_table[col_index][j] = (col_index << LOW_INDEX_BIT) | j; +- } +- +- upcase_table[col_index][get_row_index(index)] = uni; +- index++; +- } +- } +- +- if (index >= 0xFFFF) +- return 0; +- +-error: +- /* FATAL error: default upcase table has error */ +- free_upcase_table(sb); +- return ret; +-} +- +-s32 load_upcase_table(struct super_block *sb) +-{ +- int i; +- u32 tbl_clu, tbl_size; +- sector_t sector; +- u32 type, num_sectors; +- struct chain_t clu; +- struct case_dentry_t *ep; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- clu.dir = p_fs->root_dir; +- clu.flags = 0x01; +- +- if (p_fs->dev_ejected) +- return -EIO; +- +- while (clu.dir != CLUSTER_32(~0)) { +- for (i = 0; i < p_fs->dentries_per_clu; i++) { +- ep = (struct case_dentry_t *)get_entry_in_dir(sb, &clu, +- i, NULL); +- if (!ep) +- return -ENOENT; +- +- type = exfat_get_entry_type((struct dentry_t *)ep); +- +- if (type == TYPE_UNUSED) +- break; +- if (type != TYPE_UPCASE) +- continue; +- +- tbl_clu = GET32_A(ep->start_clu); +- tbl_size = (u32)GET64_A(ep->size); +- +- sector = START_SECTOR(tbl_clu); +- num_sectors = ((tbl_size - 1) >> p_bd->sector_size_bits) + 1; +- if (__load_upcase_table(sb, sector, num_sectors, +- GET32_A(ep->checksum)) != 0) +- break; +- return 0; +- } +- if (exfat_fat_read(sb, clu.dir, &clu.dir) != 0) +- return -EIO; +- } +- /* load default upcase table */ +- return __load_default_upcase_table(sb); +-} +- +-void free_upcase_table(struct super_block *sb) +-{ +- u32 i; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- u16 **upcase_table; +- +- upcase_table = p_fs->vol_utbl; +- for (i = 0; i < UTBL_COL_COUNT; i++) +- kfree(upcase_table[i]); +- +- kfree(p_fs->vol_utbl); +- p_fs->vol_utbl = NULL; +-} +- +-/* +- * Directory Entry Management Functions +- */ +- +-u32 exfat_get_entry_type(struct dentry_t *p_entry) +-{ +- struct file_dentry_t *ep = (struct file_dentry_t *)p_entry; +- +- if (ep->type == 0x0) { +- return TYPE_UNUSED; +- } else if (ep->type < 0x80) { +- return TYPE_DELETED; +- } else if (ep->type == 0x80) { +- return TYPE_INVALID; +- } else if (ep->type < 0xA0) { +- if (ep->type == 0x81) { +- return TYPE_BITMAP; +- } else if (ep->type == 0x82) { +- return TYPE_UPCASE; +- } else if (ep->type == 0x83) { +- return TYPE_VOLUME; +- } else if (ep->type == 0x85) { +- if (GET16_A(ep->attr) & ATTR_SUBDIR) +- return TYPE_DIR; +- else +- return TYPE_FILE; +- } +- return TYPE_CRITICAL_PRI; +- } else if (ep->type < 0xC0) { +- if (ep->type == 0xA0) +- return TYPE_GUID; +- else if (ep->type == 0xA1) +- return TYPE_PADDING; +- else if (ep->type == 0xA2) +- return TYPE_ACLTAB; +- return TYPE_BENIGN_PRI; +- } else if (ep->type < 0xE0) { +- if (ep->type == 0xC0) +- return TYPE_STREAM; +- else if (ep->type == 0xC1) +- return TYPE_EXTEND; +- else if (ep->type == 0xC2) +- return TYPE_ACL; +- return TYPE_CRITICAL_SEC; +- } +- +- return TYPE_BENIGN_SEC; +-} +- +-static void exfat_set_entry_type(struct dentry_t *p_entry, u32 type) +-{ +- struct file_dentry_t *ep = (struct file_dentry_t *)p_entry; +- +- if (type == TYPE_UNUSED) { +- ep->type = 0x0; +- } else if (type == TYPE_DELETED) { +- ep->type &= ~0x80; +- } else if (type == TYPE_STREAM) { +- ep->type = 0xC0; +- } else if (type == TYPE_EXTEND) { +- ep->type = 0xC1; +- } else if (type == TYPE_BITMAP) { +- ep->type = 0x81; +- } else if (type == TYPE_UPCASE) { +- ep->type = 0x82; +- } else if (type == TYPE_VOLUME) { +- ep->type = 0x83; +- } else if (type == TYPE_DIR) { +- ep->type = 0x85; +- SET16_A(ep->attr, ATTR_SUBDIR); +- } else if (type == TYPE_FILE) { +- ep->type = 0x85; +- SET16_A(ep->attr, ATTR_ARCHIVE); +- } else if (type == TYPE_SYMLINK) { +- ep->type = 0x85; +- SET16_A(ep->attr, ATTR_ARCHIVE | ATTR_SYMLINK); +- } +-} +- +-u32 exfat_get_entry_attr(struct dentry_t *p_entry) +-{ +- struct file_dentry_t *ep = (struct file_dentry_t *)p_entry; +- +- return (u32)GET16_A(ep->attr); +-} +- +-void exfat_set_entry_attr(struct dentry_t *p_entry, u32 attr) +-{ +- struct file_dentry_t *ep = (struct file_dentry_t *)p_entry; +- +- SET16_A(ep->attr, (u16)attr); +-} +- +-u8 exfat_get_entry_flag(struct dentry_t *p_entry) +-{ +- struct strm_dentry_t *ep = (struct strm_dentry_t *)p_entry; +- +- return ep->flags; +-} +- +-void exfat_set_entry_flag(struct dentry_t *p_entry, u8 flags) +-{ +- struct strm_dentry_t *ep = (struct strm_dentry_t *)p_entry; +- +- ep->flags = flags; +-} +- +-u32 exfat_get_entry_clu0(struct dentry_t *p_entry) +-{ +- struct strm_dentry_t *ep = (struct strm_dentry_t *)p_entry; +- +- return GET32_A(ep->start_clu); +-} +- +-void exfat_set_entry_clu0(struct dentry_t *p_entry, u32 start_clu) +-{ +- struct strm_dentry_t *ep = (struct strm_dentry_t *)p_entry; +- +- SET32_A(ep->start_clu, start_clu); +-} +- +-u64 exfat_get_entry_size(struct dentry_t *p_entry) +-{ +- struct strm_dentry_t *ep = (struct strm_dentry_t *)p_entry; +- +- return GET64_A(ep->valid_size); +-} +- +-void exfat_set_entry_size(struct dentry_t *p_entry, u64 size) +-{ +- struct strm_dentry_t *ep = (struct strm_dentry_t *)p_entry; +- +- SET64_A(ep->valid_size, size); +- SET64_A(ep->size, size); +-} +- +-void exfat_get_entry_time(struct dentry_t *p_entry, struct timestamp_t *tp, +- u8 mode) +-{ +- u16 t = 0x00, d = 0x21; +- struct file_dentry_t *ep = (struct file_dentry_t *)p_entry; +- +- switch (mode) { +- case TM_CREATE: +- t = GET16_A(ep->create_time); +- d = GET16_A(ep->create_date); +- break; +- case TM_MODIFY: +- t = GET16_A(ep->modify_time); +- d = GET16_A(ep->modify_date); +- break; +- case TM_ACCESS: +- t = GET16_A(ep->access_time); +- d = GET16_A(ep->access_date); +- break; +- } +- +- tp->sec = (t & 0x001F) << 1; +- tp->min = (t >> 5) & 0x003F; +- tp->hour = (t >> 11); +- tp->day = (d & 0x001F); +- tp->mon = (d >> 5) & 0x000F; +- tp->year = (d >> 9); +-} +- +-void exfat_set_entry_time(struct dentry_t *p_entry, struct timestamp_t *tp, +- u8 mode) +-{ +- u16 t, d; +- struct file_dentry_t *ep = (struct file_dentry_t *)p_entry; +- +- t = (tp->hour << 11) | (tp->min << 5) | (tp->sec >> 1); +- d = (tp->year << 9) | (tp->mon << 5) | tp->day; +- +- switch (mode) { +- case TM_CREATE: +- SET16_A(ep->create_time, t); +- SET16_A(ep->create_date, d); +- break; +- case TM_MODIFY: +- SET16_A(ep->modify_time, t); +- SET16_A(ep->modify_date, d); +- break; +- case TM_ACCESS: +- SET16_A(ep->access_time, t); +- SET16_A(ep->access_date, d); +- break; +- } +-} +- +-static void init_file_entry(struct file_dentry_t *ep, u32 type) +-{ +- struct timestamp_t tm, *tp; +- +- exfat_set_entry_type((struct dentry_t *)ep, type); +- +- tp = tm_current(&tm); +- exfat_set_entry_time((struct dentry_t *)ep, tp, TM_CREATE); +- exfat_set_entry_time((struct dentry_t *)ep, tp, TM_MODIFY); +- exfat_set_entry_time((struct dentry_t *)ep, tp, TM_ACCESS); +- ep->create_time_ms = 0; +- ep->modify_time_ms = 0; +- ep->access_time_ms = 0; +-} +- +-static void init_strm_entry(struct strm_dentry_t *ep, u8 flags, u32 start_clu, u64 size) +-{ +- exfat_set_entry_type((struct dentry_t *)ep, TYPE_STREAM); +- ep->flags = flags; +- SET32_A(ep->start_clu, start_clu); +- SET64_A(ep->valid_size, size); +- SET64_A(ep->size, size); +-} +- +-static void init_name_entry(struct name_dentry_t *ep, u16 *uniname) +-{ +- int i; +- +- exfat_set_entry_type((struct dentry_t *)ep, TYPE_EXTEND); +- ep->flags = 0x0; +- +- for (i = 0; i < 30; i++, i++) { +- SET16_A(ep->unicode_0_14 + i, *uniname); +- if (*uniname == 0x0) +- break; +- uniname++; +- } +-} +- +-static s32 exfat_init_dir_entry(struct super_block *sb, struct chain_t *p_dir, +- s32 entry, u32 type, u32 start_clu, u64 size) +-{ +- sector_t sector; +- u8 flags; +- struct file_dentry_t *file_ep; +- struct strm_dentry_t *strm_ep; +- +- flags = (type == TYPE_FILE) ? 0x01 : 0x03; +- +- /* we cannot use get_entry_set_in_dir here because file ep is not initialized yet */ +- file_ep = (struct file_dentry_t *)get_entry_in_dir(sb, p_dir, entry, +- §or); +- if (!file_ep) +- return -ENOENT; +- +- strm_ep = (struct strm_dentry_t *)get_entry_in_dir(sb, p_dir, entry + 1, +- §or); +- if (!strm_ep) +- return -ENOENT; +- +- init_file_entry(file_ep, type); +- exfat_buf_modify(sb, sector); +- +- init_strm_entry(strm_ep, flags, start_clu, size); +- exfat_buf_modify(sb, sector); +- +- return 0; +-} +- +-static s32 exfat_init_ext_entry(struct super_block *sb, struct chain_t *p_dir, +- s32 entry, s32 num_entries, +- struct uni_name_t *p_uniname, +- struct dos_name_t *p_dosname) +-{ +- int i; +- sector_t sector; +- u16 *uniname = p_uniname->name; +- struct file_dentry_t *file_ep; +- struct strm_dentry_t *strm_ep; +- struct name_dentry_t *name_ep; +- +- file_ep = (struct file_dentry_t *)get_entry_in_dir(sb, p_dir, entry, +- §or); +- if (!file_ep) +- return -ENOENT; +- +- file_ep->num_ext = (u8)(num_entries - 1); +- exfat_buf_modify(sb, sector); +- +- strm_ep = (struct strm_dentry_t *)get_entry_in_dir(sb, p_dir, entry + 1, +- §or); +- if (!strm_ep) +- return -ENOENT; +- +- strm_ep->name_len = p_uniname->name_len; +- SET16_A(strm_ep->name_hash, p_uniname->name_hash); +- exfat_buf_modify(sb, sector); +- +- for (i = 2; i < num_entries; i++) { +- name_ep = (struct name_dentry_t *)get_entry_in_dir(sb, p_dir, +- entry + i, +- §or); +- if (!name_ep) +- return -ENOENT; +- +- init_name_entry(name_ep, uniname); +- exfat_buf_modify(sb, sector); +- uniname += 15; +- } +- +- update_dir_checksum(sb, p_dir, entry); +- +- return 0; +-} +- +-void exfat_delete_dir_entry(struct super_block *sb, struct chain_t *p_dir, +- s32 entry, s32 order, s32 num_entries) +-{ +- int i; +- sector_t sector; +- struct dentry_t *ep; +- +- for (i = order; i < num_entries; i++) { +- ep = get_entry_in_dir(sb, p_dir, entry + i, §or); +- if (!ep) +- return; +- +- exfat_set_entry_type(ep, TYPE_DELETED); +- exfat_buf_modify(sb, sector); +- } +-} +- +-void update_dir_checksum(struct super_block *sb, struct chain_t *p_dir, +- s32 entry) +-{ +- int i, num_entries; +- sector_t sector; +- u16 chksum; +- struct file_dentry_t *file_ep; +- struct dentry_t *ep; +- +- file_ep = (struct file_dentry_t *)get_entry_in_dir(sb, p_dir, entry, +- §or); +- if (!file_ep) +- return; +- +- exfat_buf_lock(sb, sector); +- +- num_entries = (s32)file_ep->num_ext + 1; +- chksum = calc_checksum_2byte((void *)file_ep, DENTRY_SIZE, 0, +- CS_DIR_ENTRY); +- +- for (i = 1; i < num_entries; i++) { +- ep = get_entry_in_dir(sb, p_dir, entry + i, NULL); +- if (!ep) { +- exfat_buf_unlock(sb, sector); +- return; +- } +- +- chksum = calc_checksum_2byte((void *)ep, DENTRY_SIZE, chksum, +- CS_DEFAULT); +- } +- +- SET16_A(file_ep->checksum, chksum); +- exfat_buf_modify(sb, sector); +- exfat_buf_unlock(sb, sector); +-} +- +-static s32 __write_partial_entries_in_entry_set(struct super_block *sb, +- struct entry_set_cache_t *es, +- sector_t sec, s32 off, u32 count) +-{ +- s32 num_entries, buf_off = (off - es->offset); +- u32 remaining_byte_in_sector, copy_entries; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- u32 clu; +- u8 *buf, *esbuf = (u8 *)&es->__buf; +- +- pr_debug("%s entered es %p sec %llu off %d count %d\n", +- __func__, es, (unsigned long long)sec, off, count); +- num_entries = count; +- +- while (num_entries) { +- /* white per sector base */ +- remaining_byte_in_sector = (1 << p_bd->sector_size_bits) - off; +- copy_entries = min_t(s32, +- remaining_byte_in_sector >> DENTRY_SIZE_BITS, +- num_entries); +- buf = exfat_buf_getblk(sb, sec); +- if (!buf) +- goto err_out; +- pr_debug("es->buf %p buf_off %u\n", esbuf, buf_off); +- pr_debug("copying %d entries from %p to sector %llu\n", +- copy_entries, (esbuf + buf_off), +- (unsigned long long)sec); +- memcpy(buf + off, esbuf + buf_off, +- copy_entries << DENTRY_SIZE_BITS); +- exfat_buf_modify(sb, sec); +- num_entries -= copy_entries; +- +- if (num_entries) { +- /* get next sector */ +- if (IS_LAST_SECTOR_IN_CLUSTER(sec)) { +- clu = GET_CLUSTER_FROM_SECTOR(sec); +- if (es->alloc_flag == 0x03) { +- clu++; +- } else { +- if (exfat_fat_read(sb, clu, &clu) == -1) +- goto err_out; +- } +- sec = START_SECTOR(clu); +- } else { +- sec++; +- } +- off = 0; +- buf_off += copy_entries << DENTRY_SIZE_BITS; +- } +- } +- +- pr_debug("%s exited successfully\n", __func__); +- return 0; +-err_out: +- pr_debug("%s failed\n", __func__); +- return -EINVAL; +-} +- +-/* write back all entries in entry set */ +-static s32 write_whole_entry_set(struct super_block *sb, struct entry_set_cache_t *es) +-{ +- return __write_partial_entries_in_entry_set(sb, es, es->sector, +- es->offset, +- es->num_entries); +-} +- +-void update_dir_checksum_with_entry_set(struct super_block *sb, +- struct entry_set_cache_t *es) +-{ +- struct dentry_t *ep; +- u16 chksum = 0; +- s32 chksum_type = CS_DIR_ENTRY, i; +- +- ep = (struct dentry_t *)&es->__buf; +- for (i = 0; i < es->num_entries; i++) { +- pr_debug("%s ep %p\n", __func__, ep); +- chksum = calc_checksum_2byte((void *)ep, DENTRY_SIZE, chksum, +- chksum_type); +- ep++; +- chksum_type = CS_DEFAULT; +- } +- +- ep = (struct dentry_t *)&es->__buf; +- SET16_A(((struct file_dentry_t *)ep)->checksum, chksum); +- write_whole_entry_set(sb, es); +-} +- +-static s32 _walk_fat_chain(struct super_block *sb, struct chain_t *p_dir, +- s32 byte_offset, u32 *clu) +-{ +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- s32 clu_offset; +- u32 cur_clu; +- +- clu_offset = byte_offset >> p_fs->cluster_size_bits; +- cur_clu = p_dir->dir; +- +- if (p_dir->flags == 0x03) { +- cur_clu += clu_offset; +- } else { +- while (clu_offset > 0) { +- if (exfat_fat_read(sb, cur_clu, &cur_clu) == -1) +- return -EIO; +- clu_offset--; +- } +- } +- +- if (clu) +- *clu = cur_clu; +- return 0; +-} +- +-static s32 find_location(struct super_block *sb, struct chain_t *p_dir, s32 entry, +- sector_t *sector, s32 *offset) +-{ +- s32 off, ret; +- u32 clu = 0; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- off = entry << DENTRY_SIZE_BITS; +- +- if (p_dir->dir == CLUSTER_32(0)) { /* FAT16 root_dir */ +- *offset = off & p_bd->sector_size_mask; +- *sector = off >> p_bd->sector_size_bits; +- *sector += p_fs->root_start_sector; +- } else { +- ret = _walk_fat_chain(sb, p_dir, off, &clu); +- if (ret != 0) +- return ret; +- +- /* byte offset in cluster */ +- off &= p_fs->cluster_size - 1; +- +- /* byte offset in sector */ +- *offset = off & p_bd->sector_size_mask; +- +- /* sector offset in cluster */ +- *sector = off >> p_bd->sector_size_bits; +- *sector += START_SECTOR(clu); +- } +- return 0; +-} +- +-struct dentry_t *get_entry_in_dir(struct super_block *sb, struct chain_t *p_dir, +- s32 entry, sector_t *sector) +-{ +- s32 off; +- sector_t sec; +- u8 *buf; +- +- if (find_location(sb, p_dir, entry, &sec, &off) != 0) +- return NULL; +- +- buf = exfat_buf_getblk(sb, sec); +- +- if (!buf) +- return NULL; +- +- if (sector) +- *sector = sec; +- return (struct dentry_t *)(buf + off); +-} +- +-/* returns a set of dentries for a file or dir. +- * Note that this is a copy (dump) of dentries so that user should call write_entry_set() +- * to apply changes made in this entry set to the real device. +- * in: +- * sb+p_dir+entry: indicates a file/dir +- * type: specifies how many dentries should be included. +- * out: +- * file_ep: will point the first dentry(= file dentry) on success +- * return: +- * pointer of entry set on success, +- * NULL on failure. +- */ +- +-#define ES_MODE_STARTED 0 +-#define ES_MODE_GET_FILE_ENTRY 1 +-#define ES_MODE_GET_STRM_ENTRY 2 +-#define ES_MODE_GET_NAME_ENTRY 3 +-#define ES_MODE_GET_CRITICAL_SEC_ENTRY 4 +-struct entry_set_cache_t *get_entry_set_in_dir(struct super_block *sb, +- struct chain_t *p_dir, s32 entry, +- u32 type, +- struct dentry_t **file_ep) +-{ +- s32 off, ret, byte_offset; +- u32 clu = 0; +- sector_t sec; +- u32 entry_type; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- struct entry_set_cache_t *es = NULL; +- struct dentry_t *ep, *pos; +- u8 *buf; +- u8 num_entries; +- s32 mode = ES_MODE_STARTED; +- size_t bufsize; +- +- pr_debug("%s entered p_dir dir %u flags %x size %d\n", +- __func__, p_dir->dir, p_dir->flags, p_dir->size); +- +- byte_offset = entry << DENTRY_SIZE_BITS; +- ret = _walk_fat_chain(sb, p_dir, byte_offset, &clu); +- if (ret != 0) +- return NULL; +- +- /* byte offset in cluster */ +- byte_offset &= p_fs->cluster_size - 1; +- +- /* byte offset in sector */ +- off = byte_offset & p_bd->sector_size_mask; +- +- /* sector offset in cluster */ +- sec = byte_offset >> p_bd->sector_size_bits; +- sec += START_SECTOR(clu); +- +- buf = exfat_buf_getblk(sb, sec); +- if (!buf) +- goto err_out; +- +- ep = (struct dentry_t *)(buf + off); +- entry_type = exfat_get_entry_type(ep); +- +- if ((entry_type != TYPE_FILE) && (entry_type != TYPE_DIR)) +- goto err_out; +- +- if (type == ES_ALL_ENTRIES) +- num_entries = ((struct file_dentry_t *)ep)->num_ext + 1; +- else +- num_entries = type; +- +- bufsize = offsetof(struct entry_set_cache_t, __buf) + (num_entries) * +- sizeof(struct dentry_t); +- pr_debug("%s: trying to kmalloc %zx bytes for %d entries\n", __func__, +- bufsize, num_entries); +- es = kmalloc(bufsize, GFP_KERNEL); +- if (!es) +- goto err_out; +- +- es->num_entries = num_entries; +- es->sector = sec; +- es->offset = off; +- es->alloc_flag = p_dir->flags; +- +- pos = (struct dentry_t *)&es->__buf; +- +- while (num_entries) { +- /* +- * instead of copying whole sector, we will check every entry. +- * this will provide minimum stablity and consistency. +- */ +- entry_type = exfat_get_entry_type(ep); +- +- if ((entry_type == TYPE_UNUSED) || (entry_type == TYPE_DELETED)) +- goto err_out; +- +- switch (mode) { +- case ES_MODE_STARTED: +- if ((entry_type == TYPE_FILE) || (entry_type == TYPE_DIR)) +- mode = ES_MODE_GET_FILE_ENTRY; +- else +- goto err_out; +- break; +- case ES_MODE_GET_FILE_ENTRY: +- if (entry_type == TYPE_STREAM) +- mode = ES_MODE_GET_STRM_ENTRY; +- else +- goto err_out; +- break; +- case ES_MODE_GET_STRM_ENTRY: +- if (entry_type == TYPE_EXTEND) +- mode = ES_MODE_GET_NAME_ENTRY; +- else +- goto err_out; +- break; +- case ES_MODE_GET_NAME_ENTRY: +- if (entry_type == TYPE_EXTEND) +- break; +- else if (entry_type == TYPE_STREAM) +- goto err_out; +- else if (entry_type & TYPE_CRITICAL_SEC) +- mode = ES_MODE_GET_CRITICAL_SEC_ENTRY; +- else +- goto err_out; +- break; +- case ES_MODE_GET_CRITICAL_SEC_ENTRY: +- if ((entry_type == TYPE_EXTEND) || +- (entry_type == TYPE_STREAM)) +- goto err_out; +- else if ((entry_type & TYPE_CRITICAL_SEC) != +- TYPE_CRITICAL_SEC) +- goto err_out; +- break; +- } +- +- memcpy(pos, ep, sizeof(struct dentry_t)); +- +- if (--num_entries == 0) +- break; +- +- if (((off + DENTRY_SIZE) & p_bd->sector_size_mask) < +- (off & p_bd->sector_size_mask)) { +- /* get the next sector */ +- if (IS_LAST_SECTOR_IN_CLUSTER(sec)) { +- if (es->alloc_flag == 0x03) { +- clu++; +- } else { +- if (exfat_fat_read(sb, clu, &clu) == -1) +- goto err_out; +- } +- sec = START_SECTOR(clu); +- } else { +- sec++; +- } +- buf = exfat_buf_getblk(sb, sec); +- if (!buf) +- goto err_out; +- off = 0; +- ep = (struct dentry_t *)(buf); +- } else { +- ep++; +- off += DENTRY_SIZE; +- } +- pos++; +- } +- +- if (file_ep) +- *file_ep = (struct dentry_t *)&es->__buf; +- +- pr_debug("%s exiting es %p sec %llu offset %d flags %d, num_entries %u buf ptr %p\n", +- __func__, es, (unsigned long long)es->sector, es->offset, +- es->alloc_flag, es->num_entries, &es->__buf); +- return es; +-err_out: +- pr_debug("%s exited NULL (es %p)\n", __func__, es); +- kfree(es); +- return NULL; +-} +- +-void release_entry_set(struct entry_set_cache_t *es) +-{ +- pr_debug("%s es=%p\n", __func__, es); +- kfree(es); +-} +- +-/* search EMPTY CONTINUOUS "num_entries" entries */ +-static s32 search_deleted_or_unused_entry(struct super_block *sb, +- struct chain_t *p_dir, +- s32 num_entries) +-{ +- int i, dentry, num_empty = 0; +- s32 dentries_per_clu; +- u32 type; +- struct chain_t clu; +- struct dentry_t *ep; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */ +- dentries_per_clu = p_fs->dentries_in_root; +- else +- dentries_per_clu = p_fs->dentries_per_clu; +- +- if (p_fs->hint_uentry.dir == p_dir->dir) { +- if (p_fs->hint_uentry.entry == -1) +- return -1; +- +- clu.dir = p_fs->hint_uentry.clu.dir; +- clu.size = p_fs->hint_uentry.clu.size; +- clu.flags = p_fs->hint_uentry.clu.flags; +- +- dentry = p_fs->hint_uentry.entry; +- } else { +- p_fs->hint_uentry.entry = -1; +- +- clu.dir = p_dir->dir; +- clu.size = p_dir->size; +- clu.flags = p_dir->flags; +- +- dentry = 0; +- } +- +- while (clu.dir != CLUSTER_32(~0)) { +- if (p_fs->dev_ejected) +- break; +- +- if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */ +- i = dentry % dentries_per_clu; +- else +- i = dentry & (dentries_per_clu - 1); +- +- for (; i < dentries_per_clu; i++, dentry++) { +- ep = get_entry_in_dir(sb, &clu, i, NULL); +- if (!ep) +- return -1; +- +- type = exfat_get_entry_type(ep); +- +- if (type == TYPE_UNUSED) { +- num_empty++; +- if (p_fs->hint_uentry.entry == -1) { +- p_fs->hint_uentry.dir = p_dir->dir; +- p_fs->hint_uentry.entry = dentry; +- +- p_fs->hint_uentry.clu.dir = clu.dir; +- p_fs->hint_uentry.clu.size = clu.size; +- p_fs->hint_uentry.clu.flags = clu.flags; +- } +- } else if (type == TYPE_DELETED) { +- num_empty++; +- } else { +- num_empty = 0; +- } +- +- if (num_empty >= num_entries) { +- p_fs->hint_uentry.dir = CLUSTER_32(~0); +- p_fs->hint_uentry.entry = -1; +- +- if (p_fs->vol_type == EXFAT) +- return dentry - (num_entries - 1); +- else +- return dentry; +- } +- } +- +- if (p_dir->dir == CLUSTER_32(0)) +- break; /* FAT16 root_dir */ +- +- if (clu.flags == 0x03) { +- if ((--clu.size) > 0) +- clu.dir++; +- else +- clu.dir = CLUSTER_32(~0); +- } else { +- if (exfat_fat_read(sb, clu.dir, &clu.dir) != 0) +- return -1; +- } +- } +- +- return -1; +-} +- +-static s32 find_empty_entry(struct inode *inode, struct chain_t *p_dir, s32 num_entries) +-{ +- s32 ret, dentry; +- u32 last_clu; +- sector_t sector; +- u64 size = 0; +- struct chain_t clu; +- struct dentry_t *ep = NULL; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct file_id_t *fid = &(EXFAT_I(inode)->fid); +- +- if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */ +- return search_deleted_or_unused_entry(sb, p_dir, num_entries); +- +- while ((dentry = search_deleted_or_unused_entry(sb, p_dir, num_entries)) < 0) { +- if (p_fs->dev_ejected) +- break; +- +- if (p_dir->dir != p_fs->root_dir) +- size = i_size_read(inode); +- +- last_clu = find_last_cluster(sb, p_dir); +- clu.dir = last_clu + 1; +- clu.size = 0; +- clu.flags = p_dir->flags; +- +- /* (1) allocate a cluster */ +- ret = exfat_alloc_cluster(sb, 1, &clu); +- if (ret < 1) +- return -EIO; +- +- if (clear_cluster(sb, clu.dir) != 0) +- return -EIO; +- +- /* (2) append to the FAT chain */ +- if (clu.flags != p_dir->flags) { +- exfat_chain_cont_cluster(sb, p_dir->dir, p_dir->size); +- p_dir->flags = 0x01; +- p_fs->hint_uentry.clu.flags = 0x01; +- } +- if (clu.flags == 0x01) +- if (exfat_fat_write(sb, last_clu, clu.dir) < 0) +- return -EIO; +- +- if (p_fs->hint_uentry.entry == -1) { +- p_fs->hint_uentry.dir = p_dir->dir; +- p_fs->hint_uentry.entry = p_dir->size << (p_fs->cluster_size_bits - DENTRY_SIZE_BITS); +- +- p_fs->hint_uentry.clu.dir = clu.dir; +- p_fs->hint_uentry.clu.size = 0; +- p_fs->hint_uentry.clu.flags = clu.flags; +- } +- p_fs->hint_uentry.clu.size++; +- p_dir->size++; +- +- /* (3) update the directory entry */ +- if (p_dir->dir != p_fs->root_dir) { +- size += p_fs->cluster_size; +- +- ep = get_entry_in_dir(sb, &fid->dir, +- fid->entry + 1, §or); +- if (!ep) +- return -ENOENT; +- exfat_set_entry_size(ep, size); +- exfat_set_entry_flag(ep, p_dir->flags); +- exfat_buf_modify(sb, sector); +- +- update_dir_checksum(sb, &fid->dir, +- fid->entry); +- } +- +- i_size_write(inode, i_size_read(inode) + p_fs->cluster_size); +- EXFAT_I(inode)->mmu_private += p_fs->cluster_size; +- EXFAT_I(inode)->fid.size += p_fs->cluster_size; +- EXFAT_I(inode)->fid.flags = p_dir->flags; +- inode->i_blocks += 1 << (p_fs->cluster_size_bits - 9); +- } +- +- return dentry; +-} +- +-static s32 extract_uni_name_from_name_entry(struct name_dentry_t *ep, u16 *uniname, +- s32 order) +-{ +- int i, len = 0; +- +- for (i = 0; i < 30; i += 2) { +- *uniname = GET16_A(ep->unicode_0_14 + i); +- if (*uniname == 0x0) +- return len; +- uniname++; +- len++; +- } +- +- *uniname = 0x0; +- return len; +-} +- +-/* return values of exfat_find_dir_entry() +- * >= 0 : return dir entiry position with the name in dir +- * -1 : (root dir, ".") it is the root dir itself +- * -2 : entry with the name does not exist +- */ +-s32 exfat_find_dir_entry(struct super_block *sb, struct chain_t *p_dir, +- struct uni_name_t *p_uniname, s32 num_entries, +- struct dos_name_t *p_dosname, u32 type) +-{ +- int i = 0, dentry = 0, num_ext_entries = 0, len, step; +- s32 order = 0; +- bool is_feasible_entry = false; +- s32 dentries_per_clu, num_empty = 0; +- u32 entry_type; +- u16 entry_uniname[16], *uniname = NULL, unichar; +- struct chain_t clu; +- struct dentry_t *ep; +- struct file_dentry_t *file_ep; +- struct strm_dentry_t *strm_ep; +- struct name_dentry_t *name_ep; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- if (p_dir->dir == p_fs->root_dir) { +- if ((!nls_uniname_cmp(sb, p_uniname->name, +- (u16 *)UNI_CUR_DIR_NAME)) || +- (!nls_uniname_cmp(sb, p_uniname->name, +- (u16 *)UNI_PAR_DIR_NAME))) +- return -1; // special case, root directory itself +- } +- +- if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */ +- dentries_per_clu = p_fs->dentries_in_root; +- else +- dentries_per_clu = p_fs->dentries_per_clu; +- +- clu.dir = p_dir->dir; +- clu.size = p_dir->size; +- clu.flags = p_dir->flags; +- +- p_fs->hint_uentry.dir = p_dir->dir; +- p_fs->hint_uentry.entry = -1; +- +- while (clu.dir != CLUSTER_32(~0)) { +- if (p_fs->dev_ejected) +- break; +- +- while (i < dentries_per_clu) { +- ep = get_entry_in_dir(sb, &clu, i, NULL); +- if (!ep) +- return -2; +- +- entry_type = exfat_get_entry_type(ep); +- step = 1; +- +- if ((entry_type == TYPE_UNUSED) || (entry_type == TYPE_DELETED)) { +- is_feasible_entry = false; +- +- if (p_fs->hint_uentry.entry == -1) { +- num_empty++; +- +- if (num_empty == 1) { +- p_fs->hint_uentry.clu.dir = clu.dir; +- p_fs->hint_uentry.clu.size = clu.size; +- p_fs->hint_uentry.clu.flags = clu.flags; +- } +- if ((num_empty >= num_entries) || (entry_type == TYPE_UNUSED)) +- p_fs->hint_uentry.entry = dentry - (num_empty - 1); +- } +- +- if (entry_type == TYPE_UNUSED) +- return -2; +- } else { +- num_empty = 0; +- +- if ((entry_type == TYPE_FILE) || (entry_type == TYPE_DIR)) { +- file_ep = (struct file_dentry_t *)ep; +- if ((type == TYPE_ALL) || (type == entry_type)) { +- num_ext_entries = file_ep->num_ext; +- is_feasible_entry = true; +- } else { +- is_feasible_entry = false; +- step = file_ep->num_ext + 1; +- } +- } else if (entry_type == TYPE_STREAM) { +- if (is_feasible_entry) { +- strm_ep = (struct strm_dentry_t *)ep; +- if (p_uniname->name_hash == GET16_A(strm_ep->name_hash) && +- p_uniname->name_len == strm_ep->name_len) { +- order = 1; +- } else { +- is_feasible_entry = false; +- step = num_ext_entries; +- } +- } +- } else if (entry_type == TYPE_EXTEND) { +- if (is_feasible_entry) { +- name_ep = (struct name_dentry_t *)ep; +- +- if ((++order) == 2) +- uniname = p_uniname->name; +- else +- uniname += 15; +- +- len = extract_uni_name_from_name_entry(name_ep, +- entry_uniname, order); +- +- unichar = *(uniname + len); +- *(uniname + len) = 0x0; +- +- if (nls_uniname_cmp(sb, uniname, entry_uniname)) { +- is_feasible_entry = false; +- step = num_ext_entries - order + 1; +- } else if (order == num_ext_entries) { +- p_fs->hint_uentry.dir = CLUSTER_32(~0); +- p_fs->hint_uentry.entry = -1; +- return dentry - (num_ext_entries); +- } +- +- *(uniname + len) = unichar; +- } +- } else { +- is_feasible_entry = false; +- } +- } +- +- i += step; +- dentry += step; +- } +- +- i -= dentries_per_clu; +- +- if (p_dir->dir == CLUSTER_32(0)) +- break; /* FAT16 root_dir */ +- +- if (clu.flags == 0x03) { +- if ((--clu.size) > 0) +- clu.dir++; +- else +- clu.dir = CLUSTER_32(~0); +- } else { +- if (exfat_fat_read(sb, clu.dir, &clu.dir) != 0) +- return -2; +- } +- } +- +- return -2; +-} +- +-s32 exfat_count_ext_entries(struct super_block *sb, struct chain_t *p_dir, +- s32 entry, struct dentry_t *p_entry) +-{ +- int i, count = 0; +- u32 type; +- struct file_dentry_t *file_ep = (struct file_dentry_t *)p_entry; +- struct dentry_t *ext_ep; +- +- for (i = 0, entry++; i < file_ep->num_ext; i++, entry++) { +- ext_ep = get_entry_in_dir(sb, p_dir, entry, NULL); +- if (!ext_ep) +- return -1; +- +- type = exfat_get_entry_type(ext_ep); +- if ((type == TYPE_EXTEND) || (type == TYPE_STREAM)) +- count++; +- else +- return count; +- } +- +- return count; +-} +- +-s32 count_dos_name_entries(struct super_block *sb, struct chain_t *p_dir, +- u32 type) +-{ +- int i, count = 0; +- s32 dentries_per_clu; +- u32 entry_type; +- struct chain_t clu; +- struct dentry_t *ep; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */ +- dentries_per_clu = p_fs->dentries_in_root; +- else +- dentries_per_clu = p_fs->dentries_per_clu; +- +- clu.dir = p_dir->dir; +- clu.size = p_dir->size; +- clu.flags = p_dir->flags; +- +- while (clu.dir != CLUSTER_32(~0)) { +- if (p_fs->dev_ejected) +- break; +- +- for (i = 0; i < dentries_per_clu; i++) { +- ep = get_entry_in_dir(sb, &clu, i, NULL); +- if (!ep) +- return -ENOENT; +- +- entry_type = exfat_get_entry_type(ep); +- +- if (entry_type == TYPE_UNUSED) +- return count; +- if (!(type & TYPE_CRITICAL_PRI) && +- !(type & TYPE_BENIGN_PRI)) +- continue; +- +- if ((type == TYPE_ALL) || (type == entry_type)) +- count++; +- } +- +- if (p_dir->dir == CLUSTER_32(0)) +- break; /* FAT16 root_dir */ +- +- if (clu.flags == 0x03) { +- if ((--clu.size) > 0) +- clu.dir++; +- else +- clu.dir = CLUSTER_32(~0); +- } else { +- if (exfat_fat_read(sb, clu.dir, &clu.dir) != 0) +- return -EIO; +- } +- } +- +- return count; +-} +- +-bool is_dir_empty(struct super_block *sb, struct chain_t *p_dir) +-{ +- int i, count = 0; +- s32 dentries_per_clu; +- u32 type; +- struct chain_t clu; +- struct dentry_t *ep; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */ +- dentries_per_clu = p_fs->dentries_in_root; +- else +- dentries_per_clu = p_fs->dentries_per_clu; +- +- clu.dir = p_dir->dir; +- clu.size = p_dir->size; +- clu.flags = p_dir->flags; +- +- while (clu.dir != CLUSTER_32(~0)) { +- if (p_fs->dev_ejected) +- break; +- +- for (i = 0; i < dentries_per_clu; i++) { +- ep = get_entry_in_dir(sb, &clu, i, NULL); +- if (!ep) +- break; +- +- type = exfat_get_entry_type(ep); +- +- if (type == TYPE_UNUSED) +- return true; +- if ((type != TYPE_FILE) && (type != TYPE_DIR)) +- continue; +- +- if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */ +- return false; +- +- if (p_fs->vol_type == EXFAT) +- return false; +- if ((p_dir->dir == p_fs->root_dir) || ((++count) > 2)) +- return false; +- } +- +- if (p_dir->dir == CLUSTER_32(0)) +- break; /* FAT16 root_dir */ +- +- if (clu.flags == 0x03) { +- if ((--clu.size) > 0) +- clu.dir++; +- else +- clu.dir = CLUSTER_32(~0); +- } +- if (exfat_fat_read(sb, clu.dir, &clu.dir) != 0) +- break; +- } +- +- return true; +-} +- +-/* +- * Name Conversion Functions +- */ +- +-/* input : dir, uni_name +- * output : num_of_entry, dos_name(format : aaaaaa~1.bbb) +- */ +-s32 get_num_entries_and_dos_name(struct super_block *sb, struct chain_t *p_dir, +- struct uni_name_t *p_uniname, s32 *entries, +- struct dos_name_t *p_dosname) +-{ +- s32 num_entries; +- +- num_entries = exfat_calc_num_entries(p_uniname); +- if (num_entries == 0) +- return -EINVAL; +- +- *entries = num_entries; +- +- return 0; +-} +- +-void exfat_get_uni_name_from_ext_entry(struct super_block *sb, +- struct chain_t *p_dir, s32 entry, +- u16 *uniname) +-{ +- int i; +- struct dentry_t *ep; +- struct entry_set_cache_t *es; +- +- es = get_entry_set_in_dir(sb, p_dir, entry, ES_ALL_ENTRIES, &ep); +- if (!es || es->num_entries < 3) { +- if (es) +- release_entry_set(es); +- return; +- } +- +- ep += 2; +- +- /* +- * First entry : file entry +- * Second entry : stream-extension entry +- * Third entry : first file-name entry +- * So, the index of first file-name dentry should start from 2. +- */ +- for (i = 2; i < es->num_entries; i++, ep++) { +- if (exfat_get_entry_type(ep) == TYPE_EXTEND) +- extract_uni_name_from_name_entry((struct name_dentry_t *) +- ep, uniname, i); +- else +- goto out; +- uniname += 15; +- } +- +-out: +- release_entry_set(es); +-} +- +-s32 exfat_calc_num_entries(struct uni_name_t *p_uniname) +-{ +- s32 len; +- +- len = p_uniname->name_len; +- if (len == 0) +- return 0; +- +- /* 1 file entry + 1 stream entry + name entries */ +- return (len - 1) / 15 + 3; +-} +- +-u16 calc_checksum_2byte(void *data, s32 len, u16 chksum, s32 type) +-{ +- int i; +- u8 *c = (u8 *)data; +- +- switch (type) { +- case CS_DIR_ENTRY: +- for (i = 0; i < len; i++, c++) { +- if ((i == 2) || (i == 3)) +- continue; +- chksum = (((chksum & 1) << 15) | +- ((chksum & 0xFFFE) >> 1)) + (u16)*c; +- } +- break; +- default +- : +- for (i = 0; i < len; i++, c++) +- chksum = (((chksum & 1) << 15) | +- ((chksum & 0xFFFE) >> 1)) + (u16)*c; +- } +- +- return chksum; +-} +- +-/* +- * Name Resolution Functions +- */ +- +-/* return values of resolve_path() +- * > 0 : return the length of the path +- * < 0 : return error +- */ +-s32 resolve_path(struct inode *inode, char *path, struct chain_t *p_dir, +- struct uni_name_t *p_uniname) +-{ +- bool lossy = false; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct file_id_t *fid = &(EXFAT_I(inode)->fid); +- +- if (strscpy(name_buf, path, sizeof(name_buf)) < 0) +- return -EINVAL; +- +- nls_cstring_to_uniname(sb, p_uniname, name_buf, &lossy); +- if (lossy) +- return -EINVAL; +- +- fid->size = i_size_read(inode); +- +- p_dir->dir = fid->start_clu; +- p_dir->size = (s32)(fid->size >> p_fs->cluster_size_bits); +- p_dir->flags = fid->flags; +- +- return 0; +-} +- +-s32 exfat_mount(struct super_block *sb, struct pbr_sector_t *p_pbr) +-{ +- struct bpbex_t *p_bpb = (struct bpbex_t *)p_pbr->bpb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- if (p_bpb->num_fats == 0) +- return -EFSCORRUPTED; +- +- p_fs->sectors_per_clu = 1 << p_bpb->sectors_per_clu_bits; +- p_fs->sectors_per_clu_bits = p_bpb->sectors_per_clu_bits; +- p_fs->cluster_size_bits = p_fs->sectors_per_clu_bits + +- p_bd->sector_size_bits; +- p_fs->cluster_size = 1 << p_fs->cluster_size_bits; +- +- p_fs->num_FAT_sectors = GET32(p_bpb->fat_length); +- +- p_fs->FAT1_start_sector = p_fs->PBR_sector + GET32(p_bpb->fat_offset); +- if (p_bpb->num_fats == 1) +- p_fs->FAT2_start_sector = p_fs->FAT1_start_sector; +- else +- p_fs->FAT2_start_sector = p_fs->FAT1_start_sector + +- p_fs->num_FAT_sectors; +- +- p_fs->root_start_sector = p_fs->PBR_sector + GET32(p_bpb->clu_offset); +- p_fs->data_start_sector = p_fs->root_start_sector; +- +- p_fs->num_sectors = GET64(p_bpb->vol_length); +- p_fs->num_clusters = GET32(p_bpb->clu_count) + 2; +- /* because the cluster index starts with 2 */ +- +- p_fs->vol_type = EXFAT; +- p_fs->vol_id = GET32(p_bpb->vol_serial); +- +- p_fs->root_dir = GET32(p_bpb->root_cluster); +- p_fs->dentries_in_root = 0; +- p_fs->dentries_per_clu = 1 << (p_fs->cluster_size_bits - +- DENTRY_SIZE_BITS); +- +- p_fs->vol_flag = (u32)GET16(p_bpb->vol_flags); +- p_fs->clu_srch_ptr = 2; +- p_fs->used_clusters = UINT_MAX; +- +- return 0; +-} +- +-s32 create_dir(struct inode *inode, struct chain_t *p_dir, +- struct uni_name_t *p_uniname, struct file_id_t *fid) +-{ +- s32 ret, dentry, num_entries; +- u64 size; +- struct chain_t clu; +- struct dos_name_t dos_name; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- ret = get_num_entries_and_dos_name(sb, p_dir, p_uniname, &num_entries, +- &dos_name); +- if (ret) +- return ret; +- +- /* find_empty_entry must be called before alloc_cluster */ +- dentry = find_empty_entry(inode, p_dir, num_entries); +- if (dentry < 0) +- return -ENOSPC; +- +- clu.dir = CLUSTER_32(~0); +- clu.size = 0; +- clu.flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01; +- +- /* (1) allocate a cluster */ +- ret = exfat_alloc_cluster(sb, 1, &clu); +- if (ret < 0) +- return ret; +- else if (ret == 0) +- return -ENOSPC; +- +- ret = clear_cluster(sb, clu.dir); +- if (ret != 0) +- return ret; +- +- size = p_fs->cluster_size; +- +- /* (2) update the directory entry */ +- /* make sub-dir entry in parent directory */ +- ret = exfat_init_dir_entry(sb, p_dir, dentry, TYPE_DIR, clu.dir, +- size); +- if (ret != 0) +- return ret; +- +- ret = exfat_init_ext_entry(sb, p_dir, dentry, num_entries, p_uniname, +- &dos_name); +- if (ret != 0) +- return ret; +- +- fid->dir.dir = p_dir->dir; +- fid->dir.size = p_dir->size; +- fid->dir.flags = p_dir->flags; +- fid->entry = dentry; +- +- fid->attr = ATTR_SUBDIR; +- fid->flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01; +- fid->size = size; +- fid->start_clu = clu.dir; +- +- fid->type = TYPE_DIR; +- fid->rwoffset = 0; +- fid->hint_last_off = -1; +- +- return 0; +-} +- +-s32 create_file(struct inode *inode, struct chain_t *p_dir, +- struct uni_name_t *p_uniname, u8 mode, struct file_id_t *fid) +-{ +- s32 ret, dentry, num_entries; +- struct dos_name_t dos_name; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- ret = get_num_entries_and_dos_name(sb, p_dir, p_uniname, &num_entries, +- &dos_name); +- if (ret) +- return ret; +- +- /* find_empty_entry must be called before alloc_cluster() */ +- dentry = find_empty_entry(inode, p_dir, num_entries); +- if (dentry < 0) +- return -ENOSPC; +- +- /* (1) update the directory entry */ +- /* fill the dos name directory entry information of the created file. +- * the first cluster is not determined yet. (0) +- */ +- ret = exfat_init_dir_entry(sb, p_dir, dentry, TYPE_FILE | mode, +- CLUSTER_32(0), 0); +- if (ret != 0) +- return ret; +- +- ret = exfat_init_ext_entry(sb, p_dir, dentry, num_entries, p_uniname, +- &dos_name); +- if (ret != 0) +- return ret; +- +- fid->dir.dir = p_dir->dir; +- fid->dir.size = p_dir->size; +- fid->dir.flags = p_dir->flags; +- fid->entry = dentry; +- +- fid->attr = ATTR_ARCHIVE | mode; +- fid->flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01; +- fid->size = 0; +- fid->start_clu = CLUSTER_32(~0); +- +- fid->type = TYPE_FILE; +- fid->rwoffset = 0; +- fid->hint_last_off = -1; +- +- return 0; +-} +- +-void remove_file(struct inode *inode, struct chain_t *p_dir, s32 entry) +-{ +- s32 num_entries; +- sector_t sector; +- struct dentry_t *ep; +- struct super_block *sb = inode->i_sb; +- +- ep = get_entry_in_dir(sb, p_dir, entry, §or); +- if (!ep) +- return; +- +- exfat_buf_lock(sb, sector); +- +- /* exfat_buf_lock() before call count_ext_entries() */ +- num_entries = exfat_count_ext_entries(sb, p_dir, entry, ep); +- if (num_entries < 0) { +- exfat_buf_unlock(sb, sector); +- return; +- } +- num_entries++; +- +- exfat_buf_unlock(sb, sector); +- +- /* (1) update the directory entry */ +- exfat_delete_dir_entry(sb, p_dir, entry, 0, num_entries); +-} +- +-s32 exfat_rename_file(struct inode *inode, struct chain_t *p_dir, s32 oldentry, +- struct uni_name_t *p_uniname, struct file_id_t *fid) +-{ +- s32 ret, newentry = -1, num_old_entries, num_new_entries; +- sector_t sector_old, sector_new; +- struct dos_name_t dos_name; +- struct dentry_t *epold, *epnew; +- struct super_block *sb = inode->i_sb; +- +- epold = get_entry_in_dir(sb, p_dir, oldentry, §or_old); +- if (!epold) +- return -ENOENT; +- +- exfat_buf_lock(sb, sector_old); +- +- /* exfat_buf_lock() before call count_ext_entries() */ +- num_old_entries = exfat_count_ext_entries(sb, p_dir, oldentry, +- epold); +- if (num_old_entries < 0) { +- exfat_buf_unlock(sb, sector_old); +- return -ENOENT; +- } +- num_old_entries++; +- +- ret = get_num_entries_and_dos_name(sb, p_dir, p_uniname, +- &num_new_entries, &dos_name); +- if (ret) { +- exfat_buf_unlock(sb, sector_old); +- return ret; +- } +- +- if (num_old_entries < num_new_entries) { +- newentry = find_empty_entry(inode, p_dir, num_new_entries); +- if (newentry < 0) { +- exfat_buf_unlock(sb, sector_old); +- return -ENOSPC; +- } +- +- epnew = get_entry_in_dir(sb, p_dir, newentry, §or_new); +- if (!epnew) { +- exfat_buf_unlock(sb, sector_old); +- return -ENOENT; +- } +- +- memcpy((void *)epnew, (void *)epold, DENTRY_SIZE); +- if (exfat_get_entry_type(epnew) == TYPE_FILE) { +- exfat_set_entry_attr(epnew, +- exfat_get_entry_attr(epnew) | +- ATTR_ARCHIVE); +- fid->attr |= ATTR_ARCHIVE; +- } +- exfat_buf_modify(sb, sector_new); +- exfat_buf_unlock(sb, sector_old); +- +- epold = get_entry_in_dir(sb, p_dir, oldentry + 1, +- §or_old); +- exfat_buf_lock(sb, sector_old); +- epnew = get_entry_in_dir(sb, p_dir, newentry + 1, +- §or_new); +- +- if (!epold || !epnew) { +- exfat_buf_unlock(sb, sector_old); +- return -ENOENT; +- } +- +- memcpy((void *)epnew, (void *)epold, DENTRY_SIZE); +- exfat_buf_modify(sb, sector_new); +- exfat_buf_unlock(sb, sector_old); +- +- ret = exfat_init_ext_entry(sb, p_dir, newentry, +- num_new_entries, p_uniname, +- &dos_name); +- if (ret != 0) +- return ret; +- +- exfat_delete_dir_entry(sb, p_dir, oldentry, 0, +- num_old_entries); +- fid->entry = newentry; +- } else { +- if (exfat_get_entry_type(epold) == TYPE_FILE) { +- exfat_set_entry_attr(epold, +- exfat_get_entry_attr(epold) | +- ATTR_ARCHIVE); +- fid->attr |= ATTR_ARCHIVE; +- } +- exfat_buf_modify(sb, sector_old); +- exfat_buf_unlock(sb, sector_old); +- +- ret = exfat_init_ext_entry(sb, p_dir, oldentry, +- num_new_entries, p_uniname, +- &dos_name); +- if (ret != 0) +- return ret; +- +- exfat_delete_dir_entry(sb, p_dir, oldentry, num_new_entries, +- num_old_entries); +- } +- +- return 0; +-} +- +-s32 move_file(struct inode *inode, struct chain_t *p_olddir, s32 oldentry, +- struct chain_t *p_newdir, struct uni_name_t *p_uniname, +- struct file_id_t *fid) +-{ +- s32 ret, newentry, num_new_entries, num_old_entries; +- sector_t sector_mov, sector_new; +- struct dos_name_t dos_name; +- struct dentry_t *epmov, *epnew; +- struct super_block *sb = inode->i_sb; +- +- epmov = get_entry_in_dir(sb, p_olddir, oldentry, §or_mov); +- if (!epmov) +- return -ENOENT; +- +- /* check if the source and target directory is the same */ +- if (exfat_get_entry_type(epmov) == TYPE_DIR && +- exfat_get_entry_clu0(epmov) == p_newdir->dir) +- return -EINVAL; +- +- exfat_buf_lock(sb, sector_mov); +- +- /* exfat_buf_lock() before call count_ext_entries() */ +- num_old_entries = exfat_count_ext_entries(sb, p_olddir, oldentry, +- epmov); +- if (num_old_entries < 0) { +- exfat_buf_unlock(sb, sector_mov); +- return -ENOENT; +- } +- num_old_entries++; +- +- ret = get_num_entries_and_dos_name(sb, p_newdir, p_uniname, +- &num_new_entries, &dos_name); +- if (ret) { +- exfat_buf_unlock(sb, sector_mov); +- return ret; +- } +- +- newentry = find_empty_entry(inode, p_newdir, num_new_entries); +- if (newentry < 0) { +- exfat_buf_unlock(sb, sector_mov); +- return -ENOSPC; +- } +- +- epnew = get_entry_in_dir(sb, p_newdir, newentry, §or_new); +- if (!epnew) { +- exfat_buf_unlock(sb, sector_mov); +- return -ENOENT; +- } +- +- memcpy((void *)epnew, (void *)epmov, DENTRY_SIZE); +- if (exfat_get_entry_type(epnew) == TYPE_FILE) { +- exfat_set_entry_attr(epnew, exfat_get_entry_attr(epnew) | +- ATTR_ARCHIVE); +- fid->attr |= ATTR_ARCHIVE; +- } +- exfat_buf_modify(sb, sector_new); +- exfat_buf_unlock(sb, sector_mov); +- +- epmov = get_entry_in_dir(sb, p_olddir, oldentry + 1, +- §or_mov); +- exfat_buf_lock(sb, sector_mov); +- epnew = get_entry_in_dir(sb, p_newdir, newentry + 1, +- §or_new); +- if (!epmov || !epnew) { +- exfat_buf_unlock(sb, sector_mov); +- return -ENOENT; +- } +- +- memcpy((void *)epnew, (void *)epmov, DENTRY_SIZE); +- exfat_buf_modify(sb, sector_new); +- exfat_buf_unlock(sb, sector_mov); +- +- ret = exfat_init_ext_entry(sb, p_newdir, newentry, num_new_entries, +- p_uniname, &dos_name); +- if (ret != 0) +- return ret; +- +- exfat_delete_dir_entry(sb, p_olddir, oldentry, 0, num_old_entries); +- +- fid->dir.dir = p_newdir->dir; +- fid->dir.size = p_newdir->size; +- fid->dir.flags = p_newdir->flags; +- +- fid->entry = newentry; +- +- return 0; +-} +- +-/* +- * Sector Read/Write Functions +- */ +- +-int sector_read(struct super_block *sb, sector_t sec, struct buffer_head **bh, +- bool read) +-{ +- s32 ret = -EIO; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- if ((sec >= (p_fs->PBR_sector + p_fs->num_sectors)) && +- (p_fs->num_sectors > 0)) { +- pr_err("[EXFAT] %s: out of range error! (sec = %llu)\n", +- __func__, (unsigned long long)sec); +- fs_error(sb); +- return ret; +- } +- +- if (!p_fs->dev_ejected) { +- ret = exfat_bdev_read(sb, sec, bh, 1, read); +- if (ret != 0) +- p_fs->dev_ejected = 1; +- } +- +- return ret; +-} +- +-int sector_write(struct super_block *sb, sector_t sec, struct buffer_head *bh, +- bool sync) +-{ +- s32 ret = -EIO; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- if (sec >= (p_fs->PBR_sector + p_fs->num_sectors) && +- (p_fs->num_sectors > 0)) { +- pr_err("[EXFAT] %s: out of range error! (sec = %llu)\n", +- __func__, (unsigned long long)sec); +- fs_error(sb); +- return ret; +- } +- +- if (!bh) { +- pr_err("[EXFAT] %s: bh is NULL!\n", __func__); +- fs_error(sb); +- return ret; +- } +- +- if (!p_fs->dev_ejected) { +- ret = exfat_bdev_write(sb, sec, bh, 1, sync); +- if (ret != 0) +- p_fs->dev_ejected = 1; +- } +- +- return ret; +-} +- +-int multi_sector_read(struct super_block *sb, sector_t sec, +- struct buffer_head **bh, s32 num_secs, bool read) +-{ +- s32 ret = -EIO; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- if (((sec + num_secs) > (p_fs->PBR_sector + p_fs->num_sectors)) && +- (p_fs->num_sectors > 0)) { +- pr_err("[EXFAT] %s: out of range error! (sec = %llu, num_secs = %d)\n", +- __func__, (unsigned long long)sec, num_secs); +- fs_error(sb); +- return ret; +- } +- +- if (!p_fs->dev_ejected) { +- ret = exfat_bdev_read(sb, sec, bh, num_secs, read); +- if (ret != 0) +- p_fs->dev_ejected = 1; +- } +- +- return ret; +-} +- +-int multi_sector_write(struct super_block *sb, sector_t sec, +- struct buffer_head *bh, s32 num_secs, bool sync) +-{ +- s32 ret = -EIO; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- if ((sec + num_secs) > (p_fs->PBR_sector + p_fs->num_sectors) && +- (p_fs->num_sectors > 0)) { +- pr_err("[EXFAT] %s: out of range error! (sec = %llu, num_secs = %d)\n", +- __func__, (unsigned long long)sec, num_secs); +- fs_error(sb); +- return ret; +- } +- if (!bh) { +- pr_err("[EXFAT] %s: bh is NULL!\n", __func__); +- fs_error(sb); +- return ret; +- } +- +- if (!p_fs->dev_ejected) { +- ret = exfat_bdev_write(sb, sec, bh, num_secs, sync); +- if (ret != 0) +- p_fs->dev_ejected = 1; +- } +- +- return ret; +-} +diff -Nurp linux-5.6.3.orig/drivers/staging/exfat/exfat.h linux-5.6.3/drivers/staging/exfat/exfat.h +--- linux-5.6.3.orig/drivers/staging/exfat/exfat.h 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/drivers/staging/exfat/exfat.h 1970-01-01 02:00:00.000000000 +0200 +@@ -1,824 +0,0 @@ +-/* SPDX-License-Identifier: GPL-2.0-or-later */ +-/* +- * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. +- */ +- +-#ifndef _EXFAT_H +-#define _EXFAT_H +- +-#include +-#include +- +-#ifdef CONFIG_STAGING_EXFAT_KERNEL_DEBUG +- /* For Debugging Purpose */ +- /* IOCTL code 'f' used by +- * - file systems typically #0~0x1F +- * - embedded terminal devices #128~ +- * - exts for debugging purpose #99 +- * number 100 and 101 is available now but has possible conflicts +- */ +-#define EXFAT_IOC_GET_DEBUGFLAGS _IOR('f', 100, long) +-#define EXFAT_IOC_SET_DEBUGFLAGS _IOW('f', 101, long) +- +-#define EXFAT_DEBUGFLAGS_INVALID_UMOUNT 0x01 +-#define EXFAT_DEBUGFLAGS_ERROR_RW 0x02 +-#endif /* CONFIG_STAGING_EXFAT_KERNEL_DEBUG */ +- +-#ifdef CONFIG_STAGING_EXFAT_DEBUG_MSG +-#define DEBUG 1 +-#else +-#undef DEBUG +-#endif +- +-#define EFSCORRUPTED EUCLEAN /* Filesystem is corrupted */ +- +-#define DENTRY_SIZE 32 /* dir entry size */ +-#define DENTRY_SIZE_BITS 5 +- +-/* PBR entries */ +-#define PBR_SIGNATURE 0xAA55 +-#define EXT_SIGNATURE 0xAA550000 +-#define VOL_LABEL "NO NAME " /* size should be 11 */ +-#define OEM_NAME "MSWIN4.1" /* size should be 8 */ +-#define STR_FAT12 "FAT12 " /* size should be 8 */ +-#define STR_FAT16 "FAT16 " /* size should be 8 */ +-#define STR_FAT32 "FAT32 " /* size should be 8 */ +-#define STR_EXFAT "EXFAT " /* size should be 8 */ +-#define VOL_CLEAN 0x0000 +-#define VOL_DIRTY 0x0002 +- +-/* max number of clusters */ +-#define FAT12_THRESHOLD 4087 /* 2^12 - 1 + 2 (clu 0 & 1) */ +-#define FAT16_THRESHOLD 65527 /* 2^16 - 1 + 2 */ +-#define FAT32_THRESHOLD 268435457 /* 2^28 - 1 + 2 */ +-#define EXFAT_THRESHOLD 268435457 /* 2^28 - 1 + 2 */ +- +-/* file types */ +-#define TYPE_UNUSED 0x0000 +-#define TYPE_DELETED 0x0001 +-#define TYPE_INVALID 0x0002 +-#define TYPE_CRITICAL_PRI 0x0100 +-#define TYPE_BITMAP 0x0101 +-#define TYPE_UPCASE 0x0102 +-#define TYPE_VOLUME 0x0103 +-#define TYPE_DIR 0x0104 +-#define TYPE_FILE 0x011F +-#define TYPE_SYMLINK 0x015F +-#define TYPE_CRITICAL_SEC 0x0200 +-#define TYPE_STREAM 0x0201 +-#define TYPE_EXTEND 0x0202 +-#define TYPE_ACL 0x0203 +-#define TYPE_BENIGN_PRI 0x0400 +-#define TYPE_GUID 0x0401 +-#define TYPE_PADDING 0x0402 +-#define TYPE_ACLTAB 0x0403 +-#define TYPE_BENIGN_SEC 0x0800 +-#define TYPE_ALL 0x0FFF +- +-/* time modes */ +-#define TM_CREATE 0 +-#define TM_MODIFY 1 +-#define TM_ACCESS 2 +- +-/* checksum types */ +-#define CS_DIR_ENTRY 0 +-#define CS_PBR_SECTOR 1 +-#define CS_DEFAULT 2 +- +-#define CLUSTER_16(x) ((u16)(x)) +-#define CLUSTER_32(x) ((u32)(x)) +- +-#define START_SECTOR(x) \ +- ((((sector_t)((x) - 2)) << p_fs->sectors_per_clu_bits) + \ +- p_fs->data_start_sector) +- +-#define IS_LAST_SECTOR_IN_CLUSTER(sec) \ +- ((((sec) - p_fs->data_start_sector + 1) & \ +- ((1 << p_fs->sectors_per_clu_bits) - 1)) == 0) +- +-#define GET_CLUSTER_FROM_SECTOR(sec) \ +- ((u32)((((sec) - p_fs->data_start_sector) >> \ +- p_fs->sectors_per_clu_bits) + 2)) +- +-#define GET16(p_src) \ +- (((u16)(p_src)[0]) | (((u16)(p_src)[1]) << 8)) +-#define GET32(p_src) \ +- (((u32)(p_src)[0]) | (((u32)(p_src)[1]) << 8) | \ +- (((u32)(p_src)[2]) << 16) | (((u32)(p_src)[3]) << 24)) +-#define GET64(p_src) \ +- (((u64)(p_src)[0]) | (((u64)(p_src)[1]) << 8) | \ +- (((u64)(p_src)[2]) << 16) | (((u64)(p_src)[3]) << 24) | \ +- (((u64)(p_src)[4]) << 32) | (((u64)(p_src)[5]) << 40) | \ +- (((u64)(p_src)[6]) << 48) | (((u64)(p_src)[7]) << 56)) +- +-#define SET16(p_dst, src) \ +- do { \ +- (p_dst)[0] = (u8)(src); \ +- (p_dst)[1] = (u8)(((u16)(src)) >> 8); \ +- } while (0) +-#define SET32(p_dst, src) \ +- do { \ +- (p_dst)[0] = (u8)(src); \ +- (p_dst)[1] = (u8)(((u32)(src)) >> 8); \ +- (p_dst)[2] = (u8)(((u32)(src)) >> 16); \ +- (p_dst)[3] = (u8)(((u32)(src)) >> 24); \ +- } while (0) +-#define SET64(p_dst, src) \ +- do { \ +- (p_dst)[0] = (u8)(src); \ +- (p_dst)[1] = (u8)(((u64)(src)) >> 8); \ +- (p_dst)[2] = (u8)(((u64)(src)) >> 16); \ +- (p_dst)[3] = (u8)(((u64)(src)) >> 24); \ +- (p_dst)[4] = (u8)(((u64)(src)) >> 32); \ +- (p_dst)[5] = (u8)(((u64)(src)) >> 40); \ +- (p_dst)[6] = (u8)(((u64)(src)) >> 48); \ +- (p_dst)[7] = (u8)(((u64)(src)) >> 56); \ +- } while (0) +- +-#ifdef __LITTLE_ENDIAN +-#define GET16_A(p_src) (*((u16 *)(p_src))) +-#define GET32_A(p_src) (*((u32 *)(p_src))) +-#define GET64_A(p_src) (*((u64 *)(p_src))) +-#define SET16_A(p_dst, src) (*((u16 *)(p_dst)) = (u16)(src)) +-#define SET32_A(p_dst, src) (*((u32 *)(p_dst)) = (u32)(src)) +-#define SET64_A(p_dst, src) (*((u64 *)(p_dst)) = (u64)(src)) +-#else /* BIG_ENDIAN */ +-#define GET16_A(p_src) GET16(p_src) +-#define GET32_A(p_src) GET32(p_src) +-#define GET64_A(p_src) GET64(p_src) +-#define SET16_A(p_dst, src) SET16(p_dst, src) +-#define SET32_A(p_dst, src) SET32(p_dst, src) +-#define SET64_A(p_dst, src) SET64(p_dst, src) +-#endif +- +-/* cache size (in number of sectors) */ +-/* (should be an exponential value of 2) */ +-#define FAT_CACHE_SIZE 128 +-#define FAT_CACHE_HASH_SIZE 64 +-#define BUF_CACHE_SIZE 256 +-#define BUF_CACHE_HASH_SIZE 64 +- +-/* Upcase table macro */ +-#define HIGH_INDEX_BIT (8) +-#define HIGH_INDEX_MASK (0xFF00) +-#define LOW_INDEX_BIT (16 - HIGH_INDEX_BIT) +-#define UTBL_ROW_COUNT BIT(LOW_INDEX_BIT) +-#define UTBL_COL_COUNT BIT(HIGH_INDEX_BIT) +- +-static inline u16 get_col_index(u16 i) +-{ +- return i >> LOW_INDEX_BIT; +-} +- +-static inline u16 get_row_index(u16 i) +-{ +- return i & ~HIGH_INDEX_MASK; +-} +- +-#define EXFAT_SUPER_MAGIC (0x2011BAB0L) +-#define EXFAT_ROOT_INO 1 +- +-/* FAT types */ +-#define FAT12 0x01 /* FAT12 */ +-#define FAT16 0x0E /* Win95 FAT16 (LBA) */ +-#define FAT32 0x0C /* Win95 FAT32 (LBA) */ +-#define EXFAT 0x07 /* exFAT */ +- +-/* file name lengths */ +-#define MAX_CHARSET_SIZE 3 /* max size of multi-byte character */ +-#define MAX_PATH_DEPTH 15 /* max depth of path name */ +-#define MAX_NAME_LENGTH 256 /* max len of filename including NULL */ +-#define MAX_PATH_LENGTH 260 /* max len of pathname including NULL */ +-#define DOS_NAME_LENGTH 11 /* DOS filename length excluding NULL */ +-#define DOS_PATH_LENGTH 80 /* DOS pathname length excluding NULL */ +- +-/* file attributes */ +-#define ATTR_NORMAL 0x0000 +-#define ATTR_READONLY 0x0001 +-#define ATTR_HIDDEN 0x0002 +-#define ATTR_SYSTEM 0x0004 +-#define ATTR_VOLUME 0x0008 +-#define ATTR_SUBDIR 0x0010 +-#define ATTR_ARCHIVE 0x0020 +-#define ATTR_SYMLINK 0x0040 +-#define ATTR_EXTEND 0x000F +-#define ATTR_RWMASK 0x007E +- +-/* file creation modes */ +-#define FM_REGULAR 0x00 +-#define FM_SYMLINK 0x40 +- +-#define NUM_UPCASE 2918 +- +-#define DOS_CUR_DIR_NAME ". " +-#define DOS_PAR_DIR_NAME ".. " +- +-#ifdef __LITTLE_ENDIAN +-#define UNI_CUR_DIR_NAME ".\0" +-#define UNI_PAR_DIR_NAME ".\0.\0" +-#else +-#define UNI_CUR_DIR_NAME "\0." +-#define UNI_PAR_DIR_NAME "\0.\0." +-#endif +- +-struct date_time_t { +- u16 Year; +- u16 Month; +- u16 Day; +- u16 Hour; +- u16 Minute; +- u16 Second; +- u16 MilliSecond; +-}; +- +-struct part_info_t { +- u32 Offset; /* start sector number of the partition */ +- u32 Size; /* in sectors */ +-}; +- +-struct dev_info_t { +- u32 SecSize; /* sector size in bytes */ +- u32 DevSize; /* block device size in sectors */ +-}; +- +-struct vol_info_t { +- u32 FatType; +- u32 ClusterSize; +- u32 NumClusters; +- u32 FreeClusters; +- u32 UsedClusters; +-}; +- +-/* directory structure */ +-struct chain_t { +- u32 dir; +- s32 size; +- u8 flags; +-}; +- +-struct file_id_t { +- struct chain_t dir; +- s32 entry; +- u32 type; +- u32 attr; +- u32 start_clu; +- u64 size; +- u8 flags; +- s64 rwoffset; +- s32 hint_last_off; +- u32 hint_last_clu; +-}; +- +-struct dir_entry_t { +- char Name[MAX_NAME_LENGTH * MAX_CHARSET_SIZE]; +- +- /* used only for FAT12/16/32, not used for exFAT */ +- char ShortName[DOS_NAME_LENGTH + 2]; +- +- u32 Attr; +- u64 Size; +- u32 NumSubdirs; +- struct date_time_t CreateTimestamp; +- struct date_time_t ModifyTimestamp; +- struct date_time_t AccessTimestamp; +-}; +- +-struct timestamp_t { +- u16 sec; /* 0 ~ 59 */ +- u16 min; /* 0 ~ 59 */ +- u16 hour; /* 0 ~ 23 */ +- u16 day; /* 1 ~ 31 */ +- u16 mon; /* 1 ~ 12 */ +- u16 year; /* 0 ~ 127 (since 1980) */ +-}; +- +-/* MS_DOS FAT partition boot record (512 bytes) */ +-struct pbr_sector_t { +- u8 jmp_boot[3]; +- u8 oem_name[8]; +- u8 bpb[109]; +- u8 boot_code[390]; +- u8 signature[2]; +-}; +- +-/* MS-DOS FAT12/16 BIOS parameter block (51 bytes) */ +-struct bpb16_t { +- u8 sector_size[2]; +- u8 sectors_per_clu; +- u8 num_reserved[2]; +- u8 num_fats; +- u8 num_root_entries[2]; +- u8 num_sectors[2]; +- u8 media_type; +- u8 num_fat_sectors[2]; +- u8 sectors_in_track[2]; +- u8 num_heads[2]; +- u8 num_hid_sectors[4]; +- u8 num_huge_sectors[4]; +- +- u8 phy_drv_no; +- u8 reserved; +- u8 ext_signature; +- u8 vol_serial[4]; +- u8 vol_label[11]; +- u8 vol_type[8]; +-}; +- +-/* MS-DOS FAT32 BIOS parameter block (79 bytes) */ +-struct bpb32_t { +- u8 sector_size[2]; +- u8 sectors_per_clu; +- u8 num_reserved[2]; +- u8 num_fats; +- u8 num_root_entries[2]; +- u8 num_sectors[2]; +- u8 media_type; +- u8 num_fat_sectors[2]; +- u8 sectors_in_track[2]; +- u8 num_heads[2]; +- u8 num_hid_sectors[4]; +- u8 num_huge_sectors[4]; +- u8 num_fat32_sectors[4]; +- u8 ext_flags[2]; +- u8 fs_version[2]; +- u8 root_cluster[4]; +- u8 fsinfo_sector[2]; +- u8 backup_sector[2]; +- u8 reserved[12]; +- +- u8 phy_drv_no; +- u8 ext_reserved; +- u8 ext_signature; +- u8 vol_serial[4]; +- u8 vol_label[11]; +- u8 vol_type[8]; +-}; +- +-/* MS-DOS EXFAT BIOS parameter block (109 bytes) */ +-struct bpbex_t { +- u8 reserved1[53]; +- u8 vol_offset[8]; +- u8 vol_length[8]; +- u8 fat_offset[4]; +- u8 fat_length[4]; +- u8 clu_offset[4]; +- u8 clu_count[4]; +- u8 root_cluster[4]; +- u8 vol_serial[4]; +- u8 fs_version[2]; +- u8 vol_flags[2]; +- u8 sector_size_bits; +- u8 sectors_per_clu_bits; +- u8 num_fats; +- u8 phy_drv_no; +- u8 perc_in_use; +- u8 reserved2[7]; +-}; +- +-/* MS-DOS FAT file system information sector (512 bytes) */ +-struct fsi_sector_t { +- u8 signature1[4]; +- u8 reserved1[480]; +- u8 signature2[4]; +- u8 free_cluster[4]; +- u8 next_cluster[4]; +- u8 reserved2[14]; +- u8 signature3[2]; +-}; +- +-/* MS-DOS FAT directory entry (32 bytes) */ +-struct dentry_t { +- u8 dummy[32]; +-}; +- +-struct dos_dentry_t { +- u8 name[DOS_NAME_LENGTH]; +- u8 attr; +- u8 lcase; +- u8 create_time_ms; +- u8 create_time[2]; +- u8 create_date[2]; +- u8 access_date[2]; +- u8 start_clu_hi[2]; +- u8 modify_time[2]; +- u8 modify_date[2]; +- u8 start_clu_lo[2]; +- u8 size[4]; +-}; +- +-/* MS-DOS FAT extended directory entry (32 bytes) */ +-struct ext_dentry_t { +- u8 order; +- u8 unicode_0_4[10]; +- u8 attr; +- u8 sysid; +- u8 checksum; +- u8 unicode_5_10[12]; +- u8 start_clu[2]; +- u8 unicode_11_12[4]; +-}; +- +-/* MS-DOS EXFAT file directory entry (32 bytes) */ +-struct file_dentry_t { +- u8 type; +- u8 num_ext; +- u8 checksum[2]; +- u8 attr[2]; +- u8 reserved1[2]; +- u8 create_time[2]; +- u8 create_date[2]; +- u8 modify_time[2]; +- u8 modify_date[2]; +- u8 access_time[2]; +- u8 access_date[2]; +- u8 create_time_ms; +- u8 modify_time_ms; +- u8 access_time_ms; +- u8 reserved2[9]; +-}; +- +-/* MS-DOS EXFAT stream extension directory entry (32 bytes) */ +-struct strm_dentry_t { +- u8 type; +- u8 flags; +- u8 reserved1; +- u8 name_len; +- u8 name_hash[2]; +- u8 reserved2[2]; +- u8 valid_size[8]; +- u8 reserved3[4]; +- u8 start_clu[4]; +- u8 size[8]; +-}; +- +-/* MS-DOS EXFAT file name directory entry (32 bytes) */ +-struct name_dentry_t { +- u8 type; +- u8 flags; +- u8 unicode_0_14[30]; +-}; +- +-/* MS-DOS EXFAT allocation bitmap directory entry (32 bytes) */ +-struct bmap_dentry_t { +- u8 type; +- u8 flags; +- u8 reserved[18]; +- u8 start_clu[4]; +- u8 size[8]; +-}; +- +-/* MS-DOS EXFAT up-case table directory entry (32 bytes) */ +-struct case_dentry_t { +- u8 type; +- u8 reserved1[3]; +- u8 checksum[4]; +- u8 reserved2[12]; +- u8 start_clu[4]; +- u8 size[8]; +-}; +- +-/* MS-DOS EXFAT volume label directory entry (32 bytes) */ +-struct volm_dentry_t { +- u8 type; +- u8 label_len; +- u8 unicode_0_10[22]; +- u8 reserved[8]; +-}; +- +-/* unused entry hint information */ +-struct uentry_t { +- u32 dir; +- s32 entry; +- struct chain_t clu; +-}; +- +-/* DOS name structure */ +-struct dos_name_t { +- u8 name[DOS_NAME_LENGTH]; +- u8 name_case; +-}; +- +-/* unicode name structure */ +-struct uni_name_t { +- u16 name[MAX_NAME_LENGTH]; +- u16 name_hash; +- u8 name_len; +-}; +- +-struct buf_cache_t { +- struct buf_cache_t *next; +- struct buf_cache_t *prev; +- struct buf_cache_t *hash_next; +- struct buf_cache_t *hash_prev; +- s32 drv; +- sector_t sec; +- u32 flag; +- struct buffer_head *buf_bh; +-}; +- +-struct fs_info_t { +- u32 drv; /* drive ID */ +- u32 vol_type; /* volume FAT type */ +- u32 vol_id; /* volume serial number */ +- +- u64 num_sectors; /* num of sectors in volume */ +- u32 num_clusters; /* num of clusters in volume */ +- u32 cluster_size; /* cluster size in bytes */ +- u32 cluster_size_bits; +- u32 sectors_per_clu; /* cluster size in sectors */ +- u32 sectors_per_clu_bits; +- +- u32 PBR_sector; /* PBR sector */ +- u32 FAT1_start_sector; /* FAT1 start sector */ +- u32 FAT2_start_sector; /* FAT2 start sector */ +- u32 root_start_sector; /* root dir start sector */ +- u32 data_start_sector; /* data area start sector */ +- u32 num_FAT_sectors; /* num of FAT sectors */ +- +- u32 root_dir; /* root dir cluster */ +- u32 dentries_in_root; /* num of dentries in root dir */ +- u32 dentries_per_clu; /* num of dentries per cluster */ +- +- u32 vol_flag; /* volume dirty flag */ +- struct buffer_head *pbr_bh; /* PBR sector */ +- +- u32 map_clu; /* allocation bitmap start cluster */ +- u32 map_sectors; /* num of allocation bitmap sectors */ +- struct buffer_head **vol_amap; /* allocation bitmap */ +- +- u16 **vol_utbl; /* upcase table */ +- +- u32 clu_srch_ptr; /* cluster search pointer */ +- u32 used_clusters; /* number of used clusters */ +- struct uentry_t hint_uentry; /* unused entry hint information */ +- +- u32 dev_ejected; /* block device operation error flag */ +- +- struct mutex v_mutex; +- +- /* FAT cache */ +- struct buf_cache_t FAT_cache_array[FAT_CACHE_SIZE]; +- struct buf_cache_t FAT_cache_lru_list; +- struct buf_cache_t FAT_cache_hash_list[FAT_CACHE_HASH_SIZE]; +- +- /* buf cache */ +- struct buf_cache_t buf_cache_array[BUF_CACHE_SIZE]; +- struct buf_cache_t buf_cache_lru_list; +- struct buf_cache_t buf_cache_hash_list[BUF_CACHE_HASH_SIZE]; +-}; +- +-#define ES_2_ENTRIES 2 +-#define ES_3_ENTRIES 3 +-#define ES_ALL_ENTRIES 0 +- +-struct entry_set_cache_t { +- /* sector number that contains file_entry */ +- sector_t sector; +- +- /* byte offset in the sector */ +- s32 offset; +- +- /* +- * flag in stream entry. +- * 01 for cluster chain, +- * 03 for contig. clusteres. +- */ +- s32 alloc_flag; +- +- u32 num_entries; +- +- /* __buf should be the last member */ +- void *__buf; +-}; +- +-#define EXFAT_ERRORS_CONT 1 /* ignore error and continue */ +-#define EXFAT_ERRORS_PANIC 2 /* panic on error */ +-#define EXFAT_ERRORS_RO 3 /* remount r/o on error */ +- +-/* ioctl command */ +-#define EXFAT_IOCTL_GET_VOLUME_ID _IOR('r', 0x12, __u32) +- +-struct exfat_mount_options { +- kuid_t fs_uid; +- kgid_t fs_gid; +- unsigned short fs_fmask; +- unsigned short fs_dmask; +- +- /* permission for setting the [am]time */ +- unsigned short allow_utime; +- +- /* codepage for shortname conversions */ +- unsigned short codepage; +- +- /* charset for filename input/display */ +- char *iocharset; +- +- unsigned char casesensitive; +- +- /* on error: continue, panic, remount-ro */ +- unsigned char errors; +-#ifdef CONFIG_STAGING_EXFAT_DISCARD +- /* flag on if -o dicard specified and device support discard() */ +- unsigned char discard; +-#endif /* CONFIG_STAGING_EXFAT_DISCARD */ +-}; +- +-#define EXFAT_HASH_BITS 8 +-#define EXFAT_HASH_SIZE BIT(EXFAT_HASH_BITS) +- +-/* +- * EXFAT file system in-core superblock data +- */ +-struct bd_info_t { +- s32 sector_size; /* in bytes */ +- s32 sector_size_bits; +- s32 sector_size_mask; +- +- /* total number of sectors in this block device */ +- s32 num_sectors; +- +- /* opened or not */ +- bool opened; +-}; +- +-struct exfat_sb_info { +- struct fs_info_t fs_info; +- struct bd_info_t bd_info; +- +- struct exfat_mount_options options; +- +- int s_dirt; +- struct mutex s_lock; +- struct nls_table *nls_disk; /* Codepage used on disk */ +- struct nls_table *nls_io; /* Charset used for input and display */ +- +- struct inode *fat_inode; +- +- spinlock_t inode_hash_lock; +- struct hlist_head inode_hashtable[EXFAT_HASH_SIZE]; +-#ifdef CONFIG_STAGING_EXFAT_KERNEL_DEBUG +- long debug_flags; +-#endif /* CONFIG_STAGING_EXFAT_KERNEL_DEBUG */ +-}; +- +-/* +- * EXFAT file system inode data in memory +- */ +-struct exfat_inode_info { +- struct file_id_t fid; +- char *target; +- /* NOTE: mmu_private is 64bits, so must hold ->i_mutex to access */ +- loff_t mmu_private; /* physically allocated size */ +- loff_t i_pos; /* on-disk position of directory entry or 0 */ +- struct hlist_node i_hash_fat; /* hash by i_location */ +- struct rw_semaphore truncate_lock; +- struct inode vfs_inode; +- struct rw_semaphore i_alloc_sem; /* protect bmap against truncate */ +-}; +- +-#define EXFAT_SB(sb) ((struct exfat_sb_info *)((sb)->s_fs_info)) +- +-static inline struct exfat_inode_info *EXFAT_I(struct inode *inode) +-{ +- return container_of(inode, struct exfat_inode_info, vfs_inode); +-} +- +-/* NLS management function */ +-u16 nls_upper(struct super_block *sb, u16 a); +-int nls_uniname_cmp(struct super_block *sb, u16 *a, u16 *b); +-void nls_uniname_to_cstring(struct super_block *sb, u8 *p_cstring, +- struct uni_name_t *p_uniname); +-void nls_cstring_to_uniname(struct super_block *sb, +- struct uni_name_t *p_uniname, u8 *p_cstring, +- bool *p_lossy); +- +-/* buffer cache management */ +-void exfat_buf_init(struct super_block *sb); +-void exfat_buf_shutdown(struct super_block *sb); +-int exfat_fat_read(struct super_block *sb, u32 loc, u32 *content); +-s32 exfat_fat_write(struct super_block *sb, u32 loc, u32 content); +-u8 *exfat_fat_getblk(struct super_block *sb, sector_t sec); +-void exfat_fat_modify(struct super_block *sb, sector_t sec); +-void exfat_fat_release_all(struct super_block *sb); +-void exfat_fat_sync(struct super_block *sb); +-u8 *exfat_buf_getblk(struct super_block *sb, sector_t sec); +-void exfat_buf_modify(struct super_block *sb, sector_t sec); +-void exfat_buf_lock(struct super_block *sb, sector_t sec); +-void exfat_buf_unlock(struct super_block *sb, sector_t sec); +-void exfat_buf_release(struct super_block *sb, sector_t sec); +-void exfat_buf_release_all(struct super_block *sb); +-void exfat_buf_sync(struct super_block *sb); +- +-/* fs management functions */ +-void fs_set_vol_flags(struct super_block *sb, u32 new_flag); +-void fs_error(struct super_block *sb); +- +-/* cluster management functions */ +-s32 count_num_clusters(struct super_block *sb, struct chain_t *dir); +-void exfat_chain_cont_cluster(struct super_block *sb, u32 chain, s32 len); +- +-/* allocation bitmap management functions */ +-s32 load_alloc_bitmap(struct super_block *sb); +-void free_alloc_bitmap(struct super_block *sb); +-void sync_alloc_bitmap(struct super_block *sb); +- +-/* upcase table management functions */ +-s32 load_upcase_table(struct super_block *sb); +-void free_upcase_table(struct super_block *sb); +- +-/* dir entry management functions */ +-struct timestamp_t *tm_current(struct timestamp_t *tm); +- +-struct dentry_t *get_entry_in_dir(struct super_block *sb, struct chain_t *p_dir, +- s32 entry, sector_t *sector); +-struct entry_set_cache_t *get_entry_set_in_dir(struct super_block *sb, +- struct chain_t *p_dir, s32 entry, +- u32 type, +- struct dentry_t **file_ep); +-void release_entry_set(struct entry_set_cache_t *es); +-s32 count_dos_name_entries(struct super_block *sb, struct chain_t *p_dir, +- u32 type); +-void update_dir_checksum(struct super_block *sb, struct chain_t *p_dir, +- s32 entry); +-void update_dir_checksum_with_entry_set(struct super_block *sb, +- struct entry_set_cache_t *es); +-bool is_dir_empty(struct super_block *sb, struct chain_t *p_dir); +- +-/* name conversion functions */ +-s32 get_num_entries_and_dos_name(struct super_block *sb, struct chain_t *p_dir, +- struct uni_name_t *p_uniname, s32 *entries, +- struct dos_name_t *p_dosname); +-u16 calc_checksum_2byte(void *data, s32 len, u16 chksum, s32 type); +- +-/* name resolution functions */ +-s32 resolve_path(struct inode *inode, char *path, struct chain_t *p_dir, +- struct uni_name_t *p_uniname); +- +-/* file operation functions */ +-s32 exfat_mount(struct super_block *sb, struct pbr_sector_t *p_pbr); +-s32 create_dir(struct inode *inode, struct chain_t *p_dir, +- struct uni_name_t *p_uniname, struct file_id_t *fid); +-s32 create_file(struct inode *inode, struct chain_t *p_dir, +- struct uni_name_t *p_uniname, u8 mode, struct file_id_t *fid); +-void remove_file(struct inode *inode, struct chain_t *p_dir, s32 entry); +-s32 exfat_rename_file(struct inode *inode, struct chain_t *p_dir, s32 old_entry, +- struct uni_name_t *p_uniname, struct file_id_t *fid); +-s32 move_file(struct inode *inode, struct chain_t *p_olddir, s32 oldentry, +- struct chain_t *p_newdir, struct uni_name_t *p_uniname, +- struct file_id_t *fid); +- +-/* sector read/write functions */ +-int sector_read(struct super_block *sb, sector_t sec, +- struct buffer_head **bh, bool read); +-int sector_write(struct super_block *sb, sector_t sec, +- struct buffer_head *bh, bool sync); +-int multi_sector_read(struct super_block *sb, sector_t sec, +- struct buffer_head **bh, s32 num_secs, bool read); +-int multi_sector_write(struct super_block *sb, sector_t sec, +- struct buffer_head *bh, s32 num_secs, bool sync); +- +-void exfat_bdev_open(struct super_block *sb); +-void exfat_bdev_close(struct super_block *sb); +-int exfat_bdev_read(struct super_block *sb, sector_t secno, +- struct buffer_head **bh, u32 num_secs, bool read); +-int exfat_bdev_write(struct super_block *sb, sector_t secno, +- struct buffer_head *bh, u32 num_secs, bool sync); +-int exfat_bdev_sync(struct super_block *sb); +- +-/* cluster operation functions */ +-s32 exfat_alloc_cluster(struct super_block *sb, s32 num_alloc, +- struct chain_t *p_chain); +-void exfat_free_cluster(struct super_block *sb, struct chain_t *p_chain, +- s32 do_relse); +-s32 exfat_count_used_clusters(struct super_block *sb); +- +-/* dir operation functions */ +-s32 exfat_find_dir_entry(struct super_block *sb, struct chain_t *p_dir, +- struct uni_name_t *p_uniname, s32 num_entries, +- struct dos_name_t *p_dosname, u32 type); +-void exfat_delete_dir_entry(struct super_block *sb, struct chain_t *p_dir, +- s32 entry, s32 order, s32 num_entries); +-void exfat_get_uni_name_from_ext_entry(struct super_block *sb, +- struct chain_t *p_dir, s32 entry, +- u16 *uniname); +-s32 exfat_count_ext_entries(struct super_block *sb, struct chain_t *p_dir, +- s32 entry, struct dentry_t *p_entry); +-s32 exfat_calc_num_entries(struct uni_name_t *p_uniname); +- +-/* dir entry getter/setter */ +-u32 exfat_get_entry_type(struct dentry_t *p_entry); +-u32 exfat_get_entry_attr(struct dentry_t *p_entry); +-void exfat_set_entry_attr(struct dentry_t *p_entry, u32 attr); +-u8 exfat_get_entry_flag(struct dentry_t *p_entry); +-void exfat_set_entry_flag(struct dentry_t *p_entry, u8 flags); +-u32 exfat_get_entry_clu0(struct dentry_t *p_entry); +-void exfat_set_entry_clu0(struct dentry_t *p_entry, u32 start_clu); +-u64 exfat_get_entry_size(struct dentry_t *p_entry); +-void exfat_set_entry_size(struct dentry_t *p_entry, u64 size); +-void exfat_get_entry_time(struct dentry_t *p_entry, struct timestamp_t *tp, +- u8 mode); +-void exfat_set_entry_time(struct dentry_t *p_entry, struct timestamp_t *tp, +- u8 mode); +- +-extern const u8 uni_upcase[]; +-#endif /* _EXFAT_H */ +diff -Nurp linux-5.6.3.orig/drivers/staging/exfat/exfat_nls.c linux-5.6.3/drivers/staging/exfat/exfat_nls.c +--- linux-5.6.3.orig/drivers/staging/exfat/exfat_nls.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/drivers/staging/exfat/exfat_nls.c 1970-01-01 02:00:00.000000000 +0200 +@@ -1,212 +0,0 @@ +-// SPDX-License-Identifier: GPL-2.0-or-later +-/* +- * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. +- */ +- +-#include +-#include +-#include "exfat.h" +- +-static u16 bad_uni_chars[] = { +- /* " * / : < > ? \ | */ +- 0x0022, 0x002A, 0x002F, 0x003A, +- 0x003C, 0x003E, 0x003F, 0x005C, 0x007C, +- 0 +-}; +- +-static int convert_ch_to_uni(struct nls_table *nls, u16 *uni, u8 *ch, +- bool *lossy) +-{ +- int len; +- +- *uni = 0x0; +- +- if (ch[0] < 0x80) { +- *uni = (u16)ch[0]; +- return 1; +- } +- +- len = nls->char2uni(ch, NLS_MAX_CHARSET_SIZE, uni); +- if (len < 0) { +- /* conversion failed */ +- pr_info("%s: fail to use nls\n", __func__); +- if (lossy) +- *lossy = true; +- *uni = (u16)'_'; +- if (!strcmp(nls->charset, "utf8")) +- return 1; +- else +- return 2; +- } +- +- return len; +-} +- +-static int convert_uni_to_ch(struct nls_table *nls, u8 *ch, u16 uni, +- bool *lossy) +-{ +- int len; +- +- ch[0] = 0x0; +- +- if (uni < 0x0080) { +- ch[0] = (u8)uni; +- return 1; +- } +- +- len = nls->uni2char(uni, ch, NLS_MAX_CHARSET_SIZE); +- if (len < 0) { +- /* conversion failed */ +- pr_info("%s: fail to use nls\n", __func__); +- if (lossy) +- *lossy = true; +- ch[0] = '_'; +- return 1; +- } +- +- return len; +-} +- +-u16 nls_upper(struct super_block *sb, u16 a) +-{ +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- if (EXFAT_SB(sb)->options.casesensitive) +- return a; +- if (p_fs->vol_utbl && p_fs->vol_utbl[get_col_index(a)]) +- return p_fs->vol_utbl[get_col_index(a)][get_row_index(a)]; +- else +- return a; +-} +- +-static u16 *nls_wstrchr(u16 *str, u16 wchar) +-{ +- while (*str) { +- if (*(str++) == wchar) +- return str; +- } +- +- return NULL; +-} +- +-int nls_uniname_cmp(struct super_block *sb, u16 *a, u16 *b) +-{ +- int i; +- +- for (i = 0; i < MAX_NAME_LENGTH; i++, a++, b++) { +- if (nls_upper(sb, *a) != nls_upper(sb, *b)) +- return 1; +- if (*a == 0x0) +- return 0; +- } +- return 0; +-} +- +-void nls_uniname_to_cstring(struct super_block *sb, u8 *p_cstring, +- struct uni_name_t *p_uniname) +-{ +- int i, j, len; +- u8 buf[MAX_CHARSET_SIZE]; +- u16 *uniname = p_uniname->name; +- struct nls_table *nls = EXFAT_SB(sb)->nls_io; +- +- if (!nls) { +- len = utf16s_to_utf8s(uniname, MAX_NAME_LENGTH, +- UTF16_HOST_ENDIAN, p_cstring, +- MAX_NAME_LENGTH); +- p_cstring[len] = 0; +- return; +- } +- +- i = 0; +- while (i < (MAX_NAME_LENGTH - 1)) { +- if (*uniname == (u16)'\0') +- break; +- +- len = convert_uni_to_ch(nls, buf, *uniname, NULL); +- +- if (len > 1) { +- for (j = 0; j < len; j++) +- *p_cstring++ = (char)*(buf + j); +- } else { /* len == 1 */ +- *p_cstring++ = (char)*buf; +- } +- +- uniname++; +- i++; +- } +- +- *p_cstring = '\0'; +-} +- +-void nls_cstring_to_uniname(struct super_block *sb, +- struct uni_name_t *p_uniname, u8 *p_cstring, +- bool *p_lossy) +-{ +- int i, j; +- bool lossy = false; +- u8 *end_of_name; +- u8 upname[MAX_NAME_LENGTH * 2]; +- u16 *uniname = p_uniname->name; +- struct nls_table *nls = EXFAT_SB(sb)->nls_io; +- +- /* strip all trailing spaces */ +- end_of_name = p_cstring + strlen(p_cstring); +- +- while (*(--end_of_name) == ' ') { +- if (end_of_name < p_cstring) +- break; +- } +- *(++end_of_name) = '\0'; +- +- if (strcmp(p_cstring, ".") && strcmp(p_cstring, "..")) { +- /* strip all trailing periods */ +- while (*(--end_of_name) == '.') { +- if (end_of_name < p_cstring) +- break; +- } +- *(++end_of_name) = '\0'; +- } +- +- if (*p_cstring == '\0') +- lossy = true; +- +- if (!nls) { +- i = utf8s_to_utf16s(p_cstring, MAX_NAME_LENGTH, +- UTF16_HOST_ENDIAN, uniname, +- MAX_NAME_LENGTH); +- for (j = 0; j < i; j++) +- SET16_A(upname + j * 2, nls_upper(sb, uniname[j])); +- uniname[i] = '\0'; +- } else { +- i = 0; +- j = 0; +- while (j < (MAX_NAME_LENGTH - 1)) { +- if (*(p_cstring + i) == '\0') +- break; +- +- i += convert_ch_to_uni(nls, uniname, +- (u8 *)(p_cstring + i), &lossy); +- +- if ((*uniname < 0x0020) || +- nls_wstrchr(bad_uni_chars, *uniname)) +- lossy = true; +- +- SET16_A(upname + j * 2, nls_upper(sb, *uniname)); +- +- uniname++; +- j++; +- } +- +- if (*(p_cstring + i) != '\0') +- lossy = true; +- *uniname = (u16)'\0'; +- } +- +- p_uniname->name_len = j; +- p_uniname->name_hash = calc_checksum_2byte(upname, j << 1, 0, +- CS_DEFAULT); +- +- if (p_lossy) +- *p_lossy = lossy; +-} +diff -Nurp linux-5.6.3.orig/drivers/staging/exfat/exfat_super.c linux-5.6.3/drivers/staging/exfat/exfat_super.c +--- linux-5.6.3.orig/drivers/staging/exfat/exfat_super.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/drivers/staging/exfat/exfat_super.c 1970-01-01 02:00:00.000000000 +0200 +@@ -1,3883 +0,0 @@ +-// SPDX-License-Identifier: GPL-2.0-or-later +-/* +- * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. +- */ +- +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +-#include +- +-#define EXFAT_VERSION "1.3.0" +- +-#include "exfat.h" +- +-static struct kmem_cache *exfat_inode_cachep; +- +-static int exfat_default_codepage = CONFIG_STAGING_EXFAT_DEFAULT_CODEPAGE; +-static char exfat_default_iocharset[] = CONFIG_STAGING_EXFAT_DEFAULT_IOCHARSET; +- +-#define INC_IVERSION(x) (inode_inc_iversion(x)) +-#define GET_IVERSION(x) (inode_peek_iversion_raw(x)) +-#define SET_IVERSION(x, y) (inode_set_iversion(x, y)) +- +-static struct inode *exfat_iget(struct super_block *sb, loff_t i_pos); +-static int exfat_sync_inode(struct inode *inode); +-static struct inode *exfat_build_inode(struct super_block *sb, +- struct file_id_t *fid, loff_t i_pos); +-static int exfat_write_inode(struct inode *inode, +- struct writeback_control *wbc); +-static void exfat_write_super(struct super_block *sb); +- +-#define UNIX_SECS_1980 315532800L +-#define UNIX_SECS_2108 4354819200L +- +-/* Convert a FAT time/date pair to a UNIX date (seconds since 1 1 70). */ +-static void exfat_time_fat2unix(struct timespec64 *ts, struct date_time_t *tp) +-{ +- ts->tv_sec = mktime64(tp->Year + 1980, tp->Month + 1, tp->Day, +- tp->Hour, tp->Minute, tp->Second); +- +- ts->tv_nsec = tp->MilliSecond * NSEC_PER_MSEC; +-} +- +-/* Convert linear UNIX date to a FAT time/date pair. */ +-static void exfat_time_unix2fat(struct timespec64 *ts, struct date_time_t *tp) +-{ +- time64_t second = ts->tv_sec; +- struct tm tm; +- +- time64_to_tm(second, 0, &tm); +- +- if (second < UNIX_SECS_1980) { +- tp->MilliSecond = 0; +- tp->Second = 0; +- tp->Minute = 0; +- tp->Hour = 0; +- tp->Day = 1; +- tp->Month = 1; +- tp->Year = 0; +- return; +- } +- +- if (second >= UNIX_SECS_2108) { +- tp->MilliSecond = 999; +- tp->Second = 59; +- tp->Minute = 59; +- tp->Hour = 23; +- tp->Day = 31; +- tp->Month = 12; +- tp->Year = 127; +- return; +- } +- +- tp->MilliSecond = ts->tv_nsec / NSEC_PER_MSEC; +- tp->Second = tm.tm_sec; +- tp->Minute = tm.tm_min; +- tp->Hour = tm.tm_hour; +- tp->Day = tm.tm_mday; +- tp->Month = tm.tm_mon + 1; +- tp->Year = tm.tm_year + 1900 - 1980; +-} +- +-struct timestamp_t *tm_current(struct timestamp_t *tp) +-{ +- time64_t second = ktime_get_real_seconds(); +- struct tm tm; +- +- time64_to_tm(second, 0, &tm); +- +- if (second < UNIX_SECS_1980) { +- tp->sec = 0; +- tp->min = 0; +- tp->hour = 0; +- tp->day = 1; +- tp->mon = 1; +- tp->year = 0; +- return tp; +- } +- +- if (second >= UNIX_SECS_2108) { +- tp->sec = 59; +- tp->min = 59; +- tp->hour = 23; +- tp->day = 31; +- tp->mon = 12; +- tp->year = 127; +- return tp; +- } +- +- tp->sec = tm.tm_sec; +- tp->min = tm.tm_min; +- tp->hour = tm.tm_hour; +- tp->day = tm.tm_mday; +- tp->mon = tm.tm_mon + 1; +- tp->year = tm.tm_year + 1900 - 1980; +- +- return tp; +-} +- +-static void __lock_super(struct super_block *sb) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- +- mutex_lock(&sbi->s_lock); +-} +- +-static void __unlock_super(struct super_block *sb) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- +- mutex_unlock(&sbi->s_lock); +-} +- +-static int __is_sb_dirty(struct super_block *sb) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- +- return sbi->s_dirt; +-} +- +-static void __set_sb_clean(struct super_block *sb) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- +- sbi->s_dirt = 0; +-} +- +-static int __exfat_revalidate(struct dentry *dentry) +-{ +- return 0; +-} +- +-static int exfat_revalidate(struct dentry *dentry, unsigned int flags) +-{ +- if (flags & LOOKUP_RCU) +- return -ECHILD; +- +- if (dentry->d_inode) +- return 1; +- return __exfat_revalidate(dentry); +-} +- +-static int exfat_revalidate_ci(struct dentry *dentry, unsigned int flags) +-{ +- if (flags & LOOKUP_RCU) +- return -ECHILD; +- +- if (dentry->d_inode) +- return 1; +- +- if (!flags) +- return 0; +- +- if (flags & (LOOKUP_CREATE | LOOKUP_RENAME_TARGET)) +- return 0; +- +- return __exfat_revalidate(dentry); +-} +- +-static unsigned int __exfat_striptail_len(unsigned int len, const char *name) +-{ +- while (len && name[len - 1] == '.') +- len--; +- return len; +-} +- +-static unsigned int exfat_striptail_len(const struct qstr *qstr) +-{ +- return __exfat_striptail_len(qstr->len, qstr->name); +-} +- +-static int exfat_d_hash(const struct dentry *dentry, struct qstr *qstr) +-{ +- qstr->hash = full_name_hash(dentry, qstr->name, +- exfat_striptail_len(qstr)); +- return 0; +-} +- +-static int exfat_d_hashi(const struct dentry *dentry, struct qstr *qstr) +-{ +- struct super_block *sb = dentry->d_sb; +- const unsigned char *name; +- unsigned int len; +- unsigned long hash; +- +- name = qstr->name; +- len = exfat_striptail_len(qstr); +- +- hash = init_name_hash(dentry); +- while (len--) +- hash = partial_name_hash(nls_upper(sb, *name++), hash); +- qstr->hash = end_name_hash(hash); +- +- return 0; +-} +- +-static int exfat_cmpi(const struct dentry *dentry, unsigned int len, +- const char *str, const struct qstr *name) +-{ +- struct nls_table *t = EXFAT_SB(dentry->d_sb)->nls_io; +- unsigned int alen, blen; +- +- alen = exfat_striptail_len(name); +- blen = __exfat_striptail_len(len, str); +- if (alen == blen) { +- if (!t) { +- if (strncasecmp(name->name, str, alen) == 0) +- return 0; +- } else { +- if (nls_strnicmp(t, name->name, str, alen) == 0) +- return 0; +- } +- } +- return 1; +-} +- +-static int exfat_cmp(const struct dentry *dentry, unsigned int len, +- const char *str, const struct qstr *name) +-{ +- unsigned int alen, blen; +- +- alen = exfat_striptail_len(name); +- blen = __exfat_striptail_len(len, str); +- if (alen == blen) { +- if (strncmp(name->name, str, alen) == 0) +- return 0; +- } +- return 1; +-} +- +-static const struct dentry_operations exfat_ci_dentry_ops = { +- .d_revalidate = exfat_revalidate_ci, +- .d_hash = exfat_d_hashi, +- .d_compare = exfat_cmpi, +-}; +- +-static const struct dentry_operations exfat_dentry_ops = { +- .d_revalidate = exfat_revalidate, +- .d_hash = exfat_d_hash, +- .d_compare = exfat_cmp, +-}; +- +-static DEFINE_MUTEX(z_mutex); +- +-static inline void fs_sync(struct super_block *sb, bool do_sync) +-{ +- if (do_sync) +- exfat_bdev_sync(sb); +-} +- +-/* +- * If ->i_mode can't hold S_IWUGO (i.e. ATTR_RO), we use ->i_attrs to +- * save ATTR_RO instead of ->i_mode. +- * +- * If it's directory and !sbi->options.rodir, ATTR_RO isn't read-only +- * bit, it's just used as flag for app. +- */ +-static inline int exfat_mode_can_hold_ro(struct inode *inode) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(inode->i_sb); +- +- if (S_ISDIR(inode->i_mode)) +- return 0; +- +- if ((~sbi->options.fs_fmask) & 0222) +- return 1; +- return 0; +-} +- +-/* Convert attribute bits and a mask to the UNIX mode. */ +-static inline mode_t exfat_make_mode(struct exfat_sb_info *sbi, u32 attr, +- mode_t mode) +-{ +- if ((attr & ATTR_READONLY) && !(attr & ATTR_SUBDIR)) +- mode &= ~0222; +- +- if (attr & ATTR_SUBDIR) +- return (mode & ~sbi->options.fs_dmask) | S_IFDIR; +- else if (attr & ATTR_SYMLINK) +- return (mode & ~sbi->options.fs_dmask) | S_IFLNK; +- else +- return (mode & ~sbi->options.fs_fmask) | S_IFREG; +-} +- +-/* Return the FAT attribute byte for this inode */ +-static inline u32 exfat_make_attr(struct inode *inode) +-{ +- if (exfat_mode_can_hold_ro(inode) && !(inode->i_mode & 0222)) +- return (EXFAT_I(inode)->fid.attr) | ATTR_READONLY; +- else +- return EXFAT_I(inode)->fid.attr; +-} +- +-static inline void exfat_save_attr(struct inode *inode, u32 attr) +-{ +- if (exfat_mode_can_hold_ro(inode)) +- EXFAT_I(inode)->fid.attr = attr & ATTR_RWMASK; +- else +- EXFAT_I(inode)->fid.attr = attr & (ATTR_RWMASK | ATTR_READONLY); +-} +- +-static int ffsMountVol(struct super_block *sb) +-{ +- int i, ret; +- struct pbr_sector_t *p_pbr; +- struct buffer_head *tmp_bh = NULL; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- pr_info("[EXFAT] trying to mount...\n"); +- +- mutex_lock(&z_mutex); +- +- exfat_buf_init(sb); +- +- mutex_init(&p_fs->v_mutex); +- p_fs->dev_ejected = 0; +- +- /* open the block device */ +- exfat_bdev_open(sb); +- +- if (p_bd->sector_size < sb->s_blocksize) { +- printk(KERN_INFO "EXFAT: mount failed - sector size %d less than blocksize %ld\n", +- p_bd->sector_size, sb->s_blocksize); +- ret = -EINVAL; +- goto out; +- } +- if (p_bd->sector_size > sb->s_blocksize) +- sb_set_blocksize(sb, p_bd->sector_size); +- +- /* read Sector 0 */ +- if (sector_read(sb, 0, &tmp_bh, 1) != 0) { +- ret = -EIO; +- goto out; +- } +- +- p_fs->PBR_sector = 0; +- +- p_pbr = (struct pbr_sector_t *)tmp_bh->b_data; +- +- /* check the validity of PBR */ +- if (GET16_A(p_pbr->signature) != PBR_SIGNATURE) { +- brelse(tmp_bh); +- exfat_bdev_close(sb); +- ret = -EFSCORRUPTED; +- goto out; +- } +- +- /* fill fs_struct */ +- for (i = 0; i < 53; i++) +- if (p_pbr->bpb[i]) +- break; +- +- if (i < 53) { +- /* Not sure how we'd get here, but complain if it does */ +- ret = -EINVAL; +- pr_info("EXFAT: Attempted to mount VFAT filesystem\n"); +- goto out; +- } else { +- ret = exfat_mount(sb, p_pbr); +- } +- +- brelse(tmp_bh); +- +- if (ret) { +- exfat_bdev_close(sb); +- goto out; +- } +- +- ret = load_alloc_bitmap(sb); +- if (ret) { +- exfat_bdev_close(sb); +- goto out; +- } +- ret = load_upcase_table(sb); +- if (ret) { +- free_alloc_bitmap(sb); +- exfat_bdev_close(sb); +- goto out; +- } +- +- if (p_fs->dev_ejected) { +- free_upcase_table(sb); +- free_alloc_bitmap(sb); +- exfat_bdev_close(sb); +- ret = -EIO; +- goto out; +- } +- +- pr_info("[EXFAT] mounted successfully\n"); +- +-out: +- mutex_unlock(&z_mutex); +- +- return ret; +-} +- +-static int ffsUmountVol(struct super_block *sb) +-{ +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- int err = 0; +- +- pr_info("[EXFAT] trying to unmount...\n"); +- +- mutex_lock(&z_mutex); +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- fs_sync(sb, true); +- fs_set_vol_flags(sb, VOL_CLEAN); +- +- free_upcase_table(sb); +- free_alloc_bitmap(sb); +- +- exfat_fat_release_all(sb); +- exfat_buf_release_all(sb); +- +- /* close the block device */ +- exfat_bdev_close(sb); +- +- if (p_fs->dev_ejected) { +- pr_info("[EXFAT] unmounted with media errors. Device is already ejected.\n"); +- err = -EIO; +- } +- +- exfat_buf_shutdown(sb); +- +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- mutex_unlock(&z_mutex); +- +- pr_info("[EXFAT] unmounted successfully\n"); +- +- return err; +-} +- +-static int ffsGetVolInfo(struct super_block *sb, struct vol_info_t *info) +-{ +- int err = 0; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- /* check the validity of pointer parameters */ +- if (!info) +- return -EINVAL; +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- if (p_fs->used_clusters == UINT_MAX) +- p_fs->used_clusters = exfat_count_used_clusters(sb); +- +- info->FatType = p_fs->vol_type; +- info->ClusterSize = p_fs->cluster_size; +- info->NumClusters = p_fs->num_clusters - 2; /* clu 0 & 1 */ +- info->UsedClusters = p_fs->used_clusters; +- info->FreeClusters = info->NumClusters - info->UsedClusters; +- +- if (p_fs->dev_ejected) +- err = -EIO; +- +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return err; +-} +- +-static int ffsSyncVol(struct super_block *sb, bool do_sync) +-{ +- int err = 0; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- /* synchronize the file system */ +- fs_sync(sb, do_sync); +- fs_set_vol_flags(sb, VOL_CLEAN); +- +- if (p_fs->dev_ejected) +- err = -EIO; +- +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return err; +-} +- +-/*----------------------------------------------------------------------*/ +-/* File Operation Functions */ +-/*----------------------------------------------------------------------*/ +- +-static int ffsLookupFile(struct inode *inode, char *path, struct file_id_t *fid) +-{ +- int ret, dentry, num_entries; +- struct chain_t dir; +- struct uni_name_t uni_name; +- struct dos_name_t dos_name; +- struct dentry_t *ep, *ep2; +- struct entry_set_cache_t *es = NULL; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- pr_debug("%s entered\n", __func__); +- +- /* check the validity of pointer parameters */ +- if (!fid || !path || (*path == '\0')) +- return -EINVAL; +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- /* check the validity of directory name in the given pathname */ +- ret = resolve_path(inode, path, &dir, &uni_name); +- if (ret) +- goto out; +- +- ret = get_num_entries_and_dos_name(sb, &dir, &uni_name, &num_entries, +- &dos_name); +- if (ret) +- goto out; +- +- /* search the file name for directories */ +- dentry = exfat_find_dir_entry(sb, &dir, &uni_name, num_entries, +- &dos_name, TYPE_ALL); +- if (dentry < -1) { +- ret = -ENOENT; +- goto out; +- } +- +- fid->dir.dir = dir.dir; +- fid->dir.size = dir.size; +- fid->dir.flags = dir.flags; +- fid->entry = dentry; +- +- if (dentry == -1) { +- fid->type = TYPE_DIR; +- fid->rwoffset = 0; +- fid->hint_last_off = -1; +- +- fid->attr = ATTR_SUBDIR; +- fid->flags = 0x01; +- fid->size = 0; +- fid->start_clu = p_fs->root_dir; +- } else { +- es = get_entry_set_in_dir(sb, &dir, dentry, +- ES_2_ENTRIES, &ep); +- if (!es) { +- ret = -ENOENT; +- goto out; +- } +- ep2 = ep + 1; +- +- fid->type = exfat_get_entry_type(ep); +- fid->rwoffset = 0; +- fid->hint_last_off = -1; +- fid->attr = exfat_get_entry_attr(ep); +- +- fid->size = exfat_get_entry_size(ep2); +- if ((fid->type == TYPE_FILE) && (fid->size == 0)) { +- fid->flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01; +- fid->start_clu = CLUSTER_32(~0); +- } else { +- fid->flags = exfat_get_entry_flag(ep2); +- fid->start_clu = exfat_get_entry_clu0(ep2); +- } +- +- release_entry_set(es); +- } +- +- if (p_fs->dev_ejected) +- ret = -EIO; +-out: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return ret; +-} +- +-static int ffsCreateFile(struct inode *inode, char *path, u8 mode, +- struct file_id_t *fid) +-{ +- struct chain_t dir; +- struct uni_name_t uni_name; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- int ret = 0; +- +- /* check the validity of pointer parameters */ +- if (!fid || !path || (*path == '\0')) +- return -EINVAL; +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- /* check the validity of directory name in the given pathname */ +- ret = resolve_path(inode, path, &dir, &uni_name); +- if (ret) +- goto out; +- +- fs_set_vol_flags(sb, VOL_DIRTY); +- +- /* create a new file */ +- ret = create_file(inode, &dir, &uni_name, mode, fid); +- +-#ifndef CONFIG_STAGING_EXFAT_DELAYED_SYNC +- fs_sync(sb, true); +- fs_set_vol_flags(sb, VOL_CLEAN); +-#endif +- +- if (p_fs->dev_ejected) +- ret = -EIO; +- +-out: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return ret; +-} +- +-static int ffsReadFile(struct inode *inode, struct file_id_t *fid, void *buffer, +- u64 count, u64 *rcount) +-{ +- s32 offset, sec_offset, clu_offset; +- u32 clu; +- int ret = 0; +- sector_t LogSector; +- u64 oneblkread, read_bytes; +- struct buffer_head *tmp_bh = NULL; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- /* check the validity of the given file id */ +- if (!fid) +- return -EINVAL; +- +- /* check the validity of pointer parameters */ +- if (!buffer) +- return -EINVAL; +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- /* check if the given file ID is opened */ +- if (fid->type != TYPE_FILE) { +- ret = -EPERM; +- goto out; +- } +- +- if (fid->rwoffset > fid->size) +- fid->rwoffset = fid->size; +- +- if (count > (fid->size - fid->rwoffset)) +- count = fid->size - fid->rwoffset; +- +- if (count == 0) { +- if (rcount) +- *rcount = 0; +- ret = 0; +- goto out; +- } +- +- read_bytes = 0; +- +- while (count > 0) { +- clu_offset = (s32)(fid->rwoffset >> p_fs->cluster_size_bits); +- clu = fid->start_clu; +- +- if (fid->flags == 0x03) { +- clu += clu_offset; +- } else { +- /* hint information */ +- if ((clu_offset > 0) && (fid->hint_last_off > 0) && +- (clu_offset >= fid->hint_last_off)) { +- clu_offset -= fid->hint_last_off; +- clu = fid->hint_last_clu; +- } +- +- while (clu_offset > 0) { +- /* clu = exfat_fat_read(sb, clu); */ +- if (exfat_fat_read(sb, clu, &clu) == -1) { +- ret = -EIO; +- goto out; +- } +- +- clu_offset--; +- } +- } +- +- /* hint information */ +- fid->hint_last_off = (s32)(fid->rwoffset >> +- p_fs->cluster_size_bits); +- fid->hint_last_clu = clu; +- +- /* byte offset in cluster */ +- offset = (s32)(fid->rwoffset & (p_fs->cluster_size - 1)); +- +- /* sector offset in cluster */ +- sec_offset = offset >> p_bd->sector_size_bits; +- +- /* byte offset in sector */ +- offset &= p_bd->sector_size_mask; +- +- LogSector = START_SECTOR(clu) + sec_offset; +- +- oneblkread = (u64)(p_bd->sector_size - offset); +- if (oneblkread > count) +- oneblkread = count; +- +- if ((offset == 0) && (oneblkread == p_bd->sector_size)) { +- if (sector_read(sb, LogSector, &tmp_bh, 1) != +- 0) +- goto err_out; +- memcpy((char *)buffer + read_bytes, +- (char *)tmp_bh->b_data, (s32)oneblkread); +- } else { +- if (sector_read(sb, LogSector, &tmp_bh, 1) != +- 0) +- goto err_out; +- memcpy((char *)buffer + read_bytes, +- (char *)tmp_bh->b_data + offset, +- (s32)oneblkread); +- } +- count -= oneblkread; +- read_bytes += oneblkread; +- fid->rwoffset += oneblkread; +- } +- brelse(tmp_bh); +- +-/* How did this ever work and not leak a brlse()?? */ +-err_out: +- /* set the size of read bytes */ +- if (rcount) +- *rcount = read_bytes; +- +- if (p_fs->dev_ejected) +- ret = -EIO; +- +-out: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return ret; +-} +- +-static int ffsWriteFile(struct inode *inode, struct file_id_t *fid, +- void *buffer, u64 count, u64 *wcount) +-{ +- bool modified = false; +- s32 offset, sec_offset, clu_offset; +- s32 num_clusters, num_alloc, num_alloced = (s32)~0; +- int ret = 0; +- u32 clu, last_clu; +- sector_t LogSector; +- u64 oneblkwrite, write_bytes; +- struct chain_t new_clu; +- struct timestamp_t tm; +- struct dentry_t *ep, *ep2; +- struct entry_set_cache_t *es = NULL; +- struct buffer_head *tmp_bh = NULL; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- +- /* check the validity of the given file id */ +- if (!fid) +- return -EINVAL; +- +- /* check the validity of pointer parameters */ +- if (!buffer) +- return -EINVAL; +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- /* check if the given file ID is opened */ +- if (fid->type != TYPE_FILE) { +- ret = -EPERM; +- goto out; +- } +- +- if (fid->rwoffset > fid->size) +- fid->rwoffset = fid->size; +- +- if (count == 0) { +- if (wcount) +- *wcount = 0; +- ret = 0; +- goto out; +- } +- +- fs_set_vol_flags(sb, VOL_DIRTY); +- +- if (fid->size == 0) +- num_clusters = 0; +- else +- num_clusters = (s32)((fid->size - 1) >> +- p_fs->cluster_size_bits) + 1; +- +- write_bytes = 0; +- +- while (count > 0) { +- clu_offset = (s32)(fid->rwoffset >> p_fs->cluster_size_bits); +- clu = fid->start_clu; +- last_clu = fid->start_clu; +- +- if (fid->flags == 0x03) { +- if ((clu_offset > 0) && (clu != CLUSTER_32(~0))) { +- last_clu += clu_offset - 1; +- +- if (clu_offset == num_clusters) +- clu = CLUSTER_32(~0); +- else +- clu += clu_offset; +- } +- } else { +- /* hint information */ +- if ((clu_offset > 0) && (fid->hint_last_off > 0) && +- (clu_offset >= fid->hint_last_off)) { +- clu_offset -= fid->hint_last_off; +- clu = fid->hint_last_clu; +- } +- +- while ((clu_offset > 0) && (clu != CLUSTER_32(~0))) { +- last_clu = clu; +- /* clu = exfat_fat_read(sb, clu); */ +- if (exfat_fat_read(sb, clu, &clu) == -1) { +- ret = -EIO; +- goto out; +- } +- clu_offset--; +- } +- } +- +- if (clu == CLUSTER_32(~0)) { +- num_alloc = (s32)((count - 1) >> +- p_fs->cluster_size_bits) + 1; +- new_clu.dir = (last_clu == CLUSTER_32(~0)) ? +- CLUSTER_32(~0) : last_clu + 1; +- new_clu.size = 0; +- new_clu.flags = fid->flags; +- +- /* (1) allocate a chain of clusters */ +- num_alloced = exfat_alloc_cluster(sb, +- num_alloc, +- &new_clu); +- if (num_alloced == 0) +- break; +- if (num_alloced < 0) { +- ret = num_alloced; +- goto out; +- } +- +- /* (2) append to the FAT chain */ +- if (last_clu == CLUSTER_32(~0)) { +- if (new_clu.flags == 0x01) +- fid->flags = 0x01; +- fid->start_clu = new_clu.dir; +- modified = true; +- } else { +- if (new_clu.flags != fid->flags) { +- exfat_chain_cont_cluster(sb, +- fid->start_clu, +- num_clusters); +- fid->flags = 0x01; +- modified = true; +- } +- if (new_clu.flags == 0x01) +- exfat_fat_write(sb, last_clu, new_clu.dir); +- } +- +- num_clusters += num_alloced; +- clu = new_clu.dir; +- } +- +- /* hint information */ +- fid->hint_last_off = (s32)(fid->rwoffset >> +- p_fs->cluster_size_bits); +- fid->hint_last_clu = clu; +- +- /* byte offset in cluster */ +- offset = (s32)(fid->rwoffset & (p_fs->cluster_size - 1)); +- +- /* sector offset in cluster */ +- sec_offset = offset >> p_bd->sector_size_bits; +- +- /* byte offset in sector */ +- offset &= p_bd->sector_size_mask; +- +- LogSector = START_SECTOR(clu) + sec_offset; +- +- oneblkwrite = (u64)(p_bd->sector_size - offset); +- if (oneblkwrite > count) +- oneblkwrite = count; +- +- if ((offset == 0) && (oneblkwrite == p_bd->sector_size)) { +- if (sector_read(sb, LogSector, &tmp_bh, 0) != +- 0) +- goto err_out; +- memcpy((char *)tmp_bh->b_data, +- (char *)buffer + write_bytes, (s32)oneblkwrite); +- if (sector_write(sb, LogSector, tmp_bh, 0) != +- 0) { +- brelse(tmp_bh); +- goto err_out; +- } +- } else { +- if ((offset > 0) || +- ((fid->rwoffset + oneblkwrite) < fid->size)) { +- if (sector_read(sb, LogSector, &tmp_bh, 1) != +- 0) +- goto err_out; +- } else { +- if (sector_read(sb, LogSector, &tmp_bh, 0) != +- 0) +- goto err_out; +- } +- +- memcpy((char *)tmp_bh->b_data + offset, +- (char *)buffer + write_bytes, (s32)oneblkwrite); +- if (sector_write(sb, LogSector, tmp_bh, 0) != +- 0) { +- brelse(tmp_bh); +- goto err_out; +- } +- } +- +- count -= oneblkwrite; +- write_bytes += oneblkwrite; +- fid->rwoffset += oneblkwrite; +- +- fid->attr |= ATTR_ARCHIVE; +- +- if (fid->size < fid->rwoffset) { +- fid->size = fid->rwoffset; +- modified = true; +- } +- } +- +- brelse(tmp_bh); +- +- /* (3) update the direcoty entry */ +- es = get_entry_set_in_dir(sb, &fid->dir, fid->entry, +- ES_ALL_ENTRIES, &ep); +- if (!es) +- goto err_out; +- ep2 = ep + 1; +- +- exfat_set_entry_time(ep, tm_current(&tm), TM_MODIFY); +- exfat_set_entry_attr(ep, fid->attr); +- +- if (modified) { +- if (exfat_get_entry_flag(ep2) != fid->flags) +- exfat_set_entry_flag(ep2, fid->flags); +- +- if (exfat_get_entry_size(ep2) != fid->size) +- exfat_set_entry_size(ep2, fid->size); +- +- if (exfat_get_entry_clu0(ep2) != fid->start_clu) +- exfat_set_entry_clu0(ep2, fid->start_clu); +- } +- +- update_dir_checksum_with_entry_set(sb, es); +- release_entry_set(es); +- +-#ifndef CONFIG_STAGING_EXFAT_DELAYED_SYNC +- fs_sync(sb, true); +- fs_set_vol_flags(sb, VOL_CLEAN); +-#endif +- +-err_out: +- /* set the size of written bytes */ +- if (wcount) +- *wcount = write_bytes; +- +- if (num_alloced == 0) +- ret = -ENOSPC; +- +- else if (p_fs->dev_ejected) +- ret = -EIO; +- +-out: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return ret; +-} +- +-static int ffsTruncateFile(struct inode *inode, u64 old_size, u64 new_size) +-{ +- s32 num_clusters; +- u32 last_clu = CLUSTER_32(0); +- int ret = 0; +- struct chain_t clu; +- struct timestamp_t tm; +- struct dentry_t *ep, *ep2; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct file_id_t *fid = &(EXFAT_I(inode)->fid); +- struct entry_set_cache_t *es = NULL; +- +- pr_debug("%s entered (inode %p size %llu)\n", __func__, inode, +- new_size); +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- /* check if the given file ID is opened */ +- if (fid->type != TYPE_FILE) { +- ret = -EPERM; +- goto out; +- } +- +- if (fid->size != old_size) { +- pr_err("[EXFAT] truncate : can't skip it because of size-mismatch(old:%lld->fid:%lld).\n", +- old_size, fid->size); +- } +- +- if (old_size <= new_size) { +- ret = 0; +- goto out; +- } +- +- fs_set_vol_flags(sb, VOL_DIRTY); +- +- clu.dir = fid->start_clu; +- clu.size = (s32)((old_size - 1) >> p_fs->cluster_size_bits) + 1; +- clu.flags = fid->flags; +- +- if (new_size > 0) { +- num_clusters = (s32)((new_size - 1) >> +- p_fs->cluster_size_bits) + 1; +- +- if (clu.flags == 0x03) { +- clu.dir += num_clusters; +- } else { +- while (num_clusters > 0) { +- last_clu = clu.dir; +- if (exfat_fat_read(sb, clu.dir, &clu.dir) == -1) { +- ret = -EIO; +- goto out; +- } +- num_clusters--; +- } +- } +- +- clu.size -= num_clusters; +- } +- +- fid->size = new_size; +- fid->attr |= ATTR_ARCHIVE; +- if (new_size == 0) { +- fid->flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01; +- fid->start_clu = CLUSTER_32(~0); +- } +- +- /* (1) update the directory entry */ +- es = get_entry_set_in_dir(sb, &fid->dir, fid->entry, +- ES_ALL_ENTRIES, &ep); +- if (!es) { +- ret = -ENOENT; +- goto out; +- } +- ep2 = ep + 1; +- +- exfat_set_entry_time(ep, tm_current(&tm), TM_MODIFY); +- exfat_set_entry_attr(ep, fid->attr); +- +- exfat_set_entry_size(ep2, new_size); +- if (new_size == 0) { +- exfat_set_entry_flag(ep2, 0x01); +- exfat_set_entry_clu0(ep2, CLUSTER_32(0)); +- } +- +- update_dir_checksum_with_entry_set(sb, es); +- release_entry_set(es); +- +- /* (2) cut off from the FAT chain */ +- if (last_clu != CLUSTER_32(0)) { +- if (fid->flags == 0x01) +- exfat_fat_write(sb, last_clu, CLUSTER_32(~0)); +- } +- +- /* (3) free the clusters */ +- exfat_free_cluster(sb, &clu, 0); +- +- /* hint information */ +- fid->hint_last_off = -1; +- if (fid->rwoffset > fid->size) +- fid->rwoffset = fid->size; +- +-#ifndef CONFIG_STAGING_EXFAT_DELAYED_SYNC +- fs_sync(sb, true); +- fs_set_vol_flags(sb, VOL_CLEAN); +-#endif +- +- if (p_fs->dev_ejected) +- ret = -EIO; +- +-out: +- pr_debug("%s exited (%d)\n", __func__, ret); +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return ret; +-} +- +-static void update_parent_info(struct file_id_t *fid, +- struct inode *parent_inode) +-{ +- struct fs_info_t *p_fs = &(EXFAT_SB(parent_inode->i_sb)->fs_info); +- struct file_id_t *parent_fid = &(EXFAT_I(parent_inode)->fid); +- +- if (unlikely((parent_fid->flags != fid->dir.flags) || +- (parent_fid->size != +- (fid->dir.size << p_fs->cluster_size_bits)) || +- (parent_fid->start_clu != fid->dir.dir))) { +- fid->dir.dir = parent_fid->start_clu; +- fid->dir.flags = parent_fid->flags; +- fid->dir.size = ((parent_fid->size + (p_fs->cluster_size - 1)) +- >> p_fs->cluster_size_bits); +- } +-} +- +-static int ffsMoveFile(struct inode *old_parent_inode, struct file_id_t *fid, +- struct inode *new_parent_inode, struct dentry *new_dentry) +-{ +- s32 ret; +- s32 dentry; +- struct chain_t olddir, newdir; +- struct chain_t *p_dir = NULL; +- struct uni_name_t uni_name; +- struct dentry_t *ep; +- struct super_block *sb = old_parent_inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- u8 *new_path = (u8 *)new_dentry->d_name.name; +- struct inode *new_inode = new_dentry->d_inode; +- int num_entries; +- struct file_id_t *new_fid = NULL; +- s32 new_entry = 0; +- +- /* check the validity of the given file id */ +- if (!fid) +- return -EINVAL; +- +- /* check the validity of pointer parameters */ +- if (!new_path || (*new_path == '\0')) +- return -EINVAL; +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- update_parent_info(fid, old_parent_inode); +- +- olddir.dir = fid->dir.dir; +- olddir.size = fid->dir.size; +- olddir.flags = fid->dir.flags; +- +- dentry = fid->entry; +- +- /* check if the old file is "." or ".." */ +- if (p_fs->vol_type != EXFAT) { +- if ((olddir.dir != p_fs->root_dir) && (dentry < 2)) { +- ret = -EPERM; +- goto out2; +- } +- } +- +- ep = get_entry_in_dir(sb, &olddir, dentry, NULL); +- if (!ep) { +- ret = -ENOENT; +- goto out2; +- } +- +- if (exfat_get_entry_attr(ep) & ATTR_READONLY) { +- ret = -EPERM; +- goto out2; +- } +- +- /* check whether new dir is existing directory and empty */ +- if (new_inode) { +- u32 entry_type; +- +- ret = -ENOENT; +- new_fid = &EXFAT_I(new_inode)->fid; +- +- update_parent_info(new_fid, new_parent_inode); +- +- p_dir = &new_fid->dir; +- new_entry = new_fid->entry; +- ep = get_entry_in_dir(sb, p_dir, new_entry, NULL); +- if (!ep) +- goto out; +- +- entry_type = exfat_get_entry_type(ep); +- +- if (entry_type == TYPE_DIR) { +- struct chain_t new_clu; +- +- new_clu.dir = new_fid->start_clu; +- new_clu.size = (s32)((new_fid->size - 1) >> +- p_fs->cluster_size_bits) + 1; +- new_clu.flags = new_fid->flags; +- +- if (!is_dir_empty(sb, &new_clu)) { +- ret = -EEXIST; +- goto out; +- } +- } +- } +- +- /* check the validity of directory name in the given new pathname */ +- ret = resolve_path(new_parent_inode, new_path, &newdir, &uni_name); +- if (ret) +- goto out2; +- +- fs_set_vol_flags(sb, VOL_DIRTY); +- +- if (olddir.dir == newdir.dir) +- ret = exfat_rename_file(new_parent_inode, &olddir, dentry, +- &uni_name, fid); +- else +- ret = move_file(new_parent_inode, &olddir, dentry, &newdir, +- &uni_name, fid); +- +- if ((ret == 0) && new_inode) { +- /* delete entries of new_dir */ +- ep = get_entry_in_dir(sb, p_dir, new_entry, NULL); +- if (!ep) +- goto out; +- +- num_entries = exfat_count_ext_entries(sb, p_dir, +- new_entry, ep); +- if (num_entries < 0) +- goto out; +- exfat_delete_dir_entry(sb, p_dir, new_entry, 0, +- num_entries + 1); +- } +-out: +-#ifndef CONFIG_STAGING_EXFAT_DELAYED_SYNC +- fs_sync(sb, true); +- fs_set_vol_flags(sb, VOL_CLEAN); +-#endif +- +- if (p_fs->dev_ejected) +- ret = -EIO; +-out2: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return ret; +-} +- +-static int ffsRemoveFile(struct inode *inode, struct file_id_t *fid) +-{ +- s32 dentry; +- int ret = 0; +- struct chain_t dir, clu_to_free; +- struct dentry_t *ep; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- /* check the validity of the given file id */ +- if (!fid) +- return -EINVAL; +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- dir.dir = fid->dir.dir; +- dir.size = fid->dir.size; +- dir.flags = fid->dir.flags; +- +- dentry = fid->entry; +- +- ep = get_entry_in_dir(sb, &dir, dentry, NULL); +- if (!ep) { +- ret = -ENOENT; +- goto out; +- } +- +- if (exfat_get_entry_attr(ep) & ATTR_READONLY) { +- ret = -EPERM; +- goto out; +- } +- fs_set_vol_flags(sb, VOL_DIRTY); +- +- /* (1) update the directory entry */ +- remove_file(inode, &dir, dentry); +- +- clu_to_free.dir = fid->start_clu; +- clu_to_free.size = (s32)((fid->size - 1) >> p_fs->cluster_size_bits) + 1; +- clu_to_free.flags = fid->flags; +- +- /* (2) free the clusters */ +- exfat_free_cluster(sb, &clu_to_free, 0); +- +- fid->size = 0; +- fid->start_clu = CLUSTER_32(~0); +- fid->flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01; +- +-#ifndef CONFIG_STAGING_EXFAT_DELAYED_SYNC +- fs_sync(sb, true); +- fs_set_vol_flags(sb, VOL_CLEAN); +-#endif +- +- if (p_fs->dev_ejected) +- ret = -EIO; +-out: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return ret; +-} +- +-#if 0 +-/* Not currently wired up */ +-static int ffsSetAttr(struct inode *inode, u32 attr) +-{ +- u32 type; +- int ret = 0; +- sector_t sector = 0; +- struct dentry_t *ep; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct file_id_t *fid = &(EXFAT_I(inode)->fid); +- u8 is_dir = (fid->type == TYPE_DIR) ? 1 : 0; +- struct entry_set_cache_t *es = NULL; +- +- if (fid->attr == attr) { +- if (p_fs->dev_ejected) +- return -EIO; +- return 0; +- } +- +- if (is_dir) { +- if ((fid->dir.dir == p_fs->root_dir) && +- (fid->entry == -1)) { +- if (p_fs->dev_ejected) +- return -EIO; +- return 0; +- } +- } +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- /* get the directory entry of given file */ +- es = get_entry_set_in_dir(sb, &fid->dir, fid->entry, +- ES_ALL_ENTRIES, &ep); +- if (!es) { +- ret = -ENOENT; +- goto out; +- } +- +- type = exfat_get_entry_type(ep); +- +- if (((type == TYPE_FILE) && (attr & ATTR_SUBDIR)) || +- ((type == TYPE_DIR) && (!(attr & ATTR_SUBDIR)))) { +- if (p_fs->dev_ejected) +- ret = -EIO; +- else +- ret = -EINVAL; +- +- release_entry_set(es); +- goto out; +- } +- +- fs_set_vol_flags(sb, VOL_DIRTY); +- +- /* set the file attribute */ +- fid->attr = attr; +- exfat_set_entry_attr(ep, attr); +- +- update_dir_checksum_with_entry_set(sb, es); +- release_entry_set(es); +- +-#ifndef CONFIG_STAGING_EXFAT_DELAYED_SYNC +- fs_sync(sb, true); +- fs_set_vol_flags(sb, VOL_CLEAN); +-#endif +- +- if (p_fs->dev_ejected) +- ret = -EIO; +-out: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return ret; +-} +-#endif +- +-static int ffsReadStat(struct inode *inode, struct dir_entry_t *info) +-{ +- s32 count; +- int ret = 0; +- struct chain_t dir; +- struct uni_name_t uni_name; +- struct timestamp_t tm; +- struct dentry_t *ep, *ep2; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct file_id_t *fid = &(EXFAT_I(inode)->fid); +- struct entry_set_cache_t *es = NULL; +- u8 is_dir = (fid->type == TYPE_DIR) ? 1 : 0; +- +- pr_debug("%s entered\n", __func__); +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- if (is_dir) { +- if ((fid->dir.dir == p_fs->root_dir) && +- (fid->entry == -1)) { +- info->Attr = ATTR_SUBDIR; +- memset((char *)&info->CreateTimestamp, 0, +- sizeof(struct date_time_t)); +- memset((char *)&info->ModifyTimestamp, 0, +- sizeof(struct date_time_t)); +- memset((char *)&info->AccessTimestamp, 0, +- sizeof(struct date_time_t)); +- strcpy(info->ShortName, "."); +- strcpy(info->Name, "."); +- +- dir.dir = p_fs->root_dir; +- dir.flags = 0x01; +- +- if (p_fs->root_dir == CLUSTER_32(0)) { +- /* FAT16 root_dir */ +- info->Size = p_fs->dentries_in_root << +- DENTRY_SIZE_BITS; +- } else { +- info->Size = count_num_clusters(sb, &dir) << +- p_fs->cluster_size_bits; +- } +- +- count = count_dos_name_entries(sb, &dir, TYPE_DIR); +- if (count < 0) { +- ret = count; /* propagate error upward */ +- goto out; +- } +- info->NumSubdirs = count; +- +- if (p_fs->dev_ejected) +- ret = -EIO; +- goto out; +- } +- } +- +- /* get the directory entry of given file or directory */ +- es = get_entry_set_in_dir(sb, &fid->dir, fid->entry, +- ES_2_ENTRIES, &ep); +- if (!es) { +- ret = -ENOENT; +- goto out; +- } +- ep2 = ep + 1; +- +- /* set FILE_INFO structure using the acquired struct dentry_t */ +- info->Attr = exfat_get_entry_attr(ep); +- +- exfat_get_entry_time(ep, &tm, TM_CREATE); +- info->CreateTimestamp.Year = tm.year; +- info->CreateTimestamp.Month = tm.mon; +- info->CreateTimestamp.Day = tm.day; +- info->CreateTimestamp.Hour = tm.hour; +- info->CreateTimestamp.Minute = tm.min; +- info->CreateTimestamp.Second = tm.sec; +- info->CreateTimestamp.MilliSecond = 0; +- +- exfat_get_entry_time(ep, &tm, TM_MODIFY); +- info->ModifyTimestamp.Year = tm.year; +- info->ModifyTimestamp.Month = tm.mon; +- info->ModifyTimestamp.Day = tm.day; +- info->ModifyTimestamp.Hour = tm.hour; +- info->ModifyTimestamp.Minute = tm.min; +- info->ModifyTimestamp.Second = tm.sec; +- info->ModifyTimestamp.MilliSecond = 0; +- +- memset((char *)&info->AccessTimestamp, 0, sizeof(struct date_time_t)); +- +- *uni_name.name = 0x0; +- /* XXX this is very bad for exfat cuz name is already included in es. +- * API should be revised +- */ +- exfat_get_uni_name_from_ext_entry(sb, &fid->dir, fid->entry, +- uni_name.name); +- nls_uniname_to_cstring(sb, info->Name, &uni_name); +- +- info->NumSubdirs = 2; +- +- info->Size = exfat_get_entry_size(ep2); +- +- release_entry_set(es); +- +- if (is_dir) { +- dir.dir = fid->start_clu; +- dir.flags = 0x01; +- +- if (info->Size == 0) +- info->Size = (u64)count_num_clusters(sb, &dir) << +- p_fs->cluster_size_bits; +- +- count = count_dos_name_entries(sb, &dir, TYPE_DIR); +- if (count < 0) { +- ret = count; /* propagate error upward */ +- goto out; +- } +- info->NumSubdirs += count; +- } +- +- if (p_fs->dev_ejected) +- ret = -EIO; +- +-out: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- pr_debug("%s exited successfully\n", __func__); +- return ret; +-} +- +-static int ffsWriteStat(struct inode *inode, struct dir_entry_t *info) +-{ +- int ret = 0; +- struct timestamp_t tm; +- struct dentry_t *ep, *ep2; +- struct entry_set_cache_t *es = NULL; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct file_id_t *fid = &(EXFAT_I(inode)->fid); +- u8 is_dir = (fid->type == TYPE_DIR) ? 1 : 0; +- +- pr_debug("%s entered (inode %p info %p\n", __func__, inode, info); +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- if (is_dir) { +- if ((fid->dir.dir == p_fs->root_dir) && +- (fid->entry == -1)) { +- if (p_fs->dev_ejected) +- ret = -EIO; +- ret = 0; +- goto out; +- } +- } +- +- fs_set_vol_flags(sb, VOL_DIRTY); +- +- /* get the directory entry of given file or directory */ +- es = get_entry_set_in_dir(sb, &fid->dir, fid->entry, +- ES_ALL_ENTRIES, &ep); +- if (!es) { +- ret = -ENOENT; +- goto out; +- } +- ep2 = ep + 1; +- +- exfat_set_entry_attr(ep, info->Attr); +- +- /* set FILE_INFO structure using the acquired struct dentry_t */ +- tm.sec = info->CreateTimestamp.Second; +- tm.min = info->CreateTimestamp.Minute; +- tm.hour = info->CreateTimestamp.Hour; +- tm.day = info->CreateTimestamp.Day; +- tm.mon = info->CreateTimestamp.Month; +- tm.year = info->CreateTimestamp.Year; +- exfat_set_entry_time(ep, &tm, TM_CREATE); +- +- tm.sec = info->ModifyTimestamp.Second; +- tm.min = info->ModifyTimestamp.Minute; +- tm.hour = info->ModifyTimestamp.Hour; +- tm.day = info->ModifyTimestamp.Day; +- tm.mon = info->ModifyTimestamp.Month; +- tm.year = info->ModifyTimestamp.Year; +- exfat_set_entry_time(ep, &tm, TM_MODIFY); +- +- exfat_set_entry_size(ep2, info->Size); +- +- update_dir_checksum_with_entry_set(sb, es); +- release_entry_set(es); +- +- if (p_fs->dev_ejected) +- ret = -EIO; +- +-out: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- pr_debug("%s exited (%d)\n", __func__, ret); +- +- return ret; +-} +- +-static int ffsMapCluster(struct inode *inode, s32 clu_offset, u32 *clu) +-{ +- s32 num_clusters, num_alloced; +- bool modified = false; +- u32 last_clu; +- int ret = 0; +- struct chain_t new_clu; +- struct dentry_t *ep; +- struct entry_set_cache_t *es = NULL; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct file_id_t *fid = &(EXFAT_I(inode)->fid); +- +- /* check the validity of pointer parameters */ +- if (!clu) +- return -EINVAL; +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- fid->rwoffset = (s64)(clu_offset) << p_fs->cluster_size_bits; +- +- if (EXFAT_I(inode)->mmu_private == 0) +- num_clusters = 0; +- else +- num_clusters = (s32)((EXFAT_I(inode)->mmu_private - 1) >> +- p_fs->cluster_size_bits) + 1; +- +- *clu = last_clu = fid->start_clu; +- +- if (fid->flags == 0x03) { +- if ((clu_offset > 0) && (*clu != CLUSTER_32(~0))) { +- last_clu += clu_offset - 1; +- +- if (clu_offset == num_clusters) +- *clu = CLUSTER_32(~0); +- else +- *clu += clu_offset; +- } +- } else { +- /* hint information */ +- if ((clu_offset > 0) && (fid->hint_last_off > 0) && +- (clu_offset >= fid->hint_last_off)) { +- clu_offset -= fid->hint_last_off; +- *clu = fid->hint_last_clu; +- } +- +- while ((clu_offset > 0) && (*clu != CLUSTER_32(~0))) { +- last_clu = *clu; +- if (exfat_fat_read(sb, *clu, clu) == -1) { +- ret = -EIO; +- goto out; +- } +- clu_offset--; +- } +- } +- +- if (*clu == CLUSTER_32(~0)) { +- fs_set_vol_flags(sb, VOL_DIRTY); +- +- new_clu.dir = (last_clu == CLUSTER_32(~0)) ? CLUSTER_32(~0) : +- last_clu + 1; +- new_clu.size = 0; +- new_clu.flags = fid->flags; +- +- /* (1) allocate a cluster */ +- num_alloced = exfat_alloc_cluster(sb, 1, &new_clu); +- if (num_alloced < 0) { +- ret = -EIO; +- goto out; +- } else if (num_alloced == 0) { +- ret = -ENOSPC; +- goto out; +- } +- +- /* (2) append to the FAT chain */ +- if (last_clu == CLUSTER_32(~0)) { +- if (new_clu.flags == 0x01) +- fid->flags = 0x01; +- fid->start_clu = new_clu.dir; +- modified = true; +- } else { +- if (new_clu.flags != fid->flags) { +- exfat_chain_cont_cluster(sb, fid->start_clu, +- num_clusters); +- fid->flags = 0x01; +- modified = true; +- } +- if (new_clu.flags == 0x01) +- exfat_fat_write(sb, last_clu, new_clu.dir); +- } +- +- num_clusters += num_alloced; +- *clu = new_clu.dir; +- +- es = get_entry_set_in_dir(sb, &fid->dir, fid->entry, +- ES_ALL_ENTRIES, &ep); +- if (!es) { +- ret = -ENOENT; +- goto out; +- } +- /* get stream entry */ +- ep++; +- +- /* (3) update directory entry */ +- if (modified) { +- if (exfat_get_entry_flag(ep) != fid->flags) +- exfat_set_entry_flag(ep, fid->flags); +- +- if (exfat_get_entry_clu0(ep) != fid->start_clu) +- exfat_set_entry_clu0(ep, fid->start_clu); +- } +- +- update_dir_checksum_with_entry_set(sb, es); +- release_entry_set(es); +- +- /* add number of new blocks to inode */ +- inode->i_blocks += num_alloced << (p_fs->cluster_size_bits - 9); +- } +- +- /* hint information */ +- fid->hint_last_off = (s32)(fid->rwoffset >> p_fs->cluster_size_bits); +- fid->hint_last_clu = *clu; +- +- if (p_fs->dev_ejected) +- ret = -EIO; +- +-out: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return ret; +-} +- +-/*----------------------------------------------------------------------*/ +-/* Directory Operation Functions */ +-/*----------------------------------------------------------------------*/ +- +-static int ffsCreateDir(struct inode *inode, char *path, struct file_id_t *fid) +-{ +- int ret = 0; +- struct chain_t dir; +- struct uni_name_t uni_name; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- pr_debug("%s entered\n", __func__); +- +- /* check the validity of pointer parameters */ +- if (!fid || !path || (*path == '\0')) +- return -EINVAL; +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- /* check the validity of directory name in the given old pathname */ +- ret = resolve_path(inode, path, &dir, &uni_name); +- if (ret) +- goto out; +- +- fs_set_vol_flags(sb, VOL_DIRTY); +- +- ret = create_dir(inode, &dir, &uni_name, fid); +- +-#ifndef CONFIG_STAGING_EXFAT_DELAYED_SYNC +- fs_sync(sb, true); +- fs_set_vol_flags(sb, VOL_CLEAN); +-#endif +- +- if (p_fs->dev_ejected) +- ret = -EIO; +-out: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return ret; +-} +- +-static int ffsReadDir(struct inode *inode, struct dir_entry_t *dir_entry) +-{ +- int i, dentry, clu_offset; +- int ret = 0; +- s32 dentries_per_clu, dentries_per_clu_bits = 0; +- u32 type; +- sector_t sector; +- struct chain_t dir, clu; +- struct uni_name_t uni_name; +- struct timestamp_t tm; +- struct dentry_t *ep; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct file_id_t *fid = &(EXFAT_I(inode)->fid); +- +- /* check the validity of pointer parameters */ +- if (!dir_entry) +- return -EINVAL; +- +- /* check if the given file ID is opened */ +- if (fid->type != TYPE_DIR) +- return -ENOTDIR; +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- if (fid->entry == -1) { +- dir.dir = p_fs->root_dir; +- dir.flags = 0x01; +- } else { +- dir.dir = fid->start_clu; +- dir.size = (s32)(fid->size >> p_fs->cluster_size_bits); +- dir.flags = fid->flags; +- } +- +- dentry = (s32)fid->rwoffset; +- +- if (dir.dir == CLUSTER_32(0)) { +- /* FAT16 root_dir */ +- dentries_per_clu = p_fs->dentries_in_root; +- +- if (dentry == dentries_per_clu) { +- clu.dir = CLUSTER_32(~0); +- } else { +- clu.dir = dir.dir; +- clu.size = dir.size; +- clu.flags = dir.flags; +- } +- } else { +- dentries_per_clu = p_fs->dentries_per_clu; +- dentries_per_clu_bits = ilog2(dentries_per_clu); +- +- clu_offset = dentry >> dentries_per_clu_bits; +- clu.dir = dir.dir; +- clu.size = dir.size; +- clu.flags = dir.flags; +- +- if (clu.flags == 0x03) { +- clu.dir += clu_offset; +- clu.size -= clu_offset; +- } else { +- /* hint_information */ +- if ((clu_offset > 0) && (fid->hint_last_off > 0) && +- (clu_offset >= fid->hint_last_off)) { +- clu_offset -= fid->hint_last_off; +- clu.dir = fid->hint_last_clu; +- } +- +- while (clu_offset > 0) { +- /* clu.dir = exfat_fat_read(sb, clu.dir); */ +- if (exfat_fat_read(sb, clu.dir, &clu.dir) == -1) { +- ret = -EIO; +- goto out; +- } +- clu_offset--; +- } +- } +- } +- +- while (clu.dir != CLUSTER_32(~0)) { +- if (p_fs->dev_ejected) +- break; +- +- if (dir.dir == CLUSTER_32(0)) /* FAT16 root_dir */ +- i = dentry % dentries_per_clu; +- else +- i = dentry & (dentries_per_clu - 1); +- +- for ( ; i < dentries_per_clu; i++, dentry++) { +- ep = get_entry_in_dir(sb, &clu, i, §or); +- if (!ep) { +- ret = -ENOENT; +- goto out; +- } +- type = exfat_get_entry_type(ep); +- +- if (type == TYPE_UNUSED) +- break; +- +- if ((type != TYPE_FILE) && (type != TYPE_DIR)) +- continue; +- +- exfat_buf_lock(sb, sector); +- dir_entry->Attr = exfat_get_entry_attr(ep); +- +- exfat_get_entry_time(ep, &tm, TM_CREATE); +- dir_entry->CreateTimestamp.Year = tm.year; +- dir_entry->CreateTimestamp.Month = tm.mon; +- dir_entry->CreateTimestamp.Day = tm.day; +- dir_entry->CreateTimestamp.Hour = tm.hour; +- dir_entry->CreateTimestamp.Minute = tm.min; +- dir_entry->CreateTimestamp.Second = tm.sec; +- dir_entry->CreateTimestamp.MilliSecond = 0; +- +- exfat_get_entry_time(ep, &tm, TM_MODIFY); +- dir_entry->ModifyTimestamp.Year = tm.year; +- dir_entry->ModifyTimestamp.Month = tm.mon; +- dir_entry->ModifyTimestamp.Day = tm.day; +- dir_entry->ModifyTimestamp.Hour = tm.hour; +- dir_entry->ModifyTimestamp.Minute = tm.min; +- dir_entry->ModifyTimestamp.Second = tm.sec; +- dir_entry->ModifyTimestamp.MilliSecond = 0; +- +- memset((char *)&dir_entry->AccessTimestamp, 0, +- sizeof(struct date_time_t)); +- +- *uni_name.name = 0x0; +- exfat_get_uni_name_from_ext_entry(sb, &dir, dentry, +- uni_name.name); +- nls_uniname_to_cstring(sb, dir_entry->Name, &uni_name); +- exfat_buf_unlock(sb, sector); +- +- ep = get_entry_in_dir(sb, &clu, i + 1, NULL); +- if (!ep) { +- ret = -ENOENT; +- goto out; +- } +- +- dir_entry->Size = exfat_get_entry_size(ep); +- +- /* hint information */ +- if (dir.dir == CLUSTER_32(0)) { /* FAT16 root_dir */ +- } else { +- fid->hint_last_off = dentry >> +- dentries_per_clu_bits; +- fid->hint_last_clu = clu.dir; +- } +- +- fid->rwoffset = (s64)(++dentry); +- +- if (p_fs->dev_ejected) +- ret = -EIO; +- goto out; +- } +- +- if (dir.dir == CLUSTER_32(0)) +- break; /* FAT16 root_dir */ +- +- if (clu.flags == 0x03) { +- if ((--clu.size) > 0) +- clu.dir++; +- else +- clu.dir = CLUSTER_32(~0); +- } else { +- /* clu.dir = exfat_fat_read(sb, clu.dir); */ +- if (exfat_fat_read(sb, clu.dir, &clu.dir) == -1) { +- ret = -EIO; +- goto out; +- } +- } +- } +- +- *dir_entry->Name = '\0'; +- +- fid->rwoffset = (s64)(++dentry); +- +- if (p_fs->dev_ejected) +- ret = -EIO; +- +-out: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return ret; +-} +- +-static int ffsRemoveDir(struct inode *inode, struct file_id_t *fid) +-{ +- s32 dentry; +- int ret = 0; +- struct chain_t dir, clu_to_free; +- struct super_block *sb = inode->i_sb; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- /* check the validity of the given file id */ +- if (!fid) +- return -EINVAL; +- +- dir.dir = fid->dir.dir; +- dir.size = fid->dir.size; +- dir.flags = fid->dir.flags; +- +- dentry = fid->entry; +- +- /* check if the file is "." or ".." */ +- if (p_fs->vol_type != EXFAT) { +- if ((dir.dir != p_fs->root_dir) && (dentry < 2)) +- return -EPERM; +- } +- +- /* acquire the lock for file system critical section */ +- mutex_lock(&p_fs->v_mutex); +- +- clu_to_free.dir = fid->start_clu; +- clu_to_free.size = (s32)((fid->size - 1) >> p_fs->cluster_size_bits) + 1; +- clu_to_free.flags = fid->flags; +- +- if (!is_dir_empty(sb, &clu_to_free)) { +- ret = -ENOTEMPTY; +- goto out; +- } +- +- fs_set_vol_flags(sb, VOL_DIRTY); +- +- /* (1) update the directory entry */ +- remove_file(inode, &dir, dentry); +- +- /* (2) free the clusters */ +- exfat_free_cluster(sb, &clu_to_free, 1); +- +- fid->size = 0; +- fid->start_clu = CLUSTER_32(~0); +- fid->flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01; +- +-#ifndef CONFIG_STAGING_EXFAT_DELAYED_SYNC +- fs_sync(sb, true); +- fs_set_vol_flags(sb, VOL_CLEAN); +-#endif +- +- if (p_fs->dev_ejected) +- ret = -EIO; +- +-out: +- /* release the lock for file system critical section */ +- mutex_unlock(&p_fs->v_mutex); +- +- return ret; +-} +- +-/*======================================================================*/ +-/* Directory Entry Operations */ +-/*======================================================================*/ +- +-static int exfat_readdir(struct file *filp, struct dir_context *ctx) +-{ +- struct inode *inode = file_inode(filp); +- struct super_block *sb = inode->i_sb; +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- struct fs_info_t *p_fs = &sbi->fs_info; +- struct bd_info_t *p_bd = &(EXFAT_SB(sb)->bd_info); +- struct dir_entry_t de; +- unsigned long inum; +- loff_t cpos; +- int err = 0; +- +- __lock_super(sb); +- +- cpos = ctx->pos; +- /* Fake . and .. for the root directory. */ +- if ((p_fs->vol_type == EXFAT) || (inode->i_ino == EXFAT_ROOT_INO)) { +- while (cpos < 2) { +- if (inode->i_ino == EXFAT_ROOT_INO) +- inum = EXFAT_ROOT_INO; +- else if (cpos == 0) +- inum = inode->i_ino; +- else /* (cpos == 1) */ +- inum = parent_ino(filp->f_path.dentry); +- +- if (!dir_emit_dots(filp, ctx)) +- goto out; +- cpos++; +- ctx->pos++; +- } +- if (cpos == 2) +- cpos = 0; +- } +- if (cpos & (DENTRY_SIZE - 1)) { +- err = -ENOENT; +- goto out; +- } +- +-get_new: +- EXFAT_I(inode)->fid.size = i_size_read(inode); +- EXFAT_I(inode)->fid.rwoffset = cpos >> DENTRY_SIZE_BITS; +- +- err = ffsReadDir(inode, &de); +- if (err) { +- /* at least we tried to read a sector +- * move cpos to next sector position (should be aligned) +- */ +- if (err == -EIO) { +- cpos += 1 << p_bd->sector_size_bits; +- cpos &= ~((1 << p_bd->sector_size_bits) - 1); +- } +- +- goto end_of_dir; +- } +- +- cpos = EXFAT_I(inode)->fid.rwoffset << DENTRY_SIZE_BITS; +- +- if (!de.Name[0]) +- goto end_of_dir; +- +- if (!memcmp(de.ShortName, DOS_CUR_DIR_NAME, DOS_NAME_LENGTH)) { +- inum = inode->i_ino; +- } else if (!memcmp(de.ShortName, DOS_PAR_DIR_NAME, DOS_NAME_LENGTH)) { +- inum = parent_ino(filp->f_path.dentry); +- } else { +- loff_t i_pos = ((loff_t)EXFAT_I(inode)->fid.start_clu << 32) | +- ((EXFAT_I(inode)->fid.rwoffset - 1) & 0xffffffff); +- struct inode *tmp = exfat_iget(sb, i_pos); +- +- if (tmp) { +- inum = tmp->i_ino; +- iput(tmp); +- } else { +- inum = iunique(sb, EXFAT_ROOT_INO); +- } +- } +- +- if (!dir_emit(ctx, de.Name, strlen(de.Name), inum, +- (de.Attr & ATTR_SUBDIR) ? DT_DIR : DT_REG)) +- goto out; +- +- ctx->pos = cpos; +- goto get_new; +- +-end_of_dir: +- ctx->pos = cpos; +-out: +- __unlock_super(sb); +- return err; +-} +- +-static int exfat_ioctl_volume_id(struct inode *dir) +-{ +- struct super_block *sb = dir->i_sb; +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- struct fs_info_t *p_fs = &sbi->fs_info; +- +- return p_fs->vol_id; +-} +- +-static long exfat_generic_ioctl(struct file *filp, unsigned int cmd, +- unsigned long arg) +-{ +- struct inode *inode = filp->f_path.dentry->d_inode; +-#ifdef CONFIG_STAGING_EXFAT_KERNEL_DEBUG +- unsigned int flags; +-#endif /* CONFIG_STAGING_EXFAT_KERNEL_DEBUG */ +- +- switch (cmd) { +- case EXFAT_IOCTL_GET_VOLUME_ID: +- return exfat_ioctl_volume_id(inode); +-#ifdef CONFIG_STAGING_EXFAT_KERNEL_DEBUG +- case EXFAT_IOC_GET_DEBUGFLAGS: { +- struct super_block *sb = inode->i_sb; +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- +- flags = sbi->debug_flags; +- return put_user(flags, (int __user *)arg); +- } +- case EXFAT_IOC_SET_DEBUGFLAGS: { +- struct super_block *sb = inode->i_sb; +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- +- if (!capable(CAP_SYS_ADMIN)) +- return -EPERM; +- +- if (get_user(flags, (int __user *)arg)) +- return -EFAULT; +- +- __lock_super(sb); +- sbi->debug_flags = flags; +- __unlock_super(sb); +- +- return 0; +- } +-#endif /* CONFIG_STAGING_EXFAT_KERNEL_DEBUG */ +- default: +- return -ENOTTY; /* Inappropriate ioctl for device */ +- } +-} +- +-static const struct file_operations exfat_dir_operations = { +- .llseek = generic_file_llseek, +- .read = generic_read_dir, +- .iterate = exfat_readdir, +- .unlocked_ioctl = exfat_generic_ioctl, +- .fsync = generic_file_fsync, +-}; +- +-static int exfat_create(struct inode *dir, struct dentry *dentry, umode_t mode, +- bool excl) +-{ +- struct super_block *sb = dir->i_sb; +- struct timespec64 curtime; +- struct inode *inode; +- struct file_id_t fid; +- loff_t i_pos; +- int err; +- +- __lock_super(sb); +- +- pr_debug("%s entered\n", __func__); +- +- err = ffsCreateFile(dir, (u8 *)dentry->d_name.name, FM_REGULAR, &fid); +- if (err) +- goto out; +- +- INC_IVERSION(dir); +- curtime = current_time(dir); +- dir->i_ctime = curtime; +- dir->i_mtime = curtime; +- dir->i_atime = curtime; +- if (IS_DIRSYNC(dir)) +- (void)exfat_sync_inode(dir); +- else +- mark_inode_dirty(dir); +- +- i_pos = ((loff_t)fid.dir.dir << 32) | (fid.entry & 0xffffffff); +- +- inode = exfat_build_inode(sb, &fid, i_pos); +- if (IS_ERR(inode)) { +- err = PTR_ERR(inode); +- goto out; +- } +- INC_IVERSION(inode); +- curtime = current_time(inode); +- inode->i_mtime = curtime; +- inode->i_atime = curtime; +- inode->i_ctime = curtime; +- /* +- * timestamp is already written, so mark_inode_dirty() is unnecessary. +- */ +- +- dentry->d_time = GET_IVERSION(dentry->d_parent->d_inode); +- d_instantiate(dentry, inode); +- +-out: +- __unlock_super(sb); +- pr_debug("%s exited\n", __func__); +- return err; +-} +- +-static int exfat_find(struct inode *dir, struct qstr *qname, +- struct file_id_t *fid) +-{ +- int err; +- +- if (qname->len == 0) +- return -ENOENT; +- +- err = ffsLookupFile(dir, (u8 *)qname->name, fid); +- if (err) +- return -ENOENT; +- +- return 0; +-} +- +-static int exfat_d_anon_disconn(struct dentry *dentry) +-{ +- return IS_ROOT(dentry) && (dentry->d_flags & DCACHE_DISCONNECTED); +-} +- +-static struct dentry *exfat_lookup(struct inode *dir, struct dentry *dentry, +- unsigned int flags) +-{ +- struct super_block *sb = dir->i_sb; +- struct inode *inode; +- struct dentry *alias; +- int err; +- struct file_id_t fid; +- loff_t i_pos; +- u64 ret; +- mode_t i_mode; +- +- __lock_super(sb); +- pr_debug("%s entered\n", __func__); +- err = exfat_find(dir, &dentry->d_name, &fid); +- if (err) { +- if (err == -ENOENT) { +- inode = NULL; +- goto out; +- } +- goto error; +- } +- +- i_pos = ((loff_t)fid.dir.dir << 32) | (fid.entry & 0xffffffff); +- inode = exfat_build_inode(sb, &fid, i_pos); +- if (IS_ERR(inode)) { +- err = PTR_ERR(inode); +- goto error; +- } +- +- i_mode = inode->i_mode; +- if (S_ISLNK(i_mode) && !EXFAT_I(inode)->target) { +- EXFAT_I(inode)->target = kmalloc(i_size_read(inode) + 1, +- GFP_KERNEL); +- if (!EXFAT_I(inode)->target) { +- err = -ENOMEM; +- goto error; +- } +- ffsReadFile(dir, &fid, EXFAT_I(inode)->target, +- i_size_read(inode), &ret); +- *(EXFAT_I(inode)->target + i_size_read(inode)) = '\0'; +- } +- +- alias = d_find_alias(inode); +- if (alias && !exfat_d_anon_disconn(alias)) { +- BUG_ON(d_unhashed(alias)); +- if (!S_ISDIR(i_mode)) +- d_move(alias, dentry); +- iput(inode); +- __unlock_super(sb); +- pr_debug("%s exited 1\n", __func__); +- return alias; +- } +- dput(alias); +-out: +- __unlock_super(sb); +- dentry->d_time = GET_IVERSION(dentry->d_parent->d_inode); +- dentry = d_splice_alias(inode, dentry); +- if (dentry) +- dentry->d_time = GET_IVERSION(dentry->d_parent->d_inode); +- pr_debug("%s exited 2\n", __func__); +- return dentry; +- +-error: +- __unlock_super(sb); +- pr_debug("%s exited 3\n", __func__); +- return ERR_PTR(err); +-} +- +-static inline unsigned long exfat_hash(loff_t i_pos) +-{ +- return hash_32(i_pos, EXFAT_HASH_BITS); +-} +- +-static void exfat_attach(struct inode *inode, loff_t i_pos) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(inode->i_sb); +- struct hlist_head *head = sbi->inode_hashtable + exfat_hash(i_pos); +- +- spin_lock(&sbi->inode_hash_lock); +- EXFAT_I(inode)->i_pos = i_pos; +- hlist_add_head(&EXFAT_I(inode)->i_hash_fat, head); +- spin_unlock(&sbi->inode_hash_lock); +-} +- +-static void exfat_detach(struct inode *inode) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(inode->i_sb); +- +- spin_lock(&sbi->inode_hash_lock); +- hlist_del_init(&EXFAT_I(inode)->i_hash_fat); +- EXFAT_I(inode)->i_pos = 0; +- spin_unlock(&sbi->inode_hash_lock); +-} +- +-static int exfat_unlink(struct inode *dir, struct dentry *dentry) +-{ +- struct inode *inode = dentry->d_inode; +- struct super_block *sb = dir->i_sb; +- struct timespec64 curtime; +- int err; +- +- __lock_super(sb); +- +- pr_debug("%s entered\n", __func__); +- +- EXFAT_I(inode)->fid.size = i_size_read(inode); +- +- err = ffsRemoveFile(dir, &(EXFAT_I(inode)->fid)); +- if (err) +- goto out; +- +- INC_IVERSION(dir); +- curtime = current_time(dir); +- dir->i_mtime = curtime; +- dir->i_atime = curtime; +- if (IS_DIRSYNC(dir)) +- (void)exfat_sync_inode(dir); +- else +- mark_inode_dirty(dir); +- +- clear_nlink(inode); +- curtime = current_time(inode); +- inode->i_mtime = curtime; +- inode->i_atime = curtime; +- exfat_detach(inode); +- remove_inode_hash(inode); +- +-out: +- __unlock_super(sb); +- pr_debug("%s exited\n", __func__); +- return err; +-} +- +-static int exfat_symlink(struct inode *dir, struct dentry *dentry, +- const char *target) +-{ +- struct super_block *sb = dir->i_sb; +- struct timespec64 curtime; +- struct inode *inode; +- struct file_id_t fid; +- loff_t i_pos; +- int err; +- u64 len = (u64)strlen(target); +- u64 ret; +- +- __lock_super(sb); +- +- pr_debug("%s entered\n", __func__); +- +- err = ffsCreateFile(dir, (u8 *)dentry->d_name.name, FM_SYMLINK, &fid); +- if (err) +- goto out; +- +- +- err = ffsWriteFile(dir, &fid, (char *)target, len, &ret); +- +- if (err) { +- ffsRemoveFile(dir, &fid); +- goto out; +- } +- +- INC_IVERSION(dir); +- curtime = current_time(dir); +- dir->i_ctime = curtime; +- dir->i_mtime = curtime; +- dir->i_atime = curtime; +- if (IS_DIRSYNC(dir)) +- (void)exfat_sync_inode(dir); +- else +- mark_inode_dirty(dir); +- +- i_pos = ((loff_t)fid.dir.dir << 32) | (fid.entry & 0xffffffff); +- +- inode = exfat_build_inode(sb, &fid, i_pos); +- if (IS_ERR(inode)) { +- err = PTR_ERR(inode); +- goto out; +- } +- INC_IVERSION(inode); +- curtime = current_time(inode); +- inode->i_mtime = curtime; +- inode->i_atime = curtime; +- inode->i_ctime = curtime; +- /* timestamp is already written, so mark_inode_dirty() is unneeded. */ +- +- EXFAT_I(inode)->target = kmemdup(target, len + 1, GFP_KERNEL); +- if (!EXFAT_I(inode)->target) { +- err = -ENOMEM; +- goto out; +- } +- +- dentry->d_time = GET_IVERSION(dentry->d_parent->d_inode); +- d_instantiate(dentry, inode); +- +-out: +- __unlock_super(sb); +- pr_debug("%s exited\n", __func__); +- return err; +-} +- +-static int exfat_mkdir(struct inode *dir, struct dentry *dentry, umode_t mode) +-{ +- struct super_block *sb = dir->i_sb; +- struct timespec64 curtime; +- struct inode *inode; +- struct file_id_t fid; +- loff_t i_pos; +- int err; +- +- __lock_super(sb); +- +- pr_debug("%s entered\n", __func__); +- +- err = ffsCreateDir(dir, (u8 *)dentry->d_name.name, &fid); +- if (err) +- goto out; +- +- INC_IVERSION(dir); +- curtime = current_time(dir); +- dir->i_ctime = curtime; +- dir->i_mtime = curtime; +- dir->i_atime = curtime; +- if (IS_DIRSYNC(dir)) +- (void)exfat_sync_inode(dir); +- else +- mark_inode_dirty(dir); +- inc_nlink(dir); +- +- i_pos = ((loff_t)fid.dir.dir << 32) | (fid.entry & 0xffffffff); +- +- inode = exfat_build_inode(sb, &fid, i_pos); +- if (IS_ERR(inode)) { +- err = PTR_ERR(inode); +- goto out; +- } +- INC_IVERSION(inode); +- curtime = current_time(inode); +- inode->i_mtime = curtime; +- inode->i_atime = curtime; +- inode->i_ctime = curtime; +- /* timestamp is already written, so mark_inode_dirty() is unneeded. */ +- +- dentry->d_time = GET_IVERSION(dentry->d_parent->d_inode); +- d_instantiate(dentry, inode); +- +-out: +- __unlock_super(sb); +- pr_debug("%s exited\n", __func__); +- return err; +-} +- +-static int exfat_rmdir(struct inode *dir, struct dentry *dentry) +-{ +- struct inode *inode = dentry->d_inode; +- struct super_block *sb = dir->i_sb; +- struct timespec64 curtime; +- int err; +- +- __lock_super(sb); +- +- pr_debug("%s entered\n", __func__); +- +- EXFAT_I(inode)->fid.size = i_size_read(inode); +- +- err = ffsRemoveDir(dir, &(EXFAT_I(inode)->fid)); +- if (err) +- goto out; +- +- INC_IVERSION(dir); +- curtime = current_time(dir); +- dir->i_mtime = curtime; +- dir->i_atime = curtime; +- if (IS_DIRSYNC(dir)) +- (void)exfat_sync_inode(dir); +- else +- mark_inode_dirty(dir); +- drop_nlink(dir); +- +- clear_nlink(inode); +- curtime = current_time(inode); +- inode->i_mtime = curtime; +- inode->i_atime = curtime; +- exfat_detach(inode); +- remove_inode_hash(inode); +- +-out: +- __unlock_super(sb); +- pr_debug("%s exited\n", __func__); +- return err; +-} +- +-static int exfat_rename(struct inode *old_dir, struct dentry *old_dentry, +- struct inode *new_dir, struct dentry *new_dentry, +- unsigned int flags) +-{ +- struct inode *old_inode, *new_inode; +- struct super_block *sb = old_dir->i_sb; +- struct timespec64 curtime; +- loff_t i_pos; +- int err; +- +- if (flags) +- return -EINVAL; +- +- __lock_super(sb); +- +- pr_debug("%s entered\n", __func__); +- +- old_inode = old_dentry->d_inode; +- new_inode = new_dentry->d_inode; +- +- EXFAT_I(old_inode)->fid.size = i_size_read(old_inode); +- +- err = ffsMoveFile(old_dir, &(EXFAT_I(old_inode)->fid), new_dir, +- new_dentry); +- if (err) +- goto out; +- +- INC_IVERSION(new_dir); +- curtime = current_time(new_dir); +- new_dir->i_ctime = curtime; +- new_dir->i_mtime = curtime; +- new_dir->i_atime = curtime; +- +- if (IS_DIRSYNC(new_dir)) +- (void)exfat_sync_inode(new_dir); +- else +- mark_inode_dirty(new_dir); +- +- i_pos = ((loff_t)EXFAT_I(old_inode)->fid.dir.dir << 32) | +- (EXFAT_I(old_inode)->fid.entry & 0xffffffff); +- +- exfat_detach(old_inode); +- exfat_attach(old_inode, i_pos); +- if (IS_DIRSYNC(new_dir)) +- (void)exfat_sync_inode(old_inode); +- else +- mark_inode_dirty(old_inode); +- +- if ((S_ISDIR(old_inode->i_mode)) && (old_dir != new_dir)) { +- drop_nlink(old_dir); +- if (!new_inode) +- inc_nlink(new_dir); +- } +- INC_IVERSION(old_dir); +- curtime = current_time(old_dir); +- old_dir->i_ctime = curtime; +- old_dir->i_mtime = curtime; +- if (IS_DIRSYNC(old_dir)) +- (void)exfat_sync_inode(old_dir); +- else +- mark_inode_dirty(old_dir); +- +- if (new_inode) { +- exfat_detach(new_inode); +- drop_nlink(new_inode); +- if (S_ISDIR(new_inode->i_mode)) +- drop_nlink(new_inode); +- new_inode->i_ctime = current_time(new_inode); +- } +- +-out: +- __unlock_super(sb); +- pr_debug("%s exited\n", __func__); +- return err; +-} +- +-static int exfat_cont_expand(struct inode *inode, loff_t size) +-{ +- struct address_space *mapping = inode->i_mapping; +- loff_t start = i_size_read(inode), count = size - i_size_read(inode); +- struct timespec64 curtime; +- int err, err2; +- +- err = generic_cont_expand_simple(inode, size); +- if (err != 0) +- return err; +- +- curtime = current_time(inode); +- inode->i_ctime = curtime; +- inode->i_mtime = curtime; +- mark_inode_dirty(inode); +- +- if (IS_SYNC(inode)) { +- err = filemap_fdatawrite_range(mapping, start, +- start + count - 1); +- err2 = sync_mapping_buffers(mapping); +- err = (err) ? (err) : (err2); +- err2 = write_inode_now(inode, 1); +- err = (err) ? (err) : (err2); +- if (!err) +- err = filemap_fdatawait_range(mapping, start, +- start + count - 1); +- } +- return err; +-} +- +-static int exfat_allow_set_time(struct exfat_sb_info *sbi, struct inode *inode) +-{ +- mode_t allow_utime = sbi->options.allow_utime; +- +- if (!uid_eq(current_fsuid(), inode->i_uid)) { +- if (in_group_p(inode->i_gid)) +- allow_utime >>= 3; +- if (allow_utime & MAY_WRITE) +- return 1; +- } +- +- /* use a default check */ +- return 0; +-} +- +-static int exfat_sanitize_mode(const struct exfat_sb_info *sbi, +- struct inode *inode, umode_t *mode_ptr) +-{ +- mode_t i_mode, mask, perm; +- +- i_mode = inode->i_mode; +- +- if (S_ISREG(i_mode) || S_ISLNK(i_mode)) +- mask = sbi->options.fs_fmask; +- else +- mask = sbi->options.fs_dmask; +- +- perm = *mode_ptr & ~(S_IFMT | mask); +- +- /* Of the r and x bits, all (subject to umask) must be present.*/ +- if ((perm & 0555) != (i_mode & 0555)) +- return -EPERM; +- +- if (exfat_mode_can_hold_ro(inode)) { +- /* +- * Of the w bits, either all (subject to umask) or none must be +- * present. +- */ +- if ((perm & 0222) && ((perm & 0222) != (0222 & ~mask))) +- return -EPERM; +- } else { +- /* +- * If exfat_mode_can_hold_ro(inode) is false, can't change w +- * bits. +- */ +- if ((perm & 0222) != (0222 & ~mask)) +- return -EPERM; +- } +- +- *mode_ptr &= S_IFMT | perm; +- +- return 0; +-} +- +-static void exfat_truncate(struct inode *inode, loff_t old_size) +-{ +- struct super_block *sb = inode->i_sb; +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- struct fs_info_t *p_fs = &sbi->fs_info; +- struct timespec64 curtime; +- int err; +- +- __lock_super(sb); +- +- /* +- * This protects against truncating a file bigger than it was then +- * trying to write into the hole. +- */ +- if (EXFAT_I(inode)->mmu_private > i_size_read(inode)) +- EXFAT_I(inode)->mmu_private = i_size_read(inode); +- +- if (EXFAT_I(inode)->fid.start_clu == 0) +- goto out; +- +- err = ffsTruncateFile(inode, old_size, i_size_read(inode)); +- if (err) +- goto out; +- +- curtime = current_time(inode); +- inode->i_ctime = curtime; +- inode->i_mtime = curtime; +- if (IS_DIRSYNC(inode)) +- (void)exfat_sync_inode(inode); +- else +- mark_inode_dirty(inode); +- +- inode->i_blocks = ((i_size_read(inode) + (p_fs->cluster_size - 1)) & +- ~((loff_t)p_fs->cluster_size - 1)) >> 9; +-out: +- __unlock_super(sb); +-} +- +-static int exfat_setattr(struct dentry *dentry, struct iattr *attr) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(dentry->d_sb); +- struct inode *inode = dentry->d_inode; +- unsigned int ia_valid; +- int error; +- loff_t old_size; +- +- pr_debug("%s entered\n", __func__); +- +- if ((attr->ia_valid & ATTR_SIZE) && +- attr->ia_size > i_size_read(inode)) { +- error = exfat_cont_expand(inode, attr->ia_size); +- if (error || attr->ia_valid == ATTR_SIZE) +- return error; +- attr->ia_valid &= ~ATTR_SIZE; +- } +- +- ia_valid = attr->ia_valid; +- +- if ((ia_valid & (ATTR_MTIME_SET | ATTR_ATIME_SET | ATTR_TIMES_SET)) && +- exfat_allow_set_time(sbi, inode)) { +- attr->ia_valid &= ~(ATTR_MTIME_SET | +- ATTR_ATIME_SET | +- ATTR_TIMES_SET); +- } +- +- error = setattr_prepare(dentry, attr); +- attr->ia_valid = ia_valid; +- if (error) +- return error; +- +- if (((attr->ia_valid & ATTR_UID) && +- (!uid_eq(attr->ia_uid, sbi->options.fs_uid))) || +- ((attr->ia_valid & ATTR_GID) && +- (!gid_eq(attr->ia_gid, sbi->options.fs_gid))) || +- ((attr->ia_valid & ATTR_MODE) && +- (attr->ia_mode & ~(S_IFREG | S_IFLNK | S_IFDIR | 0777)))) { +- return -EPERM; +- } +- +- /* +- * We don't return -EPERM here. Yes, strange, but this is too +- * old behavior. +- */ +- if (attr->ia_valid & ATTR_MODE) { +- if (exfat_sanitize_mode(sbi, inode, &attr->ia_mode) < 0) +- attr->ia_valid &= ~ATTR_MODE; +- } +- +- EXFAT_I(inode)->fid.size = i_size_read(inode); +- +- if (attr->ia_valid & ATTR_SIZE) { +- old_size = i_size_read(inode); +- down_write(&EXFAT_I(inode)->truncate_lock); +- truncate_setsize(inode, attr->ia_size); +- exfat_truncate(inode, old_size); +- up_write(&EXFAT_I(inode)->truncate_lock); +- } +- setattr_copy(inode, attr); +- mark_inode_dirty(inode); +- +- pr_debug("%s exited\n", __func__); +- return error; +-} +- +-static int exfat_getattr(const struct path *path, struct kstat *stat, +- u32 request_mask, unsigned int flags) +-{ +- struct inode *inode = path->dentry->d_inode; +- +- pr_debug("%s entered\n", __func__); +- +- generic_fillattr(inode, stat); +- stat->blksize = EXFAT_SB(inode->i_sb)->fs_info.cluster_size; +- +- pr_debug("%s exited\n", __func__); +- return 0; +-} +- +-static const struct inode_operations exfat_dir_inode_operations = { +- .create = exfat_create, +- .lookup = exfat_lookup, +- .unlink = exfat_unlink, +- .symlink = exfat_symlink, +- .mkdir = exfat_mkdir, +- .rmdir = exfat_rmdir, +- .rename = exfat_rename, +- .setattr = exfat_setattr, +- .getattr = exfat_getattr, +-}; +- +-/*======================================================================*/ +-/* File Operations */ +-/*======================================================================*/ +-static const char *exfat_get_link(struct dentry *dentry, struct inode *inode, +- struct delayed_call *done) +-{ +- struct exfat_inode_info *ei = EXFAT_I(inode); +- +- if (ei->target) { +- char *cookie = ei->target; +- +- if (cookie) +- return (char *)(ei->target); +- } +- return NULL; +-} +- +-static const struct inode_operations exfat_symlink_inode_operations = { +- .get_link = exfat_get_link, +-}; +- +-static int exfat_file_release(struct inode *inode, struct file *filp) +-{ +- struct super_block *sb = inode->i_sb; +- +- EXFAT_I(inode)->fid.size = i_size_read(inode); +- ffsSyncVol(sb, false); +- return 0; +-} +- +-static const struct file_operations exfat_file_operations = { +- .llseek = generic_file_llseek, +- .read_iter = generic_file_read_iter, +- .write_iter = generic_file_write_iter, +- .mmap = generic_file_mmap, +- .release = exfat_file_release, +- .unlocked_ioctl = exfat_generic_ioctl, +- .fsync = generic_file_fsync, +- .splice_read = generic_file_splice_read, +-}; +- +-static const struct inode_operations exfat_file_inode_operations = { +- .setattr = exfat_setattr, +- .getattr = exfat_getattr, +-}; +- +-/*======================================================================*/ +-/* Address Space Operations */ +-/*======================================================================*/ +- +-static int exfat_bmap(struct inode *inode, sector_t sector, sector_t *phys, +- unsigned long *mapped_blocks, int *create) +-{ +- struct super_block *sb = inode->i_sb; +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- struct fs_info_t *p_fs = &sbi->fs_info; +- const unsigned long blocksize = sb->s_blocksize; +- const unsigned char blocksize_bits = sb->s_blocksize_bits; +- sector_t last_block; +- int err, clu_offset, sec_offset; +- unsigned int cluster; +- +- *phys = 0; +- *mapped_blocks = 0; +- +- last_block = (i_size_read(inode) + (blocksize - 1)) >> blocksize_bits; +- if (sector >= last_block) { +- if (*create == 0) +- return 0; +- } else { +- *create = 0; +- } +- +- /* cluster offset */ +- clu_offset = sector >> p_fs->sectors_per_clu_bits; +- +- /* sector offset in cluster */ +- sec_offset = sector & (p_fs->sectors_per_clu - 1); +- +- EXFAT_I(inode)->fid.size = i_size_read(inode); +- +- err = ffsMapCluster(inode, clu_offset, &cluster); +- +- if (!err && (cluster != CLUSTER_32(~0))) { +- *phys = START_SECTOR(cluster) + sec_offset; +- *mapped_blocks = p_fs->sectors_per_clu - sec_offset; +- } +- +- return 0; +-} +- +-static int exfat_get_block(struct inode *inode, sector_t iblock, +- struct buffer_head *bh_result, int create) +-{ +- struct super_block *sb = inode->i_sb; +- unsigned long max_blocks = bh_result->b_size >> inode->i_blkbits; +- int err; +- unsigned long mapped_blocks; +- sector_t phys; +- +- __lock_super(sb); +- +- err = exfat_bmap(inode, iblock, &phys, &mapped_blocks, &create); +- if (err) { +- __unlock_super(sb); +- return err; +- } +- +- if (phys) { +- max_blocks = min(mapped_blocks, max_blocks); +- if (create) { +- EXFAT_I(inode)->mmu_private += max_blocks << +- sb->s_blocksize_bits; +- set_buffer_new(bh_result); +- } +- map_bh(bh_result, sb, phys); +- } +- +- bh_result->b_size = max_blocks << sb->s_blocksize_bits; +- __unlock_super(sb); +- +- return 0; +-} +- +-static int exfat_readpage(struct file *file, struct page *page) +-{ +- return mpage_readpage(page, exfat_get_block); +-} +- +-static int exfat_readpages(struct file *file, struct address_space *mapping, +- struct list_head *pages, unsigned int nr_pages) +-{ +- return mpage_readpages(mapping, pages, nr_pages, exfat_get_block); +-} +- +-static int exfat_writepage(struct page *page, struct writeback_control *wbc) +-{ +- return block_write_full_page(page, exfat_get_block, wbc); +-} +- +-static int exfat_writepages(struct address_space *mapping, +- struct writeback_control *wbc) +-{ +- return mpage_writepages(mapping, wbc, exfat_get_block); +-} +- +-static void exfat_write_failed(struct address_space *mapping, loff_t to) +-{ +- struct inode *inode = mapping->host; +- +- if (to > i_size_read(inode)) { +- truncate_pagecache(inode, i_size_read(inode)); +- EXFAT_I(inode)->fid.size = i_size_read(inode); +- exfat_truncate(inode, i_size_read(inode)); +- } +-} +- +-static int exfat_write_begin(struct file *file, struct address_space *mapping, +- loff_t pos, unsigned int len, unsigned int flags, +- struct page **pagep, void **fsdata) +-{ +- int ret; +- +- *pagep = NULL; +- ret = cont_write_begin(file, mapping, pos, len, flags, pagep, fsdata, +- exfat_get_block, +- &EXFAT_I(mapping->host)->mmu_private); +- +- if (ret < 0) +- exfat_write_failed(mapping, pos + len); +- return ret; +-} +- +-static int exfat_write_end(struct file *file, struct address_space *mapping, +- loff_t pos, unsigned int len, unsigned int copied, +- struct page *pagep, void *fsdata) +-{ +- struct inode *inode = mapping->host; +- struct file_id_t *fid = &(EXFAT_I(inode)->fid); +- struct timespec64 curtime; +- int err; +- +- err = generic_write_end(file, mapping, pos, len, copied, pagep, fsdata); +- +- if (err < len) +- exfat_write_failed(mapping, pos + len); +- +- if (!(err < 0) && !(fid->attr & ATTR_ARCHIVE)) { +- curtime = current_time(inode); +- inode->i_mtime = curtime; +- inode->i_ctime = curtime; +- fid->attr |= ATTR_ARCHIVE; +- mark_inode_dirty(inode); +- } +- return err; +-} +- +-static ssize_t exfat_direct_IO(struct kiocb *iocb, struct iov_iter *iter) +-{ +- struct inode *inode = iocb->ki_filp->f_mapping->host; +- struct address_space *mapping = iocb->ki_filp->f_mapping; +- ssize_t ret; +- int rw; +- +- rw = iov_iter_rw(iter); +- +- if (rw == WRITE) { +- if (EXFAT_I(inode)->mmu_private < iov_iter_count(iter)) +- return 0; +- } +- ret = blockdev_direct_IO(iocb, inode, iter, exfat_get_block); +- +- if ((ret < 0) && (rw & WRITE)) +- exfat_write_failed(mapping, iov_iter_count(iter)); +- return ret; +-} +- +-static sector_t _exfat_bmap(struct address_space *mapping, sector_t block) +-{ +- sector_t blocknr; +- +- /* exfat_get_cluster() assumes the requested blocknr isn't truncated. */ +- down_read(&EXFAT_I(mapping->host)->truncate_lock); +- blocknr = generic_block_bmap(mapping, block, exfat_get_block); +- up_read(&EXFAT_I(mapping->host)->truncate_lock); +- +- return blocknr; +-} +- +-static const struct address_space_operations exfat_aops = { +- .readpage = exfat_readpage, +- .readpages = exfat_readpages, +- .writepage = exfat_writepage, +- .writepages = exfat_writepages, +- .write_begin = exfat_write_begin, +- .write_end = exfat_write_end, +- .direct_IO = exfat_direct_IO, +- .bmap = _exfat_bmap +-}; +- +-/*======================================================================*/ +-/* Super Operations */ +-/*======================================================================*/ +- +-static struct inode *exfat_iget(struct super_block *sb, loff_t i_pos) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- struct exfat_inode_info *info; +- struct hlist_head *head = sbi->inode_hashtable + exfat_hash(i_pos); +- struct inode *inode = NULL; +- +- spin_lock(&sbi->inode_hash_lock); +- hlist_for_each_entry(info, head, i_hash_fat) { +- BUG_ON(info->vfs_inode.i_sb != sb); +- +- if (i_pos != info->i_pos) +- continue; +- inode = igrab(&info->vfs_inode); +- if (inode) +- break; +- } +- spin_unlock(&sbi->inode_hash_lock); +- return inode; +-} +- +-/* doesn't deal with root inode */ +-static int exfat_fill_inode(struct inode *inode, struct file_id_t *fid) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(inode->i_sb); +- struct fs_info_t *p_fs = &sbi->fs_info; +- struct dir_entry_t info; +- +- memcpy(&(EXFAT_I(inode)->fid), fid, sizeof(struct file_id_t)); +- +- ffsReadStat(inode, &info); +- +- EXFAT_I(inode)->i_pos = 0; +- EXFAT_I(inode)->target = NULL; +- inode->i_uid = sbi->options.fs_uid; +- inode->i_gid = sbi->options.fs_gid; +- INC_IVERSION(inode); +- inode->i_generation = prandom_u32(); +- +- if (info.Attr & ATTR_SUBDIR) { /* directory */ +- inode->i_generation &= ~1; +- inode->i_mode = exfat_make_mode(sbi, info.Attr, 0777); +- inode->i_op = &exfat_dir_inode_operations; +- inode->i_fop = &exfat_dir_operations; +- +- i_size_write(inode, info.Size); +- EXFAT_I(inode)->mmu_private = i_size_read(inode); +- set_nlink(inode, info.NumSubdirs); +- } else if (info.Attr & ATTR_SYMLINK) { /* symbolic link */ +- inode->i_generation |= 1; +- inode->i_mode = exfat_make_mode(sbi, info.Attr, 0777); +- inode->i_op = &exfat_symlink_inode_operations; +- +- i_size_write(inode, info.Size); +- EXFAT_I(inode)->mmu_private = i_size_read(inode); +- } else { /* regular file */ +- inode->i_generation |= 1; +- inode->i_mode = exfat_make_mode(sbi, info.Attr, 0777); +- inode->i_op = &exfat_file_inode_operations; +- inode->i_fop = &exfat_file_operations; +- inode->i_mapping->a_ops = &exfat_aops; +- inode->i_mapping->nrpages = 0; +- +- i_size_write(inode, info.Size); +- EXFAT_I(inode)->mmu_private = i_size_read(inode); +- } +- exfat_save_attr(inode, info.Attr); +- +- inode->i_blocks = ((i_size_read(inode) + (p_fs->cluster_size - 1)) +- & ~((loff_t)p_fs->cluster_size - 1)) >> 9; +- +- exfat_time_fat2unix(&inode->i_mtime, &info.ModifyTimestamp); +- exfat_time_fat2unix(&inode->i_ctime, &info.CreateTimestamp); +- exfat_time_fat2unix(&inode->i_atime, &info.AccessTimestamp); +- +- return 0; +-} +- +-static struct inode *exfat_build_inode(struct super_block *sb, +- struct file_id_t *fid, loff_t i_pos) +-{ +- struct inode *inode; +- int err; +- +- inode = exfat_iget(sb, i_pos); +- if (inode) +- goto out; +- inode = new_inode(sb); +- if (!inode) { +- inode = ERR_PTR(-ENOMEM); +- goto out; +- } +- inode->i_ino = iunique(sb, EXFAT_ROOT_INO); +- SET_IVERSION(inode, 1); +- err = exfat_fill_inode(inode, fid); +- if (err) { +- iput(inode); +- inode = ERR_PTR(err); +- goto out; +- } +- exfat_attach(inode, i_pos); +- insert_inode_hash(inode); +-out: +- return inode; +-} +- +-static int exfat_sync_inode(struct inode *inode) +-{ +- return exfat_write_inode(inode, NULL); +-} +- +-static struct inode *exfat_alloc_inode(struct super_block *sb) +-{ +- struct exfat_inode_info *ei; +- +- ei = kmem_cache_alloc(exfat_inode_cachep, GFP_NOFS); +- if (!ei) +- return NULL; +- +- init_rwsem(&ei->truncate_lock); +- +- return &ei->vfs_inode; +-} +- +-static void exfat_destroy_inode(struct inode *inode) +-{ +- kfree(EXFAT_I(inode)->target); +- EXFAT_I(inode)->target = NULL; +- +- kmem_cache_free(exfat_inode_cachep, EXFAT_I(inode)); +-} +- +-static int exfat_write_inode(struct inode *inode, struct writeback_control *wbc) +-{ +- struct dir_entry_t info; +- +- if (inode->i_ino == EXFAT_ROOT_INO) +- return 0; +- +- info.Attr = exfat_make_attr(inode); +- info.Size = i_size_read(inode); +- +- exfat_time_unix2fat(&inode->i_mtime, &info.ModifyTimestamp); +- exfat_time_unix2fat(&inode->i_ctime, &info.CreateTimestamp); +- exfat_time_unix2fat(&inode->i_atime, &info.AccessTimestamp); +- +- ffsWriteStat(inode, &info); +- +- return 0; +-} +- +-static void exfat_evict_inode(struct inode *inode) +-{ +- truncate_inode_pages(&inode->i_data, 0); +- +- if (!inode->i_nlink) +- i_size_write(inode, 0); +- invalidate_inode_buffers(inode); +- clear_inode(inode); +- exfat_detach(inode); +- +- remove_inode_hash(inode); +-} +- +-static void exfat_free_super(struct exfat_sb_info *sbi) +-{ +- if (sbi->nls_disk) +- unload_nls(sbi->nls_disk); +- if (sbi->nls_io) +- unload_nls(sbi->nls_io); +- if (sbi->options.iocharset != exfat_default_iocharset) +- kfree(sbi->options.iocharset); +- /* mutex_init is in exfat_fill_super function. only for 3.7+ */ +- mutex_destroy(&sbi->s_lock); +- kvfree(sbi); +-} +- +-static void exfat_put_super(struct super_block *sb) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- +- if (__is_sb_dirty(sb)) +- exfat_write_super(sb); +- +- ffsUmountVol(sb); +- +- sb->s_fs_info = NULL; +- exfat_free_super(sbi); +-} +- +-static void exfat_write_super(struct super_block *sb) +-{ +- __lock_super(sb); +- +- __set_sb_clean(sb); +- +- if (!sb_rdonly(sb)) +- ffsSyncVol(sb, true); +- +- __unlock_super(sb); +-} +- +-static int exfat_sync_fs(struct super_block *sb, int wait) +-{ +- int err = 0; +- +- if (__is_sb_dirty(sb)) { +- __lock_super(sb); +- __set_sb_clean(sb); +- err = ffsSyncVol(sb, true); +- __unlock_super(sb); +- } +- +- return err; +-} +- +-static int exfat_statfs(struct dentry *dentry, struct kstatfs *buf) +-{ +- struct super_block *sb = dentry->d_sb; +- u64 id = huge_encode_dev(sb->s_bdev->bd_dev); +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- struct vol_info_t info; +- +- if (p_fs->used_clusters == UINT_MAX) { +- if (ffsGetVolInfo(sb, &info) == -EIO) +- return -EIO; +- +- } else { +- info.FatType = p_fs->vol_type; +- info.ClusterSize = p_fs->cluster_size; +- info.NumClusters = p_fs->num_clusters - 2; +- info.UsedClusters = p_fs->used_clusters; +- info.FreeClusters = info.NumClusters - info.UsedClusters; +- +- if (p_fs->dev_ejected) +- pr_info("[EXFAT] statfs on device that is ejected\n"); +- } +- +- buf->f_type = sb->s_magic; +- buf->f_bsize = info.ClusterSize; +- buf->f_blocks = info.NumClusters; +- buf->f_bfree = info.FreeClusters; +- buf->f_bavail = info.FreeClusters; +- buf->f_fsid.val[0] = (u32)id; +- buf->f_fsid.val[1] = (u32)(id >> 32); +- buf->f_namelen = 260; +- +- return 0; +-} +- +-static int exfat_remount(struct super_block *sb, int *flags, char *data) +-{ +- *flags |= SB_NODIRATIME; +- return 0; +-} +- +-static int exfat_show_options(struct seq_file *m, struct dentry *root) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(root->d_sb); +- struct exfat_mount_options *opts = &sbi->options; +- +- if (__kuid_val(opts->fs_uid)) +- seq_printf(m, ",uid=%u", __kuid_val(opts->fs_uid)); +- if (__kgid_val(opts->fs_gid)) +- seq_printf(m, ",gid=%u", __kgid_val(opts->fs_gid)); +- seq_printf(m, ",fmask=%04o", opts->fs_fmask); +- seq_printf(m, ",dmask=%04o", opts->fs_dmask); +- if (opts->allow_utime) +- seq_printf(m, ",allow_utime=%04o", opts->allow_utime); +- if (sbi->nls_disk) +- seq_printf(m, ",codepage=%s", sbi->nls_disk->charset); +- if (sbi->nls_io) +- seq_printf(m, ",iocharset=%s", sbi->nls_io->charset); +- seq_printf(m, ",namecase=%u", opts->casesensitive); +- if (opts->errors == EXFAT_ERRORS_CONT) +- seq_puts(m, ",errors=continue"); +- else if (opts->errors == EXFAT_ERRORS_PANIC) +- seq_puts(m, ",errors=panic"); +- else +- seq_puts(m, ",errors=remount-ro"); +-#ifdef CONFIG_STAGING_EXFAT_DISCARD +- if (opts->discard) +- seq_puts(m, ",discard"); +-#endif +- return 0; +-} +- +-static const struct super_operations exfat_sops = { +- .alloc_inode = exfat_alloc_inode, +- .destroy_inode = exfat_destroy_inode, +- .write_inode = exfat_write_inode, +- .evict_inode = exfat_evict_inode, +- .put_super = exfat_put_super, +- .sync_fs = exfat_sync_fs, +- .statfs = exfat_statfs, +- .remount_fs = exfat_remount, +- .show_options = exfat_show_options, +-}; +- +-/*======================================================================*/ +-/* Export Operations */ +-/*======================================================================*/ +- +-static struct inode *exfat_nfs_get_inode(struct super_block *sb, u64 ino, +- u32 generation) +-{ +- struct inode *inode = NULL; +- +- if (ino < EXFAT_ROOT_INO) +- return inode; +- inode = ilookup(sb, ino); +- +- if (inode && generation && (inode->i_generation != generation)) { +- iput(inode); +- inode = NULL; +- } +- +- return inode; +-} +- +-static struct dentry *exfat_fh_to_dentry(struct super_block *sb, +- struct fid *fid, int fh_len, +- int fh_type) +-{ +- return generic_fh_to_dentry(sb, fid, fh_len, fh_type, +- exfat_nfs_get_inode); +-} +- +-static struct dentry *exfat_fh_to_parent(struct super_block *sb, +- struct fid *fid, int fh_len, +- int fh_type) +-{ +- return generic_fh_to_parent(sb, fid, fh_len, fh_type, +- exfat_nfs_get_inode); +-} +- +-static const struct export_operations exfat_export_ops = { +- .fh_to_dentry = exfat_fh_to_dentry, +- .fh_to_parent = exfat_fh_to_parent, +-}; +- +-/*======================================================================*/ +-/* Super Block Read Operations */ +-/*======================================================================*/ +- +-enum { +- Opt_uid, +- Opt_gid, +- Opt_umask, +- Opt_dmask, +- Opt_fmask, +- Opt_allow_utime, +- Opt_codepage, +- Opt_charset, +- Opt_namecase, +- Opt_debug, +- Opt_err_cont, +- Opt_err_panic, +- Opt_err_ro, +- Opt_utf8_hack, +- Opt_err, +-#ifdef CONFIG_STAGING_EXFAT_DISCARD +- Opt_discard, +-#endif /* EXFAT_CONFIG_DISCARD */ +-}; +- +-static const match_table_t exfat_tokens = { +- {Opt_uid, "uid=%u"}, +- {Opt_gid, "gid=%u"}, +- {Opt_umask, "umask=%o"}, +- {Opt_dmask, "dmask=%o"}, +- {Opt_fmask, "fmask=%o"}, +- {Opt_allow_utime, "allow_utime=%o"}, +- {Opt_codepage, "codepage=%u"}, +- {Opt_charset, "iocharset=%s"}, +- {Opt_namecase, "namecase=%u"}, +- {Opt_debug, "debug"}, +- {Opt_err_cont, "errors=continue"}, +- {Opt_err_panic, "errors=panic"}, +- {Opt_err_ro, "errors=remount-ro"}, +- {Opt_utf8_hack, "utf8"}, +-#ifdef CONFIG_STAGING_EXFAT_DISCARD +- {Opt_discard, "discard"}, +-#endif /* CONFIG_STAGING_EXFAT_DISCARD */ +- {Opt_err, NULL} +-}; +- +-static int parse_options(char *options, int silent, int *debug, +- struct exfat_mount_options *opts) +-{ +- char *p; +- substring_t args[MAX_OPT_ARGS]; +- int option; +- char *iocharset; +- +- opts->fs_uid = current_uid(); +- opts->fs_gid = current_gid(); +- opts->fs_fmask = current->fs->umask; +- opts->fs_dmask = current->fs->umask; +- opts->allow_utime = U16_MAX; +- opts->codepage = exfat_default_codepage; +- opts->iocharset = exfat_default_iocharset; +- opts->casesensitive = 0; +- opts->errors = EXFAT_ERRORS_RO; +-#ifdef CONFIG_STAGING_EXFAT_DISCARD +- opts->discard = 0; +-#endif +- *debug = 0; +- +- if (!options) +- goto out; +- +- while ((p = strsep(&options, ","))) { +- int token; +- +- if (!*p) +- continue; +- +- token = match_token(p, exfat_tokens, args); +- switch (token) { +- case Opt_uid: +- if (match_int(&args[0], &option)) +- return 0; +- opts->fs_uid = KUIDT_INIT(option); +- break; +- case Opt_gid: +- if (match_int(&args[0], &option)) +- return 0; +- opts->fs_gid = KGIDT_INIT(option); +- break; +- case Opt_umask: +- case Opt_dmask: +- case Opt_fmask: +- if (match_octal(&args[0], &option)) +- return 0; +- if (token != Opt_dmask) +- opts->fs_fmask = option; +- if (token != Opt_fmask) +- opts->fs_dmask = option; +- break; +- case Opt_allow_utime: +- if (match_octal(&args[0], &option)) +- return 0; +- opts->allow_utime = option & 0022; +- break; +- case Opt_codepage: +- if (match_int(&args[0], &option)) +- return 0; +- opts->codepage = option; +- break; +- case Opt_charset: +- if (opts->iocharset != exfat_default_iocharset) +- kfree(opts->iocharset); +- iocharset = match_strdup(&args[0]); +- if (!iocharset) +- return -ENOMEM; +- opts->iocharset = iocharset; +- break; +- case Opt_namecase: +- if (match_int(&args[0], &option)) +- return 0; +- opts->casesensitive = option; +- break; +- case Opt_err_cont: +- opts->errors = EXFAT_ERRORS_CONT; +- break; +- case Opt_err_panic: +- opts->errors = EXFAT_ERRORS_PANIC; +- break; +- case Opt_err_ro: +- opts->errors = EXFAT_ERRORS_RO; +- break; +- case Opt_debug: +- *debug = 1; +- break; +-#ifdef CONFIG_STAGING_EXFAT_DISCARD +- case Opt_discard: +- opts->discard = 1; +- break; +-#endif /* CONFIG_STAGING_EXFAT_DISCARD */ +- case Opt_utf8_hack: +- break; +- default: +- if (!silent) +- pr_err("[EXFAT] Unrecognized mount option %s or missing value\n", +- p); +- return -EINVAL; +- } +- } +- +-out: +- if (opts->allow_utime == U16_MAX) +- opts->allow_utime = ~opts->fs_dmask & 0022; +- +- return 0; +-} +- +-static void exfat_hash_init(struct super_block *sb) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- int i; +- +- spin_lock_init(&sbi->inode_hash_lock); +- for (i = 0; i < EXFAT_HASH_SIZE; i++) +- INIT_HLIST_HEAD(&sbi->inode_hashtable[i]); +-} +- +-static int exfat_read_root(struct inode *inode) +-{ +- struct super_block *sb = inode->i_sb; +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- struct fs_info_t *p_fs = &sbi->fs_info; +- struct timespec64 curtime; +- struct dir_entry_t info; +- +- EXFAT_I(inode)->fid.dir.dir = p_fs->root_dir; +- EXFAT_I(inode)->fid.dir.flags = 0x01; +- EXFAT_I(inode)->fid.entry = -1; +- EXFAT_I(inode)->fid.start_clu = p_fs->root_dir; +- EXFAT_I(inode)->fid.flags = 0x01; +- EXFAT_I(inode)->fid.type = TYPE_DIR; +- EXFAT_I(inode)->fid.rwoffset = 0; +- EXFAT_I(inode)->fid.hint_last_off = -1; +- +- EXFAT_I(inode)->target = NULL; +- +- ffsReadStat(inode, &info); +- +- inode->i_uid = sbi->options.fs_uid; +- inode->i_gid = sbi->options.fs_gid; +- INC_IVERSION(inode); +- inode->i_generation = 0; +- inode->i_mode = exfat_make_mode(sbi, ATTR_SUBDIR, 0777); +- inode->i_op = &exfat_dir_inode_operations; +- inode->i_fop = &exfat_dir_operations; +- +- i_size_write(inode, info.Size); +- inode->i_blocks = ((i_size_read(inode) + (p_fs->cluster_size - 1)) +- & ~((loff_t)p_fs->cluster_size - 1)) >> 9; +- EXFAT_I(inode)->i_pos = ((loff_t)p_fs->root_dir << 32) | 0xffffffff; +- EXFAT_I(inode)->mmu_private = i_size_read(inode); +- +- exfat_save_attr(inode, ATTR_SUBDIR); +- curtime = current_time(inode); +- inode->i_mtime = curtime; +- inode->i_atime = curtime; +- inode->i_ctime = curtime; +- set_nlink(inode, info.NumSubdirs + 2); +- +- return 0; +-} +- +-static void setup_dops(struct super_block *sb) +-{ +- if (EXFAT_SB(sb)->options.casesensitive == 0) +- sb->s_d_op = &exfat_ci_dentry_ops; +- else +- sb->s_d_op = &exfat_dentry_ops; +-} +- +-static int exfat_fill_super(struct super_block *sb, void *data, int silent) +-{ +- struct inode *root_inode = NULL; +- struct exfat_sb_info *sbi; +- int debug, ret; +- long error; +- +- /* +- * GFP_KERNEL is ok here, because while we do hold the +- * supeblock lock, memory pressure can't call back into +- * the filesystem, since we're only just about to mount +- * it and have no inodes etc active! +- */ +- sbi = kvzalloc(sizeof(*sbi), GFP_KERNEL); +- if (!sbi) +- return -ENOMEM; +- mutex_init(&sbi->s_lock); +- sb->s_fs_info = sbi; +- sb->s_flags |= SB_NODIRATIME; +- sb->s_magic = EXFAT_SUPER_MAGIC; +- sb->s_op = &exfat_sops; +- sb->s_export_op = &exfat_export_ops; +- +- error = parse_options(data, silent, &debug, &sbi->options); +- if (error) +- goto out_fail; +- +- setup_dops(sb); +- +- error = -EIO; +- sb_min_blocksize(sb, 512); +- sb->s_maxbytes = 0x7fffffffffffffffLL; /* maximum file size */ +- +- ret = ffsMountVol(sb); +- if (ret) { +- if (!silent) +- pr_err("[EXFAT] ffsMountVol failed\n"); +- +- goto out_fail; +- } +- +- /* set up enough so that it can read an inode */ +- exfat_hash_init(sb); +- +- /* +- * The low byte of FAT's first entry must have same value with +- * media-field. But in real world, too many devices is +- * writing wrong value. So, removed that validity check. +- * +- * if (FAT_FIRST_ENT(sb, media) != first) +- */ +- +- sbi->nls_io = load_nls(sbi->options.iocharset); +- +- error = -ENOMEM; +- root_inode = new_inode(sb); +- if (!root_inode) +- goto out_fail2; +- root_inode->i_ino = EXFAT_ROOT_INO; +- SET_IVERSION(root_inode, 1); +- +- error = exfat_read_root(root_inode); +- if (error < 0) +- goto out_fail2; +- error = -ENOMEM; +- exfat_attach(root_inode, EXFAT_I(root_inode)->i_pos); +- insert_inode_hash(root_inode); +- sb->s_root = d_make_root(root_inode); +- if (!sb->s_root) { +- pr_err("[EXFAT] Getting the root inode failed\n"); +- goto out_fail2; +- } +- +- return 0; +- +-out_fail2: +- ffsUmountVol(sb); +-out_fail: +- if (root_inode) +- iput(root_inode); +- sb->s_fs_info = NULL; +- exfat_free_super(sbi); +- return error; +-} +- +-static struct dentry *exfat_fs_mount(struct file_system_type *fs_type, +- int flags, const char *dev_name, +- void *data) +-{ +- return mount_bdev(fs_type, flags, dev_name, data, exfat_fill_super); +-} +- +-static void init_once(void *foo) +-{ +- struct exfat_inode_info *ei = (struct exfat_inode_info *)foo; +- +- INIT_HLIST_NODE(&ei->i_hash_fat); +- inode_init_once(&ei->vfs_inode); +-} +- +-static int __init exfat_init_inodecache(void) +-{ +- exfat_inode_cachep = kmem_cache_create("exfat_inode_cache", +- sizeof(struct exfat_inode_info), +- 0, +- (SLAB_RECLAIM_ACCOUNT | +- SLAB_MEM_SPREAD), +- init_once); +- if (!exfat_inode_cachep) +- return -ENOMEM; +- return 0; +-} +- +-static void __exit exfat_destroy_inodecache(void) +-{ +- /* +- * Make sure all delayed rcu free inodes are flushed before we +- * destroy cache. +- */ +- rcu_barrier(); +- kmem_cache_destroy(exfat_inode_cachep); +-} +- +-#ifdef CONFIG_STAGING_EXFAT_KERNEL_DEBUG +-static void exfat_debug_kill_sb(struct super_block *sb) +-{ +- struct exfat_sb_info *sbi = EXFAT_SB(sb); +- struct block_device *bdev = sb->s_bdev; +- struct fs_info_t *p_fs = &(EXFAT_SB(sb)->fs_info); +- +- long flags; +- +- if (sbi) { +- flags = sbi->debug_flags; +- +- if (flags & EXFAT_DEBUGFLAGS_INVALID_UMOUNT) { +- /* +- * invalidate_bdev drops all device cache include +- * dirty. We use this to simulate device removal. +- */ +- mutex_lock(&p_fs->v_mutex); +- exfat_fat_release_all(sb); +- exfat_buf_release_all(sb); +- mutex_unlock(&p_fs->v_mutex); +- +- invalidate_bdev(bdev); +- } +- } +- +- kill_block_super(sb); +-} +-#endif /* CONFIG_STAGING_EXFAT_KERNEL_DEBUG */ +- +-static struct file_system_type exfat_fs_type = { +- .owner = THIS_MODULE, +- .name = "exfat", +- .mount = exfat_fs_mount, +-#ifdef CONFIG_STAGING_EXFAT_KERNEL_DEBUG +- .kill_sb = exfat_debug_kill_sb, +-#else +- .kill_sb = kill_block_super, +-#endif /* CONFIG_STAGING_EXFAT_KERNEL_DEBUG */ +- .fs_flags = FS_REQUIRES_DEV, +-}; +- +-static int __init init_exfat(void) +-{ +- int err; +- +- BUILD_BUG_ON(sizeof(struct dentry_t) != DENTRY_SIZE); +- BUILD_BUG_ON(sizeof(struct dos_dentry_t) != DENTRY_SIZE); +- BUILD_BUG_ON(sizeof(struct ext_dentry_t) != DENTRY_SIZE); +- BUILD_BUG_ON(sizeof(struct file_dentry_t) != DENTRY_SIZE); +- BUILD_BUG_ON(sizeof(struct strm_dentry_t) != DENTRY_SIZE); +- BUILD_BUG_ON(sizeof(struct name_dentry_t) != DENTRY_SIZE); +- BUILD_BUG_ON(sizeof(struct bmap_dentry_t) != DENTRY_SIZE); +- BUILD_BUG_ON(sizeof(struct case_dentry_t) != DENTRY_SIZE); +- BUILD_BUG_ON(sizeof(struct volm_dentry_t) != DENTRY_SIZE); +- +- pr_info("exFAT: Version %s\n", EXFAT_VERSION); +- +- err = exfat_init_inodecache(); +- if (err) +- return err; +- +- err = register_filesystem(&exfat_fs_type); +- if (err) +- return err; +- +- return 0; +-} +- +-static void __exit exit_exfat(void) +-{ +- exfat_destroy_inodecache(); +- unregister_filesystem(&exfat_fs_type); +-} +- +-module_init(init_exfat); +-module_exit(exit_exfat); +- +-MODULE_LICENSE("GPL"); +-MODULE_DESCRIPTION("exFAT Filesystem Driver"); +-MODULE_ALIAS_FS("exfat"); +diff -Nurp linux-5.6.3.orig/drivers/staging/exfat/exfat_upcase.c linux-5.6.3/drivers/staging/exfat/exfat_upcase.c +--- linux-5.6.3.orig/drivers/staging/exfat/exfat_upcase.c 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/drivers/staging/exfat/exfat_upcase.c 1970-01-01 02:00:00.000000000 +0200 +@@ -1,740 +0,0 @@ +-// SPDX-License-Identifier: GPL-2.0-or-later +-/* +- * Copyright (C) 2012-2013 Samsung Electronics Co., Ltd. +- */ +- +-#include +-#include "exfat.h" +- +-const u8 uni_upcase[NUM_UPCASE << 1] = { +- 0x00, 0x00, 0x01, 0x00, 0x02, 0x00, 0x03, 0x00, +- 0x04, 0x00, 0x05, 0x00, 0x06, 0x00, 0x07, 0x00, +- 0x08, 0x00, 0x09, 0x00, 0x0A, 0x00, 0x0B, 0x00, +- 0x0C, 0x00, 0x0D, 0x00, 0x0E, 0x00, 0x0F, 0x00, +- 0x10, 0x00, 0x11, 0x00, 0x12, 0x00, 0x13, 0x00, +- 0x14, 0x00, 0x15, 0x00, 0x16, 0x00, 0x17, 0x00, +- 0x18, 0x00, 0x19, 0x00, 0x1A, 0x00, 0x1B, 0x00, +- 0x1C, 0x00, 0x1D, 0x00, 0x1E, 0x00, 0x1F, 0x00, +- 0x20, 0x00, 0x21, 0x00, 0x22, 0x00, 0x23, 0x00, +- 0x24, 0x00, 0x25, 0x00, 0x26, 0x00, 0x27, 0x00, +- 0x28, 0x00, 0x29, 0x00, 0x2A, 0x00, 0x2B, 0x00, +- 0x2C, 0x00, 0x2D, 0x00, 0x2E, 0x00, 0x2F, 0x00, +- 0x30, 0x00, 0x31, 0x00, 0x32, 0x00, 0x33, 0x00, +- 0x34, 0x00, 0x35, 0x00, 0x36, 0x00, 0x37, 0x00, +- 0x38, 0x00, 0x39, 0x00, 0x3A, 0x00, 0x3B, 0x00, +- 0x3C, 0x00, 0x3D, 0x00, 0x3E, 0x00, 0x3F, 0x00, +- 0x40, 0x00, 0x41, 0x00, 0x42, 0x00, 0x43, 0x00, +- 0x44, 0x00, 0x45, 0x00, 0x46, 0x00, 0x47, 0x00, +- 0x48, 0x00, 0x49, 0x00, 0x4A, 0x00, 0x4B, 0x00, +- 0x4C, 0x00, 0x4D, 0x00, 0x4E, 0x00, 0x4F, 0x00, +- 0x50, 0x00, 0x51, 0x00, 0x52, 0x00, 0x53, 0x00, +- 0x54, 0x00, 0x55, 0x00, 0x56, 0x00, 0x57, 0x00, +- 0x58, 0x00, 0x59, 0x00, 0x5A, 0x00, 0x5B, 0x00, +- 0x5C, 0x00, 0x5D, 0x00, 0x5E, 0x00, 0x5F, 0x00, +- 0x60, 0x00, 0x41, 0x00, 0x42, 0x00, 0x43, 0x00, +- 0x44, 0x00, 0x45, 0x00, 0x46, 0x00, 0x47, 0x00, +- 0x48, 0x00, 0x49, 0x00, 0x4A, 0x00, 0x4B, 0x00, +- 0x4C, 0x00, 0x4D, 0x00, 0x4E, 0x00, 0x4F, 0x00, +- 0x50, 0x00, 0x51, 0x00, 0x52, 0x00, 0x53, 0x00, +- 0x54, 0x00, 0x55, 0x00, 0x56, 0x00, 0x57, 0x00, +- 0x58, 0x00, 0x59, 0x00, 0x5A, 0x00, 0x7B, 0x00, +- 0x7C, 0x00, 0x7D, 0x00, 0x7E, 0x00, 0x7F, 0x00, +- 0x80, 0x00, 0x81, 0x00, 0x82, 0x00, 0x83, 0x00, +- 0x84, 0x00, 0x85, 0x00, 0x86, 0x00, 0x87, 0x00, +- 0x88, 0x00, 0x89, 0x00, 0x8A, 0x00, 0x8B, 0x00, +- 0x8C, 0x00, 0x8D, 0x00, 0x8E, 0x00, 0x8F, 0x00, +- 0x90, 0x00, 0x91, 0x00, 0x92, 0x00, 0x93, 0x00, +- 0x94, 0x00, 0x95, 0x00, 0x96, 0x00, 0x97, 0x00, +- 0x98, 0x00, 0x99, 0x00, 0x9A, 0x00, 0x9B, 0x00, +- 0x9C, 0x00, 0x9D, 0x00, 0x9E, 0x00, 0x9F, 0x00, +- 0xA0, 0x00, 0xA1, 0x00, 0xA2, 0x00, 0xA3, 0x00, +- 0xA4, 0x00, 0xA5, 0x00, 0xA6, 0x00, 0xA7, 0x00, +- 0xA8, 0x00, 0xA9, 0x00, 0xAA, 0x00, 0xAB, 0x00, +- 0xAC, 0x00, 0xAD, 0x00, 0xAE, 0x00, 0xAF, 0x00, +- 0xB0, 0x00, 0xB1, 0x00, 0xB2, 0x00, 0xB3, 0x00, +- 0xB4, 0x00, 0xB5, 0x00, 0xB6, 0x00, 0xB7, 0x00, +- 0xB8, 0x00, 0xB9, 0x00, 0xBA, 0x00, 0xBB, 0x00, +- 0xBC, 0x00, 0xBD, 0x00, 0xBE, 0x00, 0xBF, 0x00, +- 0xC0, 0x00, 0xC1, 0x00, 0xC2, 0x00, 0xC3, 0x00, +- 0xC4, 0x00, 0xC5, 0x00, 0xC6, 0x00, 0xC7, 0x00, +- 0xC8, 0x00, 0xC9, 0x00, 0xCA, 0x00, 0xCB, 0x00, +- 0xCC, 0x00, 0xCD, 0x00, 0xCE, 0x00, 0xCF, 0x00, +- 0xD0, 0x00, 0xD1, 0x00, 0xD2, 0x00, 0xD3, 0x00, +- 0xD4, 0x00, 0xD5, 0x00, 0xD6, 0x00, 0xD7, 0x00, +- 0xD8, 0x00, 0xD9, 0x00, 0xDA, 0x00, 0xDB, 0x00, +- 0xDC, 0x00, 0xDD, 0x00, 0xDE, 0x00, 0xDF, 0x00, +- 0xC0, 0x00, 0xC1, 0x00, 0xC2, 0x00, 0xC3, 0x00, +- 0xC4, 0x00, 0xC5, 0x00, 0xC6, 0x00, 0xC7, 0x00, +- 0xC8, 0x00, 0xC9, 0x00, 0xCA, 0x00, 0xCB, 0x00, +- 0xCC, 0x00, 0xCD, 0x00, 0xCE, 0x00, 0xCF, 0x00, +- 0xD0, 0x00, 0xD1, 0x00, 0xD2, 0x00, 0xD3, 0x00, +- 0xD4, 0x00, 0xD5, 0x00, 0xD6, 0x00, 0xF7, 0x00, +- 0xD8, 0x00, 0xD9, 0x00, 0xDA, 0x00, 0xDB, 0x00, +- 0xDC, 0x00, 0xDD, 0x00, 0xDE, 0x00, 0x78, 0x01, +- 0x00, 0x01, 0x00, 0x01, 0x02, 0x01, 0x02, 0x01, +- 0x04, 0x01, 0x04, 0x01, 0x06, 0x01, 0x06, 0x01, +- 0x08, 0x01, 0x08, 0x01, 0x0A, 0x01, 0x0A, 0x01, +- 0x0C, 0x01, 0x0C, 0x01, 0x0E, 0x01, 0x0E, 0x01, +- 0x10, 0x01, 0x10, 0x01, 0x12, 0x01, 0x12, 0x01, +- 0x14, 0x01, 0x14, 0x01, 0x16, 0x01, 0x16, 0x01, +- 0x18, 0x01, 0x18, 0x01, 0x1A, 0x01, 0x1A, 0x01, +- 0x1C, 0x01, 0x1C, 0x01, 0x1E, 0x01, 0x1E, 0x01, +- 0x20, 0x01, 0x20, 0x01, 0x22, 0x01, 0x22, 0x01, +- 0x24, 0x01, 0x24, 0x01, 0x26, 0x01, 0x26, 0x01, +- 0x28, 0x01, 0x28, 0x01, 0x2A, 0x01, 0x2A, 0x01, +- 0x2C, 0x01, 0x2C, 0x01, 0x2E, 0x01, 0x2E, 0x01, +- 0x30, 0x01, 0x31, 0x01, 0x32, 0x01, 0x32, 0x01, +- 0x34, 0x01, 0x34, 0x01, 0x36, 0x01, 0x36, 0x01, +- 0x38, 0x01, 0x39, 0x01, 0x39, 0x01, 0x3B, 0x01, +- 0x3B, 0x01, 0x3D, 0x01, 0x3D, 0x01, 0x3F, 0x01, +- 0x3F, 0x01, 0x41, 0x01, 0x41, 0x01, 0x43, 0x01, +- 0x43, 0x01, 0x45, 0x01, 0x45, 0x01, 0x47, 0x01, +- 0x47, 0x01, 0x49, 0x01, 0x4A, 0x01, 0x4A, 0x01, +- 0x4C, 0x01, 0x4C, 0x01, 0x4E, 0x01, 0x4E, 0x01, +- 0x50, 0x01, 0x50, 0x01, 0x52, 0x01, 0x52, 0x01, +- 0x54, 0x01, 0x54, 0x01, 0x56, 0x01, 0x56, 0x01, +- 0x58, 0x01, 0x58, 0x01, 0x5A, 0x01, 0x5A, 0x01, +- 0x5C, 0x01, 0x5C, 0x01, 0x5E, 0x01, 0x5E, 0x01, +- 0x60, 0x01, 0x60, 0x01, 0x62, 0x01, 0x62, 0x01, +- 0x64, 0x01, 0x64, 0x01, 0x66, 0x01, 0x66, 0x01, +- 0x68, 0x01, 0x68, 0x01, 0x6A, 0x01, 0x6A, 0x01, +- 0x6C, 0x01, 0x6C, 0x01, 0x6E, 0x01, 0x6E, 0x01, +- 0x70, 0x01, 0x70, 0x01, 0x72, 0x01, 0x72, 0x01, +- 0x74, 0x01, 0x74, 0x01, 0x76, 0x01, 0x76, 0x01, +- 0x78, 0x01, 0x79, 0x01, 0x79, 0x01, 0x7B, 0x01, +- 0x7B, 0x01, 0x7D, 0x01, 0x7D, 0x01, 0x7F, 0x01, +- 0x43, 0x02, 0x81, 0x01, 0x82, 0x01, 0x82, 0x01, +- 0x84, 0x01, 0x84, 0x01, 0x86, 0x01, 0x87, 0x01, +- 0x87, 0x01, 0x89, 0x01, 0x8A, 0x01, 0x8B, 0x01, +- 0x8B, 0x01, 0x8D, 0x01, 0x8E, 0x01, 0x8F, 0x01, +- 0x90, 0x01, 0x91, 0x01, 0x91, 0x01, 0x93, 0x01, +- 0x94, 0x01, 0xF6, 0x01, 0x96, 0x01, 0x97, 0x01, +- 0x98, 0x01, 0x98, 0x01, 0x3D, 0x02, 0x9B, 0x01, +- 0x9C, 0x01, 0x9D, 0x01, 0x20, 0x02, 0x9F, 0x01, +- 0xA0, 0x01, 0xA0, 0x01, 0xA2, 0x01, 0xA2, 0x01, +- 0xA4, 0x01, 0xA4, 0x01, 0xA6, 0x01, 0xA7, 0x01, +- 0xA7, 0x01, 0xA9, 0x01, 0xAA, 0x01, 0xAB, 0x01, +- 0xAC, 0x01, 0xAC, 0x01, 0xAE, 0x01, 0xAF, 0x01, +- 0xAF, 0x01, 0xB1, 0x01, 0xB2, 0x01, 0xB3, 0x01, +- 0xB3, 0x01, 0xB5, 0x01, 0xB5, 0x01, 0xB7, 0x01, +- 0xB8, 0x01, 0xB8, 0x01, 0xBA, 0x01, 0xBB, 0x01, +- 0xBC, 0x01, 0xBC, 0x01, 0xBE, 0x01, 0xF7, 0x01, +- 0xC0, 0x01, 0xC1, 0x01, 0xC2, 0x01, 0xC3, 0x01, +- 0xC4, 0x01, 0xC5, 0x01, 0xC4, 0x01, 0xC7, 0x01, +- 0xC8, 0x01, 0xC7, 0x01, 0xCA, 0x01, 0xCB, 0x01, +- 0xCA, 0x01, 0xCD, 0x01, 0xCD, 0x01, 0xCF, 0x01, +- 0xCF, 0x01, 0xD1, 0x01, 0xD1, 0x01, 0xD3, 0x01, +- 0xD3, 0x01, 0xD5, 0x01, 0xD5, 0x01, 0xD7, 0x01, +- 0xD7, 0x01, 0xD9, 0x01, 0xD9, 0x01, 0xDB, 0x01, +- 0xDB, 0x01, 0x8E, 0x01, 0xDE, 0x01, 0xDE, 0x01, +- 0xE0, 0x01, 0xE0, 0x01, 0xE2, 0x01, 0xE2, 0x01, +- 0xE4, 0x01, 0xE4, 0x01, 0xE6, 0x01, 0xE6, 0x01, +- 0xE8, 0x01, 0xE8, 0x01, 0xEA, 0x01, 0xEA, 0x01, +- 0xEC, 0x01, 0xEC, 0x01, 0xEE, 0x01, 0xEE, 0x01, +- 0xF0, 0x01, 0xF1, 0x01, 0xF2, 0x01, 0xF1, 0x01, +- 0xF4, 0x01, 0xF4, 0x01, 0xF6, 0x01, 0xF7, 0x01, +- 0xF8, 0x01, 0xF8, 0x01, 0xFA, 0x01, 0xFA, 0x01, +- 0xFC, 0x01, 0xFC, 0x01, 0xFE, 0x01, 0xFE, 0x01, +- 0x00, 0x02, 0x00, 0x02, 0x02, 0x02, 0x02, 0x02, +- 0x04, 0x02, 0x04, 0x02, 0x06, 0x02, 0x06, 0x02, +- 0x08, 0x02, 0x08, 0x02, 0x0A, 0x02, 0x0A, 0x02, +- 0x0C, 0x02, 0x0C, 0x02, 0x0E, 0x02, 0x0E, 0x02, +- 0x10, 0x02, 0x10, 0x02, 0x12, 0x02, 0x12, 0x02, +- 0x14, 0x02, 0x14, 0x02, 0x16, 0x02, 0x16, 0x02, +- 0x18, 0x02, 0x18, 0x02, 0x1A, 0x02, 0x1A, 0x02, +- 0x1C, 0x02, 0x1C, 0x02, 0x1E, 0x02, 0x1E, 0x02, +- 0x20, 0x02, 0x21, 0x02, 0x22, 0x02, 0x22, 0x02, +- 0x24, 0x02, 0x24, 0x02, 0x26, 0x02, 0x26, 0x02, +- 0x28, 0x02, 0x28, 0x02, 0x2A, 0x02, 0x2A, 0x02, +- 0x2C, 0x02, 0x2C, 0x02, 0x2E, 0x02, 0x2E, 0x02, +- 0x30, 0x02, 0x30, 0x02, 0x32, 0x02, 0x32, 0x02, +- 0x34, 0x02, 0x35, 0x02, 0x36, 0x02, 0x37, 0x02, +- 0x38, 0x02, 0x39, 0x02, 0x65, 0x2C, 0x3B, 0x02, +- 0x3B, 0x02, 0x3D, 0x02, 0x66, 0x2C, 0x3F, 0x02, +- 0x40, 0x02, 0x41, 0x02, 0x41, 0x02, 0x43, 0x02, +- 0x44, 0x02, 0x45, 0x02, 0x46, 0x02, 0x46, 0x02, +- 0x48, 0x02, 0x48, 0x02, 0x4A, 0x02, 0x4A, 0x02, +- 0x4C, 0x02, 0x4C, 0x02, 0x4E, 0x02, 0x4E, 0x02, +- 0x50, 0x02, 0x51, 0x02, 0x52, 0x02, 0x81, 0x01, +- 0x86, 0x01, 0x55, 0x02, 0x89, 0x01, 0x8A, 0x01, +- 0x58, 0x02, 0x8F, 0x01, 0x5A, 0x02, 0x90, 0x01, +- 0x5C, 0x02, 0x5D, 0x02, 0x5E, 0x02, 0x5F, 0x02, +- 0x93, 0x01, 0x61, 0x02, 0x62, 0x02, 0x94, 0x01, +- 0x64, 0x02, 0x65, 0x02, 0x66, 0x02, 0x67, 0x02, +- 0x97, 0x01, 0x96, 0x01, 0x6A, 0x02, 0x62, 0x2C, +- 0x6C, 0x02, 0x6D, 0x02, 0x6E, 0x02, 0x9C, 0x01, +- 0x70, 0x02, 0x71, 0x02, 0x9D, 0x01, 0x73, 0x02, +- 0x74, 0x02, 0x9F, 0x01, 0x76, 0x02, 0x77, 0x02, +- 0x78, 0x02, 0x79, 0x02, 0x7A, 0x02, 0x7B, 0x02, +- 0x7C, 0x02, 0x64, 0x2C, 0x7E, 0x02, 0x7F, 0x02, +- 0xA6, 0x01, 0x81, 0x02, 0x82, 0x02, 0xA9, 0x01, +- 0x84, 0x02, 0x85, 0x02, 0x86, 0x02, 0x87, 0x02, +- 0xAE, 0x01, 0x44, 0x02, 0xB1, 0x01, 0xB2, 0x01, +- 0x45, 0x02, 0x8D, 0x02, 0x8E, 0x02, 0x8F, 0x02, +- 0x90, 0x02, 0x91, 0x02, 0xB7, 0x01, 0x93, 0x02, +- 0x94, 0x02, 0x95, 0x02, 0x96, 0x02, 0x97, 0x02, +- 0x98, 0x02, 0x99, 0x02, 0x9A, 0x02, 0x9B, 0x02, +- 0x9C, 0x02, 0x9D, 0x02, 0x9E, 0x02, 0x9F, 0x02, +- 0xA0, 0x02, 0xA1, 0x02, 0xA2, 0x02, 0xA3, 0x02, +- 0xA4, 0x02, 0xA5, 0x02, 0xA6, 0x02, 0xA7, 0x02, +- 0xA8, 0x02, 0xA9, 0x02, 0xAA, 0x02, 0xAB, 0x02, +- 0xAC, 0x02, 0xAD, 0x02, 0xAE, 0x02, 0xAF, 0x02, +- 0xB0, 0x02, 0xB1, 0x02, 0xB2, 0x02, 0xB3, 0x02, +- 0xB4, 0x02, 0xB5, 0x02, 0xB6, 0x02, 0xB7, 0x02, +- 0xB8, 0x02, 0xB9, 0x02, 0xBA, 0x02, 0xBB, 0x02, +- 0xBC, 0x02, 0xBD, 0x02, 0xBE, 0x02, 0xBF, 0x02, +- 0xC0, 0x02, 0xC1, 0x02, 0xC2, 0x02, 0xC3, 0x02, +- 0xC4, 0x02, 0xC5, 0x02, 0xC6, 0x02, 0xC7, 0x02, +- 0xC8, 0x02, 0xC9, 0x02, 0xCA, 0x02, 0xCB, 0x02, +- 0xCC, 0x02, 0xCD, 0x02, 0xCE, 0x02, 0xCF, 0x02, +- 0xD0, 0x02, 0xD1, 0x02, 0xD2, 0x02, 0xD3, 0x02, +- 0xD4, 0x02, 0xD5, 0x02, 0xD6, 0x02, 0xD7, 0x02, +- 0xD8, 0x02, 0xD9, 0x02, 0xDA, 0x02, 0xDB, 0x02, +- 0xDC, 0x02, 0xDD, 0x02, 0xDE, 0x02, 0xDF, 0x02, +- 0xE0, 0x02, 0xE1, 0x02, 0xE2, 0x02, 0xE3, 0x02, +- 0xE4, 0x02, 0xE5, 0x02, 0xE6, 0x02, 0xE7, 0x02, +- 0xE8, 0x02, 0xE9, 0x02, 0xEA, 0x02, 0xEB, 0x02, +- 0xEC, 0x02, 0xED, 0x02, 0xEE, 0x02, 0xEF, 0x02, +- 0xF0, 0x02, 0xF1, 0x02, 0xF2, 0x02, 0xF3, 0x02, +- 0xF4, 0x02, 0xF5, 0x02, 0xF6, 0x02, 0xF7, 0x02, +- 0xF8, 0x02, 0xF9, 0x02, 0xFA, 0x02, 0xFB, 0x02, +- 0xFC, 0x02, 0xFD, 0x02, 0xFE, 0x02, 0xFF, 0x02, +- 0x00, 0x03, 0x01, 0x03, 0x02, 0x03, 0x03, 0x03, +- 0x04, 0x03, 0x05, 0x03, 0x06, 0x03, 0x07, 0x03, +- 0x08, 0x03, 0x09, 0x03, 0x0A, 0x03, 0x0B, 0x03, +- 0x0C, 0x03, 0x0D, 0x03, 0x0E, 0x03, 0x0F, 0x03, +- 0x10, 0x03, 0x11, 0x03, 0x12, 0x03, 0x13, 0x03, +- 0x14, 0x03, 0x15, 0x03, 0x16, 0x03, 0x17, 0x03, +- 0x18, 0x03, 0x19, 0x03, 0x1A, 0x03, 0x1B, 0x03, +- 0x1C, 0x03, 0x1D, 0x03, 0x1E, 0x03, 0x1F, 0x03, +- 0x20, 0x03, 0x21, 0x03, 0x22, 0x03, 0x23, 0x03, +- 0x24, 0x03, 0x25, 0x03, 0x26, 0x03, 0x27, 0x03, +- 0x28, 0x03, 0x29, 0x03, 0x2A, 0x03, 0x2B, 0x03, +- 0x2C, 0x03, 0x2D, 0x03, 0x2E, 0x03, 0x2F, 0x03, +- 0x30, 0x03, 0x31, 0x03, 0x32, 0x03, 0x33, 0x03, +- 0x34, 0x03, 0x35, 0x03, 0x36, 0x03, 0x37, 0x03, +- 0x38, 0x03, 0x39, 0x03, 0x3A, 0x03, 0x3B, 0x03, +- 0x3C, 0x03, 0x3D, 0x03, 0x3E, 0x03, 0x3F, 0x03, +- 0x40, 0x03, 0x41, 0x03, 0x42, 0x03, 0x43, 0x03, +- 0x44, 0x03, 0x45, 0x03, 0x46, 0x03, 0x47, 0x03, +- 0x48, 0x03, 0x49, 0x03, 0x4A, 0x03, 0x4B, 0x03, +- 0x4C, 0x03, 0x4D, 0x03, 0x4E, 0x03, 0x4F, 0x03, +- 0x50, 0x03, 0x51, 0x03, 0x52, 0x03, 0x53, 0x03, +- 0x54, 0x03, 0x55, 0x03, 0x56, 0x03, 0x57, 0x03, +- 0x58, 0x03, 0x59, 0x03, 0x5A, 0x03, 0x5B, 0x03, +- 0x5C, 0x03, 0x5D, 0x03, 0x5E, 0x03, 0x5F, 0x03, +- 0x60, 0x03, 0x61, 0x03, 0x62, 0x03, 0x63, 0x03, +- 0x64, 0x03, 0x65, 0x03, 0x66, 0x03, 0x67, 0x03, +- 0x68, 0x03, 0x69, 0x03, 0x6A, 0x03, 0x6B, 0x03, +- 0x6C, 0x03, 0x6D, 0x03, 0x6E, 0x03, 0x6F, 0x03, +- 0x70, 0x03, 0x71, 0x03, 0x72, 0x03, 0x73, 0x03, +- 0x74, 0x03, 0x75, 0x03, 0x76, 0x03, 0x77, 0x03, +- 0x78, 0x03, 0x79, 0x03, 0x7A, 0x03, 0xFD, 0x03, +- 0xFE, 0x03, 0xFF, 0x03, 0x7E, 0x03, 0x7F, 0x03, +- 0x80, 0x03, 0x81, 0x03, 0x82, 0x03, 0x83, 0x03, +- 0x84, 0x03, 0x85, 0x03, 0x86, 0x03, 0x87, 0x03, +- 0x88, 0x03, 0x89, 0x03, 0x8A, 0x03, 0x8B, 0x03, +- 0x8C, 0x03, 0x8D, 0x03, 0x8E, 0x03, 0x8F, 0x03, +- 0x90, 0x03, 0x91, 0x03, 0x92, 0x03, 0x93, 0x03, +- 0x94, 0x03, 0x95, 0x03, 0x96, 0x03, 0x97, 0x03, +- 0x98, 0x03, 0x99, 0x03, 0x9A, 0x03, 0x9B, 0x03, +- 0x9C, 0x03, 0x9D, 0x03, 0x9E, 0x03, 0x9F, 0x03, +- 0xA0, 0x03, 0xA1, 0x03, 0xA2, 0x03, 0xA3, 0x03, +- 0xA4, 0x03, 0xA5, 0x03, 0xA6, 0x03, 0xA7, 0x03, +- 0xA8, 0x03, 0xA9, 0x03, 0xAA, 0x03, 0xAB, 0x03, +- 0x86, 0x03, 0x88, 0x03, 0x89, 0x03, 0x8A, 0x03, +- 0xB0, 0x03, 0x91, 0x03, 0x92, 0x03, 0x93, 0x03, +- 0x94, 0x03, 0x95, 0x03, 0x96, 0x03, 0x97, 0x03, +- 0x98, 0x03, 0x99, 0x03, 0x9A, 0x03, 0x9B, 0x03, +- 0x9C, 0x03, 0x9D, 0x03, 0x9E, 0x03, 0x9F, 0x03, +- 0xA0, 0x03, 0xA1, 0x03, 0xA3, 0x03, 0xA3, 0x03, +- 0xA4, 0x03, 0xA5, 0x03, 0xA6, 0x03, 0xA7, 0x03, +- 0xA8, 0x03, 0xA9, 0x03, 0xAA, 0x03, 0xAB, 0x03, +- 0x8C, 0x03, 0x8E, 0x03, 0x8F, 0x03, 0xCF, 0x03, +- 0xD0, 0x03, 0xD1, 0x03, 0xD2, 0x03, 0xD3, 0x03, +- 0xD4, 0x03, 0xD5, 0x03, 0xD6, 0x03, 0xD7, 0x03, +- 0xD8, 0x03, 0xD8, 0x03, 0xDA, 0x03, 0xDA, 0x03, +- 0xDC, 0x03, 0xDC, 0x03, 0xDE, 0x03, 0xDE, 0x03, +- 0xE0, 0x03, 0xE0, 0x03, 0xE2, 0x03, 0xE2, 0x03, +- 0xE4, 0x03, 0xE4, 0x03, 0xE6, 0x03, 0xE6, 0x03, +- 0xE8, 0x03, 0xE8, 0x03, 0xEA, 0x03, 0xEA, 0x03, +- 0xEC, 0x03, 0xEC, 0x03, 0xEE, 0x03, 0xEE, 0x03, +- 0xF0, 0x03, 0xF1, 0x03, 0xF9, 0x03, 0xF3, 0x03, +- 0xF4, 0x03, 0xF5, 0x03, 0xF6, 0x03, 0xF7, 0x03, +- 0xF7, 0x03, 0xF9, 0x03, 0xFA, 0x03, 0xFA, 0x03, +- 0xFC, 0x03, 0xFD, 0x03, 0xFE, 0x03, 0xFF, 0x03, +- 0x00, 0x04, 0x01, 0x04, 0x02, 0x04, 0x03, 0x04, +- 0x04, 0x04, 0x05, 0x04, 0x06, 0x04, 0x07, 0x04, +- 0x08, 0x04, 0x09, 0x04, 0x0A, 0x04, 0x0B, 0x04, +- 0x0C, 0x04, 0x0D, 0x04, 0x0E, 0x04, 0x0F, 0x04, +- 0x10, 0x04, 0x11, 0x04, 0x12, 0x04, 0x13, 0x04, +- 0x14, 0x04, 0x15, 0x04, 0x16, 0x04, 0x17, 0x04, +- 0x18, 0x04, 0x19, 0x04, 0x1A, 0x04, 0x1B, 0x04, +- 0x1C, 0x04, 0x1D, 0x04, 0x1E, 0x04, 0x1F, 0x04, +- 0x20, 0x04, 0x21, 0x04, 0x22, 0x04, 0x23, 0x04, +- 0x24, 0x04, 0x25, 0x04, 0x26, 0x04, 0x27, 0x04, +- 0x28, 0x04, 0x29, 0x04, 0x2A, 0x04, 0x2B, 0x04, +- 0x2C, 0x04, 0x2D, 0x04, 0x2E, 0x04, 0x2F, 0x04, +- 0x10, 0x04, 0x11, 0x04, 0x12, 0x04, 0x13, 0x04, +- 0x14, 0x04, 0x15, 0x04, 0x16, 0x04, 0x17, 0x04, +- 0x18, 0x04, 0x19, 0x04, 0x1A, 0x04, 0x1B, 0x04, +- 0x1C, 0x04, 0x1D, 0x04, 0x1E, 0x04, 0x1F, 0x04, +- 0x20, 0x04, 0x21, 0x04, 0x22, 0x04, 0x23, 0x04, +- 0x24, 0x04, 0x25, 0x04, 0x26, 0x04, 0x27, 0x04, +- 0x28, 0x04, 0x29, 0x04, 0x2A, 0x04, 0x2B, 0x04, +- 0x2C, 0x04, 0x2D, 0x04, 0x2E, 0x04, 0x2F, 0x04, +- 0x00, 0x04, 0x01, 0x04, 0x02, 0x04, 0x03, 0x04, +- 0x04, 0x04, 0x05, 0x04, 0x06, 0x04, 0x07, 0x04, +- 0x08, 0x04, 0x09, 0x04, 0x0A, 0x04, 0x0B, 0x04, +- 0x0C, 0x04, 0x0D, 0x04, 0x0E, 0x04, 0x0F, 0x04, +- 0x60, 0x04, 0x60, 0x04, 0x62, 0x04, 0x62, 0x04, +- 0x64, 0x04, 0x64, 0x04, 0x66, 0x04, 0x66, 0x04, +- 0x68, 0x04, 0x68, 0x04, 0x6A, 0x04, 0x6A, 0x04, +- 0x6C, 0x04, 0x6C, 0x04, 0x6E, 0x04, 0x6E, 0x04, +- 0x70, 0x04, 0x70, 0x04, 0x72, 0x04, 0x72, 0x04, +- 0x74, 0x04, 0x74, 0x04, 0x76, 0x04, 0x76, 0x04, +- 0x78, 0x04, 0x78, 0x04, 0x7A, 0x04, 0x7A, 0x04, +- 0x7C, 0x04, 0x7C, 0x04, 0x7E, 0x04, 0x7E, 0x04, +- 0x80, 0x04, 0x80, 0x04, 0x82, 0x04, 0x83, 0x04, +- 0x84, 0x04, 0x85, 0x04, 0x86, 0x04, 0x87, 0x04, +- 0x88, 0x04, 0x89, 0x04, 0x8A, 0x04, 0x8A, 0x04, +- 0x8C, 0x04, 0x8C, 0x04, 0x8E, 0x04, 0x8E, 0x04, +- 0x90, 0x04, 0x90, 0x04, 0x92, 0x04, 0x92, 0x04, +- 0x94, 0x04, 0x94, 0x04, 0x96, 0x04, 0x96, 0x04, +- 0x98, 0x04, 0x98, 0x04, 0x9A, 0x04, 0x9A, 0x04, +- 0x9C, 0x04, 0x9C, 0x04, 0x9E, 0x04, 0x9E, 0x04, +- 0xA0, 0x04, 0xA0, 0x04, 0xA2, 0x04, 0xA2, 0x04, +- 0xA4, 0x04, 0xA4, 0x04, 0xA6, 0x04, 0xA6, 0x04, +- 0xA8, 0x04, 0xA8, 0x04, 0xAA, 0x04, 0xAA, 0x04, +- 0xAC, 0x04, 0xAC, 0x04, 0xAE, 0x04, 0xAE, 0x04, +- 0xB0, 0x04, 0xB0, 0x04, 0xB2, 0x04, 0xB2, 0x04, +- 0xB4, 0x04, 0xB4, 0x04, 0xB6, 0x04, 0xB6, 0x04, +- 0xB8, 0x04, 0xB8, 0x04, 0xBA, 0x04, 0xBA, 0x04, +- 0xBC, 0x04, 0xBC, 0x04, 0xBE, 0x04, 0xBE, 0x04, +- 0xC0, 0x04, 0xC1, 0x04, 0xC1, 0x04, 0xC3, 0x04, +- 0xC3, 0x04, 0xC5, 0x04, 0xC5, 0x04, 0xC7, 0x04, +- 0xC7, 0x04, 0xC9, 0x04, 0xC9, 0x04, 0xCB, 0x04, +- 0xCB, 0x04, 0xCD, 0x04, 0xCD, 0x04, 0xC0, 0x04, +- 0xD0, 0x04, 0xD0, 0x04, 0xD2, 0x04, 0xD2, 0x04, +- 0xD4, 0x04, 0xD4, 0x04, 0xD6, 0x04, 0xD6, 0x04, +- 0xD8, 0x04, 0xD8, 0x04, 0xDA, 0x04, 0xDA, 0x04, +- 0xDC, 0x04, 0xDC, 0x04, 0xDE, 0x04, 0xDE, 0x04, +- 0xE0, 0x04, 0xE0, 0x04, 0xE2, 0x04, 0xE2, 0x04, +- 0xE4, 0x04, 0xE4, 0x04, 0xE6, 0x04, 0xE6, 0x04, +- 0xE8, 0x04, 0xE8, 0x04, 0xEA, 0x04, 0xEA, 0x04, +- 0xEC, 0x04, 0xEC, 0x04, 0xEE, 0x04, 0xEE, 0x04, +- 0xF0, 0x04, 0xF0, 0x04, 0xF2, 0x04, 0xF2, 0x04, +- 0xF4, 0x04, 0xF4, 0x04, 0xF6, 0x04, 0xF6, 0x04, +- 0xF8, 0x04, 0xF8, 0x04, 0xFA, 0x04, 0xFA, 0x04, +- 0xFC, 0x04, 0xFC, 0x04, 0xFE, 0x04, 0xFE, 0x04, +- 0x00, 0x05, 0x00, 0x05, 0x02, 0x05, 0x02, 0x05, +- 0x04, 0x05, 0x04, 0x05, 0x06, 0x05, 0x06, 0x05, +- 0x08, 0x05, 0x08, 0x05, 0x0A, 0x05, 0x0A, 0x05, +- 0x0C, 0x05, 0x0C, 0x05, 0x0E, 0x05, 0x0E, 0x05, +- 0x10, 0x05, 0x10, 0x05, 0x12, 0x05, 0x12, 0x05, +- 0x14, 0x05, 0x15, 0x05, 0x16, 0x05, 0x17, 0x05, +- 0x18, 0x05, 0x19, 0x05, 0x1A, 0x05, 0x1B, 0x05, +- 0x1C, 0x05, 0x1D, 0x05, 0x1E, 0x05, 0x1F, 0x05, +- 0x20, 0x05, 0x21, 0x05, 0x22, 0x05, 0x23, 0x05, +- 0x24, 0x05, 0x25, 0x05, 0x26, 0x05, 0x27, 0x05, +- 0x28, 0x05, 0x29, 0x05, 0x2A, 0x05, 0x2B, 0x05, +- 0x2C, 0x05, 0x2D, 0x05, 0x2E, 0x05, 0x2F, 0x05, +- 0x30, 0x05, 0x31, 0x05, 0x32, 0x05, 0x33, 0x05, +- 0x34, 0x05, 0x35, 0x05, 0x36, 0x05, 0x37, 0x05, +- 0x38, 0x05, 0x39, 0x05, 0x3A, 0x05, 0x3B, 0x05, +- 0x3C, 0x05, 0x3D, 0x05, 0x3E, 0x05, 0x3F, 0x05, +- 0x40, 0x05, 0x41, 0x05, 0x42, 0x05, 0x43, 0x05, +- 0x44, 0x05, 0x45, 0x05, 0x46, 0x05, 0x47, 0x05, +- 0x48, 0x05, 0x49, 0x05, 0x4A, 0x05, 0x4B, 0x05, +- 0x4C, 0x05, 0x4D, 0x05, 0x4E, 0x05, 0x4F, 0x05, +- 0x50, 0x05, 0x51, 0x05, 0x52, 0x05, 0x53, 0x05, +- 0x54, 0x05, 0x55, 0x05, 0x56, 0x05, 0x57, 0x05, +- 0x58, 0x05, 0x59, 0x05, 0x5A, 0x05, 0x5B, 0x05, +- 0x5C, 0x05, 0x5D, 0x05, 0x5E, 0x05, 0x5F, 0x05, +- 0x60, 0x05, 0x31, 0x05, 0x32, 0x05, 0x33, 0x05, +- 0x34, 0x05, 0x35, 0x05, 0x36, 0x05, 0x37, 0x05, +- 0x38, 0x05, 0x39, 0x05, 0x3A, 0x05, 0x3B, 0x05, +- 0x3C, 0x05, 0x3D, 0x05, 0x3E, 0x05, 0x3F, 0x05, +- 0x40, 0x05, 0x41, 0x05, 0x42, 0x05, 0x43, 0x05, +- 0x44, 0x05, 0x45, 0x05, 0x46, 0x05, 0x47, 0x05, +- 0x48, 0x05, 0x49, 0x05, 0x4A, 0x05, 0x4B, 0x05, +- 0x4C, 0x05, 0x4D, 0x05, 0x4E, 0x05, 0x4F, 0x05, +- 0x50, 0x05, 0x51, 0x05, 0x52, 0x05, 0x53, 0x05, +- 0x54, 0x05, 0x55, 0x05, 0x56, 0x05, 0xFF, 0xFF, +- 0xF6, 0x17, 0x63, 0x2C, 0x7E, 0x1D, 0x7F, 0x1D, +- 0x80, 0x1D, 0x81, 0x1D, 0x82, 0x1D, 0x83, 0x1D, +- 0x84, 0x1D, 0x85, 0x1D, 0x86, 0x1D, 0x87, 0x1D, +- 0x88, 0x1D, 0x89, 0x1D, 0x8A, 0x1D, 0x8B, 0x1D, +- 0x8C, 0x1D, 0x8D, 0x1D, 0x8E, 0x1D, 0x8F, 0x1D, +- 0x90, 0x1D, 0x91, 0x1D, 0x92, 0x1D, 0x93, 0x1D, +- 0x94, 0x1D, 0x95, 0x1D, 0x96, 0x1D, 0x97, 0x1D, +- 0x98, 0x1D, 0x99, 0x1D, 0x9A, 0x1D, 0x9B, 0x1D, +- 0x9C, 0x1D, 0x9D, 0x1D, 0x9E, 0x1D, 0x9F, 0x1D, +- 0xA0, 0x1D, 0xA1, 0x1D, 0xA2, 0x1D, 0xA3, 0x1D, +- 0xA4, 0x1D, 0xA5, 0x1D, 0xA6, 0x1D, 0xA7, 0x1D, +- 0xA8, 0x1D, 0xA9, 0x1D, 0xAA, 0x1D, 0xAB, 0x1D, +- 0xAC, 0x1D, 0xAD, 0x1D, 0xAE, 0x1D, 0xAF, 0x1D, +- 0xB0, 0x1D, 0xB1, 0x1D, 0xB2, 0x1D, 0xB3, 0x1D, +- 0xB4, 0x1D, 0xB5, 0x1D, 0xB6, 0x1D, 0xB7, 0x1D, +- 0xB8, 0x1D, 0xB9, 0x1D, 0xBA, 0x1D, 0xBB, 0x1D, +- 0xBC, 0x1D, 0xBD, 0x1D, 0xBE, 0x1D, 0xBF, 0x1D, +- 0xC0, 0x1D, 0xC1, 0x1D, 0xC2, 0x1D, 0xC3, 0x1D, +- 0xC4, 0x1D, 0xC5, 0x1D, 0xC6, 0x1D, 0xC7, 0x1D, +- 0xC8, 0x1D, 0xC9, 0x1D, 0xCA, 0x1D, 0xCB, 0x1D, +- 0xCC, 0x1D, 0xCD, 0x1D, 0xCE, 0x1D, 0xCF, 0x1D, +- 0xD0, 0x1D, 0xD1, 0x1D, 0xD2, 0x1D, 0xD3, 0x1D, +- 0xD4, 0x1D, 0xD5, 0x1D, 0xD6, 0x1D, 0xD7, 0x1D, +- 0xD8, 0x1D, 0xD9, 0x1D, 0xDA, 0x1D, 0xDB, 0x1D, +- 0xDC, 0x1D, 0xDD, 0x1D, 0xDE, 0x1D, 0xDF, 0x1D, +- 0xE0, 0x1D, 0xE1, 0x1D, 0xE2, 0x1D, 0xE3, 0x1D, +- 0xE4, 0x1D, 0xE5, 0x1D, 0xE6, 0x1D, 0xE7, 0x1D, +- 0xE8, 0x1D, 0xE9, 0x1D, 0xEA, 0x1D, 0xEB, 0x1D, +- 0xEC, 0x1D, 0xED, 0x1D, 0xEE, 0x1D, 0xEF, 0x1D, +- 0xF0, 0x1D, 0xF1, 0x1D, 0xF2, 0x1D, 0xF3, 0x1D, +- 0xF4, 0x1D, 0xF5, 0x1D, 0xF6, 0x1D, 0xF7, 0x1D, +- 0xF8, 0x1D, 0xF9, 0x1D, 0xFA, 0x1D, 0xFB, 0x1D, +- 0xFC, 0x1D, 0xFD, 0x1D, 0xFE, 0x1D, 0xFF, 0x1D, +- 0x00, 0x1E, 0x00, 0x1E, 0x02, 0x1E, 0x02, 0x1E, +- 0x04, 0x1E, 0x04, 0x1E, 0x06, 0x1E, 0x06, 0x1E, +- 0x08, 0x1E, 0x08, 0x1E, 0x0A, 0x1E, 0x0A, 0x1E, +- 0x0C, 0x1E, 0x0C, 0x1E, 0x0E, 0x1E, 0x0E, 0x1E, +- 0x10, 0x1E, 0x10, 0x1E, 0x12, 0x1E, 0x12, 0x1E, +- 0x14, 0x1E, 0x14, 0x1E, 0x16, 0x1E, 0x16, 0x1E, +- 0x18, 0x1E, 0x18, 0x1E, 0x1A, 0x1E, 0x1A, 0x1E, +- 0x1C, 0x1E, 0x1C, 0x1E, 0x1E, 0x1E, 0x1E, 0x1E, +- 0x20, 0x1E, 0x20, 0x1E, 0x22, 0x1E, 0x22, 0x1E, +- 0x24, 0x1E, 0x24, 0x1E, 0x26, 0x1E, 0x26, 0x1E, +- 0x28, 0x1E, 0x28, 0x1E, 0x2A, 0x1E, 0x2A, 0x1E, +- 0x2C, 0x1E, 0x2C, 0x1E, 0x2E, 0x1E, 0x2E, 0x1E, +- 0x30, 0x1E, 0x30, 0x1E, 0x32, 0x1E, 0x32, 0x1E, +- 0x34, 0x1E, 0x34, 0x1E, 0x36, 0x1E, 0x36, 0x1E, +- 0x38, 0x1E, 0x38, 0x1E, 0x3A, 0x1E, 0x3A, 0x1E, +- 0x3C, 0x1E, 0x3C, 0x1E, 0x3E, 0x1E, 0x3E, 0x1E, +- 0x40, 0x1E, 0x40, 0x1E, 0x42, 0x1E, 0x42, 0x1E, +- 0x44, 0x1E, 0x44, 0x1E, 0x46, 0x1E, 0x46, 0x1E, +- 0x48, 0x1E, 0x48, 0x1E, 0x4A, 0x1E, 0x4A, 0x1E, +- 0x4C, 0x1E, 0x4C, 0x1E, 0x4E, 0x1E, 0x4E, 0x1E, +- 0x50, 0x1E, 0x50, 0x1E, 0x52, 0x1E, 0x52, 0x1E, +- 0x54, 0x1E, 0x54, 0x1E, 0x56, 0x1E, 0x56, 0x1E, +- 0x58, 0x1E, 0x58, 0x1E, 0x5A, 0x1E, 0x5A, 0x1E, +- 0x5C, 0x1E, 0x5C, 0x1E, 0x5E, 0x1E, 0x5E, 0x1E, +- 0x60, 0x1E, 0x60, 0x1E, 0x62, 0x1E, 0x62, 0x1E, +- 0x64, 0x1E, 0x64, 0x1E, 0x66, 0x1E, 0x66, 0x1E, +- 0x68, 0x1E, 0x68, 0x1E, 0x6A, 0x1E, 0x6A, 0x1E, +- 0x6C, 0x1E, 0x6C, 0x1E, 0x6E, 0x1E, 0x6E, 0x1E, +- 0x70, 0x1E, 0x70, 0x1E, 0x72, 0x1E, 0x72, 0x1E, +- 0x74, 0x1E, 0x74, 0x1E, 0x76, 0x1E, 0x76, 0x1E, +- 0x78, 0x1E, 0x78, 0x1E, 0x7A, 0x1E, 0x7A, 0x1E, +- 0x7C, 0x1E, 0x7C, 0x1E, 0x7E, 0x1E, 0x7E, 0x1E, +- 0x80, 0x1E, 0x80, 0x1E, 0x82, 0x1E, 0x82, 0x1E, +- 0x84, 0x1E, 0x84, 0x1E, 0x86, 0x1E, 0x86, 0x1E, +- 0x88, 0x1E, 0x88, 0x1E, 0x8A, 0x1E, 0x8A, 0x1E, +- 0x8C, 0x1E, 0x8C, 0x1E, 0x8E, 0x1E, 0x8E, 0x1E, +- 0x90, 0x1E, 0x90, 0x1E, 0x92, 0x1E, 0x92, 0x1E, +- 0x94, 0x1E, 0x94, 0x1E, 0x96, 0x1E, 0x97, 0x1E, +- 0x98, 0x1E, 0x99, 0x1E, 0x9A, 0x1E, 0x9B, 0x1E, +- 0x9C, 0x1E, 0x9D, 0x1E, 0x9E, 0x1E, 0x9F, 0x1E, +- 0xA0, 0x1E, 0xA0, 0x1E, 0xA2, 0x1E, 0xA2, 0x1E, +- 0xA4, 0x1E, 0xA4, 0x1E, 0xA6, 0x1E, 0xA6, 0x1E, +- 0xA8, 0x1E, 0xA8, 0x1E, 0xAA, 0x1E, 0xAA, 0x1E, +- 0xAC, 0x1E, 0xAC, 0x1E, 0xAE, 0x1E, 0xAE, 0x1E, +- 0xB0, 0x1E, 0xB0, 0x1E, 0xB2, 0x1E, 0xB2, 0x1E, +- 0xB4, 0x1E, 0xB4, 0x1E, 0xB6, 0x1E, 0xB6, 0x1E, +- 0xB8, 0x1E, 0xB8, 0x1E, 0xBA, 0x1E, 0xBA, 0x1E, +- 0xBC, 0x1E, 0xBC, 0x1E, 0xBE, 0x1E, 0xBE, 0x1E, +- 0xC0, 0x1E, 0xC0, 0x1E, 0xC2, 0x1E, 0xC2, 0x1E, +- 0xC4, 0x1E, 0xC4, 0x1E, 0xC6, 0x1E, 0xC6, 0x1E, +- 0xC8, 0x1E, 0xC8, 0x1E, 0xCA, 0x1E, 0xCA, 0x1E, +- 0xCC, 0x1E, 0xCC, 0x1E, 0xCE, 0x1E, 0xCE, 0x1E, +- 0xD0, 0x1E, 0xD0, 0x1E, 0xD2, 0x1E, 0xD2, 0x1E, +- 0xD4, 0x1E, 0xD4, 0x1E, 0xD6, 0x1E, 0xD6, 0x1E, +- 0xD8, 0x1E, 0xD8, 0x1E, 0xDA, 0x1E, 0xDA, 0x1E, +- 0xDC, 0x1E, 0xDC, 0x1E, 0xDE, 0x1E, 0xDE, 0x1E, +- 0xE0, 0x1E, 0xE0, 0x1E, 0xE2, 0x1E, 0xE2, 0x1E, +- 0xE4, 0x1E, 0xE4, 0x1E, 0xE6, 0x1E, 0xE6, 0x1E, +- 0xE8, 0x1E, 0xE8, 0x1E, 0xEA, 0x1E, 0xEA, 0x1E, +- 0xEC, 0x1E, 0xEC, 0x1E, 0xEE, 0x1E, 0xEE, 0x1E, +- 0xF0, 0x1E, 0xF0, 0x1E, 0xF2, 0x1E, 0xF2, 0x1E, +- 0xF4, 0x1E, 0xF4, 0x1E, 0xF6, 0x1E, 0xF6, 0x1E, +- 0xF8, 0x1E, 0xF8, 0x1E, 0xFA, 0x1E, 0xFB, 0x1E, +- 0xFC, 0x1E, 0xFD, 0x1E, 0xFE, 0x1E, 0xFF, 0x1E, +- 0x08, 0x1F, 0x09, 0x1F, 0x0A, 0x1F, 0x0B, 0x1F, +- 0x0C, 0x1F, 0x0D, 0x1F, 0x0E, 0x1F, 0x0F, 0x1F, +- 0x08, 0x1F, 0x09, 0x1F, 0x0A, 0x1F, 0x0B, 0x1F, +- 0x0C, 0x1F, 0x0D, 0x1F, 0x0E, 0x1F, 0x0F, 0x1F, +- 0x18, 0x1F, 0x19, 0x1F, 0x1A, 0x1F, 0x1B, 0x1F, +- 0x1C, 0x1F, 0x1D, 0x1F, 0x16, 0x1F, 0x17, 0x1F, +- 0x18, 0x1F, 0x19, 0x1F, 0x1A, 0x1F, 0x1B, 0x1F, +- 0x1C, 0x1F, 0x1D, 0x1F, 0x1E, 0x1F, 0x1F, 0x1F, +- 0x28, 0x1F, 0x29, 0x1F, 0x2A, 0x1F, 0x2B, 0x1F, +- 0x2C, 0x1F, 0x2D, 0x1F, 0x2E, 0x1F, 0x2F, 0x1F, +- 0x28, 0x1F, 0x29, 0x1F, 0x2A, 0x1F, 0x2B, 0x1F, +- 0x2C, 0x1F, 0x2D, 0x1F, 0x2E, 0x1F, 0x2F, 0x1F, +- 0x38, 0x1F, 0x39, 0x1F, 0x3A, 0x1F, 0x3B, 0x1F, +- 0x3C, 0x1F, 0x3D, 0x1F, 0x3E, 0x1F, 0x3F, 0x1F, +- 0x38, 0x1F, 0x39, 0x1F, 0x3A, 0x1F, 0x3B, 0x1F, +- 0x3C, 0x1F, 0x3D, 0x1F, 0x3E, 0x1F, 0x3F, 0x1F, +- 0x48, 0x1F, 0x49, 0x1F, 0x4A, 0x1F, 0x4B, 0x1F, +- 0x4C, 0x1F, 0x4D, 0x1F, 0x46, 0x1F, 0x47, 0x1F, +- 0x48, 0x1F, 0x49, 0x1F, 0x4A, 0x1F, 0x4B, 0x1F, +- 0x4C, 0x1F, 0x4D, 0x1F, 0x4E, 0x1F, 0x4F, 0x1F, +- 0x50, 0x1F, 0x59, 0x1F, 0x52, 0x1F, 0x5B, 0x1F, +- 0x54, 0x1F, 0x5D, 0x1F, 0x56, 0x1F, 0x5F, 0x1F, +- 0x58, 0x1F, 0x59, 0x1F, 0x5A, 0x1F, 0x5B, 0x1F, +- 0x5C, 0x1F, 0x5D, 0x1F, 0x5E, 0x1F, 0x5F, 0x1F, +- 0x68, 0x1F, 0x69, 0x1F, 0x6A, 0x1F, 0x6B, 0x1F, +- 0x6C, 0x1F, 0x6D, 0x1F, 0x6E, 0x1F, 0x6F, 0x1F, +- 0x68, 0x1F, 0x69, 0x1F, 0x6A, 0x1F, 0x6B, 0x1F, +- 0x6C, 0x1F, 0x6D, 0x1F, 0x6E, 0x1F, 0x6F, 0x1F, +- 0xBA, 0x1F, 0xBB, 0x1F, 0xC8, 0x1F, 0xC9, 0x1F, +- 0xCA, 0x1F, 0xCB, 0x1F, 0xDA, 0x1F, 0xDB, 0x1F, +- 0xF8, 0x1F, 0xF9, 0x1F, 0xEA, 0x1F, 0xEB, 0x1F, +- 0xFA, 0x1F, 0xFB, 0x1F, 0x7E, 0x1F, 0x7F, 0x1F, +- 0x88, 0x1F, 0x89, 0x1F, 0x8A, 0x1F, 0x8B, 0x1F, +- 0x8C, 0x1F, 0x8D, 0x1F, 0x8E, 0x1F, 0x8F, 0x1F, +- 0x88, 0x1F, 0x89, 0x1F, 0x8A, 0x1F, 0x8B, 0x1F, +- 0x8C, 0x1F, 0x8D, 0x1F, 0x8E, 0x1F, 0x8F, 0x1F, +- 0x98, 0x1F, 0x99, 0x1F, 0x9A, 0x1F, 0x9B, 0x1F, +- 0x9C, 0x1F, 0x9D, 0x1F, 0x9E, 0x1F, 0x9F, 0x1F, +- 0x98, 0x1F, 0x99, 0x1F, 0x9A, 0x1F, 0x9B, 0x1F, +- 0x9C, 0x1F, 0x9D, 0x1F, 0x9E, 0x1F, 0x9F, 0x1F, +- 0xA8, 0x1F, 0xA9, 0x1F, 0xAA, 0x1F, 0xAB, 0x1F, +- 0xAC, 0x1F, 0xAD, 0x1F, 0xAE, 0x1F, 0xAF, 0x1F, +- 0xA8, 0x1F, 0xA9, 0x1F, 0xAA, 0x1F, 0xAB, 0x1F, +- 0xAC, 0x1F, 0xAD, 0x1F, 0xAE, 0x1F, 0xAF, 0x1F, +- 0xB8, 0x1F, 0xB9, 0x1F, 0xB2, 0x1F, 0xBC, 0x1F, +- 0xB4, 0x1F, 0xB5, 0x1F, 0xB6, 0x1F, 0xB7, 0x1F, +- 0xB8, 0x1F, 0xB9, 0x1F, 0xBA, 0x1F, 0xBB, 0x1F, +- 0xBC, 0x1F, 0xBD, 0x1F, 0xBE, 0x1F, 0xBF, 0x1F, +- 0xC0, 0x1F, 0xC1, 0x1F, 0xC2, 0x1F, 0xC3, 0x1F, +- 0xC4, 0x1F, 0xC5, 0x1F, 0xC6, 0x1F, 0xC7, 0x1F, +- 0xC8, 0x1F, 0xC9, 0x1F, 0xCA, 0x1F, 0xCB, 0x1F, +- 0xC3, 0x1F, 0xCD, 0x1F, 0xCE, 0x1F, 0xCF, 0x1F, +- 0xD8, 0x1F, 0xD9, 0x1F, 0xD2, 0x1F, 0xD3, 0x1F, +- 0xD4, 0x1F, 0xD5, 0x1F, 0xD6, 0x1F, 0xD7, 0x1F, +- 0xD8, 0x1F, 0xD9, 0x1F, 0xDA, 0x1F, 0xDB, 0x1F, +- 0xDC, 0x1F, 0xDD, 0x1F, 0xDE, 0x1F, 0xDF, 0x1F, +- 0xE8, 0x1F, 0xE9, 0x1F, 0xE2, 0x1F, 0xE3, 0x1F, +- 0xE4, 0x1F, 0xEC, 0x1F, 0xE6, 0x1F, 0xE7, 0x1F, +- 0xE8, 0x1F, 0xE9, 0x1F, 0xEA, 0x1F, 0xEB, 0x1F, +- 0xEC, 0x1F, 0xED, 0x1F, 0xEE, 0x1F, 0xEF, 0x1F, +- 0xF0, 0x1F, 0xF1, 0x1F, 0xF2, 0x1F, 0xF3, 0x1F, +- 0xF4, 0x1F, 0xF5, 0x1F, 0xF6, 0x1F, 0xF7, 0x1F, +- 0xF8, 0x1F, 0xF9, 0x1F, 0xFA, 0x1F, 0xFB, 0x1F, +- 0xF3, 0x1F, 0xFD, 0x1F, 0xFE, 0x1F, 0xFF, 0x1F, +- 0x00, 0x20, 0x01, 0x20, 0x02, 0x20, 0x03, 0x20, +- 0x04, 0x20, 0x05, 0x20, 0x06, 0x20, 0x07, 0x20, +- 0x08, 0x20, 0x09, 0x20, 0x0A, 0x20, 0x0B, 0x20, +- 0x0C, 0x20, 0x0D, 0x20, 0x0E, 0x20, 0x0F, 0x20, +- 0x10, 0x20, 0x11, 0x20, 0x12, 0x20, 0x13, 0x20, +- 0x14, 0x20, 0x15, 0x20, 0x16, 0x20, 0x17, 0x20, +- 0x18, 0x20, 0x19, 0x20, 0x1A, 0x20, 0x1B, 0x20, +- 0x1C, 0x20, 0x1D, 0x20, 0x1E, 0x20, 0x1F, 0x20, +- 0x20, 0x20, 0x21, 0x20, 0x22, 0x20, 0x23, 0x20, +- 0x24, 0x20, 0x25, 0x20, 0x26, 0x20, 0x27, 0x20, +- 0x28, 0x20, 0x29, 0x20, 0x2A, 0x20, 0x2B, 0x20, +- 0x2C, 0x20, 0x2D, 0x20, 0x2E, 0x20, 0x2F, 0x20, +- 0x30, 0x20, 0x31, 0x20, 0x32, 0x20, 0x33, 0x20, +- 0x34, 0x20, 0x35, 0x20, 0x36, 0x20, 0x37, 0x20, +- 0x38, 0x20, 0x39, 0x20, 0x3A, 0x20, 0x3B, 0x20, +- 0x3C, 0x20, 0x3D, 0x20, 0x3E, 0x20, 0x3F, 0x20, +- 0x40, 0x20, 0x41, 0x20, 0x42, 0x20, 0x43, 0x20, +- 0x44, 0x20, 0x45, 0x20, 0x46, 0x20, 0x47, 0x20, +- 0x48, 0x20, 0x49, 0x20, 0x4A, 0x20, 0x4B, 0x20, +- 0x4C, 0x20, 0x4D, 0x20, 0x4E, 0x20, 0x4F, 0x20, +- 0x50, 0x20, 0x51, 0x20, 0x52, 0x20, 0x53, 0x20, +- 0x54, 0x20, 0x55, 0x20, 0x56, 0x20, 0x57, 0x20, +- 0x58, 0x20, 0x59, 0x20, 0x5A, 0x20, 0x5B, 0x20, +- 0x5C, 0x20, 0x5D, 0x20, 0x5E, 0x20, 0x5F, 0x20, +- 0x60, 0x20, 0x61, 0x20, 0x62, 0x20, 0x63, 0x20, +- 0x64, 0x20, 0x65, 0x20, 0x66, 0x20, 0x67, 0x20, +- 0x68, 0x20, 0x69, 0x20, 0x6A, 0x20, 0x6B, 0x20, +- 0x6C, 0x20, 0x6D, 0x20, 0x6E, 0x20, 0x6F, 0x20, +- 0x70, 0x20, 0x71, 0x20, 0x72, 0x20, 0x73, 0x20, +- 0x74, 0x20, 0x75, 0x20, 0x76, 0x20, 0x77, 0x20, +- 0x78, 0x20, 0x79, 0x20, 0x7A, 0x20, 0x7B, 0x20, +- 0x7C, 0x20, 0x7D, 0x20, 0x7E, 0x20, 0x7F, 0x20, +- 0x80, 0x20, 0x81, 0x20, 0x82, 0x20, 0x83, 0x20, +- 0x84, 0x20, 0x85, 0x20, 0x86, 0x20, 0x87, 0x20, +- 0x88, 0x20, 0x89, 0x20, 0x8A, 0x20, 0x8B, 0x20, +- 0x8C, 0x20, 0x8D, 0x20, 0x8E, 0x20, 0x8F, 0x20, +- 0x90, 0x20, 0x91, 0x20, 0x92, 0x20, 0x93, 0x20, +- 0x94, 0x20, 0x95, 0x20, 0x96, 0x20, 0x97, 0x20, +- 0x98, 0x20, 0x99, 0x20, 0x9A, 0x20, 0x9B, 0x20, +- 0x9C, 0x20, 0x9D, 0x20, 0x9E, 0x20, 0x9F, 0x20, +- 0xA0, 0x20, 0xA1, 0x20, 0xA2, 0x20, 0xA3, 0x20, +- 0xA4, 0x20, 0xA5, 0x20, 0xA6, 0x20, 0xA7, 0x20, +- 0xA8, 0x20, 0xA9, 0x20, 0xAA, 0x20, 0xAB, 0x20, +- 0xAC, 0x20, 0xAD, 0x20, 0xAE, 0x20, 0xAF, 0x20, +- 0xB0, 0x20, 0xB1, 0x20, 0xB2, 0x20, 0xB3, 0x20, +- 0xB4, 0x20, 0xB5, 0x20, 0xB6, 0x20, 0xB7, 0x20, +- 0xB8, 0x20, 0xB9, 0x20, 0xBA, 0x20, 0xBB, 0x20, +- 0xBC, 0x20, 0xBD, 0x20, 0xBE, 0x20, 0xBF, 0x20, +- 0xC0, 0x20, 0xC1, 0x20, 0xC2, 0x20, 0xC3, 0x20, +- 0xC4, 0x20, 0xC5, 0x20, 0xC6, 0x20, 0xC7, 0x20, +- 0xC8, 0x20, 0xC9, 0x20, 0xCA, 0x20, 0xCB, 0x20, +- 0xCC, 0x20, 0xCD, 0x20, 0xCE, 0x20, 0xCF, 0x20, +- 0xD0, 0x20, 0xD1, 0x20, 0xD2, 0x20, 0xD3, 0x20, +- 0xD4, 0x20, 0xD5, 0x20, 0xD6, 0x20, 0xD7, 0x20, +- 0xD8, 0x20, 0xD9, 0x20, 0xDA, 0x20, 0xDB, 0x20, +- 0xDC, 0x20, 0xDD, 0x20, 0xDE, 0x20, 0xDF, 0x20, +- 0xE0, 0x20, 0xE1, 0x20, 0xE2, 0x20, 0xE3, 0x20, +- 0xE4, 0x20, 0xE5, 0x20, 0xE6, 0x20, 0xE7, 0x20, +- 0xE8, 0x20, 0xE9, 0x20, 0xEA, 0x20, 0xEB, 0x20, +- 0xEC, 0x20, 0xED, 0x20, 0xEE, 0x20, 0xEF, 0x20, +- 0xF0, 0x20, 0xF1, 0x20, 0xF2, 0x20, 0xF3, 0x20, +- 0xF4, 0x20, 0xF5, 0x20, 0xF6, 0x20, 0xF7, 0x20, +- 0xF8, 0x20, 0xF9, 0x20, 0xFA, 0x20, 0xFB, 0x20, +- 0xFC, 0x20, 0xFD, 0x20, 0xFE, 0x20, 0xFF, 0x20, +- 0x00, 0x21, 0x01, 0x21, 0x02, 0x21, 0x03, 0x21, +- 0x04, 0x21, 0x05, 0x21, 0x06, 0x21, 0x07, 0x21, +- 0x08, 0x21, 0x09, 0x21, 0x0A, 0x21, 0x0B, 0x21, +- 0x0C, 0x21, 0x0D, 0x21, 0x0E, 0x21, 0x0F, 0x21, +- 0x10, 0x21, 0x11, 0x21, 0x12, 0x21, 0x13, 0x21, +- 0x14, 0x21, 0x15, 0x21, 0x16, 0x21, 0x17, 0x21, +- 0x18, 0x21, 0x19, 0x21, 0x1A, 0x21, 0x1B, 0x21, +- 0x1C, 0x21, 0x1D, 0x21, 0x1E, 0x21, 0x1F, 0x21, +- 0x20, 0x21, 0x21, 0x21, 0x22, 0x21, 0x23, 0x21, +- 0x24, 0x21, 0x25, 0x21, 0x26, 0x21, 0x27, 0x21, +- 0x28, 0x21, 0x29, 0x21, 0x2A, 0x21, 0x2B, 0x21, +- 0x2C, 0x21, 0x2D, 0x21, 0x2E, 0x21, 0x2F, 0x21, +- 0x30, 0x21, 0x31, 0x21, 0x32, 0x21, 0x33, 0x21, +- 0x34, 0x21, 0x35, 0x21, 0x36, 0x21, 0x37, 0x21, +- 0x38, 0x21, 0x39, 0x21, 0x3A, 0x21, 0x3B, 0x21, +- 0x3C, 0x21, 0x3D, 0x21, 0x3E, 0x21, 0x3F, 0x21, +- 0x40, 0x21, 0x41, 0x21, 0x42, 0x21, 0x43, 0x21, +- 0x44, 0x21, 0x45, 0x21, 0x46, 0x21, 0x47, 0x21, +- 0x48, 0x21, 0x49, 0x21, 0x4A, 0x21, 0x4B, 0x21, +- 0x4C, 0x21, 0x4D, 0x21, 0x32, 0x21, 0x4F, 0x21, +- 0x50, 0x21, 0x51, 0x21, 0x52, 0x21, 0x53, 0x21, +- 0x54, 0x21, 0x55, 0x21, 0x56, 0x21, 0x57, 0x21, +- 0x58, 0x21, 0x59, 0x21, 0x5A, 0x21, 0x5B, 0x21, +- 0x5C, 0x21, 0x5D, 0x21, 0x5E, 0x21, 0x5F, 0x21, +- 0x60, 0x21, 0x61, 0x21, 0x62, 0x21, 0x63, 0x21, +- 0x64, 0x21, 0x65, 0x21, 0x66, 0x21, 0x67, 0x21, +- 0x68, 0x21, 0x69, 0x21, 0x6A, 0x21, 0x6B, 0x21, +- 0x6C, 0x21, 0x6D, 0x21, 0x6E, 0x21, 0x6F, 0x21, +- 0x60, 0x21, 0x61, 0x21, 0x62, 0x21, 0x63, 0x21, +- 0x64, 0x21, 0x65, 0x21, 0x66, 0x21, 0x67, 0x21, +- 0x68, 0x21, 0x69, 0x21, 0x6A, 0x21, 0x6B, 0x21, +- 0x6C, 0x21, 0x6D, 0x21, 0x6E, 0x21, 0x6F, 0x21, +- 0x80, 0x21, 0x81, 0x21, 0x82, 0x21, 0x83, 0x21, +- 0x83, 0x21, 0xFF, 0xFF, 0x4B, 0x03, 0xB6, 0x24, +- 0xB7, 0x24, 0xB8, 0x24, 0xB9, 0x24, 0xBA, 0x24, +- 0xBB, 0x24, 0xBC, 0x24, 0xBD, 0x24, 0xBE, 0x24, +- 0xBF, 0x24, 0xC0, 0x24, 0xC1, 0x24, 0xC2, 0x24, +- 0xC3, 0x24, 0xC4, 0x24, 0xC5, 0x24, 0xC6, 0x24, +- 0xC7, 0x24, 0xC8, 0x24, 0xC9, 0x24, 0xCA, 0x24, +- 0xCB, 0x24, 0xCC, 0x24, 0xCD, 0x24, 0xCE, 0x24, +- 0xCF, 0x24, 0xFF, 0xFF, 0x46, 0x07, 0x00, 0x2C, +- 0x01, 0x2C, 0x02, 0x2C, 0x03, 0x2C, 0x04, 0x2C, +- 0x05, 0x2C, 0x06, 0x2C, 0x07, 0x2C, 0x08, 0x2C, +- 0x09, 0x2C, 0x0A, 0x2C, 0x0B, 0x2C, 0x0C, 0x2C, +- 0x0D, 0x2C, 0x0E, 0x2C, 0x0F, 0x2C, 0x10, 0x2C, +- 0x11, 0x2C, 0x12, 0x2C, 0x13, 0x2C, 0x14, 0x2C, +- 0x15, 0x2C, 0x16, 0x2C, 0x17, 0x2C, 0x18, 0x2C, +- 0x19, 0x2C, 0x1A, 0x2C, 0x1B, 0x2C, 0x1C, 0x2C, +- 0x1D, 0x2C, 0x1E, 0x2C, 0x1F, 0x2C, 0x20, 0x2C, +- 0x21, 0x2C, 0x22, 0x2C, 0x23, 0x2C, 0x24, 0x2C, +- 0x25, 0x2C, 0x26, 0x2C, 0x27, 0x2C, 0x28, 0x2C, +- 0x29, 0x2C, 0x2A, 0x2C, 0x2B, 0x2C, 0x2C, 0x2C, +- 0x2D, 0x2C, 0x2E, 0x2C, 0x5F, 0x2C, 0x60, 0x2C, +- 0x60, 0x2C, 0x62, 0x2C, 0x63, 0x2C, 0x64, 0x2C, +- 0x65, 0x2C, 0x66, 0x2C, 0x67, 0x2C, 0x67, 0x2C, +- 0x69, 0x2C, 0x69, 0x2C, 0x6B, 0x2C, 0x6B, 0x2C, +- 0x6D, 0x2C, 0x6E, 0x2C, 0x6F, 0x2C, 0x70, 0x2C, +- 0x71, 0x2C, 0x72, 0x2C, 0x73, 0x2C, 0x74, 0x2C, +- 0x75, 0x2C, 0x75, 0x2C, 0x77, 0x2C, 0x78, 0x2C, +- 0x79, 0x2C, 0x7A, 0x2C, 0x7B, 0x2C, 0x7C, 0x2C, +- 0x7D, 0x2C, 0x7E, 0x2C, 0x7F, 0x2C, 0x80, 0x2C, +- 0x80, 0x2C, 0x82, 0x2C, 0x82, 0x2C, 0x84, 0x2C, +- 0x84, 0x2C, 0x86, 0x2C, 0x86, 0x2C, 0x88, 0x2C, +- 0x88, 0x2C, 0x8A, 0x2C, 0x8A, 0x2C, 0x8C, 0x2C, +- 0x8C, 0x2C, 0x8E, 0x2C, 0x8E, 0x2C, 0x90, 0x2C, +- 0x90, 0x2C, 0x92, 0x2C, 0x92, 0x2C, 0x94, 0x2C, +- 0x94, 0x2C, 0x96, 0x2C, 0x96, 0x2C, 0x98, 0x2C, +- 0x98, 0x2C, 0x9A, 0x2C, 0x9A, 0x2C, 0x9C, 0x2C, +- 0x9C, 0x2C, 0x9E, 0x2C, 0x9E, 0x2C, 0xA0, 0x2C, +- 0xA0, 0x2C, 0xA2, 0x2C, 0xA2, 0x2C, 0xA4, 0x2C, +- 0xA4, 0x2C, 0xA6, 0x2C, 0xA6, 0x2C, 0xA8, 0x2C, +- 0xA8, 0x2C, 0xAA, 0x2C, 0xAA, 0x2C, 0xAC, 0x2C, +- 0xAC, 0x2C, 0xAE, 0x2C, 0xAE, 0x2C, 0xB0, 0x2C, +- 0xB0, 0x2C, 0xB2, 0x2C, 0xB2, 0x2C, 0xB4, 0x2C, +- 0xB4, 0x2C, 0xB6, 0x2C, 0xB6, 0x2C, 0xB8, 0x2C, +- 0xB8, 0x2C, 0xBA, 0x2C, 0xBA, 0x2C, 0xBC, 0x2C, +- 0xBC, 0x2C, 0xBE, 0x2C, 0xBE, 0x2C, 0xC0, 0x2C, +- 0xC0, 0x2C, 0xC2, 0x2C, 0xC2, 0x2C, 0xC4, 0x2C, +- 0xC4, 0x2C, 0xC6, 0x2C, 0xC6, 0x2C, 0xC8, 0x2C, +- 0xC8, 0x2C, 0xCA, 0x2C, 0xCA, 0x2C, 0xCC, 0x2C, +- 0xCC, 0x2C, 0xCE, 0x2C, 0xCE, 0x2C, 0xD0, 0x2C, +- 0xD0, 0x2C, 0xD2, 0x2C, 0xD2, 0x2C, 0xD4, 0x2C, +- 0xD4, 0x2C, 0xD6, 0x2C, 0xD6, 0x2C, 0xD8, 0x2C, +- 0xD8, 0x2C, 0xDA, 0x2C, 0xDA, 0x2C, 0xDC, 0x2C, +- 0xDC, 0x2C, 0xDE, 0x2C, 0xDE, 0x2C, 0xE0, 0x2C, +- 0xE0, 0x2C, 0xE2, 0x2C, 0xE2, 0x2C, 0xE4, 0x2C, +- 0xE5, 0x2C, 0xE6, 0x2C, 0xE7, 0x2C, 0xE8, 0x2C, +- 0xE9, 0x2C, 0xEA, 0x2C, 0xEB, 0x2C, 0xEC, 0x2C, +- 0xED, 0x2C, 0xEE, 0x2C, 0xEF, 0x2C, 0xF0, 0x2C, +- 0xF1, 0x2C, 0xF2, 0x2C, 0xF3, 0x2C, 0xF4, 0x2C, +- 0xF5, 0x2C, 0xF6, 0x2C, 0xF7, 0x2C, 0xF8, 0x2C, +- 0xF9, 0x2C, 0xFA, 0x2C, 0xFB, 0x2C, 0xFC, 0x2C, +- 0xFD, 0x2C, 0xFE, 0x2C, 0xFF, 0x2C, 0xA0, 0x10, +- 0xA1, 0x10, 0xA2, 0x10, 0xA3, 0x10, 0xA4, 0x10, +- 0xA5, 0x10, 0xA6, 0x10, 0xA7, 0x10, 0xA8, 0x10, +- 0xA9, 0x10, 0xAA, 0x10, 0xAB, 0x10, 0xAC, 0x10, +- 0xAD, 0x10, 0xAE, 0x10, 0xAF, 0x10, 0xB0, 0x10, +- 0xB1, 0x10, 0xB2, 0x10, 0xB3, 0x10, 0xB4, 0x10, +- 0xB5, 0x10, 0xB6, 0x10, 0xB7, 0x10, 0xB8, 0x10, +- 0xB9, 0x10, 0xBA, 0x10, 0xBB, 0x10, 0xBC, 0x10, +- 0xBD, 0x10, 0xBE, 0x10, 0xBF, 0x10, 0xC0, 0x10, +- 0xC1, 0x10, 0xC2, 0x10, 0xC3, 0x10, 0xC4, 0x10, +- 0xC5, 0x10, 0xFF, 0xFF, 0x1B, 0xD2, 0x21, 0xFF, +- 0x22, 0xFF, 0x23, 0xFF, 0x24, 0xFF, 0x25, 0xFF, +- 0x26, 0xFF, 0x27, 0xFF, 0x28, 0xFF, 0x29, 0xFF, +- 0x2A, 0xFF, 0x2B, 0xFF, 0x2C, 0xFF, 0x2D, 0xFF, +- 0x2E, 0xFF, 0x2F, 0xFF, 0x30, 0xFF, 0x31, 0xFF, +- 0x32, 0xFF, 0x33, 0xFF, 0x34, 0xFF, 0x35, 0xFF, +- 0x36, 0xFF, 0x37, 0xFF, 0x38, 0xFF, 0x39, 0xFF, +- 0x3A, 0xFF, 0x5B, 0xFF, 0x5C, 0xFF, 0x5D, 0xFF, +- 0x5E, 0xFF, 0x5F, 0xFF, 0x60, 0xFF, 0x61, 0xFF, +- 0x62, 0xFF, 0x63, 0xFF, 0x64, 0xFF, 0x65, 0xFF, +- 0x66, 0xFF, 0x67, 0xFF, 0x68, 0xFF, 0x69, 0xFF, +- 0x6A, 0xFF, 0x6B, 0xFF, 0x6C, 0xFF, 0x6D, 0xFF, +- 0x6E, 0xFF, 0x6F, 0xFF, 0x70, 0xFF, 0x71, 0xFF, +- 0x72, 0xFF, 0x73, 0xFF, 0x74, 0xFF, 0x75, 0xFF, +- 0x76, 0xFF, 0x77, 0xFF, 0x78, 0xFF, 0x79, 0xFF, +- 0x7A, 0xFF, 0x7B, 0xFF, 0x7C, 0xFF, 0x7D, 0xFF, +- 0x7E, 0xFF, 0x7F, 0xFF, 0x80, 0xFF, 0x81, 0xFF, +- 0x82, 0xFF, 0x83, 0xFF, 0x84, 0xFF, 0x85, 0xFF, +- 0x86, 0xFF, 0x87, 0xFF, 0x88, 0xFF, 0x89, 0xFF, +- 0x8A, 0xFF, 0x8B, 0xFF, 0x8C, 0xFF, 0x8D, 0xFF, +- 0x8E, 0xFF, 0x8F, 0xFF, 0x90, 0xFF, 0x91, 0xFF, +- 0x92, 0xFF, 0x93, 0xFF, 0x94, 0xFF, 0x95, 0xFF, +- 0x96, 0xFF, 0x97, 0xFF, 0x98, 0xFF, 0x99, 0xFF, +- 0x9A, 0xFF, 0x9B, 0xFF, 0x9C, 0xFF, 0x9D, 0xFF, +- 0x9E, 0xFF, 0x9F, 0xFF, 0xA0, 0xFF, 0xA1, 0xFF, +- 0xA2, 0xFF, 0xA3, 0xFF, 0xA4, 0xFF, 0xA5, 0xFF, +- 0xA6, 0xFF, 0xA7, 0xFF, 0xA8, 0xFF, 0xA9, 0xFF, +- 0xAA, 0xFF, 0xAB, 0xFF, 0xAC, 0xFF, 0xAD, 0xFF, +- 0xAE, 0xFF, 0xAF, 0xFF, 0xB0, 0xFF, 0xB1, 0xFF, +- 0xB2, 0xFF, 0xB3, 0xFF, 0xB4, 0xFF, 0xB5, 0xFF, +- 0xB6, 0xFF, 0xB7, 0xFF, 0xB8, 0xFF, 0xB9, 0xFF, +- 0xBA, 0xFF, 0xBB, 0xFF, 0xBC, 0xFF, 0xBD, 0xFF, +- 0xBE, 0xFF, 0xBF, 0xFF, 0xC0, 0xFF, 0xC1, 0xFF, +- 0xC2, 0xFF, 0xC3, 0xFF, 0xC4, 0xFF, 0xC5, 0xFF, +- 0xC6, 0xFF, 0xC7, 0xFF, 0xC8, 0xFF, 0xC9, 0xFF, +- 0xCA, 0xFF, 0xCB, 0xFF, 0xCC, 0xFF, 0xCD, 0xFF, +- 0xCE, 0xFF, 0xCF, 0xFF, 0xD0, 0xFF, 0xD1, 0xFF, +- 0xD2, 0xFF, 0xD3, 0xFF, 0xD4, 0xFF, 0xD5, 0xFF, +- 0xD6, 0xFF, 0xD7, 0xFF, 0xD8, 0xFF, 0xD9, 0xFF, +- 0xDA, 0xFF, 0xDB, 0xFF, 0xDC, 0xFF, 0xDD, 0xFF, +- 0xDE, 0xFF, 0xDF, 0xFF, 0xE0, 0xFF, 0xE1, 0xFF, +- 0xE2, 0xFF, 0xE3, 0xFF, 0xE4, 0xFF, 0xE5, 0xFF, +- 0xE6, 0xFF, 0xE7, 0xFF, 0xE8, 0xFF, 0xE9, 0xFF, +- 0xEA, 0xFF, 0xEB, 0xFF, 0xEC, 0xFF, 0xED, 0xFF, +- 0xEE, 0xFF, 0xEF, 0xFF, 0xF0, 0xFF, 0xF1, 0xFF, +- 0xF2, 0xFF, 0xF3, 0xFF, 0xF4, 0xFF, 0xF5, 0xFF, +- 0xF6, 0xFF, 0xF7, 0xFF, 0xF8, 0xFF, 0xF9, 0xFF, +- 0xFA, 0xFF, 0xFB, 0xFF, 0xFC, 0xFF, 0xFD, 0xFF, +- 0xFE, 0xFF, 0xFF, 0xFF +-}; +diff -Nurp linux-5.6.3.orig/drivers/staging/exfat/Kconfig linux-5.6.3/drivers/staging/exfat/Kconfig +--- linux-5.6.3.orig/drivers/staging/exfat/Kconfig 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/drivers/staging/exfat/Kconfig 1970-01-01 02:00:00.000000000 +0200 +@@ -1,41 +0,0 @@ +-# SPDX-License-Identifier: GPL-2.0 +-config STAGING_EXFAT_FS +- tristate "exFAT fs support" +- depends on BLOCK +- select NLS +- help +- This adds support for the exFAT file system. +- +-config STAGING_EXFAT_DISCARD +- bool "enable discard support" +- depends on STAGING_EXFAT_FS +- default y +- +-config STAGING_EXFAT_DELAYED_SYNC +- bool "enable delayed sync" +- depends on STAGING_EXFAT_FS +- default n +- +-config STAGING_EXFAT_KERNEL_DEBUG +- bool "enable kernel debug features via ioctl" +- depends on STAGING_EXFAT_FS +- default n +- +-config STAGING_EXFAT_DEBUG_MSG +- bool "print debug messages" +- depends on STAGING_EXFAT_FS +- default n +- +-config STAGING_EXFAT_DEFAULT_CODEPAGE +- int "Default codepage for exFAT" +- default 437 +- depends on STAGING_EXFAT_FS +- help +- This option should be set to the codepage of your exFAT filesystems. +- +-config STAGING_EXFAT_DEFAULT_IOCHARSET +- string "Default iocharset for exFAT" +- default "utf8" +- depends on STAGING_EXFAT_FS +- help +- Set this to the default input/output character set you'd like exFAT to use. +diff -Nurp linux-5.6.3.orig/drivers/staging/exfat/Makefile linux-5.6.3/drivers/staging/exfat/Makefile +--- linux-5.6.3.orig/drivers/staging/exfat/Makefile 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/drivers/staging/exfat/Makefile 1970-01-01 02:00:00.000000000 +0200 +@@ -1,10 +0,0 @@ +-# SPDX-License-Identifier: GPL-2.0-or-later +- +-obj-$(CONFIG_STAGING_EXFAT_FS) += exfat.o +- +-exfat-y := exfat_core.o \ +- exfat_super.o \ +- exfat_blkdev.o \ +- exfat_cache.o \ +- exfat_nls.o \ +- exfat_upcase.o +diff -Nurp linux-5.6.3.orig/drivers/staging/exfat/TODO linux-5.6.3/drivers/staging/exfat/TODO +--- linux-5.6.3.orig/drivers/staging/exfat/TODO 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/drivers/staging/exfat/TODO 1970-01-01 02:00:00.000000000 +0200 +@@ -1,69 +0,0 @@ +-A laundry list of things that need looking at, most of which will +-require more work than the average checkpatch cleanup... +- +-Note that some of these entries may not be bugs - they're things +-that need to be looked at, and *possibly* fixed. +- +-Clean up the ffsCamelCase function names. +- +-Fix (thing)->flags to not use magic numbers - multiple offenders +- +-Sort out all the s32/u32/u8 nonsense - most of these should be plain int. +- +-exfat_core.c - ffsReadFile - the goto err_out seem to leak a brelse(). +-same for ffsWriteFile. +- +-All the calls to fs_sync() need to be looked at, particularly in the +-context of EXFAT_DELAYED_SYNC. Currently, if that's defined, we only +-flush to disk when sync() gets called. We should be doing at least +-metadata flushes at appropriate times. +- +-ffsTruncateFile - if (old_size <= new_size) { +-That doesn't look right. How did it ever work? Are they relying on lazy +-block allocation when actual writes happen? If nothing else, it never +-does the 'fid->size = new_size' and do the inode update.... +- +-ffsSetAttr() is just dangling in the breeze, not wired up at all... +- +-Convert global mutexes to a per-superblock mutex. +- +-Right now, we load exactly one UTF-8 table. Check to see +-if that plays nice with different codepage and iocharset values +-for simultanous mounts of different devices +- +-exfat_rmdir() checks for -EBUSY but ffsRemoveDir() doesn't return it. +-In fact, there's a complete lack of -EBUSY testing anywhere. +- +-There's probably a few missing checks for -EEXIST +- +-check return codes of sync_dirty_buffer() +- +-Why is remove_file doing a num_entries++?? +- +-Double check a lot of can't-happen parameter checks (for null pointers for +-things that have only one call site and can't pass a null, etc). +- +-All the DEBUG stuff can probably be tossed, including the ioctl(). Either +-that, or convert to a proper fault-injection system. +- +-exfat_remount does exactly one thing. Fix to actually deal with remount +-options, particularly handling R/O correctly. For that matter, allow +-R/O mounts in the first place. +- +-Figure out why the VFAT code used multi_sector_(read|write) but the +-exfat code doesn't use it. The difference matters on SSDs with wear leveling. +- +-exfat_fat_sync(), exfat_buf_sync(), and sync_alloc_bitmap() +-aren't called anyplace.... +- +-Create helper function for exfat_set_entry_time() and exfat_set_entry_type() +-because it's sort of ugly to be calling the same functionn directly and +-other code calling through the fs_func struc ponters... +- +-clean up the remaining vol_type checks, which are of two types: +-some are ?: operators with magic numbers, and the rest are places +-where we're doing stuff with '.' and '..'. +- +-Patches to: +- Greg Kroah-Hartman +- Valdis Kletnieks +diff -Nurp linux-5.6.3.orig/drivers/staging/Kconfig linux-5.6.3/drivers/staging/Kconfig +--- linux-5.6.3.orig/drivers/staging/Kconfig 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/drivers/staging/Kconfig 2020-04-10 13:23:50.104394573 +0300 +@@ -115,8 +115,6 @@ source "drivers/staging/kpc2000/Kconfig" + source "drivers/staging/wusbcore/Kconfig" + source "drivers/staging/uwb/Kconfig" + +-source "drivers/staging/exfat/Kconfig" +- + source "drivers/staging/qlge/Kconfig" + + source "drivers/staging/hp/Kconfig" +diff -Nurp linux-5.6.3.orig/drivers/staging/Makefile linux-5.6.3/drivers/staging/Makefile +--- linux-5.6.3.orig/drivers/staging/Makefile 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/drivers/staging/Makefile 2020-04-10 13:23:55.703656045 +0300 +@@ -48,7 +48,6 @@ obj-$(CONFIG_FIELDBUS_DEV) += fieldb + obj-$(CONFIG_KPC2000) += kpc2000/ + obj-$(CONFIG_UWB) += uwb/ + obj-$(CONFIG_USB_WUSB) += wusbcore/ +-obj-$(CONFIG_STAGING_EXFAT_FS) += exfat/ + obj-$(CONFIG_QLGE) += qlge/ + obj-$(CONFIG_NET_VENDOR_HP) += hp/ + obj-$(CONFIG_WFX) += wfx/ +diff -Nurp linux-5.6.3.orig/MAINTAINERS linux-5.6.3/MAINTAINERS +--- linux-5.6.3.orig/MAINTAINERS 2020-03-30 01:25:41.000000000 +0300 ++++ linux-5.6.3/MAINTAINERS 2020-04-10 13:23:25.806260135 +0300 +@@ -6304,12 +6304,6 @@ F: include/trace/events/mdio.h + F: include/uapi/linux/mdio.h + F: include/uapi/linux/mii.h + +-EXFAT FILE SYSTEM +-M: Valdis Kletnieks +-L: linux-fsdevel@vger.kernel.org +-S: Maintained +-F: drivers/staging/exfat/ +- + EXT2 FILE SYSTEM + M: Jan Kara + L: linux-ext4@vger.kernel.org diff --git a/kernel/kernel/files/patches/mageia/fs-exfat-update-file-system-parameter-handling.patch b/kernel/kernel/files/patches/mageia/fs-exfat-update-file-system-parameter-handling.patch new file mode 100644 index 00000000..9e07cd45 --- /dev/null +++ b/kernel/kernel/files/patches/mageia/fs-exfat-update-file-system-parameter-handling.patch @@ -0,0 +1,84 @@ +From 9acd0d53800c55c6e2186e29b6433daf24617451 Mon Sep 17 00:00:00 2001 +From: Valdis Kletnieks +Date: Mon, 2 Mar 2020 15:21:45 +0900 +Subject: [PATCH] exfat: update file system parameter handling + +Al Viro recently reworked the way file system parameters are handled +Update super.c to work with it in linux-next 20200203. + +Signed-off-by: Valdis Kletnieks +Reviewed-by: Christoph Hellwig +Acked-by: Namjae Jeon +Signed-off-by: Al Viro +--- + fs/exfat/super.c | 28 +++++++++++----------------- + 1 file changed, 11 insertions(+), 17 deletions(-) + +diff --git a/fs/exfat/super.c b/fs/exfat/super.c +index f06e0b53e393..16ed202ef527 100644 +--- a/fs/exfat/super.c ++++ b/fs/exfat/super.c +@@ -214,7 +214,14 @@ enum { + Opt_time_offset, + }; + +-static const struct fs_parameter_spec exfat_param_specs[] = { ++static const struct constant_table exfat_param_enums[] = { ++ { "continue", EXFAT_ERRORS_CONT }, ++ { "panic", EXFAT_ERRORS_PANIC }, ++ { "remount-ro", EXFAT_ERRORS_RO }, ++ {} ++}; ++ ++static const struct fs_parameter_spec exfat_parameters[] = { + fsparam_u32("uid", Opt_uid), + fsparam_u32("gid", Opt_gid), + fsparam_u32oct("umask", Opt_umask), +@@ -222,25 +229,12 @@ static const struct fs_parameter_spec exfat_param_specs[] = { + fsparam_u32oct("fmask", Opt_fmask), + fsparam_u32oct("allow_utime", Opt_allow_utime), + fsparam_string("iocharset", Opt_charset), +- fsparam_enum("errors", Opt_errors), ++ fsparam_enum("errors", Opt_errors, exfat_param_enums), + fsparam_flag("discard", Opt_discard), + fsparam_s32("time_offset", Opt_time_offset), + {} + }; + +-static const struct fs_parameter_enum exfat_param_enums[] = { +- { Opt_errors, "continue", EXFAT_ERRORS_CONT }, +- { Opt_errors, "panic", EXFAT_ERRORS_PANIC }, +- { Opt_errors, "remount-ro", EXFAT_ERRORS_RO }, +- {} +-}; +- +-static const struct fs_parameter_description exfat_parameters = { +- .name = "exfat", +- .specs = exfat_param_specs, +- .enums = exfat_param_enums, +-}; +- + static int exfat_parse_param(struct fs_context *fc, struct fs_parameter *param) + { + struct exfat_sb_info *sbi = fc->s_fs_info; +@@ -248,7 +242,7 @@ static int exfat_parse_param(struct fs_context *fc, struct fs_parameter *param) + struct fs_parse_result result; + int opt; + +- opt = fs_parse(fc, &exfat_parameters, param, &result); ++ opt = fs_parse(fc, exfat_parameters, param, &result); + if (opt < 0) + return opt; + +@@ -665,7 +659,7 @@ static struct file_system_type exfat_fs_type = { + .owner = THIS_MODULE, + .name = "exfat", + .init_fs_context = exfat_init_fs_context, +- .parameters = &exfat_parameters, ++ .parameters = exfat_parameters, + .kill_sb = kill_block_super, + .fs_flags = FS_REQUIRES_DEV, + }; +-- +2.26.0 + diff --git a/kernel/kernel/files/patches/mageia/fs-vboxsf.patch b/kernel/kernel/files/patches/mageia/fs-vboxsf.patch deleted file mode 100644 index 434fdee6..00000000 --- a/kernel/kernel/files/patches/mageia/fs-vboxsf.patch +++ /dev/null @@ -1,3410 +0,0 @@ -From df4028658f9dd7f82fd190e9db5bd82c05f94625 Mon Sep 17 00:00:00 2001 -From: Hans de Goede -Date: Mon, 28 Oct 2019 12:17:44 +0100 -Subject: staging: Add VirtualBox guest shared folder (vboxsf) support - -VirtualBox hosts can share folders with guests, this commit adds a -VFS driver implementing the Linux-guest side of this, allowing folders -exported by the host to be mounted under Linux. - -This driver depends on the guest <-> host IPC functions exported by -the vboxguest driver. - -Signed-off-by: Hans de Goede -Link: https://lore.kernel.org/r/20191028111744.143863-2-hdegoede@redhat.com -Signed-off-by: Greg Kroah-Hartman ---- - MAINTAINERS | 6 + - drivers/staging/Kconfig | 2 + - drivers/staging/Makefile | 1 + - drivers/staging/vboxsf/Kconfig | 10 + - drivers/staging/vboxsf/Makefile | 5 + - drivers/staging/vboxsf/TODO | 7 + - drivers/staging/vboxsf/dir.c | 418 ++++++++++++++ - drivers/staging/vboxsf/file.c | 370 +++++++++++++ - drivers/staging/vboxsf/shfl_hostintf.h | 901 +++++++++++++++++++++++++++++++ - drivers/staging/vboxsf/super.c | 499 +++++++++++++++++ - drivers/staging/vboxsf/utils.c | 550 +++++++++++++++++++ - drivers/staging/vboxsf/vboxsf_wrappers.c | 371 +++++++++++++ - drivers/staging/vboxsf/vfsmod.h | 138 +++++ - 13 files changed, 3278 insertions(+) - create mode 100644 drivers/staging/vboxsf/Kconfig - create mode 100644 drivers/staging/vboxsf/Makefile - create mode 100644 drivers/staging/vboxsf/TODO - create mode 100644 drivers/staging/vboxsf/dir.c - create mode 100644 drivers/staging/vboxsf/file.c - create mode 100644 drivers/staging/vboxsf/shfl_hostintf.h - create mode 100644 drivers/staging/vboxsf/super.c - create mode 100644 drivers/staging/vboxsf/utils.c - create mode 100644 drivers/staging/vboxsf/vboxsf_wrappers.c - create mode 100644 drivers/staging/vboxsf/vfsmod.h - -diff --git a/MAINTAINERS b/MAINTAINERS -index c6c34d04ce95..71789e42ed17 100644 ---- a/MAINTAINERS -+++ b/MAINTAINERS -@@ -17335,6 +17335,12 @@ F: include/linux/vbox_utils.h - F: include/uapi/linux/vbox*.h - F: drivers/virt/vboxguest/ - -+VIRTUAL BOX SHARED FOLDER VFS DRIVER: -+M: Hans de Goede -+L: linux-fsdevel@vger.kernel.org -+S: Maintained -+F: drivers/staging/vboxsf/* -+ - VIRTUAL SERIO DEVICE DRIVER - M: Stephen Chandler Paul - S: Maintained -diff --git a/drivers/staging/Kconfig b/drivers/staging/Kconfig -index 6f1fa4c849a1..927d29eb92c6 100644 ---- a/drivers/staging/Kconfig -+++ b/drivers/staging/Kconfig -@@ -125,4 +125,6 @@ source "drivers/staging/exfat/Kconfig" - - source "drivers/staging/qlge/Kconfig" - -+source "drivers/staging/vboxsf/Kconfig" -+ - endif # STAGING -diff --git a/drivers/staging/Makefile b/drivers/staging/Makefile -index a90f9b308c8d..f01f04199073 100644 ---- a/drivers/staging/Makefile -+++ b/drivers/staging/Makefile -@@ -53,3 +53,4 @@ obj-$(CONFIG_UWB) += uwb/ - obj-$(CONFIG_USB_WUSB) += wusbcore/ - obj-$(CONFIG_EXFAT_FS) += exfat/ - obj-$(CONFIG_QLGE) += qlge/ -+obj-$(CONFIG_VBOXSF_FS) += vboxsf/ -diff --git a/drivers/staging/vboxsf/Kconfig b/drivers/staging/vboxsf/Kconfig -new file mode 100644 -index 000000000000..b84586ae08b3 ---- /dev/null -+++ b/drivers/staging/vboxsf/Kconfig -@@ -0,0 +1,10 @@ -+config VBOXSF_FS -+ tristate "VirtualBox guest shared folder (vboxsf) support" -+ depends on X86 && VBOXGUEST -+ select NLS -+ help -+ VirtualBox hosts can share folders with guests, this driver -+ implements the Linux-guest side of this allowing folders exported -+ by the host to be mounted under Linux. -+ -+ If you want to use shared folders in VirtualBox guests, answer Y or M. -diff --git a/drivers/staging/vboxsf/Makefile b/drivers/staging/vboxsf/Makefile -new file mode 100644 -index 000000000000..9e4328e79623 ---- /dev/null -+++ b/drivers/staging/vboxsf/Makefile -@@ -0,0 +1,5 @@ -+# SPDX-License-Identifier: MIT -+ -+obj-$(CONFIG_VBOXSF_FS) += vboxsf.o -+ -+vboxsf-y := dir.o file.o utils.o vboxsf_wrappers.o super.o -diff --git a/drivers/staging/vboxsf/TODO b/drivers/staging/vboxsf/TODO -new file mode 100644 -index 000000000000..8b9193d0d4f0 ---- /dev/null -+++ b/drivers/staging/vboxsf/TODO -@@ -0,0 +1,7 @@ -+TODO: -+- Find a file-system developer to review this and give their Reviewed-By -+- Address any items coming up during review -+- Move to fs/vboxfs -+ -+Please send any patches to Greg Kroah-Hartman -+and Hans de Goede -diff --git a/drivers/staging/vboxsf/dir.c b/drivers/staging/vboxsf/dir.c -new file mode 100644 -index 000000000000..f260b5cc1646 ---- /dev/null -+++ b/drivers/staging/vboxsf/dir.c -@@ -0,0 +1,418 @@ -+// SPDX-License-Identifier: MIT -+/* -+ * VirtualBox Guest Shared Folders support: Directory inode and file operations -+ * -+ * Copyright (C) 2006-2018 Oracle Corporation -+ */ -+ -+#include -+#include -+#include "vfsmod.h" -+ -+static int vboxsf_dir_open(struct inode *inode, struct file *file) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(inode->i_sb); -+ struct shfl_createparms params = {}; -+ struct vboxsf_dir_info *sf_d; -+ int err; -+ -+ sf_d = vboxsf_dir_info_alloc(); -+ if (!sf_d) -+ return -ENOMEM; -+ -+ params.handle = SHFL_HANDLE_NIL; -+ params.create_flags = SHFL_CF_DIRECTORY | SHFL_CF_ACT_OPEN_IF_EXISTS | -+ SHFL_CF_ACT_FAIL_IF_NEW | SHFL_CF_ACCESS_READ; -+ -+ err = vboxsf_create_at_dentry(file_dentry(file), ¶ms); -+ if (err) -+ goto err_free_dir_info; -+ -+ if (params.result != SHFL_FILE_EXISTS) { -+ err = -ENOENT; -+ goto err_close; -+ } -+ -+ err = vboxsf_dir_read_all(sbi, sf_d, params.handle); -+ if (err) -+ goto err_close; -+ -+ vboxsf_close(sbi->root, params.handle); -+ file->private_data = sf_d; -+ return 0; -+ -+err_close: -+ vboxsf_close(sbi->root, params.handle); -+err_free_dir_info: -+ vboxsf_dir_info_free(sf_d); -+ return err; -+} -+ -+static int vboxsf_dir_release(struct inode *inode, struct file *file) -+{ -+ if (file->private_data) -+ vboxsf_dir_info_free(file->private_data); -+ -+ return 0; -+} -+ -+static unsigned int vboxsf_get_d_type(u32 mode) -+{ -+ unsigned int d_type; -+ -+ switch (mode & SHFL_TYPE_MASK) { -+ case SHFL_TYPE_FIFO: -+ d_type = DT_FIFO; -+ break; -+ case SHFL_TYPE_DEV_CHAR: -+ d_type = DT_CHR; -+ break; -+ case SHFL_TYPE_DIRECTORY: -+ d_type = DT_DIR; -+ break; -+ case SHFL_TYPE_DEV_BLOCK: -+ d_type = DT_BLK; -+ break; -+ case SHFL_TYPE_FILE: -+ d_type = DT_REG; -+ break; -+ case SHFL_TYPE_SYMLINK: -+ d_type = DT_LNK; -+ break; -+ case SHFL_TYPE_SOCKET: -+ d_type = DT_SOCK; -+ break; -+ case SHFL_TYPE_WHITEOUT: -+ d_type = DT_WHT; -+ break; -+ default: -+ d_type = DT_UNKNOWN; -+ break; -+ } -+ return d_type; -+} -+ -+static bool vboxsf_dir_emit(struct file *dir, struct dir_context *ctx) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(file_inode(dir)->i_sb); -+ struct vboxsf_dir_info *sf_d = dir->private_data; -+ struct shfl_dirinfo *info; -+ struct vboxsf_dir_buf *b; -+ unsigned int d_type; -+ loff_t i, cur = 0; -+ ino_t fake_ino; -+ size_t size; -+ int err; -+ -+ list_for_each_entry(b, &sf_d->info_list, head) { -+try_next_entry: -+ if (ctx->pos >= cur + b->entries) { -+ cur += b->entries; -+ continue; -+ } -+ -+ /* -+ * Note the vboxsf_dir_info objects we are iterating over here -+ * are variable sized, so the info pointer may end up being -+ * unaligned. This is how we get the data from the host. -+ * Since vboxsf is only supported on x86 machines this is not -+ * a problem. -+ */ -+ for (i = 0, info = b->buf; i < ctx->pos - cur; i++) { -+ size = offsetof(struct shfl_dirinfo, name.string) + -+ info->name.size; -+ info = (struct shfl_dirinfo *)((uintptr_t)info + size); -+ } -+ -+ /* Info now points to the right entry, emit it. */ -+ d_type = vboxsf_get_d_type(info->info.attr.mode); -+ -+ /* -+ * On 32 bit systems pos is 64 signed, while ino is 32 bit -+ * unsigned so fake_ino may overflow, check for this. -+ */ -+ if ((ino_t)(ctx->pos + 1) != (u64)(ctx->pos + 1)) { -+ vbg_err("vboxsf: fake ino overflow, truncating dir\n"); -+ return false; -+ } -+ fake_ino = ctx->pos + 1; -+ -+ if (sbi->nls) { -+ char d_name[NAME_MAX]; -+ -+ err = vboxsf_nlscpy(sbi, d_name, NAME_MAX, -+ info->name.string.utf8, -+ info->name.length); -+ if (err) { -+ /* skip erroneous entry and proceed */ -+ ctx->pos += 1; -+ goto try_next_entry; -+ } -+ -+ return dir_emit(ctx, d_name, strlen(d_name), -+ fake_ino, d_type); -+ } -+ -+ return dir_emit(ctx, info->name.string.utf8, info->name.length, -+ fake_ino, d_type); -+ } -+ -+ return false; -+} -+ -+static int vboxsf_dir_iterate(struct file *dir, struct dir_context *ctx) -+{ -+ bool keep_iterating; -+ -+ for (keep_iterating = true; keep_iterating; ctx->pos += 1) -+ keep_iterating = vboxsf_dir_emit(dir, ctx); -+ -+ return 0; -+} -+ -+const struct file_operations vboxsf_dir_fops = { -+ .open = vboxsf_dir_open, -+ .iterate = vboxsf_dir_iterate, -+ .release = vboxsf_dir_release, -+ .read = generic_read_dir, -+ .llseek = generic_file_llseek, -+}; -+ -+/* -+ * This is called during name resolution/lookup to check if the @dentry in -+ * the cache is still valid. the job is handled by vboxsf_inode_revalidate. -+ */ -+static int vboxsf_dentry_revalidate(struct dentry *dentry, unsigned int flags) -+{ -+ if (flags & LOOKUP_RCU) -+ return -ECHILD; -+ -+ if (d_really_is_positive(dentry)) -+ return vboxsf_inode_revalidate(dentry) == 0; -+ else -+ return vboxsf_stat_dentry(dentry, NULL) == -ENOENT; -+} -+ -+const struct dentry_operations vboxsf_dentry_ops = { -+ .d_revalidate = vboxsf_dentry_revalidate -+}; -+ -+/* iops */ -+ -+static struct dentry *vboxsf_dir_lookup(struct inode *parent, -+ struct dentry *dentry, -+ unsigned int flags) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(parent->i_sb); -+ struct shfl_fsobjinfo fsinfo; -+ struct inode *inode; -+ int err; -+ -+ dentry->d_time = jiffies; -+ -+ err = vboxsf_stat_dentry(dentry, &fsinfo); -+ if (err) { -+ inode = (err == -ENOENT) ? NULL : ERR_PTR(err); -+ } else { -+ inode = vboxsf_new_inode(parent->i_sb); -+ if (!IS_ERR(inode)) -+ vboxsf_init_inode(sbi, inode, &fsinfo); -+ } -+ -+ return d_splice_alias(inode, dentry); -+} -+ -+static int vboxsf_dir_instantiate(struct inode *parent, struct dentry *dentry, -+ struct shfl_fsobjinfo *info) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(parent->i_sb); -+ struct vboxsf_inode *sf_i; -+ struct inode *inode; -+ -+ inode = vboxsf_new_inode(parent->i_sb); -+ if (IS_ERR(inode)) -+ return PTR_ERR(inode); -+ -+ sf_i = VBOXSF_I(inode); -+ /* The host may have given us different attr then requested */ -+ sf_i->force_restat = 1; -+ vboxsf_init_inode(sbi, inode, info); -+ -+ d_instantiate(dentry, inode); -+ -+ return 0; -+} -+ -+static int vboxsf_dir_create(struct inode *parent, struct dentry *dentry, -+ umode_t mode, int is_dir) -+{ -+ struct vboxsf_inode *sf_parent_i = VBOXSF_I(parent); -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(parent->i_sb); -+ struct shfl_createparms params = {}; -+ int err; -+ -+ params.handle = SHFL_HANDLE_NIL; -+ params.create_flags = SHFL_CF_ACT_CREATE_IF_NEW | -+ SHFL_CF_ACT_FAIL_IF_EXISTS | -+ SHFL_CF_ACCESS_READWRITE | -+ (is_dir ? SHFL_CF_DIRECTORY : 0); -+ params.info.attr.mode = (mode & 0777) | -+ (is_dir ? SHFL_TYPE_DIRECTORY : SHFL_TYPE_FILE); -+ params.info.attr.additional = SHFLFSOBJATTRADD_NOTHING; -+ -+ err = vboxsf_create_at_dentry(dentry, ¶ms); -+ if (err) -+ return err; -+ -+ if (params.result != SHFL_FILE_CREATED) -+ return -EPERM; -+ -+ vboxsf_close(sbi->root, params.handle); -+ -+ err = vboxsf_dir_instantiate(parent, dentry, ¶ms.info); -+ if (err) -+ return err; -+ -+ /* parent directory access/change time changed */ -+ sf_parent_i->force_restat = 1; -+ -+ return 0; -+} -+ -+static int vboxsf_dir_mkfile(struct inode *parent, struct dentry *dentry, -+ umode_t mode, bool excl) -+{ -+ return vboxsf_dir_create(parent, dentry, mode, 0); -+} -+ -+static int vboxsf_dir_mkdir(struct inode *parent, struct dentry *dentry, -+ umode_t mode) -+{ -+ return vboxsf_dir_create(parent, dentry, mode, 1); -+} -+ -+static int vboxsf_dir_unlink(struct inode *parent, struct dentry *dentry) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(parent->i_sb); -+ struct vboxsf_inode *sf_parent_i = VBOXSF_I(parent); -+ struct inode *inode = d_inode(dentry); -+ struct shfl_string *path; -+ u32 flags; -+ int err; -+ -+ if (S_ISDIR(inode->i_mode)) -+ flags = SHFL_REMOVE_DIR; -+ else -+ flags = SHFL_REMOVE_FILE; -+ -+ if (S_ISLNK(inode->i_mode)) -+ flags |= SHFL_REMOVE_SYMLINK; -+ -+ path = vboxsf_path_from_dentry(sbi, dentry); -+ if (IS_ERR(path)) -+ return PTR_ERR(path); -+ -+ err = vboxsf_remove(sbi->root, path, flags); -+ __putname(path); -+ if (err) -+ return err; -+ -+ /* parent directory access/change time changed */ -+ sf_parent_i->force_restat = 1; -+ -+ return 0; -+} -+ -+static int vboxsf_dir_rename(struct inode *old_parent, -+ struct dentry *old_dentry, -+ struct inode *new_parent, -+ struct dentry *new_dentry, -+ unsigned int flags) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(old_parent->i_sb); -+ struct vboxsf_inode *sf_old_parent_i = VBOXSF_I(old_parent); -+ struct vboxsf_inode *sf_new_parent_i = VBOXSF_I(new_parent); -+ u32 shfl_flags = SHFL_RENAME_FILE | SHFL_RENAME_REPLACE_IF_EXISTS; -+ struct shfl_string *old_path, *new_path; -+ int err; -+ -+ if (flags) -+ return -EINVAL; -+ -+ old_path = vboxsf_path_from_dentry(sbi, old_dentry); -+ if (IS_ERR(old_path)) -+ return PTR_ERR(old_path); -+ -+ new_path = vboxsf_path_from_dentry(sbi, new_dentry); -+ if (IS_ERR(new_path)) { -+ err = PTR_ERR(new_path); -+ goto err_put_old_path; -+ } -+ -+ if (d_inode(old_dentry)->i_mode & S_IFDIR) -+ shfl_flags = 0; -+ -+ err = vboxsf_rename(sbi->root, old_path, new_path, shfl_flags); -+ if (err == 0) { -+ /* parent directories access/change time changed */ -+ sf_new_parent_i->force_restat = 1; -+ sf_old_parent_i->force_restat = 1; -+ } -+ -+ __putname(new_path); -+err_put_old_path: -+ __putname(old_path); -+ return err; -+} -+ -+static int vboxsf_dir_symlink(struct inode *parent, struct dentry *dentry, -+ const char *symname) -+{ -+ struct vboxsf_inode *sf_parent_i = VBOXSF_I(parent); -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(parent->i_sb); -+ int symname_size = strlen(symname) + 1; -+ struct shfl_string *path, *ssymname; -+ struct shfl_fsobjinfo info; -+ int err; -+ -+ path = vboxsf_path_from_dentry(sbi, dentry); -+ if (IS_ERR(path)) -+ return PTR_ERR(path); -+ -+ ssymname = kmalloc(SHFLSTRING_HEADER_SIZE + symname_size, GFP_KERNEL); -+ if (!ssymname) { -+ __putname(path); -+ return -ENOMEM; -+ } -+ ssymname->length = symname_size - 1; -+ ssymname->size = symname_size; -+ memcpy(ssymname->string.utf8, symname, symname_size); -+ -+ err = vboxsf_symlink(sbi->root, path, ssymname, &info); -+ kfree(ssymname); -+ __putname(path); -+ if (err) { -+ /* -EROFS means symlinks are note support -> -EPERM */ -+ return (err == -EROFS) ? -EPERM : err; -+ } -+ -+ err = vboxsf_dir_instantiate(parent, dentry, &info); -+ if (err) -+ return err; -+ -+ /* parent directory access/change time changed */ -+ sf_parent_i->force_restat = 1; -+ return 0; -+} -+ -+const struct inode_operations vboxsf_dir_iops = { -+ .lookup = vboxsf_dir_lookup, -+ .create = vboxsf_dir_mkfile, -+ .mkdir = vboxsf_dir_mkdir, -+ .rmdir = vboxsf_dir_unlink, -+ .unlink = vboxsf_dir_unlink, -+ .rename = vboxsf_dir_rename, -+ .symlink = vboxsf_dir_symlink, -+ .getattr = vboxsf_getattr, -+ .setattr = vboxsf_setattr, -+}; -diff --git a/drivers/staging/vboxsf/file.c b/drivers/staging/vboxsf/file.c -new file mode 100644 -index 000000000000..4b61ccf83fca ---- /dev/null -+++ b/drivers/staging/vboxsf/file.c -@@ -0,0 +1,370 @@ -+// SPDX-License-Identifier: MIT -+/* -+ * VirtualBox Guest Shared Folders support: Regular file inode and file ops. -+ * -+ * Copyright (C) 2006-2018 Oracle Corporation -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include "vfsmod.h" -+ -+struct vboxsf_handle { -+ u64 handle; -+ u32 root; -+ u32 access_flags; -+ struct kref refcount; -+ struct list_head head; -+}; -+ -+static int vboxsf_file_open(struct inode *inode, struct file *file) -+{ -+ struct vboxsf_inode *sf_i = VBOXSF_I(inode); -+ struct shfl_createparms params = {}; -+ struct vboxsf_handle *sf_handle; -+ u32 access_flags = 0; -+ int err; -+ -+ sf_handle = kmalloc(sizeof(*sf_handle), GFP_KERNEL); -+ if (!sf_handle) -+ return -ENOMEM; -+ -+ /* -+ * We check the value of params.handle afterwards to find out if -+ * the call succeeded or failed, as the API does not seem to cleanly -+ * distinguish error and informational messages. -+ * -+ * Furthermore, we must set params.handle to SHFL_HANDLE_NIL to -+ * make the shared folders host service use our mode parameter. -+ */ -+ params.handle = SHFL_HANDLE_NIL; -+ if (file->f_flags & O_CREAT) { -+ params.create_flags |= SHFL_CF_ACT_CREATE_IF_NEW; -+ /* -+ * We ignore O_EXCL, as the Linux kernel seems to call create -+ * beforehand itself, so O_EXCL should always fail. -+ */ -+ if (file->f_flags & O_TRUNC) -+ params.create_flags |= SHFL_CF_ACT_OVERWRITE_IF_EXISTS; -+ else -+ params.create_flags |= SHFL_CF_ACT_OPEN_IF_EXISTS; -+ } else { -+ params.create_flags |= SHFL_CF_ACT_FAIL_IF_NEW; -+ if (file->f_flags & O_TRUNC) -+ params.create_flags |= SHFL_CF_ACT_OVERWRITE_IF_EXISTS; -+ } -+ -+ switch (file->f_flags & O_ACCMODE) { -+ case O_RDONLY: -+ access_flags |= SHFL_CF_ACCESS_READ; -+ break; -+ -+ case O_WRONLY: -+ access_flags |= SHFL_CF_ACCESS_WRITE; -+ break; -+ -+ case O_RDWR: -+ access_flags |= SHFL_CF_ACCESS_READWRITE; -+ break; -+ -+ default: -+ WARN_ON(1); -+ } -+ -+ if (file->f_flags & O_APPEND) -+ access_flags |= SHFL_CF_ACCESS_APPEND; -+ -+ params.create_flags |= access_flags; -+ params.info.attr.mode = inode->i_mode; -+ -+ err = vboxsf_create_at_dentry(file_dentry(file), ¶ms); -+ if (err == 0 && params.handle == SHFL_HANDLE_NIL) -+ err = (params.result == SHFL_FILE_EXISTS) ? -EEXIST : -ENOENT; -+ if (err) { -+ kfree(sf_handle); -+ return err; -+ } -+ -+ /* the host may have given us different attr then requested */ -+ sf_i->force_restat = 1; -+ -+ /* init our handle struct and add it to the inode's handles list */ -+ sf_handle->handle = params.handle; -+ sf_handle->root = VBOXSF_SBI(inode->i_sb)->root; -+ sf_handle->access_flags = access_flags; -+ kref_init(&sf_handle->refcount); -+ -+ mutex_lock(&sf_i->handle_list_mutex); -+ list_add(&sf_handle->head, &sf_i->handle_list); -+ mutex_unlock(&sf_i->handle_list_mutex); -+ -+ file->private_data = sf_handle; -+ return 0; -+} -+ -+static void vboxsf_handle_release(struct kref *refcount) -+{ -+ struct vboxsf_handle *sf_handle = -+ container_of(refcount, struct vboxsf_handle, refcount); -+ -+ vboxsf_close(sf_handle->root, sf_handle->handle); -+ kfree(sf_handle); -+} -+ -+static int vboxsf_file_release(struct inode *inode, struct file *file) -+{ -+ struct vboxsf_inode *sf_i = VBOXSF_I(inode); -+ struct vboxsf_handle *sf_handle = file->private_data; -+ -+ /* -+ * When a file is closed on our (the guest) side, we want any subsequent -+ * accesses done on the host side to see all changes done from our side. -+ */ -+ filemap_write_and_wait(inode->i_mapping); -+ -+ mutex_lock(&sf_i->handle_list_mutex); -+ list_del(&sf_handle->head); -+ mutex_unlock(&sf_i->handle_list_mutex); -+ -+ kref_put(&sf_handle->refcount, vboxsf_handle_release); -+ return 0; -+} -+ -+/* -+ * Write back dirty pages now, because there may not be any suitable -+ * open files later -+ */ -+static void vboxsf_vma_close(struct vm_area_struct *vma) -+{ -+ filemap_write_and_wait(vma->vm_file->f_mapping); -+} -+ -+static const struct vm_operations_struct vboxsf_file_vm_ops = { -+ .close = vboxsf_vma_close, -+ .fault = filemap_fault, -+ .map_pages = filemap_map_pages, -+}; -+ -+static int vboxsf_file_mmap(struct file *file, struct vm_area_struct *vma) -+{ -+ int err; -+ -+ err = generic_file_mmap(file, vma); -+ if (!err) -+ vma->vm_ops = &vboxsf_file_vm_ops; -+ -+ return err; -+} -+ -+/* -+ * Note that since we are accessing files on the host's filesystem, files -+ * may always be changed underneath us by the host! -+ * -+ * The vboxsf API between the guest and the host does not offer any functions -+ * to deal with this. There is no inode-generation to check for changes, no -+ * events / callback on changes and no way to lock files. -+ * -+ * To avoid returning stale data when a file gets *opened* on our (the guest) -+ * side, we do a "stat" on the host side, then compare the mtime with the -+ * last known mtime and invalidate the page-cache if they differ. -+ * This is done from vboxsf_inode_revalidate(). -+ * -+ * When reads are done through the read_iter fop, it is possible to do -+ * further cache revalidation then, there are 3 options to deal with this: -+ * -+ * 1) Rely solely on the revalidation done at open time -+ * 2) Do another "stat" and compare mtime again. Unfortunately the vboxsf -+ * host API does not allow stat on handles, so we would need to use -+ * file->f_path.dentry and the stat will then fail if the file was unlinked -+ * or renamed (and there is no thing like NFS' silly-rename). So we get: -+ * 2a) "stat" and compare mtime, on stat failure invalidate the cache -+ * 2b) "stat" and compare mtime, on stat failure do nothing -+ * 3) Simply always call invalidate_inode_pages2_range on the range of the read -+ * -+ * Currently we are keeping things KISS and using option 1. this allows -+ * directly using generic_file_read_iter without wrapping it. -+ * -+ * This means that only data written on the host side before open() on -+ * the guest side is guaranteed to be seen by the guest. If necessary -+ * we may provide other read-cache strategies in the future and make this -+ * configurable through a mount option. -+ */ -+const struct file_operations vboxsf_reg_fops = { -+ .llseek = generic_file_llseek, -+ .read_iter = generic_file_read_iter, -+ .write_iter = generic_file_write_iter, -+ .mmap = vboxsf_file_mmap, -+ .open = vboxsf_file_open, -+ .release = vboxsf_file_release, -+ .fsync = noop_fsync, -+ .splice_read = generic_file_splice_read, -+}; -+ -+const struct inode_operations vboxsf_reg_iops = { -+ .getattr = vboxsf_getattr, -+ .setattr = vboxsf_setattr -+}; -+ -+static int vboxsf_readpage(struct file *file, struct page *page) -+{ -+ struct vboxsf_handle *sf_handle = file->private_data; -+ loff_t off = page_offset(page); -+ u32 nread = PAGE_SIZE; -+ u8 *buf; -+ int err; -+ -+ buf = kmap(page); -+ -+ err = vboxsf_read(sf_handle->root, sf_handle->handle, off, &nread, buf); -+ if (err == 0) { -+ memset(&buf[nread], 0, PAGE_SIZE - nread); -+ flush_dcache_page(page); -+ SetPageUptodate(page); -+ } else { -+ SetPageError(page); -+ } -+ -+ kunmap(page); -+ unlock_page(page); -+ return err; -+} -+ -+static struct vboxsf_handle *vboxsf_get_write_handle(struct vboxsf_inode *sf_i) -+{ -+ struct vboxsf_handle *h, *sf_handle = NULL; -+ -+ mutex_lock(&sf_i->handle_list_mutex); -+ list_for_each_entry(h, &sf_i->handle_list, head) { -+ if (h->access_flags == SHFL_CF_ACCESS_WRITE || -+ h->access_flags == SHFL_CF_ACCESS_READWRITE) { -+ kref_get(&h->refcount); -+ sf_handle = h; -+ break; -+ } -+ } -+ mutex_unlock(&sf_i->handle_list_mutex); -+ -+ return sf_handle; -+} -+ -+static int vboxsf_writepage(struct page *page, struct writeback_control *wbc) -+{ -+ struct inode *inode = page->mapping->host; -+ struct vboxsf_inode *sf_i = VBOXSF_I(inode); -+ struct vboxsf_handle *sf_handle; -+ loff_t off = page_offset(page); -+ loff_t size = i_size_read(inode); -+ u32 nwrite = PAGE_SIZE; -+ u8 *buf; -+ int err; -+ -+ if (off + PAGE_SIZE > size) -+ nwrite = size & ~PAGE_MASK; -+ -+ sf_handle = vboxsf_get_write_handle(sf_i); -+ if (!sf_handle) -+ return -EBADF; -+ -+ buf = kmap(page); -+ err = vboxsf_write(sf_handle->root, sf_handle->handle, -+ off, &nwrite, buf); -+ kunmap(page); -+ -+ kref_put(&sf_handle->refcount, vboxsf_handle_release); -+ -+ if (err == 0) { -+ ClearPageError(page); -+ /* mtime changed */ -+ sf_i->force_restat = 1; -+ } else { -+ ClearPageUptodate(page); -+ } -+ -+ unlock_page(page); -+ return err; -+} -+ -+static int vboxsf_write_end(struct file *file, struct address_space *mapping, -+ loff_t pos, unsigned int len, unsigned int copied, -+ struct page *page, void *fsdata) -+{ -+ struct inode *inode = mapping->host; -+ struct vboxsf_handle *sf_handle = file->private_data; -+ unsigned int from = pos & ~PAGE_MASK; -+ u32 nwritten = len; -+ u8 *buf; -+ int err; -+ -+ buf = kmap(page); -+ err = vboxsf_write(sf_handle->root, sf_handle->handle, -+ pos, &nwritten, buf + from); -+ kunmap(page); -+ -+ if (err) { -+ nwritten = 0; -+ goto out; -+ } -+ -+ /* mtime changed */ -+ VBOXSF_I(inode)->force_restat = 1; -+ -+ if (!PageUptodate(page) && nwritten == PAGE_SIZE) -+ SetPageUptodate(page); -+ -+ pos += nwritten; -+ if (pos > inode->i_size) -+ i_size_write(inode, pos); -+ -+out: -+ unlock_page(page); -+ put_page(page); -+ -+ return nwritten; -+} -+ -+const struct address_space_operations vboxsf_reg_aops = { -+ .readpage = vboxsf_readpage, -+ .writepage = vboxsf_writepage, -+ .set_page_dirty = __set_page_dirty_nobuffers, -+ .write_begin = simple_write_begin, -+ .write_end = vboxsf_write_end, -+}; -+ -+static const char *vboxsf_get_link(struct dentry *dentry, struct inode *inode, -+ struct delayed_call *done) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(inode->i_sb); -+ struct shfl_string *path; -+ char *link; -+ int err; -+ -+ if (!dentry) -+ return ERR_PTR(-ECHILD); -+ -+ path = vboxsf_path_from_dentry(sbi, dentry); -+ if (IS_ERR(path)) -+ return (char *)path; -+ -+ link = kzalloc(PATH_MAX, GFP_KERNEL); -+ if (!link) { -+ __putname(path); -+ return ERR_PTR(-ENOMEM); -+ } -+ -+ err = vboxsf_readlink(sbi->root, path, PATH_MAX, link); -+ __putname(path); -+ if (err) { -+ kfree(link); -+ return ERR_PTR(err); -+ } -+ -+ set_delayed_call(done, kfree_link, link); -+ return link; -+} -+ -+const struct inode_operations vboxsf_lnk_iops = { -+ .get_link = vboxsf_get_link -+}; -diff --git a/drivers/staging/vboxsf/shfl_hostintf.h b/drivers/staging/vboxsf/shfl_hostintf.h -new file mode 100644 -index 000000000000..aca829062c12 ---- /dev/null -+++ b/drivers/staging/vboxsf/shfl_hostintf.h -@@ -0,0 +1,901 @@ -+/* SPDX-License-Identifier: MIT */ -+/* -+ * VirtualBox Shared Folders: host interface definition. -+ * -+ * Copyright (C) 2006-2018 Oracle Corporation -+ */ -+ -+#ifndef SHFL_HOSTINTF_H -+#define SHFL_HOSTINTF_H -+ -+#include -+ -+/* The max in/out buffer size for a FN_READ or FN_WRITE call */ -+#define SHFL_MAX_RW_COUNT (16 * SZ_1M) -+ -+/* -+ * Structures shared between guest and the service -+ * can be relocated and use offsets to point to variable -+ * length parts. -+ * -+ * Shared folders protocol works with handles. -+ * Before doing any action on a file system object, -+ * one have to obtain the object handle via a SHFL_FN_CREATE -+ * request. A handle must be closed with SHFL_FN_CLOSE. -+ */ -+ -+enum { -+ SHFL_FN_QUERY_MAPPINGS = 1, /* Query mappings changes. */ -+ SHFL_FN_QUERY_MAP_NAME = 2, /* Query map name. */ -+ SHFL_FN_CREATE = 3, /* Open/create object. */ -+ SHFL_FN_CLOSE = 4, /* Close object handle. */ -+ SHFL_FN_READ = 5, /* Read object content. */ -+ SHFL_FN_WRITE = 6, /* Write new object content. */ -+ SHFL_FN_LOCK = 7, /* Lock/unlock a range in the object. */ -+ SHFL_FN_LIST = 8, /* List object content. */ -+ SHFL_FN_INFORMATION = 9, /* Query/set object information. */ -+ /* Note function number 10 is not used! */ -+ SHFL_FN_REMOVE = 11, /* Remove object */ -+ SHFL_FN_MAP_FOLDER_OLD = 12, /* Map folder (legacy) */ -+ SHFL_FN_UNMAP_FOLDER = 13, /* Unmap folder */ -+ SHFL_FN_RENAME = 14, /* Rename object */ -+ SHFL_FN_FLUSH = 15, /* Flush file */ -+ SHFL_FN_SET_UTF8 = 16, /* Select UTF8 filename encoding */ -+ SHFL_FN_MAP_FOLDER = 17, /* Map folder */ -+ SHFL_FN_READLINK = 18, /* Read symlink dest (as of VBox 4.0) */ -+ SHFL_FN_SYMLINK = 19, /* Create symlink (as of VBox 4.0) */ -+ SHFL_FN_SET_SYMLINKS = 20, /* Ask host to show symlinks (4.0+) */ -+}; -+ -+/* Root handles for a mapping are of type u32, Root handles are unique. */ -+#define SHFL_ROOT_NIL UINT_MAX -+ -+/* Shared folders handle for an opened object are of type u64. */ -+#define SHFL_HANDLE_NIL ULLONG_MAX -+ -+/* Hardcoded maximum length (in chars) of a shared folder name. */ -+#define SHFL_MAX_LEN (256) -+/* Hardcoded maximum number of shared folder mapping available to the guest. */ -+#define SHFL_MAX_MAPPINGS (64) -+ -+/** Shared folder string buffer structure. */ -+struct shfl_string { -+ /** Allocated size of the string member in bytes. */ -+ u16 size; -+ -+ /** Length of string without trailing nul in bytes. */ -+ u16 length; -+ -+ /** UTF-8 or UTF-16 string. Nul terminated. */ -+ union { -+ u8 utf8[2]; -+ u16 utf16[1]; -+ u16 ucs2[1]; /* misnomer, use utf16. */ -+ } string; -+}; -+VMMDEV_ASSERT_SIZE(shfl_string, 6); -+ -+/* The size of shfl_string w/o the string part. */ -+#define SHFLSTRING_HEADER_SIZE 4 -+ -+/* Calculate size of the string. */ -+static inline u32 shfl_string_buf_size(const struct shfl_string *string) -+{ -+ return string ? SHFLSTRING_HEADER_SIZE + string->size : 0; -+} -+ -+/* Set user id on execution (S_ISUID). */ -+#define SHFL_UNIX_ISUID 0004000U -+/* Set group id on execution (S_ISGID). */ -+#define SHFL_UNIX_ISGID 0002000U -+/* Sticky bit (S_ISVTX / S_ISTXT). */ -+#define SHFL_UNIX_ISTXT 0001000U -+ -+/* Owner readable (S_IRUSR). */ -+#define SHFL_UNIX_IRUSR 0000400U -+/* Owner writable (S_IWUSR). */ -+#define SHFL_UNIX_IWUSR 0000200U -+/* Owner executable (S_IXUSR). */ -+#define SHFL_UNIX_IXUSR 0000100U -+ -+/* Group readable (S_IRGRP). */ -+#define SHFL_UNIX_IRGRP 0000040U -+/* Group writable (S_IWGRP). */ -+#define SHFL_UNIX_IWGRP 0000020U -+/* Group executable (S_IXGRP). */ -+#define SHFL_UNIX_IXGRP 0000010U -+ -+/* Other readable (S_IROTH). */ -+#define SHFL_UNIX_IROTH 0000004U -+/* Other writable (S_IWOTH). */ -+#define SHFL_UNIX_IWOTH 0000002U -+/* Other executable (S_IXOTH). */ -+#define SHFL_UNIX_IXOTH 0000001U -+ -+/* Named pipe (fifo) (S_IFIFO). */ -+#define SHFL_TYPE_FIFO 0010000U -+/* Character device (S_IFCHR). */ -+#define SHFL_TYPE_DEV_CHAR 0020000U -+/* Directory (S_IFDIR). */ -+#define SHFL_TYPE_DIRECTORY 0040000U -+/* Block device (S_IFBLK). */ -+#define SHFL_TYPE_DEV_BLOCK 0060000U -+/* Regular file (S_IFREG). */ -+#define SHFL_TYPE_FILE 0100000U -+/* Symbolic link (S_IFLNK). */ -+#define SHFL_TYPE_SYMLINK 0120000U -+/* Socket (S_IFSOCK). */ -+#define SHFL_TYPE_SOCKET 0140000U -+/* Whiteout (S_IFWHT). */ -+#define SHFL_TYPE_WHITEOUT 0160000U -+/* Type mask (S_IFMT). */ -+#define SHFL_TYPE_MASK 0170000U -+ -+/* Checks the mode flags indicate a directory (S_ISDIR). */ -+#define SHFL_IS_DIRECTORY(m) (((m) & SHFL_TYPE_MASK) == SHFL_TYPE_DIRECTORY) -+/* Checks the mode flags indicate a symbolic link (S_ISLNK). */ -+#define SHFL_IS_SYMLINK(m) (((m) & SHFL_TYPE_MASK) == SHFL_TYPE_SYMLINK) -+ -+/** The available additional information in a shfl_fsobjattr object. */ -+enum shfl_fsobjattr_add { -+ /** No additional information is available / requested. */ -+ SHFLFSOBJATTRADD_NOTHING = 1, -+ /** -+ * The additional unix attributes (shfl_fsobjattr::u::unix_attr) are -+ * available / requested. -+ */ -+ SHFLFSOBJATTRADD_UNIX, -+ /** -+ * The additional extended attribute size (shfl_fsobjattr::u::size) is -+ * available / requested. -+ */ -+ SHFLFSOBJATTRADD_EASIZE, -+ /** -+ * The last valid item (inclusive). -+ * The valid range is SHFLFSOBJATTRADD_NOTHING thru -+ * SHFLFSOBJATTRADD_LAST. -+ */ -+ SHFLFSOBJATTRADD_LAST = SHFLFSOBJATTRADD_EASIZE, -+ -+ /** The usual 32-bit hack. */ -+ SHFLFSOBJATTRADD_32BIT_SIZE_HACK = 0x7fffffff -+}; -+ -+/** -+ * Additional unix Attributes, these are available when -+ * shfl_fsobjattr.additional == SHFLFSOBJATTRADD_UNIX. -+ */ -+struct shfl_fsobjattr_unix { -+ /** -+ * The user owning the filesystem object (st_uid). -+ * This field is ~0U if not supported. -+ */ -+ u32 uid; -+ -+ /** -+ * The group the filesystem object is assigned (st_gid). -+ * This field is ~0U if not supported. -+ */ -+ u32 gid; -+ -+ /** -+ * Number of hard links to this filesystem object (st_nlink). -+ * This field is 1 if the filesystem doesn't support hardlinking or -+ * the information isn't available. -+ */ -+ u32 hardlinks; -+ -+ /** -+ * The device number of the device which this filesystem object resides -+ * on (st_dev). This field is 0 if this information is not available. -+ */ -+ u32 inode_id_device; -+ -+ /** -+ * The unique identifier (within the filesystem) of this filesystem -+ * object (st_ino). Together with inode_id_device, this field can be -+ * used as a OS wide unique id, when both their values are not 0. -+ * This field is 0 if the information is not available. -+ */ -+ u64 inode_id; -+ -+ /** -+ * User flags (st_flags). -+ * This field is 0 if this information is not available. -+ */ -+ u32 flags; -+ -+ /** -+ * The current generation number (st_gen). -+ * This field is 0 if this information is not available. -+ */ -+ u32 generation_id; -+ -+ /** -+ * The device number of a char. or block device type object (st_rdev). -+ * This field is 0 if the file isn't a char. or block device or when -+ * the OS doesn't use the major+minor device idenfication scheme. -+ */ -+ u32 device; -+} __packed; -+ -+/** Extended attribute size. */ -+struct shfl_fsobjattr_easize { -+ /** Size of EAs. */ -+ s64 cb; -+} __packed; -+ -+/** Shared folder filesystem object attributes. */ -+struct shfl_fsobjattr { -+ /** Mode flags (st_mode). SHFL_UNIX_*, SHFL_TYPE_*, and SHFL_DOS_*. */ -+ u32 mode; -+ -+ /** The additional attributes available. */ -+ enum shfl_fsobjattr_add additional; -+ -+ /** -+ * Additional attributes. -+ * -+ * Unless explicitly specified to an API, the API can provide additional -+ * data as it is provided by the underlying OS. -+ */ -+ union { -+ struct shfl_fsobjattr_unix unix_attr; -+ struct shfl_fsobjattr_easize size; -+ } __packed u; -+} __packed; -+VMMDEV_ASSERT_SIZE(shfl_fsobjattr, 44); -+ -+struct shfl_timespec { -+ s64 ns_relative_to_unix_epoch; -+}; -+ -+/** Filesystem object information structure. */ -+struct shfl_fsobjinfo { -+ /** -+ * Logical size (st_size). -+ * For normal files this is the size of the file. -+ * For symbolic links, this is the length of the path name contained -+ * in the symbolic link. -+ * For other objects this fields needs to be specified. -+ */ -+ s64 size; -+ -+ /** Disk allocation size (st_blocks * DEV_BSIZE). */ -+ s64 allocated; -+ -+ /** Time of last access (st_atime). */ -+ struct shfl_timespec access_time; -+ -+ /** Time of last data modification (st_mtime). */ -+ struct shfl_timespec modification_time; -+ -+ /** -+ * Time of last status change (st_ctime). -+ * If not available this is set to modification_time. -+ */ -+ struct shfl_timespec change_time; -+ -+ /** -+ * Time of file birth (st_birthtime). -+ * If not available this is set to change_time. -+ */ -+ struct shfl_timespec birth_time; -+ -+ /** Attributes. */ -+ struct shfl_fsobjattr attr; -+ -+} __packed; -+VMMDEV_ASSERT_SIZE(shfl_fsobjinfo, 92); -+ -+/** -+ * result of an open/create request. -+ * Along with handle value the result code -+ * identifies what has happened while -+ * trying to open the object. -+ */ -+enum shfl_create_result { -+ SHFL_NO_RESULT, -+ /** Specified path does not exist. */ -+ SHFL_PATH_NOT_FOUND, -+ /** Path to file exists, but the last component does not. */ -+ SHFL_FILE_NOT_FOUND, -+ /** File already exists and either has been opened or not. */ -+ SHFL_FILE_EXISTS, -+ /** New file was created. */ -+ SHFL_FILE_CREATED, -+ /** Existing file was replaced or overwritten. */ -+ SHFL_FILE_REPLACED -+}; -+ -+/* No flags. Initialization value. */ -+#define SHFL_CF_NONE (0x00000000) -+ -+/* -+ * Only lookup the object, do not return a handle. When this is set all other -+ * flags are ignored. -+ */ -+#define SHFL_CF_LOOKUP (0x00000001) -+ -+/* -+ * Open parent directory of specified object. -+ * Useful for the corresponding Windows FSD flag -+ * and for opening paths like \\dir\\*.* to search the 'dir'. -+ */ -+#define SHFL_CF_OPEN_TARGET_DIRECTORY (0x00000002) -+ -+/* Create/open a directory. */ -+#define SHFL_CF_DIRECTORY (0x00000004) -+ -+/* -+ * Open/create action to do if object exists -+ * and if the object does not exists. -+ * REPLACE file means atomically DELETE and CREATE. -+ * OVERWRITE file means truncating the file to 0 and -+ * setting new size. -+ * When opening an existing directory REPLACE and OVERWRITE -+ * actions are considered invalid, and cause returning -+ * FILE_EXISTS with NIL handle. -+ */ -+#define SHFL_CF_ACT_MASK_IF_EXISTS (0x000000f0) -+#define SHFL_CF_ACT_MASK_IF_NEW (0x00000f00) -+ -+/* What to do if object exists. */ -+#define SHFL_CF_ACT_OPEN_IF_EXISTS (0x00000000) -+#define SHFL_CF_ACT_FAIL_IF_EXISTS (0x00000010) -+#define SHFL_CF_ACT_REPLACE_IF_EXISTS (0x00000020) -+#define SHFL_CF_ACT_OVERWRITE_IF_EXISTS (0x00000030) -+ -+/* What to do if object does not exist. */ -+#define SHFL_CF_ACT_CREATE_IF_NEW (0x00000000) -+#define SHFL_CF_ACT_FAIL_IF_NEW (0x00000100) -+ -+/* Read/write requested access for the object. */ -+#define SHFL_CF_ACCESS_MASK_RW (0x00003000) -+ -+/* No access requested. */ -+#define SHFL_CF_ACCESS_NONE (0x00000000) -+/* Read access requested. */ -+#define SHFL_CF_ACCESS_READ (0x00001000) -+/* Write access requested. */ -+#define SHFL_CF_ACCESS_WRITE (0x00002000) -+/* Read/Write access requested. */ -+#define SHFL_CF_ACCESS_READWRITE (0x00003000) -+ -+/* Requested share access for the object. */ -+#define SHFL_CF_ACCESS_MASK_DENY (0x0000c000) -+ -+/* Allow any access. */ -+#define SHFL_CF_ACCESS_DENYNONE (0x00000000) -+/* Do not allow read. */ -+#define SHFL_CF_ACCESS_DENYREAD (0x00004000) -+/* Do not allow write. */ -+#define SHFL_CF_ACCESS_DENYWRITE (0x00008000) -+/* Do not allow access. */ -+#define SHFL_CF_ACCESS_DENYALL (0x0000c000) -+ -+/* Requested access to attributes of the object. */ -+#define SHFL_CF_ACCESS_MASK_ATTR (0x00030000) -+ -+/* No access requested. */ -+#define SHFL_CF_ACCESS_ATTR_NONE (0x00000000) -+/* Read access requested. */ -+#define SHFL_CF_ACCESS_ATTR_READ (0x00010000) -+/* Write access requested. */ -+#define SHFL_CF_ACCESS_ATTR_WRITE (0x00020000) -+/* Read/Write access requested. */ -+#define SHFL_CF_ACCESS_ATTR_READWRITE (0x00030000) -+ -+/* -+ * The file is opened in append mode. -+ * Ignored if SHFL_CF_ACCESS_WRITE is not set. -+ */ -+#define SHFL_CF_ACCESS_APPEND (0x00040000) -+ -+/** Create parameters buffer struct for SHFL_FN_CREATE call */ -+struct shfl_createparms { -+ /** Returned handle of opened object. */ -+ u64 handle; -+ -+ /** Returned result of the operation */ -+ enum shfl_create_result result; -+ -+ /** SHFL_CF_* */ -+ u32 create_flags; -+ -+ /** -+ * Attributes of object to create and -+ * returned actual attributes of opened/created object. -+ */ -+ struct shfl_fsobjinfo info; -+} __packed; -+ -+/** Shared Folder directory information */ -+struct shfl_dirinfo { -+ /** Full information about the object. */ -+ struct shfl_fsobjinfo info; -+ /** -+ * The length of the short field (number of UTF16 chars). -+ * It is 16-bit for reasons of alignment. -+ */ -+ u16 short_name_len; -+ /** -+ * The short name for 8.3 compatibility. -+ * Empty string if not available. -+ */ -+ u16 short_name[14]; -+ struct shfl_string name; -+}; -+ -+/** Shared folder filesystem properties. */ -+struct shfl_fsproperties { -+ /** -+ * The maximum size of a filesystem object name. -+ * This does not include the '\\0'. -+ */ -+ u32 max_component_len; -+ -+ /** -+ * True if the filesystem is remote. -+ * False if the filesystem is local. -+ */ -+ bool remote; -+ -+ /** -+ * True if the filesystem is case sensitive. -+ * False if the filesystem is case insensitive. -+ */ -+ bool case_sensitive; -+ -+ /** -+ * True if the filesystem is mounted read only. -+ * False if the filesystem is mounted read write. -+ */ -+ bool read_only; -+ -+ /** -+ * True if the filesystem can encode unicode object names. -+ * False if it can't. -+ */ -+ bool supports_unicode; -+ -+ /** -+ * True if the filesystem is compresses. -+ * False if it isn't or we don't know. -+ */ -+ bool compressed; -+ -+ /** -+ * True if the filesystem compresses of individual files. -+ * False if it doesn't or we don't know. -+ */ -+ bool file_compression; -+}; -+VMMDEV_ASSERT_SIZE(shfl_fsproperties, 12); -+ -+struct shfl_volinfo { -+ s64 total_allocation_bytes; -+ s64 available_allocation_bytes; -+ u32 bytes_per_allocation_unit; -+ u32 bytes_per_sector; -+ u32 serial; -+ struct shfl_fsproperties properties; -+}; -+ -+ -+/** SHFL_FN_MAP_FOLDER Parameters structure. */ -+struct shfl_map_folder { -+ /** -+ * pointer, in: -+ * Points to struct shfl_string buffer. -+ */ -+ struct vmmdev_hgcm_function_parameter path; -+ -+ /** -+ * pointer, out: SHFLROOT (u32) -+ * Root handle of the mapping which name is queried. -+ */ -+ struct vmmdev_hgcm_function_parameter root; -+ -+ /** -+ * pointer, in: UTF16 -+ * Path delimiter -+ */ -+ struct vmmdev_hgcm_function_parameter delimiter; -+ -+ /** -+ * pointer, in: SHFLROOT (u32) -+ * Case senstive flag -+ */ -+ struct vmmdev_hgcm_function_parameter case_sensitive; -+ -+}; -+ -+/* Number of parameters */ -+#define SHFL_CPARMS_MAP_FOLDER (4) -+ -+ -+/** SHFL_FN_UNMAP_FOLDER Parameters structure. */ -+struct shfl_unmap_folder { -+ /** -+ * pointer, in: SHFLROOT (u32) -+ * Root handle of the mapping which name is queried. -+ */ -+ struct vmmdev_hgcm_function_parameter root; -+ -+}; -+ -+/* Number of parameters */ -+#define SHFL_CPARMS_UNMAP_FOLDER (1) -+ -+ -+/** SHFL_FN_CREATE Parameters structure. */ -+struct shfl_create { -+ /** -+ * pointer, in: SHFLROOT (u32) -+ * Root handle of the mapping which name is queried. -+ */ -+ struct vmmdev_hgcm_function_parameter root; -+ -+ /** -+ * pointer, in: -+ * Points to struct shfl_string buffer. -+ */ -+ struct vmmdev_hgcm_function_parameter path; -+ -+ /** -+ * pointer, in/out: -+ * Points to struct shfl_createparms buffer. -+ */ -+ struct vmmdev_hgcm_function_parameter parms; -+ -+}; -+ -+/* Number of parameters */ -+#define SHFL_CPARMS_CREATE (3) -+ -+ -+/** SHFL_FN_CLOSE Parameters structure. */ -+struct shfl_close { -+ /** -+ * pointer, in: SHFLROOT (u32) -+ * Root handle of the mapping which name is queried. -+ */ -+ struct vmmdev_hgcm_function_parameter root; -+ -+ /** -+ * value64, in: -+ * SHFLHANDLE (u64) of object to close. -+ */ -+ struct vmmdev_hgcm_function_parameter handle; -+ -+}; -+ -+/* Number of parameters */ -+#define SHFL_CPARMS_CLOSE (2) -+ -+ -+/** SHFL_FN_READ Parameters structure. */ -+struct shfl_read { -+ /** -+ * pointer, in: SHFLROOT (u32) -+ * Root handle of the mapping which name is queried. -+ */ -+ struct vmmdev_hgcm_function_parameter root; -+ -+ /** -+ * value64, in: -+ * SHFLHANDLE (u64) of object to read from. -+ */ -+ struct vmmdev_hgcm_function_parameter handle; -+ -+ /** -+ * value64, in: -+ * Offset to read from. -+ */ -+ struct vmmdev_hgcm_function_parameter offset; -+ -+ /** -+ * value64, in/out: -+ * Bytes to read/How many were read. -+ */ -+ struct vmmdev_hgcm_function_parameter cb; -+ -+ /** -+ * pointer, out: -+ * Buffer to place data to. -+ */ -+ struct vmmdev_hgcm_function_parameter buffer; -+ -+}; -+ -+/* Number of parameters */ -+#define SHFL_CPARMS_READ (5) -+ -+ -+/** SHFL_FN_WRITE Parameters structure. */ -+struct shfl_write { -+ /** -+ * pointer, in: SHFLROOT (u32) -+ * Root handle of the mapping which name is queried. -+ */ -+ struct vmmdev_hgcm_function_parameter root; -+ -+ /** -+ * value64, in: -+ * SHFLHANDLE (u64) of object to write to. -+ */ -+ struct vmmdev_hgcm_function_parameter handle; -+ -+ /** -+ * value64, in: -+ * Offset to write to. -+ */ -+ struct vmmdev_hgcm_function_parameter offset; -+ -+ /** -+ * value64, in/out: -+ * Bytes to write/How many were written. -+ */ -+ struct vmmdev_hgcm_function_parameter cb; -+ -+ /** -+ * pointer, in: -+ * Data to write. -+ */ -+ struct vmmdev_hgcm_function_parameter buffer; -+ -+}; -+ -+/* Number of parameters */ -+#define SHFL_CPARMS_WRITE (5) -+ -+ -+/* -+ * SHFL_FN_LIST -+ * Listing information includes variable length RTDIRENTRY[EX] structures. -+ */ -+ -+#define SHFL_LIST_NONE 0 -+#define SHFL_LIST_RETURN_ONE 1 -+ -+/** SHFL_FN_LIST Parameters structure. */ -+struct shfl_list { -+ /** -+ * pointer, in: SHFLROOT (u32) -+ * Root handle of the mapping which name is queried. -+ */ -+ struct vmmdev_hgcm_function_parameter root; -+ -+ /** -+ * value64, in: -+ * SHFLHANDLE (u64) of object to be listed. -+ */ -+ struct vmmdev_hgcm_function_parameter handle; -+ -+ /** -+ * value32, in: -+ * List flags SHFL_LIST_*. -+ */ -+ struct vmmdev_hgcm_function_parameter flags; -+ -+ /** -+ * value32, in/out: -+ * Bytes to be used for listing information/How many bytes were used. -+ */ -+ struct vmmdev_hgcm_function_parameter cb; -+ -+ /** -+ * pointer, in/optional -+ * Points to struct shfl_string buffer that specifies a search path. -+ */ -+ struct vmmdev_hgcm_function_parameter path; -+ -+ /** -+ * pointer, out: -+ * Buffer to place listing information to. (struct shfl_dirinfo) -+ */ -+ struct vmmdev_hgcm_function_parameter buffer; -+ -+ /** -+ * value32, in/out: -+ * Indicates a key where the listing must be resumed. -+ * in: 0 means start from begin of object. -+ * out: 0 means listing completed. -+ */ -+ struct vmmdev_hgcm_function_parameter resume_point; -+ -+ /** -+ * pointer, out: -+ * Number of files returned -+ */ -+ struct vmmdev_hgcm_function_parameter file_count; -+}; -+ -+/* Number of parameters */ -+#define SHFL_CPARMS_LIST (8) -+ -+ -+/** SHFL_FN_READLINK Parameters structure. */ -+struct shfl_readLink { -+ /** -+ * pointer, in: SHFLROOT (u32) -+ * Root handle of the mapping which name is queried. -+ */ -+ struct vmmdev_hgcm_function_parameter root; -+ -+ /** -+ * pointer, in: -+ * Points to struct shfl_string buffer. -+ */ -+ struct vmmdev_hgcm_function_parameter path; -+ -+ /** -+ * pointer, out: -+ * Buffer to place data to. -+ */ -+ struct vmmdev_hgcm_function_parameter buffer; -+ -+}; -+ -+/* Number of parameters */ -+#define SHFL_CPARMS_READLINK (3) -+ -+ -+/* SHFL_FN_INFORMATION */ -+ -+/* Mask of Set/Get bit. */ -+#define SHFL_INFO_MODE_MASK (0x1) -+/* Get information */ -+#define SHFL_INFO_GET (0x0) -+/* Set information */ -+#define SHFL_INFO_SET (0x1) -+ -+/* Get name of the object. */ -+#define SHFL_INFO_NAME (0x2) -+/* Set size of object (extend/trucate); only applies to file objects */ -+#define SHFL_INFO_SIZE (0x4) -+/* Get/Set file object info. */ -+#define SHFL_INFO_FILE (0x8) -+/* Get volume information. */ -+#define SHFL_INFO_VOLUME (0x10) -+ -+/** SHFL_FN_INFORMATION Parameters structure. */ -+struct shfl_information { -+ /** -+ * pointer, in: SHFLROOT (u32) -+ * Root handle of the mapping which name is queried. -+ */ -+ struct vmmdev_hgcm_function_parameter root; -+ -+ /** -+ * value64, in: -+ * SHFLHANDLE (u64) of object to be listed. -+ */ -+ struct vmmdev_hgcm_function_parameter handle; -+ -+ /** -+ * value32, in: -+ * SHFL_INFO_* -+ */ -+ struct vmmdev_hgcm_function_parameter flags; -+ -+ /** -+ * value32, in/out: -+ * Bytes to be used for information/How many bytes were used. -+ */ -+ struct vmmdev_hgcm_function_parameter cb; -+ -+ /** -+ * pointer, in/out: -+ * Information to be set/get (shfl_fsobjinfo or shfl_string). Do not -+ * forget to set the shfl_fsobjinfo::attr::additional for a get -+ * operation as well. -+ */ -+ struct vmmdev_hgcm_function_parameter info; -+ -+}; -+ -+/* Number of parameters */ -+#define SHFL_CPARMS_INFORMATION (5) -+ -+ -+/* SHFL_FN_REMOVE */ -+ -+#define SHFL_REMOVE_FILE (0x1) -+#define SHFL_REMOVE_DIR (0x2) -+#define SHFL_REMOVE_SYMLINK (0x4) -+ -+/** SHFL_FN_REMOVE Parameters structure. */ -+struct shfl_remove { -+ /** -+ * pointer, in: SHFLROOT (u32) -+ * Root handle of the mapping which name is queried. -+ */ -+ struct vmmdev_hgcm_function_parameter root; -+ -+ /** -+ * pointer, in: -+ * Points to struct shfl_string buffer. -+ */ -+ struct vmmdev_hgcm_function_parameter path; -+ -+ /** -+ * value32, in: -+ * remove flags (file/directory) -+ */ -+ struct vmmdev_hgcm_function_parameter flags; -+ -+}; -+ -+#define SHFL_CPARMS_REMOVE (3) -+ -+ -+/* SHFL_FN_RENAME */ -+ -+#define SHFL_RENAME_FILE (0x1) -+#define SHFL_RENAME_DIR (0x2) -+#define SHFL_RENAME_REPLACE_IF_EXISTS (0x4) -+ -+/** SHFL_FN_RENAME Parameters structure. */ -+struct shfl_rename { -+ /** -+ * pointer, in: SHFLROOT (u32) -+ * Root handle of the mapping which name is queried. -+ */ -+ struct vmmdev_hgcm_function_parameter root; -+ -+ /** -+ * pointer, in: -+ * Points to struct shfl_string src. -+ */ -+ struct vmmdev_hgcm_function_parameter src; -+ -+ /** -+ * pointer, in: -+ * Points to struct shfl_string dest. -+ */ -+ struct vmmdev_hgcm_function_parameter dest; -+ -+ /** -+ * value32, in: -+ * rename flags (file/directory) -+ */ -+ struct vmmdev_hgcm_function_parameter flags; -+ -+}; -+ -+#define SHFL_CPARMS_RENAME (4) -+ -+ -+/** SHFL_FN_SYMLINK Parameters structure. */ -+struct shfl_symlink { -+ /** -+ * pointer, in: SHFLROOT (u32) -+ * Root handle of the mapping which name is queried. -+ */ -+ struct vmmdev_hgcm_function_parameter root; -+ -+ /** -+ * pointer, in: -+ * Points to struct shfl_string of path for the new symlink. -+ */ -+ struct vmmdev_hgcm_function_parameter new_path; -+ -+ /** -+ * pointer, in: -+ * Points to struct shfl_string of destination for symlink. -+ */ -+ struct vmmdev_hgcm_function_parameter old_path; -+ -+ /** -+ * pointer, out: -+ * Information about created symlink. -+ */ -+ struct vmmdev_hgcm_function_parameter info; -+ -+}; -+ -+#define SHFL_CPARMS_SYMLINK (4) -+ -+#endif -diff --git a/drivers/staging/vboxsf/super.c b/drivers/staging/vboxsf/super.c -new file mode 100644 -index 000000000000..3913ffafa83b ---- /dev/null -+++ b/drivers/staging/vboxsf/super.c -@@ -0,0 +1,499 @@ -+// SPDX-License-Identifier: MIT -+/* -+ * VirtualBox Guest Shared Folders support: Virtual File System. -+ * -+ * Module initialization/finalization -+ * File system registration/deregistration -+ * Superblock reading -+ * Few utility functions -+ * -+ * Copyright (C) 2006-2018 Oracle Corporation -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include "vfsmod.h" -+ -+#define VBOXSF_SUPER_MAGIC 0x786f4256 /* 'VBox' little endian */ -+ -+#define VBSF_MOUNT_SIGNATURE_BYTE_0 ('\000') -+#define VBSF_MOUNT_SIGNATURE_BYTE_1 ('\377') -+#define VBSF_MOUNT_SIGNATURE_BYTE_2 ('\376') -+#define VBSF_MOUNT_SIGNATURE_BYTE_3 ('\375') -+ -+static int follow_symlinks; -+module_param(follow_symlinks, int, 0444); -+MODULE_PARM_DESC(follow_symlinks, -+ "Let host resolve symlinks rather than showing them"); -+ -+static DEFINE_IDA(vboxsf_bdi_ida); -+static DEFINE_MUTEX(vboxsf_setup_mutex); -+static bool vboxsf_setup_done; -+static struct super_operations vboxsf_super_ops; /* forward declaration */ -+static struct kmem_cache *vboxsf_inode_cachep; -+ -+static char * const vboxsf_default_nls = CONFIG_NLS_DEFAULT; -+ -+enum { opt_nls, opt_uid, opt_gid, opt_ttl, opt_dmode, opt_fmode, -+ opt_dmask, opt_fmask }; -+ -+static const struct fs_parameter_spec vboxsf_param_specs[] = { -+ fsparam_string ("nls", opt_nls), -+ fsparam_u32 ("uid", opt_uid), -+ fsparam_u32 ("gid", opt_gid), -+ fsparam_u32 ("ttl", opt_ttl), -+ fsparam_u32oct ("dmode", opt_dmode), -+ fsparam_u32oct ("fmode", opt_fmode), -+ fsparam_u32oct ("dmask", opt_dmask), -+ fsparam_u32oct ("fmask", opt_fmask), -+ {} -+}; -+ -+static const struct fs_parameter_description vboxsf_fs_parameters = { -+ .name = "vboxsf", -+ .specs = vboxsf_param_specs, -+}; -+ -+static int vboxsf_parse_param(struct fs_context *fc, struct fs_parameter *param) -+{ -+ struct vboxsf_fs_context *ctx = fc->fs_private; -+ struct fs_parse_result result; -+ kuid_t uid; -+ kgid_t gid; -+ int opt; -+ -+ opt = fs_parse(fc, &vboxsf_fs_parameters, param, &result); -+ if (opt < 0) -+ return opt; -+ -+ switch (opt) { -+ case opt_nls: -+ if (fc->purpose != FS_CONTEXT_FOR_MOUNT) { -+ vbg_err("vboxsf: Cannot reconfigure nls option\n"); -+ return -EINVAL; -+ } -+ ctx->nls_name = param->string; -+ param->string = NULL; -+ break; -+ case opt_uid: -+ uid = make_kuid(current_user_ns(), result.uint_32); -+ if (!uid_valid(uid)) -+ return -EINVAL; -+ ctx->o.uid = uid; -+ break; -+ case opt_gid: -+ gid = make_kgid(current_user_ns(), result.uint_32); -+ if (!gid_valid(gid)) -+ return -EINVAL; -+ ctx->o.gid = gid; -+ break; -+ case opt_ttl: -+ ctx->o.ttl = msecs_to_jiffies(result.uint_32); -+ break; -+ case opt_dmode: -+ if (result.uint_32 & ~0777) -+ return -EINVAL; -+ ctx->o.dmode = result.uint_32; -+ ctx->o.dmode_set = true; -+ break; -+ case opt_fmode: -+ if (result.uint_32 & ~0777) -+ return -EINVAL; -+ ctx->o.fmode = result.uint_32; -+ ctx->o.fmode_set = true; -+ break; -+ case opt_dmask: -+ if (result.uint_32 & ~07777) -+ return -EINVAL; -+ ctx->o.dmask = result.uint_32; -+ break; -+ case opt_fmask: -+ if (result.uint_32 & ~07777) -+ return -EINVAL; -+ ctx->o.fmask = result.uint_32; -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ return 0; -+} -+ -+static int vboxsf_fill_super(struct super_block *sb, struct fs_context *fc) -+{ -+ struct vboxsf_fs_context *ctx = fc->fs_private; -+ struct shfl_string *folder_name, root_path; -+ struct vboxsf_sbi *sbi; -+ struct dentry *droot; -+ struct inode *iroot; -+ char *nls_name; -+ size_t size; -+ int err; -+ -+ if (!fc->source) -+ return -EINVAL; -+ -+ sbi = kzalloc(sizeof(*sbi), GFP_KERNEL); -+ if (!sbi) -+ return -ENOMEM; -+ -+ sbi->o = ctx->o; -+ idr_init(&sbi->ino_idr); -+ spin_lock_init(&sbi->ino_idr_lock); -+ sbi->next_generation = 1; -+ sbi->bdi_id = -1; -+ -+ /* Load nls if not utf8 */ -+ nls_name = ctx->nls_name ? ctx->nls_name : vboxsf_default_nls; -+ if (strcmp(nls_name, "utf8") != 0) { -+ if (nls_name == vboxsf_default_nls) -+ sbi->nls = load_nls_default(); -+ else -+ sbi->nls = load_nls(nls_name); -+ -+ if (!sbi->nls) { -+ vbg_err("vboxsf: Count not load '%s' nls\n", nls_name); -+ err = -EINVAL; -+ goto fail_free; -+ } -+ } -+ -+ sbi->bdi_id = ida_simple_get(&vboxsf_bdi_ida, 0, 0, GFP_KERNEL); -+ if (sbi->bdi_id < 0) { -+ err = sbi->bdi_id; -+ goto fail_free; -+ } -+ -+ err = super_setup_bdi_name(sb, "vboxsf-%s.%d", fc->source, sbi->bdi_id); -+ if (err) -+ goto fail_free; -+ -+ /* Turn source into a shfl_string and map the folder */ -+ size = strlen(fc->source) + 1; -+ folder_name = kmalloc(SHFLSTRING_HEADER_SIZE + size, GFP_KERNEL); -+ if (!folder_name) -+ goto fail_free; -+ folder_name->size = size; -+ folder_name->length = size - 1; -+ strlcpy(folder_name->string.utf8, fc->source, size); -+ err = vboxsf_map_folder(folder_name, &sbi->root); -+ kfree(folder_name); -+ if (err) { -+ vbg_err("vboxsf: Host rejected mount of '%s' with error %d\n", -+ fc->source, err); -+ goto fail_free; -+ } -+ -+ root_path.length = 1; -+ root_path.size = 2; -+ root_path.string.utf8[0] = '/'; -+ root_path.string.utf8[1] = 0; -+ err = vboxsf_stat(sbi, &root_path, &sbi->root_info); -+ if (err) -+ goto fail_unmap; -+ -+ sb->s_magic = VBOXSF_SUPER_MAGIC; -+ sb->s_blocksize = 1024; -+ sb->s_maxbytes = MAX_LFS_FILESIZE; -+ sb->s_op = &vboxsf_super_ops; -+ sb->s_d_op = &vboxsf_dentry_ops; -+ -+ iroot = iget_locked(sb, 0); -+ if (!iroot) { -+ err = -ENOMEM; -+ goto fail_unmap; -+ } -+ vboxsf_init_inode(sbi, iroot, &sbi->root_info); -+ unlock_new_inode(iroot); -+ -+ droot = d_make_root(iroot); -+ if (!droot) { -+ err = -ENOMEM; -+ goto fail_unmap; -+ } -+ -+ sb->s_root = droot; -+ sb->s_fs_info = sbi; -+ return 0; -+ -+fail_unmap: -+ vboxsf_unmap_folder(sbi->root); -+fail_free: -+ if (sbi->bdi_id >= 0) -+ ida_simple_remove(&vboxsf_bdi_ida, sbi->bdi_id); -+ if (sbi->nls) -+ unload_nls(sbi->nls); -+ idr_destroy(&sbi->ino_idr); -+ kfree(sbi); -+ return err; -+} -+ -+static void vboxsf_inode_init_once(void *data) -+{ -+ struct vboxsf_inode *sf_i = data; -+ -+ mutex_init(&sf_i->handle_list_mutex); -+ inode_init_once(&sf_i->vfs_inode); -+} -+ -+static struct inode *vboxsf_alloc_inode(struct super_block *sb) -+{ -+ struct vboxsf_inode *sf_i; -+ -+ sf_i = kmem_cache_alloc(vboxsf_inode_cachep, GFP_NOFS); -+ if (!sf_i) -+ return NULL; -+ -+ sf_i->force_restat = 0; -+ INIT_LIST_HEAD(&sf_i->handle_list); -+ -+ return &sf_i->vfs_inode; -+} -+ -+static void vboxsf_free_inode(struct inode *inode) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(inode->i_sb); -+ unsigned long flags; -+ -+ spin_lock_irqsave(&sbi->ino_idr_lock, flags); -+ idr_remove(&sbi->ino_idr, inode->i_ino); -+ spin_unlock_irqrestore(&sbi->ino_idr_lock, flags); -+ kmem_cache_free(vboxsf_inode_cachep, VBOXSF_I(inode)); -+} -+ -+static void vboxsf_put_super(struct super_block *sb) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(sb); -+ -+ vboxsf_unmap_folder(sbi->root); -+ if (sbi->bdi_id >= 0) -+ ida_simple_remove(&vboxsf_bdi_ida, sbi->bdi_id); -+ if (sbi->nls) -+ unload_nls(sbi->nls); -+ -+ /* -+ * vboxsf_free_inode uses the idr, make sure all delayed rcu free -+ * inodes are flushed. -+ */ -+ rcu_barrier(); -+ idr_destroy(&sbi->ino_idr); -+ kfree(sbi); -+} -+ -+static int vboxsf_statfs(struct dentry *dentry, struct kstatfs *stat) -+{ -+ struct super_block *sb = dentry->d_sb; -+ struct shfl_volinfo shfl_volinfo; -+ struct vboxsf_sbi *sbi; -+ u32 buf_len; -+ int err; -+ -+ sbi = VBOXSF_SBI(sb); -+ buf_len = sizeof(shfl_volinfo); -+ err = vboxsf_fsinfo(sbi->root, 0, SHFL_INFO_GET | SHFL_INFO_VOLUME, -+ &buf_len, &shfl_volinfo); -+ if (err) -+ return err; -+ -+ stat->f_type = VBOXSF_SUPER_MAGIC; -+ stat->f_bsize = shfl_volinfo.bytes_per_allocation_unit; -+ -+ do_div(shfl_volinfo.total_allocation_bytes, -+ shfl_volinfo.bytes_per_allocation_unit); -+ stat->f_blocks = shfl_volinfo.total_allocation_bytes; -+ -+ do_div(shfl_volinfo.available_allocation_bytes, -+ shfl_volinfo.bytes_per_allocation_unit); -+ stat->f_bfree = shfl_volinfo.available_allocation_bytes; -+ stat->f_bavail = shfl_volinfo.available_allocation_bytes; -+ -+ stat->f_files = 1000; -+ /* -+ * Don't return 0 here since the guest may then think that it is not -+ * possible to create any more files. -+ */ -+ stat->f_ffree = 1000000; -+ stat->f_fsid.val[0] = 0; -+ stat->f_fsid.val[1] = 0; -+ stat->f_namelen = 255; -+ return 0; -+} -+ -+static struct super_operations vboxsf_super_ops = { -+ .alloc_inode = vboxsf_alloc_inode, -+ .free_inode = vboxsf_free_inode, -+ .put_super = vboxsf_put_super, -+ .statfs = vboxsf_statfs, -+}; -+ -+static int vboxsf_setup(void) -+{ -+ int err; -+ -+ mutex_lock(&vboxsf_setup_mutex); -+ -+ if (vboxsf_setup_done) -+ goto success; -+ -+ vboxsf_inode_cachep = -+ kmem_cache_create("vboxsf_inode_cache", -+ sizeof(struct vboxsf_inode), 0, -+ (SLAB_RECLAIM_ACCOUNT | SLAB_MEM_SPREAD | -+ SLAB_ACCOUNT), -+ vboxsf_inode_init_once); -+ if (!vboxsf_inode_cachep) { -+ err = -ENOMEM; -+ goto fail_nomem; -+ } -+ -+ err = vboxsf_connect(); -+ if (err) { -+ vbg_err("vboxsf: err %d connecting to guest PCI-device\n", err); -+ vbg_err("vboxsf: make sure you are inside a VirtualBox VM\n"); -+ vbg_err("vboxsf: and check dmesg for vboxguest errors\n"); -+ goto fail_free_cache; -+ } -+ -+ err = vboxsf_set_utf8(); -+ if (err) { -+ vbg_err("vboxsf_setutf8 error %d\n", err); -+ goto fail_disconnect; -+ } -+ -+ if (!follow_symlinks) { -+ err = vboxsf_set_symlinks(); -+ if (err) -+ vbg_warn("vboxsf: Unable to show symlinks: %d\n", err); -+ } -+ -+ vboxsf_setup_done = true; -+success: -+ mutex_unlock(&vboxsf_setup_mutex); -+ return 0; -+ -+fail_disconnect: -+ vboxsf_disconnect(); -+fail_free_cache: -+ kmem_cache_destroy(vboxsf_inode_cachep); -+fail_nomem: -+ mutex_unlock(&vboxsf_setup_mutex); -+ return err; -+} -+ -+static int vboxsf_parse_monolithic(struct fs_context *fc, void *data) -+{ -+ char *options = data; -+ -+ if (options && options[0] == VBSF_MOUNT_SIGNATURE_BYTE_0 && -+ options[1] == VBSF_MOUNT_SIGNATURE_BYTE_1 && -+ options[2] == VBSF_MOUNT_SIGNATURE_BYTE_2 && -+ options[3] == VBSF_MOUNT_SIGNATURE_BYTE_3) { -+ vbg_err("vboxsf: Old binary mount data not supported, remove obsolete mount.vboxsf and/or update your VBoxService.\n"); -+ return -EINVAL; -+ } -+ -+ return generic_parse_monolithic(fc, data); -+} -+ -+static int vboxsf_get_tree(struct fs_context *fc) -+{ -+ int err; -+ -+ err = vboxsf_setup(); -+ if (err) -+ return err; -+ -+ return vfs_get_super(fc, vfs_get_independent_super, vboxsf_fill_super); -+} -+ -+static int vboxsf_reconfigure(struct fs_context *fc) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(fc->root->d_sb); -+ struct vboxsf_fs_context *ctx = fc->fs_private; -+ struct inode *iroot; -+ -+ iroot = ilookup(fc->root->d_sb, 0); -+ if (!iroot) -+ return -ENOENT; -+ -+ /* Apply changed options to the root inode */ -+ sbi->o = ctx->o; -+ vboxsf_init_inode(sbi, iroot, &sbi->root_info); -+ -+ return 0; -+} -+ -+static void vboxsf_free_fc(struct fs_context *fc) -+{ -+ struct vboxsf_fs_context *ctx = fc->fs_private; -+ -+ kfree(ctx->nls_name); -+ kfree(ctx); -+} -+ -+static const struct fs_context_operations vboxsf_context_ops = { -+ .free = vboxsf_free_fc, -+ .parse_param = vboxsf_parse_param, -+ .parse_monolithic = vboxsf_parse_monolithic, -+ .get_tree = vboxsf_get_tree, -+ .reconfigure = vboxsf_reconfigure, -+}; -+ -+static int vboxsf_init_fs_context(struct fs_context *fc) -+{ -+ struct vboxsf_fs_context *ctx; -+ -+ ctx = kzalloc(sizeof(*ctx), GFP_KERNEL); -+ if (!ctx) -+ return -ENOMEM; -+ -+ current_uid_gid(&ctx->o.uid, &ctx->o.gid); -+ -+ fc->fs_private = ctx; -+ fc->ops = &vboxsf_context_ops; -+ return 0; -+} -+ -+static struct file_system_type vboxsf_fs_type = { -+ .owner = THIS_MODULE, -+ .name = "vboxsf", -+ .init_fs_context = vboxsf_init_fs_context, -+ .parameters = &vboxsf_fs_parameters, -+ .kill_sb = kill_anon_super -+}; -+ -+/* Module initialization/finalization handlers */ -+static int __init vboxsf_init(void) -+{ -+ return register_filesystem(&vboxsf_fs_type); -+} -+ -+static void __exit vboxsf_fini(void) -+{ -+ unregister_filesystem(&vboxsf_fs_type); -+ -+ mutex_lock(&vboxsf_setup_mutex); -+ if (vboxsf_setup_done) { -+ vboxsf_disconnect(); -+ /* -+ * Make sure all delayed rcu free inodes are flushed -+ * before we destroy the cache. -+ */ -+ rcu_barrier(); -+ kmem_cache_destroy(vboxsf_inode_cachep); -+ } -+ mutex_unlock(&vboxsf_setup_mutex); -+} -+ -+module_init(vboxsf_init); -+module_exit(vboxsf_fini); -+ -+MODULE_DESCRIPTION("Oracle VM VirtualBox Module for Host File System Access"); -+MODULE_AUTHOR("Oracle Corporation"); -+MODULE_LICENSE("GPL v2"); -+MODULE_ALIAS_FS("vboxsf"); -diff --git a/drivers/staging/vboxsf/utils.c b/drivers/staging/vboxsf/utils.c -new file mode 100644 -index 000000000000..1870b69c824e ---- /dev/null -+++ b/drivers/staging/vboxsf/utils.c -@@ -0,0 +1,550 @@ -+// SPDX-License-Identifier: MIT -+/* -+ * VirtualBox Guest Shared Folders support: Utility functions. -+ * Mainly conversion from/to VirtualBox/Linux data structures. -+ * -+ * Copyright (C) 2006-2018 Oracle Corporation -+ */ -+ -+#include -+#include -+#include -+#include -+#include "vfsmod.h" -+ -+struct inode *vboxsf_new_inode(struct super_block *sb) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(sb); -+ struct inode *inode; -+ unsigned long flags; -+ int cursor, ret; -+ u32 gen; -+ -+ inode = new_inode(sb); -+ if (!inode) -+ return ERR_PTR(-ENOMEM); -+ -+ idr_preload(GFP_KERNEL); -+ spin_lock_irqsave(&sbi->ino_idr_lock, flags); -+ cursor = idr_get_cursor(&sbi->ino_idr); -+ ret = idr_alloc_cyclic(&sbi->ino_idr, inode, 1, 0, GFP_ATOMIC); -+ if (ret >= 0 && ret < cursor) -+ sbi->next_generation++; -+ gen = sbi->next_generation; -+ spin_unlock_irqrestore(&sbi->ino_idr_lock, flags); -+ idr_preload_end(); -+ -+ if (ret < 0) { -+ iput(inode); -+ return ERR_PTR(ret); -+ } -+ -+ inode->i_ino = ret; -+ inode->i_generation = gen; -+ return inode; -+} -+ -+/* set [inode] attributes based on [info], uid/gid based on [sbi] */ -+void vboxsf_init_inode(struct vboxsf_sbi *sbi, struct inode *inode, -+ const struct shfl_fsobjinfo *info) -+{ -+ const struct shfl_fsobjattr *attr; -+ s64 allocated; -+ int mode; -+ -+ attr = &info->attr; -+ -+#define mode_set(r) ((attr->mode & (SHFL_UNIX_##r)) ? (S_##r) : 0) -+ -+ mode = mode_set(IRUSR); -+ mode |= mode_set(IWUSR); -+ mode |= mode_set(IXUSR); -+ -+ mode |= mode_set(IRGRP); -+ mode |= mode_set(IWGRP); -+ mode |= mode_set(IXGRP); -+ -+ mode |= mode_set(IROTH); -+ mode |= mode_set(IWOTH); -+ mode |= mode_set(IXOTH); -+ -+#undef mode_set -+ -+ /* We use the host-side values for these */ -+ inode->i_flags |= S_NOATIME | S_NOCMTIME; -+ inode->i_mapping->a_ops = &vboxsf_reg_aops; -+ -+ if (SHFL_IS_DIRECTORY(attr->mode)) { -+ inode->i_mode = sbi->o.dmode_set ? sbi->o.dmode : mode; -+ inode->i_mode &= ~sbi->o.dmask; -+ inode->i_mode |= S_IFDIR; -+ inode->i_op = &vboxsf_dir_iops; -+ inode->i_fop = &vboxsf_dir_fops; -+ /* -+ * XXX: this probably should be set to the number of entries -+ * in the directory plus two (. ..) -+ */ -+ set_nlink(inode, 1); -+ } else if (SHFL_IS_SYMLINK(attr->mode)) { -+ inode->i_mode = sbi->o.fmode_set ? sbi->o.fmode : mode; -+ inode->i_mode &= ~sbi->o.fmask; -+ inode->i_mode |= S_IFLNK; -+ inode->i_op = &vboxsf_lnk_iops; -+ set_nlink(inode, 1); -+ } else { -+ inode->i_mode = sbi->o.fmode_set ? sbi->o.fmode : mode; -+ inode->i_mode &= ~sbi->o.fmask; -+ inode->i_mode |= S_IFREG; -+ inode->i_op = &vboxsf_reg_iops; -+ inode->i_fop = &vboxsf_reg_fops; -+ set_nlink(inode, 1); -+ } -+ -+ inode->i_uid = sbi->o.uid; -+ inode->i_gid = sbi->o.gid; -+ -+ inode->i_size = info->size; -+ inode->i_blkbits = 12; -+ /* i_blocks always in units of 512 bytes! */ -+ allocated = info->allocated + 511; -+ do_div(allocated, 512); -+ inode->i_blocks = allocated; -+ -+ inode->i_atime = ns_to_timespec64( -+ info->access_time.ns_relative_to_unix_epoch); -+ inode->i_ctime = ns_to_timespec64( -+ info->change_time.ns_relative_to_unix_epoch); -+ inode->i_mtime = ns_to_timespec64( -+ info->modification_time.ns_relative_to_unix_epoch); -+} -+ -+int vboxsf_create_at_dentry(struct dentry *dentry, -+ struct shfl_createparms *params) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(dentry->d_sb); -+ struct shfl_string *path; -+ int err; -+ -+ path = vboxsf_path_from_dentry(sbi, dentry); -+ if (IS_ERR(path)) -+ return PTR_ERR(path); -+ -+ err = vboxsf_create(sbi->root, path, params); -+ __putname(path); -+ -+ return err; -+} -+ -+int vboxsf_stat(struct vboxsf_sbi *sbi, struct shfl_string *path, -+ struct shfl_fsobjinfo *info) -+{ -+ struct shfl_createparms params = {}; -+ int err; -+ -+ params.handle = SHFL_HANDLE_NIL; -+ params.create_flags = SHFL_CF_LOOKUP | SHFL_CF_ACT_FAIL_IF_NEW; -+ -+ err = vboxsf_create(sbi->root, path, ¶ms); -+ if (err) -+ return err; -+ -+ if (params.result != SHFL_FILE_EXISTS) -+ return -ENOENT; -+ -+ if (info) -+ *info = params.info; -+ -+ return 0; -+} -+ -+int vboxsf_stat_dentry(struct dentry *dentry, struct shfl_fsobjinfo *info) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(dentry->d_sb); -+ struct shfl_string *path; -+ int err; -+ -+ path = vboxsf_path_from_dentry(sbi, dentry); -+ if (IS_ERR(path)) -+ return PTR_ERR(path); -+ -+ err = vboxsf_stat(sbi, path, info); -+ __putname(path); -+ return err; -+} -+ -+int vboxsf_inode_revalidate(struct dentry *dentry) -+{ -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(dentry->d_sb); -+ struct vboxsf_inode *sf_i; -+ struct shfl_fsobjinfo info; -+ struct timespec64 prev_mtime; -+ struct inode *inode; -+ int err; -+ -+ if (!dentry || !d_really_is_positive(dentry)) -+ return -EINVAL; -+ -+ inode = d_inode(dentry); -+ prev_mtime = inode->i_mtime; -+ sf_i = VBOXSF_I(inode); -+ if (!sf_i->force_restat) { -+ if (time_before(jiffies, dentry->d_time + sbi->o.ttl)) -+ return 0; -+ } -+ -+ err = vboxsf_stat_dentry(dentry, &info); -+ if (err) -+ return err; -+ -+ dentry->d_time = jiffies; -+ sf_i->force_restat = 0; -+ vboxsf_init_inode(sbi, inode, &info); -+ -+ /* -+ * If the file was changed on the host side we need to invalidate the -+ * page-cache for it. Note this also gets triggered by our own writes, -+ * this is unavoidable. -+ */ -+ if (timespec64_compare(&inode->i_mtime, &prev_mtime) > 0) -+ invalidate_inode_pages2(inode->i_mapping); -+ -+ return 0; -+} -+ -+int vboxsf_getattr(const struct path *path, struct kstat *kstat, -+ u32 request_mask, unsigned int flags) -+{ -+ int err; -+ struct dentry *dentry = path->dentry; -+ struct inode *inode = d_inode(dentry); -+ struct vboxsf_inode *sf_i = VBOXSF_I(inode); -+ -+ switch (flags & AT_STATX_SYNC_TYPE) { -+ case AT_STATX_DONT_SYNC: -+ err = 0; -+ break; -+ case AT_STATX_FORCE_SYNC: -+ sf_i->force_restat = 1; -+ /* fall-through */ -+ default: -+ err = vboxsf_inode_revalidate(dentry); -+ } -+ if (err) -+ return err; -+ -+ generic_fillattr(d_inode(dentry), kstat); -+ return 0; -+} -+ -+int vboxsf_setattr(struct dentry *dentry, struct iattr *iattr) -+{ -+ struct vboxsf_inode *sf_i = VBOXSF_I(d_inode(dentry)); -+ struct vboxsf_sbi *sbi = VBOXSF_SBI(dentry->d_sb); -+ struct shfl_createparms params = {}; -+ struct shfl_fsobjinfo info = {}; -+ u32 buf_len; -+ int err; -+ -+ params.handle = SHFL_HANDLE_NIL; -+ params.create_flags = SHFL_CF_ACT_OPEN_IF_EXISTS | -+ SHFL_CF_ACT_FAIL_IF_NEW | -+ SHFL_CF_ACCESS_ATTR_WRITE; -+ -+ /* this is at least required for Posix hosts */ -+ if (iattr->ia_valid & ATTR_SIZE) -+ params.create_flags |= SHFL_CF_ACCESS_WRITE; -+ -+ err = vboxsf_create_at_dentry(dentry, ¶ms); -+ if (err || params.result != SHFL_FILE_EXISTS) -+ return err ? err : -ENOENT; -+ -+#define mode_set(r) ((iattr->ia_mode & (S_##r)) ? SHFL_UNIX_##r : 0) -+ -+ /* -+ * Setting the file size and setting the other attributes has to -+ * be handled separately. -+ */ -+ if (iattr->ia_valid & (ATTR_MODE | ATTR_ATIME | ATTR_MTIME)) { -+ if (iattr->ia_valid & ATTR_MODE) { -+ info.attr.mode = mode_set(IRUSR); -+ info.attr.mode |= mode_set(IWUSR); -+ info.attr.mode |= mode_set(IXUSR); -+ info.attr.mode |= mode_set(IRGRP); -+ info.attr.mode |= mode_set(IWGRP); -+ info.attr.mode |= mode_set(IXGRP); -+ info.attr.mode |= mode_set(IROTH); -+ info.attr.mode |= mode_set(IWOTH); -+ info.attr.mode |= mode_set(IXOTH); -+ -+ if (iattr->ia_mode & S_IFDIR) -+ info.attr.mode |= SHFL_TYPE_DIRECTORY; -+ else -+ info.attr.mode |= SHFL_TYPE_FILE; -+ } -+ -+ if (iattr->ia_valid & ATTR_ATIME) -+ info.access_time.ns_relative_to_unix_epoch = -+ timespec64_to_ns(&iattr->ia_atime); -+ -+ if (iattr->ia_valid & ATTR_MTIME) -+ info.modification_time.ns_relative_to_unix_epoch = -+ timespec64_to_ns(&iattr->ia_mtime); -+ -+ /* -+ * Ignore ctime (inode change time) as it can't be set -+ * from userland anyway. -+ */ -+ -+ buf_len = sizeof(info); -+ err = vboxsf_fsinfo(sbi->root, params.handle, -+ SHFL_INFO_SET | SHFL_INFO_FILE, &buf_len, -+ &info); -+ if (err) { -+ vboxsf_close(sbi->root, params.handle); -+ return err; -+ } -+ -+ /* the host may have given us different attr then requested */ -+ sf_i->force_restat = 1; -+ } -+ -+#undef mode_set -+ -+ if (iattr->ia_valid & ATTR_SIZE) { -+ memset(&info, 0, sizeof(info)); -+ info.size = iattr->ia_size; -+ buf_len = sizeof(info); -+ err = vboxsf_fsinfo(sbi->root, params.handle, -+ SHFL_INFO_SET | SHFL_INFO_SIZE, &buf_len, -+ &info); -+ if (err) { -+ vboxsf_close(sbi->root, params.handle); -+ return err; -+ } -+ -+ /* the host may have given us different attr then requested */ -+ sf_i->force_restat = 1; -+ } -+ -+ vboxsf_close(sbi->root, params.handle); -+ -+ /* Update the inode with what the host has actually given us. */ -+ if (sf_i->force_restat) -+ vboxsf_inode_revalidate(dentry); -+ -+ return 0; -+} -+ -+/* -+ * [dentry] contains string encoded in coding system that corresponds -+ * to [sbi]->nls, we must convert it to UTF8 here. -+ * Returns a shfl_string allocated through __getname (must be freed using -+ * __putname), or an ERR_PTR on error. -+ */ -+struct shfl_string *vboxsf_path_from_dentry(struct vboxsf_sbi *sbi, -+ struct dentry *dentry) -+{ -+ struct shfl_string *shfl_path; -+ int path_len, out_len, nb; -+ char *buf, *path; -+ wchar_t uni; -+ u8 *out; -+ -+ buf = __getname(); -+ if (!buf) -+ return ERR_PTR(-ENOMEM); -+ -+ path = dentry_path_raw(dentry, buf, PATH_MAX); -+ if (IS_ERR(path)) { -+ __putname(buf); -+ return (struct shfl_string *)path; -+ } -+ path_len = strlen(path); -+ -+ if (sbi->nls) { -+ shfl_path = __getname(); -+ if (!shfl_path) { -+ __putname(buf); -+ return ERR_PTR(-ENOMEM); -+ } -+ -+ out = shfl_path->string.utf8; -+ out_len = PATH_MAX - SHFLSTRING_HEADER_SIZE - 1; -+ -+ while (path_len) { -+ nb = sbi->nls->char2uni(path, path_len, &uni); -+ if (nb < 0) { -+ __putname(shfl_path); -+ __putname(buf); -+ return ERR_PTR(-EINVAL); -+ } -+ path += nb; -+ path_len -= nb; -+ -+ nb = utf32_to_utf8(uni, out, out_len); -+ if (nb < 0) { -+ __putname(shfl_path); -+ __putname(buf); -+ return ERR_PTR(-ENAMETOOLONG); -+ } -+ out += nb; -+ out_len -= nb; -+ } -+ *out = 0; -+ shfl_path->length = out - shfl_path->string.utf8; -+ shfl_path->size = shfl_path->length + 1; -+ __putname(buf); -+ } else { -+ if ((SHFLSTRING_HEADER_SIZE + path_len + 1) > PATH_MAX) { -+ __putname(buf); -+ return ERR_PTR(-ENAMETOOLONG); -+ } -+ /* -+ * dentry_path stores the name at the end of buf, but the -+ * shfl_string string we return must be properly aligned. -+ */ -+ shfl_path = (struct shfl_string *)buf; -+ memmove(shfl_path->string.utf8, path, path_len); -+ shfl_path->string.utf8[path_len] = 0; -+ shfl_path->length = path_len; -+ shfl_path->size = path_len + 1; -+ } -+ -+ return shfl_path; -+} -+ -+int vboxsf_nlscpy(struct vboxsf_sbi *sbi, char *name, size_t name_bound_len, -+ const unsigned char *utf8_name, size_t utf8_len) -+{ -+ const char *in; -+ char *out; -+ size_t out_len; -+ size_t out_bound_len; -+ size_t in_bound_len; -+ -+ in = utf8_name; -+ in_bound_len = utf8_len; -+ -+ out = name; -+ out_len = 0; -+ /* Reserve space for terminating 0 */ -+ out_bound_len = name_bound_len - 1; -+ -+ while (in_bound_len) { -+ int nb; -+ unicode_t uni; -+ -+ nb = utf8_to_utf32(in, in_bound_len, &uni); -+ if (nb < 0) -+ return -EINVAL; -+ -+ in += nb; -+ in_bound_len -= nb; -+ -+ nb = sbi->nls->uni2char(uni, out, out_bound_len); -+ if (nb < 0) -+ return nb; -+ -+ out += nb; -+ out_bound_len -= nb; -+ out_len += nb; -+ } -+ -+ *out = 0; -+ -+ return 0; -+} -+ -+static struct vboxsf_dir_buf *vboxsf_dir_buf_alloc(struct list_head *list) -+{ -+ struct vboxsf_dir_buf *b; -+ -+ b = kmalloc(sizeof(*b), GFP_KERNEL); -+ if (!b) -+ return NULL; -+ -+ b->buf = kmalloc(DIR_BUFFER_SIZE, GFP_KERNEL); -+ if (!b->buf) { -+ kfree(b); -+ return NULL; -+ } -+ -+ b->entries = 0; -+ b->used = 0; -+ b->free = DIR_BUFFER_SIZE; -+ list_add(&b->head, list); -+ -+ return b; -+} -+ -+static void vboxsf_dir_buf_free(struct vboxsf_dir_buf *b) -+{ -+ list_del(&b->head); -+ kfree(b->buf); -+ kfree(b); -+} -+ -+struct vboxsf_dir_info *vboxsf_dir_info_alloc(void) -+{ -+ struct vboxsf_dir_info *p; -+ -+ p = kmalloc(sizeof(*p), GFP_KERNEL); -+ if (!p) -+ return NULL; -+ -+ INIT_LIST_HEAD(&p->info_list); -+ return p; -+} -+ -+void vboxsf_dir_info_free(struct vboxsf_dir_info *p) -+{ -+ struct list_head *list, *pos, *tmp; -+ -+ list = &p->info_list; -+ list_for_each_safe(pos, tmp, list) { -+ struct vboxsf_dir_buf *b; -+ -+ b = list_entry(pos, struct vboxsf_dir_buf, head); -+ vboxsf_dir_buf_free(b); -+ } -+ kfree(p); -+} -+ -+int vboxsf_dir_read_all(struct vboxsf_sbi *sbi, struct vboxsf_dir_info *sf_d, -+ u64 handle) -+{ -+ struct vboxsf_dir_buf *b; -+ u32 entries, size; -+ int err = 0; -+ void *buf; -+ -+ /* vboxsf_dirinfo returns 1 on end of dir */ -+ while (err == 0) { -+ b = vboxsf_dir_buf_alloc(&sf_d->info_list); -+ if (!b) { -+ err = -ENOMEM; -+ break; -+ } -+ -+ buf = b->buf; -+ size = b->free; -+ -+ err = vboxsf_dirinfo(sbi->root, handle, NULL, 0, 0, -+ &size, buf, &entries); -+ if (err < 0) -+ break; -+ -+ b->entries += entries; -+ b->free -= size; -+ b->used += size; -+ } -+ -+ if (b && b->used == 0) -+ vboxsf_dir_buf_free(b); -+ -+ /* -EILSEQ means the host could not translate a filename, ignore */ -+ if (err > 0 || err == -EILSEQ) -+ err = 0; -+ -+ return err; -+} -diff --git a/drivers/staging/vboxsf/vboxsf_wrappers.c b/drivers/staging/vboxsf/vboxsf_wrappers.c -new file mode 100644 -index 000000000000..bfc78a097dae ---- /dev/null -+++ b/drivers/staging/vboxsf/vboxsf_wrappers.c -@@ -0,0 +1,371 @@ -+// SPDX-License-Identifier: MIT -+/* -+ * Wrapper functions for the shfl host calls. -+ * -+ * Copyright (C) 2006-2018 Oracle Corporation -+ */ -+ -+#include -+#include -+#include -+#include -+#include "vfsmod.h" -+ -+#define SHFL_REQUEST \ -+ (VMMDEV_REQUESTOR_KERNEL | VMMDEV_REQUESTOR_USR_DRV_OTHER | \ -+ VMMDEV_REQUESTOR_CON_DONT_KNOW | VMMDEV_REQUESTOR_TRUST_NOT_GIVEN) -+ -+static u32 vboxsf_client_id; -+ -+int vboxsf_connect(void) -+{ -+ struct vbg_dev *gdev; -+ struct vmmdev_hgcm_service_location loc; -+ int err, vbox_status; -+ -+ loc.type = VMMDEV_HGCM_LOC_LOCALHOST_EXISTING; -+ strcpy(loc.u.localhost.service_name, "VBoxSharedFolders"); -+ -+ gdev = vbg_get_gdev(); -+ if (IS_ERR(gdev)) -+ return -ENODEV; /* No guest-device */ -+ -+ err = vbg_hgcm_connect(gdev, SHFL_REQUEST, &loc, -+ &vboxsf_client_id, &vbox_status); -+ vbg_put_gdev(gdev); -+ -+ return err ? err : vbg_status_code_to_errno(vbox_status); -+} -+ -+void vboxsf_disconnect(void) -+{ -+ struct vbg_dev *gdev; -+ int vbox_status; -+ -+ gdev = vbg_get_gdev(); -+ if (IS_ERR(gdev)) -+ return; /* guest-device is gone, already disconnected */ -+ -+ vbg_hgcm_disconnect(gdev, SHFL_REQUEST, vboxsf_client_id, &vbox_status); -+ vbg_put_gdev(gdev); -+} -+ -+static int vboxsf_call(u32 function, void *parms, u32 parm_count, int *status) -+{ -+ struct vbg_dev *gdev; -+ int err, vbox_status; -+ -+ gdev = vbg_get_gdev(); -+ if (IS_ERR(gdev)) -+ return -ESHUTDOWN; /* guest-dev removed underneath us */ -+ -+ err = vbg_hgcm_call(gdev, SHFL_REQUEST, vboxsf_client_id, function, -+ U32_MAX, parms, parm_count, &vbox_status); -+ vbg_put_gdev(gdev); -+ -+ if (err < 0) -+ return err; -+ -+ if (status) -+ *status = vbox_status; -+ -+ return vbg_status_code_to_errno(vbox_status); -+} -+ -+int vboxsf_map_folder(struct shfl_string *folder_name, u32 *root) -+{ -+ struct shfl_map_folder parms; -+ int err, status; -+ -+ parms.path.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL; -+ parms.path.u.pointer.size = shfl_string_buf_size(folder_name); -+ parms.path.u.pointer.u.linear_addr = (uintptr_t)folder_name; -+ -+ parms.root.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.root.u.value32 = 0; -+ -+ parms.delimiter.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.delimiter.u.value32 = '/'; -+ -+ parms.case_sensitive.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.case_sensitive.u.value32 = 1; -+ -+ err = vboxsf_call(SHFL_FN_MAP_FOLDER, &parms, SHFL_CPARMS_MAP_FOLDER, -+ &status); -+ if (err == -ENOSYS && status == VERR_NOT_IMPLEMENTED) -+ vbg_err("%s: Error host is too old\n", __func__); -+ -+ *root = parms.root.u.value32; -+ return err; -+} -+ -+int vboxsf_unmap_folder(u32 root) -+{ -+ struct shfl_unmap_folder parms; -+ -+ parms.root.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.root.u.value32 = root; -+ -+ return vboxsf_call(SHFL_FN_UNMAP_FOLDER, &parms, -+ SHFL_CPARMS_UNMAP_FOLDER, NULL); -+} -+ -+/** -+ * vboxsf_create - Create a new file or folder -+ * @root: Root of the shared folder in which to create the file -+ * @parsed_path: The path of the file or folder relative to the shared folder -+ * @param: create_parms Parameters for file/folder creation. -+ * -+ * Create a new file or folder or open an existing one in a shared folder. -+ * Note this function always returns 0 / success unless an exceptional condition -+ * occurs - out of memory, invalid arguments, etc. If the file or folder could -+ * not be opened or created, create_parms->handle will be set to -+ * SHFL_HANDLE_NIL on return. In this case the value in create_parms->result -+ * provides information as to why (e.g. SHFL_FILE_EXISTS), create_parms->result -+ * is also set on success as additional information. -+ * -+ * Returns: -+ * 0 or negative errno value. -+ */ -+int vboxsf_create(u32 root, struct shfl_string *parsed_path, -+ struct shfl_createparms *create_parms) -+{ -+ struct shfl_create parms; -+ -+ parms.root.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.root.u.value32 = root; -+ -+ parms.path.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL; -+ parms.path.u.pointer.size = shfl_string_buf_size(parsed_path); -+ parms.path.u.pointer.u.linear_addr = (uintptr_t)parsed_path; -+ -+ parms.parms.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL; -+ parms.parms.u.pointer.size = sizeof(struct shfl_createparms); -+ parms.parms.u.pointer.u.linear_addr = (uintptr_t)create_parms; -+ -+ return vboxsf_call(SHFL_FN_CREATE, &parms, SHFL_CPARMS_CREATE, NULL); -+} -+ -+int vboxsf_close(u32 root, u64 handle) -+{ -+ struct shfl_close parms; -+ -+ parms.root.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.root.u.value32 = root; -+ -+ parms.handle.type = VMMDEV_HGCM_PARM_TYPE_64BIT; -+ parms.handle.u.value64 = handle; -+ -+ return vboxsf_call(SHFL_FN_CLOSE, &parms, SHFL_CPARMS_CLOSE, NULL); -+} -+ -+int vboxsf_remove(u32 root, struct shfl_string *parsed_path, u32 flags) -+{ -+ struct shfl_remove parms; -+ -+ parms.root.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.root.u.value32 = root; -+ -+ parms.path.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_IN; -+ parms.path.u.pointer.size = shfl_string_buf_size(parsed_path); -+ parms.path.u.pointer.u.linear_addr = (uintptr_t)parsed_path; -+ -+ parms.flags.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.flags.u.value32 = flags; -+ -+ return vboxsf_call(SHFL_FN_REMOVE, &parms, SHFL_CPARMS_REMOVE, NULL); -+} -+ -+int vboxsf_rename(u32 root, struct shfl_string *src_path, -+ struct shfl_string *dest_path, u32 flags) -+{ -+ struct shfl_rename parms; -+ -+ parms.root.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.root.u.value32 = root; -+ -+ parms.src.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_IN; -+ parms.src.u.pointer.size = shfl_string_buf_size(src_path); -+ parms.src.u.pointer.u.linear_addr = (uintptr_t)src_path; -+ -+ parms.dest.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_IN; -+ parms.dest.u.pointer.size = shfl_string_buf_size(dest_path); -+ parms.dest.u.pointer.u.linear_addr = (uintptr_t)dest_path; -+ -+ parms.flags.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.flags.u.value32 = flags; -+ -+ return vboxsf_call(SHFL_FN_RENAME, &parms, SHFL_CPARMS_RENAME, NULL); -+} -+ -+int vboxsf_read(u32 root, u64 handle, u64 offset, u32 *buf_len, u8 *buf) -+{ -+ struct shfl_read parms; -+ int err; -+ -+ parms.root.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.root.u.value32 = root; -+ -+ parms.handle.type = VMMDEV_HGCM_PARM_TYPE_64BIT; -+ parms.handle.u.value64 = handle; -+ parms.offset.type = VMMDEV_HGCM_PARM_TYPE_64BIT; -+ parms.offset.u.value64 = offset; -+ parms.cb.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.cb.u.value32 = *buf_len; -+ parms.buffer.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_OUT; -+ parms.buffer.u.pointer.size = *buf_len; -+ parms.buffer.u.pointer.u.linear_addr = (uintptr_t)buf; -+ -+ err = vboxsf_call(SHFL_FN_READ, &parms, SHFL_CPARMS_READ, NULL); -+ -+ *buf_len = parms.cb.u.value32; -+ return err; -+} -+ -+int vboxsf_write(u32 root, u64 handle, u64 offset, u32 *buf_len, u8 *buf) -+{ -+ struct shfl_write parms; -+ int err; -+ -+ parms.root.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.root.u.value32 = root; -+ -+ parms.handle.type = VMMDEV_HGCM_PARM_TYPE_64BIT; -+ parms.handle.u.value64 = handle; -+ parms.offset.type = VMMDEV_HGCM_PARM_TYPE_64BIT; -+ parms.offset.u.value64 = offset; -+ parms.cb.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.cb.u.value32 = *buf_len; -+ parms.buffer.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_IN; -+ parms.buffer.u.pointer.size = *buf_len; -+ parms.buffer.u.pointer.u.linear_addr = (uintptr_t)buf; -+ -+ err = vboxsf_call(SHFL_FN_WRITE, &parms, SHFL_CPARMS_WRITE, NULL); -+ -+ *buf_len = parms.cb.u.value32; -+ return err; -+} -+ -+/* Returns 0 on success, 1 on end-of-dir, negative errno otherwise */ -+int vboxsf_dirinfo(u32 root, u64 handle, -+ struct shfl_string *parsed_path, u32 flags, u32 index, -+ u32 *buf_len, struct shfl_dirinfo *buf, u32 *file_count) -+{ -+ struct shfl_list parms; -+ int err, status; -+ -+ parms.root.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.root.u.value32 = root; -+ -+ parms.handle.type = VMMDEV_HGCM_PARM_TYPE_64BIT; -+ parms.handle.u.value64 = handle; -+ parms.flags.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.flags.u.value32 = flags; -+ parms.cb.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.cb.u.value32 = *buf_len; -+ if (parsed_path) { -+ parms.path.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_IN; -+ parms.path.u.pointer.size = shfl_string_buf_size(parsed_path); -+ parms.path.u.pointer.u.linear_addr = (uintptr_t)parsed_path; -+ } else { -+ parms.path.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_IN; -+ parms.path.u.pointer.size = 0; -+ parms.path.u.pointer.u.linear_addr = 0; -+ } -+ -+ parms.buffer.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_OUT; -+ parms.buffer.u.pointer.size = *buf_len; -+ parms.buffer.u.pointer.u.linear_addr = (uintptr_t)buf; -+ -+ parms.resume_point.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.resume_point.u.value32 = index; -+ parms.file_count.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.file_count.u.value32 = 0; /* out parameter only */ -+ -+ err = vboxsf_call(SHFL_FN_LIST, &parms, SHFL_CPARMS_LIST, &status); -+ if (err == -ENODATA && status == VERR_NO_MORE_FILES) -+ err = 1; -+ -+ *buf_len = parms.cb.u.value32; -+ *file_count = parms.file_count.u.value32; -+ return err; -+} -+ -+int vboxsf_fsinfo(u32 root, u64 handle, u32 flags, -+ u32 *buf_len, void *buf) -+{ -+ struct shfl_information parms; -+ int err; -+ -+ parms.root.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.root.u.value32 = root; -+ -+ parms.handle.type = VMMDEV_HGCM_PARM_TYPE_64BIT; -+ parms.handle.u.value64 = handle; -+ parms.flags.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.flags.u.value32 = flags; -+ parms.cb.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.cb.u.value32 = *buf_len; -+ parms.info.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL; -+ parms.info.u.pointer.size = *buf_len; -+ parms.info.u.pointer.u.linear_addr = (uintptr_t)buf; -+ -+ err = vboxsf_call(SHFL_FN_INFORMATION, &parms, SHFL_CPARMS_INFORMATION, -+ NULL); -+ -+ *buf_len = parms.cb.u.value32; -+ return err; -+} -+ -+int vboxsf_readlink(u32 root, struct shfl_string *parsed_path, -+ u32 buf_len, u8 *buf) -+{ -+ struct shfl_readLink parms; -+ -+ parms.root.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.root.u.value32 = root; -+ -+ parms.path.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_IN; -+ parms.path.u.pointer.size = shfl_string_buf_size(parsed_path); -+ parms.path.u.pointer.u.linear_addr = (uintptr_t)parsed_path; -+ -+ parms.buffer.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_OUT; -+ parms.buffer.u.pointer.size = buf_len; -+ parms.buffer.u.pointer.u.linear_addr = (uintptr_t)buf; -+ -+ return vboxsf_call(SHFL_FN_READLINK, &parms, SHFL_CPARMS_READLINK, -+ NULL); -+} -+ -+int vboxsf_symlink(u32 root, struct shfl_string *new_path, -+ struct shfl_string *old_path, struct shfl_fsobjinfo *buf) -+{ -+ struct shfl_symlink parms; -+ -+ parms.root.type = VMMDEV_HGCM_PARM_TYPE_32BIT; -+ parms.root.u.value32 = root; -+ -+ parms.new_path.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_IN; -+ parms.new_path.u.pointer.size = shfl_string_buf_size(new_path); -+ parms.new_path.u.pointer.u.linear_addr = (uintptr_t)new_path; -+ -+ parms.old_path.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_IN; -+ parms.old_path.u.pointer.size = shfl_string_buf_size(old_path); -+ parms.old_path.u.pointer.u.linear_addr = (uintptr_t)old_path; -+ -+ parms.info.type = VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_OUT; -+ parms.info.u.pointer.size = sizeof(struct shfl_fsobjinfo); -+ parms.info.u.pointer.u.linear_addr = (uintptr_t)buf; -+ -+ return vboxsf_call(SHFL_FN_SYMLINK, &parms, SHFL_CPARMS_SYMLINK, NULL); -+} -+ -+int vboxsf_set_utf8(void) -+{ -+ return vboxsf_call(SHFL_FN_SET_UTF8, NULL, 0, NULL); -+} -+ -+int vboxsf_set_symlinks(void) -+{ -+ return vboxsf_call(SHFL_FN_SET_SYMLINKS, NULL, 0, NULL); -+} -diff --git a/drivers/staging/vboxsf/vfsmod.h b/drivers/staging/vboxsf/vfsmod.h -new file mode 100644 -index 000000000000..de650d65fbe4 ---- /dev/null -+++ b/drivers/staging/vboxsf/vfsmod.h -@@ -0,0 +1,138 @@ -+/* SPDX-License-Identifier: MIT */ -+/* -+ * VirtualBox Guest Shared Folders support: module header. -+ * -+ * Copyright (C) 2006-2018 Oracle Corporation -+ */ -+ -+#ifndef VFSMOD_H -+#define VFSMOD_H -+ -+#include -+#include -+#include -+#include "shfl_hostintf.h" -+ -+#define DIR_BUFFER_SIZE SZ_16K -+ -+/* The cast is to prevent assignment of void * to pointers of arbitrary type */ -+#define VBOXSF_SBI(sb) ((struct vboxsf_sbi *)(sb)->s_fs_info) -+#define VBOXSF_I(i) container_of(i, struct vboxsf_inode, vfs_inode) -+ -+struct vboxsf_options { -+ unsigned long ttl; -+ kuid_t uid; -+ kgid_t gid; -+ bool dmode_set; -+ bool fmode_set; -+ umode_t dmode; -+ umode_t fmode; -+ umode_t dmask; -+ umode_t fmask; -+}; -+ -+struct vboxsf_fs_context { -+ struct vboxsf_options o; -+ char *nls_name; -+}; -+ -+/* per-shared folder information */ -+struct vboxsf_sbi { -+ struct vboxsf_options o; -+ struct shfl_fsobjinfo root_info; -+ struct idr ino_idr; -+ spinlock_t ino_idr_lock; /* This protects ino_idr */ -+ struct nls_table *nls; -+ u32 next_generation; -+ u32 root; -+ int bdi_id; -+}; -+ -+/* per-inode information */ -+struct vboxsf_inode { -+ /* some information was changed, update data on next revalidate */ -+ int force_restat; -+ /* list of open handles for this inode + lock protecting it */ -+ struct list_head handle_list; -+ /* This mutex protects handle_list accesses */ -+ struct mutex handle_list_mutex; -+ /* The VFS inode struct */ -+ struct inode vfs_inode; -+}; -+ -+struct vboxsf_dir_info { -+ struct list_head info_list; -+}; -+ -+struct vboxsf_dir_buf { -+ size_t entries; -+ size_t free; -+ size_t used; -+ void *buf; -+ struct list_head head; -+}; -+ -+/* globals */ -+extern const struct inode_operations vboxsf_dir_iops; -+extern const struct inode_operations vboxsf_lnk_iops; -+extern const struct inode_operations vboxsf_reg_iops; -+extern const struct file_operations vboxsf_dir_fops; -+extern const struct file_operations vboxsf_reg_fops; -+extern const struct address_space_operations vboxsf_reg_aops; -+extern const struct dentry_operations vboxsf_dentry_ops; -+ -+/* from utils.c */ -+struct inode *vboxsf_new_inode(struct super_block *sb); -+void vboxsf_init_inode(struct vboxsf_sbi *sbi, struct inode *inode, -+ const struct shfl_fsobjinfo *info); -+int vboxsf_create_at_dentry(struct dentry *dentry, -+ struct shfl_createparms *params); -+int vboxsf_stat(struct vboxsf_sbi *sbi, struct shfl_string *path, -+ struct shfl_fsobjinfo *info); -+int vboxsf_stat_dentry(struct dentry *dentry, struct shfl_fsobjinfo *info); -+int vboxsf_inode_revalidate(struct dentry *dentry); -+int vboxsf_getattr(const struct path *path, struct kstat *kstat, -+ u32 request_mask, unsigned int query_flags); -+int vboxsf_setattr(struct dentry *dentry, struct iattr *iattr); -+struct shfl_string *vboxsf_path_from_dentry(struct vboxsf_sbi *sbi, -+ struct dentry *dentry); -+int vboxsf_nlscpy(struct vboxsf_sbi *sbi, char *name, size_t name_bound_len, -+ const unsigned char *utf8_name, size_t utf8_len); -+struct vboxsf_dir_info *vboxsf_dir_info_alloc(void); -+void vboxsf_dir_info_free(struct vboxsf_dir_info *p); -+int vboxsf_dir_read_all(struct vboxsf_sbi *sbi, struct vboxsf_dir_info *sf_d, -+ u64 handle); -+ -+/* from vboxsf_wrappers.c */ -+int vboxsf_connect(void); -+void vboxsf_disconnect(void); -+ -+int vboxsf_create(u32 root, struct shfl_string *parsed_path, -+ struct shfl_createparms *create_parms); -+ -+int vboxsf_close(u32 root, u64 handle); -+int vboxsf_remove(u32 root, struct shfl_string *parsed_path, u32 flags); -+int vboxsf_rename(u32 root, struct shfl_string *src_path, -+ struct shfl_string *dest_path, u32 flags); -+ -+int vboxsf_read(u32 root, u64 handle, u64 offset, u32 *buf_len, u8 *buf); -+int vboxsf_write(u32 root, u64 handle, u64 offset, u32 *buf_len, u8 *buf); -+ -+int vboxsf_dirinfo(u32 root, u64 handle, -+ struct shfl_string *parsed_path, u32 flags, u32 index, -+ u32 *buf_len, struct shfl_dirinfo *buf, u32 *file_count); -+int vboxsf_fsinfo(u32 root, u64 handle, u32 flags, -+ u32 *buf_len, void *buf); -+ -+int vboxsf_map_folder(struct shfl_string *folder_name, u32 *root); -+int vboxsf_unmap_folder(u32 root); -+ -+int vboxsf_readlink(u32 root, struct shfl_string *parsed_path, -+ u32 buf_len, u8 *buf); -+int vboxsf_symlink(u32 root, struct shfl_string *new_path, -+ struct shfl_string *old_path, struct shfl_fsobjinfo *buf); -+ -+int vboxsf_set_utf8(void); -+int vboxsf_set_symlinks(void); -+ -+#endif --- -cgit 1.2-0.3.lf.el7 - diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-2.6.31.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-2.6.31.patch deleted file mode 100644 index ac0254e5..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-2.6.31.patch +++ /dev/null @@ -1,100 +0,0 @@ -Adapt mach64 to build with 2.6.31 series kernels - -Signed-off-by: Thomas Backlund - -diff -urp linux-2.6.31-rc3-git5-mnb1/drivers/gpu/drm/mach64/mach64_dma.c linux-2.6.31-rc3-git5-mnb1/drivers/gpu/drm/mach64.fixed/mach64_dma.c ---- linux-2.6.31-rc3-git5-mnb1/drivers/gpu/drm/mach64/mach64_dma.c 2009-07-23 00:24:12.000000000 +0300 -+++ linux-2.6.31-rc3-git5-mnb1/drivers/gpu/drm/mach64.fixed/mach64_dma.c 2009-07-23 02:28:21.000000000 +0300 -@@ -1006,7 +1006,7 @@ static int mach64_do_dma_init(struct drm - - DRM_DEBUG("\n"); - -- dev_priv = drm_alloc(sizeof(drm_mach64_private_t), DRM_MEM_DRIVER); -+ dev_priv = kmalloc(sizeof(drm_mach64_private_t), GFP_KERNEL); - if (dev_priv == NULL) - return -ENOMEM; - -@@ -1386,8 +1386,7 @@ int mach64_do_cleanup_dma(struct drm_dev - - mach64_destroy_freelist(dev); - -- drm_free(dev_priv, sizeof(drm_mach64_private_t), -- DRM_MEM_DRIVER); -+ kfree(dev_priv); - dev->dev_private = NULL; - } - -@@ -1476,8 +1475,8 @@ int mach64_init_freelist(struct drm_devi - for (i = 0; i < dma->buf_count; i++) { - if ((entry = - (drm_mach64_freelist_t *) -- drm_alloc(sizeof(drm_mach64_freelist_t), -- DRM_MEM_BUFLISTS)) == NULL) -+ kmalloc(sizeof(drm_mach64_freelist_t), -+ GFP_KERNEL)) == NULL) - return -ENOMEM; - memset(entry, 0, sizeof(drm_mach64_freelist_t)); - entry->buf = dma->buflist[i]; -@@ -1500,18 +1499,18 @@ void mach64_destroy_freelist(struct drm_ - list_for_each_safe(ptr, tmp, &dev_priv->pending) { - list_del(ptr); - entry = list_entry(ptr, drm_mach64_freelist_t, list); -- drm_free(entry, sizeof(*entry), DRM_MEM_BUFLISTS); -+ kfree(entry); - } - list_for_each_safe(ptr, tmp, &dev_priv->placeholders) { - list_del(ptr); - entry = list_entry(ptr, drm_mach64_freelist_t, list); -- drm_free(entry, sizeof(*entry), DRM_MEM_BUFLISTS); -+ kfree(entry); - } - - list_for_each_safe(ptr, tmp, &dev_priv->free_list) { - list_del(ptr); - entry = list_entry(ptr, drm_mach64_freelist_t, list); -- drm_free(entry, sizeof(*entry), DRM_MEM_BUFLISTS); -+ kfree(entry); - } - } - -diff -urp linux-2.6.31-rc3-git5-mnb1/drivers/gpu/drm/mach64/mach64_state.c linux-2.6.31-rc3-git5-mnb1/drivers/gpu/drm/mach64.fixed/mach64_state.c ---- linux-2.6.31-rc3-git5-mnb1/drivers/gpu/drm/mach64/mach64_state.c 2009-07-23 00:24:12.000000000 +0300 -+++ linux-2.6.31-rc3-git5-mnb1/drivers/gpu/drm/mach64.fixed/mach64_state.c 2009-07-23 02:29:24.000000000 +0300 -@@ -490,12 +490,12 @@ static __inline__ int copy_from_user_ver - unsigned long n = bytes; /* dwords remaining in buffer */ - u32 *from, *orig_from; - -- from = drm_alloc(bytes, DRM_MEM_DRIVER); -+ from = kmalloc(bytes, GFP_KERNEL); - if (from == NULL) - return -ENOMEM; - - if (DRM_COPY_FROM_USER(from, ufrom, bytes)) { -- drm_free(from, bytes, DRM_MEM_DRIVER); -+ kfree(from); - return -EFAULT; - } - orig_from = from; /* we'll be modifying the "from" ptr, so save it */ -@@ -526,19 +526,19 @@ static __inline__ int copy_from_user_ver - to += count; - } else { - DRM_ERROR("Got bad command: 0x%04x\n", reg); -- drm_free(orig_from, bytes, DRM_MEM_DRIVER); -+ kfree(orig_from); - return -EACCES; - } - } else { - DRM_ERROR - ("Got bad command count(=%u) dwords remaining=%lu\n", - count, n); -- drm_free(orig_from, bytes, DRM_MEM_DRIVER); -+ kfree(orig_from); - return -EINVAL; - } - } - -- drm_free(orig_from, bytes, DRM_MEM_DRIVER); -+ kfree(orig_from); - if (n == 0) - return 0; - else { diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-2.6.36-buildfix.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-2.6.36-buildfix.patch deleted file mode 100644 index ef428983..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-2.6.36-buildfix.patch +++ /dev/null @@ -1,27 +0,0 @@ ---- linux-2.6.35/drivers/gpu/drm/mach64/mach64_state.c.orig 2010-10-03 13:29:10.000000000 +0300 -+++ linux-2.6.35/drivers/gpu/drm/mach64/mach64_state.c 2010-10-03 14:04:45.991164007 +0300 -@@ -41,15 +41,15 @@ - * - */ - struct drm_ioctl_desc mach64_ioctls[] = { -- DRM_IOCTL_DEF(DRM_MACH64_INIT, mach64_dma_init, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY), -- DRM_IOCTL_DEF(DRM_MACH64_CLEAR, mach64_dma_clear, DRM_AUTH), -- DRM_IOCTL_DEF(DRM_MACH64_SWAP, mach64_dma_swap, DRM_AUTH), -- DRM_IOCTL_DEF(DRM_MACH64_IDLE, mach64_dma_idle, DRM_AUTH), -- DRM_IOCTL_DEF(DRM_MACH64_RESET, mach64_engine_reset, DRM_AUTH), -- DRM_IOCTL_DEF(DRM_MACH64_VERTEX, mach64_dma_vertex, DRM_AUTH), -- DRM_IOCTL_DEF(DRM_MACH64_BLIT, mach64_dma_blit, DRM_AUTH), -- DRM_IOCTL_DEF(DRM_MACH64_FLUSH, mach64_dma_flush, DRM_AUTH), -- DRM_IOCTL_DEF(DRM_MACH64_GETPARAM, mach64_get_param, DRM_AUTH), -+ DRM_IOCTL_DEF_DRV(MACH64_INIT, mach64_dma_init, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY), -+ DRM_IOCTL_DEF_DRV(MACH64_CLEAR, mach64_dma_clear, DRM_AUTH), -+ DRM_IOCTL_DEF_DRV(MACH64_SWAP, mach64_dma_swap, DRM_AUTH), -+ DRM_IOCTL_DEF_DRV(MACH64_IDLE, mach64_dma_idle, DRM_AUTH), -+ DRM_IOCTL_DEF_DRV(MACH64_RESET, mach64_engine_reset, DRM_AUTH), -+ DRM_IOCTL_DEF_DRV(MACH64_VERTEX, mach64_dma_vertex, DRM_AUTH), -+ DRM_IOCTL_DEF_DRV(MACH64_BLIT, mach64_dma_blit, DRM_AUTH), -+ DRM_IOCTL_DEF_DRV(MACH64_FLUSH, mach64_dma_flush, DRM_AUTH), -+ DRM_IOCTL_DEF_DRV(MACH64_GETPARAM, mach64_get_param, DRM_AUTH), - }; - - int mach64_max_ioctl = DRM_ARRAY_SIZE(mach64_ioctls); diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-2.6.37-buildfix.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-2.6.37-buildfix.patch deleted file mode 100644 index 43dc70ec..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-2.6.37-buildfix.patch +++ /dev/null @@ -1,24 +0,0 @@ - -Fix build for 2.6.37 - -Signed-off-by: Thomas Backlund - ---- a/drivers/gpu/drm/mach64/mach64_drv.c.orig 2011-01-02 16:55:48.000000000 +0200 -+++ a/drivers/gpu/drm/mach64/mach64_drv.c 2011-01-02 17:53:54.808775632 +0200 -@@ -51,8 +51,6 @@ static struct drm_driver driver = { - .irq_uninstall = mach64_driver_irq_uninstall, - .irq_handler = mach64_driver_irq_handler, - .reclaim_buffers = drm_core_reclaim_buffers, -- .get_map_ofs = drm_core_get_map_ofs, -- .get_reg_ofs = drm_core_get_reg_ofs, - .ioctls = mach64_ioctls, - .dma_ioctl = mach64_dma_buffers, - .fops = { -@@ -63,6 +61,7 @@ static struct drm_driver driver = { - .mmap = drm_mmap, - .poll = drm_poll, - .fasync = drm_fasync, -+ .llseek = noop_llseek, - }, - .pci_driver = { - .name = DRIVER_NAME, diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.0-buildfix.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.0-buildfix.patch deleted file mode 100644 index 9d7538a9..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.0-buildfix.patch +++ /dev/null @@ -1,44 +0,0 @@ - -fix build with linux-3.0 - -Signed-off-by: Thomas Backlund - - drivers/gpu/drm/mach64/mach64_drv.c | 13 +++++++------ - 1 file changed, 7 insertions(+), 6 deletions(-) - ---- a/drivers/gpu/drm/mach64/mach64_drv.c.orig 2011-07-15 02:48:40.000000000 +0300 -+++ a/drivers/gpu/drm/mach64/mach64_drv.c 2011-07-15 13:24:41.454753025 +0300 -@@ -63,10 +63,6 @@ static struct drm_driver driver = { - .fasync = drm_fasync, - .llseek = noop_llseek, - }, -- .pci_driver = { -- .name = DRIVER_NAME, -- .id_table = pciidlist, -- }, - - .name = DRIVER_NAME, - .desc = DRIVER_DESC, -@@ -76,15 +72,20 @@ static struct drm_driver driver = { - .patchlevel = DRIVER_PATCHLEVEL, - }; - -+static struct pci_driver mach64_pci_driver = { -+ .name = DRIVER_NAME, -+ .id_table = pciidlist, -+}; -+ - static int __init mach64_init(void) - { - driver.num_ioctls = mach64_max_ioctl; -- return drm_init(&driver); -+ return drm_pci_init(&driver, &mach64_pci_driver); - } - - static void __exit mach64_exit(void) - { -- drm_exit(&driver); -+ drm_pci_exit(&driver, &mach64_pci_driver); - } - - module_init(mach64_init); diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.12-buildfix.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.12-buildfix.patch deleted file mode 100644 index 5ec06698..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.12-buildfix.patch +++ /dev/null @@ -1,17 +0,0 @@ ---- linux/drivers/gpu/drm/mach64/mach64_drv.c.orig 2013-10-13 12:19:41.000000000 +0300 -+++ linux/drivers/gpu/drm/mach64/mach64_drv.c 2013-10-13 14:27:25.684247911 +0300 -@@ -46,13 +46,12 @@ static const struct file_operations mach - .unlocked_ioctl = drm_ioctl, - .mmap = drm_mmap, - .poll = drm_poll, -- .fasync = drm_fasync, - .llseek = noop_llseek, - }; - - static struct drm_driver driver = { - .driver_features = -- DRIVER_USE_AGP | DRIVER_USE_MTRR | DRIVER_PCI_DMA | DRIVER_HAVE_DMA -+ DRIVER_USE_AGP | DRIVER_PCI_DMA | DRIVER_HAVE_DMA - | DRIVER_HAVE_IRQ | DRIVER_IRQ_SHARED, - .lastclose = mach64_driver_lastclose, - .get_vblank_counter = mach64_get_vblank_counter, diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.17-buildfix.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.17-buildfix.patch deleted file mode 100644 index 6b7b3780..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.17-buildfix.patch +++ /dev/null @@ -1,31 +0,0 @@ - -Adapt for kernel-3.17 - -DRM_ARRAY_SIZE is a duplicate of ARRAY_SIZE and have been dropped. - -drm_dev_to_irq has been dropped, so call dev->pdev->irq directly -for code simplicity. - -Signed-off-by: Thomas Backlund - -diff -urp linux/drivers/gpu/drm/mach64/mach64_state.c.orig linux/drivers/gpu/drm/mach64/mach64_state.c ---- linux/drivers/gpu/drm/mach64/mach64_state.c.orig -+++ linux/drivers/gpu/drm/mach64/mach64_state.c -@@ -52,7 +52,7 @@ struct drm_ioctl_desc mach64_ioctls[] = - DRM_IOCTL_DEF_DRV(MACH64_GETPARAM, mach64_get_param, DRM_AUTH), - }; - --int mach64_max_ioctl = DRM_ARRAY_SIZE(mach64_ioctls); -+int mach64_max_ioctl = ARRAY_SIZE(mach64_ioctls); - - /* ================================================================ - * DMA hardware state programming functions -@@ -895,7 +895,7 @@ int mach64_get_param(struct drm_device * - value = mach64_do_get_frames_queued(dev_priv); - break; - case MACH64_PARAM_IRQ_NR: -- value = drm_dev_to_irq(dev); -+ value = dev->pdev->irq; - break; - default: - return -EINVAL; diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.18-buildfix.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.18-buildfix.patch deleted file mode 100644 index bc0d4606..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.18-buildfix.patch +++ /dev/null @@ -1,142 +0,0 @@ - -Fix build with kernel 3.18 - -Signed-off-by: Thomas Backlund - -diff -urp linux/drivers/gpu/drm/mach64.orig/mach64_dma.c linux/drivers/gpu/drm/mach64/mach64_dma.c ---- linux/drivers/gpu/drm/mach64.orig/mach64_dma.c 2014-11-29 22:01:54.000000000 +0200 -+++ linux/drivers/gpu/drm/mach64/mach64_dma.c 2014-11-30 00:02:06.906821818 +0200 -@@ -1038,21 +1038,21 @@ static int mach64_do_dma_init(struct drm - INIT_LIST_HEAD(&dev_priv->placeholders); - INIT_LIST_HEAD(&dev_priv->pending); - -- dev_priv->sarea = drm_getsarea(dev); -+ dev_priv->sarea = drm_legacy_getsarea(dev); - if (!dev_priv->sarea) { - DRM_ERROR("can not find sarea!\n"); - dev->dev_private = (void *)dev_priv; - mach64_do_cleanup_dma(dev); - return -EINVAL; - } -- dev_priv->fb = drm_core_findmap(dev, init->fb_offset); -+ dev_priv->fb = drm_legacy_findmap(dev, init->fb_offset); - if (!dev_priv->fb) { - DRM_ERROR("can not find frame buffer map!\n"); - dev->dev_private = (void *)dev_priv; - mach64_do_cleanup_dma(dev); - return -EINVAL; - } -- dev_priv->mmio = drm_core_findmap(dev, init->mmio_offset); -+ dev_priv->mmio = drm_legacy_findmap(dev, init->mmio_offset); - if (!dev_priv->mmio) { - DRM_ERROR("can not find mmio map!\n"); - dev->dev_private = (void *)dev_priv; -@@ -1060,7 +1060,7 @@ static int mach64_do_dma_init(struct drm - return -EINVAL; - } - -- dev_priv->ring_map = drm_core_findmap(dev, init->ring_offset); -+ dev_priv->ring_map = drm_legacy_findmap(dev, init->ring_offset); - if (!dev_priv->ring_map) { - DRM_ERROR("can not find ring map!\n"); - dev->dev_private = (void *)dev_priv; -@@ -1072,7 +1072,7 @@ static int mach64_do_dma_init(struct drm - ((u8 *) dev_priv->sarea->handle + init->sarea_priv_offset); - - if (!dev_priv->is_pci) { -- drm_core_ioremap(dev_priv->ring_map, dev); -+ drm_legacy_ioremap(dev_priv->ring_map, dev); - if (!dev_priv->ring_map->handle) { - DRM_ERROR("can not ioremap virtual address for" - " descriptor ring\n"); -@@ -1082,7 +1082,7 @@ static int mach64_do_dma_init(struct drm - } - dev->agp_buffer_token = init->buffers_offset; - dev->agp_buffer_map = -- drm_core_findmap(dev, init->buffers_offset); -+ drm_legacy_findmap(dev, init->buffers_offset); - if (!dev->agp_buffer_map) { - DRM_ERROR("can not find dma buffer map!\n"); - dev->dev_private = (void *)dev_priv; -@@ -1093,7 +1093,7 @@ static int mach64_do_dma_init(struct drm - dev isn't passed all the way though the mach64 - DA */ - dev_priv->dev_buffers = dev->agp_buffer_map; - -- drm_core_ioremap(dev->agp_buffer_map, dev); -+ drm_legacy_ioremap(dev->agp_buffer_map, dev); - if (!dev->agp_buffer_map->handle) { - DRM_ERROR("can not ioremap virtual address for" - " dma buffer\n"); -@@ -1102,7 +1102,7 @@ static int mach64_do_dma_init(struct drm - return -ENOMEM; - } - dev_priv->agp_textures = -- drm_core_findmap(dev, init->agp_textures_offset); -+ drm_legacy_findmap(dev, init->agp_textures_offset); - if (!dev_priv->agp_textures) { - DRM_ERROR("can not find agp texture region!\n"); - dev->dev_private = (void *)dev_priv; -@@ -1376,10 +1376,10 @@ int mach64_do_cleanup_dma(struct drm_dev - - if (!dev_priv->is_pci) { - if (dev_priv->ring_map) -- drm_core_ioremapfree(dev_priv->ring_map, dev); -+ drm_legacy_ioremapfree(dev_priv->ring_map, dev); - - if (dev->agp_buffer_map) { -- drm_core_ioremapfree(dev->agp_buffer_map, dev); -+ drm_legacy_ioremapfree(dev->agp_buffer_map, dev); - dev->agp_buffer_map = NULL; - } - } -diff -urp linux/drivers/gpu/drm/mach64.orig/mach64_drv.c linux/drivers/gpu/drm/mach64/mach64_drv.c ---- linux/drivers/gpu/drm/mach64.orig/mach64_drv.c 2014-11-29 22:01:54.000000000 +0200 -+++ linux/drivers/gpu/drm/mach64/mach64_drv.c 2014-11-29 23:14:21.918009653 +0200 -@@ -34,6 +34,7 @@ - #include "mach64_drv.h" - - #include -+#include - - static struct pci_device_id pciidlist[] = { - mach64_PCI_IDS -@@ -44,7 +45,7 @@ static const struct file_operations mach - .open = drm_open, - .release = drm_release, - .unlocked_ioctl = drm_ioctl, -- .mmap = drm_mmap, -+ .mmap = drm_legacy_mmap, - .poll = drm_poll, - .llseek = noop_llseek, - }; -diff -urp linux/drivers/gpu/drm/mach64.orig/mach64_drv.h linux/drivers/gpu/drm/mach64/mach64_drv.h ---- linux/drivers/gpu/drm/mach64.orig/mach64_drv.h 2014-11-29 22:01:54.000000000 +0200 -+++ linux/drivers/gpu/drm/mach64/mach64_drv.h 2014-11-29 23:58:20.111491646 +0200 -@@ -35,6 +35,8 @@ - #ifndef __MACH64_DRV_H__ - #define __MACH64_DRV_H__ - -+#include -+ - /* General customization: - */ - -@@ -102,12 +104,12 @@ typedef struct drm_mach64_private { - u32 back_offset_pitch; - u32 depth_offset_pitch; - -- drm_local_map_t *sarea; -- drm_local_map_t *fb; -- drm_local_map_t *mmio; -- drm_local_map_t *ring_map; -- drm_local_map_t *dev_buffers; /* this is a pointer to a structure in dev */ -- drm_local_map_t *agp_textures; -+ struct drm_local_map *sarea; -+ struct drm_local_map *fb; -+ struct drm_local_map *mmio; -+ struct drm_local_map *ring_map; -+ struct drm_local_map *dev_buffers; /* this is a pointer to a structure in dev */ -+ struct drm_local_map *agp_textures; - } drm_mach64_private_t; - - extern struct drm_ioctl_desc mach64_ioctls[]; diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.3-buildfix.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.3-buildfix.patch deleted file mode 100644 index 824b9552..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.3-buildfix.patch +++ /dev/null @@ -1,47 +0,0 @@ - -This moves the .fops to a separate struct as required by kernel-3.3 - -Signed-off-by: Thomas Backlund - - b/drivers/gpu/drm/mach64/mach64_drv.c | 23 ++++++++++++----------- - 1 file changed, 12 insertions(+), 11 deletions(-) - ---- a/drivers/gpu/drm/mach64/mach64_drv.c -+++ b/drivers/gpu/drm/mach64/mach64_drv.c -@@ -39,6 +39,17 @@ static struct pci_device_id pciidlist[] - mach64_PCI_IDS - }; - -+static const struct file_operations mach64_driver_fops = { -+ .owner = THIS_MODULE, -+ .open = drm_open, -+ .release = drm_release, -+ .unlocked_ioctl = drm_ioctl, -+ .mmap = drm_mmap, -+ .poll = drm_poll, -+ .fasync = drm_fasync, -+ .llseek = noop_llseek, -+}; -+ - static struct drm_driver driver = { - .driver_features = - DRIVER_USE_AGP | DRIVER_USE_MTRR | DRIVER_PCI_DMA | DRIVER_HAVE_DMA -@@ -54,17 +65,7 @@ static struct drm_driver driver = { - .reclaim_buffers = drm_core_reclaim_buffers, - .ioctls = mach64_ioctls, - .dma_ioctl = mach64_dma_buffers, -- .fops = { -- .owner = THIS_MODULE, -- .open = drm_open, -- .release = drm_release, -- .unlocked_ioctl = drm_ioctl, -- .mmap = drm_mmap, -- .poll = drm_poll, -- .fasync = drm_fasync, -- .llseek = noop_llseek, -- }, -- -+ .fops = &mach64_driver_fops, - .name = DRIVER_NAME, - .desc = DRIVER_DESC, - .date = DRIVER_DATE, diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.6-buildfix.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.6-buildfix.patch deleted file mode 100644 index c7df6444..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.6-buildfix.patch +++ /dev/null @@ -1,15 +0,0 @@ - -reclaim_buffers is gone in 3.6 - -Signed-off-by: Thomas Backlund - ---- linux/drivers/gpu/drm/mach64/mach64_drv.c.orig 2012-10-17 22:26:58.000000000 +0300 -+++ linux/drivers/gpu/drm/mach64/mach64_drv.c 2012-10-17 23:05:10.212566630 +0300 -@@ -62,7 +62,6 @@ static struct drm_driver driver = { - .irq_postinstall = mach64_driver_irq_postinstall, - .irq_uninstall = mach64_driver_irq_uninstall, - .irq_handler = mach64_driver_irq_handler, -- .reclaim_buffers = drm_core_reclaim_buffers, - .ioctls = mach64_ioctls, - .dma_ioctl = mach64_dma_buffers, - .fops = &mach64_driver_fops, diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.7-buildfix.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.7-buildfix.patch deleted file mode 100644 index cc1c5b27..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-3.7-buildfix.patch +++ /dev/null @@ -1,61 +0,0 @@ -diff -Nurp linux-3.7-rc8/drivers/gpu/drm/mach64.orig/mach64_dma.c linux-3.7-rc8/drivers/gpu/drm/mach64/mach64_dma.c ---- linux-3.7-rc8/drivers/gpu/drm/mach64.orig/mach64_dma.c 2012-12-06 19:50:10.000000000 +0200 -+++ linux-3.7-rc8/drivers/gpu/drm/mach64/mach64_dma.c 2012-12-06 20:19:10.590681644 +0200 -@@ -34,8 +34,8 @@ - * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. - */ - --#include "drmP.h" --#include "drm.h" -+#include -+#include - #include "mach64_drm.h" - #include "mach64_drv.h" - -diff -Nurp linux-3.7-rc8/drivers/gpu/drm/mach64.orig/mach64_drv.c linux-3.7-rc8/drivers/gpu/drm/mach64/mach64_drv.c ---- linux-3.7-rc8/drivers/gpu/drm/mach64.orig/mach64_drv.c 2012-12-06 19:50:10.000000000 +0200 -+++ linux-3.7-rc8/drivers/gpu/drm/mach64/mach64_drv.c 2012-12-06 20:20:13.062073838 +0200 -@@ -28,12 +28,12 @@ - */ - - #include --#include "drmP.h" --#include "drm.h" -+#include -+#include - #include "mach64_drm.h" - #include "mach64_drv.h" - --#include "drm_pciids.h" -+#include - - static struct pci_device_id pciidlist[] = { - mach64_PCI_IDS -diff -Nurp linux-3.7-rc8/drivers/gpu/drm/mach64.orig/mach64_irq.c linux-3.7-rc8/drivers/gpu/drm/mach64/mach64_irq.c ---- linux-3.7-rc8/drivers/gpu/drm/mach64.orig/mach64_irq.c 2012-12-06 19:50:10.000000000 +0200 -+++ linux-3.7-rc8/drivers/gpu/drm/mach64/mach64_irq.c 2012-12-06 20:20:40.192678476 +0200 -@@ -35,8 +35,8 @@ - * Leif Delgass - */ - --#include "drmP.h" --#include "drm.h" -+#include -+#include - #include "mach64_drm.h" - #include "mach64_drv.h" - -diff -Nurp linux-3.7-rc8/drivers/gpu/drm/mach64.orig/mach64_state.c linux-3.7-rc8/drivers/gpu/drm/mach64/mach64_state.c ---- linux-3.7-rc8/drivers/gpu/drm/mach64.orig/mach64_state.c 2012-12-06 19:50:10.000000000 +0200 -+++ linux-3.7-rc8/drivers/gpu/drm/mach64/mach64_state.c 2012-12-06 20:21:00.783137370 +0200 -@@ -30,8 +30,8 @@ - * José Fonseca - */ - --#include "drmP.h" --#include "drm.h" -+#include -+#include - #include "mach64_drm.h" - #include "mach64_drv.h" - diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-fix-for-changed-drm_ioctl.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-fix-for-changed-drm_ioctl.patch deleted file mode 100644 index 951eabb9..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-fix-for-changed-drm_ioctl.patch +++ /dev/null @@ -1,20 +0,0 @@ -Update mach64 for changes in drm_ioctl done in 2.6.33: -"drm: convert drm_ioctl to unlocked_ioctl" (commit ed8b670) - -Signed-off-by: Herton Ronaldo Krzesinski ---- - drivers/gpu/drm/mach64/mach64_drv.c | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - -diff -p -up linux-2.6.33/drivers/gpu/drm/mach64/mach64_drv.c.orig linux-2.6.33/drivers/gpu/drm/mach64/mach64_drv.c ---- linux-2.6.33/drivers/gpu/drm/mach64/mach64_drv.c.orig 2010-03-16 19:27:22.517068880 -0300 -+++ linux-2.6.33/drivers/gpu/drm/mach64/mach64_drv.c 2010-03-16 19:27:54.890318416 -0300 -@@ -59,7 +59,7 @@ static struct drm_driver driver = { - .owner = THIS_MODULE, - .open = drm_open, - .release = drm_release, -- .ioctl = drm_ioctl, -+ .unlocked_ioctl = drm_ioctl, - .mmap = drm_mmap, - .poll = drm_poll, - .fasync = drm_fasync, diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-fix-for-changed-drm_pci_alloc.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-fix-for-changed-drm_pci_alloc.patch deleted file mode 100644 index b67cecab..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-fix-for-changed-drm_pci_alloc.patch +++ /dev/null @@ -1,12 +0,0 @@ -diff -p -up linux-2.6.32/drivers/gpu/drm/mach64/mach64_dma.c.orig linux-2.6.32/drivers/gpu/drm/mach64/mach64_dma.c ---- linux-2.6.32/drivers/gpu/drm/mach64/mach64_dma.c.orig 2010-01-06 11:35:13.784843304 -0200 -+++ linux-2.6.32/drivers/gpu/drm/mach64/mach64_dma.c 2010-01-06 11:37:50.793843502 -0200 -@@ -835,7 +835,7 @@ static int mach64_bm_dma_test(struct drm - /* FIXME: get a dma buffer from the freelist here */ - DRM_DEBUG("Allocating data memory ...\n"); - cpu_addr_dmah = -- drm_pci_alloc(dev, 0x1000, 0x1000, 0xfffffffful); -+ drm_pci_alloc(dev, 0x1000, 0x1000); - if (!cpu_addr_dmah) { - DRM_INFO("data-memory allocation failed!\n"); - return -ENOMEM; diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-fixes.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-fixes.patch deleted file mode 100644 index 0ea07cd7..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-fixes.patch +++ /dev/null @@ -1,97 +0,0 @@ -Fix/cleanup mach64 drm module for building with current kernel. - -Signed-off-by: Herton Ronaldo Krzesinski - ---- - drivers/gpu/drm/mach64/mach64_dma.c | 9 +-------- - drivers/gpu/drm/mach64/mach64_drv.c | 11 +---------- - drivers/gpu/drm/mach64/mach64_state.c | 4 ++-- - 3 files changed, 4 insertions(+), 20 deletions(-) - -diff -p -up linux-2.6.28/drivers/gpu/drm/mach64/mach64_dma.c.orig linux-2.6.28/drivers/gpu/drm/mach64/mach64_dma.c ---- linux-2.6.28/drivers/gpu/drm/mach64/mach64_dma.c.orig 2008-12-10 12:19:14.000000000 -0500 -+++ linux-2.6.28/drivers/gpu/drm/mach64/mach64_dma.c 2008-12-10 13:34:19.000000000 -0500 -@@ -834,14 +834,8 @@ static int mach64_bm_dma_test(struct drm - - /* FIXME: get a dma buffer from the freelist here */ - DRM_DEBUG("Allocating data memory ...\n"); --#ifdef __FreeBSD__ -- DRM_UNLOCK(); --#endif - cpu_addr_dmah = - drm_pci_alloc(dev, 0x1000, 0x1000, 0xfffffffful); --#ifdef __FreeBSD__ -- DRM_LOCK(); --#endif - if (!cpu_addr_dmah) { - DRM_INFO("data-memory allocation failed!\n"); - return -ENOMEM; -@@ -1375,8 +1369,7 @@ int mach64_do_cleanup_dma(struct drm_dev - * may not have been called from userspace and after dev_private - * is freed, it's too late. - */ -- if (dev->irq) -- drm_irq_uninstall(dev); -+ drm_irq_uninstall(dev); - - if (dev->dev_private) { - drm_mach64_private_t *dev_priv = dev->dev_private; -diff -p -up linux-2.6.28/drivers/gpu/drm/mach64/mach64_drv.c.orig linux-2.6.28/drivers/gpu/drm/mach64/mach64_drv.c ---- linux-2.6.28/drivers/gpu/drm/mach64/mach64_drv.c.orig 2008-12-10 12:13:13.000000000 -0500 -+++ linux-2.6.28/drivers/gpu/drm/mach64/mach64_drv.c 2008-12-10 12:16:54.000000000 -0500 -@@ -38,7 +38,6 @@ static struct pci_device_id pciidlist[] - mach64_PCI_IDS - }; - --static int probe(struct pci_dev *pdev, const struct pci_device_id *ent); - static struct drm_driver driver = { - .driver_features = - DRIVER_USE_AGP | DRIVER_USE_MTRR | DRIVER_PCI_DMA | DRIVER_HAVE_DMA -@@ -68,8 +67,6 @@ static struct drm_driver driver = { - .pci_driver = { - .name = DRIVER_NAME, - .id_table = pciidlist, -- .probe = probe, -- .remove = __devexit_p(drm_cleanup_pci), - }, - - .name = DRIVER_NAME, -@@ -80,16 +77,10 @@ static struct drm_driver driver = { - .patchlevel = DRIVER_PATCHLEVEL, - }; - --static int probe(struct pci_dev *pdev, const struct pci_device_id *ent) --{ -- return drm_get_dev(pdev, ent, &driver); --} -- -- - static int __init mach64_init(void) - { - driver.num_ioctls = mach64_max_ioctl; -- return drm_init(&driver, pciidlist); -+ return drm_init(&driver); - } - - static void __exit mach64_exit(void) -diff -p -up linux-2.6.28/drivers/gpu/drm/mach64/mach64_state.c.orig linux-2.6.28/drivers/gpu/drm/mach64/mach64_state.c ---- linux-2.6.28/drivers/gpu/drm/mach64/mach64_state.c.orig 2008-12-10 12:13:13.000000000 -0500 -+++ linux-2.6.28/drivers/gpu/drm/mach64/mach64_state.c 2008-12-10 13:38:54.000000000 -0500 -@@ -455,7 +455,7 @@ static int mach64_do_get_frames_queued(d - head = ring->head; - - start = (MACH64_MAX_QUEUED_FRAMES - -- DRM_MIN(MACH64_MAX_QUEUED_FRAMES, sarea_priv->frames_queued)); -+ min(MACH64_MAX_QUEUED_FRAMES, sarea_priv->frames_queued)); - - if (head == tail) { - sarea_priv->frames_queued = 0; -@@ -895,7 +895,7 @@ int mach64_get_param(struct drm_device * - value = mach64_do_get_frames_queued(dev_priv); - break; - case MACH64_PARAM_IRQ_NR: -- value = dev->irq; -+ value = drm_dev_to_irq(dev); - break; - default: - return -EINVAL; diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-include-module.h.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-include-module.h.patch deleted file mode 100644 index 9c1163d5..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-include-module.h.patch +++ /dev/null @@ -1,10 +0,0 @@ ---- linux/drivers/gpu/drm/mach64/mach64_drv.c.orig 2011-12-25 00:48:42.814932355 +0200 -+++ linux/drivers/gpu/drm/mach64/mach64_drv.c 2011-12-25 00:47:43.393625260 +0200 -@@ -27,6 +27,7 @@ - * Leif Delgass - */ - -+#include - #include "drmP.h" - #include "drm.h" - #include "mach64_drm.h" diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-linux-3.14-buildfix.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-linux-3.14-buildfix.patch deleted file mode 100644 index 80010d3a..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-linux-3.14-buildfix.patch +++ /dev/null @@ -1,102 +0,0 @@ - -Fix build with kernel-3.14 - -Signed-off-by: Thomas Backlund - - drivers/gpu/drm/mach64/mach64_dma.c | 10 +++++----- - drivers/gpu/drm/mach64/mach64_drv.h | 2 +- - drivers/gpu/drm/mach64/mach64_irq.c | 2 +- - drivers/gpu/drm/mach64/mach64_state.c | 6 +++--- - 4 files changed, 10 insertions(+), 10 deletions(-) - -diff -urp linux/drivers/gpu/drm/mach64.orig/mach64_dma.c linux/drivers/gpu/drm/mach64/mach64_dma.c ---- linux/drivers/gpu/drm/mach64.orig/mach64_dma.c 2014-04-26 19:10:55.000000000 +0300 -+++ linux/drivers/gpu/drm/mach64/mach64_dma.c 2014-04-26 20:26:05.263501325 +0300 -@@ -696,9 +696,9 @@ do { \ - DRM_INFO( "ADVANCE_RING() wr=0x%06x tail=0x%06x\n", \ - _ring_write, _ring_tail ); \ - } \ -- DRM_MEMORYBARRIER(); \ -+ mb(); \ - mach64_clear_dma_eol( &_ring[(_ring_tail - 2) & _ring_mask] ); \ -- DRM_MEMORYBARRIER(); \ -+ mb(); \ - dev_priv->ring.tail = _ring_write; \ - mach64_ring_tick( dev_priv, &(dev_priv)->ring ); \ - } while (0) -@@ -912,7 +912,7 @@ static int mach64_bm_dma_test(struct drm - DRM_DEBUG(" data[%d] = 0x%08x\n", i, data[i]); - } - -- DRM_MEMORYBARRIER(); -+ mb(); - - DRM_DEBUG("waiting for idle...\n"); - if ((i = mach64_do_wait_for_idle(dev_priv))) { -@@ -1716,10 +1716,10 @@ static int mach64_dma_get_buffers(struct - - buf->file_priv = file_priv; - -- if (DRM_COPY_TO_USER(&d->request_indices[i], &buf->idx, -+ if (copy_to_user(&d->request_indices[i], &buf->idx, - sizeof(buf->idx))) - return -EFAULT; -- if (DRM_COPY_TO_USER(&d->request_sizes[i], &buf->total, -+ if (copy_to_user(&d->request_sizes[i], &buf->total, - sizeof(buf->total))) - return -EFAULT; - -diff -urp linux/drivers/gpu/drm/mach64.orig/mach64_drv.h linux/drivers/gpu/drm/mach64/mach64_drv.h ---- linux/drivers/gpu/drm/mach64.orig/mach64_drv.h 2014-04-26 19:10:55.000000000 +0300 -+++ linux/drivers/gpu/drm/mach64/mach64_drv.h 2014-04-26 20:28:43.693457652 +0300 -@@ -166,7 +166,7 @@ extern int mach64_get_param(struct drm_d - extern u32 mach64_get_vblank_counter(struct drm_device *dev, int crtc); - extern int mach64_enable_vblank(struct drm_device *dev, int crtc); - extern void mach64_disable_vblank(struct drm_device *dev, int crtc); --extern irqreturn_t mach64_driver_irq_handler(DRM_IRQ_ARGS); -+extern irqreturn_t mach64_driver_irq_handler(int irq, void *arg); - extern void mach64_driver_irq_preinstall(struct drm_device *dev); - extern int mach64_driver_irq_postinstall(struct drm_device *dev); - extern void mach64_driver_irq_uninstall(struct drm_device *dev); -diff -urp linux/drivers/gpu/drm/mach64.orig/mach64_irq.c linux/drivers/gpu/drm/mach64/mach64_irq.c ---- linux/drivers/gpu/drm/mach64.orig/mach64_irq.c 2014-04-26 19:10:55.000000000 +0300 -+++ linux/drivers/gpu/drm/mach64/mach64_irq.c 2014-04-26 20:32:01.464898140 +0300 -@@ -40,7 +40,7 @@ - #include "mach64_drm.h" - #include "mach64_drv.h" - --irqreturn_t mach64_driver_irq_handler(DRM_IRQ_ARGS) -+irqreturn_t mach64_driver_irq_handler(int irq, void *arg) - { - struct drm_device *dev = arg; - drm_mach64_private_t *dev_priv = dev->dev_private; -diff -urp linux/drivers/gpu/drm/mach64.orig/mach64_state.c linux/drivers/gpu/drm/mach64/mach64_state.c ---- linux/drivers/gpu/drm/mach64.orig/mach64_state.c 2014-04-26 19:10:55.000000000 +0300 -+++ linux/drivers/gpu/drm/mach64/mach64_state.c 2014-04-26 20:07:16.701527488 +0300 -@@ -494,7 +494,7 @@ static __inline__ int copy_from_user_ver - if (from == NULL) - return -ENOMEM; - -- if (DRM_COPY_FROM_USER(from, ufrom, bytes)) { -+ if (copy_from_user(from, ufrom, bytes)) { - kfree(from); - return -EFAULT; - } -@@ -640,7 +640,7 @@ static __inline__ int copy_from_user_bli - { - to = (u32 *)((char *)to + MACH64_HOSTDATA_BLIT_OFFSET); - -- if (DRM_COPY_FROM_USER(to, ufrom, bytes)) { -+ if (copy_from_user(to, ufrom, bytes)) { - return -EFAULT; - } - -@@ -901,7 +901,7 @@ int mach64_get_param(struct drm_device * - return -EINVAL; - } - -- if (DRM_COPY_TO_USER(param->value, &value, sizeof(int))) { -+ if (copy_to_user(param->value, &value, sizeof(int))) { - DRM_ERROR("copy_to_user\n"); - return -EFAULT; - } diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-restore-mach64_PCI_IDS.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64-restore-mach64_PCI_IDS.patch deleted file mode 100644 index 651d7631..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64-restore-mach64_PCI_IDS.patch +++ /dev/null @@ -1,38 +0,0 @@ -Theese got dropped in 3.12-rc - -Restore for now to get the mach64 driver to build - -TODO: Need to check mesa & drm if it's dropped there too... - ---- linux/include/drm/drm_pciids.h.orig 2013-10-13 11:05:33.000000000 +0300 -+++ linux/include/drm/drm_pciids.h 2013-10-13 14:30:43.625995248 +0300 -@@ -711,6 +711,29 @@ - {0x102b, 0x2527, PCI_ANY_ID, PCI_ANY_ID, 0, 0, MGA_CARD_TYPE_G550}, \ - {0, 0, 0} - -+#define mach64_PCI_IDS \ -+ {0x1002, 0x4749, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4750, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4751, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4742, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4744, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4c49, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4c50, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4c51, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4c42, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4c44, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x474c, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x474f, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4752, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4753, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x474d, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x474e, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4c52, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4c53, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4c4d, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0x1002, 0x4c4e, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ -+ {0, 0, 0} -+ - #define sisdrv_PCI_IDS \ - {0x1039, 0x0300, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ - {0x1039, 0x5300, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, \ diff --git a/kernel/kernel/files/patches/mageia/gpu-drm-mach64.patch b/kernel/kernel/files/patches/mageia/gpu-drm-mach64.patch deleted file mode 100644 index 409981fc..00000000 --- a/kernel/kernel/files/patches/mageia/gpu-drm-mach64.patch +++ /dev/null @@ -1,4144 +0,0 @@ -mach64 driver from git://anongit.freedesktop.org/git/mesa/drm -head: c99566fb810c9d8cae5e9cd39d1772b55e2f514c - ---- - drivers/gpu/drm/Kconfig | 11 - drivers/gpu/drm/Makefile | 1 - drivers/gpu/drm/mach64/Makefile | 8 - drivers/gpu/drm/Kconfig | 11 - drivers/gpu/drm/Makefile | 1 - drivers/gpu/drm/mach64/Makefile | 8 - drivers/gpu/drm/mach64/mach64_dma.c | 1778 ++++++++++++++++++++++++++++++++++ - drivers/gpu/drm/mach64/mach64_drm.h | 256 ++++ - drivers/gpu/drm/mach64/mach64_drv.c | 105 ++ - drivers/gpu/drm/mach64/mach64_drv.h | 859 ++++++++++++++++ - drivers/gpu/drm/mach64/mach64_irq.c | 159 +++ - drivers/gpu/drm/mach64/mach64_state.c | 910 +++++++++++++++++ - 9 files changed, 4087 insertions(+) - ---- /dev/null -+++ b/drivers/gpu/drm/mach64/Makefile -@@ -0,0 +1,8 @@ -+# -+# Makefile for the drm device driver. This driver provides support for the -+# Direct Rendering Infrastructure (DRI) in XFree86 4.1.0 and higher. -+ -+ccflags-y = -Iinclude/drm -+mach64-y := mach64_drv.o mach64_dma.o mach64_irq.o mach64_state.o -+ -+obj-$(CONFIG_DRM_MACH64) += mach64.o ---- /dev/null -+++ b/drivers/gpu/drm/mach64/mach64_dma.c -@@ -0,0 +1,1778 @@ -+/* mach64_dma.c -- DMA support for mach64 (Rage Pro) driver -*- linux-c -*- */ -+/** -+ * \file mach64_dma.c -+ * DMA support for mach64 (Rage Pro) driver -+ * -+ * \author Gareth Hughes -+ * \author Frank C. Earl -+ * \author Leif Delgass -+ * \author José Fonseca -+ */ -+ -+/* -+ * Copyright 2000 Gareth Hughes -+ * Copyright 2002 Frank C. Earl -+ * Copyright 2002-2003 Leif Delgass -+ * All Rights Reserved. -+ * -+ * Permission is hereby granted, free of charge, to any person obtaining a -+ * copy of this software and associated documentation files (the "Software"), -+ * to deal in the Software without restriction, including without limitation -+ * the rights to use, copy, modify, merge, publish, distribute, sublicense, -+ * and/or sell copies of the Software, and to permit persons to whom the -+ * Software is furnished to do so, subject to the following conditions: -+ * -+ * The above copyright notice and this permission notice (including the next -+ * paragraph) shall be included in all copies or substantial portions of the -+ * Software. -+ * -+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR -+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, -+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL -+ * THE COPYRIGHT OWNER(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER -+ * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN -+ * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. -+ */ -+ -+#include "drmP.h" -+#include "drm.h" -+#include "mach64_drm.h" -+#include "mach64_drv.h" -+ -+/*******************************************************************/ -+/** \name Engine, FIFO control */ -+/*@{*/ -+ -+/** -+ * Waits for free entries in the FIFO. -+ * -+ * \note Most writes to Mach64 registers are automatically routed through -+ * command FIFO which is 16 entry deep. Prior to writing to any draw engine -+ * register one has to ensure that enough FIFO entries are available by calling -+ * this function. Failure to do so may cause the engine to lock. -+ * -+ * \param dev_priv pointer to device private data structure. -+ * \param entries number of free entries in the FIFO to wait for. -+ * -+ * \returns zero on success, or -EBUSY if the timeout (specificed by -+ * drm_mach64_private::usec_timeout) occurs. -+ */ -+int mach64_do_wait_for_fifo(drm_mach64_private_t *dev_priv, int entries) -+{ -+ int slots = 0, i; -+ -+ for (i = 0; i < dev_priv->usec_timeout; i++) { -+ slots = (MACH64_READ(MACH64_FIFO_STAT) & MACH64_FIFO_SLOT_MASK); -+ if (slots <= (0x8000 >> entries)) -+ return 0; -+ DRM_UDELAY(1); -+ } -+ -+ DRM_INFO("failed! slots=%d entries=%d\n", slots, entries); -+ return -EBUSY; -+} -+ -+/** -+ * Wait for the draw engine to be idle. -+ */ -+int mach64_do_wait_for_idle(drm_mach64_private_t *dev_priv) -+{ -+ int i, ret; -+ -+ ret = mach64_do_wait_for_fifo(dev_priv, 16); -+ if (ret < 0) -+ return ret; -+ -+ for (i = 0; i < dev_priv->usec_timeout; i++) { -+ if (!(MACH64_READ(MACH64_GUI_STAT) & MACH64_GUI_ACTIVE)) -+ return 0; -+ DRM_UDELAY(1); -+ } -+ -+ DRM_INFO("failed! GUI_STAT=0x%08x\n", MACH64_READ(MACH64_GUI_STAT)); -+ mach64_dump_ring_info(dev_priv); -+ return -EBUSY; -+} -+ -+/** -+ * Wait for free entries in the ring buffer. -+ * -+ * The Mach64 bus master can be configured to act as a virtual FIFO, using a -+ * circular buffer (commonly referred as "ring buffer" in other drivers) with -+ * pointers to engine commands. This allows the CPU to do other things while -+ * the graphics engine is busy, i.e., DMA mode. -+ * -+ * This function should be called before writing new entries to the ring -+ * buffer. -+ * -+ * \param dev_priv pointer to device private data structure. -+ * \param n number of free entries in the ring buffer to wait for. -+ * -+ * \returns zero on success, or -EBUSY if the timeout (specificed by -+ * drm_mach64_private_t::usec_timeout) occurs. -+ * -+ * \sa mach64_dump_ring_info() -+ */ -+int mach64_wait_ring(drm_mach64_private_t *dev_priv, int n) -+{ -+ drm_mach64_descriptor_ring_t *ring = &dev_priv->ring; -+ int i; -+ -+ for (i = 0; i < dev_priv->usec_timeout; i++) { -+ mach64_update_ring_snapshot(dev_priv); -+ if (ring->space >= n) { -+ if (i > 0) -+ DRM_DEBUG("%d usecs\n", i); -+ return 0; -+ } -+ DRM_UDELAY(1); -+ } -+ -+ /* FIXME: This is being ignored... */ -+ DRM_ERROR("failed!\n"); -+ mach64_dump_ring_info(dev_priv); -+ return -EBUSY; -+} -+ -+/** -+ * Wait until all DMA requests have been processed... -+ * -+ * \sa mach64_wait_ring() -+ */ -+static int mach64_ring_idle(drm_mach64_private_t *dev_priv) -+{ -+ drm_mach64_descriptor_ring_t *ring = &dev_priv->ring; -+ u32 head; -+ int i; -+ -+ head = ring->head; -+ i = 0; -+ while (i < dev_priv->usec_timeout) { -+ mach64_update_ring_snapshot(dev_priv); -+ if (ring->head == ring->tail && -+ !(MACH64_READ(MACH64_GUI_STAT) & MACH64_GUI_ACTIVE)) { -+ if (i > 0) -+ DRM_DEBUG("%d usecs\n", i); -+ return 0; -+ } -+ if (ring->head == head) { -+ ++i; -+ } else { -+ head = ring->head; -+ i = 0; -+ } -+ DRM_UDELAY(1); -+ } -+ -+ DRM_INFO("failed! GUI_STAT=0x%08x\n", MACH64_READ(MACH64_GUI_STAT)); -+ mach64_dump_ring_info(dev_priv); -+ return -EBUSY; -+} -+ -+/** -+ * Reset the the ring buffer descriptors. -+ * -+ * \sa mach64_do_engine_reset() -+ */ -+static void mach64_ring_reset(drm_mach64_private_t *dev_priv) -+{ -+ drm_mach64_descriptor_ring_t *ring = &dev_priv->ring; -+ -+ mach64_do_release_used_buffers(dev_priv); -+ ring->head_addr = ring->start_addr; -+ ring->head = ring->tail = 0; -+ ring->space = ring->size; -+ -+ MACH64_WRITE(MACH64_BM_GUI_TABLE_CMD, -+ ring->head_addr | MACH64_CIRCULAR_BUF_SIZE_16KB); -+ -+ dev_priv->ring_running = 0; -+} -+ -+/** -+ * Ensure the all the queued commands will be processed. -+ */ -+int mach64_do_dma_flush(drm_mach64_private_t *dev_priv) -+{ -+ /* FIXME: It's not necessary to wait for idle when flushing -+ * we just need to ensure the ring will be completely processed -+ * in finite time without another ioctl -+ */ -+ return mach64_ring_idle(dev_priv); -+} -+ -+/** -+ * Stop all DMA activity. -+ */ -+int mach64_do_dma_idle(drm_mach64_private_t *dev_priv) -+{ -+ int ret; -+ -+ /* wait for completion */ -+ if ((ret = mach64_ring_idle(dev_priv)) < 0) { -+ DRM_ERROR("failed BM_GUI_TABLE=0x%08x tail: %u\n", -+ MACH64_READ(MACH64_BM_GUI_TABLE), -+ dev_priv->ring.tail); -+ return ret; -+ } -+ -+ mach64_ring_stop(dev_priv); -+ -+ /* clean up after pass */ -+ mach64_do_release_used_buffers(dev_priv); -+ return 0; -+} -+ -+/** -+ * Reset the engine. This will stop the DMA if it is running. -+ */ -+int mach64_do_engine_reset(drm_mach64_private_t *dev_priv) -+{ -+ u32 tmp; -+ -+ DRM_DEBUG("\n"); -+ -+ /* Kill off any outstanding DMA transfers. -+ */ -+ tmp = MACH64_READ(MACH64_BUS_CNTL); -+ MACH64_WRITE(MACH64_BUS_CNTL, tmp | MACH64_BUS_MASTER_DIS); -+ -+ /* Reset the GUI engine (high to low transition). -+ */ -+ tmp = MACH64_READ(MACH64_GEN_TEST_CNTL); -+ MACH64_WRITE(MACH64_GEN_TEST_CNTL, tmp & ~MACH64_GUI_ENGINE_ENABLE); -+ /* Enable the GUI engine -+ */ -+ tmp = MACH64_READ(MACH64_GEN_TEST_CNTL); -+ MACH64_WRITE(MACH64_GEN_TEST_CNTL, tmp | MACH64_GUI_ENGINE_ENABLE); -+ -+ /* ensure engine is not locked up by clearing any FIFO or HOST errors -+ */ -+ tmp = MACH64_READ(MACH64_BUS_CNTL); -+ MACH64_WRITE(MACH64_BUS_CNTL, tmp | 0x00a00000); -+ -+ /* Once GUI engine is restored, disable bus mastering */ -+ MACH64_WRITE(MACH64_SRC_CNTL, 0); -+ -+ /* Reset descriptor ring */ -+ mach64_ring_reset(dev_priv); -+ -+ return 0; -+} -+ -+/*@}*/ -+ -+ -+/*******************************************************************/ -+/** \name Debugging output */ -+/*@{*/ -+ -+/** -+ * Dump engine registers values. -+ */ -+void mach64_dump_engine_info(drm_mach64_private_t *dev_priv) -+{ -+ DRM_INFO("\n"); -+ if (!dev_priv->is_pci) { -+ DRM_INFO(" AGP_BASE = 0x%08x\n", -+ MACH64_READ(MACH64_AGP_BASE)); -+ DRM_INFO(" AGP_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_AGP_CNTL)); -+ } -+ DRM_INFO(" ALPHA_TST_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_ALPHA_TST_CNTL)); -+ DRM_INFO("\n"); -+ DRM_INFO(" BM_COMMAND = 0x%08x\n", -+ MACH64_READ(MACH64_BM_COMMAND)); -+ DRM_INFO("BM_FRAME_BUF_OFFSET = 0x%08x\n", -+ MACH64_READ(MACH64_BM_FRAME_BUF_OFFSET)); -+ DRM_INFO(" BM_GUI_TABLE = 0x%08x\n", -+ MACH64_READ(MACH64_BM_GUI_TABLE)); -+ DRM_INFO(" BM_STATUS = 0x%08x\n", -+ MACH64_READ(MACH64_BM_STATUS)); -+ DRM_INFO(" BM_SYSTEM_MEM_ADDR = 0x%08x\n", -+ MACH64_READ(MACH64_BM_SYSTEM_MEM_ADDR)); -+ DRM_INFO(" BM_SYSTEM_TABLE = 0x%08x\n", -+ MACH64_READ(MACH64_BM_SYSTEM_TABLE)); -+ DRM_INFO(" BUS_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_BUS_CNTL)); -+ DRM_INFO("\n"); -+ /* DRM_INFO( " CLOCK_CNTL = 0x%08x\n", MACH64_READ( MACH64_CLOCK_CNTL ) ); */ -+ DRM_INFO(" CLR_CMP_CLR = 0x%08x\n", -+ MACH64_READ(MACH64_CLR_CMP_CLR)); -+ DRM_INFO(" CLR_CMP_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_CLR_CMP_CNTL)); -+ /* DRM_INFO( " CLR_CMP_MSK = 0x%08x\n", MACH64_READ( MACH64_CLR_CMP_MSK ) ); */ -+ DRM_INFO(" CONFIG_CHIP_ID = 0x%08x\n", -+ MACH64_READ(MACH64_CONFIG_CHIP_ID)); -+ DRM_INFO(" CONFIG_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_CONFIG_CNTL)); -+ DRM_INFO(" CONFIG_STAT0 = 0x%08x\n", -+ MACH64_READ(MACH64_CONFIG_STAT0)); -+ DRM_INFO(" CONFIG_STAT1 = 0x%08x\n", -+ MACH64_READ(MACH64_CONFIG_STAT1)); -+ DRM_INFO(" CONFIG_STAT2 = 0x%08x\n", -+ MACH64_READ(MACH64_CONFIG_STAT2)); -+ DRM_INFO(" CRC_SIG = 0x%08x\n", MACH64_READ(MACH64_CRC_SIG)); -+ DRM_INFO(" CUSTOM_MACRO_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_CUSTOM_MACRO_CNTL)); -+ DRM_INFO("\n"); -+ /* DRM_INFO( " DAC_CNTL = 0x%08x\n", MACH64_READ( MACH64_DAC_CNTL ) ); */ -+ /* DRM_INFO( " DAC_REGS = 0x%08x\n", MACH64_READ( MACH64_DAC_REGS ) ); */ -+ DRM_INFO(" DP_BKGD_CLR = 0x%08x\n", -+ MACH64_READ(MACH64_DP_BKGD_CLR)); -+ DRM_INFO(" DP_FRGD_CLR = 0x%08x\n", -+ MACH64_READ(MACH64_DP_FRGD_CLR)); -+ DRM_INFO(" DP_MIX = 0x%08x\n", MACH64_READ(MACH64_DP_MIX)); -+ DRM_INFO(" DP_PIX_WIDTH = 0x%08x\n", -+ MACH64_READ(MACH64_DP_PIX_WIDTH)); -+ DRM_INFO(" DP_SRC = 0x%08x\n", MACH64_READ(MACH64_DP_SRC)); -+ DRM_INFO(" DP_WRITE_MASK = 0x%08x\n", -+ MACH64_READ(MACH64_DP_WRITE_MASK)); -+ DRM_INFO(" DSP_CONFIG = 0x%08x\n", -+ MACH64_READ(MACH64_DSP_CONFIG)); -+ DRM_INFO(" DSP_ON_OFF = 0x%08x\n", -+ MACH64_READ(MACH64_DSP_ON_OFF)); -+ DRM_INFO(" DST_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_DST_CNTL)); -+ DRM_INFO(" DST_OFF_PITCH = 0x%08x\n", -+ MACH64_READ(MACH64_DST_OFF_PITCH)); -+ DRM_INFO("\n"); -+ /* DRM_INFO( " EXT_DAC_REGS = 0x%08x\n", MACH64_READ( MACH64_EXT_DAC_REGS ) ); */ -+ DRM_INFO(" EXT_MEM_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_EXT_MEM_CNTL)); -+ DRM_INFO("\n"); -+ DRM_INFO(" FIFO_STAT = 0x%08x\n", -+ MACH64_READ(MACH64_FIFO_STAT)); -+ DRM_INFO("\n"); -+ DRM_INFO(" GEN_TEST_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_GEN_TEST_CNTL)); -+ /* DRM_INFO( " GP_IO = 0x%08x\n", MACH64_READ( MACH64_GP_IO ) ); */ -+ DRM_INFO(" GUI_CMDFIFO_DATA = 0x%08x\n", -+ MACH64_READ(MACH64_GUI_CMDFIFO_DATA)); -+ DRM_INFO(" GUI_CMDFIFO_DEBUG = 0x%08x\n", -+ MACH64_READ(MACH64_GUI_CMDFIFO_DEBUG)); -+ DRM_INFO(" GUI_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_GUI_CNTL)); -+ DRM_INFO(" GUI_STAT = 0x%08x\n", -+ MACH64_READ(MACH64_GUI_STAT)); -+ DRM_INFO(" GUI_TRAJ_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_GUI_TRAJ_CNTL)); -+ DRM_INFO("\n"); -+ DRM_INFO(" HOST_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_HOST_CNTL)); -+ DRM_INFO(" HW_DEBUG = 0x%08x\n", -+ MACH64_READ(MACH64_HW_DEBUG)); -+ DRM_INFO("\n"); -+ DRM_INFO(" MEM_ADDR_CONFIG = 0x%08x\n", -+ MACH64_READ(MACH64_MEM_ADDR_CONFIG)); -+ DRM_INFO(" MEM_BUF_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_MEM_BUF_CNTL)); -+ DRM_INFO("\n"); -+ DRM_INFO(" PAT_REG0 = 0x%08x\n", -+ MACH64_READ(MACH64_PAT_REG0)); -+ DRM_INFO(" PAT_REG1 = 0x%08x\n", -+ MACH64_READ(MACH64_PAT_REG1)); -+ DRM_INFO("\n"); -+ DRM_INFO(" SC_LEFT = 0x%08x\n", MACH64_READ(MACH64_SC_LEFT)); -+ DRM_INFO(" SC_RIGHT = 0x%08x\n", -+ MACH64_READ(MACH64_SC_RIGHT)); -+ DRM_INFO(" SC_TOP = 0x%08x\n", MACH64_READ(MACH64_SC_TOP)); -+ DRM_INFO(" SC_BOTTOM = 0x%08x\n", -+ MACH64_READ(MACH64_SC_BOTTOM)); -+ DRM_INFO("\n"); -+ DRM_INFO(" SCALE_3D_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_SCALE_3D_CNTL)); -+ DRM_INFO(" SCRATCH_REG0 = 0x%08x\n", -+ MACH64_READ(MACH64_SCRATCH_REG0)); -+ DRM_INFO(" SCRATCH_REG1 = 0x%08x\n", -+ MACH64_READ(MACH64_SCRATCH_REG1)); -+ DRM_INFO(" SETUP_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_SETUP_CNTL)); -+ DRM_INFO(" SRC_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_SRC_CNTL)); -+ DRM_INFO("\n"); -+ DRM_INFO(" TEX_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_TEX_CNTL)); -+ DRM_INFO(" TEX_SIZE_PITCH = 0x%08x\n", -+ MACH64_READ(MACH64_TEX_SIZE_PITCH)); -+ DRM_INFO(" TIMER_CONFIG = 0x%08x\n", -+ MACH64_READ(MACH64_TIMER_CONFIG)); -+ DRM_INFO("\n"); -+ DRM_INFO(" Z_CNTL = 0x%08x\n", MACH64_READ(MACH64_Z_CNTL)); -+ DRM_INFO(" Z_OFF_PITCH = 0x%08x\n", -+ MACH64_READ(MACH64_Z_OFF_PITCH)); -+ DRM_INFO("\n"); -+} -+ -+#define MACH64_DUMP_CONTEXT 3 -+ -+/** -+ * Used by mach64_dump_ring_info() to dump the contents of the current buffer -+ * pointed by the ring head. -+ */ -+static void mach64_dump_buf_info(drm_mach64_private_t *dev_priv, -+ struct drm_buf *buf) -+{ -+ u32 addr = GETBUFADDR(buf); -+ u32 used = buf->used >> 2; -+ u32 sys_addr = MACH64_READ(MACH64_BM_SYSTEM_MEM_ADDR); -+ u32 *p = GETBUFPTR(buf); -+ int skipped = 0; -+ -+ DRM_INFO("buffer contents:\n"); -+ -+ while (used) { -+ u32 reg, count; -+ -+ reg = le32_to_cpu(*p++); -+ if (addr <= GETBUFADDR(buf) + MACH64_DUMP_CONTEXT * 4 || -+ (addr >= sys_addr - MACH64_DUMP_CONTEXT * 4 && -+ addr <= sys_addr + MACH64_DUMP_CONTEXT * 4) || -+ addr >= -+ GETBUFADDR(buf) + buf->used - MACH64_DUMP_CONTEXT * 4) { -+ DRM_INFO("%08x: 0x%08x\n", addr, reg); -+ } -+ addr += 4; -+ used--; -+ -+ count = (reg >> 16) + 1; -+ reg = reg & 0xffff; -+ reg = MMSELECT(reg); -+ while (count && used) { -+ if (addr <= GETBUFADDR(buf) + MACH64_DUMP_CONTEXT * 4 || -+ (addr >= sys_addr - MACH64_DUMP_CONTEXT * 4 && -+ addr <= sys_addr + MACH64_DUMP_CONTEXT * 4) || -+ addr >= -+ GETBUFADDR(buf) + buf->used - -+ MACH64_DUMP_CONTEXT * 4) { -+ DRM_INFO("%08x: 0x%04x = 0x%08x\n", addr, -+ reg, le32_to_cpu(*p)); -+ skipped = 0; -+ } else { -+ if (!skipped) { -+ DRM_INFO(" ...\n"); -+ skipped = 1; -+ } -+ } -+ p++; -+ addr += 4; -+ used--; -+ -+ reg += 4; -+ count--; -+ } -+ } -+ -+ DRM_INFO("\n"); -+} -+ -+/** -+ * Dump the ring state and contents, including the contents of the buffer being -+ * processed by the graphics engine. -+ */ -+void mach64_dump_ring_info(drm_mach64_private_t *dev_priv) -+{ -+ drm_mach64_descriptor_ring_t *ring = &dev_priv->ring; -+ int i, skipped; -+ -+ DRM_INFO("\n"); -+ -+ DRM_INFO("ring contents:\n"); -+ DRM_INFO(" head_addr: 0x%08x head: %u tail: %u\n\n", -+ ring->head_addr, ring->head, ring->tail); -+ -+ skipped = 0; -+ for (i = 0; i < ring->size / sizeof(u32); i += 4) { -+ if (i <= MACH64_DUMP_CONTEXT * 4 || -+ i >= ring->size / sizeof(u32) - MACH64_DUMP_CONTEXT * 4 || -+ (i >= ring->tail - MACH64_DUMP_CONTEXT * 4 && -+ i <= ring->tail + MACH64_DUMP_CONTEXT * 4) || -+ (i >= ring->head - MACH64_DUMP_CONTEXT * 4 && -+ i <= ring->head + MACH64_DUMP_CONTEXT * 4)) { -+ DRM_INFO(" 0x%08x: 0x%08x 0x%08x 0x%08x 0x%08x%s%s\n", -+ (u32)(ring->start_addr + i * sizeof(u32)), -+ le32_to_cpu(((u32 *) ring->start)[i + 0]), -+ le32_to_cpu(((u32 *) ring->start)[i + 1]), -+ le32_to_cpu(((u32 *) ring->start)[i + 2]), -+ le32_to_cpu(((u32 *) ring->start)[i + 3]), -+ i == ring->head ? " (head)" : "", -+ i == ring->tail ? " (tail)" : ""); -+ skipped = 0; -+ } else { -+ if (!skipped) { -+ DRM_INFO(" ...\n"); -+ skipped = 1; -+ } -+ } -+ } -+ -+ DRM_INFO("\n"); -+ -+ if (ring->head >= 0 && ring->head < ring->size / sizeof(u32)) { -+ struct list_head *ptr; -+ u32 addr = le32_to_cpu(((u32 *) ring->start)[ring->head + 1]); -+ -+ list_for_each(ptr, &dev_priv->pending) { -+ drm_mach64_freelist_t *entry = -+ list_entry(ptr, drm_mach64_freelist_t, list); -+ struct drm_buf *buf = entry->buf; -+ -+ u32 buf_addr = GETBUFADDR(buf); -+ -+ if (buf_addr <= addr && addr < buf_addr + buf->used) -+ mach64_dump_buf_info(dev_priv, buf); -+ } -+ } -+ -+ DRM_INFO("\n"); -+ DRM_INFO(" BM_GUI_TABLE = 0x%08x\n", -+ MACH64_READ(MACH64_BM_GUI_TABLE)); -+ DRM_INFO("\n"); -+ DRM_INFO("BM_FRAME_BUF_OFFSET = 0x%08x\n", -+ MACH64_READ(MACH64_BM_FRAME_BUF_OFFSET)); -+ DRM_INFO(" BM_SYSTEM_MEM_ADDR = 0x%08x\n", -+ MACH64_READ(MACH64_BM_SYSTEM_MEM_ADDR)); -+ DRM_INFO(" BM_COMMAND = 0x%08x\n", -+ MACH64_READ(MACH64_BM_COMMAND)); -+ DRM_INFO("\n"); -+ DRM_INFO(" BM_STATUS = 0x%08x\n", -+ MACH64_READ(MACH64_BM_STATUS)); -+ DRM_INFO(" BUS_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_BUS_CNTL)); -+ DRM_INFO(" FIFO_STAT = 0x%08x\n", -+ MACH64_READ(MACH64_FIFO_STAT)); -+ DRM_INFO(" GUI_STAT = 0x%08x\n", -+ MACH64_READ(MACH64_GUI_STAT)); -+ DRM_INFO(" SRC_CNTL = 0x%08x\n", -+ MACH64_READ(MACH64_SRC_CNTL)); -+} -+ -+/*@}*/ -+ -+ -+/*******************************************************************/ -+/** \name DMA descriptor ring macros */ -+/*@{*/ -+ -+/** -+ * Add the end mark to the ring's new tail position. -+ * -+ * The bus master engine will keep processing the DMA buffers listed in the ring -+ * until it finds this mark, making it stop. -+ * -+ * \sa mach64_clear_dma_eol -+ */ -+static __inline__ void mach64_set_dma_eol(volatile u32 *addr) -+{ -+#if defined(__i386__) -+ int nr = 31; -+ -+ /* Taken from include/asm-i386/bitops.h linux header */ -+ __asm__ __volatile__("lock;" "btsl %1,%0":"=m"(*addr) -+ :"Ir"(nr)); -+#elif defined(__powerpc__) -+ u32 old; -+ u32 mask = cpu_to_le32(MACH64_DMA_EOL); -+ -+ /* Taken from the include/asm-ppc/bitops.h linux header */ -+ __asm__ __volatile__("\n\ -+1: lwarx %0,0,%3 \n\ -+ or %0,%0,%2 \n\ -+ stwcx. %0,0,%3 \n\ -+ bne- 1b":"=&r"(old), "=m"(*addr) -+ :"r"(mask), "r"(addr), "m"(*addr) -+ :"cc"); -+#elif defined(__alpha__) -+ u32 temp; -+ u32 mask = MACH64_DMA_EOL; -+ -+ /* Taken from the include/asm-alpha/bitops.h linux header */ -+ __asm__ __volatile__("1: ldl_l %0,%3\n" -+ " bis %0,%2,%0\n" -+ " stl_c %0,%1\n" -+ " beq %0,2f\n" -+ ".subsection 2\n" -+ "2: br 1b\n" -+ ".previous":"=&r"(temp), "=m"(*addr) -+ :"Ir"(mask), "m"(*addr)); -+#else -+ u32 mask = cpu_to_le32(MACH64_DMA_EOL); -+ -+ *addr |= mask; -+#endif -+} -+ -+/** -+ * Remove the end mark from the ring's old tail position. -+ * -+ * It should be called after calling mach64_set_dma_eol to mark the ring's new -+ * tail position. -+ * -+ * We update the end marks while the bus master engine is in operation. Since -+ * the bus master engine may potentially be reading from the same position -+ * that we write, we must change atomically to avoid having intermediary bad -+ * data. -+ */ -+static __inline__ void mach64_clear_dma_eol(volatile u32 *addr) -+{ -+#if defined(__i386__) -+ int nr = 31; -+ -+ /* Taken from include/asm-i386/bitops.h linux header */ -+ __asm__ __volatile__("lock;" "btrl %1,%0":"=m"(*addr) -+ :"Ir"(nr)); -+#elif defined(__powerpc__) -+ u32 old; -+ u32 mask = cpu_to_le32(MACH64_DMA_EOL); -+ -+ /* Taken from the include/asm-ppc/bitops.h linux header */ -+ __asm__ __volatile__("\n\ -+1: lwarx %0,0,%3 \n\ -+ andc %0,%0,%2 \n\ -+ stwcx. %0,0,%3 \n\ -+ bne- 1b":"=&r"(old), "=m"(*addr) -+ :"r"(mask), "r"(addr), "m"(*addr) -+ :"cc"); -+#elif defined(__alpha__) -+ u32 temp; -+ u32 mask = ~MACH64_DMA_EOL; -+ -+ /* Taken from the include/asm-alpha/bitops.h linux header */ -+ __asm__ __volatile__("1: ldl_l %0,%3\n" -+ " and %0,%2,%0\n" -+ " stl_c %0,%1\n" -+ " beq %0,2f\n" -+ ".subsection 2\n" -+ "2: br 1b\n" -+ ".previous":"=&r"(temp), "=m"(*addr) -+ :"Ir"(mask), "m"(*addr)); -+#else -+ u32 mask = cpu_to_le32(~MACH64_DMA_EOL); -+ -+ *addr &= mask; -+#endif -+} -+ -+#define RING_LOCALS \ -+ int _ring_tail, _ring_write; unsigned int _ring_mask; volatile u32 *_ring -+ -+#define RING_WRITE_OFS _ring_write -+ -+#define BEGIN_RING(n) \ -+ do { \ -+ if (MACH64_VERBOSE) { \ -+ DRM_INFO( "BEGIN_RING( %d ) \n", \ -+ (n) ); \ -+ } \ -+ if (dev_priv->ring.space <= (n) * sizeof(u32)) { \ -+ int ret; \ -+ if ((ret = mach64_wait_ring( dev_priv, (n) * sizeof(u32))) < 0 ) { \ -+ DRM_ERROR( "wait_ring failed, resetting engine\n"); \ -+ mach64_dump_engine_info( dev_priv ); \ -+ mach64_do_engine_reset( dev_priv ); \ -+ return ret; \ -+ } \ -+ } \ -+ dev_priv->ring.space -= (n) * sizeof(u32); \ -+ _ring = (u32 *) dev_priv->ring.start; \ -+ _ring_tail = _ring_write = dev_priv->ring.tail; \ -+ _ring_mask = dev_priv->ring.tail_mask; \ -+ } while (0) -+ -+#define OUT_RING( x ) \ -+do { \ -+ if (MACH64_VERBOSE) { \ -+ DRM_INFO( " OUT_RING( 0x%08x ) at 0x%x\n", \ -+ (unsigned int)(x), _ring_write ); \ -+ } \ -+ _ring[_ring_write++] = cpu_to_le32( x ); \ -+ _ring_write &= _ring_mask; \ -+} while (0) -+ -+#define ADVANCE_RING() \ -+do { \ -+ if (MACH64_VERBOSE) { \ -+ DRM_INFO( "ADVANCE_RING() wr=0x%06x tail=0x%06x\n", \ -+ _ring_write, _ring_tail ); \ -+ } \ -+ DRM_MEMORYBARRIER(); \ -+ mach64_clear_dma_eol( &_ring[(_ring_tail - 2) & _ring_mask] ); \ -+ DRM_MEMORYBARRIER(); \ -+ dev_priv->ring.tail = _ring_write; \ -+ mach64_ring_tick( dev_priv, &(dev_priv)->ring ); \ -+} while (0) -+ -+/** -+ * Queue a DMA buffer of registers writes into the ring buffer. -+ */ -+int mach64_add_buf_to_ring(drm_mach64_private_t *dev_priv, -+ drm_mach64_freelist_t *entry) -+{ -+ int bytes, pages, remainder; -+ u32 address, page; -+ int i; -+ struct drm_buf *buf = entry->buf; -+ RING_LOCALS; -+ -+ bytes = buf->used; -+ address = GETBUFADDR( buf ); -+ pages = (bytes + MACH64_DMA_CHUNKSIZE - 1) / MACH64_DMA_CHUNKSIZE; -+ -+ BEGIN_RING( pages * 4 ); -+ -+ for ( i = 0 ; i < pages-1 ; i++ ) { -+ page = address + i * MACH64_DMA_CHUNKSIZE; -+ OUT_RING( MACH64_APERTURE_OFFSET + MACH64_BM_ADDR ); -+ OUT_RING( page ); -+ OUT_RING( MACH64_DMA_CHUNKSIZE | MACH64_DMA_HOLD_OFFSET ); -+ OUT_RING( 0 ); -+ } -+ -+ /* generate the final descriptor for any remaining commands in this buffer */ -+ page = address + i * MACH64_DMA_CHUNKSIZE; -+ remainder = bytes - i * MACH64_DMA_CHUNKSIZE; -+ -+ /* Save dword offset of last descriptor for this buffer. -+ * This is needed to check for completion of the buffer in freelist_get -+ */ -+ entry->ring_ofs = RING_WRITE_OFS; -+ -+ OUT_RING( MACH64_APERTURE_OFFSET + MACH64_BM_ADDR ); -+ OUT_RING( page ); -+ OUT_RING( remainder | MACH64_DMA_HOLD_OFFSET | MACH64_DMA_EOL ); -+ OUT_RING( 0 ); -+ -+ ADVANCE_RING(); -+ -+ return 0; -+} -+ -+/** -+ * Queue DMA buffer controlling host data tranfers (e.g., blit). -+ * -+ * Almost identical to mach64_add_buf_to_ring. -+ */ -+int mach64_add_hostdata_buf_to_ring(drm_mach64_private_t *dev_priv, -+ drm_mach64_freelist_t *entry) -+{ -+ int bytes, pages, remainder; -+ u32 address, page; -+ int i; -+ struct drm_buf *buf = entry->buf; -+ RING_LOCALS; -+ -+ bytes = buf->used - MACH64_HOSTDATA_BLIT_OFFSET; -+ pages = (bytes + MACH64_DMA_CHUNKSIZE - 1) / MACH64_DMA_CHUNKSIZE; -+ address = GETBUFADDR( buf ); -+ -+ BEGIN_RING( 4 + pages * 4 ); -+ -+ OUT_RING( MACH64_APERTURE_OFFSET + MACH64_BM_ADDR ); -+ OUT_RING( address ); -+ OUT_RING( MACH64_HOSTDATA_BLIT_OFFSET | MACH64_DMA_HOLD_OFFSET ); -+ OUT_RING( 0 ); -+ address += MACH64_HOSTDATA_BLIT_OFFSET; -+ -+ for ( i = 0 ; i < pages-1 ; i++ ) { -+ page = address + i * MACH64_DMA_CHUNKSIZE; -+ OUT_RING( MACH64_APERTURE_OFFSET + MACH64_BM_HOSTDATA ); -+ OUT_RING( page ); -+ OUT_RING( MACH64_DMA_CHUNKSIZE | MACH64_DMA_HOLD_OFFSET ); -+ OUT_RING( 0 ); -+ } -+ -+ /* generate the final descriptor for any remaining commands in this buffer */ -+ page = address + i * MACH64_DMA_CHUNKSIZE; -+ remainder = bytes - i * MACH64_DMA_CHUNKSIZE; -+ -+ /* Save dword offset of last descriptor for this buffer. -+ * This is needed to check for completion of the buffer in freelist_get -+ */ -+ entry->ring_ofs = RING_WRITE_OFS; -+ -+ OUT_RING( MACH64_APERTURE_OFFSET + MACH64_BM_HOSTDATA ); -+ OUT_RING( page ); -+ OUT_RING( remainder | MACH64_DMA_HOLD_OFFSET | MACH64_DMA_EOL ); -+ OUT_RING( 0 ); -+ -+ ADVANCE_RING(); -+ -+ return 0; -+} -+ -+/*@}*/ -+ -+ -+/*******************************************************************/ -+/** \name DMA test and initialization */ -+/*@{*/ -+ -+/** -+ * Perform a simple DMA operation using the pattern registers to test whether -+ * DMA works. -+ * -+ * \return zero if successful. -+ * -+ * \note This function was the testbed for many experiences regarding Mach64 -+ * DMA operation. It is left here since it so tricky to get DMA operating -+ * properly in some architectures and hardware. -+ */ -+static int mach64_bm_dma_test(struct drm_device * dev) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ drm_dma_handle_t *cpu_addr_dmah; -+ u32 data_addr; -+ u32 *table, *data; -+ u32 expected[2]; -+ u32 src_cntl, pat_reg0, pat_reg1; -+ int i, count, failed; -+ -+ DRM_DEBUG("\n"); -+ -+ table = (u32 *) dev_priv->ring.start; -+ -+ /* FIXME: get a dma buffer from the freelist here */ -+ DRM_DEBUG("Allocating data memory ...\n"); -+#ifdef __FreeBSD__ -+ DRM_UNLOCK(); -+#endif -+ cpu_addr_dmah = -+ drm_pci_alloc(dev, 0x1000, 0x1000, 0xfffffffful); -+#ifdef __FreeBSD__ -+ DRM_LOCK(); -+#endif -+ if (!cpu_addr_dmah) { -+ DRM_INFO("data-memory allocation failed!\n"); -+ return -ENOMEM; -+ } else { -+ data = (u32 *) cpu_addr_dmah->vaddr; -+ data_addr = (u32) cpu_addr_dmah->busaddr; -+ } -+ -+ /* Save the X server's value for SRC_CNTL and restore it -+ * in case our test fails. This prevents the X server -+ * from disabling it's cache for this register -+ */ -+ src_cntl = MACH64_READ(MACH64_SRC_CNTL); -+ pat_reg0 = MACH64_READ(MACH64_PAT_REG0); -+ pat_reg1 = MACH64_READ(MACH64_PAT_REG1); -+ -+ mach64_do_wait_for_fifo(dev_priv, 3); -+ -+ MACH64_WRITE(MACH64_SRC_CNTL, 0); -+ MACH64_WRITE(MACH64_PAT_REG0, 0x11111111); -+ MACH64_WRITE(MACH64_PAT_REG1, 0x11111111); -+ -+ mach64_do_wait_for_idle(dev_priv); -+ -+ for (i = 0; i < 2; i++) { -+ u32 reg; -+ reg = MACH64_READ((MACH64_PAT_REG0 + i * 4)); -+ DRM_DEBUG("(Before DMA Transfer) reg %d = 0x%08x\n", i, reg); -+ if (reg != 0x11111111) { -+ DRM_INFO("Error initializing test registers\n"); -+ DRM_INFO("resetting engine ...\n"); -+ mach64_do_engine_reset(dev_priv); -+ DRM_INFO("freeing data buffer memory.\n"); -+ drm_pci_free(dev, cpu_addr_dmah); -+ return -EIO; -+ } -+ } -+ -+ /* fill up a buffer with sets of 2 consecutive writes starting with PAT_REG0 */ -+ count = 0; -+ -+ data[count++] = cpu_to_le32(DMAREG(MACH64_PAT_REG0) | (1 << 16)); -+ data[count++] = expected[0] = 0x22222222; -+ data[count++] = expected[1] = 0xaaaaaaaa; -+ -+ while (count < 1020) { -+ data[count++] = -+ cpu_to_le32(DMAREG(MACH64_PAT_REG0) | (1 << 16)); -+ data[count++] = 0x22222222; -+ data[count++] = 0xaaaaaaaa; -+ } -+ data[count++] = cpu_to_le32(DMAREG(MACH64_SRC_CNTL) | (0 << 16)); -+ data[count++] = 0; -+ -+ DRM_DEBUG("Preparing table ...\n"); -+ table[MACH64_DMA_FRAME_BUF_OFFSET] = cpu_to_le32(MACH64_BM_ADDR + -+ MACH64_APERTURE_OFFSET); -+ table[MACH64_DMA_SYS_MEM_ADDR] = cpu_to_le32(data_addr); -+ table[MACH64_DMA_COMMAND] = cpu_to_le32(count * sizeof(u32) -+ | MACH64_DMA_HOLD_OFFSET -+ | MACH64_DMA_EOL); -+ table[MACH64_DMA_RESERVED] = 0; -+ -+ DRM_DEBUG("table[0] = 0x%08x\n", table[0]); -+ DRM_DEBUG("table[1] = 0x%08x\n", table[1]); -+ DRM_DEBUG("table[2] = 0x%08x\n", table[2]); -+ DRM_DEBUG("table[3] = 0x%08x\n", table[3]); -+ -+ for (i = 0; i < 6; i++) { -+ DRM_DEBUG(" data[%d] = 0x%08x\n", i, data[i]); -+ } -+ DRM_DEBUG(" ...\n"); -+ for (i = count - 5; i < count; i++) { -+ DRM_DEBUG(" data[%d] = 0x%08x\n", i, data[i]); -+ } -+ -+ DRM_MEMORYBARRIER(); -+ -+ DRM_DEBUG("waiting for idle...\n"); -+ if ((i = mach64_do_wait_for_idle(dev_priv))) { -+ DRM_INFO("mach64_do_wait_for_idle failed (result=%d)\n", i); -+ DRM_INFO("resetting engine ...\n"); -+ mach64_do_engine_reset(dev_priv); -+ mach64_do_wait_for_fifo(dev_priv, 3); -+ MACH64_WRITE(MACH64_SRC_CNTL, src_cntl); -+ MACH64_WRITE(MACH64_PAT_REG0, pat_reg0); -+ MACH64_WRITE(MACH64_PAT_REG1, pat_reg1); -+ DRM_INFO("freeing data buffer memory.\n"); -+ drm_pci_free(dev, cpu_addr_dmah); -+ return i; -+ } -+ DRM_DEBUG("waiting for idle...done\n"); -+ -+ DRM_DEBUG("BUS_CNTL = 0x%08x\n", MACH64_READ(MACH64_BUS_CNTL)); -+ DRM_DEBUG("SRC_CNTL = 0x%08x\n", MACH64_READ(MACH64_SRC_CNTL)); -+ DRM_DEBUG("\n"); -+ DRM_DEBUG("data bus addr = 0x%08x\n", data_addr); -+ DRM_DEBUG("table bus addr = 0x%08x\n", dev_priv->ring.start_addr); -+ -+ DRM_DEBUG("starting DMA transfer...\n"); -+ MACH64_WRITE(MACH64_BM_GUI_TABLE_CMD, -+ dev_priv->ring.start_addr | MACH64_CIRCULAR_BUF_SIZE_16KB); -+ -+ MACH64_WRITE(MACH64_SRC_CNTL, -+ MACH64_SRC_BM_ENABLE | MACH64_SRC_BM_SYNC | -+ MACH64_SRC_BM_OP_SYSTEM_TO_REG); -+ -+ /* Kick off the transfer */ -+ DRM_DEBUG("starting DMA transfer... done.\n"); -+ MACH64_WRITE(MACH64_DST_HEIGHT_WIDTH, 0); -+ -+ DRM_DEBUG("waiting for idle...\n"); -+ -+ if ((i = mach64_do_wait_for_idle(dev_priv))) { -+ /* engine locked up, dump register state and reset */ -+ DRM_INFO("mach64_do_wait_for_idle failed (result=%d)\n", i); -+ mach64_dump_engine_info(dev_priv); -+ DRM_INFO("resetting engine ...\n"); -+ mach64_do_engine_reset(dev_priv); -+ mach64_do_wait_for_fifo(dev_priv, 3); -+ MACH64_WRITE(MACH64_SRC_CNTL, src_cntl); -+ MACH64_WRITE(MACH64_PAT_REG0, pat_reg0); -+ MACH64_WRITE(MACH64_PAT_REG1, pat_reg1); -+ DRM_INFO("freeing data buffer memory.\n"); -+ drm_pci_free(dev, cpu_addr_dmah); -+ return i; -+ } -+ -+ DRM_DEBUG("waiting for idle...done\n"); -+ -+ /* restore SRC_CNTL */ -+ mach64_do_wait_for_fifo(dev_priv, 1); -+ MACH64_WRITE(MACH64_SRC_CNTL, src_cntl); -+ -+ failed = 0; -+ -+ /* Check register values to see if the GUI master operation succeeded */ -+ for (i = 0; i < 2; i++) { -+ u32 reg; -+ reg = MACH64_READ((MACH64_PAT_REG0 + i * 4)); -+ DRM_DEBUG("(After DMA Transfer) reg %d = 0x%08x\n", i, reg); -+ if (reg != expected[i]) { -+ failed = -1; -+ } -+ } -+ -+ /* restore pattern registers */ -+ mach64_do_wait_for_fifo(dev_priv, 2); -+ MACH64_WRITE(MACH64_PAT_REG0, pat_reg0); -+ MACH64_WRITE(MACH64_PAT_REG1, pat_reg1); -+ -+ DRM_DEBUG("freeing data buffer memory.\n"); -+ drm_pci_free(dev, cpu_addr_dmah); -+ DRM_DEBUG("returning ...\n"); -+ -+ return failed; -+} -+ -+/** -+ * Called during the DMA initialization ioctl to initialize all the necessary -+ * software and hardware state for DMA operation. -+ */ -+static int mach64_do_dma_init(struct drm_device * dev, drm_mach64_init_t * init) -+{ -+ drm_mach64_private_t *dev_priv; -+ u32 tmp; -+ int i, ret; -+ -+ DRM_DEBUG("\n"); -+ -+ dev_priv = drm_alloc(sizeof(drm_mach64_private_t), DRM_MEM_DRIVER); -+ if (dev_priv == NULL) -+ return -ENOMEM; -+ -+ memset(dev_priv, 0, sizeof(drm_mach64_private_t)); -+ -+ dev_priv->is_pci = init->is_pci; -+ -+ dev_priv->fb_bpp = init->fb_bpp; -+ dev_priv->front_offset = init->front_offset; -+ dev_priv->front_pitch = init->front_pitch; -+ dev_priv->back_offset = init->back_offset; -+ dev_priv->back_pitch = init->back_pitch; -+ -+ dev_priv->depth_bpp = init->depth_bpp; -+ dev_priv->depth_offset = init->depth_offset; -+ dev_priv->depth_pitch = init->depth_pitch; -+ -+ dev_priv->front_offset_pitch = (((dev_priv->front_pitch / 8) << 22) | -+ (dev_priv->front_offset >> 3)); -+ dev_priv->back_offset_pitch = (((dev_priv->back_pitch / 8) << 22) | -+ (dev_priv->back_offset >> 3)); -+ dev_priv->depth_offset_pitch = (((dev_priv->depth_pitch / 8) << 22) | -+ (dev_priv->depth_offset >> 3)); -+ -+ dev_priv->usec_timeout = 1000000; -+ -+ /* Set up the freelist, placeholder list and pending list */ -+ INIT_LIST_HEAD(&dev_priv->free_list); -+ INIT_LIST_HEAD(&dev_priv->placeholders); -+ INIT_LIST_HEAD(&dev_priv->pending); -+ -+ dev_priv->sarea = drm_getsarea(dev); -+ if (!dev_priv->sarea) { -+ DRM_ERROR("can not find sarea!\n"); -+ dev->dev_private = (void *)dev_priv; -+ mach64_do_cleanup_dma(dev); -+ return -EINVAL; -+ } -+ dev_priv->fb = drm_core_findmap(dev, init->fb_offset); -+ if (!dev_priv->fb) { -+ DRM_ERROR("can not find frame buffer map!\n"); -+ dev->dev_private = (void *)dev_priv; -+ mach64_do_cleanup_dma(dev); -+ return -EINVAL; -+ } -+ dev_priv->mmio = drm_core_findmap(dev, init->mmio_offset); -+ if (!dev_priv->mmio) { -+ DRM_ERROR("can not find mmio map!\n"); -+ dev->dev_private = (void *)dev_priv; -+ mach64_do_cleanup_dma(dev); -+ return -EINVAL; -+ } -+ -+ dev_priv->ring_map = drm_core_findmap(dev, init->ring_offset); -+ if (!dev_priv->ring_map) { -+ DRM_ERROR("can not find ring map!\n"); -+ dev->dev_private = (void *)dev_priv; -+ mach64_do_cleanup_dma(dev); -+ return -EINVAL; -+ } -+ -+ dev_priv->sarea_priv = (drm_mach64_sarea_t *) -+ ((u8 *) dev_priv->sarea->handle + init->sarea_priv_offset); -+ -+ if (!dev_priv->is_pci) { -+ drm_core_ioremap(dev_priv->ring_map, dev); -+ if (!dev_priv->ring_map->handle) { -+ DRM_ERROR("can not ioremap virtual address for" -+ " descriptor ring\n"); -+ dev->dev_private = (void *)dev_priv; -+ mach64_do_cleanup_dma(dev); -+ return -ENOMEM; -+ } -+ dev->agp_buffer_token = init->buffers_offset; -+ dev->agp_buffer_map = -+ drm_core_findmap(dev, init->buffers_offset); -+ if (!dev->agp_buffer_map) { -+ DRM_ERROR("can not find dma buffer map!\n"); -+ dev->dev_private = (void *)dev_priv; -+ mach64_do_cleanup_dma(dev); -+ return -EINVAL; -+ } -+ /* there might be a nicer way to do this - -+ dev isn't passed all the way though the mach64 - DA */ -+ dev_priv->dev_buffers = dev->agp_buffer_map; -+ -+ drm_core_ioremap(dev->agp_buffer_map, dev); -+ if (!dev->agp_buffer_map->handle) { -+ DRM_ERROR("can not ioremap virtual address for" -+ " dma buffer\n"); -+ dev->dev_private = (void *)dev_priv; -+ mach64_do_cleanup_dma(dev); -+ return -ENOMEM; -+ } -+ dev_priv->agp_textures = -+ drm_core_findmap(dev, init->agp_textures_offset); -+ if (!dev_priv->agp_textures) { -+ DRM_ERROR("can not find agp texture region!\n"); -+ dev->dev_private = (void *)dev_priv; -+ mach64_do_cleanup_dma(dev); -+ return -EINVAL; -+ } -+ } -+ -+ dev->dev_private = (void *)dev_priv; -+ -+ dev_priv->driver_mode = init->dma_mode; -+ -+ /* changing the FIFO size from the default causes problems with DMA */ -+ tmp = MACH64_READ(MACH64_GUI_CNTL); -+ if ((tmp & MACH64_CMDFIFO_SIZE_MASK) != MACH64_CMDFIFO_SIZE_128) { -+ DRM_INFO("Setting FIFO size to 128 entries\n"); -+ /* FIFO must be empty to change the FIFO depth */ -+ if ((ret = mach64_do_wait_for_idle(dev_priv))) { -+ DRM_ERROR -+ ("wait for idle failed before changing FIFO depth!\n"); -+ mach64_do_cleanup_dma(dev); -+ return ret; -+ } -+ MACH64_WRITE(MACH64_GUI_CNTL, ((tmp & ~MACH64_CMDFIFO_SIZE_MASK) -+ | MACH64_CMDFIFO_SIZE_128)); -+ /* need to read GUI_STAT for proper sync according to docs */ -+ if ((ret = mach64_do_wait_for_idle(dev_priv))) { -+ DRM_ERROR -+ ("wait for idle failed when changing FIFO depth!\n"); -+ mach64_do_cleanup_dma(dev); -+ return ret; -+ } -+ } -+ -+ dev_priv->ring.size = 0x4000; /* 16KB */ -+ dev_priv->ring.start = dev_priv->ring_map->handle; -+ dev_priv->ring.start_addr = (u32) dev_priv->ring_map->offset; -+ -+ memset(dev_priv->ring.start, 0, dev_priv->ring.size); -+ DRM_INFO("descriptor ring: cpu addr %p, bus addr: 0x%08x\n", -+ dev_priv->ring.start, dev_priv->ring.start_addr); -+ -+ ret = 0; -+ if (dev_priv->driver_mode != MACH64_MODE_MMIO) { -+ -+ /* enable block 1 registers and bus mastering */ -+ MACH64_WRITE(MACH64_BUS_CNTL, ((MACH64_READ(MACH64_BUS_CNTL) -+ | MACH64_BUS_EXT_REG_EN) -+ & ~MACH64_BUS_MASTER_DIS)); -+ -+ /* try a DMA GUI-mastering pass and fall back to MMIO if it fails */ -+ DRM_DEBUG("Starting DMA test...\n"); -+ if ((ret = mach64_bm_dma_test(dev))) { -+ dev_priv->driver_mode = MACH64_MODE_MMIO; -+ } -+ } -+ -+ switch (dev_priv->driver_mode) { -+ case MACH64_MODE_MMIO: -+ MACH64_WRITE(MACH64_BUS_CNTL, (MACH64_READ(MACH64_BUS_CNTL) -+ | MACH64_BUS_EXT_REG_EN -+ | MACH64_BUS_MASTER_DIS)); -+ if (init->dma_mode == MACH64_MODE_MMIO) -+ DRM_INFO("Forcing pseudo-DMA mode\n"); -+ else -+ DRM_INFO -+ ("DMA test failed (ret=%d), using pseudo-DMA mode\n", -+ ret); -+ break; -+ case MACH64_MODE_DMA_SYNC: -+ DRM_INFO("DMA test succeeded, using synchronous DMA mode\n"); -+ break; -+ case MACH64_MODE_DMA_ASYNC: -+ default: -+ DRM_INFO("DMA test succeeded, using asynchronous DMA mode\n"); -+ } -+ -+ dev_priv->ring_running = 0; -+ -+ /* setup offsets for physical address of table start and end */ -+ dev_priv->ring.head_addr = dev_priv->ring.start_addr; -+ dev_priv->ring.head = dev_priv->ring.tail = 0; -+ dev_priv->ring.tail_mask = (dev_priv->ring.size / sizeof(u32)) - 1; -+ dev_priv->ring.space = dev_priv->ring.size; -+ -+ /* setup physical address and size of descriptor table */ -+ mach64_do_wait_for_fifo(dev_priv, 1); -+ MACH64_WRITE(MACH64_BM_GUI_TABLE_CMD, -+ (dev_priv->ring. -+ head_addr | MACH64_CIRCULAR_BUF_SIZE_16KB)); -+ -+ /* init frame counter */ -+ dev_priv->sarea_priv->frames_queued = 0; -+ for (i = 0; i < MACH64_MAX_QUEUED_FRAMES; i++) { -+ dev_priv->frame_ofs[i] = ~0; /* All ones indicates placeholder */ -+ } -+ -+ /* Allocate the DMA buffer freelist */ -+ if ((ret = mach64_init_freelist(dev))) { -+ DRM_ERROR("Freelist allocation failed\n"); -+ mach64_do_cleanup_dma(dev); -+ return ret; -+ } -+ -+ return 0; -+} -+ -+/*******************************************************************/ -+/** MMIO Pseudo-DMA (intended primarily for debugging, not performance) -+ */ -+ -+int mach64_do_dispatch_pseudo_dma(drm_mach64_private_t *dev_priv) -+{ -+ drm_mach64_descriptor_ring_t *ring = &dev_priv->ring; -+ volatile u32 *ring_read; -+ struct list_head *ptr; -+ drm_mach64_freelist_t *entry; -+ struct drm_buf *buf = NULL; -+ u32 *buf_ptr; -+ u32 used, reg, target; -+ int fifo, count, found, ret, no_idle_wait; -+ -+ fifo = count = reg = no_idle_wait = 0; -+ target = MACH64_BM_ADDR; -+ -+ if ((ret = mach64_do_wait_for_idle(dev_priv)) < 0) { -+ DRM_INFO("idle failed before pseudo-dma dispatch, resetting engine\n"); -+ mach64_dump_engine_info(dev_priv); -+ mach64_do_engine_reset(dev_priv); -+ return ret; -+ } -+ -+ ring_read = (u32 *) ring->start; -+ -+ while (ring->tail != ring->head) { -+ u32 buf_addr, new_target, offset; -+ u32 bytes, remaining, head, eol; -+ -+ head = ring->head; -+ -+ new_target = -+ le32_to_cpu(ring_read[head++]) - MACH64_APERTURE_OFFSET; -+ buf_addr = le32_to_cpu(ring_read[head++]); -+ eol = le32_to_cpu(ring_read[head]) & MACH64_DMA_EOL; -+ bytes = le32_to_cpu(ring_read[head++]) -+ & ~(MACH64_DMA_HOLD_OFFSET | MACH64_DMA_EOL); -+ head++; -+ head &= ring->tail_mask; -+ -+ /* can't wait for idle between a blit setup descriptor -+ * and a HOSTDATA descriptor or the engine will lock -+ */ -+ if (new_target == MACH64_BM_HOSTDATA -+ && target == MACH64_BM_ADDR) -+ no_idle_wait = 1; -+ -+ target = new_target; -+ -+ found = 0; -+ offset = 0; -+ list_for_each(ptr, &dev_priv->pending) { -+ entry = list_entry(ptr, drm_mach64_freelist_t, list); -+ buf = entry->buf; -+ offset = buf_addr - GETBUFADDR(buf); -+ if (offset >= 0 && offset < MACH64_BUFFER_SIZE) { -+ found = 1; -+ break; -+ } -+ } -+ -+ if (!found || buf == NULL) { -+ DRM_ERROR -+ ("Couldn't find pending buffer: head: %u tail: %u buf_addr: 0x%08x %s\n", -+ head, ring->tail, buf_addr, (eol ? "eol" : "")); -+ mach64_dump_ring_info(dev_priv); -+ mach64_do_engine_reset(dev_priv); -+ return -EINVAL; -+ } -+ -+ /* Hand feed the buffer to the card via MMIO, waiting for the fifo -+ * every 16 writes -+ */ -+ DRM_DEBUG("target: (0x%08x) %s\n", target, -+ (target == -+ MACH64_BM_HOSTDATA ? "BM_HOSTDATA" : "BM_ADDR")); -+ DRM_DEBUG("offset: %u bytes: %u used: %u\n", offset, bytes, -+ buf->used); -+ -+ remaining = (buf->used - offset) >> 2; /* dwords remaining in buffer */ -+ used = bytes >> 2; /* dwords in buffer for this descriptor */ -+ buf_ptr = (u32 *) ((char *)GETBUFPTR(buf) + offset); -+ -+ while (used) { -+ -+ if (count == 0) { -+ if (target == MACH64_BM_HOSTDATA) { -+ reg = DMAREG(MACH64_HOST_DATA0); -+ count = -+ (remaining > 16) ? 16 : remaining; -+ fifo = 0; -+ } else { -+ reg = le32_to_cpu(*buf_ptr++); -+ used--; -+ count = (reg >> 16) + 1; -+ } -+ -+ reg = reg & 0xffff; -+ reg = MMSELECT(reg); -+ } -+ while (count && used) { -+ if (!fifo) { -+ if (no_idle_wait) { -+ if ((ret = -+ mach64_do_wait_for_fifo -+ (dev_priv, 16)) < 0) { -+ no_idle_wait = 0; -+ return ret; -+ } -+ } else { -+ if ((ret = -+ mach64_do_wait_for_idle -+ (dev_priv)) < 0) { -+ return ret; -+ } -+ } -+ fifo = 16; -+ } -+ --fifo; -+ MACH64_WRITE(reg, le32_to_cpu(*buf_ptr++)); -+ used--; -+ remaining--; -+ -+ reg += 4; -+ count--; -+ } -+ } -+ ring->head = head; -+ ring->head_addr = ring->start_addr + (ring->head * sizeof(u32)); -+ ring->space += (4 * sizeof(u32)); -+ } -+ -+ if ((ret = mach64_do_wait_for_idle(dev_priv)) < 0) { -+ return ret; -+ } -+ MACH64_WRITE(MACH64_BM_GUI_TABLE_CMD, -+ ring->head_addr | MACH64_CIRCULAR_BUF_SIZE_16KB); -+ -+ DRM_DEBUG("completed\n"); -+ return 0; -+} -+ -+/*@}*/ -+ -+ -+/*******************************************************************/ -+/** \name DMA cleanup */ -+/*@{*/ -+ -+int mach64_do_cleanup_dma(struct drm_device * dev) -+{ -+ DRM_DEBUG("\n"); -+ -+ /* Make sure interrupts are disabled here because the uninstall ioctl -+ * may not have been called from userspace and after dev_private -+ * is freed, it's too late. -+ */ -+ if (dev->irq) -+ drm_irq_uninstall(dev); -+ -+ if (dev->dev_private) { -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ -+ if (!dev_priv->is_pci) { -+ if (dev_priv->ring_map) -+ drm_core_ioremapfree(dev_priv->ring_map, dev); -+ -+ if (dev->agp_buffer_map) { -+ drm_core_ioremapfree(dev->agp_buffer_map, dev); -+ dev->agp_buffer_map = NULL; -+ } -+ } -+ -+ mach64_destroy_freelist(dev); -+ -+ drm_free(dev_priv, sizeof(drm_mach64_private_t), -+ DRM_MEM_DRIVER); -+ dev->dev_private = NULL; -+ } -+ -+ return 0; -+} -+ -+/*@}*/ -+ -+ -+/*******************************************************************/ -+/** \name IOCTL handlers */ -+/*@{*/ -+ -+int mach64_dma_init(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ drm_mach64_init_t *init = data; -+ -+ DRM_DEBUG("\n"); -+ -+ LOCK_TEST_WITH_RETURN(dev, file_priv); -+ -+ switch (init->func) { -+ case DRM_MACH64_INIT_DMA: -+ return mach64_do_dma_init(dev, init); -+ case DRM_MACH64_CLEANUP_DMA: -+ return mach64_do_cleanup_dma(dev); -+ } -+ -+ return -EINVAL; -+} -+ -+int mach64_dma_idle(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ -+ DRM_DEBUG("\n"); -+ -+ LOCK_TEST_WITH_RETURN(dev, file_priv); -+ -+ return mach64_do_dma_idle(dev_priv); -+} -+ -+int mach64_dma_flush(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ -+ DRM_DEBUG("\n"); -+ -+ LOCK_TEST_WITH_RETURN(dev, file_priv); -+ -+ return mach64_do_dma_flush(dev_priv); -+} -+ -+int mach64_engine_reset(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ -+ DRM_DEBUG("\n"); -+ -+ LOCK_TEST_WITH_RETURN(dev, file_priv); -+ -+ return mach64_do_engine_reset(dev_priv); -+} -+ -+/*@}*/ -+ -+ -+/*******************************************************************/ -+/** \name Freelist management */ -+/*@{*/ -+ -+int mach64_init_freelist(struct drm_device * dev) -+{ -+ struct drm_device_dma *dma = dev->dma; -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ drm_mach64_freelist_t *entry; -+ struct list_head *ptr; -+ int i; -+ -+ DRM_DEBUG("adding %d buffers to freelist\n", dma->buf_count); -+ -+ for (i = 0; i < dma->buf_count; i++) { -+ if ((entry = -+ (drm_mach64_freelist_t *) -+ drm_alloc(sizeof(drm_mach64_freelist_t), -+ DRM_MEM_BUFLISTS)) == NULL) -+ return -ENOMEM; -+ memset(entry, 0, sizeof(drm_mach64_freelist_t)); -+ entry->buf = dma->buflist[i]; -+ ptr = &entry->list; -+ list_add_tail(ptr, &dev_priv->free_list); -+ } -+ -+ return 0; -+} -+ -+void mach64_destroy_freelist(struct drm_device * dev) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ drm_mach64_freelist_t *entry; -+ struct list_head *ptr; -+ struct list_head *tmp; -+ -+ DRM_DEBUG("\n"); -+ -+ list_for_each_safe(ptr, tmp, &dev_priv->pending) { -+ list_del(ptr); -+ entry = list_entry(ptr, drm_mach64_freelist_t, list); -+ drm_free(entry, sizeof(*entry), DRM_MEM_BUFLISTS); -+ } -+ list_for_each_safe(ptr, tmp, &dev_priv->placeholders) { -+ list_del(ptr); -+ entry = list_entry(ptr, drm_mach64_freelist_t, list); -+ drm_free(entry, sizeof(*entry), DRM_MEM_BUFLISTS); -+ } -+ -+ list_for_each_safe(ptr, tmp, &dev_priv->free_list) { -+ list_del(ptr); -+ entry = list_entry(ptr, drm_mach64_freelist_t, list); -+ drm_free(entry, sizeof(*entry), DRM_MEM_BUFLISTS); -+ } -+} -+ -+/* IMPORTANT: This function should only be called when the engine is idle or locked up, -+ * as it assumes all buffers in the pending list have been completed by the hardware. -+ */ -+int mach64_do_release_used_buffers(drm_mach64_private_t *dev_priv) -+{ -+ struct list_head *ptr; -+ struct list_head *tmp; -+ drm_mach64_freelist_t *entry; -+ int i; -+ -+ if (list_empty(&dev_priv->pending)) -+ return 0; -+ -+ /* Iterate the pending list and move all buffers into the freelist... */ -+ i = 0; -+ list_for_each_safe(ptr, tmp, &dev_priv->pending) { -+ entry = list_entry(ptr, drm_mach64_freelist_t, list); -+ if (entry->discard) { -+ entry->buf->pending = 0; -+ list_del(ptr); -+ list_add_tail(ptr, &dev_priv->free_list); -+ i++; -+ } -+ } -+ -+ DRM_DEBUG("released %d buffers from pending list\n", i); -+ -+ return 0; -+} -+ -+static int mach64_do_reclaim_completed(drm_mach64_private_t *dev_priv) -+{ -+ drm_mach64_descriptor_ring_t *ring = &dev_priv->ring; -+ struct list_head *ptr; -+ struct list_head *tmp; -+ drm_mach64_freelist_t *entry; -+ u32 head, tail, ofs; -+ -+ mach64_ring_tick(dev_priv, ring); -+ head = ring->head; -+ tail = ring->tail; -+ -+ if (head == tail) { -+#if MACH64_EXTRA_CHECKING -+ if (MACH64_READ(MACH64_GUI_STAT) & MACH64_GUI_ACTIVE) { -+ DRM_ERROR("Empty ring with non-idle engine!\n"); -+ mach64_dump_ring_info(dev_priv); -+ return -1; -+ } -+#endif -+ /* last pass is complete, so release everything */ -+ mach64_do_release_used_buffers(dev_priv); -+ DRM_DEBUG("idle engine, freed all buffers.\n"); -+ if (list_empty(&dev_priv->free_list)) { -+ DRM_ERROR("Freelist empty with idle engine\n"); -+ return -1; -+ } -+ return 0; -+ } -+ /* Look for a completed buffer and bail out of the loop -+ * as soon as we find one -- don't waste time trying -+ * to free extra bufs here, leave that to do_release_used_buffers -+ */ -+ list_for_each_safe(ptr, tmp, &dev_priv->pending) { -+ entry = list_entry(ptr, drm_mach64_freelist_t, list); -+ ofs = entry->ring_ofs; -+ if (entry->discard && -+ ((head < tail && (ofs < head || ofs >= tail)) || -+ (head > tail && (ofs < head && ofs >= tail)))) { -+#if MACH64_EXTRA_CHECKING -+ int i; -+ -+ for (i = head; i != tail; i = (i + 4) & ring->tail_mask) -+ { -+ u32 o1 = le32_to_cpu(((u32 *) ring-> -+ start)[i + 1]); -+ u32 o2 = GETBUFADDR(entry->buf); -+ -+ if (o1 == o2) { -+ DRM_ERROR -+ ("Attempting to free used buffer: " -+ "i=%d buf=0x%08x\n", -+ i, o1); -+ mach64_dump_ring_info(dev_priv); -+ return -1; -+ } -+ } -+#endif -+ /* found a processed buffer */ -+ entry->buf->pending = 0; -+ list_del(ptr); -+ list_add_tail(ptr, &dev_priv->free_list); -+ DRM_DEBUG -+ ("freed processed buffer (head=%d tail=%d " -+ "buf ring ofs=%d).\n", -+ head, tail, ofs); -+ return 0; -+ } -+ } -+ -+ return 1; -+} -+ -+struct drm_buf *mach64_freelist_get(drm_mach64_private_t *dev_priv) -+{ -+ drm_mach64_descriptor_ring_t *ring = &dev_priv->ring; -+ drm_mach64_freelist_t *entry; -+ struct list_head *ptr; -+ int t; -+ -+ if (list_empty(&dev_priv->free_list)) { -+ if (list_empty(&dev_priv->pending)) { -+ DRM_ERROR -+ ("Couldn't get buffer - pending and free lists empty\n"); -+ t = 0; -+ list_for_each(ptr, &dev_priv->placeholders) { -+ t++; -+ } -+ DRM_INFO("Placeholders: %d\n", t); -+ return NULL; -+ } -+ -+ for (t = 0; t < dev_priv->usec_timeout; t++) { -+ int ret; -+ -+ ret = mach64_do_reclaim_completed(dev_priv); -+ if (ret == 0) -+ goto _freelist_entry_found; -+ if (ret < 0) -+ return NULL; -+ -+ DRM_UDELAY(1); -+ } -+ mach64_dump_ring_info(dev_priv); -+ DRM_ERROR -+ ("timeout waiting for buffers: ring head_addr: 0x%08x head: %d tail: %d\n", -+ ring->head_addr, ring->head, ring->tail); -+ return NULL; -+ } -+ -+ _freelist_entry_found: -+ ptr = dev_priv->free_list.next; -+ list_del(ptr); -+ entry = list_entry(ptr, drm_mach64_freelist_t, list); -+ entry->buf->used = 0; -+ list_add_tail(ptr, &dev_priv->placeholders); -+ return entry->buf; -+} -+ -+int mach64_freelist_put(drm_mach64_private_t *dev_priv, struct drm_buf *copy_buf) -+{ -+ struct list_head *ptr; -+ drm_mach64_freelist_t *entry; -+ -+#if MACH64_EXTRA_CHECKING -+ list_for_each(ptr, &dev_priv->pending) { -+ entry = list_entry(ptr, drm_mach64_freelist_t, list); -+ if (copy_buf == entry->buf) { -+ DRM_ERROR("Trying to release a pending buf\n"); -+ return -EFAULT; -+ } -+ } -+#endif -+ ptr = dev_priv->placeholders.next; -+ entry = list_entry(ptr, drm_mach64_freelist_t, list); -+ copy_buf->pending = 0; -+ copy_buf->used = 0; -+ entry->buf = copy_buf; -+ entry->discard = 1; -+ list_del(ptr); -+ list_add_tail(ptr, &dev_priv->free_list); -+ -+ return 0; -+} -+ -+/*@}*/ -+ -+ -+/*******************************************************************/ -+/** \name DMA buffer request and submission IOCTL handler */ -+/*@{*/ -+ -+static int mach64_dma_get_buffers(struct drm_device *dev, -+ struct drm_file *file_priv, -+ struct drm_dma * d) -+{ -+ int i; -+ struct drm_buf *buf; -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ -+ for (i = d->granted_count; i < d->request_count; i++) { -+ buf = mach64_freelist_get(dev_priv); -+#if MACH64_EXTRA_CHECKING -+ if (!buf) -+ return -EFAULT; -+#else -+ if (!buf) -+ return -EAGAIN; -+#endif -+ -+ buf->file_priv = file_priv; -+ -+ if (DRM_COPY_TO_USER(&d->request_indices[i], &buf->idx, -+ sizeof(buf->idx))) -+ return -EFAULT; -+ if (DRM_COPY_TO_USER(&d->request_sizes[i], &buf->total, -+ sizeof(buf->total))) -+ return -EFAULT; -+ -+ d->granted_count++; -+ } -+ return 0; -+} -+ -+int mach64_dma_buffers(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ struct drm_device_dma *dma = dev->dma; -+ struct drm_dma *d = data; -+ int ret = 0; -+ -+ LOCK_TEST_WITH_RETURN(dev, file_priv); -+ -+ /* Please don't send us buffers. -+ */ -+ if (d->send_count != 0) { -+ DRM_ERROR("Process %d trying to send %d buffers via drmDMA\n", -+ DRM_CURRENTPID, d->send_count); -+ return -EINVAL; -+ } -+ -+ /* We'll send you buffers. -+ */ -+ if (d->request_count < 0 || d->request_count > dma->buf_count) { -+ DRM_ERROR("Process %d trying to get %d buffers (of %d max)\n", -+ DRM_CURRENTPID, d->request_count, dma->buf_count); -+ ret = -EINVAL; -+ } -+ -+ d->granted_count = 0; -+ -+ if (d->request_count) { -+ ret = mach64_dma_get_buffers(dev, file_priv, d); -+ } -+ -+ return ret; -+} -+ -+void mach64_driver_lastclose(struct drm_device * dev) -+{ -+ mach64_do_cleanup_dma(dev); -+} -+ -+/*@}*/ ---- /dev/null -+++ b/drivers/gpu/drm/mach64/mach64_drm.h -@@ -0,0 +1,256 @@ -+/* mach64_drm.h -- Public header for the mach64 driver -*- linux-c -*- -+ * Created: Thu Nov 30 20:04:32 2000 by gareth@valinux.com -+ */ -+/* -+ * Copyright 2000 Gareth Hughes -+ * Copyright 2002 Frank C. Earl -+ * Copyright 2002-2003 Leif Delgass -+ * All Rights Reserved. -+ * -+ * Permission is hereby granted, free of charge, to any person obtaining a -+ * copy of this software and associated documentation files (the "Software"), -+ * to deal in the Software without restriction, including without limitation -+ * the rights to use, copy, modify, merge, publish, distribute, sublicense, -+ * and/or sell copies of the Software, and to permit persons to whom the -+ * Software is furnished to do so, subject to the following conditions: -+ * -+ * The above copyright notice and this permission notice (including the next -+ * paragraph) shall be included in all copies or substantial portions of the -+ * Software. -+ * -+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR -+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, -+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL -+ * THE COPYRIGHT OWNER(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER -+ * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN -+ * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. -+ * -+ * Authors: -+ * Gareth Hughes -+ * Frank C. Earl -+ * Leif Delgass -+ */ -+ -+#ifndef __MACH64_DRM_H__ -+#define __MACH64_DRM_H__ -+ -+/* WARNING: If you change any of these defines, make sure to change the -+ * defines in the Xserver file (mach64_sarea.h) -+ */ -+#ifndef __MACH64_SAREA_DEFINES__ -+#define __MACH64_SAREA_DEFINES__ -+ -+/* What needs to be changed for the current vertex buffer? -+ * GH: We're going to be pedantic about this. We want the card to do as -+ * little as possible, so let's avoid having it fetch a whole bunch of -+ * register values that don't change all that often, if at all. -+ */ -+#define MACH64_UPLOAD_DST_OFF_PITCH 0x0001 -+#define MACH64_UPLOAD_Z_OFF_PITCH 0x0002 -+#define MACH64_UPLOAD_Z_ALPHA_CNTL 0x0004 -+#define MACH64_UPLOAD_SCALE_3D_CNTL 0x0008 -+#define MACH64_UPLOAD_DP_FOG_CLR 0x0010 -+#define MACH64_UPLOAD_DP_WRITE_MASK 0x0020 -+#define MACH64_UPLOAD_DP_PIX_WIDTH 0x0040 -+#define MACH64_UPLOAD_SETUP_CNTL 0x0080 -+#define MACH64_UPLOAD_MISC 0x0100 -+#define MACH64_UPLOAD_TEXTURE 0x0200 -+#define MACH64_UPLOAD_TEX0IMAGE 0x0400 -+#define MACH64_UPLOAD_TEX1IMAGE 0x0800 -+#define MACH64_UPLOAD_CLIPRECTS 0x1000 /* handled client-side */ -+#define MACH64_UPLOAD_CONTEXT 0x00ff -+#define MACH64_UPLOAD_ALL 0x1fff -+ -+/* DMA buffer size -+ */ -+#define MACH64_BUFFER_SIZE 16384 -+ -+/* Max number of swaps allowed on the ring -+ * before the client must wait -+ */ -+#define MACH64_MAX_QUEUED_FRAMES 3U -+ -+/* Byte offsets for host blit buffer data -+ */ -+#define MACH64_HOSTDATA_BLIT_OFFSET 104 -+ -+/* Keep these small for testing. -+ */ -+#define MACH64_NR_SAREA_CLIPRECTS 8 -+ -+#define MACH64_CARD_HEAP 0 -+#define MACH64_AGP_HEAP 1 -+#define MACH64_NR_TEX_HEAPS 2 -+#define MACH64_NR_TEX_REGIONS 64 -+#define MACH64_LOG_TEX_GRANULARITY 16 -+ -+#define MACH64_TEX_MAXLEVELS 1 -+ -+#define MACH64_NR_CONTEXT_REGS 15 -+#define MACH64_NR_TEXTURE_REGS 4 -+ -+#endif /* __MACH64_SAREA_DEFINES__ */ -+ -+typedef struct { -+ unsigned int dst_off_pitch; -+ -+ unsigned int z_off_pitch; -+ unsigned int z_cntl; -+ unsigned int alpha_tst_cntl; -+ -+ unsigned int scale_3d_cntl; -+ -+ unsigned int sc_left_right; -+ unsigned int sc_top_bottom; -+ -+ unsigned int dp_fog_clr; -+ unsigned int dp_write_mask; -+ unsigned int dp_pix_width; -+ unsigned int dp_mix; -+ unsigned int dp_src; -+ -+ unsigned int clr_cmp_cntl; -+ unsigned int gui_traj_cntl; -+ -+ unsigned int setup_cntl; -+ -+ unsigned int tex_size_pitch; -+ unsigned int tex_cntl; -+ unsigned int secondary_tex_off; -+ unsigned int tex_offset; -+} drm_mach64_context_regs_t; -+ -+typedef struct drm_mach64_sarea { -+ /* The channel for communication of state information to the kernel -+ * on firing a vertex dma buffer. -+ */ -+ drm_mach64_context_regs_t context_state; -+ unsigned int dirty; -+ unsigned int vertsize; -+ -+ /* The current cliprects, or a subset thereof. -+ */ -+ struct drm_clip_rect boxes[MACH64_NR_SAREA_CLIPRECTS]; -+ unsigned int nbox; -+ -+ /* Counters for client-side throttling of rendering clients. -+ */ -+ unsigned int frames_queued; -+ -+ /* Texture memory LRU. -+ */ -+ struct drm_tex_region tex_list[MACH64_NR_TEX_HEAPS][MACH64_NR_TEX_REGIONS + -+ 1]; -+ unsigned int tex_age[MACH64_NR_TEX_HEAPS]; -+ int ctx_owner; -+} drm_mach64_sarea_t; -+ -+/* WARNING: If you change any of these defines, make sure to change the -+ * defines in the Xserver file (mach64_common.h) -+ */ -+ -+/* Mach64 specific ioctls -+ * The device specific ioctl range is 0x40 to 0x79. -+ */ -+ -+#define DRM_MACH64_INIT 0x00 -+#define DRM_MACH64_IDLE 0x01 -+#define DRM_MACH64_RESET 0x02 -+#define DRM_MACH64_SWAP 0x03 -+#define DRM_MACH64_CLEAR 0x04 -+#define DRM_MACH64_VERTEX 0x05 -+#define DRM_MACH64_BLIT 0x06 -+#define DRM_MACH64_FLUSH 0x07 -+#define DRM_MACH64_GETPARAM 0x08 -+ -+#define DRM_IOCTL_MACH64_INIT DRM_IOW( DRM_COMMAND_BASE + DRM_MACH64_INIT, drm_mach64_init_t) -+#define DRM_IOCTL_MACH64_IDLE DRM_IO( DRM_COMMAND_BASE + DRM_MACH64_IDLE ) -+#define DRM_IOCTL_MACH64_RESET DRM_IO( DRM_COMMAND_BASE + DRM_MACH64_RESET ) -+#define DRM_IOCTL_MACH64_SWAP DRM_IO( DRM_COMMAND_BASE + DRM_MACH64_SWAP ) -+#define DRM_IOCTL_MACH64_CLEAR DRM_IOW( DRM_COMMAND_BASE + DRM_MACH64_CLEAR, drm_mach64_clear_t) -+#define DRM_IOCTL_MACH64_VERTEX DRM_IOW( DRM_COMMAND_BASE + DRM_MACH64_VERTEX, drm_mach64_vertex_t) -+#define DRM_IOCTL_MACH64_BLIT DRM_IOW( DRM_COMMAND_BASE + DRM_MACH64_BLIT, drm_mach64_blit_t) -+#define DRM_IOCTL_MACH64_FLUSH DRM_IO( DRM_COMMAND_BASE + DRM_MACH64_FLUSH ) -+#define DRM_IOCTL_MACH64_GETPARAM DRM_IOWR( DRM_COMMAND_BASE + DRM_MACH64_GETPARAM, drm_mach64_getparam_t) -+ -+/* Buffer flags for clears -+ */ -+#define MACH64_FRONT 0x1 -+#define MACH64_BACK 0x2 -+#define MACH64_DEPTH 0x4 -+ -+/* Primitive types for vertex buffers -+ */ -+#define MACH64_PRIM_POINTS 0x00000000 -+#define MACH64_PRIM_LINES 0x00000001 -+#define MACH64_PRIM_LINE_LOOP 0x00000002 -+#define MACH64_PRIM_LINE_STRIP 0x00000003 -+#define MACH64_PRIM_TRIANGLES 0x00000004 -+#define MACH64_PRIM_TRIANGLE_STRIP 0x00000005 -+#define MACH64_PRIM_TRIANGLE_FAN 0x00000006 -+#define MACH64_PRIM_QUADS 0x00000007 -+#define MACH64_PRIM_QUAD_STRIP 0x00000008 -+#define MACH64_PRIM_POLYGON 0x00000009 -+ -+typedef enum _drm_mach64_dma_mode_t { -+ MACH64_MODE_DMA_ASYNC, -+ MACH64_MODE_DMA_SYNC, -+ MACH64_MODE_MMIO -+} drm_mach64_dma_mode_t; -+ -+typedef struct drm_mach64_init { -+ enum { -+ DRM_MACH64_INIT_DMA = 0x01, -+ DRM_MACH64_CLEANUP_DMA = 0x02 -+ } func; -+ -+ unsigned long sarea_priv_offset; -+ int is_pci; -+ drm_mach64_dma_mode_t dma_mode; -+ -+ unsigned int fb_bpp; -+ unsigned int front_offset, front_pitch; -+ unsigned int back_offset, back_pitch; -+ -+ unsigned int depth_bpp; -+ unsigned int depth_offset, depth_pitch; -+ -+ unsigned long fb_offset; -+ unsigned long mmio_offset; -+ unsigned long ring_offset; -+ unsigned long buffers_offset; -+ unsigned long agp_textures_offset; -+} drm_mach64_init_t; -+ -+typedef struct drm_mach64_clear { -+ unsigned int flags; -+ int x, y, w, h; -+ unsigned int clear_color; -+ unsigned int clear_depth; -+} drm_mach64_clear_t; -+ -+typedef struct drm_mach64_vertex { -+ int prim; -+ void *buf; /* Address of vertex buffer */ -+ unsigned long used; /* Number of bytes in buffer */ -+ int discard; /* Client finished with buffer? */ -+} drm_mach64_vertex_t; -+ -+typedef struct drm_mach64_blit { -+ void *buf; -+ int pitch; -+ int offset; -+ int format; -+ unsigned short x, y; -+ unsigned short width, height; -+} drm_mach64_blit_t; -+ -+typedef struct drm_mach64_getparam { -+ enum { -+ MACH64_PARAM_FRAMES_QUEUED = 0x01, -+ MACH64_PARAM_IRQ_NR = 0x02 -+ } param; -+ void *value; -+} drm_mach64_getparam_t; -+ -+#endif ---- /dev/null -+++ b/drivers/gpu/drm/mach64/mach64_drv.c -@@ -0,0 +1,105 @@ -+/* mach64_drv.c -- mach64 (Rage Pro) driver -*- linux-c -*- -+ * Created: Fri Nov 24 18:34:32 2000 by gareth@valinux.com -+ * -+ * Copyright 2000 Gareth Hughes -+ * All Rights Reserved. -+ * -+ * Permission is hereby granted, free of charge, to any person obtaining a -+ * copy of this software and associated documentation files (the "Software"), -+ * to deal in the Software without restriction, including without limitation -+ * the rights to use, copy, modify, merge, publish, distribute, sublicense, -+ * and/or sell copies of the Software, and to permit persons to whom the -+ * Software is furnished to do so, subject to the following conditions: -+ * -+ * The above copyright notice and this permission notice (including the next -+ * paragraph) shall be included in all copies or substantial portions of the -+ * Software. -+ * -+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR -+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, -+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL -+ * GARETH HUGHES BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER -+ * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN -+ * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. -+ * -+ * Authors: -+ * Gareth Hughes -+ * Leif Delgass -+ */ -+ -+#include "drmP.h" -+#include "drm.h" -+#include "mach64_drm.h" -+#include "mach64_drv.h" -+ -+#include "drm_pciids.h" -+ -+static struct pci_device_id pciidlist[] = { -+ mach64_PCI_IDS -+}; -+ -+static int probe(struct pci_dev *pdev, const struct pci_device_id *ent); -+static struct drm_driver driver = { -+ .driver_features = -+ DRIVER_USE_AGP | DRIVER_USE_MTRR | DRIVER_PCI_DMA | DRIVER_HAVE_DMA -+ | DRIVER_HAVE_IRQ | DRIVER_IRQ_SHARED, -+ .lastclose = mach64_driver_lastclose, -+ .get_vblank_counter = mach64_get_vblank_counter, -+ .enable_vblank = mach64_enable_vblank, -+ .disable_vblank = mach64_disable_vblank, -+ .irq_preinstall = mach64_driver_irq_preinstall, -+ .irq_postinstall = mach64_driver_irq_postinstall, -+ .irq_uninstall = mach64_driver_irq_uninstall, -+ .irq_handler = mach64_driver_irq_handler, -+ .reclaim_buffers = drm_core_reclaim_buffers, -+ .get_map_ofs = drm_core_get_map_ofs, -+ .get_reg_ofs = drm_core_get_reg_ofs, -+ .ioctls = mach64_ioctls, -+ .dma_ioctl = mach64_dma_buffers, -+ .fops = { -+ .owner = THIS_MODULE, -+ .open = drm_open, -+ .release = drm_release, -+ .ioctl = drm_ioctl, -+ .mmap = drm_mmap, -+ .poll = drm_poll, -+ .fasync = drm_fasync, -+ }, -+ .pci_driver = { -+ .name = DRIVER_NAME, -+ .id_table = pciidlist, -+ .probe = probe, -+ .remove = __devexit_p(drm_cleanup_pci), -+ }, -+ -+ .name = DRIVER_NAME, -+ .desc = DRIVER_DESC, -+ .date = DRIVER_DATE, -+ .major = DRIVER_MAJOR, -+ .minor = DRIVER_MINOR, -+ .patchlevel = DRIVER_PATCHLEVEL, -+}; -+ -+static int probe(struct pci_dev *pdev, const struct pci_device_id *ent) -+{ -+ return drm_get_dev(pdev, ent, &driver); -+} -+ -+ -+static int __init mach64_init(void) -+{ -+ driver.num_ioctls = mach64_max_ioctl; -+ return drm_init(&driver, pciidlist); -+} -+ -+static void __exit mach64_exit(void) -+{ -+ drm_exit(&driver); -+} -+ -+module_init(mach64_init); -+module_exit(mach64_exit); -+ -+MODULE_AUTHOR(DRIVER_AUTHOR); -+MODULE_DESCRIPTION(DRIVER_DESC); -+MODULE_LICENSE("GPL and additional rights"); ---- /dev/null -+++ b/drivers/gpu/drm/mach64/mach64_drv.h -@@ -0,0 +1,859 @@ -+/* mach64_drv.h -- Private header for mach64 driver -*- linux-c -*- -+ * Created: Fri Nov 24 22:07:58 2000 by gareth@valinux.com -+ */ -+/* -+ * Copyright 2000 Gareth Hughes -+ * Copyright 2002 Frank C. Earl -+ * Copyright 2002-2003 Leif Delgass -+ * All Rights Reserved. -+ * -+ * Permission is hereby granted, free of charge, to any person obtaining a -+ * copy of this software and associated documentation files (the "Software"), -+ * to deal in the Software without restriction, including without limitation -+ * the rights to use, copy, modify, merge, publish, distribute, sublicense, -+ * and/or sell copies of the Software, and to permit persons to whom the -+ * Software is furnished to do so, subject to the following conditions: -+ * -+ * The above copyright notice and this permission notice (including the next -+ * paragraph) shall be included in all copies or substantial portions of the -+ * Software. -+ * -+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR -+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, -+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL -+ * THE COPYRIGHT OWNER(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER -+ * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN -+ * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. -+ * -+ * Authors: -+ * Gareth Hughes -+ * Frank C. Earl -+ * Leif Delgass -+ * José Fonseca -+ */ -+ -+#ifndef __MACH64_DRV_H__ -+#define __MACH64_DRV_H__ -+ -+/* General customization: -+ */ -+ -+#define DRIVER_AUTHOR "Gareth Hughes, Leif Delgass, José Fonseca" -+ -+#define DRIVER_NAME "mach64" -+#define DRIVER_DESC "DRM module for the ATI Rage Pro" -+#define DRIVER_DATE "20060718" -+ -+#define DRIVER_MAJOR 2 -+#define DRIVER_MINOR 0 -+#define DRIVER_PATCHLEVEL 0 -+ -+/* FIXME: remove these when not needed */ -+/* Development driver options */ -+#define MACH64_EXTRA_CHECKING 0 /* Extra sanity checks for DMA/freelist management */ -+#define MACH64_VERBOSE 0 /* Verbose debugging output */ -+ -+typedef struct drm_mach64_freelist { -+ struct list_head list; /* List pointers for free_list, placeholders, or pending list */ -+ struct drm_buf *buf; /* Pointer to the buffer */ -+ int discard; /* This flag is set when we're done (re)using a buffer */ -+ u32 ring_ofs; /* dword offset in ring of last descriptor for this buffer */ -+} drm_mach64_freelist_t; -+ -+typedef struct drm_mach64_descriptor_ring { -+ void *start; /* write pointer (cpu address) to start of descriptor ring */ -+ u32 start_addr; /* bus address of beginning of descriptor ring */ -+ int size; /* size of ring in bytes */ -+ -+ u32 head_addr; /* bus address of descriptor ring head */ -+ u32 head; /* dword offset of descriptor ring head */ -+ u32 tail; /* dword offset of descriptor ring tail */ -+ u32 tail_mask; /* mask used to wrap ring */ -+ int space; /* number of free bytes in ring */ -+} drm_mach64_descriptor_ring_t; -+ -+typedef struct drm_mach64_private { -+ drm_mach64_sarea_t *sarea_priv; -+ -+ int is_pci; -+ drm_mach64_dma_mode_t driver_mode; /* Async DMA, sync DMA, or MMIO */ -+ -+ int usec_timeout; /* Timeout for the wait functions */ -+ -+ drm_mach64_descriptor_ring_t ring; /* DMA descriptor table (ring buffer) */ -+ int ring_running; /* Is bus mastering is enabled */ -+ -+ struct list_head free_list; /* Free-list head */ -+ struct list_head placeholders; /* Placeholder list for buffers held by clients */ -+ struct list_head pending; /* Buffers pending completion */ -+ -+ u32 frame_ofs[MACH64_MAX_QUEUED_FRAMES]; /* dword ring offsets of most recent frame swaps */ -+ -+ unsigned int fb_bpp; -+ unsigned int front_offset, front_pitch; -+ unsigned int back_offset, back_pitch; -+ -+ unsigned int depth_bpp; -+ unsigned int depth_offset, depth_pitch; -+ -+ atomic_t vbl_received; /**< Number of vblanks received. */ -+ -+ u32 front_offset_pitch; -+ u32 back_offset_pitch; -+ u32 depth_offset_pitch; -+ -+ drm_local_map_t *sarea; -+ drm_local_map_t *fb; -+ drm_local_map_t *mmio; -+ drm_local_map_t *ring_map; -+ drm_local_map_t *dev_buffers; /* this is a pointer to a structure in dev */ -+ drm_local_map_t *agp_textures; -+} drm_mach64_private_t; -+ -+extern struct drm_ioctl_desc mach64_ioctls[]; -+extern int mach64_max_ioctl; -+ -+ /* mach64_dma.c */ -+extern int mach64_dma_init(struct drm_device *dev, void *data, -+ struct drm_file *file_priv); -+extern int mach64_dma_idle(struct drm_device *dev, void *data, -+ struct drm_file *file_priv); -+extern int mach64_dma_flush(struct drm_device *dev, void *data, -+ struct drm_file *file_priv); -+extern int mach64_engine_reset(struct drm_device *dev, void *data, -+ struct drm_file *file_priv); -+extern int mach64_dma_buffers(struct drm_device *dev, void *data, -+ struct drm_file *file_priv); -+extern void mach64_driver_lastclose(struct drm_device * dev); -+ -+extern int mach64_init_freelist(struct drm_device * dev); -+extern void mach64_destroy_freelist(struct drm_device * dev); -+extern struct drm_buf *mach64_freelist_get(drm_mach64_private_t * dev_priv); -+extern int mach64_freelist_put(drm_mach64_private_t * dev_priv, -+ struct drm_buf * copy_buf); -+ -+extern int mach64_do_wait_for_fifo(drm_mach64_private_t * dev_priv, -+ int entries); -+extern int mach64_do_wait_for_idle(drm_mach64_private_t * dev_priv); -+extern int mach64_wait_ring(drm_mach64_private_t * dev_priv, int n); -+extern int mach64_do_dispatch_pseudo_dma(drm_mach64_private_t * dev_priv); -+extern int mach64_do_release_used_buffers(drm_mach64_private_t * dev_priv); -+extern void mach64_dump_engine_info(drm_mach64_private_t * dev_priv); -+extern void mach64_dump_ring_info(drm_mach64_private_t * dev_priv); -+extern int mach64_do_engine_reset(drm_mach64_private_t * dev_priv); -+ -+extern int mach64_add_buf_to_ring(drm_mach64_private_t *dev_priv, -+ drm_mach64_freelist_t *_entry); -+extern int mach64_add_hostdata_buf_to_ring(drm_mach64_private_t *dev_priv, -+ drm_mach64_freelist_t *_entry); -+ -+extern int mach64_do_dma_idle(drm_mach64_private_t * dev_priv); -+extern int mach64_do_dma_flush(drm_mach64_private_t * dev_priv); -+extern int mach64_do_cleanup_dma(struct drm_device * dev); -+ -+ /* mach64_state.c */ -+extern int mach64_dma_clear(struct drm_device *dev, void *data, -+ struct drm_file *file_priv); -+extern int mach64_dma_swap(struct drm_device *dev, void *data, -+ struct drm_file *file_priv); -+extern int mach64_dma_vertex(struct drm_device *dev, void *data, -+ struct drm_file *file_priv); -+extern int mach64_dma_blit(struct drm_device *dev, void *data, -+ struct drm_file *file_priv); -+extern int mach64_get_param(struct drm_device *dev, void *data, -+ struct drm_file *file_priv); -+ -+extern u32 mach64_get_vblank_counter(struct drm_device *dev, int crtc); -+extern int mach64_enable_vblank(struct drm_device *dev, int crtc); -+extern void mach64_disable_vblank(struct drm_device *dev, int crtc); -+extern irqreturn_t mach64_driver_irq_handler(DRM_IRQ_ARGS); -+extern void mach64_driver_irq_preinstall(struct drm_device *dev); -+extern int mach64_driver_irq_postinstall(struct drm_device *dev); -+extern void mach64_driver_irq_uninstall(struct drm_device *dev); -+ -+/* ================================================================ -+ * Registers -+ */ -+ -+#define MACH64_AGP_BASE 0x0148 -+#define MACH64_AGP_CNTL 0x014c -+#define MACH64_ALPHA_TST_CNTL 0x0550 -+ -+#define MACH64_DSP_CONFIG 0x0420 -+#define MACH64_DSP_ON_OFF 0x0424 -+#define MACH64_EXT_MEM_CNTL 0x04ac -+#define MACH64_GEN_TEST_CNTL 0x04d0 -+#define MACH64_HW_DEBUG 0x047c -+#define MACH64_MEM_ADDR_CONFIG 0x0434 -+#define MACH64_MEM_BUF_CNTL 0x042c -+#define MACH64_MEM_CNTL 0x04b0 -+ -+#define MACH64_BM_ADDR 0x0648 -+#define MACH64_BM_COMMAND 0x0188 -+#define MACH64_BM_DATA 0x0648 -+#define MACH64_BM_FRAME_BUF_OFFSET 0x0180 -+#define MACH64_BM_GUI_TABLE 0x01b8 -+#define MACH64_BM_GUI_TABLE_CMD 0x064c -+# define MACH64_CIRCULAR_BUF_SIZE_16KB (0 << 0) -+# define MACH64_CIRCULAR_BUF_SIZE_32KB (1 << 0) -+# define MACH64_CIRCULAR_BUF_SIZE_64KB (2 << 0) -+# define MACH64_CIRCULAR_BUF_SIZE_128KB (3 << 0) -+# define MACH64_LAST_DESCRIPTOR (1 << 31) -+#define MACH64_BM_HOSTDATA 0x0644 -+#define MACH64_BM_STATUS 0x018c -+#define MACH64_BM_SYSTEM_MEM_ADDR 0x0184 -+#define MACH64_BM_SYSTEM_TABLE 0x01bc -+#define MACH64_BUS_CNTL 0x04a0 -+# define MACH64_BUS_MSTR_RESET (1 << 1) -+# define MACH64_BUS_APER_REG_DIS (1 << 4) -+# define MACH64_BUS_FLUSH_BUF (1 << 2) -+# define MACH64_BUS_MASTER_DIS (1 << 6) -+# define MACH64_BUS_EXT_REG_EN (1 << 27) -+ -+#define MACH64_CLR_CMP_CLR 0x0700 -+#define MACH64_CLR_CMP_CNTL 0x0708 -+#define MACH64_CLR_CMP_MASK 0x0704 -+#define MACH64_CONFIG_CHIP_ID 0x04e0 -+#define MACH64_CONFIG_CNTL 0x04dc -+#define MACH64_CONFIG_STAT0 0x04e4 -+#define MACH64_CONFIG_STAT1 0x0494 -+#define MACH64_CONFIG_STAT2 0x0498 -+#define MACH64_CONTEXT_LOAD_CNTL 0x072c -+#define MACH64_CONTEXT_MASK 0x0720 -+#define MACH64_COMPOSITE_SHADOW_ID 0x0798 -+#define MACH64_CRC_SIG 0x04e8 -+#define MACH64_CUSTOM_MACRO_CNTL 0x04d4 -+ -+#define MACH64_DP_BKGD_CLR 0x06c0 -+#define MACH64_DP_FOG_CLR 0x06c4 -+#define MACH64_DP_FGRD_BKGD_CLR 0x06e0 -+#define MACH64_DP_FRGD_CLR 0x06c4 -+#define MACH64_DP_FGRD_CLR_MIX 0x06dc -+ -+#define MACH64_DP_MIX 0x06d4 -+# define BKGD_MIX_NOT_D (0 << 0) -+# define BKGD_MIX_ZERO (1 << 0) -+# define BKGD_MIX_ONE (2 << 0) -+# define MACH64_BKGD_MIX_D (3 << 0) -+# define BKGD_MIX_NOT_S (4 << 0) -+# define BKGD_MIX_D_XOR_S (5 << 0) -+# define BKGD_MIX_NOT_D_XOR_S (6 << 0) -+# define MACH64_BKGD_MIX_S (7 << 0) -+# define BKGD_MIX_NOT_D_OR_NOT_S (8 << 0) -+# define BKGD_MIX_D_OR_NOT_S (9 << 0) -+# define BKGD_MIX_NOT_D_OR_S (10 << 0) -+# define BKGD_MIX_D_OR_S (11 << 0) -+# define BKGD_MIX_D_AND_S (12 << 0) -+# define BKGD_MIX_NOT_D_AND_S (13 << 0) -+# define BKGD_MIX_D_AND_NOT_S (14 << 0) -+# define BKGD_MIX_NOT_D_AND_NOT_S (15 << 0) -+# define BKGD_MIX_D_PLUS_S_DIV2 (23 << 0) -+# define FRGD_MIX_NOT_D (0 << 16) -+# define FRGD_MIX_ZERO (1 << 16) -+# define FRGD_MIX_ONE (2 << 16) -+# define FRGD_MIX_D (3 << 16) -+# define FRGD_MIX_NOT_S (4 << 16) -+# define FRGD_MIX_D_XOR_S (5 << 16) -+# define FRGD_MIX_NOT_D_XOR_S (6 << 16) -+# define MACH64_FRGD_MIX_S (7 << 16) -+# define FRGD_MIX_NOT_D_OR_NOT_S (8 << 16) -+# define FRGD_MIX_D_OR_NOT_S (9 << 16) -+# define FRGD_MIX_NOT_D_OR_S (10 << 16) -+# define FRGD_MIX_D_OR_S (11 << 16) -+# define FRGD_MIX_D_AND_S (12 << 16) -+# define FRGD_MIX_NOT_D_AND_S (13 << 16) -+# define FRGD_MIX_D_AND_NOT_S (14 << 16) -+# define FRGD_MIX_NOT_D_AND_NOT_S (15 << 16) -+# define FRGD_MIX_D_PLUS_S_DIV2 (23 << 16) -+ -+#define MACH64_DP_PIX_WIDTH 0x06d0 -+# define MACH64_HOST_TRIPLE_ENABLE (1 << 13) -+# define MACH64_BYTE_ORDER_MSB_TO_LSB (0 << 24) -+# define MACH64_BYTE_ORDER_LSB_TO_MSB (1 << 24) -+ -+#define MACH64_DP_SRC 0x06d8 -+# define MACH64_BKGD_SRC_BKGD_CLR (0 << 0) -+# define MACH64_BKGD_SRC_FRGD_CLR (1 << 0) -+# define MACH64_BKGD_SRC_HOST (2 << 0) -+# define MACH64_BKGD_SRC_BLIT (3 << 0) -+# define MACH64_BKGD_SRC_PATTERN (4 << 0) -+# define MACH64_BKGD_SRC_3D (5 << 0) -+# define MACH64_FRGD_SRC_BKGD_CLR (0 << 8) -+# define MACH64_FRGD_SRC_FRGD_CLR (1 << 8) -+# define MACH64_FRGD_SRC_HOST (2 << 8) -+# define MACH64_FRGD_SRC_BLIT (3 << 8) -+# define MACH64_FRGD_SRC_PATTERN (4 << 8) -+# define MACH64_FRGD_SRC_3D (5 << 8) -+# define MACH64_MONO_SRC_ONE (0 << 16) -+# define MACH64_MONO_SRC_PATTERN (1 << 16) -+# define MACH64_MONO_SRC_HOST (2 << 16) -+# define MACH64_MONO_SRC_BLIT (3 << 16) -+ -+#define MACH64_DP_WRITE_MASK 0x06c8 -+ -+#define MACH64_DST_CNTL 0x0530 -+# define MACH64_DST_X_RIGHT_TO_LEFT (0 << 0) -+# define MACH64_DST_X_LEFT_TO_RIGHT (1 << 0) -+# define MACH64_DST_Y_BOTTOM_TO_TOP (0 << 1) -+# define MACH64_DST_Y_TOP_TO_BOTTOM (1 << 1) -+# define MACH64_DST_X_MAJOR (0 << 2) -+# define MACH64_DST_Y_MAJOR (1 << 2) -+# define MACH64_DST_X_TILE (1 << 3) -+# define MACH64_DST_Y_TILE (1 << 4) -+# define MACH64_DST_LAST_PEL (1 << 5) -+# define MACH64_DST_POLYGON_ENABLE (1 << 6) -+# define MACH64_DST_24_ROTATION_ENABLE (1 << 7) -+ -+#define MACH64_DST_HEIGHT_WIDTH 0x0518 -+#define MACH64_DST_OFF_PITCH 0x0500 -+#define MACH64_DST_WIDTH_HEIGHT 0x06ec -+#define MACH64_DST_X_Y 0x06e8 -+#define MACH64_DST_Y_X 0x050c -+ -+#define MACH64_FIFO_STAT 0x0710 -+# define MACH64_FIFO_SLOT_MASK 0x0000ffff -+# define MACH64_FIFO_ERR (1 << 31) -+ -+#define MACH64_GEN_TEST_CNTL 0x04d0 -+# define MACH64_GUI_ENGINE_ENABLE (1 << 8) -+#define MACH64_GUI_CMDFIFO_DEBUG 0x0170 -+#define MACH64_GUI_CMDFIFO_DATA 0x0174 -+#define MACH64_GUI_CNTL 0x0178 -+# define MACH64_CMDFIFO_SIZE_MASK 0x00000003ul -+# define MACH64_CMDFIFO_SIZE_192 0x00000000ul -+# define MACH64_CMDFIFO_SIZE_128 0x00000001ul -+# define MACH64_CMDFIFO_SIZE_64 0x00000002ul -+#define MACH64_GUI_STAT 0x0738 -+# define MACH64_GUI_ACTIVE (1 << 0) -+#define MACH64_GUI_TRAJ_CNTL 0x0730 -+ -+#define MACH64_HOST_CNTL 0x0640 -+#define MACH64_HOST_DATA0 0x0600 -+ -+#define MACH64_ONE_OVER_AREA 0x029c -+#define MACH64_ONE_OVER_AREA_UC 0x0300 -+ -+#define MACH64_PAT_REG0 0x0680 -+#define MACH64_PAT_REG1 0x0684 -+ -+#define MACH64_SC_LEFT 0x06a0 -+#define MACH64_SC_RIGHT 0x06a4 -+#define MACH64_SC_LEFT_RIGHT 0x06a8 -+#define MACH64_SC_TOP 0x06ac -+#define MACH64_SC_BOTTOM 0x06b0 -+#define MACH64_SC_TOP_BOTTOM 0x06b4 -+ -+#define MACH64_SCALE_3D_CNTL 0x05fc -+#define MACH64_SCRATCH_REG0 0x0480 -+#define MACH64_SCRATCH_REG1 0x0484 -+#define MACH64_SECONDARY_TEX_OFF 0x0778 -+#define MACH64_SETUP_CNTL 0x0304 -+#define MACH64_SRC_CNTL 0x05b4 -+# define MACH64_SRC_BM_ENABLE (1 << 8) -+# define MACH64_SRC_BM_SYNC (1 << 9) -+# define MACH64_SRC_BM_OP_FRAME_TO_SYSTEM (0 << 10) -+# define MACH64_SRC_BM_OP_SYSTEM_TO_FRAME (1 << 10) -+# define MACH64_SRC_BM_OP_REG_TO_SYSTEM (2 << 10) -+# define MACH64_SRC_BM_OP_SYSTEM_TO_REG (3 << 10) -+#define MACH64_SRC_HEIGHT1 0x0594 -+#define MACH64_SRC_HEIGHT2 0x05ac -+#define MACH64_SRC_HEIGHT1_WIDTH1 0x0598 -+#define MACH64_SRC_HEIGHT2_WIDTH2 0x05b0 -+#define MACH64_SRC_OFF_PITCH 0x0580 -+#define MACH64_SRC_WIDTH1 0x0590 -+#define MACH64_SRC_Y_X 0x058c -+ -+#define MACH64_TEX_0_OFF 0x05c0 -+#define MACH64_TEX_CNTL 0x0774 -+#define MACH64_TEX_SIZE_PITCH 0x0770 -+#define MACH64_TIMER_CONFIG 0x0428 -+ -+#define MACH64_VERTEX_1_ARGB 0x0254 -+#define MACH64_VERTEX_1_S 0x0240 -+#define MACH64_VERTEX_1_SECONDARY_S 0x0328 -+#define MACH64_VERTEX_1_SECONDARY_T 0x032c -+#define MACH64_VERTEX_1_SECONDARY_W 0x0330 -+#define MACH64_VERTEX_1_SPEC_ARGB 0x024c -+#define MACH64_VERTEX_1_T 0x0244 -+#define MACH64_VERTEX_1_W 0x0248 -+#define MACH64_VERTEX_1_X_Y 0x0258 -+#define MACH64_VERTEX_1_Z 0x0250 -+#define MACH64_VERTEX_2_ARGB 0x0274 -+#define MACH64_VERTEX_2_S 0x0260 -+#define MACH64_VERTEX_2_SECONDARY_S 0x0334 -+#define MACH64_VERTEX_2_SECONDARY_T 0x0338 -+#define MACH64_VERTEX_2_SECONDARY_W 0x033c -+#define MACH64_VERTEX_2_SPEC_ARGB 0x026c -+#define MACH64_VERTEX_2_T 0x0264 -+#define MACH64_VERTEX_2_W 0x0268 -+#define MACH64_VERTEX_2_X_Y 0x0278 -+#define MACH64_VERTEX_2_Z 0x0270 -+#define MACH64_VERTEX_3_ARGB 0x0294 -+#define MACH64_VERTEX_3_S 0x0280 -+#define MACH64_VERTEX_3_SECONDARY_S 0x02a0 -+#define MACH64_VERTEX_3_SECONDARY_T 0x02a4 -+#define MACH64_VERTEX_3_SECONDARY_W 0x02a8 -+#define MACH64_VERTEX_3_SPEC_ARGB 0x028c -+#define MACH64_VERTEX_3_T 0x0284 -+#define MACH64_VERTEX_3_W 0x0288 -+#define MACH64_VERTEX_3_X_Y 0x0298 -+#define MACH64_VERTEX_3_Z 0x0290 -+ -+#define MACH64_Z_CNTL 0x054c -+#define MACH64_Z_OFF_PITCH 0x0548 -+ -+#define MACH64_CRTC_VLINE_CRNT_VLINE 0x0410 -+# define MACH64_CRTC_VLINE_MASK 0x000007ff -+# define MACH64_CRTC_CRNT_VLINE_MASK 0x07ff0000 -+#define MACH64_CRTC_OFF_PITCH 0x0414 -+#define MACH64_CRTC_INT_CNTL 0x0418 -+# define MACH64_CRTC_VBLANK (1 << 0) -+# define MACH64_CRTC_VBLANK_INT_EN (1 << 1) -+# define MACH64_CRTC_VBLANK_INT (1 << 2) -+# define MACH64_CRTC_VLINE_INT_EN (1 << 3) -+# define MACH64_CRTC_VLINE_INT (1 << 4) -+# define MACH64_CRTC_VLINE_SYNC (1 << 5) /* 0=even, 1=odd */ -+# define MACH64_CRTC_FRAME (1 << 6) /* 0=even, 1=odd */ -+# define MACH64_CRTC_SNAPSHOT_INT_EN (1 << 7) -+# define MACH64_CRTC_SNAPSHOT_INT (1 << 8) -+# define MACH64_CRTC_I2C_INT_EN (1 << 9) -+# define MACH64_CRTC_I2C_INT (1 << 10) -+# define MACH64_CRTC2_VBLANK (1 << 11) /* LT Pro */ -+# define MACH64_CRTC2_VBLANK_INT_EN (1 << 12) /* LT Pro */ -+# define MACH64_CRTC2_VBLANK_INT (1 << 13) /* LT Pro */ -+# define MACH64_CRTC2_VLINE_INT_EN (1 << 14) /* LT Pro */ -+# define MACH64_CRTC2_VLINE_INT (1 << 15) /* LT Pro */ -+# define MACH64_CRTC_CAPBUF0_INT_EN (1 << 16) -+# define MACH64_CRTC_CAPBUF0_INT (1 << 17) -+# define MACH64_CRTC_CAPBUF1_INT_EN (1 << 18) -+# define MACH64_CRTC_CAPBUF1_INT (1 << 19) -+# define MACH64_CRTC_OVERLAY_EOF_INT_EN (1 << 20) -+# define MACH64_CRTC_OVERLAY_EOF_INT (1 << 21) -+# define MACH64_CRTC_ONESHOT_CAP_INT_EN (1 << 22) -+# define MACH64_CRTC_ONESHOT_CAP_INT (1 << 23) -+# define MACH64_CRTC_BUSMASTER_EOL_INT_EN (1 << 24) -+# define MACH64_CRTC_BUSMASTER_EOL_INT (1 << 25) -+# define MACH64_CRTC_GP_INT_EN (1 << 26) -+# define MACH64_CRTC_GP_INT (1 << 27) -+# define MACH64_CRTC2_VLINE_SYNC (1 << 28) /* LT Pro */ /* 0=even, 1=odd */ -+# define MACH64_CRTC_SNAPSHOT2_INT_EN (1 << 29) /* LT Pro */ -+# define MACH64_CRTC_SNAPSHOT2_INT (1 << 30) /* LT Pro */ -+# define MACH64_CRTC_VBLANK2_INT (1 << 31) -+# define MACH64_CRTC_INT_ENS \ -+ ( \ -+ MACH64_CRTC_VBLANK_INT_EN | \ -+ MACH64_CRTC_VLINE_INT_EN | \ -+ MACH64_CRTC_SNAPSHOT_INT_EN | \ -+ MACH64_CRTC_I2C_INT_EN | \ -+ MACH64_CRTC2_VBLANK_INT_EN | \ -+ MACH64_CRTC2_VLINE_INT_EN | \ -+ MACH64_CRTC_CAPBUF0_INT_EN | \ -+ MACH64_CRTC_CAPBUF1_INT_EN | \ -+ MACH64_CRTC_OVERLAY_EOF_INT_EN | \ -+ MACH64_CRTC_ONESHOT_CAP_INT_EN | \ -+ MACH64_CRTC_BUSMASTER_EOL_INT_EN | \ -+ MACH64_CRTC_GP_INT_EN | \ -+ MACH64_CRTC_SNAPSHOT2_INT_EN | \ -+ 0 \ -+ ) -+# define MACH64_CRTC_INT_ACKS \ -+ ( \ -+ MACH64_CRTC_VBLANK_INT | \ -+ MACH64_CRTC_VLINE_INT | \ -+ MACH64_CRTC_SNAPSHOT_INT | \ -+ MACH64_CRTC_I2C_INT | \ -+ MACH64_CRTC2_VBLANK_INT | \ -+ MACH64_CRTC2_VLINE_INT | \ -+ MACH64_CRTC_CAPBUF0_INT | \ -+ MACH64_CRTC_CAPBUF1_INT | \ -+ MACH64_CRTC_OVERLAY_EOF_INT | \ -+ MACH64_CRTC_ONESHOT_CAP_INT | \ -+ MACH64_CRTC_BUSMASTER_EOL_INT | \ -+ MACH64_CRTC_GP_INT | \ -+ MACH64_CRTC_SNAPSHOT2_INT | \ -+ MACH64_CRTC_VBLANK2_INT | \ -+ 0 \ -+ ) -+ -+#define MACH64_DATATYPE_CI8 2 -+#define MACH64_DATATYPE_ARGB1555 3 -+#define MACH64_DATATYPE_RGB565 4 -+#define MACH64_DATATYPE_ARGB8888 6 -+#define MACH64_DATATYPE_RGB332 7 -+#define MACH64_DATATYPE_Y8 8 -+#define MACH64_DATATYPE_RGB8 9 -+#define MACH64_DATATYPE_VYUY422 11 -+#define MACH64_DATATYPE_YVYU422 12 -+#define MACH64_DATATYPE_AYUV444 14 -+#define MACH64_DATATYPE_ARGB4444 15 -+ -+#define MACH64_READ(reg) DRM_READ32(dev_priv->mmio, (reg) ) -+#define MACH64_WRITE(reg,val) DRM_WRITE32(dev_priv->mmio, (reg), (val) ) -+ -+#define DWMREG0 0x0400 -+#define DWMREG0_END 0x07ff -+#define DWMREG1 0x0000 -+#define DWMREG1_END 0x03ff -+ -+#define ISREG0(r) (((r) >= DWMREG0) && ((r) <= DWMREG0_END)) -+#define DMAREG0(r) (((r) - DWMREG0) >> 2) -+#define DMAREG1(r) ((((r) - DWMREG1) >> 2 ) | 0x0100) -+#define DMAREG(r) (ISREG0(r) ? DMAREG0(r) : DMAREG1(r)) -+ -+#define MMREG0 0x0000 -+#define MMREG0_END 0x00ff -+ -+#define ISMMREG0(r) (((r) >= MMREG0) && ((r) <= MMREG0_END)) -+#define MMSELECT0(r) (((r) << 2) + DWMREG0) -+#define MMSELECT1(r) (((((r) & 0xff) << 2) + DWMREG1)) -+#define MMSELECT(r) (ISMMREG0(r) ? MMSELECT0(r) : MMSELECT1(r)) -+ -+/* ================================================================ -+ * DMA constants -+ */ -+ -+/* DMA descriptor field indices: -+ * The descriptor fields are loaded into the read-only -+ * BM_* system bus master registers during a bus-master operation -+ */ -+#define MACH64_DMA_FRAME_BUF_OFFSET 0 /* BM_FRAME_BUF_OFFSET */ -+#define MACH64_DMA_SYS_MEM_ADDR 1 /* BM_SYSTEM_MEM_ADDR */ -+#define MACH64_DMA_COMMAND 2 /* BM_COMMAND */ -+#define MACH64_DMA_RESERVED 3 /* BM_STATUS */ -+ -+/* BM_COMMAND descriptor field flags */ -+#define MACH64_DMA_HOLD_OFFSET (1<<30) /* Don't increment DMA_FRAME_BUF_OFFSET */ -+#define MACH64_DMA_EOL (1<<31) /* End of descriptor list flag */ -+ -+#define MACH64_DMA_CHUNKSIZE 0x1000 /* 4kB per DMA descriptor */ -+#define MACH64_APERTURE_OFFSET 0x7ff800 /* frame-buffer offset for gui-masters */ -+ -+/* ================================================================ -+ * Ring operations -+ * -+ * Since the Mach64 bus master engine requires polling, these functions end -+ * up being called frequently, hence being inline. -+ */ -+ -+static __inline__ void mach64_ring_start(drm_mach64_private_t * dev_priv) -+{ -+ drm_mach64_descriptor_ring_t *ring = &dev_priv->ring; -+ -+ DRM_DEBUG("head_addr: 0x%08x head: %d tail: %d space: %d\n", -+ ring->head_addr, ring->head, ring->tail, ring->space); -+ -+ if (mach64_do_wait_for_idle(dev_priv) < 0) { -+ mach64_do_engine_reset(dev_priv); -+ } -+ -+ if (dev_priv->driver_mode != MACH64_MODE_MMIO) { -+ /* enable bus mastering and block 1 registers */ -+ MACH64_WRITE(MACH64_BUS_CNTL, -+ (MACH64_READ(MACH64_BUS_CNTL) & -+ ~MACH64_BUS_MASTER_DIS) -+ | MACH64_BUS_EXT_REG_EN); -+ mach64_do_wait_for_idle(dev_priv); -+ } -+ -+ /* reset descriptor table ring head */ -+ MACH64_WRITE(MACH64_BM_GUI_TABLE_CMD, -+ ring->head_addr | MACH64_CIRCULAR_BUF_SIZE_16KB); -+ -+ dev_priv->ring_running = 1; -+} -+ -+static __inline__ void mach64_ring_resume(drm_mach64_private_t * dev_priv, -+ drm_mach64_descriptor_ring_t * ring) -+{ -+ DRM_DEBUG("head_addr: 0x%08x head: %d tail: %d space: %d\n", -+ ring->head_addr, ring->head, ring->tail, ring->space); -+ -+ /* reset descriptor table ring head */ -+ MACH64_WRITE(MACH64_BM_GUI_TABLE_CMD, -+ ring->head_addr | MACH64_CIRCULAR_BUF_SIZE_16KB); -+ -+ if (dev_priv->driver_mode == MACH64_MODE_MMIO) { -+ mach64_do_dispatch_pseudo_dma(dev_priv); -+ } else { -+ /* enable GUI bus mastering, and sync the bus master to the GUI */ -+ MACH64_WRITE(MACH64_SRC_CNTL, -+ MACH64_SRC_BM_ENABLE | MACH64_SRC_BM_SYNC | -+ MACH64_SRC_BM_OP_SYSTEM_TO_REG); -+ -+ /* kick off the transfer */ -+ MACH64_WRITE(MACH64_DST_HEIGHT_WIDTH, 0); -+ if (dev_priv->driver_mode == MACH64_MODE_DMA_SYNC) { -+ if ((mach64_do_wait_for_idle(dev_priv)) < 0) { -+ DRM_ERROR("idle failed, resetting engine\n"); -+ mach64_dump_engine_info(dev_priv); -+ mach64_do_engine_reset(dev_priv); -+ return; -+ } -+ mach64_do_release_used_buffers(dev_priv); -+ } -+ } -+} -+ -+/** -+ * Poll the ring head and make sure the bus master is alive. -+ * -+ * Mach64's bus master engine will stop if there are no more entries to process. -+ * This function polls the engine for the last processed entry and calls -+ * mach64_ring_resume if there is an unprocessed entry. -+ * -+ * Note also that, since we update the ring tail while the bus master engine is -+ * in operation, it is possible that the last tail update was too late to be -+ * processed, and the bus master engine stops at the previous tail position. -+ * Therefore it is important to call this function frequently. -+ */ -+static __inline__ void mach64_ring_tick(drm_mach64_private_t * dev_priv, -+ drm_mach64_descriptor_ring_t * ring) -+{ -+ DRM_DEBUG("head_addr: 0x%08x head: %d tail: %d space: %d\n", -+ ring->head_addr, ring->head, ring->tail, ring->space); -+ -+ if (!dev_priv->ring_running) { -+ mach64_ring_start(dev_priv); -+ -+ if (ring->head != ring->tail) { -+ mach64_ring_resume(dev_priv, ring); -+ } -+ } else { -+ /* GUI_ACTIVE must be read before BM_GUI_TABLE to -+ * correctly determine the ring head -+ */ -+ int gui_active = -+ MACH64_READ(MACH64_GUI_STAT) & MACH64_GUI_ACTIVE; -+ -+ ring->head_addr = MACH64_READ(MACH64_BM_GUI_TABLE) & 0xfffffff0; -+ -+ if (gui_active) { -+ /* If not idle, BM_GUI_TABLE points one descriptor -+ * past the current head -+ */ -+ if (ring->head_addr == ring->start_addr) { -+ ring->head_addr += ring->size; -+ } -+ ring->head_addr -= 4 * sizeof(u32); -+ } -+ -+ if (ring->head_addr < ring->start_addr || -+ ring->head_addr >= ring->start_addr + ring->size) { -+ DRM_ERROR("bad ring head address: 0x%08x\n", -+ ring->head_addr); -+ mach64_dump_ring_info(dev_priv); -+ mach64_do_engine_reset(dev_priv); -+ return; -+ } -+ -+ ring->head = (ring->head_addr - ring->start_addr) / sizeof(u32); -+ -+ if (!gui_active && ring->head != ring->tail) { -+ mach64_ring_resume(dev_priv, ring); -+ } -+ } -+} -+ -+static __inline__ void mach64_ring_stop(drm_mach64_private_t * dev_priv) -+{ -+ DRM_DEBUG("head_addr: 0x%08x head: %d tail: %d space: %d\n", -+ dev_priv->ring.head_addr, dev_priv->ring.head, -+ dev_priv->ring.tail, dev_priv->ring.space); -+ -+ /* restore previous SRC_CNTL to disable busmastering */ -+ mach64_do_wait_for_fifo(dev_priv, 1); -+ MACH64_WRITE(MACH64_SRC_CNTL, 0); -+ -+ /* disable busmastering but keep the block 1 registers enabled */ -+ mach64_do_wait_for_idle(dev_priv); -+ MACH64_WRITE(MACH64_BUS_CNTL, MACH64_READ(MACH64_BUS_CNTL) -+ | MACH64_BUS_MASTER_DIS | MACH64_BUS_EXT_REG_EN); -+ -+ dev_priv->ring_running = 0; -+} -+ -+static __inline__ void -+mach64_update_ring_snapshot(drm_mach64_private_t * dev_priv) -+{ -+ drm_mach64_descriptor_ring_t *ring = &dev_priv->ring; -+ -+ DRM_DEBUG("\n"); -+ -+ mach64_ring_tick(dev_priv, ring); -+ -+ ring->space = (ring->head - ring->tail) * sizeof(u32); -+ if (ring->space <= 0) { -+ ring->space += ring->size; -+ } -+} -+ -+/* ================================================================ -+ * DMA macros -+ * -+ * Mach64's ring buffer doesn't take register writes directly. These -+ * have to be written indirectly in DMA buffers. These macros simplify -+ * the task of setting up a buffer, writing commands to it, and -+ * queuing the buffer in the ring. -+ */ -+ -+#define DMALOCALS \ -+ drm_mach64_freelist_t *_entry = NULL; \ -+ struct drm_buf *_buf = NULL; \ -+ u32 *_buf_wptr; int _outcount -+ -+#define GETBUFPTR( __buf ) \ -+((dev_priv->is_pci) ? \ -+ ((u32 *)(__buf)->address) : \ -+ ((u32 *)((char *)dev_priv->dev_buffers->handle + (__buf)->offset))) -+ -+#define GETBUFADDR( __buf ) ((u32)(__buf)->bus_address) -+ -+#define GETRINGOFFSET() (_entry->ring_ofs) -+ -+static __inline__ int mach64_find_pending_buf_entry(drm_mach64_private_t * -+ dev_priv, -+ drm_mach64_freelist_t ** -+ entry, struct drm_buf * buf) -+{ -+ struct list_head *ptr; -+#if MACH64_EXTRA_CHECKING -+ if (list_empty(&dev_priv->pending)) { -+ DRM_ERROR("Empty pending list in \n"); -+ return -EINVAL; -+ } -+#endif -+ ptr = dev_priv->pending.prev; -+ *entry = list_entry(ptr, drm_mach64_freelist_t, list); -+ while ((*entry)->buf != buf) { -+ if (ptr == &dev_priv->pending) { -+ return -EFAULT; -+ } -+ ptr = ptr->prev; -+ *entry = list_entry(ptr, drm_mach64_freelist_t, list); -+ } -+ return 0; -+} -+ -+#define DMASETPTR( _p ) \ -+do { \ -+ _buf = (_p); \ -+ _outcount = 0; \ -+ _buf_wptr = GETBUFPTR( _buf ); \ -+} while(0) -+ -+/* FIXME: use a private set of smaller buffers for state emits, clears, and swaps? */ -+#define DMAGETPTR( file_priv, dev_priv, n ) \ -+do { \ -+ if ( MACH64_VERBOSE ) { \ -+ DRM_INFO( "DMAGETPTR( %d )\n", (n) ); \ -+ } \ -+ _buf = mach64_freelist_get( dev_priv ); \ -+ if (_buf == NULL) { \ -+ DRM_ERROR("couldn't get buffer in DMAGETPTR\n"); \ -+ return -EAGAIN; \ -+ } \ -+ if (_buf->pending) { \ -+ DRM_ERROR("pending buf in DMAGETPTR\n"); \ -+ return -EFAULT; \ -+ } \ -+ _buf->file_priv = file_priv; \ -+ _outcount = 0; \ -+ \ -+ _buf_wptr = GETBUFPTR( _buf ); \ -+} while (0) -+ -+#define DMAOUTREG( reg, val ) \ -+do { \ -+ if ( MACH64_VERBOSE ) { \ -+ DRM_INFO( " DMAOUTREG( 0x%x = 0x%08x )\n", \ -+ reg, val ); \ -+ } \ -+ _buf_wptr[_outcount++] = cpu_to_le32(DMAREG(reg)); \ -+ _buf_wptr[_outcount++] = cpu_to_le32((val)); \ -+ _buf->used += 8; \ -+} while (0) -+ -+#define DMAADVANCE( dev_priv, _discard ) \ -+ do { \ -+ struct list_head *ptr; \ -+ int ret; \ -+ \ -+ if ( MACH64_VERBOSE ) { \ -+ DRM_INFO( "DMAADVANCE() in \n" ); \ -+ } \ -+ \ -+ if (_buf->used <= 0) { \ -+ DRM_ERROR( "DMAADVANCE(): sending empty buf %d\n", \ -+ _buf->idx ); \ -+ return -EFAULT; \ -+ } \ -+ if (_buf->pending) { \ -+ /* This is a resued buffer, so we need to find it in the pending list */ \ -+ if ((ret = mach64_find_pending_buf_entry(dev_priv, &_entry, _buf))) { \ -+ DRM_ERROR( "DMAADVANCE(): couldn't find pending buf %d\n", _buf->idx ); \ -+ return ret; \ -+ } \ -+ if (_entry->discard) { \ -+ DRM_ERROR( "DMAADVANCE(): sending discarded pending buf %d\n", _buf->idx ); \ -+ return -EFAULT; \ -+ } \ -+ } else { \ -+ if (list_empty(&dev_priv->placeholders)) { \ -+ DRM_ERROR( "DMAADVANCE(): empty placeholder list\n"); \ -+ return -EFAULT; \ -+ } \ -+ ptr = dev_priv->placeholders.next; \ -+ list_del(ptr); \ -+ _entry = list_entry(ptr, drm_mach64_freelist_t, list); \ -+ _buf->pending = 1; \ -+ _entry->buf = _buf; \ -+ list_add_tail(ptr, &dev_priv->pending); \ -+ } \ -+ _entry->discard = (_discard); \ -+ if ((ret = mach64_add_buf_to_ring( dev_priv, _entry ))) \ -+ return ret; \ -+ } while (0) -+ -+#define DMADISCARDBUF() \ -+ do { \ -+ if (_entry == NULL) { \ -+ int ret; \ -+ if ((ret = mach64_find_pending_buf_entry(dev_priv, &_entry, _buf))) { \ -+ DRM_ERROR( "couldn't find pending buf %d\n", \ -+ _buf->idx ); \ -+ return ret; \ -+ } \ -+ } \ -+ _entry->discard = 1; \ -+ } while(0) -+ -+#define DMAADVANCEHOSTDATA( dev_priv ) \ -+ do { \ -+ struct list_head *ptr; \ -+ int ret; \ -+ \ -+ if ( MACH64_VERBOSE ) { \ -+ DRM_INFO( "DMAADVANCEHOSTDATA() in \n" ); \ -+ } \ -+ \ -+ if (_buf->used <= 0) { \ -+ DRM_ERROR( "DMAADVANCEHOSTDATA(): sending empty buf %d\n", _buf->idx ); \ -+ return -EFAULT; \ -+ } \ -+ if (list_empty(&dev_priv->placeholders)) { \ -+ DRM_ERROR( "empty placeholder list in DMAADVANCEHOSTDATA()\n" ); \ -+ return -EFAULT; \ -+ } \ -+ \ -+ ptr = dev_priv->placeholders.next; \ -+ list_del(ptr); \ -+ _entry = list_entry(ptr, drm_mach64_freelist_t, list); \ -+ _entry->buf = _buf; \ -+ _entry->buf->pending = 1; \ -+ list_add_tail(ptr, &dev_priv->pending); \ -+ _entry->discard = 1; \ -+ if ((ret = mach64_add_hostdata_buf_to_ring( dev_priv, _entry ))) \ -+ return ret; \ -+ } while (0) -+ -+#endif /* __MACH64_DRV_H__ */ ---- /dev/null -+++ b/drivers/gpu/drm/mach64/mach64_irq.c -@@ -0,0 +1,159 @@ -+/* mach64_irq.c -- IRQ handling for ATI Mach64 -*- linux-c -*- -+ * Created: Tue Feb 25, 2003 by Leif Delgass, based on radeon_irq.c/r128_irq.c -+ */ -+/*- -+ * Copyright (C) The Weather Channel, Inc. 2002. -+ * Copyright 2003 Leif Delgass -+ * All Rights Reserved. -+ * -+ * The Weather Channel (TM) funded Tungsten Graphics to develop the -+ * initial release of the Radeon 8500 driver under the XFree86 license. -+ * This notice must be preserved. -+ * -+ * Permission is hereby granted, free of charge, to any person obtaining a -+ * copy of this software and associated documentation files (the "Software"), -+ * to deal in the Software without restriction, including without limitation -+ * the rights to use, copy, modify, merge, publish, distribute, sublicense, -+ * and/or sell copies of the Software, and to permit persons to whom the -+ * Software is furnished to do so, subject to the following conditions: -+ * -+ * The above copyright notice and this permission notice (including the next -+ * paragraph) shall be included in all copies or substantial portions of the -+ * Software. -+ * -+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR -+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, -+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL -+ * THE COPYRIGHT OWNER(S) AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR -+ * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, -+ * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER -+ * DEALINGS IN THE SOFTWARE. -+ * -+ * Authors: -+ * Keith Whitwell -+ * Eric Anholt -+ * Leif Delgass -+ */ -+ -+#include "drmP.h" -+#include "drm.h" -+#include "mach64_drm.h" -+#include "mach64_drv.h" -+ -+irqreturn_t mach64_driver_irq_handler(DRM_IRQ_ARGS) -+{ -+ struct drm_device *dev = arg; -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ int status; -+ -+ status = MACH64_READ(MACH64_CRTC_INT_CNTL); -+ -+ /* VBLANK interrupt */ -+ if (status & MACH64_CRTC_VBLANK_INT) { -+ /* Mask off all interrupt ack bits before setting the ack bit, since -+ * there may be other handlers outside the DRM. -+ * -+ * NOTE: On mach64, you need to keep the enable bits set when doing -+ * the ack, despite what the docs say about not acking and enabling -+ * in a single write. -+ */ -+ MACH64_WRITE(MACH64_CRTC_INT_CNTL, -+ (status & ~MACH64_CRTC_INT_ACKS) -+ | MACH64_CRTC_VBLANK_INT); -+ -+ atomic_inc(&dev_priv->vbl_received); -+ drm_handle_vblank(dev, 0); -+ return IRQ_HANDLED; -+ } -+ return IRQ_NONE; -+} -+ -+u32 mach64_get_vblank_counter(struct drm_device * dev, int crtc) -+{ -+ const drm_mach64_private_t *const dev_priv = dev->dev_private; -+ -+ if (crtc != 0) -+ return 0; -+ -+ return atomic_read(&dev_priv->vbl_received); -+} -+ -+int mach64_enable_vblank(struct drm_device * dev, int crtc) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ u32 status = MACH64_READ(MACH64_CRTC_INT_CNTL); -+ -+ if (crtc != 0) { -+ DRM_ERROR("tried to enable vblank on non-existent crtc %d\n", -+ crtc); -+ return -EINVAL; -+ } -+ -+ DRM_DEBUG("before enable vblank CRTC_INT_CTNL: 0x%08x\n", status); -+ -+ /* Turn on VBLANK interrupt */ -+ MACH64_WRITE(MACH64_CRTC_INT_CNTL, MACH64_READ(MACH64_CRTC_INT_CNTL) -+ | MACH64_CRTC_VBLANK_INT_EN); -+ -+ return 0; -+} -+ -+void mach64_disable_vblank(struct drm_device * dev, int crtc) -+{ -+ if (crtc != 0) { -+ DRM_ERROR("tried to disable vblank on non-existent crtc %d\n", -+ crtc); -+ return; -+ } -+ -+ /* -+ * FIXME: implement proper interrupt disable by using the vblank -+ * counter register (if available). -+ */ -+} -+ -+static void mach64_disable_vblank_local(struct drm_device * dev, int crtc) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ u32 status = MACH64_READ(MACH64_CRTC_INT_CNTL); -+ -+ if (crtc != 0) { -+ DRM_ERROR("tried to disable vblank on non-existent crtc %d\n", -+ crtc); -+ return; -+ } -+ -+ DRM_DEBUG("before disable vblank CRTC_INT_CTNL: 0x%08x\n", status); -+ -+ /* Disable and clear VBLANK interrupt */ -+ MACH64_WRITE(MACH64_CRTC_INT_CNTL, (status & ~MACH64_CRTC_VBLANK_INT_EN) -+ | MACH64_CRTC_VBLANK_INT); -+} -+ -+void mach64_driver_irq_preinstall(struct drm_device * dev) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ -+ u32 status = MACH64_READ(MACH64_CRTC_INT_CNTL); -+ -+ DRM_DEBUG("before install CRTC_INT_CTNL: 0x%08x\n", status); -+ -+ mach64_disable_vblank_local(dev, 0); -+} -+ -+int mach64_driver_irq_postinstall(struct drm_device * dev) -+{ -+ return drm_vblank_init(dev, 1); -+} -+ -+void mach64_driver_irq_uninstall(struct drm_device * dev) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ if (!dev_priv) -+ return; -+ -+ mach64_disable_vblank_local(dev, 0); -+ -+ DRM_DEBUG("after uninstall CRTC_INT_CTNL: 0x%08x\n", -+ MACH64_READ(MACH64_CRTC_INT_CNTL)); -+} ---- /dev/null -+++ b/drivers/gpu/drm/mach64/mach64_state.c -@@ -0,0 +1,910 @@ -+/* mach64_state.c -- State support for mach64 (Rage Pro) driver -*- linux-c -*- -+ * Created: Sun Dec 03 19:20:26 2000 by gareth@valinux.com -+ */ -+/* -+ * Copyright 2000 Gareth Hughes -+ * Copyright 2002-2003 Leif Delgass -+ * All Rights Reserved. -+ * -+ * Permission is hereby granted, free of charge, to any person obtaining a -+ * copy of this software and associated documentation files (the "Software"), -+ * to deal in the Software without restriction, including without limitation -+ * the rights to use, copy, modify, merge, publish, distribute, sublicense, -+ * and/or sell copies of the Software, and to permit persons to whom the -+ * Software is furnished to do so, subject to the following conditions: -+ * -+ * The above copyright notice and this permission notice (including the next -+ * paragraph) shall be included in all copies or substantial portions of the -+ * Software. -+ * -+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR -+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, -+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL -+ * THE COPYRIGHT OWNER(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER -+ * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN -+ * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. -+ * -+ * Authors: -+ * Gareth Hughes -+ * Leif Delgass -+ * José Fonseca -+ */ -+ -+#include "drmP.h" -+#include "drm.h" -+#include "mach64_drm.h" -+#include "mach64_drv.h" -+ -+/* Interface history: -+ * -+ * 1.0 - Initial mach64 DRM -+ * -+ */ -+struct drm_ioctl_desc mach64_ioctls[] = { -+ DRM_IOCTL_DEF(DRM_MACH64_INIT, mach64_dma_init, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY), -+ DRM_IOCTL_DEF(DRM_MACH64_CLEAR, mach64_dma_clear, DRM_AUTH), -+ DRM_IOCTL_DEF(DRM_MACH64_SWAP, mach64_dma_swap, DRM_AUTH), -+ DRM_IOCTL_DEF(DRM_MACH64_IDLE, mach64_dma_idle, DRM_AUTH), -+ DRM_IOCTL_DEF(DRM_MACH64_RESET, mach64_engine_reset, DRM_AUTH), -+ DRM_IOCTL_DEF(DRM_MACH64_VERTEX, mach64_dma_vertex, DRM_AUTH), -+ DRM_IOCTL_DEF(DRM_MACH64_BLIT, mach64_dma_blit, DRM_AUTH), -+ DRM_IOCTL_DEF(DRM_MACH64_FLUSH, mach64_dma_flush, DRM_AUTH), -+ DRM_IOCTL_DEF(DRM_MACH64_GETPARAM, mach64_get_param, DRM_AUTH), -+}; -+ -+int mach64_max_ioctl = DRM_ARRAY_SIZE(mach64_ioctls); -+ -+/* ================================================================ -+ * DMA hardware state programming functions -+ */ -+ -+static void mach64_print_dirty(const char *msg, unsigned int flags) -+{ -+ DRM_DEBUG("%s: (0x%x) %s%s%s%s%s%s%s%s%s%s%s%s\n", -+ msg, -+ flags, -+ (flags & MACH64_UPLOAD_DST_OFF_PITCH) ? "dst_off_pitch, " : -+ "", -+ (flags & MACH64_UPLOAD_Z_ALPHA_CNTL) ? "z_alpha_cntl, " : "", -+ (flags & MACH64_UPLOAD_SCALE_3D_CNTL) ? "scale_3d_cntl, " : -+ "", (flags & MACH64_UPLOAD_DP_FOG_CLR) ? "dp_fog_clr, " : "", -+ (flags & MACH64_UPLOAD_DP_WRITE_MASK) ? "dp_write_mask, " : -+ "", -+ (flags & MACH64_UPLOAD_DP_PIX_WIDTH) ? "dp_pix_width, " : "", -+ (flags & MACH64_UPLOAD_SETUP_CNTL) ? "setup_cntl, " : "", -+ (flags & MACH64_UPLOAD_MISC) ? "misc, " : "", -+ (flags & MACH64_UPLOAD_TEXTURE) ? "texture, " : "", -+ (flags & MACH64_UPLOAD_TEX0IMAGE) ? "tex0 image, " : "", -+ (flags & MACH64_UPLOAD_TEX1IMAGE) ? "tex1 image, " : "", -+ (flags & MACH64_UPLOAD_CLIPRECTS) ? "cliprects, " : ""); -+} -+ -+/* Mach64 doesn't have hardware cliprects, just one hardware scissor, -+ * so the GL scissor is intersected with each cliprect here -+ */ -+/* This function returns 0 on success, 1 for no intersection, and -+ * negative for an error -+ */ -+static int mach64_emit_cliprect(struct drm_file *file_priv, -+ drm_mach64_private_t * dev_priv, -+ struct drm_clip_rect * box) -+{ -+ u32 sc_left_right, sc_top_bottom; -+ struct drm_clip_rect scissor; -+ drm_mach64_sarea_t *sarea_priv = dev_priv->sarea_priv; -+ drm_mach64_context_regs_t *regs = &sarea_priv->context_state; -+ DMALOCALS; -+ -+ DRM_DEBUG("box=%p\n", box); -+ -+ /* Get GL scissor */ -+ /* FIXME: store scissor in SAREA as a cliprect instead of in -+ * hardware format, or do intersection client-side -+ */ -+ scissor.x1 = regs->sc_left_right & 0xffff; -+ scissor.x2 = (regs->sc_left_right & 0xffff0000) >> 16; -+ scissor.y1 = regs->sc_top_bottom & 0xffff; -+ scissor.y2 = (regs->sc_top_bottom & 0xffff0000) >> 16; -+ -+ /* Intersect GL scissor with cliprect */ -+ if (box->x1 > scissor.x1) -+ scissor.x1 = box->x1; -+ if (box->y1 > scissor.y1) -+ scissor.y1 = box->y1; -+ if (box->x2 < scissor.x2) -+ scissor.x2 = box->x2; -+ if (box->y2 < scissor.y2) -+ scissor.y2 = box->y2; -+ /* positive return means skip */ -+ if (scissor.x1 >= scissor.x2) -+ return 1; -+ if (scissor.y1 >= scissor.y2) -+ return 1; -+ -+ DMAGETPTR(file_priv, dev_priv, 2); /* returns on failure to get buffer */ -+ -+ sc_left_right = ((scissor.x1 << 0) | (scissor.x2 << 16)); -+ sc_top_bottom = ((scissor.y1 << 0) | (scissor.y2 << 16)); -+ -+ DMAOUTREG(MACH64_SC_LEFT_RIGHT, sc_left_right); -+ DMAOUTREG(MACH64_SC_TOP_BOTTOM, sc_top_bottom); -+ -+ DMAADVANCE(dev_priv, 1); -+ -+ return 0; -+} -+ -+static __inline__ int mach64_emit_state(struct drm_file *file_priv, -+ drm_mach64_private_t * dev_priv) -+{ -+ drm_mach64_sarea_t *sarea_priv = dev_priv->sarea_priv; -+ drm_mach64_context_regs_t *regs = &sarea_priv->context_state; -+ unsigned int dirty = sarea_priv->dirty; -+ u32 offset = ((regs->tex_size_pitch & 0xf0) >> 2); -+ DMALOCALS; -+ -+ if (MACH64_VERBOSE) { -+ mach64_print_dirty(__FUNCTION__, dirty); -+ } else { -+ DRM_DEBUG("dirty=0x%08x\n", dirty); -+ } -+ -+ DMAGETPTR(file_priv, dev_priv, 17); /* returns on failure to get buffer */ -+ -+ if (dirty & MACH64_UPLOAD_MISC) { -+ DMAOUTREG(MACH64_DP_MIX, regs->dp_mix); -+ DMAOUTREG(MACH64_DP_SRC, regs->dp_src); -+ DMAOUTREG(MACH64_CLR_CMP_CNTL, regs->clr_cmp_cntl); -+ DMAOUTREG(MACH64_GUI_TRAJ_CNTL, regs->gui_traj_cntl); -+ sarea_priv->dirty &= ~MACH64_UPLOAD_MISC; -+ } -+ -+ if (dirty & MACH64_UPLOAD_DST_OFF_PITCH) { -+ DMAOUTREG(MACH64_DST_OFF_PITCH, regs->dst_off_pitch); -+ sarea_priv->dirty &= ~MACH64_UPLOAD_DST_OFF_PITCH; -+ } -+ if (dirty & MACH64_UPLOAD_Z_OFF_PITCH) { -+ DMAOUTREG(MACH64_Z_OFF_PITCH, regs->z_off_pitch); -+ sarea_priv->dirty &= ~MACH64_UPLOAD_Z_OFF_PITCH; -+ } -+ if (dirty & MACH64_UPLOAD_Z_ALPHA_CNTL) { -+ DMAOUTREG(MACH64_Z_CNTL, regs->z_cntl); -+ DMAOUTREG(MACH64_ALPHA_TST_CNTL, regs->alpha_tst_cntl); -+ sarea_priv->dirty &= ~MACH64_UPLOAD_Z_ALPHA_CNTL; -+ } -+ if (dirty & MACH64_UPLOAD_SCALE_3D_CNTL) { -+ DMAOUTREG(MACH64_SCALE_3D_CNTL, regs->scale_3d_cntl); -+ sarea_priv->dirty &= ~MACH64_UPLOAD_SCALE_3D_CNTL; -+ } -+ if (dirty & MACH64_UPLOAD_DP_FOG_CLR) { -+ DMAOUTREG(MACH64_DP_FOG_CLR, regs->dp_fog_clr); -+ sarea_priv->dirty &= ~MACH64_UPLOAD_DP_FOG_CLR; -+ } -+ if (dirty & MACH64_UPLOAD_DP_WRITE_MASK) { -+ DMAOUTREG(MACH64_DP_WRITE_MASK, regs->dp_write_mask); -+ sarea_priv->dirty &= ~MACH64_UPLOAD_DP_WRITE_MASK; -+ } -+ if (dirty & MACH64_UPLOAD_DP_PIX_WIDTH) { -+ DMAOUTREG(MACH64_DP_PIX_WIDTH, regs->dp_pix_width); -+ sarea_priv->dirty &= ~MACH64_UPLOAD_DP_PIX_WIDTH; -+ } -+ if (dirty & MACH64_UPLOAD_SETUP_CNTL) { -+ DMAOUTREG(MACH64_SETUP_CNTL, regs->setup_cntl); -+ sarea_priv->dirty &= ~MACH64_UPLOAD_SETUP_CNTL; -+ } -+ -+ if (dirty & MACH64_UPLOAD_TEXTURE) { -+ DMAOUTREG(MACH64_TEX_SIZE_PITCH, regs->tex_size_pitch); -+ DMAOUTREG(MACH64_TEX_CNTL, regs->tex_cntl); -+ DMAOUTREG(MACH64_SECONDARY_TEX_OFF, regs->secondary_tex_off); -+ DMAOUTREG(MACH64_TEX_0_OFF + offset, regs->tex_offset); -+ sarea_priv->dirty &= ~MACH64_UPLOAD_TEXTURE; -+ } -+ -+ DMAADVANCE(dev_priv, 1); -+ -+ sarea_priv->dirty &= MACH64_UPLOAD_CLIPRECTS; -+ -+ return 0; -+ -+} -+ -+/* ================================================================ -+ * DMA command dispatch functions -+ */ -+ -+static int mach64_dma_dispatch_clear(struct drm_device * dev, -+ struct drm_file *file_priv, -+ unsigned int flags, -+ int cx, int cy, int cw, int ch, -+ unsigned int clear_color, -+ unsigned int clear_depth) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ drm_mach64_sarea_t *sarea_priv = dev_priv->sarea_priv; -+ drm_mach64_context_regs_t *ctx = &sarea_priv->context_state; -+ int nbox = sarea_priv->nbox; -+ struct drm_clip_rect *pbox = sarea_priv->boxes; -+ u32 fb_bpp, depth_bpp; -+ int i; -+ DMALOCALS; -+ -+ DRM_DEBUG("\n"); -+ -+ switch (dev_priv->fb_bpp) { -+ case 16: -+ fb_bpp = MACH64_DATATYPE_RGB565; -+ break; -+ case 32: -+ fb_bpp = MACH64_DATATYPE_ARGB8888; -+ break; -+ default: -+ return -EINVAL; -+ } -+ switch (dev_priv->depth_bpp) { -+ case 16: -+ depth_bpp = MACH64_DATATYPE_RGB565; -+ break; -+ case 24: -+ case 32: -+ depth_bpp = MACH64_DATATYPE_ARGB8888; -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ if (!nbox) -+ return 0; -+ -+ DMAGETPTR(file_priv, dev_priv, nbox * 31); /* returns on failure to get buffer */ -+ -+ for (i = 0; i < nbox; i++) { -+ int x = pbox[i].x1; -+ int y = pbox[i].y1; -+ int w = pbox[i].x2 - x; -+ int h = pbox[i].y2 - y; -+ -+ DRM_DEBUG("dispatch clear %d,%d-%d,%d flags 0x%x\n", -+ pbox[i].x1, pbox[i].y1, -+ pbox[i].x2, pbox[i].y2, flags); -+ -+ if (flags & (MACH64_FRONT | MACH64_BACK)) { -+ /* Setup for color buffer clears -+ */ -+ -+ DMAOUTREG(MACH64_Z_CNTL, 0); -+ DMAOUTREG(MACH64_SCALE_3D_CNTL, 0); -+ -+ DMAOUTREG(MACH64_SC_LEFT_RIGHT, ctx->sc_left_right); -+ DMAOUTREG(MACH64_SC_TOP_BOTTOM, ctx->sc_top_bottom); -+ -+ DMAOUTREG(MACH64_CLR_CMP_CNTL, 0); -+ DMAOUTREG(MACH64_GUI_TRAJ_CNTL, -+ (MACH64_DST_X_LEFT_TO_RIGHT | -+ MACH64_DST_Y_TOP_TO_BOTTOM)); -+ -+ DMAOUTREG(MACH64_DP_PIX_WIDTH, ((fb_bpp << 0) | -+ (fb_bpp << 4) | -+ (fb_bpp << 8) | -+ (fb_bpp << 16) | -+ (fb_bpp << 28))); -+ -+ DMAOUTREG(MACH64_DP_FRGD_CLR, clear_color); -+ DMAOUTREG(MACH64_DP_WRITE_MASK, ctx->dp_write_mask); -+ DMAOUTREG(MACH64_DP_MIX, (MACH64_BKGD_MIX_D | -+ MACH64_FRGD_MIX_S)); -+ DMAOUTREG(MACH64_DP_SRC, (MACH64_BKGD_SRC_FRGD_CLR | -+ MACH64_FRGD_SRC_FRGD_CLR | -+ MACH64_MONO_SRC_ONE)); -+ -+ } -+ -+ if (flags & MACH64_FRONT) { -+ -+ DMAOUTREG(MACH64_DST_OFF_PITCH, -+ dev_priv->front_offset_pitch); -+ DMAOUTREG(MACH64_DST_X_Y, (y << 16) | x); -+ DMAOUTREG(MACH64_DST_WIDTH_HEIGHT, (h << 16) | w); -+ -+ } -+ -+ if (flags & MACH64_BACK) { -+ -+ DMAOUTREG(MACH64_DST_OFF_PITCH, -+ dev_priv->back_offset_pitch); -+ DMAOUTREG(MACH64_DST_X_Y, (y << 16) | x); -+ DMAOUTREG(MACH64_DST_WIDTH_HEIGHT, (h << 16) | w); -+ -+ } -+ -+ if (flags & MACH64_DEPTH) { -+ /* Setup for depth buffer clear -+ */ -+ DMAOUTREG(MACH64_Z_CNTL, 0); -+ DMAOUTREG(MACH64_SCALE_3D_CNTL, 0); -+ -+ DMAOUTREG(MACH64_SC_LEFT_RIGHT, ctx->sc_left_right); -+ DMAOUTREG(MACH64_SC_TOP_BOTTOM, ctx->sc_top_bottom); -+ -+ DMAOUTREG(MACH64_CLR_CMP_CNTL, 0); -+ DMAOUTREG(MACH64_GUI_TRAJ_CNTL, -+ (MACH64_DST_X_LEFT_TO_RIGHT | -+ MACH64_DST_Y_TOP_TO_BOTTOM)); -+ -+ DMAOUTREG(MACH64_DP_PIX_WIDTH, ((depth_bpp << 0) | -+ (depth_bpp << 4) | -+ (depth_bpp << 8) | -+ (depth_bpp << 16) | -+ (depth_bpp << 28))); -+ -+ DMAOUTREG(MACH64_DP_FRGD_CLR, clear_depth); -+ DMAOUTREG(MACH64_DP_WRITE_MASK, 0xffffffff); -+ DMAOUTREG(MACH64_DP_MIX, (MACH64_BKGD_MIX_D | -+ MACH64_FRGD_MIX_S)); -+ DMAOUTREG(MACH64_DP_SRC, (MACH64_BKGD_SRC_FRGD_CLR | -+ MACH64_FRGD_SRC_FRGD_CLR | -+ MACH64_MONO_SRC_ONE)); -+ -+ DMAOUTREG(MACH64_DST_OFF_PITCH, -+ dev_priv->depth_offset_pitch); -+ DMAOUTREG(MACH64_DST_X_Y, (y << 16) | x); -+ DMAOUTREG(MACH64_DST_WIDTH_HEIGHT, (h << 16) | w); -+ } -+ } -+ -+ DMAADVANCE(dev_priv, 1); -+ -+ return 0; -+} -+ -+static int mach64_dma_dispatch_swap(struct drm_device * dev, -+ struct drm_file *file_priv) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ drm_mach64_sarea_t *sarea_priv = dev_priv->sarea_priv; -+ int nbox = sarea_priv->nbox; -+ struct drm_clip_rect *pbox = sarea_priv->boxes; -+ u32 fb_bpp; -+ int i; -+ DMALOCALS; -+ -+ DRM_DEBUG("\n"); -+ -+ switch (dev_priv->fb_bpp) { -+ case 16: -+ fb_bpp = MACH64_DATATYPE_RGB565; -+ break; -+ case 32: -+ default: -+ fb_bpp = MACH64_DATATYPE_ARGB8888; -+ break; -+ } -+ -+ if (!nbox) -+ return 0; -+ -+ DMAGETPTR(file_priv, dev_priv, 13 + nbox * 4); /* returns on failure to get buffer */ -+ -+ DMAOUTREG(MACH64_Z_CNTL, 0); -+ DMAOUTREG(MACH64_SCALE_3D_CNTL, 0); -+ -+ DMAOUTREG(MACH64_SC_LEFT_RIGHT, 0 | (8191 << 16)); /* no scissor */ -+ DMAOUTREG(MACH64_SC_TOP_BOTTOM, 0 | (16383 << 16)); -+ -+ DMAOUTREG(MACH64_CLR_CMP_CNTL, 0); -+ DMAOUTREG(MACH64_GUI_TRAJ_CNTL, (MACH64_DST_X_LEFT_TO_RIGHT | -+ MACH64_DST_Y_TOP_TO_BOTTOM)); -+ -+ DMAOUTREG(MACH64_DP_PIX_WIDTH, ((fb_bpp << 0) | -+ (fb_bpp << 4) | -+ (fb_bpp << 8) | -+ (fb_bpp << 16) | (fb_bpp << 28))); -+ -+ DMAOUTREG(MACH64_DP_WRITE_MASK, 0xffffffff); -+ DMAOUTREG(MACH64_DP_MIX, (MACH64_BKGD_MIX_D | MACH64_FRGD_MIX_S)); -+ DMAOUTREG(MACH64_DP_SRC, (MACH64_BKGD_SRC_BKGD_CLR | -+ MACH64_FRGD_SRC_BLIT | MACH64_MONO_SRC_ONE)); -+ -+ DMAOUTREG(MACH64_SRC_OFF_PITCH, dev_priv->back_offset_pitch); -+ DMAOUTREG(MACH64_DST_OFF_PITCH, dev_priv->front_offset_pitch); -+ -+ for (i = 0; i < nbox; i++) { -+ int x = pbox[i].x1; -+ int y = pbox[i].y1; -+ int w = pbox[i].x2 - x; -+ int h = pbox[i].y2 - y; -+ -+ DRM_DEBUG("dispatch swap %d,%d-%d,%d\n", -+ pbox[i].x1, pbox[i].y1, pbox[i].x2, pbox[i].y2); -+ -+ DMAOUTREG(MACH64_SRC_WIDTH1, w); -+ DMAOUTREG(MACH64_SRC_Y_X, (x << 16) | y); -+ DMAOUTREG(MACH64_DST_Y_X, (x << 16) | y); -+ DMAOUTREG(MACH64_DST_WIDTH_HEIGHT, (h << 16) | w); -+ -+ } -+ -+ DMAADVANCE(dev_priv, 1); -+ -+ if (dev_priv->driver_mode == MACH64_MODE_DMA_ASYNC) { -+ for (i = 0; i < MACH64_MAX_QUEUED_FRAMES - 1; i++) { -+ dev_priv->frame_ofs[i] = dev_priv->frame_ofs[i + 1]; -+ } -+ dev_priv->frame_ofs[i] = GETRINGOFFSET(); -+ -+ dev_priv->sarea_priv->frames_queued++; -+ } -+ -+ return 0; -+} -+ -+static int mach64_do_get_frames_queued(drm_mach64_private_t * dev_priv) -+{ -+ drm_mach64_descriptor_ring_t *ring = &dev_priv->ring; -+ drm_mach64_sarea_t *sarea_priv = dev_priv->sarea_priv; -+ int i, start; -+ u32 head, tail, ofs; -+ -+ DRM_DEBUG("\n"); -+ -+ if (sarea_priv->frames_queued == 0) -+ return 0; -+ -+ tail = ring->tail; -+ mach64_ring_tick(dev_priv, ring); -+ head = ring->head; -+ -+ start = (MACH64_MAX_QUEUED_FRAMES - -+ DRM_MIN(MACH64_MAX_QUEUED_FRAMES, sarea_priv->frames_queued)); -+ -+ if (head == tail) { -+ sarea_priv->frames_queued = 0; -+ for (i = start; i < MACH64_MAX_QUEUED_FRAMES; i++) { -+ dev_priv->frame_ofs[i] = ~0; -+ } -+ return 0; -+ } -+ -+ for (i = start; i < MACH64_MAX_QUEUED_FRAMES; i++) { -+ ofs = dev_priv->frame_ofs[i]; -+ DRM_DEBUG("frame_ofs[%d] ofs: %d\n", i, ofs); -+ if (ofs == ~0 || -+ (head < tail && (ofs < head || ofs >= tail)) || -+ (head > tail && (ofs < head && ofs >= tail))) { -+ sarea_priv->frames_queued = -+ (MACH64_MAX_QUEUED_FRAMES - 1) - i; -+ dev_priv->frame_ofs[i] = ~0; -+ } -+ } -+ -+ return sarea_priv->frames_queued; -+} -+ -+/* Copy and verify a client submited buffer. -+ * FIXME: Make an assembly optimized version -+ */ -+static __inline__ int copy_from_user_vertex(u32 *to, -+ const u32 __user *ufrom, -+ unsigned long bytes) -+{ -+ unsigned long n = bytes; /* dwords remaining in buffer */ -+ u32 *from, *orig_from; -+ -+ from = drm_alloc(bytes, DRM_MEM_DRIVER); -+ if (from == NULL) -+ return -ENOMEM; -+ -+ if (DRM_COPY_FROM_USER(from, ufrom, bytes)) { -+ drm_free(from, bytes, DRM_MEM_DRIVER); -+ return -EFAULT; -+ } -+ orig_from = from; /* we'll be modifying the "from" ptr, so save it */ -+ -+ n >>= 2; -+ -+ while (n > 1) { -+ u32 data, reg, count; -+ -+ data = *from++; -+ -+ n--; -+ -+ reg = le32_to_cpu(data); -+ count = (reg >> 16) + 1; -+ if (count <= n) { -+ n -= count; -+ reg &= 0xffff; -+ -+ /* This is an exact match of Mach64's Setup Engine registers, -+ * excluding SETUP_CNTL (1_C1). -+ */ -+ if ((reg >= 0x0190 && reg < 0x01c1) || -+ (reg >= 0x01ca && reg <= 0x01cf)) { -+ *to++ = data; -+ memcpy(to, from, count << 2); -+ from += count; -+ to += count; -+ } else { -+ DRM_ERROR("Got bad command: 0x%04x\n", reg); -+ drm_free(orig_from, bytes, DRM_MEM_DRIVER); -+ return -EACCES; -+ } -+ } else { -+ DRM_ERROR -+ ("Got bad command count(=%u) dwords remaining=%lu\n", -+ count, n); -+ drm_free(orig_from, bytes, DRM_MEM_DRIVER); -+ return -EINVAL; -+ } -+ } -+ -+ drm_free(orig_from, bytes, DRM_MEM_DRIVER); -+ if (n == 0) -+ return 0; -+ else { -+ DRM_ERROR("Bad buf->used(=%lu)\n", bytes); -+ return -EINVAL; -+ } -+} -+ -+static int mach64_dma_dispatch_vertex(struct drm_device * dev, -+ struct drm_file *file_priv, -+ drm_mach64_vertex_t * vertex) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ drm_mach64_sarea_t *sarea_priv = dev_priv->sarea_priv; -+ struct drm_buf *copy_buf; -+ void *buf = vertex->buf; -+ unsigned long used = vertex->used; -+ int ret = 0; -+ int i = 0; -+ int done = 0; -+ int verify_ret = 0; -+ DMALOCALS; -+ -+ DRM_DEBUG("buf=%p used=%lu nbox=%d\n", -+ buf, used, sarea_priv->nbox); -+ -+ if (!used) -+ goto _vertex_done; -+ -+ copy_buf = mach64_freelist_get(dev_priv); -+ if (copy_buf == NULL) { -+ DRM_ERROR("couldn't get buffer\n"); -+ return -EAGAIN; -+ } -+ -+ /* Mach64's vertex data is actually register writes. To avoid security -+ * compromises these register writes have to be verified and copied from -+ * user space into a private DMA buffer. -+ */ -+ verify_ret = copy_from_user_vertex(GETBUFPTR(copy_buf), buf, used); -+ -+ if (verify_ret != 0) { -+ mach64_freelist_put(dev_priv, copy_buf); -+ goto _vertex_done; -+ } -+ -+ copy_buf->used = used; -+ -+ DMASETPTR(copy_buf); -+ -+ if (sarea_priv->dirty & ~MACH64_UPLOAD_CLIPRECTS) { -+ ret = mach64_emit_state(file_priv, dev_priv); -+ if (ret < 0) -+ return ret; -+ } -+ -+ do { -+ /* Emit the next cliprect */ -+ if (i < sarea_priv->nbox) { -+ ret = mach64_emit_cliprect(file_priv, dev_priv, -+ &sarea_priv->boxes[i]); -+ if (ret < 0) { -+ /* failed to get buffer */ -+ return ret; -+ } else if (ret != 0) { -+ /* null intersection with scissor */ -+ continue; -+ } -+ } -+ if ((i >= sarea_priv->nbox - 1)) -+ done = 1; -+ -+ /* Add the buffer to the DMA queue */ -+ DMAADVANCE(dev_priv, done); -+ -+ } while (++i < sarea_priv->nbox); -+ -+ if (!done) { -+ if (copy_buf->pending) { -+ DMADISCARDBUF(); -+ } else { -+ /* This buffer wasn't used (no cliprects), so place it -+ * back on the free list -+ */ -+ mach64_freelist_put(dev_priv, copy_buf); -+ } -+ } -+ -+_vertex_done: -+ sarea_priv->dirty &= ~MACH64_UPLOAD_CLIPRECTS; -+ sarea_priv->nbox = 0; -+ -+ return verify_ret; -+} -+ -+static __inline__ int copy_from_user_blit(u32 *to, -+ const u32 __user *ufrom, -+ unsigned long bytes) -+{ -+ to = (u32 *)((char *)to + MACH64_HOSTDATA_BLIT_OFFSET); -+ -+ if (DRM_COPY_FROM_USER(to, ufrom, bytes)) { -+ return -EFAULT; -+ } -+ -+ return 0; -+} -+ -+static int mach64_dma_dispatch_blit(struct drm_device * dev, -+ struct drm_file *file_priv, -+ drm_mach64_blit_t * blit) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ int dword_shift, dwords; -+ unsigned long used; -+ struct drm_buf *copy_buf; -+ int verify_ret = 0; -+ DMALOCALS; -+ -+ /* The compiler won't optimize away a division by a variable, -+ * even if the only legal values are powers of two. Thus, we'll -+ * use a shift instead. -+ */ -+ switch (blit->format) { -+ case MACH64_DATATYPE_ARGB8888: -+ dword_shift = 0; -+ break; -+ case MACH64_DATATYPE_ARGB1555: -+ case MACH64_DATATYPE_RGB565: -+ case MACH64_DATATYPE_VYUY422: -+ case MACH64_DATATYPE_YVYU422: -+ case MACH64_DATATYPE_ARGB4444: -+ dword_shift = 1; -+ break; -+ case MACH64_DATATYPE_CI8: -+ case MACH64_DATATYPE_RGB8: -+ dword_shift = 2; -+ break; -+ default: -+ DRM_ERROR("invalid blit format %d\n", blit->format); -+ return -EINVAL; -+ } -+ -+ /* Set buf->used to the bytes of blit data based on the blit dimensions -+ * and verify the size. When the setup is emitted to the buffer with -+ * the DMA* macros below, buf->used is incremented to include the bytes -+ * used for setup as well as the blit data. -+ */ -+ dwords = (blit->width * blit->height) >> dword_shift; -+ used = dwords << 2; -+ if (used <= 0 || -+ used > MACH64_BUFFER_SIZE - MACH64_HOSTDATA_BLIT_OFFSET) { -+ DRM_ERROR("Invalid blit size: %lu bytes\n", used); -+ return -EINVAL; -+ } -+ -+ copy_buf = mach64_freelist_get(dev_priv); -+ if (copy_buf == NULL) { -+ DRM_ERROR("couldn't get buffer\n"); -+ return -EAGAIN; -+ } -+ -+ /* Copy the blit data from userspace. -+ * -+ * XXX: This is overkill. The most efficient solution would be having -+ * two sets of buffers (one set private for vertex data, the other set -+ * client-writable for blits). However that would bring more complexity -+ * and would break backward compatability. The solution currently -+ * implemented is keeping all buffers private, allowing to secure the -+ * driver, without increasing complexity at the expense of some speed -+ * transfering data. -+ */ -+ verify_ret = copy_from_user_blit(GETBUFPTR(copy_buf), blit->buf, used); -+ -+ if (verify_ret != 0) { -+ mach64_freelist_put(dev_priv, copy_buf); -+ goto _blit_done; -+ } -+ -+ copy_buf->used = used; -+ -+ /* FIXME: Use a last buffer flag and reduce the state emitted for subsequent, -+ * continuation buffers? -+ */ -+ -+ /* Blit via BM_HOSTDATA (gui-master) - like HOST_DATA[0-15], but doesn't require -+ * a register command every 16 dwords. State setup is added at the start of the -+ * buffer -- the client leaves space for this based on MACH64_HOSTDATA_BLIT_OFFSET -+ */ -+ DMASETPTR(copy_buf); -+ -+ DMAOUTREG(MACH64_Z_CNTL, 0); -+ DMAOUTREG(MACH64_SCALE_3D_CNTL, 0); -+ -+ DMAOUTREG(MACH64_SC_LEFT_RIGHT, 0 | (8191 << 16)); /* no scissor */ -+ DMAOUTREG(MACH64_SC_TOP_BOTTOM, 0 | (16383 << 16)); -+ -+ DMAOUTREG(MACH64_CLR_CMP_CNTL, 0); /* disable */ -+ DMAOUTREG(MACH64_GUI_TRAJ_CNTL, -+ MACH64_DST_X_LEFT_TO_RIGHT | MACH64_DST_Y_TOP_TO_BOTTOM); -+ -+ DMAOUTREG(MACH64_DP_PIX_WIDTH, (blit->format << 0) /* dst pix width */ -+ |(blit->format << 4) /* composite pix width */ -+ |(blit->format << 8) /* src pix width */ -+ |(blit->format << 16) /* host data pix width */ -+ |(blit->format << 28) /* scaler/3D pix width */ -+ ); -+ -+ DMAOUTREG(MACH64_DP_WRITE_MASK, 0xffffffff); /* enable all planes */ -+ DMAOUTREG(MACH64_DP_MIX, MACH64_BKGD_MIX_D | MACH64_FRGD_MIX_S); -+ DMAOUTREG(MACH64_DP_SRC, -+ MACH64_BKGD_SRC_BKGD_CLR -+ | MACH64_FRGD_SRC_HOST | MACH64_MONO_SRC_ONE); -+ -+ DMAOUTREG(MACH64_DST_OFF_PITCH, -+ (blit->pitch << 22) | (blit->offset >> 3)); -+ DMAOUTREG(MACH64_DST_X_Y, (blit->y << 16) | blit->x); -+ DMAOUTREG(MACH64_DST_WIDTH_HEIGHT, (blit->height << 16) | blit->width); -+ -+ DRM_DEBUG("%lu bytes\n", used); -+ -+ /* Add the buffer to the queue */ -+ DMAADVANCEHOSTDATA(dev_priv); -+ -+_blit_done: -+ return verify_ret; -+} -+ -+/* ================================================================ -+ * IOCTL functions -+ */ -+ -+int mach64_dma_clear(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ drm_mach64_sarea_t *sarea_priv = dev_priv->sarea_priv; -+ drm_mach64_clear_t *clear = data; -+ int ret; -+ -+ DRM_DEBUG("pid=%d\n", DRM_CURRENTPID); -+ -+ LOCK_TEST_WITH_RETURN(dev, file_priv); -+ -+ if (sarea_priv->nbox > MACH64_NR_SAREA_CLIPRECTS) -+ sarea_priv->nbox = MACH64_NR_SAREA_CLIPRECTS; -+ -+ ret = mach64_dma_dispatch_clear(dev, file_priv, clear->flags, -+ clear->x, clear->y, clear->w, clear->h, -+ clear->clear_color, -+ clear->clear_depth); -+ -+ /* Make sure we restore the 3D state next time. -+ */ -+ sarea_priv->dirty |= (MACH64_UPLOAD_CONTEXT | MACH64_UPLOAD_MISC); -+ return ret; -+} -+ -+int mach64_dma_swap(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ drm_mach64_sarea_t *sarea_priv = dev_priv->sarea_priv; -+ int ret; -+ -+ DRM_DEBUG("pid=%d\n", DRM_CURRENTPID); -+ -+ LOCK_TEST_WITH_RETURN(dev, file_priv); -+ -+ if (sarea_priv->nbox > MACH64_NR_SAREA_CLIPRECTS) -+ sarea_priv->nbox = MACH64_NR_SAREA_CLIPRECTS; -+ -+ ret = mach64_dma_dispatch_swap(dev, file_priv); -+ -+ /* Make sure we restore the 3D state next time. -+ */ -+ sarea_priv->dirty |= (MACH64_UPLOAD_CONTEXT | MACH64_UPLOAD_MISC); -+ return ret; -+} -+ -+int mach64_dma_vertex(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ drm_mach64_sarea_t *sarea_priv = dev_priv->sarea_priv; -+ drm_mach64_vertex_t *vertex = data; -+ -+ LOCK_TEST_WITH_RETURN(dev, file_priv); -+ -+ if (!dev_priv) { -+ DRM_ERROR("called with no initialization\n"); -+ return -EINVAL; -+ } -+ -+ DRM_DEBUG("pid=%d buf=%p used=%lu discard=%d\n", -+ DRM_CURRENTPID, -+ vertex->buf, vertex->used, vertex->discard); -+ -+ if (vertex->prim < 0 || vertex->prim > MACH64_PRIM_POLYGON) { -+ DRM_ERROR("buffer prim %d\n", vertex->prim); -+ return -EINVAL; -+ } -+ -+ if (vertex->used > MACH64_BUFFER_SIZE || (vertex->used & 3) != 0) { -+ DRM_ERROR("Invalid vertex buffer size: %lu bytes\n", -+ vertex->used); -+ return -EINVAL; -+ } -+ -+ if (sarea_priv->nbox > MACH64_NR_SAREA_CLIPRECTS) -+ sarea_priv->nbox = MACH64_NR_SAREA_CLIPRECTS; -+ -+ return mach64_dma_dispatch_vertex(dev, file_priv, vertex); -+} -+ -+int mach64_dma_blit(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ drm_mach64_sarea_t *sarea_priv = dev_priv->sarea_priv; -+ drm_mach64_blit_t *blit = data; -+ int ret; -+ -+ LOCK_TEST_WITH_RETURN(dev, file_priv); -+ -+ ret = mach64_dma_dispatch_blit(dev, file_priv, blit); -+ -+ /* Make sure we restore the 3D state next time. -+ */ -+ sarea_priv->dirty |= (MACH64_UPLOAD_CONTEXT | -+ MACH64_UPLOAD_MISC | MACH64_UPLOAD_CLIPRECTS); -+ -+ return ret; -+} -+ -+int mach64_get_param(struct drm_device *dev, void *data, -+ struct drm_file *file_priv) -+{ -+ drm_mach64_private_t *dev_priv = dev->dev_private; -+ drm_mach64_getparam_t *param = data; -+ int value; -+ -+ DRM_DEBUG("\n"); -+ -+ if (!dev_priv) { -+ DRM_ERROR("called with no initialization\n"); -+ return -EINVAL; -+ } -+ -+ switch (param->param) { -+ case MACH64_PARAM_FRAMES_QUEUED: -+ /* Needs lock since it calls mach64_ring_tick() */ -+ LOCK_TEST_WITH_RETURN(dev, file_priv); -+ value = mach64_do_get_frames_queued(dev_priv); -+ break; -+ case MACH64_PARAM_IRQ_NR: -+ value = dev->irq; -+ break; -+ default: -+ return -EINVAL; -+ } -+ -+ if (DRM_COPY_TO_USER(param->value, &value, sizeof(int))) { -+ DRM_ERROR("copy_to_user\n"); -+ return -EFAULT; -+ } -+ -+ return 0; -+} ---- linux/drivers/gpu/drm/Kconfig.gpu-drm-mach64.orig -+++ linux/drivers/gpu/drm/Kconfig -@@ -267,6 +267,17 @@ config DRM_I810 - selected, the module will be called i810. AGP support is required - for this driver to work. - -+config DRM_MACH64 -+ tristate "ATI Rage Pro (Mach64)" -+ depends on DRM && PCI -+ help -+ Choose this option if you have an ATI Rage Pro (mach64 chipset) -+ graphics card. Example cards include: 3D Rage Pro, Xpert 98, -+ 3D Rage LT Pro, 3D Rage XL/XC, and 3D Rage Mobility (P/M, M1). -+ Cards earlier than ATI Rage Pro (e.g. Rage II) are not supported. -+ If M is selected, the module will be called mach64. AGP support for -+ this card is strongly suggested (unless you have a PCI version). -+ - config DRM_MGA - tristate "Matrox g200/g400" - depends on DRM && PCI ---- linux/drivers/gpu/drm/Makefile.gpu-drm-mach64.orig -+++ linux/drivers/gpu/drm/Makefile -@@ -47,6 +47,7 @@ obj-$(CONFIG_DRM_R128) += r128/ - obj-$(CONFIG_HSA_AMD) += amd/amdkfd/ - obj-$(CONFIG_DRM_RADEON)+= radeon/ - obj-$(CONFIG_DRM_AMDGPU)+= amd/amdgpu/ -+obj-$(CONFIG_DRM_MACH64)+= mach64/ - obj-$(CONFIG_DRM_MGA) += mga/ - obj-$(CONFIG_DRM_I810) += i810/ - obj-$(CONFIG_DRM_I915) += i915/ diff --git a/kernel/kernel/files/patches/mageia/hid-usbhid-IBM-BladeCenterHS20-quirk.patch b/kernel/kernel/files/patches/mageia/hid-usbhid-IBM-BladeCenterHS20-quirk.patch deleted file mode 100644 index d8e7fa4d..00000000 --- a/kernel/kernel/files/patches/mageia/hid-usbhid-IBM-BladeCenterHS20-quirk.patch +++ /dev/null @@ -1,37 +0,0 @@ -Subject: Add blacklist of usb hid modules - -IBM Blade Center HS20 can connect PS2 kerboard and mouse, It is USB emulation. -This devices need HID_QUIRK_IGNORE option. - -This patch is workaround. - -[ rediffed for 2.6.28 -- herton ] -Signed-off-by: Go Taniguchi - ---- - drivers/hid/hid-core.c | 2 ++ - drivers/hid/hid-ids.h | 2 ++ - 2 files changed, 4 insertions(+) - ---- a/drivers/hid/hid-core.c -+++ b/drivers/hid/hid-core.c -@@ -2062,6 +2062,8 @@ static const struct hid_device_id hid_ig - { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_1005) }, - { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_1006) }, - { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_1007) }, -+ { HID_USB_DEVICE(USB_VENDOR_ID_IBM, 0x4001) }, -+ { HID_USB_DEVICE(USB_VENDOR_ID_IBM, 0x4002) }, - { HID_USB_DEVICE(USB_VENDOR_ID_IMATION, USB_DEVICE_ID_DISC_STAKKA) }, - { HID_USB_DEVICE(USB_VENDOR_ID_JABRA, USB_DEVICE_ID_JABRA_SPEAK_410) }, - { HID_USB_DEVICE(USB_VENDOR_ID_JABRA, USB_DEVICE_ID_JABRA_SPEAK_510) }, ---- a/drivers/hid/hid-ids.h -+++ b/drivers/hid/hid-ids.h -@@ -46,6 +46,8 @@ - #define USB_VENDOR_ID_AFATECH 0x15a4 - #define USB_DEVICE_ID_AFATECH_AF9016 0x9016 - -+#define USB_VENDOR_ID_IBM 0x04b3 -+ - #define USB_VENDOR_ID_AIPTEK 0x08ca - #define USB_DEVICE_ID_AIPTEK_01 0x0001 - #define USB_DEVICE_ID_AIPTEK_10 0x0010 diff --git a/kernel/kernel/files/patches/mageia/hwmon-k10temp-Add-support-for-family-17h.patch b/kernel/kernel/files/patches/mageia/hwmon-k10temp-Add-support-for-family-17h.patch deleted file mode 100644 index eda09934..00000000 --- a/kernel/kernel/files/patches/mageia/hwmon-k10temp-Add-support-for-family-17h.patch +++ /dev/null @@ -1,70 +0,0 @@ -From 9af0a9aecdb945cd5513941ffdcbcc031009b402 Mon Sep 17 00:00:00 2001 -From: Guenter Roeck -Date: Mon, 4 Sep 2017 18:33:53 -0700 -Subject: hwmon: (k10temp) Add support for family 17h - -Add support for temperature sensors on Family 17h (Ryzen) processors. - -Signed-off-by: Guenter Roeck ---- - drivers/hwmon/k10temp.c | 16 ++++++++++++++++ - 1 file changed, 16 insertions(+) - -diff --git a/drivers/hwmon/k10temp.c b/drivers/hwmon/k10temp.c -index fc8076c..c4dac53 100644 ---- a/drivers/hwmon/k10temp.c -+++ b/drivers/hwmon/k10temp.c -@@ -36,6 +36,10 @@ MODULE_PARM_DESC(force, "force loading on processors with erratum 319"); - /* Provide lock for writing to NB_SMU_IND_ADDR */ - static DEFINE_MUTEX(nb_smu_ind_mutex); - -+#ifndef PCI_DEVICE_ID_AMD_17H_DF_F3 -+#define PCI_DEVICE_ID_AMD_17H_DF_F3 0x1463 -+#endif -+ - /* CPUID function 0x80000001, ebx */ - #define CPUID_PKGTYPE_MASK 0xf0000000 - #define CPUID_PKGTYPE_F 0x00000000 -@@ -61,6 +65,9 @@ static DEFINE_MUTEX(nb_smu_ind_mutex); - */ - #define F15H_M60H_REPORTED_TEMP_CTRL_OFFSET 0xd8200ca4 - -+/* F17h M01h Access througn SMN */ -+#define F17H_M01H_REPORTED_TEMP_CTRL_OFFSET 0x00059800 -+ - struct k10temp_data { - struct pci_dev *pdev; - void (*read_tempreg)(struct pci_dev *pdev, u32 *regval); -@@ -88,6 +95,12 @@ static void read_tempreg_nb_f15(struct pci_dev *pdev, u32 *regval) - F15H_M60H_REPORTED_TEMP_CTRL_OFFSET, regval); - } - -+static void read_tempreg_nb_f17(struct pci_dev *pdev, u32 *regval) -+{ -+ amd_nb_index_read(pdev, PCI_DEVFN(0, 0), 0x60, -+ F17H_M01H_REPORTED_TEMP_CTRL_OFFSET, regval); -+} -+ - static ssize_t temp1_input_show(struct device *dev, - struct device_attribute *attr, char *buf) - { -@@ -224,6 +237,8 @@ static int k10temp_probe(struct pci_dev *pdev, - if (boot_cpu_data.x86 == 0x15 && (boot_cpu_data.x86_model == 0x60 || - boot_cpu_data.x86_model == 0x70)) - data->read_tempreg = read_tempreg_nb_f15; -+ else if (boot_cpu_data.x86 == 0x17) -+ data->read_tempreg = read_tempreg_nb_f17; - else - data->read_tempreg = read_tempreg_pci; - -@@ -242,6 +257,7 @@ static const struct pci_device_id k10temp_id_table[] = { - { PCI_VDEVICE(AMD, PCI_DEVICE_ID_AMD_15H_M60H_NB_F3) }, - { PCI_VDEVICE(AMD, PCI_DEVICE_ID_AMD_16H_NB_F3) }, - { PCI_VDEVICE(AMD, PCI_DEVICE_ID_AMD_16H_M30H_NB_F3) }, -+ { PCI_VDEVICE(AMD, PCI_DEVICE_ID_AMD_17H_DF_F3) }, - {} - }; - MODULE_DEVICE_TABLE(pci, k10temp_id_table); --- -cgit v1.1 - diff --git a/kernel/kernel/files/patches/mageia/hwmon-k10temp-Add-support-for-temperature-offsets.patch b/kernel/kernel/files/patches/mageia/hwmon-k10temp-Add-support-for-temperature-offsets.patch deleted file mode 100644 index b7d650b3..00000000 --- a/kernel/kernel/files/patches/mageia/hwmon-k10temp-Add-support-for-temperature-offsets.patch +++ /dev/null @@ -1,80 +0,0 @@ -From 1b50b776355fa6c6d7b3281a63c275d5c18d629d Mon Sep 17 00:00:00 2001 -From: Guenter Roeck -Date: Mon, 4 Sep 2017 18:33:53 -0700 -Subject: hwmon: (k10temp) Add support for temperature offsets - -Add support for handling temperature offset values for various AMD CPUs, -similar to the code used in the coretemp driver for Intel CPUs. This is -primarily for Ryzen CPUs (which has documented temperature offsets), -but the code is kept generic to simplify adding additional CPUs. - -Signed-off-by: Guenter Roeck ---- - drivers/hwmon/k10temp.c | 30 ++++++++++++++++++++++++++++++ - 1 file changed, 30 insertions(+) - -diff --git a/drivers/hwmon/k10temp.c b/drivers/hwmon/k10temp.c -index c4dac53..46a54ed 100644 ---- a/drivers/hwmon/k10temp.c -+++ b/drivers/hwmon/k10temp.c -@@ -71,6 +71,24 @@ static DEFINE_MUTEX(nb_smu_ind_mutex); - struct k10temp_data { - struct pci_dev *pdev; - void (*read_tempreg)(struct pci_dev *pdev, u32 *regval); -+ int temp_offset; -+}; -+ -+struct tctl_offset { -+ u8 model; -+ char const *id; -+ int offset; -+}; -+ -+static const struct tctl_offset tctl_offset_table[] = { -+ { 0x17, "AMD Ryzen 7 1600X", 20000 }, -+ { 0x17, "AMD Ryzen 7 1700X", 20000 }, -+ { 0x17, "AMD Ryzen 7 1800X", 20000 }, -+ { 0x17, "AMD Ryzen Threadripper 1950X", 27000 }, -+ { 0x17, "AMD Ryzen Threadripper 1920X", 27000 }, -+ { 0x17, "AMD Ryzen Threadripper 1950", 10000 }, -+ { 0x17, "AMD Ryzen Threadripper 1920", 10000 }, -+ { 0x17, "AMD Ryzen Threadripper 1910", 10000 }, - }; - - static void read_tempreg_pci(struct pci_dev *pdev, u32 *regval) -@@ -110,6 +128,7 @@ static ssize_t temp1_input_show(struct device *dev, - - data->read_tempreg(data->pdev, ®val); - temp = (regval >> 21) * 125; -+ temp -= data->temp_offset; - - return sprintf(buf, "%u\n", temp); - } -@@ -217,6 +236,7 @@ static int k10temp_probe(struct pci_dev *pdev, - struct device *dev = &pdev->dev; - struct k10temp_data *data; - struct device *hwmon_dev; -+ int i; - - if (unreliable) { - if (!force) { -@@ -242,6 +262,16 @@ static int k10temp_probe(struct pci_dev *pdev, - else - data->read_tempreg = read_tempreg_pci; - -+ for (i = 0; i < ARRAY_SIZE(tctl_offset_table); i++) { -+ const struct tctl_offset *entry = &tctl_offset_table[i]; -+ -+ if (boot_cpu_data.x86 == entry->model && -+ strstr(boot_cpu_data.x86_model_id, entry->id)) { -+ data->temp_offset = entry->offset; -+ break; -+ } -+ } -+ - hwmon_dev = devm_hwmon_device_register_with_groups(dev, "k10temp", data, - k10temp_groups); - return PTR_ERR_OR_ZERO(hwmon_dev); --- -cgit v1.1 - diff --git a/kernel/kernel/files/patches/mageia/hwmon-k10temp-Move-chip-specific-code-into-probe-function.patch b/kernel/kernel/files/patches/mageia/hwmon-k10temp-Move-chip-specific-code-into-probe-function.patch deleted file mode 100644 index c171d274..00000000 --- a/kernel/kernel/files/patches/mageia/hwmon-k10temp-Move-chip-specific-code-into-probe-function.patch +++ /dev/null @@ -1,132 +0,0 @@ -From 68546abf7a3a63f199e53d6dcaa7375df37a6aaa Mon Sep 17 00:00:00 2001 -From: Guenter Roeck -Date: Mon, 4 Sep 2017 18:33:53 -0700 -Subject: hwmon: (k10temp) Move chip specific code into probe function - -Introduce a local data structure and determine the temperature read -function at probe time to reduce runtime complexity. - -Signed-off-by: Guenter Roeck ---- - drivers/hwmon/k10temp.c | 62 +++++++++++++++++++++++++++++++++++-------------- - 1 file changed, 45 insertions(+), 17 deletions(-) - -diff --git a/drivers/hwmon/k10temp.c b/drivers/hwmon/k10temp.c -index ce3b91f..fc8076c 100644 ---- a/drivers/hwmon/k10temp.c -+++ b/drivers/hwmon/k10temp.c -@@ -61,31 +61,44 @@ static DEFINE_MUTEX(nb_smu_ind_mutex); - */ - #define F15H_M60H_REPORTED_TEMP_CTRL_OFFSET 0xd8200ca4 - --static void amd_nb_smu_index_read(struct pci_dev *pdev, unsigned int devfn, -- int offset, u32 *val) -+struct k10temp_data { -+ struct pci_dev *pdev; -+ void (*read_tempreg)(struct pci_dev *pdev, u32 *regval); -+}; -+ -+static void read_tempreg_pci(struct pci_dev *pdev, u32 *regval) -+{ -+ pci_read_config_dword(pdev, REG_REPORTED_TEMPERATURE, regval); -+} -+ -+static void amd_nb_index_read(struct pci_dev *pdev, unsigned int devfn, -+ unsigned int base, int offset, u32 *val) - { - mutex_lock(&nb_smu_ind_mutex); - pci_bus_write_config_dword(pdev->bus, devfn, -- 0xb8, offset); -+ base, offset); - pci_bus_read_config_dword(pdev->bus, devfn, -- 0xbc, val); -+ base + 4, val); - mutex_unlock(&nb_smu_ind_mutex); - } - -+static void read_tempreg_nb_f15(struct pci_dev *pdev, u32 *regval) -+{ -+ amd_nb_index_read(pdev, PCI_DEVFN(0, 0), 0xb8, -+ F15H_M60H_REPORTED_TEMP_CTRL_OFFSET, regval); -+} -+ - static ssize_t temp1_input_show(struct device *dev, - struct device_attribute *attr, char *buf) - { -+ struct k10temp_data *data = dev_get_drvdata(dev); - u32 regval; -- struct pci_dev *pdev = dev_get_drvdata(dev); -- -- if (boot_cpu_data.x86 == 0x15 && boot_cpu_data.x86_model == 0x60) { -- amd_nb_smu_index_read(pdev, PCI_DEVFN(0, 0), -- F15H_M60H_REPORTED_TEMP_CTRL_OFFSET, -- ®val); -- } else { -- pci_read_config_dword(pdev, REG_REPORTED_TEMPERATURE, ®val); -- } -- return sprintf(buf, "%u\n", (regval >> 21) * 125); -+ unsigned int temp; -+ -+ data->read_tempreg(data->pdev, ®val); -+ temp = (regval >> 21) * 125; -+ -+ return sprintf(buf, "%u\n", temp); - } - - static ssize_t temp1_max_show(struct device *dev, -@@ -98,11 +111,12 @@ static ssize_t show_temp_crit(struct device *dev, - struct device_attribute *devattr, char *buf) - { - struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr); -+ struct k10temp_data *data = dev_get_drvdata(dev); - int show_hyst = attr->index; - u32 regval; - int value; - -- pci_read_config_dword(dev_get_drvdata(dev), -+ pci_read_config_dword(data->pdev, - REG_HARDWARE_THERMAL_CONTROL, ®val); - value = ((regval >> 16) & 0x7f) * 500 + 52000; - if (show_hyst) -@@ -119,7 +133,8 @@ static umode_t k10temp_is_visible(struct kobject *kobj, - struct attribute *attr, int index) - { - struct device *dev = container_of(kobj, struct device, kobj); -- struct pci_dev *pdev = dev_get_drvdata(dev); -+ struct k10temp_data *data = dev_get_drvdata(dev); -+ struct pci_dev *pdev = data->pdev; - - if (index >= 2) { - u32 reg_caps, reg_htc; -@@ -187,6 +202,7 @@ static int k10temp_probe(struct pci_dev *pdev, - { - int unreliable = has_erratum_319(pdev); - struct device *dev = &pdev->dev; -+ struct k10temp_data *data; - struct device *hwmon_dev; - - if (unreliable) { -@@ -199,7 +215,19 @@ static int k10temp_probe(struct pci_dev *pdev, - "unreliable CPU thermal sensor; check erratum 319\n"); - } - -- hwmon_dev = devm_hwmon_device_register_with_groups(dev, "k10temp", pdev, -+ data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); -+ if (!data) -+ return -ENOMEM; -+ -+ data->pdev = pdev; -+ -+ if (boot_cpu_data.x86 == 0x15 && (boot_cpu_data.x86_model == 0x60 || -+ boot_cpu_data.x86_model == 0x70)) -+ data->read_tempreg = read_tempreg_nb_f15; -+ else -+ data->read_tempreg = read_tempreg_pci; -+ -+ hwmon_dev = devm_hwmon_device_register_with_groups(dev, "k10temp", data, - k10temp_groups); - return PTR_ERR_OR_ZERO(hwmon_dev); - } --- -cgit v1.1 - diff --git a/kernel/kernel/files/patches/mageia/ide-pci-sis5513-965.patch b/kernel/kernel/files/patches/mageia/ide-pci-sis5513-965.patch deleted file mode 100644 index 9c54ab70..00000000 --- a/kernel/kernel/files/patches/mageia/ide-pci-sis5513-965.patch +++ /dev/null @@ -1,23 +0,0 @@ ---- - drivers/ide/sis5513.c | 9 +++++++++ - 1 file changed, 9 insertions(+) - -diff -p -up linux-2.6.28/drivers/ide/sis5513.c.orig linux-2.6.28/drivers/ide/sis5513.c ---- linux-2.6.28/drivers/ide/sis5513.c.orig 2008-12-08 12:41:13.000000000 -0500 -+++ linux-2.6.28/drivers/ide/sis5513.c 2008-12-08 12:51:32.000000000 -0500 -@@ -412,6 +412,15 @@ static int __devinit sis_find_family(str - pci_name(dev)); - } - } -+ else if (trueid == 0x180) { /* sis965L */ -+ u16 pci_command; -+ pci_read_config_word(dev, PCI_COMMAND, &pci_command); -+ pci_command &= ~PCI_COMMAND_INTX_DISABLE; -+ pci_write_config_word(dev, PCI_COMMAND, pci_command); -+ chipset_family = ATA_133; -+ printk(KERN_INFO DRV_NAME " %s: SiS 965 IDE UDMA133 controller\n", -+ pci_name(dev)); -+ } - } - - if (!chipset_family) { /* Belongs to pci-quirks */ diff --git a/kernel/kernel/files/patches/mageia/input-goodix-add-support-for-GDIX1002.patch b/kernel/kernel/files/patches/mageia/input-goodix-add-support-for-GDIX1002.patch deleted file mode 100644 index 8f263bee..00000000 --- a/kernel/kernel/files/patches/mageia/input-goodix-add-support-for-GDIX1002.patch +++ /dev/null @@ -1,18 +0,0 @@ ---- a/drivers/input/touchscreen/goodix.c -+++ a/drivers/input/touchscreen/goodix.c -@@ -947,6 +954,7 @@ static SIMPLE_DEV_PM_OPS(goodix_pm_ops, goodix_suspend, goodix_resume); - - static const struct i2c_device_id goodix_ts_id[] = { - { "GDIX1001:00", 0 }, -+ { "GDIX1002:00", 0 }, - { } - }; - MODULE_DEVICE_TABLE(i2c, goodix_ts_id); -@@ -954,6 +962,7 @@ MODULE_DEVICE_TABLE(i2c, goodix_ts_id); - #ifdef CONFIG_ACPI - static const struct acpi_device_id goodix_acpi_match[] = { - { "GDIX1001", 0 }, -+ { "GDIX1002", 0 }, - { } - }; - MODULE_DEVICE_TABLE(acpi, goodix_acpi_match); diff --git a/kernel/kernel/files/patches/mageia/input-goodix-disable-IRQs-while-suspended.patch b/kernel/kernel/files/patches/mageia/input-goodix-disable-IRQs-while-suspended.patch deleted file mode 100644 index e946f0d3..00000000 --- a/kernel/kernel/files/patches/mageia/input-goodix-disable-IRQs-while-suspended.patch +++ /dev/null @@ -1,60 +0,0 @@ -From faec44b6838312484d63e82286087cf2d5ebb891 Mon Sep 17 00:00:00 2001 -From: Hans de Goede -Date: Fri, 12 Jan 2018 00:36:48 -0800 -Subject: [PATCH] Input: goodix - disable IRQs while suspended - -We should not try to do any i2c transfers before the controller is -resumed (which happens before our resume method gets called). - -So we need to disable our IRQ while suspended to enforce this. The -code paths for devices with GPIOs for the int and reset pins already -disable the IRQ the through goodix_free_irq(). - -This commit also disables the IRQ while suspended for devices without -GPIOs for the int and reset pins. - -This fixes the i2c bus sometimes getting stuck after a suspend/resume -causing the touchscreen to sometimes not work after a suspend/resume. -This has been tested on a GPD pocked device. - -BugLink: https://github.com/nexus511/gpd-ubuntu-packages/issues/10 -BugLink: https://www.reddit.com/r/GPDPocket/comments/7niut2/fix_for_broken_touch_after_resume_all_linux/ -Tested-by: Hans de Goede -Signed-off-by: Hans de Goede -Reviewed-by: Bastien Nocera -Signed-off-by: Dmitry Torokhov ---- - drivers/input/touchscreen/goodix.c | 8 ++++++-- - 1 file changed, 6 insertions(+), 2 deletions(-) - -diff --git a/drivers/input/touchscreen/goodix.c b/drivers/input/touchscreen/goodix.c -index 69d0b8cbc71f..ecec8eb17f28 100644 ---- a/drivers/input/touchscreen/goodix.c -+++ b/drivers/input/touchscreen/goodix.c -@@ -878,8 +878,10 @@ static int __maybe_unused goodix_suspend(struct device *dev) - int error; - - /* We need gpio pins to suspend/resume */ -- if (!ts->gpiod_int || !ts->gpiod_rst) -+ if (!ts->gpiod_int || !ts->gpiod_rst) { -+ disable_irq(client->irq); - return 0; -+ } - - wait_for_completion(&ts->firmware_loading_complete); - -@@ -919,8 +921,10 @@ static int __maybe_unused goodix_resume(struct device *dev) - struct goodix_ts_data *ts = i2c_get_clientdata(client); - int error; - -- if (!ts->gpiod_int || !ts->gpiod_rst) -+ if (!ts->gpiod_int || !ts->gpiod_rst) { -+ enable_irq(client->irq); - return 0; -+ } - - /* - * Exit sleep mode by outputting HIGH level to INT pin --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/input-i8042-quirks-for-Fujitsu-Lifebook-A544-and-Lif.patch b/kernel/kernel/files/patches/mageia/input-i8042-quirks-for-Fujitsu-Lifebook-A544-and-Lif.patch deleted file mode 100644 index 2ed76671..00000000 --- a/kernel/kernel/files/patches/mageia/input-i8042-quirks-for-Fujitsu-Lifebook-A544-and-Lif.patch +++ /dev/null @@ -1,47 +0,0 @@ -From 993b3a3f80a7842a48cd46c2b41e1b3ef6302468 Mon Sep 17 00:00:00 2001 -From: Hans de Goede -Date: Fri, 24 Oct 2014 14:55:24 -0700 -Subject: [PATCH] Input: i8042 - quirks for Fujitsu Lifebook A544 and Lifebook - AH544 - -These models need i8042.notimeout, otherwise the touchpad will not work. - -BugLink: https://bugzilla.kernel.org/show_bug.cgi?id=69731 -BugLink: https://bugzilla.redhat.com/show_bug.cgi?id=1111138 -Cc: stable@vger.kernel.org -Signed-off-by: Hans de Goede -Signed-off-by: Dmitry Torokhov ---- - drivers/input/serio/i8042-x86ia64io.h | 16 ++++++++++++++++ - 1 file changed, 16 insertions(+) - -diff --git a/drivers/input/serio/i8042-x86ia64io.h b/drivers/input/serio/i8042-x86ia64io.h -index a0bcbb6..aa9b299 100644 ---- a/drivers/input/serio/i8042-x86ia64io.h -+++ b/drivers/input/serio/i8042-x86ia64io.h -@@ -364,6 +364,22 @@ static const struct dmi_system_id __initconst i8042_dmi_notimeout_table[] = { - }, - }, - { -+ /* Fujitsu A544 laptop */ -+ /* https://bugzilla.redhat.com/show_bug.cgi?id=1111138 */ -+ .matches = { -+ DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"), -+ DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK A544"), -+ }, -+ }, -+ { -+ /* Fujitsu AH544 laptop */ -+ /* https://bugzilla.kernel.org/show_bug.cgi?id=69731 */ -+ .matches = { -+ DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"), -+ DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK AH544"), -+ }, -+ }, -+ { - /* Fujitsu U574 laptop */ - /* https://bugzilla.kernel.org/show_bug.cgi?id=69731 */ - .matches = { --- -2.1.2 - diff --git a/kernel/kernel/files/patches/mageia/media-usb-pwc-lie-in-proc-usb-devices.patch b/kernel/kernel/files/patches/mageia/media-usb-pwc-lie-in-proc-usb-devices.patch deleted file mode 100644 index 32d496e3..00000000 --- a/kernel/kernel/files/patches/mageia/media-usb-pwc-lie-in-proc-usb-devices.patch +++ /dev/null @@ -1,13 +0,0 @@ -diff --git a/drivers/media/video/pwc/pwc-if.c b/drivers/media/video/pwc/pwc-if.c -index f976df4..32c883b 100644 ---- a/drivers/media/usb/pwc/pwc-if.c -+++ b/drivers/media/usb/pwc/pwc-if.c -@@ -119,7 +119,7 @@ static void usb_pwc_disconnect(struct us - static void pwc_isoc_cleanup(struct pwc_device *pdev); - - static struct usb_driver pwc_driver = { -- .name = "Philips webcam", /* name */ -+ .name = "pwc", /* name */ - .id_table = pwc_device_table, - .probe = usb_pwc_probe, /* probe() */ - .disconnect = usb_pwc_disconnect, /* disconnect() */ diff --git a/kernel/kernel/files/patches/mageia/mm-page_vma_mapped-Introduce-pfn_in_hpage.patch b/kernel/kernel/files/patches/mageia/mm-page_vma_mapped-Introduce-pfn_in_hpage.patch deleted file mode 100644 index 71f6c656..00000000 --- a/kernel/kernel/files/patches/mageia/mm-page_vma_mapped-Introduce-pfn_in_hpage.patch +++ /dev/null @@ -1,58 +0,0 @@ -From 7222708e823afc98dfb769d36bf2f26b6420b7ce Mon Sep 17 00:00:00 2001 -From: "Kirill A. Shutemov" -Date: Mon, 22 Jan 2018 12:22:30 +0300 -Subject: [PATCH] mm, page_vma_mapped: Introduce pfn_in_hpage() - -The new helper would check if the pfn belongs to the page. For huge -pages it checks if the PFN is within range covered by the huge page. - -The helper is used in check_pte(). The original code the helper replaces -had two call to page_to_pfn(). page_to_pfn() is relatively costly. - -Although current GCC is able to optimize code to have one call, it's -better to do this explicitly. - -Signed-off-by: Kirill A. Shutemov -Signed-off-by: Linus Torvalds ---- - mm/page_vma_mapped.c | 17 +++++++++-------- - 1 file changed, 9 insertions(+), 8 deletions(-) - -diff --git a/mm/page_vma_mapped.c b/mm/page_vma_mapped.c -index 956015614395..ae3c2a35d61b 100644 ---- a/mm/page_vma_mapped.c -+++ b/mm/page_vma_mapped.c -@@ -30,6 +30,14 @@ static bool map_pte(struct page_vma_mapped_walk *pvmw) - return true; - } - -+static inline bool pfn_in_hpage(struct page *hpage, unsigned long pfn) -+{ -+ unsigned long hpage_pfn = page_to_pfn(hpage); -+ -+ /* THP can be referenced by any subpage */ -+ return pfn >= hpage_pfn && pfn - hpage_pfn < hpage_nr_pages(hpage); -+} -+ - /** - * check_pte - check if @pvmw->page is mapped at the @pvmw->pte - * -@@ -78,14 +86,7 @@ static bool check_pte(struct page_vma_mapped_walk *pvmw) - pfn = pte_pfn(*pvmw->pte); - } - -- if (pfn < page_to_pfn(pvmw->page)) -- return false; -- -- /* THP can be referenced by any subpage */ -- if (pfn - page_to_pfn(pvmw->page) >= hpage_nr_pages(pvmw->page)) -- return false; -- -- return true; -+ return pfn_in_hpage(pvmw->page, pfn); - } - - /** --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/mpt-vmware-fix.patch b/kernel/kernel/files/patches/mageia/mpt-vmware-fix.patch deleted file mode 100644 index 0b90277c..00000000 --- a/kernel/kernel/files/patches/mageia/mpt-vmware-fix.patch +++ /dev/null @@ -1,49 +0,0 @@ -Subject: mpt scsi modules for VMWare's emulated - -The attached patch is a workaround for a bug in VMWare's emulated LSI -Fusion SCSI HBA. The emulated firmware returns zero for the maximum -number of attached devices; the real firmware returns a positive -number. Therefore, the kernel that boots and works fine on bare metal -will fail on VMWare because this firmware value is handed to the SCSI -midlayer, which then skips the entire bus scan. - -F7 bz 241935 - -The patch below was submitted by Eric Moore of LSI to the linux-scsi -mailing list: - -http://marc.info/?l=linux-scsi&m=117432237404247 - -then immediately rejected by Christoph Hellwig, who prefers that -VMWare fix their emulation instead. - -This patch is workaround. - ---- - drivers/message/fusion/mptbase.c | 15 +++++++++++++-- - 1 file changed, 13 insertions(+), 2 deletions(-) - ---- a/drivers/message/fusion/mptbase.c -+++ b/drivers/message/fusion/mptbase.c -@@ -3051,8 +3051,19 @@ GetPortFacts(MPT_ADAPTER *ioc, int portn - pfacts->MaxPersistentIDs = le16_to_cpu(pfacts->MaxPersistentIDs); - pfacts->MaxLanBuckets = le16_to_cpu(pfacts->MaxLanBuckets); - -- max_id = (ioc->bus_type == SAS) ? pfacts->PortSCSIID : -- pfacts->MaxDevices; -+ switch (ioc->bus_type) { -+ case SAS: -+ max_id = pfacts->PortSCSIID; -+ break; -+ case FC: -+ max_id = pfacts->MaxDevices; -+ break; -+ case SPI: -+ default: -+ max_id = MPT_MAX_SCSI_DEVICES; -+ break; -+ } -+ - ioc->devices_per_bus = (max_id > 255) ? 256 : max_id; - ioc->number_of_buses = (ioc->devices_per_bus < 256) ? 1 : max_id/256; - diff --git a/kernel/kernel/files/patches/mageia/net-WireGuard.patch b/kernel/kernel/files/patches/mageia/net-WireGuard.patch deleted file mode 100644 index fce4fe44..00000000 --- a/kernel/kernel/files/patches/mageia/net-WireGuard.patch +++ /dev/null @@ -1,32579 +0,0 @@ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/allowedips.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,328 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "allowedips.h" -+#include "peer.h" -+ -+struct allowedips_node { -+ struct wireguard_peer *peer; -+ struct rcu_head rcu; -+ struct allowedips_node __rcu *bit[2]; -+ /* While it may seem scandalous that we waste space for v4, -+ * we're alloc'ing to the nearest power of 2 anyway, so this -+ * doesn't actually make a difference. -+ */ -+ union { -+ __be64 v6[2]; -+ __be32 v4; -+ u8 bits[16]; -+ }; -+ u8 cidr, bit_at_a, bit_at_b; -+}; -+ -+static void copy_and_assign_cidr(struct allowedips_node *node, const u8 *src, u8 cidr) -+{ -+ node->cidr = cidr; -+ node->bit_at_a = cidr / 8; -+ node->bit_at_b = 7 - (cidr % 8); -+ if (cidr) { -+ memcpy(node->bits, src, (cidr + 7) / 8); -+ node->bits[(cidr + 7) / 8 - 1] &= ~0U << ((8 - (cidr % 8)) % 8); -+ } -+} -+ -+#define choose_node(parent, key) parent->bit[(key[parent->bit_at_a] >> parent->bit_at_b) & 1] -+ -+static void node_free_rcu(struct rcu_head *rcu) -+{ -+ kfree(container_of(rcu, struct allowedips_node, rcu)); -+} -+ -+#define push(stack, p, len) ({ \ -+ if (rcu_access_pointer(p)) { \ -+ BUG_ON(len >= 128); \ -+ stack[len++] = rcu_dereference_protected(p, lockdep_is_held(lock)); \ -+ } \ -+ true; \ -+}) -+static void free_root_node(struct allowedips_node __rcu *top, struct mutex *lock) -+{ -+ struct allowedips_node *stack[128], *node; -+ unsigned int len; -+ -+ for (len = 0, push(stack, top, len); len > 0 && (node = stack[--len]) && push(stack, node->bit[0], len) && push(stack, node->bit[1], len);) -+ call_rcu_bh(&node->rcu, node_free_rcu); -+} -+ -+static int walk_by_peer(struct allowedips_node __rcu *top, int family, struct allowedips_cursor *cursor, struct wireguard_peer *peer, int (*func)(void *ctx, const u8 *ip, u8 cidr, int family), void *ctx, struct mutex *lock) -+{ -+ struct allowedips_node *node; -+ int ret; -+ -+ if (!rcu_access_pointer(top)) -+ return 0; -+ -+ if (!cursor->len) -+ push(cursor->stack, top, cursor->len); -+ -+ for (; cursor->len > 0 && (node = cursor->stack[cursor->len - 1]); --cursor->len, push(cursor->stack, node->bit[0], cursor->len), push(cursor->stack, node->bit[1], cursor->len)) { -+ if (node->peer != peer) -+ continue; -+ ret = func(ctx, node->bits, node->cidr, family); -+ if (ret) -+ return ret; -+ } -+ return 0; -+} -+#undef push -+ -+#define ref(p) rcu_access_pointer(p) -+#define deref(p) rcu_dereference_protected(*p, lockdep_is_held(lock)) -+#define push(p) ({ BUG_ON(len >= 128); stack[len++] = p; }) -+static void walk_remove_by_peer(struct allowedips_node __rcu **top, struct wireguard_peer *peer, struct mutex *lock) -+{ -+ struct allowedips_node __rcu **stack[128], **nptr; -+ struct allowedips_node *node, *prev; -+ unsigned int len; -+ -+ if (unlikely(!peer || !ref(*top))) -+ return; -+ -+ for (prev = NULL, len = 0, push(top); len > 0; prev = node) { -+ nptr = stack[len - 1]; -+ node = deref(nptr); -+ if (!node) { -+ --len; -+ continue; -+ } -+ if (!prev || ref(prev->bit[0]) == node || ref(prev->bit[1]) == node) { -+ if (ref(node->bit[0])) -+ push(&node->bit[0]); -+ else if (ref(node->bit[1])) -+ push(&node->bit[1]); -+ } else if (ref(node->bit[0]) == prev) { -+ if (ref(node->bit[1])) -+ push(&node->bit[1]); -+ } else { -+ if (node->peer == peer) { -+ node->peer = NULL; -+ if (!node->bit[0] || !node->bit[1]) { -+ rcu_assign_pointer(*nptr, deref(&node->bit[!ref(node->bit[0])])); -+ call_rcu_bh(&node->rcu, node_free_rcu); -+ node = deref(nptr); -+ } -+ } -+ --len; -+ } -+ } -+} -+#undef ref -+#undef deref -+#undef push -+ -+static __always_inline unsigned int fls128(u64 a, u64 b) -+{ -+ return a ? fls64(a) + 64 : fls64(b); -+} -+ -+static __always_inline u8 common_bits(const struct allowedips_node *node, const u8 *key, u8 bits) -+{ -+ if (bits == 32) -+ return 32 - fls(be32_to_cpu(*(const __be32 *)node->bits ^ *(const __be32 *)key)); -+ else if (bits == 128) -+ return 128 - fls128(be64_to_cpu(*(const __be64 *)&node->bits[0] ^ *(const __be64 *)&key[0]), be64_to_cpu(*(const __be64 *)&node->bits[8] ^ *(const __be64 *)&key[8])); -+ return 0; -+} -+ -+/* This could be much faster if it actually just compared the common bits properly, -+ * by precomputing a mask bswap(~0 << (32 - cidr)), and the rest, but it turns out that -+ * common_bits is already super fast on modern processors, even taking into account -+ * the unfortunate bswap. So, we just inline it like this instead. -+ */ -+#define prefix_matches(node, key, bits) (common_bits(node, key, bits) >= node->cidr) -+ -+static __always_inline struct allowedips_node *find_node(struct allowedips_node *trie, u8 bits, const u8 *key) -+{ -+ struct allowedips_node *node = trie, *found = NULL; -+ -+ while (node && prefix_matches(node, key, bits)) { -+ if (node->peer) -+ found = node; -+ if (node->cidr == bits) -+ break; -+ node = rcu_dereference_bh(choose_node(node, key)); -+ } -+ return found; -+} -+ -+/* Returns a strong reference to a peer */ -+static __always_inline struct wireguard_peer *lookup(struct allowedips_node __rcu *root, u8 bits, const void *ip) -+{ -+ struct wireguard_peer *peer = NULL; -+ struct allowedips_node *node; -+ -+ rcu_read_lock_bh(); -+ node = find_node(rcu_dereference_bh(root), bits, ip); -+ if (node) -+ peer = peer_get(node->peer); -+ rcu_read_unlock_bh(); -+ return peer; -+} -+ -+__attribute__((nonnull(1))) -+static inline bool node_placement(struct allowedips_node __rcu *trie, const u8 *key, u8 cidr, u8 bits, struct allowedips_node **rnode, struct mutex *lock) -+{ -+ bool exact = false; -+ struct allowedips_node *parent = NULL, *node = rcu_dereference_protected(trie, lockdep_is_held(lock)); -+ -+ while (node && node->cidr <= cidr && prefix_matches(node, key, bits)) { -+ parent = node; -+ if (parent->cidr == cidr) { -+ exact = true; -+ break; -+ } -+ node = rcu_dereference_protected(choose_node(parent, key), lockdep_is_held(lock)); -+ } -+ *rnode = parent; -+ return exact; -+} -+ -+static int add(struct allowedips_node __rcu **trie, u8 bits, const u8 *key, u8 cidr, struct wireguard_peer *peer, struct mutex *lock) -+{ -+ struct allowedips_node *node, *parent, *down, *newnode; -+ -+ if (unlikely(cidr > bits || !peer)) -+ return -EINVAL; -+ -+ if (!rcu_access_pointer(*trie)) { -+ node = kzalloc(sizeof(*node), GFP_KERNEL); -+ if (!node) -+ return -ENOMEM; -+ node->peer = peer; -+ copy_and_assign_cidr(node, key, cidr); -+ rcu_assign_pointer(*trie, node); -+ return 0; -+ } -+ if (node_placement(*trie, key, cidr, bits, &node, lock)) { -+ node->peer = peer; -+ return 0; -+ } -+ -+ newnode = kzalloc(sizeof(*newnode), GFP_KERNEL); -+ if (!newnode) -+ return -ENOMEM; -+ newnode->peer = peer; -+ copy_and_assign_cidr(newnode, key, cidr); -+ -+ if (!node) -+ down = rcu_dereference_protected(*trie, lockdep_is_held(lock)); -+ else { -+ down = rcu_dereference_protected(choose_node(node, key), lockdep_is_held(lock)); -+ if (!down) { -+ rcu_assign_pointer(choose_node(node, key), newnode); -+ return 0; -+ } -+ } -+ cidr = min(cidr, common_bits(down, key, bits)); -+ parent = node; -+ -+ if (newnode->cidr == cidr) { -+ rcu_assign_pointer(choose_node(newnode, down->bits), down); -+ if (!parent) -+ rcu_assign_pointer(*trie, newnode); -+ else -+ rcu_assign_pointer(choose_node(parent, newnode->bits), newnode); -+ } else { -+ node = kzalloc(sizeof(*node), GFP_KERNEL); -+ if (!node) { -+ kfree(newnode); -+ return -ENOMEM; -+ } -+ copy_and_assign_cidr(node, newnode->bits, cidr); -+ -+ rcu_assign_pointer(choose_node(node, down->bits), down); -+ rcu_assign_pointer(choose_node(node, newnode->bits), newnode); -+ if (!parent) -+ rcu_assign_pointer(*trie, node); -+ else -+ rcu_assign_pointer(choose_node(parent, node->bits), node); -+ } -+ return 0; -+} -+ -+void allowedips_init(struct allowedips *table) -+{ -+ table->root4 = table->root6 = NULL; -+ table->seq = 1; -+} -+ -+void allowedips_free(struct allowedips *table, struct mutex *lock) -+{ -+ ++table->seq; -+ free_root_node(table->root4, lock); -+ rcu_assign_pointer(table->root4, NULL); -+ free_root_node(table->root6, lock); -+ rcu_assign_pointer(table->root6, NULL); -+} -+ -+int allowedips_insert_v4(struct allowedips *table, const struct in_addr *ip, u8 cidr, struct wireguard_peer *peer, struct mutex *lock) -+{ -+ ++table->seq; -+ return add(&table->root4, 32, (const u8 *)ip, cidr, peer, lock); -+} -+ -+int allowedips_insert_v6(struct allowedips *table, const struct in6_addr *ip, u8 cidr, struct wireguard_peer *peer, struct mutex *lock) -+{ -+ ++table->seq; -+ return add(&table->root6, 128, (const u8 *)ip, cidr, peer, lock); -+} -+ -+void allowedips_remove_by_peer(struct allowedips *table, struct wireguard_peer *peer, struct mutex *lock) -+{ -+ ++table->seq; -+ walk_remove_by_peer(&table->root4, peer, lock); -+ walk_remove_by_peer(&table->root6, peer, lock); -+} -+ -+int allowedips_walk_by_peer(struct allowedips *table, struct allowedips_cursor *cursor, struct wireguard_peer *peer, int (*func)(void *ctx, const u8 *ip, u8 cidr, int family), void *ctx, struct mutex *lock) -+{ -+ int ret; -+ -+ if (!cursor->seq) -+ cursor->seq = table->seq; -+ else if (cursor->seq != table->seq) -+ return 0; -+ -+ if (!cursor->second_half) { -+ ret = walk_by_peer(table->root4, AF_INET, cursor, peer, func, ctx, lock); -+ if (ret) -+ return ret; -+ cursor->len = 0; -+ cursor->second_half = true; -+ } -+ return walk_by_peer(table->root6, AF_INET6, cursor, peer, func, ctx, lock); -+} -+ -+/* Returns a strong reference to a peer */ -+struct wireguard_peer *allowedips_lookup_dst(struct allowedips *table, struct sk_buff *skb) -+{ -+ if (skb->protocol == htons(ETH_P_IP)) -+ return lookup(table->root4, 32, &ip_hdr(skb)->daddr); -+ else if (skb->protocol == htons(ETH_P_IPV6)) -+ return lookup(table->root6, 128, &ipv6_hdr(skb)->daddr); -+ return NULL; -+} -+ -+/* Returns a strong reference to a peer */ -+struct wireguard_peer *allowedips_lookup_src(struct allowedips *table, struct sk_buff *skb) -+{ -+ if (skb->protocol == htons(ETH_P_IP)) -+ return lookup(table->root4, 32, &ip_hdr(skb)->saddr); -+ else if (skb->protocol == htons(ETH_P_IPV6)) -+ return lookup(table->root6, 128, &ipv6_hdr(skb)->saddr); -+ return NULL; -+} -+ -+#include "selftest/allowedips.h" ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/cookie.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,195 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "cookie.h" -+#include "peer.h" -+#include "device.h" -+#include "messages.h" -+#include "ratelimiter.h" -+#include "crypto/blake2s.h" -+#include "crypto/chacha20poly1305.h" -+ -+#include -+#include -+#include -+ -+void cookie_checker_init(struct cookie_checker *checker, struct wireguard_device *wg) -+{ -+ init_rwsem(&checker->secret_lock); -+ checker->secret_birthdate = get_jiffies_64(); -+ get_random_bytes(checker->secret, NOISE_HASH_LEN); -+ checker->device = wg; -+} -+ -+enum { COOKIE_KEY_LABEL_LEN = 8 }; -+static const u8 mac1_key_label[COOKIE_KEY_LABEL_LEN] = "mac1----"; -+static const u8 cookie_key_label[COOKIE_KEY_LABEL_LEN] = "cookie--"; -+ -+static void precompute_key(u8 key[NOISE_SYMMETRIC_KEY_LEN], const u8 pubkey[NOISE_PUBLIC_KEY_LEN], const u8 label[COOKIE_KEY_LABEL_LEN]) -+{ -+ struct blake2s_state blake; -+ -+ blake2s_init(&blake, NOISE_SYMMETRIC_KEY_LEN); -+ blake2s_update(&blake, label, COOKIE_KEY_LABEL_LEN); -+ blake2s_update(&blake, pubkey, NOISE_PUBLIC_KEY_LEN); -+ blake2s_final(&blake, key, NOISE_SYMMETRIC_KEY_LEN); -+} -+ -+void cookie_checker_precompute_device_keys(struct cookie_checker *checker) -+{ -+ down_read(&checker->device->static_identity.lock); -+ if (likely(checker->device->static_identity.has_identity)) { -+ precompute_key(checker->cookie_encryption_key, checker->device->static_identity.static_public, cookie_key_label); -+ precompute_key(checker->message_mac1_key, checker->device->static_identity.static_public, mac1_key_label); -+ } else { -+ memset(checker->cookie_encryption_key, 0, NOISE_SYMMETRIC_KEY_LEN); -+ memset(checker->message_mac1_key, 0, NOISE_SYMMETRIC_KEY_LEN); -+ } -+ up_read(&checker->device->static_identity.lock); -+} -+ -+void cookie_checker_precompute_peer_keys(struct wireguard_peer *peer) -+{ -+ precompute_key(peer->latest_cookie.cookie_decryption_key, peer->handshake.remote_static, cookie_key_label); -+ precompute_key(peer->latest_cookie.message_mac1_key, peer->handshake.remote_static, mac1_key_label); -+} -+ -+void cookie_init(struct cookie *cookie) -+{ -+ memset(cookie, 0, sizeof(struct cookie)); -+ init_rwsem(&cookie->lock); -+} -+ -+static void compute_mac1(u8 mac1[COOKIE_LEN], const void *message, size_t len, const u8 key[NOISE_SYMMETRIC_KEY_LEN]) -+{ -+ len = len - sizeof(struct message_macs) + offsetof(struct message_macs, mac1); -+ blake2s(mac1, message, key, COOKIE_LEN, len, NOISE_SYMMETRIC_KEY_LEN); -+} -+ -+static void compute_mac2(u8 mac2[COOKIE_LEN], const void *message, size_t len, const u8 cookie[COOKIE_LEN]) -+{ -+ len = len - sizeof(struct message_macs) + offsetof(struct message_macs, mac2); -+ blake2s(mac2, message, cookie, COOKIE_LEN, len, COOKIE_LEN); -+} -+ -+static void make_cookie(u8 cookie[COOKIE_LEN], struct sk_buff *skb, struct cookie_checker *checker) -+{ -+ struct blake2s_state state; -+ -+ if (!time_is_after_jiffies64(checker->secret_birthdate + COOKIE_SECRET_MAX_AGE)) { -+ down_write(&checker->secret_lock); -+ checker->secret_birthdate = get_jiffies_64(); -+ get_random_bytes(checker->secret, NOISE_HASH_LEN); -+ up_write(&checker->secret_lock); -+ } -+ -+ down_read(&checker->secret_lock); -+ -+ blake2s_init_key(&state, COOKIE_LEN, checker->secret, NOISE_HASH_LEN); -+ if (skb->protocol == htons(ETH_P_IP)) -+ blake2s_update(&state, (u8 *)&ip_hdr(skb)->saddr, sizeof(struct in_addr)); -+ else if (skb->protocol == htons(ETH_P_IPV6)) -+ blake2s_update(&state, (u8 *)&ipv6_hdr(skb)->saddr, sizeof(struct in6_addr)); -+ blake2s_update(&state, (u8 *)&udp_hdr(skb)->source, sizeof(__be16)); -+ blake2s_final(&state, cookie, COOKIE_LEN); -+ -+ up_read(&checker->secret_lock); -+} -+ -+enum cookie_mac_state cookie_validate_packet(struct cookie_checker *checker, struct sk_buff *skb, bool check_cookie) -+{ -+ u8 computed_mac[COOKIE_LEN]; -+ u8 cookie[COOKIE_LEN]; -+ enum cookie_mac_state ret; -+ struct message_macs *macs = (struct message_macs *)(skb->data + skb->len - sizeof(struct message_macs)); -+ -+ ret = INVALID_MAC; -+ compute_mac1(computed_mac, skb->data, skb->len, checker->message_mac1_key); -+ if (crypto_memneq(computed_mac, macs->mac1, COOKIE_LEN)) -+ goto out; -+ -+ ret = VALID_MAC_BUT_NO_COOKIE; -+ -+ if (!check_cookie) -+ goto out; -+ -+ make_cookie(cookie, skb, checker); -+ -+ compute_mac2(computed_mac, skb->data, skb->len, cookie); -+ if (crypto_memneq(computed_mac, macs->mac2, COOKIE_LEN)) -+ goto out; -+ -+ ret = VALID_MAC_WITH_COOKIE_BUT_RATELIMITED; -+ if (!ratelimiter_allow(skb, dev_net(checker->device->dev))) -+ goto out; -+ -+ ret = VALID_MAC_WITH_COOKIE; -+ -+out: -+ return ret; -+} -+ -+void cookie_add_mac_to_packet(void *message, size_t len, struct wireguard_peer *peer) -+{ -+ struct message_macs *macs = (struct message_macs *)((u8 *)message + len - sizeof(struct message_macs)); -+ -+ down_write(&peer->latest_cookie.lock); -+ compute_mac1(macs->mac1, message, len, peer->latest_cookie.message_mac1_key); -+ memcpy(peer->latest_cookie.last_mac1_sent, macs->mac1, COOKIE_LEN); -+ peer->latest_cookie.have_sent_mac1 = true; -+ up_write(&peer->latest_cookie.lock); -+ -+ down_read(&peer->latest_cookie.lock); -+ if (peer->latest_cookie.is_valid && time_is_after_jiffies64(peer->latest_cookie.birthdate + COOKIE_SECRET_MAX_AGE - COOKIE_SECRET_LATENCY)) -+ compute_mac2(macs->mac2, message, len, peer->latest_cookie.cookie); -+ else -+ memset(macs->mac2, 0, COOKIE_LEN); -+ up_read(&peer->latest_cookie.lock); -+} -+ -+void cookie_message_create(struct message_handshake_cookie *dst, struct sk_buff *skb, __le32 index, struct cookie_checker *checker) -+{ -+ struct message_macs *macs = (struct message_macs *)((u8 *)skb->data + skb->len - sizeof(struct message_macs)); -+ u8 cookie[COOKIE_LEN]; -+ -+ dst->header.type = cpu_to_le32(MESSAGE_HANDSHAKE_COOKIE); -+ dst->receiver_index = index; -+ get_random_bytes_wait(dst->nonce, COOKIE_NONCE_LEN); -+ -+ make_cookie(cookie, skb, checker); -+ xchacha20poly1305_encrypt(dst->encrypted_cookie, cookie, COOKIE_LEN, macs->mac1, COOKIE_LEN, dst->nonce, checker->cookie_encryption_key); -+} -+ -+void cookie_message_consume(struct message_handshake_cookie *src, struct wireguard_device *wg) -+{ -+ u8 cookie[COOKIE_LEN]; -+ struct index_hashtable_entry *entry; -+ bool ret; -+ -+ entry = index_hashtable_lookup(&wg->index_hashtable, INDEX_HASHTABLE_HANDSHAKE | INDEX_HASHTABLE_KEYPAIR, src->receiver_index); -+ if (unlikely(!entry)) -+ return; -+ -+ down_read(&entry->peer->latest_cookie.lock); -+ if (unlikely(!entry->peer->latest_cookie.have_sent_mac1)) { -+ up_read(&entry->peer->latest_cookie.lock); -+ goto out; -+ } -+ ret = xchacha20poly1305_decrypt(cookie, src->encrypted_cookie, sizeof(src->encrypted_cookie), entry->peer->latest_cookie.last_mac1_sent, COOKIE_LEN, src->nonce, entry->peer->latest_cookie.cookie_decryption_key); -+ up_read(&entry->peer->latest_cookie.lock); -+ -+ if (ret) { -+ down_write(&entry->peer->latest_cookie.lock); -+ memcpy(entry->peer->latest_cookie.cookie, cookie, COOKIE_LEN); -+ entry->peer->latest_cookie.birthdate = get_jiffies_64(); -+ entry->peer->latest_cookie.is_valid = true; -+ entry->peer->latest_cookie.have_sent_mac1 = false; -+ up_write(&entry->peer->latest_cookie.lock); -+ } else -+ net_dbg_ratelimited("%s: Could not decrypt invalid cookie response\n", wg->dev->name); -+ -+out: -+ peer_put(entry->peer); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/device.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,421 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "queueing.h" -+#include "socket.h" -+#include "timers.h" -+#include "device.h" -+#include "ratelimiter.h" -+#include "peer.h" -+#include "messages.h" -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+static LIST_HEAD(device_list); -+ -+static int open(struct net_device *dev) -+{ -+ int ret; -+ struct wireguard_peer *peer; -+ struct wireguard_device *wg = netdev_priv(dev); -+#ifndef COMPAT_CANNOT_USE_IN6_DEV_GET -+ struct inet6_dev *dev_v6 = __in6_dev_get(dev); -+#endif -+ struct in_device *dev_v4 = __in_dev_get_rtnl(dev); -+ -+ if (dev_v4) { -+ /* TODO: when we merge to mainline, put this check near the ip_rt_send_redirect -+ * call of ip_forward in net/ipv4/ip_forward.c, similar to the current secpath -+ * check, rather than turning it off like this. This is just a stop gap solution -+ * while we're an out of tree module. -+ */ -+ IN_DEV_CONF_SET(dev_v4, SEND_REDIRECTS, false); -+ IPV4_DEVCONF_ALL(dev_net(dev), SEND_REDIRECTS) = false; -+ } -+#ifndef COMPAT_CANNOT_USE_IN6_DEV_GET -+ if (dev_v6) -+#ifndef COMPAT_CANNOT_USE_DEV_CNF -+ dev_v6->cnf.addr_gen_mode = IN6_ADDR_GEN_MODE_NONE; -+#else -+ dev_v6->addr_gen_mode = IN6_ADDR_GEN_MODE_NONE; -+#endif -+#endif -+ -+ ret = socket_init(wg, wg->incoming_port); -+ if (ret < 0) -+ return ret; -+ mutex_lock(&wg->device_update_lock); -+ list_for_each_entry(peer, &wg->peer_list, peer_list) { -+ packet_send_staged_packets(peer); -+ if (peer->persistent_keepalive_interval) -+ packet_send_keepalive(peer); -+ } -+ mutex_unlock(&wg->device_update_lock); -+ return 0; -+} -+ -+#if defined(CONFIG_PM_SLEEP) && !defined(CONFIG_ANDROID) -+static int pm_notification(struct notifier_block *nb, unsigned long action, void *data) -+{ -+ struct wireguard_device *wg; -+ struct wireguard_peer *peer; -+ -+ if (action != PM_HIBERNATION_PREPARE && action != PM_SUSPEND_PREPARE) -+ return 0; -+ -+ rtnl_lock(); -+ list_for_each_entry(wg, &device_list, device_list) { -+ mutex_lock(&wg->device_update_lock); -+ list_for_each_entry(peer, &wg->peer_list, peer_list) { -+ noise_handshake_clear(&peer->handshake); -+ noise_keypairs_clear(&peer->keypairs); -+ if (peer->timers_enabled) -+ del_timer(&peer->timer_zero_key_material); -+ } -+ mutex_unlock(&wg->device_update_lock); -+ } -+ rtnl_unlock(); -+ rcu_barrier_bh(); -+ return 0; -+} -+static struct notifier_block pm_notifier = { .notifier_call = pm_notification }; -+#endif -+ -+static int stop(struct net_device *dev) -+{ -+ struct wireguard_device *wg = netdev_priv(dev); -+ struct wireguard_peer *peer; -+ -+ mutex_lock(&wg->device_update_lock); -+ list_for_each_entry(peer, &wg->peer_list, peer_list) { -+ skb_queue_purge(&peer->staged_packet_queue); -+ timers_stop(peer); -+ noise_handshake_clear(&peer->handshake); -+ noise_keypairs_clear(&peer->keypairs); -+ peer->last_sent_handshake = get_jiffies_64() - REKEY_TIMEOUT - HZ; -+ } -+ mutex_unlock(&wg->device_update_lock); -+ skb_queue_purge(&wg->incoming_handshakes); -+ socket_reinit(wg, NULL, NULL); -+ return 0; -+} -+ -+static netdev_tx_t xmit(struct sk_buff *skb, struct net_device *dev) -+{ -+ struct wireguard_device *wg = netdev_priv(dev); -+ struct wireguard_peer *peer; -+ struct sk_buff *next; -+ struct sk_buff_head packets; -+ sa_family_t family; -+ int ret; -+ -+ if (unlikely(skb_examine_untrusted_ip_hdr(skb) != skb->protocol)) { -+ ret = -EPROTONOSUPPORT; -+ net_dbg_ratelimited("%s: Invalid IP packet\n", dev->name); -+ goto err; -+ } -+ -+ peer = allowedips_lookup_dst(&wg->peer_allowedips, skb); -+ if (unlikely(!peer)) { -+ ret = -ENOKEY; -+ net_dbg_skb_ratelimited("%s: No peer is configured for %pISc\n", dev->name, skb); -+ goto err; -+ } -+ -+ family = READ_ONCE(peer->endpoint.addr.sa_family); -+ if (unlikely(family != AF_INET && family != AF_INET6)) { -+ ret = -EDESTADDRREQ; -+ net_dbg_ratelimited("%s: No valid endpoint has been configured or discovered for peer %llu\n", dev->name, peer->internal_id); -+ goto err_peer; -+ } -+ -+ __skb_queue_head_init(&packets); -+ if (!skb_is_gso(skb)) -+ skb->next = NULL; -+ else { -+ struct sk_buff *segs = skb_gso_segment(skb, 0); -+ -+ if (unlikely(IS_ERR(segs))) { -+ ret = PTR_ERR(segs); -+ goto err_peer; -+ } -+ dev_kfree_skb(skb); -+ skb = segs; -+ } -+ do { -+ next = skb->next; -+ skb->next = skb->prev = NULL; -+ -+ skb = skb_share_check(skb, GFP_ATOMIC); -+ if (unlikely(!skb)) -+ continue; -+ -+ /* We only need to keep the original dst around for icmp, -+ * so at this point we're in a position to drop it. -+ */ -+ skb_dst_drop(skb); -+ -+ __skb_queue_tail(&packets, skb); -+ } while ((skb = next) != NULL); -+ -+ spin_lock_bh(&peer->staged_packet_queue.lock); -+ /* If the queue is getting too big, we start removing the oldest packets until it's small again. -+ * We do this before adding the new packet, so we don't remove GSO segments that are in excess. -+ */ -+ while (skb_queue_len(&peer->staged_packet_queue) > MAX_STAGED_PACKETS) -+ dev_kfree_skb(__skb_dequeue(&peer->staged_packet_queue)); -+ skb_queue_splice_tail(&packets, &peer->staged_packet_queue); -+ spin_unlock_bh(&peer->staged_packet_queue.lock); -+ -+ packet_send_staged_packets(peer); -+ -+ peer_put(peer); -+ return NETDEV_TX_OK; -+ -+err_peer: -+ peer_put(peer); -+err: -+ ++dev->stats.tx_errors; -+ if (skb->protocol == htons(ETH_P_IP)) -+ icmp_send(skb, ICMP_DEST_UNREACH, ICMP_HOST_UNREACH, 0); -+ else if (skb->protocol == htons(ETH_P_IPV6)) -+ icmpv6_send(skb, ICMPV6_DEST_UNREACH, ICMPV6_ADDR_UNREACH, 0); -+ kfree_skb(skb); -+ return ret; -+} -+ -+static const struct net_device_ops netdev_ops = { -+ .ndo_open = open, -+ .ndo_stop = stop, -+ .ndo_start_xmit = xmit, -+ .ndo_get_stats64 = ip_tunnel_get_stats64 -+}; -+ -+static void destruct(struct net_device *dev) -+{ -+ struct wireguard_device *wg = netdev_priv(dev); -+ -+ rtnl_lock(); -+ list_del(&wg->device_list); -+ rtnl_unlock(); -+ mutex_lock(&wg->device_update_lock); -+ wg->incoming_port = 0; -+ socket_reinit(wg, NULL, NULL); -+ peer_remove_all(wg); /* The final references are cleared in the below calls to destroy_workqueue. */ -+ destroy_workqueue(wg->handshake_receive_wq); -+ destroy_workqueue(wg->handshake_send_wq); -+ packet_queue_free(&wg->decrypt_queue, true); -+ packet_queue_free(&wg->encrypt_queue, true); -+ destroy_workqueue(wg->packet_crypt_wq); -+ rcu_barrier_bh(); /* Wait for all the peers to be actually freed. */ -+ allowedips_free(&wg->peer_allowedips, &wg->device_update_lock); -+ ratelimiter_uninit(); -+ memzero_explicit(&wg->static_identity, sizeof(struct noise_static_identity)); -+ skb_queue_purge(&wg->incoming_handshakes); -+ free_percpu(dev->tstats); -+ free_percpu(wg->incoming_handshakes_worker); -+ if (wg->have_creating_net_ref) -+ put_net(wg->creating_net); -+ mutex_unlock(&wg->device_update_lock); -+ -+ pr_debug("%s: Interface deleted\n", dev->name); -+ free_netdev(dev); -+} -+ -+static const struct device_type device_type = { -+ .name = KBUILD_MODNAME -+}; -+ -+static void setup(struct net_device *dev) -+{ -+ struct wireguard_device *wg = netdev_priv(dev); -+ enum { WG_NETDEV_FEATURES = NETIF_F_HW_CSUM | NETIF_F_RXCSUM | NETIF_F_SG | NETIF_F_GSO | NETIF_F_GSO_SOFTWARE | NETIF_F_HIGHDMA }; -+ -+ dev->netdev_ops = &netdev_ops; -+ dev->hard_header_len = 0; -+ dev->addr_len = 0; -+ dev->needed_headroom = DATA_PACKET_HEAD_ROOM; -+ dev->needed_tailroom = noise_encrypted_len(MESSAGE_PADDING_MULTIPLE); -+ dev->type = ARPHRD_NONE; -+ dev->flags = IFF_POINTOPOINT | IFF_NOARP; -+#ifndef COMPAT_CANNOT_USE_IFF_NO_QUEUE -+ dev->priv_flags |= IFF_NO_QUEUE; -+#else -+ dev->tx_queue_len = 0; -+#endif -+ dev->features |= NETIF_F_LLTX; -+ dev->features |= WG_NETDEV_FEATURES; -+ dev->hw_features |= WG_NETDEV_FEATURES; -+ dev->hw_enc_features |= WG_NETDEV_FEATURES; -+ dev->mtu = ETH_DATA_LEN - MESSAGE_MINIMUM_LENGTH - sizeof(struct udphdr) - max(sizeof(struct ipv6hdr), sizeof(struct iphdr)); -+ -+ SET_NETDEV_DEVTYPE(dev, &device_type); -+ -+ /* We need to keep the dst around in case of icmp replies. */ -+ netif_keep_dst(dev); -+ -+ memset(wg, 0, sizeof(struct wireguard_device)); -+ wg->dev = dev; -+} -+ -+static int newlink(struct net *src_net, struct net_device *dev, struct nlattr *tb[], struct nlattr *data[], struct netlink_ext_ack *extack) -+{ -+ int ret = -ENOMEM; -+ struct wireguard_device *wg = netdev_priv(dev); -+ -+ wg->creating_net = src_net; -+ init_rwsem(&wg->static_identity.lock); -+ mutex_init(&wg->socket_update_lock); -+ mutex_init(&wg->device_update_lock); -+ skb_queue_head_init(&wg->incoming_handshakes); -+ pubkey_hashtable_init(&wg->peer_hashtable); -+ index_hashtable_init(&wg->index_hashtable); -+ allowedips_init(&wg->peer_allowedips); -+ cookie_checker_init(&wg->cookie_checker, wg); -+ INIT_LIST_HEAD(&wg->peer_list); -+ wg->device_update_gen = 1; -+ -+ dev->tstats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats); -+ if (!dev->tstats) -+ goto error_1; -+ -+ wg->incoming_handshakes_worker = packet_alloc_percpu_multicore_worker(packet_handshake_receive_worker, wg); -+ if (!wg->incoming_handshakes_worker) -+ goto error_2; -+ -+ wg->handshake_receive_wq = alloc_workqueue("wg-kex-%s", WQ_CPU_INTENSIVE | WQ_FREEZABLE, 0, dev->name); -+ if (!wg->handshake_receive_wq) -+ goto error_3; -+ -+ wg->handshake_send_wq = alloc_workqueue("wg-kex-%s", WQ_UNBOUND | WQ_FREEZABLE, 0, dev->name); -+ if (!wg->handshake_send_wq) -+ goto error_4; -+ -+ wg->packet_crypt_wq = alloc_workqueue("wg-crypt-%s", WQ_CPU_INTENSIVE | WQ_MEM_RECLAIM, 0, dev->name); -+ if (!wg->packet_crypt_wq) -+ goto error_5; -+ -+ if (packet_queue_init(&wg->encrypt_queue, packet_encrypt_worker, true, MAX_QUEUED_PACKETS) < 0) -+ goto error_6; -+ -+ if (packet_queue_init(&wg->decrypt_queue, packet_decrypt_worker, true, MAX_QUEUED_PACKETS) < 0) -+ goto error_7; -+ -+ ret = ratelimiter_init(); -+ if (ret < 0) -+ goto error_8; -+ -+ ret = register_netdevice(dev); -+ if (ret < 0) -+ goto error_9; -+ -+ list_add(&wg->device_list, &device_list); -+ -+ /* We wait until the end to assign priv_destructor, so that register_netdevice doesn't -+ * call it for us if it fails. -+ */ -+ dev->priv_destructor = destruct; -+ -+ pr_debug("%s: Interface created\n", dev->name); -+ return ret; -+ -+error_9: -+ ratelimiter_uninit(); -+error_8: -+ packet_queue_free(&wg->decrypt_queue, true); -+error_7: -+ packet_queue_free(&wg->encrypt_queue, true); -+error_6: -+ destroy_workqueue(wg->packet_crypt_wq); -+error_5: -+ destroy_workqueue(wg->handshake_send_wq); -+error_4: -+ destroy_workqueue(wg->handshake_receive_wq); -+error_3: -+ free_percpu(wg->incoming_handshakes_worker); -+error_2: -+ free_percpu(dev->tstats); -+error_1: -+ return ret; -+} -+ -+static struct rtnl_link_ops link_ops __read_mostly = { -+ .kind = KBUILD_MODNAME, -+ .priv_size = sizeof(struct wireguard_device), -+ .setup = setup, -+ .newlink = newlink, -+}; -+ -+static int netdevice_notification(struct notifier_block *nb, unsigned long action, void *data) -+{ -+ struct net_device *dev = ((struct netdev_notifier_info *)data)->dev; -+ struct wireguard_device *wg = netdev_priv(dev); -+ -+ ASSERT_RTNL(); -+ -+ if (action != NETDEV_REGISTER || dev->netdev_ops != &netdev_ops) -+ return 0; -+ -+ if (dev_net(dev) == wg->creating_net && wg->have_creating_net_ref) { -+ put_net(wg->creating_net); -+ wg->have_creating_net_ref = false; -+ } else if (dev_net(dev) != wg->creating_net && !wg->have_creating_net_ref) { -+ wg->have_creating_net_ref = true; -+ get_net(wg->creating_net); -+ } -+ return 0; -+} -+ -+static struct notifier_block netdevice_notifier = { .notifier_call = netdevice_notification }; -+ -+int __init device_init(void) -+{ -+ int ret; -+ -+#if defined(CONFIG_PM_SLEEP) && !defined(CONFIG_ANDROID) -+ ret = register_pm_notifier(&pm_notifier); -+ if (ret) -+ return ret; -+#endif -+ -+ ret = register_netdevice_notifier(&netdevice_notifier); -+ if (ret) -+ goto error_pm; -+ -+ ret = rtnl_link_register(&link_ops); -+ if (ret) -+ goto error_netdevice; -+ -+ return 0; -+ -+error_netdevice: -+ unregister_netdevice_notifier(&netdevice_notifier); -+error_pm: -+#if defined(CONFIG_PM_SLEEP) && !defined(CONFIG_ANDROID) -+ unregister_pm_notifier(&pm_notifier); -+#endif -+ return ret; -+} -+ -+void device_uninit(void) -+{ -+ rtnl_link_unregister(&link_ops); -+ unregister_netdevice_notifier(&netdevice_notifier); -+#if defined(CONFIG_PM_SLEEP) && !defined(CONFIG_ANDROID) -+ unregister_pm_notifier(&pm_notifier); -+#endif -+ rcu_barrier_bh(); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/hashtables.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,168 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "hashtables.h" -+#include "peer.h" -+#include "noise.h" -+ -+static inline struct hlist_head *pubkey_bucket(struct pubkey_hashtable *table, const u8 pubkey[NOISE_PUBLIC_KEY_LEN]) -+{ -+ /* siphash gives us a secure 64bit number based on a random key. Since the bits are -+ * uniformly distributed, we can then mask off to get the bits we need. -+ */ -+ return &table->hashtable[siphash(pubkey, NOISE_PUBLIC_KEY_LEN, &table->key) & (HASH_SIZE(table->hashtable) - 1)]; -+} -+ -+void pubkey_hashtable_init(struct pubkey_hashtable *table) -+{ -+ get_random_bytes(&table->key, sizeof(table->key)); -+ hash_init(table->hashtable); -+ mutex_init(&table->lock); -+} -+ -+void pubkey_hashtable_add(struct pubkey_hashtable *table, struct wireguard_peer *peer) -+{ -+ mutex_lock(&table->lock); -+ hlist_add_head_rcu(&peer->pubkey_hash, pubkey_bucket(table, peer->handshake.remote_static)); -+ mutex_unlock(&table->lock); -+} -+ -+void pubkey_hashtable_remove(struct pubkey_hashtable *table, struct wireguard_peer *peer) -+{ -+ mutex_lock(&table->lock); -+ hlist_del_init_rcu(&peer->pubkey_hash); -+ mutex_unlock(&table->lock); -+} -+ -+/* Returns a strong reference to a peer */ -+struct wireguard_peer *pubkey_hashtable_lookup(struct pubkey_hashtable *table, const u8 pubkey[NOISE_PUBLIC_KEY_LEN]) -+{ -+ struct wireguard_peer *iter_peer, *peer = NULL; -+ -+ rcu_read_lock_bh(); -+ hlist_for_each_entry_rcu_bh(iter_peer, pubkey_bucket(table, pubkey), pubkey_hash) { -+ if (!memcmp(pubkey, iter_peer->handshake.remote_static, NOISE_PUBLIC_KEY_LEN)) { -+ peer = iter_peer; -+ break; -+ } -+ } -+ peer = peer_get(peer); -+ rcu_read_unlock_bh(); -+ return peer; -+} -+ -+static inline struct hlist_head *index_bucket(struct index_hashtable *table, const __le32 index) -+{ -+ /* Since the indices are random and thus all bits are uniformly distributed, -+ * we can find its bucket simply by masking. -+ */ -+ return &table->hashtable[(__force u32)index & (HASH_SIZE(table->hashtable) - 1)]; -+} -+ -+void index_hashtable_init(struct index_hashtable *table) -+{ -+ hash_init(table->hashtable); -+ spin_lock_init(&table->lock); -+} -+ -+/* At the moment, we limit ourselves to 2^20 total peers, which generally might amount to 2^20*3 -+ * items in this hashtable. The algorithm below works by picking a random number and testing it. -+ * We can see that these limits mean we usually succeed pretty quickly: -+ * -+ * >>> def calculation(tries, size): -+ * ... return (size / 2**32)**(tries - 1) * (1 - (size / 2**32)) -+ * ... -+ * >>> calculation(1, 2**20 * 3) -+ * 0.999267578125 -+ * >>> calculation(2, 2**20 * 3) -+ * 0.0007318854331970215 -+ * >>> calculation(3, 2**20 * 3) -+ * 5.360489012673497e-07 -+ * >>> calculation(4, 2**20 * 3) -+ * 3.9261394135792216e-10 -+ * -+ * At the moment, we don't do any masking, so this algorithm isn't exactly constant time in -+ * either the random guessing or in the hash list lookup. We could require a minimum of 3 -+ * tries, which would successfully mask the guessing. TODO: this would not, however, help -+ * with the growing hash lengths. -+ */ -+ -+__le32 index_hashtable_insert(struct index_hashtable *table, struct index_hashtable_entry *entry) -+{ -+ struct index_hashtable_entry *existing_entry; -+ -+ spin_lock_bh(&table->lock); -+ hlist_del_init_rcu(&entry->index_hash); -+ spin_unlock_bh(&table->lock); -+ -+ rcu_read_lock_bh(); -+ -+search_unused_slot: -+ /* First we try to find an unused slot, randomly, while unlocked. */ -+ entry->index = (__force __le32)get_random_u32(); -+ hlist_for_each_entry_rcu_bh(existing_entry, index_bucket(table, entry->index), index_hash) { -+ if (existing_entry->index == entry->index) -+ goto search_unused_slot; /* If it's already in use, we continue searching. */ -+ } -+ -+ /* Once we've found an unused slot, we lock it, and then double-check -+ * that nobody else stole it from us. -+ */ -+ spin_lock_bh(&table->lock); -+ hlist_for_each_entry_rcu_bh(existing_entry, index_bucket(table, entry->index), index_hash) { -+ if (existing_entry->index == entry->index) { -+ spin_unlock_bh(&table->lock); -+ goto search_unused_slot; /* If it was stolen, we start over. */ -+ } -+ } -+ /* Otherwise, we know we have it exclusively (since we're locked), so we insert. */ -+ hlist_add_head_rcu(&entry->index_hash, index_bucket(table, entry->index)); -+ spin_unlock_bh(&table->lock); -+ -+ rcu_read_unlock_bh(); -+ -+ return entry->index; -+} -+ -+bool index_hashtable_replace(struct index_hashtable *table, struct index_hashtable_entry *old, struct index_hashtable_entry *new) -+{ -+ if (unlikely(hlist_unhashed(&old->index_hash))) -+ return false; -+ spin_lock_bh(&table->lock); -+ new->index = old->index; -+ hlist_replace_rcu(&old->index_hash, &new->index_hash); -+ INIT_HLIST_NODE(&old->index_hash); -+ spin_unlock_bh(&table->lock); -+ return true; -+} -+ -+void index_hashtable_remove(struct index_hashtable *table, struct index_hashtable_entry *entry) -+{ -+ spin_lock_bh(&table->lock); -+ hlist_del_init_rcu(&entry->index_hash); -+ spin_unlock_bh(&table->lock); -+} -+ -+/* Returns a strong reference to a entry->peer */ -+struct index_hashtable_entry *index_hashtable_lookup(struct index_hashtable *table, const enum index_hashtable_type type_mask, const __le32 index) -+{ -+ struct index_hashtable_entry *iter_entry, *entry = NULL; -+ -+ rcu_read_lock_bh(); -+ hlist_for_each_entry_rcu_bh(iter_entry, index_bucket(table, index), index_hash) { -+ if (iter_entry->index == index) { -+ if (likely(iter_entry->type & type_mask)) -+ entry = iter_entry; -+ break; -+ } -+ } -+ if (likely(entry)) { -+ entry->peer = peer_get(entry->peer); -+ if (unlikely(!entry->peer)) -+ entry = NULL; -+ } -+ rcu_read_unlock_bh(); -+ return entry; -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/main.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,69 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "version.h" -+#include "device.h" -+#include "noise.h" -+#include "queueing.h" -+#include "ratelimiter.h" -+#include "netlink.h" -+#include "crypto/chacha20poly1305.h" -+#include "crypto/blake2s.h" -+#include "crypto/curve25519.h" -+#include "uapi/wireguard.h" -+ -+#include -+#include -+#include -+#include -+#include -+ -+static int __init mod_init(void) -+{ -+ int ret; -+ -+ chacha20poly1305_fpu_init(); -+ blake2s_fpu_init(); -+ curve25519_fpu_init(); -+#ifdef DEBUG -+ if (!allowedips_selftest() || !packet_counter_selftest() || !curve25519_selftest() || !chacha20poly1305_selftest() || !poly1305_selftest() || !blake2s_selftest() || !ratelimiter_selftest()) -+ return -ENOTRECOVERABLE; -+#endif -+ noise_init(); -+ -+ ret = device_init(); -+ if (ret < 0) -+ goto err_packet; -+ -+ ret = genetlink_init(); -+ if (ret < 0) -+ goto err_netlink; -+ -+ pr_info("WireGuard " WIREGUARD_VERSION " loaded. See www.wireguard.com for information.\n"); -+ pr_info("Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved.\n"); -+ -+ return 0; -+ -+err_netlink: -+ device_uninit(); -+err_packet: -+ return ret; -+} -+ -+static void __exit mod_exit(void) -+{ -+ genetlink_uninit(); -+ device_uninit(); -+ pr_debug("WireGuard unloaded\n"); -+} -+ -+module_init(mod_init); -+module_exit(mod_exit); -+MODULE_LICENSE("GPL v2"); -+MODULE_DESCRIPTION("Fast, secure, and modern VPN tunnel"); -+MODULE_AUTHOR("Jason A. Donenfeld "); -+MODULE_VERSION(WIREGUARD_VERSION); -+MODULE_ALIAS_RTNL_LINK(KBUILD_MODNAME); -+MODULE_ALIAS_GENL_FAMILY(WG_GENL_NAME); ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/netlink.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,517 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "netlink.h" -+#include "device.h" -+#include "peer.h" -+#include "socket.h" -+#include "queueing.h" -+#include "messages.h" -+#include "uapi/wireguard.h" -+#include -+#include -+#include -+ -+static struct genl_family genl_family; -+ -+static const struct nla_policy device_policy[WGDEVICE_A_MAX + 1] = { -+ [WGDEVICE_A_IFINDEX] = { .type = NLA_U32 }, -+ [WGDEVICE_A_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ - 1 }, -+ [WGDEVICE_A_PRIVATE_KEY]= { .len = NOISE_PUBLIC_KEY_LEN }, -+ [WGDEVICE_A_PUBLIC_KEY] = { .len = NOISE_PUBLIC_KEY_LEN }, -+ [WGDEVICE_A_FLAGS] = { .type = NLA_U32 }, -+ [WGDEVICE_A_LISTEN_PORT]= { .type = NLA_U16 }, -+ [WGDEVICE_A_FWMARK] = { .type = NLA_U32 }, -+ [WGDEVICE_A_PEERS] = { .type = NLA_NESTED } -+}; -+ -+static const struct nla_policy peer_policy[WGPEER_A_MAX + 1] = { -+ [WGPEER_A_PUBLIC_KEY] = { .len = NOISE_PUBLIC_KEY_LEN }, -+ [WGPEER_A_PRESHARED_KEY] = { .len = NOISE_SYMMETRIC_KEY_LEN }, -+ [WGPEER_A_FLAGS] = { .type = NLA_U32 }, -+ [WGPEER_A_ENDPOINT] = { .len = sizeof(struct sockaddr) }, -+ [WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL]= { .type = NLA_U16 }, -+ [WGPEER_A_LAST_HANDSHAKE_TIME] = { .len = sizeof(struct timespec) }, -+ [WGPEER_A_RX_BYTES] = { .type = NLA_U64 }, -+ [WGPEER_A_TX_BYTES] = { .type = NLA_U64 }, -+ [WGPEER_A_ALLOWEDIPS] = { .type = NLA_NESTED } -+}; -+ -+static const struct nla_policy allowedip_policy[WGALLOWEDIP_A_MAX + 1] = { -+ [WGALLOWEDIP_A_FAMILY] = { .type = NLA_U16 }, -+ [WGALLOWEDIP_A_IPADDR] = { .len = sizeof(struct in_addr) }, -+ [WGALLOWEDIP_A_CIDR_MASK] = { .type = NLA_U8 } -+}; -+ -+static struct wireguard_device *lookup_interface(struct nlattr **attrs, struct sk_buff *skb) -+{ -+ struct net_device *dev = NULL; -+ -+ if (!attrs[WGDEVICE_A_IFINDEX] == !attrs[WGDEVICE_A_IFNAME]) -+ return ERR_PTR(-EBADR); -+ if (attrs[WGDEVICE_A_IFINDEX]) -+ dev = dev_get_by_index(sock_net(skb->sk), nla_get_u32(attrs[WGDEVICE_A_IFINDEX])); -+ else if (attrs[WGDEVICE_A_IFNAME]) -+ dev = dev_get_by_name(sock_net(skb->sk), nla_data(attrs[WGDEVICE_A_IFNAME])); -+ if (!dev) -+ return ERR_PTR(-ENODEV); -+ if (!dev->rtnl_link_ops || !dev->rtnl_link_ops->kind || strcmp(dev->rtnl_link_ops->kind, KBUILD_MODNAME)) { -+ dev_put(dev); -+ return ERR_PTR(-EOPNOTSUPP); -+ } -+ return netdev_priv(dev); -+} -+ -+struct allowedips_ctx { -+ struct sk_buff *skb; -+ unsigned int i; -+}; -+ -+static int get_allowedips(void *ctx, const u8 *ip, u8 cidr, int family) -+{ -+ struct nlattr *allowedip_nest; -+ struct allowedips_ctx *actx = ctx; -+ -+ allowedip_nest = nla_nest_start(actx->skb, actx->i++); -+ if (!allowedip_nest) -+ return -EMSGSIZE; -+ -+ if (nla_put_u8(actx->skb, WGALLOWEDIP_A_CIDR_MASK, cidr) || nla_put_u16(actx->skb, WGALLOWEDIP_A_FAMILY, family) || -+ nla_put(actx->skb, WGALLOWEDIP_A_IPADDR, family == AF_INET6 ? sizeof(struct in6_addr) : sizeof(struct in_addr), ip)) { -+ nla_nest_cancel(actx->skb, allowedip_nest); -+ return -EMSGSIZE; -+ } -+ -+ nla_nest_end(actx->skb, allowedip_nest); -+ return 0; -+} -+ -+static int get_peer(struct wireguard_peer *peer, unsigned int index, struct allowedips_cursor *rt_cursor, struct sk_buff *skb) -+{ -+ struct allowedips_ctx ctx = { .skb = skb }; -+ struct nlattr *allowedips_nest, *peer_nest = nla_nest_start(skb, index); -+ bool fail; -+ -+ if (!peer_nest) -+ return -EMSGSIZE; -+ -+ down_read(&peer->handshake.lock); -+ fail = nla_put(skb, WGPEER_A_PUBLIC_KEY, NOISE_PUBLIC_KEY_LEN, peer->handshake.remote_static); -+ up_read(&peer->handshake.lock); -+ if (fail) -+ goto err; -+ -+ if (!rt_cursor->seq) { -+ down_read(&peer->handshake.lock); -+ fail = nla_put(skb, WGPEER_A_PRESHARED_KEY, NOISE_SYMMETRIC_KEY_LEN, peer->handshake.preshared_key); -+ up_read(&peer->handshake.lock); -+ if (fail) -+ goto err; -+ -+ if (nla_put(skb, WGPEER_A_LAST_HANDSHAKE_TIME, sizeof(struct timespec), &peer->walltime_last_handshake) || nla_put_u16(skb, WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL, peer->persistent_keepalive_interval / HZ) || -+ nla_put_u64_64bit(skb, WGPEER_A_TX_BYTES, peer->tx_bytes, WGPEER_A_UNSPEC) || nla_put_u64_64bit(skb, WGPEER_A_RX_BYTES, peer->rx_bytes, WGPEER_A_UNSPEC)) -+ goto err; -+ -+ read_lock_bh(&peer->endpoint_lock); -+ if (peer->endpoint.addr.sa_family == AF_INET) -+ fail = nla_put(skb, WGPEER_A_ENDPOINT, sizeof(struct sockaddr_in), &peer->endpoint.addr4); -+ else if (peer->endpoint.addr.sa_family == AF_INET6) -+ fail = nla_put(skb, WGPEER_A_ENDPOINT, sizeof(struct sockaddr_in6), &peer->endpoint.addr6); -+ read_unlock_bh(&peer->endpoint_lock); -+ if (fail) -+ goto err; -+ } -+ -+ allowedips_nest = nla_nest_start(skb, WGPEER_A_ALLOWEDIPS); -+ if (!allowedips_nest) -+ goto err; -+ if (allowedips_walk_by_peer(&peer->device->peer_allowedips, rt_cursor, peer, get_allowedips, &ctx, &peer->device->device_update_lock)) { -+ nla_nest_end(skb, allowedips_nest); -+ nla_nest_end(skb, peer_nest); -+ return -EMSGSIZE; -+ } -+ memset(rt_cursor, 0, sizeof(*rt_cursor)); -+ nla_nest_end(skb, allowedips_nest); -+ nla_nest_end(skb, peer_nest); -+ return 0; -+err: -+ nla_nest_cancel(skb, peer_nest); -+ return -EMSGSIZE; -+} -+ -+static int get_device_start(struct netlink_callback *cb) -+{ -+ struct wireguard_device *wg; -+ struct nlattr **attrs = genl_family_attrbuf(&genl_family); -+ int ret = nlmsg_parse(cb->nlh, GENL_HDRLEN + genl_family.hdrsize, attrs, genl_family.maxattr, device_policy, NULL); -+ -+ if (ret < 0) -+ return ret; -+ cb->args[2] = (long)kzalloc(sizeof(struct allowedips_cursor), GFP_KERNEL); -+ if (!cb->args[2]) -+ return -ENOMEM; -+ wg = lookup_interface(attrs, cb->skb); -+ if (IS_ERR(wg)) { -+ kfree((void *)cb->args[2]); -+ cb->args[2] = 0; -+ return PTR_ERR(wg); -+ } -+ cb->args[0] = (long)wg; -+ return 0; -+} -+ -+static int get_device_dump(struct sk_buff *skb, struct netlink_callback *cb) -+{ -+ struct wireguard_device *wg = (struct wireguard_device *)cb->args[0]; -+ struct wireguard_peer *peer, *next_peer_cursor = NULL, *last_peer_cursor = (struct wireguard_peer *)cb->args[1]; -+ struct allowedips_cursor *rt_cursor = (struct allowedips_cursor *)cb->args[2]; -+ unsigned int peer_idx = 0; -+ struct nlattr *peers_nest; -+ bool done = true; -+ void *hdr; -+ int ret = -EMSGSIZE; -+ -+ rtnl_lock(); -+ mutex_lock(&wg->device_update_lock); -+ cb->seq = wg->device_update_gen; -+ -+ hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq, &genl_family, NLM_F_MULTI, WG_CMD_GET_DEVICE); -+ if (!hdr) -+ goto out; -+ genl_dump_check_consistent(cb, hdr); -+ -+ if (!last_peer_cursor) { -+ if (nla_put_u16(skb, WGDEVICE_A_LISTEN_PORT, wg->incoming_port) || nla_put_u32(skb, WGDEVICE_A_FWMARK, wg->fwmark) || nla_put_u32(skb, WGDEVICE_A_IFINDEX, wg->dev->ifindex) || nla_put_string(skb, WGDEVICE_A_IFNAME, wg->dev->name)) -+ goto out; -+ -+ down_read(&wg->static_identity.lock); -+ if (wg->static_identity.has_identity) { -+ if (nla_put(skb, WGDEVICE_A_PRIVATE_KEY, NOISE_PUBLIC_KEY_LEN, wg->static_identity.static_private) || nla_put(skb, WGDEVICE_A_PUBLIC_KEY, NOISE_PUBLIC_KEY_LEN, wg->static_identity.static_public)) { -+ up_read(&wg->static_identity.lock); -+ goto out; -+ } -+ } -+ up_read(&wg->static_identity.lock); -+ } -+ -+ peers_nest = nla_nest_start(skb, WGDEVICE_A_PEERS); -+ if (!peers_nest) -+ goto out; -+ ret = 0; -+ /* If the last cursor was removed via list_del_init in peer_remove, then we just treat -+ * this the same as there being no more peers left. The reason is that seq_nr should -+ * indicate to userspace that this isn't a coherent dump anyway, so they'll try again. -+ */ -+ if (list_empty(&wg->peer_list) || (last_peer_cursor && list_empty(&last_peer_cursor->peer_list))) { -+ nla_nest_cancel(skb, peers_nest); -+ goto out; -+ } -+ lockdep_assert_held(&wg->device_update_lock); -+ peer = list_prepare_entry(last_peer_cursor, &wg->peer_list, peer_list); -+ list_for_each_entry_continue(peer, &wg->peer_list, peer_list) { -+ if (get_peer(peer, peer_idx++, rt_cursor, skb)) { -+ done = false; -+ break; -+ } -+ next_peer_cursor = peer; -+ } -+ nla_nest_end(skb, peers_nest); -+ -+out: -+ peer_put(last_peer_cursor); -+ if (!ret && !done) -+ next_peer_cursor = peer_rcu_get(next_peer_cursor); -+ mutex_unlock(&wg->device_update_lock); -+ rtnl_unlock(); -+ -+ if (ret) { -+ genlmsg_cancel(skb, hdr); -+ return ret; -+ } -+ genlmsg_end(skb, hdr); -+ if (done) { -+ cb->args[1] = 0; -+ return 0; -+ } -+ cb->args[1] = (long)next_peer_cursor; -+ return skb->len; -+ -+ /* At this point, we can't really deal ourselves with safely zeroing out -+ * the private key material after usage. This will need an additional API -+ * in the kernel for marking skbs as zero_on_free. -+ */ -+} -+ -+static int get_device_done(struct netlink_callback *cb) -+{ -+ struct wireguard_device *wg = (struct wireguard_device *)cb->args[0]; -+ struct wireguard_peer *peer = (struct wireguard_peer *)cb->args[1]; -+ struct allowedips_cursor *rt_cursor = (struct allowedips_cursor *)cb->args[2]; -+ -+ if (wg) -+ dev_put(wg->dev); -+ kfree(rt_cursor); -+ peer_put(peer); -+ return 0; -+} -+ -+static int set_port(struct wireguard_device *wg, u16 port) -+{ -+ struct wireguard_peer *peer; -+ -+ if (wg->incoming_port == port) -+ return 0; -+ list_for_each_entry(peer, &wg->peer_list, peer_list) -+ socket_clear_peer_endpoint_src(peer); -+ if (!netif_running(wg->dev)) { -+ wg->incoming_port = port; -+ return 0; -+ } -+ return socket_init(wg, port); -+} -+ -+static int set_allowedip(struct wireguard_peer *peer, struct nlattr **attrs) -+{ -+ int ret = -EINVAL; -+ u16 family; -+ u8 cidr; -+ -+ if (!attrs[WGALLOWEDIP_A_FAMILY] || !attrs[WGALLOWEDIP_A_IPADDR] || !attrs[WGALLOWEDIP_A_CIDR_MASK]) -+ return ret; -+ family = nla_get_u16(attrs[WGALLOWEDIP_A_FAMILY]); -+ cidr = nla_get_u8(attrs[WGALLOWEDIP_A_CIDR_MASK]); -+ -+ if (family == AF_INET && cidr <= 32 && nla_len(attrs[WGALLOWEDIP_A_IPADDR]) == sizeof(struct in_addr)) -+ ret = allowedips_insert_v4(&peer->device->peer_allowedips, nla_data(attrs[WGALLOWEDIP_A_IPADDR]), cidr, peer, &peer->device->device_update_lock); -+ else if (family == AF_INET6 && cidr <= 128 && nla_len(attrs[WGALLOWEDIP_A_IPADDR]) == sizeof(struct in6_addr)) -+ ret = allowedips_insert_v6(&peer->device->peer_allowedips, nla_data(attrs[WGALLOWEDIP_A_IPADDR]), cidr, peer, &peer->device->device_update_lock); -+ -+ return ret; -+} -+ -+static int set_peer(struct wireguard_device *wg, struct nlattr **attrs) -+{ -+ int ret; -+ u32 flags = 0; -+ struct wireguard_peer *peer = NULL; -+ u8 *public_key = NULL, *preshared_key = NULL; -+ -+ ret = -EINVAL; -+ if (attrs[WGPEER_A_PUBLIC_KEY] && nla_len(attrs[WGPEER_A_PUBLIC_KEY]) == NOISE_PUBLIC_KEY_LEN) -+ public_key = nla_data(attrs[WGPEER_A_PUBLIC_KEY]); -+ else -+ goto out; -+ if (attrs[WGPEER_A_PRESHARED_KEY] && nla_len(attrs[WGPEER_A_PRESHARED_KEY]) == NOISE_SYMMETRIC_KEY_LEN) -+ preshared_key = nla_data(attrs[WGPEER_A_PRESHARED_KEY]); -+ if (attrs[WGPEER_A_FLAGS]) -+ flags = nla_get_u32(attrs[WGPEER_A_FLAGS]); -+ -+ peer = pubkey_hashtable_lookup(&wg->peer_hashtable, nla_data(attrs[WGPEER_A_PUBLIC_KEY])); -+ if (!peer) { /* Peer doesn't exist yet. Add a new one. */ -+ ret = -ENODEV; -+ if (flags & WGPEER_F_REMOVE_ME) -+ goto out; /* Tried to remove a non-existing peer. */ -+ -+ down_read(&wg->static_identity.lock); -+ if (wg->static_identity.has_identity && !memcmp(nla_data(attrs[WGPEER_A_PUBLIC_KEY]), wg->static_identity.static_public, NOISE_PUBLIC_KEY_LEN)) { -+ /* We silently ignore peers that have the same public key as the device. The reason we do it silently -+ * is that we'd like for people to be able to reuse the same set of API calls across peers. -+ */ -+ up_read(&wg->static_identity.lock); -+ ret = 0; -+ goto out; -+ } -+ up_read(&wg->static_identity.lock); -+ -+ ret = -ENOMEM; -+ peer = peer_rcu_get(peer_create(wg, public_key, preshared_key)); -+ if (!peer) -+ goto out; -+ } -+ -+ ret = 0; -+ if (flags & WGPEER_F_REMOVE_ME) { -+ peer_remove(peer); -+ goto out; -+ } -+ -+ if (preshared_key) { -+ down_write(&peer->handshake.lock); -+ memcpy(&peer->handshake.preshared_key, preshared_key, NOISE_SYMMETRIC_KEY_LEN); -+ up_write(&peer->handshake.lock); -+ } -+ -+ if (attrs[WGPEER_A_ENDPOINT]) { -+ struct sockaddr *addr = nla_data(attrs[WGPEER_A_ENDPOINT]); -+ size_t len = nla_len(attrs[WGPEER_A_ENDPOINT]); -+ -+ if ((len == sizeof(struct sockaddr_in) && addr->sa_family == AF_INET) || (len == sizeof(struct sockaddr_in6) && addr->sa_family == AF_INET6)) { -+ struct endpoint endpoint = { { { 0 } } }; -+ -+ memcpy(&endpoint.addr, addr, len); -+ socket_set_peer_endpoint(peer, &endpoint); -+ } -+ } -+ -+ if (flags & WGPEER_F_REPLACE_ALLOWEDIPS) -+ allowedips_remove_by_peer(&wg->peer_allowedips, peer, &wg->device_update_lock); -+ -+ if (attrs[WGPEER_A_ALLOWEDIPS]) { -+ int rem; -+ struct nlattr *attr, *allowedip[WGALLOWEDIP_A_MAX + 1]; -+ -+ nla_for_each_nested(attr, attrs[WGPEER_A_ALLOWEDIPS], rem) { -+ ret = nla_parse_nested(allowedip, WGALLOWEDIP_A_MAX, attr, allowedip_policy, NULL); -+ if (ret < 0) -+ goto out; -+ ret = set_allowedip(peer, allowedip); -+ if (ret < 0) -+ goto out; -+ } -+ } -+ -+ if (attrs[WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL]) { -+ const u16 persistent_keepalive_interval = nla_get_u16(attrs[WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL]); -+ const bool send_keepalive = !peer->persistent_keepalive_interval && persistent_keepalive_interval && netif_running(wg->dev); -+ -+ peer->persistent_keepalive_interval = (unsigned long)persistent_keepalive_interval * HZ; -+ if (send_keepalive) -+ packet_send_keepalive(peer); -+ } -+ -+ if (netif_running(wg->dev)) -+ packet_send_staged_packets(peer); -+ -+out: -+ peer_put(peer); -+ if (attrs[WGPEER_A_PRESHARED_KEY]) -+ memzero_explicit(nla_data(attrs[WGPEER_A_PRESHARED_KEY]), nla_len(attrs[WGPEER_A_PRESHARED_KEY])); -+ return ret; -+} -+ -+static int set_device(struct sk_buff *skb, struct genl_info *info) -+{ -+ int ret; -+ struct wireguard_device *wg = lookup_interface(info->attrs, skb); -+ -+ if (IS_ERR(wg)) { -+ ret = PTR_ERR(wg); -+ goto out_nodev; -+ } -+ -+ rtnl_lock(); -+ mutex_lock(&wg->device_update_lock); -+ ++wg->device_update_gen; -+ -+ if (info->attrs[WGDEVICE_A_FWMARK]) { -+ struct wireguard_peer *peer; -+ -+ wg->fwmark = nla_get_u32(info->attrs[WGDEVICE_A_FWMARK]); -+ list_for_each_entry(peer, &wg->peer_list, peer_list) -+ socket_clear_peer_endpoint_src(peer); -+ } -+ -+ if (info->attrs[WGDEVICE_A_LISTEN_PORT]) { -+ ret = set_port(wg, nla_get_u16(info->attrs[WGDEVICE_A_LISTEN_PORT])); -+ if (ret) -+ goto out; -+ } -+ -+ if (info->attrs[WGDEVICE_A_FLAGS] && nla_get_u32(info->attrs[WGDEVICE_A_FLAGS]) & WGDEVICE_F_REPLACE_PEERS) -+ peer_remove_all(wg); -+ -+ if (info->attrs[WGDEVICE_A_PRIVATE_KEY] && nla_len(info->attrs[WGDEVICE_A_PRIVATE_KEY]) == NOISE_PUBLIC_KEY_LEN) { -+ struct wireguard_peer *peer, *temp; -+ u8 public_key[NOISE_PUBLIC_KEY_LEN], *private_key = nla_data(info->attrs[WGDEVICE_A_PRIVATE_KEY]); -+ -+ /* We remove before setting, to prevent race, which means doing two 25519-genpub ops. */ -+ if (curve25519_generate_public(public_key, private_key)) { -+ peer = pubkey_hashtable_lookup(&wg->peer_hashtable, public_key); -+ if (peer) { -+ peer_put(peer); -+ peer_remove(peer); -+ } -+ } -+ -+ noise_set_static_identity_private_key(&wg->static_identity, private_key); -+ list_for_each_entry_safe(peer, temp, &wg->peer_list, peer_list) { -+ if (!noise_precompute_static_static(peer)) -+ peer_remove(peer); -+ } -+ cookie_checker_precompute_device_keys(&wg->cookie_checker); -+ } -+ -+ if (info->attrs[WGDEVICE_A_PEERS]) { -+ int rem; -+ struct nlattr *attr, *peer[WGPEER_A_MAX + 1]; -+ -+ nla_for_each_nested(attr, info->attrs[WGDEVICE_A_PEERS], rem) { -+ ret = nla_parse_nested(peer, WGPEER_A_MAX, attr, peer_policy, NULL); -+ if (ret < 0) -+ goto out; -+ ret = set_peer(wg, peer); -+ if (ret < 0) -+ goto out; -+ } -+ } -+ ret = 0; -+ -+out: -+ mutex_unlock(&wg->device_update_lock); -+ rtnl_unlock(); -+ dev_put(wg->dev); -+out_nodev: -+ if (info->attrs[WGDEVICE_A_PRIVATE_KEY]) -+ memzero_explicit(nla_data(info->attrs[WGDEVICE_A_PRIVATE_KEY]), nla_len(info->attrs[WGDEVICE_A_PRIVATE_KEY])); -+ return ret; -+} -+ -+#ifndef COMPAT_CANNOT_USE_CONST_GENL_OPS -+static const -+#else -+static -+#endif -+struct genl_ops genl_ops[] = { -+ { -+ .cmd = WG_CMD_GET_DEVICE, -+#ifndef COMPAT_CANNOT_USE_NETLINK_START -+ .start = get_device_start, -+#endif -+ .dumpit = get_device_dump, -+ .done = get_device_done, -+ .policy = device_policy, -+ .flags = GENL_UNS_ADMIN_PERM -+ }, { -+ .cmd = WG_CMD_SET_DEVICE, -+ .doit = set_device, -+ .policy = device_policy, -+ .flags = GENL_UNS_ADMIN_PERM -+ } -+}; -+ -+static struct genl_family genl_family -+#ifndef COMPAT_CANNOT_USE_GENL_NOPS -+__ro_after_init = { -+ .ops = genl_ops, -+ .n_ops = ARRAY_SIZE(genl_ops), -+#else -+= { -+#endif -+ .name = WG_GENL_NAME, -+ .version = WG_GENL_VERSION, -+ .maxattr = WGDEVICE_A_MAX, -+ .module = THIS_MODULE, -+ .netnsok = true -+}; -+ -+int __init genetlink_init(void) -+{ -+ return genl_register_family(&genl_family); -+} -+ -+void __exit genetlink_uninit(void) -+{ -+ genl_unregister_family(&genl_family); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/noise.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,635 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "noise.h" -+#include "device.h" -+#include "peer.h" -+#include "messages.h" -+#include "queueing.h" -+#include "hashtables.h" -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+/* This implements Noise_IKpsk2: -+ * -+ * <- s -+ * ****** -+ * -> e, es, s, ss, {t} -+ * <- e, ee, se, psk, {} -+ */ -+ -+static const u8 handshake_name[37] = "Noise_IKpsk2_25519_ChaChaPoly_BLAKE2s"; -+static const u8 identifier_name[34] = "WireGuard v1 zx2c4 Jason@zx2c4.com"; -+static u8 handshake_init_hash[NOISE_HASH_LEN] __ro_after_init; -+static u8 handshake_init_chaining_key[NOISE_HASH_LEN] __ro_after_init; -+static atomic64_t keypair_counter = ATOMIC64_INIT(0); -+ -+void __init noise_init(void) -+{ -+ struct blake2s_state blake; -+ -+ blake2s(handshake_init_chaining_key, handshake_name, NULL, NOISE_HASH_LEN, sizeof(handshake_name), 0); -+ blake2s_init(&blake, NOISE_HASH_LEN); -+ blake2s_update(&blake, handshake_init_chaining_key, NOISE_HASH_LEN); -+ blake2s_update(&blake, identifier_name, sizeof(identifier_name)); -+ blake2s_final(&blake, handshake_init_hash, NOISE_HASH_LEN); -+} -+ -+bool noise_precompute_static_static(struct wireguard_peer *peer) -+{ -+ if (peer->handshake.static_identity->has_identity) -+ return curve25519(peer->handshake.precomputed_static_static, peer->handshake.static_identity->static_private, peer->handshake.remote_static); -+ memset(peer->handshake.precomputed_static_static, 0, NOISE_PUBLIC_KEY_LEN); -+ return true; -+} -+ -+bool noise_handshake_init(struct noise_handshake *handshake, struct noise_static_identity *static_identity, const u8 peer_public_key[NOISE_PUBLIC_KEY_LEN], const u8 peer_preshared_key[NOISE_SYMMETRIC_KEY_LEN], struct wireguard_peer *peer) -+{ -+ memset(handshake, 0, sizeof(struct noise_handshake)); -+ init_rwsem(&handshake->lock); -+ handshake->entry.type = INDEX_HASHTABLE_HANDSHAKE; -+ handshake->entry.peer = peer; -+ memcpy(handshake->remote_static, peer_public_key, NOISE_PUBLIC_KEY_LEN); -+ if (peer_preshared_key) -+ memcpy(handshake->preshared_key, peer_preshared_key, NOISE_SYMMETRIC_KEY_LEN); -+ handshake->static_identity = static_identity; -+ handshake->state = HANDSHAKE_ZEROED; -+ return noise_precompute_static_static(peer); -+} -+ -+static void handshake_zero(struct noise_handshake *handshake) -+{ -+ memset(&handshake->ephemeral_private, 0, NOISE_PUBLIC_KEY_LEN); -+ memset(&handshake->remote_ephemeral, 0, NOISE_PUBLIC_KEY_LEN); -+ memset(&handshake->hash, 0, NOISE_HASH_LEN); -+ memset(&handshake->chaining_key, 0, NOISE_HASH_LEN); -+ handshake->remote_index = 0; -+ handshake->state = HANDSHAKE_ZEROED; -+} -+ -+void noise_handshake_clear(struct noise_handshake *handshake) -+{ -+ index_hashtable_remove(&handshake->entry.peer->device->index_hashtable, &handshake->entry); -+ down_write(&handshake->lock); -+ handshake_zero(handshake); -+ up_write(&handshake->lock); -+ index_hashtable_remove(&handshake->entry.peer->device->index_hashtable, &handshake->entry); -+} -+ -+static struct noise_keypair *keypair_create(struct wireguard_peer *peer) -+{ -+ struct noise_keypair *keypair = kzalloc(sizeof(struct noise_keypair), GFP_KERNEL); -+ -+ if (unlikely(!keypair)) -+ return NULL; -+ keypair->internal_id = atomic64_inc_return(&keypair_counter); -+ keypair->entry.type = INDEX_HASHTABLE_KEYPAIR; -+ keypair->entry.peer = peer; -+ kref_init(&keypair->refcount); -+ return keypair; -+} -+ -+static void keypair_free_rcu(struct rcu_head *rcu) -+{ -+ struct noise_keypair *keypair = container_of(rcu, struct noise_keypair, rcu); -+ -+ net_dbg_ratelimited("%s: Keypair %llu destroyed for peer %llu\n", keypair->entry.peer->device->dev->name, keypair->internal_id, keypair->entry.peer->internal_id); -+ kzfree(keypair); -+} -+ -+static void keypair_free_kref(struct kref *kref) -+{ -+ struct noise_keypair *keypair = container_of(kref, struct noise_keypair, refcount); -+ -+ index_hashtable_remove(&keypair->entry.peer->device->index_hashtable, &keypair->entry); -+ call_rcu_bh(&keypair->rcu, keypair_free_rcu); -+} -+ -+void noise_keypair_put(struct noise_keypair *keypair) -+{ -+ if (unlikely(!keypair)) -+ return; -+ kref_put(&keypair->refcount, keypair_free_kref); -+} -+ -+struct noise_keypair *noise_keypair_get(struct noise_keypair *keypair) -+{ -+ RCU_LOCKDEP_WARN(!rcu_read_lock_bh_held(), "Taking noise keypair reference without holding the RCU BH read lock"); -+ if (unlikely(!keypair || !kref_get_unless_zero(&keypair->refcount))) -+ return NULL; -+ return keypair; -+} -+ -+void noise_keypairs_clear(struct noise_keypairs *keypairs) -+{ -+ struct noise_keypair *old; -+ -+ spin_lock_bh(&keypairs->keypair_update_lock); -+ old = rcu_dereference_protected(keypairs->previous_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); -+ rcu_assign_pointer(keypairs->previous_keypair, NULL); -+ noise_keypair_put(old); -+ old = rcu_dereference_protected(keypairs->next_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); -+ rcu_assign_pointer(keypairs->next_keypair, NULL); -+ noise_keypair_put(old); -+ old = rcu_dereference_protected(keypairs->current_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); -+ rcu_assign_pointer(keypairs->current_keypair, NULL); -+ noise_keypair_put(old); -+ spin_unlock_bh(&keypairs->keypair_update_lock); -+} -+ -+static void add_new_keypair(struct noise_keypairs *keypairs, struct noise_keypair *new_keypair) -+{ -+ struct noise_keypair *previous_keypair, *next_keypair, *current_keypair; -+ -+ spin_lock_bh(&keypairs->keypair_update_lock); -+ previous_keypair = rcu_dereference_protected(keypairs->previous_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); -+ next_keypair = rcu_dereference_protected(keypairs->next_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); -+ current_keypair = rcu_dereference_protected(keypairs->current_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); -+ if (new_keypair->i_am_the_initiator) { -+ /* If we're the initiator, it means we've sent a handshake, and received -+ * a confirmation response, which means this new keypair can now be used. -+ */ -+ if (next_keypair) { -+ /* If there already was a next keypair pending, we demote it to be -+ * the previous keypair, and free the existing current. -+ * TODO: note that this means KCI can result in this transition. It -+ * would perhaps be more sound to always just get rid of the unused -+ * next keypair instead of putting it in the previous slot, but this -+ * might be a bit less robust. Something to think about and decide on. -+ */ -+ rcu_assign_pointer(keypairs->next_keypair, NULL); -+ rcu_assign_pointer(keypairs->previous_keypair, next_keypair); -+ noise_keypair_put(current_keypair); -+ } else /* If there wasn't an existing next keypair, we replace the -+ * previous with the current one. -+ */ -+ rcu_assign_pointer(keypairs->previous_keypair, current_keypair); -+ /* At this point we can get rid of the old previous keypair, and set up -+ * the new keypair. -+ */ -+ noise_keypair_put(previous_keypair); -+ rcu_assign_pointer(keypairs->current_keypair, new_keypair); -+ } else { -+ /* If we're the responder, it means we can't use the new keypair until -+ * we receive confirmation via the first data packet, so we get rid of -+ * the existing previous one, the possibly existing next one, and slide -+ * in the new next one. -+ */ -+ rcu_assign_pointer(keypairs->next_keypair, new_keypair); -+ noise_keypair_put(next_keypair); -+ rcu_assign_pointer(keypairs->previous_keypair, NULL); -+ noise_keypair_put(previous_keypair); -+ } -+ spin_unlock_bh(&keypairs->keypair_update_lock); -+} -+ -+bool noise_received_with_keypair(struct noise_keypairs *keypairs, struct noise_keypair *received_keypair) -+{ -+ bool key_is_new; -+ struct noise_keypair *old_keypair; -+ -+ /* We first check without taking the spinlock. */ -+ key_is_new = received_keypair == rcu_access_pointer(keypairs->next_keypair); -+ if (likely(!key_is_new)) -+ return false; -+ -+ spin_lock_bh(&keypairs->keypair_update_lock); -+ /* After locking, we double check that things didn't change from beneath us. */ -+ if (unlikely(received_keypair != rcu_dereference_protected(keypairs->next_keypair, lockdep_is_held(&keypairs->keypair_update_lock)))) { -+ spin_unlock_bh(&keypairs->keypair_update_lock); -+ return false; -+ } -+ -+ /* When we've finally received the confirmation, we slide the next -+ * into the current, the current into the previous, and get rid of -+ * the old previous. -+ */ -+ old_keypair = rcu_dereference_protected(keypairs->previous_keypair, lockdep_is_held(&keypairs->keypair_update_lock)); -+ rcu_assign_pointer(keypairs->previous_keypair, rcu_dereference_protected(keypairs->current_keypair, lockdep_is_held(&keypairs->keypair_update_lock))); -+ noise_keypair_put(old_keypair); -+ rcu_assign_pointer(keypairs->current_keypair, received_keypair); -+ rcu_assign_pointer(keypairs->next_keypair, NULL); -+ -+ spin_unlock_bh(&keypairs->keypair_update_lock); -+ return true; -+} -+ -+void noise_set_static_identity_private_key(struct noise_static_identity *static_identity, const u8 private_key[NOISE_PUBLIC_KEY_LEN]) -+{ -+ down_write(&static_identity->lock); -+ memcpy(static_identity->static_private, private_key, NOISE_PUBLIC_KEY_LEN); -+ static_identity->has_identity = curve25519_generate_public(static_identity->static_public, private_key); -+ up_write(&static_identity->lock); -+} -+ -+/* This is Hugo Krawczyk's HKDF: -+ * - https://eprint.iacr.org/2010/264.pdf -+ * - https://tools.ietf.org/html/rfc5869 -+ */ -+static void kdf(u8 *first_dst, u8 *second_dst, u8 *third_dst, const u8 *data, size_t first_len, size_t second_len, size_t third_len, size_t data_len, const u8 chaining_key[NOISE_HASH_LEN]) -+{ -+ u8 secret[BLAKE2S_OUTBYTES]; -+ u8 output[BLAKE2S_OUTBYTES + 1]; -+ -+#ifdef DEBUG -+ BUG_ON(first_len > BLAKE2S_OUTBYTES || second_len > BLAKE2S_OUTBYTES || third_len > BLAKE2S_OUTBYTES || ((second_len || second_dst || third_len || third_dst) && (!first_len || !first_dst)) || ((third_len || third_dst) && (!second_len || !second_dst))); -+#endif -+ -+ /* Extract entropy from data into secret */ -+ blake2s_hmac(secret, data, chaining_key, BLAKE2S_OUTBYTES, data_len, NOISE_HASH_LEN); -+ -+ if (!first_dst || !first_len) -+ goto out; -+ -+ /* Expand first key: key = secret, data = 0x1 */ -+ output[0] = 1; -+ blake2s_hmac(output, output, secret, BLAKE2S_OUTBYTES, 1, BLAKE2S_OUTBYTES); -+ memcpy(first_dst, output, first_len); -+ -+ if (!second_dst || !second_len) -+ goto out; -+ -+ /* Expand second key: key = secret, data = first-key || 0x2 */ -+ output[BLAKE2S_OUTBYTES] = 2; -+ blake2s_hmac(output, output, secret, BLAKE2S_OUTBYTES, BLAKE2S_OUTBYTES + 1, BLAKE2S_OUTBYTES); -+ memcpy(second_dst, output, second_len); -+ -+ if (!third_dst || !third_len) -+ goto out; -+ -+ /* Expand third key: key = secret, data = second-key || 0x3 */ -+ output[BLAKE2S_OUTBYTES] = 3; -+ blake2s_hmac(output, output, secret, BLAKE2S_OUTBYTES, BLAKE2S_OUTBYTES + 1, BLAKE2S_OUTBYTES); -+ memcpy(third_dst, output, third_len); -+ -+out: -+ /* Clear sensitive data from stack */ -+ memzero_explicit(secret, BLAKE2S_OUTBYTES); -+ memzero_explicit(output, BLAKE2S_OUTBYTES + 1); -+} -+ -+static void symmetric_key_init(struct noise_symmetric_key *key) -+{ -+ spin_lock_init(&key->counter.receive.lock); -+ atomic64_set(&key->counter.counter, 0); -+ memset(key->counter.receive.backtrack, 0, sizeof(key->counter.receive.backtrack)); -+ key->birthdate = get_jiffies_64(); -+ key->is_valid = true; -+} -+ -+static void derive_keys(struct noise_symmetric_key *first_dst, struct noise_symmetric_key *second_dst, const u8 chaining_key[NOISE_HASH_LEN]) -+{ -+ kdf(first_dst->key, second_dst->key, NULL, NULL, NOISE_SYMMETRIC_KEY_LEN, NOISE_SYMMETRIC_KEY_LEN, 0, 0, chaining_key); -+ symmetric_key_init(first_dst); -+ symmetric_key_init(second_dst); -+} -+ -+static bool __must_check mix_dh(u8 chaining_key[NOISE_HASH_LEN], u8 key[NOISE_SYMMETRIC_KEY_LEN], const u8 private[NOISE_PUBLIC_KEY_LEN], const u8 public[NOISE_PUBLIC_KEY_LEN]) -+{ -+ u8 dh_calculation[NOISE_PUBLIC_KEY_LEN]; -+ -+ if (unlikely(!curve25519(dh_calculation, private, public))) -+ return false; -+ kdf(chaining_key, key, NULL, dh_calculation, NOISE_HASH_LEN, NOISE_SYMMETRIC_KEY_LEN, 0, NOISE_PUBLIC_KEY_LEN, chaining_key); -+ memzero_explicit(dh_calculation, NOISE_PUBLIC_KEY_LEN); -+ return true; -+} -+ -+static void mix_hash(u8 hash[NOISE_HASH_LEN], const u8 *src, size_t src_len) -+{ -+ struct blake2s_state blake; -+ -+ blake2s_init(&blake, NOISE_HASH_LEN); -+ blake2s_update(&blake, hash, NOISE_HASH_LEN); -+ blake2s_update(&blake, src, src_len); -+ blake2s_final(&blake, hash, NOISE_HASH_LEN); -+} -+ -+static void mix_psk(u8 chaining_key[NOISE_HASH_LEN], u8 hash[NOISE_HASH_LEN], u8 key[NOISE_SYMMETRIC_KEY_LEN], const u8 psk[NOISE_SYMMETRIC_KEY_LEN]) -+{ -+ u8 temp_hash[NOISE_HASH_LEN]; -+ -+ kdf(chaining_key, temp_hash, key, psk, NOISE_HASH_LEN, NOISE_HASH_LEN, NOISE_SYMMETRIC_KEY_LEN, NOISE_SYMMETRIC_KEY_LEN, chaining_key); -+ mix_hash(hash, temp_hash, NOISE_HASH_LEN); -+ memzero_explicit(temp_hash, NOISE_HASH_LEN); -+} -+ -+static void handshake_init(u8 chaining_key[NOISE_HASH_LEN], u8 hash[NOISE_HASH_LEN], const u8 remote_static[NOISE_PUBLIC_KEY_LEN]) -+{ -+ memcpy(hash, handshake_init_hash, NOISE_HASH_LEN); -+ memcpy(chaining_key, handshake_init_chaining_key, NOISE_HASH_LEN); -+ mix_hash(hash, remote_static, NOISE_PUBLIC_KEY_LEN); -+} -+ -+static void message_encrypt(u8 *dst_ciphertext, const u8 *src_plaintext, size_t src_len, u8 key[NOISE_SYMMETRIC_KEY_LEN], u8 hash[NOISE_HASH_LEN]) -+{ -+ chacha20poly1305_encrypt(dst_ciphertext, src_plaintext, src_len, hash, NOISE_HASH_LEN, 0 /* Always zero for Noise_IK */, key); -+ mix_hash(hash, dst_ciphertext, noise_encrypted_len(src_len)); -+} -+ -+static bool message_decrypt(u8 *dst_plaintext, const u8 *src_ciphertext, size_t src_len, u8 key[NOISE_SYMMETRIC_KEY_LEN], u8 hash[NOISE_HASH_LEN]) -+{ -+ if (!chacha20poly1305_decrypt(dst_plaintext, src_ciphertext, src_len, hash, NOISE_HASH_LEN, 0 /* Always zero for Noise_IK */, key)) -+ return false; -+ mix_hash(hash, src_ciphertext, src_len); -+ return true; -+} -+ -+static void message_ephemeral(u8 ephemeral_dst[NOISE_PUBLIC_KEY_LEN], const u8 ephemeral_src[NOISE_PUBLIC_KEY_LEN], u8 chaining_key[NOISE_HASH_LEN], u8 hash[NOISE_HASH_LEN]) -+{ -+ if (ephemeral_dst != ephemeral_src) -+ memcpy(ephemeral_dst, ephemeral_src, NOISE_PUBLIC_KEY_LEN); -+ mix_hash(hash, ephemeral_src, NOISE_PUBLIC_KEY_LEN); -+ kdf(chaining_key, NULL, NULL, ephemeral_src, NOISE_HASH_LEN, 0, 0, NOISE_PUBLIC_KEY_LEN, chaining_key); -+} -+ -+static void tai64n_now(u8 output[NOISE_TIMESTAMP_LEN]) -+{ -+ struct timespec64 now; -+ -+ getnstimeofday64(&now); -+ /* https://cr.yp.to/libtai/tai64.html */ -+ *(__be64 *)output = cpu_to_be64(4611686018427387914ULL + now.tv_sec); -+ *(__be32 *)(output + sizeof(__be64)) = cpu_to_be32(now.tv_nsec); -+} -+ -+bool noise_handshake_create_initiation(struct message_handshake_initiation *dst, struct noise_handshake *handshake) -+{ -+ u8 timestamp[NOISE_TIMESTAMP_LEN]; -+ u8 key[NOISE_SYMMETRIC_KEY_LEN]; -+ bool ret = false; -+ -+ down_read(&handshake->static_identity->lock); -+ down_write(&handshake->lock); -+ -+ if (unlikely(!handshake->static_identity->has_identity)) -+ goto out; -+ -+ dst->header.type = cpu_to_le32(MESSAGE_HANDSHAKE_INITIATION); -+ -+ handshake_init(handshake->chaining_key, handshake->hash, handshake->remote_static); -+ -+ /* e */ -+ curve25519_generate_secret(handshake->ephemeral_private); -+ if (!curve25519_generate_public(dst->unencrypted_ephemeral, handshake->ephemeral_private)) -+ goto out; -+ message_ephemeral(dst->unencrypted_ephemeral, dst->unencrypted_ephemeral, handshake->chaining_key, handshake->hash); -+ -+ /* es */ -+ if (!mix_dh(handshake->chaining_key, key, handshake->ephemeral_private, handshake->remote_static)) -+ goto out; -+ -+ /* s */ -+ message_encrypt(dst->encrypted_static, handshake->static_identity->static_public, NOISE_PUBLIC_KEY_LEN, key, handshake->hash); -+ -+ /* ss */ -+ kdf(handshake->chaining_key, key, NULL, handshake->precomputed_static_static, NOISE_HASH_LEN, NOISE_SYMMETRIC_KEY_LEN, 0, NOISE_PUBLIC_KEY_LEN, handshake->chaining_key); -+ -+ /* {t} */ -+ tai64n_now(timestamp); -+ message_encrypt(dst->encrypted_timestamp, timestamp, NOISE_TIMESTAMP_LEN, key, handshake->hash); -+ -+ dst->sender_index = index_hashtable_insert(&handshake->entry.peer->device->index_hashtable, &handshake->entry); -+ -+ handshake->state = HANDSHAKE_CREATED_INITIATION; -+ ret = true; -+ -+out: -+ up_write(&handshake->lock); -+ up_read(&handshake->static_identity->lock); -+ memzero_explicit(key, NOISE_SYMMETRIC_KEY_LEN); -+ return ret; -+} -+ -+struct wireguard_peer *noise_handshake_consume_initiation(struct message_handshake_initiation *src, struct wireguard_device *wg) -+{ -+ bool replay_attack, flood_attack; -+ u8 s[NOISE_PUBLIC_KEY_LEN]; -+ u8 e[NOISE_PUBLIC_KEY_LEN]; -+ u8 t[NOISE_TIMESTAMP_LEN]; -+ struct noise_handshake *handshake; -+ struct wireguard_peer *wg_peer = NULL; -+ u8 key[NOISE_SYMMETRIC_KEY_LEN]; -+ u8 hash[NOISE_HASH_LEN]; -+ u8 chaining_key[NOISE_HASH_LEN]; -+ -+ down_read(&wg->static_identity.lock); -+ if (unlikely(!wg->static_identity.has_identity)) -+ goto out; -+ -+ handshake_init(chaining_key, hash, wg->static_identity.static_public); -+ -+ /* e */ -+ message_ephemeral(e, src->unencrypted_ephemeral, chaining_key, hash); -+ -+ /* es */ -+ if (!mix_dh(chaining_key, key, wg->static_identity.static_private, e)) -+ goto out; -+ -+ /* s */ -+ if (!message_decrypt(s, src->encrypted_static, sizeof(src->encrypted_static), key, hash)) -+ goto out; -+ -+ /* Lookup which peer we're actually talking to */ -+ wg_peer = pubkey_hashtable_lookup(&wg->peer_hashtable, s); -+ if (!wg_peer) -+ goto out; -+ handshake = &wg_peer->handshake; -+ -+ /* ss */ -+ kdf(chaining_key, key, NULL, handshake->precomputed_static_static, NOISE_HASH_LEN, NOISE_SYMMETRIC_KEY_LEN, 0, NOISE_PUBLIC_KEY_LEN, chaining_key); -+ -+ /* {t} */ -+ if (!message_decrypt(t, src->encrypted_timestamp, sizeof(src->encrypted_timestamp), key, hash)) -+ goto out; -+ -+ down_read(&handshake->lock); -+ replay_attack = memcmp(t, handshake->latest_timestamp, NOISE_TIMESTAMP_LEN) <= 0; -+ flood_attack = !time_is_before_jiffies64(handshake->last_initiation_consumption + INITIATIONS_PER_SECOND); -+ up_read(&handshake->lock); -+ if (replay_attack || flood_attack) { -+ peer_put(wg_peer); -+ wg_peer = NULL; -+ goto out; -+ } -+ -+ /* Success! Copy everything to peer */ -+ down_write(&handshake->lock); -+ memcpy(handshake->remote_ephemeral, e, NOISE_PUBLIC_KEY_LEN); -+ memcpy(handshake->latest_timestamp, t, NOISE_TIMESTAMP_LEN); -+ memcpy(handshake->hash, hash, NOISE_HASH_LEN); -+ memcpy(handshake->chaining_key, chaining_key, NOISE_HASH_LEN); -+ handshake->remote_index = src->sender_index; -+ handshake->last_initiation_consumption = get_jiffies_64(); -+ handshake->state = HANDSHAKE_CONSUMED_INITIATION; -+ up_write(&handshake->lock); -+ -+out: -+ memzero_explicit(key, NOISE_SYMMETRIC_KEY_LEN); -+ memzero_explicit(hash, NOISE_HASH_LEN); -+ memzero_explicit(chaining_key, NOISE_HASH_LEN); -+ up_read(&wg->static_identity.lock); -+ return wg_peer; -+} -+ -+bool noise_handshake_create_response(struct message_handshake_response *dst, struct noise_handshake *handshake) -+{ -+ bool ret = false; -+ u8 key[NOISE_SYMMETRIC_KEY_LEN]; -+ -+ down_read(&handshake->static_identity->lock); -+ down_write(&handshake->lock); -+ -+ if (handshake->state != HANDSHAKE_CONSUMED_INITIATION) -+ goto out; -+ -+ dst->header.type = cpu_to_le32(MESSAGE_HANDSHAKE_RESPONSE); -+ dst->receiver_index = handshake->remote_index; -+ -+ /* e */ -+ curve25519_generate_secret(handshake->ephemeral_private); -+ if (!curve25519_generate_public(dst->unencrypted_ephemeral, handshake->ephemeral_private)) -+ goto out; -+ message_ephemeral(dst->unencrypted_ephemeral, dst->unencrypted_ephemeral, handshake->chaining_key, handshake->hash); -+ -+ /* ee */ -+ if (!mix_dh(handshake->chaining_key, NULL, handshake->ephemeral_private, handshake->remote_ephemeral)) -+ goto out; -+ -+ /* se */ -+ if (!mix_dh(handshake->chaining_key, NULL, handshake->ephemeral_private, handshake->remote_static)) -+ goto out; -+ -+ /* psk */ -+ mix_psk(handshake->chaining_key, handshake->hash, key, handshake->preshared_key); -+ -+ /* {} */ -+ message_encrypt(dst->encrypted_nothing, NULL, 0, key, handshake->hash); -+ -+ dst->sender_index = index_hashtable_insert(&handshake->entry.peer->device->index_hashtable, &handshake->entry); -+ -+ handshake->state = HANDSHAKE_CREATED_RESPONSE; -+ ret = true; -+ -+out: -+ up_write(&handshake->lock); -+ up_read(&handshake->static_identity->lock); -+ memzero_explicit(key, NOISE_SYMMETRIC_KEY_LEN); -+ return ret; -+} -+ -+struct wireguard_peer *noise_handshake_consume_response(struct message_handshake_response *src, struct wireguard_device *wg) -+{ -+ struct noise_handshake *handshake; -+ struct wireguard_peer *ret_peer = NULL; -+ u8 key[NOISE_SYMMETRIC_KEY_LEN]; -+ u8 hash[NOISE_HASH_LEN]; -+ u8 chaining_key[NOISE_HASH_LEN]; -+ u8 e[NOISE_PUBLIC_KEY_LEN]; -+ u8 ephemeral_private[NOISE_PUBLIC_KEY_LEN]; -+ u8 static_private[NOISE_PUBLIC_KEY_LEN]; -+ enum noise_handshake_state state = HANDSHAKE_ZEROED; -+ -+ down_read(&wg->static_identity.lock); -+ -+ if (unlikely(!wg->static_identity.has_identity)) -+ goto out; -+ -+ handshake = (struct noise_handshake *)index_hashtable_lookup(&wg->index_hashtable, INDEX_HASHTABLE_HANDSHAKE, src->receiver_index); -+ if (unlikely(!handshake)) -+ goto out; -+ -+ down_read(&handshake->lock); -+ state = handshake->state; -+ memcpy(hash, handshake->hash, NOISE_HASH_LEN); -+ memcpy(chaining_key, handshake->chaining_key, NOISE_HASH_LEN); -+ memcpy(ephemeral_private, handshake->ephemeral_private, NOISE_PUBLIC_KEY_LEN); -+ up_read(&handshake->lock); -+ -+ if (state != HANDSHAKE_CREATED_INITIATION) -+ goto fail; -+ -+ /* e */ -+ message_ephemeral(e, src->unencrypted_ephemeral, chaining_key, hash); -+ -+ /* ee */ -+ if (!mix_dh(chaining_key, NULL, ephemeral_private, e)) -+ goto out; -+ -+ /* se */ -+ if (!mix_dh(chaining_key, NULL, wg->static_identity.static_private, e)) -+ goto out; -+ -+ /* psk */ -+ mix_psk(chaining_key, hash, key, handshake->preshared_key); -+ -+ /* {} */ -+ if (!message_decrypt(NULL, src->encrypted_nothing, sizeof(src->encrypted_nothing), key, hash)) -+ goto fail; -+ -+ /* Success! Copy everything to peer */ -+ down_write(&handshake->lock); -+ /* It's important to check that the state is still the same, while we have an exclusive lock */ -+ if (handshake->state != state) { -+ up_write(&handshake->lock); -+ goto fail; -+ } -+ memcpy(handshake->remote_ephemeral, e, NOISE_PUBLIC_KEY_LEN); -+ memcpy(handshake->hash, hash, NOISE_HASH_LEN); -+ memcpy(handshake->chaining_key, chaining_key, NOISE_HASH_LEN); -+ handshake->remote_index = src->sender_index; -+ handshake->state = HANDSHAKE_CONSUMED_RESPONSE; -+ up_write(&handshake->lock); -+ ret_peer = handshake->entry.peer; -+ goto out; -+ -+fail: -+ peer_put(handshake->entry.peer); -+out: -+ memzero_explicit(key, NOISE_SYMMETRIC_KEY_LEN); -+ memzero_explicit(hash, NOISE_HASH_LEN); -+ memzero_explicit(chaining_key, NOISE_HASH_LEN); -+ memzero_explicit(ephemeral_private, NOISE_PUBLIC_KEY_LEN); -+ memzero_explicit(static_private, NOISE_PUBLIC_KEY_LEN); -+ up_read(&wg->static_identity.lock); -+ return ret_peer; -+} -+ -+bool noise_handshake_begin_session(struct noise_handshake *handshake, struct noise_keypairs *keypairs) -+{ -+ struct noise_keypair *new_keypair; -+ -+ down_write(&handshake->lock); -+ if (handshake->state != HANDSHAKE_CREATED_RESPONSE && handshake->state != HANDSHAKE_CONSUMED_RESPONSE) -+ goto fail; -+ -+ new_keypair = keypair_create(handshake->entry.peer); -+ if (!new_keypair) -+ goto fail; -+ new_keypair->i_am_the_initiator = handshake->state == HANDSHAKE_CONSUMED_RESPONSE; -+ new_keypair->remote_index = handshake->remote_index; -+ -+ if (new_keypair->i_am_the_initiator) -+ derive_keys(&new_keypair->sending, &new_keypair->receiving, handshake->chaining_key); -+ else -+ derive_keys(&new_keypair->receiving, &new_keypair->sending, handshake->chaining_key); -+ -+ handshake_zero(handshake); -+ add_new_keypair(keypairs, new_keypair); -+ net_dbg_ratelimited("%s: Keypair %llu created for peer %llu\n", new_keypair->entry.peer->device->dev->name, new_keypair->internal_id, new_keypair->entry.peer->internal_id); -+ WARN_ON(!index_hashtable_replace(&handshake->entry.peer->device->index_hashtable, &handshake->entry, &new_keypair->entry)); -+ up_write(&handshake->lock); -+ -+ return true; -+ -+fail: -+ up_write(&handshake->lock); -+ return false; -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/peer.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,136 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "peer.h" -+#include "device.h" -+#include "queueing.h" -+#include "timers.h" -+#include "hashtables.h" -+#include "noise.h" -+ -+#include -+#include -+#include -+#include -+ -+static atomic64_t peer_counter = ATOMIC64_INIT(0); -+ -+struct wireguard_peer *peer_create(struct wireguard_device *wg, const u8 public_key[NOISE_PUBLIC_KEY_LEN], const u8 preshared_key[NOISE_SYMMETRIC_KEY_LEN]) -+{ -+ struct wireguard_peer *peer; -+ -+ lockdep_assert_held(&wg->device_update_lock); -+ -+ if (wg->num_peers >= MAX_PEERS_PER_DEVICE) -+ return NULL; -+ ++wg->num_peers; -+ -+ peer = kzalloc(sizeof(struct wireguard_peer), GFP_KERNEL); -+ if (!peer) -+ return NULL; -+ peer->device = wg; -+ -+ if (dst_cache_init(&peer->endpoint_cache, GFP_KERNEL)) { -+ kfree(peer); -+ return NULL; -+ } -+ -+ peer->internal_id = atomic64_inc_return(&peer_counter); -+ peer->serial_work_cpu = nr_cpumask_bits; -+ cookie_init(&peer->latest_cookie); -+ if (!noise_handshake_init(&peer->handshake, &wg->static_identity, public_key, preshared_key, peer)) { -+ kfree(peer); -+ return NULL; -+ } -+ timers_init(peer); -+ cookie_checker_precompute_peer_keys(peer); -+ spin_lock_init(&peer->keypairs.keypair_update_lock); -+ INIT_WORK(&peer->transmit_handshake_work, packet_handshake_send_worker); -+ rwlock_init(&peer->endpoint_lock); -+ kref_init(&peer->refcount); -+ packet_queue_init(&peer->tx_queue, packet_tx_worker, false, MAX_QUEUED_PACKETS); -+ packet_queue_init(&peer->rx_queue, packet_rx_worker, false, MAX_QUEUED_PACKETS); -+ skb_queue_head_init(&peer->staged_packet_queue); -+ list_add_tail(&peer->peer_list, &wg->peer_list); -+ pubkey_hashtable_add(&wg->peer_hashtable, peer); -+ peer->last_sent_handshake = get_jiffies_64() - REKEY_TIMEOUT - HZ; -+ pr_debug("%s: Peer %llu created\n", wg->dev->name, peer->internal_id); -+ return peer; -+} -+ -+struct wireguard_peer *peer_get(struct wireguard_peer *peer) -+{ -+ RCU_LOCKDEP_WARN(!rcu_read_lock_bh_held(), "Taking peer reference without holding the RCU read lock"); -+ if (unlikely(!peer || !kref_get_unless_zero(&peer->refcount))) -+ return NULL; -+ return peer; -+} -+ -+struct wireguard_peer *peer_rcu_get(struct wireguard_peer *peer) -+{ -+ rcu_read_lock_bh(); -+ peer = peer_get(peer); -+ rcu_read_unlock_bh(); -+ return peer; -+} -+ -+/* We have a separate "remove" function to get rid of the final reference because -+ * peer_list, clearing handshakes, and flushing all require mutexes which requires -+ * sleeping, which must only be done from certain contexts. -+ */ -+void peer_remove(struct wireguard_peer *peer) -+{ -+ if (unlikely(!peer)) -+ return; -+ lockdep_assert_held(&peer->device->device_update_lock); -+ allowedips_remove_by_peer(&peer->device->peer_allowedips, peer, &peer->device->device_update_lock); -+ pubkey_hashtable_remove(&peer->device->peer_hashtable, peer); -+ skb_queue_purge(&peer->staged_packet_queue); -+ noise_handshake_clear(&peer->handshake); -+ noise_keypairs_clear(&peer->keypairs); -+ list_del_init(&peer->peer_list); -+ timers_stop(peer); -+ flush_workqueue(peer->device->packet_crypt_wq); /* The first flush is for encrypt/decrypt step. */ -+ flush_workqueue(peer->device->packet_crypt_wq); /* The second flush is for send/receive step. */ -+ flush_workqueue(peer->device->handshake_send_wq); -+ --peer->device->num_peers; -+ peer_put(peer); -+} -+ -+static void rcu_release(struct rcu_head *rcu) -+{ -+ struct wireguard_peer *peer = container_of(rcu, struct wireguard_peer, rcu); -+ -+ pr_debug("%s: Peer %llu (%pISpfsc) destroyed\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr); -+ dst_cache_destroy(&peer->endpoint_cache); -+ packet_queue_free(&peer->rx_queue, false); -+ packet_queue_free(&peer->tx_queue, false); -+ kzfree(peer); -+} -+ -+static void kref_release(struct kref *refcount) -+{ -+ struct wireguard_peer *peer = container_of(refcount, struct wireguard_peer, refcount); -+ -+ index_hashtable_remove(&peer->device->index_hashtable, &peer->handshake.entry); -+ skb_queue_purge(&peer->staged_packet_queue); -+ call_rcu_bh(&peer->rcu, rcu_release); -+} -+ -+void peer_put(struct wireguard_peer *peer) -+{ -+ if (unlikely(!peer)) -+ return; -+ kref_put(&peer->refcount, kref_release); -+} -+ -+void peer_remove_all(struct wireguard_device *wg) -+{ -+ struct wireguard_peer *peer, *temp; -+ -+ lockdep_assert_held(&wg->device_update_lock); -+ list_for_each_entry_safe(peer, temp, &wg->peer_list, peer_list) -+ peer_remove(peer); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/queueing.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,46 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "queueing.h" -+ -+struct multicore_worker __percpu *packet_alloc_percpu_multicore_worker(work_func_t function, void *ptr) -+{ -+ int cpu; -+ struct multicore_worker __percpu *worker = alloc_percpu(struct multicore_worker); -+ -+ if (!worker) -+ return NULL; -+ -+ for_each_possible_cpu(cpu) { -+ per_cpu_ptr(worker, cpu)->ptr = ptr; -+ INIT_WORK(&per_cpu_ptr(worker, cpu)->work, function); -+ } -+ return worker; -+} -+ -+int packet_queue_init(struct crypt_queue *queue, work_func_t function, bool multicore, unsigned int len) -+{ -+ int ret; -+ -+ memset(queue, 0, sizeof(*queue)); -+ ret = ptr_ring_init(&queue->ring, len, GFP_KERNEL); -+ if (ret) -+ return ret; -+ if (multicore) { -+ queue->worker = packet_alloc_percpu_multicore_worker(function, queue); -+ if (!queue->worker) -+ return -ENOMEM; -+ } else -+ INIT_WORK(&queue->work, function); -+ return 0; -+} -+ -+void packet_queue_free(struct crypt_queue *queue, bool multicore) -+{ -+ if (multicore) -+ free_percpu(queue->worker); -+ WARN_ON(!ptr_ring_empty_bh(&queue->ring)); -+ ptr_ring_cleanup(&queue->ring, NULL); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/ratelimiter.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,199 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "ratelimiter.h" -+#include -+#include -+#include -+#include -+ -+static struct kmem_cache *entry_cache; -+static hsiphash_key_t key; -+static spinlock_t table_lock = __SPIN_LOCK_UNLOCKED("ratelimiter_table_lock"); -+static atomic64_t refcnt = ATOMIC64_INIT(0); -+static atomic_t total_entries = ATOMIC_INIT(0); -+static unsigned int max_entries, table_size; -+static void gc_entries(struct work_struct *); -+static DECLARE_DEFERRABLE_WORK(gc_work, gc_entries); -+static struct hlist_head *table_v4; -+#if IS_ENABLED(CONFIG_IPV6) -+static struct hlist_head *table_v6; -+#endif -+ -+struct ratelimiter_entry { -+ u64 last_time_ns, tokens; -+ __be64 ip; -+ void *net; -+ spinlock_t lock; -+ struct hlist_node hash; -+ struct rcu_head rcu; -+}; -+ -+enum { -+ PACKETS_PER_SECOND = 20, -+ PACKETS_BURSTABLE = 5, -+ PACKET_COST = NSEC_PER_SEC / PACKETS_PER_SECOND, -+ TOKEN_MAX = PACKET_COST * PACKETS_BURSTABLE -+}; -+ -+static void entry_free(struct rcu_head *rcu) -+{ -+ kmem_cache_free(entry_cache, container_of(rcu, struct ratelimiter_entry, rcu)); -+ atomic_dec(&total_entries); -+} -+ -+static void entry_uninit(struct ratelimiter_entry *entry) -+{ -+ hlist_del_rcu(&entry->hash); -+ call_rcu(&entry->rcu, entry_free); -+} -+ -+/* Calling this function with a NULL work uninits all entries. */ -+static void gc_entries(struct work_struct *work) -+{ -+ unsigned int i; -+ struct ratelimiter_entry *entry; -+ struct hlist_node *temp; -+ const u64 now = ktime_get_ns(); -+ -+ for (i = 0; i < table_size; ++i) { -+ spin_lock(&table_lock); -+ hlist_for_each_entry_safe(entry, temp, &table_v4[i], hash) { -+ if (unlikely(!work) || now - entry->last_time_ns > NSEC_PER_SEC) -+ entry_uninit(entry); -+ } -+#if IS_ENABLED(CONFIG_IPV6) -+ hlist_for_each_entry_safe(entry, temp, &table_v6[i], hash) { -+ if (unlikely(!work) || now - entry->last_time_ns > NSEC_PER_SEC) -+ entry_uninit(entry); -+ } -+#endif -+ spin_unlock(&table_lock); -+ if (likely(work)) -+ cond_resched(); -+ } -+ if (likely(work)) -+ queue_delayed_work(system_power_efficient_wq, &gc_work, HZ); -+} -+ -+bool ratelimiter_allow(struct sk_buff *skb, struct net *net) -+{ -+ struct ratelimiter_entry *entry; -+ struct hlist_head *bucket; -+ struct { __be64 ip; u32 net; } data = { .net = (unsigned long)net & 0xffffffff }; -+ -+ if (skb->protocol == htons(ETH_P_IP)) { -+ data.ip = (__force __be64)ip_hdr(skb)->saddr; -+ bucket = &table_v4[hsiphash(&data, sizeof(u32) * 3, &key) & (table_size - 1)]; -+ } -+#if IS_ENABLED(CONFIG_IPV6) -+ else if (skb->protocol == htons(ETH_P_IPV6)) { -+ memcpy(&data.ip, &ipv6_hdr(skb)->saddr, sizeof(__be64)); /* Only 64 bits */ -+ bucket = &table_v6[hsiphash(&data, sizeof(u32) * 3, &key) & (table_size - 1)]; -+ } -+#endif -+ else -+ return false; -+ rcu_read_lock(); -+ hlist_for_each_entry_rcu(entry, bucket, hash) { -+ if (entry->net == net && entry->ip == data.ip) { -+ u64 now, tokens; -+ bool ret; -+ /* Inspired by nft_limit.c, but this is actually a slightly different -+ * algorithm. Namely, we incorporate the burst as part of the maximum -+ * tokens, rather than as part of the rate. -+ */ -+ spin_lock(&entry->lock); -+ now = ktime_get_ns(); -+ tokens = min_t(u64, TOKEN_MAX, entry->tokens + now - entry->last_time_ns); -+ entry->last_time_ns = now; -+ ret = tokens >= PACKET_COST; -+ entry->tokens = ret ? tokens - PACKET_COST : tokens; -+ spin_unlock(&entry->lock); -+ rcu_read_unlock(); -+ return ret; -+ } -+ } -+ rcu_read_unlock(); -+ -+ if (atomic_inc_return(&total_entries) > max_entries) -+ goto err_oom; -+ -+ entry = kmem_cache_alloc(entry_cache, GFP_KERNEL); -+ if (!entry) -+ goto err_oom; -+ -+ entry->net = net; -+ entry->ip = data.ip; -+ INIT_HLIST_NODE(&entry->hash); -+ spin_lock_init(&entry->lock); -+ entry->last_time_ns = ktime_get_ns(); -+ entry->tokens = TOKEN_MAX - PACKET_COST; -+ spin_lock(&table_lock); -+ hlist_add_head_rcu(&entry->hash, bucket); -+ spin_unlock(&table_lock); -+ return true; -+ -+err_oom: -+ atomic_dec(&total_entries); -+ return false; -+} -+ -+int ratelimiter_init(void) -+{ -+ if (atomic64_inc_return(&refcnt) != 1) -+ return 0; -+ -+ entry_cache = KMEM_CACHE(ratelimiter_entry, 0); -+ if (!entry_cache) -+ goto err; -+ -+ /* xt_hashlimit.c uses a slightly different algorithm for ratelimiting, -+ * but what it shares in common is that it uses a massive hashtable. So, -+ * we borrow their wisdom about good table sizes on different systems -+ * dependent on RAM. This calculation here comes from there. -+ */ -+ table_size = (totalram_pages > (1U << 30) / PAGE_SIZE) ? 8192 : max_t(unsigned long, 16, roundup_pow_of_two((totalram_pages << PAGE_SHIFT) / (1U << 14) / sizeof(struct hlist_head))); -+ max_entries = table_size * 8; -+ -+ table_v4 = kvzalloc(table_size * sizeof(struct hlist_head), GFP_KERNEL); -+ if (!table_v4) -+ goto err_kmemcache; -+ -+#if IS_ENABLED(CONFIG_IPV6) -+ table_v6 = kvzalloc(table_size * sizeof(struct hlist_head), GFP_KERNEL); -+ if (!table_v6) { -+ kvfree(table_v4); -+ goto err_kmemcache; -+ } -+#endif -+ -+ queue_delayed_work(system_power_efficient_wq, &gc_work, HZ); -+ get_random_bytes(&key, sizeof(key)); -+ return 0; -+ -+err_kmemcache: -+ kmem_cache_destroy(entry_cache); -+err: -+ atomic64_dec(&refcnt); -+ return -ENOMEM; -+} -+ -+void ratelimiter_uninit(void) -+{ -+ if (atomic64_dec_return(&refcnt)) -+ return; -+ -+ cancel_delayed_work_sync(&gc_work); -+ gc_entries(NULL); -+ rcu_barrier(); -+ kvfree(table_v4); -+#if IS_ENABLED(CONFIG_IPV6) -+ kvfree(table_v6); -+#endif -+ kmem_cache_destroy(entry_cache); -+} -+ -+#include "selftest/ratelimiter.h" ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/receive.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,490 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "queueing.h" -+#include "device.h" -+#include "peer.h" -+#include "timers.h" -+#include "messages.h" -+#include "cookie.h" -+#include "socket.h" -+ -+#include -+#include -+#include -+#include -+ -+/* Must be called with bh disabled. */ -+static inline void rx_stats(struct wireguard_peer *peer, size_t len) -+{ -+ struct pcpu_sw_netstats *tstats = get_cpu_ptr(peer->device->dev->tstats); -+ -+ u64_stats_update_begin(&tstats->syncp); -+ ++tstats->rx_packets; -+ tstats->rx_bytes += len; -+ peer->rx_bytes += len; -+ u64_stats_update_end(&tstats->syncp); -+ put_cpu_ptr(tstats); -+} -+ -+#define SKB_TYPE_LE32(skb) (((struct message_header *)(skb)->data)->type) -+ -+static inline size_t validate_header_len(struct sk_buff *skb) -+{ -+ if (unlikely(skb->len < sizeof(struct message_header))) -+ return 0; -+ if (SKB_TYPE_LE32(skb) == cpu_to_le32(MESSAGE_DATA) && skb->len >= MESSAGE_MINIMUM_LENGTH) -+ return sizeof(struct message_data); -+ if (SKB_TYPE_LE32(skb) == cpu_to_le32(MESSAGE_HANDSHAKE_INITIATION) && skb->len == sizeof(struct message_handshake_initiation)) -+ return sizeof(struct message_handshake_initiation); -+ if (SKB_TYPE_LE32(skb) == cpu_to_le32(MESSAGE_HANDSHAKE_RESPONSE) && skb->len == sizeof(struct message_handshake_response)) -+ return sizeof(struct message_handshake_response); -+ if (SKB_TYPE_LE32(skb) == cpu_to_le32(MESSAGE_HANDSHAKE_COOKIE) && skb->len == sizeof(struct message_handshake_cookie)) -+ return sizeof(struct message_handshake_cookie); -+ return 0; -+} -+ -+static inline int skb_prepare_header(struct sk_buff *skb, struct wireguard_device *wg) -+{ -+ struct udphdr *udp; -+ size_t data_offset, data_len, header_len; -+ -+ if (unlikely(skb_examine_untrusted_ip_hdr(skb) != skb->protocol || skb_transport_header(skb) < skb->head || (skb_transport_header(skb) + sizeof(struct udphdr)) > skb_tail_pointer(skb))) -+ return -EINVAL; /* Bogus IP header */ -+ udp = udp_hdr(skb); -+ data_offset = (u8 *)udp - skb->data; -+ if (unlikely(data_offset > U16_MAX || data_offset + sizeof(struct udphdr) > skb->len)) -+ return -EINVAL; /* Packet has offset at impossible location or isn't big enough to have UDP fields*/ -+ data_len = ntohs(udp->len); -+ if (unlikely(data_len < sizeof(struct udphdr) || data_len > skb->len - data_offset)) -+ return -EINVAL; /* UDP packet is reporting too small of a size or lying about its size */ -+ data_len -= sizeof(struct udphdr); -+ data_offset = (u8 *)udp + sizeof(struct udphdr) - skb->data; -+ if (unlikely(!pskb_may_pull(skb, data_offset + sizeof(struct message_header)) || pskb_trim(skb, data_len + data_offset) < 0)) -+ return -EINVAL; -+ skb_pull(skb, data_offset); -+ if (unlikely(skb->len != data_len)) -+ return -EINVAL; /* Final len does not agree with calculated len */ -+ header_len = validate_header_len(skb); -+ if (unlikely(!header_len)) -+ return -EINVAL; -+ __skb_push(skb, data_offset); -+ if (unlikely(!pskb_may_pull(skb, data_offset + header_len))) -+ return -EINVAL; -+ __skb_pull(skb, data_offset); -+ return 0; -+} -+ -+static void receive_handshake_packet(struct wireguard_device *wg, struct sk_buff *skb) -+{ -+ static u64 last_under_load; /* Yes this is global, so that our load calculation applies to the whole system. */ -+ struct wireguard_peer *peer = NULL; -+ bool under_load; -+ enum cookie_mac_state mac_state; -+ bool packet_needs_cookie; -+ -+ if (SKB_TYPE_LE32(skb) == cpu_to_le32(MESSAGE_HANDSHAKE_COOKIE)) { -+ net_dbg_skb_ratelimited("%s: Receiving cookie response from %pISpfsc\n", wg->dev->name, skb); -+ cookie_message_consume((struct message_handshake_cookie *)skb->data, wg); -+ return; -+ } -+ -+ under_load = skb_queue_len(&wg->incoming_handshakes) >= MAX_QUEUED_INCOMING_HANDSHAKES / 8; -+ if (under_load) -+ last_under_load = get_jiffies_64(); -+ else if (last_under_load) -+ under_load = time_is_after_jiffies64(last_under_load + HZ); -+ mac_state = cookie_validate_packet(&wg->cookie_checker, skb, under_load); -+ if ((under_load && mac_state == VALID_MAC_WITH_COOKIE) || (!under_load && mac_state == VALID_MAC_BUT_NO_COOKIE)) -+ packet_needs_cookie = false; -+ else if (under_load && mac_state == VALID_MAC_BUT_NO_COOKIE) -+ packet_needs_cookie = true; -+ else { -+ net_dbg_skb_ratelimited("%s: Invalid MAC of handshake, dropping packet from %pISpfsc\n", wg->dev->name, skb); -+ return; -+ } -+ -+ switch (SKB_TYPE_LE32(skb)) { -+ case cpu_to_le32(MESSAGE_HANDSHAKE_INITIATION): { -+ struct message_handshake_initiation *message = (struct message_handshake_initiation *)skb->data; -+ -+ if (packet_needs_cookie) { -+ packet_send_handshake_cookie(wg, skb, message->sender_index); -+ return; -+ } -+ peer = noise_handshake_consume_initiation(message, wg); -+ if (unlikely(!peer)) { -+ net_dbg_skb_ratelimited("%s: Invalid handshake initiation from %pISpfsc\n", wg->dev->name, skb); -+ return; -+ } -+ socket_set_peer_endpoint_from_skb(peer, skb); -+ net_dbg_ratelimited("%s: Receiving handshake initiation from peer %llu (%pISpfsc)\n", wg->dev->name, peer->internal_id, &peer->endpoint.addr); -+ packet_send_handshake_response(peer); -+ break; -+ } -+ case cpu_to_le32(MESSAGE_HANDSHAKE_RESPONSE): { -+ struct message_handshake_response *message = (struct message_handshake_response *)skb->data; -+ -+ if (packet_needs_cookie) { -+ packet_send_handshake_cookie(wg, skb, message->sender_index); -+ return; -+ } -+ peer = noise_handshake_consume_response(message, wg); -+ if (unlikely(!peer)) { -+ net_dbg_skb_ratelimited("%s: Invalid handshake response from %pISpfsc\n", wg->dev->name, skb); -+ return; -+ } -+ socket_set_peer_endpoint_from_skb(peer, skb); -+ net_dbg_ratelimited("%s: Receiving handshake response from peer %llu (%pISpfsc)\n", wg->dev->name, peer->internal_id, &peer->endpoint.addr); -+ if (noise_handshake_begin_session(&peer->handshake, &peer->keypairs)) { -+ timers_session_derived(peer); -+ timers_handshake_complete(peer); -+ /* Calling this function will either send any existing packets in the queue -+ * and not send a keepalive, which is the best case, Or, if there's nothing -+ * in the queue, it will send a keepalive, in order to give immediate -+ * confirmation of the session. -+ */ -+ packet_send_keepalive(peer); -+ } -+ break; -+ } -+ } -+ -+ if (unlikely(!peer)) { -+ WARN(1, "Somehow a wrong type of packet wound up in the handshake queue!\n"); -+ return; -+ } -+ -+ local_bh_disable(); -+ rx_stats(peer, skb->len); -+ local_bh_enable(); -+ -+ timers_any_authenticated_packet_received(peer); -+ timers_any_authenticated_packet_traversal(peer); -+ peer_put(peer); -+} -+ -+void packet_handshake_receive_worker(struct work_struct *work) -+{ -+ struct wireguard_device *wg = container_of(work, struct multicore_worker, work)->ptr; -+ struct sk_buff *skb; -+ -+ while ((skb = skb_dequeue(&wg->incoming_handshakes)) != NULL) { -+ receive_handshake_packet(wg, skb); -+ dev_kfree_skb(skb); -+ cond_resched(); -+ } -+} -+ -+static inline void keep_key_fresh(struct wireguard_peer *peer) -+{ -+ struct noise_keypair *keypair; -+ bool send = false; -+ -+ if (peer->sent_lastminute_handshake) -+ return; -+ -+ rcu_read_lock_bh(); -+ keypair = rcu_dereference_bh(peer->keypairs.current_keypair); -+ if (likely(keypair && keypair->sending.is_valid) && keypair->i_am_the_initiator && -+ unlikely(time_is_before_eq_jiffies64(keypair->sending.birthdate + REJECT_AFTER_TIME - KEEPALIVE_TIMEOUT - REKEY_TIMEOUT))) -+ send = true; -+ rcu_read_unlock_bh(); -+ -+ if (send) { -+ peer->sent_lastminute_handshake = true; -+ packet_send_queued_handshake_initiation(peer, false); -+ } -+} -+ -+static inline bool skb_decrypt(struct sk_buff *skb, struct noise_symmetric_key *key, bool have_simd) -+{ -+ struct scatterlist sg[MAX_SKB_FRAGS * 2 + 1]; -+ struct sk_buff *trailer; -+ unsigned int offset; -+ int num_frags; -+ -+ if (unlikely(!key)) -+ return false; -+ -+ if (unlikely(!key->is_valid || time_is_before_eq_jiffies64(key->birthdate + REJECT_AFTER_TIME) || key->counter.receive.counter >= REJECT_AFTER_MESSAGES)) { -+ key->is_valid = false; -+ return false; -+ } -+ -+ PACKET_CB(skb)->nonce = le64_to_cpu(((struct message_data *)skb->data)->counter); -+ -+ /* We ensure that the network header is part of the packet before we -+ * call skb_cow_data, so that there's no chance that data is removed -+ * from the skb, so that later we can extract the original endpoint. -+ */ -+ offset = skb->data - skb_network_header(skb); -+ skb_push(skb, offset); -+ num_frags = skb_cow_data(skb, 0, &trailer); -+ offset += sizeof(struct message_data); -+ skb_pull(skb, offset); -+ if (unlikely(num_frags < 0 || num_frags > ARRAY_SIZE(sg))) -+ return false; -+ -+ sg_init_table(sg, num_frags); -+ if (skb_to_sgvec(skb, sg, 0, skb->len) <= 0) -+ return false; -+ -+ if (!chacha20poly1305_decrypt_sg(sg, sg, skb->len, NULL, 0, PACKET_CB(skb)->nonce, key->key, have_simd)) -+ return false; -+ -+ /* Another ugly situation of pushing and pulling the header so as to -+ * keep endpoint information intact. -+ */ -+ skb_push(skb, offset); -+ if (pskb_trim(skb, skb->len - noise_encrypted_len(0))) -+ return false; -+ skb_pull(skb, offset); -+ -+ return true; -+} -+ -+/* This is RFC6479, a replay detection bitmap algorithm that avoids bitshifts */ -+static inline bool counter_validate(union noise_counter *counter, u64 their_counter) -+{ -+ bool ret = false; -+ unsigned long index, index_current, top, i; -+ -+ spin_lock_bh(&counter->receive.lock); -+ -+ if (unlikely(counter->receive.counter >= REJECT_AFTER_MESSAGES + 1 || their_counter >= REJECT_AFTER_MESSAGES)) -+ goto out; -+ -+ ++their_counter; -+ -+ if (unlikely((COUNTER_WINDOW_SIZE + their_counter) < counter->receive.counter)) -+ goto out; -+ -+ index = their_counter >> ilog2(BITS_PER_LONG); -+ -+ if (likely(their_counter > counter->receive.counter)) { -+ index_current = counter->receive.counter >> ilog2(BITS_PER_LONG); -+ top = min_t(unsigned long, index - index_current, COUNTER_BITS_TOTAL / BITS_PER_LONG); -+ for (i = 1; i <= top; ++i) -+ counter->receive.backtrack[(i + index_current) & ((COUNTER_BITS_TOTAL / BITS_PER_LONG) - 1)] = 0; -+ counter->receive.counter = their_counter; -+ } -+ -+ index &= (COUNTER_BITS_TOTAL / BITS_PER_LONG) - 1; -+ ret = !test_and_set_bit(their_counter & (BITS_PER_LONG - 1), &counter->receive.backtrack[index]); -+ -+out: -+ spin_unlock_bh(&counter->receive.lock); -+ return ret; -+} -+#include "selftest/counter.h" -+ -+static void packet_consume_data_done(struct sk_buff *skb, struct endpoint *endpoint) -+{ -+ struct wireguard_peer *peer = PACKET_PEER(skb), *routed_peer; -+ struct net_device *dev = peer->device->dev; -+ unsigned int len, len_before_trim; -+ -+ socket_set_peer_endpoint(peer, endpoint); -+ -+ if (unlikely(noise_received_with_keypair(&peer->keypairs, PACKET_CB(skb)->keypair))) { -+ timers_handshake_complete(peer); -+ packet_send_staged_packets(peer); -+ } -+ -+ keep_key_fresh(peer); -+ -+ timers_any_authenticated_packet_received(peer); -+ timers_any_authenticated_packet_traversal(peer); -+ -+ /* A packet with length 0 is a keepalive packet */ -+ if (unlikely(!skb->len)) { -+ rx_stats(peer, message_data_len(0)); -+ net_dbg_ratelimited("%s: Receiving keepalive packet from peer %llu (%pISpfsc)\n", dev->name, peer->internal_id, &peer->endpoint.addr); -+ goto packet_processed; -+ } -+ -+ timers_data_received(peer); -+ -+ if (unlikely(skb_network_header(skb) < skb->head)) -+ goto dishonest_packet_size; -+ if (unlikely(!(pskb_network_may_pull(skb, sizeof(struct iphdr)) && (ip_hdr(skb)->version == 4 || (ip_hdr(skb)->version == 6 && pskb_network_may_pull(skb, sizeof(struct ipv6hdr))))))) -+ goto dishonest_packet_type; -+ -+ skb->dev = dev; -+ skb->ip_summed = CHECKSUM_UNNECESSARY; -+ skb->protocol = skb_examine_untrusted_ip_hdr(skb); -+ if (skb->protocol == htons(ETH_P_IP)) { -+ len = ntohs(ip_hdr(skb)->tot_len); -+ if (unlikely(len < sizeof(struct iphdr))) -+ goto dishonest_packet_size; -+ if (INET_ECN_is_ce(PACKET_CB(skb)->ds)) -+ IP_ECN_set_ce(ip_hdr(skb)); -+ } else if (skb->protocol == htons(ETH_P_IPV6)) { -+ len = ntohs(ipv6_hdr(skb)->payload_len) + sizeof(struct ipv6hdr); -+ if (INET_ECN_is_ce(PACKET_CB(skb)->ds)) -+ IP6_ECN_set_ce(skb, ipv6_hdr(skb)); -+ } else -+ goto dishonest_packet_type; -+ -+ if (unlikely(len > skb->len)) -+ goto dishonest_packet_size; -+ len_before_trim = skb->len; -+ if (unlikely(pskb_trim(skb, len))) -+ goto packet_processed; -+ -+ routed_peer = allowedips_lookup_src(&peer->device->peer_allowedips, skb); -+ peer_put(routed_peer); /* We don't need the extra reference. */ -+ -+ if (unlikely(routed_peer != peer)) -+ goto dishonest_packet_peer; -+ -+ if (unlikely(netif_receive_skb(skb) == NET_RX_DROP)) { -+ ++dev->stats.rx_dropped; -+ net_dbg_ratelimited("%s: Failed to give packet to userspace from peer %llu (%pISpfsc)\n", dev->name, peer->internal_id, &peer->endpoint.addr); -+ } else -+ rx_stats(peer, message_data_len(len_before_trim)); -+ return; -+ -+dishonest_packet_peer: -+ net_dbg_skb_ratelimited("%s: Packet has unallowed src IP (%pISc) from peer %llu (%pISpfsc)\n", dev->name, skb, peer->internal_id, &peer->endpoint.addr); -+ ++dev->stats.rx_errors; -+ ++dev->stats.rx_frame_errors; -+ goto packet_processed; -+dishonest_packet_type: -+ net_dbg_ratelimited("%s: Packet is neither ipv4 nor ipv6 from peer %llu (%pISpfsc)\n", dev->name, peer->internal_id, &peer->endpoint.addr); -+ ++dev->stats.rx_errors; -+ ++dev->stats.rx_frame_errors; -+ goto packet_processed; -+dishonest_packet_size: -+ net_dbg_ratelimited("%s: Packet has incorrect size from peer %llu (%pISpfsc)\n", dev->name, peer->internal_id, &peer->endpoint.addr); -+ ++dev->stats.rx_errors; -+ ++dev->stats.rx_length_errors; -+ goto packet_processed; -+packet_processed: -+ dev_kfree_skb(skb); -+} -+ -+void packet_rx_worker(struct work_struct *work) -+{ -+ struct crypt_queue *queue = container_of(work, struct crypt_queue, work); -+ struct wireguard_peer *peer; -+ struct noise_keypair *keypair; -+ struct sk_buff *skb; -+ struct endpoint endpoint; -+ enum packet_state state; -+ bool free; -+ -+ local_bh_disable(); -+ spin_lock_bh(&queue->ring.consumer_lock); -+ while ((skb = __ptr_ring_peek(&queue->ring)) != NULL && (state = atomic_read(&PACKET_CB(skb)->state)) != PACKET_STATE_UNCRYPTED) { -+ __ptr_ring_discard_one(&queue->ring); -+ peer = PACKET_PEER(skb); -+ keypair = PACKET_CB(skb)->keypair; -+ free = true; -+ -+ if (unlikely(state != PACKET_STATE_CRYPTED)) -+ goto next; -+ -+ if (unlikely(!counter_validate(&keypair->receiving.counter, PACKET_CB(skb)->nonce))) { -+ net_dbg_ratelimited("%s: Packet has invalid nonce %llu (max %llu)\n", peer->device->dev->name, PACKET_CB(skb)->nonce, keypair->receiving.counter.receive.counter); -+ goto next; -+ } -+ -+ if (unlikely(socket_endpoint_from_skb(&endpoint, skb))) -+ goto next; -+ -+ skb_reset(skb); -+ packet_consume_data_done(skb, &endpoint); -+ free = false; -+ -+next: -+ noise_keypair_put(keypair); -+ peer_put(peer); -+ if (unlikely(free)) -+ dev_kfree_skb(skb); -+ } -+ spin_unlock_bh(&queue->ring.consumer_lock); -+ local_bh_enable(); -+} -+ -+void packet_decrypt_worker(struct work_struct *work) -+{ -+ struct crypt_queue *queue = container_of(work, struct multicore_worker, work)->ptr; -+ struct sk_buff *skb; -+ bool have_simd = chacha20poly1305_init_simd(); -+ -+ while ((skb = ptr_ring_consume_bh(&queue->ring)) != NULL) { -+ enum packet_state state = likely(skb_decrypt(skb, &PACKET_CB(skb)->keypair->receiving, have_simd)) ? PACKET_STATE_CRYPTED : PACKET_STATE_DEAD; -+ -+ queue_enqueue_per_peer(&PACKET_PEER(skb)->rx_queue, skb, state); -+ } -+ -+ chacha20poly1305_deinit_simd(have_simd); -+} -+ -+static void packet_consume_data(struct wireguard_device *wg, struct sk_buff *skb) -+{ -+ struct wireguard_peer *peer; -+ __le32 idx = ((struct message_data *)skb->data)->key_idx; -+ int ret; -+ -+ rcu_read_lock_bh(); -+ PACKET_CB(skb)->keypair = noise_keypair_get((struct noise_keypair *)index_hashtable_lookup(&wg->index_hashtable, INDEX_HASHTABLE_KEYPAIR, idx)); -+ rcu_read_unlock_bh(); -+ if (unlikely(!PACKET_CB(skb)->keypair)) { -+ dev_kfree_skb(skb); -+ return; -+ } -+ -+ /* The call to index_hashtable_lookup gives us a reference to its underlying peer, so we don't need to call peer_rcu_get(). */ -+ peer = PACKET_PEER(skb); -+ -+ ret = queue_enqueue_per_device_and_peer(&wg->decrypt_queue, &peer->rx_queue, skb, wg->packet_crypt_wq, &wg->decrypt_queue.last_cpu); -+ if (likely(!ret)) -+ return; /* Successful. No need to drop references below. */ -+ -+ if (ret == -EPIPE) -+ queue_enqueue_per_peer(&peer->rx_queue, skb, PACKET_STATE_DEAD); -+ else { -+ peer_put(peer); -+ noise_keypair_put(PACKET_CB(skb)->keypair); -+ dev_kfree_skb(skb); -+ } -+} -+ -+void packet_receive(struct wireguard_device *wg, struct sk_buff *skb) -+{ -+ if (unlikely(skb_prepare_header(skb, wg) < 0)) -+ goto err; -+ switch (SKB_TYPE_LE32(skb)) { -+ case cpu_to_le32(MESSAGE_HANDSHAKE_INITIATION): -+ case cpu_to_le32(MESSAGE_HANDSHAKE_RESPONSE): -+ case cpu_to_le32(MESSAGE_HANDSHAKE_COOKIE): { -+ int cpu; -+ -+ if (skb_queue_len(&wg->incoming_handshakes) > MAX_QUEUED_INCOMING_HANDSHAKES) { -+ net_dbg_skb_ratelimited("%s: Too many handshakes queued, dropping packet from %pISpfsc\n", wg->dev->name, skb); -+ goto err; -+ } -+ skb_queue_tail(&wg->incoming_handshakes, skb); -+ /* Queues up a call to packet_process_queued_handshake_packets(skb): */ -+ cpu = cpumask_next_online(&wg->incoming_handshake_cpu); -+ queue_work_on(cpu, wg->handshake_receive_wq, &per_cpu_ptr(wg->incoming_handshakes_worker, cpu)->work); -+ break; -+ } -+ case cpu_to_le32(MESSAGE_DATA): -+ PACKET_CB(skb)->ds = ip_tunnel_get_dsfield(ip_hdr(skb), skb); -+ packet_consume_data(wg, skb); -+ break; -+ default: -+ net_dbg_skb_ratelimited("%s: Invalid packet from %pISpfsc\n", wg->dev->name, skb); -+ goto err; -+ } -+ return; -+ -+err: -+ dev_kfree_skb(skb); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/send.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,348 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "queueing.h" -+#include "timers.h" -+#include "device.h" -+#include "peer.h" -+#include "socket.h" -+#include "messages.h" -+#include "cookie.h" -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+static void packet_send_handshake_initiation(struct wireguard_peer *peer) -+{ -+ struct message_handshake_initiation packet; -+ -+ down_write(&peer->handshake.lock); -+ if (!time_is_before_jiffies64(peer->last_sent_handshake + REKEY_TIMEOUT)) { -+ up_write(&peer->handshake.lock); -+ return; /* This function is rate limited. */ -+ } -+ peer->last_sent_handshake = get_jiffies_64(); -+ up_write(&peer->handshake.lock); -+ -+ net_dbg_ratelimited("%s: Sending handshake initiation to peer %llu (%pISpfsc)\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr); -+ -+ if (noise_handshake_create_initiation(&packet, &peer->handshake)) { -+ cookie_add_mac_to_packet(&packet, sizeof(packet), peer); -+ timers_any_authenticated_packet_traversal(peer); -+ socket_send_buffer_to_peer(peer, &packet, sizeof(struct message_handshake_initiation), HANDSHAKE_DSCP); -+ timers_handshake_initiated(peer); -+ } -+} -+ -+void packet_handshake_send_worker(struct work_struct *work) -+{ -+ struct wireguard_peer *peer = container_of(work, struct wireguard_peer, transmit_handshake_work); -+ -+ packet_send_handshake_initiation(peer); -+ peer_put(peer); -+} -+ -+void packet_send_queued_handshake_initiation(struct wireguard_peer *peer, bool is_retry) -+{ -+ if (!is_retry) -+ peer->timer_handshake_attempts = 0; -+ -+ /* First checking the timestamp here is just an optimization; it will -+ * be caught while properly locked inside the actual work queue. -+ */ -+ if (!time_is_before_jiffies64(peer->last_sent_handshake + REKEY_TIMEOUT)) -+ return; -+ -+ peer = peer_rcu_get(peer); -+ /* Queues up calling packet_send_queued_handshakes(peer), where we do a peer_put(peer) after: */ -+ if (!queue_work(peer->device->handshake_send_wq, &peer->transmit_handshake_work)) -+ peer_put(peer); /* If the work was already queued, we want to drop the extra reference */ -+} -+ -+void packet_send_handshake_response(struct wireguard_peer *peer) -+{ -+ struct message_handshake_response packet; -+ -+ net_dbg_ratelimited("%s: Sending handshake response to peer %llu (%pISpfsc)\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr); -+ peer->last_sent_handshake = get_jiffies_64(); -+ -+ if (noise_handshake_create_response(&packet, &peer->handshake)) { -+ cookie_add_mac_to_packet(&packet, sizeof(packet), peer); -+ if (noise_handshake_begin_session(&peer->handshake, &peer->keypairs)) { -+ timers_session_derived(peer); -+ timers_any_authenticated_packet_traversal(peer); -+ socket_send_buffer_to_peer(peer, &packet, sizeof(struct message_handshake_response), HANDSHAKE_DSCP); -+ } -+ } -+} -+ -+void packet_send_handshake_cookie(struct wireguard_device *wg, struct sk_buff *initiating_skb, __le32 sender_index) -+{ -+ struct message_handshake_cookie packet; -+ -+ net_dbg_skb_ratelimited("%s: Sending cookie response for denied handshake message for %pISpfsc\n", wg->dev->name, initiating_skb); -+ cookie_message_create(&packet, initiating_skb, sender_index, &wg->cookie_checker); -+ socket_send_buffer_as_reply_to_skb(wg, initiating_skb, &packet, sizeof(packet)); -+} -+ -+static inline void keep_key_fresh(struct wireguard_peer *peer) -+{ -+ struct noise_keypair *keypair; -+ bool send = false; -+ -+ rcu_read_lock_bh(); -+ keypair = rcu_dereference_bh(peer->keypairs.current_keypair); -+ if (likely(keypair && keypair->sending.is_valid) && -+ (unlikely(atomic64_read(&keypair->sending.counter.counter) > REKEY_AFTER_MESSAGES) || -+ (keypair->i_am_the_initiator && unlikely(time_is_before_eq_jiffies64(keypair->sending.birthdate + REKEY_AFTER_TIME))))) -+ send = true; -+ rcu_read_unlock_bh(); -+ -+ if (send) -+ packet_send_queued_handshake_initiation(peer, false); -+} -+ -+static inline unsigned int skb_padding(struct sk_buff *skb) -+{ -+ /* We do this modulo business with the MTU, just in case the networking layer -+ * gives us a packet that's bigger than the MTU. Since we support GSO, this -+ * isn't strictly neccessary, but it's better to be cautious here, especially -+ * if that code ever changes. -+ */ -+ unsigned int last_unit = skb->len % skb->dev->mtu; -+ unsigned int padded_size = (last_unit + MESSAGE_PADDING_MULTIPLE - 1) & ~(MESSAGE_PADDING_MULTIPLE - 1); -+ -+ if (padded_size > skb->dev->mtu) -+ padded_size = skb->dev->mtu; -+ return padded_size - last_unit; -+} -+ -+static inline bool skb_encrypt(struct sk_buff *skb, struct noise_keypair *keypair, bool have_simd) -+{ -+ struct scatterlist sg[MAX_SKB_FRAGS * 2 + 1]; -+ struct message_data *header; -+ unsigned int padding_len, plaintext_len, trailer_len; -+ int num_frags; -+ struct sk_buff *trailer; -+ -+ /* Calculate lengths */ -+ padding_len = skb_padding(skb); -+ trailer_len = padding_len + noise_encrypted_len(0); -+ plaintext_len = skb->len + padding_len; -+ -+ /* Expand data section to have room for padding and auth tag */ -+ num_frags = skb_cow_data(skb, trailer_len, &trailer); -+ if (unlikely(num_frags < 0 || num_frags > ARRAY_SIZE(sg))) -+ return false; -+ -+ /* Set the padding to zeros, and make sure it and the auth tag are part of the skb */ -+ memset(skb_tail_pointer(trailer), 0, padding_len); -+ -+ /* Expand head section to have room for our header and the network stack's headers. */ -+ if (unlikely(skb_cow_head(skb, DATA_PACKET_HEAD_ROOM) < 0)) -+ return false; -+ -+ /* We have to remember to add the checksum to the innerpacket, in case the receiver forwards it. */ -+ if (likely(!skb_checksum_setup(skb, true))) -+ skb_checksum_help(skb); -+ -+ /* Only after checksumming can we safely add on the padding at the end and the header. */ -+ skb_set_inner_network_header(skb, 0); -+ header = (struct message_data *)skb_push(skb, sizeof(struct message_data)); -+ header->header.type = cpu_to_le32(MESSAGE_DATA); -+ header->key_idx = keypair->remote_index; -+ header->counter = cpu_to_le64(PACKET_CB(skb)->nonce); -+ pskb_put(skb, trailer, trailer_len); -+ -+ /* Now we can encrypt the scattergather segments */ -+ sg_init_table(sg, num_frags); -+ if (skb_to_sgvec(skb, sg, sizeof(struct message_data), noise_encrypted_len(plaintext_len)) <= 0) -+ return false; -+ return chacha20poly1305_encrypt_sg(sg, sg, plaintext_len, NULL, 0, PACKET_CB(skb)->nonce, keypair->sending.key, have_simd); -+} -+ -+void packet_send_keepalive(struct wireguard_peer *peer) -+{ -+ struct sk_buff *skb; -+ -+ if (skb_queue_empty(&peer->staged_packet_queue)) { -+ skb = alloc_skb(DATA_PACKET_HEAD_ROOM + MESSAGE_MINIMUM_LENGTH, GFP_ATOMIC); -+ if (unlikely(!skb)) -+ return; -+ skb_reserve(skb, DATA_PACKET_HEAD_ROOM); -+ skb->dev = peer->device->dev; -+ skb_queue_tail(&peer->staged_packet_queue, skb); -+ net_dbg_ratelimited("%s: Sending keepalive packet to peer %llu (%pISpfsc)\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr); -+ } -+ -+ packet_send_staged_packets(peer); -+} -+ -+#define skb_walk_null_queue_safe(first, skb, next) for (skb = first, next = skb->next; skb; skb = next, next = skb ? skb->next : NULL) -+static inline void skb_free_null_queue(struct sk_buff *first) -+{ -+ struct sk_buff *skb, *next; -+ -+ skb_walk_null_queue_safe(first, skb, next) -+ dev_kfree_skb(skb); -+} -+ -+static void packet_create_data_done(struct sk_buff *first, struct wireguard_peer *peer) -+{ -+ struct sk_buff *skb, *next; -+ bool is_keepalive, data_sent = false; -+ -+ timers_any_authenticated_packet_traversal(peer); -+ skb_walk_null_queue_safe(first, skb, next) { -+ is_keepalive = skb->len == message_data_len(0); -+ if (likely(!socket_send_skb_to_peer(peer, skb, PACKET_CB(skb)->ds) && !is_keepalive)) -+ data_sent = true; -+ } -+ -+ if (likely(data_sent)) -+ timers_data_sent(peer); -+ -+ keep_key_fresh(peer); -+} -+ -+void packet_tx_worker(struct work_struct *work) -+{ -+ struct crypt_queue *queue = container_of(work, struct crypt_queue, work); -+ struct wireguard_peer *peer; -+ struct noise_keypair *keypair; -+ struct sk_buff *first; -+ enum packet_state state; -+ -+ spin_lock_bh(&queue->ring.consumer_lock); -+ while ((first = __ptr_ring_peek(&queue->ring)) != NULL && (state = atomic_read(&PACKET_CB(first)->state)) != PACKET_STATE_UNCRYPTED) { -+ __ptr_ring_discard_one(&queue->ring); -+ peer = PACKET_PEER(first); -+ keypair = PACKET_CB(first)->keypair; -+ -+ if (likely(state == PACKET_STATE_CRYPTED)) -+ packet_create_data_done(first, peer); -+ else -+ skb_free_null_queue(first); -+ -+ noise_keypair_put(keypair); -+ peer_put(peer); -+ } -+ spin_unlock_bh(&queue->ring.consumer_lock); -+} -+ -+void packet_encrypt_worker(struct work_struct *work) -+{ -+ struct crypt_queue *queue = container_of(work, struct multicore_worker, work)->ptr; -+ struct sk_buff *first, *skb, *next; -+ bool have_simd = chacha20poly1305_init_simd(); -+ -+ while ((first = ptr_ring_consume_bh(&queue->ring)) != NULL) { -+ enum packet_state state = PACKET_STATE_CRYPTED; -+ -+ skb_walk_null_queue_safe(first, skb, next) { -+ if (likely(skb_encrypt(skb, PACKET_CB(first)->keypair, have_simd))) -+ skb_reset(skb); -+ else { -+ state = PACKET_STATE_DEAD; -+ break; -+ } -+ } -+ queue_enqueue_per_peer(&PACKET_PEER(first)->tx_queue, first, state); -+ } -+ chacha20poly1305_deinit_simd(have_simd); -+} -+ -+static void packet_create_data(struct sk_buff *first) -+{ -+ struct wireguard_peer *peer = PACKET_PEER(first); -+ struct wireguard_device *wg = peer->device; -+ int ret; -+ -+ ret = queue_enqueue_per_device_and_peer(&wg->encrypt_queue, &peer->tx_queue, first, wg->packet_crypt_wq, &wg->encrypt_queue.last_cpu); -+ if (likely(!ret)) -+ return; /* Successful. No need to fall through to drop references below. */ -+ -+ if (ret == -EPIPE) -+ queue_enqueue_per_peer(&peer->tx_queue, first, PACKET_STATE_DEAD); -+ else { -+ peer_put(peer); -+ noise_keypair_put(PACKET_CB(first)->keypair); -+ skb_free_null_queue(first); -+ } -+} -+ -+void packet_send_staged_packets(struct wireguard_peer *peer) -+{ -+ struct noise_keypair *keypair; -+ struct noise_symmetric_key *key; -+ struct sk_buff_head packets; -+ struct sk_buff *skb; -+ -+ /* Steal the current queue into our local one. */ -+ __skb_queue_head_init(&packets); -+ spin_lock_bh(&peer->staged_packet_queue.lock); -+ skb_queue_splice_init(&peer->staged_packet_queue, &packets); -+ spin_unlock_bh(&peer->staged_packet_queue.lock); -+ if (unlikely(skb_queue_empty(&packets))) -+ return; -+ -+ /* First we make sure we have a valid reference to a valid key. */ -+ rcu_read_lock_bh(); -+ keypair = noise_keypair_get(rcu_dereference_bh(peer->keypairs.current_keypair)); -+ rcu_read_unlock_bh(); -+ if (unlikely(!keypair)) -+ goto out_nokey; -+ key = &keypair->sending; -+ if (unlikely(!key || !key->is_valid)) -+ goto out_nokey; -+ if (unlikely(time_is_before_eq_jiffies64(key->birthdate + REJECT_AFTER_TIME))) -+ goto out_invalid; -+ -+ /* After we know we have a somewhat valid key, we now try to assign nonces to -+ * all of the packets in the queue. If we can't assign nonces for all of them, -+ * we just consider it a failure and wait for the next handshake. -+ */ -+ skb_queue_walk(&packets, skb) { -+ PACKET_CB(skb)->ds = ip_tunnel_ecn_encap(0 /* No outer TOS: no leak. TODO: should we use flowi->tos as outer? */, ip_hdr(skb), skb); -+ PACKET_CB(skb)->nonce = atomic64_inc_return(&key->counter.counter) - 1; -+ if (unlikely(PACKET_CB(skb)->nonce >= REJECT_AFTER_MESSAGES)) -+ goto out_invalid; -+ } -+ -+ packets.prev->next = NULL; -+ peer_rcu_get(keypair->entry.peer); -+ PACKET_CB(packets.next)->keypair = keypair; -+ packet_create_data(packets.next); -+ return; -+ -+out_invalid: -+ key->is_valid = false; -+out_nokey: -+ noise_keypair_put(keypair); -+ -+ /* We orphan the packets if we're waiting on a handshake, so that they -+ * don't block a socket's pool. -+ */ -+ skb_queue_walk(&packets, skb) -+ skb_orphan(skb); -+ /* Then we put them back on the top of the queue. We're not too concerned about -+ * accidently getting things a little out of order if packets are being added -+ * really fast, because this queue is for before packets can even be sent and -+ * it's small anyway. -+ */ -+ spin_lock_bh(&peer->staged_packet_queue.lock); -+ skb_queue_splice(&packets, &peer->staged_packet_queue); -+ spin_unlock_bh(&peer->staged_packet_queue.lock); -+ -+ /* If we're exiting because there's something wrong with the key, it means -+ * we should initiate a new handshake. -+ */ -+ packet_send_queued_handshake_initiation(peer, false); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/socket.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,393 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "device.h" -+#include "peer.h" -+#include "socket.h" -+#include "queueing.h" -+#include "messages.h" -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+static inline int send4(struct wireguard_device *wg, struct sk_buff *skb, struct endpoint *endpoint, u8 ds, struct dst_cache *cache) -+{ -+ struct flowi4 fl = { -+ .saddr = endpoint->src4.s_addr, -+ .daddr = endpoint->addr4.sin_addr.s_addr, -+ .fl4_dport = endpoint->addr4.sin_port, -+ .flowi4_mark = wg->fwmark, -+ .flowi4_proto = IPPROTO_UDP -+ }; -+ struct rtable *rt = NULL; -+ struct sock *sock; -+ int ret = 0; -+ -+ skb->next = skb->prev = NULL; -+ skb->dev = wg->dev; -+ skb->mark = wg->fwmark; -+ -+ rcu_read_lock_bh(); -+ sock = rcu_dereference_bh(wg->sock4); -+ -+ if (unlikely(!sock)) { -+ ret = -ENONET; -+ goto err; -+ } -+ -+ fl.fl4_sport = inet_sk(sock)->inet_sport; -+ -+ if (cache) -+ rt = dst_cache_get_ip4(cache, &fl.saddr); -+ -+ if (!rt) { -+ security_sk_classify_flow(sock, flowi4_to_flowi(&fl)); -+ if (unlikely(!inet_confirm_addr(sock_net(sock), NULL, 0, fl.saddr, RT_SCOPE_HOST))) { -+ endpoint->src4.s_addr = *(__force __be32 *)&endpoint->src_if4 = fl.saddr = 0; -+ if (cache) -+ dst_cache_reset(cache); -+ } -+ rt = ip_route_output_flow(sock_net(sock), &fl, sock); -+ if (unlikely(endpoint->src_if4 && ((IS_ERR(rt) && PTR_ERR(rt) == -EINVAL) || (!IS_ERR(rt) && rt->dst.dev->ifindex != endpoint->src_if4)))) { -+ endpoint->src4.s_addr = *(__force __be32 *)&endpoint->src_if4 = fl.saddr = 0; -+ if (cache) -+ dst_cache_reset(cache); -+ if (!IS_ERR(rt)) -+ ip_rt_put(rt); -+ rt = ip_route_output_flow(sock_net(sock), &fl, sock); -+ } -+ if (unlikely(IS_ERR(rt))) { -+ ret = PTR_ERR(rt); -+ net_dbg_ratelimited("%s: No route to %pISpfsc, error %d\n", wg->dev->name, &endpoint->addr, ret); -+ goto err; -+ } else if (unlikely(rt->dst.dev == skb->dev)) { -+ ip_rt_put(rt); -+ ret = -ELOOP; -+ net_dbg_ratelimited("%s: Avoiding routing loop to %pISpfsc\n", wg->dev->name, &endpoint->addr); -+ goto err; -+ } -+ if (cache) -+ dst_cache_set_ip4(cache, &rt->dst, fl.saddr); -+ } -+ udp_tunnel_xmit_skb(rt, sock, skb, fl.saddr, fl.daddr, ds, ip4_dst_hoplimit(&rt->dst), 0, fl.fl4_sport, fl.fl4_dport, false, false); -+ goto out; -+ -+err: -+ kfree_skb(skb); -+out: -+ rcu_read_unlock_bh(); -+ return ret; -+} -+ -+static inline int send6(struct wireguard_device *wg, struct sk_buff *skb, struct endpoint *endpoint, u8 ds, struct dst_cache *cache) -+{ -+#if IS_ENABLED(CONFIG_IPV6) -+ struct flowi6 fl = { -+ .saddr = endpoint->src6, -+ .daddr = endpoint->addr6.sin6_addr, -+ .fl6_dport = endpoint->addr6.sin6_port, -+ .flowi6_mark = wg->fwmark, -+ .flowi6_oif = endpoint->addr6.sin6_scope_id, -+ .flowi6_proto = IPPROTO_UDP -+ /* TODO: addr->sin6_flowinfo */ -+ }; -+ struct dst_entry *dst = NULL; -+ struct sock *sock; -+ int ret = 0; -+ -+ skb->next = skb->prev = NULL; -+ skb->dev = wg->dev; -+ skb->mark = wg->fwmark; -+ -+ rcu_read_lock_bh(); -+ sock = rcu_dereference_bh(wg->sock6); -+ -+ if (unlikely(!sock)) { -+ ret = -ENONET; -+ goto err; -+ } -+ -+ fl.fl6_sport = inet_sk(sock)->inet_sport; -+ -+ if (cache) -+ dst = dst_cache_get_ip6(cache, &fl.saddr); -+ -+ if (!dst) { -+ security_sk_classify_flow(sock, flowi6_to_flowi(&fl)); -+ if (unlikely(!ipv6_addr_any(&fl.saddr) && !ipv6_chk_addr(sock_net(sock), &fl.saddr, NULL, 0))) { -+ endpoint->src6 = fl.saddr = in6addr_any; -+ if (cache) -+ dst_cache_reset(cache); -+ } -+ ret = ipv6_stub->ipv6_dst_lookup(sock_net(sock), sock, &dst, &fl); -+ if (unlikely(ret)) { -+ net_dbg_ratelimited("%s: No route to %pISpfsc, error %d\n", wg->dev->name, &endpoint->addr, ret); -+ goto err; -+ } else if (unlikely(dst->dev == skb->dev)) { -+ dst_release(dst); -+ ret = -ELOOP; -+ net_dbg_ratelimited("%s: Avoiding routing loop to %pISpfsc\n", wg->dev->name, &endpoint->addr); -+ goto err; -+ } -+ if (cache) -+ dst_cache_set_ip6(cache, dst, &fl.saddr); -+ } -+ -+ udp_tunnel6_xmit_skb(dst, sock, skb, skb->dev, &fl.saddr, &fl.daddr, ds, ip6_dst_hoplimit(dst), 0, fl.fl6_sport, fl.fl6_dport, false); -+ goto out; -+ -+err: -+ kfree_skb(skb); -+out: -+ rcu_read_unlock_bh(); -+ return ret; -+#else -+ return -EAFNOSUPPORT; -+#endif -+} -+ -+int socket_send_skb_to_peer(struct wireguard_peer *peer, struct sk_buff *skb, u8 ds) -+{ -+ size_t skb_len = skb->len; -+ int ret = -EAFNOSUPPORT; -+ -+ read_lock_bh(&peer->endpoint_lock); -+ if (peer->endpoint.addr.sa_family == AF_INET) -+ ret = send4(peer->device, skb, &peer->endpoint, ds, &peer->endpoint_cache); -+ else if (peer->endpoint.addr.sa_family == AF_INET6) -+ ret = send6(peer->device, skb, &peer->endpoint, ds, &peer->endpoint_cache); -+ else -+ dev_kfree_skb(skb); -+ if (likely(!ret)) -+ peer->tx_bytes += skb_len; -+ read_unlock_bh(&peer->endpoint_lock); -+ -+ return ret; -+} -+ -+int socket_send_buffer_to_peer(struct wireguard_peer *peer, void *buffer, size_t len, u8 ds) -+{ -+ struct sk_buff *skb = alloc_skb(len + SKB_HEADER_LEN, GFP_ATOMIC); -+ -+ if (unlikely(!skb)) -+ return -ENOMEM; -+ -+ skb_reserve(skb, SKB_HEADER_LEN); -+ skb_set_inner_network_header(skb, 0); -+ memcpy(skb_put(skb, len), buffer, len); -+ return socket_send_skb_to_peer(peer, skb, ds); -+} -+ -+int socket_send_buffer_as_reply_to_skb(struct wireguard_device *wg, struct sk_buff *in_skb, void *out_buffer, size_t len) -+{ -+ int ret = 0; -+ struct sk_buff *skb; -+ struct endpoint endpoint; -+ -+ if (unlikely(!in_skb)) -+ return -EINVAL; -+ ret = socket_endpoint_from_skb(&endpoint, in_skb); -+ if (unlikely(ret < 0)) -+ return ret; -+ -+ skb = alloc_skb(len + SKB_HEADER_LEN, GFP_ATOMIC); -+ if (unlikely(!skb)) -+ return -ENOMEM; -+ skb_reserve(skb, SKB_HEADER_LEN); -+ skb_set_inner_network_header(skb, 0); -+ memcpy(skb_put(skb, len), out_buffer, len); -+ -+ if (endpoint.addr.sa_family == AF_INET) -+ ret = send4(wg, skb, &endpoint, 0, NULL); -+ else if (endpoint.addr.sa_family == AF_INET6) -+ ret = send6(wg, skb, &endpoint, 0, NULL); -+ /* No other possibilities if the endpoint is valid, which it is, as we checked above. */ -+ -+ return ret; -+} -+ -+int socket_endpoint_from_skb(struct endpoint *endpoint, const struct sk_buff *skb) -+{ -+ memset(endpoint, 0, sizeof(struct endpoint)); -+ if (skb->protocol == htons(ETH_P_IP)) { -+ endpoint->addr4.sin_family = AF_INET; -+ endpoint->addr4.sin_port = udp_hdr(skb)->source; -+ endpoint->addr4.sin_addr.s_addr = ip_hdr(skb)->saddr; -+ endpoint->src4.s_addr = ip_hdr(skb)->daddr; -+ endpoint->src_if4 = skb->skb_iif; -+ } else if (skb->protocol == htons(ETH_P_IPV6)) { -+ endpoint->addr6.sin6_family = AF_INET6; -+ endpoint->addr6.sin6_port = udp_hdr(skb)->source; -+ endpoint->addr6.sin6_addr = ipv6_hdr(skb)->saddr; -+ endpoint->addr6.sin6_scope_id = ipv6_iface_scope_id(&ipv6_hdr(skb)->saddr, skb->skb_iif); -+ endpoint->src6 = ipv6_hdr(skb)->daddr; -+ } else -+ return -EINVAL; -+ return 0; -+} -+ -+static inline bool endpoint_eq(const struct endpoint *a, const struct endpoint *b) -+{ -+ return (a->addr.sa_family == AF_INET && b->addr.sa_family == AF_INET && -+ a->addr4.sin_port == b->addr4.sin_port && a->addr4.sin_addr.s_addr == b->addr4.sin_addr.s_addr && -+ a->src4.s_addr == b->src4.s_addr && a->src_if4 == b->src_if4) || -+ (a->addr.sa_family == AF_INET6 && b->addr.sa_family == AF_INET6 && -+ a->addr6.sin6_port == b->addr6.sin6_port && ipv6_addr_equal(&a->addr6.sin6_addr, &b->addr6.sin6_addr) && -+ a->addr6.sin6_scope_id == b->addr6.sin6_scope_id && ipv6_addr_equal(&a->src6, &b->src6)) || -+ unlikely(!a->addr.sa_family && !b->addr.sa_family); -+} -+ -+void socket_set_peer_endpoint(struct wireguard_peer *peer, const struct endpoint *endpoint) -+{ -+ /* First we check unlocked, in order to optimize, since it's pretty rare -+ * that an endpoint will change. If we happen to be mid-write, and two -+ * CPUs wind up writing the same thing or something slightly different, -+ * it doesn't really matter much either. -+ */ -+ if (endpoint_eq(endpoint, &peer->endpoint)) -+ return; -+ write_lock_bh(&peer->endpoint_lock); -+ if (endpoint->addr.sa_family == AF_INET) { -+ peer->endpoint.addr4 = endpoint->addr4; -+ peer->endpoint.src4 = endpoint->src4; -+ peer->endpoint.src_if4 = endpoint->src_if4; -+ } else if (endpoint->addr.sa_family == AF_INET6) { -+ peer->endpoint.addr6 = endpoint->addr6; -+ peer->endpoint.src6 = endpoint->src6; -+ } else -+ goto out; -+ dst_cache_reset(&peer->endpoint_cache); -+out: -+ write_unlock_bh(&peer->endpoint_lock); -+} -+ -+void socket_set_peer_endpoint_from_skb(struct wireguard_peer *peer, const struct sk_buff *skb) -+{ -+ struct endpoint endpoint; -+ -+ if (!socket_endpoint_from_skb(&endpoint, skb)) -+ socket_set_peer_endpoint(peer, &endpoint); -+} -+ -+void socket_clear_peer_endpoint_src(struct wireguard_peer *peer) -+{ -+ write_lock_bh(&peer->endpoint_lock); -+ memset(&peer->endpoint.src6, 0, sizeof(peer->endpoint.src6)); -+ dst_cache_reset(&peer->endpoint_cache); -+ write_unlock_bh(&peer->endpoint_lock); -+} -+ -+static int receive(struct sock *sk, struct sk_buff *skb) -+{ -+ struct wireguard_device *wg; -+ -+ if (unlikely(!sk)) -+ goto err; -+ wg = sk->sk_user_data; -+ if (unlikely(!wg)) -+ goto err; -+ packet_receive(wg, skb); -+ return 0; -+ -+err: -+ kfree_skb(skb); -+ return 0; -+} -+ -+static inline void sock_free(struct sock *sock) -+{ -+ if (unlikely(!sock)) -+ return; -+ sk_clear_memalloc(sock); -+ udp_tunnel_sock_release(sock->sk_socket); -+} -+ -+static inline void set_sock_opts(struct socket *sock) -+{ -+ sock->sk->sk_allocation = GFP_ATOMIC; -+ sock->sk->sk_sndbuf = INT_MAX; -+ sk_set_memalloc(sock->sk); -+} -+ -+int socket_init(struct wireguard_device *wg, u16 port) -+{ -+ int ret; -+ struct udp_tunnel_sock_cfg cfg = { -+ .sk_user_data = wg, -+ .encap_type = 1, -+ .encap_rcv = receive -+ }; -+ struct socket *new4 = NULL, *new6 = NULL; -+ struct udp_port_cfg port4 = { -+ .family = AF_INET, -+ .local_ip.s_addr = htonl(INADDR_ANY), -+ .local_udp_port = htons(port), -+ .use_udp_checksums = true -+ }; -+#if IS_ENABLED(CONFIG_IPV6) -+ int retries = 0; -+ struct udp_port_cfg port6 = { -+ .family = AF_INET6, -+ .local_ip6 = IN6ADDR_ANY_INIT, -+ .use_udp6_tx_checksums = true, -+ .use_udp6_rx_checksums = true, -+ .ipv6_v6only = true -+ }; -+#endif -+ -+#if IS_ENABLED(CONFIG_IPV6) -+retry: -+#endif -+ -+ ret = udp_sock_create(wg->creating_net, &port4, &new4); -+ if (ret < 0) { -+ pr_err("%s: Could not create IPv4 socket\n", wg->dev->name); -+ return ret; -+ } -+ set_sock_opts(new4); -+ setup_udp_tunnel_sock(wg->creating_net, new4, &cfg); -+ -+#if IS_ENABLED(CONFIG_IPV6) -+ if (ipv6_mod_enabled()) { -+ port6.local_udp_port = inet_sk(new4->sk)->inet_sport; -+ ret = udp_sock_create(wg->creating_net, &port6, &new6); -+ if (ret < 0) { -+ udp_tunnel_sock_release(new4); -+ if (ret == -EADDRINUSE && !port && retries++ < 100) -+ goto retry; -+ pr_err("%s: Could not create IPv6 socket\n", wg->dev->name); -+ return ret; -+ } -+ set_sock_opts(new6); -+ setup_udp_tunnel_sock(wg->creating_net, new6, &cfg); -+ } -+#endif -+ -+ socket_reinit(wg, new4 ? new4->sk : NULL, new6 ? new6->sk : NULL); -+ return 0; -+} -+ -+void socket_reinit(struct wireguard_device *wg, struct sock *new4, struct sock *new6) -+{ -+ struct sock *old4, *old6; -+ -+ mutex_lock(&wg->socket_update_lock); -+ old4 = rcu_dereference_protected(wg->sock4, lockdep_is_held(&wg->socket_update_lock)); -+ old6 = rcu_dereference_protected(wg->sock6, lockdep_is_held(&wg->socket_update_lock)); -+ rcu_assign_pointer(wg->sock4, new4); -+ rcu_assign_pointer(wg->sock6, new6); -+ if (new4) -+ wg->incoming_port = ntohs(inet_sk(new4)->inet_sport); -+ mutex_unlock(&wg->socket_update_lock); -+ synchronize_rcu_bh(); -+ synchronize_net(); -+ sock_free(old4); -+ sock_free(old6); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/timers.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,199 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "timers.h" -+#include "device.h" -+#include "peer.h" -+#include "queueing.h" -+#include "socket.h" -+ -+/* -+ * Timer for retransmitting the handshake if we don't hear back after `REKEY_TIMEOUT + jitter` ms -+ * Timer for sending empty packet if we have received a packet but after have not sent one for `KEEPALIVE_TIMEOUT` ms -+ * Timer for initiating new handshake if we have sent a packet but after have not received one (even empty) for `(KEEPALIVE_TIMEOUT + REKEY_TIMEOUT)` ms -+ * Timer for zeroing out all ephemeral keys after `(REJECT_AFTER_TIME * 3)` ms if no new keys have been received -+ * Timer for, if enabled, sending an empty authenticated packet every user-specified seconds -+ */ -+ -+/* This rounds the time down to the closest power of two of the closest quarter second. */ -+static inline unsigned long slack_time(unsigned long time) -+{ -+ return time & ~(roundup_pow_of_two(HZ / 4) - 1); -+} -+ -+#define peer_get_from_timer(timer_name) \ -+ struct wireguard_peer *peer = peer_rcu_get(from_timer(peer, timer, timer_name)); \ -+ if (unlikely(!peer)) \ -+ return; -+ -+static inline bool timers_active(struct wireguard_peer *peer) -+{ -+ return netif_running(peer->device->dev) && !list_empty(&peer->peer_list); -+} -+ -+static void expired_retransmit_handshake(struct timer_list *timer) -+{ -+ peer_get_from_timer(timer_retransmit_handshake); -+ -+ if (peer->timer_handshake_attempts > MAX_TIMER_HANDSHAKES) { -+ pr_debug("%s: Handshake for peer %llu (%pISpfsc) did not complete after %d attempts, giving up\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr, MAX_TIMER_HANDSHAKES + 2); -+ -+ if (likely(timers_active(peer))) -+ del_timer(&peer->timer_send_keepalive); -+ /* We drop all packets without a keypair and don't try again, -+ * if we try unsuccessfully for too long to make a handshake. -+ */ -+ skb_queue_purge(&peer->staged_packet_queue); -+ -+ /* We set a timer for destroying any residue that might be left -+ * of a partial exchange. -+ */ -+ if (likely(timers_active(peer)) && !timer_pending(&peer->timer_zero_key_material)) -+ mod_timer(&peer->timer_zero_key_material, jiffies + (REJECT_AFTER_TIME * 3)); -+ } else { -+ ++peer->timer_handshake_attempts; -+ pr_debug("%s: Handshake for peer %llu (%pISpfsc) did not complete after %d seconds, retrying (try %d)\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr, REKEY_TIMEOUT / HZ, peer->timer_handshake_attempts + 1); -+ -+ /* We clear the endpoint address src address, in case this is the cause of trouble. */ -+ socket_clear_peer_endpoint_src(peer); -+ -+ packet_send_queued_handshake_initiation(peer, true); -+ } -+ peer_put(peer); -+} -+ -+static void expired_send_keepalive(struct timer_list *timer) -+{ -+ peer_get_from_timer(timer_send_keepalive); -+ -+ packet_send_keepalive(peer); -+ if (peer->timer_need_another_keepalive) { -+ peer->timer_need_another_keepalive = false; -+ if (likely(timers_active(peer))) -+ mod_timer(&peer->timer_send_keepalive, jiffies + KEEPALIVE_TIMEOUT); -+ } -+ peer_put(peer); -+} -+ -+static void expired_new_handshake(struct timer_list *timer) -+{ -+ peer_get_from_timer(timer_new_handshake); -+ -+ pr_debug("%s: Retrying handshake with peer %llu (%pISpfsc) because we stopped hearing back after %d seconds\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr, (KEEPALIVE_TIMEOUT + REKEY_TIMEOUT) / HZ); -+ /* We clear the endpoint address src address, in case this is the cause of trouble. */ -+ socket_clear_peer_endpoint_src(peer); -+ packet_send_queued_handshake_initiation(peer, false); -+ peer_put(peer); -+} -+ -+static void expired_zero_key_material(struct timer_list *timer) -+{ -+ peer_get_from_timer(timer_zero_key_material); -+ -+ if (!queue_work(peer->device->handshake_send_wq, &peer->clear_peer_work)) /* Takes our reference. */ -+ peer_put(peer); /* If the work was already on the queue, we want to drop the extra reference */ -+} -+static void queued_expired_zero_key_material(struct work_struct *work) -+{ -+ struct wireguard_peer *peer = container_of(work, struct wireguard_peer, clear_peer_work); -+ -+ pr_debug("%s: Zeroing out all keys for peer %llu (%pISpfsc), since we haven't received a new one in %d seconds\n", peer->device->dev->name, peer->internal_id, &peer->endpoint.addr, (REJECT_AFTER_TIME * 3) / HZ); -+ noise_handshake_clear(&peer->handshake); -+ noise_keypairs_clear(&peer->keypairs); -+ peer_put(peer); -+} -+ -+static void expired_send_persistent_keepalive(struct timer_list *timer) -+{ -+ peer_get_from_timer(timer_persistent_keepalive); -+ -+ if (likely(peer->persistent_keepalive_interval)) { -+ if (likely(timers_active(peer))) -+ del_timer(&peer->timer_send_keepalive); -+ packet_send_keepalive(peer); -+ } -+ peer_put(peer); -+} -+ -+/* Should be called after an authenticated data packet is sent. */ -+void timers_data_sent(struct wireguard_peer *peer) -+{ -+ if (likely(timers_active(peer))) -+ del_timer(&peer->timer_send_keepalive); -+ -+ if (likely(timers_active(peer)) && !timer_pending(&peer->timer_new_handshake)) -+ mod_timer(&peer->timer_new_handshake, jiffies + KEEPALIVE_TIMEOUT + REKEY_TIMEOUT); -+} -+ -+/* Should be called after an authenticated data packet is received. */ -+void timers_data_received(struct wireguard_peer *peer) -+{ -+ if (likely(timers_active(peer))) { -+ if (!timer_pending(&peer->timer_send_keepalive)) -+ mod_timer(&peer->timer_send_keepalive, jiffies + KEEPALIVE_TIMEOUT); -+ else -+ peer->timer_need_another_keepalive = true; -+ } -+} -+ -+/* Should be called after any type of authenticated packet is received -- keepalive or data. */ -+void timers_any_authenticated_packet_received(struct wireguard_peer *peer) -+{ -+ if (likely(timers_active(peer))) -+ del_timer(&peer->timer_new_handshake); -+} -+ -+/* Should be called after a handshake initiation message is sent. */ -+void timers_handshake_initiated(struct wireguard_peer *peer) -+{ -+ if (likely(timers_active(peer))) { -+ del_timer(&peer->timer_send_keepalive); -+ mod_timer(&peer->timer_retransmit_handshake, slack_time(jiffies + REKEY_TIMEOUT + prandom_u32_max(REKEY_TIMEOUT_JITTER_MAX))); -+ } -+} -+ -+/* Should be called after a handshake response message is received and processed or when getting key confirmation via the first data message. */ -+void timers_handshake_complete(struct wireguard_peer *peer) -+{ -+ if (likely(timers_active(peer))) -+ del_timer(&peer->timer_retransmit_handshake); -+ peer->timer_handshake_attempts = 0; -+ peer->sent_lastminute_handshake = false; -+ getnstimeofday(&peer->walltime_last_handshake); -+} -+ -+/* Should be called after an ephemeral key is created, which is before sending a handshake response or after receiving a handshake response. */ -+void timers_session_derived(struct wireguard_peer *peer) -+{ -+ if (likely(timers_active(peer))) -+ mod_timer(&peer->timer_zero_key_material, jiffies + (REJECT_AFTER_TIME * 3)); -+} -+ -+/* Should be called before a packet with authentication -- data, keepalive, either handshake -- is sent, or after one is received. */ -+void timers_any_authenticated_packet_traversal(struct wireguard_peer *peer) -+{ -+ if (peer->persistent_keepalive_interval && likely(timers_active(peer))) -+ mod_timer(&peer->timer_persistent_keepalive, slack_time(jiffies + peer->persistent_keepalive_interval)); -+} -+ -+void timers_init(struct wireguard_peer *peer) -+{ -+ timer_setup(&peer->timer_retransmit_handshake, expired_retransmit_handshake, 0); -+ timer_setup(&peer->timer_send_keepalive, expired_send_keepalive, 0); -+ timer_setup(&peer->timer_new_handshake, expired_new_handshake, 0); -+ timer_setup(&peer->timer_zero_key_material, expired_zero_key_material, 0); -+ timer_setup(&peer->timer_persistent_keepalive, expired_send_persistent_keepalive, 0); -+ INIT_WORK(&peer->clear_peer_work, queued_expired_zero_key_material); -+} -+ -+void timers_stop(struct wireguard_peer *peer) -+{ -+ del_timer_sync(&peer->timer_retransmit_handshake); -+ del_timer_sync(&peer->timer_send_keepalive); -+ del_timer_sync(&peer->timer_new_handshake); -+ del_timer_sync(&peer->timer_zero_key_material); -+ del_timer_sync(&peer->timer_persistent_keepalive); -+ flush_work(&peer->clear_peer_work); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/allowedips.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,44 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_ALLOWEDIPS_H -+#define _WG_ALLOWEDIPS_H -+ -+#include -+#include -+#include -+ -+struct wireguard_peer; -+struct allowedips_node; -+ -+struct allowedips { -+ struct allowedips_node __rcu *root4; -+ struct allowedips_node __rcu *root6; -+ u64 seq; -+}; -+ -+struct allowedips_cursor { -+ u64 seq; -+ struct allowedips_node *stack[128]; -+ unsigned int len; -+ bool second_half; -+}; -+ -+void allowedips_init(struct allowedips *table); -+void allowedips_free(struct allowedips *table, struct mutex *mutex); -+int allowedips_insert_v4(struct allowedips *table, const struct in_addr *ip, u8 cidr, struct wireguard_peer *peer, struct mutex *lock); -+int allowedips_insert_v6(struct allowedips *table, const struct in6_addr *ip, u8 cidr, struct wireguard_peer *peer, struct mutex *lock); -+void allowedips_remove_by_peer(struct allowedips *table, struct wireguard_peer *peer, struct mutex *lock); -+int allowedips_walk_by_peer(struct allowedips *table, struct allowedips_cursor *cursor, struct wireguard_peer *peer, int (*func)(void *ctx, const u8 *ip, u8 cidr, int family), void *ctx, struct mutex *lock); -+ -+/* These return a strong reference to a peer: */ -+struct wireguard_peer *allowedips_lookup_dst(struct allowedips *table, struct sk_buff *skb); -+struct wireguard_peer *allowedips_lookup_src(struct allowedips *table, struct sk_buff *skb); -+ -+#ifdef DEBUG -+bool allowedips_selftest(void); -+#endif -+ -+#endif /* _WG_ALLOWEDIPS_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/cookie.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,52 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_COOKIE_H -+#define _WG_COOKIE_H -+ -+#include "messages.h" -+#include -+ -+struct wireguard_peer; -+ -+struct cookie_checker { -+ u8 secret[NOISE_HASH_LEN]; -+ u8 cookie_encryption_key[NOISE_SYMMETRIC_KEY_LEN]; -+ u8 message_mac1_key[NOISE_SYMMETRIC_KEY_LEN]; -+ u64 secret_birthdate; -+ struct rw_semaphore secret_lock; -+ struct wireguard_device *device; -+}; -+ -+struct cookie { -+ u64 birthdate; -+ bool is_valid; -+ u8 cookie[COOKIE_LEN]; -+ bool have_sent_mac1; -+ u8 last_mac1_sent[COOKIE_LEN]; -+ u8 cookie_decryption_key[NOISE_SYMMETRIC_KEY_LEN]; -+ u8 message_mac1_key[NOISE_SYMMETRIC_KEY_LEN]; -+ struct rw_semaphore lock; -+}; -+ -+enum cookie_mac_state { -+ INVALID_MAC, -+ VALID_MAC_BUT_NO_COOKIE, -+ VALID_MAC_WITH_COOKIE_BUT_RATELIMITED, -+ VALID_MAC_WITH_COOKIE -+}; -+ -+void cookie_checker_init(struct cookie_checker *checker, struct wireguard_device *wg); -+void cookie_checker_precompute_device_keys(struct cookie_checker *checker); -+void cookie_checker_precompute_peer_keys(struct wireguard_peer *peer); -+void cookie_init(struct cookie *cookie); -+ -+enum cookie_mac_state cookie_validate_packet(struct cookie_checker *checker, struct sk_buff *skb, bool check_cookie); -+void cookie_add_mac_to_packet(void *message, size_t len, struct wireguard_peer *peer); -+ -+void cookie_message_create(struct message_handshake_cookie *src, struct sk_buff *skb, __le32 index, struct cookie_checker *checker); -+void cookie_message_consume(struct message_handshake_cookie *src, struct wireguard_device *wg); -+ -+#endif /* _WG_COOKIE_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/device.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,64 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_DEVICE_H -+#define _WG_DEVICE_H -+ -+#include "noise.h" -+#include "allowedips.h" -+#include "hashtables.h" -+#include "cookie.h" -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+struct wireguard_device; -+ -+struct multicore_worker { -+ void *ptr; -+ struct work_struct work; -+}; -+ -+struct crypt_queue { -+ struct ptr_ring ring; -+ union { -+ struct { -+ struct multicore_worker __percpu *worker; -+ int last_cpu; -+ }; -+ struct work_struct work; -+ }; -+}; -+ -+struct wireguard_device { -+ struct net_device *dev; -+ struct crypt_queue encrypt_queue, decrypt_queue; -+ struct sock __rcu *sock4, *sock6; -+ struct net *creating_net; -+ struct noise_static_identity static_identity; -+ struct workqueue_struct *handshake_receive_wq, *handshake_send_wq, *packet_crypt_wq; -+ struct sk_buff_head incoming_handshakes; -+ int incoming_handshake_cpu; -+ struct multicore_worker __percpu *incoming_handshakes_worker; -+ struct cookie_checker cookie_checker; -+ struct pubkey_hashtable peer_hashtable; -+ struct index_hashtable index_hashtable; -+ struct allowedips peer_allowedips; -+ struct mutex device_update_lock, socket_update_lock; -+ struct list_head device_list, peer_list; -+ unsigned int num_peers, device_update_gen; -+ u32 fwmark; -+ u16 incoming_port; -+ bool have_creating_net_ref; -+}; -+ -+int device_init(void); -+void device_uninit(void); -+ -+#endif /* _WG_DEVICE_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/hashtables.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,52 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_HASHTABLES_H -+#define _WG_HASHTABLES_H -+ -+#include "messages.h" -+ -+#include -+#include -+#include -+ -+struct wireguard_peer; -+ -+struct pubkey_hashtable { -+ /* TODO: move to rhashtable */ -+ DECLARE_HASHTABLE(hashtable, 11); -+ siphash_key_t key; -+ struct mutex lock; -+}; -+ -+void pubkey_hashtable_init(struct pubkey_hashtable *table); -+void pubkey_hashtable_add(struct pubkey_hashtable *table, struct wireguard_peer *peer); -+void pubkey_hashtable_remove(struct pubkey_hashtable *table, struct wireguard_peer *peer); -+struct wireguard_peer *pubkey_hashtable_lookup(struct pubkey_hashtable *table, const u8 pubkey[NOISE_PUBLIC_KEY_LEN]); -+ -+struct index_hashtable { -+ /* TODO: move to rhashtable */ -+ DECLARE_HASHTABLE(hashtable, 13); -+ spinlock_t lock; -+}; -+ -+enum index_hashtable_type { -+ INDEX_HASHTABLE_HANDSHAKE = 1U << 0, -+ INDEX_HASHTABLE_KEYPAIR = 1U << 1 -+}; -+ -+struct index_hashtable_entry { -+ struct wireguard_peer *peer; -+ struct hlist_node index_hash; -+ enum index_hashtable_type type; -+ __le32 index; -+}; -+void index_hashtable_init(struct index_hashtable *table); -+__le32 index_hashtable_insert(struct index_hashtable *table, struct index_hashtable_entry *entry); -+bool index_hashtable_replace(struct index_hashtable *table, struct index_hashtable_entry *old, struct index_hashtable_entry *new); -+void index_hashtable_remove(struct index_hashtable *table, struct index_hashtable_entry *entry); -+struct index_hashtable_entry *index_hashtable_lookup(struct index_hashtable *table, const enum index_hashtable_type type_mask, const __le32 index); -+ -+#endif /* _WG_HASHTABLES_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/messages.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,128 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+/* -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * -+ * See doc/protocol.md for more info -+ */ -+ -+#ifndef _WG_MESSAGES_H -+#define _WG_MESSAGES_H -+ -+#include "crypto/curve25519.h" -+#include "crypto/chacha20poly1305.h" -+#include "crypto/blake2s.h" -+ -+#include -+#include -+#include -+ -+enum noise_lengths { -+ NOISE_PUBLIC_KEY_LEN = CURVE25519_POINT_SIZE, -+ NOISE_SYMMETRIC_KEY_LEN = CHACHA20POLY1305_KEYLEN, -+ NOISE_TIMESTAMP_LEN = sizeof(u64) + sizeof(u32), -+ NOISE_AUTHTAG_LEN = CHACHA20POLY1305_AUTHTAGLEN, -+ NOISE_HASH_LEN = BLAKE2S_OUTBYTES -+}; -+ -+#define noise_encrypted_len(plain_len) (plain_len + NOISE_AUTHTAG_LEN) -+ -+enum cookie_values { -+ COOKIE_SECRET_MAX_AGE = 2 * 60 * HZ, -+ COOKIE_SECRET_LATENCY = 5 * HZ, -+ COOKIE_NONCE_LEN = XCHACHA20POLY1305_NONCELEN, -+ COOKIE_LEN = 16 -+}; -+ -+enum counter_values { -+ COUNTER_BITS_TOTAL = 2048, -+ COUNTER_REDUNDANT_BITS = BITS_PER_LONG, -+ COUNTER_WINDOW_SIZE = COUNTER_BITS_TOTAL - COUNTER_REDUNDANT_BITS -+}; -+ -+enum limits { -+ REKEY_AFTER_MESSAGES = U64_MAX - 0xffff, -+ REJECT_AFTER_MESSAGES = U64_MAX - COUNTER_WINDOW_SIZE - 1, -+ REKEY_TIMEOUT = 5 * HZ, -+ REKEY_TIMEOUT_JITTER_MAX = HZ / 3, -+ REKEY_AFTER_TIME = 120 * HZ, -+ REJECT_AFTER_TIME = 180 * HZ, -+ INITIATIONS_PER_SECOND = HZ / 50, -+ MAX_PEERS_PER_DEVICE = 1U << 20, -+ KEEPALIVE_TIMEOUT = 10 * HZ, -+ MAX_TIMER_HANDSHAKES = (90 * HZ) / REKEY_TIMEOUT, -+ MAX_QUEUED_INCOMING_HANDSHAKES = 4096, /* TODO: replace this with DQL */ -+ MAX_STAGED_PACKETS = 128, -+ MAX_QUEUED_PACKETS = 1024 /* TODO: replace this with DQL */ -+}; -+ -+enum message_type { -+ MESSAGE_INVALID = 0, -+ MESSAGE_HANDSHAKE_INITIATION = 1, -+ MESSAGE_HANDSHAKE_RESPONSE = 2, -+ MESSAGE_HANDSHAKE_COOKIE = 3, -+ MESSAGE_DATA = 4 -+}; -+ -+struct message_header { -+ /* The actual layout of this that we want is: -+ * u8 type -+ * u8 reserved_zero[3] -+ * -+ * But it turns out that by encoding this as little endian, -+ * we achieve the same thing, and it makes checking faster. -+ */ -+ __le32 type; -+}; -+ -+struct message_macs { -+ u8 mac1[COOKIE_LEN]; -+ u8 mac2[COOKIE_LEN]; -+}; -+ -+struct message_handshake_initiation { -+ struct message_header header; -+ __le32 sender_index; -+ u8 unencrypted_ephemeral[NOISE_PUBLIC_KEY_LEN]; -+ u8 encrypted_static[noise_encrypted_len(NOISE_PUBLIC_KEY_LEN)]; -+ u8 encrypted_timestamp[noise_encrypted_len(NOISE_TIMESTAMP_LEN)]; -+ struct message_macs macs; -+}; -+ -+struct message_handshake_response { -+ struct message_header header; -+ __le32 sender_index; -+ __le32 receiver_index; -+ u8 unencrypted_ephemeral[NOISE_PUBLIC_KEY_LEN]; -+ u8 encrypted_nothing[noise_encrypted_len(0)]; -+ struct message_macs macs; -+}; -+ -+struct message_handshake_cookie { -+ struct message_header header; -+ __le32 receiver_index; -+ u8 nonce[COOKIE_NONCE_LEN]; -+ u8 encrypted_cookie[noise_encrypted_len(COOKIE_LEN)]; -+}; -+ -+struct message_data { -+ struct message_header header; -+ __le32 key_idx; -+ __le64 counter; -+ u8 encrypted_data[]; -+}; -+ -+#define message_data_len(plain_len) (noise_encrypted_len(plain_len) + sizeof(struct message_data)) -+ -+enum message_alignments { -+ MESSAGE_PADDING_MULTIPLE = 16, -+ MESSAGE_MINIMUM_LENGTH = message_data_len(0) -+}; -+ -+#define SKB_HEADER_LEN (max(sizeof(struct iphdr), sizeof(struct ipv6hdr)) + sizeof(struct udphdr) + NET_SKB_PAD) -+#define DATA_PACKET_HEAD_ROOM ALIGN(sizeof(struct message_data) + SKB_HEADER_LEN, 4) -+ -+enum { -+ HANDSHAKE_DSCP = 0x88 /* AF41, plus 00 ECN */ -+}; -+ -+#endif /* _WG_MESSAGES_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/netlink.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,12 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_NETLINK_H -+#define _WG_NETLINK_H -+ -+int genetlink_init(void); -+void genetlink_uninit(void); -+ -+#endif /* _WG_NETLINK_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/noise.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,117 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * -+ * See doc/protocol.md and https://github.com/trevp/noise/blob/master/noise.md for more info -+ */ -+ -+#ifndef _WG_NOISE_H -+#define _WG_NOISE_H -+ -+#include "messages.h" -+#include "hashtables.h" -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+union noise_counter { -+ struct { -+ u64 counter; -+ unsigned long backtrack[COUNTER_BITS_TOTAL / BITS_PER_LONG]; -+ spinlock_t lock; -+ } receive; -+ atomic64_t counter; -+}; -+ -+struct noise_symmetric_key { -+ u8 key[NOISE_SYMMETRIC_KEY_LEN]; -+ union noise_counter counter; -+ u64 birthdate; -+ bool is_valid; -+}; -+ -+struct noise_keypair { -+ struct index_hashtable_entry entry; -+ struct noise_symmetric_key sending; -+ struct noise_symmetric_key receiving; -+ __le32 remote_index; -+ bool i_am_the_initiator; -+ struct kref refcount; -+ struct rcu_head rcu; -+ u64 internal_id; -+}; -+ -+struct noise_keypairs { -+ struct noise_keypair __rcu *current_keypair; -+ struct noise_keypair __rcu *previous_keypair; -+ struct noise_keypair __rcu *next_keypair; -+ spinlock_t keypair_update_lock; -+}; -+ -+struct noise_static_identity { -+ u8 static_public[NOISE_PUBLIC_KEY_LEN]; -+ u8 static_private[NOISE_PUBLIC_KEY_LEN]; -+ struct rw_semaphore lock; -+ bool has_identity; -+}; -+ -+enum noise_handshake_state { -+ HANDSHAKE_ZEROED, -+ HANDSHAKE_CREATED_INITIATION, -+ HANDSHAKE_CONSUMED_INITIATION, -+ HANDSHAKE_CREATED_RESPONSE, -+ HANDSHAKE_CONSUMED_RESPONSE -+}; -+ -+struct noise_handshake { -+ struct index_hashtable_entry entry; -+ -+ enum noise_handshake_state state; -+ u64 last_initiation_consumption; -+ -+ struct noise_static_identity *static_identity; -+ -+ u8 ephemeral_private[NOISE_PUBLIC_KEY_LEN]; -+ u8 remote_static[NOISE_PUBLIC_KEY_LEN]; -+ u8 remote_ephemeral[NOISE_PUBLIC_KEY_LEN]; -+ u8 precomputed_static_static[NOISE_PUBLIC_KEY_LEN]; -+ -+ u8 preshared_key[NOISE_SYMMETRIC_KEY_LEN]; -+ -+ u8 hash[NOISE_HASH_LEN]; -+ u8 chaining_key[NOISE_HASH_LEN]; -+ -+ u8 latest_timestamp[NOISE_TIMESTAMP_LEN]; -+ __le32 remote_index; -+ -+ /* Protects all members except the immutable (after noise_handshake_init): remote_static, precomputed_static_static, static_identity */ -+ struct rw_semaphore lock; -+}; -+ -+struct wireguard_device; -+ -+void noise_init(void); -+bool noise_handshake_init(struct noise_handshake *handshake, struct noise_static_identity *static_identity, const u8 peer_public_key[NOISE_PUBLIC_KEY_LEN], const u8 peer_preshared_key[NOISE_SYMMETRIC_KEY_LEN], struct wireguard_peer *peer); -+void noise_handshake_clear(struct noise_handshake *handshake); -+void noise_keypair_put(struct noise_keypair *keypair); -+struct noise_keypair *noise_keypair_get(struct noise_keypair *keypair); -+void noise_keypairs_clear(struct noise_keypairs *keypairs); -+bool noise_received_with_keypair(struct noise_keypairs *keypairs, struct noise_keypair *received_keypair); -+ -+void noise_set_static_identity_private_key(struct noise_static_identity *static_identity, const u8 private_key[NOISE_PUBLIC_KEY_LEN]); -+bool noise_precompute_static_static(struct wireguard_peer *peer); -+ -+bool noise_handshake_create_initiation(struct message_handshake_initiation *dst, struct noise_handshake *handshake); -+struct wireguard_peer *noise_handshake_consume_initiation(struct message_handshake_initiation *src, struct wireguard_device *wg); -+ -+bool noise_handshake_create_response(struct message_handshake_response *dst, struct noise_handshake *handshake); -+struct wireguard_peer *noise_handshake_consume_response(struct message_handshake_response *src, struct wireguard_device *wg); -+ -+bool noise_handshake_begin_session(struct noise_handshake *handshake, struct noise_keypairs *keypairs); -+ -+#endif /* _WG_NOISE_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/peer.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,73 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_PEER_H -+#define _WG_PEER_H -+ -+#include "device.h" -+#include "noise.h" -+#include "cookie.h" -+ -+#include -+#include -+#include -+#include -+#include -+ -+struct wireguard_device; -+ -+struct endpoint { -+ union { -+ struct sockaddr addr; -+ struct sockaddr_in addr4; -+ struct sockaddr_in6 addr6; -+ }; -+ union { -+ struct { -+ struct in_addr src4; -+ int src_if4; /* Essentially the same as addr6->scope_id */ -+ }; -+ struct in6_addr src6; -+ }; -+}; -+ -+struct wireguard_peer { -+ struct wireguard_device *device; -+ struct crypt_queue tx_queue, rx_queue; -+ struct sk_buff_head staged_packet_queue; -+ int serial_work_cpu; -+ struct noise_keypairs keypairs; -+ struct endpoint endpoint; -+ struct dst_cache endpoint_cache; -+ rwlock_t endpoint_lock; -+ struct noise_handshake handshake; -+ u64 last_sent_handshake; -+ struct work_struct transmit_handshake_work, clear_peer_work; -+ struct cookie latest_cookie; -+ struct hlist_node pubkey_hash; -+ u64 rx_bytes, tx_bytes; -+ struct timer_list timer_retransmit_handshake, timer_send_keepalive, timer_new_handshake, timer_zero_key_material, timer_persistent_keepalive; -+ unsigned int timer_handshake_attempts; -+ unsigned long persistent_keepalive_interval; -+ bool timers_enabled, timer_need_another_keepalive, sent_lastminute_handshake; -+ struct timespec walltime_last_handshake; -+ struct kref refcount; -+ struct rcu_head rcu; -+ struct list_head peer_list; -+ u64 internal_id; -+}; -+ -+struct wireguard_peer *peer_create(struct wireguard_device *wg, const u8 public_key[NOISE_PUBLIC_KEY_LEN], const u8 preshared_key[NOISE_SYMMETRIC_KEY_LEN]); -+ -+struct wireguard_peer *peer_get(struct wireguard_peer *peer); -+struct wireguard_peer *peer_rcu_get(struct wireguard_peer *peer); -+ -+void peer_put(struct wireguard_peer *peer); -+void peer_remove(struct wireguard_peer *peer); -+void peer_remove_all(struct wireguard_device *wg); -+ -+struct wireguard_peer *peer_lookup_by_index(struct wireguard_device *wg, u32 index); -+ -+#endif /* _WG_PEER_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/queueing.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,142 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_QUEUEING_H -+#define _WG_QUEUEING_H -+ -+#include "peer.h" -+#include -+#include -+#include -+#include -+ -+struct wireguard_device; -+struct wireguard_peer; -+struct multicore_worker; -+struct crypt_queue; -+struct sk_buff; -+ -+/* queueing.c APIs: */ -+int packet_queue_init(struct crypt_queue *queue, work_func_t function, bool multicore, unsigned int len); -+void packet_queue_free(struct crypt_queue *queue, bool multicore); -+struct multicore_worker __percpu *packet_alloc_percpu_multicore_worker(work_func_t function, void *ptr); -+ -+/* receive.c APIs: */ -+void packet_receive(struct wireguard_device *wg, struct sk_buff *skb); -+void packet_handshake_receive_worker(struct work_struct *work); -+/* Workqueue workers: */ -+void packet_rx_worker(struct work_struct *work); -+void packet_decrypt_worker(struct work_struct *work); -+ -+/* send.c APIs: */ -+void packet_send_queued_handshake_initiation(struct wireguard_peer *peer, bool is_retry); -+void packet_send_handshake_response(struct wireguard_peer *peer); -+void packet_send_handshake_cookie(struct wireguard_device *wg, struct sk_buff *initiating_skb, __le32 sender_index); -+void packet_send_keepalive(struct wireguard_peer *peer); -+void packet_send_staged_packets(struct wireguard_peer *peer); -+/* Workqueue workers: */ -+void packet_handshake_send_worker(struct work_struct *work); -+void packet_tx_worker(struct work_struct *work); -+void packet_encrypt_worker(struct work_struct *work); -+ -+enum packet_state { PACKET_STATE_UNCRYPTED, PACKET_STATE_CRYPTED, PACKET_STATE_DEAD }; -+struct packet_cb { -+ u64 nonce; -+ struct noise_keypair *keypair; -+ atomic_t state; -+ u8 ds; -+}; -+#define PACKET_PEER(skb) (((struct packet_cb *)skb->cb)->keypair->entry.peer) -+#define PACKET_CB(skb) ((struct packet_cb *)skb->cb) -+ -+/* Returns either the correct skb->protocol value, or 0 if invalid. */ -+static inline __be16 skb_examine_untrusted_ip_hdr(struct sk_buff *skb) -+{ -+ if (skb_network_header(skb) >= skb->head && (skb_network_header(skb) + sizeof(struct iphdr)) <= skb_tail_pointer(skb) && ip_hdr(skb)->version == 4) -+ return htons(ETH_P_IP); -+ if (skb_network_header(skb) >= skb->head && (skb_network_header(skb) + sizeof(struct ipv6hdr)) <= skb_tail_pointer(skb) && ipv6_hdr(skb)->version == 6) -+ return htons(ETH_P_IPV6); -+ return 0; -+} -+ -+static inline void skb_reset(struct sk_buff *skb) -+{ -+ skb_scrub_packet(skb, true); -+ memset(&skb->headers_start, 0, offsetof(struct sk_buff, headers_end) - offsetof(struct sk_buff, headers_start)); -+ skb->queue_mapping = 0; -+ skb->nohdr = 0; -+ skb->peeked = 0; -+ skb->mac_len = 0; -+ skb->dev = NULL; -+#ifdef CONFIG_NET_SCHED -+ skb->tc_index = 0; -+ skb_reset_tc(skb); -+#endif -+ skb->hdr_len = skb_headroom(skb); -+ skb_reset_mac_header(skb); -+ skb_reset_network_header(skb); -+ skb_probe_transport_header(skb, 0); -+ skb_reset_inner_headers(skb); -+} -+ -+static inline int cpumask_choose_online(int *stored_cpu, unsigned int id) -+{ -+ unsigned int cpu = *stored_cpu, cpu_index, i; -+ -+ if (unlikely(cpu == nr_cpumask_bits || !cpumask_test_cpu(cpu, cpu_online_mask))) { -+ cpu_index = id % cpumask_weight(cpu_online_mask); -+ cpu = cpumask_first(cpu_online_mask); -+ for (i = 0; i < cpu_index; ++i) -+ cpu = cpumask_next(cpu, cpu_online_mask); -+ *stored_cpu = cpu; -+ } -+ return cpu; -+} -+ -+/* This function is racy, in the sense that next is unlocked, so it could return -+ * the same CPU twice. A race-free version of this would be to instead store an -+ * atomic sequence number, do an increment-and-return, and then iterate through -+ * every possible CPU until we get to that index -- choose_cpu. However that's -+ * a bit slower, and it doesn't seem like this potential race actually introduces -+ * any performance loss, so we live with it. -+ */ -+static inline int cpumask_next_online(int *next) -+{ -+ int cpu = *next; -+ -+ while (unlikely(!cpumask_test_cpu(cpu, cpu_online_mask))) -+ cpu = cpumask_next(cpu, cpu_online_mask) % nr_cpumask_bits; -+ *next = cpumask_next(cpu, cpu_online_mask) % nr_cpumask_bits; -+ return cpu; -+} -+ -+static inline int queue_enqueue_per_device_and_peer(struct crypt_queue *device_queue, struct crypt_queue *peer_queue, struct sk_buff *skb, struct workqueue_struct *wq, int *next_cpu) -+{ -+ int cpu; -+ -+ atomic_set(&PACKET_CB(skb)->state, PACKET_STATE_UNCRYPTED); -+ if (unlikely(ptr_ring_produce_bh(&peer_queue->ring, skb))) -+ return -ENOSPC; -+ cpu = cpumask_next_online(next_cpu); -+ if (unlikely(ptr_ring_produce_bh(&device_queue->ring, skb))) -+ return -EPIPE; -+ queue_work_on(cpu, wq, &per_cpu_ptr(device_queue->worker, cpu)->work); -+ return 0; -+} -+ -+static inline void queue_enqueue_per_peer(struct crypt_queue *queue, struct sk_buff *skb, enum packet_state state) -+{ -+ struct wireguard_peer *peer = peer_rcu_get(PACKET_PEER(skb)); -+ -+ atomic_set(&PACKET_CB(skb)->state, state); -+ queue_work_on(cpumask_choose_online(&peer->serial_work_cpu, peer->internal_id), peer->device->packet_crypt_wq, &queue->work); -+ peer_put(peer); -+} -+ -+#ifdef DEBUG -+bool packet_counter_selftest(void); -+#endif -+ -+#endif /* _WG_QUEUEING_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/ratelimiter.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,19 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_RATELIMITER_H -+#define _WG_RATELIMITER_H -+ -+#include -+ -+int ratelimiter_init(void); -+void ratelimiter_uninit(void); -+bool ratelimiter_allow(struct sk_buff *skb, struct net *net); -+ -+#ifdef DEBUG -+bool ratelimiter_selftest(void); -+#endif -+ -+#endif /* _WG_RATELIMITER_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/socket.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,35 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_SOCKET_H -+#define _WG_SOCKET_H -+ -+#include -+#include -+#include -+#include -+ -+int socket_init(struct wireguard_device *wg, u16 port); -+void socket_reinit(struct wireguard_device *wg, struct sock *new4, struct sock *new6); -+int socket_send_buffer_to_peer(struct wireguard_peer *peer, void *data, size_t len, u8 ds); -+int socket_send_skb_to_peer(struct wireguard_peer *peer, struct sk_buff *skb, u8 ds); -+int socket_send_buffer_as_reply_to_skb(struct wireguard_device *wg, struct sk_buff *in_skb, void *out_buffer, size_t len); -+ -+int socket_endpoint_from_skb(struct endpoint *endpoint, const struct sk_buff *skb); -+void socket_set_peer_endpoint(struct wireguard_peer *peer, const struct endpoint *endpoint); -+void socket_set_peer_endpoint_from_skb(struct wireguard_peer *peer, const struct sk_buff *skb); -+void socket_clear_peer_endpoint_src(struct wireguard_peer *peer); -+ -+#if defined(CONFIG_DYNAMIC_DEBUG) || defined(DEBUG) -+#define net_dbg_skb_ratelimited(fmt, dev, skb, ...) do { \ -+ struct endpoint __endpoint; \ -+ socket_endpoint_from_skb(&__endpoint, skb); \ -+ net_dbg_ratelimited(fmt, dev, &__endpoint.addr, ##__VA_ARGS__); \ -+} while (0) -+#else -+#define net_dbg_skb_ratelimited(fmt, skb, ...) -+#endif -+ -+#endif /* _WG_SOCKET_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/timers.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,21 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_TIMERS_H -+#define _WG_TIMERS_H -+ -+struct wireguard_peer; -+ -+void timers_init(struct wireguard_peer *peer); -+void timers_stop(struct wireguard_peer *peer); -+void timers_data_sent(struct wireguard_peer *peer); -+void timers_data_received(struct wireguard_peer *peer); -+void timers_any_authenticated_packet_received(struct wireguard_peer *peer); -+void timers_handshake_initiated(struct wireguard_peer *peer); -+void timers_handshake_complete(struct wireguard_peer *peer); -+void timers_session_derived(struct wireguard_peer *peer); -+void timers_any_authenticated_packet_traversal(struct wireguard_peer *peer); -+ -+#endif /* _WG_TIMERS_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/version.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1 @@ -+#define WIREGUARD_VERSION "0.0.20180304" ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/uapi/wireguard.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,182 @@ -+/* SPDX-License-Identifier: ((GPL-2.0 WITH Linux-syscall-note) OR MIT) -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * -+ * Documentation -+ * ============= -+ * -+ * The below enums and macros are for interfacing with WireGuard, using generic -+ * netlink, with family WG_GENL_NAME and version WG_GENL_VERSION. It defines two -+ * methods: get and set. Note that while they share many common attributes, these -+ * two functions actually accept a slightly different set of inputs and outputs. -+ * -+ * WG_CMD_GET_DEVICE -+ * ----------------- -+ * -+ * May only be called via NLM_F_REQUEST | NLM_F_DUMP. The command should contain -+ * one but not both of: -+ * -+ * WGDEVICE_A_IFINDEX: NLA_U32 -+ * WGDEVICE_A_IFNAME: NLA_NUL_STRING, maxlen IFNAMESIZ - 1 -+ * -+ * The kernel will then return several messages (NLM_F_MULTI) containing the following -+ * tree of nested items: -+ * -+ * WGDEVICE_A_IFINDEX: NLA_U32 -+ * WGDEVICE_A_IFNAME: NLA_NUL_STRING, maxlen IFNAMESIZ - 1 -+ * WGDEVICE_A_PRIVATE_KEY: len WG_KEY_LEN -+ * WGDEVICE_A_PUBLIC_KEY: len WG_KEY_LEN -+ * WGDEVICE_A_LISTEN_PORT: NLA_U16 -+ * WGDEVICE_A_FWMARK: NLA_U32 -+ * WGDEVICE_A_PEERS: NLA_NESTED -+ * 0: NLA_NESTED -+ * WGPEER_A_PUBLIC_KEY: len WG_KEY_LEN -+ * WGPEER_A_PRESHARED_KEY: len WG_KEY_LEN -+ * WGPEER_A_ENDPOINT: struct sockaddr_in or struct sockaddr_in6 -+ * WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL: NLA_U16 -+ * WGPEER_A_LAST_HANDSHAKE_TIME: struct timespec -+ * WGPEER_A_RX_BYTES: NLA_U64 -+ * WGPEER_A_TX_BYTES: NLA_U64 -+ * WGPEER_A_ALLOWEDIPS: NLA_NESTED -+ * 0: NLA_NESTED -+ * WGALLOWEDIP_A_FAMILY: NLA_U16 -+ * WGALLOWEDIP_A_IPADDR: struct in_addr or struct in6_addr -+ * WGALLOWEDIP_A_CIDR_MASK: NLA_U8 -+ * 1: NLA_NESTED -+ * ... -+ * 2: NLA_NESTED -+ * ... -+ * ... -+ * 1: NLA_NESTED -+ * ... -+ * ... -+ * -+ * It is possible that all of the allowed IPs of a single peer will not -+ * fit within a single netlink message. In that case, the same peer will -+ * be written in the following message, except it will only contain -+ * WGPEER_A_PUBLIC_KEY and WGPEER_A_ALLOWEDIPS. This may occur several -+ * times in a row for the same peer. It is then up to the receiver to -+ * coalesce adjacent peers. Likewise, it is possible that all peers will -+ * not fit within a single message. So, subsequent peers will be sent -+ * in following messages, except those will only contain WGDEVICE_A_IFNAME -+ * and WGDEVICE_A_PEERS. It is then up to the receiver to coalesce these -+ * messages to form the complete list of peers. -+ * -+ * Since this is an NLA_F_DUMP command, the final message will always be -+ * NLMSG_DONE, even if an error occurs. However, this NLMSG_DONE message -+ * contains an integer error code. It is either zero or a negative error -+ * code corresponding to the errno. -+ * -+ * WG_CMD_SET_DEVICE -+ * ----------------- -+ * -+ * May only be called via NLM_F_REQUEST. The command should contain the following -+ * tree of nested items, containing one but not both of WGDEVICE_A_IFINDEX -+ * and WGDEVICE_A_IFNAME: -+ * -+ * WGDEVICE_A_IFINDEX: NLA_U32 -+ * WGDEVICE_A_IFNAME: NLA_NUL_STRING, maxlen IFNAMESIZ - 1 -+ * WGDEVICE_A_FLAGS: NLA_U32, 0 or WGDEVICE_F_REPLACE_PEERS if all current -+ * peers should be removed prior to adding the list below. -+ * WGDEVICE_A_PRIVATE_KEY: len WG_KEY_LEN, all zeros to remove -+ * WGDEVICE_A_LISTEN_PORT: NLA_U16, 0 to choose randomly -+ * WGDEVICE_A_FWMARK: NLA_U32, 0 to disable -+ * WGDEVICE_A_PEERS: NLA_NESTED -+ * 0: NLA_NESTED -+ * WGPEER_A_PUBLIC_KEY: len WG_KEY_LEN -+ * WGPEER_A_FLAGS: NLA_U32, 0 and/or WGPEER_F_REMOVE_ME if the specified peer -+ * should be removed rather than added/updated and/or -+ * WGPEER_F_REPLACE_ALLOWEDIPS if all current allowed IPs of -+ * this peer should be removed prior to adding the list below. -+ * WGPEER_A_PRESHARED_KEY: len WG_KEY_LEN, all zeros to remove -+ * WGPEER_A_ENDPOINT: struct sockaddr_in or struct sockaddr_in6 -+ * WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL: NLA_U16, 0 to disable -+ * WGPEER_A_ALLOWEDIPS: NLA_NESTED -+ * 0: NLA_NESTED -+ * WGALLOWEDIP_A_FAMILY: NLA_U16 -+ * WGALLOWEDIP_A_IPADDR: struct in_addr or struct in6_addr -+ * WGALLOWEDIP_A_CIDR_MASK: NLA_U8 -+ * 1: NLA_NESTED -+ * ... -+ * 2: NLA_NESTED -+ * ... -+ * ... -+ * 1: NLA_NESTED -+ * ... -+ * ... -+ * -+ * It is possible that the amount of configuration data exceeds that of -+ * the maximum message length accepted by the kernel. In that case, -+ * several messages should be sent one after another, with each -+ * successive one filling in information not contained in the prior. Note -+ * that if WGDEVICE_F_REPLACE_PEERS is specified in the first message, it -+ * probably should not be specified in fragments that come after, so that -+ * the list of peers is only cleared the first time but appened after. -+ * Likewise for peers, if WGPEER_F_REPLACE_ALLOWEDIPS is specified in the -+ * first message of a peer, it likely should not be specified in subsequent -+ * fragments. -+ * -+ * If an error occurs, NLMSG_ERROR will reply containing an errno. -+ */ -+ -+#ifndef _WG_UAPI_WIREGUARD_H -+#define _WG_UAPI_WIREGUARD_H -+ -+#define WG_GENL_NAME "wireguard" -+#define WG_GENL_VERSION 1 -+ -+#define WG_KEY_LEN 32 -+ -+enum wg_cmd { -+ WG_CMD_GET_DEVICE, -+ WG_CMD_SET_DEVICE, -+ __WG_CMD_MAX -+}; -+#define WG_CMD_MAX (__WG_CMD_MAX - 1) -+ -+enum wgdevice_flag { -+ WGDEVICE_F_REPLACE_PEERS = 1U << 0 -+}; -+enum wgdevice_attribute { -+ WGDEVICE_A_UNSPEC, -+ WGDEVICE_A_IFINDEX, -+ WGDEVICE_A_IFNAME, -+ WGDEVICE_A_PRIVATE_KEY, -+ WGDEVICE_A_PUBLIC_KEY, -+ WGDEVICE_A_FLAGS, -+ WGDEVICE_A_LISTEN_PORT, -+ WGDEVICE_A_FWMARK, -+ WGDEVICE_A_PEERS, -+ __WGDEVICE_A_LAST -+}; -+#define WGDEVICE_A_MAX (__WGDEVICE_A_LAST - 1) -+ -+enum wgpeer_flag { -+ WGPEER_F_REMOVE_ME = 1U << 0, -+ WGPEER_F_REPLACE_ALLOWEDIPS = 1U << 1 -+}; -+enum wgpeer_attribute { -+ WGPEER_A_UNSPEC, -+ WGPEER_A_PUBLIC_KEY, -+ WGPEER_A_PRESHARED_KEY, -+ WGPEER_A_FLAGS, -+ WGPEER_A_ENDPOINT, -+ WGPEER_A_PERSISTENT_KEEPALIVE_INTERVAL, -+ WGPEER_A_LAST_HANDSHAKE_TIME, -+ WGPEER_A_RX_BYTES, -+ WGPEER_A_TX_BYTES, -+ WGPEER_A_ALLOWEDIPS, -+ __WGPEER_A_LAST -+}; -+#define WGPEER_A_MAX (__WGPEER_A_LAST - 1) -+ -+enum wgallowedip_attribute { -+ WGALLOWEDIP_A_UNSPEC, -+ WGALLOWEDIP_A_FAMILY, -+ WGALLOWEDIP_A_IPADDR, -+ WGALLOWEDIP_A_CIDR_MASK, -+ __WGALLOWEDIP_A_LAST -+}; -+#define WGALLOWEDIP_A_MAX (__WGALLOWEDIP_A_LAST - 1) -+ -+#endif /* _WG_UAPI_WIREGUARD_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/selftest/allowedips.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,514 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifdef DEBUG -+ -+#ifdef DEBUG_PRINT_TRIE_GRAPHVIZ -+#include -+static __init void print_node(struct allowedips_node *node, u8 bits) -+{ -+ u32 color = 0; -+ char *style = "dotted"; -+ char *fmt_connection = KERN_DEBUG "\t\"%p/%d\" -> \"%p/%d\";\n"; -+ char *fmt_declaration = KERN_DEBUG "\t\"%p/%d\"[style=%s, color=\"#%06x\"];\n"; -+ if (bits == 32) { -+ fmt_connection = KERN_DEBUG "\t\"%pI4/%d\" -> \"%pI4/%d\";\n"; -+ fmt_declaration = KERN_DEBUG "\t\"%pI4/%d\"[style=%s, color=\"#%06x\"];\n"; -+ } else if (bits == 128) { -+ fmt_connection = KERN_DEBUG "\t\"%pI6/%d\" -> \"%pI6/%d\";\n"; -+ fmt_declaration = KERN_DEBUG "\t\"%pI6/%d\"[style=%s, color=\"#%06x\"];\n"; -+ } -+ if (node->peer) { -+ hsiphash_key_t key = { 0 }; -+ memcpy(&key, &node->peer, sizeof(node->peer)); -+ color = hsiphash_1u32(0xdeadbeef, &key) % 200 << 16 | hsiphash_1u32(0xbabecafe, &key) % 200 << 8 | hsiphash_1u32(0xabad1dea, &key) % 200; -+ style = "bold"; -+ } -+ printk(fmt_declaration, node->bits, node->cidr, style, color); -+ if (node->bit[0]) { -+ printk(fmt_connection, node->bits, node->cidr, node->bit[0]->bits, node->bit[0]->cidr); -+ print_node(node->bit[0], bits); -+ } -+ if (node->bit[1]) { -+ printk(fmt_connection, node->bits, node->cidr, node->bit[1]->bits, node->bit[1]->cidr); -+ print_node(node->bit[1], bits); -+ } -+} -+static __init void print_tree(struct allowedips_node *top, u8 bits) -+{ -+ printk(KERN_DEBUG "digraph trie {\n"); -+ print_node(top, bits); -+ printk(KERN_DEBUG "}\n"); -+} -+#endif -+ -+#ifdef DEBUG_RANDOM_TRIE -+#define NUM_PEERS 2000 -+#define NUM_RAND_ROUTES 400 -+#define NUM_MUTATED_ROUTES 100 -+#define NUM_QUERIES (NUM_RAND_ROUTES * NUM_MUTATED_ROUTES * 30) -+#include -+struct horrible_allowedips { -+ struct hlist_head head; -+}; -+struct horrible_allowedips_node { -+ struct hlist_node table; -+ union nf_inet_addr ip; -+ union nf_inet_addr mask; -+ uint8_t ip_version; -+ void *value; -+}; -+static __init void horrible_allowedips_init(struct horrible_allowedips *table) -+{ -+ INIT_HLIST_HEAD(&table->head); -+} -+static __init void horrible_allowedips_free(struct horrible_allowedips *table) -+{ -+ struct hlist_node *h; -+ struct horrible_allowedips_node *node; -+ hlist_for_each_entry_safe(node, h, &table->head, table) { -+ hlist_del(&node->table); -+ kfree(node); -+ } -+} -+static __init inline union nf_inet_addr horrible_cidr_to_mask(uint8_t cidr) -+{ -+ union nf_inet_addr mask; -+ memset(&mask, 0x00, 128 / 8); -+ memset(&mask, 0xff, cidr / 8); -+ if (cidr % 32) -+ mask.all[cidr / 32] = htonl((0xFFFFFFFFUL << (32 - (cidr % 32))) & 0xFFFFFFFFUL); -+ return mask; -+} -+static __init inline uint8_t horrible_mask_to_cidr(union nf_inet_addr subnet) -+{ -+ return hweight32(subnet.all[0]) -+ + hweight32(subnet.all[1]) -+ + hweight32(subnet.all[2]) -+ + hweight32(subnet.all[3]); -+} -+static __init inline void horrible_mask_self(struct horrible_allowedips_node *node) -+{ -+ if (node->ip_version == 4) -+ node->ip.ip &= node->mask.ip; -+ else if (node->ip_version == 6) { -+ node->ip.ip6[0] &= node->mask.ip6[0]; -+ node->ip.ip6[1] &= node->mask.ip6[1]; -+ node->ip.ip6[2] &= node->mask.ip6[2]; -+ node->ip.ip6[3] &= node->mask.ip6[3]; -+ } -+} -+static __init inline bool horrible_match_v4(const struct horrible_allowedips_node *node, struct in_addr *ip) -+{ -+ return (ip->s_addr & node->mask.ip) == node->ip.ip; -+} -+static __init inline bool horrible_match_v6(const struct horrible_allowedips_node *node, struct in6_addr *ip) -+{ -+ return (ip->in6_u.u6_addr32[0] & node->mask.ip6[0]) == node->ip.ip6[0] && -+ (ip->in6_u.u6_addr32[1] & node->mask.ip6[1]) == node->ip.ip6[1] && -+ (ip->in6_u.u6_addr32[2] & node->mask.ip6[2]) == node->ip.ip6[2] && -+ (ip->in6_u.u6_addr32[3] & node->mask.ip6[3]) == node->ip.ip6[3]; -+} -+static __init void horrible_insert_ordered(struct horrible_allowedips *table, struct horrible_allowedips_node *node) -+{ -+ struct horrible_allowedips_node *other = NULL, *where = NULL; -+ uint8_t my_cidr = horrible_mask_to_cidr(node->mask); -+ hlist_for_each_entry(other, &table->head, table) { -+ if (!memcmp(&other->mask, &node->mask, sizeof(union nf_inet_addr)) && -+ !memcmp(&other->ip, &node->ip, sizeof(union nf_inet_addr)) && -+ other->ip_version == node->ip_version) { -+ other->value = node->value; -+ kfree(node); -+ return; -+ } -+ where = other; -+ if (horrible_mask_to_cidr(other->mask) <= my_cidr) -+ break; -+ } -+ if (!other && !where) -+ hlist_add_head(&node->table, &table->head); -+ else if (!other) -+ hlist_add_behind(&node->table, &where->table); -+ else -+ hlist_add_before(&node->table, &where->table); -+} -+static __init int horrible_allowedips_insert_v4(struct horrible_allowedips *table, struct in_addr *ip, uint8_t cidr, void *value) -+{ -+ struct horrible_allowedips_node *node = kzalloc(sizeof(struct horrible_allowedips_node), GFP_KERNEL); -+ if (!node) -+ return -ENOMEM; -+ node->ip.in = *ip; -+ node->mask = horrible_cidr_to_mask(cidr); -+ node->ip_version = 4; -+ node->value = value; -+ horrible_mask_self(node); -+ horrible_insert_ordered(table, node); -+ return 0; -+} -+static __init int horrible_allowedips_insert_v6(struct horrible_allowedips *table, struct in6_addr *ip, uint8_t cidr, void *value) -+{ -+ struct horrible_allowedips_node *node = kzalloc(sizeof(struct horrible_allowedips_node), GFP_KERNEL); -+ if (!node) -+ return -ENOMEM; -+ node->ip.in6 = *ip; -+ node->mask = horrible_cidr_to_mask(cidr); -+ node->ip_version = 6; -+ node->value = value; -+ horrible_mask_self(node); -+ horrible_insert_ordered(table, node); -+ return 0; -+} -+static __init void *horrible_allowedips_lookup_v4(struct horrible_allowedips *table, struct in_addr *ip) -+{ -+ struct horrible_allowedips_node *node; -+ void *ret = NULL; -+ hlist_for_each_entry(node, &table->head, table) { -+ if (node->ip_version != 4) -+ continue; -+ if (horrible_match_v4(node, ip)) { -+ ret = node->value; -+ break; -+ } -+ } -+ return ret; -+} -+static __init void *horrible_allowedips_lookup_v6(struct horrible_allowedips *table, struct in6_addr *ip) -+{ -+ struct horrible_allowedips_node *node; -+ void *ret = NULL; -+ hlist_for_each_entry(node, &table->head, table) { -+ if (node->ip_version != 6) -+ continue; -+ if (horrible_match_v6(node, ip)) { -+ ret = node->value; -+ break; -+ } -+ } -+ return ret; -+} -+ -+static __init bool randomized_test(void) -+{ -+ DEFINE_MUTEX(mutex); -+ bool ret = false; -+ unsigned int i, j, k, mutate_amount, cidr; -+ struct wireguard_peer **peers, *peer; -+ struct allowedips t; -+ struct horrible_allowedips h; -+ u8 ip[16], mutate_mask[16], mutated[16]; -+ -+ allowedips_init(&t); -+ horrible_allowedips_init(&h); -+ -+ peers = kcalloc(NUM_PEERS, sizeof(struct wireguard_peer *), GFP_KERNEL); -+ if (!peers) { -+ pr_info("allowedips random self-test: out of memory\n"); -+ goto free; -+ } -+ for (i = 0; i < NUM_PEERS; ++i) { -+ peers[i] = kzalloc(sizeof(struct wireguard_peer), GFP_KERNEL); -+ if (!peers[i]) { -+ pr_info("allowedips random self-test: out of memory\n"); -+ goto free; -+ } -+ kref_init(&peers[i]->refcount); -+ } -+ -+ for (i = 0; i < NUM_RAND_ROUTES; ++i) { -+ prandom_bytes(ip, 4); -+ cidr = prandom_u32_max(32) + 1; -+ peer = peers[prandom_u32_max(NUM_PEERS)]; -+ if (allowedips_insert_v4(&t, (struct in_addr *)ip, cidr, peer, &mutex) < 0) { -+ pr_info("allowedips random self-test: out of memory\n"); -+ goto free; -+ } -+ if (horrible_allowedips_insert_v4(&h, (struct in_addr *)ip, cidr, peer) < 0) { -+ pr_info("allowedips random self-test: out of memory\n"); -+ goto free; -+ } -+ for (j = 0; j < NUM_MUTATED_ROUTES; ++j) { -+ memcpy(mutated, ip, 4); -+ prandom_bytes(mutate_mask, 4); -+ mutate_amount = prandom_u32_max(32); -+ for (k = 0; k < mutate_amount / 8; ++k) -+ mutate_mask[k] = 0xff; -+ mutate_mask[k] = 0xff << ((8 - (mutate_amount % 8)) % 8); -+ for (; k < 4; ++k) -+ mutate_mask[k] = 0; -+ for (k = 0; k < 4; ++k) -+ mutated[k] = (mutated[k] & mutate_mask[k]) | (~mutate_mask[k] & prandom_u32_max(256)); -+ cidr = prandom_u32_max(32) + 1; -+ peer = peers[prandom_u32_max(NUM_PEERS)]; -+ if (allowedips_insert_v4(&t, (struct in_addr *)mutated, cidr, peer, &mutex) < 0) { -+ pr_info("allowedips random self-test: out of memory\n"); -+ goto free; -+ } -+ if (horrible_allowedips_insert_v4(&h, (struct in_addr *)mutated, cidr, peer)) { -+ pr_info("allowedips random self-test: out of memory\n"); -+ goto free; -+ } -+ } -+ } -+ -+ for (i = 0; i < NUM_RAND_ROUTES; ++i) { -+ prandom_bytes(ip, 16); -+ cidr = prandom_u32_max(128) + 1; -+ peer = peers[prandom_u32_max(NUM_PEERS)]; -+ if (allowedips_insert_v6(&t, (struct in6_addr *)ip, cidr, peer, &mutex) < 0) { -+ pr_info("allowedips random self-test: out of memory\n"); -+ goto free; -+ } -+ if (horrible_allowedips_insert_v6(&h, (struct in6_addr *)ip, cidr, peer) < 0) { -+ pr_info("allowedips random self-test: out of memory\n"); -+ goto free; -+ } -+ for (j = 0; j < NUM_MUTATED_ROUTES; ++j) { -+ memcpy(mutated, ip, 16); -+ prandom_bytes(mutate_mask, 16); -+ mutate_amount = prandom_u32_max(128); -+ for (k = 0; k < mutate_amount / 8; ++k) -+ mutate_mask[k] = 0xff; -+ mutate_mask[k] = 0xff << ((8 - (mutate_amount % 8)) % 8); -+ for (; k < 4; ++k) -+ mutate_mask[k] = 0; -+ for (k = 0; k < 4; ++k) -+ mutated[k] = (mutated[k] & mutate_mask[k]) | (~mutate_mask[k] & prandom_u32_max(256)); -+ cidr = prandom_u32_max(128) + 1; -+ peer = peers[prandom_u32_max(NUM_PEERS)]; -+ if (allowedips_insert_v6(&t, (struct in6_addr *)mutated, cidr, peer, &mutex) < 0) { -+ pr_info("allowedips random self-test: out of memory\n"); -+ goto free; -+ } -+ if (horrible_allowedips_insert_v6(&h, (struct in6_addr *)mutated, cidr, peer)) { -+ pr_info("allowedips random self-test: out of memory\n"); -+ goto free; -+ } -+ } -+ } -+ -+#ifdef DEBUG_PRINT_TRIE_GRAPHVIZ -+ print_tree(t.root4, 32); -+ print_tree(t.root6, 128); -+#endif -+ -+ for (i = 0; i < NUM_QUERIES; ++i) { -+ prandom_bytes(ip, 4); -+ if (lookup(t.root4, 32, ip) != horrible_allowedips_lookup_v4(&h, (struct in_addr *)ip)) { -+ pr_info("allowedips random self-test: FAIL\n"); -+ goto free; -+ } -+ } -+ -+ for (i = 0; i < NUM_QUERIES; ++i) { -+ prandom_bytes(ip, 16); -+ if (lookup(t.root6, 128, ip) != horrible_allowedips_lookup_v6(&h, (struct in6_addr *)ip)) { -+ pr_info("allowedips random self-test: FAIL\n"); -+ goto free; -+ } -+ } -+ ret = true; -+ -+free: -+ allowedips_free(&t, &mutex); -+ horrible_allowedips_free(&h); -+ if (peers) { -+ for (i = 0; i < NUM_PEERS; ++i) -+ kfree(peers[i]); -+ } -+ kfree(peers); -+ return ret; -+} -+#endif -+ -+static __init inline struct in_addr *ip4(u8 a, u8 b, u8 c, u8 d) -+{ -+ static struct in_addr ip; -+ u8 *split = (u8 *)&ip; -+ split[0] = a; -+ split[1] = b; -+ split[2] = c; -+ split[3] = d; -+ return &ip; -+} -+static __init inline struct in6_addr *ip6(u32 a, u32 b, u32 c, u32 d) -+{ -+ static struct in6_addr ip; -+ __be32 *split = (__be32 *)&ip; -+ split[0] = cpu_to_be32(a); -+ split[1] = cpu_to_be32(b); -+ split[2] = cpu_to_be32(c); -+ split[3] = cpu_to_be32(d); -+ return &ip; -+} -+ -+#define init_peer(name) do { \ -+ name = kzalloc(sizeof(struct wireguard_peer), GFP_KERNEL); \ -+ if (!name) { \ -+ pr_info("allowedips self-test: out of memory\n"); \ -+ goto free; \ -+ } \ -+ kref_init(&name->refcount); \ -+} while (0) -+ -+#define insert(version, mem, ipa, ipb, ipc, ipd, cidr) \ -+ allowedips_insert_v##version(&t, ip##version(ipa, ipb, ipc, ipd), cidr, mem, &mutex) -+ -+#define maybe_fail \ -+ ++i; \ -+ if (!_s) { \ -+ pr_info("allowedips self-test %zu: FAIL\n", i); \ -+ success = false; \ -+ } -+ -+#define test(version, mem, ipa, ipb, ipc, ipd) do { \ -+ bool _s = lookup(t.root##version, version == 4 ? 32 : 128, ip##version(ipa, ipb, ipc, ipd)) == mem; \ -+ maybe_fail \ -+} while (0) -+ -+#define test_negative(version, mem, ipa, ipb, ipc, ipd) do { \ -+ bool _s = lookup(t.root##version, version == 4 ? 32 : 128, ip##version(ipa, ipb, ipc, ipd)) != mem; \ -+ maybe_fail \ -+} while (0) -+ -+bool __init allowedips_selftest(void) -+{ -+ DEFINE_MUTEX(mutex); -+ struct allowedips t; -+ struct wireguard_peer *a = NULL, *b = NULL, *c = NULL, *d = NULL, *e = NULL, *f = NULL, *g = NULL, *h = NULL; -+ size_t i = 0; -+ bool success = false; -+ struct in6_addr ip; -+ __be64 part; -+ -+ mutex_init(&mutex); -+ -+ mutex_lock(&mutex); -+ -+ allowedips_init(&t); -+ init_peer(a); -+ init_peer(b); -+ init_peer(c); -+ init_peer(d); -+ init_peer(e); -+ init_peer(f); -+ init_peer(g); -+ init_peer(h); -+ -+ insert(4, a, 192, 168, 4, 0, 24); -+ insert(4, b, 192, 168, 4, 4, 32); -+ insert(4, c, 192, 168, 0, 0, 16); -+ insert(4, d, 192, 95, 5, 64, 27); -+ insert(4, c, 192, 95, 5, 65, 27); /* replaces previous entry, and maskself is required */ -+ insert(6, d, 0x26075300, 0x60006b00, 0, 0xc05f0543, 128); -+ insert(6, c, 0x26075300, 0x60006b00, 0, 0, 64); -+ insert(4, e, 0, 0, 0, 0, 0); -+ insert(6, e, 0, 0, 0, 0, 0); -+ insert(6, f, 0, 0, 0, 0, 0); /* replaces previous entry */ -+ insert(6, g, 0x24046800, 0, 0, 0, 32); -+ insert(6, h, 0x24046800, 0x40040800, 0xdeadbeef, 0xdeadbeef, 64); /* maskself is required */ -+ insert(6, a, 0x24046800, 0x40040800, 0xdeadbeef, 0xdeadbeef, 128); -+ insert(6, c, 0x24446800, 0x40e40800, 0xdeaebeef, 0xdefbeef, 128); -+ insert(6, b, 0x24446800, 0xf0e40800, 0xeeaebeef, 0, 98); -+ insert(4, g, 64, 15, 112, 0, 20); -+ insert(4, h, 64, 15, 123, 211, 25); /* maskself is required */ -+ insert(4, a, 10, 0, 0, 0, 25); -+ insert(4, b, 10, 0, 0, 128, 25); -+ insert(4, a, 10, 1, 0, 0, 30); -+ insert(4, b, 10, 1, 0, 4, 30); -+ insert(4, c, 10, 1, 0, 8, 29); -+ insert(4, d, 10, 1, 0, 16, 29); -+ -+#ifdef DEBUG_PRINT_TRIE_GRAPHVIZ -+ print_tree(t.root4, 32); -+ print_tree(t.root6, 128); -+#endif -+ -+ success = true; -+ -+ test(4, a, 192, 168, 4, 20); -+ test(4, a, 192, 168, 4, 0); -+ test(4, b, 192, 168, 4, 4); -+ test(4, c, 192, 168, 200, 182); -+ test(4, c, 192, 95, 5, 68); -+ test(4, e, 192, 95, 5, 96); -+ test(6, d, 0x26075300, 0x60006b00, 0, 0xc05f0543); -+ test(6, c, 0x26075300, 0x60006b00, 0, 0xc02e01ee); -+ test(6, f, 0x26075300, 0x60006b01, 0, 0); -+ test(6, g, 0x24046800, 0x40040806, 0, 0x1006); -+ test(6, g, 0x24046800, 0x40040806, 0x1234, 0x5678); -+ test(6, f, 0x240467ff, 0x40040806, 0x1234, 0x5678); -+ test(6, f, 0x24046801, 0x40040806, 0x1234, 0x5678); -+ test(6, h, 0x24046800, 0x40040800, 0x1234, 0x5678); -+ test(6, h, 0x24046800, 0x40040800, 0, 0); -+ test(6, h, 0x24046800, 0x40040800, 0x10101010, 0x10101010); -+ test(6, a, 0x24046800, 0x40040800, 0xdeadbeef, 0xdeadbeef); -+ test(4, g, 64, 15, 116, 26); -+ test(4, g, 64, 15, 127, 3); -+ test(4, g, 64, 15, 123, 1); -+ test(4, h, 64, 15, 123, 128); -+ test(4, h, 64, 15, 123, 129); -+ test(4, a, 10, 0, 0, 52); -+ test(4, b, 10, 0, 0, 220); -+ test(4, a, 10, 1, 0, 2); -+ test(4, b, 10, 1, 0, 6); -+ test(4, c, 10, 1, 0, 10); -+ test(4, d, 10, 1, 0, 20); -+ -+ insert(4, a, 1, 0, 0, 0, 32); -+ insert(4, a, 64, 0, 0, 0, 32); -+ insert(4, a, 128, 0, 0, 0, 32); -+ insert(4, a, 192, 0, 0, 0, 32); -+ insert(4, a, 255, 0, 0, 0, 32); -+ allowedips_remove_by_peer(&t, a, &mutex); -+ test_negative(4, a, 1, 0, 0, 0); -+ test_negative(4, a, 64, 0, 0, 0); -+ test_negative(4, a, 128, 0, 0, 0); -+ test_negative(4, a, 192, 0, 0, 0); -+ test_negative(4, a, 255, 0, 0, 0); -+ -+ allowedips_free(&t, &mutex); -+ allowedips_init(&t); -+ insert(4, a, 192, 168, 0, 0, 16); -+ insert(4, a, 192, 168, 0, 0, 24); -+ allowedips_remove_by_peer(&t, a, &mutex); -+ test_negative(4, a, 192, 168, 0, 1); -+ -+ /* These will hit the BUG_ON(len >= 128) in free_node if something goes wrong. */ -+ for (i = 0; i < 128; ++i) { -+ part = cpu_to_be64(~(1LLU << (i % 64))); -+ memset(&ip, 0xff, 16); -+ memcpy((u8 *)&ip + (i < 64) * 8, &part, 8); -+ allowedips_insert_v6(&t, &ip, 128, a, &mutex); -+ } -+ -+#ifdef DEBUG_RANDOM_TRIE -+ if (success) -+ success = randomized_test(); -+#endif -+ -+ if (success) -+ pr_info("allowedips self-tests: pass\n"); -+ -+free: -+ allowedips_free(&t, &mutex); -+ kfree(a); -+ kfree(b); -+ kfree(c); -+ kfree(d); -+ kfree(e); -+ kfree(f); -+ kfree(g); -+ kfree(h); -+ mutex_unlock(&mutex); -+ -+ return success; -+} -+#undef test_negative -+#undef test -+#undef remove -+#undef insert -+#undef init_peer -+ -+#endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/selftest/blake2s.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,559 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifdef DEBUG -+static const u8 blake2s_testvecs[][BLAKE2S_OUTBYTES] __initconst = { -+ { 0x69, 0x21, 0x7A, 0x30, 0x79, 0x90, 0x80, 0x94, 0xE1, 0x11, 0x21, 0xD0, 0x42, 0x35, 0x4A, 0x7C, 0x1F, 0x55, 0xB6, 0x48, 0x2C, 0xA1, 0xA5, 0x1E, 0x1B, 0x25, 0x0D, 0xFD, 0x1E, 0xD0, 0xEE, 0xF9 }, -+ { 0xE3, 0x4D, 0x74, 0xDB, 0xAF, 0x4F, 0xF4, 0xC6, 0xAB, 0xD8, 0x71, 0xCC, 0x22, 0x04, 0x51, 0xD2, 0xEA, 0x26, 0x48, 0x84, 0x6C, 0x77, 0x57, 0xFB, 0xAA, 0xC8, 0x2F, 0xE5, 0x1A, 0xD6, 0x4B, 0xEA }, -+ { 0xDD, 0xAD, 0x9A, 0xB1, 0x5D, 0xAC, 0x45, 0x49, 0xBA, 0x42, 0xF4, 0x9D, 0x26, 0x24, 0x96, 0xBE, 0xF6, 0xC0, 0xBA, 0xE1, 0xDD, 0x34, 0x2A, 0x88, 0x08, 0xF8, 0xEA, 0x26, 0x7C, 0x6E, 0x21, 0x0C }, -+ { 0xE8, 0xF9, 0x1C, 0x6E, 0xF2, 0x32, 0xA0, 0x41, 0x45, 0x2A, 0xB0, 0xE1, 0x49, 0x07, 0x0C, 0xDD, 0x7D, 0xD1, 0x76, 0x9E, 0x75, 0xB3, 0xA5, 0x92, 0x1B, 0xE3, 0x78, 0x76, 0xC4, 0x5C, 0x99, 0x00 }, -+ { 0x0C, 0xC7, 0x0E, 0x00, 0x34, 0x8B, 0x86, 0xBA, 0x29, 0x44, 0xD0, 0xC3, 0x20, 0x38, 0xB2, 0x5C, 0x55, 0x58, 0x4F, 0x90, 0xDF, 0x23, 0x04, 0xF5, 0x5F, 0xA3, 0x32, 0xAF, 0x5F, 0xB0, 0x1E, 0x20 }, -+ { 0xEC, 0x19, 0x64, 0x19, 0x10, 0x87, 0xA4, 0xFE, 0x9D, 0xF1, 0xC7, 0x95, 0x34, 0x2A, 0x02, 0xFF, 0xC1, 0x91, 0xA5, 0xB2, 0x51, 0x76, 0x48, 0x56, 0xAE, 0x5B, 0x8B, 0x57, 0x69, 0xF0, 0xC6, 0xCD }, -+ { 0xE1, 0xFA, 0x51, 0x61, 0x8D, 0x7D, 0xF4, 0xEB, 0x70, 0xCF, 0x0D, 0x5A, 0x9E, 0x90, 0x6F, 0x80, 0x6E, 0x9D, 0x19, 0xF7, 0xF4, 0xF0, 0x1E, 0x3B, 0x62, 0x12, 0x88, 0xE4, 0x12, 0x04, 0x05, 0xD6 }, -+ { 0x59, 0x80, 0x01, 0xFA, 0xFB, 0xE8, 0xF9, 0x4E, 0xC6, 0x6D, 0xC8, 0x27, 0xD0, 0x12, 0xCF, 0xCB, 0xBA, 0x22, 0x28, 0x56, 0x9F, 0x44, 0x8E, 0x89, 0xEA, 0x22, 0x08, 0xC8, 0xBF, 0x76, 0x92, 0x93 }, -+ { 0xC7, 0xE8, 0x87, 0xB5, 0x46, 0x62, 0x36, 0x35, 0xE9, 0x3E, 0x04, 0x95, 0x59, 0x8F, 0x17, 0x26, 0x82, 0x19, 0x96, 0xC2, 0x37, 0x77, 0x05, 0xB9, 0x3A, 0x1F, 0x63, 0x6F, 0x87, 0x2B, 0xFA, 0x2D }, -+ { 0xC3, 0x15, 0xA4, 0x37, 0xDD, 0x28, 0x06, 0x2A, 0x77, 0x0D, 0x48, 0x19, 0x67, 0x13, 0x6B, 0x1B, 0x5E, 0xB8, 0x8B, 0x21, 0xEE, 0x53, 0xD0, 0x32, 0x9C, 0x58, 0x97, 0x12, 0x6E, 0x9D, 0xB0, 0x2C }, -+ { 0xBB, 0x47, 0x3D, 0xED, 0xDC, 0x05, 0x5F, 0xEA, 0x62, 0x28, 0xF2, 0x07, 0xDA, 0x57, 0x53, 0x47, 0xBB, 0x00, 0x40, 0x4C, 0xD3, 0x49, 0xD3, 0x8C, 0x18, 0x02, 0x63, 0x07, 0xA2, 0x24, 0xCB, 0xFF }, -+ { 0x68, 0x7E, 0x18, 0x73, 0xA8, 0x27, 0x75, 0x91, 0xBB, 0x33, 0xD9, 0xAD, 0xF9, 0xA1, 0x39, 0x12, 0xEF, 0xEF, 0xE5, 0x57, 0xCA, 0xFC, 0x39, 0xA7, 0x95, 0x26, 0x23, 0xE4, 0x72, 0x55, 0xF1, 0x6D }, -+ { 0x1A, 0xC7, 0xBA, 0x75, 0x4D, 0x6E, 0x2F, 0x94, 0xE0, 0xE8, 0x6C, 0x46, 0xBF, 0xB2, 0x62, 0xAB, 0xBB, 0x74, 0xF4, 0x50, 0xEF, 0x45, 0x6D, 0x6B, 0x4D, 0x97, 0xAA, 0x80, 0xCE, 0x6D, 0xA7, 0x67 }, -+ { 0x01, 0x2C, 0x97, 0x80, 0x96, 0x14, 0x81, 0x6B, 0x5D, 0x94, 0x94, 0x47, 0x7D, 0x4B, 0x68, 0x7D, 0x15, 0xB9, 0x6E, 0xB6, 0x9C, 0x0E, 0x80, 0x74, 0xA8, 0x51, 0x6F, 0x31, 0x22, 0x4B, 0x5C, 0x98 }, -+ { 0x91, 0xFF, 0xD2, 0x6C, 0xFA, 0x4D, 0xA5, 0x13, 0x4C, 0x7E, 0xA2, 0x62, 0xF7, 0x88, 0x9C, 0x32, 0x9F, 0x61, 0xF6, 0xA6, 0x57, 0x22, 0x5C, 0xC2, 0x12, 0xF4, 0x00, 0x56, 0xD9, 0x86, 0xB3, 0xF4 }, -+ { 0xD9, 0x7C, 0x82, 0x8D, 0x81, 0x82, 0xA7, 0x21, 0x80, 0xA0, 0x6A, 0x78, 0x26, 0x83, 0x30, 0x67, 0x3F, 0x7C, 0x4E, 0x06, 0x35, 0x94, 0x7C, 0x04, 0xC0, 0x23, 0x23, 0xFD, 0x45, 0xC0, 0xA5, 0x2D }, -+ { 0xEF, 0xC0, 0x4C, 0xDC, 0x39, 0x1C, 0x7E, 0x91, 0x19, 0xBD, 0x38, 0x66, 0x8A, 0x53, 0x4E, 0x65, 0xFE, 0x31, 0x03, 0x6D, 0x6A, 0x62, 0x11, 0x2E, 0x44, 0xEB, 0xEB, 0x11, 0xF9, 0xC5, 0x70, 0x80 }, -+ { 0x99, 0x2C, 0xF5, 0xC0, 0x53, 0x44, 0x2A, 0x5F, 0xBC, 0x4F, 0xAF, 0x58, 0x3E, 0x04, 0xE5, 0x0B, 0xB7, 0x0D, 0x2F, 0x39, 0xFB, 0xB6, 0xA5, 0x03, 0xF8, 0x9E, 0x56, 0xA6, 0x3E, 0x18, 0x57, 0x8A }, -+ { 0x38, 0x64, 0x0E, 0x9F, 0x21, 0x98, 0x3E, 0x67, 0xB5, 0x39, 0xCA, 0xCC, 0xAE, 0x5E, 0xCF, 0x61, 0x5A, 0xE2, 0x76, 0x4F, 0x75, 0xA0, 0x9C, 0x9C, 0x59, 0xB7, 0x64, 0x83, 0xC1, 0xFB, 0xC7, 0x35 }, -+ { 0x21, 0x3D, 0xD3, 0x4C, 0x7E, 0xFE, 0x4F, 0xB2, 0x7A, 0x6B, 0x35, 0xF6, 0xB4, 0x00, 0x0D, 0x1F, 0xE0, 0x32, 0x81, 0xAF, 0x3C, 0x72, 0x3E, 0x5C, 0x9F, 0x94, 0x74, 0x7A, 0x5F, 0x31, 0xCD, 0x3B }, -+ { 0xEC, 0x24, 0x6E, 0xEE, 0xB9, 0xCE, 0xD3, 0xF7, 0xAD, 0x33, 0xED, 0x28, 0x66, 0x0D, 0xD9, 0xBB, 0x07, 0x32, 0x51, 0x3D, 0xB4, 0xE2, 0xFA, 0x27, 0x8B, 0x60, 0xCD, 0xE3, 0x68, 0x2A, 0x4C, 0xCD }, -+ { 0xAC, 0x9B, 0x61, 0xD4, 0x46, 0x64, 0x8C, 0x30, 0x05, 0xD7, 0x89, 0x2B, 0xF3, 0xA8, 0x71, 0x9F, 0x4C, 0x81, 0x81, 0xCF, 0xDC, 0xBC, 0x2B, 0x79, 0xFE, 0xF1, 0x0A, 0x27, 0x9B, 0x91, 0x10, 0x95 }, -+ { 0x7B, 0xF8, 0xB2, 0x29, 0x59, 0xE3, 0x4E, 0x3A, 0x43, 0xF7, 0x07, 0x92, 0x23, 0xE8, 0x3A, 0x97, 0x54, 0x61, 0x7D, 0x39, 0x1E, 0x21, 0x3D, 0xFD, 0x80, 0x8E, 0x41, 0xB9, 0xBE, 0xAD, 0x4C, 0xE7 }, -+ { 0x68, 0xD4, 0xB5, 0xD4, 0xFA, 0x0E, 0x30, 0x2B, 0x64, 0xCC, 0xC5, 0xAF, 0x79, 0x29, 0x13, 0xAC, 0x4C, 0x88, 0xEC, 0x95, 0xC0, 0x7D, 0xDF, 0x40, 0x69, 0x42, 0x56, 0xEB, 0x88, 0xCE, 0x9F, 0x3D }, -+ { 0xB2, 0xC2, 0x42, 0x0F, 0x05, 0xF9, 0xAB, 0xE3, 0x63, 0x15, 0x91, 0x93, 0x36, 0xB3, 0x7E, 0x4E, 0x0F, 0xA3, 0x3F, 0xF7, 0xE7, 0x6A, 0x49, 0x27, 0x67, 0x00, 0x6F, 0xDB, 0x5D, 0x93, 0x54, 0x62 }, -+ { 0x13, 0x4F, 0x61, 0xBB, 0xD0, 0xBB, 0xB6, 0x9A, 0xED, 0x53, 0x43, 0x90, 0x45, 0x51, 0xA3, 0xE6, 0xC1, 0xAA, 0x7D, 0xCD, 0xD7, 0x7E, 0x90, 0x3E, 0x70, 0x23, 0xEB, 0x7C, 0x60, 0x32, 0x0A, 0xA7 }, -+ { 0x46, 0x93, 0xF9, 0xBF, 0xF7, 0xD4, 0xF3, 0x98, 0x6A, 0x7D, 0x17, 0x6E, 0x6E, 0x06, 0xF7, 0x2A, 0xD1, 0x49, 0x0D, 0x80, 0x5C, 0x99, 0xE2, 0x53, 0x47, 0xB8, 0xDE, 0x77, 0xB4, 0xDB, 0x6D, 0x9B }, -+ { 0x85, 0x3E, 0x26, 0xF7, 0x41, 0x95, 0x3B, 0x0F, 0xD5, 0xBD, 0xB4, 0x24, 0xE8, 0xAB, 0x9E, 0x8B, 0x37, 0x50, 0xEA, 0xA8, 0xEF, 0x61, 0xE4, 0x79, 0x02, 0xC9, 0x1E, 0x55, 0x4E, 0x9C, 0x73, 0xB9 }, -+ { 0xF7, 0xDE, 0x53, 0x63, 0x61, 0xAB, 0xAA, 0x0E, 0x15, 0x81, 0x56, 0xCF, 0x0E, 0xA4, 0xF6, 0x3A, 0x99, 0xB5, 0xE4, 0x05, 0x4F, 0x8F, 0xA4, 0xC9, 0xD4, 0x5F, 0x62, 0x85, 0xCA, 0xD5, 0x56, 0x94 }, -+ { 0x4C, 0x23, 0x06, 0x08, 0x86, 0x0A, 0x99, 0xAE, 0x8D, 0x7B, 0xD5, 0xC2, 0xCC, 0x17, 0xFA, 0x52, 0x09, 0x6B, 0x9A, 0x61, 0xBE, 0xDB, 0x17, 0xCB, 0x76, 0x17, 0x86, 0x4A, 0xD2, 0x9C, 0xA7, 0xA6 }, -+ { 0xAE, 0xB9, 0x20, 0xEA, 0x87, 0x95, 0x2D, 0xAD, 0xB1, 0xFB, 0x75, 0x92, 0x91, 0xE3, 0x38, 0x81, 0x39, 0xA8, 0x72, 0x86, 0x50, 0x01, 0x88, 0x6E, 0xD8, 0x47, 0x52, 0xE9, 0x3C, 0x25, 0x0C, 0x2A }, -+ { 0xAB, 0xA4, 0xAD, 0x9B, 0x48, 0x0B, 0x9D, 0xF3, 0xD0, 0x8C, 0xA5, 0xE8, 0x7B, 0x0C, 0x24, 0x40, 0xD4, 0xE4, 0xEA, 0x21, 0x22, 0x4C, 0x2E, 0xB4, 0x2C, 0xBA, 0xE4, 0x69, 0xD0, 0x89, 0xB9, 0x31 }, -+ { 0x05, 0x82, 0x56, 0x07, 0xD7, 0xFD, 0xF2, 0xD8, 0x2E, 0xF4, 0xC3, 0xC8, 0xC2, 0xAE, 0xA9, 0x61, 0xAD, 0x98, 0xD6, 0x0E, 0xDF, 0xF7, 0xD0, 0x18, 0x98, 0x3E, 0x21, 0x20, 0x4C, 0x0D, 0x93, 0xD1 }, -+ { 0xA7, 0x42, 0xF8, 0xB6, 0xAF, 0x82, 0xD8, 0xA6, 0xCA, 0x23, 0x57, 0xC5, 0xF1, 0xCF, 0x91, 0xDE, 0xFB, 0xD0, 0x66, 0x26, 0x7D, 0x75, 0xC0, 0x48, 0xB3, 0x52, 0x36, 0x65, 0x85, 0x02, 0x59, 0x62 }, -+ { 0x2B, 0xCA, 0xC8, 0x95, 0x99, 0x00, 0x0B, 0x42, 0xC9, 0x5A, 0xE2, 0x38, 0x35, 0xA7, 0x13, 0x70, 0x4E, 0xD7, 0x97, 0x89, 0xC8, 0x4F, 0xEF, 0x14, 0x9A, 0x87, 0x4F, 0xF7, 0x33, 0xF0, 0x17, 0xA2 }, -+ { 0xAC, 0x1E, 0xD0, 0x7D, 0x04, 0x8F, 0x10, 0x5A, 0x9E, 0x5B, 0x7A, 0xB8, 0x5B, 0x09, 0xA4, 0x92, 0xD5, 0xBA, 0xFF, 0x14, 0xB8, 0xBF, 0xB0, 0xE9, 0xFD, 0x78, 0x94, 0x86, 0xEE, 0xA2, 0xB9, 0x74 }, -+ { 0xE4, 0x8D, 0x0E, 0xCF, 0xAF, 0x49, 0x7D, 0x5B, 0x27, 0xC2, 0x5D, 0x99, 0xE1, 0x56, 0xCB, 0x05, 0x79, 0xD4, 0x40, 0xD6, 0xE3, 0x1F, 0xB6, 0x24, 0x73, 0x69, 0x6D, 0xBF, 0x95, 0xE0, 0x10, 0xE4 }, -+ { 0x12, 0xA9, 0x1F, 0xAD, 0xF8, 0xB2, 0x16, 0x44, 0xFD, 0x0F, 0x93, 0x4F, 0x3C, 0x4A, 0x8F, 0x62, 0xBA, 0x86, 0x2F, 0xFD, 0x20, 0xE8, 0xE9, 0x61, 0x15, 0x4C, 0x15, 0xC1, 0x38, 0x84, 0xED, 0x3D }, -+ { 0x7C, 0xBE, 0xE9, 0x6E, 0x13, 0x98, 0x97, 0xDC, 0x98, 0xFB, 0xEF, 0x3B, 0xE8, 0x1A, 0xD4, 0xD9, 0x64, 0xD2, 0x35, 0xCB, 0x12, 0x14, 0x1F, 0xB6, 0x67, 0x27, 0xE6, 0xE5, 0xDF, 0x73, 0xA8, 0x78 }, -+ { 0xEB, 0xF6, 0x6A, 0xBB, 0x59, 0x7A, 0xE5, 0x72, 0xA7, 0x29, 0x7C, 0xB0, 0x87, 0x1E, 0x35, 0x5A, 0xCC, 0xAF, 0xAD, 0x83, 0x77, 0xB8, 0xE7, 0x8B, 0xF1, 0x64, 0xCE, 0x2A, 0x18, 0xDE, 0x4B, 0xAF }, -+ { 0x71, 0xB9, 0x33, 0xB0, 0x7E, 0x4F, 0xF7, 0x81, 0x8C, 0xE0, 0x59, 0xD0, 0x08, 0x82, 0x9E, 0x45, 0x3C, 0x6F, 0xF0, 0x2E, 0xC0, 0xA7, 0xDB, 0x39, 0x3F, 0xC2, 0xD8, 0x70, 0xF3, 0x7A, 0x72, 0x86 }, -+ { 0x7C, 0xF7, 0xC5, 0x13, 0x31, 0x22, 0x0B, 0x8D, 0x3E, 0xBA, 0xED, 0x9C, 0x29, 0x39, 0x8A, 0x16, 0xD9, 0x81, 0x56, 0xE2, 0x61, 0x3C, 0xB0, 0x88, 0xF2, 0xB0, 0xE0, 0x8A, 0x1B, 0xE4, 0xCF, 0x4F }, -+ { 0x3E, 0x41, 0xA1, 0x08, 0xE0, 0xF6, 0x4A, 0xD2, 0x76, 0xB9, 0x79, 0xE1, 0xCE, 0x06, 0x82, 0x79, 0xE1, 0x6F, 0x7B, 0xC7, 0xE4, 0xAA, 0x1D, 0x21, 0x1E, 0x17, 0xB8, 0x11, 0x61, 0xDF, 0x16, 0x02 }, -+ { 0x88, 0x65, 0x02, 0xA8, 0x2A, 0xB4, 0x7B, 0xA8, 0xD8, 0x67, 0x10, 0xAA, 0x9D, 0xE3, 0xD4, 0x6E, 0xA6, 0x5C, 0x47, 0xAF, 0x6E, 0xE8, 0xDE, 0x45, 0x0C, 0xCE, 0xB8, 0xB1, 0x1B, 0x04, 0x5F, 0x50 }, -+ { 0xC0, 0x21, 0xBC, 0x5F, 0x09, 0x54, 0xFE, 0xE9, 0x4F, 0x46, 0xEA, 0x09, 0x48, 0x7E, 0x10, 0xA8, 0x48, 0x40, 0xD0, 0x2F, 0x64, 0x81, 0x0B, 0xC0, 0x8D, 0x9E, 0x55, 0x1F, 0x7D, 0x41, 0x68, 0x14 }, -+ { 0x20, 0x30, 0x51, 0x6E, 0x8A, 0x5F, 0xE1, 0x9A, 0xE7, 0x9C, 0x33, 0x6F, 0xCE, 0x26, 0x38, 0x2A, 0x74, 0x9D, 0x3F, 0xD0, 0xEC, 0x91, 0xE5, 0x37, 0xD4, 0xBD, 0x23, 0x58, 0xC1, 0x2D, 0xFB, 0x22 }, -+ { 0x55, 0x66, 0x98, 0xDA, 0xC8, 0x31, 0x7F, 0xD3, 0x6D, 0xFB, 0xDF, 0x25, 0xA7, 0x9C, 0xB1, 0x12, 0xD5, 0x42, 0x58, 0x60, 0x60, 0x5C, 0xBA, 0xF5, 0x07, 0xF2, 0x3B, 0xF7, 0xE9, 0xF4, 0x2A, 0xFE }, -+ { 0x2F, 0x86, 0x7B, 0xA6, 0x77, 0x73, 0xFD, 0xC3, 0xE9, 0x2F, 0xCE, 0xD9, 0x9A, 0x64, 0x09, 0xAD, 0x39, 0xD0, 0xB8, 0x80, 0xFD, 0xE8, 0xF1, 0x09, 0xA8, 0x17, 0x30, 0xC4, 0x45, 0x1D, 0x01, 0x78 }, -+ { 0x17, 0x2E, 0xC2, 0x18, 0xF1, 0x19, 0xDF, 0xAE, 0x98, 0x89, 0x6D, 0xFF, 0x29, 0xDD, 0x98, 0x76, 0xC9, 0x4A, 0xF8, 0x74, 0x17, 0xF9, 0xAE, 0x4C, 0x70, 0x14, 0xBB, 0x4E, 0x4B, 0x96, 0xAF, 0xC7 }, -+ { 0x3F, 0x85, 0x81, 0x4A, 0x18, 0x19, 0x5F, 0x87, 0x9A, 0xA9, 0x62, 0xF9, 0x5D, 0x26, 0xBD, 0x82, 0xA2, 0x78, 0xF2, 0xB8, 0x23, 0x20, 0x21, 0x8F, 0x6B, 0x3B, 0xD6, 0xF7, 0xF6, 0x67, 0xA6, 0xD9 }, -+ { 0x1B, 0x61, 0x8F, 0xBA, 0xA5, 0x66, 0xB3, 0xD4, 0x98, 0xC1, 0x2E, 0x98, 0x2C, 0x9E, 0xC5, 0x2E, 0x4D, 0xA8, 0x5A, 0x8C, 0x54, 0xF3, 0x8F, 0x34, 0xC0, 0x90, 0x39, 0x4F, 0x23, 0xC1, 0x84, 0xC1 }, -+ { 0x0C, 0x75, 0x8F, 0xB5, 0x69, 0x2F, 0xFD, 0x41, 0xA3, 0x57, 0x5D, 0x0A, 0xF0, 0x0C, 0xC7, 0xFB, 0xF2, 0xCB, 0xE5, 0x90, 0x5A, 0x58, 0x32, 0x3A, 0x88, 0xAE, 0x42, 0x44, 0xF6, 0xE4, 0xC9, 0x93 }, -+ { 0xA9, 0x31, 0x36, 0x0C, 0xAD, 0x62, 0x8C, 0x7F, 0x12, 0xA6, 0xC1, 0xC4, 0xB7, 0x53, 0xB0, 0xF4, 0x06, 0x2A, 0xEF, 0x3C, 0xE6, 0x5A, 0x1A, 0xE3, 0xF1, 0x93, 0x69, 0xDA, 0xDF, 0x3A, 0xE2, 0x3D }, -+ { 0xCB, 0xAC, 0x7D, 0x77, 0x3B, 0x1E, 0x3B, 0x3C, 0x66, 0x91, 0xD7, 0xAB, 0xB7, 0xE9, 0xDF, 0x04, 0x5C, 0x8B, 0xA1, 0x92, 0x68, 0xDE, 0xD1, 0x53, 0x20, 0x7F, 0x5E, 0x80, 0x43, 0x52, 0xEC, 0x5D }, -+ { 0x23, 0xA1, 0x96, 0xD3, 0x80, 0x2E, 0xD3, 0xC1, 0xB3, 0x84, 0x01, 0x9A, 0x82, 0x32, 0x58, 0x40, 0xD3, 0x2F, 0x71, 0x95, 0x0C, 0x45, 0x80, 0xB0, 0x34, 0x45, 0xE0, 0x89, 0x8E, 0x14, 0x05, 0x3C }, -+ { 0xF4, 0x49, 0x54, 0x70, 0xF2, 0x26, 0xC8, 0xC2, 0x14, 0xBE, 0x08, 0xFD, 0xFA, 0xD4, 0xBC, 0x4A, 0x2A, 0x9D, 0xBE, 0xA9, 0x13, 0x6A, 0x21, 0x0D, 0xF0, 0xD4, 0xB6, 0x49, 0x29, 0xE6, 0xFC, 0x14 }, -+ { 0xE2, 0x90, 0xDD, 0x27, 0x0B, 0x46, 0x7F, 0x34, 0xAB, 0x1C, 0x00, 0x2D, 0x34, 0x0F, 0xA0, 0x16, 0x25, 0x7F, 0xF1, 0x9E, 0x58, 0x33, 0xFD, 0xBB, 0xF2, 0xCB, 0x40, 0x1C, 0x3B, 0x28, 0x17, 0xDE }, -+ { 0x9F, 0xC7, 0xB5, 0xDE, 0xD3, 0xC1, 0x50, 0x42, 0xB2, 0xA6, 0x58, 0x2D, 0xC3, 0x9B, 0xE0, 0x16, 0xD2, 0x4A, 0x68, 0x2D, 0x5E, 0x61, 0xAD, 0x1E, 0xFF, 0x9C, 0x63, 0x30, 0x98, 0x48, 0xF7, 0x06 }, -+ { 0x8C, 0xCA, 0x67, 0xA3, 0x6D, 0x17, 0xD5, 0xE6, 0x34, 0x1C, 0xB5, 0x92, 0xFD, 0x7B, 0xEF, 0x99, 0x26, 0xC9, 0xE3, 0xAA, 0x10, 0x27, 0xEA, 0x11, 0xA7, 0xD8, 0xBD, 0x26, 0x0B, 0x57, 0x6E, 0x04 }, -+ { 0x40, 0x93, 0x92, 0xF5, 0x60, 0xF8, 0x68, 0x31, 0xDA, 0x43, 0x73, 0xEE, 0x5E, 0x00, 0x74, 0x26, 0x05, 0x95, 0xD7, 0xBC, 0x24, 0x18, 0x3B, 0x60, 0xED, 0x70, 0x0D, 0x45, 0x83, 0xD3, 0xF6, 0xF0 }, -+ { 0x28, 0x02, 0x16, 0x5D, 0xE0, 0x90, 0x91, 0x55, 0x46, 0xF3, 0x39, 0x8C, 0xD8, 0x49, 0x16, 0x4A, 0x19, 0xF9, 0x2A, 0xDB, 0xC3, 0x61, 0xAD, 0xC9, 0x9B, 0x0F, 0x20, 0xC8, 0xEA, 0x07, 0x10, 0x54 }, -+ { 0xAD, 0x83, 0x91, 0x68, 0xD9, 0xF8, 0xA4, 0xBE, 0x95, 0xBA, 0x9E, 0xF9, 0xA6, 0x92, 0xF0, 0x72, 0x56, 0xAE, 0x43, 0xFE, 0x6F, 0x98, 0x64, 0xE2, 0x90, 0x69, 0x1B, 0x02, 0x56, 0xCE, 0x50, 0xA9 }, -+ { 0x75, 0xFD, 0xAA, 0x50, 0x38, 0xC2, 0x84, 0xB8, 0x6D, 0x6E, 0x8A, 0xFF, 0xE8, 0xB2, 0x80, 0x7E, 0x46, 0x7B, 0x86, 0x60, 0x0E, 0x79, 0xAF, 0x36, 0x89, 0xFB, 0xC0, 0x63, 0x28, 0xCB, 0xF8, 0x94 }, -+ { 0xE5, 0x7C, 0xB7, 0x94, 0x87, 0xDD, 0x57, 0x90, 0x24, 0x32, 0xB2, 0x50, 0x73, 0x38, 0x13, 0xBD, 0x96, 0xA8, 0x4E, 0xFC, 0xE5, 0x9F, 0x65, 0x0F, 0xAC, 0x26, 0xE6, 0x69, 0x6A, 0xEF, 0xAF, 0xC3 }, -+ { 0x56, 0xF3, 0x4E, 0x8B, 0x96, 0x55, 0x7E, 0x90, 0xC1, 0xF2, 0x4B, 0x52, 0xD0, 0xC8, 0x9D, 0x51, 0x08, 0x6A, 0xCF, 0x1B, 0x00, 0xF6, 0x34, 0xCF, 0x1D, 0xDE, 0x92, 0x33, 0xB8, 0xEA, 0xAA, 0x3E }, -+ { 0x1B, 0x53, 0xEE, 0x94, 0xAA, 0xF3, 0x4E, 0x4B, 0x15, 0x9D, 0x48, 0xDE, 0x35, 0x2C, 0x7F, 0x06, 0x61, 0xD0, 0xA4, 0x0E, 0xDF, 0xF9, 0x5A, 0x0B, 0x16, 0x39, 0xB4, 0x09, 0x0E, 0x97, 0x44, 0x72 }, -+ { 0x05, 0x70, 0x5E, 0x2A, 0x81, 0x75, 0x7C, 0x14, 0xBD, 0x38, 0x3E, 0xA9, 0x8D, 0xDA, 0x54, 0x4E, 0xB1, 0x0E, 0x6B, 0xC0, 0x7B, 0xAE, 0x43, 0x5E, 0x25, 0x18, 0xDB, 0xE1, 0x33, 0x52, 0x53, 0x75 }, -+ { 0xD8, 0xB2, 0x86, 0x6E, 0x8A, 0x30, 0x9D, 0xB5, 0x3E, 0x52, 0x9E, 0xC3, 0x29, 0x11, 0xD8, 0x2F, 0x5C, 0xA1, 0x6C, 0xFF, 0x76, 0x21, 0x68, 0x91, 0xA9, 0x67, 0x6A, 0xA3, 0x1A, 0xAA, 0x6C, 0x42 }, -+ { 0xF5, 0x04, 0x1C, 0x24, 0x12, 0x70, 0xEB, 0x04, 0xC7, 0x1E, 0xC2, 0xC9, 0x5D, 0x4C, 0x38, 0xD8, 0x03, 0xB1, 0x23, 0x7B, 0x0F, 0x29, 0xFD, 0x4D, 0xB3, 0xEB, 0x39, 0x76, 0x69, 0xE8, 0x86, 0x99 }, -+ { 0x9A, 0x4C, 0xE0, 0x77, 0xC3, 0x49, 0x32, 0x2F, 0x59, 0x5E, 0x0E, 0xE7, 0x9E, 0xD0, 0xDA, 0x5F, 0xAB, 0x66, 0x75, 0x2C, 0xBF, 0xEF, 0x8F, 0x87, 0xD0, 0xE9, 0xD0, 0x72, 0x3C, 0x75, 0x30, 0xDD }, -+ { 0x65, 0x7B, 0x09, 0xF3, 0xD0, 0xF5, 0x2B, 0x5B, 0x8F, 0x2F, 0x97, 0x16, 0x3A, 0x0E, 0xDF, 0x0C, 0x04, 0xF0, 0x75, 0x40, 0x8A, 0x07, 0xBB, 0xEB, 0x3A, 0x41, 0x01, 0xA8, 0x91, 0x99, 0x0D, 0x62 }, -+ { 0x1E, 0x3F, 0x7B, 0xD5, 0xA5, 0x8F, 0xA5, 0x33, 0x34, 0x4A, 0xA8, 0xED, 0x3A, 0xC1, 0x22, 0xBB, 0x9E, 0x70, 0xD4, 0xEF, 0x50, 0xD0, 0x04, 0x53, 0x08, 0x21, 0x94, 0x8F, 0x5F, 0xE6, 0x31, 0x5A }, -+ { 0x80, 0xDC, 0xCF, 0x3F, 0xD8, 0x3D, 0xFD, 0x0D, 0x35, 0xAA, 0x28, 0x58, 0x59, 0x22, 0xAB, 0x89, 0xD5, 0x31, 0x39, 0x97, 0x67, 0x3E, 0xAF, 0x90, 0x5C, 0xEA, 0x9C, 0x0B, 0x22, 0x5C, 0x7B, 0x5F }, -+ { 0x8A, 0x0D, 0x0F, 0xBF, 0x63, 0x77, 0xD8, 0x3B, 0xB0, 0x8B, 0x51, 0x4B, 0x4B, 0x1C, 0x43, 0xAC, 0xC9, 0x5D, 0x75, 0x17, 0x14, 0xF8, 0x92, 0x56, 0x45, 0xCB, 0x6B, 0xC8, 0x56, 0xCA, 0x15, 0x0A }, -+ { 0x9F, 0xA5, 0xB4, 0x87, 0x73, 0x8A, 0xD2, 0x84, 0x4C, 0xC6, 0x34, 0x8A, 0x90, 0x19, 0x18, 0xF6, 0x59, 0xA3, 0xB8, 0x9E, 0x9C, 0x0D, 0xFE, 0xEA, 0xD3, 0x0D, 0xD9, 0x4B, 0xCF, 0x42, 0xEF, 0x8E }, -+ { 0x80, 0x83, 0x2C, 0x4A, 0x16, 0x77, 0xF5, 0xEA, 0x25, 0x60, 0xF6, 0x68, 0xE9, 0x35, 0x4D, 0xD3, 0x69, 0x97, 0xF0, 0x37, 0x28, 0xCF, 0xA5, 0x5E, 0x1B, 0x38, 0x33, 0x7C, 0x0C, 0x9E, 0xF8, 0x18 }, -+ { 0xAB, 0x37, 0xDD, 0xB6, 0x83, 0x13, 0x7E, 0x74, 0x08, 0x0D, 0x02, 0x6B, 0x59, 0x0B, 0x96, 0xAE, 0x9B, 0xB4, 0x47, 0x72, 0x2F, 0x30, 0x5A, 0x5A, 0xC5, 0x70, 0xEC, 0x1D, 0xF9, 0xB1, 0x74, 0x3C }, -+ { 0x3E, 0xE7, 0x35, 0xA6, 0x94, 0xC2, 0x55, 0x9B, 0x69, 0x3A, 0xA6, 0x86, 0x29, 0x36, 0x1E, 0x15, 0xD1, 0x22, 0x65, 0xAD, 0x6A, 0x3D, 0xED, 0xF4, 0x88, 0xB0, 0xB0, 0x0F, 0xAC, 0x97, 0x54, 0xBA }, -+ { 0xD6, 0xFC, 0xD2, 0x32, 0x19, 0xB6, 0x47, 0xE4, 0xCB, 0xD5, 0xEB, 0x2D, 0x0A, 0xD0, 0x1E, 0xC8, 0x83, 0x8A, 0x4B, 0x29, 0x01, 0xFC, 0x32, 0x5C, 0xC3, 0x70, 0x19, 0x81, 0xCA, 0x6C, 0x88, 0x8B }, -+ { 0x05, 0x20, 0xEC, 0x2F, 0x5B, 0xF7, 0xA7, 0x55, 0xDA, 0xCB, 0x50, 0xC6, 0xBF, 0x23, 0x3E, 0x35, 0x15, 0x43, 0x47, 0x63, 0xDB, 0x01, 0x39, 0xCC, 0xD9, 0xFA, 0xEF, 0xBB, 0x82, 0x07, 0x61, 0x2D }, -+ { 0xAF, 0xF3, 0xB7, 0x5F, 0x3F, 0x58, 0x12, 0x64, 0xD7, 0x66, 0x16, 0x62, 0xB9, 0x2F, 0x5A, 0xD3, 0x7C, 0x1D, 0x32, 0xBD, 0x45, 0xFF, 0x81, 0xA4, 0xED, 0x8A, 0xDC, 0x9E, 0xF3, 0x0D, 0xD9, 0x89 }, -+ { 0xD0, 0xDD, 0x65, 0x0B, 0xEF, 0xD3, 0xBA, 0x63, 0xDC, 0x25, 0x10, 0x2C, 0x62, 0x7C, 0x92, 0x1B, 0x9C, 0xBE, 0xB0, 0xB1, 0x30, 0x68, 0x69, 0x35, 0xB5, 0xC9, 0x27, 0xCB, 0x7C, 0xCD, 0x5E, 0x3B }, -+ { 0xE1, 0x14, 0x98, 0x16, 0xB1, 0x0A, 0x85, 0x14, 0xFB, 0x3E, 0x2C, 0xAB, 0x2C, 0x08, 0xBE, 0xE9, 0xF7, 0x3C, 0xE7, 0x62, 0x21, 0x70, 0x12, 0x46, 0xA5, 0x89, 0xBB, 0xB6, 0x73, 0x02, 0xD8, 0xA9 }, -+ { 0x7D, 0xA3, 0xF4, 0x41, 0xDE, 0x90, 0x54, 0x31, 0x7E, 0x72, 0xB5, 0xDB, 0xF9, 0x79, 0xDA, 0x01, 0xE6, 0xBC, 0xEE, 0xBB, 0x84, 0x78, 0xEA, 0xE6, 0xA2, 0x28, 0x49, 0xD9, 0x02, 0x92, 0x63, 0x5C }, -+ { 0x12, 0x30, 0xB1, 0xFC, 0x8A, 0x7D, 0x92, 0x15, 0xED, 0xC2, 0xD4, 0xA2, 0xDE, 0xCB, 0xDD, 0x0A, 0x6E, 0x21, 0x6C, 0x92, 0x42, 0x78, 0xC9, 0x1F, 0xC5, 0xD1, 0x0E, 0x7D, 0x60, 0x19, 0x2D, 0x94 }, -+ { 0x57, 0x50, 0xD7, 0x16, 0xB4, 0x80, 0x8F, 0x75, 0x1F, 0xEB, 0xC3, 0x88, 0x06, 0xBA, 0x17, 0x0B, 0xF6, 0xD5, 0x19, 0x9A, 0x78, 0x16, 0xBE, 0x51, 0x4E, 0x3F, 0x93, 0x2F, 0xBE, 0x0C, 0xB8, 0x71 }, -+ { 0x6F, 0xC5, 0x9B, 0x2F, 0x10, 0xFE, 0xBA, 0x95, 0x4A, 0xA6, 0x82, 0x0B, 0x3C, 0xA9, 0x87, 0xEE, 0x81, 0xD5, 0xCC, 0x1D, 0xA3, 0xC6, 0x3C, 0xE8, 0x27, 0x30, 0x1C, 0x56, 0x9D, 0xFB, 0x39, 0xCE }, -+ { 0xC7, 0xC3, 0xFE, 0x1E, 0xEB, 0xDC, 0x7B, 0x5A, 0x93, 0x93, 0x26, 0xE8, 0xDD, 0xB8, 0x3E, 0x8B, 0xF2, 0xB7, 0x80, 0xB6, 0x56, 0x78, 0xCB, 0x62, 0xF2, 0x08, 0xB0, 0x40, 0xAB, 0xDD, 0x35, 0xE2 }, -+ { 0x0C, 0x75, 0xC1, 0xA1, 0x5C, 0xF3, 0x4A, 0x31, 0x4E, 0xE4, 0x78, 0xF4, 0xA5, 0xCE, 0x0B, 0x8A, 0x6B, 0x36, 0x52, 0x8E, 0xF7, 0xA8, 0x20, 0x69, 0x6C, 0x3E, 0x42, 0x46, 0xC5, 0xA1, 0x58, 0x64 }, -+ { 0x21, 0x6D, 0xC1, 0x2A, 0x10, 0x85, 0x69, 0xA3, 0xC7, 0xCD, 0xDE, 0x4A, 0xED, 0x43, 0xA6, 0xC3, 0x30, 0x13, 0x9D, 0xDA, 0x3C, 0xCC, 0x4A, 0x10, 0x89, 0x05, 0xDB, 0x38, 0x61, 0x89, 0x90, 0x50 }, -+ { 0xA5, 0x7B, 0xE6, 0xAE, 0x67, 0x56, 0xF2, 0x8B, 0x02, 0xF5, 0x9D, 0xAD, 0xF7, 0xE0, 0xD7, 0xD8, 0x80, 0x7F, 0x10, 0xFA, 0x15, 0xCE, 0xD1, 0xAD, 0x35, 0x85, 0x52, 0x1A, 0x1D, 0x99, 0x5A, 0x89 }, -+ { 0x81, 0x6A, 0xEF, 0x87, 0x59, 0x53, 0x71, 0x6C, 0xD7, 0xA5, 0x81, 0xF7, 0x32, 0xF5, 0x3D, 0xD4, 0x35, 0xDA, 0xB6, 0x6D, 0x09, 0xC3, 0x61, 0xD2, 0xD6, 0x59, 0x2D, 0xE1, 0x77, 0x55, 0xD8, 0xA8 }, -+ { 0x9A, 0x76, 0x89, 0x32, 0x26, 0x69, 0x3B, 0x6E, 0xA9, 0x7E, 0x6A, 0x73, 0x8F, 0x9D, 0x10, 0xFB, 0x3D, 0x0B, 0x43, 0xAE, 0x0E, 0x8B, 0x7D, 0x81, 0x23, 0xEA, 0x76, 0xCE, 0x97, 0x98, 0x9C, 0x7E }, -+ { 0x8D, 0xAE, 0xDB, 0x9A, 0x27, 0x15, 0x29, 0xDB, 0xB7, 0xDC, 0x3B, 0x60, 0x7F, 0xE5, 0xEB, 0x2D, 0x32, 0x11, 0x77, 0x07, 0x58, 0xDD, 0x3B, 0x0A, 0x35, 0x93, 0xD2, 0xD7, 0x95, 0x4E, 0x2D, 0x5B }, -+ { 0x16, 0xDB, 0xC0, 0xAA, 0x5D, 0xD2, 0xC7, 0x74, 0xF5, 0x05, 0x10, 0x0F, 0x73, 0x37, 0x86, 0xD8, 0xA1, 0x75, 0xFC, 0xBB, 0xB5, 0x9C, 0x43, 0xE1, 0xFB, 0xFF, 0x3E, 0x1E, 0xAF, 0x31, 0xCB, 0x4A }, -+ { 0x86, 0x06, 0xCB, 0x89, 0x9C, 0x6A, 0xEA, 0xF5, 0x1B, 0x9D, 0xB0, 0xFE, 0x49, 0x24, 0xA9, 0xFD, 0x5D, 0xAB, 0xC1, 0x9F, 0x88, 0x26, 0xF2, 0xBC, 0x1C, 0x1D, 0x7D, 0xA1, 0x4D, 0x2C, 0x2C, 0x99 }, -+ { 0x84, 0x79, 0x73, 0x1A, 0xED, 0xA5, 0x7B, 0xD3, 0x7E, 0xAD, 0xB5, 0x1A, 0x50, 0x7E, 0x30, 0x7F, 0x3B, 0xD9, 0x5E, 0x69, 0xDB, 0xCA, 0x94, 0xF3, 0xBC, 0x21, 0x72, 0x60, 0x66, 0xAD, 0x6D, 0xFD }, -+ { 0x58, 0x47, 0x3A, 0x9E, 0xA8, 0x2E, 0xFA, 0x3F, 0x3B, 0x3D, 0x8F, 0xC8, 0x3E, 0xD8, 0x86, 0x31, 0x27, 0xB3, 0x3A, 0xE8, 0xDE, 0xAE, 0x63, 0x07, 0x20, 0x1E, 0xDB, 0x6D, 0xDE, 0x61, 0xDE, 0x29 }, -+ { 0x9A, 0x92, 0x55, 0xD5, 0x3A, 0xF1, 0x16, 0xDE, 0x8B, 0xA2, 0x7C, 0xE3, 0x5B, 0x4C, 0x7E, 0x15, 0x64, 0x06, 0x57, 0xA0, 0xFC, 0xB8, 0x88, 0xC7, 0x0D, 0x95, 0x43, 0x1D, 0xAC, 0xD8, 0xF8, 0x30 }, -+ { 0x9E, 0xB0, 0x5F, 0xFB, 0xA3, 0x9F, 0xD8, 0x59, 0x6A, 0x45, 0x49, 0x3E, 0x18, 0xD2, 0x51, 0x0B, 0xF3, 0xEF, 0x06, 0x5C, 0x51, 0xD6, 0xE1, 0x3A, 0xBE, 0x66, 0xAA, 0x57, 0xE0, 0x5C, 0xFD, 0xB7 }, -+ { 0x81, 0xDC, 0xC3, 0xA5, 0x05, 0xEA, 0xCE, 0x3F, 0x87, 0x9D, 0x8F, 0x70, 0x27, 0x76, 0x77, 0x0F, 0x9D, 0xF5, 0x0E, 0x52, 0x1D, 0x14, 0x28, 0xA8, 0x5D, 0xAF, 0x04, 0xF9, 0xAD, 0x21, 0x50, 0xE0 }, -+ { 0xE3, 0xE3, 0xC4, 0xAA, 0x3A, 0xCB, 0xBC, 0x85, 0x33, 0x2A, 0xF9, 0xD5, 0x64, 0xBC, 0x24, 0x16, 0x5E, 0x16, 0x87, 0xF6, 0xB1, 0xAD, 0xCB, 0xFA, 0xE7, 0x7A, 0x8F, 0x03, 0xC7, 0x2A, 0xC2, 0x8C }, -+ { 0x67, 0x46, 0xC8, 0x0B, 0x4E, 0xB5, 0x6A, 0xEA, 0x45, 0xE6, 0x4E, 0x72, 0x89, 0xBB, 0xA3, 0xED, 0xBF, 0x45, 0xEC, 0xF8, 0x20, 0x64, 0x81, 0xFF, 0x63, 0x02, 0x12, 0x29, 0x84, 0xCD, 0x52, 0x6A }, -+ { 0x2B, 0x62, 0x8E, 0x52, 0x76, 0x4D, 0x7D, 0x62, 0xC0, 0x86, 0x8B, 0x21, 0x23, 0x57, 0xCD, 0xD1, 0x2D, 0x91, 0x49, 0x82, 0x2F, 0x4E, 0x98, 0x45, 0xD9, 0x18, 0xA0, 0x8D, 0x1A, 0xE9, 0x90, 0xC0 }, -+ { 0xE4, 0xBF, 0xE8, 0x0D, 0x58, 0xC9, 0x19, 0x94, 0x61, 0x39, 0x09, 0xDC, 0x4B, 0x1A, 0x12, 0x49, 0x68, 0x96, 0xC0, 0x04, 0xAF, 0x7B, 0x57, 0x01, 0x48, 0x3D, 0xE4, 0x5D, 0x28, 0x23, 0xD7, 0x8E }, -+ { 0xEB, 0xB4, 0xBA, 0x15, 0x0C, 0xEF, 0x27, 0x34, 0x34, 0x5B, 0x5D, 0x64, 0x1B, 0xBE, 0xD0, 0x3A, 0x21, 0xEA, 0xFA, 0xE9, 0x33, 0xC9, 0x9E, 0x00, 0x92, 0x12, 0xEF, 0x04, 0x57, 0x4A, 0x85, 0x30 }, -+ { 0x39, 0x66, 0xEC, 0x73, 0xB1, 0x54, 0xAC, 0xC6, 0x97, 0xAC, 0x5C, 0xF5, 0xB2, 0x4B, 0x40, 0xBD, 0xB0, 0xDB, 0x9E, 0x39, 0x88, 0x36, 0xD7, 0x6D, 0x4B, 0x88, 0x0E, 0x3B, 0x2A, 0xF1, 0xAA, 0x27 }, -+ { 0xEF, 0x7E, 0x48, 0x31, 0xB3, 0xA8, 0x46, 0x36, 0x51, 0x8D, 0x6E, 0x4B, 0xFC, 0xE6, 0x4A, 0x43, 0xDB, 0x2A, 0x5D, 0xDA, 0x9C, 0xCA, 0x2B, 0x44, 0xF3, 0x90, 0x33, 0xBD, 0xC4, 0x0D, 0x62, 0x43 }, -+ { 0x7A, 0xBF, 0x6A, 0xCF, 0x5C, 0x8E, 0x54, 0x9D, 0xDB, 0xB1, 0x5A, 0xE8, 0xD8, 0xB3, 0x88, 0xC1, 0xC1, 0x97, 0xE6, 0x98, 0x73, 0x7C, 0x97, 0x85, 0x50, 0x1E, 0xD1, 0xF9, 0x49, 0x30, 0xB7, 0xD9 }, -+ { 0x88, 0x01, 0x8D, 0xED, 0x66, 0x81, 0x3F, 0x0C, 0xA9, 0x5D, 0xEF, 0x47, 0x4C, 0x63, 0x06, 0x92, 0x01, 0x99, 0x67, 0xB9, 0xE3, 0x68, 0x88, 0xDA, 0xDD, 0x94, 0x12, 0x47, 0x19, 0xB6, 0x82, 0xF6 }, -+ { 0x39, 0x30, 0x87, 0x6B, 0x9F, 0xC7, 0x52, 0x90, 0x36, 0xB0, 0x08, 0xB1, 0xB8, 0xBB, 0x99, 0x75, 0x22, 0xA4, 0x41, 0x63, 0x5A, 0x0C, 0x25, 0xEC, 0x02, 0xFB, 0x6D, 0x90, 0x26, 0xE5, 0x5A, 0x97 }, -+ { 0x0A, 0x40, 0x49, 0xD5, 0x7E, 0x83, 0x3B, 0x56, 0x95, 0xFA, 0xC9, 0x3D, 0xD1, 0xFB, 0xEF, 0x31, 0x66, 0xB4, 0x4B, 0x12, 0xAD, 0x11, 0x24, 0x86, 0x62, 0x38, 0x3A, 0xE0, 0x51, 0xE1, 0x58, 0x27 }, -+ { 0x81, 0xDC, 0xC0, 0x67, 0x8B, 0xB6, 0xA7, 0x65, 0xE4, 0x8C, 0x32, 0x09, 0x65, 0x4F, 0xE9, 0x00, 0x89, 0xCE, 0x44, 0xFF, 0x56, 0x18, 0x47, 0x7E, 0x39, 0xAB, 0x28, 0x64, 0x76, 0xDF, 0x05, 0x2B }, -+ { 0xE6, 0x9B, 0x3A, 0x36, 0xA4, 0x46, 0x19, 0x12, 0xDC, 0x08, 0x34, 0x6B, 0x11, 0xDD, 0xCB, 0x9D, 0xB7, 0x96, 0xF8, 0x85, 0xFD, 0x01, 0x93, 0x6E, 0x66, 0x2F, 0xE2, 0x92, 0x97, 0xB0, 0x99, 0xA4 }, -+ { 0x5A, 0xC6, 0x50, 0x3B, 0x0D, 0x8D, 0xA6, 0x91, 0x76, 0x46, 0xE6, 0xDC, 0xC8, 0x7E, 0xDC, 0x58, 0xE9, 0x42, 0x45, 0x32, 0x4C, 0xC2, 0x04, 0xF4, 0xDD, 0x4A, 0xF0, 0x15, 0x63, 0xAC, 0xD4, 0x27 }, -+ { 0xDF, 0x6D, 0xDA, 0x21, 0x35, 0x9A, 0x30, 0xBC, 0x27, 0x17, 0x80, 0x97, 0x1C, 0x1A, 0xBD, 0x56, 0xA6, 0xEF, 0x16, 0x7E, 0x48, 0x08, 0x87, 0x88, 0x8E, 0x73, 0xA8, 0x6D, 0x3B, 0xF6, 0x05, 0xE9 }, -+ { 0xE8, 0xE6, 0xE4, 0x70, 0x71, 0xE7, 0xB7, 0xDF, 0x25, 0x80, 0xF2, 0x25, 0xCF, 0xBB, 0xED, 0xF8, 0x4C, 0xE6, 0x77, 0x46, 0x62, 0x66, 0x28, 0xD3, 0x30, 0x97, 0xE4, 0xB7, 0xDC, 0x57, 0x11, 0x07 }, -+ { 0x53, 0xE4, 0x0E, 0xAD, 0x62, 0x05, 0x1E, 0x19, 0xCB, 0x9B, 0xA8, 0x13, 0x3E, 0x3E, 0x5C, 0x1C, 0xE0, 0x0D, 0xDC, 0xAD, 0x8A, 0xCF, 0x34, 0x2A, 0x22, 0x43, 0x60, 0xB0, 0xAC, 0xC1, 0x47, 0x77 }, -+ { 0x9C, 0xCD, 0x53, 0xFE, 0x80, 0xBE, 0x78, 0x6A, 0xA9, 0x84, 0x63, 0x84, 0x62, 0xFB, 0x28, 0xAF, 0xDF, 0x12, 0x2B, 0x34, 0xD7, 0x8F, 0x46, 0x87, 0xEC, 0x63, 0x2B, 0xB1, 0x9D, 0xE2, 0x37, 0x1A }, -+ { 0xCB, 0xD4, 0x80, 0x52, 0xC4, 0x8D, 0x78, 0x84, 0x66, 0xA3, 0xE8, 0x11, 0x8C, 0x56, 0xC9, 0x7F, 0xE1, 0x46, 0xE5, 0x54, 0x6F, 0xAA, 0xF9, 0x3E, 0x2B, 0xC3, 0xC4, 0x7E, 0x45, 0x93, 0x97, 0x53 }, -+ { 0x25, 0x68, 0x83, 0xB1, 0x4E, 0x2A, 0xF4, 0x4D, 0xAD, 0xB2, 0x8E, 0x1B, 0x34, 0xB2, 0xAC, 0x0F, 0x0F, 0x4C, 0x91, 0xC3, 0x4E, 0xC9, 0x16, 0x9E, 0x29, 0x03, 0x61, 0x58, 0xAC, 0xAA, 0x95, 0xB9 }, -+ { 0x44, 0x71, 0xB9, 0x1A, 0xB4, 0x2D, 0xB7, 0xC4, 0xDD, 0x84, 0x90, 0xAB, 0x95, 0xA2, 0xEE, 0x8D, 0x04, 0xE3, 0xEF, 0x5C, 0x3D, 0x6F, 0xC7, 0x1A, 0xC7, 0x4B, 0x2B, 0x26, 0x91, 0x4D, 0x16, 0x41 }, -+ { 0xA5, 0xEB, 0x08, 0x03, 0x8F, 0x8F, 0x11, 0x55, 0xED, 0x86, 0xE6, 0x31, 0x90, 0x6F, 0xC1, 0x30, 0x95, 0xF6, 0xBB, 0xA4, 0x1D, 0xE5, 0xD4, 0xE7, 0x95, 0x75, 0x8E, 0xC8, 0xC8, 0xDF, 0x8A, 0xF1 }, -+ { 0xDC, 0x1D, 0xB6, 0x4E, 0xD8, 0xB4, 0x8A, 0x91, 0x0E, 0x06, 0x0A, 0x6B, 0x86, 0x63, 0x74, 0xC5, 0x78, 0x78, 0x4E, 0x9A, 0xC4, 0x9A, 0xB2, 0x77, 0x40, 0x92, 0xAC, 0x71, 0x50, 0x19, 0x34, 0xAC }, -+ { 0x28, 0x54, 0x13, 0xB2, 0xF2, 0xEE, 0x87, 0x3D, 0x34, 0x31, 0x9E, 0xE0, 0xBB, 0xFB, 0xB9, 0x0F, 0x32, 0xDA, 0x43, 0x4C, 0xC8, 0x7E, 0x3D, 0xB5, 0xED, 0x12, 0x1B, 0xB3, 0x98, 0xED, 0x96, 0x4B }, -+ { 0x02, 0x16, 0xE0, 0xF8, 0x1F, 0x75, 0x0F, 0x26, 0xF1, 0x99, 0x8B, 0xC3, 0x93, 0x4E, 0x3E, 0x12, 0x4C, 0x99, 0x45, 0xE6, 0x85, 0xA6, 0x0B, 0x25, 0xE8, 0xFB, 0xD9, 0x62, 0x5A, 0xB6, 0xB5, 0x99 }, -+ { 0x38, 0xC4, 0x10, 0xF5, 0xB9, 0xD4, 0x07, 0x20, 0x50, 0x75, 0x5B, 0x31, 0xDC, 0xA8, 0x9F, 0xD5, 0x39, 0x5C, 0x67, 0x85, 0xEE, 0xB3, 0xD7, 0x90, 0xF3, 0x20, 0xFF, 0x94, 0x1C, 0x5A, 0x93, 0xBF }, -+ { 0xF1, 0x84, 0x17, 0xB3, 0x9D, 0x61, 0x7A, 0xB1, 0xC1, 0x8F, 0xDF, 0x91, 0xEB, 0xD0, 0xFC, 0x6D, 0x55, 0x16, 0xBB, 0x34, 0xCF, 0x39, 0x36, 0x40, 0x37, 0xBC, 0xE8, 0x1F, 0xA0, 0x4C, 0xEC, 0xB1 }, -+ { 0x1F, 0xA8, 0x77, 0xDE, 0x67, 0x25, 0x9D, 0x19, 0x86, 0x3A, 0x2A, 0x34, 0xBC, 0xC6, 0x96, 0x2A, 0x2B, 0x25, 0xFC, 0xBF, 0x5C, 0xBE, 0xCD, 0x7E, 0xDE, 0x8F, 0x1F, 0xA3, 0x66, 0x88, 0xA7, 0x96 }, -+ { 0x5B, 0xD1, 0x69, 0xE6, 0x7C, 0x82, 0xC2, 0xC2, 0xE9, 0x8E, 0xF7, 0x00, 0x8B, 0xDF, 0x26, 0x1F, 0x2D, 0xDF, 0x30, 0xB1, 0xC0, 0x0F, 0x9E, 0x7F, 0x27, 0x5B, 0xB3, 0xE8, 0xA2, 0x8D, 0xC9, 0xA2 }, -+ { 0xC8, 0x0A, 0xBE, 0xEB, 0xB6, 0x69, 0xAD, 0x5D, 0xEE, 0xB5, 0xF5, 0xEC, 0x8E, 0xA6, 0xB7, 0xA0, 0x5D, 0xDF, 0x7D, 0x31, 0xEC, 0x4C, 0x0A, 0x2E, 0xE2, 0x0B, 0x0B, 0x98, 0xCA, 0xEC, 0x67, 0x46 }, -+ { 0xE7, 0x6D, 0x3F, 0xBD, 0xA5, 0xBA, 0x37, 0x4E, 0x6B, 0xF8, 0xE5, 0x0F, 0xAD, 0xC3, 0xBB, 0xB9, 0xBA, 0x5C, 0x20, 0x6E, 0xBD, 0xEC, 0x89, 0xA3, 0xA5, 0x4C, 0xF3, 0xDD, 0x84, 0xA0, 0x70, 0x16 }, -+ { 0x7B, 0xBA, 0x9D, 0xC5, 0xB5, 0xDB, 0x20, 0x71, 0xD1, 0x77, 0x52, 0xB1, 0x04, 0x4C, 0x1E, 0xCE, 0xD9, 0x6A, 0xAF, 0x2D, 0xD4, 0x6E, 0x9B, 0x43, 0x37, 0x50, 0xE8, 0xEA, 0x0D, 0xCC, 0x18, 0x70 }, -+ { 0xF2, 0x9B, 0x1B, 0x1A, 0xB9, 0xBA, 0xB1, 0x63, 0x01, 0x8E, 0xE3, 0xDA, 0x15, 0x23, 0x2C, 0xCA, 0x78, 0xEC, 0x52, 0xDB, 0xC3, 0x4E, 0xDA, 0x5B, 0x82, 0x2E, 0xC1, 0xD8, 0x0F, 0xC2, 0x1B, 0xD0 }, -+ { 0x9E, 0xE3, 0xE3, 0xE7, 0xE9, 0x00, 0xF1, 0xE1, 0x1D, 0x30, 0x8C, 0x4B, 0x2B, 0x30, 0x76, 0xD2, 0x72, 0xCF, 0x70, 0x12, 0x4F, 0x9F, 0x51, 0xE1, 0xDA, 0x60, 0xF3, 0x78, 0x46, 0xCD, 0xD2, 0xF4 }, -+ { 0x70, 0xEA, 0x3B, 0x01, 0x76, 0x92, 0x7D, 0x90, 0x96, 0xA1, 0x85, 0x08, 0xCD, 0x12, 0x3A, 0x29, 0x03, 0x25, 0x92, 0x0A, 0x9D, 0x00, 0xA8, 0x9B, 0x5D, 0xE0, 0x42, 0x73, 0xFB, 0xC7, 0x6B, 0x85 }, -+ { 0x67, 0xDE, 0x25, 0xC0, 0x2A, 0x4A, 0xAB, 0xA2, 0x3B, 0xDC, 0x97, 0x3C, 0x8B, 0xB0, 0xB5, 0x79, 0x6D, 0x47, 0xCC, 0x06, 0x59, 0xD4, 0x3D, 0xFF, 0x1F, 0x97, 0xDE, 0x17, 0x49, 0x63, 0xB6, 0x8E }, -+ { 0xB2, 0x16, 0x8E, 0x4E, 0x0F, 0x18, 0xB0, 0xE6, 0x41, 0x00, 0xB5, 0x17, 0xED, 0x95, 0x25, 0x7D, 0x73, 0xF0, 0x62, 0x0D, 0xF8, 0x85, 0xC1, 0x3D, 0x2E, 0xCF, 0x79, 0x36, 0x7B, 0x38, 0x4C, 0xEE }, -+ { 0x2E, 0x7D, 0xEC, 0x24, 0x28, 0x85, 0x3B, 0x2C, 0x71, 0x76, 0x07, 0x45, 0x54, 0x1F, 0x7A, 0xFE, 0x98, 0x25, 0xB5, 0xDD, 0x77, 0xDF, 0x06, 0x51, 0x1D, 0x84, 0x41, 0xA9, 0x4B, 0xAC, 0xC9, 0x27 }, -+ { 0xCA, 0x9F, 0xFA, 0xC4, 0xC4, 0x3F, 0x0B, 0x48, 0x46, 0x1D, 0xC5, 0xC2, 0x63, 0xBE, 0xA3, 0xF6, 0xF0, 0x06, 0x11, 0xCE, 0xAC, 0xAB, 0xF6, 0xF8, 0x95, 0xBA, 0x2B, 0x01, 0x01, 0xDB, 0xB6, 0x8D }, -+ { 0x74, 0x10, 0xD4, 0x2D, 0x8F, 0xD1, 0xD5, 0xE9, 0xD2, 0xF5, 0x81, 0x5C, 0xB9, 0x34, 0x17, 0x99, 0x88, 0x28, 0xEF, 0x3C, 0x42, 0x30, 0xBF, 0xBD, 0x41, 0x2D, 0xF0, 0xA4, 0xA7, 0xA2, 0x50, 0x7A }, -+ { 0x50, 0x10, 0xF6, 0x84, 0x51, 0x6D, 0xCC, 0xD0, 0xB6, 0xEE, 0x08, 0x52, 0xC2, 0x51, 0x2B, 0x4D, 0xC0, 0x06, 0x6C, 0xF0, 0xD5, 0x6F, 0x35, 0x30, 0x29, 0x78, 0xDB, 0x8A, 0xE3, 0x2C, 0x6A, 0x81 }, -+ { 0xAC, 0xAA, 0xB5, 0x85, 0xF7, 0xB7, 0x9B, 0x71, 0x99, 0x35, 0xCE, 0xB8, 0x95, 0x23, 0xDD, 0xC5, 0x48, 0x27, 0xF7, 0x5C, 0x56, 0x88, 0x38, 0x56, 0x15, 0x4A, 0x56, 0xCD, 0xCD, 0x5E, 0xE9, 0x88 }, -+ { 0x66, 0x6D, 0xE5, 0xD1, 0x44, 0x0F, 0xEE, 0x73, 0x31, 0xAA, 0xF0, 0x12, 0x3A, 0x62, 0xEF, 0x2D, 0x8B, 0xA5, 0x74, 0x53, 0xA0, 0x76, 0x96, 0x35, 0xAC, 0x6C, 0xD0, 0x1E, 0x63, 0x3F, 0x77, 0x12 }, -+ { 0xA6, 0xF9, 0x86, 0x58, 0xF6, 0xEA, 0xBA, 0xF9, 0x02, 0xD8, 0xB3, 0x87, 0x1A, 0x4B, 0x10, 0x1D, 0x16, 0x19, 0x6E, 0x8A, 0x4B, 0x24, 0x1E, 0x15, 0x58, 0xFE, 0x29, 0x96, 0x6E, 0x10, 0x3E, 0x8D }, -+ { 0x89, 0x15, 0x46, 0xA8, 0xB2, 0x9F, 0x30, 0x47, 0xDD, 0xCF, 0xE5, 0xB0, 0x0E, 0x45, 0xFD, 0x55, 0x75, 0x63, 0x73, 0x10, 0x5E, 0xA8, 0x63, 0x7D, 0xFC, 0xFF, 0x54, 0x7B, 0x6E, 0xA9, 0x53, 0x5F }, -+ { 0x18, 0xDF, 0xBC, 0x1A, 0xC5, 0xD2, 0x5B, 0x07, 0x61, 0x13, 0x7D, 0xBD, 0x22, 0xC1, 0x7C, 0x82, 0x9D, 0x0F, 0x0E, 0xF1, 0xD8, 0x23, 0x44, 0xE9, 0xC8, 0x9C, 0x28, 0x66, 0x94, 0xDA, 0x24, 0xE8 }, -+ { 0xB5, 0x4B, 0x9B, 0x67, 0xF8, 0xFE, 0xD5, 0x4B, 0xBF, 0x5A, 0x26, 0x66, 0xDB, 0xDF, 0x4B, 0x23, 0xCF, 0xF1, 0xD1, 0xB6, 0xF4, 0xAF, 0xC9, 0x85, 0xB2, 0xE6, 0xD3, 0x30, 0x5A, 0x9F, 0xF8, 0x0F }, -+ { 0x7D, 0xB4, 0x42, 0xE1, 0x32, 0xBA, 0x59, 0xBC, 0x12, 0x89, 0xAA, 0x98, 0xB0, 0xD3, 0xE8, 0x06, 0x00, 0x4F, 0x8E, 0xC1, 0x28, 0x11, 0xAF, 0x1E, 0x2E, 0x33, 0xC6, 0x9B, 0xFD, 0xE7, 0x29, 0xE1 }, -+ { 0x25, 0x0F, 0x37, 0xCD, 0xC1, 0x5E, 0x81, 0x7D, 0x2F, 0x16, 0x0D, 0x99, 0x56, 0xC7, 0x1F, 0xE3, 0xEB, 0x5D, 0xB7, 0x45, 0x56, 0xE4, 0xAD, 0xF9, 0xA4, 0xFF, 0xAF, 0xBA, 0x74, 0x01, 0x03, 0x96 }, -+ { 0x4A, 0xB8, 0xA3, 0xDD, 0x1D, 0xDF, 0x8A, 0xD4, 0x3D, 0xAB, 0x13, 0xA2, 0x7F, 0x66, 0xA6, 0x54, 0x4F, 0x29, 0x05, 0x97, 0xFA, 0x96, 0x04, 0x0E, 0x0E, 0x1D, 0xB9, 0x26, 0x3A, 0xA4, 0x79, 0xF8 }, -+ { 0xEE, 0x61, 0x72, 0x7A, 0x07, 0x66, 0xDF, 0x93, 0x9C, 0xCD, 0xC8, 0x60, 0x33, 0x40, 0x44, 0xC7, 0x9A, 0x3C, 0x9B, 0x15, 0x62, 0x00, 0xBC, 0x3A, 0xA3, 0x29, 0x73, 0x48, 0x3D, 0x83, 0x41, 0xAE }, -+ { 0x3F, 0x68, 0xC7, 0xEC, 0x63, 0xAC, 0x11, 0xEB, 0xB9, 0x8F, 0x94, 0xB3, 0x39, 0xB0, 0x5C, 0x10, 0x49, 0x84, 0xFD, 0xA5, 0x01, 0x03, 0x06, 0x01, 0x44, 0xE5, 0xA2, 0xBF, 0xCC, 0xC9, 0xDA, 0x95 }, -+ { 0x05, 0x6F, 0x29, 0x81, 0x6B, 0x8A, 0xF8, 0xF5, 0x66, 0x82, 0xBC, 0x4D, 0x7C, 0xF0, 0x94, 0x11, 0x1D, 0xA7, 0x73, 0x3E, 0x72, 0x6C, 0xD1, 0x3D, 0x6B, 0x3E, 0x8E, 0xA0, 0x3E, 0x92, 0xA0, 0xD5 }, -+ { 0xF5, 0xEC, 0x43, 0xA2, 0x8A, 0xCB, 0xEF, 0xF1, 0xF3, 0x31, 0x8A, 0x5B, 0xCA, 0xC7, 0xC6, 0x6D, 0xDB, 0x52, 0x30, 0xB7, 0x9D, 0xB2, 0xD1, 0x05, 0xBC, 0xBE, 0x15, 0xF3, 0xC1, 0x14, 0x8D, 0x69 }, -+ { 0x2A, 0x69, 0x60, 0xAD, 0x1D, 0x8D, 0xD5, 0x47, 0x55, 0x5C, 0xFB, 0xD5, 0xE4, 0x60, 0x0F, 0x1E, 0xAA, 0x1C, 0x8E, 0xDA, 0x34, 0xDE, 0x03, 0x74, 0xEC, 0x4A, 0x26, 0xEA, 0xAA, 0xA3, 0x3B, 0x4E }, -+ { 0xDC, 0xC1, 0xEA, 0x7B, 0xAA, 0xB9, 0x33, 0x84, 0xF7, 0x6B, 0x79, 0x68, 0x66, 0x19, 0x97, 0x54, 0x74, 0x2F, 0x7B, 0x96, 0xD6, 0xB4, 0xC1, 0x20, 0x16, 0x5C, 0x04, 0xA6, 0xC4, 0xF5, 0xCE, 0x10 }, -+ { 0x13, 0xD5, 0xDF, 0x17, 0x92, 0x21, 0x37, 0x9C, 0x6A, 0x78, 0xC0, 0x7C, 0x79, 0x3F, 0xF5, 0x34, 0x87, 0xCA, 0xE6, 0xBF, 0x9F, 0xE8, 0x82, 0x54, 0x1A, 0xB0, 0xE7, 0x35, 0xE3, 0xEA, 0xDA, 0x3B }, -+ { 0x8C, 0x59, 0xE4, 0x40, 0x76, 0x41, 0xA0, 0x1E, 0x8F, 0xF9, 0x1F, 0x99, 0x80, 0xDC, 0x23, 0x6F, 0x4E, 0xCD, 0x6F, 0xCF, 0x52, 0x58, 0x9A, 0x09, 0x9A, 0x96, 0x16, 0x33, 0x96, 0x77, 0x14, 0xE1 }, -+ { 0x83, 0x3B, 0x1A, 0xC6, 0xA2, 0x51, 0xFD, 0x08, 0xFD, 0x6D, 0x90, 0x8F, 0xEA, 0x2A, 0x4E, 0xE1, 0xE0, 0x40, 0xBC, 0xA9, 0x3F, 0xC1, 0xA3, 0x8E, 0xC3, 0x82, 0x0E, 0x0C, 0x10, 0xBD, 0x82, 0xEA }, -+ { 0xA2, 0x44, 0xF9, 0x27, 0xF3, 0xB4, 0x0B, 0x8F, 0x6C, 0x39, 0x15, 0x70, 0xC7, 0x65, 0x41, 0x8F, 0x2F, 0x6E, 0x70, 0x8E, 0xAC, 0x90, 0x06, 0xC5, 0x1A, 0x7F, 0xEF, 0xF4, 0xAF, 0x3B, 0x2B, 0x9E }, -+ { 0x3D, 0x99, 0xED, 0x95, 0x50, 0xCF, 0x11, 0x96, 0xE6, 0xC4, 0xD2, 0x0C, 0x25, 0x96, 0x20, 0xF8, 0x58, 0xC3, 0xD7, 0x03, 0x37, 0x4C, 0x12, 0x8C, 0xE7, 0xB5, 0x90, 0x31, 0x0C, 0x83, 0x04, 0x6D }, -+ { 0x2B, 0x35, 0xC4, 0x7D, 0x7B, 0x87, 0x76, 0x1F, 0x0A, 0xE4, 0x3A, 0xC5, 0x6A, 0xC2, 0x7B, 0x9F, 0x25, 0x83, 0x03, 0x67, 0xB5, 0x95, 0xBE, 0x8C, 0x24, 0x0E, 0x94, 0x60, 0x0C, 0x6E, 0x33, 0x12 }, -+ { 0x5D, 0x11, 0xED, 0x37, 0xD2, 0x4D, 0xC7, 0x67, 0x30, 0x5C, 0xB7, 0xE1, 0x46, 0x7D, 0x87, 0xC0, 0x65, 0xAC, 0x4B, 0xC8, 0xA4, 0x26, 0xDE, 0x38, 0x99, 0x1F, 0xF5, 0x9A, 0xA8, 0x73, 0x5D, 0x02 }, -+ { 0xB8, 0x36, 0x47, 0x8E, 0x1C, 0xA0, 0x64, 0x0D, 0xCE, 0x6F, 0xD9, 0x10, 0xA5, 0x09, 0x62, 0x72, 0xC8, 0x33, 0x09, 0x90, 0xCD, 0x97, 0x86, 0x4A, 0xC2, 0xBF, 0x14, 0xEF, 0x6B, 0x23, 0x91, 0x4A }, -+ { 0x91, 0x00, 0xF9, 0x46, 0xD6, 0xCC, 0xDE, 0x3A, 0x59, 0x7F, 0x90, 0xD3, 0x9F, 0xC1, 0x21, 0x5B, 0xAD, 0xDC, 0x74, 0x13, 0x64, 0x3D, 0x85, 0xC2, 0x1C, 0x3E, 0xEE, 0x5D, 0x2D, 0xD3, 0x28, 0x94 }, -+ { 0xDA, 0x70, 0xEE, 0xDD, 0x23, 0xE6, 0x63, 0xAA, 0x1A, 0x74, 0xB9, 0x76, 0x69, 0x35, 0xB4, 0x79, 0x22, 0x2A, 0x72, 0xAF, 0xBA, 0x5C, 0x79, 0x51, 0x58, 0xDA, 0xD4, 0x1A, 0x3B, 0xD7, 0x7E, 0x40 }, -+ { 0xF0, 0x67, 0xED, 0x6A, 0x0D, 0xBD, 0x43, 0xAA, 0x0A, 0x92, 0x54, 0xE6, 0x9F, 0xD6, 0x6B, 0xDD, 0x8A, 0xCB, 0x87, 0xDE, 0x93, 0x6C, 0x25, 0x8C, 0xFB, 0x02, 0x28, 0x5F, 0x2C, 0x11, 0xFA, 0x79 }, -+ { 0x71, 0x5C, 0x99, 0xC7, 0xD5, 0x75, 0x80, 0xCF, 0x97, 0x53, 0xB4, 0xC1, 0xD7, 0x95, 0xE4, 0x5A, 0x83, 0xFB, 0xB2, 0x28, 0xC0, 0xD3, 0x6F, 0xBE, 0x20, 0xFA, 0xF3, 0x9B, 0xDD, 0x6D, 0x4E, 0x85 }, -+ { 0xE4, 0x57, 0xD6, 0xAD, 0x1E, 0x67, 0xCB, 0x9B, 0xBD, 0x17, 0xCB, 0xD6, 0x98, 0xFA, 0x6D, 0x7D, 0xAE, 0x0C, 0x9B, 0x7A, 0xD6, 0xCB, 0xD6, 0x53, 0x96, 0x34, 0xE3, 0x2A, 0x71, 0x9C, 0x84, 0x92 }, -+ { 0xEC, 0xE3, 0xEA, 0x81, 0x03, 0xE0, 0x24, 0x83, 0xC6, 0x4A, 0x70, 0xA4, 0xBD, 0xCE, 0xE8, 0xCE, 0xB6, 0x27, 0x8F, 0x25, 0x33, 0xF3, 0xF4, 0x8D, 0xBE, 0xED, 0xFB, 0xA9, 0x45, 0x31, 0xD4, 0xAE }, -+ { 0x38, 0x8A, 0xA5, 0xD3, 0x66, 0x7A, 0x97, 0xC6, 0x8D, 0x3D, 0x56, 0xF8, 0xF3, 0xEE, 0x8D, 0x3D, 0x36, 0x09, 0x1F, 0x17, 0xFE, 0x5D, 0x1B, 0x0D, 0x5D, 0x84, 0xC9, 0x3B, 0x2F, 0xFE, 0x40, 0xBD }, -+ { 0x8B, 0x6B, 0x31, 0xB9, 0xAD, 0x7C, 0x3D, 0x5C, 0xD8, 0x4B, 0xF9, 0x89, 0x47, 0xB9, 0xCD, 0xB5, 0x9D, 0xF8, 0xA2, 0x5F, 0xF7, 0x38, 0x10, 0x10, 0x13, 0xBE, 0x4F, 0xD6, 0x5E, 0x1D, 0xD1, 0xA3 }, -+ { 0x06, 0x62, 0x91, 0xF6, 0xBB, 0xD2, 0x5F, 0x3C, 0x85, 0x3D, 0xB7, 0xD8, 0xB9, 0x5C, 0x9A, 0x1C, 0xFB, 0x9B, 0xF1, 0xC1, 0xC9, 0x9F, 0xB9, 0x5A, 0x9B, 0x78, 0x69, 0xD9, 0x0F, 0x1C, 0x29, 0x03 }, -+ { 0xA7, 0x07, 0xEF, 0xBC, 0xCD, 0xCE, 0xED, 0x42, 0x96, 0x7A, 0x66, 0xF5, 0x53, 0x9B, 0x93, 0xED, 0x75, 0x60, 0xD4, 0x67, 0x30, 0x40, 0x16, 0xC4, 0x78, 0x0D, 0x77, 0x55, 0xA5, 0x65, 0xD4, 0xC4 }, -+ { 0x38, 0xC5, 0x3D, 0xFB, 0x70, 0xBE, 0x7E, 0x79, 0x2B, 0x07, 0xA6, 0xA3, 0x5B, 0x8A, 0x6A, 0x0A, 0xBA, 0x02, 0xC5, 0xC5, 0xF3, 0x8B, 0xAF, 0x5C, 0x82, 0x3F, 0xDF, 0xD9, 0xE4, 0x2D, 0x65, 0x7E }, -+ { 0xF2, 0x91, 0x13, 0x86, 0x50, 0x1D, 0x9A, 0xB9, 0xD7, 0x20, 0xCF, 0x8A, 0xD1, 0x05, 0x03, 0xD5, 0x63, 0x4B, 0xF4, 0xB7, 0xD1, 0x2B, 0x56, 0xDF, 0xB7, 0x4F, 0xEC, 0xC6, 0xE4, 0x09, 0x3F, 0x68 }, -+ { 0xC6, 0xF2, 0xBD, 0xD5, 0x2B, 0x81, 0xE6, 0xE4, 0xF6, 0x59, 0x5A, 0xBD, 0x4D, 0x7F, 0xB3, 0x1F, 0x65, 0x11, 0x69, 0xD0, 0x0F, 0xF3, 0x26, 0x92, 0x6B, 0x34, 0x94, 0x7B, 0x28, 0xA8, 0x39, 0x59 }, -+ { 0x29, 0x3D, 0x94, 0xB1, 0x8C, 0x98, 0xBB, 0x32, 0x23, 0x36, 0x6B, 0x8C, 0xE7, 0x4C, 0x28, 0xFB, 0xDF, 0x28, 0xE1, 0xF8, 0x4A, 0x33, 0x50, 0xB0, 0xEB, 0x2D, 0x18, 0x04, 0xA5, 0x77, 0x57, 0x9B }, -+ { 0x2C, 0x2F, 0xA5, 0xC0, 0xB5, 0x15, 0x33, 0x16, 0x5B, 0xC3, 0x75, 0xC2, 0x2E, 0x27, 0x81, 0x76, 0x82, 0x70, 0xA3, 0x83, 0x98, 0x5D, 0x13, 0xBD, 0x6B, 0x67, 0xB6, 0xFD, 0x67, 0xF8, 0x89, 0xEB }, -+ { 0xCA, 0xA0, 0x9B, 0x82, 0xB7, 0x25, 0x62, 0xE4, 0x3F, 0x4B, 0x22, 0x75, 0xC0, 0x91, 0x91, 0x8E, 0x62, 0x4D, 0x91, 0x16, 0x61, 0xCC, 0x81, 0x1B, 0xB5, 0xFA, 0xEC, 0x51, 0xF6, 0x08, 0x8E, 0xF7 }, -+ { 0x24, 0x76, 0x1E, 0x45, 0xE6, 0x74, 0x39, 0x53, 0x79, 0xFB, 0x17, 0x72, 0x9C, 0x78, 0xCB, 0x93, 0x9E, 0x6F, 0x74, 0xC5, 0xDF, 0xFB, 0x9C, 0x96, 0x1F, 0x49, 0x59, 0x82, 0xC3, 0xED, 0x1F, 0xE3 }, -+ { 0x55, 0xB7, 0x0A, 0x82, 0x13, 0x1E, 0xC9, 0x48, 0x88, 0xD7, 0xAB, 0x54, 0xA7, 0xC5, 0x15, 0x25, 0x5C, 0x39, 0x38, 0xBB, 0x10, 0xBC, 0x78, 0x4D, 0xC9, 0xB6, 0x7F, 0x07, 0x6E, 0x34, 0x1A, 0x73 }, -+ { 0x6A, 0xB9, 0x05, 0x7B, 0x97, 0x7E, 0xBC, 0x3C, 0xA4, 0xD4, 0xCE, 0x74, 0x50, 0x6C, 0x25, 0xCC, 0xCD, 0xC5, 0x66, 0x49, 0x7C, 0x45, 0x0B, 0x54, 0x15, 0xA3, 0x94, 0x86, 0xF8, 0x65, 0x7A, 0x03 }, -+ { 0x24, 0x06, 0x6D, 0xEE, 0xE0, 0xEC, 0xEE, 0x15, 0xA4, 0x5F, 0x0A, 0x32, 0x6D, 0x0F, 0x8D, 0xBC, 0x79, 0x76, 0x1E, 0xBB, 0x93, 0xCF, 0x8C, 0x03, 0x77, 0xAF, 0x44, 0x09, 0x78, 0xFC, 0xF9, 0x94 }, -+ { 0x20, 0x00, 0x0D, 0x3F, 0x66, 0xBA, 0x76, 0x86, 0x0D, 0x5A, 0x95, 0x06, 0x88, 0xB9, 0xAA, 0x0D, 0x76, 0xCF, 0xEA, 0x59, 0xB0, 0x05, 0xD8, 0x59, 0x91, 0x4B, 0x1A, 0x46, 0x65, 0x3A, 0x93, 0x9B }, -+ { 0xB9, 0x2D, 0xAA, 0x79, 0x60, 0x3E, 0x3B, 0xDB, 0xC3, 0xBF, 0xE0, 0xF4, 0x19, 0xE4, 0x09, 0xB2, 0xEA, 0x10, 0xDC, 0x43, 0x5B, 0xEE, 0xFE, 0x29, 0x59, 0xDA, 0x16, 0x89, 0x5D, 0x5D, 0xCA, 0x1C }, -+ { 0xE9, 0x47, 0x94, 0x87, 0x05, 0xB2, 0x06, 0xD5, 0x72, 0xB0, 0xE8, 0xF6, 0x2F, 0x66, 0xA6, 0x55, 0x1C, 0xBD, 0x6B, 0xC3, 0x05, 0xD2, 0x6C, 0xE7, 0x53, 0x9A, 0x12, 0xF9, 0xAA, 0xDF, 0x75, 0x71 }, -+ { 0x3D, 0x67, 0xC1, 0xB3, 0xF9, 0xB2, 0x39, 0x10, 0xE3, 0xD3, 0x5E, 0x6B, 0x0F, 0x2C, 0xCF, 0x44, 0xA0, 0xB5, 0x40, 0xA4, 0x5C, 0x18, 0xBA, 0x3C, 0x36, 0x26, 0x4D, 0xD4, 0x8E, 0x96, 0xAF, 0x6A }, -+ { 0xC7, 0x55, 0x8B, 0xAB, 0xDA, 0x04, 0xBC, 0xCB, 0x76, 0x4D, 0x0B, 0xBF, 0x33, 0x58, 0x42, 0x51, 0x41, 0x90, 0x2D, 0x22, 0x39, 0x1D, 0x9F, 0x8C, 0x59, 0x15, 0x9F, 0xEC, 0x9E, 0x49, 0xB1, 0x51 }, -+ { 0x0B, 0x73, 0x2B, 0xB0, 0x35, 0x67, 0x5A, 0x50, 0xFF, 0x58, 0xF2, 0xC2, 0x42, 0xE4, 0x71, 0x0A, 0xEC, 0xE6, 0x46, 0x70, 0x07, 0x9C, 0x13, 0x04, 0x4C, 0x79, 0xC9, 0xB7, 0x49, 0x1F, 0x70, 0x00 }, -+ { 0xD1, 0x20, 0xB5, 0xEF, 0x6D, 0x57, 0xEB, 0xF0, 0x6E, 0xAF, 0x96, 0xBC, 0x93, 0x3C, 0x96, 0x7B, 0x16, 0xCB, 0xE6, 0xE2, 0xBF, 0x00, 0x74, 0x1C, 0x30, 0xAA, 0x1C, 0x54, 0xBA, 0x64, 0x80, 0x1F }, -+ { 0x58, 0xD2, 0x12, 0xAD, 0x6F, 0x58, 0xAE, 0xF0, 0xF8, 0x01, 0x16, 0xB4, 0x41, 0xE5, 0x7F, 0x61, 0x95, 0xBF, 0xEF, 0x26, 0xB6, 0x14, 0x63, 0xED, 0xEC, 0x11, 0x83, 0xCD, 0xB0, 0x4F, 0xE7, 0x6D }, -+ { 0xB8, 0x83, 0x6F, 0x51, 0xD1, 0xE2, 0x9B, 0xDF, 0xDB, 0xA3, 0x25, 0x56, 0x53, 0x60, 0x26, 0x8B, 0x8F, 0xAD, 0x62, 0x74, 0x73, 0xED, 0xEC, 0xEF, 0x7E, 0xAE, 0xFE, 0xE8, 0x37, 0xC7, 0x40, 0x03 }, -+ { 0xC5, 0x47, 0xA3, 0xC1, 0x24, 0xAE, 0x56, 0x85, 0xFF, 0xA7, 0xB8, 0xED, 0xAF, 0x96, 0xEC, 0x86, 0xF8, 0xB2, 0xD0, 0xD5, 0x0C, 0xEE, 0x8B, 0xE3, 0xB1, 0xF0, 0xC7, 0x67, 0x63, 0x06, 0x9D, 0x9C }, -+ { 0x5D, 0x16, 0x8B, 0x76, 0x9A, 0x2F, 0x67, 0x85, 0x3D, 0x62, 0x95, 0xF7, 0x56, 0x8B, 0xE4, 0x0B, 0xB7, 0xA1, 0x6B, 0x8D, 0x65, 0xBA, 0x87, 0x63, 0x5D, 0x19, 0x78, 0xD2, 0xAB, 0x11, 0xBA, 0x2A }, -+ { 0xA2, 0xF6, 0x75, 0xDC, 0x73, 0x02, 0x63, 0x8C, 0xB6, 0x02, 0x01, 0x06, 0x4C, 0xA5, 0x50, 0x77, 0x71, 0x4D, 0x71, 0xFE, 0x09, 0x6A, 0x31, 0x5F, 0x2F, 0xE7, 0x40, 0x12, 0x77, 0xCA, 0xA5, 0xAF }, -+ { 0xC8, 0xAA, 0xB5, 0xCD, 0x01, 0x60, 0xAE, 0x78, 0xCD, 0x2E, 0x8A, 0xC5, 0xFB, 0x0E, 0x09, 0x3C, 0xDB, 0x5C, 0x4B, 0x60, 0x52, 0xA0, 0xA9, 0x7B, 0xB0, 0x42, 0x16, 0x82, 0x6F, 0xA7, 0xA4, 0x37 }, -+ { 0xFF, 0x68, 0xCA, 0x40, 0x35, 0xBF, 0xEB, 0x43, 0xFB, 0xF1, 0x45, 0xFD, 0xDD, 0x5E, 0x43, 0xF1, 0xCE, 0xA5, 0x4F, 0x11, 0xF7, 0xBE, 0xE1, 0x30, 0x58, 0xF0, 0x27, 0x32, 0x9A, 0x4A, 0x5F, 0xA4 }, -+ { 0x1D, 0x4E, 0x54, 0x87, 0xAE, 0x3C, 0x74, 0x0F, 0x2B, 0xA6, 0xE5, 0x41, 0xAC, 0x91, 0xBC, 0x2B, 0xFC, 0xD2, 0x99, 0x9C, 0x51, 0x8D, 0x80, 0x7B, 0x42, 0x67, 0x48, 0x80, 0x3A, 0x35, 0x0F, 0xD4 }, -+ { 0x6D, 0x24, 0x4E, 0x1A, 0x06, 0xCE, 0x4E, 0xF5, 0x78, 0xDD, 0x0F, 0x63, 0xAF, 0xF0, 0x93, 0x67, 0x06, 0x73, 0x51, 0x19, 0xCA, 0x9C, 0x8D, 0x22, 0xD8, 0x6C, 0x80, 0x14, 0x14, 0xAB, 0x97, 0x41 }, -+ { 0xDE, 0xCF, 0x73, 0x29, 0xDB, 0xCC, 0x82, 0x7B, 0x8F, 0xC5, 0x24, 0xC9, 0x43, 0x1E, 0x89, 0x98, 0x02, 0x9E, 0xCE, 0x12, 0xCE, 0x93, 0xB7, 0xB2, 0xF3, 0xE7, 0x69, 0xA9, 0x41, 0xFB, 0x8C, 0xEA }, -+ { 0x2F, 0xAF, 0xCC, 0x0F, 0x2E, 0x63, 0xCB, 0xD0, 0x77, 0x55, 0xBE, 0x7B, 0x75, 0xEC, 0xEA, 0x0A, 0xDF, 0xF9, 0xAA, 0x5E, 0xDE, 0x2A, 0x52, 0xFD, 0xAB, 0x4D, 0xFD, 0x03, 0x74, 0xCD, 0x48, 0x3F }, -+ { 0xAA, 0x85, 0x01, 0x0D, 0xD4, 0x6A, 0x54, 0x6B, 0x53, 0x5E, 0xF4, 0xCF, 0x5F, 0x07, 0xD6, 0x51, 0x61, 0xE8, 0x98, 0x28, 0xF3, 0xA7, 0x7D, 0xB7, 0xB9, 0xB5, 0x6F, 0x0D, 0xF5, 0x9A, 0xAE, 0x45 }, -+ { 0x07, 0xE8, 0xE1, 0xEE, 0x73, 0x2C, 0xB0, 0xD3, 0x56, 0xC9, 0xC0, 0xD1, 0x06, 0x9C, 0x89, 0xD1, 0x7A, 0xDF, 0x6A, 0x9A, 0x33, 0x4F, 0x74, 0x5E, 0xC7, 0x86, 0x73, 0x32, 0x54, 0x8C, 0xA8, 0xE9 }, -+ { 0x0E, 0x01, 0xE8, 0x1C, 0xAD, 0xA8, 0x16, 0x2B, 0xFD, 0x5F, 0x8A, 0x8C, 0x81, 0x8A, 0x6C, 0x69, 0xFE, 0xDF, 0x02, 0xCE, 0xB5, 0x20, 0x85, 0x23, 0xCB, 0xE5, 0x31, 0x3B, 0x89, 0xCA, 0x10, 0x53 }, -+ { 0x6B, 0xB6, 0xC6, 0x47, 0x26, 0x55, 0x08, 0x43, 0x99, 0x85, 0x2E, 0x00, 0x24, 0x9F, 0x8C, 0xB2, 0x47, 0x89, 0x6D, 0x39, 0x2B, 0x02, 0xD7, 0x3B, 0x7F, 0x0D, 0xD8, 0x18, 0xE1, 0xE2, 0x9B, 0x07 }, -+ { 0x42, 0xD4, 0x63, 0x6E, 0x20, 0x60, 0xF0, 0x8F, 0x41, 0xC8, 0x82, 0xE7, 0x6B, 0x39, 0x6B, 0x11, 0x2E, 0xF6, 0x27, 0xCC, 0x24, 0xC4, 0x3D, 0xD5, 0xF8, 0x3A, 0x1D, 0x1A, 0x7E, 0xAD, 0x71, 0x1A }, -+ { 0x48, 0x58, 0xC9, 0xA1, 0x88, 0xB0, 0x23, 0x4F, 0xB9, 0xA8, 0xD4, 0x7D, 0x0B, 0x41, 0x33, 0x65, 0x0A, 0x03, 0x0B, 0xD0, 0x61, 0x1B, 0x87, 0xC3, 0x89, 0x2E, 0x94, 0x95, 0x1F, 0x8D, 0xF8, 0x52 }, -+ { 0x3F, 0xAB, 0x3E, 0x36, 0x98, 0x8D, 0x44, 0x5A, 0x51, 0xC8, 0x78, 0x3E, 0x53, 0x1B, 0xE3, 0xA0, 0x2B, 0xE4, 0x0C, 0xD0, 0x47, 0x96, 0xCF, 0xB6, 0x1D, 0x40, 0x34, 0x74, 0x42, 0xD3, 0xF7, 0x94 }, -+ { 0xEB, 0xAB, 0xC4, 0x96, 0x36, 0xBD, 0x43, 0x3D, 0x2E, 0xC8, 0xF0, 0xE5, 0x18, 0x73, 0x2E, 0xF8, 0xFA, 0x21, 0xD4, 0xD0, 0x71, 0xCC, 0x3B, 0xC4, 0x6C, 0xD7, 0x9F, 0xA3, 0x8A, 0x28, 0xB8, 0x10 }, -+ { 0xA1, 0xD0, 0x34, 0x35, 0x23, 0xB8, 0x93, 0xFC, 0xA8, 0x4F, 0x47, 0xFE, 0xB4, 0xA6, 0x4D, 0x35, 0x0A, 0x17, 0xD8, 0xEE, 0xF5, 0x49, 0x7E, 0xCE, 0x69, 0x7D, 0x02, 0xD7, 0x91, 0x78, 0xB5, 0x91 }, -+ { 0x26, 0x2E, 0xBF, 0xD9, 0x13, 0x0B, 0x7D, 0x28, 0x76, 0x0D, 0x08, 0xEF, 0x8B, 0xFD, 0x3B, 0x86, 0xCD, 0xD3, 0xB2, 0x11, 0x3D, 0x2C, 0xAE, 0xF7, 0xEA, 0x95, 0x1A, 0x30, 0x3D, 0xFA, 0x38, 0x46 }, -+ { 0xF7, 0x61, 0x58, 0xED, 0xD5, 0x0A, 0x15, 0x4F, 0xA7, 0x82, 0x03, 0xED, 0x23, 0x62, 0x93, 0x2F, 0xCB, 0x82, 0x53, 0xAA, 0xE3, 0x78, 0x90, 0x3E, 0xDE, 0xD1, 0xE0, 0x3F, 0x70, 0x21, 0xA2, 0x57 }, -+ { 0x26, 0x17, 0x8E, 0x95, 0x0A, 0xC7, 0x22, 0xF6, 0x7A, 0xE5, 0x6E, 0x57, 0x1B, 0x28, 0x4C, 0x02, 0x07, 0x68, 0x4A, 0x63, 0x34, 0xA1, 0x77, 0x48, 0xA9, 0x4D, 0x26, 0x0B, 0xC5, 0xF5, 0x52, 0x74 }, -+ { 0xC3, 0x78, 0xD1, 0xE4, 0x93, 0xB4, 0x0E, 0xF1, 0x1F, 0xE6, 0xA1, 0x5D, 0x9C, 0x27, 0x37, 0xA3, 0x78, 0x09, 0x63, 0x4C, 0x5A, 0xBA, 0xD5, 0xB3, 0x3D, 0x7E, 0x39, 0x3B, 0x4A, 0xE0, 0x5D, 0x03 }, -+ { 0x98, 0x4B, 0xD8, 0x37, 0x91, 0x01, 0xBE, 0x8F, 0xD8, 0x06, 0x12, 0xD8, 0xEA, 0x29, 0x59, 0xA7, 0x86, 0x5E, 0xC9, 0x71, 0x85, 0x23, 0x55, 0x01, 0x07, 0xAE, 0x39, 0x38, 0xDF, 0x32, 0x01, 0x1B }, -+ { 0xC6, 0xF2, 0x5A, 0x81, 0x2A, 0x14, 0x48, 0x58, 0xAC, 0x5C, 0xED, 0x37, 0xA9, 0x3A, 0x9F, 0x47, 0x59, 0xBA, 0x0B, 0x1C, 0x0F, 0xDC, 0x43, 0x1D, 0xCE, 0x35, 0xF9, 0xEC, 0x1F, 0x1F, 0x4A, 0x99 }, -+ { 0x92, 0x4C, 0x75, 0xC9, 0x44, 0x24, 0xFF, 0x75, 0xE7, 0x4B, 0x8B, 0x4E, 0x94, 0x35, 0x89, 0x58, 0xB0, 0x27, 0xB1, 0x71, 0xDF, 0x5E, 0x57, 0x89, 0x9A, 0xD0, 0xD4, 0xDA, 0xC3, 0x73, 0x53, 0xB6 }, -+ { 0x0A, 0xF3, 0x58, 0x92, 0xA6, 0x3F, 0x45, 0x93, 0x1F, 0x68, 0x46, 0xED, 0x19, 0x03, 0x61, 0xCD, 0x07, 0x30, 0x89, 0xE0, 0x77, 0x16, 0x57, 0x14, 0xB5, 0x0B, 0x81, 0xA2, 0xE3, 0xDD, 0x9B, 0xA1 }, -+ { 0xCC, 0x80, 0xCE, 0xFB, 0x26, 0xC3, 0xB2, 0xB0, 0xDA, 0xEF, 0x23, 0x3E, 0x60, 0x6D, 0x5F, 0xFC, 0x80, 0xFA, 0x17, 0x42, 0x7D, 0x18, 0xE3, 0x04, 0x89, 0x67, 0x3E, 0x06, 0xEF, 0x4B, 0x87, 0xF7 }, -+ { 0xC2, 0xF8, 0xC8, 0x11, 0x74, 0x47, 0xF3, 0x97, 0x8B, 0x08, 0x18, 0xDC, 0xF6, 0xF7, 0x01, 0x16, 0xAC, 0x56, 0xFD, 0x18, 0x4D, 0xD1, 0x27, 0x84, 0x94, 0xE1, 0x03, 0xFC, 0x6D, 0x74, 0xA8, 0x87 }, -+ { 0xBD, 0xEC, 0xF6, 0xBF, 0xC1, 0xBA, 0x0D, 0xF6, 0xE8, 0x62, 0xC8, 0x31, 0x99, 0x22, 0x07, 0x79, 0x6A, 0xCC, 0x79, 0x79, 0x68, 0x35, 0x88, 0x28, 0xC0, 0x6E, 0x7A, 0x51, 0xE0, 0x90, 0x09, 0x8F }, -+ { 0x24, 0xD1, 0xA2, 0x6E, 0x3D, 0xAB, 0x02, 0xFE, 0x45, 0x72, 0xD2, 0xAA, 0x7D, 0xBD, 0x3E, 0xC3, 0x0F, 0x06, 0x93, 0xDB, 0x26, 0xF2, 0x73, 0xD0, 0xAB, 0x2C, 0xB0, 0xC1, 0x3B, 0x5E, 0x64, 0x51 }, -+ { 0xEC, 0x56, 0xF5, 0x8B, 0x09, 0x29, 0x9A, 0x30, 0x0B, 0x14, 0x05, 0x65, 0xD7, 0xD3, 0xE6, 0x87, 0x82, 0xB6, 0xE2, 0xFB, 0xEB, 0x4B, 0x7E, 0xA9, 0x7A, 0xC0, 0x57, 0x98, 0x90, 0x61, 0xDD, 0x3F }, -+ { 0x11, 0xA4, 0x37, 0xC1, 0xAB, 0xA3, 0xC1, 0x19, 0xDD, 0xFA, 0xB3, 0x1B, 0x3E, 0x8C, 0x84, 0x1D, 0xEE, 0xEB, 0x91, 0x3E, 0xF5, 0x7F, 0x7E, 0x48, 0xF2, 0xC9, 0xCF, 0x5A, 0x28, 0xFA, 0x42, 0xBC }, -+ { 0x53, 0xC7, 0xE6, 0x11, 0x4B, 0x85, 0x0A, 0x2C, 0xB4, 0x96, 0xC9, 0xB3, 0xC6, 0x9A, 0x62, 0x3E, 0xAE, 0xA2, 0xCB, 0x1D, 0x33, 0xDD, 0x81, 0x7E, 0x47, 0x65, 0xED, 0xAA, 0x68, 0x23, 0xC2, 0x28 }, -+ { 0x15, 0x4C, 0x3E, 0x96, 0xFE, 0xE5, 0xDB, 0x14, 0xF8, 0x77, 0x3E, 0x18, 0xAF, 0x14, 0x85, 0x79, 0x13, 0x50, 0x9D, 0xA9, 0x99, 0xB4, 0x6C, 0xDD, 0x3D, 0x4C, 0x16, 0x97, 0x60, 0xC8, 0x3A, 0xD2 }, -+ { 0x40, 0xB9, 0x91, 0x6F, 0x09, 0x3E, 0x02, 0x7A, 0x87, 0x86, 0x64, 0x18, 0x18, 0x92, 0x06, 0x20, 0x47, 0x2F, 0xBC, 0xF6, 0x8F, 0x70, 0x1D, 0x1B, 0x68, 0x06, 0x32, 0xE6, 0x99, 0x6B, 0xDE, 0xD3 }, -+ { 0x24, 0xC4, 0xCB, 0xBA, 0x07, 0x11, 0x98, 0x31, 0xA7, 0x26, 0xB0, 0x53, 0x05, 0xD9, 0x6D, 0xA0, 0x2F, 0xF8, 0xB1, 0x48, 0xF0, 0xDA, 0x44, 0x0F, 0xE2, 0x33, 0xBC, 0xAA, 0x32, 0xC7, 0x2F, 0x6F }, -+ { 0x5D, 0x20, 0x15, 0x10, 0x25, 0x00, 0x20, 0xB7, 0x83, 0x68, 0x96, 0x88, 0xAB, 0xBF, 0x8E, 0xCF, 0x25, 0x94, 0xA9, 0x6A, 0x08, 0xF2, 0xBF, 0xEC, 0x6C, 0xE0, 0x57, 0x44, 0x65, 0xDD, 0xED, 0x71 }, -+ { 0x04, 0x3B, 0x97, 0xE3, 0x36, 0xEE, 0x6F, 0xDB, 0xBE, 0x2B, 0x50, 0xF2, 0x2A, 0xF8, 0x32, 0x75, 0xA4, 0x08, 0x48, 0x05, 0xD2, 0xD5, 0x64, 0x59, 0x62, 0x45, 0x4B, 0x6C, 0x9B, 0x80, 0x53, 0xA0 }, -+ { 0x56, 0x48, 0x35, 0xCB, 0xAE, 0xA7, 0x74, 0x94, 0x85, 0x68, 0xBE, 0x36, 0xCF, 0x52, 0xFC, 0xDD, 0x83, 0x93, 0x4E, 0xB0, 0xA2, 0x75, 0x12, 0xDB, 0xE3, 0xE2, 0xDB, 0x47, 0xB9, 0xE6, 0x63, 0x5A }, -+ { 0xF2, 0x1C, 0x33, 0xF4, 0x7B, 0xDE, 0x40, 0xA2, 0xA1, 0x01, 0xC9, 0xCD, 0xE8, 0x02, 0x7A, 0xAF, 0x61, 0xA3, 0x13, 0x7D, 0xE2, 0x42, 0x2B, 0x30, 0x03, 0x5A, 0x04, 0xC2, 0x70, 0x89, 0x41, 0x83 }, -+ { 0x9D, 0xB0, 0xEF, 0x74, 0xE6, 0x6C, 0xBB, 0x84, 0x2E, 0xB0, 0xE0, 0x73, 0x43, 0xA0, 0x3C, 0x5C, 0x56, 0x7E, 0x37, 0x2B, 0x3F, 0x23, 0xB9, 0x43, 0xC7, 0x88, 0xA4, 0xF2, 0x50, 0xF6, 0x78, 0x91 }, -+ { 0xAB, 0x8D, 0x08, 0x65, 0x5F, 0xF1, 0xD3, 0xFE, 0x87, 0x58, 0xD5, 0x62, 0x23, 0x5F, 0xD2, 0x3E, 0x7C, 0xF9, 0xDC, 0xAA, 0xD6, 0x58, 0x87, 0x2A, 0x49, 0xE5, 0xD3, 0x18, 0x3B, 0x6C, 0xCE, 0xBD }, -+ { 0x6F, 0x27, 0xF7, 0x7E, 0x7B, 0xCF, 0x46, 0xA1, 0xE9, 0x63, 0xAD, 0xE0, 0x30, 0x97, 0x33, 0x54, 0x30, 0x31, 0xDC, 0xCD, 0xD4, 0x7C, 0xAA, 0xC1, 0x74, 0xD7, 0xD2, 0x7C, 0xE8, 0x07, 0x7E, 0x8B }, -+ { 0xE3, 0xCD, 0x54, 0xDA, 0x7E, 0x44, 0x4C, 0xAA, 0x62, 0x07, 0x56, 0x95, 0x25, 0xA6, 0x70, 0xEB, 0xAE, 0x12, 0x78, 0xDE, 0x4E, 0x3F, 0xE2, 0x68, 0x4B, 0x3E, 0x33, 0xF5, 0xEF, 0x90, 0xCC, 0x1B }, -+ { 0xB2, 0xC3, 0xE3, 0x3A, 0x51, 0xD2, 0x2C, 0x4C, 0x08, 0xFC, 0x09, 0x89, 0xC8, 0x73, 0xC9, 0xCC, 0x41, 0x50, 0x57, 0x9B, 0x1E, 0x61, 0x63, 0xFA, 0x69, 0x4A, 0xD5, 0x1D, 0x53, 0xD7, 0x12, 0xDC }, -+ { 0xBE, 0x7F, 0xDA, 0x98, 0x3E, 0x13, 0x18, 0x9B, 0x4C, 0x77, 0xE0, 0xA8, 0x09, 0x20, 0xB6, 0xE0, 0xE0, 0xEA, 0x80, 0xC3, 0xB8, 0x4D, 0xBE, 0x7E, 0x71, 0x17, 0xD2, 0x53, 0xF4, 0x81, 0x12, 0xF4 }, -+ { 0xB6, 0x00, 0x8C, 0x28, 0xFA, 0xE0, 0x8A, 0xA4, 0x27, 0xE5, 0xBD, 0x3A, 0xAD, 0x36, 0xF1, 0x00, 0x21, 0xF1, 0x6C, 0x77, 0xCF, 0xEA, 0xBE, 0xD0, 0x7F, 0x97, 0xCC, 0x7D, 0xC1, 0xF1, 0x28, 0x4A }, -+ { 0x6E, 0x4E, 0x67, 0x60, 0xC5, 0x38, 0xF2, 0xE9, 0x7B, 0x3A, 0xDB, 0xFB, 0xBC, 0xDE, 0x57, 0xF8, 0x96, 0x6B, 0x7E, 0xA8, 0xFC, 0xB5, 0xBF, 0x7E, 0xFE, 0xC9, 0x13, 0xFD, 0x2A, 0x2B, 0x0C, 0x55 }, -+ { 0x4A, 0xE5, 0x1F, 0xD1, 0x83, 0x4A, 0xA5, 0xBD, 0x9A, 0x6F, 0x7E, 0xC3, 0x9F, 0xC6, 0x63, 0x33, 0x8D, 0xC5, 0xD2, 0xE2, 0x07, 0x61, 0x56, 0x6D, 0x90, 0xCC, 0x68, 0xB1, 0xCB, 0x87, 0x5E, 0xD8 }, -+ { 0xB6, 0x73, 0xAA, 0xD7, 0x5A, 0xB1, 0xFD, 0xB5, 0x40, 0x1A, 0xBF, 0xA1, 0xBF, 0x89, 0xF3, 0xAD, 0xD2, 0xEB, 0xC4, 0x68, 0xDF, 0x36, 0x24, 0xA4, 0x78, 0xF4, 0xFE, 0x85, 0x9D, 0x8D, 0x55, 0xE2 }, -+ { 0x13, 0xC9, 0x47, 0x1A, 0x98, 0x55, 0x91, 0x35, 0x39, 0x83, 0x66, 0x60, 0x39, 0x8D, 0xA0, 0xF3, 0xF9, 0x9A, 0xDA, 0x08, 0x47, 0x9C, 0x69, 0xD1, 0xB7, 0xFC, 0xAA, 0x34, 0x61, 0xDD, 0x7E, 0x59 }, -+ { 0x2C, 0x11, 0xF4, 0xA7, 0xF9, 0x9A, 0x1D, 0x23, 0xA5, 0x8B, 0xB6, 0x36, 0x35, 0x0F, 0xE8, 0x49, 0xF2, 0x9C, 0xBA, 0xC1, 0xB2, 0xA1, 0x11, 0x2D, 0x9F, 0x1E, 0xD5, 0xBC, 0x5B, 0x31, 0x3C, 0xCD }, -+ { 0xC7, 0xD3, 0xC0, 0x70, 0x6B, 0x11, 0xAE, 0x74, 0x1C, 0x05, 0xA1, 0xEF, 0x15, 0x0D, 0xD6, 0x5B, 0x54, 0x94, 0xD6, 0xD5, 0x4C, 0x9A, 0x86, 0xE2, 0x61, 0x78, 0x54, 0xE6, 0xAE, 0xEE, 0xBB, 0xD9 }, -+ { 0x19, 0x4E, 0x10, 0xC9, 0x38, 0x93, 0xAF, 0xA0, 0x64, 0xC3, 0xAC, 0x04, 0xC0, 0xDD, 0x80, 0x8D, 0x79, 0x1C, 0x3D, 0x4B, 0x75, 0x56, 0xE8, 0x9D, 0x8D, 0x9C, 0xB2, 0x25, 0xC4, 0xB3, 0x33, 0x39 }, -+ { 0x6F, 0xC4, 0x98, 0x8B, 0x8F, 0x78, 0x54, 0x6B, 0x16, 0x88, 0x99, 0x18, 0x45, 0x90, 0x8F, 0x13, 0x4B, 0x6A, 0x48, 0x2E, 0x69, 0x94, 0xB3, 0xD4, 0x83, 0x17, 0xBF, 0x08, 0xDB, 0x29, 0x21, 0x85 }, -+ { 0x56, 0x65, 0xBE, 0xB8, 0xB0, 0x95, 0x55, 0x25, 0x81, 0x3B, 0x59, 0x81, 0xCD, 0x14, 0x2E, 0xD4, 0xD0, 0x3F, 0xBA, 0x38, 0xA6, 0xF3, 0xE5, 0xAD, 0x26, 0x8E, 0x0C, 0xC2, 0x70, 0xD1, 0xCD, 0x11 }, -+ { 0xB8, 0x83, 0xD6, 0x8F, 0x5F, 0xE5, 0x19, 0x36, 0x43, 0x1B, 0xA4, 0x25, 0x67, 0x38, 0x05, 0x3B, 0x1D, 0x04, 0x26, 0xD4, 0xCB, 0x64, 0xB1, 0x6E, 0x83, 0xBA, 0xDC, 0x5E, 0x9F, 0xBE, 0x3B, 0x81 }, -+ { 0x53, 0xE7, 0xB2, 0x7E, 0xA5, 0x9C, 0x2F, 0x6D, 0xBB, 0x50, 0x76, 0x9E, 0x43, 0x55, 0x4D, 0xF3, 0x5A, 0xF8, 0x9F, 0x48, 0x22, 0xD0, 0x46, 0x6B, 0x00, 0x7D, 0xD6, 0xF6, 0xDE, 0xAF, 0xFF, 0x02 }, -+ { 0x1F, 0x1A, 0x02, 0x29, 0xD4, 0x64, 0x0F, 0x01, 0x90, 0x15, 0x88, 0xD9, 0xDE, 0xC2, 0x2D, 0x13, 0xFC, 0x3E, 0xB3, 0x4A, 0x61, 0xB3, 0x29, 0x38, 0xEF, 0xBF, 0x53, 0x34, 0xB2, 0x80, 0x0A, 0xFA }, -+ { 0xC2, 0xB4, 0x05, 0xAF, 0xA0, 0xFA, 0x66, 0x68, 0x85, 0x2A, 0xEE, 0x4D, 0x88, 0x04, 0x08, 0x53, 0xFA, 0xB8, 0x00, 0xE7, 0x2B, 0x57, 0x58, 0x14, 0x18, 0xE5, 0x50, 0x6F, 0x21, 0x4C, 0x7D, 0x1F }, -+ { 0xC0, 0x8A, 0xA1, 0xC2, 0x86, 0xD7, 0x09, 0xFD, 0xC7, 0x47, 0x37, 0x44, 0x97, 0x71, 0x88, 0xC8, 0x95, 0xBA, 0x01, 0x10, 0x14, 0x24, 0x7E, 0x4E, 0xFA, 0x8D, 0x07, 0xE7, 0x8F, 0xEC, 0x69, 0x5C }, -+ { 0xF0, 0x3F, 0x57, 0x89, 0xD3, 0x33, 0x6B, 0x80, 0xD0, 0x02, 0xD5, 0x9F, 0xDF, 0x91, 0x8B, 0xDB, 0x77, 0x5B, 0x00, 0x95, 0x6E, 0xD5, 0x52, 0x8E, 0x86, 0xAA, 0x99, 0x4A, 0xCB, 0x38, 0xFE, 0x2D } -+}; -+ -+static const u8 blake2s_keyed_testvecs[][BLAKE2S_OUTBYTES] __initconst = { -+ { 0x48, 0xA8, 0x99, 0x7D, 0xA4, 0x07, 0x87, 0x6B, 0x3D, 0x79, 0xC0, 0xD9, 0x23, 0x25, 0xAD, 0x3B, 0x89, 0xCB, 0xB7, 0x54, 0xD8, 0x6A, 0xB7, 0x1A, 0xEE, 0x04, 0x7A, 0xD3, 0x45, 0xFD, 0x2C, 0x49 }, -+ { 0x40, 0xD1, 0x5F, 0xEE, 0x7C, 0x32, 0x88, 0x30, 0x16, 0x6A, 0xC3, 0xF9, 0x18, 0x65, 0x0F, 0x80, 0x7E, 0x7E, 0x01, 0xE1, 0x77, 0x25, 0x8C, 0xDC, 0x0A, 0x39, 0xB1, 0x1F, 0x59, 0x80, 0x66, 0xF1 }, -+ { 0x6B, 0xB7, 0x13, 0x00, 0x64, 0x4C, 0xD3, 0x99, 0x1B, 0x26, 0xCC, 0xD4, 0xD2, 0x74, 0xAC, 0xD1, 0xAD, 0xEA, 0xB8, 0xB1, 0xD7, 0x91, 0x45, 0x46, 0xC1, 0x19, 0x8B, 0xBE, 0x9F, 0xC9, 0xD8, 0x03 }, -+ { 0x1D, 0x22, 0x0D, 0xBE, 0x2E, 0xE1, 0x34, 0x66, 0x1F, 0xDF, 0x6D, 0x9E, 0x74, 0xB4, 0x17, 0x04, 0x71, 0x05, 0x56, 0xF2, 0xF6, 0xE5, 0xA0, 0x91, 0xB2, 0x27, 0x69, 0x74, 0x45, 0xDB, 0xEA, 0x6B }, -+ { 0xF6, 0xC3, 0xFB, 0xAD, 0xB4, 0xCC, 0x68, 0x7A, 0x00, 0x64, 0xA5, 0xBE, 0x6E, 0x79, 0x1B, 0xEC, 0x63, 0xB8, 0x68, 0xAD, 0x62, 0xFB, 0xA6, 0x1B, 0x37, 0x57, 0xEF, 0x9C, 0xA5, 0x2E, 0x05, 0xB2 }, -+ { 0x49, 0xC1, 0xF2, 0x11, 0x88, 0xDF, 0xD7, 0x69, 0xAE, 0xA0, 0xE9, 0x11, 0xDD, 0x6B, 0x41, 0xF1, 0x4D, 0xAB, 0x10, 0x9D, 0x2B, 0x85, 0x97, 0x7A, 0xA3, 0x08, 0x8B, 0x5C, 0x70, 0x7E, 0x85, 0x98 }, -+ { 0xFD, 0xD8, 0x99, 0x3D, 0xCD, 0x43, 0xF6, 0x96, 0xD4, 0x4F, 0x3C, 0xEA, 0x0F, 0xF3, 0x53, 0x45, 0x23, 0x4E, 0xC8, 0xEE, 0x08, 0x3E, 0xB3, 0xCA, 0xDA, 0x01, 0x7C, 0x7F, 0x78, 0xC1, 0x71, 0x43 }, -+ { 0xE6, 0xC8, 0x12, 0x56, 0x37, 0x43, 0x8D, 0x09, 0x05, 0xB7, 0x49, 0xF4, 0x65, 0x60, 0xAC, 0x89, 0xFD, 0x47, 0x1C, 0xF8, 0x69, 0x2E, 0x28, 0xFA, 0xB9, 0x82, 0xF7, 0x3F, 0x01, 0x9B, 0x83, 0xA9 }, -+ { 0x19, 0xFC, 0x8C, 0xA6, 0x97, 0x9D, 0x60, 0xE6, 0xED, 0xD3, 0xB4, 0x54, 0x1E, 0x2F, 0x96, 0x7C, 0xED, 0x74, 0x0D, 0xF6, 0xEC, 0x1E, 0xAE, 0xBB, 0xFE, 0x81, 0x38, 0x32, 0xE9, 0x6B, 0x29, 0x74 }, -+ { 0xA6, 0xAD, 0x77, 0x7C, 0xE8, 0x81, 0xB5, 0x2B, 0xB5, 0xA4, 0x42, 0x1A, 0xB6, 0xCD, 0xD2, 0xDF, 0xBA, 0x13, 0xE9, 0x63, 0x65, 0x2D, 0x4D, 0x6D, 0x12, 0x2A, 0xEE, 0x46, 0x54, 0x8C, 0x14, 0xA7 }, -+ { 0xF5, 0xC4, 0xB2, 0xBA, 0x1A, 0x00, 0x78, 0x1B, 0x13, 0xAB, 0xA0, 0x42, 0x52, 0x42, 0xC6, 0x9C, 0xB1, 0x55, 0x2F, 0x3F, 0x71, 0xA9, 0xA3, 0xBB, 0x22, 0xB4, 0xA6, 0xB4, 0x27, 0x7B, 0x46, 0xDD }, -+ { 0xE3, 0x3C, 0x4C, 0x9B, 0xD0, 0xCC, 0x7E, 0x45, 0xC8, 0x0E, 0x65, 0xC7, 0x7F, 0xA5, 0x99, 0x7F, 0xEC, 0x70, 0x02, 0x73, 0x85, 0x41, 0x50, 0x9E, 0x68, 0xA9, 0x42, 0x38, 0x91, 0xE8, 0x22, 0xA3 }, -+ { 0xFB, 0xA1, 0x61, 0x69, 0xB2, 0xC3, 0xEE, 0x10, 0x5B, 0xE6, 0xE1, 0xE6, 0x50, 0xE5, 0xCB, 0xF4, 0x07, 0x46, 0xB6, 0x75, 0x3D, 0x03, 0x6A, 0xB5, 0x51, 0x79, 0x01, 0x4A, 0xD7, 0xEF, 0x66, 0x51 }, -+ { 0xF5, 0xC4, 0xBE, 0xC6, 0xD6, 0x2F, 0xC6, 0x08, 0xBF, 0x41, 0xCC, 0x11, 0x5F, 0x16, 0xD6, 0x1C, 0x7E, 0xFD, 0x3F, 0xF6, 0xC6, 0x56, 0x92, 0xBB, 0xE0, 0xAF, 0xFF, 0xB1, 0xFE, 0xDE, 0x74, 0x75 }, -+ { 0xA4, 0x86, 0x2E, 0x76, 0xDB, 0x84, 0x7F, 0x05, 0xBA, 0x17, 0xED, 0xE5, 0xDA, 0x4E, 0x7F, 0x91, 0xB5, 0x92, 0x5C, 0xF1, 0xAD, 0x4B, 0xA1, 0x27, 0x32, 0xC3, 0x99, 0x57, 0x42, 0xA5, 0xCD, 0x6E }, -+ { 0x65, 0xF4, 0xB8, 0x60, 0xCD, 0x15, 0xB3, 0x8E, 0xF8, 0x14, 0xA1, 0xA8, 0x04, 0x31, 0x4A, 0x55, 0xBE, 0x95, 0x3C, 0xAA, 0x65, 0xFD, 0x75, 0x8A, 0xD9, 0x89, 0xFF, 0x34, 0xA4, 0x1C, 0x1E, 0xEA }, -+ { 0x19, 0xBA, 0x23, 0x4F, 0x0A, 0x4F, 0x38, 0x63, 0x7D, 0x18, 0x39, 0xF9, 0xD9, 0xF7, 0x6A, 0xD9, 0x1C, 0x85, 0x22, 0x30, 0x71, 0x43, 0xC9, 0x7D, 0x5F, 0x93, 0xF6, 0x92, 0x74, 0xCE, 0xC9, 0xA7 }, -+ { 0x1A, 0x67, 0x18, 0x6C, 0xA4, 0xA5, 0xCB, 0x8E, 0x65, 0xFC, 0xA0, 0xE2, 0xEC, 0xBC, 0x5D, 0xDC, 0x14, 0xAE, 0x38, 0x1B, 0xB8, 0xBF, 0xFE, 0xB9, 0xE0, 0xA1, 0x03, 0x44, 0x9E, 0x3E, 0xF0, 0x3C }, -+ { 0xAF, 0xBE, 0xA3, 0x17, 0xB5, 0xA2, 0xE8, 0x9C, 0x0B, 0xD9, 0x0C, 0xCF, 0x5D, 0x7F, 0xD0, 0xED, 0x57, 0xFE, 0x58, 0x5E, 0x4B, 0xE3, 0x27, 0x1B, 0x0A, 0x6B, 0xF0, 0xF5, 0x78, 0x6B, 0x0F, 0x26 }, -+ { 0xF1, 0xB0, 0x15, 0x58, 0xCE, 0x54, 0x12, 0x62, 0xF5, 0xEC, 0x34, 0x29, 0x9D, 0x6F, 0xB4, 0x09, 0x00, 0x09, 0xE3, 0x43, 0x4B, 0xE2, 0xF4, 0x91, 0x05, 0xCF, 0x46, 0xAF, 0x4D, 0x2D, 0x41, 0x24 }, -+ { 0x13, 0xA0, 0xA0, 0xC8, 0x63, 0x35, 0x63, 0x5E, 0xAA, 0x74, 0xCA, 0x2D, 0x5D, 0x48, 0x8C, 0x79, 0x7B, 0xBB, 0x4F, 0x47, 0xDC, 0x07, 0x10, 0x50, 0x15, 0xED, 0x6A, 0x1F, 0x33, 0x09, 0xEF, 0xCE }, -+ { 0x15, 0x80, 0xAF, 0xEE, 0xBE, 0xBB, 0x34, 0x6F, 0x94, 0xD5, 0x9F, 0xE6, 0x2D, 0xA0, 0xB7, 0x92, 0x37, 0xEA, 0xD7, 0xB1, 0x49, 0x1F, 0x56, 0x67, 0xA9, 0x0E, 0x45, 0xED, 0xF6, 0xCA, 0x8B, 0x03 }, -+ { 0x20, 0xBE, 0x1A, 0x87, 0x5B, 0x38, 0xC5, 0x73, 0xDD, 0x7F, 0xAA, 0xA0, 0xDE, 0x48, 0x9D, 0x65, 0x5C, 0x11, 0xEF, 0xB6, 0xA5, 0x52, 0x69, 0x8E, 0x07, 0xA2, 0xD3, 0x31, 0xB5, 0xF6, 0x55, 0xC3 }, -+ { 0xBE, 0x1F, 0xE3, 0xC4, 0xC0, 0x40, 0x18, 0xC5, 0x4C, 0x4A, 0x0F, 0x6B, 0x9A, 0x2E, 0xD3, 0xC5, 0x3A, 0xBE, 0x3A, 0x9F, 0x76, 0xB4, 0xD2, 0x6D, 0xE5, 0x6F, 0xC9, 0xAE, 0x95, 0x05, 0x9A, 0x99 }, -+ { 0xE3, 0xE3, 0xAC, 0xE5, 0x37, 0xEB, 0x3E, 0xDD, 0x84, 0x63, 0xD9, 0xAD, 0x35, 0x82, 0xE1, 0x3C, 0xF8, 0x65, 0x33, 0xFF, 0xDE, 0x43, 0xD6, 0x68, 0xDD, 0x2E, 0x93, 0xBB, 0xDB, 0xD7, 0x19, 0x5A }, -+ { 0x11, 0x0C, 0x50, 0xC0, 0xBF, 0x2C, 0x6E, 0x7A, 0xEB, 0x7E, 0x43, 0x5D, 0x92, 0xD1, 0x32, 0xAB, 0x66, 0x55, 0x16, 0x8E, 0x78, 0xA2, 0xDE, 0xCD, 0xEC, 0x33, 0x30, 0x77, 0x76, 0x84, 0xD9, 0xC1 }, -+ { 0xE9, 0xBA, 0x8F, 0x50, 0x5C, 0x9C, 0x80, 0xC0, 0x86, 0x66, 0xA7, 0x01, 0xF3, 0x36, 0x7E, 0x6C, 0xC6, 0x65, 0xF3, 0x4B, 0x22, 0xE7, 0x3C, 0x3C, 0x04, 0x17, 0xEB, 0x1C, 0x22, 0x06, 0x08, 0x2F }, -+ { 0x26, 0xCD, 0x66, 0xFC, 0xA0, 0x23, 0x79, 0xC7, 0x6D, 0xF1, 0x23, 0x17, 0x05, 0x2B, 0xCA, 0xFD, 0x6C, 0xD8, 0xC3, 0xA7, 0xB8, 0x90, 0xD8, 0x05, 0xF3, 0x6C, 0x49, 0x98, 0x97, 0x82, 0x43, 0x3A }, -+ { 0x21, 0x3F, 0x35, 0x96, 0xD6, 0xE3, 0xA5, 0xD0, 0xE9, 0x93, 0x2C, 0xD2, 0x15, 0x91, 0x46, 0x01, 0x5E, 0x2A, 0xBC, 0x94, 0x9F, 0x47, 0x29, 0xEE, 0x26, 0x32, 0xFE, 0x1E, 0xDB, 0x78, 0xD3, 0x37 }, -+ { 0x10, 0x15, 0xD7, 0x01, 0x08, 0xE0, 0x3B, 0xE1, 0xC7, 0x02, 0xFE, 0x97, 0x25, 0x36, 0x07, 0xD1, 0x4A, 0xEE, 0x59, 0x1F, 0x24, 0x13, 0xEA, 0x67, 0x87, 0x42, 0x7B, 0x64, 0x59, 0xFF, 0x21, 0x9A }, -+ { 0x3C, 0xA9, 0x89, 0xDE, 0x10, 0xCF, 0xE6, 0x09, 0x90, 0x94, 0x72, 0xC8, 0xD3, 0x56, 0x10, 0x80, 0x5B, 0x2F, 0x97, 0x77, 0x34, 0xCF, 0x65, 0x2C, 0xC6, 0x4B, 0x3B, 0xFC, 0x88, 0x2D, 0x5D, 0x89 }, -+ { 0xB6, 0x15, 0x6F, 0x72, 0xD3, 0x80, 0xEE, 0x9E, 0xA6, 0xAC, 0xD1, 0x90, 0x46, 0x4F, 0x23, 0x07, 0xA5, 0xC1, 0x79, 0xEF, 0x01, 0xFD, 0x71, 0xF9, 0x9F, 0x2D, 0x0F, 0x7A, 0x57, 0x36, 0x0A, 0xEA }, -+ { 0xC0, 0x3B, 0xC6, 0x42, 0xB2, 0x09, 0x59, 0xCB, 0xE1, 0x33, 0xA0, 0x30, 0x3E, 0x0C, 0x1A, 0xBF, 0xF3, 0xE3, 0x1E, 0xC8, 0xE1, 0xA3, 0x28, 0xEC, 0x85, 0x65, 0xC3, 0x6D, 0xEC, 0xFF, 0x52, 0x65 }, -+ { 0x2C, 0x3E, 0x08, 0x17, 0x6F, 0x76, 0x0C, 0x62, 0x64, 0xC3, 0xA2, 0xCD, 0x66, 0xFE, 0xC6, 0xC3, 0xD7, 0x8D, 0xE4, 0x3F, 0xC1, 0x92, 0x45, 0x7B, 0x2A, 0x4A, 0x66, 0x0A, 0x1E, 0x0E, 0xB2, 0x2B }, -+ { 0xF7, 0x38, 0xC0, 0x2F, 0x3C, 0x1B, 0x19, 0x0C, 0x51, 0x2B, 0x1A, 0x32, 0xDE, 0xAB, 0xF3, 0x53, 0x72, 0x8E, 0x0E, 0x9A, 0xB0, 0x34, 0x49, 0x0E, 0x3C, 0x34, 0x09, 0x94, 0x6A, 0x97, 0xAE, 0xEC }, -+ { 0x8B, 0x18, 0x80, 0xDF, 0x30, 0x1C, 0xC9, 0x63, 0x41, 0x88, 0x11, 0x08, 0x89, 0x64, 0x83, 0x92, 0x87, 0xFF, 0x7F, 0xE3, 0x1C, 0x49, 0xEA, 0x6E, 0xBD, 0x9E, 0x48, 0xBD, 0xEE, 0xE4, 0x97, 0xC5 }, -+ { 0x1E, 0x75, 0xCB, 0x21, 0xC6, 0x09, 0x89, 0x02, 0x03, 0x75, 0xF1, 0xA7, 0xA2, 0x42, 0x83, 0x9F, 0x0B, 0x0B, 0x68, 0x97, 0x3A, 0x4C, 0x2A, 0x05, 0xCF, 0x75, 0x55, 0xED, 0x5A, 0xAE, 0xC4, 0xC1 }, -+ { 0x62, 0xBF, 0x8A, 0x9C, 0x32, 0xA5, 0xBC, 0xCF, 0x29, 0x0B, 0x6C, 0x47, 0x4D, 0x75, 0xB2, 0xA2, 0xA4, 0x09, 0x3F, 0x1A, 0x9E, 0x27, 0x13, 0x94, 0x33, 0xA8, 0xF2, 0xB3, 0xBC, 0xE7, 0xB8, 0xD7 }, -+ { 0x16, 0x6C, 0x83, 0x50, 0xD3, 0x17, 0x3B, 0x5E, 0x70, 0x2B, 0x78, 0x3D, 0xFD, 0x33, 0xC6, 0x6E, 0xE0, 0x43, 0x27, 0x42, 0xE9, 0xB9, 0x2B, 0x99, 0x7F, 0xD2, 0x3C, 0x60, 0xDC, 0x67, 0x56, 0xCA }, -+ { 0x04, 0x4A, 0x14, 0xD8, 0x22, 0xA9, 0x0C, 0xAC, 0xF2, 0xF5, 0xA1, 0x01, 0x42, 0x8A, 0xDC, 0x8F, 0x41, 0x09, 0x38, 0x6C, 0xCB, 0x15, 0x8B, 0xF9, 0x05, 0xC8, 0x61, 0x8B, 0x8E, 0xE2, 0x4E, 0xC3 }, -+ { 0x38, 0x7D, 0x39, 0x7E, 0xA4, 0x3A, 0x99, 0x4B, 0xE8, 0x4D, 0x2D, 0x54, 0x4A, 0xFB, 0xE4, 0x81, 0xA2, 0x00, 0x0F, 0x55, 0x25, 0x26, 0x96, 0xBB, 0xA2, 0xC5, 0x0C, 0x8E, 0xBD, 0x10, 0x13, 0x47 }, -+ { 0x56, 0xF8, 0xCC, 0xF1, 0xF8, 0x64, 0x09, 0xB4, 0x6C, 0xE3, 0x61, 0x66, 0xAE, 0x91, 0x65, 0x13, 0x84, 0x41, 0x57, 0x75, 0x89, 0xDB, 0x08, 0xCB, 0xC5, 0xF6, 0x6C, 0xA2, 0x97, 0x43, 0xB9, 0xFD }, -+ { 0x97, 0x06, 0xC0, 0x92, 0xB0, 0x4D, 0x91, 0xF5, 0x3D, 0xFF, 0x91, 0xFA, 0x37, 0xB7, 0x49, 0x3D, 0x28, 0xB5, 0x76, 0xB5, 0xD7, 0x10, 0x46, 0x9D, 0xF7, 0x94, 0x01, 0x66, 0x22, 0x36, 0xFC, 0x03 }, -+ { 0x87, 0x79, 0x68, 0x68, 0x6C, 0x06, 0x8C, 0xE2, 0xF7, 0xE2, 0xAD, 0xCF, 0xF6, 0x8B, 0xF8, 0x74, 0x8E, 0xDF, 0x3C, 0xF8, 0x62, 0xCF, 0xB4, 0xD3, 0x94, 0x7A, 0x31, 0x06, 0x95, 0x80, 0x54, 0xE3 }, -+ { 0x88, 0x17, 0xE5, 0x71, 0x98, 0x79, 0xAC, 0xF7, 0x02, 0x47, 0x87, 0xEC, 0xCD, 0xB2, 0x71, 0x03, 0x55, 0x66, 0xCF, 0xA3, 0x33, 0xE0, 0x49, 0x40, 0x7C, 0x01, 0x78, 0xCC, 0xC5, 0x7A, 0x5B, 0x9F }, -+ { 0x89, 0x38, 0x24, 0x9E, 0x4B, 0x50, 0xCA, 0xDA, 0xCC, 0xDF, 0x5B, 0x18, 0x62, 0x13, 0x26, 0xCB, 0xB1, 0x52, 0x53, 0xE3, 0x3A, 0x20, 0xF5, 0x63, 0x6E, 0x99, 0x5D, 0x72, 0x47, 0x8D, 0xE4, 0x72 }, -+ { 0xF1, 0x64, 0xAB, 0xBA, 0x49, 0x63, 0xA4, 0x4D, 0x10, 0x72, 0x57, 0xE3, 0x23, 0x2D, 0x90, 0xAC, 0xA5, 0xE6, 0x6A, 0x14, 0x08, 0x24, 0x8C, 0x51, 0x74, 0x1E, 0x99, 0x1D, 0xB5, 0x22, 0x77, 0x56 }, -+ { 0xD0, 0x55, 0x63, 0xE2, 0xB1, 0xCB, 0xA0, 0xC4, 0xA2, 0xA1, 0xE8, 0xBD, 0xE3, 0xA1, 0xA0, 0xD9, 0xF5, 0xB4, 0x0C, 0x85, 0xA0, 0x70, 0xD6, 0xF5, 0xFB, 0x21, 0x06, 0x6E, 0xAD, 0x5D, 0x06, 0x01 }, -+ { 0x03, 0xFB, 0xB1, 0x63, 0x84, 0xF0, 0xA3, 0x86, 0x6F, 0x4C, 0x31, 0x17, 0x87, 0x76, 0x66, 0xEF, 0xBF, 0x12, 0x45, 0x97, 0x56, 0x4B, 0x29, 0x3D, 0x4A, 0xAB, 0x0D, 0x26, 0x9F, 0xAB, 0xDD, 0xFA }, -+ { 0x5F, 0xA8, 0x48, 0x6A, 0xC0, 0xE5, 0x29, 0x64, 0xD1, 0x88, 0x1B, 0xBE, 0x33, 0x8E, 0xB5, 0x4B, 0xE2, 0xF7, 0x19, 0x54, 0x92, 0x24, 0x89, 0x20, 0x57, 0xB4, 0xDA, 0x04, 0xBA, 0x8B, 0x34, 0x75 }, -+ { 0xCD, 0xFA, 0xBC, 0xEE, 0x46, 0x91, 0x11, 0x11, 0x23, 0x6A, 0x31, 0x70, 0x8B, 0x25, 0x39, 0xD7, 0x1F, 0xC2, 0x11, 0xD9, 0xB0, 0x9C, 0x0D, 0x85, 0x30, 0xA1, 0x1E, 0x1D, 0xBF, 0x6E, 0xED, 0x01 }, -+ { 0x4F, 0x82, 0xDE, 0x03, 0xB9, 0x50, 0x47, 0x93, 0xB8, 0x2A, 0x07, 0xA0, 0xBD, 0xCD, 0xFF, 0x31, 0x4D, 0x75, 0x9E, 0x7B, 0x62, 0xD2, 0x6B, 0x78, 0x49, 0x46, 0xB0, 0xD3, 0x6F, 0x91, 0x6F, 0x52 }, -+ { 0x25, 0x9E, 0xC7, 0xF1, 0x73, 0xBC, 0xC7, 0x6A, 0x09, 0x94, 0xC9, 0x67, 0xB4, 0xF5, 0xF0, 0x24, 0xC5, 0x60, 0x57, 0xFB, 0x79, 0xC9, 0x65, 0xC4, 0xFA, 0xE4, 0x18, 0x75, 0xF0, 0x6A, 0x0E, 0x4C }, -+ { 0x19, 0x3C, 0xC8, 0xE7, 0xC3, 0xE0, 0x8B, 0xB3, 0x0F, 0x54, 0x37, 0xAA, 0x27, 0xAD, 0xE1, 0xF1, 0x42, 0x36, 0x9B, 0x24, 0x6A, 0x67, 0x5B, 0x23, 0x83, 0xE6, 0xDA, 0x9B, 0x49, 0xA9, 0x80, 0x9E }, -+ { 0x5C, 0x10, 0x89, 0x6F, 0x0E, 0x28, 0x56, 0xB2, 0xA2, 0xEE, 0xE0, 0xFE, 0x4A, 0x2C, 0x16, 0x33, 0x56, 0x5D, 0x18, 0xF0, 0xE9, 0x3E, 0x1F, 0xAB, 0x26, 0xC3, 0x73, 0xE8, 0xF8, 0x29, 0x65, 0x4D }, -+ { 0xF1, 0x60, 0x12, 0xD9, 0x3F, 0x28, 0x85, 0x1A, 0x1E, 0xB9, 0x89, 0xF5, 0xD0, 0xB4, 0x3F, 0x3F, 0x39, 0xCA, 0x73, 0xC9, 0xA6, 0x2D, 0x51, 0x81, 0xBF, 0xF2, 0x37, 0x53, 0x6B, 0xD3, 0x48, 0xC3 }, -+ { 0x29, 0x66, 0xB3, 0xCF, 0xAE, 0x1E, 0x44, 0xEA, 0x99, 0x6D, 0xC5, 0xD6, 0x86, 0xCF, 0x25, 0xFA, 0x05, 0x3F, 0xB6, 0xF6, 0x72, 0x01, 0xB9, 0xE4, 0x6E, 0xAD, 0xE8, 0x5D, 0x0A, 0xD6, 0xB8, 0x06 }, -+ { 0xDD, 0xB8, 0x78, 0x24, 0x85, 0xE9, 0x00, 0xBC, 0x60, 0xBC, 0xF4, 0xC3, 0x3A, 0x6F, 0xD5, 0x85, 0x68, 0x0C, 0xC6, 0x83, 0xD5, 0x16, 0xEF, 0xA0, 0x3E, 0xB9, 0x98, 0x5F, 0xAD, 0x87, 0x15, 0xFB }, -+ { 0x4C, 0x4D, 0x6E, 0x71, 0xAE, 0xA0, 0x57, 0x86, 0x41, 0x31, 0x48, 0xFC, 0x7A, 0x78, 0x6B, 0x0E, 0xCA, 0xF5, 0x82, 0xCF, 0xF1, 0x20, 0x9F, 0x5A, 0x80, 0x9F, 0xBA, 0x85, 0x04, 0xCE, 0x66, 0x2C }, -+ { 0xFB, 0x4C, 0x5E, 0x86, 0xD7, 0xB2, 0x22, 0x9B, 0x99, 0xB8, 0xBA, 0x6D, 0x94, 0xC2, 0x47, 0xEF, 0x96, 0x4A, 0xA3, 0xA2, 0xBA, 0xE8, 0xED, 0xC7, 0x75, 0x69, 0xF2, 0x8D, 0xBB, 0xFF, 0x2D, 0x4E }, -+ { 0xE9, 0x4F, 0x52, 0x6D, 0xE9, 0x01, 0x96, 0x33, 0xEC, 0xD5, 0x4A, 0xC6, 0x12, 0x0F, 0x23, 0x95, 0x8D, 0x77, 0x18, 0xF1, 0xE7, 0x71, 0x7B, 0xF3, 0x29, 0x21, 0x1A, 0x4F, 0xAE, 0xED, 0x4E, 0x6D }, -+ { 0xCB, 0xD6, 0x66, 0x0A, 0x10, 0xDB, 0x3F, 0x23, 0xF7, 0xA0, 0x3D, 0x4B, 0x9D, 0x40, 0x44, 0xC7, 0x93, 0x2B, 0x28, 0x01, 0xAC, 0x89, 0xD6, 0x0B, 0xC9, 0xEB, 0x92, 0xD6, 0x5A, 0x46, 0xC2, 0xA0 }, -+ { 0x88, 0x18, 0xBB, 0xD3, 0xDB, 0x4D, 0xC1, 0x23, 0xB2, 0x5C, 0xBB, 0xA5, 0xF5, 0x4C, 0x2B, 0xC4, 0xB3, 0xFC, 0xF9, 0xBF, 0x7D, 0x7A, 0x77, 0x09, 0xF4, 0xAE, 0x58, 0x8B, 0x26, 0x7C, 0x4E, 0xCE }, -+ { 0xC6, 0x53, 0x82, 0x51, 0x3F, 0x07, 0x46, 0x0D, 0xA3, 0x98, 0x33, 0xCB, 0x66, 0x6C, 0x5E, 0xD8, 0x2E, 0x61, 0xB9, 0xE9, 0x98, 0xF4, 0xB0, 0xC4, 0x28, 0x7C, 0xEE, 0x56, 0xC3, 0xCC, 0x9B, 0xCD }, -+ { 0x89, 0x75, 0xB0, 0x57, 0x7F, 0xD3, 0x55, 0x66, 0xD7, 0x50, 0xB3, 0x62, 0xB0, 0x89, 0x7A, 0x26, 0xC3, 0x99, 0x13, 0x6D, 0xF0, 0x7B, 0xAB, 0xAB, 0xBD, 0xE6, 0x20, 0x3F, 0xF2, 0x95, 0x4E, 0xD4 }, -+ { 0x21, 0xFE, 0x0C, 0xEB, 0x00, 0x52, 0xBE, 0x7F, 0xB0, 0xF0, 0x04, 0x18, 0x7C, 0xAC, 0xD7, 0xDE, 0x67, 0xFA, 0x6E, 0xB0, 0x93, 0x8D, 0x92, 0x76, 0x77, 0xF2, 0x39, 0x8C, 0x13, 0x23, 0x17, 0xA8 }, -+ { 0x2E, 0xF7, 0x3F, 0x3C, 0x26, 0xF1, 0x2D, 0x93, 0x88, 0x9F, 0x3C, 0x78, 0xB6, 0xA6, 0x6C, 0x1D, 0x52, 0xB6, 0x49, 0xDC, 0x9E, 0x85, 0x6E, 0x2C, 0x17, 0x2E, 0xA7, 0xC5, 0x8A, 0xC2, 0xB5, 0xE3 }, -+ { 0x38, 0x8A, 0x3C, 0xD5, 0x6D, 0x73, 0x86, 0x7A, 0xBB, 0x5F, 0x84, 0x01, 0x49, 0x2B, 0x6E, 0x26, 0x81, 0xEB, 0x69, 0x85, 0x1E, 0x76, 0x7F, 0xD8, 0x42, 0x10, 0xA5, 0x60, 0x76, 0xFB, 0x3D, 0xD3 }, -+ { 0xAF, 0x53, 0x3E, 0x02, 0x2F, 0xC9, 0x43, 0x9E, 0x4E, 0x3C, 0xB8, 0x38, 0xEC, 0xD1, 0x86, 0x92, 0x23, 0x2A, 0xDF, 0x6F, 0xE9, 0x83, 0x95, 0x26, 0xD3, 0xC3, 0xDD, 0x1B, 0x71, 0x91, 0x0B, 0x1A }, -+ { 0x75, 0x1C, 0x09, 0xD4, 0x1A, 0x93, 0x43, 0x88, 0x2A, 0x81, 0xCD, 0x13, 0xEE, 0x40, 0x81, 0x8D, 0x12, 0xEB, 0x44, 0xC6, 0xC7, 0xF4, 0x0D, 0xF1, 0x6E, 0x4A, 0xEA, 0x8F, 0xAB, 0x91, 0x97, 0x2A }, -+ { 0x5B, 0x73, 0xDD, 0xB6, 0x8D, 0x9D, 0x2B, 0x0A, 0xA2, 0x65, 0xA0, 0x79, 0x88, 0xD6, 0xB8, 0x8A, 0xE9, 0xAA, 0xC5, 0x82, 0xAF, 0x83, 0x03, 0x2F, 0x8A, 0x9B, 0x21, 0xA2, 0xE1, 0xB7, 0xBF, 0x18 }, -+ { 0x3D, 0xA2, 0x91, 0x26, 0xC7, 0xC5, 0xD7, 0xF4, 0x3E, 0x64, 0x24, 0x2A, 0x79, 0xFE, 0xAA, 0x4E, 0xF3, 0x45, 0x9C, 0xDE, 0xCC, 0xC8, 0x98, 0xED, 0x59, 0xA9, 0x7F, 0x6E, 0xC9, 0x3B, 0x9D, 0xAB }, -+ { 0x56, 0x6D, 0xC9, 0x20, 0x29, 0x3D, 0xA5, 0xCB, 0x4F, 0xE0, 0xAA, 0x8A, 0xBD, 0xA8, 0xBB, 0xF5, 0x6F, 0x55, 0x23, 0x13, 0xBF, 0xF1, 0x90, 0x46, 0x64, 0x1E, 0x36, 0x15, 0xC1, 0xE3, 0xED, 0x3F }, -+ { 0x41, 0x15, 0xBE, 0xA0, 0x2F, 0x73, 0xF9, 0x7F, 0x62, 0x9E, 0x5C, 0x55, 0x90, 0x72, 0x0C, 0x01, 0xE7, 0xE4, 0x49, 0xAE, 0x2A, 0x66, 0x97, 0xD4, 0xD2, 0x78, 0x33, 0x21, 0x30, 0x36, 0x92, 0xF9 }, -+ { 0x4C, 0xE0, 0x8F, 0x47, 0x62, 0x46, 0x8A, 0x76, 0x70, 0x01, 0x21, 0x64, 0x87, 0x8D, 0x68, 0x34, 0x0C, 0x52, 0xA3, 0x5E, 0x66, 0xC1, 0x88, 0x4D, 0x5C, 0x86, 0x48, 0x89, 0xAB, 0xC9, 0x66, 0x77 }, -+ { 0x81, 0xEA, 0x0B, 0x78, 0x04, 0x12, 0x4E, 0x0C, 0x22, 0xEA, 0x5F, 0xC7, 0x11, 0x04, 0xA2, 0xAF, 0xCB, 0x52, 0xA1, 0xFA, 0x81, 0x6F, 0x3E, 0xCB, 0x7D, 0xCB, 0x5D, 0x9D, 0xEA, 0x17, 0x86, 0xD0 }, -+ { 0xFE, 0x36, 0x27, 0x33, 0xB0, 0x5F, 0x6B, 0xED, 0xAF, 0x93, 0x79, 0xD7, 0xF7, 0x93, 0x6E, 0xDE, 0x20, 0x9B, 0x1F, 0x83, 0x23, 0xC3, 0x92, 0x25, 0x49, 0xD9, 0xE7, 0x36, 0x81, 0xB5, 0xDB, 0x7B }, -+ { 0xEF, 0xF3, 0x7D, 0x30, 0xDF, 0xD2, 0x03, 0x59, 0xBE, 0x4E, 0x73, 0xFD, 0xF4, 0x0D, 0x27, 0x73, 0x4B, 0x3D, 0xF9, 0x0A, 0x97, 0xA5, 0x5E, 0xD7, 0x45, 0x29, 0x72, 0x94, 0xCA, 0x85, 0xD0, 0x9F }, -+ { 0x17, 0x2F, 0xFC, 0x67, 0x15, 0x3D, 0x12, 0xE0, 0xCA, 0x76, 0xA8, 0xB6, 0xCD, 0x5D, 0x47, 0x31, 0x88, 0x5B, 0x39, 0xCE, 0x0C, 0xAC, 0x93, 0xA8, 0x97, 0x2A, 0x18, 0x00, 0x6C, 0x8B, 0x8B, 0xAF }, -+ { 0xC4, 0x79, 0x57, 0xF1, 0xCC, 0x88, 0xE8, 0x3E, 0xF9, 0x44, 0x58, 0x39, 0x70, 0x9A, 0x48, 0x0A, 0x03, 0x6B, 0xED, 0x5F, 0x88, 0xAC, 0x0F, 0xCC, 0x8E, 0x1E, 0x70, 0x3F, 0xFA, 0xAC, 0x13, 0x2C }, -+ { 0x30, 0xF3, 0x54, 0x83, 0x70, 0xCF, 0xDC, 0xED, 0xA5, 0xC3, 0x7B, 0x56, 0x9B, 0x61, 0x75, 0xE7, 0x99, 0xEE, 0xF1, 0xA6, 0x2A, 0xAA, 0x94, 0x32, 0x45, 0xAE, 0x76, 0x69, 0xC2, 0x27, 0xA7, 0xB5 }, -+ { 0xC9, 0x5D, 0xCB, 0x3C, 0xF1, 0xF2, 0x7D, 0x0E, 0xEF, 0x2F, 0x25, 0xD2, 0x41, 0x38, 0x70, 0x90, 0x4A, 0x87, 0x7C, 0x4A, 0x56, 0xC2, 0xDE, 0x1E, 0x83, 0xE2, 0xBC, 0x2A, 0xE2, 0xE4, 0x68, 0x21 }, -+ { 0xD5, 0xD0, 0xB5, 0xD7, 0x05, 0x43, 0x4C, 0xD4, 0x6B, 0x18, 0x57, 0x49, 0xF6, 0x6B, 0xFB, 0x58, 0x36, 0xDC, 0xDF, 0x6E, 0xE5, 0x49, 0xA2, 0xB7, 0xA4, 0xAE, 0xE7, 0xF5, 0x80, 0x07, 0xCA, 0xAF }, -+ { 0xBB, 0xC1, 0x24, 0xA7, 0x12, 0xF1, 0x5D, 0x07, 0xC3, 0x00, 0xE0, 0x5B, 0x66, 0x83, 0x89, 0xA4, 0x39, 0xC9, 0x17, 0x77, 0xF7, 0x21, 0xF8, 0x32, 0x0C, 0x1C, 0x90, 0x78, 0x06, 0x6D, 0x2C, 0x7E }, -+ { 0xA4, 0x51, 0xB4, 0x8C, 0x35, 0xA6, 0xC7, 0x85, 0x4C, 0xFA, 0xAE, 0x60, 0x26, 0x2E, 0x76, 0x99, 0x08, 0x16, 0x38, 0x2A, 0xC0, 0x66, 0x7E, 0x5A, 0x5C, 0x9E, 0x1B, 0x46, 0xC4, 0x34, 0x2D, 0xDF }, -+ { 0xB0, 0xD1, 0x50, 0xFB, 0x55, 0xE7, 0x78, 0xD0, 0x11, 0x47, 0xF0, 0xB5, 0xD8, 0x9D, 0x99, 0xEC, 0xB2, 0x0F, 0xF0, 0x7E, 0x5E, 0x67, 0x60, 0xD6, 0xB6, 0x45, 0xEB, 0x5B, 0x65, 0x4C, 0x62, 0x2B }, -+ { 0x34, 0xF7, 0x37, 0xC0, 0xAB, 0x21, 0x99, 0x51, 0xEE, 0xE8, 0x9A, 0x9F, 0x8D, 0xAC, 0x29, 0x9C, 0x9D, 0x4C, 0x38, 0xF3, 0x3F, 0xA4, 0x94, 0xC5, 0xC6, 0xEE, 0xFC, 0x92, 0xB6, 0xDB, 0x08, 0xBC }, -+ { 0x1A, 0x62, 0xCC, 0x3A, 0x00, 0x80, 0x0D, 0xCB, 0xD9, 0x98, 0x91, 0x08, 0x0C, 0x1E, 0x09, 0x84, 0x58, 0x19, 0x3A, 0x8C, 0xC9, 0xF9, 0x70, 0xEA, 0x99, 0xFB, 0xEF, 0xF0, 0x03, 0x18, 0xC2, 0x89 }, -+ { 0xCF, 0xCE, 0x55, 0xEB, 0xAF, 0xC8, 0x40, 0xD7, 0xAE, 0x48, 0x28, 0x1C, 0x7F, 0xD5, 0x7E, 0xC8, 0xB4, 0x82, 0xD4, 0xB7, 0x04, 0x43, 0x74, 0x95, 0x49, 0x5A, 0xC4, 0x14, 0xCF, 0x4A, 0x37, 0x4B }, -+ { 0x67, 0x46, 0xFA, 0xCF, 0x71, 0x14, 0x6D, 0x99, 0x9D, 0xAB, 0xD0, 0x5D, 0x09, 0x3A, 0xE5, 0x86, 0x64, 0x8D, 0x1E, 0xE2, 0x8E, 0x72, 0x61, 0x7B, 0x99, 0xD0, 0xF0, 0x08, 0x6E, 0x1E, 0x45, 0xBF }, -+ { 0x57, 0x1C, 0xED, 0x28, 0x3B, 0x3F, 0x23, 0xB4, 0xE7, 0x50, 0xBF, 0x12, 0xA2, 0xCA, 0xF1, 0x78, 0x18, 0x47, 0xBD, 0x89, 0x0E, 0x43, 0x60, 0x3C, 0xDC, 0x59, 0x76, 0x10, 0x2B, 0x7B, 0xB1, 0x1B }, -+ { 0xCF, 0xCB, 0x76, 0x5B, 0x04, 0x8E, 0x35, 0x02, 0x2C, 0x5D, 0x08, 0x9D, 0x26, 0xE8, 0x5A, 0x36, 0xB0, 0x05, 0xA2, 0xB8, 0x04, 0x93, 0xD0, 0x3A, 0x14, 0x4E, 0x09, 0xF4, 0x09, 0xB6, 0xAF, 0xD1 }, -+ { 0x40, 0x50, 0xC7, 0xA2, 0x77, 0x05, 0xBB, 0x27, 0xF4, 0x20, 0x89, 0xB2, 0x99, 0xF3, 0xCB, 0xE5, 0x05, 0x4E, 0xAD, 0x68, 0x72, 0x7E, 0x8E, 0xF9, 0x31, 0x8C, 0xE6, 0xF2, 0x5C, 0xD6, 0xF3, 0x1D }, -+ { 0x18, 0x40, 0x70, 0xBD, 0x5D, 0x26, 0x5F, 0xBD, 0xC1, 0x42, 0xCD, 0x1C, 0x5C, 0xD0, 0xD7, 0xE4, 0x14, 0xE7, 0x03, 0x69, 0xA2, 0x66, 0xD6, 0x27, 0xC8, 0xFB, 0xA8, 0x4F, 0xA5, 0xE8, 0x4C, 0x34 }, -+ { 0x9E, 0xDD, 0xA9, 0xA4, 0x44, 0x39, 0x02, 0xA9, 0x58, 0x8C, 0x0D, 0x0C, 0xCC, 0x62, 0xB9, 0x30, 0x21, 0x84, 0x79, 0xA6, 0x84, 0x1E, 0x6F, 0xE7, 0xD4, 0x30, 0x03, 0xF0, 0x4B, 0x1F, 0xD6, 0x43 }, -+ { 0xE4, 0x12, 0xFE, 0xEF, 0x79, 0x08, 0x32, 0x4A, 0x6D, 0xA1, 0x84, 0x16, 0x29, 0xF3, 0x5D, 0x3D, 0x35, 0x86, 0x42, 0x01, 0x93, 0x10, 0xEC, 0x57, 0xC6, 0x14, 0x83, 0x6B, 0x63, 0xD3, 0x07, 0x63 }, -+ { 0x1A, 0x2B, 0x8E, 0xDF, 0xF3, 0xF9, 0xAC, 0xC1, 0x55, 0x4F, 0xCB, 0xAE, 0x3C, 0xF1, 0xD6, 0x29, 0x8C, 0x64, 0x62, 0xE2, 0x2E, 0x5E, 0xB0, 0x25, 0x96, 0x84, 0xF8, 0x35, 0x01, 0x2B, 0xD1, 0x3F }, -+ { 0x28, 0x8C, 0x4A, 0xD9, 0xB9, 0x40, 0x97, 0x62, 0xEA, 0x07, 0xC2, 0x4A, 0x41, 0xF0, 0x4F, 0x69, 0xA7, 0xD7, 0x4B, 0xEE, 0x2D, 0x95, 0x43, 0x53, 0x74, 0xBD, 0xE9, 0x46, 0xD7, 0x24, 0x1C, 0x7B }, -+ { 0x80, 0x56, 0x91, 0xBB, 0x28, 0x67, 0x48, 0xCF, 0xB5, 0x91, 0xD3, 0xAE, 0xBE, 0x7E, 0x6F, 0x4E, 0x4D, 0xC6, 0xE2, 0x80, 0x8C, 0x65, 0x14, 0x3C, 0xC0, 0x04, 0xE4, 0xEB, 0x6F, 0xD0, 0x9D, 0x43 }, -+ { 0xD4, 0xAC, 0x8D, 0x3A, 0x0A, 0xFC, 0x6C, 0xFA, 0x7B, 0x46, 0x0A, 0xE3, 0x00, 0x1B, 0xAE, 0xB3, 0x6D, 0xAD, 0xB3, 0x7D, 0xA0, 0x7D, 0x2E, 0x8A, 0xC9, 0x18, 0x22, 0xDF, 0x34, 0x8A, 0xED, 0x3D }, -+ { 0xC3, 0x76, 0x61, 0x70, 0x14, 0xD2, 0x01, 0x58, 0xBC, 0xED, 0x3D, 0x3B, 0xA5, 0x52, 0xB6, 0xEC, 0xCF, 0x84, 0xE6, 0x2A, 0xA3, 0xEB, 0x65, 0x0E, 0x90, 0x02, 0x9C, 0x84, 0xD1, 0x3E, 0xEA, 0x69 }, -+ { 0xC4, 0x1F, 0x09, 0xF4, 0x3C, 0xEC, 0xAE, 0x72, 0x93, 0xD6, 0x00, 0x7C, 0xA0, 0xA3, 0x57, 0x08, 0x7D, 0x5A, 0xE5, 0x9B, 0xE5, 0x00, 0xC1, 0xCD, 0x5B, 0x28, 0x9E, 0xE8, 0x10, 0xC7, 0xB0, 0x82 }, -+ { 0x03, 0xD1, 0xCE, 0xD1, 0xFB, 0xA5, 0xC3, 0x91, 0x55, 0xC4, 0x4B, 0x77, 0x65, 0xCB, 0x76, 0x0C, 0x78, 0x70, 0x8D, 0xCF, 0xC8, 0x0B, 0x0B, 0xD8, 0xAD, 0xE3, 0xA5, 0x6D, 0xA8, 0x83, 0x0B, 0x29 }, -+ { 0x09, 0xBD, 0xE6, 0xF1, 0x52, 0x21, 0x8D, 0xC9, 0x2C, 0x41, 0xD7, 0xF4, 0x53, 0x87, 0xE6, 0x3E, 0x58, 0x69, 0xD8, 0x07, 0xEC, 0x70, 0xB8, 0x21, 0x40, 0x5D, 0xBD, 0x88, 0x4B, 0x7F, 0xCF, 0x4B }, -+ { 0x71, 0xC9, 0x03, 0x6E, 0x18, 0x17, 0x9B, 0x90, 0xB3, 0x7D, 0x39, 0xE9, 0xF0, 0x5E, 0xB8, 0x9C, 0xC5, 0xFC, 0x34, 0x1F, 0xD7, 0xC4, 0x77, 0xD0, 0xD7, 0x49, 0x32, 0x85, 0xFA, 0xCA, 0x08, 0xA4 }, -+ { 0x59, 0x16, 0x83, 0x3E, 0xBB, 0x05, 0xCD, 0x91, 0x9C, 0xA7, 0xFE, 0x83, 0xB6, 0x92, 0xD3, 0x20, 0x5B, 0xEF, 0x72, 0x39, 0x2B, 0x2C, 0xF6, 0xBB, 0x0A, 0x6D, 0x43, 0xF9, 0x94, 0xF9, 0x5F, 0x11 }, -+ { 0xF6, 0x3A, 0xAB, 0x3E, 0xC6, 0x41, 0xB3, 0xB0, 0x24, 0x96, 0x4C, 0x2B, 0x43, 0x7C, 0x04, 0xF6, 0x04, 0x3C, 0x4C, 0x7E, 0x02, 0x79, 0x23, 0x99, 0x95, 0x40, 0x19, 0x58, 0xF8, 0x6B, 0xBE, 0x54 }, -+ { 0xF1, 0x72, 0xB1, 0x80, 0xBF, 0xB0, 0x97, 0x40, 0x49, 0x31, 0x20, 0xB6, 0x32, 0x6C, 0xBD, 0xC5, 0x61, 0xE4, 0x77, 0xDE, 0xF9, 0xBB, 0xCF, 0xD2, 0x8C, 0xC8, 0xC1, 0xC5, 0xE3, 0x37, 0x9A, 0x31 }, -+ { 0xCB, 0x9B, 0x89, 0xCC, 0x18, 0x38, 0x1D, 0xD9, 0x14, 0x1A, 0xDE, 0x58, 0x86, 0x54, 0xD4, 0xE6, 0xA2, 0x31, 0xD5, 0xBF, 0x49, 0xD4, 0xD5, 0x9A, 0xC2, 0x7D, 0x86, 0x9C, 0xBE, 0x10, 0x0C, 0xF3 }, -+ { 0x7B, 0xD8, 0x81, 0x50, 0x46, 0xFD, 0xD8, 0x10, 0xA9, 0x23, 0xE1, 0x98, 0x4A, 0xAE, 0xBD, 0xCD, 0xF8, 0x4D, 0x87, 0xC8, 0x99, 0x2D, 0x68, 0xB5, 0xEE, 0xB4, 0x60, 0xF9, 0x3E, 0xB3, 0xC8, 0xD7 }, -+ { 0x60, 0x7B, 0xE6, 0x68, 0x62, 0xFD, 0x08, 0xEE, 0x5B, 0x19, 0xFA, 0xCA, 0xC0, 0x9D, 0xFD, 0xBC, 0xD4, 0x0C, 0x31, 0x21, 0x01, 0xD6, 0x6E, 0x6E, 0xBD, 0x2B, 0x84, 0x1F, 0x1B, 0x9A, 0x93, 0x25 }, -+ { 0x9F, 0xE0, 0x3B, 0xBE, 0x69, 0xAB, 0x18, 0x34, 0xF5, 0x21, 0x9B, 0x0D, 0xA8, 0x8A, 0x08, 0xB3, 0x0A, 0x66, 0xC5, 0x91, 0x3F, 0x01, 0x51, 0x96, 0x3C, 0x36, 0x05, 0x60, 0xDB, 0x03, 0x87, 0xB3 }, -+ { 0x90, 0xA8, 0x35, 0x85, 0x71, 0x7B, 0x75, 0xF0, 0xE9, 0xB7, 0x25, 0xE0, 0x55, 0xEE, 0xEE, 0xB9, 0xE7, 0xA0, 0x28, 0xEA, 0x7E, 0x6C, 0xBC, 0x07, 0xB2, 0x09, 0x17, 0xEC, 0x03, 0x63, 0xE3, 0x8C }, -+ { 0x33, 0x6E, 0xA0, 0x53, 0x0F, 0x4A, 0x74, 0x69, 0x12, 0x6E, 0x02, 0x18, 0x58, 0x7E, 0xBB, 0xDE, 0x33, 0x58, 0xA0, 0xB3, 0x1C, 0x29, 0xD2, 0x00, 0xF7, 0xDC, 0x7E, 0xB1, 0x5C, 0x6A, 0xAD, 0xD8 }, -+ { 0xA7, 0x9E, 0x76, 0xDC, 0x0A, 0xBC, 0xA4, 0x39, 0x6F, 0x07, 0x47, 0xCD, 0x7B, 0x74, 0x8D, 0xF9, 0x13, 0x00, 0x76, 0x26, 0xB1, 0xD6, 0x59, 0xDA, 0x0C, 0x1F, 0x78, 0xB9, 0x30, 0x3D, 0x01, 0xA3 }, -+ { 0x44, 0xE7, 0x8A, 0x77, 0x37, 0x56, 0xE0, 0x95, 0x15, 0x19, 0x50, 0x4D, 0x70, 0x38, 0xD2, 0x8D, 0x02, 0x13, 0xA3, 0x7E, 0x0C, 0xE3, 0x75, 0x37, 0x17, 0x57, 0xBC, 0x99, 0x63, 0x11, 0xE3, 0xB8 }, -+ { 0x77, 0xAC, 0x01, 0x2A, 0x3F, 0x75, 0x4D, 0xCF, 0xEA, 0xB5, 0xEB, 0x99, 0x6B, 0xE9, 0xCD, 0x2D, 0x1F, 0x96, 0x11, 0x1B, 0x6E, 0x49, 0xF3, 0x99, 0x4D, 0xF1, 0x81, 0xF2, 0x85, 0x69, 0xD8, 0x25 }, -+ { 0xCE, 0x5A, 0x10, 0xDB, 0x6F, 0xCC, 0xDA, 0xF1, 0x40, 0xAA, 0xA4, 0xDE, 0xD6, 0x25, 0x0A, 0x9C, 0x06, 0xE9, 0x22, 0x2B, 0xC9, 0xF9, 0xF3, 0x65, 0x8A, 0x4A, 0xFF, 0x93, 0x5F, 0x2B, 0x9F, 0x3A }, -+ { 0xEC, 0xC2, 0x03, 0xA7, 0xFE, 0x2B, 0xE4, 0xAB, 0xD5, 0x5B, 0xB5, 0x3E, 0x6E, 0x67, 0x35, 0x72, 0xE0, 0x07, 0x8D, 0xA8, 0xCD, 0x37, 0x5E, 0xF4, 0x30, 0xCC, 0x97, 0xF9, 0xF8, 0x00, 0x83, 0xAF }, -+ { 0x14, 0xA5, 0x18, 0x6D, 0xE9, 0xD7, 0xA1, 0x8B, 0x04, 0x12, 0xB8, 0x56, 0x3E, 0x51, 0xCC, 0x54, 0x33, 0x84, 0x0B, 0x4A, 0x12, 0x9A, 0x8F, 0xF9, 0x63, 0xB3, 0x3A, 0x3C, 0x4A, 0xFE, 0x8E, 0xBB }, -+ { 0x13, 0xF8, 0xEF, 0x95, 0xCB, 0x86, 0xE6, 0xA6, 0x38, 0x93, 0x1C, 0x8E, 0x10, 0x76, 0x73, 0xEB, 0x76, 0xBA, 0x10, 0xD7, 0xC2, 0xCD, 0x70, 0xB9, 0xD9, 0x92, 0x0B, 0xBE, 0xED, 0x92, 0x94, 0x09 }, -+ { 0x0B, 0x33, 0x8F, 0x4E, 0xE1, 0x2F, 0x2D, 0xFC, 0xB7, 0x87, 0x13, 0x37, 0x79, 0x41, 0xE0, 0xB0, 0x63, 0x21, 0x52, 0x58, 0x1D, 0x13, 0x32, 0x51, 0x6E, 0x4A, 0x2C, 0xAB, 0x19, 0x42, 0xCC, 0xA4 }, -+ { 0xEA, 0xAB, 0x0E, 0xC3, 0x7B, 0x3B, 0x8A, 0xB7, 0x96, 0xE9, 0xF5, 0x72, 0x38, 0xDE, 0x14, 0xA2, 0x64, 0xA0, 0x76, 0xF3, 0x88, 0x7D, 0x86, 0xE2, 0x9B, 0xB5, 0x90, 0x6D, 0xB5, 0xA0, 0x0E, 0x02 }, -+ { 0x23, 0xCB, 0x68, 0xB8, 0xC0, 0xE6, 0xDC, 0x26, 0xDC, 0x27, 0x76, 0x6D, 0xDC, 0x0A, 0x13, 0xA9, 0x94, 0x38, 0xFD, 0x55, 0x61, 0x7A, 0xA4, 0x09, 0x5D, 0x8F, 0x96, 0x97, 0x20, 0xC8, 0x72, 0xDF }, -+ { 0x09, 0x1D, 0x8E, 0xE3, 0x0D, 0x6F, 0x29, 0x68, 0xD4, 0x6B, 0x68, 0x7D, 0xD6, 0x52, 0x92, 0x66, 0x57, 0x42, 0xDE, 0x0B, 0xB8, 0x3D, 0xCC, 0x00, 0x04, 0xC7, 0x2C, 0xE1, 0x00, 0x07, 0xA5, 0x49 }, -+ { 0x7F, 0x50, 0x7A, 0xBC, 0x6D, 0x19, 0xBA, 0x00, 0xC0, 0x65, 0xA8, 0x76, 0xEC, 0x56, 0x57, 0x86, 0x88, 0x82, 0xD1, 0x8A, 0x22, 0x1B, 0xC4, 0x6C, 0x7A, 0x69, 0x12, 0x54, 0x1F, 0x5B, 0xC7, 0xBA }, -+ { 0xA0, 0x60, 0x7C, 0x24, 0xE1, 0x4E, 0x8C, 0x22, 0x3D, 0xB0, 0xD7, 0x0B, 0x4D, 0x30, 0xEE, 0x88, 0x01, 0x4D, 0x60, 0x3F, 0x43, 0x7E, 0x9E, 0x02, 0xAA, 0x7D, 0xAF, 0xA3, 0xCD, 0xFB, 0xAD, 0x94 }, -+ { 0xDD, 0xBF, 0xEA, 0x75, 0xCC, 0x46, 0x78, 0x82, 0xEB, 0x34, 0x83, 0xCE, 0x5E, 0x2E, 0x75, 0x6A, 0x4F, 0x47, 0x01, 0xB7, 0x6B, 0x44, 0x55, 0x19, 0xE8, 0x9F, 0x22, 0xD6, 0x0F, 0xA8, 0x6E, 0x06 }, -+ { 0x0C, 0x31, 0x1F, 0x38, 0xC3, 0x5A, 0x4F, 0xB9, 0x0D, 0x65, 0x1C, 0x28, 0x9D, 0x48, 0x68, 0x56, 0xCD, 0x14, 0x13, 0xDF, 0x9B, 0x06, 0x77, 0xF5, 0x3E, 0xCE, 0x2C, 0xD9, 0xE4, 0x77, 0xC6, 0x0A }, -+ { 0x46, 0xA7, 0x3A, 0x8D, 0xD3, 0xE7, 0x0F, 0x59, 0xD3, 0x94, 0x2C, 0x01, 0xDF, 0x59, 0x9D, 0xEF, 0x78, 0x3C, 0x9D, 0xA8, 0x2F, 0xD8, 0x32, 0x22, 0xCD, 0x66, 0x2B, 0x53, 0xDC, 0xE7, 0xDB, 0xDF }, -+ { 0xAD, 0x03, 0x8F, 0xF9, 0xB1, 0x4D, 0xE8, 0x4A, 0x80, 0x1E, 0x4E, 0x62, 0x1C, 0xE5, 0xDF, 0x02, 0x9D, 0xD9, 0x35, 0x20, 0xD0, 0xC2, 0xFA, 0x38, 0xBF, 0xF1, 0x76, 0xA8, 0xB1, 0xD1, 0x69, 0x8C }, -+ { 0xAB, 0x70, 0xC5, 0xDF, 0xBD, 0x1E, 0xA8, 0x17, 0xFE, 0xD0, 0xCD, 0x06, 0x72, 0x93, 0xAB, 0xF3, 0x19, 0xE5, 0xD7, 0x90, 0x1C, 0x21, 0x41, 0xD5, 0xD9, 0x9B, 0x23, 0xF0, 0x3A, 0x38, 0xE7, 0x48 }, -+ { 0x1F, 0xFF, 0xDA, 0x67, 0x93, 0x2B, 0x73, 0xC8, 0xEC, 0xAF, 0x00, 0x9A, 0x34, 0x91, 0xA0, 0x26, 0x95, 0x3B, 0xAB, 0xFE, 0x1F, 0x66, 0x3B, 0x06, 0x97, 0xC3, 0xC4, 0xAE, 0x8B, 0x2E, 0x7D, 0xCB }, -+ { 0xB0, 0xD2, 0xCC, 0x19, 0x47, 0x2D, 0xD5, 0x7F, 0x2B, 0x17, 0xEF, 0xC0, 0x3C, 0x8D, 0x58, 0xC2, 0x28, 0x3D, 0xBB, 0x19, 0xDA, 0x57, 0x2F, 0x77, 0x55, 0x85, 0x5A, 0xA9, 0x79, 0x43, 0x17, 0xA0 }, -+ { 0xA0, 0xD1, 0x9A, 0x6E, 0xE3, 0x39, 0x79, 0xC3, 0x25, 0x51, 0x0E, 0x27, 0x66, 0x22, 0xDF, 0x41, 0xF7, 0x15, 0x83, 0xD0, 0x75, 0x01, 0xB8, 0x70, 0x71, 0x12, 0x9A, 0x0A, 0xD9, 0x47, 0x32, 0xA5 }, -+ { 0x72, 0x46, 0x42, 0xA7, 0x03, 0x2D, 0x10, 0x62, 0xB8, 0x9E, 0x52, 0xBE, 0xA3, 0x4B, 0x75, 0xDF, 0x7D, 0x8F, 0xE7, 0x72, 0xD9, 0xFE, 0x3C, 0x93, 0xDD, 0xF3, 0xC4, 0x54, 0x5A, 0xB5, 0xA9, 0x9B }, -+ { 0xAD, 0xE5, 0xEA, 0xA7, 0xE6, 0x1F, 0x67, 0x2D, 0x58, 0x7E, 0xA0, 0x3D, 0xAE, 0x7D, 0x7B, 0x55, 0x22, 0x9C, 0x01, 0xD0, 0x6B, 0xC0, 0xA5, 0x70, 0x14, 0x36, 0xCB, 0xD1, 0x83, 0x66, 0xA6, 0x26 }, -+ { 0x01, 0x3B, 0x31, 0xEB, 0xD2, 0x28, 0xFC, 0xDD, 0xA5, 0x1F, 0xAB, 0xB0, 0x3B, 0xB0, 0x2D, 0x60, 0xAC, 0x20, 0xCA, 0x21, 0x5A, 0xAF, 0xA8, 0x3B, 0xDD, 0x85, 0x5E, 0x37, 0x55, 0xA3, 0x5F, 0x0B }, -+ { 0x33, 0x2E, 0xD4, 0x0B, 0xB1, 0x0D, 0xDE, 0x3C, 0x95, 0x4A, 0x75, 0xD7, 0xB8, 0x99, 0x9D, 0x4B, 0x26, 0xA1, 0xC0, 0x63, 0xC1, 0xDC, 0x6E, 0x32, 0xC1, 0xD9, 0x1B, 0xAB, 0x7B, 0xBB, 0x7D, 0x16 }, -+ { 0xC7, 0xA1, 0x97, 0xB3, 0xA0, 0x5B, 0x56, 0x6B, 0xCC, 0x9F, 0xAC, 0xD2, 0x0E, 0x44, 0x1D, 0x6F, 0x6C, 0x28, 0x60, 0xAC, 0x96, 0x51, 0xCD, 0x51, 0xD6, 0xB9, 0xD2, 0xCD, 0xEE, 0xEA, 0x03, 0x90 }, -+ { 0xBD, 0x9C, 0xF6, 0x4E, 0xA8, 0x95, 0x3C, 0x03, 0x71, 0x08, 0xE6, 0xF6, 0x54, 0x91, 0x4F, 0x39, 0x58, 0xB6, 0x8E, 0x29, 0xC1, 0x67, 0x00, 0xDC, 0x18, 0x4D, 0x94, 0xA2, 0x17, 0x08, 0xFF, 0x60 }, -+ { 0x88, 0x35, 0xB0, 0xAC, 0x02, 0x11, 0x51, 0xDF, 0x71, 0x64, 0x74, 0xCE, 0x27, 0xCE, 0x4D, 0x3C, 0x15, 0xF0, 0xB2, 0xDA, 0xB4, 0x80, 0x03, 0xCF, 0x3F, 0x3E, 0xFD, 0x09, 0x45, 0x10, 0x6B, 0x9A }, -+ { 0x3B, 0xFE, 0xFA, 0x33, 0x01, 0xAA, 0x55, 0xC0, 0x80, 0x19, 0x0C, 0xFF, 0xDA, 0x8E, 0xAE, 0x51, 0xD9, 0xAF, 0x48, 0x8B, 0x4C, 0x1F, 0x24, 0xC3, 0xD9, 0xA7, 0x52, 0x42, 0xFD, 0x8E, 0xA0, 0x1D }, -+ { 0x08, 0x28, 0x4D, 0x14, 0x99, 0x3C, 0xD4, 0x7D, 0x53, 0xEB, 0xAE, 0xCF, 0x0D, 0xF0, 0x47, 0x8C, 0xC1, 0x82, 0xC8, 0x9C, 0x00, 0xE1, 0x85, 0x9C, 0x84, 0x85, 0x16, 0x86, 0xDD, 0xF2, 0xC1, 0xB7 }, -+ { 0x1E, 0xD7, 0xEF, 0x9F, 0x04, 0xC2, 0xAC, 0x8D, 0xB6, 0xA8, 0x64, 0xDB, 0x13, 0x10, 0x87, 0xF2, 0x70, 0x65, 0x09, 0x8E, 0x69, 0xC3, 0xFE, 0x78, 0x71, 0x8D, 0x9B, 0x94, 0x7F, 0x4A, 0x39, 0xD0 }, -+ { 0xC1, 0x61, 0xF2, 0xDC, 0xD5, 0x7E, 0x9C, 0x14, 0x39, 0xB3, 0x1A, 0x9D, 0xD4, 0x3D, 0x8F, 0x3D, 0x7D, 0xD8, 0xF0, 0xEB, 0x7C, 0xFA, 0xC6, 0xFB, 0x25, 0xA0, 0xF2, 0x8E, 0x30, 0x6F, 0x06, 0x61 }, -+ { 0xC0, 0x19, 0x69, 0xAD, 0x34, 0xC5, 0x2C, 0xAF, 0x3D, 0xC4, 0xD8, 0x0D, 0x19, 0x73, 0x5C, 0x29, 0x73, 0x1A, 0xC6, 0xE7, 0xA9, 0x20, 0x85, 0xAB, 0x92, 0x50, 0xC4, 0x8D, 0xEA, 0x48, 0xA3, 0xFC }, -+ { 0x17, 0x20, 0xB3, 0x65, 0x56, 0x19, 0xD2, 0xA5, 0x2B, 0x35, 0x21, 0xAE, 0x0E, 0x49, 0xE3, 0x45, 0xCB, 0x33, 0x89, 0xEB, 0xD6, 0x20, 0x8A, 0xCA, 0xF9, 0xF1, 0x3F, 0xDA, 0xCC, 0xA8, 0xBE, 0x49 }, -+ { 0x75, 0x62, 0x88, 0x36, 0x1C, 0x83, 0xE2, 0x4C, 0x61, 0x7C, 0xF9, 0x5C, 0x90, 0x5B, 0x22, 0xD0, 0x17, 0xCD, 0xC8, 0x6F, 0x0B, 0xF1, 0xD6, 0x58, 0xF4, 0x75, 0x6C, 0x73, 0x79, 0x87, 0x3B, 0x7F }, -+ { 0xE7, 0xD0, 0xED, 0xA3, 0x45, 0x26, 0x93, 0xB7, 0x52, 0xAB, 0xCD, 0xA1, 0xB5, 0x5E, 0x27, 0x6F, 0x82, 0x69, 0x8F, 0x5F, 0x16, 0x05, 0x40, 0x3E, 0xFF, 0x83, 0x0B, 0xEA, 0x00, 0x71, 0xA3, 0x94 }, -+ { 0x2C, 0x82, 0xEC, 0xAA, 0x6B, 0x84, 0x80, 0x3E, 0x04, 0x4A, 0xF6, 0x31, 0x18, 0xAF, 0xE5, 0x44, 0x68, 0x7C, 0xB6, 0xE6, 0xC7, 0xDF, 0x49, 0xED, 0x76, 0x2D, 0xFD, 0x7C, 0x86, 0x93, 0xA1, 0xBC }, -+ { 0x61, 0x36, 0xCB, 0xF4, 0xB4, 0x41, 0x05, 0x6F, 0xA1, 0xE2, 0x72, 0x24, 0x98, 0x12, 0x5D, 0x6D, 0xED, 0x45, 0xE1, 0x7B, 0x52, 0x14, 0x39, 0x59, 0xC7, 0xF4, 0xD4, 0xE3, 0x95, 0x21, 0x8A, 0xC2 }, -+ { 0x72, 0x1D, 0x32, 0x45, 0xAA, 0xFE, 0xF2, 0x7F, 0x6A, 0x62, 0x4F, 0x47, 0x95, 0x4B, 0x6C, 0x25, 0x50, 0x79, 0x52, 0x6F, 0xFA, 0x25, 0xE9, 0xFF, 0x77, 0xE5, 0xDC, 0xFF, 0x47, 0x3B, 0x15, 0x97 }, -+ { 0x9D, 0xD2, 0xFB, 0xD8, 0xCE, 0xF1, 0x6C, 0x35, 0x3C, 0x0A, 0xC2, 0x11, 0x91, 0xD5, 0x09, 0xEB, 0x28, 0xDD, 0x9E, 0x3E, 0x0D, 0x8C, 0xEA, 0x5D, 0x26, 0xCA, 0x83, 0x93, 0x93, 0x85, 0x1C, 0x3A }, -+ { 0xB2, 0x39, 0x4C, 0xEA, 0xCD, 0xEB, 0xF2, 0x1B, 0xF9, 0xDF, 0x2C, 0xED, 0x98, 0xE5, 0x8F, 0x1C, 0x3A, 0x4B, 0xBB, 0xFF, 0x66, 0x0D, 0xD9, 0x00, 0xF6, 0x22, 0x02, 0xD6, 0x78, 0x5C, 0xC4, 0x6E }, -+ { 0x57, 0x08, 0x9F, 0x22, 0x27, 0x49, 0xAD, 0x78, 0x71, 0x76, 0x5F, 0x06, 0x2B, 0x11, 0x4F, 0x43, 0xBA, 0x20, 0xEC, 0x56, 0x42, 0x2A, 0x8B, 0x1E, 0x3F, 0x87, 0x19, 0x2C, 0x0E, 0xA7, 0x18, 0xC6 }, -+ { 0xE4, 0x9A, 0x94, 0x59, 0x96, 0x1C, 0xD3, 0x3C, 0xDF, 0x4A, 0xAE, 0x1B, 0x10, 0x78, 0xA5, 0xDE, 0xA7, 0xC0, 0x40, 0xE0, 0xFE, 0xA3, 0x40, 0xC9, 0x3A, 0x72, 0x48, 0x72, 0xFC, 0x4A, 0xF8, 0x06 }, -+ { 0xED, 0xE6, 0x7F, 0x72, 0x0E, 0xFF, 0xD2, 0xCA, 0x9C, 0x88, 0x99, 0x41, 0x52, 0xD0, 0x20, 0x1D, 0xEE, 0x6B, 0x0A, 0x2D, 0x2C, 0x07, 0x7A, 0xCA, 0x6D, 0xAE, 0x29, 0xF7, 0x3F, 0x8B, 0x63, 0x09 }, -+ { 0xE0, 0xF4, 0x34, 0xBF, 0x22, 0xE3, 0x08, 0x80, 0x39, 0xC2, 0x1F, 0x71, 0x9F, 0xFC, 0x67, 0xF0, 0xF2, 0xCB, 0x5E, 0x98, 0xA7, 0xA0, 0x19, 0x4C, 0x76, 0xE9, 0x6B, 0xF4, 0xE8, 0xE1, 0x7E, 0x61 }, -+ { 0x27, 0x7C, 0x04, 0xE2, 0x85, 0x34, 0x84, 0xA4, 0xEB, 0xA9, 0x10, 0xAD, 0x33, 0x6D, 0x01, 0xB4, 0x77, 0xB6, 0x7C, 0xC2, 0x00, 0xC5, 0x9F, 0x3C, 0x8D, 0x77, 0xEE, 0xF8, 0x49, 0x4F, 0x29, 0xCD }, -+ { 0x15, 0x6D, 0x57, 0x47, 0xD0, 0xC9, 0x9C, 0x7F, 0x27, 0x09, 0x7D, 0x7B, 0x7E, 0x00, 0x2B, 0x2E, 0x18, 0x5C, 0xB7, 0x2D, 0x8D, 0xD7, 0xEB, 0x42, 0x4A, 0x03, 0x21, 0x52, 0x81, 0x61, 0x21, 0x9F }, -+ { 0x20, 0xDD, 0xD1, 0xED, 0x9B, 0x1C, 0xA8, 0x03, 0x94, 0x6D, 0x64, 0xA8, 0x3A, 0xE4, 0x65, 0x9D, 0xA6, 0x7F, 0xBA, 0x7A, 0x1A, 0x3E, 0xDD, 0xB1, 0xE1, 0x03, 0xC0, 0xF5, 0xE0, 0x3E, 0x3A, 0x2C }, -+ { 0xF0, 0xAF, 0x60, 0x4D, 0x3D, 0xAB, 0xBF, 0x9A, 0x0F, 0x2A, 0x7D, 0x3D, 0xDA, 0x6B, 0xD3, 0x8B, 0xBA, 0x72, 0xC6, 0xD0, 0x9B, 0xE4, 0x94, 0xFC, 0xEF, 0x71, 0x3F, 0xF1, 0x01, 0x89, 0xB6, 0xE6 }, -+ { 0x98, 0x02, 0xBB, 0x87, 0xDE, 0xF4, 0xCC, 0x10, 0xC4, 0xA5, 0xFD, 0x49, 0xAA, 0x58, 0xDF, 0xE2, 0xF3, 0xFD, 0xDB, 0x46, 0xB4, 0x70, 0x88, 0x14, 0xEA, 0xD8, 0x1D, 0x23, 0xBA, 0x95, 0x13, 0x9B }, -+ { 0x4F, 0x8C, 0xE1, 0xE5, 0x1D, 0x2F, 0xE7, 0xF2, 0x40, 0x43, 0xA9, 0x04, 0xD8, 0x98, 0xEB, 0xFC, 0x91, 0x97, 0x54, 0x18, 0x75, 0x34, 0x13, 0xAA, 0x09, 0x9B, 0x79, 0x5E, 0xCB, 0x35, 0xCE, 0xDB }, -+ { 0xBD, 0xDC, 0x65, 0x14, 0xD7, 0xEE, 0x6A, 0xCE, 0x0A, 0x4A, 0xC1, 0xD0, 0xE0, 0x68, 0x11, 0x22, 0x88, 0xCB, 0xCF, 0x56, 0x04, 0x54, 0x64, 0x27, 0x05, 0x63, 0x01, 0x77, 0xCB, 0xA6, 0x08, 0xBD }, -+ { 0xD6, 0x35, 0x99, 0x4F, 0x62, 0x91, 0x51, 0x7B, 0x02, 0x81, 0xFF, 0xDD, 0x49, 0x6A, 0xFA, 0x86, 0x27, 0x12, 0xE5, 0xB3, 0xC4, 0xE5, 0x2E, 0x4C, 0xD5, 0xFD, 0xAE, 0x8C, 0x0E, 0x72, 0xFB, 0x08 }, -+ { 0x87, 0x8D, 0x9C, 0xA6, 0x00, 0xCF, 0x87, 0xE7, 0x69, 0xCC, 0x30, 0x5C, 0x1B, 0x35, 0x25, 0x51, 0x86, 0x61, 0x5A, 0x73, 0xA0, 0xDA, 0x61, 0x3B, 0x5F, 0x1C, 0x98, 0xDB, 0xF8, 0x12, 0x83, 0xEA }, -+ { 0xA6, 0x4E, 0xBE, 0x5D, 0xC1, 0x85, 0xDE, 0x9F, 0xDD, 0xE7, 0x60, 0x7B, 0x69, 0x98, 0x70, 0x2E, 0xB2, 0x34, 0x56, 0x18, 0x49, 0x57, 0x30, 0x7D, 0x2F, 0xA7, 0x2E, 0x87, 0xA4, 0x77, 0x02, 0xD6 }, -+ { 0xCE, 0x50, 0xEA, 0xB7, 0xB5, 0xEB, 0x52, 0xBD, 0xC9, 0xAD, 0x8E, 0x5A, 0x48, 0x0A, 0xB7, 0x80, 0xCA, 0x93, 0x20, 0xE4, 0x43, 0x60, 0xB1, 0xFE, 0x37, 0xE0, 0x3F, 0x2F, 0x7A, 0xD7, 0xDE, 0x01 }, -+ { 0xEE, 0xDD, 0xB7, 0xC0, 0xDB, 0x6E, 0x30, 0xAB, 0xE6, 0x6D, 0x79, 0xE3, 0x27, 0x51, 0x1E, 0x61, 0xFC, 0xEB, 0xBC, 0x29, 0xF1, 0x59, 0xB4, 0x0A, 0x86, 0xB0, 0x46, 0xEC, 0xF0, 0x51, 0x38, 0x23 }, -+ { 0x78, 0x7F, 0xC9, 0x34, 0x40, 0xC1, 0xEC, 0x96, 0xB5, 0xAD, 0x01, 0xC1, 0x6C, 0xF7, 0x79, 0x16, 0xA1, 0x40, 0x5F, 0x94, 0x26, 0x35, 0x6E, 0xC9, 0x21, 0xD8, 0xDF, 0xF3, 0xEA, 0x63, 0xB7, 0xE0 }, -+ { 0x7F, 0x0D, 0x5E, 0xAB, 0x47, 0xEE, 0xFD, 0xA6, 0x96, 0xC0, 0xBF, 0x0F, 0xBF, 0x86, 0xAB, 0x21, 0x6F, 0xCE, 0x46, 0x1E, 0x93, 0x03, 0xAB, 0xA6, 0xAC, 0x37, 0x41, 0x20, 0xE8, 0x90, 0xE8, 0xDF }, -+ { 0xB6, 0x80, 0x04, 0xB4, 0x2F, 0x14, 0xAD, 0x02, 0x9F, 0x4C, 0x2E, 0x03, 0xB1, 0xD5, 0xEB, 0x76, 0xD5, 0x71, 0x60, 0xE2, 0x64, 0x76, 0xD2, 0x11, 0x31, 0xBE, 0xF2, 0x0A, 0xDA, 0x7D, 0x27, 0xF4 }, -+ { 0xB0, 0xC4, 0xEB, 0x18, 0xAE, 0x25, 0x0B, 0x51, 0xA4, 0x13, 0x82, 0xEA, 0xD9, 0x2D, 0x0D, 0xC7, 0x45, 0x5F, 0x93, 0x79, 0xFC, 0x98, 0x84, 0x42, 0x8E, 0x47, 0x70, 0x60, 0x8D, 0xB0, 0xFA, 0xEC }, -+ { 0xF9, 0x2B, 0x7A, 0x87, 0x0C, 0x05, 0x9F, 0x4D, 0x46, 0x46, 0x4C, 0x82, 0x4E, 0xC9, 0x63, 0x55, 0x14, 0x0B, 0xDC, 0xE6, 0x81, 0x32, 0x2C, 0xC3, 0xA9, 0x92, 0xFF, 0x10, 0x3E, 0x3F, 0xEA, 0x52 }, -+ { 0x53, 0x64, 0x31, 0x26, 0x14, 0x81, 0x33, 0x98, 0xCC, 0x52, 0x5D, 0x4C, 0x4E, 0x14, 0x6E, 0xDE, 0xB3, 0x71, 0x26, 0x5F, 0xBA, 0x19, 0x13, 0x3A, 0x2C, 0x3D, 0x21, 0x59, 0x29, 0x8A, 0x17, 0x42 }, -+ { 0xF6, 0x62, 0x0E, 0x68, 0xD3, 0x7F, 0xB2, 0xAF, 0x50, 0x00, 0xFC, 0x28, 0xE2, 0x3B, 0x83, 0x22, 0x97, 0xEC, 0xD8, 0xBC, 0xE9, 0x9E, 0x8B, 0xE4, 0xD0, 0x4E, 0x85, 0x30, 0x9E, 0x3D, 0x33, 0x74 }, -+ { 0x53, 0x16, 0xA2, 0x79, 0x69, 0xD7, 0xFE, 0x04, 0xFF, 0x27, 0xB2, 0x83, 0x96, 0x1B, 0xFF, 0xC3, 0xBF, 0x5D, 0xFB, 0x32, 0xFB, 0x6A, 0x89, 0xD1, 0x01, 0xC6, 0xC3, 0xB1, 0x93, 0x7C, 0x28, 0x71 }, -+ { 0x81, 0xD1, 0x66, 0x4F, 0xDF, 0x3C, 0xB3, 0x3C, 0x24, 0xEE, 0xBA, 0xC0, 0xBD, 0x64, 0x24, 0x4B, 0x77, 0xC4, 0xAB, 0xEA, 0x90, 0xBB, 0xE8, 0xB5, 0xEE, 0x0B, 0x2A, 0xAF, 0xCF, 0x2D, 0x6A, 0x53 }, -+ { 0x34, 0x57, 0x82, 0xF2, 0x95, 0xB0, 0x88, 0x03, 0x52, 0xE9, 0x24, 0xA0, 0x46, 0x7B, 0x5F, 0xBC, 0x3E, 0x8F, 0x3B, 0xFB, 0xC3, 0xC7, 0xE4, 0x8B, 0x67, 0x09, 0x1F, 0xB5, 0xE8, 0x0A, 0x94, 0x42 }, -+ { 0x79, 0x41, 0x11, 0xEA, 0x6C, 0xD6, 0x5E, 0x31, 0x1F, 0x74, 0xEE, 0x41, 0xD4, 0x76, 0xCB, 0x63, 0x2C, 0xE1, 0xE4, 0xB0, 0x51, 0xDC, 0x1D, 0x9E, 0x9D, 0x06, 0x1A, 0x19, 0xE1, 0xD0, 0xBB, 0x49 }, -+ { 0x2A, 0x85, 0xDA, 0xF6, 0x13, 0x88, 0x16, 0xB9, 0x9B, 0xF8, 0xD0, 0x8B, 0xA2, 0x11, 0x4B, 0x7A, 0xB0, 0x79, 0x75, 0xA7, 0x84, 0x20, 0xC1, 0xA3, 0xB0, 0x6A, 0x77, 0x7C, 0x22, 0xDD, 0x8B, 0xCB }, -+ { 0x89, 0xB0, 0xD5, 0xF2, 0x89, 0xEC, 0x16, 0x40, 0x1A, 0x06, 0x9A, 0x96, 0x0D, 0x0B, 0x09, 0x3E, 0x62, 0x5D, 0xA3, 0xCF, 0x41, 0xEE, 0x29, 0xB5, 0x9B, 0x93, 0x0C, 0x58, 0x20, 0x14, 0x54, 0x55 }, -+ { 0xD0, 0xFD, 0xCB, 0x54, 0x39, 0x43, 0xFC, 0x27, 0xD2, 0x08, 0x64, 0xF5, 0x21, 0x81, 0x47, 0x1B, 0x94, 0x2C, 0xC7, 0x7C, 0xA6, 0x75, 0xBC, 0xB3, 0x0D, 0xF3, 0x1D, 0x35, 0x8E, 0xF7, 0xB1, 0xEB }, -+ { 0xB1, 0x7E, 0xA8, 0xD7, 0x70, 0x63, 0xC7, 0x09, 0xD4, 0xDC, 0x6B, 0x87, 0x94, 0x13, 0xC3, 0x43, 0xE3, 0x79, 0x0E, 0x9E, 0x62, 0xCA, 0x85, 0xB7, 0x90, 0x0B, 0x08, 0x6F, 0x6B, 0x75, 0xC6, 0x72 }, -+ { 0xE7, 0x1A, 0x3E, 0x2C, 0x27, 0x4D, 0xB8, 0x42, 0xD9, 0x21, 0x14, 0xF2, 0x17, 0xE2, 0xC0, 0xEA, 0xC8, 0xB4, 0x50, 0x93, 0xFD, 0xFD, 0x9D, 0xF4, 0xCA, 0x71, 0x62, 0x39, 0x48, 0x62, 0xD5, 0x01 }, -+ { 0xC0, 0x47, 0x67, 0x59, 0xAB, 0x7A, 0xA3, 0x33, 0x23, 0x4F, 0x6B, 0x44, 0xF5, 0xFD, 0x85, 0x83, 0x90, 0xEC, 0x23, 0x69, 0x4C, 0x62, 0x2C, 0xB9, 0x86, 0xE7, 0x69, 0xC7, 0x8E, 0xDD, 0x73, 0x3E }, -+ { 0x9A, 0xB8, 0xEA, 0xBB, 0x14, 0x16, 0x43, 0x4D, 0x85, 0x39, 0x13, 0x41, 0xD5, 0x69, 0x93, 0xC5, 0x54, 0x58, 0x16, 0x7D, 0x44, 0x18, 0xB1, 0x9A, 0x0F, 0x2A, 0xD8, 0xB7, 0x9A, 0x83, 0xA7, 0x5B }, -+ { 0x79, 0x92, 0xD0, 0xBB, 0xB1, 0x5E, 0x23, 0x82, 0x6F, 0x44, 0x3E, 0x00, 0x50, 0x5D, 0x68, 0xD3, 0xED, 0x73, 0x72, 0x99, 0x5A, 0x5C, 0x3E, 0x49, 0x86, 0x54, 0x10, 0x2F, 0xBC, 0xD0, 0x96, 0x4E }, -+ { 0xC0, 0x21, 0xB3, 0x00, 0x85, 0x15, 0x14, 0x35, 0xDF, 0x33, 0xB0, 0x07, 0xCC, 0xEC, 0xC6, 0x9D, 0xF1, 0x26, 0x9F, 0x39, 0xBA, 0x25, 0x09, 0x2B, 0xED, 0x59, 0xD9, 0x32, 0xAC, 0x0F, 0xDC, 0x28 }, -+ { 0x91, 0xA2, 0x5E, 0xC0, 0xEC, 0x0D, 0x9A, 0x56, 0x7F, 0x89, 0xC4, 0xBF, 0xE1, 0xA6, 0x5A, 0x0E, 0x43, 0x2D, 0x07, 0x06, 0x4B, 0x41, 0x90, 0xE2, 0x7D, 0xFB, 0x81, 0x90, 0x1F, 0xD3, 0x13, 0x9B }, -+ { 0x59, 0x50, 0xD3, 0x9A, 0x23, 0xE1, 0x54, 0x5F, 0x30, 0x12, 0x70, 0xAA, 0x1A, 0x12, 0xF2, 0xE6, 0xC4, 0x53, 0x77, 0x6E, 0x4D, 0x63, 0x55, 0xDE, 0x42, 0x5C, 0xC1, 0x53, 0xF9, 0x81, 0x88, 0x67 }, -+ { 0xD7, 0x9F, 0x14, 0x72, 0x0C, 0x61, 0x0A, 0xF1, 0x79, 0xA3, 0x76, 0x5D, 0x4B, 0x7C, 0x09, 0x68, 0xF9, 0x77, 0x96, 0x2D, 0xBF, 0x65, 0x5B, 0x52, 0x12, 0x72, 0xB6, 0xF1, 0xE1, 0x94, 0x48, 0x8E }, -+ { 0xE9, 0x53, 0x1B, 0xFC, 0x8B, 0x02, 0x99, 0x5A, 0xEA, 0xA7, 0x5B, 0xA2, 0x70, 0x31, 0xFA, 0xDB, 0xCB, 0xF4, 0xA0, 0xDA, 0xB8, 0x96, 0x1D, 0x92, 0x96, 0xCD, 0x7E, 0x84, 0xD2, 0x5D, 0x60, 0x06 }, -+ { 0x34, 0xE9, 0xC2, 0x6A, 0x01, 0xD7, 0xF1, 0x61, 0x81, 0xB4, 0x54, 0xA9, 0xD1, 0x62, 0x3C, 0x23, 0x3C, 0xB9, 0x9D, 0x31, 0xC6, 0x94, 0x65, 0x6E, 0x94, 0x13, 0xAC, 0xA3, 0xE9, 0x18, 0x69, 0x2F }, -+ { 0xD9, 0xD7, 0x42, 0x2F, 0x43, 0x7B, 0xD4, 0x39, 0xDD, 0xD4, 0xD8, 0x83, 0xDA, 0xE2, 0xA0, 0x83, 0x50, 0x17, 0x34, 0x14, 0xBE, 0x78, 0x15, 0x51, 0x33, 0xFF, 0xF1, 0x96, 0x4C, 0x3D, 0x79, 0x72 }, -+ { 0x4A, 0xEE, 0x0C, 0x7A, 0xAF, 0x07, 0x54, 0x14, 0xFF, 0x17, 0x93, 0xEA, 0xD7, 0xEA, 0xCA, 0x60, 0x17, 0x75, 0xC6, 0x15, 0xDB, 0xD6, 0x0B, 0x64, 0x0B, 0x0A, 0x9F, 0x0C, 0xE5, 0x05, 0xD4, 0x35 }, -+ { 0x6B, 0xFD, 0xD1, 0x54, 0x59, 0xC8, 0x3B, 0x99, 0xF0, 0x96, 0xBF, 0xB4, 0x9E, 0xE8, 0x7B, 0x06, 0x3D, 0x69, 0xC1, 0x97, 0x4C, 0x69, 0x28, 0xAC, 0xFC, 0xFB, 0x40, 0x99, 0xF8, 0xC4, 0xEF, 0x67 }, -+ { 0x9F, 0xD1, 0xC4, 0x08, 0xFD, 0x75, 0xC3, 0x36, 0x19, 0x3A, 0x2A, 0x14, 0xD9, 0x4F, 0x6A, 0xF5, 0xAD, 0xF0, 0x50, 0xB8, 0x03, 0x87, 0xB4, 0xB0, 0x10, 0xFB, 0x29, 0xF4, 0xCC, 0x72, 0x70, 0x7C }, -+ { 0x13, 0xC8, 0x84, 0x80, 0xA5, 0xD0, 0x0D, 0x6C, 0x8C, 0x7A, 0xD2, 0x11, 0x0D, 0x76, 0xA8, 0x2D, 0x9B, 0x70, 0xF4, 0xFA, 0x66, 0x96, 0xD4, 0xE5, 0xDD, 0x42, 0xA0, 0x66, 0xDC, 0xAF, 0x99, 0x20 }, -+ { 0x82, 0x0E, 0x72, 0x5E, 0xE2, 0x5F, 0xE8, 0xFD, 0x3A, 0x8D, 0x5A, 0xBE, 0x4C, 0x46, 0xC3, 0xBA, 0x88, 0x9D, 0xE6, 0xFA, 0x91, 0x91, 0xAA, 0x22, 0xBA, 0x67, 0xD5, 0x70, 0x54, 0x21, 0x54, 0x2B }, -+ { 0x32, 0xD9, 0x3A, 0x0E, 0xB0, 0x2F, 0x42, 0xFB, 0xBC, 0xAF, 0x2B, 0xAD, 0x00, 0x85, 0xB2, 0x82, 0xE4, 0x60, 0x46, 0xA4, 0xDF, 0x7A, 0xD1, 0x06, 0x57, 0xC9, 0xD6, 0x47, 0x63, 0x75, 0xB9, 0x3E }, -+ { 0xAD, 0xC5, 0x18, 0x79, 0x05, 0xB1, 0x66, 0x9C, 0xD8, 0xEC, 0x9C, 0x72, 0x1E, 0x19, 0x53, 0x78, 0x6B, 0x9D, 0x89, 0xA9, 0xBA, 0xE3, 0x07, 0x80, 0xF1, 0xE1, 0xEA, 0xB2, 0x4A, 0x00, 0x52, 0x3C }, -+ { 0xE9, 0x07, 0x56, 0xFF, 0x7F, 0x9A, 0xD8, 0x10, 0xB2, 0x39, 0xA1, 0x0C, 0xED, 0x2C, 0xF9, 0xB2, 0x28, 0x43, 0x54, 0xC1, 0xF8, 0xC7, 0xE0, 0xAC, 0xCC, 0x24, 0x61, 0xDC, 0x79, 0x6D, 0x6E, 0x89 }, -+ { 0x12, 0x51, 0xF7, 0x6E, 0x56, 0x97, 0x84, 0x81, 0x87, 0x53, 0x59, 0x80, 0x1D, 0xB5, 0x89, 0xA0, 0xB2, 0x2F, 0x86, 0xD8, 0xD6, 0x34, 0xDC, 0x04, 0x50, 0x6F, 0x32, 0x2E, 0xD7, 0x8F, 0x17, 0xE8 }, -+ { 0x3A, 0xFA, 0x89, 0x9F, 0xD9, 0x80, 0xE7, 0x3E, 0xCB, 0x7F, 0x4D, 0x8B, 0x8F, 0x29, 0x1D, 0xC9, 0xAF, 0x79, 0x6B, 0xC6, 0x5D, 0x27, 0xF9, 0x74, 0xC6, 0xF1, 0x93, 0xC9, 0x19, 0x1A, 0x09, 0xFD }, -+ { 0xAA, 0x30, 0x5B, 0xE2, 0x6E, 0x5D, 0xED, 0xDC, 0x3C, 0x10, 0x10, 0xCB, 0xC2, 0x13, 0xF9, 0x5F, 0x05, 0x1C, 0x78, 0x5C, 0x5B, 0x43, 0x1E, 0x6A, 0x7C, 0xD0, 0x48, 0xF1, 0x61, 0x78, 0x75, 0x28 }, -+ { 0x8E, 0xA1, 0x88, 0x4F, 0xF3, 0x2E, 0x9D, 0x10, 0xF0, 0x39, 0xB4, 0x07, 0xD0, 0xD4, 0x4E, 0x7E, 0x67, 0x0A, 0xBD, 0x88, 0x4A, 0xEE, 0xE0, 0xFB, 0x75, 0x7A, 0xE9, 0x4E, 0xAA, 0x97, 0x37, 0x3D }, -+ { 0xD4, 0x82, 0xB2, 0x15, 0x5D, 0x4D, 0xEC, 0x6B, 0x47, 0x36, 0xA1, 0xF1, 0x61, 0x7B, 0x53, 0xAA, 0xA3, 0x73, 0x10, 0x27, 0x7D, 0x3F, 0xEF, 0x0C, 0x37, 0xAD, 0x41, 0x76, 0x8F, 0xC2, 0x35, 0xB4 }, -+ { 0x4D, 0x41, 0x39, 0x71, 0x38, 0x7E, 0x7A, 0x88, 0x98, 0xA8, 0xDC, 0x2A, 0x27, 0x50, 0x07, 0x78, 0x53, 0x9E, 0xA2, 0x14, 0xA2, 0xDF, 0xE9, 0xB3, 0xD7, 0xE8, 0xEB, 0xDC, 0xE5, 0xCF, 0x3D, 0xB3 }, -+ { 0x69, 0x6E, 0x5D, 0x46, 0xE6, 0xC5, 0x7E, 0x87, 0x96, 0xE4, 0x73, 0x5D, 0x08, 0x91, 0x6E, 0x0B, 0x79, 0x29, 0xB3, 0xCF, 0x29, 0x8C, 0x29, 0x6D, 0x22, 0xE9, 0xD3, 0x01, 0x96, 0x53, 0x37, 0x1C }, -+ { 0x1F, 0x56, 0x47, 0xC1, 0xD3, 0xB0, 0x88, 0x22, 0x88, 0x85, 0x86, 0x5C, 0x89, 0x40, 0x90, 0x8B, 0xF4, 0x0D, 0x1A, 0x82, 0x72, 0x82, 0x19, 0x73, 0xB1, 0x60, 0x00, 0x8E, 0x7A, 0x3C, 0xE2, 0xEB }, -+ { 0xB6, 0xE7, 0x6C, 0x33, 0x0F, 0x02, 0x1A, 0x5B, 0xDA, 0x65, 0x87, 0x50, 0x10, 0xB0, 0xED, 0xF0, 0x91, 0x26, 0xC0, 0xF5, 0x10, 0xEA, 0x84, 0x90, 0x48, 0x19, 0x20, 0x03, 0xAE, 0xF4, 0xC6, 0x1C }, -+ { 0x3C, 0xD9, 0x52, 0xA0, 0xBE, 0xAD, 0xA4, 0x1A, 0xBB, 0x42, 0x4C, 0xE4, 0x7F, 0x94, 0xB4, 0x2B, 0xE6, 0x4E, 0x1F, 0xFB, 0x0F, 0xD0, 0x78, 0x22, 0x76, 0x80, 0x79, 0x46, 0xD0, 0xD0, 0xBC, 0x55 }, -+ { 0x98, 0xD9, 0x26, 0x77, 0x43, 0x9B, 0x41, 0xB7, 0xBB, 0x51, 0x33, 0x12, 0xAF, 0xB9, 0x2B, 0xCC, 0x8E, 0xE9, 0x68, 0xB2, 0xE3, 0xB2, 0x38, 0xCE, 0xCB, 0x9B, 0x0F, 0x34, 0xC9, 0xBB, 0x63, 0xD0 }, -+ { 0xEC, 0xBC, 0xA2, 0xCF, 0x08, 0xAE, 0x57, 0xD5, 0x17, 0xAD, 0x16, 0x15, 0x8A, 0x32, 0xBF, 0xA7, 0xDC, 0x03, 0x82, 0xEA, 0xED, 0xA1, 0x28, 0xE9, 0x18, 0x86, 0x73, 0x4C, 0x24, 0xA0, 0xB2, 0x9D }, -+ { 0x94, 0x2C, 0xC7, 0xC0, 0xB5, 0x2E, 0x2B, 0x16, 0xA4, 0xB8, 0x9F, 0xA4, 0xFC, 0x7E, 0x0B, 0xF6, 0x09, 0xE2, 0x9A, 0x08, 0xC1, 0xA8, 0x54, 0x34, 0x52, 0xB7, 0x7C, 0x7B, 0xFD, 0x11, 0xBB, 0x28 }, -+ { 0x8A, 0x06, 0x5D, 0x8B, 0x61, 0xA0, 0xDF, 0xFB, 0x17, 0x0D, 0x56, 0x27, 0x73, 0x5A, 0x76, 0xB0, 0xE9, 0x50, 0x60, 0x37, 0x80, 0x8C, 0xBA, 0x16, 0xC3, 0x45, 0x00, 0x7C, 0x9F, 0x79, 0xCF, 0x8F }, -+ { 0x1B, 0x9F, 0xA1, 0x97, 0x14, 0x65, 0x9C, 0x78, 0xFF, 0x41, 0x38, 0x71, 0x84, 0x92, 0x15, 0x36, 0x10, 0x29, 0xAC, 0x80, 0x2B, 0x1C, 0xBC, 0xD5, 0x4E, 0x40, 0x8B, 0xD8, 0x72, 0x87, 0xF8, 0x1F }, -+ { 0x8D, 0xAB, 0x07, 0x1B, 0xCD, 0x6C, 0x72, 0x92, 0xA9, 0xEF, 0x72, 0x7B, 0x4A, 0xE0, 0xD8, 0x67, 0x13, 0x30, 0x1D, 0xA8, 0x61, 0x8D, 0x9A, 0x48, 0xAD, 0xCE, 0x55, 0xF3, 0x03, 0xA8, 0x69, 0xA1 }, -+ { 0x82, 0x53, 0xE3, 0xE7, 0xC7, 0xB6, 0x84, 0xB9, 0xCB, 0x2B, 0xEB, 0x01, 0x4C, 0xE3, 0x30, 0xFF, 0x3D, 0x99, 0xD1, 0x7A, 0xBB, 0xDB, 0xAB, 0xE4, 0xF4, 0xD6, 0x74, 0xDE, 0xD5, 0x3F, 0xFC, 0x6B }, -+ { 0xF1, 0x95, 0xF3, 0x21, 0xE9, 0xE3, 0xD6, 0xBD, 0x7D, 0x07, 0x45, 0x04, 0xDD, 0x2A, 0xB0, 0xE6, 0x24, 0x1F, 0x92, 0xE7, 0x84, 0xB1, 0xAA, 0x27, 0x1F, 0xF6, 0x48, 0xB1, 0xCA, 0xB6, 0xD7, 0xF6 }, -+ { 0x27, 0xE4, 0xCC, 0x72, 0x09, 0x0F, 0x24, 0x12, 0x66, 0x47, 0x6A, 0x7C, 0x09, 0x49, 0x5F, 0x2D, 0xB1, 0x53, 0xD5, 0xBC, 0xBD, 0x76, 0x19, 0x03, 0xEF, 0x79, 0x27, 0x5E, 0xC5, 0x6B, 0x2E, 0xD8 }, -+ { 0x89, 0x9C, 0x24, 0x05, 0x78, 0x8E, 0x25, 0xB9, 0x9A, 0x18, 0x46, 0x35, 0x5E, 0x64, 0x6D, 0x77, 0xCF, 0x40, 0x00, 0x83, 0x41, 0x5F, 0x7D, 0xC5, 0xAF, 0xE6, 0x9D, 0x6E, 0x17, 0xC0, 0x00, 0x23 }, -+ { 0xA5, 0x9B, 0x78, 0xC4, 0x90, 0x57, 0x44, 0x07, 0x6B, 0xFE, 0xE8, 0x94, 0xDE, 0x70, 0x7D, 0x4F, 0x12, 0x0B, 0x5C, 0x68, 0x93, 0xEA, 0x04, 0x00, 0x29, 0x7D, 0x0B, 0xB8, 0x34, 0x72, 0x76, 0x32 }, -+ { 0x59, 0xDC, 0x78, 0xB1, 0x05, 0x64, 0x97, 0x07, 0xA2, 0xBB, 0x44, 0x19, 0xC4, 0x8F, 0x00, 0x54, 0x00, 0xD3, 0x97, 0x3D, 0xE3, 0x73, 0x66, 0x10, 0x23, 0x04, 0x35, 0xB1, 0x04, 0x24, 0xB2, 0x4F }, -+ { 0xC0, 0x14, 0x9D, 0x1D, 0x7E, 0x7A, 0x63, 0x53, 0xA6, 0xD9, 0x06, 0xEF, 0xE7, 0x28, 0xF2, 0xF3, 0x29, 0xFE, 0x14, 0xA4, 0x14, 0x9A, 0x3E, 0xA7, 0x76, 0x09, 0xBC, 0x42, 0xB9, 0x75, 0xDD, 0xFA }, -+ { 0xA3, 0x2F, 0x24, 0x14, 0x74, 0xA6, 0xC1, 0x69, 0x32, 0xE9, 0x24, 0x3B, 0xE0, 0xCF, 0x09, 0xBC, 0xDC, 0x7E, 0x0C, 0xA0, 0xE7, 0xA6, 0xA1, 0xB9, 0xB1, 0xA0, 0xF0, 0x1E, 0x41, 0x50, 0x23, 0x77 }, -+ { 0xB2, 0x39, 0xB2, 0xE4, 0xF8, 0x18, 0x41, 0x36, 0x1C, 0x13, 0x39, 0xF6, 0x8E, 0x2C, 0x35, 0x9F, 0x92, 0x9A, 0xF9, 0xAD, 0x9F, 0x34, 0xE0, 0x1A, 0xAB, 0x46, 0x31, 0xAD, 0x6D, 0x55, 0x00, 0xB0 }, -+ { 0x85, 0xFB, 0x41, 0x9C, 0x70, 0x02, 0xA3, 0xE0, 0xB4, 0xB6, 0xEA, 0x09, 0x3B, 0x4C, 0x1A, 0xC6, 0x93, 0x66, 0x45, 0xB6, 0x5D, 0xAC, 0x5A, 0xC1, 0x5A, 0x85, 0x28, 0xB7, 0xB9, 0x4C, 0x17, 0x54 }, -+ { 0x96, 0x19, 0x72, 0x06, 0x25, 0xF1, 0x90, 0xB9, 0x3A, 0x3F, 0xAD, 0x18, 0x6A, 0xB3, 0x14, 0x18, 0x96, 0x33, 0xC0, 0xD3, 0xA0, 0x1E, 0x6F, 0x9B, 0xC8, 0xC4, 0xA8, 0xF8, 0x2F, 0x38, 0x3D, 0xBF }, -+ { 0x7D, 0x62, 0x0D, 0x90, 0xFE, 0x69, 0xFA, 0x46, 0x9A, 0x65, 0x38, 0x38, 0x89, 0x70, 0xA1, 0xAA, 0x09, 0xBB, 0x48, 0xA2, 0xD5, 0x9B, 0x34, 0x7B, 0x97, 0xE8, 0xCE, 0x71, 0xF4, 0x8C, 0x7F, 0x46 }, -+ { 0x29, 0x43, 0x83, 0x56, 0x85, 0x96, 0xFB, 0x37, 0xC7, 0x5B, 0xBA, 0xCD, 0x97, 0x9C, 0x5F, 0xF6, 0xF2, 0x0A, 0x55, 0x6B, 0xF8, 0x87, 0x9C, 0xC7, 0x29, 0x24, 0x85, 0x5D, 0xF9, 0xB8, 0x24, 0x0E }, -+ { 0x16, 0xB1, 0x8A, 0xB3, 0x14, 0x35, 0x9C, 0x2B, 0x83, 0x3C, 0x1C, 0x69, 0x86, 0xD4, 0x8C, 0x55, 0xA9, 0xFC, 0x97, 0xCD, 0xE9, 0xA3, 0xC1, 0xF1, 0x0A, 0x31, 0x77, 0x14, 0x0F, 0x73, 0xF7, 0x38 }, -+ { 0x8C, 0xBB, 0xDD, 0x14, 0xBC, 0x33, 0xF0, 0x4C, 0xF4, 0x58, 0x13, 0xE4, 0xA1, 0x53, 0xA2, 0x73, 0xD3, 0x6A, 0xDA, 0xD5, 0xCE, 0x71, 0xF4, 0x99, 0xEE, 0xB8, 0x7F, 0xB8, 0xAC, 0x63, 0xB7, 0x29 }, -+ { 0x69, 0xC9, 0xA4, 0x98, 0xDB, 0x17, 0x4E, 0xCA, 0xEF, 0xCC, 0x5A, 0x3A, 0xC9, 0xFD, 0xED, 0xF0, 0xF8, 0x13, 0xA5, 0xBE, 0xC7, 0x27, 0xF1, 0xE7, 0x75, 0xBA, 0xBD, 0xEC, 0x77, 0x18, 0x81, 0x6E }, -+ { 0xB4, 0x62, 0xC3, 0xBE, 0x40, 0x44, 0x8F, 0x1D, 0x4F, 0x80, 0x62, 0x62, 0x54, 0xE5, 0x35, 0xB0, 0x8B, 0xC9, 0xCD, 0xCF, 0xF5, 0x99, 0xA7, 0x68, 0x57, 0x8D, 0x4B, 0x28, 0x81, 0xA8, 0xE3, 0xF0 }, -+ { 0x55, 0x3E, 0x9D, 0x9C, 0x5F, 0x36, 0x0A, 0xC0, 0xB7, 0x4A, 0x7D, 0x44, 0xE5, 0xA3, 0x91, 0xDA, 0xD4, 0xCE, 0xD0, 0x3E, 0x0C, 0x24, 0x18, 0x3B, 0x7E, 0x8E, 0xCA, 0xBD, 0xF1, 0x71, 0x5A, 0x64 }, -+ { 0x7A, 0x7C, 0x55, 0xA5, 0x6F, 0xA9, 0xAE, 0x51, 0xE6, 0x55, 0xE0, 0x19, 0x75, 0xD8, 0xA6, 0xFF, 0x4A, 0xE9, 0xE4, 0xB4, 0x86, 0xFC, 0xBE, 0x4E, 0xAC, 0x04, 0x45, 0x88, 0xF2, 0x45, 0xEB, 0xEA }, -+ { 0x2A, 0xFD, 0xF3, 0xC8, 0x2A, 0xBC, 0x48, 0x67, 0xF5, 0xDE, 0x11, 0x12, 0x86, 0xC2, 0xB3, 0xBE, 0x7D, 0x6E, 0x48, 0x65, 0x7B, 0xA9, 0x23, 0xCF, 0xBF, 0x10, 0x1A, 0x6D, 0xFC, 0xF9, 0xDB, 0x9A }, -+ { 0x41, 0x03, 0x7D, 0x2E, 0xDC, 0xDC, 0xE0, 0xC4, 0x9B, 0x7F, 0xB4, 0xA6, 0xAA, 0x09, 0x99, 0xCA, 0x66, 0x97, 0x6C, 0x74, 0x83, 0xAF, 0xE6, 0x31, 0xD4, 0xED, 0xA2, 0x83, 0x14, 0x4F, 0x6D, 0xFC }, -+ { 0xC4, 0x46, 0x6F, 0x84, 0x97, 0xCA, 0x2E, 0xEB, 0x45, 0x83, 0xA0, 0xB0, 0x8E, 0x9D, 0x9A, 0xC7, 0x43, 0x95, 0x70, 0x9F, 0xDA, 0x10, 0x9D, 0x24, 0xF2, 0xE4, 0x46, 0x21, 0x96, 0x77, 0x9C, 0x5D }, -+ { 0x75, 0xF6, 0x09, 0x33, 0x8A, 0xA6, 0x7D, 0x96, 0x9A, 0x2A, 0xE2, 0xA2, 0x36, 0x2B, 0x2D, 0xA9, 0xD7, 0x7C, 0x69, 0x5D, 0xFD, 0x1D, 0xF7, 0x22, 0x4A, 0x69, 0x01, 0xDB, 0x93, 0x2C, 0x33, 0x64 }, -+ { 0x68, 0x60, 0x6C, 0xEB, 0x98, 0x9D, 0x54, 0x88, 0xFC, 0x7C, 0xF6, 0x49, 0xF3, 0xD7, 0xC2, 0x72, 0xEF, 0x05, 0x5D, 0xA1, 0xA9, 0x3F, 0xAE, 0xCD, 0x55, 0xFE, 0x06, 0xF6, 0x96, 0x70, 0x98, 0xCA }, -+ { 0x44, 0x34, 0x6B, 0xDE, 0xB7, 0xE0, 0x52, 0xF6, 0x25, 0x50, 0x48, 0xF0, 0xD9, 0xB4, 0x2C, 0x42, 0x5B, 0xAB, 0x9C, 0x3D, 0xD2, 0x41, 0x68, 0x21, 0x2C, 0x3E, 0xCF, 0x1E, 0xBF, 0x34, 0xE6, 0xAE }, -+ { 0x8E, 0x9C, 0xF6, 0xE1, 0xF3, 0x66, 0x47, 0x1F, 0x2A, 0xC7, 0xD2, 0xEE, 0x9B, 0x5E, 0x62, 0x66, 0xFD, 0xA7, 0x1F, 0x8F, 0x2E, 0x41, 0x09, 0xF2, 0x23, 0x7E, 0xD5, 0xF8, 0x81, 0x3F, 0xC7, 0x18 }, -+ { 0x84, 0xBB, 0xEB, 0x84, 0x06, 0xD2, 0x50, 0x95, 0x1F, 0x8C, 0x1B, 0x3E, 0x86, 0xA7, 0xC0, 0x10, 0x08, 0x29, 0x21, 0x83, 0x3D, 0xFD, 0x95, 0x55, 0xA2, 0xF9, 0x09, 0xB1, 0x08, 0x6E, 0xB4, 0xB8 }, -+ { 0xEE, 0x66, 0x6F, 0x3E, 0xEF, 0x0F, 0x7E, 0x2A, 0x9C, 0x22, 0x29, 0x58, 0xC9, 0x7E, 0xAF, 0x35, 0xF5, 0x1C, 0xED, 0x39, 0x3D, 0x71, 0x44, 0x85, 0xAB, 0x09, 0xA0, 0x69, 0x34, 0x0F, 0xDF, 0x88 }, -+ { 0xC1, 0x53, 0xD3, 0x4A, 0x65, 0xC4, 0x7B, 0x4A, 0x62, 0xC5, 0xCA, 0xCF, 0x24, 0x01, 0x09, 0x75, 0xD0, 0x35, 0x6B, 0x2F, 0x32, 0xC8, 0xF5, 0xDA, 0x53, 0x0D, 0x33, 0x88, 0x16, 0xAD, 0x5D, 0xE6 }, -+ { 0x9F, 0xC5, 0x45, 0x01, 0x09, 0xE1, 0xB7, 0x79, 0xF6, 0xC7, 0xAE, 0x79, 0xD5, 0x6C, 0x27, 0x63, 0x5C, 0x8D, 0xD4, 0x26, 0xC5, 0xA9, 0xD5, 0x4E, 0x25, 0x78, 0xDB, 0x98, 0x9B, 0x8C, 0x3B, 0x4E }, -+ { 0xD1, 0x2B, 0xF3, 0x73, 0x2E, 0xF4, 0xAF, 0x5C, 0x22, 0xFA, 0x90, 0x35, 0x6A, 0xF8, 0xFC, 0x50, 0xFC, 0xB4, 0x0F, 0x8F, 0x2E, 0xA5, 0xC8, 0x59, 0x47, 0x37, 0xA3, 0xB3, 0xD5, 0xAB, 0xDB, 0xD7 }, -+ { 0x11, 0x03, 0x0B, 0x92, 0x89, 0xBB, 0xA5, 0xAF, 0x65, 0x26, 0x06, 0x72, 0xAB, 0x6F, 0xEE, 0x88, 0xB8, 0x74, 0x20, 0xAC, 0xEF, 0x4A, 0x17, 0x89, 0xA2, 0x07, 0x3B, 0x7E, 0xC2, 0xF2, 0xA0, 0x9E }, -+ { 0x69, 0xCB, 0x19, 0x2B, 0x84, 0x44, 0x00, 0x5C, 0x8C, 0x0C, 0xEB, 0x12, 0xC8, 0x46, 0x86, 0x07, 0x68, 0x18, 0x8C, 0xDA, 0x0A, 0xEC, 0x27, 0xA9, 0xC8, 0xA5, 0x5C, 0xDE, 0xE2, 0x12, 0x36, 0x32 }, -+ { 0xDB, 0x44, 0x4C, 0x15, 0x59, 0x7B, 0x5F, 0x1A, 0x03, 0xD1, 0xF9, 0xED, 0xD1, 0x6E, 0x4A, 0x9F, 0x43, 0xA6, 0x67, 0xCC, 0x27, 0x51, 0x75, 0xDF, 0xA2, 0xB7, 0x04, 0xE3, 0xBB, 0x1A, 0x9B, 0x83 }, -+ { 0x3F, 0xB7, 0x35, 0x06, 0x1A, 0xBC, 0x51, 0x9D, 0xFE, 0x97, 0x9E, 0x54, 0xC1, 0xEE, 0x5B, 0xFA, 0xD0, 0xA9, 0xD8, 0x58, 0xB3, 0x31, 0x5B, 0xAD, 0x34, 0xBD, 0xE9, 0x99, 0xEF, 0xD7, 0x24, 0xDD } -+}; -+ -+bool __init blake2s_selftest(void) -+{ -+ u8 key[BLAKE2S_KEYBYTES]; -+ u8 buf[ARRAY_SIZE(blake2s_testvecs)]; -+ u8 hash[BLAKE2S_OUTBYTES]; -+ size_t i; -+ bool success = true; -+ -+ for (i = 0; i < BLAKE2S_KEYBYTES; ++i) -+ key[i] = (u8)i; -+ -+ for (i = 0; i < ARRAY_SIZE(blake2s_testvecs); ++i) -+ buf[i] = (u8)i; -+ -+ for (i = 0; i < ARRAY_SIZE(blake2s_keyed_testvecs); ++i) { -+ blake2s(hash, buf, key, BLAKE2S_OUTBYTES, i, BLAKE2S_KEYBYTES); -+ if (memcmp(hash, blake2s_keyed_testvecs[i], BLAKE2S_OUTBYTES)) { -+ pr_info("blake2s keyed self-test %zu: FAIL\n", i + 1); -+ success = false; -+ } -+ } -+ -+ for (i = 0; i < ARRAY_SIZE(blake2s_testvecs); ++i) { -+ blake2s(hash, buf, NULL, BLAKE2S_OUTBYTES, i, 0); -+ if (memcmp(hash, blake2s_testvecs[i], BLAKE2S_OUTBYTES)) { -+ pr_info("blake2s unkeyed self-test %zu: FAIL\n", i + i); -+ success = false; -+ } -+ } -+ -+ if (success) -+ pr_info("blake2s self-tests: pass\n"); -+ return success; -+} -+#endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/selftest/chacha20poly1305.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,333 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifdef DEBUG -+struct chacha20poly1305_testvec { -+ u8 *key, *nonce, *assoc, *input, *result; -+ size_t alen, ilen; -+}; -+ -+/* The first of these are the ChaCha20-Poly1305 AEAD test vectors from RFC7539 2.8.2. The rest are generated by: -+ * #!/usr/bin/env python3 -+ * -+ * from cryptography.hazmat.primitives.ciphers.aead import ChaCha20Poly1305 -+ * import os -+ * -+ * def encode_blob(blob): -+ * a = "" -+ * for i in blob: -+ * a += "\\x" + hex(i)[2:] -+ * return a -+ * -+ * enc = [ ] -+ * dec = [ ] -+ * -+ * def make_vector(plen, adlen): -+ * key = os.urandom(32) -+ * nonce = os.urandom(8) -+ * p = os.urandom(plen) -+ * ad = os.urandom(adlen) -+ * c = ChaCha20Poly1305(key).encrypt(nonce=bytes(4) + nonce, data=p, associated_data=ad) -+ * -+ * out = "{\n" -+ * out += "\t.key\t= \"" + encode_blob(key) + "\",\n" -+ * out += "\t.nonce\t= \"" + encode_blob(nonce) + "\",\n" -+ * out += "\t.assoc\t= \"" + encode_blob(ad) + "\",\n" -+ * out += "\t.alen\t= " + str(len(ad)) + ",\n" -+ * out += "\t.input\t= \"" + encode_blob(p) + "\",\n" -+ * out += "\t.ilen\t= " + str(len(p)) + ",\n" -+ * out += "\t.result\t= \"" + encode_blob(c) + "\"\n" -+ * out += "}" -+ * enc.append(out) -+ * -+ * -+ * out = "{\n" -+ * out += "\t.key\t= \"" + encode_blob(key) + "\",\n" -+ * out += "\t.nonce\t= \"" + encode_blob(nonce) + "\",\n" -+ * out += "\t.assoc\t= \"" + encode_blob(ad) + "\",\n" -+ * out += "\t.alen\t= " + str(len(ad)) + ",\n" -+ * out += "\t.input\t= \"" + encode_blob(c) + "\",\n" -+ * out += "\t.ilen\t= " + str(len(c)) + ",\n" -+ * out += "\t.result\t= \"" + encode_blob(p) + "\"\n" -+ * out += "}" -+ * dec.append(out) -+ * -+ * -+ * make_vector(0, 0) -+ * make_vector(0, 8) -+ * make_vector(1, 8) -+ * make_vector(1, 0) -+ * make_vector(129, 7) -+ * make_vector(256, 0) -+ * make_vector(512, 0) -+ * make_vector(513, 9) -+ * make_vector(1024, 16) -+ * make_vector(1933, 7) -+ * make_vector(2011, 63) -+ * -+ * print("======== encryption vectors ========") -+ * print(", ".join(enc)) -+ * -+ * print("\n\n\n======== decryption vectors ========") -+ * print(", ".join(dec)) -+ */ -+ -+static const struct chacha20poly1305_testvec chacha20poly1305_enc_vectors[] __initconst = { { -+ .key = "\x1c\x92\x40\xa5\xeb\x55\xd3\x8a\xf3\x33\x88\x86\x04\xf6\xb5\xf0\x47\x39\x17\xc1\x40\x2b\x80\x09\x9d\xca\x5c\xbc\x20\x70\x75\xc0", -+ .nonce = "\x01\x02\x03\x04\x05\x06\x07\x08", -+ .assoc = "\xf3\x33\x88\x86\x00\x00\x00\x00\x00\x00\x4e\x91", -+ .alen = 12, -+ .input = "\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x72\x65\x20\x64\x72\x61\x66\x74\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x76\x61\x6c\x69\x64\x20\x66\x6f\x72\x20\x61\x20\x6d\x61\x78\x69\x6d\x75\x6d\x20\x6f\x66\x20\x73\x69\x78\x20\x6d\x6f\x6e\x74\x68\x73\x20\x61\x6e\x64\x20\x6d\x61\x79\x20\x62\x65\x20\x75\x70\x64\x61\x74\x65\x64\x2c\x20\x72\x65\x70\x6c\x61\x63\x65\x64\x2c\x20\x6f\x72\x20\x6f\x62\x73\x6f\x6c\x65\x74\x65\x64\x20\x62\x79\x20\x6f\x74\x68\x65\x72\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x61\x74\x20\x61\x6e\x79\x20\x74\x69\x6d\x65\x2e\x20\x49\x74\x20\x69\x73\x20\x69\x6e\x61\x70\x70\x72\x6f\x70\x72\x69\x61\x74\x65\x20\x74\x6f\x20\x75\x73\x65\x20\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x73\x20\x72\x65\x66\x65\x72\x65\x6e\x63\x65\x20\x6d\x61\x74\x65\x72\x69\x61\x6c\x20\x6f\x72\x20\x74\x6f\x20\x63\x69\x74\x65\x20\x74\x68\x65\x6d\x20\x6f\x74\x68\x65\x72\x20\x74\x68\x61\x6e\x20\x61\x73\x20\x2f\xe2\x80\x9c\x77\x6f\x72\x6b\x20\x69\x6e\x20\x70\x72\x6f\x67\x72\x65\x73\x73\x2e\x2f\xe2\x80\x9d", -+ .ilen = 265, -+ .result = "\x64\xa0\x86\x15\x75\x86\x1a\xf4\x60\xf0\x62\xc7\x9b\xe6\x43\xbd\x5e\x80\x5c\xfd\x34\x5c\xf3\x89\xf1\x08\x67\x0a\xc7\x6c\x8c\xb2\x4c\x6c\xfc\x18\x75\x5d\x43\xee\xa0\x9e\xe9\x4e\x38\x2d\x26\xb0\xbd\xb7\xb7\x3c\x32\x1b\x01\x00\xd4\xf0\x3b\x7f\x35\x58\x94\xcf\x33\x2f\x83\x0e\x71\x0b\x97\xce\x98\xc8\xa8\x4a\xbd\x0b\x94\x81\x14\xad\x17\x6e\x00\x8d\x33\xbd\x60\xf9\x82\xb1\xff\x37\xc8\x55\x97\x97\xa0\x6e\xf4\xf0\xef\x61\xc1\x86\x32\x4e\x2b\x35\x06\x38\x36\x06\x90\x7b\x6a\x7c\x02\xb0\xf9\xf6\x15\x7b\x53\xc8\x67\xe4\xb9\x16\x6c\x76\x7b\x80\x4d\x46\xa5\x9b\x52\x16\xcd\xe7\xa4\xe9\x90\x40\xc5\xa4\x04\x33\x22\x5e\xe2\x82\xa1\xb0\xa0\x6c\x52\x3e\xaf\x45\x34\xd7\xf8\x3f\xa1\x15\x5b\x00\x47\x71\x8c\xbc\x54\x6a\x0d\x07\x2b\x04\xb3\x56\x4e\xea\x1b\x42\x22\x73\xf5\x48\x27\x1a\x0b\xb2\x31\x60\x53\xfa\x76\x99\x19\x55\xeb\xd6\x31\x59\x43\x4e\xce\xbb\x4e\x46\x6d\xae\x5a\x10\x73\xa6\x72\x76\x27\x09\x7a\x10\x49\xe6\x17\xd9\x1d\x36\x10\x94\xfa\x68\xf0\xff\x77\x98\x71\x30\x30\x5b\xea\xba\x2e\xda\x04\xdf\x99\x7b\x71\x4d\x6c\x6f\x2c\x29\xa6\xad\x5c\xb4\x02\x2b\x02\x70\x9b\xee\xad\x9d\x67\x89\x0c\xbb\x22\x39\x23\x36\xfe\xa1\x85\x1f\x38" -+}, { -+ .key = "\x4c\xf5\x96\x83\x38\xe6\xae\x7f\x2d\x29\x25\x76\xd5\x75\x27\x86\x91\x9a\x27\x7a\xfb\x46\xc5\xef\x94\x81\x79\x57\x14\x59\x40\x68", -+ .nonce = "\xca\xbf\x33\x71\x32\x45\x77\x8e", -+ .assoc = "", -+ .alen = 0, -+ .input = "", -+ .ilen = 0, -+ .result = "\xea\xe0\x1e\x9e\x2c\x91\xaa\xe1\xdb\x5d\x99\x3f\x8a\xf7\x69\x92" -+}, { -+ .key = "\x2d\xb0\x5d\x40\xc8\xed\x44\x88\x34\xd1\x13\xaf\x57\xa1\xeb\x3a\x2a\x80\x51\x36\xec\x5b\xbc\x8\x93\x84\x21\xb5\x13\x88\x3c\xd", -+ .nonce = "\x3d\x86\xb5\x6b\xc8\xa3\x1f\x1d", -+ .assoc = "\x33\x10\x41\x12\x1f\xf3\xd2\x6b", -+ .alen = 8, -+ .input = "", -+ .ilen = 0, -+ .result = "\xdd\x6b\x3b\x82\xce\x5a\xbd\xd6\xa9\x35\x83\xd8\x8c\x3d\x85\x77" -+}, { -+ .key = "\x4b\x28\x4b\xa3\x7b\xbe\xe9\xf8\x31\x80\x82\xd7\xd8\xe8\xb5\xa1\xe2\x18\x18\x8a\x9c\xfa\xa3\x3d\x25\x71\x3e\x40\xbc\x54\x7a\x3e", -+ .nonce = "\xd2\x32\x1f\x29\x28\xc6\xc4\xc4", -+ .assoc = "\x6a\xe2\xad\x3f\x88\x39\x5a\x40", -+ .alen = 8, -+ .input = "\xa4", -+ .ilen = 1, -+ .result = "\xb7\x1b\xb0\x73\x59\xb0\x84\xb2\x6d\x8e\xab\x94\x31\xa1\xae\xac\x89" -+}, { -+ .key = "\x66\xca\x9c\x23\x2a\x4b\x4b\x31\xe\x92\x89\x8b\xf4\x93\xc7\x87\x98\xa3\xd8\x39\xf8\xf4\xa7\x1\xc0\x2e\xa\xa6\x7e\x5a\x78\x87", -+ .nonce = "\x20\x1c\xaa\x5f\x9c\xbf\x92\x30", -+ .assoc = "", -+ .alen = 0, -+ .input = "\x2d", -+ .ilen = 1, -+ .result = "\xbf\xe1\x5b\xb\xdb\x6b\xf5\x5e\x6c\x5d\x84\x44\x39\x81\xc1\x9c\xac" -+}, { -+ .key = "\x68\x7b\x8d\x8e\xe3\xc4\xdd\xae\xdf\x72\x7f\x53\x72\x25\x1e\x78\x91\xcb\x69\x76\x1f\x49\x93\xf9\x6f\x21\xcc\x39\x9c\xad\xb1\x1", -+ .nonce = "\xdf\x51\x84\x82\x42\xc\x75\x9c", -+ .assoc = "\x70\xd3\x33\xf3\x8b\x18\xb", -+ .alen = 7, -+ .input = "\x33\x2f\x94\xc1\xa4\xef\xcc\x2a\x5b\xa6\xe5\x8f\x1d\x40\xf0\x92\x3c\xd9\x24\x11\xa9\x71\xf9\x37\x14\x99\xfa\xbe\xe6\x80\xde\x50\xc9\x96\xd4\xb0\xec\x9e\x17\xec\xd2\x5e\x72\x99\xfc\xa\xe1\xcb\x48\xd2\x85\xdd\x2f\x90\xe0\x66\x3b\xe6\x20\x74\xbe\x23\x8f\xcb\xb4\xe4\xda\x48\x40\xa6\xd1\x1b\xc7\x42\xce\x2f\xc\xa6\x85\x6e\x87\x37\x3\xb1\x7c\x25\x96\xa3\x5\xd8\xb0\xf4\xed\xea\xc2\xf0\x31\x98\x6c\xd1\x14\x25\xc0\xcb\x1\x74\xd0\x82\xf4\x36\xf5\x41\xd5\xdc\xca\xc5\xbb\x98\xfe\xfc\x69\x21\x70\xd8\xa4\x4b\xc8\xde\x8f", -+ .ilen = 129, -+ .result = "\x8b\x6\xd3\x31\xb0\x93\x45\xb1\x75\x6e\x26\xf9\x67\xbc\x90\x15\x81\x2c\xb5\xf0\xc6\x2b\xc7\x8c\x56\xd1\xbf\x69\x6c\x7\xa0\xda\x65\x27\xc9\x90\x3d\xef\x4b\x11\xf\x19\x7\xfd\x29\x92\xd9\xc8\xf7\x99\x2e\x4a\xd0\xb8\x2c\xdc\x93\xf5\x9e\x33\x78\xd1\x37\xc3\x66\xd7\x5e\xbc\x44\xbf\x53\xa5\xbc\xc4\xcb\x7b\x3a\x8e\x7f\x2\xbd\xbb\xe7\xca\xa6\x6c\x6b\x93\x21\x93\x10\x61\xe7\x69\xd0\x78\xf3\x7\x5a\x1a\x8f\x73\xaa\xb1\x4e\xd3\xda\x4f\xf3\x32\xe1\x66\x3e\x6c\xc6\x13\xba\x6\x5b\xfc\x6a\xe5\x6f\x60\xfb\x7\x40\xb0\x8c\x9d\x84\x43\x6b\xc1\xf7\x8d\x8d\x31\xf7\x7a\x39\x4d\x8f\x9a\xeb" -+}, { -+ .key = "\x8d\xb8\x91\x48\xf0\xe7\xa\xbd\xf9\x3f\xcd\xd9\xa0\x1e\x42\x4c\xe7\xde\x25\x3d\xa3\xd7\x5\x80\x8d\xf2\x82\xac\x44\x16\x51\x1", -+ .nonce = "\xde\x7b\xef\xc3\x65\x1b\x68\xb0", -+ .assoc = "", -+ .alen = 0, -+ .input = "\x9b\x18\xdb\xdd\x9a\xf\x3e\xa5\x15\x17\xde\xdf\x8\x9d\x65\xa\x67\x30\x12\xe2\x34\x77\x4b\xc1\xd9\xc6\x1f\xab\xc6\x18\x50\x17\xa7\x9d\x3c\xa6\xc5\x35\x8c\x1c\xc0\xa1\x7c\x9f\x3\x89\xca\xe1\xe6\xe9\xd4\xd3\x88\xdb\xb4\x51\x9d\xec\xb4\xfc\x52\xee\x6d\xf1\x75\x42\xc6\xfd\xbd\x7a\x8e\x86\xfc\x44\xb3\x4f\xf3\xea\x67\x5a\x41\x13\xba\xb0\xdc\xe1\xd3\x2a\x7c\x22\xb3\xca\xac\x6a\x37\x98\x3e\x1d\x40\x97\xf7\x9b\x1d\x36\x6b\xb3\x28\xbd\x60\x82\x47\x34\xaa\x2f\x7d\xe9\xa8\x70\x81\x57\xd4\xb9\x77\xa\x9d\x29\xa7\x84\x52\x4f\xc2\x4a\x40\x3b\x3c\xd4\xc9\x2a\xdb\x4a\x53\xc4\xbe\x80\xe9\x51\x7f\x8f\xc7\xa2\xce\x82\x5c\x91\x1e\x74\xd9\xd0\xbd\xd5\xf3\xfd\xda\x4d\x25\xb4\xbb\x2d\xac\x2f\x3d\x71\x85\x7b\xcf\x3c\x7b\x3e\xe\x22\x78\xc\x29\xbf\xe4\xf4\x57\xb3\xcb\x49\xa0\xfc\x1e\x5\x4e\x16\xbc\xd5\xa8\xa3\xee\x5\x35\xc6\x7c\xab\x60\x14\x55\x1a\x8e\xc5\x88\x5d\xd5\x81\xc2\x81\xa5\xc4\x60\xdb\xaf\x77\x91\xe1\xce\xa2\x7e\x7f\x42\xe3\xb0\x13\x1c\x1f\x25\x60\x21\xe2\x40\x5f\x99\xb7\x73\xec\x9b\x2b\xf0\x65\x11\xc8\xd0\xa\x9f\xd3", -+ .ilen = 256, -+ .result = "\x85\x4\xc2\xed\x8d\xfd\x97\x5c\xd2\xb7\xe2\xc1\x6b\xa3\xba\xf8\xc9\x50\xc3\xc6\xa5\xe3\xa4\x7c\xc3\x23\x49\x5e\xa9\xb9\x32\xeb\x8a\x7c\xca\xe5\xec\xfb\x7c\xc0\xcb\x7d\xdc\x2c\x9d\x92\x55\x21\xa\xc8\x43\x63\x59\xa\x31\x70\x82\x67\x41\x3\xf8\xdf\xf2\xac\xa7\x2\xd4\xd5\x8a\x2d\xc8\x99\x19\x66\xd0\xf6\x88\x2c\x77\xd9\xd4\xd\x6c\xbd\x98\xde\xe7\x7f\xad\x7e\x8a\xfb\xe9\x4b\xe5\xf7\xe5\x50\xa0\x90\x3f\xd6\x22\x53\xe3\xfe\x1b\xcc\x79\x3b\xec\x12\x47\x52\xa7\xd6\x4\xe3\x52\xe6\x93\x90\x91\x32\x73\x79\xb8\xd0\x31\xde\x1f\x9f\x2f\x5\x38\x54\x2f\x35\x4\x39\xe0\xa7\xba\xc6\x52\xf6\x37\x65\x4c\x7\xa9\x7e\xb3\x21\x6f\x74\x8c\xc9\xde\xdb\x65\x1b\x9b\xaa\x60\xb1\x3\x30\x6b\xb2\x3\xc4\x1c\x4\xf8\xf\x64\xaf\x46\xe4\x65\x99\x49\xe2\xea\xce\x78\x0\xd8\x8b\xd5\x2e\xcf\xfc\x40\x49\xe8\x58\xdc\x34\x9c\x8c\x61\xbf\xa\x8e\xec\x39\xa9\x30\x5\x5a\xd2\x56\x1\xc7\xda\x8f\x4e\xbb\x43\xa3\x3a\xf9\x15\x2a\xd0\xa0\x7a\x87\x34\x82\xfe\x8a\xd1\x2d\x5e\xc7\xbf\x4\x53\x5f\x3b\x36\xd4\x25\x5c\x34\x7a\x8d\xd5\x5\xce\x72\xca\xef\x7a\x4b\xbc\xb0\x10\x5c\x96\x42\x3a\x0\x98\xcd\x15\xe8\xb7\x53" -+}, { -+ .key = "\xf2\xaa\x4f\x99\xfd\x3e\xa8\x53\xc1\x44\xe9\x81\x18\xdc\xf5\xf0\x3e\x44\x15\x59\xe0\xc5\x44\x86\xc3\x91\xa8\x75\xc0\x12\x46\xba", -+ .nonce = "\xe\xd\x57\xbb\x7b\x40\x54\x2", -+ .assoc = "", -+ .alen = 0, -+ .input = "\xc3\x9\x94\x62\xe6\x46\x2e\x10\xbe\x0\xe4\xfc\xf3\x40\xa3\xe2\xf\xc2\x8b\x28\xdc\xba\xb4\x3c\xe4\x21\x58\x61\xcd\x8b\xcd\xfb\xac\x94\xa1\x45\xf5\x1c\xe1\x12\xe0\x3b\x67\x21\x54\x5e\x8c\xaa\xcf\xdb\xb4\x51\xd4\x13\xda\xe6\x83\x89\xb6\x92\xe9\x21\x76\xa4\x93\x7d\xe\xfd\x96\x36\x3\x91\x43\x5c\x92\x49\x62\x61\x7b\xeb\x43\x89\xb8\x12\x20\x43\xd4\x47\x6\x84\xee\x47\xe9\x8a\x73\x15\xf\x72\xcf\xed\xce\x96\xb2\x7f\x21\x45\x76\xeb\x26\x28\x83\x6a\xad\xaa\xa6\x81\xd8\x55\xb1\xa3\x85\xb3\xc\xdf\xf1\x69\x2d\x97\x5\x2a\xbc\x7c\x7b\x25\xf8\x80\x9d\x39\x25\xf3\x62\xf0\x66\x5e\xf4\xa0\xcf\xd8\xfd\x4f\xb1\x1f\x60\x3a\x8\x47\xaf\xe1\xf6\x10\x77\x9\xa7\x27\x8f\x9a\x97\x5a\x26\xfa\xfe\x41\x32\x83\x10\xe0\x1d\xbf\x64\xd\xf4\x1c\x32\x35\xe5\x1b\x36\xef\xd4\x4a\x93\x4d\x0\x7c\xec\x2\x7\x8b\x5d\x7d\x1b\xe\xd1\xa6\xa5\x5d\x7d\x57\x88\xa8\xcc\x81\xb4\x86\x4e\xb4\x40\xe9\x1d\xc3\xb1\x24\x3e\x7f\xcc\x8a\x24\x9b\xdf\x6d\xf0\x39\x69\x3e\x4c\xc0\x96\xe4\x13\xda\x90\xda\xf4\x95\x66\x8b\x17\x17\xfe\x39\x43\x25\xaa\xda\xa0\x43\x3c\xb1\x41\x2\xa3\xf0\xa7\x19\x59\xbc\x1d\x7d\x6c\x6d\x91\x9\x5c\xb7\x5b\x1\xd1\x6f\x17\x21\x97\xbf\x89\x71\xa5\xb0\x6e\x7\x45\xfd\x9d\xea\x7\xf6\x7a\x9f\x10\x18\x22\x30\x73\xac\xd4\x6b\x72\x44\xed\xd9\x19\x9b\x2d\x4a\x41\xdd\xd1\x85\x5e\x37\x19\xed\xd2\x15\x8f\x5e\x91\xdb\x33\xf2\xe4\xdb\xff\x98\xfb\xa3\xb5\xca\x21\x69\x8\xe7\x8a\xdf\x90\xff\x3e\xe9\x20\x86\x3c\xe9\xfc\xb\xfe\x5c\x61\xaa\x13\x92\x7f\x7b\xec\xe0\x6d\xa8\x23\x22\xf6\x6b\x77\xc4\xfe\x40\x7\x3b\xb6\xf6\x8e\x5f\xd4\xb9\xb7\xf\x21\x4\xef\x83\x63\x91\x69\x40\xa3\x48\x5c\xd2\x60\xf9\x4f\x6c\x47\x8b\x3b\xb1\x9f\x8e\xee\x16\x8a\x13\xfc\x46\x17\xc3\xc3\x32\x56\xf8\x3c\x85\x3a\xb6\x3e\xaa\x89\x4f\xb3\xdf\x38\xfd\xf1\xe4\x3a\xc0\xe6\x58\xb5\x8f\xc5\x29\xa2\x92\x4a\xb6\xa0\x34\x7f\xab\xb5\x8a\x90\xa1\xdb\x4d\xca\xb6\x2c\x41\x3c\xf7\x2b\x21\xc3\xfd\xf4\x17\x5c\xb5\x33\x17\x68\x2b\x8\x30\xf3\xf7\x30\x3c\x96\xe6\x6a\x20\x97\xe7\x4d\x10\x5f\x47\x5f\x49\x96\x9\xf0\x27\x91\xc8\xf8\x5a\x2e\x79\xb5\xe2\xb8\xe8\xb9\x7b\xd5\x10\xcb\xff\x5d\x14\x73\xf3", -+ .ilen = 512, -+ .result = "\x14\xf6\x41\x37\xa6\xd4\x27\xcd\xdb\x6\x3e\x9a\x4e\xab\xd5\xb1\x1e\x6b\xd2\xbc\x11\xf4\x28\x93\x63\x54\xef\xbb\x5e\x1d\x3a\x1d\x37\x3c\xa\x6c\x1e\xc2\xd1\x2c\xb5\xa3\xb5\x7b\xb8\x8f\x25\xa6\x1b\x61\x1c\xec\x28\x58\x26\xa4\xa8\x33\x28\x25\x5c\x45\x5\xe5\x6c\x99\xe5\x45\xc4\xa2\x3\x84\x3\x73\x1e\x8c\x49\xac\x20\xdd\x8d\xb3\xc4\xf5\xe7\x4f\xf1\xed\xa1\x98\xde\xa4\x96\xdd\x2f\xab\xab\x97\xcf\x3e\xd2\x9e\xb8\x13\x7\x28\x29\x19\xaf\xfd\xf2\x49\x43\xea\x49\x26\x91\xc1\x7\xd6\xbb\x81\x75\x35\xd\x24\x7f\xc8\xda\xd4\xb7\xeb\xe8\x5c\x9\xa2\x2f\xdc\x28\x7d\x3a\x3\xfa\x94\xb5\x1d\x17\x99\x36\xc3\x1c\x18\x34\xe3\x9f\xf5\x55\x7c\xb0\x60\x9d\xff\xac\xd4\x61\xf2\xad\xf8\xce\xc7\xbe\x5c\xd2\x95\xa8\x4b\x77\x13\x19\x59\x26\xc9\xb7\x8f\x6a\xcb\x2d\x37\x91\xea\x92\x9c\x94\x5b\xda\xb\xce\xfe\x30\x20\xf8\x51\xad\xf2\xbe\xe7\xc7\xff\xb3\x33\x91\x6a\xc9\x1a\x41\xc9\xf\xf3\x10\xe\xfd\x53\xff\x6c\x16\x52\xd9\xf3\xf7\x98\x2e\xc9\x7\x31\x2c\xc\x72\xd7\xc5\xc6\x8\x2a\x7b\xda\xbd\x7e\x2\xea\x1a\xbb\xf2\x4\x27\x61\x28\x8e\xf5\x4\x3\x1f\x4c\x7\x55\x82\xec\x1e\xd7\x8b\x2f\x65\x56\xd1\xd9\x1e\x3c\xe9\x1f\x5e\x98\x70\x38\x4a\x8c\x49\xc5\x43\xa0\xa1\x8b\x74\x9d\x4c\x62\xd\x10\xc\xf4\x6c\x8f\xe0\xaa\x9a\x8d\xb7\xe0\xbe\x4c\x87\xf1\x98\x2f\xcc\xed\xc0\x52\x29\xdc\x83\xf8\xfc\x2c\xe\xa8\x51\x4d\x80\xd\xa3\xfe\xd8\x37\xe7\x41\x24\xfc\xfb\x75\xe3\x71\x7b\x57\x45\xf5\x97\x73\x65\x63\x14\x74\xb8\x82\x9f\xf8\x60\x2f\x8a\xf2\x4e\xf1\x39\xda\x33\x91\xf8\x36\xe0\x8d\x3f\x1f\x3b\x56\xdc\xa0\x8f\x3c\x9d\x71\x52\xa7\xb8\xc0\xa5\xc6\xa2\x73\xda\xf4\x4b\x74\x5b\x0\x3d\x99\xd7\x96\xba\xe6\xe1\xa6\x96\x38\xad\xb3\xc0\xd2\xba\x91\x6b\xf9\x19\xdd\x3b\xbe\xbe\x9c\x20\x50\xba\xa1\xd0\xce\x11\xbd\x95\xd8\xd1\xdd\x33\x85\x74\xdc\xdb\x66\x76\x44\xdc\x3\x74\x48\x35\x98\xb1\x18\x47\x94\x7d\xff\x62\xe4\x58\x78\xab\xed\x95\x36\xd9\x84\x91\x82\x64\x41\xbb\x58\xe6\x1c\x20\x6d\x15\x6b\x13\x96\xe8\x35\x7f\xdc\x40\x2c\xe9\xbc\x8a\x4f\x92\xec\x6\x2d\x50\xdf\x93\x5d\x65\x5a\xa8\xfc\x20\x50\x14\xa9\x8a\x7e\x1d\x8\x1f\xe2\x99\xd0\xbe\xfb\x3a\x21\x9d\xad\x86\x54\xfd\xd\x98\x1c\x5a\x6f\x1f\x9a\x40\xcd\xa2\xff\x6a\xf1\x54" -+}, { -+ .key = "\xea\xbc\x56\x99\xe3\x50\xff\xc5\xcc\x1a\xd7\xc1\x57\x72\xea\x86\x5b\x89\x88\x61\x3d\x2f\x9b\xb2\xe7\x9c\xec\x74\x6e\x3e\xf4\x3b", -+ .nonce = "\xef\x2d\x63\xee\x6b\x80\x8b\x78", -+ .assoc = "\x5a\x27\xff\xeb\xdf\x84\xb2\x9e\xef", -+ .alen = 9, -+ .input = "\xe6\xc3\xdb\x63\x55\x15\xe3\x5b\xb7\x4b\x27\x8b\x5a\xdd\xc2\xe8\x3a\x6b\xd7\x81\x96\x35\x97\xca\xd7\x68\xe8\xef\xce\xab\xda\x9\x6e\xd6\x8e\xcb\x55\xb5\xe1\xe5\x57\xfd\xc4\xe3\xe0\x18\x4f\x85\xf5\x3f\x7e\x4b\x88\xc9\x52\x44\xf\xea\xaf\x1f\x71\x48\x9f\x97\x6d\xb9\x6f\x0\xa6\xde\x2b\x77\x8b\x15\xad\x10\xa0\x2b\x7b\x41\x90\x3\x2d\x69\xae\xcc\x77\x7c\xa5\x9d\x29\x22\xc2\xea\xb4\x0\x1a\xd2\x7a\x98\x8a\xf9\xf7\x82\xb0\xab\xd8\xa6\x94\x8d\x58\x2f\x1\x9e\x0\x20\xfc\x49\xdc\xe\x3\xe8\x45\x10\xd6\xa8\xda\x55\x10\x9a\xdf\x67\x22\x8b\x43\xab\x0\xbb\x2\xc8\xdd\x7b\x97\x17\xd7\x1d\x9e\x2\x5e\x48\xde\x8e\xcf\x99\x7\x95\x92\x3c\x5f\x9f\xc5\x8a\xc0\x23\xaa\xd5\x8c\x82\x6e\x16\x92\xb1\x12\x17\x7\xc3\xfb\x36\xf5\x6c\x35\xd6\x6\x1f\x9f\xa7\x94\xa2\x38\x63\x9c\xb0\x71\xb3\xa5\xd2\xd8\xba\x9f\x8\x1\xb3\xff\x4\x97\x73\x45\x1b\xd5\xa9\x9c\x80\xaf\x4\x9a\x85\xdb\x32\x5b\x5d\x1a\xc1\x36\x28\x10\x79\xf1\x3c\xbf\x1a\x41\x5c\x4e\xdf\xb2\x7c\x79\x3b\x7a\x62\x3d\x4b\xc9\x9b\x2a\x2e\x7c\xa2\xb1\x11\x98\xa7\x34\x1a\x0\xf3\xd1\xbc\x18\x22\xba\x2\x56\x62\x31\x10\x11\x6d\xe0\x54\x9d\x40\x1f\x26\x80\x41\xca\x3f\x68\xf\x32\x1d\xa\x8e\x79\xd8\xa4\x1b\x29\x1c\x90\x8e\xc5\xe3\xb4\x91\x37\x9a\x97\x86\x99\xd5\x9\xc5\xbb\xa3\x3f\x21\x29\x82\x14\x5c\xab\x25\xfb\xf2\x4f\x58\x26\xd4\x83\xaa\x66\x89\x67\x7e\xc0\x49\xe1\x11\x10\x7f\x7a\xda\x29\x4\xff\xf0\xcb\x9\x7c\x9d\xfa\x3\x6f\x81\x9\x31\x60\xfb\x8\xfa\x74\xd3\x64\x44\x7c\x55\x85\xec\x9c\x6e\x25\xb7\x6c\xc5\x37\xb6\x83\x87\x72\x95\x8b\x9d\xe1\x69\x5c\x31\x95\x42\xa6\x2c\xd1\x36\x47\x1f\xec\x54\xab\xa2\x1c\xd8\x0\xcc\xbc\xd\x65\xe2\x67\xbf\xbc\xea\xee\x9e\xe4\x36\x95\xbe\x73\xd9\xa6\xd9\xf\xa0\xcc\x82\x76\x26\xad\x5b\x58\x6c\x4e\xab\x29\x64\xd3\xd9\xa9\x8\x8c\x1d\xa1\x4f\x80\xd8\x3f\x94\xfb\xd3\x7b\xfc\xd1\x2b\xc3\x21\xeb\xe5\x1c\x84\x23\x7f\x4b\xfa\xdb\x34\x18\xa2\xc2\xe5\x13\xfe\x6c\x49\x81\xd2\x73\xe7\xe2\xd7\xe4\x4f\x4b\x8\x6e\xb1\x12\x22\x10\x9d\xac\x51\x1e\x17\xd9\x8a\xb\x42\x88\x16\x81\x37\x7c\x6a\xf7\xef\x2d\xe3\xd9\xf8\x5f\xe0\x53\x27\x74\xb9\xe2\xd6\x1c\x80\x2c\x52\x65", -+ .ilen = 513, -+ .result = "\xfd\x81\x8d\xd0\x3d\xb4\xd5\xdf\xd3\x42\x47\x5a\x6d\x19\x27\x66\x4b\x2e\xc\x27\x9c\x96\x4c\x72\x2\xa3\x65\xc3\xb3\x6f\x2e\xbd\x63\x8a\x4a\x5d\x29\xa2\xd0\x28\x48\xc5\x3d\x98\xa3\xbc\xe0\xbe\x3b\x3f\xe6\x8a\xa4\x7f\x53\x6\xfa\x7f\x27\x76\x72\x31\xa1\xf5\xd6\xc\x52\x47\xba\xcd\x4f\xd7\xeb\x5\x48\xd\x7c\x35\x4a\x9\xc9\x76\x71\x2\xa3\xfb\xb7\x1a\x65\xb7\xed\x98\xc6\x30\x8a\x0\xae\xa1\x31\xe5\xb5\x9e\x6d\x62\xda\xda\x7\xf\x38\x38\xd3\xcb\xc1\xb0\xad\xec\x72\xec\xb1\xa2\x7b\x59\xf3\x3d\x2b\xef\xcd\x28\x5b\x83\xcc\x18\x91\x88\xb0\x2e\xf9\x29\x31\x18\xf9\x4e\xe9\xa\x91\x92\x9f\xae\x2d\xad\xf4\xe6\x1a\xe2\xa4\xee\x47\x15\xbf\x83\x6e\xd7\x72\x12\x3b\x2d\x24\xe9\xb2\x55\xcb\x3c\x10\xf0\x24\x8a\x4a\x2\xea\x90\x25\xf0\xb4\x79\x3a\xef\x6e\xf5\x52\xdf\xb0\xa\xcd\x24\x1c\xd3\x2e\x22\x74\xea\x21\x6f\xe9\xbd\xc8\x3e\x36\x5b\x19\xf1\xca\x99\xa\xb4\xa7\x52\x1a\x4e\xf2\xad\x8d\x56\x85\xbb\x64\x89\xba\x26\xf9\xc7\xe1\x89\x19\x22\x77\xc3\xa8\xfc\xff\xad\xfe\xb9\x48\xae\x12\x30\x9f\x19\xfb\x1b\xef\x14\x87\x8a\x78\x71\xf3\xf4\xb7\x0\x9c\x1d\xb5\x3d\x49\x0\xc\x6\xd4\x50\xf9\x54\x45\xb2\x5b\x43\xdb\x6d\xcf\x1a\xe9\x7a\x7a\xcf\xfc\x8a\x4e\x4d\xb\x7\x63\x28\xd8\xe7\x8\x95\xdf\xa6\x72\x93\x2e\xbb\xa0\x42\x89\x16\xf1\xd9\xc\xf9\xa1\x16\xfd\xd9\x3\xb4\x3b\x8a\xf5\xf6\xe7\x6b\x2e\x8e\x4c\x3d\xe2\xaf\x8\x45\x3\xff\x9\xb6\xeb\x2d\xc6\x1b\x88\x94\xac\x3e\xf1\x9f\xe\xe\x2b\xd5\x0\x4d\x3f\x3b\x53\xae\xaf\x1c\x33\x5f\x55\x6e\x8d\xaf\x5\x7a\x10\x34\xc9\xf4\x66\xcb\x62\x12\xa6\xee\xe8\x1c\x5d\x12\x86\xdb\x6f\x1c\x33\xc4\x1c\xda\x82\x2d\x3b\x59\xfe\xb1\xa4\x59\x41\x86\xd0\xef\xae\xfb\xda\x6d\x11\xb8\xca\xe9\x6e\xff\xf7\xa9\xd9\x70\x30\xfc\x53\xe2\xd7\xa2\x4e\xc7\x91\xd9\x7\x6\xaa\xdd\xb0\x59\x28\x1d\x0\x66\xc5\x54\xc2\xfc\x6\xda\x5\x90\x52\x1d\x37\x66\xee\xf0\xb2\x55\x8a\x5d\xd2\x38\x86\x94\x9b\xfc\x10\x4c\xa1\xb9\x64\x3e\x44\xb8\x5f\xb0\xc\xec\xe0\xc9\xe5\x62\x75\x3f\x9\xd5\xf5\xd9\x26\xba\x9e\xd2\xf4\xb9\x48\xa\xbc\xa2\xd6\x7c\x36\x11\x7d\x26\x81\x89\xcf\xa4\xad\x73\xe\xee\xcc\x6\xa9\xdb\xb1\xfd\xfb\x9\x7f\x90\x42\x37\x2f\xe1\x9c\xf\x6f\xcf\x43\xb5\xd9\x90\xe1\x85\xf5\xa8\xae" -+}, { -+ .key = "\x47\x11\xeb\x86\x2b\x2c\xab\x44\x34\xda\x7f\x57\x3\x39\xc\xaf\x2c\x14\xfd\x65\x23\xe9\x8e\x74\xd5\x8\x68\x8\xe7\xb4\x72\xd7", -+ .nonce = "\xdb\x92\xf\x7f\x17\x54\xc\x30", -+ .assoc = "\xd2\xa1\x70\xdb\x7a\xf8\xfa\x27\xba\x73\xf\xbf\x3d\x1e\x82\xb2", -+ .alen = 16, -+ .input = "\x42\x93\xe4\xeb\x97\xb0\x57\xbf\x1a\x8b\x1f\xe4\x5f\x36\x20\x3c\xef\xa\xa9\x48\x5f\x5f\x37\x22\x3a\xde\xe3\xae\xbe\xad\x7\xcc\xb1\xf6\xf5\xf9\x56\xdd\xe7\x16\x1e\x7f\xdf\x7a\x9e\x75\xb7\xc7\xbe\xbe\x8a\x36\x4\xc0\x10\xf4\x95\x20\x3\xec\xdc\x5\xa1\x7d\xc4\xa9\x2c\x82\xd0\xbc\x8b\xc5\xc7\x45\x50\xf6\xa2\x1a\xb5\x46\x3b\x73\x2\xa6\x83\x4b\x73\x82\x58\x5e\x3b\x65\x2f\xe\xfd\x2b\x59\x16\xce\xa1\x60\x9c\xe8\x3a\x99\xed\x8d\x5a\xcf\xf6\x83\xaf\xba\xd7\x73\x73\x40\x97\x3d\xca\xef\x7\x57\xe6\xd9\x70\xe\x95\xae\xa6\x8d\x4\xcc\xee\xf7\x9\x31\x77\x12\xa3\x23\x97\x62\xb3\x7b\x32\xfb\x80\x14\x48\x81\xc3\xe5\xea\x91\x39\x52\x81\xa2\x4f\xe4\xb3\x9\xff\xde\x5e\xe9\x58\x84\x6e\xf9\x3d\xdf\x25\xea\xad\xae\xe6\x9a\xd1\x89\x55\xd3\xde\x6c\x52\xdb\x70\xfe\x37\xce\x44\xa\xa8\x25\x5f\x92\xc1\x33\x4a\x4f\x9b\x62\x35\xff\xce\xc0\xa9\x60\xce\x52\x0\x97\x51\x35\x26\x2e\xb9\x36\xa9\x87\x6e\x1e\xcc\x91\x78\x53\x98\x86\x5b\x9c\x74\x7d\x88\x33\xe1\xdf\x37\x69\x2b\xbb\xf1\x4d\xf4\xd1\xf1\x39\x93\x17\x51\x19\xe3\x19\x1e\x76\x37\x25\xfb\x9\x27\x6a\xab\x67\x6f\x14\x12\x64\xe7\xc4\x7\xdf\x4d\x17\xbb\x6d\xe0\xe9\xb9\xab\xca\x10\x68\xaf\x7e\xb7\x33\x54\x73\x7\x6e\xf7\x81\x97\x9c\x5\x6f\x84\x5f\xd2\x42\xfb\x38\xcf\xd1\x2f\x14\x30\x88\x98\x4d\x5a\xa9\x76\xd5\x4f\x3e\x70\x6c\x85\x76\xd7\x1\xa0\x1a\xc8\x4e\xaa\xac\x78\xfe\x46\xde\x6a\x5\x46\xa7\x43\xc\xb9\xde\xb9\x68\xfb\xce\x42\x99\x7\x4d\xb\x3b\x5a\x30\x35\xa8\xf9\x3a\x73\xef\xf\xdb\x1e\x16\x42\xc4\xba\xae\x58\xaa\xf8\xe5\x75\x2f\x1b\x15\x5c\xfd\xa\x97\xd0\xe4\x37\x83\x61\x5f\x43\xa6\xc7\x3f\x38\x59\xe6\xeb\xa3\x90\xc3\xaa\xaa\x5a\xd3\x34\xd4\x17\xc8\x65\x3e\x57\xbc\x5e\xdd\x9e\xb7\xf0\x2e\x5b\xb2\x1f\x8a\x8\xd\x45\x91\xb\x29\x53\x4f\x4c\x5a\x73\x56\xfe\xaf\x41\x1\x39\xa\x24\x3c\x7e\xbe\x4e\x53\xf3\xeb\x6\x66\x51\x28\x1d\xbd\x41\xa\x1\xab\x16\x47\x27\x47\x47\xf7\xcb\x46\xa\x70\x9e\x1\x9c\x9\xe1\x2a\x0\x1a\xd8\xd4\x79\x9d\x80\x15\x8e\x53\x2a\x65\x83\x78\x3e\x3\x0\x7\x12\x1f\x33\x3e\x7b\x13\x37\xf1\xc3\xef\xb7\xc1\x20\x3c\x3e\x67\x66\x5d\x88\xa7\x7d\x33\x50\x77\xb0\x28\x8e\xe7\x2c\x2e\x7a\xf4\x3c\x8d\x74\x83\xaf\x8e\x87\xf\xe4\x50\xff\x84\x5c\x47\xc\x6a\x49\xbf\x42\x86\x77\x15\x48\xa5\x90\x5d\x93\xd6\x2a\x11\xd5\xd5\x11\xaa\xce\xe7\x6f\xa5\xb0\x9\x2c\x8d\xd3\x92\xf0\x5a\x2a\xda\x5b\x1e\xd5\x9a\xc4\xc4\xf3\x49\x74\x41\xca\xe8\xc1\xf8\x44\xd6\x3c\xae\x6c\x1d\x9a\x30\x4\x4d\x27\xe\xb1\x5f\x59\xa2\x24\xe8\xe1\x98\xc5\x6a\x4c\xfe\x41\xd2\x27\x42\x52\xe1\xe9\x7d\x62\xe4\x88\xf\xad\xb2\x70\xcb\x9d\x4c\x27\x2e\x76\x1e\x1a\x63\x65\xf5\x3b\xf8\x57\x69\xeb\x5b\x38\x26\x39\x33\x25\x45\x3e\x91\xb8\xd8\xc7\xd5\x42\xc0\x22\x31\x74\xf4\xbc\xc\x23\xf1\xca\xc1\x8d\xd7\xbe\xc9\x62\xe4\x8\x1a\xcf\x36\xd5\xfe\x55\x21\x59\x91\x87\x87\xdf\x6\xdb\xdf\x96\x45\x58\xda\x5\xcd\x50\x4d\xd2\x7d\x5\x18\x73\x6a\x8d\x11\x85\xa6\x88\xe8\xda\xe6\x30\x33\xa4\x89\x31\x75\xbe\x69\x43\x84\x43\x50\x87\xdd\x71\x36\x83\xc3\x78\x74\x24\xa\xed\x7b\xdb\xa4\x24\xb\xb9\x7e\x5d\xff\xde\xb1\xef\x61\x5a\x45\x33\xf6\x17\x7\x8\x98\x83\x92\xf\x23\x6d\xe6\xaa\x17\x54\xad\x6a\xc8\xdb\x26\xbe\xb8\xb6\x8\xfa\x68\xf1\xd7\x79\x6f\x18\xb4\x9e\x2d\x3f\x1b\x64\xaf\x8d\x6\xe\x49\x28\xe0\x5d\x45\x68\x13\x87\xfa\xde\x40\x7b\xd2\xc3\x94\xd5\xe1\xd9\xc2\xaf\x55\x89\xeb\xb4\x12\x59\xa8\xd4\xc5\x29\x66\x38\xe6\xac\x22\x22\xd9\x64\x9b\x34\xa\x32\x9f\xc2\xbf\x17\x6c\x3f\x71\x7a\x38\x6b\x98\xfb\x49\x36\x89\xc9\xe2\xd6\xc7\x5d\xd0\x69\x5f\x23\x35\xc9\x30\xe2\xfd\x44\x58\x39\xd7\x97\xfb\x5c\x0\xd5\x4f\x7a\x1a\x95\x8b\x62\x4b\xce\xe5\x91\x21\x7b\x30\x0\xd6\xdd\x6d\x2\x86\x49\xf\x3c\x1a\x27\x3c\xd3\xe\x71\xf2\xff\xf5\x2f\x87\xac\x67\x59\x81\xa3\xf7\xf8\xd6\x11\xc\x84\xa9\x3\xee\x2a\xc4\xf3\x22\xab\x7c\xe2\x25\xf5\x67\xa3\xe4\x11\xe0\x59\xb3\xca\x87\xa0\xae\xc9\xa6\x62\x1b\x6e\x4d\x2\x6b\x7\x9d\xfd\xd0\x92\x6\xe1\xb2\x9a\x4a\x1f\x1f\x13\x49\x99\x97\x8\xde\x7f\x98\xaf\x51\x98\xee\x2c\xcb\xf0\xb\xc6\xb6\xb7\x2d\x9a\xb1\xac\xa6\xe3\x15\x77\x9d\x6b\x1a\xe4\xfc\x8b\xf2\x17\x59\x8\x4\x58\x81\x9d\x1b\x1b\x69\x55\xc2\xb4\x3c\x1f\x50\xf1\x7f\x77\x90\x4c\x66\x40\x5a\xc0\x33\x1f\xcb\x5\x6d\x5c\x6\x87\x52\xa2\x8f\x26\xd5\x4f", -+ .ilen = 1024, -+ .result = "\xe5\x26\xa4\x3d\xbd\x33\xd0\x4b\x6f\x5\xa7\x6e\x12\x7a\xd2\x74\xa6\xdd\xbd\x95\xeb\xf9\xa4\xf1\x59\x93\x91\x70\xd9\xfe\x9a\xcd\x53\x1f\x3a\xab\xa6\x7c\x9f\xa6\x9e\xbd\x99\xd9\xb5\x97\x44\xd5\x14\x48\x4d\x9d\xc0\xd0\x5\x96\xeb\x4c\x78\x55\x9\x8\x1\x2\x30\x90\x7b\x96\x7a\x7b\x5f\x30\x41\x24\xce\x68\x61\x49\x86\x57\x82\xdd\x53\x1c\x51\x28\x2b\x53\x6e\x2d\xc2\x20\x4c\xdd\x8f\x65\x10\x20\x50\xdd\x9d\x50\xe5\x71\x40\x53\x69\xfc\x77\x48\x11\xb9\xde\xa4\x8d\x58\xe4\xa6\x1a\x18\x47\x81\x7e\xfc\xdd\xf6\xef\xce\x2f\x43\x68\xd6\x6\xe2\x74\x6a\xad\x90\xf5\x37\xf3\x3d\x82\x69\x40\xe9\x6b\xa7\x3d\xa8\x1e\xd2\x2\x7c\xb7\x9b\xe4\xda\x8f\x95\x6\xc5\xdf\x73\xa3\x20\x9a\x49\xde\x9c\xbc\xee\x14\x3f\x81\x5e\xf8\x3b\x59\x3c\xe1\x68\x12\x5a\x3a\x76\x3a\x3f\xf7\x87\x33\xa\x1\xb8\xd4\xed\xb6\xbe\x94\x5e\x70\x40\x56\x67\x1f\x50\x44\x19\xce\x82\x70\x10\x87\x13\x20\xb\x4c\x5a\xb6\xf6\xa7\xae\x81\x75\x1\x81\xe6\x4b\x57\x7c\xdd\x6d\xf8\x1c\x29\x32\xf7\xda\x3c\x2d\xf8\x9b\x25\x6e\x0\xb4\xf7\x2f\xf7\x4\xf7\xa1\x56\xac\x4f\x1a\x64\xb8\x47\x55\x18\x7b\x7\x4d\xbd\x47\x24\x80\x5d\xa2\x70\xc5\xdd\x8e\x82\xd4\xeb\xec\xb2\xc\x39\xd2\x97\xc1\xcb\xeb\xf4\x77\x59\xb4\x87\xef\xcb\x43\x2d\x46\x54\xd1\xa7\xd7\x15\x99\xa\x43\xa1\xe0\x99\x33\x71\xc1\xed\xfe\x72\x46\x33\x8e\x91\x8\x9f\xc8\x2e\xca\xfa\xdc\x59\xd5\xc3\x76\x84\x9f\xa3\x37\x68\xc3\xf0\x47\x2c\x68\xdb\x5e\xc3\x49\x4c\xe8\x92\x85\xe2\x23\xd3\x3f\xad\x32\xe5\x2b\x82\xd7\x8f\x99\xa\x59\x5c\x45\xd9\xb4\x51\x52\xc2\xae\xbf\x80\xcf\xc9\xc9\x51\x24\x2a\x3b\x3a\x4d\xae\xeb\xbd\x22\xc3\xe\xf\x59\x25\x92\x17\xe9\x74\xc7\x8b\x70\x70\x36\x55\x95\x75\x4b\xad\x61\x2b\x9\xbc\x82\xf2\x6e\x94\x43\xae\xc3\xd5\xcd\x8e\xfe\x5b\x9a\x88\x43\x1\x75\xb2\x23\x9\xf7\x89\x83\xe7\xfa\xf9\xb4\x9b\xf8\xef\xbd\x1c\x92\xc1\xda\x7e\xfe\x5\xba\x5a\xcd\x7\x6a\x78\x9e\x5d\xfb\x11\x2f\x79\x38\xb6\xc2\x5b\x6b\x51\xb4\x71\xdd\xf7\x2a\xe4\xf4\x72\x76\xad\xc2\xdd\x64\x5d\x79\xb6\xf5\x7a\x77\x20\x5\x3d\x30\x6\xd4\x4c\xa\x2c\x98\x5a\xb9\xd4\x98\xa9\x3f\xc6\x12\xea\x3b\x4b\xc5\x79\x64\x63\x6b\x9\x54\x3b\x14\x27\xba\x99\x80\xc8\x72\xa8\x12\x90\x29\xba\x40\x54\x97\x2b\x7b\xfe\xeb\xcd\x1\x5\x44\x72\xdb\x99\xe4\x61\xc9\x69\xd6\xb9\x28\xd1\x5\x3e\xf9\xb\x49\xa\x49\xe9\x8d\xe\xa7\x4a\xf\xaf\x32\xd0\xe0\xb2\x3a\x55\x58\xfe\x5c\x28\x70\x51\x23\xb0\x7b\x6a\x5f\x1e\xb8\x17\xd7\x94\x15\x8f\xee\x20\xc7\x42\x25\x3e\x9a\x14\xd7\x60\x72\x39\x47\x48\xa9\xfe\xdd\x47\xa\xb1\xe6\x60\x28\x8c\x11\x68\xe1\xff\xd7\xce\xc8\xbe\xb3\xfe\x27\x30\x9\x70\xd7\xfa\x2\x33\x3a\x61\x2e\xc7\xff\xa4\x2a\xa8\x6e\xb4\x79\x35\x6d\x4c\x1e\x38\xf8\xee\xd4\x84\x4e\x6e\x28\xa7\xce\xc8\xc1\xcf\x80\x5\xf3\x4\xef\xc8\x18\x28\x2e\x8d\x5e\xc\xdf\xb8\x5f\x96\xe8\xc6\x9c\x2f\xe5\xa6\x44\xd7\xe7\x99\x44\xc\xec\xd7\x5\x60\x97\xbb\x74\x77\x58\xd5\xbb\x48\xde\x5a\xb2\x54\x7f\xe\x46\x70\x6a\x6f\x78\xa5\x8\x89\x5\x4e\x7e\xa0\x69\xb4\x40\x60\x55\x77\x75\x9b\x19\xf2\xd5\x13\x80\x77\xf9\x4b\x3f\x1e\xee\xe6\x76\x84\x7b\x8c\xe5\x27\xa8\xa\x91\x1\x68\x71\x8a\x3f\x6\xab\xf6\xa9\xa5\xe6\x72\x92\xe4\x67\xe2\xa2\x46\x35\x84\x55\x7d\xca\xa8\x85\xd0\xf1\x3f\xbe\xd7\x34\x64\xfc\xae\xe3\xe4\x4\x9f\x66\x2\xb9\x88\x10\xd9\xc4\x4c\x31\x43\x7a\x93\xe2\x9b\x56\x43\x84\xdc\xdc\xde\x1d\xa4\x2\xe\xc2\xef\xc3\xf8\x78\xd1\xb2\x6b\x63\x18\xc9\xa9\xe5\x72\xd8\xf3\xb9\xd1\x8a\xc7\x1a\x2\x27\x20\x77\x10\xe5\xc8\xd4\x4a\x47\xe5\xdf\x5f\x1\xaa\xb0\xd4\x10\xbb\x69\xe3\x36\xc8\xe1\x3d\x43\xfb\x86\xcd\xcc\xbf\xf4\x88\xe0\x20\xca\xb7\x1b\xf1\x2f\x5c\xee\xd4\xd3\xa3\xcc\xa4\x1e\x1c\x47\xfb\xbf\xfc\xa2\x41\x55\x9d\xf6\x5a\x5e\x65\x32\x34\x7b\x52\x8d\xd5\xd0\x20\x60\x3\xab\x3f\x8c\xd4\x21\xea\x2a\xd9\xc4\xd0\xd3\x65\xd8\x7a\x13\x28\x62\x32\x4b\x2c\x87\x93\xa8\xb4\x52\x45\x9\x44\xec\xec\xc3\x17\xdb\x9a\x4d\x5c\xa9\x11\xd4\x7d\xaf\x9e\xf1\x2d\xb2\x66\xc5\x1d\xed\xb7\xcd\xb\x25\x5e\x30\x47\x3f\x40\xf4\xa1\xa0\x0\x94\x10\xc5\x6a\x63\x1a\xd5\x88\x92\x8e\x82\x39\x87\x3c\x78\x65\x58\x42\x75\x5b\xdd\x77\x3e\x9\x4e\x76\x5b\xe6\xe\x4d\x38\xb2\xc0\xb8\x95\x1\x7a\x10\xe0\xfb\x7\xf2\xab\x2d\x8c\x32\xed\x2b\xc0\x46\xc2\xf5\x38\x83\xf0\x17\xec\xc1\x20\x6a\x9a\xb\x0\xa0\x98\x22\x50\x23\xd5\x80\x6b\xf6\x1f\xc3\xcc\x97\xc9\x24\x9f\xf3\xaf\x43\x14\xd5\xa0" -+}, { -+ .key = "\x35\x4e\xb5\x70\x50\x42\x8a\x85\xf2\xfb\xed\x7b\xd0\x9e\x97\xca\xfa\x98\x66\x63\xee\x37\xcc\x52\xfe\xd1\xdf\x95\x15\x34\x29\x38", -+ .nonce = "\xfd\x87\xd4\xd8\x62\xfd\xec\xaa", -+ .assoc = "\xd6\x31\xda\x5d\x42\x5e\xd7", -+ .alen = 7, -+ .input = "\x7a\x57\xf2\xc7\x6\x3f\x50\x7b\x36\x1a\x66\x5c\xb9\xe\x5e\x3b\x45\x60\xbe\x9a\x31\x9f\xff\x5d\x66\x34\xb4\xdc\xfb\x9d\x8e\xee\x6a\x33\xa4\x7\x3c\xf9\x4c\x30\xa1\x24\x52\xf9\x50\x46\x88\x20\x2\x32\x3a\xe\x99\x63\xaf\x1f\x15\x28\x2a\x5\xff\x57\x59\x5e\x18\xa1\x1f\xd0\x92\x5c\x88\x66\x1b\x0\x64\xa5\x93\x8d\x6\x46\xb0\x64\x8b\x8b\xef\x99\x5\x35\x85\xb3\xf3\x33\xbb\xec\x66\xb6\x3d\x57\x42\xe3\xb4\xc6\xaa\xb0\x41\x2a\xb9\x59\xa9\xf6\x3e\x15\x26\x12\x3\x21\x4c\x74\x43\x13\x2a\x3\x27\x9\xb4\xfb\xe7\xb7\x40\xff\x5e\xce\x48\x9a\x60\xe3\x8b\x80\x8c\x38\x2d\xcb\x93\x37\x74\x5\x52\x6f\x73\x3e\xc3\xbc\xca\x72\xa\xeb\xf1\x3b\xa0\x95\xdc\x8a\xc4\xa9\xdc\xca\x44\xd8\x8\x63\x6a\x36\xd3\x3c\xb8\xac\x46\x7d\xfd\xaa\xeb\x3e\xf\x45\x8f\x49\xda\x2b\xf2\x12\xbd\xaf\x67\x8a\x63\x48\x4b\x55\x5f\x6d\x8c\xb9\x76\x34\x84\xae\xc2\xfc\x52\x64\x82\xf7\xb0\x6\xf0\x45\x73\x12\x50\x30\x72\xea\x78\x9a\xa8\xaf\xb5\xe3\xbb\x77\x52\xec\x59\x84\xbf\x6b\x8f\xce\x86\x5e\x1f\x23\xe9\xfb\x8\x86\xf7\x10\xb9\xf2\x44\x96\x44\x63\xa9\xa8\x78\x0\x23\xd6\xc7\xe7\x6e\x66\x4f\xcc\xee\x15\xb3\xbd\x1d\xa0\xe5\x9c\x1b\x24\x2c\x4d\x3c\x62\x35\x9c\x88\x59\x9\xdd\x82\x1b\xcf\xa\x83\x6b\x3f\xae\x3\xc4\xb4\xdd\x7e\x5b\x28\x76\x25\x96\xd9\xc9\x9d\x5f\x86\xfa\xf6\xd7\xd2\xe6\x76\x1d\xf\xa1\xdc\x74\x5\x1b\x1d\xe0\xcd\x16\xb0\xa8\x8a\x34\x7b\x15\x11\x77\xe5\x7b\x7e\x20\xf7\xda\x38\xda\xce\x70\xe9\xf5\x6c\xd9\xbe\xc\x4c\x95\x4c\xc2\x9b\x34\x55\x55\xe1\xf3\x46\x8e\x48\x74\x14\x4f\x9d\xc9\xf5\xe8\x1a\xf0\x11\x4a\xc1\x8d\xe0\x93\xa0\xbe\x9\x1c\x2b\x4e\xf\xb2\x87\x8b\x84\xfe\x92\x32\x14\xd7\x93\xdf\xe7\x44\xbc\xc5\xae\x53\x69\xd8\xb3\x79\x37\x80\xe3\x17\x5c\xec\x53\x0\x9a\xe3\x8e\xdc\x38\xb8\x66\xf0\xd3\xad\x1d\x2\x96\x86\x3e\x9d\x3b\x5d\xa5\x7f\x21\x10\xf1\x1f\x13\x20\xf9\x57\x87\x20\xf5\x5f\xf1\x17\x48\xa\x51\x5a\xcd\x19\x3\xa6\x5a\xd1\x12\x97\xe9\x48\xe2\x1d\x83\x75\x50\xd9\x75\x7d\x6a\x82\xa1\xf9\x4e\x54\x87\x89\xc9\xc\xb7\x5b\x6a\x91\xc1\x9c\xb2\xa9\xdc\x9a\xa4\x49\xa\x6d\xd\xbb\xde\x86\x44\xdd\x5d\x89\x2b\x96\xf\x23\x95\xad\xcc\xa2\xb3\xb9\x7e\x74\x38\xba\x9f\x73\xae\x5f\xf8\x68\xa2\xe0\xa9\xce\xbd\x40\xd4\x4c\x6b\xd2\x56\x62\xb0\xcc\x63\x7e\x5b\xd3\xae\xd1\x75\xce\xbb\xb4\x5b\xa8\xf8\xb4\xac\x71\x75\xaa\xc9\x9f\xbb\x6c\xad\xf\x55\x5d\xe8\x85\x7d\xf9\x21\x35\xea\x92\x85\x2b\x0\xec\x84\x90\xa\x63\x96\xe4\x6b\xa9\x77\xb8\x91\xf8\x46\x15\x72\x63\x70\x1\x40\xa3\xa5\x76\x62\x2b\xbf\xf1\xe5\x8d\x9f\xa3\xfa\x9b\x3\xbe\xfe\x65\x6f\xa2\x29\xd\x54\xb4\x71\xce\xa9\xd6\x3d\x88\xf9\xaf\x6b\xa8\x9e\xf4\x16\x96\x36\xb9\x0\xdc\x10\xab\xb5\x8\x31\x1f\x0\xb1\x3c\xd9\x38\x3e\xc6\x4\xa7\x4e\xe8\xae\xed\x98\xc2\xf7\xb9\x0\x5f\x8c\x60\xd1\xe5\x15\xf7\xae\x1e\x84\x88\xd1\xf6\xbc\x3a\x89\x35\x22\x83\x7c\xca\xf0\x33\x82\x4c\x79\x3c\xfd\xb1\xae\x52\x62\x55\xd2\x41\x60\xc6\xbb\xfa\xe\x59\xd6\xa8\xfe\x5d\xed\x47\x3d\xe0\xea\x1f\x6e\x43\x51\xec\x10\x52\x56\x77\x42\x6b\x52\x87\xd8\xec\xe0\xaa\x76\xa5\x84\x2a\x22\x24\xfd\x92\x40\x88\xd5\x85\x1c\x1f\x6b\x47\xa0\xc4\xe4\xef\xf4\xea\xd7\x59\xac\x2a\x9e\x8c\xfa\x1f\x42\x8\xfe\x4f\x74\xa0\x26\xf5\xb3\x84\xf6\x58\x5f\x26\x66\x3e\xd7\xe4\x22\x91\x13\xc8\xac\x25\x96\x23\xd8\x9\xea\x45\x75\x23\xb8\x5f\xc2\x90\x8b\x9\xc4\xfc\x47\x6c\x6d\xa\xef\x69\xa4\x38\x19\xcf\x7d\xf9\x9\x73\x9b\x60\x5a\xf7\x37\xb5\xfe\x9f\xe3\x2b\x4c\xd\x6e\x19\xf1\xd6\xc0\x70\xf3\x9d\x22\x3c\xf9\x49\xce\x30\x8e\x44\xb5\x76\x15\x8f\x52\xfd\xa5\x4\xb8\x55\x6a\x36\x59\x7c\xc4\x48\xb8\xd7\xab\x5\x66\xe9\x5e\x21\x6f\x6b\x36\x29\xbb\xe9\xe3\xa2\x9a\xa8\xcd\x55\x25\x11\xba\x5a\x58\xa0\xde\xae\x19\x2a\x48\x5a\xff\x36\xcd\x6d\x16\x7a\x73\x38\x46\xe5\x47\x59\xc8\xa2\xf6\xe2\x6c\x83\xc5\x36\x2c\x83\x7d\xb4\x1\x5\x69\xe7\xaf\x5c\xc4\x64\x82\x12\x21\xef\xf7\xd1\x7d\xb8\x8d\x8c\x98\x7c\x5f\x7d\x92\x88\xb9\x94\x7\x9c\xd8\xe9\x9c\x17\x38\xe3\x57\x6c\xe0\xdc\xa5\x92\x42\xb3\xbd\x50\xa2\x7e\xb5\xb1\x52\x72\x3\x97\xd8\xaa\x9a\x1e\x75\x41\x11\xa3\x4f\xcc\xd4\xe3\x73\xad\x96\xdc\x47\x41\x9f\xb0\xbe\x79\x91\xf5\xb6\x18\xfe\xc2\x83\x18\x7d\x73\xd9\x4f\x83\x84\x3\xb3\xf0\x77\x66\x3d\x83\x63\x2e\x2c\xf9\xdd\xa6\x1f\x89\x82\xb8\x23\x42\xeb\xe2\xca\x70\x82\x61\x41\xa\x6d\x5f\x75\xc5\xe2\xc4\x91\x18\x44\x22\xfa\x34\x10\xf5\x20\xdc\xb7\xdd\x2a\x20\x77\xf5\xf9\xce\xdb\xa0\xa\x52\x2a\x4e\xdd\xcc\x97\xdf\x5\xe4\x5e\xb7\xaa\xf0\xe2\x80\xff\xba\x1a\xf\xac\xdf\x2\x32\xe6\xf7\xc7\x17\x13\xb7\xfc\x98\x48\x8c\xd\x82\xc9\x80\x7a\xe2\xa\xc5\xb4\xde\x7c\x3c\x79\x81\xe\x28\x65\x79\x67\x82\x69\x44\x66\x9\xf7\x16\x1a\xf9\x7d\x80\xa1\x79\x14\xa9\xc8\x20\xfb\xa2\x46\xbe\x8\x35\x17\x58\xc1\x1a\xda\x2a\x6b\x2e\x1e\xe6\x27\x55\x7b\x19\xe2\xfb\x64\xfc\x5e\x15\x54\x3c\xe7\xc2\x11\x50\x30\xb8\x72\x3\xb\x1a\x9f\x86\x27\x11\x5c\x6\x2b\xbd\x75\x1a\xa\xda\x1\xfa\x5c\x4a\xc1\x80\x3a\x6e\x30\xc8\x2c\xeb\x56\xec\x89\xfa\x35\x7b\xb2\xf0\x97\x8\x86\x53\xbe\xbd\x40\x41\x38\x1c\xb4\x8b\x79\x2e\x18\x96\x94\xde\xe8\xca\xe5\x9f\x92\x9f\x15\x5d\x56\x60\x5c\x9\xf9\x16\xf4\x17\xf\xf6\x4c\xda\xe6\x67\x89\x9f\xca\x6c\xe7\x9b\x4\x62\xe\x26\xa6\x52\xbd\x29\xff\xc7\xa4\x96\xe6\x6a\x2\xa5\x2e\x7b\xfe\x97\x68\x3e\x2e\x5f\x3b\xf\x36\xd6\x98\x19\x59\x48\xd2\xc6\xe1\x55\x1a\x6e\xd6\xed\x2c\xba\xc3\x9e\x64\xc9\x95\x86\x35\x5e\x3e\x88\x69\x99\x4b\xee\xbe\x9a\x99\xb5\x6e\x58\xae\xdd\x22\xdb\xdd\x6b\xfc\xaf\x90\xa3\x3d\xa4\xc1\x15\x92\x18\x8d\xd2\x4b\x7b\x6\xd1\x37\xb5\xe2\x7c\x2c\xf0\x25\xe4\x94\x2a\xbd\xe3\x82\x70\x78\xa3\x82\x10\x5a\x90\xd7\xa4\xfa\xaf\x1a\x88\x59\xdc\x74\x12\xb4\x8e\xd7\x19\x46\xf4\x84\x69\x9f\xbb\x70\xa8\x4c\x52\x81\xa9\xff\x76\x1c\xae\xd8\x11\x3d\x7f\x7d\xc5\x12\x59\x28\x18\xc2\xa2\xb7\x1c\x88\xf8\xd6\x1b\xa6\x7d\x9e\xde\x29\xf8\xed\xff\xeb\x92\x24\x4f\x5\xaa\xd9\x49\xba\x87\x59\x51\xc9\x20\x5c\x9b\x74\xcf\x3\xd9\x2d\x34\xc7\x5b\xa5\x40\xb2\x99\xf5\xcb\xb4\xf6\xb7\x72\x4a\xd6\xbd\xb0\xf3\x93\xe0\x1b\xa8\x4\x1e\x35\xd4\x80\x20\xf4\x9c\x31\x6b\x45\xb9\x15\xb0\x5e\xdd\xa\x33\x9c\x83\xcd\x58\x89\x50\x56\xbb\x81\x0\x91\x32\xf3\x1b\x3e\xcf\x45\xe1\xf9\xe1\x2c\x26\x78\x93\x9a\x60\x46\xc9\xb5\x5e\x6a\x28\x92\x87\x3f\x63\x7b\xdb\xf7\xd0\x13\x9d\x32\x40\x5e\xcf\xfb\x79\x68\x47\x4c\xfd\x1\x17\xe6\x97\x93\x78\xbb\xa6\x27\xa3\xe8\x1a\xe8\x94\x55\x7d\x8\xe5\xdc\x66\xa3\x69\xc8\xca\xc5\xa1\x84\x55\xde\x8\x91\x16\x3a\xc\x86\xab\x27\x2b\x64\x34\x2\x6c\x76\x8b\xc6\xaf\xcc\xe1\xd6\x8c\x2a\x18\x3d\xa6\x1b\x37\x75\x45\x73\xc2\x75\xd7\x53\x78\x3a\xd6\xe8\x29\xd2\x4a\xa8\x1e\x82\xf6\xb6\x81\xde\x21\xed\x2b\x56\xbb\xf2\xd0\x57\xc1\x7c\xd2\x6a\xd2\x56\xf5\x13\x5f\x1c\x6a\xb\x74\xfb\xe9\xfe\x9e\xea\x95\xb2\x46\xab\xa\xfc\xfd\xf3\xbb\x4\x2b\x76\x1b\xa4\x74\xb0\xc1\x78\xc3\x69\xe2\xb0\x1\xe1\xde\x32\x4c\x8d\x1a\xb3\x38\x8\xd5\xfc\x1f\xdc\xe\x2c\x9c\xb1\xa1\x63\x17\x22\xf5\x6c\x93\x70\x74\x0\xf8\x39\x1\x94\xd1\x32\x23\x56\x5d\xa6\x2\x76\x76\x93\xce\x2f\x19\xe9\x17\x52\xae\x6e\x2c\x6d\x61\x7f\x3b\xaa\xe0\x52\x85\xc5\x65\xc1\xbb\x8e\x5b\x21\xd5\xc9\x78\x83\x7\x97\x4c\x62\x61\x41\xd4\xfc\xc9\x39\xe3\x9b\xd0\xcc\x75\xc4\x97\xe6\xdd\x2a\x5f\xa6\xe8\x59\x6c\x98\xb9\x2\xe2\xa2\xd6\x68\xee\x3b\x1d\xe3\x4d\x5b\x30\xef\x3\xf2\xeb\x18\x57\x36\xe8\xa1\xf4\x47\xfb\xcb\x8f\xcb\xc8\xf3\x4f\x74\x9d\x9d\xb1\x8d\x14\x44\xd9\x19\xb4\x54\x4f\x75\x19\x9\xa0\x75\xbc\x3b\x82\xc6\x3f\xb8\x83\x19\x6e\xd6\x37\xfe\x6e\x8a\x4e\xe0\x4a\xab\x7b\xc8\xb4\x1d\xf4\xed\x27\x3\x65\xa2\xa1\xae\x11\xe7\x98\x78\x48\x91\xd2\xd2\xd4\x23\x78\x50\xb1\x5b\x85\x10\x8d\xca\x5f\xf\x71\xae\x72\x9a\xf6\x25\x19\x60\x6\xf7\x10\x34\x18\xd\xc9\x9f\x7b\xc\x9b\x8f\x91\x1b\x9f\xcd\x10\xee\x75\xf9\x97\x66\xfc\x4d\x33\x6e\x28\x2b\x92\x85\x4f\xab\x43\x8d\x8f\x7d\x86\xa7\xc7\xd8\xd3\xb\x8b\x57\xb6\x1d\x95\xd\xe9\xbc\xd9\x3\xd9\x10\x19\xc3\x46\x63\x55\x87\x61\x79\x6c\x95\xe\x9c\xdd\xca\xc3\xf3\x64\xf0\x7d\x76\xb7\x53\x67\x2b\x1e\x44\x56\x81\xea\x8f\x5c\x42\x16\xb8\x28\xeb\x1b\x61\x10\x1e\xbf\xec\xa8", -+ .ilen = 1933, -+ .result = "\x6a\xfc\x4b\x25\xdf\xc0\xe4\xe8\x17\x4d\x4c\xc9\x7e\xde\x3a\xcc\x3c\xba\x6a\x77\x47\xdb\xe3\x74\x7a\x4d\x5f\x8d\x37\x55\x80\x73\x90\x66\x5d\x3a\x7d\x5d\x86\x5e\x8d\xfd\x83\xff\x4e\x74\x6f\xf9\xe6\x70\x17\x70\x3e\x96\xa7\x7e\xcb\xab\x8f\x58\x24\x9b\x1\xfd\xcb\xe6\x4d\x9b\xf0\x88\x94\x57\x66\xef\x72\x4c\x42\x6e\x16\x19\x15\xea\x70\x5b\xac\x13\xdb\x9f\x18\xe2\x3c\x26\x97\xbc\xdc\x45\x8c\x6c\x24\x69\x9c\xf7\x65\x1e\x18\x59\x31\x7c\xe4\x73\xbc\x39\x62\xc6\x5c\x9f\xbf\xfa\x90\x3\xc9\x72\x26\xb6\x1b\xc2\xb7\x3f\xf2\x13\x77\xf2\x8d\xb9\x47\xd0\x53\xdd\xc8\x91\x83\x8b\xb1\xce\xa3\xfe\xcd\xd9\xdd\x92\x7b\xdb\xb8\xfb\xc9\x2d\x1\x59\x39\x52\xad\x1b\xec\xcf\xd7\x70\x13\x21\xf5\x47\xaa\x18\x21\x5c\xc9\x9a\xd2\x6b\x5\x9c\x1\xa1\xda\x35\x5d\xb3\x70\xe6\xa9\x80\x8b\x91\xb7\xb3\x5f\x24\x9a\xb7\xd1\x6b\xa1\x1c\x50\xba\x49\xe0\xee\x2e\x75\xac\x69\xc0\xeb\x3\xdd\x19\xe5\xf6\x6\xdd\xc3\xd7\x2b\x7\x7\x30\xa7\x19\xc\xbf\xe6\x18\xcc\xb1\x1\x11\x85\x77\x1d\x96\xa7\xa3\x0\x84\x2\xa2\x83\x68\xda\x17\x27\xc8\x7f\x23\xb7\xf4\x13\x85\xcf\xdd\x7a\x7d\x24\x57\xfe\x5\x93\xf5\x74\xce\xed\xc\x20\x98\x8d\x92\x30\xa1\x29\x23\x1a\xa0\x4f\x69\x56\x4c\xe1\xc8\xce\xf6\x9a\xc\xa4\xfa\x4\xf6\x62\x95\xf2\xfa\xc7\x40\x68\x40\x8f\x41\xda\xb4\x26\x6f\x70\xab\x40\x61\xa4\xe\x75\xfb\x86\xeb\x9d\x9a\x1f\xec\x76\x99\xe7\xea\xaa\x1e\x2d\xb5\xd4\xa6\x1a\xb8\x61\xa\x1d\x16\x5b\x98\xc2\x31\x40\xe7\x23\x1d\x66\x99\xc8\xc0\xd7\xce\xf3\x57\x40\x4\x3f\xfc\xea\xb3\xfc\xd2\xd3\x99\xa4\x94\x69\xa0\xef\xd1\x85\xb3\xa6\xb1\x28\xbf\x94\x67\x22\xc3\x36\x46\xf8\xd2\xf\x5f\xf4\x59\x80\xe6\x2d\x43\x8\x7d\x19\x9\x97\xa7\x4c\x3d\x8d\xba\x65\x62\xa3\x71\x33\x29\x62\xdb\xc1\x33\x34\x1a\x63\x33\x16\xb6\x64\x7e\xab\x33\xf0\xe6\x26\x68\xba\x1d\x2e\x38\x8\xe6\x2\xd3\x25\x2c\x47\x23\x58\x34\xf\x9d\x63\x4f\x63\xbb\x7f\x3b\x34\x38\xa7\xb5\x8d\x65\xd9\x9f\x79\x55\x3e\x4d\xe7\x73\xd8\xf6\x98\x97\x84\x60\x9c\xc8\xa9\x3c\xf6\xdc\x12\x5c\xe1\xbb\xb\x8b\x98\x9c\x9d\x26\x7c\x4a\xe6\x46\x36\x58\x21\x4a\xee\xca\xd7\x3b\xc2\x6c\x49\x2f\xe5\xd5\x3\x59\x84\x53\xcb\xfe\x92\x71\x2e\x7c\x21\xcc\x99\x85\x7f\xb8\x74\x90\x13\x42\x3f\xe0\x6b\x1d\xf2\x4d\x54\xd4\xfc\x3a\x5\xe6\x74\xaf\xa6\xa0\x2a\x20\x23\x5d\x34\x5c\xd9\x3e\x4e\xfa\x93\xe7\xaa\xe9\x6f\x8\x43\x67\x41\xc5\xad\xfb\x31\x95\x82\x73\x32\xd8\xa6\xa3\xed\xe\x2d\xf6\x5f\xfd\x80\xa6\x7a\xe0\xdf\x78\x15\x29\x74\x33\xd0\x9e\x83\x86\x72\x22\x57\x29\xb9\x9e\x5d\xd3\x1a\xb5\x96\x72\x41\x3d\xf1\x64\x43\x67\xee\xaa\x5c\xd3\x9a\x96\x13\x11\x5d\xf3\xc\x87\x82\x1e\x41\x9e\xd0\x27\xd7\x54\x3b\x67\x73\x9\x91\xe9\xd5\x36\xa7\xb5\x55\xe4\xf3\x21\x51\x49\x22\x7\x55\x4f\x44\x4b\xd2\x15\x93\x17\x2a\xfa\x4d\x4a\x57\xdb\x4c\xa6\xeb\xec\x53\x25\x6c\x21\xed\x0\x4c\x3b\xca\x14\x57\xa9\xd6\x6a\xcd\x8d\x5e\x74\xac\x72\xc1\x97\xe5\x1b\x45\x4e\xda\xfc\xcc\x40\xe8\x48\x88\xb\xa3\xe3\x8d\x83\x42\xc3\x23\xfd\x68\xb5\x8e\xf1\x9d\x63\x77\xe9\xa3\x8e\x8c\x26\x6b\xbd\x72\x73\x35\xc\x3\xf8\x43\x78\x52\x71\x15\x1f\x71\x5d\x6e\xed\xb9\xcc\x86\x30\xdb\x2b\xd3\x82\x88\x23\x71\x90\x53\x5c\xa9\x2f\x76\x1\xb7\x9a\xfe\x43\x55\xa3\x4\x9b\xe\xe4\x59\xdf\xc9\xe9\xb1\xea\x29\x28\x3c\x5c\xae\x72\x84\xb6\xc6\xeb\xc\x27\x7\x74\x90\xd\x31\xb0\x0\x77\xe9\x40\x70\x6f\x68\xa7\xfd\x6\xec\x4b\xc0\xb7\xac\xbc\x33\xb7\x6d\xa\xbd\x12\x1b\x59\xcb\xdd\x32\xf5\x1d\x94\x57\x76\x9e\xc\x18\x98\x71\xd7\x2a\xdb\xb\x7b\xa7\x71\xb7\x67\x81\x23\x96\xae\xb9\x7e\x32\x43\x92\x8a\x19\xa0\xc4\xd4\x3b\x57\xf9\x4a\x2c\xfb\x51\x46\xbb\xcb\x5d\xb3\xef\x13\x93\x6e\x68\x42\x54\x57\xd3\x6a\x3a\x8f\x9d\x66\xbf\xbd\x36\x23\xf5\x93\x83\x7b\x9c\xc0\xdd\xc5\x49\xc0\x64\xed\x7\x12\xb3\xe6\xe4\xe5\x38\x95\x23\xb1\xa0\x3b\x1a\x61\xda\x17\xac\xc3\x58\xdd\x74\x64\x22\x11\xe8\x32\x1d\x16\x93\x85\x99\xa5\x9c\x34\x55\xb1\xe9\x20\x72\xc9\x28\x7b\x79\x0\xa1\xa6\xa3\x27\x40\x18\x8a\x54\xe0\xcc\xe8\x4e\x8e\x43\x96\xe7\x3f\xc8\xe9\xb2\xf9\xc9\xda\x4\x71\x50\x47\xe4\xaa\xce\xa2\x30\xc8\xe4\xac\xc7\xd\x6\x2e\xe6\xe8\x80\x36\x29\x9e\x1\xb8\xc3\xf0\xa0\x5d\x7a\xca\x4d\xa0\x57\xbd\x2a\x45\xa7\x7f\x9c\x93\x7\x8f\x35\x67\x92\xe3\xe9\x7f\xa8\x61\x43\x9e\x25\x4f\x33\x76\x13\x6e\x12\xb9\xdd\xa4\x7c\x8\x9f\x7c\xe7\xa\x8d\x84\x6\xa4\x33\x17\x34\x5e\x10\x7c\xc0\xa8\x3d\x1f\x42\x20\x51\x65\x5d\x9\xc3\xaa\xc0\xc8\xd\xf0\x79\xbc\x20\x1b\x95\xe7\x6\x7d\x47\x20\x3\x1a\x74\xdd\xe2\xd4\xae\x38\x71\x9b\xf5\x80\xec\x8\x4e\x56\xba\x76\x12\x1a\xdf\x48\xf3\xae\xb3\xe6\xe6\xbe\xc0\x91\x2e\x1\xb3\x1\x86\xa2\xb9\x52\xd1\x21\xae\xd4\x97\x1d\xef\x41\x12\x95\x3d\x48\x45\x1c\x56\x32\x8f\xb8\x43\xbb\x19\xf3\xca\xe9\xeb\x6d\x84\xbe\x86\x6\xe2\x36\xb2\x62\x9d\xd3\x4c\x48\x18\x54\x13\x4e\xcf\xfd\xba\x84\xb9\x30\x53\xcf\xfb\xb9\x29\x8f\xdc\x9f\xef\x60\xb\x64\xf6\x8b\xee\xa6\x91\xc2\x41\x6c\xf6\xfa\x79\x67\x4b\xc1\x3f\xaf\x9\x81\xd4\x5d\xcb\x9\xdf\x36\x31\xc0\x14\x3c\x7c\xe\x65\x95\x99\x6d\xa3\xf4\xd7\x38\xee\x1a\x2b\x37\xe2\xa4\x3b\x4b\xd0\x65\xca\xf8\xc3\xe8\x15\x20\xef\xf2\x0\xfd\x1\x9\xc5\xc8\x17\x4\x93\xd0\x93\x3\x55\xc5\xfe\x32\xa3\x3e\x28\x2d\x3b\x93\x8a\xcc\x7\x72\x80\x8b\x74\x16\x24\xbb\xda\x94\x39\x30\x8f\xb1\xcd\x4a\x90\x92\x7c\x14\x8f\x95\x4e\xac\x9b\xd8\x8f\x1a\x87\xa4\x32\x27\x8a\xba\xf7\x41\xcf\x84\x37\x19\xe6\x6\xf5\xe\xcf\x36\xf5\x9e\x6c\xde\xbc\xff\x64\x7e\x4e\x59\x57\x48\xfe\x14\xf7\x9c\x93\x5d\x15\xad\xcc\x11\xb1\x17\x18\xb2\x7e\xcc\xab\xe9\xce\x7d\x77\x5b\x51\x1b\x1e\x20\xa8\x32\x6\xe\x75\x93\xac\xdb\x35\x37\x1f\xe9\x19\x1d\xb4\x71\x97\xd6\x4e\x2c\x8\xa5\x13\xf9\xe\x7e\x78\x6e\x14\xe0\xa9\xb9\x96\x4c\x80\x82\xba\x17\xb3\x9d\x69\xb0\x84\x46\xff\xf9\x52\x79\x94\x58\x3a\x62\x90\x15\x35\x71\x10\x37\xed\xa1\x8e\x53\x6e\xf4\x26\x57\x93\x15\x93\xf6\x81\x2c\x5a\x10\xda\x92\xad\x2f\xdb\x28\x31\x2d\x55\x4\xd2\x6\x28\x8c\x1e\xdc\xea\x54\xac\xff\xb7\x6c\x30\x15\xd4\xb4\xd\x0\x93\x57\xdd\xd2\x7\x7\x6\xd9\x43\x9b\xcd\x3a\xf4\x7d\x4c\x36\x5d\x23\xa2\xcc\x57\x40\x91\xe9\x2c\x2f\x2c\xd5\x30\x9b\x17\xb0\xc9\xf7\xa7\x2f\xd1\x93\x20\x6b\xc6\xc1\xe4\x6f\xcb\xd1\xe7\x9\xf\x9e\xdc\xaa\x9f\x2f\xdf\x56\x9f\xd4\x33\x4\xaf\xd3\x6c\x58\x61\xf0\x30\xec\xf2\x7f\xf2\x9c\xdf\x39\xbb\x6f\xa2\x8c\x7e\xc4\x22\x51\x71\xc0\x4d\x14\x1a\xc4\xcd\x4\xd9\x87\x8\x50\x5\xcc\xaf\xf6\xf0\x8f\x92\x54\x58\xc2\xc7\x9\x7a\x59\x2\x5\xe8\xb0\x86\xd9\xbf\x7b\x35\x51\x4d\xaf\x8\x97\x2c\x65\xda\x2a\x71\x3a\xa8\x51\xcc\xf2\x73\x27\xc3\xfd\x62\xcf\xe3\xb2\xca\xcb\xbe\x1a\xa\xa1\x34\x7b\x77\xc4\x62\x68\x78\x5f\x94\x7\x4\x65\x16\x4b\x61\xcb\xff\x75\x26\x50\x66\x1f\x6e\x93\xf8\xc5\x51\xeb\xa4\x4a\x48\x68\x6b\xe2\x5e\x44\xb2\x50\x2c\x6c\xae\x79\x4e\x66\x35\x81\x50\xac\xbc\x3f\xb1\xc\xf3\x5\x3c\x4a\xa3\x6c\x2a\x79\xb4\xb7\xab\xca\xc7\x9b\x8e\xcd\x5f\x11\x3\xcb\x30\xa3\xab\xda\xfe\x64\xb9\xbb\xd8\x5e\x3a\x1a\x56\xe5\x5\x48\x90\x1e\x61\x69\x1b\x22\xe6\x1a\x3c\x75\xad\x1f\x37\x28\xdc\xe4\x6d\xbd\x42\xdc\xd3\xc8\xb6\x1c\x48\xfe\x94\x77\x7f\xbd\x62\xac\xa3\x47\x27\xcf\x5f\xd9\xdb\xaf\xec\xf7\x5e\xc1\xb0\x9d\x1\x26\x99\x7e\x8f\x3\x70\xb5\x42\xbe\x67\x28\x1b\x7c\xbd\x61\x21\x97\xcc\x5c\xe1\x97\x8f\x8d\xde\x2b\xaa\xa7\x71\x1d\x1e\x2\x73\x70\x58\x32\x5b\x1d\x67\x3d\xe0\x74\x4f\x3\xf2\x70\x51\x79\xf1\x61\x70\x15\x74\x9d\x23\x89\xde\xac\xfd\xde\xd0\x1f\xc3\x87\x44\x35\x4b\xe5\xb0\x60\xc5\x22\xe4\x9e\xca\xeb\xd5\x3a\x9\x45\xa4\xdb\xfa\x3f\xeb\x1b\xc7\xc8\x14\x99\x51\x92\x10\xed\xed\x28\xe0\xa1\xf8\x26\xcf\xcd\xcb\x63\xa1\x3b\xe3\xdf\x7e\xfe\xa6\xf0\x81\x9a\xbf\x55\xde\x54\xd5\x56\x60\x98\x10\x68\xf4\x38\x96\x8e\x6f\x1d\x44\x7f\xd6\x2f\xfe\x55\xfb\xc\x7e\x67\xe2\x61\x44\xed\xf2\x35\x30\x5d\xe9\xc7\xd6\x6d\xe0\xa0\xed\xf3\xfc\xd8\x3e\xa\x7b\xcd\xaf\x65\x68\x18\xc0\xec\x4\x1c\x74\x6d\xe2\x6e\x79\xd4\x11\x2b\x62\xd5\x27\xad\x4f\x1\x59\x73\xcc\x6a\x53\xfb\x2d\xd5\x4e\x99\x21\x65\x4d\xf5\x82\xf7\xd8\x42\xce\x6f\x3d\x36\x47\xf1\x5\x16\xe8\x1b\x6a\x8f\x93\xf2\x8f\x37\x40\x12\x28\xa3\xe6\xb9\x17\x4a\x1f\xb1\xd1\x66\x69\x86\xc4\xfc\x97\xae\x3f\x8f\x1e\x2b\xdf\xcd\xf9\x3c" -+}, { -+ .key = "\xb3\x35\x50\x3\x54\x2e\x40\x5e\x8f\x59\x8e\xc5\x90\xd5\x27\x2d\xba\x29\x2e\xcb\x1b\x70\x44\x1e\x65\x91\x6e\x2a\x79\x22\xda\x64", -+ .nonce = "\x5\xa3\x93\xed\x30\xc5\xa2\x6", -+ .assoc = "\xb1\x69\x83\x87\x30\xaa\x5d\xb8\x77\xe8\x21\xff\x6\x59\x35\xce\x75\xfe\x38\xef\xb8\x91\x43\x8c\xcf\x70\xdd\xa\x68\xbf\xd4\xbc\x16\x76\x99\x36\x1e\x58\x79\x5e\xd4\x29\xf7\x33\x93\x48\xdb\x5f\x1\xae\x9c\xb6\xe4\x88\x6d\x2b\x76\x75\xe0\xf3\x74\xe2\xc9", -+ .alen = 63, -+ .input = "\x74\xa6\x3e\xe4\xb1\xcb\xaf\xb0\x40\xe5\xf\x9e\xf1\xf2\x89\xb5\x42\x34\x8a\xa1\x3\xb7\xe9\x57\x46\xbe\x20\xe4\x6e\xb0\xeb\xff\xea\x7\x7e\xef\xe2\x55\x9f\xe5\x78\x3a\xb7\x83\xc2\x18\x40\x7b\xeb\xcd\x81\xfb\x90\x12\x9e\x46\xa9\xd6\x4a\xba\xb0\x62\xdb\x6b\x99\xc4\xdb\x54\x4b\xb8\xa5\x71\xcb\xcd\x63\x32\x55\xfb\x31\xf0\x38\xf5\xbe\x78\xe4\x45\xce\x1b\x6a\x5b\xe\xf4\x16\xe4\xb1\x3d\xf6\x63\x7b\xa7\xc\xde\x6f\x8f\x74\xdf\xe0\x1e\x9d\xce\x8f\x24\xef\x23\x35\x33\x7b\x83\x34\x23\x58\x74\x14\x77\x1f\xc2\x4f\x4e\xc6\x89\xf9\x52\x9\x37\x64\x14\xc4\x1\x6b\x9d\x77\xe8\x90\x5d\xa8\x4a\x2a\xef\x5c\x7f\xeb\xbb\xb2\xc6\x93\x99\x66\xdc\x7f\xd4\x9e\x2a\xca\x8d\xdb\xe7\x20\xcf\xe4\x73\xae\x49\x7d\x64\xf\xe\x28\x46\xa9\xa8\x32\xe4\xe\xf6\x51\x53\xb8\x3c\xb1\xff\xa3\x33\x41\x75\xff\xf1\x6f\xf1\xfb\xbb\x83\x7f\x6\x9b\xe7\x1b\xa\xe0\x5c\x33\x60\x5b\xdb\x5b\xed\xfe\xa5\x16\x19\x72\xa3\x64\x23\x0\x2\xc7\xf3\x6a\x81\x3e\x44\x1d\x79\x15\x5f\x9a\xde\xe2\xfd\x1b\x73\xc1\xbc\x23\xba\x31\xd2\x50\xd5\xad\x7f\x74\xa7\xc9\xf8\x3e\x2b\x26\x10\xf6\x3\x36\x74\xe4\xe\x6a\x72\xb7\x73\xa\x42\x28\xc2\xad\x5e\x3\xbe\xb8\xb\xa8\x5b\xd4\xb8\xba\x52\x89\xb1\x9b\xc1\xc3\x65\x87\xed\xa5\xf4\x86\xfd\x41\x80\x91\x27\x59\x53\x67\x15\x78\x54\x8b\x2d\x3d\xc7\xff\x2\x92\x7\x5f\x7a\x4b\x60\x59\x3c\x6f\x5c\xd8\xec\x95\xd2\xfe\xa0\x3b\xd8\x3f\xd1\x69\xa6\xd6\x41\xb2\xf4\x4d\x12\xf4\x58\x3e\x66\x64\x80\x31\x9b\xa8\x4c\x8b\x7\xb2\xec\x66\x94\x66\x47\x50\x50\x5f\x18\xb\xe\xd6\xc0\x39\x21\x13\x9e\x33\xbc\x79\x36\x2\x96\x70\xf0\x48\x67\x2f\x26\xe9\x6d\x10\xbb\xd6\x3f\xd1\x64\x7a\x2e\xbe\xc\x61\xf0\x75\x42\x38\x23\xb1\x9e\x9f\x7c\x67\x66\xd9\x58\x9a\xf1\xbb\x41\x2a\x8d\x65\x84\x94\xfc\xdc\x6a\x50\x64\xdb\x56\x33\x76\x0\x10\xed\xbe\xd2\x12\xf6\xf6\x1b\xa2\x16\xde\xae\x31\x95\xdd\xb1\x8\x7e\x4e\xee\xe7\xf9\xa5\xfb\x5b\x61\x43\x0\x40\xf6\x7e\x2\x4\x32\x4e\xc\xe2\x66\xd\xd7\x7\x98\xe\xf8\x72\x34\x6d\x95\x86\xd7\xcb\x31\x54\x47\xd0\x38\x29\x9c\x5a\x68\xd4\x87\x76\xc9\xe7\x7e\xe3\xf4\x81\x6d\x18\xcb\xc9\x5\xaf\xa0\xfb\x66\xf7\xf1\x1c\xc6\x14\x11\x4f\x2b\x79\x42\x8b\xbc\xac\xe7\x6c\xfe\xf\x58\xe7\x7c\x78\x39\x30\xb0\x66\x2c\x9b\x6d\x3a\xe1\xcf\xc9\xa4\xe\x6d\x6d\x8a\xa1\x3a\xe7\x28\xd4\x78\x4c\xa6\xa2\x2a\xa6\x3\x30\xd7\xa8\x25\x66\x87\x2f\x69\x5c\x4e\xdd\xa5\x49\x5d\x37\x4a\x59\xc4\xaf\x1f\xa2\xe4\xf8\xa6\x12\x97\xd5\x79\xf5\xe2\x4a\x2b\x5f\x61\xe4\x9e\xe3\xee\xb8\xa7\x5b\x2f\xf4\x9e\x6c\xfb\xd1\xc6\x56\x77\xba\x75\xaa\x3d\x1a\xa8\xb\xb3\x68\x24\x0\x10\x7f\xfd\xd7\xa1\x8d\x83\x54\x4f\x1f\xd8\x2a\xbe\x8a\xc\x87\xab\xa2\xde\xc3\x39\xbf\x9\x3\xa5\xf3\x5\x28\xe1\xe1\xee\x39\x70\x9c\xd8\x81\x12\x1e\x2\x40\xd2\x6e\xf0\xeb\x1b\x3d\x22\xc6\xe5\xe3\xb4\x5a\x98\xbb\xf0\x22\x28\x8d\xe5\xd3\x16\x48\x24\xa5\xe6\x66\xc\xf9\x8\xf9\x7e\x1e\xe1\x28\x26\x22\xc7\xc7\xa\x32\x47\xfa\xa3\xbe\x3c\xc4\xc5\x53\xa\xd5\x94\x4a\xd7\x93\xd8\x42\x99\xb9\xa\xdb\x56\xf7\xb9\x1c\x53\x4f\xfa\xd3\x74\xad\xd9\x68\xf1\x1b\xdf\x61\xc6\x5e\xa8\x48\xfc\xd4\x4a\x4c\x3c\x32\xf7\x1c\x96\x21\x9b\xf9\xa3\xcc\x5a\xce\xd5\xd7\x8\x24\xf6\x1c\xfd\xdd\x38\xc2\x32\xe9\xb8\xe7\xb6\xfa\x9d\x45\x13\x2c\x83\xfd\x4a\x69\x82\xcd\xdc\xb3\x76\xc\x9e\xd8\xf4\x1b\x45\x15\xb4\x97\xe7\x58\x34\xe2\x3\x29\x5a\xbf\xb6\xe0\x5d\x13\xd9\x2b\xb4\x80\xb2\x45\x81\x6a\x2e\x6c\x89\x7d\xee\xbb\x52\xdd\x1f\x18\xe7\x13\x6b\x33\xe\xea\x36\x92\x77\x7b\x6d\x9c\x5a\x5f\x45\x7b\x7b\x35\x62\x23\xd1\xbf\xf\xd0\x8\x1b\x2b\x80\x6b\x7e\xf1\x21\x47\xb0\x57\xd1\x98\x72\x90\x34\x1c\x20\x4\xff\x3d\x5c\xee\xe\x57\x5f\x6f\x24\x4e\x3c\xea\xfc\xa5\xa9\x83\xc9\x61\xb4\x51\x24\xf8\x27\x5e\x46\x8c\xb1\x53\x2\x96\x35\xba\xb8\x4c\x71\xd3\x15\x59\x35\x22\x20\xad\x3\x9f\x66\x44\x3b\x9c\x35\x37\x1f\x9b\xbb\xf3\xdb\x35\x63\x30\x64\xaa\xa2\x6\xa8\x5d\xbb\xe1\x9f\x70\xec\x82\x11\x6\x36\xec\x8b\x69\x66\x24\x44\xc9\x4a\x57\xbb\x9b\x78\x13\xce\x9c\xc\xba\x92\x93\x63\xb8\xe2\x95\xf\xf\x16\x39\x52\xfd\x3a\x6d\x2\x4b\xdf\x13\xd3\x2a\x22\xb4\x3\x7c\x54\x49\x96\x68\x54\x10\xfa\xef\xaa\x6c\xe8\x22\xdc\x71\x16\x13\x1a\xf6\x28\xe5\x6d\x77\x3d\xcd\x30\x63\xb1\x70\x52\xa1\xc5\x94\x5f\xcf\xe8\xb8\x26\x98\xf7\x6\xa0\xa\x70\xfa\x3\x80\xac\xc1\xec\xd6\x4c\x54\xd7\xfe\x47\xb6\x88\x4a\xf7\x71\x24\xee\xf3\xd2\xc2\x4a\x7f\xfe\x61\xc7\x35\xc9\x37\x67\xcb\x24\x35\xda\x7e\xca\x5f\xf3\x8d\xd4\x13\x8e\xd6\xcb\x4d\x53\x8f\x53\x1f\xc0\x74\xf7\x53\xb9\x5e\x23\x37\xba\x6e\xe3\x9d\x7\x55\x25\x7b\xe6\x2a\x64\xd1\x32\xdd\x54\x1b\x4b\xc0\xe1\xd7\x69\x58\xf8\x93\x29\xc4\xdd\x23\x2f\xa5\xfc\x9d\x7e\xf8\xd4\x90\xcd\x82\x55\xdc\x16\x16\x9f\x7\x52\x9b\x9d\x25\xed\x32\xc5\x7b\xdf\xf6\x83\x46\x3d\x65\xb7\xef\x87\x7a\x12\x69\x8f\x6\x7c\x51\x15\x4a\x8\xe8\xac\x9a\xc\x24\xa7\x27\xd8\x46\x2f\xe7\x1\xe\x1c\xc6\x91\xb0\x6e\x85\x65\xf0\x29\xd\x2e\x6b\x3b\xfb\x4b\xdf\xe4\x80\x93\x3\x66\x46\x3e\x8a\x6e\xf3\x5e\x4d\x62\xe\x49\x5\xaf\xd4\xf8\x21\x20\x61\x1d\x39\x17\xf4\x61\x47\x95\xfb\x15\x2e\xb3\x4f\xd0\x5d\xf5\x7d\x40\xda\x90\x3c\x6b\xcb\x17\x0\x13\x3b\x64\x34\x1b\xf0\xf2\xe5\x3b\xb2\xc7\xd3\x5f\x3a\x44\xa6\x9b\xb7\x78\xe\x42\x5d\x4c\xc1\xe9\xd2\xcb\xb7\x78\xd1\xfe\x9a\xb5\x7\xe9\xe0\xbe\xe2\x8a\xa7\x1\x83\x0\x8c\x5c\x8\xe6\x63\x12\x92\xb7\xb7\xa6\x19\x7d\x38\x13\x38\x92\x87\x24\xf9\x48\xb3\x5e\x87\x6a\x40\x39\x5c\x3f\xed\x8f\xee\xdb\x15\x82\x6\xda\x49\x21\x2b\xb5\xbf\x32\x7c\x9f\x42\x28\x63\xcf\xaf\x1e\xf8\xc6\xa0\xd1\x2\x43\x57\x62\xec\x9b\xf\x1\x9e\x71\xd8\x87\x9d\x1\xc1\x58\x77\xd9\xaf\xb1\x10\x7e\xdd\xa6\x50\x96\xe5\xf0\x72\x0\x6d\x4b\xf8\x2a\x8f\x19\xf3\x22\x88\x11\x4a\x8b\x7c\xfd\xb7\xed\xe1\xf6\x40\x39\xe0\xe9\xf6\x3d\x25\xe6\x74\x3c\x58\x57\x7f\xe1\x22\x96\x47\x31\x91\xba\x70\x85\x28\x6b\x9f\x6e\x25\xac\x23\x66\x2f\x29\x88\x28\xce\x8c\x5c\x88\x53\xd1\x3b\xcc\x6a\x51\xb2\xe1\x28\x3f\x91\xb4\xd\x0\x3a\xe3\xf8\xc3\x8f\xd7\x96\x62\xe\x2e\xfc\xc8\x6c\x77\xa6\x1d\x22\xc1\xb8\xe6\x61\xd7\x67\x36\x13\x7b\xbb\x9b\x59\x9\xa6\xdf\xf7\x6b\xa3\x40\x1a\xf5\x4f\xb4\xda\xd3\xf3\x81\x93\xc6\x18\xd9\x26\xee\xac\xf0\xaa\xdf\xc5\x9c\xca\xc2\xa2\xcc\x7b\x5c\x24\xb0\xbc\xd0\x6a\x4d\x89\x9\xb8\x7\xfe\x87\xad\xa\xea\xb8\x42\xf9\x5e\xb3\x3e\x36\x4c\xaf\x75\x9e\x1c\xeb\xbd\xbc\xbb\x80\x40\xa7\x3a\x30\xbf\xa8\x44\xf4\xeb\x38\xad\x29\xba\x23\xed\x41\xc\xea\xd2\xbb\x41\x18\xd6\xb9\xba\x65\x2b\xa3\x91\x6d\x1f\xa9\xf4\xd1\x25\x8d\x4d\x38\xff\x64\xa0\xec\xde\xa6\xb6\x79\xab\x8e\x33\x6c\x47\xde\xaf\x94\xa4\xa5\x86\x77\x55\x9\x92\x81\x31\x76\xc7\x34\x22\x89\x8e\x3d\x26\x26\xd7\xfc\x1e\x16\x72\x13\x33\x63\xd5\x22\xbe\xb8\x4\x34\x84\x41\xbb\x80\xd0\x9f\x46\x48\x7\xa7\xfc\x2b\x3a\x75\x55\x8c\xc7\x6a\xbd\x7e\x46\x8\x84\xf\xd5\x74\xc0\x82\x8e\xaa\x61\x5\x1\xb2\x47\x6e\x20\x6a\x2d\x58\x70\x48\x32\xa7\x37\xd2\xb8\x82\x1a\x51\xb9\x61\xdd\xfd\x9d\x6b\xe\x18\x97\xf8\x45\x5f\x87\x10\xcf\x34\x72\x45\x26\x49\x70\xe7\xa3\x78\xe0\x52\x89\x84\x94\x83\x82\xc2\x69\x8f\xe3\xe1\x3f\x60\x74\x88\xc4\xf7\x75\x2c\xfb\xbd\xb6\xc4\x7e\x10\xa\x6c\x90\x4\x9e\xc3\x3f\x59\x7c\xce\x31\x18\x60\x57\x73\x46\x94\x7d\x6\xa0\x6d\x44\xec\xa2\xa\x9e\x5\x15\xef\xca\x5c\xbf\x0\xeb\xf7\x3d\x32\xd4\xa5\xef\x49\x89\x5e\x46\xb0\xa6\x63\x5b\x8a\x73\xae\x6f\xd5\x9d\xf8\x4f\x40\xb5\xb2\x6e\xd3\xb6\x1\xa9\x26\xa2\x21\xcf\x33\x7a\x3a\xa4\x23\x13\xb0\x69\x6a\xee\xce\xd8\x9d\x1\x1d\x50\xc1\x30\x6c\xb1\xcd\xa0\xf0\xf0\xa2\x64\x6f\xbb\xbf\x5e\xe6\xab\x87\xb4\xf\x4f\x15\xaf\xb5\x25\xa1\xb2\xd0\x80\x2c\xfb\xf9\xfe\xd2\x33\xbb\x76\xfe\x7c\xa8\x66\xf7\xe7\x85\x9f\x1f\x85\x57\x88\xe1\xe9\x63\xe4\xd8\x1c\xa1\xfb\xda\x44\x5\x2e\x1d\x3a\x1c\xff\xc8\x3b\xc0\xfe\xda\x22\xb\x43\xd6\x88\x39\x4c\x4a\xa6\x69\x18\x93\x42\x4e\xb5\xcc\x66\xd\x9\xf8\x1e\x7c\xd3\x3c\x99\xd\x50\x1d\x62\xe9\x57\x6\xbf\x19\x88\xdd\xad\x7b\x4f\xf9\xc7\x82\x6d\x8d\xc8\xc4\xc5\x78\x17\x20\x15\xc5\x52\x41\xcf\x5b\xd6\x7f\x94\x2\x41\xe0\x40\x22\x3\x5e\xd1\x53\xd4\x86\xd3\x2c\x9f\xf\x96\xe3\x6b\x9a\x76\x32\x6\x47\x4b\x11\xb3\xdd\x3\x65\xbd\x9b\x1\xda\x9c\xb9\x7e\x3f\x6a\xc4\x7b\xea\xd4\x3c\xb9\xfb\x5c\x6b\x64\x33\x52\xba\x64\x78\x8f\xa4\xaf\x7a\x61\x8d\xbc\xc5\x73\xe9\x6b\x58\x97\x4b\xbf\x63\x22\xd3\x37\x2\x54\xc5\xb9\x16\x4a\xf0\x19\xd8\x94\x57\xb8\x8a\xb3\x16\x3b\xd0\x84\x8e\x67\xa6\xa3\x7d\x78\xec\x0", -+ .ilen = 2011, -+ .result = "\x52\x34\xb3\x65\x3b\xb7\xe5\xd3\xab\x49\x17\x60\xd2\x52\x56\xdf\xdf\x34\x56\x82\xe2\xbe\xe5\xe1\x28\xd1\x4e\x5f\x4f\x1\x7d\x3f\x99\x6b\x30\x6e\x1a\x7c\x4c\x8e\x62\x81\xae\x86\x3f\x6b\xd0\xb5\xa9\xcf\x50\xf1\x2\x12\xa0\xb\x24\xe9\xe6\x72\x89\x2c\x52\x1b\x34\x38\xf8\x75\x5f\xa0\x74\xe2\x99\xdd\xa6\x4b\x14\x50\x4e\xf1\xbe\xd6\x9e\xdb\xb2\x24\x27\x74\x12\x4a\x78\x78\x17\xa5\x58\x8e\x2f\xf9\xf4\x8d\xee\x3\x88\xae\xb8\x29\xa1\x2f\x4b\xee\x92\xbd\x87\xb3\xce\x34\x21\x57\x46\x4\x49\xc\x80\xf2\x1\x13\xa1\x55\xb3\xff\x44\x30\x3c\x1c\xd0\xef\xbc\x18\x74\x26\xad\x41\x5b\x5b\x3e\x9a\x7a\x46\x4f\x16\xd6\x74\x5a\xb7\x3a\x28\x31\xd8\xae\x26\xac\x50\x53\x86\xf2\x56\xd7\x3f\x29\xbc\x45\x68\x8e\xcb\x98\x64\xdd\xc9\xba\xb8\x4b\x7b\x82\xdd\x14\xa7\xcb\x71\x72\x0\x5c\xad\x7b\x6a\x89\xa4\x3d\xbf\xb5\x4b\x3e\x7c\x5a\xcf\xb8\xa1\xc5\x6e\xc8\xb6\x31\x57\x7b\xdf\xa5\x7e\xb1\xd6\x42\x2a\x31\x36\xd1\xd0\x3f\x7a\xe5\x94\xd6\x36\xa0\x6f\xb7\x40\x7d\x37\xc6\x55\x7c\x50\x40\x6d\x29\x89\xe3\x5a\xae\x97\xe7\x44\x49\x6e\xbd\x81\x3d\x3\x93\x6\x12\x6\xe2\x41\x12\x4a\xf1\x6a\xa4\x58\xa2\xfb\xd2\x15\xba\xc9\x79\xc9\xce\x5e\x13\xbb\xf1\x9\x4\xcc\xfd\xe8\x51\x34\x6a\xe8\x61\x88\xda\xed\x1\x47\x84\xf5\x73\x25\xf9\x1c\x42\x86\x7\xf3\x5b\x1a\x1\xb3\xeb\x24\x32\x8d\xf6\xed\x7c\x4b\xeb\x3c\x36\x42\x28\xdf\xdf\xb6\xbe\xd9\x8c\x52\xd3\x2b\x8\x90\x8c\xe7\x98\x31\xe2\x32\x8e\xfc\x11\x48\x0\xa8\x6a\x42\x4a\x2\xc6\x4b\x9\xf1\xe3\x49\xf3\x45\x1f\xe\xbc\x56\xe2\xe4\xdf\xfb\xeb\x61\xfa\x24\xc1\x63\x75\xbb\x47\x75\xaf\xe1\x53\x16\x96\x21\x85\x26\x11\xb3\x76\xe3\x23\xa1\x6b\x74\x37\xd0\xde\x6\x90\x71\x5d\x43\x88\x9b\x0\x54\xa6\x75\x2f\xa1\xc2\xb\x73\x20\x1d\xb6\x21\x79\x57\x3f\xfa\x9\xbe\x8a\x33\xc3\x52\xf0\x1d\x82\x31\xd1\x55\xb5\x6c\x99\x25\xcf\x5c\x32\xce\xe9\xd\xfa\x69\x2c\xd5\xd\xc5\x6d\x86\xd0\xc\x3b\x6\x50\x79\xe8\xc3\xae\x4\xe6\xcd\x51\xe4\x26\x9b\x4f\x7e\xa6\xf\xab\xd8\xe5\xde\xa9\x0\x95\xbe\xa3\x9d\x5d\xb2\x9\x70\x18\x1c\xf0\xac\x29\x23\x2\x29\x28\xd2\x74\x35\x57\x62\xf\x24\xea\x5e\x33\xc2\x92\xf3\x78\x4d\x30\x1e\xa1\x99\xa9\x82\xb0\x42\x31\x8d\xad\x8a\xbc\xfc\xd4\x57\x47\x3e\xb4\x50\xdd\x6e\x2c\x80\x4d\x22\xf1\xfb\x57\xc4\xdd\x17\xe1\x8a\x36\x4a\xb3\x37\xca\xc9\x4e\xab\xd5\x69\xc4\xf4\xbc\xb\x3b\x44\x4b\x29\x9c\xee\xd4\x35\x22\x21\xb0\x1f\x27\x64\xa8\x51\x1b\xf0\x9f\x19\x5c\xfb\x5a\x64\x74\x70\x45\x9\xf5\x64\xfe\x1a\x2d\xc9\x14\x4\x14\xcf\xd5\x7d\x60\xaf\x94\x39\x94\xe2\x7d\x79\x82\xd0\x65\x3b\x6b\x9c\x19\x84\xb4\x6d\xb3\xc\x99\xc0\x56\xa8\xbd\x73\xce\x5\x84\x3e\x30\xaa\xc4\x9b\x1b\x4\x2a\x9f\xd7\x43\x2b\x23\xdf\xbf\xaa\xd5\xc2\x43\x2d\x70\xab\xdc\x75\xad\xac\xf7\xc0\xbe\x67\xb2\x74\xed\x67\x10\x4a\x92\x60\xc1\x40\x50\x19\x8a\x8a\x8c\x9\xe\x72\xe1\x73\x5e\xe8\x41\x85\x63\x9f\x3f\xd7\x7d\xc4\xfb\x22\x5d\x92\x6c\xb3\x1e\xe2\x50\x2f\x82\xa8\x28\xc0\xb5\xd7\x5f\x68\xd\x2c\x2d\xaf\x7e\xfa\x2e\x8\xf\x1f\x70\x9f\xe9\x19\x72\x55\xf8\xfb\x51\xd2\x33\x5d\xa0\xd3\x2b\xa\x6c\xbc\x4e\xcf\x36\x4d\xdc\x3b\xe9\x3e\x81\x7c\x61\xdb\x20\x2d\x3a\xc3\xb3\xc\x1e\x0\xb9\x7c\xf5\xca\x10\x5f\x3a\x71\xb3\xe4\x20\xdb\xc\x2a\x98\x63\x45\x0\x58\xf6\x68\xe4\xb\xda\x13\x3b\x60\x5c\x76\xdb\xb9\x97\x71\xe4\xd9\xb7\xdb\xbd\x68\xc7\x84\x84\xaa\x7c\x68\x62\x5e\x16\xfc\xba\x72\xaa\x9a\xa9\xeb\x7c\x75\x47\x97\x7e\xad\xe2\xd9\x91\xe8\xe4\xa5\x31\xd7\x1\x8e\xa2\x11\x88\x95\xb9\xf2\x9b\xd3\x7f\x1b\x81\x22\xf7\x98\x60\xa\x64\xa6\xc1\xf6\x49\xc7\xe3\x7\x4d\x94\x7a\xcf\x6e\x68\xc\x1b\x3f\x6e\x2e\xee\x92\xfa\x52\xb3\x59\xf8\xf1\x8f\x6a\x66\xa3\x82\x76\x4a\x7\x1a\xc7\xdd\xf5\xda\x9c\x3c\x24\xbf\xfd\x42\xa1\x10\x64\x6a\xf\x89\xee\x36\xa5\xce\x99\x48\x6a\xf0\x9f\x9e\x69\xa4\x40\x20\xe9\x16\x15\xf7\xdb\x75\x2\xcb\xe9\x73\x8b\x3b\x49\x2f\xf0\xaf\x51\x6\x5c\xdf\x27\x27\x49\x6a\xd1\xcc\xc7\xb5\x63\xb5\xfc\xb8\x5c\x87\x7f\x84\xb4\xcc\x14\xa9\x53\xda\xa4\x56\xf8\xb6\x1b\xcc\x40\x27\x52\x6\x5a\x13\x81\xd7\x3a\xd4\x3b\xfb\x49\x65\x31\x33\xb2\xfa\xcd\xad\x58\x4e\x2b\xae\xd2\x20\xfb\x1a\x48\xb4\x3f\x9a\xd8\x7a\x35\x4a\xc8\xee\x88\x5e\x7\x66\x54\xb9\xec\x9f\xa3\xe3\xb9\x37\xaa\x49\x76\x31\xda\x74\x2d\x3c\xa4\x65\x10\x32\x38\xf0\xde\xd3\x99\x17\xaa\x71\xaa\x8f\xf\x8c\xaf\xa2\xf8\x5d\x64\xba\x1d\xa3\xef\x96\x73\xe8\xa1\x2\x8d\xc\x6d\xb8\x6\x90\xb8\x8\x56\x2c\xa7\x6\xc9\xc2\x38\xdb\x7c\x63\xb1\x57\x8e\xea\x7c\x79\xf3\x49\x1d\xfe\x9f\xf3\x6e\xb1\x1d\xba\x19\x80\x1a\xa\xd3\xb0\x26\x21\x40\xb1\x7c\xf9\x4d\x8d\x10\xc1\x7e\xf4\xf6\x3c\xa8\xfd\x7c\xa3\x92\xb2\xf\xaa\xcc\xa6\x11\xfe\x4\xe3\xd1\x7a\x32\x89\xdf\xd\xc4\x8f\x79\x6b\xca\x16\x7c\x6e\xf9\xad\xf\xf6\xfe\x27\xdb\xc4\x13\x70\xf1\x62\x1a\x4f\x79\x40\xc9\x9b\x8b\x21\xea\x84\xfa\xf5\xf1\x89\xce\xb7\x55\xa\x80\x39\x2f\x55\x36\x16\x9c\x7b\x8\xbd\x87\xd\xa5\x32\xf1\x52\x7c\xe8\x55\x60\x5b\xd7\x69\xe4\xfc\xfa\x12\x85\x96\xea\x50\x28\xab\x8a\xf7\xbb\xe\x53\x74\xca\xa6\x27\x9\xc2\xb5\xde\x18\x14\xd9\xea\xe5\x29\x1c\x40\x56\xcf\xd7\xae\x5\x3f\x65\xaf\x5\x73\xe2\x35\x96\x27\x7\x14\xc0\xad\x33\xf1\xdc\x44\x7a\x89\x17\x77\xd2\x9c\x58\x60\xf0\x3f\x7b\x2d\x2e\x57\x95\x54\x87\xed\xf2\xc7\x4c\xf0\xae\x56\x29\x19\x7d\x66\x4b\x9b\x83\x84\x42\x3b\x1\x25\x66\x8e\x2\xde\xb9\x83\x54\x19\xf6\x9f\x79\xd\x67\xc5\x1d\x7a\x44\x2\x98\xa7\x16\x1c\x29\xd\x74\xff\x85\x40\x6\xef\x2c\xa9\xc6\xf5\x53\x7\x6\xae\xe4\xfa\x5f\xd8\x39\x4d\xf1\x9b\x6b\xd9\x24\x84\xfe\x3\x4c\xb2\x3f\xdf\xa1\x5\x9e\x50\x14\x5a\xd9\x1a\xa2\xa7\xfa\xfa\x17\xf7\x78\xd6\xb5\x92\x61\x91\xac\x36\xfa\x56\xd\x38\x32\x18\x85\x8\x58\x37\xf0\x4b\xdb\x59\xe7\xa4\x34\xc0\x1b\x1\xaf\x2d\xde\xa1\xaa\x5d\xd3\xec\xe1\xd4\xf7\xe6\x54\x68\xf0\x51\x97\xa7\x89\xea\x24\xad\xd3\x6e\x47\x93\x8b\x4b\xb4\xf7\x1c\x42\x6\x67\xe8\x99\xf6\xf5\x7b\x85\xb5\x65\xb5\xb5\xd2\x37\xf5\xf3\x2\xa6\x4d\x11\xa7\xdc\x51\x9\x7f\xa0\xd8\x88\x1c\x13\x71\xae\x9c\xb7\x7b\x34\xd6\x4e\x68\x26\x83\x51\xaf\x1d\xee\x8b\xbb\x69\x43\x2b\x9e\x8a\xbc\x2\xe\xa0\x1b\xe0\xa8\x5f\x6f\xaf\x1b\x8f\xe7\x64\x71\x74\x11\x7e\xa8\xd8\xf9\x97\x6\xc3\xb6\xfb\xfb\xb7\x3d\x35\x9d\x3b\x52\xed\x54\xca\xf4\x81\x1\x2d\x1b\xc3\xa7\x0\x3d\x1a\x39\x54\xe1\xf6\xff\xed\x6f\xb\x5a\x68\xda\x58\xdd\xa9\xcf\x5c\x4a\xe5\x9\x4e\xde\x9d\xbc\x3e\xee\x5a\x0\x3b\x2c\x87\x10\x65\x60\xdd\xd7\x56\xd1\x4c\x64\x45\xe4\x21\xec\x78\xf8\x25\x7a\x3e\x16\x5d\x9\x53\x14\xbe\x4f\xae\x87\xd8\xd1\xaa\x3c\xf6\x3e\xa4\x70\x8c\x5e\x70\xa4\xb3\x6b\x66\x73\xd3\xbf\x31\x6\x19\x62\x93\x15\xf2\x86\xe4\x52\x7e\x53\x4c\x12\x38\xcc\x34\x7d\x57\xf6\x42\x93\x8a\xc4\xee\x5c\x8a\xe1\x52\x8f\x56\x64\xf6\xa6\xd1\x91\x57\x70\xcd\x11\x76\xf5\x59\x60\x60\x3c\xc1\xc3\xb\x7f\x58\x1a\x50\x91\xf1\x68\x8f\x6e\x74\x74\xa8\x51\xb\xf7\x7a\x98\x37\xf2\xa\xe\xa4\x97\x4\xb8\x9b\xfd\xa0\xea\xf7\xd\xe1\xdb\x3\xf0\x31\x29\xf8\xdd\x6b\x8b\x5d\xd8\x59\xa9\x29\xcf\x9a\x79\x89\x19\x63\x46\x9\x79\x6a\x11\xda\x63\x68\x48\x77\x23\xfb\x7d\x3a\x43\xcb\x2\x3b\x7a\x6d\x10\x2a\x9e\xac\xf1\xd4\x19\xf8\x23\x64\x1d\x2c\x5f\xf2\xb0\x5c\x23\x27\xf7\x27\x30\x16\x37\xb1\x90\xab\x38\xfb\x55\xcd\x78\x58\xd4\x7d\x43\xf6\x45\x5e\x55\x8d\xb1\x2\x65\x58\xb4\x13\x4b\x36\xf7\xcc\xfe\x3d\xb\x82\xe2\x12\x11\xbb\xe6\xb8\x3a\x48\x71\xc7\x50\x6\x16\x3a\xe6\x7c\x5\xc7\xc8\x4d\x2f\x8\x6a\x17\x9a\x95\x97\x50\x68\xdc\x28\x18\xc4\x61\x38\xb9\xe0\x3e\x78\xdb\x29\xe0\x9f\x52\xdd\xf8\x4f\x91\xc1\xd0\x33\xa1\x7a\x8e\x30\x13\x82\x7\x9f\xd3\x31\xf\x23\xbe\x32\x5a\x75\xcf\x96\xb2\xec\xb5\x32\xac\x21\xd1\x82\x33\xd3\x15\x74\xbd\x90\xf1\x2c\xe6\x5f\x8d\xe3\x2\xe8\xe9\xc4\xca\x96\xeb\xe\xbc\x91\xf4\xb9\xea\xd9\x1b\x75\xbd\xe1\xac\x2a\x5\x37\x52\x9b\x1b\x3f\x5a\xdc\x21\xc3\x98\xbb\xaf\xa3\xf2\x0\xbf\xd\x30\x89\x5\xcc\xa5\x76\xf5\x6\xf0\xc6\x54\x8a\x5d\xd4\x1e\xc1\xf2\xce\xb0\x62\xc8\xfc\x59\x42\x9a\x90\x60\x55\xfe\x88\xa5\x8b\xb8\x33\xc\x23\x24\xd\x15\x70\x37\x1e\x3d\xf6\xd2\xea\x92\x10\xb2\xc4\x51\xac\xf2\xac\xf3\x6b\x6c\xaa\xcf\x12\xc5\x6c\x90\x50\xb5\xc\xfc\x1a\x15\x52\xe9\x26\xc6\x52\xa4\xe7\x81\x69\xe1\xe7\x9e\x30\x1\xec\x84\x89\xb2\xd\x66\xdd\xce\x28\x5c\xec\x98\x46\x68\x21\x9f\x88\x3f\x1f\x42\x77\xce\xd0\x61\xd4\x20\xa7\xff\x53\xad\x37\xd0\x17\x35\xc9\xfc\xba\xa\x78\x3f\xf2\xcc\x86\x89\xe8\x4b\x3c\x48\x33\x9\x7f\xc6\xc0\xdd\xb8\xfd\x7a\x66\x66\x65\xeb\x47\xa7\x4\x28\xa3\x19\x8e\xa9\xb1\x13\x67\x62\x70\xcf\xd6" -+} }; -+static const struct chacha20poly1305_testvec chacha20poly1305_dec_vectors[] __initconst = { { -+ .key = "\x1c\x92\x40\xa5\xeb\x55\xd3\x8a\xf3\x33\x88\x86\x04\xf6\xb5\xf0\x47\x39\x17\xc1\x40\x2b\x80\x09\x9d\xca\x5c\xbc\x20\x70\x75\xc0", -+ .nonce = "\x01\x02\x03\x04\x05\x06\x07\x08", -+ .assoc = "\xf3\x33\x88\x86\x00\x00\x00\x00\x00\x00\x4e\x91", -+ .alen = 12, -+ .input = "\x64\xa0\x86\x15\x75\x86\x1a\xf4\x60\xf0\x62\xc7\x9b\xe6\x43\xbd\x5e\x80\x5c\xfd\x34\x5c\xf3\x89\xf1\x08\x67\x0a\xc7\x6c\x8c\xb2\x4c\x6c\xfc\x18\x75\x5d\x43\xee\xa0\x9e\xe9\x4e\x38\x2d\x26\xb0\xbd\xb7\xb7\x3c\x32\x1b\x01\x00\xd4\xf0\x3b\x7f\x35\x58\x94\xcf\x33\x2f\x83\x0e\x71\x0b\x97\xce\x98\xc8\xa8\x4a\xbd\x0b\x94\x81\x14\xad\x17\x6e\x00\x8d\x33\xbd\x60\xf9\x82\xb1\xff\x37\xc8\x55\x97\x97\xa0\x6e\xf4\xf0\xef\x61\xc1\x86\x32\x4e\x2b\x35\x06\x38\x36\x06\x90\x7b\x6a\x7c\x02\xb0\xf9\xf6\x15\x7b\x53\xc8\x67\xe4\xb9\x16\x6c\x76\x7b\x80\x4d\x46\xa5\x9b\x52\x16\xcd\xe7\xa4\xe9\x90\x40\xc5\xa4\x04\x33\x22\x5e\xe2\x82\xa1\xb0\xa0\x6c\x52\x3e\xaf\x45\x34\xd7\xf8\x3f\xa1\x15\x5b\x00\x47\x71\x8c\xbc\x54\x6a\x0d\x07\x2b\x04\xb3\x56\x4e\xea\x1b\x42\x22\x73\xf5\x48\x27\x1a\x0b\xb2\x31\x60\x53\xfa\x76\x99\x19\x55\xeb\xd6\x31\x59\x43\x4e\xce\xbb\x4e\x46\x6d\xae\x5a\x10\x73\xa6\x72\x76\x27\x09\x7a\x10\x49\xe6\x17\xd9\x1d\x36\x10\x94\xfa\x68\xf0\xff\x77\x98\x71\x30\x30\x5b\xea\xba\x2e\xda\x04\xdf\x99\x7b\x71\x4d\x6c\x6f\x2c\x29\xa6\xad\x5c\xb4\x02\x2b\x02\x70\x9b\xee\xad\x9d\x67\x89\x0c\xbb\x22\x39\x23\x36\xfe\xa1\x85\x1f\x38", -+ .ilen = 281, -+ .result = "\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x72\x65\x20\x64\x72\x61\x66\x74\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x76\x61\x6c\x69\x64\x20\x66\x6f\x72\x20\x61\x20\x6d\x61\x78\x69\x6d\x75\x6d\x20\x6f\x66\x20\x73\x69\x78\x20\x6d\x6f\x6e\x74\x68\x73\x20\x61\x6e\x64\x20\x6d\x61\x79\x20\x62\x65\x20\x75\x70\x64\x61\x74\x65\x64\x2c\x20\x72\x65\x70\x6c\x61\x63\x65\x64\x2c\x20\x6f\x72\x20\x6f\x62\x73\x6f\x6c\x65\x74\x65\x64\x20\x62\x79\x20\x6f\x74\x68\x65\x72\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x61\x74\x20\x61\x6e\x79\x20\x74\x69\x6d\x65\x2e\x20\x49\x74\x20\x69\x73\x20\x69\x6e\x61\x70\x70\x72\x6f\x70\x72\x69\x61\x74\x65\x20\x74\x6f\x20\x75\x73\x65\x20\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x73\x20\x72\x65\x66\x65\x72\x65\x6e\x63\x65\x20\x6d\x61\x74\x65\x72\x69\x61\x6c\x20\x6f\x72\x20\x74\x6f\x20\x63\x69\x74\x65\x20\x74\x68\x65\x6d\x20\x6f\x74\x68\x65\x72\x20\x74\x68\x61\x6e\x20\x61\x73\x20\x2f\xe2\x80\x9c\x77\x6f\x72\x6b\x20\x69\x6e\x20\x70\x72\x6f\x67\x72\x65\x73\x73\x2e\x2f\xe2\x80\x9d" -+}, { -+ .key = "\x4c\xf5\x96\x83\x38\xe6\xae\x7f\x2d\x29\x25\x76\xd5\x75\x27\x86\x91\x9a\x27\x7a\xfb\x46\xc5\xef\x94\x81\x79\x57\x14\x59\x40\x68", -+ .nonce = "\xca\xbf\x33\x71\x32\x45\x77\x8e", -+ .assoc = "", -+ .alen = 0, -+ .input = "\xea\xe0\x1e\x9e\x2c\x91\xaa\xe1\xdb\x5d\x99\x3f\x8a\xf7\x69\x92", -+ .ilen = 16, -+ .result = "" -+}, { -+ .key = "\x2d\xb0\x5d\x40\xc8\xed\x44\x88\x34\xd1\x13\xaf\x57\xa1\xeb\x3a\x2a\x80\x51\x36\xec\x5b\xbc\x8\x93\x84\x21\xb5\x13\x88\x3c\xd", -+ .nonce = "\x3d\x86\xb5\x6b\xc8\xa3\x1f\x1d", -+ .assoc = "\x33\x10\x41\x12\x1f\xf3\xd2\x6b", -+ .alen = 8, -+ .input = "\xdd\x6b\x3b\x82\xce\x5a\xbd\xd6\xa9\x35\x83\xd8\x8c\x3d\x85\x77", -+ .ilen = 16, -+ .result = "" -+}, { -+ .key = "\x4b\x28\x4b\xa3\x7b\xbe\xe9\xf8\x31\x80\x82\xd7\xd8\xe8\xb5\xa1\xe2\x18\x18\x8a\x9c\xfa\xa3\x3d\x25\x71\x3e\x40\xbc\x54\x7a\x3e", -+ .nonce = "\xd2\x32\x1f\x29\x28\xc6\xc4\xc4", -+ .assoc = "\x6a\xe2\xad\x3f\x88\x39\x5a\x40", -+ .alen = 8, -+ .input = "\xb7\x1b\xb0\x73\x59\xb0\x84\xb2\x6d\x8e\xab\x94\x31\xa1\xae\xac\x89", -+ .ilen = 17, -+ .result = "\xa4" -+}, { -+ .key = "\x66\xca\x9c\x23\x2a\x4b\x4b\x31\xe\x92\x89\x8b\xf4\x93\xc7\x87\x98\xa3\xd8\x39\xf8\xf4\xa7\x1\xc0\x2e\xa\xa6\x7e\x5a\x78\x87", -+ .nonce = "\x20\x1c\xaa\x5f\x9c\xbf\x92\x30", -+ .assoc = "", -+ .alen = 0, -+ .input = "\xbf\xe1\x5b\xb\xdb\x6b\xf5\x5e\x6c\x5d\x84\x44\x39\x81\xc1\x9c\xac", -+ .ilen = 17, -+ .result = "\x2d" -+}, { -+ .key = "\x68\x7b\x8d\x8e\xe3\xc4\xdd\xae\xdf\x72\x7f\x53\x72\x25\x1e\x78\x91\xcb\x69\x76\x1f\x49\x93\xf9\x6f\x21\xcc\x39\x9c\xad\xb1\x1", -+ .nonce = "\xdf\x51\x84\x82\x42\xc\x75\x9c", -+ .assoc = "\x70\xd3\x33\xf3\x8b\x18\xb", -+ .alen = 7, -+ .input = "\x8b\x6\xd3\x31\xb0\x93\x45\xb1\x75\x6e\x26\xf9\x67\xbc\x90\x15\x81\x2c\xb5\xf0\xc6\x2b\xc7\x8c\x56\xd1\xbf\x69\x6c\x7\xa0\xda\x65\x27\xc9\x90\x3d\xef\x4b\x11\xf\x19\x7\xfd\x29\x92\xd9\xc8\xf7\x99\x2e\x4a\xd0\xb8\x2c\xdc\x93\xf5\x9e\x33\x78\xd1\x37\xc3\x66\xd7\x5e\xbc\x44\xbf\x53\xa5\xbc\xc4\xcb\x7b\x3a\x8e\x7f\x2\xbd\xbb\xe7\xca\xa6\x6c\x6b\x93\x21\x93\x10\x61\xe7\x69\xd0\x78\xf3\x7\x5a\x1a\x8f\x73\xaa\xb1\x4e\xd3\xda\x4f\xf3\x32\xe1\x66\x3e\x6c\xc6\x13\xba\x6\x5b\xfc\x6a\xe5\x6f\x60\xfb\x7\x40\xb0\x8c\x9d\x84\x43\x6b\xc1\xf7\x8d\x8d\x31\xf7\x7a\x39\x4d\x8f\x9a\xeb", -+ .ilen = 145, -+ .result = "\x33\x2f\x94\xc1\xa4\xef\xcc\x2a\x5b\xa6\xe5\x8f\x1d\x40\xf0\x92\x3c\xd9\x24\x11\xa9\x71\xf9\x37\x14\x99\xfa\xbe\xe6\x80\xde\x50\xc9\x96\xd4\xb0\xec\x9e\x17\xec\xd2\x5e\x72\x99\xfc\xa\xe1\xcb\x48\xd2\x85\xdd\x2f\x90\xe0\x66\x3b\xe6\x20\x74\xbe\x23\x8f\xcb\xb4\xe4\xda\x48\x40\xa6\xd1\x1b\xc7\x42\xce\x2f\xc\xa6\x85\x6e\x87\x37\x3\xb1\x7c\x25\x96\xa3\x5\xd8\xb0\xf4\xed\xea\xc2\xf0\x31\x98\x6c\xd1\x14\x25\xc0\xcb\x1\x74\xd0\x82\xf4\x36\xf5\x41\xd5\xdc\xca\xc5\xbb\x98\xfe\xfc\x69\x21\x70\xd8\xa4\x4b\xc8\xde\x8f" -+}, { -+ .key = "\x8d\xb8\x91\x48\xf0\xe7\xa\xbd\xf9\x3f\xcd\xd9\xa0\x1e\x42\x4c\xe7\xde\x25\x3d\xa3\xd7\x5\x80\x8d\xf2\x82\xac\x44\x16\x51\x1", -+ .nonce = "\xde\x7b\xef\xc3\x65\x1b\x68\xb0", -+ .assoc = "", -+ .alen = 0, -+ .input = "\x85\x4\xc2\xed\x8d\xfd\x97\x5c\xd2\xb7\xe2\xc1\x6b\xa3\xba\xf8\xc9\x50\xc3\xc6\xa5\xe3\xa4\x7c\xc3\x23\x49\x5e\xa9\xb9\x32\xeb\x8a\x7c\xca\xe5\xec\xfb\x7c\xc0\xcb\x7d\xdc\x2c\x9d\x92\x55\x21\xa\xc8\x43\x63\x59\xa\x31\x70\x82\x67\x41\x3\xf8\xdf\xf2\xac\xa7\x2\xd4\xd5\x8a\x2d\xc8\x99\x19\x66\xd0\xf6\x88\x2c\x77\xd9\xd4\xd\x6c\xbd\x98\xde\xe7\x7f\xad\x7e\x8a\xfb\xe9\x4b\xe5\xf7\xe5\x50\xa0\x90\x3f\xd6\x22\x53\xe3\xfe\x1b\xcc\x79\x3b\xec\x12\x47\x52\xa7\xd6\x4\xe3\x52\xe6\x93\x90\x91\x32\x73\x79\xb8\xd0\x31\xde\x1f\x9f\x2f\x5\x38\x54\x2f\x35\x4\x39\xe0\xa7\xba\xc6\x52\xf6\x37\x65\x4c\x7\xa9\x7e\xb3\x21\x6f\x74\x8c\xc9\xde\xdb\x65\x1b\x9b\xaa\x60\xb1\x3\x30\x6b\xb2\x3\xc4\x1c\x4\xf8\xf\x64\xaf\x46\xe4\x65\x99\x49\xe2\xea\xce\x78\x0\xd8\x8b\xd5\x2e\xcf\xfc\x40\x49\xe8\x58\xdc\x34\x9c\x8c\x61\xbf\xa\x8e\xec\x39\xa9\x30\x5\x5a\xd2\x56\x1\xc7\xda\x8f\x4e\xbb\x43\xa3\x3a\xf9\x15\x2a\xd0\xa0\x7a\x87\x34\x82\xfe\x8a\xd1\x2d\x5e\xc7\xbf\x4\x53\x5f\x3b\x36\xd4\x25\x5c\x34\x7a\x8d\xd5\x5\xce\x72\xca\xef\x7a\x4b\xbc\xb0\x10\x5c\x96\x42\x3a\x0\x98\xcd\x15\xe8\xb7\x53", -+ .ilen = 272, -+ .result = "\x9b\x18\xdb\xdd\x9a\xf\x3e\xa5\x15\x17\xde\xdf\x8\x9d\x65\xa\x67\x30\x12\xe2\x34\x77\x4b\xc1\xd9\xc6\x1f\xab\xc6\x18\x50\x17\xa7\x9d\x3c\xa6\xc5\x35\x8c\x1c\xc0\xa1\x7c\x9f\x3\x89\xca\xe1\xe6\xe9\xd4\xd3\x88\xdb\xb4\x51\x9d\xec\xb4\xfc\x52\xee\x6d\xf1\x75\x42\xc6\xfd\xbd\x7a\x8e\x86\xfc\x44\xb3\x4f\xf3\xea\x67\x5a\x41\x13\xba\xb0\xdc\xe1\xd3\x2a\x7c\x22\xb3\xca\xac\x6a\x37\x98\x3e\x1d\x40\x97\xf7\x9b\x1d\x36\x6b\xb3\x28\xbd\x60\x82\x47\x34\xaa\x2f\x7d\xe9\xa8\x70\x81\x57\xd4\xb9\x77\xa\x9d\x29\xa7\x84\x52\x4f\xc2\x4a\x40\x3b\x3c\xd4\xc9\x2a\xdb\x4a\x53\xc4\xbe\x80\xe9\x51\x7f\x8f\xc7\xa2\xce\x82\x5c\x91\x1e\x74\xd9\xd0\xbd\xd5\xf3\xfd\xda\x4d\x25\xb4\xbb\x2d\xac\x2f\x3d\x71\x85\x7b\xcf\x3c\x7b\x3e\xe\x22\x78\xc\x29\xbf\xe4\xf4\x57\xb3\xcb\x49\xa0\xfc\x1e\x5\x4e\x16\xbc\xd5\xa8\xa3\xee\x5\x35\xc6\x7c\xab\x60\x14\x55\x1a\x8e\xc5\x88\x5d\xd5\x81\xc2\x81\xa5\xc4\x60\xdb\xaf\x77\x91\xe1\xce\xa2\x7e\x7f\x42\xe3\xb0\x13\x1c\x1f\x25\x60\x21\xe2\x40\x5f\x99\xb7\x73\xec\x9b\x2b\xf0\x65\x11\xc8\xd0\xa\x9f\xd3" -+}, { -+ .key = "\xf2\xaa\x4f\x99\xfd\x3e\xa8\x53\xc1\x44\xe9\x81\x18\xdc\xf5\xf0\x3e\x44\x15\x59\xe0\xc5\x44\x86\xc3\x91\xa8\x75\xc0\x12\x46\xba", -+ .nonce = "\xe\xd\x57\xbb\x7b\x40\x54\x2", -+ .assoc = "", -+ .alen = 0, -+ .input = "\x14\xf6\x41\x37\xa6\xd4\x27\xcd\xdb\x6\x3e\x9a\x4e\xab\xd5\xb1\x1e\x6b\xd2\xbc\x11\xf4\x28\x93\x63\x54\xef\xbb\x5e\x1d\x3a\x1d\x37\x3c\xa\x6c\x1e\xc2\xd1\x2c\xb5\xa3\xb5\x7b\xb8\x8f\x25\xa6\x1b\x61\x1c\xec\x28\x58\x26\xa4\xa8\x33\x28\x25\x5c\x45\x5\xe5\x6c\x99\xe5\x45\xc4\xa2\x3\x84\x3\x73\x1e\x8c\x49\xac\x20\xdd\x8d\xb3\xc4\xf5\xe7\x4f\xf1\xed\xa1\x98\xde\xa4\x96\xdd\x2f\xab\xab\x97\xcf\x3e\xd2\x9e\xb8\x13\x7\x28\x29\x19\xaf\xfd\xf2\x49\x43\xea\x49\x26\x91\xc1\x7\xd6\xbb\x81\x75\x35\xd\x24\x7f\xc8\xda\xd4\xb7\xeb\xe8\x5c\x9\xa2\x2f\xdc\x28\x7d\x3a\x3\xfa\x94\xb5\x1d\x17\x99\x36\xc3\x1c\x18\x34\xe3\x9f\xf5\x55\x7c\xb0\x60\x9d\xff\xac\xd4\x61\xf2\xad\xf8\xce\xc7\xbe\x5c\xd2\x95\xa8\x4b\x77\x13\x19\x59\x26\xc9\xb7\x8f\x6a\xcb\x2d\x37\x91\xea\x92\x9c\x94\x5b\xda\xb\xce\xfe\x30\x20\xf8\x51\xad\xf2\xbe\xe7\xc7\xff\xb3\x33\x91\x6a\xc9\x1a\x41\xc9\xf\xf3\x10\xe\xfd\x53\xff\x6c\x16\x52\xd9\xf3\xf7\x98\x2e\xc9\x7\x31\x2c\xc\x72\xd7\xc5\xc6\x8\x2a\x7b\xda\xbd\x7e\x2\xea\x1a\xbb\xf2\x4\x27\x61\x28\x8e\xf5\x4\x3\x1f\x4c\x7\x55\x82\xec\x1e\xd7\x8b\x2f\x65\x56\xd1\xd9\x1e\x3c\xe9\x1f\x5e\x98\x70\x38\x4a\x8c\x49\xc5\x43\xa0\xa1\x8b\x74\x9d\x4c\x62\xd\x10\xc\xf4\x6c\x8f\xe0\xaa\x9a\x8d\xb7\xe0\xbe\x4c\x87\xf1\x98\x2f\xcc\xed\xc0\x52\x29\xdc\x83\xf8\xfc\x2c\xe\xa8\x51\x4d\x80\xd\xa3\xfe\xd8\x37\xe7\x41\x24\xfc\xfb\x75\xe3\x71\x7b\x57\x45\xf5\x97\x73\x65\x63\x14\x74\xb8\x82\x9f\xf8\x60\x2f\x8a\xf2\x4e\xf1\x39\xda\x33\x91\xf8\x36\xe0\x8d\x3f\x1f\x3b\x56\xdc\xa0\x8f\x3c\x9d\x71\x52\xa7\xb8\xc0\xa5\xc6\xa2\x73\xda\xf4\x4b\x74\x5b\x0\x3d\x99\xd7\x96\xba\xe6\xe1\xa6\x96\x38\xad\xb3\xc0\xd2\xba\x91\x6b\xf9\x19\xdd\x3b\xbe\xbe\x9c\x20\x50\xba\xa1\xd0\xce\x11\xbd\x95\xd8\xd1\xdd\x33\x85\x74\xdc\xdb\x66\x76\x44\xdc\x3\x74\x48\x35\x98\xb1\x18\x47\x94\x7d\xff\x62\xe4\x58\x78\xab\xed\x95\x36\xd9\x84\x91\x82\x64\x41\xbb\x58\xe6\x1c\x20\x6d\x15\x6b\x13\x96\xe8\x35\x7f\xdc\x40\x2c\xe9\xbc\x8a\x4f\x92\xec\x6\x2d\x50\xdf\x93\x5d\x65\x5a\xa8\xfc\x20\x50\x14\xa9\x8a\x7e\x1d\x8\x1f\xe2\x99\xd0\xbe\xfb\x3a\x21\x9d\xad\x86\x54\xfd\xd\x98\x1c\x5a\x6f\x1f\x9a\x40\xcd\xa2\xff\x6a\xf1\x54", -+ .ilen = 528, -+ .result = "\xc3\x9\x94\x62\xe6\x46\x2e\x10\xbe\x0\xe4\xfc\xf3\x40\xa3\xe2\xf\xc2\x8b\x28\xdc\xba\xb4\x3c\xe4\x21\x58\x61\xcd\x8b\xcd\xfb\xac\x94\xa1\x45\xf5\x1c\xe1\x12\xe0\x3b\x67\x21\x54\x5e\x8c\xaa\xcf\xdb\xb4\x51\xd4\x13\xda\xe6\x83\x89\xb6\x92\xe9\x21\x76\xa4\x93\x7d\xe\xfd\x96\x36\x3\x91\x43\x5c\x92\x49\x62\x61\x7b\xeb\x43\x89\xb8\x12\x20\x43\xd4\x47\x6\x84\xee\x47\xe9\x8a\x73\x15\xf\x72\xcf\xed\xce\x96\xb2\x7f\x21\x45\x76\xeb\x26\x28\x83\x6a\xad\xaa\xa6\x81\xd8\x55\xb1\xa3\x85\xb3\xc\xdf\xf1\x69\x2d\x97\x5\x2a\xbc\x7c\x7b\x25\xf8\x80\x9d\x39\x25\xf3\x62\xf0\x66\x5e\xf4\xa0\xcf\xd8\xfd\x4f\xb1\x1f\x60\x3a\x8\x47\xaf\xe1\xf6\x10\x77\x9\xa7\x27\x8f\x9a\x97\x5a\x26\xfa\xfe\x41\x32\x83\x10\xe0\x1d\xbf\x64\xd\xf4\x1c\x32\x35\xe5\x1b\x36\xef\xd4\x4a\x93\x4d\x0\x7c\xec\x2\x7\x8b\x5d\x7d\x1b\xe\xd1\xa6\xa5\x5d\x7d\x57\x88\xa8\xcc\x81\xb4\x86\x4e\xb4\x40\xe9\x1d\xc3\xb1\x24\x3e\x7f\xcc\x8a\x24\x9b\xdf\x6d\xf0\x39\x69\x3e\x4c\xc0\x96\xe4\x13\xda\x90\xda\xf4\x95\x66\x8b\x17\x17\xfe\x39\x43\x25\xaa\xda\xa0\x43\x3c\xb1\x41\x2\xa3\xf0\xa7\x19\x59\xbc\x1d\x7d\x6c\x6d\x91\x9\x5c\xb7\x5b\x1\xd1\x6f\x17\x21\x97\xbf\x89\x71\xa5\xb0\x6e\x7\x45\xfd\x9d\xea\x7\xf6\x7a\x9f\x10\x18\x22\x30\x73\xac\xd4\x6b\x72\x44\xed\xd9\x19\x9b\x2d\x4a\x41\xdd\xd1\x85\x5e\x37\x19\xed\xd2\x15\x8f\x5e\x91\xdb\x33\xf2\xe4\xdb\xff\x98\xfb\xa3\xb5\xca\x21\x69\x8\xe7\x8a\xdf\x90\xff\x3e\xe9\x20\x86\x3c\xe9\xfc\xb\xfe\x5c\x61\xaa\x13\x92\x7f\x7b\xec\xe0\x6d\xa8\x23\x22\xf6\x6b\x77\xc4\xfe\x40\x7\x3b\xb6\xf6\x8e\x5f\xd4\xb9\xb7\xf\x21\x4\xef\x83\x63\x91\x69\x40\xa3\x48\x5c\xd2\x60\xf9\x4f\x6c\x47\x8b\x3b\xb1\x9f\x8e\xee\x16\x8a\x13\xfc\x46\x17\xc3\xc3\x32\x56\xf8\x3c\x85\x3a\xb6\x3e\xaa\x89\x4f\xb3\xdf\x38\xfd\xf1\xe4\x3a\xc0\xe6\x58\xb5\x8f\xc5\x29\xa2\x92\x4a\xb6\xa0\x34\x7f\xab\xb5\x8a\x90\xa1\xdb\x4d\xca\xb6\x2c\x41\x3c\xf7\x2b\x21\xc3\xfd\xf4\x17\x5c\xb5\x33\x17\x68\x2b\x8\x30\xf3\xf7\x30\x3c\x96\xe6\x6a\x20\x97\xe7\x4d\x10\x5f\x47\x5f\x49\x96\x9\xf0\x27\x91\xc8\xf8\x5a\x2e\x79\xb5\xe2\xb8\xe8\xb9\x7b\xd5\x10\xcb\xff\x5d\x14\x73\xf3" -+}, { -+ .key = "\xea\xbc\x56\x99\xe3\x50\xff\xc5\xcc\x1a\xd7\xc1\x57\x72\xea\x86\x5b\x89\x88\x61\x3d\x2f\x9b\xb2\xe7\x9c\xec\x74\x6e\x3e\xf4\x3b", -+ .nonce = "\xef\x2d\x63\xee\x6b\x80\x8b\x78", -+ .assoc = "\x5a\x27\xff\xeb\xdf\x84\xb2\x9e\xef", -+ .alen = 9, -+ .input = "\xfd\x81\x8d\xd0\x3d\xb4\xd5\xdf\xd3\x42\x47\x5a\x6d\x19\x27\x66\x4b\x2e\xc\x27\x9c\x96\x4c\x72\x2\xa3\x65\xc3\xb3\x6f\x2e\xbd\x63\x8a\x4a\x5d\x29\xa2\xd0\x28\x48\xc5\x3d\x98\xa3\xbc\xe0\xbe\x3b\x3f\xe6\x8a\xa4\x7f\x53\x6\xfa\x7f\x27\x76\x72\x31\xa1\xf5\xd6\xc\x52\x47\xba\xcd\x4f\xd7\xeb\x5\x48\xd\x7c\x35\x4a\x9\xc9\x76\x71\x2\xa3\xfb\xb7\x1a\x65\xb7\xed\x98\xc6\x30\x8a\x0\xae\xa1\x31\xe5\xb5\x9e\x6d\x62\xda\xda\x7\xf\x38\x38\xd3\xcb\xc1\xb0\xad\xec\x72\xec\xb1\xa2\x7b\x59\xf3\x3d\x2b\xef\xcd\x28\x5b\x83\xcc\x18\x91\x88\xb0\x2e\xf9\x29\x31\x18\xf9\x4e\xe9\xa\x91\x92\x9f\xae\x2d\xad\xf4\xe6\x1a\xe2\xa4\xee\x47\x15\xbf\x83\x6e\xd7\x72\x12\x3b\x2d\x24\xe9\xb2\x55\xcb\x3c\x10\xf0\x24\x8a\x4a\x2\xea\x90\x25\xf0\xb4\x79\x3a\xef\x6e\xf5\x52\xdf\xb0\xa\xcd\x24\x1c\xd3\x2e\x22\x74\xea\x21\x6f\xe9\xbd\xc8\x3e\x36\x5b\x19\xf1\xca\x99\xa\xb4\xa7\x52\x1a\x4e\xf2\xad\x8d\x56\x85\xbb\x64\x89\xba\x26\xf9\xc7\xe1\x89\x19\x22\x77\xc3\xa8\xfc\xff\xad\xfe\xb9\x48\xae\x12\x30\x9f\x19\xfb\x1b\xef\x14\x87\x8a\x78\x71\xf3\xf4\xb7\x0\x9c\x1d\xb5\x3d\x49\x0\xc\x6\xd4\x50\xf9\x54\x45\xb2\x5b\x43\xdb\x6d\xcf\x1a\xe9\x7a\x7a\xcf\xfc\x8a\x4e\x4d\xb\x7\x63\x28\xd8\xe7\x8\x95\xdf\xa6\x72\x93\x2e\xbb\xa0\x42\x89\x16\xf1\xd9\xc\xf9\xa1\x16\xfd\xd9\x3\xb4\x3b\x8a\xf5\xf6\xe7\x6b\x2e\x8e\x4c\x3d\xe2\xaf\x8\x45\x3\xff\x9\xb6\xeb\x2d\xc6\x1b\x88\x94\xac\x3e\xf1\x9f\xe\xe\x2b\xd5\x0\x4d\x3f\x3b\x53\xae\xaf\x1c\x33\x5f\x55\x6e\x8d\xaf\x5\x7a\x10\x34\xc9\xf4\x66\xcb\x62\x12\xa6\xee\xe8\x1c\x5d\x12\x86\xdb\x6f\x1c\x33\xc4\x1c\xda\x82\x2d\x3b\x59\xfe\xb1\xa4\x59\x41\x86\xd0\xef\xae\xfb\xda\x6d\x11\xb8\xca\xe9\x6e\xff\xf7\xa9\xd9\x70\x30\xfc\x53\xe2\xd7\xa2\x4e\xc7\x91\xd9\x7\x6\xaa\xdd\xb0\x59\x28\x1d\x0\x66\xc5\x54\xc2\xfc\x6\xda\x5\x90\x52\x1d\x37\x66\xee\xf0\xb2\x55\x8a\x5d\xd2\x38\x86\x94\x9b\xfc\x10\x4c\xa1\xb9\x64\x3e\x44\xb8\x5f\xb0\xc\xec\xe0\xc9\xe5\x62\x75\x3f\x9\xd5\xf5\xd9\x26\xba\x9e\xd2\xf4\xb9\x48\xa\xbc\xa2\xd6\x7c\x36\x11\x7d\x26\x81\x89\xcf\xa4\xad\x73\xe\xee\xcc\x6\xa9\xdb\xb1\xfd\xfb\x9\x7f\x90\x42\x37\x2f\xe1\x9c\xf\x6f\xcf\x43\xb5\xd9\x90\xe1\x85\xf5\xa8\xae", -+ .ilen = 529, -+ .result = "\xe6\xc3\xdb\x63\x55\x15\xe3\x5b\xb7\x4b\x27\x8b\x5a\xdd\xc2\xe8\x3a\x6b\xd7\x81\x96\x35\x97\xca\xd7\x68\xe8\xef\xce\xab\xda\x9\x6e\xd6\x8e\xcb\x55\xb5\xe1\xe5\x57\xfd\xc4\xe3\xe0\x18\x4f\x85\xf5\x3f\x7e\x4b\x88\xc9\x52\x44\xf\xea\xaf\x1f\x71\x48\x9f\x97\x6d\xb9\x6f\x0\xa6\xde\x2b\x77\x8b\x15\xad\x10\xa0\x2b\x7b\x41\x90\x3\x2d\x69\xae\xcc\x77\x7c\xa5\x9d\x29\x22\xc2\xea\xb4\x0\x1a\xd2\x7a\x98\x8a\xf9\xf7\x82\xb0\xab\xd8\xa6\x94\x8d\x58\x2f\x1\x9e\x0\x20\xfc\x49\xdc\xe\x3\xe8\x45\x10\xd6\xa8\xda\x55\x10\x9a\xdf\x67\x22\x8b\x43\xab\x0\xbb\x2\xc8\xdd\x7b\x97\x17\xd7\x1d\x9e\x2\x5e\x48\xde\x8e\xcf\x99\x7\x95\x92\x3c\x5f\x9f\xc5\x8a\xc0\x23\xaa\xd5\x8c\x82\x6e\x16\x92\xb1\x12\x17\x7\xc3\xfb\x36\xf5\x6c\x35\xd6\x6\x1f\x9f\xa7\x94\xa2\x38\x63\x9c\xb0\x71\xb3\xa5\xd2\xd8\xba\x9f\x8\x1\xb3\xff\x4\x97\x73\x45\x1b\xd5\xa9\x9c\x80\xaf\x4\x9a\x85\xdb\x32\x5b\x5d\x1a\xc1\x36\x28\x10\x79\xf1\x3c\xbf\x1a\x41\x5c\x4e\xdf\xb2\x7c\x79\x3b\x7a\x62\x3d\x4b\xc9\x9b\x2a\x2e\x7c\xa2\xb1\x11\x98\xa7\x34\x1a\x0\xf3\xd1\xbc\x18\x22\xba\x2\x56\x62\x31\x10\x11\x6d\xe0\x54\x9d\x40\x1f\x26\x80\x41\xca\x3f\x68\xf\x32\x1d\xa\x8e\x79\xd8\xa4\x1b\x29\x1c\x90\x8e\xc5\xe3\xb4\x91\x37\x9a\x97\x86\x99\xd5\x9\xc5\xbb\xa3\x3f\x21\x29\x82\x14\x5c\xab\x25\xfb\xf2\x4f\x58\x26\xd4\x83\xaa\x66\x89\x67\x7e\xc0\x49\xe1\x11\x10\x7f\x7a\xda\x29\x4\xff\xf0\xcb\x9\x7c\x9d\xfa\x3\x6f\x81\x9\x31\x60\xfb\x8\xfa\x74\xd3\x64\x44\x7c\x55\x85\xec\x9c\x6e\x25\xb7\x6c\xc5\x37\xb6\x83\x87\x72\x95\x8b\x9d\xe1\x69\x5c\x31\x95\x42\xa6\x2c\xd1\x36\x47\x1f\xec\x54\xab\xa2\x1c\xd8\x0\xcc\xbc\xd\x65\xe2\x67\xbf\xbc\xea\xee\x9e\xe4\x36\x95\xbe\x73\xd9\xa6\xd9\xf\xa0\xcc\x82\x76\x26\xad\x5b\x58\x6c\x4e\xab\x29\x64\xd3\xd9\xa9\x8\x8c\x1d\xa1\x4f\x80\xd8\x3f\x94\xfb\xd3\x7b\xfc\xd1\x2b\xc3\x21\xeb\xe5\x1c\x84\x23\x7f\x4b\xfa\xdb\x34\x18\xa2\xc2\xe5\x13\xfe\x6c\x49\x81\xd2\x73\xe7\xe2\xd7\xe4\x4f\x4b\x8\x6e\xb1\x12\x22\x10\x9d\xac\x51\x1e\x17\xd9\x8a\xb\x42\x88\x16\x81\x37\x7c\x6a\xf7\xef\x2d\xe3\xd9\xf8\x5f\xe0\x53\x27\x74\xb9\xe2\xd6\x1c\x80\x2c\x52\x65" -+}, { -+ .key = "\x47\x11\xeb\x86\x2b\x2c\xab\x44\x34\xda\x7f\x57\x3\x39\xc\xaf\x2c\x14\xfd\x65\x23\xe9\x8e\x74\xd5\x8\x68\x8\xe7\xb4\x72\xd7", -+ .nonce = "\xdb\x92\xf\x7f\x17\x54\xc\x30", -+ .assoc = "\xd2\xa1\x70\xdb\x7a\xf8\xfa\x27\xba\x73\xf\xbf\x3d\x1e\x82\xb2", -+ .alen = 16, -+ .input = "\xe5\x26\xa4\x3d\xbd\x33\xd0\x4b\x6f\x5\xa7\x6e\x12\x7a\xd2\x74\xa6\xdd\xbd\x95\xeb\xf9\xa4\xf1\x59\x93\x91\x70\xd9\xfe\x9a\xcd\x53\x1f\x3a\xab\xa6\x7c\x9f\xa6\x9e\xbd\x99\xd9\xb5\x97\x44\xd5\x14\x48\x4d\x9d\xc0\xd0\x5\x96\xeb\x4c\x78\x55\x9\x8\x1\x2\x30\x90\x7b\x96\x7a\x7b\x5f\x30\x41\x24\xce\x68\x61\x49\x86\x57\x82\xdd\x53\x1c\x51\x28\x2b\x53\x6e\x2d\xc2\x20\x4c\xdd\x8f\x65\x10\x20\x50\xdd\x9d\x50\xe5\x71\x40\x53\x69\xfc\x77\x48\x11\xb9\xde\xa4\x8d\x58\xe4\xa6\x1a\x18\x47\x81\x7e\xfc\xdd\xf6\xef\xce\x2f\x43\x68\xd6\x6\xe2\x74\x6a\xad\x90\xf5\x37\xf3\x3d\x82\x69\x40\xe9\x6b\xa7\x3d\xa8\x1e\xd2\x2\x7c\xb7\x9b\xe4\xda\x8f\x95\x6\xc5\xdf\x73\xa3\x20\x9a\x49\xde\x9c\xbc\xee\x14\x3f\x81\x5e\xf8\x3b\x59\x3c\xe1\x68\x12\x5a\x3a\x76\x3a\x3f\xf7\x87\x33\xa\x1\xb8\xd4\xed\xb6\xbe\x94\x5e\x70\x40\x56\x67\x1f\x50\x44\x19\xce\x82\x70\x10\x87\x13\x20\xb\x4c\x5a\xb6\xf6\xa7\xae\x81\x75\x1\x81\xe6\x4b\x57\x7c\xdd\x6d\xf8\x1c\x29\x32\xf7\xda\x3c\x2d\xf8\x9b\x25\x6e\x0\xb4\xf7\x2f\xf7\x4\xf7\xa1\x56\xac\x4f\x1a\x64\xb8\x47\x55\x18\x7b\x7\x4d\xbd\x47\x24\x80\x5d\xa2\x70\xc5\xdd\x8e\x82\xd4\xeb\xec\xb2\xc\x39\xd2\x97\xc1\xcb\xeb\xf4\x77\x59\xb4\x87\xef\xcb\x43\x2d\x46\x54\xd1\xa7\xd7\x15\x99\xa\x43\xa1\xe0\x99\x33\x71\xc1\xed\xfe\x72\x46\x33\x8e\x91\x8\x9f\xc8\x2e\xca\xfa\xdc\x59\xd5\xc3\x76\x84\x9f\xa3\x37\x68\xc3\xf0\x47\x2c\x68\xdb\x5e\xc3\x49\x4c\xe8\x92\x85\xe2\x23\xd3\x3f\xad\x32\xe5\x2b\x82\xd7\x8f\x99\xa\x59\x5c\x45\xd9\xb4\x51\x52\xc2\xae\xbf\x80\xcf\xc9\xc9\x51\x24\x2a\x3b\x3a\x4d\xae\xeb\xbd\x22\xc3\xe\xf\x59\x25\x92\x17\xe9\x74\xc7\x8b\x70\x70\x36\x55\x95\x75\x4b\xad\x61\x2b\x9\xbc\x82\xf2\x6e\x94\x43\xae\xc3\xd5\xcd\x8e\xfe\x5b\x9a\x88\x43\x1\x75\xb2\x23\x9\xf7\x89\x83\xe7\xfa\xf9\xb4\x9b\xf8\xef\xbd\x1c\x92\xc1\xda\x7e\xfe\x5\xba\x5a\xcd\x7\x6a\x78\x9e\x5d\xfb\x11\x2f\x79\x38\xb6\xc2\x5b\x6b\x51\xb4\x71\xdd\xf7\x2a\xe4\xf4\x72\x76\xad\xc2\xdd\x64\x5d\x79\xb6\xf5\x7a\x77\x20\x5\x3d\x30\x6\xd4\x4c\xa\x2c\x98\x5a\xb9\xd4\x98\xa9\x3f\xc6\x12\xea\x3b\x4b\xc5\x79\x64\x63\x6b\x9\x54\x3b\x14\x27\xba\x99\x80\xc8\x72\xa8\x12\x90\x29\xba\x40\x54\x97\x2b\x7b\xfe\xeb\xcd\x1\x5\x44\x72\xdb\x99\xe4\x61\xc9\x69\xd6\xb9\x28\xd1\x5\x3e\xf9\xb\x49\xa\x49\xe9\x8d\xe\xa7\x4a\xf\xaf\x32\xd0\xe0\xb2\x3a\x55\x58\xfe\x5c\x28\x70\x51\x23\xb0\x7b\x6a\x5f\x1e\xb8\x17\xd7\x94\x15\x8f\xee\x20\xc7\x42\x25\x3e\x9a\x14\xd7\x60\x72\x39\x47\x48\xa9\xfe\xdd\x47\xa\xb1\xe6\x60\x28\x8c\x11\x68\xe1\xff\xd7\xce\xc8\xbe\xb3\xfe\x27\x30\x9\x70\xd7\xfa\x2\x33\x3a\x61\x2e\xc7\xff\xa4\x2a\xa8\x6e\xb4\x79\x35\x6d\x4c\x1e\x38\xf8\xee\xd4\x84\x4e\x6e\x28\xa7\xce\xc8\xc1\xcf\x80\x5\xf3\x4\xef\xc8\x18\x28\x2e\x8d\x5e\xc\xdf\xb8\x5f\x96\xe8\xc6\x9c\x2f\xe5\xa6\x44\xd7\xe7\x99\x44\xc\xec\xd7\x5\x60\x97\xbb\x74\x77\x58\xd5\xbb\x48\xde\x5a\xb2\x54\x7f\xe\x46\x70\x6a\x6f\x78\xa5\x8\x89\x5\x4e\x7e\xa0\x69\xb4\x40\x60\x55\x77\x75\x9b\x19\xf2\xd5\x13\x80\x77\xf9\x4b\x3f\x1e\xee\xe6\x76\x84\x7b\x8c\xe5\x27\xa8\xa\x91\x1\x68\x71\x8a\x3f\x6\xab\xf6\xa9\xa5\xe6\x72\x92\xe4\x67\xe2\xa2\x46\x35\x84\x55\x7d\xca\xa8\x85\xd0\xf1\x3f\xbe\xd7\x34\x64\xfc\xae\xe3\xe4\x4\x9f\x66\x2\xb9\x88\x10\xd9\xc4\x4c\x31\x43\x7a\x93\xe2\x9b\x56\x43\x84\xdc\xdc\xde\x1d\xa4\x2\xe\xc2\xef\xc3\xf8\x78\xd1\xb2\x6b\x63\x18\xc9\xa9\xe5\x72\xd8\xf3\xb9\xd1\x8a\xc7\x1a\x2\x27\x20\x77\x10\xe5\xc8\xd4\x4a\x47\xe5\xdf\x5f\x1\xaa\xb0\xd4\x10\xbb\x69\xe3\x36\xc8\xe1\x3d\x43\xfb\x86\xcd\xcc\xbf\xf4\x88\xe0\x20\xca\xb7\x1b\xf1\x2f\x5c\xee\xd4\xd3\xa3\xcc\xa4\x1e\x1c\x47\xfb\xbf\xfc\xa2\x41\x55\x9d\xf6\x5a\x5e\x65\x32\x34\x7b\x52\x8d\xd5\xd0\x20\x60\x3\xab\x3f\x8c\xd4\x21\xea\x2a\xd9\xc4\xd0\xd3\x65\xd8\x7a\x13\x28\x62\x32\x4b\x2c\x87\x93\xa8\xb4\x52\x45\x9\x44\xec\xec\xc3\x17\xdb\x9a\x4d\x5c\xa9\x11\xd4\x7d\xaf\x9e\xf1\x2d\xb2\x66\xc5\x1d\xed\xb7\xcd\xb\x25\x5e\x30\x47\x3f\x40\xf4\xa1\xa0\x0\x94\x10\xc5\x6a\x63\x1a\xd5\x88\x92\x8e\x82\x39\x87\x3c\x78\x65\x58\x42\x75\x5b\xdd\x77\x3e\x9\x4e\x76\x5b\xe6\xe\x4d\x38\xb2\xc0\xb8\x95\x1\x7a\x10\xe0\xfb\x7\xf2\xab\x2d\x8c\x32\xed\x2b\xc0\x46\xc2\xf5\x38\x83\xf0\x17\xec\xc1\x20\x6a\x9a\xb\x0\xa0\x98\x22\x50\x23\xd5\x80\x6b\xf6\x1f\xc3\xcc\x97\xc9\x24\x9f\xf3\xaf\x43\x14\xd5\xa0", -+ .ilen = 1040, -+ .result = "\x42\x93\xe4\xeb\x97\xb0\x57\xbf\x1a\x8b\x1f\xe4\x5f\x36\x20\x3c\xef\xa\xa9\x48\x5f\x5f\x37\x22\x3a\xde\xe3\xae\xbe\xad\x7\xcc\xb1\xf6\xf5\xf9\x56\xdd\xe7\x16\x1e\x7f\xdf\x7a\x9e\x75\xb7\xc7\xbe\xbe\x8a\x36\x4\xc0\x10\xf4\x95\x20\x3\xec\xdc\x5\xa1\x7d\xc4\xa9\x2c\x82\xd0\xbc\x8b\xc5\xc7\x45\x50\xf6\xa2\x1a\xb5\x46\x3b\x73\x2\xa6\x83\x4b\x73\x82\x58\x5e\x3b\x65\x2f\xe\xfd\x2b\x59\x16\xce\xa1\x60\x9c\xe8\x3a\x99\xed\x8d\x5a\xcf\xf6\x83\xaf\xba\xd7\x73\x73\x40\x97\x3d\xca\xef\x7\x57\xe6\xd9\x70\xe\x95\xae\xa6\x8d\x4\xcc\xee\xf7\x9\x31\x77\x12\xa3\x23\x97\x62\xb3\x7b\x32\xfb\x80\x14\x48\x81\xc3\xe5\xea\x91\x39\x52\x81\xa2\x4f\xe4\xb3\x9\xff\xde\x5e\xe9\x58\x84\x6e\xf9\x3d\xdf\x25\xea\xad\xae\xe6\x9a\xd1\x89\x55\xd3\xde\x6c\x52\xdb\x70\xfe\x37\xce\x44\xa\xa8\x25\x5f\x92\xc1\x33\x4a\x4f\x9b\x62\x35\xff\xce\xc0\xa9\x60\xce\x52\x0\x97\x51\x35\x26\x2e\xb9\x36\xa9\x87\x6e\x1e\xcc\x91\x78\x53\x98\x86\x5b\x9c\x74\x7d\x88\x33\xe1\xdf\x37\x69\x2b\xbb\xf1\x4d\xf4\xd1\xf1\x39\x93\x17\x51\x19\xe3\x19\x1e\x76\x37\x25\xfb\x9\x27\x6a\xab\x67\x6f\x14\x12\x64\xe7\xc4\x7\xdf\x4d\x17\xbb\x6d\xe0\xe9\xb9\xab\xca\x10\x68\xaf\x7e\xb7\x33\x54\x73\x7\x6e\xf7\x81\x97\x9c\x5\x6f\x84\x5f\xd2\x42\xfb\x38\xcf\xd1\x2f\x14\x30\x88\x98\x4d\x5a\xa9\x76\xd5\x4f\x3e\x70\x6c\x85\x76\xd7\x1\xa0\x1a\xc8\x4e\xaa\xac\x78\xfe\x46\xde\x6a\x5\x46\xa7\x43\xc\xb9\xde\xb9\x68\xfb\xce\x42\x99\x7\x4d\xb\x3b\x5a\x30\x35\xa8\xf9\x3a\x73\xef\xf\xdb\x1e\x16\x42\xc4\xba\xae\x58\xaa\xf8\xe5\x75\x2f\x1b\x15\x5c\xfd\xa\x97\xd0\xe4\x37\x83\x61\x5f\x43\xa6\xc7\x3f\x38\x59\xe6\xeb\xa3\x90\xc3\xaa\xaa\x5a\xd3\x34\xd4\x17\xc8\x65\x3e\x57\xbc\x5e\xdd\x9e\xb7\xf0\x2e\x5b\xb2\x1f\x8a\x8\xd\x45\x91\xb\x29\x53\x4f\x4c\x5a\x73\x56\xfe\xaf\x41\x1\x39\xa\x24\x3c\x7e\xbe\x4e\x53\xf3\xeb\x6\x66\x51\x28\x1d\xbd\x41\xa\x1\xab\x16\x47\x27\x47\x47\xf7\xcb\x46\xa\x70\x9e\x1\x9c\x9\xe1\x2a\x0\x1a\xd8\xd4\x79\x9d\x80\x15\x8e\x53\x2a\x65\x83\x78\x3e\x3\x0\x7\x12\x1f\x33\x3e\x7b\x13\x37\xf1\xc3\xef\xb7\xc1\x20\x3c\x3e\x67\x66\x5d\x88\xa7\x7d\x33\x50\x77\xb0\x28\x8e\xe7\x2c\x2e\x7a\xf4\x3c\x8d\x74\x83\xaf\x8e\x87\xf\xe4\x50\xff\x84\x5c\x47\xc\x6a\x49\xbf\x42\x86\x77\x15\x48\xa5\x90\x5d\x93\xd6\x2a\x11\xd5\xd5\x11\xaa\xce\xe7\x6f\xa5\xb0\x9\x2c\x8d\xd3\x92\xf0\x5a\x2a\xda\x5b\x1e\xd5\x9a\xc4\xc4\xf3\x49\x74\x41\xca\xe8\xc1\xf8\x44\xd6\x3c\xae\x6c\x1d\x9a\x30\x4\x4d\x27\xe\xb1\x5f\x59\xa2\x24\xe8\xe1\x98\xc5\x6a\x4c\xfe\x41\xd2\x27\x42\x52\xe1\xe9\x7d\x62\xe4\x88\xf\xad\xb2\x70\xcb\x9d\x4c\x27\x2e\x76\x1e\x1a\x63\x65\xf5\x3b\xf8\x57\x69\xeb\x5b\x38\x26\x39\x33\x25\x45\x3e\x91\xb8\xd8\xc7\xd5\x42\xc0\x22\x31\x74\xf4\xbc\xc\x23\xf1\xca\xc1\x8d\xd7\xbe\xc9\x62\xe4\x8\x1a\xcf\x36\xd5\xfe\x55\x21\x59\x91\x87\x87\xdf\x6\xdb\xdf\x96\x45\x58\xda\x5\xcd\x50\x4d\xd2\x7d\x5\x18\x73\x6a\x8d\x11\x85\xa6\x88\xe8\xda\xe6\x30\x33\xa4\x89\x31\x75\xbe\x69\x43\x84\x43\x50\x87\xdd\x71\x36\x83\xc3\x78\x74\x24\xa\xed\x7b\xdb\xa4\x24\xb\xb9\x7e\x5d\xff\xde\xb1\xef\x61\x5a\x45\x33\xf6\x17\x7\x8\x98\x83\x92\xf\x23\x6d\xe6\xaa\x17\x54\xad\x6a\xc8\xdb\x26\xbe\xb8\xb6\x8\xfa\x68\xf1\xd7\x79\x6f\x18\xb4\x9e\x2d\x3f\x1b\x64\xaf\x8d\x6\xe\x49\x28\xe0\x5d\x45\x68\x13\x87\xfa\xde\x40\x7b\xd2\xc3\x94\xd5\xe1\xd9\xc2\xaf\x55\x89\xeb\xb4\x12\x59\xa8\xd4\xc5\x29\x66\x38\xe6\xac\x22\x22\xd9\x64\x9b\x34\xa\x32\x9f\xc2\xbf\x17\x6c\x3f\x71\x7a\x38\x6b\x98\xfb\x49\x36\x89\xc9\xe2\xd6\xc7\x5d\xd0\x69\x5f\x23\x35\xc9\x30\xe2\xfd\x44\x58\x39\xd7\x97\xfb\x5c\x0\xd5\x4f\x7a\x1a\x95\x8b\x62\x4b\xce\xe5\x91\x21\x7b\x30\x0\xd6\xdd\x6d\x2\x86\x49\xf\x3c\x1a\x27\x3c\xd3\xe\x71\xf2\xff\xf5\x2f\x87\xac\x67\x59\x81\xa3\xf7\xf8\xd6\x11\xc\x84\xa9\x3\xee\x2a\xc4\xf3\x22\xab\x7c\xe2\x25\xf5\x67\xa3\xe4\x11\xe0\x59\xb3\xca\x87\xa0\xae\xc9\xa6\x62\x1b\x6e\x4d\x2\x6b\x7\x9d\xfd\xd0\x92\x6\xe1\xb2\x9a\x4a\x1f\x1f\x13\x49\x99\x97\x8\xde\x7f\x98\xaf\x51\x98\xee\x2c\xcb\xf0\xb\xc6\xb6\xb7\x2d\x9a\xb1\xac\xa6\xe3\x15\x77\x9d\x6b\x1a\xe4\xfc\x8b\xf2\x17\x59\x8\x4\x58\x81\x9d\x1b\x1b\x69\x55\xc2\xb4\x3c\x1f\x50\xf1\x7f\x77\x90\x4c\x66\x40\x5a\xc0\x33\x1f\xcb\x5\x6d\x5c\x6\x87\x52\xa2\x8f\x26\xd5\x4f" -+}, { -+ .key = "\x35\x4e\xb5\x70\x50\x42\x8a\x85\xf2\xfb\xed\x7b\xd0\x9e\x97\xca\xfa\x98\x66\x63\xee\x37\xcc\x52\xfe\xd1\xdf\x95\x15\x34\x29\x38", -+ .nonce = "\xfd\x87\xd4\xd8\x62\xfd\xec\xaa", -+ .assoc = "\xd6\x31\xda\x5d\x42\x5e\xd7", -+ .alen = 7, -+ .input = "\x6a\xfc\x4b\x25\xdf\xc0\xe4\xe8\x17\x4d\x4c\xc9\x7e\xde\x3a\xcc\x3c\xba\x6a\x77\x47\xdb\xe3\x74\x7a\x4d\x5f\x8d\x37\x55\x80\x73\x90\x66\x5d\x3a\x7d\x5d\x86\x5e\x8d\xfd\x83\xff\x4e\x74\x6f\xf9\xe6\x70\x17\x70\x3e\x96\xa7\x7e\xcb\xab\x8f\x58\x24\x9b\x1\xfd\xcb\xe6\x4d\x9b\xf0\x88\x94\x57\x66\xef\x72\x4c\x42\x6e\x16\x19\x15\xea\x70\x5b\xac\x13\xdb\x9f\x18\xe2\x3c\x26\x97\xbc\xdc\x45\x8c\x6c\x24\x69\x9c\xf7\x65\x1e\x18\x59\x31\x7c\xe4\x73\xbc\x39\x62\xc6\x5c\x9f\xbf\xfa\x90\x3\xc9\x72\x26\xb6\x1b\xc2\xb7\x3f\xf2\x13\x77\xf2\x8d\xb9\x47\xd0\x53\xdd\xc8\x91\x83\x8b\xb1\xce\xa3\xfe\xcd\xd9\xdd\x92\x7b\xdb\xb8\xfb\xc9\x2d\x1\x59\x39\x52\xad\x1b\xec\xcf\xd7\x70\x13\x21\xf5\x47\xaa\x18\x21\x5c\xc9\x9a\xd2\x6b\x5\x9c\x1\xa1\xda\x35\x5d\xb3\x70\xe6\xa9\x80\x8b\x91\xb7\xb3\x5f\x24\x9a\xb7\xd1\x6b\xa1\x1c\x50\xba\x49\xe0\xee\x2e\x75\xac\x69\xc0\xeb\x3\xdd\x19\xe5\xf6\x6\xdd\xc3\xd7\x2b\x7\x7\x30\xa7\x19\xc\xbf\xe6\x18\xcc\xb1\x1\x11\x85\x77\x1d\x96\xa7\xa3\x0\x84\x2\xa2\x83\x68\xda\x17\x27\xc8\x7f\x23\xb7\xf4\x13\x85\xcf\xdd\x7a\x7d\x24\x57\xfe\x5\x93\xf5\x74\xce\xed\xc\x20\x98\x8d\x92\x30\xa1\x29\x23\x1a\xa0\x4f\x69\x56\x4c\xe1\xc8\xce\xf6\x9a\xc\xa4\xfa\x4\xf6\x62\x95\xf2\xfa\xc7\x40\x68\x40\x8f\x41\xda\xb4\x26\x6f\x70\xab\x40\x61\xa4\xe\x75\xfb\x86\xeb\x9d\x9a\x1f\xec\x76\x99\xe7\xea\xaa\x1e\x2d\xb5\xd4\xa6\x1a\xb8\x61\xa\x1d\x16\x5b\x98\xc2\x31\x40\xe7\x23\x1d\x66\x99\xc8\xc0\xd7\xce\xf3\x57\x40\x4\x3f\xfc\xea\xb3\xfc\xd2\xd3\x99\xa4\x94\x69\xa0\xef\xd1\x85\xb3\xa6\xb1\x28\xbf\x94\x67\x22\xc3\x36\x46\xf8\xd2\xf\x5f\xf4\x59\x80\xe6\x2d\x43\x8\x7d\x19\x9\x97\xa7\x4c\x3d\x8d\xba\x65\x62\xa3\x71\x33\x29\x62\xdb\xc1\x33\x34\x1a\x63\x33\x16\xb6\x64\x7e\xab\x33\xf0\xe6\x26\x68\xba\x1d\x2e\x38\x8\xe6\x2\xd3\x25\x2c\x47\x23\x58\x34\xf\x9d\x63\x4f\x63\xbb\x7f\x3b\x34\x38\xa7\xb5\x8d\x65\xd9\x9f\x79\x55\x3e\x4d\xe7\x73\xd8\xf6\x98\x97\x84\x60\x9c\xc8\xa9\x3c\xf6\xdc\x12\x5c\xe1\xbb\xb\x8b\x98\x9c\x9d\x26\x7c\x4a\xe6\x46\x36\x58\x21\x4a\xee\xca\xd7\x3b\xc2\x6c\x49\x2f\xe5\xd5\x3\x59\x84\x53\xcb\xfe\x92\x71\x2e\x7c\x21\xcc\x99\x85\x7f\xb8\x74\x90\x13\x42\x3f\xe0\x6b\x1d\xf2\x4d\x54\xd4\xfc\x3a\x5\xe6\x74\xaf\xa6\xa0\x2a\x20\x23\x5d\x34\x5c\xd9\x3e\x4e\xfa\x93\xe7\xaa\xe9\x6f\x8\x43\x67\x41\xc5\xad\xfb\x31\x95\x82\x73\x32\xd8\xa6\xa3\xed\xe\x2d\xf6\x5f\xfd\x80\xa6\x7a\xe0\xdf\x78\x15\x29\x74\x33\xd0\x9e\x83\x86\x72\x22\x57\x29\xb9\x9e\x5d\xd3\x1a\xb5\x96\x72\x41\x3d\xf1\x64\x43\x67\xee\xaa\x5c\xd3\x9a\x96\x13\x11\x5d\xf3\xc\x87\x82\x1e\x41\x9e\xd0\x27\xd7\x54\x3b\x67\x73\x9\x91\xe9\xd5\x36\xa7\xb5\x55\xe4\xf3\x21\x51\x49\x22\x7\x55\x4f\x44\x4b\xd2\x15\x93\x17\x2a\xfa\x4d\x4a\x57\xdb\x4c\xa6\xeb\xec\x53\x25\x6c\x21\xed\x0\x4c\x3b\xca\x14\x57\xa9\xd6\x6a\xcd\x8d\x5e\x74\xac\x72\xc1\x97\xe5\x1b\x45\x4e\xda\xfc\xcc\x40\xe8\x48\x88\xb\xa3\xe3\x8d\x83\x42\xc3\x23\xfd\x68\xb5\x8e\xf1\x9d\x63\x77\xe9\xa3\x8e\x8c\x26\x6b\xbd\x72\x73\x35\xc\x3\xf8\x43\x78\x52\x71\x15\x1f\x71\x5d\x6e\xed\xb9\xcc\x86\x30\xdb\x2b\xd3\x82\x88\x23\x71\x90\x53\x5c\xa9\x2f\x76\x1\xb7\x9a\xfe\x43\x55\xa3\x4\x9b\xe\xe4\x59\xdf\xc9\xe9\xb1\xea\x29\x28\x3c\x5c\xae\x72\x84\xb6\xc6\xeb\xc\x27\x7\x74\x90\xd\x31\xb0\x0\x77\xe9\x40\x70\x6f\x68\xa7\xfd\x6\xec\x4b\xc0\xb7\xac\xbc\x33\xb7\x6d\xa\xbd\x12\x1b\x59\xcb\xdd\x32\xf5\x1d\x94\x57\x76\x9e\xc\x18\x98\x71\xd7\x2a\xdb\xb\x7b\xa7\x71\xb7\x67\x81\x23\x96\xae\xb9\x7e\x32\x43\x92\x8a\x19\xa0\xc4\xd4\x3b\x57\xf9\x4a\x2c\xfb\x51\x46\xbb\xcb\x5d\xb3\xef\x13\x93\x6e\x68\x42\x54\x57\xd3\x6a\x3a\x8f\x9d\x66\xbf\xbd\x36\x23\xf5\x93\x83\x7b\x9c\xc0\xdd\xc5\x49\xc0\x64\xed\x7\x12\xb3\xe6\xe4\xe5\x38\x95\x23\xb1\xa0\x3b\x1a\x61\xda\x17\xac\xc3\x58\xdd\x74\x64\x22\x11\xe8\x32\x1d\x16\x93\x85\x99\xa5\x9c\x34\x55\xb1\xe9\x20\x72\xc9\x28\x7b\x79\x0\xa1\xa6\xa3\x27\x40\x18\x8a\x54\xe0\xcc\xe8\x4e\x8e\x43\x96\xe7\x3f\xc8\xe9\xb2\xf9\xc9\xda\x4\x71\x50\x47\xe4\xaa\xce\xa2\x30\xc8\xe4\xac\xc7\xd\x6\x2e\xe6\xe8\x80\x36\x29\x9e\x1\xb8\xc3\xf0\xa0\x5d\x7a\xca\x4d\xa0\x57\xbd\x2a\x45\xa7\x7f\x9c\x93\x7\x8f\x35\x67\x92\xe3\xe9\x7f\xa8\x61\x43\x9e\x25\x4f\x33\x76\x13\x6e\x12\xb9\xdd\xa4\x7c\x8\x9f\x7c\xe7\xa\x8d\x84\x6\xa4\x33\x17\x34\x5e\x10\x7c\xc0\xa8\x3d\x1f\x42\x20\x51\x65\x5d\x9\xc3\xaa\xc0\xc8\xd\xf0\x79\xbc\x20\x1b\x95\xe7\x6\x7d\x47\x20\x3\x1a\x74\xdd\xe2\xd4\xae\x38\x71\x9b\xf5\x80\xec\x8\x4e\x56\xba\x76\x12\x1a\xdf\x48\xf3\xae\xb3\xe6\xe6\xbe\xc0\x91\x2e\x1\xb3\x1\x86\xa2\xb9\x52\xd1\x21\xae\xd4\x97\x1d\xef\x41\x12\x95\x3d\x48\x45\x1c\x56\x32\x8f\xb8\x43\xbb\x19\xf3\xca\xe9\xeb\x6d\x84\xbe\x86\x6\xe2\x36\xb2\x62\x9d\xd3\x4c\x48\x18\x54\x13\x4e\xcf\xfd\xba\x84\xb9\x30\x53\xcf\xfb\xb9\x29\x8f\xdc\x9f\xef\x60\xb\x64\xf6\x8b\xee\xa6\x91\xc2\x41\x6c\xf6\xfa\x79\x67\x4b\xc1\x3f\xaf\x9\x81\xd4\x5d\xcb\x9\xdf\x36\x31\xc0\x14\x3c\x7c\xe\x65\x95\x99\x6d\xa3\xf4\xd7\x38\xee\x1a\x2b\x37\xe2\xa4\x3b\x4b\xd0\x65\xca\xf8\xc3\xe8\x15\x20\xef\xf2\x0\xfd\x1\x9\xc5\xc8\x17\x4\x93\xd0\x93\x3\x55\xc5\xfe\x32\xa3\x3e\x28\x2d\x3b\x93\x8a\xcc\x7\x72\x80\x8b\x74\x16\x24\xbb\xda\x94\x39\x30\x8f\xb1\xcd\x4a\x90\x92\x7c\x14\x8f\x95\x4e\xac\x9b\xd8\x8f\x1a\x87\xa4\x32\x27\x8a\xba\xf7\x41\xcf\x84\x37\x19\xe6\x6\xf5\xe\xcf\x36\xf5\x9e\x6c\xde\xbc\xff\x64\x7e\x4e\x59\x57\x48\xfe\x14\xf7\x9c\x93\x5d\x15\xad\xcc\x11\xb1\x17\x18\xb2\x7e\xcc\xab\xe9\xce\x7d\x77\x5b\x51\x1b\x1e\x20\xa8\x32\x6\xe\x75\x93\xac\xdb\x35\x37\x1f\xe9\x19\x1d\xb4\x71\x97\xd6\x4e\x2c\x8\xa5\x13\xf9\xe\x7e\x78\x6e\x14\xe0\xa9\xb9\x96\x4c\x80\x82\xba\x17\xb3\x9d\x69\xb0\x84\x46\xff\xf9\x52\x79\x94\x58\x3a\x62\x90\x15\x35\x71\x10\x37\xed\xa1\x8e\x53\x6e\xf4\x26\x57\x93\x15\x93\xf6\x81\x2c\x5a\x10\xda\x92\xad\x2f\xdb\x28\x31\x2d\x55\x4\xd2\x6\x28\x8c\x1e\xdc\xea\x54\xac\xff\xb7\x6c\x30\x15\xd4\xb4\xd\x0\x93\x57\xdd\xd2\x7\x7\x6\xd9\x43\x9b\xcd\x3a\xf4\x7d\x4c\x36\x5d\x23\xa2\xcc\x57\x40\x91\xe9\x2c\x2f\x2c\xd5\x30\x9b\x17\xb0\xc9\xf7\xa7\x2f\xd1\x93\x20\x6b\xc6\xc1\xe4\x6f\xcb\xd1\xe7\x9\xf\x9e\xdc\xaa\x9f\x2f\xdf\x56\x9f\xd4\x33\x4\xaf\xd3\x6c\x58\x61\xf0\x30\xec\xf2\x7f\xf2\x9c\xdf\x39\xbb\x6f\xa2\x8c\x7e\xc4\x22\x51\x71\xc0\x4d\x14\x1a\xc4\xcd\x4\xd9\x87\x8\x50\x5\xcc\xaf\xf6\xf0\x8f\x92\x54\x58\xc2\xc7\x9\x7a\x59\x2\x5\xe8\xb0\x86\xd9\xbf\x7b\x35\x51\x4d\xaf\x8\x97\x2c\x65\xda\x2a\x71\x3a\xa8\x51\xcc\xf2\x73\x27\xc3\xfd\x62\xcf\xe3\xb2\xca\xcb\xbe\x1a\xa\xa1\x34\x7b\x77\xc4\x62\x68\x78\x5f\x94\x7\x4\x65\x16\x4b\x61\xcb\xff\x75\x26\x50\x66\x1f\x6e\x93\xf8\xc5\x51\xeb\xa4\x4a\x48\x68\x6b\xe2\x5e\x44\xb2\x50\x2c\x6c\xae\x79\x4e\x66\x35\x81\x50\xac\xbc\x3f\xb1\xc\xf3\x5\x3c\x4a\xa3\x6c\x2a\x79\xb4\xb7\xab\xca\xc7\x9b\x8e\xcd\x5f\x11\x3\xcb\x30\xa3\xab\xda\xfe\x64\xb9\xbb\xd8\x5e\x3a\x1a\x56\xe5\x5\x48\x90\x1e\x61\x69\x1b\x22\xe6\x1a\x3c\x75\xad\x1f\x37\x28\xdc\xe4\x6d\xbd\x42\xdc\xd3\xc8\xb6\x1c\x48\xfe\x94\x77\x7f\xbd\x62\xac\xa3\x47\x27\xcf\x5f\xd9\xdb\xaf\xec\xf7\x5e\xc1\xb0\x9d\x1\x26\x99\x7e\x8f\x3\x70\xb5\x42\xbe\x67\x28\x1b\x7c\xbd\x61\x21\x97\xcc\x5c\xe1\x97\x8f\x8d\xde\x2b\xaa\xa7\x71\x1d\x1e\x2\x73\x70\x58\x32\x5b\x1d\x67\x3d\xe0\x74\x4f\x3\xf2\x70\x51\x79\xf1\x61\x70\x15\x74\x9d\x23\x89\xde\xac\xfd\xde\xd0\x1f\xc3\x87\x44\x35\x4b\xe5\xb0\x60\xc5\x22\xe4\x9e\xca\xeb\xd5\x3a\x9\x45\xa4\xdb\xfa\x3f\xeb\x1b\xc7\xc8\x14\x99\x51\x92\x10\xed\xed\x28\xe0\xa1\xf8\x26\xcf\xcd\xcb\x63\xa1\x3b\xe3\xdf\x7e\xfe\xa6\xf0\x81\x9a\xbf\x55\xde\x54\xd5\x56\x60\x98\x10\x68\xf4\x38\x96\x8e\x6f\x1d\x44\x7f\xd6\x2f\xfe\x55\xfb\xc\x7e\x67\xe2\x61\x44\xed\xf2\x35\x30\x5d\xe9\xc7\xd6\x6d\xe0\xa0\xed\xf3\xfc\xd8\x3e\xa\x7b\xcd\xaf\x65\x68\x18\xc0\xec\x4\x1c\x74\x6d\xe2\x6e\x79\xd4\x11\x2b\x62\xd5\x27\xad\x4f\x1\x59\x73\xcc\x6a\x53\xfb\x2d\xd5\x4e\x99\x21\x65\x4d\xf5\x82\xf7\xd8\x42\xce\x6f\x3d\x36\x47\xf1\x5\x16\xe8\x1b\x6a\x8f\x93\xf2\x8f\x37\x40\x12\x28\xa3\xe6\xb9\x17\x4a\x1f\xb1\xd1\x66\x69\x86\xc4\xfc\x97\xae\x3f\x8f\x1e\x2b\xdf\xcd\xf9\x3c", -+ .ilen = 1949, -+ .result = "\x7a\x57\xf2\xc7\x6\x3f\x50\x7b\x36\x1a\x66\x5c\xb9\xe\x5e\x3b\x45\x60\xbe\x9a\x31\x9f\xff\x5d\x66\x34\xb4\xdc\xfb\x9d\x8e\xee\x6a\x33\xa4\x7\x3c\xf9\x4c\x30\xa1\x24\x52\xf9\x50\x46\x88\x20\x2\x32\x3a\xe\x99\x63\xaf\x1f\x15\x28\x2a\x5\xff\x57\x59\x5e\x18\xa1\x1f\xd0\x92\x5c\x88\x66\x1b\x0\x64\xa5\x93\x8d\x6\x46\xb0\x64\x8b\x8b\xef\x99\x5\x35\x85\xb3\xf3\x33\xbb\xec\x66\xb6\x3d\x57\x42\xe3\xb4\xc6\xaa\xb0\x41\x2a\xb9\x59\xa9\xf6\x3e\x15\x26\x12\x3\x21\x4c\x74\x43\x13\x2a\x3\x27\x9\xb4\xfb\xe7\xb7\x40\xff\x5e\xce\x48\x9a\x60\xe3\x8b\x80\x8c\x38\x2d\xcb\x93\x37\x74\x5\x52\x6f\x73\x3e\xc3\xbc\xca\x72\xa\xeb\xf1\x3b\xa0\x95\xdc\x8a\xc4\xa9\xdc\xca\x44\xd8\x8\x63\x6a\x36\xd3\x3c\xb8\xac\x46\x7d\xfd\xaa\xeb\x3e\xf\x45\x8f\x49\xda\x2b\xf2\x12\xbd\xaf\x67\x8a\x63\x48\x4b\x55\x5f\x6d\x8c\xb9\x76\x34\x84\xae\xc2\xfc\x52\x64\x82\xf7\xb0\x6\xf0\x45\x73\x12\x50\x30\x72\xea\x78\x9a\xa8\xaf\xb5\xe3\xbb\x77\x52\xec\x59\x84\xbf\x6b\x8f\xce\x86\x5e\x1f\x23\xe9\xfb\x8\x86\xf7\x10\xb9\xf2\x44\x96\x44\x63\xa9\xa8\x78\x0\x23\xd6\xc7\xe7\x6e\x66\x4f\xcc\xee\x15\xb3\xbd\x1d\xa0\xe5\x9c\x1b\x24\x2c\x4d\x3c\x62\x35\x9c\x88\x59\x9\xdd\x82\x1b\xcf\xa\x83\x6b\x3f\xae\x3\xc4\xb4\xdd\x7e\x5b\x28\x76\x25\x96\xd9\xc9\x9d\x5f\x86\xfa\xf6\xd7\xd2\xe6\x76\x1d\xf\xa1\xdc\x74\x5\x1b\x1d\xe0\xcd\x16\xb0\xa8\x8a\x34\x7b\x15\x11\x77\xe5\x7b\x7e\x20\xf7\xda\x38\xda\xce\x70\xe9\xf5\x6c\xd9\xbe\xc\x4c\x95\x4c\xc2\x9b\x34\x55\x55\xe1\xf3\x46\x8e\x48\x74\x14\x4f\x9d\xc9\xf5\xe8\x1a\xf0\x11\x4a\xc1\x8d\xe0\x93\xa0\xbe\x9\x1c\x2b\x4e\xf\xb2\x87\x8b\x84\xfe\x92\x32\x14\xd7\x93\xdf\xe7\x44\xbc\xc5\xae\x53\x69\xd8\xb3\x79\x37\x80\xe3\x17\x5c\xec\x53\x0\x9a\xe3\x8e\xdc\x38\xb8\x66\xf0\xd3\xad\x1d\x2\x96\x86\x3e\x9d\x3b\x5d\xa5\x7f\x21\x10\xf1\x1f\x13\x20\xf9\x57\x87\x20\xf5\x5f\xf1\x17\x48\xa\x51\x5a\xcd\x19\x3\xa6\x5a\xd1\x12\x97\xe9\x48\xe2\x1d\x83\x75\x50\xd9\x75\x7d\x6a\x82\xa1\xf9\x4e\x54\x87\x89\xc9\xc\xb7\x5b\x6a\x91\xc1\x9c\xb2\xa9\xdc\x9a\xa4\x49\xa\x6d\xd\xbb\xde\x86\x44\xdd\x5d\x89\x2b\x96\xf\x23\x95\xad\xcc\xa2\xb3\xb9\x7e\x74\x38\xba\x9f\x73\xae\x5f\xf8\x68\xa2\xe0\xa9\xce\xbd\x40\xd4\x4c\x6b\xd2\x56\x62\xb0\xcc\x63\x7e\x5b\xd3\xae\xd1\x75\xce\xbb\xb4\x5b\xa8\xf8\xb4\xac\x71\x75\xaa\xc9\x9f\xbb\x6c\xad\xf\x55\x5d\xe8\x85\x7d\xf9\x21\x35\xea\x92\x85\x2b\x0\xec\x84\x90\xa\x63\x96\xe4\x6b\xa9\x77\xb8\x91\xf8\x46\x15\x72\x63\x70\x1\x40\xa3\xa5\x76\x62\x2b\xbf\xf1\xe5\x8d\x9f\xa3\xfa\x9b\x3\xbe\xfe\x65\x6f\xa2\x29\xd\x54\xb4\x71\xce\xa9\xd6\x3d\x88\xf9\xaf\x6b\xa8\x9e\xf4\x16\x96\x36\xb9\x0\xdc\x10\xab\xb5\x8\x31\x1f\x0\xb1\x3c\xd9\x38\x3e\xc6\x4\xa7\x4e\xe8\xae\xed\x98\xc2\xf7\xb9\x0\x5f\x8c\x60\xd1\xe5\x15\xf7\xae\x1e\x84\x88\xd1\xf6\xbc\x3a\x89\x35\x22\x83\x7c\xca\xf0\x33\x82\x4c\x79\x3c\xfd\xb1\xae\x52\x62\x55\xd2\x41\x60\xc6\xbb\xfa\xe\x59\xd6\xa8\xfe\x5d\xed\x47\x3d\xe0\xea\x1f\x6e\x43\x51\xec\x10\x52\x56\x77\x42\x6b\x52\x87\xd8\xec\xe0\xaa\x76\xa5\x84\x2a\x22\x24\xfd\x92\x40\x88\xd5\x85\x1c\x1f\x6b\x47\xa0\xc4\xe4\xef\xf4\xea\xd7\x59\xac\x2a\x9e\x8c\xfa\x1f\x42\x8\xfe\x4f\x74\xa0\x26\xf5\xb3\x84\xf6\x58\x5f\x26\x66\x3e\xd7\xe4\x22\x91\x13\xc8\xac\x25\x96\x23\xd8\x9\xea\x45\x75\x23\xb8\x5f\xc2\x90\x8b\x9\xc4\xfc\x47\x6c\x6d\xa\xef\x69\xa4\x38\x19\xcf\x7d\xf9\x9\x73\x9b\x60\x5a\xf7\x37\xb5\xfe\x9f\xe3\x2b\x4c\xd\x6e\x19\xf1\xd6\xc0\x70\xf3\x9d\x22\x3c\xf9\x49\xce\x30\x8e\x44\xb5\x76\x15\x8f\x52\xfd\xa5\x4\xb8\x55\x6a\x36\x59\x7c\xc4\x48\xb8\xd7\xab\x5\x66\xe9\x5e\x21\x6f\x6b\x36\x29\xbb\xe9\xe3\xa2\x9a\xa8\xcd\x55\x25\x11\xba\x5a\x58\xa0\xde\xae\x19\x2a\x48\x5a\xff\x36\xcd\x6d\x16\x7a\x73\x38\x46\xe5\x47\x59\xc8\xa2\xf6\xe2\x6c\x83\xc5\x36\x2c\x83\x7d\xb4\x1\x5\x69\xe7\xaf\x5c\xc4\x64\x82\x12\x21\xef\xf7\xd1\x7d\xb8\x8d\x8c\x98\x7c\x5f\x7d\x92\x88\xb9\x94\x7\x9c\xd8\xe9\x9c\x17\x38\xe3\x57\x6c\xe0\xdc\xa5\x92\x42\xb3\xbd\x50\xa2\x7e\xb5\xb1\x52\x72\x3\x97\xd8\xaa\x9a\x1e\x75\x41\x11\xa3\x4f\xcc\xd4\xe3\x73\xad\x96\xdc\x47\x41\x9f\xb0\xbe\x79\x91\xf5\xb6\x18\xfe\xc2\x83\x18\x7d\x73\xd9\x4f\x83\x84\x3\xb3\xf0\x77\x66\x3d\x83\x63\x2e\x2c\xf9\xdd\xa6\x1f\x89\x82\xb8\x23\x42\xeb\xe2\xca\x70\x82\x61\x41\xa\x6d\x5f\x75\xc5\xe2\xc4\x91\x18\x44\x22\xfa\x34\x10\xf5\x20\xdc\xb7\xdd\x2a\x20\x77\xf5\xf9\xce\xdb\xa0\xa\x52\x2a\x4e\xdd\xcc\x97\xdf\x5\xe4\x5e\xb7\xaa\xf0\xe2\x80\xff\xba\x1a\xf\xac\xdf\x2\x32\xe6\xf7\xc7\x17\x13\xb7\xfc\x98\x48\x8c\xd\x82\xc9\x80\x7a\xe2\xa\xc5\xb4\xde\x7c\x3c\x79\x81\xe\x28\x65\x79\x67\x82\x69\x44\x66\x9\xf7\x16\x1a\xf9\x7d\x80\xa1\x79\x14\xa9\xc8\x20\xfb\xa2\x46\xbe\x8\x35\x17\x58\xc1\x1a\xda\x2a\x6b\x2e\x1e\xe6\x27\x55\x7b\x19\xe2\xfb\x64\xfc\x5e\x15\x54\x3c\xe7\xc2\x11\x50\x30\xb8\x72\x3\xb\x1a\x9f\x86\x27\x11\x5c\x6\x2b\xbd\x75\x1a\xa\xda\x1\xfa\x5c\x4a\xc1\x80\x3a\x6e\x30\xc8\x2c\xeb\x56\xec\x89\xfa\x35\x7b\xb2\xf0\x97\x8\x86\x53\xbe\xbd\x40\x41\x38\x1c\xb4\x8b\x79\x2e\x18\x96\x94\xde\xe8\xca\xe5\x9f\x92\x9f\x15\x5d\x56\x60\x5c\x9\xf9\x16\xf4\x17\xf\xf6\x4c\xda\xe6\x67\x89\x9f\xca\x6c\xe7\x9b\x4\x62\xe\x26\xa6\x52\xbd\x29\xff\xc7\xa4\x96\xe6\x6a\x2\xa5\x2e\x7b\xfe\x97\x68\x3e\x2e\x5f\x3b\xf\x36\xd6\x98\x19\x59\x48\xd2\xc6\xe1\x55\x1a\x6e\xd6\xed\x2c\xba\xc3\x9e\x64\xc9\x95\x86\x35\x5e\x3e\x88\x69\x99\x4b\xee\xbe\x9a\x99\xb5\x6e\x58\xae\xdd\x22\xdb\xdd\x6b\xfc\xaf\x90\xa3\x3d\xa4\xc1\x15\x92\x18\x8d\xd2\x4b\x7b\x6\xd1\x37\xb5\xe2\x7c\x2c\xf0\x25\xe4\x94\x2a\xbd\xe3\x82\x70\x78\xa3\x82\x10\x5a\x90\xd7\xa4\xfa\xaf\x1a\x88\x59\xdc\x74\x12\xb4\x8e\xd7\x19\x46\xf4\x84\x69\x9f\xbb\x70\xa8\x4c\x52\x81\xa9\xff\x76\x1c\xae\xd8\x11\x3d\x7f\x7d\xc5\x12\x59\x28\x18\xc2\xa2\xb7\x1c\x88\xf8\xd6\x1b\xa6\x7d\x9e\xde\x29\xf8\xed\xff\xeb\x92\x24\x4f\x5\xaa\xd9\x49\xba\x87\x59\x51\xc9\x20\x5c\x9b\x74\xcf\x3\xd9\x2d\x34\xc7\x5b\xa5\x40\xb2\x99\xf5\xcb\xb4\xf6\xb7\x72\x4a\xd6\xbd\xb0\xf3\x93\xe0\x1b\xa8\x4\x1e\x35\xd4\x80\x20\xf4\x9c\x31\x6b\x45\xb9\x15\xb0\x5e\xdd\xa\x33\x9c\x83\xcd\x58\x89\x50\x56\xbb\x81\x0\x91\x32\xf3\x1b\x3e\xcf\x45\xe1\xf9\xe1\x2c\x26\x78\x93\x9a\x60\x46\xc9\xb5\x5e\x6a\x28\x92\x87\x3f\x63\x7b\xdb\xf7\xd0\x13\x9d\x32\x40\x5e\xcf\xfb\x79\x68\x47\x4c\xfd\x1\x17\xe6\x97\x93\x78\xbb\xa6\x27\xa3\xe8\x1a\xe8\x94\x55\x7d\x8\xe5\xdc\x66\xa3\x69\xc8\xca\xc5\xa1\x84\x55\xde\x8\x91\x16\x3a\xc\x86\xab\x27\x2b\x64\x34\x2\x6c\x76\x8b\xc6\xaf\xcc\xe1\xd6\x8c\x2a\x18\x3d\xa6\x1b\x37\x75\x45\x73\xc2\x75\xd7\x53\x78\x3a\xd6\xe8\x29\xd2\x4a\xa8\x1e\x82\xf6\xb6\x81\xde\x21\xed\x2b\x56\xbb\xf2\xd0\x57\xc1\x7c\xd2\x6a\xd2\x56\xf5\x13\x5f\x1c\x6a\xb\x74\xfb\xe9\xfe\x9e\xea\x95\xb2\x46\xab\xa\xfc\xfd\xf3\xbb\x4\x2b\x76\x1b\xa4\x74\xb0\xc1\x78\xc3\x69\xe2\xb0\x1\xe1\xde\x32\x4c\x8d\x1a\xb3\x38\x8\xd5\xfc\x1f\xdc\xe\x2c\x9c\xb1\xa1\x63\x17\x22\xf5\x6c\x93\x70\x74\x0\xf8\x39\x1\x94\xd1\x32\x23\x56\x5d\xa6\x2\x76\x76\x93\xce\x2f\x19\xe9\x17\x52\xae\x6e\x2c\x6d\x61\x7f\x3b\xaa\xe0\x52\x85\xc5\x65\xc1\xbb\x8e\x5b\x21\xd5\xc9\x78\x83\x7\x97\x4c\x62\x61\x41\xd4\xfc\xc9\x39\xe3\x9b\xd0\xcc\x75\xc4\x97\xe6\xdd\x2a\x5f\xa6\xe8\x59\x6c\x98\xb9\x2\xe2\xa2\xd6\x68\xee\x3b\x1d\xe3\x4d\x5b\x30\xef\x3\xf2\xeb\x18\x57\x36\xe8\xa1\xf4\x47\xfb\xcb\x8f\xcb\xc8\xf3\x4f\x74\x9d\x9d\xb1\x8d\x14\x44\xd9\x19\xb4\x54\x4f\x75\x19\x9\xa0\x75\xbc\x3b\x82\xc6\x3f\xb8\x83\x19\x6e\xd6\x37\xfe\x6e\x8a\x4e\xe0\x4a\xab\x7b\xc8\xb4\x1d\xf4\xed\x27\x3\x65\xa2\xa1\xae\x11\xe7\x98\x78\x48\x91\xd2\xd2\xd4\x23\x78\x50\xb1\x5b\x85\x10\x8d\xca\x5f\xf\x71\xae\x72\x9a\xf6\x25\x19\x60\x6\xf7\x10\x34\x18\xd\xc9\x9f\x7b\xc\x9b\x8f\x91\x1b\x9f\xcd\x10\xee\x75\xf9\x97\x66\xfc\x4d\x33\x6e\x28\x2b\x92\x85\x4f\xab\x43\x8d\x8f\x7d\x86\xa7\xc7\xd8\xd3\xb\x8b\x57\xb6\x1d\x95\xd\xe9\xbc\xd9\x3\xd9\x10\x19\xc3\x46\x63\x55\x87\x61\x79\x6c\x95\xe\x9c\xdd\xca\xc3\xf3\x64\xf0\x7d\x76\xb7\x53\x67\x2b\x1e\x44\x56\x81\xea\x8f\x5c\x42\x16\xb8\x28\xeb\x1b\x61\x10\x1e\xbf\xec\xa8" -+}, { -+ .key = "\xb3\x35\x50\x3\x54\x2e\x40\x5e\x8f\x59\x8e\xc5\x90\xd5\x27\x2d\xba\x29\x2e\xcb\x1b\x70\x44\x1e\x65\x91\x6e\x2a\x79\x22\xda\x64", -+ .nonce = "\x5\xa3\x93\xed\x30\xc5\xa2\x6", -+ .assoc = "\xb1\x69\x83\x87\x30\xaa\x5d\xb8\x77\xe8\x21\xff\x6\x59\x35\xce\x75\xfe\x38\xef\xb8\x91\x43\x8c\xcf\x70\xdd\xa\x68\xbf\xd4\xbc\x16\x76\x99\x36\x1e\x58\x79\x5e\xd4\x29\xf7\x33\x93\x48\xdb\x5f\x1\xae\x9c\xb6\xe4\x88\x6d\x2b\x76\x75\xe0\xf3\x74\xe2\xc9", -+ .alen = 63, -+ .input = "\x52\x34\xb3\x65\x3b\xb7\xe5\xd3\xab\x49\x17\x60\xd2\x52\x56\xdf\xdf\x34\x56\x82\xe2\xbe\xe5\xe1\x28\xd1\x4e\x5f\x4f\x1\x7d\x3f\x99\x6b\x30\x6e\x1a\x7c\x4c\x8e\x62\x81\xae\x86\x3f\x6b\xd0\xb5\xa9\xcf\x50\xf1\x2\x12\xa0\xb\x24\xe9\xe6\x72\x89\x2c\x52\x1b\x34\x38\xf8\x75\x5f\xa0\x74\xe2\x99\xdd\xa6\x4b\x14\x50\x4e\xf1\xbe\xd6\x9e\xdb\xb2\x24\x27\x74\x12\x4a\x78\x78\x17\xa5\x58\x8e\x2f\xf9\xf4\x8d\xee\x3\x88\xae\xb8\x29\xa1\x2f\x4b\xee\x92\xbd\x87\xb3\xce\x34\x21\x57\x46\x4\x49\xc\x80\xf2\x1\x13\xa1\x55\xb3\xff\x44\x30\x3c\x1c\xd0\xef\xbc\x18\x74\x26\xad\x41\x5b\x5b\x3e\x9a\x7a\x46\x4f\x16\xd6\x74\x5a\xb7\x3a\x28\x31\xd8\xae\x26\xac\x50\x53\x86\xf2\x56\xd7\x3f\x29\xbc\x45\x68\x8e\xcb\x98\x64\xdd\xc9\xba\xb8\x4b\x7b\x82\xdd\x14\xa7\xcb\x71\x72\x0\x5c\xad\x7b\x6a\x89\xa4\x3d\xbf\xb5\x4b\x3e\x7c\x5a\xcf\xb8\xa1\xc5\x6e\xc8\xb6\x31\x57\x7b\xdf\xa5\x7e\xb1\xd6\x42\x2a\x31\x36\xd1\xd0\x3f\x7a\xe5\x94\xd6\x36\xa0\x6f\xb7\x40\x7d\x37\xc6\x55\x7c\x50\x40\x6d\x29\x89\xe3\x5a\xae\x97\xe7\x44\x49\x6e\xbd\x81\x3d\x3\x93\x6\x12\x6\xe2\x41\x12\x4a\xf1\x6a\xa4\x58\xa2\xfb\xd2\x15\xba\xc9\x79\xc9\xce\x5e\x13\xbb\xf1\x9\x4\xcc\xfd\xe8\x51\x34\x6a\xe8\x61\x88\xda\xed\x1\x47\x84\xf5\x73\x25\xf9\x1c\x42\x86\x7\xf3\x5b\x1a\x1\xb3\xeb\x24\x32\x8d\xf6\xed\x7c\x4b\xeb\x3c\x36\x42\x28\xdf\xdf\xb6\xbe\xd9\x8c\x52\xd3\x2b\x8\x90\x8c\xe7\x98\x31\xe2\x32\x8e\xfc\x11\x48\x0\xa8\x6a\x42\x4a\x2\xc6\x4b\x9\xf1\xe3\x49\xf3\x45\x1f\xe\xbc\x56\xe2\xe4\xdf\xfb\xeb\x61\xfa\x24\xc1\x63\x75\xbb\x47\x75\xaf\xe1\x53\x16\x96\x21\x85\x26\x11\xb3\x76\xe3\x23\xa1\x6b\x74\x37\xd0\xde\x6\x90\x71\x5d\x43\x88\x9b\x0\x54\xa6\x75\x2f\xa1\xc2\xb\x73\x20\x1d\xb6\x21\x79\x57\x3f\xfa\x9\xbe\x8a\x33\xc3\x52\xf0\x1d\x82\x31\xd1\x55\xb5\x6c\x99\x25\xcf\x5c\x32\xce\xe9\xd\xfa\x69\x2c\xd5\xd\xc5\x6d\x86\xd0\xc\x3b\x6\x50\x79\xe8\xc3\xae\x4\xe6\xcd\x51\xe4\x26\x9b\x4f\x7e\xa6\xf\xab\xd8\xe5\xde\xa9\x0\x95\xbe\xa3\x9d\x5d\xb2\x9\x70\x18\x1c\xf0\xac\x29\x23\x2\x29\x28\xd2\x74\x35\x57\x62\xf\x24\xea\x5e\x33\xc2\x92\xf3\x78\x4d\x30\x1e\xa1\x99\xa9\x82\xb0\x42\x31\x8d\xad\x8a\xbc\xfc\xd4\x57\x47\x3e\xb4\x50\xdd\x6e\x2c\x80\x4d\x22\xf1\xfb\x57\xc4\xdd\x17\xe1\x8a\x36\x4a\xb3\x37\xca\xc9\x4e\xab\xd5\x69\xc4\xf4\xbc\xb\x3b\x44\x4b\x29\x9c\xee\xd4\x35\x22\x21\xb0\x1f\x27\x64\xa8\x51\x1b\xf0\x9f\x19\x5c\xfb\x5a\x64\x74\x70\x45\x9\xf5\x64\xfe\x1a\x2d\xc9\x14\x4\x14\xcf\xd5\x7d\x60\xaf\x94\x39\x94\xe2\x7d\x79\x82\xd0\x65\x3b\x6b\x9c\x19\x84\xb4\x6d\xb3\xc\x99\xc0\x56\xa8\xbd\x73\xce\x5\x84\x3e\x30\xaa\xc4\x9b\x1b\x4\x2a\x9f\xd7\x43\x2b\x23\xdf\xbf\xaa\xd5\xc2\x43\x2d\x70\xab\xdc\x75\xad\xac\xf7\xc0\xbe\x67\xb2\x74\xed\x67\x10\x4a\x92\x60\xc1\x40\x50\x19\x8a\x8a\x8c\x9\xe\x72\xe1\x73\x5e\xe8\x41\x85\x63\x9f\x3f\xd7\x7d\xc4\xfb\x22\x5d\x92\x6c\xb3\x1e\xe2\x50\x2f\x82\xa8\x28\xc0\xb5\xd7\x5f\x68\xd\x2c\x2d\xaf\x7e\xfa\x2e\x8\xf\x1f\x70\x9f\xe9\x19\x72\x55\xf8\xfb\x51\xd2\x33\x5d\xa0\xd3\x2b\xa\x6c\xbc\x4e\xcf\x36\x4d\xdc\x3b\xe9\x3e\x81\x7c\x61\xdb\x20\x2d\x3a\xc3\xb3\xc\x1e\x0\xb9\x7c\xf5\xca\x10\x5f\x3a\x71\xb3\xe4\x20\xdb\xc\x2a\x98\x63\x45\x0\x58\xf6\x68\xe4\xb\xda\x13\x3b\x60\x5c\x76\xdb\xb9\x97\x71\xe4\xd9\xb7\xdb\xbd\x68\xc7\x84\x84\xaa\x7c\x68\x62\x5e\x16\xfc\xba\x72\xaa\x9a\xa9\xeb\x7c\x75\x47\x97\x7e\xad\xe2\xd9\x91\xe8\xe4\xa5\x31\xd7\x1\x8e\xa2\x11\x88\x95\xb9\xf2\x9b\xd3\x7f\x1b\x81\x22\xf7\x98\x60\xa\x64\xa6\xc1\xf6\x49\xc7\xe3\x7\x4d\x94\x7a\xcf\x6e\x68\xc\x1b\x3f\x6e\x2e\xee\x92\xfa\x52\xb3\x59\xf8\xf1\x8f\x6a\x66\xa3\x82\x76\x4a\x7\x1a\xc7\xdd\xf5\xda\x9c\x3c\x24\xbf\xfd\x42\xa1\x10\x64\x6a\xf\x89\xee\x36\xa5\xce\x99\x48\x6a\xf0\x9f\x9e\x69\xa4\x40\x20\xe9\x16\x15\xf7\xdb\x75\x2\xcb\xe9\x73\x8b\x3b\x49\x2f\xf0\xaf\x51\x6\x5c\xdf\x27\x27\x49\x6a\xd1\xcc\xc7\xb5\x63\xb5\xfc\xb8\x5c\x87\x7f\x84\xb4\xcc\x14\xa9\x53\xda\xa4\x56\xf8\xb6\x1b\xcc\x40\x27\x52\x6\x5a\x13\x81\xd7\x3a\xd4\x3b\xfb\x49\x65\x31\x33\xb2\xfa\xcd\xad\x58\x4e\x2b\xae\xd2\x20\xfb\x1a\x48\xb4\x3f\x9a\xd8\x7a\x35\x4a\xc8\xee\x88\x5e\x7\x66\x54\xb9\xec\x9f\xa3\xe3\xb9\x37\xaa\x49\x76\x31\xda\x74\x2d\x3c\xa4\x65\x10\x32\x38\xf0\xde\xd3\x99\x17\xaa\x71\xaa\x8f\xf\x8c\xaf\xa2\xf8\x5d\x64\xba\x1d\xa3\xef\x96\x73\xe8\xa1\x2\x8d\xc\x6d\xb8\x6\x90\xb8\x8\x56\x2c\xa7\x6\xc9\xc2\x38\xdb\x7c\x63\xb1\x57\x8e\xea\x7c\x79\xf3\x49\x1d\xfe\x9f\xf3\x6e\xb1\x1d\xba\x19\x80\x1a\xa\xd3\xb0\x26\x21\x40\xb1\x7c\xf9\x4d\x8d\x10\xc1\x7e\xf4\xf6\x3c\xa8\xfd\x7c\xa3\x92\xb2\xf\xaa\xcc\xa6\x11\xfe\x4\xe3\xd1\x7a\x32\x89\xdf\xd\xc4\x8f\x79\x6b\xca\x16\x7c\x6e\xf9\xad\xf\xf6\xfe\x27\xdb\xc4\x13\x70\xf1\x62\x1a\x4f\x79\x40\xc9\x9b\x8b\x21\xea\x84\xfa\xf5\xf1\x89\xce\xb7\x55\xa\x80\x39\x2f\x55\x36\x16\x9c\x7b\x8\xbd\x87\xd\xa5\x32\xf1\x52\x7c\xe8\x55\x60\x5b\xd7\x69\xe4\xfc\xfa\x12\x85\x96\xea\x50\x28\xab\x8a\xf7\xbb\xe\x53\x74\xca\xa6\x27\x9\xc2\xb5\xde\x18\x14\xd9\xea\xe5\x29\x1c\x40\x56\xcf\xd7\xae\x5\x3f\x65\xaf\x5\x73\xe2\x35\x96\x27\x7\x14\xc0\xad\x33\xf1\xdc\x44\x7a\x89\x17\x77\xd2\x9c\x58\x60\xf0\x3f\x7b\x2d\x2e\x57\x95\x54\x87\xed\xf2\xc7\x4c\xf0\xae\x56\x29\x19\x7d\x66\x4b\x9b\x83\x84\x42\x3b\x1\x25\x66\x8e\x2\xde\xb9\x83\x54\x19\xf6\x9f\x79\xd\x67\xc5\x1d\x7a\x44\x2\x98\xa7\x16\x1c\x29\xd\x74\xff\x85\x40\x6\xef\x2c\xa9\xc6\xf5\x53\x7\x6\xae\xe4\xfa\x5f\xd8\x39\x4d\xf1\x9b\x6b\xd9\x24\x84\xfe\x3\x4c\xb2\x3f\xdf\xa1\x5\x9e\x50\x14\x5a\xd9\x1a\xa2\xa7\xfa\xfa\x17\xf7\x78\xd6\xb5\x92\x61\x91\xac\x36\xfa\x56\xd\x38\x32\x18\x85\x8\x58\x37\xf0\x4b\xdb\x59\xe7\xa4\x34\xc0\x1b\x1\xaf\x2d\xde\xa1\xaa\x5d\xd3\xec\xe1\xd4\xf7\xe6\x54\x68\xf0\x51\x97\xa7\x89\xea\x24\xad\xd3\x6e\x47\x93\x8b\x4b\xb4\xf7\x1c\x42\x6\x67\xe8\x99\xf6\xf5\x7b\x85\xb5\x65\xb5\xb5\xd2\x37\xf5\xf3\x2\xa6\x4d\x11\xa7\xdc\x51\x9\x7f\xa0\xd8\x88\x1c\x13\x71\xae\x9c\xb7\x7b\x34\xd6\x4e\x68\x26\x83\x51\xaf\x1d\xee\x8b\xbb\x69\x43\x2b\x9e\x8a\xbc\x2\xe\xa0\x1b\xe0\xa8\x5f\x6f\xaf\x1b\x8f\xe7\x64\x71\x74\x11\x7e\xa8\xd8\xf9\x97\x6\xc3\xb6\xfb\xfb\xb7\x3d\x35\x9d\x3b\x52\xed\x54\xca\xf4\x81\x1\x2d\x1b\xc3\xa7\x0\x3d\x1a\x39\x54\xe1\xf6\xff\xed\x6f\xb\x5a\x68\xda\x58\xdd\xa9\xcf\x5c\x4a\xe5\x9\x4e\xde\x9d\xbc\x3e\xee\x5a\x0\x3b\x2c\x87\x10\x65\x60\xdd\xd7\x56\xd1\x4c\x64\x45\xe4\x21\xec\x78\xf8\x25\x7a\x3e\x16\x5d\x9\x53\x14\xbe\x4f\xae\x87\xd8\xd1\xaa\x3c\xf6\x3e\xa4\x70\x8c\x5e\x70\xa4\xb3\x6b\x66\x73\xd3\xbf\x31\x6\x19\x62\x93\x15\xf2\x86\xe4\x52\x7e\x53\x4c\x12\x38\xcc\x34\x7d\x57\xf6\x42\x93\x8a\xc4\xee\x5c\x8a\xe1\x52\x8f\x56\x64\xf6\xa6\xd1\x91\x57\x70\xcd\x11\x76\xf5\x59\x60\x60\x3c\xc1\xc3\xb\x7f\x58\x1a\x50\x91\xf1\x68\x8f\x6e\x74\x74\xa8\x51\xb\xf7\x7a\x98\x37\xf2\xa\xe\xa4\x97\x4\xb8\x9b\xfd\xa0\xea\xf7\xd\xe1\xdb\x3\xf0\x31\x29\xf8\xdd\x6b\x8b\x5d\xd8\x59\xa9\x29\xcf\x9a\x79\x89\x19\x63\x46\x9\x79\x6a\x11\xda\x63\x68\x48\x77\x23\xfb\x7d\x3a\x43\xcb\x2\x3b\x7a\x6d\x10\x2a\x9e\xac\xf1\xd4\x19\xf8\x23\x64\x1d\x2c\x5f\xf2\xb0\x5c\x23\x27\xf7\x27\x30\x16\x37\xb1\x90\xab\x38\xfb\x55\xcd\x78\x58\xd4\x7d\x43\xf6\x45\x5e\x55\x8d\xb1\x2\x65\x58\xb4\x13\x4b\x36\xf7\xcc\xfe\x3d\xb\x82\xe2\x12\x11\xbb\xe6\xb8\x3a\x48\x71\xc7\x50\x6\x16\x3a\xe6\x7c\x5\xc7\xc8\x4d\x2f\x8\x6a\x17\x9a\x95\x97\x50\x68\xdc\x28\x18\xc4\x61\x38\xb9\xe0\x3e\x78\xdb\x29\xe0\x9f\x52\xdd\xf8\x4f\x91\xc1\xd0\x33\xa1\x7a\x8e\x30\x13\x82\x7\x9f\xd3\x31\xf\x23\xbe\x32\x5a\x75\xcf\x96\xb2\xec\xb5\x32\xac\x21\xd1\x82\x33\xd3\x15\x74\xbd\x90\xf1\x2c\xe6\x5f\x8d\xe3\x2\xe8\xe9\xc4\xca\x96\xeb\xe\xbc\x91\xf4\xb9\xea\xd9\x1b\x75\xbd\xe1\xac\x2a\x5\x37\x52\x9b\x1b\x3f\x5a\xdc\x21\xc3\x98\xbb\xaf\xa3\xf2\x0\xbf\xd\x30\x89\x5\xcc\xa5\x76\xf5\x6\xf0\xc6\x54\x8a\x5d\xd4\x1e\xc1\xf2\xce\xb0\x62\xc8\xfc\x59\x42\x9a\x90\x60\x55\xfe\x88\xa5\x8b\xb8\x33\xc\x23\x24\xd\x15\x70\x37\x1e\x3d\xf6\xd2\xea\x92\x10\xb2\xc4\x51\xac\xf2\xac\xf3\x6b\x6c\xaa\xcf\x12\xc5\x6c\x90\x50\xb5\xc\xfc\x1a\x15\x52\xe9\x26\xc6\x52\xa4\xe7\x81\x69\xe1\xe7\x9e\x30\x1\xec\x84\x89\xb2\xd\x66\xdd\xce\x28\x5c\xec\x98\x46\x68\x21\x9f\x88\x3f\x1f\x42\x77\xce\xd0\x61\xd4\x20\xa7\xff\x53\xad\x37\xd0\x17\x35\xc9\xfc\xba\xa\x78\x3f\xf2\xcc\x86\x89\xe8\x4b\x3c\x48\x33\x9\x7f\xc6\xc0\xdd\xb8\xfd\x7a\x66\x66\x65\xeb\x47\xa7\x4\x28\xa3\x19\x8e\xa9\xb1\x13\x67\x62\x70\xcf\xd6", -+ .ilen = 2027, -+ .result = "\x74\xa6\x3e\xe4\xb1\xcb\xaf\xb0\x40\xe5\xf\x9e\xf1\xf2\x89\xb5\x42\x34\x8a\xa1\x3\xb7\xe9\x57\x46\xbe\x20\xe4\x6e\xb0\xeb\xff\xea\x7\x7e\xef\xe2\x55\x9f\xe5\x78\x3a\xb7\x83\xc2\x18\x40\x7b\xeb\xcd\x81\xfb\x90\x12\x9e\x46\xa9\xd6\x4a\xba\xb0\x62\xdb\x6b\x99\xc4\xdb\x54\x4b\xb8\xa5\x71\xcb\xcd\x63\x32\x55\xfb\x31\xf0\x38\xf5\xbe\x78\xe4\x45\xce\x1b\x6a\x5b\xe\xf4\x16\xe4\xb1\x3d\xf6\x63\x7b\xa7\xc\xde\x6f\x8f\x74\xdf\xe0\x1e\x9d\xce\x8f\x24\xef\x23\x35\x33\x7b\x83\x34\x23\x58\x74\x14\x77\x1f\xc2\x4f\x4e\xc6\x89\xf9\x52\x9\x37\x64\x14\xc4\x1\x6b\x9d\x77\xe8\x90\x5d\xa8\x4a\x2a\xef\x5c\x7f\xeb\xbb\xb2\xc6\x93\x99\x66\xdc\x7f\xd4\x9e\x2a\xca\x8d\xdb\xe7\x20\xcf\xe4\x73\xae\x49\x7d\x64\xf\xe\x28\x46\xa9\xa8\x32\xe4\xe\xf6\x51\x53\xb8\x3c\xb1\xff\xa3\x33\x41\x75\xff\xf1\x6f\xf1\xfb\xbb\x83\x7f\x6\x9b\xe7\x1b\xa\xe0\x5c\x33\x60\x5b\xdb\x5b\xed\xfe\xa5\x16\x19\x72\xa3\x64\x23\x0\x2\xc7\xf3\x6a\x81\x3e\x44\x1d\x79\x15\x5f\x9a\xde\xe2\xfd\x1b\x73\xc1\xbc\x23\xba\x31\xd2\x50\xd5\xad\x7f\x74\xa7\xc9\xf8\x3e\x2b\x26\x10\xf6\x3\x36\x74\xe4\xe\x6a\x72\xb7\x73\xa\x42\x28\xc2\xad\x5e\x3\xbe\xb8\xb\xa8\x5b\xd4\xb8\xba\x52\x89\xb1\x9b\xc1\xc3\x65\x87\xed\xa5\xf4\x86\xfd\x41\x80\x91\x27\x59\x53\x67\x15\x78\x54\x8b\x2d\x3d\xc7\xff\x2\x92\x7\x5f\x7a\x4b\x60\x59\x3c\x6f\x5c\xd8\xec\x95\xd2\xfe\xa0\x3b\xd8\x3f\xd1\x69\xa6\xd6\x41\xb2\xf4\x4d\x12\xf4\x58\x3e\x66\x64\x80\x31\x9b\xa8\x4c\x8b\x7\xb2\xec\x66\x94\x66\x47\x50\x50\x5f\x18\xb\xe\xd6\xc0\x39\x21\x13\x9e\x33\xbc\x79\x36\x2\x96\x70\xf0\x48\x67\x2f\x26\xe9\x6d\x10\xbb\xd6\x3f\xd1\x64\x7a\x2e\xbe\xc\x61\xf0\x75\x42\x38\x23\xb1\x9e\x9f\x7c\x67\x66\xd9\x58\x9a\xf1\xbb\x41\x2a\x8d\x65\x84\x94\xfc\xdc\x6a\x50\x64\xdb\x56\x33\x76\x0\x10\xed\xbe\xd2\x12\xf6\xf6\x1b\xa2\x16\xde\xae\x31\x95\xdd\xb1\x8\x7e\x4e\xee\xe7\xf9\xa5\xfb\x5b\x61\x43\x0\x40\xf6\x7e\x2\x4\x32\x4e\xc\xe2\x66\xd\xd7\x7\x98\xe\xf8\x72\x34\x6d\x95\x86\xd7\xcb\x31\x54\x47\xd0\x38\x29\x9c\x5a\x68\xd4\x87\x76\xc9\xe7\x7e\xe3\xf4\x81\x6d\x18\xcb\xc9\x5\xaf\xa0\xfb\x66\xf7\xf1\x1c\xc6\x14\x11\x4f\x2b\x79\x42\x8b\xbc\xac\xe7\x6c\xfe\xf\x58\xe7\x7c\x78\x39\x30\xb0\x66\x2c\x9b\x6d\x3a\xe1\xcf\xc9\xa4\xe\x6d\x6d\x8a\xa1\x3a\xe7\x28\xd4\x78\x4c\xa6\xa2\x2a\xa6\x3\x30\xd7\xa8\x25\x66\x87\x2f\x69\x5c\x4e\xdd\xa5\x49\x5d\x37\x4a\x59\xc4\xaf\x1f\xa2\xe4\xf8\xa6\x12\x97\xd5\x79\xf5\xe2\x4a\x2b\x5f\x61\xe4\x9e\xe3\xee\xb8\xa7\x5b\x2f\xf4\x9e\x6c\xfb\xd1\xc6\x56\x77\xba\x75\xaa\x3d\x1a\xa8\xb\xb3\x68\x24\x0\x10\x7f\xfd\xd7\xa1\x8d\x83\x54\x4f\x1f\xd8\x2a\xbe\x8a\xc\x87\xab\xa2\xde\xc3\x39\xbf\x9\x3\xa5\xf3\x5\x28\xe1\xe1\xee\x39\x70\x9c\xd8\x81\x12\x1e\x2\x40\xd2\x6e\xf0\xeb\x1b\x3d\x22\xc6\xe5\xe3\xb4\x5a\x98\xbb\xf0\x22\x28\x8d\xe5\xd3\x16\x48\x24\xa5\xe6\x66\xc\xf9\x8\xf9\x7e\x1e\xe1\x28\x26\x22\xc7\xc7\xa\x32\x47\xfa\xa3\xbe\x3c\xc4\xc5\x53\xa\xd5\x94\x4a\xd7\x93\xd8\x42\x99\xb9\xa\xdb\x56\xf7\xb9\x1c\x53\x4f\xfa\xd3\x74\xad\xd9\x68\xf1\x1b\xdf\x61\xc6\x5e\xa8\x48\xfc\xd4\x4a\x4c\x3c\x32\xf7\x1c\x96\x21\x9b\xf9\xa3\xcc\x5a\xce\xd5\xd7\x8\x24\xf6\x1c\xfd\xdd\x38\xc2\x32\xe9\xb8\xe7\xb6\xfa\x9d\x45\x13\x2c\x83\xfd\x4a\x69\x82\xcd\xdc\xb3\x76\xc\x9e\xd8\xf4\x1b\x45\x15\xb4\x97\xe7\x58\x34\xe2\x3\x29\x5a\xbf\xb6\xe0\x5d\x13\xd9\x2b\xb4\x80\xb2\x45\x81\x6a\x2e\x6c\x89\x7d\xee\xbb\x52\xdd\x1f\x18\xe7\x13\x6b\x33\xe\xea\x36\x92\x77\x7b\x6d\x9c\x5a\x5f\x45\x7b\x7b\x35\x62\x23\xd1\xbf\xf\xd0\x8\x1b\x2b\x80\x6b\x7e\xf1\x21\x47\xb0\x57\xd1\x98\x72\x90\x34\x1c\x20\x4\xff\x3d\x5c\xee\xe\x57\x5f\x6f\x24\x4e\x3c\xea\xfc\xa5\xa9\x83\xc9\x61\xb4\x51\x24\xf8\x27\x5e\x46\x8c\xb1\x53\x2\x96\x35\xba\xb8\x4c\x71\xd3\x15\x59\x35\x22\x20\xad\x3\x9f\x66\x44\x3b\x9c\x35\x37\x1f\x9b\xbb\xf3\xdb\x35\x63\x30\x64\xaa\xa2\x6\xa8\x5d\xbb\xe1\x9f\x70\xec\x82\x11\x6\x36\xec\x8b\x69\x66\x24\x44\xc9\x4a\x57\xbb\x9b\x78\x13\xce\x9c\xc\xba\x92\x93\x63\xb8\xe2\x95\xf\xf\x16\x39\x52\xfd\x3a\x6d\x2\x4b\xdf\x13\xd3\x2a\x22\xb4\x3\x7c\x54\x49\x96\x68\x54\x10\xfa\xef\xaa\x6c\xe8\x22\xdc\x71\x16\x13\x1a\xf6\x28\xe5\x6d\x77\x3d\xcd\x30\x63\xb1\x70\x52\xa1\xc5\x94\x5f\xcf\xe8\xb8\x26\x98\xf7\x6\xa0\xa\x70\xfa\x3\x80\xac\xc1\xec\xd6\x4c\x54\xd7\xfe\x47\xb6\x88\x4a\xf7\x71\x24\xee\xf3\xd2\xc2\x4a\x7f\xfe\x61\xc7\x35\xc9\x37\x67\xcb\x24\x35\xda\x7e\xca\x5f\xf3\x8d\xd4\x13\x8e\xd6\xcb\x4d\x53\x8f\x53\x1f\xc0\x74\xf7\x53\xb9\x5e\x23\x37\xba\x6e\xe3\x9d\x7\x55\x25\x7b\xe6\x2a\x64\xd1\x32\xdd\x54\x1b\x4b\xc0\xe1\xd7\x69\x58\xf8\x93\x29\xc4\xdd\x23\x2f\xa5\xfc\x9d\x7e\xf8\xd4\x90\xcd\x82\x55\xdc\x16\x16\x9f\x7\x52\x9b\x9d\x25\xed\x32\xc5\x7b\xdf\xf6\x83\x46\x3d\x65\xb7\xef\x87\x7a\x12\x69\x8f\x6\x7c\x51\x15\x4a\x8\xe8\xac\x9a\xc\x24\xa7\x27\xd8\x46\x2f\xe7\x1\xe\x1c\xc6\x91\xb0\x6e\x85\x65\xf0\x29\xd\x2e\x6b\x3b\xfb\x4b\xdf\xe4\x80\x93\x3\x66\x46\x3e\x8a\x6e\xf3\x5e\x4d\x62\xe\x49\x5\xaf\xd4\xf8\x21\x20\x61\x1d\x39\x17\xf4\x61\x47\x95\xfb\x15\x2e\xb3\x4f\xd0\x5d\xf5\x7d\x40\xda\x90\x3c\x6b\xcb\x17\x0\x13\x3b\x64\x34\x1b\xf0\xf2\xe5\x3b\xb2\xc7\xd3\x5f\x3a\x44\xa6\x9b\xb7\x78\xe\x42\x5d\x4c\xc1\xe9\xd2\xcb\xb7\x78\xd1\xfe\x9a\xb5\x7\xe9\xe0\xbe\xe2\x8a\xa7\x1\x83\x0\x8c\x5c\x8\xe6\x63\x12\x92\xb7\xb7\xa6\x19\x7d\x38\x13\x38\x92\x87\x24\xf9\x48\xb3\x5e\x87\x6a\x40\x39\x5c\x3f\xed\x8f\xee\xdb\x15\x82\x6\xda\x49\x21\x2b\xb5\xbf\x32\x7c\x9f\x42\x28\x63\xcf\xaf\x1e\xf8\xc6\xa0\xd1\x2\x43\x57\x62\xec\x9b\xf\x1\x9e\x71\xd8\x87\x9d\x1\xc1\x58\x77\xd9\xaf\xb1\x10\x7e\xdd\xa6\x50\x96\xe5\xf0\x72\x0\x6d\x4b\xf8\x2a\x8f\x19\xf3\x22\x88\x11\x4a\x8b\x7c\xfd\xb7\xed\xe1\xf6\x40\x39\xe0\xe9\xf6\x3d\x25\xe6\x74\x3c\x58\x57\x7f\xe1\x22\x96\x47\x31\x91\xba\x70\x85\x28\x6b\x9f\x6e\x25\xac\x23\x66\x2f\x29\x88\x28\xce\x8c\x5c\x88\x53\xd1\x3b\xcc\x6a\x51\xb2\xe1\x28\x3f\x91\xb4\xd\x0\x3a\xe3\xf8\xc3\x8f\xd7\x96\x62\xe\x2e\xfc\xc8\x6c\x77\xa6\x1d\x22\xc1\xb8\xe6\x61\xd7\x67\x36\x13\x7b\xbb\x9b\x59\x9\xa6\xdf\xf7\x6b\xa3\x40\x1a\xf5\x4f\xb4\xda\xd3\xf3\x81\x93\xc6\x18\xd9\x26\xee\xac\xf0\xaa\xdf\xc5\x9c\xca\xc2\xa2\xcc\x7b\x5c\x24\xb0\xbc\xd0\x6a\x4d\x89\x9\xb8\x7\xfe\x87\xad\xa\xea\xb8\x42\xf9\x5e\xb3\x3e\x36\x4c\xaf\x75\x9e\x1c\xeb\xbd\xbc\xbb\x80\x40\xa7\x3a\x30\xbf\xa8\x44\xf4\xeb\x38\xad\x29\xba\x23\xed\x41\xc\xea\xd2\xbb\x41\x18\xd6\xb9\xba\x65\x2b\xa3\x91\x6d\x1f\xa9\xf4\xd1\x25\x8d\x4d\x38\xff\x64\xa0\xec\xde\xa6\xb6\x79\xab\x8e\x33\x6c\x47\xde\xaf\x94\xa4\xa5\x86\x77\x55\x9\x92\x81\x31\x76\xc7\x34\x22\x89\x8e\x3d\x26\x26\xd7\xfc\x1e\x16\x72\x13\x33\x63\xd5\x22\xbe\xb8\x4\x34\x84\x41\xbb\x80\xd0\x9f\x46\x48\x7\xa7\xfc\x2b\x3a\x75\x55\x8c\xc7\x6a\xbd\x7e\x46\x8\x84\xf\xd5\x74\xc0\x82\x8e\xaa\x61\x5\x1\xb2\x47\x6e\x20\x6a\x2d\x58\x70\x48\x32\xa7\x37\xd2\xb8\x82\x1a\x51\xb9\x61\xdd\xfd\x9d\x6b\xe\x18\x97\xf8\x45\x5f\x87\x10\xcf\x34\x72\x45\x26\x49\x70\xe7\xa3\x78\xe0\x52\x89\x84\x94\x83\x82\xc2\x69\x8f\xe3\xe1\x3f\x60\x74\x88\xc4\xf7\x75\x2c\xfb\xbd\xb6\xc4\x7e\x10\xa\x6c\x90\x4\x9e\xc3\x3f\x59\x7c\xce\x31\x18\x60\x57\x73\x46\x94\x7d\x6\xa0\x6d\x44\xec\xa2\xa\x9e\x5\x15\xef\xca\x5c\xbf\x0\xeb\xf7\x3d\x32\xd4\xa5\xef\x49\x89\x5e\x46\xb0\xa6\x63\x5b\x8a\x73\xae\x6f\xd5\x9d\xf8\x4f\x40\xb5\xb2\x6e\xd3\xb6\x1\xa9\x26\xa2\x21\xcf\x33\x7a\x3a\xa4\x23\x13\xb0\x69\x6a\xee\xce\xd8\x9d\x1\x1d\x50\xc1\x30\x6c\xb1\xcd\xa0\xf0\xf0\xa2\x64\x6f\xbb\xbf\x5e\xe6\xab\x87\xb4\xf\x4f\x15\xaf\xb5\x25\xa1\xb2\xd0\x80\x2c\xfb\xf9\xfe\xd2\x33\xbb\x76\xfe\x7c\xa8\x66\xf7\xe7\x85\x9f\x1f\x85\x57\x88\xe1\xe9\x63\xe4\xd8\x1c\xa1\xfb\xda\x44\x5\x2e\x1d\x3a\x1c\xff\xc8\x3b\xc0\xfe\xda\x22\xb\x43\xd6\x88\x39\x4c\x4a\xa6\x69\x18\x93\x42\x4e\xb5\xcc\x66\xd\x9\xf8\x1e\x7c\xd3\x3c\x99\xd\x50\x1d\x62\xe9\x57\x6\xbf\x19\x88\xdd\xad\x7b\x4f\xf9\xc7\x82\x6d\x8d\xc8\xc4\xc5\x78\x17\x20\x15\xc5\x52\x41\xcf\x5b\xd6\x7f\x94\x2\x41\xe0\x40\x22\x3\x5e\xd1\x53\xd4\x86\xd3\x2c\x9f\xf\x96\xe3\x6b\x9a\x76\x32\x6\x47\x4b\x11\xb3\xdd\x3\x65\xbd\x9b\x1\xda\x9c\xb9\x7e\x3f\x6a\xc4\x7b\xea\xd4\x3c\xb9\xfb\x5c\x6b\x64\x33\x52\xba\x64\x78\x8f\xa4\xaf\x7a\x61\x8d\xbc\xc5\x73\xe9\x6b\x58\x97\x4b\xbf\x63\x22\xd3\x37\x2\x54\xc5\xb9\x16\x4a\xf0\x19\xd8\x94\x57\xb8\x8a\xb3\x16\x3b\xd0\x84\x8e\x67\xa6\xa3\x7d\x78\xec\x0" -+} }; -+ -+static const struct chacha20poly1305_testvec xchacha20poly1305_enc_vectors[] __initconst = { { -+ .key = "\x1c\x92\x40\xa5\xeb\x55\xd3\x8a\xf3\x33\x88\x86\x04\xf6\xb5\xf0\x47\x39\x17\xc1\x40\x2b\x80\x09\x9d\xca\x5c\xbc\x20\x70\x75\xc0", -+ .nonce = "\x00\x01\x02\x03\x04\x05\x06\x07\x08\x09\x0a\x0b\x0c\x0d\x0e\x0f\x10\x11\x12\x13\x14\x15\x16\x17", -+ .assoc = "\xf3\x33\x88\x86\x00\x00\x00\x00\x00\x00\x4e\x91", -+ .alen = 12, -+ .input = "\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x72\x65\x20\x64\x72\x61\x66\x74\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x76\x61\x6c\x69\x64\x20\x66\x6f\x72\x20\x61\x20\x6d\x61\x78\x69\x6d\x75\x6d\x20\x6f\x66\x20\x73\x69\x78\x20\x6d\x6f\x6e\x74\x68\x73\x20\x61\x6e\x64\x20\x6d\x61\x79\x20\x62\x65\x20\x75\x70\x64\x61\x74\x65\x64\x2c\x20\x72\x65\x70\x6c\x61\x63\x65\x64\x2c\x20\x6f\x72\x20\x6f\x62\x73\x6f\x6c\x65\x74\x65\x64\x20\x62\x79\x20\x6f\x74\x68\x65\x72\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x61\x74\x20\x61\x6e\x79\x20\x74\x69\x6d\x65\x2e\x20\x49\x74\x20\x69\x73\x20\x69\x6e\x61\x70\x70\x72\x6f\x70\x72\x69\x61\x74\x65\x20\x74\x6f\x20\x75\x73\x65\x20\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x73\x20\x72\x65\x66\x65\x72\x65\x6e\x63\x65\x20\x6d\x61\x74\x65\x72\x69\x61\x6c\x20\x6f\x72\x20\x74\x6f\x20\x63\x69\x74\x65\x20\x74\x68\x65\x6d\x20\x6f\x74\x68\x65\x72\x20\x74\x68\x61\x6e\x20\x61\x73\x20\x2f\xe2\x80\x9c\x77\x6f\x72\x6b\x20\x69\x6e\x20\x70\x72\x6f\x67\x72\x65\x73\x73\x2e\x2f\xe2\x80\x9d", -+ .ilen = 265, -+ .result = "\x1a\x6e\x3a\xd9\xfd\x41\x3f\x77\x54\x72\x0a\x70\x9a\xa0\x29\x92\x2e\xed\x93\xcf\x0f\x71\x88\x18\x7a\x9d\x2d\x24\xe0\xf5\xea\x3d\x55\x64\xd7\xad\x2a\x1a\x1f\x7e\x86\x6d\xb0\xce\x80\x41\x72\x86\x26\xee\x84\xd7\xef\x82\x9e\xe2\x60\x9d\x5a\xfc\xf0\xe4\x19\x85\xea\x09\xc6\xfb\xb3\xa9\x50\x09\xec\x5e\x11\x90\xa1\xc5\x4e\x49\xef\x50\xd8\x8f\xe0\x78\xd7\xfd\xb9\x3b\xc9\xf2\x91\xc8\x25\xc8\xa7\x63\x60\xce\x10\xcd\xc6\x7f\xf8\x16\xf8\xe1\x0a\xd9\xde\x79\x50\x33\xf2\x16\x0f\x17\xba\xb8\x5d\xd8\xdf\x4e\x51\xa8\x39\xd0\x85\xca\x46\x6a\x10\xa7\xa3\x88\xef\x79\xb9\xf8\x24\xf3\xe0\x71\x7b\x76\x28\x46\x3a\x3a\x1b\x91\xb6\xd4\x3e\x23\xe5\x44\x15\xbf\x60\x43\x9d\xa4\xbb\xd5\x5f\x89\xeb\xef\x8e\xfd\xdd\xb4\x0d\x46\xf0\x69\x23\x63\xae\x94\xf5\x5e\xa5\xad\x13\x1c\x41\x76\xe6\x90\xd6\x6d\xa2\x8f\x97\x4c\xa8\x0b\xcf\x8d\x43\x2b\x9c\x9b\xc5\x58\xa5\xb6\x95\x9a\xbf\x81\xc6\x54\xc9\x66\x0c\xe5\x4f\x6a\x53\xa1\xe5\x0c\xba\x31\xde\x34\x64\x73\x8a\x3b\xbd\x92\x01\xdb\x71\x69\xf3\x58\x99\xbc\xd1\xcb\x4a\x05\xe2\x58\x9c\x25\x17\xcd\xdc\x83\xb7\xff\xfb\x09\x61\xad\xbf\x13\x5b\x5e\xed\x46\x82\x6f\x22\xd8\x93\xa6\x85\x5b\x40\x39\x5c\xc5\x9c" -+} }; -+static const struct chacha20poly1305_testvec xchacha20poly1305_dec_vectors[] __initconst = { { -+ .key = "\x1c\x92\x40\xa5\xeb\x55\xd3\x8a\xf3\x33\x88\x86\x04\xf6\xb5\xf0\x47\x39\x17\xc1\x40\x2b\x80\x09\x9d\xca\x5c\xbc\x20\x70\x75\xc0", -+ .nonce = "\x00\x01\x02\x03\x04\x05\x06\x07\x08\x09\x0a\x0b\x0c\x0d\x0e\x0f\x10\x11\x12\x13\x14\x15\x16\x17", -+ .assoc = "\xf3\x33\x88\x86\x00\x00\x00\x00\x00\x00\x4e\x91", -+ .alen = 12, -+ .input = "\x1a\x6e\x3a\xd9\xfd\x41\x3f\x77\x54\x72\x0a\x70\x9a\xa0\x29\x92\x2e\xed\x93\xcf\x0f\x71\x88\x18\x7a\x9d\x2d\x24\xe0\xf5\xea\x3d\x55\x64\xd7\xad\x2a\x1a\x1f\x7e\x86\x6d\xb0\xce\x80\x41\x72\x86\x26\xee\x84\xd7\xef\x82\x9e\xe2\x60\x9d\x5a\xfc\xf0\xe4\x19\x85\xea\x09\xc6\xfb\xb3\xa9\x50\x09\xec\x5e\x11\x90\xa1\xc5\x4e\x49\xef\x50\xd8\x8f\xe0\x78\xd7\xfd\xb9\x3b\xc9\xf2\x91\xc8\x25\xc8\xa7\x63\x60\xce\x10\xcd\xc6\x7f\xf8\x16\xf8\xe1\x0a\xd9\xde\x79\x50\x33\xf2\x16\x0f\x17\xba\xb8\x5d\xd8\xdf\x4e\x51\xa8\x39\xd0\x85\xca\x46\x6a\x10\xa7\xa3\x88\xef\x79\xb9\xf8\x24\xf3\xe0\x71\x7b\x76\x28\x46\x3a\x3a\x1b\x91\xb6\xd4\x3e\x23\xe5\x44\x15\xbf\x60\x43\x9d\xa4\xbb\xd5\x5f\x89\xeb\xef\x8e\xfd\xdd\xb4\x0d\x46\xf0\x69\x23\x63\xae\x94\xf5\x5e\xa5\xad\x13\x1c\x41\x76\xe6\x90\xd6\x6d\xa2\x8f\x97\x4c\xa8\x0b\xcf\x8d\x43\x2b\x9c\x9b\xc5\x58\xa5\xb6\x95\x9a\xbf\x81\xc6\x54\xc9\x66\x0c\xe5\x4f\x6a\x53\xa1\xe5\x0c\xba\x31\xde\x34\x64\x73\x8a\x3b\xbd\x92\x01\xdb\x71\x69\xf3\x58\x99\xbc\xd1\xcb\x4a\x05\xe2\x58\x9c\x25\x17\xcd\xdc\x83\xb7\xff\xfb\x09\x61\xad\xbf\x13\x5b\x5e\xed\x46\x82\x6f\x22\xd8\x93\xa6\x85\x5b\x40\x39\x5c\xc5\x9c", -+ .ilen = 281, -+ .result = "\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x72\x65\x20\x64\x72\x61\x66\x74\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x76\x61\x6c\x69\x64\x20\x66\x6f\x72\x20\x61\x20\x6d\x61\x78\x69\x6d\x75\x6d\x20\x6f\x66\x20\x73\x69\x78\x20\x6d\x6f\x6e\x74\x68\x73\x20\x61\x6e\x64\x20\x6d\x61\x79\x20\x62\x65\x20\x75\x70\x64\x61\x74\x65\x64\x2c\x20\x72\x65\x70\x6c\x61\x63\x65\x64\x2c\x20\x6f\x72\x20\x6f\x62\x73\x6f\x6c\x65\x74\x65\x64\x20\x62\x79\x20\x6f\x74\x68\x65\x72\x20\x64\x6f\x63\x75\x6d\x65\x6e\x74\x73\x20\x61\x74\x20\x61\x6e\x79\x20\x74\x69\x6d\x65\x2e\x20\x49\x74\x20\x69\x73\x20\x69\x6e\x61\x70\x70\x72\x6f\x70\x72\x69\x61\x74\x65\x20\x74\x6f\x20\x75\x73\x65\x20\x49\x6e\x74\x65\x72\x6e\x65\x74\x2d\x44\x72\x61\x66\x74\x73\x20\x61\x73\x20\x72\x65\x66\x65\x72\x65\x6e\x63\x65\x20\x6d\x61\x74\x65\x72\x69\x61\x6c\x20\x6f\x72\x20\x74\x6f\x20\x63\x69\x74\x65\x20\x74\x68\x65\x6d\x20\x6f\x74\x68\x65\x72\x20\x74\x68\x61\x6e\x20\x61\x73\x20\x2f\xe2\x80\x9c\x77\x6f\x72\x6b\x20\x69\x6e\x20\x70\x72\x6f\x67\x72\x65\x73\x73\x2e\x2f\xe2\x80\x9d" -+} }; -+ -+bool __init chacha20poly1305_selftest(void) -+{ -+ size_t i; -+ u8 computed_result[3000]; -+ bool success = true, ret; -+ -+ for (i = 0; i < ARRAY_SIZE(chacha20poly1305_enc_vectors); ++i) { -+ memset(computed_result, 0, sizeof(computed_result)); -+ chacha20poly1305_encrypt(computed_result, chacha20poly1305_enc_vectors[i].input, chacha20poly1305_enc_vectors[i].ilen, chacha20poly1305_enc_vectors[i].assoc, chacha20poly1305_enc_vectors[i].alen, le64_to_cpu(*(__force __le64 *)chacha20poly1305_enc_vectors[i].nonce), chacha20poly1305_enc_vectors[i].key); -+ if (memcmp(computed_result, chacha20poly1305_enc_vectors[i].result, chacha20poly1305_enc_vectors[i].ilen + POLY1305_MAC_SIZE)) { -+ pr_info("chacha20poly1305 encryption self-test %zu: FAIL\n", i + 1); -+ success = false; -+ } -+ } -+ for (i = 0; i < ARRAY_SIZE(chacha20poly1305_dec_vectors); ++i) { -+ memset(computed_result, 0, sizeof(computed_result)); -+ ret = chacha20poly1305_decrypt(computed_result, chacha20poly1305_dec_vectors[i].input, chacha20poly1305_dec_vectors[i].ilen, chacha20poly1305_dec_vectors[i].assoc, chacha20poly1305_dec_vectors[i].alen, le64_to_cpu(*(__force __le64 *)chacha20poly1305_dec_vectors[i].nonce), chacha20poly1305_dec_vectors[i].key); -+ if (!ret || memcmp(computed_result, chacha20poly1305_dec_vectors[i].result, chacha20poly1305_dec_vectors[i].ilen - POLY1305_MAC_SIZE)) { -+ pr_info("chacha20poly1305 decryption self-test %zu: FAIL\n", i + 1); -+ success = false; -+ } -+ } -+ for (i = 0; i < ARRAY_SIZE(xchacha20poly1305_enc_vectors); ++i) { -+ memset(computed_result, 0, sizeof(computed_result)); -+ xchacha20poly1305_encrypt(computed_result, xchacha20poly1305_enc_vectors[i].input, xchacha20poly1305_enc_vectors[i].ilen, xchacha20poly1305_enc_vectors[i].assoc, xchacha20poly1305_enc_vectors[i].alen, xchacha20poly1305_enc_vectors[i].nonce, xchacha20poly1305_enc_vectors[i].key); -+ if (memcmp(computed_result, xchacha20poly1305_enc_vectors[i].result, xchacha20poly1305_enc_vectors[i].ilen + POLY1305_MAC_SIZE)) { -+ pr_info("xchacha20poly1305 encryption self-test %zu: FAIL\n", i + 1); -+ success = false; -+ } -+ } -+ for (i = 0; i < ARRAY_SIZE(xchacha20poly1305_dec_vectors); ++i) { -+ memset(computed_result, 0, sizeof(computed_result)); -+ ret = xchacha20poly1305_decrypt(computed_result, xchacha20poly1305_dec_vectors[i].input, xchacha20poly1305_dec_vectors[i].ilen, xchacha20poly1305_dec_vectors[i].assoc, xchacha20poly1305_dec_vectors[i].alen, xchacha20poly1305_dec_vectors[i].nonce, xchacha20poly1305_dec_vectors[i].key); -+ if (!ret || memcmp(computed_result, xchacha20poly1305_dec_vectors[i].result, xchacha20poly1305_dec_vectors[i].ilen - POLY1305_MAC_SIZE)) { -+ pr_info("xchacha20poly1305 decryption self-test %zu: FAIL\n", i + 1); -+ success = false; -+ } -+ } -+ if (success) -+ pr_info("chacha20poly1305 self-tests: pass\n"); -+ return success; -+} -+#endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/selftest/counter.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,92 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifdef DEBUG -+bool __init packet_counter_selftest(void) -+{ -+ bool success = true; -+ unsigned int test_num = 0, i; -+ union noise_counter counter; -+ -+#define T_INIT do { memset(&counter, 0, sizeof(union noise_counter)); spin_lock_init(&counter.receive.lock); } while (0) -+#define T_LIM (COUNTER_WINDOW_SIZE + 1) -+#define T(n, v) do { ++test_num; if (counter_validate(&counter, n) != v) { pr_info("nonce counter self-test %u: FAIL\n", test_num); success = false; } } while (0) -+ T_INIT; -+ /* 1 */ T(0, true); -+ /* 2 */ T(1, true); -+ /* 3 */ T(1, false); -+ /* 4 */ T(9, true); -+ /* 5 */ T(8, true); -+ /* 6 */ T(7, true); -+ /* 7 */ T(7, false); -+ /* 8 */ T(T_LIM, true); -+ /* 9 */ T(T_LIM - 1, true); -+ /* 10 */ T(T_LIM - 1, false); -+ /* 11 */ T(T_LIM - 2, true); -+ /* 12 */ T(2, true); -+ /* 13 */ T(2, false); -+ /* 14 */ T(T_LIM + 16, true); -+ /* 15 */ T(3, false); -+ /* 16 */ T(T_LIM + 16, false); -+ /* 17 */ T(T_LIM * 4, true); -+ /* 18 */ T(T_LIM * 4 - (T_LIM - 1), true); -+ /* 19 */ T(10, false); -+ /* 20 */ T(T_LIM * 4 - T_LIM, false); -+ /* 21 */ T(T_LIM * 4 - (T_LIM + 1), false); -+ /* 22 */ T(T_LIM * 4 - (T_LIM - 2), true); -+ /* 23 */ T(T_LIM * 4 + 1 - T_LIM, false); -+ /* 24 */ T(0, false); -+ /* 25 */ T(REJECT_AFTER_MESSAGES, false); -+ /* 26 */ T(REJECT_AFTER_MESSAGES - 1, true); -+ /* 27 */ T(REJECT_AFTER_MESSAGES, false); -+ /* 28 */ T(REJECT_AFTER_MESSAGES - 1, false); -+ /* 29 */ T(REJECT_AFTER_MESSAGES - 2, true); -+ /* 30 */ T(REJECT_AFTER_MESSAGES + 1, false); -+ /* 31 */ T(REJECT_AFTER_MESSAGES + 2, false); -+ /* 32 */ T(REJECT_AFTER_MESSAGES - 2, false); -+ /* 33 */ T(REJECT_AFTER_MESSAGES - 3, true); -+ /* 34 */ T(0, false); -+ -+ T_INIT; -+ for (i = 1; i <= COUNTER_WINDOW_SIZE; ++i) -+ T(i, true); -+ T(0, true); -+ T(0, false); -+ -+ T_INIT; -+ for (i = 2; i <= COUNTER_WINDOW_SIZE + 1; ++i) -+ T(i, true); -+ T(1, true); -+ T(0, false); -+ -+ T_INIT; -+ for (i = COUNTER_WINDOW_SIZE + 1; i-- > 0 ;) -+ T(i, true); -+ -+ T_INIT; -+ for (i = COUNTER_WINDOW_SIZE + 2; i-- > 1 ;) -+ T(i, true); -+ T(0, false); -+ -+ T_INIT; -+ for (i = COUNTER_WINDOW_SIZE + 1; i-- > 1 ;) -+ T(i, true); -+ T(COUNTER_WINDOW_SIZE + 1, true); -+ T(0, false); -+ -+ T_INIT; -+ for (i = COUNTER_WINDOW_SIZE + 1; i-- > 1 ;) -+ T(i, true); -+ T(0, true); -+ T(COUNTER_WINDOW_SIZE + 1, true); -+#undef T -+#undef T_LIM -+#undef T_INIT -+ -+ if (success) -+ pr_info("nonce counter self-tests: pass\n"); -+ return success; -+} -+#endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/selftest/curve25519.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,103 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifdef DEBUG -+struct curve25519_test_vector { -+ u8 private[CURVE25519_POINT_SIZE]; -+ u8 public[CURVE25519_POINT_SIZE]; -+ u8 result[CURVE25519_POINT_SIZE]; -+ bool valid; -+}; -+static const struct curve25519_test_vector curve25519_test_vectors[] __initconst = { -+ { -+ .private = { 0x77, 0x07, 0x6d, 0x0a, 0x73, 0x18, 0xa5, 0x7d, 0x3c, 0x16, 0xc1, 0x72, 0x51, 0xb2, 0x66, 0x45, 0xdf, 0x4c, 0x2f, 0x87, 0xeb, 0xc0, 0x99, 0x2a, 0xb1, 0x77, 0xfb, 0xa5, 0x1d, 0xb9, 0x2c, 0x2a }, -+ .public = { 0xde, 0x9e, 0xdb, 0x7d, 0x7b, 0x7d, 0xc1, 0xb4, 0xd3, 0x5b, 0x61, 0xc2, 0xec, 0xe4, 0x35, 0x37, 0x3f, 0x83, 0x43, 0xc8, 0x5b, 0x78, 0x67, 0x4d, 0xad, 0xfc, 0x7e, 0x14, 0x6f, 0x88, 0x2b, 0x4f }, -+ .result = { 0x4a, 0x5d, 0x9d, 0x5b, 0xa4, 0xce, 0x2d, 0xe1, 0x72, 0x8e, 0x3b, 0xf4, 0x80, 0x35, 0x0f, 0x25, 0xe0, 0x7e, 0x21, 0xc9, 0x47, 0xd1, 0x9e, 0x33, 0x76, 0xf0, 0x9b, 0x3c, 0x1e, 0x16, 0x17, 0x42 }, -+ .valid = true -+ }, -+ { -+ .private = { 0x5d, 0xab, 0x08, 0x7e, 0x62, 0x4a, 0x8a, 0x4b, 0x79, 0xe1, 0x7f, 0x8b, 0x83, 0x80, 0x0e, 0xe6, 0x6f, 0x3b, 0xb1, 0x29, 0x26, 0x18, 0xb6, 0xfd, 0x1c, 0x2f, 0x8b, 0x27, 0xff, 0x88, 0xe0, 0xeb }, -+ .public = { 0x85, 0x20, 0xf0, 0x09, 0x89, 0x30, 0xa7, 0x54, 0x74, 0x8b, 0x7d, 0xdc, 0xb4, 0x3e, 0xf7, 0x5a, 0x0d, 0xbf, 0x3a, 0x0d, 0x26, 0x38, 0x1a, 0xf4, 0xeb, 0xa4, 0xa9, 0x8e, 0xaa, 0x9b, 0x4e, 0x6a }, -+ .result = { 0x4a, 0x5d, 0x9d, 0x5b, 0xa4, 0xce, 0x2d, 0xe1, 0x72, 0x8e, 0x3b, 0xf4, 0x80, 0x35, 0x0f, 0x25, 0xe0, 0x7e, 0x21, 0xc9, 0x47, 0xd1, 0x9e, 0x33, 0x76, 0xf0, 0x9b, 0x3c, 0x1e, 0x16, 0x17, 0x42 }, -+ .valid = true -+ }, -+ { -+ .private = { 1 }, -+ .public = { 0x25, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }, -+ .result = { 0x3c, 0x77, 0x77, 0xca, 0xf9, 0x97, 0xb2, 0x64, 0x41, 0x60, 0x77, 0x66, 0x5b, 0x4e, 0x22, 0x9d, 0xb, 0x95, 0x48, 0xdc, 0xc, 0xd8, 0x19, 0x98, 0xdd, 0xcd, 0xc5, 0xc8, 0x53, 0x3c, 0x79, 0x7f }, -+ .valid = true -+ }, -+ { -+ .private = { 1 }, -+ .public = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }, -+ .result = { 0xb3, 0x2d, 0x13, 0x62, 0xc2, 0x48, 0xd6, 0x2f, 0xe6, 0x26, 0x19, 0xcf, 0xf0, 0x4d, 0xd4, 0x3d, 0xb7, 0x3f, 0xfc, 0x1b, 0x63, 0x8, 0xed, 0xe3, 0xb, 0x78, 0xd8, 0x73, 0x80, 0xf1, 0xe8, 0x34 }, -+ .valid = true -+ }, -+ { -+ .private = { 0xa5, 0x46, 0xe3, 0x6b, 0xf0, 0x52, 0x7c, 0x9d, 0x3b, 0x16, 0x15, 0x4b, 0x82, 0x46, 0x5e, 0xdd, 0x62, 0x14, 0x4c, 0x0a, 0xc1, 0xfc, 0x5a, 0x18, 0x50, 0x6a, 0x22, 0x44, 0xba, 0x44, 0x9a, 0xc4 }, -+ .public = { 0xe6, 0xdb, 0x68, 0x67, 0x58, 0x30, 0x30, 0xdb, 0x35, 0x94, 0xc1, 0xa4, 0x24, 0xb1, 0x5f, 0x7c, 0x72, 0x66, 0x24, 0xec, 0x26, 0xb3, 0x35, 0x3b, 0x10, 0xa9, 0x03, 0xa6, 0xd0, 0xab, 0x1c, 0x4c }, -+ .result = { 0xc3, 0xda, 0x55, 0x37, 0x9d, 0xe9, 0xc6, 0x90, 0x8e, 0x94, 0xea, 0x4d, 0xf2, 0x8d, 0x08, 0x4f, 0x32, 0xec, 0xcf, 0x03, 0x49, 0x1c, 0x71, 0xf7, 0x54, 0xb4, 0x07, 0x55, 0x77, 0xa2, 0x85, 0x52 }, -+ .valid = true -+ }, -+ { -+ .private = { 1, 2, 3, 4 }, -+ .public = { 0 }, -+ .result = { 0 }, -+ .valid = false -+ }, -+ { -+ .private = { 2, 4, 6, 8 }, -+ .public = { 0xe0, 0xeb, 0x7a, 0x7c, 0x3b, 0x41, 0xb8, 0xae, 0x16, 0x56, 0xe3, 0xfa, 0xf1, 0x9f, 0xc4, 0x6a, 0xda, 0x09, 0x8d, 0xeb, 0x9c, 0x32, 0xb1, 0xfd, 0x86, 0x62, 0x05, 0x16, 0x5f, 0x49, 0xb8 }, -+ .result = { 0 }, -+ .valid = false -+ }, -+ { -+ .private = { 0xff, 0xff, 0xff, 0xff, 0x0a, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }, -+ .public = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x0a, 0x00, 0xfb, 0x9f }, -+ .result = { 0x77, 0x52, 0xb6, 0x18, 0xc1, 0x2d, 0x48, 0xd2, 0xc6, 0x93, 0x46, 0x83, 0x81, 0x7c, 0xc6, 0x57, 0xf3, 0x31, 0x03, 0x19, 0x49, 0x48, 0x20, 0x05, 0x42, 0x2b, 0x4e, 0xae, 0x8d, 0x1d, 0x43, 0x23 }, -+ .valid = true -+ }, -+ { -+ .private = { 0x8e, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }, -+ .public = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x8e, 0x06 }, -+ .result = { 0x5a, 0xdf, 0xaa, 0x25, 0x86, 0x8e, 0x32, 0x3d, 0xae, 0x49, 0x62, 0xc1, 0x01, 0x5c, 0xb3, 0x12, 0xe1, 0xc5, 0xc7, 0x9e, 0x95, 0x3f, 0x03, 0x99, 0xb0, 0xba, 0x16, 0x22, 0xf3, 0xb6, 0xf7, 0x0c }, -+ .valid = true -+ } -+}; -+bool __init curve25519_selftest(void) -+{ -+ bool success = true, ret, ret2; -+ size_t i = 0, j; -+ u8 in[CURVE25519_POINT_SIZE], out[CURVE25519_POINT_SIZE], out2[CURVE25519_POINT_SIZE]; -+ -+ for (i = 0; i < ARRAY_SIZE(curve25519_test_vectors); ++i) { -+ memset(out, 0, CURVE25519_POINT_SIZE); -+ ret = curve25519(out, curve25519_test_vectors[i].private, curve25519_test_vectors[i].public); -+ if (ret != curve25519_test_vectors[i].valid || memcmp(out, curve25519_test_vectors[i].result, CURVE25519_POINT_SIZE)) { -+ pr_info("curve25519 self-test %zu: FAIL\n", i + 1); -+ success = false; -+ break; -+ } -+ } -+ -+ for (i = 0; i < 5; ++i) { -+ get_random_bytes(in, sizeof(in)); -+ ret = curve25519_generate_public(out, in); -+ ret2 = curve25519(out2, in, (u8[CURVE25519_POINT_SIZE]){ 9 }); -+ if (ret != ret2 || memcmp(out, out2, CURVE25519_POINT_SIZE)) { -+ pr_info("curve25519 basepoint self-test %zu: FAIL: input - 0x", i + 1); -+ for (j = CURVE25519_POINT_SIZE; j-- > 0;) -+ printk(KERN_CONT "%02x", in[j]); -+ printk(KERN_CONT "\n"); -+ success = false; -+ break; -+ } -+ } -+ -+ if (success) -+ pr_info("curve25519 self-tests: pass\n"); -+ return success; -+} -+#endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/selftest/poly1305.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,1566 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * Copyright (C) 2016-2017 The OpenSSL Project Authors. All Rights Reserved. -+ */ -+ -+#ifdef DEBUG -+ -+struct poly1305_testdata { -+ size_t size; -+ const u8 data[1024]; -+}; -+ -+struct poly1305_testvec { -+ struct poly1305_testdata input, key, expected; -+}; -+ -+static const struct poly1305_testvec poly1305_testvecs[] = { -+ /* -+ * RFC7539 -+ */ -+ { -+ { -+ 34, -+ { -+ 0x43, 0x72, 0x79, 0x70, 0x74, 0x6f, 0x67, 0x72, -+ 0x61, 0x70, 0x68, 0x69, 0x63, 0x20, 0x46, 0x6f, -+ 0x72, 0x75, 0x6d, 0x20, 0x52, 0x65, 0x73, 0x65, -+ 0x61, 0x72, 0x63, 0x68, 0x20, 0x47, 0x72, 0x6f, -+ -+ 0x75, 0x70 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x85, 0xd6, 0xbe, 0x78, 0x57, 0x55, 0x6d, 0x33, -+ 0x7f, 0x44, 0x52, 0xfe, 0x42, 0xd5, 0x06, 0xa8, -+ 0x01, 0x03, 0x80, 0x8a, 0xfb, 0x0d, 0xb2, 0xfd, -+ 0x4a, 0xbf, 0xf6, 0xaf, 0x41, 0x49, 0xf5, 0x1b -+ } -+ }, -+ { -+ 16, -+ { -+ 0xa8, 0x06, 0x1d, 0xc1, 0x30, 0x51, 0x36, 0xc6, -+ 0xc2, 0x2b, 0x8b, 0xaf, 0x0c, 0x01, 0x27, 0xa9 -+ } -+ } -+ }, -+ /* -+ * test vectors from "The Poly1305-AES message-authentication code" -+ */ -+ { -+ { -+ 2, -+ { -+ 0xf3, 0xf6 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x85, 0x1f, 0xc4, 0x0c, 0x34, 0x67, 0xac, 0x0b, -+ 0xe0, 0x5c, 0xc2, 0x04, 0x04, 0xf3, 0xf7, 0x00, -+ 0x58, 0x0b, 0x3b, 0x0f, 0x94, 0x47, 0xbb, 0x1e, -+ 0x69, 0xd0, 0x95, 0xb5, 0x92, 0x8b, 0x6d, 0xbc -+ } -+ }, -+ { -+ 16, -+ { -+ 0xf4, 0xc6, 0x33, 0xc3, 0x04, 0x4f, 0xc1, 0x45, -+ 0xf8, 0x4f, 0x33, 0x5c, 0xb8, 0x19, 0x53, 0xde -+ } -+ } -+ }, -+ { -+ { -+ 0, -+ { -+ 0 -+ } -+ }, -+ { -+ 32, -+ { -+ 0xa0, 0xf3, 0x08, 0x00, 0x00, 0xf4, 0x64, 0x00, -+ 0xd0, 0xc7, 0xe9, 0x07, 0x6c, 0x83, 0x44, 0x03, -+ 0xdd, 0x3f, 0xab, 0x22, 0x51, 0xf1, 0x1a, 0xc7, -+ 0x59, 0xf0, 0x88, 0x71, 0x29, 0xcc, 0x2e, 0xe7 -+ } -+ }, -+ { -+ 16, -+ { -+ 0xdd, 0x3f, 0xab, 0x22, 0x51, 0xf1, 0x1a, 0xc7, -+ 0x59, 0xf0, 0x88, 0x71, 0x29, 0xcc, 0x2e, 0xe7 -+ } -+ } -+ }, -+ { -+ { -+ 32, -+ { -+ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, -+ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, -+ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, -+ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, -+ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, -+ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, -+ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef -+ } -+ }, -+ { -+ 16, -+ { -+ 0x0e, 0xe1, 0xc1, 0x6b, 0xb7, 0x3f, 0x0f, 0x4f, -+ 0xd1, 0x98, 0x81, 0x75, 0x3c, 0x01, 0xcd, 0xbe -+ } -+ } -+ }, -+ { -+ { -+ 63, -+ { -+ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, -+ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, -+ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, -+ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, -+ -+ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, -+ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, -+ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, -+ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, -+ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, -+ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, -+ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x51, 0x54, 0xad, 0x0d, 0x2c, 0xb2, 0x6e, 0x01, -+ 0x27, 0x4f, 0xc5, 0x11, 0x48, 0x49, 0x1f, 0x1b -+ } -+ }, -+ }, -+ /* -+ * self-generated vectors exercise "significant" lengths, such that -+ * are handled by different code paths -+ */ -+ { -+ { -+ 64, -+ { -+ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, -+ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, -+ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, -+ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, -+ -+ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, -+ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, -+ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, -+ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf -+ } -+ }, -+ { -+ 32, -+ { -+ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, -+ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, -+ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, -+ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x81, 0x20, 0x59, 0xa5, 0xda, 0x19, 0x86, 0x37, -+ 0xca, 0xc7, 0xc4, 0xa6, 0x31, 0xbe, 0xe4, 0x66 -+ } -+ }, -+ }, -+ { -+ { -+ 48, -+ { -+ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, -+ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, -+ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, -+ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, -+ -+ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, -+ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, -+ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, -+ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, -+ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 -+ -+ } -+ }, -+ { -+ 16, -+ { -+ 0x5b, 0x88, 0xd7, 0xf6, 0x22, 0x8b, 0x11, 0xe2, -+ 0xe2, 0x85, 0x79, 0xa5, 0xc0, 0xc1, 0xf7, 0x61 -+ } -+ }, -+ }, -+ { -+ { -+ 96, -+ { -+ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, -+ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, -+ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, -+ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, -+ -+ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, -+ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, -+ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, -+ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, -+ -+ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, -+ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, -+ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, -+ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, -+ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, -+ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, -+ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 -+ } -+ }, -+ { -+ 16, -+ { -+ 0xbb, 0xb6, 0x13, 0xb2, 0xb6, 0xd7, 0x53, 0xba, -+ 0x07, 0x39, 0x5b, 0x91, 0x6a, 0xae, 0xce, 0x15 -+ } -+ }, -+ }, -+ { -+ { -+ 112, -+ { -+ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, -+ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, -+ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, -+ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, -+ -+ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, -+ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, -+ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, -+ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, -+ -+ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, -+ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, -+ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, -+ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, -+ -+ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, -+ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, -+ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, -+ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, -+ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 -+ } -+ }, -+ { -+ 16, -+ { -+ 0xc7, 0x94, 0xd7, 0x05, 0x7d, 0x17, 0x78, 0xc4, -+ 0xbb, 0xee, 0x0a, 0x39, 0xb3, 0xd9, 0x73, 0x42 -+ } -+ }, -+ }, -+ { -+ { -+ 128, -+ { -+ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, -+ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, -+ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, -+ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, -+ -+ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, -+ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, -+ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, -+ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, -+ -+ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, -+ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, -+ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, -+ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, -+ -+ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, -+ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, -+ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, -+ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, -+ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, -+ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, -+ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 -+ } -+ }, -+ { -+ 16, -+ { -+ 0xff, 0xbc, 0xb9, 0xb3, 0x71, 0x42, 0x31, 0x52, -+ 0xd7, 0xfc, 0xa5, 0xad, 0x04, 0x2f, 0xba, 0xa9 -+ } -+ }, -+ }, -+ { -+ { -+ 144, -+ { -+ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, -+ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, -+ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, -+ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, -+ -+ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, -+ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, -+ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, -+ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, -+ -+ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, -+ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, -+ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, -+ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, -+ -+ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, -+ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, -+ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, -+ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36, -+ -+ 0x81, 0x20, 0x59, 0xa5, 0xda, 0x19, 0x86, 0x37, -+ 0xca, 0xc7, 0xc4, 0xa6, 0x31, 0xbe, 0xe4, 0x66 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, -+ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, -+ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, -+ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x06, 0x9e, 0xd6, 0xb8, 0xef, 0x0f, 0x20, 0x7b, -+ 0x3e, 0x24, 0x3b, 0xb1, 0x01, 0x9f, 0xe6, 0x32 -+ } -+ }, -+ }, -+ { -+ { -+ 160, -+ { -+ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, -+ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, -+ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, -+ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, -+ -+ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, -+ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, -+ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, -+ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, -+ -+ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, -+ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, -+ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, -+ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, -+ -+ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, -+ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, -+ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, -+ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36, -+ -+ 0x81, 0x20, 0x59, 0xa5, 0xda, 0x19, 0x86, 0x37, -+ 0xca, 0xc7, 0xc4, 0xa6, 0x31, 0xbe, 0xe4, 0x66, -+ 0x5b, 0x88, 0xd7, 0xf6, 0x22, 0x8b, 0x11, 0xe2, -+ 0xe2, 0x85, 0x79, 0xa5, 0xc0, 0xc1, 0xf7, 0x61 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, -+ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, -+ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, -+ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 -+ } -+ }, -+ { -+ 16, -+ { -+ 0xcc, 0xa3, 0x39, 0xd9, 0xa4, 0x5f, 0xa2, 0x36, -+ 0x8c, 0x2c, 0x68, 0xb3, 0xa4, 0x17, 0x91, 0x33 -+ } -+ }, -+ }, -+ { -+ { -+ 288, -+ { -+ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, -+ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, -+ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, -+ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, -+ -+ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, -+ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, -+ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, -+ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, -+ -+ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, -+ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, -+ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, -+ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, -+ -+ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, -+ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, -+ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, -+ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36, -+ -+ 0x81, 0x20, 0x59, 0xa5, 0xda, 0x19, 0x86, 0x37, -+ 0xca, 0xc7, 0xc4, 0xa6, 0x31, 0xbe, 0xe4, 0x66, -+ 0x5b, 0x88, 0xd7, 0xf6, 0x22, 0x8b, 0x11, 0xe2, -+ 0xe2, 0x85, 0x79, 0xa5, 0xc0, 0xc1, 0xf7, 0x61, -+ -+ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, -+ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, -+ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, -+ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, -+ -+ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, -+ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, -+ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, -+ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, -+ -+ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, -+ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, -+ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, -+ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, -+ -+ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, -+ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, -+ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, -+ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, -+ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, -+ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, -+ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x53, 0xf6, 0xe8, 0x28, 0xa2, 0xf0, 0xfe, 0x0e, -+ 0xe8, 0x15, 0xbf, 0x0b, 0xd5, 0x84, 0x1a, 0x34 -+ } -+ }, -+ }, -+ { -+ { -+ 320, -+ { -+ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, -+ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, -+ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, -+ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, -+ -+ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, -+ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, -+ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, -+ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, -+ -+ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, -+ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, -+ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, -+ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, -+ -+ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, -+ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, -+ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, -+ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36, -+ -+ 0x81, 0x20, 0x59, 0xa5, 0xda, 0x19, 0x86, 0x37, -+ 0xca, 0xc7, 0xc4, 0xa6, 0x31, 0xbe, 0xe4, 0x66, -+ 0x5b, 0x88, 0xd7, 0xf6, 0x22, 0x8b, 0x11, 0xe2, -+ 0xe2, 0x85, 0x79, 0xa5, 0xc0, 0xc1, 0xf7, 0x61, -+ -+ 0xab, 0x08, 0x12, 0x72, 0x4a, 0x7f, 0x1e, 0x34, -+ 0x27, 0x42, 0xcb, 0xed, 0x37, 0x4d, 0x94, 0xd1, -+ 0x36, 0xc6, 0xb8, 0x79, 0x5d, 0x45, 0xb3, 0x81, -+ 0x98, 0x30, 0xf2, 0xc0, 0x44, 0x91, 0xfa, 0xf0, -+ -+ 0x99, 0x0c, 0x62, 0xe4, 0x8b, 0x80, 0x18, 0xb2, -+ 0xc3, 0xe4, 0xa0, 0xfa, 0x31, 0x34, 0xcb, 0x67, -+ 0xfa, 0x83, 0xe1, 0x58, 0xc9, 0x94, 0xd9, 0x61, -+ 0xc4, 0xcb, 0x21, 0x09, 0x5c, 0x1b, 0xf9, 0xaf, -+ -+ 0x48, 0x44, 0x3d, 0x0b, 0xb0, 0xd2, 0x11, 0x09, -+ 0xc8, 0x9a, 0x10, 0x0b, 0x5c, 0xe2, 0xc2, 0x08, -+ 0x83, 0x14, 0x9c, 0x69, 0xb5, 0x61, 0xdd, 0x88, -+ 0x29, 0x8a, 0x17, 0x98, 0xb1, 0x07, 0x16, 0xef, -+ -+ 0x66, 0x3c, 0xea, 0x19, 0x0f, 0xfb, 0x83, 0xd8, -+ 0x95, 0x93, 0xf3, 0xf4, 0x76, 0xb6, 0xbc, 0x24, -+ 0xd7, 0xe6, 0x79, 0x10, 0x7e, 0xa2, 0x6a, 0xdb, -+ 0x8c, 0xaf, 0x66, 0x52, 0xd0, 0x65, 0x61, 0x36, -+ -+ 0x81, 0x20, 0x59, 0xa5, 0xda, 0x19, 0x86, 0x37, -+ 0xca, 0xc7, 0xc4, 0xa6, 0x31, 0xbe, 0xe4, 0x66, -+ 0x5b, 0x88, 0xd7, 0xf6, 0x22, 0x8b, 0x11, 0xe2, -+ 0xe2, 0x85, 0x79, 0xa5, 0xc0, 0xc1, 0xf7, 0x61 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x12, 0x97, 0x6a, 0x08, 0xc4, 0x42, 0x6d, 0x0c, -+ 0xe8, 0xa8, 0x24, 0x07, 0xc4, 0xf4, 0x82, 0x07, -+ 0x80, 0xf8, 0xc2, 0x0a, 0xa7, 0x12, 0x02, 0xd1, -+ 0xe2, 0x91, 0x79, 0xcb, 0xcb, 0x55, 0x5a, 0x57 -+ } -+ }, -+ { -+ 16, -+ { -+ 0xb8, 0x46, 0xd4, 0x4e, 0x9b, 0xbd, 0x53, 0xce, -+ 0xdf, 0xfb, 0xfb, 0xb6, 0xb7, 0xfa, 0x49, 0x33 -+ } -+ }, -+ }, -+ /* -+ * 4th power of the key spills to 131th bit in SIMD key setup -+ */ -+ { -+ { -+ 256, -+ { -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff -+ } -+ }, -+ { -+ 32, -+ { -+ 0xad, 0x62, 0x81, 0x07, 0xe8, 0x35, 0x1d, 0x0f, -+ 0x2c, 0x23, 0x1a, 0x05, 0xdc, 0x4a, 0x41, 0x06, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x07, 0x14, 0x5a, 0x4c, 0x02, 0xfe, 0x5f, 0xa3, -+ 0x20, 0x36, 0xde, 0x68, 0xfa, 0xbe, 0x90, 0x66 -+ } -+ }, -+ }, -+ /* -+ * OpenSSL's poly1305_ieee754.c failed this in final stage -+ */ -+ { -+ { -+ 252, -+ { -+ 0x84, 0x23, 0x64, 0xe1, 0x56, 0x33, 0x6c, 0x09, -+ 0x98, 0xb9, 0x33, 0xa6, 0x23, 0x77, 0x26, 0x18, -+ 0x0d, 0x9e, 0x3f, 0xdc, 0xbd, 0xe4, 0xcd, 0x5d, -+ 0x17, 0x08, 0x0f, 0xc3, 0xbe, 0xb4, 0x96, 0x14, -+ -+ 0xd7, 0x12, 0x2c, 0x03, 0x74, 0x63, 0xff, 0x10, -+ 0x4d, 0x73, 0xf1, 0x9c, 0x12, 0x70, 0x46, 0x28, -+ 0xd4, 0x17, 0xc4, 0xc5, 0x4a, 0x3f, 0xe3, 0x0d, -+ 0x3c, 0x3d, 0x77, 0x14, 0x38, 0x2d, 0x43, 0xb0, -+ -+ 0x38, 0x2a, 0x50, 0xa5, 0xde, 0xe5, 0x4b, 0xe8, -+ 0x44, 0xb0, 0x76, 0xe8, 0xdf, 0x88, 0x20, 0x1a, -+ 0x1c, 0xd4, 0x3b, 0x90, 0xeb, 0x21, 0x64, 0x3f, -+ 0xa9, 0x6f, 0x39, 0xb5, 0x18, 0xaa, 0x83, 0x40, -+ -+ 0xc9, 0x42, 0xff, 0x3c, 0x31, 0xba, 0xf7, 0xc9, -+ 0xbd, 0xbf, 0x0f, 0x31, 0xae, 0x3f, 0xa0, 0x96, -+ 0xbf, 0x8c, 0x63, 0x03, 0x06, 0x09, 0x82, 0x9f, -+ 0xe7, 0x2e, 0x17, 0x98, 0x24, 0x89, 0x0b, 0xc8, -+ -+ 0xe0, 0x8c, 0x31, 0x5c, 0x1c, 0xce, 0x2a, 0x83, -+ 0x14, 0x4d, 0xbb, 0xff, 0x09, 0xf7, 0x4e, 0x3e, -+ 0xfc, 0x77, 0x0b, 0x54, 0xd0, 0x98, 0x4a, 0x8f, -+ 0x19, 0xb1, 0x47, 0x19, 0xe6, 0x36, 0x35, 0x64, -+ -+ 0x1d, 0x6b, 0x1e, 0xed, 0xf6, 0x3e, 0xfb, 0xf0, -+ 0x80, 0xe1, 0x78, 0x3d, 0x32, 0x44, 0x54, 0x12, -+ 0x11, 0x4c, 0x20, 0xde, 0x0b, 0x83, 0x7a, 0x0d, -+ 0xfa, 0x33, 0xd6, 0xb8, 0x28, 0x25, 0xff, 0xf4, -+ -+ 0x4c, 0x9a, 0x70, 0xea, 0x54, 0xce, 0x47, 0xf0, -+ 0x7d, 0xf6, 0x98, 0xe6, 0xb0, 0x33, 0x23, 0xb5, -+ 0x30, 0x79, 0x36, 0x4a, 0x5f, 0xc3, 0xe9, 0xdd, -+ 0x03, 0x43, 0x92, 0xbd, 0xde, 0x86, 0xdc, 0xcd, -+ -+ 0xda, 0x94, 0x32, 0x1c, 0x5e, 0x44, 0x06, 0x04, -+ 0x89, 0x33, 0x6c, 0xb6, 0x5b, 0xf3, 0x98, 0x9c, -+ 0x36, 0xf7, 0x28, 0x2c, 0x2f, 0x5d, 0x2b, 0x88, -+ 0x2c, 0x17, 0x1e, 0x74 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x95, 0xd5, 0xc0, 0x05, 0x50, 0x3e, 0x51, 0x0d, -+ 0x8c, 0xd0, 0xaa, 0x07, 0x2c, 0x4a, 0x4d, 0x06, -+ 0x6e, 0xab, 0xc5, 0x2d, 0x11, 0x65, 0x3d, 0xf4, -+ 0x7f, 0xbf, 0x63, 0xab, 0x19, 0x8b, 0xcc, 0x26 -+ } -+ }, -+ { -+ 16, -+ { -+ 0xf2, 0x48, 0x31, 0x2e, 0x57, 0x8d, 0x9d, 0x58, -+ 0xf8, 0xb7, 0xbb, 0x4d, 0x19, 0x10, 0x54, 0x31 -+ } -+ }, -+ }, -+ /* -+ * AVX2 in OpenSSL's poly1305-x86.pl failed this with 176+32 split -+ */ -+ { -+ { -+ 208, -+ { -+ 0x24, 0x8a, 0xc3, 0x10, 0x85, 0xb6, 0xc2, 0xad, -+ 0xaa, 0xa3, 0x82, 0x59, 0xa0, 0xd7, 0x19, 0x2c, -+ 0x5c, 0x35, 0xd1, 0xbb, 0x4e, 0xf3, 0x9a, 0xd9, -+ 0x4c, 0x38, 0xd1, 0xc8, 0x24, 0x79, 0xe2, 0xdd, -+ -+ 0x21, 0x59, 0xa0, 0x77, 0x02, 0x4b, 0x05, 0x89, -+ 0xbc, 0x8a, 0x20, 0x10, 0x1b, 0x50, 0x6f, 0x0a, -+ 0x1a, 0xd0, 0xbb, 0xab, 0x76, 0xe8, 0x3a, 0x83, -+ 0xf1, 0xb9, 0x4b, 0xe6, 0xbe, 0xae, 0x74, 0xe8, -+ -+ 0x74, 0xca, 0xb6, 0x92, 0xc5, 0x96, 0x3a, 0x75, -+ 0x43, 0x6b, 0x77, 0x61, 0x21, 0xec, 0x9f, 0x62, -+ 0x39, 0x9a, 0x3e, 0x66, 0xb2, 0xd2, 0x27, 0x07, -+ 0xda, 0xe8, 0x19, 0x33, 0xb6, 0x27, 0x7f, 0x3c, -+ -+ 0x85, 0x16, 0xbc, 0xbe, 0x26, 0xdb, 0xbd, 0x86, -+ 0xf3, 0x73, 0x10, 0x3d, 0x7c, 0xf4, 0xca, 0xd1, -+ 0x88, 0x8c, 0x95, 0x21, 0x18, 0xfb, 0xfb, 0xd0, -+ 0xd7, 0xb4, 0xbe, 0xdc, 0x4a, 0xe4, 0x93, 0x6a, -+ -+ 0xff, 0x91, 0x15, 0x7e, 0x7a, 0xa4, 0x7c, 0x54, -+ 0x44, 0x2e, 0xa7, 0x8d, 0x6a, 0xc2, 0x51, 0xd3, -+ 0x24, 0xa0, 0xfb, 0xe4, 0x9d, 0x89, 0xcc, 0x35, -+ 0x21, 0xb6, 0x6d, 0x16, 0xe9, 0xc6, 0x6a, 0x37, -+ -+ 0x09, 0x89, 0x4e, 0x4e, 0xb0, 0xa4, 0xee, 0xdc, -+ 0x4a, 0xe1, 0x94, 0x68, 0xe6, 0x6b, 0x81, 0xf2, -+ -+ 0x71, 0x35, 0x1b, 0x1d, 0x92, 0x1e, 0xa5, 0x51, -+ 0x04, 0x7a, 0xbc, 0xc6, 0xb8, 0x7a, 0x90, 0x1f, -+ 0xde, 0x7d, 0xb7, 0x9f, 0xa1, 0x81, 0x8c, 0x11, -+ 0x33, 0x6d, 0xbc, 0x07, 0x24, 0x4a, 0x40, 0xeb -+ } -+ }, -+ { -+ 32, -+ { -+ 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, -+ 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ { -+ 16, -+ { -+ 0xbc, 0x93, 0x9b, 0xc5, 0x28, 0x14, 0x80, 0xfa, -+ 0x99, 0xc6, 0xd6, 0x8c, 0x25, 0x8e, 0xc4, 0x2f -+ } -+ }, -+ }, -+ /* -+ * test vectors from Google -+ */ -+ { -+ { -+ 0, -+ { -+ 0x00, -+ } -+ }, -+ { -+ 32, -+ { -+ 0xc8, 0xaf, 0xaa, 0xc3, 0x31, 0xee, 0x37, 0x2c, -+ 0xd6, 0x08, 0x2d, 0xe1, 0x34, 0x94, 0x3b, 0x17, -+ 0x47, 0x10, 0x13, 0x0e, 0x9f, 0x6f, 0xea, 0x8d, -+ 0x72, 0x29, 0x38, 0x50, 0xa6, 0x67, 0xd8, 0x6c -+ } -+ }, -+ { -+ 16, -+ { -+ 0x47, 0x10, 0x13, 0x0e, 0x9f, 0x6f, 0xea, 0x8d, -+ 0x72, 0x29, 0x38, 0x50, 0xa6, 0x67, 0xd8, 0x6c -+ } -+ }, -+ }, -+ { -+ { -+ 12, -+ { -+ 0x48, 0x65, 0x6c, 0x6c, 0x6f, 0x20, 0x77, 0x6f, -+ 0x72, 0x6c, 0x64, 0x21 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x74, 0x68, 0x69, 0x73, 0x20, 0x69, 0x73, 0x20, -+ 0x33, 0x32, 0x2d, 0x62, 0x79, 0x74, 0x65, 0x20, -+ 0x6b, 0x65, 0x79, 0x20, 0x66, 0x6f, 0x72, 0x20, -+ 0x50, 0x6f, 0x6c, 0x79, 0x31, 0x33, 0x30, 0x35 -+ } -+ }, -+ { -+ 16, -+ { -+ 0xa6, 0xf7, 0x45, 0x00, 0x8f, 0x81, 0xc9, 0x16, -+ 0xa2, 0x0d, 0xcc, 0x74, 0xee, 0xf2, 0xb2, 0xf0 -+ } -+ }, -+ }, -+ { -+ { -+ 32, -+ { -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x74, 0x68, 0x69, 0x73, 0x20, 0x69, 0x73, 0x20, -+ 0x33, 0x32, 0x2d, 0x62, 0x79, 0x74, 0x65, 0x20, -+ 0x6b, 0x65, 0x79, 0x20, 0x66, 0x6f, 0x72, 0x20, -+ 0x50, 0x6f, 0x6c, 0x79, 0x31, 0x33, 0x30, 0x35 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x49, 0xec, 0x78, 0x09, 0x0e, 0x48, 0x1e, 0xc6, -+ 0xc2, 0x6b, 0x33, 0xb9, 0x1c, 0xcc, 0x03, 0x07 -+ } -+ }, -+ }, -+ { -+ { -+ 128, -+ { -+ 0x89, 0xda, 0xb8, 0x0b, 0x77, 0x17, 0xc1, 0xdb, -+ 0x5d, 0xb4, 0x37, 0x86, 0x0a, 0x3f, 0x70, 0x21, -+ 0x8e, 0x93, 0xe1, 0xb8, 0xf4, 0x61, 0xfb, 0x67, -+ 0x7f, 0x16, 0xf3, 0x5f, 0x6f, 0x87, 0xe2, 0xa9, -+ -+ 0x1c, 0x99, 0xbc, 0x3a, 0x47, 0xac, 0xe4, 0x76, -+ 0x40, 0xcc, 0x95, 0xc3, 0x45, 0xbe, 0x5e, 0xcc, -+ 0xa5, 0xa3, 0x52, 0x3c, 0x35, 0xcc, 0x01, 0x89, -+ 0x3a, 0xf0, 0xb6, 0x4a, 0x62, 0x03, 0x34, 0x27, -+ -+ 0x03, 0x72, 0xec, 0x12, 0x48, 0x2d, 0x1b, 0x1e, -+ 0x36, 0x35, 0x61, 0x69, 0x8a, 0x57, 0x8b, 0x35, -+ 0x98, 0x03, 0x49, 0x5b, 0xb4, 0xe2, 0xef, 0x19, -+ 0x30, 0xb1, 0x7a, 0x51, 0x90, 0xb5, 0x80, 0xf1, -+ -+ 0x41, 0x30, 0x0d, 0xf3, 0x0a, 0xdb, 0xec, 0xa2, -+ 0x8f, 0x64, 0x27, 0xa8, 0xbc, 0x1a, 0x99, 0x9f, -+ 0xd5, 0x1c, 0x55, 0x4a, 0x01, 0x7d, 0x09, 0x5d, -+ 0x8c, 0x3e, 0x31, 0x27, 0xda, 0xf9, 0xf5, 0x95 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x2d, 0x77, 0x3b, 0xe3, 0x7a, 0xdb, 0x1e, 0x4d, -+ 0x68, 0x3b, 0xf0, 0x07, 0x5e, 0x79, 0xc4, 0xee, -+ 0x03, 0x79, 0x18, 0x53, 0x5a, 0x7f, 0x99, 0xcc, -+ 0xb7, 0x04, 0x0f, 0xb5, 0xf5, 0xf4, 0x3a, 0xea -+ } -+ }, -+ { -+ 16, -+ { -+ 0xc8, 0x5d, 0x15, 0xed, 0x44, 0xc3, 0x78, 0xd6, -+ 0xb0, 0x0e, 0x23, 0x06, 0x4c, 0x7b, 0xcd, 0x51 -+ } -+ }, -+ }, -+ { -+ { -+ 528, -+ { -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0b, -+ 0x17, 0x03, 0x03, 0x02, 0x00, 0x00, 0x00, 0x00, -+ -+ 0x06, 0xdb, 0x1f, 0x1f, 0x36, 0x8d, 0x69, 0x6a, -+ 0x81, 0x0a, 0x34, 0x9c, 0x0c, 0x71, 0x4c, 0x9a, -+ 0x5e, 0x78, 0x50, 0xc2, 0x40, 0x7d, 0x72, 0x1a, -+ 0xcd, 0xed, 0x95, 0xe0, 0x18, 0xd7, 0xa8, 0x52, -+ -+ 0x66, 0xa6, 0xe1, 0x28, 0x9c, 0xdb, 0x4a, 0xeb, -+ 0x18, 0xda, 0x5a, 0xc8, 0xa2, 0xb0, 0x02, 0x6d, -+ 0x24, 0xa5, 0x9a, 0xd4, 0x85, 0x22, 0x7f, 0x3e, -+ 0xae, 0xdb, 0xb2, 0xe7, 0xe3, 0x5e, 0x1c, 0x66, -+ -+ 0xcd, 0x60, 0xf9, 0xab, 0xf7, 0x16, 0xdc, 0xc9, -+ 0xac, 0x42, 0x68, 0x2d, 0xd7, 0xda, 0xb2, 0x87, -+ 0xa7, 0x02, 0x4c, 0x4e, 0xef, 0xc3, 0x21, 0xcc, -+ 0x05, 0x74, 0xe1, 0x67, 0x93, 0xe3, 0x7c, 0xec, -+ -+ 0x03, 0xc5, 0xbd, 0xa4, 0x2b, 0x54, 0xc1, 0x14, -+ 0xa8, 0x0b, 0x57, 0xaf, 0x26, 0x41, 0x6c, 0x7b, -+ 0xe7, 0x42, 0x00, 0x5e, 0x20, 0x85, 0x5c, 0x73, -+ 0xe2, 0x1d, 0xc8, 0xe2, 0xed, 0xc9, 0xd4, 0x35, -+ -+ 0xcb, 0x6f, 0x60, 0x59, 0x28, 0x00, 0x11, 0xc2, -+ 0x70, 0xb7, 0x15, 0x70, 0x05, 0x1c, 0x1c, 0x9b, -+ 0x30, 0x52, 0x12, 0x66, 0x20, 0xbc, 0x1e, 0x27, -+ 0x30, 0xfa, 0x06, 0x6c, 0x7a, 0x50, 0x9d, 0x53, -+ -+ 0xc6, 0x0e, 0x5a, 0xe1, 0xb4, 0x0a, 0xa6, 0xe3, -+ 0x9e, 0x49, 0x66, 0x92, 0x28, 0xc9, 0x0e, 0xec, -+ 0xb4, 0xa5, 0x0d, 0xb3, 0x2a, 0x50, 0xbc, 0x49, -+ 0xe9, 0x0b, 0x4f, 0x4b, 0x35, 0x9a, 0x1d, 0xfd, -+ -+ 0x11, 0x74, 0x9c, 0xd3, 0x86, 0x7f, 0xcf, 0x2f, -+ 0xb7, 0xbb, 0x6c, 0xd4, 0x73, 0x8f, 0x6a, 0x4a, -+ 0xd6, 0xf7, 0xca, 0x50, 0x58, 0xf7, 0x61, 0x88, -+ 0x45, 0xaf, 0x9f, 0x02, 0x0f, 0x6c, 0x3b, 0x96, -+ -+ 0x7b, 0x8f, 0x4c, 0xd4, 0xa9, 0x1e, 0x28, 0x13, -+ 0xb5, 0x07, 0xae, 0x66, 0xf2, 0xd3, 0x5c, 0x18, -+ 0x28, 0x4f, 0x72, 0x92, 0x18, 0x60, 0x62, 0xe1, -+ 0x0f, 0xd5, 0x51, 0x0d, 0x18, 0x77, 0x53, 0x51, -+ -+ 0xef, 0x33, 0x4e, 0x76, 0x34, 0xab, 0x47, 0x43, -+ 0xf5, 0xb6, 0x8f, 0x49, 0xad, 0xca, 0xb3, 0x84, -+ 0xd3, 0xfd, 0x75, 0xf7, 0x39, 0x0f, 0x40, 0x06, -+ 0xef, 0x2a, 0x29, 0x5c, 0x8c, 0x7a, 0x07, 0x6a, -+ -+ 0xd5, 0x45, 0x46, 0xcd, 0x25, 0xd2, 0x10, 0x7f, -+ 0xbe, 0x14, 0x36, 0xc8, 0x40, 0x92, 0x4a, 0xae, -+ 0xbe, 0x5b, 0x37, 0x08, 0x93, 0xcd, 0x63, 0xd1, -+ 0x32, 0x5b, 0x86, 0x16, 0xfc, 0x48, 0x10, 0x88, -+ -+ 0x6b, 0xc1, 0x52, 0xc5, 0x32, 0x21, 0xb6, 0xdf, -+ 0x37, 0x31, 0x19, 0x39, 0x32, 0x55, 0xee, 0x72, -+ 0xbc, 0xaa, 0x88, 0x01, 0x74, 0xf1, 0x71, 0x7f, -+ 0x91, 0x84, 0xfa, 0x91, 0x64, 0x6f, 0x17, 0xa2, -+ -+ 0x4a, 0xc5, 0x5d, 0x16, 0xbf, 0xdd, 0xca, 0x95, -+ 0x81, 0xa9, 0x2e, 0xda, 0x47, 0x92, 0x01, 0xf0, -+ 0xed, 0xbf, 0x63, 0x36, 0x00, 0xd6, 0x06, 0x6d, -+ 0x1a, 0xb3, 0x6d, 0x5d, 0x24, 0x15, 0xd7, 0x13, -+ -+ 0x51, 0xbb, 0xcd, 0x60, 0x8a, 0x25, 0x10, 0x8d, -+ 0x25, 0x64, 0x19, 0x92, 0xc1, 0xf2, 0x6c, 0x53, -+ 0x1c, 0xf9, 0xf9, 0x02, 0x03, 0xbc, 0x4c, 0xc1, -+ 0x9f, 0x59, 0x27, 0xd8, 0x34, 0xb0, 0xa4, 0x71, -+ -+ 0x16, 0xd3, 0x88, 0x4b, 0xbb, 0x16, 0x4b, 0x8e, -+ 0xc8, 0x83, 0xd1, 0xac, 0x83, 0x2e, 0x56, 0xb3, -+ 0x91, 0x8a, 0x98, 0x60, 0x1a, 0x08, 0xd1, 0x71, -+ 0x88, 0x15, 0x41, 0xd5, 0x94, 0xdb, 0x39, 0x9c, -+ -+ 0x6a, 0xe6, 0x15, 0x12, 0x21, 0x74, 0x5a, 0xec, -+ 0x81, 0x4c, 0x45, 0xb0, 0xb0, 0x5b, 0x56, 0x54, -+ 0x36, 0xfd, 0x6f, 0x13, 0x7a, 0xa1, 0x0a, 0x0c, -+ 0x0b, 0x64, 0x37, 0x61, 0xdb, 0xd6, 0xf9, 0xa9, -+ -+ 0xdc, 0xb9, 0x9b, 0x1a, 0x6e, 0x69, 0x08, 0x54, -+ 0xce, 0x07, 0x69, 0xcd, 0xe3, 0x97, 0x61, 0xd8, -+ 0x2f, 0xcd, 0xec, 0x15, 0xf0, 0xd9, 0x2d, 0x7d, -+ 0x8e, 0x94, 0xad, 0xe8, 0xeb, 0x83, 0xfb, 0xe0 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x99, 0xe5, 0x82, 0x2d, 0xd4, 0x17, 0x3c, 0x99, -+ 0x5e, 0x3d, 0xae, 0x0d, 0xde, 0xfb, 0x97, 0x74, -+ 0x3f, 0xde, 0x3b, 0x08, 0x01, 0x34, 0xb3, 0x9f, -+ 0x76, 0xe9, 0xbf, 0x8d, 0x0e, 0x88, 0xd5, 0x46 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x26, 0x37, 0x40, 0x8f, 0xe1, 0x30, 0x86, 0xea, -+ 0x73, 0xf9, 0x71, 0xe3, 0x42, 0x5e, 0x28, 0x20 -+ } -+ }, -+ }, -+ /* -+ * test vectors from Hanno Böck -+ */ -+ { -+ { -+ 257, -+ { -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ 0xcc, 0x80, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xce, 0xcc, 0xcc, 0xcc, -+ -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xc5, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xe3, 0xcc, 0xcc, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xac, 0xcc, 0xcc, 0xcc, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xe6, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x00, 0x00, 0x00, -+ 0xaf, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, -+ -+ 0xcc, 0xcc, 0xff, 0xff, 0xff, 0xf5, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ -+ 0x00, 0xff, 0xff, 0xff, 0xe7, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x71, 0x92, 0x05, 0xa8, 0x52, 0x1d, -+ -+ 0xfc -+ } -+ }, -+ { -+ 32, -+ { -+ 0x7f, 0x1b, 0x02, 0x64, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc -+ } -+ }, -+ { -+ 16, -+ { -+ 0x85, 0x59, 0xb8, 0x76, 0xec, 0xee, 0xd6, 0x6e, -+ 0xb3, 0x77, 0x98, 0xc0, 0x45, 0x7b, 0xaf, 0xf9 -+ } -+ }, -+ }, -+ { -+ { -+ 39, -+ { -+ 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, -+ 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, -+ 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, -+ 0xaa, 0xaa, 0xaa, 0x00, 0x00, 0x00, 0x00, 0x00, -+ -+ 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x64 -+ } -+ }, -+ { -+ 32, -+ { -+ 0xe0, 0x00, 0x16, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, -+ 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa -+ } -+ }, -+ { -+ 16, -+ { -+ 0x00, 0xbd, 0x12, 0x58, 0x97, 0x8e, 0x20, 0x54, -+ 0x44, 0xc9, 0xaa, 0xaa, 0x82, 0x00, 0x6f, 0xed -+ } -+ }, -+ }, -+ { -+ { -+ 2, -+ { -+ 0x02, 0xfc -+ } -+ }, -+ { -+ 32, -+ { -+ 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, -+ 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, -+ 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, -+ 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c -+ } -+ }, -+ { -+ 16, -+ { -+ 0x06, 0x12, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, -+ 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c -+ } -+ }, -+ }, -+ { -+ { -+ 415, -+ { -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7a, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ -+ 0x7b, 0x7b, 0x5c, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x6e, 0x7b, 0x00, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7a, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x5c, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, 0x7b, -+ -+ 0x7b, 0x6e, 0x7b, 0x00, 0x13, 0x00, 0x00, 0x00, -+ 0x00, 0xb3, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ -+ 0xf2, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x20, 0x00, 0xef, 0xff, 0x00, -+ 0x09, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00, -+ 0x00, 0x00, 0x09, 0x00, 0x00, 0x00, 0x64, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x13, 0x00, 0x00, 0x00, 0x00, -+ -+ 0xb3, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf2, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x20, 0x00, 0xef, 0xff, 0x00, 0x09, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x7a, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00, -+ -+ 0x00, 0x09, 0x00, 0x00, 0x00, 0x64, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfc -+ } -+ }, -+ { -+ 32, -+ { -+ 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x1e, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7b, 0x7b -+ } -+ }, -+ { -+ 16, -+ { -+ 0x33, 0x20, 0x5b, 0xbf, 0x9e, 0x9f, 0x8f, 0x72, -+ 0x12, 0xab, 0x9e, 0x2a, 0xb9, 0xb7, 0xe4, 0xa5 -+ } -+ }, -+ }, -+ { -+ { -+ 118, -+ { -+ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, -+ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, -+ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, -+ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, -+ -+ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, -+ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, -+ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, -+ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, -+ -+ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, -+ 0x77, 0x77, 0x77, 0x77, 0xff, 0xff, 0xff, 0xe9, -+ 0xe9, 0xac, 0xac, 0xac, 0xac, 0xac, 0xac, 0xac, -+ 0xac, 0xac, 0xac, 0xac, 0x00, 0x00, 0xac, 0xac, -+ -+ 0xec, 0x01, 0x00, 0xac, 0xac, 0xac, 0x2c, 0xac, -+ 0xa2, 0xac, 0xac, 0xac, 0xac, 0xac, 0xac, 0xac, -+ 0xac, 0xac, 0xac, 0xac, 0x64, 0xf2 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x00, 0x00, 0x00, 0x7f, 0x00, 0x00, 0x00, 0x7f, -+ 0x01, 0x00, 0x00, 0x20, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0xcf, 0x77, 0x77, 0x77, 0x77, 0x77, -+ 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77, 0x77 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x02, 0xee, 0x7c, 0x8c, 0x54, 0x6d, 0xde, 0xb1, -+ 0xa4, 0x67, 0xe4, 0xc3, 0x98, 0x11, 0x58, 0xb9 -+ } -+ }, -+ }, -+ /* -+ * test vectors from Andrew Moon -+ */ -+ { /* nacl */ -+ { -+ 131, -+ { -+ 0x8e, 0x99, 0x3b, 0x9f, 0x48, 0x68, 0x12, 0x73, -+ 0xc2, 0x96, 0x50, 0xba, 0x32, 0xfc, 0x76, 0xce, -+ 0x48, 0x33, 0x2e, 0xa7, 0x16, 0x4d, 0x96, 0xa4, -+ 0x47, 0x6f, 0xb8, 0xc5, 0x31, 0xa1, 0x18, 0x6a, -+ -+ 0xc0, 0xdf, 0xc1, 0x7c, 0x98, 0xdc, 0xe8, 0x7b, -+ 0x4d, 0xa7, 0xf0, 0x11, 0xec, 0x48, 0xc9, 0x72, -+ 0x71, 0xd2, 0xc2, 0x0f, 0x9b, 0x92, 0x8f, 0xe2, -+ 0x27, 0x0d, 0x6f, 0xb8, 0x63, 0xd5, 0x17, 0x38, -+ -+ 0xb4, 0x8e, 0xee, 0xe3, 0x14, 0xa7, 0xcc, 0x8a, -+ 0xb9, 0x32, 0x16, 0x45, 0x48, 0xe5, 0x26, 0xae, -+ 0x90, 0x22, 0x43, 0x68, 0x51, 0x7a, 0xcf, 0xea, -+ 0xbd, 0x6b, 0xb3, 0x73, 0x2b, 0xc0, 0xe9, 0xda, -+ -+ 0x99, 0x83, 0x2b, 0x61, 0xca, 0x01, 0xb6, 0xde, -+ 0x56, 0x24, 0x4a, 0x9e, 0x88, 0xd5, 0xf9, 0xb3, -+ 0x79, 0x73, 0xf6, 0x22, 0xa4, 0x3d, 0x14, 0xa6, -+ 0x59, 0x9b, 0x1f, 0x65, 0x4c, 0xb4, 0x5a, 0x74, -+ -+ 0xe3, 0x55, 0xa5 -+ } -+ }, -+ { -+ 32, -+ { -+ 0xee, 0xa6, 0xa7, 0x25, 0x1c, 0x1e, 0x72, 0x91, -+ 0x6d, 0x11, 0xc2, 0xcb, 0x21, 0x4d, 0x3c, 0x25, -+ 0x25, 0x39, 0x12, 0x1d, 0x8e, 0x23, 0x4e, 0x65, -+ 0x2d, 0x65, 0x1f, 0xa4, 0xc8, 0xcf, 0xf8, 0x80 -+ } -+ }, -+ { -+ 16, -+ { -+ 0xf3, 0xff, 0xc7, 0x70, 0x3f, 0x94, 0x00, 0xe5, -+ 0x2a, 0x7d, 0xfb, 0x4b, 0x3d, 0x33, 0x05, 0xd9 -+ } -+ }, -+ }, -+ { /* wrap 2^130-5 */ -+ { -+ 16, -+ { -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff -+ } -+ }, -+ { -+ 32, -+ { -+ 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ }, -+ { /* wrap 2^128 */ -+ { -+ 16, -+ { -+ 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff -+ } -+ }, -+ { -+ 16, -+ { -+ 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ }, -+ { /* limb carry */ -+ { -+ 48, -+ { -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xf0, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ -+ 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ }, -+ { /* 2^130-5 */ -+ { -+ 48, -+ { -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xfb, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, -+ 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, -+ -+ 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, -+ 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ -+ } -+ }, -+ }, -+ { /* 2^130-6 */ -+ { -+ 16, -+ { -+ 0xfd, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff -+ } -+ }, -+ { -+ 32, -+ { -+ 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ { -+ 16, -+ { -+ 0xfa, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, -+ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff -+ } -+ }, -+ }, -+ { /* 5*H+L reduction intermediate */ -+ { -+ 64, -+ { -+ 0xe3, 0x35, 0x94, 0xd7, 0x50, 0x5e, 0x43, 0xb9, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x33, 0x94, 0xd7, 0x50, 0x5e, 0x43, 0x79, 0xcd, -+ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ { -+ 32, -+ { -+ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x55, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ }, -+ { /* 5*H+L reduction final */ -+ { -+ 48, -+ { -+ 0xe3, 0x35, 0x94, 0xd7, 0x50, 0x5e, 0x43, 0xb9, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x33, 0x94, 0xd7, 0x50, 0x5e, 0x43, 0x79, 0xcd, -+ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ -+ } -+ }, -+ { -+ 32, -+ { -+ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ }, -+ { -+ 16, -+ { -+ 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 -+ } -+ } -+ } -+}; -+ -+bool __init poly1305_selftest(void) -+{ -+ bool have_simd = chacha20poly1305_init_simd(); -+ bool success = true; -+ size_t i; -+ -+ for (i = 0; i < ARRAY_SIZE(poly1305_testvecs); ++i) { -+ struct poly1305_ctx poly1305; -+ const u8 *in = poly1305_testvecs[i].input.data; -+ size_t inlen = poly1305_testvecs[i].input.size; -+ const u8 *key = poly1305_testvecs[i].key.data; -+ const u8 *expected = poly1305_testvecs[i].expected.data; -+ size_t expectedlen = poly1305_testvecs[i].expected.size; -+ u8 out[POLY1305_MAC_SIZE]; -+ -+ if (expectedlen != sizeof(out)) { -+ pr_info("poly1305 self-test %zu logic: FAIL\n", i + 1); -+ success = false; -+ } -+ -+ memset(out, 0, sizeof(out)); -+ memset(&poly1305, 0, sizeof(poly1305)); -+ poly1305_init(&poly1305, key, have_simd); -+ poly1305_update(&poly1305, in, inlen, have_simd); -+ poly1305_finish(&poly1305, out, have_simd); -+ if (memcmp(out, expected, expectedlen)) { -+ pr_info("poly1305 self-test %zu: FAIL\n", i + 1); -+ success = false; -+ } -+ -+ if (inlen > 16) { -+ memset(out, 0, sizeof(out)); -+ memset(&poly1305, 0, sizeof(poly1305)); -+ poly1305_init(&poly1305, key, have_simd); -+ poly1305_update(&poly1305, in, 1, have_simd); -+ poly1305_update(&poly1305, in + 1, inlen - 1, have_simd); -+ poly1305_finish(&poly1305, out, have_simd); -+ if (memcmp(out, expected, expectedlen)) { -+ pr_info("poly1305 self-test %zu/1+(N-1): FAIL\n", i + 1); -+ success = false; -+ } -+ } -+ -+ if (inlen > 32) { -+ size_t half = inlen / 2; -+ -+ memset(out, 0, sizeof(out)); -+ memset(&poly1305, 0, sizeof(poly1305)); -+ poly1305_init(&poly1305, key, have_simd); -+ poly1305_update(&poly1305, in, half, have_simd); -+ poly1305_update(&poly1305, in + half, inlen - half, have_simd); -+ poly1305_finish(&poly1305, out, have_simd); -+ if (memcmp(out, expected, expectedlen)) { -+ pr_info("poly1305 self-test %zu/2: FAIL\n", i + 1); -+ success = false; -+ } -+ -+ for (half = 16; half < inlen; half += 16) { -+ memset(out, 0, sizeof(out)); -+ memset(&poly1305, 0, sizeof(poly1305)); -+ poly1305_init(&poly1305, key, have_simd); -+ poly1305_update(&poly1305, in, half, have_simd); -+ poly1305_update(&poly1305, in + half, inlen - half, have_simd); -+ poly1305_finish(&poly1305, out, have_simd); -+ if (memcmp(out, expected, expectedlen)) { -+ pr_info("poly1305 self-test %zu/%zu+%zu: FAIL\n", i + 1, half, inlen - half); -+ success = false; -+ } -+ } -+ } -+ } -+ chacha20poly1305_deinit_simd(have_simd); -+ -+ if (success) -+ pr_info("poly1305 self-tests: pass\n"); -+ -+ return success; -+} -+#endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/selftest/ratelimiter.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,157 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifdef DEBUG -+ -+#include -+ -+static const struct { bool result; unsigned int msec_to_sleep_before; } expected_results[] __initconst = { -+ [0 ... PACKETS_BURSTABLE - 1] = { true, 0 }, -+ [PACKETS_BURSTABLE] = { false, 0 }, -+ [PACKETS_BURSTABLE + 1] = { true, MSEC_PER_SEC / PACKETS_PER_SECOND }, -+ [PACKETS_BURSTABLE + 2] = { false, 0 }, -+ [PACKETS_BURSTABLE + 3] = { true, (MSEC_PER_SEC / PACKETS_PER_SECOND) * 2 }, -+ [PACKETS_BURSTABLE + 4] = { true, 0 }, -+ [PACKETS_BURSTABLE + 5] = { false, 0 } -+}; -+ -+static __init unsigned int maximum_jiffies_at_index(int index) -+{ -+ unsigned int total_msecs = 2 * MSEC_PER_SEC / PACKETS_PER_SECOND / 3; -+ int i; -+ -+ for (i = 0; i <= index; ++i) -+ total_msecs += expected_results[i].msec_to_sleep_before; -+ return msecs_to_jiffies(total_msecs); -+} -+ -+bool __init ratelimiter_selftest(void) -+{ -+ struct sk_buff *skb4; -+ struct iphdr *hdr4; -+#if IS_ENABLED(CONFIG_IPV6) -+ struct sk_buff *skb6; -+ struct ipv6hdr *hdr6; -+#endif -+ int i, test = 0, tries = 0, ret = false; -+ unsigned long loop_start_time; -+ -+ BUILD_BUG_ON(MSEC_PER_SEC % PACKETS_PER_SECOND != 0); -+ -+ if (ratelimiter_init()) -+ goto out; -+ ++test; -+ if (ratelimiter_init()) { -+ ratelimiter_uninit(); -+ goto out; -+ } -+ ++test; -+ if (ratelimiter_init()) { -+ ratelimiter_uninit(); -+ ratelimiter_uninit(); -+ goto out; -+ } -+ ++test; -+ -+ skb4 = alloc_skb(sizeof(struct iphdr), GFP_KERNEL); -+ if (!skb4) -+ goto err_nofree; -+ skb4->protocol = htons(ETH_P_IP); -+ hdr4 = (struct iphdr *)skb_put(skb4, sizeof(struct iphdr)); -+ hdr4->saddr = htonl(8182); -+ skb_reset_network_header(skb4); -+ ++test; -+ -+#if IS_ENABLED(CONFIG_IPV6) -+ skb6 = alloc_skb(sizeof(struct ipv6hdr), GFP_KERNEL); -+ if (!skb6) { -+ kfree_skb(skb4); -+ goto err_nofree; -+ } -+ skb6->protocol = htons(ETH_P_IPV6); -+ hdr6 = (struct ipv6hdr *)skb_put(skb6, sizeof(struct ipv6hdr)); -+ hdr6->saddr.in6_u.u6_addr32[0] = htonl(1212); -+ hdr6->saddr.in6_u.u6_addr32[1] = htonl(289188); -+ skb_reset_network_header(skb6); -+ ++test; -+#endif -+ -+restart: -+ loop_start_time = jiffies; -+ for (i = 0; i < ARRAY_SIZE(expected_results); ++i) { -+#define ensure_time do {\ -+ if (time_is_before_jiffies(loop_start_time + maximum_jiffies_at_index(i))) { \ -+ if (++tries >= 5000) \ -+ goto err; \ -+ gc_entries(NULL); \ -+ rcu_barrier(); \ -+ msleep(500); \ -+ goto restart; \ -+ }} while (0) -+ -+ if (expected_results[i].msec_to_sleep_before) -+ msleep(expected_results[i].msec_to_sleep_before); -+ -+ ensure_time; -+ if (ratelimiter_allow(skb4, &init_net) != expected_results[i].result) -+ goto err; -+ ++test; -+ hdr4->saddr = htonl(ntohl(hdr4->saddr) + i + 1); -+ ensure_time; -+ if (!ratelimiter_allow(skb4, &init_net)) -+ goto err; -+ ++test; -+ hdr4->saddr = htonl(ntohl(hdr4->saddr) - i - 1); -+ -+#if IS_ENABLED(CONFIG_IPV6) -+ hdr6->saddr.in6_u.u6_addr32[2] = hdr6->saddr.in6_u.u6_addr32[3] = htonl(i); -+ ensure_time; -+ if (ratelimiter_allow(skb6, &init_net) != expected_results[i].result) -+ goto err; -+ ++test; -+ hdr6->saddr.in6_u.u6_addr32[0] = htonl(ntohl(hdr6->saddr.in6_u.u6_addr32[0]) + i + 1); -+ ensure_time; -+ if (!ratelimiter_allow(skb6, &init_net)) -+ goto err; -+ ++test; -+ hdr6->saddr.in6_u.u6_addr32[0] = htonl(ntohl(hdr6->saddr.in6_u.u6_addr32[0]) - i - 1); -+ ensure_time; -+#endif -+ } -+ -+ gc_entries(NULL); -+ rcu_barrier(); -+ -+ if (atomic_read(&total_entries)) -+ goto err; -+ ++test; -+ -+ for (i = 0; i <= max_entries; ++i) { -+ hdr4->saddr = htonl(i); -+ if (ratelimiter_allow(skb4, &init_net) != (i != max_entries)) -+ goto err; -+ ++test; -+ } -+ -+ ret = true; -+ -+err: -+ kfree_skb(skb4); -+#if IS_ENABLED(CONFIG_IPV6) -+ kfree_skb(skb6); -+#endif -+err_nofree: -+ ratelimiter_uninit(); -+ ratelimiter_uninit(); -+ ratelimiter_uninit(); -+out: -+ if (ret) -+ pr_info("ratelimiter self-tests: pass\n"); -+ else -+ pr_info("ratelimiter self-test %d: fail\n", test); -+ -+ return ret; -+} -+#endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/blake2s.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,294 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * -+ * Original author: Samuel Neves -+ */ -+ -+#include "blake2s.h" -+ -+#include -+#include -+#include -+#include -+#include -+ -+typedef union { -+ struct { -+ u8 digest_length; -+ u8 key_length; -+ u8 fanout; -+ u8 depth; -+ u32 leaf_length; -+ u32 node_offset; -+ u16 xof_length; -+ u8 node_depth; -+ u8 inner_length; -+ u8 salt[8]; -+ u8 personal[8]; -+ }; -+ __le32 words[8]; -+} __packed blake2s_param; -+ -+static const u32 blake2s_iv[8] = { -+ 0x6A09E667UL, 0xBB67AE85UL, 0x3C6EF372UL, 0xA54FF53AUL, -+ 0x510E527FUL, 0x9B05688CUL, 0x1F83D9ABUL, 0x5BE0CD19UL -+}; -+ -+static const u8 blake2s_sigma[10][16] = { -+ {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15}, -+ {14, 10, 4, 8, 9, 15, 13, 6, 1, 12, 0, 2, 11, 7, 5, 3}, -+ {11, 8, 12, 0, 5, 2, 15, 13, 10, 14, 3, 6, 7, 1, 9, 4}, -+ {7, 9, 3, 1, 13, 12, 11, 14, 2, 6, 5, 10, 4, 0, 15, 8}, -+ {9, 0, 5, 7, 2, 4, 10, 15, 14, 1, 11, 12, 6, 8, 3, 13}, -+ {2, 12, 6, 10, 0, 11, 8, 3, 4, 13, 7, 5, 15, 14, 1, 9}, -+ {12, 5, 1, 15, 14, 13, 4, 10, 0, 7, 6, 3, 9, 2, 8, 11}, -+ {13, 11, 7, 14, 12, 1, 3, 9, 5, 0, 15, 4, 8, 6, 2, 10}, -+ {6, 15, 14, 9, 11, 3, 0, 8, 12, 2, 13, 7, 1, 4, 10, 5}, -+ {10, 2, 8, 4, 7, 6, 1, 5, 15, 11, 9, 14, 3, 12, 13, 0}, -+}; -+ -+static inline u32 le32_to_cpuvp(const void *p) -+{ -+ return le32_to_cpup(p); -+} -+ -+static inline void blake2s_set_lastblock(struct blake2s_state *state) -+{ -+ if (state->last_node) -+ state->f[1] = -1; -+ state->f[0] = -1; -+} -+ -+static inline void blake2s_increment_counter(struct blake2s_state *state, const u32 inc) -+{ -+ state->t[0] += inc; -+ state->t[1] += (state->t[0] < inc); -+} -+ -+static inline void blake2s_init_param(struct blake2s_state *state, const blake2s_param *param) -+{ -+ int i; -+ -+ memset(state, 0, sizeof(struct blake2s_state)); -+ for (i = 0; i < 8; ++i) -+ state->h[i] = blake2s_iv[i] ^ le32_to_cpu(param->words[i]); -+} -+ -+void blake2s_init(struct blake2s_state *state, const size_t outlen) -+{ -+ blake2s_param param __aligned(__alignof__(u32)) = { -+ .digest_length = outlen, -+ .fanout = 1, -+ .depth = 1 -+ }; -+ -+#ifdef DEBUG -+ BUG_ON(!outlen || outlen > BLAKE2S_OUTBYTES); -+#endif -+ blake2s_init_param(state, ¶m); -+} -+ -+void blake2s_init_key(struct blake2s_state *state, const size_t outlen, const void *key, const size_t keylen) -+{ -+ blake2s_param param = { -+ .digest_length = outlen, -+ .key_length = keylen, -+ .fanout = 1, -+ .depth = 1 -+ }; -+ u8 block[BLAKE2S_BLOCKBYTES] = { 0 }; -+ -+#ifdef DEBUG -+ BUG_ON(!outlen || outlen > BLAKE2S_OUTBYTES || !key || !keylen || keylen > BLAKE2S_KEYBYTES); -+#endif -+ blake2s_init_param(state, ¶m); -+ memcpy(block, key, keylen); -+ blake2s_update(state, block, BLAKE2S_BLOCKBYTES); -+ memzero_explicit(block, BLAKE2S_BLOCKBYTES); -+} -+ -+#ifdef CONFIG_X86_64 -+#include -+#include -+#include -+#include -+static bool blake2s_use_avx __ro_after_init; -+static bool blake2s_use_avx512 __ro_after_init; -+void __init blake2s_fpu_init(void) -+{ -+#ifndef CONFIG_UML -+ blake2s_use_avx = boot_cpu_has(X86_FEATURE_AVX) && cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM, NULL); -+#ifndef COMPAT_CANNOT_USE_AVX512 -+ blake2s_use_avx512 = boot_cpu_has(X86_FEATURE_AVX) && boot_cpu_has(X86_FEATURE_AVX2) && boot_cpu_has(X86_FEATURE_AVX512F) && boot_cpu_has(X86_FEATURE_AVX512VL) && cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM | XFEATURE_MASK_AVX512, NULL); -+#endif -+#endif -+} -+#ifdef CONFIG_AS_AVX -+asmlinkage void blake2s_compress_avx(struct blake2s_state *state, const u8 *block, size_t nblocks, u32 inc); -+#endif -+#ifdef CONFIG_AS_AVX512 -+asmlinkage void blake2s_compress_avx512(struct blake2s_state *state, const u8 *block, size_t nblocks, u32 inc); -+#endif -+#else -+void __init blake2s_fpu_init(void) { } -+#endif -+ -+static inline void blake2s_compress(struct blake2s_state *state, const u8 *block, size_t nblocks, u32 inc) -+{ -+ u32 m[16]; -+ u32 v[16]; -+ int i; -+ -+#ifdef DEBUG -+ BUG_ON(nblocks > 1 && inc != BLAKE2S_BLOCKBYTES); -+#endif -+ -+#ifdef CONFIG_X86_64 -+#ifdef CONFIG_AS_AVX512 -+ if (blake2s_use_avx512 && irq_fpu_usable()) { -+ kernel_fpu_begin(); -+ blake2s_compress_avx512(state, block, nblocks, inc); -+ kernel_fpu_end(); -+ return; -+ } -+#endif -+#ifdef CONFIG_AS_AVX -+ if (blake2s_use_avx && irq_fpu_usable()) { -+ kernel_fpu_begin(); -+ blake2s_compress_avx(state, block, nblocks, inc); -+ kernel_fpu_end(); -+ return; -+ } -+#endif -+#endif -+ -+ while (nblocks > 0) { -+ blake2s_increment_counter(state, inc); -+ -+#ifdef __LITTLE_ENDIAN -+ memcpy(m, block, BLAKE2S_BLOCKBYTES); -+#else -+ for (i = 0; i < 16; ++i) -+ m[i] = get_unaligned_le32(block + i * sizeof(m[i])); -+#endif -+ memcpy(v, state->h, 32); -+ v[ 8] = blake2s_iv[0]; -+ v[ 9] = blake2s_iv[1]; -+ v[10] = blake2s_iv[2]; -+ v[11] = blake2s_iv[3]; -+ v[12] = blake2s_iv[4] ^ state->t[0]; -+ v[13] = blake2s_iv[5] ^ state->t[1]; -+ v[14] = blake2s_iv[6] ^ state->f[0]; -+ v[15] = blake2s_iv[7] ^ state->f[1]; -+ -+#define G(r, i, a, b, c, d) do { \ -+ a += b + m[blake2s_sigma[r][2 * i + 0]]; \ -+ d = ror32(d ^ a, 16); \ -+ c += d; \ -+ b = ror32(b ^ c, 12); \ -+ a += b + m[blake2s_sigma[r][2 * i + 1]]; \ -+ d = ror32(d ^ a, 8); \ -+ c += d; \ -+ b = ror32(b ^ c, 7); \ -+} while (0) -+ -+#define ROUND(r) do { \ -+ G(r, 0, v[0], v[ 4], v[ 8], v[12]); \ -+ G(r, 1, v[1], v[ 5], v[ 9], v[13]); \ -+ G(r, 2, v[2], v[ 6], v[10], v[14]); \ -+ G(r, 3, v[3], v[ 7], v[11], v[15]); \ -+ G(r, 4, v[0], v[ 5], v[10], v[15]); \ -+ G(r, 5, v[1], v[ 6], v[11], v[12]); \ -+ G(r, 6, v[2], v[ 7], v[ 8], v[13]); \ -+ G(r, 7, v[3], v[ 4], v[ 9], v[14]); \ -+} while (0) -+ ROUND(0); -+ ROUND(1); -+ ROUND(2); -+ ROUND(3); -+ ROUND(4); -+ ROUND(5); -+ ROUND(6); -+ ROUND(7); -+ ROUND(8); -+ ROUND(9); -+ -+#undef G -+#undef ROUND -+ -+ for (i = 0; i < 8; ++i) -+ state->h[i] ^= v[i] ^ v[i + 8]; -+ -+ block += BLAKE2S_BLOCKBYTES; -+ --nblocks; -+ } -+} -+ -+void blake2s_update(struct blake2s_state *state, const u8 *in, size_t inlen) -+{ -+ const size_t fill = BLAKE2S_BLOCKBYTES - state->buflen; -+ -+ if (unlikely(!inlen)) -+ return; -+ if (inlen > fill) { -+ memcpy(state->buf + state->buflen, in, fill); -+ blake2s_compress(state, state->buf, 1, BLAKE2S_BLOCKBYTES); -+ state->buflen = 0; -+ in += fill; -+ inlen -= fill; -+ } -+ if (inlen > BLAKE2S_BLOCKBYTES) { -+ const size_t nblocks = (inlen + BLAKE2S_BLOCKBYTES - 1) / BLAKE2S_BLOCKBYTES; -+ /* Hash one less (full) block than strictly possible */ -+ blake2s_compress(state, in, nblocks - 1, BLAKE2S_BLOCKBYTES); -+ in += BLAKE2S_BLOCKBYTES * (nblocks - 1); -+ inlen -= BLAKE2S_BLOCKBYTES * (nblocks - 1); -+ } -+ memcpy(state->buf + state->buflen, in, inlen); -+ state->buflen += inlen; -+} -+ -+void __blake2s_final(struct blake2s_state *state) -+{ -+ blake2s_set_lastblock(state); -+ memset(state->buf + state->buflen, 0, BLAKE2S_BLOCKBYTES - state->buflen); /* Padding */ -+ blake2s_compress(state, state->buf, 1, state->buflen); -+} -+ -+void blake2s_hmac(u8 *out, const u8 *in, const u8 *key, const size_t outlen, const size_t inlen, const size_t keylen) -+{ -+ struct blake2s_state state; -+ u8 x_key[BLAKE2S_BLOCKBYTES] __aligned(__alignof__(u32)) = { 0 }; -+ u8 i_hash[BLAKE2S_OUTBYTES] __aligned(__alignof__(u32)); -+ int i; -+ -+ if (keylen > BLAKE2S_BLOCKBYTES) { -+ blake2s_init(&state, BLAKE2S_OUTBYTES); -+ blake2s_update(&state, key, keylen); -+ blake2s_final(&state, x_key, BLAKE2S_OUTBYTES); -+ } else -+ memcpy(x_key, key, keylen); -+ -+ for (i = 0; i < BLAKE2S_BLOCKBYTES; ++i) -+ x_key[i] ^= 0x36; -+ -+ blake2s_init(&state, BLAKE2S_OUTBYTES); -+ blake2s_update(&state, x_key, BLAKE2S_BLOCKBYTES); -+ blake2s_update(&state, in, inlen); -+ blake2s_final(&state, i_hash, BLAKE2S_OUTBYTES); -+ -+ for (i = 0; i < BLAKE2S_BLOCKBYTES; ++i) -+ x_key[i] ^= 0x5c ^ 0x36; -+ -+ blake2s_init(&state, BLAKE2S_OUTBYTES); -+ blake2s_update(&state, x_key, BLAKE2S_BLOCKBYTES); -+ blake2s_update(&state, i_hash, BLAKE2S_OUTBYTES); -+ blake2s_final(&state, i_hash, BLAKE2S_OUTBYTES); -+ -+ memcpy(out, i_hash, outlen); -+ memzero_explicit(x_key, BLAKE2S_BLOCKBYTES); -+ memzero_explicit(i_hash, BLAKE2S_OUTBYTES); -+} -+ -+#include "../selftest/blake2s.h" ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/chacha20poly1305.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,852 @@ -+/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. -+ */ -+ -+#include "chacha20poly1305.h" -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#if defined(CONFIG_X86_64) -+#include -+#include -+#include -+asmlinkage void poly1305_init_x86_64(void *ctx, const u8 key[16]); -+asmlinkage void poly1305_blocks_x86_64(void *ctx, const u8 *inp, size_t len, u32 padbit); -+asmlinkage void poly1305_emit_x86_64(void *ctx, u8 mac[16], const u32 nonce[4]); -+#ifdef CONFIG_AS_SSSE3 -+asmlinkage void hchacha20_ssse3(u8 *derived_key, const u8 *nonce, const u8 *key); -+asmlinkage void chacha20_ssse3(u8 *out, const u8 *in, size_t len, const u32 key[8], const u32 counter[4]); -+#endif -+#ifdef CONFIG_AS_AVX -+asmlinkage void poly1305_emit_avx(void *ctx, u8 mac[16], const u32 nonce[4]); -+asmlinkage void poly1305_blocks_avx(void *ctx, const u8 *inp, size_t len, u32 padbit); -+#endif -+#ifdef CONFIG_AS_AVX2 -+asmlinkage void chacha20_avx2(u8 *out, const u8 *in, size_t len, const u32 key[8], const u32 counter[4]); -+asmlinkage void poly1305_blocks_avx2(void *ctx, const u8 *inp, size_t len, u32 padbit); -+#endif -+#ifdef CONFIG_AS_AVX512 -+asmlinkage void chacha20_avx512(u8 *out, const u8 *in, size_t len, const u32 key[8], const u32 counter[4]); -+asmlinkage void chacha20_avx512vl(u8 *out, const u8 *in, size_t len, const u32 key[8], const u32 counter[4]); -+asmlinkage void poly1305_blocks_avx512(void *ctx, const u8 *inp, size_t len, u32 padbit); -+#endif -+ -+static bool chacha20poly1305_use_ssse3 __ro_after_init; -+static bool chacha20poly1305_use_avx __ro_after_init; -+static bool chacha20poly1305_use_avx2 __ro_after_init; -+static bool chacha20poly1305_use_avx512 __ro_after_init; -+static bool chacha20poly1305_use_avx512vl __ro_after_init; -+ -+void __init chacha20poly1305_fpu_init(void) -+{ -+#ifndef CONFIG_UML -+ chacha20poly1305_use_ssse3 = boot_cpu_has(X86_FEATURE_SSSE3); -+ chacha20poly1305_use_avx = boot_cpu_has(X86_FEATURE_AVX) && -+ cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM, NULL); -+ chacha20poly1305_use_avx2 = boot_cpu_has(X86_FEATURE_AVX) && boot_cpu_has(X86_FEATURE_AVX2) && -+ cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM, NULL); -+#ifndef COMPAT_CANNOT_USE_AVX512 -+ chacha20poly1305_use_avx512 = boot_cpu_has(X86_FEATURE_AVX) && boot_cpu_has(X86_FEATURE_AVX2) && boot_cpu_has(X86_FEATURE_AVX512F) && -+ cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM | XFEATURE_MASK_AVX512, NULL) && -+ boot_cpu_data.x86_model != INTEL_FAM6_SKYLAKE_X; -+ chacha20poly1305_use_avx512vl = boot_cpu_has(X86_FEATURE_AVX) && boot_cpu_has(X86_FEATURE_AVX2) && boot_cpu_has(X86_FEATURE_AVX512F) && boot_cpu_has(X86_FEATURE_AVX512VL) && -+ cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM | XFEATURE_MASK_AVX512, NULL); -+#endif -+#endif -+} -+#elif defined(CONFIG_ARM) || defined(CONFIG_ARM64) -+asmlinkage void poly1305_init_arm(void *ctx, const u8 key[16]); -+asmlinkage void poly1305_blocks_arm(void *ctx, const u8 *inp, size_t len, u32 padbit); -+asmlinkage void poly1305_emit_arm(void *ctx, u8 mac[16], const u32 nonce[4]); -+asmlinkage void chacha20_arm(u8 *out, const u8 *in, size_t len, const u32 key[8], const u32 counter[4]); -+#if IS_ENABLED(CONFIG_KERNEL_MODE_NEON) && (!defined(__LINUX_ARM_ARCH__) || __LINUX_ARM_ARCH__ >= 7) -+#define ARM_USE_NEON -+#include -+#include -+asmlinkage void poly1305_blocks_neon(void *ctx, const u8 *inp, size_t len, u32 padbit); -+asmlinkage void poly1305_emit_neon(void *ctx, u8 mac[16], const u32 nonce[4]); -+asmlinkage void chacha20_neon(u8 *out, const u8 *in, size_t len, const u32 key[8], const u32 counter[4]); -+#endif -+static bool chacha20poly1305_use_neon __ro_after_init; -+void __init chacha20poly1305_fpu_init(void) -+{ -+#if defined(CONFIG_ARM64) -+ chacha20poly1305_use_neon = elf_hwcap & HWCAP_ASIMD; -+#elif defined(CONFIG_ARM) -+ chacha20poly1305_use_neon = elf_hwcap & HWCAP_NEON; -+#endif -+} -+#elif defined(CONFIG_MIPS) && defined(CONFIG_64BIT) -+asmlinkage void poly1305_init_mips(void *ctx, const u8 key[16]); -+asmlinkage void poly1305_blocks_mips(void *ctx, const u8 *inp, size_t len, u32 padbit); -+asmlinkage void poly1305_emit_mips(void *ctx, u8 mac[16], const u32 nonce[4]); -+void __init chacha20poly1305_fpu_init(void) { } -+#else -+void __init chacha20poly1305_fpu_init(void) { } -+#endif -+ -+enum { -+ CHACHA20_IV_SIZE = 16, -+ CHACHA20_KEY_SIZE = 32, -+ CHACHA20_BLOCK_SIZE = 64, -+ POLY1305_BLOCK_SIZE = 16, -+ POLY1305_KEY_SIZE = 32, -+ POLY1305_MAC_SIZE = 16 -+}; -+ -+static inline u32 le32_to_cpuvp(const void *p) -+{ -+ return le32_to_cpup(p); -+} -+ -+static inline u64 le64_to_cpuvp(const void *p) -+{ -+ return le64_to_cpup(p); -+} -+ -+struct chacha20_ctx { -+ u32 state[CHACHA20_BLOCK_SIZE / sizeof(u32)]; -+} __aligned(32); -+ -+#define QUARTER_ROUND(x, a, b, c, d) ( \ -+ x[a] += x[b], \ -+ x[d] = rol32((x[d] ^ x[a]), 16), \ -+ x[c] += x[d], \ -+ x[b] = rol32((x[b] ^ x[c]), 12), \ -+ x[a] += x[b], \ -+ x[d] = rol32((x[d] ^ x[a]), 8), \ -+ x[c] += x[d], \ -+ x[b] = rol32((x[b] ^ x[c]), 7) \ -+) -+ -+#define C(i, j) (i * 4 + j) -+ -+#define DOUBLE_ROUND(x) ( \ -+ /* Column Round */ \ -+ QUARTER_ROUND(x, C(0, 0), C(1, 0), C(2, 0), C(3, 0)), \ -+ QUARTER_ROUND(x, C(0, 1), C(1, 1), C(2, 1), C(3, 1)), \ -+ QUARTER_ROUND(x, C(0, 2), C(1, 2), C(2, 2), C(3, 2)), \ -+ QUARTER_ROUND(x, C(0, 3), C(1, 3), C(2, 3), C(3, 3)), \ -+ /* Diagonal Round */ \ -+ QUARTER_ROUND(x, C(0, 0), C(1, 1), C(2, 2), C(3, 3)), \ -+ QUARTER_ROUND(x, C(0, 1), C(1, 2), C(2, 3), C(3, 0)), \ -+ QUARTER_ROUND(x, C(0, 2), C(1, 3), C(2, 0), C(3, 1)), \ -+ QUARTER_ROUND(x, C(0, 3), C(1, 0), C(2, 1), C(3, 2)) \ -+) -+ -+#define TWENTY_ROUNDS(x) ( \ -+ DOUBLE_ROUND(x), \ -+ DOUBLE_ROUND(x), \ -+ DOUBLE_ROUND(x), \ -+ DOUBLE_ROUND(x), \ -+ DOUBLE_ROUND(x), \ -+ DOUBLE_ROUND(x), \ -+ DOUBLE_ROUND(x), \ -+ DOUBLE_ROUND(x), \ -+ DOUBLE_ROUND(x), \ -+ DOUBLE_ROUND(x) \ -+) -+ -+static void chacha20_block_generic(struct chacha20_ctx *ctx, __le32 *stream) -+{ -+ u32 x[CHACHA20_BLOCK_SIZE / sizeof(u32)]; -+ int i; -+ -+ for (i = 0; i < ARRAY_SIZE(x); ++i) -+ x[i] = ctx->state[i]; -+ -+ TWENTY_ROUNDS(x); -+ -+ for (i = 0; i < ARRAY_SIZE(x); ++i) -+ stream[i] = cpu_to_le32(x[i] + ctx->state[i]); -+ -+ ++ctx->state[12]; -+} -+ -+static void hchacha20_generic(u8 derived_key[CHACHA20POLY1305_KEYLEN], const u8 nonce[16], const u8 key[CHACHA20POLY1305_KEYLEN]) -+{ -+ __le32 *out = (__force __le32 *)derived_key; -+ u32 x[] = { -+ 0x61707865, 0x3320646e, 0x79622d32, 0x6b206574, -+ le32_to_cpuvp(key + 0), le32_to_cpuvp(key + 4), le32_to_cpuvp(key + 8), le32_to_cpuvp(key + 12), -+ le32_to_cpuvp(key + 16), le32_to_cpuvp(key + 20), le32_to_cpuvp(key + 24), le32_to_cpuvp(key + 28), -+ le32_to_cpuvp(nonce + 0), le32_to_cpuvp(nonce + 4), le32_to_cpuvp(nonce + 8), le32_to_cpuvp(nonce + 12) -+ }; -+ -+ TWENTY_ROUNDS(x); -+ -+ out[0] = cpu_to_le32(x[0]); -+ out[1] = cpu_to_le32(x[1]); -+ out[2] = cpu_to_le32(x[2]); -+ out[3] = cpu_to_le32(x[3]); -+ out[4] = cpu_to_le32(x[12]); -+ out[5] = cpu_to_le32(x[13]); -+ out[6] = cpu_to_le32(x[14]); -+ out[7] = cpu_to_le32(x[15]); -+} -+ -+static inline void hchacha20(u8 derived_key[CHACHA20POLY1305_KEYLEN], const u8 nonce[16], const u8 key[CHACHA20POLY1305_KEYLEN], bool have_simd) -+{ -+#if defined(CONFIG_X86_64) && defined(CONFIG_AS_SSSE3) -+ if (have_simd && chacha20poly1305_use_ssse3) { -+ hchacha20_ssse3(derived_key, nonce, key); -+ return; -+ } -+#endif -+ -+ hchacha20_generic(derived_key, nonce, key); -+} -+ -+#define chacha20_initial_state(key, nonce) {{ \ -+ 0x61707865, 0x3320646e, 0x79622d32, 0x6b206574, \ -+ le32_to_cpuvp((key) + 0), le32_to_cpuvp((key) + 4), le32_to_cpuvp((key) + 8), le32_to_cpuvp((key) + 12), \ -+ le32_to_cpuvp((key) + 16), le32_to_cpuvp((key) + 20), le32_to_cpuvp((key) + 24), le32_to_cpuvp((key) + 28), \ -+ 0, 0, le32_to_cpuvp((nonce) + 0), le32_to_cpuvp((nonce) + 4) \ -+}} -+ -+static void chacha20_crypt(struct chacha20_ctx *ctx, u8 *dst, const u8 *src, u32 bytes, bool have_simd) -+{ -+ __le32 buf[CHACHA20_BLOCK_SIZE / sizeof(__le32)]; -+ -+ if (!have_simd -+#if defined(CONFIG_X86_64) -+ || !chacha20poly1305_use_ssse3 -+ -+#elif defined(ARM_USE_NEON) -+ || !chacha20poly1305_use_neon -+#endif -+ ) -+ goto no_simd; -+ -+#if defined(CONFIG_X86_64) -+#ifdef CONFIG_AS_AVX512 -+ if (chacha20poly1305_use_avx512) { -+ chacha20_avx512(dst, src, bytes, &ctx->state[4], &ctx->state[12]); -+ ctx->state[12] += (bytes + 63) / 64; -+ return; -+ } -+ if (chacha20poly1305_use_avx512vl) { -+ chacha20_avx512vl(dst, src, bytes, &ctx->state[4], &ctx->state[12]); -+ ctx->state[12] += (bytes + 63) / 64; -+ return; -+ } -+#endif -+#ifdef CONFIG_AS_AVX2 -+ if (chacha20poly1305_use_avx2) { -+ chacha20_avx2(dst, src, bytes, &ctx->state[4], &ctx->state[12]); -+ ctx->state[12] += (bytes + 63) / 64; -+ return; -+ } -+#endif -+#ifdef CONFIG_AS_SSSE3 -+ chacha20_ssse3(dst, src, bytes, &ctx->state[4], &ctx->state[12]); -+ ctx->state[12] += (bytes + 63) / 64; -+ return; -+#endif -+#elif defined(ARM_USE_NEON) -+ chacha20_neon(dst, src, bytes, &ctx->state[4], &ctx->state[12]); -+ ctx->state[12] += (bytes + 63) / 64; -+ return; -+#endif -+ -+no_simd: -+#if defined(CONFIG_ARM) || defined(CONFIG_ARM64) -+ chacha20_arm(dst, src, bytes, &ctx->state[4], &ctx->state[12]); -+ ctx->state[12] += (bytes + 63) / 64; -+ return; -+#endif -+ -+ if (dst != src) -+ memcpy(dst, src, bytes); -+ -+ while (bytes >= CHACHA20_BLOCK_SIZE) { -+ chacha20_block_generic(ctx, buf); -+ crypto_xor(dst, (u8 *)buf, CHACHA20_BLOCK_SIZE); -+ bytes -= CHACHA20_BLOCK_SIZE; -+ dst += CHACHA20_BLOCK_SIZE; -+ } -+ if (bytes) { -+ chacha20_block_generic(ctx, buf); -+ crypto_xor(dst, (u8 *)buf, bytes); -+ } -+} -+ -+struct poly1305_ctx { -+ u8 opaque[24 * sizeof(u64)]; -+ u32 nonce[4]; -+ u8 data[POLY1305_BLOCK_SIZE]; -+ size_t num; -+} __aligned(8); -+ -+#if !(defined(CONFIG_X86_64) || defined(CONFIG_ARM) || defined(CONFIG_ARM64) || (defined(CONFIG_MIPS) && defined(CONFIG_64BIT))) -+struct poly1305_internal { -+ u32 h[5]; -+ u32 r[4]; -+}; -+ -+static void poly1305_init_generic(void *ctx, const u8 key[16]) -+{ -+ struct poly1305_internal *st = (struct poly1305_internal *)ctx; -+ -+ /* h = 0 */ -+ st->h[0] = 0; -+ st->h[1] = 0; -+ st->h[2] = 0; -+ st->h[3] = 0; -+ st->h[4] = 0; -+ -+ /* r &= 0xffffffc0ffffffc0ffffffc0fffffff */ -+ st->r[0] = le32_to_cpuvp(&key[ 0]) & 0x0fffffff; -+ st->r[1] = le32_to_cpuvp(&key[ 4]) & 0x0ffffffc; -+ st->r[2] = le32_to_cpuvp(&key[ 8]) & 0x0ffffffc; -+ st->r[3] = le32_to_cpuvp(&key[12]) & 0x0ffffffc; -+} -+ -+static void poly1305_blocks_generic(void *ctx, const u8 *inp, size_t len, u32 padbit) -+{ -+#define CONSTANT_TIME_CARRY(a,b) ((a ^ ((a ^ b) | ((a - b) ^ b))) >> (sizeof(a) * 8 - 1)) -+ struct poly1305_internal *st = (struct poly1305_internal *)ctx; -+ u32 r0, r1, r2, r3; -+ u32 s1, s2, s3; -+ u32 h0, h1, h2, h3, h4, c; -+ u64 d0, d1, d2, d3; -+ -+ r0 = st->r[0]; -+ r1 = st->r[1]; -+ r2 = st->r[2]; -+ r3 = st->r[3]; -+ -+ s1 = r1 + (r1 >> 2); -+ s2 = r2 + (r2 >> 2); -+ s3 = r3 + (r3 >> 2); -+ -+ h0 = st->h[0]; -+ h1 = st->h[1]; -+ h2 = st->h[2]; -+ h3 = st->h[3]; -+ h4 = st->h[4]; -+ -+ while (len >= POLY1305_BLOCK_SIZE) { -+ /* h += m[i] */ -+ h0 = (u32)(d0 = (u64)h0 + le32_to_cpuvp(inp + 0)); -+ h1 = (u32)(d1 = (u64)h1 + (d0 >> 32) + le32_to_cpuvp(inp + 4)); -+ h2 = (u32)(d2 = (u64)h2 + (d1 >> 32) + le32_to_cpuvp(inp + 8)); -+ h3 = (u32)(d3 = (u64)h3 + (d2 >> 32) + le32_to_cpuvp(inp + 12)); -+ h4 += (u32)(d3 >> 32) + padbit; -+ -+ /* h *= r "%" p, where "%" stands for "partial remainder" */ -+ d0 = ((u64)h0 * r0) + -+ ((u64)h1 * s3) + -+ ((u64)h2 * s2) + -+ ((u64)h3 * s1); -+ d1 = ((u64)h0 * r1) + -+ ((u64)h1 * r0) + -+ ((u64)h2 * s3) + -+ ((u64)h3 * s2) + -+ (h4 * s1); -+ d2 = ((u64)h0 * r2) + -+ ((u64)h1 * r1) + -+ ((u64)h2 * r0) + -+ ((u64)h3 * s3) + -+ (h4 * s2); -+ d3 = ((u64)h0 * r3) + -+ ((u64)h1 * r2) + -+ ((u64)h2 * r1) + -+ ((u64)h3 * r0) + -+ (h4 * s3); -+ h4 = (h4 * r0); -+ -+ /* last reduction step: */ -+ /* a) h4:h0 = h4<<128 + d3<<96 + d2<<64 + d1<<32 + d0 */ -+ h0 = (u32)d0; -+ h1 = (u32)(d1 += d0 >> 32); -+ h2 = (u32)(d2 += d1 >> 32); -+ h3 = (u32)(d3 += d2 >> 32); -+ h4 += (u32)(d3 >> 32); -+ /* b) (h4:h0 += (h4:h0>>130) * 5) %= 2^130 */ -+ c = (h4 >> 2) + (h4 & ~3U); -+ h4 &= 3; -+ h0 += c; -+ h1 += (c = CONSTANT_TIME_CARRY(h0,c)); -+ h2 += (c = CONSTANT_TIME_CARRY(h1,c)); -+ h3 += (c = CONSTANT_TIME_CARRY(h2,c)); -+ h4 += CONSTANT_TIME_CARRY(h3,c); -+ /* -+ * Occasional overflows to 3rd bit of h4 are taken care of -+ * "naturally". If after this point we end up at the top of -+ * this loop, then the overflow bit will be accounted for -+ * in next iteration. If we end up in poly1305_emit, then -+ * comparison to modulus below will still count as "carry -+ * into 131st bit", so that properly reduced value will be -+ * picked in conditional move. -+ */ -+ -+ inp += POLY1305_BLOCK_SIZE; -+ len -= POLY1305_BLOCK_SIZE; -+ } -+ -+ st->h[0] = h0; -+ st->h[1] = h1; -+ st->h[2] = h2; -+ st->h[3] = h3; -+ st->h[4] = h4; -+#undef CONSTANT_TIME_CARRY -+} -+ -+static void poly1305_emit_generic(void *ctx, u8 mac[16], const u32 nonce[4]) -+{ -+ struct poly1305_internal *st = (struct poly1305_internal *)ctx; -+ __le32 *omac = (__force __le32 *)mac; -+ u32 h0, h1, h2, h3, h4; -+ u32 g0, g1, g2, g3, g4; -+ u64 t; -+ u32 mask; -+ -+ h0 = st->h[0]; -+ h1 = st->h[1]; -+ h2 = st->h[2]; -+ h3 = st->h[3]; -+ h4 = st->h[4]; -+ -+ /* compare to modulus by computing h + -p */ -+ g0 = (u32)(t = (u64)h0 + 5); -+ g1 = (u32)(t = (u64)h1 + (t >> 32)); -+ g2 = (u32)(t = (u64)h2 + (t >> 32)); -+ g3 = (u32)(t = (u64)h3 + (t >> 32)); -+ g4 = h4 + (u32)(t >> 32); -+ -+ /* if there was carry into 131st bit, h3:h0 = g3:g0 */ -+ mask = 0 - (g4 >> 2); -+ g0 &= mask; -+ g1 &= mask; -+ g2 &= mask; -+ g3 &= mask; -+ mask = ~mask; -+ h0 = (h0 & mask) | g0; -+ h1 = (h1 & mask) | g1; -+ h2 = (h2 & mask) | g2; -+ h3 = (h3 & mask) | g3; -+ -+ /* mac = (h + nonce) % (2^128) */ -+ h0 = (u32)(t = (u64)h0 + nonce[0]); -+ h1 = (u32)(t = (u64)h1 + (t >> 32) + nonce[1]); -+ h2 = (u32)(t = (u64)h2 + (t >> 32) + nonce[2]); -+ h3 = (u32)(t = (u64)h3 + (t >> 32) + nonce[3]); -+ -+ omac[0] = cpu_to_le32(h0); -+ omac[1] = cpu_to_le32(h1); -+ omac[2] = cpu_to_le32(h2); -+ omac[3] = cpu_to_le32(h3); -+} -+#endif -+ -+static void poly1305_init(struct poly1305_ctx *ctx, const u8 key[POLY1305_KEY_SIZE], bool have_simd) -+{ -+ ctx->nonce[0] = le32_to_cpuvp(&key[16]); -+ ctx->nonce[1] = le32_to_cpuvp(&key[20]); -+ ctx->nonce[2] = le32_to_cpuvp(&key[24]); -+ ctx->nonce[3] = le32_to_cpuvp(&key[28]); -+ -+#if defined(CONFIG_X86_64) -+ poly1305_init_x86_64(ctx->opaque, key); -+#elif defined(CONFIG_ARM) || defined(CONFIG_ARM64) -+ poly1305_init_arm(ctx->opaque, key); -+#elif defined(CONFIG_MIPS) && defined(CONFIG_64BIT) -+ poly1305_init_mips(ctx->opaque, key); -+#else -+ poly1305_init_generic(ctx->opaque, key); -+#endif -+ ctx->num = 0; -+} -+ -+static inline void poly1305_blocks(void *ctx, const u8 *inp, size_t len, u32 padbit, bool have_simd) -+{ -+#if defined(CONFIG_X86_64) -+#ifdef CONFIG_AS_AVX512 -+ if(chacha20poly1305_use_avx512 && have_simd) -+ poly1305_blocks_avx512(ctx, inp, len, padbit); -+ else -+#endif -+#ifdef CONFIG_AS_AVX2 -+ if (chacha20poly1305_use_avx2 && have_simd) -+ poly1305_blocks_avx2(ctx, inp, len, padbit); -+ else -+#endif -+#ifdef CONFIG_AS_AVX -+ if (chacha20poly1305_use_avx && have_simd) -+ poly1305_blocks_avx(ctx, inp, len, padbit); -+ else -+#endif -+ poly1305_blocks_x86_64(ctx, inp, len, padbit); -+#elif defined(CONFIG_ARM) || defined(CONFIG_ARM64) -+#if defined(ARM_USE_NEON) -+ if (chacha20poly1305_use_neon && have_simd) -+ poly1305_blocks_neon(ctx, inp, len, padbit); -+ else -+#endif -+ poly1305_blocks_arm(ctx, inp, len, padbit); -+#elif defined(CONFIG_MIPS) && defined(CONFIG_64BIT) -+ poly1305_blocks_mips(ctx, inp, len, padbit); -+#else -+ poly1305_blocks_generic(ctx, inp, len, padbit); -+#endif -+} -+ -+static inline void poly1305_emit(void *ctx, u8 mac[16], const u32 nonce[4], bool have_simd) -+{ -+#if defined(CONFIG_X86_64) -+#ifdef CONFIG_AS_AVX512 -+ if(chacha20poly1305_use_avx512 && have_simd) -+ poly1305_emit_avx(ctx, mac, nonce); -+ else -+#endif -+#ifdef CONFIG_AS_AVX2 -+ if (chacha20poly1305_use_avx2 && have_simd) -+ poly1305_emit_avx(ctx, mac, nonce); -+ else -+#endif -+#ifdef CONFIG_AS_AVX -+ if (chacha20poly1305_use_avx && have_simd) -+ poly1305_emit_avx(ctx, mac, nonce); -+ else -+#endif -+ poly1305_emit_x86_64(ctx, mac, nonce); -+#elif defined(CONFIG_ARM) || defined(CONFIG_ARM64) -+#if defined(ARM_USE_NEON) -+ if (chacha20poly1305_use_neon && have_simd) -+ poly1305_emit_neon(ctx, mac, nonce); -+ else -+#endif -+ poly1305_emit_arm(ctx, mac, nonce); -+#elif defined(CONFIG_MIPS) && defined(CONFIG_64BIT) -+ poly1305_emit_mips(ctx, mac, nonce); -+#else -+ poly1305_emit_generic(ctx, mac, nonce); -+#endif -+} -+ -+static void poly1305_update(struct poly1305_ctx *ctx, const u8 *inp, size_t len, bool have_simd) -+{ -+ const size_t num = ctx->num; -+ size_t rem; -+ -+ if (num) { -+ rem = POLY1305_BLOCK_SIZE - num; -+ if (len >= rem) { -+ memcpy(ctx->data + num, inp, rem); -+ poly1305_blocks(ctx->opaque, ctx->data, POLY1305_BLOCK_SIZE, 1, have_simd); -+ inp += rem; -+ len -= rem; -+ } else { -+ /* Still not enough data to process a block. */ -+ memcpy(ctx->data + num, inp, len); -+ ctx->num = num + len; -+ return; -+ } -+ } -+ -+ rem = len % POLY1305_BLOCK_SIZE; -+ len -= rem; -+ -+ if (len >= POLY1305_BLOCK_SIZE) { -+ poly1305_blocks(ctx->opaque, inp, len, 1, have_simd); -+ inp += len; -+ } -+ -+ if (rem) -+ memcpy(ctx->data, inp, rem); -+ -+ ctx->num = rem; -+} -+ -+static void poly1305_finish(struct poly1305_ctx *ctx, u8 mac[16], bool have_simd) -+{ -+ size_t num = ctx->num; -+ -+ if (num) { -+ ctx->data[num++] = 1; /* pad bit */ -+ while (num < POLY1305_BLOCK_SIZE) -+ ctx->data[num++] = 0; -+ poly1305_blocks(ctx->opaque, ctx->data, POLY1305_BLOCK_SIZE, 0, have_simd); -+ } -+ -+ poly1305_emit(ctx->opaque, mac, ctx->nonce, have_simd); -+ -+ /* zero out the state */ -+ memzero_explicit(ctx, sizeof(*ctx)); -+} -+ -+ -+static const u8 pad0[16] = { 0 }; -+ -+static struct crypto_alg chacha20_alg = { -+ .cra_blocksize = 1, -+ .cra_alignmask = sizeof(u32) - 1 -+}; -+static struct crypto_blkcipher chacha20_cipher = { -+ .base = { -+ .__crt_alg = &chacha20_alg -+ } -+}; -+static struct blkcipher_desc chacha20_desc = { -+ .tfm = &chacha20_cipher -+}; -+ -+static inline void __chacha20poly1305_encrypt(u8 *dst, const u8 *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN], -+ bool have_simd) -+{ -+ __le64 len, le_nonce = cpu_to_le64(nonce); -+ struct poly1305_ctx poly1305_state; -+ struct chacha20_ctx chacha20_state = chacha20_initial_state(key, (u8 *)&le_nonce); -+ u8 block0[CHACHA20_BLOCK_SIZE] = { 0 }; -+ -+ chacha20_crypt(&chacha20_state, block0, block0, sizeof(block0), have_simd); -+ poly1305_init(&poly1305_state, block0, have_simd); -+ memzero_explicit(block0, sizeof(block0)); -+ -+ poly1305_update(&poly1305_state, ad, ad_len, have_simd); -+ poly1305_update(&poly1305_state, pad0, (0x10 - ad_len) & 0xf, have_simd); -+ -+ chacha20_crypt(&chacha20_state, dst, src, src_len, have_simd); -+ -+ poly1305_update(&poly1305_state, dst, src_len, have_simd); -+ poly1305_update(&poly1305_state, pad0, (0x10 - src_len) & 0xf, have_simd); -+ -+ len = cpu_to_le64(ad_len); -+ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); -+ -+ len = cpu_to_le64(src_len); -+ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); -+ -+ poly1305_finish(&poly1305_state, dst + src_len, have_simd); -+ -+ memzero_explicit(&chacha20_state, sizeof(chacha20_state)); -+} -+ -+void chacha20poly1305_encrypt(u8 *dst, const u8 *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN]) -+{ -+ bool have_simd; -+ -+ have_simd = chacha20poly1305_init_simd(); -+ __chacha20poly1305_encrypt(dst, src, src_len, ad, ad_len, nonce, key, have_simd); -+ chacha20poly1305_deinit_simd(have_simd); -+} -+ -+bool chacha20poly1305_encrypt_sg(struct scatterlist *dst, struct scatterlist *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN], -+ bool have_simd) -+{ -+ __le64 len, le_nonce = cpu_to_le64(nonce); -+ struct poly1305_ctx poly1305_state; -+ struct chacha20_ctx chacha20_state = chacha20_initial_state(key, (u8 *)&le_nonce); -+ int ret = 0; -+ struct blkcipher_walk walk; -+ u8 block0[CHACHA20_BLOCK_SIZE] = { 0 }; -+ u8 mac[POLY1305_MAC_SIZE]; -+ -+ chacha20_crypt(&chacha20_state, block0, block0, sizeof(block0), have_simd); -+ poly1305_init(&poly1305_state, block0, have_simd); -+ memzero_explicit(block0, sizeof(block0)); -+ -+ poly1305_update(&poly1305_state, ad, ad_len, have_simd); -+ poly1305_update(&poly1305_state, pad0, (0x10 - ad_len) & 0xf, have_simd); -+ -+ if (likely(src_len)) { -+ blkcipher_walk_init(&walk, dst, src, src_len); -+ ret = blkcipher_walk_virt_block(&chacha20_desc, &walk, CHACHA20_BLOCK_SIZE); -+ while (walk.nbytes >= CHACHA20_BLOCK_SIZE) { -+ size_t chunk_len = rounddown(walk.nbytes, CHACHA20_BLOCK_SIZE); -+ -+ chacha20_crypt(&chacha20_state, walk.dst.virt.addr, walk.src.virt.addr, chunk_len, have_simd); -+ poly1305_update(&poly1305_state, walk.dst.virt.addr, chunk_len, have_simd); -+ ret = blkcipher_walk_done(&chacha20_desc, &walk, walk.nbytes % CHACHA20_BLOCK_SIZE); -+ } -+ if (walk.nbytes) { -+ chacha20_crypt(&chacha20_state, walk.dst.virt.addr, walk.src.virt.addr, walk.nbytes, have_simd); -+ poly1305_update(&poly1305_state, walk.dst.virt.addr, walk.nbytes, have_simd); -+ ret = blkcipher_walk_done(&chacha20_desc, &walk, 0); -+ } -+ } -+ if (unlikely(ret)) -+ goto err; -+ -+ poly1305_update(&poly1305_state, pad0, (0x10 - src_len) & 0xf, have_simd); -+ -+ len = cpu_to_le64(ad_len); -+ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); -+ -+ len = cpu_to_le64(src_len); -+ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); -+ -+ poly1305_finish(&poly1305_state, mac, have_simd); -+ scatterwalk_map_and_copy(mac, dst, src_len, sizeof(mac), 1); -+err: -+ memzero_explicit(&chacha20_state, sizeof(chacha20_state)); -+ memzero_explicit(mac, sizeof(mac)); -+ return !ret; -+} -+ -+static inline bool __chacha20poly1305_decrypt(u8 *dst, const u8 *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN], -+ bool have_simd) -+{ -+ __le64 len, le_nonce = cpu_to_le64(nonce); -+ struct poly1305_ctx poly1305_state; -+ struct chacha20_ctx chacha20_state = chacha20_initial_state(key, (u8 *)&le_nonce); -+ int ret; -+ u8 block0[CHACHA20_BLOCK_SIZE] = { 0 }; -+ u8 mac[POLY1305_MAC_SIZE]; -+ size_t dst_len; -+ -+ if (unlikely(src_len < POLY1305_MAC_SIZE)) -+ return false; -+ -+ chacha20_crypt(&chacha20_state, block0, block0, sizeof(block0), have_simd); -+ poly1305_init(&poly1305_state, block0, have_simd); -+ memzero_explicit(block0, sizeof(block0)); -+ -+ poly1305_update(&poly1305_state, ad, ad_len, have_simd); -+ poly1305_update(&poly1305_state, pad0, (0x10 - ad_len) & 0xf, have_simd); -+ -+ dst_len = src_len - POLY1305_MAC_SIZE; -+ poly1305_update(&poly1305_state, src, dst_len, have_simd); -+ poly1305_update(&poly1305_state, pad0, (0x10 - dst_len) & 0xf, have_simd); -+ -+ len = cpu_to_le64(ad_len); -+ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); -+ -+ len = cpu_to_le64(dst_len); -+ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); -+ -+ poly1305_finish(&poly1305_state, mac, have_simd); -+ -+ ret = crypto_memneq(mac, src + dst_len, POLY1305_MAC_SIZE); -+ memzero_explicit(mac, POLY1305_MAC_SIZE); -+ if (likely(!ret)) -+ chacha20_crypt(&chacha20_state, dst, src, dst_len, have_simd); -+ -+ memzero_explicit(&chacha20_state, sizeof(chacha20_state)); -+ -+ return !ret; -+} -+ -+bool chacha20poly1305_decrypt(u8 *dst, const u8 *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN]) -+{ -+ bool have_simd, ret; -+ -+ have_simd = chacha20poly1305_init_simd(); -+ ret = __chacha20poly1305_decrypt(dst, src, src_len, ad, ad_len, nonce, key, have_simd); -+ chacha20poly1305_deinit_simd(have_simd); -+ return ret; -+} -+ -+bool chacha20poly1305_decrypt_sg(struct scatterlist *dst, struct scatterlist *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN], -+ bool have_simd) -+{ -+ __le64 len, le_nonce = cpu_to_le64(nonce); -+ struct poly1305_ctx poly1305_state; -+ struct chacha20_ctx chacha20_state = chacha20_initial_state(key, (u8 *)&le_nonce); -+ struct blkcipher_walk walk; -+ int ret = 0; -+ u8 block0[CHACHA20_BLOCK_SIZE] = { 0 }; -+ u8 read_mac[POLY1305_MAC_SIZE], computed_mac[POLY1305_MAC_SIZE]; -+ size_t dst_len; -+ -+ if (unlikely(src_len < POLY1305_MAC_SIZE)) -+ return false; -+ -+ chacha20_crypt(&chacha20_state, block0, block0, sizeof(block0), have_simd); -+ poly1305_init(&poly1305_state, block0, have_simd); -+ memzero_explicit(block0, sizeof(block0)); -+ -+ poly1305_update(&poly1305_state, ad, ad_len, have_simd); -+ poly1305_update(&poly1305_state, pad0, (0x10 - ad_len) & 0xf, have_simd); -+ -+ dst_len = src_len - POLY1305_MAC_SIZE; -+ if (likely(dst_len)) { -+ blkcipher_walk_init(&walk, dst, src, dst_len); -+ ret = blkcipher_walk_virt_block(&chacha20_desc, &walk, CHACHA20_BLOCK_SIZE); -+ while (walk.nbytes >= CHACHA20_BLOCK_SIZE) { -+ size_t chunk_len = rounddown(walk.nbytes, CHACHA20_BLOCK_SIZE); -+ -+ poly1305_update(&poly1305_state, walk.src.virt.addr, chunk_len, have_simd); -+ chacha20_crypt(&chacha20_state, walk.dst.virt.addr, walk.src.virt.addr, chunk_len, have_simd); -+ ret = blkcipher_walk_done(&chacha20_desc, &walk, walk.nbytes % CHACHA20_BLOCK_SIZE); -+ } -+ if (walk.nbytes) { -+ poly1305_update(&poly1305_state, walk.src.virt.addr, walk.nbytes, have_simd); -+ chacha20_crypt(&chacha20_state, walk.dst.virt.addr, walk.src.virt.addr, walk.nbytes, have_simd); -+ ret = blkcipher_walk_done(&chacha20_desc, &walk, 0); -+ } -+ } -+ if (unlikely(ret)) -+ goto err; -+ -+ poly1305_update(&poly1305_state, pad0, (0x10 - dst_len) & 0xf, have_simd); -+ -+ len = cpu_to_le64(ad_len); -+ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); -+ -+ len = cpu_to_le64(dst_len); -+ poly1305_update(&poly1305_state, (u8 *)&len, sizeof(len), have_simd); -+ -+ poly1305_finish(&poly1305_state, computed_mac, have_simd); -+ -+ scatterwalk_map_and_copy(read_mac, src, dst_len, POLY1305_MAC_SIZE, 0); -+ ret = crypto_memneq(read_mac, computed_mac, POLY1305_MAC_SIZE); -+err: -+ memzero_explicit(read_mac, POLY1305_MAC_SIZE); -+ memzero_explicit(computed_mac, POLY1305_MAC_SIZE); -+ memzero_explicit(&chacha20_state, sizeof(chacha20_state)); -+ return !ret; -+} -+ -+ -+void xchacha20poly1305_encrypt(u8 *dst, const u8 *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u8 nonce[XCHACHA20POLY1305_NONCELEN], -+ const u8 key[CHACHA20POLY1305_KEYLEN]) -+{ -+ bool have_simd = chacha20poly1305_init_simd(); -+ u8 derived_key[CHACHA20POLY1305_KEYLEN] __aligned(16); -+ -+ hchacha20(derived_key, nonce, key, have_simd); -+ __chacha20poly1305_encrypt(dst, src, src_len, ad, ad_len, le64_to_cpuvp(nonce + 16), derived_key, have_simd); -+ memzero_explicit(derived_key, CHACHA20POLY1305_KEYLEN); -+ chacha20poly1305_deinit_simd(have_simd); -+} -+ -+bool xchacha20poly1305_decrypt(u8 *dst, const u8 *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u8 nonce[XCHACHA20POLY1305_NONCELEN], -+ const u8 key[CHACHA20POLY1305_KEYLEN]) -+{ -+ bool ret, have_simd = chacha20poly1305_init_simd(); -+ u8 derived_key[CHACHA20POLY1305_KEYLEN] __aligned(16); -+ -+ hchacha20(derived_key, nonce, key, have_simd); -+ ret = __chacha20poly1305_decrypt(dst, src, src_len, ad, ad_len, le64_to_cpuvp(nonce + 16), derived_key, have_simd); -+ memzero_explicit(derived_key, CHACHA20POLY1305_KEYLEN); -+ chacha20poly1305_deinit_simd(have_simd); -+ return ret; -+} -+ -+#include "../selftest/chacha20poly1305.h" -+#include "../selftest/poly1305.h" ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/curve25519.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,81 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include "curve25519.h" -+ -+#include -+#include -+#include -+#include -+ -+static __always_inline void normalize_secret(u8 secret[CURVE25519_POINT_SIZE]) -+{ -+ secret[0] &= 248; -+ secret[31] &= 127; -+ secret[31] |= 64; -+} -+ -+#if defined(CONFIG_X86_64) && defined(CONFIG_AS_AVX) -+#include "curve25519-x86_64.h" -+#elif IS_ENABLED(CONFIG_KERNEL_MODE_NEON) && defined(CONFIG_ARM) -+#include "curve25519-arm.h" -+#else -+void __init curve25519_fpu_init(void) { } -+#endif -+ -+#if defined(CONFIG_ARCH_SUPPORTS_INT128) && defined(__SIZEOF_INT128__) -+#include "curve25519-hacl64.h" -+#else -+#include "curve25519-fiat32.h" -+#endif -+ -+static const u8 null_point[CURVE25519_POINT_SIZE] = { 0 }; -+ -+bool curve25519(u8 mypublic[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE], const u8 basepoint[CURVE25519_POINT_SIZE]) -+{ -+#if defined(CONFIG_X86_64) && defined(CONFIG_AS_AVX) -+ if (curve25519_use_avx && irq_fpu_usable()) { -+ kernel_fpu_begin(); -+ curve25519_sandy2x(mypublic, secret, basepoint); -+ kernel_fpu_end(); -+ } else -+#elif IS_ENABLED(CONFIG_KERNEL_MODE_NEON) && defined(CONFIG_ARM) -+ if (curve25519_use_neon && may_use_simd()) { -+ kernel_neon_begin(); -+ curve25519_neon(mypublic, secret, basepoint); -+ kernel_neon_end(); -+ } else -+#endif -+ curve25519_generic(mypublic, secret, basepoint); -+ -+ return crypto_memneq(mypublic, null_point, CURVE25519_POINT_SIZE); -+} -+ -+bool curve25519_generate_public(u8 pub[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE]) -+{ -+ static const u8 basepoint[CURVE25519_POINT_SIZE] __aligned(32) = { 9 }; -+ -+ if (unlikely(!crypto_memneq(secret, null_point, CURVE25519_POINT_SIZE))) -+ return false; -+ -+#if defined(CONFIG_X86_64) && defined(CONFIG_AS_AVX) -+ if (curve25519_use_avx && irq_fpu_usable()) { -+ kernel_fpu_begin(); -+ curve25519_sandy2x_base(pub, secret); -+ kernel_fpu_end(); -+ return crypto_memneq(pub, null_point, CURVE25519_POINT_SIZE); -+ } -+#endif -+ -+ return curve25519(pub, secret, basepoint); -+} -+ -+void curve25519_generate_secret(u8 secret[CURVE25519_POINT_SIZE]) -+{ -+ get_random_bytes_wait(secret, CURVE25519_POINT_SIZE); -+ normalize_secret(secret); -+} -+ -+#include "../selftest/curve25519.h" ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/blake2s.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,94 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_BLAKE2S_H -+#define _WG_BLAKE2S_H -+ -+#include -+#include -+#include -+ -+enum blake2s_lengths { -+ BLAKE2S_BLOCKBYTES = 64, -+ BLAKE2S_OUTBYTES = 32, -+ BLAKE2S_KEYBYTES = 32 -+}; -+ -+struct blake2s_state { -+ u32 h[8]; -+ u32 t[2]; -+ u32 f[2]; -+ u8 buf[BLAKE2S_BLOCKBYTES]; -+ size_t buflen; -+ u8 last_node; -+}; -+ -+void blake2s_init(struct blake2s_state *state, const size_t outlen); -+void blake2s_init_key(struct blake2s_state *state, const size_t outlen, const void *key, const size_t keylen); -+void blake2s_update(struct blake2s_state *state, const u8 *in, size_t inlen); -+void __blake2s_final(struct blake2s_state *state); -+static inline void blake2s_final(struct blake2s_state *state, u8 *out, size_t outlen) -+{ -+ int i; -+ -+#ifdef DEBUG -+ BUG_ON(!out || !outlen || outlen > BLAKE2S_OUTBYTES); -+#endif -+ __blake2s_final(state); -+ -+ if (__builtin_constant_p(outlen) && !(outlen % sizeof(u32))) { -+ if (IS_ENABLED(CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS) || IS_ALIGNED((unsigned long)out, __alignof__(u32))) { -+ __le32 *outwords = (__le32 *)out; -+ -+ for (i = 0; i < outlen / sizeof(u32); ++i) -+ outwords[i] = cpu_to_le32(state->h[i]); -+ } else { -+ __le32 buffer[BLAKE2S_OUTBYTES]; -+ -+ for (i = 0; i < outlen / sizeof(u32); ++i) -+ buffer[i] = cpu_to_le32(state->h[i]); -+ memcpy(out, buffer, outlen); -+ memzero_explicit(buffer, sizeof(buffer)); -+ } -+ } else { -+ u8 buffer[BLAKE2S_OUTBYTES] __aligned(__alignof__(u32)); -+ __le32 *outwords = (__le32 *)buffer; -+ -+ for (i = 0; i < 8; ++i) -+ outwords[i] = cpu_to_le32(state->h[i]); -+ memcpy(out, buffer, outlen); -+ memzero_explicit(buffer, sizeof(buffer)); -+ } -+ -+ memzero_explicit(state, sizeof(struct blake2s_state)); -+} -+ -+ -+static inline void blake2s(u8 *out, const u8 *in, const u8 *key, const size_t outlen, size_t inlen, const size_t keylen) -+{ -+ struct blake2s_state state; -+ -+#ifdef DEBUG -+ BUG_ON((!in && inlen > 0) || !out || !outlen || outlen > BLAKE2S_OUTBYTES || keylen > BLAKE2S_KEYBYTES || (!key && keylen)); -+#endif -+ -+ if (keylen) -+ blake2s_init_key(&state, outlen, key, keylen); -+ else -+ blake2s_init(&state, outlen); -+ -+ blake2s_update(&state, in, inlen); -+ blake2s_final(&state, out, outlen); -+} -+ -+void blake2s_hmac(u8 *out, const u8 *in, const u8 *key, const size_t outlen, const size_t inlen, const size_t keylen); -+ -+void blake2s_fpu_init(void); -+ -+#ifdef DEBUG -+bool blake2s_selftest(void); -+#endif -+ -+#endif /* _WG_BLAKE2S_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/chacha20poly1305.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,93 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_CHACHA20POLY1305_H -+#define _WG_CHACHA20POLY1305_H -+ -+#include -+ -+struct scatterlist; -+ -+enum chacha20poly1305_lengths { -+ XCHACHA20POLY1305_NONCELEN = 24, -+ CHACHA20POLY1305_KEYLEN = 32, -+ CHACHA20POLY1305_AUTHTAGLEN = 16 -+}; -+ -+void chacha20poly1305_fpu_init(void); -+ -+void chacha20poly1305_encrypt(u8 *dst, const u8 *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN]); -+ -+bool __must_check chacha20poly1305_encrypt_sg(struct scatterlist *dst, struct scatterlist *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN], -+ bool have_simd); -+ -+bool __must_check chacha20poly1305_decrypt(u8 *dst, const u8 *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN]); -+ -+bool __must_check chacha20poly1305_decrypt_sg(struct scatterlist *dst, struct scatterlist *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u64 nonce, const u8 key[CHACHA20POLY1305_KEYLEN], -+ bool have_simd); -+ -+void xchacha20poly1305_encrypt(u8 *dst, const u8 *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u8 nonce[XCHACHA20POLY1305_NONCELEN], -+ const u8 key[CHACHA20POLY1305_KEYLEN]); -+ -+bool __must_check xchacha20poly1305_decrypt(u8 *dst, const u8 *src, const size_t src_len, -+ const u8 *ad, const size_t ad_len, -+ const u8 nonce[XCHACHA20POLY1305_NONCELEN], -+ const u8 key[CHACHA20POLY1305_KEYLEN]); -+ -+#if defined(CONFIG_X86_64) -+#include -+#include -+#include -+#elif IS_ENABLED(CONFIG_KERNEL_MODE_NEON) -+#include -+#include -+#endif -+ -+static inline bool chacha20poly1305_init_simd(void) -+{ -+ bool have_simd = false; -+#if defined(CONFIG_X86_64) && !defined(CONFIG_UML) -+ have_simd = irq_fpu_usable(); -+ if (have_simd) -+ kernel_fpu_begin(); -+#elif IS_ENABLED(CONFIG_KERNEL_MODE_NEON) -+#if defined(CONFIG_ARM64) -+ have_simd = true; /* ARM64 supports NEON in any context. */ -+#elif defined(CONFIG_ARM) -+ have_simd = may_use_simd(); /* ARM doesn't support NEON in interrupt context. */ -+#endif -+ if (have_simd) -+ kernel_neon_begin(); -+#endif -+ return have_simd; -+} -+ -+static inline void chacha20poly1305_deinit_simd(bool was_on) -+{ -+#if defined(CONFIG_X86_64) && !defined(CONFIG_UML) -+ if (was_on) -+ kernel_fpu_end(); -+#elif IS_ENABLED(CONFIG_KERNEL_MODE_NEON) -+ if (was_on) -+ kernel_neon_end(); -+#endif -+} -+ -+#ifdef DEBUG -+bool chacha20poly1305_selftest(void); -+bool poly1305_selftest(void); -+#endif -+ -+#endif /* _WG_CHACHA20POLY1305_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/curve25519-arm.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,14 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include -+#include -+#include -+asmlinkage void curve25519_neon(u8 mypublic[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE], const u8 basepoint[CURVE25519_POINT_SIZE]); -+static bool curve25519_use_neon __ro_after_init; -+void __init curve25519_fpu_init(void) -+{ -+ curve25519_use_neon = elf_hwcap & HWCAP_NEON; -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/curve25519-fiat32.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,838 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2016 The fiat-crypto Authors. -+ * Copyright (C) 2018 Jason A. Donenfeld . All Rights Reserved. -+ * -+ * This is a machine-generated formally verified implementation of curve25519 DH from: -+ * https://github.com/mit-plv/fiat-crypto -+ */ -+ -+/* fe means field element. Here the field is \Z/(2^255-19). An element t, -+ * entries t[0]...t[9], represents the integer t[0]+2^26 t[1]+2^51 t[2]+2^77 -+ * t[3]+2^102 t[4]+...+2^230 t[9]. -+ * fe limbs are bounded by 1.125*2^26,1.125*2^25,1.125*2^26,1.125*2^25,etc. -+ * Multiplication and carrying produce fe from fe_loose. -+ */ -+typedef struct fe { u32 v[10]; } fe; -+ -+/* fe_loose limbs are bounded by 3.375*2^26,3.375*2^25,3.375*2^26,3.375*2^25,etc. -+ * Addition and subtraction produce fe_loose from (fe, fe). -+ */ -+typedef struct fe_loose { u32 v[10]; } fe_loose; -+ -+static __always_inline void fe_frombytes_impl(u32 h[10], const u8 *s) -+{ -+ /* Ignores top bit of s. */ -+ u32 a0 = le32_to_cpup((__force __le32 *)(s)); -+ u32 a1 = le32_to_cpup((__force __le32 *)(s+4)); -+ u32 a2 = le32_to_cpup((__force __le32 *)(s+8)); -+ u32 a3 = le32_to_cpup((__force __le32 *)(s+12)); -+ u32 a4 = le32_to_cpup((__force __le32 *)(s+16)); -+ u32 a5 = le32_to_cpup((__force __le32 *)(s+20)); -+ u32 a6 = le32_to_cpup((__force __le32 *)(s+24)); -+ u32 a7 = le32_to_cpup((__force __le32 *)(s+28)); -+ h[0] = a0&((1<<26)-1); /* 26 used, 32-26 left. 26 */ -+ h[1] = (a0>>26) | ((a1&((1<<19)-1))<< 6); /* (32-26) + 19 = 6+19 = 25 */ -+ h[2] = (a1>>19) | ((a2&((1<<13)-1))<<13); /* (32-19) + 13 = 13+13 = 26 */ -+ h[3] = (a2>>13) | ((a3&((1<< 6)-1))<<19); /* (32-13) + 6 = 19+ 6 = 25 */ -+ h[4] = (a3>> 6); /* (32- 6) = 26 */ -+ h[5] = a4&((1<<25)-1); /* 25 */ -+ h[6] = (a4>>25) | ((a5&((1<<19)-1))<< 7); /* (32-25) + 19 = 7+19 = 26 */ -+ h[7] = (a5>>19) | ((a6&((1<<12)-1))<<13); /* (32-19) + 12 = 13+12 = 25 */ -+ h[8] = (a6>>12) | ((a7&((1<< 6)-1))<<20); /* (32-12) + 6 = 20+ 6 = 26 */ -+ h[9] = (a7>> 6)&((1<<25)-1); /* 25 */ -+} -+ -+static __always_inline void fe_frombytes(fe *h, const u8 *s) -+{ -+ fe_frombytes_impl(h->v, s); -+} -+ -+static __always_inline u8 /*bool*/ addcarryx_u25(u8 /*bool*/ c, u32 a, u32 b, u32 *low) -+{ -+ /* This function extracts 25 bits of result and 1 bit of carry (26 total), so -+ * a 32-bit intermediate is sufficient. -+ */ -+ u32 x = a + b + c; -+ *low = x & ((1 << 25) - 1); -+ return (x >> 25) & 1; -+} -+ -+static __always_inline u8 /*bool*/ addcarryx_u26(u8 /*bool*/ c, u32 a, u32 b, u32 *low) -+{ -+ /* This function extracts 26 bits of result and 1 bit of carry (27 total), so -+ * a 32-bit intermediate is sufficient. -+ */ -+ u32 x = a + b + c; -+ *low = x & ((1 << 26) - 1); -+ return (x >> 26) & 1; -+} -+ -+static __always_inline u8 /*bool*/ subborrow_u25(u8 /*bool*/ c, u32 a, u32 b, u32 *low) -+{ -+ /* This function extracts 25 bits of result and 1 bit of borrow (26 total), so -+ * a 32-bit intermediate is sufficient. -+ */ -+ u32 x = a - b - c; -+ *low = x & ((1 << 25) - 1); -+ return x >> 31; -+} -+ -+static __always_inline u8 /*bool*/ subborrow_u26(u8 /*bool*/ c, u32 a, u32 b, u32 *low) -+{ -+ /* This function extracts 26 bits of result and 1 bit of borrow (27 total), so -+ * a 32-bit intermediate is sufficient. -+ */ -+ u32 x = a - b - c; -+ *low = x & ((1 << 26) - 1); -+ return x >> 31; -+} -+ -+static __always_inline u32 cmovznz32(u32 t, u32 z, u32 nz) -+{ -+ t = -!!t; /* all set if nonzero, 0 if 0 */ -+ return (t&nz) | ((~t)&z); -+} -+ -+static __always_inline void fe_freeze(u32 out[10], const u32 in1[10]) -+{ -+ { const u32 x17 = in1[9]; -+ { const u32 x18 = in1[8]; -+ { const u32 x16 = in1[7]; -+ { const u32 x14 = in1[6]; -+ { const u32 x12 = in1[5]; -+ { const u32 x10 = in1[4]; -+ { const u32 x8 = in1[3]; -+ { const u32 x6 = in1[2]; -+ { const u32 x4 = in1[1]; -+ { const u32 x2 = in1[0]; -+ { u32 x20; u8/*bool*/ x21 = subborrow_u26(0x0, x2, 0x3ffffed, &x20); -+ { u32 x23; u8/*bool*/ x24 = subborrow_u25(x21, x4, 0x1ffffff, &x23); -+ { u32 x26; u8/*bool*/ x27 = subborrow_u26(x24, x6, 0x3ffffff, &x26); -+ { u32 x29; u8/*bool*/ x30 = subborrow_u25(x27, x8, 0x1ffffff, &x29); -+ { u32 x32; u8/*bool*/ x33 = subborrow_u26(x30, x10, 0x3ffffff, &x32); -+ { u32 x35; u8/*bool*/ x36 = subborrow_u25(x33, x12, 0x1ffffff, &x35); -+ { u32 x38; u8/*bool*/ x39 = subborrow_u26(x36, x14, 0x3ffffff, &x38); -+ { u32 x41; u8/*bool*/ x42 = subborrow_u25(x39, x16, 0x1ffffff, &x41); -+ { u32 x44; u8/*bool*/ x45 = subborrow_u26(x42, x18, 0x3ffffff, &x44); -+ { u32 x47; u8/*bool*/ x48 = subborrow_u25(x45, x17, 0x1ffffff, &x47); -+ { u32 x49 = cmovznz32(x48, 0x0, 0xffffffff); -+ { u32 x50 = (x49 & 0x3ffffed); -+ { u32 x52; u8/*bool*/ x53 = addcarryx_u26(0x0, x20, x50, &x52); -+ { u32 x54 = (x49 & 0x1ffffff); -+ { u32 x56; u8/*bool*/ x57 = addcarryx_u25(x53, x23, x54, &x56); -+ { u32 x58 = (x49 & 0x3ffffff); -+ { u32 x60; u8/*bool*/ x61 = addcarryx_u26(x57, x26, x58, &x60); -+ { u32 x62 = (x49 & 0x1ffffff); -+ { u32 x64; u8/*bool*/ x65 = addcarryx_u25(x61, x29, x62, &x64); -+ { u32 x66 = (x49 & 0x3ffffff); -+ { u32 x68; u8/*bool*/ x69 = addcarryx_u26(x65, x32, x66, &x68); -+ { u32 x70 = (x49 & 0x1ffffff); -+ { u32 x72; u8/*bool*/ x73 = addcarryx_u25(x69, x35, x70, &x72); -+ { u32 x74 = (x49 & 0x3ffffff); -+ { u32 x76; u8/*bool*/ x77 = addcarryx_u26(x73, x38, x74, &x76); -+ { u32 x78 = (x49 & 0x1ffffff); -+ { u32 x80; u8/*bool*/ x81 = addcarryx_u25(x77, x41, x78, &x80); -+ { u32 x82 = (x49 & 0x3ffffff); -+ { u32 x84; u8/*bool*/ x85 = addcarryx_u26(x81, x44, x82, &x84); -+ { u32 x86 = (x49 & 0x1ffffff); -+ { u32 x88; addcarryx_u25(x85, x47, x86, &x88); -+ out[0] = x52; -+ out[1] = x56; -+ out[2] = x60; -+ out[3] = x64; -+ out[4] = x68; -+ out[5] = x72; -+ out[6] = x76; -+ out[7] = x80; -+ out[8] = x84; -+ out[9] = x88; -+ }}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}} -+} -+ -+static __always_inline void fe_tobytes(u8 s[32], const fe *f) -+{ -+ u32 h[10]; -+ fe_freeze(h, f->v); -+ s[0] = h[0] >> 0; -+ s[1] = h[0] >> 8; -+ s[2] = h[0] >> 16; -+ s[3] = (h[0] >> 24) | (h[1] << 2); -+ s[4] = h[1] >> 6; -+ s[5] = h[1] >> 14; -+ s[6] = (h[1] >> 22) | (h[2] << 3); -+ s[7] = h[2] >> 5; -+ s[8] = h[2] >> 13; -+ s[9] = (h[2] >> 21) | (h[3] << 5); -+ s[10] = h[3] >> 3; -+ s[11] = h[3] >> 11; -+ s[12] = (h[3] >> 19) | (h[4] << 6); -+ s[13] = h[4] >> 2; -+ s[14] = h[4] >> 10; -+ s[15] = h[4] >> 18; -+ s[16] = h[5] >> 0; -+ s[17] = h[5] >> 8; -+ s[18] = h[5] >> 16; -+ s[19] = (h[5] >> 24) | (h[6] << 1); -+ s[20] = h[6] >> 7; -+ s[21] = h[6] >> 15; -+ s[22] = (h[6] >> 23) | (h[7] << 3); -+ s[23] = h[7] >> 5; -+ s[24] = h[7] >> 13; -+ s[25] = (h[7] >> 21) | (h[8] << 4); -+ s[26] = h[8] >> 4; -+ s[27] = h[8] >> 12; -+ s[28] = (h[8] >> 20) | (h[9] << 6); -+ s[29] = h[9] >> 2; -+ s[30] = h[9] >> 10; -+ s[31] = h[9] >> 18; -+} -+ -+/* h = f */ -+static __always_inline void fe_copy(fe *h, const fe *f) -+{ -+ memmove(h, f, sizeof(u32) * 10); -+} -+ -+static __always_inline void fe_copy_lt(fe_loose *h, const fe *f) -+{ -+ memmove(h, f, sizeof(u32) * 10); -+} -+ -+/* h = 0 */ -+static __always_inline void fe_0(fe *h) -+{ -+ memset(h, 0, sizeof(u32) * 10); -+} -+ -+/* h = 1 */ -+static __always_inline void fe_1(fe *h) -+{ -+ memset(h, 0, sizeof(u32) * 10); -+ h->v[0] = 1; -+} -+ -+static void fe_add_impl(u32 out[10], const u32 in1[10], const u32 in2[10]) -+{ -+ { const u32 x20 = in1[9]; -+ { const u32 x21 = in1[8]; -+ { const u32 x19 = in1[7]; -+ { const u32 x17 = in1[6]; -+ { const u32 x15 = in1[5]; -+ { const u32 x13 = in1[4]; -+ { const u32 x11 = in1[3]; -+ { const u32 x9 = in1[2]; -+ { const u32 x7 = in1[1]; -+ { const u32 x5 = in1[0]; -+ { const u32 x38 = in2[9]; -+ { const u32 x39 = in2[8]; -+ { const u32 x37 = in2[7]; -+ { const u32 x35 = in2[6]; -+ { const u32 x33 = in2[5]; -+ { const u32 x31 = in2[4]; -+ { const u32 x29 = in2[3]; -+ { const u32 x27 = in2[2]; -+ { const u32 x25 = in2[1]; -+ { const u32 x23 = in2[0]; -+ out[0] = (x5 + x23); -+ out[1] = (x7 + x25); -+ out[2] = (x9 + x27); -+ out[3] = (x11 + x29); -+ out[4] = (x13 + x31); -+ out[5] = (x15 + x33); -+ out[6] = (x17 + x35); -+ out[7] = (x19 + x37); -+ out[8] = (x21 + x39); -+ out[9] = (x20 + x38); -+ }}}}}}}}}}}}}}}}}}}} -+} -+ -+/* h = f + g -+ * Can overlap h with f or g. -+ */ -+static __always_inline void fe_add(fe_loose *h, const fe *f, const fe *g) -+{ -+ fe_add_impl(h->v, f->v, g->v); -+} -+ -+static void fe_sub_impl(u32 out[10], const u32 in1[10], const u32 in2[10]) -+{ -+ { const u32 x20 = in1[9]; -+ { const u32 x21 = in1[8]; -+ { const u32 x19 = in1[7]; -+ { const u32 x17 = in1[6]; -+ { const u32 x15 = in1[5]; -+ { const u32 x13 = in1[4]; -+ { const u32 x11 = in1[3]; -+ { const u32 x9 = in1[2]; -+ { const u32 x7 = in1[1]; -+ { const u32 x5 = in1[0]; -+ { const u32 x38 = in2[9]; -+ { const u32 x39 = in2[8]; -+ { const u32 x37 = in2[7]; -+ { const u32 x35 = in2[6]; -+ { const u32 x33 = in2[5]; -+ { const u32 x31 = in2[4]; -+ { const u32 x29 = in2[3]; -+ { const u32 x27 = in2[2]; -+ { const u32 x25 = in2[1]; -+ { const u32 x23 = in2[0]; -+ out[0] = ((0x7ffffda + x5) - x23); -+ out[1] = ((0x3fffffe + x7) - x25); -+ out[2] = ((0x7fffffe + x9) - x27); -+ out[3] = ((0x3fffffe + x11) - x29); -+ out[4] = ((0x7fffffe + x13) - x31); -+ out[5] = ((0x3fffffe + x15) - x33); -+ out[6] = ((0x7fffffe + x17) - x35); -+ out[7] = ((0x3fffffe + x19) - x37); -+ out[8] = ((0x7fffffe + x21) - x39); -+ out[9] = ((0x3fffffe + x20) - x38); -+ }}}}}}}}}}}}}}}}}}}} -+} -+ -+/* h = f - g -+ * Can overlap h with f or g. -+ */ -+static __always_inline void fe_sub(fe_loose *h, const fe *f, const fe *g) -+{ -+ fe_sub_impl(h->v, f->v, g->v); -+} -+ -+static void fe_mul_impl(u32 out[10], const u32 in1[10], const u32 in2[10]) -+{ -+ { const u32 x20 = in1[9]; -+ { const u32 x21 = in1[8]; -+ { const u32 x19 = in1[7]; -+ { const u32 x17 = in1[6]; -+ { const u32 x15 = in1[5]; -+ { const u32 x13 = in1[4]; -+ { const u32 x11 = in1[3]; -+ { const u32 x9 = in1[2]; -+ { const u32 x7 = in1[1]; -+ { const u32 x5 = in1[0]; -+ { const u32 x38 = in2[9]; -+ { const u32 x39 = in2[8]; -+ { const u32 x37 = in2[7]; -+ { const u32 x35 = in2[6]; -+ { const u32 x33 = in2[5]; -+ { const u32 x31 = in2[4]; -+ { const u32 x29 = in2[3]; -+ { const u32 x27 = in2[2]; -+ { const u32 x25 = in2[1]; -+ { const u32 x23 = in2[0]; -+ { u64 x40 = ((u64)x23 * x5); -+ { u64 x41 = (((u64)x23 * x7) + ((u64)x25 * x5)); -+ { u64 x42 = ((((u64)(0x2 * x25) * x7) + ((u64)x23 * x9)) + ((u64)x27 * x5)); -+ { u64 x43 = (((((u64)x25 * x9) + ((u64)x27 * x7)) + ((u64)x23 * x11)) + ((u64)x29 * x5)); -+ { u64 x44 = (((((u64)x27 * x9) + (0x2 * (((u64)x25 * x11) + ((u64)x29 * x7)))) + ((u64)x23 * x13)) + ((u64)x31 * x5)); -+ { u64 x45 = (((((((u64)x27 * x11) + ((u64)x29 * x9)) + ((u64)x25 * x13)) + ((u64)x31 * x7)) + ((u64)x23 * x15)) + ((u64)x33 * x5)); -+ { u64 x46 = (((((0x2 * ((((u64)x29 * x11) + ((u64)x25 * x15)) + ((u64)x33 * x7))) + ((u64)x27 * x13)) + ((u64)x31 * x9)) + ((u64)x23 * x17)) + ((u64)x35 * x5)); -+ { u64 x47 = (((((((((u64)x29 * x13) + ((u64)x31 * x11)) + ((u64)x27 * x15)) + ((u64)x33 * x9)) + ((u64)x25 * x17)) + ((u64)x35 * x7)) + ((u64)x23 * x19)) + ((u64)x37 * x5)); -+ { u64 x48 = (((((((u64)x31 * x13) + (0x2 * (((((u64)x29 * x15) + ((u64)x33 * x11)) + ((u64)x25 * x19)) + ((u64)x37 * x7)))) + ((u64)x27 * x17)) + ((u64)x35 * x9)) + ((u64)x23 * x21)) + ((u64)x39 * x5)); -+ { u64 x49 = (((((((((((u64)x31 * x15) + ((u64)x33 * x13)) + ((u64)x29 * x17)) + ((u64)x35 * x11)) + ((u64)x27 * x19)) + ((u64)x37 * x9)) + ((u64)x25 * x21)) + ((u64)x39 * x7)) + ((u64)x23 * x20)) + ((u64)x38 * x5)); -+ { u64 x50 = (((((0x2 * ((((((u64)x33 * x15) + ((u64)x29 * x19)) + ((u64)x37 * x11)) + ((u64)x25 * x20)) + ((u64)x38 * x7))) + ((u64)x31 * x17)) + ((u64)x35 * x13)) + ((u64)x27 * x21)) + ((u64)x39 * x9)); -+ { u64 x51 = (((((((((u64)x33 * x17) + ((u64)x35 * x15)) + ((u64)x31 * x19)) + ((u64)x37 * x13)) + ((u64)x29 * x21)) + ((u64)x39 * x11)) + ((u64)x27 * x20)) + ((u64)x38 * x9)); -+ { u64 x52 = (((((u64)x35 * x17) + (0x2 * (((((u64)x33 * x19) + ((u64)x37 * x15)) + ((u64)x29 * x20)) + ((u64)x38 * x11)))) + ((u64)x31 * x21)) + ((u64)x39 * x13)); -+ { u64 x53 = (((((((u64)x35 * x19) + ((u64)x37 * x17)) + ((u64)x33 * x21)) + ((u64)x39 * x15)) + ((u64)x31 * x20)) + ((u64)x38 * x13)); -+ { u64 x54 = (((0x2 * ((((u64)x37 * x19) + ((u64)x33 * x20)) + ((u64)x38 * x15))) + ((u64)x35 * x21)) + ((u64)x39 * x17)); -+ { u64 x55 = (((((u64)x37 * x21) + ((u64)x39 * x19)) + ((u64)x35 * x20)) + ((u64)x38 * x17)); -+ { u64 x56 = (((u64)x39 * x21) + (0x2 * (((u64)x37 * x20) + ((u64)x38 * x19)))); -+ { u64 x57 = (((u64)x39 * x20) + ((u64)x38 * x21)); -+ { u64 x58 = ((u64)(0x2 * x38) * x20); -+ { u64 x59 = (x48 + (x58 << 0x4)); -+ { u64 x60 = (x59 + (x58 << 0x1)); -+ { u64 x61 = (x60 + x58); -+ { u64 x62 = (x47 + (x57 << 0x4)); -+ { u64 x63 = (x62 + (x57 << 0x1)); -+ { u64 x64 = (x63 + x57); -+ { u64 x65 = (x46 + (x56 << 0x4)); -+ { u64 x66 = (x65 + (x56 << 0x1)); -+ { u64 x67 = (x66 + x56); -+ { u64 x68 = (x45 + (x55 << 0x4)); -+ { u64 x69 = (x68 + (x55 << 0x1)); -+ { u64 x70 = (x69 + x55); -+ { u64 x71 = (x44 + (x54 << 0x4)); -+ { u64 x72 = (x71 + (x54 << 0x1)); -+ { u64 x73 = (x72 + x54); -+ { u64 x74 = (x43 + (x53 << 0x4)); -+ { u64 x75 = (x74 + (x53 << 0x1)); -+ { u64 x76 = (x75 + x53); -+ { u64 x77 = (x42 + (x52 << 0x4)); -+ { u64 x78 = (x77 + (x52 << 0x1)); -+ { u64 x79 = (x78 + x52); -+ { u64 x80 = (x41 + (x51 << 0x4)); -+ { u64 x81 = (x80 + (x51 << 0x1)); -+ { u64 x82 = (x81 + x51); -+ { u64 x83 = (x40 + (x50 << 0x4)); -+ { u64 x84 = (x83 + (x50 << 0x1)); -+ { u64 x85 = (x84 + x50); -+ { u64 x86 = (x85 >> 0x1a); -+ { u32 x87 = ((u32)x85 & 0x3ffffff); -+ { u64 x88 = (x86 + x82); -+ { u64 x89 = (x88 >> 0x19); -+ { u32 x90 = ((u32)x88 & 0x1ffffff); -+ { u64 x91 = (x89 + x79); -+ { u64 x92 = (x91 >> 0x1a); -+ { u32 x93 = ((u32)x91 & 0x3ffffff); -+ { u64 x94 = (x92 + x76); -+ { u64 x95 = (x94 >> 0x19); -+ { u32 x96 = ((u32)x94 & 0x1ffffff); -+ { u64 x97 = (x95 + x73); -+ { u64 x98 = (x97 >> 0x1a); -+ { u32 x99 = ((u32)x97 & 0x3ffffff); -+ { u64 x100 = (x98 + x70); -+ { u64 x101 = (x100 >> 0x19); -+ { u32 x102 = ((u32)x100 & 0x1ffffff); -+ { u64 x103 = (x101 + x67); -+ { u64 x104 = (x103 >> 0x1a); -+ { u32 x105 = ((u32)x103 & 0x3ffffff); -+ { u64 x106 = (x104 + x64); -+ { u64 x107 = (x106 >> 0x19); -+ { u32 x108 = ((u32)x106 & 0x1ffffff); -+ { u64 x109 = (x107 + x61); -+ { u64 x110 = (x109 >> 0x1a); -+ { u32 x111 = ((u32)x109 & 0x3ffffff); -+ { u64 x112 = (x110 + x49); -+ { u64 x113 = (x112 >> 0x19); -+ { u32 x114 = ((u32)x112 & 0x1ffffff); -+ { u64 x115 = (x87 + (0x13 * x113)); -+ { u32 x116 = (u32) (x115 >> 0x1a); -+ { u32 x117 = ((u32)x115 & 0x3ffffff); -+ { u32 x118 = (x116 + x90); -+ { u32 x119 = (x118 >> 0x19); -+ { u32 x120 = (x118 & 0x1ffffff); -+ out[0] = x117; -+ out[1] = x120; -+ out[2] = (x119 + x93); -+ out[3] = x96; -+ out[4] = x99; -+ out[5] = x102; -+ out[6] = x105; -+ out[7] = x108; -+ out[8] = x111; -+ out[9] = x114; -+ }}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}} -+} -+ -+static __always_inline void fe_mul_ttt(fe *h, const fe *f, const fe *g) -+{ -+ fe_mul_impl(h->v, f->v, g->v); -+} -+ -+static __always_inline void fe_mul_tlt(fe *h, const fe_loose *f, const fe *g) -+{ -+ fe_mul_impl(h->v, f->v, g->v); -+} -+ -+static __always_inline void fe_mul_tll(fe *h, const fe_loose *f, const fe_loose *g) -+{ -+ fe_mul_impl(h->v, f->v, g->v); -+} -+ -+static void fe_sqr_impl(u32 out[10], const u32 in1[10]) -+{ -+ { const u32 x17 = in1[9]; -+ { const u32 x18 = in1[8]; -+ { const u32 x16 = in1[7]; -+ { const u32 x14 = in1[6]; -+ { const u32 x12 = in1[5]; -+ { const u32 x10 = in1[4]; -+ { const u32 x8 = in1[3]; -+ { const u32 x6 = in1[2]; -+ { const u32 x4 = in1[1]; -+ { const u32 x2 = in1[0]; -+ { u64 x19 = ((u64)x2 * x2); -+ { u64 x20 = ((u64)(0x2 * x2) * x4); -+ { u64 x21 = (0x2 * (((u64)x4 * x4) + ((u64)x2 * x6))); -+ { u64 x22 = (0x2 * (((u64)x4 * x6) + ((u64)x2 * x8))); -+ { u64 x23 = ((((u64)x6 * x6) + ((u64)(0x4 * x4) * x8)) + ((u64)(0x2 * x2) * x10)); -+ { u64 x24 = (0x2 * ((((u64)x6 * x8) + ((u64)x4 * x10)) + ((u64)x2 * x12))); -+ { u64 x25 = (0x2 * (((((u64)x8 * x8) + ((u64)x6 * x10)) + ((u64)x2 * x14)) + ((u64)(0x2 * x4) * x12))); -+ { u64 x26 = (0x2 * (((((u64)x8 * x10) + ((u64)x6 * x12)) + ((u64)x4 * x14)) + ((u64)x2 * x16))); -+ { u64 x27 = (((u64)x10 * x10) + (0x2 * ((((u64)x6 * x14) + ((u64)x2 * x18)) + (0x2 * (((u64)x4 * x16) + ((u64)x8 * x12)))))); -+ { u64 x28 = (0x2 * ((((((u64)x10 * x12) + ((u64)x8 * x14)) + ((u64)x6 * x16)) + ((u64)x4 * x18)) + ((u64)x2 * x17))); -+ { u64 x29 = (0x2 * (((((u64)x12 * x12) + ((u64)x10 * x14)) + ((u64)x6 * x18)) + (0x2 * (((u64)x8 * x16) + ((u64)x4 * x17))))); -+ { u64 x30 = (0x2 * (((((u64)x12 * x14) + ((u64)x10 * x16)) + ((u64)x8 * x18)) + ((u64)x6 * x17))); -+ { u64 x31 = (((u64)x14 * x14) + (0x2 * (((u64)x10 * x18) + (0x2 * (((u64)x12 * x16) + ((u64)x8 * x17)))))); -+ { u64 x32 = (0x2 * ((((u64)x14 * x16) + ((u64)x12 * x18)) + ((u64)x10 * x17))); -+ { u64 x33 = (0x2 * ((((u64)x16 * x16) + ((u64)x14 * x18)) + ((u64)(0x2 * x12) * x17))); -+ { u64 x34 = (0x2 * (((u64)x16 * x18) + ((u64)x14 * x17))); -+ { u64 x35 = (((u64)x18 * x18) + ((u64)(0x4 * x16) * x17)); -+ { u64 x36 = ((u64)(0x2 * x18) * x17); -+ { u64 x37 = ((u64)(0x2 * x17) * x17); -+ { u64 x38 = (x27 + (x37 << 0x4)); -+ { u64 x39 = (x38 + (x37 << 0x1)); -+ { u64 x40 = (x39 + x37); -+ { u64 x41 = (x26 + (x36 << 0x4)); -+ { u64 x42 = (x41 + (x36 << 0x1)); -+ { u64 x43 = (x42 + x36); -+ { u64 x44 = (x25 + (x35 << 0x4)); -+ { u64 x45 = (x44 + (x35 << 0x1)); -+ { u64 x46 = (x45 + x35); -+ { u64 x47 = (x24 + (x34 << 0x4)); -+ { u64 x48 = (x47 + (x34 << 0x1)); -+ { u64 x49 = (x48 + x34); -+ { u64 x50 = (x23 + (x33 << 0x4)); -+ { u64 x51 = (x50 + (x33 << 0x1)); -+ { u64 x52 = (x51 + x33); -+ { u64 x53 = (x22 + (x32 << 0x4)); -+ { u64 x54 = (x53 + (x32 << 0x1)); -+ { u64 x55 = (x54 + x32); -+ { u64 x56 = (x21 + (x31 << 0x4)); -+ { u64 x57 = (x56 + (x31 << 0x1)); -+ { u64 x58 = (x57 + x31); -+ { u64 x59 = (x20 + (x30 << 0x4)); -+ { u64 x60 = (x59 + (x30 << 0x1)); -+ { u64 x61 = (x60 + x30); -+ { u64 x62 = (x19 + (x29 << 0x4)); -+ { u64 x63 = (x62 + (x29 << 0x1)); -+ { u64 x64 = (x63 + x29); -+ { u64 x65 = (x64 >> 0x1a); -+ { u32 x66 = ((u32)x64 & 0x3ffffff); -+ { u64 x67 = (x65 + x61); -+ { u64 x68 = (x67 >> 0x19); -+ { u32 x69 = ((u32)x67 & 0x1ffffff); -+ { u64 x70 = (x68 + x58); -+ { u64 x71 = (x70 >> 0x1a); -+ { u32 x72 = ((u32)x70 & 0x3ffffff); -+ { u64 x73 = (x71 + x55); -+ { u64 x74 = (x73 >> 0x19); -+ { u32 x75 = ((u32)x73 & 0x1ffffff); -+ { u64 x76 = (x74 + x52); -+ { u64 x77 = (x76 >> 0x1a); -+ { u32 x78 = ((u32)x76 & 0x3ffffff); -+ { u64 x79 = (x77 + x49); -+ { u64 x80 = (x79 >> 0x19); -+ { u32 x81 = ((u32)x79 & 0x1ffffff); -+ { u64 x82 = (x80 + x46); -+ { u64 x83 = (x82 >> 0x1a); -+ { u32 x84 = ((u32)x82 & 0x3ffffff); -+ { u64 x85 = (x83 + x43); -+ { u64 x86 = (x85 >> 0x19); -+ { u32 x87 = ((u32)x85 & 0x1ffffff); -+ { u64 x88 = (x86 + x40); -+ { u64 x89 = (x88 >> 0x1a); -+ { u32 x90 = ((u32)x88 & 0x3ffffff); -+ { u64 x91 = (x89 + x28); -+ { u64 x92 = (x91 >> 0x19); -+ { u32 x93 = ((u32)x91 & 0x1ffffff); -+ { u64 x94 = (x66 + (0x13 * x92)); -+ { u32 x95 = (u32) (x94 >> 0x1a); -+ { u32 x96 = ((u32)x94 & 0x3ffffff); -+ { u32 x97 = (x95 + x69); -+ { u32 x98 = (x97 >> 0x19); -+ { u32 x99 = (x97 & 0x1ffffff); -+ out[0] = x96; -+ out[1] = x99; -+ out[2] = (x98 + x72); -+ out[3] = x75; -+ out[4] = x78; -+ out[5] = x81; -+ out[6] = x84; -+ out[7] = x87; -+ out[8] = x90; -+ out[9] = x93; -+ }}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}} -+} -+ -+static __always_inline void fe_sq_tl(fe *h, const fe_loose *f) -+{ -+ fe_sqr_impl(h->v, f->v); -+} -+ -+static __always_inline void fe_sq_tt(fe *h, const fe *f) -+{ -+ fe_sqr_impl(h->v, f->v); -+} -+ -+static __always_inline void fe_loose_invert(fe *out, const fe_loose *z) -+{ -+ fe t0; -+ fe t1; -+ fe t2; -+ fe t3; -+ int i; -+ -+ fe_sq_tl(&t0, z); -+ fe_sq_tt(&t1, &t0); -+ for (i = 1; i < 2; ++i) -+ fe_sq_tt(&t1, &t1); -+ fe_mul_tlt(&t1, z, &t1); -+ fe_mul_ttt(&t0, &t0, &t1); -+ fe_sq_tt(&t2, &t0); -+ fe_mul_ttt(&t1, &t1, &t2); -+ fe_sq_tt(&t2, &t1); -+ for (i = 1; i < 5; ++i) -+ fe_sq_tt(&t2, &t2); -+ fe_mul_ttt(&t1, &t2, &t1); -+ fe_sq_tt(&t2, &t1); -+ for (i = 1; i < 10; ++i) -+ fe_sq_tt(&t2, &t2); -+ fe_mul_ttt(&t2, &t2, &t1); -+ fe_sq_tt(&t3, &t2); -+ for (i = 1; i < 20; ++i) -+ fe_sq_tt(&t3, &t3); -+ fe_mul_ttt(&t2, &t3, &t2); -+ fe_sq_tt(&t2, &t2); -+ for (i = 1; i < 10; ++i) -+ fe_sq_tt(&t2, &t2); -+ fe_mul_ttt(&t1, &t2, &t1); -+ fe_sq_tt(&t2, &t1); -+ for (i = 1; i < 50; ++i) -+ fe_sq_tt(&t2, &t2); -+ fe_mul_ttt(&t2, &t2, &t1); -+ fe_sq_tt(&t3, &t2); -+ for (i = 1; i < 100; ++i) -+ fe_sq_tt(&t3, &t3); -+ fe_mul_ttt(&t2, &t3, &t2); -+ fe_sq_tt(&t2, &t2); -+ for (i = 1; i < 50; ++i) -+ fe_sq_tt(&t2, &t2); -+ fe_mul_ttt(&t1, &t2, &t1); -+ fe_sq_tt(&t1, &t1); -+ for (i = 1; i < 5; ++i) -+ fe_sq_tt(&t1, &t1); -+ fe_mul_ttt(out, &t1, &t0); -+} -+ -+static __always_inline void fe_invert(fe *out, const fe *z) -+{ -+ fe_loose l; -+ fe_copy_lt(&l, z); -+ fe_loose_invert(out, &l); -+} -+ -+/* Replace (f,g) with (g,f) if b == 1; -+ * replace (f,g) with (f,g) if b == 0. -+ * -+ * Preconditions: b in {0,1} -+ */ -+static __always_inline void fe_cswap(fe *f, fe *g, unsigned int b) -+{ -+ unsigned i; -+ b = 0-b; -+ for (i = 0; i < 10; i++) { -+ u32 x = f->v[i] ^ g->v[i]; -+ x &= b; -+ f->v[i] ^= x; -+ g->v[i] ^= x; -+ } -+} -+ -+/* NOTE: based on fiat-crypto fe_mul, edited for in2=121666, 0, 0.*/ -+static __always_inline void fe_mul_121666_impl(u32 out[10], const u32 in1[10]) -+{ -+ { const u32 x20 = in1[9]; -+ { const u32 x21 = in1[8]; -+ { const u32 x19 = in1[7]; -+ { const u32 x17 = in1[6]; -+ { const u32 x15 = in1[5]; -+ { const u32 x13 = in1[4]; -+ { const u32 x11 = in1[3]; -+ { const u32 x9 = in1[2]; -+ { const u32 x7 = in1[1]; -+ { const u32 x5 = in1[0]; -+ { const u32 x38 = 0; -+ { const u32 x39 = 0; -+ { const u32 x37 = 0; -+ { const u32 x35 = 0; -+ { const u32 x33 = 0; -+ { const u32 x31 = 0; -+ { const u32 x29 = 0; -+ { const u32 x27 = 0; -+ { const u32 x25 = 0; -+ { const u32 x23 = 121666; -+ { u64 x40 = ((u64)x23 * x5); -+ { u64 x41 = (((u64)x23 * x7) + ((u64)x25 * x5)); -+ { u64 x42 = ((((u64)(0x2 * x25) * x7) + ((u64)x23 * x9)) + ((u64)x27 * x5)); -+ { u64 x43 = (((((u64)x25 * x9) + ((u64)x27 * x7)) + ((u64)x23 * x11)) + ((u64)x29 * x5)); -+ { u64 x44 = (((((u64)x27 * x9) + (0x2 * (((u64)x25 * x11) + ((u64)x29 * x7)))) + ((u64)x23 * x13)) + ((u64)x31 * x5)); -+ { u64 x45 = (((((((u64)x27 * x11) + ((u64)x29 * x9)) + ((u64)x25 * x13)) + ((u64)x31 * x7)) + ((u64)x23 * x15)) + ((u64)x33 * x5)); -+ { u64 x46 = (((((0x2 * ((((u64)x29 * x11) + ((u64)x25 * x15)) + ((u64)x33 * x7))) + ((u64)x27 * x13)) + ((u64)x31 * x9)) + ((u64)x23 * x17)) + ((u64)x35 * x5)); -+ { u64 x47 = (((((((((u64)x29 * x13) + ((u64)x31 * x11)) + ((u64)x27 * x15)) + ((u64)x33 * x9)) + ((u64)x25 * x17)) + ((u64)x35 * x7)) + ((u64)x23 * x19)) + ((u64)x37 * x5)); -+ { u64 x48 = (((((((u64)x31 * x13) + (0x2 * (((((u64)x29 * x15) + ((u64)x33 * x11)) + ((u64)x25 * x19)) + ((u64)x37 * x7)))) + ((u64)x27 * x17)) + ((u64)x35 * x9)) + ((u64)x23 * x21)) + ((u64)x39 * x5)); -+ { u64 x49 = (((((((((((u64)x31 * x15) + ((u64)x33 * x13)) + ((u64)x29 * x17)) + ((u64)x35 * x11)) + ((u64)x27 * x19)) + ((u64)x37 * x9)) + ((u64)x25 * x21)) + ((u64)x39 * x7)) + ((u64)x23 * x20)) + ((u64)x38 * x5)); -+ { u64 x50 = (((((0x2 * ((((((u64)x33 * x15) + ((u64)x29 * x19)) + ((u64)x37 * x11)) + ((u64)x25 * x20)) + ((u64)x38 * x7))) + ((u64)x31 * x17)) + ((u64)x35 * x13)) + ((u64)x27 * x21)) + ((u64)x39 * x9)); -+ { u64 x51 = (((((((((u64)x33 * x17) + ((u64)x35 * x15)) + ((u64)x31 * x19)) + ((u64)x37 * x13)) + ((u64)x29 * x21)) + ((u64)x39 * x11)) + ((u64)x27 * x20)) + ((u64)x38 * x9)); -+ { u64 x52 = (((((u64)x35 * x17) + (0x2 * (((((u64)x33 * x19) + ((u64)x37 * x15)) + ((u64)x29 * x20)) + ((u64)x38 * x11)))) + ((u64)x31 * x21)) + ((u64)x39 * x13)); -+ { u64 x53 = (((((((u64)x35 * x19) + ((u64)x37 * x17)) + ((u64)x33 * x21)) + ((u64)x39 * x15)) + ((u64)x31 * x20)) + ((u64)x38 * x13)); -+ { u64 x54 = (((0x2 * ((((u64)x37 * x19) + ((u64)x33 * x20)) + ((u64)x38 * x15))) + ((u64)x35 * x21)) + ((u64)x39 * x17)); -+ { u64 x55 = (((((u64)x37 * x21) + ((u64)x39 * x19)) + ((u64)x35 * x20)) + ((u64)x38 * x17)); -+ { u64 x56 = (((u64)x39 * x21) + (0x2 * (((u64)x37 * x20) + ((u64)x38 * x19)))); -+ { u64 x57 = (((u64)x39 * x20) + ((u64)x38 * x21)); -+ { u64 x58 = ((u64)(0x2 * x38) * x20); -+ { u64 x59 = (x48 + (x58 << 0x4)); -+ { u64 x60 = (x59 + (x58 << 0x1)); -+ { u64 x61 = (x60 + x58); -+ { u64 x62 = (x47 + (x57 << 0x4)); -+ { u64 x63 = (x62 + (x57 << 0x1)); -+ { u64 x64 = (x63 + x57); -+ { u64 x65 = (x46 + (x56 << 0x4)); -+ { u64 x66 = (x65 + (x56 << 0x1)); -+ { u64 x67 = (x66 + x56); -+ { u64 x68 = (x45 + (x55 << 0x4)); -+ { u64 x69 = (x68 + (x55 << 0x1)); -+ { u64 x70 = (x69 + x55); -+ { u64 x71 = (x44 + (x54 << 0x4)); -+ { u64 x72 = (x71 + (x54 << 0x1)); -+ { u64 x73 = (x72 + x54); -+ { u64 x74 = (x43 + (x53 << 0x4)); -+ { u64 x75 = (x74 + (x53 << 0x1)); -+ { u64 x76 = (x75 + x53); -+ { u64 x77 = (x42 + (x52 << 0x4)); -+ { u64 x78 = (x77 + (x52 << 0x1)); -+ { u64 x79 = (x78 + x52); -+ { u64 x80 = (x41 + (x51 << 0x4)); -+ { u64 x81 = (x80 + (x51 << 0x1)); -+ { u64 x82 = (x81 + x51); -+ { u64 x83 = (x40 + (x50 << 0x4)); -+ { u64 x84 = (x83 + (x50 << 0x1)); -+ { u64 x85 = (x84 + x50); -+ { u64 x86 = (x85 >> 0x1a); -+ { u32 x87 = ((u32)x85 & 0x3ffffff); -+ { u64 x88 = (x86 + x82); -+ { u64 x89 = (x88 >> 0x19); -+ { u32 x90 = ((u32)x88 & 0x1ffffff); -+ { u64 x91 = (x89 + x79); -+ { u64 x92 = (x91 >> 0x1a); -+ { u32 x93 = ((u32)x91 & 0x3ffffff); -+ { u64 x94 = (x92 + x76); -+ { u64 x95 = (x94 >> 0x19); -+ { u32 x96 = ((u32)x94 & 0x1ffffff); -+ { u64 x97 = (x95 + x73); -+ { u64 x98 = (x97 >> 0x1a); -+ { u32 x99 = ((u32)x97 & 0x3ffffff); -+ { u64 x100 = (x98 + x70); -+ { u64 x101 = (x100 >> 0x19); -+ { u32 x102 = ((u32)x100 & 0x1ffffff); -+ { u64 x103 = (x101 + x67); -+ { u64 x104 = (x103 >> 0x1a); -+ { u32 x105 = ((u32)x103 & 0x3ffffff); -+ { u64 x106 = (x104 + x64); -+ { u64 x107 = (x106 >> 0x19); -+ { u32 x108 = ((u32)x106 & 0x1ffffff); -+ { u64 x109 = (x107 + x61); -+ { u64 x110 = (x109 >> 0x1a); -+ { u32 x111 = ((u32)x109 & 0x3ffffff); -+ { u64 x112 = (x110 + x49); -+ { u64 x113 = (x112 >> 0x19); -+ { u32 x114 = ((u32)x112 & 0x1ffffff); -+ { u64 x115 = (x87 + (0x13 * x113)); -+ { u32 x116 = (u32) (x115 >> 0x1a); -+ { u32 x117 = ((u32)x115 & 0x3ffffff); -+ { u32 x118 = (x116 + x90); -+ { u32 x119 = (x118 >> 0x19); -+ { u32 x120 = (x118 & 0x1ffffff); -+ out[0] = x117; -+ out[1] = x120; -+ out[2] = (x119 + x93); -+ out[3] = x96; -+ out[4] = x99; -+ out[5] = x102; -+ out[6] = x105; -+ out[7] = x108; -+ out[8] = x111; -+ out[9] = x114; -+ }}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}}} -+} -+ -+static __always_inline void fe_mul121666(fe *h, const fe_loose *f) -+{ -+ fe_mul_121666_impl(h->v, f->v); -+} -+ -+static void curve25519_generic(u8 out[CURVE25519_POINT_SIZE], const u8 scalar[CURVE25519_POINT_SIZE], const u8 point[CURVE25519_POINT_SIZE]) -+{ -+ fe x1, x2, z2, x3, z3, tmp0, tmp1; -+ fe_loose x2l, z2l, x3l, tmp0l, tmp1l; -+ unsigned swap = 0; -+ int pos; -+ u8 e[32]; -+ -+ memcpy(e, scalar, 32); -+ normalize_secret(e); -+ -+ /* The following implementation was transcribed to Coq and proven to -+ * correspond to unary scalar multiplication in affine coordinates given that -+ * x1 != 0 is the x coordinate of some point on the curve. It was also checked -+ * in Coq that doing a ladderstep with x1 = x3 = 0 gives z2' = z3' = 0, and z2 -+ * = z3 = 0 gives z2' = z3' = 0. The statement was quantified over the -+ * underlying field, so it applies to Curve25519 itself and the quadratic -+ * twist of Curve25519. It was not proven in Coq that prime-field arithmetic -+ * correctly simulates extension-field arithmetic on prime-field values. -+ * The decoding of the byte array representation of e was not considered. -+ * Specification of Montgomery curves in affine coordinates: -+ * -+ * Proof that these form a group that is isomorphic to a Weierstrass curve: -+ * -+ * Coq transcription and correctness proof of the loop (where scalarbits=255): -+ * -+ * -+ * preconditions: 0 <= e < 2^255 (not necessarily e < order), fe_invert(0) = 0 -+ */ -+ fe_frombytes(&x1, point); -+ fe_1(&x2); -+ fe_0(&z2); -+ fe_copy(&x3, &x1); -+ fe_1(&z3); -+ -+ for (pos = 254; pos >= 0; --pos) { -+ /* loop invariant as of right before the test, for the case where x1 != 0: -+ * pos >= -1; if z2 = 0 then x2 is nonzero; if z3 = 0 then x3 is nonzero -+ * let r := e >> (pos+1) in the following equalities of projective points: -+ * to_xz (r*P) === if swap then (x3, z3) else (x2, z2) -+ * to_xz ((r+1)*P) === if swap then (x2, z2) else (x3, z3) -+ * x1 is the nonzero x coordinate of the nonzero point (r*P-(r+1)*P) -+ */ -+ unsigned b = 1 & (e[pos / 8] >> (pos & 7)); -+ swap ^= b; -+ fe_cswap(&x2, &x3, swap); -+ fe_cswap(&z2, &z3, swap); -+ swap = b; -+ /* Coq transcription of ladderstep formula (called from transcribed loop): -+ * -+ * -+ * x1 != 0 -+ * x1 = 0 -+ */ -+ fe_sub(&tmp0l, &x3, &z3); -+ fe_sub(&tmp1l, &x2, &z2); -+ fe_add(&x2l, &x2, &z2); -+ fe_add(&z2l, &x3, &z3); -+ fe_mul_tll(&z3, &tmp0l, &x2l); -+ fe_mul_tll(&z2, &z2l, &tmp1l); -+ fe_sq_tl(&tmp0, &tmp1l); -+ fe_sq_tl(&tmp1, &x2l); -+ fe_add(&x3l, &z3, &z2); -+ fe_sub(&z2l, &z3, &z2); -+ fe_mul_ttt(&x2, &tmp1, &tmp0); -+ fe_sub(&tmp1l, &tmp1, &tmp0); -+ fe_sq_tl(&z2, &z2l); -+ fe_mul121666(&z3, &tmp1l); -+ fe_sq_tl(&x3, &x3l); -+ fe_add(&tmp0l, &tmp0, &z3); -+ fe_mul_ttt(&z3, &x1, &z2); -+ fe_mul_tll(&z2, &tmp1l, &tmp0l); -+ } -+ /* here pos=-1, so r=e, so to_xz (e*P) === if swap then (x3, z3) else (x2, z2) */ -+ fe_cswap(&x2, &x3, swap); -+ fe_cswap(&z2, &z3, swap); -+ -+ fe_invert(&z2, &z2); -+ fe_mul_ttt(&x2, &x2, &z2); -+ fe_tobytes(out, &x2); -+ -+ memzero_explicit(&x1, sizeof(x1)); -+ memzero_explicit(&x2, sizeof(x2)); -+ memzero_explicit(&z2, sizeof(z2)); -+ memzero_explicit(&x3, sizeof(x3)); -+ memzero_explicit(&z3, sizeof(z3)); -+ memzero_explicit(&tmp0, sizeof(tmp0)); -+ memzero_explicit(&tmp1, sizeof(tmp1)); -+ memzero_explicit(&x2l, sizeof(x2l)); -+ memzero_explicit(&z2l, sizeof(z2l)); -+ memzero_explicit(&x3l, sizeof(x3l)); -+ memzero_explicit(&tmp0l, sizeof(tmp0l)); -+ memzero_explicit(&tmp1l, sizeof(tmp1l)); -+ memzero_explicit(&e, sizeof(e)); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/curve25519.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,25 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_CURVE25519_H -+#define _WG_CURVE25519_H -+ -+#include -+ -+enum curve25519_lengths { -+ CURVE25519_POINT_SIZE = 32 -+}; -+ -+bool __must_check curve25519(u8 mypublic[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE], const u8 basepoint[CURVE25519_POINT_SIZE]); -+void curve25519_generate_secret(u8 secret[CURVE25519_POINT_SIZE]); -+bool __must_check curve25519_generate_public(u8 pub[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE]); -+ -+void curve25519_fpu_init(void); -+ -+#ifdef DEBUG -+bool curve25519_selftest(void); -+#endif -+ -+#endif /* _WG_CURVE25519_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/curve25519-hacl64.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,751 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2016-2017 INRIA and Microsoft Corporation. -+ * Copyright (C) 2018 Jason A. Donenfeld . All Rights Reserved. -+ * -+ * This is a machine-generated formally verified implementation of curve25519 DH from: -+ * https://github.com/mitls/hacl-star -+ */ -+ -+typedef __uint128_t u128; -+static __always_inline u64 u64_eq_mask(u64 x, u64 y) -+{ -+ x = ~(x ^ y); -+ x &= x << 32; -+ x &= x << 16; -+ x &= x << 8; -+ x &= x << 4; -+ x &= x << 2; -+ x &= x << 1; -+ return ((s64)x) >> 63; -+} -+ -+static __always_inline u64 u64_gte_mask(u64 x, u64 y) -+{ -+ u64 low63 = ~((u64)((s64)((s64)(x & 0x7fffffffffffffffLLU) - (s64)(y & 0x7fffffffffffffffLLU)) >> 63)); -+ u64 high_bit = ~((u64)((s64)((s64)(x & 0x8000000000000000LLU) - (s64)(y & 0x8000000000000000LLU)) >> 63)); -+ return low63 & high_bit; -+} -+ -+static __always_inline void modulo_carry_top(u64 *b) -+{ -+ u64 b4 = b[4]; -+ u64 b0 = b[0]; -+ u64 b4_ = b4 & 0x7ffffffffffffLLU; -+ u64 b0_ = b0 + 19 * (b4 >> 51); -+ b[4] = b4_; -+ b[0] = b0_; -+} -+ -+static __always_inline void fproduct_copy_from_wide_(u64 *output, u128 *input) -+{ -+ { -+ u128 xi = input[0]; -+ output[0] = ((u64)(xi)); -+ } -+ { -+ u128 xi = input[1]; -+ output[1] = ((u64)(xi)); -+ } -+ { -+ u128 xi = input[2]; -+ output[2] = ((u64)(xi)); -+ } -+ { -+ u128 xi = input[3]; -+ output[3] = ((u64)(xi)); -+ } -+ { -+ u128 xi = input[4]; -+ output[4] = ((u64)(xi)); -+ } -+} -+ -+static __always_inline void fproduct_sum_scalar_multiplication_(u128 *output, u64 *input, u64 s) -+{ -+ output[0] += (u128)input[0] * s; -+ output[1] += (u128)input[1] * s; -+ output[2] += (u128)input[2] * s; -+ output[3] += (u128)input[3] * s; -+ output[4] += (u128)input[4] * s; -+} -+ -+static __always_inline void fproduct_carry_wide_(u128 *tmp) -+{ -+ { -+ u32 ctr = 0; -+ u128 tctr = tmp[ctr]; -+ u128 tctrp1 = tmp[ctr + 1]; -+ u64 r0 = ((u64)(tctr)) & 0x7ffffffffffffLLU; -+ u128 c = ((tctr) >> (51)); -+ tmp[ctr] = ((u128)(r0)); -+ tmp[ctr + 1] = ((tctrp1) + (c)); -+ } -+ { -+ u32 ctr = 1; -+ u128 tctr = tmp[ctr]; -+ u128 tctrp1 = tmp[ctr + 1]; -+ u64 r0 = ((u64)(tctr)) & 0x7ffffffffffffLLU; -+ u128 c = ((tctr) >> (51)); -+ tmp[ctr] = ((u128)(r0)); -+ tmp[ctr + 1] = ((tctrp1) + (c)); -+ } -+ -+ { -+ u32 ctr = 2; -+ u128 tctr = tmp[ctr]; -+ u128 tctrp1 = tmp[ctr + 1]; -+ u64 r0 = ((u64)(tctr)) & 0x7ffffffffffffLLU; -+ u128 c = ((tctr) >> (51)); -+ tmp[ctr] = ((u128)(r0)); -+ tmp[ctr + 1] = ((tctrp1) + (c)); -+ } -+ { -+ u32 ctr = 3; -+ u128 tctr = tmp[ctr]; -+ u128 tctrp1 = tmp[ctr + 1]; -+ u64 r0 = ((u64)(tctr)) & 0x7ffffffffffffLLU; -+ u128 c = ((tctr) >> (51)); -+ tmp[ctr] = ((u128)(r0)); -+ tmp[ctr + 1] = ((tctrp1) + (c)); -+ } -+} -+ -+static __always_inline void fmul_shift_reduce(u64 *output) -+{ -+ u64 tmp = output[4]; -+ u64 b0; -+ { -+ u32 ctr = 5 - 0 - 1; -+ u64 z = output[ctr - 1]; -+ output[ctr] = z; -+ } -+ { -+ u32 ctr = 5 - 1 - 1; -+ u64 z = output[ctr - 1]; -+ output[ctr] = z; -+ } -+ { -+ u32 ctr = 5 - 2 - 1; -+ u64 z = output[ctr - 1]; -+ output[ctr] = z; -+ } -+ { -+ u32 ctr = 5 - 3 - 1; -+ u64 z = output[ctr - 1]; -+ output[ctr] = z; -+ } -+ output[0] = tmp; -+ b0 = output[0]; -+ output[0] = 19 * b0; -+} -+ -+static __always_inline void fmul_mul_shift_reduce_(u128 *output, u64 *input, u64 *input21) -+{ -+ u32 i; -+ u64 input2i; -+ { -+ u64 input2i = input21[0]; -+ fproduct_sum_scalar_multiplication_(output, input, input2i); -+ fmul_shift_reduce(input); -+ } -+ { -+ u64 input2i = input21[1]; -+ fproduct_sum_scalar_multiplication_(output, input, input2i); -+ fmul_shift_reduce(input); -+ } -+ { -+ u64 input2i = input21[2]; -+ fproduct_sum_scalar_multiplication_(output, input, input2i); -+ fmul_shift_reduce(input); -+ } -+ { -+ u64 input2i = input21[3]; -+ fproduct_sum_scalar_multiplication_(output, input, input2i); -+ fmul_shift_reduce(input); -+ } -+ i = 4; -+ input2i = input21[i]; -+ fproduct_sum_scalar_multiplication_(output, input, input2i); -+} -+ -+static __always_inline void fmul_fmul(u64 *output, u64 *input, u64 *input21) -+{ -+ u64 tmp[5]; -+ memcpy(tmp, input, 5 * sizeof(*input)); -+ { -+ u128 b4; -+ u128 b0; -+ u128 b4_; -+ u128 b0_; -+ u64 i0; -+ u64 i1; -+ u64 i0_; -+ u64 i1_; -+ u128 t[5] = { 0 }; -+ fmul_mul_shift_reduce_(t, tmp, input21); -+ fproduct_carry_wide_(t); -+ b4 = t[4]; -+ b0 = t[0]; -+ b4_ = ((b4) & (((u128)(0x7ffffffffffffLLU)))); -+ b0_ = ((b0) + (((u128)(19) * (((u64)(((b4) >> (51)))))))); -+ t[4] = b4_; -+ t[0] = b0_; -+ fproduct_copy_from_wide_(output, t); -+ i0 = output[0]; -+ i1 = output[1]; -+ i0_ = i0 & 0x7ffffffffffffLLU; -+ i1_ = i1 + (i0 >> 51); -+ output[0] = i0_; -+ output[1] = i1_; -+ } -+} -+ -+static __always_inline void fsquare_fsquare__(u128 *tmp, u64 *output) -+{ -+ u64 r0 = output[0]; -+ u64 r1 = output[1]; -+ u64 r2 = output[2]; -+ u64 r3 = output[3]; -+ u64 r4 = output[4]; -+ u64 d0 = r0 * 2; -+ u64 d1 = r1 * 2; -+ u64 d2 = r2 * 2 * 19; -+ u64 d419 = r4 * 19; -+ u64 d4 = d419 * 2; -+ u128 s0 = ((((((u128)(r0) * (r0))) + (((u128)(d4) * (r1))))) + (((u128)(d2) * (r3)))); -+ u128 s1 = ((((((u128)(d0) * (r1))) + (((u128)(d4) * (r2))))) + (((u128)(r3 * 19) * (r3)))); -+ u128 s2 = ((((((u128)(d0) * (r2))) + (((u128)(r1) * (r1))))) + (((u128)(d4) * (r3)))); -+ u128 s3 = ((((((u128)(d0) * (r3))) + (((u128)(d1) * (r2))))) + (((u128)(r4) * (d419)))); -+ u128 s4 = ((((((u128)(d0) * (r4))) + (((u128)(d1) * (r3))))) + (((u128)(r2) * (r2)))); -+ tmp[0] = s0; -+ tmp[1] = s1; -+ tmp[2] = s2; -+ tmp[3] = s3; -+ tmp[4] = s4; -+} -+ -+static __always_inline void fsquare_fsquare_(u128 *tmp, u64 *output) -+{ -+ u128 b4; -+ u128 b0; -+ u128 b4_; -+ u128 b0_; -+ u64 i0; -+ u64 i1; -+ u64 i0_; -+ u64 i1_; -+ fsquare_fsquare__(tmp, output); -+ fproduct_carry_wide_(tmp); -+ b4 = tmp[4]; -+ b0 = tmp[0]; -+ b4_ = ((b4) & (((u128)(0x7ffffffffffffLLU)))); -+ b0_ = ((b0) + (((u128)(19) * (((u64)(((b4) >> (51)))))))); -+ tmp[4] = b4_; -+ tmp[0] = b0_; -+ fproduct_copy_from_wide_(output, tmp); -+ i0 = output[0]; -+ i1 = output[1]; -+ i0_ = i0 & 0x7ffffffffffffLLU; -+ i1_ = i1 + (i0 >> 51); -+ output[0] = i0_; -+ output[1] = i1_; -+} -+ -+static __always_inline void fsquare_fsquare_times_(u64 *output, u128 *tmp, u32 count1) -+{ -+ u32 i; -+ fsquare_fsquare_(tmp, output); -+ for (i = 1; i < count1; ++i) -+ fsquare_fsquare_(tmp, output); -+} -+ -+static __always_inline void fsquare_fsquare_times(u64 *output, u64 *input, u32 count1) -+{ -+ u128 t[5]; -+ memcpy(output, input, 5 * sizeof(*input)); -+ fsquare_fsquare_times_(output, t, count1); -+} -+ -+static __always_inline void fsquare_fsquare_times_inplace(u64 *output, u32 count1) -+{ -+ u128 t[5]; -+ fsquare_fsquare_times_(output, t, count1); -+} -+ -+static __always_inline void crecip_crecip(u64 *out, u64 *z) -+{ -+ u64 buf[20] = { 0 }; -+ u64 *a0 = buf; -+ u64 *t00 = buf + 5; -+ u64 *b0 = buf + 10; -+ u64 *t01; -+ u64 *b1; -+ u64 *c0; -+ u64 *a; -+ u64 *t0; -+ u64 *b; -+ u64 *c; -+ fsquare_fsquare_times(a0, z, 1); -+ fsquare_fsquare_times(t00, a0, 2); -+ fmul_fmul(b0, t00, z); -+ fmul_fmul(a0, b0, a0); -+ fsquare_fsquare_times(t00, a0, 1); -+ fmul_fmul(b0, t00, b0); -+ fsquare_fsquare_times(t00, b0, 5); -+ t01 = buf + 5; -+ b1 = buf + 10; -+ c0 = buf + 15; -+ fmul_fmul(b1, t01, b1); -+ fsquare_fsquare_times(t01, b1, 10); -+ fmul_fmul(c0, t01, b1); -+ fsquare_fsquare_times(t01, c0, 20); -+ fmul_fmul(t01, t01, c0); -+ fsquare_fsquare_times_inplace(t01, 10); -+ fmul_fmul(b1, t01, b1); -+ fsquare_fsquare_times(t01, b1, 50); -+ a = buf; -+ t0 = buf + 5; -+ b = buf + 10; -+ c = buf + 15; -+ fmul_fmul(c, t0, b); -+ fsquare_fsquare_times(t0, c, 100); -+ fmul_fmul(t0, t0, c); -+ fsquare_fsquare_times_inplace(t0, 50); -+ fmul_fmul(t0, t0, b); -+ fsquare_fsquare_times_inplace(t0, 5); -+ fmul_fmul(out, t0, a); -+} -+ -+static __always_inline void fsum(u64 *a, u64 *b) -+{ -+ a[0] += b[0]; -+ a[1] += b[1]; -+ a[2] += b[2]; -+ a[3] += b[3]; -+ a[4] += b[4]; -+} -+ -+static __always_inline void fdifference(u64 *a, u64 *b) -+{ -+ u64 tmp[5] = { 0 }; -+ u64 b0; -+ u64 b1; -+ u64 b2; -+ u64 b3; -+ u64 b4; -+ memcpy(tmp, b, 5 * sizeof(*b)); -+ b0 = tmp[0]; -+ b1 = tmp[1]; -+ b2 = tmp[2]; -+ b3 = tmp[3]; -+ b4 = tmp[4]; -+ tmp[0] = b0 + 0x3fffffffffff68LLU; -+ tmp[1] = b1 + 0x3ffffffffffff8LLU; -+ tmp[2] = b2 + 0x3ffffffffffff8LLU; -+ tmp[3] = b3 + 0x3ffffffffffff8LLU; -+ tmp[4] = b4 + 0x3ffffffffffff8LLU; -+ { -+ u64 xi = a[0]; -+ u64 yi = tmp[0]; -+ a[0] = yi - xi; -+ } -+ { -+ u64 xi = a[1]; -+ u64 yi = tmp[1]; -+ a[1] = yi - xi; -+ } -+ { -+ u64 xi = a[2]; -+ u64 yi = tmp[2]; -+ a[2] = yi - xi; -+ } -+ { -+ u64 xi = a[3]; -+ u64 yi = tmp[3]; -+ a[3] = yi - xi; -+ } -+ { -+ u64 xi = a[4]; -+ u64 yi = tmp[4]; -+ a[4] = yi - xi; -+ } -+} -+ -+static __always_inline void fscalar(u64 *output, u64 *b, u64 s) -+{ -+ u128 tmp[5]; -+ u128 b4; -+ u128 b0; -+ u128 b4_; -+ u128 b0_; -+ { -+ u64 xi = b[0]; -+ tmp[0] = ((u128)(xi) * (s)); -+ } -+ { -+ u64 xi = b[1]; -+ tmp[1] = ((u128)(xi) * (s)); -+ } -+ { -+ u64 xi = b[2]; -+ tmp[2] = ((u128)(xi) * (s)); -+ } -+ { -+ u64 xi = b[3]; -+ tmp[3] = ((u128)(xi) * (s)); -+ } -+ { -+ u64 xi = b[4]; -+ tmp[4] = ((u128)(xi) * (s)); -+ } -+ fproduct_carry_wide_(tmp); -+ b4 = tmp[4]; -+ b0 = tmp[0]; -+ b4_ = ((b4) & (((u128)(0x7ffffffffffffLLU)))); -+ b0_ = ((b0) + (((u128)(19) * (((u64)(((b4) >> (51)))))))); -+ tmp[4] = b4_; -+ tmp[0] = b0_; -+ fproduct_copy_from_wide_(output, tmp); -+} -+ -+static __always_inline void fmul(u64 *output, u64 *a, u64 *b) -+{ -+ fmul_fmul(output, a, b); -+} -+ -+static __always_inline void crecip(u64 *output, u64 *input) -+{ -+ crecip_crecip(output, input); -+} -+ -+static __always_inline void point_swap_conditional_step(u64 *a, u64 *b, u64 swap1, u32 ctr) -+{ -+ u32 i = ctr - 1; -+ u64 ai = a[i]; -+ u64 bi = b[i]; -+ u64 x = swap1 & (ai ^ bi); -+ u64 ai1 = ai ^ x; -+ u64 bi1 = bi ^ x; -+ a[i] = ai1; -+ b[i] = bi1; -+} -+ -+static __always_inline void point_swap_conditional5(u64 *a, u64 *b, u64 swap1) -+{ -+ point_swap_conditional_step(a, b, swap1, 5); -+ point_swap_conditional_step(a, b, swap1, 4); -+ point_swap_conditional_step(a, b, swap1, 3); -+ point_swap_conditional_step(a, b, swap1, 2); -+ point_swap_conditional_step(a, b, swap1, 1); -+} -+ -+static __always_inline void point_swap_conditional(u64 *a, u64 *b, u64 iswap) -+{ -+ u64 swap1 = 0 - iswap; -+ point_swap_conditional5(a, b, swap1); -+ point_swap_conditional5(a + 5, b + 5, swap1); -+} -+ -+static __always_inline void point_copy(u64 *output, u64 *input) -+{ -+ memcpy(output, input, 5 * sizeof(*input)); -+ memcpy(output + 5, input + 5, 5 * sizeof(*input)); -+} -+ -+static __always_inline void addanddouble_fmonty(u64 *pp, u64 *ppq, u64 *p, u64 *pq, u64 *qmqp) -+{ -+ u64 *qx = qmqp; -+ u64 *x2 = pp; -+ u64 *z2 = pp + 5; -+ u64 *x3 = ppq; -+ u64 *z3 = ppq + 5; -+ u64 *x = p; -+ u64 *z = p + 5; -+ u64 *xprime = pq; -+ u64 *zprime = pq + 5; -+ u64 buf[40] = { 0 }; -+ u64 *origx = buf; -+ u64 *origxprime0 = buf + 5; -+ u64 *xxprime0; -+ u64 *zzprime0; -+ u64 *origxprime; -+ xxprime0 = buf + 25; -+ zzprime0 = buf + 30; -+ memcpy(origx, x, 5 * sizeof(*x)); -+ fsum(x, z); -+ fdifference(z, origx); -+ memcpy(origxprime0, xprime, 5 * sizeof(*xprime)); -+ fsum(xprime, zprime); -+ fdifference(zprime, origxprime0); -+ fmul(xxprime0, xprime, z); -+ fmul(zzprime0, x, zprime); -+ origxprime = buf + 5; -+ { -+ u64 *xx0; -+ u64 *zz0; -+ u64 *xxprime; -+ u64 *zzprime; -+ u64 *zzzprime; -+ xx0 = buf + 15; -+ zz0 = buf + 20; -+ xxprime = buf + 25; -+ zzprime = buf + 30; -+ zzzprime = buf + 35; -+ memcpy(origxprime, xxprime, 5 * sizeof(*xxprime)); -+ fsum(xxprime, zzprime); -+ fdifference(zzprime, origxprime); -+ fsquare_fsquare_times(x3, xxprime, 1); -+ fsquare_fsquare_times(zzzprime, zzprime, 1); -+ fmul(z3, zzzprime, qx); -+ fsquare_fsquare_times(xx0, x, 1); -+ fsquare_fsquare_times(zz0, z, 1); -+ { -+ u64 *zzz; -+ u64 *xx; -+ u64 *zz; -+ u64 scalar; -+ zzz = buf + 10; -+ xx = buf + 15; -+ zz = buf + 20; -+ fmul(x2, xx, zz); -+ fdifference(zz, xx); -+ scalar = 121665; -+ fscalar(zzz, zz, scalar); -+ fsum(zzz, xx); -+ fmul(z2, zzz, zz); -+ } -+ } -+} -+ -+static __always_inline void ladder_smallloop_cmult_small_loop_step(u64 *nq, u64 *nqpq, u64 *nq2, u64 *nqpq2, u64 *q, u8 byt) -+{ -+ u64 bit0 = (u64)(byt >> 7); -+ u64 bit; -+ point_swap_conditional(nq, nqpq, bit0); -+ addanddouble_fmonty(nq2, nqpq2, nq, nqpq, q); -+ bit = (u64)(byt >> 7); -+ point_swap_conditional(nq2, nqpq2, bit); -+} -+ -+static __always_inline void ladder_smallloop_cmult_small_loop_double_step(u64 *nq, u64 *nqpq, u64 *nq2, u64 *nqpq2, u64 *q, u8 byt) -+{ -+ u8 byt1; -+ ladder_smallloop_cmult_small_loop_step(nq, nqpq, nq2, nqpq2, q, byt); -+ byt1 = byt << 1; -+ ladder_smallloop_cmult_small_loop_step(nq2, nqpq2, nq, nqpq, q, byt1); -+} -+ -+static __always_inline void ladder_smallloop_cmult_small_loop(u64 *nq, u64 *nqpq, u64 *nq2, u64 *nqpq2, u64 *q, u8 byt, u32 i) -+{ -+ while (i--) { -+ ladder_smallloop_cmult_small_loop_double_step(nq, nqpq, nq2, nqpq2, q, byt); -+ byt <<= 2; -+ } -+} -+ -+static __always_inline void ladder_bigloop_cmult_big_loop(u8 *n1, u64 *nq, u64 *nqpq, u64 *nq2, u64 *nqpq2, u64 *q, u32 i) -+{ -+ while (i--) { -+ u8 byte = n1[i]; -+ ladder_smallloop_cmult_small_loop(nq, nqpq, nq2, nqpq2, q, byte, 4); -+ } -+} -+ -+static __always_inline void ladder_cmult(u64 *result, u8 *n1, u64 *q) -+{ -+ u64 point_buf[40] = { 0 }; -+ u64 *nq = point_buf; -+ u64 *nqpq = point_buf + 10; -+ u64 *nq2 = point_buf + 20; -+ u64 *nqpq2 = point_buf + 30; -+ point_copy(nqpq, q); -+ nq[0] = 1; -+ ladder_bigloop_cmult_big_loop(n1, nq, nqpq, nq2, nqpq2, q, 32); -+ point_copy(result, nq); -+} -+ -+static __always_inline void format_fexpand(u64 *output, const u8 *input) -+{ -+ const u8 *x00 = input + 6; -+ const u8 *x01 = input + 12; -+ const u8 *x02 = input + 19; -+ const u8 *x0 = input + 24; -+ u64 i0, i1, i2, i3, i4, output0, output1, output2, output3, output4; -+ i0 = le64_to_cpup((__force __le64 *)input); -+ i1 = le64_to_cpup((__force __le64 *)x00); -+ i2 = le64_to_cpup((__force __le64 *)x01); -+ i3 = le64_to_cpup((__force __le64 *)x02); -+ i4 = le64_to_cpup((__force __le64 *)x0); -+ output0 = i0 & 0x7ffffffffffffLLU; -+ output1 = i1 >> 3 & 0x7ffffffffffffLLU; -+ output2 = i2 >> 6 & 0x7ffffffffffffLLU; -+ output3 = i3 >> 1 & 0x7ffffffffffffLLU; -+ output4 = i4 >> 12 & 0x7ffffffffffffLLU; -+ output[0] = output0; -+ output[1] = output1; -+ output[2] = output2; -+ output[3] = output3; -+ output[4] = output4; -+} -+ -+static __always_inline void format_fcontract_first_carry_pass(u64 *input) -+{ -+ u64 t0 = input[0]; -+ u64 t1 = input[1]; -+ u64 t2 = input[2]; -+ u64 t3 = input[3]; -+ u64 t4 = input[4]; -+ u64 t1_ = t1 + (t0 >> 51); -+ u64 t0_ = t0 & 0x7ffffffffffffLLU; -+ u64 t2_ = t2 + (t1_ >> 51); -+ u64 t1__ = t1_ & 0x7ffffffffffffLLU; -+ u64 t3_ = t3 + (t2_ >> 51); -+ u64 t2__ = t2_ & 0x7ffffffffffffLLU; -+ u64 t4_ = t4 + (t3_ >> 51); -+ u64 t3__ = t3_ & 0x7ffffffffffffLLU; -+ input[0] = t0_; -+ input[1] = t1__; -+ input[2] = t2__; -+ input[3] = t3__; -+ input[4] = t4_; -+} -+ -+static __always_inline void format_fcontract_first_carry_full(u64 *input) -+{ -+ format_fcontract_first_carry_pass(input); -+ modulo_carry_top(input); -+} -+ -+static __always_inline void format_fcontract_second_carry_pass(u64 *input) -+{ -+ u64 t0 = input[0]; -+ u64 t1 = input[1]; -+ u64 t2 = input[2]; -+ u64 t3 = input[3]; -+ u64 t4 = input[4]; -+ u64 t1_ = t1 + (t0 >> 51); -+ u64 t0_ = t0 & 0x7ffffffffffffLLU; -+ u64 t2_ = t2 + (t1_ >> 51); -+ u64 t1__ = t1_ & 0x7ffffffffffffLLU; -+ u64 t3_ = t3 + (t2_ >> 51); -+ u64 t2__ = t2_ & 0x7ffffffffffffLLU; -+ u64 t4_ = t4 + (t3_ >> 51); -+ u64 t3__ = t3_ & 0x7ffffffffffffLLU; -+ input[0] = t0_; -+ input[1] = t1__; -+ input[2] = t2__; -+ input[3] = t3__; -+ input[4] = t4_; -+} -+ -+static __always_inline void format_fcontract_second_carry_full(u64 *input) -+{ -+ u64 i0; -+ u64 i1; -+ u64 i0_; -+ u64 i1_; -+ format_fcontract_second_carry_pass(input); -+ modulo_carry_top(input); -+ i0 = input[0]; -+ i1 = input[1]; -+ i0_ = i0 & 0x7ffffffffffffLLU; -+ i1_ = i1 + (i0 >> 51); -+ input[0] = i0_; -+ input[1] = i1_; -+} -+ -+static __always_inline void format_fcontract_trim(u64 *input) -+{ -+ u64 a0 = input[0]; -+ u64 a1 = input[1]; -+ u64 a2 = input[2]; -+ u64 a3 = input[3]; -+ u64 a4 = input[4]; -+ u64 mask0 = u64_gte_mask(a0, 0x7ffffffffffedLLU); -+ u64 mask1 = u64_eq_mask(a1, 0x7ffffffffffffLLU); -+ u64 mask2 = u64_eq_mask(a2, 0x7ffffffffffffLLU); -+ u64 mask3 = u64_eq_mask(a3, 0x7ffffffffffffLLU); -+ u64 mask4 = u64_eq_mask(a4, 0x7ffffffffffffLLU); -+ u64 mask = (((mask0 & mask1) & mask2) & mask3) & mask4; -+ u64 a0_ = a0 - (0x7ffffffffffedLLU & mask); -+ u64 a1_ = a1 - (0x7ffffffffffffLLU & mask); -+ u64 a2_ = a2 - (0x7ffffffffffffLLU & mask); -+ u64 a3_ = a3 - (0x7ffffffffffffLLU & mask); -+ u64 a4_ = a4 - (0x7ffffffffffffLLU & mask); -+ input[0] = a0_; -+ input[1] = a1_; -+ input[2] = a2_; -+ input[3] = a3_; -+ input[4] = a4_; -+} -+ -+static __always_inline void format_fcontract_store(u8 *output, u64 *input) -+{ -+ u64 t0 = input[0]; -+ u64 t1 = input[1]; -+ u64 t2 = input[2]; -+ u64 t3 = input[3]; -+ u64 t4 = input[4]; -+ u64 o0 = t1 << 51 | t0; -+ u64 o1 = t2 << 38 | t1 >> 13; -+ u64 o2 = t3 << 25 | t2 >> 26; -+ u64 o3 = t4 << 12 | t3 >> 39; -+ u8 *b0 = output; -+ u8 *b1 = output + 8; -+ u8 *b2 = output + 16; -+ u8 *b3 = output + 24; -+ *(__force __le64 *)b0 = cpu_to_le64(o0); -+ *(__force __le64 *)b1 = cpu_to_le64(o1); -+ *(__force __le64 *)b2 = cpu_to_le64(o2); -+ *(__force __le64 *)b3 = cpu_to_le64(o3); -+} -+ -+static __always_inline void format_fcontract(u8 *output, u64 *input) -+{ -+ format_fcontract_first_carry_full(input); -+ format_fcontract_second_carry_full(input); -+ format_fcontract_trim(input); -+ format_fcontract_store(output, input); -+} -+ -+static __always_inline void format_scalar_of_point(u8 *scalar, u64 *point) -+{ -+ u64 *x = point; -+ u64 *z = point + 5; -+ u64 buf[10] __aligned(32) = { 0 }; -+ u64 *zmone = buf; -+ u64 *sc = buf + 5; -+ crecip(zmone, z); -+ fmul(sc, x, zmone); -+ format_fcontract(scalar, sc); -+} -+ -+static void curve25519_generic(u8 mypublic[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE], const u8 basepoint[CURVE25519_POINT_SIZE]) -+{ -+ u64 buf0[10] __aligned(32) = { 0 }; -+ u64 *x0 = buf0; -+ u64 *z = buf0 + 5; -+ u64 *q; -+ format_fexpand(x0, basepoint); -+ z[0] = 1; -+ q = buf0; -+ { -+ u8 e[32] __aligned(32) = { 0 }; -+ u8 *scalar; -+ memcpy(e, secret, 32); -+ normalize_secret(e); -+ scalar = e; -+ { -+ u64 buf[15] = { 0 }; -+ u64 *nq = buf; -+ u64 *x = nq; -+ x[0] = 1; -+ ladder_cmult(nq, scalar, q); -+ format_scalar_of_point(mypublic, nq); -+ memzero_explicit(buf, sizeof(buf)); -+ } -+ memzero_explicit(e, sizeof(e)); -+ } -+ memzero_explicit(buf0, sizeof(buf0)); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/curve25519-x86_64.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,176 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * -+ * Based on algorithms from Tung Chou -+ */ -+ -+#include -+#include -+#include -+#include -+ -+static bool curve25519_use_avx __ro_after_init; -+void __init curve25519_fpu_init(void) -+{ -+#ifndef CONFIG_UML -+ curve25519_use_avx = boot_cpu_has(X86_FEATURE_AVX) && cpu_has_xfeatures(XFEATURE_MASK_SSE | XFEATURE_MASK_YMM, NULL); -+#endif -+} -+ -+typedef u64 fex[10]; -+typedef u64 fe51[5]; -+asmlinkage void curve25519_sandy2x_ladder(fex *, const u8 *); -+asmlinkage void curve25519_sandy2x_ladder_base(fex *, const u8 *); -+asmlinkage void curve25519_sandy2x_fe51_pack(u8 *, const fe51 *); -+asmlinkage void curve25519_sandy2x_fe51_mul(fe51 *, const fe51 *, const fe51 *); -+asmlinkage void curve25519_sandy2x_fe51_nsquare(fe51 *, const fe51 *, int); -+ -+static inline u32 le24_to_cpupv(const u8 *in) -+{ -+ return le16_to_cpup((__le16 *)in) | ((u32)in[2]) << 16; -+} -+ -+static inline void fex_frombytes(fex h, const u8 *s) -+{ -+ u64 h0 = le32_to_cpup((__le32 *)s); -+ u64 h1 = le24_to_cpupv(s + 4) << 6; -+ u64 h2 = le24_to_cpupv(s + 7) << 5; -+ u64 h3 = le24_to_cpupv(s + 10) << 3; -+ u64 h4 = le24_to_cpupv(s + 13) << 2; -+ u64 h5 = le32_to_cpup((__le32 *)(s + 16)); -+ u64 h6 = le24_to_cpupv(s + 20) << 7; -+ u64 h7 = le24_to_cpupv(s + 23) << 5; -+ u64 h8 = le24_to_cpupv(s + 26) << 4; -+ u64 h9 = (le24_to_cpupv(s + 29) & 8388607) << 2; -+ u64 carry0, carry1, carry2, carry3, carry4, carry5, carry6, carry7, carry8, carry9; -+ -+ carry9 = h9 >> 25; h0 += carry9 * 19; h9 &= 0x1FFFFFF; -+ carry1 = h1 >> 25; h2 += carry1; h1 &= 0x1FFFFFF; -+ carry3 = h3 >> 25; h4 += carry3; h3 &= 0x1FFFFFF; -+ carry5 = h5 >> 25; h6 += carry5; h5 &= 0x1FFFFFF; -+ carry7 = h7 >> 25; h8 += carry7; h7 &= 0x1FFFFFF; -+ -+ carry0 = h0 >> 26; h1 += carry0; h0 &= 0x3FFFFFF; -+ carry2 = h2 >> 26; h3 += carry2; h2 &= 0x3FFFFFF; -+ carry4 = h4 >> 26; h5 += carry4; h4 &= 0x3FFFFFF; -+ carry6 = h6 >> 26; h7 += carry6; h6 &= 0x3FFFFFF; -+ carry8 = h8 >> 26; h9 += carry8; h8 &= 0x3FFFFFF; -+ -+ h[0] = h0; -+ h[1] = h1; -+ h[2] = h2; -+ h[3] = h3; -+ h[4] = h4; -+ h[5] = h5; -+ h[6] = h6; -+ h[7] = h7; -+ h[8] = h8; -+ h[9] = h9; -+} -+ -+static inline void fe51_invert(fe51 *r, const fe51 *x) -+{ -+ fe51 z2, z9, z11, z2_5_0, z2_10_0, z2_20_0, z2_50_0, z2_100_0, t; -+ -+ /* 2 */ curve25519_sandy2x_fe51_nsquare(&z2, x, 1); -+ /* 4 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z2, 1); -+ /* 8 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&t, 1); -+ /* 9 */ curve25519_sandy2x_fe51_mul(&z9, (const fe51 *)&t, x); -+ /* 11 */ curve25519_sandy2x_fe51_mul(&z11, (const fe51 *)&z9, (const fe51 *)&z2); -+ /* 22 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z11, 1); -+ /* 2^5 - 2^0 = 31 */ curve25519_sandy2x_fe51_mul(&z2_5_0, (const fe51 *)&t, (const fe51 *)&z9); -+ -+ /* 2^10 - 2^5 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z2_5_0, 5); -+ /* 2^10 - 2^0 */ curve25519_sandy2x_fe51_mul(&z2_10_0, (const fe51 *)&t, (const fe51 *)&z2_5_0); -+ -+ /* 2^20 - 2^10 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z2_10_0, 10); -+ /* 2^20 - 2^0 */ curve25519_sandy2x_fe51_mul(&z2_20_0, (const fe51 *)&t, (const fe51 *)&z2_10_0); -+ -+ /* 2^40 - 2^20 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z2_20_0, 20); -+ /* 2^40 - 2^0 */ curve25519_sandy2x_fe51_mul(&t, (const fe51 *)&t, (const fe51 *)&z2_20_0); -+ -+ /* 2^50 - 2^10 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&t, 10); -+ /* 2^50 - 2^0 */ curve25519_sandy2x_fe51_mul(&z2_50_0, (const fe51 *)&t, (const fe51 *)&z2_10_0); -+ -+ /* 2^100 - 2^50 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z2_50_0, 50); -+ /* 2^100 - 2^0 */ curve25519_sandy2x_fe51_mul(&z2_100_0, (const fe51 *)&t, (const fe51 *)&z2_50_0); -+ -+ /* 2^200 - 2^100 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&z2_100_0, 100); -+ /* 2^200 - 2^0 */ curve25519_sandy2x_fe51_mul(&t, (const fe51 *)&t, (const fe51 *)&z2_100_0); -+ -+ /* 2^250 - 2^50 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&t, 50); -+ /* 2^250 - 2^0 */ curve25519_sandy2x_fe51_mul(&t, (const fe51 *)&t, (const fe51 *)&z2_50_0); -+ -+ /* 2^255 - 2^5 */ curve25519_sandy2x_fe51_nsquare(&t, (const fe51 *)&t, 5); -+ /* 2^255 - 21 */ curve25519_sandy2x_fe51_mul(r, (const fe51 *)t, (const fe51 *)&z11); -+} -+ -+static void curve25519_sandy2x(u8 mypublic[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE], const u8 basepoint[CURVE25519_POINT_SIZE]) -+{ -+ u8 e[32]; -+ fex var[3]; -+ fe51 x_51, z_51; -+ -+ memcpy(e, secret, 32); -+ normalize_secret(e); -+#define x1 var[0] -+#define x2 var[1] -+#define z2 var[2] -+ fex_frombytes(x1, basepoint); -+ curve25519_sandy2x_ladder(var, e); -+ z_51[0] = (z2[1] << 26) + z2[0]; -+ z_51[1] = (z2[3] << 26) + z2[2]; -+ z_51[2] = (z2[5] << 26) + z2[4]; -+ z_51[3] = (z2[7] << 26) + z2[6]; -+ z_51[4] = (z2[9] << 26) + z2[8]; -+ x_51[0] = (x2[1] << 26) + x2[0]; -+ x_51[1] = (x2[3] << 26) + x2[2]; -+ x_51[2] = (x2[5] << 26) + x2[4]; -+ x_51[3] = (x2[7] << 26) + x2[6]; -+ x_51[4] = (x2[9] << 26) + x2[8]; -+#undef x1 -+#undef x2 -+#undef z2 -+ fe51_invert(&z_51, (const fe51 *)&z_51); -+ curve25519_sandy2x_fe51_mul(&x_51, (const fe51 *)&x_51, (const fe51 *)&z_51); -+ curve25519_sandy2x_fe51_pack(mypublic, (const fe51 *)&x_51); -+ -+ memzero_explicit(e, sizeof(e)); -+ memzero_explicit(var, sizeof(var)); -+ memzero_explicit(x_51, sizeof(x_51)); -+ memzero_explicit(z_51, sizeof(z_51)); -+} -+ -+static void curve25519_sandy2x_base(u8 pub[CURVE25519_POINT_SIZE], const u8 secret[CURVE25519_POINT_SIZE]) -+{ -+ u8 e[32]; -+ fex var[3]; -+ fe51 x_51, z_51; -+ -+ memcpy(e, secret, 32); -+ normalize_secret(e); -+ curve25519_sandy2x_ladder_base(var, e); -+#define x2 var[0] -+#define z2 var[1] -+ z_51[0] = (z2[1] << 26) + z2[0]; -+ z_51[1] = (z2[3] << 26) + z2[2]; -+ z_51[2] = (z2[5] << 26) + z2[4]; -+ z_51[3] = (z2[7] << 26) + z2[6]; -+ z_51[4] = (z2[9] << 26) + z2[8]; -+ x_51[0] = (x2[1] << 26) + x2[0]; -+ x_51[1] = (x2[3] << 26) + x2[2]; -+ x_51[2] = (x2[5] << 26) + x2[4]; -+ x_51[3] = (x2[7] << 26) + x2[6]; -+ x_51[4] = (x2[9] << 26) + x2[8]; -+#undef x2 -+#undef z2 -+ fe51_invert(&z_51, (const fe51 *)&z_51); -+ curve25519_sandy2x_fe51_mul(&x_51, (const fe51 *)&x_51, (const fe51 *)&z_51); -+ curve25519_sandy2x_fe51_pack(pub, (const fe51 *)&x_51); -+ -+ memzero_explicit(e, sizeof(e)); -+ memzero_explicit(var, sizeof(var)); -+ memzero_explicit(x_51, sizeof(x_51)); -+ memzero_explicit(z_51, sizeof(z_51)); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/blake2s-x86_64.S 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,685 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * Copyright (C) 2017 Samuel Neves . All Rights Reserved. -+ */ -+ -+#include -+ -+.section .rodata.cst32.BLAKE2S_IV, "aM", @progbits, 32 -+.align 32 -+IV: .octa 0xA54FF53A3C6EF372BB67AE856A09E667 -+ .octa 0x5BE0CD191F83D9AB9B05688C510E527F -+.section .rodata.cst16.ROT16, "aM", @progbits, 16 -+.align 16 -+ROT16: .octa 0x0D0C0F0E09080B0A0504070601000302 -+.section .rodata.cst16.ROR328, "aM", @progbits, 16 -+.align 16 -+ROR328: .octa 0x0C0F0E0D080B0A090407060500030201 -+#ifdef CONFIG_AS_AVX512 -+.section .rodata.cst64.BLAKE2S_SIGMA, "aM", @progbits, 640 -+.align 64 -+SIGMA: -+.long 0, 2, 4, 6, 1, 3, 5, 7, 8, 10, 12, 14, 9, 11, 13, 15 -+.long 11, 2, 12, 14, 9, 8, 15, 3, 4, 0, 13, 6, 10, 1, 7, 5 -+.long 10, 12, 11, 6, 5, 9, 13, 3, 4, 15, 14, 2, 0, 7, 8, 1 -+.long 10, 9, 7, 0, 11, 14, 1, 12, 6, 2, 15, 3, 13, 8, 5, 4 -+.long 4, 9, 8, 13, 14, 0, 10, 11, 7, 3, 12, 1, 5, 6, 15, 2 -+.long 2, 10, 4, 14, 13, 3, 9, 11, 6, 5, 7, 12, 15, 1, 8, 0 -+.long 4, 11, 14, 8, 13, 10, 12, 5, 2, 1, 15, 3, 9, 7, 0, 6 -+.long 6, 12, 0, 13, 15, 2, 1, 10, 4, 5, 11, 14, 8, 3, 9, 7 -+.long 14, 5, 4, 12, 9, 7, 3, 10, 2, 0, 6, 15, 11, 1, 13, 8 -+.long 11, 7, 13, 10, 12, 14, 0, 15, 4, 5, 6, 9, 2, 1, 8, 3 -+#endif /* CONFIG_AS_AVX512 */ -+ -+.text -+#ifdef CONFIG_AS_AVX -+ENTRY(blake2s_compress_avx) -+ movl %ecx, %ecx -+ testq %rdx, %rdx -+ je .Lendofloop -+ .align 32 -+.Lbeginofloop: -+ addq %rcx, 32(%rdi) -+ vmovdqu IV+16(%rip), %xmm1 -+ vmovdqu (%rsi), %xmm4 -+ vpxor 32(%rdi), %xmm1, %xmm1 -+ vmovdqu 16(%rsi), %xmm3 -+ vshufps $136, %xmm3, %xmm4, %xmm6 -+ vmovdqa ROT16(%rip), %xmm7 -+ vpaddd (%rdi), %xmm6, %xmm6 -+ vpaddd 16(%rdi), %xmm6, %xmm6 -+ vpxor %xmm6, %xmm1, %xmm1 -+ vmovdqu IV(%rip), %xmm8 -+ vpshufb %xmm7, %xmm1, %xmm1 -+ vmovdqu 48(%rsi), %xmm5 -+ vpaddd %xmm1, %xmm8, %xmm8 -+ vpxor 16(%rdi), %xmm8, %xmm9 -+ vmovdqu 32(%rsi), %xmm2 -+ vpblendw $12, %xmm3, %xmm5, %xmm13 -+ vshufps $221, %xmm5, %xmm2, %xmm12 -+ vpunpckhqdq %xmm2, %xmm4, %xmm14 -+ vpslld $20, %xmm9, %xmm0 -+ vpsrld $12, %xmm9, %xmm9 -+ vpxor %xmm0, %xmm9, %xmm0 -+ vshufps $221, %xmm3, %xmm4, %xmm9 -+ vpaddd %xmm9, %xmm6, %xmm9 -+ vpaddd %xmm0, %xmm9, %xmm9 -+ vpxor %xmm9, %xmm1, %xmm1 -+ vmovdqa ROR328(%rip), %xmm6 -+ vpshufb %xmm6, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm8, %xmm8 -+ vpxor %xmm8, %xmm0, %xmm0 -+ vpshufd $147, %xmm1, %xmm1 -+ vpshufd $78, %xmm8, %xmm8 -+ vpslld $25, %xmm0, %xmm10 -+ vpsrld $7, %xmm0, %xmm0 -+ vpxor %xmm10, %xmm0, %xmm0 -+ vshufps $136, %xmm5, %xmm2, %xmm10 -+ vpshufd $57, %xmm0, %xmm0 -+ vpaddd %xmm10, %xmm9, %xmm9 -+ vpaddd %xmm0, %xmm9, %xmm9 -+ vpxor %xmm9, %xmm1, %xmm1 -+ vpaddd %xmm12, %xmm9, %xmm9 -+ vpblendw $12, %xmm2, %xmm3, %xmm12 -+ vpshufb %xmm7, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm8, %xmm8 -+ vpxor %xmm8, %xmm0, %xmm10 -+ vpslld $20, %xmm10, %xmm0 -+ vpsrld $12, %xmm10, %xmm10 -+ vpxor %xmm0, %xmm10, %xmm0 -+ vpaddd %xmm0, %xmm9, %xmm9 -+ vpxor %xmm9, %xmm1, %xmm1 -+ vpshufb %xmm6, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm8, %xmm8 -+ vpxor %xmm8, %xmm0, %xmm0 -+ vpshufd $57, %xmm1, %xmm1 -+ vpshufd $78, %xmm8, %xmm8 -+ vpslld $25, %xmm0, %xmm10 -+ vpsrld $7, %xmm0, %xmm0 -+ vpxor %xmm10, %xmm0, %xmm0 -+ vpslldq $4, %xmm5, %xmm10 -+ vpblendw $240, %xmm10, %xmm12, %xmm12 -+ vpshufd $147, %xmm0, %xmm0 -+ vpshufd $147, %xmm12, %xmm12 -+ vpaddd %xmm9, %xmm12, %xmm12 -+ vpaddd %xmm0, %xmm12, %xmm12 -+ vpxor %xmm12, %xmm1, %xmm1 -+ vpshufb %xmm7, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm8, %xmm8 -+ vpxor %xmm8, %xmm0, %xmm11 -+ vpslld $20, %xmm11, %xmm9 -+ vpsrld $12, %xmm11, %xmm11 -+ vpxor %xmm9, %xmm11, %xmm0 -+ vpshufd $8, %xmm2, %xmm9 -+ vpblendw $192, %xmm5, %xmm3, %xmm11 -+ vpblendw $240, %xmm11, %xmm9, %xmm9 -+ vpshufd $177, %xmm9, %xmm9 -+ vpaddd %xmm12, %xmm9, %xmm9 -+ vpaddd %xmm0, %xmm9, %xmm11 -+ vpxor %xmm11, %xmm1, %xmm1 -+ vpshufb %xmm6, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm8, %xmm8 -+ vpxor %xmm8, %xmm0, %xmm9 -+ vpshufd $147, %xmm1, %xmm1 -+ vpshufd $78, %xmm8, %xmm8 -+ vpslld $25, %xmm9, %xmm0 -+ vpsrld $7, %xmm9, %xmm9 -+ vpxor %xmm0, %xmm9, %xmm0 -+ vpslldq $4, %xmm3, %xmm9 -+ vpblendw $48, %xmm9, %xmm2, %xmm9 -+ vpblendw $240, %xmm9, %xmm4, %xmm9 -+ vpshufd $57, %xmm0, %xmm0 -+ vpshufd $177, %xmm9, %xmm9 -+ vpaddd %xmm11, %xmm9, %xmm9 -+ vpaddd %xmm0, %xmm9, %xmm9 -+ vpxor %xmm9, %xmm1, %xmm1 -+ vpshufb %xmm7, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm8, %xmm11 -+ vpxor %xmm11, %xmm0, %xmm0 -+ vpslld $20, %xmm0, %xmm8 -+ vpsrld $12, %xmm0, %xmm0 -+ vpxor %xmm8, %xmm0, %xmm0 -+ vpunpckhdq %xmm3, %xmm4, %xmm8 -+ vpblendw $12, %xmm10, %xmm8, %xmm12 -+ vpshufd $177, %xmm12, %xmm12 -+ vpaddd %xmm9, %xmm12, %xmm9 -+ vpaddd %xmm0, %xmm9, %xmm9 -+ vpxor %xmm9, %xmm1, %xmm1 -+ vpshufb %xmm6, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm11, %xmm11 -+ vpxor %xmm11, %xmm0, %xmm0 -+ vpshufd $57, %xmm1, %xmm1 -+ vpshufd $78, %xmm11, %xmm11 -+ vpslld $25, %xmm0, %xmm12 -+ vpsrld $7, %xmm0, %xmm0 -+ vpxor %xmm12, %xmm0, %xmm0 -+ vpunpckhdq %xmm5, %xmm2, %xmm12 -+ vpshufd $147, %xmm0, %xmm0 -+ vpblendw $15, %xmm13, %xmm12, %xmm12 -+ vpslldq $8, %xmm5, %xmm13 -+ vpshufd $210, %xmm12, %xmm12 -+ vpaddd %xmm9, %xmm12, %xmm9 -+ vpaddd %xmm0, %xmm9, %xmm9 -+ vpxor %xmm9, %xmm1, %xmm1 -+ vpshufb %xmm7, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm11, %xmm11 -+ vpxor %xmm11, %xmm0, %xmm0 -+ vpslld $20, %xmm0, %xmm12 -+ vpsrld $12, %xmm0, %xmm0 -+ vpxor %xmm12, %xmm0, %xmm0 -+ vpunpckldq %xmm4, %xmm2, %xmm12 -+ vpblendw $240, %xmm4, %xmm12, %xmm12 -+ vpblendw $192, %xmm13, %xmm12, %xmm12 -+ vpsrldq $12, %xmm3, %xmm13 -+ vpaddd %xmm12, %xmm9, %xmm9 -+ vpaddd %xmm0, %xmm9, %xmm9 -+ vpxor %xmm9, %xmm1, %xmm1 -+ vpshufb %xmm6, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm11, %xmm11 -+ vpxor %xmm11, %xmm0, %xmm0 -+ vpshufd $147, %xmm1, %xmm1 -+ vpshufd $78, %xmm11, %xmm11 -+ vpslld $25, %xmm0, %xmm12 -+ vpsrld $7, %xmm0, %xmm0 -+ vpxor %xmm12, %xmm0, %xmm0 -+ vpblendw $60, %xmm2, %xmm4, %xmm12 -+ vpblendw $3, %xmm13, %xmm12, %xmm12 -+ vpshufd $57, %xmm0, %xmm0 -+ vpshufd $78, %xmm12, %xmm12 -+ vpaddd %xmm9, %xmm12, %xmm9 -+ vpaddd %xmm0, %xmm9, %xmm9 -+ vpxor %xmm9, %xmm1, %xmm1 -+ vpshufb %xmm7, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm11, %xmm11 -+ vpxor %xmm11, %xmm0, %xmm12 -+ vpslld $20, %xmm12, %xmm13 -+ vpsrld $12, %xmm12, %xmm0 -+ vpblendw $51, %xmm3, %xmm4, %xmm12 -+ vpxor %xmm13, %xmm0, %xmm0 -+ vpblendw $192, %xmm10, %xmm12, %xmm10 -+ vpslldq $8, %xmm2, %xmm12 -+ vpshufd $27, %xmm10, %xmm10 -+ vpaddd %xmm9, %xmm10, %xmm9 -+ vpaddd %xmm0, %xmm9, %xmm9 -+ vpxor %xmm9, %xmm1, %xmm1 -+ vpshufb %xmm6, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm11, %xmm11 -+ vpxor %xmm11, %xmm0, %xmm0 -+ vpshufd $57, %xmm1, %xmm1 -+ vpshufd $78, %xmm11, %xmm11 -+ vpslld $25, %xmm0, %xmm10 -+ vpsrld $7, %xmm0, %xmm0 -+ vpxor %xmm10, %xmm0, %xmm0 -+ vpunpckhdq %xmm2, %xmm8, %xmm10 -+ vpshufd $147, %xmm0, %xmm0 -+ vpblendw $12, %xmm5, %xmm10, %xmm10 -+ vpshufd $210, %xmm10, %xmm10 -+ vpaddd %xmm9, %xmm10, %xmm9 -+ vpaddd %xmm0, %xmm9, %xmm9 -+ vpxor %xmm9, %xmm1, %xmm1 -+ vpshufb %xmm7, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm11, %xmm11 -+ vpxor %xmm11, %xmm0, %xmm10 -+ vpslld $20, %xmm10, %xmm0 -+ vpsrld $12, %xmm10, %xmm10 -+ vpxor %xmm0, %xmm10, %xmm0 -+ vpblendw $12, %xmm4, %xmm5, %xmm10 -+ vpblendw $192, %xmm12, %xmm10, %xmm10 -+ vpunpckldq %xmm2, %xmm4, %xmm12 -+ vpshufd $135, %xmm10, %xmm10 -+ vpaddd %xmm9, %xmm10, %xmm9 -+ vpaddd %xmm0, %xmm9, %xmm9 -+ vpxor %xmm9, %xmm1, %xmm1 -+ vpshufb %xmm6, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm11, %xmm13 -+ vpxor %xmm13, %xmm0, %xmm0 -+ vpshufd $147, %xmm1, %xmm1 -+ vpshufd $78, %xmm13, %xmm13 -+ vpslld $25, %xmm0, %xmm10 -+ vpsrld $7, %xmm0, %xmm0 -+ vpxor %xmm10, %xmm0, %xmm0 -+ vpblendw $15, %xmm3, %xmm4, %xmm10 -+ vpblendw $192, %xmm5, %xmm10, %xmm10 -+ vpshufd $57, %xmm0, %xmm0 -+ vpshufd $198, %xmm10, %xmm10 -+ vpaddd %xmm9, %xmm10, %xmm10 -+ vpaddd %xmm0, %xmm10, %xmm10 -+ vpxor %xmm10, %xmm1, %xmm1 -+ vpshufb %xmm7, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm13, %xmm13 -+ vpxor %xmm13, %xmm0, %xmm9 -+ vpslld $20, %xmm9, %xmm0 -+ vpsrld $12, %xmm9, %xmm9 -+ vpxor %xmm0, %xmm9, %xmm0 -+ vpunpckhdq %xmm2, %xmm3, %xmm9 -+ vpunpcklqdq %xmm12, %xmm9, %xmm15 -+ vpunpcklqdq %xmm12, %xmm8, %xmm12 -+ vpblendw $15, %xmm5, %xmm8, %xmm8 -+ vpaddd %xmm15, %xmm10, %xmm15 -+ vpaddd %xmm0, %xmm15, %xmm15 -+ vpxor %xmm15, %xmm1, %xmm1 -+ vpshufd $141, %xmm8, %xmm8 -+ vpshufb %xmm6, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm13, %xmm13 -+ vpxor %xmm13, %xmm0, %xmm0 -+ vpshufd $57, %xmm1, %xmm1 -+ vpshufd $78, %xmm13, %xmm13 -+ vpslld $25, %xmm0, %xmm10 -+ vpsrld $7, %xmm0, %xmm0 -+ vpxor %xmm10, %xmm0, %xmm0 -+ vpunpcklqdq %xmm2, %xmm3, %xmm10 -+ vpshufd $147, %xmm0, %xmm0 -+ vpblendw $51, %xmm14, %xmm10, %xmm14 -+ vpshufd $135, %xmm14, %xmm14 -+ vpaddd %xmm15, %xmm14, %xmm14 -+ vpaddd %xmm0, %xmm14, %xmm14 -+ vpxor %xmm14, %xmm1, %xmm1 -+ vpunpcklqdq %xmm3, %xmm4, %xmm15 -+ vpshufb %xmm7, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm13, %xmm13 -+ vpxor %xmm13, %xmm0, %xmm0 -+ vpslld $20, %xmm0, %xmm11 -+ vpsrld $12, %xmm0, %xmm0 -+ vpxor %xmm11, %xmm0, %xmm0 -+ vpunpckhqdq %xmm5, %xmm3, %xmm11 -+ vpblendw $51, %xmm15, %xmm11, %xmm11 -+ vpunpckhqdq %xmm3, %xmm5, %xmm15 -+ vpaddd %xmm11, %xmm14, %xmm11 -+ vpaddd %xmm0, %xmm11, %xmm11 -+ vpxor %xmm11, %xmm1, %xmm1 -+ vpshufb %xmm6, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm13, %xmm13 -+ vpxor %xmm13, %xmm0, %xmm0 -+ vpshufd $147, %xmm1, %xmm1 -+ vpshufd $78, %xmm13, %xmm13 -+ vpslld $25, %xmm0, %xmm14 -+ vpsrld $7, %xmm0, %xmm0 -+ vpxor %xmm14, %xmm0, %xmm14 -+ vpunpckhqdq %xmm4, %xmm2, %xmm0 -+ vpshufd $57, %xmm14, %xmm14 -+ vpblendw $51, %xmm15, %xmm0, %xmm15 -+ vpaddd %xmm15, %xmm11, %xmm15 -+ vpaddd %xmm14, %xmm15, %xmm15 -+ vpxor %xmm15, %xmm1, %xmm1 -+ vpshufb %xmm7, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm13, %xmm13 -+ vpxor %xmm13, %xmm14, %xmm14 -+ vpslld $20, %xmm14, %xmm11 -+ vpsrld $12, %xmm14, %xmm14 -+ vpxor %xmm11, %xmm14, %xmm14 -+ vpblendw $3, %xmm2, %xmm4, %xmm11 -+ vpslldq $8, %xmm11, %xmm0 -+ vpblendw $15, %xmm5, %xmm0, %xmm0 -+ vpshufd $99, %xmm0, %xmm0 -+ vpaddd %xmm15, %xmm0, %xmm15 -+ vpaddd %xmm14, %xmm15, %xmm15 -+ vpxor %xmm15, %xmm1, %xmm0 -+ vpaddd %xmm12, %xmm15, %xmm15 -+ vpshufb %xmm6, %xmm0, %xmm0 -+ vpaddd %xmm0, %xmm13, %xmm13 -+ vpxor %xmm13, %xmm14, %xmm14 -+ vpshufd $57, %xmm0, %xmm0 -+ vpshufd $78, %xmm13, %xmm13 -+ vpslld $25, %xmm14, %xmm1 -+ vpsrld $7, %xmm14, %xmm14 -+ vpxor %xmm1, %xmm14, %xmm14 -+ vpblendw $3, %xmm5, %xmm4, %xmm1 -+ vpshufd $147, %xmm14, %xmm14 -+ vpaddd %xmm14, %xmm15, %xmm15 -+ vpxor %xmm15, %xmm0, %xmm0 -+ vpshufb %xmm7, %xmm0, %xmm0 -+ vpaddd %xmm0, %xmm13, %xmm13 -+ vpxor %xmm13, %xmm14, %xmm14 -+ vpslld $20, %xmm14, %xmm12 -+ vpsrld $12, %xmm14, %xmm14 -+ vpxor %xmm12, %xmm14, %xmm14 -+ vpsrldq $4, %xmm2, %xmm12 -+ vpblendw $60, %xmm12, %xmm1, %xmm1 -+ vpaddd %xmm1, %xmm15, %xmm15 -+ vpaddd %xmm14, %xmm15, %xmm15 -+ vpxor %xmm15, %xmm0, %xmm0 -+ vpblendw $12, %xmm4, %xmm3, %xmm1 -+ vpshufb %xmm6, %xmm0, %xmm0 -+ vpaddd %xmm0, %xmm13, %xmm13 -+ vpxor %xmm13, %xmm14, %xmm14 -+ vpshufd $147, %xmm0, %xmm0 -+ vpshufd $78, %xmm13, %xmm13 -+ vpslld $25, %xmm14, %xmm12 -+ vpsrld $7, %xmm14, %xmm14 -+ vpxor %xmm12, %xmm14, %xmm14 -+ vpsrldq $4, %xmm5, %xmm12 -+ vpblendw $48, %xmm12, %xmm1, %xmm1 -+ vpshufd $33, %xmm5, %xmm12 -+ vpshufd $57, %xmm14, %xmm14 -+ vpshufd $108, %xmm1, %xmm1 -+ vpblendw $51, %xmm12, %xmm10, %xmm12 -+ vpaddd %xmm15, %xmm1, %xmm15 -+ vpaddd %xmm14, %xmm15, %xmm15 -+ vpxor %xmm15, %xmm0, %xmm0 -+ vpaddd %xmm12, %xmm15, %xmm15 -+ vpshufb %xmm7, %xmm0, %xmm0 -+ vpaddd %xmm0, %xmm13, %xmm1 -+ vpxor %xmm1, %xmm14, %xmm14 -+ vpslld $20, %xmm14, %xmm13 -+ vpsrld $12, %xmm14, %xmm14 -+ vpxor %xmm13, %xmm14, %xmm14 -+ vpslldq $12, %xmm3, %xmm13 -+ vpaddd %xmm14, %xmm15, %xmm15 -+ vpxor %xmm15, %xmm0, %xmm0 -+ vpshufb %xmm6, %xmm0, %xmm0 -+ vpaddd %xmm0, %xmm1, %xmm1 -+ vpxor %xmm1, %xmm14, %xmm14 -+ vpshufd $57, %xmm0, %xmm0 -+ vpshufd $78, %xmm1, %xmm1 -+ vpslld $25, %xmm14, %xmm12 -+ vpsrld $7, %xmm14, %xmm14 -+ vpxor %xmm12, %xmm14, %xmm14 -+ vpblendw $51, %xmm5, %xmm4, %xmm12 -+ vpshufd $147, %xmm14, %xmm14 -+ vpblendw $192, %xmm13, %xmm12, %xmm12 -+ vpaddd %xmm12, %xmm15, %xmm15 -+ vpaddd %xmm14, %xmm15, %xmm15 -+ vpxor %xmm15, %xmm0, %xmm0 -+ vpsrldq $4, %xmm3, %xmm12 -+ vpshufb %xmm7, %xmm0, %xmm0 -+ vpaddd %xmm0, %xmm1, %xmm1 -+ vpxor %xmm1, %xmm14, %xmm14 -+ vpslld $20, %xmm14, %xmm13 -+ vpsrld $12, %xmm14, %xmm14 -+ vpxor %xmm13, %xmm14, %xmm14 -+ vpblendw $48, %xmm2, %xmm5, %xmm13 -+ vpblendw $3, %xmm12, %xmm13, %xmm13 -+ vpshufd $156, %xmm13, %xmm13 -+ vpaddd %xmm15, %xmm13, %xmm15 -+ vpaddd %xmm14, %xmm15, %xmm15 -+ vpxor %xmm15, %xmm0, %xmm0 -+ vpshufb %xmm6, %xmm0, %xmm0 -+ vpaddd %xmm0, %xmm1, %xmm1 -+ vpxor %xmm1, %xmm14, %xmm14 -+ vpshufd $147, %xmm0, %xmm0 -+ vpshufd $78, %xmm1, %xmm1 -+ vpslld $25, %xmm14, %xmm13 -+ vpsrld $7, %xmm14, %xmm14 -+ vpxor %xmm13, %xmm14, %xmm14 -+ vpunpcklqdq %xmm2, %xmm4, %xmm13 -+ vpshufd $57, %xmm14, %xmm14 -+ vpblendw $12, %xmm12, %xmm13, %xmm12 -+ vpshufd $180, %xmm12, %xmm12 -+ vpaddd %xmm15, %xmm12, %xmm15 -+ vpaddd %xmm14, %xmm15, %xmm15 -+ vpxor %xmm15, %xmm0, %xmm0 -+ vpshufb %xmm7, %xmm0, %xmm0 -+ vpaddd %xmm0, %xmm1, %xmm1 -+ vpxor %xmm1, %xmm14, %xmm14 -+ vpslld $20, %xmm14, %xmm12 -+ vpsrld $12, %xmm14, %xmm14 -+ vpxor %xmm12, %xmm14, %xmm14 -+ vpunpckhqdq %xmm9, %xmm4, %xmm12 -+ vpshufd $198, %xmm12, %xmm12 -+ vpaddd %xmm15, %xmm12, %xmm15 -+ vpaddd %xmm14, %xmm15, %xmm15 -+ vpxor %xmm15, %xmm0, %xmm0 -+ vpaddd %xmm15, %xmm8, %xmm15 -+ vpshufb %xmm6, %xmm0, %xmm0 -+ vpaddd %xmm0, %xmm1, %xmm1 -+ vpxor %xmm1, %xmm14, %xmm14 -+ vpshufd $57, %xmm0, %xmm0 -+ vpshufd $78, %xmm1, %xmm1 -+ vpslld $25, %xmm14, %xmm12 -+ vpsrld $7, %xmm14, %xmm14 -+ vpxor %xmm12, %xmm14, %xmm14 -+ vpsrldq $4, %xmm4, %xmm12 -+ vpshufd $147, %xmm14, %xmm14 -+ vpaddd %xmm14, %xmm15, %xmm15 -+ vpxor %xmm15, %xmm0, %xmm0 -+ vpshufb %xmm7, %xmm0, %xmm0 -+ vpaddd %xmm0, %xmm1, %xmm1 -+ vpxor %xmm1, %xmm14, %xmm14 -+ vpslld $20, %xmm14, %xmm8 -+ vpsrld $12, %xmm14, %xmm14 -+ vpxor %xmm14, %xmm8, %xmm14 -+ vpblendw $48, %xmm5, %xmm2, %xmm8 -+ vpblendw $3, %xmm12, %xmm8, %xmm8 -+ vpunpckhqdq %xmm5, %xmm4, %xmm12 -+ vpshufd $75, %xmm8, %xmm8 -+ vpblendw $60, %xmm10, %xmm12, %xmm10 -+ vpaddd %xmm15, %xmm8, %xmm15 -+ vpaddd %xmm14, %xmm15, %xmm15 -+ vpxor %xmm0, %xmm15, %xmm0 -+ vpshufd $45, %xmm10, %xmm10 -+ vpshufb %xmm6, %xmm0, %xmm0 -+ vpaddd %xmm15, %xmm10, %xmm15 -+ vpaddd %xmm0, %xmm1, %xmm1 -+ vpxor %xmm1, %xmm14, %xmm14 -+ vpshufd $147, %xmm0, %xmm0 -+ vpshufd $78, %xmm1, %xmm1 -+ vpslld $25, %xmm14, %xmm8 -+ vpsrld $7, %xmm14, %xmm14 -+ vpxor %xmm14, %xmm8, %xmm8 -+ vpshufd $57, %xmm8, %xmm8 -+ vpaddd %xmm8, %xmm15, %xmm15 -+ vpxor %xmm0, %xmm15, %xmm0 -+ vpshufb %xmm7, %xmm0, %xmm0 -+ vpaddd %xmm0, %xmm1, %xmm1 -+ vpxor %xmm8, %xmm1, %xmm8 -+ vpslld $20, %xmm8, %xmm10 -+ vpsrld $12, %xmm8, %xmm8 -+ vpxor %xmm8, %xmm10, %xmm10 -+ vpunpckldq %xmm3, %xmm4, %xmm8 -+ vpunpcklqdq %xmm9, %xmm8, %xmm9 -+ vpaddd %xmm9, %xmm15, %xmm9 -+ vpaddd %xmm10, %xmm9, %xmm9 -+ vpxor %xmm0, %xmm9, %xmm8 -+ vpshufb %xmm6, %xmm8, %xmm8 -+ vpaddd %xmm8, %xmm1, %xmm1 -+ vpxor %xmm1, %xmm10, %xmm10 -+ vpshufd $57, %xmm8, %xmm8 -+ vpshufd $78, %xmm1, %xmm1 -+ vpslld $25, %xmm10, %xmm12 -+ vpsrld $7, %xmm10, %xmm10 -+ vpxor %xmm10, %xmm12, %xmm10 -+ vpblendw $48, %xmm4, %xmm3, %xmm12 -+ vpshufd $147, %xmm10, %xmm0 -+ vpunpckhdq %xmm5, %xmm3, %xmm10 -+ vpshufd $78, %xmm12, %xmm12 -+ vpunpcklqdq %xmm4, %xmm10, %xmm10 -+ vpblendw $192, %xmm2, %xmm10, %xmm10 -+ vpshufhw $78, %xmm10, %xmm10 -+ vpaddd %xmm10, %xmm9, %xmm10 -+ vpaddd %xmm0, %xmm10, %xmm10 -+ vpxor %xmm8, %xmm10, %xmm8 -+ vpshufb %xmm7, %xmm8, %xmm8 -+ vpaddd %xmm8, %xmm1, %xmm1 -+ vpxor %xmm0, %xmm1, %xmm9 -+ vpslld $20, %xmm9, %xmm0 -+ vpsrld $12, %xmm9, %xmm9 -+ vpxor %xmm9, %xmm0, %xmm0 -+ vpunpckhdq %xmm5, %xmm4, %xmm9 -+ vpblendw $240, %xmm9, %xmm2, %xmm13 -+ vpshufd $39, %xmm13, %xmm13 -+ vpaddd %xmm10, %xmm13, %xmm10 -+ vpaddd %xmm0, %xmm10, %xmm10 -+ vpxor %xmm8, %xmm10, %xmm8 -+ vpblendw $12, %xmm4, %xmm2, %xmm13 -+ vpshufb %xmm6, %xmm8, %xmm8 -+ vpslldq $4, %xmm13, %xmm13 -+ vpblendw $15, %xmm5, %xmm13, %xmm13 -+ vpaddd %xmm8, %xmm1, %xmm1 -+ vpxor %xmm1, %xmm0, %xmm0 -+ vpaddd %xmm13, %xmm10, %xmm13 -+ vpshufd $147, %xmm8, %xmm8 -+ vpshufd $78, %xmm1, %xmm1 -+ vpslld $25, %xmm0, %xmm14 -+ vpsrld $7, %xmm0, %xmm0 -+ vpxor %xmm0, %xmm14, %xmm14 -+ vpshufd $57, %xmm14, %xmm14 -+ vpaddd %xmm14, %xmm13, %xmm13 -+ vpxor %xmm8, %xmm13, %xmm8 -+ vpaddd %xmm13, %xmm12, %xmm12 -+ vpshufb %xmm7, %xmm8, %xmm8 -+ vpaddd %xmm8, %xmm1, %xmm1 -+ vpxor %xmm14, %xmm1, %xmm14 -+ vpslld $20, %xmm14, %xmm10 -+ vpsrld $12, %xmm14, %xmm14 -+ vpxor %xmm14, %xmm10, %xmm10 -+ vpaddd %xmm10, %xmm12, %xmm12 -+ vpxor %xmm8, %xmm12, %xmm8 -+ vpshufb %xmm6, %xmm8, %xmm8 -+ vpaddd %xmm8, %xmm1, %xmm1 -+ vpxor %xmm1, %xmm10, %xmm0 -+ vpshufd $57, %xmm8, %xmm8 -+ vpshufd $78, %xmm1, %xmm1 -+ vpslld $25, %xmm0, %xmm10 -+ vpsrld $7, %xmm0, %xmm0 -+ vpxor %xmm0, %xmm10, %xmm10 -+ vpblendw $48, %xmm2, %xmm3, %xmm0 -+ vpblendw $15, %xmm11, %xmm0, %xmm0 -+ vpshufd $147, %xmm10, %xmm10 -+ vpshufd $114, %xmm0, %xmm0 -+ vpaddd %xmm12, %xmm0, %xmm0 -+ vpaddd %xmm10, %xmm0, %xmm0 -+ vpxor %xmm8, %xmm0, %xmm8 -+ vpshufb %xmm7, %xmm8, %xmm8 -+ vpaddd %xmm8, %xmm1, %xmm1 -+ vpxor %xmm10, %xmm1, %xmm10 -+ vpslld $20, %xmm10, %xmm11 -+ vpsrld $12, %xmm10, %xmm10 -+ vpxor %xmm10, %xmm11, %xmm10 -+ vpslldq $4, %xmm4, %xmm11 -+ vpblendw $192, %xmm11, %xmm3, %xmm3 -+ vpunpckldq %xmm5, %xmm4, %xmm4 -+ vpshufd $99, %xmm3, %xmm3 -+ vpaddd %xmm0, %xmm3, %xmm3 -+ vpaddd %xmm10, %xmm3, %xmm3 -+ vpxor %xmm8, %xmm3, %xmm11 -+ vpunpckldq %xmm5, %xmm2, %xmm0 -+ vpblendw $192, %xmm2, %xmm5, %xmm2 -+ vpshufb %xmm6, %xmm11, %xmm11 -+ vpunpckhqdq %xmm0, %xmm9, %xmm0 -+ vpblendw $15, %xmm4, %xmm2, %xmm4 -+ vpaddd %xmm11, %xmm1, %xmm1 -+ vpxor %xmm1, %xmm10, %xmm10 -+ vpshufd $147, %xmm11, %xmm11 -+ vpshufd $201, %xmm0, %xmm0 -+ vpslld $25, %xmm10, %xmm8 -+ vpsrld $7, %xmm10, %xmm10 -+ vpxor %xmm10, %xmm8, %xmm10 -+ vpshufd $78, %xmm1, %xmm1 -+ vpaddd %xmm3, %xmm0, %xmm0 -+ vpshufd $27, %xmm4, %xmm4 -+ vpshufd $57, %xmm10, %xmm10 -+ vpaddd %xmm10, %xmm0, %xmm0 -+ vpxor %xmm11, %xmm0, %xmm11 -+ vpaddd %xmm0, %xmm4, %xmm0 -+ vpshufb %xmm7, %xmm11, %xmm7 -+ vpaddd %xmm7, %xmm1, %xmm1 -+ vpxor %xmm10, %xmm1, %xmm10 -+ vpslld $20, %xmm10, %xmm8 -+ vpsrld $12, %xmm10, %xmm10 -+ vpxor %xmm10, %xmm8, %xmm8 -+ vpaddd %xmm8, %xmm0, %xmm0 -+ vpxor %xmm7, %xmm0, %xmm7 -+ vpshufb %xmm6, %xmm7, %xmm6 -+ vpaddd %xmm6, %xmm1, %xmm1 -+ vpxor %xmm1, %xmm8, %xmm8 -+ vpshufd $78, %xmm1, %xmm1 -+ vpshufd $57, %xmm6, %xmm6 -+ vpslld $25, %xmm8, %xmm2 -+ vpsrld $7, %xmm8, %xmm8 -+ vpxor %xmm8, %xmm2, %xmm8 -+ vpxor (%rdi), %xmm1, %xmm1 -+ vpshufd $147, %xmm8, %xmm8 -+ vpxor %xmm0, %xmm1, %xmm0 -+ vmovups %xmm0, (%rdi) -+ vpxor 16(%rdi), %xmm8, %xmm0 -+ vpxor %xmm6, %xmm0, %xmm6 -+ vmovups %xmm6, 16(%rdi) -+ addq $64, %rsi -+ decq %rdx -+ jnz .Lbeginofloop -+.Lendofloop: -+ ret -+ENDPROC(blake2s_compress_avx) -+#endif /* CONFIG_AS_AVX */ -+ -+#ifdef CONFIG_AS_AVX512 -+ENTRY(blake2s_compress_avx512) -+ vmovdqu (%rdi),%xmm0 -+ vmovdqu 0x10(%rdi),%xmm1 -+ vmovdqu 0x20(%rdi),%xmm4 -+ vmovq %rcx,%xmm5 -+ vmovdqa IV(%rip),%xmm14 -+ vmovdqa IV+16(%rip),%xmm15 -+ jmp .Lblake2s_compress_avx512_mainloop -+.align 32 -+.Lblake2s_compress_avx512_mainloop: -+ vmovdqa %xmm0,%xmm10 -+ vmovdqa %xmm1,%xmm11 -+ vpaddq %xmm5,%xmm4,%xmm4 -+ vmovdqa %xmm14,%xmm2 -+ vpxor %xmm15,%xmm4,%xmm3 -+ vmovdqu (%rsi),%ymm6 -+ vmovdqu 0x20(%rsi),%ymm7 -+ addq $0x40,%rsi -+ leaq SIGMA(%rip),%rax -+ movb $0xa,%cl -+.Lblake2s_compress_avx512_roundloop: -+ addq $0x40,%rax -+ vmovdqa -0x40(%rax),%ymm8 -+ vmovdqa -0x20(%rax),%ymm9 -+ vpermi2d %ymm7,%ymm6,%ymm8 -+ vpermi2d %ymm7,%ymm6,%ymm9 -+ vmovdqa %ymm8,%ymm6 -+ vmovdqa %ymm9,%ymm7 -+ vpaddd %xmm8,%xmm0,%xmm0 -+ vpaddd %xmm1,%xmm0,%xmm0 -+ vpxor %xmm0,%xmm3,%xmm3 -+ vprord $0x10,%xmm3,%xmm3 -+ vpaddd %xmm3,%xmm2,%xmm2 -+ vpxor %xmm2,%xmm1,%xmm1 -+ vprord $0xc,%xmm1,%xmm1 -+ vextracti128 $0x1,%ymm8,%xmm8 -+ vpaddd %xmm8,%xmm0,%xmm0 -+ vpaddd %xmm1,%xmm0,%xmm0 -+ vpxor %xmm0,%xmm3,%xmm3 -+ vprord $0x8,%xmm3,%xmm3 -+ vpaddd %xmm3,%xmm2,%xmm2 -+ vpxor %xmm2,%xmm1,%xmm1 -+ vprord $0x7,%xmm1,%xmm1 -+ vpshufd $0x39,%xmm1,%xmm1 -+ vpshufd $0x4e,%xmm2,%xmm2 -+ vpshufd $0x93,%xmm3,%xmm3 -+ vpaddd %xmm9,%xmm0,%xmm0 -+ vpaddd %xmm1,%xmm0,%xmm0 -+ vpxor %xmm0,%xmm3,%xmm3 -+ vprord $0x10,%xmm3,%xmm3 -+ vpaddd %xmm3,%xmm2,%xmm2 -+ vpxor %xmm2,%xmm1,%xmm1 -+ vprord $0xc,%xmm1,%xmm1 -+ vextracti128 $0x1,%ymm9,%xmm9 -+ vpaddd %xmm9,%xmm0,%xmm0 -+ vpaddd %xmm1,%xmm0,%xmm0 -+ vpxor %xmm0,%xmm3,%xmm3 -+ vprord $0x8,%xmm3,%xmm3 -+ vpaddd %xmm3,%xmm2,%xmm2 -+ vpxor %xmm2,%xmm1,%xmm1 -+ vprord $0x7,%xmm1,%xmm1 -+ vpshufd $0x93,%xmm1,%xmm1 -+ vpshufd $0x4e,%xmm2,%xmm2 -+ vpshufd $0x39,%xmm3,%xmm3 -+ decb %cl -+ jne .Lblake2s_compress_avx512_roundloop -+ vpxor %xmm10,%xmm0,%xmm0 -+ vpxor %xmm11,%xmm1,%xmm1 -+ vpxor %xmm2,%xmm0,%xmm0 -+ vpxor %xmm3,%xmm1,%xmm1 -+ decq %rdx -+ jne .Lblake2s_compress_avx512_mainloop -+ vmovdqu %xmm0,(%rdi) -+ vmovdqu %xmm1,0x10(%rdi) -+ vmovdqu %xmm4,0x20(%rdi) -+ vzeroupper -+ retq -+ENDPROC(blake2s_compress_avx512) -+#endif /* CONFIG_AS_AVX512 */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/chacha20-arm64.S 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,1940 @@ -+/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. -+ */ -+ -+#include -+ -+.text -+.align 5 -+.Lsigma: -+.quad 0x3320646e61707865,0x6b20657479622d32 // endian-neutral -+.Lone: -+.long 1,0,0,0 -+ -+.align 5 -+ENTRY(chacha20_arm) -+ cbz x2,.Labort -+.Lshort: -+ stp x29,x30,[sp,#-96]! -+ add x29,sp,#0 -+ -+ adr x5,.Lsigma -+ stp x19,x20,[sp,#16] -+ stp x21,x22,[sp,#32] -+ stp x23,x24,[sp,#48] -+ stp x25,x26,[sp,#64] -+ stp x27,x28,[sp,#80] -+ sub sp,sp,#64 -+ -+ ldp x22,x23,[x5] // load sigma -+ ldp x24,x25,[x3] // load key -+ ldp x26,x27,[x3,#16] -+ ldp x28,x30,[x4] // load counter -+#ifdef __ARMEB__ -+ ror x24,x24,#32 -+ ror x25,x25,#32 -+ ror x26,x26,#32 -+ ror x27,x27,#32 -+ ror x28,x28,#32 -+ ror x30,x30,#32 -+#endif -+ -+.Loop_outer: -+ mov w5,w22 // unpack key block -+ lsr x6,x22,#32 -+ mov w7,w23 -+ lsr x8,x23,#32 -+ mov w9,w24 -+ lsr x10,x24,#32 -+ mov w11,w25 -+ lsr x12,x25,#32 -+ mov w13,w26 -+ lsr x14,x26,#32 -+ mov w15,w27 -+ lsr x16,x27,#32 -+ mov w17,w28 -+ lsr x19,x28,#32 -+ mov w20,w30 -+ lsr x21,x30,#32 -+ -+ mov x4,#10 -+ subs x2,x2,#64 -+.Loop: -+ sub x4,x4,#1 -+ add w5,w5,w9 -+ add w6,w6,w10 -+ add w7,w7,w11 -+ add w8,w8,w12 -+ eor w17,w17,w5 -+ eor w19,w19,w6 -+ eor w20,w20,w7 -+ eor w21,w21,w8 -+ ror w17,w17,#16 -+ ror w19,w19,#16 -+ ror w20,w20,#16 -+ ror w21,w21,#16 -+ add w13,w13,w17 -+ add w14,w14,w19 -+ add w15,w15,w20 -+ add w16,w16,w21 -+ eor w9,w9,w13 -+ eor w10,w10,w14 -+ eor w11,w11,w15 -+ eor w12,w12,w16 -+ ror w9,w9,#20 -+ ror w10,w10,#20 -+ ror w11,w11,#20 -+ ror w12,w12,#20 -+ add w5,w5,w9 -+ add w6,w6,w10 -+ add w7,w7,w11 -+ add w8,w8,w12 -+ eor w17,w17,w5 -+ eor w19,w19,w6 -+ eor w20,w20,w7 -+ eor w21,w21,w8 -+ ror w17,w17,#24 -+ ror w19,w19,#24 -+ ror w20,w20,#24 -+ ror w21,w21,#24 -+ add w13,w13,w17 -+ add w14,w14,w19 -+ add w15,w15,w20 -+ add w16,w16,w21 -+ eor w9,w9,w13 -+ eor w10,w10,w14 -+ eor w11,w11,w15 -+ eor w12,w12,w16 -+ ror w9,w9,#25 -+ ror w10,w10,#25 -+ ror w11,w11,#25 -+ ror w12,w12,#25 -+ add w5,w5,w10 -+ add w6,w6,w11 -+ add w7,w7,w12 -+ add w8,w8,w9 -+ eor w21,w21,w5 -+ eor w17,w17,w6 -+ eor w19,w19,w7 -+ eor w20,w20,w8 -+ ror w21,w21,#16 -+ ror w17,w17,#16 -+ ror w19,w19,#16 -+ ror w20,w20,#16 -+ add w15,w15,w21 -+ add w16,w16,w17 -+ add w13,w13,w19 -+ add w14,w14,w20 -+ eor w10,w10,w15 -+ eor w11,w11,w16 -+ eor w12,w12,w13 -+ eor w9,w9,w14 -+ ror w10,w10,#20 -+ ror w11,w11,#20 -+ ror w12,w12,#20 -+ ror w9,w9,#20 -+ add w5,w5,w10 -+ add w6,w6,w11 -+ add w7,w7,w12 -+ add w8,w8,w9 -+ eor w21,w21,w5 -+ eor w17,w17,w6 -+ eor w19,w19,w7 -+ eor w20,w20,w8 -+ ror w21,w21,#24 -+ ror w17,w17,#24 -+ ror w19,w19,#24 -+ ror w20,w20,#24 -+ add w15,w15,w21 -+ add w16,w16,w17 -+ add w13,w13,w19 -+ add w14,w14,w20 -+ eor w10,w10,w15 -+ eor w11,w11,w16 -+ eor w12,w12,w13 -+ eor w9,w9,w14 -+ ror w10,w10,#25 -+ ror w11,w11,#25 -+ ror w12,w12,#25 -+ ror w9,w9,#25 -+ cbnz x4,.Loop -+ -+ add w5,w5,w22 // accumulate key block -+ add x6,x6,x22,lsr#32 -+ add w7,w7,w23 -+ add x8,x8,x23,lsr#32 -+ add w9,w9,w24 -+ add x10,x10,x24,lsr#32 -+ add w11,w11,w25 -+ add x12,x12,x25,lsr#32 -+ add w13,w13,w26 -+ add x14,x14,x26,lsr#32 -+ add w15,w15,w27 -+ add x16,x16,x27,lsr#32 -+ add w17,w17,w28 -+ add x19,x19,x28,lsr#32 -+ add w20,w20,w30 -+ add x21,x21,x30,lsr#32 -+ -+ b.lo .Ltail -+ -+ add x5,x5,x6,lsl#32 // pack -+ add x7,x7,x8,lsl#32 -+ ldp x6,x8,[x1,#0] // load input -+ add x9,x9,x10,lsl#32 -+ add x11,x11,x12,lsl#32 -+ ldp x10,x12,[x1,#16] -+ add x13,x13,x14,lsl#32 -+ add x15,x15,x16,lsl#32 -+ ldp x14,x16,[x1,#32] -+ add x17,x17,x19,lsl#32 -+ add x20,x20,x21,lsl#32 -+ ldp x19,x21,[x1,#48] -+ add x1,x1,#64 -+#ifdef __ARMEB__ -+ rev x5,x5 -+ rev x7,x7 -+ rev x9,x9 -+ rev x11,x11 -+ rev x13,x13 -+ rev x15,x15 -+ rev x17,x17 -+ rev x20,x20 -+#endif -+ eor x5,x5,x6 -+ eor x7,x7,x8 -+ eor x9,x9,x10 -+ eor x11,x11,x12 -+ eor x13,x13,x14 -+ eor x15,x15,x16 -+ eor x17,x17,x19 -+ eor x20,x20,x21 -+ -+ stp x5,x7,[x0,#0] // store output -+ add x28,x28,#1 // increment counter -+ stp x9,x11,[x0,#16] -+ stp x13,x15,[x0,#32] -+ stp x17,x20,[x0,#48] -+ add x0,x0,#64 -+ -+ b.hi .Loop_outer -+ -+ ldp x19,x20,[x29,#16] -+ add sp,sp,#64 -+ ldp x21,x22,[x29,#32] -+ ldp x23,x24,[x29,#48] -+ ldp x25,x26,[x29,#64] -+ ldp x27,x28,[x29,#80] -+ ldp x29,x30,[sp],#96 -+.Labort: -+ ret -+ -+.align 4 -+.Ltail: -+ add x2,x2,#64 -+.Less_than_64: -+ sub x0,x0,#1 -+ add x1,x1,x2 -+ add x0,x0,x2 -+ add x4,sp,x2 -+ neg x2,x2 -+ -+ add x5,x5,x6,lsl#32 // pack -+ add x7,x7,x8,lsl#32 -+ add x9,x9,x10,lsl#32 -+ add x11,x11,x12,lsl#32 -+ add x13,x13,x14,lsl#32 -+ add x15,x15,x16,lsl#32 -+ add x17,x17,x19,lsl#32 -+ add x20,x20,x21,lsl#32 -+#ifdef __ARMEB__ -+ rev x5,x5 -+ rev x7,x7 -+ rev x9,x9 -+ rev x11,x11 -+ rev x13,x13 -+ rev x15,x15 -+ rev x17,x17 -+ rev x20,x20 -+#endif -+ stp x5,x7,[sp,#0] -+ stp x9,x11,[sp,#16] -+ stp x13,x15,[sp,#32] -+ stp x17,x20,[sp,#48] -+ -+.Loop_tail: -+ ldrb w10,[x1,x2] -+ ldrb w11,[x4,x2] -+ add x2,x2,#1 -+ eor w10,w10,w11 -+ strb w10,[x0,x2] -+ cbnz x2,.Loop_tail -+ -+ stp xzr,xzr,[sp,#0] -+ stp xzr,xzr,[sp,#16] -+ stp xzr,xzr,[sp,#32] -+ stp xzr,xzr,[sp,#48] -+ -+ ldp x19,x20,[x29,#16] -+ add sp,sp,#64 -+ ldp x21,x22,[x29,#32] -+ ldp x23,x24,[x29,#48] -+ ldp x25,x26,[x29,#64] -+ ldp x27,x28,[x29,#80] -+ ldp x29,x30,[sp],#96 -+ ret -+ENDPROC(chacha20_arm) -+ -+.align 5 -+ENTRY(chacha20_neon) -+ cbz x2,.Labort_neon -+ cmp x2,#192 -+ b.lo .Lshort -+ -+ stp x29,x30,[sp,#-96]! -+ add x29,sp,#0 -+ -+ adr x5,.Lsigma -+ stp x19,x20,[sp,#16] -+ stp x21,x22,[sp,#32] -+ stp x23,x24,[sp,#48] -+ stp x25,x26,[sp,#64] -+ stp x27,x28,[sp,#80] -+ cmp x2,#512 -+ b.hs .L512_or_more_neon -+ -+ sub sp,sp,#64 -+ -+ ldp x22,x23,[x5] // load sigma -+ ld1 {v24.4s},[x5],#16 -+ ldp x24,x25,[x3] // load key -+ ldp x26,x27,[x3,#16] -+ ld1 {v25.4s,v26.4s},[x3] -+ ldp x28,x30,[x4] // load counter -+ ld1 {v27.4s},[x4] -+ ld1 {v31.4s},[x5] -+#ifdef __ARMEB__ -+ rev64 v24.4s,v24.4s -+ ror x24,x24,#32 -+ ror x25,x25,#32 -+ ror x26,x26,#32 -+ ror x27,x27,#32 -+ ror x28,x28,#32 -+ ror x30,x30,#32 -+#endif -+ add v27.4s,v27.4s,v31.4s // += 1 -+ add v28.4s,v27.4s,v31.4s -+ add v29.4s,v28.4s,v31.4s -+ shl v31.4s,v31.4s,#2 // 1 -> 4 -+ -+.Loop_outer_neon: -+ mov w5,w22 // unpack key block -+ lsr x6,x22,#32 -+ mov v0.16b,v24.16b -+ mov w7,w23 -+ lsr x8,x23,#32 -+ mov v4.16b,v24.16b -+ mov w9,w24 -+ lsr x10,x24,#32 -+ mov v16.16b,v24.16b -+ mov w11,w25 -+ mov v1.16b,v25.16b -+ lsr x12,x25,#32 -+ mov v5.16b,v25.16b -+ mov w13,w26 -+ mov v17.16b,v25.16b -+ lsr x14,x26,#32 -+ mov v3.16b,v27.16b -+ mov w15,w27 -+ mov v7.16b,v28.16b -+ lsr x16,x27,#32 -+ mov v19.16b,v29.16b -+ mov w17,w28 -+ mov v2.16b,v26.16b -+ lsr x19,x28,#32 -+ mov v6.16b,v26.16b -+ mov w20,w30 -+ mov v18.16b,v26.16b -+ lsr x21,x30,#32 -+ -+ mov x4,#10 -+ subs x2,x2,#256 -+.Loop_neon: -+ sub x4,x4,#1 -+ add v0.4s,v0.4s,v1.4s -+ add w5,w5,w9 -+ add v4.4s,v4.4s,v5.4s -+ add w6,w6,w10 -+ add v16.4s,v16.4s,v17.4s -+ add w7,w7,w11 -+ eor v3.16b,v3.16b,v0.16b -+ add w8,w8,w12 -+ eor v7.16b,v7.16b,v4.16b -+ eor w17,w17,w5 -+ eor v19.16b,v19.16b,v16.16b -+ eor w19,w19,w6 -+ rev32 v3.8h,v3.8h -+ eor w20,w20,w7 -+ rev32 v7.8h,v7.8h -+ eor w21,w21,w8 -+ rev32 v19.8h,v19.8h -+ ror w17,w17,#16 -+ add v2.4s,v2.4s,v3.4s -+ ror w19,w19,#16 -+ add v6.4s,v6.4s,v7.4s -+ ror w20,w20,#16 -+ add v18.4s,v18.4s,v19.4s -+ ror w21,w21,#16 -+ eor v20.16b,v1.16b,v2.16b -+ add w13,w13,w17 -+ eor v21.16b,v5.16b,v6.16b -+ add w14,w14,w19 -+ eor v22.16b,v17.16b,v18.16b -+ add w15,w15,w20 -+ ushr v1.4s,v20.4s,#20 -+ add w16,w16,w21 -+ ushr v5.4s,v21.4s,#20 -+ eor w9,w9,w13 -+ ushr v17.4s,v22.4s,#20 -+ eor w10,w10,w14 -+ sli v1.4s,v20.4s,#12 -+ eor w11,w11,w15 -+ sli v5.4s,v21.4s,#12 -+ eor w12,w12,w16 -+ sli v17.4s,v22.4s,#12 -+ ror w9,w9,#20 -+ add v0.4s,v0.4s,v1.4s -+ ror w10,w10,#20 -+ add v4.4s,v4.4s,v5.4s -+ ror w11,w11,#20 -+ add v16.4s,v16.4s,v17.4s -+ ror w12,w12,#20 -+ eor v20.16b,v3.16b,v0.16b -+ add w5,w5,w9 -+ eor v21.16b,v7.16b,v4.16b -+ add w6,w6,w10 -+ eor v22.16b,v19.16b,v16.16b -+ add w7,w7,w11 -+ ushr v3.4s,v20.4s,#24 -+ add w8,w8,w12 -+ ushr v7.4s,v21.4s,#24 -+ eor w17,w17,w5 -+ ushr v19.4s,v22.4s,#24 -+ eor w19,w19,w6 -+ sli v3.4s,v20.4s,#8 -+ eor w20,w20,w7 -+ sli v7.4s,v21.4s,#8 -+ eor w21,w21,w8 -+ sli v19.4s,v22.4s,#8 -+ ror w17,w17,#24 -+ add v2.4s,v2.4s,v3.4s -+ ror w19,w19,#24 -+ add v6.4s,v6.4s,v7.4s -+ ror w20,w20,#24 -+ add v18.4s,v18.4s,v19.4s -+ ror w21,w21,#24 -+ eor v20.16b,v1.16b,v2.16b -+ add w13,w13,w17 -+ eor v21.16b,v5.16b,v6.16b -+ add w14,w14,w19 -+ eor v22.16b,v17.16b,v18.16b -+ add w15,w15,w20 -+ ushr v1.4s,v20.4s,#25 -+ add w16,w16,w21 -+ ushr v5.4s,v21.4s,#25 -+ eor w9,w9,w13 -+ ushr v17.4s,v22.4s,#25 -+ eor w10,w10,w14 -+ sli v1.4s,v20.4s,#7 -+ eor w11,w11,w15 -+ sli v5.4s,v21.4s,#7 -+ eor w12,w12,w16 -+ sli v17.4s,v22.4s,#7 -+ ror w9,w9,#25 -+ ext v2.16b,v2.16b,v2.16b,#8 -+ ror w10,w10,#25 -+ ext v6.16b,v6.16b,v6.16b,#8 -+ ror w11,w11,#25 -+ ext v18.16b,v18.16b,v18.16b,#8 -+ ror w12,w12,#25 -+ ext v3.16b,v3.16b,v3.16b,#12 -+ ext v7.16b,v7.16b,v7.16b,#12 -+ ext v19.16b,v19.16b,v19.16b,#12 -+ ext v1.16b,v1.16b,v1.16b,#4 -+ ext v5.16b,v5.16b,v5.16b,#4 -+ ext v17.16b,v17.16b,v17.16b,#4 -+ add v0.4s,v0.4s,v1.4s -+ add w5,w5,w10 -+ add v4.4s,v4.4s,v5.4s -+ add w6,w6,w11 -+ add v16.4s,v16.4s,v17.4s -+ add w7,w7,w12 -+ eor v3.16b,v3.16b,v0.16b -+ add w8,w8,w9 -+ eor v7.16b,v7.16b,v4.16b -+ eor w21,w21,w5 -+ eor v19.16b,v19.16b,v16.16b -+ eor w17,w17,w6 -+ rev32 v3.8h,v3.8h -+ eor w19,w19,w7 -+ rev32 v7.8h,v7.8h -+ eor w20,w20,w8 -+ rev32 v19.8h,v19.8h -+ ror w21,w21,#16 -+ add v2.4s,v2.4s,v3.4s -+ ror w17,w17,#16 -+ add v6.4s,v6.4s,v7.4s -+ ror w19,w19,#16 -+ add v18.4s,v18.4s,v19.4s -+ ror w20,w20,#16 -+ eor v20.16b,v1.16b,v2.16b -+ add w15,w15,w21 -+ eor v21.16b,v5.16b,v6.16b -+ add w16,w16,w17 -+ eor v22.16b,v17.16b,v18.16b -+ add w13,w13,w19 -+ ushr v1.4s,v20.4s,#20 -+ add w14,w14,w20 -+ ushr v5.4s,v21.4s,#20 -+ eor w10,w10,w15 -+ ushr v17.4s,v22.4s,#20 -+ eor w11,w11,w16 -+ sli v1.4s,v20.4s,#12 -+ eor w12,w12,w13 -+ sli v5.4s,v21.4s,#12 -+ eor w9,w9,w14 -+ sli v17.4s,v22.4s,#12 -+ ror w10,w10,#20 -+ add v0.4s,v0.4s,v1.4s -+ ror w11,w11,#20 -+ add v4.4s,v4.4s,v5.4s -+ ror w12,w12,#20 -+ add v16.4s,v16.4s,v17.4s -+ ror w9,w9,#20 -+ eor v20.16b,v3.16b,v0.16b -+ add w5,w5,w10 -+ eor v21.16b,v7.16b,v4.16b -+ add w6,w6,w11 -+ eor v22.16b,v19.16b,v16.16b -+ add w7,w7,w12 -+ ushr v3.4s,v20.4s,#24 -+ add w8,w8,w9 -+ ushr v7.4s,v21.4s,#24 -+ eor w21,w21,w5 -+ ushr v19.4s,v22.4s,#24 -+ eor w17,w17,w6 -+ sli v3.4s,v20.4s,#8 -+ eor w19,w19,w7 -+ sli v7.4s,v21.4s,#8 -+ eor w20,w20,w8 -+ sli v19.4s,v22.4s,#8 -+ ror w21,w21,#24 -+ add v2.4s,v2.4s,v3.4s -+ ror w17,w17,#24 -+ add v6.4s,v6.4s,v7.4s -+ ror w19,w19,#24 -+ add v18.4s,v18.4s,v19.4s -+ ror w20,w20,#24 -+ eor v20.16b,v1.16b,v2.16b -+ add w15,w15,w21 -+ eor v21.16b,v5.16b,v6.16b -+ add w16,w16,w17 -+ eor v22.16b,v17.16b,v18.16b -+ add w13,w13,w19 -+ ushr v1.4s,v20.4s,#25 -+ add w14,w14,w20 -+ ushr v5.4s,v21.4s,#25 -+ eor w10,w10,w15 -+ ushr v17.4s,v22.4s,#25 -+ eor w11,w11,w16 -+ sli v1.4s,v20.4s,#7 -+ eor w12,w12,w13 -+ sli v5.4s,v21.4s,#7 -+ eor w9,w9,w14 -+ sli v17.4s,v22.4s,#7 -+ ror w10,w10,#25 -+ ext v2.16b,v2.16b,v2.16b,#8 -+ ror w11,w11,#25 -+ ext v6.16b,v6.16b,v6.16b,#8 -+ ror w12,w12,#25 -+ ext v18.16b,v18.16b,v18.16b,#8 -+ ror w9,w9,#25 -+ ext v3.16b,v3.16b,v3.16b,#4 -+ ext v7.16b,v7.16b,v7.16b,#4 -+ ext v19.16b,v19.16b,v19.16b,#4 -+ ext v1.16b,v1.16b,v1.16b,#12 -+ ext v5.16b,v5.16b,v5.16b,#12 -+ ext v17.16b,v17.16b,v17.16b,#12 -+ cbnz x4,.Loop_neon -+ -+ add w5,w5,w22 // accumulate key block -+ add v0.4s,v0.4s,v24.4s -+ add x6,x6,x22,lsr#32 -+ add v4.4s,v4.4s,v24.4s -+ add w7,w7,w23 -+ add v16.4s,v16.4s,v24.4s -+ add x8,x8,x23,lsr#32 -+ add v2.4s,v2.4s,v26.4s -+ add w9,w9,w24 -+ add v6.4s,v6.4s,v26.4s -+ add x10,x10,x24,lsr#32 -+ add v18.4s,v18.4s,v26.4s -+ add w11,w11,w25 -+ add v3.4s,v3.4s,v27.4s -+ add x12,x12,x25,lsr#32 -+ add w13,w13,w26 -+ add v7.4s,v7.4s,v28.4s -+ add x14,x14,x26,lsr#32 -+ add w15,w15,w27 -+ add v19.4s,v19.4s,v29.4s -+ add x16,x16,x27,lsr#32 -+ add w17,w17,w28 -+ add v1.4s,v1.4s,v25.4s -+ add x19,x19,x28,lsr#32 -+ add w20,w20,w30 -+ add v5.4s,v5.4s,v25.4s -+ add x21,x21,x30,lsr#32 -+ add v17.4s,v17.4s,v25.4s -+ -+ b.lo .Ltail_neon -+ -+ add x5,x5,x6,lsl#32 // pack -+ add x7,x7,x8,lsl#32 -+ ldp x6,x8,[x1,#0] // load input -+ add x9,x9,x10,lsl#32 -+ add x11,x11,x12,lsl#32 -+ ldp x10,x12,[x1,#16] -+ add x13,x13,x14,lsl#32 -+ add x15,x15,x16,lsl#32 -+ ldp x14,x16,[x1,#32] -+ add x17,x17,x19,lsl#32 -+ add x20,x20,x21,lsl#32 -+ ldp x19,x21,[x1,#48] -+ add x1,x1,#64 -+#ifdef __ARMEB__ -+ rev x5,x5 -+ rev x7,x7 -+ rev x9,x9 -+ rev x11,x11 -+ rev x13,x13 -+ rev x15,x15 -+ rev x17,x17 -+ rev x20,x20 -+#endif -+ ld1 {v20.16b,v21.16b,v22.16b,v23.16b},[x1],#64 -+ eor x5,x5,x6 -+ eor x7,x7,x8 -+ eor x9,x9,x10 -+ eor x11,x11,x12 -+ eor x13,x13,x14 -+ eor v0.16b,v0.16b,v20.16b -+ eor x15,x15,x16 -+ eor v1.16b,v1.16b,v21.16b -+ eor x17,x17,x19 -+ eor v2.16b,v2.16b,v22.16b -+ eor x20,x20,x21 -+ eor v3.16b,v3.16b,v23.16b -+ ld1 {v20.16b,v21.16b,v22.16b,v23.16b},[x1],#64 -+ -+ stp x5,x7,[x0,#0] // store output -+ add x28,x28,#4 // increment counter -+ stp x9,x11,[x0,#16] -+ add v27.4s,v27.4s,v31.4s // += 4 -+ stp x13,x15,[x0,#32] -+ add v28.4s,v28.4s,v31.4s -+ stp x17,x20,[x0,#48] -+ add v29.4s,v29.4s,v31.4s -+ add x0,x0,#64 -+ -+ st1 {v0.16b,v1.16b,v2.16b,v3.16b},[x0],#64 -+ ld1 {v0.16b,v1.16b,v2.16b,v3.16b},[x1],#64 -+ -+ eor v4.16b,v4.16b,v20.16b -+ eor v5.16b,v5.16b,v21.16b -+ eor v6.16b,v6.16b,v22.16b -+ eor v7.16b,v7.16b,v23.16b -+ st1 {v4.16b,v5.16b,v6.16b,v7.16b},[x0],#64 -+ -+ eor v16.16b,v16.16b,v0.16b -+ eor v17.16b,v17.16b,v1.16b -+ eor v18.16b,v18.16b,v2.16b -+ eor v19.16b,v19.16b,v3.16b -+ st1 {v16.16b,v17.16b,v18.16b,v19.16b},[x0],#64 -+ -+ b.hi .Loop_outer_neon -+ -+ ldp x19,x20,[x29,#16] -+ add sp,sp,#64 -+ ldp x21,x22,[x29,#32] -+ ldp x23,x24,[x29,#48] -+ ldp x25,x26,[x29,#64] -+ ldp x27,x28,[x29,#80] -+ ldp x29,x30,[sp],#96 -+ ret -+ -+.Ltail_neon: -+ add x2,x2,#256 -+ cmp x2,#64 -+ b.lo .Less_than_64 -+ -+ add x5,x5,x6,lsl#32 // pack -+ add x7,x7,x8,lsl#32 -+ ldp x6,x8,[x1,#0] // load input -+ add x9,x9,x10,lsl#32 -+ add x11,x11,x12,lsl#32 -+ ldp x10,x12,[x1,#16] -+ add x13,x13,x14,lsl#32 -+ add x15,x15,x16,lsl#32 -+ ldp x14,x16,[x1,#32] -+ add x17,x17,x19,lsl#32 -+ add x20,x20,x21,lsl#32 -+ ldp x19,x21,[x1,#48] -+ add x1,x1,#64 -+#ifdef __ARMEB__ -+ rev x5,x5 -+ rev x7,x7 -+ rev x9,x9 -+ rev x11,x11 -+ rev x13,x13 -+ rev x15,x15 -+ rev x17,x17 -+ rev x20,x20 -+#endif -+ eor x5,x5,x6 -+ eor x7,x7,x8 -+ eor x9,x9,x10 -+ eor x11,x11,x12 -+ eor x13,x13,x14 -+ eor x15,x15,x16 -+ eor x17,x17,x19 -+ eor x20,x20,x21 -+ -+ stp x5,x7,[x0,#0] // store output -+ add x28,x28,#4 // increment counter -+ stp x9,x11,[x0,#16] -+ stp x13,x15,[x0,#32] -+ stp x17,x20,[x0,#48] -+ add x0,x0,#64 -+ b.eq .Ldone_neon -+ sub x2,x2,#64 -+ cmp x2,#64 -+ b.lo .Less_than_128 -+ -+ ld1 {v20.16b,v21.16b,v22.16b,v23.16b},[x1],#64 -+ eor v0.16b,v0.16b,v20.16b -+ eor v1.16b,v1.16b,v21.16b -+ eor v2.16b,v2.16b,v22.16b -+ eor v3.16b,v3.16b,v23.16b -+ st1 {v0.16b,v1.16b,v2.16b,v3.16b},[x0],#64 -+ b.eq .Ldone_neon -+ sub x2,x2,#64 -+ cmp x2,#64 -+ b.lo .Less_than_192 -+ -+ ld1 {v20.16b,v21.16b,v22.16b,v23.16b},[x1],#64 -+ eor v4.16b,v4.16b,v20.16b -+ eor v5.16b,v5.16b,v21.16b -+ eor v6.16b,v6.16b,v22.16b -+ eor v7.16b,v7.16b,v23.16b -+ st1 {v4.16b,v5.16b,v6.16b,v7.16b},[x0],#64 -+ b.eq .Ldone_neon -+ sub x2,x2,#64 -+ -+ st1 {v16.16b,v17.16b,v18.16b,v19.16b},[sp] -+ b .Last_neon -+ -+.Less_than_128: -+ st1 {v0.16b,v1.16b,v2.16b,v3.16b},[sp] -+ b .Last_neon -+.Less_than_192: -+ st1 {v4.16b,v5.16b,v6.16b,v7.16b},[sp] -+ b .Last_neon -+ -+.align 4 -+.Last_neon: -+ sub x0,x0,#1 -+ add x1,x1,x2 -+ add x0,x0,x2 -+ add x4,sp,x2 -+ neg x2,x2 -+ -+.Loop_tail_neon: -+ ldrb w10,[x1,x2] -+ ldrb w11,[x4,x2] -+ add x2,x2,#1 -+ eor w10,w10,w11 -+ strb w10,[x0,x2] -+ cbnz x2,.Loop_tail_neon -+ -+ stp xzr,xzr,[sp,#0] -+ stp xzr,xzr,[sp,#16] -+ stp xzr,xzr,[sp,#32] -+ stp xzr,xzr,[sp,#48] -+ -+.Ldone_neon: -+ ldp x19,x20,[x29,#16] -+ add sp,sp,#64 -+ ldp x21,x22,[x29,#32] -+ ldp x23,x24,[x29,#48] -+ ldp x25,x26,[x29,#64] -+ ldp x27,x28,[x29,#80] -+ ldp x29,x30,[sp],#96 -+ ret -+ -+.L512_or_more_neon: -+ sub sp,sp,#128+64 -+ -+ ldp x22,x23,[x5] // load sigma -+ ld1 {v24.4s},[x5],#16 -+ ldp x24,x25,[x3] // load key -+ ldp x26,x27,[x3,#16] -+ ld1 {v25.4s,v26.4s},[x3] -+ ldp x28,x30,[x4] // load counter -+ ld1 {v27.4s},[x4] -+ ld1 {v31.4s},[x5] -+#ifdef __ARMEB__ -+ rev64 v24.4s,v24.4s -+ ror x24,x24,#32 -+ ror x25,x25,#32 -+ ror x26,x26,#32 -+ ror x27,x27,#32 -+ ror x28,x28,#32 -+ ror x30,x30,#32 -+#endif -+ add v27.4s,v27.4s,v31.4s // += 1 -+ stp q24,q25,[sp,#0] // off-load key block, invariant part -+ add v27.4s,v27.4s,v31.4s // not typo -+ str q26,[sp,#32] -+ add v28.4s,v27.4s,v31.4s -+ add v29.4s,v28.4s,v31.4s -+ add v30.4s,v29.4s,v31.4s -+ shl v31.4s,v31.4s,#2 // 1 -> 4 -+ -+ stp d8,d9,[sp,#128+0] // meet ABI requirements -+ stp d10,d11,[sp,#128+16] -+ stp d12,d13,[sp,#128+32] -+ stp d14,d15,[sp,#128+48] -+ -+ sub x2,x2,#512 // not typo -+ -+.Loop_outer_512_neon: -+ mov v0.16b,v24.16b -+ mov v4.16b,v24.16b -+ mov v8.16b,v24.16b -+ mov v12.16b,v24.16b -+ mov v16.16b,v24.16b -+ mov v20.16b,v24.16b -+ mov v1.16b,v25.16b -+ mov w5,w22 // unpack key block -+ mov v5.16b,v25.16b -+ lsr x6,x22,#32 -+ mov v9.16b,v25.16b -+ mov w7,w23 -+ mov v13.16b,v25.16b -+ lsr x8,x23,#32 -+ mov v17.16b,v25.16b -+ mov w9,w24 -+ mov v21.16b,v25.16b -+ lsr x10,x24,#32 -+ mov v3.16b,v27.16b -+ mov w11,w25 -+ mov v7.16b,v28.16b -+ lsr x12,x25,#32 -+ mov v11.16b,v29.16b -+ mov w13,w26 -+ mov v15.16b,v30.16b -+ lsr x14,x26,#32 -+ mov v2.16b,v26.16b -+ mov w15,w27 -+ mov v6.16b,v26.16b -+ lsr x16,x27,#32 -+ add v19.4s,v3.4s,v31.4s // +4 -+ mov w17,w28 -+ add v23.4s,v7.4s,v31.4s // +4 -+ lsr x19,x28,#32 -+ mov v10.16b,v26.16b -+ mov w20,w30 -+ mov v14.16b,v26.16b -+ lsr x21,x30,#32 -+ mov v18.16b,v26.16b -+ stp q27,q28,[sp,#48] // off-load key block, variable part -+ mov v22.16b,v26.16b -+ str q29,[sp,#80] -+ -+ mov x4,#5 -+ subs x2,x2,#512 -+.Loop_upper_neon: -+ sub x4,x4,#1 -+ add v0.4s,v0.4s,v1.4s -+ add w5,w5,w9 -+ add v4.4s,v4.4s,v5.4s -+ add w6,w6,w10 -+ add v8.4s,v8.4s,v9.4s -+ add w7,w7,w11 -+ add v12.4s,v12.4s,v13.4s -+ add w8,w8,w12 -+ add v16.4s,v16.4s,v17.4s -+ eor w17,w17,w5 -+ add v20.4s,v20.4s,v21.4s -+ eor w19,w19,w6 -+ eor v3.16b,v3.16b,v0.16b -+ eor w20,w20,w7 -+ eor v7.16b,v7.16b,v4.16b -+ eor w21,w21,w8 -+ eor v11.16b,v11.16b,v8.16b -+ ror w17,w17,#16 -+ eor v15.16b,v15.16b,v12.16b -+ ror w19,w19,#16 -+ eor v19.16b,v19.16b,v16.16b -+ ror w20,w20,#16 -+ eor v23.16b,v23.16b,v20.16b -+ ror w21,w21,#16 -+ rev32 v3.8h,v3.8h -+ add w13,w13,w17 -+ rev32 v7.8h,v7.8h -+ add w14,w14,w19 -+ rev32 v11.8h,v11.8h -+ add w15,w15,w20 -+ rev32 v15.8h,v15.8h -+ add w16,w16,w21 -+ rev32 v19.8h,v19.8h -+ eor w9,w9,w13 -+ rev32 v23.8h,v23.8h -+ eor w10,w10,w14 -+ add v2.4s,v2.4s,v3.4s -+ eor w11,w11,w15 -+ add v6.4s,v6.4s,v7.4s -+ eor w12,w12,w16 -+ add v10.4s,v10.4s,v11.4s -+ ror w9,w9,#20 -+ add v14.4s,v14.4s,v15.4s -+ ror w10,w10,#20 -+ add v18.4s,v18.4s,v19.4s -+ ror w11,w11,#20 -+ add v22.4s,v22.4s,v23.4s -+ ror w12,w12,#20 -+ eor v24.16b,v1.16b,v2.16b -+ add w5,w5,w9 -+ eor v25.16b,v5.16b,v6.16b -+ add w6,w6,w10 -+ eor v26.16b,v9.16b,v10.16b -+ add w7,w7,w11 -+ eor v27.16b,v13.16b,v14.16b -+ add w8,w8,w12 -+ eor v28.16b,v17.16b,v18.16b -+ eor w17,w17,w5 -+ eor v29.16b,v21.16b,v22.16b -+ eor w19,w19,w6 -+ ushr v1.4s,v24.4s,#20 -+ eor w20,w20,w7 -+ ushr v5.4s,v25.4s,#20 -+ eor w21,w21,w8 -+ ushr v9.4s,v26.4s,#20 -+ ror w17,w17,#24 -+ ushr v13.4s,v27.4s,#20 -+ ror w19,w19,#24 -+ ushr v17.4s,v28.4s,#20 -+ ror w20,w20,#24 -+ ushr v21.4s,v29.4s,#20 -+ ror w21,w21,#24 -+ sli v1.4s,v24.4s,#12 -+ add w13,w13,w17 -+ sli v5.4s,v25.4s,#12 -+ add w14,w14,w19 -+ sli v9.4s,v26.4s,#12 -+ add w15,w15,w20 -+ sli v13.4s,v27.4s,#12 -+ add w16,w16,w21 -+ sli v17.4s,v28.4s,#12 -+ eor w9,w9,w13 -+ sli v21.4s,v29.4s,#12 -+ eor w10,w10,w14 -+ add v0.4s,v0.4s,v1.4s -+ eor w11,w11,w15 -+ add v4.4s,v4.4s,v5.4s -+ eor w12,w12,w16 -+ add v8.4s,v8.4s,v9.4s -+ ror w9,w9,#25 -+ add v12.4s,v12.4s,v13.4s -+ ror w10,w10,#25 -+ add v16.4s,v16.4s,v17.4s -+ ror w11,w11,#25 -+ add v20.4s,v20.4s,v21.4s -+ ror w12,w12,#25 -+ eor v24.16b,v3.16b,v0.16b -+ add w5,w5,w10 -+ eor v25.16b,v7.16b,v4.16b -+ add w6,w6,w11 -+ eor v26.16b,v11.16b,v8.16b -+ add w7,w7,w12 -+ eor v27.16b,v15.16b,v12.16b -+ add w8,w8,w9 -+ eor v28.16b,v19.16b,v16.16b -+ eor w21,w21,w5 -+ eor v29.16b,v23.16b,v20.16b -+ eor w17,w17,w6 -+ ushr v3.4s,v24.4s,#24 -+ eor w19,w19,w7 -+ ushr v7.4s,v25.4s,#24 -+ eor w20,w20,w8 -+ ushr v11.4s,v26.4s,#24 -+ ror w21,w21,#16 -+ ushr v15.4s,v27.4s,#24 -+ ror w17,w17,#16 -+ ushr v19.4s,v28.4s,#24 -+ ror w19,w19,#16 -+ ushr v23.4s,v29.4s,#24 -+ ror w20,w20,#16 -+ sli v3.4s,v24.4s,#8 -+ add w15,w15,w21 -+ sli v7.4s,v25.4s,#8 -+ add w16,w16,w17 -+ sli v11.4s,v26.4s,#8 -+ add w13,w13,w19 -+ sli v15.4s,v27.4s,#8 -+ add w14,w14,w20 -+ sli v19.4s,v28.4s,#8 -+ eor w10,w10,w15 -+ sli v23.4s,v29.4s,#8 -+ eor w11,w11,w16 -+ add v2.4s,v2.4s,v3.4s -+ eor w12,w12,w13 -+ add v6.4s,v6.4s,v7.4s -+ eor w9,w9,w14 -+ add v10.4s,v10.4s,v11.4s -+ ror w10,w10,#20 -+ add v14.4s,v14.4s,v15.4s -+ ror w11,w11,#20 -+ add v18.4s,v18.4s,v19.4s -+ ror w12,w12,#20 -+ add v22.4s,v22.4s,v23.4s -+ ror w9,w9,#20 -+ eor v24.16b,v1.16b,v2.16b -+ add w5,w5,w10 -+ eor v25.16b,v5.16b,v6.16b -+ add w6,w6,w11 -+ eor v26.16b,v9.16b,v10.16b -+ add w7,w7,w12 -+ eor v27.16b,v13.16b,v14.16b -+ add w8,w8,w9 -+ eor v28.16b,v17.16b,v18.16b -+ eor w21,w21,w5 -+ eor v29.16b,v21.16b,v22.16b -+ eor w17,w17,w6 -+ ushr v1.4s,v24.4s,#25 -+ eor w19,w19,w7 -+ ushr v5.4s,v25.4s,#25 -+ eor w20,w20,w8 -+ ushr v9.4s,v26.4s,#25 -+ ror w21,w21,#24 -+ ushr v13.4s,v27.4s,#25 -+ ror w17,w17,#24 -+ ushr v17.4s,v28.4s,#25 -+ ror w19,w19,#24 -+ ushr v21.4s,v29.4s,#25 -+ ror w20,w20,#24 -+ sli v1.4s,v24.4s,#7 -+ add w15,w15,w21 -+ sli v5.4s,v25.4s,#7 -+ add w16,w16,w17 -+ sli v9.4s,v26.4s,#7 -+ add w13,w13,w19 -+ sli v13.4s,v27.4s,#7 -+ add w14,w14,w20 -+ sli v17.4s,v28.4s,#7 -+ eor w10,w10,w15 -+ sli v21.4s,v29.4s,#7 -+ eor w11,w11,w16 -+ ext v2.16b,v2.16b,v2.16b,#8 -+ eor w12,w12,w13 -+ ext v6.16b,v6.16b,v6.16b,#8 -+ eor w9,w9,w14 -+ ext v10.16b,v10.16b,v10.16b,#8 -+ ror w10,w10,#25 -+ ext v14.16b,v14.16b,v14.16b,#8 -+ ror w11,w11,#25 -+ ext v18.16b,v18.16b,v18.16b,#8 -+ ror w12,w12,#25 -+ ext v22.16b,v22.16b,v22.16b,#8 -+ ror w9,w9,#25 -+ ext v3.16b,v3.16b,v3.16b,#12 -+ ext v7.16b,v7.16b,v7.16b,#12 -+ ext v11.16b,v11.16b,v11.16b,#12 -+ ext v15.16b,v15.16b,v15.16b,#12 -+ ext v19.16b,v19.16b,v19.16b,#12 -+ ext v23.16b,v23.16b,v23.16b,#12 -+ ext v1.16b,v1.16b,v1.16b,#4 -+ ext v5.16b,v5.16b,v5.16b,#4 -+ ext v9.16b,v9.16b,v9.16b,#4 -+ ext v13.16b,v13.16b,v13.16b,#4 -+ ext v17.16b,v17.16b,v17.16b,#4 -+ ext v21.16b,v21.16b,v21.16b,#4 -+ add v0.4s,v0.4s,v1.4s -+ add w5,w5,w9 -+ add v4.4s,v4.4s,v5.4s -+ add w6,w6,w10 -+ add v8.4s,v8.4s,v9.4s -+ add w7,w7,w11 -+ add v12.4s,v12.4s,v13.4s -+ add w8,w8,w12 -+ add v16.4s,v16.4s,v17.4s -+ eor w17,w17,w5 -+ add v20.4s,v20.4s,v21.4s -+ eor w19,w19,w6 -+ eor v3.16b,v3.16b,v0.16b -+ eor w20,w20,w7 -+ eor v7.16b,v7.16b,v4.16b -+ eor w21,w21,w8 -+ eor v11.16b,v11.16b,v8.16b -+ ror w17,w17,#16 -+ eor v15.16b,v15.16b,v12.16b -+ ror w19,w19,#16 -+ eor v19.16b,v19.16b,v16.16b -+ ror w20,w20,#16 -+ eor v23.16b,v23.16b,v20.16b -+ ror w21,w21,#16 -+ rev32 v3.8h,v3.8h -+ add w13,w13,w17 -+ rev32 v7.8h,v7.8h -+ add w14,w14,w19 -+ rev32 v11.8h,v11.8h -+ add w15,w15,w20 -+ rev32 v15.8h,v15.8h -+ add w16,w16,w21 -+ rev32 v19.8h,v19.8h -+ eor w9,w9,w13 -+ rev32 v23.8h,v23.8h -+ eor w10,w10,w14 -+ add v2.4s,v2.4s,v3.4s -+ eor w11,w11,w15 -+ add v6.4s,v6.4s,v7.4s -+ eor w12,w12,w16 -+ add v10.4s,v10.4s,v11.4s -+ ror w9,w9,#20 -+ add v14.4s,v14.4s,v15.4s -+ ror w10,w10,#20 -+ add v18.4s,v18.4s,v19.4s -+ ror w11,w11,#20 -+ add v22.4s,v22.4s,v23.4s -+ ror w12,w12,#20 -+ eor v24.16b,v1.16b,v2.16b -+ add w5,w5,w9 -+ eor v25.16b,v5.16b,v6.16b -+ add w6,w6,w10 -+ eor v26.16b,v9.16b,v10.16b -+ add w7,w7,w11 -+ eor v27.16b,v13.16b,v14.16b -+ add w8,w8,w12 -+ eor v28.16b,v17.16b,v18.16b -+ eor w17,w17,w5 -+ eor v29.16b,v21.16b,v22.16b -+ eor w19,w19,w6 -+ ushr v1.4s,v24.4s,#20 -+ eor w20,w20,w7 -+ ushr v5.4s,v25.4s,#20 -+ eor w21,w21,w8 -+ ushr v9.4s,v26.4s,#20 -+ ror w17,w17,#24 -+ ushr v13.4s,v27.4s,#20 -+ ror w19,w19,#24 -+ ushr v17.4s,v28.4s,#20 -+ ror w20,w20,#24 -+ ushr v21.4s,v29.4s,#20 -+ ror w21,w21,#24 -+ sli v1.4s,v24.4s,#12 -+ add w13,w13,w17 -+ sli v5.4s,v25.4s,#12 -+ add w14,w14,w19 -+ sli v9.4s,v26.4s,#12 -+ add w15,w15,w20 -+ sli v13.4s,v27.4s,#12 -+ add w16,w16,w21 -+ sli v17.4s,v28.4s,#12 -+ eor w9,w9,w13 -+ sli v21.4s,v29.4s,#12 -+ eor w10,w10,w14 -+ add v0.4s,v0.4s,v1.4s -+ eor w11,w11,w15 -+ add v4.4s,v4.4s,v5.4s -+ eor w12,w12,w16 -+ add v8.4s,v8.4s,v9.4s -+ ror w9,w9,#25 -+ add v12.4s,v12.4s,v13.4s -+ ror w10,w10,#25 -+ add v16.4s,v16.4s,v17.4s -+ ror w11,w11,#25 -+ add v20.4s,v20.4s,v21.4s -+ ror w12,w12,#25 -+ eor v24.16b,v3.16b,v0.16b -+ add w5,w5,w10 -+ eor v25.16b,v7.16b,v4.16b -+ add w6,w6,w11 -+ eor v26.16b,v11.16b,v8.16b -+ add w7,w7,w12 -+ eor v27.16b,v15.16b,v12.16b -+ add w8,w8,w9 -+ eor v28.16b,v19.16b,v16.16b -+ eor w21,w21,w5 -+ eor v29.16b,v23.16b,v20.16b -+ eor w17,w17,w6 -+ ushr v3.4s,v24.4s,#24 -+ eor w19,w19,w7 -+ ushr v7.4s,v25.4s,#24 -+ eor w20,w20,w8 -+ ushr v11.4s,v26.4s,#24 -+ ror w21,w21,#16 -+ ushr v15.4s,v27.4s,#24 -+ ror w17,w17,#16 -+ ushr v19.4s,v28.4s,#24 -+ ror w19,w19,#16 -+ ushr v23.4s,v29.4s,#24 -+ ror w20,w20,#16 -+ sli v3.4s,v24.4s,#8 -+ add w15,w15,w21 -+ sli v7.4s,v25.4s,#8 -+ add w16,w16,w17 -+ sli v11.4s,v26.4s,#8 -+ add w13,w13,w19 -+ sli v15.4s,v27.4s,#8 -+ add w14,w14,w20 -+ sli v19.4s,v28.4s,#8 -+ eor w10,w10,w15 -+ sli v23.4s,v29.4s,#8 -+ eor w11,w11,w16 -+ add v2.4s,v2.4s,v3.4s -+ eor w12,w12,w13 -+ add v6.4s,v6.4s,v7.4s -+ eor w9,w9,w14 -+ add v10.4s,v10.4s,v11.4s -+ ror w10,w10,#20 -+ add v14.4s,v14.4s,v15.4s -+ ror w11,w11,#20 -+ add v18.4s,v18.4s,v19.4s -+ ror w12,w12,#20 -+ add v22.4s,v22.4s,v23.4s -+ ror w9,w9,#20 -+ eor v24.16b,v1.16b,v2.16b -+ add w5,w5,w10 -+ eor v25.16b,v5.16b,v6.16b -+ add w6,w6,w11 -+ eor v26.16b,v9.16b,v10.16b -+ add w7,w7,w12 -+ eor v27.16b,v13.16b,v14.16b -+ add w8,w8,w9 -+ eor v28.16b,v17.16b,v18.16b -+ eor w21,w21,w5 -+ eor v29.16b,v21.16b,v22.16b -+ eor w17,w17,w6 -+ ushr v1.4s,v24.4s,#25 -+ eor w19,w19,w7 -+ ushr v5.4s,v25.4s,#25 -+ eor w20,w20,w8 -+ ushr v9.4s,v26.4s,#25 -+ ror w21,w21,#24 -+ ushr v13.4s,v27.4s,#25 -+ ror w17,w17,#24 -+ ushr v17.4s,v28.4s,#25 -+ ror w19,w19,#24 -+ ushr v21.4s,v29.4s,#25 -+ ror w20,w20,#24 -+ sli v1.4s,v24.4s,#7 -+ add w15,w15,w21 -+ sli v5.4s,v25.4s,#7 -+ add w16,w16,w17 -+ sli v9.4s,v26.4s,#7 -+ add w13,w13,w19 -+ sli v13.4s,v27.4s,#7 -+ add w14,w14,w20 -+ sli v17.4s,v28.4s,#7 -+ eor w10,w10,w15 -+ sli v21.4s,v29.4s,#7 -+ eor w11,w11,w16 -+ ext v2.16b,v2.16b,v2.16b,#8 -+ eor w12,w12,w13 -+ ext v6.16b,v6.16b,v6.16b,#8 -+ eor w9,w9,w14 -+ ext v10.16b,v10.16b,v10.16b,#8 -+ ror w10,w10,#25 -+ ext v14.16b,v14.16b,v14.16b,#8 -+ ror w11,w11,#25 -+ ext v18.16b,v18.16b,v18.16b,#8 -+ ror w12,w12,#25 -+ ext v22.16b,v22.16b,v22.16b,#8 -+ ror w9,w9,#25 -+ ext v3.16b,v3.16b,v3.16b,#4 -+ ext v7.16b,v7.16b,v7.16b,#4 -+ ext v11.16b,v11.16b,v11.16b,#4 -+ ext v15.16b,v15.16b,v15.16b,#4 -+ ext v19.16b,v19.16b,v19.16b,#4 -+ ext v23.16b,v23.16b,v23.16b,#4 -+ ext v1.16b,v1.16b,v1.16b,#12 -+ ext v5.16b,v5.16b,v5.16b,#12 -+ ext v9.16b,v9.16b,v9.16b,#12 -+ ext v13.16b,v13.16b,v13.16b,#12 -+ ext v17.16b,v17.16b,v17.16b,#12 -+ ext v21.16b,v21.16b,v21.16b,#12 -+ cbnz x4,.Loop_upper_neon -+ -+ add w5,w5,w22 // accumulate key block -+ add x6,x6,x22,lsr#32 -+ add w7,w7,w23 -+ add x8,x8,x23,lsr#32 -+ add w9,w9,w24 -+ add x10,x10,x24,lsr#32 -+ add w11,w11,w25 -+ add x12,x12,x25,lsr#32 -+ add w13,w13,w26 -+ add x14,x14,x26,lsr#32 -+ add w15,w15,w27 -+ add x16,x16,x27,lsr#32 -+ add w17,w17,w28 -+ add x19,x19,x28,lsr#32 -+ add w20,w20,w30 -+ add x21,x21,x30,lsr#32 -+ -+ add x5,x5,x6,lsl#32 // pack -+ add x7,x7,x8,lsl#32 -+ ldp x6,x8,[x1,#0] // load input -+ add x9,x9,x10,lsl#32 -+ add x11,x11,x12,lsl#32 -+ ldp x10,x12,[x1,#16] -+ add x13,x13,x14,lsl#32 -+ add x15,x15,x16,lsl#32 -+ ldp x14,x16,[x1,#32] -+ add x17,x17,x19,lsl#32 -+ add x20,x20,x21,lsl#32 -+ ldp x19,x21,[x1,#48] -+ add x1,x1,#64 -+#ifdef __ARMEB__ -+ rev x5,x5 -+ rev x7,x7 -+ rev x9,x9 -+ rev x11,x11 -+ rev x13,x13 -+ rev x15,x15 -+ rev x17,x17 -+ rev x20,x20 -+#endif -+ eor x5,x5,x6 -+ eor x7,x7,x8 -+ eor x9,x9,x10 -+ eor x11,x11,x12 -+ eor x13,x13,x14 -+ eor x15,x15,x16 -+ eor x17,x17,x19 -+ eor x20,x20,x21 -+ -+ stp x5,x7,[x0,#0] // store output -+ add x28,x28,#1 // increment counter -+ mov w5,w22 // unpack key block -+ lsr x6,x22,#32 -+ stp x9,x11,[x0,#16] -+ mov w7,w23 -+ lsr x8,x23,#32 -+ stp x13,x15,[x0,#32] -+ mov w9,w24 -+ lsr x10,x24,#32 -+ stp x17,x20,[x0,#48] -+ add x0,x0,#64 -+ mov w11,w25 -+ lsr x12,x25,#32 -+ mov w13,w26 -+ lsr x14,x26,#32 -+ mov w15,w27 -+ lsr x16,x27,#32 -+ mov w17,w28 -+ lsr x19,x28,#32 -+ mov w20,w30 -+ lsr x21,x30,#32 -+ -+ mov x4,#5 -+.Loop_lower_neon: -+ sub x4,x4,#1 -+ add v0.4s,v0.4s,v1.4s -+ add w5,w5,w9 -+ add v4.4s,v4.4s,v5.4s -+ add w6,w6,w10 -+ add v8.4s,v8.4s,v9.4s -+ add w7,w7,w11 -+ add v12.4s,v12.4s,v13.4s -+ add w8,w8,w12 -+ add v16.4s,v16.4s,v17.4s -+ eor w17,w17,w5 -+ add v20.4s,v20.4s,v21.4s -+ eor w19,w19,w6 -+ eor v3.16b,v3.16b,v0.16b -+ eor w20,w20,w7 -+ eor v7.16b,v7.16b,v4.16b -+ eor w21,w21,w8 -+ eor v11.16b,v11.16b,v8.16b -+ ror w17,w17,#16 -+ eor v15.16b,v15.16b,v12.16b -+ ror w19,w19,#16 -+ eor v19.16b,v19.16b,v16.16b -+ ror w20,w20,#16 -+ eor v23.16b,v23.16b,v20.16b -+ ror w21,w21,#16 -+ rev32 v3.8h,v3.8h -+ add w13,w13,w17 -+ rev32 v7.8h,v7.8h -+ add w14,w14,w19 -+ rev32 v11.8h,v11.8h -+ add w15,w15,w20 -+ rev32 v15.8h,v15.8h -+ add w16,w16,w21 -+ rev32 v19.8h,v19.8h -+ eor w9,w9,w13 -+ rev32 v23.8h,v23.8h -+ eor w10,w10,w14 -+ add v2.4s,v2.4s,v3.4s -+ eor w11,w11,w15 -+ add v6.4s,v6.4s,v7.4s -+ eor w12,w12,w16 -+ add v10.4s,v10.4s,v11.4s -+ ror w9,w9,#20 -+ add v14.4s,v14.4s,v15.4s -+ ror w10,w10,#20 -+ add v18.4s,v18.4s,v19.4s -+ ror w11,w11,#20 -+ add v22.4s,v22.4s,v23.4s -+ ror w12,w12,#20 -+ eor v24.16b,v1.16b,v2.16b -+ add w5,w5,w9 -+ eor v25.16b,v5.16b,v6.16b -+ add w6,w6,w10 -+ eor v26.16b,v9.16b,v10.16b -+ add w7,w7,w11 -+ eor v27.16b,v13.16b,v14.16b -+ add w8,w8,w12 -+ eor v28.16b,v17.16b,v18.16b -+ eor w17,w17,w5 -+ eor v29.16b,v21.16b,v22.16b -+ eor w19,w19,w6 -+ ushr v1.4s,v24.4s,#20 -+ eor w20,w20,w7 -+ ushr v5.4s,v25.4s,#20 -+ eor w21,w21,w8 -+ ushr v9.4s,v26.4s,#20 -+ ror w17,w17,#24 -+ ushr v13.4s,v27.4s,#20 -+ ror w19,w19,#24 -+ ushr v17.4s,v28.4s,#20 -+ ror w20,w20,#24 -+ ushr v21.4s,v29.4s,#20 -+ ror w21,w21,#24 -+ sli v1.4s,v24.4s,#12 -+ add w13,w13,w17 -+ sli v5.4s,v25.4s,#12 -+ add w14,w14,w19 -+ sli v9.4s,v26.4s,#12 -+ add w15,w15,w20 -+ sli v13.4s,v27.4s,#12 -+ add w16,w16,w21 -+ sli v17.4s,v28.4s,#12 -+ eor w9,w9,w13 -+ sli v21.4s,v29.4s,#12 -+ eor w10,w10,w14 -+ add v0.4s,v0.4s,v1.4s -+ eor w11,w11,w15 -+ add v4.4s,v4.4s,v5.4s -+ eor w12,w12,w16 -+ add v8.4s,v8.4s,v9.4s -+ ror w9,w9,#25 -+ add v12.4s,v12.4s,v13.4s -+ ror w10,w10,#25 -+ add v16.4s,v16.4s,v17.4s -+ ror w11,w11,#25 -+ add v20.4s,v20.4s,v21.4s -+ ror w12,w12,#25 -+ eor v24.16b,v3.16b,v0.16b -+ add w5,w5,w10 -+ eor v25.16b,v7.16b,v4.16b -+ add w6,w6,w11 -+ eor v26.16b,v11.16b,v8.16b -+ add w7,w7,w12 -+ eor v27.16b,v15.16b,v12.16b -+ add w8,w8,w9 -+ eor v28.16b,v19.16b,v16.16b -+ eor w21,w21,w5 -+ eor v29.16b,v23.16b,v20.16b -+ eor w17,w17,w6 -+ ushr v3.4s,v24.4s,#24 -+ eor w19,w19,w7 -+ ushr v7.4s,v25.4s,#24 -+ eor w20,w20,w8 -+ ushr v11.4s,v26.4s,#24 -+ ror w21,w21,#16 -+ ushr v15.4s,v27.4s,#24 -+ ror w17,w17,#16 -+ ushr v19.4s,v28.4s,#24 -+ ror w19,w19,#16 -+ ushr v23.4s,v29.4s,#24 -+ ror w20,w20,#16 -+ sli v3.4s,v24.4s,#8 -+ add w15,w15,w21 -+ sli v7.4s,v25.4s,#8 -+ add w16,w16,w17 -+ sli v11.4s,v26.4s,#8 -+ add w13,w13,w19 -+ sli v15.4s,v27.4s,#8 -+ add w14,w14,w20 -+ sli v19.4s,v28.4s,#8 -+ eor w10,w10,w15 -+ sli v23.4s,v29.4s,#8 -+ eor w11,w11,w16 -+ add v2.4s,v2.4s,v3.4s -+ eor w12,w12,w13 -+ add v6.4s,v6.4s,v7.4s -+ eor w9,w9,w14 -+ add v10.4s,v10.4s,v11.4s -+ ror w10,w10,#20 -+ add v14.4s,v14.4s,v15.4s -+ ror w11,w11,#20 -+ add v18.4s,v18.4s,v19.4s -+ ror w12,w12,#20 -+ add v22.4s,v22.4s,v23.4s -+ ror w9,w9,#20 -+ eor v24.16b,v1.16b,v2.16b -+ add w5,w5,w10 -+ eor v25.16b,v5.16b,v6.16b -+ add w6,w6,w11 -+ eor v26.16b,v9.16b,v10.16b -+ add w7,w7,w12 -+ eor v27.16b,v13.16b,v14.16b -+ add w8,w8,w9 -+ eor v28.16b,v17.16b,v18.16b -+ eor w21,w21,w5 -+ eor v29.16b,v21.16b,v22.16b -+ eor w17,w17,w6 -+ ushr v1.4s,v24.4s,#25 -+ eor w19,w19,w7 -+ ushr v5.4s,v25.4s,#25 -+ eor w20,w20,w8 -+ ushr v9.4s,v26.4s,#25 -+ ror w21,w21,#24 -+ ushr v13.4s,v27.4s,#25 -+ ror w17,w17,#24 -+ ushr v17.4s,v28.4s,#25 -+ ror w19,w19,#24 -+ ushr v21.4s,v29.4s,#25 -+ ror w20,w20,#24 -+ sli v1.4s,v24.4s,#7 -+ add w15,w15,w21 -+ sli v5.4s,v25.4s,#7 -+ add w16,w16,w17 -+ sli v9.4s,v26.4s,#7 -+ add w13,w13,w19 -+ sli v13.4s,v27.4s,#7 -+ add w14,w14,w20 -+ sli v17.4s,v28.4s,#7 -+ eor w10,w10,w15 -+ sli v21.4s,v29.4s,#7 -+ eor w11,w11,w16 -+ ext v2.16b,v2.16b,v2.16b,#8 -+ eor w12,w12,w13 -+ ext v6.16b,v6.16b,v6.16b,#8 -+ eor w9,w9,w14 -+ ext v10.16b,v10.16b,v10.16b,#8 -+ ror w10,w10,#25 -+ ext v14.16b,v14.16b,v14.16b,#8 -+ ror w11,w11,#25 -+ ext v18.16b,v18.16b,v18.16b,#8 -+ ror w12,w12,#25 -+ ext v22.16b,v22.16b,v22.16b,#8 -+ ror w9,w9,#25 -+ ext v3.16b,v3.16b,v3.16b,#12 -+ ext v7.16b,v7.16b,v7.16b,#12 -+ ext v11.16b,v11.16b,v11.16b,#12 -+ ext v15.16b,v15.16b,v15.16b,#12 -+ ext v19.16b,v19.16b,v19.16b,#12 -+ ext v23.16b,v23.16b,v23.16b,#12 -+ ext v1.16b,v1.16b,v1.16b,#4 -+ ext v5.16b,v5.16b,v5.16b,#4 -+ ext v9.16b,v9.16b,v9.16b,#4 -+ ext v13.16b,v13.16b,v13.16b,#4 -+ ext v17.16b,v17.16b,v17.16b,#4 -+ ext v21.16b,v21.16b,v21.16b,#4 -+ add v0.4s,v0.4s,v1.4s -+ add w5,w5,w9 -+ add v4.4s,v4.4s,v5.4s -+ add w6,w6,w10 -+ add v8.4s,v8.4s,v9.4s -+ add w7,w7,w11 -+ add v12.4s,v12.4s,v13.4s -+ add w8,w8,w12 -+ add v16.4s,v16.4s,v17.4s -+ eor w17,w17,w5 -+ add v20.4s,v20.4s,v21.4s -+ eor w19,w19,w6 -+ eor v3.16b,v3.16b,v0.16b -+ eor w20,w20,w7 -+ eor v7.16b,v7.16b,v4.16b -+ eor w21,w21,w8 -+ eor v11.16b,v11.16b,v8.16b -+ ror w17,w17,#16 -+ eor v15.16b,v15.16b,v12.16b -+ ror w19,w19,#16 -+ eor v19.16b,v19.16b,v16.16b -+ ror w20,w20,#16 -+ eor v23.16b,v23.16b,v20.16b -+ ror w21,w21,#16 -+ rev32 v3.8h,v3.8h -+ add w13,w13,w17 -+ rev32 v7.8h,v7.8h -+ add w14,w14,w19 -+ rev32 v11.8h,v11.8h -+ add w15,w15,w20 -+ rev32 v15.8h,v15.8h -+ add w16,w16,w21 -+ rev32 v19.8h,v19.8h -+ eor w9,w9,w13 -+ rev32 v23.8h,v23.8h -+ eor w10,w10,w14 -+ add v2.4s,v2.4s,v3.4s -+ eor w11,w11,w15 -+ add v6.4s,v6.4s,v7.4s -+ eor w12,w12,w16 -+ add v10.4s,v10.4s,v11.4s -+ ror w9,w9,#20 -+ add v14.4s,v14.4s,v15.4s -+ ror w10,w10,#20 -+ add v18.4s,v18.4s,v19.4s -+ ror w11,w11,#20 -+ add v22.4s,v22.4s,v23.4s -+ ror w12,w12,#20 -+ eor v24.16b,v1.16b,v2.16b -+ add w5,w5,w9 -+ eor v25.16b,v5.16b,v6.16b -+ add w6,w6,w10 -+ eor v26.16b,v9.16b,v10.16b -+ add w7,w7,w11 -+ eor v27.16b,v13.16b,v14.16b -+ add w8,w8,w12 -+ eor v28.16b,v17.16b,v18.16b -+ eor w17,w17,w5 -+ eor v29.16b,v21.16b,v22.16b -+ eor w19,w19,w6 -+ ushr v1.4s,v24.4s,#20 -+ eor w20,w20,w7 -+ ushr v5.4s,v25.4s,#20 -+ eor w21,w21,w8 -+ ushr v9.4s,v26.4s,#20 -+ ror w17,w17,#24 -+ ushr v13.4s,v27.4s,#20 -+ ror w19,w19,#24 -+ ushr v17.4s,v28.4s,#20 -+ ror w20,w20,#24 -+ ushr v21.4s,v29.4s,#20 -+ ror w21,w21,#24 -+ sli v1.4s,v24.4s,#12 -+ add w13,w13,w17 -+ sli v5.4s,v25.4s,#12 -+ add w14,w14,w19 -+ sli v9.4s,v26.4s,#12 -+ add w15,w15,w20 -+ sli v13.4s,v27.4s,#12 -+ add w16,w16,w21 -+ sli v17.4s,v28.4s,#12 -+ eor w9,w9,w13 -+ sli v21.4s,v29.4s,#12 -+ eor w10,w10,w14 -+ add v0.4s,v0.4s,v1.4s -+ eor w11,w11,w15 -+ add v4.4s,v4.4s,v5.4s -+ eor w12,w12,w16 -+ add v8.4s,v8.4s,v9.4s -+ ror w9,w9,#25 -+ add v12.4s,v12.4s,v13.4s -+ ror w10,w10,#25 -+ add v16.4s,v16.4s,v17.4s -+ ror w11,w11,#25 -+ add v20.4s,v20.4s,v21.4s -+ ror w12,w12,#25 -+ eor v24.16b,v3.16b,v0.16b -+ add w5,w5,w10 -+ eor v25.16b,v7.16b,v4.16b -+ add w6,w6,w11 -+ eor v26.16b,v11.16b,v8.16b -+ add w7,w7,w12 -+ eor v27.16b,v15.16b,v12.16b -+ add w8,w8,w9 -+ eor v28.16b,v19.16b,v16.16b -+ eor w21,w21,w5 -+ eor v29.16b,v23.16b,v20.16b -+ eor w17,w17,w6 -+ ushr v3.4s,v24.4s,#24 -+ eor w19,w19,w7 -+ ushr v7.4s,v25.4s,#24 -+ eor w20,w20,w8 -+ ushr v11.4s,v26.4s,#24 -+ ror w21,w21,#16 -+ ushr v15.4s,v27.4s,#24 -+ ror w17,w17,#16 -+ ushr v19.4s,v28.4s,#24 -+ ror w19,w19,#16 -+ ushr v23.4s,v29.4s,#24 -+ ror w20,w20,#16 -+ sli v3.4s,v24.4s,#8 -+ add w15,w15,w21 -+ sli v7.4s,v25.4s,#8 -+ add w16,w16,w17 -+ sli v11.4s,v26.4s,#8 -+ add w13,w13,w19 -+ sli v15.4s,v27.4s,#8 -+ add w14,w14,w20 -+ sli v19.4s,v28.4s,#8 -+ eor w10,w10,w15 -+ sli v23.4s,v29.4s,#8 -+ eor w11,w11,w16 -+ add v2.4s,v2.4s,v3.4s -+ eor w12,w12,w13 -+ add v6.4s,v6.4s,v7.4s -+ eor w9,w9,w14 -+ add v10.4s,v10.4s,v11.4s -+ ror w10,w10,#20 -+ add v14.4s,v14.4s,v15.4s -+ ror w11,w11,#20 -+ add v18.4s,v18.4s,v19.4s -+ ror w12,w12,#20 -+ add v22.4s,v22.4s,v23.4s -+ ror w9,w9,#20 -+ eor v24.16b,v1.16b,v2.16b -+ add w5,w5,w10 -+ eor v25.16b,v5.16b,v6.16b -+ add w6,w6,w11 -+ eor v26.16b,v9.16b,v10.16b -+ add w7,w7,w12 -+ eor v27.16b,v13.16b,v14.16b -+ add w8,w8,w9 -+ eor v28.16b,v17.16b,v18.16b -+ eor w21,w21,w5 -+ eor v29.16b,v21.16b,v22.16b -+ eor w17,w17,w6 -+ ushr v1.4s,v24.4s,#25 -+ eor w19,w19,w7 -+ ushr v5.4s,v25.4s,#25 -+ eor w20,w20,w8 -+ ushr v9.4s,v26.4s,#25 -+ ror w21,w21,#24 -+ ushr v13.4s,v27.4s,#25 -+ ror w17,w17,#24 -+ ushr v17.4s,v28.4s,#25 -+ ror w19,w19,#24 -+ ushr v21.4s,v29.4s,#25 -+ ror w20,w20,#24 -+ sli v1.4s,v24.4s,#7 -+ add w15,w15,w21 -+ sli v5.4s,v25.4s,#7 -+ add w16,w16,w17 -+ sli v9.4s,v26.4s,#7 -+ add w13,w13,w19 -+ sli v13.4s,v27.4s,#7 -+ add w14,w14,w20 -+ sli v17.4s,v28.4s,#7 -+ eor w10,w10,w15 -+ sli v21.4s,v29.4s,#7 -+ eor w11,w11,w16 -+ ext v2.16b,v2.16b,v2.16b,#8 -+ eor w12,w12,w13 -+ ext v6.16b,v6.16b,v6.16b,#8 -+ eor w9,w9,w14 -+ ext v10.16b,v10.16b,v10.16b,#8 -+ ror w10,w10,#25 -+ ext v14.16b,v14.16b,v14.16b,#8 -+ ror w11,w11,#25 -+ ext v18.16b,v18.16b,v18.16b,#8 -+ ror w12,w12,#25 -+ ext v22.16b,v22.16b,v22.16b,#8 -+ ror w9,w9,#25 -+ ext v3.16b,v3.16b,v3.16b,#4 -+ ext v7.16b,v7.16b,v7.16b,#4 -+ ext v11.16b,v11.16b,v11.16b,#4 -+ ext v15.16b,v15.16b,v15.16b,#4 -+ ext v19.16b,v19.16b,v19.16b,#4 -+ ext v23.16b,v23.16b,v23.16b,#4 -+ ext v1.16b,v1.16b,v1.16b,#12 -+ ext v5.16b,v5.16b,v5.16b,#12 -+ ext v9.16b,v9.16b,v9.16b,#12 -+ ext v13.16b,v13.16b,v13.16b,#12 -+ ext v17.16b,v17.16b,v17.16b,#12 -+ ext v21.16b,v21.16b,v21.16b,#12 -+ cbnz x4,.Loop_lower_neon -+ -+ add w5,w5,w22 // accumulate key block -+ ldp q24,q25,[sp,#0] -+ add x6,x6,x22,lsr#32 -+ ldp q26,q27,[sp,#32] -+ add w7,w7,w23 -+ ldp q28,q29,[sp,#64] -+ add x8,x8,x23,lsr#32 -+ add v0.4s,v0.4s,v24.4s -+ add w9,w9,w24 -+ add v4.4s,v4.4s,v24.4s -+ add x10,x10,x24,lsr#32 -+ add v8.4s,v8.4s,v24.4s -+ add w11,w11,w25 -+ add v12.4s,v12.4s,v24.4s -+ add x12,x12,x25,lsr#32 -+ add v16.4s,v16.4s,v24.4s -+ add w13,w13,w26 -+ add v20.4s,v20.4s,v24.4s -+ add x14,x14,x26,lsr#32 -+ add v2.4s,v2.4s,v26.4s -+ add w15,w15,w27 -+ add v6.4s,v6.4s,v26.4s -+ add x16,x16,x27,lsr#32 -+ add v10.4s,v10.4s,v26.4s -+ add w17,w17,w28 -+ add v14.4s,v14.4s,v26.4s -+ add x19,x19,x28,lsr#32 -+ add v18.4s,v18.4s,v26.4s -+ add w20,w20,w30 -+ add v22.4s,v22.4s,v26.4s -+ add x21,x21,x30,lsr#32 -+ add v19.4s,v19.4s,v31.4s // +4 -+ add x5,x5,x6,lsl#32 // pack -+ add v23.4s,v23.4s,v31.4s // +4 -+ add x7,x7,x8,lsl#32 -+ add v3.4s,v3.4s,v27.4s -+ ldp x6,x8,[x1,#0] // load input -+ add v7.4s,v7.4s,v28.4s -+ add x9,x9,x10,lsl#32 -+ add v11.4s,v11.4s,v29.4s -+ add x11,x11,x12,lsl#32 -+ add v15.4s,v15.4s,v30.4s -+ ldp x10,x12,[x1,#16] -+ add v19.4s,v19.4s,v27.4s -+ add x13,x13,x14,lsl#32 -+ add v23.4s,v23.4s,v28.4s -+ add x15,x15,x16,lsl#32 -+ add v1.4s,v1.4s,v25.4s -+ ldp x14,x16,[x1,#32] -+ add v5.4s,v5.4s,v25.4s -+ add x17,x17,x19,lsl#32 -+ add v9.4s,v9.4s,v25.4s -+ add x20,x20,x21,lsl#32 -+ add v13.4s,v13.4s,v25.4s -+ ldp x19,x21,[x1,#48] -+ add v17.4s,v17.4s,v25.4s -+ add x1,x1,#64 -+ add v21.4s,v21.4s,v25.4s -+ -+#ifdef __ARMEB__ -+ rev x5,x5 -+ rev x7,x7 -+ rev x9,x9 -+ rev x11,x11 -+ rev x13,x13 -+ rev x15,x15 -+ rev x17,x17 -+ rev x20,x20 -+#endif -+ ld1 {v24.16b,v25.16b,v26.16b,v27.16b},[x1],#64 -+ eor x5,x5,x6 -+ eor x7,x7,x8 -+ eor x9,x9,x10 -+ eor x11,x11,x12 -+ eor x13,x13,x14 -+ eor v0.16b,v0.16b,v24.16b -+ eor x15,x15,x16 -+ eor v1.16b,v1.16b,v25.16b -+ eor x17,x17,x19 -+ eor v2.16b,v2.16b,v26.16b -+ eor x20,x20,x21 -+ eor v3.16b,v3.16b,v27.16b -+ ld1 {v24.16b,v25.16b,v26.16b,v27.16b},[x1],#64 -+ -+ stp x5,x7,[x0,#0] // store output -+ add x28,x28,#7 // increment counter -+ stp x9,x11,[x0,#16] -+ stp x13,x15,[x0,#32] -+ stp x17,x20,[x0,#48] -+ add x0,x0,#64 -+ st1 {v0.16b,v1.16b,v2.16b,v3.16b},[x0],#64 -+ -+ ld1 {v0.16b,v1.16b,v2.16b,v3.16b},[x1],#64 -+ eor v4.16b,v4.16b,v24.16b -+ eor v5.16b,v5.16b,v25.16b -+ eor v6.16b,v6.16b,v26.16b -+ eor v7.16b,v7.16b,v27.16b -+ st1 {v4.16b,v5.16b,v6.16b,v7.16b},[x0],#64 -+ -+ ld1 {v4.16b,v5.16b,v6.16b,v7.16b},[x1],#64 -+ eor v8.16b,v8.16b,v0.16b -+ ldp q24,q25,[sp,#0] -+ eor v9.16b,v9.16b,v1.16b -+ ldp q26,q27,[sp,#32] -+ eor v10.16b,v10.16b,v2.16b -+ eor v11.16b,v11.16b,v3.16b -+ st1 {v8.16b,v9.16b,v10.16b,v11.16b},[x0],#64 -+ -+ ld1 {v8.16b,v9.16b,v10.16b,v11.16b},[x1],#64 -+ eor v12.16b,v12.16b,v4.16b -+ eor v13.16b,v13.16b,v5.16b -+ eor v14.16b,v14.16b,v6.16b -+ eor v15.16b,v15.16b,v7.16b -+ st1 {v12.16b,v13.16b,v14.16b,v15.16b},[x0],#64 -+ -+ ld1 {v12.16b,v13.16b,v14.16b,v15.16b},[x1],#64 -+ eor v16.16b,v16.16b,v8.16b -+ eor v17.16b,v17.16b,v9.16b -+ eor v18.16b,v18.16b,v10.16b -+ eor v19.16b,v19.16b,v11.16b -+ st1 {v16.16b,v17.16b,v18.16b,v19.16b},[x0],#64 -+ -+ shl v0.4s,v31.4s,#1 // 4 -> 8 -+ eor v20.16b,v20.16b,v12.16b -+ eor v21.16b,v21.16b,v13.16b -+ eor v22.16b,v22.16b,v14.16b -+ eor v23.16b,v23.16b,v15.16b -+ st1 {v20.16b,v21.16b,v22.16b,v23.16b},[x0],#64 -+ -+ add v27.4s,v27.4s,v0.4s // += 8 -+ add v28.4s,v28.4s,v0.4s -+ add v29.4s,v29.4s,v0.4s -+ add v30.4s,v30.4s,v0.4s -+ -+ b.hs .Loop_outer_512_neon -+ -+ adds x2,x2,#512 -+ ushr v0.4s,v31.4s,#2 // 4 -> 1 -+ -+ ldp d8,d9,[sp,#128+0] // meet ABI requirements -+ ldp d10,d11,[sp,#128+16] -+ ldp d12,d13,[sp,#128+32] -+ ldp d14,d15,[sp,#128+48] -+ -+ stp q24,q31,[sp,#0] // wipe off-load area -+ stp q24,q31,[sp,#32] -+ stp q24,q31,[sp,#64] -+ -+ b.eq .Ldone_512_neon -+ -+ cmp x2,#192 -+ sub v27.4s,v27.4s,v0.4s // -= 1 -+ sub v28.4s,v28.4s,v0.4s -+ sub v29.4s,v29.4s,v0.4s -+ add sp,sp,#128 -+ b.hs .Loop_outer_neon -+ -+ eor v25.16b,v25.16b,v25.16b -+ eor v26.16b,v26.16b,v26.16b -+ eor v27.16b,v27.16b,v27.16b -+ eor v28.16b,v28.16b,v28.16b -+ eor v29.16b,v29.16b,v29.16b -+ eor v30.16b,v30.16b,v30.16b -+ b .Loop_outer -+ -+.Ldone_512_neon: -+ ldp x19,x20,[x29,#16] -+ add sp,sp,#128+64 -+ ldp x21,x22,[x29,#32] -+ ldp x23,x24,[x29,#48] -+ ldp x25,x26,[x29,#64] -+ ldp x27,x28,[x29,#80] -+ ldp x29,x30,[sp],#96 -+.Labort_neon: -+ ret -+ENDPROC(chacha20_neon) ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/chacha20-arm.S 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,1471 @@ -+/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. -+ */ -+ -+#include -+ -+.text -+#if defined(__thumb2__) || defined(__clang__) -+.syntax unified -+#endif -+#if defined(__thumb2__) -+.thumb -+#else -+.code 32 -+#endif -+ -+#if defined(__thumb2__) || defined(__clang__) -+#define ldrhsb ldrbhs -+#endif -+ -+.align 5 -+.Lsigma: -+.long 0x61707865,0x3320646e,0x79622d32,0x6b206574 @ endian-neutral -+.Lone: -+.long 1,0,0,0 -+.word -1 -+ -+#if __LINUX_ARM_ARCH__ >= 7 && IS_ENABLED(CONFIG_KERNEL_MODE_NEON) -+.arch armv7-a -+.fpu neon -+ -+.align 5 -+ENTRY(chacha20_neon) -+ ldr r12,[sp,#0] @ pull pointer to counter and nonce -+ stmdb sp!,{r0-r2,r4-r11,lr} -+ cmp r2,#0 @ len==0? -+#ifdef __thumb2__ -+ itt eq -+#endif -+ addeq sp,sp,#4*3 -+ beq .Lno_data_neon -+ cmp r2,#192 @ test len -+ bls .Lshort -+.Lchacha20_neon_begin: -+ adr r14,.Lsigma -+ vstmdb sp!,{d8-d15} @ ABI spec says so -+ stmdb sp!,{r0-r3} -+ -+ vld1.32 {q1-q2},[r3] @ load key -+ ldmia r3,{r4-r11} @ load key -+ -+ sub sp,sp,#4*(16+16) -+ vld1.32 {q3},[r12] @ load counter and nonce -+ add r12,sp,#4*8 -+ ldmia r14,{r0-r3} @ load sigma -+ vld1.32 {q0},[r14]! @ load sigma -+ vld1.32 {q12},[r14] @ one -+ vst1.32 {q2-q3},[r12] @ copy 1/2key|counter|nonce -+ vst1.32 {q0-q1},[sp] @ copy sigma|1/2key -+ -+ str r10,[sp,#4*(16+10)] @ off-load "rx" -+ str r11,[sp,#4*(16+11)] @ off-load "rx" -+ vshl.i32 d26,d24,#1 @ two -+ vstr d24,[sp,#4*(16+0)] -+ vshl.i32 d28,d24,#2 @ four -+ vstr d26,[sp,#4*(16+2)] -+ vmov q4,q0 -+ vstr d28,[sp,#4*(16+4)] -+ vmov q8,q0 -+ vmov q5,q1 -+ vmov q9,q1 -+ b .Loop_neon_enter -+ -+.align 4 -+.Loop_neon_outer: -+ ldmia sp,{r0-r9} @ load key material -+ cmp r11,#64*2 @ if len<=64*2 -+ bls .Lbreak_neon @ switch to integer-only -+ vmov q4,q0 -+ str r11,[sp,#4*(32+2)] @ save len -+ vmov q8,q0 -+ str r12, [sp,#4*(32+1)] @ save inp -+ vmov q5,q1 -+ str r14, [sp,#4*(32+0)] @ save out -+ vmov q9,q1 -+.Loop_neon_enter: -+ ldr r11, [sp,#4*(15)] -+ vadd.i32 q7,q3,q12 @ counter+1 -+ ldr r12,[sp,#4*(12)] @ modulo-scheduled load -+ vmov q6,q2 -+ ldr r10, [sp,#4*(13)] -+ vmov q10,q2 -+ ldr r14,[sp,#4*(14)] -+ vadd.i32 q11,q7,q12 @ counter+2 -+ str r11, [sp,#4*(16+15)] -+ mov r11,#10 -+ add r12,r12,#3 @ counter+3 -+ b .Loop_neon -+ -+.align 4 -+.Loop_neon: -+ subs r11,r11,#1 -+ vadd.i32 q0,q0,q1 -+ add r0,r0,r4 -+ vadd.i32 q4,q4,q5 -+ mov r12,r12,ror#16 -+ vadd.i32 q8,q8,q9 -+ add r1,r1,r5 -+ veor q3,q3,q0 -+ mov r10,r10,ror#16 -+ veor q7,q7,q4 -+ eor r12,r12,r0,ror#16 -+ veor q11,q11,q8 -+ eor r10,r10,r1,ror#16 -+ vrev32.16 q3,q3 -+ add r8,r8,r12 -+ vrev32.16 q7,q7 -+ mov r4,r4,ror#20 -+ vrev32.16 q11,q11 -+ add r9,r9,r10 -+ vadd.i32 q2,q2,q3 -+ mov r5,r5,ror#20 -+ vadd.i32 q6,q6,q7 -+ eor r4,r4,r8,ror#20 -+ vadd.i32 q10,q10,q11 -+ eor r5,r5,r9,ror#20 -+ veor q12,q1,q2 -+ add r0,r0,r4 -+ veor q13,q5,q6 -+ mov r12,r12,ror#24 -+ veor q14,q9,q10 -+ add r1,r1,r5 -+ vshr.u32 q1,q12,#20 -+ mov r10,r10,ror#24 -+ vshr.u32 q5,q13,#20 -+ eor r12,r12,r0,ror#24 -+ vshr.u32 q9,q14,#20 -+ eor r10,r10,r1,ror#24 -+ vsli.32 q1,q12,#12 -+ add r8,r8,r12 -+ vsli.32 q5,q13,#12 -+ mov r4,r4,ror#25 -+ vsli.32 q9,q14,#12 -+ add r9,r9,r10 -+ vadd.i32 q0,q0,q1 -+ mov r5,r5,ror#25 -+ vadd.i32 q4,q4,q5 -+ str r10,[sp,#4*(16+13)] -+ vadd.i32 q8,q8,q9 -+ ldr r10,[sp,#4*(16+15)] -+ veor q12,q3,q0 -+ eor r4,r4,r8,ror#25 -+ veor q13,q7,q4 -+ eor r5,r5,r9,ror#25 -+ veor q14,q11,q8 -+ str r8,[sp,#4*(16+8)] -+ vshr.u32 q3,q12,#24 -+ ldr r8,[sp,#4*(16+10)] -+ vshr.u32 q7,q13,#24 -+ add r2,r2,r6 -+ vshr.u32 q11,q14,#24 -+ mov r14,r14,ror#16 -+ vsli.32 q3,q12,#8 -+ str r9,[sp,#4*(16+9)] -+ vsli.32 q7,q13,#8 -+ ldr r9,[sp,#4*(16+11)] -+ vsli.32 q11,q14,#8 -+ add r3,r3,r7 -+ vadd.i32 q2,q2,q3 -+ mov r10,r10,ror#16 -+ vadd.i32 q6,q6,q7 -+ eor r14,r14,r2,ror#16 -+ vadd.i32 q10,q10,q11 -+ eor r10,r10,r3,ror#16 -+ veor q12,q1,q2 -+ add r8,r8,r14 -+ veor q13,q5,q6 -+ mov r6,r6,ror#20 -+ veor q14,q9,q10 -+ add r9,r9,r10 -+ vshr.u32 q1,q12,#25 -+ mov r7,r7,ror#20 -+ vshr.u32 q5,q13,#25 -+ eor r6,r6,r8,ror#20 -+ vshr.u32 q9,q14,#25 -+ eor r7,r7,r9,ror#20 -+ vsli.32 q1,q12,#7 -+ add r2,r2,r6 -+ vsli.32 q5,q13,#7 -+ mov r14,r14,ror#24 -+ vsli.32 q9,q14,#7 -+ add r3,r3,r7 -+ vext.8 q2,q2,q2,#8 -+ mov r10,r10,ror#24 -+ vext.8 q6,q6,q6,#8 -+ eor r14,r14,r2,ror#24 -+ vext.8 q10,q10,q10,#8 -+ eor r10,r10,r3,ror#24 -+ vext.8 q1,q1,q1,#4 -+ add r8,r8,r14 -+ vext.8 q5,q5,q5,#4 -+ mov r6,r6,ror#25 -+ vext.8 q9,q9,q9,#4 -+ add r9,r9,r10 -+ vext.8 q3,q3,q3,#12 -+ mov r7,r7,ror#25 -+ vext.8 q7,q7,q7,#12 -+ eor r6,r6,r8,ror#25 -+ vext.8 q11,q11,q11,#12 -+ eor r7,r7,r9,ror#25 -+ vadd.i32 q0,q0,q1 -+ add r0,r0,r5 -+ vadd.i32 q4,q4,q5 -+ mov r10,r10,ror#16 -+ vadd.i32 q8,q8,q9 -+ add r1,r1,r6 -+ veor q3,q3,q0 -+ mov r12,r12,ror#16 -+ veor q7,q7,q4 -+ eor r10,r10,r0,ror#16 -+ veor q11,q11,q8 -+ eor r12,r12,r1,ror#16 -+ vrev32.16 q3,q3 -+ add r8,r8,r10 -+ vrev32.16 q7,q7 -+ mov r5,r5,ror#20 -+ vrev32.16 q11,q11 -+ add r9,r9,r12 -+ vadd.i32 q2,q2,q3 -+ mov r6,r6,ror#20 -+ vadd.i32 q6,q6,q7 -+ eor r5,r5,r8,ror#20 -+ vadd.i32 q10,q10,q11 -+ eor r6,r6,r9,ror#20 -+ veor q12,q1,q2 -+ add r0,r0,r5 -+ veor q13,q5,q6 -+ mov r10,r10,ror#24 -+ veor q14,q9,q10 -+ add r1,r1,r6 -+ vshr.u32 q1,q12,#20 -+ mov r12,r12,ror#24 -+ vshr.u32 q5,q13,#20 -+ eor r10,r10,r0,ror#24 -+ vshr.u32 q9,q14,#20 -+ eor r12,r12,r1,ror#24 -+ vsli.32 q1,q12,#12 -+ add r8,r8,r10 -+ vsli.32 q5,q13,#12 -+ mov r5,r5,ror#25 -+ vsli.32 q9,q14,#12 -+ str r10,[sp,#4*(16+15)] -+ vadd.i32 q0,q0,q1 -+ ldr r10,[sp,#4*(16+13)] -+ vadd.i32 q4,q4,q5 -+ add r9,r9,r12 -+ vadd.i32 q8,q8,q9 -+ mov r6,r6,ror#25 -+ veor q12,q3,q0 -+ eor r5,r5,r8,ror#25 -+ veor q13,q7,q4 -+ eor r6,r6,r9,ror#25 -+ veor q14,q11,q8 -+ str r8,[sp,#4*(16+10)] -+ vshr.u32 q3,q12,#24 -+ ldr r8,[sp,#4*(16+8)] -+ vshr.u32 q7,q13,#24 -+ add r2,r2,r7 -+ vshr.u32 q11,q14,#24 -+ mov r10,r10,ror#16 -+ vsli.32 q3,q12,#8 -+ str r9,[sp,#4*(16+11)] -+ vsli.32 q7,q13,#8 -+ ldr r9,[sp,#4*(16+9)] -+ vsli.32 q11,q14,#8 -+ add r3,r3,r4 -+ vadd.i32 q2,q2,q3 -+ mov r14,r14,ror#16 -+ vadd.i32 q6,q6,q7 -+ eor r10,r10,r2,ror#16 -+ vadd.i32 q10,q10,q11 -+ eor r14,r14,r3,ror#16 -+ veor q12,q1,q2 -+ add r8,r8,r10 -+ veor q13,q5,q6 -+ mov r7,r7,ror#20 -+ veor q14,q9,q10 -+ add r9,r9,r14 -+ vshr.u32 q1,q12,#25 -+ mov r4,r4,ror#20 -+ vshr.u32 q5,q13,#25 -+ eor r7,r7,r8,ror#20 -+ vshr.u32 q9,q14,#25 -+ eor r4,r4,r9,ror#20 -+ vsli.32 q1,q12,#7 -+ add r2,r2,r7 -+ vsli.32 q5,q13,#7 -+ mov r10,r10,ror#24 -+ vsli.32 q9,q14,#7 -+ add r3,r3,r4 -+ vext.8 q2,q2,q2,#8 -+ mov r14,r14,ror#24 -+ vext.8 q6,q6,q6,#8 -+ eor r10,r10,r2,ror#24 -+ vext.8 q10,q10,q10,#8 -+ eor r14,r14,r3,ror#24 -+ vext.8 q1,q1,q1,#12 -+ add r8,r8,r10 -+ vext.8 q5,q5,q5,#12 -+ mov r7,r7,ror#25 -+ vext.8 q9,q9,q9,#12 -+ add r9,r9,r14 -+ vext.8 q3,q3,q3,#4 -+ mov r4,r4,ror#25 -+ vext.8 q7,q7,q7,#4 -+ eor r7,r7,r8,ror#25 -+ vext.8 q11,q11,q11,#4 -+ eor r4,r4,r9,ror#25 -+ bne .Loop_neon -+ -+ add r11,sp,#32 -+ vld1.32 {q12-q13},[sp] @ load key material -+ vld1.32 {q14-q15},[r11] -+ -+ ldr r11,[sp,#4*(32+2)] @ load len -+ -+ str r8, [sp,#4*(16+8)] @ modulo-scheduled store -+ str r9, [sp,#4*(16+9)] -+ str r12,[sp,#4*(16+12)] -+ str r10, [sp,#4*(16+13)] -+ str r14,[sp,#4*(16+14)] -+ -+ @ at this point we have first half of 512-bit result in -+ @ rx and second half at sp+4*(16+8) -+ -+ ldr r12,[sp,#4*(32+1)] @ load inp -+ ldr r14,[sp,#4*(32+0)] @ load out -+ -+ vadd.i32 q0,q0,q12 @ accumulate key material -+ vadd.i32 q4,q4,q12 -+ vadd.i32 q8,q8,q12 -+ vldr d24,[sp,#4*(16+0)] @ one -+ -+ vadd.i32 q1,q1,q13 -+ vadd.i32 q5,q5,q13 -+ vadd.i32 q9,q9,q13 -+ vldr d26,[sp,#4*(16+2)] @ two -+ -+ vadd.i32 q2,q2,q14 -+ vadd.i32 q6,q6,q14 -+ vadd.i32 q10,q10,q14 -+ vadd.i32 d14,d14,d24 @ counter+1 -+ vadd.i32 d22,d22,d26 @ counter+2 -+ -+ vadd.i32 q3,q3,q15 -+ vadd.i32 q7,q7,q15 -+ vadd.i32 q11,q11,q15 -+ -+ cmp r11,#64*4 -+ blo .Ltail_neon -+ -+ vld1.8 {q12-q13},[r12]! @ load input -+ mov r11,sp -+ vld1.8 {q14-q15},[r12]! -+ veor q0,q0,q12 @ xor with input -+ veor q1,q1,q13 -+ vld1.8 {q12-q13},[r12]! -+ veor q2,q2,q14 -+ veor q3,q3,q15 -+ vld1.8 {q14-q15},[r12]! -+ -+ veor q4,q4,q12 -+ vst1.8 {q0-q1},[r14]! @ store output -+ veor q5,q5,q13 -+ vld1.8 {q12-q13},[r12]! -+ veor q6,q6,q14 -+ vst1.8 {q2-q3},[r14]! -+ veor q7,q7,q15 -+ vld1.8 {q14-q15},[r12]! -+ -+ veor q8,q8,q12 -+ vld1.32 {q0-q1},[r11]! @ load for next iteration -+ veor d25,d25,d25 -+ vldr d24,[sp,#4*(16+4)] @ four -+ veor q9,q9,q13 -+ vld1.32 {q2-q3},[r11] -+ veor q10,q10,q14 -+ vst1.8 {q4-q5},[r14]! -+ veor q11,q11,q15 -+ vst1.8 {q6-q7},[r14]! -+ -+ vadd.i32 d6,d6,d24 @ next counter value -+ vldr d24,[sp,#4*(16+0)] @ one -+ -+ ldmia sp,{r8-r11} @ load key material -+ add r0,r0,r8 @ accumulate key material -+ ldr r8,[r12],#16 @ load input -+ vst1.8 {q8-q9},[r14]! -+ add r1,r1,r9 -+ ldr r9,[r12,#-12] -+ vst1.8 {q10-q11},[r14]! -+ add r2,r2,r10 -+ ldr r10,[r12,#-8] -+ add r3,r3,r11 -+ ldr r11,[r12,#-4] -+#ifdef __ARMEB__ -+ rev r0,r0 -+ rev r1,r1 -+ rev r2,r2 -+ rev r3,r3 -+#endif -+ eor r0,r0,r8 @ xor with input -+ add r8,sp,#4*(4) -+ eor r1,r1,r9 -+ str r0,[r14],#16 @ store output -+ eor r2,r2,r10 -+ str r1,[r14,#-12] -+ eor r3,r3,r11 -+ ldmia r8,{r8-r11} @ load key material -+ str r2,[r14,#-8] -+ str r3,[r14,#-4] -+ -+ add r4,r4,r8 @ accumulate key material -+ ldr r8,[r12],#16 @ load input -+ add r5,r5,r9 -+ ldr r9,[r12,#-12] -+ add r6,r6,r10 -+ ldr r10,[r12,#-8] -+ add r7,r7,r11 -+ ldr r11,[r12,#-4] -+#ifdef __ARMEB__ -+ rev r4,r4 -+ rev r5,r5 -+ rev r6,r6 -+ rev r7,r7 -+#endif -+ eor r4,r4,r8 -+ add r8,sp,#4*(8) -+ eor r5,r5,r9 -+ str r4,[r14],#16 @ store output -+ eor r6,r6,r10 -+ str r5,[r14,#-12] -+ eor r7,r7,r11 -+ ldmia r8,{r8-r11} @ load key material -+ str r6,[r14,#-8] -+ add r0,sp,#4*(16+8) -+ str r7,[r14,#-4] -+ -+ ldmia r0,{r0-r7} @ load second half -+ -+ add r0,r0,r8 @ accumulate key material -+ ldr r8,[r12],#16 @ load input -+ add r1,r1,r9 -+ ldr r9,[r12,#-12] -+#ifdef __thumb2__ -+ it hi -+#endif -+ strhi r10,[sp,#4*(16+10)] @ copy "rx" while at it -+ add r2,r2,r10 -+ ldr r10,[r12,#-8] -+#ifdef __thumb2__ -+ it hi -+#endif -+ strhi r11,[sp,#4*(16+11)] @ copy "rx" while at it -+ add r3,r3,r11 -+ ldr r11,[r12,#-4] -+#ifdef __ARMEB__ -+ rev r0,r0 -+ rev r1,r1 -+ rev r2,r2 -+ rev r3,r3 -+#endif -+ eor r0,r0,r8 -+ add r8,sp,#4*(12) -+ eor r1,r1,r9 -+ str r0,[r14],#16 @ store output -+ eor r2,r2,r10 -+ str r1,[r14,#-12] -+ eor r3,r3,r11 -+ ldmia r8,{r8-r11} @ load key material -+ str r2,[r14,#-8] -+ str r3,[r14,#-4] -+ -+ add r4,r4,r8 @ accumulate key material -+ add r8,r8,#4 @ next counter value -+ add r5,r5,r9 -+ str r8,[sp,#4*(12)] @ save next counter value -+ ldr r8,[r12],#16 @ load input -+ add r6,r6,r10 -+ add r4,r4,#3 @ counter+3 -+ ldr r9,[r12,#-12] -+ add r7,r7,r11 -+ ldr r10,[r12,#-8] -+ ldr r11,[r12,#-4] -+#ifdef __ARMEB__ -+ rev r4,r4 -+ rev r5,r5 -+ rev r6,r6 -+ rev r7,r7 -+#endif -+ eor r4,r4,r8 -+#ifdef __thumb2__ -+ it hi -+#endif -+ ldrhi r8,[sp,#4*(32+2)] @ re-load len -+ eor r5,r5,r9 -+ eor r6,r6,r10 -+ str r4,[r14],#16 @ store output -+ eor r7,r7,r11 -+ str r5,[r14,#-12] -+ sub r11,r8,#64*4 @ len-=64*4 -+ str r6,[r14,#-8] -+ str r7,[r14,#-4] -+ bhi .Loop_neon_outer -+ -+ b .Ldone_neon -+ -+.align 4 -+.Lbreak_neon: -+ @ harmonize NEON and integer-only stack frames: load data -+ @ from NEON frame, but save to integer-only one; distance -+ @ between the two is 4*(32+4+16-32)=4*(20). -+ -+ str r11, [sp,#4*(20+32+2)] @ save len -+ add r11,sp,#4*(32+4) -+ str r12, [sp,#4*(20+32+1)] @ save inp -+ str r14, [sp,#4*(20+32+0)] @ save out -+ -+ ldr r12,[sp,#4*(16+10)] -+ ldr r14,[sp,#4*(16+11)] -+ vldmia r11,{d8-d15} @ fulfill ABI requirement -+ str r12,[sp,#4*(20+16+10)] @ copy "rx" -+ str r14,[sp,#4*(20+16+11)] @ copy "rx" -+ -+ ldr r11, [sp,#4*(15)] -+ ldr r12,[sp,#4*(12)] @ modulo-scheduled load -+ ldr r10, [sp,#4*(13)] -+ ldr r14,[sp,#4*(14)] -+ str r11, [sp,#4*(20+16+15)] -+ add r11,sp,#4*(20) -+ vst1.32 {q0-q1},[r11]! @ copy key -+ add sp,sp,#4*(20) @ switch frame -+ vst1.32 {q2-q3},[r11] -+ mov r11,#10 -+ b .Loop @ go integer-only -+ -+.align 4 -+.Ltail_neon: -+ cmp r11,#64*3 -+ bhs .L192_or_more_neon -+ cmp r11,#64*2 -+ bhs .L128_or_more_neon -+ cmp r11,#64*1 -+ bhs .L64_or_more_neon -+ -+ add r8,sp,#4*(8) -+ vst1.8 {q0-q1},[sp] -+ add r10,sp,#4*(0) -+ vst1.8 {q2-q3},[r8] -+ b .Loop_tail_neon -+ -+.align 4 -+.L64_or_more_neon: -+ vld1.8 {q12-q13},[r12]! -+ vld1.8 {q14-q15},[r12]! -+ veor q0,q0,q12 -+ veor q1,q1,q13 -+ veor q2,q2,q14 -+ veor q3,q3,q15 -+ vst1.8 {q0-q1},[r14]! -+ vst1.8 {q2-q3},[r14]! -+ -+ beq .Ldone_neon -+ -+ add r8,sp,#4*(8) -+ vst1.8 {q4-q5},[sp] -+ add r10,sp,#4*(0) -+ vst1.8 {q6-q7},[r8] -+ sub r11,r11,#64*1 @ len-=64*1 -+ b .Loop_tail_neon -+ -+.align 4 -+.L128_or_more_neon: -+ vld1.8 {q12-q13},[r12]! -+ vld1.8 {q14-q15},[r12]! -+ veor q0,q0,q12 -+ veor q1,q1,q13 -+ vld1.8 {q12-q13},[r12]! -+ veor q2,q2,q14 -+ veor q3,q3,q15 -+ vld1.8 {q14-q15},[r12]! -+ -+ veor q4,q4,q12 -+ veor q5,q5,q13 -+ vst1.8 {q0-q1},[r14]! -+ veor q6,q6,q14 -+ vst1.8 {q2-q3},[r14]! -+ veor q7,q7,q15 -+ vst1.8 {q4-q5},[r14]! -+ vst1.8 {q6-q7},[r14]! -+ -+ beq .Ldone_neon -+ -+ add r8,sp,#4*(8) -+ vst1.8 {q8-q9},[sp] -+ add r10,sp,#4*(0) -+ vst1.8 {q10-q11},[r8] -+ sub r11,r11,#64*2 @ len-=64*2 -+ b .Loop_tail_neon -+ -+.align 4 -+.L192_or_more_neon: -+ vld1.8 {q12-q13},[r12]! -+ vld1.8 {q14-q15},[r12]! -+ veor q0,q0,q12 -+ veor q1,q1,q13 -+ vld1.8 {q12-q13},[r12]! -+ veor q2,q2,q14 -+ veor q3,q3,q15 -+ vld1.8 {q14-q15},[r12]! -+ -+ veor q4,q4,q12 -+ veor q5,q5,q13 -+ vld1.8 {q12-q13},[r12]! -+ veor q6,q6,q14 -+ vst1.8 {q0-q1},[r14]! -+ veor q7,q7,q15 -+ vld1.8 {q14-q15},[r12]! -+ -+ veor q8,q8,q12 -+ vst1.8 {q2-q3},[r14]! -+ veor q9,q9,q13 -+ vst1.8 {q4-q5},[r14]! -+ veor q10,q10,q14 -+ vst1.8 {q6-q7},[r14]! -+ veor q11,q11,q15 -+ vst1.8 {q8-q9},[r14]! -+ vst1.8 {q10-q11},[r14]! -+ -+ beq .Ldone_neon -+ -+ ldmia sp,{r8-r11} @ load key material -+ add r0,r0,r8 @ accumulate key material -+ add r8,sp,#4*(4) -+ add r1,r1,r9 -+ add r2,r2,r10 -+ add r3,r3,r11 -+ ldmia r8,{r8-r11} @ load key material -+ -+ add r4,r4,r8 @ accumulate key material -+ add r8,sp,#4*(8) -+ add r5,r5,r9 -+ add r6,r6,r10 -+ add r7,r7,r11 -+ ldmia r8,{r8-r11} @ load key material -+#ifdef __ARMEB__ -+ rev r0,r0 -+ rev r1,r1 -+ rev r2,r2 -+ rev r3,r3 -+ rev r4,r4 -+ rev r5,r5 -+ rev r6,r6 -+ rev r7,r7 -+#endif -+ stmia sp,{r0-r7} -+ add r0,sp,#4*(16+8) -+ -+ ldmia r0,{r0-r7} @ load second half -+ -+ add r0,r0,r8 @ accumulate key material -+ add r8,sp,#4*(12) -+ add r1,r1,r9 -+ add r2,r2,r10 -+ add r3,r3,r11 -+ ldmia r8,{r8-r11} @ load key material -+ -+ add r4,r4,r8 @ accumulate key material -+ add r8,sp,#4*(8) -+ add r5,r5,r9 -+ add r4,r4,#3 @ counter+3 -+ add r6,r6,r10 -+ add r7,r7,r11 -+ ldr r11,[sp,#4*(32+2)] @ re-load len -+#ifdef __ARMEB__ -+ rev r0,r0 -+ rev r1,r1 -+ rev r2,r2 -+ rev r3,r3 -+ rev r4,r4 -+ rev r5,r5 -+ rev r6,r6 -+ rev r7,r7 -+#endif -+ stmia r8,{r0-r7} -+ add r10,sp,#4*(0) -+ sub r11,r11,#64*3 @ len-=64*3 -+ -+.Loop_tail_neon: -+ ldrb r8,[r10],#1 @ read buffer on stack -+ ldrb r9,[r12],#1 @ read input -+ subs r11,r11,#1 -+ eor r8,r8,r9 -+ strb r8,[r14],#1 @ store output -+ bne .Loop_tail_neon -+ -+.Ldone_neon: -+ add sp,sp,#4*(32+4) -+ vldmia sp,{d8-d15} -+ add sp,sp,#4*(16+3) -+.Lno_data_neon: -+ ldmia sp!,{r4-r11,pc} -+ENDPROC(chacha20_neon) -+#endif -+ -+.align 5 -+.Lsigma2: -+.long 0x61707865,0x3320646e,0x79622d32,0x6b206574 @ endian-neutral -+.Lone2: -+.long 1,0,0,0 -+.word -1 -+ -+.align 5 -+ENTRY(chacha20_arm) -+ ldr r12,[sp,#0] @ pull pointer to counter and nonce -+ stmdb sp!,{r0-r2,r4-r11,lr} -+ cmp r2,#0 @ len==0? -+#ifdef __thumb2__ -+ itt eq -+#endif -+ addeq sp,sp,#4*3 -+ beq .Lno_data_arm -+.Lshort: -+ ldmia r12,{r4-r7} @ load counter and nonce -+ sub sp,sp,#4*(16) @ off-load area -+#if __LINUX_ARM_ARCH__ < 7 && !defined(__thumb2__) -+ sub r14,pc,#100 @ .Lsigma2 -+#else -+ adr r14,.Lsigma2 @ .Lsigma2 -+#endif -+ stmdb sp!,{r4-r7} @ copy counter and nonce -+ ldmia r3,{r4-r11} @ load key -+ ldmia r14,{r0-r3} @ load sigma -+ stmdb sp!,{r4-r11} @ copy key -+ stmdb sp!,{r0-r3} @ copy sigma -+ str r10,[sp,#4*(16+10)] @ off-load "rx" -+ str r11,[sp,#4*(16+11)] @ off-load "rx" -+ b .Loop_outer_enter -+ -+.align 4 -+.Loop_outer: -+ ldmia sp,{r0-r9} @ load key material -+ str r11,[sp,#4*(32+2)] @ save len -+ str r12, [sp,#4*(32+1)] @ save inp -+ str r14, [sp,#4*(32+0)] @ save out -+.Loop_outer_enter: -+ ldr r11, [sp,#4*(15)] -+ ldr r12,[sp,#4*(12)] @ modulo-scheduled load -+ ldr r10, [sp,#4*(13)] -+ ldr r14,[sp,#4*(14)] -+ str r11, [sp,#4*(16+15)] -+ mov r11,#10 -+ b .Loop -+ -+.align 4 -+.Loop: -+ subs r11,r11,#1 -+ add r0,r0,r4 -+ mov r12,r12,ror#16 -+ add r1,r1,r5 -+ mov r10,r10,ror#16 -+ eor r12,r12,r0,ror#16 -+ eor r10,r10,r1,ror#16 -+ add r8,r8,r12 -+ mov r4,r4,ror#20 -+ add r9,r9,r10 -+ mov r5,r5,ror#20 -+ eor r4,r4,r8,ror#20 -+ eor r5,r5,r9,ror#20 -+ add r0,r0,r4 -+ mov r12,r12,ror#24 -+ add r1,r1,r5 -+ mov r10,r10,ror#24 -+ eor r12,r12,r0,ror#24 -+ eor r10,r10,r1,ror#24 -+ add r8,r8,r12 -+ mov r4,r4,ror#25 -+ add r9,r9,r10 -+ mov r5,r5,ror#25 -+ str r10,[sp,#4*(16+13)] -+ ldr r10,[sp,#4*(16+15)] -+ eor r4,r4,r8,ror#25 -+ eor r5,r5,r9,ror#25 -+ str r8,[sp,#4*(16+8)] -+ ldr r8,[sp,#4*(16+10)] -+ add r2,r2,r6 -+ mov r14,r14,ror#16 -+ str r9,[sp,#4*(16+9)] -+ ldr r9,[sp,#4*(16+11)] -+ add r3,r3,r7 -+ mov r10,r10,ror#16 -+ eor r14,r14,r2,ror#16 -+ eor r10,r10,r3,ror#16 -+ add r8,r8,r14 -+ mov r6,r6,ror#20 -+ add r9,r9,r10 -+ mov r7,r7,ror#20 -+ eor r6,r6,r8,ror#20 -+ eor r7,r7,r9,ror#20 -+ add r2,r2,r6 -+ mov r14,r14,ror#24 -+ add r3,r3,r7 -+ mov r10,r10,ror#24 -+ eor r14,r14,r2,ror#24 -+ eor r10,r10,r3,ror#24 -+ add r8,r8,r14 -+ mov r6,r6,ror#25 -+ add r9,r9,r10 -+ mov r7,r7,ror#25 -+ eor r6,r6,r8,ror#25 -+ eor r7,r7,r9,ror#25 -+ add r0,r0,r5 -+ mov r10,r10,ror#16 -+ add r1,r1,r6 -+ mov r12,r12,ror#16 -+ eor r10,r10,r0,ror#16 -+ eor r12,r12,r1,ror#16 -+ add r8,r8,r10 -+ mov r5,r5,ror#20 -+ add r9,r9,r12 -+ mov r6,r6,ror#20 -+ eor r5,r5,r8,ror#20 -+ eor r6,r6,r9,ror#20 -+ add r0,r0,r5 -+ mov r10,r10,ror#24 -+ add r1,r1,r6 -+ mov r12,r12,ror#24 -+ eor r10,r10,r0,ror#24 -+ eor r12,r12,r1,ror#24 -+ add r8,r8,r10 -+ mov r5,r5,ror#25 -+ str r10,[sp,#4*(16+15)] -+ ldr r10,[sp,#4*(16+13)] -+ add r9,r9,r12 -+ mov r6,r6,ror#25 -+ eor r5,r5,r8,ror#25 -+ eor r6,r6,r9,ror#25 -+ str r8,[sp,#4*(16+10)] -+ ldr r8,[sp,#4*(16+8)] -+ add r2,r2,r7 -+ mov r10,r10,ror#16 -+ str r9,[sp,#4*(16+11)] -+ ldr r9,[sp,#4*(16+9)] -+ add r3,r3,r4 -+ mov r14,r14,ror#16 -+ eor r10,r10,r2,ror#16 -+ eor r14,r14,r3,ror#16 -+ add r8,r8,r10 -+ mov r7,r7,ror#20 -+ add r9,r9,r14 -+ mov r4,r4,ror#20 -+ eor r7,r7,r8,ror#20 -+ eor r4,r4,r9,ror#20 -+ add r2,r2,r7 -+ mov r10,r10,ror#24 -+ add r3,r3,r4 -+ mov r14,r14,ror#24 -+ eor r10,r10,r2,ror#24 -+ eor r14,r14,r3,ror#24 -+ add r8,r8,r10 -+ mov r7,r7,ror#25 -+ add r9,r9,r14 -+ mov r4,r4,ror#25 -+ eor r7,r7,r8,ror#25 -+ eor r4,r4,r9,ror#25 -+ bne .Loop -+ -+ ldr r11,[sp,#4*(32+2)] @ load len -+ -+ str r8, [sp,#4*(16+8)] @ modulo-scheduled store -+ str r9, [sp,#4*(16+9)] -+ str r12,[sp,#4*(16+12)] -+ str r10, [sp,#4*(16+13)] -+ str r14,[sp,#4*(16+14)] -+ -+ @ at this point we have first half of 512-bit result in -+ @ rx and second half at sp+4*(16+8) -+ -+ cmp r11,#64 @ done yet? -+#ifdef __thumb2__ -+ itete lo -+#endif -+ addlo r12,sp,#4*(0) @ shortcut or ... -+ ldrhs r12,[sp,#4*(32+1)] @ ... load inp -+ addlo r14,sp,#4*(0) @ shortcut or ... -+ ldrhs r14,[sp,#4*(32+0)] @ ... load out -+ -+ ldr r8,[sp,#4*(0)] @ load key material -+ ldr r9,[sp,#4*(1)] -+ -+#if __LINUX_ARM_ARCH__ >= 6 || !defined(__ARMEB__) -+#if __LINUX_ARM_ARCH__ < 7 -+ orr r10,r12,r14 -+ tst r10,#3 @ are input and output aligned? -+ ldr r10,[sp,#4*(2)] -+ bne .Lunaligned -+ cmp r11,#64 @ restore flags -+#else -+ ldr r10,[sp,#4*(2)] -+#endif -+ ldr r11,[sp,#4*(3)] -+ -+ add r0,r0,r8 @ accumulate key material -+ add r1,r1,r9 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhs r8,[r12],#16 @ load input -+ ldrhs r9,[r12,#-12] -+ -+ add r2,r2,r10 -+ add r3,r3,r11 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhs r10,[r12,#-8] -+ ldrhs r11,[r12,#-4] -+#if __LINUX_ARM_ARCH__ >= 6 && defined(__ARMEB__) -+ rev r0,r0 -+ rev r1,r1 -+ rev r2,r2 -+ rev r3,r3 -+#endif -+#ifdef __thumb2__ -+ itt hs -+#endif -+ eorhs r0,r0,r8 @ xor with input -+ eorhs r1,r1,r9 -+ add r8,sp,#4*(4) -+ str r0,[r14],#16 @ store output -+#ifdef __thumb2__ -+ itt hs -+#endif -+ eorhs r2,r2,r10 -+ eorhs r3,r3,r11 -+ ldmia r8,{r8-r11} @ load key material -+ str r1,[r14,#-12] -+ str r2,[r14,#-8] -+ str r3,[r14,#-4] -+ -+ add r4,r4,r8 @ accumulate key material -+ add r5,r5,r9 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhs r8,[r12],#16 @ load input -+ ldrhs r9,[r12,#-12] -+ add r6,r6,r10 -+ add r7,r7,r11 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhs r10,[r12,#-8] -+ ldrhs r11,[r12,#-4] -+#if __LINUX_ARM_ARCH__ >= 6 && defined(__ARMEB__) -+ rev r4,r4 -+ rev r5,r5 -+ rev r6,r6 -+ rev r7,r7 -+#endif -+#ifdef __thumb2__ -+ itt hs -+#endif -+ eorhs r4,r4,r8 -+ eorhs r5,r5,r9 -+ add r8,sp,#4*(8) -+ str r4,[r14],#16 @ store output -+#ifdef __thumb2__ -+ itt hs -+#endif -+ eorhs r6,r6,r10 -+ eorhs r7,r7,r11 -+ str r5,[r14,#-12] -+ ldmia r8,{r8-r11} @ load key material -+ str r6,[r14,#-8] -+ add r0,sp,#4*(16+8) -+ str r7,[r14,#-4] -+ -+ ldmia r0,{r0-r7} @ load second half -+ -+ add r0,r0,r8 @ accumulate key material -+ add r1,r1,r9 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhs r8,[r12],#16 @ load input -+ ldrhs r9,[r12,#-12] -+#ifdef __thumb2__ -+ itt hi -+#endif -+ strhi r10,[sp,#4*(16+10)] @ copy "rx" while at it -+ strhi r11,[sp,#4*(16+11)] @ copy "rx" while at it -+ add r2,r2,r10 -+ add r3,r3,r11 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhs r10,[r12,#-8] -+ ldrhs r11,[r12,#-4] -+#if __LINUX_ARM_ARCH__ >= 6 && defined(__ARMEB__) -+ rev r0,r0 -+ rev r1,r1 -+ rev r2,r2 -+ rev r3,r3 -+#endif -+#ifdef __thumb2__ -+ itt hs -+#endif -+ eorhs r0,r0,r8 -+ eorhs r1,r1,r9 -+ add r8,sp,#4*(12) -+ str r0,[r14],#16 @ store output -+#ifdef __thumb2__ -+ itt hs -+#endif -+ eorhs r2,r2,r10 -+ eorhs r3,r3,r11 -+ str r1,[r14,#-12] -+ ldmia r8,{r8-r11} @ load key material -+ str r2,[r14,#-8] -+ str r3,[r14,#-4] -+ -+ add r4,r4,r8 @ accumulate key material -+ add r5,r5,r9 -+#ifdef __thumb2__ -+ itt hi -+#endif -+ addhi r8,r8,#1 @ next counter value -+ strhi r8,[sp,#4*(12)] @ save next counter value -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhs r8,[r12],#16 @ load input -+ ldrhs r9,[r12,#-12] -+ add r6,r6,r10 -+ add r7,r7,r11 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhs r10,[r12,#-8] -+ ldrhs r11,[r12,#-4] -+#if __LINUX_ARM_ARCH__ >= 6 && defined(__ARMEB__) -+ rev r4,r4 -+ rev r5,r5 -+ rev r6,r6 -+ rev r7,r7 -+#endif -+#ifdef __thumb2__ -+ itt hs -+#endif -+ eorhs r4,r4,r8 -+ eorhs r5,r5,r9 -+#ifdef __thumb2__ -+ it ne -+#endif -+ ldrne r8,[sp,#4*(32+2)] @ re-load len -+#ifdef __thumb2__ -+ itt hs -+#endif -+ eorhs r6,r6,r10 -+ eorhs r7,r7,r11 -+ str r4,[r14],#16 @ store output -+ str r5,[r14,#-12] -+#ifdef __thumb2__ -+ it hs -+#endif -+ subhs r11,r8,#64 @ len-=64 -+ str r6,[r14,#-8] -+ str r7,[r14,#-4] -+ bhi .Loop_outer -+ -+ beq .Ldone -+#if __LINUX_ARM_ARCH__ < 7 -+ b .Ltail -+ -+.align 4 -+.Lunaligned: @ unaligned endian-neutral path -+ cmp r11,#64 @ restore flags -+#endif -+#endif -+#if __LINUX_ARM_ARCH__ < 7 -+ ldr r11,[sp,#4*(3)] -+ add r0,r0,r8 @ accumulate key material -+ add r1,r1,r9 -+ add r2,r2,r10 -+#ifdef __thumb2__ -+ itete lo -+#endif -+ eorlo r8,r8,r8 @ zero or ... -+ ldrhsb r8,[r12],#16 @ ... load input -+ eorlo r9,r9,r9 -+ ldrhsb r9,[r12,#-12] -+ -+ add r3,r3,r11 -+#ifdef __thumb2__ -+ itete lo -+#endif -+ eorlo r10,r10,r10 -+ ldrhsb r10,[r12,#-8] -+ eorlo r11,r11,r11 -+ ldrhsb r11,[r12,#-4] -+ -+ eor r0,r8,r0 @ xor with input (or zero) -+ eor r1,r9,r1 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r8,[r12,#-15] @ load more input -+ ldrhsb r9,[r12,#-11] -+ eor r2,r10,r2 -+ strb r0,[r14],#16 @ store output -+ eor r3,r11,r3 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r10,[r12,#-7] -+ ldrhsb r11,[r12,#-3] -+ strb r1,[r14,#-12] -+ eor r0,r8,r0,lsr#8 -+ strb r2,[r14,#-8] -+ eor r1,r9,r1,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r8,[r12,#-14] @ load more input -+ ldrhsb r9,[r12,#-10] -+ strb r3,[r14,#-4] -+ eor r2,r10,r2,lsr#8 -+ strb r0,[r14,#-15] -+ eor r3,r11,r3,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r10,[r12,#-6] -+ ldrhsb r11,[r12,#-2] -+ strb r1,[r14,#-11] -+ eor r0,r8,r0,lsr#8 -+ strb r2,[r14,#-7] -+ eor r1,r9,r1,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r8,[r12,#-13] @ load more input -+ ldrhsb r9,[r12,#-9] -+ strb r3,[r14,#-3] -+ eor r2,r10,r2,lsr#8 -+ strb r0,[r14,#-14] -+ eor r3,r11,r3,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r10,[r12,#-5] -+ ldrhsb r11,[r12,#-1] -+ strb r1,[r14,#-10] -+ strb r2,[r14,#-6] -+ eor r0,r8,r0,lsr#8 -+ strb r3,[r14,#-2] -+ eor r1,r9,r1,lsr#8 -+ strb r0,[r14,#-13] -+ eor r2,r10,r2,lsr#8 -+ strb r1,[r14,#-9] -+ eor r3,r11,r3,lsr#8 -+ strb r2,[r14,#-5] -+ strb r3,[r14,#-1] -+ add r8,sp,#4*(4+0) -+ ldmia r8,{r8-r11} @ load key material -+ add r0,sp,#4*(16+8) -+ add r4,r4,r8 @ accumulate key material -+ add r5,r5,r9 -+ add r6,r6,r10 -+#ifdef __thumb2__ -+ itete lo -+#endif -+ eorlo r8,r8,r8 @ zero or ... -+ ldrhsb r8,[r12],#16 @ ... load input -+ eorlo r9,r9,r9 -+ ldrhsb r9,[r12,#-12] -+ -+ add r7,r7,r11 -+#ifdef __thumb2__ -+ itete lo -+#endif -+ eorlo r10,r10,r10 -+ ldrhsb r10,[r12,#-8] -+ eorlo r11,r11,r11 -+ ldrhsb r11,[r12,#-4] -+ -+ eor r4,r8,r4 @ xor with input (or zero) -+ eor r5,r9,r5 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r8,[r12,#-15] @ load more input -+ ldrhsb r9,[r12,#-11] -+ eor r6,r10,r6 -+ strb r4,[r14],#16 @ store output -+ eor r7,r11,r7 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r10,[r12,#-7] -+ ldrhsb r11,[r12,#-3] -+ strb r5,[r14,#-12] -+ eor r4,r8,r4,lsr#8 -+ strb r6,[r14,#-8] -+ eor r5,r9,r5,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r8,[r12,#-14] @ load more input -+ ldrhsb r9,[r12,#-10] -+ strb r7,[r14,#-4] -+ eor r6,r10,r6,lsr#8 -+ strb r4,[r14,#-15] -+ eor r7,r11,r7,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r10,[r12,#-6] -+ ldrhsb r11,[r12,#-2] -+ strb r5,[r14,#-11] -+ eor r4,r8,r4,lsr#8 -+ strb r6,[r14,#-7] -+ eor r5,r9,r5,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r8,[r12,#-13] @ load more input -+ ldrhsb r9,[r12,#-9] -+ strb r7,[r14,#-3] -+ eor r6,r10,r6,lsr#8 -+ strb r4,[r14,#-14] -+ eor r7,r11,r7,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r10,[r12,#-5] -+ ldrhsb r11,[r12,#-1] -+ strb r5,[r14,#-10] -+ strb r6,[r14,#-6] -+ eor r4,r8,r4,lsr#8 -+ strb r7,[r14,#-2] -+ eor r5,r9,r5,lsr#8 -+ strb r4,[r14,#-13] -+ eor r6,r10,r6,lsr#8 -+ strb r5,[r14,#-9] -+ eor r7,r11,r7,lsr#8 -+ strb r6,[r14,#-5] -+ strb r7,[r14,#-1] -+ add r8,sp,#4*(4+4) -+ ldmia r8,{r8-r11} @ load key material -+ ldmia r0,{r0-r7} @ load second half -+#ifdef __thumb2__ -+ itt hi -+#endif -+ strhi r10,[sp,#4*(16+10)] @ copy "rx" -+ strhi r11,[sp,#4*(16+11)] @ copy "rx" -+ add r0,r0,r8 @ accumulate key material -+ add r1,r1,r9 -+ add r2,r2,r10 -+#ifdef __thumb2__ -+ itete lo -+#endif -+ eorlo r8,r8,r8 @ zero or ... -+ ldrhsb r8,[r12],#16 @ ... load input -+ eorlo r9,r9,r9 -+ ldrhsb r9,[r12,#-12] -+ -+ add r3,r3,r11 -+#ifdef __thumb2__ -+ itete lo -+#endif -+ eorlo r10,r10,r10 -+ ldrhsb r10,[r12,#-8] -+ eorlo r11,r11,r11 -+ ldrhsb r11,[r12,#-4] -+ -+ eor r0,r8,r0 @ xor with input (or zero) -+ eor r1,r9,r1 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r8,[r12,#-15] @ load more input -+ ldrhsb r9,[r12,#-11] -+ eor r2,r10,r2 -+ strb r0,[r14],#16 @ store output -+ eor r3,r11,r3 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r10,[r12,#-7] -+ ldrhsb r11,[r12,#-3] -+ strb r1,[r14,#-12] -+ eor r0,r8,r0,lsr#8 -+ strb r2,[r14,#-8] -+ eor r1,r9,r1,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r8,[r12,#-14] @ load more input -+ ldrhsb r9,[r12,#-10] -+ strb r3,[r14,#-4] -+ eor r2,r10,r2,lsr#8 -+ strb r0,[r14,#-15] -+ eor r3,r11,r3,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r10,[r12,#-6] -+ ldrhsb r11,[r12,#-2] -+ strb r1,[r14,#-11] -+ eor r0,r8,r0,lsr#8 -+ strb r2,[r14,#-7] -+ eor r1,r9,r1,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r8,[r12,#-13] @ load more input -+ ldrhsb r9,[r12,#-9] -+ strb r3,[r14,#-3] -+ eor r2,r10,r2,lsr#8 -+ strb r0,[r14,#-14] -+ eor r3,r11,r3,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r10,[r12,#-5] -+ ldrhsb r11,[r12,#-1] -+ strb r1,[r14,#-10] -+ strb r2,[r14,#-6] -+ eor r0,r8,r0,lsr#8 -+ strb r3,[r14,#-2] -+ eor r1,r9,r1,lsr#8 -+ strb r0,[r14,#-13] -+ eor r2,r10,r2,lsr#8 -+ strb r1,[r14,#-9] -+ eor r3,r11,r3,lsr#8 -+ strb r2,[r14,#-5] -+ strb r3,[r14,#-1] -+ add r8,sp,#4*(4+8) -+ ldmia r8,{r8-r11} @ load key material -+ add r4,r4,r8 @ accumulate key material -+#ifdef __thumb2__ -+ itt hi -+#endif -+ addhi r8,r8,#1 @ next counter value -+ strhi r8,[sp,#4*(12)] @ save next counter value -+ add r5,r5,r9 -+ add r6,r6,r10 -+#ifdef __thumb2__ -+ itete lo -+#endif -+ eorlo r8,r8,r8 @ zero or ... -+ ldrhsb r8,[r12],#16 @ ... load input -+ eorlo r9,r9,r9 -+ ldrhsb r9,[r12,#-12] -+ -+ add r7,r7,r11 -+#ifdef __thumb2__ -+ itete lo -+#endif -+ eorlo r10,r10,r10 -+ ldrhsb r10,[r12,#-8] -+ eorlo r11,r11,r11 -+ ldrhsb r11,[r12,#-4] -+ -+ eor r4,r8,r4 @ xor with input (or zero) -+ eor r5,r9,r5 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r8,[r12,#-15] @ load more input -+ ldrhsb r9,[r12,#-11] -+ eor r6,r10,r6 -+ strb r4,[r14],#16 @ store output -+ eor r7,r11,r7 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r10,[r12,#-7] -+ ldrhsb r11,[r12,#-3] -+ strb r5,[r14,#-12] -+ eor r4,r8,r4,lsr#8 -+ strb r6,[r14,#-8] -+ eor r5,r9,r5,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r8,[r12,#-14] @ load more input -+ ldrhsb r9,[r12,#-10] -+ strb r7,[r14,#-4] -+ eor r6,r10,r6,lsr#8 -+ strb r4,[r14,#-15] -+ eor r7,r11,r7,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r10,[r12,#-6] -+ ldrhsb r11,[r12,#-2] -+ strb r5,[r14,#-11] -+ eor r4,r8,r4,lsr#8 -+ strb r6,[r14,#-7] -+ eor r5,r9,r5,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r8,[r12,#-13] @ load more input -+ ldrhsb r9,[r12,#-9] -+ strb r7,[r14,#-3] -+ eor r6,r10,r6,lsr#8 -+ strb r4,[r14,#-14] -+ eor r7,r11,r7,lsr#8 -+#ifdef __thumb2__ -+ itt hs -+#endif -+ ldrhsb r10,[r12,#-5] -+ ldrhsb r11,[r12,#-1] -+ strb r5,[r14,#-10] -+ strb r6,[r14,#-6] -+ eor r4,r8,r4,lsr#8 -+ strb r7,[r14,#-2] -+ eor r5,r9,r5,lsr#8 -+ strb r4,[r14,#-13] -+ eor r6,r10,r6,lsr#8 -+ strb r5,[r14,#-9] -+ eor r7,r11,r7,lsr#8 -+ strb r6,[r14,#-5] -+ strb r7,[r14,#-1] -+#ifdef __thumb2__ -+ it ne -+#endif -+ ldrne r8,[sp,#4*(32+2)] @ re-load len -+#ifdef __thumb2__ -+ it hs -+#endif -+ subhs r11,r8,#64 @ len-=64 -+ bhi .Loop_outer -+ -+ beq .Ldone -+#endif -+ -+.Ltail: -+ ldr r12,[sp,#4*(32+1)] @ load inp -+ add r9,sp,#4*(0) -+ ldr r14,[sp,#4*(32+0)] @ load out -+ -+.Loop_tail: -+ ldrb r10,[r9],#1 @ read buffer on stack -+ ldrb r11,[r12],#1 @ read input -+ subs r8,r8,#1 -+ eor r11,r11,r10 -+ strb r11,[r14],#1 @ store output -+ bne .Loop_tail -+ -+.Ldone: -+ add sp,sp,#4*(32+3) -+.Lno_data_arm: -+ ldmia sp!,{r4-r11,pc} -+ENDPROC(chacha20_arm) ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/chacha20-x86_64.S 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,2630 @@ -+/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) -+ * -+ * Copyright (C) 2017 Samuel Neves . All Rights Reserved. -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. -+ */ -+ -+#include -+ -+.section .rodata.cst16.Lzero, "aM", @progbits, 16 -+.align 16 -+.Lzero: -+.long 0,0,0,0 -+.section .rodata.cst16.Lone, "aM", @progbits, 16 -+.align 16 -+.Lone: -+.long 1,0,0,0 -+.section .rodata.cst16.Linc, "aM", @progbits, 16 -+.align 16 -+.Linc: -+.long 0,1,2,3 -+.section .rodata.cst16.Lfour, "aM", @progbits, 16 -+.align 16 -+.Lfour: -+.long 4,4,4,4 -+.section .rodata.cst32.Lincy, "aM", @progbits, 32 -+.align 32 -+.Lincy: -+.long 0,2,4,6,1,3,5,7 -+.section .rodata.cst32.Leight, "aM", @progbits, 32 -+.align 32 -+.Leight: -+.long 8,8,8,8,8,8,8,8 -+.section .rodata.cst16.Lrot16, "aM", @progbits, 16 -+.align 16 -+.Lrot16: -+.byte 0x2,0x3,0x0,0x1, 0x6,0x7,0x4,0x5, 0xa,0xb,0x8,0x9, 0xe,0xf,0xc,0xd -+.section .rodata.cst16.Lrot24, "aM", @progbits, 16 -+.align 16 -+.Lrot24: -+.byte 0x3,0x0,0x1,0x2, 0x7,0x4,0x5,0x6, 0xb,0x8,0x9,0xa, 0xf,0xc,0xd,0xe -+.section .rodata.cst16.Lsigma, "aM", @progbits, 16 -+.align 16 -+.Lsigma: -+.byte 101,120,112,97,110,100,32,51,50,45,98,121,116,101,32,107,0 -+.section .rodata.cst64.Lzeroz, "aM", @progbits, 64 -+.align 64 -+.Lzeroz: -+.long 0,0,0,0, 1,0,0,0, 2,0,0,0, 3,0,0,0 -+.section .rodata.cst64.Lfourz, "aM", @progbits, 64 -+.align 64 -+.Lfourz: -+.long 4,0,0,0, 4,0,0,0, 4,0,0,0, 4,0,0,0 -+.section .rodata.cst64.Lincz, "aM", @progbits, 64 -+.align 64 -+.Lincz: -+.long 0,1,2,3,4,5,6,7,8,9,10,11,12,13,14,15 -+.section .rodata.cst64.Lsixteen, "aM", @progbits, 64 -+.align 64 -+.Lsixteen: -+.long 16,16,16,16,16,16,16,16,16,16,16,16,16,16,16,16 -+.section .rodata.cst32.Ltwoy, "aM", @progbits, 32 -+.align 64 -+.Ltwoy: -+.long 2,0,0,0, 2,0,0,0 -+ -+.text -+ -+#ifdef CONFIG_AS_SSSE3 -+.align 32 -+ENTRY(hchacha20_ssse3) -+ movdqa .Lsigma(%rip),%xmm0 -+ movdqu (%rdx),%xmm1 -+ movdqu 16(%rdx),%xmm2 -+ movdqu (%rsi),%xmm3 -+ movdqa .Lrot16(%rip),%xmm6 -+ movdqa .Lrot24(%rip),%xmm7 -+ movq $10,%r8 -+ .align 32 -+.Loop_hssse3: -+ paddd %xmm1,%xmm0 -+ pxor %xmm0,%xmm3 -+ pshufb %xmm6,%xmm3 -+ paddd %xmm3,%xmm2 -+ pxor %xmm2,%xmm1 -+ movdqa %xmm1,%xmm4 -+ psrld $20,%xmm1 -+ pslld $12,%xmm4 -+ por %xmm4,%xmm1 -+ paddd %xmm1,%xmm0 -+ pxor %xmm0,%xmm3 -+ pshufb %xmm7,%xmm3 -+ paddd %xmm3,%xmm2 -+ pxor %xmm2,%xmm1 -+ movdqa %xmm1,%xmm4 -+ psrld $25,%xmm1 -+ pslld $7,%xmm4 -+ por %xmm4,%xmm1 -+ pshufd $78,%xmm2,%xmm2 -+ pshufd $57,%xmm1,%xmm1 -+ pshufd $147,%xmm3,%xmm3 -+ nop -+ paddd %xmm1,%xmm0 -+ pxor %xmm0,%xmm3 -+ pshufb %xmm6,%xmm3 -+ paddd %xmm3,%xmm2 -+ pxor %xmm2,%xmm1 -+ movdqa %xmm1,%xmm4 -+ psrld $20,%xmm1 -+ pslld $12,%xmm4 -+ por %xmm4,%xmm1 -+ paddd %xmm1,%xmm0 -+ pxor %xmm0,%xmm3 -+ pshufb %xmm7,%xmm3 -+ paddd %xmm3,%xmm2 -+ pxor %xmm2,%xmm1 -+ movdqa %xmm1,%xmm4 -+ psrld $25,%xmm1 -+ pslld $7,%xmm4 -+ por %xmm4,%xmm1 -+ pshufd $78,%xmm2,%xmm2 -+ pshufd $147,%xmm1,%xmm1 -+ pshufd $57,%xmm3,%xmm3 -+ decq %r8 -+ jnz .Loop_hssse3 -+ movdqu %xmm0,0(%rdi) -+ movdqu %xmm3,16(%rdi) -+ ret -+ENDPROC(hchacha20_ssse3) -+ -+.align 32 -+ENTRY(chacha20_ssse3) -+.Lchacha20_ssse3: -+ cmpq $0,%rdx -+ je .Lssse3_epilogue -+ leaq 8(%rsp),%r10 -+ -+ cmpq $128,%rdx -+ ja .Lchacha20_4x -+ -+.Ldo_sse3_after_all: -+ subq $64+8,%rsp -+ andq $-32,%rsp -+ movdqa .Lsigma(%rip),%xmm0 -+ movdqu (%rcx),%xmm1 -+ movdqu 16(%rcx),%xmm2 -+ movdqu (%r8),%xmm3 -+ movdqa .Lrot16(%rip),%xmm6 -+ movdqa .Lrot24(%rip),%xmm7 -+ -+ movdqa %xmm0,0(%rsp) -+ movdqa %xmm1,16(%rsp) -+ movdqa %xmm2,32(%rsp) -+ movdqa %xmm3,48(%rsp) -+ movq $10,%r8 -+ jmp .Loop_ssse3 -+ -+.align 32 -+.Loop_outer_ssse3: -+ movdqa .Lone(%rip),%xmm3 -+ movdqa 0(%rsp),%xmm0 -+ movdqa 16(%rsp),%xmm1 -+ movdqa 32(%rsp),%xmm2 -+ paddd 48(%rsp),%xmm3 -+ movq $10,%r8 -+ movdqa %xmm3,48(%rsp) -+ jmp .Loop_ssse3 -+ -+.align 32 -+.Loop_ssse3: -+ paddd %xmm1,%xmm0 -+ pxor %xmm0,%xmm3 -+ pshufb %xmm6,%xmm3 -+ paddd %xmm3,%xmm2 -+ pxor %xmm2,%xmm1 -+ movdqa %xmm1,%xmm4 -+ psrld $20,%xmm1 -+ pslld $12,%xmm4 -+ por %xmm4,%xmm1 -+ paddd %xmm1,%xmm0 -+ pxor %xmm0,%xmm3 -+ pshufb %xmm7,%xmm3 -+ paddd %xmm3,%xmm2 -+ pxor %xmm2,%xmm1 -+ movdqa %xmm1,%xmm4 -+ psrld $25,%xmm1 -+ pslld $7,%xmm4 -+ por %xmm4,%xmm1 -+ pshufd $78,%xmm2,%xmm2 -+ pshufd $57,%xmm1,%xmm1 -+ pshufd $147,%xmm3,%xmm3 -+ nop -+ paddd %xmm1,%xmm0 -+ pxor %xmm0,%xmm3 -+ pshufb %xmm6,%xmm3 -+ paddd %xmm3,%xmm2 -+ pxor %xmm2,%xmm1 -+ movdqa %xmm1,%xmm4 -+ psrld $20,%xmm1 -+ pslld $12,%xmm4 -+ por %xmm4,%xmm1 -+ paddd %xmm1,%xmm0 -+ pxor %xmm0,%xmm3 -+ pshufb %xmm7,%xmm3 -+ paddd %xmm3,%xmm2 -+ pxor %xmm2,%xmm1 -+ movdqa %xmm1,%xmm4 -+ psrld $25,%xmm1 -+ pslld $7,%xmm4 -+ por %xmm4,%xmm1 -+ pshufd $78,%xmm2,%xmm2 -+ pshufd $147,%xmm1,%xmm1 -+ pshufd $57,%xmm3,%xmm3 -+ decq %r8 -+ jnz .Loop_ssse3 -+ paddd 0(%rsp),%xmm0 -+ paddd 16(%rsp),%xmm1 -+ paddd 32(%rsp),%xmm2 -+ paddd 48(%rsp),%xmm3 -+ -+ cmpq $64,%rdx -+ jb .Ltail_ssse3 -+ -+ movdqu 0(%rsi),%xmm4 -+ movdqu 16(%rsi),%xmm5 -+ pxor %xmm4,%xmm0 -+ movdqu 32(%rsi),%xmm4 -+ pxor %xmm5,%xmm1 -+ movdqu 48(%rsi),%xmm5 -+ leaq 64(%rsi),%rsi -+ pxor %xmm4,%xmm2 -+ pxor %xmm5,%xmm3 -+ -+ movdqu %xmm0,0(%rdi) -+ movdqu %xmm1,16(%rdi) -+ movdqu %xmm2,32(%rdi) -+ movdqu %xmm3,48(%rdi) -+ leaq 64(%rdi),%rdi -+ -+ subq $64,%rdx -+ jnz .Loop_outer_ssse3 -+ -+ jmp .Ldone_ssse3 -+ -+.align 16 -+.Ltail_ssse3: -+ movdqa %xmm0,0(%rsp) -+ movdqa %xmm1,16(%rsp) -+ movdqa %xmm2,32(%rsp) -+ movdqa %xmm3,48(%rsp) -+ xorq %r8,%r8 -+ -+.Loop_tail_ssse3: -+ movzbl (%rsi,%r8,1),%eax -+ movzbl (%rsp,%r8,1),%ecx -+ leaq 1(%r8),%r8 -+ xorl %ecx,%eax -+ movb %al,-1(%rdi,%r8,1) -+ decq %rdx -+ jnz .Loop_tail_ssse3 -+ -+.Ldone_ssse3: -+ leaq -8(%r10),%rsp -+ -+.Lssse3_epilogue: -+ ret -+ -+.align 32 -+.Lchacha20_4x: -+ leaq 8(%rsp),%r10 -+ -+.Lproceed4x: -+ subq $0x140+8,%rsp -+ andq $-32,%rsp -+ movdqa .Lsigma(%rip),%xmm11 -+ movdqu (%rcx),%xmm15 -+ movdqu 16(%rcx),%xmm7 -+ movdqu (%r8),%xmm3 -+ leaq 256(%rsp),%rcx -+ leaq .Lrot16(%rip),%r9 -+ leaq .Lrot24(%rip),%r11 -+ -+ pshufd $0x00,%xmm11,%xmm8 -+ pshufd $0x55,%xmm11,%xmm9 -+ movdqa %xmm8,64(%rsp) -+ pshufd $0xaa,%xmm11,%xmm10 -+ movdqa %xmm9,80(%rsp) -+ pshufd $0xff,%xmm11,%xmm11 -+ movdqa %xmm10,96(%rsp) -+ movdqa %xmm11,112(%rsp) -+ -+ pshufd $0x00,%xmm15,%xmm12 -+ pshufd $0x55,%xmm15,%xmm13 -+ movdqa %xmm12,128-256(%rcx) -+ pshufd $0xaa,%xmm15,%xmm14 -+ movdqa %xmm13,144-256(%rcx) -+ pshufd $0xff,%xmm15,%xmm15 -+ movdqa %xmm14,160-256(%rcx) -+ movdqa %xmm15,176-256(%rcx) -+ -+ pshufd $0x00,%xmm7,%xmm4 -+ pshufd $0x55,%xmm7,%xmm5 -+ movdqa %xmm4,192-256(%rcx) -+ pshufd $0xaa,%xmm7,%xmm6 -+ movdqa %xmm5,208-256(%rcx) -+ pshufd $0xff,%xmm7,%xmm7 -+ movdqa %xmm6,224-256(%rcx) -+ movdqa %xmm7,240-256(%rcx) -+ -+ pshufd $0x00,%xmm3,%xmm0 -+ pshufd $0x55,%xmm3,%xmm1 -+ paddd .Linc(%rip),%xmm0 -+ pshufd $0xaa,%xmm3,%xmm2 -+ movdqa %xmm1,272-256(%rcx) -+ pshufd $0xff,%xmm3,%xmm3 -+ movdqa %xmm2,288-256(%rcx) -+ movdqa %xmm3,304-256(%rcx) -+ -+ jmp .Loop_enter4x -+ -+.align 32 -+.Loop_outer4x: -+ movdqa 64(%rsp),%xmm8 -+ movdqa 80(%rsp),%xmm9 -+ movdqa 96(%rsp),%xmm10 -+ movdqa 112(%rsp),%xmm11 -+ movdqa 128-256(%rcx),%xmm12 -+ movdqa 144-256(%rcx),%xmm13 -+ movdqa 160-256(%rcx),%xmm14 -+ movdqa 176-256(%rcx),%xmm15 -+ movdqa 192-256(%rcx),%xmm4 -+ movdqa 208-256(%rcx),%xmm5 -+ movdqa 224-256(%rcx),%xmm6 -+ movdqa 240-256(%rcx),%xmm7 -+ movdqa 256-256(%rcx),%xmm0 -+ movdqa 272-256(%rcx),%xmm1 -+ movdqa 288-256(%rcx),%xmm2 -+ movdqa 304-256(%rcx),%xmm3 -+ paddd .Lfour(%rip),%xmm0 -+ -+.Loop_enter4x: -+ movdqa %xmm6,32(%rsp) -+ movdqa %xmm7,48(%rsp) -+ movdqa (%r9),%xmm7 -+ movl $10,%eax -+ movdqa %xmm0,256-256(%rcx) -+ jmp .Loop4x -+ -+.align 32 -+.Loop4x: -+ paddd %xmm12,%xmm8 -+ paddd %xmm13,%xmm9 -+ pxor %xmm8,%xmm0 -+ pxor %xmm9,%xmm1 -+ pshufb %xmm7,%xmm0 -+ pshufb %xmm7,%xmm1 -+ paddd %xmm0,%xmm4 -+ paddd %xmm1,%xmm5 -+ pxor %xmm4,%xmm12 -+ pxor %xmm5,%xmm13 -+ movdqa %xmm12,%xmm6 -+ pslld $12,%xmm12 -+ psrld $20,%xmm6 -+ movdqa %xmm13,%xmm7 -+ pslld $12,%xmm13 -+ por %xmm6,%xmm12 -+ psrld $20,%xmm7 -+ movdqa (%r11),%xmm6 -+ por %xmm7,%xmm13 -+ paddd %xmm12,%xmm8 -+ paddd %xmm13,%xmm9 -+ pxor %xmm8,%xmm0 -+ pxor %xmm9,%xmm1 -+ pshufb %xmm6,%xmm0 -+ pshufb %xmm6,%xmm1 -+ paddd %xmm0,%xmm4 -+ paddd %xmm1,%xmm5 -+ pxor %xmm4,%xmm12 -+ pxor %xmm5,%xmm13 -+ movdqa %xmm12,%xmm7 -+ pslld $7,%xmm12 -+ psrld $25,%xmm7 -+ movdqa %xmm13,%xmm6 -+ pslld $7,%xmm13 -+ por %xmm7,%xmm12 -+ psrld $25,%xmm6 -+ movdqa (%r9),%xmm7 -+ por %xmm6,%xmm13 -+ movdqa %xmm4,0(%rsp) -+ movdqa %xmm5,16(%rsp) -+ movdqa 32(%rsp),%xmm4 -+ movdqa 48(%rsp),%xmm5 -+ paddd %xmm14,%xmm10 -+ paddd %xmm15,%xmm11 -+ pxor %xmm10,%xmm2 -+ pxor %xmm11,%xmm3 -+ pshufb %xmm7,%xmm2 -+ pshufb %xmm7,%xmm3 -+ paddd %xmm2,%xmm4 -+ paddd %xmm3,%xmm5 -+ pxor %xmm4,%xmm14 -+ pxor %xmm5,%xmm15 -+ movdqa %xmm14,%xmm6 -+ pslld $12,%xmm14 -+ psrld $20,%xmm6 -+ movdqa %xmm15,%xmm7 -+ pslld $12,%xmm15 -+ por %xmm6,%xmm14 -+ psrld $20,%xmm7 -+ movdqa (%r11),%xmm6 -+ por %xmm7,%xmm15 -+ paddd %xmm14,%xmm10 -+ paddd %xmm15,%xmm11 -+ pxor %xmm10,%xmm2 -+ pxor %xmm11,%xmm3 -+ pshufb %xmm6,%xmm2 -+ pshufb %xmm6,%xmm3 -+ paddd %xmm2,%xmm4 -+ paddd %xmm3,%xmm5 -+ pxor %xmm4,%xmm14 -+ pxor %xmm5,%xmm15 -+ movdqa %xmm14,%xmm7 -+ pslld $7,%xmm14 -+ psrld $25,%xmm7 -+ movdqa %xmm15,%xmm6 -+ pslld $7,%xmm15 -+ por %xmm7,%xmm14 -+ psrld $25,%xmm6 -+ movdqa (%r9),%xmm7 -+ por %xmm6,%xmm15 -+ paddd %xmm13,%xmm8 -+ paddd %xmm14,%xmm9 -+ pxor %xmm8,%xmm3 -+ pxor %xmm9,%xmm0 -+ pshufb %xmm7,%xmm3 -+ pshufb %xmm7,%xmm0 -+ paddd %xmm3,%xmm4 -+ paddd %xmm0,%xmm5 -+ pxor %xmm4,%xmm13 -+ pxor %xmm5,%xmm14 -+ movdqa %xmm13,%xmm6 -+ pslld $12,%xmm13 -+ psrld $20,%xmm6 -+ movdqa %xmm14,%xmm7 -+ pslld $12,%xmm14 -+ por %xmm6,%xmm13 -+ psrld $20,%xmm7 -+ movdqa (%r11),%xmm6 -+ por %xmm7,%xmm14 -+ paddd %xmm13,%xmm8 -+ paddd %xmm14,%xmm9 -+ pxor %xmm8,%xmm3 -+ pxor %xmm9,%xmm0 -+ pshufb %xmm6,%xmm3 -+ pshufb %xmm6,%xmm0 -+ paddd %xmm3,%xmm4 -+ paddd %xmm0,%xmm5 -+ pxor %xmm4,%xmm13 -+ pxor %xmm5,%xmm14 -+ movdqa %xmm13,%xmm7 -+ pslld $7,%xmm13 -+ psrld $25,%xmm7 -+ movdqa %xmm14,%xmm6 -+ pslld $7,%xmm14 -+ por %xmm7,%xmm13 -+ psrld $25,%xmm6 -+ movdqa (%r9),%xmm7 -+ por %xmm6,%xmm14 -+ movdqa %xmm4,32(%rsp) -+ movdqa %xmm5,48(%rsp) -+ movdqa 0(%rsp),%xmm4 -+ movdqa 16(%rsp),%xmm5 -+ paddd %xmm15,%xmm10 -+ paddd %xmm12,%xmm11 -+ pxor %xmm10,%xmm1 -+ pxor %xmm11,%xmm2 -+ pshufb %xmm7,%xmm1 -+ pshufb %xmm7,%xmm2 -+ paddd %xmm1,%xmm4 -+ paddd %xmm2,%xmm5 -+ pxor %xmm4,%xmm15 -+ pxor %xmm5,%xmm12 -+ movdqa %xmm15,%xmm6 -+ pslld $12,%xmm15 -+ psrld $20,%xmm6 -+ movdqa %xmm12,%xmm7 -+ pslld $12,%xmm12 -+ por %xmm6,%xmm15 -+ psrld $20,%xmm7 -+ movdqa (%r11),%xmm6 -+ por %xmm7,%xmm12 -+ paddd %xmm15,%xmm10 -+ paddd %xmm12,%xmm11 -+ pxor %xmm10,%xmm1 -+ pxor %xmm11,%xmm2 -+ pshufb %xmm6,%xmm1 -+ pshufb %xmm6,%xmm2 -+ paddd %xmm1,%xmm4 -+ paddd %xmm2,%xmm5 -+ pxor %xmm4,%xmm15 -+ pxor %xmm5,%xmm12 -+ movdqa %xmm15,%xmm7 -+ pslld $7,%xmm15 -+ psrld $25,%xmm7 -+ movdqa %xmm12,%xmm6 -+ pslld $7,%xmm12 -+ por %xmm7,%xmm15 -+ psrld $25,%xmm6 -+ movdqa (%r9),%xmm7 -+ por %xmm6,%xmm12 -+ decl %eax -+ jnz .Loop4x -+ -+ paddd 64(%rsp),%xmm8 -+ paddd 80(%rsp),%xmm9 -+ paddd 96(%rsp),%xmm10 -+ paddd 112(%rsp),%xmm11 -+ -+ movdqa %xmm8,%xmm6 -+ punpckldq %xmm9,%xmm8 -+ movdqa %xmm10,%xmm7 -+ punpckldq %xmm11,%xmm10 -+ punpckhdq %xmm9,%xmm6 -+ punpckhdq %xmm11,%xmm7 -+ movdqa %xmm8,%xmm9 -+ punpcklqdq %xmm10,%xmm8 -+ movdqa %xmm6,%xmm11 -+ punpcklqdq %xmm7,%xmm6 -+ punpckhqdq %xmm10,%xmm9 -+ punpckhqdq %xmm7,%xmm11 -+ paddd 128-256(%rcx),%xmm12 -+ paddd 144-256(%rcx),%xmm13 -+ paddd 160-256(%rcx),%xmm14 -+ paddd 176-256(%rcx),%xmm15 -+ -+ movdqa %xmm8,0(%rsp) -+ movdqa %xmm9,16(%rsp) -+ movdqa 32(%rsp),%xmm8 -+ movdqa 48(%rsp),%xmm9 -+ -+ movdqa %xmm12,%xmm10 -+ punpckldq %xmm13,%xmm12 -+ movdqa %xmm14,%xmm7 -+ punpckldq %xmm15,%xmm14 -+ punpckhdq %xmm13,%xmm10 -+ punpckhdq %xmm15,%xmm7 -+ movdqa %xmm12,%xmm13 -+ punpcklqdq %xmm14,%xmm12 -+ movdqa %xmm10,%xmm15 -+ punpcklqdq %xmm7,%xmm10 -+ punpckhqdq %xmm14,%xmm13 -+ punpckhqdq %xmm7,%xmm15 -+ paddd 192-256(%rcx),%xmm4 -+ paddd 208-256(%rcx),%xmm5 -+ paddd 224-256(%rcx),%xmm8 -+ paddd 240-256(%rcx),%xmm9 -+ -+ movdqa %xmm6,32(%rsp) -+ movdqa %xmm11,48(%rsp) -+ -+ movdqa %xmm4,%xmm14 -+ punpckldq %xmm5,%xmm4 -+ movdqa %xmm8,%xmm7 -+ punpckldq %xmm9,%xmm8 -+ punpckhdq %xmm5,%xmm14 -+ punpckhdq %xmm9,%xmm7 -+ movdqa %xmm4,%xmm5 -+ punpcklqdq %xmm8,%xmm4 -+ movdqa %xmm14,%xmm9 -+ punpcklqdq %xmm7,%xmm14 -+ punpckhqdq %xmm8,%xmm5 -+ punpckhqdq %xmm7,%xmm9 -+ paddd 256-256(%rcx),%xmm0 -+ paddd 272-256(%rcx),%xmm1 -+ paddd 288-256(%rcx),%xmm2 -+ paddd 304-256(%rcx),%xmm3 -+ -+ movdqa %xmm0,%xmm8 -+ punpckldq %xmm1,%xmm0 -+ movdqa %xmm2,%xmm7 -+ punpckldq %xmm3,%xmm2 -+ punpckhdq %xmm1,%xmm8 -+ punpckhdq %xmm3,%xmm7 -+ movdqa %xmm0,%xmm1 -+ punpcklqdq %xmm2,%xmm0 -+ movdqa %xmm8,%xmm3 -+ punpcklqdq %xmm7,%xmm8 -+ punpckhqdq %xmm2,%xmm1 -+ punpckhqdq %xmm7,%xmm3 -+ cmpq $256,%rdx -+ jb .Ltail4x -+ -+ movdqu 0(%rsi),%xmm6 -+ movdqu 16(%rsi),%xmm11 -+ movdqu 32(%rsi),%xmm2 -+ movdqu 48(%rsi),%xmm7 -+ pxor 0(%rsp),%xmm6 -+ pxor %xmm12,%xmm11 -+ pxor %xmm4,%xmm2 -+ pxor %xmm0,%xmm7 -+ -+ movdqu %xmm6,0(%rdi) -+ movdqu 64(%rsi),%xmm6 -+ movdqu %xmm11,16(%rdi) -+ movdqu 80(%rsi),%xmm11 -+ movdqu %xmm2,32(%rdi) -+ movdqu 96(%rsi),%xmm2 -+ movdqu %xmm7,48(%rdi) -+ movdqu 112(%rsi),%xmm7 -+ leaq 128(%rsi),%rsi -+ pxor 16(%rsp),%xmm6 -+ pxor %xmm13,%xmm11 -+ pxor %xmm5,%xmm2 -+ pxor %xmm1,%xmm7 -+ -+ movdqu %xmm6,64(%rdi) -+ movdqu 0(%rsi),%xmm6 -+ movdqu %xmm11,80(%rdi) -+ movdqu 16(%rsi),%xmm11 -+ movdqu %xmm2,96(%rdi) -+ movdqu 32(%rsi),%xmm2 -+ movdqu %xmm7,112(%rdi) -+ leaq 128(%rdi),%rdi -+ movdqu 48(%rsi),%xmm7 -+ pxor 32(%rsp),%xmm6 -+ pxor %xmm10,%xmm11 -+ pxor %xmm14,%xmm2 -+ pxor %xmm8,%xmm7 -+ -+ movdqu %xmm6,0(%rdi) -+ movdqu 64(%rsi),%xmm6 -+ movdqu %xmm11,16(%rdi) -+ movdqu 80(%rsi),%xmm11 -+ movdqu %xmm2,32(%rdi) -+ movdqu 96(%rsi),%xmm2 -+ movdqu %xmm7,48(%rdi) -+ movdqu 112(%rsi),%xmm7 -+ leaq 128(%rsi),%rsi -+ pxor 48(%rsp),%xmm6 -+ pxor %xmm15,%xmm11 -+ pxor %xmm9,%xmm2 -+ pxor %xmm3,%xmm7 -+ movdqu %xmm6,64(%rdi) -+ movdqu %xmm11,80(%rdi) -+ movdqu %xmm2,96(%rdi) -+ movdqu %xmm7,112(%rdi) -+ leaq 128(%rdi),%rdi -+ -+ subq $256,%rdx -+ jnz .Loop_outer4x -+ -+ jmp .Ldone4x -+ -+.Ltail4x: -+ cmpq $192,%rdx -+ jae .L192_or_more4x -+ cmpq $128,%rdx -+ jae .L128_or_more4x -+ cmpq $64,%rdx -+ jae .L64_or_more4x -+ -+ -+ xorq %r9,%r9 -+ -+ movdqa %xmm12,16(%rsp) -+ movdqa %xmm4,32(%rsp) -+ movdqa %xmm0,48(%rsp) -+ jmp .Loop_tail4x -+ -+.align 32 -+.L64_or_more4x: -+ movdqu 0(%rsi),%xmm6 -+ movdqu 16(%rsi),%xmm11 -+ movdqu 32(%rsi),%xmm2 -+ movdqu 48(%rsi),%xmm7 -+ pxor 0(%rsp),%xmm6 -+ pxor %xmm12,%xmm11 -+ pxor %xmm4,%xmm2 -+ pxor %xmm0,%xmm7 -+ movdqu %xmm6,0(%rdi) -+ movdqu %xmm11,16(%rdi) -+ movdqu %xmm2,32(%rdi) -+ movdqu %xmm7,48(%rdi) -+ je .Ldone4x -+ -+ movdqa 16(%rsp),%xmm6 -+ leaq 64(%rsi),%rsi -+ xorq %r9,%r9 -+ movdqa %xmm6,0(%rsp) -+ movdqa %xmm13,16(%rsp) -+ leaq 64(%rdi),%rdi -+ movdqa %xmm5,32(%rsp) -+ subq $64,%rdx -+ movdqa %xmm1,48(%rsp) -+ jmp .Loop_tail4x -+ -+.align 32 -+.L128_or_more4x: -+ movdqu 0(%rsi),%xmm6 -+ movdqu 16(%rsi),%xmm11 -+ movdqu 32(%rsi),%xmm2 -+ movdqu 48(%rsi),%xmm7 -+ pxor 0(%rsp),%xmm6 -+ pxor %xmm12,%xmm11 -+ pxor %xmm4,%xmm2 -+ pxor %xmm0,%xmm7 -+ -+ movdqu %xmm6,0(%rdi) -+ movdqu 64(%rsi),%xmm6 -+ movdqu %xmm11,16(%rdi) -+ movdqu 80(%rsi),%xmm11 -+ movdqu %xmm2,32(%rdi) -+ movdqu 96(%rsi),%xmm2 -+ movdqu %xmm7,48(%rdi) -+ movdqu 112(%rsi),%xmm7 -+ pxor 16(%rsp),%xmm6 -+ pxor %xmm13,%xmm11 -+ pxor %xmm5,%xmm2 -+ pxor %xmm1,%xmm7 -+ movdqu %xmm6,64(%rdi) -+ movdqu %xmm11,80(%rdi) -+ movdqu %xmm2,96(%rdi) -+ movdqu %xmm7,112(%rdi) -+ je .Ldone4x -+ -+ movdqa 32(%rsp),%xmm6 -+ leaq 128(%rsi),%rsi -+ xorq %r9,%r9 -+ movdqa %xmm6,0(%rsp) -+ movdqa %xmm10,16(%rsp) -+ leaq 128(%rdi),%rdi -+ movdqa %xmm14,32(%rsp) -+ subq $128,%rdx -+ movdqa %xmm8,48(%rsp) -+ jmp .Loop_tail4x -+ -+.align 32 -+.L192_or_more4x: -+ movdqu 0(%rsi),%xmm6 -+ movdqu 16(%rsi),%xmm11 -+ movdqu 32(%rsi),%xmm2 -+ movdqu 48(%rsi),%xmm7 -+ pxor 0(%rsp),%xmm6 -+ pxor %xmm12,%xmm11 -+ pxor %xmm4,%xmm2 -+ pxor %xmm0,%xmm7 -+ -+ movdqu %xmm6,0(%rdi) -+ movdqu 64(%rsi),%xmm6 -+ movdqu %xmm11,16(%rdi) -+ movdqu 80(%rsi),%xmm11 -+ movdqu %xmm2,32(%rdi) -+ movdqu 96(%rsi),%xmm2 -+ movdqu %xmm7,48(%rdi) -+ movdqu 112(%rsi),%xmm7 -+ leaq 128(%rsi),%rsi -+ pxor 16(%rsp),%xmm6 -+ pxor %xmm13,%xmm11 -+ pxor %xmm5,%xmm2 -+ pxor %xmm1,%xmm7 -+ -+ movdqu %xmm6,64(%rdi) -+ movdqu 0(%rsi),%xmm6 -+ movdqu %xmm11,80(%rdi) -+ movdqu 16(%rsi),%xmm11 -+ movdqu %xmm2,96(%rdi) -+ movdqu 32(%rsi),%xmm2 -+ movdqu %xmm7,112(%rdi) -+ leaq 128(%rdi),%rdi -+ movdqu 48(%rsi),%xmm7 -+ pxor 32(%rsp),%xmm6 -+ pxor %xmm10,%xmm11 -+ pxor %xmm14,%xmm2 -+ pxor %xmm8,%xmm7 -+ movdqu %xmm6,0(%rdi) -+ movdqu %xmm11,16(%rdi) -+ movdqu %xmm2,32(%rdi) -+ movdqu %xmm7,48(%rdi) -+ je .Ldone4x -+ -+ movdqa 48(%rsp),%xmm6 -+ leaq 64(%rsi),%rsi -+ xorq %r9,%r9 -+ movdqa %xmm6,0(%rsp) -+ movdqa %xmm15,16(%rsp) -+ leaq 64(%rdi),%rdi -+ movdqa %xmm9,32(%rsp) -+ subq $192,%rdx -+ movdqa %xmm3,48(%rsp) -+ -+.Loop_tail4x: -+ movzbl (%rsi,%r9,1),%eax -+ movzbl (%rsp,%r9,1),%ecx -+ leaq 1(%r9),%r9 -+ xorl %ecx,%eax -+ movb %al,-1(%rdi,%r9,1) -+ decq %rdx -+ jnz .Loop_tail4x -+ -+.Ldone4x: -+ leaq -8(%r10),%rsp -+ -+.L4x_epilogue: -+ ret -+ENDPROC(chacha20_ssse3) -+#endif /* CONFIG_AS_SSSE3 */ -+ -+#ifdef CONFIG_AS_AVX2 -+.align 32 -+ENTRY(chacha20_avx2) -+.Lchacha20_avx2: -+ cmpq $0,%rdx -+ je .L8x_epilogue -+ leaq 8(%rsp),%r10 -+ -+ subq $0x280+8,%rsp -+ andq $-32,%rsp -+ vzeroupper -+ -+ vbroadcasti128 .Lsigma(%rip),%ymm11 -+ vbroadcasti128 (%rcx),%ymm3 -+ vbroadcasti128 16(%rcx),%ymm15 -+ vbroadcasti128 (%r8),%ymm7 -+ leaq 256(%rsp),%rcx -+ leaq 512(%rsp),%rax -+ leaq .Lrot16(%rip),%r9 -+ leaq .Lrot24(%rip),%r11 -+ -+ vpshufd $0x00,%ymm11,%ymm8 -+ vpshufd $0x55,%ymm11,%ymm9 -+ vmovdqa %ymm8,128-256(%rcx) -+ vpshufd $0xaa,%ymm11,%ymm10 -+ vmovdqa %ymm9,160-256(%rcx) -+ vpshufd $0xff,%ymm11,%ymm11 -+ vmovdqa %ymm10,192-256(%rcx) -+ vmovdqa %ymm11,224-256(%rcx) -+ -+ vpshufd $0x00,%ymm3,%ymm0 -+ vpshufd $0x55,%ymm3,%ymm1 -+ vmovdqa %ymm0,256-256(%rcx) -+ vpshufd $0xaa,%ymm3,%ymm2 -+ vmovdqa %ymm1,288-256(%rcx) -+ vpshufd $0xff,%ymm3,%ymm3 -+ vmovdqa %ymm2,320-256(%rcx) -+ vmovdqa %ymm3,352-256(%rcx) -+ -+ vpshufd $0x00,%ymm15,%ymm12 -+ vpshufd $0x55,%ymm15,%ymm13 -+ vmovdqa %ymm12,384-512(%rax) -+ vpshufd $0xaa,%ymm15,%ymm14 -+ vmovdqa %ymm13,416-512(%rax) -+ vpshufd $0xff,%ymm15,%ymm15 -+ vmovdqa %ymm14,448-512(%rax) -+ vmovdqa %ymm15,480-512(%rax) -+ -+ vpshufd $0x00,%ymm7,%ymm4 -+ vpshufd $0x55,%ymm7,%ymm5 -+ vpaddd .Lincy(%rip),%ymm4,%ymm4 -+ vpshufd $0xaa,%ymm7,%ymm6 -+ vmovdqa %ymm5,544-512(%rax) -+ vpshufd $0xff,%ymm7,%ymm7 -+ vmovdqa %ymm6,576-512(%rax) -+ vmovdqa %ymm7,608-512(%rax) -+ -+ jmp .Loop_enter8x -+ -+.align 32 -+.Loop_outer8x: -+ vmovdqa 128-256(%rcx),%ymm8 -+ vmovdqa 160-256(%rcx),%ymm9 -+ vmovdqa 192-256(%rcx),%ymm10 -+ vmovdqa 224-256(%rcx),%ymm11 -+ vmovdqa 256-256(%rcx),%ymm0 -+ vmovdqa 288-256(%rcx),%ymm1 -+ vmovdqa 320-256(%rcx),%ymm2 -+ vmovdqa 352-256(%rcx),%ymm3 -+ vmovdqa 384-512(%rax),%ymm12 -+ vmovdqa 416-512(%rax),%ymm13 -+ vmovdqa 448-512(%rax),%ymm14 -+ vmovdqa 480-512(%rax),%ymm15 -+ vmovdqa 512-512(%rax),%ymm4 -+ vmovdqa 544-512(%rax),%ymm5 -+ vmovdqa 576-512(%rax),%ymm6 -+ vmovdqa 608-512(%rax),%ymm7 -+ vpaddd .Leight(%rip),%ymm4,%ymm4 -+ -+.Loop_enter8x: -+ vmovdqa %ymm14,64(%rsp) -+ vmovdqa %ymm15,96(%rsp) -+ vbroadcasti128 (%r9),%ymm15 -+ vmovdqa %ymm4,512-512(%rax) -+ movl $10,%eax -+ jmp .Loop8x -+ -+.align 32 -+.Loop8x: -+ vpaddd %ymm0,%ymm8,%ymm8 -+ vpxor %ymm4,%ymm8,%ymm4 -+ vpshufb %ymm15,%ymm4,%ymm4 -+ vpaddd %ymm1,%ymm9,%ymm9 -+ vpxor %ymm5,%ymm9,%ymm5 -+ vpshufb %ymm15,%ymm5,%ymm5 -+ vpaddd %ymm4,%ymm12,%ymm12 -+ vpxor %ymm0,%ymm12,%ymm0 -+ vpslld $12,%ymm0,%ymm14 -+ vpsrld $20,%ymm0,%ymm0 -+ vpor %ymm0,%ymm14,%ymm0 -+ vbroadcasti128 (%r11),%ymm14 -+ vpaddd %ymm5,%ymm13,%ymm13 -+ vpxor %ymm1,%ymm13,%ymm1 -+ vpslld $12,%ymm1,%ymm15 -+ vpsrld $20,%ymm1,%ymm1 -+ vpor %ymm1,%ymm15,%ymm1 -+ vpaddd %ymm0,%ymm8,%ymm8 -+ vpxor %ymm4,%ymm8,%ymm4 -+ vpshufb %ymm14,%ymm4,%ymm4 -+ vpaddd %ymm1,%ymm9,%ymm9 -+ vpxor %ymm5,%ymm9,%ymm5 -+ vpshufb %ymm14,%ymm5,%ymm5 -+ vpaddd %ymm4,%ymm12,%ymm12 -+ vpxor %ymm0,%ymm12,%ymm0 -+ vpslld $7,%ymm0,%ymm15 -+ vpsrld $25,%ymm0,%ymm0 -+ vpor %ymm0,%ymm15,%ymm0 -+ vbroadcasti128 (%r9),%ymm15 -+ vpaddd %ymm5,%ymm13,%ymm13 -+ vpxor %ymm1,%ymm13,%ymm1 -+ vpslld $7,%ymm1,%ymm14 -+ vpsrld $25,%ymm1,%ymm1 -+ vpor %ymm1,%ymm14,%ymm1 -+ vmovdqa %ymm12,0(%rsp) -+ vmovdqa %ymm13,32(%rsp) -+ vmovdqa 64(%rsp),%ymm12 -+ vmovdqa 96(%rsp),%ymm13 -+ vpaddd %ymm2,%ymm10,%ymm10 -+ vpxor %ymm6,%ymm10,%ymm6 -+ vpshufb %ymm15,%ymm6,%ymm6 -+ vpaddd %ymm3,%ymm11,%ymm11 -+ vpxor %ymm7,%ymm11,%ymm7 -+ vpshufb %ymm15,%ymm7,%ymm7 -+ vpaddd %ymm6,%ymm12,%ymm12 -+ vpxor %ymm2,%ymm12,%ymm2 -+ vpslld $12,%ymm2,%ymm14 -+ vpsrld $20,%ymm2,%ymm2 -+ vpor %ymm2,%ymm14,%ymm2 -+ vbroadcasti128 (%r11),%ymm14 -+ vpaddd %ymm7,%ymm13,%ymm13 -+ vpxor %ymm3,%ymm13,%ymm3 -+ vpslld $12,%ymm3,%ymm15 -+ vpsrld $20,%ymm3,%ymm3 -+ vpor %ymm3,%ymm15,%ymm3 -+ vpaddd %ymm2,%ymm10,%ymm10 -+ vpxor %ymm6,%ymm10,%ymm6 -+ vpshufb %ymm14,%ymm6,%ymm6 -+ vpaddd %ymm3,%ymm11,%ymm11 -+ vpxor %ymm7,%ymm11,%ymm7 -+ vpshufb %ymm14,%ymm7,%ymm7 -+ vpaddd %ymm6,%ymm12,%ymm12 -+ vpxor %ymm2,%ymm12,%ymm2 -+ vpslld $7,%ymm2,%ymm15 -+ vpsrld $25,%ymm2,%ymm2 -+ vpor %ymm2,%ymm15,%ymm2 -+ vbroadcasti128 (%r9),%ymm15 -+ vpaddd %ymm7,%ymm13,%ymm13 -+ vpxor %ymm3,%ymm13,%ymm3 -+ vpslld $7,%ymm3,%ymm14 -+ vpsrld $25,%ymm3,%ymm3 -+ vpor %ymm3,%ymm14,%ymm3 -+ vpaddd %ymm1,%ymm8,%ymm8 -+ vpxor %ymm7,%ymm8,%ymm7 -+ vpshufb %ymm15,%ymm7,%ymm7 -+ vpaddd %ymm2,%ymm9,%ymm9 -+ vpxor %ymm4,%ymm9,%ymm4 -+ vpshufb %ymm15,%ymm4,%ymm4 -+ vpaddd %ymm7,%ymm12,%ymm12 -+ vpxor %ymm1,%ymm12,%ymm1 -+ vpslld $12,%ymm1,%ymm14 -+ vpsrld $20,%ymm1,%ymm1 -+ vpor %ymm1,%ymm14,%ymm1 -+ vbroadcasti128 (%r11),%ymm14 -+ vpaddd %ymm4,%ymm13,%ymm13 -+ vpxor %ymm2,%ymm13,%ymm2 -+ vpslld $12,%ymm2,%ymm15 -+ vpsrld $20,%ymm2,%ymm2 -+ vpor %ymm2,%ymm15,%ymm2 -+ vpaddd %ymm1,%ymm8,%ymm8 -+ vpxor %ymm7,%ymm8,%ymm7 -+ vpshufb %ymm14,%ymm7,%ymm7 -+ vpaddd %ymm2,%ymm9,%ymm9 -+ vpxor %ymm4,%ymm9,%ymm4 -+ vpshufb %ymm14,%ymm4,%ymm4 -+ vpaddd %ymm7,%ymm12,%ymm12 -+ vpxor %ymm1,%ymm12,%ymm1 -+ vpslld $7,%ymm1,%ymm15 -+ vpsrld $25,%ymm1,%ymm1 -+ vpor %ymm1,%ymm15,%ymm1 -+ vbroadcasti128 (%r9),%ymm15 -+ vpaddd %ymm4,%ymm13,%ymm13 -+ vpxor %ymm2,%ymm13,%ymm2 -+ vpslld $7,%ymm2,%ymm14 -+ vpsrld $25,%ymm2,%ymm2 -+ vpor %ymm2,%ymm14,%ymm2 -+ vmovdqa %ymm12,64(%rsp) -+ vmovdqa %ymm13,96(%rsp) -+ vmovdqa 0(%rsp),%ymm12 -+ vmovdqa 32(%rsp),%ymm13 -+ vpaddd %ymm3,%ymm10,%ymm10 -+ vpxor %ymm5,%ymm10,%ymm5 -+ vpshufb %ymm15,%ymm5,%ymm5 -+ vpaddd %ymm0,%ymm11,%ymm11 -+ vpxor %ymm6,%ymm11,%ymm6 -+ vpshufb %ymm15,%ymm6,%ymm6 -+ vpaddd %ymm5,%ymm12,%ymm12 -+ vpxor %ymm3,%ymm12,%ymm3 -+ vpslld $12,%ymm3,%ymm14 -+ vpsrld $20,%ymm3,%ymm3 -+ vpor %ymm3,%ymm14,%ymm3 -+ vbroadcasti128 (%r11),%ymm14 -+ vpaddd %ymm6,%ymm13,%ymm13 -+ vpxor %ymm0,%ymm13,%ymm0 -+ vpslld $12,%ymm0,%ymm15 -+ vpsrld $20,%ymm0,%ymm0 -+ vpor %ymm0,%ymm15,%ymm0 -+ vpaddd %ymm3,%ymm10,%ymm10 -+ vpxor %ymm5,%ymm10,%ymm5 -+ vpshufb %ymm14,%ymm5,%ymm5 -+ vpaddd %ymm0,%ymm11,%ymm11 -+ vpxor %ymm6,%ymm11,%ymm6 -+ vpshufb %ymm14,%ymm6,%ymm6 -+ vpaddd %ymm5,%ymm12,%ymm12 -+ vpxor %ymm3,%ymm12,%ymm3 -+ vpslld $7,%ymm3,%ymm15 -+ vpsrld $25,%ymm3,%ymm3 -+ vpor %ymm3,%ymm15,%ymm3 -+ vbroadcasti128 (%r9),%ymm15 -+ vpaddd %ymm6,%ymm13,%ymm13 -+ vpxor %ymm0,%ymm13,%ymm0 -+ vpslld $7,%ymm0,%ymm14 -+ vpsrld $25,%ymm0,%ymm0 -+ vpor %ymm0,%ymm14,%ymm0 -+ decl %eax -+ jnz .Loop8x -+ -+ leaq 512(%rsp),%rax -+ vpaddd 128-256(%rcx),%ymm8,%ymm8 -+ vpaddd 160-256(%rcx),%ymm9,%ymm9 -+ vpaddd 192-256(%rcx),%ymm10,%ymm10 -+ vpaddd 224-256(%rcx),%ymm11,%ymm11 -+ -+ vpunpckldq %ymm9,%ymm8,%ymm14 -+ vpunpckldq %ymm11,%ymm10,%ymm15 -+ vpunpckhdq %ymm9,%ymm8,%ymm8 -+ vpunpckhdq %ymm11,%ymm10,%ymm10 -+ vpunpcklqdq %ymm15,%ymm14,%ymm9 -+ vpunpckhqdq %ymm15,%ymm14,%ymm14 -+ vpunpcklqdq %ymm10,%ymm8,%ymm11 -+ vpunpckhqdq %ymm10,%ymm8,%ymm8 -+ vpaddd 256-256(%rcx),%ymm0,%ymm0 -+ vpaddd 288-256(%rcx),%ymm1,%ymm1 -+ vpaddd 320-256(%rcx),%ymm2,%ymm2 -+ vpaddd 352-256(%rcx),%ymm3,%ymm3 -+ -+ vpunpckldq %ymm1,%ymm0,%ymm10 -+ vpunpckldq %ymm3,%ymm2,%ymm15 -+ vpunpckhdq %ymm1,%ymm0,%ymm0 -+ vpunpckhdq %ymm3,%ymm2,%ymm2 -+ vpunpcklqdq %ymm15,%ymm10,%ymm1 -+ vpunpckhqdq %ymm15,%ymm10,%ymm10 -+ vpunpcklqdq %ymm2,%ymm0,%ymm3 -+ vpunpckhqdq %ymm2,%ymm0,%ymm0 -+ vperm2i128 $0x20,%ymm1,%ymm9,%ymm15 -+ vperm2i128 $0x31,%ymm1,%ymm9,%ymm1 -+ vperm2i128 $0x20,%ymm10,%ymm14,%ymm9 -+ vperm2i128 $0x31,%ymm10,%ymm14,%ymm10 -+ vperm2i128 $0x20,%ymm3,%ymm11,%ymm14 -+ vperm2i128 $0x31,%ymm3,%ymm11,%ymm3 -+ vperm2i128 $0x20,%ymm0,%ymm8,%ymm11 -+ vperm2i128 $0x31,%ymm0,%ymm8,%ymm0 -+ vmovdqa %ymm15,0(%rsp) -+ vmovdqa %ymm9,32(%rsp) -+ vmovdqa 64(%rsp),%ymm15 -+ vmovdqa 96(%rsp),%ymm9 -+ -+ vpaddd 384-512(%rax),%ymm12,%ymm12 -+ vpaddd 416-512(%rax),%ymm13,%ymm13 -+ vpaddd 448-512(%rax),%ymm15,%ymm15 -+ vpaddd 480-512(%rax),%ymm9,%ymm9 -+ -+ vpunpckldq %ymm13,%ymm12,%ymm2 -+ vpunpckldq %ymm9,%ymm15,%ymm8 -+ vpunpckhdq %ymm13,%ymm12,%ymm12 -+ vpunpckhdq %ymm9,%ymm15,%ymm15 -+ vpunpcklqdq %ymm8,%ymm2,%ymm13 -+ vpunpckhqdq %ymm8,%ymm2,%ymm2 -+ vpunpcklqdq %ymm15,%ymm12,%ymm9 -+ vpunpckhqdq %ymm15,%ymm12,%ymm12 -+ vpaddd 512-512(%rax),%ymm4,%ymm4 -+ vpaddd 544-512(%rax),%ymm5,%ymm5 -+ vpaddd 576-512(%rax),%ymm6,%ymm6 -+ vpaddd 608-512(%rax),%ymm7,%ymm7 -+ -+ vpunpckldq %ymm5,%ymm4,%ymm15 -+ vpunpckldq %ymm7,%ymm6,%ymm8 -+ vpunpckhdq %ymm5,%ymm4,%ymm4 -+ vpunpckhdq %ymm7,%ymm6,%ymm6 -+ vpunpcklqdq %ymm8,%ymm15,%ymm5 -+ vpunpckhqdq %ymm8,%ymm15,%ymm15 -+ vpunpcklqdq %ymm6,%ymm4,%ymm7 -+ vpunpckhqdq %ymm6,%ymm4,%ymm4 -+ vperm2i128 $0x20,%ymm5,%ymm13,%ymm8 -+ vperm2i128 $0x31,%ymm5,%ymm13,%ymm5 -+ vperm2i128 $0x20,%ymm15,%ymm2,%ymm13 -+ vperm2i128 $0x31,%ymm15,%ymm2,%ymm15 -+ vperm2i128 $0x20,%ymm7,%ymm9,%ymm2 -+ vperm2i128 $0x31,%ymm7,%ymm9,%ymm7 -+ vperm2i128 $0x20,%ymm4,%ymm12,%ymm9 -+ vperm2i128 $0x31,%ymm4,%ymm12,%ymm4 -+ vmovdqa 0(%rsp),%ymm6 -+ vmovdqa 32(%rsp),%ymm12 -+ -+ cmpq $512,%rdx -+ jb .Ltail8x -+ -+ vpxor 0(%rsi),%ymm6,%ymm6 -+ vpxor 32(%rsi),%ymm8,%ymm8 -+ vpxor 64(%rsi),%ymm1,%ymm1 -+ vpxor 96(%rsi),%ymm5,%ymm5 -+ leaq 128(%rsi),%rsi -+ vmovdqu %ymm6,0(%rdi) -+ vmovdqu %ymm8,32(%rdi) -+ vmovdqu %ymm1,64(%rdi) -+ vmovdqu %ymm5,96(%rdi) -+ leaq 128(%rdi),%rdi -+ -+ vpxor 0(%rsi),%ymm12,%ymm12 -+ vpxor 32(%rsi),%ymm13,%ymm13 -+ vpxor 64(%rsi),%ymm10,%ymm10 -+ vpxor 96(%rsi),%ymm15,%ymm15 -+ leaq 128(%rsi),%rsi -+ vmovdqu %ymm12,0(%rdi) -+ vmovdqu %ymm13,32(%rdi) -+ vmovdqu %ymm10,64(%rdi) -+ vmovdqu %ymm15,96(%rdi) -+ leaq 128(%rdi),%rdi -+ -+ vpxor 0(%rsi),%ymm14,%ymm14 -+ vpxor 32(%rsi),%ymm2,%ymm2 -+ vpxor 64(%rsi),%ymm3,%ymm3 -+ vpxor 96(%rsi),%ymm7,%ymm7 -+ leaq 128(%rsi),%rsi -+ vmovdqu %ymm14,0(%rdi) -+ vmovdqu %ymm2,32(%rdi) -+ vmovdqu %ymm3,64(%rdi) -+ vmovdqu %ymm7,96(%rdi) -+ leaq 128(%rdi),%rdi -+ -+ vpxor 0(%rsi),%ymm11,%ymm11 -+ vpxor 32(%rsi),%ymm9,%ymm9 -+ vpxor 64(%rsi),%ymm0,%ymm0 -+ vpxor 96(%rsi),%ymm4,%ymm4 -+ leaq 128(%rsi),%rsi -+ vmovdqu %ymm11,0(%rdi) -+ vmovdqu %ymm9,32(%rdi) -+ vmovdqu %ymm0,64(%rdi) -+ vmovdqu %ymm4,96(%rdi) -+ leaq 128(%rdi),%rdi -+ -+ subq $512,%rdx -+ jnz .Loop_outer8x -+ -+ jmp .Ldone8x -+ -+.Ltail8x: -+ cmpq $448,%rdx -+ jae .L448_or_more8x -+ cmpq $384,%rdx -+ jae .L384_or_more8x -+ cmpq $320,%rdx -+ jae .L320_or_more8x -+ cmpq $256,%rdx -+ jae .L256_or_more8x -+ cmpq $192,%rdx -+ jae .L192_or_more8x -+ cmpq $128,%rdx -+ jae .L128_or_more8x -+ cmpq $64,%rdx -+ jae .L64_or_more8x -+ -+ xorq %r9,%r9 -+ vmovdqa %ymm6,0(%rsp) -+ vmovdqa %ymm8,32(%rsp) -+ jmp .Loop_tail8x -+ -+.align 32 -+.L64_or_more8x: -+ vpxor 0(%rsi),%ymm6,%ymm6 -+ vpxor 32(%rsi),%ymm8,%ymm8 -+ vmovdqu %ymm6,0(%rdi) -+ vmovdqu %ymm8,32(%rdi) -+ je .Ldone8x -+ -+ leaq 64(%rsi),%rsi -+ xorq %r9,%r9 -+ vmovdqa %ymm1,0(%rsp) -+ leaq 64(%rdi),%rdi -+ subq $64,%rdx -+ vmovdqa %ymm5,32(%rsp) -+ jmp .Loop_tail8x -+ -+.align 32 -+.L128_or_more8x: -+ vpxor 0(%rsi),%ymm6,%ymm6 -+ vpxor 32(%rsi),%ymm8,%ymm8 -+ vpxor 64(%rsi),%ymm1,%ymm1 -+ vpxor 96(%rsi),%ymm5,%ymm5 -+ vmovdqu %ymm6,0(%rdi) -+ vmovdqu %ymm8,32(%rdi) -+ vmovdqu %ymm1,64(%rdi) -+ vmovdqu %ymm5,96(%rdi) -+ je .Ldone8x -+ -+ leaq 128(%rsi),%rsi -+ xorq %r9,%r9 -+ vmovdqa %ymm12,0(%rsp) -+ leaq 128(%rdi),%rdi -+ subq $128,%rdx -+ vmovdqa %ymm13,32(%rsp) -+ jmp .Loop_tail8x -+ -+.align 32 -+.L192_or_more8x: -+ vpxor 0(%rsi),%ymm6,%ymm6 -+ vpxor 32(%rsi),%ymm8,%ymm8 -+ vpxor 64(%rsi),%ymm1,%ymm1 -+ vpxor 96(%rsi),%ymm5,%ymm5 -+ vpxor 128(%rsi),%ymm12,%ymm12 -+ vpxor 160(%rsi),%ymm13,%ymm13 -+ vmovdqu %ymm6,0(%rdi) -+ vmovdqu %ymm8,32(%rdi) -+ vmovdqu %ymm1,64(%rdi) -+ vmovdqu %ymm5,96(%rdi) -+ vmovdqu %ymm12,128(%rdi) -+ vmovdqu %ymm13,160(%rdi) -+ je .Ldone8x -+ -+ leaq 192(%rsi),%rsi -+ xorq %r9,%r9 -+ vmovdqa %ymm10,0(%rsp) -+ leaq 192(%rdi),%rdi -+ subq $192,%rdx -+ vmovdqa %ymm15,32(%rsp) -+ jmp .Loop_tail8x -+ -+.align 32 -+.L256_or_more8x: -+ vpxor 0(%rsi),%ymm6,%ymm6 -+ vpxor 32(%rsi),%ymm8,%ymm8 -+ vpxor 64(%rsi),%ymm1,%ymm1 -+ vpxor 96(%rsi),%ymm5,%ymm5 -+ vpxor 128(%rsi),%ymm12,%ymm12 -+ vpxor 160(%rsi),%ymm13,%ymm13 -+ vpxor 192(%rsi),%ymm10,%ymm10 -+ vpxor 224(%rsi),%ymm15,%ymm15 -+ vmovdqu %ymm6,0(%rdi) -+ vmovdqu %ymm8,32(%rdi) -+ vmovdqu %ymm1,64(%rdi) -+ vmovdqu %ymm5,96(%rdi) -+ vmovdqu %ymm12,128(%rdi) -+ vmovdqu %ymm13,160(%rdi) -+ vmovdqu %ymm10,192(%rdi) -+ vmovdqu %ymm15,224(%rdi) -+ je .Ldone8x -+ -+ leaq 256(%rsi),%rsi -+ xorq %r9,%r9 -+ vmovdqa %ymm14,0(%rsp) -+ leaq 256(%rdi),%rdi -+ subq $256,%rdx -+ vmovdqa %ymm2,32(%rsp) -+ jmp .Loop_tail8x -+ -+.align 32 -+.L320_or_more8x: -+ vpxor 0(%rsi),%ymm6,%ymm6 -+ vpxor 32(%rsi),%ymm8,%ymm8 -+ vpxor 64(%rsi),%ymm1,%ymm1 -+ vpxor 96(%rsi),%ymm5,%ymm5 -+ vpxor 128(%rsi),%ymm12,%ymm12 -+ vpxor 160(%rsi),%ymm13,%ymm13 -+ vpxor 192(%rsi),%ymm10,%ymm10 -+ vpxor 224(%rsi),%ymm15,%ymm15 -+ vpxor 256(%rsi),%ymm14,%ymm14 -+ vpxor 288(%rsi),%ymm2,%ymm2 -+ vmovdqu %ymm6,0(%rdi) -+ vmovdqu %ymm8,32(%rdi) -+ vmovdqu %ymm1,64(%rdi) -+ vmovdqu %ymm5,96(%rdi) -+ vmovdqu %ymm12,128(%rdi) -+ vmovdqu %ymm13,160(%rdi) -+ vmovdqu %ymm10,192(%rdi) -+ vmovdqu %ymm15,224(%rdi) -+ vmovdqu %ymm14,256(%rdi) -+ vmovdqu %ymm2,288(%rdi) -+ je .Ldone8x -+ -+ leaq 320(%rsi),%rsi -+ xorq %r9,%r9 -+ vmovdqa %ymm3,0(%rsp) -+ leaq 320(%rdi),%rdi -+ subq $320,%rdx -+ vmovdqa %ymm7,32(%rsp) -+ jmp .Loop_tail8x -+ -+.align 32 -+.L384_or_more8x: -+ vpxor 0(%rsi),%ymm6,%ymm6 -+ vpxor 32(%rsi),%ymm8,%ymm8 -+ vpxor 64(%rsi),%ymm1,%ymm1 -+ vpxor 96(%rsi),%ymm5,%ymm5 -+ vpxor 128(%rsi),%ymm12,%ymm12 -+ vpxor 160(%rsi),%ymm13,%ymm13 -+ vpxor 192(%rsi),%ymm10,%ymm10 -+ vpxor 224(%rsi),%ymm15,%ymm15 -+ vpxor 256(%rsi),%ymm14,%ymm14 -+ vpxor 288(%rsi),%ymm2,%ymm2 -+ vpxor 320(%rsi),%ymm3,%ymm3 -+ vpxor 352(%rsi),%ymm7,%ymm7 -+ vmovdqu %ymm6,0(%rdi) -+ vmovdqu %ymm8,32(%rdi) -+ vmovdqu %ymm1,64(%rdi) -+ vmovdqu %ymm5,96(%rdi) -+ vmovdqu %ymm12,128(%rdi) -+ vmovdqu %ymm13,160(%rdi) -+ vmovdqu %ymm10,192(%rdi) -+ vmovdqu %ymm15,224(%rdi) -+ vmovdqu %ymm14,256(%rdi) -+ vmovdqu %ymm2,288(%rdi) -+ vmovdqu %ymm3,320(%rdi) -+ vmovdqu %ymm7,352(%rdi) -+ je .Ldone8x -+ -+ leaq 384(%rsi),%rsi -+ xorq %r9,%r9 -+ vmovdqa %ymm11,0(%rsp) -+ leaq 384(%rdi),%rdi -+ subq $384,%rdx -+ vmovdqa %ymm9,32(%rsp) -+ jmp .Loop_tail8x -+ -+.align 32 -+.L448_or_more8x: -+ vpxor 0(%rsi),%ymm6,%ymm6 -+ vpxor 32(%rsi),%ymm8,%ymm8 -+ vpxor 64(%rsi),%ymm1,%ymm1 -+ vpxor 96(%rsi),%ymm5,%ymm5 -+ vpxor 128(%rsi),%ymm12,%ymm12 -+ vpxor 160(%rsi),%ymm13,%ymm13 -+ vpxor 192(%rsi),%ymm10,%ymm10 -+ vpxor 224(%rsi),%ymm15,%ymm15 -+ vpxor 256(%rsi),%ymm14,%ymm14 -+ vpxor 288(%rsi),%ymm2,%ymm2 -+ vpxor 320(%rsi),%ymm3,%ymm3 -+ vpxor 352(%rsi),%ymm7,%ymm7 -+ vpxor 384(%rsi),%ymm11,%ymm11 -+ vpxor 416(%rsi),%ymm9,%ymm9 -+ vmovdqu %ymm6,0(%rdi) -+ vmovdqu %ymm8,32(%rdi) -+ vmovdqu %ymm1,64(%rdi) -+ vmovdqu %ymm5,96(%rdi) -+ vmovdqu %ymm12,128(%rdi) -+ vmovdqu %ymm13,160(%rdi) -+ vmovdqu %ymm10,192(%rdi) -+ vmovdqu %ymm15,224(%rdi) -+ vmovdqu %ymm14,256(%rdi) -+ vmovdqu %ymm2,288(%rdi) -+ vmovdqu %ymm3,320(%rdi) -+ vmovdqu %ymm7,352(%rdi) -+ vmovdqu %ymm11,384(%rdi) -+ vmovdqu %ymm9,416(%rdi) -+ je .Ldone8x -+ -+ leaq 448(%rsi),%rsi -+ xorq %r9,%r9 -+ vmovdqa %ymm0,0(%rsp) -+ leaq 448(%rdi),%rdi -+ subq $448,%rdx -+ vmovdqa %ymm4,32(%rsp) -+ -+.Loop_tail8x: -+ movzbl (%rsi,%r9,1),%eax -+ movzbl (%rsp,%r9,1),%ecx -+ leaq 1(%r9),%r9 -+ xorl %ecx,%eax -+ movb %al,-1(%rdi,%r9,1) -+ decq %rdx -+ jnz .Loop_tail8x -+ -+.Ldone8x: -+ vzeroall -+ leaq -8(%r10),%rsp -+ -+.L8x_epilogue: -+ ret -+ENDPROC(chacha20_avx2) -+#endif /* CONFIG_AS_AVX2 */ -+ -+#ifdef CONFIG_AS_AVX512 -+.align 32 -+ENTRY(chacha20_avx512) -+.Lchacha20_avx512: -+ cmpq $0,%rdx -+ je .Lavx512_epilogue -+ leaq 8(%rsp),%r10 -+ -+ cmpq $512,%rdx -+ ja .Lchacha20_16x -+ -+ subq $64+8,%rsp -+ andq $-64,%rsp -+ vbroadcasti32x4 .Lsigma(%rip),%zmm0 -+ vbroadcasti32x4 (%rcx),%zmm1 -+ vbroadcasti32x4 16(%rcx),%zmm2 -+ vbroadcasti32x4 (%r8),%zmm3 -+ -+ vmovdqa32 %zmm0,%zmm16 -+ vmovdqa32 %zmm1,%zmm17 -+ vmovdqa32 %zmm2,%zmm18 -+ vpaddd .Lzeroz(%rip),%zmm3,%zmm3 -+ vmovdqa32 .Lfourz(%rip),%zmm20 -+ movq $10,%r8 -+ vmovdqa32 %zmm3,%zmm19 -+ jmp .Loop_avx512 -+ -+.align 16 -+.Loop_outer_avx512: -+ vmovdqa32 %zmm16,%zmm0 -+ vmovdqa32 %zmm17,%zmm1 -+ vmovdqa32 %zmm18,%zmm2 -+ vpaddd %zmm20,%zmm19,%zmm3 -+ movq $10,%r8 -+ vmovdqa32 %zmm3,%zmm19 -+ jmp .Loop_avx512 -+ -+.align 32 -+.Loop_avx512: -+ vpaddd %zmm1,%zmm0,%zmm0 -+ vpxord %zmm0,%zmm3,%zmm3 -+ vprold $16,%zmm3,%zmm3 -+ vpaddd %zmm3,%zmm2,%zmm2 -+ vpxord %zmm2,%zmm1,%zmm1 -+ vprold $12,%zmm1,%zmm1 -+ vpaddd %zmm1,%zmm0,%zmm0 -+ vpxord %zmm0,%zmm3,%zmm3 -+ vprold $8,%zmm3,%zmm3 -+ vpaddd %zmm3,%zmm2,%zmm2 -+ vpxord %zmm2,%zmm1,%zmm1 -+ vprold $7,%zmm1,%zmm1 -+ vpshufd $78,%zmm2,%zmm2 -+ vpshufd $57,%zmm1,%zmm1 -+ vpshufd $147,%zmm3,%zmm3 -+ vpaddd %zmm1,%zmm0,%zmm0 -+ vpxord %zmm0,%zmm3,%zmm3 -+ vprold $16,%zmm3,%zmm3 -+ vpaddd %zmm3,%zmm2,%zmm2 -+ vpxord %zmm2,%zmm1,%zmm1 -+ vprold $12,%zmm1,%zmm1 -+ vpaddd %zmm1,%zmm0,%zmm0 -+ vpxord %zmm0,%zmm3,%zmm3 -+ vprold $8,%zmm3,%zmm3 -+ vpaddd %zmm3,%zmm2,%zmm2 -+ vpxord %zmm2,%zmm1,%zmm1 -+ vprold $7,%zmm1,%zmm1 -+ vpshufd $78,%zmm2,%zmm2 -+ vpshufd $147,%zmm1,%zmm1 -+ vpshufd $57,%zmm3,%zmm3 -+ decq %r8 -+ jnz .Loop_avx512 -+ vpaddd %zmm16,%zmm0,%zmm0 -+ vpaddd %zmm17,%zmm1,%zmm1 -+ vpaddd %zmm18,%zmm2,%zmm2 -+ vpaddd %zmm19,%zmm3,%zmm3 -+ -+ subq $64,%rdx -+ jb .Ltail64_avx512 -+ -+ vpxor 0(%rsi),%xmm0,%xmm4 -+ vpxor 16(%rsi),%xmm1,%xmm5 -+ vpxor 32(%rsi),%xmm2,%xmm6 -+ vpxor 48(%rsi),%xmm3,%xmm7 -+ leaq 64(%rsi),%rsi -+ -+ vmovdqu %xmm4,0(%rdi) -+ vmovdqu %xmm5,16(%rdi) -+ vmovdqu %xmm6,32(%rdi) -+ vmovdqu %xmm7,48(%rdi) -+ leaq 64(%rdi),%rdi -+ -+ jz .Ldone_avx512 -+ -+ vextracti32x4 $1,%zmm0,%xmm4 -+ vextracti32x4 $1,%zmm1,%xmm5 -+ vextracti32x4 $1,%zmm2,%xmm6 -+ vextracti32x4 $1,%zmm3,%xmm7 -+ -+ subq $64,%rdx -+ jb .Ltail_avx512 -+ -+ vpxor 0(%rsi),%xmm4,%xmm4 -+ vpxor 16(%rsi),%xmm5,%xmm5 -+ vpxor 32(%rsi),%xmm6,%xmm6 -+ vpxor 48(%rsi),%xmm7,%xmm7 -+ leaq 64(%rsi),%rsi -+ -+ vmovdqu %xmm4,0(%rdi) -+ vmovdqu %xmm5,16(%rdi) -+ vmovdqu %xmm6,32(%rdi) -+ vmovdqu %xmm7,48(%rdi) -+ leaq 64(%rdi),%rdi -+ -+ jz .Ldone_avx512 -+ -+ vextracti32x4 $2,%zmm0,%xmm4 -+ vextracti32x4 $2,%zmm1,%xmm5 -+ vextracti32x4 $2,%zmm2,%xmm6 -+ vextracti32x4 $2,%zmm3,%xmm7 -+ -+ subq $64,%rdx -+ jb .Ltail_avx512 -+ -+ vpxor 0(%rsi),%xmm4,%xmm4 -+ vpxor 16(%rsi),%xmm5,%xmm5 -+ vpxor 32(%rsi),%xmm6,%xmm6 -+ vpxor 48(%rsi),%xmm7,%xmm7 -+ leaq 64(%rsi),%rsi -+ -+ vmovdqu %xmm4,0(%rdi) -+ vmovdqu %xmm5,16(%rdi) -+ vmovdqu %xmm6,32(%rdi) -+ vmovdqu %xmm7,48(%rdi) -+ leaq 64(%rdi),%rdi -+ -+ jz .Ldone_avx512 -+ -+ vextracti32x4 $3,%zmm0,%xmm4 -+ vextracti32x4 $3,%zmm1,%xmm5 -+ vextracti32x4 $3,%zmm2,%xmm6 -+ vextracti32x4 $3,%zmm3,%xmm7 -+ -+ subq $64,%rdx -+ jb .Ltail_avx512 -+ -+ vpxor 0(%rsi),%xmm4,%xmm4 -+ vpxor 16(%rsi),%xmm5,%xmm5 -+ vpxor 32(%rsi),%xmm6,%xmm6 -+ vpxor 48(%rsi),%xmm7,%xmm7 -+ leaq 64(%rsi),%rsi -+ -+ vmovdqu %xmm4,0(%rdi) -+ vmovdqu %xmm5,16(%rdi) -+ vmovdqu %xmm6,32(%rdi) -+ vmovdqu %xmm7,48(%rdi) -+ leaq 64(%rdi),%rdi -+ -+ jnz .Loop_outer_avx512 -+ -+ jmp .Ldone_avx512 -+ -+.align 16 -+.Ltail64_avx512: -+ vmovdqa %xmm0,0(%rsp) -+ vmovdqa %xmm1,16(%rsp) -+ vmovdqa %xmm2,32(%rsp) -+ vmovdqa %xmm3,48(%rsp) -+ addq $64,%rdx -+ jmp .Loop_tail_avx512 -+ -+.align 16 -+.Ltail_avx512: -+ vmovdqa %xmm4,0(%rsp) -+ vmovdqa %xmm5,16(%rsp) -+ vmovdqa %xmm6,32(%rsp) -+ vmovdqa %xmm7,48(%rsp) -+ addq $64,%rdx -+ -+.Loop_tail_avx512: -+ movzbl (%rsi,%r8,1),%eax -+ movzbl (%rsp,%r8,1),%ecx -+ leaq 1(%r8),%r8 -+ xorl %ecx,%eax -+ movb %al,-1(%rdi,%r8,1) -+ decq %rdx -+ jnz .Loop_tail_avx512 -+ -+ vmovdqa32 %zmm16,0(%rsp) -+ -+.Ldone_avx512: -+ vzeroall -+ leaq -8(%r10),%rsp -+ -+.Lavx512_epilogue: -+ ret -+ -+.align 32 -+.Lchacha20_16x: -+ leaq 8(%rsp),%r10 -+ -+ subq $64+8,%rsp -+ andq $-64,%rsp -+ vzeroupper -+ -+ leaq .Lsigma(%rip),%r9 -+ vbroadcasti32x4 (%r9),%zmm3 -+ vbroadcasti32x4 (%rcx),%zmm7 -+ vbroadcasti32x4 16(%rcx),%zmm11 -+ vbroadcasti32x4 (%r8),%zmm15 -+ -+ vpshufd $0x00,%zmm3,%zmm0 -+ vpshufd $0x55,%zmm3,%zmm1 -+ vpshufd $0xaa,%zmm3,%zmm2 -+ vpshufd $0xff,%zmm3,%zmm3 -+ vmovdqa64 %zmm0,%zmm16 -+ vmovdqa64 %zmm1,%zmm17 -+ vmovdqa64 %zmm2,%zmm18 -+ vmovdqa64 %zmm3,%zmm19 -+ -+ vpshufd $0x00,%zmm7,%zmm4 -+ vpshufd $0x55,%zmm7,%zmm5 -+ vpshufd $0xaa,%zmm7,%zmm6 -+ vpshufd $0xff,%zmm7,%zmm7 -+ vmovdqa64 %zmm4,%zmm20 -+ vmovdqa64 %zmm5,%zmm21 -+ vmovdqa64 %zmm6,%zmm22 -+ vmovdqa64 %zmm7,%zmm23 -+ -+ vpshufd $0x00,%zmm11,%zmm8 -+ vpshufd $0x55,%zmm11,%zmm9 -+ vpshufd $0xaa,%zmm11,%zmm10 -+ vpshufd $0xff,%zmm11,%zmm11 -+ vmovdqa64 %zmm8,%zmm24 -+ vmovdqa64 %zmm9,%zmm25 -+ vmovdqa64 %zmm10,%zmm26 -+ vmovdqa64 %zmm11,%zmm27 -+ -+ vpshufd $0x00,%zmm15,%zmm12 -+ vpshufd $0x55,%zmm15,%zmm13 -+ vpshufd $0xaa,%zmm15,%zmm14 -+ vpshufd $0xff,%zmm15,%zmm15 -+ vpaddd .Lincz(%rip),%zmm12,%zmm12 -+ vmovdqa64 %zmm12,%zmm28 -+ vmovdqa64 %zmm13,%zmm29 -+ vmovdqa64 %zmm14,%zmm30 -+ vmovdqa64 %zmm15,%zmm31 -+ -+ movl $10,%eax -+ jmp .Loop16x -+ -+.align 32 -+.Loop_outer16x: -+ vpbroadcastd 0(%r9),%zmm0 -+ vpbroadcastd 4(%r9),%zmm1 -+ vpbroadcastd 8(%r9),%zmm2 -+ vpbroadcastd 12(%r9),%zmm3 -+ vpaddd .Lsixteen(%rip),%zmm28,%zmm28 -+ vmovdqa64 %zmm20,%zmm4 -+ vmovdqa64 %zmm21,%zmm5 -+ vmovdqa64 %zmm22,%zmm6 -+ vmovdqa64 %zmm23,%zmm7 -+ vmovdqa64 %zmm24,%zmm8 -+ vmovdqa64 %zmm25,%zmm9 -+ vmovdqa64 %zmm26,%zmm10 -+ vmovdqa64 %zmm27,%zmm11 -+ vmovdqa64 %zmm28,%zmm12 -+ vmovdqa64 %zmm29,%zmm13 -+ vmovdqa64 %zmm30,%zmm14 -+ vmovdqa64 %zmm31,%zmm15 -+ -+ vmovdqa64 %zmm0,%zmm16 -+ vmovdqa64 %zmm1,%zmm17 -+ vmovdqa64 %zmm2,%zmm18 -+ vmovdqa64 %zmm3,%zmm19 -+ -+ movl $10,%eax -+ jmp .Loop16x -+ -+.align 32 -+.Loop16x: -+ vpaddd %zmm4,%zmm0,%zmm0 -+ vpaddd %zmm5,%zmm1,%zmm1 -+ vpaddd %zmm6,%zmm2,%zmm2 -+ vpaddd %zmm7,%zmm3,%zmm3 -+ vpxord %zmm0,%zmm12,%zmm12 -+ vpxord %zmm1,%zmm13,%zmm13 -+ vpxord %zmm2,%zmm14,%zmm14 -+ vpxord %zmm3,%zmm15,%zmm15 -+ vprold $16,%zmm12,%zmm12 -+ vprold $16,%zmm13,%zmm13 -+ vprold $16,%zmm14,%zmm14 -+ vprold $16,%zmm15,%zmm15 -+ vpaddd %zmm12,%zmm8,%zmm8 -+ vpaddd %zmm13,%zmm9,%zmm9 -+ vpaddd %zmm14,%zmm10,%zmm10 -+ vpaddd %zmm15,%zmm11,%zmm11 -+ vpxord %zmm8,%zmm4,%zmm4 -+ vpxord %zmm9,%zmm5,%zmm5 -+ vpxord %zmm10,%zmm6,%zmm6 -+ vpxord %zmm11,%zmm7,%zmm7 -+ vprold $12,%zmm4,%zmm4 -+ vprold $12,%zmm5,%zmm5 -+ vprold $12,%zmm6,%zmm6 -+ vprold $12,%zmm7,%zmm7 -+ vpaddd %zmm4,%zmm0,%zmm0 -+ vpaddd %zmm5,%zmm1,%zmm1 -+ vpaddd %zmm6,%zmm2,%zmm2 -+ vpaddd %zmm7,%zmm3,%zmm3 -+ vpxord %zmm0,%zmm12,%zmm12 -+ vpxord %zmm1,%zmm13,%zmm13 -+ vpxord %zmm2,%zmm14,%zmm14 -+ vpxord %zmm3,%zmm15,%zmm15 -+ vprold $8,%zmm12,%zmm12 -+ vprold $8,%zmm13,%zmm13 -+ vprold $8,%zmm14,%zmm14 -+ vprold $8,%zmm15,%zmm15 -+ vpaddd %zmm12,%zmm8,%zmm8 -+ vpaddd %zmm13,%zmm9,%zmm9 -+ vpaddd %zmm14,%zmm10,%zmm10 -+ vpaddd %zmm15,%zmm11,%zmm11 -+ vpxord %zmm8,%zmm4,%zmm4 -+ vpxord %zmm9,%zmm5,%zmm5 -+ vpxord %zmm10,%zmm6,%zmm6 -+ vpxord %zmm11,%zmm7,%zmm7 -+ vprold $7,%zmm4,%zmm4 -+ vprold $7,%zmm5,%zmm5 -+ vprold $7,%zmm6,%zmm6 -+ vprold $7,%zmm7,%zmm7 -+ vpaddd %zmm5,%zmm0,%zmm0 -+ vpaddd %zmm6,%zmm1,%zmm1 -+ vpaddd %zmm7,%zmm2,%zmm2 -+ vpaddd %zmm4,%zmm3,%zmm3 -+ vpxord %zmm0,%zmm15,%zmm15 -+ vpxord %zmm1,%zmm12,%zmm12 -+ vpxord %zmm2,%zmm13,%zmm13 -+ vpxord %zmm3,%zmm14,%zmm14 -+ vprold $16,%zmm15,%zmm15 -+ vprold $16,%zmm12,%zmm12 -+ vprold $16,%zmm13,%zmm13 -+ vprold $16,%zmm14,%zmm14 -+ vpaddd %zmm15,%zmm10,%zmm10 -+ vpaddd %zmm12,%zmm11,%zmm11 -+ vpaddd %zmm13,%zmm8,%zmm8 -+ vpaddd %zmm14,%zmm9,%zmm9 -+ vpxord %zmm10,%zmm5,%zmm5 -+ vpxord %zmm11,%zmm6,%zmm6 -+ vpxord %zmm8,%zmm7,%zmm7 -+ vpxord %zmm9,%zmm4,%zmm4 -+ vprold $12,%zmm5,%zmm5 -+ vprold $12,%zmm6,%zmm6 -+ vprold $12,%zmm7,%zmm7 -+ vprold $12,%zmm4,%zmm4 -+ vpaddd %zmm5,%zmm0,%zmm0 -+ vpaddd %zmm6,%zmm1,%zmm1 -+ vpaddd %zmm7,%zmm2,%zmm2 -+ vpaddd %zmm4,%zmm3,%zmm3 -+ vpxord %zmm0,%zmm15,%zmm15 -+ vpxord %zmm1,%zmm12,%zmm12 -+ vpxord %zmm2,%zmm13,%zmm13 -+ vpxord %zmm3,%zmm14,%zmm14 -+ vprold $8,%zmm15,%zmm15 -+ vprold $8,%zmm12,%zmm12 -+ vprold $8,%zmm13,%zmm13 -+ vprold $8,%zmm14,%zmm14 -+ vpaddd %zmm15,%zmm10,%zmm10 -+ vpaddd %zmm12,%zmm11,%zmm11 -+ vpaddd %zmm13,%zmm8,%zmm8 -+ vpaddd %zmm14,%zmm9,%zmm9 -+ vpxord %zmm10,%zmm5,%zmm5 -+ vpxord %zmm11,%zmm6,%zmm6 -+ vpxord %zmm8,%zmm7,%zmm7 -+ vpxord %zmm9,%zmm4,%zmm4 -+ vprold $7,%zmm5,%zmm5 -+ vprold $7,%zmm6,%zmm6 -+ vprold $7,%zmm7,%zmm7 -+ vprold $7,%zmm4,%zmm4 -+ decl %eax -+ jnz .Loop16x -+ -+ vpaddd %zmm16,%zmm0,%zmm0 -+ vpaddd %zmm17,%zmm1,%zmm1 -+ vpaddd %zmm18,%zmm2,%zmm2 -+ vpaddd %zmm19,%zmm3,%zmm3 -+ -+ vpunpckldq %zmm1,%zmm0,%zmm18 -+ vpunpckldq %zmm3,%zmm2,%zmm19 -+ vpunpckhdq %zmm1,%zmm0,%zmm0 -+ vpunpckhdq %zmm3,%zmm2,%zmm2 -+ vpunpcklqdq %zmm19,%zmm18,%zmm1 -+ vpunpckhqdq %zmm19,%zmm18,%zmm18 -+ vpunpcklqdq %zmm2,%zmm0,%zmm3 -+ vpunpckhqdq %zmm2,%zmm0,%zmm0 -+ vpaddd %zmm20,%zmm4,%zmm4 -+ vpaddd %zmm21,%zmm5,%zmm5 -+ vpaddd %zmm22,%zmm6,%zmm6 -+ vpaddd %zmm23,%zmm7,%zmm7 -+ -+ vpunpckldq %zmm5,%zmm4,%zmm2 -+ vpunpckldq %zmm7,%zmm6,%zmm19 -+ vpunpckhdq %zmm5,%zmm4,%zmm4 -+ vpunpckhdq %zmm7,%zmm6,%zmm6 -+ vpunpcklqdq %zmm19,%zmm2,%zmm5 -+ vpunpckhqdq %zmm19,%zmm2,%zmm2 -+ vpunpcklqdq %zmm6,%zmm4,%zmm7 -+ vpunpckhqdq %zmm6,%zmm4,%zmm4 -+ vshufi32x4 $0x44,%zmm5,%zmm1,%zmm19 -+ vshufi32x4 $0xee,%zmm5,%zmm1,%zmm5 -+ vshufi32x4 $0x44,%zmm2,%zmm18,%zmm1 -+ vshufi32x4 $0xee,%zmm2,%zmm18,%zmm2 -+ vshufi32x4 $0x44,%zmm7,%zmm3,%zmm18 -+ vshufi32x4 $0xee,%zmm7,%zmm3,%zmm7 -+ vshufi32x4 $0x44,%zmm4,%zmm0,%zmm3 -+ vshufi32x4 $0xee,%zmm4,%zmm0,%zmm4 -+ vpaddd %zmm24,%zmm8,%zmm8 -+ vpaddd %zmm25,%zmm9,%zmm9 -+ vpaddd %zmm26,%zmm10,%zmm10 -+ vpaddd %zmm27,%zmm11,%zmm11 -+ -+ vpunpckldq %zmm9,%zmm8,%zmm6 -+ vpunpckldq %zmm11,%zmm10,%zmm0 -+ vpunpckhdq %zmm9,%zmm8,%zmm8 -+ vpunpckhdq %zmm11,%zmm10,%zmm10 -+ vpunpcklqdq %zmm0,%zmm6,%zmm9 -+ vpunpckhqdq %zmm0,%zmm6,%zmm6 -+ vpunpcklqdq %zmm10,%zmm8,%zmm11 -+ vpunpckhqdq %zmm10,%zmm8,%zmm8 -+ vpaddd %zmm28,%zmm12,%zmm12 -+ vpaddd %zmm29,%zmm13,%zmm13 -+ vpaddd %zmm30,%zmm14,%zmm14 -+ vpaddd %zmm31,%zmm15,%zmm15 -+ -+ vpunpckldq %zmm13,%zmm12,%zmm10 -+ vpunpckldq %zmm15,%zmm14,%zmm0 -+ vpunpckhdq %zmm13,%zmm12,%zmm12 -+ vpunpckhdq %zmm15,%zmm14,%zmm14 -+ vpunpcklqdq %zmm0,%zmm10,%zmm13 -+ vpunpckhqdq %zmm0,%zmm10,%zmm10 -+ vpunpcklqdq %zmm14,%zmm12,%zmm15 -+ vpunpckhqdq %zmm14,%zmm12,%zmm12 -+ vshufi32x4 $0x44,%zmm13,%zmm9,%zmm0 -+ vshufi32x4 $0xee,%zmm13,%zmm9,%zmm13 -+ vshufi32x4 $0x44,%zmm10,%zmm6,%zmm9 -+ vshufi32x4 $0xee,%zmm10,%zmm6,%zmm10 -+ vshufi32x4 $0x44,%zmm15,%zmm11,%zmm6 -+ vshufi32x4 $0xee,%zmm15,%zmm11,%zmm15 -+ vshufi32x4 $0x44,%zmm12,%zmm8,%zmm11 -+ vshufi32x4 $0xee,%zmm12,%zmm8,%zmm12 -+ vshufi32x4 $0x88,%zmm0,%zmm19,%zmm16 -+ vshufi32x4 $0xdd,%zmm0,%zmm19,%zmm19 -+ vshufi32x4 $0x88,%zmm13,%zmm5,%zmm0 -+ vshufi32x4 $0xdd,%zmm13,%zmm5,%zmm13 -+ vshufi32x4 $0x88,%zmm9,%zmm1,%zmm17 -+ vshufi32x4 $0xdd,%zmm9,%zmm1,%zmm1 -+ vshufi32x4 $0x88,%zmm10,%zmm2,%zmm9 -+ vshufi32x4 $0xdd,%zmm10,%zmm2,%zmm10 -+ vshufi32x4 $0x88,%zmm6,%zmm18,%zmm14 -+ vshufi32x4 $0xdd,%zmm6,%zmm18,%zmm18 -+ vshufi32x4 $0x88,%zmm15,%zmm7,%zmm6 -+ vshufi32x4 $0xdd,%zmm15,%zmm7,%zmm15 -+ vshufi32x4 $0x88,%zmm11,%zmm3,%zmm8 -+ vshufi32x4 $0xdd,%zmm11,%zmm3,%zmm3 -+ vshufi32x4 $0x88,%zmm12,%zmm4,%zmm11 -+ vshufi32x4 $0xdd,%zmm12,%zmm4,%zmm12 -+ cmpq $1024,%rdx -+ jb .Ltail16x -+ -+ vpxord 0(%rsi),%zmm16,%zmm16 -+ vpxord 64(%rsi),%zmm17,%zmm17 -+ vpxord 128(%rsi),%zmm14,%zmm14 -+ vpxord 192(%rsi),%zmm8,%zmm8 -+ vmovdqu32 %zmm16,0(%rdi) -+ vmovdqu32 %zmm17,64(%rdi) -+ vmovdqu32 %zmm14,128(%rdi) -+ vmovdqu32 %zmm8,192(%rdi) -+ -+ vpxord 256(%rsi),%zmm19,%zmm19 -+ vpxord 320(%rsi),%zmm1,%zmm1 -+ vpxord 384(%rsi),%zmm18,%zmm18 -+ vpxord 448(%rsi),%zmm3,%zmm3 -+ vmovdqu32 %zmm19,256(%rdi) -+ vmovdqu32 %zmm1,320(%rdi) -+ vmovdqu32 %zmm18,384(%rdi) -+ vmovdqu32 %zmm3,448(%rdi) -+ -+ vpxord 512(%rsi),%zmm0,%zmm0 -+ vpxord 576(%rsi),%zmm9,%zmm9 -+ vpxord 640(%rsi),%zmm6,%zmm6 -+ vpxord 704(%rsi),%zmm11,%zmm11 -+ vmovdqu32 %zmm0,512(%rdi) -+ vmovdqu32 %zmm9,576(%rdi) -+ vmovdqu32 %zmm6,640(%rdi) -+ vmovdqu32 %zmm11,704(%rdi) -+ -+ vpxord 768(%rsi),%zmm13,%zmm13 -+ vpxord 832(%rsi),%zmm10,%zmm10 -+ vpxord 896(%rsi),%zmm15,%zmm15 -+ vpxord 960(%rsi),%zmm12,%zmm12 -+ leaq 1024(%rsi),%rsi -+ vmovdqu32 %zmm13,768(%rdi) -+ vmovdqu32 %zmm10,832(%rdi) -+ vmovdqu32 %zmm15,896(%rdi) -+ vmovdqu32 %zmm12,960(%rdi) -+ leaq 1024(%rdi),%rdi -+ -+ subq $1024,%rdx -+ jnz .Loop_outer16x -+ -+ jmp .Ldone16x -+ -+.align 32 -+.Ltail16x: -+ xorq %r9,%r9 -+ subq %rsi,%rdi -+ cmpq $64,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm16,%zmm16 -+ vmovdqu32 %zmm16,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm17,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $128,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm17,%zmm17 -+ vmovdqu32 %zmm17,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm14,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $192,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm14,%zmm14 -+ vmovdqu32 %zmm14,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm8,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $256,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm8,%zmm8 -+ vmovdqu32 %zmm8,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm19,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $320,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm19,%zmm19 -+ vmovdqu32 %zmm19,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm1,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $384,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm1,%zmm1 -+ vmovdqu32 %zmm1,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm18,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $448,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm18,%zmm18 -+ vmovdqu32 %zmm18,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm3,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $512,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm3,%zmm3 -+ vmovdqu32 %zmm3,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm0,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $576,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm0,%zmm0 -+ vmovdqu32 %zmm0,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm9,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $640,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm9,%zmm9 -+ vmovdqu32 %zmm9,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm6,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $704,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm6,%zmm6 -+ vmovdqu32 %zmm6,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm11,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $768,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm11,%zmm11 -+ vmovdqu32 %zmm11,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm13,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $832,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm13,%zmm13 -+ vmovdqu32 %zmm13,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm10,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $896,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm10,%zmm10 -+ vmovdqu32 %zmm10,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm15,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $960,%rdx -+ jb .Less_than_64_16x -+ vpxord (%rsi),%zmm15,%zmm15 -+ vmovdqu32 %zmm15,(%rdi,%rsi,1) -+ je .Ldone16x -+ vmovdqa32 %zmm12,%zmm16 -+ leaq 64(%rsi),%rsi -+ -+.Less_than_64_16x: -+ vmovdqa32 %zmm16,0(%rsp) -+ leaq (%rdi,%rsi,1),%rdi -+ andq $63,%rdx -+ -+.Loop_tail16x: -+ movzbl (%rsi,%r9,1),%eax -+ movzbl (%rsp,%r9,1),%ecx -+ leaq 1(%r9),%r9 -+ xorl %ecx,%eax -+ movb %al,-1(%rdi,%r9,1) -+ decq %rdx -+ jnz .Loop_tail16x -+ -+ vpxord %zmm16,%zmm16,%zmm16 -+ vmovdqa32 %zmm16,0(%rsp) -+ -+.Ldone16x: -+ vzeroall -+ leaq -8(%r10),%rsp -+ -+.L16x_epilogue: -+ ret -+ENDPROC(chacha20_avx512) -+ -+.align 32 -+ENTRY(chacha20_avx512vl) -+ cmpq $0,%rdx -+ je .Lavx512vl_epilogue -+ -+ leaq 8(%rsp),%r10 -+ -+ cmpq $128,%rdx -+ ja .Lchacha20_8xvl -+ -+ subq $64+8,%rsp -+ andq $-64,%rsp -+ vbroadcasti128 .Lsigma(%rip),%ymm0 -+ vbroadcasti128 (%rcx),%ymm1 -+ vbroadcasti128 16(%rcx),%ymm2 -+ vbroadcasti128 (%r8),%ymm3 -+ -+ vmovdqa32 %ymm0,%ymm16 -+ vmovdqa32 %ymm1,%ymm17 -+ vmovdqa32 %ymm2,%ymm18 -+ vpaddd .Lzeroz(%rip),%ymm3,%ymm3 -+ vmovdqa32 .Ltwoy(%rip),%ymm20 -+ movq $10,%r8 -+ vmovdqa32 %ymm3,%ymm19 -+ jmp .Loop_avx512vl -+ -+.align 16 -+.Loop_outer_avx512vl: -+ vmovdqa32 %ymm18,%ymm2 -+ vpaddd %ymm20,%ymm19,%ymm3 -+ movq $10,%r8 -+ vmovdqa32 %ymm3,%ymm19 -+ jmp .Loop_avx512vl -+ -+.align 32 -+.Loop_avx512vl: -+ vpaddd %ymm1,%ymm0,%ymm0 -+ vpxor %ymm0,%ymm3,%ymm3 -+ vprold $16,%ymm3,%ymm3 -+ vpaddd %ymm3,%ymm2,%ymm2 -+ vpxor %ymm2,%ymm1,%ymm1 -+ vprold $12,%ymm1,%ymm1 -+ vpaddd %ymm1,%ymm0,%ymm0 -+ vpxor %ymm0,%ymm3,%ymm3 -+ vprold $8,%ymm3,%ymm3 -+ vpaddd %ymm3,%ymm2,%ymm2 -+ vpxor %ymm2,%ymm1,%ymm1 -+ vprold $7,%ymm1,%ymm1 -+ vpshufd $78,%ymm2,%ymm2 -+ vpshufd $57,%ymm1,%ymm1 -+ vpshufd $147,%ymm3,%ymm3 -+ vpaddd %ymm1,%ymm0,%ymm0 -+ vpxor %ymm0,%ymm3,%ymm3 -+ vprold $16,%ymm3,%ymm3 -+ vpaddd %ymm3,%ymm2,%ymm2 -+ vpxor %ymm2,%ymm1,%ymm1 -+ vprold $12,%ymm1,%ymm1 -+ vpaddd %ymm1,%ymm0,%ymm0 -+ vpxor %ymm0,%ymm3,%ymm3 -+ vprold $8,%ymm3,%ymm3 -+ vpaddd %ymm3,%ymm2,%ymm2 -+ vpxor %ymm2,%ymm1,%ymm1 -+ vprold $7,%ymm1,%ymm1 -+ vpshufd $78,%ymm2,%ymm2 -+ vpshufd $147,%ymm1,%ymm1 -+ vpshufd $57,%ymm3,%ymm3 -+ decq %r8 -+ jnz .Loop_avx512vl -+ vpaddd %ymm16,%ymm0,%ymm0 -+ vpaddd %ymm17,%ymm1,%ymm1 -+ vpaddd %ymm18,%ymm2,%ymm2 -+ vpaddd %ymm19,%ymm3,%ymm3 -+ -+ subq $64,%rdx -+ jb .Ltail64_avx512vl -+ -+ vpxor 0(%rsi),%xmm0,%xmm4 -+ vpxor 16(%rsi),%xmm1,%xmm5 -+ vpxor 32(%rsi),%xmm2,%xmm6 -+ vpxor 48(%rsi),%xmm3,%xmm7 -+ leaq 64(%rsi),%rsi -+ -+ vmovdqu %xmm4,0(%rdi) -+ vmovdqu %xmm5,16(%rdi) -+ vmovdqu %xmm6,32(%rdi) -+ vmovdqu %xmm7,48(%rdi) -+ leaq 64(%rdi),%rdi -+ -+ jz .Ldone_avx512vl -+ -+ vextracti128 $1,%ymm0,%xmm4 -+ vextracti128 $1,%ymm1,%xmm5 -+ vextracti128 $1,%ymm2,%xmm6 -+ vextracti128 $1,%ymm3,%xmm7 -+ -+ subq $64,%rdx -+ jb .Ltail_avx512vl -+ -+ vpxor 0(%rsi),%xmm4,%xmm4 -+ vpxor 16(%rsi),%xmm5,%xmm5 -+ vpxor 32(%rsi),%xmm6,%xmm6 -+ vpxor 48(%rsi),%xmm7,%xmm7 -+ leaq 64(%rsi),%rsi -+ -+ vmovdqu %xmm4,0(%rdi) -+ vmovdqu %xmm5,16(%rdi) -+ vmovdqu %xmm6,32(%rdi) -+ vmovdqu %xmm7,48(%rdi) -+ leaq 64(%rdi),%rdi -+ -+ vmovdqa32 %ymm16,%ymm0 -+ vmovdqa32 %ymm17,%ymm1 -+ jnz .Loop_outer_avx512vl -+ -+ jmp .Ldone_avx512vl -+ -+.align 16 -+.Ltail64_avx512vl: -+ vmovdqa %xmm0,0(%rsp) -+ vmovdqa %xmm1,16(%rsp) -+ vmovdqa %xmm2,32(%rsp) -+ vmovdqa %xmm3,48(%rsp) -+ addq $64,%rdx -+ jmp .Loop_tail_avx512vl -+ -+.align 16 -+.Ltail_avx512vl: -+ vmovdqa %xmm4,0(%rsp) -+ vmovdqa %xmm5,16(%rsp) -+ vmovdqa %xmm6,32(%rsp) -+ vmovdqa %xmm7,48(%rsp) -+ addq $64,%rdx -+ -+.Loop_tail_avx512vl: -+ movzbl (%rsi,%r8,1),%eax -+ movzbl (%rsp,%r8,1),%ecx -+ leaq 1(%r8),%r8 -+ xorl %ecx,%eax -+ movb %al,-1(%rdi,%r8,1) -+ decq %rdx -+ jnz .Loop_tail_avx512vl -+ -+ vmovdqa32 %ymm16,0(%rsp) -+ vmovdqa32 %ymm16,32(%rsp) -+ -+.Ldone_avx512vl: -+ vzeroall -+ leaq -8(%r10),%rsp -+.Lavx512vl_epilogue: -+ ret -+ -+.align 32 -+.Lchacha20_8xvl: -+ leaq 8(%rsp),%r10 -+ subq $64+8,%rsp -+ andq $-64,%rsp -+ vzeroupper -+ -+ leaq .Lsigma(%rip),%r9 -+ vbroadcasti128 (%r9),%ymm3 -+ vbroadcasti128 (%rcx),%ymm7 -+ vbroadcasti128 16(%rcx),%ymm11 -+ vbroadcasti128 (%r8),%ymm15 -+ -+ vpshufd $0x00,%ymm3,%ymm0 -+ vpshufd $0x55,%ymm3,%ymm1 -+ vpshufd $0xaa,%ymm3,%ymm2 -+ vpshufd $0xff,%ymm3,%ymm3 -+ vmovdqa64 %ymm0,%ymm16 -+ vmovdqa64 %ymm1,%ymm17 -+ vmovdqa64 %ymm2,%ymm18 -+ vmovdqa64 %ymm3,%ymm19 -+ -+ vpshufd $0x00,%ymm7,%ymm4 -+ vpshufd $0x55,%ymm7,%ymm5 -+ vpshufd $0xaa,%ymm7,%ymm6 -+ vpshufd $0xff,%ymm7,%ymm7 -+ vmovdqa64 %ymm4,%ymm20 -+ vmovdqa64 %ymm5,%ymm21 -+ vmovdqa64 %ymm6,%ymm22 -+ vmovdqa64 %ymm7,%ymm23 -+ -+ vpshufd $0x00,%ymm11,%ymm8 -+ vpshufd $0x55,%ymm11,%ymm9 -+ vpshufd $0xaa,%ymm11,%ymm10 -+ vpshufd $0xff,%ymm11,%ymm11 -+ vmovdqa64 %ymm8,%ymm24 -+ vmovdqa64 %ymm9,%ymm25 -+ vmovdqa64 %ymm10,%ymm26 -+ vmovdqa64 %ymm11,%ymm27 -+ -+ vpshufd $0x00,%ymm15,%ymm12 -+ vpshufd $0x55,%ymm15,%ymm13 -+ vpshufd $0xaa,%ymm15,%ymm14 -+ vpshufd $0xff,%ymm15,%ymm15 -+ vpaddd .Lincy(%rip),%ymm12,%ymm12 -+ vmovdqa64 %ymm12,%ymm28 -+ vmovdqa64 %ymm13,%ymm29 -+ vmovdqa64 %ymm14,%ymm30 -+ vmovdqa64 %ymm15,%ymm31 -+ -+ movl $10,%eax -+ jmp .Loop8xvl -+ -+.align 32 -+.Loop_outer8xvl: -+ -+ -+ vpbroadcastd 8(%r9),%ymm2 -+ vpbroadcastd 12(%r9),%ymm3 -+ vpaddd .Leight(%rip),%ymm28,%ymm28 -+ vmovdqa64 %ymm20,%ymm4 -+ vmovdqa64 %ymm21,%ymm5 -+ vmovdqa64 %ymm22,%ymm6 -+ vmovdqa64 %ymm23,%ymm7 -+ vmovdqa64 %ymm24,%ymm8 -+ vmovdqa64 %ymm25,%ymm9 -+ vmovdqa64 %ymm26,%ymm10 -+ vmovdqa64 %ymm27,%ymm11 -+ vmovdqa64 %ymm28,%ymm12 -+ vmovdqa64 %ymm29,%ymm13 -+ vmovdqa64 %ymm30,%ymm14 -+ vmovdqa64 %ymm31,%ymm15 -+ -+ vmovdqa64 %ymm0,%ymm16 -+ vmovdqa64 %ymm1,%ymm17 -+ vmovdqa64 %ymm2,%ymm18 -+ vmovdqa64 %ymm3,%ymm19 -+ -+ movl $10,%eax -+ jmp .Loop8xvl -+ -+.align 32 -+.Loop8xvl: -+ vpaddd %ymm4,%ymm0,%ymm0 -+ vpaddd %ymm5,%ymm1,%ymm1 -+ vpaddd %ymm6,%ymm2,%ymm2 -+ vpaddd %ymm7,%ymm3,%ymm3 -+ vpxor %ymm0,%ymm12,%ymm12 -+ vpxor %ymm1,%ymm13,%ymm13 -+ vpxor %ymm2,%ymm14,%ymm14 -+ vpxor %ymm3,%ymm15,%ymm15 -+ vprold $16,%ymm12,%ymm12 -+ vprold $16,%ymm13,%ymm13 -+ vprold $16,%ymm14,%ymm14 -+ vprold $16,%ymm15,%ymm15 -+ vpaddd %ymm12,%ymm8,%ymm8 -+ vpaddd %ymm13,%ymm9,%ymm9 -+ vpaddd %ymm14,%ymm10,%ymm10 -+ vpaddd %ymm15,%ymm11,%ymm11 -+ vpxor %ymm8,%ymm4,%ymm4 -+ vpxor %ymm9,%ymm5,%ymm5 -+ vpxor %ymm10,%ymm6,%ymm6 -+ vpxor %ymm11,%ymm7,%ymm7 -+ vprold $12,%ymm4,%ymm4 -+ vprold $12,%ymm5,%ymm5 -+ vprold $12,%ymm6,%ymm6 -+ vprold $12,%ymm7,%ymm7 -+ vpaddd %ymm4,%ymm0,%ymm0 -+ vpaddd %ymm5,%ymm1,%ymm1 -+ vpaddd %ymm6,%ymm2,%ymm2 -+ vpaddd %ymm7,%ymm3,%ymm3 -+ vpxor %ymm0,%ymm12,%ymm12 -+ vpxor %ymm1,%ymm13,%ymm13 -+ vpxor %ymm2,%ymm14,%ymm14 -+ vpxor %ymm3,%ymm15,%ymm15 -+ vprold $8,%ymm12,%ymm12 -+ vprold $8,%ymm13,%ymm13 -+ vprold $8,%ymm14,%ymm14 -+ vprold $8,%ymm15,%ymm15 -+ vpaddd %ymm12,%ymm8,%ymm8 -+ vpaddd %ymm13,%ymm9,%ymm9 -+ vpaddd %ymm14,%ymm10,%ymm10 -+ vpaddd %ymm15,%ymm11,%ymm11 -+ vpxor %ymm8,%ymm4,%ymm4 -+ vpxor %ymm9,%ymm5,%ymm5 -+ vpxor %ymm10,%ymm6,%ymm6 -+ vpxor %ymm11,%ymm7,%ymm7 -+ vprold $7,%ymm4,%ymm4 -+ vprold $7,%ymm5,%ymm5 -+ vprold $7,%ymm6,%ymm6 -+ vprold $7,%ymm7,%ymm7 -+ vpaddd %ymm5,%ymm0,%ymm0 -+ vpaddd %ymm6,%ymm1,%ymm1 -+ vpaddd %ymm7,%ymm2,%ymm2 -+ vpaddd %ymm4,%ymm3,%ymm3 -+ vpxor %ymm0,%ymm15,%ymm15 -+ vpxor %ymm1,%ymm12,%ymm12 -+ vpxor %ymm2,%ymm13,%ymm13 -+ vpxor %ymm3,%ymm14,%ymm14 -+ vprold $16,%ymm15,%ymm15 -+ vprold $16,%ymm12,%ymm12 -+ vprold $16,%ymm13,%ymm13 -+ vprold $16,%ymm14,%ymm14 -+ vpaddd %ymm15,%ymm10,%ymm10 -+ vpaddd %ymm12,%ymm11,%ymm11 -+ vpaddd %ymm13,%ymm8,%ymm8 -+ vpaddd %ymm14,%ymm9,%ymm9 -+ vpxor %ymm10,%ymm5,%ymm5 -+ vpxor %ymm11,%ymm6,%ymm6 -+ vpxor %ymm8,%ymm7,%ymm7 -+ vpxor %ymm9,%ymm4,%ymm4 -+ vprold $12,%ymm5,%ymm5 -+ vprold $12,%ymm6,%ymm6 -+ vprold $12,%ymm7,%ymm7 -+ vprold $12,%ymm4,%ymm4 -+ vpaddd %ymm5,%ymm0,%ymm0 -+ vpaddd %ymm6,%ymm1,%ymm1 -+ vpaddd %ymm7,%ymm2,%ymm2 -+ vpaddd %ymm4,%ymm3,%ymm3 -+ vpxor %ymm0,%ymm15,%ymm15 -+ vpxor %ymm1,%ymm12,%ymm12 -+ vpxor %ymm2,%ymm13,%ymm13 -+ vpxor %ymm3,%ymm14,%ymm14 -+ vprold $8,%ymm15,%ymm15 -+ vprold $8,%ymm12,%ymm12 -+ vprold $8,%ymm13,%ymm13 -+ vprold $8,%ymm14,%ymm14 -+ vpaddd %ymm15,%ymm10,%ymm10 -+ vpaddd %ymm12,%ymm11,%ymm11 -+ vpaddd %ymm13,%ymm8,%ymm8 -+ vpaddd %ymm14,%ymm9,%ymm9 -+ vpxor %ymm10,%ymm5,%ymm5 -+ vpxor %ymm11,%ymm6,%ymm6 -+ vpxor %ymm8,%ymm7,%ymm7 -+ vpxor %ymm9,%ymm4,%ymm4 -+ vprold $7,%ymm5,%ymm5 -+ vprold $7,%ymm6,%ymm6 -+ vprold $7,%ymm7,%ymm7 -+ vprold $7,%ymm4,%ymm4 -+ decl %eax -+ jnz .Loop8xvl -+ -+ vpaddd %ymm16,%ymm0,%ymm0 -+ vpaddd %ymm17,%ymm1,%ymm1 -+ vpaddd %ymm18,%ymm2,%ymm2 -+ vpaddd %ymm19,%ymm3,%ymm3 -+ -+ vpunpckldq %ymm1,%ymm0,%ymm18 -+ vpunpckldq %ymm3,%ymm2,%ymm19 -+ vpunpckhdq %ymm1,%ymm0,%ymm0 -+ vpunpckhdq %ymm3,%ymm2,%ymm2 -+ vpunpcklqdq %ymm19,%ymm18,%ymm1 -+ vpunpckhqdq %ymm19,%ymm18,%ymm18 -+ vpunpcklqdq %ymm2,%ymm0,%ymm3 -+ vpunpckhqdq %ymm2,%ymm0,%ymm0 -+ vpaddd %ymm20,%ymm4,%ymm4 -+ vpaddd %ymm21,%ymm5,%ymm5 -+ vpaddd %ymm22,%ymm6,%ymm6 -+ vpaddd %ymm23,%ymm7,%ymm7 -+ -+ vpunpckldq %ymm5,%ymm4,%ymm2 -+ vpunpckldq %ymm7,%ymm6,%ymm19 -+ vpunpckhdq %ymm5,%ymm4,%ymm4 -+ vpunpckhdq %ymm7,%ymm6,%ymm6 -+ vpunpcklqdq %ymm19,%ymm2,%ymm5 -+ vpunpckhqdq %ymm19,%ymm2,%ymm2 -+ vpunpcklqdq %ymm6,%ymm4,%ymm7 -+ vpunpckhqdq %ymm6,%ymm4,%ymm4 -+ vshufi32x4 $0,%ymm5,%ymm1,%ymm19 -+ vshufi32x4 $3,%ymm5,%ymm1,%ymm5 -+ vshufi32x4 $0,%ymm2,%ymm18,%ymm1 -+ vshufi32x4 $3,%ymm2,%ymm18,%ymm2 -+ vshufi32x4 $0,%ymm7,%ymm3,%ymm18 -+ vshufi32x4 $3,%ymm7,%ymm3,%ymm7 -+ vshufi32x4 $0,%ymm4,%ymm0,%ymm3 -+ vshufi32x4 $3,%ymm4,%ymm0,%ymm4 -+ vpaddd %ymm24,%ymm8,%ymm8 -+ vpaddd %ymm25,%ymm9,%ymm9 -+ vpaddd %ymm26,%ymm10,%ymm10 -+ vpaddd %ymm27,%ymm11,%ymm11 -+ -+ vpunpckldq %ymm9,%ymm8,%ymm6 -+ vpunpckldq %ymm11,%ymm10,%ymm0 -+ vpunpckhdq %ymm9,%ymm8,%ymm8 -+ vpunpckhdq %ymm11,%ymm10,%ymm10 -+ vpunpcklqdq %ymm0,%ymm6,%ymm9 -+ vpunpckhqdq %ymm0,%ymm6,%ymm6 -+ vpunpcklqdq %ymm10,%ymm8,%ymm11 -+ vpunpckhqdq %ymm10,%ymm8,%ymm8 -+ vpaddd %ymm28,%ymm12,%ymm12 -+ vpaddd %ymm29,%ymm13,%ymm13 -+ vpaddd %ymm30,%ymm14,%ymm14 -+ vpaddd %ymm31,%ymm15,%ymm15 -+ -+ vpunpckldq %ymm13,%ymm12,%ymm10 -+ vpunpckldq %ymm15,%ymm14,%ymm0 -+ vpunpckhdq %ymm13,%ymm12,%ymm12 -+ vpunpckhdq %ymm15,%ymm14,%ymm14 -+ vpunpcklqdq %ymm0,%ymm10,%ymm13 -+ vpunpckhqdq %ymm0,%ymm10,%ymm10 -+ vpunpcklqdq %ymm14,%ymm12,%ymm15 -+ vpunpckhqdq %ymm14,%ymm12,%ymm12 -+ vperm2i128 $0x20,%ymm13,%ymm9,%ymm0 -+ vperm2i128 $0x31,%ymm13,%ymm9,%ymm13 -+ vperm2i128 $0x20,%ymm10,%ymm6,%ymm9 -+ vperm2i128 $0x31,%ymm10,%ymm6,%ymm10 -+ vperm2i128 $0x20,%ymm15,%ymm11,%ymm6 -+ vperm2i128 $0x31,%ymm15,%ymm11,%ymm15 -+ vperm2i128 $0x20,%ymm12,%ymm8,%ymm11 -+ vperm2i128 $0x31,%ymm12,%ymm8,%ymm12 -+ cmpq $512,%rdx -+ jb .Ltail8xvl -+ -+ movl $0x80,%eax -+ vpxord 0(%rsi),%ymm19,%ymm19 -+ vpxor 32(%rsi),%ymm0,%ymm0 -+ vpxor 64(%rsi),%ymm5,%ymm5 -+ vpxor 96(%rsi),%ymm13,%ymm13 -+ leaq (%rsi,%rax,1),%rsi -+ vmovdqu32 %ymm19,0(%rdi) -+ vmovdqu %ymm0,32(%rdi) -+ vmovdqu %ymm5,64(%rdi) -+ vmovdqu %ymm13,96(%rdi) -+ leaq (%rdi,%rax,1),%rdi -+ -+ vpxor 0(%rsi),%ymm1,%ymm1 -+ vpxor 32(%rsi),%ymm9,%ymm9 -+ vpxor 64(%rsi),%ymm2,%ymm2 -+ vpxor 96(%rsi),%ymm10,%ymm10 -+ leaq (%rsi,%rax,1),%rsi -+ vmovdqu %ymm1,0(%rdi) -+ vmovdqu %ymm9,32(%rdi) -+ vmovdqu %ymm2,64(%rdi) -+ vmovdqu %ymm10,96(%rdi) -+ leaq (%rdi,%rax,1),%rdi -+ -+ vpxord 0(%rsi),%ymm18,%ymm18 -+ vpxor 32(%rsi),%ymm6,%ymm6 -+ vpxor 64(%rsi),%ymm7,%ymm7 -+ vpxor 96(%rsi),%ymm15,%ymm15 -+ leaq (%rsi,%rax,1),%rsi -+ vmovdqu32 %ymm18,0(%rdi) -+ vmovdqu %ymm6,32(%rdi) -+ vmovdqu %ymm7,64(%rdi) -+ vmovdqu %ymm15,96(%rdi) -+ leaq (%rdi,%rax,1),%rdi -+ -+ vpxor 0(%rsi),%ymm3,%ymm3 -+ vpxor 32(%rsi),%ymm11,%ymm11 -+ vpxor 64(%rsi),%ymm4,%ymm4 -+ vpxor 96(%rsi),%ymm12,%ymm12 -+ leaq (%rsi,%rax,1),%rsi -+ vmovdqu %ymm3,0(%rdi) -+ vmovdqu %ymm11,32(%rdi) -+ vmovdqu %ymm4,64(%rdi) -+ vmovdqu %ymm12,96(%rdi) -+ leaq (%rdi,%rax,1),%rdi -+ -+ vpbroadcastd 0(%r9),%ymm0 -+ vpbroadcastd 4(%r9),%ymm1 -+ -+ subq $512,%rdx -+ jnz .Loop_outer8xvl -+ -+ jmp .Ldone8xvl -+ -+.align 32 -+.Ltail8xvl: -+ vmovdqa64 %ymm19,%ymm8 -+ xorq %r9,%r9 -+ subq %rsi,%rdi -+ cmpq $64,%rdx -+ jb .Less_than_64_8xvl -+ vpxor 0(%rsi),%ymm8,%ymm8 -+ vpxor 32(%rsi),%ymm0,%ymm0 -+ vmovdqu %ymm8,0(%rdi,%rsi,1) -+ vmovdqu %ymm0,32(%rdi,%rsi,1) -+ je .Ldone8xvl -+ vmovdqa %ymm5,%ymm8 -+ vmovdqa %ymm13,%ymm0 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $128,%rdx -+ jb .Less_than_64_8xvl -+ vpxor 0(%rsi),%ymm5,%ymm5 -+ vpxor 32(%rsi),%ymm13,%ymm13 -+ vmovdqu %ymm5,0(%rdi,%rsi,1) -+ vmovdqu %ymm13,32(%rdi,%rsi,1) -+ je .Ldone8xvl -+ vmovdqa %ymm1,%ymm8 -+ vmovdqa %ymm9,%ymm0 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $192,%rdx -+ jb .Less_than_64_8xvl -+ vpxor 0(%rsi),%ymm1,%ymm1 -+ vpxor 32(%rsi),%ymm9,%ymm9 -+ vmovdqu %ymm1,0(%rdi,%rsi,1) -+ vmovdqu %ymm9,32(%rdi,%rsi,1) -+ je .Ldone8xvl -+ vmovdqa %ymm2,%ymm8 -+ vmovdqa %ymm10,%ymm0 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $256,%rdx -+ jb .Less_than_64_8xvl -+ vpxor 0(%rsi),%ymm2,%ymm2 -+ vpxor 32(%rsi),%ymm10,%ymm10 -+ vmovdqu %ymm2,0(%rdi,%rsi,1) -+ vmovdqu %ymm10,32(%rdi,%rsi,1) -+ je .Ldone8xvl -+ vmovdqa32 %ymm18,%ymm8 -+ vmovdqa %ymm6,%ymm0 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $320,%rdx -+ jb .Less_than_64_8xvl -+ vpxord 0(%rsi),%ymm18,%ymm18 -+ vpxor 32(%rsi),%ymm6,%ymm6 -+ vmovdqu32 %ymm18,0(%rdi,%rsi,1) -+ vmovdqu %ymm6,32(%rdi,%rsi,1) -+ je .Ldone8xvl -+ vmovdqa %ymm7,%ymm8 -+ vmovdqa %ymm15,%ymm0 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $384,%rdx -+ jb .Less_than_64_8xvl -+ vpxor 0(%rsi),%ymm7,%ymm7 -+ vpxor 32(%rsi),%ymm15,%ymm15 -+ vmovdqu %ymm7,0(%rdi,%rsi,1) -+ vmovdqu %ymm15,32(%rdi,%rsi,1) -+ je .Ldone8xvl -+ vmovdqa %ymm3,%ymm8 -+ vmovdqa %ymm11,%ymm0 -+ leaq 64(%rsi),%rsi -+ -+ cmpq $448,%rdx -+ jb .Less_than_64_8xvl -+ vpxor 0(%rsi),%ymm3,%ymm3 -+ vpxor 32(%rsi),%ymm11,%ymm11 -+ vmovdqu %ymm3,0(%rdi,%rsi,1) -+ vmovdqu %ymm11,32(%rdi,%rsi,1) -+ je .Ldone8xvl -+ vmovdqa %ymm4,%ymm8 -+ vmovdqa %ymm12,%ymm0 -+ leaq 64(%rsi),%rsi -+ -+.Less_than_64_8xvl: -+ vmovdqa %ymm8,0(%rsp) -+ vmovdqa %ymm0,32(%rsp) -+ leaq (%rdi,%rsi,1),%rdi -+ andq $63,%rdx -+ -+.Loop_tail8xvl: -+ movzbl (%rsi,%r9,1),%eax -+ movzbl (%rsp,%r9,1),%ecx -+ leaq 1(%r9),%r9 -+ xorl %ecx,%eax -+ movb %al,-1(%rdi,%r9,1) -+ decq %rdx -+ jnz .Loop_tail8xvl -+ -+ vpxor %ymm8,%ymm8,%ymm8 -+ vmovdqa %ymm8,0(%rsp) -+ vmovdqa %ymm8,32(%rsp) -+ -+.Ldone8xvl: -+ vzeroall -+ leaq -8(%r10),%rsp -+.L8xvl_epilogue: -+ ret -+ENDPROC(chacha20_avx512vl) -+ -+#endif /* CONFIG_AS_AVX512 */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/curve25519-arm.S 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,2110 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * -+ * Based on algorithms from Daniel J. Bernstein and Peter Schwabe. -+ */ -+ -+#if IS_ENABLED(CONFIG_KERNEL_MODE_NEON) -+ -+#include -+ -+ .text -+ .fpu neon -+ .align 4 -+ -+ENTRY(curve25519_neon) -+ vpush {q4,q5,q6,q7} -+ mov r12,sp -+ sub r3,sp,#736 -+ and r3,r3,#0xffffffe0 -+ mov sp,r3 -+ strd r4,[sp,#0] -+ strd r6,[sp,#8] -+ strd r8,[sp,#16] -+ strd r10,[sp,#24] -+ str r12,[sp,#480] -+ str r14,[sp,#484] -+ mov r0,r0 -+ mov r1,r1 -+ mov r2,r2 -+ add r3,sp,#32 -+ ldr r4,=0 -+ ldr r5,=254 -+ vmov.i32 q0,#1 -+ vshr.u64 q1,q0,#7 -+ vshr.u64 q0,q0,#8 -+ vmov.i32 d4,#19 -+ vmov.i32 d5,#38 -+ add r6,sp,#512 -+ vst1.8 {d2-d3},[r6,: 128] -+ add r6,sp,#528 -+ vst1.8 {d0-d1},[r6,: 128] -+ add r6,sp,#544 -+ vst1.8 {d4-d5},[r6,: 128] -+ add r6,r3,#0 -+ vmov.i32 q2,#0 -+ vst1.8 {d4-d5},[r6,: 128]! -+ vst1.8 {d4-d5},[r6,: 128]! -+ vst1.8 d4,[r6,: 64] -+ add r6,r3,#0 -+ ldr r7,=960 -+ sub r7,r7,#2 -+ neg r7,r7 -+ sub r7,r7,r7,LSL #7 -+ str r7,[r6] -+ add r6,sp,#704 -+ vld1.8 {d4-d5},[r1]! -+ vld1.8 {d6-d7},[r1] -+ vst1.8 {d4-d5},[r6,: 128]! -+ vst1.8 {d6-d7},[r6,: 128] -+ sub r1,r6,#16 -+ ldrb r6,[r1] -+ and r6,r6,#248 -+ strb r6,[r1] -+ ldrb r6,[r1,#31] -+ and r6,r6,#127 -+ orr r6,r6,#64 -+ strb r6,[r1,#31] -+ vmov.i64 q2,#0xffffffff -+ vshr.u64 q3,q2,#7 -+ vshr.u64 q2,q2,#6 -+ vld1.8 {d8},[r2] -+ vld1.8 {d10},[r2] -+ add r2,r2,#6 -+ vld1.8 {d12},[r2] -+ vld1.8 {d14},[r2] -+ add r2,r2,#6 -+ vld1.8 {d16},[r2] -+ add r2,r2,#4 -+ vld1.8 {d18},[r2] -+ vld1.8 {d20},[r2] -+ add r2,r2,#6 -+ vld1.8 {d22},[r2] -+ add r2,r2,#2 -+ vld1.8 {d24},[r2] -+ vld1.8 {d26},[r2] -+ vshr.u64 q5,q5,#26 -+ vshr.u64 q6,q6,#3 -+ vshr.u64 q7,q7,#29 -+ vshr.u64 q8,q8,#6 -+ vshr.u64 q10,q10,#25 -+ vshr.u64 q11,q11,#3 -+ vshr.u64 q12,q12,#12 -+ vshr.u64 q13,q13,#38 -+ vand q4,q4,q2 -+ vand q6,q6,q2 -+ vand q8,q8,q2 -+ vand q10,q10,q2 -+ vand q2,q12,q2 -+ vand q5,q5,q3 -+ vand q7,q7,q3 -+ vand q9,q9,q3 -+ vand q11,q11,q3 -+ vand q3,q13,q3 -+ add r2,r3,#48 -+ vadd.i64 q12,q4,q1 -+ vadd.i64 q13,q10,q1 -+ vshr.s64 q12,q12,#26 -+ vshr.s64 q13,q13,#26 -+ vadd.i64 q5,q5,q12 -+ vshl.i64 q12,q12,#26 -+ vadd.i64 q14,q5,q0 -+ vadd.i64 q11,q11,q13 -+ vshl.i64 q13,q13,#26 -+ vadd.i64 q15,q11,q0 -+ vsub.i64 q4,q4,q12 -+ vshr.s64 q12,q14,#25 -+ vsub.i64 q10,q10,q13 -+ vshr.s64 q13,q15,#25 -+ vadd.i64 q6,q6,q12 -+ vshl.i64 q12,q12,#25 -+ vadd.i64 q14,q6,q1 -+ vadd.i64 q2,q2,q13 -+ vsub.i64 q5,q5,q12 -+ vshr.s64 q12,q14,#26 -+ vshl.i64 q13,q13,#25 -+ vadd.i64 q14,q2,q1 -+ vadd.i64 q7,q7,q12 -+ vshl.i64 q12,q12,#26 -+ vadd.i64 q15,q7,q0 -+ vsub.i64 q11,q11,q13 -+ vshr.s64 q13,q14,#26 -+ vsub.i64 q6,q6,q12 -+ vshr.s64 q12,q15,#25 -+ vadd.i64 q3,q3,q13 -+ vshl.i64 q13,q13,#26 -+ vadd.i64 q14,q3,q0 -+ vadd.i64 q8,q8,q12 -+ vshl.i64 q12,q12,#25 -+ vadd.i64 q15,q8,q1 -+ add r2,r2,#8 -+ vsub.i64 q2,q2,q13 -+ vshr.s64 q13,q14,#25 -+ vsub.i64 q7,q7,q12 -+ vshr.s64 q12,q15,#26 -+ vadd.i64 q14,q13,q13 -+ vadd.i64 q9,q9,q12 -+ vtrn.32 d12,d14 -+ vshl.i64 q12,q12,#26 -+ vtrn.32 d13,d15 -+ vadd.i64 q0,q9,q0 -+ vadd.i64 q4,q4,q14 -+ vst1.8 d12,[r2,: 64]! -+ vshl.i64 q6,q13,#4 -+ vsub.i64 q7,q8,q12 -+ vshr.s64 q0,q0,#25 -+ vadd.i64 q4,q4,q6 -+ vadd.i64 q6,q10,q0 -+ vshl.i64 q0,q0,#25 -+ vadd.i64 q8,q6,q1 -+ vadd.i64 q4,q4,q13 -+ vshl.i64 q10,q13,#25 -+ vadd.i64 q1,q4,q1 -+ vsub.i64 q0,q9,q0 -+ vshr.s64 q8,q8,#26 -+ vsub.i64 q3,q3,q10 -+ vtrn.32 d14,d0 -+ vshr.s64 q1,q1,#26 -+ vtrn.32 d15,d1 -+ vadd.i64 q0,q11,q8 -+ vst1.8 d14,[r2,: 64] -+ vshl.i64 q7,q8,#26 -+ vadd.i64 q5,q5,q1 -+ vtrn.32 d4,d6 -+ vshl.i64 q1,q1,#26 -+ vtrn.32 d5,d7 -+ vsub.i64 q3,q6,q7 -+ add r2,r2,#16 -+ vsub.i64 q1,q4,q1 -+ vst1.8 d4,[r2,: 64] -+ vtrn.32 d6,d0 -+ vtrn.32 d7,d1 -+ sub r2,r2,#8 -+ vtrn.32 d2,d10 -+ vtrn.32 d3,d11 -+ vst1.8 d6,[r2,: 64] -+ sub r2,r2,#24 -+ vst1.8 d2,[r2,: 64] -+ add r2,r3,#96 -+ vmov.i32 q0,#0 -+ vmov.i64 d2,#0xff -+ vmov.i64 d3,#0 -+ vshr.u32 q1,q1,#7 -+ vst1.8 {d2-d3},[r2,: 128]! -+ vst1.8 {d0-d1},[r2,: 128]! -+ vst1.8 d0,[r2,: 64] -+ add r2,r3,#144 -+ vmov.i32 q0,#0 -+ vst1.8 {d0-d1},[r2,: 128]! -+ vst1.8 {d0-d1},[r2,: 128]! -+ vst1.8 d0,[r2,: 64] -+ add r2,r3,#240 -+ vmov.i32 q0,#0 -+ vmov.i64 d2,#0xff -+ vmov.i64 d3,#0 -+ vshr.u32 q1,q1,#7 -+ vst1.8 {d2-d3},[r2,: 128]! -+ vst1.8 {d0-d1},[r2,: 128]! -+ vst1.8 d0,[r2,: 64] -+ add r2,r3,#48 -+ add r6,r3,#192 -+ vld1.8 {d0-d1},[r2,: 128]! -+ vld1.8 {d2-d3},[r2,: 128]! -+ vld1.8 {d4},[r2,: 64] -+ vst1.8 {d0-d1},[r6,: 128]! -+ vst1.8 {d2-d3},[r6,: 128]! -+ vst1.8 d4,[r6,: 64] -+ .Lmainloop: -+ mov r2,r5,LSR #3 -+ and r6,r5,#7 -+ ldrb r2,[r1,r2] -+ mov r2,r2,LSR r6 -+ and r2,r2,#1 -+ str r5,[sp,#488] -+ eor r4,r4,r2 -+ str r2,[sp,#492] -+ neg r2,r4 -+ add r4,r3,#96 -+ add r5,r3,#192 -+ add r6,r3,#144 -+ vld1.8 {d8-d9},[r4,: 128]! -+ add r7,r3,#240 -+ vld1.8 {d10-d11},[r5,: 128]! -+ veor q6,q4,q5 -+ vld1.8 {d14-d15},[r6,: 128]! -+ vdup.i32 q8,r2 -+ vld1.8 {d18-d19},[r7,: 128]! -+ veor q10,q7,q9 -+ vld1.8 {d22-d23},[r4,: 128]! -+ vand q6,q6,q8 -+ vld1.8 {d24-d25},[r5,: 128]! -+ vand q10,q10,q8 -+ vld1.8 {d26-d27},[r6,: 128]! -+ veor q4,q4,q6 -+ vld1.8 {d28-d29},[r7,: 128]! -+ veor q5,q5,q6 -+ vld1.8 {d0},[r4,: 64] -+ veor q6,q7,q10 -+ vld1.8 {d2},[r5,: 64] -+ veor q7,q9,q10 -+ vld1.8 {d4},[r6,: 64] -+ veor q9,q11,q12 -+ vld1.8 {d6},[r7,: 64] -+ veor q10,q0,q1 -+ sub r2,r4,#32 -+ vand q9,q9,q8 -+ sub r4,r5,#32 -+ vand q10,q10,q8 -+ sub r5,r6,#32 -+ veor q11,q11,q9 -+ sub r6,r7,#32 -+ veor q0,q0,q10 -+ veor q9,q12,q9 -+ veor q1,q1,q10 -+ veor q10,q13,q14 -+ veor q12,q2,q3 -+ vand q10,q10,q8 -+ vand q8,q12,q8 -+ veor q12,q13,q10 -+ veor q2,q2,q8 -+ veor q10,q14,q10 -+ veor q3,q3,q8 -+ vadd.i32 q8,q4,q6 -+ vsub.i32 q4,q4,q6 -+ vst1.8 {d16-d17},[r2,: 128]! -+ vadd.i32 q6,q11,q12 -+ vst1.8 {d8-d9},[r5,: 128]! -+ vsub.i32 q4,q11,q12 -+ vst1.8 {d12-d13},[r2,: 128]! -+ vadd.i32 q6,q0,q2 -+ vst1.8 {d8-d9},[r5,: 128]! -+ vsub.i32 q0,q0,q2 -+ vst1.8 d12,[r2,: 64] -+ vadd.i32 q2,q5,q7 -+ vst1.8 d0,[r5,: 64] -+ vsub.i32 q0,q5,q7 -+ vst1.8 {d4-d5},[r4,: 128]! -+ vadd.i32 q2,q9,q10 -+ vst1.8 {d0-d1},[r6,: 128]! -+ vsub.i32 q0,q9,q10 -+ vst1.8 {d4-d5},[r4,: 128]! -+ vadd.i32 q2,q1,q3 -+ vst1.8 {d0-d1},[r6,: 128]! -+ vsub.i32 q0,q1,q3 -+ vst1.8 d4,[r4,: 64] -+ vst1.8 d0,[r6,: 64] -+ add r2,sp,#544 -+ add r4,r3,#96 -+ add r5,r3,#144 -+ vld1.8 {d0-d1},[r2,: 128] -+ vld1.8 {d2-d3},[r4,: 128]! -+ vld1.8 {d4-d5},[r5,: 128]! -+ vzip.i32 q1,q2 -+ vld1.8 {d6-d7},[r4,: 128]! -+ vld1.8 {d8-d9},[r5,: 128]! -+ vshl.i32 q5,q1,#1 -+ vzip.i32 q3,q4 -+ vshl.i32 q6,q2,#1 -+ vld1.8 {d14},[r4,: 64] -+ vshl.i32 q8,q3,#1 -+ vld1.8 {d15},[r5,: 64] -+ vshl.i32 q9,q4,#1 -+ vmul.i32 d21,d7,d1 -+ vtrn.32 d14,d15 -+ vmul.i32 q11,q4,q0 -+ vmul.i32 q0,q7,q0 -+ vmull.s32 q12,d2,d2 -+ vmlal.s32 q12,d11,d1 -+ vmlal.s32 q12,d12,d0 -+ vmlal.s32 q12,d13,d23 -+ vmlal.s32 q12,d16,d22 -+ vmlal.s32 q12,d7,d21 -+ vmull.s32 q10,d2,d11 -+ vmlal.s32 q10,d4,d1 -+ vmlal.s32 q10,d13,d0 -+ vmlal.s32 q10,d6,d23 -+ vmlal.s32 q10,d17,d22 -+ vmull.s32 q13,d10,d4 -+ vmlal.s32 q13,d11,d3 -+ vmlal.s32 q13,d13,d1 -+ vmlal.s32 q13,d16,d0 -+ vmlal.s32 q13,d17,d23 -+ vmlal.s32 q13,d8,d22 -+ vmull.s32 q1,d10,d5 -+ vmlal.s32 q1,d11,d4 -+ vmlal.s32 q1,d6,d1 -+ vmlal.s32 q1,d17,d0 -+ vmlal.s32 q1,d8,d23 -+ vmull.s32 q14,d10,d6 -+ vmlal.s32 q14,d11,d13 -+ vmlal.s32 q14,d4,d4 -+ vmlal.s32 q14,d17,d1 -+ vmlal.s32 q14,d18,d0 -+ vmlal.s32 q14,d9,d23 -+ vmull.s32 q11,d10,d7 -+ vmlal.s32 q11,d11,d6 -+ vmlal.s32 q11,d12,d5 -+ vmlal.s32 q11,d8,d1 -+ vmlal.s32 q11,d19,d0 -+ vmull.s32 q15,d10,d8 -+ vmlal.s32 q15,d11,d17 -+ vmlal.s32 q15,d12,d6 -+ vmlal.s32 q15,d13,d5 -+ vmlal.s32 q15,d19,d1 -+ vmlal.s32 q15,d14,d0 -+ vmull.s32 q2,d10,d9 -+ vmlal.s32 q2,d11,d8 -+ vmlal.s32 q2,d12,d7 -+ vmlal.s32 q2,d13,d6 -+ vmlal.s32 q2,d14,d1 -+ vmull.s32 q0,d15,d1 -+ vmlal.s32 q0,d10,d14 -+ vmlal.s32 q0,d11,d19 -+ vmlal.s32 q0,d12,d8 -+ vmlal.s32 q0,d13,d17 -+ vmlal.s32 q0,d6,d6 -+ add r2,sp,#512 -+ vld1.8 {d18-d19},[r2,: 128] -+ vmull.s32 q3,d16,d7 -+ vmlal.s32 q3,d10,d15 -+ vmlal.s32 q3,d11,d14 -+ vmlal.s32 q3,d12,d9 -+ vmlal.s32 q3,d13,d8 -+ add r2,sp,#528 -+ vld1.8 {d8-d9},[r2,: 128] -+ vadd.i64 q5,q12,q9 -+ vadd.i64 q6,q15,q9 -+ vshr.s64 q5,q5,#26 -+ vshr.s64 q6,q6,#26 -+ vadd.i64 q7,q10,q5 -+ vshl.i64 q5,q5,#26 -+ vadd.i64 q8,q7,q4 -+ vadd.i64 q2,q2,q6 -+ vshl.i64 q6,q6,#26 -+ vadd.i64 q10,q2,q4 -+ vsub.i64 q5,q12,q5 -+ vshr.s64 q8,q8,#25 -+ vsub.i64 q6,q15,q6 -+ vshr.s64 q10,q10,#25 -+ vadd.i64 q12,q13,q8 -+ vshl.i64 q8,q8,#25 -+ vadd.i64 q13,q12,q9 -+ vadd.i64 q0,q0,q10 -+ vsub.i64 q7,q7,q8 -+ vshr.s64 q8,q13,#26 -+ vshl.i64 q10,q10,#25 -+ vadd.i64 q13,q0,q9 -+ vadd.i64 q1,q1,q8 -+ vshl.i64 q8,q8,#26 -+ vadd.i64 q15,q1,q4 -+ vsub.i64 q2,q2,q10 -+ vshr.s64 q10,q13,#26 -+ vsub.i64 q8,q12,q8 -+ vshr.s64 q12,q15,#25 -+ vadd.i64 q3,q3,q10 -+ vshl.i64 q10,q10,#26 -+ vadd.i64 q13,q3,q4 -+ vadd.i64 q14,q14,q12 -+ add r2,r3,#288 -+ vshl.i64 q12,q12,#25 -+ add r4,r3,#336 -+ vadd.i64 q15,q14,q9 -+ add r2,r2,#8 -+ vsub.i64 q0,q0,q10 -+ add r4,r4,#8 -+ vshr.s64 q10,q13,#25 -+ vsub.i64 q1,q1,q12 -+ vshr.s64 q12,q15,#26 -+ vadd.i64 q13,q10,q10 -+ vadd.i64 q11,q11,q12 -+ vtrn.32 d16,d2 -+ vshl.i64 q12,q12,#26 -+ vtrn.32 d17,d3 -+ vadd.i64 q1,q11,q4 -+ vadd.i64 q4,q5,q13 -+ vst1.8 d16,[r2,: 64]! -+ vshl.i64 q5,q10,#4 -+ vst1.8 d17,[r4,: 64]! -+ vsub.i64 q8,q14,q12 -+ vshr.s64 q1,q1,#25 -+ vadd.i64 q4,q4,q5 -+ vadd.i64 q5,q6,q1 -+ vshl.i64 q1,q1,#25 -+ vadd.i64 q6,q5,q9 -+ vadd.i64 q4,q4,q10 -+ vshl.i64 q10,q10,#25 -+ vadd.i64 q9,q4,q9 -+ vsub.i64 q1,q11,q1 -+ vshr.s64 q6,q6,#26 -+ vsub.i64 q3,q3,q10 -+ vtrn.32 d16,d2 -+ vshr.s64 q9,q9,#26 -+ vtrn.32 d17,d3 -+ vadd.i64 q1,q2,q6 -+ vst1.8 d16,[r2,: 64] -+ vshl.i64 q2,q6,#26 -+ vst1.8 d17,[r4,: 64] -+ vadd.i64 q6,q7,q9 -+ vtrn.32 d0,d6 -+ vshl.i64 q7,q9,#26 -+ vtrn.32 d1,d7 -+ vsub.i64 q2,q5,q2 -+ add r2,r2,#16 -+ vsub.i64 q3,q4,q7 -+ vst1.8 d0,[r2,: 64] -+ add r4,r4,#16 -+ vst1.8 d1,[r4,: 64] -+ vtrn.32 d4,d2 -+ vtrn.32 d5,d3 -+ sub r2,r2,#8 -+ sub r4,r4,#8 -+ vtrn.32 d6,d12 -+ vtrn.32 d7,d13 -+ vst1.8 d4,[r2,: 64] -+ vst1.8 d5,[r4,: 64] -+ sub r2,r2,#24 -+ sub r4,r4,#24 -+ vst1.8 d6,[r2,: 64] -+ vst1.8 d7,[r4,: 64] -+ add r2,r3,#240 -+ add r4,r3,#96 -+ vld1.8 {d0-d1},[r4,: 128]! -+ vld1.8 {d2-d3},[r4,: 128]! -+ vld1.8 {d4},[r4,: 64] -+ add r4,r3,#144 -+ vld1.8 {d6-d7},[r4,: 128]! -+ vtrn.32 q0,q3 -+ vld1.8 {d8-d9},[r4,: 128]! -+ vshl.i32 q5,q0,#4 -+ vtrn.32 q1,q4 -+ vshl.i32 q6,q3,#4 -+ vadd.i32 q5,q5,q0 -+ vadd.i32 q6,q6,q3 -+ vshl.i32 q7,q1,#4 -+ vld1.8 {d5},[r4,: 64] -+ vshl.i32 q8,q4,#4 -+ vtrn.32 d4,d5 -+ vadd.i32 q7,q7,q1 -+ vadd.i32 q8,q8,q4 -+ vld1.8 {d18-d19},[r2,: 128]! -+ vshl.i32 q10,q2,#4 -+ vld1.8 {d22-d23},[r2,: 128]! -+ vadd.i32 q10,q10,q2 -+ vld1.8 {d24},[r2,: 64] -+ vadd.i32 q5,q5,q0 -+ add r2,r3,#192 -+ vld1.8 {d26-d27},[r2,: 128]! -+ vadd.i32 q6,q6,q3 -+ vld1.8 {d28-d29},[r2,: 128]! -+ vadd.i32 q8,q8,q4 -+ vld1.8 {d25},[r2,: 64] -+ vadd.i32 q10,q10,q2 -+ vtrn.32 q9,q13 -+ vadd.i32 q7,q7,q1 -+ vadd.i32 q5,q5,q0 -+ vtrn.32 q11,q14 -+ vadd.i32 q6,q6,q3 -+ add r2,sp,#560 -+ vadd.i32 q10,q10,q2 -+ vtrn.32 d24,d25 -+ vst1.8 {d12-d13},[r2,: 128] -+ vshl.i32 q6,q13,#1 -+ add r2,sp,#576 -+ vst1.8 {d20-d21},[r2,: 128] -+ vshl.i32 q10,q14,#1 -+ add r2,sp,#592 -+ vst1.8 {d12-d13},[r2,: 128] -+ vshl.i32 q15,q12,#1 -+ vadd.i32 q8,q8,q4 -+ vext.32 d10,d31,d30,#0 -+ vadd.i32 q7,q7,q1 -+ add r2,sp,#608 -+ vst1.8 {d16-d17},[r2,: 128] -+ vmull.s32 q8,d18,d5 -+ vmlal.s32 q8,d26,d4 -+ vmlal.s32 q8,d19,d9 -+ vmlal.s32 q8,d27,d3 -+ vmlal.s32 q8,d22,d8 -+ vmlal.s32 q8,d28,d2 -+ vmlal.s32 q8,d23,d7 -+ vmlal.s32 q8,d29,d1 -+ vmlal.s32 q8,d24,d6 -+ vmlal.s32 q8,d25,d0 -+ add r2,sp,#624 -+ vst1.8 {d14-d15},[r2,: 128] -+ vmull.s32 q2,d18,d4 -+ vmlal.s32 q2,d12,d9 -+ vmlal.s32 q2,d13,d8 -+ vmlal.s32 q2,d19,d3 -+ vmlal.s32 q2,d22,d2 -+ vmlal.s32 q2,d23,d1 -+ vmlal.s32 q2,d24,d0 -+ add r2,sp,#640 -+ vst1.8 {d20-d21},[r2,: 128] -+ vmull.s32 q7,d18,d9 -+ vmlal.s32 q7,d26,d3 -+ vmlal.s32 q7,d19,d8 -+ vmlal.s32 q7,d27,d2 -+ vmlal.s32 q7,d22,d7 -+ vmlal.s32 q7,d28,d1 -+ vmlal.s32 q7,d23,d6 -+ vmlal.s32 q7,d29,d0 -+ add r2,sp,#656 -+ vst1.8 {d10-d11},[r2,: 128] -+ vmull.s32 q5,d18,d3 -+ vmlal.s32 q5,d19,d2 -+ vmlal.s32 q5,d22,d1 -+ vmlal.s32 q5,d23,d0 -+ vmlal.s32 q5,d12,d8 -+ add r2,sp,#672 -+ vst1.8 {d16-d17},[r2,: 128] -+ vmull.s32 q4,d18,d8 -+ vmlal.s32 q4,d26,d2 -+ vmlal.s32 q4,d19,d7 -+ vmlal.s32 q4,d27,d1 -+ vmlal.s32 q4,d22,d6 -+ vmlal.s32 q4,d28,d0 -+ vmull.s32 q8,d18,d7 -+ vmlal.s32 q8,d26,d1 -+ vmlal.s32 q8,d19,d6 -+ vmlal.s32 q8,d27,d0 -+ add r2,sp,#576 -+ vld1.8 {d20-d21},[r2,: 128] -+ vmlal.s32 q7,d24,d21 -+ vmlal.s32 q7,d25,d20 -+ vmlal.s32 q4,d23,d21 -+ vmlal.s32 q4,d29,d20 -+ vmlal.s32 q8,d22,d21 -+ vmlal.s32 q8,d28,d20 -+ vmlal.s32 q5,d24,d20 -+ add r2,sp,#576 -+ vst1.8 {d14-d15},[r2,: 128] -+ vmull.s32 q7,d18,d6 -+ vmlal.s32 q7,d26,d0 -+ add r2,sp,#656 -+ vld1.8 {d30-d31},[r2,: 128] -+ vmlal.s32 q2,d30,d21 -+ vmlal.s32 q7,d19,d21 -+ vmlal.s32 q7,d27,d20 -+ add r2,sp,#624 -+ vld1.8 {d26-d27},[r2,: 128] -+ vmlal.s32 q4,d25,d27 -+ vmlal.s32 q8,d29,d27 -+ vmlal.s32 q8,d25,d26 -+ vmlal.s32 q7,d28,d27 -+ vmlal.s32 q7,d29,d26 -+ add r2,sp,#608 -+ vld1.8 {d28-d29},[r2,: 128] -+ vmlal.s32 q4,d24,d29 -+ vmlal.s32 q8,d23,d29 -+ vmlal.s32 q8,d24,d28 -+ vmlal.s32 q7,d22,d29 -+ vmlal.s32 q7,d23,d28 -+ add r2,sp,#608 -+ vst1.8 {d8-d9},[r2,: 128] -+ add r2,sp,#560 -+ vld1.8 {d8-d9},[r2,: 128] -+ vmlal.s32 q7,d24,d9 -+ vmlal.s32 q7,d25,d31 -+ vmull.s32 q1,d18,d2 -+ vmlal.s32 q1,d19,d1 -+ vmlal.s32 q1,d22,d0 -+ vmlal.s32 q1,d24,d27 -+ vmlal.s32 q1,d23,d20 -+ vmlal.s32 q1,d12,d7 -+ vmlal.s32 q1,d13,d6 -+ vmull.s32 q6,d18,d1 -+ vmlal.s32 q6,d19,d0 -+ vmlal.s32 q6,d23,d27 -+ vmlal.s32 q6,d22,d20 -+ vmlal.s32 q6,d24,d26 -+ vmull.s32 q0,d18,d0 -+ vmlal.s32 q0,d22,d27 -+ vmlal.s32 q0,d23,d26 -+ vmlal.s32 q0,d24,d31 -+ vmlal.s32 q0,d19,d20 -+ add r2,sp,#640 -+ vld1.8 {d18-d19},[r2,: 128] -+ vmlal.s32 q2,d18,d7 -+ vmlal.s32 q2,d19,d6 -+ vmlal.s32 q5,d18,d6 -+ vmlal.s32 q5,d19,d21 -+ vmlal.s32 q1,d18,d21 -+ vmlal.s32 q1,d19,d29 -+ vmlal.s32 q0,d18,d28 -+ vmlal.s32 q0,d19,d9 -+ vmlal.s32 q6,d18,d29 -+ vmlal.s32 q6,d19,d28 -+ add r2,sp,#592 -+ vld1.8 {d18-d19},[r2,: 128] -+ add r2,sp,#512 -+ vld1.8 {d22-d23},[r2,: 128] -+ vmlal.s32 q5,d19,d7 -+ vmlal.s32 q0,d18,d21 -+ vmlal.s32 q0,d19,d29 -+ vmlal.s32 q6,d18,d6 -+ add r2,sp,#528 -+ vld1.8 {d6-d7},[r2,: 128] -+ vmlal.s32 q6,d19,d21 -+ add r2,sp,#576 -+ vld1.8 {d18-d19},[r2,: 128] -+ vmlal.s32 q0,d30,d8 -+ add r2,sp,#672 -+ vld1.8 {d20-d21},[r2,: 128] -+ vmlal.s32 q5,d30,d29 -+ add r2,sp,#608 -+ vld1.8 {d24-d25},[r2,: 128] -+ vmlal.s32 q1,d30,d28 -+ vadd.i64 q13,q0,q11 -+ vadd.i64 q14,q5,q11 -+ vmlal.s32 q6,d30,d9 -+ vshr.s64 q4,q13,#26 -+ vshr.s64 q13,q14,#26 -+ vadd.i64 q7,q7,q4 -+ vshl.i64 q4,q4,#26 -+ vadd.i64 q14,q7,q3 -+ vadd.i64 q9,q9,q13 -+ vshl.i64 q13,q13,#26 -+ vadd.i64 q15,q9,q3 -+ vsub.i64 q0,q0,q4 -+ vshr.s64 q4,q14,#25 -+ vsub.i64 q5,q5,q13 -+ vshr.s64 q13,q15,#25 -+ vadd.i64 q6,q6,q4 -+ vshl.i64 q4,q4,#25 -+ vadd.i64 q14,q6,q11 -+ vadd.i64 q2,q2,q13 -+ vsub.i64 q4,q7,q4 -+ vshr.s64 q7,q14,#26 -+ vshl.i64 q13,q13,#25 -+ vadd.i64 q14,q2,q11 -+ vadd.i64 q8,q8,q7 -+ vshl.i64 q7,q7,#26 -+ vadd.i64 q15,q8,q3 -+ vsub.i64 q9,q9,q13 -+ vshr.s64 q13,q14,#26 -+ vsub.i64 q6,q6,q7 -+ vshr.s64 q7,q15,#25 -+ vadd.i64 q10,q10,q13 -+ vshl.i64 q13,q13,#26 -+ vadd.i64 q14,q10,q3 -+ vadd.i64 q1,q1,q7 -+ add r2,r3,#144 -+ vshl.i64 q7,q7,#25 -+ add r4,r3,#96 -+ vadd.i64 q15,q1,q11 -+ add r2,r2,#8 -+ vsub.i64 q2,q2,q13 -+ add r4,r4,#8 -+ vshr.s64 q13,q14,#25 -+ vsub.i64 q7,q8,q7 -+ vshr.s64 q8,q15,#26 -+ vadd.i64 q14,q13,q13 -+ vadd.i64 q12,q12,q8 -+ vtrn.32 d12,d14 -+ vshl.i64 q8,q8,#26 -+ vtrn.32 d13,d15 -+ vadd.i64 q3,q12,q3 -+ vadd.i64 q0,q0,q14 -+ vst1.8 d12,[r2,: 64]! -+ vshl.i64 q7,q13,#4 -+ vst1.8 d13,[r4,: 64]! -+ vsub.i64 q1,q1,q8 -+ vshr.s64 q3,q3,#25 -+ vadd.i64 q0,q0,q7 -+ vadd.i64 q5,q5,q3 -+ vshl.i64 q3,q3,#25 -+ vadd.i64 q6,q5,q11 -+ vadd.i64 q0,q0,q13 -+ vshl.i64 q7,q13,#25 -+ vadd.i64 q8,q0,q11 -+ vsub.i64 q3,q12,q3 -+ vshr.s64 q6,q6,#26 -+ vsub.i64 q7,q10,q7 -+ vtrn.32 d2,d6 -+ vshr.s64 q8,q8,#26 -+ vtrn.32 d3,d7 -+ vadd.i64 q3,q9,q6 -+ vst1.8 d2,[r2,: 64] -+ vshl.i64 q6,q6,#26 -+ vst1.8 d3,[r4,: 64] -+ vadd.i64 q1,q4,q8 -+ vtrn.32 d4,d14 -+ vshl.i64 q4,q8,#26 -+ vtrn.32 d5,d15 -+ vsub.i64 q5,q5,q6 -+ add r2,r2,#16 -+ vsub.i64 q0,q0,q4 -+ vst1.8 d4,[r2,: 64] -+ add r4,r4,#16 -+ vst1.8 d5,[r4,: 64] -+ vtrn.32 d10,d6 -+ vtrn.32 d11,d7 -+ sub r2,r2,#8 -+ sub r4,r4,#8 -+ vtrn.32 d0,d2 -+ vtrn.32 d1,d3 -+ vst1.8 d10,[r2,: 64] -+ vst1.8 d11,[r4,: 64] -+ sub r2,r2,#24 -+ sub r4,r4,#24 -+ vst1.8 d0,[r2,: 64] -+ vst1.8 d1,[r4,: 64] -+ add r2,r3,#288 -+ add r4,r3,#336 -+ vld1.8 {d0-d1},[r2,: 128]! -+ vld1.8 {d2-d3},[r4,: 128]! -+ vsub.i32 q0,q0,q1 -+ vld1.8 {d2-d3},[r2,: 128]! -+ vld1.8 {d4-d5},[r4,: 128]! -+ vsub.i32 q1,q1,q2 -+ add r5,r3,#240 -+ vld1.8 {d4},[r2,: 64] -+ vld1.8 {d6},[r4,: 64] -+ vsub.i32 q2,q2,q3 -+ vst1.8 {d0-d1},[r5,: 128]! -+ vst1.8 {d2-d3},[r5,: 128]! -+ vst1.8 d4,[r5,: 64] -+ add r2,r3,#144 -+ add r4,r3,#96 -+ add r5,r3,#144 -+ add r6,r3,#192 -+ vld1.8 {d0-d1},[r2,: 128]! -+ vld1.8 {d2-d3},[r4,: 128]! -+ vsub.i32 q2,q0,q1 -+ vadd.i32 q0,q0,q1 -+ vld1.8 {d2-d3},[r2,: 128]! -+ vld1.8 {d6-d7},[r4,: 128]! -+ vsub.i32 q4,q1,q3 -+ vadd.i32 q1,q1,q3 -+ vld1.8 {d6},[r2,: 64] -+ vld1.8 {d10},[r4,: 64] -+ vsub.i32 q6,q3,q5 -+ vadd.i32 q3,q3,q5 -+ vst1.8 {d4-d5},[r5,: 128]! -+ vst1.8 {d0-d1},[r6,: 128]! -+ vst1.8 {d8-d9},[r5,: 128]! -+ vst1.8 {d2-d3},[r6,: 128]! -+ vst1.8 d12,[r5,: 64] -+ vst1.8 d6,[r6,: 64] -+ add r2,r3,#0 -+ add r4,r3,#240 -+ vld1.8 {d0-d1},[r4,: 128]! -+ vld1.8 {d2-d3},[r4,: 128]! -+ vld1.8 {d4},[r4,: 64] -+ add r4,r3,#336 -+ vld1.8 {d6-d7},[r4,: 128]! -+ vtrn.32 q0,q3 -+ vld1.8 {d8-d9},[r4,: 128]! -+ vshl.i32 q5,q0,#4 -+ vtrn.32 q1,q4 -+ vshl.i32 q6,q3,#4 -+ vadd.i32 q5,q5,q0 -+ vadd.i32 q6,q6,q3 -+ vshl.i32 q7,q1,#4 -+ vld1.8 {d5},[r4,: 64] -+ vshl.i32 q8,q4,#4 -+ vtrn.32 d4,d5 -+ vadd.i32 q7,q7,q1 -+ vadd.i32 q8,q8,q4 -+ vld1.8 {d18-d19},[r2,: 128]! -+ vshl.i32 q10,q2,#4 -+ vld1.8 {d22-d23},[r2,: 128]! -+ vadd.i32 q10,q10,q2 -+ vld1.8 {d24},[r2,: 64] -+ vadd.i32 q5,q5,q0 -+ add r2,r3,#288 -+ vld1.8 {d26-d27},[r2,: 128]! -+ vadd.i32 q6,q6,q3 -+ vld1.8 {d28-d29},[r2,: 128]! -+ vadd.i32 q8,q8,q4 -+ vld1.8 {d25},[r2,: 64] -+ vadd.i32 q10,q10,q2 -+ vtrn.32 q9,q13 -+ vadd.i32 q7,q7,q1 -+ vadd.i32 q5,q5,q0 -+ vtrn.32 q11,q14 -+ vadd.i32 q6,q6,q3 -+ add r2,sp,#560 -+ vadd.i32 q10,q10,q2 -+ vtrn.32 d24,d25 -+ vst1.8 {d12-d13},[r2,: 128] -+ vshl.i32 q6,q13,#1 -+ add r2,sp,#576 -+ vst1.8 {d20-d21},[r2,: 128] -+ vshl.i32 q10,q14,#1 -+ add r2,sp,#592 -+ vst1.8 {d12-d13},[r2,: 128] -+ vshl.i32 q15,q12,#1 -+ vadd.i32 q8,q8,q4 -+ vext.32 d10,d31,d30,#0 -+ vadd.i32 q7,q7,q1 -+ add r2,sp,#608 -+ vst1.8 {d16-d17},[r2,: 128] -+ vmull.s32 q8,d18,d5 -+ vmlal.s32 q8,d26,d4 -+ vmlal.s32 q8,d19,d9 -+ vmlal.s32 q8,d27,d3 -+ vmlal.s32 q8,d22,d8 -+ vmlal.s32 q8,d28,d2 -+ vmlal.s32 q8,d23,d7 -+ vmlal.s32 q8,d29,d1 -+ vmlal.s32 q8,d24,d6 -+ vmlal.s32 q8,d25,d0 -+ add r2,sp,#624 -+ vst1.8 {d14-d15},[r2,: 128] -+ vmull.s32 q2,d18,d4 -+ vmlal.s32 q2,d12,d9 -+ vmlal.s32 q2,d13,d8 -+ vmlal.s32 q2,d19,d3 -+ vmlal.s32 q2,d22,d2 -+ vmlal.s32 q2,d23,d1 -+ vmlal.s32 q2,d24,d0 -+ add r2,sp,#640 -+ vst1.8 {d20-d21},[r2,: 128] -+ vmull.s32 q7,d18,d9 -+ vmlal.s32 q7,d26,d3 -+ vmlal.s32 q7,d19,d8 -+ vmlal.s32 q7,d27,d2 -+ vmlal.s32 q7,d22,d7 -+ vmlal.s32 q7,d28,d1 -+ vmlal.s32 q7,d23,d6 -+ vmlal.s32 q7,d29,d0 -+ add r2,sp,#656 -+ vst1.8 {d10-d11},[r2,: 128] -+ vmull.s32 q5,d18,d3 -+ vmlal.s32 q5,d19,d2 -+ vmlal.s32 q5,d22,d1 -+ vmlal.s32 q5,d23,d0 -+ vmlal.s32 q5,d12,d8 -+ add r2,sp,#672 -+ vst1.8 {d16-d17},[r2,: 128] -+ vmull.s32 q4,d18,d8 -+ vmlal.s32 q4,d26,d2 -+ vmlal.s32 q4,d19,d7 -+ vmlal.s32 q4,d27,d1 -+ vmlal.s32 q4,d22,d6 -+ vmlal.s32 q4,d28,d0 -+ vmull.s32 q8,d18,d7 -+ vmlal.s32 q8,d26,d1 -+ vmlal.s32 q8,d19,d6 -+ vmlal.s32 q8,d27,d0 -+ add r2,sp,#576 -+ vld1.8 {d20-d21},[r2,: 128] -+ vmlal.s32 q7,d24,d21 -+ vmlal.s32 q7,d25,d20 -+ vmlal.s32 q4,d23,d21 -+ vmlal.s32 q4,d29,d20 -+ vmlal.s32 q8,d22,d21 -+ vmlal.s32 q8,d28,d20 -+ vmlal.s32 q5,d24,d20 -+ add r2,sp,#576 -+ vst1.8 {d14-d15},[r2,: 128] -+ vmull.s32 q7,d18,d6 -+ vmlal.s32 q7,d26,d0 -+ add r2,sp,#656 -+ vld1.8 {d30-d31},[r2,: 128] -+ vmlal.s32 q2,d30,d21 -+ vmlal.s32 q7,d19,d21 -+ vmlal.s32 q7,d27,d20 -+ add r2,sp,#624 -+ vld1.8 {d26-d27},[r2,: 128] -+ vmlal.s32 q4,d25,d27 -+ vmlal.s32 q8,d29,d27 -+ vmlal.s32 q8,d25,d26 -+ vmlal.s32 q7,d28,d27 -+ vmlal.s32 q7,d29,d26 -+ add r2,sp,#608 -+ vld1.8 {d28-d29},[r2,: 128] -+ vmlal.s32 q4,d24,d29 -+ vmlal.s32 q8,d23,d29 -+ vmlal.s32 q8,d24,d28 -+ vmlal.s32 q7,d22,d29 -+ vmlal.s32 q7,d23,d28 -+ add r2,sp,#608 -+ vst1.8 {d8-d9},[r2,: 128] -+ add r2,sp,#560 -+ vld1.8 {d8-d9},[r2,: 128] -+ vmlal.s32 q7,d24,d9 -+ vmlal.s32 q7,d25,d31 -+ vmull.s32 q1,d18,d2 -+ vmlal.s32 q1,d19,d1 -+ vmlal.s32 q1,d22,d0 -+ vmlal.s32 q1,d24,d27 -+ vmlal.s32 q1,d23,d20 -+ vmlal.s32 q1,d12,d7 -+ vmlal.s32 q1,d13,d6 -+ vmull.s32 q6,d18,d1 -+ vmlal.s32 q6,d19,d0 -+ vmlal.s32 q6,d23,d27 -+ vmlal.s32 q6,d22,d20 -+ vmlal.s32 q6,d24,d26 -+ vmull.s32 q0,d18,d0 -+ vmlal.s32 q0,d22,d27 -+ vmlal.s32 q0,d23,d26 -+ vmlal.s32 q0,d24,d31 -+ vmlal.s32 q0,d19,d20 -+ add r2,sp,#640 -+ vld1.8 {d18-d19},[r2,: 128] -+ vmlal.s32 q2,d18,d7 -+ vmlal.s32 q2,d19,d6 -+ vmlal.s32 q5,d18,d6 -+ vmlal.s32 q5,d19,d21 -+ vmlal.s32 q1,d18,d21 -+ vmlal.s32 q1,d19,d29 -+ vmlal.s32 q0,d18,d28 -+ vmlal.s32 q0,d19,d9 -+ vmlal.s32 q6,d18,d29 -+ vmlal.s32 q6,d19,d28 -+ add r2,sp,#592 -+ vld1.8 {d18-d19},[r2,: 128] -+ add r2,sp,#512 -+ vld1.8 {d22-d23},[r2,: 128] -+ vmlal.s32 q5,d19,d7 -+ vmlal.s32 q0,d18,d21 -+ vmlal.s32 q0,d19,d29 -+ vmlal.s32 q6,d18,d6 -+ add r2,sp,#528 -+ vld1.8 {d6-d7},[r2,: 128] -+ vmlal.s32 q6,d19,d21 -+ add r2,sp,#576 -+ vld1.8 {d18-d19},[r2,: 128] -+ vmlal.s32 q0,d30,d8 -+ add r2,sp,#672 -+ vld1.8 {d20-d21},[r2,: 128] -+ vmlal.s32 q5,d30,d29 -+ add r2,sp,#608 -+ vld1.8 {d24-d25},[r2,: 128] -+ vmlal.s32 q1,d30,d28 -+ vadd.i64 q13,q0,q11 -+ vadd.i64 q14,q5,q11 -+ vmlal.s32 q6,d30,d9 -+ vshr.s64 q4,q13,#26 -+ vshr.s64 q13,q14,#26 -+ vadd.i64 q7,q7,q4 -+ vshl.i64 q4,q4,#26 -+ vadd.i64 q14,q7,q3 -+ vadd.i64 q9,q9,q13 -+ vshl.i64 q13,q13,#26 -+ vadd.i64 q15,q9,q3 -+ vsub.i64 q0,q0,q4 -+ vshr.s64 q4,q14,#25 -+ vsub.i64 q5,q5,q13 -+ vshr.s64 q13,q15,#25 -+ vadd.i64 q6,q6,q4 -+ vshl.i64 q4,q4,#25 -+ vadd.i64 q14,q6,q11 -+ vadd.i64 q2,q2,q13 -+ vsub.i64 q4,q7,q4 -+ vshr.s64 q7,q14,#26 -+ vshl.i64 q13,q13,#25 -+ vadd.i64 q14,q2,q11 -+ vadd.i64 q8,q8,q7 -+ vshl.i64 q7,q7,#26 -+ vadd.i64 q15,q8,q3 -+ vsub.i64 q9,q9,q13 -+ vshr.s64 q13,q14,#26 -+ vsub.i64 q6,q6,q7 -+ vshr.s64 q7,q15,#25 -+ vadd.i64 q10,q10,q13 -+ vshl.i64 q13,q13,#26 -+ vadd.i64 q14,q10,q3 -+ vadd.i64 q1,q1,q7 -+ add r2,r3,#288 -+ vshl.i64 q7,q7,#25 -+ add r4,r3,#96 -+ vadd.i64 q15,q1,q11 -+ add r2,r2,#8 -+ vsub.i64 q2,q2,q13 -+ add r4,r4,#8 -+ vshr.s64 q13,q14,#25 -+ vsub.i64 q7,q8,q7 -+ vshr.s64 q8,q15,#26 -+ vadd.i64 q14,q13,q13 -+ vadd.i64 q12,q12,q8 -+ vtrn.32 d12,d14 -+ vshl.i64 q8,q8,#26 -+ vtrn.32 d13,d15 -+ vadd.i64 q3,q12,q3 -+ vadd.i64 q0,q0,q14 -+ vst1.8 d12,[r2,: 64]! -+ vshl.i64 q7,q13,#4 -+ vst1.8 d13,[r4,: 64]! -+ vsub.i64 q1,q1,q8 -+ vshr.s64 q3,q3,#25 -+ vadd.i64 q0,q0,q7 -+ vadd.i64 q5,q5,q3 -+ vshl.i64 q3,q3,#25 -+ vadd.i64 q6,q5,q11 -+ vadd.i64 q0,q0,q13 -+ vshl.i64 q7,q13,#25 -+ vadd.i64 q8,q0,q11 -+ vsub.i64 q3,q12,q3 -+ vshr.s64 q6,q6,#26 -+ vsub.i64 q7,q10,q7 -+ vtrn.32 d2,d6 -+ vshr.s64 q8,q8,#26 -+ vtrn.32 d3,d7 -+ vadd.i64 q3,q9,q6 -+ vst1.8 d2,[r2,: 64] -+ vshl.i64 q6,q6,#26 -+ vst1.8 d3,[r4,: 64] -+ vadd.i64 q1,q4,q8 -+ vtrn.32 d4,d14 -+ vshl.i64 q4,q8,#26 -+ vtrn.32 d5,d15 -+ vsub.i64 q5,q5,q6 -+ add r2,r2,#16 -+ vsub.i64 q0,q0,q4 -+ vst1.8 d4,[r2,: 64] -+ add r4,r4,#16 -+ vst1.8 d5,[r4,: 64] -+ vtrn.32 d10,d6 -+ vtrn.32 d11,d7 -+ sub r2,r2,#8 -+ sub r4,r4,#8 -+ vtrn.32 d0,d2 -+ vtrn.32 d1,d3 -+ vst1.8 d10,[r2,: 64] -+ vst1.8 d11,[r4,: 64] -+ sub r2,r2,#24 -+ sub r4,r4,#24 -+ vst1.8 d0,[r2,: 64] -+ vst1.8 d1,[r4,: 64] -+ add r2,sp,#544 -+ add r4,r3,#144 -+ add r5,r3,#192 -+ vld1.8 {d0-d1},[r2,: 128] -+ vld1.8 {d2-d3},[r4,: 128]! -+ vld1.8 {d4-d5},[r5,: 128]! -+ vzip.i32 q1,q2 -+ vld1.8 {d6-d7},[r4,: 128]! -+ vld1.8 {d8-d9},[r5,: 128]! -+ vshl.i32 q5,q1,#1 -+ vzip.i32 q3,q4 -+ vshl.i32 q6,q2,#1 -+ vld1.8 {d14},[r4,: 64] -+ vshl.i32 q8,q3,#1 -+ vld1.8 {d15},[r5,: 64] -+ vshl.i32 q9,q4,#1 -+ vmul.i32 d21,d7,d1 -+ vtrn.32 d14,d15 -+ vmul.i32 q11,q4,q0 -+ vmul.i32 q0,q7,q0 -+ vmull.s32 q12,d2,d2 -+ vmlal.s32 q12,d11,d1 -+ vmlal.s32 q12,d12,d0 -+ vmlal.s32 q12,d13,d23 -+ vmlal.s32 q12,d16,d22 -+ vmlal.s32 q12,d7,d21 -+ vmull.s32 q10,d2,d11 -+ vmlal.s32 q10,d4,d1 -+ vmlal.s32 q10,d13,d0 -+ vmlal.s32 q10,d6,d23 -+ vmlal.s32 q10,d17,d22 -+ vmull.s32 q13,d10,d4 -+ vmlal.s32 q13,d11,d3 -+ vmlal.s32 q13,d13,d1 -+ vmlal.s32 q13,d16,d0 -+ vmlal.s32 q13,d17,d23 -+ vmlal.s32 q13,d8,d22 -+ vmull.s32 q1,d10,d5 -+ vmlal.s32 q1,d11,d4 -+ vmlal.s32 q1,d6,d1 -+ vmlal.s32 q1,d17,d0 -+ vmlal.s32 q1,d8,d23 -+ vmull.s32 q14,d10,d6 -+ vmlal.s32 q14,d11,d13 -+ vmlal.s32 q14,d4,d4 -+ vmlal.s32 q14,d17,d1 -+ vmlal.s32 q14,d18,d0 -+ vmlal.s32 q14,d9,d23 -+ vmull.s32 q11,d10,d7 -+ vmlal.s32 q11,d11,d6 -+ vmlal.s32 q11,d12,d5 -+ vmlal.s32 q11,d8,d1 -+ vmlal.s32 q11,d19,d0 -+ vmull.s32 q15,d10,d8 -+ vmlal.s32 q15,d11,d17 -+ vmlal.s32 q15,d12,d6 -+ vmlal.s32 q15,d13,d5 -+ vmlal.s32 q15,d19,d1 -+ vmlal.s32 q15,d14,d0 -+ vmull.s32 q2,d10,d9 -+ vmlal.s32 q2,d11,d8 -+ vmlal.s32 q2,d12,d7 -+ vmlal.s32 q2,d13,d6 -+ vmlal.s32 q2,d14,d1 -+ vmull.s32 q0,d15,d1 -+ vmlal.s32 q0,d10,d14 -+ vmlal.s32 q0,d11,d19 -+ vmlal.s32 q0,d12,d8 -+ vmlal.s32 q0,d13,d17 -+ vmlal.s32 q0,d6,d6 -+ add r2,sp,#512 -+ vld1.8 {d18-d19},[r2,: 128] -+ vmull.s32 q3,d16,d7 -+ vmlal.s32 q3,d10,d15 -+ vmlal.s32 q3,d11,d14 -+ vmlal.s32 q3,d12,d9 -+ vmlal.s32 q3,d13,d8 -+ add r2,sp,#528 -+ vld1.8 {d8-d9},[r2,: 128] -+ vadd.i64 q5,q12,q9 -+ vadd.i64 q6,q15,q9 -+ vshr.s64 q5,q5,#26 -+ vshr.s64 q6,q6,#26 -+ vadd.i64 q7,q10,q5 -+ vshl.i64 q5,q5,#26 -+ vadd.i64 q8,q7,q4 -+ vadd.i64 q2,q2,q6 -+ vshl.i64 q6,q6,#26 -+ vadd.i64 q10,q2,q4 -+ vsub.i64 q5,q12,q5 -+ vshr.s64 q8,q8,#25 -+ vsub.i64 q6,q15,q6 -+ vshr.s64 q10,q10,#25 -+ vadd.i64 q12,q13,q8 -+ vshl.i64 q8,q8,#25 -+ vadd.i64 q13,q12,q9 -+ vadd.i64 q0,q0,q10 -+ vsub.i64 q7,q7,q8 -+ vshr.s64 q8,q13,#26 -+ vshl.i64 q10,q10,#25 -+ vadd.i64 q13,q0,q9 -+ vadd.i64 q1,q1,q8 -+ vshl.i64 q8,q8,#26 -+ vadd.i64 q15,q1,q4 -+ vsub.i64 q2,q2,q10 -+ vshr.s64 q10,q13,#26 -+ vsub.i64 q8,q12,q8 -+ vshr.s64 q12,q15,#25 -+ vadd.i64 q3,q3,q10 -+ vshl.i64 q10,q10,#26 -+ vadd.i64 q13,q3,q4 -+ vadd.i64 q14,q14,q12 -+ add r2,r3,#144 -+ vshl.i64 q12,q12,#25 -+ add r4,r3,#192 -+ vadd.i64 q15,q14,q9 -+ add r2,r2,#8 -+ vsub.i64 q0,q0,q10 -+ add r4,r4,#8 -+ vshr.s64 q10,q13,#25 -+ vsub.i64 q1,q1,q12 -+ vshr.s64 q12,q15,#26 -+ vadd.i64 q13,q10,q10 -+ vadd.i64 q11,q11,q12 -+ vtrn.32 d16,d2 -+ vshl.i64 q12,q12,#26 -+ vtrn.32 d17,d3 -+ vadd.i64 q1,q11,q4 -+ vadd.i64 q4,q5,q13 -+ vst1.8 d16,[r2,: 64]! -+ vshl.i64 q5,q10,#4 -+ vst1.8 d17,[r4,: 64]! -+ vsub.i64 q8,q14,q12 -+ vshr.s64 q1,q1,#25 -+ vadd.i64 q4,q4,q5 -+ vadd.i64 q5,q6,q1 -+ vshl.i64 q1,q1,#25 -+ vadd.i64 q6,q5,q9 -+ vadd.i64 q4,q4,q10 -+ vshl.i64 q10,q10,#25 -+ vadd.i64 q9,q4,q9 -+ vsub.i64 q1,q11,q1 -+ vshr.s64 q6,q6,#26 -+ vsub.i64 q3,q3,q10 -+ vtrn.32 d16,d2 -+ vshr.s64 q9,q9,#26 -+ vtrn.32 d17,d3 -+ vadd.i64 q1,q2,q6 -+ vst1.8 d16,[r2,: 64] -+ vshl.i64 q2,q6,#26 -+ vst1.8 d17,[r4,: 64] -+ vadd.i64 q6,q7,q9 -+ vtrn.32 d0,d6 -+ vshl.i64 q7,q9,#26 -+ vtrn.32 d1,d7 -+ vsub.i64 q2,q5,q2 -+ add r2,r2,#16 -+ vsub.i64 q3,q4,q7 -+ vst1.8 d0,[r2,: 64] -+ add r4,r4,#16 -+ vst1.8 d1,[r4,: 64] -+ vtrn.32 d4,d2 -+ vtrn.32 d5,d3 -+ sub r2,r2,#8 -+ sub r4,r4,#8 -+ vtrn.32 d6,d12 -+ vtrn.32 d7,d13 -+ vst1.8 d4,[r2,: 64] -+ vst1.8 d5,[r4,: 64] -+ sub r2,r2,#24 -+ sub r4,r4,#24 -+ vst1.8 d6,[r2,: 64] -+ vst1.8 d7,[r4,: 64] -+ add r2,r3,#336 -+ add r4,r3,#288 -+ vld1.8 {d0-d1},[r2,: 128]! -+ vld1.8 {d2-d3},[r4,: 128]! -+ vadd.i32 q0,q0,q1 -+ vld1.8 {d2-d3},[r2,: 128]! -+ vld1.8 {d4-d5},[r4,: 128]! -+ vadd.i32 q1,q1,q2 -+ add r5,r3,#288 -+ vld1.8 {d4},[r2,: 64] -+ vld1.8 {d6},[r4,: 64] -+ vadd.i32 q2,q2,q3 -+ vst1.8 {d0-d1},[r5,: 128]! -+ vst1.8 {d2-d3},[r5,: 128]! -+ vst1.8 d4,[r5,: 64] -+ add r2,r3,#48 -+ add r4,r3,#144 -+ vld1.8 {d0-d1},[r4,: 128]! -+ vld1.8 {d2-d3},[r4,: 128]! -+ vld1.8 {d4},[r4,: 64] -+ add r4,r3,#288 -+ vld1.8 {d6-d7},[r4,: 128]! -+ vtrn.32 q0,q3 -+ vld1.8 {d8-d9},[r4,: 128]! -+ vshl.i32 q5,q0,#4 -+ vtrn.32 q1,q4 -+ vshl.i32 q6,q3,#4 -+ vadd.i32 q5,q5,q0 -+ vadd.i32 q6,q6,q3 -+ vshl.i32 q7,q1,#4 -+ vld1.8 {d5},[r4,: 64] -+ vshl.i32 q8,q4,#4 -+ vtrn.32 d4,d5 -+ vadd.i32 q7,q7,q1 -+ vadd.i32 q8,q8,q4 -+ vld1.8 {d18-d19},[r2,: 128]! -+ vshl.i32 q10,q2,#4 -+ vld1.8 {d22-d23},[r2,: 128]! -+ vadd.i32 q10,q10,q2 -+ vld1.8 {d24},[r2,: 64] -+ vadd.i32 q5,q5,q0 -+ add r2,r3,#240 -+ vld1.8 {d26-d27},[r2,: 128]! -+ vadd.i32 q6,q6,q3 -+ vld1.8 {d28-d29},[r2,: 128]! -+ vadd.i32 q8,q8,q4 -+ vld1.8 {d25},[r2,: 64] -+ vadd.i32 q10,q10,q2 -+ vtrn.32 q9,q13 -+ vadd.i32 q7,q7,q1 -+ vadd.i32 q5,q5,q0 -+ vtrn.32 q11,q14 -+ vadd.i32 q6,q6,q3 -+ add r2,sp,#560 -+ vadd.i32 q10,q10,q2 -+ vtrn.32 d24,d25 -+ vst1.8 {d12-d13},[r2,: 128] -+ vshl.i32 q6,q13,#1 -+ add r2,sp,#576 -+ vst1.8 {d20-d21},[r2,: 128] -+ vshl.i32 q10,q14,#1 -+ add r2,sp,#592 -+ vst1.8 {d12-d13},[r2,: 128] -+ vshl.i32 q15,q12,#1 -+ vadd.i32 q8,q8,q4 -+ vext.32 d10,d31,d30,#0 -+ vadd.i32 q7,q7,q1 -+ add r2,sp,#608 -+ vst1.8 {d16-d17},[r2,: 128] -+ vmull.s32 q8,d18,d5 -+ vmlal.s32 q8,d26,d4 -+ vmlal.s32 q8,d19,d9 -+ vmlal.s32 q8,d27,d3 -+ vmlal.s32 q8,d22,d8 -+ vmlal.s32 q8,d28,d2 -+ vmlal.s32 q8,d23,d7 -+ vmlal.s32 q8,d29,d1 -+ vmlal.s32 q8,d24,d6 -+ vmlal.s32 q8,d25,d0 -+ add r2,sp,#624 -+ vst1.8 {d14-d15},[r2,: 128] -+ vmull.s32 q2,d18,d4 -+ vmlal.s32 q2,d12,d9 -+ vmlal.s32 q2,d13,d8 -+ vmlal.s32 q2,d19,d3 -+ vmlal.s32 q2,d22,d2 -+ vmlal.s32 q2,d23,d1 -+ vmlal.s32 q2,d24,d0 -+ add r2,sp,#640 -+ vst1.8 {d20-d21},[r2,: 128] -+ vmull.s32 q7,d18,d9 -+ vmlal.s32 q7,d26,d3 -+ vmlal.s32 q7,d19,d8 -+ vmlal.s32 q7,d27,d2 -+ vmlal.s32 q7,d22,d7 -+ vmlal.s32 q7,d28,d1 -+ vmlal.s32 q7,d23,d6 -+ vmlal.s32 q7,d29,d0 -+ add r2,sp,#656 -+ vst1.8 {d10-d11},[r2,: 128] -+ vmull.s32 q5,d18,d3 -+ vmlal.s32 q5,d19,d2 -+ vmlal.s32 q5,d22,d1 -+ vmlal.s32 q5,d23,d0 -+ vmlal.s32 q5,d12,d8 -+ add r2,sp,#672 -+ vst1.8 {d16-d17},[r2,: 128] -+ vmull.s32 q4,d18,d8 -+ vmlal.s32 q4,d26,d2 -+ vmlal.s32 q4,d19,d7 -+ vmlal.s32 q4,d27,d1 -+ vmlal.s32 q4,d22,d6 -+ vmlal.s32 q4,d28,d0 -+ vmull.s32 q8,d18,d7 -+ vmlal.s32 q8,d26,d1 -+ vmlal.s32 q8,d19,d6 -+ vmlal.s32 q8,d27,d0 -+ add r2,sp,#576 -+ vld1.8 {d20-d21},[r2,: 128] -+ vmlal.s32 q7,d24,d21 -+ vmlal.s32 q7,d25,d20 -+ vmlal.s32 q4,d23,d21 -+ vmlal.s32 q4,d29,d20 -+ vmlal.s32 q8,d22,d21 -+ vmlal.s32 q8,d28,d20 -+ vmlal.s32 q5,d24,d20 -+ add r2,sp,#576 -+ vst1.8 {d14-d15},[r2,: 128] -+ vmull.s32 q7,d18,d6 -+ vmlal.s32 q7,d26,d0 -+ add r2,sp,#656 -+ vld1.8 {d30-d31},[r2,: 128] -+ vmlal.s32 q2,d30,d21 -+ vmlal.s32 q7,d19,d21 -+ vmlal.s32 q7,d27,d20 -+ add r2,sp,#624 -+ vld1.8 {d26-d27},[r2,: 128] -+ vmlal.s32 q4,d25,d27 -+ vmlal.s32 q8,d29,d27 -+ vmlal.s32 q8,d25,d26 -+ vmlal.s32 q7,d28,d27 -+ vmlal.s32 q7,d29,d26 -+ add r2,sp,#608 -+ vld1.8 {d28-d29},[r2,: 128] -+ vmlal.s32 q4,d24,d29 -+ vmlal.s32 q8,d23,d29 -+ vmlal.s32 q8,d24,d28 -+ vmlal.s32 q7,d22,d29 -+ vmlal.s32 q7,d23,d28 -+ add r2,sp,#608 -+ vst1.8 {d8-d9},[r2,: 128] -+ add r2,sp,#560 -+ vld1.8 {d8-d9},[r2,: 128] -+ vmlal.s32 q7,d24,d9 -+ vmlal.s32 q7,d25,d31 -+ vmull.s32 q1,d18,d2 -+ vmlal.s32 q1,d19,d1 -+ vmlal.s32 q1,d22,d0 -+ vmlal.s32 q1,d24,d27 -+ vmlal.s32 q1,d23,d20 -+ vmlal.s32 q1,d12,d7 -+ vmlal.s32 q1,d13,d6 -+ vmull.s32 q6,d18,d1 -+ vmlal.s32 q6,d19,d0 -+ vmlal.s32 q6,d23,d27 -+ vmlal.s32 q6,d22,d20 -+ vmlal.s32 q6,d24,d26 -+ vmull.s32 q0,d18,d0 -+ vmlal.s32 q0,d22,d27 -+ vmlal.s32 q0,d23,d26 -+ vmlal.s32 q0,d24,d31 -+ vmlal.s32 q0,d19,d20 -+ add r2,sp,#640 -+ vld1.8 {d18-d19},[r2,: 128] -+ vmlal.s32 q2,d18,d7 -+ vmlal.s32 q2,d19,d6 -+ vmlal.s32 q5,d18,d6 -+ vmlal.s32 q5,d19,d21 -+ vmlal.s32 q1,d18,d21 -+ vmlal.s32 q1,d19,d29 -+ vmlal.s32 q0,d18,d28 -+ vmlal.s32 q0,d19,d9 -+ vmlal.s32 q6,d18,d29 -+ vmlal.s32 q6,d19,d28 -+ add r2,sp,#592 -+ vld1.8 {d18-d19},[r2,: 128] -+ add r2,sp,#512 -+ vld1.8 {d22-d23},[r2,: 128] -+ vmlal.s32 q5,d19,d7 -+ vmlal.s32 q0,d18,d21 -+ vmlal.s32 q0,d19,d29 -+ vmlal.s32 q6,d18,d6 -+ add r2,sp,#528 -+ vld1.8 {d6-d7},[r2,: 128] -+ vmlal.s32 q6,d19,d21 -+ add r2,sp,#576 -+ vld1.8 {d18-d19},[r2,: 128] -+ vmlal.s32 q0,d30,d8 -+ add r2,sp,#672 -+ vld1.8 {d20-d21},[r2,: 128] -+ vmlal.s32 q5,d30,d29 -+ add r2,sp,#608 -+ vld1.8 {d24-d25},[r2,: 128] -+ vmlal.s32 q1,d30,d28 -+ vadd.i64 q13,q0,q11 -+ vadd.i64 q14,q5,q11 -+ vmlal.s32 q6,d30,d9 -+ vshr.s64 q4,q13,#26 -+ vshr.s64 q13,q14,#26 -+ vadd.i64 q7,q7,q4 -+ vshl.i64 q4,q4,#26 -+ vadd.i64 q14,q7,q3 -+ vadd.i64 q9,q9,q13 -+ vshl.i64 q13,q13,#26 -+ vadd.i64 q15,q9,q3 -+ vsub.i64 q0,q0,q4 -+ vshr.s64 q4,q14,#25 -+ vsub.i64 q5,q5,q13 -+ vshr.s64 q13,q15,#25 -+ vadd.i64 q6,q6,q4 -+ vshl.i64 q4,q4,#25 -+ vadd.i64 q14,q6,q11 -+ vadd.i64 q2,q2,q13 -+ vsub.i64 q4,q7,q4 -+ vshr.s64 q7,q14,#26 -+ vshl.i64 q13,q13,#25 -+ vadd.i64 q14,q2,q11 -+ vadd.i64 q8,q8,q7 -+ vshl.i64 q7,q7,#26 -+ vadd.i64 q15,q8,q3 -+ vsub.i64 q9,q9,q13 -+ vshr.s64 q13,q14,#26 -+ vsub.i64 q6,q6,q7 -+ vshr.s64 q7,q15,#25 -+ vadd.i64 q10,q10,q13 -+ vshl.i64 q13,q13,#26 -+ vadd.i64 q14,q10,q3 -+ vadd.i64 q1,q1,q7 -+ add r2,r3,#240 -+ vshl.i64 q7,q7,#25 -+ add r4,r3,#144 -+ vadd.i64 q15,q1,q11 -+ add r2,r2,#8 -+ vsub.i64 q2,q2,q13 -+ add r4,r4,#8 -+ vshr.s64 q13,q14,#25 -+ vsub.i64 q7,q8,q7 -+ vshr.s64 q8,q15,#26 -+ vadd.i64 q14,q13,q13 -+ vadd.i64 q12,q12,q8 -+ vtrn.32 d12,d14 -+ vshl.i64 q8,q8,#26 -+ vtrn.32 d13,d15 -+ vadd.i64 q3,q12,q3 -+ vadd.i64 q0,q0,q14 -+ vst1.8 d12,[r2,: 64]! -+ vshl.i64 q7,q13,#4 -+ vst1.8 d13,[r4,: 64]! -+ vsub.i64 q1,q1,q8 -+ vshr.s64 q3,q3,#25 -+ vadd.i64 q0,q0,q7 -+ vadd.i64 q5,q5,q3 -+ vshl.i64 q3,q3,#25 -+ vadd.i64 q6,q5,q11 -+ vadd.i64 q0,q0,q13 -+ vshl.i64 q7,q13,#25 -+ vadd.i64 q8,q0,q11 -+ vsub.i64 q3,q12,q3 -+ vshr.s64 q6,q6,#26 -+ vsub.i64 q7,q10,q7 -+ vtrn.32 d2,d6 -+ vshr.s64 q8,q8,#26 -+ vtrn.32 d3,d7 -+ vadd.i64 q3,q9,q6 -+ vst1.8 d2,[r2,: 64] -+ vshl.i64 q6,q6,#26 -+ vst1.8 d3,[r4,: 64] -+ vadd.i64 q1,q4,q8 -+ vtrn.32 d4,d14 -+ vshl.i64 q4,q8,#26 -+ vtrn.32 d5,d15 -+ vsub.i64 q5,q5,q6 -+ add r2,r2,#16 -+ vsub.i64 q0,q0,q4 -+ vst1.8 d4,[r2,: 64] -+ add r4,r4,#16 -+ vst1.8 d5,[r4,: 64] -+ vtrn.32 d10,d6 -+ vtrn.32 d11,d7 -+ sub r2,r2,#8 -+ sub r4,r4,#8 -+ vtrn.32 d0,d2 -+ vtrn.32 d1,d3 -+ vst1.8 d10,[r2,: 64] -+ vst1.8 d11,[r4,: 64] -+ sub r2,r2,#24 -+ sub r4,r4,#24 -+ vst1.8 d0,[r2,: 64] -+ vst1.8 d1,[r4,: 64] -+ ldr r2,[sp,#488] -+ ldr r4,[sp,#492] -+ subs r5,r2,#1 -+ bge .Lmainloop -+ add r1,r3,#144 -+ add r2,r3,#336 -+ vld1.8 {d0-d1},[r1,: 128]! -+ vld1.8 {d2-d3},[r1,: 128]! -+ vld1.8 {d4},[r1,: 64] -+ vst1.8 {d0-d1},[r2,: 128]! -+ vst1.8 {d2-d3},[r2,: 128]! -+ vst1.8 d4,[r2,: 64] -+ ldr r1,=0 -+ .Linvertloop: -+ add r2,r3,#144 -+ ldr r4,=0 -+ ldr r5,=2 -+ cmp r1,#1 -+ ldreq r5,=1 -+ addeq r2,r3,#336 -+ addeq r4,r3,#48 -+ cmp r1,#2 -+ ldreq r5,=1 -+ addeq r2,r3,#48 -+ cmp r1,#3 -+ ldreq r5,=5 -+ addeq r4,r3,#336 -+ cmp r1,#4 -+ ldreq r5,=10 -+ cmp r1,#5 -+ ldreq r5,=20 -+ cmp r1,#6 -+ ldreq r5,=10 -+ addeq r2,r3,#336 -+ addeq r4,r3,#336 -+ cmp r1,#7 -+ ldreq r5,=50 -+ cmp r1,#8 -+ ldreq r5,=100 -+ cmp r1,#9 -+ ldreq r5,=50 -+ addeq r2,r3,#336 -+ cmp r1,#10 -+ ldreq r5,=5 -+ addeq r2,r3,#48 -+ cmp r1,#11 -+ ldreq r5,=0 -+ addeq r2,r3,#96 -+ add r6,r3,#144 -+ add r7,r3,#288 -+ vld1.8 {d0-d1},[r6,: 128]! -+ vld1.8 {d2-d3},[r6,: 128]! -+ vld1.8 {d4},[r6,: 64] -+ vst1.8 {d0-d1},[r7,: 128]! -+ vst1.8 {d2-d3},[r7,: 128]! -+ vst1.8 d4,[r7,: 64] -+ cmp r5,#0 -+ beq .Lskipsquaringloop -+ .Lsquaringloop: -+ add r6,r3,#288 -+ add r7,r3,#288 -+ add r8,r3,#288 -+ vmov.i32 q0,#19 -+ vmov.i32 q1,#0 -+ vmov.i32 q2,#1 -+ vzip.i32 q1,q2 -+ vld1.8 {d4-d5},[r7,: 128]! -+ vld1.8 {d6-d7},[r7,: 128]! -+ vld1.8 {d9},[r7,: 64] -+ vld1.8 {d10-d11},[r6,: 128]! -+ add r7,sp,#416 -+ vld1.8 {d12-d13},[r6,: 128]! -+ vmul.i32 q7,q2,q0 -+ vld1.8 {d8},[r6,: 64] -+ vext.32 d17,d11,d10,#1 -+ vmul.i32 q9,q3,q0 -+ vext.32 d16,d10,d8,#1 -+ vshl.u32 q10,q5,q1 -+ vext.32 d22,d14,d4,#1 -+ vext.32 d24,d18,d6,#1 -+ vshl.u32 q13,q6,q1 -+ vshl.u32 d28,d8,d2 -+ vrev64.i32 d22,d22 -+ vmul.i32 d1,d9,d1 -+ vrev64.i32 d24,d24 -+ vext.32 d29,d8,d13,#1 -+ vext.32 d0,d1,d9,#1 -+ vrev64.i32 d0,d0 -+ vext.32 d2,d9,d1,#1 -+ vext.32 d23,d15,d5,#1 -+ vmull.s32 q4,d20,d4 -+ vrev64.i32 d23,d23 -+ vmlal.s32 q4,d21,d1 -+ vrev64.i32 d2,d2 -+ vmlal.s32 q4,d26,d19 -+ vext.32 d3,d5,d15,#1 -+ vmlal.s32 q4,d27,d18 -+ vrev64.i32 d3,d3 -+ vmlal.s32 q4,d28,d15 -+ vext.32 d14,d12,d11,#1 -+ vmull.s32 q5,d16,d23 -+ vext.32 d15,d13,d12,#1 -+ vmlal.s32 q5,d17,d4 -+ vst1.8 d8,[r7,: 64]! -+ vmlal.s32 q5,d14,d1 -+ vext.32 d12,d9,d8,#0 -+ vmlal.s32 q5,d15,d19 -+ vmov.i64 d13,#0 -+ vmlal.s32 q5,d29,d18 -+ vext.32 d25,d19,d7,#1 -+ vmlal.s32 q6,d20,d5 -+ vrev64.i32 d25,d25 -+ vmlal.s32 q6,d21,d4 -+ vst1.8 d11,[r7,: 64]! -+ vmlal.s32 q6,d26,d1 -+ vext.32 d9,d10,d10,#0 -+ vmlal.s32 q6,d27,d19 -+ vmov.i64 d8,#0 -+ vmlal.s32 q6,d28,d18 -+ vmlal.s32 q4,d16,d24 -+ vmlal.s32 q4,d17,d5 -+ vmlal.s32 q4,d14,d4 -+ vst1.8 d12,[r7,: 64]! -+ vmlal.s32 q4,d15,d1 -+ vext.32 d10,d13,d12,#0 -+ vmlal.s32 q4,d29,d19 -+ vmov.i64 d11,#0 -+ vmlal.s32 q5,d20,d6 -+ vmlal.s32 q5,d21,d5 -+ vmlal.s32 q5,d26,d4 -+ vext.32 d13,d8,d8,#0 -+ vmlal.s32 q5,d27,d1 -+ vmov.i64 d12,#0 -+ vmlal.s32 q5,d28,d19 -+ vst1.8 d9,[r7,: 64]! -+ vmlal.s32 q6,d16,d25 -+ vmlal.s32 q6,d17,d6 -+ vst1.8 d10,[r7,: 64] -+ vmlal.s32 q6,d14,d5 -+ vext.32 d8,d11,d10,#0 -+ vmlal.s32 q6,d15,d4 -+ vmov.i64 d9,#0 -+ vmlal.s32 q6,d29,d1 -+ vmlal.s32 q4,d20,d7 -+ vmlal.s32 q4,d21,d6 -+ vmlal.s32 q4,d26,d5 -+ vext.32 d11,d12,d12,#0 -+ vmlal.s32 q4,d27,d4 -+ vmov.i64 d10,#0 -+ vmlal.s32 q4,d28,d1 -+ vmlal.s32 q5,d16,d0 -+ sub r6,r7,#32 -+ vmlal.s32 q5,d17,d7 -+ vmlal.s32 q5,d14,d6 -+ vext.32 d30,d9,d8,#0 -+ vmlal.s32 q5,d15,d5 -+ vld1.8 {d31},[r6,: 64]! -+ vmlal.s32 q5,d29,d4 -+ vmlal.s32 q15,d20,d0 -+ vext.32 d0,d6,d18,#1 -+ vmlal.s32 q15,d21,d25 -+ vrev64.i32 d0,d0 -+ vmlal.s32 q15,d26,d24 -+ vext.32 d1,d7,d19,#1 -+ vext.32 d7,d10,d10,#0 -+ vmlal.s32 q15,d27,d23 -+ vrev64.i32 d1,d1 -+ vld1.8 {d6},[r6,: 64] -+ vmlal.s32 q15,d28,d22 -+ vmlal.s32 q3,d16,d4 -+ add r6,r6,#24 -+ vmlal.s32 q3,d17,d2 -+ vext.32 d4,d31,d30,#0 -+ vmov d17,d11 -+ vmlal.s32 q3,d14,d1 -+ vext.32 d11,d13,d13,#0 -+ vext.32 d13,d30,d30,#0 -+ vmlal.s32 q3,d15,d0 -+ vext.32 d1,d8,d8,#0 -+ vmlal.s32 q3,d29,d3 -+ vld1.8 {d5},[r6,: 64] -+ sub r6,r6,#16 -+ vext.32 d10,d6,d6,#0 -+ vmov.i32 q1,#0xffffffff -+ vshl.i64 q4,q1,#25 -+ add r7,sp,#512 -+ vld1.8 {d14-d15},[r7,: 128] -+ vadd.i64 q9,q2,q7 -+ vshl.i64 q1,q1,#26 -+ vshr.s64 q10,q9,#26 -+ vld1.8 {d0},[r6,: 64]! -+ vadd.i64 q5,q5,q10 -+ vand q9,q9,q1 -+ vld1.8 {d16},[r6,: 64]! -+ add r6,sp,#528 -+ vld1.8 {d20-d21},[r6,: 128] -+ vadd.i64 q11,q5,q10 -+ vsub.i64 q2,q2,q9 -+ vshr.s64 q9,q11,#25 -+ vext.32 d12,d5,d4,#0 -+ vand q11,q11,q4 -+ vadd.i64 q0,q0,q9 -+ vmov d19,d7 -+ vadd.i64 q3,q0,q7 -+ vsub.i64 q5,q5,q11 -+ vshr.s64 q11,q3,#26 -+ vext.32 d18,d11,d10,#0 -+ vand q3,q3,q1 -+ vadd.i64 q8,q8,q11 -+ vadd.i64 q11,q8,q10 -+ vsub.i64 q0,q0,q3 -+ vshr.s64 q3,q11,#25 -+ vand q11,q11,q4 -+ vadd.i64 q3,q6,q3 -+ vadd.i64 q6,q3,q7 -+ vsub.i64 q8,q8,q11 -+ vshr.s64 q11,q6,#26 -+ vand q6,q6,q1 -+ vadd.i64 q9,q9,q11 -+ vadd.i64 d25,d19,d21 -+ vsub.i64 q3,q3,q6 -+ vshr.s64 d23,d25,#25 -+ vand q4,q12,q4 -+ vadd.i64 d21,d23,d23 -+ vshl.i64 d25,d23,#4 -+ vadd.i64 d21,d21,d23 -+ vadd.i64 d25,d25,d21 -+ vadd.i64 d4,d4,d25 -+ vzip.i32 q0,q8 -+ vadd.i64 d12,d4,d14 -+ add r6,r8,#8 -+ vst1.8 d0,[r6,: 64] -+ vsub.i64 d19,d19,d9 -+ add r6,r6,#16 -+ vst1.8 d16,[r6,: 64] -+ vshr.s64 d22,d12,#26 -+ vand q0,q6,q1 -+ vadd.i64 d10,d10,d22 -+ vzip.i32 q3,q9 -+ vsub.i64 d4,d4,d0 -+ sub r6,r6,#8 -+ vst1.8 d6,[r6,: 64] -+ add r6,r6,#16 -+ vst1.8 d18,[r6,: 64] -+ vzip.i32 q2,q5 -+ sub r6,r6,#32 -+ vst1.8 d4,[r6,: 64] -+ subs r5,r5,#1 -+ bhi .Lsquaringloop -+ .Lskipsquaringloop: -+ mov r2,r2 -+ add r5,r3,#288 -+ add r6,r3,#144 -+ vmov.i32 q0,#19 -+ vmov.i32 q1,#0 -+ vmov.i32 q2,#1 -+ vzip.i32 q1,q2 -+ vld1.8 {d4-d5},[r5,: 128]! -+ vld1.8 {d6-d7},[r5,: 128]! -+ vld1.8 {d9},[r5,: 64] -+ vld1.8 {d10-d11},[r2,: 128]! -+ add r5,sp,#416 -+ vld1.8 {d12-d13},[r2,: 128]! -+ vmul.i32 q7,q2,q0 -+ vld1.8 {d8},[r2,: 64] -+ vext.32 d17,d11,d10,#1 -+ vmul.i32 q9,q3,q0 -+ vext.32 d16,d10,d8,#1 -+ vshl.u32 q10,q5,q1 -+ vext.32 d22,d14,d4,#1 -+ vext.32 d24,d18,d6,#1 -+ vshl.u32 q13,q6,q1 -+ vshl.u32 d28,d8,d2 -+ vrev64.i32 d22,d22 -+ vmul.i32 d1,d9,d1 -+ vrev64.i32 d24,d24 -+ vext.32 d29,d8,d13,#1 -+ vext.32 d0,d1,d9,#1 -+ vrev64.i32 d0,d0 -+ vext.32 d2,d9,d1,#1 -+ vext.32 d23,d15,d5,#1 -+ vmull.s32 q4,d20,d4 -+ vrev64.i32 d23,d23 -+ vmlal.s32 q4,d21,d1 -+ vrev64.i32 d2,d2 -+ vmlal.s32 q4,d26,d19 -+ vext.32 d3,d5,d15,#1 -+ vmlal.s32 q4,d27,d18 -+ vrev64.i32 d3,d3 -+ vmlal.s32 q4,d28,d15 -+ vext.32 d14,d12,d11,#1 -+ vmull.s32 q5,d16,d23 -+ vext.32 d15,d13,d12,#1 -+ vmlal.s32 q5,d17,d4 -+ vst1.8 d8,[r5,: 64]! -+ vmlal.s32 q5,d14,d1 -+ vext.32 d12,d9,d8,#0 -+ vmlal.s32 q5,d15,d19 -+ vmov.i64 d13,#0 -+ vmlal.s32 q5,d29,d18 -+ vext.32 d25,d19,d7,#1 -+ vmlal.s32 q6,d20,d5 -+ vrev64.i32 d25,d25 -+ vmlal.s32 q6,d21,d4 -+ vst1.8 d11,[r5,: 64]! -+ vmlal.s32 q6,d26,d1 -+ vext.32 d9,d10,d10,#0 -+ vmlal.s32 q6,d27,d19 -+ vmov.i64 d8,#0 -+ vmlal.s32 q6,d28,d18 -+ vmlal.s32 q4,d16,d24 -+ vmlal.s32 q4,d17,d5 -+ vmlal.s32 q4,d14,d4 -+ vst1.8 d12,[r5,: 64]! -+ vmlal.s32 q4,d15,d1 -+ vext.32 d10,d13,d12,#0 -+ vmlal.s32 q4,d29,d19 -+ vmov.i64 d11,#0 -+ vmlal.s32 q5,d20,d6 -+ vmlal.s32 q5,d21,d5 -+ vmlal.s32 q5,d26,d4 -+ vext.32 d13,d8,d8,#0 -+ vmlal.s32 q5,d27,d1 -+ vmov.i64 d12,#0 -+ vmlal.s32 q5,d28,d19 -+ vst1.8 d9,[r5,: 64]! -+ vmlal.s32 q6,d16,d25 -+ vmlal.s32 q6,d17,d6 -+ vst1.8 d10,[r5,: 64] -+ vmlal.s32 q6,d14,d5 -+ vext.32 d8,d11,d10,#0 -+ vmlal.s32 q6,d15,d4 -+ vmov.i64 d9,#0 -+ vmlal.s32 q6,d29,d1 -+ vmlal.s32 q4,d20,d7 -+ vmlal.s32 q4,d21,d6 -+ vmlal.s32 q4,d26,d5 -+ vext.32 d11,d12,d12,#0 -+ vmlal.s32 q4,d27,d4 -+ vmov.i64 d10,#0 -+ vmlal.s32 q4,d28,d1 -+ vmlal.s32 q5,d16,d0 -+ sub r2,r5,#32 -+ vmlal.s32 q5,d17,d7 -+ vmlal.s32 q5,d14,d6 -+ vext.32 d30,d9,d8,#0 -+ vmlal.s32 q5,d15,d5 -+ vld1.8 {d31},[r2,: 64]! -+ vmlal.s32 q5,d29,d4 -+ vmlal.s32 q15,d20,d0 -+ vext.32 d0,d6,d18,#1 -+ vmlal.s32 q15,d21,d25 -+ vrev64.i32 d0,d0 -+ vmlal.s32 q15,d26,d24 -+ vext.32 d1,d7,d19,#1 -+ vext.32 d7,d10,d10,#0 -+ vmlal.s32 q15,d27,d23 -+ vrev64.i32 d1,d1 -+ vld1.8 {d6},[r2,: 64] -+ vmlal.s32 q15,d28,d22 -+ vmlal.s32 q3,d16,d4 -+ add r2,r2,#24 -+ vmlal.s32 q3,d17,d2 -+ vext.32 d4,d31,d30,#0 -+ vmov d17,d11 -+ vmlal.s32 q3,d14,d1 -+ vext.32 d11,d13,d13,#0 -+ vext.32 d13,d30,d30,#0 -+ vmlal.s32 q3,d15,d0 -+ vext.32 d1,d8,d8,#0 -+ vmlal.s32 q3,d29,d3 -+ vld1.8 {d5},[r2,: 64] -+ sub r2,r2,#16 -+ vext.32 d10,d6,d6,#0 -+ vmov.i32 q1,#0xffffffff -+ vshl.i64 q4,q1,#25 -+ add r5,sp,#512 -+ vld1.8 {d14-d15},[r5,: 128] -+ vadd.i64 q9,q2,q7 -+ vshl.i64 q1,q1,#26 -+ vshr.s64 q10,q9,#26 -+ vld1.8 {d0},[r2,: 64]! -+ vadd.i64 q5,q5,q10 -+ vand q9,q9,q1 -+ vld1.8 {d16},[r2,: 64]! -+ add r2,sp,#528 -+ vld1.8 {d20-d21},[r2,: 128] -+ vadd.i64 q11,q5,q10 -+ vsub.i64 q2,q2,q9 -+ vshr.s64 q9,q11,#25 -+ vext.32 d12,d5,d4,#0 -+ vand q11,q11,q4 -+ vadd.i64 q0,q0,q9 -+ vmov d19,d7 -+ vadd.i64 q3,q0,q7 -+ vsub.i64 q5,q5,q11 -+ vshr.s64 q11,q3,#26 -+ vext.32 d18,d11,d10,#0 -+ vand q3,q3,q1 -+ vadd.i64 q8,q8,q11 -+ vadd.i64 q11,q8,q10 -+ vsub.i64 q0,q0,q3 -+ vshr.s64 q3,q11,#25 -+ vand q11,q11,q4 -+ vadd.i64 q3,q6,q3 -+ vadd.i64 q6,q3,q7 -+ vsub.i64 q8,q8,q11 -+ vshr.s64 q11,q6,#26 -+ vand q6,q6,q1 -+ vadd.i64 q9,q9,q11 -+ vadd.i64 d25,d19,d21 -+ vsub.i64 q3,q3,q6 -+ vshr.s64 d23,d25,#25 -+ vand q4,q12,q4 -+ vadd.i64 d21,d23,d23 -+ vshl.i64 d25,d23,#4 -+ vadd.i64 d21,d21,d23 -+ vadd.i64 d25,d25,d21 -+ vadd.i64 d4,d4,d25 -+ vzip.i32 q0,q8 -+ vadd.i64 d12,d4,d14 -+ add r2,r6,#8 -+ vst1.8 d0,[r2,: 64] -+ vsub.i64 d19,d19,d9 -+ add r2,r2,#16 -+ vst1.8 d16,[r2,: 64] -+ vshr.s64 d22,d12,#26 -+ vand q0,q6,q1 -+ vadd.i64 d10,d10,d22 -+ vzip.i32 q3,q9 -+ vsub.i64 d4,d4,d0 -+ sub r2,r2,#8 -+ vst1.8 d6,[r2,: 64] -+ add r2,r2,#16 -+ vst1.8 d18,[r2,: 64] -+ vzip.i32 q2,q5 -+ sub r2,r2,#32 -+ vst1.8 d4,[r2,: 64] -+ cmp r4,#0 -+ beq .Lskippostcopy -+ add r2,r3,#144 -+ mov r4,r4 -+ vld1.8 {d0-d1},[r2,: 128]! -+ vld1.8 {d2-d3},[r2,: 128]! -+ vld1.8 {d4},[r2,: 64] -+ vst1.8 {d0-d1},[r4,: 128]! -+ vst1.8 {d2-d3},[r4,: 128]! -+ vst1.8 d4,[r4,: 64] -+ .Lskippostcopy: -+ cmp r1,#1 -+ bne .Lskipfinalcopy -+ add r2,r3,#288 -+ add r4,r3,#144 -+ vld1.8 {d0-d1},[r2,: 128]! -+ vld1.8 {d2-d3},[r2,: 128]! -+ vld1.8 {d4},[r2,: 64] -+ vst1.8 {d0-d1},[r4,: 128]! -+ vst1.8 {d2-d3},[r4,: 128]! -+ vst1.8 d4,[r4,: 64] -+ .Lskipfinalcopy: -+ add r1,r1,#1 -+ cmp r1,#12 -+ blo .Linvertloop -+ add r1,r3,#144 -+ ldr r2,[r1],#4 -+ ldr r3,[r1],#4 -+ ldr r4,[r1],#4 -+ ldr r5,[r1],#4 -+ ldr r6,[r1],#4 -+ ldr r7,[r1],#4 -+ ldr r8,[r1],#4 -+ ldr r9,[r1],#4 -+ ldr r10,[r1],#4 -+ ldr r1,[r1] -+ add r11,r1,r1,LSL #4 -+ add r11,r11,r1,LSL #1 -+ add r11,r11,#16777216 -+ mov r11,r11,ASR #25 -+ add r11,r11,r2 -+ mov r11,r11,ASR #26 -+ add r11,r11,r3 -+ mov r11,r11,ASR #25 -+ add r11,r11,r4 -+ mov r11,r11,ASR #26 -+ add r11,r11,r5 -+ mov r11,r11,ASR #25 -+ add r11,r11,r6 -+ mov r11,r11,ASR #26 -+ add r11,r11,r7 -+ mov r11,r11,ASR #25 -+ add r11,r11,r8 -+ mov r11,r11,ASR #26 -+ add r11,r11,r9 -+ mov r11,r11,ASR #25 -+ add r11,r11,r10 -+ mov r11,r11,ASR #26 -+ add r11,r11,r1 -+ mov r11,r11,ASR #25 -+ add r2,r2,r11 -+ add r2,r2,r11,LSL #1 -+ add r2,r2,r11,LSL #4 -+ mov r11,r2,ASR #26 -+ add r3,r3,r11 -+ sub r2,r2,r11,LSL #26 -+ mov r11,r3,ASR #25 -+ add r4,r4,r11 -+ sub r3,r3,r11,LSL #25 -+ mov r11,r4,ASR #26 -+ add r5,r5,r11 -+ sub r4,r4,r11,LSL #26 -+ mov r11,r5,ASR #25 -+ add r6,r6,r11 -+ sub r5,r5,r11,LSL #25 -+ mov r11,r6,ASR #26 -+ add r7,r7,r11 -+ sub r6,r6,r11,LSL #26 -+ mov r11,r7,ASR #25 -+ add r8,r8,r11 -+ sub r7,r7,r11,LSL #25 -+ mov r11,r8,ASR #26 -+ add r9,r9,r11 -+ sub r8,r8,r11,LSL #26 -+ mov r11,r9,ASR #25 -+ add r10,r10,r11 -+ sub r9,r9,r11,LSL #25 -+ mov r11,r10,ASR #26 -+ add r1,r1,r11 -+ sub r10,r10,r11,LSL #26 -+ mov r11,r1,ASR #25 -+ sub r1,r1,r11,LSL #25 -+ add r2,r2,r3,LSL #26 -+ mov r3,r3,LSR #6 -+ add r3,r3,r4,LSL #19 -+ mov r4,r4,LSR #13 -+ add r4,r4,r5,LSL #13 -+ mov r5,r5,LSR #19 -+ add r5,r5,r6,LSL #6 -+ add r6,r7,r8,LSL #25 -+ mov r7,r8,LSR #7 -+ add r7,r7,r9,LSL #19 -+ mov r8,r9,LSR #13 -+ add r8,r8,r10,LSL #12 -+ mov r9,r10,LSR #20 -+ add r1,r9,r1,LSL #6 -+ str r2,[r0],#4 -+ str r3,[r0],#4 -+ str r4,[r0],#4 -+ str r5,[r0],#4 -+ str r6,[r0],#4 -+ str r7,[r0],#4 -+ str r8,[r0],#4 -+ str r1,[r0] -+ ldrd r4,[sp,#0] -+ ldrd r6,[sp,#8] -+ ldrd r8,[sp,#16] -+ ldrd r10,[sp,#24] -+ ldr r12,[sp,#480] -+ ldr r14,[sp,#484] -+ ldr r0,=0 -+ mov sp,r12 -+ vpop {q4,q5,q6,q7} -+ bx lr -+ENDPROC(curve25519_neon) -+#endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/curve25519-x86_64.S 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,3261 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * -+ * Based on algorithms from Tung Chou -+ */ -+ -+#include -+ -+.data -+.align 16 -+curve25519_sandy2x_v0_0: .quad 0, 0 -+curve25519_sandy2x_v1_0: .quad 1, 0 -+curve25519_sandy2x_v2_1: .quad 2, 1 -+curve25519_sandy2x_v9_0: .quad 9, 0 -+curve25519_sandy2x_v9_9: .quad 9, 9 -+curve25519_sandy2x_v19_19: .quad 19, 19 -+curve25519_sandy2x_v38_1: .quad 38, 1 -+curve25519_sandy2x_v38_38: .quad 38, 38 -+curve25519_sandy2x_v121666_121666: .quad 121666, 121666 -+curve25519_sandy2x_m25: .quad 33554431, 33554431 -+curve25519_sandy2x_m26: .quad 67108863, 67108863 -+curve25519_sandy2x_subc0: .quad 0x07FFFFDA, 0x03FFFFFE -+curve25519_sandy2x_subc2: .quad 0x07FFFFFE, 0x03FFFFFE -+curve25519_sandy2x_REDMASK51: .quad 0x0007FFFFFFFFFFFF -+ -+.text -+.align 32 -+#ifdef CONFIG_AS_AVX -+ENTRY(curve25519_sandy2x_fe51_mul) -+ push %rbp -+ mov %rsp,%rbp -+ sub $96,%rsp -+ and $-32,%rsp -+ movq %r11,0(%rsp) -+ movq %r12,8(%rsp) -+ movq %r13,16(%rsp) -+ movq %r14,24(%rsp) -+ movq %r15,32(%rsp) -+ movq %rbx,40(%rsp) -+ movq %rbp,48(%rsp) -+ movq %rdi,56(%rsp) -+ mov %rdx,%rcx -+ movq 24(%rsi),%rdx -+ imulq $19,%rdx,%rax -+ movq %rax,64(%rsp) -+ mulq 16(%rcx) -+ mov %rax,%r8 -+ mov %rdx,%r9 -+ movq 32(%rsi),%rdx -+ imulq $19,%rdx,%rax -+ movq %rax,72(%rsp) -+ mulq 8(%rcx) -+ add %rax,%r8 -+ adc %rdx,%r9 -+ movq 0(%rsi),%rax -+ mulq 0(%rcx) -+ add %rax,%r8 -+ adc %rdx,%r9 -+ movq 0(%rsi),%rax -+ mulq 8(%rcx) -+ mov %rax,%r10 -+ mov %rdx,%r11 -+ movq 0(%rsi),%rax -+ mulq 16(%rcx) -+ mov %rax,%r12 -+ mov %rdx,%r13 -+ movq 0(%rsi),%rax -+ mulq 24(%rcx) -+ mov %rax,%r14 -+ mov %rdx,%r15 -+ movq 0(%rsi),%rax -+ mulq 32(%rcx) -+ mov %rax,%rbx -+ mov %rdx,%rbp -+ movq 8(%rsi),%rax -+ mulq 0(%rcx) -+ add %rax,%r10 -+ adc %rdx,%r11 -+ movq 8(%rsi),%rax -+ mulq 8(%rcx) -+ add %rax,%r12 -+ adc %rdx,%r13 -+ movq 8(%rsi),%rax -+ mulq 16(%rcx) -+ add %rax,%r14 -+ adc %rdx,%r15 -+ movq 8(%rsi),%rax -+ mulq 24(%rcx) -+ add %rax,%rbx -+ adc %rdx,%rbp -+ movq 8(%rsi),%rdx -+ imulq $19,%rdx,%rax -+ mulq 32(%rcx) -+ add %rax,%r8 -+ adc %rdx,%r9 -+ movq 16(%rsi),%rax -+ mulq 0(%rcx) -+ add %rax,%r12 -+ adc %rdx,%r13 -+ movq 16(%rsi),%rax -+ mulq 8(%rcx) -+ add %rax,%r14 -+ adc %rdx,%r15 -+ movq 16(%rsi),%rax -+ mulq 16(%rcx) -+ add %rax,%rbx -+ adc %rdx,%rbp -+ movq 16(%rsi),%rdx -+ imulq $19,%rdx,%rax -+ mulq 24(%rcx) -+ add %rax,%r8 -+ adc %rdx,%r9 -+ movq 16(%rsi),%rdx -+ imulq $19,%rdx,%rax -+ mulq 32(%rcx) -+ add %rax,%r10 -+ adc %rdx,%r11 -+ movq 24(%rsi),%rax -+ mulq 0(%rcx) -+ add %rax,%r14 -+ adc %rdx,%r15 -+ movq 24(%rsi),%rax -+ mulq 8(%rcx) -+ add %rax,%rbx -+ adc %rdx,%rbp -+ movq 64(%rsp),%rax -+ mulq 24(%rcx) -+ add %rax,%r10 -+ adc %rdx,%r11 -+ movq 64(%rsp),%rax -+ mulq 32(%rcx) -+ add %rax,%r12 -+ adc %rdx,%r13 -+ movq 32(%rsi),%rax -+ mulq 0(%rcx) -+ add %rax,%rbx -+ adc %rdx,%rbp -+ movq 72(%rsp),%rax -+ mulq 16(%rcx) -+ add %rax,%r10 -+ adc %rdx,%r11 -+ movq 72(%rsp),%rax -+ mulq 24(%rcx) -+ add %rax,%r12 -+ adc %rdx,%r13 -+ movq 72(%rsp),%rax -+ mulq 32(%rcx) -+ add %rax,%r14 -+ adc %rdx,%r15 -+ movq curve25519_sandy2x_REDMASK51(%rip),%rsi -+ shld $13,%r8,%r9 -+ and %rsi,%r8 -+ shld $13,%r10,%r11 -+ and %rsi,%r10 -+ add %r9,%r10 -+ shld $13,%r12,%r13 -+ and %rsi,%r12 -+ add %r11,%r12 -+ shld $13,%r14,%r15 -+ and %rsi,%r14 -+ add %r13,%r14 -+ shld $13,%rbx,%rbp -+ and %rsi,%rbx -+ add %r15,%rbx -+ imulq $19,%rbp,%rdx -+ add %rdx,%r8 -+ mov %r8,%rdx -+ shr $51,%rdx -+ add %r10,%rdx -+ mov %rdx,%rcx -+ shr $51,%rdx -+ and %rsi,%r8 -+ add %r12,%rdx -+ mov %rdx,%r9 -+ shr $51,%rdx -+ and %rsi,%rcx -+ add %r14,%rdx -+ mov %rdx,%rax -+ shr $51,%rdx -+ and %rsi,%r9 -+ add %rbx,%rdx -+ mov %rdx,%r10 -+ shr $51,%rdx -+ and %rsi,%rax -+ imulq $19,%rdx,%rdx -+ add %rdx,%r8 -+ and %rsi,%r10 -+ movq %r8,0(%rdi) -+ movq %rcx,8(%rdi) -+ movq %r9,16(%rdi) -+ movq %rax,24(%rdi) -+ movq %r10,32(%rdi) -+ movq 0(%rsp),%r11 -+ movq 8(%rsp),%r12 -+ movq 16(%rsp),%r13 -+ movq 24(%rsp),%r14 -+ movq 32(%rsp),%r15 -+ movq 40(%rsp),%rbx -+ movq 48(%rsp),%rbp -+ leave -+ ret -+ENDPROC(curve25519_sandy2x_fe51_mul) -+ -+.align 32 -+ENTRY(curve25519_sandy2x_fe51_nsquare) -+ push %rbp -+ mov %rsp,%rbp -+ sub $64,%rsp -+ and $-32,%rsp -+ movq %r11,0(%rsp) -+ movq %r12,8(%rsp) -+ movq %r13,16(%rsp) -+ movq %r14,24(%rsp) -+ movq %r15,32(%rsp) -+ movq %rbx,40(%rsp) -+ movq %rbp,48(%rsp) -+ movq 0(%rsi),%rcx -+ movq 8(%rsi),%r8 -+ movq 16(%rsi),%r9 -+ movq 24(%rsi),%rax -+ movq 32(%rsi),%rsi -+ movq %r9,16(%rdi) -+ movq %rax,24(%rdi) -+ movq %rsi,32(%rdi) -+ mov %rdx,%rsi -+ -+ .align 16 -+ .Lloop: -+ sub $1,%rsi -+ mov %rcx,%rax -+ mul %rcx -+ add %rcx,%rcx -+ mov %rax,%r9 -+ mov %rdx,%r10 -+ mov %rcx,%rax -+ mul %r8 -+ mov %rax,%r11 -+ mov %rdx,%r12 -+ mov %rcx,%rax -+ mulq 16(%rdi) -+ mov %rax,%r13 -+ mov %rdx,%r14 -+ mov %rcx,%rax -+ mulq 24(%rdi) -+ mov %rax,%r15 -+ mov %rdx,%rbx -+ mov %rcx,%rax -+ mulq 32(%rdi) -+ mov %rax,%rcx -+ mov %rdx,%rbp -+ mov %r8,%rax -+ mul %r8 -+ add %r8,%r8 -+ add %rax,%r13 -+ adc %rdx,%r14 -+ mov %r8,%rax -+ mulq 16(%rdi) -+ add %rax,%r15 -+ adc %rdx,%rbx -+ mov %r8,%rax -+ imulq $19, %r8,%r8 -+ mulq 24(%rdi) -+ add %rax,%rcx -+ adc %rdx,%rbp -+ mov %r8,%rax -+ mulq 32(%rdi) -+ add %rax,%r9 -+ adc %rdx,%r10 -+ movq 16(%rdi),%rax -+ mulq 16(%rdi) -+ add %rax,%rcx -+ adc %rdx,%rbp -+ shld $13,%rcx,%rbp -+ movq 16(%rdi),%rax -+ imulq $38, %rax,%rax -+ mulq 24(%rdi) -+ add %rax,%r9 -+ adc %rdx,%r10 -+ shld $13,%r9,%r10 -+ movq 16(%rdi),%rax -+ imulq $38, %rax,%rax -+ mulq 32(%rdi) -+ add %rax,%r11 -+ adc %rdx,%r12 -+ movq 24(%rdi),%rax -+ imulq $19, %rax,%rax -+ mulq 24(%rdi) -+ add %rax,%r11 -+ adc %rdx,%r12 -+ shld $13,%r11,%r12 -+ movq 24(%rdi),%rax -+ imulq $38, %rax,%rax -+ mulq 32(%rdi) -+ add %rax,%r13 -+ adc %rdx,%r14 -+ shld $13,%r13,%r14 -+ movq 32(%rdi),%rax -+ imulq $19, %rax,%rax -+ mulq 32(%rdi) -+ add %rax,%r15 -+ adc %rdx,%rbx -+ shld $13,%r15,%rbx -+ movq curve25519_sandy2x_REDMASK51(%rip),%rdx -+ and %rdx,%rcx -+ add %rbx,%rcx -+ and %rdx,%r9 -+ and %rdx,%r11 -+ add %r10,%r11 -+ and %rdx,%r13 -+ add %r12,%r13 -+ and %rdx,%r15 -+ add %r14,%r15 -+ imulq $19, %rbp,%rbp -+ lea (%r9,%rbp),%r9 -+ mov %r9,%rax -+ shr $51,%r9 -+ add %r11,%r9 -+ and %rdx,%rax -+ mov %r9,%r8 -+ shr $51,%r9 -+ add %r13,%r9 -+ and %rdx,%r8 -+ mov %r9,%r10 -+ shr $51,%r9 -+ add %r15,%r9 -+ and %rdx,%r10 -+ movq %r10,16(%rdi) -+ mov %r9,%r10 -+ shr $51,%r9 -+ add %rcx,%r9 -+ and %rdx,%r10 -+ movq %r10,24(%rdi) -+ mov %r9,%r10 -+ shr $51,%r9 -+ imulq $19, %r9,%r9 -+ lea (%rax,%r9),%rcx -+ and %rdx,%r10 -+ movq %r10,32(%rdi) -+ cmp $0,%rsi -+ jne .Lloop -+ -+ movq %rcx,0(%rdi) -+ movq %r8,8(%rdi) -+ movq 0(%rsp),%r11 -+ movq 8(%rsp),%r12 -+ movq 16(%rsp),%r13 -+ movq 24(%rsp),%r14 -+ movq 32(%rsp),%r15 -+ movq 40(%rsp),%rbx -+ movq 48(%rsp),%rbp -+ leave -+ ret -+ENDPROC(curve25519_sandy2x_fe51_nsquare) -+ -+.align 32 -+ENTRY(curve25519_sandy2x_fe51_pack) -+ push %rbp -+ mov %rsp,%rbp -+ sub $32,%rsp -+ and $-32,%rsp -+ movq %r11,0(%rsp) -+ movq %r12,8(%rsp) -+ movq 0(%rsi),%rdx -+ movq 8(%rsi),%rcx -+ movq 16(%rsi),%r8 -+ movq 24(%rsi),%r9 -+ movq 32(%rsi),%rsi -+ movq curve25519_sandy2x_REDMASK51(%rip),%rax -+ lea -18(%rax),%r10 -+ mov $3,%r11 -+ -+ .align 16 -+ .Lreduceloop: -+ mov %rdx,%r12 -+ shr $51,%r12 -+ and %rax,%rdx -+ add %r12,%rcx -+ mov %rcx,%r12 -+ shr $51,%r12 -+ and %rax,%rcx -+ add %r12,%r8 -+ mov %r8,%r12 -+ shr $51,%r12 -+ and %rax,%r8 -+ add %r12,%r9 -+ mov %r9,%r12 -+ shr $51,%r12 -+ and %rax,%r9 -+ add %r12,%rsi -+ mov %rsi,%r12 -+ shr $51,%r12 -+ and %rax,%rsi -+ imulq $19, %r12,%r12 -+ add %r12,%rdx -+ sub $1,%r11 -+ ja .Lreduceloop -+ -+ mov $1,%r12 -+ cmp %r10,%rdx -+ cmovl %r11,%r12 -+ cmp %rax,%rcx -+ cmovne %r11,%r12 -+ cmp %rax,%r8 -+ cmovne %r11,%r12 -+ cmp %rax,%r9 -+ cmovne %r11,%r12 -+ cmp %rax,%rsi -+ cmovne %r11,%r12 -+ neg %r12 -+ and %r12,%rax -+ and %r12,%r10 -+ sub %r10,%rdx -+ sub %rax,%rcx -+ sub %rax,%r8 -+ sub %rax,%r9 -+ sub %rax,%rsi -+ mov %rdx,%rax -+ and $0xFF,%eax -+ movb %al,0(%rdi) -+ mov %rdx,%rax -+ shr $8,%rax -+ and $0xFF,%eax -+ movb %al,1(%rdi) -+ mov %rdx,%rax -+ shr $16,%rax -+ and $0xFF,%eax -+ movb %al,2(%rdi) -+ mov %rdx,%rax -+ shr $24,%rax -+ and $0xFF,%eax -+ movb %al,3(%rdi) -+ mov %rdx,%rax -+ shr $32,%rax -+ and $0xFF,%eax -+ movb %al,4(%rdi) -+ mov %rdx,%rax -+ shr $40,%rax -+ and $0xFF,%eax -+ movb %al,5(%rdi) -+ mov %rdx,%rdx -+ shr $48,%rdx -+ mov %rcx,%rax -+ shl $3,%rax -+ and $0xF8,%eax -+ xor %rdx,%rax -+ movb %al,6(%rdi) -+ mov %rcx,%rdx -+ shr $5,%rdx -+ and $0xFF,%edx -+ movb %dl,7(%rdi) -+ mov %rcx,%rdx -+ shr $13,%rdx -+ and $0xFF,%edx -+ movb %dl,8(%rdi) -+ mov %rcx,%rdx -+ shr $21,%rdx -+ and $0xFF,%edx -+ movb %dl,9(%rdi) -+ mov %rcx,%rdx -+ shr $29,%rdx -+ and $0xFF,%edx -+ movb %dl,10(%rdi) -+ mov %rcx,%rdx -+ shr $37,%rdx -+ and $0xFF,%edx -+ movb %dl,11(%rdi) -+ mov %rcx,%rdx -+ shr $45,%rdx -+ mov %r8,%rcx -+ shl $6,%rcx -+ and $0xC0,%ecx -+ xor %rdx,%rcx -+ movb %cl,12(%rdi) -+ mov %r8,%rdx -+ shr $2,%rdx -+ and $0xFF,%edx -+ movb %dl,13(%rdi) -+ mov %r8,%rdx -+ shr $10,%rdx -+ and $0xFF,%edx -+ movb %dl,14(%rdi) -+ mov %r8,%rdx -+ shr $18,%rdx -+ and $0xFF,%edx -+ movb %dl,15(%rdi) -+ mov %r8,%rdx -+ shr $26,%rdx -+ and $0xFF,%edx -+ movb %dl,16(%rdi) -+ mov %r8,%rdx -+ shr $34,%rdx -+ and $0xFF,%edx -+ movb %dl,17(%rdi) -+ mov %r8,%rdx -+ shr $42,%rdx -+ movb %dl,18(%rdi) -+ mov %r8,%rdx -+ shr $50,%rdx -+ mov %r9,%rcx -+ shl $1,%rcx -+ and $0xFE,%ecx -+ xor %rdx,%rcx -+ movb %cl,19(%rdi) -+ mov %r9,%rdx -+ shr $7,%rdx -+ and $0xFF,%edx -+ movb %dl,20(%rdi) -+ mov %r9,%rdx -+ shr $15,%rdx -+ and $0xFF,%edx -+ movb %dl,21(%rdi) -+ mov %r9,%rdx -+ shr $23,%rdx -+ and $0xFF,%edx -+ movb %dl,22(%rdi) -+ mov %r9,%rdx -+ shr $31,%rdx -+ and $0xFF,%edx -+ movb %dl,23(%rdi) -+ mov %r9,%rdx -+ shr $39,%rdx -+ and $0xFF,%edx -+ movb %dl,24(%rdi) -+ mov %r9,%rdx -+ shr $47,%rdx -+ mov %rsi,%rcx -+ shl $4,%rcx -+ and $0xF0,%ecx -+ xor %rdx,%rcx -+ movb %cl,25(%rdi) -+ mov %rsi,%rdx -+ shr $4,%rdx -+ and $0xFF,%edx -+ movb %dl,26(%rdi) -+ mov %rsi,%rdx -+ shr $12,%rdx -+ and $0xFF,%edx -+ movb %dl,27(%rdi) -+ mov %rsi,%rdx -+ shr $20,%rdx -+ and $0xFF,%edx -+ movb %dl,28(%rdi) -+ mov %rsi,%rdx -+ shr $28,%rdx -+ and $0xFF,%edx -+ movb %dl,29(%rdi) -+ mov %rsi,%rdx -+ shr $36,%rdx -+ and $0xFF,%edx -+ movb %dl,30(%rdi) -+ mov %rsi,%rsi -+ shr $44,%rsi -+ movb %sil,31(%rdi) -+ movq 0(%rsp),%r11 -+ movq 8(%rsp),%r12 -+ leave -+ ret -+ENDPROC(curve25519_sandy2x_fe51_pack) -+ -+.align 32 -+ENTRY(curve25519_sandy2x_ladder) -+ push %rbp -+ mov %rsp,%rbp -+ sub $1856,%rsp -+ and $-32,%rsp -+ movq %r11,1824(%rsp) -+ movq %r12,1832(%rsp) -+ movq %r13,1840(%rsp) -+ movq %r14,1848(%rsp) -+ vmovdqa curve25519_sandy2x_v0_0(%rip),%xmm0 -+ vmovdqa curve25519_sandy2x_v1_0(%rip),%xmm1 -+ vmovdqu 0(%rdi),%xmm2 -+ vmovdqa %xmm2,0(%rsp) -+ vmovdqu 16(%rdi),%xmm2 -+ vmovdqa %xmm2,16(%rsp) -+ vmovdqu 32(%rdi),%xmm2 -+ vmovdqa %xmm2,32(%rsp) -+ vmovdqu 48(%rdi),%xmm2 -+ vmovdqa %xmm2,48(%rsp) -+ vmovdqu 64(%rdi),%xmm2 -+ vmovdqa %xmm2,64(%rsp) -+ vmovdqa %xmm1,80(%rsp) -+ vmovdqa %xmm0,96(%rsp) -+ vmovdqa %xmm0,112(%rsp) -+ vmovdqa %xmm0,128(%rsp) -+ vmovdqa %xmm0,144(%rsp) -+ vmovdqa %xmm1,%xmm0 -+ vpxor %xmm1,%xmm1,%xmm1 -+ vpxor %xmm2,%xmm2,%xmm2 -+ vpxor %xmm3,%xmm3,%xmm3 -+ vpxor %xmm4,%xmm4,%xmm4 -+ vpxor %xmm5,%xmm5,%xmm5 -+ vpxor %xmm6,%xmm6,%xmm6 -+ vpxor %xmm7,%xmm7,%xmm7 -+ vpxor %xmm8,%xmm8,%xmm8 -+ vpxor %xmm9,%xmm9,%xmm9 -+ vmovdqu 0(%rdi),%xmm10 -+ vmovdqa %xmm10,160(%rsp) -+ vmovdqu 16(%rdi),%xmm10 -+ vmovdqa %xmm10,176(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,192(%rsp) -+ vmovdqu 32(%rdi),%xmm10 -+ vmovdqa %xmm10,208(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,224(%rsp) -+ vmovdqu 48(%rdi),%xmm10 -+ vmovdqa %xmm10,240(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,256(%rsp) -+ vmovdqu 64(%rdi),%xmm10 -+ vmovdqa %xmm10,272(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,288(%rsp) -+ vmovdqu 8(%rdi),%xmm10 -+ vpmuludq curve25519_sandy2x_v2_1(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,304(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,320(%rsp) -+ vmovdqu 24(%rdi),%xmm10 -+ vpmuludq curve25519_sandy2x_v2_1(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,336(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,352(%rsp) -+ vmovdqu 40(%rdi),%xmm10 -+ vpmuludq curve25519_sandy2x_v2_1(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,368(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,384(%rsp) -+ vmovdqu 56(%rdi),%xmm10 -+ vpmuludq curve25519_sandy2x_v2_1(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,400(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,416(%rsp) -+ vmovdqu 0(%rdi),%xmm10 -+ vmovdqu 64(%rdi),%xmm11 -+ vblendps $12, %xmm11, %xmm10, %xmm10 -+ vpshufd $2,%xmm10,%xmm10 -+ vpmuludq curve25519_sandy2x_v38_1(%rip),%xmm10,%xmm10 -+ vmovdqa %xmm10,432(%rsp) -+ movq 0(%rsi),%rdx -+ movq 8(%rsi),%rcx -+ movq 16(%rsi),%r8 -+ movq 24(%rsi),%r9 -+ shrd $1,%rcx,%rdx -+ shrd $1,%r8,%rcx -+ shrd $1,%r9,%r8 -+ shr $1,%r9 -+ xorq 0(%rsi),%rdx -+ xorq 8(%rsi),%rcx -+ xorq 16(%rsi),%r8 -+ xorq 24(%rsi),%r9 -+ leaq 800(%rsp),%rsi -+ mov $64,%rax -+ -+ .align 16 -+ .Lladder_small_loop: -+ mov %rdx,%r10 -+ mov %rcx,%r11 -+ mov %r8,%r12 -+ mov %r9,%r13 -+ shr $1,%rdx -+ shr $1,%rcx -+ shr $1,%r8 -+ shr $1,%r9 -+ and $1,%r10d -+ and $1,%r11d -+ and $1,%r12d -+ and $1,%r13d -+ neg %r10 -+ neg %r11 -+ neg %r12 -+ neg %r13 -+ movl %r10d,0(%rsi) -+ movl %r11d,256(%rsi) -+ movl %r12d,512(%rsi) -+ movl %r13d,768(%rsi) -+ add $4,%rsi -+ sub $1,%rax -+ jne .Lladder_small_loop -+ mov $255,%rdx -+ add $760,%rsi -+ -+ .align 16 -+ .Lladder_loop: -+ sub $1,%rdx -+ vbroadcastss 0(%rsi),%xmm10 -+ sub $4,%rsi -+ vmovdqa 0(%rsp),%xmm11 -+ vmovdqa 80(%rsp),%xmm12 -+ vpxor %xmm11,%xmm0,%xmm13 -+ vpand %xmm10,%xmm13,%xmm13 -+ vpxor %xmm13,%xmm0,%xmm0 -+ vpxor %xmm13,%xmm11,%xmm11 -+ vpxor %xmm12,%xmm1,%xmm13 -+ vpand %xmm10,%xmm13,%xmm13 -+ vpxor %xmm13,%xmm1,%xmm1 -+ vpxor %xmm13,%xmm12,%xmm12 -+ vmovdqa 16(%rsp),%xmm13 -+ vmovdqa 96(%rsp),%xmm14 -+ vpxor %xmm13,%xmm2,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm2,%xmm2 -+ vpxor %xmm15,%xmm13,%xmm13 -+ vpxor %xmm14,%xmm3,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm3,%xmm3 -+ vpxor %xmm15,%xmm14,%xmm14 -+ vmovdqa %xmm13,0(%rsp) -+ vmovdqa %xmm14,16(%rsp) -+ vmovdqa 32(%rsp),%xmm13 -+ vmovdqa 112(%rsp),%xmm14 -+ vpxor %xmm13,%xmm4,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm4,%xmm4 -+ vpxor %xmm15,%xmm13,%xmm13 -+ vpxor %xmm14,%xmm5,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm5,%xmm5 -+ vpxor %xmm15,%xmm14,%xmm14 -+ vmovdqa %xmm13,32(%rsp) -+ vmovdqa %xmm14,80(%rsp) -+ vmovdqa 48(%rsp),%xmm13 -+ vmovdqa 128(%rsp),%xmm14 -+ vpxor %xmm13,%xmm6,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm6,%xmm6 -+ vpxor %xmm15,%xmm13,%xmm13 -+ vpxor %xmm14,%xmm7,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm7,%xmm7 -+ vpxor %xmm15,%xmm14,%xmm14 -+ vmovdqa %xmm13,48(%rsp) -+ vmovdqa %xmm14,96(%rsp) -+ vmovdqa 64(%rsp),%xmm13 -+ vmovdqa 144(%rsp),%xmm14 -+ vpxor %xmm13,%xmm8,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm8,%xmm8 -+ vpxor %xmm15,%xmm13,%xmm13 -+ vpxor %xmm14,%xmm9,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm9,%xmm9 -+ vpxor %xmm15,%xmm14,%xmm14 -+ vmovdqa %xmm13,64(%rsp) -+ vmovdqa %xmm14,112(%rsp) -+ vpaddq curve25519_sandy2x_subc0(%rip),%xmm11,%xmm10 -+ vpsubq %xmm12,%xmm10,%xmm10 -+ vpaddq %xmm12,%xmm11,%xmm11 -+ vpunpckhqdq %xmm10,%xmm11,%xmm12 -+ vpunpcklqdq %xmm10,%xmm11,%xmm10 -+ vpaddq %xmm1,%xmm0,%xmm11 -+ vpaddq curve25519_sandy2x_subc0(%rip),%xmm0,%xmm0 -+ vpsubq %xmm1,%xmm0,%xmm0 -+ vpunpckhqdq %xmm11,%xmm0,%xmm1 -+ vpunpcklqdq %xmm11,%xmm0,%xmm0 -+ vpmuludq %xmm0,%xmm10,%xmm11 -+ vpmuludq %xmm1,%xmm10,%xmm13 -+ vmovdqa %xmm1,128(%rsp) -+ vpaddq %xmm1,%xmm1,%xmm1 -+ vpmuludq %xmm0,%xmm12,%xmm14 -+ vmovdqa %xmm0,144(%rsp) -+ vpaddq %xmm14,%xmm13,%xmm13 -+ vpmuludq %xmm1,%xmm12,%xmm0 -+ vmovdqa %xmm1,448(%rsp) -+ vpaddq %xmm3,%xmm2,%xmm1 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm2,%xmm2 -+ vpsubq %xmm3,%xmm2,%xmm2 -+ vpunpckhqdq %xmm1,%xmm2,%xmm3 -+ vpunpcklqdq %xmm1,%xmm2,%xmm1 -+ vpmuludq %xmm1,%xmm10,%xmm2 -+ vpaddq %xmm2,%xmm0,%xmm0 -+ vpmuludq %xmm3,%xmm10,%xmm2 -+ vmovdqa %xmm3,464(%rsp) -+ vpaddq %xmm3,%xmm3,%xmm3 -+ vpmuludq %xmm1,%xmm12,%xmm14 -+ vmovdqa %xmm1,480(%rsp) -+ vpaddq %xmm14,%xmm2,%xmm2 -+ vpmuludq %xmm3,%xmm12,%xmm1 -+ vmovdqa %xmm3,496(%rsp) -+ vpaddq %xmm5,%xmm4,%xmm3 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm4,%xmm4 -+ vpsubq %xmm5,%xmm4,%xmm4 -+ vpunpckhqdq %xmm3,%xmm4,%xmm5 -+ vpunpcklqdq %xmm3,%xmm4,%xmm3 -+ vpmuludq %xmm3,%xmm10,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vpmuludq %xmm5,%xmm10,%xmm4 -+ vmovdqa %xmm5,512(%rsp) -+ vpaddq %xmm5,%xmm5,%xmm5 -+ vpmuludq %xmm3,%xmm12,%xmm14 -+ vmovdqa %xmm3,528(%rsp) -+ vpaddq %xmm14,%xmm4,%xmm4 -+ vpaddq %xmm7,%xmm6,%xmm3 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm6,%xmm6 -+ vpsubq %xmm7,%xmm6,%xmm6 -+ vpunpckhqdq %xmm3,%xmm6,%xmm7 -+ vpunpcklqdq %xmm3,%xmm6,%xmm3 -+ vpmuludq %xmm3,%xmm10,%xmm6 -+ vpmuludq %xmm5,%xmm12,%xmm14 -+ vmovdqa %xmm5,544(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm5,%xmm5 -+ vmovdqa %xmm5,560(%rsp) -+ vpaddq %xmm14,%xmm6,%xmm6 -+ vpmuludq %xmm7,%xmm10,%xmm5 -+ vmovdqa %xmm7,576(%rsp) -+ vpaddq %xmm7,%xmm7,%xmm7 -+ vpmuludq %xmm3,%xmm12,%xmm14 -+ vmovdqa %xmm3,592(%rsp) -+ vpaddq %xmm14,%xmm5,%xmm5 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 -+ vmovdqa %xmm3,608(%rsp) -+ vpaddq %xmm9,%xmm8,%xmm3 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm8,%xmm8 -+ vpsubq %xmm9,%xmm8,%xmm8 -+ vpunpckhqdq %xmm3,%xmm8,%xmm9 -+ vpunpcklqdq %xmm3,%xmm8,%xmm3 -+ vmovdqa %xmm3,624(%rsp) -+ vpmuludq %xmm7,%xmm12,%xmm8 -+ vmovdqa %xmm7,640(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm7,%xmm7 -+ vmovdqa %xmm7,656(%rsp) -+ vpmuludq %xmm3,%xmm10,%xmm7 -+ vpaddq %xmm7,%xmm8,%xmm8 -+ vpmuludq %xmm9,%xmm10,%xmm7 -+ vmovdqa %xmm9,672(%rsp) -+ vpaddq %xmm9,%xmm9,%xmm9 -+ vpmuludq %xmm3,%xmm12,%xmm10 -+ vpaddq %xmm10,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 -+ vmovdqa %xmm3,688(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm12,%xmm12 -+ vpmuludq %xmm9,%xmm12,%xmm3 -+ vmovdqa %xmm9,704(%rsp) -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vmovdqa 0(%rsp),%xmm3 -+ vmovdqa 16(%rsp),%xmm9 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 -+ vpsubq %xmm9,%xmm10,%xmm10 -+ vpaddq %xmm9,%xmm3,%xmm3 -+ vpunpckhqdq %xmm10,%xmm3,%xmm9 -+ vpunpcklqdq %xmm10,%xmm3,%xmm3 -+ vpmuludq 144(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm0,%xmm0 -+ vpmuludq 128(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm2,%xmm2 -+ vpmuludq 480(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ vpmuludq 464(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm4,%xmm4 -+ vpmuludq 528(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm6,%xmm6 -+ vpmuludq 512(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm5,%xmm5 -+ vpmuludq 592(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm8,%xmm8 -+ vpmuludq 576(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 -+ vpmuludq 624(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm11,%xmm11 -+ vpmuludq 672(%rsp),%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 144(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpmuludq 448(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm1,%xmm1 -+ vpmuludq 480(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 496(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 528(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 544(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm8,%xmm8 -+ vpmuludq 592(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 -+ vpmuludq 640(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 624(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 704(%rsp),%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm0,%xmm0 -+ vmovdqa 32(%rsp),%xmm3 -+ vmovdqa 80(%rsp),%xmm9 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 -+ vpsubq %xmm9,%xmm10,%xmm10 -+ vpaddq %xmm9,%xmm3,%xmm3 -+ vpunpckhqdq %xmm10,%xmm3,%xmm9 -+ vpunpcklqdq %xmm10,%xmm3,%xmm3 -+ vpmuludq 144(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ vpmuludq 128(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm4,%xmm4 -+ vpmuludq 480(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm6,%xmm6 -+ vpmuludq 464(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm5,%xmm5 -+ vpmuludq 528(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm8,%xmm8 -+ vpmuludq 512(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 -+ vpmuludq 592(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm11,%xmm11 -+ vpmuludq 576(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm13,%xmm13 -+ vpmuludq 624(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm0,%xmm0 -+ vpmuludq 672(%rsp),%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpmuludq 144(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 448(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 480(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 496(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm8,%xmm8 -+ vpmuludq 528(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 -+ vpmuludq 544(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 592(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 640(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm0,%xmm0 -+ vpmuludq 624(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpmuludq 704(%rsp),%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm1,%xmm1 -+ vmovdqa 48(%rsp),%xmm3 -+ vmovdqa 96(%rsp),%xmm9 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 -+ vpsubq %xmm9,%xmm10,%xmm10 -+ vpaddq %xmm9,%xmm3,%xmm3 -+ vpunpckhqdq %xmm10,%xmm3,%xmm9 -+ vpunpcklqdq %xmm10,%xmm3,%xmm3 -+ vpmuludq 144(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm6,%xmm6 -+ vpmuludq 128(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm5,%xmm5 -+ vpmuludq 480(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm8,%xmm8 -+ vpmuludq 464(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 -+ vpmuludq 528(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm11,%xmm11 -+ vpmuludq 512(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm13,%xmm13 -+ vpmuludq 592(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm0,%xmm0 -+ vpmuludq 576(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm2,%xmm2 -+ vpmuludq 624(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ vpmuludq 672(%rsp),%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 144(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 448(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm8,%xmm8 -+ vpmuludq 480(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 -+ vpmuludq 496(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 528(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 544(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm0,%xmm0 -+ vpmuludq 592(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpmuludq 640(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm1,%xmm1 -+ vpmuludq 624(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 704(%rsp),%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm6,%xmm6 -+ vmovdqa 64(%rsp),%xmm3 -+ vmovdqa 112(%rsp),%xmm9 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 -+ vpsubq %xmm9,%xmm10,%xmm10 -+ vpaddq %xmm9,%xmm3,%xmm3 -+ vpunpckhqdq %xmm10,%xmm3,%xmm9 -+ vpunpcklqdq %xmm10,%xmm3,%xmm3 -+ vpmuludq 144(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm8,%xmm8 -+ vpmuludq 128(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 -+ vpmuludq 480(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm11,%xmm11 -+ vpmuludq 464(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm13,%xmm13 -+ vpmuludq 528(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm0,%xmm0 -+ vpmuludq 512(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm2,%xmm2 -+ vpmuludq 592(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ vpmuludq 576(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm4,%xmm4 -+ vpmuludq 624(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm6,%xmm6 -+ vpmuludq 672(%rsp),%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 144(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 -+ vpmuludq 448(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 480(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 496(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm0,%xmm0 -+ vpmuludq 528(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpmuludq 544(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm1,%xmm1 -+ vpmuludq 592(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 640(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 624(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 704(%rsp),%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm8,%xmm8 -+ vpsrlq $25,%xmm4,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpand curve25519_sandy2x_m25(%rip),%xmm4,%xmm4 -+ vpsrlq $26,%xmm11,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 -+ vpsrlq $26,%xmm6,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 -+ vpsrlq $25,%xmm13,%xmm3 -+ vpaddq %xmm3,%xmm0,%xmm0 -+ vpand curve25519_sandy2x_m25(%rip),%xmm13,%xmm13 -+ vpsrlq $25,%xmm5,%xmm3 -+ vpaddq %xmm3,%xmm8,%xmm8 -+ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 -+ vpsrlq $26,%xmm0,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpand curve25519_sandy2x_m26(%rip),%xmm0,%xmm0 -+ vpsrlq $26,%xmm8,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpand curve25519_sandy2x_m26(%rip),%xmm8,%xmm8 -+ vpsrlq $25,%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm1,%xmm1 -+ vpand curve25519_sandy2x_m25(%rip),%xmm2,%xmm2 -+ vpsrlq $25,%xmm7,%xmm3 -+ vpsllq $4,%xmm3,%xmm9 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpsllq $1,%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m25(%rip),%xmm7,%xmm7 -+ vpsrlq $26,%xmm1,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 -+ vpsrlq $26,%xmm11,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 -+ vpsrlq $25,%xmm4,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpand curve25519_sandy2x_m25(%rip),%xmm4,%xmm4 -+ vpunpcklqdq %xmm13,%xmm11,%xmm3 -+ vpunpckhqdq %xmm13,%xmm11,%xmm9 -+ vpaddq curve25519_sandy2x_subc0(%rip),%xmm9,%xmm10 -+ vpsubq %xmm3,%xmm10,%xmm10 -+ vpaddq %xmm9,%xmm3,%xmm3 -+ vpunpckhqdq %xmm3,%xmm10,%xmm9 -+ vpunpcklqdq %xmm3,%xmm10,%xmm10 -+ vpmuludq %xmm10,%xmm10,%xmm3 -+ vpaddq %xmm10,%xmm10,%xmm10 -+ vpmuludq %xmm9,%xmm10,%xmm11 -+ vpunpcklqdq %xmm2,%xmm0,%xmm12 -+ vpunpckhqdq %xmm2,%xmm0,%xmm0 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm0,%xmm2 -+ vpsubq %xmm12,%xmm2,%xmm2 -+ vpaddq %xmm0,%xmm12,%xmm12 -+ vpunpckhqdq %xmm12,%xmm2,%xmm0 -+ vpunpcklqdq %xmm12,%xmm2,%xmm2 -+ vpmuludq %xmm2,%xmm10,%xmm12 -+ vpaddq %xmm9,%xmm9,%xmm13 -+ vpmuludq %xmm13,%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm12,%xmm12 -+ vpmuludq %xmm0,%xmm10,%xmm9 -+ vpmuludq %xmm2,%xmm13,%xmm14 -+ vpaddq %xmm14,%xmm9,%xmm9 -+ vpunpcklqdq %xmm4,%xmm1,%xmm14 -+ vpunpckhqdq %xmm4,%xmm1,%xmm1 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm1,%xmm4 -+ vpsubq %xmm14,%xmm4,%xmm4 -+ vpaddq %xmm1,%xmm14,%xmm14 -+ vpunpckhqdq %xmm14,%xmm4,%xmm1 -+ vpunpcklqdq %xmm14,%xmm4,%xmm4 -+ vmovdqa %xmm1,0(%rsp) -+ vpaddq %xmm1,%xmm1,%xmm1 -+ vmovdqa %xmm1,16(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 -+ vmovdqa %xmm1,32(%rsp) -+ vpmuludq %xmm4,%xmm10,%xmm1 -+ vpmuludq %xmm2,%xmm2,%xmm14 -+ vpaddq %xmm14,%xmm1,%xmm1 -+ vpmuludq 0(%rsp),%xmm10,%xmm14 -+ vpmuludq %xmm4,%xmm13,%xmm15 -+ vpaddq %xmm15,%xmm14,%xmm14 -+ vpunpcklqdq %xmm5,%xmm6,%xmm15 -+ vpunpckhqdq %xmm5,%xmm6,%xmm5 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm5,%xmm6 -+ vpsubq %xmm15,%xmm6,%xmm6 -+ vpaddq %xmm5,%xmm15,%xmm15 -+ vpunpckhqdq %xmm15,%xmm6,%xmm5 -+ vpunpcklqdq %xmm15,%xmm6,%xmm6 -+ vmovdqa %xmm6,48(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm6,%xmm6 -+ vmovdqa %xmm6,64(%rsp) -+ vmovdqa %xmm5,80(%rsp) -+ vpmuludq curve25519_sandy2x_v38_38(%rip),%xmm5,%xmm5 -+ vmovdqa %xmm5,96(%rsp) -+ vpmuludq 48(%rsp),%xmm10,%xmm5 -+ vpaddq %xmm0,%xmm0,%xmm6 -+ vpmuludq %xmm6,%xmm0,%xmm0 -+ vpaddq %xmm0,%xmm5,%xmm5 -+ vpmuludq 80(%rsp),%xmm10,%xmm0 -+ vpmuludq %xmm4,%xmm6,%xmm15 -+ vpaddq %xmm15,%xmm0,%xmm0 -+ vpmuludq %xmm6,%xmm13,%xmm15 -+ vpaddq %xmm15,%xmm1,%xmm1 -+ vpmuludq %xmm6,%xmm2,%xmm15 -+ vpaddq %xmm15,%xmm14,%xmm14 -+ vpunpcklqdq %xmm7,%xmm8,%xmm15 -+ vpunpckhqdq %xmm7,%xmm8,%xmm7 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm7,%xmm8 -+ vpsubq %xmm15,%xmm8,%xmm8 -+ vpaddq %xmm7,%xmm15,%xmm15 -+ vpunpckhqdq %xmm15,%xmm8,%xmm7 -+ vpunpcklqdq %xmm15,%xmm8,%xmm8 -+ vmovdqa %xmm8,112(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm8,%xmm8 -+ vmovdqa %xmm8,448(%rsp) -+ vpmuludq 112(%rsp),%xmm10,%xmm8 -+ vpmuludq %xmm7,%xmm10,%xmm10 -+ vpmuludq curve25519_sandy2x_v38_38(%rip),%xmm7,%xmm15 -+ vpmuludq %xmm15,%xmm7,%xmm7 -+ vpaddq %xmm7,%xmm8,%xmm8 -+ vpmuludq %xmm15,%xmm13,%xmm7 -+ vpaddq %xmm7,%xmm3,%xmm3 -+ vpmuludq %xmm15,%xmm2,%xmm7 -+ vpaddq %xmm7,%xmm11,%xmm11 -+ vpmuludq 80(%rsp),%xmm13,%xmm7 -+ vpaddq %xmm7,%xmm7,%xmm7 -+ vpaddq %xmm7,%xmm8,%xmm8 -+ vpmuludq 16(%rsp),%xmm13,%xmm7 -+ vpaddq %xmm7,%xmm5,%xmm5 -+ vpmuludq 48(%rsp),%xmm13,%xmm7 -+ vpaddq %xmm7,%xmm0,%xmm0 -+ vpmuludq 112(%rsp),%xmm13,%xmm7 -+ vpaddq %xmm7,%xmm10,%xmm10 -+ vpmuludq %xmm15,%xmm6,%xmm7 -+ vpaddq %xmm7,%xmm12,%xmm12 -+ vpmuludq %xmm15,%xmm4,%xmm7 -+ vpaddq %xmm7,%xmm9,%xmm9 -+ vpaddq %xmm2,%xmm2,%xmm2 -+ vpmuludq %xmm4,%xmm2,%xmm7 -+ vpaddq %xmm7,%xmm5,%xmm5 -+ vpmuludq 448(%rsp),%xmm2,%xmm7 -+ vpaddq %xmm7,%xmm3,%xmm3 -+ vpmuludq 448(%rsp),%xmm6,%xmm7 -+ vpaddq %xmm7,%xmm11,%xmm11 -+ vpmuludq 0(%rsp),%xmm2,%xmm7 -+ vpaddq %xmm7,%xmm0,%xmm0 -+ vpmuludq 48(%rsp),%xmm2,%xmm7 -+ vpaddq %xmm7,%xmm8,%xmm8 -+ vpmuludq 80(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq 96(%rsp),%xmm4,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpmuludq %xmm4,%xmm4,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpaddq %xmm4,%xmm4,%xmm2 -+ vpmuludq 448(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm12,%xmm12 -+ vpmuludq 16(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vpmuludq 48(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm14,%xmm14 -+ vpmuludq 96(%rsp),%xmm6,%xmm4 -+ vpaddq %xmm4,%xmm3,%xmm3 -+ vmovdqa 16(%rsp),%xmm4 -+ vpmuludq 448(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm9,%xmm9 -+ vpmuludq 16(%rsp),%xmm6,%xmm4 -+ vpaddq %xmm4,%xmm8,%xmm8 -+ vpmuludq 48(%rsp),%xmm6,%xmm4 -+ vpaddq %xmm4,%xmm10,%xmm10 -+ vpmuludq 80(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm5,%xmm5 -+ vpmuludq 112(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm0,%xmm0 -+ vmovdqa 48(%rsp),%xmm4 -+ vpaddq %xmm4,%xmm4,%xmm4 -+ vpmuludq 448(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vmovdqa 80(%rsp),%xmm4 -+ vpaddq %xmm4,%xmm4,%xmm4 -+ vpmuludq 448(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm14,%xmm14 -+ vpmuludq 64(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm3,%xmm3 -+ vmovdqa 16(%rsp),%xmm4 -+ vpmuludq 64(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm11,%xmm11 -+ vmovdqa 16(%rsp),%xmm4 -+ vpmuludq 96(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm12,%xmm12 -+ vmovdqa 48(%rsp),%xmm4 -+ vpmuludq 96(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm9,%xmm9 -+ vpmuludq 0(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vmovdqa 32(%rsp),%xmm2 -+ vpmuludq 0(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm3,%xmm3 -+ vmovdqa 64(%rsp),%xmm2 -+ vpmuludq 48(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vmovdqa 96(%rsp),%xmm2 -+ vpmuludq 80(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm1,%xmm1 -+ vmovdqa 448(%rsp),%xmm2 -+ vpmuludq 112(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpsrlq $26,%xmm3,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m26(%rip),%xmm3,%xmm3 -+ vpsrlq $25,%xmm14,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m25(%rip),%xmm14,%xmm14 -+ vpsrlq $25,%xmm11,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpand curve25519_sandy2x_m25(%rip),%xmm11,%xmm11 -+ vpsrlq $26,%xmm5,%xmm2 -+ vpaddq %xmm2,%xmm0,%xmm0 -+ vpand curve25519_sandy2x_m26(%rip),%xmm5,%xmm5 -+ vpsrlq $26,%xmm12,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpand curve25519_sandy2x_m26(%rip),%xmm12,%xmm12 -+ vpsrlq $25,%xmm0,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpand curve25519_sandy2x_m25(%rip),%xmm0,%xmm0 -+ vpsrlq $25,%xmm9,%xmm2 -+ vpaddq %xmm2,%xmm1,%xmm1 -+ vpand curve25519_sandy2x_m25(%rip),%xmm9,%xmm9 -+ vpsrlq $26,%xmm8,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpand curve25519_sandy2x_m26(%rip),%xmm8,%xmm8 -+ vpsrlq $26,%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm14,%xmm14 -+ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 -+ vpsrlq $25,%xmm10,%xmm2 -+ vpsllq $4,%xmm2,%xmm4 -+ vpaddq %xmm2,%xmm3,%xmm3 -+ vpsllq $1,%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm3,%xmm3 -+ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 -+ vpsrlq $25,%xmm14,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m25(%rip),%xmm14,%xmm14 -+ vpsrlq $26,%xmm3,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m26(%rip),%xmm3,%xmm3 -+ vpunpckhqdq %xmm11,%xmm3,%xmm2 -+ vmovdqa %xmm2,0(%rsp) -+ vpshufd $0,%xmm3,%xmm2 -+ vpshufd $0,%xmm11,%xmm3 -+ vpmuludq 160(%rsp),%xmm2,%xmm4 -+ vpmuludq 432(%rsp),%xmm3,%xmm6 -+ vpaddq %xmm6,%xmm4,%xmm4 -+ vpmuludq 176(%rsp),%xmm2,%xmm6 -+ vpmuludq 304(%rsp),%xmm3,%xmm7 -+ vpaddq %xmm7,%xmm6,%xmm6 -+ vpmuludq 208(%rsp),%xmm2,%xmm7 -+ vpmuludq 336(%rsp),%xmm3,%xmm11 -+ vpaddq %xmm11,%xmm7,%xmm7 -+ vpmuludq 240(%rsp),%xmm2,%xmm11 -+ vpmuludq 368(%rsp),%xmm3,%xmm13 -+ vpaddq %xmm13,%xmm11,%xmm11 -+ vpmuludq 272(%rsp),%xmm2,%xmm2 -+ vpmuludq 400(%rsp),%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpunpckhqdq %xmm9,%xmm12,%xmm3 -+ vmovdqa %xmm3,16(%rsp) -+ vpshufd $0,%xmm12,%xmm3 -+ vpshufd $0,%xmm9,%xmm9 -+ vpmuludq 288(%rsp),%xmm3,%xmm12 -+ vpaddq %xmm12,%xmm4,%xmm4 -+ vpmuludq 416(%rsp),%xmm9,%xmm12 -+ vpaddq %xmm12,%xmm4,%xmm4 -+ vpmuludq 160(%rsp),%xmm3,%xmm12 -+ vpaddq %xmm12,%xmm6,%xmm6 -+ vpmuludq 432(%rsp),%xmm9,%xmm12 -+ vpaddq %xmm12,%xmm6,%xmm6 -+ vpmuludq 176(%rsp),%xmm3,%xmm12 -+ vpaddq %xmm12,%xmm7,%xmm7 -+ vpmuludq 304(%rsp),%xmm9,%xmm12 -+ vpaddq %xmm12,%xmm7,%xmm7 -+ vpmuludq 208(%rsp),%xmm3,%xmm12 -+ vpaddq %xmm12,%xmm11,%xmm11 -+ vpmuludq 336(%rsp),%xmm9,%xmm12 -+ vpaddq %xmm12,%xmm11,%xmm11 -+ vpmuludq 240(%rsp),%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpmuludq 368(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpunpckhqdq %xmm14,%xmm1,%xmm3 -+ vmovdqa %xmm3,32(%rsp) -+ vpshufd $0,%xmm1,%xmm1 -+ vpshufd $0,%xmm14,%xmm3 -+ vpmuludq 256(%rsp),%xmm1,%xmm9 -+ vpaddq %xmm9,%xmm4,%xmm4 -+ vpmuludq 384(%rsp),%xmm3,%xmm9 -+ vpaddq %xmm9,%xmm4,%xmm4 -+ vpmuludq 288(%rsp),%xmm1,%xmm9 -+ vpaddq %xmm9,%xmm6,%xmm6 -+ vpmuludq 416(%rsp),%xmm3,%xmm9 -+ vpaddq %xmm9,%xmm6,%xmm6 -+ vpmuludq 160(%rsp),%xmm1,%xmm9 -+ vpaddq %xmm9,%xmm7,%xmm7 -+ vpmuludq 432(%rsp),%xmm3,%xmm9 -+ vpaddq %xmm9,%xmm7,%xmm7 -+ vpmuludq 176(%rsp),%xmm1,%xmm9 -+ vpaddq %xmm9,%xmm11,%xmm11 -+ vpmuludq 304(%rsp),%xmm3,%xmm9 -+ vpaddq %xmm9,%xmm11,%xmm11 -+ vpmuludq 208(%rsp),%xmm1,%xmm1 -+ vpaddq %xmm1,%xmm2,%xmm2 -+ vpmuludq 336(%rsp),%xmm3,%xmm1 -+ vpaddq %xmm1,%xmm2,%xmm2 -+ vpunpckhqdq %xmm0,%xmm5,%xmm1 -+ vmovdqa %xmm1,48(%rsp) -+ vpshufd $0,%xmm5,%xmm1 -+ vpshufd $0,%xmm0,%xmm0 -+ vpmuludq 224(%rsp),%xmm1,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 352(%rsp),%xmm0,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 256(%rsp),%xmm1,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 384(%rsp),%xmm0,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 288(%rsp),%xmm1,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq 416(%rsp),%xmm0,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq 160(%rsp),%xmm1,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 432(%rsp),%xmm0,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 176(%rsp),%xmm1,%xmm1 -+ vpaddq %xmm1,%xmm2,%xmm2 -+ vpmuludq 304(%rsp),%xmm0,%xmm0 -+ vpaddq %xmm0,%xmm2,%xmm2 -+ vpunpckhqdq %xmm10,%xmm8,%xmm0 -+ vmovdqa %xmm0,64(%rsp) -+ vpshufd $0,%xmm8,%xmm0 -+ vpshufd $0,%xmm10,%xmm1 -+ vpmuludq 192(%rsp),%xmm0,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 320(%rsp),%xmm1,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 224(%rsp),%xmm0,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 352(%rsp),%xmm1,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 256(%rsp),%xmm0,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq 384(%rsp),%xmm1,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq 288(%rsp),%xmm0,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 416(%rsp),%xmm1,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 160(%rsp),%xmm0,%xmm0 -+ vpaddq %xmm0,%xmm2,%xmm2 -+ vpmuludq 432(%rsp),%xmm1,%xmm0 -+ vpaddq %xmm0,%xmm2,%xmm2 -+ vmovdqa %xmm4,80(%rsp) -+ vmovdqa %xmm6,96(%rsp) -+ vmovdqa %xmm7,112(%rsp) -+ vmovdqa %xmm11,448(%rsp) -+ vmovdqa %xmm2,496(%rsp) -+ vmovdqa 144(%rsp),%xmm0 -+ vpmuludq %xmm0,%xmm0,%xmm1 -+ vpaddq %xmm0,%xmm0,%xmm0 -+ vmovdqa 128(%rsp),%xmm2 -+ vpmuludq %xmm2,%xmm0,%xmm3 -+ vmovdqa 480(%rsp),%xmm4 -+ vpmuludq %xmm4,%xmm0,%xmm5 -+ vmovdqa 464(%rsp),%xmm6 -+ vpmuludq %xmm6,%xmm0,%xmm7 -+ vmovdqa 528(%rsp),%xmm8 -+ vpmuludq %xmm8,%xmm0,%xmm9 -+ vpmuludq 512(%rsp),%xmm0,%xmm10 -+ vpmuludq 592(%rsp),%xmm0,%xmm11 -+ vpmuludq 576(%rsp),%xmm0,%xmm12 -+ vpmuludq 624(%rsp),%xmm0,%xmm13 -+ vmovdqa 672(%rsp),%xmm14 -+ vpmuludq %xmm14,%xmm0,%xmm0 -+ vpmuludq curve25519_sandy2x_v38_38(%rip),%xmm14,%xmm15 -+ vpmuludq %xmm15,%xmm14,%xmm14 -+ vpaddq %xmm14,%xmm13,%xmm13 -+ vpaddq %xmm6,%xmm6,%xmm14 -+ vpmuludq %xmm14,%xmm6,%xmm6 -+ vpaddq %xmm6,%xmm11,%xmm11 -+ vpaddq %xmm2,%xmm2,%xmm6 -+ vpmuludq %xmm6,%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpmuludq %xmm15,%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm1,%xmm1 -+ vpmuludq %xmm15,%xmm4,%xmm2 -+ vpaddq %xmm2,%xmm3,%xmm3 -+ vpmuludq 544(%rsp),%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpmuludq 592(%rsp),%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq 640(%rsp),%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpmuludq 624(%rsp),%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm0,%xmm0 -+ vpmuludq %xmm4,%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpmuludq %xmm14,%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpmuludq %xmm8,%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq %xmm15,%xmm14,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpmuludq %xmm15,%xmm8,%xmm2 -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpmuludq %xmm4,%xmm4,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpmuludq %xmm14,%xmm4,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpaddq %xmm4,%xmm4,%xmm2 -+ vpmuludq %xmm8,%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm11,%xmm11 -+ vpmuludq 688(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vpmuludq 688(%rsp),%xmm14,%xmm4 -+ vpaddq %xmm4,%xmm3,%xmm3 -+ vpmuludq 512(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm12,%xmm12 -+ vpmuludq 592(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm13,%xmm13 -+ vpmuludq 576(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm0,%xmm0 -+ vpmuludq 656(%rsp),%xmm8,%xmm2 -+ vpaddq %xmm2,%xmm3,%xmm3 -+ vpmuludq %xmm8,%xmm14,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq %xmm8,%xmm8,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpaddq %xmm8,%xmm8,%xmm2 -+ vpmuludq 688(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm5,%xmm5 -+ vpmuludq 544(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm9,%xmm9 -+ vpmuludq 592(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm10,%xmm10 -+ vpmuludq 656(%rsp),%xmm14,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vmovdqa 544(%rsp),%xmm4 -+ vpmuludq 688(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm7,%xmm7 -+ vpmuludq 544(%rsp),%xmm14,%xmm4 -+ vpaddq %xmm4,%xmm13,%xmm13 -+ vpmuludq 592(%rsp),%xmm14,%xmm4 -+ vpaddq %xmm4,%xmm0,%xmm0 -+ vpmuludq 640(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm11,%xmm11 -+ vpmuludq 624(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm12,%xmm12 -+ vmovdqa 592(%rsp),%xmm4 -+ vpaddq %xmm4,%xmm4,%xmm4 -+ vpmuludq 688(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm9,%xmm9 -+ vpmuludq 608(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vmovdqa 544(%rsp),%xmm4 -+ vpmuludq 608(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm3,%xmm3 -+ vmovdqa 544(%rsp),%xmm4 -+ vpmuludq 656(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm5,%xmm5 -+ vmovdqa 592(%rsp),%xmm4 -+ vpmuludq 656(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm7,%xmm7 -+ vmovdqa 640(%rsp),%xmm4 -+ vpmuludq 688(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm10,%xmm10 -+ vpmuludq 512(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm0,%xmm0 -+ vmovdqa 560(%rsp),%xmm2 -+ vpmuludq 512(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm1,%xmm1 -+ vmovdqa 608(%rsp),%xmm2 -+ vpmuludq 592(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vmovdqa 656(%rsp),%xmm2 -+ vpmuludq 576(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vmovdqa 688(%rsp),%xmm2 -+ vpmuludq 624(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpsrlq $26,%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm3,%xmm3 -+ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 -+ vpsrlq $25,%xmm10,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 -+ vpsrlq $25,%xmm3,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m25(%rip),%xmm3,%xmm3 -+ vpsrlq $26,%xmm11,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 -+ vpsrlq $26,%xmm5,%xmm2 -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpand curve25519_sandy2x_m26(%rip),%xmm5,%xmm5 -+ vpsrlq $25,%xmm12,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpand curve25519_sandy2x_m25(%rip),%xmm12,%xmm12 -+ vpsrlq $25,%xmm7,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpand curve25519_sandy2x_m25(%rip),%xmm7,%xmm7 -+ vpsrlq $26,%xmm13,%xmm2 -+ vpaddq %xmm2,%xmm0,%xmm0 -+ vpand curve25519_sandy2x_m26(%rip),%xmm13,%xmm13 -+ vpsrlq $26,%xmm9,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpand curve25519_sandy2x_m26(%rip),%xmm9,%xmm9 -+ vpsrlq $25,%xmm0,%xmm2 -+ vpsllq $4,%xmm2,%xmm4 -+ vpaddq %xmm2,%xmm1,%xmm1 -+ vpsllq $1,%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vpand curve25519_sandy2x_m25(%rip),%xmm0,%xmm0 -+ vpsrlq $25,%xmm10,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 -+ vpsrlq $26,%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm3,%xmm3 -+ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 -+ vpunpckhqdq %xmm3,%xmm1,%xmm2 -+ vpunpcklqdq %xmm3,%xmm1,%xmm1 -+ vmovdqa %xmm1,464(%rsp) -+ vpaddq curve25519_sandy2x_subc0(%rip),%xmm2,%xmm3 -+ vpsubq %xmm1,%xmm3,%xmm3 -+ vpunpckhqdq %xmm3,%xmm2,%xmm1 -+ vpunpcklqdq %xmm3,%xmm2,%xmm2 -+ vmovdqa %xmm2,480(%rsp) -+ vmovdqa %xmm1,512(%rsp) -+ vpsllq $1,%xmm1,%xmm1 -+ vmovdqa %xmm1,528(%rsp) -+ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm3,%xmm3 -+ vmovdqa 80(%rsp),%xmm1 -+ vpunpcklqdq %xmm1,%xmm3,%xmm2 -+ vpunpckhqdq %xmm1,%xmm3,%xmm1 -+ vpunpckhqdq %xmm7,%xmm5,%xmm3 -+ vpunpcklqdq %xmm7,%xmm5,%xmm4 -+ vmovdqa %xmm4,544(%rsp) -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm5 -+ vpsubq %xmm4,%xmm5,%xmm5 -+ vpunpckhqdq %xmm5,%xmm3,%xmm4 -+ vpunpcklqdq %xmm5,%xmm3,%xmm3 -+ vmovdqa %xmm3,560(%rsp) -+ vmovdqa %xmm4,576(%rsp) -+ vpsllq $1,%xmm4,%xmm4 -+ vmovdqa %xmm4,592(%rsp) -+ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm5,%xmm5 -+ vmovdqa 96(%rsp),%xmm3 -+ vpunpcklqdq %xmm3,%xmm5,%xmm4 -+ vpunpckhqdq %xmm3,%xmm5,%xmm3 -+ vpunpckhqdq %xmm10,%xmm9,%xmm5 -+ vpunpcklqdq %xmm10,%xmm9,%xmm6 -+ vmovdqa %xmm6,608(%rsp) -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm5,%xmm7 -+ vpsubq %xmm6,%xmm7,%xmm7 -+ vpunpckhqdq %xmm7,%xmm5,%xmm6 -+ vpunpcklqdq %xmm7,%xmm5,%xmm5 -+ vmovdqa %xmm5,624(%rsp) -+ vmovdqa %xmm6,640(%rsp) -+ vpsllq $1,%xmm6,%xmm6 -+ vmovdqa %xmm6,656(%rsp) -+ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm7,%xmm7 -+ vmovdqa 112(%rsp),%xmm5 -+ vpunpcklqdq %xmm5,%xmm7,%xmm6 -+ vpunpckhqdq %xmm5,%xmm7,%xmm5 -+ vpunpckhqdq %xmm12,%xmm11,%xmm7 -+ vpunpcklqdq %xmm12,%xmm11,%xmm8 -+ vmovdqa %xmm8,672(%rsp) -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm7,%xmm9 -+ vpsubq %xmm8,%xmm9,%xmm9 -+ vpunpckhqdq %xmm9,%xmm7,%xmm8 -+ vpunpcklqdq %xmm9,%xmm7,%xmm7 -+ vmovdqa %xmm7,688(%rsp) -+ vmovdqa %xmm8,704(%rsp) -+ vpsllq $1,%xmm8,%xmm8 -+ vmovdqa %xmm8,720(%rsp) -+ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm9,%xmm9 -+ vmovdqa 448(%rsp),%xmm7 -+ vpunpcklqdq %xmm7,%xmm9,%xmm8 -+ vpunpckhqdq %xmm7,%xmm9,%xmm7 -+ vpunpckhqdq %xmm0,%xmm13,%xmm9 -+ vpunpcklqdq %xmm0,%xmm13,%xmm0 -+ vmovdqa %xmm0,448(%rsp) -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm9,%xmm10 -+ vpsubq %xmm0,%xmm10,%xmm10 -+ vpunpckhqdq %xmm10,%xmm9,%xmm0 -+ vpunpcklqdq %xmm10,%xmm9,%xmm9 -+ vmovdqa %xmm9,736(%rsp) -+ vmovdqa %xmm0,752(%rsp) -+ vpsllq $1,%xmm0,%xmm0 -+ vmovdqa %xmm0,768(%rsp) -+ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm10,%xmm10 -+ vmovdqa 496(%rsp),%xmm0 -+ vpunpcklqdq %xmm0,%xmm10,%xmm9 -+ vpunpckhqdq %xmm0,%xmm10,%xmm0 -+ vpsrlq $26,%xmm2,%xmm10 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ vpand curve25519_sandy2x_m26(%rip),%xmm2,%xmm2 -+ vpsrlq $25,%xmm5,%xmm10 -+ vpaddq %xmm10,%xmm8,%xmm8 -+ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 -+ vpsrlq $25,%xmm1,%xmm10 -+ vpaddq %xmm10,%xmm4,%xmm4 -+ vpand curve25519_sandy2x_m25(%rip),%xmm1,%xmm1 -+ vpsrlq $26,%xmm8,%xmm10 -+ vpaddq %xmm10,%xmm7,%xmm7 -+ vpand curve25519_sandy2x_m26(%rip),%xmm8,%xmm8 -+ vpsrlq $26,%xmm4,%xmm10 -+ vpaddq %xmm10,%xmm3,%xmm3 -+ vpand curve25519_sandy2x_m26(%rip),%xmm4,%xmm4 -+ vpsrlq $25,%xmm7,%xmm10 -+ vpaddq %xmm10,%xmm9,%xmm9 -+ vpand curve25519_sandy2x_m25(%rip),%xmm7,%xmm7 -+ vpsrlq $25,%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm6,%xmm6 -+ vpand curve25519_sandy2x_m25(%rip),%xmm3,%xmm3 -+ vpsrlq $26,%xmm9,%xmm10 -+ vpaddq %xmm10,%xmm0,%xmm0 -+ vpand curve25519_sandy2x_m26(%rip),%xmm9,%xmm9 -+ vpsrlq $26,%xmm6,%xmm10 -+ vpaddq %xmm10,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 -+ vpsrlq $25,%xmm0,%xmm10 -+ vpsllq $4,%xmm10,%xmm11 -+ vpaddq %xmm10,%xmm2,%xmm2 -+ vpsllq $1,%xmm10,%xmm10 -+ vpaddq %xmm10,%xmm11,%xmm11 -+ vpaddq %xmm11,%xmm2,%xmm2 -+ vpand curve25519_sandy2x_m25(%rip),%xmm0,%xmm0 -+ vpsrlq $25,%xmm5,%xmm10 -+ vpaddq %xmm10,%xmm8,%xmm8 -+ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 -+ vpsrlq $26,%xmm2,%xmm10 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ vpand curve25519_sandy2x_m26(%rip),%xmm2,%xmm2 -+ vpunpckhqdq %xmm1,%xmm2,%xmm10 -+ vmovdqa %xmm10,80(%rsp) -+ vpunpcklqdq %xmm1,%xmm2,%xmm1 -+ vpunpckhqdq %xmm3,%xmm4,%xmm2 -+ vmovdqa %xmm2,96(%rsp) -+ vpunpcklqdq %xmm3,%xmm4,%xmm2 -+ vpunpckhqdq %xmm5,%xmm6,%xmm3 -+ vmovdqa %xmm3,112(%rsp) -+ vpunpcklqdq %xmm5,%xmm6,%xmm3 -+ vpunpckhqdq %xmm7,%xmm8,%xmm4 -+ vmovdqa %xmm4,128(%rsp) -+ vpunpcklqdq %xmm7,%xmm8,%xmm4 -+ vpunpckhqdq %xmm0,%xmm9,%xmm5 -+ vmovdqa %xmm5,144(%rsp) -+ vpunpcklqdq %xmm0,%xmm9,%xmm0 -+ vmovdqa 464(%rsp),%xmm5 -+ vpaddq %xmm5,%xmm1,%xmm1 -+ vpunpcklqdq %xmm1,%xmm5,%xmm6 -+ vpunpckhqdq %xmm1,%xmm5,%xmm1 -+ vpmuludq 512(%rsp),%xmm6,%xmm5 -+ vpmuludq 480(%rsp),%xmm1,%xmm7 -+ vpaddq %xmm7,%xmm5,%xmm5 -+ vpmuludq 560(%rsp),%xmm6,%xmm7 -+ vpmuludq 528(%rsp),%xmm1,%xmm8 -+ vpaddq %xmm8,%xmm7,%xmm7 -+ vpmuludq 576(%rsp),%xmm6,%xmm8 -+ vpmuludq 560(%rsp),%xmm1,%xmm9 -+ vpaddq %xmm9,%xmm8,%xmm8 -+ vpmuludq 624(%rsp),%xmm6,%xmm9 -+ vpmuludq 592(%rsp),%xmm1,%xmm10 -+ vpaddq %xmm10,%xmm9,%xmm9 -+ vpmuludq 640(%rsp),%xmm6,%xmm10 -+ vpmuludq 624(%rsp),%xmm1,%xmm11 -+ vpaddq %xmm11,%xmm10,%xmm10 -+ vpmuludq 688(%rsp),%xmm6,%xmm11 -+ vpmuludq 656(%rsp),%xmm1,%xmm12 -+ vpaddq %xmm12,%xmm11,%xmm11 -+ vpmuludq 704(%rsp),%xmm6,%xmm12 -+ vpmuludq 688(%rsp),%xmm1,%xmm13 -+ vpaddq %xmm13,%xmm12,%xmm12 -+ vpmuludq 736(%rsp),%xmm6,%xmm13 -+ vpmuludq 720(%rsp),%xmm1,%xmm14 -+ vpaddq %xmm14,%xmm13,%xmm13 -+ vpmuludq 752(%rsp),%xmm6,%xmm14 -+ vpmuludq 736(%rsp),%xmm1,%xmm15 -+ vpaddq %xmm15,%xmm14,%xmm14 -+ vpmuludq 480(%rsp),%xmm6,%xmm6 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 -+ vpmuludq 768(%rsp),%xmm1,%xmm1 -+ vpaddq %xmm1,%xmm6,%xmm6 -+ vmovdqa 544(%rsp),%xmm1 -+ vpaddq %xmm1,%xmm2,%xmm2 -+ vpunpcklqdq %xmm2,%xmm1,%xmm15 -+ vpunpckhqdq %xmm2,%xmm1,%xmm1 -+ vpmuludq 480(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpmuludq 512(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpmuludq 560(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpmuludq 576(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq 624(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpmuludq 640(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq 688(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpmuludq 704(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm15,%xmm15 -+ vpmuludq 736(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm6,%xmm6 -+ vpmuludq 752(%rsp),%xmm15,%xmm15 -+ vpaddq %xmm15,%xmm5,%xmm5 -+ vpmuludq 480(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpmuludq 528(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpmuludq 560(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq 592(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpmuludq 624(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq 656(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpmuludq 688(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 -+ vpmuludq 720(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm6,%xmm6 -+ vpmuludq 736(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpmuludq 768(%rsp),%xmm1,%xmm1 -+ vpaddq %xmm1,%xmm7,%xmm7 -+ vmovdqa 608(%rsp),%xmm1 -+ vpaddq %xmm1,%xmm3,%xmm3 -+ vpunpcklqdq %xmm3,%xmm1,%xmm2 -+ vpunpckhqdq %xmm3,%xmm1,%xmm1 -+ vpmuludq 480(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm9,%xmm9 -+ vpmuludq 512(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm10,%xmm10 -+ vpmuludq 560(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 576(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm12,%xmm12 -+ vpmuludq 624(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 640(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm2,%xmm2 -+ vpmuludq 688(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 704(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 736(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq 752(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpmuludq 480(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq 528(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpmuludq 560(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq 592(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpmuludq 624(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 -+ vpmuludq 656(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm6,%xmm6 -+ vpmuludq 688(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpmuludq 720(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpmuludq 736(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpmuludq 768(%rsp),%xmm1,%xmm1 -+ vpaddq %xmm1,%xmm9,%xmm9 -+ vmovdqa 672(%rsp),%xmm1 -+ vpaddq %xmm1,%xmm4,%xmm4 -+ vpunpcklqdq %xmm4,%xmm1,%xmm2 -+ vpunpckhqdq %xmm4,%xmm1,%xmm1 -+ vpmuludq 480(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 512(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm12,%xmm12 -+ vpmuludq 560(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 576(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm2,%xmm2 -+ vpmuludq 624(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 640(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 688(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq 704(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm8,%xmm8 -+ vpmuludq 736(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm9,%xmm9 -+ vpmuludq 752(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq 480(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq 528(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpmuludq 560(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 -+ vpmuludq 592(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm6,%xmm6 -+ vpmuludq 624(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpmuludq 656(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpmuludq 688(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpmuludq 720(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpmuludq 736(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq 768(%rsp),%xmm1,%xmm1 -+ vpaddq %xmm1,%xmm11,%xmm11 -+ vmovdqa 448(%rsp),%xmm1 -+ vpaddq %xmm1,%xmm0,%xmm0 -+ vpunpcklqdq %xmm0,%xmm1,%xmm2 -+ vpunpckhqdq %xmm0,%xmm1,%xmm0 -+ vpmuludq 480(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm13,%xmm13 -+ vpmuludq 512(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm2,%xmm2 -+ vpmuludq 560(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm6,%xmm6 -+ vpmuludq 576(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm5,%xmm5 -+ vpmuludq 624(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm7,%xmm7 -+ vpmuludq 640(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm8,%xmm8 -+ vpmuludq 688(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm9,%xmm9 -+ vpmuludq 704(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm10,%xmm10 -+ vpmuludq 736(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm11,%xmm11 -+ vpmuludq 752(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq 480(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm0,%xmm0 -+ vpmuludq 528(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm6,%xmm6 -+ vpmuludq 560(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm5,%xmm5 -+ vpmuludq 592(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm7,%xmm7 -+ vpmuludq 624(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm8,%xmm8 -+ vpmuludq 656(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm9,%xmm9 -+ vpmuludq 688(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm10,%xmm10 -+ vpmuludq 720(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm11,%xmm11 -+ vpmuludq 736(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm12,%xmm12 -+ vpmuludq 768(%rsp),%xmm0,%xmm0 -+ vpaddq %xmm0,%xmm13,%xmm13 -+ vpsrlq $26,%xmm6,%xmm0 -+ vpaddq %xmm0,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 -+ vpsrlq $25,%xmm10,%xmm0 -+ vpaddq %xmm0,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 -+ vpsrlq $25,%xmm5,%xmm0 -+ vpaddq %xmm0,%xmm7,%xmm7 -+ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 -+ vpsrlq $26,%xmm11,%xmm0 -+ vpaddq %xmm0,%xmm12,%xmm12 -+ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 -+ vpsrlq $26,%xmm7,%xmm0 -+ vpaddq %xmm0,%xmm8,%xmm8 -+ vpand curve25519_sandy2x_m26(%rip),%xmm7,%xmm7 -+ vpsrlq $25,%xmm12,%xmm0 -+ vpaddq %xmm0,%xmm13,%xmm13 -+ vpand curve25519_sandy2x_m25(%rip),%xmm12,%xmm12 -+ vpsrlq $25,%xmm8,%xmm0 -+ vpaddq %xmm0,%xmm9,%xmm9 -+ vpand curve25519_sandy2x_m25(%rip),%xmm8,%xmm8 -+ vpsrlq $26,%xmm13,%xmm0 -+ vpaddq %xmm0,%xmm14,%xmm14 -+ vpand curve25519_sandy2x_m26(%rip),%xmm13,%xmm13 -+ vpsrlq $26,%xmm9,%xmm0 -+ vpaddq %xmm0,%xmm10,%xmm10 -+ vpand curve25519_sandy2x_m26(%rip),%xmm9,%xmm9 -+ vpsrlq $25,%xmm14,%xmm0 -+ vpsllq $4,%xmm0,%xmm1 -+ vpaddq %xmm0,%xmm6,%xmm6 -+ vpsllq $1,%xmm0,%xmm0 -+ vpaddq %xmm0,%xmm1,%xmm1 -+ vpaddq %xmm1,%xmm6,%xmm6 -+ vpand curve25519_sandy2x_m25(%rip),%xmm14,%xmm14 -+ vpsrlq $25,%xmm10,%xmm0 -+ vpaddq %xmm0,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 -+ vpsrlq $26,%xmm6,%xmm0 -+ vpaddq %xmm0,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 -+ vpunpckhqdq %xmm5,%xmm6,%xmm1 -+ vpunpcklqdq %xmm5,%xmm6,%xmm0 -+ vpunpckhqdq %xmm8,%xmm7,%xmm3 -+ vpunpcklqdq %xmm8,%xmm7,%xmm2 -+ vpunpckhqdq %xmm10,%xmm9,%xmm5 -+ vpunpcklqdq %xmm10,%xmm9,%xmm4 -+ vpunpckhqdq %xmm12,%xmm11,%xmm7 -+ vpunpcklqdq %xmm12,%xmm11,%xmm6 -+ vpunpckhqdq %xmm14,%xmm13,%xmm9 -+ vpunpcklqdq %xmm14,%xmm13,%xmm8 -+ cmp $0,%rdx -+ jne .Lladder_loop -+ vmovdqu %xmm1,160(%rdi) -+ vmovdqu %xmm0,80(%rdi) -+ vmovdqu %xmm3,176(%rdi) -+ vmovdqu %xmm2,96(%rdi) -+ vmovdqu %xmm5,192(%rdi) -+ vmovdqu %xmm4,112(%rdi) -+ vmovdqu %xmm7,208(%rdi) -+ vmovdqu %xmm6,128(%rdi) -+ vmovdqu %xmm9,224(%rdi) -+ vmovdqu %xmm8,144(%rdi) -+ movq 1824(%rsp),%r11 -+ movq 1832(%rsp),%r12 -+ movq 1840(%rsp),%r13 -+ movq 1848(%rsp),%r14 -+ leave -+ ret -+ENDPROC(curve25519_sandy2x_ladder) -+ -+.align 32 -+ENTRY(curve25519_sandy2x_ladder_base) -+ push %rbp -+ mov %rsp,%rbp -+ sub $1568,%rsp -+ and $-32,%rsp -+ movq %r11,1536(%rsp) -+ movq %r12,1544(%rsp) -+ movq %r13,1552(%rsp) -+ vmovdqa curve25519_sandy2x_v0_0(%rip),%xmm0 -+ vmovdqa curve25519_sandy2x_v1_0(%rip),%xmm1 -+ vmovdqa curve25519_sandy2x_v9_0(%rip),%xmm2 -+ vmovdqa %xmm2,0(%rsp) -+ vmovdqa %xmm0,16(%rsp) -+ vmovdqa %xmm0,32(%rsp) -+ vmovdqa %xmm0,48(%rsp) -+ vmovdqa %xmm0,64(%rsp) -+ vmovdqa %xmm1,80(%rsp) -+ vmovdqa %xmm0,96(%rsp) -+ vmovdqa %xmm0,112(%rsp) -+ vmovdqa %xmm0,128(%rsp) -+ vmovdqa %xmm0,144(%rsp) -+ vmovdqa %xmm1,%xmm0 -+ vpxor %xmm1,%xmm1,%xmm1 -+ vpxor %xmm2,%xmm2,%xmm2 -+ vpxor %xmm3,%xmm3,%xmm3 -+ vpxor %xmm4,%xmm4,%xmm4 -+ vpxor %xmm5,%xmm5,%xmm5 -+ vpxor %xmm6,%xmm6,%xmm6 -+ vpxor %xmm7,%xmm7,%xmm7 -+ vpxor %xmm8,%xmm8,%xmm8 -+ vpxor %xmm9,%xmm9,%xmm9 -+ movq 0(%rsi),%rdx -+ movq 8(%rsi),%rcx -+ movq 16(%rsi),%r8 -+ movq 24(%rsi),%r9 -+ shrd $1,%rcx,%rdx -+ shrd $1,%r8,%rcx -+ shrd $1,%r9,%r8 -+ shr $1,%r9 -+ xorq 0(%rsi),%rdx -+ xorq 8(%rsi),%rcx -+ xorq 16(%rsi),%r8 -+ xorq 24(%rsi),%r9 -+ leaq 512(%rsp),%rsi -+ mov $64,%rax -+ -+ .align 16 -+ .Lladder_base_small_loop: -+ mov %rdx,%r10 -+ mov %rcx,%r11 -+ mov %r8,%r12 -+ mov %r9,%r13 -+ shr $1,%rdx -+ shr $1,%rcx -+ shr $1,%r8 -+ shr $1,%r9 -+ and $1,%r10d -+ and $1,%r11d -+ and $1,%r12d -+ and $1,%r13d -+ neg %r10 -+ neg %r11 -+ neg %r12 -+ neg %r13 -+ movl %r10d,0(%rsi) -+ movl %r11d,256(%rsi) -+ movl %r12d,512(%rsi) -+ movl %r13d,768(%rsi) -+ add $4,%rsi -+ sub $1,%rax -+ jne .Lladder_base_small_loop -+ mov $255,%rdx -+ add $760,%rsi -+ -+ .align 16 -+ .Lladder_base_loop: -+ sub $1,%rdx -+ vbroadcastss 0(%rsi),%xmm10 -+ sub $4,%rsi -+ vmovdqa 0(%rsp),%xmm11 -+ vmovdqa 80(%rsp),%xmm12 -+ vpxor %xmm11,%xmm0,%xmm13 -+ vpand %xmm10,%xmm13,%xmm13 -+ vpxor %xmm13,%xmm0,%xmm0 -+ vpxor %xmm13,%xmm11,%xmm11 -+ vpxor %xmm12,%xmm1,%xmm13 -+ vpand %xmm10,%xmm13,%xmm13 -+ vpxor %xmm13,%xmm1,%xmm1 -+ vpxor %xmm13,%xmm12,%xmm12 -+ vmovdqa 16(%rsp),%xmm13 -+ vmovdqa 96(%rsp),%xmm14 -+ vpxor %xmm13,%xmm2,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm2,%xmm2 -+ vpxor %xmm15,%xmm13,%xmm13 -+ vpxor %xmm14,%xmm3,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm3,%xmm3 -+ vpxor %xmm15,%xmm14,%xmm14 -+ vmovdqa %xmm13,0(%rsp) -+ vmovdqa %xmm14,16(%rsp) -+ vmovdqa 32(%rsp),%xmm13 -+ vmovdqa 112(%rsp),%xmm14 -+ vpxor %xmm13,%xmm4,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm4,%xmm4 -+ vpxor %xmm15,%xmm13,%xmm13 -+ vpxor %xmm14,%xmm5,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm5,%xmm5 -+ vpxor %xmm15,%xmm14,%xmm14 -+ vmovdqa %xmm13,32(%rsp) -+ vmovdqa %xmm14,80(%rsp) -+ vmovdqa 48(%rsp),%xmm13 -+ vmovdqa 128(%rsp),%xmm14 -+ vpxor %xmm13,%xmm6,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm6,%xmm6 -+ vpxor %xmm15,%xmm13,%xmm13 -+ vpxor %xmm14,%xmm7,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm7,%xmm7 -+ vpxor %xmm15,%xmm14,%xmm14 -+ vmovdqa %xmm13,48(%rsp) -+ vmovdqa %xmm14,96(%rsp) -+ vmovdqa 64(%rsp),%xmm13 -+ vmovdqa 144(%rsp),%xmm14 -+ vpxor %xmm13,%xmm8,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm8,%xmm8 -+ vpxor %xmm15,%xmm13,%xmm13 -+ vpxor %xmm14,%xmm9,%xmm15 -+ vpand %xmm10,%xmm15,%xmm15 -+ vpxor %xmm15,%xmm9,%xmm9 -+ vpxor %xmm15,%xmm14,%xmm14 -+ vmovdqa %xmm13,64(%rsp) -+ vmovdqa %xmm14,112(%rsp) -+ vpaddq curve25519_sandy2x_subc0(%rip),%xmm11,%xmm10 -+ vpsubq %xmm12,%xmm10,%xmm10 -+ vpaddq %xmm12,%xmm11,%xmm11 -+ vpunpckhqdq %xmm10,%xmm11,%xmm12 -+ vpunpcklqdq %xmm10,%xmm11,%xmm10 -+ vpaddq %xmm1,%xmm0,%xmm11 -+ vpaddq curve25519_sandy2x_subc0(%rip),%xmm0,%xmm0 -+ vpsubq %xmm1,%xmm0,%xmm0 -+ vpunpckhqdq %xmm11,%xmm0,%xmm1 -+ vpunpcklqdq %xmm11,%xmm0,%xmm0 -+ vpmuludq %xmm0,%xmm10,%xmm11 -+ vpmuludq %xmm1,%xmm10,%xmm13 -+ vmovdqa %xmm1,128(%rsp) -+ vpaddq %xmm1,%xmm1,%xmm1 -+ vpmuludq %xmm0,%xmm12,%xmm14 -+ vmovdqa %xmm0,144(%rsp) -+ vpaddq %xmm14,%xmm13,%xmm13 -+ vpmuludq %xmm1,%xmm12,%xmm0 -+ vmovdqa %xmm1,160(%rsp) -+ vpaddq %xmm3,%xmm2,%xmm1 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm2,%xmm2 -+ vpsubq %xmm3,%xmm2,%xmm2 -+ vpunpckhqdq %xmm1,%xmm2,%xmm3 -+ vpunpcklqdq %xmm1,%xmm2,%xmm1 -+ vpmuludq %xmm1,%xmm10,%xmm2 -+ vpaddq %xmm2,%xmm0,%xmm0 -+ vpmuludq %xmm3,%xmm10,%xmm2 -+ vmovdqa %xmm3,176(%rsp) -+ vpaddq %xmm3,%xmm3,%xmm3 -+ vpmuludq %xmm1,%xmm12,%xmm14 -+ vmovdqa %xmm1,192(%rsp) -+ vpaddq %xmm14,%xmm2,%xmm2 -+ vpmuludq %xmm3,%xmm12,%xmm1 -+ vmovdqa %xmm3,208(%rsp) -+ vpaddq %xmm5,%xmm4,%xmm3 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm4,%xmm4 -+ vpsubq %xmm5,%xmm4,%xmm4 -+ vpunpckhqdq %xmm3,%xmm4,%xmm5 -+ vpunpcklqdq %xmm3,%xmm4,%xmm3 -+ vpmuludq %xmm3,%xmm10,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vpmuludq %xmm5,%xmm10,%xmm4 -+ vmovdqa %xmm5,224(%rsp) -+ vpaddq %xmm5,%xmm5,%xmm5 -+ vpmuludq %xmm3,%xmm12,%xmm14 -+ vmovdqa %xmm3,240(%rsp) -+ vpaddq %xmm14,%xmm4,%xmm4 -+ vpaddq %xmm7,%xmm6,%xmm3 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm6,%xmm6 -+ vpsubq %xmm7,%xmm6,%xmm6 -+ vpunpckhqdq %xmm3,%xmm6,%xmm7 -+ vpunpcklqdq %xmm3,%xmm6,%xmm3 -+ vpmuludq %xmm3,%xmm10,%xmm6 -+ vpmuludq %xmm5,%xmm12,%xmm14 -+ vmovdqa %xmm5,256(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm5,%xmm5 -+ vmovdqa %xmm5,272(%rsp) -+ vpaddq %xmm14,%xmm6,%xmm6 -+ vpmuludq %xmm7,%xmm10,%xmm5 -+ vmovdqa %xmm7,288(%rsp) -+ vpaddq %xmm7,%xmm7,%xmm7 -+ vpmuludq %xmm3,%xmm12,%xmm14 -+ vmovdqa %xmm3,304(%rsp) -+ vpaddq %xmm14,%xmm5,%xmm5 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 -+ vmovdqa %xmm3,320(%rsp) -+ vpaddq %xmm9,%xmm8,%xmm3 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm8,%xmm8 -+ vpsubq %xmm9,%xmm8,%xmm8 -+ vpunpckhqdq %xmm3,%xmm8,%xmm9 -+ vpunpcklqdq %xmm3,%xmm8,%xmm3 -+ vmovdqa %xmm3,336(%rsp) -+ vpmuludq %xmm7,%xmm12,%xmm8 -+ vmovdqa %xmm7,352(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm7,%xmm7 -+ vmovdqa %xmm7,368(%rsp) -+ vpmuludq %xmm3,%xmm10,%xmm7 -+ vpaddq %xmm7,%xmm8,%xmm8 -+ vpmuludq %xmm9,%xmm10,%xmm7 -+ vmovdqa %xmm9,384(%rsp) -+ vpaddq %xmm9,%xmm9,%xmm9 -+ vpmuludq %xmm3,%xmm12,%xmm10 -+ vpaddq %xmm10,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 -+ vmovdqa %xmm3,400(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm12,%xmm12 -+ vpmuludq %xmm9,%xmm12,%xmm3 -+ vmovdqa %xmm9,416(%rsp) -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vmovdqa 0(%rsp),%xmm3 -+ vmovdqa 16(%rsp),%xmm9 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 -+ vpsubq %xmm9,%xmm10,%xmm10 -+ vpaddq %xmm9,%xmm3,%xmm3 -+ vpunpckhqdq %xmm10,%xmm3,%xmm9 -+ vpunpcklqdq %xmm10,%xmm3,%xmm3 -+ vpmuludq 144(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm0,%xmm0 -+ vpmuludq 128(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm2,%xmm2 -+ vpmuludq 192(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ vpmuludq 176(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm4,%xmm4 -+ vpmuludq 240(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm6,%xmm6 -+ vpmuludq 224(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm5,%xmm5 -+ vpmuludq 304(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm8,%xmm8 -+ vpmuludq 288(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 -+ vpmuludq 336(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm11,%xmm11 -+ vpmuludq 384(%rsp),%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 144(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpmuludq 160(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm1,%xmm1 -+ vpmuludq 192(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 208(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 240(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 256(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm8,%xmm8 -+ vpmuludq 304(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 -+ vpmuludq 352(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 336(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 416(%rsp),%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm0,%xmm0 -+ vmovdqa 32(%rsp),%xmm3 -+ vmovdqa 80(%rsp),%xmm9 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 -+ vpsubq %xmm9,%xmm10,%xmm10 -+ vpaddq %xmm9,%xmm3,%xmm3 -+ vpunpckhqdq %xmm10,%xmm3,%xmm9 -+ vpunpcklqdq %xmm10,%xmm3,%xmm3 -+ vpmuludq 144(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ vpmuludq 128(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm4,%xmm4 -+ vpmuludq 192(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm6,%xmm6 -+ vpmuludq 176(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm5,%xmm5 -+ vpmuludq 240(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm8,%xmm8 -+ vpmuludq 224(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 -+ vpmuludq 304(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm11,%xmm11 -+ vpmuludq 288(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm13,%xmm13 -+ vpmuludq 336(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm0,%xmm0 -+ vpmuludq 384(%rsp),%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpmuludq 144(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 160(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 192(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 208(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm8,%xmm8 -+ vpmuludq 240(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 -+ vpmuludq 256(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 304(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 352(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm0,%xmm0 -+ vpmuludq 336(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpmuludq 416(%rsp),%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm1,%xmm1 -+ vmovdqa 48(%rsp),%xmm3 -+ vmovdqa 96(%rsp),%xmm9 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 -+ vpsubq %xmm9,%xmm10,%xmm10 -+ vpaddq %xmm9,%xmm3,%xmm3 -+ vpunpckhqdq %xmm10,%xmm3,%xmm9 -+ vpunpcklqdq %xmm10,%xmm3,%xmm3 -+ vpmuludq 144(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm6,%xmm6 -+ vpmuludq 128(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm5,%xmm5 -+ vpmuludq 192(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm8,%xmm8 -+ vpmuludq 176(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 -+ vpmuludq 240(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm11,%xmm11 -+ vpmuludq 224(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm13,%xmm13 -+ vpmuludq 304(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm0,%xmm0 -+ vpmuludq 288(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm2,%xmm2 -+ vpmuludq 336(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ vpmuludq 384(%rsp),%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 144(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 160(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm8,%xmm8 -+ vpmuludq 192(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 -+ vpmuludq 208(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 240(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 256(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm0,%xmm0 -+ vpmuludq 304(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpmuludq 352(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm1,%xmm1 -+ vpmuludq 336(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 416(%rsp),%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm6,%xmm6 -+ vmovdqa 64(%rsp),%xmm3 -+ vmovdqa 112(%rsp),%xmm9 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm10 -+ vpsubq %xmm9,%xmm10,%xmm10 -+ vpaddq %xmm9,%xmm3,%xmm3 -+ vpunpckhqdq %xmm10,%xmm3,%xmm9 -+ vpunpcklqdq %xmm10,%xmm3,%xmm3 -+ vpmuludq 144(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm8,%xmm8 -+ vpmuludq 128(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm3,%xmm3 -+ vpmuludq 192(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm11,%xmm11 -+ vpmuludq 176(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm13,%xmm13 -+ vpmuludq 240(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm0,%xmm0 -+ vpmuludq 224(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm2,%xmm2 -+ vpmuludq 304(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ vpmuludq 288(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm4,%xmm4 -+ vpmuludq 336(%rsp),%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm6,%xmm6 -+ vpmuludq 384(%rsp),%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 144(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm9,%xmm9 -+ vpmuludq 160(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 192(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 208(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm0,%xmm0 -+ vpmuludq 240(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpmuludq 256(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm1,%xmm1 -+ vpmuludq 304(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpmuludq 352(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 336(%rsp),%xmm9,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 416(%rsp),%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm8,%xmm8 -+ vpsrlq $25,%xmm4,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpand curve25519_sandy2x_m25(%rip),%xmm4,%xmm4 -+ vpsrlq $26,%xmm11,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 -+ vpsrlq $26,%xmm6,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 -+ vpsrlq $25,%xmm13,%xmm3 -+ vpaddq %xmm3,%xmm0,%xmm0 -+ vpand curve25519_sandy2x_m25(%rip),%xmm13,%xmm13 -+ vpsrlq $25,%xmm5,%xmm3 -+ vpaddq %xmm3,%xmm8,%xmm8 -+ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 -+ vpsrlq $26,%xmm0,%xmm3 -+ vpaddq %xmm3,%xmm2,%xmm2 -+ vpand curve25519_sandy2x_m26(%rip),%xmm0,%xmm0 -+ vpsrlq $26,%xmm8,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpand curve25519_sandy2x_m26(%rip),%xmm8,%xmm8 -+ vpsrlq $25,%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm1,%xmm1 -+ vpand curve25519_sandy2x_m25(%rip),%xmm2,%xmm2 -+ vpsrlq $25,%xmm7,%xmm3 -+ vpsllq $4,%xmm3,%xmm9 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpsllq $1,%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m25(%rip),%xmm7,%xmm7 -+ vpsrlq $26,%xmm1,%xmm3 -+ vpaddq %xmm3,%xmm4,%xmm4 -+ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 -+ vpsrlq $26,%xmm11,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 -+ vpsrlq $25,%xmm4,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpand curve25519_sandy2x_m25(%rip),%xmm4,%xmm4 -+ vpunpcklqdq %xmm13,%xmm11,%xmm3 -+ vpunpckhqdq %xmm13,%xmm11,%xmm9 -+ vpaddq curve25519_sandy2x_subc0(%rip),%xmm9,%xmm10 -+ vpsubq %xmm3,%xmm10,%xmm10 -+ vpaddq %xmm9,%xmm3,%xmm3 -+ vpunpckhqdq %xmm3,%xmm10,%xmm9 -+ vpunpcklqdq %xmm3,%xmm10,%xmm10 -+ vpmuludq %xmm10,%xmm10,%xmm3 -+ vpaddq %xmm10,%xmm10,%xmm10 -+ vpmuludq %xmm9,%xmm10,%xmm11 -+ vpunpcklqdq %xmm2,%xmm0,%xmm12 -+ vpunpckhqdq %xmm2,%xmm0,%xmm0 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm0,%xmm2 -+ vpsubq %xmm12,%xmm2,%xmm2 -+ vpaddq %xmm0,%xmm12,%xmm12 -+ vpunpckhqdq %xmm12,%xmm2,%xmm0 -+ vpunpcklqdq %xmm12,%xmm2,%xmm2 -+ vpmuludq %xmm2,%xmm10,%xmm12 -+ vpaddq %xmm9,%xmm9,%xmm13 -+ vpmuludq %xmm13,%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm12,%xmm12 -+ vpmuludq %xmm0,%xmm10,%xmm9 -+ vpmuludq %xmm2,%xmm13,%xmm14 -+ vpaddq %xmm14,%xmm9,%xmm9 -+ vpunpcklqdq %xmm4,%xmm1,%xmm14 -+ vpunpckhqdq %xmm4,%xmm1,%xmm1 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm1,%xmm4 -+ vpsubq %xmm14,%xmm4,%xmm4 -+ vpaddq %xmm1,%xmm14,%xmm14 -+ vpunpckhqdq %xmm14,%xmm4,%xmm1 -+ vpunpcklqdq %xmm14,%xmm4,%xmm4 -+ vmovdqa %xmm1,0(%rsp) -+ vpaddq %xmm1,%xmm1,%xmm1 -+ vmovdqa %xmm1,16(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 -+ vmovdqa %xmm1,32(%rsp) -+ vpmuludq %xmm4,%xmm10,%xmm1 -+ vpmuludq %xmm2,%xmm2,%xmm14 -+ vpaddq %xmm14,%xmm1,%xmm1 -+ vpmuludq 0(%rsp),%xmm10,%xmm14 -+ vpmuludq %xmm4,%xmm13,%xmm15 -+ vpaddq %xmm15,%xmm14,%xmm14 -+ vpunpcklqdq %xmm5,%xmm6,%xmm15 -+ vpunpckhqdq %xmm5,%xmm6,%xmm5 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm5,%xmm6 -+ vpsubq %xmm15,%xmm6,%xmm6 -+ vpaddq %xmm5,%xmm15,%xmm15 -+ vpunpckhqdq %xmm15,%xmm6,%xmm5 -+ vpunpcklqdq %xmm15,%xmm6,%xmm6 -+ vmovdqa %xmm6,48(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm6,%xmm6 -+ vmovdqa %xmm6,64(%rsp) -+ vmovdqa %xmm5,80(%rsp) -+ vpmuludq curve25519_sandy2x_v38_38(%rip),%xmm5,%xmm5 -+ vmovdqa %xmm5,96(%rsp) -+ vpmuludq 48(%rsp),%xmm10,%xmm5 -+ vpaddq %xmm0,%xmm0,%xmm6 -+ vpmuludq %xmm6,%xmm0,%xmm0 -+ vpaddq %xmm0,%xmm5,%xmm5 -+ vpmuludq 80(%rsp),%xmm10,%xmm0 -+ vpmuludq %xmm4,%xmm6,%xmm15 -+ vpaddq %xmm15,%xmm0,%xmm0 -+ vpmuludq %xmm6,%xmm13,%xmm15 -+ vpaddq %xmm15,%xmm1,%xmm1 -+ vpmuludq %xmm6,%xmm2,%xmm15 -+ vpaddq %xmm15,%xmm14,%xmm14 -+ vpunpcklqdq %xmm7,%xmm8,%xmm15 -+ vpunpckhqdq %xmm7,%xmm8,%xmm7 -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm7,%xmm8 -+ vpsubq %xmm15,%xmm8,%xmm8 -+ vpaddq %xmm7,%xmm15,%xmm15 -+ vpunpckhqdq %xmm15,%xmm8,%xmm7 -+ vpunpcklqdq %xmm15,%xmm8,%xmm8 -+ vmovdqa %xmm8,112(%rsp) -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm8,%xmm8 -+ vmovdqa %xmm8,160(%rsp) -+ vpmuludq 112(%rsp),%xmm10,%xmm8 -+ vpmuludq %xmm7,%xmm10,%xmm10 -+ vpmuludq curve25519_sandy2x_v38_38(%rip),%xmm7,%xmm15 -+ vpmuludq %xmm15,%xmm7,%xmm7 -+ vpaddq %xmm7,%xmm8,%xmm8 -+ vpmuludq %xmm15,%xmm13,%xmm7 -+ vpaddq %xmm7,%xmm3,%xmm3 -+ vpmuludq %xmm15,%xmm2,%xmm7 -+ vpaddq %xmm7,%xmm11,%xmm11 -+ vpmuludq 80(%rsp),%xmm13,%xmm7 -+ vpaddq %xmm7,%xmm7,%xmm7 -+ vpaddq %xmm7,%xmm8,%xmm8 -+ vpmuludq 16(%rsp),%xmm13,%xmm7 -+ vpaddq %xmm7,%xmm5,%xmm5 -+ vpmuludq 48(%rsp),%xmm13,%xmm7 -+ vpaddq %xmm7,%xmm0,%xmm0 -+ vpmuludq 112(%rsp),%xmm13,%xmm7 -+ vpaddq %xmm7,%xmm10,%xmm10 -+ vpmuludq %xmm15,%xmm6,%xmm7 -+ vpaddq %xmm7,%xmm12,%xmm12 -+ vpmuludq %xmm15,%xmm4,%xmm7 -+ vpaddq %xmm7,%xmm9,%xmm9 -+ vpaddq %xmm2,%xmm2,%xmm2 -+ vpmuludq %xmm4,%xmm2,%xmm7 -+ vpaddq %xmm7,%xmm5,%xmm5 -+ vpmuludq 160(%rsp),%xmm2,%xmm7 -+ vpaddq %xmm7,%xmm3,%xmm3 -+ vpmuludq 160(%rsp),%xmm6,%xmm7 -+ vpaddq %xmm7,%xmm11,%xmm11 -+ vpmuludq 0(%rsp),%xmm2,%xmm7 -+ vpaddq %xmm7,%xmm0,%xmm0 -+ vpmuludq 48(%rsp),%xmm2,%xmm7 -+ vpaddq %xmm7,%xmm8,%xmm8 -+ vpmuludq 80(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq 96(%rsp),%xmm4,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpmuludq %xmm4,%xmm4,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpaddq %xmm4,%xmm4,%xmm2 -+ vpmuludq 160(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm12,%xmm12 -+ vpmuludq 16(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vpmuludq 48(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm14,%xmm14 -+ vpmuludq 96(%rsp),%xmm6,%xmm4 -+ vpaddq %xmm4,%xmm3,%xmm3 -+ vmovdqa 16(%rsp),%xmm4 -+ vpmuludq 160(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm9,%xmm9 -+ vpmuludq 16(%rsp),%xmm6,%xmm4 -+ vpaddq %xmm4,%xmm8,%xmm8 -+ vpmuludq 48(%rsp),%xmm6,%xmm4 -+ vpaddq %xmm4,%xmm10,%xmm10 -+ vpmuludq 80(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm5,%xmm5 -+ vpmuludq 112(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm0,%xmm0 -+ vmovdqa 48(%rsp),%xmm4 -+ vpaddq %xmm4,%xmm4,%xmm4 -+ vpmuludq 160(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vmovdqa 80(%rsp),%xmm4 -+ vpaddq %xmm4,%xmm4,%xmm4 -+ vpmuludq 160(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm14,%xmm14 -+ vpmuludq 64(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm3,%xmm3 -+ vmovdqa 16(%rsp),%xmm4 -+ vpmuludq 64(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm11,%xmm11 -+ vmovdqa 16(%rsp),%xmm4 -+ vpmuludq 96(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm12,%xmm12 -+ vmovdqa 48(%rsp),%xmm4 -+ vpmuludq 96(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm9,%xmm9 -+ vpmuludq 0(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vmovdqa 32(%rsp),%xmm2 -+ vpmuludq 0(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm3,%xmm3 -+ vmovdqa 64(%rsp),%xmm2 -+ vpmuludq 48(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vmovdqa 96(%rsp),%xmm2 -+ vpmuludq 80(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm1,%xmm1 -+ vmovdqa 160(%rsp),%xmm2 -+ vpmuludq 112(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpsrlq $26,%xmm3,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m26(%rip),%xmm3,%xmm3 -+ vpsrlq $25,%xmm14,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m25(%rip),%xmm14,%xmm14 -+ vpsrlq $25,%xmm11,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpand curve25519_sandy2x_m25(%rip),%xmm11,%xmm11 -+ vpsrlq $26,%xmm5,%xmm2 -+ vpaddq %xmm2,%xmm0,%xmm0 -+ vpand curve25519_sandy2x_m26(%rip),%xmm5,%xmm5 -+ vpsrlq $26,%xmm12,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpand curve25519_sandy2x_m26(%rip),%xmm12,%xmm12 -+ vpsrlq $25,%xmm0,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpand curve25519_sandy2x_m25(%rip),%xmm0,%xmm0 -+ vpsrlq $25,%xmm9,%xmm2 -+ vpaddq %xmm2,%xmm1,%xmm1 -+ vpand curve25519_sandy2x_m25(%rip),%xmm9,%xmm9 -+ vpsrlq $26,%xmm8,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpand curve25519_sandy2x_m26(%rip),%xmm8,%xmm8 -+ vpsrlq $26,%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm14,%xmm14 -+ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 -+ vpsrlq $25,%xmm10,%xmm2 -+ vpsllq $4,%xmm2,%xmm4 -+ vpaddq %xmm2,%xmm3,%xmm3 -+ vpsllq $1,%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm3,%xmm3 -+ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 -+ vpsrlq $25,%xmm14,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m25(%rip),%xmm14,%xmm14 -+ vpsrlq $26,%xmm3,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m26(%rip),%xmm3,%xmm3 -+ vpunpckhqdq %xmm11,%xmm3,%xmm2 -+ vmovdqa %xmm2,0(%rsp) -+ vpunpcklqdq %xmm11,%xmm3,%xmm2 -+ vpmuludq curve25519_sandy2x_v9_9(%rip),%xmm2,%xmm2 -+ vmovdqa %xmm2,80(%rsp) -+ vpunpckhqdq %xmm9,%xmm12,%xmm2 -+ vmovdqa %xmm2,16(%rsp) -+ vpunpcklqdq %xmm9,%xmm12,%xmm2 -+ vpmuludq curve25519_sandy2x_v9_9(%rip),%xmm2,%xmm2 -+ vmovdqa %xmm2,96(%rsp) -+ vpunpckhqdq %xmm14,%xmm1,%xmm2 -+ vmovdqa %xmm2,32(%rsp) -+ vpunpcklqdq %xmm14,%xmm1,%xmm1 -+ vpmuludq curve25519_sandy2x_v9_9(%rip),%xmm1,%xmm1 -+ vmovdqa %xmm1,112(%rsp) -+ vpunpckhqdq %xmm0,%xmm5,%xmm1 -+ vmovdqa %xmm1,48(%rsp) -+ vpunpcklqdq %xmm0,%xmm5,%xmm0 -+ vpmuludq curve25519_sandy2x_v9_9(%rip),%xmm0,%xmm0 -+ vmovdqa %xmm0,160(%rsp) -+ vpunpckhqdq %xmm10,%xmm8,%xmm0 -+ vmovdqa %xmm0,64(%rsp) -+ vpunpcklqdq %xmm10,%xmm8,%xmm0 -+ vpmuludq curve25519_sandy2x_v9_9(%rip),%xmm0,%xmm0 -+ vmovdqa %xmm0,208(%rsp) -+ vmovdqa 144(%rsp),%xmm0 -+ vpmuludq %xmm0,%xmm0,%xmm1 -+ vpaddq %xmm0,%xmm0,%xmm0 -+ vmovdqa 128(%rsp),%xmm2 -+ vpmuludq %xmm2,%xmm0,%xmm3 -+ vmovdqa 192(%rsp),%xmm4 -+ vpmuludq %xmm4,%xmm0,%xmm5 -+ vmovdqa 176(%rsp),%xmm6 -+ vpmuludq %xmm6,%xmm0,%xmm7 -+ vmovdqa 240(%rsp),%xmm8 -+ vpmuludq %xmm8,%xmm0,%xmm9 -+ vpmuludq 224(%rsp),%xmm0,%xmm10 -+ vpmuludq 304(%rsp),%xmm0,%xmm11 -+ vpmuludq 288(%rsp),%xmm0,%xmm12 -+ vpmuludq 336(%rsp),%xmm0,%xmm13 -+ vmovdqa 384(%rsp),%xmm14 -+ vpmuludq %xmm14,%xmm0,%xmm0 -+ vpmuludq curve25519_sandy2x_v38_38(%rip),%xmm14,%xmm15 -+ vpmuludq %xmm15,%xmm14,%xmm14 -+ vpaddq %xmm14,%xmm13,%xmm13 -+ vpaddq %xmm6,%xmm6,%xmm14 -+ vpmuludq %xmm14,%xmm6,%xmm6 -+ vpaddq %xmm6,%xmm11,%xmm11 -+ vpaddq %xmm2,%xmm2,%xmm6 -+ vpmuludq %xmm6,%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpmuludq %xmm15,%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm1,%xmm1 -+ vpmuludq %xmm15,%xmm4,%xmm2 -+ vpaddq %xmm2,%xmm3,%xmm3 -+ vpmuludq 256(%rsp),%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpmuludq 304(%rsp),%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq 352(%rsp),%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpmuludq 336(%rsp),%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm0,%xmm0 -+ vpmuludq %xmm4,%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpmuludq %xmm14,%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpmuludq %xmm8,%xmm6,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq %xmm15,%xmm14,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpmuludq %xmm15,%xmm8,%xmm2 -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpmuludq %xmm4,%xmm4,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpmuludq %xmm14,%xmm4,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpaddq %xmm4,%xmm4,%xmm2 -+ vpmuludq %xmm8,%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm11,%xmm11 -+ vpmuludq 400(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vpmuludq 400(%rsp),%xmm14,%xmm4 -+ vpaddq %xmm4,%xmm3,%xmm3 -+ vpmuludq 224(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm12,%xmm12 -+ vpmuludq 304(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm13,%xmm13 -+ vpmuludq 288(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm0,%xmm0 -+ vpmuludq 368(%rsp),%xmm8,%xmm2 -+ vpaddq %xmm2,%xmm3,%xmm3 -+ vpmuludq %xmm8,%xmm14,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq %xmm8,%xmm8,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpaddq %xmm8,%xmm8,%xmm2 -+ vpmuludq 400(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm5,%xmm5 -+ vpmuludq 256(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm9,%xmm9 -+ vpmuludq 304(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm10,%xmm10 -+ vpmuludq 368(%rsp),%xmm14,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vmovdqa 256(%rsp),%xmm4 -+ vpmuludq 400(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm7,%xmm7 -+ vpmuludq 256(%rsp),%xmm14,%xmm4 -+ vpaddq %xmm4,%xmm13,%xmm13 -+ vpmuludq 304(%rsp),%xmm14,%xmm4 -+ vpaddq %xmm4,%xmm0,%xmm0 -+ vpmuludq 352(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm11,%xmm11 -+ vpmuludq 336(%rsp),%xmm15,%xmm4 -+ vpaddq %xmm4,%xmm12,%xmm12 -+ vmovdqa 304(%rsp),%xmm4 -+ vpaddq %xmm4,%xmm4,%xmm4 -+ vpmuludq 400(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm9,%xmm9 -+ vpmuludq 320(%rsp),%xmm2,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vmovdqa 256(%rsp),%xmm4 -+ vpmuludq 320(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm3,%xmm3 -+ vmovdqa 256(%rsp),%xmm4 -+ vpmuludq 368(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm5,%xmm5 -+ vmovdqa 304(%rsp),%xmm4 -+ vpmuludq 368(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm7,%xmm7 -+ vmovdqa 352(%rsp),%xmm4 -+ vpmuludq 400(%rsp),%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm10,%xmm10 -+ vpmuludq 224(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm0,%xmm0 -+ vmovdqa 272(%rsp),%xmm2 -+ vpmuludq 224(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm1,%xmm1 -+ vmovdqa 320(%rsp),%xmm2 -+ vpmuludq 304(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vmovdqa 368(%rsp),%xmm2 -+ vpmuludq 288(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vmovdqa 400(%rsp),%xmm2 -+ vpmuludq 336(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpsrlq $26,%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm3,%xmm3 -+ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 -+ vpsrlq $25,%xmm10,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 -+ vpsrlq $25,%xmm3,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m25(%rip),%xmm3,%xmm3 -+ vpsrlq $26,%xmm11,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 -+ vpsrlq $26,%xmm5,%xmm2 -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpand curve25519_sandy2x_m26(%rip),%xmm5,%xmm5 -+ vpsrlq $25,%xmm12,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpand curve25519_sandy2x_m25(%rip),%xmm12,%xmm12 -+ vpsrlq $25,%xmm7,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpand curve25519_sandy2x_m25(%rip),%xmm7,%xmm7 -+ vpsrlq $26,%xmm13,%xmm2 -+ vpaddq %xmm2,%xmm0,%xmm0 -+ vpand curve25519_sandy2x_m26(%rip),%xmm13,%xmm13 -+ vpsrlq $26,%xmm9,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpand curve25519_sandy2x_m26(%rip),%xmm9,%xmm9 -+ vpsrlq $25,%xmm0,%xmm2 -+ vpsllq $4,%xmm2,%xmm4 -+ vpaddq %xmm2,%xmm1,%xmm1 -+ vpsllq $1,%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm1,%xmm1 -+ vpand curve25519_sandy2x_m25(%rip),%xmm0,%xmm0 -+ vpsrlq $25,%xmm10,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 -+ vpsrlq $26,%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm3,%xmm3 -+ vpand curve25519_sandy2x_m26(%rip),%xmm1,%xmm1 -+ vpunpckhqdq %xmm3,%xmm1,%xmm2 -+ vpunpcklqdq %xmm3,%xmm1,%xmm1 -+ vmovdqa %xmm1,176(%rsp) -+ vpaddq curve25519_sandy2x_subc0(%rip),%xmm2,%xmm3 -+ vpsubq %xmm1,%xmm3,%xmm3 -+ vpunpckhqdq %xmm3,%xmm2,%xmm1 -+ vpunpcklqdq %xmm3,%xmm2,%xmm2 -+ vmovdqa %xmm2,192(%rsp) -+ vmovdqa %xmm1,224(%rsp) -+ vpsllq $1,%xmm1,%xmm1 -+ vmovdqa %xmm1,240(%rsp) -+ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm3,%xmm3 -+ vmovdqa 80(%rsp),%xmm1 -+ vpunpcklqdq %xmm1,%xmm3,%xmm2 -+ vpunpckhqdq %xmm1,%xmm3,%xmm1 -+ vpunpckhqdq %xmm7,%xmm5,%xmm3 -+ vpunpcklqdq %xmm7,%xmm5,%xmm4 -+ vmovdqa %xmm4,256(%rsp) -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm3,%xmm5 -+ vpsubq %xmm4,%xmm5,%xmm5 -+ vpunpckhqdq %xmm5,%xmm3,%xmm4 -+ vpunpcklqdq %xmm5,%xmm3,%xmm3 -+ vmovdqa %xmm3,272(%rsp) -+ vmovdqa %xmm4,288(%rsp) -+ vpsllq $1,%xmm4,%xmm4 -+ vmovdqa %xmm4,304(%rsp) -+ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm5,%xmm5 -+ vmovdqa 96(%rsp),%xmm3 -+ vpunpcklqdq %xmm3,%xmm5,%xmm4 -+ vpunpckhqdq %xmm3,%xmm5,%xmm3 -+ vpunpckhqdq %xmm10,%xmm9,%xmm5 -+ vpunpcklqdq %xmm10,%xmm9,%xmm6 -+ vmovdqa %xmm6,320(%rsp) -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm5,%xmm7 -+ vpsubq %xmm6,%xmm7,%xmm7 -+ vpunpckhqdq %xmm7,%xmm5,%xmm6 -+ vpunpcklqdq %xmm7,%xmm5,%xmm5 -+ vmovdqa %xmm5,336(%rsp) -+ vmovdqa %xmm6,352(%rsp) -+ vpsllq $1,%xmm6,%xmm6 -+ vmovdqa %xmm6,368(%rsp) -+ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm7,%xmm7 -+ vmovdqa 112(%rsp),%xmm5 -+ vpunpcklqdq %xmm5,%xmm7,%xmm6 -+ vpunpckhqdq %xmm5,%xmm7,%xmm5 -+ vpunpckhqdq %xmm12,%xmm11,%xmm7 -+ vpunpcklqdq %xmm12,%xmm11,%xmm8 -+ vmovdqa %xmm8,384(%rsp) -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm7,%xmm9 -+ vpsubq %xmm8,%xmm9,%xmm9 -+ vpunpckhqdq %xmm9,%xmm7,%xmm8 -+ vpunpcklqdq %xmm9,%xmm7,%xmm7 -+ vmovdqa %xmm7,400(%rsp) -+ vmovdqa %xmm8,416(%rsp) -+ vpsllq $1,%xmm8,%xmm8 -+ vmovdqa %xmm8,432(%rsp) -+ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm9,%xmm9 -+ vmovdqa 160(%rsp),%xmm7 -+ vpunpcklqdq %xmm7,%xmm9,%xmm8 -+ vpunpckhqdq %xmm7,%xmm9,%xmm7 -+ vpunpckhqdq %xmm0,%xmm13,%xmm9 -+ vpunpcklqdq %xmm0,%xmm13,%xmm0 -+ vmovdqa %xmm0,160(%rsp) -+ vpaddq curve25519_sandy2x_subc2(%rip),%xmm9,%xmm10 -+ vpsubq %xmm0,%xmm10,%xmm10 -+ vpunpckhqdq %xmm10,%xmm9,%xmm0 -+ vpunpcklqdq %xmm10,%xmm9,%xmm9 -+ vmovdqa %xmm9,448(%rsp) -+ vmovdqa %xmm0,464(%rsp) -+ vpsllq $1,%xmm0,%xmm0 -+ vmovdqa %xmm0,480(%rsp) -+ vpmuludq curve25519_sandy2x_v121666_121666(%rip),%xmm10,%xmm10 -+ vmovdqa 208(%rsp),%xmm0 -+ vpunpcklqdq %xmm0,%xmm10,%xmm9 -+ vpunpckhqdq %xmm0,%xmm10,%xmm0 -+ vpsrlq $26,%xmm2,%xmm10 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ vpand curve25519_sandy2x_m26(%rip),%xmm2,%xmm2 -+ vpsrlq $25,%xmm5,%xmm10 -+ vpaddq %xmm10,%xmm8,%xmm8 -+ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 -+ vpsrlq $25,%xmm1,%xmm10 -+ vpaddq %xmm10,%xmm4,%xmm4 -+ vpand curve25519_sandy2x_m25(%rip),%xmm1,%xmm1 -+ vpsrlq $26,%xmm8,%xmm10 -+ vpaddq %xmm10,%xmm7,%xmm7 -+ vpand curve25519_sandy2x_m26(%rip),%xmm8,%xmm8 -+ vpsrlq $26,%xmm4,%xmm10 -+ vpaddq %xmm10,%xmm3,%xmm3 -+ vpand curve25519_sandy2x_m26(%rip),%xmm4,%xmm4 -+ vpsrlq $25,%xmm7,%xmm10 -+ vpaddq %xmm10,%xmm9,%xmm9 -+ vpand curve25519_sandy2x_m25(%rip),%xmm7,%xmm7 -+ vpsrlq $25,%xmm3,%xmm10 -+ vpaddq %xmm10,%xmm6,%xmm6 -+ vpand curve25519_sandy2x_m25(%rip),%xmm3,%xmm3 -+ vpsrlq $26,%xmm9,%xmm10 -+ vpaddq %xmm10,%xmm0,%xmm0 -+ vpand curve25519_sandy2x_m26(%rip),%xmm9,%xmm9 -+ vpsrlq $26,%xmm6,%xmm10 -+ vpaddq %xmm10,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 -+ vpsrlq $25,%xmm0,%xmm10 -+ vpsllq $4,%xmm10,%xmm11 -+ vpaddq %xmm10,%xmm2,%xmm2 -+ vpsllq $1,%xmm10,%xmm10 -+ vpaddq %xmm10,%xmm11,%xmm11 -+ vpaddq %xmm11,%xmm2,%xmm2 -+ vpand curve25519_sandy2x_m25(%rip),%xmm0,%xmm0 -+ vpsrlq $25,%xmm5,%xmm10 -+ vpaddq %xmm10,%xmm8,%xmm8 -+ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 -+ vpsrlq $26,%xmm2,%xmm10 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ vpand curve25519_sandy2x_m26(%rip),%xmm2,%xmm2 -+ vpunpckhqdq %xmm1,%xmm2,%xmm10 -+ vmovdqa %xmm10,80(%rsp) -+ vpunpcklqdq %xmm1,%xmm2,%xmm1 -+ vpunpckhqdq %xmm3,%xmm4,%xmm2 -+ vmovdqa %xmm2,96(%rsp) -+ vpunpcklqdq %xmm3,%xmm4,%xmm2 -+ vpunpckhqdq %xmm5,%xmm6,%xmm3 -+ vmovdqa %xmm3,112(%rsp) -+ vpunpcklqdq %xmm5,%xmm6,%xmm3 -+ vpunpckhqdq %xmm7,%xmm8,%xmm4 -+ vmovdqa %xmm4,128(%rsp) -+ vpunpcklqdq %xmm7,%xmm8,%xmm4 -+ vpunpckhqdq %xmm0,%xmm9,%xmm5 -+ vmovdqa %xmm5,144(%rsp) -+ vpunpcklqdq %xmm0,%xmm9,%xmm0 -+ vmovdqa 176(%rsp),%xmm5 -+ vpaddq %xmm5,%xmm1,%xmm1 -+ vpunpcklqdq %xmm1,%xmm5,%xmm6 -+ vpunpckhqdq %xmm1,%xmm5,%xmm1 -+ vpmuludq 224(%rsp),%xmm6,%xmm5 -+ vpmuludq 192(%rsp),%xmm1,%xmm7 -+ vpaddq %xmm7,%xmm5,%xmm5 -+ vpmuludq 272(%rsp),%xmm6,%xmm7 -+ vpmuludq 240(%rsp),%xmm1,%xmm8 -+ vpaddq %xmm8,%xmm7,%xmm7 -+ vpmuludq 288(%rsp),%xmm6,%xmm8 -+ vpmuludq 272(%rsp),%xmm1,%xmm9 -+ vpaddq %xmm9,%xmm8,%xmm8 -+ vpmuludq 336(%rsp),%xmm6,%xmm9 -+ vpmuludq 304(%rsp),%xmm1,%xmm10 -+ vpaddq %xmm10,%xmm9,%xmm9 -+ vpmuludq 352(%rsp),%xmm6,%xmm10 -+ vpmuludq 336(%rsp),%xmm1,%xmm11 -+ vpaddq %xmm11,%xmm10,%xmm10 -+ vpmuludq 400(%rsp),%xmm6,%xmm11 -+ vpmuludq 368(%rsp),%xmm1,%xmm12 -+ vpaddq %xmm12,%xmm11,%xmm11 -+ vpmuludq 416(%rsp),%xmm6,%xmm12 -+ vpmuludq 400(%rsp),%xmm1,%xmm13 -+ vpaddq %xmm13,%xmm12,%xmm12 -+ vpmuludq 448(%rsp),%xmm6,%xmm13 -+ vpmuludq 432(%rsp),%xmm1,%xmm14 -+ vpaddq %xmm14,%xmm13,%xmm13 -+ vpmuludq 464(%rsp),%xmm6,%xmm14 -+ vpmuludq 448(%rsp),%xmm1,%xmm15 -+ vpaddq %xmm15,%xmm14,%xmm14 -+ vpmuludq 192(%rsp),%xmm6,%xmm6 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 -+ vpmuludq 480(%rsp),%xmm1,%xmm1 -+ vpaddq %xmm1,%xmm6,%xmm6 -+ vmovdqa 256(%rsp),%xmm1 -+ vpaddq %xmm1,%xmm2,%xmm2 -+ vpunpcklqdq %xmm2,%xmm1,%xmm15 -+ vpunpckhqdq %xmm2,%xmm1,%xmm1 -+ vpmuludq 192(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpmuludq 224(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpmuludq 272(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpmuludq 288(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq 336(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpmuludq 352(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq 400(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpmuludq 416(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm15,%xmm15 -+ vpmuludq 448(%rsp),%xmm15,%xmm2 -+ vpaddq %xmm2,%xmm6,%xmm6 -+ vpmuludq 464(%rsp),%xmm15,%xmm15 -+ vpaddq %xmm15,%xmm5,%xmm5 -+ vpmuludq 192(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpmuludq 240(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpmuludq 272(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq 304(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpmuludq 336(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq 368(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpmuludq 400(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 -+ vpmuludq 432(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm6,%xmm6 -+ vpmuludq 448(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpmuludq 480(%rsp),%xmm1,%xmm1 -+ vpaddq %xmm1,%xmm7,%xmm7 -+ vmovdqa 320(%rsp),%xmm1 -+ vpaddq %xmm1,%xmm3,%xmm3 -+ vpunpcklqdq %xmm3,%xmm1,%xmm2 -+ vpunpckhqdq %xmm3,%xmm1,%xmm1 -+ vpmuludq 192(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm9,%xmm9 -+ vpmuludq 224(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm10,%xmm10 -+ vpmuludq 272(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 288(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm12,%xmm12 -+ vpmuludq 336(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 352(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm2,%xmm2 -+ vpmuludq 400(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 416(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 448(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq 464(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpmuludq 192(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq 240(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpmuludq 272(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq 304(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpmuludq 336(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 -+ vpmuludq 368(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm6,%xmm6 -+ vpmuludq 400(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpmuludq 432(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpmuludq 448(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpmuludq 480(%rsp),%xmm1,%xmm1 -+ vpaddq %xmm1,%xmm9,%xmm9 -+ vmovdqa 384(%rsp),%xmm1 -+ vpaddq %xmm1,%xmm4,%xmm4 -+ vpunpcklqdq %xmm4,%xmm1,%xmm2 -+ vpunpckhqdq %xmm4,%xmm1,%xmm1 -+ vpmuludq 192(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm11,%xmm11 -+ vpmuludq 224(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm12,%xmm12 -+ vpmuludq 272(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpmuludq 288(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm2,%xmm2 -+ vpmuludq 336(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm6,%xmm6 -+ vpmuludq 352(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm5,%xmm5 -+ vpmuludq 400(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm7,%xmm7 -+ vpmuludq 416(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm8,%xmm8 -+ vpmuludq 448(%rsp),%xmm2,%xmm3 -+ vpaddq %xmm3,%xmm9,%xmm9 -+ vpmuludq 464(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq 192(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq 240(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpmuludq 272(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm1,%xmm1 -+ vpmuludq 304(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm6,%xmm6 -+ vpmuludq 336(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm5,%xmm5 -+ vpmuludq 368(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpmuludq 400(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm8,%xmm8 -+ vpmuludq 432(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm9,%xmm9 -+ vpmuludq 448(%rsp),%xmm1,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ vpmuludq 480(%rsp),%xmm1,%xmm1 -+ vpaddq %xmm1,%xmm11,%xmm11 -+ vmovdqa 160(%rsp),%xmm1 -+ vpaddq %xmm1,%xmm0,%xmm0 -+ vpunpcklqdq %xmm0,%xmm1,%xmm2 -+ vpunpckhqdq %xmm0,%xmm1,%xmm0 -+ vpmuludq 192(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm13,%xmm13 -+ vpmuludq 224(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm2,%xmm2 -+ vpmuludq 272(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm6,%xmm6 -+ vpmuludq 288(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm5,%xmm5 -+ vpmuludq 336(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm7,%xmm7 -+ vpmuludq 352(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm8,%xmm8 -+ vpmuludq 400(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm9,%xmm9 -+ vpmuludq 416(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm10,%xmm10 -+ vpmuludq 448(%rsp),%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm11,%xmm11 -+ vpmuludq 464(%rsp),%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm12,%xmm12 -+ vpmuludq 192(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm14,%xmm14 -+ vpmuludq curve25519_sandy2x_v19_19(%rip),%xmm0,%xmm0 -+ vpmuludq 240(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm6,%xmm6 -+ vpmuludq 272(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm5,%xmm5 -+ vpmuludq 304(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm7,%xmm7 -+ vpmuludq 336(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm8,%xmm8 -+ vpmuludq 368(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm9,%xmm9 -+ vpmuludq 400(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm10,%xmm10 -+ vpmuludq 432(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm11,%xmm11 -+ vpmuludq 448(%rsp),%xmm0,%xmm1 -+ vpaddq %xmm1,%xmm12,%xmm12 -+ vpmuludq 480(%rsp),%xmm0,%xmm0 -+ vpaddq %xmm0,%xmm13,%xmm13 -+ vpsrlq $26,%xmm6,%xmm0 -+ vpaddq %xmm0,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 -+ vpsrlq $25,%xmm10,%xmm0 -+ vpaddq %xmm0,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 -+ vpsrlq $25,%xmm5,%xmm0 -+ vpaddq %xmm0,%xmm7,%xmm7 -+ vpand curve25519_sandy2x_m25(%rip),%xmm5,%xmm5 -+ vpsrlq $26,%xmm11,%xmm0 -+ vpaddq %xmm0,%xmm12,%xmm12 -+ vpand curve25519_sandy2x_m26(%rip),%xmm11,%xmm11 -+ vpsrlq $26,%xmm7,%xmm0 -+ vpaddq %xmm0,%xmm8,%xmm8 -+ vpand curve25519_sandy2x_m26(%rip),%xmm7,%xmm7 -+ vpsrlq $25,%xmm12,%xmm0 -+ vpaddq %xmm0,%xmm13,%xmm13 -+ vpand curve25519_sandy2x_m25(%rip),%xmm12,%xmm12 -+ vpsrlq $25,%xmm8,%xmm0 -+ vpaddq %xmm0,%xmm9,%xmm9 -+ vpand curve25519_sandy2x_m25(%rip),%xmm8,%xmm8 -+ vpsrlq $26,%xmm13,%xmm0 -+ vpaddq %xmm0,%xmm14,%xmm14 -+ vpand curve25519_sandy2x_m26(%rip),%xmm13,%xmm13 -+ vpsrlq $26,%xmm9,%xmm0 -+ vpaddq %xmm0,%xmm10,%xmm10 -+ vpand curve25519_sandy2x_m26(%rip),%xmm9,%xmm9 -+ vpsrlq $25,%xmm14,%xmm0 -+ vpsllq $4,%xmm0,%xmm1 -+ vpaddq %xmm0,%xmm6,%xmm6 -+ vpsllq $1,%xmm0,%xmm0 -+ vpaddq %xmm0,%xmm1,%xmm1 -+ vpaddq %xmm1,%xmm6,%xmm6 -+ vpand curve25519_sandy2x_m25(%rip),%xmm14,%xmm14 -+ vpsrlq $25,%xmm10,%xmm0 -+ vpaddq %xmm0,%xmm11,%xmm11 -+ vpand curve25519_sandy2x_m25(%rip),%xmm10,%xmm10 -+ vpsrlq $26,%xmm6,%xmm0 -+ vpaddq %xmm0,%xmm5,%xmm5 -+ vpand curve25519_sandy2x_m26(%rip),%xmm6,%xmm6 -+ vpunpckhqdq %xmm5,%xmm6,%xmm1 -+ vpunpcklqdq %xmm5,%xmm6,%xmm0 -+ vpunpckhqdq %xmm8,%xmm7,%xmm3 -+ vpunpcklqdq %xmm8,%xmm7,%xmm2 -+ vpunpckhqdq %xmm10,%xmm9,%xmm5 -+ vpunpcklqdq %xmm10,%xmm9,%xmm4 -+ vpunpckhqdq %xmm12,%xmm11,%xmm7 -+ vpunpcklqdq %xmm12,%xmm11,%xmm6 -+ vpunpckhqdq %xmm14,%xmm13,%xmm9 -+ vpunpcklqdq %xmm14,%xmm13,%xmm8 -+ cmp $0,%rdx -+ jne .Lladder_base_loop -+ vmovdqu %xmm1,80(%rdi) -+ vmovdqu %xmm0,0(%rdi) -+ vmovdqu %xmm3,96(%rdi) -+ vmovdqu %xmm2,16(%rdi) -+ vmovdqu %xmm5,112(%rdi) -+ vmovdqu %xmm4,32(%rdi) -+ vmovdqu %xmm7,128(%rdi) -+ vmovdqu %xmm6,48(%rdi) -+ vmovdqu %xmm9,144(%rdi) -+ vmovdqu %xmm8,64(%rdi) -+ movq 1536(%rsp),%r11 -+ movq 1544(%rsp),%r12 -+ movq 1552(%rsp),%r13 -+ leave -+ ret -+ENDPROC(curve25519_sandy2x_ladder_base) -+#endif /* CONFIG_AS_AVX */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/poly1305-arm64.S 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,820 @@ -+/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. -+ */ -+ -+#include -+.text -+ -+.align 5 -+ENTRY(poly1305_init_arm) -+ cmp x1,xzr -+ stp xzr,xzr,[x0] // zero hash value -+ stp xzr,xzr,[x0,#16] // [along with is_base2_26] -+ -+ csel x0,xzr,x0,eq -+ b.eq .Lno_key -+ -+ ldp x7,x8,[x1] // load key -+ mov x9,#0xfffffffc0fffffff -+ movk x9,#0x0fff,lsl#48 -+#ifdef __ARMEB__ -+ rev x7,x7 // flip bytes -+ rev x8,x8 -+#endif -+ and x7,x7,x9 // &=0ffffffc0fffffff -+ and x9,x9,#-4 -+ and x8,x8,x9 // &=0ffffffc0ffffffc -+ stp x7,x8,[x0,#32] // save key value -+ -+.Lno_key: -+ ret -+ENDPROC(poly1305_init_arm) -+ -+.align 5 -+ENTRY(poly1305_blocks_arm) -+ ands x2,x2,#-16 -+ b.eq .Lno_data -+ -+ ldp x4,x5,[x0] // load hash value -+ ldp x7,x8,[x0,#32] // load key value -+ ldr x6,[x0,#16] -+ add x9,x8,x8,lsr#2 // s1 = r1 + (r1 >> 2) -+ b .Loop -+ -+.align 5 -+.Loop: -+ ldp x10,x11,[x1],#16 // load input -+ sub x2,x2,#16 -+#ifdef __ARMEB__ -+ rev x10,x10 -+ rev x11,x11 -+#endif -+ adds x4,x4,x10 // accumulate input -+ adcs x5,x5,x11 -+ -+ mul x12,x4,x7 // h0*r0 -+ adc x6,x6,x3 -+ umulh x13,x4,x7 -+ -+ mul x10,x5,x9 // h1*5*r1 -+ umulh x11,x5,x9 -+ -+ adds x12,x12,x10 -+ mul x10,x4,x8 // h0*r1 -+ adc x13,x13,x11 -+ umulh x14,x4,x8 -+ -+ adds x13,x13,x10 -+ mul x10,x5,x7 // h1*r0 -+ adc x14,x14,xzr -+ umulh x11,x5,x7 -+ -+ adds x13,x13,x10 -+ mul x10,x6,x9 // h2*5*r1 -+ adc x14,x14,x11 -+ mul x11,x6,x7 // h2*r0 -+ -+ adds x13,x13,x10 -+ adc x14,x14,x11 -+ -+ and x10,x14,#-4 // final reduction -+ and x6,x14,#3 -+ add x10,x10,x14,lsr#2 -+ adds x4,x12,x10 -+ adcs x5,x13,xzr -+ adc x6,x6,xzr -+ -+ cbnz x2,.Loop -+ -+ stp x4,x5,[x0] // store hash value -+ str x6,[x0,#16] -+ -+.Lno_data: -+ ret -+ENDPROC(poly1305_blocks_arm) -+ -+.align 5 -+ENTRY(poly1305_emit_arm) -+ ldp x4,x5,[x0] // load hash base 2^64 -+ ldr x6,[x0,#16] -+ ldp x10,x11,[x2] // load nonce -+ -+ adds x12,x4,#5 // compare to modulus -+ adcs x13,x5,xzr -+ adc x14,x6,xzr -+ -+ tst x14,#-4 // see if it's carried/borrowed -+ -+ csel x4,x4,x12,eq -+ csel x5,x5,x13,eq -+ -+#ifdef __ARMEB__ -+ ror x10,x10,#32 // flip nonce words -+ ror x11,x11,#32 -+#endif -+ adds x4,x4,x10 // accumulate nonce -+ adc x5,x5,x11 -+#ifdef __ARMEB__ -+ rev x4,x4 // flip output bytes -+ rev x5,x5 -+#endif -+ stp x4,x5,[x1] // write result -+ -+ ret -+ENDPROC(poly1305_emit_arm) -+ -+.align 5 -+__poly1305_mult: -+ mul x12,x4,x7 // h0*r0 -+ umulh x13,x4,x7 -+ -+ mul x10,x5,x9 // h1*5*r1 -+ umulh x11,x5,x9 -+ -+ adds x12,x12,x10 -+ mul x10,x4,x8 // h0*r1 -+ adc x13,x13,x11 -+ umulh x14,x4,x8 -+ -+ adds x13,x13,x10 -+ mul x10,x5,x7 // h1*r0 -+ adc x14,x14,xzr -+ umulh x11,x5,x7 -+ -+ adds x13,x13,x10 -+ mul x10,x6,x9 // h2*5*r1 -+ adc x14,x14,x11 -+ mul x11,x6,x7 // h2*r0 -+ -+ adds x13,x13,x10 -+ adc x14,x14,x11 -+ -+ and x10,x14,#-4 // final reduction -+ and x6,x14,#3 -+ add x10,x10,x14,lsr#2 -+ adds x4,x12,x10 -+ adcs x5,x13,xzr -+ adc x6,x6,xzr -+ -+ ret -+ -+__poly1305_splat: -+ and x12,x4,#0x03ffffff // base 2^64 -> base 2^26 -+ ubfx x13,x4,#26,#26 -+ extr x14,x5,x4,#52 -+ and x14,x14,#0x03ffffff -+ ubfx x15,x5,#14,#26 -+ extr x16,x6,x5,#40 -+ -+ str w12,[x0,#16*0] // r0 -+ add w12,w13,w13,lsl#2 // r1*5 -+ str w13,[x0,#16*1] // r1 -+ add w13,w14,w14,lsl#2 // r2*5 -+ str w12,[x0,#16*2] // s1 -+ str w14,[x0,#16*3] // r2 -+ add w14,w15,w15,lsl#2 // r3*5 -+ str w13,[x0,#16*4] // s2 -+ str w15,[x0,#16*5] // r3 -+ add w15,w16,w16,lsl#2 // r4*5 -+ str w14,[x0,#16*6] // s3 -+ str w16,[x0,#16*7] // r4 -+ str w15,[x0,#16*8] // s4 -+ -+ ret -+ -+.align 5 -+ENTRY(poly1305_blocks_neon) -+ ldr x17,[x0,#24] -+ cmp x2,#128 -+ b.hs .Lblocks_neon -+ cbz x17,poly1305_blocks_arm -+ -+.Lblocks_neon: -+ stp x29,x30,[sp,#-80]! -+ add x29,sp,#0 -+ -+ ands x2,x2,#-16 -+ b.eq .Lno_data_neon -+ -+ cbz x17,.Lbase2_64_neon -+ -+ ldp w10,w11,[x0] // load hash value base 2^26 -+ ldp w12,w13,[x0,#8] -+ ldr w14,[x0,#16] -+ -+ tst x2,#31 -+ b.eq .Leven_neon -+ -+ ldp x7,x8,[x0,#32] // load key value -+ -+ add x4,x10,x11,lsl#26 // base 2^26 -> base 2^64 -+ lsr x5,x12,#12 -+ adds x4,x4,x12,lsl#52 -+ add x5,x5,x13,lsl#14 -+ adc x5,x5,xzr -+ lsr x6,x14,#24 -+ adds x5,x5,x14,lsl#40 -+ adc x14,x6,xzr // can be partially reduced... -+ -+ ldp x12,x13,[x1],#16 // load input -+ sub x2,x2,#16 -+ add x9,x8,x8,lsr#2 // s1 = r1 + (r1 >> 2) -+ -+ and x10,x14,#-4 // ... so reduce -+ and x6,x14,#3 -+ add x10,x10,x14,lsr#2 -+ adds x4,x4,x10 -+ adcs x5,x5,xzr -+ adc x6,x6,xzr -+ -+#ifdef __ARMEB__ -+ rev x12,x12 -+ rev x13,x13 -+#endif -+ adds x4,x4,x12 // accumulate input -+ adcs x5,x5,x13 -+ adc x6,x6,x3 -+ -+ bl __poly1305_mult -+ ldr x30,[sp,#8] -+ -+ cbz x3,.Lstore_base2_64_neon -+ -+ and x10,x4,#0x03ffffff // base 2^64 -> base 2^26 -+ ubfx x11,x4,#26,#26 -+ extr x12,x5,x4,#52 -+ and x12,x12,#0x03ffffff -+ ubfx x13,x5,#14,#26 -+ extr x14,x6,x5,#40 -+ -+ cbnz x2,.Leven_neon -+ -+ stp w10,w11,[x0] // store hash value base 2^26 -+ stp w12,w13,[x0,#8] -+ str w14,[x0,#16] -+ b .Lno_data_neon -+ -+.align 4 -+.Lstore_base2_64_neon: -+ stp x4,x5,[x0] // store hash value base 2^64 -+ stp x6,xzr,[x0,#16] // note that is_base2_26 is zeroed -+ b .Lno_data_neon -+ -+.align 4 -+.Lbase2_64_neon: -+ ldp x7,x8,[x0,#32] // load key value -+ -+ ldp x4,x5,[x0] // load hash value base 2^64 -+ ldr x6,[x0,#16] -+ -+ tst x2,#31 -+ b.eq .Linit_neon -+ -+ ldp x12,x13,[x1],#16 // load input -+ sub x2,x2,#16 -+ add x9,x8,x8,lsr#2 // s1 = r1 + (r1 >> 2) -+#ifdef __ARMEB__ -+ rev x12,x12 -+ rev x13,x13 -+#endif -+ adds x4,x4,x12 // accumulate input -+ adcs x5,x5,x13 -+ adc x6,x6,x3 -+ -+ bl __poly1305_mult -+ -+.Linit_neon: -+ and x10,x4,#0x03ffffff // base 2^64 -> base 2^26 -+ ubfx x11,x4,#26,#26 -+ extr x12,x5,x4,#52 -+ and x12,x12,#0x03ffffff -+ ubfx x13,x5,#14,#26 -+ extr x14,x6,x5,#40 -+ -+ stp d8,d9,[sp,#16] // meet ABI requirements -+ stp d10,d11,[sp,#32] -+ stp d12,d13,[sp,#48] -+ stp d14,d15,[sp,#64] -+ -+ fmov d24,x10 -+ fmov d25,x11 -+ fmov d26,x12 -+ fmov d27,x13 -+ fmov d28,x14 -+ -+ ////////////////////////////////// initialize r^n table -+ mov x4,x7 // r^1 -+ add x9,x8,x8,lsr#2 // s1 = r1 + (r1 >> 2) -+ mov x5,x8 -+ mov x6,xzr -+ add x0,x0,#48+12 -+ bl __poly1305_splat -+ -+ bl __poly1305_mult // r^2 -+ sub x0,x0,#4 -+ bl __poly1305_splat -+ -+ bl __poly1305_mult // r^3 -+ sub x0,x0,#4 -+ bl __poly1305_splat -+ -+ bl __poly1305_mult // r^4 -+ sub x0,x0,#4 -+ bl __poly1305_splat -+ ldr x30,[sp,#8] -+ -+ add x16,x1,#32 -+ adr x17,.Lzeros -+ subs x2,x2,#64 -+ csel x16,x17,x16,lo -+ -+ mov x4,#1 -+ str x4,[x0,#-24] // set is_base2_26 -+ sub x0,x0,#48 // restore original x0 -+ b .Ldo_neon -+ -+.align 4 -+.Leven_neon: -+ add x16,x1,#32 -+ adr x17,.Lzeros -+ subs x2,x2,#64 -+ csel x16,x17,x16,lo -+ -+ stp d8,d9,[sp,#16] // meet ABI requirements -+ stp d10,d11,[sp,#32] -+ stp d12,d13,[sp,#48] -+ stp d14,d15,[sp,#64] -+ -+ fmov d24,x10 -+ fmov d25,x11 -+ fmov d26,x12 -+ fmov d27,x13 -+ fmov d28,x14 -+ -+.Ldo_neon: -+ ldp x8,x12,[x16],#16 // inp[2:3] (or zero) -+ ldp x9,x13,[x16],#48 -+ -+ lsl x3,x3,#24 -+ add x15,x0,#48 -+ -+#ifdef __ARMEB__ -+ rev x8,x8 -+ rev x12,x12 -+ rev x9,x9 -+ rev x13,x13 -+#endif -+ and x4,x8,#0x03ffffff // base 2^64 -> base 2^26 -+ and x5,x9,#0x03ffffff -+ ubfx x6,x8,#26,#26 -+ ubfx x7,x9,#26,#26 -+ add x4,x4,x5,lsl#32 // bfi x4,x5,#32,#32 -+ extr x8,x12,x8,#52 -+ extr x9,x13,x9,#52 -+ add x6,x6,x7,lsl#32 // bfi x6,x7,#32,#32 -+ fmov d14,x4 -+ and x8,x8,#0x03ffffff -+ and x9,x9,#0x03ffffff -+ ubfx x10,x12,#14,#26 -+ ubfx x11,x13,#14,#26 -+ add x12,x3,x12,lsr#40 -+ add x13,x3,x13,lsr#40 -+ add x8,x8,x9,lsl#32 // bfi x8,x9,#32,#32 -+ fmov d15,x6 -+ add x10,x10,x11,lsl#32 // bfi x10,x11,#32,#32 -+ add x12,x12,x13,lsl#32 // bfi x12,x13,#32,#32 -+ fmov d16,x8 -+ fmov d17,x10 -+ fmov d18,x12 -+ -+ ldp x8,x12,[x1],#16 // inp[0:1] -+ ldp x9,x13,[x1],#48 -+ -+ ld1 {v0.4s,v1.4s,v2.4s,v3.4s},[x15],#64 -+ ld1 {v4.4s,v5.4s,v6.4s,v7.4s},[x15],#64 -+ ld1 {v8.4s},[x15] -+ -+#ifdef __ARMEB__ -+ rev x8,x8 -+ rev x12,x12 -+ rev x9,x9 -+ rev x13,x13 -+#endif -+ and x4,x8,#0x03ffffff // base 2^64 -> base 2^26 -+ and x5,x9,#0x03ffffff -+ ubfx x6,x8,#26,#26 -+ ubfx x7,x9,#26,#26 -+ add x4,x4,x5,lsl#32 // bfi x4,x5,#32,#32 -+ extr x8,x12,x8,#52 -+ extr x9,x13,x9,#52 -+ add x6,x6,x7,lsl#32 // bfi x6,x7,#32,#32 -+ fmov d9,x4 -+ and x8,x8,#0x03ffffff -+ and x9,x9,#0x03ffffff -+ ubfx x10,x12,#14,#26 -+ ubfx x11,x13,#14,#26 -+ add x12,x3,x12,lsr#40 -+ add x13,x3,x13,lsr#40 -+ add x8,x8,x9,lsl#32 // bfi x8,x9,#32,#32 -+ fmov d10,x6 -+ add x10,x10,x11,lsl#32 // bfi x10,x11,#32,#32 -+ add x12,x12,x13,lsl#32 // bfi x12,x13,#32,#32 -+ movi v31.2d,#-1 -+ fmov d11,x8 -+ fmov d12,x10 -+ fmov d13,x12 -+ ushr v31.2d,v31.2d,#38 -+ -+ b.ls .Lskip_loop -+ -+.align 4 -+.Loop_neon: -+ //////////////////////////////////////////////////////////////// -+ // ((inp[0]*r^4+inp[2]*r^2+inp[4])*r^4+inp[6]*r^2 -+ // ((inp[1]*r^4+inp[3]*r^2+inp[5])*r^3+inp[7]*r -+ // ___________________/ -+ // ((inp[0]*r^4+inp[2]*r^2+inp[4])*r^4+inp[6]*r^2+inp[8])*r^2 -+ // ((inp[1]*r^4+inp[3]*r^2+inp[5])*r^4+inp[7]*r^2+inp[9])*r -+ // ___________________/ ____________________/ -+ // -+ // Note that we start with inp[2:3]*r^2. This is because it -+ // doesn't depend on reduction in previous iteration. -+ //////////////////////////////////////////////////////////////// -+ // d4 = h0*r4 + h1*r3 + h2*r2 + h3*r1 + h4*r0 -+ // d3 = h0*r3 + h1*r2 + h2*r1 + h3*r0 + h4*5*r4 -+ // d2 = h0*r2 + h1*r1 + h2*r0 + h3*5*r4 + h4*5*r3 -+ // d1 = h0*r1 + h1*r0 + h2*5*r4 + h3*5*r3 + h4*5*r2 -+ // d0 = h0*r0 + h1*5*r4 + h2*5*r3 + h3*5*r2 + h4*5*r1 -+ -+ subs x2,x2,#64 -+ umull v23.2d,v14.2s,v7.s[2] -+ csel x16,x17,x16,lo -+ umull v22.2d,v14.2s,v5.s[2] -+ umull v21.2d,v14.2s,v3.s[2] -+ ldp x8,x12,[x16],#16 // inp[2:3] (or zero) -+ umull v20.2d,v14.2s,v1.s[2] -+ ldp x9,x13,[x16],#48 -+ umull v19.2d,v14.2s,v0.s[2] -+#ifdef __ARMEB__ -+ rev x8,x8 -+ rev x12,x12 -+ rev x9,x9 -+ rev x13,x13 -+#endif -+ -+ umlal v23.2d,v15.2s,v5.s[2] -+ and x4,x8,#0x03ffffff // base 2^64 -> base 2^26 -+ umlal v22.2d,v15.2s,v3.s[2] -+ and x5,x9,#0x03ffffff -+ umlal v21.2d,v15.2s,v1.s[2] -+ ubfx x6,x8,#26,#26 -+ umlal v20.2d,v15.2s,v0.s[2] -+ ubfx x7,x9,#26,#26 -+ umlal v19.2d,v15.2s,v8.s[2] -+ add x4,x4,x5,lsl#32 // bfi x4,x5,#32,#32 -+ -+ umlal v23.2d,v16.2s,v3.s[2] -+ extr x8,x12,x8,#52 -+ umlal v22.2d,v16.2s,v1.s[2] -+ extr x9,x13,x9,#52 -+ umlal v21.2d,v16.2s,v0.s[2] -+ add x6,x6,x7,lsl#32 // bfi x6,x7,#32,#32 -+ umlal v20.2d,v16.2s,v8.s[2] -+ fmov d14,x4 -+ umlal v19.2d,v16.2s,v6.s[2] -+ and x8,x8,#0x03ffffff -+ -+ umlal v23.2d,v17.2s,v1.s[2] -+ and x9,x9,#0x03ffffff -+ umlal v22.2d,v17.2s,v0.s[2] -+ ubfx x10,x12,#14,#26 -+ umlal v21.2d,v17.2s,v8.s[2] -+ ubfx x11,x13,#14,#26 -+ umlal v20.2d,v17.2s,v6.s[2] -+ add x8,x8,x9,lsl#32 // bfi x8,x9,#32,#32 -+ umlal v19.2d,v17.2s,v4.s[2] -+ fmov d15,x6 -+ -+ add v11.2s,v11.2s,v26.2s -+ add x12,x3,x12,lsr#40 -+ umlal v23.2d,v18.2s,v0.s[2] -+ add x13,x3,x13,lsr#40 -+ umlal v22.2d,v18.2s,v8.s[2] -+ add x10,x10,x11,lsl#32 // bfi x10,x11,#32,#32 -+ umlal v21.2d,v18.2s,v6.s[2] -+ add x12,x12,x13,lsl#32 // bfi x12,x13,#32,#32 -+ umlal v20.2d,v18.2s,v4.s[2] -+ fmov d16,x8 -+ umlal v19.2d,v18.2s,v2.s[2] -+ fmov d17,x10 -+ -+ //////////////////////////////////////////////////////////////// -+ // (hash+inp[0:1])*r^4 and accumulate -+ -+ add v9.2s,v9.2s,v24.2s -+ fmov d18,x12 -+ umlal v22.2d,v11.2s,v1.s[0] -+ ldp x8,x12,[x1],#16 // inp[0:1] -+ umlal v19.2d,v11.2s,v6.s[0] -+ ldp x9,x13,[x1],#48 -+ umlal v23.2d,v11.2s,v3.s[0] -+ umlal v20.2d,v11.2s,v8.s[0] -+ umlal v21.2d,v11.2s,v0.s[0] -+#ifdef __ARMEB__ -+ rev x8,x8 -+ rev x12,x12 -+ rev x9,x9 -+ rev x13,x13 -+#endif -+ -+ add v10.2s,v10.2s,v25.2s -+ umlal v22.2d,v9.2s,v5.s[0] -+ umlal v23.2d,v9.2s,v7.s[0] -+ and x4,x8,#0x03ffffff // base 2^64 -> base 2^26 -+ umlal v21.2d,v9.2s,v3.s[0] -+ and x5,x9,#0x03ffffff -+ umlal v19.2d,v9.2s,v0.s[0] -+ ubfx x6,x8,#26,#26 -+ umlal v20.2d,v9.2s,v1.s[0] -+ ubfx x7,x9,#26,#26 -+ -+ add v12.2s,v12.2s,v27.2s -+ add x4,x4,x5,lsl#32 // bfi x4,x5,#32,#32 -+ umlal v22.2d,v10.2s,v3.s[0] -+ extr x8,x12,x8,#52 -+ umlal v23.2d,v10.2s,v5.s[0] -+ extr x9,x13,x9,#52 -+ umlal v19.2d,v10.2s,v8.s[0] -+ add x6,x6,x7,lsl#32 // bfi x6,x7,#32,#32 -+ umlal v21.2d,v10.2s,v1.s[0] -+ fmov d9,x4 -+ umlal v20.2d,v10.2s,v0.s[0] -+ and x8,x8,#0x03ffffff -+ -+ add v13.2s,v13.2s,v28.2s -+ and x9,x9,#0x03ffffff -+ umlal v22.2d,v12.2s,v0.s[0] -+ ubfx x10,x12,#14,#26 -+ umlal v19.2d,v12.2s,v4.s[0] -+ ubfx x11,x13,#14,#26 -+ umlal v23.2d,v12.2s,v1.s[0] -+ add x8,x8,x9,lsl#32 // bfi x8,x9,#32,#32 -+ umlal v20.2d,v12.2s,v6.s[0] -+ fmov d10,x6 -+ umlal v21.2d,v12.2s,v8.s[0] -+ add x12,x3,x12,lsr#40 -+ -+ umlal v22.2d,v13.2s,v8.s[0] -+ add x13,x3,x13,lsr#40 -+ umlal v19.2d,v13.2s,v2.s[0] -+ add x10,x10,x11,lsl#32 // bfi x10,x11,#32,#32 -+ umlal v23.2d,v13.2s,v0.s[0] -+ add x12,x12,x13,lsl#32 // bfi x12,x13,#32,#32 -+ umlal v20.2d,v13.2s,v4.s[0] -+ fmov d11,x8 -+ umlal v21.2d,v13.2s,v6.s[0] -+ fmov d12,x10 -+ fmov d13,x12 -+ -+ ///////////////////////////////////////////////////////////////// -+ // lazy reduction as discussed in "NEON crypto" by D.J. Bernstein -+ // and P. Schwabe -+ // -+ // [see discussion in poly1305-armv4 module] -+ -+ ushr v29.2d,v22.2d,#26 -+ xtn v27.2s,v22.2d -+ ushr v30.2d,v19.2d,#26 -+ and v19.16b,v19.16b,v31.16b -+ add v23.2d,v23.2d,v29.2d // h3 -> h4 -+ bic v27.2s,#0xfc,lsl#24 // &=0x03ffffff -+ add v20.2d,v20.2d,v30.2d // h0 -> h1 -+ -+ ushr v29.2d,v23.2d,#26 -+ xtn v28.2s,v23.2d -+ ushr v30.2d,v20.2d,#26 -+ xtn v25.2s,v20.2d -+ bic v28.2s,#0xfc,lsl#24 -+ add v21.2d,v21.2d,v30.2d // h1 -> h2 -+ -+ add v19.2d,v19.2d,v29.2d -+ shl v29.2d,v29.2d,#2 -+ shrn v30.2s,v21.2d,#26 -+ xtn v26.2s,v21.2d -+ add v19.2d,v19.2d,v29.2d // h4 -> h0 -+ bic v25.2s,#0xfc,lsl#24 -+ add v27.2s,v27.2s,v30.2s // h2 -> h3 -+ bic v26.2s,#0xfc,lsl#24 -+ -+ shrn v29.2s,v19.2d,#26 -+ xtn v24.2s,v19.2d -+ ushr v30.2s,v27.2s,#26 -+ bic v27.2s,#0xfc,lsl#24 -+ bic v24.2s,#0xfc,lsl#24 -+ add v25.2s,v25.2s,v29.2s // h0 -> h1 -+ add v28.2s,v28.2s,v30.2s // h3 -> h4 -+ -+ b.hi .Loop_neon -+ -+.Lskip_loop: -+ dup v16.2d,v16.d[0] -+ add v11.2s,v11.2s,v26.2s -+ -+ //////////////////////////////////////////////////////////////// -+ // multiply (inp[0:1]+hash) or inp[2:3] by r^2:r^1 -+ -+ adds x2,x2,#32 -+ b.ne .Long_tail -+ -+ dup v16.2d,v11.d[0] -+ add v14.2s,v9.2s,v24.2s -+ add v17.2s,v12.2s,v27.2s -+ add v15.2s,v10.2s,v25.2s -+ add v18.2s,v13.2s,v28.2s -+ -+.Long_tail: -+ dup v14.2d,v14.d[0] -+ umull2 v19.2d,v16.4s,v6.4s -+ umull2 v22.2d,v16.4s,v1.4s -+ umull2 v23.2d,v16.4s,v3.4s -+ umull2 v21.2d,v16.4s,v0.4s -+ umull2 v20.2d,v16.4s,v8.4s -+ -+ dup v15.2d,v15.d[0] -+ umlal2 v19.2d,v14.4s,v0.4s -+ umlal2 v21.2d,v14.4s,v3.4s -+ umlal2 v22.2d,v14.4s,v5.4s -+ umlal2 v23.2d,v14.4s,v7.4s -+ umlal2 v20.2d,v14.4s,v1.4s -+ -+ dup v17.2d,v17.d[0] -+ umlal2 v19.2d,v15.4s,v8.4s -+ umlal2 v22.2d,v15.4s,v3.4s -+ umlal2 v21.2d,v15.4s,v1.4s -+ umlal2 v23.2d,v15.4s,v5.4s -+ umlal2 v20.2d,v15.4s,v0.4s -+ -+ dup v18.2d,v18.d[0] -+ umlal2 v22.2d,v17.4s,v0.4s -+ umlal2 v23.2d,v17.4s,v1.4s -+ umlal2 v19.2d,v17.4s,v4.4s -+ umlal2 v20.2d,v17.4s,v6.4s -+ umlal2 v21.2d,v17.4s,v8.4s -+ -+ umlal2 v22.2d,v18.4s,v8.4s -+ umlal2 v19.2d,v18.4s,v2.4s -+ umlal2 v23.2d,v18.4s,v0.4s -+ umlal2 v20.2d,v18.4s,v4.4s -+ umlal2 v21.2d,v18.4s,v6.4s -+ -+ b.eq .Lshort_tail -+ -+ //////////////////////////////////////////////////////////////// -+ // (hash+inp[0:1])*r^4:r^3 and accumulate -+ -+ add v9.2s,v9.2s,v24.2s -+ umlal v22.2d,v11.2s,v1.2s -+ umlal v19.2d,v11.2s,v6.2s -+ umlal v23.2d,v11.2s,v3.2s -+ umlal v20.2d,v11.2s,v8.2s -+ umlal v21.2d,v11.2s,v0.2s -+ -+ add v10.2s,v10.2s,v25.2s -+ umlal v22.2d,v9.2s,v5.2s -+ umlal v19.2d,v9.2s,v0.2s -+ umlal v23.2d,v9.2s,v7.2s -+ umlal v20.2d,v9.2s,v1.2s -+ umlal v21.2d,v9.2s,v3.2s -+ -+ add v12.2s,v12.2s,v27.2s -+ umlal v22.2d,v10.2s,v3.2s -+ umlal v19.2d,v10.2s,v8.2s -+ umlal v23.2d,v10.2s,v5.2s -+ umlal v20.2d,v10.2s,v0.2s -+ umlal v21.2d,v10.2s,v1.2s -+ -+ add v13.2s,v13.2s,v28.2s -+ umlal v22.2d,v12.2s,v0.2s -+ umlal v19.2d,v12.2s,v4.2s -+ umlal v23.2d,v12.2s,v1.2s -+ umlal v20.2d,v12.2s,v6.2s -+ umlal v21.2d,v12.2s,v8.2s -+ -+ umlal v22.2d,v13.2s,v8.2s -+ umlal v19.2d,v13.2s,v2.2s -+ umlal v23.2d,v13.2s,v0.2s -+ umlal v20.2d,v13.2s,v4.2s -+ umlal v21.2d,v13.2s,v6.2s -+ -+.Lshort_tail: -+ //////////////////////////////////////////////////////////////// -+ // horizontal add -+ -+ addp v22.2d,v22.2d,v22.2d -+ ldp d8,d9,[sp,#16] // meet ABI requirements -+ addp v19.2d,v19.2d,v19.2d -+ ldp d10,d11,[sp,#32] -+ addp v23.2d,v23.2d,v23.2d -+ ldp d12,d13,[sp,#48] -+ addp v20.2d,v20.2d,v20.2d -+ ldp d14,d15,[sp,#64] -+ addp v21.2d,v21.2d,v21.2d -+ -+ //////////////////////////////////////////////////////////////// -+ // lazy reduction, but without narrowing -+ -+ ushr v29.2d,v22.2d,#26 -+ and v22.16b,v22.16b,v31.16b -+ ushr v30.2d,v19.2d,#26 -+ and v19.16b,v19.16b,v31.16b -+ -+ add v23.2d,v23.2d,v29.2d // h3 -> h4 -+ add v20.2d,v20.2d,v30.2d // h0 -> h1 -+ -+ ushr v29.2d,v23.2d,#26 -+ and v23.16b,v23.16b,v31.16b -+ ushr v30.2d,v20.2d,#26 -+ and v20.16b,v20.16b,v31.16b -+ add v21.2d,v21.2d,v30.2d // h1 -> h2 -+ -+ add v19.2d,v19.2d,v29.2d -+ shl v29.2d,v29.2d,#2 -+ ushr v30.2d,v21.2d,#26 -+ and v21.16b,v21.16b,v31.16b -+ add v19.2d,v19.2d,v29.2d // h4 -> h0 -+ add v22.2d,v22.2d,v30.2d // h2 -> h3 -+ -+ ushr v29.2d,v19.2d,#26 -+ and v19.16b,v19.16b,v31.16b -+ ushr v30.2d,v22.2d,#26 -+ and v22.16b,v22.16b,v31.16b -+ add v20.2d,v20.2d,v29.2d // h0 -> h1 -+ add v23.2d,v23.2d,v30.2d // h3 -> h4 -+ -+ //////////////////////////////////////////////////////////////// -+ // write the result, can be partially reduced -+ -+ st4 {v19.s,v20.s,v21.s,v22.s}[0],[x0],#16 -+ st1 {v23.s}[0],[x0] -+ -+.Lno_data_neon: -+ ldr x29,[sp],#80 -+ ret -+ENDPROC(poly1305_blocks_neon) -+ -+.align 5 -+ENTRY(poly1305_emit_neon) -+ ldr x17,[x0,#24] -+ cbz x17,poly1305_emit_arm -+ -+ ldp w10,w11,[x0] // load hash value base 2^26 -+ ldp w12,w13,[x0,#8] -+ ldr w14,[x0,#16] -+ -+ add x4,x10,x11,lsl#26 // base 2^26 -> base 2^64 -+ lsr x5,x12,#12 -+ adds x4,x4,x12,lsl#52 -+ add x5,x5,x13,lsl#14 -+ adc x5,x5,xzr -+ lsr x6,x14,#24 -+ adds x5,x5,x14,lsl#40 -+ adc x6,x6,xzr // can be partially reduced... -+ -+ ldp x10,x11,[x2] // load nonce -+ -+ and x12,x6,#-4 // ... so reduce -+ add x12,x12,x6,lsr#2 -+ and x6,x6,#3 -+ adds x4,x4,x12 -+ adcs x5,x5,xzr -+ adc x6,x6,xzr -+ -+ adds x12,x4,#5 // compare to modulus -+ adcs x13,x5,xzr -+ adc x14,x6,xzr -+ -+ tst x14,#-4 // see if it's carried/borrowed -+ -+ csel x4,x4,x12,eq -+ csel x5,x5,x13,eq -+ -+#ifdef __ARMEB__ -+ ror x10,x10,#32 // flip nonce words -+ ror x11,x11,#32 -+#endif -+ adds x4,x4,x10 // accumulate nonce -+ adc x5,x5,x11 -+#ifdef __ARMEB__ -+ rev x4,x4 // flip output bytes -+ rev x5,x5 -+#endif -+ stp x4,x5,[x1] // write result -+ -+ ret -+ENDPROC(poly1305_emit_neon) -+ -+.align 5 -+.Lzeros: -+.long 0,0,0,0,0,0,0,0 ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/poly1305-arm.S 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,1115 @@ -+/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. -+ */ -+ -+#include -+ -+.text -+#if defined(__thumb2__) -+.syntax unified -+.thumb -+#else -+.code 32 -+#endif -+ -+.align 5 -+ENTRY(poly1305_init_arm) -+ stmdb sp!,{r4-r11} -+ -+ eor r3,r3,r3 -+ cmp r1,#0 -+ str r3,[r0,#0] @ zero hash value -+ str r3,[r0,#4] -+ str r3,[r0,#8] -+ str r3,[r0,#12] -+ str r3,[r0,#16] -+ str r3,[r0,#36] @ is_base2_26 -+ add r0,r0,#20 -+ -+#ifdef __thumb2__ -+ it eq -+#endif -+ moveq r0,#0 -+ beq .Lno_key -+ -+ ldrb r4,[r1,#0] -+ mov r10,#0x0fffffff -+ ldrb r5,[r1,#1] -+ and r3,r10,#-4 @ 0x0ffffffc -+ ldrb r6,[r1,#2] -+ ldrb r7,[r1,#3] -+ orr r4,r4,r5,lsl#8 -+ ldrb r5,[r1,#4] -+ orr r4,r4,r6,lsl#16 -+ ldrb r6,[r1,#5] -+ orr r4,r4,r7,lsl#24 -+ ldrb r7,[r1,#6] -+ and r4,r4,r10 -+ -+ ldrb r8,[r1,#7] -+ orr r5,r5,r6,lsl#8 -+ ldrb r6,[r1,#8] -+ orr r5,r5,r7,lsl#16 -+ ldrb r7,[r1,#9] -+ orr r5,r5,r8,lsl#24 -+ ldrb r8,[r1,#10] -+ and r5,r5,r3 -+ -+ ldrb r9,[r1,#11] -+ orr r6,r6,r7,lsl#8 -+ ldrb r7,[r1,#12] -+ orr r6,r6,r8,lsl#16 -+ ldrb r8,[r1,#13] -+ orr r6,r6,r9,lsl#24 -+ ldrb r9,[r1,#14] -+ and r6,r6,r3 -+ -+ ldrb r10,[r1,#15] -+ orr r7,r7,r8,lsl#8 -+ str r4,[r0,#0] -+ orr r7,r7,r9,lsl#16 -+ str r5,[r0,#4] -+ orr r7,r7,r10,lsl#24 -+ str r6,[r0,#8] -+ and r7,r7,r3 -+ str r7,[r0,#12] -+.Lno_key: -+ ldmia sp!,{r4-r11} -+#if __LINUX_ARM_ARCH__ >= 5 -+ bx lr @ bx lr -+#else -+ tst lr,#1 -+ moveq pc,lr @ be binary compatible with V4, yet -+ .word 0xe12fff1e @ interoperable with Thumb ISA:-) -+#endif -+ENDPROC(poly1305_init_arm) -+ -+.align 5 -+ENTRY(poly1305_blocks_arm) -+.Lpoly1305_blocks_arm: -+ stmdb sp!,{r3-r11,lr} -+ -+ ands r2,r2,#-16 -+ beq .Lno_data -+ -+ cmp r3,#0 -+ add r2,r2,r1 @ end pointer -+ sub sp,sp,#32 -+ -+ ldmia r0,{r4-r12} @ load context -+ -+ str r0,[sp,#12] @ offload stuff -+ mov lr,r1 -+ str r2,[sp,#16] -+ str r10,[sp,#20] -+ str r11,[sp,#24] -+ str r12,[sp,#28] -+ b .Loop -+ -+.Loop: -+#if __LINUX_ARM_ARCH__ < 7 -+ ldrb r0,[lr],#16 @ load input -+#ifdef __thumb2__ -+ it hi -+#endif -+ addhi r8,r8,#1 @ 1<<128 -+ ldrb r1,[lr,#-15] -+ ldrb r2,[lr,#-14] -+ ldrb r3,[lr,#-13] -+ orr r1,r0,r1,lsl#8 -+ ldrb r0,[lr,#-12] -+ orr r2,r1,r2,lsl#16 -+ ldrb r1,[lr,#-11] -+ orr r3,r2,r3,lsl#24 -+ ldrb r2,[lr,#-10] -+ adds r4,r4,r3 @ accumulate input -+ -+ ldrb r3,[lr,#-9] -+ orr r1,r0,r1,lsl#8 -+ ldrb r0,[lr,#-8] -+ orr r2,r1,r2,lsl#16 -+ ldrb r1,[lr,#-7] -+ orr r3,r2,r3,lsl#24 -+ ldrb r2,[lr,#-6] -+ adcs r5,r5,r3 -+ -+ ldrb r3,[lr,#-5] -+ orr r1,r0,r1,lsl#8 -+ ldrb r0,[lr,#-4] -+ orr r2,r1,r2,lsl#16 -+ ldrb r1,[lr,#-3] -+ orr r3,r2,r3,lsl#24 -+ ldrb r2,[lr,#-2] -+ adcs r6,r6,r3 -+ -+ ldrb r3,[lr,#-1] -+ orr r1,r0,r1,lsl#8 -+ str lr,[sp,#8] @ offload input pointer -+ orr r2,r1,r2,lsl#16 -+ add r10,r10,r10,lsr#2 -+ orr r3,r2,r3,lsl#24 -+#else -+ ldr r0,[lr],#16 @ load input -+#ifdef __thumb2__ -+ it hi -+#endif -+ addhi r8,r8,#1 @ padbit -+ ldr r1,[lr,#-12] -+ ldr r2,[lr,#-8] -+ ldr r3,[lr,#-4] -+#ifdef __ARMEB__ -+ rev r0,r0 -+ rev r1,r1 -+ rev r2,r2 -+ rev r3,r3 -+#endif -+ adds r4,r4,r0 @ accumulate input -+ str lr,[sp,#8] @ offload input pointer -+ adcs r5,r5,r1 -+ add r10,r10,r10,lsr#2 -+ adcs r6,r6,r2 -+#endif -+ add r11,r11,r11,lsr#2 -+ adcs r7,r7,r3 -+ add r12,r12,r12,lsr#2 -+ -+ umull r2,r3,r5,r9 -+ adc r8,r8,#0 -+ umull r0,r1,r4,r9 -+ umlal r2,r3,r8,r10 -+ umlal r0,r1,r7,r10 -+ ldr r10,[sp,#20] @ reload r10 -+ umlal r2,r3,r6,r12 -+ umlal r0,r1,r5,r12 -+ umlal r2,r3,r7,r11 -+ umlal r0,r1,r6,r11 -+ umlal r2,r3,r4,r10 -+ str r0,[sp,#0] @ future r4 -+ mul r0,r11,r8 -+ ldr r11,[sp,#24] @ reload r11 -+ adds r2,r2,r1 @ d1+=d0>>32 -+ eor r1,r1,r1 -+ adc lr,r3,#0 @ future r6 -+ str r2,[sp,#4] @ future r5 -+ -+ mul r2,r12,r8 -+ eor r3,r3,r3 -+ umlal r0,r1,r7,r12 -+ ldr r12,[sp,#28] @ reload r12 -+ umlal r2,r3,r7,r9 -+ umlal r0,r1,r6,r9 -+ umlal r2,r3,r6,r10 -+ umlal r0,r1,r5,r10 -+ umlal r2,r3,r5,r11 -+ umlal r0,r1,r4,r11 -+ umlal r2,r3,r4,r12 -+ ldr r4,[sp,#0] -+ mul r8,r9,r8 -+ ldr r5,[sp,#4] -+ -+ adds r6,lr,r0 @ d2+=d1>>32 -+ ldr lr,[sp,#8] @ reload input pointer -+ adc r1,r1,#0 -+ adds r7,r2,r1 @ d3+=d2>>32 -+ ldr r0,[sp,#16] @ reload end pointer -+ adc r3,r3,#0 -+ add r8,r8,r3 @ h4+=d3>>32 -+ -+ and r1,r8,#-4 -+ and r8,r8,#3 -+ add r1,r1,r1,lsr#2 @ *=5 -+ adds r4,r4,r1 -+ adcs r5,r5,#0 -+ adcs r6,r6,#0 -+ adcs r7,r7,#0 -+ adc r8,r8,#0 -+ -+ cmp r0,lr @ done yet? -+ bhi .Loop -+ -+ ldr r0,[sp,#12] -+ add sp,sp,#32 -+ stmia r0,{r4-r8} @ store the result -+ -+.Lno_data: -+#if __LINUX_ARM_ARCH__ >= 5 -+ ldmia sp!,{r3-r11,pc} -+#else -+ ldmia sp!,{r3-r11,lr} -+ tst lr,#1 -+ moveq pc,lr @ be binary compatible with V4, yet -+ .word 0xe12fff1e @ interoperable with Thumb ISA:-) -+#endif -+ENDPROC(poly1305_blocks_arm) -+ -+.align 5 -+ENTRY(poly1305_emit_arm) -+ stmdb sp!,{r4-r11} -+.Lpoly1305_emit_enter: -+ ldmia r0,{r3-r7} -+ adds r8,r3,#5 @ compare to modulus -+ adcs r9,r4,#0 -+ adcs r10,r5,#0 -+ adcs r11,r6,#0 -+ adc r7,r7,#0 -+ tst r7,#4 @ did it carry/borrow? -+ -+#ifdef __thumb2__ -+ it ne -+#endif -+ movne r3,r8 -+ ldr r8,[r2,#0] -+#ifdef __thumb2__ -+ it ne -+#endif -+ movne r4,r9 -+ ldr r9,[r2,#4] -+#ifdef __thumb2__ -+ it ne -+#endif -+ movne r5,r10 -+ ldr r10,[r2,#8] -+#ifdef __thumb2__ -+ it ne -+#endif -+ movne r6,r11 -+ ldr r11,[r2,#12] -+ -+ adds r3,r3,r8 -+ adcs r4,r4,r9 -+ adcs r5,r5,r10 -+ adc r6,r6,r11 -+ -+#if __LINUX_ARM_ARCH__ >= 7 -+#ifdef __ARMEB__ -+ rev r3,r3 -+ rev r4,r4 -+ rev r5,r5 -+ rev r6,r6 -+#endif -+ str r3,[r1,#0] -+ str r4,[r1,#4] -+ str r5,[r1,#8] -+ str r6,[r1,#12] -+#else -+ strb r3,[r1,#0] -+ mov r3,r3,lsr#8 -+ strb r4,[r1,#4] -+ mov r4,r4,lsr#8 -+ strb r5,[r1,#8] -+ mov r5,r5,lsr#8 -+ strb r6,[r1,#12] -+ mov r6,r6,lsr#8 -+ -+ strb r3,[r1,#1] -+ mov r3,r3,lsr#8 -+ strb r4,[r1,#5] -+ mov r4,r4,lsr#8 -+ strb r5,[r1,#9] -+ mov r5,r5,lsr#8 -+ strb r6,[r1,#13] -+ mov r6,r6,lsr#8 -+ -+ strb r3,[r1,#2] -+ mov r3,r3,lsr#8 -+ strb r4,[r1,#6] -+ mov r4,r4,lsr#8 -+ strb r5,[r1,#10] -+ mov r5,r5,lsr#8 -+ strb r6,[r1,#14] -+ mov r6,r6,lsr#8 -+ -+ strb r3,[r1,#3] -+ strb r4,[r1,#7] -+ strb r5,[r1,#11] -+ strb r6,[r1,#15] -+#endif -+ ldmia sp!,{r4-r11} -+#if __LINUX_ARM_ARCH__ >= 5 -+ bx lr @ bx lr -+#else -+ tst lr,#1 -+ moveq pc,lr @ be binary compatible with V4, yet -+ .word 0xe12fff1e @ interoperable with Thumb ISA:-) -+#endif -+ENDPROC(poly1305_emit_arm) -+ -+ -+#if __LINUX_ARM_ARCH__ >= 7 -+.fpu neon -+ -+.align 5 -+ENTRY(poly1305_init_neon) -+.Lpoly1305_init_neon: -+ ldr r4,[r0,#20] @ load key base 2^32 -+ ldr r5,[r0,#24] -+ ldr r6,[r0,#28] -+ ldr r7,[r0,#32] -+ -+ and r2,r4,#0x03ffffff @ base 2^32 -> base 2^26 -+ mov r3,r4,lsr#26 -+ mov r4,r5,lsr#20 -+ orr r3,r3,r5,lsl#6 -+ mov r5,r6,lsr#14 -+ orr r4,r4,r6,lsl#12 -+ mov r6,r7,lsr#8 -+ orr r5,r5,r7,lsl#18 -+ and r3,r3,#0x03ffffff -+ and r4,r4,#0x03ffffff -+ and r5,r5,#0x03ffffff -+ -+ vdup.32 d0,r2 @ r^1 in both lanes -+ add r2,r3,r3,lsl#2 @ *5 -+ vdup.32 d1,r3 -+ add r3,r4,r4,lsl#2 -+ vdup.32 d2,r2 -+ vdup.32 d3,r4 -+ add r4,r5,r5,lsl#2 -+ vdup.32 d4,r3 -+ vdup.32 d5,r5 -+ add r5,r6,r6,lsl#2 -+ vdup.32 d6,r4 -+ vdup.32 d7,r6 -+ vdup.32 d8,r5 -+ -+ mov r5,#2 @ counter -+ -+.Lsquare_neon: -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ d0 = h0*r0 + h4*5*r1 + h3*5*r2 + h2*5*r3 + h1*5*r4 -+ @ d1 = h1*r0 + h0*r1 + h4*5*r2 + h3*5*r3 + h2*5*r4 -+ @ d2 = h2*r0 + h1*r1 + h0*r2 + h4*5*r3 + h3*5*r4 -+ @ d3 = h3*r0 + h2*r1 + h1*r2 + h0*r3 + h4*5*r4 -+ @ d4 = h4*r0 + h3*r1 + h2*r2 + h1*r3 + h0*r4 -+ -+ vmull.u32 q5,d0,d0[1] -+ vmull.u32 q6,d1,d0[1] -+ vmull.u32 q7,d3,d0[1] -+ vmull.u32 q8,d5,d0[1] -+ vmull.u32 q9,d7,d0[1] -+ -+ vmlal.u32 q5,d7,d2[1] -+ vmlal.u32 q6,d0,d1[1] -+ vmlal.u32 q7,d1,d1[1] -+ vmlal.u32 q8,d3,d1[1] -+ vmlal.u32 q9,d5,d1[1] -+ -+ vmlal.u32 q5,d5,d4[1] -+ vmlal.u32 q6,d7,d4[1] -+ vmlal.u32 q8,d1,d3[1] -+ vmlal.u32 q7,d0,d3[1] -+ vmlal.u32 q9,d3,d3[1] -+ -+ vmlal.u32 q5,d3,d6[1] -+ vmlal.u32 q8,d0,d5[1] -+ vmlal.u32 q6,d5,d6[1] -+ vmlal.u32 q7,d7,d6[1] -+ vmlal.u32 q9,d1,d5[1] -+ -+ vmlal.u32 q8,d7,d8[1] -+ vmlal.u32 q5,d1,d8[1] -+ vmlal.u32 q6,d3,d8[1] -+ vmlal.u32 q7,d5,d8[1] -+ vmlal.u32 q9,d0,d7[1] -+ -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ lazy reduction as discussed in "NEON crypto" by D.J. Bernstein -+ @ and P. Schwabe -+ @ -+ @ H0>>+H1>>+H2>>+H3>>+H4 -+ @ H3>>+H4>>*5+H0>>+H1 -+ @ -+ @ Trivia. -+ @ -+ @ Result of multiplication of n-bit number by m-bit number is -+ @ n+m bits wide. However! Even though 2^n is a n+1-bit number, -+ @ m-bit number multiplied by 2^n is still n+m bits wide. -+ @ -+ @ Sum of two n-bit numbers is n+1 bits wide, sum of three - n+2, -+ @ and so is sum of four. Sum of 2^m n-m-bit numbers and n-bit -+ @ one is n+1 bits wide. -+ @ -+ @ >>+ denotes Hnext += Hn>>26, Hn &= 0x3ffffff. This means that -+ @ H0, H2, H3 are guaranteed to be 26 bits wide, while H1 and H4 -+ @ can be 27. However! In cases when their width exceeds 26 bits -+ @ they are limited by 2^26+2^6. This in turn means that *sum* -+ @ of the products with these values can still be viewed as sum -+ @ of 52-bit numbers as long as the amount of addends is not a -+ @ power of 2. For example, -+ @ -+ @ H4 = H4*R0 + H3*R1 + H2*R2 + H1*R3 + H0 * R4, -+ @ -+ @ which can't be larger than 5 * (2^26 + 2^6) * (2^26 + 2^6), or -+ @ 5 * (2^52 + 2*2^32 + 2^12), which in turn is smaller than -+ @ 8 * (2^52) or 2^55. However, the value is then multiplied by -+ @ by 5, so we should be looking at 5 * 5 * (2^52 + 2^33 + 2^12), -+ @ which is less than 32 * (2^52) or 2^57. And when processing -+ @ data we are looking at triple as many addends... -+ @ -+ @ In key setup procedure pre-reduced H0 is limited by 5*4+1 and -+ @ 5*H4 - by 5*5 52-bit addends, or 57 bits. But when hashing the -+ @ input H0 is limited by (5*4+1)*3 addends, or 58 bits, while -+ @ 5*H4 by 5*5*3, or 59[!] bits. How is this relevant? vmlal.u32 -+ @ instruction accepts 2x32-bit input and writes 2x64-bit result. -+ @ This means that result of reduction have to be compressed upon -+ @ loop wrap-around. This can be done in the process of reduction -+ @ to minimize amount of instructions [as well as amount of -+ @ 128-bit instructions, which benefits low-end processors], but -+ @ one has to watch for H2 (which is narrower than H0) and 5*H4 -+ @ not being wider than 58 bits, so that result of right shift -+ @ by 26 bits fits in 32 bits. This is also useful on x86, -+ @ because it allows to use paddd in place for paddq, which -+ @ benefits Atom, where paddq is ridiculously slow. -+ -+ vshr.u64 q15,q8,#26 -+ vmovn.i64 d16,q8 -+ vshr.u64 q4,q5,#26 -+ vmovn.i64 d10,q5 -+ vadd.i64 q9,q9,q15 @ h3 -> h4 -+ vbic.i32 d16,#0xfc000000 @ &=0x03ffffff -+ vadd.i64 q6,q6,q4 @ h0 -> h1 -+ vbic.i32 d10,#0xfc000000 -+ -+ vshrn.u64 d30,q9,#26 -+ vmovn.i64 d18,q9 -+ vshr.u64 q4,q6,#26 -+ vmovn.i64 d12,q6 -+ vadd.i64 q7,q7,q4 @ h1 -> h2 -+ vbic.i32 d18,#0xfc000000 -+ vbic.i32 d12,#0xfc000000 -+ -+ vadd.i32 d10,d10,d30 -+ vshl.u32 d30,d30,#2 -+ vshrn.u64 d8,q7,#26 -+ vmovn.i64 d14,q7 -+ vadd.i32 d10,d10,d30 @ h4 -> h0 -+ vadd.i32 d16,d16,d8 @ h2 -> h3 -+ vbic.i32 d14,#0xfc000000 -+ -+ vshr.u32 d30,d10,#26 -+ vbic.i32 d10,#0xfc000000 -+ vshr.u32 d8,d16,#26 -+ vbic.i32 d16,#0xfc000000 -+ vadd.i32 d12,d12,d30 @ h0 -> h1 -+ vadd.i32 d18,d18,d8 @ h3 -> h4 -+ -+ subs r5,r5,#1 -+ beq .Lsquare_break_neon -+ -+ add r6,r0,#(48+0*9*4) -+ add r7,r0,#(48+1*9*4) -+ -+ vtrn.32 d0,d10 @ r^2:r^1 -+ vtrn.32 d3,d14 -+ vtrn.32 d5,d16 -+ vtrn.32 d1,d12 -+ vtrn.32 d7,d18 -+ -+ vshl.u32 d4,d3,#2 @ *5 -+ vshl.u32 d6,d5,#2 -+ vshl.u32 d2,d1,#2 -+ vshl.u32 d8,d7,#2 -+ vadd.i32 d4,d4,d3 -+ vadd.i32 d2,d2,d1 -+ vadd.i32 d6,d6,d5 -+ vadd.i32 d8,d8,d7 -+ -+ vst4.32 {d0[0],d1[0],d2[0],d3[0]},[r6]! -+ vst4.32 {d0[1],d1[1],d2[1],d3[1]},[r7]! -+ vst4.32 {d4[0],d5[0],d6[0],d7[0]},[r6]! -+ vst4.32 {d4[1],d5[1],d6[1],d7[1]},[r7]! -+ vst1.32 {d8[0]},[r6,:32] -+ vst1.32 {d8[1]},[r7,:32] -+ -+ b .Lsquare_neon -+ -+.align 4 -+.Lsquare_break_neon: -+ add r6,r0,#(48+2*4*9) -+ add r7,r0,#(48+3*4*9) -+ -+ vmov d0,d10 @ r^4:r^3 -+ vshl.u32 d2,d12,#2 @ *5 -+ vmov d1,d12 -+ vshl.u32 d4,d14,#2 -+ vmov d3,d14 -+ vshl.u32 d6,d16,#2 -+ vmov d5,d16 -+ vshl.u32 d8,d18,#2 -+ vmov d7,d18 -+ vadd.i32 d2,d2,d12 -+ vadd.i32 d4,d4,d14 -+ vadd.i32 d6,d6,d16 -+ vadd.i32 d8,d8,d18 -+ -+ vst4.32 {d0[0],d1[0],d2[0],d3[0]},[r6]! -+ vst4.32 {d0[1],d1[1],d2[1],d3[1]},[r7]! -+ vst4.32 {d4[0],d5[0],d6[0],d7[0]},[r6]! -+ vst4.32 {d4[1],d5[1],d6[1],d7[1]},[r7]! -+ vst1.32 {d8[0]},[r6] -+ vst1.32 {d8[1]},[r7] -+ -+ bx lr @ bx lr -+ENDPROC(poly1305_init_neon) -+ -+.align 5 -+ENTRY(poly1305_blocks_neon) -+ ldr ip,[r0,#36] @ is_base2_26 -+ ands r2,r2,#-16 -+ beq .Lno_data_neon -+ -+ cmp r2,#64 -+ bhs .Lenter_neon -+ tst ip,ip @ is_base2_26? -+ beq .Lpoly1305_blocks_arm -+ -+.Lenter_neon: -+ stmdb sp!,{r4-r7} -+ vstmdb sp!,{d8-d15} @ ABI specification says so -+ -+ tst ip,ip @ is_base2_26? -+ bne .Lbase2_26_neon -+ -+ stmdb sp!,{r1-r3,lr} -+ bl .Lpoly1305_init_neon -+ -+ ldr r4,[r0,#0] @ load hash value base 2^32 -+ ldr r5,[r0,#4] -+ ldr r6,[r0,#8] -+ ldr r7,[r0,#12] -+ ldr ip,[r0,#16] -+ -+ and r2,r4,#0x03ffffff @ base 2^32 -> base 2^26 -+ mov r3,r4,lsr#26 -+ veor d10,d10,d10 -+ mov r4,r5,lsr#20 -+ orr r3,r3,r5,lsl#6 -+ veor d12,d12,d12 -+ mov r5,r6,lsr#14 -+ orr r4,r4,r6,lsl#12 -+ veor d14,d14,d14 -+ mov r6,r7,lsr#8 -+ orr r5,r5,r7,lsl#18 -+ veor d16,d16,d16 -+ and r3,r3,#0x03ffffff -+ orr r6,r6,ip,lsl#24 -+ veor d18,d18,d18 -+ and r4,r4,#0x03ffffff -+ mov r1,#1 -+ and r5,r5,#0x03ffffff -+ str r1,[r0,#36] @ is_base2_26 -+ -+ vmov.32 d10[0],r2 -+ vmov.32 d12[0],r3 -+ vmov.32 d14[0],r4 -+ vmov.32 d16[0],r5 -+ vmov.32 d18[0],r6 -+ adr r5,.Lzeros -+ -+ ldmia sp!,{r1-r3,lr} -+ b .Lbase2_32_neon -+ -+.align 4 -+.Lbase2_26_neon: -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ load hash value -+ -+ veor d10,d10,d10 -+ veor d12,d12,d12 -+ veor d14,d14,d14 -+ veor d16,d16,d16 -+ veor d18,d18,d18 -+ vld4.32 {d10[0],d12[0],d14[0],d16[0]},[r0]! -+ adr r5,.Lzeros -+ vld1.32 {d18[0]},[r0] -+ sub r0,r0,#16 @ rewind -+ -+.Lbase2_32_neon: -+ add r4,r1,#32 -+ mov r3,r3,lsl#24 -+ tst r2,#31 -+ beq .Leven -+ -+ vld4.32 {d20[0],d22[0],d24[0],d26[0]},[r1]! -+ vmov.32 d28[0],r3 -+ sub r2,r2,#16 -+ add r4,r1,#32 -+ -+#ifdef __ARMEB__ -+ vrev32.8 q10,q10 -+ vrev32.8 q13,q13 -+ vrev32.8 q11,q11 -+ vrev32.8 q12,q12 -+#endif -+ vsri.u32 d28,d26,#8 @ base 2^32 -> base 2^26 -+ vshl.u32 d26,d26,#18 -+ -+ vsri.u32 d26,d24,#14 -+ vshl.u32 d24,d24,#12 -+ vadd.i32 d29,d28,d18 @ add hash value and move to #hi -+ -+ vbic.i32 d26,#0xfc000000 -+ vsri.u32 d24,d22,#20 -+ vshl.u32 d22,d22,#6 -+ -+ vbic.i32 d24,#0xfc000000 -+ vsri.u32 d22,d20,#26 -+ vadd.i32 d27,d26,d16 -+ -+ vbic.i32 d20,#0xfc000000 -+ vbic.i32 d22,#0xfc000000 -+ vadd.i32 d25,d24,d14 -+ -+ vadd.i32 d21,d20,d10 -+ vadd.i32 d23,d22,d12 -+ -+ mov r7,r5 -+ add r6,r0,#48 -+ -+ cmp r2,r2 -+ b .Long_tail -+ -+.align 4 -+.Leven: -+ subs r2,r2,#64 -+ it lo -+ movlo r4,r5 -+ -+ vmov.i32 q14,#1<<24 @ padbit, yes, always -+ vld4.32 {d20,d22,d24,d26},[r1] @ inp[0:1] -+ add r1,r1,#64 -+ vld4.32 {d21,d23,d25,d27},[r4] @ inp[2:3] (or 0) -+ add r4,r4,#64 -+ itt hi -+ addhi r7,r0,#(48+1*9*4) -+ addhi r6,r0,#(48+3*9*4) -+ -+#ifdef __ARMEB__ -+ vrev32.8 q10,q10 -+ vrev32.8 q13,q13 -+ vrev32.8 q11,q11 -+ vrev32.8 q12,q12 -+#endif -+ vsri.u32 q14,q13,#8 @ base 2^32 -> base 2^26 -+ vshl.u32 q13,q13,#18 -+ -+ vsri.u32 q13,q12,#14 -+ vshl.u32 q12,q12,#12 -+ -+ vbic.i32 q13,#0xfc000000 -+ vsri.u32 q12,q11,#20 -+ vshl.u32 q11,q11,#6 -+ -+ vbic.i32 q12,#0xfc000000 -+ vsri.u32 q11,q10,#26 -+ -+ vbic.i32 q10,#0xfc000000 -+ vbic.i32 q11,#0xfc000000 -+ -+ bls .Lskip_loop -+ -+ vld4.32 {d0[1],d1[1],d2[1],d3[1]},[r7]! @ load r^2 -+ vld4.32 {d0[0],d1[0],d2[0],d3[0]},[r6]! @ load r^4 -+ vld4.32 {d4[1],d5[1],d6[1],d7[1]},[r7]! -+ vld4.32 {d4[0],d5[0],d6[0],d7[0]},[r6]! -+ b .Loop_neon -+ -+.align 5 -+.Loop_neon: -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ ((inp[0]*r^4+inp[2]*r^2+inp[4])*r^4+inp[6]*r^2 -+ @ ((inp[1]*r^4+inp[3]*r^2+inp[5])*r^3+inp[7]*r -+ @ ___________________/ -+ @ ((inp[0]*r^4+inp[2]*r^2+inp[4])*r^4+inp[6]*r^2+inp[8])*r^2 -+ @ ((inp[1]*r^4+inp[3]*r^2+inp[5])*r^4+inp[7]*r^2+inp[9])*r -+ @ ___________________/ ____________________/ -+ @ -+ @ Note that we start with inp[2:3]*r^2. This is because it -+ @ doesn't depend on reduction in previous iteration. -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ d4 = h4*r0 + h3*r1 + h2*r2 + h1*r3 + h0*r4 -+ @ d3 = h3*r0 + h2*r1 + h1*r2 + h0*r3 + h4*5*r4 -+ @ d2 = h2*r0 + h1*r1 + h0*r2 + h4*5*r3 + h3*5*r4 -+ @ d1 = h1*r0 + h0*r1 + h4*5*r2 + h3*5*r3 + h2*5*r4 -+ @ d0 = h0*r0 + h4*5*r1 + h3*5*r2 + h2*5*r3 + h1*5*r4 -+ -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ inp[2:3]*r^2 -+ -+ vadd.i32 d24,d24,d14 @ accumulate inp[0:1] -+ vmull.u32 q7,d25,d0[1] -+ vadd.i32 d20,d20,d10 -+ vmull.u32 q5,d21,d0[1] -+ vadd.i32 d26,d26,d16 -+ vmull.u32 q8,d27,d0[1] -+ vmlal.u32 q7,d23,d1[1] -+ vadd.i32 d22,d22,d12 -+ vmull.u32 q6,d23,d0[1] -+ -+ vadd.i32 d28,d28,d18 -+ vmull.u32 q9,d29,d0[1] -+ subs r2,r2,#64 -+ vmlal.u32 q5,d29,d2[1] -+ it lo -+ movlo r4,r5 -+ vmlal.u32 q8,d25,d1[1] -+ vld1.32 d8[1],[r7,:32] -+ vmlal.u32 q6,d21,d1[1] -+ vmlal.u32 q9,d27,d1[1] -+ -+ vmlal.u32 q5,d27,d4[1] -+ vmlal.u32 q8,d23,d3[1] -+ vmlal.u32 q9,d25,d3[1] -+ vmlal.u32 q6,d29,d4[1] -+ vmlal.u32 q7,d21,d3[1] -+ -+ vmlal.u32 q8,d21,d5[1] -+ vmlal.u32 q5,d25,d6[1] -+ vmlal.u32 q9,d23,d5[1] -+ vmlal.u32 q6,d27,d6[1] -+ vmlal.u32 q7,d29,d6[1] -+ -+ vmlal.u32 q8,d29,d8[1] -+ vmlal.u32 q5,d23,d8[1] -+ vmlal.u32 q9,d21,d7[1] -+ vmlal.u32 q6,d25,d8[1] -+ vmlal.u32 q7,d27,d8[1] -+ -+ vld4.32 {d21,d23,d25,d27},[r4] @ inp[2:3] (or 0) -+ add r4,r4,#64 -+ -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ (hash+inp[0:1])*r^4 and accumulate -+ -+ vmlal.u32 q8,d26,d0[0] -+ vmlal.u32 q5,d20,d0[0] -+ vmlal.u32 q9,d28,d0[0] -+ vmlal.u32 q6,d22,d0[0] -+ vmlal.u32 q7,d24,d0[0] -+ vld1.32 d8[0],[r6,:32] -+ -+ vmlal.u32 q8,d24,d1[0] -+ vmlal.u32 q5,d28,d2[0] -+ vmlal.u32 q9,d26,d1[0] -+ vmlal.u32 q6,d20,d1[0] -+ vmlal.u32 q7,d22,d1[0] -+ -+ vmlal.u32 q8,d22,d3[0] -+ vmlal.u32 q5,d26,d4[0] -+ vmlal.u32 q9,d24,d3[0] -+ vmlal.u32 q6,d28,d4[0] -+ vmlal.u32 q7,d20,d3[0] -+ -+ vmlal.u32 q8,d20,d5[0] -+ vmlal.u32 q5,d24,d6[0] -+ vmlal.u32 q9,d22,d5[0] -+ vmlal.u32 q6,d26,d6[0] -+ vmlal.u32 q8,d28,d8[0] -+ -+ vmlal.u32 q7,d28,d6[0] -+ vmlal.u32 q5,d22,d8[0] -+ vmlal.u32 q9,d20,d7[0] -+ vmov.i32 q14,#1<<24 @ padbit, yes, always -+ vmlal.u32 q6,d24,d8[0] -+ vmlal.u32 q7,d26,d8[0] -+ -+ vld4.32 {d20,d22,d24,d26},[r1] @ inp[0:1] -+ add r1,r1,#64 -+#ifdef __ARMEB__ -+ vrev32.8 q10,q10 -+ vrev32.8 q11,q11 -+ vrev32.8 q12,q12 -+ vrev32.8 q13,q13 -+#endif -+ -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ lazy reduction interleaved with base 2^32 -> base 2^26 of -+ @ inp[0:3] previously loaded to q10-q13 and smashed to q10-q14. -+ -+ vshr.u64 q15,q8,#26 -+ vmovn.i64 d16,q8 -+ vshr.u64 q4,q5,#26 -+ vmovn.i64 d10,q5 -+ vadd.i64 q9,q9,q15 @ h3 -> h4 -+ vbic.i32 d16,#0xfc000000 -+ vsri.u32 q14,q13,#8 @ base 2^32 -> base 2^26 -+ vadd.i64 q6,q6,q4 @ h0 -> h1 -+ vshl.u32 q13,q13,#18 -+ vbic.i32 d10,#0xfc000000 -+ -+ vshrn.u64 d30,q9,#26 -+ vmovn.i64 d18,q9 -+ vshr.u64 q4,q6,#26 -+ vmovn.i64 d12,q6 -+ vadd.i64 q7,q7,q4 @ h1 -> h2 -+ vsri.u32 q13,q12,#14 -+ vbic.i32 d18,#0xfc000000 -+ vshl.u32 q12,q12,#12 -+ vbic.i32 d12,#0xfc000000 -+ -+ vadd.i32 d10,d10,d30 -+ vshl.u32 d30,d30,#2 -+ vbic.i32 q13,#0xfc000000 -+ vshrn.u64 d8,q7,#26 -+ vmovn.i64 d14,q7 -+ vaddl.u32 q5,d10,d30 @ h4 -> h0 [widen for a sec] -+ vsri.u32 q12,q11,#20 -+ vadd.i32 d16,d16,d8 @ h2 -> h3 -+ vshl.u32 q11,q11,#6 -+ vbic.i32 d14,#0xfc000000 -+ vbic.i32 q12,#0xfc000000 -+ -+ vshrn.u64 d30,q5,#26 @ re-narrow -+ vmovn.i64 d10,q5 -+ vsri.u32 q11,q10,#26 -+ vbic.i32 q10,#0xfc000000 -+ vshr.u32 d8,d16,#26 -+ vbic.i32 d16,#0xfc000000 -+ vbic.i32 d10,#0xfc000000 -+ vadd.i32 d12,d12,d30 @ h0 -> h1 -+ vadd.i32 d18,d18,d8 @ h3 -> h4 -+ vbic.i32 q11,#0xfc000000 -+ -+ bhi .Loop_neon -+ -+.Lskip_loop: -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ multiply (inp[0:1]+hash) or inp[2:3] by r^2:r^1 -+ -+ add r7,r0,#(48+0*9*4) -+ add r6,r0,#(48+1*9*4) -+ adds r2,r2,#32 -+ it ne -+ movne r2,#0 -+ bne .Long_tail -+ -+ vadd.i32 d25,d24,d14 @ add hash value and move to #hi -+ vadd.i32 d21,d20,d10 -+ vadd.i32 d27,d26,d16 -+ vadd.i32 d23,d22,d12 -+ vadd.i32 d29,d28,d18 -+ -+.Long_tail: -+ vld4.32 {d0[1],d1[1],d2[1],d3[1]},[r7]! @ load r^1 -+ vld4.32 {d0[0],d1[0],d2[0],d3[0]},[r6]! @ load r^2 -+ -+ vadd.i32 d24,d24,d14 @ can be redundant -+ vmull.u32 q7,d25,d0 -+ vadd.i32 d20,d20,d10 -+ vmull.u32 q5,d21,d0 -+ vadd.i32 d26,d26,d16 -+ vmull.u32 q8,d27,d0 -+ vadd.i32 d22,d22,d12 -+ vmull.u32 q6,d23,d0 -+ vadd.i32 d28,d28,d18 -+ vmull.u32 q9,d29,d0 -+ -+ vmlal.u32 q5,d29,d2 -+ vld4.32 {d4[1],d5[1],d6[1],d7[1]},[r7]! -+ vmlal.u32 q8,d25,d1 -+ vld4.32 {d4[0],d5[0],d6[0],d7[0]},[r6]! -+ vmlal.u32 q6,d21,d1 -+ vmlal.u32 q9,d27,d1 -+ vmlal.u32 q7,d23,d1 -+ -+ vmlal.u32 q8,d23,d3 -+ vld1.32 d8[1],[r7,:32] -+ vmlal.u32 q5,d27,d4 -+ vld1.32 d8[0],[r6,:32] -+ vmlal.u32 q9,d25,d3 -+ vmlal.u32 q6,d29,d4 -+ vmlal.u32 q7,d21,d3 -+ -+ vmlal.u32 q8,d21,d5 -+ it ne -+ addne r7,r0,#(48+2*9*4) -+ vmlal.u32 q5,d25,d6 -+ it ne -+ addne r6,r0,#(48+3*9*4) -+ vmlal.u32 q9,d23,d5 -+ vmlal.u32 q6,d27,d6 -+ vmlal.u32 q7,d29,d6 -+ -+ vmlal.u32 q8,d29,d8 -+ vorn q0,q0,q0 @ all-ones, can be redundant -+ vmlal.u32 q5,d23,d8 -+ vshr.u64 q0,q0,#38 -+ vmlal.u32 q9,d21,d7 -+ vmlal.u32 q6,d25,d8 -+ vmlal.u32 q7,d27,d8 -+ -+ beq .Lshort_tail -+ -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ (hash+inp[0:1])*r^4:r^3 and accumulate -+ -+ vld4.32 {d0[1],d1[1],d2[1],d3[1]},[r7]! @ load r^3 -+ vld4.32 {d0[0],d1[0],d2[0],d3[0]},[r6]! @ load r^4 -+ -+ vmlal.u32 q7,d24,d0 -+ vmlal.u32 q5,d20,d0 -+ vmlal.u32 q8,d26,d0 -+ vmlal.u32 q6,d22,d0 -+ vmlal.u32 q9,d28,d0 -+ -+ vmlal.u32 q5,d28,d2 -+ vld4.32 {d4[1],d5[1],d6[1],d7[1]},[r7]! -+ vmlal.u32 q8,d24,d1 -+ vld4.32 {d4[0],d5[0],d6[0],d7[0]},[r6]! -+ vmlal.u32 q6,d20,d1 -+ vmlal.u32 q9,d26,d1 -+ vmlal.u32 q7,d22,d1 -+ -+ vmlal.u32 q8,d22,d3 -+ vld1.32 d8[1],[r7,:32] -+ vmlal.u32 q5,d26,d4 -+ vld1.32 d8[0],[r6,:32] -+ vmlal.u32 q9,d24,d3 -+ vmlal.u32 q6,d28,d4 -+ vmlal.u32 q7,d20,d3 -+ -+ vmlal.u32 q8,d20,d5 -+ vmlal.u32 q5,d24,d6 -+ vmlal.u32 q9,d22,d5 -+ vmlal.u32 q6,d26,d6 -+ vmlal.u32 q7,d28,d6 -+ -+ vmlal.u32 q8,d28,d8 -+ vorn q0,q0,q0 @ all-ones -+ vmlal.u32 q5,d22,d8 -+ vshr.u64 q0,q0,#38 -+ vmlal.u32 q9,d20,d7 -+ vmlal.u32 q6,d24,d8 -+ vmlal.u32 q7,d26,d8 -+ -+.Lshort_tail: -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ horizontal addition -+ -+ vadd.i64 d16,d16,d17 -+ vadd.i64 d10,d10,d11 -+ vadd.i64 d18,d18,d19 -+ vadd.i64 d12,d12,d13 -+ vadd.i64 d14,d14,d15 -+ -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ lazy reduction, but without narrowing -+ -+ vshr.u64 q15,q8,#26 -+ vand.i64 q8,q8,q0 -+ vshr.u64 q4,q5,#26 -+ vand.i64 q5,q5,q0 -+ vadd.i64 q9,q9,q15 @ h3 -> h4 -+ vadd.i64 q6,q6,q4 @ h0 -> h1 -+ -+ vshr.u64 q15,q9,#26 -+ vand.i64 q9,q9,q0 -+ vshr.u64 q4,q6,#26 -+ vand.i64 q6,q6,q0 -+ vadd.i64 q7,q7,q4 @ h1 -> h2 -+ -+ vadd.i64 q5,q5,q15 -+ vshl.u64 q15,q15,#2 -+ vshr.u64 q4,q7,#26 -+ vand.i64 q7,q7,q0 -+ vadd.i64 q5,q5,q15 @ h4 -> h0 -+ vadd.i64 q8,q8,q4 @ h2 -> h3 -+ -+ vshr.u64 q15,q5,#26 -+ vand.i64 q5,q5,q0 -+ vshr.u64 q4,q8,#26 -+ vand.i64 q8,q8,q0 -+ vadd.i64 q6,q6,q15 @ h0 -> h1 -+ vadd.i64 q9,q9,q4 @ h3 -> h4 -+ -+ cmp r2,#0 -+ bne .Leven -+ -+ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ -+ @ store hash value -+ -+ vst4.32 {d10[0],d12[0],d14[0],d16[0]},[r0]! -+ vst1.32 {d18[0]},[r0] -+ -+ vldmia sp!,{d8-d15} @ epilogue -+ ldmia sp!,{r4-r7} -+.Lno_data_neon: -+ bx lr @ bx lr -+ENDPROC(poly1305_blocks_neon) -+ -+.align 5 -+ENTRY(poly1305_emit_neon) -+ ldr ip,[r0,#36] @ is_base2_26 -+ -+ stmdb sp!,{r4-r11} -+ -+ tst ip,ip -+ beq .Lpoly1305_emit_enter -+ -+ ldmia r0,{r3-r7} -+ eor r8,r8,r8 -+ -+ adds r3,r3,r4,lsl#26 @ base 2^26 -> base 2^32 -+ mov r4,r4,lsr#6 -+ adcs r4,r4,r5,lsl#20 -+ mov r5,r5,lsr#12 -+ adcs r5,r5,r6,lsl#14 -+ mov r6,r6,lsr#18 -+ adcs r6,r6,r7,lsl#8 -+ adc r7,r8,r7,lsr#24 @ can be partially reduced ... -+ -+ and r8,r7,#-4 @ ... so reduce -+ and r7,r6,#3 -+ add r8,r8,r8,lsr#2 @ *= 5 -+ adds r3,r3,r8 -+ adcs r4,r4,#0 -+ adcs r5,r5,#0 -+ adcs r6,r6,#0 -+ adc r7,r7,#0 -+ -+ adds r8,r3,#5 @ compare to modulus -+ adcs r9,r4,#0 -+ adcs r10,r5,#0 -+ adcs r11,r6,#0 -+ adc r7,r7,#0 -+ tst r7,#4 @ did it carry/borrow? -+ -+ it ne -+ movne r3,r8 -+ ldr r8,[r2,#0] -+ it ne -+ movne r4,r9 -+ ldr r9,[r2,#4] -+ it ne -+ movne r5,r10 -+ ldr r10,[r2,#8] -+ it ne -+ movne r6,r11 -+ ldr r11,[r2,#12] -+ -+ adds r3,r3,r8 @ accumulate nonce -+ adcs r4,r4,r9 -+ adcs r5,r5,r10 -+ adc r6,r6,r11 -+ -+#ifdef __ARMEB__ -+ rev r3,r3 -+ rev r4,r4 -+ rev r5,r5 -+ rev r6,r6 -+#endif -+ str r3,[r1,#0] @ store the result -+ str r4,[r1,#4] -+ str r5,[r1,#8] -+ str r6,[r1,#12] -+ -+ ldmia sp!,{r4-r11} -+ bx lr @ bx lr -+ENDPROC(poly1305_emit_neon) -+ -+.align 5 -+.Lzeros: -+.long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0 -+#endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/poly1305-mips64.S 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,357 @@ -+/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. -+ */ -+ -+#if !defined(CONFIG_64BIT) -+#error "This is only for 64-bit kernels." -+#endif -+ -+#ifdef __MIPSEB__ -+#define MSB 0 -+#define LSB 7 -+#else -+#define MSB 7 -+#define LSB 0 -+#endif -+ -+#if defined(CONFIG_CPU_MIPS64_R6) || defined(CONFIG_CPU_MIPSR6) -+#define dmultu(rs,rt) -+#define mflo(rd,rs,rt) dmulu rd,rs,rt -+#define mfhi(rd,rs,rt) dmuhu rd,rs,rt -+#else -+#define dmultu(rs,rt) dmultu rs,rt -+#define multu(rs,rt) multu rs,rt -+#define mflo(rd,rs,rt) mflo rd -+#define mfhi(rd,rs,rt) mfhi rd -+#endif -+ -+.text -+.set noat -+.set noreorder -+ -+/* While most of the assembly in the kernel prefers ENTRY() and ENDPROC(), -+ * there is no existing MIPS assembly that uses it, and MIPS assembler seems -+ * to like its own .ent/.end notation, which the MIPS include files don't -+ * provide in a MIPS-specific ENTRY/ENDPROC definition. So, we skip these -+ * for now, until somebody complains. */ -+ -+.align 5 -+.globl poly1305_init_mips -+.ent poly1305_init_mips -+poly1305_init_mips: -+ .frame $29,0,$31 -+ .set reorder -+ -+ sd $0,0($4) -+ sd $0,8($4) -+ sd $0,16($4) -+ -+ beqz $5,.Lno_key -+ -+#if defined(CONFIG_CPU_MIPS64_R6) || defined(CONFIG_CPU_MIPSR6) -+ ld $8,0($5) -+ ld $9,8($5) -+#else -+ ldl $8,0+MSB($5) -+ ldl $9,8+MSB($5) -+ ldr $8,0+LSB($5) -+ ldr $9,8+LSB($5) -+#endif -+#ifdef __MIPSEB__ -+#if defined(CONFIG_CPU_MIPS64_R2) || defined(CONFIG_CPU_MIPSR2) || defined(CONFIG_CPU_MIPS64_R6) || defined(CONFIG_CPU_MIPSR6) -+ dsbh $8,$8 # byte swap -+ dsbh $9,$9 -+ dshd $8,$8 -+ dshd $9,$9 -+#else -+ ori $10,$0,0xFF -+ dsll $1,$10,32 -+ or $10,$1 # 0x000000FF000000FF -+ -+ and $11,$8,$10 # byte swap -+ and $2,$9,$10 -+ dsrl $1,$8,24 -+ dsrl $24,$9,24 -+ dsll $11,24 -+ dsll $2,24 -+ and $1,$10 -+ and $24,$10 -+ dsll $10,8 # 0x0000FF000000FF00 -+ or $11,$1 -+ or $2,$24 -+ and $1,$8,$10 -+ and $24,$9,$10 -+ dsrl $8,8 -+ dsrl $9,8 -+ dsll $1,8 -+ dsll $24,8 -+ and $8,$10 -+ and $9,$10 -+ or $11,$1 -+ or $2,$24 -+ or $8,$11 -+ or $9,$2 -+ dsrl $11,$8,32 -+ dsrl $2,$9,32 -+ dsll $8,32 -+ dsll $9,32 -+ or $8,$11 -+ or $9,$2 -+#endif -+#endif -+ li $10,1 -+ dsll $10,32 -+ daddiu $10,-63 -+ dsll $10,28 -+ daddiu $10,-1 # 0ffffffc0fffffff -+ -+ and $8,$10 -+ daddiu $10,-3 # 0ffffffc0ffffffc -+ and $9,$10 -+ -+ sd $8,24($4) -+ dsrl $10,$9,2 -+ sd $9,32($4) -+ daddu $10,$9 # s1 = r1 + (r1 >> 2) -+ sd $10,40($4) -+ -+.Lno_key: -+ li $2,0 # return 0 -+ jr $31 -+.end poly1305_init_mips -+ -+.align 5 -+.globl poly1305_blocks_mips -+.ent poly1305_blocks_mips -+poly1305_blocks_mips: -+ .set noreorder -+ dsrl $6,4 # number of complete blocks -+ bnez $6,poly1305_blocks_internal -+ nop -+ jr $31 -+ nop -+.end poly1305_blocks_mips -+ -+.align 5 -+.ent poly1305_blocks_internal -+poly1305_blocks_internal: -+ .frame $29,6*8,$31 -+ .mask 0x00030000,-8 -+ .set noreorder -+ dsubu $29,6*8 -+ sd $17,40($29) -+ sd $16,32($29) -+ .set reorder -+ -+ ld $12,0($4) # load hash value -+ ld $13,8($4) -+ ld $14,16($4) -+ -+ ld $15,24($4) # load key -+ ld $16,32($4) -+ ld $17,40($4) -+ -+.Loop: -+#if defined(CONFIG_CPU_MIPS64_R6) || defined(CONFIG_CPU_MIPSR6) -+ ld $8,0($5) # load input -+ ld $9,8($5) -+#else -+ ldl $8,0+MSB($5) # load input -+ ldl $9,8+MSB($5) -+ ldr $8,0+LSB($5) -+ ldr $9,8+LSB($5) -+#endif -+ daddiu $6,-1 -+ daddiu $5,16 -+#ifdef __MIPSEB__ -+#if defined(CONFIG_CPU_MIPS64_R2) || defined(CONFIG_CPU_MIPSR2) || defined(CONFIG_CPU_MIPS64_R6) || defined(CONFIG_CPU_MIPSR6) -+ dsbh $8,$8 # byte swap -+ dsbh $9,$9 -+ dshd $8,$8 -+ dshd $9,$9 -+#else -+ ori $10,$0,0xFF -+ dsll $1,$10,32 -+ or $10,$1 # 0x000000FF000000FF -+ -+ and $11,$8,$10 # byte swap -+ and $2,$9,$10 -+ dsrl $1,$8,24 -+ dsrl $24,$9,24 -+ dsll $11,24 -+ dsll $2,24 -+ and $1,$10 -+ and $24,$10 -+ dsll $10,8 # 0x0000FF000000FF00 -+ or $11,$1 -+ or $2,$24 -+ and $1,$8,$10 -+ and $24,$9,$10 -+ dsrl $8,8 -+ dsrl $9,8 -+ dsll $1,8 -+ dsll $24,8 -+ and $8,$10 -+ and $9,$10 -+ or $11,$1 -+ or $2,$24 -+ or $8,$11 -+ or $9,$2 -+ dsrl $11,$8,32 -+ dsrl $2,$9,32 -+ dsll $8,32 -+ dsll $9,32 -+ or $8,$11 -+ or $9,$2 -+#endif -+#endif -+ daddu $12,$8 # accumulate input -+ daddu $13,$9 -+ sltu $10,$12,$8 -+ sltu $11,$13,$9 -+ daddu $13,$10 -+ -+ dmultu ($15,$12) # h0*r0 -+ daddu $14,$7 -+ sltu $10,$13,$10 -+ mflo ($8,$15,$12) -+ mfhi ($9,$15,$12) -+ -+ dmultu ($17,$13) # h1*5*r1 -+ daddu $10,$11 -+ daddu $14,$10 -+ mflo ($10,$17,$13) -+ mfhi ($11,$17,$13) -+ -+ dmultu ($16,$12) # h0*r1 -+ daddu $8,$10 -+ daddu $9,$11 -+ mflo ($1,$16,$12) -+ mfhi ($25,$16,$12) -+ sltu $10,$8,$10 -+ daddu $9,$10 -+ -+ dmultu ($15,$13) # h1*r0 -+ daddu $9,$1 -+ sltu $1,$9,$1 -+ mflo ($10,$15,$13) -+ mfhi ($11,$15,$13) -+ daddu $25,$1 -+ -+ dmultu ($17,$14) # h2*5*r1 -+ daddu $9,$10 -+ daddu $25,$11 -+ mflo ($1,$17,$14) -+ -+ dmultu ($15,$14) # h2*r0 -+ sltu $10,$9,$10 -+ daddu $25,$10 -+ mflo ($2,$15,$14) -+ -+ daddu $9,$1 -+ daddu $25,$2 -+ sltu $1,$9,$1 -+ daddu $25,$1 -+ -+ li $10,-4 # final reduction -+ and $10,$25 -+ dsrl $11,$25,2 -+ andi $14,$25,3 -+ daddu $10,$11 -+ daddu $12,$8,$10 -+ sltu $10,$12,$10 -+ daddu $13,$9,$10 -+ sltu $10,$13,$10 -+ daddu $14,$14,$10 -+ -+ bnez $6,.Loop -+ -+ sd $12,0($4) # store hash value -+ sd $13,8($4) -+ sd $14,16($4) -+ -+ .set noreorder -+ ld $17,40($29) # epilogue -+ ld $16,32($29) -+ jr $31 -+ daddu $29,6*8 -+.end poly1305_blocks_internal -+ -+.align 5 -+.globl poly1305_emit_mips -+.ent poly1305_emit_mips -+poly1305_emit_mips: -+ .frame $29,0,$31 -+ .set reorder -+ -+ ld $10,0($4) -+ ld $11,8($4) -+ ld $1,16($4) -+ -+ daddiu $8,$10,5 # compare to modulus -+ sltiu $2,$8,5 -+ daddu $9,$11,$2 -+ sltu $2,$9,$2 -+ daddu $1,$1,$2 -+ -+ dsrl $1,2 # see if it carried/borrowed -+ dsubu $1,$0,$1 -+ nor $2,$0,$1 -+ -+ and $8,$1 -+ and $10,$2 -+ and $9,$1 -+ and $11,$2 -+ or $8,$10 -+ or $9,$11 -+ -+ lwu $10,0($6) # load nonce -+ lwu $11,4($6) -+ lwu $1,8($6) -+ lwu $2,12($6) -+ dsll $11,32 -+ dsll $2,32 -+ or $10,$11 -+ or $1,$2 -+ -+ daddu $8,$10 # accumulate nonce -+ daddu $9,$1 -+ sltu $10,$8,$10 -+ daddu $9,$10 -+ -+ dsrl $10,$8,8 # write mac value -+ dsrl $11,$8,16 -+ dsrl $1,$8,24 -+ sb $8,0($5) -+ dsrl $2,$8,32 -+ sb $10,1($5) -+ dsrl $10,$8,40 -+ sb $11,2($5) -+ dsrl $11,$8,48 -+ sb $1,3($5) -+ dsrl $1,$8,56 -+ sb $2,4($5) -+ dsrl $2,$9,8 -+ sb $10,5($5) -+ dsrl $10,$9,16 -+ sb $11,6($5) -+ dsrl $11,$9,24 -+ sb $1,7($5) -+ -+ sb $9,8($5) -+ dsrl $1,$9,32 -+ sb $2,9($5) -+ dsrl $2,$9,40 -+ sb $10,10($5) -+ dsrl $10,$9,48 -+ sb $11,11($5) -+ dsrl $11,$9,56 -+ sb $1,12($5) -+ sb $2,13($5) -+ sb $10,14($5) -+ sb $11,15($5) -+ -+ jr $31 -+.end poly1305_emit_mips ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/crypto/poly1305-x86_64.S 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,2803 @@ -+/* SPDX-License-Identifier: OpenSSL OR (BSD-3-Clause OR GPL-2.0) -+ * -+ * Copyright (C) 2017 Samuel Neves . All Rights Reserved. -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved. -+ */ -+ -+#include -+ -+.section .rodata.cst32.Lmask24, "aM", @progbits, 32 -+.align 64 -+.Lconst: -+.Lmask24: -+.long 0x0ffffff,0,0x0ffffff,0,0x0ffffff,0,0x0ffffff,0 -+.section .rodata.cst32.L129, "aM", @progbits, 32 -+.align 32 -+.L129: -+.long 16777216,0,16777216,0,16777216,0,16777216,0 -+.section .rodata.cst32.Lmask26, "aM", @progbits, 32 -+.align 32 -+.Lmask26: -+.long 0x3ffffff,0,0x3ffffff,0,0x3ffffff,0,0x3ffffff,0 -+.section .rodata.cst32.Lpermd_avx2, "aM", @progbits, 32 -+.align 32 -+.Lpermd_avx2: -+.long 2,2,2,3,2,0,2,1 -+.section .rodata.cst64.Lpermd_avx512, "aM", @progbits, 64 -+.align 64 -+.Lpermd_avx512: -+.long 0,0,0,1, 0,2,0,3, 0,4,0,5, 0,6,0,7 -+ -+.text -+ -+.align 32 -+ENTRY(poly1305_init_x86_64) -+ xorq %rax,%rax -+ movq %rax,0(%rdi) -+ movq %rax,8(%rdi) -+ movq %rax,16(%rdi) -+ -+ cmpq $0,%rsi -+ je .Lno_key -+ -+ movq $0x0ffffffc0fffffff,%rax -+ movq $0x0ffffffc0ffffffc,%rcx -+ andq 0(%rsi),%rax -+ andq 8(%rsi),%rcx -+ movq %rax,24(%rdi) -+ movq %rcx,32(%rdi) -+ movl $1,%eax -+.Lno_key: -+ ret -+ENDPROC(poly1305_init_x86_64) -+ -+.align 32 -+ENTRY(poly1305_blocks_x86_64) -+.Lblocks: -+ shrq $4,%rdx -+ jz .Lno_data -+ -+ pushq %rbx -+ pushq %r12 -+ pushq %r13 -+ pushq %r14 -+ pushq %r15 -+ pushq %rdi -+ -+.Lblocks_body: -+ -+ movq %rdx,%r15 -+ -+ movq 24(%rdi),%r11 -+ movq 32(%rdi),%r13 -+ -+ movq 0(%rdi),%r14 -+ movq 8(%rdi),%rbx -+ movq 16(%rdi),%r10 -+ -+ movq %r13,%r12 -+ shrq $2,%r13 -+ movq %r12,%rax -+ addq %r12,%r13 -+ jmp .Loop -+ -+.align 32 -+.Loop: -+ -+ addq 0(%rsi),%r14 -+ adcq 8(%rsi),%rbx -+ leaq 16(%rsi),%rsi -+ adcq %rcx,%r10 -+ mulq %r14 -+ movq %rax,%r9 -+ movq %r11,%rax -+ movq %rdx,%rdi -+ -+ mulq %r14 -+ movq %rax,%r14 -+ movq %r11,%rax -+ movq %rdx,%r8 -+ -+ mulq %rbx -+ addq %rax,%r9 -+ movq %r13,%rax -+ adcq %rdx,%rdi -+ -+ mulq %rbx -+ movq %r10,%rbx -+ addq %rax,%r14 -+ adcq %rdx,%r8 -+ -+ imulq %r13,%rbx -+ addq %rbx,%r9 -+ movq %r8,%rbx -+ adcq $0,%rdi -+ -+ imulq %r11,%r10 -+ addq %r9,%rbx -+ movq $-4,%rax -+ adcq %r10,%rdi -+ -+ andq %rdi,%rax -+ movq %rdi,%r10 -+ shrq $2,%rdi -+ andq $3,%r10 -+ addq %rdi,%rax -+ addq %rax,%r14 -+ adcq $0,%rbx -+ adcq $0,%r10 -+ -+ movq %r12,%rax -+ decq %r15 -+ jnz .Loop -+ -+ movq 0(%rsp),%rdi -+ -+ movq %r14,0(%rdi) -+ movq %rbx,8(%rdi) -+ movq %r10,16(%rdi) -+ -+ movq 8(%rsp),%r15 -+ movq 16(%rsp),%r14 -+ movq 24(%rsp),%r13 -+ movq 32(%rsp),%r12 -+ movq 40(%rsp),%rbx -+ leaq 48(%rsp),%rsp -+.Lno_data: -+.Lblocks_epilogue: -+ ret -+ENDPROC(poly1305_blocks_x86_64) -+ -+.align 32 -+ENTRY(poly1305_emit_x86_64) -+.Lemit: -+ movq 0(%rdi),%r8 -+ movq 8(%rdi),%r9 -+ movq 16(%rdi),%r10 -+ -+ movq %r8,%rax -+ addq $5,%r8 -+ movq %r9,%rcx -+ adcq $0,%r9 -+ adcq $0,%r10 -+ shrq $2,%r10 -+ cmovnzq %r8,%rax -+ cmovnzq %r9,%rcx -+ -+ addq 0(%rdx),%rax -+ adcq 8(%rdx),%rcx -+ movq %rax,0(%rsi) -+ movq %rcx,8(%rsi) -+ -+ ret -+ENDPROC(poly1305_emit_x86_64) -+ -+.macro __poly1305_block -+ mulq %r14 -+ movq %rax,%r9 -+ movq %r11,%rax -+ movq %rdx,%rdi -+ -+ mulq %r14 -+ movq %rax,%r14 -+ movq %r11,%rax -+ movq %rdx,%r8 -+ -+ mulq %rbx -+ addq %rax,%r9 -+ movq %r13,%rax -+ adcq %rdx,%rdi -+ -+ mulq %rbx -+ movq %r10,%rbx -+ addq %rax,%r14 -+ adcq %rdx,%r8 -+ -+ imulq %r13,%rbx -+ addq %rbx,%r9 -+ movq %r8,%rbx -+ adcq $0,%rdi -+ -+ imulq %r11,%r10 -+ addq %r9,%rbx -+ movq $-4,%rax -+ adcq %r10,%rdi -+ -+ andq %rdi,%rax -+ movq %rdi,%r10 -+ shrq $2,%rdi -+ andq $3,%r10 -+ addq %rdi,%rax -+ addq %rax,%r14 -+ adcq $0,%rbx -+ adcq $0,%r10 -+.endm -+ -+.macro __poly1305_init_avx -+ movq %r11,%r14 -+ movq %r12,%rbx -+ xorq %r10,%r10 -+ -+ leaq 48+64(%rdi),%rdi -+ -+ movq %r12,%rax -+ movq %rdi,0(%rsp) -+ __poly1305_block -+ movq 0(%rsp),%rdi -+ -+ movl $0x3ffffff,%eax -+ movl $0x3ffffff,%edx -+ movq %r14,%r8 -+ andl %r14d,%eax -+ movq %r11,%r9 -+ andl %r11d,%edx -+ movl %eax,-64(%rdi) -+ shrq $26,%r8 -+ movl %edx,-60(%rdi) -+ shrq $26,%r9 -+ -+ movl $0x3ffffff,%eax -+ movl $0x3ffffff,%edx -+ andl %r8d,%eax -+ andl %r9d,%edx -+ movl %eax,-48(%rdi) -+ leal (%rax,%rax,4),%eax -+ movl %edx,-44(%rdi) -+ leal (%rdx,%rdx,4),%edx -+ movl %eax,-32(%rdi) -+ shrq $26,%r8 -+ movl %edx,-28(%rdi) -+ shrq $26,%r9 -+ -+ movq %rbx,%rax -+ movq %r12,%rdx -+ shlq $12,%rax -+ shlq $12,%rdx -+ orq %r8,%rax -+ orq %r9,%rdx -+ andl $0x3ffffff,%eax -+ andl $0x3ffffff,%edx -+ movl %eax,-16(%rdi) -+ leal (%rax,%rax,4),%eax -+ movl %edx,-12(%rdi) -+ leal (%rdx,%rdx,4),%edx -+ movl %eax,0(%rdi) -+ movq %rbx,%r8 -+ movl %edx,4(%rdi) -+ movq %r12,%r9 -+ -+ movl $0x3ffffff,%eax -+ movl $0x3ffffff,%edx -+ shrq $14,%r8 -+ shrq $14,%r9 -+ andl %r8d,%eax -+ andl %r9d,%edx -+ movl %eax,16(%rdi) -+ leal (%rax,%rax,4),%eax -+ movl %edx,20(%rdi) -+ leal (%rdx,%rdx,4),%edx -+ movl %eax,32(%rdi) -+ shrq $26,%r8 -+ movl %edx,36(%rdi) -+ shrq $26,%r9 -+ -+ movq %r10,%rax -+ shlq $24,%rax -+ orq %rax,%r8 -+ movl %r8d,48(%rdi) -+ leaq (%r8,%r8,4),%r8 -+ movl %r9d,52(%rdi) -+ leaq (%r9,%r9,4),%r9 -+ movl %r8d,64(%rdi) -+ movl %r9d,68(%rdi) -+ -+ movq %r12,%rax -+ movq %rdi,0(%rsp) -+ __poly1305_block -+ movq 0(%rsp),%rdi -+ -+ movl $0x3ffffff,%eax -+ movq %r14,%r8 -+ andl %r14d,%eax -+ shrq $26,%r8 -+ movl %eax,-52(%rdi) -+ -+ movl $0x3ffffff,%edx -+ andl %r8d,%edx -+ movl %edx,-36(%rdi) -+ leal (%rdx,%rdx,4),%edx -+ shrq $26,%r8 -+ movl %edx,-20(%rdi) -+ -+ movq %rbx,%rax -+ shlq $12,%rax -+ orq %r8,%rax -+ andl $0x3ffffff,%eax -+ movl %eax,-4(%rdi) -+ leal (%rax,%rax,4),%eax -+ movq %rbx,%r8 -+ movl %eax,12(%rdi) -+ -+ movl $0x3ffffff,%edx -+ shrq $14,%r8 -+ andl %r8d,%edx -+ movl %edx,28(%rdi) -+ leal (%rdx,%rdx,4),%edx -+ shrq $26,%r8 -+ movl %edx,44(%rdi) -+ -+ movq %r10,%rax -+ shlq $24,%rax -+ orq %rax,%r8 -+ movl %r8d,60(%rdi) -+ leaq (%r8,%r8,4),%r8 -+ movl %r8d,76(%rdi) -+ -+ movq %r12,%rax -+ movq %rdi,0(%rsp) -+ __poly1305_block -+ movq 0(%rsp),%rdi -+ -+ movl $0x3ffffff,%eax -+ movq %r14,%r8 -+ andl %r14d,%eax -+ shrq $26,%r8 -+ movl %eax,-56(%rdi) -+ -+ movl $0x3ffffff,%edx -+ andl %r8d,%edx -+ movl %edx,-40(%rdi) -+ leal (%rdx,%rdx,4),%edx -+ shrq $26,%r8 -+ movl %edx,-24(%rdi) -+ -+ movq %rbx,%rax -+ shlq $12,%rax -+ orq %r8,%rax -+ andl $0x3ffffff,%eax -+ movl %eax,-8(%rdi) -+ leal (%rax,%rax,4),%eax -+ movq %rbx,%r8 -+ movl %eax,8(%rdi) -+ -+ movl $0x3ffffff,%edx -+ shrq $14,%r8 -+ andl %r8d,%edx -+ movl %edx,24(%rdi) -+ leal (%rdx,%rdx,4),%edx -+ shrq $26,%r8 -+ movl %edx,40(%rdi) -+ -+ movq %r10,%rax -+ shlq $24,%rax -+ orq %rax,%r8 -+ movl %r8d,56(%rdi) -+ leaq (%r8,%r8,4),%r8 -+ movl %r8d,72(%rdi) -+ -+ leaq -48-64(%rdi),%rdi -+.endm -+ -+#ifdef CONFIG_AS_AVX -+.align 32 -+ENTRY(poly1305_blocks_avx) -+ -+ movl 20(%rdi),%r8d -+ cmpq $128,%rdx -+ jae .Lblocks_avx -+ testl %r8d,%r8d -+ jz .Lblocks -+ -+.Lblocks_avx: -+ andq $-16,%rdx -+ jz .Lno_data_avx -+ -+ vzeroupper -+ -+ testl %r8d,%r8d -+ jz .Lbase2_64_avx -+ -+ testq $31,%rdx -+ jz .Leven_avx -+ -+ pushq %rbx -+ pushq %r12 -+ pushq %r13 -+ pushq %r14 -+ pushq %r15 -+ pushq %rdi -+ -+.Lblocks_avx_body: -+ -+ movq %rdx,%r15 -+ -+ movq 0(%rdi),%r8 -+ movq 8(%rdi),%r9 -+ movl 16(%rdi),%r10d -+ -+ movq 24(%rdi),%r11 -+ movq 32(%rdi),%r13 -+ -+ -+ movl %r8d,%r14d -+ andq $-2147483648,%r8 -+ movq %r9,%r12 -+ movl %r9d,%ebx -+ andq $-2147483648,%r9 -+ -+ shrq $6,%r8 -+ shlq $52,%r12 -+ addq %r8,%r14 -+ shrq $12,%rbx -+ shrq $18,%r9 -+ addq %r12,%r14 -+ adcq %r9,%rbx -+ -+ movq %r10,%r8 -+ shlq $40,%r8 -+ shrq $24,%r10 -+ addq %r8,%rbx -+ adcq $0,%r10 -+ -+ movq $-4,%r9 -+ movq %r10,%r8 -+ andq %r10,%r9 -+ shrq $2,%r8 -+ andq $3,%r10 -+ addq %r9,%r8 -+ addq %r8,%r14 -+ adcq $0,%rbx -+ adcq $0,%r10 -+ -+ movq %r13,%r12 -+ movq %r13,%rax -+ shrq $2,%r13 -+ addq %r12,%r13 -+ -+ addq 0(%rsi),%r14 -+ adcq 8(%rsi),%rbx -+ leaq 16(%rsi),%rsi -+ adcq %rcx,%r10 -+ -+ movq %rdi,0(%rsp) -+ __poly1305_block -+ movq 0(%rsp),%rdi -+ -+ testq %rcx,%rcx -+ jz .Lstore_base2_64_avx -+ -+ -+ movq %r14,%rax -+ movq %r14,%rdx -+ shrq $52,%r14 -+ movq %rbx,%r11 -+ movq %rbx,%r12 -+ shrq $26,%rdx -+ andq $0x3ffffff,%rax -+ shlq $12,%r11 -+ andq $0x3ffffff,%rdx -+ shrq $14,%rbx -+ orq %r11,%r14 -+ shlq $24,%r10 -+ andq $0x3ffffff,%r14 -+ shrq $40,%r12 -+ andq $0x3ffffff,%rbx -+ orq %r12,%r10 -+ -+ subq $16,%r15 -+ jz .Lstore_base2_26_avx -+ -+ vmovd %eax,%xmm0 -+ vmovd %edx,%xmm1 -+ vmovd %r14d,%xmm2 -+ vmovd %ebx,%xmm3 -+ vmovd %r10d,%xmm4 -+ jmp .Lproceed_avx -+ -+.align 32 -+.Lstore_base2_64_avx: -+ movq %r14,0(%rdi) -+ movq %rbx,8(%rdi) -+ movq %r10,16(%rdi) -+ jmp .Ldone_avx -+ -+.align 16 -+.Lstore_base2_26_avx: -+ movl %eax,0(%rdi) -+ movl %edx,4(%rdi) -+ movl %r14d,8(%rdi) -+ movl %ebx,12(%rdi) -+ movl %r10d,16(%rdi) -+.align 16 -+.Ldone_avx: -+ movq 8(%rsp),%r15 -+ movq 16(%rsp),%r14 -+ movq 24(%rsp),%r13 -+ movq 32(%rsp),%r12 -+ movq 40(%rsp),%rbx -+ leaq 48(%rsp),%rsp -+ -+.Lno_data_avx: -+.Lblocks_avx_epilogue: -+ ret -+ -+.align 32 -+.Lbase2_64_avx: -+ -+ pushq %rbx -+ pushq %r12 -+ pushq %r13 -+ pushq %r14 -+ pushq %r15 -+ pushq %rdi -+ -+.Lbase2_64_avx_body: -+ -+ movq %rdx,%r15 -+ -+ movq 24(%rdi),%r11 -+ movq 32(%rdi),%r13 -+ -+ movq 0(%rdi),%r14 -+ movq 8(%rdi),%rbx -+ movl 16(%rdi),%r10d -+ -+ movq %r13,%r12 -+ movq %r13,%rax -+ shrq $2,%r13 -+ addq %r12,%r13 -+ -+ testq $31,%rdx -+ jz .Linit_avx -+ -+ addq 0(%rsi),%r14 -+ adcq 8(%rsi),%rbx -+ leaq 16(%rsi),%rsi -+ adcq %rcx,%r10 -+ subq $16,%r15 -+ -+ movq %rdi,0(%rsp) -+ __poly1305_block -+ movq 0(%rsp),%rdi -+ -+.Linit_avx: -+ -+ movq %r14,%rax -+ movq %r14,%rdx -+ shrq $52,%r14 -+ movq %rbx,%r8 -+ movq %rbx,%r9 -+ shrq $26,%rdx -+ andq $0x3ffffff,%rax -+ shlq $12,%r8 -+ andq $0x3ffffff,%rdx -+ shrq $14,%rbx -+ orq %r8,%r14 -+ shlq $24,%r10 -+ andq $0x3ffffff,%r14 -+ shrq $40,%r9 -+ andq $0x3ffffff,%rbx -+ orq %r9,%r10 -+ -+ vmovd %eax,%xmm0 -+ vmovd %edx,%xmm1 -+ vmovd %r14d,%xmm2 -+ vmovd %ebx,%xmm3 -+ vmovd %r10d,%xmm4 -+ movl $1,20(%rdi) -+ -+ __poly1305_init_avx -+ -+.Lproceed_avx: -+ movq %r15,%rdx -+ -+ movq 8(%rsp),%r15 -+ movq 16(%rsp),%r14 -+ movq 24(%rsp),%r13 -+ movq 32(%rsp),%r12 -+ movq 40(%rsp),%rbx -+ leaq 48(%rsp),%rax -+ leaq 48(%rsp),%rsp -+ -+.Lbase2_64_avx_epilogue: -+ jmp .Ldo_avx -+ -+ -+.align 32 -+.Leven_avx: -+ vmovd 0(%rdi),%xmm0 -+ vmovd 4(%rdi),%xmm1 -+ vmovd 8(%rdi),%xmm2 -+ vmovd 12(%rdi),%xmm3 -+ vmovd 16(%rdi),%xmm4 -+ -+.Ldo_avx: -+ leaq 8(%rsp),%r10 -+ andq $-32,%rsp -+ subq $8,%rsp -+ leaq -88(%rsp),%r11 -+ subq $0x178,%rsp -+ subq $64,%rdx -+ leaq -32(%rsi),%rax -+ cmovcq %rax,%rsi -+ -+ vmovdqu 48(%rdi),%xmm14 -+ leaq 112(%rdi),%rdi -+ leaq .Lconst(%rip),%rcx -+ -+ vmovdqu 32(%rsi),%xmm5 -+ vmovdqu 48(%rsi),%xmm6 -+ vmovdqa 64(%rcx),%xmm15 -+ -+ vpsrldq $6,%xmm5,%xmm7 -+ vpsrldq $6,%xmm6,%xmm8 -+ vpunpckhqdq %xmm6,%xmm5,%xmm9 -+ vpunpcklqdq %xmm6,%xmm5,%xmm5 -+ vpunpcklqdq %xmm8,%xmm7,%xmm8 -+ -+ vpsrlq $40,%xmm9,%xmm9 -+ vpsrlq $26,%xmm5,%xmm6 -+ vpand %xmm15,%xmm5,%xmm5 -+ vpsrlq $4,%xmm8,%xmm7 -+ vpand %xmm15,%xmm6,%xmm6 -+ vpsrlq $30,%xmm8,%xmm8 -+ vpand %xmm15,%xmm7,%xmm7 -+ vpand %xmm15,%xmm8,%xmm8 -+ vpor 32(%rcx),%xmm9,%xmm9 -+ -+ jbe .Lskip_loop_avx -+ -+ -+ vmovdqu -48(%rdi),%xmm11 -+ vmovdqu -32(%rdi),%xmm12 -+ vpshufd $0xEE,%xmm14,%xmm13 -+ vpshufd $0x44,%xmm14,%xmm10 -+ vmovdqa %xmm13,-144(%r11) -+ vmovdqa %xmm10,0(%rsp) -+ vpshufd $0xEE,%xmm11,%xmm14 -+ vmovdqu -16(%rdi),%xmm10 -+ vpshufd $0x44,%xmm11,%xmm11 -+ vmovdqa %xmm14,-128(%r11) -+ vmovdqa %xmm11,16(%rsp) -+ vpshufd $0xEE,%xmm12,%xmm13 -+ vmovdqu 0(%rdi),%xmm11 -+ vpshufd $0x44,%xmm12,%xmm12 -+ vmovdqa %xmm13,-112(%r11) -+ vmovdqa %xmm12,32(%rsp) -+ vpshufd $0xEE,%xmm10,%xmm14 -+ vmovdqu 16(%rdi),%xmm12 -+ vpshufd $0x44,%xmm10,%xmm10 -+ vmovdqa %xmm14,-96(%r11) -+ vmovdqa %xmm10,48(%rsp) -+ vpshufd $0xEE,%xmm11,%xmm13 -+ vmovdqu 32(%rdi),%xmm10 -+ vpshufd $0x44,%xmm11,%xmm11 -+ vmovdqa %xmm13,-80(%r11) -+ vmovdqa %xmm11,64(%rsp) -+ vpshufd $0xEE,%xmm12,%xmm14 -+ vmovdqu 48(%rdi),%xmm11 -+ vpshufd $0x44,%xmm12,%xmm12 -+ vmovdqa %xmm14,-64(%r11) -+ vmovdqa %xmm12,80(%rsp) -+ vpshufd $0xEE,%xmm10,%xmm13 -+ vmovdqu 64(%rdi),%xmm12 -+ vpshufd $0x44,%xmm10,%xmm10 -+ vmovdqa %xmm13,-48(%r11) -+ vmovdqa %xmm10,96(%rsp) -+ vpshufd $0xEE,%xmm11,%xmm14 -+ vpshufd $0x44,%xmm11,%xmm11 -+ vmovdqa %xmm14,-32(%r11) -+ vmovdqa %xmm11,112(%rsp) -+ vpshufd $0xEE,%xmm12,%xmm13 -+ vmovdqa 0(%rsp),%xmm14 -+ vpshufd $0x44,%xmm12,%xmm12 -+ vmovdqa %xmm13,-16(%r11) -+ vmovdqa %xmm12,128(%rsp) -+ -+ jmp .Loop_avx -+ -+.align 32 -+.Loop_avx: -+ -+ vpmuludq %xmm5,%xmm14,%xmm10 -+ vpmuludq %xmm6,%xmm14,%xmm11 -+ vmovdqa %xmm2,32(%r11) -+ vpmuludq %xmm7,%xmm14,%xmm12 -+ vmovdqa 16(%rsp),%xmm2 -+ vpmuludq %xmm8,%xmm14,%xmm13 -+ vpmuludq %xmm9,%xmm14,%xmm14 -+ -+ vmovdqa %xmm0,0(%r11) -+ vpmuludq 32(%rsp),%xmm9,%xmm0 -+ vmovdqa %xmm1,16(%r11) -+ vpmuludq %xmm8,%xmm2,%xmm1 -+ vpaddq %xmm0,%xmm10,%xmm10 -+ vpaddq %xmm1,%xmm14,%xmm14 -+ vmovdqa %xmm3,48(%r11) -+ vpmuludq %xmm7,%xmm2,%xmm0 -+ vpmuludq %xmm6,%xmm2,%xmm1 -+ vpaddq %xmm0,%xmm13,%xmm13 -+ vmovdqa 48(%rsp),%xmm3 -+ vpaddq %xmm1,%xmm12,%xmm12 -+ vmovdqa %xmm4,64(%r11) -+ vpmuludq %xmm5,%xmm2,%xmm2 -+ vpmuludq %xmm7,%xmm3,%xmm0 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ -+ vmovdqa 64(%rsp),%xmm4 -+ vpaddq %xmm0,%xmm14,%xmm14 -+ vpmuludq %xmm6,%xmm3,%xmm1 -+ vpmuludq %xmm5,%xmm3,%xmm3 -+ vpaddq %xmm1,%xmm13,%xmm13 -+ vmovdqa 80(%rsp),%xmm2 -+ vpaddq %xmm3,%xmm12,%xmm12 -+ vpmuludq %xmm9,%xmm4,%xmm0 -+ vpmuludq %xmm8,%xmm4,%xmm4 -+ vpaddq %xmm0,%xmm11,%xmm11 -+ vmovdqa 96(%rsp),%xmm3 -+ vpaddq %xmm4,%xmm10,%xmm10 -+ -+ vmovdqa 128(%rsp),%xmm4 -+ vpmuludq %xmm6,%xmm2,%xmm1 -+ vpmuludq %xmm5,%xmm2,%xmm2 -+ vpaddq %xmm1,%xmm14,%xmm14 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ vpmuludq %xmm9,%xmm3,%xmm0 -+ vpmuludq %xmm8,%xmm3,%xmm1 -+ vpaddq %xmm0,%xmm12,%xmm12 -+ vmovdqu 0(%rsi),%xmm0 -+ vpaddq %xmm1,%xmm11,%xmm11 -+ vpmuludq %xmm7,%xmm3,%xmm3 -+ vpmuludq %xmm7,%xmm4,%xmm7 -+ vpaddq %xmm3,%xmm10,%xmm10 -+ -+ vmovdqu 16(%rsi),%xmm1 -+ vpaddq %xmm7,%xmm11,%xmm11 -+ vpmuludq %xmm8,%xmm4,%xmm8 -+ vpmuludq %xmm9,%xmm4,%xmm9 -+ vpsrldq $6,%xmm0,%xmm2 -+ vpaddq %xmm8,%xmm12,%xmm12 -+ vpaddq %xmm9,%xmm13,%xmm13 -+ vpsrldq $6,%xmm1,%xmm3 -+ vpmuludq 112(%rsp),%xmm5,%xmm9 -+ vpmuludq %xmm6,%xmm4,%xmm5 -+ vpunpckhqdq %xmm1,%xmm0,%xmm4 -+ vpaddq %xmm9,%xmm14,%xmm14 -+ vmovdqa -144(%r11),%xmm9 -+ vpaddq %xmm5,%xmm10,%xmm10 -+ -+ vpunpcklqdq %xmm1,%xmm0,%xmm0 -+ vpunpcklqdq %xmm3,%xmm2,%xmm3 -+ -+ -+ vpsrldq $5,%xmm4,%xmm4 -+ vpsrlq $26,%xmm0,%xmm1 -+ vpand %xmm15,%xmm0,%xmm0 -+ vpsrlq $4,%xmm3,%xmm2 -+ vpand %xmm15,%xmm1,%xmm1 -+ vpand 0(%rcx),%xmm4,%xmm4 -+ vpsrlq $30,%xmm3,%xmm3 -+ vpand %xmm15,%xmm2,%xmm2 -+ vpand %xmm15,%xmm3,%xmm3 -+ vpor 32(%rcx),%xmm4,%xmm4 -+ -+ vpaddq 0(%r11),%xmm0,%xmm0 -+ vpaddq 16(%r11),%xmm1,%xmm1 -+ vpaddq 32(%r11),%xmm2,%xmm2 -+ vpaddq 48(%r11),%xmm3,%xmm3 -+ vpaddq 64(%r11),%xmm4,%xmm4 -+ -+ leaq 32(%rsi),%rax -+ leaq 64(%rsi),%rsi -+ subq $64,%rdx -+ cmovcq %rax,%rsi -+ -+ vpmuludq %xmm0,%xmm9,%xmm5 -+ vpmuludq %xmm1,%xmm9,%xmm6 -+ vpaddq %xmm5,%xmm10,%xmm10 -+ vpaddq %xmm6,%xmm11,%xmm11 -+ vmovdqa -128(%r11),%xmm7 -+ vpmuludq %xmm2,%xmm9,%xmm5 -+ vpmuludq %xmm3,%xmm9,%xmm6 -+ vpaddq %xmm5,%xmm12,%xmm12 -+ vpaddq %xmm6,%xmm13,%xmm13 -+ vpmuludq %xmm4,%xmm9,%xmm9 -+ vpmuludq -112(%r11),%xmm4,%xmm5 -+ vpaddq %xmm9,%xmm14,%xmm14 -+ -+ vpaddq %xmm5,%xmm10,%xmm10 -+ vpmuludq %xmm2,%xmm7,%xmm6 -+ vpmuludq %xmm3,%xmm7,%xmm5 -+ vpaddq %xmm6,%xmm13,%xmm13 -+ vmovdqa -96(%r11),%xmm8 -+ vpaddq %xmm5,%xmm14,%xmm14 -+ vpmuludq %xmm1,%xmm7,%xmm6 -+ vpmuludq %xmm0,%xmm7,%xmm7 -+ vpaddq %xmm6,%xmm12,%xmm12 -+ vpaddq %xmm7,%xmm11,%xmm11 -+ -+ vmovdqa -80(%r11),%xmm9 -+ vpmuludq %xmm2,%xmm8,%xmm5 -+ vpmuludq %xmm1,%xmm8,%xmm6 -+ vpaddq %xmm5,%xmm14,%xmm14 -+ vpaddq %xmm6,%xmm13,%xmm13 -+ vmovdqa -64(%r11),%xmm7 -+ vpmuludq %xmm0,%xmm8,%xmm8 -+ vpmuludq %xmm4,%xmm9,%xmm5 -+ vpaddq %xmm8,%xmm12,%xmm12 -+ vpaddq %xmm5,%xmm11,%xmm11 -+ vmovdqa -48(%r11),%xmm8 -+ vpmuludq %xmm3,%xmm9,%xmm9 -+ vpmuludq %xmm1,%xmm7,%xmm6 -+ vpaddq %xmm9,%xmm10,%xmm10 -+ -+ vmovdqa -16(%r11),%xmm9 -+ vpaddq %xmm6,%xmm14,%xmm14 -+ vpmuludq %xmm0,%xmm7,%xmm7 -+ vpmuludq %xmm4,%xmm8,%xmm5 -+ vpaddq %xmm7,%xmm13,%xmm13 -+ vpaddq %xmm5,%xmm12,%xmm12 -+ vmovdqu 32(%rsi),%xmm5 -+ vpmuludq %xmm3,%xmm8,%xmm7 -+ vpmuludq %xmm2,%xmm8,%xmm8 -+ vpaddq %xmm7,%xmm11,%xmm11 -+ vmovdqu 48(%rsi),%xmm6 -+ vpaddq %xmm8,%xmm10,%xmm10 -+ -+ vpmuludq %xmm2,%xmm9,%xmm2 -+ vpmuludq %xmm3,%xmm9,%xmm3 -+ vpsrldq $6,%xmm5,%xmm7 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpmuludq %xmm4,%xmm9,%xmm4 -+ vpsrldq $6,%xmm6,%xmm8 -+ vpaddq %xmm3,%xmm12,%xmm2 -+ vpaddq %xmm4,%xmm13,%xmm3 -+ vpmuludq -32(%r11),%xmm0,%xmm4 -+ vpmuludq %xmm1,%xmm9,%xmm0 -+ vpunpckhqdq %xmm6,%xmm5,%xmm9 -+ vpaddq %xmm4,%xmm14,%xmm4 -+ vpaddq %xmm0,%xmm10,%xmm0 -+ -+ vpunpcklqdq %xmm6,%xmm5,%xmm5 -+ vpunpcklqdq %xmm8,%xmm7,%xmm8 -+ -+ -+ vpsrldq $5,%xmm9,%xmm9 -+ vpsrlq $26,%xmm5,%xmm6 -+ vmovdqa 0(%rsp),%xmm14 -+ vpand %xmm15,%xmm5,%xmm5 -+ vpsrlq $4,%xmm8,%xmm7 -+ vpand %xmm15,%xmm6,%xmm6 -+ vpand 0(%rcx),%xmm9,%xmm9 -+ vpsrlq $30,%xmm8,%xmm8 -+ vpand %xmm15,%xmm7,%xmm7 -+ vpand %xmm15,%xmm8,%xmm8 -+ vpor 32(%rcx),%xmm9,%xmm9 -+ -+ vpsrlq $26,%xmm3,%xmm13 -+ vpand %xmm15,%xmm3,%xmm3 -+ vpaddq %xmm13,%xmm4,%xmm4 -+ -+ vpsrlq $26,%xmm0,%xmm10 -+ vpand %xmm15,%xmm0,%xmm0 -+ vpaddq %xmm10,%xmm11,%xmm1 -+ -+ vpsrlq $26,%xmm4,%xmm10 -+ vpand %xmm15,%xmm4,%xmm4 -+ -+ vpsrlq $26,%xmm1,%xmm11 -+ vpand %xmm15,%xmm1,%xmm1 -+ vpaddq %xmm11,%xmm2,%xmm2 -+ -+ vpaddq %xmm10,%xmm0,%xmm0 -+ vpsllq $2,%xmm10,%xmm10 -+ vpaddq %xmm10,%xmm0,%xmm0 -+ -+ vpsrlq $26,%xmm2,%xmm12 -+ vpand %xmm15,%xmm2,%xmm2 -+ vpaddq %xmm12,%xmm3,%xmm3 -+ -+ vpsrlq $26,%xmm0,%xmm10 -+ vpand %xmm15,%xmm0,%xmm0 -+ vpaddq %xmm10,%xmm1,%xmm1 -+ -+ vpsrlq $26,%xmm3,%xmm13 -+ vpand %xmm15,%xmm3,%xmm3 -+ vpaddq %xmm13,%xmm4,%xmm4 -+ -+ ja .Loop_avx -+ -+.Lskip_loop_avx: -+ vpshufd $0x10,%xmm14,%xmm14 -+ addq $32,%rdx -+ jnz .Long_tail_avx -+ -+ vpaddq %xmm2,%xmm7,%xmm7 -+ vpaddq %xmm0,%xmm5,%xmm5 -+ vpaddq %xmm1,%xmm6,%xmm6 -+ vpaddq %xmm3,%xmm8,%xmm8 -+ vpaddq %xmm4,%xmm9,%xmm9 -+ -+.Long_tail_avx: -+ vmovdqa %xmm2,32(%r11) -+ vmovdqa %xmm0,0(%r11) -+ vmovdqa %xmm1,16(%r11) -+ vmovdqa %xmm3,48(%r11) -+ vmovdqa %xmm4,64(%r11) -+ -+ vpmuludq %xmm7,%xmm14,%xmm12 -+ vpmuludq %xmm5,%xmm14,%xmm10 -+ vpshufd $0x10,-48(%rdi),%xmm2 -+ vpmuludq %xmm6,%xmm14,%xmm11 -+ vpmuludq %xmm8,%xmm14,%xmm13 -+ vpmuludq %xmm9,%xmm14,%xmm14 -+ -+ vpmuludq %xmm8,%xmm2,%xmm0 -+ vpaddq %xmm0,%xmm14,%xmm14 -+ vpshufd $0x10,-32(%rdi),%xmm3 -+ vpmuludq %xmm7,%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm13,%xmm13 -+ vpshufd $0x10,-16(%rdi),%xmm4 -+ vpmuludq %xmm6,%xmm2,%xmm0 -+ vpaddq %xmm0,%xmm12,%xmm12 -+ vpmuludq %xmm5,%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm11,%xmm11 -+ vpmuludq %xmm9,%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm10,%xmm10 -+ -+ vpshufd $0x10,0(%rdi),%xmm2 -+ vpmuludq %xmm7,%xmm4,%xmm1 -+ vpaddq %xmm1,%xmm14,%xmm14 -+ vpmuludq %xmm6,%xmm4,%xmm0 -+ vpaddq %xmm0,%xmm13,%xmm13 -+ vpshufd $0x10,16(%rdi),%xmm3 -+ vpmuludq %xmm5,%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm12,%xmm12 -+ vpmuludq %xmm9,%xmm2,%xmm1 -+ vpaddq %xmm1,%xmm11,%xmm11 -+ vpshufd $0x10,32(%rdi),%xmm4 -+ vpmuludq %xmm8,%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm10,%xmm10 -+ -+ vpmuludq %xmm6,%xmm3,%xmm0 -+ vpaddq %xmm0,%xmm14,%xmm14 -+ vpmuludq %xmm5,%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm13,%xmm13 -+ vpshufd $0x10,48(%rdi),%xmm2 -+ vpmuludq %xmm9,%xmm4,%xmm1 -+ vpaddq %xmm1,%xmm12,%xmm12 -+ vpshufd $0x10,64(%rdi),%xmm3 -+ vpmuludq %xmm8,%xmm4,%xmm0 -+ vpaddq %xmm0,%xmm11,%xmm11 -+ vpmuludq %xmm7,%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm10,%xmm10 -+ -+ vpmuludq %xmm5,%xmm2,%xmm2 -+ vpaddq %xmm2,%xmm14,%xmm14 -+ vpmuludq %xmm9,%xmm3,%xmm1 -+ vpaddq %xmm1,%xmm13,%xmm13 -+ vpmuludq %xmm8,%xmm3,%xmm0 -+ vpaddq %xmm0,%xmm12,%xmm12 -+ vpmuludq %xmm7,%xmm3,%xmm1 -+ vpaddq %xmm1,%xmm11,%xmm11 -+ vpmuludq %xmm6,%xmm3,%xmm3 -+ vpaddq %xmm3,%xmm10,%xmm10 -+ -+ jz .Lshort_tail_avx -+ -+ vmovdqu 0(%rsi),%xmm0 -+ vmovdqu 16(%rsi),%xmm1 -+ -+ vpsrldq $6,%xmm0,%xmm2 -+ vpsrldq $6,%xmm1,%xmm3 -+ vpunpckhqdq %xmm1,%xmm0,%xmm4 -+ vpunpcklqdq %xmm1,%xmm0,%xmm0 -+ vpunpcklqdq %xmm3,%xmm2,%xmm3 -+ -+ vpsrlq $40,%xmm4,%xmm4 -+ vpsrlq $26,%xmm0,%xmm1 -+ vpand %xmm15,%xmm0,%xmm0 -+ vpsrlq $4,%xmm3,%xmm2 -+ vpand %xmm15,%xmm1,%xmm1 -+ vpsrlq $30,%xmm3,%xmm3 -+ vpand %xmm15,%xmm2,%xmm2 -+ vpand %xmm15,%xmm3,%xmm3 -+ vpor 32(%rcx),%xmm4,%xmm4 -+ -+ vpshufd $0x32,-64(%rdi),%xmm9 -+ vpaddq 0(%r11),%xmm0,%xmm0 -+ vpaddq 16(%r11),%xmm1,%xmm1 -+ vpaddq 32(%r11),%xmm2,%xmm2 -+ vpaddq 48(%r11),%xmm3,%xmm3 -+ vpaddq 64(%r11),%xmm4,%xmm4 -+ -+ vpmuludq %xmm0,%xmm9,%xmm5 -+ vpaddq %xmm5,%xmm10,%xmm10 -+ vpmuludq %xmm1,%xmm9,%xmm6 -+ vpaddq %xmm6,%xmm11,%xmm11 -+ vpmuludq %xmm2,%xmm9,%xmm5 -+ vpaddq %xmm5,%xmm12,%xmm12 -+ vpshufd $0x32,-48(%rdi),%xmm7 -+ vpmuludq %xmm3,%xmm9,%xmm6 -+ vpaddq %xmm6,%xmm13,%xmm13 -+ vpmuludq %xmm4,%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm14,%xmm14 -+ -+ vpmuludq %xmm3,%xmm7,%xmm5 -+ vpaddq %xmm5,%xmm14,%xmm14 -+ vpshufd $0x32,-32(%rdi),%xmm8 -+ vpmuludq %xmm2,%xmm7,%xmm6 -+ vpaddq %xmm6,%xmm13,%xmm13 -+ vpshufd $0x32,-16(%rdi),%xmm9 -+ vpmuludq %xmm1,%xmm7,%xmm5 -+ vpaddq %xmm5,%xmm12,%xmm12 -+ vpmuludq %xmm0,%xmm7,%xmm7 -+ vpaddq %xmm7,%xmm11,%xmm11 -+ vpmuludq %xmm4,%xmm8,%xmm8 -+ vpaddq %xmm8,%xmm10,%xmm10 -+ -+ vpshufd $0x32,0(%rdi),%xmm7 -+ vpmuludq %xmm2,%xmm9,%xmm6 -+ vpaddq %xmm6,%xmm14,%xmm14 -+ vpmuludq %xmm1,%xmm9,%xmm5 -+ vpaddq %xmm5,%xmm13,%xmm13 -+ vpshufd $0x32,16(%rdi),%xmm8 -+ vpmuludq %xmm0,%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm12,%xmm12 -+ vpmuludq %xmm4,%xmm7,%xmm6 -+ vpaddq %xmm6,%xmm11,%xmm11 -+ vpshufd $0x32,32(%rdi),%xmm9 -+ vpmuludq %xmm3,%xmm7,%xmm7 -+ vpaddq %xmm7,%xmm10,%xmm10 -+ -+ vpmuludq %xmm1,%xmm8,%xmm5 -+ vpaddq %xmm5,%xmm14,%xmm14 -+ vpmuludq %xmm0,%xmm8,%xmm8 -+ vpaddq %xmm8,%xmm13,%xmm13 -+ vpshufd $0x32,48(%rdi),%xmm7 -+ vpmuludq %xmm4,%xmm9,%xmm6 -+ vpaddq %xmm6,%xmm12,%xmm12 -+ vpshufd $0x32,64(%rdi),%xmm8 -+ vpmuludq %xmm3,%xmm9,%xmm5 -+ vpaddq %xmm5,%xmm11,%xmm11 -+ vpmuludq %xmm2,%xmm9,%xmm9 -+ vpaddq %xmm9,%xmm10,%xmm10 -+ -+ vpmuludq %xmm0,%xmm7,%xmm7 -+ vpaddq %xmm7,%xmm14,%xmm14 -+ vpmuludq %xmm4,%xmm8,%xmm6 -+ vpaddq %xmm6,%xmm13,%xmm13 -+ vpmuludq %xmm3,%xmm8,%xmm5 -+ vpaddq %xmm5,%xmm12,%xmm12 -+ vpmuludq %xmm2,%xmm8,%xmm6 -+ vpaddq %xmm6,%xmm11,%xmm11 -+ vpmuludq %xmm1,%xmm8,%xmm8 -+ vpaddq %xmm8,%xmm10,%xmm10 -+ -+.Lshort_tail_avx: -+ -+ vpsrldq $8,%xmm14,%xmm9 -+ vpsrldq $8,%xmm13,%xmm8 -+ vpsrldq $8,%xmm11,%xmm6 -+ vpsrldq $8,%xmm10,%xmm5 -+ vpsrldq $8,%xmm12,%xmm7 -+ vpaddq %xmm8,%xmm13,%xmm13 -+ vpaddq %xmm9,%xmm14,%xmm14 -+ vpaddq %xmm5,%xmm10,%xmm10 -+ vpaddq %xmm6,%xmm11,%xmm11 -+ vpaddq %xmm7,%xmm12,%xmm12 -+ -+ vpsrlq $26,%xmm13,%xmm3 -+ vpand %xmm15,%xmm13,%xmm13 -+ vpaddq %xmm3,%xmm14,%xmm14 -+ -+ vpsrlq $26,%xmm10,%xmm0 -+ vpand %xmm15,%xmm10,%xmm10 -+ vpaddq %xmm0,%xmm11,%xmm11 -+ -+ vpsrlq $26,%xmm14,%xmm4 -+ vpand %xmm15,%xmm14,%xmm14 -+ -+ vpsrlq $26,%xmm11,%xmm1 -+ vpand %xmm15,%xmm11,%xmm11 -+ vpaddq %xmm1,%xmm12,%xmm12 -+ -+ vpaddq %xmm4,%xmm10,%xmm10 -+ vpsllq $2,%xmm4,%xmm4 -+ vpaddq %xmm4,%xmm10,%xmm10 -+ -+ vpsrlq $26,%xmm12,%xmm2 -+ vpand %xmm15,%xmm12,%xmm12 -+ vpaddq %xmm2,%xmm13,%xmm13 -+ -+ vpsrlq $26,%xmm10,%xmm0 -+ vpand %xmm15,%xmm10,%xmm10 -+ vpaddq %xmm0,%xmm11,%xmm11 -+ -+ vpsrlq $26,%xmm13,%xmm3 -+ vpand %xmm15,%xmm13,%xmm13 -+ vpaddq %xmm3,%xmm14,%xmm14 -+ -+ vmovd %xmm10,-112(%rdi) -+ vmovd %xmm11,-108(%rdi) -+ vmovd %xmm12,-104(%rdi) -+ vmovd %xmm13,-100(%rdi) -+ vmovd %xmm14,-96(%rdi) -+ leaq -8(%r10),%rsp -+ -+ vzeroupper -+ ret -+ENDPROC(poly1305_blocks_avx) -+ -+.align 32 -+ENTRY(poly1305_emit_avx) -+ cmpl $0,20(%rdi) -+ je .Lemit -+ -+ movl 0(%rdi),%eax -+ movl 4(%rdi),%ecx -+ movl 8(%rdi),%r8d -+ movl 12(%rdi),%r11d -+ movl 16(%rdi),%r10d -+ -+ shlq $26,%rcx -+ movq %r8,%r9 -+ shlq $52,%r8 -+ addq %rcx,%rax -+ shrq $12,%r9 -+ addq %rax,%r8 -+ adcq $0,%r9 -+ -+ shlq $14,%r11 -+ movq %r10,%rax -+ shrq $24,%r10 -+ addq %r11,%r9 -+ shlq $40,%rax -+ addq %rax,%r9 -+ adcq $0,%r10 -+ -+ movq %r10,%rax -+ movq %r10,%rcx -+ andq $3,%r10 -+ shrq $2,%rax -+ andq $-4,%rcx -+ addq %rcx,%rax -+ addq %rax,%r8 -+ adcq $0,%r9 -+ adcq $0,%r10 -+ -+ movq %r8,%rax -+ addq $5,%r8 -+ movq %r9,%rcx -+ adcq $0,%r9 -+ adcq $0,%r10 -+ shrq $2,%r10 -+ cmovnzq %r8,%rax -+ cmovnzq %r9,%rcx -+ -+ addq 0(%rdx),%rax -+ adcq 8(%rdx),%rcx -+ movq %rax,0(%rsi) -+ movq %rcx,8(%rsi) -+ -+ ret -+ENDPROC(poly1305_emit_avx) -+#endif /* CONFIG_AS_AVX */ -+ -+#ifdef CONFIG_AS_AVX2 -+.align 32 -+ENTRY(poly1305_blocks_avx2) -+ -+ movl 20(%rdi),%r8d -+ cmpq $128,%rdx -+ jae .Lblocks_avx2 -+ testl %r8d,%r8d -+ jz .Lblocks -+ -+.Lblocks_avx2: -+ andq $-16,%rdx -+ jz .Lno_data_avx2 -+ -+ vzeroupper -+ -+ testl %r8d,%r8d -+ jz .Lbase2_64_avx2 -+ -+ testq $63,%rdx -+ jz .Leven_avx2 -+ -+ pushq %rbx -+ pushq %r12 -+ pushq %r13 -+ pushq %r14 -+ pushq %r15 -+ pushq %rdi -+ -+.Lblocks_avx2_body: -+ -+ movq %rdx,%r15 -+ -+ movq 0(%rdi),%r8 -+ movq 8(%rdi),%r9 -+ movl 16(%rdi),%r10d -+ -+ movq 24(%rdi),%r11 -+ movq 32(%rdi),%r13 -+ -+ -+ movl %r8d,%r14d -+ andq $-2147483648,%r8 -+ movq %r9,%r12 -+ movl %r9d,%ebx -+ andq $-2147483648,%r9 -+ -+ shrq $6,%r8 -+ shlq $52,%r12 -+ addq %r8,%r14 -+ shrq $12,%rbx -+ shrq $18,%r9 -+ addq %r12,%r14 -+ adcq %r9,%rbx -+ -+ movq %r10,%r8 -+ shlq $40,%r8 -+ shrq $24,%r10 -+ addq %r8,%rbx -+ adcq $0,%r10 -+ -+ movq $-4,%r9 -+ movq %r10,%r8 -+ andq %r10,%r9 -+ shrq $2,%r8 -+ andq $3,%r10 -+ addq %r9,%r8 -+ addq %r8,%r14 -+ adcq $0,%rbx -+ adcq $0,%r10 -+ -+ movq %r13,%r12 -+ movq %r13,%rax -+ shrq $2,%r13 -+ addq %r12,%r13 -+ -+.Lbase2_26_pre_avx2: -+ addq 0(%rsi),%r14 -+ adcq 8(%rsi),%rbx -+ leaq 16(%rsi),%rsi -+ adcq %rcx,%r10 -+ subq $16,%r15 -+ -+ movq %rdi,0(%rsp) -+ __poly1305_block -+ movq 0(%rsp),%rdi -+ movq %r12,%rax -+ -+ testq $63,%r15 -+ jnz .Lbase2_26_pre_avx2 -+ -+ testq %rcx,%rcx -+ jz .Lstore_base2_64_avx2 -+ -+ -+ movq %r14,%rax -+ movq %r14,%rdx -+ shrq $52,%r14 -+ movq %rbx,%r11 -+ movq %rbx,%r12 -+ shrq $26,%rdx -+ andq $0x3ffffff,%rax -+ shlq $12,%r11 -+ andq $0x3ffffff,%rdx -+ shrq $14,%rbx -+ orq %r11,%r14 -+ shlq $24,%r10 -+ andq $0x3ffffff,%r14 -+ shrq $40,%r12 -+ andq $0x3ffffff,%rbx -+ orq %r12,%r10 -+ -+ testq %r15,%r15 -+ jz .Lstore_base2_26_avx2 -+ -+ vmovd %eax,%xmm0 -+ vmovd %edx,%xmm1 -+ vmovd %r14d,%xmm2 -+ vmovd %ebx,%xmm3 -+ vmovd %r10d,%xmm4 -+ jmp .Lproceed_avx2 -+ -+.align 32 -+.Lstore_base2_64_avx2: -+ movq %r14,0(%rdi) -+ movq %rbx,8(%rdi) -+ movq %r10,16(%rdi) -+ jmp .Ldone_avx2 -+ -+.align 16 -+.Lstore_base2_26_avx2: -+ movl %eax,0(%rdi) -+ movl %edx,4(%rdi) -+ movl %r14d,8(%rdi) -+ movl %ebx,12(%rdi) -+ movl %r10d,16(%rdi) -+.align 16 -+.Ldone_avx2: -+ movq 8(%rsp),%r15 -+ movq 16(%rsp),%r14 -+ movq 24(%rsp),%r13 -+ movq 32(%rsp),%r12 -+ movq 40(%rsp),%rbx -+ leaq 48(%rsp),%rsp -+ -+.Lno_data_avx2: -+.Lblocks_avx2_epilogue: -+ ret -+ -+ -+.align 32 -+.Lbase2_64_avx2: -+ -+ -+ pushq %rbx -+ pushq %r12 -+ pushq %r13 -+ pushq %r14 -+ pushq %r15 -+ pushq %rdi -+ -+.Lbase2_64_avx2_body: -+ -+ movq %rdx,%r15 -+ -+ movq 24(%rdi),%r11 -+ movq 32(%rdi),%r13 -+ -+ movq 0(%rdi),%r14 -+ movq 8(%rdi),%rbx -+ movl 16(%rdi),%r10d -+ -+ movq %r13,%r12 -+ movq %r13,%rax -+ shrq $2,%r13 -+ addq %r12,%r13 -+ -+ testq $63,%rdx -+ jz .Linit_avx2 -+ -+.Lbase2_64_pre_avx2: -+ addq 0(%rsi),%r14 -+ adcq 8(%rsi),%rbx -+ leaq 16(%rsi),%rsi -+ adcq %rcx,%r10 -+ subq $16,%r15 -+ -+ movq %rdi,0(%rsp) -+ __poly1305_block -+ movq 0(%rsp),%rdi -+ movq %r12,%rax -+ -+ testq $63,%r15 -+ jnz .Lbase2_64_pre_avx2 -+ -+.Linit_avx2: -+ -+ movq %r14,%rax -+ movq %r14,%rdx -+ shrq $52,%r14 -+ movq %rbx,%r8 -+ movq %rbx,%r9 -+ shrq $26,%rdx -+ andq $0x3ffffff,%rax -+ shlq $12,%r8 -+ andq $0x3ffffff,%rdx -+ shrq $14,%rbx -+ orq %r8,%r14 -+ shlq $24,%r10 -+ andq $0x3ffffff,%r14 -+ shrq $40,%r9 -+ andq $0x3ffffff,%rbx -+ orq %r9,%r10 -+ -+ vmovd %eax,%xmm0 -+ vmovd %edx,%xmm1 -+ vmovd %r14d,%xmm2 -+ vmovd %ebx,%xmm3 -+ vmovd %r10d,%xmm4 -+ movl $1,20(%rdi) -+ -+ __poly1305_init_avx -+ -+.Lproceed_avx2: -+ movq %r15,%rdx -+ -+ movq 8(%rsp),%r15 -+ movq 16(%rsp),%r14 -+ movq 24(%rsp),%r13 -+ movq 32(%rsp),%r12 -+ movq 40(%rsp),%rbx -+ leaq 48(%rsp),%rax -+ leaq 48(%rsp),%rsp -+ -+.Lbase2_64_avx2_epilogue: -+ jmp .Ldo_avx2 -+ -+ -+.align 32 -+.Leven_avx2: -+ -+ vmovd 0(%rdi),%xmm0 -+ vmovd 4(%rdi),%xmm1 -+ vmovd 8(%rdi),%xmm2 -+ vmovd 12(%rdi),%xmm3 -+ vmovd 16(%rdi),%xmm4 -+ -+.Ldo_avx2: -+ leaq 8(%rsp),%r10 -+ subq $0x128,%rsp -+ leaq .Lconst(%rip),%rcx -+ leaq 48+64(%rdi),%rdi -+ vmovdqa 96(%rcx),%ymm7 -+ -+ -+ vmovdqu -64(%rdi),%xmm9 -+ andq $-512,%rsp -+ vmovdqu -48(%rdi),%xmm10 -+ vmovdqu -32(%rdi),%xmm6 -+ vmovdqu -16(%rdi),%xmm11 -+ vmovdqu 0(%rdi),%xmm12 -+ vmovdqu 16(%rdi),%xmm13 -+ leaq 144(%rsp),%rax -+ vmovdqu 32(%rdi),%xmm14 -+ vpermd %ymm9,%ymm7,%ymm9 -+ vmovdqu 48(%rdi),%xmm15 -+ vpermd %ymm10,%ymm7,%ymm10 -+ vmovdqu 64(%rdi),%xmm5 -+ vpermd %ymm6,%ymm7,%ymm6 -+ vmovdqa %ymm9,0(%rsp) -+ vpermd %ymm11,%ymm7,%ymm11 -+ vmovdqa %ymm10,32-144(%rax) -+ vpermd %ymm12,%ymm7,%ymm12 -+ vmovdqa %ymm6,64-144(%rax) -+ vpermd %ymm13,%ymm7,%ymm13 -+ vmovdqa %ymm11,96-144(%rax) -+ vpermd %ymm14,%ymm7,%ymm14 -+ vmovdqa %ymm12,128-144(%rax) -+ vpermd %ymm15,%ymm7,%ymm15 -+ vmovdqa %ymm13,160-144(%rax) -+ vpermd %ymm5,%ymm7,%ymm5 -+ vmovdqa %ymm14,192-144(%rax) -+ vmovdqa %ymm15,224-144(%rax) -+ vmovdqa %ymm5,256-144(%rax) -+ vmovdqa 64(%rcx),%ymm5 -+ -+ -+ -+ vmovdqu 0(%rsi),%xmm7 -+ vmovdqu 16(%rsi),%xmm8 -+ vinserti128 $1,32(%rsi),%ymm7,%ymm7 -+ vinserti128 $1,48(%rsi),%ymm8,%ymm8 -+ leaq 64(%rsi),%rsi -+ -+ vpsrldq $6,%ymm7,%ymm9 -+ vpsrldq $6,%ymm8,%ymm10 -+ vpunpckhqdq %ymm8,%ymm7,%ymm6 -+ vpunpcklqdq %ymm10,%ymm9,%ymm9 -+ vpunpcklqdq %ymm8,%ymm7,%ymm7 -+ -+ vpsrlq $30,%ymm9,%ymm10 -+ vpsrlq $4,%ymm9,%ymm9 -+ vpsrlq $26,%ymm7,%ymm8 -+ vpsrlq $40,%ymm6,%ymm6 -+ vpand %ymm5,%ymm9,%ymm9 -+ vpand %ymm5,%ymm7,%ymm7 -+ vpand %ymm5,%ymm8,%ymm8 -+ vpand %ymm5,%ymm10,%ymm10 -+ vpor 32(%rcx),%ymm6,%ymm6 -+ -+ vpaddq %ymm2,%ymm9,%ymm2 -+ subq $64,%rdx -+ jz .Ltail_avx2 -+ jmp .Loop_avx2 -+ -+.align 32 -+.Loop_avx2: -+ -+ vpaddq %ymm0,%ymm7,%ymm0 -+ vmovdqa 0(%rsp),%ymm7 -+ vpaddq %ymm1,%ymm8,%ymm1 -+ vmovdqa 32(%rsp),%ymm8 -+ vpaddq %ymm3,%ymm10,%ymm3 -+ vmovdqa 96(%rsp),%ymm9 -+ vpaddq %ymm4,%ymm6,%ymm4 -+ vmovdqa 48(%rax),%ymm10 -+ vmovdqa 112(%rax),%ymm5 -+ -+ vpmuludq %ymm2,%ymm7,%ymm13 -+ vpmuludq %ymm2,%ymm8,%ymm14 -+ vpmuludq %ymm2,%ymm9,%ymm15 -+ vpmuludq %ymm2,%ymm10,%ymm11 -+ vpmuludq %ymm2,%ymm5,%ymm12 -+ -+ vpmuludq %ymm0,%ymm8,%ymm6 -+ vpmuludq %ymm1,%ymm8,%ymm2 -+ vpaddq %ymm6,%ymm12,%ymm12 -+ vpaddq %ymm2,%ymm13,%ymm13 -+ vpmuludq %ymm3,%ymm8,%ymm6 -+ vpmuludq 64(%rsp),%ymm4,%ymm2 -+ vpaddq %ymm6,%ymm15,%ymm15 -+ vpaddq %ymm2,%ymm11,%ymm11 -+ vmovdqa -16(%rax),%ymm8 -+ -+ vpmuludq %ymm0,%ymm7,%ymm6 -+ vpmuludq %ymm1,%ymm7,%ymm2 -+ vpaddq %ymm6,%ymm11,%ymm11 -+ vpaddq %ymm2,%ymm12,%ymm12 -+ vpmuludq %ymm3,%ymm7,%ymm6 -+ vpmuludq %ymm4,%ymm7,%ymm2 -+ vmovdqu 0(%rsi),%xmm7 -+ vpaddq %ymm6,%ymm14,%ymm14 -+ vpaddq %ymm2,%ymm15,%ymm15 -+ vinserti128 $1,32(%rsi),%ymm7,%ymm7 -+ -+ vpmuludq %ymm3,%ymm8,%ymm6 -+ vpmuludq %ymm4,%ymm8,%ymm2 -+ vmovdqu 16(%rsi),%xmm8 -+ vpaddq %ymm6,%ymm11,%ymm11 -+ vpaddq %ymm2,%ymm12,%ymm12 -+ vmovdqa 16(%rax),%ymm2 -+ vpmuludq %ymm1,%ymm9,%ymm6 -+ vpmuludq %ymm0,%ymm9,%ymm9 -+ vpaddq %ymm6,%ymm14,%ymm14 -+ vpaddq %ymm9,%ymm13,%ymm13 -+ vinserti128 $1,48(%rsi),%ymm8,%ymm8 -+ leaq 64(%rsi),%rsi -+ -+ vpmuludq %ymm1,%ymm2,%ymm6 -+ vpmuludq %ymm0,%ymm2,%ymm2 -+ vpsrldq $6,%ymm7,%ymm9 -+ vpaddq %ymm6,%ymm15,%ymm15 -+ vpaddq %ymm2,%ymm14,%ymm14 -+ vpmuludq %ymm3,%ymm10,%ymm6 -+ vpmuludq %ymm4,%ymm10,%ymm2 -+ vpsrldq $6,%ymm8,%ymm10 -+ vpaddq %ymm6,%ymm12,%ymm12 -+ vpaddq %ymm2,%ymm13,%ymm13 -+ vpunpckhqdq %ymm8,%ymm7,%ymm6 -+ -+ vpmuludq %ymm3,%ymm5,%ymm3 -+ vpmuludq %ymm4,%ymm5,%ymm4 -+ vpunpcklqdq %ymm8,%ymm7,%ymm7 -+ vpaddq %ymm3,%ymm13,%ymm2 -+ vpaddq %ymm4,%ymm14,%ymm3 -+ vpunpcklqdq %ymm10,%ymm9,%ymm10 -+ vpmuludq 80(%rax),%ymm0,%ymm4 -+ vpmuludq %ymm1,%ymm5,%ymm0 -+ vmovdqa 64(%rcx),%ymm5 -+ vpaddq %ymm4,%ymm15,%ymm4 -+ vpaddq %ymm0,%ymm11,%ymm0 -+ -+ vpsrlq $26,%ymm3,%ymm14 -+ vpand %ymm5,%ymm3,%ymm3 -+ vpaddq %ymm14,%ymm4,%ymm4 -+ -+ vpsrlq $26,%ymm0,%ymm11 -+ vpand %ymm5,%ymm0,%ymm0 -+ vpaddq %ymm11,%ymm12,%ymm1 -+ -+ vpsrlq $26,%ymm4,%ymm15 -+ vpand %ymm5,%ymm4,%ymm4 -+ -+ vpsrlq $4,%ymm10,%ymm9 -+ -+ vpsrlq $26,%ymm1,%ymm12 -+ vpand %ymm5,%ymm1,%ymm1 -+ vpaddq %ymm12,%ymm2,%ymm2 -+ -+ vpaddq %ymm15,%ymm0,%ymm0 -+ vpsllq $2,%ymm15,%ymm15 -+ vpaddq %ymm15,%ymm0,%ymm0 -+ -+ vpand %ymm5,%ymm9,%ymm9 -+ vpsrlq $26,%ymm7,%ymm8 -+ -+ vpsrlq $26,%ymm2,%ymm13 -+ vpand %ymm5,%ymm2,%ymm2 -+ vpaddq %ymm13,%ymm3,%ymm3 -+ -+ vpaddq %ymm9,%ymm2,%ymm2 -+ vpsrlq $30,%ymm10,%ymm10 -+ -+ vpsrlq $26,%ymm0,%ymm11 -+ vpand %ymm5,%ymm0,%ymm0 -+ vpaddq %ymm11,%ymm1,%ymm1 -+ -+ vpsrlq $40,%ymm6,%ymm6 -+ -+ vpsrlq $26,%ymm3,%ymm14 -+ vpand %ymm5,%ymm3,%ymm3 -+ vpaddq %ymm14,%ymm4,%ymm4 -+ -+ vpand %ymm5,%ymm7,%ymm7 -+ vpand %ymm5,%ymm8,%ymm8 -+ vpand %ymm5,%ymm10,%ymm10 -+ vpor 32(%rcx),%ymm6,%ymm6 -+ -+ subq $64,%rdx -+ jnz .Loop_avx2 -+ -+.byte 0x66,0x90 -+.Ltail_avx2: -+ -+ vpaddq %ymm0,%ymm7,%ymm0 -+ vmovdqu 4(%rsp),%ymm7 -+ vpaddq %ymm1,%ymm8,%ymm1 -+ vmovdqu 36(%rsp),%ymm8 -+ vpaddq %ymm3,%ymm10,%ymm3 -+ vmovdqu 100(%rsp),%ymm9 -+ vpaddq %ymm4,%ymm6,%ymm4 -+ vmovdqu 52(%rax),%ymm10 -+ vmovdqu 116(%rax),%ymm5 -+ -+ vpmuludq %ymm2,%ymm7,%ymm13 -+ vpmuludq %ymm2,%ymm8,%ymm14 -+ vpmuludq %ymm2,%ymm9,%ymm15 -+ vpmuludq %ymm2,%ymm10,%ymm11 -+ vpmuludq %ymm2,%ymm5,%ymm12 -+ -+ vpmuludq %ymm0,%ymm8,%ymm6 -+ vpmuludq %ymm1,%ymm8,%ymm2 -+ vpaddq %ymm6,%ymm12,%ymm12 -+ vpaddq %ymm2,%ymm13,%ymm13 -+ vpmuludq %ymm3,%ymm8,%ymm6 -+ vpmuludq 68(%rsp),%ymm4,%ymm2 -+ vpaddq %ymm6,%ymm15,%ymm15 -+ vpaddq %ymm2,%ymm11,%ymm11 -+ -+ vpmuludq %ymm0,%ymm7,%ymm6 -+ vpmuludq %ymm1,%ymm7,%ymm2 -+ vpaddq %ymm6,%ymm11,%ymm11 -+ vmovdqu -12(%rax),%ymm8 -+ vpaddq %ymm2,%ymm12,%ymm12 -+ vpmuludq %ymm3,%ymm7,%ymm6 -+ vpmuludq %ymm4,%ymm7,%ymm2 -+ vpaddq %ymm6,%ymm14,%ymm14 -+ vpaddq %ymm2,%ymm15,%ymm15 -+ -+ vpmuludq %ymm3,%ymm8,%ymm6 -+ vpmuludq %ymm4,%ymm8,%ymm2 -+ vpaddq %ymm6,%ymm11,%ymm11 -+ vpaddq %ymm2,%ymm12,%ymm12 -+ vmovdqu 20(%rax),%ymm2 -+ vpmuludq %ymm1,%ymm9,%ymm6 -+ vpmuludq %ymm0,%ymm9,%ymm9 -+ vpaddq %ymm6,%ymm14,%ymm14 -+ vpaddq %ymm9,%ymm13,%ymm13 -+ -+ vpmuludq %ymm1,%ymm2,%ymm6 -+ vpmuludq %ymm0,%ymm2,%ymm2 -+ vpaddq %ymm6,%ymm15,%ymm15 -+ vpaddq %ymm2,%ymm14,%ymm14 -+ vpmuludq %ymm3,%ymm10,%ymm6 -+ vpmuludq %ymm4,%ymm10,%ymm2 -+ vpaddq %ymm6,%ymm12,%ymm12 -+ vpaddq %ymm2,%ymm13,%ymm13 -+ -+ vpmuludq %ymm3,%ymm5,%ymm3 -+ vpmuludq %ymm4,%ymm5,%ymm4 -+ vpaddq %ymm3,%ymm13,%ymm2 -+ vpaddq %ymm4,%ymm14,%ymm3 -+ vpmuludq 84(%rax),%ymm0,%ymm4 -+ vpmuludq %ymm1,%ymm5,%ymm0 -+ vmovdqa 64(%rcx),%ymm5 -+ vpaddq %ymm4,%ymm15,%ymm4 -+ vpaddq %ymm0,%ymm11,%ymm0 -+ -+ vpsrldq $8,%ymm12,%ymm8 -+ vpsrldq $8,%ymm2,%ymm9 -+ vpsrldq $8,%ymm3,%ymm10 -+ vpsrldq $8,%ymm4,%ymm6 -+ vpsrldq $8,%ymm0,%ymm7 -+ vpaddq %ymm8,%ymm12,%ymm12 -+ vpaddq %ymm9,%ymm2,%ymm2 -+ vpaddq %ymm10,%ymm3,%ymm3 -+ vpaddq %ymm6,%ymm4,%ymm4 -+ vpaddq %ymm7,%ymm0,%ymm0 -+ -+ vpermq $0x2,%ymm3,%ymm10 -+ vpermq $0x2,%ymm4,%ymm6 -+ vpermq $0x2,%ymm0,%ymm7 -+ vpermq $0x2,%ymm12,%ymm8 -+ vpermq $0x2,%ymm2,%ymm9 -+ vpaddq %ymm10,%ymm3,%ymm3 -+ vpaddq %ymm6,%ymm4,%ymm4 -+ vpaddq %ymm7,%ymm0,%ymm0 -+ vpaddq %ymm8,%ymm12,%ymm12 -+ vpaddq %ymm9,%ymm2,%ymm2 -+ -+ vpsrlq $26,%ymm3,%ymm14 -+ vpand %ymm5,%ymm3,%ymm3 -+ vpaddq %ymm14,%ymm4,%ymm4 -+ -+ vpsrlq $26,%ymm0,%ymm11 -+ vpand %ymm5,%ymm0,%ymm0 -+ vpaddq %ymm11,%ymm12,%ymm1 -+ -+ vpsrlq $26,%ymm4,%ymm15 -+ vpand %ymm5,%ymm4,%ymm4 -+ -+ vpsrlq $26,%ymm1,%ymm12 -+ vpand %ymm5,%ymm1,%ymm1 -+ vpaddq %ymm12,%ymm2,%ymm2 -+ -+ vpaddq %ymm15,%ymm0,%ymm0 -+ vpsllq $2,%ymm15,%ymm15 -+ vpaddq %ymm15,%ymm0,%ymm0 -+ -+ vpsrlq $26,%ymm2,%ymm13 -+ vpand %ymm5,%ymm2,%ymm2 -+ vpaddq %ymm13,%ymm3,%ymm3 -+ -+ vpsrlq $26,%ymm0,%ymm11 -+ vpand %ymm5,%ymm0,%ymm0 -+ vpaddq %ymm11,%ymm1,%ymm1 -+ -+ vpsrlq $26,%ymm3,%ymm14 -+ vpand %ymm5,%ymm3,%ymm3 -+ vpaddq %ymm14,%ymm4,%ymm4 -+ -+ vmovd %xmm0,-112(%rdi) -+ vmovd %xmm1,-108(%rdi) -+ vmovd %xmm2,-104(%rdi) -+ vmovd %xmm3,-100(%rdi) -+ vmovd %xmm4,-96(%rdi) -+ leaq -8(%r10),%rsp -+ -+ vzeroupper -+ ret -+ -+ENDPROC(poly1305_blocks_avx2) -+#endif /* CONFIG_AS_AVX2 */ -+ -+#ifdef CONFIG_AS_AVX512 -+.align 32 -+ENTRY(poly1305_blocks_avx512) -+ -+ movl 20(%rdi),%r8d -+ cmpq $128,%rdx -+ jae .Lblocks_avx2_512 -+ testl %r8d,%r8d -+ jz .Lblocks -+ -+.Lblocks_avx2_512: -+ andq $-16,%rdx -+ jz .Lno_data_avx2_512 -+ -+ vzeroupper -+ -+ testl %r8d,%r8d -+ jz .Lbase2_64_avx2_512 -+ -+ testq $63,%rdx -+ jz .Leven_avx2_512 -+ -+ pushq %rbx -+ pushq %r12 -+ pushq %r13 -+ pushq %r14 -+ pushq %r15 -+ pushq %rdi -+ -+.Lblocks_avx2_body_512: -+ -+ movq %rdx,%r15 -+ -+ movq 0(%rdi),%r8 -+ movq 8(%rdi),%r9 -+ movl 16(%rdi),%r10d -+ -+ movq 24(%rdi),%r11 -+ movq 32(%rdi),%r13 -+ -+ -+ movl %r8d,%r14d -+ andq $-2147483648,%r8 -+ movq %r9,%r12 -+ movl %r9d,%ebx -+ andq $-2147483648,%r9 -+ -+ shrq $6,%r8 -+ shlq $52,%r12 -+ addq %r8,%r14 -+ shrq $12,%rbx -+ shrq $18,%r9 -+ addq %r12,%r14 -+ adcq %r9,%rbx -+ -+ movq %r10,%r8 -+ shlq $40,%r8 -+ shrq $24,%r10 -+ addq %r8,%rbx -+ adcq $0,%r10 -+ -+ movq $-4,%r9 -+ movq %r10,%r8 -+ andq %r10,%r9 -+ shrq $2,%r8 -+ andq $3,%r10 -+ addq %r9,%r8 -+ addq %r8,%r14 -+ adcq $0,%rbx -+ adcq $0,%r10 -+ -+ movq %r13,%r12 -+ movq %r13,%rax -+ shrq $2,%r13 -+ addq %r12,%r13 -+ -+.Lbase2_26_pre_avx2_512: -+ addq 0(%rsi),%r14 -+ adcq 8(%rsi),%rbx -+ leaq 16(%rsi),%rsi -+ adcq %rcx,%r10 -+ subq $16,%r15 -+ -+ movq %rdi,0(%rsp) -+ __poly1305_block -+ movq 0(%rsp),%rdi -+ movq %r12,%rax -+ -+ testq $63,%r15 -+ jnz .Lbase2_26_pre_avx2_512 -+ -+ testq %rcx,%rcx -+ jz .Lstore_base2_64_avx2_512 -+ -+ -+ movq %r14,%rax -+ movq %r14,%rdx -+ shrq $52,%r14 -+ movq %rbx,%r11 -+ movq %rbx,%r12 -+ shrq $26,%rdx -+ andq $0x3ffffff,%rax -+ shlq $12,%r11 -+ andq $0x3ffffff,%rdx -+ shrq $14,%rbx -+ orq %r11,%r14 -+ shlq $24,%r10 -+ andq $0x3ffffff,%r14 -+ shrq $40,%r12 -+ andq $0x3ffffff,%rbx -+ orq %r12,%r10 -+ -+ testq %r15,%r15 -+ jz .Lstore_base2_26_avx2_512 -+ -+ vmovd %eax,%xmm0 -+ vmovd %edx,%xmm1 -+ vmovd %r14d,%xmm2 -+ vmovd %ebx,%xmm3 -+ vmovd %r10d,%xmm4 -+ jmp .Lproceed_avx2_512 -+ -+.align 32 -+.Lstore_base2_64_avx2_512: -+ movq %r14,0(%rdi) -+ movq %rbx,8(%rdi) -+ movq %r10,16(%rdi) -+ jmp .Ldone_avx2_512 -+ -+.align 16 -+.Lstore_base2_26_avx2_512: -+ movl %eax,0(%rdi) -+ movl %edx,4(%rdi) -+ movl %r14d,8(%rdi) -+ movl %ebx,12(%rdi) -+ movl %r10d,16(%rdi) -+.align 16 -+.Ldone_avx2_512: -+ movq 8(%rsp),%r15 -+ movq 16(%rsp),%r14 -+ movq 24(%rsp),%r13 -+ movq 32(%rsp),%r12 -+ movq 40(%rsp),%rbx -+ leaq 48(%rsp),%rsp -+ -+.Lno_data_avx2_512: -+.Lblocks_avx2_epilogue_512: -+ ret -+ -+ -+.align 32 -+.Lbase2_64_avx2_512: -+ -+ pushq %rbx -+ pushq %r12 -+ pushq %r13 -+ pushq %r14 -+ pushq %r15 -+ pushq %rdi -+ -+.Lbase2_64_avx2_body_512: -+ -+ movq %rdx,%r15 -+ -+ movq 24(%rdi),%r11 -+ movq 32(%rdi),%r13 -+ -+ movq 0(%rdi),%r14 -+ movq 8(%rdi),%rbx -+ movl 16(%rdi),%r10d -+ -+ movq %r13,%r12 -+ movq %r13,%rax -+ shrq $2,%r13 -+ addq %r12,%r13 -+ -+ testq $63,%rdx -+ jz .Linit_avx2_512 -+ -+.Lbase2_64_pre_avx2_512: -+ addq 0(%rsi),%r14 -+ adcq 8(%rsi),%rbx -+ leaq 16(%rsi),%rsi -+ adcq %rcx,%r10 -+ subq $16,%r15 -+ -+ movq %rdi,0(%rsp) -+ __poly1305_block -+ movq 0(%rsp),%rdi -+ movq %r12,%rax -+ -+ testq $63,%r15 -+ jnz .Lbase2_64_pre_avx2_512 -+ -+.Linit_avx2_512: -+ -+ movq %r14,%rax -+ movq %r14,%rdx -+ shrq $52,%r14 -+ movq %rbx,%r8 -+ movq %rbx,%r9 -+ shrq $26,%rdx -+ andq $0x3ffffff,%rax -+ shlq $12,%r8 -+ andq $0x3ffffff,%rdx -+ shrq $14,%rbx -+ orq %r8,%r14 -+ shlq $24,%r10 -+ andq $0x3ffffff,%r14 -+ shrq $40,%r9 -+ andq $0x3ffffff,%rbx -+ orq %r9,%r10 -+ -+ vmovd %eax,%xmm0 -+ vmovd %edx,%xmm1 -+ vmovd %r14d,%xmm2 -+ vmovd %ebx,%xmm3 -+ vmovd %r10d,%xmm4 -+ movl $1,20(%rdi) -+ -+ __poly1305_init_avx -+ -+.Lproceed_avx2_512: -+ movq %r15,%rdx -+ -+ movq 8(%rsp),%r15 -+ movq 16(%rsp),%r14 -+ movq 24(%rsp),%r13 -+ movq 32(%rsp),%r12 -+ movq 40(%rsp),%rbx -+ leaq 48(%rsp),%rax -+ leaq 48(%rsp),%rsp -+ -+.Lbase2_64_avx2_epilogue_512: -+ jmp .Ldo_avx2_512 -+ -+ -+.align 32 -+.Leven_avx2_512: -+ -+ vmovd 0(%rdi),%xmm0 -+ vmovd 4(%rdi),%xmm1 -+ vmovd 8(%rdi),%xmm2 -+ vmovd 12(%rdi),%xmm3 -+ vmovd 16(%rdi),%xmm4 -+ -+.Ldo_avx2_512: -+ cmpq $512,%rdx -+ jae .Lblocks_avx512 -+.Lskip_avx512: -+ leaq 8(%rsp),%r10 -+ -+ subq $0x128,%rsp -+ leaq .Lconst(%rip),%rcx -+ leaq 48+64(%rdi),%rdi -+ vmovdqa 96(%rcx),%ymm7 -+ -+ -+ vmovdqu -64(%rdi),%xmm9 -+ andq $-512,%rsp -+ vmovdqu -48(%rdi),%xmm10 -+ vmovdqu -32(%rdi),%xmm6 -+ vmovdqu -16(%rdi),%xmm11 -+ vmovdqu 0(%rdi),%xmm12 -+ vmovdqu 16(%rdi),%xmm13 -+ leaq 144(%rsp),%rax -+ vmovdqu 32(%rdi),%xmm14 -+ vpermd %ymm9,%ymm7,%ymm9 -+ vmovdqu 48(%rdi),%xmm15 -+ vpermd %ymm10,%ymm7,%ymm10 -+ vmovdqu 64(%rdi),%xmm5 -+ vpermd %ymm6,%ymm7,%ymm6 -+ vmovdqa %ymm9,0(%rsp) -+ vpermd %ymm11,%ymm7,%ymm11 -+ vmovdqa %ymm10,32-144(%rax) -+ vpermd %ymm12,%ymm7,%ymm12 -+ vmovdqa %ymm6,64-144(%rax) -+ vpermd %ymm13,%ymm7,%ymm13 -+ vmovdqa %ymm11,96-144(%rax) -+ vpermd %ymm14,%ymm7,%ymm14 -+ vmovdqa %ymm12,128-144(%rax) -+ vpermd %ymm15,%ymm7,%ymm15 -+ vmovdqa %ymm13,160-144(%rax) -+ vpermd %ymm5,%ymm7,%ymm5 -+ vmovdqa %ymm14,192-144(%rax) -+ vmovdqa %ymm15,224-144(%rax) -+ vmovdqa %ymm5,256-144(%rax) -+ vmovdqa 64(%rcx),%ymm5 -+ -+ -+ -+ vmovdqu 0(%rsi),%xmm7 -+ vmovdqu 16(%rsi),%xmm8 -+ vinserti128 $1,32(%rsi),%ymm7,%ymm7 -+ vinserti128 $1,48(%rsi),%ymm8,%ymm8 -+ leaq 64(%rsi),%rsi -+ -+ vpsrldq $6,%ymm7,%ymm9 -+ vpsrldq $6,%ymm8,%ymm10 -+ vpunpckhqdq %ymm8,%ymm7,%ymm6 -+ vpunpcklqdq %ymm10,%ymm9,%ymm9 -+ vpunpcklqdq %ymm8,%ymm7,%ymm7 -+ -+ vpsrlq $30,%ymm9,%ymm10 -+ vpsrlq $4,%ymm9,%ymm9 -+ vpsrlq $26,%ymm7,%ymm8 -+ vpsrlq $40,%ymm6,%ymm6 -+ vpand %ymm5,%ymm9,%ymm9 -+ vpand %ymm5,%ymm7,%ymm7 -+ vpand %ymm5,%ymm8,%ymm8 -+ vpand %ymm5,%ymm10,%ymm10 -+ vpor 32(%rcx),%ymm6,%ymm6 -+ -+ vpaddq %ymm2,%ymm9,%ymm2 -+ subq $64,%rdx -+ jz .Ltail_avx2_512 -+ jmp .Loop_avx2_512 -+ -+.align 32 -+.Loop_avx2_512: -+ -+ vpaddq %ymm0,%ymm7,%ymm0 -+ vmovdqa 0(%rsp),%ymm7 -+ vpaddq %ymm1,%ymm8,%ymm1 -+ vmovdqa 32(%rsp),%ymm8 -+ vpaddq %ymm3,%ymm10,%ymm3 -+ vmovdqa 96(%rsp),%ymm9 -+ vpaddq %ymm4,%ymm6,%ymm4 -+ vmovdqa 48(%rax),%ymm10 -+ vmovdqa 112(%rax),%ymm5 -+ -+ vpmuludq %ymm2,%ymm7,%ymm13 -+ vpmuludq %ymm2,%ymm8,%ymm14 -+ vpmuludq %ymm2,%ymm9,%ymm15 -+ vpmuludq %ymm2,%ymm10,%ymm11 -+ vpmuludq %ymm2,%ymm5,%ymm12 -+ -+ vpmuludq %ymm0,%ymm8,%ymm6 -+ vpmuludq %ymm1,%ymm8,%ymm2 -+ vpaddq %ymm6,%ymm12,%ymm12 -+ vpaddq %ymm2,%ymm13,%ymm13 -+ vpmuludq %ymm3,%ymm8,%ymm6 -+ vpmuludq 64(%rsp),%ymm4,%ymm2 -+ vpaddq %ymm6,%ymm15,%ymm15 -+ vpaddq %ymm2,%ymm11,%ymm11 -+ vmovdqa -16(%rax),%ymm8 -+ -+ vpmuludq %ymm0,%ymm7,%ymm6 -+ vpmuludq %ymm1,%ymm7,%ymm2 -+ vpaddq %ymm6,%ymm11,%ymm11 -+ vpaddq %ymm2,%ymm12,%ymm12 -+ vpmuludq %ymm3,%ymm7,%ymm6 -+ vpmuludq %ymm4,%ymm7,%ymm2 -+ vmovdqu 0(%rsi),%xmm7 -+ vpaddq %ymm6,%ymm14,%ymm14 -+ vpaddq %ymm2,%ymm15,%ymm15 -+ vinserti128 $1,32(%rsi),%ymm7,%ymm7 -+ -+ vpmuludq %ymm3,%ymm8,%ymm6 -+ vpmuludq %ymm4,%ymm8,%ymm2 -+ vmovdqu 16(%rsi),%xmm8 -+ vpaddq %ymm6,%ymm11,%ymm11 -+ vpaddq %ymm2,%ymm12,%ymm12 -+ vmovdqa 16(%rax),%ymm2 -+ vpmuludq %ymm1,%ymm9,%ymm6 -+ vpmuludq %ymm0,%ymm9,%ymm9 -+ vpaddq %ymm6,%ymm14,%ymm14 -+ vpaddq %ymm9,%ymm13,%ymm13 -+ vinserti128 $1,48(%rsi),%ymm8,%ymm8 -+ leaq 64(%rsi),%rsi -+ -+ vpmuludq %ymm1,%ymm2,%ymm6 -+ vpmuludq %ymm0,%ymm2,%ymm2 -+ vpsrldq $6,%ymm7,%ymm9 -+ vpaddq %ymm6,%ymm15,%ymm15 -+ vpaddq %ymm2,%ymm14,%ymm14 -+ vpmuludq %ymm3,%ymm10,%ymm6 -+ vpmuludq %ymm4,%ymm10,%ymm2 -+ vpsrldq $6,%ymm8,%ymm10 -+ vpaddq %ymm6,%ymm12,%ymm12 -+ vpaddq %ymm2,%ymm13,%ymm13 -+ vpunpckhqdq %ymm8,%ymm7,%ymm6 -+ -+ vpmuludq %ymm3,%ymm5,%ymm3 -+ vpmuludq %ymm4,%ymm5,%ymm4 -+ vpunpcklqdq %ymm8,%ymm7,%ymm7 -+ vpaddq %ymm3,%ymm13,%ymm2 -+ vpaddq %ymm4,%ymm14,%ymm3 -+ vpunpcklqdq %ymm10,%ymm9,%ymm10 -+ vpmuludq 80(%rax),%ymm0,%ymm4 -+ vpmuludq %ymm1,%ymm5,%ymm0 -+ vmovdqa 64(%rcx),%ymm5 -+ vpaddq %ymm4,%ymm15,%ymm4 -+ vpaddq %ymm0,%ymm11,%ymm0 -+ -+ vpsrlq $26,%ymm3,%ymm14 -+ vpand %ymm5,%ymm3,%ymm3 -+ vpaddq %ymm14,%ymm4,%ymm4 -+ -+ vpsrlq $26,%ymm0,%ymm11 -+ vpand %ymm5,%ymm0,%ymm0 -+ vpaddq %ymm11,%ymm12,%ymm1 -+ -+ vpsrlq $26,%ymm4,%ymm15 -+ vpand %ymm5,%ymm4,%ymm4 -+ -+ vpsrlq $4,%ymm10,%ymm9 -+ -+ vpsrlq $26,%ymm1,%ymm12 -+ vpand %ymm5,%ymm1,%ymm1 -+ vpaddq %ymm12,%ymm2,%ymm2 -+ -+ vpaddq %ymm15,%ymm0,%ymm0 -+ vpsllq $2,%ymm15,%ymm15 -+ vpaddq %ymm15,%ymm0,%ymm0 -+ -+ vpand %ymm5,%ymm9,%ymm9 -+ vpsrlq $26,%ymm7,%ymm8 -+ -+ vpsrlq $26,%ymm2,%ymm13 -+ vpand %ymm5,%ymm2,%ymm2 -+ vpaddq %ymm13,%ymm3,%ymm3 -+ -+ vpaddq %ymm9,%ymm2,%ymm2 -+ vpsrlq $30,%ymm10,%ymm10 -+ -+ vpsrlq $26,%ymm0,%ymm11 -+ vpand %ymm5,%ymm0,%ymm0 -+ vpaddq %ymm11,%ymm1,%ymm1 -+ -+ vpsrlq $40,%ymm6,%ymm6 -+ -+ vpsrlq $26,%ymm3,%ymm14 -+ vpand %ymm5,%ymm3,%ymm3 -+ vpaddq %ymm14,%ymm4,%ymm4 -+ -+ vpand %ymm5,%ymm7,%ymm7 -+ vpand %ymm5,%ymm8,%ymm8 -+ vpand %ymm5,%ymm10,%ymm10 -+ vpor 32(%rcx),%ymm6,%ymm6 -+ -+ subq $64,%rdx -+ jnz .Loop_avx2_512 -+ -+.byte 0x66,0x90 -+.Ltail_avx2_512: -+ -+ vpaddq %ymm0,%ymm7,%ymm0 -+ vmovdqu 4(%rsp),%ymm7 -+ vpaddq %ymm1,%ymm8,%ymm1 -+ vmovdqu 36(%rsp),%ymm8 -+ vpaddq %ymm3,%ymm10,%ymm3 -+ vmovdqu 100(%rsp),%ymm9 -+ vpaddq %ymm4,%ymm6,%ymm4 -+ vmovdqu 52(%rax),%ymm10 -+ vmovdqu 116(%rax),%ymm5 -+ -+ vpmuludq %ymm2,%ymm7,%ymm13 -+ vpmuludq %ymm2,%ymm8,%ymm14 -+ vpmuludq %ymm2,%ymm9,%ymm15 -+ vpmuludq %ymm2,%ymm10,%ymm11 -+ vpmuludq %ymm2,%ymm5,%ymm12 -+ -+ vpmuludq %ymm0,%ymm8,%ymm6 -+ vpmuludq %ymm1,%ymm8,%ymm2 -+ vpaddq %ymm6,%ymm12,%ymm12 -+ vpaddq %ymm2,%ymm13,%ymm13 -+ vpmuludq %ymm3,%ymm8,%ymm6 -+ vpmuludq 68(%rsp),%ymm4,%ymm2 -+ vpaddq %ymm6,%ymm15,%ymm15 -+ vpaddq %ymm2,%ymm11,%ymm11 -+ -+ vpmuludq %ymm0,%ymm7,%ymm6 -+ vpmuludq %ymm1,%ymm7,%ymm2 -+ vpaddq %ymm6,%ymm11,%ymm11 -+ vmovdqu -12(%rax),%ymm8 -+ vpaddq %ymm2,%ymm12,%ymm12 -+ vpmuludq %ymm3,%ymm7,%ymm6 -+ vpmuludq %ymm4,%ymm7,%ymm2 -+ vpaddq %ymm6,%ymm14,%ymm14 -+ vpaddq %ymm2,%ymm15,%ymm15 -+ -+ vpmuludq %ymm3,%ymm8,%ymm6 -+ vpmuludq %ymm4,%ymm8,%ymm2 -+ vpaddq %ymm6,%ymm11,%ymm11 -+ vpaddq %ymm2,%ymm12,%ymm12 -+ vmovdqu 20(%rax),%ymm2 -+ vpmuludq %ymm1,%ymm9,%ymm6 -+ vpmuludq %ymm0,%ymm9,%ymm9 -+ vpaddq %ymm6,%ymm14,%ymm14 -+ vpaddq %ymm9,%ymm13,%ymm13 -+ -+ vpmuludq %ymm1,%ymm2,%ymm6 -+ vpmuludq %ymm0,%ymm2,%ymm2 -+ vpaddq %ymm6,%ymm15,%ymm15 -+ vpaddq %ymm2,%ymm14,%ymm14 -+ vpmuludq %ymm3,%ymm10,%ymm6 -+ vpmuludq %ymm4,%ymm10,%ymm2 -+ vpaddq %ymm6,%ymm12,%ymm12 -+ vpaddq %ymm2,%ymm13,%ymm13 -+ -+ vpmuludq %ymm3,%ymm5,%ymm3 -+ vpmuludq %ymm4,%ymm5,%ymm4 -+ vpaddq %ymm3,%ymm13,%ymm2 -+ vpaddq %ymm4,%ymm14,%ymm3 -+ vpmuludq 84(%rax),%ymm0,%ymm4 -+ vpmuludq %ymm1,%ymm5,%ymm0 -+ vmovdqa 64(%rcx),%ymm5 -+ vpaddq %ymm4,%ymm15,%ymm4 -+ vpaddq %ymm0,%ymm11,%ymm0 -+ -+ vpsrldq $8,%ymm12,%ymm8 -+ vpsrldq $8,%ymm2,%ymm9 -+ vpsrldq $8,%ymm3,%ymm10 -+ vpsrldq $8,%ymm4,%ymm6 -+ vpsrldq $8,%ymm0,%ymm7 -+ vpaddq %ymm8,%ymm12,%ymm12 -+ vpaddq %ymm9,%ymm2,%ymm2 -+ vpaddq %ymm10,%ymm3,%ymm3 -+ vpaddq %ymm6,%ymm4,%ymm4 -+ vpaddq %ymm7,%ymm0,%ymm0 -+ -+ vpermq $0x2,%ymm3,%ymm10 -+ vpermq $0x2,%ymm4,%ymm6 -+ vpermq $0x2,%ymm0,%ymm7 -+ vpermq $0x2,%ymm12,%ymm8 -+ vpermq $0x2,%ymm2,%ymm9 -+ vpaddq %ymm10,%ymm3,%ymm3 -+ vpaddq %ymm6,%ymm4,%ymm4 -+ vpaddq %ymm7,%ymm0,%ymm0 -+ vpaddq %ymm8,%ymm12,%ymm12 -+ vpaddq %ymm9,%ymm2,%ymm2 -+ -+ vpsrlq $26,%ymm3,%ymm14 -+ vpand %ymm5,%ymm3,%ymm3 -+ vpaddq %ymm14,%ymm4,%ymm4 -+ -+ vpsrlq $26,%ymm0,%ymm11 -+ vpand %ymm5,%ymm0,%ymm0 -+ vpaddq %ymm11,%ymm12,%ymm1 -+ -+ vpsrlq $26,%ymm4,%ymm15 -+ vpand %ymm5,%ymm4,%ymm4 -+ -+ vpsrlq $26,%ymm1,%ymm12 -+ vpand %ymm5,%ymm1,%ymm1 -+ vpaddq %ymm12,%ymm2,%ymm2 -+ -+ vpaddq %ymm15,%ymm0,%ymm0 -+ vpsllq $2,%ymm15,%ymm15 -+ vpaddq %ymm15,%ymm0,%ymm0 -+ -+ vpsrlq $26,%ymm2,%ymm13 -+ vpand %ymm5,%ymm2,%ymm2 -+ vpaddq %ymm13,%ymm3,%ymm3 -+ -+ vpsrlq $26,%ymm0,%ymm11 -+ vpand %ymm5,%ymm0,%ymm0 -+ vpaddq %ymm11,%ymm1,%ymm1 -+ -+ vpsrlq $26,%ymm3,%ymm14 -+ vpand %ymm5,%ymm3,%ymm3 -+ vpaddq %ymm14,%ymm4,%ymm4 -+ -+ vmovd %xmm0,-112(%rdi) -+ vmovd %xmm1,-108(%rdi) -+ vmovd %xmm2,-104(%rdi) -+ vmovd %xmm3,-100(%rdi) -+ vmovd %xmm4,-96(%rdi) -+ leaq -8(%r10),%rsp -+ -+ vzeroupper -+ ret -+ -+.Lblocks_avx512: -+ -+ movl $15,%eax -+ kmovw %eax,%k2 -+ leaq 8(%rsp),%r10 -+ -+ subq $0x128,%rsp -+ leaq .Lconst(%rip),%rcx -+ leaq 48+64(%rdi),%rdi -+ vmovdqa 96(%rcx),%ymm9 -+ -+ vmovdqu32 -64(%rdi),%zmm16{%k2}{z} -+ andq $-512,%rsp -+ vmovdqu32 -48(%rdi),%zmm17{%k2}{z} -+ movq $0x20,%rax -+ vmovdqu32 -32(%rdi),%zmm21{%k2}{z} -+ vmovdqu32 -16(%rdi),%zmm18{%k2}{z} -+ vmovdqu32 0(%rdi),%zmm22{%k2}{z} -+ vmovdqu32 16(%rdi),%zmm19{%k2}{z} -+ vmovdqu32 32(%rdi),%zmm23{%k2}{z} -+ vmovdqu32 48(%rdi),%zmm20{%k2}{z} -+ vmovdqu32 64(%rdi),%zmm24{%k2}{z} -+ vpermd %zmm16,%zmm9,%zmm16 -+ vpbroadcastq 64(%rcx),%zmm5 -+ vpermd %zmm17,%zmm9,%zmm17 -+ vpermd %zmm21,%zmm9,%zmm21 -+ vpermd %zmm18,%zmm9,%zmm18 -+ vmovdqa64 %zmm16,0(%rsp){%k2} -+ vpsrlq $32,%zmm16,%zmm7 -+ vpermd %zmm22,%zmm9,%zmm22 -+ vmovdqu64 %zmm17,0(%rsp,%rax,1){%k2} -+ vpsrlq $32,%zmm17,%zmm8 -+ vpermd %zmm19,%zmm9,%zmm19 -+ vmovdqa64 %zmm21,64(%rsp){%k2} -+ vpermd %zmm23,%zmm9,%zmm23 -+ vpermd %zmm20,%zmm9,%zmm20 -+ vmovdqu64 %zmm18,64(%rsp,%rax,1){%k2} -+ vpermd %zmm24,%zmm9,%zmm24 -+ vmovdqa64 %zmm22,128(%rsp){%k2} -+ vmovdqu64 %zmm19,128(%rsp,%rax,1){%k2} -+ vmovdqa64 %zmm23,192(%rsp){%k2} -+ vmovdqu64 %zmm20,192(%rsp,%rax,1){%k2} -+ vmovdqa64 %zmm24,256(%rsp){%k2} -+ -+ vpmuludq %zmm7,%zmm16,%zmm11 -+ vpmuludq %zmm7,%zmm17,%zmm12 -+ vpmuludq %zmm7,%zmm18,%zmm13 -+ vpmuludq %zmm7,%zmm19,%zmm14 -+ vpmuludq %zmm7,%zmm20,%zmm15 -+ vpsrlq $32,%zmm18,%zmm9 -+ -+ vpmuludq %zmm8,%zmm24,%zmm25 -+ vpmuludq %zmm8,%zmm16,%zmm26 -+ vpmuludq %zmm8,%zmm17,%zmm27 -+ vpmuludq %zmm8,%zmm18,%zmm28 -+ vpmuludq %zmm8,%zmm19,%zmm29 -+ vpsrlq $32,%zmm19,%zmm10 -+ vpaddq %zmm25,%zmm11,%zmm11 -+ vpaddq %zmm26,%zmm12,%zmm12 -+ vpaddq %zmm27,%zmm13,%zmm13 -+ vpaddq %zmm28,%zmm14,%zmm14 -+ vpaddq %zmm29,%zmm15,%zmm15 -+ -+ vpmuludq %zmm9,%zmm23,%zmm25 -+ vpmuludq %zmm9,%zmm24,%zmm26 -+ vpmuludq %zmm9,%zmm17,%zmm28 -+ vpmuludq %zmm9,%zmm18,%zmm29 -+ vpmuludq %zmm9,%zmm16,%zmm27 -+ vpsrlq $32,%zmm20,%zmm6 -+ vpaddq %zmm25,%zmm11,%zmm11 -+ vpaddq %zmm26,%zmm12,%zmm12 -+ vpaddq %zmm28,%zmm14,%zmm14 -+ vpaddq %zmm29,%zmm15,%zmm15 -+ vpaddq %zmm27,%zmm13,%zmm13 -+ -+ vpmuludq %zmm10,%zmm22,%zmm25 -+ vpmuludq %zmm10,%zmm16,%zmm28 -+ vpmuludq %zmm10,%zmm17,%zmm29 -+ vpmuludq %zmm10,%zmm23,%zmm26 -+ vpmuludq %zmm10,%zmm24,%zmm27 -+ vpaddq %zmm25,%zmm11,%zmm11 -+ vpaddq %zmm28,%zmm14,%zmm14 -+ vpaddq %zmm29,%zmm15,%zmm15 -+ vpaddq %zmm26,%zmm12,%zmm12 -+ vpaddq %zmm27,%zmm13,%zmm13 -+ -+ vpmuludq %zmm6,%zmm24,%zmm28 -+ vpmuludq %zmm6,%zmm16,%zmm29 -+ vpmuludq %zmm6,%zmm21,%zmm25 -+ vpmuludq %zmm6,%zmm22,%zmm26 -+ vpmuludq %zmm6,%zmm23,%zmm27 -+ vpaddq %zmm28,%zmm14,%zmm14 -+ vpaddq %zmm29,%zmm15,%zmm15 -+ vpaddq %zmm25,%zmm11,%zmm11 -+ vpaddq %zmm26,%zmm12,%zmm12 -+ vpaddq %zmm27,%zmm13,%zmm13 -+ -+ vmovdqu64 0(%rsi),%zmm10 -+ vmovdqu64 64(%rsi),%zmm6 -+ leaq 128(%rsi),%rsi -+ -+ vpsrlq $26,%zmm14,%zmm28 -+ vpandq %zmm5,%zmm14,%zmm14 -+ vpaddq %zmm28,%zmm15,%zmm15 -+ -+ vpsrlq $26,%zmm11,%zmm25 -+ vpandq %zmm5,%zmm11,%zmm11 -+ vpaddq %zmm25,%zmm12,%zmm12 -+ -+ vpsrlq $26,%zmm15,%zmm29 -+ vpandq %zmm5,%zmm15,%zmm15 -+ -+ vpsrlq $26,%zmm12,%zmm26 -+ vpandq %zmm5,%zmm12,%zmm12 -+ vpaddq %zmm26,%zmm13,%zmm13 -+ -+ vpaddq %zmm29,%zmm11,%zmm11 -+ vpsllq $2,%zmm29,%zmm29 -+ vpaddq %zmm29,%zmm11,%zmm11 -+ -+ vpsrlq $26,%zmm13,%zmm27 -+ vpandq %zmm5,%zmm13,%zmm13 -+ vpaddq %zmm27,%zmm14,%zmm14 -+ -+ vpsrlq $26,%zmm11,%zmm25 -+ vpandq %zmm5,%zmm11,%zmm11 -+ vpaddq %zmm25,%zmm12,%zmm12 -+ -+ vpsrlq $26,%zmm14,%zmm28 -+ vpandq %zmm5,%zmm14,%zmm14 -+ vpaddq %zmm28,%zmm15,%zmm15 -+ -+ vpunpcklqdq %zmm6,%zmm10,%zmm7 -+ vpunpckhqdq %zmm6,%zmm10,%zmm6 -+ -+ vmovdqa32 128(%rcx),%zmm25 -+ movl $0x7777,%eax -+ kmovw %eax,%k1 -+ -+ vpermd %zmm16,%zmm25,%zmm16 -+ vpermd %zmm17,%zmm25,%zmm17 -+ vpermd %zmm18,%zmm25,%zmm18 -+ vpermd %zmm19,%zmm25,%zmm19 -+ vpermd %zmm20,%zmm25,%zmm20 -+ -+ vpermd %zmm11,%zmm25,%zmm16{%k1} -+ vpermd %zmm12,%zmm25,%zmm17{%k1} -+ vpermd %zmm13,%zmm25,%zmm18{%k1} -+ vpermd %zmm14,%zmm25,%zmm19{%k1} -+ vpermd %zmm15,%zmm25,%zmm20{%k1} -+ -+ vpslld $2,%zmm17,%zmm21 -+ vpslld $2,%zmm18,%zmm22 -+ vpslld $2,%zmm19,%zmm23 -+ vpslld $2,%zmm20,%zmm24 -+ vpaddd %zmm17,%zmm21,%zmm21 -+ vpaddd %zmm18,%zmm22,%zmm22 -+ vpaddd %zmm19,%zmm23,%zmm23 -+ vpaddd %zmm20,%zmm24,%zmm24 -+ -+ vpbroadcastq 32(%rcx),%zmm30 -+ -+ vpsrlq $52,%zmm7,%zmm9 -+ vpsllq $12,%zmm6,%zmm10 -+ vporq %zmm10,%zmm9,%zmm9 -+ vpsrlq $26,%zmm7,%zmm8 -+ vpsrlq $14,%zmm6,%zmm10 -+ vpsrlq $40,%zmm6,%zmm6 -+ vpandq %zmm5,%zmm9,%zmm9 -+ vpandq %zmm5,%zmm7,%zmm7 -+ -+ vpaddq %zmm2,%zmm9,%zmm2 -+ subq $192,%rdx -+ jbe .Ltail_avx512 -+ jmp .Loop_avx512 -+ -+.align 32 -+.Loop_avx512: -+ -+ vpmuludq %zmm2,%zmm17,%zmm14 -+ vpaddq %zmm0,%zmm7,%zmm0 -+ vpmuludq %zmm2,%zmm18,%zmm15 -+ vpandq %zmm5,%zmm8,%zmm8 -+ vpmuludq %zmm2,%zmm23,%zmm11 -+ vpandq %zmm5,%zmm10,%zmm10 -+ vpmuludq %zmm2,%zmm24,%zmm12 -+ vporq %zmm30,%zmm6,%zmm6 -+ vpmuludq %zmm2,%zmm16,%zmm13 -+ vpaddq %zmm1,%zmm8,%zmm1 -+ vpaddq %zmm3,%zmm10,%zmm3 -+ vpaddq %zmm4,%zmm6,%zmm4 -+ -+ vmovdqu64 0(%rsi),%zmm10 -+ vmovdqu64 64(%rsi),%zmm6 -+ leaq 128(%rsi),%rsi -+ vpmuludq %zmm0,%zmm19,%zmm28 -+ vpmuludq %zmm0,%zmm20,%zmm29 -+ vpmuludq %zmm0,%zmm16,%zmm25 -+ vpmuludq %zmm0,%zmm17,%zmm26 -+ vpaddq %zmm28,%zmm14,%zmm14 -+ vpaddq %zmm29,%zmm15,%zmm15 -+ vpaddq %zmm25,%zmm11,%zmm11 -+ vpaddq %zmm26,%zmm12,%zmm12 -+ -+ vpmuludq %zmm1,%zmm18,%zmm28 -+ vpmuludq %zmm1,%zmm19,%zmm29 -+ vpmuludq %zmm1,%zmm24,%zmm25 -+ vpmuludq %zmm0,%zmm18,%zmm27 -+ vpaddq %zmm28,%zmm14,%zmm14 -+ vpaddq %zmm29,%zmm15,%zmm15 -+ vpaddq %zmm25,%zmm11,%zmm11 -+ vpaddq %zmm27,%zmm13,%zmm13 -+ -+ vpunpcklqdq %zmm6,%zmm10,%zmm7 -+ vpunpckhqdq %zmm6,%zmm10,%zmm6 -+ -+ vpmuludq %zmm3,%zmm16,%zmm28 -+ vpmuludq %zmm3,%zmm17,%zmm29 -+ vpmuludq %zmm1,%zmm16,%zmm26 -+ vpmuludq %zmm1,%zmm17,%zmm27 -+ vpaddq %zmm28,%zmm14,%zmm14 -+ vpaddq %zmm29,%zmm15,%zmm15 -+ vpaddq %zmm26,%zmm12,%zmm12 -+ vpaddq %zmm27,%zmm13,%zmm13 -+ -+ vpmuludq %zmm4,%zmm24,%zmm28 -+ vpmuludq %zmm4,%zmm16,%zmm29 -+ vpmuludq %zmm3,%zmm22,%zmm25 -+ vpmuludq %zmm3,%zmm23,%zmm26 -+ vpaddq %zmm28,%zmm14,%zmm14 -+ vpmuludq %zmm3,%zmm24,%zmm27 -+ vpaddq %zmm29,%zmm15,%zmm15 -+ vpaddq %zmm25,%zmm11,%zmm11 -+ vpaddq %zmm26,%zmm12,%zmm12 -+ vpaddq %zmm27,%zmm13,%zmm13 -+ -+ vpmuludq %zmm4,%zmm21,%zmm25 -+ vpmuludq %zmm4,%zmm22,%zmm26 -+ vpmuludq %zmm4,%zmm23,%zmm27 -+ vpaddq %zmm25,%zmm11,%zmm0 -+ vpaddq %zmm26,%zmm12,%zmm1 -+ vpaddq %zmm27,%zmm13,%zmm2 -+ -+ vpsrlq $52,%zmm7,%zmm9 -+ vpsllq $12,%zmm6,%zmm10 -+ -+ vpsrlq $26,%zmm14,%zmm3 -+ vpandq %zmm5,%zmm14,%zmm14 -+ vpaddq %zmm3,%zmm15,%zmm4 -+ -+ vporq %zmm10,%zmm9,%zmm9 -+ -+ vpsrlq $26,%zmm0,%zmm11 -+ vpandq %zmm5,%zmm0,%zmm0 -+ vpaddq %zmm11,%zmm1,%zmm1 -+ -+ vpandq %zmm5,%zmm9,%zmm9 -+ -+ vpsrlq $26,%zmm4,%zmm15 -+ vpandq %zmm5,%zmm4,%zmm4 -+ -+ vpsrlq $26,%zmm1,%zmm12 -+ vpandq %zmm5,%zmm1,%zmm1 -+ vpaddq %zmm12,%zmm2,%zmm2 -+ -+ vpaddq %zmm15,%zmm0,%zmm0 -+ vpsllq $2,%zmm15,%zmm15 -+ vpaddq %zmm15,%zmm0,%zmm0 -+ -+ vpaddq %zmm9,%zmm2,%zmm2 -+ vpsrlq $26,%zmm7,%zmm8 -+ -+ vpsrlq $26,%zmm2,%zmm13 -+ vpandq %zmm5,%zmm2,%zmm2 -+ vpaddq %zmm13,%zmm14,%zmm3 -+ -+ vpsrlq $14,%zmm6,%zmm10 -+ -+ vpsrlq $26,%zmm0,%zmm11 -+ vpandq %zmm5,%zmm0,%zmm0 -+ vpaddq %zmm11,%zmm1,%zmm1 -+ -+ vpsrlq $40,%zmm6,%zmm6 -+ -+ vpsrlq $26,%zmm3,%zmm14 -+ vpandq %zmm5,%zmm3,%zmm3 -+ vpaddq %zmm14,%zmm4,%zmm4 -+ -+ vpandq %zmm5,%zmm7,%zmm7 -+ -+ subq $128,%rdx -+ ja .Loop_avx512 -+ -+.Ltail_avx512: -+ -+ vpsrlq $32,%zmm16,%zmm16 -+ vpsrlq $32,%zmm17,%zmm17 -+ vpsrlq $32,%zmm18,%zmm18 -+ vpsrlq $32,%zmm23,%zmm23 -+ vpsrlq $32,%zmm24,%zmm24 -+ vpsrlq $32,%zmm19,%zmm19 -+ vpsrlq $32,%zmm20,%zmm20 -+ vpsrlq $32,%zmm21,%zmm21 -+ vpsrlq $32,%zmm22,%zmm22 -+ -+ leaq (%rsi,%rdx,1),%rsi -+ -+ vpaddq %zmm0,%zmm7,%zmm0 -+ -+ vpmuludq %zmm2,%zmm17,%zmm14 -+ vpmuludq %zmm2,%zmm18,%zmm15 -+ vpmuludq %zmm2,%zmm23,%zmm11 -+ vpandq %zmm5,%zmm8,%zmm8 -+ vpmuludq %zmm2,%zmm24,%zmm12 -+ vpandq %zmm5,%zmm10,%zmm10 -+ vpmuludq %zmm2,%zmm16,%zmm13 -+ vporq %zmm30,%zmm6,%zmm6 -+ vpaddq %zmm1,%zmm8,%zmm1 -+ vpaddq %zmm3,%zmm10,%zmm3 -+ vpaddq %zmm4,%zmm6,%zmm4 -+ -+ vmovdqu 0(%rsi),%xmm7 -+ vpmuludq %zmm0,%zmm19,%zmm28 -+ vpmuludq %zmm0,%zmm20,%zmm29 -+ vpmuludq %zmm0,%zmm16,%zmm25 -+ vpmuludq %zmm0,%zmm17,%zmm26 -+ vpaddq %zmm28,%zmm14,%zmm14 -+ vpaddq %zmm29,%zmm15,%zmm15 -+ vpaddq %zmm25,%zmm11,%zmm11 -+ vpaddq %zmm26,%zmm12,%zmm12 -+ -+ vmovdqu 16(%rsi),%xmm8 -+ vpmuludq %zmm1,%zmm18,%zmm28 -+ vpmuludq %zmm1,%zmm19,%zmm29 -+ vpmuludq %zmm1,%zmm24,%zmm25 -+ vpmuludq %zmm0,%zmm18,%zmm27 -+ vpaddq %zmm28,%zmm14,%zmm14 -+ vpaddq %zmm29,%zmm15,%zmm15 -+ vpaddq %zmm25,%zmm11,%zmm11 -+ vpaddq %zmm27,%zmm13,%zmm13 -+ -+ vinserti128 $1,32(%rsi),%ymm7,%ymm7 -+ vpmuludq %zmm3,%zmm16,%zmm28 -+ vpmuludq %zmm3,%zmm17,%zmm29 -+ vpmuludq %zmm1,%zmm16,%zmm26 -+ vpmuludq %zmm1,%zmm17,%zmm27 -+ vpaddq %zmm28,%zmm14,%zmm14 -+ vpaddq %zmm29,%zmm15,%zmm15 -+ vpaddq %zmm26,%zmm12,%zmm12 -+ vpaddq %zmm27,%zmm13,%zmm13 -+ -+ vinserti128 $1,48(%rsi),%ymm8,%ymm8 -+ vpmuludq %zmm4,%zmm24,%zmm28 -+ vpmuludq %zmm4,%zmm16,%zmm29 -+ vpmuludq %zmm3,%zmm22,%zmm25 -+ vpmuludq %zmm3,%zmm23,%zmm26 -+ vpmuludq %zmm3,%zmm24,%zmm27 -+ vpaddq %zmm28,%zmm14,%zmm3 -+ vpaddq %zmm29,%zmm15,%zmm15 -+ vpaddq %zmm25,%zmm11,%zmm11 -+ vpaddq %zmm26,%zmm12,%zmm12 -+ vpaddq %zmm27,%zmm13,%zmm13 -+ -+ vpmuludq %zmm4,%zmm21,%zmm25 -+ vpmuludq %zmm4,%zmm22,%zmm26 -+ vpmuludq %zmm4,%zmm23,%zmm27 -+ vpaddq %zmm25,%zmm11,%zmm0 -+ vpaddq %zmm26,%zmm12,%zmm1 -+ vpaddq %zmm27,%zmm13,%zmm2 -+ -+ movl $1,%eax -+ vpermq $0xb1,%zmm3,%zmm14 -+ vpermq $0xb1,%zmm15,%zmm4 -+ vpermq $0xb1,%zmm0,%zmm11 -+ vpermq $0xb1,%zmm1,%zmm12 -+ vpermq $0xb1,%zmm2,%zmm13 -+ vpaddq %zmm14,%zmm3,%zmm3 -+ vpaddq %zmm15,%zmm4,%zmm4 -+ vpaddq %zmm11,%zmm0,%zmm0 -+ vpaddq %zmm12,%zmm1,%zmm1 -+ vpaddq %zmm13,%zmm2,%zmm2 -+ -+ kmovw %eax,%k3 -+ vpermq $0x2,%zmm3,%zmm14 -+ vpermq $0x2,%zmm4,%zmm15 -+ vpermq $0x2,%zmm0,%zmm11 -+ vpermq $0x2,%zmm1,%zmm12 -+ vpermq $0x2,%zmm2,%zmm13 -+ vpaddq %zmm14,%zmm3,%zmm3 -+ vpaddq %zmm15,%zmm4,%zmm4 -+ vpaddq %zmm11,%zmm0,%zmm0 -+ vpaddq %zmm12,%zmm1,%zmm1 -+ vpaddq %zmm13,%zmm2,%zmm2 -+ -+ vextracti64x4 $0x1,%zmm3,%ymm14 -+ vextracti64x4 $0x1,%zmm4,%ymm15 -+ vextracti64x4 $0x1,%zmm0,%ymm11 -+ vextracti64x4 $0x1,%zmm1,%ymm12 -+ vextracti64x4 $0x1,%zmm2,%ymm13 -+ vpaddq %zmm14,%zmm3,%zmm3{%k3}{z} -+ vpaddq %zmm15,%zmm4,%zmm4{%k3}{z} -+ vpaddq %zmm11,%zmm0,%zmm0{%k3}{z} -+ vpaddq %zmm12,%zmm1,%zmm1{%k3}{z} -+ vpaddq %zmm13,%zmm2,%zmm2{%k3}{z} -+ -+ vpsrlq $26,%ymm3,%ymm14 -+ vpand %ymm5,%ymm3,%ymm3 -+ vpsrldq $6,%ymm7,%ymm9 -+ vpsrldq $6,%ymm8,%ymm10 -+ vpunpckhqdq %ymm8,%ymm7,%ymm6 -+ vpaddq %ymm14,%ymm4,%ymm4 -+ -+ vpsrlq $26,%ymm0,%ymm11 -+ vpand %ymm5,%ymm0,%ymm0 -+ vpunpcklqdq %ymm10,%ymm9,%ymm9 -+ vpunpcklqdq %ymm8,%ymm7,%ymm7 -+ vpaddq %ymm11,%ymm1,%ymm1 -+ -+ vpsrlq $26,%ymm4,%ymm15 -+ vpand %ymm5,%ymm4,%ymm4 -+ -+ vpsrlq $26,%ymm1,%ymm12 -+ vpand %ymm5,%ymm1,%ymm1 -+ vpsrlq $30,%ymm9,%ymm10 -+ vpsrlq $4,%ymm9,%ymm9 -+ vpaddq %ymm12,%ymm2,%ymm2 -+ -+ vpaddq %ymm15,%ymm0,%ymm0 -+ vpsllq $2,%ymm15,%ymm15 -+ vpsrlq $26,%ymm7,%ymm8 -+ vpsrlq $40,%ymm6,%ymm6 -+ vpaddq %ymm15,%ymm0,%ymm0 -+ -+ vpsrlq $26,%ymm2,%ymm13 -+ vpand %ymm5,%ymm2,%ymm2 -+ vpand %ymm5,%ymm9,%ymm9 -+ vpand %ymm5,%ymm7,%ymm7 -+ vpaddq %ymm13,%ymm3,%ymm3 -+ -+ vpsrlq $26,%ymm0,%ymm11 -+ vpand %ymm5,%ymm0,%ymm0 -+ vpaddq %ymm2,%ymm9,%ymm2 -+ vpand %ymm5,%ymm8,%ymm8 -+ vpaddq %ymm11,%ymm1,%ymm1 -+ -+ vpsrlq $26,%ymm3,%ymm14 -+ vpand %ymm5,%ymm3,%ymm3 -+ vpand %ymm5,%ymm10,%ymm10 -+ vpor 32(%rcx),%ymm6,%ymm6 -+ vpaddq %ymm14,%ymm4,%ymm4 -+ -+ leaq 144(%rsp),%rax -+ addq $64,%rdx -+ jnz .Ltail_avx2_512 -+ -+ vpsubq %ymm9,%ymm2,%ymm2 -+ vmovd %xmm0,-112(%rdi) -+ vmovd %xmm1,-108(%rdi) -+ vmovd %xmm2,-104(%rdi) -+ vmovd %xmm3,-100(%rdi) -+ vmovd %xmm4,-96(%rdi) -+ vzeroall -+ leaq -8(%r10),%rsp -+ -+ ret -+ -+ENDPROC(poly1305_blocks_avx512) -+#endif /* CONFIG_AS_AVX512 */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/Makefile 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,19 @@ -+# SPDX-License-Identifier: GPL-2.0 -+# -+# Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ -+ccflags-y := -O3 -fvisibility=hidden -+ccflags-$(CONFIG_WIREGUARD_DEBUG) += -DDEBUG -g -+ccflags-y += -Wframe-larger-than=8192 -+ccflags-y += -D'pr_fmt(fmt)=KBUILD_MODNAME ": " fmt' -+wireguard-y := main.o noise.o device.o peer.o timers.o queueing.o send.o receive.o socket.o hashtables.o allowedips.o ratelimiter.o cookie.o netlink.o -+wireguard-y += crypto/curve25519.o crypto/chacha20poly1305.o crypto/blake2s.o -+ -+wireguard-$(CONFIG_X86_64) += crypto/chacha20-x86_64.o crypto/poly1305-x86_64.o crypto/blake2s-x86_64.o crypto/curve25519-x86_64.o -+wireguard-$(CONFIG_ARM) += crypto/chacha20-arm.o crypto/poly1305-arm.o crypto/curve25519-arm.o -+wireguard-$(CONFIG_ARM64) += crypto/chacha20-arm64.o crypto/poly1305-arm64.o -+wireguard-$(if $(filter yy,$(CONFIG_MIPS)$(CONFIG_64BIT)),y,n) += crypto/poly1305-mips64.o -+ -+include $(src)/compat/Makefile.include -+ -+obj-$(if $(KBUILD_EXTMOD),m,$(CONFIG_WIREGUARD)) := wireguard.o ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/Kconfig 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,31 @@ -+config WIREGUARD -+ tristate "IP: WireGuard secure network tunnel" -+ depends on NET && INET -+ select NET_UDP_TUNNEL -+ select DST_CACHE -+ select CRYPTO_BLKCIPHER -+ select VFP -+ select VFPv3 -+ select NEON -+ select KERNEL_MODE_NEON -+ default m -+ ---help--- -+ WireGuard is a secure, fast, and easy to use replacement for IPSec -+ that uses modern cryptography and clever networking tricks. It's -+ designed to be fairly general purpose and abstract enough to fit most -+ use cases, while at the same time remaining extremely simple to -+ configure. See www.wireguard.com for more info. -+ -+ It's safe to say Y or M here, as the driver is very lightweight and -+ is only in use when an administrator chooses to add an interface. -+ -+config WIREGUARD_DEBUG -+ bool "Debugging checks and verbose messages" -+ depends on WIREGUARD -+ ---help--- -+ This will write log messages for handshake and other events -+ that occur for a WireGuard interface. It will also perform some -+ extra validation checks and unit tests at various points. This is -+ only useful for debugging. -+ -+ Say N here unless you know what you're doing. ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/simd/include/asm/simd.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1 @@ -+#include ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/udp_tunnel/udp_tunnel_partial_compat.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,226 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 0) -+#define udp_sock_create4 udp_sock_create -+#define udp_sock_create6 udp_sock_create -+#include -+#include -+#include -+#include -+#include -+#include -+#if IS_ENABLED(CONFIG_IPV6) -+#include -+#include -+#include -+#include -+#include -+#endif -+static inline void fake_destructor(struct sk_buff *skb) -+{ -+} -+typedef int (*udp_tunnel_encap_rcv_t)(struct sock *sk, struct sk_buff *skb); -+struct udp_tunnel_sock_cfg { -+ void *sk_user_data; -+ __u8 encap_type; -+ udp_tunnel_encap_rcv_t encap_rcv; -+}; -+/* This is global so, uh, only one real call site... This is the kind of horrific hack you'd expect to see in compat code. */ -+static udp_tunnel_encap_rcv_t encap_rcv = NULL; -+static void our_sk_data_ready(struct sock *sk) -+{ -+ struct sk_buff *skb; -+ while ((skb = skb_dequeue(&sk->sk_receive_queue)) != NULL) { -+ skb_orphan(skb); -+ sk_mem_reclaim(sk); -+ encap_rcv(sk, skb); -+ } -+} -+static inline void setup_udp_tunnel_sock(struct net *net, struct socket *sock, -+ struct udp_tunnel_sock_cfg *cfg) -+{ -+ struct sock *sk = sock->sk; -+ inet_sk(sk)->mc_loop = 0; -+ encap_rcv = cfg->encap_rcv; -+ rcu_assign_sk_user_data(sk, cfg->sk_user_data); -+ sk->sk_data_ready = our_sk_data_ready; -+} -+static inline void udp_tunnel_sock_release(struct socket *sock) -+{ -+ rcu_assign_sk_user_data(sock->sk, NULL); -+ kernel_sock_shutdown(sock, SHUT_RDWR); -+ sk_release_kernel(sock->sk); -+} -+static inline int udp_tunnel_xmit_skb(struct socket *sock, struct rtable *rt, -+ struct sk_buff *skb, __be32 src, __be32 dst, -+ __u8 tos, __u8 ttl, __be16 df, __be16 src_port, -+ __be16 dst_port, bool xnet) -+{ -+ struct udphdr *uh; -+ __skb_push(skb, sizeof(*uh)); -+ skb_reset_transport_header(skb); -+ uh = udp_hdr(skb); -+ uh->dest = dst_port; -+ uh->source = src_port; -+ uh->len = htons(skb->len); -+ udp_set_csum(sock->sk->sk_no_check_tx, skb, src, dst, skb->len); -+ return iptunnel_xmit(sock->sk, rt, skb, src, dst, IPPROTO_UDP, -+ tos, ttl, df, xnet); -+} -+#if IS_ENABLED(CONFIG_IPV6) -+static inline int udp_tunnel6_xmit_skb(struct socket *sock, struct dst_entry *dst, -+ struct sk_buff *skb, struct net_device *dev, -+ struct in6_addr *saddr, struct in6_addr *daddr, -+ __u8 prio, __u8 ttl, __be16 src_port, -+ __be16 dst_port) -+{ -+ struct udphdr *uh; -+ struct ipv6hdr *ip6h; -+ struct sock *sk = sock->sk; -+ __skb_push(skb, sizeof(*uh)); -+ skb_reset_transport_header(skb); -+ uh = udp_hdr(skb); -+ uh->dest = dst_port; -+ uh->source = src_port; -+ uh->len = htons(skb->len); -+ memset(&(IPCB(skb)->opt), 0, sizeof(IPCB(skb)->opt)); -+ IPCB(skb)->flags &= ~(IPSKB_XFRM_TUNNEL_SIZE | IPSKB_XFRM_TRANSFORMED -+ | IPSKB_REROUTED); -+ skb_dst_set(skb, dst); -+ udp6_set_csum(udp_get_no_check6_tx(sk), skb, &inet6_sk(sk)->saddr, -+ &sk->sk_v6_daddr, skb->len); -+ __skb_push(skb, sizeof(*ip6h)); -+ skb_reset_network_header(skb); -+ ip6h = ipv6_hdr(skb); -+ ip6_flow_hdr(ip6h, prio, htonl(0)); -+ ip6h->payload_len = htons(skb->len); -+ ip6h->nexthdr = IPPROTO_UDP; -+ ip6h->hop_limit = ttl; -+ ip6h->daddr = *daddr; -+ ip6h->saddr = *saddr; -+ ip6tunnel_xmit(skb, dev); -+ return 0; -+} -+#endif -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 0, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0) -+#include -+#include -+#include -+#include -+#include -+#include -+#define udp_tunnel_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) do { struct net_device *dev__ = (c)->dev; int ret__; ret__ = udp_tunnel_xmit_skb((b)->sk_socket, a, c, d, e, f, g, h, i, j, k); if (ret__) iptunnel_xmit_stats(ret__ - 8, &dev__->stats, dev__->tstats); } while (0) -+#if IS_ENABLED(CONFIG_IPV6) -+#define udp_tunnel6_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) udp_tunnel6_xmit_skb((b)->sk_socket, a, c, d, e, f, g, h, j, k); -+#endif -+#elif LINUX_VERSION_CODE < KERNEL_VERSION(4, 1, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0) -+#include -+#include -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 18, 0) -+static inline void fake_destructor(struct sk_buff *skb) -+{ -+} -+#endif -+#define udp_tunnel_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) do { struct net_device *dev__ = (c)->dev; int ret__; if (!(c)->destructor) (c)->destructor = fake_destructor; if (!(c)->sk) (c)->sk = (b); ret__ = udp_tunnel_xmit_skb(a, c, d, e, f, g, h, i, j, k, l); if (ret__) iptunnel_xmit_stats(ret__ - 8, &dev__->stats, dev__->tstats); } while (0) -+#if IS_ENABLED(CONFIG_IPV6) -+#define udp_tunnel6_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) do { if (!(c)->destructor) (c)->destructor = fake_destructor; if (!(c)->sk) (c)->sk = (b); udp_tunnel6_xmit_skb(a, c, d, e, f, g, h, j, k, l); } while(0) -+#endif -+#else -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0) -+#include -+#include -+#define udp_tunnel_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) do { struct net_device *dev__ = (c)->dev; int ret__ = udp_tunnel_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l); if (ret__) iptunnel_xmit_stats(ret__ - 8, &dev__->stats, dev__->tstats); } while (0) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 5, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 3, 0) -+#include -+#include -+#define udp_tunnel_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) do { struct net_device *dev__ = (c)->dev; int ret__ = udp_tunnel_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l); iptunnel_xmit_stats(ret__, &dev__->stats, dev__->tstats); } while (0) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 6, 0) && IS_ENABLED(CONFIG_IPV6) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0) -+#include -+#include -+#define udp_tunnel6_xmit_skb(a, b, c, d, e, f, g, h, i, j, k, l) udp_tunnel6_xmit_skb(a, b, c, d, e, f, g, h, j, k, l) -+#endif -+ -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0) -+#include -+#include -+#include -+struct udp_port_cfg_new { -+ u8 family; -+ union { -+ struct in_addr local_ip; -+#if IS_ENABLED(CONFIG_IPV6) -+ struct in6_addr local_ip6; -+#endif -+ }; -+ union { -+ struct in_addr peer_ip; -+#if IS_ENABLED(CONFIG_IPV6) -+ struct in6_addr peer_ip6; -+#endif -+ }; -+ __be16 local_udp_port; -+ __be16 peer_udp_port; -+ unsigned int use_udp_checksums:1, use_udp6_tx_checksums:1, use_udp6_rx_checksums:1, ipv6_v6only:1; -+}; -+static inline int __maybe_unused udp_sock_create_new(struct net *net, struct udp_port_cfg_new *cfg, struct socket **sockp) -+{ -+ struct udp_port_cfg old_cfg = { -+ .family = cfg->family, -+ .local_ip = cfg->local_ip, -+#if IS_ENABLED(CONFIG_IPV6) -+ .local_ip6 = cfg->local_ip6, -+#endif -+ .peer_ip = cfg->peer_ip, -+#if IS_ENABLED(CONFIG_IPV6) -+ .peer_ip6 = cfg->peer_ip6, -+#endif -+ .local_udp_port = cfg->local_udp_port, -+ .peer_udp_port = cfg->peer_udp_port, -+ .use_udp_checksums = cfg->use_udp_checksums, -+ .use_udp6_tx_checksums = cfg->use_udp6_tx_checksums, -+ .use_udp6_rx_checksums = cfg->use_udp6_rx_checksums -+ }; -+ if (cfg->family == AF_INET) -+ return udp_sock_create4(net, &old_cfg, sockp); -+ -+#if IS_ENABLED(CONFIG_IPV6) -+ if (cfg->family == AF_INET6) { -+ int ret; -+ int old_bindv6only; -+ struct net *nobns; -+ -+ if (cfg->ipv6_v6only) { -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0) -+ nobns = &init_net; -+#else -+ nobns = net; -+#endif -+ /* Since udp_port_cfg only learned of ipv6_v6only in 4.3, we do this horrible -+ * hack here and set the sysctl variable temporarily to something that will -+ * set the right option for us in sock_create. It's super racey! */ -+ old_bindv6only = nobns->ipv6.sysctl.bindv6only; -+ nobns->ipv6.sysctl.bindv6only = 1; -+ } -+ ret = udp_sock_create6(net, &old_cfg, sockp); -+ if (cfg->ipv6_v6only) -+ nobns->ipv6.sysctl.bindv6only = old_bindv6only; -+ return ret; -+ } -+#endif -+ return -EPFNOSUPPORT; -+} -+#define udp_port_cfg udp_port_cfg_new -+#define udp_sock_create(a, b, c) udp_sock_create_new(a, b, c) -+#endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/udp_tunnel/include/net/udp_tunnel.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,94 @@ -+#ifndef _WG_NET_UDP_TUNNEL_H -+#define _WG_NET_UDP_TUNNEL_H -+ -+#include -+#include -+ -+#if IS_ENABLED(CONFIG_IPV6) -+#include -+#include -+#endif -+ -+struct udp_port_cfg { -+ u8 family; -+ -+ /* Used only for kernel-created sockets */ -+ union { -+ struct in_addr local_ip; -+#if IS_ENABLED(CONFIG_IPV6) -+ struct in6_addr local_ip6; -+#endif -+ }; -+ -+ union { -+ struct in_addr peer_ip; -+#if IS_ENABLED(CONFIG_IPV6) -+ struct in6_addr peer_ip6; -+#endif -+ }; -+ -+ __be16 local_udp_port; -+ __be16 peer_udp_port; -+ unsigned int use_udp_checksums:1, -+ use_udp6_tx_checksums:1, -+ use_udp6_rx_checksums:1, -+ ipv6_v6only:1; -+}; -+ -+int udp_sock_create4(struct net *net, struct udp_port_cfg *cfg, -+ struct socket **sockp); -+ -+#if IS_ENABLED(CONFIG_IPV6) -+int udp_sock_create6(struct net *net, struct udp_port_cfg *cfg, -+ struct socket **sockp); -+#else -+static inline int udp_sock_create6(struct net *net, struct udp_port_cfg *cfg, -+ struct socket **sockp) -+{ -+ return 0; -+} -+#endif -+ -+static inline int udp_sock_create(struct net *net, -+ struct udp_port_cfg *cfg, -+ struct socket **sockp) -+{ -+ if (cfg->family == AF_INET) -+ return udp_sock_create4(net, cfg, sockp); -+ -+ if (cfg->family == AF_INET6) -+ return udp_sock_create6(net, cfg, sockp); -+ -+ return -EPFNOSUPPORT; -+} -+ -+typedef int (*udp_tunnel_encap_rcv_t)(struct sock *sk, struct sk_buff *skb); -+ -+struct udp_tunnel_sock_cfg { -+ void *sk_user_data; -+ __u8 encap_type; -+ udp_tunnel_encap_rcv_t encap_rcv; -+}; -+ -+/* Setup the given (UDP) sock to receive UDP encapsulated packets */ -+void setup_udp_tunnel_sock(struct net *net, struct socket *sock, -+ struct udp_tunnel_sock_cfg *sock_cfg); -+ -+/* Transmit the skb using UDP encapsulation. */ -+void udp_tunnel_xmit_skb(struct rtable *rt, struct sock *sk, struct sk_buff *skb, -+ __be32 src, __be32 dst, __u8 tos, __u8 ttl, -+ __be16 df, __be16 src_port, __be16 dst_port, -+ bool xnet, bool nocheck); -+ -+#if IS_ENABLED(CONFIG_IPV6) -+int udp_tunnel6_xmit_skb(struct dst_entry *dst, struct sock *sk, -+ struct sk_buff *skb, -+ struct net_device *dev, struct in6_addr *saddr, -+ struct in6_addr *daddr, -+ __u8 prio, __u8 ttl, __be32 label, -+ __be16 src_port, __be16 dst_port, bool nocheck); -+#endif -+ -+void udp_tunnel_sock_release(struct socket *sock); -+ -+#endif /* _WG_NET_UDP_TUNNEL_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/udp_tunnel/udp_tunnel.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,385 @@ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0) -+#define __sk_user_data(sk) ((*((void __rcu **)&(sk)->sk_user_data))) -+#define rcu_dereference_sk_user_data(sk) rcu_dereference(__sk_user_data((sk))) -+#define rcu_assign_sk_user_data(sk, ptr) rcu_assign_pointer(__sk_user_data((sk)), ptr) -+#endif -+ -+/* This is global so, uh, only one real call site... This is the kind of horrific hack you'd expect to see in compat code. */ -+static udp_tunnel_encap_rcv_t encap_rcv = NULL; -+static void our_sk_data_ready(struct sock *sk -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0) -+ ,int unused_vulnerable_length_param -+#endif -+ ) -+{ -+ struct sk_buff *skb; -+ while ((skb = skb_dequeue(&sk->sk_receive_queue)) != NULL) { -+ skb_orphan(skb); -+ sk_mem_reclaim(sk); -+ encap_rcv(sk, skb); -+ } -+} -+ -+int udp_sock_create4(struct net *net, struct udp_port_cfg *cfg, -+ struct socket **sockp) -+{ -+ int err; -+ struct socket *sock = NULL; -+ struct sockaddr_in udp_addr; -+ -+ err = __sock_create(net, AF_INET, SOCK_DGRAM, 0, &sock, 1); -+ if (err < 0) -+ goto error; -+ -+ udp_addr.sin_family = AF_INET; -+ udp_addr.sin_addr = cfg->local_ip; -+ udp_addr.sin_port = cfg->local_udp_port; -+ err = kernel_bind(sock, (struct sockaddr *)&udp_addr, -+ sizeof(udp_addr)); -+ if (err < 0) -+ goto error; -+ -+ if (cfg->peer_udp_port) { -+ udp_addr.sin_family = AF_INET; -+ udp_addr.sin_addr = cfg->peer_ip; -+ udp_addr.sin_port = cfg->peer_udp_port; -+ err = kernel_connect(sock, (struct sockaddr *)&udp_addr, -+ sizeof(udp_addr), 0); -+ if (err < 0) -+ goto error; -+ } -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0) -+ sock->sk->sk_no_check = !cfg->use_udp_checksums; -+#else -+ sock->sk->sk_no_check_tx = !cfg->use_udp_checksums; -+#endif -+ -+ *sockp = sock; -+ return 0; -+ -+error: -+ if (sock) { -+ kernel_sock_shutdown(sock, SHUT_RDWR); -+ sock_release(sock); -+ } -+ *sockp = NULL; -+ return err; -+} -+ -+void setup_udp_tunnel_sock(struct net *net, struct socket *sock, -+ struct udp_tunnel_sock_cfg *cfg) -+{ -+ inet_sk(sock->sk)->mc_loop = 0; -+ encap_rcv = cfg->encap_rcv; -+ rcu_assign_sk_user_data(sock->sk, cfg->sk_user_data); -+ sock->sk->sk_data_ready = our_sk_data_ready; -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0) -+static inline __sum16 udp_v4_check(int len, __be32 saddr, -+ __be32 daddr, __wsum base) -+{ -+ return csum_tcpudp_magic(saddr, daddr, len, IPPROTO_UDP, base); -+} -+ -+static void udp_set_csum(bool nocheck, struct sk_buff *skb, -+ __be32 saddr, __be32 daddr, int len) -+{ -+ struct udphdr *uh = udp_hdr(skb); -+ -+ if (nocheck) -+ uh->check = 0; -+ else if (skb_is_gso(skb)) -+ uh->check = ~udp_v4_check(len, saddr, daddr, 0); -+ else if (skb_dst(skb) && skb_dst(skb)->dev && -+ (skb_dst(skb)->dev->features & NETIF_F_V4_CSUM)) { -+ -+ BUG_ON(skb->ip_summed == CHECKSUM_PARTIAL); -+ -+ skb->ip_summed = CHECKSUM_PARTIAL; -+ skb->csum_start = skb_transport_header(skb) - skb->head; -+ skb->csum_offset = offsetof(struct udphdr, check); -+ uh->check = ~udp_v4_check(len, saddr, daddr, 0); -+ } else { -+ __wsum csum; -+ -+ BUG_ON(skb->ip_summed == CHECKSUM_PARTIAL); -+ -+ uh->check = 0; -+ csum = skb_checksum(skb, 0, len, 0); -+ uh->check = udp_v4_check(len, saddr, daddr, csum); -+ if (uh->check == 0) -+ uh->check = CSUM_MANGLED_0; -+ -+ skb->ip_summed = CHECKSUM_UNNECESSARY; -+ } -+} -+ -+#endif -+ -+static void fake_destructor(struct sk_buff *skb) -+{ -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0) -+static void our_iptunnel_xmit(struct rtable *rt, struct sk_buff *skb, -+ __be32 src, __be32 dst, __u8 proto, -+ __u8 tos, __u8 ttl, __be16 df, bool xnet) -+{ -+ struct iphdr *iph; -+ struct pcpu_tstats *tstats = this_cpu_ptr(skb->dev->tstats); -+ -+ skb_scrub_packet(skb, xnet); -+ -+ skb->rxhash = 0; -+ skb_dst_set(skb, &rt->dst); -+ memset(IPCB(skb), 0, sizeof(*IPCB(skb))); -+ -+ /* Push down and install the IP header. */ -+ skb_push(skb, sizeof(struct iphdr)); -+ skb_reset_network_header(skb); -+ -+ iph = ip_hdr(skb); -+ -+ iph->version = 4; -+ iph->ihl = sizeof(struct iphdr) >> 2; -+ iph->frag_off = df; -+ iph->protocol = proto; -+ iph->tos = tos; -+ iph->daddr = dst; -+ iph->saddr = src; -+ iph->ttl = ttl; -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 53) -+ __ip_select_ident(iph, &rt->dst, (skb_shinfo(skb)->gso_segs ?: 1) - 1); -+#else -+ __ip_select_ident(iph, skb_shinfo(skb)->gso_segs ?: 1); -+#endif -+ -+ iptunnel_xmit(skb, skb->dev); -+ u64_stats_update_begin(&tstats->syncp); -+ tstats->tx_bytes -= 8; -+ u64_stats_update_end(&tstats->syncp); -+} -+#define iptunnel_xmit our_iptunnel_xmit -+#endif -+ -+void udp_tunnel_xmit_skb(struct rtable *rt, struct sock *sk, struct sk_buff *skb, -+ __be32 src, __be32 dst, __u8 tos, __u8 ttl, -+ __be16 df, __be16 src_port, __be16 dst_port, -+ bool xnet, bool nocheck) -+{ -+ struct udphdr *uh; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 12, 0) -+ struct net_device *dev = skb->dev; -+ int ret; -+#endif -+ -+ __skb_push(skb, sizeof(*uh)); -+ skb_reset_transport_header(skb); -+ uh = udp_hdr(skb); -+ -+ uh->dest = dst_port; -+ uh->source = src_port; -+ uh->len = htons(skb->len); -+ -+ memset(&(IPCB(skb)->opt), 0, sizeof(IPCB(skb)->opt)); -+ -+ udp_set_csum(nocheck, skb, src, dst, skb->len); -+ -+ if (!skb->sk) -+ skb->sk = sk; -+ if (!skb->destructor) -+ skb->destructor = fake_destructor; -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 12, 0) -+ ret = -+#endif -+ iptunnel_xmit( -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0) -+ sk, -+#endif -+ rt, skb, src, dst, IPPROTO_UDP, tos, ttl, df, xnet); -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 12, 0) -+ if (ret) -+ iptunnel_xmit_stats(ret - 8, &dev->stats, dev->tstats); -+#endif -+} -+ -+void udp_tunnel_sock_release(struct socket *sock) -+{ -+ rcu_assign_sk_user_data(sock->sk, NULL); -+ kernel_sock_shutdown(sock, SHUT_RDWR); -+ sock_release(sock); -+} -+ -+#if IS_ENABLED(CONFIG_IPV6) -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+int udp_sock_create6(struct net *net, struct udp_port_cfg *cfg, -+ struct socket **sockp) -+{ -+ struct sockaddr_in6 udp6_addr; -+ int err; -+ struct socket *sock = NULL; -+ -+ err = __sock_create(net, AF_INET6, SOCK_DGRAM, 0, &sock, 1); -+ if (err < 0) -+ goto error; -+ -+ if (cfg->ipv6_v6only) { -+ int val = 1; -+ -+ err = kernel_setsockopt(sock, IPPROTO_IPV6, IPV6_V6ONLY, -+ (char *) &val, sizeof(val)); -+ if (err < 0) -+ goto error; -+ } -+ -+ udp6_addr.sin6_family = AF_INET6; -+ memcpy(&udp6_addr.sin6_addr, &cfg->local_ip6, -+ sizeof(udp6_addr.sin6_addr)); -+ udp6_addr.sin6_port = cfg->local_udp_port; -+ err = kernel_bind(sock, (struct sockaddr *)&udp6_addr, -+ sizeof(udp6_addr)); -+ if (err < 0) -+ goto error; -+ -+ if (cfg->peer_udp_port) { -+ udp6_addr.sin6_family = AF_INET6; -+ memcpy(&udp6_addr.sin6_addr, &cfg->peer_ip6, -+ sizeof(udp6_addr.sin6_addr)); -+ udp6_addr.sin6_port = cfg->peer_udp_port; -+ err = kernel_connect(sock, -+ (struct sockaddr *)&udp6_addr, -+ sizeof(udp6_addr), 0); -+ } -+ if (err < 0) -+ goto error; -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0) -+ sock->sk->sk_no_check = !cfg->use_udp_checksums; -+#else -+ udp_set_no_check6_tx(sock->sk, !cfg->use_udp6_tx_checksums); -+ udp_set_no_check6_rx(sock->sk, !cfg->use_udp6_rx_checksums); -+#endif -+ -+ *sockp = sock; -+ return 0; -+ -+error: -+ if (sock) { -+ kernel_sock_shutdown(sock, SHUT_RDWR); -+ sock_release(sock); -+ } -+ *sockp = NULL; -+ return err; -+} -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0) -+static inline __sum16 udp_v6_check(int len, -+ const struct in6_addr *saddr, -+ const struct in6_addr *daddr, -+ __wsum base) -+{ -+ return csum_ipv6_magic(saddr, daddr, len, IPPROTO_UDP, base); -+} -+static void udp6_set_csum(bool nocheck, struct sk_buff *skb, -+ const struct in6_addr *saddr, -+ const struct in6_addr *daddr, int len) -+{ -+ struct udphdr *uh = udp_hdr(skb); -+ -+ if (nocheck) -+ uh->check = 0; -+ else if (skb_is_gso(skb)) -+ uh->check = ~udp_v6_check(len, saddr, daddr, 0); -+ else if (skb_dst(skb) && skb_dst(skb)->dev && -+ (skb_dst(skb)->dev->features & NETIF_F_IPV6_CSUM)) { -+ -+ BUG_ON(skb->ip_summed == CHECKSUM_PARTIAL); -+ -+ skb->ip_summed = CHECKSUM_PARTIAL; -+ skb->csum_start = skb_transport_header(skb) - skb->head; -+ skb->csum_offset = offsetof(struct udphdr, check); -+ uh->check = ~udp_v6_check(len, saddr, daddr, 0); -+ } else { -+ __wsum csum; -+ -+ BUG_ON(skb->ip_summed == CHECKSUM_PARTIAL); -+ -+ uh->check = 0; -+ csum = skb_checksum(skb, 0, len, 0); -+ uh->check = udp_v6_check(len, saddr, daddr, csum); -+ if (uh->check == 0) -+ uh->check = CSUM_MANGLED_0; -+ -+ skb->ip_summed = CHECKSUM_UNNECESSARY; -+ } -+} -+#endif -+ -+int udp_tunnel6_xmit_skb(struct dst_entry *dst, struct sock *sk, -+ struct sk_buff *skb, -+ struct net_device *dev, struct in6_addr *saddr, -+ struct in6_addr *daddr, -+ __u8 prio, __u8 ttl, __be32 label, -+ __be16 src_port, __be16 dst_port, bool nocheck) -+{ -+ struct udphdr *uh; -+ struct ipv6hdr *ip6h; -+ -+ __skb_push(skb, sizeof(*uh)); -+ skb_reset_transport_header(skb); -+ uh = udp_hdr(skb); -+ -+ uh->dest = dst_port; -+ uh->source = src_port; -+ -+ uh->len = htons(skb->len); -+ -+ skb_dst_set(skb, dst); -+ -+ udp6_set_csum(nocheck, skb, saddr, daddr, skb->len); -+ -+ __skb_push(skb, sizeof(*ip6h)); -+ skb_reset_network_header(skb); -+ ip6h = ipv6_hdr(skb); -+ ip6_flow_hdr(ip6h, prio, label); -+ ip6h->payload_len = htons(skb->len); -+ ip6h->nexthdr = IPPROTO_UDP; -+ ip6h->hop_limit = ttl; -+ ip6h->daddr = *daddr; -+ ip6h->saddr = *saddr; -+ -+ if (!skb->sk) -+ skb->sk = sk; -+ if (!skb->destructor) -+ skb->destructor = fake_destructor; -+ -+ ip6tunnel_xmit(skb, dev); -+ return 0; -+} -+#endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/fpu/include/asm/fpu/api.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1 @@ -+#include ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/checksum/checksum_partial_compat.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,208 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+ -+#define IP6_MF 0x0001 -+#define IP6_OFFSET 0xFFF8 -+static inline int skb_maybe_pull_tail(struct sk_buff *skb, unsigned int len, unsigned int max) -+{ -+ if (skb_headlen(skb) >= len) -+ return 0; -+ if (max > skb->len) -+ max = skb->len; -+ if (__pskb_pull_tail(skb, max - skb_headlen(skb)) == NULL) -+ return -ENOMEM; -+ if (skb_headlen(skb) < len) -+ return -EPROTO; -+ return 0; -+} -+#define MAX_IP_HDR_LEN 128 -+static inline int skb_checksum_setup_ip(struct sk_buff *skb, bool recalculate) -+{ -+ unsigned int off; -+ bool fragment; -+ int err; -+ fragment = false; -+ err = skb_maybe_pull_tail(skb, sizeof(struct iphdr), MAX_IP_HDR_LEN); -+ if (err < 0) -+ goto out; -+ if (ip_hdr(skb)->frag_off & htons(IP_OFFSET | IP_MF)) -+ fragment = true; -+ off = ip_hdrlen(skb); -+ err = -EPROTO; -+ if (fragment) -+ goto out; -+ switch (ip_hdr(skb)->protocol) { -+ case IPPROTO_TCP: -+ err = skb_maybe_pull_tail(skb, -+ off + sizeof(struct tcphdr), -+ MAX_IP_HDR_LEN); -+ if (err < 0) -+ goto out; -+ -+ if (!skb_partial_csum_set(skb, off, -+ offsetof(struct tcphdr, check))) { -+ err = -EPROTO; -+ goto out; -+ } -+ -+ if (recalculate) -+ tcp_hdr(skb)->check = -+ ~csum_tcpudp_magic(ip_hdr(skb)->saddr, -+ ip_hdr(skb)->daddr, -+ skb->len - off, -+ IPPROTO_TCP, 0); -+ break; -+ case IPPROTO_UDP: -+ err = skb_maybe_pull_tail(skb, -+ off + sizeof(struct udphdr), -+ MAX_IP_HDR_LEN); -+ if (err < 0) -+ goto out; -+ -+ if (!skb_partial_csum_set(skb, off, -+ offsetof(struct udphdr, check))) { -+ err = -EPROTO; -+ goto out; -+ } -+ -+ if (recalculate) -+ udp_hdr(skb)->check = -+ ~csum_tcpudp_magic(ip_hdr(skb)->saddr, -+ ip_hdr(skb)->daddr, -+ skb->len - off, -+ IPPROTO_UDP, 0); -+ break; -+ default: -+ goto out; -+ } -+ err = 0; -+out: -+ return err; -+} -+#define MAX_IPV6_HDR_LEN 256 -+#define OPT_HDR(type, skb, off) \ -+ (type *)(skb_network_header(skb) + (off)) -+static inline int skb_checksum_setup_ipv6(struct sk_buff *skb, bool recalculate) -+{ -+ int err; -+ u8 nexthdr; -+ unsigned int off; -+ unsigned int len; -+ bool fragment; -+ bool done; -+ fragment = false; -+ done = false; -+ off = sizeof(struct ipv6hdr); -+ err = skb_maybe_pull_tail(skb, off, MAX_IPV6_HDR_LEN); -+ if (err < 0) -+ goto out; -+ nexthdr = ipv6_hdr(skb)->nexthdr; -+ len = sizeof(struct ipv6hdr) + ntohs(ipv6_hdr(skb)->payload_len); -+ while (off <= len && !done) { -+ switch (nexthdr) { -+ case IPPROTO_DSTOPTS: -+ case IPPROTO_HOPOPTS: -+ case IPPROTO_ROUTING: { -+ struct ipv6_opt_hdr *hp; -+ -+ err = skb_maybe_pull_tail(skb, off + sizeof(struct ipv6_opt_hdr), MAX_IPV6_HDR_LEN); -+ if (err < 0) -+ goto out; -+ hp = OPT_HDR(struct ipv6_opt_hdr, skb, off); -+ nexthdr = hp->nexthdr; -+ off += ipv6_optlen(hp); -+ break; -+ } -+ case IPPROTO_FRAGMENT: { -+ struct frag_hdr *hp; -+ err = skb_maybe_pull_tail(skb, off + sizeof(struct frag_hdr), MAX_IPV6_HDR_LEN); -+ if (err < 0) -+ goto out; -+ hp = OPT_HDR(struct frag_hdr, skb, off); -+ if (hp->frag_off & htons(IP6_OFFSET | IP6_MF)) -+ fragment = true; -+ nexthdr = hp->nexthdr; -+ off += sizeof(struct frag_hdr); -+ break; -+ } -+ default: -+ done = true; -+ break; -+ } -+ } -+ err = -EPROTO; -+ if (!done || fragment) -+ goto out; -+ switch (nexthdr) { -+ case IPPROTO_TCP: -+ err = skb_maybe_pull_tail(skb, -+ off + sizeof(struct tcphdr), -+ MAX_IPV6_HDR_LEN); -+ if (err < 0) -+ goto out; -+ -+ if (!skb_partial_csum_set(skb, off, -+ offsetof(struct tcphdr, check))) { -+ err = -EPROTO; -+ goto out; -+ } -+ -+ if (recalculate) -+ tcp_hdr(skb)->check = -+ ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr, -+ &ipv6_hdr(skb)->daddr, -+ skb->len - off, -+ IPPROTO_TCP, 0); -+ break; -+ case IPPROTO_UDP: -+ err = skb_maybe_pull_tail(skb, -+ off + sizeof(struct udphdr), -+ MAX_IPV6_HDR_LEN); -+ if (err < 0) -+ goto out; -+ -+ if (!skb_partial_csum_set(skb, off, -+ offsetof(struct udphdr, check))) { -+ err = -EPROTO; -+ goto out; -+ } -+ -+ if (recalculate) -+ udp_hdr(skb)->check = -+ ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr, -+ &ipv6_hdr(skb)->daddr, -+ skb->len - off, -+ IPPROTO_UDP, 0); -+ break; -+ default: -+ goto out; -+ } -+ err = 0; -+out: -+ return err; -+} -+static inline int skb_checksum_setup(struct sk_buff *skb, bool recalculate) -+{ -+ int err; -+ switch (skb->protocol) { -+ case htons(ETH_P_IP): -+ err = skb_checksum_setup_ip(skb, recalculate); -+ break; -+ -+ case htons(ETH_P_IPV6): -+ err = skb_checksum_setup_ipv6(skb, recalculate); -+ break; -+ default: -+ err = -EPROTO; -+ break; -+ } -+ return err; -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/Makefile.include 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,71 @@ -+# SPDX-License-Identifier: GPL-2.0 -+# -+# Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ -+ifeq ($(wildcard $(src)/compat/compat.h),) -+cmd_include_path_prefix := $(srctree)/$(src) -+else -+cmd_include_path_prefix := $(src) -+endif -+ -+ccflags-y += -include $(cmd_include_path_prefix)/compat/compat.h -+asflags-y += -include $(cmd_include_path_prefix)/compat/compat-asm.h -+ -+ifeq ($(wildcard $(srctree)/include/linux/ptr_ring.h),) -+ccflags-y += -I$(src)/compat/ptr_ring/include -+endif -+ -+ifeq ($(wildcard $(srctree)/include/linux/siphash.h),) -+ccflags-y += -I$(src)/compat/siphash/include -+wireguard-y += compat/siphash/siphash.o -+endif -+ -+ifeq ($(wildcard $(srctree)/include/net/dst_cache.h),) -+ccflags-y += -I$(src)/compat/dst_cache/include -+wireguard-y += compat/dst_cache/dst_cache.o -+endif -+ -+ifeq ($(wildcard $(srctree)/arch/x86/include/asm/intel-family.h),) -+ccflags-y += -I$(src)/compat/intel-family/include -+endif -+ -+ifeq ($(wildcard $(srctree)/arch/x86/include/asm/fpu/api.h),) -+ccflags-y += -I$(src)/compat/fpu/include -+endif -+ -+ifeq ($(wildcard $(srctree)/arch/x86/include/asm/simd.h),) -+ccflags-y += -I$(src)/compat/simd/include -+endif -+ -+ifeq ($(wildcard $(srctree)/include/net/udp_tunnel.h),) -+ccflags-y += -I$(src)/compat/udp_tunnel/include -+wireguard-y += compat/udp_tunnel/udp_tunnel.o -+endif -+ -+ifeq ($(shell grep -F "int crypto_memneq" "$(srctree)/include/crypto/algapi.h"),) -+ccflags-y += -include $(cmd_include_path_prefix)/compat/memneq/include.h -+wireguard-y += compat/memneq/memneq.o -+endif -+ -+ifeq ($(CONFIG_X86_64),y) -+ ifeq ($(ssse3_instr),) -+ ssse3_instr := $(call as-instr,pshufb %xmm0$(comma)%xmm0,-DCONFIG_AS_SSSE3=1) -+ ccflags-y += $(ssse3_instr) -+ asflags-y += $(ssse3_instr) -+ endif -+ ifeq ($(avx_instr),) -+ avx_instr := $(call as-instr,vxorps %ymm0$(comma)%ymm1$(comma)%ymm2,-DCONFIG_AS_AVX=1) -+ ccflags-y += $(avx_instr) -+ asflags-y += $(avx_instr) -+ endif -+ ifeq ($(avx2_instr),) -+ avx2_instr := $(call as-instr,vpbroadcastb %xmm0$(comma)%ymm1,-DCONFIG_AS_AVX2=1) -+ ccflags-y += $(avx2_instr) -+ asflags-y += $(avx2_instr) -+ endif -+ ifeq ($(avx512_instr),) -+ avx512_instr := $(call as-instr,vpmovm2b %k1$(comma)%zmm5,-DCONFIG_AS_AVX512=1) -+ ccflags-y += $(avx512_instr) -+ asflags-y += $(avx512_instr) -+ endif -+endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/siphash/siphash.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,539 @@ -+/* Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * -+ * This file is provided under a dual BSD/GPLv2 license. -+ * -+ * SipHash: a fast short-input PRF -+ * https://131002.net/siphash/ -+ * -+ * This implementation is specifically for SipHash2-4 for a secure PRF -+ * and HalfSipHash1-3/SipHash1-3 for an insecure PRF only suitable for -+ * hashtables. -+ */ -+ -+#include -+#include -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0) -+#ifdef __LITTLE_ENDIAN -+#define bytemask_from_count(cnt) (~(~0ul << (cnt)*8)) -+#else -+#define bytemask_from_count(cnt) (~(~0ul >> (cnt)*8)) -+#endif -+#endif -+ -+#if defined(CONFIG_DCACHE_WORD_ACCESS) && BITS_PER_LONG == 64 -+#include -+#include -+#endif -+ -+#define SIPROUND \ -+ do { \ -+ v0 += v1; v1 = rol64(v1, 13); v1 ^= v0; v0 = rol64(v0, 32); \ -+ v2 += v3; v3 = rol64(v3, 16); v3 ^= v2; \ -+ v0 += v3; v3 = rol64(v3, 21); v3 ^= v0; \ -+ v2 += v1; v1 = rol64(v1, 17); v1 ^= v2; v2 = rol64(v2, 32); \ -+ } while (0) -+ -+#define PREAMBLE(len) \ -+ u64 v0 = 0x736f6d6570736575ULL; \ -+ u64 v1 = 0x646f72616e646f6dULL; \ -+ u64 v2 = 0x6c7967656e657261ULL; \ -+ u64 v3 = 0x7465646279746573ULL; \ -+ u64 b = ((u64)(len)) << 56; \ -+ v3 ^= key->key[1]; \ -+ v2 ^= key->key[0]; \ -+ v1 ^= key->key[1]; \ -+ v0 ^= key->key[0]; -+ -+#define POSTAMBLE \ -+ v3 ^= b; \ -+ SIPROUND; \ -+ SIPROUND; \ -+ v0 ^= b; \ -+ v2 ^= 0xff; \ -+ SIPROUND; \ -+ SIPROUND; \ -+ SIPROUND; \ -+ SIPROUND; \ -+ return (v0 ^ v1) ^ (v2 ^ v3); -+ -+u64 __siphash_aligned(const void *data, size_t len, const siphash_key_t *key) -+{ -+ const u8 *end = data + len - (len % sizeof(u64)); -+ const u8 left = len & (sizeof(u64) - 1); -+ u64 m; -+ PREAMBLE(len) -+ for (; data != end; data += sizeof(u64)) { -+ m = le64_to_cpup(data); -+ v3 ^= m; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= m; -+ } -+#if defined(CONFIG_DCACHE_WORD_ACCESS) && BITS_PER_LONG == 64 -+ if (left) -+ b |= le64_to_cpu((__force __le64)(load_unaligned_zeropad(data) & -+ bytemask_from_count(left))); -+#else -+ switch (left) { -+ case 7: b |= ((u64)end[6]) << 48; -+ case 6: b |= ((u64)end[5]) << 40; -+ case 5: b |= ((u64)end[4]) << 32; -+ case 4: b |= le32_to_cpup(data); break; -+ case 3: b |= ((u64)end[2]) << 16; -+ case 2: b |= le16_to_cpup(data); break; -+ case 1: b |= end[0]; -+ } -+#endif -+ POSTAMBLE -+} -+ -+#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS -+u64 __siphash_unaligned(const void *data, size_t len, const siphash_key_t *key) -+{ -+ const u8 *end = data + len - (len % sizeof(u64)); -+ const u8 left = len & (sizeof(u64) - 1); -+ u64 m; -+ PREAMBLE(len) -+ for (; data != end; data += sizeof(u64)) { -+ m = get_unaligned_le64(data); -+ v3 ^= m; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= m; -+ } -+#if defined(CONFIG_DCACHE_WORD_ACCESS) && BITS_PER_LONG == 64 -+ if (left) -+ b |= le64_to_cpu((__force __le64)(load_unaligned_zeropad(data) & -+ bytemask_from_count(left))); -+#else -+ switch (left) { -+ case 7: b |= ((u64)end[6]) << 48; -+ case 6: b |= ((u64)end[5]) << 40; -+ case 5: b |= ((u64)end[4]) << 32; -+ case 4: b |= get_unaligned_le32(end); break; -+ case 3: b |= ((u64)end[2]) << 16; -+ case 2: b |= get_unaligned_le16(end); break; -+ case 1: b |= end[0]; -+ } -+#endif -+ POSTAMBLE -+} -+#endif -+ -+/** -+ * siphash_1u64 - compute 64-bit siphash PRF value of a u64 -+ * @first: first u64 -+ * @key: the siphash key -+ */ -+u64 siphash_1u64(const u64 first, const siphash_key_t *key) -+{ -+ PREAMBLE(8) -+ v3 ^= first; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= first; -+ POSTAMBLE -+} -+ -+/** -+ * siphash_2u64 - compute 64-bit siphash PRF value of 2 u64 -+ * @first: first u64 -+ * @second: second u64 -+ * @key: the siphash key -+ */ -+u64 siphash_2u64(const u64 first, const u64 second, const siphash_key_t *key) -+{ -+ PREAMBLE(16) -+ v3 ^= first; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= first; -+ v3 ^= second; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= second; -+ POSTAMBLE -+} -+ -+/** -+ * siphash_3u64 - compute 64-bit siphash PRF value of 3 u64 -+ * @first: first u64 -+ * @second: second u64 -+ * @third: third u64 -+ * @key: the siphash key -+ */ -+u64 siphash_3u64(const u64 first, const u64 second, const u64 third, -+ const siphash_key_t *key) -+{ -+ PREAMBLE(24) -+ v3 ^= first; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= first; -+ v3 ^= second; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= second; -+ v3 ^= third; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= third; -+ POSTAMBLE -+} -+ -+/** -+ * siphash_4u64 - compute 64-bit siphash PRF value of 4 u64 -+ * @first: first u64 -+ * @second: second u64 -+ * @third: third u64 -+ * @forth: forth u64 -+ * @key: the siphash key -+ */ -+u64 siphash_4u64(const u64 first, const u64 second, const u64 third, -+ const u64 forth, const siphash_key_t *key) -+{ -+ PREAMBLE(32) -+ v3 ^= first; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= first; -+ v3 ^= second; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= second; -+ v3 ^= third; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= third; -+ v3 ^= forth; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= forth; -+ POSTAMBLE -+} -+ -+u64 siphash_1u32(const u32 first, const siphash_key_t *key) -+{ -+ PREAMBLE(4) -+ b |= first; -+ POSTAMBLE -+} -+ -+u64 siphash_3u32(const u32 first, const u32 second, const u32 third, -+ const siphash_key_t *key) -+{ -+ u64 combined = (u64)second << 32 | first; -+ PREAMBLE(12) -+ v3 ^= combined; -+ SIPROUND; -+ SIPROUND; -+ v0 ^= combined; -+ b |= third; -+ POSTAMBLE -+} -+ -+#if BITS_PER_LONG == 64 -+/* Note that on 64-bit, we make HalfSipHash1-3 actually be SipHash1-3, for -+ * performance reasons. On 32-bit, below, we actually implement HalfSipHash1-3. -+ */ -+ -+#define HSIPROUND SIPROUND -+#define HPREAMBLE(len) PREAMBLE(len) -+#define HPOSTAMBLE \ -+ v3 ^= b; \ -+ HSIPROUND; \ -+ v0 ^= b; \ -+ v2 ^= 0xff; \ -+ HSIPROUND; \ -+ HSIPROUND; \ -+ HSIPROUND; \ -+ return (v0 ^ v1) ^ (v2 ^ v3); -+ -+u32 __hsiphash_aligned(const void *data, size_t len, const hsiphash_key_t *key) -+{ -+ const u8 *end = data + len - (len % sizeof(u64)); -+ const u8 left = len & (sizeof(u64) - 1); -+ u64 m; -+ HPREAMBLE(len) -+ for (; data != end; data += sizeof(u64)) { -+ m = le64_to_cpup(data); -+ v3 ^= m; -+ HSIPROUND; -+ v0 ^= m; -+ } -+#if defined(CONFIG_DCACHE_WORD_ACCESS) && BITS_PER_LONG == 64 -+ if (left) -+ b |= le64_to_cpu((__force __le64)(load_unaligned_zeropad(data) & -+ bytemask_from_count(left))); -+#else -+ switch (left) { -+ case 7: b |= ((u64)end[6]) << 48; -+ case 6: b |= ((u64)end[5]) << 40; -+ case 5: b |= ((u64)end[4]) << 32; -+ case 4: b |= le32_to_cpup(data); break; -+ case 3: b |= ((u64)end[2]) << 16; -+ case 2: b |= le16_to_cpup(data); break; -+ case 1: b |= end[0]; -+ } -+#endif -+ HPOSTAMBLE -+} -+ -+#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS -+u32 __hsiphash_unaligned(const void *data, size_t len, -+ const hsiphash_key_t *key) -+{ -+ const u8 *end = data + len - (len % sizeof(u64)); -+ const u8 left = len & (sizeof(u64) - 1); -+ u64 m; -+ HPREAMBLE(len) -+ for (; data != end; data += sizeof(u64)) { -+ m = get_unaligned_le64(data); -+ v3 ^= m; -+ HSIPROUND; -+ v0 ^= m; -+ } -+#if defined(CONFIG_DCACHE_WORD_ACCESS) && BITS_PER_LONG == 64 -+ if (left) -+ b |= le64_to_cpu((__force __le64)(load_unaligned_zeropad(data) & -+ bytemask_from_count(left))); -+#else -+ switch (left) { -+ case 7: b |= ((u64)end[6]) << 48; -+ case 6: b |= ((u64)end[5]) << 40; -+ case 5: b |= ((u64)end[4]) << 32; -+ case 4: b |= get_unaligned_le32(end); break; -+ case 3: b |= ((u64)end[2]) << 16; -+ case 2: b |= get_unaligned_le16(end); break; -+ case 1: b |= end[0]; -+ } -+#endif -+ HPOSTAMBLE -+} -+#endif -+ -+/** -+ * hsiphash_1u32 - compute 64-bit hsiphash PRF value of a u32 -+ * @first: first u32 -+ * @key: the hsiphash key -+ */ -+u32 hsiphash_1u32(const u32 first, const hsiphash_key_t *key) -+{ -+ HPREAMBLE(4) -+ b |= first; -+ HPOSTAMBLE -+} -+ -+/** -+ * hsiphash_2u32 - compute 32-bit hsiphash PRF value of 2 u32 -+ * @first: first u32 -+ * @second: second u32 -+ * @key: the hsiphash key -+ */ -+u32 hsiphash_2u32(const u32 first, const u32 second, const hsiphash_key_t *key) -+{ -+ u64 combined = (u64)second << 32 | first; -+ HPREAMBLE(8) -+ v3 ^= combined; -+ HSIPROUND; -+ v0 ^= combined; -+ HPOSTAMBLE -+} -+ -+/** -+ * hsiphash_3u32 - compute 32-bit hsiphash PRF value of 3 u32 -+ * @first: first u32 -+ * @second: second u32 -+ * @third: third u32 -+ * @key: the hsiphash key -+ */ -+u32 hsiphash_3u32(const u32 first, const u32 second, const u32 third, -+ const hsiphash_key_t *key) -+{ -+ u64 combined = (u64)second << 32 | first; -+ HPREAMBLE(12) -+ v3 ^= combined; -+ HSIPROUND; -+ v0 ^= combined; -+ b |= third; -+ HPOSTAMBLE -+} -+ -+/** -+ * hsiphash_4u32 - compute 32-bit hsiphash PRF value of 4 u32 -+ * @first: first u32 -+ * @second: second u32 -+ * @third: third u32 -+ * @forth: forth u32 -+ * @key: the hsiphash key -+ */ -+u32 hsiphash_4u32(const u32 first, const u32 second, const u32 third, -+ const u32 forth, const hsiphash_key_t *key) -+{ -+ u64 combined = (u64)second << 32 | first; -+ HPREAMBLE(16) -+ v3 ^= combined; -+ HSIPROUND; -+ v0 ^= combined; -+ combined = (u64)forth << 32 | third; -+ v3 ^= combined; -+ HSIPROUND; -+ v0 ^= combined; -+ HPOSTAMBLE -+} -+#else -+#define HSIPROUND \ -+ do { \ -+ v0 += v1; v1 = rol32(v1, 5); v1 ^= v0; v0 = rol32(v0, 16); \ -+ v2 += v3; v3 = rol32(v3, 8); v3 ^= v2; \ -+ v0 += v3; v3 = rol32(v3, 7); v3 ^= v0; \ -+ v2 += v1; v1 = rol32(v1, 13); v1 ^= v2; v2 = rol32(v2, 16); \ -+ } while (0) -+ -+#define HPREAMBLE(len) \ -+ u32 v0 = 0; \ -+ u32 v1 = 0; \ -+ u32 v2 = 0x6c796765U; \ -+ u32 v3 = 0x74656462U; \ -+ u32 b = ((u32)(len)) << 24; \ -+ v3 ^= key->key[1]; \ -+ v2 ^= key->key[0]; \ -+ v1 ^= key->key[1]; \ -+ v0 ^= key->key[0]; -+ -+#define HPOSTAMBLE \ -+ v3 ^= b; \ -+ HSIPROUND; \ -+ v0 ^= b; \ -+ v2 ^= 0xff; \ -+ HSIPROUND; \ -+ HSIPROUND; \ -+ HSIPROUND; \ -+ return v1 ^ v3; -+ -+u32 __hsiphash_aligned(const void *data, size_t len, const hsiphash_key_t *key) -+{ -+ const u8 *end = data + len - (len % sizeof(u32)); -+ const u8 left = len & (sizeof(u32) - 1); -+ u32 m; -+ HPREAMBLE(len) -+ for (; data != end; data += sizeof(u32)) { -+ m = le32_to_cpup(data); -+ v3 ^= m; -+ HSIPROUND; -+ v0 ^= m; -+ } -+ switch (left) { -+ case 3: b |= ((u32)end[2]) << 16; -+ case 2: b |= le16_to_cpup(data); break; -+ case 1: b |= end[0]; -+ } -+ HPOSTAMBLE -+} -+ -+#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS -+u32 __hsiphash_unaligned(const void *data, size_t len, -+ const hsiphash_key_t *key) -+{ -+ const u8 *end = data + len - (len % sizeof(u32)); -+ const u8 left = len & (sizeof(u32) - 1); -+ u32 m; -+ HPREAMBLE(len) -+ for (; data != end; data += sizeof(u32)) { -+ m = get_unaligned_le32(data); -+ v3 ^= m; -+ HSIPROUND; -+ v0 ^= m; -+ } -+ switch (left) { -+ case 3: b |= ((u32)end[2]) << 16; -+ case 2: b |= get_unaligned_le16(end); break; -+ case 1: b |= end[0]; -+ } -+ HPOSTAMBLE -+} -+#endif -+ -+/** -+ * hsiphash_1u32 - compute 32-bit hsiphash PRF value of a u32 -+ * @first: first u32 -+ * @key: the hsiphash key -+ */ -+u32 hsiphash_1u32(const u32 first, const hsiphash_key_t *key) -+{ -+ HPREAMBLE(4) -+ v3 ^= first; -+ HSIPROUND; -+ v0 ^= first; -+ HPOSTAMBLE -+} -+ -+/** -+ * hsiphash_2u32 - compute 32-bit hsiphash PRF value of 2 u32 -+ * @first: first u32 -+ * @second: second u32 -+ * @key: the hsiphash key -+ */ -+u32 hsiphash_2u32(const u32 first, const u32 second, const hsiphash_key_t *key) -+{ -+ HPREAMBLE(8) -+ v3 ^= first; -+ HSIPROUND; -+ v0 ^= first; -+ v3 ^= second; -+ HSIPROUND; -+ v0 ^= second; -+ HPOSTAMBLE -+} -+ -+/** -+ * hsiphash_3u32 - compute 32-bit hsiphash PRF value of 3 u32 -+ * @first: first u32 -+ * @second: second u32 -+ * @third: third u32 -+ * @key: the hsiphash key -+ */ -+u32 hsiphash_3u32(const u32 first, const u32 second, const u32 third, -+ const hsiphash_key_t *key) -+{ -+ HPREAMBLE(12) -+ v3 ^= first; -+ HSIPROUND; -+ v0 ^= first; -+ v3 ^= second; -+ HSIPROUND; -+ v0 ^= second; -+ v3 ^= third; -+ HSIPROUND; -+ v0 ^= third; -+ HPOSTAMBLE -+} -+ -+/** -+ * hsiphash_4u32 - compute 32-bit hsiphash PRF value of 4 u32 -+ * @first: first u32 -+ * @second: second u32 -+ * @third: third u32 -+ * @forth: forth u32 -+ * @key: the hsiphash key -+ */ -+u32 hsiphash_4u32(const u32 first, const u32 second, const u32 third, -+ const u32 forth, const hsiphash_key_t *key) -+{ -+ HPREAMBLE(16) -+ v3 ^= first; -+ HSIPROUND; -+ v0 ^= first; -+ v3 ^= second; -+ HSIPROUND; -+ v0 ^= second; -+ v3 ^= third; -+ HSIPROUND; -+ v0 ^= third; -+ v3 ^= forth; -+ HSIPROUND; -+ v0 ^= forth; -+ HPOSTAMBLE -+} -+#endif ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/siphash/include/linux/siphash.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,140 @@ -+/* Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ * -+ * This file is provided under a dual BSD/GPLv2 license. -+ * -+ * SipHash: a fast short-input PRF -+ * https://131002.net/siphash/ -+ * -+ * This implementation is specifically for SipHash2-4 for a secure PRF -+ * and HalfSipHash1-3/SipHash1-3 for an insecure PRF only suitable for -+ * hashtables. -+ */ -+ -+#ifndef _WG_LINUX_SIPHASH_H -+#define _WG_LINUX_SIPHASH_H -+ -+#include -+#include -+ -+#define SIPHASH_ALIGNMENT __alignof__(u64) -+typedef struct { -+ u64 key[2]; -+} siphash_key_t; -+ -+u64 __siphash_aligned(const void *data, size_t len, const siphash_key_t *key); -+#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS -+u64 __siphash_unaligned(const void *data, size_t len, const siphash_key_t *key); -+#endif -+ -+u64 siphash_1u64(const u64 a, const siphash_key_t *key); -+u64 siphash_2u64(const u64 a, const u64 b, const siphash_key_t *key); -+u64 siphash_3u64(const u64 a, const u64 b, const u64 c, -+ const siphash_key_t *key); -+u64 siphash_4u64(const u64 a, const u64 b, const u64 c, const u64 d, -+ const siphash_key_t *key); -+u64 siphash_1u32(const u32 a, const siphash_key_t *key); -+u64 siphash_3u32(const u32 a, const u32 b, const u32 c, -+ const siphash_key_t *key); -+ -+static inline u64 siphash_2u32(const u32 a, const u32 b, -+ const siphash_key_t *key) -+{ -+ return siphash_1u64((u64)b << 32 | a, key); -+} -+static inline u64 siphash_4u32(const u32 a, const u32 b, const u32 c, -+ const u32 d, const siphash_key_t *key) -+{ -+ return siphash_2u64((u64)b << 32 | a, (u64)d << 32 | c, key); -+} -+ -+ -+static inline u64 ___siphash_aligned(const __le64 *data, size_t len, -+ const siphash_key_t *key) -+{ -+ if (__builtin_constant_p(len) && len == 4) -+ return siphash_1u32(le32_to_cpup((const __le32 *)data), key); -+ if (__builtin_constant_p(len) && len == 8) -+ return siphash_1u64(le64_to_cpu(data[0]), key); -+ if (__builtin_constant_p(len) && len == 16) -+ return siphash_2u64(le64_to_cpu(data[0]), le64_to_cpu(data[1]), -+ key); -+ if (__builtin_constant_p(len) && len == 24) -+ return siphash_3u64(le64_to_cpu(data[0]), le64_to_cpu(data[1]), -+ le64_to_cpu(data[2]), key); -+ if (__builtin_constant_p(len) && len == 32) -+ return siphash_4u64(le64_to_cpu(data[0]), le64_to_cpu(data[1]), -+ le64_to_cpu(data[2]), le64_to_cpu(data[3]), -+ key); -+ return __siphash_aligned(data, len, key); -+} -+ -+/** -+ * siphash - compute 64-bit siphash PRF value -+ * @data: buffer to hash -+ * @size: size of @data -+ * @key: the siphash key -+ */ -+static inline u64 siphash(const void *data, size_t len, -+ const siphash_key_t *key) -+{ -+#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS -+ if (!IS_ALIGNED((unsigned long)data, SIPHASH_ALIGNMENT)) -+ return __siphash_unaligned(data, len, key); -+#endif -+ return ___siphash_aligned(data, len, key); -+} -+ -+#define HSIPHASH_ALIGNMENT __alignof__(unsigned long) -+typedef struct { -+ unsigned long key[2]; -+} hsiphash_key_t; -+ -+u32 __hsiphash_aligned(const void *data, size_t len, -+ const hsiphash_key_t *key); -+#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS -+u32 __hsiphash_unaligned(const void *data, size_t len, -+ const hsiphash_key_t *key); -+#endif -+ -+u32 hsiphash_1u32(const u32 a, const hsiphash_key_t *key); -+u32 hsiphash_2u32(const u32 a, const u32 b, const hsiphash_key_t *key); -+u32 hsiphash_3u32(const u32 a, const u32 b, const u32 c, -+ const hsiphash_key_t *key); -+u32 hsiphash_4u32(const u32 a, const u32 b, const u32 c, const u32 d, -+ const hsiphash_key_t *key); -+ -+static inline u32 ___hsiphash_aligned(const __le32 *data, size_t len, -+ const hsiphash_key_t *key) -+{ -+ if (__builtin_constant_p(len) && len == 4) -+ return hsiphash_1u32(le32_to_cpu(data[0]), key); -+ if (__builtin_constant_p(len) && len == 8) -+ return hsiphash_2u32(le32_to_cpu(data[0]), le32_to_cpu(data[1]), -+ key); -+ if (__builtin_constant_p(len) && len == 12) -+ return hsiphash_3u32(le32_to_cpu(data[0]), le32_to_cpu(data[1]), -+ le32_to_cpu(data[2]), key); -+ if (__builtin_constant_p(len) && len == 16) -+ return hsiphash_4u32(le32_to_cpu(data[0]), le32_to_cpu(data[1]), -+ le32_to_cpu(data[2]), le32_to_cpu(data[3]), -+ key); -+ return __hsiphash_aligned(data, len, key); -+} -+ -+/** -+ * hsiphash - compute 32-bit hsiphash PRF value -+ * @data: buffer to hash -+ * @size: size of @data -+ * @key: the hsiphash key -+ */ -+static inline u32 hsiphash(const void *data, size_t len, -+ const hsiphash_key_t *key) -+{ -+#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS -+ if (!IS_ALIGNED((unsigned long)data, HSIPHASH_ALIGNMENT)) -+ return __hsiphash_unaligned(data, len, key); -+#endif -+ return ___hsiphash_aligned(data, len, key); -+} -+ -+#endif /* _WG_LINUX_SIPHASH_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/intel-family/include/asm/intel-family.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,73 @@ -+/* SPDX-License-Identifier: GPL-2.0 */ -+#ifndef _ASM_X86_INTEL_FAMILY_H -+#define _ASM_X86_INTEL_FAMILY_H -+ -+/* -+ * "Big Core" Processors (Branded as Core, Xeon, etc...) -+ * -+ * The "_X" parts are generally the EP and EX Xeons, or the -+ * "Extreme" ones, like Broadwell-E. -+ * -+ * Things ending in "2" are usually because we have no better -+ * name for them. There's no processor called "SILVERMONT2". -+ */ -+ -+#define INTEL_FAM6_CORE_YONAH 0x0E -+ -+#define INTEL_FAM6_CORE2_MEROM 0x0F -+#define INTEL_FAM6_CORE2_MEROM_L 0x16 -+#define INTEL_FAM6_CORE2_PENRYN 0x17 -+#define INTEL_FAM6_CORE2_DUNNINGTON 0x1D -+ -+#define INTEL_FAM6_NEHALEM 0x1E -+#define INTEL_FAM6_NEHALEM_G 0x1F /* Auburndale / Havendale */ -+#define INTEL_FAM6_NEHALEM_EP 0x1A -+#define INTEL_FAM6_NEHALEM_EX 0x2E -+ -+#define INTEL_FAM6_WESTMERE 0x25 -+#define INTEL_FAM6_WESTMERE_EP 0x2C -+#define INTEL_FAM6_WESTMERE_EX 0x2F -+ -+#define INTEL_FAM6_SANDYBRIDGE 0x2A -+#define INTEL_FAM6_SANDYBRIDGE_X 0x2D -+#define INTEL_FAM6_IVYBRIDGE 0x3A -+#define INTEL_FAM6_IVYBRIDGE_X 0x3E -+ -+#define INTEL_FAM6_HASWELL_CORE 0x3C -+#define INTEL_FAM6_HASWELL_X 0x3F -+#define INTEL_FAM6_HASWELL_ULT 0x45 -+#define INTEL_FAM6_HASWELL_GT3E 0x46 -+ -+#define INTEL_FAM6_BROADWELL_CORE 0x3D -+#define INTEL_FAM6_BROADWELL_GT3E 0x47 -+#define INTEL_FAM6_BROADWELL_X 0x4F -+#define INTEL_FAM6_BROADWELL_XEON_D 0x56 -+ -+#define INTEL_FAM6_SKYLAKE_MOBILE 0x4E -+#define INTEL_FAM6_SKYLAKE_DESKTOP 0x5E -+#define INTEL_FAM6_SKYLAKE_X 0x55 -+#define INTEL_FAM6_KABYLAKE_MOBILE 0x8E -+#define INTEL_FAM6_KABYLAKE_DESKTOP 0x9E -+ -+/* "Small Core" Processors (Atom) */ -+ -+#define INTEL_FAM6_ATOM_PINEVIEW 0x1C -+#define INTEL_FAM6_ATOM_LINCROFT 0x26 -+#define INTEL_FAM6_ATOM_PENWELL 0x27 -+#define INTEL_FAM6_ATOM_CLOVERVIEW 0x35 -+#define INTEL_FAM6_ATOM_CEDARVIEW 0x36 -+#define INTEL_FAM6_ATOM_SILVERMONT1 0x37 /* BayTrail/BYT / Valleyview */ -+#define INTEL_FAM6_ATOM_SILVERMONT2 0x4D /* Avaton/Rangely */ -+#define INTEL_FAM6_ATOM_AIRMONT 0x4C /* CherryTrail / Braswell */ -+#define INTEL_FAM6_ATOM_MERRIFIELD 0x4A /* Tangier */ -+#define INTEL_FAM6_ATOM_MOOREFIELD 0x5A /* Anniedale */ -+#define INTEL_FAM6_ATOM_GOLDMONT 0x5C -+#define INTEL_FAM6_ATOM_DENVERTON 0x5F /* Goldmont Microserver */ -+#define INTEL_FAM6_ATOM_GEMINI_LAKE 0x7A -+ -+/* Xeon Phi */ -+ -+#define INTEL_FAM6_XEON_PHI_KNL 0x57 /* Knights Landing */ -+#define INTEL_FAM6_XEON_PHI_KNM 0x85 /* Knights Mill */ -+ -+#endif /* _ASM_X86_INTEL_FAMILY_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/compat.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,632 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_COMPAT_H -+#define _WG_COMPAT_H -+ -+#include -+#include -+#include -+#include -+ -+#ifdef RHEL_MAJOR -+#if RHEL_MAJOR == 7 -+#define ISRHEL7 -+#endif -+#endif -+#ifdef UTS_UBUNTU_RELEASE_ABI -+#if LINUX_VERSION_CODE == KERNEL_VERSION(3, 13, 11) -+#define ISUBUNTU1404 -+#endif -+#endif -+#ifdef CONFIG_SUSE_KERNEL -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 5, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 4, 0) -+#define ISOPENSUSE42 -+#endif -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 0) -+#error "WireGuard requires Linux >= 3.10" -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 0) && !defined(ISRHEL7) -+#define headers_start data -+#define headers_end data -+#endif -+ -+#include -+#ifndef __ro_after_init -+#define __ro_after_init __read_mostly -+#endif -+ -+#include -+#ifndef READ_ONCE -+#define READ_ONCE ACCESS_ONCE -+#endif -+ -+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0) -+#include "udp_tunnel/udp_tunnel_partial_compat.h" -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 0) && !defined(DEBUG) && defined(net_dbg_ratelimited) -+#undef net_dbg_ratelimited -+#define net_dbg_ratelimited(fmt, ...) do { if (0) no_printk(KERN_DEBUG pr_fmt(fmt), ##__VA_ARGS__); } while (0) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 0) -+#define RCU_LOCKDEP_WARN(cond, message) rcu_lockdep_assert(!(cond), message) -+#endif -+ -+#if ((LINUX_VERSION_CODE > KERNEL_VERSION(3, 19, 0) && LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 6)) || \ -+ (LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 12) && LINUX_VERSION_CODE > KERNEL_VERSION(3, 17, 0)) || \ -+ (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 8) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) || \ -+ LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 40)) && !defined(ISRHEL7) && !defined(ISUBUNTU1404) -+#define dev_recursion_level() 0 -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 0) && !defined(ISRHEL7) -+#define ipv6_dst_lookup(a, b, c, d) ipv6_dst_lookup(b, c, d) -+#endif -+ -+#if (LINUX_VERSION_CODE == KERNEL_VERSION(4, 4, 0) || \ -+ (LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 5) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) || \ -+ (LINUX_VERSION_CODE < KERNEL_VERSION(4, 1, 17) && LINUX_VERSION_CODE > KERNEL_VERSION(3, 19, 0)) || \ -+ (LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 27) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0)) || \ -+ (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 8) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) || \ -+ (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 40) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0)) || \ -+ (LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 54))) && !defined(ISUBUNTU1404) -+#include -+#include -+#define IP6_ECN_set_ce(a, b) IP6_ECN_set_ce(b) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 0) -+#define time_is_before_jiffies64(a) time_after64(get_jiffies_64(), a) -+#define time_is_after_jiffies64(a) time_before64(get_jiffies_64(), a) -+#define time_is_before_eq_jiffies64(a) time_after_eq64(get_jiffies_64(), a) -+#define time_is_after_eq_jiffies64(a) time_before_eq64(get_jiffies_64(), a) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0) && IS_ENABLED(CONFIG_IPV6) && !defined(ISRHEL7) -+#include -+struct ipv6_stub_type { -+ void *udpv6_encap_enable; -+ int (*ipv6_dst_lookup)(struct sock *sk, struct dst_entry **dst, struct flowi6 *fl6); -+}; -+static const struct ipv6_stub_type ipv6_stub_impl = { -+ .udpv6_encap_enable = (void *)1, -+ .ipv6_dst_lookup = ip6_dst_lookup -+}; -+static const struct ipv6_stub_type *ipv6_stub = &ipv6_stub_impl; -+#endif -+ -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 8, 0) && IS_ENABLED(CONFIG_IPV6) && !defined(ISOPENSUSE42) && !defined(ISRHEL7) -+#include -+static inline bool ipv6_mod_enabled(void) -+{ -+ return ipv6_stub->udpv6_encap_enable != NULL; -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 11, 0) -+#include -+static inline void skb_reset_tc(struct sk_buff *skb) -+{ -+#ifdef CONFIG_NET_CLS_ACT -+ skb->tc_verd = 0; -+#endif -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 11, 0) -+#include -+static inline u32 get_random_u32(void) -+{ -+ static siphash_key_t key; -+ static u32 counter = 0; -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 0) -+ static bool has_seeded = false; -+ if (unlikely(!has_seeded)) { -+ get_random_bytes(&key, sizeof(key)); -+ has_seeded = true; -+ } -+#else -+ get_random_once(&key, sizeof(key)); -+#endif -+ return siphash_2u32(counter++, get_random_int(), &key); -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 0) && !defined(ISRHEL7) -+static inline void netif_keep_dst(struct net_device *dev) -+{ -+ dev->priv_flags &= ~IFF_XMIT_DST_RELEASE; -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0) && !defined(ISRHEL7) -+#include -+#ifndef netdev_alloc_pcpu_stats -+#define pcpu_sw_netstats pcpu_tstats -+#endif -+#ifndef netdev_alloc_pcpu_stats -+#define netdev_alloc_pcpu_stats alloc_percpu -+#endif -+#elif LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0) && !defined(ISRHEL7) -+#include -+#ifndef netdev_alloc_pcpu_stats -+#define netdev_alloc_pcpu_stats(type) \ -+({ \ -+ typeof(type) __percpu *pcpu_stats = alloc_percpu(type); \ -+ if (pcpu_stats) { \ -+ int __cpu; \ -+ for_each_possible_cpu(__cpu) { \ -+ typeof(type) *stat; \ -+ stat = per_cpu_ptr(pcpu_stats, __cpu); \ -+ u64_stats_init(&stat->syncp); \ -+ } \ -+ } \ -+ pcpu_stats; \ -+}) -+#endif -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0) -+#include "checksum/checksum_partial_compat.h" -+static inline void *our_pskb_put(struct sk_buff *skb, struct sk_buff *tail, int len) -+{ -+ if (tail != skb) { -+ skb->data_len += len; -+ skb->len += len; -+ } -+ return skb_put(tail, len); -+} -+#define pskb_put our_pskb_put -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) && !defined(ISRHEL7) -+#include -+static inline void skb_scrub_packet(struct sk_buff *skb, bool xnet) -+{ -+#ifdef CONFIG_CAVIUM_OCTEON_IPFWD_OFFLOAD -+ memset(&skb->cvm_info, 0, sizeof(skb->cvm_info)); -+ skb->cvm_reserved = 0; -+#endif -+ skb->tstamp.tv64 = 0; -+ skb->pkt_type = PACKET_HOST; -+ skb->skb_iif = 0; -+ skb_dst_drop(skb); -+ secpath_reset(skb); -+ nf_reset(skb); -+ nf_reset_trace(skb); -+ if (!xnet) -+ return; -+ skb_orphan(skb); -+ skb->mark = 0; -+} -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0) || defined(ISUBUNTU1404)) && !defined(ISRHEL7) -+#include -+static inline u32 prandom_u32_max(u32 ep_ro) -+{ -+ return (u32)(((u64) prandom_u32() * ep_ro) >> 32); -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 75) && !defined(ISRHEL7) -+#ifndef U8_MAX -+#define U8_MAX ((u8)~0U) -+#endif -+#ifndef S8_MAX -+#define S8_MAX ((s8)(U8_MAX >> 1)) -+#endif -+#ifndef S8_MIN -+#define S8_MIN ((s8)(-S8_MAX - 1)) -+#endif -+#ifndef U16_MAX -+#define U16_MAX ((u16)~0U) -+#endif -+#ifndef S16_MAX -+#define S16_MAX ((s16)(U16_MAX >> 1)) -+#endif -+#ifndef S16_MIN -+#define S16_MIN ((s16)(-S16_MAX - 1)) -+#endif -+#ifndef U32_MAX -+#define U32_MAX ((u32)~0U) -+#endif -+#ifndef S32_MAX -+#define S32_MAX ((s32)(U32_MAX >> 1)) -+#endif -+#ifndef S32_MIN -+#define S32_MIN ((s32)(-S32_MAX - 1)) -+#endif -+#ifndef U64_MAX -+#define U64_MAX ((u64)~0ULL) -+#endif -+#ifndef S64_MAX -+#define S64_MAX ((s64)(U64_MAX >> 1)) -+#endif -+#ifndef S64_MIN -+#define S64_MIN ((s64)(-S64_MAX - 1)) -+#endif -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 60) && !defined(ISRHEL7) -+/* Making this static may very well invalidate its usefulness, -+ * but so it goes with compat code. */ -+static inline void memzero_explicit(void *s, size_t count) -+{ -+ memset(s, 0, count); -+ barrier(); -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0) && !defined(ISRHEL7) -+static const struct in6_addr our_in6addr_any = IN6ADDR_ANY_INIT; -+#define in6addr_any our_in6addr_any -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 13, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0) -+#include -+#include -+#include -+struct rng_initializer { -+ struct completion done; -+ struct random_ready_callback cb; -+}; -+static inline void rng_initialized_callback(struct random_ready_callback *cb) -+{ -+ complete(&container_of(cb, struct rng_initializer, cb)->done); -+} -+static inline int wait_for_random_bytes(void) -+{ -+ static bool rng_is_initialized = false; -+ int ret; -+ if (unlikely(!rng_is_initialized)) { -+ struct rng_initializer rng = { -+ .done = COMPLETION_INITIALIZER(rng.done), -+ .cb = { .owner = THIS_MODULE, .func = rng_initialized_callback } -+ }; -+ ret = add_random_ready_callback(&rng.cb); -+ if (!ret) { -+ ret = wait_for_completion_interruptible(&rng.done); -+ if (ret) { -+ del_random_ready_callback(&rng.cb); -+ return ret; -+ } -+ } else if (ret != -EALREADY) -+ return ret; -+ rng_is_initialized = true; -+ } -+ return 0; -+} -+#elif LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0) -+/* This is a disaster. Without this API, we really have no way of -+ * knowing if it's initialized. We just return that it has and hope -+ * for the best... */ -+static inline int wait_for_random_bytes(void) -+{ -+ return 0; -+} -+#endif -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 13, 0) -+static inline int get_random_bytes_wait(void *buf, int nbytes) -+{ -+ int ret = wait_for_random_bytes(); -+ if (unlikely(ret)) -+ return ret; -+ get_random_bytes(buf, nbytes); -+ return 0; -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) && !defined(ISRHEL7) -+#define system_power_efficient_wq system_unbound_wq -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 17, 0) && !defined(ISRHEL7) -+#include -+static inline u64 ktime_get_ns(void) -+{ -+ return ktime_to_ns(ktime_get()); -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0) -+#include -+static inline __be32 our_confirm_addr_indev(struct in_device *in_dev, __be32 dst, __be32 local, int scope) -+{ -+ int same = 0; -+ __be32 addr = 0; -+ for_ifa(in_dev) { -+ if (!addr && (local == ifa->ifa_local || !local) && ifa->ifa_scope <= scope) { -+ addr = ifa->ifa_local; -+ if (same) -+ break; -+ } -+ if (!same) { -+ same = (!local || inet_ifa_match(local, ifa)) && (!dst || inet_ifa_match(dst, ifa)); -+ if (same && addr) { -+ if (local || !dst) -+ break; -+ if (inet_ifa_match(addr, ifa)) -+ break; -+ if (ifa->ifa_scope <= scope) { -+ addr = ifa->ifa_local; -+ break; -+ } -+ same = 0; -+ } -+ } -+ } endfor_ifa(in_dev); -+ return same ? addr : 0; -+} -+static inline __be32 our_inet_confirm_addr(struct net *net, struct in_device *in_dev, __be32 dst, __be32 local, int scope) -+{ -+ __be32 addr = 0; -+ struct net_device *dev; -+ if (in_dev) -+ return our_confirm_addr_indev(in_dev, dst, local, scope); -+ rcu_read_lock(); -+ for_each_netdev_rcu(net, dev) { -+ in_dev = __in_dev_get_rcu(dev); -+ if (in_dev) { -+ addr = our_confirm_addr_indev(in_dev, dst, local, scope); -+ if (addr) -+ break; -+ } -+ } -+ rcu_read_unlock(); -+ return addr; -+} -+#define inet_confirm_addr our_inet_confirm_addr -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 12, 0) -+#include -+#include -+#include -+static inline void *kvmalloc_ours(size_t size, gfp_t flags) -+{ -+ gfp_t kmalloc_flags = flags; -+ void *ret; -+ if (size > PAGE_SIZE) { -+ kmalloc_flags |= __GFP_NOWARN; -+ if (!(kmalloc_flags & __GFP_REPEAT) || (size <= PAGE_SIZE << PAGE_ALLOC_COSTLY_ORDER)) -+ kmalloc_flags |= __GFP_NORETRY; -+ } -+ ret = kmalloc(size, kmalloc_flags); -+ if (ret || size <= PAGE_SIZE) -+ return ret; -+ return __vmalloc(size, flags, PAGE_KERNEL); -+} -+static inline void *kvzalloc_ours(size_t size, gfp_t flags) -+{ -+ return kvmalloc_ours(size, flags | __GFP_ZERO); -+} -+#define kvmalloc kvmalloc_ours -+#define kvzalloc kvzalloc_ours -+#endif -+ -+#if ((LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0)) || LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 41)) && !defined(ISUBUNTU1404) -+#include -+#include -+static inline void kvfree_ours(const void *addr) -+{ -+ if (is_vmalloc_addr(addr)) -+ vfree(addr); -+ else -+ kfree(addr); -+} -+#define kvfree kvfree_ours -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 11, 9) -+#include -+#define priv_destructor destructor -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 13, 0) -+#define newlink(a,b,c,d,e) newlink(a,b,c,d) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 12, 0) -+#include -+#include -+#define nlmsg_parse(a, b, c, d, e, f) nlmsg_parse(a, b, c, d, e) -+#define nla_parse_nested(a, b, c, d, e) nla_parse_nested(a, b, c, d) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 10, 0) -+static inline struct nlattr **genl_family_attrbuf(const struct genl_family *family) -+{ -+ return family->attrbuf; -+} -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 12, 0) -+#define PTR_ERR_OR_ZERO(p) PTR_RET(p) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 7, 0) -+#include -+#define nla_put_u64_64bit(a, b, c, d) nla_put_u64(a, b, c) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 6, 0) -+#include -+#ifndef GENL_UNS_ADMIN_PERM -+#define GENL_UNS_ADMIN_PERM GENL_ADMIN_PERM -+#endif -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 10, 0) -+#include -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 13, 0) && !defined(ISRHEL7) -+#define genl_register_family(a) genl_register_family_with_ops(a, genl_ops, ARRAY_SIZE(genl_ops)) -+#define COMPAT_CANNOT_USE_CONST_GENL_OPS -+#else -+#define genl_register_family(a) genl_register_family_with_ops(a, genl_ops) -+#endif -+#define COMPAT_CANNOT_USE_GENL_NOPS -+#endif -+ -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 14, 2) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) || (LINUX_VERSION_CODE < KERNEL_VERSION(4, 13, 16) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 10, 0)) || (LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 65) && LINUX_VERSION_CODE >= KERNEL_VERSION(4, 5, 0)) || (LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 101) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) || LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 84) -+#define ___COMPAT_NETLINK_DUMP_BLOCK { int ret; skb->end -= nlmsg_total_size(sizeof(int)); ret = get_device_dump_real(skb, cb); skb->end += nlmsg_total_size(sizeof(int)); return ret; } -+#define ___COMPAT_NETLINK_DUMP_OVERRIDE -+#else -+#define ___COMPAT_NETLINK_DUMP_BLOCK return get_device_dump_real(skb, cb); -+#endif -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 16, 0) -+#define get_device_dump(a, b) get_device_dump_real(a, b); \ -+static int get_device_dump(a, b) { \ -+ struct wireguard_device *wg = (struct wireguard_device *)cb->args[0]; \ -+ if (!wg) { \ -+ int ret = get_device_start(cb); \ -+ if (ret) \ -+ return ret; \ -+ } \ -+ ___COMPAT_NETLINK_DUMP_BLOCK \ -+} \ -+static int get_device_dump_real(a, b) -+#define COMPAT_CANNOT_USE_NETLINK_START -+#elif defined(___COMPAT_NETLINK_DUMP_OVERRIDE) -+#define get_device_dump(a, b) get_device_dump_real(a, b); \ -+static int get_device_dump(a, b) { \ -+ ___COMPAT_NETLINK_DUMP_BLOCK \ -+} \ -+static int get_device_dump_real(a, b) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 17, 0) -+#define COMPAT_CANNOT_USE_IN6_DEV_GET -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 11, 0) -+#define COMPAT_CANNOT_USE_DEV_CNF -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 3, 0) -+#define COMPAT_CANNOT_USE_IFF_NO_QUEUE -+#endif -+ -+#if defined(CONFIG_X86_64) && LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 0) -+#include -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0) -+#include -+#include -+static inline int cpu_has_xfeatures(u64 xfeatures_needed, const char **feature_name) -+{ -+ return xgetbv(XCR_XFEATURE_ENABLED_MASK) & xfeatures_needed; -+} -+#endif -+#ifndef XFEATURE_MASK_YMM -+#define XFEATURE_MASK_YMM XSTATE_YMM -+#endif -+#ifndef XFEATURE_MASK_SSE -+#define XFEATURE_MASK_SSE XSTATE_SSE -+#endif -+#ifndef XSTATE_AVX512 -+#define XSTATE_AVX512 (XSTATE_OPMASK | XSTATE_ZMM_Hi256 | XSTATE_Hi16_ZMM) -+#endif -+#ifndef XFEATURE_MASK_AVX512 -+#define XFEATURE_MASK_AVX512 XSTATE_AVX512 -+#endif -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 6, 0) && defined(CONFIG_X86_64) -+/* This is incredibly dumb and reckless, but as it turns out, there's -+ * not really hardware Linux runs properly on that supports F but not BW -+ * and VL, so in practice this isn't so bad. Plus, this is compat layer, -+ * so the bar remains fairly low. -+ */ -+#include -+#ifndef X86_FEATURE_AVX512BW -+#define X86_FEATURE_AVX512BW X86_FEATURE_AVX512F -+#endif -+#ifndef X86_FEATURE_AVX512VL -+#define X86_FEATURE_AVX512VL X86_FEATURE_AVX512F -+#endif -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) -+struct _____dummy_container { char dev; }; -+#define netdev_notifier_info net_device *)data); __attribute((unused)) char _____dummy = ((struct _____dummy_container -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 14, 0) -+#define timer_setup(a, b, c) setup_timer(a, ((void (*)(unsigned long))b), ((unsigned long)a)) -+#define from_timer(var, callback_timer, timer_fieldname) container_of(callback_timer, typeof(*var), timer_fieldname) -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 3) -+#define COMPAT_CANNOT_USE_AVX512 -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 17, 0) -+#define timespec64 timespec -+#define getnstimeofday64 getnstimeofday -+#endif -+ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+#include -+#define genl_dump_check_consistent(a, b) genl_dump_check_consistent(a, b, &genl_family) -+#endif -+ -+/* https://lkml.org/lkml/2017/6/23/790 */ -+#if IS_ENABLED(CONFIG_NF_CONNTRACK) -+#include -+#include -+#include -+#include -+#include -+#include -+static inline void new_icmp_send(struct sk_buff *skb_in, int type, int code, __be32 info) -+{ -+ enum ip_conntrack_info ctinfo; -+ struct nf_conn *ct = nf_ct_get(skb_in, &ctinfo); -+ if (skb_network_header(skb_in) < skb_in->head || (skb_network_header(skb_in) + sizeof(struct iphdr)) > skb_tail_pointer(skb_in)) -+ return; -+ if (ct) -+ ip_hdr(skb_in)->saddr = ct->tuplehash[0].tuple.src.u3.ip; -+ icmp_send(skb_in, type, code, info); -+} -+static inline void new_icmpv6_send(struct sk_buff *skb, u8 type, u8 code, __u32 info) -+{ -+ enum ip_conntrack_info ctinfo; -+ struct nf_conn *ct = nf_ct_get(skb, &ctinfo); -+ if (skb_network_header(skb) < skb->head || (skb_network_header(skb) + sizeof(struct ipv6hdr)) > skb_tail_pointer(skb)) -+ return; -+ if (ct) -+ ipv6_hdr(skb)->saddr = ct->tuplehash[0].tuple.src.u3.in6; -+ icmpv6_send(skb, type, code, info); -+} -+#define icmp_send(a,b,c,d) new_icmp_send(a,b,c,d) -+#define icmpv6_send(a,b,c,d) new_icmpv6_send(a,b,c,d) -+#endif -+ -+/* PaX compatibility */ -+#ifdef CONSTIFY_PLUGIN -+#include -+#undef __read_mostly -+#define __read_mostly -+#endif -+#if defined(RAP_PLUGIN) && LINUX_VERSION_CODE < KERNEL_VERSION(4, 15, 0) -+#include -+#define expired_retransmit_handshake(a) expired_retransmit_handshake(unsigned long timer) -+#define expired_send_keepalive(a) expired_send_keepalive(unsigned long timer) -+#define expired_new_handshake(a) expired_new_handshake(unsigned long timer) -+#define expired_zero_key_material(a) expired_zero_key_material(unsigned long timer) -+#define expired_send_persistent_keepalive(a) expired_send_persistent_keepalive(unsigned long timer) -+#undef timer_setup -+#define timer_setup(a, b, c) setup_timer(a, ((void (*)(unsigned long))b), ((unsigned long)a)) -+#undef from_timer -+#define from_timer(var, callback_timer, timer_fieldname) container_of((struct timer_list *)callback_timer, typeof(*var), timer_fieldname) -+#endif -+ -+#endif /* _WG_COMPAT_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/ptr_ring/include/linux/ptr_ring.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,640 @@ -+/* -+ * Definitions for the 'struct ptr_ring' datastructure. -+ * -+ * Author: -+ * Michael S. Tsirkin -+ * -+ * Copyright (C) 2016 Red Hat, Inc. -+ * -+ * This program is free software; you can redistribute it and/or modify it -+ * under the terms of the GNU General Public License as published by the -+ * Free Software Foundation; either version 2 of the License, or (at your -+ * option) any later version. -+ * -+ * This is a limited-size FIFO maintaining pointers in FIFO order, with -+ * one CPU producing entries and another consuming entries from a FIFO. -+ * -+ * This implementation tries to minimize cache-contention when there is a -+ * single producer and a single consumer CPU. -+ */ -+ -+#ifndef _LINUX_PTR_RING_H -+#define _LINUX_PTR_RING_H 1 -+ -+#ifdef __KERNEL__ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#endif -+ -+struct ptr_ring { -+ int producer ____cacheline_aligned_in_smp; -+ spinlock_t producer_lock; -+ int consumer_head ____cacheline_aligned_in_smp; /* next valid entry */ -+ int consumer_tail; /* next entry to invalidate */ -+ spinlock_t consumer_lock; -+ /* Shared consumer/producer data */ -+ /* Read-only by both the producer and the consumer */ -+ int size ____cacheline_aligned_in_smp; /* max entries in queue */ -+ int batch; /* number of entries to consume in a batch */ -+ void **queue; -+}; -+ -+/* Note: callers invoking this in a loop must use a compiler barrier, -+ * for example cpu_relax(). If ring is ever resized, callers must hold -+ * producer_lock - see e.g. ptr_ring_full. Otherwise, if callers don't hold -+ * producer_lock, the next call to __ptr_ring_produce may fail. -+ */ -+static inline bool __ptr_ring_full(struct ptr_ring *r) -+{ -+ return r->queue[r->producer]; -+} -+ -+static inline bool ptr_ring_full(struct ptr_ring *r) -+{ -+ bool ret; -+ -+ spin_lock(&r->producer_lock); -+ ret = __ptr_ring_full(r); -+ spin_unlock(&r->producer_lock); -+ -+ return ret; -+} -+ -+static inline bool ptr_ring_full_irq(struct ptr_ring *r) -+{ -+ bool ret; -+ -+ spin_lock_irq(&r->producer_lock); -+ ret = __ptr_ring_full(r); -+ spin_unlock_irq(&r->producer_lock); -+ -+ return ret; -+} -+ -+static inline bool ptr_ring_full_any(struct ptr_ring *r) -+{ -+ unsigned long flags; -+ bool ret; -+ -+ spin_lock_irqsave(&r->producer_lock, flags); -+ ret = __ptr_ring_full(r); -+ spin_unlock_irqrestore(&r->producer_lock, flags); -+ -+ return ret; -+} -+ -+static inline bool ptr_ring_full_bh(struct ptr_ring *r) -+{ -+ bool ret; -+ -+ spin_lock_bh(&r->producer_lock); -+ ret = __ptr_ring_full(r); -+ spin_unlock_bh(&r->producer_lock); -+ -+ return ret; -+} -+ -+/* Note: callers invoking this in a loop must use a compiler barrier, -+ * for example cpu_relax(). Callers must hold producer_lock. -+ */ -+static inline int __ptr_ring_produce(struct ptr_ring *r, void *ptr) -+{ -+ if (unlikely(!r->size) || r->queue[r->producer]) -+ return -ENOSPC; -+ -+ r->queue[r->producer++] = ptr; -+ if (unlikely(r->producer >= r->size)) -+ r->producer = 0; -+ return 0; -+} -+ -+/* -+ * Note: resize (below) nests producer lock within consumer lock, so if you -+ * consume in interrupt or BH context, you must disable interrupts/BH when -+ * calling this. -+ */ -+static inline int ptr_ring_produce(struct ptr_ring *r, void *ptr) -+{ -+ int ret; -+ -+ spin_lock(&r->producer_lock); -+ ret = __ptr_ring_produce(r, ptr); -+ spin_unlock(&r->producer_lock); -+ -+ return ret; -+} -+ -+static inline int ptr_ring_produce_irq(struct ptr_ring *r, void *ptr) -+{ -+ int ret; -+ -+ spin_lock_irq(&r->producer_lock); -+ ret = __ptr_ring_produce(r, ptr); -+ spin_unlock_irq(&r->producer_lock); -+ -+ return ret; -+} -+ -+static inline int ptr_ring_produce_any(struct ptr_ring *r, void *ptr) -+{ -+ unsigned long flags; -+ int ret; -+ -+ spin_lock_irqsave(&r->producer_lock, flags); -+ ret = __ptr_ring_produce(r, ptr); -+ spin_unlock_irqrestore(&r->producer_lock, flags); -+ -+ return ret; -+} -+ -+static inline int ptr_ring_produce_bh(struct ptr_ring *r, void *ptr) -+{ -+ int ret; -+ -+ spin_lock_bh(&r->producer_lock); -+ ret = __ptr_ring_produce(r, ptr); -+ spin_unlock_bh(&r->producer_lock); -+ -+ return ret; -+} -+ -+/* Note: callers invoking this in a loop must use a compiler barrier, -+ * for example cpu_relax(). Callers must take consumer_lock -+ * if they dereference the pointer - see e.g. PTR_RING_PEEK_CALL. -+ * If ring is never resized, and if the pointer is merely -+ * tested, there's no need to take the lock - see e.g. __ptr_ring_empty. -+ */ -+static inline void *__ptr_ring_peek(struct ptr_ring *r) -+{ -+ if (likely(r->size)) -+ return r->queue[r->consumer_head]; -+ return NULL; -+} -+ -+/* Note: callers invoking this in a loop must use a compiler barrier, -+ * for example cpu_relax(). Callers must take consumer_lock -+ * if the ring is ever resized - see e.g. ptr_ring_empty. -+ */ -+static inline bool __ptr_ring_empty(struct ptr_ring *r) -+{ -+ return !__ptr_ring_peek(r); -+} -+ -+static inline bool ptr_ring_empty(struct ptr_ring *r) -+{ -+ bool ret; -+ -+ spin_lock(&r->consumer_lock); -+ ret = __ptr_ring_empty(r); -+ spin_unlock(&r->consumer_lock); -+ -+ return ret; -+} -+ -+static inline bool ptr_ring_empty_irq(struct ptr_ring *r) -+{ -+ bool ret; -+ -+ spin_lock_irq(&r->consumer_lock); -+ ret = __ptr_ring_empty(r); -+ spin_unlock_irq(&r->consumer_lock); -+ -+ return ret; -+} -+ -+static inline bool ptr_ring_empty_any(struct ptr_ring *r) -+{ -+ unsigned long flags; -+ bool ret; -+ -+ spin_lock_irqsave(&r->consumer_lock, flags); -+ ret = __ptr_ring_empty(r); -+ spin_unlock_irqrestore(&r->consumer_lock, flags); -+ -+ return ret; -+} -+ -+static inline bool ptr_ring_empty_bh(struct ptr_ring *r) -+{ -+ bool ret; -+ -+ spin_lock_bh(&r->consumer_lock); -+ ret = __ptr_ring_empty(r); -+ spin_unlock_bh(&r->consumer_lock); -+ -+ return ret; -+} -+ -+/* Must only be called after __ptr_ring_peek returned !NULL */ -+static inline void __ptr_ring_discard_one(struct ptr_ring *r) -+{ -+ /* Fundamentally, what we want to do is update consumer -+ * index and zero out the entry so producer can reuse it. -+ * Doing it naively at each consume would be as simple as: -+ * r->queue[r->consumer++] = NULL; -+ * if (unlikely(r->consumer >= r->size)) -+ * r->consumer = 0; -+ * but that is suboptimal when the ring is full as producer is writing -+ * out new entries in the same cache line. Defer these updates until a -+ * batch of entries has been consumed. -+ */ -+ int head = r->consumer_head++; -+ -+ /* Once we have processed enough entries invalidate them in -+ * the ring all at once so producer can reuse their space in the ring. -+ * We also do this when we reach end of the ring - not mandatory -+ * but helps keep the implementation simple. -+ */ -+ if (unlikely(r->consumer_head - r->consumer_tail >= r->batch || -+ r->consumer_head >= r->size)) { -+ /* Zero out entries in the reverse order: this way we touch the -+ * cache line that producer might currently be reading the last; -+ * producer won't make progress and touch other cache lines -+ * besides the first one until we write out all entries. -+ */ -+ while (likely(head >= r->consumer_tail)) -+ r->queue[head--] = NULL; -+ r->consumer_tail = r->consumer_head; -+ } -+ if (unlikely(r->consumer_head >= r->size)) { -+ r->consumer_head = 0; -+ r->consumer_tail = 0; -+ } -+} -+ -+static inline void *__ptr_ring_consume(struct ptr_ring *r) -+{ -+ void *ptr; -+ -+ ptr = __ptr_ring_peek(r); -+ if (ptr) -+ __ptr_ring_discard_one(r); -+ -+ return ptr; -+} -+ -+static inline int __ptr_ring_consume_batched(struct ptr_ring *r, -+ void **array, int n) -+{ -+ void *ptr; -+ int i; -+ -+ for (i = 0; i < n; i++) { -+ ptr = __ptr_ring_consume(r); -+ if (!ptr) -+ break; -+ array[i] = ptr; -+ } -+ -+ return i; -+} -+ -+/* -+ * Note: resize (below) nests producer lock within consumer lock, so if you -+ * call this in interrupt or BH context, you must disable interrupts/BH when -+ * producing. -+ */ -+static inline void *ptr_ring_consume(struct ptr_ring *r) -+{ -+ void *ptr; -+ -+ spin_lock(&r->consumer_lock); -+ ptr = __ptr_ring_consume(r); -+ spin_unlock(&r->consumer_lock); -+ -+ return ptr; -+} -+ -+static inline void *ptr_ring_consume_irq(struct ptr_ring *r) -+{ -+ void *ptr; -+ -+ spin_lock_irq(&r->consumer_lock); -+ ptr = __ptr_ring_consume(r); -+ spin_unlock_irq(&r->consumer_lock); -+ -+ return ptr; -+} -+ -+static inline void *ptr_ring_consume_any(struct ptr_ring *r) -+{ -+ unsigned long flags; -+ void *ptr; -+ -+ spin_lock_irqsave(&r->consumer_lock, flags); -+ ptr = __ptr_ring_consume(r); -+ spin_unlock_irqrestore(&r->consumer_lock, flags); -+ -+ return ptr; -+} -+ -+static inline void *ptr_ring_consume_bh(struct ptr_ring *r) -+{ -+ void *ptr; -+ -+ spin_lock_bh(&r->consumer_lock); -+ ptr = __ptr_ring_consume(r); -+ spin_unlock_bh(&r->consumer_lock); -+ -+ return ptr; -+} -+ -+static inline int ptr_ring_consume_batched(struct ptr_ring *r, -+ void **array, int n) -+{ -+ int ret; -+ -+ spin_lock(&r->consumer_lock); -+ ret = __ptr_ring_consume_batched(r, array, n); -+ spin_unlock(&r->consumer_lock); -+ -+ return ret; -+} -+ -+static inline int ptr_ring_consume_batched_irq(struct ptr_ring *r, -+ void **array, int n) -+{ -+ int ret; -+ -+ spin_lock_irq(&r->consumer_lock); -+ ret = __ptr_ring_consume_batched(r, array, n); -+ spin_unlock_irq(&r->consumer_lock); -+ -+ return ret; -+} -+ -+static inline int ptr_ring_consume_batched_any(struct ptr_ring *r, -+ void **array, int n) -+{ -+ unsigned long flags; -+ int ret; -+ -+ spin_lock_irqsave(&r->consumer_lock, flags); -+ ret = __ptr_ring_consume_batched(r, array, n); -+ spin_unlock_irqrestore(&r->consumer_lock, flags); -+ -+ return ret; -+} -+ -+static inline int ptr_ring_consume_batched_bh(struct ptr_ring *r, -+ void **array, int n) -+{ -+ int ret; -+ -+ spin_lock_bh(&r->consumer_lock); -+ ret = __ptr_ring_consume_batched(r, array, n); -+ spin_unlock_bh(&r->consumer_lock); -+ -+ return ret; -+} -+ -+/* Cast to structure type and call a function without discarding from FIFO. -+ * Function must return a value. -+ * Callers must take consumer_lock. -+ */ -+#define __PTR_RING_PEEK_CALL(r, f) ((f)(__ptr_ring_peek(r))) -+ -+#define PTR_RING_PEEK_CALL(r, f) ({ \ -+ typeof((f)(NULL)) __PTR_RING_PEEK_CALL_v; \ -+ \ -+ spin_lock(&(r)->consumer_lock); \ -+ __PTR_RING_PEEK_CALL_v = __PTR_RING_PEEK_CALL(r, f); \ -+ spin_unlock(&(r)->consumer_lock); \ -+ __PTR_RING_PEEK_CALL_v; \ -+}) -+ -+#define PTR_RING_PEEK_CALL_IRQ(r, f) ({ \ -+ typeof((f)(NULL)) __PTR_RING_PEEK_CALL_v; \ -+ \ -+ spin_lock_irq(&(r)->consumer_lock); \ -+ __PTR_RING_PEEK_CALL_v = __PTR_RING_PEEK_CALL(r, f); \ -+ spin_unlock_irq(&(r)->consumer_lock); \ -+ __PTR_RING_PEEK_CALL_v; \ -+}) -+ -+#define PTR_RING_PEEK_CALL_BH(r, f) ({ \ -+ typeof((f)(NULL)) __PTR_RING_PEEK_CALL_v; \ -+ \ -+ spin_lock_bh(&(r)->consumer_lock); \ -+ __PTR_RING_PEEK_CALL_v = __PTR_RING_PEEK_CALL(r, f); \ -+ spin_unlock_bh(&(r)->consumer_lock); \ -+ __PTR_RING_PEEK_CALL_v; \ -+}) -+ -+#define PTR_RING_PEEK_CALL_ANY(r, f) ({ \ -+ typeof((f)(NULL)) __PTR_RING_PEEK_CALL_v; \ -+ unsigned long __PTR_RING_PEEK_CALL_f;\ -+ \ -+ spin_lock_irqsave(&(r)->consumer_lock, __PTR_RING_PEEK_CALL_f); \ -+ __PTR_RING_PEEK_CALL_v = __PTR_RING_PEEK_CALL(r, f); \ -+ spin_unlock_irqrestore(&(r)->consumer_lock, __PTR_RING_PEEK_CALL_f); \ -+ __PTR_RING_PEEK_CALL_v; \ -+}) -+ -+static inline void **__ptr_ring_init_queue_alloc(unsigned int size, gfp_t gfp) -+{ -+ return kcalloc(size, sizeof(void *), gfp); -+} -+ -+static inline void __ptr_ring_set_size(struct ptr_ring *r, int size) -+{ -+ r->size = size; -+ r->batch = SMP_CACHE_BYTES * 2 / sizeof(*(r->queue)); -+ /* We need to set batch at least to 1 to make logic -+ * in __ptr_ring_discard_one work correctly. -+ * Batching too much (because ring is small) would cause a lot of -+ * burstiness. Needs tuning, for now disable batching. -+ */ -+ if (r->batch > r->size / 2 || !r->batch) -+ r->batch = 1; -+} -+ -+static inline int ptr_ring_init(struct ptr_ring *r, int size, gfp_t gfp) -+{ -+ r->queue = __ptr_ring_init_queue_alloc(size, gfp); -+ if (!r->queue) -+ return -ENOMEM; -+ -+ __ptr_ring_set_size(r, size); -+ r->producer = r->consumer_head = r->consumer_tail = 0; -+ spin_lock_init(&r->producer_lock); -+ spin_lock_init(&r->consumer_lock); -+ -+ return 0; -+} -+ -+/* -+ * Return entries into ring. Destroy entries that don't fit. -+ * -+ * Note: this is expected to be a rare slow path operation. -+ * -+ * Note: producer lock is nested within consumer lock, so if you -+ * resize you must make sure all uses nest correctly. -+ * In particular if you consume ring in interrupt or BH context, you must -+ * disable interrupts/BH when doing so. -+ */ -+static inline void ptr_ring_unconsume(struct ptr_ring *r, void **batch, int n, -+ void (*destroy)(void *)) -+{ -+ unsigned long flags; -+ int head; -+ -+ spin_lock_irqsave(&r->consumer_lock, flags); -+ spin_lock(&r->producer_lock); -+ -+ if (!r->size) -+ goto done; -+ -+ /* -+ * Clean out buffered entries (for simplicity). This way following code -+ * can test entries for NULL and if not assume they are valid. -+ */ -+ head = r->consumer_head - 1; -+ while (likely(head >= r->consumer_tail)) -+ r->queue[head--] = NULL; -+ r->consumer_tail = r->consumer_head; -+ -+ /* -+ * Go over entries in batch, start moving head back and copy entries. -+ * Stop when we run into previously unconsumed entries. -+ */ -+ while (n) { -+ head = r->consumer_head - 1; -+ if (head < 0) -+ head = r->size - 1; -+ if (r->queue[head]) { -+ /* This batch entry will have to be destroyed. */ -+ goto done; -+ } -+ r->queue[head] = batch[--n]; -+ r->consumer_tail = r->consumer_head = head; -+ } -+ -+done: -+ /* Destroy all entries left in the batch. */ -+ while (n) -+ destroy(batch[--n]); -+ spin_unlock(&r->producer_lock); -+ spin_unlock_irqrestore(&r->consumer_lock, flags); -+} -+ -+static inline void **__ptr_ring_swap_queue(struct ptr_ring *r, void **queue, -+ int size, gfp_t gfp, -+ void (*destroy)(void *)) -+{ -+ int producer = 0; -+ void **old; -+ void *ptr; -+ -+ while ((ptr = __ptr_ring_consume(r))) -+ if (producer < size) -+ queue[producer++] = ptr; -+ else if (destroy) -+ destroy(ptr); -+ -+ __ptr_ring_set_size(r, size); -+ r->producer = producer; -+ r->consumer_head = 0; -+ r->consumer_tail = 0; -+ old = r->queue; -+ r->queue = queue; -+ -+ return old; -+} -+ -+/* -+ * Note: producer lock is nested within consumer lock, so if you -+ * resize you must make sure all uses nest correctly. -+ * In particular if you consume ring in interrupt or BH context, you must -+ * disable interrupts/BH when doing so. -+ */ -+static inline int ptr_ring_resize(struct ptr_ring *r, int size, gfp_t gfp, -+ void (*destroy)(void *)) -+{ -+ unsigned long flags; -+ void **queue = __ptr_ring_init_queue_alloc(size, gfp); -+ void **old; -+ -+ if (!queue) -+ return -ENOMEM; -+ -+ spin_lock_irqsave(&(r)->consumer_lock, flags); -+ spin_lock(&(r)->producer_lock); -+ -+ old = __ptr_ring_swap_queue(r, queue, size, gfp, destroy); -+ -+ spin_unlock(&(r)->producer_lock); -+ spin_unlock_irqrestore(&(r)->consumer_lock, flags); -+ -+ kfree(old); -+ -+ return 0; -+} -+ -+/* -+ * Note: producer lock is nested within consumer lock, so if you -+ * resize you must make sure all uses nest correctly. -+ * In particular if you consume ring in interrupt or BH context, you must -+ * disable interrupts/BH when doing so. -+ */ -+static inline int ptr_ring_resize_multiple(struct ptr_ring **rings, -+ unsigned int nrings, -+ int size, -+ gfp_t gfp, void (*destroy)(void *)) -+{ -+ unsigned long flags; -+ void ***queues; -+ int i; -+ -+ queues = kmalloc_array(nrings, sizeof(*queues), gfp); -+ if (!queues) -+ goto noqueues; -+ -+ for (i = 0; i < nrings; ++i) { -+ queues[i] = __ptr_ring_init_queue_alloc(size, gfp); -+ if (!queues[i]) -+ goto nomem; -+ } -+ -+ for (i = 0; i < nrings; ++i) { -+ spin_lock_irqsave(&(rings[i])->consumer_lock, flags); -+ spin_lock(&(rings[i])->producer_lock); -+ queues[i] = __ptr_ring_swap_queue(rings[i], queues[i], -+ size, gfp, destroy); -+ spin_unlock(&(rings[i])->producer_lock); -+ spin_unlock_irqrestore(&(rings[i])->consumer_lock, flags); -+ } -+ -+ for (i = 0; i < nrings; ++i) -+ kfree(queues[i]); -+ -+ kfree(queues); -+ -+ return 0; -+ -+nomem: -+ while (--i >= 0) -+ kfree(queues[i]); -+ -+ kfree(queues); -+ -+noqueues: -+ return -ENOMEM; -+} -+ -+static inline void ptr_ring_cleanup(struct ptr_ring *r, void (*destroy)(void *)) -+{ -+ void *ptr; -+ -+ if (destroy) -+ while ((ptr = ptr_ring_consume(r))) -+ destroy(ptr); -+ kfree(r->queue); -+} -+ -+#endif /* _LINUX_PTR_RING_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/memneq/include.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,5 @@ -+extern noinline unsigned long __crypto_memneq(const void *a, const void *b, size_t size); -+static inline int crypto_memneq(const void *a, const void *b, size_t size) -+{ -+ return __crypto_memneq(a, b, size) != 0UL ? 1 : 0; -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/memneq/memneq.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,170 @@ -+/* -+ * Constant-time equality testing of memory regions. -+ * -+ * Authors: -+ * -+ * James Yonan -+ * Daniel Borkmann -+ * -+ * This file is provided under a dual BSD/GPLv2 license. When using or -+ * redistributing this file, you may do so under either license. -+ * -+ * GPL LICENSE SUMMARY -+ * -+ * Copyright(c) 2013 OpenVPN Technologies, Inc. All rights reserved. -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of version 2 of the GNU General Public License as -+ * published by the Free Software Foundation. -+ * -+ * This program is distributed in the hope that it will be useful, but -+ * WITHOUT ANY WARRANTY; without even the implied warranty of -+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU -+ * General Public License for more details. -+ * -+ * You should have received a copy of the GNU General Public License -+ * along with this program; if not, write to the Free Software -+ * Foundation, Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. -+ * The full GNU General Public License is included in this distribution -+ * in the file called LICENSE.GPL. -+ * -+ * BSD LICENSE -+ * -+ * Copyright(c) 2013 OpenVPN Technologies, Inc. All rights reserved. -+ * -+ * Redistribution and use in source and binary forms, with or without -+ * modification, are permitted provided that the following conditions -+ * are met: -+ * -+ * * Redistributions of source code must retain the above copyright -+ * notice, this list of conditions and the following disclaimer. -+ * * Redistributions in binary form must reproduce the above copyright -+ * notice, this list of conditions and the following disclaimer in -+ * the documentation and/or other materials provided with the -+ * distribution. -+ * * Neither the name of OpenVPN Technologies nor the names of its -+ * contributors may be used to endorse or promote products derived -+ * from this software without specific prior written permission. -+ * -+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS -+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT -+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR -+ * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT -+ * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, -+ * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT -+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, -+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY -+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT -+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE -+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. -+ */ -+ -+#include -+ -+/* Make the optimizer believe the variable can be manipulated arbitrarily. */ -+#define COMPILER_OPTIMIZER_HIDE_VAR(var) asm("" : "=r" (var) : "0" (var)) -+ -+#ifndef __HAVE_ARCH_CRYPTO_MEMNEQ -+ -+/* Generic path for arbitrary size */ -+static inline unsigned long -+__crypto_memneq_generic(const void *a, const void *b, size_t size) -+{ -+ unsigned long neq = 0; -+ -+#if defined(CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS) -+ while (size >= sizeof(unsigned long)) { -+ neq |= *(unsigned long *)a ^ *(unsigned long *)b; -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ a += sizeof(unsigned long); -+ b += sizeof(unsigned long); -+ size -= sizeof(unsigned long); -+ } -+#endif /* CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS */ -+ while (size > 0) { -+ neq |= *(unsigned char *)a ^ *(unsigned char *)b; -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ a += 1; -+ b += 1; -+ size -= 1; -+ } -+ return neq; -+} -+ -+/* Loop-free fast-path for frequently used 16-byte size */ -+static inline unsigned long __crypto_memneq_16(const void *a, const void *b) -+{ -+ unsigned long neq = 0; -+ -+#ifdef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS -+ if (sizeof(unsigned long) == 8) { -+ neq |= *(unsigned long *)(a) ^ *(unsigned long *)(b); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned long *)(a+8) ^ *(unsigned long *)(b+8); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ } else if (sizeof(unsigned int) == 4) { -+ neq |= *(unsigned int *)(a) ^ *(unsigned int *)(b); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned int *)(a+4) ^ *(unsigned int *)(b+4); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned int *)(a+8) ^ *(unsigned int *)(b+8); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned int *)(a+12) ^ *(unsigned int *)(b+12); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ } else -+#endif /* CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS */ -+ { -+ neq |= *(unsigned char *)(a) ^ *(unsigned char *)(b); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+1) ^ *(unsigned char *)(b+1); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+2) ^ *(unsigned char *)(b+2); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+3) ^ *(unsigned char *)(b+3); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+4) ^ *(unsigned char *)(b+4); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+5) ^ *(unsigned char *)(b+5); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+6) ^ *(unsigned char *)(b+6); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+7) ^ *(unsigned char *)(b+7); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+8) ^ *(unsigned char *)(b+8); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+9) ^ *(unsigned char *)(b+9); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+10) ^ *(unsigned char *)(b+10); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+11) ^ *(unsigned char *)(b+11); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+12) ^ *(unsigned char *)(b+12); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+13) ^ *(unsigned char *)(b+13); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+14) ^ *(unsigned char *)(b+14); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ neq |= *(unsigned char *)(a+15) ^ *(unsigned char *)(b+15); -+ COMPILER_OPTIMIZER_HIDE_VAR(neq); -+ } -+ -+ return neq; -+} -+ -+/* Compare two areas of memory without leaking timing information, -+ * and with special optimizations for common sizes. Users should -+ * not call this function directly, but should instead use -+ * crypto_memneq defined in crypto/algapi.h. -+ */ -+noinline unsigned long __crypto_memneq(const void *a, const void *b, -+ size_t size) -+{ -+ switch (size) { -+ case 16: -+ return __crypto_memneq_16(a, b); -+ default: -+ return __crypto_memneq_generic(a, b, size); -+ } -+} -+ -+#endif /* __HAVE_ARCH_CRYPTO_MEMNEQ */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/dst_cache/dst_cache.c 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,175 @@ -+/* -+ * net/core/dst_cache.c - dst entry cache -+ * -+ * Copyright (c) 2016 Paolo Abeni -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License as published by -+ * the Free Software Foundation; either version 2 of the License, or -+ * (at your option) any later version. -+ */ -+ -+#include -+#include -+#include -+#include -+#if IS_ENABLED(CONFIG_IPV6) -+#include -+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0) && LINUX_VERSION_CODE >= KERNEL_VERSION(3, 17, 0)) || LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 50) -+static inline u32 rt6_get_cookie(const struct rt6_info *rt) -+{ -+ if ((unlikely(rt->dst.flags & DST_NOCACHE) && rt->dst.from)) -+ rt = (struct rt6_info *)(rt->dst.from); -+ -+ return rt->rt6i_node ? rt->rt6i_node->fn_sernum : 0; -+} -+#endif -+#endif -+#include -+ -+struct dst_cache_pcpu { -+ unsigned long refresh_ts; -+ struct dst_entry *dst; -+ u32 cookie; -+ union { -+ struct in_addr in_saddr; -+ struct in6_addr in6_saddr; -+ }; -+}; -+ -+static void dst_cache_per_cpu_dst_set(struct dst_cache_pcpu *dst_cache, -+ struct dst_entry *dst, u32 cookie) -+{ -+ dst_release(dst_cache->dst); -+ if (dst) -+ dst_hold(dst); -+ -+ dst_cache->cookie = cookie; -+ dst_cache->dst = dst; -+} -+ -+static struct dst_entry *dst_cache_per_cpu_get(struct dst_cache *dst_cache, -+ struct dst_cache_pcpu *idst) -+{ -+ struct dst_entry *dst; -+ -+ dst = idst->dst; -+ if (!dst) -+ goto fail; -+ -+ /* the cache already hold a dst reference; it can't go away */ -+ dst_hold(dst); -+ -+ if (unlikely(!time_after(idst->refresh_ts, dst_cache->reset_ts) || -+ (dst->obsolete && !dst->ops->check(dst, idst->cookie)))) { -+ dst_cache_per_cpu_dst_set(idst, NULL, 0); -+ dst_release(dst); -+ goto fail; -+ } -+ return dst; -+ -+fail: -+ idst->refresh_ts = jiffies; -+ return NULL; -+} -+ -+struct dst_entry *dst_cache_get(struct dst_cache *dst_cache) -+{ -+ if (!dst_cache->cache) -+ return NULL; -+ -+ return dst_cache_per_cpu_get(dst_cache, this_cpu_ptr(dst_cache->cache)); -+} -+ -+struct rtable *dst_cache_get_ip4(struct dst_cache *dst_cache, __be32 *saddr) -+{ -+ struct dst_cache_pcpu *idst; -+ struct dst_entry *dst; -+ -+ if (!dst_cache->cache) -+ return NULL; -+ -+ idst = this_cpu_ptr(dst_cache->cache); -+ dst = dst_cache_per_cpu_get(dst_cache, idst); -+ if (!dst) -+ return NULL; -+ -+ *saddr = idst->in_saddr.s_addr; -+ return container_of(dst, struct rtable, dst); -+} -+ -+void dst_cache_set_ip4(struct dst_cache *dst_cache, struct dst_entry *dst, -+ __be32 saddr) -+{ -+ struct dst_cache_pcpu *idst; -+ -+ if (!dst_cache->cache) -+ return; -+ -+ idst = this_cpu_ptr(dst_cache->cache); -+ dst_cache_per_cpu_dst_set(idst, dst, 0); -+ idst->in_saddr.s_addr = saddr; -+} -+ -+#if IS_ENABLED(CONFIG_IPV6) -+void dst_cache_set_ip6(struct dst_cache *dst_cache, struct dst_entry *dst, -+ const struct in6_addr *addr) -+{ -+ struct dst_cache_pcpu *idst; -+ -+ if (!dst_cache->cache) -+ return; -+ -+ idst = this_cpu_ptr(dst_cache->cache); -+ dst_cache_per_cpu_dst_set(this_cpu_ptr(dst_cache->cache), dst, -+ rt6_get_cookie((struct rt6_info *)dst)); -+ idst->in6_saddr = *addr; -+} -+ -+struct dst_entry *dst_cache_get_ip6(struct dst_cache *dst_cache, -+ struct in6_addr *saddr) -+{ -+ struct dst_cache_pcpu *idst; -+ struct dst_entry *dst; -+ -+ if (!dst_cache->cache) -+ return NULL; -+ -+ idst = this_cpu_ptr(dst_cache->cache); -+ dst = dst_cache_per_cpu_get(dst_cache, idst); -+ if (!dst) -+ return NULL; -+ -+ *saddr = idst->in6_saddr; -+ return dst; -+} -+#endif -+ -+int dst_cache_init(struct dst_cache *dst_cache, gfp_t gfp) -+{ -+#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 18, 0) -+ BUG_ON(gfp & GFP_ATOMIC); -+ dst_cache->cache = alloc_percpu(struct dst_cache_pcpu); -+#else -+ dst_cache->cache = alloc_percpu_gfp(struct dst_cache_pcpu, -+ gfp | __GFP_ZERO); -+#endif -+ if (!dst_cache->cache) -+ return -ENOMEM; -+ -+ dst_cache_reset(dst_cache); -+ return 0; -+} -+ -+void dst_cache_destroy(struct dst_cache *dst_cache) -+{ -+ int i; -+ -+ if (!dst_cache->cache) -+ return; -+ -+ for_each_possible_cpu(i) -+ dst_release(per_cpu_ptr(dst_cache->cache, i)->dst); -+ -+ free_percpu(dst_cache->cache); -+} ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/dst_cache/include/net/dst_cache.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,97 @@ -+#ifndef _WG_NET_DST_CACHE_H -+#define _WG_NET_DST_CACHE_H -+ -+#include -+#include -+#if IS_ENABLED(CONFIG_IPV6) -+#include -+#endif -+ -+struct dst_cache { -+ struct dst_cache_pcpu __percpu *cache; -+ unsigned long reset_ts; -+}; -+ -+/** -+ * dst_cache_get - perform cache lookup -+ * @dst_cache: the cache -+ * -+ * The caller should use dst_cache_get_ip4() if it need to retrieve the -+ * source address to be used when xmitting to the cached dst. -+ * local BH must be disabled. -+ */ -+struct dst_entry *dst_cache_get(struct dst_cache *dst_cache); -+ -+/** -+ * dst_cache_get_ip4 - perform cache lookup and fetch ipv4 source address -+ * @dst_cache: the cache -+ * @saddr: return value for the retrieved source address -+ * -+ * local BH must be disabled. -+ */ -+struct rtable *dst_cache_get_ip4(struct dst_cache *dst_cache, __be32 *saddr); -+ -+/** -+ * dst_cache_set_ip4 - store the ipv4 dst into the cache -+ * @dst_cache: the cache -+ * @dst: the entry to be cached -+ * @saddr: the source address to be stored inside the cache -+ * -+ * local BH must be disabled. -+ */ -+void dst_cache_set_ip4(struct dst_cache *dst_cache, struct dst_entry *dst, -+ __be32 saddr); -+ -+#if IS_ENABLED(CONFIG_IPV6) -+ -+/** -+ * dst_cache_set_ip6 - store the ipv6 dst into the cache -+ * @dst_cache: the cache -+ * @dst: the entry to be cached -+ * @saddr: the source address to be stored inside the cache -+ * -+ * local BH must be disabled. -+ */ -+void dst_cache_set_ip6(struct dst_cache *dst_cache, struct dst_entry *dst, -+ const struct in6_addr *addr); -+ -+/** -+ * dst_cache_get_ip6 - perform cache lookup and fetch ipv6 source address -+ * @dst_cache: the cache -+ * @saddr: return value for the retrieved source address -+ * -+ * local BH must be disabled. -+ */ -+struct dst_entry *dst_cache_get_ip6(struct dst_cache *dst_cache, -+ struct in6_addr *saddr); -+#endif -+ -+/** -+ * dst_cache_reset - invalidate the cache contents -+ * @dst_cache: the cache -+ * -+ * This do not free the cached dst to avoid races and contentions. -+ * the dst will be freed on later cache lookup. -+ */ -+static inline void dst_cache_reset(struct dst_cache *dst_cache) -+{ -+ dst_cache->reset_ts = jiffies; -+} -+ -+/** -+ * dst_cache_init - initialize the cache, allocating the required storage -+ * @dst_cache: the cache -+ * @gfp: allocation flags -+ */ -+int dst_cache_init(struct dst_cache *dst_cache, gfp_t gfp); -+ -+/** -+ * dst_cache_destroy - empty the cache and free the allocated storage -+ * @dst_cache: the cache -+ * -+ * No synchronization is enforced: it must be called only when the cache -+ * is unsed. -+ */ -+void dst_cache_destroy(struct dst_cache *dst_cache); -+ -+#endif /* _WG_NET_DST_CACHE_H */ ---- /dev/null 2018-03-04 21:55:12.891724619 +0200 -+++ b/net/wireguard/compat/compat-asm.h 2018-03-04 19:51:33.000000000 +0200 -@@ -0,0 +1,18 @@ -+/* SPDX-License-Identifier: GPL-2.0 -+ * -+ * Copyright (C) 2015-2018 Jason A. Donenfeld . All Rights Reserved. -+ */ -+ -+#ifndef _WG_COMPATASM_H -+#define _WG_COMPATASM_H -+ -+#include -+#include -+ -+/* PaX compatibility */ -+#if defined(RAP_PLUGIN) -+#undef ENTRY -+#define ENTRY RAP_ENTRY -+#endif -+ -+#endif /* _WG_COMPATASM_H */ ---- a/net/Kconfig -+++ b/net/Kconfig -@@ -85,2 +85,3 @@ config INET - if INET -+source "net/wireguard/Kconfig" - source "net/ipv4/Kconfig" ---- a/net/Makefile -+++ b/net/Makefile -@@ -16,2 +16,3 @@ - obj-$(CONFIG_NETFILTER) += netfilter/ -+obj-$(CONFIG_WIREGUARD) += wireguard/ - obj-$(CONFIG_INET) += ipv4/ diff --git a/kernel/kernel/files/patches/mageia/net-ipv4-netfilter-ipt_IFWLOG-3.6-buildfix.patch b/kernel/kernel/files/patches/mageia/net-ipv4-netfilter-ipt_IFWLOG-3.6-buildfix.patch deleted file mode 100644 index 51041b6f..00000000 --- a/kernel/kernel/files/patches/mageia/net-ipv4-netfilter-ipt_IFWLOG-3.6-buildfix.patch +++ /dev/null @@ -1,33 +0,0 @@ - -Adapt to netlink changes in 3.6 - -Signed-off-by: Thomas Backlund - ---- linux/net/ipv4/netfilter/ipt_IFWLOG.c.orig 2012-10-17 22:44:57.000000000 +0300 -+++ linux/net/ipv4/netfilter/ipt_IFWLOG.c 2012-10-17 23:17:10.012725918 +0300 -@@ -56,9 +56,9 @@ static void send_packet(const struct nl_ - return; - } - -- nlh = NLMSG_PUT(skb, 0, 0, 0, size - sizeof(*nlh)); -+ nlh = nlmsg_put(skb, 0, 0, 0, size - sizeof(*nlh), 0); - -- memcpy(NLMSG_DATA(nlh), (const void *) msg, sizeof(*msg)); -+ memcpy(nlmsg_data(nlh), (const void *) msg, sizeof(*msg)); - - NETLINK_CB(skb).pid = 0; /* from kernel */ - NETLINK_CB(skb).dst_group = IFWLOGNLGRP_DEF; -@@ -169,9 +169,11 @@ static struct xt_target ipt_IFWLOG = { - static int __init ipt_ifwlog_init(void) - { - int err; -+ struct netlink_kernel_cfg cfg = { -+ .groups = IFWLOGNLGRP_MAX, -+ }; - -- nl = netlink_kernel_create(&init_net, NETLINK_IFWLOG, IFWLOGNLGRP_MAX, -- NULL, NULL, THIS_MODULE); -+ nl = netlink_kernel_create(&init_net, NETLINK_IFWLOG, THIS_MODULE, &cfg); - if (!nl) { - PRINTR(KERN_WARNING "IFWLOG: cannot create netlink socket\n"); - return -ENOMEM; diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-2.6.35-buildfix.patch b/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-2.6.35-buildfix.patch deleted file mode 100644 index 99d4d063..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-2.6.35-buildfix.patch +++ /dev/null @@ -1,32 +0,0 @@ ---- linux-2.6.35-rc6-git-mnb0.1/net/ipv4/netfilter/ipt_IFWLOG.c.orig 2010-07-30 21:17:30.000000000 +0300 -+++ linux-2.6.35-rc6-git-mnb0.1/net/ipv4/netfilter/ipt_IFWLOG.c 2010-07-31 13:46:33.834611944 +0300 -@@ -135,7 +135,7 @@ static void ipt_IFWLOG_packet(const stru - } - - static unsigned int ipt_IFWLOG_target(struct sk_buff *skb, -- const struct xt_target_param *target_param) -+ const struct xt_action_param *target_param) - { - const struct ipt_IFWLOG_info *info = target_param->targinfo; - -@@ -144,17 +144,17 @@ static unsigned int ipt_IFWLOG_target(st - return IPT_CONTINUE; - } - --static bool ipt_IFWLOG_checkentry(const struct xt_tgchk_param *tgchk_param) -+static int ipt_IFWLOG_checkentry(const struct xt_tgchk_param *tgchk_param) - { - const struct ipt_IFWLOG_info *info = tgchk_param->targinfo; - - if (info->prefix[sizeof(info->prefix)-1] != '\0') { - DEBUGP("IFWLOG: prefix term %i\n", - info->prefix[sizeof(info->prefix)-1]); -- return false; -+ return -EINVAL; - } - -- return true; -+ return 0; - } - - static struct xt_target ipt_IFWLOG = { diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-2.6.37-buildfix.patch b/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-2.6.37-buildfix.patch deleted file mode 100644 index 0ae95aa3..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-2.6.37-buildfix.patch +++ /dev/null @@ -1,15 +0,0 @@ - - net/ipv4/netfilter/ipt_IFWLOG.c | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - ---- linux-2.6.37-rc3-git1-tmb0.3/net/ipv4/netfilter/ipt_IFWLOG.c.orig 2010-11-24 21:58:36.000000000 +0200 -+++ linux-2.6.37-rc3-git1-tmb0.3/net/ipv4/netfilter/ipt_IFWLOG.c 2010-11-25 13:08:55.719379646 +0200 -@@ -141,7 +141,7 @@ static unsigned int ipt_IFWLOG_target(st - - ipt_IFWLOG_packet(skb, target_param->in, target_param->out, info); - -- return IPT_CONTINUE; -+ return XT_CONTINUE; - } - - static int ipt_IFWLOG_checkentry(const struct xt_tgchk_param *tgchk_param) diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-3.7-buildfix.patch b/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-3.7-buildfix.patch deleted file mode 100644 index 744e840f..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-3.7-buildfix.patch +++ /dev/null @@ -1,20 +0,0 @@ ---- linux-3.7-rc8/net/ipv4/netfilter/ipt_IFWLOG.c.orig 2012-12-06 19:50:10.000000000 +0200 -+++ linux-3.7-rc8/net/ipv4/netfilter/ipt_IFWLOG.c 2012-12-06 20:55:23.669152916 +0200 -@@ -60,7 +60,7 @@ static void send_packet(const struct nl_ - - memcpy(nlmsg_data(nlh), (const void *) msg, sizeof(*msg)); - -- NETLINK_CB(skb).pid = 0; /* from kernel */ -+ NETLINK_CB(skb).portid = 0; /* from kernel */ - NETLINK_CB(skb).dst_group = IFWLOGNLGRP_DEF; - - if (nl) { -@@ -173,7 +173,7 @@ static int __init ipt_ifwlog_init(void) - .groups = IFWLOGNLGRP_MAX, - }; - -- nl = netlink_kernel_create(&init_net, NETLINK_IFWLOG, THIS_MODULE, &cfg); -+ nl = netlink_kernel_create(&init_net, NETLINK_IFWLOG, &cfg); - if (!nl) { - PRINTR(KERN_WARNING "IFWLOG: cannot create netlink socket\n"); - return -ENOMEM; diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-mdv.patch b/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-mdv.patch deleted file mode 100644 index b56387f7..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-mdv.patch +++ /dev/null @@ -1,254 +0,0 @@ -ipt_IFWLOG: Mandriva changes - -This patch holds all the Mandriva changes done in ipt_IFWLOG -netfilter module. - -This work is mostly done by Thomas Backlund, Herton R. Krzesinski -and Luiz Fernando N. Capitulino. - -Signed-off-by: Luiz Fernando N. Capitulino -Signed-off-by: Herton Ronaldo Krzesinski -[moved header to uapi for kernel-4.12.4 / tmb] -Signed-off-by Thomas Backlund ---- - include/linux/netfilter_ipv4/ipt_IFWLOG.h | 23 +++++- - net/ipv4/netfilter/ipt_IFWLOG.c | 108 +++++++++++++++--------------- - 2 files changed, 77 insertions(+), 55 deletions(-) - -diff -p -up linux/include/uapi/linux/netfilter_ipv4/ipt_IFWLOG.h.orig linux/include/uapi/linux/netfilter_ipv4/ipt_IFWLOG.h ---- linux-2.6.28/include/uapi/linux/netfilter_ipv4/ipt_IFWLOG.h.orig -+++ linux-2.6.28/include/uapi/linux/netfilter_ipv4/ipt_IFWLOG.h -@@ -1,10 +1,25 @@ --#ifndef _IPT_IFWLOG_H --#define _IPT_IFWLOG_H -+#ifndef _LINUX_IPT_IFWLOG_H -+#define _LINUX_IPT_IFWLOG_H - - #ifndef NETLINK_IFWLOG --#define NETLINK_IFWLOG 19 -+#define NETLINK_IFWLOG 20 - #endif - -+#ifndef __KERNEL__ -+/* Multicast groups - backwards compatiblility for userspace */ -+#define IFWLOG_NLGRP_NONE 0x00000000 -+#define IFWLOG_NLGRP_DEF 0x00000001 /* default message group */ -+#endif -+ -+enum { -+ IFWLOGNLGRP_NONE, -+#define IFWLOGNLGRP_NONE IFWLOGNLGRP_NONE -+ IFWLOGNLGRP_DEF, -+#define IFWLOGNLGRP_DEF IFWLOGNLGRP_DEF -+ __IFWLOGNLGRP_MAX -+}; -+#define IFWLOGNLGRP_MAX (__IFWLOGNLGRP_MAX - 1) -+ - #define PREFSIZ 32 - - struct nl_msg { /* Netlink message */ -@@ -23,4 +38,4 @@ struct ipt_IFWLOG_info { - char prefix[PREFSIZ]; - }; - --#endif /* _IPT_IFWLOG_H */ -+#endif /* _LINUX_IPT_IFWLOG_H */ -diff -p -up linux-2.6.28/net/ipv4/netfilter/ipt_IFWLOG.c.orig linux-2.6.28/net/ipv4/netfilter/ipt_IFWLOG.c ---- linux-2.6.28/net/ipv4/netfilter/ipt_IFWLOG.c.orig 2008-12-12 10:55:07.000000000 -0500 -+++ linux-2.6.28/net/ipv4/netfilter/ipt_IFWLOG.c 2008-12-12 10:57:16.000000000 -0500 -@@ -4,6 +4,14 @@ - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License version 2 as - * published by the Free Software Foundation. -+ * -+ * 2007-10-10 Thomas Backlund : build fixes for 2.6.22.9 -+ * 2007-11-11 Herton Krzesinski : build fixes for 2.6.24-rc -+ * 2007-12-03 Luiz Capitulino : v1.1 -+ * - Better multicast group usage -+ * - Coding style fixes -+ * - Do not return -EINVAL by default in ipt_ifwlog_init() -+ * - Minor refinements - */ - - #include -@@ -19,12 +27,10 @@ - #include - - #include -+#include - #include - #include - --MODULE_LICENSE("GPL"); --MODULE_AUTHOR("Samir Bellabes "); --MODULE_DESCRIPTION("Interactive firewall logging and module"); - - #if 0 - #define DEBUGP PRINTR -@@ -36,44 +42,41 @@ MODULE_DESCRIPTION("Interactive firewall - - static struct sock *nl; - --#define GROUP 10 -- - /* send struct to userspace */ --static void send_packet(struct nl_msg msg) -+static void send_packet(const struct nl_msg *msg) - { - struct sk_buff *skb = NULL; - struct nlmsghdr *nlh; -+ unsigned int size; - -- skb = alloc_skb(NLMSG_SPACE(sizeof(struct nl_msg)), GFP_ATOMIC); -+ size = NLMSG_SPACE(sizeof(*msg)); -+ skb = alloc_skb(size, GFP_ATOMIC); - if (!skb) { - PRINTR(KERN_WARNING "IFWLOG: OOM can't allocate skb\n"); -- return ; -+ return; - } - -- nlh = NLMSG_PUT(skb, 0, 0, 0, sizeof(struct nl_msg) - sizeof(*nlh)); -+ nlh = NLMSG_PUT(skb, 0, 0, 0, size - sizeof(*nlh)); - -- memcpy(NLMSG_DATA(nlh), (const void*)&msg, sizeof(struct nl_msg)); -+ memcpy(NLMSG_DATA(nlh), (const void *) msg, sizeof(*msg)); - - NETLINK_CB(skb).pid = 0; /* from kernel */ -- NETLINK_CB(skb).dst_pid = 0; /* multicast */ -- NETLINK_CB(skb).dst_group = 10; -+ NETLINK_CB(skb).dst_group = IFWLOGNLGRP_DEF; - - if (nl) { - DEBUGP(KERN_WARNING - "IFWLOG: nlmsg_len=%ld\nnlmsg_type=%d nlmsg_flags=%d\nnlmsg_seq=%ld nlmsg_pid = %ld\n", - (long)nlh->nlmsg_len, nlh->nlmsg_type, nlh->nlmsg_flags, - (long)nlh->nlmsg_seq, (long)nlh->nlmsg_pid); -- DEBUGP(KERN_WARNING "prefix : %s\n", msg.prefix); -+ DEBUGP(KERN_WARNING "prefix : %s\n", msg->prefix); - -- netlink_broadcast(nl, skb, 0, 10, GFP_ATOMIC); -- return ; -+ netlink_broadcast(nl, skb, 0, IFWLOGNLGRP_DEF, GFP_ATOMIC); -+ return; - } - -- nlmsg_failure: -- if (skb) -- kfree_skb(skb); -- PRINTR(KERN_WARNING "IFWLOG: Error sending netlink packet\n"); -- return ; -+nlmsg_failure: -+ kfree_skb(skb); -+ PRINTR(KERN_WARNING "IFWLOG: Error sending netlink packet\n"); - } - - /* fill struct for userspace */ -@@ -128,73 +131,76 @@ static void ipt_IFWLOG_packet(const stru - do_gettimeofday((struct timeval *)&tv); - msg.timestamp_sec = tv.tv_sec; - -- send_packet(msg); -+ send_packet(&msg); - } - --static unsigned int ipt_IFWLOG_target(struct sk_buff **pskb, -- const struct net_device *in, -- const struct net_device *out, -- unsigned int hooknum, -- const void *targinfo, -- void *userinfo) -+static unsigned int ipt_IFWLOG_target(struct sk_buff *skb, -+ const struct xt_target_param *target_param) - { -- const struct ipt_IFWLOG_info *info = targinfo; -+ const struct ipt_IFWLOG_info *info = target_param->targinfo; - -- ipt_IFWLOG_packet(*pskb, in, out, info); -+ ipt_IFWLOG_packet(skb, target_param->in, target_param->out, info); - - return IPT_CONTINUE; - } - --static int ipt_IFWLOG_checkentry(const char *tablename, -- const struct ipt_entry *e, -- void *targinfo, -- unsigned int targinfosize, -- unsigned int hook_mask) -+static bool ipt_IFWLOG_checkentry(const struct xt_tgchk_param *tgchk_param) - { -- const struct ipt_IFWLOG_info *info = targinfo; -+ const struct ipt_IFWLOG_info *info = tgchk_param->targinfo; - - if (info->prefix[sizeof(info->prefix)-1] != '\0') { - DEBUGP("IFWLOG: prefix term %i\n", - info->prefix[sizeof(info->prefix)-1]); -- return 0; -+ return false; - } - -- return 1; -+ return true; - } - --static struct ipt_target ipt_IFWLOG = { -+static struct xt_target ipt_IFWLOG = { - .name = "IFWLOG", -+ .family = AF_INET, - .target = ipt_IFWLOG_target, - .targetsize = sizeof(struct ipt_IFWLOG_info), - .checkentry = ipt_IFWLOG_checkentry, - .me = THIS_MODULE, - }; - --static int __init init(void) -+static int __init ipt_ifwlog_init(void) - { -- nl = (struct sock*) netlink_kernel_create(NETLINK_IFWLOG, GROUP, NULL, THIS_MODULE); -- if (!nl) { -- PRINTR(KERN_WARNING "IFWLOG: cannot create netlink socket\n"); -- return -EINVAL; -- } -+ int err; - -- if (ipt_register_target(&ipt_IFWLOG)) { -+ nl = netlink_kernel_create(&init_net, NETLINK_IFWLOG, IFWLOGNLGRP_MAX, -+ NULL, NULL, THIS_MODULE); -+ if (!nl) { -+ PRINTR(KERN_WARNING "IFWLOG: cannot create netlink socket\n"); -+ return -ENOMEM; -+ } -+ -+ err = xt_register_target(&ipt_IFWLOG); -+ if (err) { - if (nl && nl->sk_socket) - sock_release(nl->sk_socket); -- return -EINVAL; -+ return err; - } - - PRINTR(KERN_INFO "IFWLOG: register target\n"); - return 0; - } - --static void __exit fini(void) -+static void __exit ipt_ifwlog_fini(void) - { - if (nl && nl->sk_socket) -- sock_release(nl->sk_socket); -+ sock_release(nl->sk_socket); - PRINTR(KERN_INFO "IFWLOG: unregister target\n"); -- ipt_unregister_target(&ipt_IFWLOG); -+ xt_unregister_target(&ipt_IFWLOG); - } - --module_init(init); --module_exit(fini); -+module_init(ipt_ifwlog_init); -+module_exit(ipt_ifwlog_fini); -+ -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Samir Bellabes "); -+MODULE_AUTHOR("Luiz Capitulino "); -+MODULE_DESCRIPTION("Interactive firewall logging and module"); -+MODULE_VERSION("v1.1"); diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-remove-unused-label.patch b/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-remove-unused-label.patch deleted file mode 100644 index b2c71eab..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG-remove-unused-label.patch +++ /dev/null @@ -1,10 +0,0 @@ ---- linux-4.4/net/ipv4/netfilter/ipt_IFWLOG.c~ 2016-01-24 13:19:13.233713998 +0100 -+++ linux-4.4/net/ipv4/netfilter/ipt_IFWLOG.c 2016-01-24 20:49:10.145823623 +0100 -@@ -74,7 +74,6 @@ - return; - } - --nlmsg_failure: - kfree_skb(skb); - PRINTR(KERN_WARNING "IFWLOG: Error sending netlink packet\n"); - } diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG.patch b/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG.patch deleted file mode 100644 index 0ab4f6ff..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-IFWLOG.patch +++ /dev/null @@ -1,273 +0,0 @@ - -[moved header to uapi for kernel-4.12.4 / tmb] -Signed-off-by Thomas Backlund - ---- - include/uapi/linux/netfilter_ipv4/ipt_IFWLOG.h | 26 +++ - net/ipv4/netfilter/Kconfig | 11 + - net/ipv4/netfilter/Makefile | 1 - net/ipv4/netfilter/ipt_IFWLOG.c | 200 ++++++++++++++++++++++++++++++ - 4 files changed, 238 insertions(+) - ---- /dev/null -+++ b/net/ipv4/netfilter/ipt_IFWLOG.c -@@ -0,0 +1,200 @@ -+/* Interactive Firewall for Mandriva -+ * Samir Bellabes -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License version 2 as -+ * published by the Free Software Foundation. -+ */ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include -+#include -+#include -+ -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Samir Bellabes "); -+MODULE_DESCRIPTION("Interactive firewall logging and module"); -+ -+#if 0 -+#define DEBUGP PRINTR -+#else -+#define DEBUGP(format, args...) -+#endif -+ -+#define PRINTR(format, args...) do { if(net_ratelimit()) printk(format, ##args); } while(0) -+ -+static struct sock *nl; -+ -+#define GROUP 10 -+ -+/* send struct to userspace */ -+static void send_packet(struct nl_msg msg) -+{ -+ struct sk_buff *skb = NULL; -+ struct nlmsghdr *nlh; -+ -+ skb = alloc_skb(NLMSG_SPACE(sizeof(struct nl_msg)), GFP_ATOMIC); -+ if (!skb) { -+ PRINTR(KERN_WARNING "IFWLOG: OOM can't allocate skb\n"); -+ return ; -+ } -+ -+ nlh = NLMSG_PUT(skb, 0, 0, 0, sizeof(struct nl_msg) - sizeof(*nlh)); -+ -+ memcpy(NLMSG_DATA(nlh), (const void*)&msg, sizeof(struct nl_msg)); -+ -+ NETLINK_CB(skb).pid = 0; /* from kernel */ -+ NETLINK_CB(skb).dst_pid = 0; /* multicast */ -+ NETLINK_CB(skb).dst_group = 10; -+ -+ if (nl) { -+ DEBUGP(KERN_WARNING -+ "IFWLOG: nlmsg_len=%ld\nnlmsg_type=%d nlmsg_flags=%d\nnlmsg_seq=%ld nlmsg_pid = %ld\n", -+ (long)nlh->nlmsg_len, nlh->nlmsg_type, nlh->nlmsg_flags, -+ (long)nlh->nlmsg_seq, (long)nlh->nlmsg_pid); -+ DEBUGP(KERN_WARNING "prefix : %s\n", msg.prefix); -+ -+ netlink_broadcast(nl, skb, 0, 10, GFP_ATOMIC); -+ return ; -+ } -+ -+ nlmsg_failure: -+ if (skb) -+ kfree_skb(skb); -+ PRINTR(KERN_WARNING "IFWLOG: Error sending netlink packet\n"); -+ return ; -+} -+ -+/* fill struct for userspace */ -+static void ipt_IFWLOG_packet(const struct sk_buff *skb, -+ const struct net_device *in, -+ const struct net_device *out, -+ const struct ipt_IFWLOG_info *info) -+{ -+ struct iphdr iph; -+ struct tcphdr tcph; -+ struct udphdr udph; -+ struct nl_msg msg; -+ struct iphdr _iph, *ih; -+ struct timeval tv; -+ -+ memset(&msg, 0, sizeof(struct nl_msg)); -+ -+ ih = skb_header_pointer(skb, 0, sizeof(_iph), &_iph); -+ if (ih == NULL) { -+ PRINTR(KERN_WARNING "IFWLOG: skb truncated"); -+ return; -+ } -+ -+ /* save interface name */ -+ if (in) -+ strcpy(msg.indev_name, in->name); -+ if (out) -+ strcpy(msg.outdev_name, out->name); -+ -+ /* save log-prefix */ -+ strcpy(msg.prefix, info->prefix); -+ -+ /* save ip header */ -+ skb_copy_bits(skb, 0, &iph, sizeof(iph)); -+ memcpy(&msg.ip, &iph, sizeof(struct iphdr)); -+ -+ /* save transport header */ -+ switch (iph.protocol){ -+ case IPPROTO_TCP: -+ skb_copy_bits(skb, iph.ihl*4 , &tcph, sizeof(tcph)); -+ memcpy(&msg.h.th, &tcph, sizeof(struct tcphdr)); -+ break; -+ case IPPROTO_UDP: -+ skb_copy_bits(skb, iph.ihl*4 , &udph, sizeof(udph)); -+ memcpy(&msg.h.uh, &udph, sizeof(struct udphdr)); -+ break; -+ default: -+ break; -+ } -+ -+ /* save timetamp */ -+ do_gettimeofday((struct timeval *)&tv); -+ msg.timestamp_sec = tv.tv_sec; -+ -+ send_packet(msg); -+} -+ -+static unsigned int ipt_IFWLOG_target(struct sk_buff **pskb, -+ const struct net_device *in, -+ const struct net_device *out, -+ unsigned int hooknum, -+ const void *targinfo, -+ void *userinfo) -+{ -+ const struct ipt_IFWLOG_info *info = targinfo; -+ -+ ipt_IFWLOG_packet(*pskb, in, out, info); -+ -+ return IPT_CONTINUE; -+} -+ -+static int ipt_IFWLOG_checkentry(const char *tablename, -+ const struct ipt_entry *e, -+ void *targinfo, -+ unsigned int targinfosize, -+ unsigned int hook_mask) -+{ -+ const struct ipt_IFWLOG_info *info = targinfo; -+ -+ if (info->prefix[sizeof(info->prefix)-1] != '\0') { -+ DEBUGP("IFWLOG: prefix term %i\n", -+ info->prefix[sizeof(info->prefix)-1]); -+ return 0; -+ } -+ -+ return 1; -+} -+ -+static struct ipt_target ipt_IFWLOG = { -+ .name = "IFWLOG", -+ .target = ipt_IFWLOG_target, -+ .targetsize = sizeof(struct ipt_IFWLOG_info), -+ .checkentry = ipt_IFWLOG_checkentry, -+ .me = THIS_MODULE, -+}; -+ -+static int __init init(void) -+{ -+ nl = (struct sock*) netlink_kernel_create(NETLINK_IFWLOG, GROUP, NULL, THIS_MODULE); -+ if (!nl) { -+ PRINTR(KERN_WARNING "IFWLOG: cannot create netlink socket\n"); -+ return -EINVAL; -+ } -+ -+ if (ipt_register_target(&ipt_IFWLOG)) { -+ if (nl && nl->sk_socket) -+ sock_release(nl->sk_socket); -+ return -EINVAL; -+ } -+ -+ PRINTR(KERN_INFO "IFWLOG: register target\n"); -+ return 0; -+} -+ -+static void __exit fini(void) -+{ -+ if (nl && nl->sk_socket) -+ sock_release(nl->sk_socket); -+ PRINTR(KERN_INFO "IFWLOG: unregister target\n"); -+ ipt_unregister_target(&ipt_IFWLOG); -+} -+ -+module_init(init); -+module_exit(fini); ---- a/net/ipv4/netfilter/Kconfig -+++ b/net/ipv4/netfilter/Kconfig -@@ -331,6 +331,17 @@ config IP_NF_TARGET_TTL - (e.g. when running oldconfig). It selects - CONFIG_NETFILTER_XT_TARGET_HL. - -+config IP_NF_TARGET_IFWLOG -+ tristate 'IFWLOG target support' -+ depends on IP_NF_IPTABLES -+ help -+ This option adds a `IFWLOG' target, which is used by -+ Interactive Firewall for sending informations to a userspace -+ daemon -+ -+ If you want to compile it as a module, say M here and read -+ Documentation/modules.txt. If unsure, say `N'. -+ - # raw + specific targets - config IP_NF_RAW - tristate 'raw table support (required for NOTRACK/TRACE)' ---- /dev/null -+++ b/include/uapi/linux/netfilter_ipv4/ipt_IFWLOG.h -@@ -0,0 +1,26 @@ -+#ifndef _IPT_IFWLOG_H -+#define _IPT_IFWLOG_H -+ -+#ifndef NETLINK_IFWLOG -+#define NETLINK_IFWLOG 19 -+#endif -+ -+#define PREFSIZ 32 -+ -+struct nl_msg { /* Netlink message */ -+ long timestamp_sec; /* time packet */ -+ char indev_name[IFNAMSIZ]; /* name of the ingoing interface */ -+ char outdev_name[IFNAMSIZ]; /* name of the outgoing interface */ -+ unsigned char prefix[PREFSIZ]; /* informations on the logging reason */ -+ struct iphdr ip; -+ union { -+ struct tcphdr th; -+ struct udphdr uh; -+ } h; -+}; -+ -+struct ipt_IFWLOG_info { -+ char prefix[PREFSIZ]; -+}; -+ -+#endif /* _IPT_IFWLOG_H */ ---- linux/net/ipv4/netfilter/Makefile.net-netfilter-IFWLOG.orig 2013-10-13 11:29:08.799136037 +0300 -+++ linux/net/ipv4/netfilter/Makefile 2013-10-13 11:30:28.085842333 +0300 -@@ -44,6 +44,7 @@ obj-$(CONFIG_IP_NF_MATCH_RPFILTER) += ip - # targets - obj-$(CONFIG_IP_NF_TARGET_CLUSTERIP) += ipt_CLUSTERIP.o - obj-$(CONFIG_IP_NF_TARGET_ECN) += ipt_ECN.o -+obj-$(CONFIG_IP_NF_TARGET_IFWLOG) += ipt_IFWLOG.o - obj-$(CONFIG_IP_NF_TARGET_MASQUERADE) += ipt_MASQUERADE.o - obj-$(CONFIG_IP_NF_TARGET_REJECT) += ipt_REJECT.o - obj-$(CONFIG_IP_NF_TARGET_SYNPROXY) += ipt_SYNPROXY.o diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-add-back-stackpointer-size-checks.patch b/kernel/kernel/files/patches/mageia/net-netfilter-add-back-stackpointer-size-checks.patch deleted file mode 100644 index 56c0f51b..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-add-back-stackpointer-size-checks.patch +++ /dev/null @@ -1,84 +0,0 @@ -From 57ebd808a97d7c5b1e1afb937c2db22beba3c1f8 Mon Sep 17 00:00:00 2001 -From: Florian Westphal -Date: Wed, 7 Feb 2018 13:46:25 +0100 -Subject: [PATCH] netfilter: add back stackpointer size checks - -The rationale for removing the check is only correct for rulesets -generated by ip(6)tables. - -In iptables, a jump can only occur to a user-defined chain, i.e. -because we size the stack based on number of user-defined chains we -cannot exceed stack size. - -However, the underlying binary format has no such restriction, -and the validation step only ensures that the jump target is a -valid rule start point. - -IOW, its possible to build a rule blob that has no user-defined -chains but does contain a jump. - -If this happens, no jump stack gets allocated and crash occurs -because no jumpstack was allocated. - -Fixes: 7814b6ec6d0d6 ("netfilter: xtables: don't save/restore jumpstack offset") -Reported-by: syzbot+e783f671527912cd9403@syzkaller.appspotmail.com -Signed-off-by: Florian Westphal -Signed-off-by: Pablo Neira Ayuso ---- - net/ipv4/netfilter/arp_tables.c | 4 ++++ - net/ipv4/netfilter/ip_tables.c | 7 ++++++- - net/ipv6/netfilter/ip6_tables.c | 4 ++++ - 3 files changed, 14 insertions(+), 1 deletion(-) - -diff --git a/net/ipv4/netfilter/arp_tables.c b/net/ipv4/netfilter/arp_tables.c -index 4ffe302f9b82..e3e420f3ba7b 100644 ---- a/net/ipv4/netfilter/arp_tables.c -+++ b/net/ipv4/netfilter/arp_tables.c -@@ -252,6 +252,10 @@ unsigned int arpt_do_table(struct sk_buff *skb, - } - if (table_base + v - != arpt_next_entry(e)) { -+ if (unlikely(stackidx >= private->stacksize)) { -+ verdict = NF_DROP; -+ break; -+ } - jumpstack[stackidx++] = e; - } - -diff --git a/net/ipv4/netfilter/ip_tables.c b/net/ipv4/netfilter/ip_tables.c -index 9a71f3149507..e38395a8dcf2 100644 ---- a/net/ipv4/netfilter/ip_tables.c -+++ b/net/ipv4/netfilter/ip_tables.c -@@ -330,8 +330,13 @@ ipt_do_table(struct sk_buff *skb, - continue; - } - if (table_base + v != ipt_next_entry(e) && -- !(e->ip.flags & IPT_F_GOTO)) -+ !(e->ip.flags & IPT_F_GOTO)) { -+ if (unlikely(stackidx >= private->stacksize)) { -+ verdict = NF_DROP; -+ break; -+ } - jumpstack[stackidx++] = e; -+ } - - e = get_entry(table_base, v); - continue; -diff --git a/net/ipv6/netfilter/ip6_tables.c b/net/ipv6/netfilter/ip6_tables.c -index af4c917e0836..62358b93bbac 100644 ---- a/net/ipv6/netfilter/ip6_tables.c -+++ b/net/ipv6/netfilter/ip6_tables.c -@@ -352,6 +352,10 @@ ip6t_do_table(struct sk_buff *skb, - } - if (table_base + v != ip6t_next_entry(e) && - !(e->ipv6.flags & IP6T_F_GOTO)) { -+ if (unlikely(stackidx >= private->stacksize)) { -+ verdict = NF_DROP; -+ break; -+ } - jumpstack[stackidx++] = e; - } - --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-ipt_IFWLOG-4.12-buildfix.patch b/kernel/kernel/files/patches/mageia/net-netfilter-ipt_IFWLOG-4.12-buildfix.patch deleted file mode 100644 index 451f7a1d..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-ipt_IFWLOG-4.12-buildfix.patch +++ /dev/null @@ -1,16 +0,0 @@ - -Adjust for kernel changes. - -Signed-off-by: Thomas Backlund - ---- linux/net/ipv4/netfilter/ipt_IFWLOG.c.orig -+++ linux/net/ipv4/netfilter/ipt_IFWLOG.c -@@ -138,7 +138,7 @@ static unsigned int ipt_IFWLOG_target(st - { - const struct ipt_IFWLOG_info *info = target_param->targinfo; - -- ipt_IFWLOG_packet(skb, target_param->in, target_param->out, info); -+ ipt_IFWLOG_packet(skb, xt_in(target_param), xt_out(target_param), info); - - return XT_CONTINUE; - } diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-psd-2.6.35-buildfix.patch b/kernel/kernel/files/patches/mageia/net-netfilter-psd-2.6.35-buildfix.patch deleted file mode 100644 index 218031c4..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-psd-2.6.35-buildfix.patch +++ /dev/null @@ -1,11 +0,0 @@ ---- linux-2.6.35-rc6-git-mnb0.1/net/ipv4/netfilter/ipt_psd.c.orig 2010-07-30 21:17:30.000000000 +0300 -+++ linux-2.6.35-rc6-git-mnb0.1/net/ipv4/netfilter/ipt_psd.c 2010-07-31 13:29:00.623601957 +0300 -@@ -98,7 +98,7 @@ static inline int hashfunc(struct in_add - - static bool - ipt_psd_match(const struct sk_buff *pskb, -- const struct xt_match_param *match_param) -+ struct xt_action_param *match_param) - { - struct iphdr *ip_hdr; - struct tcphdr *tcp_hdr; diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-psd-fix-redefines.patch b/kernel/kernel/files/patches/mageia/net-netfilter-psd-fix-redefines.patch deleted file mode 100644 index d71ffaa4..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-psd-fix-redefines.patch +++ /dev/null @@ -1,86 +0,0 @@ - -Make defines psd specific so they dont redefine in-kernel defines like -HASH_SIZE. - -[moved header to uapi for kernel-4.12.4 / tmb] -Signed-off-by Thomas Backlund - ---- - include/uapi/linux/netfilter_ipv4/ipt_psd.h | 14 +++++++------- - net/ipv4/netfilter/ipt_psd.c | 14 +++++++------- - 2 files changed, 14 insertions(+), 14 deletions(-) - -diff -Nurp linux-psd/include/uapi/linux/netfilter_ipv4/ipt_psd.h linux-psd-fix/include/uapi/linux/netfilter_ipv4/ipt_psd.h ---- linux-psd/include/uapi/linux/netfilter_ipv4/ipt_psd.h -+++ linux-psd-fix/include/uapi/linux/netfilter_ipv4/ipt_psd.h -@@ -21,14 +21,14 @@ - #define SCAN_DELAY_THRESHOLD (300) /* old usage of HZ here was erroneously and broke under uml */ - - /* -- * Keep track of up to LIST_SIZE source addresses, using a hash table of -- * HASH_SIZE entries for faster lookups, but limiting hash collisions to -- * HASH_MAX source addresses per the same hash value. -+ * Keep track of up to PSD_LIST_SIZE source addresses, using a hash table of -+ * PSD_HASH_SIZE entries for faster lookups, but limiting hash collisions to -+ * PSD_HASH_MAX source addresses per the same hash value. - */ --#define LIST_SIZE 0x100 --#define HASH_LOG 9 --#define HASH_SIZE (1 << HASH_LOG) --#define HASH_MAX 0x10 -+#define PSD_LIST_SIZE 0x100 -+#define PSD_HASH_LOG 9 -+#define PSD_HASH_SIZE (1 << PSD_HASH_LOG) -+#define PSD_HASH_MAX 0x10 - - struct ipt_psd_info { - unsigned int weight_threshold; -diff -Nurp linux-4.9.5-psd/net/ipv4/netfilter/ipt_psd.c linux-4.9.5-psd-fix/net/ipv4/netfilter/ipt_psd.c ---- linux-4.9.5-psd/net/ipv4/netfilter/ipt_psd.c 2017-01-20 21:47:19.792931402 +0200 -+++ linux-4.9.5-psd-fix/net/ipv4/netfilter/ipt_psd.c 2017-01-20 21:58:09.998871253 +0200 -@@ -74,8 +74,8 @@ struct host { - */ - static struct { - spinlock_t lock; -- struct host list[LIST_SIZE]; /* List of source addresses */ -- struct host *hash[HASH_SIZE]; /* Hash: pointers into the list */ -+ struct host list[PSD_LIST_SIZE]; /* List of source addresses */ -+ struct host *hash[PSD_HASH_SIZE]; /* Hash: pointers into the list */ - int index; /* Oldest entry to be replaced */ - } state; - -@@ -91,9 +91,9 @@ static inline int hashfunc(struct in_add - hash = 0; - do { - hash ^= value; -- } while ((value >>= HASH_LOG)); -+ } while ((value >>= PSD_HASH_LOG)); - -- return hash & (HASH_SIZE - 1); -+ return hash & (PSD_HASH_SIZE - 1); - } - - static bool -@@ -245,11 +245,11 @@ ipt_psd_match(const struct sk_buff *pskb - /* Got too many source addresses with the same hash value? Then remove the - * oldest one from the hash table, so that they can't take too much of our - * CPU time even with carefully chosen spoofed IP addresses. */ -- if (count >= HASH_MAX && last) last->next = NULL; -+ if (count >= PSD_HASH_MAX && last) last->next = NULL; - - /* We're going to re-use the oldest list entry, so remove it from the hash - * table first (if it is really already in use, and isn't removed from the -- * hash table already because of the HASH_MAX check above). */ -+ * hash table already because of the PSD_HASH_MAX check above). */ - - /* First, find it */ - if (state.list[state.index].src_addr.s_addr) -@@ -273,7 +273,7 @@ ipt_psd_match(const struct sk_buff *pskb - - /* Get our list entry */ - curr = &state.list[state.index++]; -- if (state.index >= LIST_SIZE) state.index = 0; -+ if (state.index >= PSD_LIST_SIZE) state.index = 0; - - /* Link it into the hash table */ - head = &state.hash[hash]; diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-psd-mdv.patch b/kernel/kernel/files/patches/mageia/net-netfilter-psd-mdv.patch deleted file mode 100644 index 0bbd42e6..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-psd-mdv.patch +++ /dev/null @@ -1,224 +0,0 @@ -ipt_psd: Mandriva changes - -This patch holds all the Mandriva changes done in ipt_psd -netfilter module. - -Most of the time they're just upgrades to match with new -API in the kernel. - -This work is mostly done by Thomas Backlund, Herton R. -Krzesinski and Luiz Fernando N. Capitulino. - -Signed-off-by: Luiz Fernando N. Capitulino -Signed-off-by: Herton Ronaldo Krzesinski - ---- - net/ipv4/netfilter/Kconfig | 8 ++ - net/ipv4/netfilter/ipt_psd.c | 113 ++++++++++++++---------------------- - 2 files changed, 55 insertions(+), 67 deletions(-) - -diff -p -up linux-2.6.28/net/ipv4/netfilter/ipt_psd.c.orig linux-2.6.28/net/ipv4/netfilter/ipt_psd.c ---- linux-2.6.28/net/ipv4/netfilter/ipt_psd.c.orig 2008-12-12 11:03:05.000000000 -0500 -+++ linux-2.6.28/net/ipv4/netfilter/ipt_psd.c 2008-12-12 11:04:03.000000000 -0500 -@@ -1,21 +1,24 @@ - /* -- This is a module which is used for PSD (portscan detection) -- Derived from scanlogd v2.1 written by Solar Designer -- and LOG target module. -- -- Copyright (C) 2000,2001 astaro AG -- -- This file is distributed under the terms of the GNU General Public -- License (GPL). Copies of the GPL can be obtained from: -- ftp://prep.ai.mit.edu/pub/gnu/GPL -- -- 2000-05-04 Markus Hennig : initial -- 2000-08-18 Dennis Koslowski : first release -- 2000-12-01 Dennis Koslowski : UDP scans detection added -- 2001-01-02 Dennis Koslowski : output modified -- 2001-02-04 Jan Rekorajski : converted from target to match -- 2004-05-05 Martijn Lievaart : ported to 2.6 --*/ -+ * This is a module which is used for PSD (portscan detection) -+ * Derived from scanlogd v2.1 written by Solar Designer -+ * and LOG target module. -+ * -+ * Copyright (C) 2000,2001 astaro AG -+ * -+ * This file is distributed under the terms of the GNU General Public -+ * License (GPL). Copies of the GPL can be obtained from: -+ * ftp://prep.ai.mit.edu/pub/gnu/GPL -+ * -+ * 2000-05-04 Markus Hennig : initial -+ * 2000-08-18 Dennis Koslowski : first release -+ * 2000-12-01 Dennis Koslowski : UDP scans detection added -+ * 2001-01-02 Dennis Koslowski : output modified -+ * 2001-02-04 Jan Rekorajski : converted from target to match -+ * 2004-05-05 Martijn Lievaart : ported to 2.6 -+ * 2007-10-10 Thomas Backlund : 2.6.22 update -+ * 2007-11-14 Luiz Capitulino : 2.6.22 API usage fixes -+ * 2007-11-26 Herton Ronaldo Krzesinski : switch xt_match->match to bool -+ */ - - #include - #include -@@ -54,7 +57,7 @@ struct port { - */ - struct host { - struct host *next; /* Next entry with the same hash */ -- clock_t timestamp; /* Last update time */ -+ unsigned long timestamp; /* Last update time */ - struct in_addr src_addr; /* Source address */ - struct in_addr dest_addr; /* Destination address */ - unsigned short src_port; /* Source port */ -@@ -93,33 +96,29 @@ static inline int hashfunc(struct in_add - return hash & (HASH_SIZE - 1); - } - --static int -+static bool - ipt_psd_match(const struct sk_buff *pskb, -- const struct net_device *in, -- const struct net_device *out, -- const void *matchinfo, -- int offset, -- int *hotdrop) -+ const struct xt_match_param *match_param) - { - struct iphdr *ip_hdr; - struct tcphdr *tcp_hdr; - struct in_addr addr; - u_int16_t src_port,dest_port; - u_int8_t tcp_flags, proto; -- clock_t now; -+ unsigned long now; - struct host *curr, *last, **head; - int hash, index, count; - - /* Parameters from userspace */ -- const struct ipt_psd_info *psdinfo = matchinfo; -+ const struct ipt_psd_info *psdinfo = match_param->matchinfo; - - /* IP header */ -- ip_hdr = pskb->nh.iph; -+ ip_hdr = ipip_hdr(pskb); - - /* Sanity check */ - if (ntohs(ip_hdr->frag_off) & IP_OFFSET) { - DEBUGP("PSD: sanity check failed\n"); -- return 0; -+ return false; - } - - /* TCP or UDP ? */ -@@ -127,7 +126,7 @@ ipt_psd_match(const struct sk_buff *pskb - - if (proto != IPPROTO_TCP && proto != IPPROTO_UDP) { - DEBUGP("PSD: protocol not supported\n"); -- return 0; -+ return false; - } - - /* Get the source address, source & destination ports, and TCP flags */ -@@ -151,7 +150,7 @@ ipt_psd_match(const struct sk_buff *pskb - * them spoof us. [DHCP needs this feature - HW] */ - if (!addr.s_addr) { - DEBUGP("PSD: spoofed source address (0.0.0.0)\n"); -- return 0; -+ return false; - } - - /* Use jiffies here not to depend on someone setting the time while we're -@@ -298,46 +297,26 @@ ipt_psd_match(const struct sk_buff *pskb - - out_no_match: - spin_unlock(&state.lock); -- return 0; -+ return false; - - out_match: - spin_unlock(&state.lock); -- return 1; -+ DEBUGP("PSD: Dropping packets from "NIPQUAD_FMT" \n", -+ NIPQUAD(curr->src_addr.s_addr)); -+ return true; - } - --static int ipt_psd_checkentry(const char *tablename, -- const struct ipt_ip *e, -- void *matchinfo, -- unsigned int matchsize, -- unsigned int hook_mask) --{ --/* const struct ipt_psd_info *psdinfo = targinfo;*/ -- -- /* we accept TCP only */ --/* if (e->ip.proto != IPPROTO_TCP) { */ --/* DEBUGP("PSD: specified protocol may be TCP only\n"); */ --/* return 0; */ --/* } */ -- -- if (matchsize != IPT_ALIGN(sizeof(struct ipt_psd_info))) { -- DEBUGP("PSD: matchsize %u != %u\n", -- matchsize, -- IPT_ALIGN(sizeof(struct ipt_psd_info))); -- return 0; -- } -- -- return 1; --} -- --static struct ipt_match ipt_psd_reg = { -- .name = "psd", -- .match = ipt_psd_match, -- .checkentry = ipt_psd_checkentry, -- .me = THIS_MODULE }; -+static struct xt_match ipt_psd_reg = { -+ .name = "psd", -+ .family = AF_INET, -+ .match = ipt_psd_match, -+ .matchsize = sizeof(struct ipt_psd_info), -+ .me = THIS_MODULE -+}; - --static int __init init(void) -+static int __init ipt_psd_init(void) - { -- if (ipt_register_match(&ipt_psd_reg)) -+ if (xt_register_match(&ipt_psd_reg)) - return -EINVAL; - - memset(&state, 0, sizeof(state)); -@@ -348,11 +327,11 @@ static int __init init(void) - return 0; - } - --static void __exit fini(void) -+static void __exit ipt_psd_fini(void) - { -- ipt_unregister_match(&ipt_psd_reg); -+ xt_unregister_match(&ipt_psd_reg); - printk("netfilter PSD unloaded - (c) astaro AG\n"); - } - --module_init(init); --module_exit(fini); -+module_init(ipt_psd_init); -+module_exit(ipt_psd_fini); ---- a/net/ipv4/netfilter/Kconfig -+++ b/net/ipv4/netfilter/Kconfig -@@ -193,6 +193,14 @@ config IP_NF_MATCH_ECN - (e.g. when running oldconfig). It selects - CONFIG_NETFILTER_XT_MATCH_ECN. - -+config IP_NF_MATCH_PSD -+ tristate 'Port scanner detection support' -+ depends on NETFILTER_ADVANCED -+ help -+ Module used for PSD (portscan detection). -+ -+ To compile it as a module, choose M here. If unsure, say N. -+ - config IP_NF_MATCH_RPFILTER - tristate '"rpfilter" reverse path filter match support' - depends on NETFILTER_ADVANCED diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-psd.patch b/kernel/kernel/files/patches/mageia/net-netfilter-psd.patch deleted file mode 100644 index 188c5250..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-psd.patch +++ /dev/null @@ -1,424 +0,0 @@ - -[moved header to uapi for kernel-4.12.4 / tmb] -Signed-off-by Thomas Backlund - ---- - include/uapi/linux/netfilter_ipv4/ipt_psd.h | 40 +++ - net/ipv4/netfilter/Makefile | 1 - net/ipv4/netfilter/ipt_psd.c | 358 +++++++++++++++++++++++++++++++++ - 3 files changed, 399 insertions(+) - ---- /dev/null -+++ b/net/ipv4/netfilter/ipt_psd.c -@@ -0,0 +1,358 @@ -+/* -+ This is a module which is used for PSD (portscan detection) -+ Derived from scanlogd v2.1 written by Solar Designer -+ and LOG target module. -+ -+ Copyright (C) 2000,2001 astaro AG -+ -+ This file is distributed under the terms of the GNU General Public -+ License (GPL). Copies of the GPL can be obtained from: -+ ftp://prep.ai.mit.edu/pub/gnu/GPL -+ -+ 2000-05-04 Markus Hennig : initial -+ 2000-08-18 Dennis Koslowski : first release -+ 2000-12-01 Dennis Koslowski : UDP scans detection added -+ 2001-01-02 Dennis Koslowski : output modified -+ 2001-02-04 Jan Rekorajski : converted from target to match -+ 2004-05-05 Martijn Lievaart : ported to 2.6 -+*/ -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#if 0 -+#define DEBUGP printk -+#else -+#define DEBUGP(format, args...) -+#endif -+ -+MODULE_LICENSE("GPL"); -+MODULE_AUTHOR("Dennis Koslowski "); -+ -+#define HF_DADDR_CHANGING 0x01 -+#define HF_SPORT_CHANGING 0x02 -+#define HF_TOS_CHANGING 0x04 -+#define HF_TTL_CHANGING 0x08 -+ -+/* -+ * Information we keep per each target port -+ */ -+struct port { -+ u_int16_t number; /* port number */ -+ u_int8_t proto; /* protocol number */ -+ u_int8_t and_flags; /* tcp ANDed flags */ -+ u_int8_t or_flags; /* tcp ORed flags */ -+}; -+ -+/* -+ * Information we keep per each source address. -+ */ -+struct host { -+ struct host *next; /* Next entry with the same hash */ -+ clock_t timestamp; /* Last update time */ -+ struct in_addr src_addr; /* Source address */ -+ struct in_addr dest_addr; /* Destination address */ -+ unsigned short src_port; /* Source port */ -+ int count; /* Number of ports in the list */ -+ int weight; /* Total weight of ports in the list */ -+ struct port ports[SCAN_MAX_COUNT - 1]; /* List of ports */ -+ unsigned char tos; /* TOS */ -+ unsigned char ttl; /* TTL */ -+ unsigned char flags; /* HF_ flags bitmask */ -+}; -+ -+/* -+ * State information. -+ */ -+static struct { -+ spinlock_t lock; -+ struct host list[LIST_SIZE]; /* List of source addresses */ -+ struct host *hash[HASH_SIZE]; /* Hash: pointers into the list */ -+ int index; /* Oldest entry to be replaced */ -+} state; -+ -+/* -+ * Convert an IP address into a hash table index. -+ */ -+static inline int hashfunc(struct in_addr addr) -+{ -+ unsigned int value; -+ int hash; -+ -+ value = addr.s_addr; -+ hash = 0; -+ do { -+ hash ^= value; -+ } while ((value >>= HASH_LOG)); -+ -+ return hash & (HASH_SIZE - 1); -+} -+ -+static int -+ipt_psd_match(const struct sk_buff *pskb, -+ const struct net_device *in, -+ const struct net_device *out, -+ const void *matchinfo, -+ int offset, -+ int *hotdrop) -+{ -+ struct iphdr *ip_hdr; -+ struct tcphdr *tcp_hdr; -+ struct in_addr addr; -+ u_int16_t src_port,dest_port; -+ u_int8_t tcp_flags, proto; -+ clock_t now; -+ struct host *curr, *last, **head; -+ int hash, index, count; -+ -+ /* Parameters from userspace */ -+ const struct ipt_psd_info *psdinfo = matchinfo; -+ -+ /* IP header */ -+ ip_hdr = pskb->nh.iph; -+ -+ /* Sanity check */ -+ if (ntohs(ip_hdr->frag_off) & IP_OFFSET) { -+ DEBUGP("PSD: sanity check failed\n"); -+ return 0; -+ } -+ -+ /* TCP or UDP ? */ -+ proto = ip_hdr->protocol; -+ -+ if (proto != IPPROTO_TCP && proto != IPPROTO_UDP) { -+ DEBUGP("PSD: protocol not supported\n"); -+ return 0; -+ } -+ -+ /* Get the source address, source & destination ports, and TCP flags */ -+ -+ addr.s_addr = ip_hdr->saddr; -+ -+ tcp_hdr = (struct tcphdr*)((u_int32_t *)ip_hdr + ip_hdr->ihl); -+ -+ /* Yep, it´s dirty */ -+ src_port = tcp_hdr->source; -+ dest_port = tcp_hdr->dest; -+ -+ if (proto == IPPROTO_TCP) { -+ tcp_flags = *((u_int8_t*)tcp_hdr + 13); -+ } -+ else { -+ tcp_flags = 0x00; -+ } -+ -+ /* We're using IP address 0.0.0.0 for a special purpose here, so don't let -+ * them spoof us. [DHCP needs this feature - HW] */ -+ if (!addr.s_addr) { -+ DEBUGP("PSD: spoofed source address (0.0.0.0)\n"); -+ return 0; -+ } -+ -+ /* Use jiffies here not to depend on someone setting the time while we're -+ * running; we need to be careful with possible return value overflows. */ -+ now = jiffies; -+ -+ spin_lock(&state.lock); -+ -+ /* Do we know this source address already? */ -+ count = 0; -+ last = NULL; -+ if ((curr = *(head = &state.hash[hash = hashfunc(addr)]))) -+ do { -+ if (curr->src_addr.s_addr == addr.s_addr) break; -+ count++; -+ if (curr->next) last = curr; -+ } while ((curr = curr->next)); -+ -+ if (curr) { -+ -+ /* We know this address, and the entry isn't too old. Update it. */ -+ if (now - curr->timestamp <= (psdinfo->delay_threshold*HZ)/100 && -+ time_after_eq(now, curr->timestamp)) { -+ -+ /* Just update the appropriate list entry if we've seen this port already */ -+ for (index = 0; index < curr->count; index++) { -+ if (curr->ports[index].number == dest_port) { -+ curr->ports[index].proto = proto; -+ curr->ports[index].and_flags &= tcp_flags; -+ curr->ports[index].or_flags |= tcp_flags; -+ goto out_no_match; -+ } -+ } -+ -+ /* TCP/ACK and/or TCP/RST to a new port? This could be an outgoing connection. */ -+ if (proto == IPPROTO_TCP && (tcp_hdr->ack || tcp_hdr->rst)) -+ goto out_no_match; -+ -+ /* Packet to a new port, and not TCP/ACK: update the timestamp */ -+ curr->timestamp = now; -+ -+ /* Logged this scan already? Then drop the packet. */ -+ if (curr->weight >= psdinfo->weight_threshold) -+ goto out_match; -+ -+ /* Specify if destination address, source port, TOS or TTL are not fixed */ -+ if (curr->dest_addr.s_addr != ip_hdr->daddr) -+ curr->flags |= HF_DADDR_CHANGING; -+ if (curr->src_port != src_port) -+ curr->flags |= HF_SPORT_CHANGING; -+ if (curr->tos != ip_hdr->tos) -+ curr->flags |= HF_TOS_CHANGING; -+ if (curr->ttl != ip_hdr->ttl) -+ curr->flags |= HF_TTL_CHANGING; -+ -+ /* Update the total weight */ -+ curr->weight += (ntohs(dest_port) < 1024) ? -+ psdinfo->lo_ports_weight : psdinfo->hi_ports_weight; -+ -+ /* Got enough destination ports to decide that this is a scan? */ -+ /* Then log it and drop the packet. */ -+ if (curr->weight >= psdinfo->weight_threshold) -+ goto out_match; -+ -+ /* Remember the new port */ -+ if (curr->count < SCAN_MAX_COUNT) { -+ curr->ports[curr->count].number = dest_port; -+ curr->ports[curr->count].proto = proto; -+ curr->ports[curr->count].and_flags = tcp_flags; -+ curr->ports[curr->count].or_flags = tcp_flags; -+ curr->count++; -+ } -+ -+ goto out_no_match; -+ } -+ -+ /* We know this address, but the entry is outdated. Mark it unused, and -+ * remove from the hash table. We'll allocate a new entry instead since -+ * this one might get re-used too soon. */ -+ curr->src_addr.s_addr = 0; -+ if (last) -+ last->next = last->next->next; -+ else if (*head) -+ *head = (*head)->next; -+ last = NULL; -+ } -+ -+ /* We don't need an ACK from a new source address */ -+ if (proto == IPPROTO_TCP && tcp_hdr->ack) -+ goto out_no_match; -+ -+ /* Got too many source addresses with the same hash value? Then remove the -+ * oldest one from the hash table, so that they can't take too much of our -+ * CPU time even with carefully chosen spoofed IP addresses. */ -+ if (count >= HASH_MAX && last) last->next = NULL; -+ -+ /* We're going to re-use the oldest list entry, so remove it from the hash -+ * table first (if it is really already in use, and isn't removed from the -+ * hash table already because of the HASH_MAX check above). */ -+ -+ /* First, find it */ -+ if (state.list[state.index].src_addr.s_addr) -+ head = &state.hash[hashfunc(state.list[state.index].src_addr)]; -+ else -+ head = &last; -+ last = NULL; -+ if ((curr = *head)) -+ do { -+ if (curr == &state.list[state.index]) break; -+ last = curr; -+ } while ((curr = curr->next)); -+ -+ /* Then, remove it */ -+ if (curr) { -+ if (last) -+ last->next = last->next->next; -+ else if (*head) -+ *head = (*head)->next; -+ } -+ -+ /* Get our list entry */ -+ curr = &state.list[state.index++]; -+ if (state.index >= LIST_SIZE) state.index = 0; -+ -+ /* Link it into the hash table */ -+ head = &state.hash[hash]; -+ curr->next = *head; -+ *head = curr; -+ -+ /* And fill in the fields */ -+ curr->timestamp = now; -+ curr->src_addr = addr; -+ curr->dest_addr.s_addr = ip_hdr->daddr; -+ curr->src_port = src_port; -+ curr->count = 1; -+ curr->weight = (ntohs(dest_port) < 1024) ? -+ psdinfo->lo_ports_weight : psdinfo->hi_ports_weight; -+ curr->ports[0].number = dest_port; -+ curr->ports[0].proto = proto; -+ curr->ports[0].and_flags = tcp_flags; -+ curr->ports[0].or_flags = tcp_flags; -+ curr->tos = ip_hdr->tos; -+ curr->ttl = ip_hdr->ttl; -+ -+out_no_match: -+ spin_unlock(&state.lock); -+ return 0; -+ -+out_match: -+ spin_unlock(&state.lock); -+ return 1; -+} -+ -+static int ipt_psd_checkentry(const char *tablename, -+ const struct ipt_ip *e, -+ void *matchinfo, -+ unsigned int matchsize, -+ unsigned int hook_mask) -+{ -+/* const struct ipt_psd_info *psdinfo = targinfo;*/ -+ -+ /* we accept TCP only */ -+/* if (e->ip.proto != IPPROTO_TCP) { */ -+/* DEBUGP("PSD: specified protocol may be TCP only\n"); */ -+/* return 0; */ -+/* } */ -+ -+ if (matchsize != IPT_ALIGN(sizeof(struct ipt_psd_info))) { -+ DEBUGP("PSD: matchsize %u != %u\n", -+ matchsize, -+ IPT_ALIGN(sizeof(struct ipt_psd_info))); -+ return 0; -+ } -+ -+ return 1; -+} -+ -+static struct ipt_match ipt_psd_reg = { -+ .name = "psd", -+ .match = ipt_psd_match, -+ .checkentry = ipt_psd_checkentry, -+ .me = THIS_MODULE }; -+ -+static int __init init(void) -+{ -+ if (ipt_register_match(&ipt_psd_reg)) -+ return -EINVAL; -+ -+ memset(&state, 0, sizeof(state)); -+ -+ spin_lock_init(&(state.lock)); -+ -+ printk("netfilter PSD loaded - (c) astaro AG\n"); -+ return 0; -+} -+ -+static void __exit fini(void) -+{ -+ ipt_unregister_match(&ipt_psd_reg); -+ printk("netfilter PSD unloaded - (c) astaro AG\n"); -+} -+ -+module_init(init); -+module_exit(fini); ---- /dev/null -+++ b/include/uapi/linux/netfilter_ipv4/ipt_psd.h -@@ -0,0 +1,40 @@ -+#ifndef _IPT_PSD_H -+#define _IPT_PSD_H -+ -+#include -+#include -+ -+/* -+ * High port numbers have a lower weight to reduce the frequency of false -+ * positives, such as from passive mode FTP transfers. -+ */ -+#define PORT_WEIGHT_PRIV 3 -+#define PORT_WEIGHT_HIGH 1 -+ -+/* -+ * Port scan detection thresholds: at least COUNT ports need to be scanned -+ * from the same source, with no longer than DELAY ticks between ports. -+ */ -+#define SCAN_MIN_COUNT 7 -+#define SCAN_MAX_COUNT (SCAN_MIN_COUNT * PORT_WEIGHT_PRIV) -+#define SCAN_WEIGHT_THRESHOLD SCAN_MAX_COUNT -+#define SCAN_DELAY_THRESHOLD (300) /* old usage of HZ here was erroneously and broke under uml */ -+ -+/* -+ * Keep track of up to LIST_SIZE source addresses, using a hash table of -+ * HASH_SIZE entries for faster lookups, but limiting hash collisions to -+ * HASH_MAX source addresses per the same hash value. -+ */ -+#define LIST_SIZE 0x100 -+#define HASH_LOG 9 -+#define HASH_SIZE (1 << HASH_LOG) -+#define HASH_MAX 0x10 -+ -+struct ipt_psd_info { -+ unsigned int weight_threshold; -+ unsigned int delay_threshold; -+ unsigned short lo_ports_weight; -+ unsigned short hi_ports_weight; -+}; -+ -+#endif /*_IPT_PSD_H*/ ---- a/net/ipv4/netfilter/Makefile -+++ b/net/ipv4/netfilter/Makefile -@@ -49,6 +49,7 @@ - - # matches - obj-$(CONFIG_IP_NF_MATCH_AH) += ipt_ah.o -+obj-$(CONFIG_IP_NF_MATCH_PSD) += ipt_psd.o - obj-$(CONFIG_IP_NF_MATCH_RPFILTER) += ipt_rpfilter.o - - # targets diff --git a/kernel/kernel/files/patches/mageia/net-netfilter-xt_addrtype-silence-BROADCAST-message.patch b/kernel/kernel/files/patches/mageia/net-netfilter-xt_addrtype-silence-BROADCAST-message.patch deleted file mode 100644 index 15312e3e..00000000 --- a/kernel/kernel/files/patches/mageia/net-netfilter-xt_addrtype-silence-BROADCAST-message.patch +++ /dev/null @@ -1,16 +0,0 @@ - -This message causes numerous useless "bug reports", so silence it by default. - -Signed-off-by: Thomas Backlund - ---- linux/net/netfilter/xt_addrtype.c.orig 2017-11-12 20:46:13.000000000 +0200 -+++ linux/net/netfilter/xt_addrtype.c 2018-02-06 20:26:49.854596642 +0200 -@@ -203,7 +203,7 @@ static int addrtype_mt_checkentry_v1(con - return -EINVAL; - } - if ((info->source | info->dest) & XT_ADDRTYPE_BROADCAST) { -- pr_err("ipv6 does not support BROADCAST matching\n"); -+ /* pr_err("ipv6 does not support BROADCAST matching\n"); */ - return -EINVAL; - } - } diff --git a/kernel/kernel/files/patches/mageia/net-sis190-fix-list-usage.patch b/kernel/kernel/files/patches/mageia/net-sis190-fix-list-usage.patch deleted file mode 100644 index eda13d1d..00000000 --- a/kernel/kernel/files/patches/mageia/net-sis190-fix-list-usage.patch +++ /dev/null @@ -1,30 +0,0 @@ ---- - drivers/net/ethernet/sis/sis190.c | 10 +++++++--- - 1 file changed, 7 insertions(+), 3 deletions(-) - ---- linux/drivers/net/ethernet/sis/sis190.c.net-sis190-fix-list-usage.orig -+++ linux/drivers/net/ethernet/sis/sis190.c -@@ -1252,6 +1252,7 @@ static u16 sis190_default_phy(struct net - struct sis190_private *tp = netdev_priv(dev); - struct mii_if_info *mii_if = &tp->mii_if; - void __iomem *ioaddr = tp->mmio_addr; -+ struct list_head *l; - u16 status; - - phy_home = phy_default = phy_lan = NULL; -@@ -1280,9 +1281,12 @@ static u16 sis190_default_phy(struct net - phy_default = phy_home; - else if (phy_lan) - phy_default = phy_lan; -- else -- phy_default = list_first_entry(&tp->first_phy, -- struct sis190_phy, list); -+ else { -+ l = &tp->first_phy; -+ l = l->next; -+ phy_default = list_first_entry(l, struct sis190_phy, list); -+ -+ } - } - - if (mii_if->phy_id != phy_default->phy_id) { diff --git a/kernel/kernel/files/patches/mageia/net-tls-Correct-length-of-scatterlist-in-tls_sw_sendpage.patch b/kernel/kernel/files/patches/mageia/net-tls-Correct-length-of-scatterlist-in-tls_sw_sendpage.patch deleted file mode 100644 index ea0f89ec..00000000 --- a/kernel/kernel/files/patches/mageia/net-tls-Correct-length-of-scatterlist-in-tls_sw_sendpage.patch +++ /dev/null @@ -1,37 +0,0 @@ -From 7a8c4dd9be91a7e8f8f0e0419a560663adc694a3 Mon Sep 17 00:00:00 2001 -From: Dave Watson -Date: Fri, 19 Jan 2018 12:30:13 -0800 -Subject: [PATCH] tls: Correct length of scatterlist in tls_sw_sendpage - -The scatterlist is reused by both sendmsg and sendfile. -If a sendmsg of smaller number of pages is followed by a sendfile -of larger number of pages, the scatterlist may be too short, resulting -in a crash in gcm_encrypt. - -Add sg_unmark_end to make the list the correct length. - -tls_sw_sendmsg already calls sg_unmark_end correctly when it allocates -memory in alloc_sg, or in zerocopy_from_iter. - -Signed-off-by: Dave Watson -Signed-off-by: David S. Miller ---- - net/tls/tls_sw.c | 2 ++ - 1 file changed, 2 insertions(+) - -diff --git a/net/tls/tls_sw.c b/net/tls/tls_sw.c -index 61f394d369bf..0a9b72fbd761 100644 ---- a/net/tls/tls_sw.c -+++ b/net/tls/tls_sw.c -@@ -577,6 +577,8 @@ int tls_sw_sendpage(struct sock *sk, struct page *page, - get_page(page); - sg = ctx->sg_plaintext_data + ctx->sg_plaintext_num_elem; - sg_set_page(sg, page, copy, offset); -+ sg_unmark_end(sg); -+ - ctx->sg_plaintext_num_elem++; - - sk_mem_charge(sk, copy); --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/net-wireless-realtek-rtl8xxxu-linux-4.11-rc.patch b/kernel/kernel/files/patches/mageia/net-wireless-realtek-rtl8xxxu-linux-4.11-rc.patch deleted file mode 100644 index 6f7092cc..00000000 --- a/kernel/kernel/files/patches/mageia/net-wireless-realtek-rtl8xxxu-linux-4.11-rc.patch +++ /dev/null @@ -1,371 +0,0 @@ - -From upstream 4.11-rc2+ git - -Fixes mga #20508 - -Signed-off-by: Thomas Backlund - - - drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu.h | 29 ++-- - drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8192c.c | 2 - drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8192e.c | 4 - drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8723a.c | 2 - drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_872tb.c | 2 - drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_core.c | 121 +++++++++++------ - drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_regs.h | 2 - 7 files changed, 105 insertions(+), 57 deletions(-) - -diff -Nurp linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8192c.c linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8192c.c ---- linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8192c.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8192c.c 2017-03-07 22:29:07.840867965 +0200 -@@ -1,7 +1,7 @@ - /* - * RTL8XXXU mac80211 USB driver - 8188c/8188r/8192c specific subdriver - * -- * Copyright (c) 2014 - 2016 Jes Sorensen -+ * Copyright (c) 2014 - 2017 Jes Sorensen - * - * Portions, notably calibration code: - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -diff -Nurp linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8192e.c linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8192e.c ---- linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8192e.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8192e.c 2017-03-07 22:29:07.841868054 +0200 -@@ -1,7 +1,7 @@ - /* - * RTL8XXXU mac80211 USB driver - 8192e specific subdriver - * -- * Copyright (c) 2014 - 2016 Jes Sorensen -+ * Copyright (c) 2014 - 2017 Jes Sorensen - * - * Portions, notably calibration code: - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -@@ -1556,7 +1556,7 @@ exit: - return ret; - } - --void rtl8192eu_power_off(struct rtl8xxxu_priv *priv) -+static void rtl8192eu_power_off(struct rtl8xxxu_priv *priv) - { - u8 val8; - u16 val16; -diff -Nurp linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8723a.c linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8723a.c ---- linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8723a.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8723a.c 2017-03-07 22:29:07.841868054 +0200 -@@ -1,7 +1,7 @@ - /* - * RTL8XXXU mac80211 USB driver - 8723a specific subdriver - * -- * Copyright (c) 2014 - 2016 Jes Sorensen -+ * Copyright (c) 2014 - 2017 Jes Sorensen - * - * Portions, notably calibration code: - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -diff -Nurp linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8723b.c linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8723b.c ---- linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8723b.c 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_8723b.c 2017-03-07 22:29:07.841868054 +0200 -@@ -1,7 +1,7 @@ - /* - * RTL8XXXU mac80211 USB driver - 8723b specific subdriver - * -- * Copyright (c) 2014 - 2016 Jes Sorensen -+ * Copyright (c) 2014 - 2017 Jes Sorensen - * - * Portions, notably calibration code: - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -diff -Nurp linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_core.c linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_core.c ---- linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_core.c 2017-03-18 13:35:47.148080457 +0200 -+++ linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_core.c 2017-03-07 22:29:07.841868054 +0200 -@@ -1,7 +1,7 @@ - /* - * RTL8XXXU mac80211 USB driver - * -- * Copyright (c) 2014 - 2016 Jes Sorensen -+ * Copyright (c) 2014 - 2017 Jes Sorensen - * - * Portions, notably calibration code: - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. -@@ -48,7 +48,7 @@ static bool rtl8xxxu_dma_aggregation; - static int rtl8xxxu_dma_agg_timeout = -1; - static int rtl8xxxu_dma_agg_pages = -1; - --MODULE_AUTHOR("Jes Sorensen "); -+MODULE_AUTHOR("Jes Sorensen "); - MODULE_DESCRIPTION("RTL8XXXu USB mac80211 Wireless LAN Driver"); - MODULE_LICENSE("GPL"); - MODULE_FIRMWARE("rtlwifi/rtl8723aufw_A.bin"); -@@ -4767,13 +4767,28 @@ static void rtl8xxxu_dump_action(struct - * This format is used on 8188cu/8192cu/8723au - */ - void --rtl8xxxu_fill_txdesc_v1(struct ieee80211_hdr *hdr, -- struct rtl8xxxu_txdesc32 *tx_desc, u32 rate, -- u16 rate_flag, bool sgi, bool short_preamble, -- bool ampdu_enable) -+rtl8xxxu_fill_txdesc_v1(struct ieee80211_hw *hw, struct ieee80211_hdr *hdr, -+ struct ieee80211_tx_info *tx_info, -+ struct rtl8xxxu_txdesc32 *tx_desc, bool sgi, -+ bool short_preamble, bool ampdu_enable, u32 rts_rate) - { -+ struct ieee80211_rate *tx_rate = ieee80211_get_tx_rate(hw, tx_info); -+ struct rtl8xxxu_priv *priv = hw->priv; -+ struct device *dev = &priv->udev->dev; -+ u32 rate; -+ u16 rate_flags = tx_info->control.rates[0].flags; - u16 seq_number; - -+ if (rate_flags & IEEE80211_TX_RC_MCS && -+ !ieee80211_is_mgmt(hdr->frame_control)) -+ rate = tx_info->control.rates[0].idx + DESC_RATE_MCS0; -+ else -+ rate = tx_rate->hw_value; -+ -+ if (rtl8xxxu_debug & RTL8XXXU_DEBUG_TX) -+ dev_info(dev, "%s: TX rate: %d, pkt size %d\n", -+ __func__, rate, cpu_to_le16(tx_desc->pkt_size)); -+ - seq_number = IEEE80211_SEQ_TO_SN(le16_to_cpu(hdr->seq_ctrl)); - - tx_desc->txdw5 = cpu_to_le32(rate); -@@ -4804,15 +4819,16 @@ rtl8xxxu_fill_txdesc_v1(struct ieee80211 - if (sgi) - tx_desc->txdw5 |= cpu_to_le32(TXDESC32_SHORT_GI); - -- if (rate_flag & IEEE80211_TX_RC_USE_RTS_CTS) { -- /* -- * Use RTS rate 24M - does the mac80211 tell -- * us which to use? -- */ -- tx_desc->txdw4 |= cpu_to_le32(DESC_RATE_24M << -- TXDESC32_RTS_RATE_SHIFT); -+ /* -+ * rts_rate is zero if RTS/CTS or CTS to SELF are not enabled -+ */ -+ tx_desc->txdw4 |= cpu_to_le32(rts_rate << TXDESC32_RTS_RATE_SHIFT); -+ if (rate_flags & IEEE80211_TX_RC_USE_RTS_CTS) { - tx_desc->txdw4 |= cpu_to_le32(TXDESC32_RTS_CTS_ENABLE); - tx_desc->txdw4 |= cpu_to_le32(TXDESC32_HW_RTS_ENABLE); -+ } else if (rate_flags & IEEE80211_TX_RC_USE_CTS_PROTECT) { -+ tx_desc->txdw4 |= cpu_to_le32(TXDESC32_CTS_SELF_ENABLE); -+ tx_desc->txdw4 |= cpu_to_le32(TXDESC32_HW_RTS_ENABLE); - } - } - -@@ -4821,16 +4837,31 @@ rtl8xxxu_fill_txdesc_v1(struct ieee80211 - * This format is used on 8192eu/8723bu - */ - void --rtl8xxxu_fill_txdesc_v2(struct ieee80211_hdr *hdr, -- struct rtl8xxxu_txdesc32 *tx_desc32, u32 rate, -- u16 rate_flag, bool sgi, bool short_preamble, -- bool ampdu_enable) -+rtl8xxxu_fill_txdesc_v2(struct ieee80211_hw *hw, struct ieee80211_hdr *hdr, -+ struct ieee80211_tx_info *tx_info, -+ struct rtl8xxxu_txdesc32 *tx_desc32, bool sgi, -+ bool short_preamble, bool ampdu_enable, u32 rts_rate) - { -+ struct ieee80211_rate *tx_rate = ieee80211_get_tx_rate(hw, tx_info); -+ struct rtl8xxxu_priv *priv = hw->priv; -+ struct device *dev = &priv->udev->dev; - struct rtl8xxxu_txdesc40 *tx_desc40; -+ u32 rate; -+ u16 rate_flags = tx_info->control.rates[0].flags; - u16 seq_number; - - tx_desc40 = (struct rtl8xxxu_txdesc40 *)tx_desc32; - -+ if (rate_flags & IEEE80211_TX_RC_MCS && -+ !ieee80211_is_mgmt(hdr->frame_control)) -+ rate = tx_info->control.rates[0].idx + DESC_RATE_MCS0; -+ else -+ rate = tx_rate->hw_value; -+ -+ if (rtl8xxxu_debug & RTL8XXXU_DEBUG_TX) -+ dev_info(dev, "%s: TX rate: %d, pkt size %d\n", -+ __func__, rate, cpu_to_le16(tx_desc40->pkt_size)); -+ - seq_number = IEEE80211_SEQ_TO_SN(le16_to_cpu(hdr->seq_ctrl)); - - tx_desc40->txdw4 = cpu_to_le32(rate); -@@ -4857,15 +4888,19 @@ rtl8xxxu_fill_txdesc_v2(struct ieee80211 - if (short_preamble) - tx_desc40->txdw5 |= cpu_to_le32(TXDESC40_SHORT_PREAMBLE); - -- if (rate_flag & IEEE80211_TX_RC_USE_RTS_CTS) { -- /* -- * Use RTS rate 24M - does the mac80211 tell -- * us which to use? -- */ -- tx_desc40->txdw4 |= cpu_to_le32(DESC_RATE_24M << -- TXDESC40_RTS_RATE_SHIFT); -+ tx_desc40->txdw4 |= cpu_to_le32(rts_rate << TXDESC40_RTS_RATE_SHIFT); -+ /* -+ * rts_rate is zero if RTS/CTS or CTS to SELF are not enabled -+ */ -+ if (rate_flags & IEEE80211_TX_RC_USE_RTS_CTS) { - tx_desc40->txdw3 |= cpu_to_le32(TXDESC40_RTS_CTS_ENABLE); - tx_desc40->txdw3 |= cpu_to_le32(TXDESC40_HW_RTS_ENABLE); -+ } else if (rate_flags & IEEE80211_TX_RC_USE_CTS_PROTECT) { -+ /* -+ * For some reason the vendor driver doesn't set -+ * TXDESC40_HW_RTS_ENABLE for CTS to SELF -+ */ -+ tx_desc40->txdw3 |= cpu_to_le32(TXDESC40_CTS_SELF_ENABLE); - } - } - -@@ -4875,14 +4910,13 @@ static void rtl8xxxu_tx(struct ieee80211 - { - struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; - struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb); -- struct ieee80211_rate *tx_rate = ieee80211_get_tx_rate(hw, tx_info); - struct rtl8xxxu_priv *priv = hw->priv; - struct rtl8xxxu_txdesc32 *tx_desc; - struct rtl8xxxu_tx_urb *tx_urb; - struct ieee80211_sta *sta = NULL; - struct ieee80211_vif *vif = tx_info->control.vif; - struct device *dev = &priv->udev->dev; -- u32 queue, rate; -+ u32 queue, rts_rate; - u16 pktlen = skb->len; - u16 seq_number; - u16 rate_flag = tx_info->control.rates[0].flags; -@@ -4909,10 +4943,6 @@ static void rtl8xxxu_tx(struct ieee80211 - goto error; - } - -- if (rtl8xxxu_debug & RTL8XXXU_DEBUG_TX) -- dev_info(dev, "%s: TX rate: %d (%d), pkt size %d\n", -- __func__, tx_rate->bitrate, tx_rate->hw_value, pktlen); -- - if (ieee80211_is_action(hdr->frame_control)) - rtl8xxxu_dump_action(dev, hdr); - -@@ -4966,12 +4996,6 @@ static void rtl8xxxu_tx(struct ieee80211 - } - } - -- if (rate_flag & IEEE80211_TX_RC_MCS && -- !ieee80211_is_mgmt(hdr->frame_control)) -- rate = tx_info->control.rates[0].idx + DESC_RATE_MCS0; -- else -- rate = tx_rate->hw_value; -- - if (rate_flag & IEEE80211_TX_RC_SHORT_GI || - (ieee80211_is_data_qos(hdr->frame_control) && - sta && sta->ht_cap.cap & -@@ -4982,10 +5006,17 @@ static void rtl8xxxu_tx(struct ieee80211 - (sta && vif && vif->bss_conf.use_short_preamble)) - short_preamble = true; - -+ if (rate_flag & IEEE80211_TX_RC_USE_RTS_CTS) -+ rts_rate = ieee80211_get_rts_cts_rate(hw, tx_info)->hw_value; -+ else if (rate_flag & IEEE80211_TX_RC_USE_CTS_PROTECT) -+ rts_rate = ieee80211_get_rts_cts_rate(hw, tx_info)->hw_value; -+ else -+ rts_rate = 0; -+ - seq_number = IEEE80211_SEQ_TO_SN(le16_to_cpu(hdr->seq_ctrl)); - -- priv->fops->fill_txdesc(hdr, tx_desc, rate, rate_flag, -- sgi, short_preamble, ampdu_enable); -+ priv->fops->fill_txdesc(hw, hdr, tx_info, tx_desc, sgi, short_preamble, -+ ampdu_enable, rts_rate); - - rtl8xxxu_calc_tx_desc_csum(tx_desc); - -@@ -5969,6 +6000,7 @@ static int rtl8xxxu_probe(struct usb_int - case 0x8176: - case 0x8178: - case 0x817f: -+ case 0x818b: - untested = 0; - break; - } -@@ -6165,6 +6197,12 @@ static struct usb_device_id dev_table[] - .driver_info = (unsigned long)&rtl8723au_fops}, - {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x818b, 0xff, 0xff, 0xff), - .driver_info = (unsigned long)&rtl8192eu_fops}, -+/* TP-Link TL-WN822N v4 */ -+{USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x0108, 0xff, 0xff, 0xff), -+ .driver_info = (unsigned long)&rtl8192eu_fops}, -+/* D-Link DWA-131 rev E1, tested by David Patiño */ -+{USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x3319, 0xff, 0xff, 0xff), -+ .driver_info = (unsigned long)&rtl8192eu_fops}, - /* Tested by Myckel Habets */ - {USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x0109, 0xff, 0xff, 0xff), - .driver_info = (unsigned long)&rtl8192eu_fops}, -@@ -6316,6 +6354,13 @@ static struct usb_device_id dev_table[] - .driver_info = (unsigned long)&rtl8192cu_fops}, - {USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0x7822, 0xff, 0xff, 0xff), - .driver_info = (unsigned long)&rtl8192cu_fops}, -+/* found in rtl8192eu vendor driver */ -+{USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x0107, 0xff, 0xff, 0xff), -+ .driver_info = (unsigned long)&rtl8192eu_fops}, -+{USB_DEVICE_AND_INTERFACE_INFO(0x2019, 0xab33, 0xff, 0xff, 0xff), -+ .driver_info = (unsigned long)&rtl8192eu_fops}, -+{USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x818c, 0xff, 0xff, 0xff), -+ .driver_info = (unsigned long)&rtl8192eu_fops}, - #endif - { } - }; -diff -Nurp linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu.h linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu.h ---- linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu.h 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu.h 2017-03-07 22:29:07.840867965 +0200 -@@ -1,5 +1,5 @@ - /* -- * Copyright (c) 2014 - 2016 Jes Sorensen -+ * Copyright (c) 2014 - 2017 Jes Sorensen - * - * This program is free software; you can redistribute it and/or modify it - * under the terms of version 2 of the GNU General Public License as -@@ -1337,10 +1337,11 @@ struct rtl8xxxu_fileops { - u32 ramask, int sgi); - void (*report_connect) (struct rtl8xxxu_priv *priv, - u8 macid, bool connect); -- void (*fill_txdesc) (struct ieee80211_hdr *hdr, -- struct rtl8xxxu_txdesc32 *tx_desc, u32 rate, -- u16 rate_flag, bool sgi, bool short_preamble, -- bool ampdu_enable); -+ void (*fill_txdesc) (struct ieee80211_hw *hw, struct ieee80211_hdr *hdr, -+ struct ieee80211_tx_info *tx_info, -+ struct rtl8xxxu_txdesc32 *tx_desc, bool sgi, -+ bool short_preamble, bool ampdu_enable, -+ u32 rts_rate); - int writeN_block_size; - int rx_agg_buf_size; - char tx_desc_size; -@@ -1434,14 +1435,16 @@ int rtl8xxxu_parse_rxdesc24(struct rtl8x - int rtl8xxxu_gen2_channel_to_group(int channel); - bool rtl8xxxu_gen2_simularity_compare(struct rtl8xxxu_priv *priv, - int result[][8], int c1, int c2); --void rtl8xxxu_fill_txdesc_v1(struct ieee80211_hdr *hdr, -- struct rtl8xxxu_txdesc32 *tx_desc, u32 rate, -- u16 rate_flag, bool sgi, bool short_preamble, -- bool ampdu_enable); --void rtl8xxxu_fill_txdesc_v2(struct ieee80211_hdr *hdr, -- struct rtl8xxxu_txdesc32 *tx_desc32, u32 rate, -- u16 rate_flag, bool sgi, bool short_preamble, -- bool ampdu_enable); -+void rtl8xxxu_fill_txdesc_v1(struct ieee80211_hw *hw, struct ieee80211_hdr *hdr, -+ struct ieee80211_tx_info *tx_info, -+ struct rtl8xxxu_txdesc32 *tx_desc, bool sgi, -+ bool short_preamble, bool ampdu_enable, -+ u32 rts_rate); -+void rtl8xxxu_fill_txdesc_v2(struct ieee80211_hw *hw, struct ieee80211_hdr *hdr, -+ struct ieee80211_tx_info *tx_info, -+ struct rtl8xxxu_txdesc32 *tx_desc32, bool sgi, -+ bool short_preamble, bool ampdu_enable, -+ u32 rts_rate); - - extern struct rtl8xxxu_fileops rtl8192cu_fops; - extern struct rtl8xxxu_fileops rtl8192eu_fops; -diff -Nurp linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_regs.h linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_regs.h ---- linux-4.9.16/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_regs.h 2016-12-11 21:17:54.000000000 +0200 -+++ linux-4.11-rc/drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu_regs.h 2017-03-07 22:29:07.842868144 +0200 -@@ -1,5 +1,5 @@ - /* -- * Copyright (c) 2014 - 2016 Jes Sorensen -+ * Copyright (c) 2014 - 2017 Jes Sorensen - * - * This program is free software; you can redistribute it and/or modify it - * under the terms of version 2 of the GNU General Public License as diff --git a/kernel/kernel/files/patches/mageia/patch-4.14.25-rc1.patch b/kernel/kernel/files/patches/mageia/patch-4.14.25-rc1.patch deleted file mode 100644 index 3246762b..00000000 --- a/kernel/kernel/files/patches/mageia/patch-4.14.25-rc1.patch +++ /dev/null @@ -1,4181 +0,0 @@ -diff --git a/Documentation/networking/ip-sysctl.txt b/Documentation/networking/ip-sysctl.txt -index 77f4de59dc9c..d499676890d8 100644 ---- a/Documentation/networking/ip-sysctl.txt -+++ b/Documentation/networking/ip-sysctl.txt -@@ -508,7 +508,7 @@ tcp_rmem - vector of 3 INTEGERs: min, default, max - min: Minimal size of receive buffer used by TCP sockets. - It is guaranteed to each TCP socket, even under moderate memory - pressure. -- Default: 1 page -+ Default: 4K - - default: initial size of receive buffer used by TCP sockets. - This value overrides net.core.rmem_default used by other protocols. -@@ -666,7 +666,7 @@ tcp_window_scaling - BOOLEAN - tcp_wmem - vector of 3 INTEGERs: min, default, max - min: Amount of memory reserved for send buffers for TCP sockets. - Each TCP socket has rights to use it due to fact of its birth. -- Default: 1 page -+ Default: 4K - - default: initial size of send buffer used by TCP sockets. This - value overrides net.core.wmem_default used by other protocols. -diff --git a/arch/arm/boot/dts/logicpd-som-lv.dtsi b/arch/arm/boot/dts/logicpd-som-lv.dtsi -index 4f2c5ec75714..e262fa9ef334 100644 ---- a/arch/arm/boot/dts/logicpd-som-lv.dtsi -+++ b/arch/arm/boot/dts/logicpd-som-lv.dtsi -@@ -97,6 +97,8 @@ - }; - - &i2c1 { -+ pinctrl-names = "default"; -+ pinctrl-0 = <&i2c1_pins>; - clock-frequency = <2600000>; - - twl: twl@48 { -@@ -215,7 +217,12 @@ - >; - }; - -- -+ i2c1_pins: pinmux_i2c1_pins { -+ pinctrl-single,pins = < -+ OMAP3_CORE1_IOPAD(0x21ba, PIN_INPUT | MUX_MODE0) /* i2c1_scl.i2c1_scl */ -+ OMAP3_CORE1_IOPAD(0x21bc, PIN_INPUT | MUX_MODE0) /* i2c1_sda.i2c1_sda */ -+ >; -+ }; - }; - - &omap3_pmx_wkup { -diff --git a/arch/arm/boot/dts/logicpd-torpedo-som.dtsi b/arch/arm/boot/dts/logicpd-torpedo-som.dtsi -index 6d89736c7b44..cf22b35f0a28 100644 ---- a/arch/arm/boot/dts/logicpd-torpedo-som.dtsi -+++ b/arch/arm/boot/dts/logicpd-torpedo-som.dtsi -@@ -104,6 +104,8 @@ - }; - - &i2c1 { -+ pinctrl-names = "default"; -+ pinctrl-0 = <&i2c1_pins>; - clock-frequency = <2600000>; - - twl: twl@48 { -@@ -211,6 +213,12 @@ - OMAP3_CORE1_IOPAD(0x21b8, PIN_INPUT | MUX_MODE0) /* hsusb0_data7.hsusb0_data7 */ - >; - }; -+ i2c1_pins: pinmux_i2c1_pins { -+ pinctrl-single,pins = < -+ OMAP3_CORE1_IOPAD(0x21ba, PIN_INPUT | MUX_MODE0) /* i2c1_scl.i2c1_scl */ -+ OMAP3_CORE1_IOPAD(0x21bc, PIN_INPUT | MUX_MODE0) /* i2c1_sda.i2c1_sda */ -+ >; -+ }; - }; - - &uart2 { -diff --git a/arch/arm/boot/dts/rk3288-phycore-som.dtsi b/arch/arm/boot/dts/rk3288-phycore-som.dtsi -index 99cfae875e12..5eae4776ffde 100644 ---- a/arch/arm/boot/dts/rk3288-phycore-som.dtsi -+++ b/arch/arm/boot/dts/rk3288-phycore-som.dtsi -@@ -110,26 +110,6 @@ - }; - }; - --&cpu0 { -- cpu0-supply = <&vdd_cpu>; -- operating-points = < -- /* KHz uV */ -- 1800000 1400000 -- 1608000 1350000 -- 1512000 1300000 -- 1416000 1200000 -- 1200000 1100000 -- 1008000 1050000 -- 816000 1000000 -- 696000 950000 -- 600000 900000 -- 408000 900000 -- 312000 900000 -- 216000 900000 -- 126000 900000 -- >; --}; -- - &emmc { - status = "okay"; - bus-width = <8>; -diff --git a/arch/arm/kvm/hyp/Makefile b/arch/arm/kvm/hyp/Makefile -index 5638ce0c9524..63d6b404d88e 100644 ---- a/arch/arm/kvm/hyp/Makefile -+++ b/arch/arm/kvm/hyp/Makefile -@@ -7,6 +7,8 @@ ccflags-y += -fno-stack-protector -DDISABLE_BRANCH_PROFILING - - KVM=../../../../virt/kvm - -+CFLAGS_ARMV7VE :=$(call cc-option, -march=armv7ve) -+ - obj-$(CONFIG_KVM_ARM_HOST) += $(KVM)/arm/hyp/vgic-v2-sr.o - obj-$(CONFIG_KVM_ARM_HOST) += $(KVM)/arm/hyp/vgic-v3-sr.o - obj-$(CONFIG_KVM_ARM_HOST) += $(KVM)/arm/hyp/timer-sr.o -@@ -15,7 +17,10 @@ obj-$(CONFIG_KVM_ARM_HOST) += tlb.o - obj-$(CONFIG_KVM_ARM_HOST) += cp15-sr.o - obj-$(CONFIG_KVM_ARM_HOST) += vfp.o - obj-$(CONFIG_KVM_ARM_HOST) += banked-sr.o -+CFLAGS_banked-sr.o += $(CFLAGS_ARMV7VE) -+ - obj-$(CONFIG_KVM_ARM_HOST) += entry.o - obj-$(CONFIG_KVM_ARM_HOST) += hyp-entry.o - obj-$(CONFIG_KVM_ARM_HOST) += switch.o -+CFLAGS_switch.o += $(CFLAGS_ARMV7VE) - obj-$(CONFIG_KVM_ARM_HOST) += s2-setup.o -diff --git a/arch/arm/kvm/hyp/banked-sr.c b/arch/arm/kvm/hyp/banked-sr.c -index 111bda8cdebd..be4b8b0a40ad 100644 ---- a/arch/arm/kvm/hyp/banked-sr.c -+++ b/arch/arm/kvm/hyp/banked-sr.c -@@ -20,6 +20,10 @@ - - #include - -+/* -+ * gcc before 4.9 doesn't understand -march=armv7ve, so we have to -+ * trick the assembler. -+ */ - __asm__(".arch_extension virt"); - - void __hyp_text __banked_save_state(struct kvm_cpu_context *ctxt) -diff --git a/arch/arm/mach-mvebu/Kconfig b/arch/arm/mach-mvebu/Kconfig -index 9b49867154bf..63fa79f9f121 100644 ---- a/arch/arm/mach-mvebu/Kconfig -+++ b/arch/arm/mach-mvebu/Kconfig -@@ -42,7 +42,7 @@ config MACH_ARMADA_375 - depends on ARCH_MULTI_V7 - select ARMADA_370_XP_IRQ - select ARM_ERRATA_720789 -- select ARM_ERRATA_753970 -+ select PL310_ERRATA_753970 - select ARM_GIC - select ARMADA_375_CLK - select HAVE_ARM_SCU -@@ -58,7 +58,7 @@ config MACH_ARMADA_38X - bool "Marvell Armada 380/385 boards" - depends on ARCH_MULTI_V7 - select ARM_ERRATA_720789 -- select ARM_ERRATA_753970 -+ select PL310_ERRATA_753970 - select ARM_GIC - select ARM_GLOBAL_TIMER - select CLKSRC_ARM_GLOBAL_TIMER_SCHED_CLOCK -diff --git a/arch/arm/plat-orion/common.c b/arch/arm/plat-orion/common.c -index aff6994950ba..a2399fd66e97 100644 ---- a/arch/arm/plat-orion/common.c -+++ b/arch/arm/plat-orion/common.c -@@ -472,28 +472,27 @@ void __init orion_ge11_init(struct mv643xx_eth_platform_data *eth_data, - /***************************************************************************** - * Ethernet switch - ****************************************************************************/ --static __initconst const char *orion_ge00_mvmdio_bus_name = "orion-mii"; --static __initdata struct mdio_board_info -- orion_ge00_switch_board_info; -+static __initdata struct mdio_board_info orion_ge00_switch_board_info = { -+ .bus_id = "orion-mii", -+ .modalias = "mv88e6085", -+}; - - void __init orion_ge00_switch_init(struct dsa_chip_data *d) - { -- struct mdio_board_info *bd; - unsigned int i; - - if (!IS_BUILTIN(CONFIG_PHYLIB)) - return; - -- for (i = 0; i < ARRAY_SIZE(d->port_names); i++) -- if (!strcmp(d->port_names[i], "cpu")) -+ for (i = 0; i < ARRAY_SIZE(d->port_names); i++) { -+ if (!strcmp(d->port_names[i], "cpu")) { -+ d->netdev[i] = &orion_ge00.dev; - break; -+ } -+ } - -- bd = &orion_ge00_switch_board_info; -- bd->bus_id = orion_ge00_mvmdio_bus_name; -- bd->mdio_addr = d->sw_addr; -- d->netdev[i] = &orion_ge00.dev; -- strcpy(bd->modalias, "mv88e6085"); -- bd->platform_data = d; -+ orion_ge00_switch_board_info.mdio_addr = d->sw_addr; -+ orion_ge00_switch_board_info.platform_data = d; - - mdiobus_register_board_info(&orion_ge00_switch_board_info, 1); - } -diff --git a/arch/parisc/include/asm/cacheflush.h b/arch/parisc/include/asm/cacheflush.h -index 3742508cc534..bd5ce31936f5 100644 ---- a/arch/parisc/include/asm/cacheflush.h -+++ b/arch/parisc/include/asm/cacheflush.h -@@ -26,6 +26,7 @@ void flush_user_icache_range_asm(unsigned long, unsigned long); - void flush_kernel_icache_range_asm(unsigned long, unsigned long); - void flush_user_dcache_range_asm(unsigned long, unsigned long); - void flush_kernel_dcache_range_asm(unsigned long, unsigned long); -+void purge_kernel_dcache_range_asm(unsigned long, unsigned long); - void flush_kernel_dcache_page_asm(void *); - void flush_kernel_icache_page(void *); - -diff --git a/arch/parisc/include/asm/processor.h b/arch/parisc/include/asm/processor.h -index 0e6ab6e4a4e9..2dbe5580a1a4 100644 ---- a/arch/parisc/include/asm/processor.h -+++ b/arch/parisc/include/asm/processor.h -@@ -316,6 +316,8 @@ extern int _parisc_requires_coherency; - #define parisc_requires_coherency() (0) - #endif - -+extern int running_on_qemu; -+ - #endif /* __ASSEMBLY__ */ - - #endif /* __ASM_PARISC_PROCESSOR_H */ -diff --git a/arch/parisc/kernel/cache.c b/arch/parisc/kernel/cache.c -index 19c0c141bc3f..79089778725b 100644 ---- a/arch/parisc/kernel/cache.c -+++ b/arch/parisc/kernel/cache.c -@@ -465,10 +465,10 @@ EXPORT_SYMBOL(copy_user_page); - int __flush_tlb_range(unsigned long sid, unsigned long start, - unsigned long end) - { -- unsigned long flags, size; -+ unsigned long flags; - -- size = (end - start); -- if (size >= parisc_tlb_flush_threshold) { -+ if ((!IS_ENABLED(CONFIG_SMP) || !arch_irqs_disabled()) && -+ end - start >= parisc_tlb_flush_threshold) { - flush_tlb_all(); - return 1; - } -@@ -539,13 +539,11 @@ void flush_cache_mm(struct mm_struct *mm) - struct vm_area_struct *vma; - pgd_t *pgd; - -- /* Flush the TLB to avoid speculation if coherency is required. */ -- if (parisc_requires_coherency()) -- flush_tlb_all(); -- - /* Flushing the whole cache on each cpu takes forever on - rp3440, etc. So, avoid it if the mm isn't too big. */ -- if (mm_total_size(mm) >= parisc_cache_flush_threshold) { -+ if ((!IS_ENABLED(CONFIG_SMP) || !arch_irqs_disabled()) && -+ mm_total_size(mm) >= parisc_cache_flush_threshold) { -+ flush_tlb_all(); - flush_cache_all(); - return; - } -@@ -553,9 +551,9 @@ void flush_cache_mm(struct mm_struct *mm) - if (mm->context == mfsp(3)) { - for (vma = mm->mmap; vma; vma = vma->vm_next) { - flush_user_dcache_range_asm(vma->vm_start, vma->vm_end); -- if ((vma->vm_flags & VM_EXEC) == 0) -- continue; -- flush_user_icache_range_asm(vma->vm_start, vma->vm_end); -+ if (vma->vm_flags & VM_EXEC) -+ flush_user_icache_range_asm(vma->vm_start, vma->vm_end); -+ flush_tlb_range(vma, vma->vm_start, vma->vm_end); - } - return; - } -@@ -581,14 +579,9 @@ void flush_cache_mm(struct mm_struct *mm) - void flush_cache_range(struct vm_area_struct *vma, - unsigned long start, unsigned long end) - { -- BUG_ON(!vma->vm_mm->context); -- -- /* Flush the TLB to avoid speculation if coherency is required. */ -- if (parisc_requires_coherency()) -+ if ((!IS_ENABLED(CONFIG_SMP) || !arch_irqs_disabled()) && -+ end - start >= parisc_cache_flush_threshold) { - flush_tlb_range(vma, start, end); -- -- if ((end - start) >= parisc_cache_flush_threshold -- || vma->vm_mm->context != mfsp(3)) { - flush_cache_all(); - return; - } -@@ -596,6 +589,7 @@ void flush_cache_range(struct vm_area_struct *vma, - flush_user_dcache_range_asm(start, end); - if (vma->vm_flags & VM_EXEC) - flush_user_icache_range_asm(start, end); -+ flush_tlb_range(vma, start, end); - } - - void -@@ -604,8 +598,7 @@ flush_cache_page(struct vm_area_struct *vma, unsigned long vmaddr, unsigned long - BUG_ON(!vma->vm_mm->context); - - if (pfn_valid(pfn)) { -- if (parisc_requires_coherency()) -- flush_tlb_page(vma, vmaddr); -+ flush_tlb_page(vma, vmaddr); - __flush_cache_page(vma, vmaddr, PFN_PHYS(pfn)); - } - } -@@ -613,21 +606,33 @@ flush_cache_page(struct vm_area_struct *vma, unsigned long vmaddr, unsigned long - void flush_kernel_vmap_range(void *vaddr, int size) - { - unsigned long start = (unsigned long)vaddr; -+ unsigned long end = start + size; - -- if ((unsigned long)size > parisc_cache_flush_threshold) -+ if ((!IS_ENABLED(CONFIG_SMP) || !arch_irqs_disabled()) && -+ (unsigned long)size >= parisc_cache_flush_threshold) { -+ flush_tlb_kernel_range(start, end); - flush_data_cache(); -- else -- flush_kernel_dcache_range_asm(start, start + size); -+ return; -+ } -+ -+ flush_kernel_dcache_range_asm(start, end); -+ flush_tlb_kernel_range(start, end); - } - EXPORT_SYMBOL(flush_kernel_vmap_range); - - void invalidate_kernel_vmap_range(void *vaddr, int size) - { - unsigned long start = (unsigned long)vaddr; -+ unsigned long end = start + size; - -- if ((unsigned long)size > parisc_cache_flush_threshold) -+ if ((!IS_ENABLED(CONFIG_SMP) || !arch_irqs_disabled()) && -+ (unsigned long)size >= parisc_cache_flush_threshold) { -+ flush_tlb_kernel_range(start, end); - flush_data_cache(); -- else -- flush_kernel_dcache_range_asm(start, start + size); -+ return; -+ } -+ -+ purge_kernel_dcache_range_asm(start, end); -+ flush_tlb_kernel_range(start, end); - } - EXPORT_SYMBOL(invalidate_kernel_vmap_range); -diff --git a/arch/parisc/kernel/pacache.S b/arch/parisc/kernel/pacache.S -index 2d40c4ff3f69..67b0f7532e83 100644 ---- a/arch/parisc/kernel/pacache.S -+++ b/arch/parisc/kernel/pacache.S -@@ -1110,6 +1110,28 @@ ENTRY_CFI(flush_kernel_dcache_range_asm) - .procend - ENDPROC_CFI(flush_kernel_dcache_range_asm) - -+ENTRY_CFI(purge_kernel_dcache_range_asm) -+ .proc -+ .callinfo NO_CALLS -+ .entry -+ -+ ldil L%dcache_stride, %r1 -+ ldw R%dcache_stride(%r1), %r23 -+ ldo -1(%r23), %r21 -+ ANDCM %r26, %r21, %r26 -+ -+1: cmpb,COND(<<),n %r26, %r25,1b -+ pdc,m %r23(%r26) -+ -+ sync -+ syncdma -+ bv %r0(%r2) -+ nop -+ .exit -+ -+ .procend -+ENDPROC_CFI(purge_kernel_dcache_range_asm) -+ - ENTRY_CFI(flush_user_icache_range_asm) - .proc - .callinfo NO_CALLS -diff --git a/arch/parisc/kernel/time.c b/arch/parisc/kernel/time.c -index 4b8fd6dc22da..f7e684560186 100644 ---- a/arch/parisc/kernel/time.c -+++ b/arch/parisc/kernel/time.c -@@ -76,10 +76,10 @@ irqreturn_t __irq_entry timer_interrupt(int irq, void *dev_id) - next_tick = cpuinfo->it_value; - - /* Calculate how many ticks have elapsed. */ -+ now = mfctl(16); - do { - ++ticks_elapsed; - next_tick += cpt; -- now = mfctl(16); - } while (next_tick - now > cpt); - - /* Store (in CR16 cycles) up to when we are accounting right now. */ -@@ -103,16 +103,17 @@ irqreturn_t __irq_entry timer_interrupt(int irq, void *dev_id) - * if one or the other wrapped. If "now" is "bigger" we'll end up - * with a very large unsigned number. - */ -- while (next_tick - mfctl(16) > cpt) -+ now = mfctl(16); -+ while (next_tick - now > cpt) - next_tick += cpt; - - /* Program the IT when to deliver the next interrupt. - * Only bottom 32-bits of next_tick are writable in CR16! - * Timer interrupt will be delivered at least a few hundred cycles -- * after the IT fires, so if we are too close (<= 500 cycles) to the -+ * after the IT fires, so if we are too close (<= 8000 cycles) to the - * next cycle, simply skip it. - */ -- if (next_tick - mfctl(16) <= 500) -+ if (next_tick - now <= 8000) - next_tick += cpt; - mtctl(next_tick, 16); - -@@ -248,7 +249,7 @@ static int __init init_cr16_clocksource(void) - * different sockets, so mark them unstable and lower rating on - * multi-socket SMP systems. - */ -- if (num_online_cpus() > 1) { -+ if (num_online_cpus() > 1 && !running_on_qemu) { - int cpu; - unsigned long cpu0_loc; - cpu0_loc = per_cpu(cpu_data, 0).cpu_loc; -diff --git a/arch/s390/kvm/interrupt.c b/arch/s390/kvm/interrupt.c -index a832ad031cee..5185be314661 100644 ---- a/arch/s390/kvm/interrupt.c -+++ b/arch/s390/kvm/interrupt.c -@@ -173,8 +173,15 @@ static int ckc_interrupts_enabled(struct kvm_vcpu *vcpu) - - static int ckc_irq_pending(struct kvm_vcpu *vcpu) - { -- if (vcpu->arch.sie_block->ckc >= kvm_s390_get_tod_clock_fast(vcpu->kvm)) -+ const u64 now = kvm_s390_get_tod_clock_fast(vcpu->kvm); -+ const u64 ckc = vcpu->arch.sie_block->ckc; -+ -+ if (vcpu->arch.sie_block->gcr[0] & 0x0020000000000000ul) { -+ if ((s64)ckc >= (s64)now) -+ return 0; -+ } else if (ckc >= now) { - return 0; -+ } - return ckc_interrupts_enabled(vcpu); - } - -@@ -1004,13 +1011,19 @@ int kvm_cpu_has_pending_timer(struct kvm_vcpu *vcpu) - - static u64 __calculate_sltime(struct kvm_vcpu *vcpu) - { -- u64 now, cputm, sltime = 0; -+ const u64 now = kvm_s390_get_tod_clock_fast(vcpu->kvm); -+ const u64 ckc = vcpu->arch.sie_block->ckc; -+ u64 cputm, sltime = 0; - - if (ckc_interrupts_enabled(vcpu)) { -- now = kvm_s390_get_tod_clock_fast(vcpu->kvm); -- sltime = tod_to_ns(vcpu->arch.sie_block->ckc - now); -- /* already expired or overflow? */ -- if (!sltime || vcpu->arch.sie_block->ckc <= now) -+ if (vcpu->arch.sie_block->gcr[0] & 0x0020000000000000ul) { -+ if ((s64)now < (s64)ckc) -+ sltime = tod_to_ns((s64)ckc - (s64)now); -+ } else if (now < ckc) { -+ sltime = tod_to_ns(ckc - now); -+ } -+ /* already expired */ -+ if (!sltime) - return 0; - if (cpu_timer_interrupts_enabled(vcpu)) { - cputm = kvm_s390_get_cpu_timer(vcpu); -diff --git a/arch/s390/kvm/kvm-s390.c b/arch/s390/kvm/kvm-s390.c -index 6e3d80b2048e..f4f12ecd0cec 100644 ---- a/arch/s390/kvm/kvm-s390.c -+++ b/arch/s390/kvm/kvm-s390.c -@@ -169,6 +169,28 @@ int kvm_arch_hardware_enable(void) - static void kvm_gmap_notifier(struct gmap *gmap, unsigned long start, - unsigned long end); - -+static void kvm_clock_sync_scb(struct kvm_s390_sie_block *scb, u64 delta) -+{ -+ u8 delta_idx = 0; -+ -+ /* -+ * The TOD jumps by delta, we have to compensate this by adding -+ * -delta to the epoch. -+ */ -+ delta = -delta; -+ -+ /* sign-extension - we're adding to signed values below */ -+ if ((s64)delta < 0) -+ delta_idx = -1; -+ -+ scb->epoch += delta; -+ if (scb->ecd & ECD_MEF) { -+ scb->epdx += delta_idx; -+ if (scb->epoch < delta) -+ scb->epdx += 1; -+ } -+} -+ - /* - * This callback is executed during stop_machine(). All CPUs are therefore - * temporarily stopped. In order not to change guest behavior, we have to -@@ -184,13 +206,17 @@ static int kvm_clock_sync(struct notifier_block *notifier, unsigned long val, - unsigned long long *delta = v; - - list_for_each_entry(kvm, &vm_list, vm_list) { -- kvm->arch.epoch -= *delta; - kvm_for_each_vcpu(i, vcpu, kvm) { -- vcpu->arch.sie_block->epoch -= *delta; -+ kvm_clock_sync_scb(vcpu->arch.sie_block, *delta); -+ if (i == 0) { -+ kvm->arch.epoch = vcpu->arch.sie_block->epoch; -+ kvm->arch.epdx = vcpu->arch.sie_block->epdx; -+ } - if (vcpu->arch.cputm_enabled) - vcpu->arch.cputm_start += *delta; - if (vcpu->arch.vsie_block) -- vcpu->arch.vsie_block->epoch -= *delta; -+ kvm_clock_sync_scb(vcpu->arch.vsie_block, -+ *delta); - } - } - return NOTIFY_OK; -@@ -888,12 +914,9 @@ static int kvm_s390_set_tod_ext(struct kvm *kvm, struct kvm_device_attr *attr) - if (copy_from_user(>od, (void __user *)attr->addr, sizeof(gtod))) - return -EFAULT; - -- if (test_kvm_facility(kvm, 139)) -- kvm_s390_set_tod_clock_ext(kvm, >od); -- else if (gtod.epoch_idx == 0) -- kvm_s390_set_tod_clock(kvm, gtod.tod); -- else -+ if (!test_kvm_facility(kvm, 139) && gtod.epoch_idx) - return -EINVAL; -+ kvm_s390_set_tod_clock(kvm, >od); - - VM_EVENT(kvm, 3, "SET: TOD extension: 0x%x, TOD base: 0x%llx", - gtod.epoch_idx, gtod.tod); -@@ -918,13 +941,14 @@ static int kvm_s390_set_tod_high(struct kvm *kvm, struct kvm_device_attr *attr) - - static int kvm_s390_set_tod_low(struct kvm *kvm, struct kvm_device_attr *attr) - { -- u64 gtod; -+ struct kvm_s390_vm_tod_clock gtod = { 0 }; - -- if (copy_from_user(>od, (void __user *)attr->addr, sizeof(gtod))) -+ if (copy_from_user(>od.tod, (void __user *)attr->addr, -+ sizeof(gtod.tod))) - return -EFAULT; - -- kvm_s390_set_tod_clock(kvm, gtod); -- VM_EVENT(kvm, 3, "SET: TOD base: 0x%llx", gtod); -+ kvm_s390_set_tod_clock(kvm, >od); -+ VM_EVENT(kvm, 3, "SET: TOD base: 0x%llx", gtod.tod); - return 0; - } - -@@ -2359,6 +2383,7 @@ void kvm_arch_vcpu_postcreate(struct kvm_vcpu *vcpu) - mutex_lock(&vcpu->kvm->lock); - preempt_disable(); - vcpu->arch.sie_block->epoch = vcpu->kvm->arch.epoch; -+ vcpu->arch.sie_block->epdx = vcpu->kvm->arch.epdx; - preempt_enable(); - mutex_unlock(&vcpu->kvm->lock); - if (!kvm_is_ucontrol(vcpu->kvm)) { -@@ -2945,8 +2970,8 @@ static int kvm_s390_handle_requests(struct kvm_vcpu *vcpu) - return 0; - } - --void kvm_s390_set_tod_clock_ext(struct kvm *kvm, -- const struct kvm_s390_vm_tod_clock *gtod) -+void kvm_s390_set_tod_clock(struct kvm *kvm, -+ const struct kvm_s390_vm_tod_clock *gtod) - { - struct kvm_vcpu *vcpu; - struct kvm_s390_tod_clock_ext htod; -@@ -2958,10 +2983,12 @@ void kvm_s390_set_tod_clock_ext(struct kvm *kvm, - get_tod_clock_ext((char *)&htod); - - kvm->arch.epoch = gtod->tod - htod.tod; -- kvm->arch.epdx = gtod->epoch_idx - htod.epoch_idx; -- -- if (kvm->arch.epoch > gtod->tod) -- kvm->arch.epdx -= 1; -+ kvm->arch.epdx = 0; -+ if (test_kvm_facility(kvm, 139)) { -+ kvm->arch.epdx = gtod->epoch_idx - htod.epoch_idx; -+ if (kvm->arch.epoch > gtod->tod) -+ kvm->arch.epdx -= 1; -+ } - - kvm_s390_vcpu_block_all(kvm); - kvm_for_each_vcpu(i, vcpu, kvm) { -@@ -2974,22 +3001,6 @@ void kvm_s390_set_tod_clock_ext(struct kvm *kvm, - mutex_unlock(&kvm->lock); - } - --void kvm_s390_set_tod_clock(struct kvm *kvm, u64 tod) --{ -- struct kvm_vcpu *vcpu; -- int i; -- -- mutex_lock(&kvm->lock); -- preempt_disable(); -- kvm->arch.epoch = tod - get_tod_clock(); -- kvm_s390_vcpu_block_all(kvm); -- kvm_for_each_vcpu(i, vcpu, kvm) -- vcpu->arch.sie_block->epoch = kvm->arch.epoch; -- kvm_s390_vcpu_unblock_all(kvm); -- preempt_enable(); -- mutex_unlock(&kvm->lock); --} -- - /** - * kvm_arch_fault_in_page - fault-in guest page if necessary - * @vcpu: The corresponding virtual cpu -diff --git a/arch/s390/kvm/kvm-s390.h b/arch/s390/kvm/kvm-s390.h -index 9f8fdd7b2311..e22d94f494a7 100644 ---- a/arch/s390/kvm/kvm-s390.h -+++ b/arch/s390/kvm/kvm-s390.h -@@ -272,9 +272,8 @@ int kvm_s390_handle_sigp_pei(struct kvm_vcpu *vcpu); - int handle_sthyi(struct kvm_vcpu *vcpu); - - /* implemented in kvm-s390.c */ --void kvm_s390_set_tod_clock_ext(struct kvm *kvm, -- const struct kvm_s390_vm_tod_clock *gtod); --void kvm_s390_set_tod_clock(struct kvm *kvm, u64 tod); -+void kvm_s390_set_tod_clock(struct kvm *kvm, -+ const struct kvm_s390_vm_tod_clock *gtod); - long kvm_arch_fault_in_page(struct kvm_vcpu *vcpu, gpa_t gpa, int writable); - int kvm_s390_store_status_unloaded(struct kvm_vcpu *vcpu, unsigned long addr); - int kvm_s390_vcpu_store_status(struct kvm_vcpu *vcpu, unsigned long addr); -diff --git a/arch/s390/kvm/priv.c b/arch/s390/kvm/priv.c -index 7bd3a59232f0..734283a21677 100644 ---- a/arch/s390/kvm/priv.c -+++ b/arch/s390/kvm/priv.c -@@ -84,9 +84,10 @@ int kvm_s390_handle_e3(struct kvm_vcpu *vcpu) - /* Handle SCK (SET CLOCK) interception */ - static int handle_set_clock(struct kvm_vcpu *vcpu) - { -+ struct kvm_s390_vm_tod_clock gtod = { 0 }; - int rc; - u8 ar; -- u64 op2, val; -+ u64 op2; - - if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE) - return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP); -@@ -94,12 +95,12 @@ static int handle_set_clock(struct kvm_vcpu *vcpu) - op2 = kvm_s390_get_base_disp_s(vcpu, &ar); - if (op2 & 7) /* Operand must be on a doubleword boundary */ - return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION); -- rc = read_guest(vcpu, op2, ar, &val, sizeof(val)); -+ rc = read_guest(vcpu, op2, ar, >od.tod, sizeof(gtod.tod)); - if (rc) - return kvm_s390_inject_prog_cond(vcpu, rc); - -- VCPU_EVENT(vcpu, 3, "SCK: setting guest TOD to 0x%llx", val); -- kvm_s390_set_tod_clock(vcpu->kvm, val); -+ VCPU_EVENT(vcpu, 3, "SCK: setting guest TOD to 0x%llx", gtod.tod); -+ kvm_s390_set_tod_clock(vcpu->kvm, >od); - - kvm_s390_set_psw_cc(vcpu, 0); - return 0; -diff --git a/arch/x86/include/asm/pgtable.h b/arch/x86/include/asm/pgtable.h -index 8b8f1f14a0bf..5c790e93657d 100644 ---- a/arch/x86/include/asm/pgtable.h -+++ b/arch/x86/include/asm/pgtable.h -@@ -350,14 +350,14 @@ static inline pmd_t pmd_set_flags(pmd_t pmd, pmdval_t set) - { - pmdval_t v = native_pmd_val(pmd); - -- return __pmd(v | set); -+ return native_make_pmd(v | set); - } - - static inline pmd_t pmd_clear_flags(pmd_t pmd, pmdval_t clear) - { - pmdval_t v = native_pmd_val(pmd); - -- return __pmd(v & ~clear); -+ return native_make_pmd(v & ~clear); - } - - static inline pmd_t pmd_mkold(pmd_t pmd) -@@ -409,14 +409,14 @@ static inline pud_t pud_set_flags(pud_t pud, pudval_t set) - { - pudval_t v = native_pud_val(pud); - -- return __pud(v | set); -+ return native_make_pud(v | set); - } - - static inline pud_t pud_clear_flags(pud_t pud, pudval_t clear) - { - pudval_t v = native_pud_val(pud); - -- return __pud(v & ~clear); -+ return native_make_pud(v & ~clear); - } - - static inline pud_t pud_mkold(pud_t pud) -diff --git a/arch/x86/include/asm/pgtable_32.h b/arch/x86/include/asm/pgtable_32.h -index e55466760ff8..b3ec519e3982 100644 ---- a/arch/x86/include/asm/pgtable_32.h -+++ b/arch/x86/include/asm/pgtable_32.h -@@ -32,6 +32,7 @@ extern pmd_t initial_pg_pmd[]; - static inline void pgtable_cache_init(void) { } - static inline void check_pgt_cache(void) { } - void paging_init(void); -+void sync_initial_page_table(void); - - /* - * Define this if things work differently on an i386 and an i486: -diff --git a/arch/x86/include/asm/pgtable_64.h b/arch/x86/include/asm/pgtable_64.h -index 81462e9a34f6..1149d2112b2e 100644 ---- a/arch/x86/include/asm/pgtable_64.h -+++ b/arch/x86/include/asm/pgtable_64.h -@@ -28,6 +28,7 @@ extern pgd_t init_top_pgt[]; - #define swapper_pg_dir init_top_pgt - - extern void paging_init(void); -+static inline void sync_initial_page_table(void) { } - - #define pte_ERROR(e) \ - pr_err("%s:%d: bad pte %p(%016lx)\n", \ -diff --git a/arch/x86/include/asm/pgtable_types.h b/arch/x86/include/asm/pgtable_types.h -index 3696398a9475..246f15b4e64c 100644 ---- a/arch/x86/include/asm/pgtable_types.h -+++ b/arch/x86/include/asm/pgtable_types.h -@@ -323,6 +323,11 @@ static inline pudval_t native_pud_val(pud_t pud) - #else - #include - -+static inline pud_t native_make_pud(pudval_t val) -+{ -+ return (pud_t) { .p4d.pgd = native_make_pgd(val) }; -+} -+ - static inline pudval_t native_pud_val(pud_t pud) - { - return native_pgd_val(pud.p4d.pgd); -@@ -344,6 +349,11 @@ static inline pmdval_t native_pmd_val(pmd_t pmd) - #else - #include - -+static inline pmd_t native_make_pmd(pmdval_t val) -+{ -+ return (pmd_t) { .pud.p4d.pgd = native_make_pgd(val) }; -+} -+ - static inline pmdval_t native_pmd_val(pmd_t pmd) - { - return native_pgd_val(pmd.pud.p4d.pgd); -diff --git a/arch/x86/kernel/setup.c b/arch/x86/kernel/setup.c -index c54361a22f59..efbcf5283520 100644 ---- a/arch/x86/kernel/setup.c -+++ b/arch/x86/kernel/setup.c -@@ -1238,20 +1238,13 @@ void __init setup_arch(char **cmdline_p) - - kasan_init(); - --#ifdef CONFIG_X86_32 -- /* sync back kernel address range */ -- clone_pgd_range(initial_page_table + KERNEL_PGD_BOUNDARY, -- swapper_pg_dir + KERNEL_PGD_BOUNDARY, -- KERNEL_PGD_PTRS); -- - /* -- * sync back low identity map too. It is used for example -- * in the 32-bit EFI stub. -+ * Sync back kernel address range. -+ * -+ * FIXME: Can the later sync in setup_cpu_entry_areas() replace -+ * this call? - */ -- clone_pgd_range(initial_page_table, -- swapper_pg_dir + KERNEL_PGD_BOUNDARY, -- min(KERNEL_PGD_PTRS, KERNEL_PGD_BOUNDARY)); --#endif -+ sync_initial_page_table(); - - tboot_probe(); - -diff --git a/arch/x86/kernel/setup_percpu.c b/arch/x86/kernel/setup_percpu.c -index 497aa766fab3..ea554f812ee1 100644 ---- a/arch/x86/kernel/setup_percpu.c -+++ b/arch/x86/kernel/setup_percpu.c -@@ -287,24 +287,15 @@ void __init setup_per_cpu_areas(void) - /* Setup cpu initialized, callin, callout masks */ - setup_cpu_local_masks(); - --#ifdef CONFIG_X86_32 - /* - * Sync back kernel address range again. We already did this in - * setup_arch(), but percpu data also needs to be available in - * the smpboot asm. We can't reliably pick up percpu mappings - * using vmalloc_fault(), because exception dispatch needs - * percpu data. -+ * -+ * FIXME: Can the later sync in setup_cpu_entry_areas() replace -+ * this call? - */ -- clone_pgd_range(initial_page_table + KERNEL_PGD_BOUNDARY, -- swapper_pg_dir + KERNEL_PGD_BOUNDARY, -- KERNEL_PGD_PTRS); -- -- /* -- * sync back low identity map too. It is used for example -- * in the 32-bit EFI stub. -- */ -- clone_pgd_range(initial_page_table, -- swapper_pg_dir + KERNEL_PGD_BOUNDARY, -- min(KERNEL_PGD_PTRS, KERNEL_PGD_BOUNDARY)); --#endif -+ sync_initial_page_table(); - } -diff --git a/arch/x86/kvm/lapic.c b/arch/x86/kvm/lapic.c -index ef03efba1c23..8cfdb6484fd0 100644 ---- a/arch/x86/kvm/lapic.c -+++ b/arch/x86/kvm/lapic.c -@@ -1944,14 +1944,13 @@ void kvm_lapic_set_base(struct kvm_vcpu *vcpu, u64 value) - - void kvm_lapic_reset(struct kvm_vcpu *vcpu, bool init_event) - { -- struct kvm_lapic *apic; -+ struct kvm_lapic *apic = vcpu->arch.apic; - int i; - -- apic_debug("%s\n", __func__); -+ if (!apic) -+ return; - -- ASSERT(vcpu); -- apic = vcpu->arch.apic; -- ASSERT(apic != NULL); -+ apic_debug("%s\n", __func__); - - /* Stop the timer in case it's a reset to an active apic */ - hrtimer_cancel(&apic->lapic_timer.timer); -@@ -2107,7 +2106,6 @@ int kvm_create_lapic(struct kvm_vcpu *vcpu) - */ - vcpu->arch.apic_base = MSR_IA32_APICBASE_ENABLE; - static_key_slow_inc(&apic_sw_disabled.key); /* sw disabled at reset */ -- kvm_lapic_reset(vcpu, false); - kvm_iodevice_init(&apic->dev, &apic_mmio_ops); - - return 0; -@@ -2511,7 +2509,6 @@ void kvm_apic_accept_events(struct kvm_vcpu *vcpu) - - pe = xchg(&apic->pending_events, 0); - if (test_bit(KVM_APIC_INIT, &pe)) { -- kvm_lapic_reset(vcpu, true); - kvm_vcpu_reset(vcpu, true); - if (kvm_vcpu_is_bsp(apic->vcpu)) - vcpu->arch.mp_state = KVM_MP_STATE_RUNNABLE; -diff --git a/arch/x86/kvm/mmu.c b/arch/x86/kvm/mmu.c -index ca000fc644bc..2b6f8a4f2731 100644 ---- a/arch/x86/kvm/mmu.c -+++ b/arch/x86/kvm/mmu.c -@@ -150,6 +150,20 @@ module_param(dbg, bool, 0644); - /* make pte_list_desc fit well in cache line */ - #define PTE_LIST_EXT 3 - -+/* -+ * Return values of handle_mmio_page_fault and mmu.page_fault: -+ * RET_PF_RETRY: let CPU fault again on the address. -+ * RET_PF_EMULATE: mmio page fault, emulate the instruction directly. -+ * -+ * For handle_mmio_page_fault only: -+ * RET_PF_INVALID: the spte is invalid, let the real page fault path update it. -+ */ -+enum { -+ RET_PF_RETRY = 0, -+ RET_PF_EMULATE = 1, -+ RET_PF_INVALID = 2, -+}; -+ - struct pte_list_desc { - u64 *sptes[PTE_LIST_EXT]; - struct pte_list_desc *more; -@@ -2794,13 +2808,13 @@ static int set_spte(struct kvm_vcpu *vcpu, u64 *sptep, - return ret; - } - --static bool mmu_set_spte(struct kvm_vcpu *vcpu, u64 *sptep, unsigned pte_access, -- int write_fault, int level, gfn_t gfn, kvm_pfn_t pfn, -- bool speculative, bool host_writable) -+static int mmu_set_spte(struct kvm_vcpu *vcpu, u64 *sptep, unsigned pte_access, -+ int write_fault, int level, gfn_t gfn, kvm_pfn_t pfn, -+ bool speculative, bool host_writable) - { - int was_rmapped = 0; - int rmap_count; -- bool emulate = false; -+ int ret = RET_PF_RETRY; - - pgprintk("%s: spte %llx write_fault %d gfn %llx\n", __func__, - *sptep, write_fault, gfn); -@@ -2830,12 +2844,12 @@ static bool mmu_set_spte(struct kvm_vcpu *vcpu, u64 *sptep, unsigned pte_access, - if (set_spte(vcpu, sptep, pte_access, level, gfn, pfn, speculative, - true, host_writable)) { - if (write_fault) -- emulate = true; -+ ret = RET_PF_EMULATE; - kvm_make_request(KVM_REQ_TLB_FLUSH, vcpu); - } - - if (unlikely(is_mmio_spte(*sptep))) -- emulate = true; -+ ret = RET_PF_EMULATE; - - pgprintk("%s: setting spte %llx\n", __func__, *sptep); - pgprintk("instantiating %s PTE (%s) at %llx (%llx) addr %p\n", -@@ -2855,7 +2869,7 @@ static bool mmu_set_spte(struct kvm_vcpu *vcpu, u64 *sptep, unsigned pte_access, - - kvm_release_pfn_clean(pfn); - -- return emulate; -+ return ret; - } - - static kvm_pfn_t pte_prefetch_gfn_to_pfn(struct kvm_vcpu *vcpu, gfn_t gfn, -@@ -2994,17 +3008,16 @@ static int kvm_handle_bad_page(struct kvm_vcpu *vcpu, gfn_t gfn, kvm_pfn_t pfn) - * Do not cache the mmio info caused by writing the readonly gfn - * into the spte otherwise read access on readonly gfn also can - * caused mmio page fault and treat it as mmio access. -- * Return 1 to tell kvm to emulate it. - */ - if (pfn == KVM_PFN_ERR_RO_FAULT) -- return 1; -+ return RET_PF_EMULATE; - - if (pfn == KVM_PFN_ERR_HWPOISON) { - kvm_send_hwpoison_signal(kvm_vcpu_gfn_to_hva(vcpu, gfn), current); -- return 0; -+ return RET_PF_RETRY; - } - -- return -EFAULT; -+ return RET_PF_EMULATE; - } - - static void transparent_hugepage_adjust(struct kvm_vcpu *vcpu, -@@ -3286,13 +3299,13 @@ static int nonpaging_map(struct kvm_vcpu *vcpu, gva_t v, u32 error_code, - } - - if (fast_page_fault(vcpu, v, level, error_code)) -- return 0; -+ return RET_PF_RETRY; - - mmu_seq = vcpu->kvm->mmu_notifier_seq; - smp_rmb(); - - if (try_async_pf(vcpu, prefault, gfn, v, &pfn, write, &map_writable)) -- return 0; -+ return RET_PF_RETRY; - - if (handle_abnormal_pfn(vcpu, v, gfn, pfn, ACC_ALL, &r)) - return r; -@@ -3312,7 +3325,7 @@ static int nonpaging_map(struct kvm_vcpu *vcpu, gva_t v, u32 error_code, - out_unlock: - spin_unlock(&vcpu->kvm->mmu_lock); - kvm_release_pfn_clean(pfn); -- return 0; -+ return RET_PF_RETRY; - } - - -@@ -3659,54 +3672,38 @@ walk_shadow_page_get_mmio_spte(struct kvm_vcpu *vcpu, u64 addr, u64 *sptep) - return reserved; - } - --/* -- * Return values of handle_mmio_page_fault: -- * RET_MMIO_PF_EMULATE: it is a real mmio page fault, emulate the instruction -- * directly. -- * RET_MMIO_PF_INVALID: invalid spte is detected then let the real page -- * fault path update the mmio spte. -- * RET_MMIO_PF_RETRY: let CPU fault again on the address. -- * RET_MMIO_PF_BUG: a bug was detected (and a WARN was printed). -- */ --enum { -- RET_MMIO_PF_EMULATE = 1, -- RET_MMIO_PF_INVALID = 2, -- RET_MMIO_PF_RETRY = 0, -- RET_MMIO_PF_BUG = -1 --}; -- - static int handle_mmio_page_fault(struct kvm_vcpu *vcpu, u64 addr, bool direct) - { - u64 spte; - bool reserved; - - if (mmio_info_in_cache(vcpu, addr, direct)) -- return RET_MMIO_PF_EMULATE; -+ return RET_PF_EMULATE; - - reserved = walk_shadow_page_get_mmio_spte(vcpu, addr, &spte); - if (WARN_ON(reserved)) -- return RET_MMIO_PF_BUG; -+ return -EINVAL; - - if (is_mmio_spte(spte)) { - gfn_t gfn = get_mmio_spte_gfn(spte); - unsigned access = get_mmio_spte_access(spte); - - if (!check_mmio_spte(vcpu, spte)) -- return RET_MMIO_PF_INVALID; -+ return RET_PF_INVALID; - - if (direct) - addr = 0; - - trace_handle_mmio_page_fault(addr, gfn, access); - vcpu_cache_mmio_info(vcpu, addr, gfn, access); -- return RET_MMIO_PF_EMULATE; -+ return RET_PF_EMULATE; - } - - /* - * If the page table is zapped by other cpus, let CPU fault again on - * the address. - */ -- return RET_MMIO_PF_RETRY; -+ return RET_PF_RETRY; - } - EXPORT_SYMBOL_GPL(handle_mmio_page_fault); - -@@ -3756,7 +3753,7 @@ static int nonpaging_page_fault(struct kvm_vcpu *vcpu, gva_t gva, - pgprintk("%s: gva %lx error %x\n", __func__, gva, error_code); - - if (page_fault_handle_page_track(vcpu, error_code, gfn)) -- return 1; -+ return RET_PF_EMULATE; - - r = mmu_topup_memory_caches(vcpu); - if (r) -@@ -3877,7 +3874,7 @@ static int tdp_page_fault(struct kvm_vcpu *vcpu, gva_t gpa, u32 error_code, - MMU_WARN_ON(!VALID_PAGE(vcpu->arch.mmu.root_hpa)); - - if (page_fault_handle_page_track(vcpu, error_code, gfn)) -- return 1; -+ return RET_PF_EMULATE; - - r = mmu_topup_memory_caches(vcpu); - if (r) -@@ -3894,13 +3891,13 @@ static int tdp_page_fault(struct kvm_vcpu *vcpu, gva_t gpa, u32 error_code, - } - - if (fast_page_fault(vcpu, gpa, level, error_code)) -- return 0; -+ return RET_PF_RETRY; - - mmu_seq = vcpu->kvm->mmu_notifier_seq; - smp_rmb(); - - if (try_async_pf(vcpu, prefault, gfn, gpa, &pfn, write, &map_writable)) -- return 0; -+ return RET_PF_RETRY; - - if (handle_abnormal_pfn(vcpu, 0, gfn, pfn, ACC_ALL, &r)) - return r; -@@ -3920,7 +3917,7 @@ static int tdp_page_fault(struct kvm_vcpu *vcpu, gva_t gpa, u32 error_code, - out_unlock: - spin_unlock(&vcpu->kvm->mmu_lock); - kvm_release_pfn_clean(pfn); -- return 0; -+ return RET_PF_RETRY; - } - - static void nonpaging_init_context(struct kvm_vcpu *vcpu, -@@ -4919,25 +4916,25 @@ int kvm_mmu_page_fault(struct kvm_vcpu *vcpu, gva_t cr2, u64 error_code, - vcpu->arch.gpa_val = cr2; - } - -+ r = RET_PF_INVALID; - if (unlikely(error_code & PFERR_RSVD_MASK)) { - r = handle_mmio_page_fault(vcpu, cr2, direct); -- if (r == RET_MMIO_PF_EMULATE) { -+ if (r == RET_PF_EMULATE) { - emulation_type = 0; - goto emulate; - } -- if (r == RET_MMIO_PF_RETRY) -- return 1; -- if (r < 0) -- return r; -- /* Must be RET_MMIO_PF_INVALID. */ - } - -- r = vcpu->arch.mmu.page_fault(vcpu, cr2, lower_32_bits(error_code), -- false); -+ if (r == RET_PF_INVALID) { -+ r = vcpu->arch.mmu.page_fault(vcpu, cr2, lower_32_bits(error_code), -+ false); -+ WARN_ON(r == RET_PF_INVALID); -+ } -+ -+ if (r == RET_PF_RETRY) -+ return 1; - if (r < 0) - return r; -- if (!r) -- return 1; - - /* - * Before emulating the instruction, check if the error code -diff --git a/arch/x86/kvm/paging_tmpl.h b/arch/x86/kvm/paging_tmpl.h -index f18d1f8d332b..5abae72266b7 100644 ---- a/arch/x86/kvm/paging_tmpl.h -+++ b/arch/x86/kvm/paging_tmpl.h -@@ -593,7 +593,7 @@ static int FNAME(fetch)(struct kvm_vcpu *vcpu, gva_t addr, - struct kvm_mmu_page *sp = NULL; - struct kvm_shadow_walk_iterator it; - unsigned direct_access, access = gw->pt_access; -- int top_level, emulate; -+ int top_level, ret; - - direct_access = gw->pte_access; - -@@ -659,15 +659,15 @@ static int FNAME(fetch)(struct kvm_vcpu *vcpu, gva_t addr, - } - - clear_sp_write_flooding_count(it.sptep); -- emulate = mmu_set_spte(vcpu, it.sptep, gw->pte_access, write_fault, -- it.level, gw->gfn, pfn, prefault, map_writable); -+ ret = mmu_set_spte(vcpu, it.sptep, gw->pte_access, write_fault, -+ it.level, gw->gfn, pfn, prefault, map_writable); - FNAME(pte_prefetch)(vcpu, gw, it.sptep); - -- return emulate; -+ return ret; - - out_gpte_changed: - kvm_release_pfn_clean(pfn); -- return 0; -+ return RET_PF_RETRY; - } - - /* -@@ -762,12 +762,12 @@ static int FNAME(page_fault)(struct kvm_vcpu *vcpu, gva_t addr, u32 error_code, - if (!prefault) - inject_page_fault(vcpu, &walker.fault); - -- return 0; -+ return RET_PF_RETRY; - } - - if (page_fault_handle_page_track(vcpu, error_code, walker.gfn)) { - shadow_page_table_clear_flood(vcpu, addr); -- return 1; -+ return RET_PF_EMULATE; - } - - vcpu->arch.write_fault_to_shadow_pgtable = false; -@@ -789,7 +789,7 @@ static int FNAME(page_fault)(struct kvm_vcpu *vcpu, gva_t addr, u32 error_code, - - if (try_async_pf(vcpu, prefault, walker.gfn, addr, &pfn, write_fault, - &map_writable)) -- return 0; -+ return RET_PF_RETRY; - - if (handle_abnormal_pfn(vcpu, addr, walker.gfn, pfn, walker.pte_access, &r)) - return r; -@@ -834,7 +834,7 @@ static int FNAME(page_fault)(struct kvm_vcpu *vcpu, gva_t addr, u32 error_code, - out_unlock: - spin_unlock(&vcpu->kvm->mmu_lock); - kvm_release_pfn_clean(pfn); -- return 0; -+ return RET_PF_RETRY; - } - - static gpa_t FNAME(get_level1_sp_gpa)(struct kvm_mmu_page *sp) -diff --git a/arch/x86/kvm/svm.c b/arch/x86/kvm/svm.c -index e0bc3ad0f6cd..9fb0daf628cb 100644 ---- a/arch/x86/kvm/svm.c -+++ b/arch/x86/kvm/svm.c -@@ -45,6 +45,7 @@ - #include - #include - #include -+#include - #include - - #include -@@ -5015,7 +5016,7 @@ static void svm_vcpu_run(struct kvm_vcpu *vcpu) - * being speculatively taken. - */ - if (svm->spec_ctrl) -- wrmsrl(MSR_IA32_SPEC_CTRL, svm->spec_ctrl); -+ native_wrmsrl(MSR_IA32_SPEC_CTRL, svm->spec_ctrl); - - asm volatile ( - "push %%" _ASM_BP "; \n\t" -@@ -5124,11 +5125,11 @@ static void svm_vcpu_run(struct kvm_vcpu *vcpu) - * If the L02 MSR bitmap does not intercept the MSR, then we need to - * save it. - */ -- if (!msr_write_intercepted(vcpu, MSR_IA32_SPEC_CTRL)) -- rdmsrl(MSR_IA32_SPEC_CTRL, svm->spec_ctrl); -+ if (unlikely(!msr_write_intercepted(vcpu, MSR_IA32_SPEC_CTRL))) -+ svm->spec_ctrl = native_read_msr(MSR_IA32_SPEC_CTRL); - - if (svm->spec_ctrl) -- wrmsrl(MSR_IA32_SPEC_CTRL, 0); -+ native_wrmsrl(MSR_IA32_SPEC_CTRL, 0); - - /* Eliminate branch target predictions from guest mode */ - vmexit_fill_RSB(); -diff --git a/arch/x86/kvm/vmx.c b/arch/x86/kvm/vmx.c -index 5ffde16253cb..315fccb2684b 100644 ---- a/arch/x86/kvm/vmx.c -+++ b/arch/x86/kvm/vmx.c -@@ -51,6 +51,7 @@ - #include - #include - #include -+#include - #include - - #include "trace.h" -@@ -9431,7 +9432,7 @@ static void __noclone vmx_vcpu_run(struct kvm_vcpu *vcpu) - * being speculatively taken. - */ - if (vmx->spec_ctrl) -- wrmsrl(MSR_IA32_SPEC_CTRL, vmx->spec_ctrl); -+ native_wrmsrl(MSR_IA32_SPEC_CTRL, vmx->spec_ctrl); - - vmx->__launched = vmx->loaded_vmcs->launched; - asm( -@@ -9566,11 +9567,11 @@ static void __noclone vmx_vcpu_run(struct kvm_vcpu *vcpu) - * If the L02 MSR bitmap does not intercept the MSR, then we need to - * save it. - */ -- if (!msr_write_intercepted(vcpu, MSR_IA32_SPEC_CTRL)) -- rdmsrl(MSR_IA32_SPEC_CTRL, vmx->spec_ctrl); -+ if (unlikely(!msr_write_intercepted(vcpu, MSR_IA32_SPEC_CTRL))) -+ vmx->spec_ctrl = native_read_msr(MSR_IA32_SPEC_CTRL); - - if (vmx->spec_ctrl) -- wrmsrl(MSR_IA32_SPEC_CTRL, 0); -+ native_wrmsrl(MSR_IA32_SPEC_CTRL, 0); - - /* Eliminate branch target predictions from guest mode */ - vmexit_fill_RSB(); -diff --git a/arch/x86/kvm/x86.c b/arch/x86/kvm/x86.c -index 0dcd7bf45dc1..b9afb4784d12 100644 ---- a/arch/x86/kvm/x86.c -+++ b/arch/x86/kvm/x86.c -@@ -7482,13 +7482,13 @@ EXPORT_SYMBOL_GPL(kvm_task_switch); - - int kvm_valid_sregs(struct kvm_vcpu *vcpu, struct kvm_sregs *sregs) - { -- if ((sregs->efer & EFER_LME) && (sregs->cr0 & X86_CR0_PG_BIT)) { -+ if ((sregs->efer & EFER_LME) && (sregs->cr0 & X86_CR0_PG)) { - /* - * When EFER.LME and CR0.PG are set, the processor is in - * 64-bit mode (though maybe in a 32-bit code segment). - * CR4.PAE and EFER.LMA must be set. - */ -- if (!(sregs->cr4 & X86_CR4_PAE_BIT) -+ if (!(sregs->cr4 & X86_CR4_PAE) - || !(sregs->efer & EFER_LMA)) - return -EINVAL; - } else { -@@ -7821,6 +7821,8 @@ void kvm_arch_vcpu_destroy(struct kvm_vcpu *vcpu) - - void kvm_vcpu_reset(struct kvm_vcpu *vcpu, bool init_event) - { -+ kvm_lapic_reset(vcpu, init_event); -+ - vcpu->arch.hflags = 0; - - vcpu->arch.smi_pending = 0; -@@ -8249,10 +8251,8 @@ int __x86_set_memory_region(struct kvm *kvm, int id, gpa_t gpa, u32 size) - return r; - } - -- if (!size) { -- r = vm_munmap(old.userspace_addr, old.npages * PAGE_SIZE); -- WARN_ON(r < 0); -- } -+ if (!size) -+ vm_munmap(old.userspace_addr, old.npages * PAGE_SIZE); - - return 0; - } -diff --git a/arch/x86/mm/cpu_entry_area.c b/arch/x86/mm/cpu_entry_area.c -index b9283cc27622..476d810639a8 100644 ---- a/arch/x86/mm/cpu_entry_area.c -+++ b/arch/x86/mm/cpu_entry_area.c -@@ -163,4 +163,10 @@ void __init setup_cpu_entry_areas(void) - - for_each_possible_cpu(cpu) - setup_cpu_entry_area(cpu); -+ -+ /* -+ * This is the last essential update to swapper_pgdir which needs -+ * to be synchronized to initial_page_table on 32bit. -+ */ -+ sync_initial_page_table(); - } -diff --git a/arch/x86/mm/init_32.c b/arch/x86/mm/init_32.c -index 135c9a7898c7..3141e67ec24c 100644 ---- a/arch/x86/mm/init_32.c -+++ b/arch/x86/mm/init_32.c -@@ -453,6 +453,21 @@ static inline void permanent_kmaps_init(pgd_t *pgd_base) - } - #endif /* CONFIG_HIGHMEM */ - -+void __init sync_initial_page_table(void) -+{ -+ clone_pgd_range(initial_page_table + KERNEL_PGD_BOUNDARY, -+ swapper_pg_dir + KERNEL_PGD_BOUNDARY, -+ KERNEL_PGD_PTRS); -+ -+ /* -+ * sync back low identity map too. It is used for example -+ * in the 32-bit EFI stub. -+ */ -+ clone_pgd_range(initial_page_table, -+ swapper_pg_dir + KERNEL_PGD_BOUNDARY, -+ min(KERNEL_PGD_PTRS, KERNEL_PGD_BOUNDARY)); -+} -+ - void __init native_pagetable_init(void) - { - unsigned long pfn, va; -diff --git a/arch/x86/platform/intel-mid/intel-mid.c b/arch/x86/platform/intel-mid/intel-mid.c -index 86676cec99a1..09dd7f3cf621 100644 ---- a/arch/x86/platform/intel-mid/intel-mid.c -+++ b/arch/x86/platform/intel-mid/intel-mid.c -@@ -79,7 +79,7 @@ static void intel_mid_power_off(void) - - static void intel_mid_reboot(void) - { -- intel_scu_ipc_simple_command(IPCMSG_COLD_BOOT, 0); -+ intel_scu_ipc_simple_command(IPCMSG_COLD_RESET, 0); - } - - static unsigned long __init intel_mid_calibrate_tsc(void) -diff --git a/arch/x86/xen/suspend.c b/arch/x86/xen/suspend.c -index 92bf5ecb6baf..3e3a58ea669e 100644 ---- a/arch/x86/xen/suspend.c -+++ b/arch/x86/xen/suspend.c -@@ -1,12 +1,15 @@ - // SPDX-License-Identifier: GPL-2.0 - #include - #include -+#include - - #include - #include - #include - #include - -+#include -+#include - #include - #include - #include -@@ -15,6 +18,8 @@ - #include "mmu.h" - #include "pmu.h" - -+static DEFINE_PER_CPU(u64, spec_ctrl); -+ - void xen_arch_pre_suspend(void) - { - if (xen_pv_domain()) -@@ -31,6 +36,9 @@ void xen_arch_post_suspend(int cancelled) - - static void xen_vcpu_notify_restore(void *data) - { -+ if (xen_pv_domain() && boot_cpu_has(X86_FEATURE_SPEC_CTRL)) -+ wrmsrl(MSR_IA32_SPEC_CTRL, this_cpu_read(spec_ctrl)); -+ - /* Boot processor notified via generic timekeeping_resume() */ - if (smp_processor_id() == 0) - return; -@@ -40,7 +48,15 @@ static void xen_vcpu_notify_restore(void *data) - - static void xen_vcpu_notify_suspend(void *data) - { -+ u64 tmp; -+ - tick_suspend_local(); -+ -+ if (xen_pv_domain() && boot_cpu_has(X86_FEATURE_SPEC_CTRL)) { -+ rdmsrl(MSR_IA32_SPEC_CTRL, tmp); -+ this_cpu_write(spec_ctrl, tmp); -+ wrmsrl(MSR_IA32_SPEC_CTRL, 0); -+ } - } - - void xen_arch_resume(void) -diff --git a/block/blk-core.c b/block/blk-core.c -index 95b7ea996ac2..c01f4907dbbc 100644 ---- a/block/blk-core.c -+++ b/block/blk-core.c -@@ -2277,7 +2277,7 @@ blk_qc_t submit_bio(struct bio *bio) - unsigned int count; - - if (unlikely(bio_op(bio) == REQ_OP_WRITE_SAME)) -- count = queue_logical_block_size(bio->bi_disk->queue); -+ count = queue_logical_block_size(bio->bi_disk->queue) >> 9; - else - count = bio_sectors(bio); - -diff --git a/block/blk-mq.c b/block/blk-mq.c -index b60798a30ea2..f1fb126a3be5 100644 ---- a/block/blk-mq.c -+++ b/block/blk-mq.c -@@ -638,7 +638,6 @@ static void __blk_mq_requeue_request(struct request *rq) - - trace_block_rq_requeue(q, rq); - wbt_requeue(q->rq_wb, &rq->issue_stat); -- blk_mq_sched_requeue_request(rq); - - if (test_and_clear_bit(REQ_ATOM_STARTED, &rq->atomic_flags)) { - if (q->dma_drain_size && blk_rq_bytes(rq)) -@@ -650,6 +649,9 @@ void blk_mq_requeue_request(struct request *rq, bool kick_requeue_list) - { - __blk_mq_requeue_request(rq); - -+ /* this request will be re-inserted to io scheduler queue */ -+ blk_mq_sched_requeue_request(rq); -+ - BUG_ON(blk_queued_rq(rq)); - blk_mq_add_to_requeue_list(rq, true, kick_requeue_list); - } -diff --git a/block/kyber-iosched.c b/block/kyber-iosched.c -index f58cab82105b..09cd5cf2e459 100644 ---- a/block/kyber-iosched.c -+++ b/block/kyber-iosched.c -@@ -814,6 +814,7 @@ static struct elevator_type kyber_sched = { - .limit_depth = kyber_limit_depth, - .prepare_request = kyber_prepare_request, - .finish_request = kyber_finish_request, -+ .requeue_request = kyber_finish_request, - .completed_request = kyber_completed_request, - .dispatch_request = kyber_dispatch_request, - .has_work = kyber_has_work, -diff --git a/drivers/acpi/bus.c b/drivers/acpi/bus.c -index 4d0979e02a28..b6d58cc58f5f 100644 ---- a/drivers/acpi/bus.c -+++ b/drivers/acpi/bus.c -@@ -66,10 +66,37 @@ static int set_copy_dsdt(const struct dmi_system_id *id) - return 0; - } - #endif -+static int set_gbl_term_list(const struct dmi_system_id *id) -+{ -+ acpi_gbl_parse_table_as_term_list = 1; -+ return 0; -+} - --static const struct dmi_system_id dsdt_dmi_table[] __initconst = { -+static const struct dmi_system_id acpi_quirks_dmi_table[] __initconst = { -+ /* -+ * Touchpad on Dell XPS 9570/Precision M5530 doesn't work under I2C -+ * mode. -+ * https://bugzilla.kernel.org/show_bug.cgi?id=198515 -+ */ -+ { -+ .callback = set_gbl_term_list, -+ .ident = "Dell Precision M5530", -+ .matches = { -+ DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."), -+ DMI_MATCH(DMI_PRODUCT_NAME, "Precision M5530"), -+ }, -+ }, -+ { -+ .callback = set_gbl_term_list, -+ .ident = "Dell XPS 15 9570", -+ .matches = { -+ DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."), -+ DMI_MATCH(DMI_PRODUCT_NAME, "XPS 15 9570"), -+ }, -+ }, - /* - * Invoke DSDT corruption work-around on all Toshiba Satellite. -+ * DSDT will be copied to memory. - * https://bugzilla.kernel.org/show_bug.cgi?id=14679 - */ - { -@@ -83,7 +110,7 @@ static const struct dmi_system_id dsdt_dmi_table[] __initconst = { - {} - }; - #else --static const struct dmi_system_id dsdt_dmi_table[] __initconst = { -+static const struct dmi_system_id acpi_quirks_dmi_table[] __initconst = { - {} - }; - #endif -@@ -1001,11 +1028,8 @@ void __init acpi_early_init(void) - - acpi_permanent_mmap = true; - -- /* -- * If the machine falls into the DMI check table, -- * DSDT will be copied to memory -- */ -- dmi_check_system(dsdt_dmi_table); -+ /* Check machine-specific quirks */ -+ dmi_check_system(acpi_quirks_dmi_table); - - status = acpi_reallocate_root_table(); - if (ACPI_FAILURE(status)) { -diff --git a/drivers/bluetooth/btusb.c b/drivers/bluetooth/btusb.c -index d54c3f6f728c..673698c7b143 100644 ---- a/drivers/bluetooth/btusb.c -+++ b/drivers/bluetooth/btusb.c -@@ -21,6 +21,7 @@ - * - */ - -+#include - #include - #include - #include -@@ -381,6 +382,21 @@ static const struct usb_device_id blacklist_table[] = { - { } /* Terminating entry */ - }; - -+/* The Bluetooth USB module build into some devices needs to be reset on resume, -+ * this is a problem with the platform (likely shutting off all power) not with -+ * the module itself. So we use a DMI list to match known broken platforms. -+ */ -+static const struct dmi_system_id btusb_needs_reset_resume_table[] = { -+ { -+ /* Lenovo Yoga 920 (QCA Rome device 0cf3:e300) */ -+ .matches = { -+ DMI_MATCH(DMI_SYS_VENDOR, "LENOVO"), -+ DMI_MATCH(DMI_PRODUCT_VERSION, "Lenovo YOGA 920"), -+ }, -+ }, -+ {} -+}; -+ - #define BTUSB_MAX_ISOC_FRAMES 10 - - #define BTUSB_INTR_RUNNING 0 -@@ -3013,6 +3029,9 @@ static int btusb_probe(struct usb_interface *intf, - hdev->send = btusb_send_frame; - hdev->notify = btusb_notify; - -+ if (dmi_check_system(btusb_needs_reset_resume_table)) -+ interface_to_usbdev(intf)->quirks |= USB_QUIRK_RESET_RESUME; -+ - #ifdef CONFIG_PM - err = btusb_config_oob_wake(hdev); - if (err) -@@ -3099,12 +3118,6 @@ static int btusb_probe(struct usb_interface *intf, - if (id->driver_info & BTUSB_QCA_ROME) { - data->setup_on_usb = btusb_setup_qca; - hdev->set_bdaddr = btusb_set_bdaddr_ath3012; -- -- /* QCA Rome devices lose their updated firmware over suspend, -- * but the USB hub doesn't notice any status change. -- * explicitly request a device reset on resume. -- */ -- interface_to_usbdev(intf)->quirks |= USB_QUIRK_RESET_RESUME; - } - - #ifdef CONFIG_BT_HCIBTUSB_RTL -diff --git a/drivers/char/tpm/st33zp24/st33zp24.c b/drivers/char/tpm/st33zp24/st33zp24.c -index 4d1dc8b46877..f95b9c75175b 100644 ---- a/drivers/char/tpm/st33zp24/st33zp24.c -+++ b/drivers/char/tpm/st33zp24/st33zp24.c -@@ -457,7 +457,7 @@ static int st33zp24_recv(struct tpm_chip *chip, unsigned char *buf, - size_t count) - { - int size = 0; -- int expected; -+ u32 expected; - - if (!chip) - return -EBUSY; -@@ -474,7 +474,7 @@ static int st33zp24_recv(struct tpm_chip *chip, unsigned char *buf, - } - - expected = be32_to_cpu(*(__be32 *)(buf + 2)); -- if (expected > count) { -+ if (expected > count || expected < TPM_HEADER_SIZE) { - size = -EIO; - goto out; - } -diff --git a/drivers/char/tpm/tpm-interface.c b/drivers/char/tpm/tpm-interface.c -index 1d6729be4cd6..3cec403a80b3 100644 ---- a/drivers/char/tpm/tpm-interface.c -+++ b/drivers/char/tpm/tpm-interface.c -@@ -1228,6 +1228,10 @@ int tpm_get_random(u32 chip_num, u8 *out, size_t max) - break; - - recd = be32_to_cpu(tpm_cmd.params.getrandom_out.rng_data_len); -+ if (recd > num_bytes) { -+ total = -EFAULT; -+ break; -+ } - - rlength = be32_to_cpu(tpm_cmd.header.out.length); - if (rlength < offsetof(struct tpm_getrandom_out, rng_data) + -diff --git a/drivers/char/tpm/tpm2-cmd.c b/drivers/char/tpm/tpm2-cmd.c -index e1a41b788f08..44a3d16231f6 100644 ---- a/drivers/char/tpm/tpm2-cmd.c -+++ b/drivers/char/tpm/tpm2-cmd.c -@@ -683,6 +683,10 @@ static int tpm2_unseal_cmd(struct tpm_chip *chip, - if (!rc) { - data_len = be16_to_cpup( - (__be16 *) &buf.data[TPM_HEADER_SIZE + 4]); -+ if (data_len < MIN_KEY_SIZE || data_len > MAX_KEY_SIZE + 1) { -+ rc = -EFAULT; -+ goto out; -+ } - - rlength = be32_to_cpu(((struct tpm2_cmd *)&buf) - ->header.out.length); -diff --git a/drivers/char/tpm/tpm_i2c_infineon.c b/drivers/char/tpm/tpm_i2c_infineon.c -index 79d6bbb58e39..d5b44cadac56 100644 ---- a/drivers/char/tpm/tpm_i2c_infineon.c -+++ b/drivers/char/tpm/tpm_i2c_infineon.c -@@ -473,7 +473,8 @@ static int recv_data(struct tpm_chip *chip, u8 *buf, size_t count) - static int tpm_tis_i2c_recv(struct tpm_chip *chip, u8 *buf, size_t count) - { - int size = 0; -- int expected, status; -+ int status; -+ u32 expected; - - if (count < TPM_HEADER_SIZE) { - size = -EIO; -@@ -488,7 +489,7 @@ static int tpm_tis_i2c_recv(struct tpm_chip *chip, u8 *buf, size_t count) - } - - expected = be32_to_cpu(*(__be32 *)(buf + 2)); -- if ((size_t) expected > count) { -+ if (((size_t) expected > count) || (expected < TPM_HEADER_SIZE)) { - size = -EIO; - goto out; - } -diff --git a/drivers/char/tpm/tpm_i2c_nuvoton.c b/drivers/char/tpm/tpm_i2c_nuvoton.c -index c6428771841f..caa86b19c76d 100644 ---- a/drivers/char/tpm/tpm_i2c_nuvoton.c -+++ b/drivers/char/tpm/tpm_i2c_nuvoton.c -@@ -281,7 +281,11 @@ static int i2c_nuvoton_recv(struct tpm_chip *chip, u8 *buf, size_t count) - struct device *dev = chip->dev.parent; - struct i2c_client *client = to_i2c_client(dev); - s32 rc; -- int expected, status, burst_count, retries, size = 0; -+ int status; -+ int burst_count; -+ int retries; -+ int size = 0; -+ u32 expected; - - if (count < TPM_HEADER_SIZE) { - i2c_nuvoton_ready(chip); /* return to idle */ -@@ -323,7 +327,7 @@ static int i2c_nuvoton_recv(struct tpm_chip *chip, u8 *buf, size_t count) - * to machine native - */ - expected = be32_to_cpu(*(__be32 *) (buf + 2)); -- if (expected > count) { -+ if (expected > count || expected < size) { - dev_err(dev, "%s() expected > count\n", __func__); - size = -EIO; - continue; -diff --git a/drivers/char/tpm/tpm_tis.c b/drivers/char/tpm/tpm_tis.c -index 7e55aa9ce680..ebd0e75a3e4d 100644 ---- a/drivers/char/tpm/tpm_tis.c -+++ b/drivers/char/tpm/tpm_tis.c -@@ -223,7 +223,7 @@ static int tpm_tcg_read_bytes(struct tpm_tis_data *data, u32 addr, u16 len, - } - - static int tpm_tcg_write_bytes(struct tpm_tis_data *data, u32 addr, u16 len, -- u8 *value) -+ const u8 *value) - { - struct tpm_tis_tcg_phy *phy = to_tpm_tis_tcg_phy(data); - -diff --git a/drivers/char/tpm/tpm_tis_core.c b/drivers/char/tpm/tpm_tis_core.c -index 63bc6c3b949e..083578b2517e 100644 ---- a/drivers/char/tpm/tpm_tis_core.c -+++ b/drivers/char/tpm/tpm_tis_core.c -@@ -202,7 +202,8 @@ static int tpm_tis_recv(struct tpm_chip *chip, u8 *buf, size_t count) - { - struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev); - int size = 0; -- int expected, status; -+ int status; -+ u32 expected; - - if (count < TPM_HEADER_SIZE) { - size = -EIO; -@@ -217,7 +218,7 @@ static int tpm_tis_recv(struct tpm_chip *chip, u8 *buf, size_t count) - } - - expected = be32_to_cpu(*(__be32 *) (buf + 2)); -- if (expected > count) { -+ if (expected > count || expected < TPM_HEADER_SIZE) { - size = -EIO; - goto out; - } -@@ -252,7 +253,7 @@ static int tpm_tis_recv(struct tpm_chip *chip, u8 *buf, size_t count) - * tpm.c can skip polling for the data to be available as the interrupt is - * waited for here - */ --static int tpm_tis_send_data(struct tpm_chip *chip, u8 *buf, size_t len) -+static int tpm_tis_send_data(struct tpm_chip *chip, const u8 *buf, size_t len) - { - struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev); - int rc, status, burstcnt; -@@ -343,7 +344,7 @@ static void disable_interrupts(struct tpm_chip *chip) - * tpm.c can skip polling for the data to be available as the interrupt is - * waited for here - */ --static int tpm_tis_send_main(struct tpm_chip *chip, u8 *buf, size_t len) -+static int tpm_tis_send_main(struct tpm_chip *chip, const u8 *buf, size_t len) - { - struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev); - int rc; -diff --git a/drivers/char/tpm/tpm_tis_core.h b/drivers/char/tpm/tpm_tis_core.h -index e2212f021a02..6bbac319ff3b 100644 ---- a/drivers/char/tpm/tpm_tis_core.h -+++ b/drivers/char/tpm/tpm_tis_core.h -@@ -98,7 +98,7 @@ struct tpm_tis_phy_ops { - int (*read_bytes)(struct tpm_tis_data *data, u32 addr, u16 len, - u8 *result); - int (*write_bytes)(struct tpm_tis_data *data, u32 addr, u16 len, -- u8 *value); -+ const u8 *value); - int (*read16)(struct tpm_tis_data *data, u32 addr, u16 *result); - int (*read32)(struct tpm_tis_data *data, u32 addr, u32 *result); - int (*write32)(struct tpm_tis_data *data, u32 addr, u32 src); -@@ -128,7 +128,7 @@ static inline int tpm_tis_read32(struct tpm_tis_data *data, u32 addr, - } - - static inline int tpm_tis_write_bytes(struct tpm_tis_data *data, u32 addr, -- u16 len, u8 *value) -+ u16 len, const u8 *value) - { - return data->phy_ops->write_bytes(data, addr, len, value); - } -diff --git a/drivers/char/tpm/tpm_tis_spi.c b/drivers/char/tpm/tpm_tis_spi.c -index 88fe72ae967f..8ab0bd8445f6 100644 ---- a/drivers/char/tpm/tpm_tis_spi.c -+++ b/drivers/char/tpm/tpm_tis_spi.c -@@ -46,9 +46,7 @@ - struct tpm_tis_spi_phy { - struct tpm_tis_data priv; - struct spi_device *spi_device; -- -- u8 tx_buf[4]; -- u8 rx_buf[4]; -+ u8 *iobuf; - }; - - static inline struct tpm_tis_spi_phy *to_tpm_tis_spi_phy(struct tpm_tis_data *data) -@@ -57,7 +55,7 @@ static inline struct tpm_tis_spi_phy *to_tpm_tis_spi_phy(struct tpm_tis_data *da - } - - static int tpm_tis_spi_transfer(struct tpm_tis_data *data, u32 addr, u16 len, -- u8 *buffer, u8 direction) -+ u8 *in, const u8 *out) - { - struct tpm_tis_spi_phy *phy = to_tpm_tis_spi_phy(data); - int ret = 0; -@@ -71,14 +69,14 @@ static int tpm_tis_spi_transfer(struct tpm_tis_data *data, u32 addr, u16 len, - while (len) { - transfer_len = min_t(u16, len, MAX_SPI_FRAMESIZE); - -- phy->tx_buf[0] = direction | (transfer_len - 1); -- phy->tx_buf[1] = 0xd4; -- phy->tx_buf[2] = addr >> 8; -- phy->tx_buf[3] = addr; -+ phy->iobuf[0] = (in ? 0x80 : 0) | (transfer_len - 1); -+ phy->iobuf[1] = 0xd4; -+ phy->iobuf[2] = addr >> 8; -+ phy->iobuf[3] = addr; - - memset(&spi_xfer, 0, sizeof(spi_xfer)); -- spi_xfer.tx_buf = phy->tx_buf; -- spi_xfer.rx_buf = phy->rx_buf; -+ spi_xfer.tx_buf = phy->iobuf; -+ spi_xfer.rx_buf = phy->iobuf; - spi_xfer.len = 4; - spi_xfer.cs_change = 1; - -@@ -88,9 +86,9 @@ static int tpm_tis_spi_transfer(struct tpm_tis_data *data, u32 addr, u16 len, - if (ret < 0) - goto exit; - -- if ((phy->rx_buf[3] & 0x01) == 0) { -+ if ((phy->iobuf[3] & 0x01) == 0) { - // handle SPI wait states -- phy->tx_buf[0] = 0; -+ phy->iobuf[0] = 0; - - for (i = 0; i < TPM_RETRY; i++) { - spi_xfer.len = 1; -@@ -99,7 +97,7 @@ static int tpm_tis_spi_transfer(struct tpm_tis_data *data, u32 addr, u16 len, - ret = spi_sync_locked(phy->spi_device, &m); - if (ret < 0) - goto exit; -- if (phy->rx_buf[0] & 0x01) -+ if (phy->iobuf[0] & 0x01) - break; - } - -@@ -113,12 +111,12 @@ static int tpm_tis_spi_transfer(struct tpm_tis_data *data, u32 addr, u16 len, - spi_xfer.len = transfer_len; - spi_xfer.delay_usecs = 5; - -- if (direction) { -+ if (in) { - spi_xfer.tx_buf = NULL; -- spi_xfer.rx_buf = buffer; -- } else { -- spi_xfer.tx_buf = buffer; -+ } else if (out) { - spi_xfer.rx_buf = NULL; -+ memcpy(phy->iobuf, out, transfer_len); -+ out += transfer_len; - } - - spi_message_init(&m); -@@ -127,8 +125,12 @@ static int tpm_tis_spi_transfer(struct tpm_tis_data *data, u32 addr, u16 len, - if (ret < 0) - goto exit; - -+ if (in) { -+ memcpy(in, phy->iobuf, transfer_len); -+ in += transfer_len; -+ } -+ - len -= transfer_len; -- buffer += transfer_len; - } - - exit: -@@ -139,13 +141,13 @@ static int tpm_tis_spi_transfer(struct tpm_tis_data *data, u32 addr, u16 len, - static int tpm_tis_spi_read_bytes(struct tpm_tis_data *data, u32 addr, - u16 len, u8 *result) - { -- return tpm_tis_spi_transfer(data, addr, len, result, 0x80); -+ return tpm_tis_spi_transfer(data, addr, len, result, NULL); - } - - static int tpm_tis_spi_write_bytes(struct tpm_tis_data *data, u32 addr, -- u16 len, u8 *value) -+ u16 len, const u8 *value) - { -- return tpm_tis_spi_transfer(data, addr, len, value, 0); -+ return tpm_tis_spi_transfer(data, addr, len, NULL, value); - } - - static int tpm_tis_spi_read16(struct tpm_tis_data *data, u32 addr, u16 *result) -@@ -194,6 +196,10 @@ static int tpm_tis_spi_probe(struct spi_device *dev) - - phy->spi_device = dev; - -+ phy->iobuf = devm_kmalloc(&dev->dev, MAX_SPI_FRAMESIZE, GFP_KERNEL); -+ if (!phy->iobuf) -+ return -ENOMEM; -+ - return tpm_tis_core_init(&dev->dev, &phy->priv, -1, &tpm_spi_phy_ops, - NULL); - } -diff --git a/drivers/cpufreq/s3c24xx-cpufreq.c b/drivers/cpufreq/s3c24xx-cpufreq.c -index 7b596fa38ad2..6bebc1f9f55a 100644 ---- a/drivers/cpufreq/s3c24xx-cpufreq.c -+++ b/drivers/cpufreq/s3c24xx-cpufreq.c -@@ -351,7 +351,13 @@ struct clk *s3c_cpufreq_clk_get(struct device *dev, const char *name) - static int s3c_cpufreq_init(struct cpufreq_policy *policy) - { - policy->clk = clk_arm; -- return cpufreq_generic_init(policy, ftab, cpu_cur.info->latency); -+ -+ policy->cpuinfo.transition_latency = cpu_cur.info->latency; -+ -+ if (ftab) -+ return cpufreq_table_validate_and_show(policy, ftab); -+ -+ return 0; - } - - static int __init s3c_cpufreq_initclks(void) -diff --git a/drivers/edac/sb_edac.c b/drivers/edac/sb_edac.c -index cd9d6ba03579..0dc0d595c47c 100644 ---- a/drivers/edac/sb_edac.c -+++ b/drivers/edac/sb_edac.c -@@ -279,7 +279,7 @@ static const u32 correrrthrsld[] = { - * sbridge structs - */ - --#define NUM_CHANNELS 4 /* Max channels per MC */ -+#define NUM_CHANNELS 6 /* Max channels per MC */ - #define MAX_DIMMS 3 /* Max DIMMS per channel */ - #define KNL_MAX_CHAS 38 /* KNL max num. of Cache Home Agents */ - #define KNL_MAX_CHANNELS 6 /* KNL max num. of PCI channels */ -diff --git a/drivers/md/md.c b/drivers/md/md.c -index 6bf093cef958..e058c209bbcf 100644 ---- a/drivers/md/md.c -+++ b/drivers/md/md.c -@@ -8522,6 +8522,10 @@ static int remove_and_add_spares(struct mddev *mddev, - int removed = 0; - bool remove_some = false; - -+ if (this && test_bit(MD_RECOVERY_RUNNING, &mddev->recovery)) -+ /* Mustn't remove devices when resync thread is running */ -+ return 0; -+ - rdev_for_each(rdev, mddev) { - if ((this == NULL || rdev == this) && - rdev->raid_disk >= 0 && -diff --git a/drivers/media/dvb-frontends/m88ds3103.c b/drivers/media/dvb-frontends/m88ds3103.c -index 50bce68ffd66..65d157fe76d1 100644 ---- a/drivers/media/dvb-frontends/m88ds3103.c -+++ b/drivers/media/dvb-frontends/m88ds3103.c -@@ -1262,11 +1262,12 @@ static int m88ds3103_select(struct i2c_mux_core *muxc, u32 chan) - * New users must use I2C client binding directly! - */ - struct dvb_frontend *m88ds3103_attach(const struct m88ds3103_config *cfg, -- struct i2c_adapter *i2c, struct i2c_adapter **tuner_i2c_adapter) -+ struct i2c_adapter *i2c, -+ struct i2c_adapter **tuner_i2c_adapter) - { - struct i2c_client *client; - struct i2c_board_info board_info; -- struct m88ds3103_platform_data pdata; -+ struct m88ds3103_platform_data pdata = {}; - - pdata.clk = cfg->clock; - pdata.i2c_wr_max = cfg->i2c_wr_max; -@@ -1409,6 +1410,8 @@ static int m88ds3103_probe(struct i2c_client *client, - case M88DS3103_CHIP_ID: - break; - default: -+ ret = -ENODEV; -+ dev_err(&client->dev, "Unknown device. Chip_id=%02x\n", dev->chip_id); - goto err_kfree; - } - -diff --git a/drivers/mmc/host/dw_mmc-exynos.c b/drivers/mmc/host/dw_mmc-exynos.c -index 35026795be28..fa41d9422d57 100644 ---- a/drivers/mmc/host/dw_mmc-exynos.c -+++ b/drivers/mmc/host/dw_mmc-exynos.c -@@ -487,6 +487,7 @@ static unsigned long exynos_dwmmc_caps[4] = { - - static const struct dw_mci_drv_data exynos_drv_data = { - .caps = exynos_dwmmc_caps, -+ .num_caps = ARRAY_SIZE(exynos_dwmmc_caps), - .init = dw_mci_exynos_priv_init, - .set_ios = dw_mci_exynos_set_ios, - .parse_dt = dw_mci_exynos_parse_dt, -diff --git a/drivers/mmc/host/dw_mmc-k3.c b/drivers/mmc/host/dw_mmc-k3.c -index 64cda84b2302..864e7fcaffaf 100644 ---- a/drivers/mmc/host/dw_mmc-k3.c -+++ b/drivers/mmc/host/dw_mmc-k3.c -@@ -135,6 +135,9 @@ static int dw_mci_hi6220_parse_dt(struct dw_mci *host) - if (priv->ctrl_id < 0) - priv->ctrl_id = 0; - -+ if (priv->ctrl_id >= TIMING_MODE) -+ return -EINVAL; -+ - host->priv = priv; - return 0; - } -@@ -207,6 +210,7 @@ static int dw_mci_hi6220_execute_tuning(struct dw_mci_slot *slot, u32 opcode) - - static const struct dw_mci_drv_data hi6220_data = { - .caps = dw_mci_hi6220_caps, -+ .num_caps = ARRAY_SIZE(dw_mci_hi6220_caps), - .switch_voltage = dw_mci_hi6220_switch_voltage, - .set_ios = dw_mci_hi6220_set_ios, - .parse_dt = dw_mci_hi6220_parse_dt, -diff --git a/drivers/mmc/host/dw_mmc-rockchip.c b/drivers/mmc/host/dw_mmc-rockchip.c -index a3f1c2b30145..339295212935 100644 ---- a/drivers/mmc/host/dw_mmc-rockchip.c -+++ b/drivers/mmc/host/dw_mmc-rockchip.c -@@ -319,6 +319,7 @@ static const struct dw_mci_drv_data rk2928_drv_data = { - - static const struct dw_mci_drv_data rk3288_drv_data = { - .caps = dw_mci_rk3288_dwmmc_caps, -+ .num_caps = ARRAY_SIZE(dw_mci_rk3288_dwmmc_caps), - .set_ios = dw_mci_rk3288_set_ios, - .execute_tuning = dw_mci_rk3288_execute_tuning, - .parse_dt = dw_mci_rk3288_parse_dt, -diff --git a/drivers/mmc/host/dw_mmc-zx.c b/drivers/mmc/host/dw_mmc-zx.c -index d38e94ae2b85..c06b5393312f 100644 ---- a/drivers/mmc/host/dw_mmc-zx.c -+++ b/drivers/mmc/host/dw_mmc-zx.c -@@ -195,6 +195,7 @@ static unsigned long zx_dwmmc_caps[3] = { - - static const struct dw_mci_drv_data zx_drv_data = { - .caps = zx_dwmmc_caps, -+ .num_caps = ARRAY_SIZE(zx_dwmmc_caps), - .execute_tuning = dw_mci_zx_execute_tuning, - .prepare_hs400_tuning = dw_mci_zx_prepare_hs400_tuning, - .parse_dt = dw_mci_zx_parse_dt, -diff --git a/drivers/mmc/host/dw_mmc.c b/drivers/mmc/host/dw_mmc.c -index 4f2806720c5c..60341a814055 100644 ---- a/drivers/mmc/host/dw_mmc.c -+++ b/drivers/mmc/host/dw_mmc.c -@@ -165,6 +165,8 @@ static int dw_mci_regs_show(struct seq_file *s, void *v) - { - struct dw_mci *host = s->private; - -+ pm_runtime_get_sync(host->dev); -+ - seq_printf(s, "STATUS:\t0x%08x\n", mci_readl(host, STATUS)); - seq_printf(s, "RINTSTS:\t0x%08x\n", mci_readl(host, RINTSTS)); - seq_printf(s, "CMD:\t0x%08x\n", mci_readl(host, CMD)); -@@ -172,6 +174,8 @@ static int dw_mci_regs_show(struct seq_file *s, void *v) - seq_printf(s, "INTMASK:\t0x%08x\n", mci_readl(host, INTMASK)); - seq_printf(s, "CLKENA:\t0x%08x\n", mci_readl(host, CLKENA)); - -+ pm_runtime_put_autosuspend(host->dev); -+ - return 0; - } - -@@ -2758,12 +2762,57 @@ static irqreturn_t dw_mci_interrupt(int irq, void *dev_id) - return IRQ_HANDLED; - } - -+static int dw_mci_init_slot_caps(struct dw_mci_slot *slot) -+{ -+ struct dw_mci *host = slot->host; -+ const struct dw_mci_drv_data *drv_data = host->drv_data; -+ struct mmc_host *mmc = slot->mmc; -+ int ctrl_id; -+ -+ if (host->pdata->caps) -+ mmc->caps = host->pdata->caps; -+ -+ /* -+ * Support MMC_CAP_ERASE by default. -+ * It needs to use trim/discard/erase commands. -+ */ -+ mmc->caps |= MMC_CAP_ERASE; -+ -+ if (host->pdata->pm_caps) -+ mmc->pm_caps = host->pdata->pm_caps; -+ -+ if (host->dev->of_node) { -+ ctrl_id = of_alias_get_id(host->dev->of_node, "mshc"); -+ if (ctrl_id < 0) -+ ctrl_id = 0; -+ } else { -+ ctrl_id = to_platform_device(host->dev)->id; -+ } -+ -+ if (drv_data && drv_data->caps) { -+ if (ctrl_id >= drv_data->num_caps) { -+ dev_err(host->dev, "invalid controller id %d\n", -+ ctrl_id); -+ return -EINVAL; -+ } -+ mmc->caps |= drv_data->caps[ctrl_id]; -+ } -+ -+ if (host->pdata->caps2) -+ mmc->caps2 = host->pdata->caps2; -+ -+ /* Process SDIO IRQs through the sdio_irq_work. */ -+ if (mmc->caps & MMC_CAP_SDIO_IRQ) -+ mmc->caps2 |= MMC_CAP2_SDIO_IRQ_NOTHREAD; -+ -+ return 0; -+} -+ - static int dw_mci_init_slot(struct dw_mci *host) - { - struct mmc_host *mmc; - struct dw_mci_slot *slot; -- const struct dw_mci_drv_data *drv_data = host->drv_data; -- int ctrl_id, ret; -+ int ret; - u32 freq[2]; - - mmc = mmc_alloc_host(sizeof(struct dw_mci_slot), host->dev); -@@ -2797,38 +2846,13 @@ static int dw_mci_init_slot(struct dw_mci *host) - if (!mmc->ocr_avail) - mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; - -- if (host->pdata->caps) -- mmc->caps = host->pdata->caps; -- -- /* -- * Support MMC_CAP_ERASE by default. -- * It needs to use trim/discard/erase commands. -- */ -- mmc->caps |= MMC_CAP_ERASE; -- -- if (host->pdata->pm_caps) -- mmc->pm_caps = host->pdata->pm_caps; -- -- if (host->dev->of_node) { -- ctrl_id = of_alias_get_id(host->dev->of_node, "mshc"); -- if (ctrl_id < 0) -- ctrl_id = 0; -- } else { -- ctrl_id = to_platform_device(host->dev)->id; -- } -- if (drv_data && drv_data->caps) -- mmc->caps |= drv_data->caps[ctrl_id]; -- -- if (host->pdata->caps2) -- mmc->caps2 = host->pdata->caps2; -- - ret = mmc_of_parse(mmc); - if (ret) - goto err_host_allocated; - -- /* Process SDIO IRQs through the sdio_irq_work. */ -- if (mmc->caps & MMC_CAP_SDIO_IRQ) -- mmc->caps2 |= MMC_CAP2_SDIO_IRQ_NOTHREAD; -+ ret = dw_mci_init_slot_caps(slot); -+ if (ret) -+ goto err_host_allocated; - - /* Useful defaults if platform data is unset. */ - if (host->use_dma == TRANS_MODE_IDMAC) { -diff --git a/drivers/mmc/host/dw_mmc.h b/drivers/mmc/host/dw_mmc.h -index 34474ad731aa..044c87ce6725 100644 ---- a/drivers/mmc/host/dw_mmc.h -+++ b/drivers/mmc/host/dw_mmc.h -@@ -542,6 +542,7 @@ struct dw_mci_slot { - /** - * dw_mci driver data - dw-mshc implementation specific driver data. - * @caps: mmc subsystem specified capabilities of the controller(s). -+ * @num_caps: number of capabilities specified by @caps. - * @init: early implementation specific initialization. - * @set_ios: handle bus specific extensions. - * @parse_dt: parse implementation specific device tree properties. -@@ -553,6 +554,7 @@ struct dw_mci_slot { - */ - struct dw_mci_drv_data { - unsigned long *caps; -+ u32 num_caps; - int (*init)(struct dw_mci *host); - void (*set_ios)(struct dw_mci *host, struct mmc_ios *ios); - int (*parse_dt)(struct dw_mci *host); -diff --git a/drivers/mmc/host/sdhci-pci-core.c b/drivers/mmc/host/sdhci-pci-core.c -index 67d787fa3306..070f5da06fd2 100644 ---- a/drivers/mmc/host/sdhci-pci-core.c -+++ b/drivers/mmc/host/sdhci-pci-core.c -@@ -594,9 +594,36 @@ static void byt_read_dsm(struct sdhci_pci_slot *slot) - slot->chip->rpm_retune = intel_host->d3_retune; - } - --static int byt_emmc_probe_slot(struct sdhci_pci_slot *slot) -+static int intel_execute_tuning(struct mmc_host *mmc, u32 opcode) -+{ -+ int err = sdhci_execute_tuning(mmc, opcode); -+ struct sdhci_host *host = mmc_priv(mmc); -+ -+ if (err) -+ return err; -+ -+ /* -+ * Tuning can leave the IP in an active state (Buffer Read Enable bit -+ * set) which prevents the entry to low power states (i.e. S0i3). Data -+ * reset will clear it. -+ */ -+ sdhci_reset(host, SDHCI_RESET_DATA); -+ -+ return 0; -+} -+ -+static void byt_probe_slot(struct sdhci_pci_slot *slot) - { -+ struct mmc_host_ops *ops = &slot->host->mmc_host_ops; -+ - byt_read_dsm(slot); -+ -+ ops->execute_tuning = intel_execute_tuning; -+} -+ -+static int byt_emmc_probe_slot(struct sdhci_pci_slot *slot) -+{ -+ byt_probe_slot(slot); - slot->host->mmc->caps |= MMC_CAP_8_BIT_DATA | MMC_CAP_NONREMOVABLE | - MMC_CAP_HW_RESET | MMC_CAP_1_8V_DDR | - MMC_CAP_CMD_DURING_TFR | -@@ -651,7 +678,7 @@ static int ni_byt_sdio_probe_slot(struct sdhci_pci_slot *slot) - { - int err; - -- byt_read_dsm(slot); -+ byt_probe_slot(slot); - - err = ni_set_max_freq(slot); - if (err) -@@ -664,7 +691,7 @@ static int ni_byt_sdio_probe_slot(struct sdhci_pci_slot *slot) - - static int byt_sdio_probe_slot(struct sdhci_pci_slot *slot) - { -- byt_read_dsm(slot); -+ byt_probe_slot(slot); - slot->host->mmc->caps |= MMC_CAP_POWER_OFF_CARD | MMC_CAP_NONREMOVABLE | - MMC_CAP_WAIT_WHILE_BUSY; - return 0; -@@ -672,7 +699,7 @@ static int byt_sdio_probe_slot(struct sdhci_pci_slot *slot) - - static int byt_sd_probe_slot(struct sdhci_pci_slot *slot) - { -- byt_read_dsm(slot); -+ byt_probe_slot(slot); - slot->host->mmc->caps |= MMC_CAP_WAIT_WHILE_BUSY | - MMC_CAP_AGGRESSIVE_PM | MMC_CAP_CD_WAKE; - slot->cd_idx = 0; -diff --git a/drivers/net/ethernet/amd/xgbe/xgbe-drv.c b/drivers/net/ethernet/amd/xgbe/xgbe-drv.c -index 608693d11bd7..75c4455e2271 100644 ---- a/drivers/net/ethernet/amd/xgbe/xgbe-drv.c -+++ b/drivers/net/ethernet/amd/xgbe/xgbe-drv.c -@@ -595,7 +595,7 @@ static void xgbe_isr_task(unsigned long data) - - reissue_mask = 1 << 0; - if (!pdata->per_channel_irq) -- reissue_mask |= 0xffff < 4; -+ reissue_mask |= 0xffff << 4; - - XP_IOWRITE(pdata, XP_INT_REISSUE_EN, reissue_mask); - } -diff --git a/drivers/net/ethernet/amd/xgbe/xgbe-pci.c b/drivers/net/ethernet/amd/xgbe/xgbe-pci.c -index 3e5833cf1fab..eb23f9ba1a9a 100644 ---- a/drivers/net/ethernet/amd/xgbe/xgbe-pci.c -+++ b/drivers/net/ethernet/amd/xgbe/xgbe-pci.c -@@ -426,6 +426,8 @@ static int xgbe_pci_resume(struct pci_dev *pdev) - struct net_device *netdev = pdata->netdev; - int ret = 0; - -+ XP_IOWRITE(pdata, XP_INT_EN, 0x1fffff); -+ - pdata->lpm_ctrl &= ~MDIO_CTRL1_LPOWER; - XMDIO_WRITE(pdata, MDIO_MMD_PCS, MDIO_CTRL1, pdata->lpm_ctrl); - -diff --git a/drivers/net/ethernet/intel/ixgbe/ixgbe_main.c b/drivers/net/ethernet/intel/ixgbe/ixgbe_main.c -index 879a9c4cef59..29f600fd6977 100644 ---- a/drivers/net/ethernet/intel/ixgbe/ixgbe_main.c -+++ b/drivers/net/ethernet/intel/ixgbe/ixgbe_main.c -@@ -1877,6 +1877,14 @@ static void ixgbe_dma_sync_frag(struct ixgbe_ring *rx_ring, - ixgbe_rx_pg_size(rx_ring), - DMA_FROM_DEVICE, - IXGBE_RX_DMA_ATTR); -+ } else if (ring_uses_build_skb(rx_ring)) { -+ unsigned long offset = (unsigned long)(skb->data) & ~PAGE_MASK; -+ -+ dma_sync_single_range_for_cpu(rx_ring->dev, -+ IXGBE_CB(skb)->dma, -+ offset, -+ skb_headlen(skb), -+ DMA_FROM_DEVICE); - } else { - struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[0]; - -diff --git a/drivers/net/ethernet/mellanox/mlx5/core/en_main.c b/drivers/net/ethernet/mellanox/mlx5/core/en_main.c -index 3cdb932cae76..a863572882b2 100644 ---- a/drivers/net/ethernet/mellanox/mlx5/core/en_main.c -+++ b/drivers/net/ethernet/mellanox/mlx5/core/en_main.c -@@ -1918,13 +1918,16 @@ static void mlx5e_build_rq_param(struct mlx5e_priv *priv, - param->wq.linear = 1; - } - --static void mlx5e_build_drop_rq_param(struct mlx5e_rq_param *param) -+static void mlx5e_build_drop_rq_param(struct mlx5_core_dev *mdev, -+ struct mlx5e_rq_param *param) - { - void *rqc = param->rqc; - void *wq = MLX5_ADDR_OF(rqc, rqc, wq); - - MLX5_SET(wq, wq, wq_type, MLX5_WQ_TYPE_LINKED_LIST); - MLX5_SET(wq, wq, log_wq_stride, ilog2(sizeof(struct mlx5e_rx_wqe))); -+ -+ param->wq.buf_numa_node = dev_to_node(&mdev->pdev->dev); - } - - static void mlx5e_build_sq_param_common(struct mlx5e_priv *priv, -@@ -2778,6 +2781,9 @@ static int mlx5e_alloc_drop_cq(struct mlx5_core_dev *mdev, - struct mlx5e_cq *cq, - struct mlx5e_cq_param *param) - { -+ param->wq.buf_numa_node = dev_to_node(&mdev->pdev->dev); -+ param->wq.db_numa_node = dev_to_node(&mdev->pdev->dev); -+ - return mlx5e_alloc_cq_common(mdev, param, cq); - } - -@@ -2789,7 +2795,7 @@ static int mlx5e_open_drop_rq(struct mlx5_core_dev *mdev, - struct mlx5e_cq *cq = &drop_rq->cq; - int err; - -- mlx5e_build_drop_rq_param(&rq_param); -+ mlx5e_build_drop_rq_param(mdev, &rq_param); - - err = mlx5e_alloc_drop_cq(mdev, cq, &cq_param); - if (err) -diff --git a/drivers/net/ethernet/mellanox/mlx5/core/en_rx.c b/drivers/net/ethernet/mellanox/mlx5/core/en_rx.c -index 91b1b0938931..3476f594c195 100644 ---- a/drivers/net/ethernet/mellanox/mlx5/core/en_rx.c -+++ b/drivers/net/ethernet/mellanox/mlx5/core/en_rx.c -@@ -36,6 +36,7 @@ - #include - #include - #include -+#include - #include "en.h" - #include "en_tc.h" - #include "eswitch.h" -@@ -546,20 +547,33 @@ bool mlx5e_post_rx_mpwqes(struct mlx5e_rq *rq) - return true; - } - -+static void mlx5e_lro_update_tcp_hdr(struct mlx5_cqe64 *cqe, struct tcphdr *tcp) -+{ -+ u8 l4_hdr_type = get_cqe_l4_hdr_type(cqe); -+ u8 tcp_ack = (l4_hdr_type == CQE_L4_HDR_TYPE_TCP_ACK_NO_DATA) || -+ (l4_hdr_type == CQE_L4_HDR_TYPE_TCP_ACK_AND_DATA); -+ -+ tcp->check = 0; -+ tcp->psh = get_cqe_lro_tcppsh(cqe); -+ -+ if (tcp_ack) { -+ tcp->ack = 1; -+ tcp->ack_seq = cqe->lro_ack_seq_num; -+ tcp->window = cqe->lro_tcp_win; -+ } -+} -+ - static void mlx5e_lro_update_hdr(struct sk_buff *skb, struct mlx5_cqe64 *cqe, - u32 cqe_bcnt) - { - struct ethhdr *eth = (struct ethhdr *)(skb->data); - struct tcphdr *tcp; - int network_depth = 0; -+ __wsum check; - __be16 proto; - u16 tot_len; - void *ip_p; - -- u8 l4_hdr_type = get_cqe_l4_hdr_type(cqe); -- u8 tcp_ack = (l4_hdr_type == CQE_L4_HDR_TYPE_TCP_ACK_NO_DATA) || -- (l4_hdr_type == CQE_L4_HDR_TYPE_TCP_ACK_AND_DATA); -- - skb->mac_len = ETH_HLEN; - proto = __vlan_get_protocol(skb, eth->h_proto, &network_depth); - -@@ -577,23 +591,30 @@ static void mlx5e_lro_update_hdr(struct sk_buff *skb, struct mlx5_cqe64 *cqe, - ipv4->check = 0; - ipv4->check = ip_fast_csum((unsigned char *)ipv4, - ipv4->ihl); -+ -+ mlx5e_lro_update_tcp_hdr(cqe, tcp); -+ check = csum_partial(tcp, tcp->doff * 4, -+ csum_unfold((__force __sum16)cqe->check_sum)); -+ /* Almost done, don't forget the pseudo header */ -+ tcp->check = csum_tcpudp_magic(ipv4->saddr, ipv4->daddr, -+ tot_len - sizeof(struct iphdr), -+ IPPROTO_TCP, check); - } else { -+ u16 payload_len = tot_len - sizeof(struct ipv6hdr); - struct ipv6hdr *ipv6 = ip_p; - - tcp = ip_p + sizeof(struct ipv6hdr); - skb_shinfo(skb)->gso_type = SKB_GSO_TCPV6; - - ipv6->hop_limit = cqe->lro_min_ttl; -- ipv6->payload_len = cpu_to_be16(tot_len - -- sizeof(struct ipv6hdr)); -- } -- -- tcp->psh = get_cqe_lro_tcppsh(cqe); -- -- if (tcp_ack) { -- tcp->ack = 1; -- tcp->ack_seq = cqe->lro_ack_seq_num; -- tcp->window = cqe->lro_tcp_win; -+ ipv6->payload_len = cpu_to_be16(payload_len); -+ -+ mlx5e_lro_update_tcp_hdr(cqe, tcp); -+ check = csum_partial(tcp, tcp->doff * 4, -+ csum_unfold((__force __sum16)cqe->check_sum)); -+ /* Almost done, don't forget the pseudo header */ -+ tcp->check = csum_ipv6_magic(&ipv6->saddr, &ipv6->daddr, payload_len, -+ IPPROTO_TCP, check); - } - } - -diff --git a/drivers/net/ethernet/mellanox/mlx5/core/en_selftest.c b/drivers/net/ethernet/mellanox/mlx5/core/en_selftest.c -index 5a4608281f38..707976482c09 100644 ---- a/drivers/net/ethernet/mellanox/mlx5/core/en_selftest.c -+++ b/drivers/net/ethernet/mellanox/mlx5/core/en_selftest.c -@@ -216,7 +216,8 @@ mlx5e_test_loopback_validate(struct sk_buff *skb, - if (iph->protocol != IPPROTO_UDP) - goto out; - -- udph = udp_hdr(skb); -+ /* Don't assume skb_transport_header() was set */ -+ udph = (struct udphdr *)((u8 *)iph + 4 * iph->ihl); - if (udph->dest != htons(9)) - goto out; - -diff --git a/drivers/net/ethernet/mellanox/mlx5/core/en_tx.c b/drivers/net/ethernet/mellanox/mlx5/core/en_tx.c -index 1d6925d4369a..eea7f931cad3 100644 ---- a/drivers/net/ethernet/mellanox/mlx5/core/en_tx.c -+++ b/drivers/net/ethernet/mellanox/mlx5/core/en_tx.c -@@ -155,7 +155,7 @@ static inline u16 mlx5e_calc_min_inline(enum mlx5_inline_modes mode, - default: - hlen = mlx5e_skb_l2_header_offset(skb); - } -- return min_t(u16, hlen, skb->len); -+ return min_t(u16, hlen, skb_headlen(skb)); - } - - static inline void mlx5e_tx_skb_pull_inline(unsigned char **skb_data, -diff --git a/drivers/net/ethernet/mellanox/mlxsw/spectrum_router.c b/drivers/net/ethernet/mellanox/mlxsw/spectrum_router.c -index 7bef80676464..516e63244606 100644 ---- a/drivers/net/ethernet/mellanox/mlxsw/spectrum_router.c -+++ b/drivers/net/ethernet/mellanox/mlxsw/spectrum_router.c -@@ -729,26 +729,29 @@ static struct mlxsw_sp_fib *mlxsw_sp_vr_fib(const struct mlxsw_sp_vr *vr, - static struct mlxsw_sp_vr *mlxsw_sp_vr_create(struct mlxsw_sp *mlxsw_sp, - u32 tb_id) - { -+ struct mlxsw_sp_fib *fib4; -+ struct mlxsw_sp_fib *fib6; - struct mlxsw_sp_vr *vr; - int err; - - vr = mlxsw_sp_vr_find_unused(mlxsw_sp); - if (!vr) - return ERR_PTR(-EBUSY); -- vr->fib4 = mlxsw_sp_fib_create(vr, MLXSW_SP_L3_PROTO_IPV4); -- if (IS_ERR(vr->fib4)) -- return ERR_CAST(vr->fib4); -- vr->fib6 = mlxsw_sp_fib_create(vr, MLXSW_SP_L3_PROTO_IPV6); -- if (IS_ERR(vr->fib6)) { -- err = PTR_ERR(vr->fib6); -+ fib4 = mlxsw_sp_fib_create(vr, MLXSW_SP_L3_PROTO_IPV4); -+ if (IS_ERR(fib4)) -+ return ERR_CAST(fib4); -+ fib6 = mlxsw_sp_fib_create(vr, MLXSW_SP_L3_PROTO_IPV6); -+ if (IS_ERR(fib6)) { -+ err = PTR_ERR(fib6); - goto err_fib6_create; - } -+ vr->fib4 = fib4; -+ vr->fib6 = fib6; - vr->tb_id = tb_id; - return vr; - - err_fib6_create: -- mlxsw_sp_fib_destroy(vr->fib4); -- vr->fib4 = NULL; -+ mlxsw_sp_fib_destroy(fib4); - return ERR_PTR(err); - } - -@@ -3029,6 +3032,9 @@ mlxsw_sp_fib4_entry_offload_unset(struct mlxsw_sp_fib_entry *fib_entry) - struct mlxsw_sp_nexthop_group *nh_grp = fib_entry->nh_group; - int i; - -+ if (!list_is_singular(&nh_grp->fib_list)) -+ return; -+ - for (i = 0; i < nh_grp->count; i++) { - struct mlxsw_sp_nexthop *nh = &nh_grp->nexthops[i]; - -diff --git a/drivers/net/ethernet/mellanox/mlxsw/spectrum_switchdev.c b/drivers/net/ethernet/mellanox/mlxsw/spectrum_switchdev.c -index f5863e5bec81..42a6afcaae03 100644 ---- a/drivers/net/ethernet/mellanox/mlxsw/spectrum_switchdev.c -+++ b/drivers/net/ethernet/mellanox/mlxsw/spectrum_switchdev.c -@@ -1098,6 +1098,7 @@ static int __mlxsw_sp_port_fdb_uc_op(struct mlxsw_sp *mlxsw_sp, u8 local_port, - bool dynamic) - { - char *sfd_pl; -+ u8 num_rec; - int err; - - sfd_pl = kmalloc(MLXSW_REG_SFD_LEN, GFP_KERNEL); -@@ -1107,9 +1108,16 @@ static int __mlxsw_sp_port_fdb_uc_op(struct mlxsw_sp *mlxsw_sp, u8 local_port, - mlxsw_reg_sfd_pack(sfd_pl, mlxsw_sp_sfd_op(adding), 0); - mlxsw_reg_sfd_uc_pack(sfd_pl, 0, mlxsw_sp_sfd_rec_policy(dynamic), - mac, fid, action, local_port); -+ num_rec = mlxsw_reg_sfd_num_rec_get(sfd_pl); - err = mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(sfd), sfd_pl); -- kfree(sfd_pl); -+ if (err) -+ goto out; -+ -+ if (num_rec != mlxsw_reg_sfd_num_rec_get(sfd_pl)) -+ err = -EBUSY; - -+out: -+ kfree(sfd_pl); - return err; - } - -@@ -1134,6 +1142,7 @@ static int mlxsw_sp_port_fdb_uc_lag_op(struct mlxsw_sp *mlxsw_sp, u16 lag_id, - bool adding, bool dynamic) - { - char *sfd_pl; -+ u8 num_rec; - int err; - - sfd_pl = kmalloc(MLXSW_REG_SFD_LEN, GFP_KERNEL); -@@ -1144,9 +1153,16 @@ static int mlxsw_sp_port_fdb_uc_lag_op(struct mlxsw_sp *mlxsw_sp, u16 lag_id, - mlxsw_reg_sfd_uc_lag_pack(sfd_pl, 0, mlxsw_sp_sfd_rec_policy(dynamic), - mac, fid, MLXSW_REG_SFD_REC_ACTION_NOP, - lag_vid, lag_id); -+ num_rec = mlxsw_reg_sfd_num_rec_get(sfd_pl); - err = mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(sfd), sfd_pl); -- kfree(sfd_pl); -+ if (err) -+ goto out; -+ -+ if (num_rec != mlxsw_reg_sfd_num_rec_get(sfd_pl)) -+ err = -EBUSY; - -+out: -+ kfree(sfd_pl); - return err; - } - -@@ -1191,6 +1207,7 @@ static int mlxsw_sp_port_mdb_op(struct mlxsw_sp *mlxsw_sp, const char *addr, - u16 fid, u16 mid, bool adding) - { - char *sfd_pl; -+ u8 num_rec; - int err; - - sfd_pl = kmalloc(MLXSW_REG_SFD_LEN, GFP_KERNEL); -@@ -1200,7 +1217,15 @@ static int mlxsw_sp_port_mdb_op(struct mlxsw_sp *mlxsw_sp, const char *addr, - mlxsw_reg_sfd_pack(sfd_pl, mlxsw_sp_sfd_op(adding), 0); - mlxsw_reg_sfd_mc_pack(sfd_pl, 0, addr, fid, - MLXSW_REG_SFD_REC_ACTION_NOP, mid); -+ num_rec = mlxsw_reg_sfd_num_rec_get(sfd_pl); - err = mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(sfd), sfd_pl); -+ if (err) -+ goto out; -+ -+ if (num_rec != mlxsw_reg_sfd_num_rec_get(sfd_pl)) -+ err = -EBUSY; -+ -+out: - kfree(sfd_pl); - return err; - } -diff --git a/drivers/net/ethernet/ti/cpsw.c b/drivers/net/ethernet/ti/cpsw.c -index db8a4bcfc6c7..14b646b3b084 100644 ---- a/drivers/net/ethernet/ti/cpsw.c -+++ b/drivers/net/ethernet/ti/cpsw.c -@@ -1618,6 +1618,7 @@ static netdev_tx_t cpsw_ndo_start_xmit(struct sk_buff *skb, - q_idx = q_idx % cpsw->tx_ch_num; - - txch = cpsw->txv[q_idx].ch; -+ txq = netdev_get_tx_queue(ndev, q_idx); - ret = cpsw_tx_packet_submit(priv, skb, txch); - if (unlikely(ret != 0)) { - cpsw_err(priv, tx_err, "desc submit failed\n"); -@@ -1628,15 +1629,26 @@ static netdev_tx_t cpsw_ndo_start_xmit(struct sk_buff *skb, - * tell the kernel to stop sending us tx frames. - */ - if (unlikely(!cpdma_check_free_tx_desc(txch))) { -- txq = netdev_get_tx_queue(ndev, q_idx); - netif_tx_stop_queue(txq); -+ -+ /* Barrier, so that stop_queue visible to other cpus */ -+ smp_mb__after_atomic(); -+ -+ if (cpdma_check_free_tx_desc(txch)) -+ netif_tx_wake_queue(txq); - } - - return NETDEV_TX_OK; - fail: - ndev->stats.tx_dropped++; -- txq = netdev_get_tx_queue(ndev, skb_get_queue_mapping(skb)); - netif_tx_stop_queue(txq); -+ -+ /* Barrier, so that stop_queue visible to other cpus */ -+ smp_mb__after_atomic(); -+ -+ if (cpdma_check_free_tx_desc(txch)) -+ netif_tx_wake_queue(txq); -+ - return NETDEV_TX_BUSY; - } - -diff --git a/drivers/net/phy/phy.c b/drivers/net/phy/phy.c -index 2b1e67bc1e73..3d860de5e342 100644 ---- a/drivers/net/phy/phy.c -+++ b/drivers/net/phy/phy.c -@@ -842,7 +842,7 @@ void phy_start(struct phy_device *phydev) - break; - case PHY_HALTED: - /* make sure interrupts are re-enabled for the PHY */ -- if (phydev->irq != PHY_POLL) { -+ if (phy_interrupt_is_valid(phydev)) { - err = phy_enable_interrupts(phydev); - if (err < 0) - break; -diff --git a/drivers/net/ppp/ppp_generic.c b/drivers/net/ppp/ppp_generic.c -index 8c6b8918ec31..38cd2e8fae23 100644 ---- a/drivers/net/ppp/ppp_generic.c -+++ b/drivers/net/ppp/ppp_generic.c -@@ -3158,6 +3158,15 @@ ppp_connect_channel(struct channel *pch, int unit) - goto outl; - - ppp_lock(ppp); -+ spin_lock_bh(&pch->downl); -+ if (!pch->chan) { -+ /* Don't connect unregistered channels */ -+ spin_unlock_bh(&pch->downl); -+ ppp_unlock(ppp); -+ ret = -ENOTCONN; -+ goto outl; -+ } -+ spin_unlock_bh(&pch->downl); - if (pch->file.hdrlen > ppp->file.hdrlen) - ppp->file.hdrlen = pch->file.hdrlen; - hdrlen = pch->file.hdrlen + 2; /* for protocol bytes */ -diff --git a/drivers/net/tun.c b/drivers/net/tun.c -index fa51b7b0e9ea..bc38d54e37b9 100644 ---- a/drivers/net/tun.c -+++ b/drivers/net/tun.c -@@ -1315,6 +1315,7 @@ static struct sk_buff *tun_build_skb(struct tun_struct *tun, - else - *skb_xdp = 0; - -+ preempt_disable(); - rcu_read_lock(); - xdp_prog = rcu_dereference(tun->xdp_prog); - if (xdp_prog && !*skb_xdp) { -@@ -1333,9 +1334,11 @@ static struct sk_buff *tun_build_skb(struct tun_struct *tun, - get_page(alloc_frag->page); - alloc_frag->offset += buflen; - err = xdp_do_redirect(tun->dev, &xdp, xdp_prog); -+ xdp_do_flush_map(); - if (err) - goto err_redirect; - rcu_read_unlock(); -+ preempt_enable(); - return NULL; - case XDP_TX: - xdp_xmit = true; -@@ -1357,6 +1360,7 @@ static struct sk_buff *tun_build_skb(struct tun_struct *tun, - skb = build_skb(buf, buflen); - if (!skb) { - rcu_read_unlock(); -+ preempt_enable(); - return ERR_PTR(-ENOMEM); - } - -@@ -1369,10 +1373,12 @@ static struct sk_buff *tun_build_skb(struct tun_struct *tun, - skb->dev = tun->dev; - generic_xdp_tx(skb, xdp_prog); - rcu_read_unlock(); -+ preempt_enable(); - return NULL; - } - - rcu_read_unlock(); -+ preempt_enable(); - - return skb; - -@@ -1380,6 +1386,7 @@ static struct sk_buff *tun_build_skb(struct tun_struct *tun, - put_page(alloc_frag->page); - err_xdp: - rcu_read_unlock(); -+ preempt_enable(); - this_cpu_inc(tun->pcpu_stats->rx_dropped); - return NULL; - } -diff --git a/drivers/net/virtio_net.c b/drivers/net/virtio_net.c -index 7927e28f5336..6a785595b9b8 100644 ---- a/drivers/net/virtio_net.c -+++ b/drivers/net/virtio_net.c -@@ -1995,8 +1995,9 @@ static int virtnet_xdp_set(struct net_device *dev, struct bpf_prog *prog, - } - - /* Make sure NAPI is not using any XDP TX queues for RX. */ -- for (i = 0; i < vi->max_queue_pairs; i++) -- napi_disable(&vi->rq[i].napi); -+ if (netif_running(dev)) -+ for (i = 0; i < vi->max_queue_pairs; i++) -+ napi_disable(&vi->rq[i].napi); - - netif_set_real_num_rx_queues(dev, curr_qp + xdp_qp); - err = _virtnet_set_queues(vi, curr_qp + xdp_qp); -@@ -2015,7 +2016,8 @@ static int virtnet_xdp_set(struct net_device *dev, struct bpf_prog *prog, - } - if (old_prog) - bpf_prog_put(old_prog); -- virtnet_napi_enable(vi->rq[i].vq, &vi->rq[i].napi); -+ if (netif_running(dev)) -+ virtnet_napi_enable(vi->rq[i].vq, &vi->rq[i].napi); - } - - return 0; -diff --git a/drivers/net/wan/hdlc_ppp.c b/drivers/net/wan/hdlc_ppp.c -index 0d2e00ece804..f3c1d5245978 100644 ---- a/drivers/net/wan/hdlc_ppp.c -+++ b/drivers/net/wan/hdlc_ppp.c -@@ -574,7 +574,10 @@ static void ppp_timer(unsigned long arg) - ppp_cp_event(proto->dev, proto->pid, TO_GOOD, 0, 0, - 0, NULL); - proto->restart_counter--; -- } else -+ } else if (netif_carrier_ok(proto->dev)) -+ ppp_cp_event(proto->dev, proto->pid, TO_GOOD, 0, 0, -+ 0, NULL); -+ else - ppp_cp_event(proto->dev, proto->pid, TO_BAD, 0, 0, - 0, NULL); - break; -diff --git a/drivers/nvme/host/rdma.c b/drivers/nvme/host/rdma.c -index 33d4431c2b4b..93a082e0bdd4 100644 ---- a/drivers/nvme/host/rdma.c -+++ b/drivers/nvme/host/rdma.c -@@ -88,7 +88,6 @@ enum nvme_rdma_queue_flags { - - struct nvme_rdma_queue { - struct nvme_rdma_qe *rsp_ring; -- atomic_t sig_count; - int queue_size; - size_t cmnd_capsule_len; - struct nvme_rdma_ctrl *ctrl; -@@ -521,7 +520,6 @@ static int nvme_rdma_alloc_queue(struct nvme_rdma_ctrl *ctrl, - queue->cmnd_capsule_len = sizeof(struct nvme_command); - - queue->queue_size = queue_size; -- atomic_set(&queue->sig_count, 0); - - queue->cm_id = rdma_create_id(&init_net, nvme_rdma_cm_handler, queue, - RDMA_PS_TCP, IB_QPT_RC); -@@ -1232,21 +1230,9 @@ static void nvme_rdma_send_done(struct ib_cq *cq, struct ib_wc *wc) - nvme_end_request(rq, req->status, req->result); - } - --/* -- * We want to signal completion at least every queue depth/2. This returns the -- * largest power of two that is not above half of (queue size + 1) to optimize -- * (avoid divisions). -- */ --static inline bool nvme_rdma_queue_sig_limit(struct nvme_rdma_queue *queue) --{ -- int limit = 1 << ilog2((queue->queue_size + 1) / 2); -- -- return (atomic_inc_return(&queue->sig_count) & (limit - 1)) == 0; --} -- - static int nvme_rdma_post_send(struct nvme_rdma_queue *queue, - struct nvme_rdma_qe *qe, struct ib_sge *sge, u32 num_sge, -- struct ib_send_wr *first, bool flush) -+ struct ib_send_wr *first) - { - struct ib_send_wr wr, *bad_wr; - int ret; -@@ -1255,31 +1241,12 @@ static int nvme_rdma_post_send(struct nvme_rdma_queue *queue, - sge->length = sizeof(struct nvme_command), - sge->lkey = queue->device->pd->local_dma_lkey; - -- qe->cqe.done = nvme_rdma_send_done; -- - wr.next = NULL; - wr.wr_cqe = &qe->cqe; - wr.sg_list = sge; - wr.num_sge = num_sge; - wr.opcode = IB_WR_SEND; -- wr.send_flags = 0; -- -- /* -- * Unsignalled send completions are another giant desaster in the -- * IB Verbs spec: If we don't regularly post signalled sends -- * the send queue will fill up and only a QP reset will rescue us. -- * Would have been way to obvious to handle this in hardware or -- * at least the RDMA stack.. -- * -- * Always signal the flushes. The magic request used for the flush -- * sequencer is not allocated in our driver's tagset and it's -- * triggered to be freed by blk_cleanup_queue(). So we need to -- * always mark it as signaled to ensure that the "wr_cqe", which is -- * embedded in request's payload, is not freed when __ib_process_cq() -- * calls wr_cqe->done(). -- */ -- if (nvme_rdma_queue_sig_limit(queue) || flush) -- wr.send_flags |= IB_SEND_SIGNALED; -+ wr.send_flags = IB_SEND_SIGNALED; - - if (first) - first->next = ≀ -@@ -1329,6 +1296,12 @@ static struct blk_mq_tags *nvme_rdma_tagset(struct nvme_rdma_queue *queue) - return queue->ctrl->tag_set.tags[queue_idx - 1]; - } - -+static void nvme_rdma_async_done(struct ib_cq *cq, struct ib_wc *wc) -+{ -+ if (unlikely(wc->status != IB_WC_SUCCESS)) -+ nvme_rdma_wr_error(cq, wc, "ASYNC"); -+} -+ - static void nvme_rdma_submit_async_event(struct nvme_ctrl *arg, int aer_idx) - { - struct nvme_rdma_ctrl *ctrl = to_rdma_ctrl(arg); -@@ -1350,10 +1323,12 @@ static void nvme_rdma_submit_async_event(struct nvme_ctrl *arg, int aer_idx) - cmd->common.flags |= NVME_CMD_SGL_METABUF; - nvme_rdma_set_sg_null(cmd); - -+ sqe->cqe.done = nvme_rdma_async_done; -+ - ib_dma_sync_single_for_device(dev, sqe->dma, sizeof(*cmd), - DMA_TO_DEVICE); - -- ret = nvme_rdma_post_send(queue, sqe, &sge, 1, NULL, false); -+ ret = nvme_rdma_post_send(queue, sqe, &sge, 1, NULL); - WARN_ON_ONCE(ret); - } - -@@ -1639,7 +1614,6 @@ static blk_status_t nvme_rdma_queue_rq(struct blk_mq_hw_ctx *hctx, - struct nvme_rdma_request *req = blk_mq_rq_to_pdu(rq); - struct nvme_rdma_qe *sqe = &req->sqe; - struct nvme_command *c = sqe->data; -- bool flush = false; - struct ib_device *dev; - blk_status_t ret; - int err; -@@ -1668,13 +1642,13 @@ static blk_status_t nvme_rdma_queue_rq(struct blk_mq_hw_ctx *hctx, - goto err; - } - -+ sqe->cqe.done = nvme_rdma_send_done; -+ - ib_dma_sync_single_for_device(dev, sqe->dma, - sizeof(struct nvme_command), DMA_TO_DEVICE); - -- if (req_op(rq) == REQ_OP_FLUSH) -- flush = true; - err = nvme_rdma_post_send(queue, sqe, req->sge, req->num_sge, -- req->mr->need_inval ? &req->reg_wr.wr : NULL, flush); -+ req->mr->need_inval ? &req->reg_wr.wr : NULL); - if (unlikely(err)) { - nvme_rdma_unmap_data(queue, rq); - goto err; -diff --git a/drivers/pci/pcie/aspm.c b/drivers/pci/pcie/aspm.c -index cae54f8320be..633e55c57b13 100644 ---- a/drivers/pci/pcie/aspm.c -+++ b/drivers/pci/pcie/aspm.c -@@ -803,10 +803,14 @@ static struct pcie_link_state *alloc_pcie_link_state(struct pci_dev *pdev) - - /* - * Root Ports and PCI/PCI-X to PCIe Bridges are roots of PCIe -- * hierarchies. -+ * hierarchies. Note that some PCIe host implementations omit -+ * the root ports entirely, in which case a downstream port on -+ * a switch may become the root of the link state chain for all -+ * its subordinate endpoints. - */ - if (pci_pcie_type(pdev) == PCI_EXP_TYPE_ROOT_PORT || -- pci_pcie_type(pdev) == PCI_EXP_TYPE_PCIE_BRIDGE) { -+ pci_pcie_type(pdev) == PCI_EXP_TYPE_PCIE_BRIDGE || -+ !pdev->bus->parent->self) { - link->root = link; - } else { - struct pcie_link_state *parent; -diff --git a/drivers/s390/net/qeth_core.h b/drivers/s390/net/qeth_core.h -index 92dd4aef21a3..6b1e83539a9d 100644 ---- a/drivers/s390/net/qeth_core.h -+++ b/drivers/s390/net/qeth_core.h -@@ -580,6 +580,11 @@ struct qeth_cmd_buffer { - void (*callback) (struct qeth_channel *, struct qeth_cmd_buffer *); - }; - -+static inline struct qeth_ipa_cmd *__ipa_cmd(struct qeth_cmd_buffer *iob) -+{ -+ return (struct qeth_ipa_cmd *)(iob->data + IPA_PDU_HEADER_SIZE); -+} -+ - /** - * definition of a qeth channel, used for read and write - */ -@@ -834,7 +839,7 @@ struct qeth_trap_id { - */ - static inline int qeth_get_elements_for_range(addr_t start, addr_t end) - { -- return PFN_UP(end - 1) - PFN_DOWN(start); -+ return PFN_UP(end) - PFN_DOWN(start); - } - - static inline int qeth_get_micros(void) -diff --git a/drivers/s390/net/qeth_core_main.c b/drivers/s390/net/qeth_core_main.c -index 7c7a244b6684..145b57762d8f 100644 ---- a/drivers/s390/net/qeth_core_main.c -+++ b/drivers/s390/net/qeth_core_main.c -@@ -2073,7 +2073,7 @@ int qeth_send_control_data(struct qeth_card *card, int len, - unsigned long flags; - struct qeth_reply *reply = NULL; - unsigned long timeout, event_timeout; -- struct qeth_ipa_cmd *cmd; -+ struct qeth_ipa_cmd *cmd = NULL; - - QETH_CARD_TEXT(card, 2, "sendctl"); - -@@ -2087,23 +2087,27 @@ int qeth_send_control_data(struct qeth_card *card, int len, - } - reply->callback = reply_cb; - reply->param = reply_param; -- if (card->state == CARD_STATE_DOWN) -- reply->seqno = QETH_IDX_COMMAND_SEQNO; -- else -- reply->seqno = card->seqno.ipa++; -+ - init_waitqueue_head(&reply->wait_q); -- spin_lock_irqsave(&card->lock, flags); -- list_add_tail(&reply->list, &card->cmd_waiter_list); -- spin_unlock_irqrestore(&card->lock, flags); - QETH_DBF_HEX(CTRL, 2, iob->data, QETH_DBF_CTRL_LEN); - - while (atomic_cmpxchg(&card->write.irq_pending, 0, 1)) ; -- qeth_prepare_control_data(card, len, iob); - -- if (IS_IPA(iob->data)) -+ if (IS_IPA(iob->data)) { -+ cmd = __ipa_cmd(iob); -+ cmd->hdr.seqno = card->seqno.ipa++; -+ reply->seqno = cmd->hdr.seqno; - event_timeout = QETH_IPA_TIMEOUT; -- else -+ } else { -+ reply->seqno = QETH_IDX_COMMAND_SEQNO; - event_timeout = QETH_TIMEOUT; -+ } -+ qeth_prepare_control_data(card, len, iob); -+ -+ spin_lock_irqsave(&card->lock, flags); -+ list_add_tail(&reply->list, &card->cmd_waiter_list); -+ spin_unlock_irqrestore(&card->lock, flags); -+ - timeout = jiffies + event_timeout; - - QETH_CARD_TEXT(card, 6, "noirqpnd"); -@@ -2128,9 +2132,8 @@ int qeth_send_control_data(struct qeth_card *card, int len, - - /* we have only one long running ipassist, since we can ensure - process context of this command we can sleep */ -- cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); -- if ((cmd->hdr.command == IPA_CMD_SETIP) && -- (cmd->hdr.prot_version == QETH_PROT_IPV4)) { -+ if (cmd && cmd->hdr.command == IPA_CMD_SETIP && -+ cmd->hdr.prot_version == QETH_PROT_IPV4) { - if (!wait_event_timeout(reply->wait_q, - atomic_read(&reply->received), event_timeout)) - goto time_err; -@@ -2894,7 +2897,7 @@ static void qeth_fill_ipacmd_header(struct qeth_card *card, - memset(cmd, 0, sizeof(struct qeth_ipa_cmd)); - cmd->hdr.command = command; - cmd->hdr.initiator = IPA_CMD_INITIATOR_HOST; -- cmd->hdr.seqno = card->seqno.ipa; -+ /* cmd->hdr.seqno is set by qeth_send_control_data() */ - cmd->hdr.adapter_type = qeth_get_ipa_adp_type(card->info.link_type); - cmd->hdr.rel_adapter_no = (__u8) card->info.portno; - if (card->options.layer2) -@@ -3859,10 +3862,12 @@ EXPORT_SYMBOL_GPL(qeth_get_elements_for_frags); - int qeth_get_elements_no(struct qeth_card *card, - struct sk_buff *skb, int extra_elems, int data_offset) - { -- int elements = qeth_get_elements_for_range( -- (addr_t)skb->data + data_offset, -- (addr_t)skb->data + skb_headlen(skb)) + -- qeth_get_elements_for_frags(skb); -+ addr_t end = (addr_t)skb->data + skb_headlen(skb); -+ int elements = qeth_get_elements_for_frags(skb); -+ addr_t start = (addr_t)skb->data + data_offset; -+ -+ if (start != end) -+ elements += qeth_get_elements_for_range(start, end); - - if ((elements + extra_elems) > QETH_MAX_BUFFER_ELEMENTS(card)) { - QETH_DBF_MESSAGE(2, "Invalid size of IP packet " -diff --git a/drivers/s390/net/qeth_l3.h b/drivers/s390/net/qeth_l3.h -index e5833837b799..8727b9517de8 100644 ---- a/drivers/s390/net/qeth_l3.h -+++ b/drivers/s390/net/qeth_l3.h -@@ -40,8 +40,40 @@ struct qeth_ipaddr { - unsigned int pfxlen; - } a6; - } u; -- - }; -+ -+static inline bool qeth_l3_addr_match_ip(struct qeth_ipaddr *a1, -+ struct qeth_ipaddr *a2) -+{ -+ if (a1->proto != a2->proto) -+ return false; -+ if (a1->proto == QETH_PROT_IPV6) -+ return ipv6_addr_equal(&a1->u.a6.addr, &a2->u.a6.addr); -+ return a1->u.a4.addr == a2->u.a4.addr; -+} -+ -+static inline bool qeth_l3_addr_match_all(struct qeth_ipaddr *a1, -+ struct qeth_ipaddr *a2) -+{ -+ /* Assumes that the pair was obtained via qeth_l3_addr_find_by_ip(), -+ * so 'proto' and 'addr' match for sure. -+ * -+ * For ucast: -+ * - 'mac' is always 0. -+ * - 'mask'/'pfxlen' for RXIP/VIPA is always 0. For NORMAL, matching -+ * values are required to avoid mixups in takeover eligibility. -+ * -+ * For mcast, -+ * - 'mac' is mapped from the IP, and thus always matches. -+ * - 'mask'/'pfxlen' is always 0. -+ */ -+ if (a1->type != a2->type) -+ return false; -+ if (a1->proto == QETH_PROT_IPV6) -+ return a1->u.a6.pfxlen == a2->u.a6.pfxlen; -+ return a1->u.a4.mask == a2->u.a4.mask; -+} -+ - static inline u64 qeth_l3_ipaddr_hash(struct qeth_ipaddr *addr) - { - u64 ret = 0; -diff --git a/drivers/s390/net/qeth_l3_main.c b/drivers/s390/net/qeth_l3_main.c -index 36dee176f8e2..96576e729222 100644 ---- a/drivers/s390/net/qeth_l3_main.c -+++ b/drivers/s390/net/qeth_l3_main.c -@@ -149,6 +149,24 @@ int qeth_l3_string_to_ipaddr(const char *buf, enum qeth_prot_versions proto, - return -EINVAL; - } - -+static struct qeth_ipaddr *qeth_l3_find_addr_by_ip(struct qeth_card *card, -+ struct qeth_ipaddr *query) -+{ -+ u64 key = qeth_l3_ipaddr_hash(query); -+ struct qeth_ipaddr *addr; -+ -+ if (query->is_multicast) { -+ hash_for_each_possible(card->ip_mc_htable, addr, hnode, key) -+ if (qeth_l3_addr_match_ip(addr, query)) -+ return addr; -+ } else { -+ hash_for_each_possible(card->ip_htable, addr, hnode, key) -+ if (qeth_l3_addr_match_ip(addr, query)) -+ return addr; -+ } -+ return NULL; -+} -+ - static void qeth_l3_convert_addr_to_bits(u8 *addr, u8 *bits, int len) - { - int i, j; -@@ -202,34 +220,6 @@ static bool qeth_l3_is_addr_covered_by_ipato(struct qeth_card *card, - return rc; - } - --inline int --qeth_l3_ipaddrs_is_equal(struct qeth_ipaddr *addr1, struct qeth_ipaddr *addr2) --{ -- return addr1->proto == addr2->proto && -- !memcmp(&addr1->u, &addr2->u, sizeof(addr1->u)) && -- !memcmp(&addr1->mac, &addr2->mac, sizeof(addr1->mac)); --} -- --static struct qeth_ipaddr * --qeth_l3_ip_from_hash(struct qeth_card *card, struct qeth_ipaddr *tmp_addr) --{ -- struct qeth_ipaddr *addr; -- -- if (tmp_addr->is_multicast) { -- hash_for_each_possible(card->ip_mc_htable, addr, -- hnode, qeth_l3_ipaddr_hash(tmp_addr)) -- if (qeth_l3_ipaddrs_is_equal(tmp_addr, addr)) -- return addr; -- } else { -- hash_for_each_possible(card->ip_htable, addr, -- hnode, qeth_l3_ipaddr_hash(tmp_addr)) -- if (qeth_l3_ipaddrs_is_equal(tmp_addr, addr)) -- return addr; -- } -- -- return NULL; --} -- - int qeth_l3_delete_ip(struct qeth_card *card, struct qeth_ipaddr *tmp_addr) - { - int rc = 0; -@@ -244,23 +234,18 @@ int qeth_l3_delete_ip(struct qeth_card *card, struct qeth_ipaddr *tmp_addr) - QETH_CARD_HEX(card, 4, ((char *)&tmp_addr->u.a6.addr) + 8, 8); - } - -- addr = qeth_l3_ip_from_hash(card, tmp_addr); -- if (!addr) -+ addr = qeth_l3_find_addr_by_ip(card, tmp_addr); -+ if (!addr || !qeth_l3_addr_match_all(addr, tmp_addr)) - return -ENOENT; - - addr->ref_counter--; -- if (addr->ref_counter > 0 && (addr->type == QETH_IP_TYPE_NORMAL || -- addr->type == QETH_IP_TYPE_RXIP)) -+ if (addr->type == QETH_IP_TYPE_NORMAL && addr->ref_counter > 0) - return rc; - if (addr->in_progress) - return -EINPROGRESS; - -- if (!qeth_card_hw_is_reachable(card)) { -- addr->disp_flag = QETH_DISP_ADDR_DELETE; -- return 0; -- } -- -- rc = qeth_l3_deregister_addr_entry(card, addr); -+ if (qeth_card_hw_is_reachable(card)) -+ rc = qeth_l3_deregister_addr_entry(card, addr); - - hash_del(&addr->hnode); - kfree(addr); -@@ -272,6 +257,7 @@ int qeth_l3_add_ip(struct qeth_card *card, struct qeth_ipaddr *tmp_addr) - { - int rc = 0; - struct qeth_ipaddr *addr; -+ char buf[40]; - - QETH_CARD_TEXT(card, 4, "addip"); - -@@ -282,8 +268,20 @@ int qeth_l3_add_ip(struct qeth_card *card, struct qeth_ipaddr *tmp_addr) - QETH_CARD_HEX(card, 4, ((char *)&tmp_addr->u.a6.addr) + 8, 8); - } - -- addr = qeth_l3_ip_from_hash(card, tmp_addr); -- if (!addr) { -+ addr = qeth_l3_find_addr_by_ip(card, tmp_addr); -+ if (addr) { -+ if (tmp_addr->type != QETH_IP_TYPE_NORMAL) -+ return -EADDRINUSE; -+ if (qeth_l3_addr_match_all(addr, tmp_addr)) { -+ addr->ref_counter++; -+ return 0; -+ } -+ qeth_l3_ipaddr_to_string(tmp_addr->proto, (u8 *)&tmp_addr->u, -+ buf); -+ dev_warn(&card->gdev->dev, -+ "Registering IP address %s failed\n", buf); -+ return -EADDRINUSE; -+ } else { - addr = qeth_l3_get_addr_buffer(tmp_addr->proto); - if (!addr) - return -ENOMEM; -@@ -323,19 +321,15 @@ int qeth_l3_add_ip(struct qeth_card *card, struct qeth_ipaddr *tmp_addr) - (rc == IPA_RC_LAN_OFFLINE)) { - addr->disp_flag = QETH_DISP_ADDR_DO_NOTHING; - if (addr->ref_counter < 1) { -- qeth_l3_delete_ip(card, addr); -+ qeth_l3_deregister_addr_entry(card, addr); -+ hash_del(&addr->hnode); - kfree(addr); - } - } else { - hash_del(&addr->hnode); - kfree(addr); - } -- } else { -- if (addr->type == QETH_IP_TYPE_NORMAL || -- addr->type == QETH_IP_TYPE_RXIP) -- addr->ref_counter++; - } -- - return rc; - } - -@@ -403,11 +397,7 @@ static void qeth_l3_recover_ip(struct qeth_card *card) - spin_lock_bh(&card->ip_lock); - - hash_for_each_safe(card->ip_htable, i, tmp, addr, hnode) { -- if (addr->disp_flag == QETH_DISP_ADDR_DELETE) { -- qeth_l3_deregister_addr_entry(card, addr); -- hash_del(&addr->hnode); -- kfree(addr); -- } else if (addr->disp_flag == QETH_DISP_ADDR_ADD) { -+ if (addr->disp_flag == QETH_DISP_ADDR_ADD) { - if (addr->proto == QETH_PROT_IPV4) { - addr->in_progress = 1; - spin_unlock_bh(&card->ip_lock); -@@ -723,12 +713,7 @@ int qeth_l3_add_vipa(struct qeth_card *card, enum qeth_prot_versions proto, - return -ENOMEM; - - spin_lock_bh(&card->ip_lock); -- -- if (qeth_l3_ip_from_hash(card, ipaddr)) -- rc = -EEXIST; -- else -- qeth_l3_add_ip(card, ipaddr); -- -+ rc = qeth_l3_add_ip(card, ipaddr); - spin_unlock_bh(&card->ip_lock); - - kfree(ipaddr); -@@ -791,12 +776,7 @@ int qeth_l3_add_rxip(struct qeth_card *card, enum qeth_prot_versions proto, - return -ENOMEM; - - spin_lock_bh(&card->ip_lock); -- -- if (qeth_l3_ip_from_hash(card, ipaddr)) -- rc = -EEXIST; -- else -- qeth_l3_add_ip(card, ipaddr); -- -+ rc = qeth_l3_add_ip(card, ipaddr); - spin_unlock_bh(&card->ip_lock); - - kfree(ipaddr); -@@ -1404,8 +1384,9 @@ qeth_l3_add_mc_to_hash(struct qeth_card *card, struct in_device *in4_dev) - memcpy(tmp->mac, buf, sizeof(tmp->mac)); - tmp->is_multicast = 1; - -- ipm = qeth_l3_ip_from_hash(card, tmp); -+ ipm = qeth_l3_find_addr_by_ip(card, tmp); - if (ipm) { -+ /* for mcast, by-IP match means full match */ - ipm->disp_flag = QETH_DISP_ADDR_DO_NOTHING; - } else { - ipm = qeth_l3_get_addr_buffer(QETH_PROT_IPV4); -@@ -1488,8 +1469,9 @@ qeth_l3_add_mc6_to_hash(struct qeth_card *card, struct inet6_dev *in6_dev) - sizeof(struct in6_addr)); - tmp->is_multicast = 1; - -- ipm = qeth_l3_ip_from_hash(card, tmp); -+ ipm = qeth_l3_find_addr_by_ip(card, tmp); - if (ipm) { -+ /* for mcast, by-IP match means full match */ - ipm->disp_flag = QETH_DISP_ADDR_DO_NOTHING; - continue; - } -@@ -2633,11 +2615,12 @@ static void qeth_tso_fill_header(struct qeth_card *card, - static int qeth_l3_get_elements_no_tso(struct qeth_card *card, - struct sk_buff *skb, int extra_elems) - { -- addr_t tcpdptr = (addr_t)tcp_hdr(skb) + tcp_hdrlen(skb); -- int elements = qeth_get_elements_for_range( -- tcpdptr, -- (addr_t)skb->data + skb_headlen(skb)) + -- qeth_get_elements_for_frags(skb); -+ addr_t start = (addr_t)tcp_hdr(skb) + tcp_hdrlen(skb); -+ addr_t end = (addr_t)skb->data + skb_headlen(skb); -+ int elements = qeth_get_elements_for_frags(skb); -+ -+ if (start != end) -+ elements += qeth_get_elements_for_range(start, end); - - if ((elements + extra_elems) > QETH_MAX_BUFFER_ELEMENTS(card)) { - QETH_DBF_MESSAGE(2, -diff --git a/drivers/vfio/vfio_iommu_type1.c b/drivers/vfio/vfio_iommu_type1.c -index 92155cce926d..fb4e6a7ee521 100644 ---- a/drivers/vfio/vfio_iommu_type1.c -+++ b/drivers/vfio/vfio_iommu_type1.c -@@ -338,11 +338,12 @@ static int vaddr_get_pfn(struct mm_struct *mm, unsigned long vaddr, - { - struct page *page[1]; - struct vm_area_struct *vma; -+ struct vm_area_struct *vmas[1]; - int ret; - - if (mm == current->mm) { -- ret = get_user_pages_fast(vaddr, 1, !!(prot & IOMMU_WRITE), -- page); -+ ret = get_user_pages_longterm(vaddr, 1, !!(prot & IOMMU_WRITE), -+ page, vmas); - } else { - unsigned int flags = 0; - -@@ -351,7 +352,18 @@ static int vaddr_get_pfn(struct mm_struct *mm, unsigned long vaddr, - - down_read(&mm->mmap_sem); - ret = get_user_pages_remote(NULL, mm, vaddr, 1, flags, page, -- NULL, NULL); -+ vmas, NULL); -+ /* -+ * The lifetime of a vaddr_get_pfn() page pin is -+ * userspace-controlled. In the fs-dax case this could -+ * lead to indefinite stalls in filesystem operations. -+ * Disallow attempts to pin fs-dax pages via this -+ * interface. -+ */ -+ if (ret > 0 && vma_is_fsdax(vmas[0])) { -+ ret = -EOPNOTSUPP; -+ put_page(page[0]); -+ } - up_read(&mm->mmap_sem); - } - -diff --git a/fs/btrfs/sysfs.c b/fs/btrfs/sysfs.c -index 883881b16c86..4447e0fe9b55 100644 ---- a/fs/btrfs/sysfs.c -+++ b/fs/btrfs/sysfs.c -@@ -422,7 +422,7 @@ static ssize_t btrfs_nodesize_show(struct kobject *kobj, - { - struct btrfs_fs_info *fs_info = to_fs_info(kobj); - -- return snprintf(buf, PAGE_SIZE, "%u\n", fs_info->super_copy->nodesize); -+ return snprintf(buf, PAGE_SIZE, "%u\n", fs_info->nodesize); - } - - BTRFS_ATTR(nodesize, btrfs_nodesize_show); -@@ -432,8 +432,7 @@ static ssize_t btrfs_sectorsize_show(struct kobject *kobj, - { - struct btrfs_fs_info *fs_info = to_fs_info(kobj); - -- return snprintf(buf, PAGE_SIZE, "%u\n", -- fs_info->super_copy->sectorsize); -+ return snprintf(buf, PAGE_SIZE, "%u\n", fs_info->sectorsize); - } - - BTRFS_ATTR(sectorsize, btrfs_sectorsize_show); -@@ -443,8 +442,7 @@ static ssize_t btrfs_clone_alignment_show(struct kobject *kobj, - { - struct btrfs_fs_info *fs_info = to_fs_info(kobj); - -- return snprintf(buf, PAGE_SIZE, "%u\n", -- fs_info->super_copy->sectorsize); -+ return snprintf(buf, PAGE_SIZE, "%u\n", fs_info->sectorsize); - } - - BTRFS_ATTR(clone_alignment, btrfs_clone_alignment_show); -diff --git a/fs/btrfs/transaction.c b/fs/btrfs/transaction.c -index f615d59b0489..46bda13e5727 100644 ---- a/fs/btrfs/transaction.c -+++ b/fs/btrfs/transaction.c -@@ -1722,19 +1722,23 @@ static void update_super_roots(struct btrfs_fs_info *fs_info) - - super = fs_info->super_copy; - -+ /* update latest btrfs_super_block::chunk_root refs */ - root_item = &fs_info->chunk_root->root_item; -- super->chunk_root = root_item->bytenr; -- super->chunk_root_generation = root_item->generation; -- super->chunk_root_level = root_item->level; -+ btrfs_set_super_chunk_root(super, root_item->bytenr); -+ btrfs_set_super_chunk_root_generation(super, root_item->generation); -+ btrfs_set_super_chunk_root_level(super, root_item->level); - -+ /* update latest btrfs_super_block::root refs */ - root_item = &fs_info->tree_root->root_item; -- super->root = root_item->bytenr; -- super->generation = root_item->generation; -- super->root_level = root_item->level; -+ btrfs_set_super_root(super, root_item->bytenr); -+ btrfs_set_super_generation(super, root_item->generation); -+ btrfs_set_super_root_level(super, root_item->level); -+ - if (btrfs_test_opt(fs_info, SPACE_CACHE)) -- super->cache_generation = root_item->generation; -+ btrfs_set_super_cache_generation(super, root_item->generation); - if (test_bit(BTRFS_FS_UPDATE_UUID_TREE_GEN, &fs_info->flags)) -- super->uuid_tree_generation = root_item->generation; -+ btrfs_set_super_uuid_tree_generation(super, -+ root_item->generation); - } - - int btrfs_transaction_in_commit(struct btrfs_fs_info *info) -diff --git a/fs/direct-io.c b/fs/direct-io.c -index b53e66d9abd7..625a84aa6484 100644 ---- a/fs/direct-io.c -+++ b/fs/direct-io.c -@@ -1252,8 +1252,7 @@ do_blockdev_direct_IO(struct kiocb *iocb, struct inode *inode, - */ - if (dio->is_async && iov_iter_rw(iter) == WRITE) { - retval = 0; -- if ((iocb->ki_filp->f_flags & O_DSYNC) || -- IS_SYNC(iocb->ki_filp->f_mapping->host)) -+ if (iocb->ki_flags & IOCB_DSYNC) - retval = dio_set_defer_completion(dio); - else if (!dio->inode->i_sb->s_dio_done_wq) { - /* -diff --git a/include/linux/fs.h b/include/linux/fs.h -index 440281f8564d..d54f41a63dbf 100644 ---- a/include/linux/fs.h -+++ b/include/linux/fs.h -@@ -3185,7 +3185,7 @@ static inline bool vma_is_fsdax(struct vm_area_struct *vma) - if (!vma_is_dax(vma)) - return false; - inode = file_inode(vma->vm_file); -- if (inode->i_mode == S_IFCHR) -+ if (S_ISCHR(inode->i_mode)) - return false; /* device-dax */ - return true; - } -diff --git a/include/linux/nospec.h b/include/linux/nospec.h -index fbc98e2c8228..132e3f5a2e0d 100644 ---- a/include/linux/nospec.h -+++ b/include/linux/nospec.h -@@ -72,7 +72,6 @@ static inline unsigned long array_index_mask_nospec(unsigned long index, - BUILD_BUG_ON(sizeof(_i) > sizeof(long)); \ - BUILD_BUG_ON(sizeof(_s) > sizeof(long)); \ - \ -- _i &= _mask; \ -- _i; \ -+ (typeof(_i)) (_i & _mask); \ - }) - #endif /* _LINUX_NOSPEC_H */ -diff --git a/include/net/udplite.h b/include/net/udplite.h -index 81bdbf97319b..9185e45b997f 100644 ---- a/include/net/udplite.h -+++ b/include/net/udplite.h -@@ -64,6 +64,7 @@ static inline int udplite_checksum_init(struct sk_buff *skb, struct udphdr *uh) - UDP_SKB_CB(skb)->cscov = cscov; - if (skb->ip_summed == CHECKSUM_COMPLETE) - skb->ip_summed = CHECKSUM_NONE; -+ skb->csum_valid = 0; - } - - return 0; -diff --git a/kernel/time/timer.c b/kernel/time/timer.c -index db5e6daadd94..9fe525f410bf 100644 ---- a/kernel/time/timer.c -+++ b/kernel/time/timer.c -@@ -1834,6 +1834,12 @@ int timers_dead_cpu(unsigned int cpu) - raw_spin_lock_irq(&new_base->lock); - raw_spin_lock_nested(&old_base->lock, SINGLE_DEPTH_NESTING); - -+ /* -+ * The current CPUs base clock might be stale. Update it -+ * before moving the timers over. -+ */ -+ forward_timer_base(new_base); -+ - BUG_ON(old_base->running_timer); - - for (i = 0; i < WHEEL_SIZE; i++) -diff --git a/net/bridge/br_sysfs_if.c b/net/bridge/br_sysfs_if.c -index 5d5d413a6cf8..a097a8613a02 100644 ---- a/net/bridge/br_sysfs_if.c -+++ b/net/bridge/br_sysfs_if.c -@@ -235,6 +235,9 @@ static ssize_t brport_show(struct kobject *kobj, - struct brport_attribute *brport_attr = to_brport_attr(attr); - struct net_bridge_port *p = to_brport(kobj); - -+ if (!brport_attr->show) -+ return -EINVAL; -+ - return brport_attr->show(p, buf); - } - -diff --git a/net/bridge/br_vlan.c b/net/bridge/br_vlan.c -index 233a30040c91..9b8a53568b0f 100644 ---- a/net/bridge/br_vlan.c -+++ b/net/bridge/br_vlan.c -@@ -157,6 +157,8 @@ static struct net_bridge_vlan *br_vlan_get_master(struct net_bridge *br, u16 vid - masterv = br_vlan_find(vg, vid); - if (WARN_ON(!masterv)) - return NULL; -+ refcount_set(&masterv->refcnt, 1); -+ return masterv; - } - refcount_inc(&masterv->refcnt); - -diff --git a/net/core/dev.c b/net/core/dev.c -index d33bbed640b1..c75ef9d8105a 100644 ---- a/net/core/dev.c -+++ b/net/core/dev.c -@@ -2343,8 +2343,11 @@ EXPORT_SYMBOL(netdev_set_num_tc); - */ - int netif_set_real_num_tx_queues(struct net_device *dev, unsigned int txq) - { -+ bool disabling; - int rc; - -+ disabling = txq < dev->real_num_tx_queues; -+ - if (txq < 1 || txq > dev->num_tx_queues) - return -EINVAL; - -@@ -2360,15 +2363,19 @@ int netif_set_real_num_tx_queues(struct net_device *dev, unsigned int txq) - if (dev->num_tc) - netif_setup_tc(dev, txq); - -- if (txq < dev->real_num_tx_queues) { -+ dev->real_num_tx_queues = txq; -+ -+ if (disabling) { -+ synchronize_net(); - qdisc_reset_all_tx_gt(dev, txq); - #ifdef CONFIG_XPS - netif_reset_xps_queues_gt(dev, txq); - #endif - } -+ } else { -+ dev->real_num_tx_queues = txq; - } - -- dev->real_num_tx_queues = txq; - return 0; - } - EXPORT_SYMBOL(netif_set_real_num_tx_queues); -diff --git a/net/core/gen_estimator.c b/net/core/gen_estimator.c -index 00ecec4891f3..7f980bd7426e 100644 ---- a/net/core/gen_estimator.c -+++ b/net/core/gen_estimator.c -@@ -66,6 +66,7 @@ struct net_rate_estimator { - static void est_fetch_counters(struct net_rate_estimator *e, - struct gnet_stats_basic_packed *b) - { -+ memset(b, 0, sizeof(*b)); - if (e->stats_lock) - spin_lock(e->stats_lock); - -diff --git a/net/ipv4/fib_semantics.c b/net/ipv4/fib_semantics.c -index aff3751df950..1ee6c0d8dde4 100644 ---- a/net/ipv4/fib_semantics.c -+++ b/net/ipv4/fib_semantics.c -@@ -654,6 +654,11 @@ int fib_nh_match(struct fib_config *cfg, struct fib_info *fi, - fi->fib_nh, cfg, extack)) - return 1; - } -+#ifdef CONFIG_IP_ROUTE_CLASSID -+ if (cfg->fc_flow && -+ cfg->fc_flow != fi->fib_nh->nh_tclassid) -+ return 1; -+#endif - if ((!cfg->fc_oif || cfg->fc_oif == fi->fib_nh->nh_oif) && - (!cfg->fc_gw || cfg->fc_gw == fi->fib_nh->nh_gw)) - return 0; -diff --git a/net/ipv4/route.c b/net/ipv4/route.c -index 0ba88efca7ad..9ff06c5051ae 100644 ---- a/net/ipv4/route.c -+++ b/net/ipv4/route.c -@@ -128,10 +128,13 @@ static int ip_rt_redirect_silence __read_mostly = ((HZ / 50) << (9 + 1)); - static int ip_rt_error_cost __read_mostly = HZ; - static int ip_rt_error_burst __read_mostly = 5 * HZ; - static int ip_rt_mtu_expires __read_mostly = 10 * 60 * HZ; --static int ip_rt_min_pmtu __read_mostly = 512 + 20 + 20; -+static u32 ip_rt_min_pmtu __read_mostly = 512 + 20 + 20; - static int ip_rt_min_advmss __read_mostly = 256; - - static int ip_rt_gc_timeout __read_mostly = RT_GC_TIMEOUT; -+ -+static int ip_min_valid_pmtu __read_mostly = IPV4_MIN_MTU; -+ - /* - * Interface to generic destination cache. - */ -@@ -1829,6 +1832,8 @@ int fib_multipath_hash(const struct fib_info *fi, const struct flowi4 *fl4, - return skb_get_hash_raw(skb) >> 1; - memset(&hash_keys, 0, sizeof(hash_keys)); - skb_flow_dissect_flow_keys(skb, &keys, flag); -+ -+ hash_keys.control.addr_type = FLOW_DISSECTOR_KEY_IPV4_ADDRS; - hash_keys.addrs.v4addrs.src = keys.addrs.v4addrs.src; - hash_keys.addrs.v4addrs.dst = keys.addrs.v4addrs.dst; - hash_keys.ports.src = keys.ports.src; -@@ -2934,7 +2939,8 @@ static struct ctl_table ipv4_route_table[] = { - .data = &ip_rt_min_pmtu, - .maxlen = sizeof(int), - .mode = 0644, -- .proc_handler = proc_dointvec, -+ .proc_handler = proc_dointvec_minmax, -+ .extra1 = &ip_min_valid_pmtu, - }, - { - .procname = "min_adv_mss", -diff --git a/net/ipv4/tcp_input.c b/net/ipv4/tcp_input.c -index d9d215e27b8a..14474acea0bb 100644 ---- a/net/ipv4/tcp_input.c -+++ b/net/ipv4/tcp_input.c -@@ -2013,11 +2013,6 @@ void tcp_enter_loss(struct sock *sk) - /* F-RTO RFC5682 sec 3.1 step 1: retransmit SND.UNA if no previous - * loss recovery is underway except recurring timeout(s) on - * the same SND.UNA (sec 3.2). Disable F-RTO on path MTU probing -- * -- * In theory F-RTO can be used repeatedly during loss recovery. -- * In practice this interacts badly with broken middle-boxes that -- * falsely raise the receive window, which results in repeated -- * timeouts and stop-and-go behavior. - */ - tp->frto = sysctl_tcp_frto && - (new_recovery || icsk->icsk_retransmits) && -@@ -2699,18 +2694,14 @@ static void tcp_process_loss(struct sock *sk, int flag, bool is_dupack, - tcp_try_undo_loss(sk, false)) - return; - -- /* The ACK (s)acks some never-retransmitted data meaning not all -- * the data packets before the timeout were lost. Therefore we -- * undo the congestion window and state. This is essentially -- * the operation in F-RTO (RFC5682 section 3.1 step 3.b). Since -- * a retransmitted skb is permantly marked, we can apply such an -- * operation even if F-RTO was not used. -- */ -- if ((flag & FLAG_ORIG_SACK_ACKED) && -- tcp_try_undo_loss(sk, tp->undo_marker)) -- return; -- - if (tp->frto) { /* F-RTO RFC5682 sec 3.1 (sack enhanced version). */ -+ /* Step 3.b. A timeout is spurious if not all data are -+ * lost, i.e., never-retransmitted data are (s)acked. -+ */ -+ if ((flag & FLAG_ORIG_SACK_ACKED) && -+ tcp_try_undo_loss(sk, true)) -+ return; -+ - if (after(tp->snd_nxt, tp->high_seq)) { - if (flag & FLAG_DATA_SACKED || is_dupack) - tp->frto = 0; /* Step 3.a. loss was real */ -@@ -4020,6 +4011,7 @@ void tcp_reset(struct sock *sk) - /* This barrier is coupled with smp_rmb() in tcp_poll() */ - smp_wmb(); - -+ tcp_write_queue_purge(sk); - tcp_done(sk); - - if (!sock_flag(sk, SOCK_DEAD)) -diff --git a/net/ipv4/tcp_output.c b/net/ipv4/tcp_output.c -index cd3d60bb7cc8..83d11cd2eb65 100644 ---- a/net/ipv4/tcp_output.c -+++ b/net/ipv4/tcp_output.c -@@ -1681,7 +1681,7 @@ u32 tcp_tso_autosize(const struct sock *sk, unsigned int mss_now, - */ - segs = max_t(u32, bytes / mss_now, min_tso_segs); - -- return min_t(u32, segs, sk->sk_gso_max_segs); -+ return segs; - } - EXPORT_SYMBOL(tcp_tso_autosize); - -@@ -1693,8 +1693,10 @@ static u32 tcp_tso_segs(struct sock *sk, unsigned int mss_now) - const struct tcp_congestion_ops *ca_ops = inet_csk(sk)->icsk_ca_ops; - u32 tso_segs = ca_ops->tso_segs_goal ? ca_ops->tso_segs_goal(sk) : 0; - -- return tso_segs ? : -- tcp_tso_autosize(sk, mss_now, sysctl_tcp_min_tso_segs); -+ if (!tso_segs) -+ tso_segs = tcp_tso_autosize(sk, mss_now, -+ sysctl_tcp_min_tso_segs); -+ return min_t(u32, tso_segs, sk->sk_gso_max_segs); - } - - /* Returns the portion of skb which can be sent right away */ -@@ -1973,6 +1975,24 @@ static inline void tcp_mtu_check_reprobe(struct sock *sk) - } - } - -+static bool tcp_can_coalesce_send_queue_head(struct sock *sk, int len) -+{ -+ struct sk_buff *skb, *next; -+ -+ skb = tcp_send_head(sk); -+ tcp_for_write_queue_from_safe(skb, next, sk) { -+ if (len <= skb->len) -+ break; -+ -+ if (unlikely(TCP_SKB_CB(skb)->eor)) -+ return false; -+ -+ len -= skb->len; -+ } -+ -+ return true; -+} -+ - /* Create a new MTU probe if we are ready. - * MTU probe is regularly attempting to increase the path MTU by - * deliberately sending larger packets. This discovers routing -@@ -2045,6 +2065,9 @@ static int tcp_mtu_probe(struct sock *sk) - return 0; - } - -+ if (!tcp_can_coalesce_send_queue_head(sk, probe_size)) -+ return -1; -+ - /* We're allowed to probe. Build it now. */ - nskb = sk_stream_alloc_skb(sk, probe_size, GFP_ATOMIC, false); - if (!nskb) -@@ -2080,6 +2103,10 @@ static int tcp_mtu_probe(struct sock *sk) - /* We've eaten all the data from this skb. - * Throw it away. */ - TCP_SKB_CB(nskb)->tcp_flags |= TCP_SKB_CB(skb)->tcp_flags; -+ /* If this is the last SKB we copy and eor is set -+ * we need to propagate it to the new skb. -+ */ -+ TCP_SKB_CB(nskb)->eor = TCP_SKB_CB(skb)->eor; - tcp_unlink_write_queue(skb, sk); - sk_wmem_free_skb(sk, skb); - } else { -diff --git a/net/ipv4/udp.c b/net/ipv4/udp.c -index ebfbccae62fd..c79fa6f6b758 100644 ---- a/net/ipv4/udp.c -+++ b/net/ipv4/udp.c -@@ -2032,6 +2032,11 @@ static inline int udp4_csum_init(struct sk_buff *skb, struct udphdr *uh, - err = udplite_checksum_init(skb, uh); - if (err) - return err; -+ -+ if (UDP_SKB_CB(skb)->partial_cov) { -+ skb->csum = inet_compute_pseudo(skb, proto); -+ return 0; -+ } - } - - /* Note, we are only interested in != 0 or == 0, thus the -diff --git a/net/ipv6/ip6_checksum.c b/net/ipv6/ip6_checksum.c -index ec43d18b5ff9..547515e8450a 100644 ---- a/net/ipv6/ip6_checksum.c -+++ b/net/ipv6/ip6_checksum.c -@@ -73,6 +73,11 @@ int udp6_csum_init(struct sk_buff *skb, struct udphdr *uh, int proto) - err = udplite_checksum_init(skb, uh); - if (err) - return err; -+ -+ if (UDP_SKB_CB(skb)->partial_cov) { -+ skb->csum = ip6_compute_pseudo(skb, proto); -+ return 0; -+ } - } - - /* To support RFC 6936 (allow zero checksum in UDP/IPV6 for tunnels) -diff --git a/net/ipv6/sit.c b/net/ipv6/sit.c -index e79854cc5790..cac815cc8600 100644 ---- a/net/ipv6/sit.c -+++ b/net/ipv6/sit.c -@@ -176,7 +176,7 @@ static void ipip6_tunnel_clone_6rd(struct net_device *dev, struct sit_net *sitn) - #ifdef CONFIG_IPV6_SIT_6RD - struct ip_tunnel *t = netdev_priv(dev); - -- if (t->dev == sitn->fb_tunnel_dev) { -+ if (dev == sitn->fb_tunnel_dev) { - ipv6_addr_set(&t->ip6rd.prefix, htonl(0x20020000), 0, 0, 0); - t->ip6rd.relay_prefix = 0; - t->ip6rd.prefixlen = 16; -diff --git a/net/netlink/af_netlink.c b/net/netlink/af_netlink.c -index 533fd0503ba0..9219bc134109 100644 ---- a/net/netlink/af_netlink.c -+++ b/net/netlink/af_netlink.c -@@ -2276,7 +2276,7 @@ int __netlink_dump_start(struct sock *ssk, struct sk_buff *skb, - if (cb->start) { - ret = cb->start(cb); - if (ret) -- goto error_unlock; -+ goto error_put; - } - - nlk->cb_running = true; -@@ -2296,6 +2296,8 @@ int __netlink_dump_start(struct sock *ssk, struct sk_buff *skb, - */ - return -EINTR; - -+error_put: -+ module_put(control->module); - error_unlock: - sock_put(sk); - mutex_unlock(nlk->cb_mutex); -diff --git a/net/netlink/genetlink.c b/net/netlink/genetlink.c -index d444daf1ac04..6f02499ef007 100644 ---- a/net/netlink/genetlink.c -+++ b/net/netlink/genetlink.c -@@ -1081,6 +1081,7 @@ static int genlmsg_mcast(struct sk_buff *skb, u32 portid, unsigned long group, - { - struct sk_buff *tmp; - struct net *net, *prev = NULL; -+ bool delivered = false; - int err; - - for_each_net_rcu(net) { -@@ -1092,14 +1093,21 @@ static int genlmsg_mcast(struct sk_buff *skb, u32 portid, unsigned long group, - } - err = nlmsg_multicast(prev->genl_sock, tmp, - portid, group, flags); -- if (err) -+ if (!err) -+ delivered = true; -+ else if (err != -ESRCH) - goto error; - } - - prev = net; - } - -- return nlmsg_multicast(prev->genl_sock, skb, portid, group, flags); -+ err = nlmsg_multicast(prev->genl_sock, skb, portid, group, flags); -+ if (!err) -+ delivered = true; -+ else if (err != -ESRCH) -+ goto error; -+ return delivered ? 0 : -ESRCH; - error: - kfree_skb(skb); - return err; -diff --git a/net/rxrpc/output.c b/net/rxrpc/output.c -index 71e6f713fbe7..5b67cb5d47f0 100644 ---- a/net/rxrpc/output.c -+++ b/net/rxrpc/output.c -@@ -395,7 +395,7 @@ int rxrpc_send_data_packet(struct rxrpc_call *call, struct sk_buff *skb, - (char *)&opt, sizeof(opt)); - if (ret == 0) { - ret = kernel_sendmsg(conn->params.local->socket, &msg, -- iov, 1, iov[0].iov_len); -+ iov, 2, len); - - opt = IPV6_PMTUDISC_DO; - kernel_setsockopt(conn->params.local->socket, -diff --git a/net/sched/cls_api.c b/net/sched/cls_api.c -index 934c239cf98d..c2fab4bcb8be 100644 ---- a/net/sched/cls_api.c -+++ b/net/sched/cls_api.c -@@ -871,13 +871,18 @@ static int tc_dump_tfilter(struct sk_buff *skb, struct netlink_callback *cb) - if (tca[TCA_CHAIN] && - nla_get_u32(tca[TCA_CHAIN]) != chain->index) - continue; -- if (!tcf_chain_dump(chain, skb, cb, index_start, &index)) -+ if (!tcf_chain_dump(chain, skb, cb, index_start, &index)) { -+ err = -EMSGSIZE; - break; -+ } - } - - cb->args[0] = index; - - out: -+ /* If we did no progress, the error (EMSGSIZE) is real */ -+ if (skb->len == 0 && err) -+ return err; - return skb->len; - } - -diff --git a/net/sched/cls_u32.c b/net/sched/cls_u32.c -index b58eccb21f03..ba37d8f57e68 100644 ---- a/net/sched/cls_u32.c -+++ b/net/sched/cls_u32.c -@@ -398,10 +398,12 @@ static int u32_init(struct tcf_proto *tp) - static int u32_destroy_key(struct tcf_proto *tp, struct tc_u_knode *n, - bool free_pf) - { -+ struct tc_u_hnode *ht = rtnl_dereference(n->ht_down); -+ - tcf_exts_destroy(&n->exts); - tcf_exts_put_net(&n->exts); -- if (n->ht_down) -- n->ht_down->refcnt--; -+ if (ht && --ht->refcnt == 0) -+ kfree(ht); - #ifdef CONFIG_CLS_U32_PERF - if (free_pf) - free_percpu(n->pf); -@@ -649,16 +651,15 @@ static void u32_destroy(struct tcf_proto *tp) - - hlist_del(&tp_c->hnode); - -- for (ht = rtnl_dereference(tp_c->hlist); -- ht; -- ht = rtnl_dereference(ht->next)) { -- ht->refcnt--; -- u32_clear_hnode(tp, ht); -- } -- - while ((ht = rtnl_dereference(tp_c->hlist)) != NULL) { -+ u32_clear_hnode(tp, ht); - RCU_INIT_POINTER(tp_c->hlist, ht->next); -- kfree_rcu(ht, rcu); -+ -+ /* u32_destroy_key() will later free ht for us, if it's -+ * still referenced by some knode -+ */ -+ if (--ht->refcnt == 0) -+ kfree_rcu(ht, rcu); - } - - kfree(tp_c); -@@ -927,7 +928,8 @@ static int u32_change(struct net *net, struct sk_buff *in_skb, - if (TC_U32_KEY(n->handle) == 0) - return -EINVAL; - -- if (n->flags != flags) -+ if ((n->flags ^ flags) & -+ ~(TCA_CLS_FLAGS_IN_HW | TCA_CLS_FLAGS_NOT_IN_HW)) - return -EINVAL; - - new = u32_init_knode(tp, n); -diff --git a/net/sctp/input.c b/net/sctp/input.c -index 141c9c466ec1..0247cc432e02 100644 ---- a/net/sctp/input.c -+++ b/net/sctp/input.c -@@ -897,15 +897,12 @@ int sctp_hash_transport(struct sctp_transport *t) - rhl_for_each_entry_rcu(transport, tmp, list, node) - if (transport->asoc->ep == t->asoc->ep) { - rcu_read_unlock(); -- err = -EEXIST; -- goto out; -+ return -EEXIST; - } - rcu_read_unlock(); - - err = rhltable_insert_key(&sctp_transport_hashtable, &arg, - &t->node, sctp_hash_params); -- --out: - if (err) - pr_err_once("insert transport fail, errno %d\n", err); - -diff --git a/net/sctp/ipv6.c b/net/sctp/ipv6.c -index 3b18085e3b10..f27a9718554c 100644 ---- a/net/sctp/ipv6.c -+++ b/net/sctp/ipv6.c -@@ -326,8 +326,10 @@ static void sctp_v6_get_dst(struct sctp_transport *t, union sctp_addr *saddr, - final_p = fl6_update_dst(fl6, rcu_dereference(np->opt), &final); - bdst = ip6_dst_lookup_flow(sk, fl6, final_p); - -- if (!IS_ERR(bdst) && -- ipv6_chk_addr(dev_net(bdst->dev), -+ if (IS_ERR(bdst)) -+ continue; -+ -+ if (ipv6_chk_addr(dev_net(bdst->dev), - &laddr->a.v6.sin6_addr, bdst->dev, 1)) { - if (!IS_ERR_OR_NULL(dst)) - dst_release(dst); -@@ -336,8 +338,10 @@ static void sctp_v6_get_dst(struct sctp_transport *t, union sctp_addr *saddr, - } - - bmatchlen = sctp_v6_addr_match_len(daddr, &laddr->a); -- if (matchlen > bmatchlen) -+ if (matchlen > bmatchlen) { -+ dst_release(bdst); - continue; -+ } - - if (!IS_ERR_OR_NULL(dst)) - dst_release(dst); -diff --git a/net/sctp/protocol.c b/net/sctp/protocol.c -index fcd80feb293f..df22a9c352ad 100644 ---- a/net/sctp/protocol.c -+++ b/net/sctp/protocol.c -@@ -514,22 +514,20 @@ static void sctp_v4_get_dst(struct sctp_transport *t, union sctp_addr *saddr, - if (IS_ERR(rt)) - continue; - -- if (!dst) -- dst = &rt->dst; -- - /* Ensure the src address belongs to the output - * interface. - */ - odev = __ip_dev_find(sock_net(sk), laddr->a.v4.sin_addr.s_addr, - false); - if (!odev || odev->ifindex != fl4->flowi4_oif) { -- if (&rt->dst != dst) -+ if (!dst) -+ dst = &rt->dst; -+ else - dst_release(&rt->dst); - continue; - } - -- if (dst != &rt->dst) -- dst_release(dst); -+ dst_release(dst); - dst = &rt->dst; - break; - } -diff --git a/net/sctp/sm_make_chunk.c b/net/sctp/sm_make_chunk.c -index 514465b03829..e4a400f88168 100644 ---- a/net/sctp/sm_make_chunk.c -+++ b/net/sctp/sm_make_chunk.c -@@ -1378,9 +1378,14 @@ static struct sctp_chunk *_sctp_make_chunk(const struct sctp_association *asoc, - struct sctp_chunk *retval; - struct sk_buff *skb; - struct sock *sk; -+ int chunklen; -+ -+ chunklen = SCTP_PAD4(sizeof(*chunk_hdr) + paylen); -+ if (chunklen > SCTP_MAX_CHUNK_LEN) -+ goto nodata; - - /* No need to allocate LL here, as this is only a chunk. */ -- skb = alloc_skb(SCTP_PAD4(sizeof(*chunk_hdr) + paylen), gfp); -+ skb = alloc_skb(chunklen, gfp); - if (!skb) - goto nodata; - -diff --git a/sound/core/control.c b/sound/core/control.c -index 56b3e2d49c82..af7e6165e21e 100644 ---- a/sound/core/control.c -+++ b/sound/core/control.c -@@ -888,7 +888,7 @@ static int snd_ctl_elem_read(struct snd_card *card, - - index_offset = snd_ctl_get_ioff(kctl, &control->id); - vd = &kctl->vd[index_offset]; -- if (!(vd->access & SNDRV_CTL_ELEM_ACCESS_READ) && kctl->get == NULL) -+ if (!(vd->access & SNDRV_CTL_ELEM_ACCESS_READ) || kctl->get == NULL) - return -EPERM; - - snd_ctl_build_ioff(&control->id, kctl, index_offset); -diff --git a/sound/pci/hda/hda_intel.c b/sound/pci/hda/hda_intel.c -index c71dcacea807..96143df19b21 100644 ---- a/sound/pci/hda/hda_intel.c -+++ b/sound/pci/hda/hda_intel.c -@@ -181,7 +181,7 @@ static const struct kernel_param_ops param_ops_xint = { - }; - #define param_check_xint param_check_int - --static int power_save = CONFIG_SND_HDA_POWER_SAVE_DEFAULT; -+static int power_save = -1; - module_param(power_save, xint, 0644); - MODULE_PARM_DESC(power_save, "Automatic power-saving timeout " - "(in second, 0 = disable)."); -@@ -2186,6 +2186,24 @@ static int azx_probe(struct pci_dev *pci, - return err; - } - -+#ifdef CONFIG_PM -+/* On some boards setting power_save to a non 0 value leads to clicking / -+ * popping sounds when ever we enter/leave powersaving mode. Ideally we would -+ * figure out how to avoid these sounds, but that is not always feasible. -+ * So we keep a list of devices where we disable powersaving as its known -+ * to causes problems on these devices. -+ */ -+static struct snd_pci_quirk power_save_blacklist[] = { -+ /* https://bugzilla.redhat.com/show_bug.cgi?id=1525104 */ -+ SND_PCI_QUIRK(0x1849, 0x0c0c, "Asrock B85M-ITX", 0), -+ /* https://bugzilla.redhat.com/show_bug.cgi?id=1525104 */ -+ SND_PCI_QUIRK(0x1043, 0x8733, "Asus Prime X370-Pro", 0), -+ /* https://bugzilla.kernel.org/show_bug.cgi?id=198611 */ -+ SND_PCI_QUIRK(0x17aa, 0x2227, "Lenovo X1 Carbon 3rd Gen", 0), -+ {} -+}; -+#endif /* CONFIG_PM */ -+ - /* number of codec slots for each chipset: 0 = default slots (i.e. 4) */ - static unsigned int azx_max_codecs[AZX_NUM_DRIVERS] = { - [AZX_DRIVER_NVIDIA] = 8, -@@ -2198,6 +2216,7 @@ static int azx_probe_continue(struct azx *chip) - struct hdac_bus *bus = azx_bus(chip); - struct pci_dev *pci = chip->pci; - int dev = chip->dev_index; -+ int val; - int err; - - hda->probe_continued = 1; -@@ -2278,7 +2297,22 @@ static int azx_probe_continue(struct azx *chip) - - chip->running = 1; - azx_add_card_list(chip); -- snd_hda_set_power_save(&chip->bus, power_save * 1000); -+ -+ val = power_save; -+#ifdef CONFIG_PM -+ if (val == -1) { -+ const struct snd_pci_quirk *q; -+ -+ val = CONFIG_SND_HDA_POWER_SAVE_DEFAULT; -+ q = snd_pci_quirk_lookup(chip->pci, power_save_blacklist); -+ if (q && val) { -+ dev_info(chip->card->dev, "device %04x:%04x is on the power_save blacklist, forcing power_save to 0\n", -+ q->subvendor, q->subdevice); -+ val = 0; -+ } -+ } -+#endif /* CONFIG_PM */ -+ snd_hda_set_power_save(&chip->bus, val * 1000); - if (azx_has_pm_runtime(chip) || hda->use_vga_switcheroo) - pm_runtime_put_autosuspend(&pci->dev); - -diff --git a/sound/pci/hda/patch_realtek.c b/sound/pci/hda/patch_realtek.c -index b7acffdf16a4..454476b47b79 100644 ---- a/sound/pci/hda/patch_realtek.c -+++ b/sound/pci/hda/patch_realtek.c -@@ -4852,13 +4852,14 @@ static void alc_fixup_tpt470_dock(struct hda_codec *codec, - - if (action == HDA_FIXUP_ACT_PRE_PROBE) { - spec->parse_flags = HDA_PINCFG_NO_HP_FIXUP; -+ snd_hda_apply_pincfgs(codec, pincfgs); -+ } else if (action == HDA_FIXUP_ACT_INIT) { - /* Enable DOCK device */ - snd_hda_codec_write(codec, 0x17, 0, - AC_VERB_SET_CONFIG_DEFAULT_BYTES_3, 0); - /* Enable DOCK device */ - snd_hda_codec_write(codec, 0x19, 0, - AC_VERB_SET_CONFIG_DEFAULT_BYTES_3, 0); -- snd_hda_apply_pincfgs(codec, pincfgs); - } - } - -diff --git a/sound/usb/quirks-table.h b/sound/usb/quirks-table.h -index 8a59d4782a0f..69bf5cf1e91e 100644 ---- a/sound/usb/quirks-table.h -+++ b/sound/usb/quirks-table.h -@@ -3277,4 +3277,51 @@ AU0828_DEVICE(0x2040, 0x7270, "Hauppauge", "HVR-950Q"), - } - }, - -+{ -+ /* -+ * Bower's & Wilkins PX headphones only support the 48 kHz sample rate -+ * even though it advertises more. The capture interface doesn't work -+ * even on windows. -+ */ -+ USB_DEVICE(0x19b5, 0x0021), -+ .driver_info = (unsigned long) &(const struct snd_usb_audio_quirk) { -+ .ifnum = QUIRK_ANY_INTERFACE, -+ .type = QUIRK_COMPOSITE, -+ .data = (const struct snd_usb_audio_quirk[]) { -+ { -+ .ifnum = 0, -+ .type = QUIRK_AUDIO_STANDARD_MIXER, -+ }, -+ /* Capture */ -+ { -+ .ifnum = 1, -+ .type = QUIRK_IGNORE_INTERFACE, -+ }, -+ /* Playback */ -+ { -+ .ifnum = 2, -+ .type = QUIRK_AUDIO_FIXED_ENDPOINT, -+ .data = &(const struct audioformat) { -+ .formats = SNDRV_PCM_FMTBIT_S16_LE, -+ .channels = 2, -+ .iface = 2, -+ .altsetting = 1, -+ .altset_idx = 1, -+ .attributes = UAC_EP_CS_ATTR_FILL_MAX | -+ UAC_EP_CS_ATTR_SAMPLE_RATE, -+ .endpoint = 0x03, -+ .ep_attr = USB_ENDPOINT_XFER_ISOC, -+ .rates = SNDRV_PCM_RATE_48000, -+ .rate_min = 48000, -+ .rate_max = 48000, -+ .nr_rates = 1, -+ .rate_table = (unsigned int[]) { -+ 48000 -+ } -+ } -+ }, -+ } -+ } -+}, -+ - #undef USB_DEVICE_VENDOR_SPEC -diff --git a/sound/x86/intel_hdmi_audio.c b/sound/x86/intel_hdmi_audio.c -index a0951505c7f5..697872d8308e 100644 ---- a/sound/x86/intel_hdmi_audio.c -+++ b/sound/x86/intel_hdmi_audio.c -@@ -1827,6 +1827,8 @@ static int hdmi_lpe_audio_probe(struct platform_device *pdev) - ctx->port = port; - ctx->pipe = -1; - -+ spin_lock_init(&ctx->had_spinlock); -+ mutex_init(&ctx->mutex); - INIT_WORK(&ctx->hdmi_audio_wq, had_audio_wq); - - ret = snd_pcm_new(card, INTEL_HAD, port, MAX_PB_STREAMS, -diff --git a/virt/kvm/kvm_main.c b/virt/kvm/kvm_main.c -index 8401774f5aeb..d81af263f50b 100644 ---- a/virt/kvm/kvm_main.c -+++ b/virt/kvm/kvm_main.c -@@ -975,8 +975,7 @@ int __kvm_set_memory_region(struct kvm *kvm, - /* Check for overlaps */ - r = -EEXIST; - kvm_for_each_memslot(slot, __kvm_memslots(kvm, as_id)) { -- if ((slot->id >= KVM_USER_MEM_SLOTS) || -- (slot->id == id)) -+ if (slot->id == id) - continue; - if (!((base_gfn + npages <= slot->base_gfn) || - (base_gfn >= slot->base_gfn + slot->npages))) diff --git a/kernel/kernel/files/patches/mageia/pci-add-ALI-M5229-ide-compatibility-mode-quirk.patch b/kernel/kernel/files/patches/mageia/pci-add-ALI-M5229-ide-compatibility-mode-quirk.patch deleted file mode 100644 index 47e1a2f5..00000000 --- a/kernel/kernel/files/patches/mageia/pci-add-ALI-M5229-ide-compatibility-mode-quirk.patch +++ /dev/null @@ -1,60 +0,0 @@ -PCI: Add ALI M5229 comaptibility mode quirk - -The libata driver will not work with an M5229 set into native IDE -mode (the old drivers/pci one does) if the M5229 does not provide -it's own IRQ. - -The M5229 implementation embedded into the ALI M1543 uses the -M1543's ISA PIC to provide the interrupts and thus does not have -an valid PCI IRQ set. This quirk detects the abscence of IRQ and -sets the M5229 back into compatibility mode to use IRQs 14 and 15 -so that libata works correctly. - -Note, I belive that the check for an valid interrupt line is -correct, I only have an M5229 in an ALI M1543 to check this -on. It would be useful to confirm that a M5229 with an valid IRQ -does not trigger this quirk. - -Signed-off-by: Ben Dooks - ---- - drivers/pci/quirks.c | 28 ++++++++++++++++++++++++++++ - 1 file changed, 28 insertions(+) - ---- a/drivers/pci/quirks.c -+++ b/drivers/pci/quirks.c -@@ -964,6 +964,34 @@ static void __devinit quirk_svwks_csb5id - } - DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SERVERWORKS, PCI_DEVICE_ID_SERVERWORKS_CSB5IDE, quirk_svwks_csb5ide); - -+/* Some systems set the ALI M5229 in the ALI M1543 bridge to native mode, -+ * which cannot be supported by the pata_ali.c driver (the old drivers/ide -+ * makes a compatibility effort to change the IDE interrupts). -+ */ -+static void __devinit quirk_ali_ide_compatibility(struct pci_dev *pdev) -+{ -+ u8 tmp; -+ -+ /* pdev->irq and pdev->pin have yet to be initialised, so check -+ * by reading from the configuration header to see if we've got -+ * a valid interrupt line. */ -+ -+ pci_read_config_byte(pdev, PCI_INTERRUPT_LINE, &tmp); -+ if (tmp != 0xff) -+ return; -+ -+ pci_read_config_byte(pdev, PCI_CLASS_PROG, &tmp); -+ if (tmp & 0x5) { -+ dev_info(&pdev->dev, "quirk: changing to IDE compatibility mode\n"); -+ -+ tmp &= ~0x05; -+ pdev->class &= ~0x05; -+ pci_write_config_byte(pdev, PCI_CLASS_PROG, tmp); -+ } -+} -+ -+DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M5229, quirk_ali_ide_compatibility); -+ - /* - * Intel 82801CAM ICH3-M datasheet says IDE modes must be the same - */ diff --git a/kernel/kernel/files/patches/mageia/pci-quirks-drop-devinit-exit.patch b/kernel/kernel/files/patches/mageia/pci-quirks-drop-devinit-exit.patch deleted file mode 100644 index c8eeeda0..00000000 --- a/kernel/kernel/files/patches/mageia/pci-quirks-drop-devinit-exit.patch +++ /dev/null @@ -1,11 +0,0 @@ ---- ./drivers/pci/quirks.c.orig 2013-01-16 18:13:57.000000000 +0200 -+++ ./drivers/pci/quirks.c 2013-01-16 18:42:24.331008402 +0200 -@@ -1083,7 +1083,7 @@ DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_SE - * which cannot be supported by the pata_ali.c driver (the old drivers/ide - * makes a compatibility effort to change the IDE interrupts). - */ --static void __devinit quirk_ali_ide_compatibility(struct pci_dev *pdev) -+static void quirk_ali_ide_compatibility(struct pci_dev *pdev) - { - u8 tmp; - diff --git a/kernel/kernel/files/patches/mageia/platform-x86-add-shuttle-wmi-driver.patch b/kernel/kernel/files/patches/mageia/platform-x86-add-shuttle-wmi-driver.patch deleted file mode 100644 index 15510c45..00000000 --- a/kernel/kernel/files/patches/mageia/platform-x86-add-shuttle-wmi-driver.patch +++ /dev/null @@ -1,1437 +0,0 @@ - - Documentation/ABI/testing/sysfs-platform-shuttle-wmi | 72 + - MAINTAINERS | 6 - drivers/platform/x86/Kconfig | 15 - drivers/platform/x86/Makefile | 1 - drivers/platform/x86/shuttle-wmi.c | 1297 +++++++++++++++++++ - 5 files changed, 1391 insertions(+) - -diff -Nurp linux-3.14.2/Documentation/ABI/testing/sysfs-platform-shuttle-wmi linux-3.14.2-shuttle/Documentation/ABI/testing/sysfs-platform-shuttle-wmi ---- linux-3.14.2/Documentation/ABI/testing/sysfs-platform-shuttle-wmi 1970-01-01 02:00:00.000000000 +0200 -+++ linux-3.14.2-shuttle/Documentation/ABI/testing/sysfs-platform-shuttle-wmi 2014-04-26 18:33:26.867761088 +0300 -@@ -0,0 +1,72 @@ -+What: /sys/devices/platform/shuttle_wmi/lcd_auto_adjust -+Date: December 2010 -+KernelVersion: 2.6.36 -+Contact: "Herton Ronaldo Krzesinski" -+Description: -+ This is a write only option (accepts any single value, eg. -+ "echo 1 > lcd_auto_adjust") that starts LCD auto-adjust -+ function, if the machine has this function enabled. Some -+ shuttle machines have LCD attached to analog VGA connector, -+ so uses/needs auto-adjust. -+ -+What: /sys/devices/platform/shuttle_wmi/model_name -+Date: December 2010 -+KernelVersion: 2.6.36 -+Contact: "Herton Ronaldo Krzesinski" -+Description: -+ This is a read only attribute which outputs a string with model -+ name of the machine. When shuttle-wmi can't determine which -+ model it is, "Unknown" is returned. Otherwise, the possible -+ models are "Shuttle MA", "Shuttle DA18IE", "Shuttle DA18IM", -+ "Shuttle X50 V2", "Positivo A14IE01", "Positivo P13", -+ "Positivo P14". -+ -+What: /sys/devices/platform/shuttle_wmi/panel_set_default -+Date: December 2010 -+KernelVersion: 2.6.36 -+Contact: "Herton Ronaldo Krzesinski" -+Description: -+ This is a write only option (accepts any single value, eg. -+ "echo 1 > panel_set_default"). Probably resets panel/lcd to -+ default configuration, function not explained in shuttle wmi -+ documentation. It also starts an auto adjust and color adjust -+ cycle. The function should only work in shuttle machines with -+ LCD attached to an analog VGA connector. -+ -+What: /sys/devices/platform/shuttle_wmi/powersave -+Date: December 2010 -+KernelVersion: 2.6.36 -+Contact: "Herton Ronaldo Krzesinski" -+Description: -+ Control powersave state. 1 means on, 0 means off. -+ When enabled, it basically forces the cpu to stay on powersave -+ state (only works if cpu has P-states support, it is similar to -+ powersave governor in cpufreq) when machine is only running on -+ battery. If not running on battery, this function isn't expected -+ to work, any attempt to enable this returns -EIO. -+ -+What: /sys/devices/platform/shuttle_wmi/touchpad_off -+Date: December 2010 -+KernelVersion: 2.6.36 -+Contact: "Herton Ronaldo Krzesinski" -+Description: -+ Control touchpad state. 1 means off, 0 means on. -+ -+What: /sys/devices/platform/shuttle_wmi/webcam -+Date: December 2010 -+KernelVersion: 2.6.36 -+Contact: "Herton Ronaldo Krzesinski" -+Description: -+ Control webcam state. 1 means on, 0 means off. -+ -+What: /sys/devices/platform/shuttle_wmi/white_balance -+Date: December 2010 -+KernelVersion: 2.6.36 -+Contact: "Herton Ronaldo Krzesinski" -+Description: -+ This is a write only option (accepts any single value, eg. -+ "echo 1 > white_balance"). Probably triggers an automatic -+ white balance adjustment for lcd, function not explained in -+ shuttle wmi documentation. It also starts an auto adjust and -+ color adjust cycle. The function should only work in shuttle -+ machines with LCD attached to an analog VGA connector. -diff -Nurp linux-3.14.2/drivers/platform/x86/Kconfig linux-3.14.2-shuttle/drivers/platform/x86/Kconfig ---- linux-3.14.2/drivers/platform/x86/Kconfig 2014-03-31 06:40:15.000000000 +0300 -+++ linux-3.14.2-shuttle/drivers/platform/x86/Kconfig 2014-04-26 18:33:26.867761088 +0300 -@@ -811,6 +811,21 @@ config INTEL_SMARTCONNECT - This driver checks to determine whether the device has Intel Smart - Connect enabled, and if so disables it. - -+config SHUTTLE_WMI -+ tristate "Shuttle WMI Extras Driver" -+ depends on ACPI_WMI -+ depends on BACKLIGHT_CLASS_DEVICE -+ depends on RFKILL -+ depends on INPUT -+ select INPUT_SPARSEKMAP -+ ---help--- -+ This is a driver for the WMI interface present on some Shuttle -+ machines. It adds controls for wireless, bluetooth and 3g radios, -+ webcam switch, backlight controls, among others. -+ -+ If you have a Shuttle machine with ACPI-WMI interface say Y or M -+ here. -+ - config PVPANIC - tristate "pvpanic device support" - depends on ACPI -diff -Nurp linux-3.14.2/drivers/platform/x86/Makefile linux-3.14.2-shuttle/drivers/platform/x86/Makefile ---- linux-3.15/drivers/platform/x86/Makefile -+++ linux-3.15-shuttle/drivers/platform/x86/Makefile -@@ -53,6 +53,7 @@ obj-$(CONFIG_SAMSUNG_Q10) += samsung-q10 - obj-$(CONFIG_APPLE_GMUX) += apple-gmux.o - obj-$(CONFIG_INTEL_RST) += intel-rst.o - obj-$(CONFIG_INTEL_SMARTCONNECT) += intel-smartconnect.o -+obj-$(CONFIG_SHUTTLE_WMI) += shuttle-wmi.o - - obj-$(CONFIG_PVPANIC) += pvpanic.o - obj-$(CONFIG_ALIENWARE_WMI) += alienware-wmi.o -diff -Nurp linux-3.14.2/drivers/platform/x86/shuttle-wmi.c linux-3.14.2-shuttle/drivers/platform/x86/shuttle-wmi.c ---- linux-3.14.2/drivers/platform/x86/shuttle-wmi.c 1970-01-01 02:00:00.000000000 +0200 -+++ linux-3.14.2-shuttle/drivers/platform/x86/shuttle-wmi.c 2014-04-26 18:33:26.868761096 +0300 -@@ -0,0 +1,1297 @@ -+/* -+ * ACPI-WMI driver for Shuttle WMI interface -+ * -+ * Copyright (c) 2010 Herton Ronaldo Krzesinski -+ * -+ * Development of this driver was funded by Positivo Informatica S.A. -+ * Parts of the driver were based on some WMI documentation provided by Shuttle -+ * -+ * This program is free software; you can redistribute it and/or modify -+ * it under the terms of the GNU General Public License version 2 as -+ * published by the Free Software Foundation. -+ */ -+ -+#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt -+ -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+#include -+ -+MODULE_AUTHOR("Herton Ronaldo Krzesinski"); -+MODULE_DESCRIPTION("Shuttle WMI Extras Driver"); -+MODULE_LICENSE("GPL"); -+ -+#define SHUTTLE_WMI_SETGET_GUID "abbc0f6f-8ea1-11d1-00a0-c90629100000" -+#define SHUTTLE_WMI_EVENT_GUID "abbc0f72-8ea1-11d1-00a0-c90629100000" -+MODULE_ALIAS("wmi:"SHUTTLE_WMI_SETGET_GUID); -+MODULE_ALIAS("wmi:"SHUTTLE_WMI_EVENT_GUID); -+ -+#define CMD_WRITEEC 0x00 -+#define CMD_READEC 0x01 -+#define CMD_SCMD 0x02 -+#define CMD_INT15 0x03 -+#define CMD_HWSW 0x07 -+#define CMD_LCTRL 0x09 -+#define CMD_CUTLVDS 0x11 -+#define CMD_MA 0x18 -+#define CMD_DA18IE 0x19 -+#define CMD_DA18IM 0x20 -+ -+#define ECRAM_ER0 0x443 -+#define ECRAM_ER1 0x45a -+#define ECRAM_ER2 0x47b -+#define ECRAM_ER3 0x758 -+#define ECRAM_ER4 0x759 -+ -+struct shuttle_ecram { -+ unsigned short addr; -+ u32 mask; -+}; -+ -+struct shuttle_state { -+ struct shuttle_ecram ecram; -+ struct device_attribute *dev_attr; -+}; -+ -+static struct shuttle_state state_powersave = { -+ .ecram = { -+ .addr = ECRAM_ER3, -+ .mask = 0x10, -+ }, -+}; -+ -+static struct shuttle_state state_touchpad_off = { -+ .ecram = { -+ .addr = ECRAM_ER2, -+ .mask = 0x02, -+ }, -+}; -+ -+static struct shuttle_state state_webcam = { -+ .ecram = { -+ .addr = ECRAM_ER2, -+ .mask = 0x10, -+ }, -+}; -+ -+struct shuttle_rfkill { -+ struct rfkill *rfk; -+ enum rfkill_type type; -+ struct shuttle_ecram ecram_state; -+ struct shuttle_ecram ecram_present; -+ /* lists of rf state switch notification codes */ -+ u32 rf_on[3]; -+ u32 rf_off[3]; -+}; -+ -+static struct shuttle_rfkill srfk_3g = { -+ .type = RFKILL_TYPE_WWAN, -+ .ecram_state = { -+ .addr = ECRAM_ER2, -+ .mask = 0x40, -+ }, -+ .rf_on = { 0x10, 0x29 }, -+ .rf_off = { 0x11, 0x2a }, -+}; -+ -+static struct shuttle_rfkill srfk_bluetooth = { -+ .type = RFKILL_TYPE_BLUETOOTH, -+ .ecram_state = { -+ .addr = ECRAM_ER2, -+ .mask = 0x20, -+ }, -+ .rf_on = { 0x0c, 0x29 }, -+ .rf_off = { 0x0d, 0x2a }, -+}; -+ -+static struct shuttle_rfkill srfk_wlan = { -+ .type = RFKILL_TYPE_WLAN, -+ .ecram_state = { -+ .addr = ECRAM_ER2, -+ .mask = 0x80, -+ }, -+ .ecram_present = { -+ .addr = ECRAM_ER1, -+ .mask = 0x80, -+ }, -+ .rf_on = { 0x08 }, -+ .rf_off = { 0x09 }, -+}; -+ -+enum fn_type { -+ FN_CMD, -+ FN_CMD_DEBUG, -+ FN_RFKILL, -+ FN_STATE -+}; -+ -+struct shuttle_fn_map { -+ char *name; -+ enum fn_type type; -+ unsigned short cmd; -+ unsigned short arg; -+ unsigned short fn; -+ void *data; -+}; -+ -+static struct shuttle_fn_map unknown_fn_map[] = { -+ { "fn_f1", FN_CMD_DEBUG, CMD_SCMD, 0, 0x01, NULL }, -+ { "fn_f2", FN_CMD_DEBUG, CMD_SCMD, 0, 0x02, NULL }, -+ { "fn_f3", FN_CMD_DEBUG, CMD_SCMD, 0, 0x03, NULL }, -+ { "fn_f4", FN_CMD_DEBUG, CMD_SCMD, 0, 0x04, NULL }, -+ { "fn_f5", FN_CMD_DEBUG, CMD_SCMD, 0, 0x05, NULL }, -+ { "fn_f6", FN_CMD_DEBUG, CMD_SCMD, 0, 0x06, NULL }, -+ { "fn_f7", FN_CMD_DEBUG, CMD_SCMD, 0, 0x07, NULL }, -+ { "fn_f8", FN_CMD_DEBUG, CMD_SCMD, 0, 0x08, NULL }, -+ { "fn_f9", FN_CMD_DEBUG, CMD_SCMD, 0, 0x09, NULL }, -+ { "fn_f10", FN_CMD_DEBUG, CMD_SCMD, 0, 0x0a, NULL }, -+ { "fn_f11", FN_CMD_DEBUG, CMD_SCMD, 0, 0x0b, NULL }, -+ { "fn_f12", FN_CMD_DEBUG, CMD_SCMD, 0, 0x0c, NULL }, -+ { "fn_f13", FN_CMD_DEBUG, CMD_SCMD, 0, 0x0d, NULL }, -+ { "fn_f14", FN_CMD_DEBUG, CMD_SCMD, 0, 0x0e, NULL }, -+ { "fn_f15", FN_CMD_DEBUG, CMD_SCMD, 0, 0x0f, NULL }, -+ { "lcd_auto_adjust", FN_CMD, CMD_SCMD, 0, 0x81, NULL }, -+ { "lightbar_brightness_down", FN_CMD_DEBUG, CMD_LCTRL, 1, 0x00, NULL }, -+ { "lightbar_brightness_up", FN_CMD_DEBUG, CMD_LCTRL, 1, 0x01, NULL }, -+ { "panel_set_default", FN_CMD, CMD_SCMD, 0, 0x83, NULL }, -+ { "video_output_on", FN_CMD_DEBUG, CMD_CUTLVDS, 0, 0x01, NULL}, -+ { "video_output_off", FN_CMD_DEBUG, CMD_CUTLVDS, 0, 0x00, NULL}, -+ { "white_balance", FN_CMD, CMD_SCMD, 0, 0x82, NULL }, -+ { } -+}; -+ -+static struct shuttle_fn_map fn_map_1[] = { -+ { "brightness_down", FN_CMD_DEBUG, CMD_SCMD, 0, 0x0b, NULL }, -+ { "brightness_up", FN_CMD_DEBUG, CMD_SCMD, 0, 0x0c, NULL }, -+ { "lcd_auto_adjust", FN_CMD, CMD_SCMD, 0, 0x81, NULL }, -+ { "lightbar_brightness_down", FN_CMD_DEBUG, CMD_LCTRL, 1, 0x00, NULL }, -+ { "lightbar_brightness_up", FN_CMD_DEBUG, CMD_LCTRL, 1, 0x01, NULL }, -+ { "panel_set_default", FN_CMD, CMD_SCMD, 0, 0x83, NULL }, -+ { "powersave", FN_STATE, CMD_SCMD, 0, 0x02, &state_powersave }, -+ { "shuttle_3g", FN_RFKILL, CMD_SCMD, 0, 0x05, &srfk_3g }, -+ { "shuttle_bluetooth", FN_RFKILL, CMD_SCMD, 0, 0x0d, &srfk_bluetooth }, -+ { "shuttle_wlan", FN_RFKILL, CMD_SCMD, 0, 0x04, &srfk_wlan }, -+ { "sleep", FN_CMD_DEBUG, CMD_SCMD, 0, 0x01, NULL }, -+ { "sound_mute", FN_CMD_DEBUG, CMD_SCMD, 0, 0x08, NULL }, -+ { "switch_video", FN_CMD_DEBUG, CMD_SCMD, 0, 0x03, NULL }, -+ { "touchpad_off", FN_STATE, CMD_SCMD, 0, 0x06, &state_touchpad_off }, -+ { "volume_down", FN_CMD_DEBUG, CMD_SCMD, 0, 0x09, NULL }, -+ { "volume_up", FN_CMD_DEBUG, CMD_SCMD, 0, 0x0a, NULL }, -+ { "video_output_on", FN_CMD_DEBUG, CMD_CUTLVDS, 0, 0x01, NULL}, -+ { "video_output_off", FN_CMD_DEBUG, CMD_CUTLVDS, 0, 0x00, NULL}, -+ { "webcam", FN_STATE, CMD_SCMD, 0, 0x07, &state_webcam }, -+ { "white_balance", FN_CMD, CMD_SCMD, 0, 0x82, NULL }, -+ { } -+}; -+ -+static struct shuttle_fn_map fn_map_2[] = { -+ { "brightness_down", FN_CMD_DEBUG, CMD_SCMD, 0, 0x08, NULL }, -+ { "brightness_up", FN_CMD_DEBUG, CMD_SCMD, 0, 0x09, NULL }, -+ { "video_output", FN_CMD_DEBUG, CMD_SCMD, 0, 0x02, NULL }, -+ { "video_output_on", FN_CMD_DEBUG, CMD_CUTLVDS, 0, 0x01, NULL}, -+ { "video_output_off", FN_CMD_DEBUG, CMD_CUTLVDS, 0, 0x00, NULL}, -+ { "shuttle_wlan", FN_RFKILL, CMD_SCMD, 0, 0x0b, &srfk_wlan }, -+ { "sleep", FN_CMD_DEBUG, CMD_SCMD, 0, 0x03, NULL }, -+ { "sound_mute", FN_CMD_DEBUG, CMD_SCMD, 0, 0x04, NULL }, -+ { "switch_video", FN_CMD_DEBUG, CMD_SCMD, 0, 0x07, NULL }, -+ { "touchpad_off", FN_STATE, CMD_SCMD, 0, 0x01, &state_touchpad_off }, -+ { "volume_down", FN_CMD_DEBUG, CMD_SCMD, 0, 0x05, NULL }, -+ { "volume_up", FN_CMD_DEBUG, CMD_SCMD, 0, 0x06, NULL }, -+ { "webcam", FN_STATE, CMD_SCMD, 0, 0x0a, &state_webcam }, -+ { } -+}; -+ -+struct shuttle_backlight { -+ u8 ec_addr; -+ struct shuttle_fn_map *fn_bl_down; -+ struct shuttle_fn_map *fn_bl_up; -+}; -+ -+static struct shuttle_backlight common_bl_desc = { -+ .ec_addr = 0x79, -+}; -+ -+static struct shuttle_backlight quirk_bl_desc = { -+ .ec_addr = 0x79, -+ .fn_bl_down = &fn_map_1[0], -+ .fn_bl_up = &fn_map_1[1], -+}; -+ -+struct shuttle_id { -+ unsigned char cmd_id; -+ const char *model_name; -+ struct shuttle_backlight *bl_desc; -+ struct shuttle_fn_map *fn_map; -+}; -+ -+static struct shuttle_id shuttle_ids[] = { -+ { CMD_MA, "Shuttle MA", &common_bl_desc, fn_map_1 }, -+ { CMD_DA18IE, "Shuttle DA18IE", &quirk_bl_desc, fn_map_1 }, -+ { CMD_DA18IM, "Shuttle DA18IM", &common_bl_desc, fn_map_1 } -+}; -+ -+static struct shuttle_id id_unknown = { -+ .model_name = "Unknown", -+ .fn_map = unknown_fn_map, -+}; -+ -+static struct shuttle_id shuttle_dmi_id; -+ -+static int shuttle_dmi_matched(const struct dmi_system_id *dmi) -+{ -+ shuttle_dmi_id.model_name = dmi->ident; -+ shuttle_dmi_id.bl_desc = &common_bl_desc; -+ shuttle_dmi_id.fn_map = dmi->driver_data; -+ return 1; -+} -+ -+static struct dmi_system_id shuttle_dmi_ids[] = { -+ { -+ .callback = shuttle_dmi_matched, -+ .ident = "Shuttle X50 V2", -+ .matches = { -+ DMI_MATCH(DMI_PRODUCT_NAME, "X50-V2"), -+ }, -+ .driver_data = fn_map_1, -+ }, -+ { -+ .callback = shuttle_dmi_matched, -+ .ident = "Positivo A14IE01", -+ .matches = { -+ DMI_MATCH(DMI_BOARD_VENDOR, "POSITIVO"), -+ DMI_MATCH(DMI_BOARD_NAME, "A14IE01"), -+ }, -+ .driver_data = fn_map_2, -+ }, -+ { -+ .callback = shuttle_dmi_matched, -+ .ident = "Positivo P13", -+ .matches = { -+ DMI_MATCH(DMI_BOARD_VENDOR, "POSITIVO"), -+ DMI_MATCH(DMI_BOARD_NAME, "P13"), -+ }, -+ .driver_data = fn_map_2, -+ }, -+ { -+ .callback = shuttle_dmi_matched, -+ .ident = "Positivo P14", -+ .matches = { -+ DMI_MATCH(DMI_BOARD_VENDOR, "POSITIVO"), -+ DMI_MATCH(DMI_BOARD_NAME, "P14"), -+ }, -+ .driver_data = fn_map_2, -+ }, -+ {} -+}; -+ -+static struct dmi_system_id __devinitdata shuttle_quirk_bl_dmi_ids[] = { -+ { -+ .ident = "Positivo M13", -+ .matches = { -+ DMI_MATCH(DMI_BOARD_VENDOR, "POSITIVO"), -+ DMI_MATCH(DMI_BOARD_NAME, "M13"), -+ }, -+ }, -+ { -+ .ident = "Positivo M14", -+ .matches = { -+ DMI_MATCH(DMI_BOARD_VENDOR, "POSITIVO"), -+ DMI_MATCH(DMI_BOARD_NAME, "M14"), -+ }, -+ }, -+ { -+ .ident = "Positivo A14IM01", -+ .matches = { -+ DMI_MATCH(DMI_BOARD_VENDOR, "POSITIVO"), -+ DMI_MATCH(DMI_BOARD_NAME, "A14IM01"), -+ }, -+ }, -+ { -+ .ident = "Positivo J14IM21", -+ .matches = { -+ DMI_MATCH(DMI_BOARD_VENDOR, "POSITIVO"), -+ DMI_MATCH(DMI_BOARD_NAME, "J14IM21"), -+ }, -+ }, -+ {} -+}; -+ -+struct shuttle_wmi { -+ struct platform_device *pdev; -+ struct shuttle_id *id; -+ struct dentry *dbg_root; -+ struct attribute_group *attr_group; -+ struct input_dev *inputdev; -+ struct backlight_device *bd; -+}; -+ -+struct shuttle_cmd { -+ u16 param2; -+ u16 param1; -+ u8 arg; -+ u8 cmd; -+ u16 hdr; -+}; -+ -+static int wmi_setget_mtd(struct shuttle_cmd *scmd, u32 *res) -+{ -+ acpi_status status; -+ union acpi_object *obj; -+ struct acpi_buffer input; -+ static DEFINE_MUTEX(mtd_lock); -+ struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL }; -+ -+ input.length = sizeof(struct shuttle_cmd); -+ scmd->hdr = 0xec00; -+ input.pointer = (u8 *) scmd; -+ -+ /* We must serialize access to wmi_evaluate_method: the wmi interface -+ * functions in the bios save its parameters on a common shared buffer, -+ * which gets overwritten on parallel calls with unpredicted results; -+ * AML code doesn't have any locking, so we must do this here */ -+ mutex_lock(&mtd_lock); -+ status = wmi_evaluate_method(SHUTTLE_WMI_SETGET_GUID, 0, 2, -+ &input, &output); -+ mutex_unlock(&mtd_lock); -+ if (ACPI_FAILURE(status)) -+ return -1; -+ -+ obj = output.pointer; -+ if (obj) { -+ if (obj->type == ACPI_TYPE_INTEGER) { -+ if (res) -+ *res = obj->integer.value; -+ } else { -+ pr_err("Unsupported object returned (%s)", __func__); -+ res = NULL; -+ } -+ kfree(obj); -+ } else { -+ if (res) { -+ pr_warning("No result from WMI method (%s)", __func__); -+ res = NULL; -+ } -+ } -+ -+ return (res) ? 0 : 1; -+} -+ -+static int wmi_ec_cmd(unsigned char cmd, unsigned char arg, -+ unsigned short param1, unsigned short param2, -+ u32 *res) -+{ -+ struct shuttle_cmd scmd = { -+ .cmd = cmd, -+ .arg = arg, -+ .param1 = param1, -+ .param2 = param2 -+ }; -+ -+ return wmi_setget_mtd(&scmd, res); -+} -+ -+static int wmi_ec_state(struct shuttle_ecram *ecram) -+{ -+ u32 val; -+ -+ if (wmi_ec_cmd(CMD_READEC, 0, 0, ecram->addr, &val)) -+ return -EIO; -+ return (val & ecram->mask) ? 1 : 0; -+} -+ -+static int rfkill_common_set_block(void *data, bool blocked) -+{ -+ int sw; -+ struct shuttle_fn_map *fn_map = data; -+ struct shuttle_rfkill *srfk = fn_map->data; -+ -+ sw = wmi_ec_state(&srfk->ecram_state); -+ if (sw < 0) -+ return sw; -+ -+ if (blocked == sw) -+ wmi_ec_cmd(fn_map->cmd, fn_map->arg, 0, fn_map->fn, NULL); -+ else -+ return 0; -+ -+ sw = wmi_ec_state(&srfk->ecram_state); -+ if (sw < 0) -+ return sw; -+ -+ return (sw != blocked) ? 0 : -EIO; -+} -+ -+static const struct rfkill_ops rfkill_common_ops = { -+ .set_block = rfkill_common_set_block, -+}; -+ -+static void pr_possible_dev_state(void) -+{ -+ static bool pr; -+ u32 val; -+ -+ if (!pr) { -+ pr = true; -+ pr_info("need to unblock some rfkills to check device" -+ " presence\n"); -+ if (!wmi_ec_cmd(CMD_READEC, 0, 0, ECRAM_ER1, &val)) -+ pr_info("possible device present state at address" -+ " 0x%04x is 0x%08x\n", ECRAM_ER1, val); -+ } -+} -+ -+static int shuttle_rfkill_init(struct shuttle_fn_map *fn_map, -+ struct device *dev) -+{ -+ int rc; -+ struct shuttle_rfkill *srfk = fn_map->data; -+ -+ /* Try to detect if device controlled by this rfkill is present, to -+ * avoid having an rfkill switch when not needed */ -+ if (srfk->ecram_present.mask && srfk->ecram_present.addr) { -+ /* we have an address to read to check if device is present */ -+ rc = wmi_ec_state(&srfk->ecram_present); -+ if (rc <= 0) -+ return rc; -+ -+ rc = wmi_ec_state(&srfk->ecram_state); -+ if (rc < 0) -+ return rc; -+ } else { -+ /* print only once the possible value of devices presence, for -+ * extra information (useful to check if really device presence -+ * is or isn't available at usual ECRAM_ER1 address) */ -+ pr_possible_dev_state(); -+ -+ /* no address/mask to check, detect if device is available by -+ * trying to enable it, in case it's disabled */ -+ rc = wmi_ec_state(&srfk->ecram_state); -+ if (rc < 0) -+ return rc; -+ if (!rc) { -+ if (rfkill_common_set_block(fn_map, false)) -+ return 0; -+ -+ /* after check, reset to initial setting; should be -+ * unlikely this returns with error, but really check if -+ * we could reset to initial blocked setting, otherwise -+ * don't make it a fatal error and assume rfkill not -+ * blocked */ -+ if (rfkill_common_set_block(fn_map, true)) -+ rc = 1; -+ } -+ } -+ -+ srfk->rfk = rfkill_alloc(fn_map->name, dev, srfk->type, -+ &rfkill_common_ops, fn_map); -+ if (!srfk->rfk) -+ return -ENOMEM; -+ -+ rfkill_init_sw_state(srfk->rfk, !rc); -+ -+ rc = rfkill_register(srfk->rfk); -+ if (rc) { -+ rfkill_destroy(srfk->rfk); -+ srfk->rfk = NULL; -+ return rc; -+ } -+ -+ return 0; -+} -+ -+static void shuttle_rfkill_remove(struct shuttle_fn_map *fn_map) -+{ -+ struct shuttle_rfkill *srfk = fn_map->data; -+ -+ if (srfk->rfk) { -+ rfkill_unregister(srfk->rfk); -+ rfkill_destroy(srfk->rfk); -+ srfk->rfk = NULL; -+ } -+} -+ -+static int shuttle_rfkill_resume(struct device *dev) -+{ -+ struct shuttle_fn_map *fn_map; -+ struct shuttle_rfkill *srfk; -+ int rc; -+ struct platform_device *pdev = to_platform_device(dev); -+ struct shuttle_wmi *priv = platform_get_drvdata(pdev); -+ -+ for (fn_map = priv->id->fn_map; fn_map->name; fn_map++) { -+ if (fn_map->type != FN_RFKILL) -+ continue; -+ -+ srfk = fn_map->data; -+ if (srfk->rfk) { -+ rc = wmi_ec_state(&srfk->ecram_state); -+ if (rc < 0) -+ return rc; -+ rfkill_set_sw_state(srfk->rfk, rc); -+ } -+ } -+ return 0; -+} -+ -+static bool set_rfkill_sw(u32 *list, u32 code, struct rfkill *rfk, bool blocked) -+{ -+ while (*list) { -+ if (*list == code) { -+ rfkill_set_sw_state(rfk, blocked); -+ return true; -+ } -+ list++; -+ } -+ return false; -+} -+ -+static bool notify_switch_rfkill(struct shuttle_wmi *priv, u32 code) -+{ -+ struct shuttle_fn_map *fn_map; -+ struct shuttle_rfkill *srfk; -+ struct rfkill *rfk; -+ bool res = false; -+ -+ for (fn_map = priv->id->fn_map; fn_map->name; fn_map++) { -+ if (fn_map->type != FN_RFKILL) -+ continue; -+ -+ srfk = fn_map->data; -+ rfk = srfk->rfk; -+ if (!rfk) -+ continue; -+ -+ /* check if notification code means radio turned on, looking -+ * at list_on array of "on" notification codes for this rfkill; -+ * if code is in this list, we notify rfkill core (set_rfkill_sw -+ * does the check, notification and returns true) and we can -+ * skip to next rfkill on the list (some notification codes are -+ * shared, firmware may want to turn on two radios at same time, -+ * so we must check all rfkills with this code) */ -+ if (set_rfkill_sw(srfk->rf_on, code, rfk, false)) { -+ res = true; -+ continue; -+ } -+ -+ /* same as above, but we check the list_off to see if -+ * notification code means radio turned off */ -+ if (set_rfkill_sw(srfk->rf_off, code, rfk, true)) -+ res = true; -+ } -+ /* if we found that notification code was indeed a radio on/off event, -+ * return true here */ -+ return res; -+} -+ -+static bool notify_switch_attr(struct platform_device *pdev, u32 code) -+{ -+ int i; -+ struct shuttle_switch { -+ u32 switch_on; -+ u32 switch_off; -+ char *sys_attr; -+ }; -+ static const struct shuttle_switch codes[] = { -+ { 0x04, 0x05, "touchpad_off" }, -+ { 0x12, 0x13, "webcam" }, -+ { 0x31, 0x32, "powersave" } -+ }; -+ -+ for (i = 0; i < ARRAY_SIZE(codes); i++) { -+ if (codes[i].switch_on == code || codes[i].switch_off == code) { -+ sysfs_notify(&pdev->dev.kobj, NULL, codes[i].sys_attr); -+ return true; -+ } -+ } -+ return false; -+} -+ -+static void shuttle_wmi_notify(u32 value, void *data) -+{ -+ acpi_status status; -+ union acpi_object *obj; -+ u8 type; -+ u32 code; -+ struct acpi_buffer res = { ACPI_ALLOCATE_BUFFER, NULL }; -+ struct shuttle_wmi *priv = data; -+ -+ status = wmi_get_event_data(value, &res); -+ if (status != AE_OK) { -+ pr_warning("unable to retrieve wmi event status" -+ " (error=0x%x)\n", status); -+ return; -+ } -+ -+ obj = (union acpi_object *) res.pointer; -+ if (!obj) -+ return; -+ if (obj->type != ACPI_TYPE_INTEGER) { -+ pr_info("unknown object returned in wmi event\n"); -+ goto notify_exit; -+ } -+ -+ type = (obj->integer.value >> 24) & 0xFF; -+ switch (type) { -+ case 0: /* OSD/Scancode event */ -+ code = obj->integer.value & 0xFFFFFF; -+ -+ /* update rfkill switches */ -+ if (notify_switch_rfkill(priv, code)) -+ break; -+ -+ /* send notification on state switch attributes */ -+ if (notify_switch_attr(priv->pdev, code)) -+ break; -+ -+ if (priv->bd && (code == 0x14 || code == 0x15)) { -+ backlight_force_update(priv->bd, -+ BACKLIGHT_UPDATE_HOTKEY); -+ break; -+ } -+ -+ if (!sparse_keymap_report_event(priv->inputdev, code, 1, true)) -+ pr_info("unhandled scancode (0x%06x)\n", code); -+ break; -+ case 1: /* Power management event */ -+ /* Events not used. -+ * Possible values for obj->integer.value: -+ * 0x01000000 - silent mode -+ * 0x01010000 - brightness sync */ -+ case 2: /* i-PowerXross event */ -+ /* i-PowerXross is a overclocking feature, not -+ * implemented, there are no further details, possible -+ * values for obj->integer.value in documentation: -+ * 0x02000000 - idle mode -+ * 0x02010000 - action mode -+ * 0x02020000 - entry s3 */ -+ break; -+ case 0xec: /* Lost event */ -+ if (printk_ratelimit()) -+ pr_warning("lost event because of buggy BIOS"); -+ break; -+ default: -+ pr_info("unknown wmi notification type (0x%02x)\n", type); -+ } -+ -+notify_exit: -+ kfree(obj); -+} -+ -+static const struct key_entry shuttle_wmi_keymap[] = { -+ { KE_IGNORE, 0x14, { KEY_BRIGHTNESSUP } }, -+ { KE_IGNORE, 0x15, { KEY_BRIGHTNESSDOWN } }, -+ { KE_KEY, 0x16, { KEY_FASTFORWARD } }, -+ { KE_KEY, 0x17, { KEY_REWIND } }, -+ { KE_KEY, 0x18, { KEY_F13 } }, /* OSD Beep */ -+ { KE_KEY, 0x2b, { KEY_F14 } }, /* OSD menu 1 */ -+ { KE_KEY, 0x2c, { KEY_F15 } }, /* OSD menu 2 */ -+ { KE_KEY, 0x2d, { KEY_F16 } }, /* OSD menu 3 */ -+ { KE_KEY, 0x2e, { KEY_F17 } }, /* OSD menu 4 */ -+ { KE_KEY, 0x33, { KEY_F18 } }, /* Update OSD bar status */ -+ { KE_KEY, 0x90, { KEY_WWW } }, -+ { KE_KEY, 0x95, { KEY_PREVIOUSSONG } }, -+ { KE_KEY, 0xa0, { KEY_PROG1 } }, /* Call OSD software */ -+ { KE_KEY, 0xa1, { KEY_VOLUMEDOWN } }, -+ { KE_KEY, 0xa3, { KEY_MUTE } }, -+ { KE_KEY, 0xb2, { KEY_VOLUMEUP } }, -+ { KE_KEY, 0xb4, { KEY_PLAYPAUSE } }, -+ { KE_KEY, 0xbb, { KEY_STOPCD } }, -+ { KE_KEY, 0xc8, { KEY_MAIL } }, -+ { KE_KEY, 0xcd, { KEY_NEXTSONG } }, -+ { KE_KEY, 0xd0, { KEY_MEDIA } }, -+ -+ /* Known non hotkey events don't handled, that we don't care or -+ * which we must ignore */ -+ { KE_IGNORE, 0x01, }, /* Caps Lock toggled */ -+ { KE_IGNORE, 0x02, }, /* Num Lock toggled */ -+ { KE_IGNORE, 0x03, }, /* Scroll Lock toggled */ -+ { KE_IGNORE, 0x06, }, /* Downclock/Silent on */ -+ { KE_IGNORE, 0x07, }, /* Downclock/Silent off */ -+ { KE_IGNORE, 0x0a, }, /* WiMax on */ -+ { KE_IGNORE, 0x0b, }, /* WiMax off */ -+ { KE_IGNORE, 0x0e, }, /* RF on */ -+ { KE_IGNORE, 0x0f, }, /* RF off */ -+ { KE_IGNORE, 0x1a, }, /* Auto Brightness on */ -+ { KE_IGNORE, 0x1b, }, /* Auto Brightness off */ -+ { KE_IGNORE, 0x1c, }, /* Auto-KB Brightness on */ -+ { KE_IGNORE, 0x1d, }, /* Auto-KB Brightness off */ -+ { KE_IGNORE, 0x1e, }, /* Light Bar Brightness up */ -+ { KE_IGNORE, 0x1f, }, /* Light Bar Brightness down */ -+ { KE_IGNORE, 0x20, }, /* China Telecom AP enable */ -+ { KE_IGNORE, 0x21, }, /* China Mobile AP enable */ -+ { KE_IGNORE, 0x22, }, /* Huawei AP enable */ -+ { KE_IGNORE, 0x23, }, /* Docking in */ -+ { KE_IGNORE, 0x24, }, /* Docking out */ -+ { KE_IGNORE, 0x25, }, /* Device no function */ -+ { KE_IGNORE, 0x26, }, /* i-PowerXross OverClocking */ -+ { KE_IGNORE, 0x27, }, /* i-PowerXross PowerSaving */ -+ { KE_IGNORE, 0x28, }, /* i-PowerXross off */ -+ { KE_IGNORE, 0x2f, }, /* Optimus on */ -+ { KE_IGNORE, 0x30, }, /* Optimus off */ -+ { KE_IGNORE, 0x91, }, /* ICO 2 on */ -+ { KE_IGNORE, 0x92, }, /* ICO 2 off */ -+ -+ { KE_END, 0 } -+}; -+ -+static int shuttle_wmi_input_init(struct shuttle_wmi *priv) -+{ -+ struct input_dev *input; -+ int rc; -+ -+ input = input_allocate_device(); -+ if (!input) -+ return -ENOMEM; -+ -+ input->name = "Shuttle WMI hotkeys"; -+ input->phys = KBUILD_MODNAME "/input0"; -+ input->id.bustype = BUS_HOST; -+ -+ rc = sparse_keymap_setup(input, shuttle_wmi_keymap, NULL); -+ if (rc) -+ goto err_free_dev; -+ -+ rc = input_register_device(input); -+ if (rc) -+ goto err_free_keymap; -+ -+ priv->inputdev = input; -+ return 0; -+ -+err_free_keymap: -+ sparse_keymap_free(input); -+err_free_dev: -+ input_free_device(input); -+ return rc; -+} -+ -+static void shuttle_wmi_input_remove(struct shuttle_wmi *priv) -+{ -+ struct input_dev *input = priv->inputdev; -+ -+ sparse_keymap_free(input); -+ input_unregister_device(input); -+} -+ -+static int shuttle_wmi_get_bl(struct backlight_device *bd) -+{ -+ u8 val; -+ int rc; -+ struct shuttle_wmi *priv = bl_get_data(bd); -+ struct shuttle_backlight *sbl = priv->id->bl_desc; -+ -+ rc = ec_read(sbl->ec_addr, &val); -+ if (rc) -+ return rc; -+ return val & 7; -+} -+ -+static int shuttle_wmi_update_bl(struct backlight_device *bd) -+{ -+ int rc, steps; -+ u8 val; -+ struct shuttle_fn_map *fn_down, *fn_up; -+ struct shuttle_wmi *priv = bl_get_data(bd); -+ struct shuttle_backlight *sbl = priv->id->bl_desc; -+ -+ fn_down = sbl->fn_bl_down; -+ fn_up = sbl->fn_bl_up; -+ if (!fn_down || !fn_up) { -+ rc = ec_write(sbl->ec_addr, bd->props.brightness); -+ if (rc) -+ return rc; -+ } else { -+ /* change brightness by steps, this is a quirk for shuttle -+ * machines which don't accept direct write to ec for this */ -+ rc = ec_read(sbl->ec_addr, &val); -+ if (rc) -+ return rc; -+ steps = bd->props.brightness - (val & 7); -+ while (steps > 0) { -+ wmi_ec_cmd(fn_up->cmd, fn_up->arg, 0, fn_up->fn, NULL); -+ steps--; -+ } -+ while (steps < 0) { -+ wmi_ec_cmd(fn_down->cmd, fn_down->arg, 0, fn_down->fn, -+ NULL); -+ steps++; -+ } -+ } -+ -+ wmi_ec_cmd(CMD_CUTLVDS, 0, 0, -+ (bd->props.power == FB_BLANK_UNBLANK) ? 1 : 0, -+ NULL); -+ -+ return 0; -+} -+ -+static const struct backlight_ops shuttle_wmi_bl_ops = { -+ .get_brightness = shuttle_wmi_get_bl, -+ .update_status = shuttle_wmi_update_bl, -+}; -+ -+static int shuttle_wmi_backlight_init(struct shuttle_wmi *priv) -+{ -+ int rc; -+ u8 val; -+ struct backlight_properties props; -+ struct backlight_device *bd; -+ struct shuttle_backlight *sbl = priv->id->bl_desc; -+ -+ rc = ec_read(sbl->ec_addr, &val); -+ if (rc) -+ return rc; -+ memset(&props, 0, sizeof(struct backlight_properties)); -+ props.max_brightness = 7; -+ props.brightness = val & 7; -+ props.power = FB_BLANK_UNBLANK; -+ -+ bd = backlight_device_register(KBUILD_MODNAME, &priv->pdev->dev, priv, -+ &shuttle_wmi_bl_ops, &props); -+ if (IS_ERR(bd)) -+ return PTR_ERR(bd); -+ priv->bd = bd; -+ return 0; -+} -+ -+static void shuttle_wmi_backlight_exit(struct shuttle_wmi *priv) -+{ -+ if (priv->bd) -+ backlight_device_unregister(priv->bd); -+} -+ -+static ssize_t store_fn_cmd(struct device *dev, struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ struct platform_device *pdev = to_platform_device(dev); -+ struct shuttle_wmi *priv = platform_get_drvdata(pdev); -+ struct shuttle_fn_map *fn_map; -+ -+ for (fn_map = priv->id->fn_map; fn_map->name; fn_map++) { -+ if (fn_map->name == attr->attr.name) { -+ wmi_ec_cmd(fn_map->cmd, fn_map->arg, 0, fn_map->fn, -+ NULL); -+ return count; -+ } -+ } -+ return -EIO; -+} -+ -+static int set_fn_cmd_debug(void *data, u64 val) -+{ -+ struct shuttle_fn_map *fn_map = data; -+ -+ wmi_ec_cmd(fn_map->cmd, fn_map->arg, 0, fn_map->fn, NULL); -+ /* we don't know yet how many brightness values or maximum brightness -+ * values for lightbar, for now print possible brightness value change -+ * to aid in discovering these */ -+ if (fn_map->cmd == CMD_LCTRL) { -+ u32 val; -+ if (!wmi_ec_cmd(CMD_READEC, 0, 0, ECRAM_ER4, &val)) -+ pr_info("possible lightbar brightness change to value" -+ " 0x%08x\n", val); -+ } -+ return 0; -+} -+DEFINE_SIMPLE_ATTRIBUTE(fops_fn_cmd_debug, NULL, set_fn_cmd_debug, "%llu"); -+ -+static ssize_t show_fn_state(struct device *dev, struct device_attribute *attr, -+ char *buf) -+{ -+ struct shuttle_fn_map *fn_map; -+ struct shuttle_state *state; -+ int sw; -+ struct platform_device *pdev = to_platform_device(dev); -+ struct shuttle_wmi *priv = platform_get_drvdata(pdev); -+ -+ for (fn_map = priv->id->fn_map; fn_map->name; fn_map++) { -+ if (fn_map->name != attr->attr.name) -+ continue; -+ -+ state = fn_map->data; -+ sw = wmi_ec_state(&state->ecram); -+ if (sw < 0) -+ return sw; -+ return sprintf(buf, "%d\n", sw); -+ } -+ return -EIO; -+} -+ -+static ssize_t store_fn_state(struct device *dev, struct device_attribute *attr, -+ const char *buf, size_t count) -+{ -+ int enable, sw; -+ struct shuttle_fn_map *fn_map; -+ struct shuttle_state *state; -+ struct platform_device *pdev = to_platform_device(dev); -+ struct shuttle_wmi *priv = platform_get_drvdata(pdev); -+ -+ if (sscanf(buf, "%i", &enable) != 1) -+ return -EINVAL; -+ -+ for (fn_map = priv->id->fn_map; fn_map->name; fn_map++) { -+ if (fn_map->name != attr->attr.name) -+ continue; -+ -+ state = fn_map->data; -+ sw = wmi_ec_state(&state->ecram); -+ if (sw < 0) -+ return sw; -+ enable = enable ? 1 : 0; -+ if (enable != sw) { -+ wmi_ec_cmd(fn_map->cmd, fn_map->arg, 0, fn_map->fn, -+ NULL); -+ sw = wmi_ec_state(&state->ecram); -+ if (sw < 0) -+ return sw; -+ if (enable != sw) -+ return -EIO; -+ } -+ return count; -+ } -+ return -EIO; -+} -+ -+static void shuttle_fn_exit(struct shuttle_wmi *priv) -+{ -+ struct shuttle_fn_map *fn_map; -+ struct dentry *dbg_entry; -+ struct shuttle_state *state; -+ -+ if (priv->attr_group) { -+ sysfs_remove_group(&priv->pdev->dev.kobj, priv->attr_group); -+ kfree(priv->attr_group->attrs); -+ kfree(priv->attr_group); -+ priv->attr_group = NULL; -+ } -+ -+ fn_map = priv->id->fn_map; -+ while (fn_map->name) { -+ switch (fn_map->type) { -+ case FN_CMD: -+ kfree(fn_map->data); -+ fn_map->data = NULL; -+ break; -+ case FN_CMD_DEBUG: -+ dbg_entry = fn_map->data; -+ if (dbg_entry) { -+ debugfs_remove(dbg_entry); -+ fn_map->data = NULL; -+ } -+ break; -+ case FN_RFKILL: -+ shuttle_rfkill_remove(fn_map); -+ break; -+ case FN_STATE: -+ state = fn_map->data; -+ kfree(state->dev_attr); -+ state->dev_attr = NULL; -+ break; -+ } -+ fn_map++; -+ } -+} -+ -+static struct device_attribute *new_dev_attr(struct shuttle_fn_map *fn_map) -+{ -+ struct device_attribute *dev_attr; -+ -+ dev_attr = kzalloc(sizeof(struct device_attribute), GFP_KERNEL); -+ if (!dev_attr) -+ return NULL; -+ dev_attr->attr.name = fn_map->name; -+ return dev_attr; -+} -+ -+static int shuttle_fn_init(struct shuttle_wmi *priv) -+{ -+ struct shuttle_fn_map *fn_map; -+ struct device_attribute *dev_attr; -+ struct dentry *dbg_entry; -+ struct shuttle_state *state; -+ struct attribute **attr; -+ int nattr = 0; -+ int rc = -ENOMEM; -+ -+ fn_map = priv->id->fn_map; -+ while (fn_map->name) { -+ switch (fn_map->type) { -+ case FN_CMD: -+ dev_attr = new_dev_attr(fn_map); -+ if (!dev_attr) -+ goto fn_init_err; -+ dev_attr->attr.mode = 0200; -+ dev_attr->store = store_fn_cmd; -+ fn_map->data = dev_attr; -+ nattr++; -+ break; -+ case FN_CMD_DEBUG: -+ dbg_entry = debugfs_create_file(fn_map->name, 0200, -+ priv->dbg_root, fn_map, -+ &fops_fn_cmd_debug); -+ if (!dbg_entry) -+ goto fn_init_err; -+ fn_map->data = dbg_entry; -+ break; -+ case FN_RFKILL: -+ rc = shuttle_rfkill_init(fn_map, &priv->pdev->dev); -+ if (rc) -+ goto fn_init_err; -+ break; -+ case FN_STATE: -+ dev_attr = new_dev_attr(fn_map); -+ if (!dev_attr) -+ goto fn_init_err; -+ dev_attr->attr.mode = 0644; -+ dev_attr->show = show_fn_state; -+ dev_attr->store = store_fn_state; -+ state = fn_map->data; -+ state->dev_attr = dev_attr; -+ nattr++; -+ break; -+ } -+ fn_map++; -+ } -+ -+ /* create array of sysfs attributes (FN_CMD and FN_STATE types) */ -+ if (nattr > 0) { -+ priv->attr_group = kzalloc(sizeof(struct attribute_group), -+ GFP_KERNEL); -+ if (!priv->attr_group) -+ goto fn_init_err; -+ priv->attr_group->attrs = kzalloc(sizeof(struct attribute *) * -+ (nattr + 1), GFP_KERNEL); -+ if (!priv->attr_group->attrs) -+ goto fn_attrs_err; -+ attr = priv->attr_group->attrs; -+ fn_map = priv->id->fn_map; -+ while (fn_map->name) { -+ if (fn_map->type == FN_CMD) { -+ dev_attr = fn_map->data; -+ *attr = &dev_attr->attr; -+ attr++; -+ } else if (fn_map->type == FN_STATE) { -+ state = fn_map->data; -+ *attr = &state->dev_attr->attr; -+ attr++; -+ } -+ fn_map++; -+ } -+ rc = sysfs_create_group(&priv->pdev->dev.kobj, -+ priv->attr_group); -+ if (rc) -+ goto fn_grp_err; -+ } -+ -+ return 0; -+ -+fn_grp_err: -+ kfree(priv->attr_group->attrs); -+fn_attrs_err: -+ kfree(priv->attr_group); -+ priv->attr_group = NULL; -+fn_init_err: -+ shuttle_fn_exit(priv); -+ return rc; -+} -+ -+static int __devinit shuttle_wmi_probe(struct platform_device *pdev) -+{ -+ struct shuttle_wmi *priv; -+ int rc, i; -+ acpi_status status; -+ u32 val; -+ -+ priv = kzalloc(sizeof(struct shuttle_wmi), GFP_KERNEL); -+ if (!priv) -+ return -ENOMEM; -+ priv->pdev = pdev; -+ platform_set_drvdata(pdev, priv); -+ -+ for (i = 0; i < ARRAY_SIZE(shuttle_ids); i++) { -+ rc = wmi_ec_cmd(shuttle_ids[i].cmd_id, 0, 0, 0, &val); -+ if (!rc && val == 1) { -+ priv->id = &shuttle_ids[i]; -+ break; -+ } -+ } -+ /* If we can't identify the system using a WMI command, try using a DMI -+ * match, otherwise set id to unknown model */ -+ if (i == ARRAY_SIZE(shuttle_ids)) { -+ if (dmi_check_system(shuttle_dmi_ids)) -+ priv->id = &shuttle_dmi_id; -+ else -+ priv->id = &id_unknown; -+ } -+ -+ /* Process backlight quirks for some models based on DA18IM */ -+ if (priv->id->cmd_id == CMD_DA18IM) { -+ if (dmi_check_system(shuttle_quirk_bl_dmi_ids)) -+ priv->id->bl_desc = &quirk_bl_desc; -+ } -+ -+ priv->dbg_root = debugfs_create_dir(KBUILD_MODNAME, NULL); -+ if (!priv->dbg_root) { -+ rc = -ENOMEM; -+ goto err_debugfs; -+ } -+ -+ rc = shuttle_fn_init(priv); -+ if (rc) -+ goto err_fn; -+ -+ rc = shuttle_wmi_input_init(priv); -+ if (rc) -+ goto err_input; -+ -+ status = wmi_install_notify_handler(SHUTTLE_WMI_EVENT_GUID, -+ shuttle_wmi_notify, priv); -+ if (ACPI_FAILURE(status)) { -+ rc = -EIO; -+ goto err_notify; -+ } -+ -+ if (!acpi_video_backlight_support()) { -+ rc = shuttle_wmi_backlight_init(priv); -+ if (rc) -+ goto err_backlight; -+ } -+ return 0; -+ -+err_backlight: -+ wmi_remove_notify_handler(SHUTTLE_WMI_EVENT_GUID); -+err_notify: -+ shuttle_wmi_input_remove(priv); -+err_input: -+ shuttle_fn_exit(priv); -+err_fn: -+ debugfs_remove(priv->dbg_root); -+err_debugfs: -+ kfree(priv); -+ return rc; -+} -+ -+static int __devexit shuttle_wmi_remove(struct platform_device *pdev) -+{ -+ struct shuttle_wmi *priv = platform_get_drvdata(pdev); -+ -+ shuttle_wmi_backlight_exit(priv); -+ wmi_remove_notify_handler(SHUTTLE_WMI_EVENT_GUID); -+ shuttle_wmi_input_remove(priv); -+ shuttle_fn_exit(priv); -+ debugfs_remove(priv->dbg_root); -+ kfree(priv); -+ return 0; -+} -+ -+static int shuttle_wmi_resume(struct device *dev) -+{ -+ return shuttle_rfkill_resume(dev); -+} -+ -+static const struct dev_pm_ops shuttle_wmi_pm_ops = { -+ .restore = shuttle_wmi_resume, -+ .resume = shuttle_wmi_resume, -+}; -+ -+static struct platform_driver shuttle_wmi_driver = { -+ .driver = { -+ .name = KBUILD_MODNAME, -+ .owner = THIS_MODULE, -+ .pm = &shuttle_wmi_pm_ops, -+ }, -+ .probe = shuttle_wmi_probe, -+ .remove = __devexit_p(shuttle_wmi_remove), -+}; -+ -+static struct platform_device *shuttle_wmi_device; -+ -+static ssize_t show_model_name(struct device *dev, -+ struct device_attribute *attr, -+ char *buf) -+{ -+ struct platform_device *pdev = to_platform_device(dev); -+ struct shuttle_wmi *priv = platform_get_drvdata(pdev); -+ -+ return sprintf(buf, "%s\n", priv->id->model_name); -+} -+ -+static DEVICE_ATTR(model_name, 0444, show_model_name, NULL); -+ -+static struct attribute *shuttle_platform_attributes[] = { -+ &dev_attr_model_name.attr, -+ NULL -+}; -+ -+static struct attribute_group shuttle_attribute_group = { -+ .attrs = shuttle_platform_attributes -+}; -+ -+static int __init shuttle_wmi_init(void) -+{ -+ int rc; -+ u32 val; -+ -+ if (!wmi_has_guid(SHUTTLE_WMI_SETGET_GUID) || -+ !wmi_has_guid(SHUTTLE_WMI_EVENT_GUID)) { -+ pr_err("Required WMI GUID not available\n"); -+ return -ENODEV; -+ } -+ -+ /* Check that we are really on a shuttle BIOS */ -+ rc = wmi_ec_cmd(CMD_INT15, 0, 0, 0, &val); -+ if (rc || val != 0x534c) { -+ pr_err("Shuttle WMI device not found or unsupported" -+ " (val=0x%08x)\n", val); -+ return -ENODEV; -+ } -+ -+ rc = platform_driver_register(&shuttle_wmi_driver); -+ if (rc) -+ goto err_driver_register; -+ shuttle_wmi_device = platform_device_alloc(KBUILD_MODNAME, -1); -+ if (!shuttle_wmi_device) { -+ rc = -ENOMEM; -+ goto err_device_alloc; -+ } -+ rc = platform_device_add(shuttle_wmi_device); -+ if (rc) -+ goto err_device_add; -+ -+ rc = sysfs_create_group(&shuttle_wmi_device->dev.kobj, -+ &shuttle_attribute_group); -+ if (rc) -+ goto err_sysfs; -+ -+ return 0; -+ -+err_sysfs: -+ platform_device_del(shuttle_wmi_device); -+err_device_add: -+ platform_device_put(shuttle_wmi_device); -+err_device_alloc: -+ platform_driver_unregister(&shuttle_wmi_driver); -+err_driver_register: -+ return rc; -+} -+ -+static void __exit shuttle_wmi_exit(void) -+{ -+ sysfs_remove_group(&shuttle_wmi_device->dev.kobj, -+ &shuttle_attribute_group); -+ platform_device_unregister(shuttle_wmi_device); -+ platform_driver_unregister(&shuttle_wmi_driver); -+} -+ -+module_init(shuttle_wmi_init); -+module_exit(shuttle_wmi_exit); -diff -Nurp linux-4.13/MAINTAINERS linux-4.13-shuttle/MAINTAINERS ---- linux-4.13/MAINTAINERS -+++ linux-4.13-shuttle/MAINTAINERS -@@ -11861,6 +11861,12 @@ - F: drivers/tty/serial/ioc?_serial.c - F: include/linux/ioc?.h - -+SHUTTLE WMI EXTRAS DRIVER -+M: Herton Ronaldo Krzesinski -+L: platform-driver-x86@vger.kernel.org -+S: Maintained -+F: drivers/platform/x86/shuttle-wmi.c -+ - SGI XP/XPC/XPNET DRIVER - M: Cliff Whickman - M: Robin Holt diff --git a/kernel/kernel/files/patches/mageia/platform-x86-ideapad-Add-IdeaPad-320-15IKB-to-no_hw_rfkill_list.patch b/kernel/kernel/files/patches/mageia/platform-x86-ideapad-Add-IdeaPad-320-15IKB-to-no_hw_rfkill_list.patch deleted file mode 100644 index d1eaa9b6..00000000 --- a/kernel/kernel/files/patches/mageia/platform-x86-ideapad-Add-IdeaPad-320-15IKB-to-no_hw_rfkill_list.patch +++ /dev/null @@ -1,24 +0,0 @@ - -Add Lenovo Ideapad 320-15IKB to no_hw_rfkill_list - -https://bugs.mageia.org/show_bug.cgi?id=21728 - -Reported-by: Jean-Christophe Cardot -Signed-off-by: Thomas Backlund - ---- a/drivers/platform/x86/ideapad-laptop.c -+++ b/drivers/platform/x86/ideapad-laptop.c -@@ -956,6 +956,13 @@ static const struct dmi_system_id no_hw_ - }, - }, - { -+ .ident = "Lenovo ideapad 320-15IKB", -+ .matches = { -+ DMI_MATCH(DMI_SYS_VENDOR, "LENOVO"), -+ DMI_MATCH(DMI_PRODUCT_VERSION, "Lenovo ideapad 320-15IKB"), -+ }, -+ }, -+ { - .ident = "Lenovo ideapad Y700-14ISK", - .matches = { - DMI_MATCH(DMI_SYS_VENDOR, "LENOVO"), diff --git a/kernel/kernel/files/patches/mageia/platform-x86-ideapad-laptop-Increase-timeout-to-wait-for-ec-answer.patch b/kernel/kernel/files/patches/mageia/platform-x86-ideapad-laptop-Increase-timeout-to-wait-for-ec-answer.patch deleted file mode 100644 index 05410a4e..00000000 --- a/kernel/kernel/files/patches/mageia/platform-x86-ideapad-laptop-Increase-timeout-to-wait-for-ec-answer.patch +++ /dev/null @@ -1,27 +0,0 @@ -From: Aaron Ma -Subject: [PATCH] platform/x86: ideapad-laptop: Increase timeout to wait for EC answer -Date: Sun, 11 Feb 2018 17:18:49 +0800 - -Lenovo E41-20 needs more time than 100ms to read VPC, -the funtion keys always failed responding. -Increase timeout to get the value from VPC, then -the funtion keys like mic mute key work well. - -Signed-off-by: Aaron Ma ---- - drivers/platform/x86/ideapad-laptop.c | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - -diff --git a/drivers/platform/x86/ideapad-laptop.c b/drivers/platform/x86/ideapad-laptop.c -index 5b6f18b18801..535199c9e6bc 100644 ---- a/drivers/platform/x86/ideapad-laptop.c -+++ b/drivers/platform/x86/ideapad-laptop.c -@@ -113,7 +113,7 @@ MODULE_PARM_DESC(no_bt_rfkill, "No rfkill for bluetooth."); - /* - * ACPI Helpers - */ --#define IDEAPAD_EC_TIMEOUT (100) /* in ms */ -+#define IDEAPAD_EC_TIMEOUT (200) /* in ms */ - - static int read_method_int(acpi_handle handle, const char *method, int *val) - { diff --git a/kernel/kernel/files/patches/mageia/platform-x86-shuttle-wmi-4.13-buildfix.patch b/kernel/kernel/files/patches/mageia/platform-x86-shuttle-wmi-4.13-buildfix.patch deleted file mode 100644 index c9a1c60d..00000000 --- a/kernel/kernel/files/patches/mageia/platform-x86-shuttle-wmi-4.13-buildfix.patch +++ /dev/null @@ -1,30 +0,0 @@ - -sparse_keymap_free() is now obsolete. - -Signed-off-by: Thomas Backlund - ---- linux/drivers/platform/x86/shuttle-wmi.c.orig 2017-10-15 00:39:53.041395980 +0300 -+++ linux/drivers/platform/x86/shuttle-wmi.c 2017-10-15 01:05:37.008662881 +0300 -@@ -763,14 +763,9 @@ static int shuttle_wmi_input_init(struct - goto err_free_dev; - - rc = input_register_device(input); -- if (rc) -- goto err_free_keymap; - - priv->inputdev = input; - return 0; -- --err_free_keymap: -- sparse_keymap_free(input); - err_free_dev: - input_free_device(input); - return rc; -@@ -780,7 +775,6 @@ static void shuttle_wmi_input_remove(str - { - struct input_dev *input = priv->inputdev; - -- sparse_keymap_free(input); - input_unregister_device(input); - } - diff --git a/kernel/kernel/files/patches/mageia/platform-x86-shuttle-wmi-4.2-buildfix.patch b/kernel/kernel/files/patches/mageia/platform-x86-shuttle-wmi-4.2-buildfix.patch deleted file mode 100644 index ee0d5849..00000000 --- a/kernel/kernel/files/patches/mageia/platform-x86-shuttle-wmi-4.2-buildfix.patch +++ /dev/null @@ -1,19 +0,0 @@ ---- linux/drivers/platform/x86/shuttle-wmi.c.orig 2015-09-30 00:51:13.000000000 +0300 -+++ linux/drivers/platform/x86/shuttle-wmi.c 2015-09-30 02:04:20.808458393 +0300 -@@ -26,6 +26,7 @@ - #include - #include - #include -+#include - - MODULE_AUTHOR("Herton Ronaldo Krzesinski"); - MODULE_DESCRIPTION("Shuttle WMI Extras Driver"); -@@ -1161,7 +1162,7 @@ static int shuttle_wmi_probe(struct plat - goto err_notify; - } - -- if (!acpi_video_backlight_support()) { -+ if (acpi_video_get_backlight_type() == acpi_backlight_vendor) { - rc = shuttle_wmi_backlight_init(priv); - if (rc) - goto err_backlight; diff --git a/kernel/kernel/files/patches/mageia/platform-x86-shuttle-wmi-drop-devinit-exit.patch b/kernel/kernel/files/patches/mageia/platform-x86-shuttle-wmi-drop-devinit-exit.patch deleted file mode 100644 index 17128641..00000000 --- a/kernel/kernel/files/patches/mageia/platform-x86-shuttle-wmi-drop-devinit-exit.patch +++ /dev/null @@ -1,38 +0,0 @@ ---- ./drivers/platform/x86/shuttle-wmi.c.orig 2013-01-16 18:13:57.000000000 +0200 -+++ ./drivers/platform/x86/shuttle-wmi.c 2013-01-16 18:41:13.676433242 +0200 -@@ -294,7 +294,7 @@ static struct dmi_system_id shuttle_dmi_ - {} - }; - --static struct dmi_system_id __devinitdata shuttle_quirk_bl_dmi_ids[] = { -+static struct dmi_system_id shuttle_quirk_bl_dmi_ids[] = { - { - .ident = "Positivo M13", - .matches = { -@@ -1105,7 +1105,7 @@ fn_init_err: - return rc; - } - --static int __devinit shuttle_wmi_probe(struct platform_device *pdev) -+static int shuttle_wmi_probe(struct platform_device *pdev) - { - struct shuttle_wmi *priv; - int rc, i; -@@ -1181,7 +1181,7 @@ err_debugfs: - return rc; - } - --static int __devexit shuttle_wmi_remove(struct platform_device *pdev) -+static int shuttle_wmi_remove(struct platform_device *pdev) - { - struct shuttle_wmi *priv = platform_get_drvdata(pdev); - -@@ -1211,7 +1211,7 @@ static struct platform_driver shuttle_wm - .pm = &shuttle_wmi_pm_ops, - }, - .probe = shuttle_wmi_probe, -- .remove = __devexit_p(shuttle_wmi_remove), -+ .remove = shuttle_wmi_remove, - }; - - static struct platform_device *shuttle_wmi_device; diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0001-x86-asm-offsets-Move-TSS_sp0-and-TSS_sp1-to-asm-offs.patch b/kernel/kernel/files/patches/mageia/pti32bit-0001-x86-asm-offsets-Move-TSS_sp0-and-TSS_sp1-to-asm-offs.patch deleted file mode 100644 index b4edc558..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0001-x86-asm-offsets-Move-TSS_sp0-and-TSS_sp1-to-asm-offs.patch +++ /dev/null @@ -1,44 +0,0 @@ -From 3b7711fd3adb7d6b812a33da4a4639ddce6522b6 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Fri, 19 Jan 2018 13:46:20 +0100 -Subject: [PATCH 01/34] x86/asm-offsets: Move TSS_sp0 and TSS_sp1 to - asm-offsets.c - -These offsets will be used in 32 bit assembly code as well, -so make them available for all of x86 code. - -Signed-off-by: Joerg Roedel ---- - arch/x86/kernel/asm-offsets.c | 4 ++++ - arch/x86/kernel/asm-offsets_64.c | 2 -- - 2 files changed, 4 insertions(+), 2 deletions(-) - -diff --git a/arch/x86/kernel/asm-offsets.c b/arch/x86/kernel/asm-offsets.c -index 76417a9aab73..232152ccb301 100644 ---- a/arch/x86/kernel/asm-offsets.c -+++ b/arch/x86/kernel/asm-offsets.c -@@ -103,4 +103,8 @@ void common(void) { - OFFSET(CPU_ENTRY_AREA_entry_trampoline, cpu_entry_area, entry_trampoline); - OFFSET(CPU_ENTRY_AREA_entry_stack, cpu_entry_area, entry_stack_page); - DEFINE(SIZEOF_entry_stack, sizeof(struct entry_stack)); -+ -+ /* Offset for sp0 and sp1 into the tss_struct */ -+ OFFSET(TSS_sp0, tss_struct, x86_tss.sp0); -+ OFFSET(TSS_sp1, tss_struct, x86_tss.sp1); - } -diff --git a/arch/x86/kernel/asm-offsets_64.c b/arch/x86/kernel/asm-offsets_64.c -index bf51e51d808d..d2eba73a5f8a 100644 ---- a/arch/x86/kernel/asm-offsets_64.c -+++ b/arch/x86/kernel/asm-offsets_64.c -@@ -65,8 +65,6 @@ int main(void) - #undef ENTRY - - OFFSET(TSS_ist, tss_struct, x86_tss.ist); -- OFFSET(TSS_sp0, tss_struct, x86_tss.sp0); -- OFFSET(TSS_sp1, tss_struct, x86_tss.sp1); - BLANK(); - - #ifdef CONFIG_CC_STACKPROTECTOR --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0002-x86-entry-32-Rename-TSS_sysenter_sp0-to-TSS_entry_st.patch b/kernel/kernel/files/patches/mageia/pti32bit-0002-x86-entry-32-Rename-TSS_sysenter_sp0-to-TSS_entry_st.patch deleted file mode 100644 index 1d9b8f47..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0002-x86-entry-32-Rename-TSS_sysenter_sp0-to-TSS_entry_st.patch +++ /dev/null @@ -1,48 +0,0 @@ -From 52806123bdb0b558a5b4fbfa132bae32e53b008a Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Mon, 15 Jan 2018 18:20:15 +0100 -Subject: [PATCH 02/34] x86/entry/32: Rename TSS_sysenter_sp0 to - TSS_entry_stack - -The stack address doesn't need to be stored in tss.sp0 if -we switch manually like on sysenter. Rename the offset so -that it still makes sense when we change its location. - -We will also use this stack for all kernel-entry points, not -just sysenter. Reflect that in the name as well. - -Signed-off-by: Joerg Roedel ---- - arch/x86/entry/entry_32.S | 2 +- - arch/x86/kernel/asm-offsets_32.c | 2 +- - 2 files changed, 2 insertions(+), 2 deletions(-) - -diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S -index 2a35b1e0fb90..e65977615616 100644 ---- a/arch/x86/entry/entry_32.S -+++ b/arch/x86/entry/entry_32.S -@@ -413,7 +413,7 @@ ENTRY(xen_sysenter_target) - * 0(%ebp) arg6 - */ - ENTRY(entry_SYSENTER_32) -- movl TSS_sysenter_sp0(%esp), %esp -+ movl TSS_entry_stack(%esp), %esp - .Lsysenter_past_esp: - pushl $__USER_DS /* pt_regs->ss */ - pushl %ebp /* pt_regs->sp (stashed in bp) */ -diff --git a/arch/x86/kernel/asm-offsets_32.c b/arch/x86/kernel/asm-offsets_32.c -index fa1261eefa16..f452bfdc485a 100644 ---- a/arch/x86/kernel/asm-offsets_32.c -+++ b/arch/x86/kernel/asm-offsets_32.c -@@ -47,7 +47,7 @@ void foo(void) - BLANK(); - - /* Offset from the sysenter stack to tss.sp0 */ -- DEFINE(TSS_sysenter_sp0, offsetof(struct cpu_entry_area, tss.x86_tss.sp0) - -+ DEFINE(TSS_entry_stack, offsetof(struct cpu_entry_area, tss.x86_tss.sp0) - - offsetofend(struct cpu_entry_area, entry_stack_page.stack)); - - #ifdef CONFIG_CC_STACKPROTECTOR --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0003-x86-entry-32-Load-task-stack-from-x86_tss.sp1-in-SYS.patch b/kernel/kernel/files/patches/mageia/pti32bit-0003-x86-entry-32-Load-task-stack-from-x86_tss.sp1-in-SYS.patch deleted file mode 100644 index 6a891571..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0003-x86-entry-32-Load-task-stack-from-x86_tss.sp1-in-SYS.patch +++ /dev/null @@ -1,49 +0,0 @@ -From b696a2c46d9b9937b816b11ff2ec72aa0b65f204 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Fri, 19 Jan 2018 13:33:37 +0100 -Subject: [PATCH 03/34] x86/entry/32: Load task stack from x86_tss.sp1 in - SYSENTER handler - -We want x86_tss.sp0 point to the entry stack later to use -it as a trampoline stack for other kernel entry points -besides SYSENTER. - -So store the task stack pointer in x86_tss.sp1, which is -otherwise unused by the hardware, as Linux doesn't make use -of Ring 1. - -Signed-off-by: Joerg Roedel ---- - arch/x86/kernel/asm-offsets_32.c | 2 +- - arch/x86/kernel/process_32.c | 2 ++ - 2 files changed, 3 insertions(+), 1 deletion(-) - -diff --git a/arch/x86/kernel/asm-offsets_32.c b/arch/x86/kernel/asm-offsets_32.c -index f452bfdc485a..b97e48c87e80 100644 ---- a/arch/x86/kernel/asm-offsets_32.c -+++ b/arch/x86/kernel/asm-offsets_32.c -@@ -47,7 +47,7 @@ void foo(void) - BLANK(); - - /* Offset from the sysenter stack to tss.sp0 */ -- DEFINE(TSS_entry_stack, offsetof(struct cpu_entry_area, tss.x86_tss.sp0) - -+ DEFINE(TSS_entry_stack, offsetof(struct cpu_entry_area, tss.x86_tss.sp1) - - offsetofend(struct cpu_entry_area, entry_stack_page.stack)); - - #ifdef CONFIG_CC_STACKPROTECTOR -diff --git a/arch/x86/kernel/process_32.c b/arch/x86/kernel/process_32.c -index 5224c6099184..097d36a64889 100644 ---- a/arch/x86/kernel/process_32.c -+++ b/arch/x86/kernel/process_32.c -@@ -292,6 +292,8 @@ __switch_to(struct task_struct *prev_p, struct task_struct *next_p) - this_cpu_write(cpu_current_top_of_stack, - (unsigned long)task_stack_page(next_p) + - THREAD_SIZE); -+ /* SYSENTER reads the task-stack from tss.sp1 */ -+ this_cpu_write(cpu_tss_rw.x86_tss.sp1, next_p->thread.sp0); - - /* - * Restore %gs if needed (which is common) --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0004-x86-entry-32-Put-ESPFIX-code-into-a-macro.patch b/kernel/kernel/files/patches/mageia/pti32bit-0004-x86-entry-32-Put-ESPFIX-code-into-a-macro.patch deleted file mode 100644 index 7a6d04ed..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0004-x86-entry-32-Put-ESPFIX-code-into-a-macro.patch +++ /dev/null @@ -1,137 +0,0 @@ -From 7c97243c7694dc1c0e0ad73bc17bdc2c553225ac Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Wed, 31 Jan 2018 10:50:02 +0100 -Subject: [PATCH 04/34] x86/entry/32: Put ESPFIX code into a macro - -This makes it easier to split up the shared iret code path. - -Signed-off-by: Joerg Roedel ---- - arch/x86/entry/entry_32.S | 97 ++++++++++++++++++++++++----------------------- - 1 file changed, 49 insertions(+), 48 deletions(-) - -diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S -index e65977615616..0289bde37a08 100644 ---- a/arch/x86/entry/entry_32.S -+++ b/arch/x86/entry/entry_32.S -@@ -221,6 +221,54 @@ - POP_GS_EX - .endm - -+.macro CHECK_AND_APPLY_ESPFIX -+#ifdef CONFIG_X86_ESPFIX32 -+#define GDT_ESPFIX_SS PER_CPU_VAR(gdt_page) + (GDT_ENTRY_ESPFIX_SS * 8) -+ -+ ALTERNATIVE "jmp .Lend_\@", "", X86_BUG_ESPFIX -+ -+ movl PT_EFLAGS(%esp), %eax # mix EFLAGS, SS and CS -+ /* -+ * Warning: PT_OLDSS(%esp) contains the wrong/random values if we -+ * are returning to the kernel. -+ * See comments in process.c:copy_thread() for details. -+ */ -+ movb PT_OLDSS(%esp), %ah -+ movb PT_CS(%esp), %al -+ andl $(X86_EFLAGS_VM | (SEGMENT_TI_MASK << 8) | SEGMENT_RPL_MASK), %eax -+ cmpl $((SEGMENT_LDT << 8) | USER_RPL), %eax -+ jne .Lend_\@ # returning to user-space with LDT SS -+ -+ /* -+ * Setup and switch to ESPFIX stack -+ * -+ * We're returning to userspace with a 16 bit stack. The CPU will not -+ * restore the high word of ESP for us on executing iret... This is an -+ * "official" bug of all the x86-compatible CPUs, which we can work -+ * around to make dosemu and wine happy. We do this by preloading the -+ * high word of ESP with the high word of the userspace ESP while -+ * compensating for the offset by changing to the ESPFIX segment with -+ * a base address that matches for the difference. -+ */ -+ mov %esp, %edx /* load kernel esp */ -+ mov PT_OLDESP(%esp), %eax /* load userspace esp */ -+ mov %dx, %ax /* eax: new kernel esp */ -+ sub %eax, %edx /* offset (low word is 0) */ -+ shr $16, %edx -+ mov %dl, GDT_ESPFIX_SS + 4 /* bits 16..23 */ -+ mov %dh, GDT_ESPFIX_SS + 7 /* bits 24..31 */ -+ pushl $__ESPFIX_SS -+ pushl %eax /* new kernel esp */ -+ /* -+ * Disable interrupts, but do not irqtrace this section: we -+ * will soon execute iret and the tracer was already set to -+ * the irqstate after the IRET: -+ */ -+ DISABLE_INTERRUPTS(CLBR_ANY) -+ lss (%esp), %esp /* switch to espfix segment */ -+.Lend_\@: -+#endif /* CONFIG_X86_ESPFIX32 */ -+.endm - /* - * %eax: prev task - * %edx: next task -@@ -548,21 +596,7 @@ ENTRY(entry_INT80_32) - restore_all: - TRACE_IRQS_IRET - .Lrestore_all_notrace: --#ifdef CONFIG_X86_ESPFIX32 -- ALTERNATIVE "jmp .Lrestore_nocheck", "", X86_BUG_ESPFIX -- -- movl PT_EFLAGS(%esp), %eax # mix EFLAGS, SS and CS -- /* -- * Warning: PT_OLDSS(%esp) contains the wrong/random values if we -- * are returning to the kernel. -- * See comments in process.c:copy_thread() for details. -- */ -- movb PT_OLDSS(%esp), %ah -- movb PT_CS(%esp), %al -- andl $(X86_EFLAGS_VM | (SEGMENT_TI_MASK << 8) | SEGMENT_RPL_MASK), %eax -- cmpl $((SEGMENT_LDT << 8) | USER_RPL), %eax -- je .Lldt_ss # returning to user-space with LDT SS --#endif -+ CHECK_AND_APPLY_ESPFIX - .Lrestore_nocheck: - RESTORE_REGS 4 # skip orig_eax/error_code - .Lirq_return: -@@ -575,39 +609,6 @@ ENTRY(iret_exc ) - jmp common_exception - .previous - _ASM_EXTABLE(.Lirq_return, iret_exc) -- --#ifdef CONFIG_X86_ESPFIX32 --.Lldt_ss: --/* -- * Setup and switch to ESPFIX stack -- * -- * We're returning to userspace with a 16 bit stack. The CPU will not -- * restore the high word of ESP for us on executing iret... This is an -- * "official" bug of all the x86-compatible CPUs, which we can work -- * around to make dosemu and wine happy. We do this by preloading the -- * high word of ESP with the high word of the userspace ESP while -- * compensating for the offset by changing to the ESPFIX segment with -- * a base address that matches for the difference. -- */ --#define GDT_ESPFIX_SS PER_CPU_VAR(gdt_page) + (GDT_ENTRY_ESPFIX_SS * 8) -- mov %esp, %edx /* load kernel esp */ -- mov PT_OLDESP(%esp), %eax /* load userspace esp */ -- mov %dx, %ax /* eax: new kernel esp */ -- sub %eax, %edx /* offset (low word is 0) */ -- shr $16, %edx -- mov %dl, GDT_ESPFIX_SS + 4 /* bits 16..23 */ -- mov %dh, GDT_ESPFIX_SS + 7 /* bits 24..31 */ -- pushl $__ESPFIX_SS -- pushl %eax /* new kernel esp */ -- /* -- * Disable interrupts, but do not irqtrace this section: we -- * will soon execute iret and the tracer was already set to -- * the irqstate after the IRET: -- */ -- DISABLE_INTERRUPTS(CLBR_ANY) -- lss (%esp), %esp /* switch to espfix segment */ -- jmp .Lrestore_nocheck --#endif - ENDPROC(entry_INT80_32) - - .macro FIXUP_ESPFIX_STACK --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0005-x86-entry-32-Unshare-NMI-return-path.patch b/kernel/kernel/files/patches/mageia/pti32bit-0005-x86-entry-32-Unshare-NMI-return-path.patch deleted file mode 100644 index 33a1f95e..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0005-x86-entry-32-Unshare-NMI-return-path.patch +++ /dev/null @@ -1,43 +0,0 @@ -From c66ec22d03296d1311197aaef753c1c320eed225 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Wed, 31 Jan 2018 10:58:38 +0100 -Subject: [PATCH 05/34] x86/entry/32: Unshare NMI return path - -NMI will no longer use most of the shared return path, -because NMI needs special handling when the CR3 switches for -PTI are added. This patch prepares for that. - -Signed-off-by: Joerg Roedel ---- - arch/x86/entry/entry_32.S | 8 ++++++-- - 1 file changed, 6 insertions(+), 2 deletions(-) - -diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S -index 0289bde37a08..00ae759a7c44 100644 ---- a/arch/x86/entry/entry_32.S -+++ b/arch/x86/entry/entry_32.S -@@ -1007,7 +1007,7 @@ ENTRY(nmi) - - /* Not on SYSENTER stack. */ - call do_nmi -- jmp .Lrestore_all_notrace -+ jmp .Lnmi_return - - .Lnmi_from_sysenter_stack: - /* -@@ -1018,7 +1018,11 @@ ENTRY(nmi) - movl PER_CPU_VAR(cpu_current_top_of_stack), %esp - call do_nmi - movl %ebx, %esp -- jmp .Lrestore_all_notrace -+ -+.Lnmi_return: -+ CHECK_AND_APPLY_ESPFIX -+ RESTORE_REGS 4 -+ jmp .Lirq_return - - #ifdef CONFIG_X86_ESPFIX32 - .Lnmi_espfix_stack: --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0006-x86-entry-32-Split-off-return-to-kernel-path.patch b/kernel/kernel/files/patches/mageia/pti32bit-0006-x86-entry-32-Split-off-return-to-kernel-path.patch deleted file mode 100644 index e47ab3d3..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0006-x86-entry-32-Split-off-return-to-kernel-path.patch +++ /dev/null @@ -1,55 +0,0 @@ -From 916e5e906873de859d8a87c1ffb0323e167d1a44 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Wed, 31 Jan 2018 11:07:32 +0100 -Subject: [PATCH 06/34] x86/entry/32: Split off return-to-kernel path - -Use a separate return path when we know we are returning to -the kernel. This allows us to put the PTI cr3-switch and the -switch to the entry-stack into the return-to-user path -without further checking. - -Signed-off-by: Joerg Roedel ---- - arch/x86/entry/entry_32.S | 11 ++++++++--- - 1 file changed, 8 insertions(+), 3 deletions(-) - -diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S -index 00ae759a7c44..9bd77183965f 100644 ---- a/arch/x86/entry/entry_32.S -+++ b/arch/x86/entry/entry_32.S -@@ -65,7 +65,7 @@ - # define preempt_stop(clobbers) DISABLE_INTERRUPTS(clobbers); TRACE_IRQS_OFF - #else - # define preempt_stop(clobbers) --# define resume_kernel restore_all -+# define resume_kernel restore_all_kernel - #endif - - .macro TRACE_IRQS_IRET -@@ -400,9 +400,9 @@ ENTRY(resume_kernel) - DISABLE_INTERRUPTS(CLBR_ANY) - .Lneed_resched: - cmpl $0, PER_CPU_VAR(__preempt_count) -- jnz restore_all -+ jnz restore_all_kernel - testl $X86_EFLAGS_IF, PT_EFLAGS(%esp) # interrupts off (exception path) ? -- jz restore_all -+ jz restore_all_kernel - call preempt_schedule_irq - jmp .Lneed_resched - END(resume_kernel) -@@ -602,6 +602,11 @@ restore_all: - .Lirq_return: - INTERRUPT_RETURN - -+restore_all_kernel: -+ TRACE_IRQS_IRET -+ RESTORE_REGS 4 -+ jmp .Lirq_return -+ - .section .fixup, "ax" - ENTRY(iret_exc ) - pushl $0 # no error code --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0007-x86-entry-32-Restore-segments-before-int-registers.patch b/kernel/kernel/files/patches/mageia/pti32bit-0007-x86-entry-32-Restore-segments-before-int-registers.patch deleted file mode 100644 index 2fd4c846..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0007-x86-entry-32-Restore-segments-before-int-registers.patch +++ /dev/null @@ -1,111 +0,0 @@ -From c19ad15b16ec8908794459f28b44eca889a925f7 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Wed, 31 Jan 2018 11:29:59 +0100 -Subject: [PATCH 07/34] x86/entry/32: Restore segments before int registers - -Restoring the segments can cause exceptions that need to be -handled. With PTI enabled, we still need to be on kernel cr3 -when the exception happens. For the cr3-switch we need -at least one integer scratch register, so we can't switch -with the user integer registers already loaded. - -Avoid a push/pop cycle to free a register for the cr3 switch -by restoring the segments first. That way the integer -registers are not live yet and we can use them for the cr3 -switch. - -This also helps in the NMI path, where we need to leave with -the same cr3 as we entered. There we still have the -callee-saved registers live when switching cr3s. - -Signed-off-by: Joerg Roedel ---- - arch/x86/entry/entry_32.S | 50 ++++++++++++++++++++--------------------------- - 1 file changed, 21 insertions(+), 29 deletions(-) - -diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S -index 9bd77183965f..b39c5e210b43 100644 ---- a/arch/x86/entry/entry_32.S -+++ b/arch/x86/entry/entry_32.S -@@ -91,11 +91,6 @@ - /* unfortunately push/pop can't be no-op */ - .macro PUSH_GS - pushl $0 --.endm --.macro POP_GS pop=0 -- addl $(4 + \pop), %esp --.endm --.macro POP_GS_EX - .endm - - /* all the rest are no-op */ -@@ -116,20 +111,6 @@ - pushl %gs - .endm - --.macro POP_GS pop=0 --98: popl %gs -- .if \pop <> 0 -- add $\pop, %esp -- .endif --.endm --.macro POP_GS_EX --.pushsection .fixup, "ax" --99: movl $0, (%esp) -- jmp 98b --.popsection -- _ASM_EXTABLE(98b, 99b) --.endm -- - .macro PTGS_TO_GS - 98: mov PT_GS(%esp), %gs - .endm -@@ -201,24 +182,35 @@ - popl %eax - .endm - --.macro RESTORE_REGS pop=0 -- RESTORE_INT_REGS --1: popl %ds --2: popl %es --3: popl %fs -- POP_GS \pop -+.macro RESTORE_SEGMENTS -+1: mov PT_DS(%esp), %ds -+2: mov PT_ES(%esp), %es -+3: mov PT_FS(%esp), %fs -+ PTGS_TO_GS - .pushsection .fixup, "ax" --4: movl $0, (%esp) -+4: movl $0, PT_DS(%esp) - jmp 1b --5: movl $0, (%esp) -+5: movl $0, PT_ES(%esp) - jmp 2b --6: movl $0, (%esp) -+6: movl $0, PT_FS(%esp) - jmp 3b - .popsection - _ASM_EXTABLE(1b, 4b) - _ASM_EXTABLE(2b, 5b) - _ASM_EXTABLE(3b, 6b) -- POP_GS_EX -+ PTGS_TO_GS_EX -+.endm -+ -+.macro RESTORE_SKIP_SEGMENTS pop=0 -+ /* Jump over the segments stored on stack */ -+ addl $((4 * 4) + \pop), %esp -+.endm -+ -+.macro RESTORE_REGS pop=0 -+ RESTORE_SEGMENTS -+ RESTORE_INT_REGS -+ /* Skip over already restored segment registers */ -+ RESTORE_SKIP_SEGMENTS \pop - .endm - - .macro CHECK_AND_APPLY_ESPFIX --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0008-x86-entry-32-Enter-the-kernel-via-trampoline-stack.patch b/kernel/kernel/files/patches/mageia/pti32bit-0008-x86-entry-32-Enter-the-kernel-via-trampoline-stack.patch deleted file mode 100644 index 0fddc074..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0008-x86-entry-32-Enter-the-kernel-via-trampoline-stack.patch +++ /dev/null @@ -1,356 +0,0 @@ -From 288a2a6b31018ab9172598a39477404582ae29fa Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 10:55:52 +0100 -Subject: [PATCH 08/34] x86/entry/32: Enter the kernel via trampoline stack - -Use the entry-stack as a trampoline to enter the kernel. The -entry-stack is already in the cpu_entry_area and will be -mapped to userspace when PTI is enabled. - -Signed-off-by: Joerg Roedel ---- - arch/x86/entry/entry_32.S | 136 +++++++++++++++++++++++++++++++-------- - arch/x86/include/asm/switch_to.h | 6 +- - arch/x86/kernel/asm-offsets.c | 1 + - arch/x86/kernel/cpu/common.c | 5 +- - arch/x86/kernel/process.c | 2 - - arch/x86/kernel/process_32.c | 10 +-- - 6 files changed, 121 insertions(+), 39 deletions(-) - -diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S -index b39c5e210b43..1737da2e4517 100644 ---- a/arch/x86/entry/entry_32.S -+++ b/arch/x86/entry/entry_32.S -@@ -135,25 +135,36 @@ - - #endif /* CONFIG_X86_32_LAZY_GS */ - --.macro SAVE_ALL pt_regs_ax=%eax -+.macro SAVE_ALL pt_regs_ax=%eax switch_stacks=0 - cld -+ /* Push segment registers and %eax */ - PUSH_GS - pushl %fs - pushl %es - pushl %ds - pushl \pt_regs_ax -+ -+ /* Load kernel segments */ -+ movl $(__USER_DS), %eax -+ movl %eax, %ds -+ movl %eax, %es -+ movl $(__KERNEL_PERCPU), %eax -+ movl %eax, %fs -+ SET_KERNEL_GS %eax -+ -+ /* Push integer registers and complete PT_REGS */ - pushl %ebp - pushl %edi - pushl %esi - pushl %edx - pushl %ecx - pushl %ebx -- movl $(__USER_DS), %edx -- movl %edx, %ds -- movl %edx, %es -- movl $(__KERNEL_PERCPU), %edx -- movl %edx, %fs -- SET_KERNEL_GS %edx -+ -+ /* Switch to kernel stack if necessary */ -+.if \switch_stacks > 0 -+ SWITCH_TO_KERNEL_STACK -+.endif -+ - .endm - - /* -@@ -261,6 +272,72 @@ - .Lend_\@: - #endif /* CONFIG_X86_ESPFIX32 */ - .endm -+ -+ -+/* -+ * Called with pt_regs fully populated and kernel segments loaded, -+ * so we can access PER_CPU and use the integer registers. -+ * -+ * We need to be very careful here with the %esp switch, because an NMI -+ * can happen everywhere. If the NMI handler finds itself on the -+ * entry-stack, it will overwrite the task-stack and everything we -+ * copied there. So allocate the stack-frame on the task-stack and -+ * switch to it before we do any copying. -+ */ -+.macro SWITCH_TO_KERNEL_STACK -+ -+ ALTERNATIVE "", "jmp .Lend_\@", X86_FEATURE_XENPV -+ -+ /* Are we on the entry stack? Bail out if not! */ -+ movl PER_CPU_VAR(cpu_entry_area), %edi -+ addl $CPU_ENTRY_AREA_entry_stack, %edi -+ cmpl %esp, %edi -+ jae .Lend_\@ -+ -+ /* Load stack pointer into %esi and %edi */ -+ movl %esp, %esi -+ movl %esi, %edi -+ -+ /* Move %edi to the top of the entry stack */ -+ andl $(MASK_entry_stack), %edi -+ addl $(SIZEOF_entry_stack), %edi -+ -+ /* Load top of task-stack into %edi */ -+ movl TSS_entry_stack(%edi), %edi -+ -+ /* Bytes to copy */ -+ movl $PTREGS_SIZE, %ecx -+ -+#ifdef CONFIG_VM86 -+ testl $X86_EFLAGS_VM, PT_EFLAGS(%esi) -+ jz .Lcopy_pt_regs_\@ -+ -+ /* -+ * Stack-frame contains 4 additional segment registers when -+ * coming from VM86 mode -+ */ -+ addl $(4 * 4), %ecx -+ -+.Lcopy_pt_regs_\@: -+#endif -+ -+ /* Allocate frame on task-stack */ -+ subl %ecx, %edi -+ -+ /* Switch to task-stack */ -+ movl %edi, %esp -+ -+ /* -+ * We are now on the task-stack and can safely copy over the -+ * stack-frame -+ */ -+ shrl $2, %ecx -+ cld -+ rep movsl -+ -+.Lend_\@: -+.endm -+ - /* - * %eax: prev task - * %edx: next task -@@ -454,6 +531,7 @@ ENTRY(xen_sysenter_target) - */ - ENTRY(entry_SYSENTER_32) - movl TSS_entry_stack(%esp), %esp -+ - .Lsysenter_past_esp: - pushl $__USER_DS /* pt_regs->ss */ - pushl %ebp /* pt_regs->sp (stashed in bp) */ -@@ -462,7 +540,7 @@ ENTRY(entry_SYSENTER_32) - pushl $__USER_CS /* pt_regs->cs */ - pushl $0 /* pt_regs->ip = 0 (placeholder) */ - pushl %eax /* pt_regs->orig_ax */ -- SAVE_ALL pt_regs_ax=$-ENOSYS /* save rest */ -+ SAVE_ALL pt_regs_ax=$-ENOSYS /* save rest, stack already switched */ - - /* - * SYSENTER doesn't filter flags, so we need to clear NT, AC -@@ -573,7 +651,8 @@ ENDPROC(entry_SYSENTER_32) - ENTRY(entry_INT80_32) - ASM_CLAC - pushl %eax /* pt_regs->orig_ax */ -- SAVE_ALL pt_regs_ax=$-ENOSYS /* save rest */ -+ -+ SAVE_ALL pt_regs_ax=$-ENOSYS switch_stacks=1 /* save rest */ - - /* - * User mode is traced as though IRQs are on, and the interrupt gate -@@ -665,7 +744,8 @@ END(irq_entries_start) - common_interrupt: - ASM_CLAC - addl $-0x80, (%esp) /* Adjust vector into the [-256, -1] range */ -- SAVE_ALL -+ -+ SAVE_ALL switch_stacks=1 - ENCODE_FRAME_POINTER - TRACE_IRQS_OFF - movl %esp, %eax -@@ -673,16 +753,16 @@ common_interrupt: - jmp ret_from_intr - ENDPROC(common_interrupt) - --#define BUILD_INTERRUPT3(name, nr, fn) \ --ENTRY(name) \ -- ASM_CLAC; \ -- pushl $~(nr); \ -- SAVE_ALL; \ -- ENCODE_FRAME_POINTER; \ -- TRACE_IRQS_OFF \ -- movl %esp, %eax; \ -- call fn; \ -- jmp ret_from_intr; \ -+#define BUILD_INTERRUPT3(name, nr, fn) \ -+ENTRY(name) \ -+ ASM_CLAC; \ -+ pushl $~(nr); \ -+ SAVE_ALL switch_stacks=1; \ -+ ENCODE_FRAME_POINTER; \ -+ TRACE_IRQS_OFF \ -+ movl %esp, %eax; \ -+ call fn; \ -+ jmp ret_from_intr; \ - ENDPROC(name) - - #define BUILD_INTERRUPT(name, nr) \ -@@ -908,16 +988,20 @@ common_exception: - pushl %es - pushl %ds - pushl %eax -+ movl $(__USER_DS), %eax -+ movl %eax, %ds -+ movl %eax, %es -+ movl $(__KERNEL_PERCPU), %eax -+ movl %eax, %fs - pushl %ebp - pushl %edi - pushl %esi - pushl %edx - pushl %ecx - pushl %ebx -+ SWITCH_TO_KERNEL_STACK - ENCODE_FRAME_POINTER - cld -- movl $(__KERNEL_PERCPU), %ecx -- movl %ecx, %fs - UNWIND_ESPFIX_STACK - GS_TO_REG %ecx - movl PT_GS(%esp), %edi # get the function address -@@ -925,9 +1009,6 @@ common_exception: - movl $-1, PT_ORIG_EAX(%esp) # no syscall to restart - REG_TO_PTGS %ecx - SET_KERNEL_GS %ecx -- movl $(__USER_DS), %ecx -- movl %ecx, %ds -- movl %ecx, %es - TRACE_IRQS_OFF - movl %esp, %eax # pt_regs pointer - CALL_NOSPEC %edi -@@ -946,6 +1027,7 @@ ENTRY(debug) - */ - ASM_CLAC - pushl $-1 # mark this as an int -+ - SAVE_ALL - ENCODE_FRAME_POINTER - xorl %edx, %edx # error code 0 -@@ -981,6 +1063,7 @@ END(debug) - */ - ENTRY(nmi) - ASM_CLAC -+ - #ifdef CONFIG_X86_ESPFIX32 - pushl %eax - movl %ss, %eax -@@ -1048,7 +1131,8 @@ END(nmi) - ENTRY(int3) - ASM_CLAC - pushl $-1 # mark this as an int -- SAVE_ALL -+ -+ SAVE_ALL switch_stacks=1 - ENCODE_FRAME_POINTER - TRACE_IRQS_OFF - xorl %edx, %edx # zero error code -diff --git a/arch/x86/include/asm/switch_to.h b/arch/x86/include/asm/switch_to.h -index eb5f7999a893..20e5f7ab8260 100644 ---- a/arch/x86/include/asm/switch_to.h -+++ b/arch/x86/include/asm/switch_to.h -@@ -89,13 +89,9 @@ static inline void refresh_sysenter_cs(struct thread_struct *thread) - /* This is used when switching tasks or entering/exiting vm86 mode. */ - static inline void update_sp0(struct task_struct *task) - { -- /* On x86_64, sp0 always points to the entry trampoline stack, which is constant: */ --#ifdef CONFIG_X86_32 -- load_sp0(task->thread.sp0); --#else -+ /* sp0 always points to the entry trampoline stack, which is constant: */ - if (static_cpu_has(X86_FEATURE_XENPV)) - load_sp0(task_top_of_stack(task)); --#endif - } - - #endif /* _ASM_X86_SWITCH_TO_H */ -diff --git a/arch/x86/kernel/asm-offsets.c b/arch/x86/kernel/asm-offsets.c -index 232152ccb301..86f06e808d02 100644 ---- a/arch/x86/kernel/asm-offsets.c -+++ b/arch/x86/kernel/asm-offsets.c -@@ -103,6 +103,7 @@ void common(void) { - OFFSET(CPU_ENTRY_AREA_entry_trampoline, cpu_entry_area, entry_trampoline); - OFFSET(CPU_ENTRY_AREA_entry_stack, cpu_entry_area, entry_stack_page); - DEFINE(SIZEOF_entry_stack, sizeof(struct entry_stack)); -+ DEFINE(MASK_entry_stack, (~(sizeof(struct entry_stack) - 1))); - - /* Offset for sp0 and sp1 into the tss_struct */ - OFFSET(TSS_sp0, tss_struct, x86_tss.sp0); -diff --git a/arch/x86/kernel/cpu/common.c b/arch/x86/kernel/cpu/common.c -index d63f4b5706e4..a0ed3481f2eb 100644 ---- a/arch/x86/kernel/cpu/common.c -+++ b/arch/x86/kernel/cpu/common.c -@@ -1709,11 +1709,12 @@ void cpu_init(void) - enter_lazy_tlb(&init_mm, curr); - - /* -- * Initialize the TSS. Don't bother initializing sp0, as the initial -- * task never enters user mode. -+ * Initialize the TSS. sp0 points to the entry trampoline stack -+ * regardless of what task is running. - */ - set_tss_desc(cpu, &get_cpu_entry_area(cpu)->tss.x86_tss); - load_TR_desc(); -+ load_sp0((unsigned long)(cpu_entry_stack(cpu) + 1)); - - load_mm_ldt(&init_mm); - -diff --git a/arch/x86/kernel/process.c b/arch/x86/kernel/process.c -index cb368c2a22ab..7fab4fa7655d 100644 ---- a/arch/x86/kernel/process.c -+++ b/arch/x86/kernel/process.c -@@ -57,14 +57,12 @@ __visible DEFINE_PER_CPU_PAGE_ALIGNED(struct tss_struct, cpu_tss_rw) = { - */ - .sp0 = (1UL << (BITS_PER_LONG-1)) + 1, - --#ifdef CONFIG_X86_64 - /* - * .sp1 is cpu_current_top_of_stack. The init task never - * runs user code, but cpu_current_top_of_stack should still - * be well defined before the first context switch. - */ - .sp1 = TOP_OF_INIT_STACK, --#endif - - #ifdef CONFIG_X86_32 - .ss0 = __KERNEL_DS, -diff --git a/arch/x86/kernel/process_32.c b/arch/x86/kernel/process_32.c -index 097d36a64889..3f3a8c620c63 100644 ---- a/arch/x86/kernel/process_32.c -+++ b/arch/x86/kernel/process_32.c -@@ -289,10 +289,12 @@ __switch_to(struct task_struct *prev_p, struct task_struct *next_p) - */ - update_sp0(next_p); - refresh_sysenter_cs(next); -- this_cpu_write(cpu_current_top_of_stack, -- (unsigned long)task_stack_page(next_p) + -- THREAD_SIZE); -- /* SYSENTER reads the task-stack from tss.sp1 */ -+ this_cpu_write(cpu_current_top_of_stack, task_top_of_stack(next_p)); -+ /* -+ * TODO: Find a way to let cpu_current_top_of_stack point to -+ * cpu_tss_rw.x86_tss.sp1. Doing so now results in stack corruption with -+ * iret exceptions. -+ */ - this_cpu_write(cpu_tss_rw.x86_tss.sp1, next_p->thread.sp0); - - /* --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0009-x86-entry-32-Leave-the-kernel-via-trampoline-stack.patch b/kernel/kernel/files/patches/mageia/pti32bit-0009-x86-entry-32-Leave-the-kernel-via-trampoline-stack.patch deleted file mode 100644 index d49e9396..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0009-x86-entry-32-Leave-the-kernel-via-trampoline-stack.patch +++ /dev/null @@ -1,137 +0,0 @@ -From af8c0db250e710c6ecd19a83bd8b57da44662041 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 11:28:30 +0100 -Subject: [PATCH 09/34] x86/entry/32: Leave the kernel via trampoline stack - -Switch back to the trampoline stack before returning to -userspace. - -Signed-off-by: Joerg Roedel ---- - arch/x86/entry/entry_32.S | 79 +++++++++++++++++++++++++++++++++++++++++++++-- - 1 file changed, 77 insertions(+), 2 deletions(-) - -diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S -index 1737da2e4517..1b5656d7040e 100644 ---- a/arch/x86/entry/entry_32.S -+++ b/arch/x86/entry/entry_32.S -@@ -338,6 +338,60 @@ - .Lend_\@: - .endm - -+/* -+ * Switch back from the kernel stack to the entry stack. -+ * -+ * The %esp register must point to pt_regs on the task stack. It will -+ * first calculate the size of the stack-frame to copy, depending on -+ * whether we return to VM86 mode or not. With that it uses 'rep movsl' -+ * to copy the contents of the stack over to the entry stack. -+ * -+ * We must be very careful here, as we can't trust the contents of the -+ * task-stack once we switched to the entry-stack. When an NMI happens -+ * while on the entry-stack, the NMI handler will switch back to the top -+ * of the task stack, overwriting our stack-frame we are about to copy. -+ * Therefore we switch the stack only after everything is copied over. -+ */ -+.macro SWITCH_TO_ENTRY_STACK -+ -+ ALTERNATIVE "", "jmp .Lend_\@", X86_FEATURE_XENPV -+ -+ /* Bytes to copy */ -+ movl $PTREGS_SIZE, %ecx -+ -+#ifdef CONFIG_VM86 -+ testl $(X86_EFLAGS_VM), PT_EFLAGS(%esp) -+ jz .Lcopy_pt_regs_\@ -+ -+ /* Additional 4 registers to copy when returning to VM86 mode */ -+ addl $(4 * 4), %ecx -+ -+.Lcopy_pt_regs_\@: -+#endif -+ -+ /* Initialize source and destination for movsb */ -+ movl PER_CPU_VAR(cpu_tss_rw + TSS_sp0), %edi -+ subl %ecx, %edi -+ movl %esp, %esi -+ -+ /* Save future stack pointer in %ebx */ -+ movl %edi, %ebx -+ -+ /* Copy over the stack-frame */ -+ shrl $2, %ecx -+ cld -+ rep movsl -+ -+ /* -+ * Switch to entry-stack - needs to happen after everything is -+ * copied because the NMI handler will overwrite the task-stack -+ * when on entry-stack -+ */ -+ movl %ebx, %esp -+ -+.Lend_\@: -+.endm -+ - /* - * %eax: prev task - * %edx: next task -@@ -579,25 +633,45 @@ ENTRY(entry_SYSENTER_32) - - /* Opportunistic SYSEXIT */ - TRACE_IRQS_ON /* User mode traces as IRQs on. */ -+ -+ /* -+ * Setup entry stack - we keep the pointer in %eax and do the -+ * switch after almost all user-state is restored. -+ */ -+ -+ /* Load entry stack pointer and allocate frame for eflags/eax */ -+ movl PER_CPU_VAR(cpu_tss_rw + TSS_sp0), %eax -+ subl $(2*4), %eax -+ -+ /* Copy eflags and eax to entry stack */ -+ movl PT_EFLAGS(%esp), %edi -+ movl PT_EAX(%esp), %esi -+ movl %edi, (%eax) -+ movl %esi, 4(%eax) -+ -+ /* Restore user registers and segments */ - movl PT_EIP(%esp), %edx /* pt_regs->ip */ - movl PT_OLDESP(%esp), %ecx /* pt_regs->sp */ - 1: mov PT_FS(%esp), %fs - PTGS_TO_GS -+ - popl %ebx /* pt_regs->bx */ - addl $2*4, %esp /* skip pt_regs->cx and pt_regs->dx */ - popl %esi /* pt_regs->si */ - popl %edi /* pt_regs->di */ - popl %ebp /* pt_regs->bp */ -- popl %eax /* pt_regs->ax */ -+ -+ /* Switch to entry stack */ -+ movl %eax, %esp - - /* - * Restore all flags except IF. (We restore IF separately because - * STI gives a one-instruction window in which we won't be interrupted, - * whereas POPF does not.) - */ -- addl $PT_EFLAGS-PT_DS, %esp /* point esp at pt_regs->flags */ - btr $X86_EFLAGS_IF_BIT, (%esp) - popfl -+ popl %eax - - /* - * Return back to the vDSO, which will pop ecx and edx. -@@ -666,6 +740,7 @@ ENTRY(entry_INT80_32) - - restore_all: - TRACE_IRQS_IRET -+ SWITCH_TO_ENTRY_STACK - .Lrestore_all_notrace: - CHECK_AND_APPLY_ESPFIX - .Lrestore_nocheck: --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0010-x86-entry-32-Introduce-SAVE_ALL_NMI-and-RESTORE_ALL_.patch b/kernel/kernel/files/patches/mageia/pti32bit-0010-x86-entry-32-Introduce-SAVE_ALL_NMI-and-RESTORE_ALL_.patch deleted file mode 100644 index b45bb7b1..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0010-x86-entry-32-Introduce-SAVE_ALL_NMI-and-RESTORE_ALL_.patch +++ /dev/null @@ -1,84 +0,0 @@ -From 49a15ace3cbe2fba45548538ede04c1599b33fb9 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Wed, 31 Jan 2018 16:35:42 +0100 -Subject: [PATCH 10/34] x86/entry/32: Introduce SAVE_ALL_NMI and - RESTORE_ALL_NMI - -These macros will be used in the NMI handler code and -replace plain SAVE_ALL and RESTORE_REGS there. We will add -the NMI-specific CR3-switch to these macros later. - -Signed-off-by: Joerg Roedel ---- - arch/x86/entry/entry_32.S | 23 +++++++++++++++++++---- - 1 file changed, 19 insertions(+), 4 deletions(-) - -diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S -index 1b5656d7040e..bb0bd896c74b 100644 ---- a/arch/x86/entry/entry_32.S -+++ b/arch/x86/entry/entry_32.S -@@ -167,6 +167,9 @@ - - .endm - -+.macro SAVE_ALL_NMI -+ SAVE_ALL -+.endm - /* - * This is a sneaky trick to help the unwinder find pt_regs on the stack. The - * frame pointer is replaced with an encoded pointer to pt_regs. The encoding -@@ -224,6 +227,18 @@ - RESTORE_SKIP_SEGMENTS \pop - .endm - -+.macro RESTORE_ALL_NMI pop=0 -+ /* -+ * Restore segments - might cause exceptions when loading -+ * user-space segments -+ */ -+ RESTORE_SEGMENTS -+ -+ /* Restore integer registers and unwind stack to iret frame */ -+ RESTORE_INT_REGS -+ RESTORE_SKIP_SEGMENTS \pop -+.endm -+ - .macro CHECK_AND_APPLY_ESPFIX - #ifdef CONFIG_X86_ESPFIX32 - #define GDT_ESPFIX_SS PER_CPU_VAR(gdt_page) + (GDT_ENTRY_ESPFIX_SS * 8) -@@ -1148,7 +1163,7 @@ ENTRY(nmi) - #endif - - pushl %eax # pt_regs->orig_ax -- SAVE_ALL -+ SAVE_ALL_NMI - ENCODE_FRAME_POINTER - xorl %edx, %edx # zero error code - movl %esp, %eax # pt_regs pointer -@@ -1176,7 +1191,7 @@ ENTRY(nmi) - - .Lnmi_return: - CHECK_AND_APPLY_ESPFIX -- RESTORE_REGS 4 -+ RESTORE_ALL_NMI pop=4 - jmp .Lirq_return - - #ifdef CONFIG_X86_ESPFIX32 -@@ -1192,12 +1207,12 @@ ENTRY(nmi) - pushl 16(%esp) - .endr - pushl %eax -- SAVE_ALL -+ SAVE_ALL_NMI - ENCODE_FRAME_POINTER - FIXUP_ESPFIX_STACK # %eax == %esp - xorl %edx, %edx # zero error code - call do_nmi -- RESTORE_REGS -+ RESTORE_ALL_NMI - lss 12+4(%esp), %esp # back to espfix stack - jmp .Lirq_return - #endif --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0011-x86-entry-32-Handle-Entry-from-Kernel-Mode-on-Entry-.patch b/kernel/kernel/files/patches/mageia/pti32bit-0011-x86-entry-32-Handle-Entry-from-Kernel-Mode-on-Entry-.patch deleted file mode 100644 index c96d7a6e..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0011-x86-entry-32-Handle-Entry-from-Kernel-Mode-on-Entry-.patch +++ /dev/null @@ -1,198 +0,0 @@ -From bbad1145165d4ed4452913df109ee3429a10dd90 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Wed, 31 Jan 2018 20:48:02 +0100 -Subject: [PATCH 11/34] x86/entry/32: Handle Entry from Kernel-Mode on - Entry-Stack - -It can happen that we enter the kernel from kernel-mode and -on the entry-stack. The most common way this happens is when -we get an exception while loading the user-space segment -registers on the kernel-to-userspace exit path. - -The segment loading needs to be done after the entry-stack -switch, because the stack-switch needs kernel %fs for -per_cpu access. - -When this happens, we need to make sure that we leave the -kernel with the entry-stack again, so that the interrupted -code-path runs on the right stack when switching to the -user-cr3. - -We do this by detecting this condition on kernel-entry by -checking CS.RPL and %esp, and if it happens, we copy over -the complete content of the entry stack to the task-stack. -This needs to be done because once we enter the exception -handlers we might be scheduled out or even migrated to a -different CPU, so that we can't rely on the entry-stack -contents. We also leave a marker in the stack-frame to -detect this condition on the exit path. - -On the exit path the copy is reversed, we copy all of the -remaining task-stack back to the entry-stack and switch -to it. - -Signed-off-by: Joerg Roedel ---- - arch/x86/entry/entry_32.S | 110 +++++++++++++++++++++++++++++++++++++++++++++- - 1 file changed, 109 insertions(+), 1 deletion(-) - -diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S -index bb0bd896c74b..3a84945fa3b6 100644 ---- a/arch/x86/entry/entry_32.S -+++ b/arch/x86/entry/entry_32.S -@@ -299,6 +299,9 @@ - * copied there. So allocate the stack-frame on the task-stack and - * switch to it before we do any copying. - */ -+ -+#define CS_FROM_ENTRY_STACK (1 << 31) -+ - .macro SWITCH_TO_KERNEL_STACK - - ALTERNATIVE "", "jmp .Lend_\@", X86_FEATURE_XENPV -@@ -320,6 +323,10 @@ - /* Load top of task-stack into %edi */ - movl TSS_entry_stack(%edi), %edi - -+ /* Special case - entry from kernel mode via entry stack */ -+ testl $SEGMENT_RPL_MASK, PT_CS(%esp) -+ jz .Lentry_from_kernel_\@ -+ - /* Bytes to copy */ - movl $PTREGS_SIZE, %ecx - -@@ -333,8 +340,8 @@ - */ - addl $(4 * 4), %ecx - --.Lcopy_pt_regs_\@: - #endif -+.Lcopy_pt_regs_\@: - - /* Allocate frame on task-stack */ - subl %ecx, %edi -@@ -350,6 +357,56 @@ - cld - rep movsl - -+ jmp .Lend_\@ -+ -+.Lentry_from_kernel_\@: -+ -+ /* -+ * This handles the case when we enter the kernel from -+ * kernel-mode and %esp points to the entry-stack. When this -+ * happens we need to switch to the task-stack to run C code, -+ * but switch back to the entry-stack again when we approach -+ * iret and return to the interrupted code-path. This usually -+ * happens when we hit an exception while restoring user-space -+ * segment registers on the way back to user-space. -+ * -+ * When we switch to the task-stack here, we can't trust the -+ * contents of the entry-stack anymore, as the exception handler -+ * might be scheduled out or moved to another CPU. Therefore we -+ * copy the complete entry-stack to the task-stack and set a -+ * marker in the iret-frame (bit 31 of the CS dword) to detect -+ * what we've done on the iret path. -+ * -+ * On the iret path we copy everything back and switch to the -+ * entry-stack, so that the interrupted kernel code-path -+ * continues on the same stack it was interrupted with. -+ * -+ * Be aware that an NMI can happen anytime in this code. -+ * -+ * %esi: Entry-Stack pointer (same as %esp) -+ * %edi: Top of the task stack -+ */ -+ -+ /* Calculate number of bytes on the entry stack in %ecx */ -+ movl %esi, %ecx -+ -+ /* %ecx to the top of entry-stack */ -+ andl $(MASK_entry_stack), %ecx -+ addl $(SIZEOF_entry_stack), %ecx -+ -+ /* Number of bytes on the entry stack to %ecx */ -+ sub %esi, %ecx -+ -+ /* Mark stackframe as coming from entry stack */ -+ orl $CS_FROM_ENTRY_STACK, PT_CS(%esp) -+ -+ /* -+ * %esi and %edi are unchanged, %ecx contains the number of -+ * bytes to copy. The code at .Lcopy_pt_regs_\@ will allocate -+ * the stack-frame on task-stack and copy everything over -+ */ -+ jmp .Lcopy_pt_regs_\@ -+ - .Lend_\@: - .endm - -@@ -407,6 +464,56 @@ - .Lend_\@: - .endm - -+/* -+ * This macro handles the case when we return to kernel-mode on the iret -+ * path and have to switch back to the entry stack. -+ * -+ * See the comments below the .Lentry_from_kernel_\@ label in the -+ * SWITCH_TO_KERNEL_STACK macro for more details. -+ */ -+.macro PARANOID_EXIT_TO_KERNEL_MODE -+ -+ /* -+ * Test if we entered the kernel with the entry-stack. Most -+ * likely we did not, because this code only runs on the -+ * return-to-kernel path. -+ */ -+ testl $CS_FROM_ENTRY_STACK, PT_CS(%esp) -+ jz .Lend_\@ -+ -+ /* Unlikely slow-path */ -+ -+ /* Clear marker from stack-frame */ -+ andl $(~CS_FROM_ENTRY_STACK), PT_CS(%esp) -+ -+ /* Copy the remaining task-stack contents to entry-stack */ -+ movl %esp, %esi -+ movl PER_CPU_VAR(cpu_tss_rw + TSS_sp0), %edi -+ -+ /* Bytes on the task-stack to ecx */ -+ movl PER_CPU_VAR(cpu_current_top_of_stack), %ecx -+ subl %esi, %ecx -+ -+ /* Allocate stack-frame on entry-stack */ -+ subl %ecx, %edi -+ -+ /* -+ * Save future stack-pointer, we must not switch until the -+ * copy is done, otherwise the NMI handler could destroy the -+ * contents of the task-stack we are about to copy. -+ */ -+ movl %edi, %ebx -+ -+ /* Do the copy */ -+ shrl $2, %ecx -+ cld -+ rep movsl -+ -+ /* Safe to switch to entry-stack now */ -+ movl %ebx, %esp -+ -+.Lend_\@: -+.endm - /* - * %eax: prev task - * %edx: next task -@@ -765,6 +872,7 @@ restore_all: - - restore_all_kernel: - TRACE_IRQS_IRET -+ PARANOID_EXIT_TO_KERNEL_MODE - RESTORE_REGS 4 - jmp .Lirq_return - --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0012-x86-entry-32-Simplify-debug-entry-point.patch b/kernel/kernel/files/patches/mageia/pti32bit-0012-x86-entry-32-Simplify-debug-entry-point.patch deleted file mode 100644 index 803fb485..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0012-x86-entry-32-Simplify-debug-entry-point.patch +++ /dev/null @@ -1,69 +0,0 @@ -From 8743506d5153928d0a0fb4106470a6581d03796d Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Thu, 1 Mar 2018 14:48:16 +0100 -Subject: [PATCH 12/34] x86/entry/32: Simplify debug entry point - -The common exception entry code now handles the -entry-from-sysenter stack situation and makes sure to leave -with the same stack as it entered the kernel. - -So there is no need anymore for the special handling in the -debug entry code. - -Signed-off-by: Joerg Roedel ---- - arch/x86/entry/entry_32.S | 35 +++-------------------------------- - 1 file changed, 3 insertions(+), 32 deletions(-) - -diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S -index 3a84945fa3b6..b1a5f34eeb27 100644 ---- a/arch/x86/entry/entry_32.S -+++ b/arch/x86/entry/entry_32.S -@@ -1215,41 +1215,12 @@ END(common_exception) - - ENTRY(debug) - /* -- * #DB can happen at the first instruction of -- * entry_SYSENTER_32 or in Xen's SYSENTER prologue. If this -- * happens, then we will be running on a very small stack. We -- * need to detect this condition and switch to the thread -- * stack before calling any C code at all. -- * -- * If you edit this code, keep in mind that NMIs can happen in here. -+ * Entry from sysenter is now handled in common_exception - */ - ASM_CLAC - pushl $-1 # mark this as an int -- -- SAVE_ALL -- ENCODE_FRAME_POINTER -- xorl %edx, %edx # error code 0 -- movl %esp, %eax # pt_regs pointer -- -- /* Are we currently on the SYSENTER stack? */ -- movl PER_CPU_VAR(cpu_entry_area), %ecx -- addl $CPU_ENTRY_AREA_entry_stack + SIZEOF_entry_stack, %ecx -- subl %eax, %ecx /* ecx = (end of entry_stack) - esp */ -- cmpl $SIZEOF_entry_stack, %ecx -- jb .Ldebug_from_sysenter_stack -- -- TRACE_IRQS_OFF -- call do_debug -- jmp ret_from_exception -- --.Ldebug_from_sysenter_stack: -- /* We're on the SYSENTER stack. Switch off. */ -- movl %esp, %ebx -- movl PER_CPU_VAR(cpu_current_top_of_stack), %esp -- TRACE_IRQS_OFF -- call do_debug -- movl %ebx, %esp -- jmp ret_from_exception -+ pushl $do_debug -+ jmp common_exception - END(debug) - - /* --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0013-x86-entry-32-Add-PTI-cr3-switches-to-NMI-handler-cod.patch b/kernel/kernel/files/patches/mageia/pti32bit-0013-x86-entry-32-Add-PTI-cr3-switches-to-NMI-handler-cod.patch deleted file mode 100644 index 3ecd0997..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0013-x86-entry-32-Add-PTI-cr3-switches-to-NMI-handler-cod.patch +++ /dev/null @@ -1,127 +0,0 @@ -From 41bc2c77864b5464134c3ec722225a9ae4701968 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Wed, 31 Jan 2018 16:58:57 +0100 -Subject: [PATCH 13/34] x86/entry/32: Add PTI cr3 switches to NMI handler code - -The NMI handler is special, as it needs to leave with the -same cr3 as it was entered with. We need to do this because -we could enter the NMI handler from kernel code with -user-cr3 already loaded. - -Signed-off-by: Joerg Roedel ---- - arch/x86/entry/entry_32.S | 52 +++++++++++++++++++++++++++++++++++++++++------ - 1 file changed, 46 insertions(+), 6 deletions(-) - -diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S -index b1a5f34eeb27..35379e5f60c6 100644 ---- a/arch/x86/entry/entry_32.S -+++ b/arch/x86/entry/entry_32.S -@@ -77,6 +77,8 @@ - #endif - .endm - -+#define PTI_SWITCH_MASK (1 << PAGE_SHIFT) -+ - /* - * User gs save/restore - * -@@ -167,8 +169,30 @@ - - .endm - --.macro SAVE_ALL_NMI -+.macro SAVE_ALL_NMI cr3_reg:req - SAVE_ALL -+ -+ /* -+ * Now switch the CR3 when PTI is enabled. -+ * -+ * We can enter with either user or kernel cr3, the code will -+ * store the old cr3 in \cr3_reg and switches to the kernel cr3 -+ * if necessary. -+ */ -+ ALTERNATIVE "jmp .Lend_\@", "", X86_FEATURE_PTI -+ -+ movl %cr3, \cr3_reg -+ testl $PTI_SWITCH_MASK, \cr3_reg -+ jz .Lend_\@ /* Already on kernel cr3 */ -+ -+ /* On user cr3 - write new kernel cr3 */ -+ andl $(~PTI_SWITCH_MASK), \cr3_reg -+ movl \cr3_reg, %cr3 -+ -+ /* Restore user cr3 value */ -+ orl $PTI_SWITCH_MASK, \cr3_reg -+ -+.Lend_\@: - .endm - /* - * This is a sneaky trick to help the unwinder find pt_regs on the stack. The -@@ -227,13 +251,29 @@ - RESTORE_SKIP_SEGMENTS \pop - .endm - --.macro RESTORE_ALL_NMI pop=0 -+.macro RESTORE_ALL_NMI cr3_reg:req pop=0 - /* - * Restore segments - might cause exceptions when loading - * user-space segments - */ - RESTORE_SEGMENTS - -+ /* -+ * Now switch the CR3 when PTI is enabled. -+ * -+ * We enter with kernel cr3 and switch the cr3 to the value -+ * stored on \cr3_reg, which is either a user or a kernel cr3. -+ */ -+ ALTERNATIVE "jmp .Lswitched_\@", "", X86_FEATURE_PTI -+ -+ testl $PTI_SWITCH_MASK, \cr3_reg -+ jz .Lswitched_\@ -+ -+ /* User cr3 in \cr3_reg - write it to hardware cr3 */ -+ movl \cr3_reg, %cr3 -+ -+.Lswitched_\@: -+ - /* Restore integer registers and unwind stack to iret frame */ - RESTORE_INT_REGS - RESTORE_SKIP_SEGMENTS \pop -@@ -1242,7 +1282,7 @@ ENTRY(nmi) - #endif - - pushl %eax # pt_regs->orig_ax -- SAVE_ALL_NMI -+ SAVE_ALL_NMI cr3_reg=%edi - ENCODE_FRAME_POINTER - xorl %edx, %edx # zero error code - movl %esp, %eax # pt_regs pointer -@@ -1270,7 +1310,7 @@ ENTRY(nmi) - - .Lnmi_return: - CHECK_AND_APPLY_ESPFIX -- RESTORE_ALL_NMI pop=4 -+ RESTORE_ALL_NMI cr3_reg=%edi pop=4 - jmp .Lirq_return - - #ifdef CONFIG_X86_ESPFIX32 -@@ -1286,12 +1326,12 @@ ENTRY(nmi) - pushl 16(%esp) - .endr - pushl %eax -- SAVE_ALL_NMI -+ SAVE_ALL_NMI cr3_reg=%edi - ENCODE_FRAME_POINTER - FIXUP_ESPFIX_STACK # %eax == %esp - xorl %edx, %edx # zero error code - call do_nmi -- RESTORE_ALL_NMI -+ RESTORE_ALL_NMI cr3_reg=%edi - lss 12+4(%esp), %esp # back to espfix stack - jmp .Lirq_return - #endif --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0014-x86-entry-32-Add-PTI-cr3-switch-to-non-NMI-entry-exi.patch b/kernel/kernel/files/patches/mageia/pti32bit-0014-x86-entry-32-Add-PTI-cr3-switch-to-non-NMI-entry-exi.patch deleted file mode 100644 index 7f9db488..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0014-x86-entry-32-Add-PTI-cr3-switch-to-non-NMI-entry-exi.patch +++ /dev/null @@ -1,187 +0,0 @@ -From d40791fdb56c15767c7c65a1a2e0c8736f3db0af Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Wed, 31 Jan 2018 17:22:10 +0100 -Subject: [PATCH 14/34] x86/entry/32: Add PTI cr3 switch to non-NMI entry/exit - points - -Add unconditional cr3 switches between user and kernel cr3 -to all non-NMI entry and exit points. - -Signed-off-by: Joerg Roedel ---- - arch/x86/entry/entry_32.S | 91 +++++++++++++++++++++++++++++++++++++++++++++-- - 1 file changed, 88 insertions(+), 3 deletions(-) - -diff --git a/arch/x86/entry/entry_32.S b/arch/x86/entry/entry_32.S -index 35379e5f60c6..8f78abcf1f9c 100644 ---- a/arch/x86/entry/entry_32.S -+++ b/arch/x86/entry/entry_32.S -@@ -328,6 +328,30 @@ - #endif /* CONFIG_X86_ESPFIX32 */ - .endm - -+/* Unconditionally switch to user cr3 */ -+.macro SWITCH_TO_USER_CR3 scratch_reg:req -+ ALTERNATIVE "jmp .Lend_\@", "", X86_FEATURE_PTI -+ -+ movl %cr3, \scratch_reg -+ orl $PTI_SWITCH_MASK, \scratch_reg -+ movl \scratch_reg, %cr3 -+.Lend_\@: -+.endm -+ -+/* Unconditionally switch to kernel cr3 */ -+.macro SWITCH_TO_KERNEL_CR3 scratch_reg:req -+ ALTERNATIVE "jmp .Lend_\@", "", X86_FEATURE_PTI -+ movl %cr3, \scratch_reg -+ /* Test if we are already on kernel CR3 */ -+ testl $PTI_SWITCH_MASK, \scratch_reg -+ jz .Lend_\@ -+ andl $(~PTI_SWITCH_MASK), \scratch_reg -+ movl \scratch_reg, %cr3 -+ /* Return original CR3 in \scratch_reg */ -+ orl $PTI_SWITCH_MASK, \scratch_reg -+.Lend_\@: -+.endm -+ - - /* - * Called with pt_regs fully populated and kernel segments loaded, -@@ -341,11 +365,19 @@ - */ - - #define CS_FROM_ENTRY_STACK (1 << 31) -+#define CS_FROM_USER_CR3 (1 << 30) - - .macro SWITCH_TO_KERNEL_STACK - - ALTERNATIVE "", "jmp .Lend_\@", X86_FEATURE_XENPV - -+ SWITCH_TO_KERNEL_CR3 scratch_reg=%eax -+ -+ /* -+ * %eax now contains the entry cr3 and we carry it forward in -+ * that register for the time this macro runs -+ */ -+ - /* Are we on the entry stack? Bail out if not! */ - movl PER_CPU_VAR(cpu_entry_area), %edi - addl $CPU_ENTRY_AREA_entry_stack, %edi -@@ -408,7 +440,8 @@ - * but switch back to the entry-stack again when we approach - * iret and return to the interrupted code-path. This usually - * happens when we hit an exception while restoring user-space -- * segment registers on the way back to user-space. -+ * segment registers on the way back to user-space or when the -+ * sysenter handler runs with eflags.tf set. - * - * When we switch to the task-stack here, we can't trust the - * contents of the entry-stack anymore, as the exception handler -@@ -425,6 +458,7 @@ - * - * %esi: Entry-Stack pointer (same as %esp) - * %edi: Top of the task stack -+ * %eax: CR3 on kernel entry - */ - - /* Calculate number of bytes on the entry stack in %ecx */ -@@ -440,6 +474,14 @@ - /* Mark stackframe as coming from entry stack */ - orl $CS_FROM_ENTRY_STACK, PT_CS(%esp) - -+ /* -+ * Test the cr3 used to enter the kernel and add a marker -+ * so that we can switch back to it before iret. -+ */ -+ testl $PTI_SWITCH_MASK, %eax -+ jz .Lcopy_pt_regs_\@ -+ orl $CS_FROM_USER_CR3, PT_CS(%esp) -+ - /* - * %esi and %edi are unchanged, %ecx contains the number of - * bytes to copy. The code at .Lcopy_pt_regs_\@ will allocate -@@ -506,7 +548,7 @@ - - /* - * This macro handles the case when we return to kernel-mode on the iret -- * path and have to switch back to the entry stack. -+ * path and have to switch back to the entry stack and/or user-cr3 - * - * See the comments below the .Lentry_from_kernel_\@ label in the - * SWITCH_TO_KERNEL_STACK macro for more details. -@@ -552,6 +594,18 @@ - /* Safe to switch to entry-stack now */ - movl %ebx, %esp - -+ /* -+ * We came from entry-stack and need to check if we also need to -+ * switch back to user cr3. -+ */ -+ testl $CS_FROM_USER_CR3, PT_CS(%esp) -+ jz .Lend_\@ -+ -+ /* Clear marker from stack-frame */ -+ andl $(~CS_FROM_USER_CR3), PT_CS(%esp) -+ -+ SWITCH_TO_USER_CR3 scratch_reg=%eax -+ - .Lend_\@: - .endm - /* -@@ -746,6 +800,18 @@ ENTRY(xen_sysenter_target) - * 0(%ebp) arg6 - */ - ENTRY(entry_SYSENTER_32) -+ /* -+ * On entry-stack with all userspace-regs live - save and -+ * restore eflags and %eax to use it as scratch-reg for the cr3 -+ * switch. -+ */ -+ pushfl -+ pushl %eax -+ SWITCH_TO_KERNEL_CR3 scratch_reg=%eax -+ popl %eax -+ popfl -+ -+ /* Stack empty again, switch to task stack */ - movl TSS_entry_stack(%esp), %esp - - .Lsysenter_past_esp: -@@ -826,6 +892,9 @@ ENTRY(entry_SYSENTER_32) - /* Switch to entry stack */ - movl %eax, %esp - -+ /* Now ready to switch the cr3 */ -+ SWITCH_TO_USER_CR3 scratch_reg=%eax -+ - /* - * Restore all flags except IF. (We restore IF separately because - * STI gives a one-instruction window in which we won't be interrupted, -@@ -906,7 +975,23 @@ restore_all: - .Lrestore_all_notrace: - CHECK_AND_APPLY_ESPFIX - .Lrestore_nocheck: -- RESTORE_REGS 4 # skip orig_eax/error_code -+ /* -+ * First restore user segments. This can cause exceptions, so we -+ * run it with kernel cr3. -+ */ -+ RESTORE_SEGMENTS -+ -+ /* -+ * Segments are restored - no more exceptions from here on except on -+ * iret, but that handled safely. -+ */ -+ SWITCH_TO_USER_CR3 scratch_reg=%eax -+ -+ /* Restore rest */ -+ RESTORE_INT_REGS -+ -+ /* Unwind stack to the iret frame */ -+ RESTORE_SKIP_SEGMENTS 4 # skip orig_eax/error_code - .Lirq_return: - INTERRUPT_RETURN - --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0015-x86-pgtable-Rename-pti_set_user_pgd-to-pti_set_user_.patch b/kernel/kernel/files/patches/mageia/pti32bit-0015-x86-pgtable-Rename-pti_set_user_pgd-to-pti_set_user_.patch deleted file mode 100644 index 60452628..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0015-x86-pgtable-Rename-pti_set_user_pgd-to-pti_set_user_.patch +++ /dev/null @@ -1,81 +0,0 @@ -From 55797d951b45c9eb709a4e7483eef89d738c2427 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Thu, 1 Mar 2018 13:40:39 +0100 -Subject: [PATCH 15/34] x86/pgtable: Rename pti_set_user_pgd to - pti_set_user_pgtbl - -With the way page-table folding is implemented on 32 bit, we -are not only setting PGDs with this functions, but also PUDs -and even PMDs. Give the function a more generic name to -reflect that. - -Signed-off-by: Joerg Roedel ---- - arch/x86/include/asm/pgtable_64.h | 12 ++++++------ - arch/x86/mm/pti.c | 2 +- - 2 files changed, 7 insertions(+), 7 deletions(-) - -diff --git a/arch/x86/include/asm/pgtable_64.h b/arch/x86/include/asm/pgtable_64.h -index 81462e9a34f6..b68bda56db67 100644 ---- a/arch/x86/include/asm/pgtable_64.h -+++ b/arch/x86/include/asm/pgtable_64.h -@@ -195,21 +195,21 @@ static inline bool pgdp_maps_userspace(void *__ptr) - } - - #ifdef CONFIG_PAGE_TABLE_ISOLATION --pgd_t __pti_set_user_pgd(pgd_t *pgdp, pgd_t pgd); -+pgd_t __pti_set_user_pgtbl(pgd_t *pgdp, pgd_t pgd); - - /* - * Take a PGD location (pgdp) and a pgd value that needs to be set there. - * Populates the user and returns the resulting PGD that must be set in - * the kernel copy of the page tables. - */ --static inline pgd_t pti_set_user_pgd(pgd_t *pgdp, pgd_t pgd) -+static inline pgd_t pti_set_user_pgtbl(pgd_t *pgdp, pgd_t pgd) - { - if (!static_cpu_has(X86_FEATURE_PTI)) - return pgd; -- return __pti_set_user_pgd(pgdp, pgd); -+ return __pti_set_user_pgtbl(pgdp, pgd); - } - #else --static inline pgd_t pti_set_user_pgd(pgd_t *pgdp, pgd_t pgd) -+static inline pgd_t pti_set_user_pgtbl(pgd_t *pgdp, pgd_t pgd) - { - return pgd; - } -@@ -218,7 +218,7 @@ static inline pgd_t pti_set_user_pgd(pgd_t *pgdp, pgd_t pgd) - static inline void native_set_p4d(p4d_t *p4dp, p4d_t p4d) - { - #if defined(CONFIG_PAGE_TABLE_ISOLATION) && !defined(CONFIG_X86_5LEVEL) -- p4dp->pgd = pti_set_user_pgd(&p4dp->pgd, p4d.pgd); -+ p4dp->pgd = pti_set_user_pgtbl(&p4dp->pgd, p4d.pgd); - #else - *p4dp = p4d; - #endif -@@ -236,7 +236,7 @@ static inline void native_p4d_clear(p4d_t *p4d) - static inline void native_set_pgd(pgd_t *pgdp, pgd_t pgd) - { - #ifdef CONFIG_PAGE_TABLE_ISOLATION -- *pgdp = pti_set_user_pgd(pgdp, pgd); -+ *pgdp = pti_set_user_pgtbl(pgdp, pgd); - #else - *pgdp = pgd; - #endif -diff --git a/arch/x86/mm/pti.c b/arch/x86/mm/pti.c -index ce38f165489b..8f53d2101f64 100644 ---- a/arch/x86/mm/pti.c -+++ b/arch/x86/mm/pti.c -@@ -102,7 +102,7 @@ void __init pti_check_boottime_disable(void) - setup_force_cpu_cap(X86_FEATURE_PTI); - } - --pgd_t __pti_set_user_pgd(pgd_t *pgdp, pgd_t pgd) -+pgd_t __pti_set_user_pgtbl(pgd_t *pgdp, pgd_t pgd) - { - /* - * Changes to the high (kernel) portion of the kernelmode page --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0016-x86-pgtable-pae-Unshare-kernel-PMDs-when-PTI-is-enab.patch b/kernel/kernel/files/patches/mageia/pti32bit-0016-x86-pgtable-pae-Unshare-kernel-PMDs-when-PTI-is-enab.patch deleted file mode 100644 index dc9e750d..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0016-x86-pgtable-pae-Unshare-kernel-PMDs-when-PTI-is-enab.patch +++ /dev/null @@ -1,35 +0,0 @@ -From 5439accd9f31dacdfbf67a18440d5805e8a0bfad Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Fri, 2 Feb 2018 10:41:36 +0100 -Subject: [PATCH 16/34] x86/pgtable/pae: Unshare kernel PMDs when PTI is - enabled - -With PTI we need to map the per-process LDT into the kernel -address-space for each process, so we need separate kernel -PMDs per PGD. - -Signed-off-by: Joerg Roedel ---- - arch/x86/include/asm/pgtable-3level_types.h | 5 +++-- - 1 file changed, 3 insertions(+), 2 deletions(-) - -diff --git a/arch/x86/include/asm/pgtable-3level_types.h b/arch/x86/include/asm/pgtable-3level_types.h -index 876b4c77d983..ed8a200ecdaf 100644 ---- a/arch/x86/include/asm/pgtable-3level_types.h -+++ b/arch/x86/include/asm/pgtable-3level_types.h -@@ -21,9 +21,10 @@ typedef union { - #endif /* !__ASSEMBLY__ */ - - #ifdef CONFIG_PARAVIRT --#define SHARED_KERNEL_PMD (pv_info.shared_kernel_pmd) -+#define SHARED_KERNEL_PMD ((!static_cpu_has(X86_FEATURE_PTI) && \ -+ (pv_info.shared_kernel_pmd))) - #else --#define SHARED_KERNEL_PMD 1 -+#define SHARED_KERNEL_PMD (!static_cpu_has(X86_FEATURE_PTI)) - #endif - - /* --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0017-x86-pgtable-32-Allocate-8k-page-tables-when-PTI-is-e.patch b/kernel/kernel/files/patches/mageia/pti32bit-0017-x86-pgtable-32-Allocate-8k-page-tables-when-PTI-is-e.patch deleted file mode 100644 index 1cf7b9c7..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0017-x86-pgtable-32-Allocate-8k-page-tables-when-PTI-is-e.patch +++ /dev/null @@ -1,98 +0,0 @@ -From 35cdf0541e9d5c7a47b59530fc8a42ac9ab767f8 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 13:10:57 +0100 -Subject: [PATCH 17/34] x86/pgtable/32: Allocate 8k page-tables when PTI is - enabled - -Allocate a kernel and a user page-table root when PTI is -enabled. Also allocate a full page per root for PAE because -otherwise the bit to flip in cr3 to switch between them -would be non-constant, which creates a lot of hassle. -Keep that for a later optimization. - -Signed-off-by: Joerg Roedel ---- - arch/x86/kernel/head_32.S | 20 +++++++++++++++----- - arch/x86/mm/pgtable.c | 5 +++-- - 2 files changed, 18 insertions(+), 7 deletions(-) - -diff --git a/arch/x86/kernel/head_32.S b/arch/x86/kernel/head_32.S -index c29020907886..1f35d600b69f 100644 ---- a/arch/x86/kernel/head_32.S -+++ b/arch/x86/kernel/head_32.S -@@ -512,11 +512,18 @@ ENTRY(initial_code) - ENTRY(setup_once_ref) - .long setup_once - -+#ifdef CONFIG_PAGE_TABLE_ISOLATION -+#define PGD_ALIGN (2 * PAGE_SIZE) -+#define PTI_USER_PGD_FILL 1024 -+#else -+#define PGD_ALIGN (PAGE_SIZE) -+#define PTI_USER_PGD_FILL 0 -+#endif - /* - * BSS section - */ - __PAGE_ALIGNED_BSS -- .align PAGE_SIZE -+ .align PGD_ALIGN - #ifdef CONFIG_X86_PAE - .globl initial_pg_pmd - initial_pg_pmd: -@@ -526,14 +533,17 @@ initial_pg_pmd: - initial_page_table: - .fill 1024,4,0 - #endif -+ .align PGD_ALIGN - initial_pg_fixmap: - .fill 1024,4,0 --.globl empty_zero_page --empty_zero_page: -- .fill 4096,1,0 - .globl swapper_pg_dir -+ .align PGD_ALIGN - swapper_pg_dir: - .fill 1024,4,0 -+ .fill PTI_USER_PGD_FILL,4,0 -+.globl empty_zero_page -+empty_zero_page: -+ .fill 4096,1,0 - EXPORT_SYMBOL(empty_zero_page) - - /* -@@ -542,7 +552,7 @@ EXPORT_SYMBOL(empty_zero_page) - #ifdef CONFIG_X86_PAE - __PAGE_ALIGNED_DATA - /* Page-aligned for the benefit of paravirt? */ -- .align PAGE_SIZE -+ .align PGD_ALIGN - ENTRY(initial_page_table) - .long pa(initial_pg_pmd+PGD_IDENT_ATTR),0 /* low identity map */ - # if KPMDS == 3 -diff --git a/arch/x86/mm/pgtable.c b/arch/x86/mm/pgtable.c -index 004abf9ebf12..a81d42e48922 100644 ---- a/arch/x86/mm/pgtable.c -+++ b/arch/x86/mm/pgtable.c -@@ -338,7 +338,8 @@ static inline pgd_t *_pgd_alloc(void) - * We allocate one page for pgd. - */ - if (!SHARED_KERNEL_PMD) -- return (pgd_t *)__get_free_page(PGALLOC_GFP); -+ return (pgd_t *)__get_free_pages(PGALLOC_GFP, -+ PGD_ALLOCATION_ORDER); - - /* - * Now PAE kernel is not running as a Xen domain. We can allocate -@@ -350,7 +351,7 @@ static inline pgd_t *_pgd_alloc(void) - static inline void _pgd_free(pgd_t *pgd) - { - if (!SHARED_KERNEL_PMD) -- free_page((unsigned long)pgd); -+ free_pages((unsigned long)pgd, PGD_ALLOCATION_ORDER); - else - kmem_cache_free(pgd_cache, pgd); - } --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0018-x86-pgtable-Move-pgdp-kernel-user-conversion-functio.patch b/kernel/kernel/files/patches/mageia/pti32bit-0018-x86-pgtable-Move-pgdp-kernel-user-conversion-functio.patch deleted file mode 100644 index ff12561b..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0018-x86-pgtable-Move-pgdp-kernel-user-conversion-functio.patch +++ /dev/null @@ -1,137 +0,0 @@ -From 69dfcb6ee23f6841982e059f58cc9be921b669dc Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 11:53:38 +0100 -Subject: [PATCH 18/34] x86/pgtable: Move pgdp kernel/user conversion functions - to pgtable.h - -Make them available on 32 bit and clone_pgd_range() happy. - -Signed-off-by: Joerg Roedel ---- - arch/x86/include/asm/pgtable.h | 49 +++++++++++++++++++++++++++++++++++++++ - arch/x86/include/asm/pgtable_64.h | 49 --------------------------------------- - 2 files changed, 49 insertions(+), 49 deletions(-) - -diff --git a/arch/x86/include/asm/pgtable.h b/arch/x86/include/asm/pgtable.h -index e42b8943cb1a..0a9f746cbdc1 100644 ---- a/arch/x86/include/asm/pgtable.h -+++ b/arch/x86/include/asm/pgtable.h -@@ -1109,6 +1109,55 @@ static inline int pud_write(pud_t pud) - return pud_flags(pud) & _PAGE_RW; - } - -+#ifdef CONFIG_PAGE_TABLE_ISOLATION -+/* -+ * All top-level PAGE_TABLE_ISOLATION page tables are order-1 pages -+ * (8k-aligned and 8k in size). The kernel one is at the beginning 4k and -+ * the user one is in the last 4k. To switch between them, you -+ * just need to flip the 12th bit in their addresses. -+ */ -+#define PTI_PGTABLE_SWITCH_BIT PAGE_SHIFT -+ -+/* -+ * This generates better code than the inline assembly in -+ * __set_bit(). -+ */ -+static inline void *ptr_set_bit(void *ptr, int bit) -+{ -+ unsigned long __ptr = (unsigned long)ptr; -+ -+ __ptr |= BIT(bit); -+ return (void *)__ptr; -+} -+static inline void *ptr_clear_bit(void *ptr, int bit) -+{ -+ unsigned long __ptr = (unsigned long)ptr; -+ -+ __ptr &= ~BIT(bit); -+ return (void *)__ptr; -+} -+ -+static inline pgd_t *kernel_to_user_pgdp(pgd_t *pgdp) -+{ -+ return ptr_set_bit(pgdp, PTI_PGTABLE_SWITCH_BIT); -+} -+ -+static inline pgd_t *user_to_kernel_pgdp(pgd_t *pgdp) -+{ -+ return ptr_clear_bit(pgdp, PTI_PGTABLE_SWITCH_BIT); -+} -+ -+static inline p4d_t *kernel_to_user_p4dp(p4d_t *p4dp) -+{ -+ return ptr_set_bit(p4dp, PTI_PGTABLE_SWITCH_BIT); -+} -+ -+static inline p4d_t *user_to_kernel_p4dp(p4d_t *p4dp) -+{ -+ return ptr_clear_bit(p4dp, PTI_PGTABLE_SWITCH_BIT); -+} -+#endif /* CONFIG_PAGE_TABLE_ISOLATION */ -+ - /* - * clone_pgd_range(pgd_t *dst, pgd_t *src, int count); - * -diff --git a/arch/x86/include/asm/pgtable_64.h b/arch/x86/include/asm/pgtable_64.h -index b68bda56db67..5e680838761d 100644 ---- a/arch/x86/include/asm/pgtable_64.h -+++ b/arch/x86/include/asm/pgtable_64.h -@@ -131,55 +131,6 @@ static inline pud_t native_pudp_get_and_clear(pud_t *xp) - #endif - } - --#ifdef CONFIG_PAGE_TABLE_ISOLATION --/* -- * All top-level PAGE_TABLE_ISOLATION page tables are order-1 pages -- * (8k-aligned and 8k in size). The kernel one is at the beginning 4k and -- * the user one is in the last 4k. To switch between them, you -- * just need to flip the 12th bit in their addresses. -- */ --#define PTI_PGTABLE_SWITCH_BIT PAGE_SHIFT -- --/* -- * This generates better code than the inline assembly in -- * __set_bit(). -- */ --static inline void *ptr_set_bit(void *ptr, int bit) --{ -- unsigned long __ptr = (unsigned long)ptr; -- -- __ptr |= BIT(bit); -- return (void *)__ptr; --} --static inline void *ptr_clear_bit(void *ptr, int bit) --{ -- unsigned long __ptr = (unsigned long)ptr; -- -- __ptr &= ~BIT(bit); -- return (void *)__ptr; --} -- --static inline pgd_t *kernel_to_user_pgdp(pgd_t *pgdp) --{ -- return ptr_set_bit(pgdp, PTI_PGTABLE_SWITCH_BIT); --} -- --static inline pgd_t *user_to_kernel_pgdp(pgd_t *pgdp) --{ -- return ptr_clear_bit(pgdp, PTI_PGTABLE_SWITCH_BIT); --} -- --static inline p4d_t *kernel_to_user_p4dp(p4d_t *p4dp) --{ -- return ptr_set_bit(p4dp, PTI_PGTABLE_SWITCH_BIT); --} -- --static inline p4d_t *user_to_kernel_p4dp(p4d_t *p4dp) --{ -- return ptr_clear_bit(p4dp, PTI_PGTABLE_SWITCH_BIT); --} --#endif /* CONFIG_PAGE_TABLE_ISOLATION */ -- - /* - * Page table pages are page-aligned. The lower half of the top - * level is used for userspace and the top half for the kernel. --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0019-x86-pgtable-Move-pti_set_user_pgtbl-to-pgtable.h.patch b/kernel/kernel/files/patches/mageia/pti32bit-0019-x86-pgtable-Move-pti_set_user_pgtbl-to-pgtable.h.patch deleted file mode 100644 index f7ccdc80..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0019-x86-pgtable-Move-pti_set_user_pgtbl-to-pgtable.h.patch +++ /dev/null @@ -1,84 +0,0 @@ -From 88eb961770b7b265bf4725f0d687af8c9cf33467 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 15:50:39 +0100 -Subject: [PATCH 19/34] x86/pgtable: Move pti_set_user_pgtbl() to pgtable.h - -There it is also usable from 32 bit code. - -Signed-off-by: Joerg Roedel ---- - arch/x86/include/asm/pgtable.h | 23 +++++++++++++++++++++++ - arch/x86/include/asm/pgtable_64.h | 21 --------------------- - 2 files changed, 23 insertions(+), 21 deletions(-) - -diff --git a/arch/x86/include/asm/pgtable.h b/arch/x86/include/asm/pgtable.h -index 0a9f746cbdc1..1e900c1f8ab1 100644 ---- a/arch/x86/include/asm/pgtable.h -+++ b/arch/x86/include/asm/pgtable.h -@@ -618,8 +618,31 @@ static inline int is_new_memtype_allowed(u64 paddr, unsigned long size, - - pmd_t *populate_extra_pmd(unsigned long vaddr); - pte_t *populate_extra_pte(unsigned long vaddr); -+ -+#ifdef CONFIG_PAGE_TABLE_ISOLATION -+pgd_t __pti_set_user_pgtbl(pgd_t *pgdp, pgd_t pgd); -+ -+/* -+ * Take a PGD location (pgdp) and a pgd value that needs to be set there. -+ * Populates the user and returns the resulting PGD that must be set in -+ * the kernel copy of the page tables. -+ */ -+static inline pgd_t pti_set_user_pgtbl(pgd_t *pgdp, pgd_t pgd) -+{ -+ if (!static_cpu_has(X86_FEATURE_PTI)) -+ return pgd; -+ return __pti_set_user_pgtbl(pgdp, pgd); -+} -+#else /* CONFIG_PAGE_TABLE_ISOLATION */ -+static inline pgd_t pti_set_user_pgtbl(pgd_t *pgdp, pgd_t pgd) -+{ -+ return pgd; -+} -+#endif /* CONFIG_PAGE_TABLE_ISOLATION */ -+ - #endif /* __ASSEMBLY__ */ - -+ - #ifdef CONFIG_X86_32 - # include - #else -diff --git a/arch/x86/include/asm/pgtable_64.h b/arch/x86/include/asm/pgtable_64.h -index 5e680838761d..4cbf5173dd76 100644 ---- a/arch/x86/include/asm/pgtable_64.h -+++ b/arch/x86/include/asm/pgtable_64.h -@@ -145,27 +145,6 @@ static inline bool pgdp_maps_userspace(void *__ptr) - return (ptr & ~PAGE_MASK) < (PAGE_SIZE / 2); - } - --#ifdef CONFIG_PAGE_TABLE_ISOLATION --pgd_t __pti_set_user_pgtbl(pgd_t *pgdp, pgd_t pgd); -- --/* -- * Take a PGD location (pgdp) and a pgd value that needs to be set there. -- * Populates the user and returns the resulting PGD that must be set in -- * the kernel copy of the page tables. -- */ --static inline pgd_t pti_set_user_pgtbl(pgd_t *pgdp, pgd_t pgd) --{ -- if (!static_cpu_has(X86_FEATURE_PTI)) -- return pgd; -- return __pti_set_user_pgtbl(pgdp, pgd); --} --#else --static inline pgd_t pti_set_user_pgtbl(pgd_t *pgdp, pgd_t pgd) --{ -- return pgd; --} --#endif -- - static inline void native_set_p4d(p4d_t *p4dp, p4d_t p4d) - { - #if defined(CONFIG_PAGE_TABLE_ISOLATION) && !defined(CONFIG_X86_5LEVEL) --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0020-x86-pgtable-Move-two-more-functions-from-pgtable_64..patch b/kernel/kernel/files/patches/mageia/pti32bit-0020-x86-pgtable-Move-two-more-functions-from-pgtable_64..patch deleted file mode 100644 index 419f6fe9..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0020-x86-pgtable-Move-two-more-functions-from-pgtable_64..patch +++ /dev/null @@ -1,120 +0,0 @@ -From 2bcb4034a5d3e49213d4b7e72187b106a50d53f3 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 12:48:14 +0100 -Subject: [PATCH 20/34] x86/pgtable: Move two more functions from pgtable_64.h - to pgtable.h - -These two functions are required for PTI on 32 bit: - - * pgdp_maps_userspace() - * pgd_large() - -Also re-implement pgdp_maps_userspace() so that it will work -on 64 and 32 bit kernels. - -Signed-off-by: Joerg Roedel ---- - arch/x86/include/asm/pgtable-2level_types.h | 3 +++ - arch/x86/include/asm/pgtable-3level_types.h | 1 + - arch/x86/include/asm/pgtable.h | 16 ++++++++++++++++ - arch/x86/include/asm/pgtable_64.h | 15 --------------- - arch/x86/include/asm/pgtable_64_types.h | 2 ++ - 5 files changed, 22 insertions(+), 15 deletions(-) - -diff --git a/arch/x86/include/asm/pgtable-2level_types.h b/arch/x86/include/asm/pgtable-2level_types.h -index f982ef808e7e..6deb6cd236e3 100644 ---- a/arch/x86/include/asm/pgtable-2level_types.h -+++ b/arch/x86/include/asm/pgtable-2level_types.h -@@ -35,4 +35,7 @@ typedef union { - - #define PTRS_PER_PTE 1024 - -+/* This covers all VMSPLIT_* and VMSPLIT_*_OPT variants */ -+#define PGD_KERNEL_START (CONFIG_PAGE_OFFSET >> PGDIR_SHIFT) -+ - #endif /* _ASM_X86_PGTABLE_2LEVEL_DEFS_H */ -diff --git a/arch/x86/include/asm/pgtable-3level_types.h b/arch/x86/include/asm/pgtable-3level_types.h -index ed8a200ecdaf..925ac1bc45cb 100644 ---- a/arch/x86/include/asm/pgtable-3level_types.h -+++ b/arch/x86/include/asm/pgtable-3level_types.h -@@ -45,5 +45,6 @@ typedef union { - */ - #define PTRS_PER_PTE 512 - -+#define PGD_KERNEL_START (CONFIG_PAGE_OFFSET >> PGDIR_SHIFT) - - #endif /* _ASM_X86_PGTABLE_3LEVEL_DEFS_H */ -diff --git a/arch/x86/include/asm/pgtable.h b/arch/x86/include/asm/pgtable.h -index 1e900c1f8ab1..981e49a8cdb2 100644 ---- a/arch/x86/include/asm/pgtable.h -+++ b/arch/x86/include/asm/pgtable.h -@@ -1132,6 +1132,22 @@ static inline int pud_write(pud_t pud) - return pud_flags(pud) & _PAGE_RW; - } - -+/* -+ * Page table pages are page-aligned. The lower half of the top -+ * level is used for userspace and the top half for the kernel. -+ * -+ * Returns true for parts of the PGD that map userspace and -+ * false for the parts that map the kernel. -+ */ -+static inline bool pgdp_maps_userspace(void *__ptr) -+{ -+ unsigned long ptr = (unsigned long)__ptr; -+ -+ return (((ptr & ~PAGE_MASK) / sizeof(pgd_t)) < PGD_KERNEL_START); -+} -+ -+static inline int pgd_large(pgd_t pgd) { return 0; } -+ - #ifdef CONFIG_PAGE_TABLE_ISOLATION - /* - * All top-level PAGE_TABLE_ISOLATION page tables are order-1 pages -diff --git a/arch/x86/include/asm/pgtable_64.h b/arch/x86/include/asm/pgtable_64.h -index 4cbf5173dd76..e11b92585de4 100644 ---- a/arch/x86/include/asm/pgtable_64.h -+++ b/arch/x86/include/asm/pgtable_64.h -@@ -131,20 +131,6 @@ static inline pud_t native_pudp_get_and_clear(pud_t *xp) - #endif - } - --/* -- * Page table pages are page-aligned. The lower half of the top -- * level is used for userspace and the top half for the kernel. -- * -- * Returns true for parts of the PGD that map userspace and -- * false for the parts that map the kernel. -- */ --static inline bool pgdp_maps_userspace(void *__ptr) --{ -- unsigned long ptr = (unsigned long)__ptr; -- -- return (ptr & ~PAGE_MASK) < (PAGE_SIZE / 2); --} -- - static inline void native_set_p4d(p4d_t *p4dp, p4d_t p4d) - { - #if defined(CONFIG_PAGE_TABLE_ISOLATION) && !defined(CONFIG_X86_5LEVEL) -@@ -187,7 +173,6 @@ extern void sync_global_pgds(unsigned long start, unsigned long end); - /* - * Level 4 access. - */ --static inline int pgd_large(pgd_t pgd) { return 0; } - #define mk_kernel_pgd(address) __pgd((address) | _KERNPG_TABLE) - - /* PUD - Level3 access */ -diff --git a/arch/x86/include/asm/pgtable_64_types.h b/arch/x86/include/asm/pgtable_64_types.h -index 6b8f73dcbc2c..e57003a3f58a 100644 ---- a/arch/x86/include/asm/pgtable_64_types.h -+++ b/arch/x86/include/asm/pgtable_64_types.h -@@ -124,4 +124,6 @@ typedef struct { pteval_t pte; } pte_t; - - #define EARLY_DYNAMIC_PAGE_TABLES 64 - -+#define PGD_KERNEL_START ((PAGE_SIZE / 2) / sizeof(pgd_t)) -+ - #endif /* _ASM_X86_PGTABLE_64_DEFS_H */ --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0021-x86-mm-pae-Populate-valid-user-PGD-entries.patch b/kernel/kernel/files/patches/mageia/pti32bit-0021-x86-mm-pae-Populate-valid-user-PGD-entries.patch deleted file mode 100644 index 04281249..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0021-x86-mm-pae-Populate-valid-user-PGD-entries.patch +++ /dev/null @@ -1,73 +0,0 @@ -From 85228cdba0d4634d6a1a162be0d755bd8ed3bdfa Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 15:28:57 +0100 -Subject: [PATCH 21/34] x86/mm/pae: Populate valid user PGD entries - -Generic page-table code populates all non-leaf entries with -_KERNPG_TABLE bits set. This is fine for all paging modes -except PAE. - -In PAE mode only a subset of the bits is allowed to be set. -Make sure we only set allowed bits by masking out the -reserved bits. - -Signed-off-by: Joerg Roedel ---- - arch/x86/include/asm/pgtable_types.h | 28 ++++++++++++++++++++++++++-- - 1 file changed, 26 insertions(+), 2 deletions(-) - -diff --git a/arch/x86/include/asm/pgtable_types.h b/arch/x86/include/asm/pgtable_types.h -index 3696398a9475..48fc70b2d044 100644 ---- a/arch/x86/include/asm/pgtable_types.h -+++ b/arch/x86/include/asm/pgtable_types.h -@@ -50,6 +50,7 @@ - #define _PAGE_GLOBAL (_AT(pteval_t, 1) << _PAGE_BIT_GLOBAL) - #define _PAGE_SOFTW1 (_AT(pteval_t, 1) << _PAGE_BIT_SOFTW1) - #define _PAGE_SOFTW2 (_AT(pteval_t, 1) << _PAGE_BIT_SOFTW2) -+#define _PAGE_SOFTW3 (_AT(pteval_t, 1) << _PAGE_BIT_SOFTW3) - #define _PAGE_PAT (_AT(pteval_t, 1) << _PAGE_BIT_PAT) - #define _PAGE_PAT_LARGE (_AT(pteval_t, 1) << _PAGE_BIT_PAT_LARGE) - #define _PAGE_SPECIAL (_AT(pteval_t, 1) << _PAGE_BIT_SPECIAL) -@@ -267,14 +268,37 @@ typedef struct pgprot { pgprotval_t pgprot; } pgprot_t; - - typedef struct { pgdval_t pgd; } pgd_t; - -+#ifdef CONFIG_X86_PAE -+ -+/* -+ * PHYSICAL_PAGE_MASK might be non-constant when SME is compiled in, so we can't -+ * use it here. -+ */ -+ -+#define PGD_PAE_PAGE_MASK ((signed long)PAGE_MASK) -+#define PGD_PAE_PHYS_MASK (((1ULL << __PHYSICAL_MASK_SHIFT)-1) & PGD_PAE_PAGE_MASK) -+ -+/* -+ * PAE allows Base Address, P, PWT, PCD and AVL bits to be set in PGD entries. -+ * All other bits are Reserved MBZ -+ */ -+#define PGD_ALLOWED_BITS (PGD_PAE_PHYS_MASK | _PAGE_PRESENT | \ -+ _PAGE_PWT | _PAGE_PCD | \ -+ _PAGE_SOFTW1 | _PAGE_SOFTW2 | _PAGE_SOFTW3 ) -+ -+#else -+/* No need to mask any bits for !PAE */ -+#define PGD_ALLOWED_BITS (~0ULL) -+#endif -+ - static inline pgd_t native_make_pgd(pgdval_t val) - { -- return (pgd_t) { val }; -+ return (pgd_t) { val & PGD_ALLOWED_BITS }; - } - - static inline pgdval_t native_pgd_val(pgd_t pgd) - { -- return pgd.pgd; -+ return pgd.pgd & PGD_ALLOWED_BITS; - } - - static inline pgdval_t pgd_flags(pgd_t pgd) --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0022-x86-mm-pae-Populate-the-user-page-table-with-user-pg.patch b/kernel/kernel/files/patches/mageia/pti32bit-0022-x86-mm-pae-Populate-the-user-page-table-with-user-pg.patch deleted file mode 100644 index 02bc60df..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0022-x86-mm-pae-Populate-the-user-page-table-with-user-pg.patch +++ /dev/null @@ -1,42 +0,0 @@ -From f05eb123abd9d8696ef340e62a37348381ff95fa Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 15:55:17 +0100 -Subject: [PATCH 22/34] x86/mm/pae: Populate the user page-table with user - pgd's - -When we populate a PGD entry, make sure we populate it in -the user page-table too. - -Signed-off-by: Joerg Roedel ---- - arch/x86/include/asm/pgtable-3level.h | 7 +++++++ - 1 file changed, 7 insertions(+) - -diff --git a/arch/x86/include/asm/pgtable-3level.h b/arch/x86/include/asm/pgtable-3level.h -index bc4af5453802..ab2aa4468293 100644 ---- a/arch/x86/include/asm/pgtable-3level.h -+++ b/arch/x86/include/asm/pgtable-3level.h -@@ -98,6 +98,9 @@ static inline void native_set_pmd(pmd_t *pmdp, pmd_t pmd) - - static inline void native_set_pud(pud_t *pudp, pud_t pud) - { -+#ifdef CONFIG_PAGE_TABLE_ISOLATION -+ pud.p4d.pgd = pti_set_user_pgtbl(&pudp->p4d.pgd, pud.p4d.pgd); -+#endif - set_64bit((unsigned long long *)(pudp), native_pud_val(pud)); - } - -@@ -194,6 +197,10 @@ static inline pud_t native_pudp_get_and_clear(pud_t *pudp) - { - union split_pud res, *orig = (union split_pud *)pudp; - -+#ifdef CONFIG_PAGE_TABLE_ISOLATION -+ pti_set_user_pgtbl(&pudp->p4d.pgd, __pgd(0)); -+#endif -+ - /* xchg acts as a barrier before setting of the high bits */ - res.pud_low = xchg(&orig->pud_low, 0); - res.pud_high = orig->pud_high; --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0023-x86-mm-legacy-Populate-the-user-page-table-with-user.patch b/kernel/kernel/files/patches/mageia/pti32bit-0023-x86-mm-legacy-Populate-the-user-page-table-with-user.patch deleted file mode 100644 index 50bb46d8..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0023-x86-mm-legacy-Populate-the-user-page-table-with-user.patch +++ /dev/null @@ -1,50 +0,0 @@ -From 08a22d9c7b62e9c9e08eaf9508f3ef881768a636 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 16:29:13 +0100 -Subject: [PATCH 23/34] x86/mm/legacy: Populate the user page-table with user - pgd's - -Also populate the user-spage pgd's in the user page-table. - -Signed-off-by: Joerg Roedel ---- - arch/x86/include/asm/pgtable-2level.h | 9 +++++++++ - 1 file changed, 9 insertions(+) - -diff --git a/arch/x86/include/asm/pgtable-2level.h b/arch/x86/include/asm/pgtable-2level.h -index 685ffe8a0eaf..c399ea5eea41 100644 ---- a/arch/x86/include/asm/pgtable-2level.h -+++ b/arch/x86/include/asm/pgtable-2level.h -@@ -19,6 +19,9 @@ static inline void native_set_pte(pte_t *ptep , pte_t pte) - - static inline void native_set_pmd(pmd_t *pmdp, pmd_t pmd) - { -+#ifdef CONFIG_PAGE_TABLE_ISOLATION -+ pmd.pud.p4d.pgd = pti_set_user_pgtbl(&pmdp->pud.p4d.pgd, pmd.pud.p4d.pgd); -+#endif - *pmdp = pmd; - } - -@@ -58,6 +61,9 @@ static inline pte_t native_ptep_get_and_clear(pte_t *xp) - #ifdef CONFIG_SMP - static inline pmd_t native_pmdp_get_and_clear(pmd_t *xp) - { -+#ifdef CONFIG_PAGE_TABLE_ISOLATION -+ pti_set_user_pgtbl(&xp->pud.p4d.pgd, __pgd(0)); -+#endif - return __pmd(xchg((pmdval_t *)xp, 0)); - } - #else -@@ -67,6 +73,9 @@ static inline pmd_t native_pmdp_get_and_clear(pmd_t *xp) - #ifdef CONFIG_SMP - static inline pud_t native_pudp_get_and_clear(pud_t *xp) - { -+#ifdef CONFIG_PAGE_TABLE_ISOLATION -+ pti_set_user_pgtbl(&xp->p4d.pgd, __pgd(0)); -+#endif - return __pud(xchg((pudval_t *)xp, 0)); - } - #else --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0024-x86-mm-pti-Add-an-overflow-check-to-pti_clone_pmds.patch b/kernel/kernel/files/patches/mageia/pti32bit-0024-x86-mm-pti-Add-an-overflow-check-to-pti_clone_pmds.patch deleted file mode 100644 index 3619c152..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0024-x86-mm-pti-Add-an-overflow-check-to-pti_clone_pmds.patch +++ /dev/null @@ -1,33 +0,0 @@ -From 9fb9b9305a94eb64cd9bfc007d0457aa16a3429c Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 16:23:52 +0100 -Subject: [PATCH 24/34] x86/mm/pti: Add an overflow check to pti_clone_pmds() - -The addr counter will overflow if we clone the last PMD of -the address space, resulting in an endless loop. - -Check for that and bail out of the loop when it happens. - -Signed-off-by: Joerg Roedel ---- - arch/x86/mm/pti.c | 4 ++++ - 1 file changed, 4 insertions(+) - -diff --git a/arch/x86/mm/pti.c b/arch/x86/mm/pti.c -index 8f53d2101f64..96a690e6c9b1 100644 ---- a/arch/x86/mm/pti.c -+++ b/arch/x86/mm/pti.c -@@ -282,6 +282,10 @@ pti_clone_pmds(unsigned long start, unsigned long end, pmdval_t clear) - p4d_t *p4d; - pud_t *pud; - -+ /* Overflow check */ -+ if (addr < start) -+ break; -+ - pgd = pgd_offset_k(addr); - if (WARN_ON(pgd_none(*pgd))) - return; --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0025-x86-mm-pti-Define-X86_CR3_PTI_PCID_USER_BIT-on-x86_3.patch b/kernel/kernel/files/patches/mageia/pti32bit-0025-x86-mm-pti-Define-X86_CR3_PTI_PCID_USER_BIT-on-x86_3.patch deleted file mode 100644 index b927eac1..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0025-x86-mm-pti-Define-X86_CR3_PTI_PCID_USER_BIT-on-x86_3.patch +++ /dev/null @@ -1,41 +0,0 @@ -From b4c87612168011f7e95681027bf1de290da8d668 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 11:35:19 +0100 -Subject: [PATCH 25/34] x86/mm/pti: Define X86_CR3_PTI_PCID_USER_BIT on x86_32 - -Move it out of the X86_64 specific processor defines so -that its visible for 32bit too. - -Reviewed-by: Andy Lutomirski -Signed-off-by: Joerg Roedel ---- - arch/x86/include/asm/processor-flags.h | 8 ++++---- - 1 file changed, 4 insertions(+), 4 deletions(-) - -diff --git a/arch/x86/include/asm/processor-flags.h b/arch/x86/include/asm/processor-flags.h -index 625a52a5594f..02c2cbda4a74 100644 ---- a/arch/x86/include/asm/processor-flags.h -+++ b/arch/x86/include/asm/processor-flags.h -@@ -39,10 +39,6 @@ - #define CR3_PCID_MASK 0xFFFull - #define CR3_NOFLUSH BIT_ULL(63) - --#ifdef CONFIG_PAGE_TABLE_ISOLATION --# define X86_CR3_PTI_PCID_USER_BIT 11 --#endif -- - #else - /* - * CR3_ADDR_MASK needs at least bits 31:5 set on PAE systems, and we save -@@ -53,4 +49,8 @@ - #define CR3_NOFLUSH 0 - #endif - -+#ifdef CONFIG_PAGE_TABLE_ISOLATION -+# define X86_CR3_PTI_PCID_USER_BIT 11 -+#endif -+ - #endif /* _ASM_X86_PROCESSOR_FLAGS_H */ --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0026-x86-mm-pti-Clone-CPU_ENTRY_AREA-on-PMD-level-on-x86_.patch b/kernel/kernel/files/patches/mageia/pti32bit-0026-x86-mm-pti-Clone-CPU_ENTRY_AREA-on-PMD-level-on-x86_.patch deleted file mode 100644 index 26d863cf..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0026-x86-mm-pti-Clone-CPU_ENTRY_AREA-on-PMD-level-on-x86_.patch +++ /dev/null @@ -1,56 +0,0 @@ -From c3b8f5b6bbb097409895ea8e00042034408cac54 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 14:13:04 +0100 -Subject: [PATCH 26/34] x86/mm/pti: Clone CPU_ENTRY_AREA on PMD level on x86_32 - -Cloning on the P4D level would clone the complete kernel -address space into the user-space page-tables for PAE -kernels. Cloning on PMD level is fine for PAE and legacy -paging. - -Signed-off-by: Joerg Roedel ---- - arch/x86/mm/pti.c | 20 ++++++++++++++++++++ - 1 file changed, 20 insertions(+) - -diff --git a/arch/x86/mm/pti.c b/arch/x86/mm/pti.c -index 96a690e6c9b1..3ffd92309aca 100644 ---- a/arch/x86/mm/pti.c -+++ b/arch/x86/mm/pti.c -@@ -312,6 +312,7 @@ pti_clone_pmds(unsigned long start, unsigned long end, pmdval_t clear) - } - } - -+#ifdef CONFIG_X86_64 - /* - * Clone a single p4d (i.e. a top-level entry on 4-level systems and a - * next-level entry on 5-level systems. -@@ -335,6 +336,25 @@ static void __init pti_clone_user_shared(void) - pti_clone_p4d(CPU_ENTRY_AREA_BASE); - } - -+#else /* CONFIG_X86_64 */ -+ -+/* -+ * On 32 bit PAE systems with 1GB of Kernel address space there is only -+ * one pgd/p4d for the whole kernel. Cloning that would map the whole -+ * address space into the user page-tables, making PTI useless. So clone -+ * the page-table on the PMD level to prevent that. -+ */ -+static void __init pti_clone_user_shared(void) -+{ -+ unsigned long start, end; -+ -+ start = CPU_ENTRY_AREA_BASE; -+ end = start + (PAGE_SIZE * CPU_ENTRY_AREA_PAGES); -+ -+ pti_clone_pmds(start, end, _PAGE_GLOBAL); -+} -+#endif /* CONFIG_X86_64 */ -+ - /* - * Clone the ESPFIX P4D into the user space visinble page table - */ --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0027-x86-mm-dump_pagetables-Define-INIT_PGD.patch b/kernel/kernel/files/patches/mageia/pti32bit-0027-x86-mm-dump_pagetables-Define-INIT_PGD.patch deleted file mode 100644 index bf454270..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0027-x86-mm-dump_pagetables-Define-INIT_PGD.patch +++ /dev/null @@ -1,61 +0,0 @@ -From 35f7b44b3ce2d5b4c4fe2fabb8905bfff44559d4 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Thu, 8 Feb 2018 09:11:57 +0100 -Subject: [PATCH 27/34] x86/mm/dump_pagetables: Define INIT_PGD - -Define INIT_PGD to point to the correct initial page-table -for 32 and 64 bit and use it where needed. This fixes the -build on 32 bit with CONFIG_PAGE_TABLE_ISOLATION enabled. - -Signed-off-by: Joerg Roedel ---- - arch/x86/mm/dump_pagetables.c | 12 ++++++------ - 1 file changed, 6 insertions(+), 6 deletions(-) - -diff --git a/arch/x86/mm/dump_pagetables.c b/arch/x86/mm/dump_pagetables.c -index 2a4849e92831..2151ebb6a282 100644 ---- a/arch/x86/mm/dump_pagetables.c -+++ b/arch/x86/mm/dump_pagetables.c -@@ -105,6 +105,8 @@ static struct addr_marker address_markers[] = { - [END_OF_SPACE_NR] = { -1, NULL } - }; - -+#define INIT_PGD ((pgd_t *) &init_top_pgt) -+ - #else /* CONFIG_X86_64 */ - - enum address_markers_idx { -@@ -133,6 +135,8 @@ static struct addr_marker address_markers[] = { - [END_OF_SPACE_NR] = { -1, NULL } - }; - -+#define INIT_PGD (swapper_pg_dir) -+ - #endif /* !CONFIG_X86_64 */ - - /* Multipliers for offsets within the PTEs */ -@@ -478,11 +482,7 @@ static inline bool is_hypervisor_range(int idx) - static void ptdump_walk_pgd_level_core(struct seq_file *m, pgd_t *pgd, - bool checkwx, bool dmesg) - { --#ifdef CONFIG_X86_64 -- pgd_t *start = (pgd_t *) &init_top_pgt; --#else -- pgd_t *start = swapper_pg_dir; --#endif -+ pgd_t *start = INIT_PGD; - pgprotval_t prot; - int i; - struct pg_state st = {}; -@@ -543,7 +543,7 @@ EXPORT_SYMBOL_GPL(ptdump_walk_pgd_level_debugfs); - static void ptdump_walk_user_pgd_level_checkwx(void) - { - #ifdef CONFIG_PAGE_TABLE_ISOLATION -- pgd_t *pgd = (pgd_t *) &init_top_pgt; -+ pgd_t *pgd = INIT_PGD; - - if (!static_cpu_has(X86_FEATURE_PTI)) - return; --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0028-x86-pgtable-pae-Use-separate-kernel-PMDs-for-user-pa.patch b/kernel/kernel/files/patches/mageia/pti32bit-0028-x86-pgtable-pae-Use-separate-kernel-PMDs-for-user-pa.patch deleted file mode 100644 index 48d3ba08..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0028-x86-pgtable-pae-Use-separate-kernel-PMDs-for-user-pa.patch +++ /dev/null @@ -1,213 +0,0 @@ -From c15cbcd9bc3d2e8aaecffc5053dbcf382fe6e56d Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Wed, 7 Feb 2018 15:37:52 +0100 -Subject: [PATCH 28/34] x86/pgtable/pae: Use separate kernel PMDs for user - page-table - -We need separate kernel PMDs in the user page-table when PTI -is enabled to map the per-process LDT for user-space. - -Signed-off-by: Joerg Roedel ---- - arch/x86/mm/pgtable.c | 100 ++++++++++++++++++++++++++++++++++++++++---------- - 1 file changed, 81 insertions(+), 19 deletions(-) - -diff --git a/arch/x86/mm/pgtable.c b/arch/x86/mm/pgtable.c -index a81d42e48922..d95bc7b1ffb4 100644 ---- a/arch/x86/mm/pgtable.c -+++ b/arch/x86/mm/pgtable.c -@@ -177,6 +177,14 @@ static void pgd_dtor(pgd_t *pgd) - */ - #define PREALLOCATED_PMDS UNSHARED_PTRS_PER_PGD - -+/* -+ * We allocate separate PMDs for the kernel part of the user page-table -+ * when PTI is enabled. We need them to map the per-process LDT into the -+ * user-space page-table. -+ */ -+#define PREALLOCATED_USER_PMDS (static_cpu_has(X86_FEATURE_PTI) ? \ -+ KERNEL_PGD_PTRS : 0) -+ - void pud_populate(struct mm_struct *mm, pud_t *pudp, pmd_t *pmd) - { - paravirt_alloc_pmd(mm, __pa(pmd) >> PAGE_SHIFT); -@@ -197,14 +205,14 @@ void pud_populate(struct mm_struct *mm, pud_t *pudp, pmd_t *pmd) - - /* No need to prepopulate any pagetable entries in non-PAE modes. */ - #define PREALLOCATED_PMDS 0 -- -+#define PREALLOCATED_USER_PMDS 0 - #endif /* CONFIG_X86_PAE */ - --static void free_pmds(struct mm_struct *mm, pmd_t *pmds[]) -+static void free_pmds(struct mm_struct *mm, pmd_t *pmds[], int count) - { - int i; - -- for(i = 0; i < PREALLOCATED_PMDS; i++) -+ for(i = 0; i < count; i++) - if (pmds[i]) { - pgtable_pmd_page_dtor(virt_to_page(pmds[i])); - free_page((unsigned long)pmds[i]); -@@ -212,7 +220,7 @@ static void free_pmds(struct mm_struct *mm, pmd_t *pmds[]) - } - } - --static int preallocate_pmds(struct mm_struct *mm, pmd_t *pmds[]) -+static int preallocate_pmds(struct mm_struct *mm, pmd_t *pmds[], int count) - { - int i; - bool failed = false; -@@ -221,7 +229,7 @@ static int preallocate_pmds(struct mm_struct *mm, pmd_t *pmds[]) - if (mm == &init_mm) - gfp &= ~__GFP_ACCOUNT; - -- for(i = 0; i < PREALLOCATED_PMDS; i++) { -+ for(i = 0; i < count; i++) { - pmd_t *pmd = (pmd_t *)__get_free_page(gfp); - if (!pmd) - failed = true; -@@ -236,7 +244,7 @@ static int preallocate_pmds(struct mm_struct *mm, pmd_t *pmds[]) - } - - if (failed) { -- free_pmds(mm, pmds); -+ free_pmds(mm, pmds, count); - return -ENOMEM; - } - -@@ -249,23 +257,38 @@ static int preallocate_pmds(struct mm_struct *mm, pmd_t *pmds[]) - * preallocate which never got a corresponding vma will need to be - * freed manually. - */ -+static void mop_up_one_pmd(struct mm_struct *mm, pgd_t *pgdp) -+{ -+ pgd_t pgd = *pgdp; -+ -+ if (pgd_val(pgd) != 0) { -+ pmd_t *pmd = (pmd_t *)pgd_page_vaddr(pgd); -+ -+ *pgdp = native_make_pgd(0); -+ -+ paravirt_release_pmd(pgd_val(pgd) >> PAGE_SHIFT); -+ pmd_free(mm, pmd); -+ mm_dec_nr_pmds(mm); -+ } -+} -+ - static void pgd_mop_up_pmds(struct mm_struct *mm, pgd_t *pgdp) - { - int i; - -- for(i = 0; i < PREALLOCATED_PMDS; i++) { -- pgd_t pgd = pgdp[i]; -+ for(i = 0; i < PREALLOCATED_PMDS; i++) -+ mop_up_one_pmd(mm, &pgdp[i]); - -- if (pgd_val(pgd) != 0) { -- pmd_t *pmd = (pmd_t *)pgd_page_vaddr(pgd); -+#ifdef CONFIG_PAGE_TABLE_ISOLATION - -- pgdp[i] = native_make_pgd(0); -+ if (!static_cpu_has(X86_FEATURE_PTI)) -+ return; - -- paravirt_release_pmd(pgd_val(pgd) >> PAGE_SHIFT); -- pmd_free(mm, pmd); -- mm_dec_nr_pmds(mm); -- } -- } -+ pgdp = kernel_to_user_pgdp(pgdp); -+ -+ for (i = 0; i < PREALLOCATED_USER_PMDS; i++) -+ mop_up_one_pmd(mm, &pgdp[i + KERNEL_PGD_BOUNDARY]); -+#endif - } - - static void pgd_prepopulate_pmd(struct mm_struct *mm, pgd_t *pgd, pmd_t *pmds[]) -@@ -291,6 +314,38 @@ static void pgd_prepopulate_pmd(struct mm_struct *mm, pgd_t *pgd, pmd_t *pmds[]) - } - } - -+#ifdef CONFIG_PAGE_TABLE_ISOLATION -+static void pgd_prepopulate_user_pmd(struct mm_struct *mm, -+ pgd_t *k_pgd, pmd_t *pmds[]) -+{ -+ pgd_t *s_pgd = kernel_to_user_pgdp(swapper_pg_dir); -+ pgd_t *u_pgd = kernel_to_user_pgdp(k_pgd); -+ p4d_t *u_p4d; -+ pud_t *u_pud; -+ int i; -+ -+ u_p4d = p4d_offset(u_pgd, 0); -+ u_pud = pud_offset(u_p4d, 0); -+ -+ s_pgd += KERNEL_PGD_BOUNDARY; -+ u_pud += KERNEL_PGD_BOUNDARY; -+ -+ for (i = 0; i < PREALLOCATED_USER_PMDS; i++, u_pud++, s_pgd++) { -+ pmd_t *pmd = pmds[i]; -+ -+ memcpy(pmd, (pmd_t *)pgd_page_vaddr(*s_pgd), -+ sizeof(pmd_t) * PTRS_PER_PMD); -+ -+ pud_populate(mm, u_pud, pmd); -+ } -+ -+} -+#else -+static void pgd_prepopulate_user_pmd(struct mm_struct *mm, -+ pgd_t *k_pgd, pmd_t *pmds[]) -+{ -+} -+#endif - /* - * Xen paravirt assumes pgd table should be in one page. 64 bit kernel also - * assumes that pgd should be in one page. -@@ -371,6 +426,7 @@ static inline void _pgd_free(pgd_t *pgd) - pgd_t *pgd_alloc(struct mm_struct *mm) - { - pgd_t *pgd; -+ pmd_t *u_pmds[PREALLOCATED_USER_PMDS]; - pmd_t *pmds[PREALLOCATED_PMDS]; - - pgd = _pgd_alloc(); -@@ -380,12 +436,15 @@ pgd_t *pgd_alloc(struct mm_struct *mm) - - mm->pgd = pgd; - -- if (preallocate_pmds(mm, pmds) != 0) -+ if (preallocate_pmds(mm, pmds, PREALLOCATED_PMDS) != 0) - goto out_free_pgd; - -- if (paravirt_pgd_alloc(mm) != 0) -+ if (preallocate_pmds(mm, u_pmds, PREALLOCATED_USER_PMDS) != 0) - goto out_free_pmds; - -+ if (paravirt_pgd_alloc(mm) != 0) -+ goto out_free_user_pmds; -+ - /* - * Make sure that pre-populating the pmds is atomic with - * respect to anything walking the pgd_list, so that they -@@ -395,13 +454,16 @@ pgd_t *pgd_alloc(struct mm_struct *mm) - - pgd_ctor(mm, pgd); - pgd_prepopulate_pmd(mm, pgd, pmds); -+ pgd_prepopulate_user_pmd(mm, pgd, u_pmds); - - spin_unlock(&pgd_lock); - - return pgd; - -+out_free_user_pmds: -+ free_pmds(mm, u_pmds, PREALLOCATED_USER_PMDS); - out_free_pmds: -- free_pmds(mm, pmds); -+ free_pmds(mm, pmds, PREALLOCATED_PMDS); - out_free_pgd: - _pgd_free(pgd); - out: --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0029-x86-ldt-Reserve-address-space-range-on-32-bit-for-th.patch b/kernel/kernel/files/patches/mageia/pti32bit-0029-x86-ldt-Reserve-address-space-range-on-32-bit-for-th.patch deleted file mode 100644 index 28f11c02..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0029-x86-ldt-Reserve-address-space-range-on-32-bit-for-th.patch +++ /dev/null @@ -1,75 +0,0 @@ -From dd247e8ec4d2eeefdcb6ad173f1eef8007f54101 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 12:40:07 +0100 -Subject: [PATCH 29/34] x86/ldt: Reserve address-space range on 32 bit for the - LDT - -Reserve 2MB/4MB of address-space for mapping the LDT to -user-space on 32 bit PTI kernels. - -Signed-off-by: Joerg Roedel ---- - arch/x86/include/asm/pgtable_32_types.h | 7 +++++-- - arch/x86/mm/dump_pagetables.c | 9 +++++++++ - 2 files changed, 14 insertions(+), 2 deletions(-) - -diff --git a/arch/x86/include/asm/pgtable_32_types.h b/arch/x86/include/asm/pgtable_32_types.h -index 0777e18a1d23..eb2e97afb27d 100644 ---- a/arch/x86/include/asm/pgtable_32_types.h -+++ b/arch/x86/include/asm/pgtable_32_types.h -@@ -48,13 +48,16 @@ extern bool __vmalloc_start_set; /* set once high_memory is set */ - ((FIXADDR_TOT_START - PAGE_SIZE * (CPU_ENTRY_AREA_PAGES + 1)) \ - & PMD_MASK) - --#define PKMAP_BASE \ -+#define LDT_BASE_ADDR \ - ((CPU_ENTRY_AREA_BASE - PAGE_SIZE) & PMD_MASK) - -+#define PKMAP_BASE \ -+ ((LDT_BASE_ADDR - PAGE_SIZE) & PMD_MASK) -+ - #ifdef CONFIG_HIGHMEM - # define VMALLOC_END (PKMAP_BASE - 2 * PAGE_SIZE) - #else --# define VMALLOC_END (CPU_ENTRY_AREA_BASE - 2 * PAGE_SIZE) -+# define VMALLOC_END (LDT_BASE_ADDR - 2 * PAGE_SIZE) - #endif - - #define MODULES_VADDR VMALLOC_START -diff --git a/arch/x86/mm/dump_pagetables.c b/arch/x86/mm/dump_pagetables.c -index 2151ebb6a282..fdefdf05739c 100644 ---- a/arch/x86/mm/dump_pagetables.c -+++ b/arch/x86/mm/dump_pagetables.c -@@ -116,6 +116,9 @@ enum address_markers_idx { - VMALLOC_END_NR, - #ifdef CONFIG_HIGHMEM - PKMAP_BASE_NR, -+#endif -+#ifdef CONFIG_MODIFY_LDT_SYSCALL -+ LDT_NR, - #endif - CPU_ENTRY_AREA_NR, - FIXADDR_START_NR, -@@ -129,6 +132,9 @@ static struct addr_marker address_markers[] = { - [VMALLOC_END_NR] = { 0UL, "vmalloc() End" }, - #ifdef CONFIG_HIGHMEM - [PKMAP_BASE_NR] = { 0UL, "Persistent kmap() Area" }, -+#endif -+#ifdef CONFIG_MODIFY_LDT_SYSCALL -+ [LDT_NR] = { 0UL, "LDT remap" }, - #endif - [CPU_ENTRY_AREA_NR] = { 0UL, "CPU entry area" }, - [FIXADDR_START_NR] = { 0UL, "Fixmap area" }, -@@ -579,6 +585,9 @@ static int __init pt_dump_init(void) - # endif - address_markers[FIXADDR_START_NR].start_address = FIXADDR_START; - address_markers[CPU_ENTRY_AREA_NR].start_address = CPU_ENTRY_AREA_BASE; -+# ifdef CONFIG_MODIFY_LDT_SYSCALL -+ address_markers[LDT_NR].start_address = LDT_BASE_ADDR; -+# endif - #endif - return 0; - } --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0030-x86-ldt-Define-LDT_END_ADDR.patch b/kernel/kernel/files/patches/mageia/pti32bit-0030-x86-ldt-Define-LDT_END_ADDR.patch deleted file mode 100644 index f6aebd55..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0030-x86-ldt-Define-LDT_END_ADDR.patch +++ /dev/null @@ -1,64 +0,0 @@ -From e00857066a9f75a64a00528d451be9899ec7328f Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Wed, 7 Feb 2018 17:44:44 +0100 -Subject: [PATCH 30/34] x86/ldt: Define LDT_END_ADDR - -It marks the end of the address-space range reserved for the -LDT. The LDT-code will use it when unmapping the LDT for -user-space. - -Signed-off-by: Joerg Roedel ---- - arch/x86/include/asm/pgtable_32_types.h | 2 ++ - arch/x86/include/asm/pgtable_64_types.h | 2 ++ - arch/x86/kernel/ldt.c | 2 +- - 3 files changed, 5 insertions(+), 1 deletion(-) - -diff --git a/arch/x86/include/asm/pgtable_32_types.h b/arch/x86/include/asm/pgtable_32_types.h -index eb2e97afb27d..02bd445d1aee 100644 ---- a/arch/x86/include/asm/pgtable_32_types.h -+++ b/arch/x86/include/asm/pgtable_32_types.h -@@ -51,6 +51,8 @@ extern bool __vmalloc_start_set; /* set once high_memory is set */ - #define LDT_BASE_ADDR \ - ((CPU_ENTRY_AREA_BASE - PAGE_SIZE) & PMD_MASK) - -+#define LDT_END_ADDR (LDT_BASE_ADDR + PMD_SIZE) -+ - #define PKMAP_BASE \ - ((LDT_BASE_ADDR - PAGE_SIZE) & PMD_MASK) - -diff --git a/arch/x86/include/asm/pgtable_64_types.h b/arch/x86/include/asm/pgtable_64_types.h -index e57003a3f58a..15188baa7762 100644 ---- a/arch/x86/include/asm/pgtable_64_types.h -+++ b/arch/x86/include/asm/pgtable_64_types.h -@@ -90,12 +90,14 @@ typedef struct { pteval_t pte; } pte_t; - # define __VMEMMAP_BASE _AC(0xffd4000000000000, UL) - # define LDT_PGD_ENTRY _AC(-112, UL) - # define LDT_BASE_ADDR (LDT_PGD_ENTRY << PGDIR_SHIFT) -+#define LDT_END_ADDR (LDT_BASE_ADDR + PGDIR_SIZE) - #else - # define VMALLOC_SIZE_TB _AC(32, UL) - # define __VMALLOC_BASE _AC(0xffffc90000000000, UL) - # define __VMEMMAP_BASE _AC(0xffffea0000000000, UL) - # define LDT_PGD_ENTRY _AC(-3, UL) - # define LDT_BASE_ADDR (LDT_PGD_ENTRY << PGDIR_SHIFT) -+#define LDT_END_ADDR (LDT_BASE_ADDR + PGDIR_SIZE) - #endif - - #ifdef CONFIG_RANDOMIZE_MEMORY -diff --git a/arch/x86/kernel/ldt.c b/arch/x86/kernel/ldt.c -index 26d713ecad34..f3c2fbf3c458 100644 ---- a/arch/x86/kernel/ldt.c -+++ b/arch/x86/kernel/ldt.c -@@ -202,7 +202,7 @@ static void free_ldt_pgtables(struct mm_struct *mm) - #ifdef CONFIG_PAGE_TABLE_ISOLATION - struct mmu_gather tlb; - unsigned long start = LDT_BASE_ADDR; -- unsigned long end = start + (1UL << PGDIR_SHIFT); -+ unsigned long end = LDT_END_ADDR; - - if (!static_cpu_has(X86_FEATURE_PTI)) - return; --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0031-x86-ldt-Split-out-sanity-check-in-map_ldt_struct.patch b/kernel/kernel/files/patches/mageia/pti32bit-0031-x86-ldt-Split-out-sanity-check-in-map_ldt_struct.patch deleted file mode 100644 index 14453bad..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0031-x86-ldt-Split-out-sanity-check-in-map_ldt_struct.patch +++ /dev/null @@ -1,146 +0,0 @@ -From 126ef631acff4fe06d76992f40e04237d7d57344 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Wed, 7 Feb 2018 18:02:18 +0100 -Subject: [PATCH 31/34] x86/ldt: Split out sanity check in map_ldt_struct() - -This splits out the mapping sanity check and the actual -mapping of the LDT to user-space from the map_ldt_struct() -function in a way so that it is re-usable for PAE paging. - -Signed-off-by: Joerg Roedel ---- - arch/x86/kernel/ldt.c | 82 ++++++++++++++++++++++++++++++++++++--------------- - 1 file changed, 58 insertions(+), 24 deletions(-) - -diff --git a/arch/x86/kernel/ldt.c b/arch/x86/kernel/ldt.c -index f3c2fbf3c458..8ab7df99c868 100644 ---- a/arch/x86/kernel/ldt.c -+++ b/arch/x86/kernel/ldt.c -@@ -100,6 +100,49 @@ static struct ldt_struct *alloc_ldt_struct(unsigned int num_entries) - return new_ldt; - } - -+#ifdef CONFIG_PAGE_TABLE_ISOLATION -+ -+static void do_sanity_check(struct mm_struct *mm, -+ bool had_kernel_mapping, -+ bool had_user_mapping) -+{ -+ if (mm->context.ldt) { -+ /* -+ * We already had an LDT. The top-level entry should already -+ * have been allocated and synchronized with the usermode -+ * tables. -+ */ -+ WARN_ON(!had_kernel_mapping); -+ if (static_cpu_has(X86_FEATURE_PTI)) -+ WARN_ON(!had_user_mapping); -+ } else { -+ /* -+ * This is the first time we're mapping an LDT for this process. -+ * Sync the pgd to the usermode tables. -+ */ -+ WARN_ON(had_kernel_mapping); -+ if (static_cpu_has(X86_FEATURE_PTI)) -+ WARN_ON(had_user_mapping); -+ } -+} -+ -+static void map_ldt_struct_to_user(struct mm_struct *mm) -+{ -+ pgd_t *pgd = pgd_offset(mm, LDT_BASE_ADDR); -+ -+ if (static_cpu_has(X86_FEATURE_PTI) && !mm->context.ldt) -+ set_pgd(kernel_to_user_pgdp(pgd), *pgd); -+} -+ -+static void sanity_check_ldt_mapping(struct mm_struct *mm) -+{ -+ pgd_t *pgd = pgd_offset(mm, LDT_BASE_ADDR); -+ bool had_kernel = (pgd->pgd != 0); -+ bool had_user = (kernel_to_user_pgdp(pgd)->pgd != 0); -+ -+ do_sanity_check(mm, had_kernel, had_user); -+} -+ - /* - * If PTI is enabled, this maps the LDT into the kernelmode and - * usermode tables for the given mm. -@@ -115,9 +158,8 @@ static struct ldt_struct *alloc_ldt_struct(unsigned int num_entries) - static int - map_ldt_struct(struct mm_struct *mm, struct ldt_struct *ldt, int slot) - { --#ifdef CONFIG_PAGE_TABLE_ISOLATION -- bool is_vmalloc, had_top_level_entry; - unsigned long va; -+ bool is_vmalloc; - spinlock_t *ptl; - pgd_t *pgd; - int i; -@@ -131,13 +173,15 @@ map_ldt_struct(struct mm_struct *mm, struct ldt_struct *ldt, int slot) - */ - WARN_ON(ldt->slot != -1); - -+ /* Check if the current mappings are sane */ -+ sanity_check_ldt_mapping(mm); -+ - /* - * Did we already have the top level entry allocated? We can't - * use pgd_none() for this because it doens't do anything on - * 4-level page table kernels. - */ - pgd = pgd_offset(mm, LDT_BASE_ADDR); -- had_top_level_entry = (pgd->pgd != 0); - - is_vmalloc = is_vmalloc_addr(ldt->entries); - -@@ -168,35 +212,25 @@ map_ldt_struct(struct mm_struct *mm, struct ldt_struct *ldt, int slot) - pte_unmap_unlock(ptep, ptl); - } - -- if (mm->context.ldt) { -- /* -- * We already had an LDT. The top-level entry should already -- * have been allocated and synchronized with the usermode -- * tables. -- */ -- WARN_ON(!had_top_level_entry); -- if (static_cpu_has(X86_FEATURE_PTI)) -- WARN_ON(!kernel_to_user_pgdp(pgd)->pgd); -- } else { -- /* -- * This is the first time we're mapping an LDT for this process. -- * Sync the pgd to the usermode tables. -- */ -- WARN_ON(had_top_level_entry); -- if (static_cpu_has(X86_FEATURE_PTI)) { -- WARN_ON(kernel_to_user_pgdp(pgd)->pgd); -- set_pgd(kernel_to_user_pgdp(pgd), *pgd); -- } -- } -+ /* Propagate LDT mapping to the user page-table */ -+ map_ldt_struct_to_user(mm); - - va = (unsigned long)ldt_slot_va(slot); - flush_tlb_mm_range(mm, va, va + LDT_SLOT_STRIDE, 0); - - ldt->slot = slot; --#endif - return 0; - } - -+#else /* !CONFIG_PAGE_TABLE_ISOLATION */ -+ -+static int -+map_ldt_struct(struct mm_struct *mm, struct ldt_struct *ldt, int slot) -+{ -+ return 0; -+} -+#endif /* CONFIG_PAGE_TABLE_ISOLATION */ -+ - static void free_ldt_pgtables(struct mm_struct *mm) - { - #ifdef CONFIG_PAGE_TABLE_ISOLATION --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0032-x86-ldt-Enable-LDT-user-mapping-for-PAE.patch b/kernel/kernel/files/patches/mageia/pti32bit-0032-x86-ldt-Enable-LDT-user-mapping-for-PAE.patch deleted file mode 100644 index d1d98bfc..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0032-x86-ldt-Enable-LDT-user-mapping-for-PAE.patch +++ /dev/null @@ -1,107 +0,0 @@ -From 1d4ac3c5063abdada00ad78e0ccf74c7de4b365d Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Wed, 7 Feb 2018 18:11:54 +0100 -Subject: [PATCH 32/34] x86/ldt: Enable LDT user-mapping for PAE - -This adds the needed special case for PAE to get the LDT -mapped into the user page-table when PTI is enabled. The big -difference to the other paging modes is that we don't have a -full top-level PGD entry available for the LDT, but only PMD -entry. - -Signed-off-by: Joerg Roedel ---- - arch/x86/include/asm/mmu_context.h | 4 --- - arch/x86/kernel/ldt.c | 53 ++++++++++++++++++++++++++++++++++++++ - 2 files changed, 53 insertions(+), 4 deletions(-) - -diff --git a/arch/x86/include/asm/mmu_context.h b/arch/x86/include/asm/mmu_context.h -index c931b88982a0..af96cfb2ab13 100644 ---- a/arch/x86/include/asm/mmu_context.h -+++ b/arch/x86/include/asm/mmu_context.h -@@ -70,11 +70,7 @@ struct ldt_struct { - - static inline void *ldt_slot_va(int slot) - { --#ifdef CONFIG_X86_64 - return (void *)(LDT_BASE_ADDR + LDT_SLOT_STRIDE * slot); --#else -- BUG(); --#endif - } - - /* -diff --git a/arch/x86/kernel/ldt.c b/arch/x86/kernel/ldt.c -index 8ab7df99c868..778745199d96 100644 ---- a/arch/x86/kernel/ldt.c -+++ b/arch/x86/kernel/ldt.c -@@ -126,6 +126,57 @@ static void do_sanity_check(struct mm_struct *mm, - } - } - -+#ifdef CONFIG_X86_PAE -+ -+static pmd_t *pgd_to_pmd_walk(pgd_t *pgd, unsigned long va) -+{ -+ p4d_t *p4d; -+ pud_t *pud; -+ -+ if (pgd->pgd == 0) -+ return NULL; -+ -+ p4d = p4d_offset(pgd, va); -+ if (p4d_none(*p4d)) -+ return NULL; -+ -+ pud = pud_offset(p4d, va); -+ if (pud_none(*pud)) -+ return NULL; -+ -+ return pmd_offset(pud, va); -+} -+ -+static void map_ldt_struct_to_user(struct mm_struct *mm) -+{ -+ pgd_t *k_pgd = pgd_offset(mm, LDT_BASE_ADDR); -+ pgd_t *u_pgd = kernel_to_user_pgdp(k_pgd); -+ pmd_t *k_pmd, *u_pmd; -+ -+ k_pmd = pgd_to_pmd_walk(k_pgd, LDT_BASE_ADDR); -+ u_pmd = pgd_to_pmd_walk(u_pgd, LDT_BASE_ADDR); -+ -+ if (static_cpu_has(X86_FEATURE_PTI) && !mm->context.ldt) -+ set_pmd(u_pmd, *k_pmd); -+} -+ -+static void sanity_check_ldt_mapping(struct mm_struct *mm) -+{ -+ pgd_t *k_pgd = pgd_offset(mm, LDT_BASE_ADDR); -+ pgd_t *u_pgd = kernel_to_user_pgdp(k_pgd); -+ bool had_kernel, had_user; -+ pmd_t *k_pmd, *u_pmd; -+ -+ k_pmd = pgd_to_pmd_walk(k_pgd, LDT_BASE_ADDR); -+ u_pmd = pgd_to_pmd_walk(u_pgd, LDT_BASE_ADDR); -+ had_kernel = (k_pmd->pmd != 0); -+ had_user = (u_pmd->pmd != 0); -+ -+ do_sanity_check(mm, had_kernel, had_user); -+} -+ -+#else /* !CONFIG_X86_PAE */ -+ - static void map_ldt_struct_to_user(struct mm_struct *mm) - { - pgd_t *pgd = pgd_offset(mm, LDT_BASE_ADDR); -@@ -143,6 +194,8 @@ static void sanity_check_ldt_mapping(struct mm_struct *mm) - do_sanity_check(mm, had_kernel, had_user); - } - -+#endif /* CONFIG_X86_PAE */ -+ - /* - * If PTI is enabled, this maps the LDT into the kernelmode and - * usermode tables for the given mm. --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0033-x86-pti-Allow-CONFIG_PAGE_TABLE_ISOLATION-for-x86_32.patch b/kernel/kernel/files/patches/mageia/pti32bit-0033-x86-pti-Allow-CONFIG_PAGE_TABLE_ISOLATION-for-x86_32.patch deleted file mode 100644 index d6842089..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0033-x86-pti-Allow-CONFIG_PAGE_TABLE_ISOLATION-for-x86_32.patch +++ /dev/null @@ -1,25 +0,0 @@ -From c15b3c596de19962f32b8aecb5abe56a9455a342 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Tue, 16 Jan 2018 11:33:01 +0100 -Subject: [PATCH 33/34] x86/pti: Allow CONFIG_PAGE_TABLE_ISOLATION for x86_32 - -Allow PTI to be compiled on x86_32. - -Signed-off-by: Joerg Roedel ---- - security/Kconfig | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - -diff --git a/security/Kconfig b/security/Kconfig -index b0cb9a5f9448..93d85fda0f54 100644 ---- a/security/Kconfig -+++ b/security/Kconfig -@@ -56,7 +56,7 @@ config SECURITY_NETWORK - - config PAGE_TABLE_ISOLATION - bool "Remove the kernel mapping in user mode" -- depends on X86_64 && !UML -+ depends on X86 && !UML - default y - help - This feature reduces the number of hardware side channels by diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0034-x86-mm-pti-Add-Warning-when-booting-on-a-PCID-capabl.patch b/kernel/kernel/files/patches/mageia/pti32bit-0034-x86-mm-pti-Add-Warning-when-booting-on-a-PCID-capabl.patch deleted file mode 100644 index 1339d475..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0034-x86-mm-pti-Add-Warning-when-booting-on-a-PCID-capabl.patch +++ /dev/null @@ -1,45 +0,0 @@ -From e7591bc0c06694418c773c099f84b79003257069 Mon Sep 17 00:00:00 2001 -From: Joerg Roedel -Date: Mon, 12 Feb 2018 19:47:19 +0100 -Subject: [PATCH 34/34] x86/mm/pti: Add Warning when booting on a PCID capable - CPU - -Warn the user in case the performance can be significantly -improved by switching to a 64-bit kernel. - -Suggested-by: Andy Lutomirski -Signed-off-by: Joerg Roedel ---- - arch/x86/mm/pti.c | 16 ++++++++++++++++ - 1 file changed, 16 insertions(+) - -diff --git a/arch/x86/mm/pti.c b/arch/x86/mm/pti.c -index 3ffd92309aca..8f5aa0dda327 100644 ---- a/arch/x86/mm/pti.c -+++ b/arch/x86/mm/pti.c -@@ -385,6 +385,22 @@ void __init pti_init(void) - - pr_info("enabled\n"); - -+#ifdef CONFIG_X86_32 -+ if (boot_cpu_has(X86_FEATURE_PCID)) { -+ /* Use printk to work around pr_fmt() */ -+ printk(KERN_WARNING "\n"); -+ printk(KERN_WARNING "************************************************************\n"); -+ printk(KERN_WARNING "** WARNING! WARNING! WARNING! WARNING! WARNING! WARNING! **\n"); -+ printk(KERN_WARNING "** **\n"); -+ printk(KERN_WARNING "** You are using 32-bit PTI on a 64-bit PCID-capable CPU. **\n"); -+ printk(KERN_WARNING "** Your performance will increase dramatically if you **\n"); -+ printk(KERN_WARNING "** switch to a 64-bit kernel! **\n"); -+ printk(KERN_WARNING "** **\n"); -+ printk(KERN_WARNING "** WARNING! WARNING! WARNING! WARNING! WARNING! WARNING! **\n"); -+ printk(KERN_WARNING "************************************************************\n"); -+ } -+#endif -+ - pti_clone_user_shared(); - pti_clone_entry_text(); - pti_setup_espfix64(); --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/pti32bit-0100-tone-down-PCID-on-32bit-message.patch b/kernel/kernel/files/patches/mageia/pti32bit-0100-tone-down-PCID-on-32bit-message.patch deleted file mode 100644 index 9e14a8ea..00000000 --- a/kernel/kernel/files/patches/mageia/pti32bit-0100-tone-down-PCID-on-32bit-message.patch +++ /dev/null @@ -1,32 +0,0 @@ - -Dont scare people with something that should be an informal message. - -Signed-off-by: Thomas Backlund - ---- linux/arch/x86/mm/pti.c.orig -+++ linux/arch/x86/mm/pti.c -@@ -388,16 +388,14 @@ void __init pti_init(void) - #ifdef CONFIG_X86_32 - if (boot_cpu_has(X86_FEATURE_PCID)) { - /* Use printk to work around pr_fmt() */ -- printk(KERN_WARNING "\n"); -- printk(KERN_WARNING "************************************************************\n"); -- printk(KERN_WARNING "** WARNING! WARNING! WARNING! WARNING! WARNING! WARNING! **\n"); -- printk(KERN_WARNING "** **\n"); -- printk(KERN_WARNING "** You are using 32-bit PTI on a 64-bit PCID-capable CPU. **\n"); -- printk(KERN_WARNING "** Your performance will increase dramatically if you **\n"); -- printk(KERN_WARNING "** switch to a 64-bit kernel! **\n"); -- printk(KERN_WARNING "** **\n"); -- printk(KERN_WARNING "** WARNING! WARNING! WARNING! WARNING! WARNING! WARNING! **\n"); -- printk(KERN_WARNING "************************************************************\n"); -+ printk(KERN_INFO "\n"); -+ printk(KERN_INFO "************************************************************\n"); -+ printk(KERN_INFO "** **\n"); -+ printk(KERN_INFO "** You are using 32-bit PTI on a 64-bit PCID-capable CPU. **\n"); -+ printk(KERN_INFO "** Your performance will increase dramatically if you **\n"); -+ printk(KERN_INFO "** switch to a 64-bit install. **\n"); -+ printk(KERN_INFO "** **\n"); -+ printk(KERN_INFO "************************************************************\n"); - } - #endif - diff --git a/kernel/kernel/files/patches/mageia/sched-topology-Introduce-NUMA-identity-node-sched-domain.patch b/kernel/kernel/files/patches/mageia/sched-topology-Introduce-NUMA-identity-node-sched-domain.patch deleted file mode 100644 index 2db23c18..00000000 --- a/kernel/kernel/files/patches/mageia/sched-topology-Introduce-NUMA-identity-node-sched-domain.patch +++ /dev/null @@ -1,123 +0,0 @@ -From 051f3ca02e46432c0965e8948f00c07d8a2f09c0 Mon Sep 17 00:00:00 2001 -From: Suravee Suthikulpanit -Date: Thu, 7 Sep 2017 02:20:05 -0500 -Subject: sched/topology: Introduce NUMA identity node sched domain - -On AMD Family17h-based (EPYC) system, a logical NUMA node can contain -upto 8 cores (16 threads) with the following topology. - - ---------------------------- - C0 | T0 T1 | || | T0 T1 | C4 - --------| || |-------- - C1 | T0 T1 | L3 || L3 | T0 T1 | C5 - --------| || |-------- - C2 | T0 T1 | #0 || #1 | T0 T1 | C6 - --------| || |-------- - C3 | T0 T1 | || | T0 T1 | C7 - ---------------------------- - -Here, there are 2 last-level (L3) caches per logical NUMA node. -A socket can contain upto 4 NUMA nodes, and a system can support -upto 2 sockets. With full system configuration, current scheduler -creates 4 sched domains: - - domain0 SMT (span a core) - domain1 MC (span a last-level-cache) - domain2 NUMA (span a socket: 4 nodes) - domain3 NUMA (span a system: 8 nodes) - -Note that there is no domain to represent cpus spaning a logical -NUMA node. With this hierarchy of sched domains, the scheduler does -not balance properly in the following cases: - -Case1: - - When running 8 tasks, a properly balanced system should - schedule a task per logical NUMA node. This is not the case for - the current scheduler. - -Case2: - - In some cases, threads are scheduled on the same cpu, while other - cpus are idle. This results in run-to-run inconsistency. For example: - - taskset -c 0-7 sysbench --num-threads=8 --test=cpu \ - --cpu-max-prime=100000 run - -Total execution time ranges from 25.1s to 33.5s depending on threads -placement, where 25.1s is when all 8 threads are balanced properly -on 8 cpus. - -Introducing NUMA identity node sched domain, which is based on how -SRAT/SLIT table define a logical NUMA node. This results in the following -hierarchy of sched domains on the same system described above. - - domain0 SMT (span a core) - domain1 MC (span a last-level-cache) - domain2 NODE (span a logical NUMA node) - domain3 NUMA (span a socket: 4 nodes) - domain4 NUMA (span a system: 8 nodes) - -This fixes the improper load balancing cases mentioned above. - -Signed-off-by: Suravee Suthikulpanit -Signed-off-by: Peter Zijlstra (Intel) -Cc: Linus Torvalds -Cc: Mike Galbraith -Cc: Peter Zijlstra -Cc: Thomas Gleixner -Cc: bp@suse.de -Link: http://lkml.kernel.org/r/1504768805-46716-1-git-send-email-suravee.suthikulpanit@amd.com -Signed-off-by: Ingo Molnar ---- - kernel/sched/topology.c | 18 +++++++++++++++--- - 1 file changed, 15 insertions(+), 3 deletions(-) - -diff --git a/kernel/sched/topology.c b/kernel/sched/topology.c -index 86e81f06..f51d123 100644 ---- a/kernel/sched/topology.c -+++ b/kernel/sched/topology.c -@@ -1332,6 +1332,10 @@ void sched_init_numa(void) - if (!sched_domains_numa_distance) - return; - -+ /* Includes NUMA identity node at level 0. */ -+ sched_domains_numa_distance[level++] = curr_distance; -+ sched_domains_numa_levels = level; -+ - /* - * O(nr_nodes^2) deduplicating selection sort -- in order to find the - * unique distances in the node_distance() table. -@@ -1379,8 +1383,7 @@ void sched_init_numa(void) - return; - - /* -- * 'level' contains the number of unique distances, excluding the -- * identity distance node_distance(i,i). -+ * 'level' contains the number of unique distances - * - * The sched_domains_numa_distance[] array includes the actual distance - * numbers. -@@ -1442,9 +1445,18 @@ void sched_init_numa(void) - tl[i] = sched_domain_topology[i]; - - /* -+ * Add the NUMA identity distance, aka single NODE. -+ */ -+ tl[i++] = (struct sched_domain_topology_level){ -+ .mask = sd_numa_mask, -+ .numa_level = 0, -+ SD_INIT_NAME(NODE) -+ }; -+ -+ /* - * .. and append 'j' levels of NUMA goodness. - */ -- for (j = 0; j < level; i++, j++) { -+ for (j = 1; j < level; i++, j++) { - tl[i] = (struct sched_domain_topology_level){ - .mask = sd_numa_mask, - .sd_flags = cpu_numa_flags, --- -cgit v1.1 - diff --git a/kernel/kernel/files/patches/mageia/scsi-core-Avoid-that-ATA-error-handling-can-trigger-a-kernel-hang-or-oops.patch b/kernel/kernel/files/patches/mageia/scsi-core-Avoid-that-ATA-error-handling-can-trigger-a-kernel-hang-or-oops.patch deleted file mode 100644 index c2bdadef..00000000 --- a/kernel/kernel/files/patches/mageia/scsi-core-Avoid-that-ATA-error-handling-can-trigger-a-kernel-hang-or-oops.patch +++ /dev/null @@ -1,126 +0,0 @@ -From 3be8828fc507cdafe7040a3dcf361a2bcd8e305b Mon Sep 17 00:00:00 2001 -From: Bart Van Assche -Date: Thu, 22 Feb 2018 11:30:20 -0800 -Subject: scsi: core: Avoid that ATA error handling can trigger a kernel hang - or oops - -Avoid that the recently introduced call_rcu() call in the SCSI core -triggers a double call_rcu() call. - -Reported-by: Natanael Copa -Reported-by: Damien Le Moal -References: https://bugzilla.kernel.org/show_bug.cgi?id=198861 -Fixes: 3bd6f43f5cb3 ("scsi: core: Ensure that the SCSI error handler gets woken up") -Signed-off-by: Bart Van Assche -Reviewed-by: Damien Le Moal -Tested-by: Damien Le Moal -Cc: Natanael Copa -Cc: Damien Le Moal -Cc: Alexandre Oliva -Cc: Pavel Tikhomirov -Cc: Hannes Reinecke -Cc: Johannes Thumshirn -Cc: -Signed-off-by: Martin K. Petersen ---- - drivers/scsi/hosts.c | 3 --- - drivers/scsi/scsi_error.c | 5 +++-- - drivers/scsi/scsi_lib.c | 2 ++ - include/scsi/scsi_cmnd.h | 3 +++ - include/scsi/scsi_host.h | 2 -- - 5 files changed, 8 insertions(+), 7 deletions(-) - -diff --git a/drivers/scsi/hosts.c b/drivers/scsi/hosts.c -index 57bf43e..dd94649 100644 ---- a/drivers/scsi/hosts.c -+++ b/drivers/scsi/hosts.c -@@ -328,8 +328,6 @@ static void scsi_host_dev_release(struct device *dev) - if (shost->work_q) - destroy_workqueue(shost->work_q); - -- destroy_rcu_head(&shost->rcu); -- - if (shost->shost_state == SHOST_CREATED) { - /* - * Free the shost_dev device name here if scsi_host_alloc() -@@ -404,7 +402,6 @@ struct Scsi_Host *scsi_host_alloc(struct scsi_host_template *sht, int privsize) - INIT_LIST_HEAD(&shost->starved_list); - init_waitqueue_head(&shost->host_wait); - mutex_init(&shost->scan_mutex); -- init_rcu_head(&shost->rcu); - - index = ida_simple_get(&host_index_ida, 0, 0, GFP_KERNEL); - if (index < 0) -diff --git a/drivers/scsi/scsi_error.c b/drivers/scsi/scsi_error.c -index d042915..ca53a5f 100644 ---- a/drivers/scsi/scsi_error.c -+++ b/drivers/scsi/scsi_error.c -@@ -223,7 +223,8 @@ static void scsi_eh_reset(struct scsi_cmnd *scmd) - - static void scsi_eh_inc_host_failed(struct rcu_head *head) - { -- struct Scsi_Host *shost = container_of(head, typeof(*shost), rcu); -+ struct scsi_cmnd *scmd = container_of(head, typeof(*scmd), rcu); -+ struct Scsi_Host *shost = scmd->device->host; - unsigned long flags; - - spin_lock_irqsave(shost->host_lock, flags); -@@ -259,7 +260,7 @@ void scsi_eh_scmd_add(struct scsi_cmnd *scmd) - * Ensure that all tasks observe the host state change before the - * host_failed change. - */ -- call_rcu(&shost->rcu, scsi_eh_inc_host_failed); -+ call_rcu(&scmd->rcu, scsi_eh_inc_host_failed); - } - - /** -diff --git a/drivers/scsi/scsi_lib.c b/drivers/scsi/scsi_lib.c -index 5cbc69b..4af1682 100644 ---- a/drivers/scsi/scsi_lib.c -+++ b/drivers/scsi/scsi_lib.c -@@ -670,6 +670,7 @@ static bool scsi_end_request(struct request *req, blk_status_t error, - if (!blk_rq_is_scsi(req)) { - WARN_ON_ONCE(!(cmd->flags & SCMD_INITIALIZED)); - cmd->flags &= ~SCMD_INITIALIZED; -+ destroy_rcu_head(&cmd->rcu); - } - - if (req->mq_ctx) { -@@ -1150,6 +1151,7 @@ static void scsi_initialize_rq(struct request *rq) - struct scsi_cmnd *cmd = blk_mq_rq_to_pdu(rq); - - scsi_req_init(&cmd->req); -+ init_rcu_head(&cmd->rcu); - cmd->jiffies_at_alloc = jiffies; - cmd->retries = 0; - } -diff --git a/include/scsi/scsi_cmnd.h b/include/scsi/scsi_cmnd.h -index 949a016..0382cea 100644 ---- a/include/scsi/scsi_cmnd.h -+++ b/include/scsi/scsi_cmnd.h -@@ -69,6 +69,9 @@ struct scsi_cmnd { - struct list_head list; /* scsi_cmnd participates in queue lists */ - struct list_head eh_entry; /* entry for the host eh_cmd_q */ - struct delayed_work abort_work; -+ -+ struct rcu_head rcu; -+ - int eh_eflags; /* Used by error handlr */ - - /* -diff --git a/include/scsi/scsi_host.h b/include/scsi/scsi_host.h -index 1a1df0d..a8b7bf8 100644 ---- a/include/scsi/scsi_host.h -+++ b/include/scsi/scsi_host.h -@@ -571,8 +571,6 @@ struct Scsi_Host { - struct blk_mq_tag_set tag_set; - }; - -- struct rcu_head rcu; -- - atomic_t host_busy; /* commands actually active on low-level */ - atomic_t host_blocked; - --- -cgit v1.1 - diff --git a/kernel/kernel/files/patches/mageia/scsi-core-return-BLK_STS_OK-for-DID_OK-in-__scsi_error_from_host_byte.patch b/kernel/kernel/files/patches/mageia/scsi-core-return-BLK_STS_OK-for-DID_OK-in-__scsi_error_from_host_byte.patch deleted file mode 100644 index 30489291..00000000 --- a/kernel/kernel/files/patches/mageia/scsi-core-return-BLK_STS_OK-for-DID_OK-in-__scsi_error_from_host_byte.patch +++ /dev/null @@ -1,34 +0,0 @@ -From e39a97353e5378eb46bf01679799c5704d397f32 Mon Sep 17 00:00:00 2001 -From: Hannes Reinecke -Date: Mon, 26 Feb 2018 08:39:59 +0100 -Subject: scsi: core: return BLK_STS_OK for DID_OK in - __scsi_error_from_host_byte() - -When converting __scsi_error_from_host_byte() to BLK_STS error codes the -case DID_OK was forgotten, resulting in it always returning an error. - -Fixes: 2a842acab109 ("block: introduce new block status code type") -Cc: Doug Gilbert -Signed-off-by: Hannes Reinecke -Reviewed-by: Douglas Gilbert -Signed-off-by: Martin K. Petersen ---- - drivers/scsi/scsi_lib.c | 2 ++ - 1 file changed, 2 insertions(+) - -diff --git a/drivers/scsi/scsi_lib.c b/drivers/scsi/scsi_lib.c -index 4af1682..c984404 100644 ---- a/drivers/scsi/scsi_lib.c -+++ b/drivers/scsi/scsi_lib.c -@@ -720,6 +720,8 @@ static blk_status_t __scsi_error_from_host_byte(struct scsi_cmnd *cmd, - int result) - { - switch (host_byte(result)) { -+ case DID_OK: -+ return BLK_STS_OK; - case DID_TRANSPORT_FAILFAST: - return BLK_STS_TRANSPORT; - case DID_TARGET_FAILURE: --- -cgit v1.1 - diff --git a/kernel/kernel/files/patches/mageia/scsi-megaraid-new-sysfs-name.patch b/kernel/kernel/files/patches/mageia/scsi-megaraid-new-sysfs-name.patch deleted file mode 100644 index c750150f..00000000 --- a/kernel/kernel/files/patches/mageia/scsi-megaraid-new-sysfs-name.patch +++ /dev/null @@ -1,15 +0,0 @@ ---- - drivers/scsi/megaraid/megaraid_mbox.c | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - ---- linux-3.8-rc3-mga0.1/drivers/scsi/megaraid/megaraid_mbox.c.scsi-megaraid-new-sysfs-name.orig 2013-01-10 08:17:11.000000000 +0200 -+++ linux-3.8-rc3-mga0.1/drivers/scsi/megaraid/megaraid_mbox.c 2013-01-10 08:30:19.908301909 +0200 -@@ -302,7 +302,7 @@ MODULE_DEVICE_TABLE(pci, pci_id_table_g) - - - static struct pci_driver megaraid_pci_driver = { -- .name = "megaraid", -+ .name = "megaraid_mbox", - .id_table = pci_id_table_g, - .probe = megaraid_probe_one, - .remove = megaraid_detach_one, diff --git a/kernel/kernel/files/patches/mageia/scsi-ppscsi-2.6.2.patch b/kernel/kernel/files/patches/mageia/scsi-ppscsi-2.6.2.patch deleted file mode 100644 index bf7be4ba..00000000 --- a/kernel/kernel/files/patches/mageia/scsi-ppscsi-2.6.2.patch +++ /dev/null @@ -1,5083 +0,0 @@ ---- - drivers/scsi/Kconfig | 36 + - drivers/scsi/Makefile | 10 - drivers/scsi/epsa2.c | 507 +++++++++++++++++++ - drivers/scsi/epst.c | 478 ++++++++++++++++++ - drivers/scsi/onscsi.c | 544 ++++++++++++++++++++ - drivers/scsi/ppscsi.c | 1294 +++++++++++++++++++++++++++++++++++++++++++++++++ - drivers/scsi/ppscsi.h | 356 +++++++++++++ - drivers/scsi/sparcsi.c | 389 ++++++++++++++ - drivers/scsi/t348.c | 318 ++++++++++++ - drivers/scsi/t358.c | 394 ++++++++++++++ - drivers/scsi/vpi0.c | 276 ++++++++++ - drivers/scsi/vpi2.c | 418 +++++++++++++++ - 12 files changed, 5020 insertions(+) - ---- /dev/null -+++ b/drivers/scsi/vpi2.c -@@ -0,0 +1,418 @@ -+/* -+ vpi2.c (c) 1995-1999 Grant Guenther -+ (c) 1997-1999 David Campbell -+ (c) 2000 Tim Waugh -+ -+ This is the ppSCSI protocol module for the Iomega VPI2 adapter -+ found in the newer ZIP-100 drives. -+ -+*/ -+ -+#error "This doesn't work yet." -+ -+#define VPI2_VERSION "0.91" -+ -+#define PPSC_BASE -+#define PPSC_HA_MODULE -+ -+#include "ppscsi.h" -+ -+static char vpi2_map[256]; /* status bits permutation */ -+ -+static void vpi2_init (PHA *pha) -+{ -+ -+/* *** No MSG line on the VPI2 ! *** */ /* tmw: is this true for VPI2? */ -+ -+/* { REQ, BSY, MSG, CD, IO} */ -+ -+ char key[5] = {0x80,0x40,0x00,0x20,0x10}; -+ -+ ppsc_make_map(vpi2_map,key,0); -+ sprintf(pha->ident,"vpi2 %s (%s) ",VPI2_VERSION,PPSC_H_VERSION); -+} -+ -+#define j44(a,b) ((a&0xf0)|((b>>4)&0x0f)) -+ -+#define CST(v) w2(0xc);w0(v);w2(4);w2(6);w2(4);w2(0xc); -+#define DST(v) w2(0xc);w0(v);w2(0xc);w2(0xe);w2(0xc);w2(4);w2(0xc); -+ -+static inline int imm_cpp (PHA *pha, unsigned char b) -+{ -+ unsigned char s1, s2, s3; -+ -+ w2(0xc); -+ udelay(2); /* 1 usec - infinite */ -+ w0(0xaa); -+ udelay(10); /* 7 usec - infinite */ -+ w0(0x55); -+ udelay(10); /* 7 usec - infinite */ -+ w0(0x00); -+ udelay(10); /* 7 usec - infinite */ -+ w0(0xff); -+ udelay(10); /* 7 usec - infinite */ -+ s1 = r1() & 0xb8; -+ w0(0x87); -+ udelay(10); /* 7 usec - infinite */ -+ s2 = r1() & 0xb8; -+ w0(0x78); -+ udelay(10); -+ s3 = r1() & 0x38; -+ /* -+ * Values for b are: -+ * 0000 00aa Assign address aa to current device -+ * 0010 00aa Select device aa in EPP Winbond mode -+ * 0010 10aa Select device aa in EPP mode -+ * 0011 xxxx Deselect all devices -+ * 0110 00aa Test device aa -+ * 1101 00aa Select device aa in ECP mode -+ * 1110 00aa Select device aa in Compatible mode -+ */ -+ w0(b); -+ udelay(2); /* 1 usec - infinite */ -+ w2(0x0c); -+ udelay(10); /* 7 usec - infinite */ -+ w2(0x0d); -+ udelay(2); /* 1 usec - infinite */ -+ w2(0x0c); -+ udelay(10); /* 7 usec - infinite */ -+ w0(0xff); -+ udelay(10); /* 7 usec - infinite */ -+ -+ /* -+ * The following table is electrical pin values. -+ * (BSY is inverted at the CTR register) -+ * -+ * BSY ACK POut SEL Fault -+ * S1 0 X 1 1 1 -+ * S2 1 X 0 1 1 -+ * S3 L X 1 1 S -+ * -+ * L => Last device in chain -+ * S => Selected -+ * -+ * Observered values for S1,S2,S3 are: -+ * Disconnect => f8/58/78 -+ * Connect => f8/58/70 -+ */ -+ if ((s1 == 0xb8) && (s2 == 0x18) && (s3 == 0x30)) -+ return 1; /* Connected */ -+ if ((s1 == 0xb8) && (s2 == 0x18) && (s3 == 0x38)) -+ return 0; /* Disconnected */ -+ -+ return -1; /* No device present */ -+} -+ -+static inline int do_vpi2_connect (PHA *pha) -+{ -+ pha->saved_r0 = r0(); -+ pha->saved_r2 = r2(); -+ -+ imm_cpp(pha, 0xe0); /* Select device 0 in compatible mode */ -+ imm_cpp(pha, 0x30); /* Disconnect all devices */ -+ -+ if (pha->mode >= 2) -+ /* Select device 0 in EPP mode */ -+ return imm_cpp (pha, 0x28); -+ -+ /* Select device 0 in compatible mode */ -+ return imm_cpp (pha, 0xe0); -+} -+ -+static void vpi2_connect (PHA *pha) -+{ -+ printk ("--> vpi2_connect\n"); -+ do_vpi2_connect (pha); -+ printk ("<--\n"); -+} -+ -+static void vpi2_disconnect (PHA *pha) -+{ -+ printk ("--> vpi2_disconnect\n"); -+ imm_cpp (pha, 0x30); /* Disconnect all devices */ -+ -+ w2(pha->saved_r2); -+ w0(pha->saved_r0); -+ printk ("<--\n"); -+} -+ -+ -+/* There are no data-transfer tests available, just this simple -+ check that we are talking to a VPI2. */ -+static int vpi2_test_proto (PHA *pha) -+{ -+ int e = 1; -+ -+ printk ("--> vpi2_test_proto\n"); -+ if (do_vpi2_connect(pha) == 1) -+ e--; -+ -+ vpi2_disconnect (pha); -+ printk ("<-- %d\n", e); -+ return e; -+} -+ -+static int vpi2_select (PHA *pha, int initiator, int target) -+{ -+ printk ("--> vpi2_select\n"); -+ w2(0xc); -+ if (r1() & 0x08) { -+ printk ("<-- -1 (busy)\n"); -+ return -1; /* bus busy */ -+ } -+ -+ /* -+ * Now assert the SCSI ID (HOST and TARGET) on the data bus -+ */ -+ w2(0x4); -+ w0(0x80 | (1 << target)); -+ udelay (1); -+ -+ /* -+ * Deassert SELIN first followed by STROBE -+ */ -+ w2(0xc); -+ w2(0xd); -+ -+ printk ("<-- 0\n"); -+ return 0; -+ -+} -+ -+static int vpi2_test_select (PHA *pha) -+{ -+ int val = r1() & 0x08; -+ printk ("--> vpi2_test_select\n<-- %d\n", val); -+ return val; /* BSY asserted ? */ -+} -+ -+static void vpi2_select_finish (PHA *pha) -+{ -+ printk ("--> vpi2_select_finish\n<--\n"); -+ w2(0xc); -+} -+ -+static void vpi2_deselect (PHA *pha) -+{ -+ printk ("--> vpi2_deselect\n<--\n"); -+ w2(0xc); -+} -+ -+static int vpi2_get_bus_status (PHA *pha) -+{ -+ int val; -+ printk ("--> vpi2_get_bus_status\n"); -+ w2(0xc); -+ val = vpi2_map[r1()]; -+ printk ("<-- %d\n", val); -+ return val; -+} -+ -+/* These functions are inlined so the C optimiser can move the switches -+ outside of loops where possible, am I dreaming ? */ -+ -+static inline int vpi2_read (PHA *pha, int first) -+{ -+ int l, h; -+ -+ printk ("--> vpi2_read\n<--\n"); -+ -+ switch (pha->mode) { -+ -+ case 0: if (first) w2(4); -+ w2(0x6); h = r1(); -+ w2(0x5); l = r1(); w2(4); -+ return j44(h,l); -+ -+ case 1: if (first) w2(0x25); -+ w2(0x26); -+ l = r0(); -+ w2(0x25); -+ return l; -+ -+ case 2: if (first) w2(0x24); -+ return r4(); -+ -+ default: return -1; -+ -+ } -+} -+ -+static inline void vpi2_write (PHA *pha, int v, int first ) -+{ -+ static int alternate; -+ -+ printk ("--> vpi2_write\n"); -+ -+ switch (pha->mode) { -+ -+ case 0: -+ case 1: -+ if (first) { -+ w2(0xc); -+ alternate = 0; -+ } -+ w0(v); -+ if (alternate) -+ w2(0x0); -+ else -+ w2(0x5); -+ alternate = 1 - alternate; -+ break; -+ -+ case 2: if (first) w2(0x4); -+ w4(v); -+ break; -+ -+ } -+ printk ("<--\n"); -+} -+ -+static void vpi2_slow_start (PHA *pha, char *val) -+{ -+ int r; -+ -+ printk ("--> vpi2_slow_start\n"); -+ -+ w2(0xc); -+ -+ r = (r1() & 0x10); -+ -+ if (r) *val = vpi2_read(pha,1); -+ else vpi2_write(pha,*val,1); -+ -+ printk ("<--\n"); -+} -+ -+static int vpi2_slow_done (PHA *pha) -+{ -+ printk ("--> vpi2_slow_done\n<--\n"); -+ return 1; /* vpi2 does its own REQ/ACK handshaking */ -+} -+ -+static void vpi2_slow_end (PHA *pha) -+{ -+ printk ("--> vpi2_slow_end\n<--\n"); -+ w2(0xc); -+} -+ -+static void vpi2_start_block (PHA *pha, int rd) -+{ -+ printk ("--> vpi2_start_block\n<--\n"); -+ pha->priv_flag = rd; -+} -+ -+static int vpi2_transfer_ready (PHA *pha) -+{ -+ int b; -+ -+ printk ("--> vpi2_transfer_ready\n<--\n"); -+ b = vpi2_get_bus_status(pha); -+ if ((b & PPSC_PH_STAT) == PPSC_PH_STAT) return -1; -+ if (b == (PPSC_REQ|PPSC_BSY| pha->priv_flag)) return 128; -+ return 0; -+} -+ -+static int vpi2_transfer_block (PHA *pha, char * buf, int buflen, int rd) -+{ -+ int k, n, i; -+ -+ printk ("--> vpi2_transfer_block\n"); -+ k = 0; -+ while (k < buflen) { -+ n = vpi2_transfer_ready(pha); -+ if (n <= 0 ) break; -+ if (n > (buflen-k)) n = buflen-k; -+ for (i=0;i vpi2_transfer_done\n<-- 1\n"); -+ return 1; -+} -+ -+static void vpi2_end_block (PHA *pha, int rd) -+{ -+ printk ("--> vpi2_end_block\n<--\n"); -+ w2(0xc); -+} -+ -+static void vpi2_reset_bus (PHA *pha) -+{ -+ printk ("--> vpi2_reset_bus\n<--\n"); -+ w2(0xc); -+ w0(0x40); w2(8); udelay(60); -+ w2(0xc); -+} -+ -+/* Make these correspond to the actual modes supported by the adapter */ -+ -+static char *(mode_strings[3]) = {"Nybble","PS/2","EPP"}; -+ -+static struct ppsc_protocol vpi2_psp = { -+ -+ {&host0,&host1,&host2,&host3}, /* params */ -+ &host_structs, /* hosts */ -+ 3, /* num_modes */ -+ 2, /* epp_first */ -+ 1, /* default_delay */ -+ 0, /* can_message */ -+ 16, /* sg_tablesize */ -+ mode_strings, -+ vpi2_init, -+ NULL, -+ vpi2_connect, -+ vpi2_disconnect, -+ vpi2_test_proto, -+ vpi2_select, -+ vpi2_test_select, -+ vpi2_select_finish, -+ vpi2_deselect, -+ vpi2_get_bus_status, -+ vpi2_slow_start, -+ vpi2_slow_done, -+ vpi2_slow_end, -+ vpi2_start_block, -+ vpi2_transfer_block, -+ vpi2_transfer_ready, -+ vpi2_transfer_done, -+ vpi2_end_block, -+ vpi2_reset_bus -+}; -+ -+int vpi2_detect (struct scsi_host_template *tpnt) -+{ -+ int val; -+ printk ("--> vpi2_detect\n"); -+ val = ppsc_detect( &vpi2_psp, tpnt, verbose); -+ printk ("<-- %d\n", val); -+ return val; -+} -+ -+#ifdef MODULE -+ -+struct scsi_host_template driver_template = PPSC_TEMPLATE(vpi2); -+ -+#include "scsi_module.c" -+ -+MODULE_LICENSE("GPL"); -+ -+#else -+ -+void vpi2_setup (char *str, int *ints) -+{ -+ printk ("--> vpi2_setup\n"); -+ ppsc_gen_setup(stt,4,str); -+ printk ("<--\n"); -+} -+ -+#endif -+ -+/* end of vpi2.c */ ---- /dev/null -+++ b/drivers/scsi/vpi0.c -@@ -0,0 +1,276 @@ -+/* -+ vpi0.c (c) 1995-1999 Grant Guenther -+ (c) 1997-1999 David Campbell -+ -+ This is the ppSCSI protocol module for the Iomega VPI0 adapter -+ found in the original ZIP-100 drives and the Jaz Traveller. -+ -+*/ -+ -+#define VPI0_VERSION "0.91" -+ -+#define PPSC_BASE -+#define PPSC_HA_MODULE -+ -+#include "ppscsi.h" -+ -+static char vpi0_map[256]; /* status bits permutation */ -+ -+static void vpi0_init (PHA *pha) -+{ -+ -+/* *** No MSG line on the VPI0 ! *** */ -+ -+/* { REQ, BSY, MSG, CD, IO} */ -+ -+ char key[5] = {0x80,0x40,0x00,0x20,0x10}; -+ -+ ppsc_make_map(vpi0_map,key,0); -+ sprintf(pha->ident,"vpi0 %s (%s) ",VPI0_VERSION,PPSC_H_VERSION); -+} -+ -+#define j44(a,b) ((a&0xf0)|((b>>4)&0x0f)) -+ -+#define CST(v) w2(0xc);w0(v);w2(4);w2(6);w2(4);w2(0xc); -+#define DST(v) w2(0xc);w0(v);w2(0xc);w2(0xe);w2(0xc);w2(4);w2(0xc); -+ -+static void vpi0_connect (PHA *pha) -+{ -+ pha->saved_r0 = r0(); -+ pha->saved_r2 = r2(); -+ -+ CST(0); CST(0x3c); CST(0x20); -+ if (pha->mode >= 2) { CST(0xcf) } else { CST(0x8f) } -+} -+ -+static void vpi0_disconnect (PHA *pha) -+{ -+ DST(0); DST(0x3c); DST(0x20); DST(0xf); -+ -+ w2(pha->saved_r2); -+ w0(pha->saved_r0); -+} -+ -+ -+/* There are no data-transfer tests available, just this simple -+ check that we are talking to a VPI0. */ -+static int vpi0_test_proto (PHA *pha) -+{ -+ int e = 2; -+ -+ vpi0_connect(pha); -+ w2(0xe); -+ if ((r1() & 8) == 8) e--; -+ w2(0xc); -+ if ((r1() & 8) == 0) e--; -+ vpi0_disconnect(pha); -+ return e; -+} -+ -+static int vpi0_select (PHA *pha, int initiator, int target) -+{ -+ w2(0xc); -+ if (r1() & 0x40) return -1; /* bus busy */ -+ -+ w0(1<mode) { -+ -+ case 0: if (first) w2(4); -+ h = r1(); w2(6); -+ l = r1(); w2(4); -+ return j44(h,l); -+ -+ case 1: if (first) w2(0x25); -+ l = r0(); -+ w2(0x27); w2(0x25); -+ return l; -+ -+ case 2: if (first) w2(0x24); -+ return r4(); -+ -+ default: return -1; -+ -+ } -+} -+ -+static inline void vpi0_write (PHA *pha, int v, int first ) -+{ -+ switch (pha->mode) { -+ -+ case 0: -+ case 1: if (first) w2(0xc); -+ w0(v); w2(0xe); w2(0xc); -+ break; -+ -+ case 2: if (first) w2(0x4); -+ w4(v); -+ break; -+ -+ } -+} -+ -+static void vpi0_slow_start (PHA *pha, char *val) -+{ -+ int r; -+ -+ w2(0xc); -+ -+ r = (r1() & 0x10); -+ -+ if (r) *val = vpi0_read(pha,1); -+ else vpi0_write(pha,*val,1); -+ -+} -+ -+static int vpi0_slow_done (PHA *pha) -+{ -+ return 1; /* vpi0 does its own REQ/ACK handshaking */ -+} -+ -+static void vpi0_slow_end (PHA *pha) -+{ -+ w2(0xc); -+} -+ -+static void vpi0_start_block (PHA *pha, int rd) -+{ -+ pha->priv_flag = rd; -+} -+ -+static int vpi0_transfer_ready (PHA *pha) -+{ -+ int b; -+ -+ b = vpi0_get_bus_status(pha); -+ if ((b & PPSC_PH_STAT) == PPSC_PH_STAT) return -1; -+ if (b == (PPSC_REQ|PPSC_BSY| pha->priv_flag)) return 128; -+ return 0; -+} -+ -+static int vpi0_transfer_block (PHA *pha, char * buf, int buflen, int rd) -+{ -+ int k, n, i; -+ -+ k = 0; -+ while (k < buflen) { -+ n = vpi0_transfer_ready(pha); -+ if (n <= 0 ) break; -+ if (n > (buflen-k)) n = buflen-k; -+ for (i=0;i -+ -+ This is the low-level protocol module for the Adaptec APA-348 -+ (aka Trantor T348) parallel port SCSI adapter. It forms part -+ of the 'ppSCSI' suite of drivers. -+ -+*/ -+ -+#define T348_VERSION "0.92" -+ -+#define PPSC_BASE -+#define PPSC_HA_MODULE -+ -+#include "ppscsi.h" -+ -+#define j44(a,b) (((a<<1)&0xf0)+((b>>3)&0x0f)) -+ -+static char t348_map[256]; /* status bits permutation */ -+ -+static void t348_init (PHA *pha) -+{ -+ -+/* { REQ, BSY, MSG, CD, IO} */ -+ -+ char key[5] = {0x20,0x40,0x10,0x08,0x04}; -+ -+ ppsc_make_map(t348_map,key,0); -+ sprintf(pha->ident,"t348 %s (%s), Adaptec APA-348", -+ T348_VERSION,PPSC_H_VERSION); -+} -+ -+static void t348_write_regr (PHA *pha, int regr, int value) -+{ -+ w0(0x40+regr); w2(1); w2(0); w0(value); w2(8); w2(0); -+} -+ -+static int t348_read_regr (PHA *pha, int regr) -+{ -+ int s,a,b; -+ -+ w0(0x10+regr); s = r2(); w2(s|1); w2(s); w2(8); -+ w0(0x80); a = r1(); w0(0); b = r1(); w2(0); -+ return j44(a,b); -+} -+ -+static void t348_connect (PHA *pha) -+{ -+ int t; -+ -+ pha->saved_r0 = r0(); -+ w0(0); -+ t = r2(); -+ w2(t%16); w0(0xfe); w2(t%4); w2((t%4)+8); w2(0); -+ pha->saved_r2 = t; -+} -+ -+static void t348_disconnect (PHA *pha) -+{ -+ w0(0x71); w2(1); w2(0); -+ w0(pha->saved_r0); -+ w2(pha->saved_r2); -+} -+ -+static int t348_test_proto (PHA *pha) -+{ -+ int k, e, a, b; -+ int wnt[3] = {0x6c, 0x55, 0xaa}; -+ -+ e = 0; -+ -+ t348_connect(pha); -+ -+ switch (pha->mode) { -+ -+ case 0: w0(0x70); w2(1); w2(0); w0(0); -+ for (k=0;k<3;k++) { -+ w2(8); a = r1(); w2(0); -+ w2(8); w2(8); w2(8); w2(8); w2(8); -+ b = r1(); w2(0); -+ if (j44(b,a) != wnt[k]) e++; -+ } -+ break; -+ -+ case 1: w0(0x50); w2(1); w2(0); -+ for (k=0;k<3;k++) { -+ w2(0xe0); w2(0xe8); -+ if (r0() != wnt[k]) e++; -+ w2(0xe0); w2(0xe8); -+ } -+ -+ } -+ -+ t348_disconnect(pha); -+ -+ return e; -+} -+ -+/* The T348 appears to contain a NCR 5380 core. The following -+ functions use the 5380 registers. See NCR5380.h for clues. -+*/ -+ -+#define WR(r,v) t348_write_regr(pha,r,v) -+#define RR(r) (t348_read_regr(pha,r)) -+ -+static int t348_select (PHA *pha, int initiator, int target) -+{ -+ WR(3,0); WR(1,1); -+ WR(0,(1 << initiator)); WR(2,1); udelay(100); -+ if (RR(1) != 0x41) { -+ WR(1,0); -+ return -1; -+ } -+ -+ WR(1,5); WR(0,(1 << initiator)|(1 << target)); -+ WR(2,0); WR(2,0); WR(2,0); -+ return 0; -+} -+ -+static int t348_test_select (PHA *pha) -+{ -+ return ((RR(4) & 0x42) == 0x42); -+} -+ -+static void t348_select_finish (PHA *pha) -+{ -+ WR(3,2); WR(1,5); WR(1,1); -+} -+ -+static void t348_deselect (PHA *pha) -+{ -+ WR(1,0); -+} -+ -+static int t348_get_bus_status (PHA *pha) -+{ -+ int s; -+ -+ s = RR(4); -+ return t348_map[s]; -+} -+ -+static void t348_slow_start (PHA *pha, char *val) -+{ -+ int ph, io; -+ -+ ph = ((RR(4)>>2)&7); -+ io = (ph & 1); -+ -+ WR(3,ph); -+ WR(1,1-io); -+ if (io) *val = RR(0); else WR(0,*val); -+ WR(1,0x10+(1-io)); -+} -+ -+static int t348_slow_done (PHA *pha) -+{ -+ return ((RR(4) & 0x20) == 0); -+} -+ -+static void t348_slow_end (PHA *pha) -+{ -+ int io; -+ -+ io = ((RR(4)>>2)&1); -+ -+ WR(1,1-io); -+} -+ -+static void t348_start_block (PHA *pha, int rd) -+{ -+ if (rd) { -+ -+ WR(3,1); WR(1,0); -+ WR(2,2); WR(7,3); -+ WR(3,1); WR(1,0); -+ -+ switch (pha->mode) { -+ -+ case 0: w0(0x31); w2(1); w2(0); w0(0x80); w2(8); -+ break; -+ -+ case 1: w0(0x21); w2(1); w2(0); w2(0xe8); -+ break; -+ } -+ -+ } else { -+ -+ WR(3,0); WR(1,1); -+ WR(2,2); WR(5,0); -+ WR(3,0); WR(1,1); -+ -+ w0(0x61); w2(1); w2(0); -+ } -+} -+ -+static int t348_transfer_ready (PHA *pha) -+{ -+ if (r1() & 0x80) return 1; -+ -+ if (pha->data_dir == 0) return 0; -+ return -1; -+} -+ -+static int t348_transfer_block (PHA *pha, char * buf, int buflen, int rd) -+{ -+ int k, a, b; -+ -+ k = 0; -+ while (k < buflen) { -+ -+ if (t348_transfer_ready(pha) <= 0) break; -+ -+ if (rd) { -+ switch(pha->mode) { -+ -+ case 0: a = r1(); w0(0); b = r1(); w0(0xc0); -+ buf[k++] = j44(a,b); -+ a = r1(); w0(0x40); b = r1(); w0(0x80); -+ buf[k++] = j44(a,b); -+ break; -+ -+ case 1: buf[k++] = r0(); w2(0xea); -+ buf[k++] = r0(); w2(0xe8); -+ break; -+ } -+ -+ } else { -+ -+ w0(buf[k++]); w2(2); -+ w0(buf[k++]); w2(0); -+ } -+ -+ } -+ -+ return k; -+} -+ -+static int t348_transfer_done (PHA *pha) -+{ -+ return 1; -+} -+ -+static void t348_end_block (PHA *pha, int rd) -+{ -+ w2(0); -+ WR(2,0); -+} -+ -+ -+static void t348_reset_bus (PHA *pha) -+{ -+ WR(1,1); WR(3,0); -+ WR(2,0); -+ WR(1,0x80); udelay(60); -+ WR(1,0); -+ WR(2,0); -+ WR(1,1); WR(3,0); -+ WR(2,0); -+} -+ -+static char *(mode_strings[2]) = {"Nybble","PS/2"}; -+ -+static struct ppsc_protocol t348_psp = { -+ -+ {&host0,&host1,&host2,&host3}, /* params */ -+ &host_structs, /* hosts */ -+ 2, /* num_modes */ -+ 2, /* epp_first */ -+ 1, /* default_delay */ -+ 1, /* can_message */ -+ 0, /* sg_tablesize */ -+ mode_strings, -+ t348_init, -+ NULL, -+ t348_connect, -+ t348_disconnect, -+ t348_test_proto, -+ t348_select, -+ t348_test_select, -+ t348_select_finish, -+ t348_deselect, -+ t348_get_bus_status, -+ t348_slow_start, -+ t348_slow_done, -+ t348_slow_end, -+ t348_start_block, -+ t348_transfer_block, -+ t348_transfer_ready, -+ t348_transfer_done, -+ t348_end_block, -+ t348_reset_bus -+}; -+ -+int t348_detect (struct scsi_host_template *tpnt) -+{ -+ return ppsc_detect( &t348_psp, tpnt, verbose); -+} -+ -+#ifdef MODULE -+ -+struct scsi_host_template driver_template = PPSC_TEMPLATE(t348); -+ -+#include "scsi_module.c" -+ -+MODULE_LICENSE("GPL"); -+ -+#else -+ -+void t348_setup (char *str, int *ints) -+{ -+ ppsc_gen_setup(stt,4,str); -+} -+ -+#endif -+ -+/* end of t348.c */ -+ ---- /dev/null -+++ b/drivers/scsi/t358.c -@@ -0,0 +1,394 @@ -+/* -+ t358.c (c) 1997-1999 Grant Guenther -+ -+ This is the low-level protocol module for the Adaptec APA-358 -+ (aka Trantor T358) parallel port SCSI adapter. It forms part -+ of the 'ppSCSI' suite of drivers. -+ -+*/ -+ -+#define T358_VERSION "0.91" -+ -+#define PPSC_BASE -+#define PPSC_HA_MODULE -+ -+#include "ppscsi.h" -+ -+#define j44(a,b) (((a<<1)&0xf0)+((b>>3)&0x0f)) -+ -+static char t358_map[256]; /* status bits permutation */ -+ -+static void t358_init (PHA *pha) -+{ -+ -+/* { REQ, BSY, MSG, CD, IO} */ -+ -+ char key[5] = {0x20,0x40,0x10,0x08,0x04}; -+ -+ ppsc_make_map(t358_map,key,0); -+ sprintf(pha->ident,"t358 %s (%s), Adaptec APA-358", -+ T358_VERSION,PPSC_H_VERSION); -+} -+ -+static void t358_write_regr (PHA *pha, int regr, int value) -+{ -+ int x; -+ -+ switch (pha->mode) { -+ -+ case 0: -+ case 1: w0(regr); x = r2(); w2(1); w2(9); w2(0); w2(0); -+ w0(value); w2(1); w2(3); w2(0); w2(x); -+ break; -+ -+ case 2: w2(0xc0); w3(regr); w4(value); -+ break; -+ -+ } -+} -+ -+static int t358_read_regr (PHA *pha, int regr) -+{ -+ int h, l; -+ -+ switch (pha->mode) { -+ -+ case 0: w0(regr); w2(1); w2(9); w2(0); w2(0); -+ w0(0x80); w2(2); h = r1(); -+ w0(0); l = r1(); w2(0); -+ return j44(h,l); -+ -+ case 1: w0(regr); h = r2(); w2(1); w2(9); w2(0); w2(0); -+ w2(0xe2); l = r0(); w2(h); -+ return l; -+ -+ case 2: h = r2(); w2(0xe0); w3(regr); w2(0xe0); -+ l = r4(); w2(h); -+ return l; -+ } -+ -+ return 0; -+} -+ -+static void t358_read_block (PHA *pha, char *buf, int len) -+{ -+ int k, h, l; -+ -+ switch (pha->mode) { -+ -+ case 0: w0(0x10); w2(1); w2(9); w2(0); w2(0); -+ for (k=0;kmode) { -+ -+ case 0: -+ case 1: w0(0x10); x = r2(); -+ w2(1); w2(9); w2(0); w2(0); -+ for (k=0;ksaved_r0 = r0(); -+ w0(0); -+ pha->saved_r2 = r2(); -+ b = pha->saved_r2 % 4; -+ w0(0xf7); w2(b+4); w2(b); w2(b+8); w2(b); w2(0); -+ -+ if (pha->mode) { w0(0x80); w2(1); w2(9); w2(1); w2(0); } -+ else { w0(0xa0); w2(1); w2(9); w2(0); } -+} -+ -+static void t358_disconnect (PHA *pha) -+{ -+ w0(pha->saved_r0); -+ w2(pha->saved_r2); -+} -+ -+static int t358_test_proto (PHA *pha) -+{ -+ int h, l, a, b; -+ int j = 0, k = 0, e = 0; -+ -+ t358_connect(pha); -+ -+ switch (pha->mode) { -+ -+ case 0: w0(0x80); w2(8); h = r1(); w0(0); l = r1(); -+ w2(0); w2(8); a = r1(); w0(0); b = r1(); w2(0); -+ k = j44(h,l); j = j44(a,b); -+ break; -+ -+ case 1: w2(0xe0); w0(0); w2(0xe8); k = r0(); -+ w2(0xe0); w2(0xe8); j = r0(); w2(0xe0); -+ break; -+ -+ case 2: w0(0xa0); w2(1); w2(9); w2(0); -+ w0(0x80); w2(8); h = r1(); w0(0); l = r1(); -+ w2(0); w2(8); a = r1(); w0(0); b = r1(); w2(0); -+ k = j44(h,l); j = j44(a,b); -+ w0(0x80); w2(1); w2(9); w2(1); w2(0); -+ -+ } -+ -+ if (V_PROBE) printk("%s: Signature: %x %x\n",pha->device,k,j); -+ -+ if ((k != 0xe8) || (j != 0xff)) e++; -+ -+ t358_disconnect(pha); -+ -+ if (!e) { -+ -+ t358_connect(pha); -+ -+ for (j=0;j<256;j++) { -+ t358_write_regr(pha,0,j); -+ k = t358_read_regr(pha,0); -+ if (k != j) e++; -+ } -+ -+ t358_disconnect(pha); -+ -+ } -+ -+ return e; -+} -+ -+/* The T358 appears to contain a NCR 53c400 core. Check NCR5380.h -+ for hints about the regrs ... */ -+ -+#define WR(r,v) t358_write_regr(pha,r+8,v) -+#define RR(r) (t358_read_regr(pha,r+8)) -+ -+static int t358_select (PHA *pha, int initiator, int target) -+{ -+ WR(3,0); WR(1,1); -+ WR(0,(1 << initiator)); WR(2,1); udelay(100); -+ if (RR(1) != 0x41) { -+ WR(1,0); -+ return -1; -+ } -+ -+ WR(1,5); WR(0,(1 << initiator)|(1 << target)); -+ WR(2,0); WR(2,0); WR(2,0); -+ return 0; -+} -+ -+static int t358_test_select (PHA *pha) -+{ -+ return ((RR(4) & 0x42) == 0x42); -+} -+ -+static void t358_select_finish (PHA *pha) -+{ -+ WR(3,2); WR(1,5); WR(1,1); -+} -+ -+static void t358_deselect (PHA *pha) -+{ -+ WR(1,0); -+} -+ -+static int t358_get_bus_status (PHA *pha) -+{ -+ int s; -+ -+ s = RR(4); -+ return t358_map[s]; -+} -+ -+static void t358_slow_start (PHA *pha, char *val) -+{ -+ int ph, io; -+ -+ ph = ((RR(4)>>2)&7); -+ io = (ph & 1); -+ -+ WR(3,ph); -+ WR(1,1-io); -+ if (io) *val = RR(0); else WR(0,*val); -+ WR(1,0x10+(1-io)); -+} -+ -+static int t358_slow_done (PHA *pha) -+{ -+ return ((RR(4) & 0x20) == 0); -+} -+ -+static void t358_slow_end (PHA *pha) -+{ -+ int io; -+ -+ io = ((RR(4)>>2)&1); -+ -+ WR(1,1-io); -+} -+ -+static void t358_start_block (PHA *pha, int rd) -+{ -+ if (rd) { -+ WR(3,1); WR(1,0); -+ WR(2,2); -+ WR(0x10,0x40); WR(2,0); WR(2,0xa); -+ WR(3,1); WR(1,0); WR(7,3); -+ } else { -+ WR(3,0); WR(1,1); -+ WR(2,2); -+ WR(0x10,0); WR(2,0); WR(2,0xa); -+ WR(3,0); WR(1,1); WR(5,0); -+ } -+ WR(0x11,pha->tlen/128); -+} -+ -+static int t358_transfer_ready (PHA *pha) -+{ -+ int r; -+ -+ r = RR(0x10); -+ -+ if (!(r & 4)) return 128; /* 4 is host buffer not ready */ -+ -+ if (r & 1) return -1; /* last block transferred */ -+ -+ return 0; -+} -+ -+static int t358_transfer_block (PHA *pha, char * buf, int buflen, int rd) -+{ -+ int k, n; -+ -+ k = 0; -+ while (k < buflen) { -+ -+ n = t358_transfer_ready(pha); -+ -+ if (n <= 0) break; -+ -+ if (n > (buflen - k)) n = buflen - k; -+ -+ if (rd) t358_read_block(pha,buf,n); -+ else t358_write_block(pha,buf,n); -+ -+ k += n; buf += n; -+ -+ } -+ -+ return k; -+} -+ -+static int t358_transfer_done (PHA *pha) -+{ -+ if (RR(0x10) & 1) return 1; /* last block transferred */ -+ return 0; -+} -+ -+static void t358_end_block (PHA *pha, int rd) -+{ -+ WR(2,0); -+} -+ -+ -+static void t358_reset_bus (PHA *pha) -+{ -+ WR(1,1); WR(3,0); -+ WR(2,0); -+ WR(1,0x80); udelay(60); -+ WR(1,0); -+ WR(2,0); -+ WR(1,1); WR(3,0); -+ WR(2,0); -+} -+ -+static char *(mode_strings[3]) = {"Nybble","PS/2","EPP"}; -+ -+static struct ppsc_protocol t358_psp = { -+ -+ {&host0,&host1,&host2,&host3}, /* params */ -+ &host_structs, /* hosts */ -+ 3, /* num_modes */ -+ 2, /* epp_first */ -+ 1, /* default_delay */ -+ 1, /* can_message */ -+ 16, /* sg_tablesize */ -+ mode_strings, -+ t358_init, -+ NULL, -+ t358_connect, -+ t358_disconnect, -+ t358_test_proto, -+ t358_select, -+ t358_test_select, -+ t358_select_finish, -+ t358_deselect, -+ t358_get_bus_status, -+ t358_slow_start, -+ t358_slow_done, -+ t358_slow_end, -+ t358_start_block, -+ t358_transfer_block, -+ t358_transfer_ready, -+ t358_transfer_done, -+ t358_end_block, -+ t358_reset_bus -+}; -+ -+int t358_detect (struct scsi_host_template *tpnt ) -+{ -+ return ppsc_detect( &t358_psp, tpnt, verbose); -+} -+ -+#ifdef MODULE -+ -+struct scsi_host_template driver_template = PPSC_TEMPLATE(t358); -+ -+#include "scsi_module.c" -+ -+MODULE_LICENSE("GPL"); -+ -+#else -+ -+void t358_setup (char *str, int *ints) -+{ -+ ppsc_gen_setup(stt,4,str); -+} -+ -+#endif -+ -+/* end of t358.c */ -+ ---- a/drivers/scsi/Makefile -+++ b/drivers/scsi/Makefile -@@ -129,6 +129,16 @@ obj-$(CONFIG_SCSI_CXGB3_ISCSI) += libisc - - obj-$(CONFIG_ARM) += arm/ - -+obj-$(CONFIG_PPSCSI) += ppscsi.o -+obj-$(CONFIG_PPSCSI_T348) += t348.o -+obj-$(CONFIG_PPSCSI_T358) += t358.o -+obj-$(CONFIG_PPSCSI_ONSCSI) += onscsi.o -+obj-$(CONFIG_PPSCSI_EPSA2) += epsa2.o -+obj-$(CONFIG_PPSCSI_EPST) += epst.o -+obj-$(CONFIG_PPSCSI_VPI0) += vpi0.o -+obj-$(CONFIG_PPSCSI_VPI2) += vpi2.o -+obj-$(CONFIG_PPSCSI_SPARCSI) += sparcsi.o -+ - obj-$(CONFIG_CHR_DEV_ST) += st.o - obj-$(CONFIG_CHR_DEV_OSST) += osst.o - obj-$(CONFIG_BLK_DEV_SD) += sd_mod.o ---- /dev/null -+++ b/drivers/scsi/epst.c -@@ -0,0 +1,478 @@ -+/* -+ epst.c (c) 1996-1999 Grant Guenther -+ -+ This is the ppSCSI protocol module for the Shuttle -+ Technologies EPST parallel port SCSI adapter. -+ -+*/ -+ -+#define EPST_VERSION "0.92" -+ -+#define PPSC_BASE -+#define PPSC_HA_MODULE -+ -+#include "ppscsi.h" -+ -+#define EPST_VER_CODE 0xb2 -+ -+#define j44(a,b) (((a>>4)&0x0f)+(b&0xf0)) -+#define j53(a,b) (((a>>3)&0x1f)+((b<<4)&0xe0)) -+ -+static char epst_map[256]; /* status bits permutation */ -+ -+static void epst_init (PHA *pha) -+{ -+ -+/* { REQ, BSY, MSG, CD, IO} */ -+ -+ char key[5] = {0x20,0x40,0x04,0x02,0x01}; -+ -+ ppsc_make_map(epst_map,key,0); -+ sprintf(pha->ident,"epst %s (%s), Shuttle EPST", -+ EPST_VERSION,PPSC_H_VERSION); -+} -+ -+static void epst_write_regr (PHA *pha, int regr, int value) -+{ -+ switch (pha->mode) { -+ -+ case 0: -+ case 1: -+ case 2: w0(0x60+regr); w2(1); w0(value); w2(4); -+ break; -+ -+ case 3: -+ case 4: -+ case 5: w3(0x40+regr); w4(value); -+ break; -+ -+ } -+} -+ -+static int epst_read_regr (PHA *pha, int regr) -+{ -+ int a, b; -+ -+ switch (pha->mode) { -+ -+ case 0: w0(regr); w2(1); w2(3); -+ a = r1(); w2(4); b = r1(); -+ return j44(a,b); -+ -+ case 1: w0(0x40+regr); w2(1); w2(4); -+ a = r1(); b = r2(); w0(0xff); -+ return j53(a,b); -+ -+ case 2: w0(0x20+regr); w2(1); w2(0x25); -+ a = r0(); w2(4); -+ return a; -+ -+ case 3: -+ case 4: -+ case 5: w3(regr); w2(0x24); a = r4(); -+ return a; -+ -+ } -+ -+ return -1; -+} -+ -+/* for performance reasons, these block transfer functions make -+ some assumptions about the behaviour of the SCSI devices. In -+ particular, DMA transfers are assumed not to stall within the -+ last few bytes of a block ... -+*/ -+ -+static int epst_read_block (PHA *pha, char *buf, int len) -+{ -+ int t, k, p, a, b; -+ -+ k = 0; -+ -+ switch (pha->mode) { -+ -+ case 0: w0(7); w2(1); w2(3); w0(0xff); -+ p = 1; -+ while (k < len) { -+ w2(6+p); a = r1(); -+ if (a & 8) b = a; else { w2(4+p); b = r1(); } -+ buf[k++] = j44(a,b); -+ p = 1 - p; -+ if (!(k % 16)) { -+ w0(0xfe); t = r1(); w0(0xff); -+ if (t & 8) break; -+ } -+ } -+ w0(0); w2(4); -+ break; -+ -+ case 1: w0(0x47); w2(1); w2(5); w0(0xff); -+ p = 0; -+ while (k < len) { -+ a = r1(); b = r2(); -+ buf[k++] = j53(a,b); -+ w2(4+p); -+ p = 1 - p; -+ if (!(k % 16)) { -+ w0(0xfe); t = r1(); w0(0xff); -+ if (t & 8) break; -+ } -+ } -+ w0(0); w2(4); -+ break; -+ -+ case 2: w0(0x27); w2(1); -+ p = 1; -+ while (k < len) { -+ w2(0x24+p); -+ buf[k++] = r0(); -+ p = 1 - p; -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(6); w2(4); -+ break; -+ -+ case 3: w3(0x80); w2(0x24); -+ while (k < len) { -+ buf[k++] = r4(); -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(4); -+ break; -+ -+ case 4: w3(0x80); w2(0x24); -+ while (k < len) { -+ if ((len - k) > 1) { -+ *((u16 *)(&buf[k])) = r4w(); -+ k += 2; -+ } else { -+ buf[k++] = r4(); -+ } -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(4); -+ break; -+ -+ case 5: w3(0x80); w2(0x24); -+ while (k < len) { -+ if ((len - k) > 3) { -+ *((u32 *)(&buf[k])) = r4l(); -+ k += 4; -+ } else { -+ buf[k++] = r4(); -+ } -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(4); -+ break; -+ } -+ -+ return k; -+} -+ -+static int epst_write_block (PHA *pha, char *buf, int len) -+{ -+ int p, k; -+ -+ k = 0; -+ -+ switch (pha->mode) { -+ -+ case 0: -+ case 1: -+ case 2: w0(0x67); w2(1); -+ p = 1; -+ while (k < len) { -+ w2(4+p); -+ w0(buf[k++]); -+ p = 1 - p; -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(5); w2(7); w2(4); -+ break; -+ -+ case 3: w3(0xc0); -+ while (k < len) { -+ w4(buf[k++]); -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(4); -+ break; -+ -+ case 4: w3(0xc0); -+ while (k < len) { -+ if ((len - k) > 1) { -+ w4w(*((u16 *)(&buf[k]))); -+ k += 2; -+ } else { -+ w4(buf[k++]); -+ } -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(4); -+ break; -+ -+ case 5: w3(0xc0); -+ while (k < len) { -+ if ((len - k) > 3) { -+ w4l(*((u32 *)(&buf[k]))); -+ k += 4; -+ } else { -+ w4(buf[k++]); -+ } -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(4); -+ break; -+ } -+ -+ return k; -+} -+ -+#define WR(r,v) epst_write_regr(pha,r,v) -+#define RR(r) (epst_read_regr(pha,r)) -+ -+#define CPP(x) w2(4);w0(0x22);w0(0xaa);w0(0x55);w0(0);w0(0xff);\ -+ w0(0x87);w0(0x78);w0(x);w2(5);w2(4);w0(0xff); -+ -+static void epst_connect (PHA *pha) -+{ -+ w2(4); -+ CPP(0x40); CPP(0xe0); -+ w0(0); w2(1); w2(3); w2(4); -+ -+ if (pha->mode >= 3) { -+ w0(0); w2(1); w2(3); w2(4); w2(0xc); -+ w0(0x40); w2(6); w2(7); w2(4); -+ } -+ -+ WR(0x1d,0x20); WR(0x1d,0); /* clear the ring buffer */ -+ WR(0xa,0x1e); /* set up PDMA */ -+ WR(0xc,4); /* enable status bits */ -+ WR(8,2); /* deglitch timing */ -+} -+ -+static void epst_disconnect (PHA *pha) -+{ -+ CPP(0x30); w2(4); -+ CPP(0x40); w2(4); -+} -+ -+#define Wsr(r,v) WR(0x18+r,v) -+#define Rsr(r) (RR(0x18+r)) -+ -+static int epst_test_proto (PHA *pha) -+{ -+ int i, j, e; -+ char wb[16], rb[16]; -+ -+ e = 0; -+ -+ epst_connect(pha); -+ i = RR(0xb); -+ if (V_PROBE) printk("%s: version code reads: 0x%x\n",pha->device,i); -+ epst_disconnect(pha); -+ -+ if (i != EPST_VER_CODE) return 1; -+ -+ epst_connect(pha); -+ -+ for (j=0;j<200;j++) { -+ for (i=0;i<16;i++) { wb[i] = i+j; rb[i] = i+j+6; } -+ Wsr(5,1); -+ epst_write_block(pha,wb,16); -+ Wsr(5,0x11); -+ epst_read_block(pha,rb,16); -+ for (i=0;i<16;i++) if (wb[i] != rb[i]) e++; -+ } -+ -+ epst_disconnect(pha); -+ -+ if (V_FULL) -+ printk("%s: test port 0x%x mode %d errors %d\n", -+ pha->device,pha->port,pha->mode,e); -+ -+ return e; -+} -+ -+/* The EPST contains a core SCSI controller that is very -+ similar to the NCR 5380. Some bits have been shuffled -+ around, but the basic structure is the same. -+*/ -+ -+static int epst_select (PHA *pha, int initiator, int target) -+{ -+ Wsr(4,(1< -+ -+ This is the low-level protocol module for the WBS-11A parallel -+ port SCSI adapter. This adapter has been marketed by LinkSys -+ as the "ParaSCSI+" and by Shining Technologies as the "SparCSI". -+ The device is constructed from the KBIC-951A ISA replicator -+ chip from KingByte and the NCR 5380. -+ -+*/ -+ -+#define SPARCSI_VERSION "0.91" -+ -+#define PPSC_BASE -+#define PPSC_HA_MODULE -+ -+#include "ppscsi.h" -+ -+#define r12w() (delay_p,inw(pha->port+1)&0xffff) -+ -+#define j44(a,b) ((((a>>4)&0x0f)|(b&0xf0))^0x88) -+#define j53(w) (((w>>3)&0x1f)|((w>>4)&0xe0)) -+ -+static char sparcsi_map[256]; /* status bits permutation */ -+ -+static void sparcsi_init (PHA *pha) -+{ -+ -+/* { REQ, BSY, MSG, CD, IO} */ -+ -+ char key[5] = {0x20,0x40,0x10,0x08,0x04}; -+ -+ ppsc_make_map(sparcsi_map,key,0); -+ sprintf(pha->ident,"sparcsi %s (%s), WBS-11A", -+ SPARCSI_VERSION,PPSC_H_VERSION); -+} -+ -+static void sparcsi_write_regr (PHA *pha, int regr, int value) -+{ -+ switch (pha->mode) { -+ -+ case 0: -+ case 1: -+ case 2: w0(regr|0x10); w2(4); w2(6); w2(4); -+ w0(value); w2(5); w2(4); -+ break; -+ -+ case 3: w0(0x20); w2(4); w2(6); w2(4); w3(regr); -+ w4(value); w2(4); w2(0); w2(4); -+ break; -+ -+ } -+} -+ -+static int sparcsi_read_regr (PHA *pha, int regr) -+{ -+ int a, b; -+ -+ switch (pha->mode) { -+ -+ case 0: w0(regr|0x18); w2(4); w2(6); w2(4); w2(5); -+ a = r1(); w0(0x58); b = r1(); w2(4); -+ return j44(a,b); -+ -+ case 1: w0(regr|0x58); w2(4); w2(6); w2(4); w2(5); -+ a = r12w(); w2(4); -+ return j53(a); -+ -+ case 2: w0(regr|0x98); w2(4); w2(6); w2(4); w2(0xa5); -+ a = r0(); w2(4); -+ return a; -+ -+ case 3: w0(0x20); w2(4); w2(6); w2(4); w3(regr); -+ w2(0xe4); a = r4(); w2(4); w2(0); w2(4); -+ return a; -+ -+ } -+ return -1; -+} -+ -+static void sparcsi_read_block (PHA *pha, char *buf, int len) -+{ -+ int k, a, b; -+ -+ switch (pha->mode) { -+ -+ case 0: w0(8); w2(4); w2(6); w2(4); -+ for (k=0;kmode) { -+ -+ case 0: -+ case 1: -+ case 2: w0(0); w2(4); w2(6); w2(4); -+ for(k=0;ksaved_r0 = r0(); -+ pha->saved_r2 = r2(); -+ w2(4); -+} -+ -+static void sparcsi_disconnect (PHA *pha) -+{ -+ w0(pha->saved_r0); -+ w2(pha->saved_r2); -+} -+ -+#define WR(r,v) sparcsi_write_regr(pha,r,v) -+#define RR(r) (sparcsi_read_regr(pha,r)) -+ -+static int sparcsi_test_proto (PHA *pha) -+{ -+ int k, e; -+ -+ e = 0; -+ -+ sparcsi_connect(pha); -+ -+ if (!pha->private[0]) { /* reset the SCSI bus on first sight */ -+ -+ if (V_FULL) printk("%s: SCSI reset ...\n",pha->device); -+ -+ WR(1,0x80); udelay(60); -+ WR(1,0); -+ scsi_sleep(5*HZ); -+ pha->private[0] = 1; -+ } -+ -+ WR(1,0); -+ WR(1,1); -+ -+ if (V_PROBE) -+ printk("%s: 5380 regrs [4]=%x [5]=%x\n",pha->device,RR(4),RR(5)); -+ -+ for (k=0;k<256;k++) { -+ WR(0,k); -+ if (RR(0) != k) e++; -+ WR(0,255-k); -+ if (RR(0) != (255-k)) e++; -+ } -+ -+ WR(1,0); -+ -+ sparcsi_disconnect(pha); -+ -+ return e; -+} -+ -+static int sparcsi_select (PHA *pha, int initiator, int target) -+{ -+ WR(3,0); WR(1,1); -+ WR(0,(1 << initiator)); WR(2,1); udelay(100); -+ if (RR(1) != 0x41) { -+ WR(1,0); -+ return -1; -+ } -+ -+ WR(1,5); WR(0,(1 << initiator)|(1 << target)); -+ WR(2,0); WR(2,0); WR(2,0); -+ return 0; -+} -+ -+static int sparcsi_test_select (PHA *pha) -+{ -+ return ((RR(4) & 0x42) == 0x42); -+} -+ -+static void sparcsi_select_finish (PHA *pha) -+{ -+ WR(3,2); WR(1,5); WR(1,1); -+} -+ -+static void sparcsi_deselect (PHA *pha) -+{ -+ WR(1,0); -+} -+ -+static int sparcsi_get_bus_status (PHA *pha) -+{ -+ int s; -+ -+ s = RR(4); -+ return sparcsi_map[s]; -+} -+ -+static void sparcsi_slow_start (PHA *pha, char *val) -+{ -+ int ph, io; -+ -+ ph = ((RR(4)>>2)&7); -+ io = (ph & 1); -+ -+ WR(3,ph); -+ WR(1,1-io); -+ if (io) *val = RR(0); else WR(0,*val); -+ WR(1,0x10+(1-io)); -+} -+ -+static int sparcsi_slow_done (PHA *pha) -+{ -+ return ((RR(4) & 0x20) == 0); -+} -+ -+static void sparcsi_slow_end (PHA *pha) -+{ -+ int io; -+ -+ io = ((RR(4)>>2)&1); -+ -+ WR(1,1-io); -+} -+ -+static void sparcsi_start_block (PHA *pha, int rd) -+{ -+ if (rd) { -+ -+ WR(3,1); WR(1,0); -+ WR(2,2); WR(7,3); -+ WR(3,1); WR(1,0); -+ -+ } else { -+ -+ WR(3,0); WR(1,1); -+ WR(2,2); WR(5,0); -+ WR(3,0); WR(1,1); -+ -+ } -+ pha->priv_flag = rd; -+} -+ -+static int sparcsi_transfer_ready (PHA *pha) -+{ -+ int chunk; -+ -+ chunk = 512; -+ if ((pha->data_count == 0) && (!pha->priv_flag)) chunk++; -+ -+ if (r1() & 0x40) return chunk; -+ if (!(RR(5) & 8)) return -1; -+ return 0; -+} -+ -+static int sparcsi_transfer_block (PHA *pha, char * buf, int buflen, int rd) -+{ -+ int k, n; -+ -+ k = 0; -+ while (k < buflen) { -+ -+ n = sparcsi_transfer_ready(pha); -+ -+ if (n <= 0) break; -+ -+ if (n > (buflen - k)) n = buflen - k; -+ -+ if (rd) sparcsi_read_block(pha,buf,n); -+ else sparcsi_write_block(pha,buf,n); -+ -+ k += n; buf += n; -+ } -+ -+ return k; -+} -+ -+static int sparcsi_transfer_done (PHA *pha) -+{ -+ return 1; -+} -+ -+static void sparcsi_end_block (PHA *pha, int rd) -+{ -+ char buf[2] = {0,0}; -+ -+ if (!rd) sparcsi_write_block(pha,buf,1); -+ -+ WR(2,0); -+} -+ -+static void sparcsi_reset_bus (PHA *pha) -+{ -+ WR(1,1); WR(3,0); -+ WR(2,0); -+ WR(1,0x80); udelay(60); -+ WR(1,0); -+ WR(2,0); -+ WR(1,1); WR(3,0); -+ WR(2,0); -+} -+ -+static char *(mode_strings[4]) = {"Nybble","KBIC 5/3","PS/2","EPP"}; -+ -+static struct ppsc_protocol sparcsi_psp = { -+ -+ {&host0,&host1,&host2,&host3}, /* params */ -+ &host_structs, /* hosts */ -+ 4, /* num_modes */ -+ 3, /* epp_first */ -+ 1, /* default_delay */ -+ 1, /* can_message */ -+ 16, /* sg_tablesize */ -+ mode_strings, -+ sparcsi_init, -+ NULL, -+ sparcsi_connect, -+ sparcsi_disconnect, -+ sparcsi_test_proto, -+ sparcsi_select, -+ sparcsi_test_select, -+ sparcsi_select_finish, -+ sparcsi_deselect, -+ sparcsi_get_bus_status, -+ sparcsi_slow_start, -+ sparcsi_slow_done, -+ sparcsi_slow_end, -+ sparcsi_start_block, -+ sparcsi_transfer_block, -+ sparcsi_transfer_ready, -+ sparcsi_transfer_done, -+ sparcsi_end_block, -+ sparcsi_reset_bus -+}; -+ -+int sparcsi_detect (Scsi_Host_Template *tpnt) -+{ -+ return ppsc_detect( &sparcsi_psp, tpnt, verbose); -+} -+ -+#ifdef MODULE -+ -+Scsi_Host_Template driver_template = PPSC_TEMPLATE(sparcsi); -+ -+#include "scsi_module.c" -+ -+MODULE_LICENSE("GPL"); -+ -+#else -+ -+void sparcsi_setup (char *str, int *ints) -+{ -+ ppsc_gen_setup(stt,4,str); -+} -+ -+#endif -+ -+/* end of sparcsi.c */ -+ ---- /dev/null -+++ b/drivers/scsi/epsa2.c -@@ -0,0 +1,507 @@ -+/* -+ epsa2.c (c) 1996-1999 Grant Guenther -+ -+ This is the ppSCSI protocol module for the Shuttle -+ Technologies EPSA2 parallel port SCSI adapter. EPSA2 is -+ a predecessor to the EPST. It uses slightly different -+ command encoding and has a less elaborate internal register -+ model. -+ -+*/ -+ -+#define EPSA2_VERSION "0.91" -+ -+#define PPSC_BASE -+#define PPSC_HA_MODULE -+ -+#include "ppscsi.h" -+ -+#define EPSA2_VER_CODE 0xb1 -+ -+#define j44(a,b) (((a>>4)&0x0f)+(b&0xf0)) -+#define j53(a,b) (((a>>3)&0x1f)+((b<<4)&0xe0)) -+ -+static char epsa2_map[256]; /* status bits permutation */ -+ -+static void epsa2_init( PHA *pha) -+{ -+ -+/* { REQ, BSY, MSG, CD, IO} */ -+ -+ char key[5] = {0x20,0x40,0x04,0x02,0x01}; -+ -+ ppsc_make_map(epsa2_map,key,0); -+ sprintf(pha->ident,"epsa2 %s (%s), Shuttle EPSA2", -+ EPSA2_VERSION,PPSC_H_VERSION); -+} -+ -+static void epsa2_write_regr (PHA *pha, int regr, int value) -+{ -+ switch (pha->mode) { -+ -+ case 0: -+ case 1: -+ case 2: w0(0x70+regr); w2(1); w0(value); w2(4); -+ break; -+ -+ case 3: -+ case 4: -+ case 5: w3(0x40+regr); w4(value); w2(4); -+ break; -+ -+ } -+} -+ -+static int epsa2_read_regr (PHA *pha, int regr) -+{ -+ int a, b; -+ -+ switch (pha->mode) { -+ -+ case 0: w0(0x40+regr); w2(1); w2(3); -+ a = r1(); w2(4); b = r1(); -+ return j44(a,b); -+ -+ case 1: w0(0x60+regr); w2(1); w2(4); -+ a = r1(); b = r2(); w0(0xff); -+ return j53(a,b); -+ -+ case 2: w0(0x50+regr); w2(1); w2(0x25); -+ a = r0(); w2(4); -+ return a; -+ -+ case 3: -+ case 4: -+ case 5: w3(regr); w2(0x24); a = r4(); w2(4); -+ return a; -+ -+ } -+ -+ return -1; -+} -+ -+/* for performance reasons, these block transfer functions make -+ some assumptions about the behaviour of the SCSI devices. In -+ particular, DMA transfers are assumed not to stall within the -+ last few bytes of a block ... -+*/ -+ -+static int epsa2_read_block (PHA *pha, char *buf, int len) -+{ -+ int t, k, p, a, b; -+ -+ k = 0; -+ -+ switch (pha->mode) { -+ -+ case 0: w0(7); w2(1); w2(3); w0(0xff); -+ p = 1; -+ while (k < len) { -+ w2(6+p); a = r1(); -+ if (a & 8) b = a; else { w2(4+p); b = r1(); } -+ buf[k++] = j44(a,b); -+ p = 1 - p; -+ if (!(k % 16)) { -+ w0(0xfe); t = r1(); w0(0xff); -+ if (t & 8) break; -+ } -+ } -+ w0(0); w2(4); -+ break; -+ -+ case 1: w0(0x27); w2(1); w2(5); w0(0xff); -+ p = 0; -+ while (k < len) { -+ a = r1(); b = r2(); -+ buf[k++] = j53(a,b); -+ w2(4+p); -+ p = 1 - p; -+ if (!(k % 16)) { -+ w0(0xfe); t = r1(); w0(0xff); -+ if (t & 8) break; -+ } -+ } -+ w0(0); w2(4); -+ break; -+ -+ case 2: w0(0x17); w2(1); -+ p = 1; -+ while (k < len) { -+ w2(0x24+p); -+ buf[k++] = r0(); -+ p = 1 - p; -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(6); w2(4); -+ break; -+ -+ case 3: w3(6); w2(0x24); -+ while (k < len) { -+ buf[k++] = r4(); -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(4); -+ break; -+ -+ case 4: w3(6); w2(0x24); -+ while (k < len) { -+ if ((len - k) > 1) { -+ *((u16 *)(&buf[k])) = r4w(); -+ k += 2; -+ } else { -+ buf[k++] = r4(); -+ } -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(4); -+ break; -+ -+ case 5: w3(6); w2(0x24); -+ while (k < len) { -+ if ((len - k) > 3) { -+ *((u32 *)(&buf[k])) = r4l(); -+ k += 4; -+ } else { -+ buf[k++] = r4(); -+ } -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(4); -+ break; -+ } -+ -+ return k; -+} -+ -+static int epsa2_write_block (PHA *pha, char *buf, int len) -+{ -+ int p, k; -+ -+ k = 0; -+ -+ switch (pha->mode) { -+ -+ case 0: -+ case 1: -+ case 2: w0(0x37); w2(1); -+ p = 1; -+ while (k < len) { -+ w2(4+p); -+ w0(buf[k++]); -+ p = 1 - p; -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(5); w2(7); w2(4); -+ break; -+ -+ case 3: w3(0x46); -+ while (k < len) { -+ w4(buf[k++]); -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(4); -+ break; -+ -+ case 4: w3(0x46); -+ while (k < len) { -+ if ((len - k) > 1) { -+ w4w(*((u16 *)(&buf[k]))); -+ k += 2; -+ } else { -+ w4(buf[k++]); -+ } -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(4); -+ break; -+ -+ case 5: w3(0x46); -+ while (k < len) { -+ if ((len - k) > 3) { -+ w4l(*((u32 *)(&buf[k]))); -+ k += 4; -+ } else { -+ w4(buf[k++]); -+ } -+ if ((!(k % 16)) && (r1() & 8)) break; -+ } -+ w2(4); -+ break; -+ } -+ -+ return k; -+} -+ -+#define WR(r,v) epsa2_write_regr(pha,r,v) -+#define RR(r) (epsa2_read_regr(pha,r)) -+ -+#define CPP(x) w2(4);w0(0x22);w0(0xaa);w0(0x55);w0(0);w0(0xff);\ -+ w0(0x87);w0(0x78);w0(x);w2(5);w2(4);w0(0xff); -+ -+static void epsa2_connect (PHA *pha) -+{ -+ CPP(0x40); CPP(0xe0); -+ -+ w0(0x73); w2(1); w0(0); w2(4); -+ w0(0x72); w2(1); w0(0x40); w2(4); -+ -+ w0(0); w2(1); w2(4); -+ -+ CPP(0x50); CPP(0x48); -+ -+ switch (pha->mode) { -+ -+ case 0: WR(7,0x82); -+ break; -+ -+ case 1: -+ case 2: WR(7,0xa2); -+ break; -+ -+ case 3: -+ case 4: -+ case 5: CPP(0x30); CPP(0x20); -+ WR(7,0xa3); -+ break; -+ } -+ -+ w2(4); -+} -+ -+static void epsa2_disconnect (PHA *pha) -+{ -+ switch (pha->mode) { -+ -+ case 0: WR(7,2); WR(2,0); -+ break; -+ -+ case 1: -+ case 2: WR(7,0x22); WR(2,0); -+ break; -+ -+ case 3: -+ case 4: -+ case 5: WR(7,0x23); w2(4); -+ w0(0x72); w2(1); w0(0); w2(4); -+ break; -+ } -+ -+ CPP(0x30); CPP(0x40); -+} -+ -+static int epsa2_test_proto (PHA *pha) -+{ -+ int i, j, e; -+ char wb[16], rb[16]; -+ -+ e = 0; -+ -+ epsa2_connect(pha); -+ i = RR(7); -+ if (V_PROBE) printk("%s: version code reads: 0x%x\n",pha->device,i); -+ epsa2_disconnect(pha); -+ -+ if (i != EPSA2_VER_CODE) return 1; -+ -+ epsa2_connect(pha); -+ -+ for (j=0;j<200;j++) { -+ for (i=0;i<16;i++) { wb[i] = i+j; rb[i] = i+j+6; } -+ WR(5,1); -+ epsa2_write_block(pha,wb,16); -+ udelay(100); -+ WR(5,0x11); -+ epsa2_read_block(pha,rb,16); -+ for (i=0;i<16;i++) if (wb[i] != rb[i]) e++; -+ } -+ -+ epsa2_disconnect(pha); -+ -+ if (V_FULL) -+ printk("%s: test port 0x%x mode %d errors %d\n", -+ pha->device,pha->port,pha->mode,e); -+ -+ return e; -+} -+ -+/* The EPSA2 contains a core SCSI controller that is very -+ similar to the NCR 5380. Some bits have been shuffled -+ around, but the basic structure is the same. -+*/ -+ -+static int epsa2_select (PHA *pha, int initiator, int target) -+{ -+ WR(4,(1< -+ (C) 2000 Tim Waugh -+ Under the terms of the GNU general public license. -+ -+ This is the common code shared by the PPSCSI family of -+ low-level drivers for parallel port SCSI host adapters. -+ -+ -+ To use one of the ppSCSI drivers, you must first have this module -+ built-in to your kernel, or loaded. Then, you can load the -+ appropriate protocol module. All protocol modules accept the -+ same parameters: -+ -+ verbose=N determines the logging level where N= -+ 0 only serious errors are logged -+ 1 report progress messages while probing adapters -+ 2 log the scsi commands sent to adapters -+ 3 basic debugging information -+ 4 full debugging (generates lots of output) -+ -+ hostN=,,,,, -+ -+ sets per-host-adapter parameters where -+ -+ N is between 0 and 3, each protocol can -+ support up to four separate adapters. -+ -+ The parport for this adapter, eg: -+ 0 for parport0. -+ -+ Protocol dependent mode number. Usually -+ probed to determine the fastest available -+ mode. -+ -+ microseconds of delay per port access. -+ Default is protocol dependent. -+ -+ Determines this host's ability to load -+ the system. Default 0. Set to 1 or 2 -+ to reduce load at the expense of device -+ performance. -+ -+ scatter-gather table size. -+ -+ bit mask of targets on which to force -+ all commands to use explicit REQ/ACK -+ handshaking, rather than adapter buffers. -+ -+*/ -+ -+#define PPSC_VERSION "0.92" -+ -+#define PPSC_BASE -+#include "ppscsi.h" -+#include -+#include -+#include -+#include -+ -+#include -+ -+#define PPSC_GEN_TMO 40*HZ -+#define PPSC_SELECT_TMO HZ/10 -+#define PPSC_PROBE_TMO HZ/2 -+#define PPSC_RESET_TMO 4*HZ -+#define PPSC_SLOW_LOOPS 30 -+#define PPSC_BUSY_SNOOZE HZ; -+ -+#define PPSC_DEF_NICE 0 -+#define PPSC_INITIATOR 7 -+ -+spinlock_t ppsc_spinlock = SPIN_LOCK_UNLOCKED; -+ -+static char ppsc_bulk_map[256]; -+ -+struct ppsc_port_list_struct { -+ struct parport *port; -+ struct ppsc_port_list_struct *next; -+}; -+static struct ppsc_port_list_struct *ppsc_port_list; -+ -+/* ppsc_attach and ppsc_detach are for keeping a list of currently -+ * available ports, held under a mutex. We do this rather than -+ * using parport_enumerate because it stops a load of races. -+ */ -+ -+static void ppsc_attach (struct parport *port) -+{ -+ struct ppsc_port_list_struct *add; -+ -+ add = kmalloc (sizeof (struct ppsc_port_list_struct), GFP_KERNEL); -+ if (!add) { -+ printk (KERN_WARNING "ppscsi: memory squeeze\n"); -+ return; -+ } -+ -+ add->port = parport_get_port (port); -+ add->next = ppsc_port_list; -+ wmb (); -+ ppsc_port_list = add; -+} -+ -+static void ppsc_detach (struct parport *port) -+{ -+ /* Do nothing. We have a reference to the port already, so -+ * it won't go away. We'll clean up the port list when we -+ * unload. */ -+} -+ -+static struct parport_driver ppsc_driver = { -+ name: "ppscsi", -+ attach: ppsc_attach, -+ detach: ppsc_detach -+}; -+ -+void ppsc_make_map (char map[256], char key[5], int inv) -+{ -+ int i, j; -+ -+ for (i=0;i<256;i++) { -+ map[i] = 0; -+ for (j=0;j<5;j++) -+ map[i] = (map[i] << 1) | ((i & key[j]) != inv*key[j]); -+ } -+} -+ -+void ppsc_gen_setup (STT t[], int n, char *ss) -+{ -+ int j, k, sgn; -+ -+ k = 0; -+ for (j=0;jcontinuation = continuation; -+ pha->ready = ready; -+ if (timeout) -+ pha->timeout = jiffies + timeout; -+ else pha->timeout = pha->then + pha->tmo; -+ -+ if (!pha->nice && !pha->wq_active) { -+#ifdef HAVE_DISABLE_HLT -+ disable_hlt(); -+#endif -+ pha->wq_active = 1; -+ schedule_work (&pha->wq); -+ } -+ -+ if (!pha->timer_active) { -+ pha->timer_active = 1; -+ pha->timer.expires = jiffies + ((pha->nice>0)?(pha->nice-1):0); -+ add_timer(&pha->timer); -+ } -+ -+ spin_unlock_irqrestore(&ppsc_spinlock,flags); -+} -+ -+static void ppsc_tq_int (void *data) -+{ -+ void (*con)(PHA *); -+ unsigned long flags; -+ PHA *pha = (PHA *)data; -+ -+ spin_lock_irqsave(&ppsc_spinlock,flags); -+ -+ con = pha->continuation; -+ -+#ifdef HAVE_DISABLE_HLT -+ enable_hlt(); -+#endif -+ -+ pha->wq_active = 0; -+ -+ if (!con) { -+ spin_unlock_irqrestore(&ppsc_spinlock,flags); -+ return; -+ } -+ pha->timedout = time_after_eq (jiffies, pha->timeout); -+ if (!pha->ready || pha->ready(pha) || pha->timedout) { -+ pha->continuation = NULL; -+ spin_unlock_irqrestore(&ppsc_spinlock,flags); -+ con(pha); -+ return; -+ } -+ -+#ifdef HAVE_DISABLE_HLT -+ disable_hlt(); -+#endif -+ -+ pha->wq_active = 1; -+ schedule_work (&pha->wq); -+ spin_unlock_irqrestore(&ppsc_spinlock,flags); -+} -+ -+static void ppsc_timer_int (unsigned long data) -+{ -+ void (*con)(PHA *); -+ unsigned long flags; -+ PHA *pha = (PHA *)data; -+ -+ spin_lock_irqsave(&ppsc_spinlock,flags); -+ -+ con = pha->continuation; -+ pha->timer_active = 0; -+ if (!con) { -+ spin_unlock_irqrestore(&ppsc_spinlock,flags); -+ return; -+ } -+ pha->timedout = time_after_eq (jiffies, pha->timeout); -+ if (!pha->ready || pha->ready(pha) || pha->timedout) { -+ pha->continuation = NULL; -+ spin_unlock_irqrestore(&ppsc_spinlock,flags); -+ con(pha); -+ return; -+ } -+ pha->timer_active = 1; -+ pha->timer.expires = jiffies + ((pha->nice>0)?(pha->nice-1):0); -+ add_timer(&pha->timer); -+ spin_unlock_irqrestore(&ppsc_spinlock,flags); -+} -+ -+static void ppsc_wake_up( void *p) -+{ -+ PHA *pha = (PHA *) p; -+ unsigned long flags; -+ void (*cont)(PHA *) = NULL; -+ -+ spin_lock_irqsave(&ppsc_spinlock,flags); -+ -+ if (pha->claim_cont && -+ !parport_claim(pha->pardev)) { -+ cont = pha->claim_cont; -+ pha->claim_cont = NULL; -+ pha->claimed = 1; -+ } -+ -+ spin_unlock_irqrestore(&ppsc_spinlock,flags); -+ -+ wake_up(&(pha->parq)); -+ -+ if (cont) cont(pha); -+} -+ -+void ppsc_do_claimed (PHA *pha, void(*cont)(PHA *)) -+{ -+ unsigned long flags; -+ -+ spin_lock_irqsave(&ppsc_spinlock,flags); -+ -+ if (!parport_claim(pha->pardev)) { -+ pha->claimed = 1; -+ spin_unlock_irqrestore(&ppsc_spinlock,flags); -+ cont(pha); -+ } else { -+ pha->claim_cont = cont; -+ spin_unlock_irqrestore(&ppsc_spinlock,flags); -+ } -+} -+ -+static void ppsc_claim (PHA *pha) -+{ -+ if (pha->claimed) return; -+ pha->claimed = 1; -+ -+ wait_event (pha->parq, !parport_claim (pha->pardev)); -+} -+ -+static void ppsc_unclaim (PHA *pha) -+{ -+ pha->claimed = 0; -+ parport_release(pha->pardev); -+} -+ -+static void ppsc_unregister_parport (PHA *pha) -+{ -+ parport_unregister_device(pha->pardev); -+ pha->pardev = NULL; -+} -+ -+static int ppsc_register_parport (PHA *pha, int verbose) -+{ -+ struct ppsc_port_list_struct *ports; -+ struct parport *port = NULL; -+ -+ ports = ppsc_port_list; -+ while((ports)&&(ports->port->number != pha->port)) -+ ports = ports->next; -+ if (ports) { -+ port = ports->port; -+ pha->pardev = parport_register_device(port, pha->device, -+ NULL, ppsc_wake_up, NULL, -+ 0, (void *)pha); -+ } else { -+ printk (KERN_DEBUG "%s: no such device: parport%d\n", -+ pha->device, pha->port); -+ return 1; -+ } -+ -+ if (!pha->pardev) { -+ printk (KERN_DEBUG "%s: couldn't register device\n", -+ pha->device); -+ return 1; -+ } -+ -+ init_waitqueue_head (&pha->parq); -+ -+ /* For now, cache the port base address. Won't need this -+ after transition to parport_xxx_yyy. */ -+ pha->port = port->base; -+ -+ if (verbose) -+ printk("%s: 0x%x is %s\n",pha->device,pha->port, -+ port->name); -+ pha->parname = port->name; -+ return 0; -+} -+ -+/* Here's the actual core SCSI stuff ... */ -+ -+#define PPSC_FAIL(err,msg) { ppsc_fail_command(pha,err,msg); return; } -+ -+static void ppsc_start (PHA *pha); -+static void ppsc_select_intr (PHA *pha); -+static void ppsc_engine (PHA *pha); -+static void ppsc_transfer (PHA *pha); -+static void ppsc_transfer_done (PHA *pha); -+static int ppsc_slow (PHA *pha, char *val); -+static void ppsc_slow_done (PHA *pha); -+static void ppsc_cleanup (PHA *pha); -+static void ppsc_fail_command (PHA *pha, int err_code, char *msg); -+static int ppsc_ready (PHA *pha); -+ -+/* synchronous interface is deprecated, but we maintain it for -+ internal use. It just starts an asynchronous command and waits -+ for it to complete. -+*/ -+ -+int ppsc_command (struct scsi_cmnd *cmd) -+{ -+ PHA *pha = (PHA *) cmd->device->host->hostdata[0]; -+ -+ pha->cur_cmd = cmd; -+ pha->done = NULL; -+ pha->then = jiffies; -+ -+ ppsc_do_claimed(pha,ppsc_start); -+ -+ while (pha->cur_cmd) scsi_sleep(1); -+ -+ return cmd->result; -+} -+ -+int ppsc_queuecommand (struct scsi_cmnd *cmd, void (*done)(struct scsi_cmnd *)) -+{ -+ PHA *pha = (PHA *) cmd->device->host->hostdata[0]; -+ -+ if (pha->cur_cmd) { -+ printk("%s: Driver is busy\n",pha->device); -+ return 0; -+ } -+ -+ pha->cur_cmd = cmd; -+ pha->done = done; -+ pha->then = jiffies; -+ -+ ppsc_do_claimed(pha,ppsc_start); -+ -+ return 0; -+} -+ -+static void ppsc_arb_fail (PHA *pha) -+{ -+ PPSC_FAIL(DID_BUS_BUSY,"Arbitration failure"); -+} -+ -+static void ppsc_start (PHA *pha) -+{ -+ int k, r, b, bf; -+ struct scatterlist *p; -+ -+ pha->last_phase = PPSC_PH_NONE; -+ pha->return_code = (DID_OK << 16); -+ pha->overflow = 0; -+ pha->protocol_error = 0; -+ pha->cmd_count = 0; -+ -+ k = pha->cur_cmd->cmnd[0]; -+ bf = ppsc_bulk_map[k]; -+ -+ bf &= (!((1<cur_cmd->device->id) & pha->slow_targets)); -+ -+ r = pha->cur_cmd->use_sg; -+ if (r) { -+ b = 0; -+ p = (struct scatterlist *)pha->cur_cmd->request_buffer; -+ for (k=0;klength; -+ p++; -+ } -+ } else { -+ b = pha->cur_cmd->request_bufflen; -+ } -+ -+ bf &= (b > 127); -+ -+ if (V_DEBUG) -+ printk("%s: Target %d, bl=%d us=%d bf=%d cm=%x\n", -+ pha->device,pha->cur_cmd->device->id,b,r,bf,k); -+ -+ pha->bulk = bf; -+ pha->tlen = b; -+ -+ pha->proto->connect(pha); -+ -+ r = 0; -+ while (r++ < 5) { -+ k = pha->proto->select(pha,PPSC_INITIATOR,pha->cur_cmd->device->id); -+ if (k != -1) break; -+ udelay(200); -+ } -+ -+ if (k == -1) { -+ ppsc_set_intr(pha,ppsc_arb_fail,NULL,1); -+ return; -+ } -+ -+ ppsc_set_intr(pha,ppsc_select_intr,pha->proto->test_select, -+ PPSC_SELECT_TMO); -+} -+ -+static void ppsc_select_intr (PHA *pha) -+{ -+ if (!pha->proto->test_select(pha)) { -+ pha->return_code = DID_NO_CONNECT << 16; -+ ppsc_cleanup(pha); -+ return; -+ } -+ if (pha->proto->select_finish) -+ pha->proto->select_finish(pha); -+ -+ if (V_FULL) -+ printk("%s: selected target\n",pha->device); -+ -+ pha->timedout = 0; -+ ppsc_engine(pha); -+} -+ -+static void ppsc_update_sg (PHA *pha) -+{ -+ if ((!pha->cur_len) && pha->sg_count) { -+ pha->sg_count--; -+ pha->sg_list++; -+ pha->cur_buf = page_address(pha->sg_list->page) + pha->sg_list->offset; -+ pha->cur_len = pha->sg_list->length; -+ } -+} -+ -+static void ppsc_engine (PHA *pha) -+{ -+ int phase, i; -+ char *sb; -+ -+ while (1) { -+ if ((pha->last_phase == PPSC_PH_MSGIN) || -+ ((pha->last_phase == PPSC_PH_STAT) -+ && (!pha->proto->can_message))) { -+ pha->return_code |= (pha->status_byte & STATUS_MASK) -+ | (pha->message_byte << 8); -+ ppsc_cleanup(pha); -+ return; -+ } -+ -+ phase = pha->proto->get_bus_status(pha); -+ -+ if (pha->abort_flag) -+ PPSC_FAIL(DID_ABORT,"Command aborted"); -+ -+ if (pha->protocol_error) -+ PPSC_FAIL(DID_ERROR,"Adapter protocol failure"); -+ -+ if (!(phase & PPSC_BSY)) { -+ if (pha->last_phase == PPSC_PH_STAT) { -+ if (V_DEBUG) printk("%s: No msg phase ?\n", pha->device); -+ pha->return_code |= (pha->status_byte & STATUS_MASK); -+ ppsc_cleanup(pha); -+ return; -+ } -+ PPSC_FAIL(DID_ERROR,"Unexpected bus free"); -+ } -+ -+ if (!(phase & PPSC_REQ)) { -+ if (pha->timedout) -+ PPSC_FAIL(DID_TIME_OUT,"Pseudo-interrupt timeout"); -+ ppsc_set_intr(pha,ppsc_engine,ppsc_ready,0); -+ return; -+ } -+ -+ switch (phase) { -+ -+ case PPSC_PH_CMD: -+ -+ if (phase != pha->last_phase) { -+ if (pha->last_phase != PPSC_PH_NONE) -+ PPSC_FAIL(DID_ERROR,"Phase sequence error 1"); -+ pha->cmd_count = 0; -+ if (V_TRACE) { -+ printk("%s: Command to %d (%d): ", -+ pha->device, pha->cur_cmd->device->id, -+ pha->cur_cmd->cmd_len); -+ for (i=0;icur_cmd->cmd_len;i++) -+ printk("%2x ",pha->cur_cmd->cmnd[i]); -+ printk("\n"); -+ } -+ } -+ -+ pha->last_phase = phase; -+ -+ if (pha->cmd_count >= pha->cur_cmd->cmd_len) -+ PPSC_FAIL(DID_ERROR,"Command buffer overrun"); -+ -+ if (!ppsc_slow(pha,&(pha->cur_cmd->cmnd[pha->cmd_count++]))) -+ return; -+ -+ break; -+ -+ case PPSC_PH_READ: -+ case PPSC_PH_WRITE: -+ -+ if (phase != pha->last_phase) { -+ if (pha->last_phase != PPSC_PH_CMD) -+ PPSC_FAIL(DID_ERROR,"Phase sequence error 2"); -+ pha->data_dir = phase & PPSC_IO; -+ pha->data_count = 0; -+ -+ pha->sg_count = pha->cur_cmd->use_sg; -+ if (pha->sg_count) { -+ pha->sg_count--; -+ pha->sg_list = -+ (struct scatterlist *)pha->cur_cmd->request_buffer; -+ pha->cur_buf = page_address(pha->sg_list->page) + pha->sg_list->offset; -+ pha->cur_len = pha->sg_list->length; -+ } else { -+ pha->cur_buf = pha->cur_cmd->request_buffer; -+ pha->cur_len = pha->cur_cmd->request_bufflen; -+ } -+ -+ pha->last_phase = phase; -+ -+ } -+ -+ if ((pha->bulk) && (pha->cur_len > 0 )) { -+ pha->proto->start_block(pha,pha->data_dir); -+ ppsc_transfer(pha); -+ return; -+ } -+ -+ ppsc_update_sg(pha); -+ -+ if (!pha->cur_len) { -+ pha->cur_len = 1; -+ pha->cur_buf = (char *)&i; -+ i = 0x5a; -+ pha->overflow++; -+ } -+ -+ pha->cur_len--; -+ pha->data_count++; -+ -+ if (!ppsc_slow(pha,pha->cur_buf++)) return; -+ -+ break; -+ -+ case PPSC_PH_STAT: -+ -+ if ((pha->last_phase != PPSC_PH_CMD) && -+ (pha->last_phase != PPSC_PH_READ) && -+ (pha->last_phase != PPSC_PH_WRITE)) -+ PPSC_FAIL(DID_ERROR,"Phase sequence error 3"); -+ -+ if ((pha->last_phase != PPSC_PH_CMD) && -+ (V_DEBUG)) { -+ printk("%s: %s%s %d bytes\n", -+ pha->device, -+ pha->bulk?"":"slow ", -+ pha->data_dir?"read":"write", -+ pha->data_count); -+ -+ if (pha->cur_cmd->cmnd[0] == REQUEST_SENSE) { -+ -+ sb = (char *)pha->cur_cmd->request_buffer; -+ printk("%s: Sense key: %x ASC: %x ASCQ: %x\n", -+ pha->device, sb[2] & 0xff, -+ sb[12] & 0xff, sb[13] & 0xff); -+ } -+ } -+ -+ if (pha->overflow) -+ printk("%s: WARNING: data %s overran by %d/%d bytes\n", -+ pha->device,pha->data_dir?"read":"write", -+ pha->overflow,pha->data_count); -+ -+ pha->last_phase = phase; -+ -+ if (!ppsc_slow(pha,&pha->status_byte)) return; -+ -+ break; -+ -+ case PPSC_PH_MSGIN: -+ -+ if (pha->last_phase != PPSC_PH_STAT) -+ PPSC_FAIL(DID_ERROR,"Phase sequence error 4"); -+ -+ pha->last_phase = phase; -+ -+ if (V_FULL) -+ printk("%s: status = %x\n",pha->device,pha->status_byte); -+ -+ if (!ppsc_slow(pha,&pha->message_byte)) return; -+ -+ break; -+ -+ default: -+ -+ PPSC_FAIL(DID_ERROR,"Unexpected bus phase"); -+ -+ } -+ } -+} -+ -+static void ppsc_transfer (PHA *pha) -+{ -+ int i, j; -+ -+ if (pha->timedout) -+ PPSC_FAIL(DID_TIME_OUT,"PDMA timeout"); -+ -+ while(1) { -+ -+ if (!(j=pha->proto->transfer_ready(pha))) { -+ ppsc_set_intr(pha,ppsc_transfer, -+ pha->proto->transfer_ready,0); -+ return; -+ } -+ -+ if (j < 0) { -+ if (V_DEBUG) -+ printk("%s: short transfer\n",pha->device); -+ ppsc_set_intr(pha,ppsc_transfer_done, -+ pha->proto->transfer_done,0); -+ return; -+ } -+ -+ i = pha->proto->transfer_block(pha,pha->cur_buf, -+ pha->cur_len,pha->data_dir); -+ -+ if (V_FULL) -+ printk("%s: Fragment %d\n",pha->device,i); -+ -+ if ((i < 0) || (i > pha->cur_len)) -+ PPSC_FAIL(DID_ERROR,"Block transfer error"); -+ -+ pha->cur_len -= i; -+ pha->cur_buf += i; -+ pha->data_count += i; -+ -+ ppsc_update_sg(pha); -+ -+ if (pha->cur_len == 0 ) { -+ ppsc_set_intr(pha,ppsc_transfer_done, -+ pha->proto->transfer_done,0); -+ return; -+ } -+ } -+} -+ -+static void ppsc_transfer_done (PHA *pha) -+{ -+ if (pha->timedout) PPSC_FAIL(DID_TIME_OUT,"PDMA done timeout"); -+ -+ pha->proto->end_block(pha,pha->data_dir); -+ ppsc_engine(pha); -+} -+ -+static int ppsc_slow (PHA *pha, char *val) -+{ -+ int k; -+ -+ pha->proto->slow_start(pha,val); -+ -+ k = 0; -+ while (k++ < PPSC_SLOW_LOOPS) -+ if (pha->proto->slow_done(pha)) { -+ pha->proto->slow_end(pha); -+ return 1; -+ } -+ -+ ppsc_set_intr(pha,ppsc_slow_done,pha->proto->slow_done,0); -+ return 0; -+} -+ -+static void ppsc_slow_done (PHA *pha) -+{ -+ int k; -+ -+ if (pha->timedout) PPSC_FAIL(DID_TIME_OUT,"PIO timeout"); -+ -+ pha->proto->slow_end(pha); -+ -+ k = 0; -+ while (k++ < PPSC_SLOW_LOOPS) -+ if (ppsc_ready(pha)) break; -+ -+ ppsc_engine(pha); -+} -+ -+static void ppsc_try_again (unsigned long data ) -+{ -+ PHA *pha = (PHA *)data; -+ -+ ppsc_do_claimed(pha,ppsc_start); -+} -+ -+static void ppsc_cleanup (PHA *pha) -+{ -+ struct scsi_cmnd *cmd; -+ void (*done)(struct scsi_cmnd *); -+ unsigned long saved_flags; -+ -+ pha->tot_bytes += pha->data_count; -+ -+ cmd = pha->cur_cmd; -+ done = pha->done; -+ cmd->result = pha->return_code; -+ pha->cur_cmd = 0; -+ -+ pha->proto->deselect(pha); -+ pha->proto->disconnect(pha); -+ -+ if (V_FULL) printk("%s: releasing parport\n",pha->device); -+ -+ ppsc_unclaim(pha); -+ -+ if (pha->abort_flag) { -+ -+ if (V_DEBUG) printk("%s: command aborted !\n",pha->device); -+ -+ return; /* kill the thread */ -+ } -+ -+ if (V_DEBUG) -+ printk("%s: Command status %08x last phase %o\n", -+ pha->device,cmd->result,pha->last_phase); -+ -+ if (status_byte(pha->return_code) == BUSY) { -+ -+ pha->cur_cmd = cmd; -+ -+ if (V_FULL) -+ printk("%s: BUSY, sleeping before retry ...\n", -+ pha->device); -+ -+ init_timer (&pha->sleeper); -+ pha->sleeper.data = (unsigned long) pha; -+ pha->sleeper.function = ppsc_try_again; -+ pha->sleeper.expires = jiffies + PPSC_BUSY_SNOOZE; -+ add_timer(&pha->sleeper); -+ -+ return; -+ -+ } -+ -+ pha->tot_cmds++; -+ -+ if ((cmd->cmnd[0] != REQUEST_SENSE) && -+ (status_byte(pha->return_code) == CHECK_CONDITION)) { -+ -+ if (V_FULL) -+ printk("%s: Requesting sense data\n",pha->device); -+ -+ cmd->cmnd[0] = REQUEST_SENSE; -+ cmd->cmnd[1] &= 0xe0; -+ cmd->cmnd[2] = 0; -+ cmd->cmnd[3] = 0; -+ cmd->cmnd[4] = sizeof(cmd->sense_buffer); -+ cmd->cmnd[5] = 0; -+ cmd->cmd_len = 6; -+ cmd->use_sg = 0; -+ cmd->request_buffer = (char *) cmd->sense_buffer; -+ cmd->request_bufflen = sizeof(cmd->sense_buffer); -+ -+ pha->cur_cmd = cmd; -+ ppsc_do_claimed(pha,ppsc_start); -+ -+ return; -+ } -+ -+ if (done) { -+ -+ spin_lock_irqsave(pha->host_ptr->host_lock,saved_flags); -+ done(cmd); -+ spin_unlock_irqrestore(pha->host_ptr->host_lock,saved_flags); -+ -+ } -+ -+} -+ -+static void ppsc_fail_command (PHA *pha, int err_code, char *msg) -+{ -+ int bs; -+ -+ pha->tot_errs++; -+ -+ bs = pha->proto->get_bus_status(pha); -+ -+ pha->return_code = err_code << 16; -+ if (!pha->quiet) -+ printk("%s: %s, bs=%o cb=%d db=%d bu=%d sg=%d " -+ "rd=%d lp=%o pe=%d cc=%d\n", -+ pha->device, msg, bs, -+ pha->cmd_count, pha->data_count, -+ pha->bulk, pha->sg_count, pha->data_dir, -+ pha->last_phase, pha->protocol_error, pha->tot_cmds); -+ -+ ppsc_cleanup(pha); -+} -+ -+static int ppsc_ready (PHA *pha) -+{ -+ int bs; -+ -+ if (pha->abort_flag || pha->protocol_error) return 1; -+ bs = pha->proto->get_bus_status(pha); -+ -+ if ( (bs & (PPSC_REQ|PPSC_BSY)) != PPSC_BSY) return 1; -+ -+ return 0; -+} -+ -+int ppsc_abort (struct scsi_cmnd * cmd) -+{ -+ PHA *pha = (PHA *)cmd->device->host->hostdata[0]; -+ -+ printk("%s: Command abort not supported\n",pha->device); -+ return FAILED; -+} -+ -+static void ppsc_reset_pha (PHA *pha) -+{ -+ if (!pha->proto->reset_bus) { -+ printk("%s: No reset method available\n",pha->device); -+ return; -+ } -+ -+ ppsc_claim(pha); -+ pha->proto->connect(pha); -+ pha->proto->reset_bus(pha); -+ scsi_sleep(4*HZ); -+ pha->proto->disconnect(pha); -+ ppsc_unclaim(pha); -+ -+ if (!pha->quiet) printk("%s: Bus reset\n",pha->device); -+} -+ -+int ppsc_reset (struct scsi_cmnd * cmd) -+{ -+ PHA *pha = (PHA *)cmd->device->host->hostdata[0]; -+ int k = 0; -+ -+ if (!pha->proto->reset_bus) -+ return FAILED; -+ -+ if (pha->cur_cmd) -+ pha->abort_flag = PPSC_DO_RESET; -+ -+ while (pha->cur_cmd && (k < PPSC_RESET_TMO)) { -+ scsi_sleep(HZ/10); -+ k += HZ/10; -+ } -+ -+ if (pha->cur_cmd) { -+ printk("%s: Driver won't give up for reset\n",pha->device); -+ return FAILED; -+ } -+ -+ ppsc_reset_pha(pha); -+ -+ return SUCCESS; -+} -+ -+#define PROCIN(n,var) \ -+ if ((length>n+1)&&(strncmp(buffer,#var"=",n+1)==0)) { \ -+ pha->var = simple_strtoul(buffer+n+1,NULL,0); \ -+ return length; \ -+ } -+ -+#define PROCOUT(fmt,val) len+=sprintf(buffer+len,fmt"\n",val); -+ -+int ppsc_proc_info(struct Scsi_Host *p, char *buffer, char **start, off_t offset, -+ int length, int inout) -+{ -+ int len = 0; -+ PHA *pha; -+ -+ if (!p) return 0; /* should never happen */ -+ pha = (PHA *)p->hostdata[0]; -+ -+ if (inout) { -+ -+ PROCIN(4,mode); -+ PROCIN(5,delay); -+ PROCIN(7,verbose); -+ PROCIN(10,abort_flag); -+ PROCIN(4,nice); -+ -+ return (-EINVAL); -+ } -+ -+ PROCOUT("ident: %s",pha->ident); -+ PROCOUT("base port: 0x%03x",pha->port); -+ PROCOUT("mode: %d",pha->mode); -+ if (pha->proto->mode_names) -+ PROCOUT("mode name: %s",pha->proto->mode_names[pha->mode]); -+ PROCOUT("delay: %d",pha->delay); -+ PROCOUT("nice: %d",pha->nice); -+ PROCOUT("verbose: %d",pha->verbose); -+ PROCOUT("quiet: %d",pha->quiet); -+ PROCOUT("tot_cmds: %d",pha->tot_cmds); -+ PROCOUT("tot_bytes: %ld",pha->tot_bytes); -+ PROCOUT("tot_errs: %d",pha->tot_errs); -+ -+ if (pha->pardev) { -+ PROCOUT("parport device: %s",pha->parname); -+ PROCOUT("claimed: %d",pha->claimed); -+ } -+ if (V_DEBUG) { -+ PROCOUT("then: %ld",pha->then); -+ PROCOUT("timeout: %ld",pha->timeout); -+ PROCOUT("now: %ld",jiffies); -+ PROCOUT("timer active: %d",pha->timer_active); -+ PROCOUT("wq_active: %d",pha->wq_active); -+ PROCOUT("abort_flag: %d",pha->abort_flag); -+ PROCOUT("return_code: %08x",pha->return_code); -+ PROCOUT("last_phase: %o",pha->last_phase); -+ PROCOUT("cmd_count: %d",pha->cmd_count); -+ PROCOUT("data_count: %d",pha->data_count); -+ PROCOUT("data_dir: %d",pha->data_dir); -+ PROCOUT("bulk: %d",pha->bulk); -+ PROCOUT("tlen: %d",pha->tlen); -+ PROCOUT("overflow: %d",pha->overflow); -+ } -+ -+ if (offset > len) return 0; -+ -+ *start = buffer+offset; len -= offset; -+ if (len > length) len = length; -+ return len; -+} -+ -+int ppsc_biosparam (struct scsi_device * sdev, struct block_device *bdev, sector_t capacity, int ip[]) -+{ -+ ip[0] = 0x40; -+ ip[1] = 0x20; -+ ip[2] = (capacity +1) / (ip[0] * ip[1]); -+ if (ip[2] > 1024) { -+ ip[0] = 0xff; -+ ip[1] = 0x3f; -+ ip[2] = (capacity +1) / (ip[0] * ip[1]); -+ if (ip[2] > 1023) -+ ip[2] = 1023; -+ } -+ return 0; -+} -+ -+static int ppsc_inquire (PHA *pha, int target, char *buf) -+{ -+ char inq[6] = {0x12,0,0,0,36,0}; -+ int i; -+ struct scsi_cmnd cmd; -+ struct scsi_device dev; -+ -+ dev.host = pha->host_ptr; -+ dev.id = target; -+ cmd.device = &dev; -+ cmd.cmd_len = 6; -+ for (i=0;i<6;i++) cmd.cmnd[i] = inq[i]; -+ cmd.use_sg = 0; -+ cmd.request_buffer = buf; -+ cmd.request_bufflen = 36; -+ -+ return ppsc_command(&cmd); -+} -+ -+static void ppsc_test_mode (PHA *pha, int mode) -+{ -+ int i, t, s, e, f, g, ok, old_mode; -+ char ibuf[38]; -+ -+ if ((mode >= pha->proto->epp_first) && -+ !(pha->pardev->port->modes & PARPORT_MODE_EPP)) -+ return; -+ -+ old_mode = pha->mode; -+ pha->mode = mode; -+ -+ e = -1; f = -1; g = 0; -+ -+ if (pha->proto->test_proto) { -+ ppsc_claim(pha); -+ e = pha->proto->test_proto(pha); -+ ppsc_unclaim(pha); -+ } -+ -+ if (e <= 0) { -+ f = 0; -+ for (t=0;t<8;t++) { -+ s = ppsc_inquire(pha,t,ibuf); -+ if (s == DID_NO_CONNECT << 16) continue; -+ if (s) { -+ f++; -+ break; -+ } -+ if (V_FULL) { -+ for (i=0;i<36;i++) -+ if ((ibuf[i] < ' ') || (ibuf[i] >= '~')) ibuf[i] = '.'; -+ ibuf[36] = 0; -+ printk("%s: port 0x%x mode %d targ %d: %s\n", -+ pha->device,pha->port,mode,t,ibuf); -+ } -+ g++; -+ } -+ if (f) ppsc_reset_pha(pha); -+ } -+ -+ ok = (e<=0) && (f == 0); -+ -+ if (!ok) pha->mode = old_mode; -+ -+ if (V_PROBE) printk("%s: port 0x%3x mode %d test %s (%d,%d,%d)\n", -+ pha->device,pha->port,mode,ok?"passed":"failed",e,f,g); -+} -+ -+ -+int ppsc_release_pha (PHA *pha) -+{ -+ if (pha->proto->release) pha->proto->release(pha); -+ -+ ppsc_unregister_parport(pha); -+ -+ /* MOD_DEC_USE_COUNT; */ -+ -+ return 0; -+} -+ -+ -+int ppsc_detect (PSP *proto, Scsi_Host_Template *tpnt, int verbose) -+{ -+ int i, m, p, d, n, s, z; -+ struct ppsc_port_list_struct *next_port = NULL; /* shut gcc up */ -+ int user_specified = 1; -+ PHA *pha; -+ int host_count = 0; -+ struct Scsi_Host *hreg; -+ -+ m = 0; -+ for (i=0;i<4;i++) if ((*proto->params[i])[PPSC_PARM_PORT] != -1) m++; -+ -+ if (!m) { -+ /* Just take parports from the list as they come. */ -+ next_port = ppsc_port_list; -+ user_specified = 0; -+ } -+ -+ tpnt->this_id = PPSC_INITIATOR; -+ -+ for (i=0;i<4;i++) { -+ if (!user_specified) { -+ if (!next_port) -+ break; -+ -+ p = next_port->port->number; -+ next_port = next_port->next; -+ } -+ else { -+ p = (*proto->params[i])[PPSC_PARM_PORT]; -+ if (p < 0) -+ continue; -+ } -+ -+ m = (*proto->params[i])[PPSC_PARM_MODE]; -+ n = (*proto->params[i])[PPSC_PARM_NICE]; -+ if (n == -1) n = PPSC_DEF_NICE; -+ d = (*proto->params[i])[PPSC_PARM_DLY]; -+ if (d == -1) d = proto->default_delay; -+ s = (*proto->params[i])[PPSC_PARM_SGTS]; -+ if (s == -1) s = proto->default_sg_tablesize; -+ z = (*proto->params[i])[PPSC_PARM_SLOW]; -+ if (z == -1) z = 0; -+ -+ /* MOD_INC_USE_COUNT; */ -+ -+ pha = &(((*proto->hosts)[i])); -+ -+ pha->proto = proto; -+ -+ pha->port = p; -+ pha->delay = d; -+ pha->nice = n; -+ -+ d = sizeof(pha->device)-3; -+ p = strlen(tpnt->name); -+ if (p > d) p = d; -+ for (n=0;ndevice[n] = tpnt->name[n]; -+ pha->device[p] = '.'; -+ pha->device[p+1] = '0' + i; -+ pha->device[p+2] = 0; -+ -+ INIT_WORK(&pha->wq, ppsc_tq_int, pha); -+ -+ init_timer (&pha->timer); -+ pha->timer.data = (unsigned long) pha; -+ pha->timer.function = ppsc_timer_int; -+ -+ init_waitqueue_head (&pha->parq); -+ pha->pardev = NULL; -+ pha->claimed = 0; -+ pha->claim_cont = NULL; -+ pha->timer_active = 0; -+ pha->wq_active = 0; -+ pha->timedout = 0; -+ -+ pha->cur_cmd = NULL; -+ pha->done = NULL; -+ pha->abort_flag = 0; -+ pha->protocol_error = 0; -+ pha->tot_errs = 0; -+ pha->tot_cmds = 0; -+ pha->tot_bytes = 0; -+ -+ for (n=0;n<8;n++) pha->private[n] = 0; -+ -+ pha->slow_targets = z; -+ -+ if (ppsc_register_parport(pha,verbose)) { -+ /* MOD_DEC_USE_COUNT; */ -+ continue; -+ } -+ -+ pha->proto->init(pha); -+ -+ pha->verbose = verbose; -+ pha->quiet = 1; /* no errors until probe over */ -+ if (V_FULL) pha->quiet = 0; /* unless we want them ... */ -+ -+ pha->tmo = PPSC_PROBE_TMO; -+ -+ hreg = scsi_register(tpnt,sizeof(PHA*)); -+ hreg->dma_channel = -1; -+ hreg->n_io_port = 0; -+ hreg->unique_id = (int) pha; /* What should we put in here??? */ -+ hreg->sg_tablesize = s; -+ hreg->hostdata[0]=(unsigned long)pha; /* Will be our pointer */ -+ -+ pha->host_ptr = hreg; -+ -+ pha->mode = -1; -+ -+ if (m == -1) for (m=0;mnum_modes;m++) -+ ppsc_test_mode(pha,m); -+ else ppsc_test_mode(pha,m); -+ -+ if (pha->mode != -1) { -+ -+ pha->quiet = 0; /* enable PPSC_FAIL msgs */ -+ pha->tmo = PPSC_GEN_TMO; -+ host_count++; -+ -+ printk("%s: %s at 0x%3x mode %d (%s) dly %d nice %d sg %d\n", -+ pha->device, -+ pha->ident, -+ pha->port, -+ pha->mode, -+ (pha->proto->mode_names)? -+ pha->proto->mode_names[pha->mode]:"", -+ pha->delay, -+ pha->nice, -+ hreg->sg_tablesize); -+ -+ } else { -+ -+ scsi_unregister(hreg); -+ ppsc_release_pha(pha); -+ -+ } -+ } -+ return host_count; -+} -+ -+int ppsc_release (struct Scsi_Host *host) -+{ -+ PHA *pha = (PHA *) host->hostdata[0]; -+ -+ return ppsc_release_pha(pha); -+} -+ -+int ppsc_initialise (void) -+{ -+ int i; -+ -+ for (i=0;i<256;i++) ppsc_bulk_map[i] = 0; -+ -+/* commands marked in this map will use pseudo-DMA transfers, while -+ the rest will use the slow handshaking. -+*/ -+ -+ ppsc_bulk_map[READ_6] = 1; -+ ppsc_bulk_map[READ_10] = 1; -+ ppsc_bulk_map[READ_BUFFER] = 1; -+ ppsc_bulk_map[WRITE_6] = 1; -+ ppsc_bulk_map[WRITE_10] = 1; -+ ppsc_bulk_map[WRITE_BUFFER] = 1; -+ -+ if (parport_register_driver (&ppsc_driver)) { -+ printk (KERN_WARNING "ppscsi: couldn't register driver\n"); -+ return -EIO; -+ } -+ -+ printk("ppSCSI %s (%s) installed\n",PPSC_VERSION,PPSC_H_VERSION); -+ return 0; -+} -+ -+#ifdef MODULE -+ -+int init_module (void) -+{ -+ return ppsc_initialise(); -+} -+ -+void cleanup_module (void) -+{ -+ struct ppsc_port_list_struct *ports, *next; -+ parport_unregister_driver (&ppsc_driver); -+ for (ports = ppsc_port_list; ports; ports = next) { -+ next = ports->next; -+ parport_put_port (ports->port); -+ kfree (ports); -+ } -+} -+ -+MODULE_LICENSE("GPL"); -+ -+#endif -+ -+EXPORT_SYMBOL(ppsc_make_map); -+EXPORT_SYMBOL(ppsc_queuecommand); -+EXPORT_SYMBOL(ppsc_abort); -+EXPORT_SYMBOL(ppsc_reset); -+EXPORT_SYMBOL(ppsc_proc_info); -+EXPORT_SYMBOL(ppsc_biosparam); -+EXPORT_SYMBOL(ppsc_detect); -+EXPORT_SYMBOL(ppsc_release); -+ -+/* end of ppscsi.c */ ---- /dev/null -+++ b/drivers/scsi/ppscsi.h -@@ -0,0 +1,356 @@ -+#ifndef _PPSC_H -+#define _PPSC_H -+ -+/* -+ ppscsi.h (c) 1999 Grant Guenther -+ Under the terms of the GNU public license. -+ -+ This header file defines a common interface for constructing -+ low-level SCSI drivers for parallel port SCSI adapters. -+ -+*/ -+ -+#define PPSC_H_VERSION "0.92" -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+#include "scsi.h" -+#include "hosts.h" -+ -+ -+/* ppscsi global functions */ -+ -+extern void ppsc_make_map( char map[256], char key[5], int inv); -+ -+extern int ppsc_proc_info(struct Scsi_Host *, char *,char **,off_t,int,int); -+extern int ppsc_command(struct scsi_cmnd *); -+extern int ppsc_queuecommand(struct scsi_cmnd *, void (* done)(struct scsi_cmnd *)); -+extern int ppsc_abort(struct scsi_cmnd *); -+extern int ppsc_reset(struct scsi_cmnd *); -+extern int ppsc_biosparam(struct scsi_device *, struct block_device *, sector_t capacity, int[]); -+extern int ppsc_release(struct Scsi_Host *); -+ -+#ifndef PPSC_BASE -+ -+/* imports for hosts.c */ -+ -+#ifdef CONFIG_PPSCSI_T348 -+extern int t348_detect( Scsi_Host_Template *); -+#endif -+ -+#ifdef CONFIG_PPSCSI_T358 -+extern int t358_detect( Scsi_Host_Template *); -+#endif -+ -+#ifdef CONFIG_PPSCSI_ONSCSI -+extern int onscsi_detect( Scsi_Host_Template *); -+#endif -+ -+#ifdef CONFIG_PPSCSI_EPST -+extern int epst_detect( Scsi_Host_Template *); -+#endif -+ -+#ifdef CONFIG_PPSCSI_EPSA2 -+extern int epsa2_detect( Scsi_Host_Template *); -+#endif -+ -+#ifdef CONFIG_PPSCSI_VPI0 -+extern int vpi0_detect( Scsi_Host_Template *); -+#endif -+ -+#ifdef CONFIG_PPSCSI_SPARCSI -+extern int sparcsi_detect( Scsi_Host_Template *); -+#endif -+ -+#endif -+ -+#define PPSC_TEMPLATE(proto){ \ -+ .name = #proto, \ -+ .detect = proto##_detect, \ -+ .release = ppsc_release, \ -+ .proc_name = #proto, \ -+ .proc_info = ppsc_proc_info, \ -+ .queuecommand = ppsc_queuecommand, \ -+ .eh_abort_handler = ppsc_abort, \ -+ .eh_bus_reset_handler = ppsc_reset, \ -+ .eh_host_reset_handler = ppsc_reset, \ -+ .bios_param = ppsc_biosparam, \ -+ .can_queue = 1, \ -+ .sg_tablesize = SG_NONE, \ -+ .cmd_per_lun = 1, \ -+ .use_clustering = DISABLE_CLUSTERING \ -+} -+ -+/* types used by the actual driver modules */ -+ -+#ifdef PPSC_BASE -+ -+#include -+#include -+#include -+#include -+#include -+#include -+ -+ -+struct setup_tab_t { -+ -+ char *tag; /* variable name */ -+ int size; /* number of elements in array */ -+ int *iv; /* pointer to variable */ -+}; -+ -+typedef struct setup_tab_t STT; -+ -+extern void ppsc_gen_setup( STT t[], int n, char *ss ); -+ -+typedef struct ppsc_host_adapter PHA; -+ -+struct ppsc_host_adapter { -+ -+ char ident[80]; /* Adapter name and version info */ -+ -+ char device[12]; /* device name for messages */ -+ -+ struct Scsi_Host *host_ptr; /* SCSI host structure */ -+ struct ppsc_protocol *proto; /* adapter protocol */ -+ -+ int port; /* parallel port base address */ -+ int mode; /* transfer mode in use */ -+ int delay; /* parallel port settling delay */ -+ int saved_r0; /* saved port state */ -+ int saved_r2; /* saved port state */ -+ -+ int reserved; /* number of ports reserved */ -+ int tmo; /* default command timeout */ -+ int verbose; /* logging level */ -+ int quiet; /* do not log PPSC_FAIL msgs */ -+ -+ int slow_targets; /* bit mask for disabling block mode */ -+ -+ wait_queue_head_t parq; /* semaphore for parport sharing */ -+ struct pardevice *pardev; /* pointer to pardevice */ -+ const char *parname; /* parport name */ -+ int claimed; /* parport has been claimed */ -+ void (*claim_cont)(PHA *); /* continuation for parport wait */ -+ -+ void (*continuation)(PHA *); /* next "interrupt" handler */ -+ int (*ready)(PHA *); /* current ready test */ -+ unsigned long then; /* jiffies at start of last wait */ -+ unsigned long timeout; /* when to timeout this wait */ -+ int timedout; /* timeout was seen */ -+ int timer_active; /* we're using a timer */ -+ int wq_active; /* we have a task queued */ -+ int nice; /* tune the CPU load */ -+ struct timer_list timer; /* timer queue element */ -+ struct work_struct wq; /* task queue element */ -+ -+ int private[8]; /* for the protocol layer, if needed */ -+ char *priv_ptr; -+ int priv_flag; -+ -+ struct scsi_cmnd *cur_cmd; /* current command on this host */ -+ void (*done)(struct scsi_cmnd *); /* current "done" function */ -+ -+ int overflow; /* excess bytes transferred */ -+ int bulk; /* should we use block mode ? */ -+ int tlen; /* total transfer length */ -+ int abort_flag; /* abort=1 reset=2 requested */ -+ int return_code; /* build return value here */ -+ -+ struct scatterlist *sg_list; /* current fragment, if any */ -+ int sg_count; /* remaining fragments */ -+ char *cur_buf; /* current buffer pointer */ -+ int cur_len; /* remaining bytes in buffer */ -+ -+ struct timer_list sleeper; /* for BUSY handling */ -+ -+ int last_phase; /* to detect phase changes */ -+ char message_byte; -+ char status_byte; -+ -+ int cmd_count; /* bytes of command transfered */ -+ int data_count; /* bytes of data transferred */ -+ int data_dir; /* direction of transfer */ -+ -+ int tot_cmds; /* number of commands processed */ -+ long tot_bytes; /* total bytes transferred */ -+ int tot_errs; /* number of failed commands */ -+ -+ int protocol_error; /* Some protocols can set this -+ != zero to signal a fatal error -+ we report it and expect to die -+ */ -+}; -+ -+/* constants for 'verbose' */ -+ -+#define PPSC_VERB_NORMAL 0 -+#define PPSC_VERB_PROBE 1 -+#define PPSC_VERB_TRACE 2 -+#define PPSC_VERB_DEBUG 3 -+#define PPSC_VERB_FULL 4 -+ -+#define V_PROBE (pha->verbose >= PPSC_VERB_PROBE) -+#define V_TRACE (pha->verbose >= PPSC_VERB_TRACE) -+#define V_DEBUG (pha->verbose >= PPSC_VERB_DEBUG) -+#define V_FULL (pha->verbose >= PPSC_VERB_FULL) -+ -+/* constants for abort_flag */ -+ -+#define PPSC_DO_ABORT 1 -+#define PPSC_DO_RESET 2 -+ -+ -+struct ppsc_protocol { -+ -+ int (*params[4])[8]; /* hostN tuning parameters */ -+ -+ PHA (*hosts)[4]; /* actual PHA structs */ -+ -+ int num_modes; /* number of modes*/ -+ int epp_first; /* modes >= this use 8 ports */ -+ int default_delay; /* delay parameter if not specified */ -+ -+ int can_message; /* adapter can send/rcv SCSI msgs */ -+ int default_sg_tablesize; /* sg_tablesize if not specified */ -+ -+ char **mode_names; /* printable names of comm. modes */ -+ -+/* first two functions are NOT called with the port claimed. */ -+ -+ void (*init)(PHA *); /* (pha) -+ protocol initialisation -+ should fill in pha->ident */ -+ void (*release)(PHA *); /* (pha) optional -+ protocol no longer in use */ -+ void (*connect)(PHA *); /* (pha) -+ connect to adapter */ -+ void (*disconnect)(PHA *); /* (pha) -+ release adapter */ -+ int (*test_proto)(PHA *); /* (pha) optional -+ test protocol in current settings, -+ returns error count */ -+ int (*select)(PHA *,int,int); /* (pha,initiator,target) -+ start artibration and selection -+ 0 = OK, -1 = arb. failed */ -+ int (*test_select)(PHA *); /* (pha) -+ test for selection to complete -+ 1 = OK, 0 try again */ -+ void (*select_finish)(PHA *); /* (pha) optional -+ called after successful select */ -+ void (*deselect)(PHA *); /* (pha) -+ release SCSI bus */ -+ int (*get_bus_status)(PHA *); /* (pha) -+ return (REQ,BSY,MSG,C/D,I/O) */ -+ void (*slow_start)(PHA *,char *); /* (pha,byte) -+ start transfer of one byte using -+ explicit handshaking */ -+ int (*slow_done)(PHA *); /* (pha) -+ has the device acked the byte ? */ -+ void (*slow_end)(PHA *); /* (pha) -+ shut down the slow transfer */ -+ void (*start_block)(PHA *,int); /* (pha,read) -+ start data transfer */ -+ int (*transfer_block)(PHA *,char *,int,int); -+ /* (pha,buf,len,read) -+ transfer as much as possible and -+ return count of bytes -+ can return -1 if error detected */ -+ int (*transfer_ready)(PHA *pha);/* (pha) -+ can we go again yet ? -+ >0 = yes, 0 = try again, -1 = done */ -+ int (*transfer_done)(PHA *pha); /* (pha) -+ has all data been flushed ? -+ 1 = yes, 0 = try again */ -+ void (*end_block)(PHA *,int); /* (pha,read) -+ shut down block transfer */ -+ void (*reset_bus)(PHA *); /* (pha) optional -+ reset SCSI bus if possible */ -+ -+}; -+ -+/* constants for the params array */ -+ -+#define PPSC_PARM_PORT 0 -+#define PPSC_PARM_MODE 1 -+#define PPSC_PARM_DLY 2 -+#define PPSC_PARM_NICE 3 -+#define PPSC_PARM_SGTS 4 -+#define PPSC_PARM_SLOW 5 -+ -+/* constants for get_bus_status */ -+ -+#define PPSC_REQ 16 -+#define PPSC_BSY 8 -+#define PPSC_MSG 4 -+#define PPSC_CD 2 -+#define PPSC_IO 1 -+ -+/* phases */ -+ -+#define PPSC_PH_NONE 0 -+#define PPSC_PH_WRITE (PPSC_REQ|PPSC_BSY) -+#define PPSC_PH_READ (PPSC_PH_WRITE|PPSC_IO) -+#define PPSC_PH_CMD (PPSC_PH_WRITE|PPSC_CD) -+#define PPSC_PH_STAT (PPSC_PH_READ|PPSC_CD) -+#define PPSC_PH_MSGIN (PPSC_PH_STAT|PPSC_MSG) -+ -+typedef struct ppsc_protocol PSP; -+ -+extern int ppsc_detect( PSP *, Scsi_Host_Template *, int); -+ -+#ifdef PPSC_HA_MODULE -+ -+static int verbose = PPSC_VERB_NORMAL; -+ -+static int host0[8] = {-1,-1,-1,-1,-1,-1,-1,-1}; -+static int host1[8] = {-1,-1,-1,-1,-1,-1,-1,-1}; -+static int host2[8] = {-1,-1,-1,-1,-1,-1,-1,-1}; -+static int host3[8] = {-1,-1,-1,-1,-1,-1,-1,-1}; -+ -+#ifndef MODULE -+ -+static STT stt[4] = { {"host0",8,host0}, -+ {"host1",8,host1}, -+ {"host2",8,host2}, -+ {"host3",8,host3} }; -+#endif -+ -+MODULE_PARM(host0,"1-8i"); -+MODULE_PARM(host1,"1-8i"); -+MODULE_PARM(host2,"1-8i"); -+MODULE_PARM(host3,"1-8i"); -+MODULE_PARM(verbose,"i"); -+ -+static struct ppsc_host_adapter host_structs[4]; -+ -+#define delay_p (pha->delay?udelay(pha->delay):0) -+#define out_p(offs,byte) outb(byte,pha->port+offs); delay_p; -+#define in_p(offs) (delay_p,inb(pha->port+offs)) -+ -+#define w0(byte) do {out_p(0,byte);} while (0) -+#define r0() (in_p(0) & 0xff) -+#define w1(byte) do {out_p(1,byte);} while (0) -+#define r1() (in_p(1) & 0xff) -+#define w2(byte) do {out_p(2,byte);} while (0) -+#define r2() (in_p(2) & 0xff) -+#define w3(byte) do {out_p(3,byte);} while (0) -+#define w4(byte) do {out_p(4,byte);} while (0) -+#define r4() (in_p(4) & 0xff) -+#define w4w(data) do {outw(data,pha->port+4); delay_p;} while (0) -+#define w4l(data) do {outl(data,pha->port+4); delay_p;} while (0) -+#define r4w() (delay_p,inw(pha->port+4)&0xffff) -+#define r4l() (delay_p,inl(pha->port+4)&0xffffffff) -+ -+#endif /* PPSC_HA_MODULE */ -+#endif /* PPSC_BASE */ -+#endif /* _PPSC_H */ -+ -+/* end of ppscsi.h */ -+ ---- /dev/null -+++ b/drivers/scsi/onscsi.c -@@ -0,0 +1,544 @@ -+/* -+ onscsi.c (c) 1999 Grant Guenther -+ -+ This is the ppSCSI protocol module for the OnSpec 90c26 -+ in its SCSI adapter mode. -+*/ -+ -+#define ONSCSI_VERSION "0.91" -+ -+#define PPSC_BASE -+#define PPSC_HA_MODULE -+ -+#include "ppscsi.h" -+ -+#define ONSCSI_REP_COUNT 256 -+ -+#define TOGL pha->private[0] -+ -+static char onscsi_map[256]; /* status bits permutation */ -+ -+static void onscsi_init (PHA *pha) -+{ -+ -+/* { REQ, BSY, MSG, CD, IO} */ -+ -+ char key[5] = {0x10,0x01,0x20,0x40,0x80}; -+ -+ ppsc_make_map(onscsi_map,key,0); -+ sprintf(pha->ident,"onscsi %s (%s), OnSpec 90c26", -+ ONSCSI_VERSION,PPSC_H_VERSION); -+} -+ -+#define j44(a,b) ((b&0xf0)|((a>>4)&0x0f)) -+ -+#define CMD(x) w0(x);w2(5);w2(0xd);w2(5);w2(0xd);w2(5);w2(4); -+#define VAL(v) w0(v);w2(5);w2(7);w2(5);w2(4); -+ -+static inline void onscsi_opcode (PHA *pha, int x ) -+{ -+ if (pha->mode < 2) { -+ CMD(x); -+ } else { -+ w3(x); -+ } -+} -+ -+#define OP(x) onscsi_opcode(pha,x) -+#define FULLBYTE (pha->mode > 0) -+ -+static void onscsi_write_regr (PHA *pha, int r, int v) -+{ -+ onscsi_opcode(pha,r); -+ -+ if (pha->mode < 2) { -+ VAL(v); -+ } else { -+ w2(5); w4(v); w2(4); -+ } -+} -+ -+static inline int onscsi_read_nybble (PHA *pha) -+{ -+ int a, b; -+ -+ w2(6); a = r1(); w2(4); -+ w2(6); b = r1(); w2(4); -+ -+ return j44(a,b); -+} -+ -+static int onscsi_read_regr (PHA *pha, int r) -+{ -+ int v = -1; -+ -+ onscsi_opcode(pha,r); -+ -+ switch (pha->mode) { -+ -+ case 0: v = onscsi_read_nybble(pha); -+ break; -+ -+ case 1: w2(0x26); v = r0(); w2(4); -+ break; -+ -+ case 2: -+ case 3: -+ case 4: w2(0x24); v = r4(); w2(4); -+ break; -+ -+ } -+ -+ return v; -+} -+ -+#define RR(r) onscsi_read_regr(pha,r) -+#define WR(r,v) onscsi_write_regr(pha,r,v) -+ -+static void onscsi_write_block (PHA *pha, char *buf, int n) -+{ -+ int i; -+ -+ w2(5+TOGL); -+ -+ switch (pha->mode) { -+ -+ case 0: -+ case 1: for (i=0;imode) { -+ -+ case 0: w2(4); -+ for (i=0;isaved_r0 = r0(); -+ pha->saved_r2 = r2(); -+ -+ CPP(0x20,4); -+ -+ CMD(2); VAL(0); -+ CMD(2); VAL(FULLBYTE); -+ -+ WR(2,FULLBYTE); -+} -+ -+static void onscsi_disconnect (PHA *pha) -+{ -+ WR(3,0); WR(7,0x48); -+ OP(4); -+ CPP(0x30,pha->saved_r2); -+ -+ w0(pha->saved_r0); -+ w2(pha->saved_r2); -+} -+ -+static int onscsi_test_proto (PHA *pha) -+{ -+ int i, k, j; -+ char wbuf[16], rbuf[16]; -+ int e = 0; -+ -+ pha->saved_r0 = r0(); -+ pha->saved_r2 = r2(); -+ -+ CPP(0x30,pha->saved_r2); -+ CPP(0x0,pha->saved_r2); -+ -+ w0(0xfe);w0(0xaa);w0(0x55);w0(0);w0(0xff); -+ i = ((r1() & 0xf0) << 4); w0(0x87); -+ i |= (r1() & 0xf0); w0(0x78); -+ w0(0x20);w2(5); -+ i |= ((r1() & 0xf0) >> 4); -+ w2(4);w0(0xff); -+ -+ if (V_PROBE) printk("%s: signature 0x%x\n",pha->device,i); -+ -+ if (i == 0xb5f) { -+ -+ CMD(2); VAL(FULLBYTE); -+ -+ w2(4); w2(0xc); udelay(100); w2(4); udelay(100); -+ -+ CMD(2); VAL(0); -+ CMD(2); VAL(FULLBYTE); -+ -+ WR(2,FULLBYTE); -+ -+ k = RR(4); -+ -+ if (V_PROBE) -+ printk("%s: OnSpec 90c26 version %x\n",pha->device,k); -+ } -+ -+ CPP(0x30,pha->saved_r2); -+ -+ w0(pha->saved_r0); -+ w2(pha->saved_r2); -+ -+ if (i != 0xb5f) return 1; -+ -+ onscsi_connect(pha); -+ -+ for (k=0;kmode == 0) WR(2,0x30); -+ if (pha->mode == 1) WR(2,0x10); -+ -+ WR(3,0); WR(7,0x48); -+ -+ WR(3,1); WR(7,0x48); OP(5); -+ TOGL = 0; -+ onscsi_write_block(pha,wbuf,16); -+ w2(4); -+ -+ if (pha->mode == 0) WR(2,0); -+ if (pha->mode == 1) WR(2,0x11); -+ -+ WR(3,5); WR(7,0x48); OP(5); -+ TOGL = 0; -+ onscsi_read_block(pha,rbuf,16); -+ w2(4); -+ -+ for (j=0;j<16;j++) -+ if (rbuf[j] != wbuf[j]) e++; -+ -+ } -+ -+ onscsi_disconnect(pha); -+ -+#ifdef EXPERIMENT -+ -+ /* enable this to see how the buffer status bits work */ -+ -+ if (pha->mode == 2) { -+ -+ onscsi_connect(pha); -+ -+ WR(3,0); WR(7,0x48); -+ WR(3,1); WR(7,0x48); OP(5); -+ w2(5); -+ -+ for (k=0;k<16;k++) { -+ j = r1(); w4(k); -+ printk("%2x:%d ",j,k); -+ } -+ printk("\n"); -+ -+ w2(4); WR(3,5); WR(7,0x48); OP(5); -+ w2(0x24); -+ -+ for (k=0;k<16;k++) { -+ j = r1(); -+ printk("%2x:%d ",j,r4()); -+ } -+ printk("\n"); -+ -+ w2(4); -+ -+ onscsi_disconnect(pha); -+ } -+ -+ if (pha->mode == 1) { -+ -+ onscsi_connect(pha); -+ -+ WR(2,0x11); -+ WR(3,0); WR(7,0x48); -+ WR(3,1); WR(7,0x48); OP(5); -+ w2(5); i = 0; -+ -+ for (k=0;k<16;k++) { -+ j = r1(); w0(k); i = 2 - i; w2(5+i); -+ printk("%2x:%d ",j,k); -+ } -+ printk("%2x.\n",r1()); -+ -+ w2(4); -+ -+ WR(2,0x11); -+ WR(3,0); WR(7,0x48); -+ WR(3,5); WR(7,0x48); OP(5); -+ w2(0x24); i = 0; -+ -+ printk("%2x ",r1()); -+ for (k=0;k<16;k++) { -+ i = 2 - i; w2(0x24+i); j = r1(); -+ printk("%2x:%d ",j,r0()); -+ } -+ printk("\n"); -+ -+ w2(4); -+ -+ onscsi_disconnect(pha); -+ } -+ -+#endif -+ -+ if (V_FULL) -+ printk("%s: test port 0x%x mode %d errors %d\n", -+ pha->device,pha->port,pha->mode,e); -+ -+ return e; -+} -+ -+static int onscsi_select (PHA *pha, int initiator, int target) -+{ -+ WR(1,0); -+ WR(2,0x80+FULLBYTE); -+ if (RR(1) != 0) return -1; -+ WR(0,((1 << initiator) | (1 << target))); -+ WR(1,2); -+ return 0; -+} -+ -+static int onscsi_test_select (PHA *pha) -+{ -+ return ((RR(1) & 3) == 3); -+} -+ -+static void onscsi_select_finish (PHA *pha) -+{ -+ WR(1,0); -+} -+ -+static void onscsi_deselect (PHA *pha) -+{ -+ WR(1,0); -+ /* WR(2,0x20+FULLBYTE); */ -+ WR(2,FULLBYTE); -+ WR(3,0); WR(7,0x48); -+} -+ -+static int onscsi_get_bus_status (PHA *pha) -+{ -+ WR(2,0x20+FULLBYTE); -+ return onscsi_map[RR(1)]; -+} -+ -+static void onscsi_slow_start (PHA *pha, char *val) -+{ -+ pha->priv_flag = (RR(1) & 0x80); -+ pha->priv_ptr = val; -+ -+ if (pha->priv_flag) WR(2,0x20); else WR(2,0x21); -+ -+ OP(0); -+ -+ if (pha->priv_flag) { -+ w2(6); -+ } else { -+ w0(*val); w2(5); w2(7); -+ } -+} -+ -+static int onscsi_slow_done (PHA *pha) -+{ -+ return (!(r1() & 8)); -+} -+ -+static void onscsi_slow_end (PHA *pha) -+{ -+ if (pha->priv_flag) { -+ *pha->priv_ptr = onscsi_read_nybble(pha); -+ } else { -+ w2(5); w2(4); -+ } -+} -+ -+static void onscsi_start_block (PHA *pha, int rd) -+{ -+ pha->priv_flag = rd; -+ -+ if (rd) { -+ WR(3,5); WR(7,0x48); -+ if (pha->mode == 1) WR(2,0x31); -+ OP(5); -+ w2(5); w0(0xff); w2(4); -+ } else { -+ WR(3,1); WR(7,0x48); -+ if (pha->mode == 1) WR(2,0x31); -+ OP(5); -+ } -+ TOGL = 0; -+} -+ -+static int onscsi_transfer_done (PHA *pha) -+{ -+ int x; -+ -+ if (pha->priv_flag) return 1; -+ -+ if (pha->mode == 0) { WR(2,0x20); OP(5); } -+ x = r1(); x = r1(); -+ if (pha->mode == 0) { WR(2,0x30); OP(5); } -+ -+ if ((x & 0xf0) == 0x80) return 16; -+ return 0; -+} -+ -+static int onscsi_transfer_ready (PHA *pha) -+{ -+ int x; -+ -+ if (pha->priv_flag) { -+ x = r1(); x = r1(); -+ if ((x & 0xf0) == 0xf0) return 16; -+ if ((x & 0xf0) == 0xb0) return 8; -+ if ((x & 0xf0) == 0x90) return 1; -+ if ((x & 0xf8) == 0x88) return -1; -+ if ((x & 0xf8) == 0x08) return -1; -+ if ((x & 0xf8) == 0x0) return 1; -+ -+ if ((x & 0xf8) != 0x80) printk("DEBUG: %x\n",x); -+ -+ return 0; -+ } -+ -+ return onscsi_transfer_done(pha); -+} -+ -+ -+static int onscsi_transfer_block (PHA *pha, char * buf, int buflen, int rd) -+{ -+ int k, b; -+ -+ k = 0; -+ while ( k < buflen) { -+ -+ if ((b=onscsi_transfer_ready(pha)) <= 0) break; -+ if (b > (buflen-k)) b = buflen-k; -+ -+ if (rd) onscsi_read_block(pha,buf,b); -+ else onscsi_write_block(pha,buf,b); -+ -+ k += b; buf += b; -+ } -+ -+ return k; -+} -+ -+static void onscsi_end_block (PHA *pha, int rd) -+{ -+ w2(4); WR(3,0); WR(7,0x48); -+} -+ -+static void onscsi_reset_bus (PHA *pha) -+{ -+ WR(2,2); -+ udelay(500); -+ WR(2,0); -+ WR(2,FULLBYTE); -+} -+ -+static char *(mode_strings[5]) = {"Nybble","PS/2","EPP","EPP-16","EPP-32"}; -+ -+static struct ppsc_protocol onscsi_psp = { -+ -+ {&host0,&host1,&host2,&host3}, /* params */ -+ &host_structs, /* hosts */ -+ 5, /* num_modes */ -+ 2, /* epp_first */ -+ 1, /* default_delay */ -+ 1, /* can_message */ -+ 16, /* sg_tablesize */ -+ mode_strings, -+ onscsi_init, -+ NULL, /* release */ -+ onscsi_connect, -+ onscsi_disconnect, -+ onscsi_test_proto, -+ onscsi_select, -+ onscsi_test_select, -+ onscsi_select_finish, -+ onscsi_deselect, -+ onscsi_get_bus_status, -+ onscsi_slow_start, -+ onscsi_slow_done, -+ onscsi_slow_end, -+ onscsi_start_block, -+ onscsi_transfer_block, -+ onscsi_transfer_ready, -+ onscsi_transfer_done, -+ onscsi_end_block, -+ onscsi_reset_bus -+}; -+ -+int onscsi_detect (struct scsi_host_template *tpnt ) -+{ -+ return ppsc_detect( &onscsi_psp, tpnt, verbose); -+} -+ -+#ifdef MODULE -+ -+struct scsi_host_template driver_template = PPSC_TEMPLATE(onscsi); -+ -+#include "scsi_module.c" -+ -+MODULE_LICENSE("GPL"); -+ -+#else -+ -+void onscsi_setup (char *str, int *ints) -+{ -+ ppsc_gen_setup(stt,4,str); -+} -+ -+#endif -+ -+/* end of onscsi.c */ ---- linux-2.6.31-rc3-git5.mnb1/drivers/scsi/Kconfig.scsi-ppscsi-2.6.2.orig 2009-07-22 01:11:12.000000000 +0300 -+++ linux-2.6.31-rc3-git5.mnb1/drivers/scsi/Kconfig 2009-07-22 21:54:04.000000000 +0300 -@@ -1062,6 +1062,42 @@ config SCSI_IZIP_SLOW_CTR - - Generally, saying N is fine. - -+config PPSCSI -+ tristate "Parallel Port SCSI adapters" -+ depends on SCSI && PARPORT -+ -+config PPSCSI_T348 -+ tristate "Adaptec APA-348 adapter" -+ depends on PPSCSI -+ -+config PPSCSI_T358 -+ tristate "Adaptec APA-358 adapter" -+ depends on PPSCSI -+ -+config PPSCSI_VPI0 -+ tristate "Iomega VPI0 adapter" -+ depends on PPSCSI -+ -+config PPSCSI_VPI2 -+ tristate "Iomega VPI2 adapter (EXPERIMENTAL)" -+ depends on PPSCSI && EXPERIMENTAL -+ -+config PPSCSI_ONSCSI -+ tristate "OnSpec 90c26 adapter" -+ depends on PPSCSI -+ -+config PPSCSI_SPARCSI -+ tristate "Shining SparSCI adapter" -+ depends on PPSCSI -+ -+config PPSCSI_EPSA2 -+ tristate "Shuttle EPSA-2 adapter" -+ depends on PPSCSI -+ -+config PPSCSI_EPST -+ tristate "Shuttle EPST adapter" -+ depends on PPSCSI -+ - config SCSI_NCR53C406A - tristate "NCR53c406a SCSI support" - depends on ISA && SCSI diff --git a/kernel/kernel/files/patches/mageia/scsi-ppscsi-3.0-buildfix.patch b/kernel/kernel/files/patches/mageia/scsi-ppscsi-3.0-buildfix.patch deleted file mode 100644 index c0be53e2..00000000 --- a/kernel/kernel/files/patches/mageia/scsi-ppscsi-3.0-buildfix.patch +++ /dev/null @@ -1,19 +0,0 @@ - -fix build with 3.0 - -Signed-off-by: Thomas Backlund - - drivers/scsi/ppscsi.c | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - ---- a/drivers/scsi/ppscsi.c.orig 2011-07-15 02:37:27.000000000 +0300 -+++ a/drivers/scsi/ppscsi.c 2011-07-15 13:44:29.514928985 +0300 -@@ -72,7 +72,7 @@ - #define PPSC_DEF_NICE 0 - #define PPSC_INITIATOR 7 - --spinlock_t ppsc_spinlock = SPIN_LOCK_UNLOCKED; -+DEFINE_SPINLOCK(ppsc_spinlock); - - static char ppsc_bulk_map[256]; - diff --git a/kernel/kernel/files/patches/mageia/scsi-ppscsi-mdvbz45393.patch b/kernel/kernel/files/patches/mageia/scsi-ppscsi-mdvbz45393.patch deleted file mode 100644 index 2e919ea6..00000000 --- a/kernel/kernel/files/patches/mageia/scsi-ppscsi-mdvbz45393.patch +++ /dev/null @@ -1,31 +0,0 @@ -Fix for https://qa.mandriva.com/show_bug.cgi?id=45393 - -cmnd field of struct scsi_cmnd changed after commit "[SCSI] Let -scsi_cmnd->cmnd use request->cmd buffer" -(64a87b244b9297667ca80264aab849a36f494884) - -Signed-off-by: Herton Ronaldo Krzesinski - ---- - drivers/scsi/ppscsi.c | 3 +-- - 1 file changed, 1 insertion(+), 2 deletions(-) - ---- a/drivers/scsi/ppscsi.c -+++ b/drivers/scsi/ppscsi.c -@@ -1009,7 +1009,6 @@ int ppsc_biosparam (struct scsi_device * - static int ppsc_inquire (PHA *pha, int target, char *buf) - { - char inq[6] = {0x12,0,0,0,36,0}; -- int i; - struct scsi_cmnd cmd; - struct scsi_device dev; - -@@ -1017,7 +1016,7 @@ static int ppsc_inquire (PHA *pha, int t - dev.id = target; - cmd.device = &dev; - cmd.cmd_len = 6; -- for (i=0;i<6;i++) cmd.cmnd[i] = inq[i]; -+ cmd.cmnd = inq; - cmd.sdb.table.nents = 0; - cmd.sdb.table.sgl = (void *) buf; - cmd.sdb.length = 36; diff --git a/kernel/kernel/files/patches/mageia/scsi-ppscsi-sg-helper-update.patch b/kernel/kernel/files/patches/mageia/scsi-ppscsi-sg-helper-update.patch deleted file mode 100644 index defdcefe..00000000 --- a/kernel/kernel/files/patches/mageia/scsi-ppscsi-sg-helper-update.patch +++ /dev/null @@ -1,36 +0,0 @@ -Update ppscsi for 2.6.24 changes. - -Signed-off-by: Herton Ronaldo Krzesinski - ---- - drivers/scsi/ppscsi.c | 5 +++-- - 1 file changed, 3 insertions(+), 2 deletions(-) - ---- a/drivers/scsi/ppscsi.c -+++ b/drivers/scsi/ppscsi.c -@@ -58,6 +58,7 @@ - #include - #include - #include -+#include - - #include - -@@ -484,7 +485,7 @@ static void ppsc_update_sg (PHA *pha) - if ((!pha->cur_len) && pha->sg_count) { - pha->sg_count--; - pha->sg_list++; -- pha->cur_buf = page_address(pha->sg_list->page) + pha->sg_list->offset; -+ pha->cur_buf = sg_virt(pha->sg_list); - pha->cur_len = pha->sg_list->length; - } - } -@@ -571,7 +572,7 @@ static void ppsc_engine (PHA *pha) - pha->sg_count--; - pha->sg_list = - (struct scatterlist *)pha->cur_cmd->request_buffer; -- pha->cur_buf = page_address(pha->sg_list->page) + pha->sg_list->offset; -+ pha->cur_buf = sg_virt(pha->sg_list); - pha->cur_len = pha->sg_list->length; - } else { - pha->cur_buf = pha->cur_cmd->request_buffer; diff --git a/kernel/kernel/files/patches/mageia/scsi-ppscsi-update-for-scsi_data_buffer.patch b/kernel/kernel/files/patches/mageia/scsi-ppscsi-update-for-scsi_data_buffer.patch deleted file mode 100644 index 496326e3..00000000 --- a/kernel/kernel/files/patches/mageia/scsi-ppscsi-update-for-scsi_data_buffer.patch +++ /dev/null @@ -1,88 +0,0 @@ -Update ppscsi for "[SCSI] implement scsi_data_buffer" change on Linux 2.6.25 -(commit 30b0c37b27485a9cb897bfe3824f6f517b8c80d6) - -Signed-off-by: Herton Ronaldo Krzesinski - ---- - drivers/scsi/ppscsi.c | 30 +++++++++++++++--------------- - 1 file changed, 15 insertions(+), 15 deletions(-) - ---- a/drivers/scsi/ppscsi.c -+++ b/drivers/scsi/ppscsi.c -@@ -424,16 +424,16 @@ static void ppsc_start (PHA *pha) - - bf &= (!((1<cur_cmd->device->id) & pha->slow_targets)); - -- r = pha->cur_cmd->use_sg; -+ r = scsi_sg_count(pha->cur_cmd); - if (r) { - b = 0; -- p = (struct scatterlist *)pha->cur_cmd->request_buffer; -+ p = scsi_sglist(pha->cur_cmd); - for (k=0;klength; - p++; - } - } else { -- b = pha->cur_cmd->request_bufflen; -+ b = scsi_bufflen(pha->cur_cmd); - } - - bf &= (b > 127); -@@ -567,16 +567,16 @@ static void ppsc_engine (PHA *pha) - pha->data_dir = phase & PPSC_IO; - pha->data_count = 0; - -- pha->sg_count = pha->cur_cmd->use_sg; -+ pha->sg_count = scsi_sg_count(pha->cur_cmd); - if (pha->sg_count) { - pha->sg_count--; -- pha->sg_list = -- (struct scatterlist *)pha->cur_cmd->request_buffer; -+ pha->sg_list = scsi_sglist(pha->cur_cmd); - pha->cur_buf = sg_virt(pha->sg_list); - pha->cur_len = pha->sg_list->length; - } else { -- pha->cur_buf = pha->cur_cmd->request_buffer; -- pha->cur_len = pha->cur_cmd->request_bufflen; -+ pha->cur_buf = -+ (char *)pha->cur_cmd->sdb.table.sgl; -+ pha->cur_len = scsi_bufflen(pha->cur_cmd); - } - - pha->last_phase = phase; -@@ -622,7 +622,7 @@ static void ppsc_engine (PHA *pha) - - if (pha->cur_cmd->cmnd[0] == REQUEST_SENSE) { - -- sb = (char *)pha->cur_cmd->request_buffer; -+ sb = (char *)pha->cur_cmd->sdb.table.sgl; - printk("%s: Sense key: %x ASC: %x ASCQ: %x\n", - pha->device, sb[2] & 0xff, - sb[12] & 0xff, sb[13] & 0xff); -@@ -819,9 +819,9 @@ static void ppsc_cleanup (PHA *pha) - cmd->cmnd[4] = sizeof(cmd->sense_buffer); - cmd->cmnd[5] = 0; - cmd->cmd_len = 6; -- cmd->use_sg = 0; -- cmd->request_buffer = (char *) cmd->sense_buffer; -- cmd->request_bufflen = sizeof(cmd->sense_buffer); -+ cmd->sdb.table.nents = 0; -+ cmd->sdb.table.sgl = (void *) cmd->sense_buffer; -+ cmd->sdb.length = sizeof(cmd->sense_buffer); - - pha->cur_cmd = cmd; - ppsc_do_claimed(pha,ppsc_start); -@@ -1018,9 +1018,9 @@ static int ppsc_inquire (PHA *pha, int t - cmd.device = &dev; - cmd.cmd_len = 6; - for (i=0;i<6;i++) cmd.cmnd[i] = inq[i]; -- cmd.use_sg = 0; -- cmd.request_buffer = buf; -- cmd.request_bufflen = 36; -+ cmd.sdb.table.nents = 0; -+ cmd.sdb.table.sgl = (void *) buf; -+ cmd.sdb.length = 36; - - return ppsc_command(&cmd); - } diff --git a/kernel/kernel/files/patches/mageia/scsi-ppscsi_fixes.patch b/kernel/kernel/files/patches/mageia/scsi-ppscsi_fixes.patch deleted file mode 100644 index acc011e9..00000000 --- a/kernel/kernel/files/patches/mageia/scsi-ppscsi_fixes.patch +++ /dev/null @@ -1,226 +0,0 @@ ---- - drivers/scsi/Makefile | 2 +- - drivers/scsi/ppscsi.c | 22 ++++++++++++---------- - drivers/scsi/ppscsi.h | 34 ++++++++++++++++++---------------- - drivers/scsi/sparcsi.c | 6 +++--- - 4 files changed, 34 insertions(+), 30 deletions(-) - ---- a/drivers/scsi/ppscsi.c -+++ b/drivers/scsi/ppscsi.c -@@ -57,6 +57,7 @@ - #include - #include - #include -+#include - - #include - -@@ -95,7 +96,8 @@ static void ppsc_attach (struct parport - return; - } - -- add->port = parport_get_port (port); -+ atomic_inc(&port->ref_count); -+ add->port = port; - add->next = ppsc_port_list; - wmb (); - ppsc_port_list = add; -@@ -187,11 +189,11 @@ static void ppsc_set_intr (PHA *pha, voi - spin_unlock_irqrestore(&ppsc_spinlock,flags); - } - --static void ppsc_tq_int (void *data) -+static void ppsc_tq_int (struct work_struct *work) - { - void (*con)(PHA *); - unsigned long flags; -- PHA *pha = (PHA *)data; -+ PHA *pha = container_of(work, PHA, wq); - - spin_lock_irqsave(&ppsc_spinlock,flags); - -@@ -377,7 +379,7 @@ int ppsc_command (struct scsi_cmnd *cmd) - - ppsc_do_claimed(pha,ppsc_start); - -- while (pha->cur_cmd) scsi_sleep(1); -+ while (pha->cur_cmd) ssleep(1); - - return cmd->result; - } -@@ -886,7 +888,7 @@ static void ppsc_reset_pha (PHA *pha) - ppsc_claim(pha); - pha->proto->connect(pha); - pha->proto->reset_bus(pha); -- scsi_sleep(4*HZ); -+ ssleep(4*HZ); - pha->proto->disconnect(pha); - ppsc_unclaim(pha); - -@@ -905,7 +907,7 @@ int ppsc_reset (struct scsi_cmnd * cmd) - pha->abort_flag = PPSC_DO_RESET; - - while (pha->cur_cmd && (k < PPSC_RESET_TMO)) { -- scsi_sleep(HZ/10); -+ ssleep(HZ/10); - k += HZ/10; - } - -@@ -992,11 +994,11 @@ int ppsc_biosparam (struct scsi_device * - { - ip[0] = 0x40; - ip[1] = 0x20; -- ip[2] = (capacity +1) / (ip[0] * ip[1]); -+ ip[2] = (unsigned int)(capacity +1) >> 11; - if (ip[2] > 1024) { - ip[0] = 0xff; - ip[1] = 0x3f; -- ip[2] = (capacity +1) / (ip[0] * ip[1]); -+ ip[2] = (unsigned int)(capacity +1) / (0xff * 0x3f); - if (ip[2] > 1023) - ip[2] = 1023; - } -@@ -1084,7 +1086,7 @@ int ppsc_release_pha (PHA *pha) - } - - --int ppsc_detect (PSP *proto, Scsi_Host_Template *tpnt, int verbose) -+int ppsc_detect (PSP *proto, struct scsi_host_template *tpnt, int verbose) - { - int i, m, p, d, n, s, z; - struct ppsc_port_list_struct *next_port = NULL; /* shut gcc up */ -@@ -1146,7 +1148,7 @@ int ppsc_detect (PSP *proto, Scsi_Host_T - pha->device[p+1] = '0' + i; - pha->device[p+2] = 0; - -- INIT_WORK(&pha->wq, ppsc_tq_int, pha); -+ INIT_WORK(&pha->wq, ppsc_tq_int); - - init_timer (&pha->timer); - pha->timer.data = (unsigned long) pha; ---- a/drivers/scsi/sparcsi.c -+++ b/drivers/scsi/sparcsi.c -@@ -165,7 +165,7 @@ static int sparcsi_test_proto (PHA *pha) - - WR(1,0x80); udelay(60); - WR(1,0); -- scsi_sleep(5*HZ); -+ ssleep(5*HZ); - pha->private[0] = 1; - } - -@@ -363,14 +363,14 @@ static struct ppsc_protocol sparcsi_psp - sparcsi_reset_bus - }; - --int sparcsi_detect (Scsi_Host_Template *tpnt) -+int sparcsi_detect (struct scsi_host_template *tpnt) - { - return ppsc_detect( &sparcsi_psp, tpnt, verbose); - } - - #ifdef MODULE - --Scsi_Host_Template driver_template = PPSC_TEMPLATE(sparcsi); -+struct scsi_host_template driver_template = PPSC_TEMPLATE(sparcsi); - - #include "scsi_module.c" - ---- a/drivers/scsi/ppscsi.h -+++ b/drivers/scsi/ppscsi.h -@@ -13,14 +13,16 @@ - #define PPSC_H_VERSION "0.92" - - #include --#include -+#include - #include - #include - #include - #include - --#include "scsi.h" --#include "hosts.h" -+#include -+#include -+#include -+#include - - - /* ppscsi global functions */ -@@ -40,31 +42,31 @@ extern int ppsc_release(struct Scsi_Host - /* imports for hosts.c */ - - #ifdef CONFIG_PPSCSI_T348 --extern int t348_detect( Scsi_Host_Template *); -+extern int t348_detect( struct scsi_host_template *); - #endif - - #ifdef CONFIG_PPSCSI_T358 --extern int t358_detect( Scsi_Host_Template *); -+extern int t358_detect( struct scsi_host_template *); - #endif - - #ifdef CONFIG_PPSCSI_ONSCSI --extern int onscsi_detect( Scsi_Host_Template *); -+extern int onscsi_detect( struct scsi_host_template *); - #endif - - #ifdef CONFIG_PPSCSI_EPST --extern int epst_detect( Scsi_Host_Template *); -+extern int epst_detect( struct scsi_host_template *); - #endif - - #ifdef CONFIG_PPSCSI_EPSA2 --extern int epsa2_detect( Scsi_Host_Template *); -+extern int epsa2_detect( struct scsi_host_template *); - #endif - - #ifdef CONFIG_PPSCSI_VPI0 --extern int vpi0_detect( Scsi_Host_Template *); -+extern int vpi0_detect( struct scsi_host_template *); - #endif - - #ifdef CONFIG_PPSCSI_SPARCSI --extern int sparcsi_detect( Scsi_Host_Template *); -+extern int sparcsi_detect( struct scsi_host_template *); - #endif - - #endif -@@ -303,7 +305,7 @@ struct ppsc_protocol { - - typedef struct ppsc_protocol PSP; - --extern int ppsc_detect( PSP *, Scsi_Host_Template *, int); -+extern int ppsc_detect( PSP *, struct scsi_host_template *, int); - - #ifdef PPSC_HA_MODULE - -@@ -322,11 +324,11 @@ static STT stt[4] = { {"host0",8,host0}, - {"host3",8,host3} }; - #endif - --MODULE_PARM(host0,"1-8i"); --MODULE_PARM(host1,"1-8i"); --MODULE_PARM(host2,"1-8i"); --MODULE_PARM(host3,"1-8i"); --MODULE_PARM(verbose,"i"); -+module_param_array(host0, int, NULL, 0); -+module_param_array(host1, int, NULL, 0); -+module_param_array(host2, int, NULL, 0); -+module_param_array(host3, int, NULL, 0); -+module_param(verbose, int, 0); - - static struct ppsc_host_adapter host_structs[4]; - ---- a/drivers/scsi/Makefile -+++ b/drivers/scsi/Makefile -@@ -136,7 +136,7 @@ obj-$(CONFIG_PPSCSI_ONSCSI) += onscsi.o - obj-$(CONFIG_PPSCSI_EPSA2) += epsa2.o - obj-$(CONFIG_PPSCSI_EPST) += epst.o - obj-$(CONFIG_PPSCSI_VPI0) += vpi0.o --obj-$(CONFIG_PPSCSI_VPI2) += vpi2.o -+obj-n += vpi2.o - obj-$(CONFIG_PPSCSI_SPARCSI) += sparcsi.o - - obj-$(CONFIG_CHR_DEV_ST) += st.o diff --git a/kernel/kernel/files/patches/mageia/scsi-qla2xxx-Fix-NULL-pointer-crash-due-to-active-timer-for-ABTS.patch b/kernel/kernel/files/patches/mageia/scsi-qla2xxx-Fix-NULL-pointer-crash-due-to-active-timer-for-ABTS.patch deleted file mode 100644 index 07d56db5..00000000 --- a/kernel/kernel/files/patches/mageia/scsi-qla2xxx-Fix-NULL-pointer-crash-due-to-active-timer-for-ABTS.patch +++ /dev/null @@ -1,119 +0,0 @@ -From 1514839b366417934e2f1328edb50ed1e8a719f5 Mon Sep 17 00:00:00 2001 -From: "himanshu.madhani@cavium.com" -Date: Mon, 12 Feb 2018 10:28:14 -0800 -Subject: scsi: qla2xxx: Fix NULL pointer crash due to active timer for ABTS - -This patch fixes NULL pointer crash due to active timer running for abort -IOCB. - -From crash dump analysis it was discoverd that get_next_timer_interrupt() -encountered a corrupted entry on the timer list. - - #9 [ffff95e1f6f0fd40] page_fault at ffffffff914fe8f8 - [exception RIP: get_next_timer_interrupt+440] - RIP: ffffffff90ea3088 RSP: ffff95e1f6f0fdf0 RFLAGS: 00010013 - RAX: ffff95e1f6451028 RBX: 000218e2389e5f40 RCX: 00000001232ad600 - RDX: 0000000000000001 RSI: ffff95e1f6f0fdf0 RDI: 0000000001232ad6 - RBP: ffff95e1f6f0fe40 R8: ffff95e1f6451188 R9: 0000000000000001 - R10: 0000000000000016 R11: 0000000000000016 R12: 00000001232ad5f6 - R13: ffff95e1f6450000 R14: ffff95e1f6f0fdf8 R15: ffff95e1f6f0fe10 - ORIG_RAX: ffffffffffffffff CS: 0010 SS: 0018 - -Looking at the assembly of get_next_timer_interrupt(), address came -from %r8 (ffff95e1f6451188) which is pointing to list_head with single -entry at ffff95e5ff621178. - - 0xffffffff90ea307a : mov (%r8),%rdx - 0xffffffff90ea307d : cmp %r8,%rdx - 0xffffffff90ea3080 : je 0xffffffff90ea30a7 - 0xffffffff90ea3082 : nopw 0x0(%rax,%rax,1) - 0xffffffff90ea3088 : testb $0x1,0x18(%rdx) - - crash> rd ffff95e1f6451188 10 - ffff95e1f6451188: ffff95e5ff621178 ffff95e5ff621178 x.b.....x.b..... - ffff95e1f6451198: ffff95e1f6451198 ffff95e1f6451198 ..E.......E..... - ffff95e1f64511a8: ffff95e1f64511a8 ffff95e1f64511a8 ..E.......E..... - ffff95e1f64511b8: ffff95e77cf509a0 ffff95e77cf509a0 ...|.......|.... - ffff95e1f64511c8: ffff95e1f64511c8 ffff95e1f64511c8 ..E.......E..... - - crash> rd ffff95e5ff621178 10 - ffff95e5ff621178: 0000000000000001 ffff95e15936aa00 ..........6Y.... - ffff95e5ff621188: 0000000000000000 00000000ffffffff ................ - ffff95e5ff621198: 00000000000000a0 0000000000000010 ................ - ffff95e5ff6211a8: ffff95e5ff621198 000000000000000c ..b............. - ffff95e5ff6211b8: 00000f5800000000 ffff95e751f8d720 ....X... ..Q.... - - ffff95e5ff621178 belongs to freed mempool object at ffff95e5ff621080. - - CACHE NAME OBJSIZE ALLOCATED TOTAL SLABS SSIZE - ffff95dc7fd74d00 mnt_cache 384 19785 24948 594 16k - SLAB MEMORY NODE TOTAL ALLOCATED FREE - ffffdc5dabfd8800 ffff95e5ff620000 1 42 29 13 - FREE / [ALLOCATED] - ffff95e5ff621080 (cpu 6 cache) - -Examining the contents of that memory reveals a pointer to a constant string -in the driver, "abort\0", which is set by qla24xx_async_abort_cmd(). - - crash> rd ffffffffc059277c 20 - ffffffffc059277c: 6e490074726f6261 0074707572726574 abort.Interrupt. - ffffffffc059278c: 00676e696c6c6f50 6920726576697244 Polling.Driver i - ffffffffc059279c: 646f6d207325206e 6974736554000a65 n %s mode..Testi - ffffffffc05927ac: 636976656420676e 786c252074612065 ng device at %lx - ffffffffc05927bc: 6b63656843000a2e 646f727020676e69 ...Checking prod - ffffffffc05927cc: 6f20444920746375 0a2e706968632066 uct ID of chip.. - ffffffffc05927dc: 5120646e756f4600 204130303232414c .Found QLA2200A - ffffffffc05927ec: 43000a2e70696843 20676e696b636568 Chip...Checking - ffffffffc05927fc: 65786f626c69616d 6c636e69000a2e73 mailboxes...incl - ffffffffc059280c: 756e696c2f656475 616d2d616d642f78 ude/linux/dma-ma - - crash> struct -ox srb_iocb - struct srb_iocb { - union { - struct {...} logio; - struct {...} els_logo; - struct {...} tmf; - struct {...} fxiocb; - struct {...} abt; - struct ct_arg ctarg; - struct {...} mbx; - struct {...} nack; - [0x0 ] } u; - [0xb8] struct timer_list timer; - [0x108] void (*timeout)(void *); - } - SIZE: 0x110 - - crash> ! bc - ibase=16 - obase=10 - B8+40 - F8 - -The object is a srb_t, and at offset 0xf8 within that structure -(i.e. ffff95e5ff621080 + f8 -> ffff95e5ff621178) is a struct timer_list. - -Cc: #4.4+ -Fixes: 4440e46d5db7 ("[SCSI] qla2xxx: Add IOCB Abort command asynchronous handling.") -Signed-off-by: Himanshu Madhani -Reviewed-by: Johannes Thumshirn -Signed-off-by: Martin K. Petersen ---- - drivers/scsi/qla2xxx/qla_init.c | 1 + - 1 file changed, 1 insertion(+) - -diff --git a/drivers/scsi/qla2xxx/qla_init.c b/drivers/scsi/qla2xxx/qla_init.c -index 2dea112..0487062 100644 ---- a/drivers/scsi/qla2xxx/qla_init.c -+++ b/drivers/scsi/qla2xxx/qla_init.c -@@ -1527,6 +1527,7 @@ qla24xx_abort_sp_done(void *ptr, int res) - srb_t *sp = ptr; - struct srb_iocb *abt = &sp->u.iocb_cmd; - -+ del_timer(&sp->u.iocb_cmd.timer); - complete(&abt->u.abt.comp); - } - --- -cgit v1.1 - diff --git a/kernel/kernel/files/patches/mageia/series b/kernel/kernel/files/patches/mageia/series deleted file mode 100644 index eaf1d51c..00000000 --- a/kernel/kernel/files/patches/mageia/series +++ /dev/null @@ -1,494 +0,0 @@ -# -# Mageia kernel series file -# -# This file describes the order in which patches should be applied -# in the kernel and why the patch is needed. -# -# Luiz Fernando N. Capitulino -# - -### -### Upstream git -### - -### -### Stable Queue -### -patch-4.14.25-rc1.patch - -### -### Arch x86 -### - -# laptop needing pci=assign-busses (#18989, needs to be submitted upstream) -x86-pci-toshiba-equium-a60-assign-busses.patch - -# If users choose a bad video mode, allow to jump to -# a working one (TTL: forever) -x86-boot-video-80x25-if-break.patch - -# Allow poweroff on UP machines running SMP kernels -x86-default_poweroff_up_machines.patch - -# Fix #38760, need to be revised and submitted upstream -# BROKEN: x86-cpufreq-speedstep-dothan-3.patch - -# raise vmalloc to fix https://bugs.mageia.org/show_bug.cgi?id=904 -x86-increase-default-minimum-vmalloc-area-by-64MB-to-192MB.patch - -# slows down boot -Revert-cpufreq-pcc-Enable-autoload-of-pcc-cpufreq-fo.patch - -# Meltdown 32bit -pti32bit-0001-x86-asm-offsets-Move-TSS_sp0-and-TSS_sp1-to-asm-offs.patch -pti32bit-0002-x86-entry-32-Rename-TSS_sysenter_sp0-to-TSS_entry_st.patch -pti32bit-0003-x86-entry-32-Load-task-stack-from-x86_tss.sp1-in-SYS.patch -pti32bit-0004-x86-entry-32-Put-ESPFIX-code-into-a-macro.patch -pti32bit-0005-x86-entry-32-Unshare-NMI-return-path.patch -pti32bit-0006-x86-entry-32-Split-off-return-to-kernel-path.patch -# could be disabled as not needed according to Linus @ LKML -pti32bit-0007-x86-entry-32-Restore-segments-before-int-registers.patch -pti32bit-0008-x86-entry-32-Enter-the-kernel-via-trampoline-stack.patch -pti32bit-0009-x86-entry-32-Leave-the-kernel-via-trampoline-stack.patch -pti32bit-0010-x86-entry-32-Introduce-SAVE_ALL_NMI-and-RESTORE_ALL_.patch -pti32bit-0011-x86-entry-32-Handle-Entry-from-Kernel-Mode-on-Entry-.patch -pti32bit-0012-x86-entry-32-Simplify-debug-entry-point.patch -pti32bit-0013-x86-entry-32-Add-PTI-cr3-switches-to-NMI-handler-cod.patch -pti32bit-0014-x86-entry-32-Add-PTI-cr3-switch-to-non-NMI-entry-exi.patch -pti32bit-0015-x86-pgtable-Rename-pti_set_user_pgd-to-pti_set_user_.patch -pti32bit-0016-x86-pgtable-pae-Unshare-kernel-PMDs-when-PTI-is-enab.patch -pti32bit-0017-x86-pgtable-32-Allocate-8k-page-tables-when-PTI-is-e.patch -pti32bit-0018-x86-pgtable-Move-pgdp-kernel-user-conversion-functio.patch -pti32bit-0019-x86-pgtable-Move-pti_set_user_pgtbl-to-pgtable.h.patch -pti32bit-0020-x86-pgtable-Move-two-more-functions-from-pgtable_64..patch -pti32bit-0021-x86-mm-pae-Populate-valid-user-PGD-entries.patch -pti32bit-0022-x86-mm-pae-Populate-the-user-page-table-with-user-pg.patch -pti32bit-0023-x86-mm-legacy-Populate-the-user-page-table-with-user.patch -pti32bit-0024-x86-mm-pti-Add-an-overflow-check-to-pti_clone_pmds.patch -pti32bit-0025-x86-mm-pti-Define-X86_CR3_PTI_PCID_USER_BIT-on-x86_3.patch -pti32bit-0026-x86-mm-pti-Clone-CPU_ENTRY_AREA-on-PMD-level-on-x86_.patch -pti32bit-0027-x86-mm-dump_pagetables-Define-INIT_PGD.patch -pti32bit-0028-x86-pgtable-pae-Use-separate-kernel-PMDs-for-user-pa.patch -pti32bit-0029-x86-ldt-Reserve-address-space-range-on-32-bit-for-th.patch -pti32bit-0030-x86-ldt-Define-LDT_END_ADDR.patch -pti32bit-0031-x86-ldt-Split-out-sanity-check-in-map_ldt_struct.patch -pti32bit-0032-x86-ldt-Enable-LDT-user-mapping-for-PAE.patch -pti32bit-0033-x86-pti-Allow-CONFIG_PAGE_TABLE_ISOLATION-for-x86_32.patch -pti32bit-0034-x86-mm-pti-Add-Warning-when-booting-on-a-PCID-capabl.patch -# tone down warning about PCID on 32bit -pti32bit-0100-tone-down-PCID-on-32bit-message.patch - -# selected fixes from x86/pti -x86-pti-0070-nospec-Kill-array_index_nospec_mask_check.patch -x86-pti-0072-nospec-Include-asm-barrier.h-dependency.patch -x86-pti-0073-x86-microcode-Propagate-return-value-from-updating-f.patch -x86-pti-0074-x86-CPU-Add-a-microcode-loader-callback.patch -x86-pti-0075-x86-CPU-Check-CPU-feature-bits-after-microcode-upgra.patch -x86-pti-0076-x86-entry-Reduce-the-code-footprint-of-the-idtentry-.patch -x86-pti-0077-x86-entry-64-Use-xorl-for-faster-register-clearing.patch - -### -### Core -### - -# Improved NUMA scheduling on AMD EPYC -sched-topology-Introduce-NUMA-identity-node-sched-domain.patch - -### -### i2c -### - -### -### PCI core -### - -# BROKEN: pci-pciprobe-CardBusNo.patch - -# http://lkml.org/lkml/2008/9/12/52 -pci-add-ALI-M5229-ide-compatibility-mode-quirk.patch -pci-quirks-drop-devinit-exit.patch - -### -### PNP core -### - -### -### ACPI -### - -# CLEVO M360S acpi irq workaround -acpi-CLEVO-M360S-disable_acpi_irq.patch - -# Clevo M720SR freezes with C3 -acpi-processor-M720SR-limit-to-C2.patch - -# backlight fixes -ACPI-video-Add-a-quirk-to-force-acpi-video-backlight.patch - -# fixes resume on atleast Thinkpad X240 -acpi-ec-restore-polling-during-noirq-suspend_resume-phases.patch - -### -### Block -### - -# epsa2 SCSI driver, don't know from where it came -scsi-ppscsi-2.6.2.patch - -# epsa2 is far behind -scsi-ppscsi_fixes.patch - -# Fix build of ppscsi on 2.6.24 -scsi-ppscsi-sg-helper-update.patch - -# Update/fix for ppscsi on 2.6.25 -scsi-ppscsi-update-for-scsi_data_buffer.patch - -# https://qa.mandriva.com/show_bug.cgi?id=45393 -scsi-ppscsi-mdvbz45393.patch - -# epsa2 3.0 buildfix -scsi-ppscsi-3.0-buildfix.patch - -# Don't know know why this is needed -scsi-megaraid-new-sysfs-name.patch - -# Looks like fixes from Arnaud, not sure why they're needed -ide-pci-sis5513-965.patch - -mpt-vmware-fix.patch - -# adds aliases to support upgrade from old dm-raid45 patch -dm-raid-aliases.patch - -# disable floppy autoloading (mga #4696) -block-floppy-disable-pnp-modalias.patch - -# prefer ata over ide drivers -ata-prefer-ata-drivers-over-ide-drivers-when-both-are-built.patch - -# bfq performance updates -doc-block-bfq-update-max-IOPS-sustainable-with-BFQ.patch -block-bfq-fix-wrong-init-of-saved-start-time-for-wei.patch -block-bfq-check-and-switch-back-to-interactive-wr-al.patch -block-bfq-let-early-merged-queues-be-weight-raised-o.patch -block-bfq-decrease-burst-size-when-queues-in-burst-e.patch -block-bfq-fix-unbalanced-decrements-of-burst-size.patch -block-bfq-add-missing-invocations-of-bfqg_stats_upda.patch -block-bfq-update-blkio-stats-outside-the-scheduler-l.patch -block-bfq-move-debug-blkio-stats-behind-CONFIG_DEBUG.patch -block-bfq-increase-threshold-to-deem-I-O-as-random.patch -block-bfq-add-missing-rq_pos_tree-update-on-rq-remov.patch -block-bfq-check-low_latency-flag-in-bfq_bfqq_save_st.patch -block-bfq-let-a-queue-be-merged-only-shortly-after-s.patch -block-bfq-remove-superfluous-check-in-queue-merging-.patch -block-bfq-consider-also-past-I-O-in-soft-real-time-d.patch -block-bfq-remove-batches-of-confusing-ifdefs.patch -block-bfq-release-oom-queue-ref-to-root-group-on-exi.patch -block-bfq-iosched-don-t-call-bfqg_and_blkg_put-for-CONFIG_.patch -block-bfq-fix-occurrences-of-request-finish-method-s.patch -block-bfq-limit-tags-for-writes-and-async-I-O.patch -block-bfq-limit-sectors-served-with-interactive-weig.patch -block-bfq-put-async-queues-for-root-bfq-groups-too.patch -block-bfq-add-requeue-request-hook.patch - -# HPT RR 644L -ata-ahci-Add-PCI-id-for-the-Highpoint-Rocketraid-644L-card.patch -PCI-Add-function-1-DMA-alias-quirk-for-Highpoint-RocketRAID-644L.patch - -# scsi -scsi-core-Avoid-that-ATA-error-handling-can-trigger-a-kernel-hang-or-oops.patch -scsi-core-return-BLK_STS_OK-for-DID_OK-in-__scsi_error_from_host_byte.patch -scsi-qla2xxx-Fix-NULL-pointer-crash-due-to-active-timer-for-ABTS.patch - -### -### Char -### - -### -### Crypto -### - -### -### File-system -### - -# aufs from: http://aufs.sourceforge.net/ (mga#8314) -fs-aufs-4.14.patch -fs-aufs-4.14-modular.patch -fs-aufs-include-vmalloc.patch - -### -### FireWire -### - -# adding module aliases to ease upgrade from ieee1394 -firewire-ieee1394-module-aliases.patch - -### -### GPU/DRM -### - -# new Q57 Host Bridge id -char-agp-intel-new-Q57-id.patch - -# External mach64 drm support from git://anongit.freedesktop.org/git/mesa/drm -gpu-drm-mach64.patch -gpu-drm-mach64-fixes.patch -gpu-drm-mach64-2.6.31.patch -gpu-drm-mach64-fix-for-changed-drm_pci_alloc.patch -gpu-drm-mach64-fix-for-changed-drm_ioctl.patch -gpu-drm-mach64-2.6.36-buildfix.patch -gpu-drm-mach64-2.6.37-buildfix.patch -gpu-drm-mach64-3.0-buildfix.patch -gpu-drm-mach64-include-module.h.patch -gpu-drm-mach64-3.3-buildfix.patch -gpu-drm-mach64-3.6-buildfix.patch -gpu-drm-mach64-3.7-buildfix.patch -gpu-drm-mach64-3.12-buildfix.patch -gpu-drm-mach64-restore-mach64_PCI_IDS.patch -gpu-drm-mach64-linux-3.14-buildfix.patch -gpu-drm-mach64-3.17-buildfix.patch -gpu-drm-mach64-3.18-buildfix.patch - -### -### Hardware Monitoring -### - -# Ryzen support -hwmon-k10temp-Move-chip-specific-code-into-probe-function.patch -hwmon-k10temp-Add-support-for-family-17h.patch -hwmon-k10temp-Add-support-for-temperature-offsets.patch - -### -### Input -### - -input-i8042-quirks-for-Fujitsu-Lifebook-A544-and-Lif.patch - -# mga #22703 -input-goodix-disable-IRQs-while-suspended.patch -input-goodix-add-support-for-GDIX1002.patch - -### -### idle -### - -### -### Kbuild -### - -### -### Media -### - -### -### MFD -### - -### -### Misc -### - -### -### MM -### - -mm-page_vma_mapped-Introduce-pfn_in_hpage.patch - -### -### Network -### - -# SiS 190 fixes -net-sis190-fix-list-usage.patch - -# netfilter IFWLOG support -net-netfilter-IFWLOG.patch -net-netfilter-IFWLOG-mdv.patch -net-netfilter-IFWLOG-2.6.35-buildfix.patch -net-netfilter-IFWLOG-2.6.37-buildfix.patch -net-ipv4-netfilter-ipt_IFWLOG-3.6-buildfix.patch -net-netfilter-IFWLOG-3.7-buildfix.patch -net-netfilter-IFWLOG-remove-unused-label.patch -net-netfilter-ipt_IFWLOG-4.12-buildfix.patch - -# netfilter psd support -net-netfilter-psd.patch -net-netfilter-psd-mdv.patch -net-netfilter-psd-2.6.35-buildfix.patch -net-netfilter-psd-fix-redefines.patch - -# WireGuard VPN -net-WireGuard.patch - -# net fixes -net-tls-Correct-length-of-scatterlist-in-tls_sw_sendpage.patch - -# silence message that gets reported as a bug -net-netfilter-xt_addrtype-silence-BROADCAST-message.patch - -# CVE-2018-1065 -net-netfilter-add-back-stackpointer-size-checks.patch - -### -### pinctrl -### - -### -### Platform drivers -### - -# Allow access to Shuttle WMI interface controls -# (Mainly allow turning on/off webcam and wireless on Shuttle DA18IE and DA18IM) -platform-x86-add-shuttle-wmi-driver.patch -platform-x86-shuttle-wmi-drop-devinit-exit.patch -platform-x86-shuttle-wmi-4.2-buildfix.patch -platform-x86-shuttle-wmi-4.13-buildfix.patch - -# ideapad-laptop -platform-x86-ideapad-Add-IdeaPad-320-15IKB-to-no_hw_rfkill_list.patch -platform-x86-ideapad-laptop-Increase-timeout-to-wait-for-ec-answer.patch - -### -### RTC -### - -### -### Serial -### - -### -### Sound -### - -sound-ALSA-hda-Fix-a-wrong-FIXUP-for-alc289-on-Dell-machines.patch - -# skl/kbl fixes -sound-ASoC-Intel-Skylake-Fix-jack-name-format-substitution.patch -sound-ASoC-Intel-kbl-fix-jack-name.patch - -### -### Staging -### - - -### -### TTY -### - -### -### -### - -### -### USB -### - -hid-usbhid-IBM-BladeCenterHS20-quirk.patch - -usb-storage-unusual_devs-add-id.patch -usb-storage-unusual_devs-add-id-2.6.37-buildfix.patch - -### -### V4L -### - -# pwc driver name in /proc/bus/devices, /sys fix and "advertisement" removal -media-usb-pwc-lie-in-proc-usb-devices.patch - -### -### Watchdog -### - -### -### Video -### - -# Mageia framebuffer boot logo -video-mageia-logo.patch - -### -### Virtualization -### - -### -### 3rdparty -### - -3rd-3rdparty-1.0-tree.patch - -# TODO: fix up patch below to include all archs? -3rd-3rdparty-merge.patch - -# acerhk -3rd-acerhk-0.5.35.patch -3rd-acerhk-kbuild.patch -3rd-acerhk-extra-cflags.patch -3rd-acerhk-proc_dir_entry-owner.patch -3rd-acerhk-fix-build-with-function-tracer.patch -3rd-acerhk-2.6.36-buildfix.patch -3rd-acerhk-fix-include.patch - -# aes2501 -3rd-aes2501-r19.patch -3rd-aes2501-kbuild.patch -3rd-aes2501-rmmod-oops-fix.patch - -# ndiswrapper -3rd-ndiswrapper-1.61.patch -3rd-ndiswrapper-Kconfig.patch -3rd-ndiswrapper-Makefile-build-fix.patch -3rd-ndiswrapper-4.10-buildfix.patch -3rd-ndiswrapper-4.13-buildfix.patch - -# rfswitch -3rd-rfswitch-1.3.patch -3rd-rfswitch-build-fix.patch -3rd-rfswitch-3.0-buildfix.patch - -# viahss -3rd-viahss-0.92.patch -3rd-viahss-config.patch -3rd-viahss-module-license.patch -3rd-viahss-2.6.35-buildfix.patch -3rd-viahss-3.0-buildfix.patch - -# add rtl8812 support (mga#21043) -3rd-rtl8812au.patch - -# add rtl8723de support (mga#22559) -3rd-rtl8723de.patch - -### -### Security -### - -### -### Smack fixes -### - -### -### XEN -### - -### -### ARM -### - -arch-ARM-omap2-hide-omap3_save_secure_ram-on-non-OMAP3-bu.patch - -### -### IA64 -### - -### -### Tools -### - -# wipe powerpc refrence so we can nuke dangling symlinks (mga#17676) -tools-testing-selftest-Makefile-remove-powerpc-reference.patch - -### -### UAPI -### diff --git a/kernel/kernel/files/patches/mageia/sound-ALSA-hda-Fix-a-wrong-FIXUP-for-alc289-on-Dell-machines.patch b/kernel/kernel/files/patches/mageia/sound-ALSA-hda-Fix-a-wrong-FIXUP-for-alc289-on-Dell-machines.patch deleted file mode 100644 index 449e697a..00000000 --- a/kernel/kernel/files/patches/mageia/sound-ALSA-hda-Fix-a-wrong-FIXUP-for-alc289-on-Dell-machines.patch +++ /dev/null @@ -1,35 +0,0 @@ -From: Hui Wang -Subject: [PATCH] ALSA: hda - Fix a wrong FIXUP for alc289 on Dell machines -Date: Fri, 2 Mar 2018 13:05:36 +0800 - -With the alc289, the Pin 0x1b is Headphone-Mic, so we should assign -ALC269_FIXUP_DELL4_MIC_NO_PRESENCE rather than -ALC225_FIXUP_DELL1_MIC_NO_PRESENCE to it. And this change is suggested -by Kailang of Realtek and is verified on the machine. - -(This fixes the commit 3f2f7c55) - -Cc: Kailang Yang -Cc: -Signed-off-by: Hui Wang ---- - sound/pci/hda/patch_realtek.c | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - -diff --git a/sound/pci/hda/patch_realtek.c b/sound/pci/hda/patch_realtek.c -index b9c93fa..7a9a867 100644 ---- a/sound/pci/hda/patch_realtek.c -+++ b/sound/pci/hda/patch_realtek.c -@@ -6872,7 +6872,7 @@ static const struct snd_hda_pin_quirk alc269_pin_fixup_tbl[] = { - {0x12, 0x90a60120}, - {0x14, 0x90170110}, - {0x21, 0x0321101f}), -- SND_HDA_PIN_QUIRK(0x10ec0289, 0x1028, "Dell", ALC225_FIXUP_DELL1_MIC_NO_PRESENCE, -+ SND_HDA_PIN_QUIRK(0x10ec0289, 0x1028, "Dell", ALC269_FIXUP_DELL4_MIC_NO_PRESENCE, - {0x12, 0xb7a60130}, - {0x14, 0x90170110}, - {0x21, 0x04211020}), --- -2.7.4 - - diff --git a/kernel/kernel/files/patches/mageia/sound-ASoC-Intel-Skylake-Fix-jack-name-format-substitution.patch b/kernel/kernel/files/patches/mageia/sound-ASoC-Intel-Skylake-Fix-jack-name-format-substitution.patch deleted file mode 100644 index b3fd6ec2..00000000 --- a/kernel/kernel/files/patches/mageia/sound-ASoC-Intel-Skylake-Fix-jack-name-format-substitution.patch +++ /dev/null @@ -1,35 +0,0 @@ -From d1c4cb447a7efcb5608a33cdfed8ab4234378b0a Mon Sep 17 00:00:00 2001 -From: Chintan Patel -Date: Mon, 18 Sep 2017 08:43:18 -0700 -Subject: [PATCH] ASoC: Intel: Skylake: Fix jack name format substitution - -Jack name is not getting formatted correctly hence resulting -in invalid name for HDMI/DP input devices. - -This was recently exposed due changes brought by MST: -commit 3a13347f05fd ("ASoC: Intel: kbl: Add jack port initialize -in kbl machine drivers") - -Signed-off-by: Chintan Patel -Acked-By: Vinod Koul -Signed-off-by: Mark Brown ---- - sound/soc/intel/boards/kbl_rt5663_rt5514_max98927.c | 2 ++ - 1 file changed, 2 insertions(+) - -diff --git a/sound/soc/intel/boards/kbl_rt5663_rt5514_max98927.c b/sound/soc/intel/boards/kbl_rt5663_rt5514_max98927.c -index 88ff54220007..9cd0769ccd34 100644 ---- a/sound/soc/intel/boards/kbl_rt5663_rt5514_max98927.c -+++ b/sound/soc/intel/boards/kbl_rt5663_rt5514_max98927.c -@@ -604,6 +604,8 @@ static int kabylake_card_late_probe(struct snd_soc_card *card) - - list_for_each_entry(pcm, &ctx->hdmi_pcm_list, head) { - codec = pcm->codec_dai->codec; -+ snprintf(jack_name, sizeof(jack_name), -+ "HDMI/DP, pcm=%d Jack", pcm->device); - err = snd_soc_card_jack_new(card, jack_name, - SND_JACK_AVOUT, &ctx->kabylake_hdmi[i], - NULL, 0); --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/sound-ASoC-Intel-kbl-fix-jack-name.patch b/kernel/kernel/files/patches/mageia/sound-ASoC-Intel-kbl-fix-jack-name.patch deleted file mode 100644 index 75359b31..00000000 --- a/kernel/kernel/files/patches/mageia/sound-ASoC-Intel-kbl-fix-jack-name.patch +++ /dev/null @@ -1,32 +0,0 @@ -From cedb6415f9ece6d3368aa0ac8a433caff799792a Mon Sep 17 00:00:00 2001 -From: Vinod Koul -Date: Tue, 31 Oct 2017 16:47:27 +0530 -Subject: [PATCH] ASoC: Intel: kbl: fix jack name - -Commit d1c4cb447a7e ("ASoC: Intel: Skylake: Fix jack name format -substitution") added Jack name but erroneously added a space as well, -so remove the space in Jack name. - -Fixes: d1c4cb447a7e ("ASoC: Intel: Skylake: Fix jack name format substitution") -Signed-off-by: Vinod Koul -Signed-off-by: Mark Brown ---- - sound/soc/intel/boards/kbl_rt5663_rt5514_max98927.c | 2 +- - 1 file changed, 1 insertion(+), 1 deletion(-) - -diff --git a/sound/soc/intel/boards/kbl_rt5663_rt5514_max98927.c b/sound/soc/intel/boards/kbl_rt5663_rt5514_max98927.c -index 9cd0769ccd34..69ab55956492 100644 ---- a/sound/soc/intel/boards/kbl_rt5663_rt5514_max98927.c -+++ b/sound/soc/intel/boards/kbl_rt5663_rt5514_max98927.c -@@ -605,7 +605,7 @@ static int kabylake_card_late_probe(struct snd_soc_card *card) - list_for_each_entry(pcm, &ctx->hdmi_pcm_list, head) { - codec = pcm->codec_dai->codec; - snprintf(jack_name, sizeof(jack_name), -- "HDMI/DP, pcm=%d Jack", pcm->device); -+ "HDMI/DP,pcm=%d Jack", pcm->device); - err = snd_soc_card_jack_new(card, jack_name, - SND_JACK_AVOUT, &ctx->kabylake_hdmi[i], - NULL, 0); --- -2.16.2 - diff --git a/kernel/kernel/files/patches/mageia/tools-testing-selftest-Makefile-remove-powerpc-reference.patch b/kernel/kernel/files/patches/mageia/tools-testing-selftest-Makefile-remove-powerpc-reference.patch deleted file mode 100644 index fea25f61..00000000 --- a/kernel/kernel/files/patches/mageia/tools-testing-selftest-Makefile-remove-powerpc-reference.patch +++ /dev/null @@ -1,10 +0,0 @@ ---- linux/tools/testing/selftests/Makefile.orig -+++ linux/tools/testing/selftests/Makefile -@@ -16,7 +16,6 @@ TARGETS += mount - TARGETS += mqueue - TARGETS += net - TARGETS += nsfs --TARGETS += powerpc - TARGETS += pstore - TARGETS += ptrace - TARGETS += seccomp diff --git a/kernel/kernel/files/patches/mageia/usb-storage-unusual_devs-add-id-2.6.37-buildfix.patch b/kernel/kernel/files/patches/mageia/usb-storage-unusual_devs-add-id-2.6.37-buildfix.patch deleted file mode 100644 index fa6655de..00000000 --- a/kernel/kernel/files/patches/mageia/usb-storage-unusual_devs-add-id-2.6.37-buildfix.patch +++ /dev/null @@ -1,46 +0,0 @@ ---- linux/drivers/usb/storage/unusual_devs.h.orig 2012-12-06 18:26:48.639813048 +0200 -+++ linux/drivers/usb/storage/unusual_devs.h 2012-12-06 18:27:16.570440504 +0200 -@@ -2046,16 +2046,16 @@ UNUSUAL_DEV( 0xed10, 0x7636, 0x0001, 0x0 - UNUSUAL_DEV( 0x0584, 0x0001, 0x0100, 0x0102, - "RATOCSystems", - "Compact Flash Adapter", -- US_SC_SCSI, US_PR_BULK, NULL, -+ USB_SC_SCSI, USB_PR_BULK, NULL, - US_FL_SINGLE_LUN | US_FL_MAX_SECTORS_MIN), - - /* - * Panasonic/OEMs compact USB CDROMs status - * KXL-840(CD-ROM11): usb_stor_Bulk_max_lun() is danger, need US_FL_SINGLE_LUN - * KXL-RW11(CDRRW02): usb_stor_Bulk_max_lun() is danger, need US_FL_SINGLE_LUN -- * KXL-RW20(CDRRW03): original IClass is 0xFF, use US_PR_CB and need init reset -+ * KXL-RW20(CDRRW03): original IClass is 0xFF, use USB_PR_CB and need init reset - * KXL-RW31(CDRRW05): work fine with current code -- * KXL-RW21(CDRRW06): original IClass is 0xFF, use US_PR_CB and need init reset -+ * KXL-RW21(CDRRW06): original IClass is 0xFF, use USB_PR_CB and need init reset - * KXL-RW32(CDRRW09): work fine with current code - * KXL-RW40(CDRRW10): work fine with current code - * Checked: Go Taniguchi -@@ -2063,19 +2063,19 @@ UNUSUAL_DEV( 0x0584, 0x0001, 0x0100, 0x0 - UNUSUAL_DEV( 0x04da, 0x0d01, 0x0000, 0xffff, - "Panasonic", - "CD-ROM11", -- US_SC_8020, US_PR_BULK, NULL, US_FL_SINGLE_LUN), -+ USB_SC_8020, USB_PR_BULK, NULL, US_FL_SINGLE_LUN), - UNUSUAL_DEV( 0x04da, 0x0d02, 0x0000, 0xffff, - "Panasonic", - "CDRRW02", -- US_SC_8020, US_PR_BULK, NULL, US_FL_SINGLE_LUN), -+ USB_SC_8020, USB_PR_BULK, NULL, US_FL_SINGLE_LUN), - UNUSUAL_DEV( 0x04da, 0x0d03, 0x0000, 0xffff, - "Panasonic", - "CDRRW03", -- US_SC_8020, US_PR_CB, NULL, US_FL_MAX_SECTORS_MIN), -+ USB_SC_8020, USB_PR_CB, NULL, US_FL_MAX_SECTORS_MIN), - UNUSUAL_DEV( 0x04da, 0x0d06, 0x0000, 0xffff, - "Panasonic", - "CDRRW06", -- US_SC_8020, US_PR_CB, NULL, US_FL_MAX_SECTORS_MIN), -+ USB_SC_8020, USB_PR_CB, NULL, US_FL_MAX_SECTORS_MIN), - - /* Control/Bulk transport for all SubClass values */ - USUAL_DEV(USB_SC_RBC, USB_PR_CB), diff --git a/kernel/kernel/files/patches/mageia/usb-storage-unusual_devs-add-id.patch b/kernel/kernel/files/patches/mageia/usb-storage-unusual_devs-add-id.patch deleted file mode 100644 index b9fc0200..00000000 --- a/kernel/kernel/files/patches/mageia/usb-storage-unusual_devs-add-id.patch +++ /dev/null @@ -1,55 +0,0 @@ -Subject: Change to usb storage of unusual_dev. - -This patch is japanease unique USB devices quirks. -There are many unique USB CD, which probides by Panasonic. -I try to use all models. all devices worked fine. - -Signed-off-by: Go Taniguchi - ---- - drivers/usb/storage/unusual_devs.h | 34 ++++++++++++++++++++++++++++++++++ - 1 file changed, 34 insertions(+) - ---- linux/drivers/usb/storage/unusual_devs.h.orig 2014-06-03 21:48:03.211099341 +0300 -+++ linux/drivers/usb/storage/unusual_devs.h 2014-06-04 21:57:21.546299167 +0300 -@@ -2105,6 +2105,40 @@ UNUSUAL_DEV( 0xed10, 0x7636, 0x0001, 0x0 - #include "unusual_uas.h" - #endif - -+UNUSUAL_DEV( 0x0584, 0x0001, 0x0100, 0x0102, -+ "RATOCSystems", -+ "Compact Flash Adapter", -+ US_SC_SCSI, US_PR_BULK, NULL, -+ US_FL_SINGLE_LUN | US_FL_MAX_SECTORS_MIN), -+ -+/* -+ * Panasonic/OEMs compact USB CDROMs status -+ * KXL-840(CD-ROM11): usb_stor_Bulk_max_lun() is danger, need US_FL_SINGLE_LUN -+ * KXL-RW11(CDRRW02): usb_stor_Bulk_max_lun() is danger, need US_FL_SINGLE_LUN -+ * KXL-RW20(CDRRW03): original IClass is 0xFF, use US_PR_CB and need init reset -+ * KXL-RW31(CDRRW05): work fine with current code -+ * KXL-RW21(CDRRW06): original IClass is 0xFF, use US_PR_CB and need init reset -+ * KXL-RW32(CDRRW09): work fine with current code -+ * KXL-RW40(CDRRW10): work fine with current code -+ * Checked: Go Taniguchi -+ */ -+UNUSUAL_DEV( 0x04da, 0x0d01, 0x0000, 0xffff, -+ "Panasonic", -+ "CD-ROM11", -+ US_SC_8020, US_PR_BULK, NULL, US_FL_SINGLE_LUN), -+UNUSUAL_DEV( 0x04da, 0x0d02, 0x0000, 0xffff, -+ "Panasonic", -+ "CDRRW02", -+ US_SC_8020, US_PR_BULK, NULL, US_FL_SINGLE_LUN), -+UNUSUAL_DEV( 0x04da, 0x0d03, 0x0000, 0xffff, -+ "Panasonic", -+ "CDRRW03", -+ US_SC_8020, US_PR_CB, NULL, US_FL_MAX_SECTORS_MIN), -+UNUSUAL_DEV( 0x04da, 0x0d06, 0x0000, 0xffff, -+ "Panasonic", -+ "CDRRW06", -+ US_SC_8020, US_PR_CB, NULL, US_FL_MAX_SECTORS_MIN), -+ - /* Control/Bulk transport for all SubClass values */ - USUAL_DEV(USB_SC_RBC, USB_PR_CB), - USUAL_DEV(USB_SC_8020, USB_PR_CB), diff --git a/kernel/kernel/files/patches/mageia/video-mageia-logo.patch b/kernel/kernel/files/patches/mageia/video-mageia-logo.patch deleted file mode 100644 index efc5307e..00000000 --- a/kernel/kernel/files/patches/mageia/video-mageia-logo.patch +++ /dev/null @@ -1,949 +0,0 @@ - -Mageia framebuffer boot logo - -Signed-off-by: Thomas Backlund - - drivers/video/logo/Kconfig | 5 - drivers/video/logo/Makefile | 1 - drivers/video/logo/logo.c | 5 - drivers/video/logo/logo_mageia_clut224.ppm | 883 +++++++++++++++++++++++++++++ - include/linux/linux_logo.h | 1 - 5 files changed, 895 insertions(+) - -diff -Nurp linux-2.6.37.3/drivers/video/logo/Kconfig linux-2.6.37.3.mga/drivers/video/logo/Kconfig ---- linux-2.6.37.3/drivers/video/logo/Kconfig 2011-01-05 02:50:19.000000000 +0200 -+++ linux-2.6.37.3.mga/drivers/video/logo/Kconfig 2011-03-08 21:50:08.077611366 +0200 -@@ -82,4 +82,9 @@ config LOGO_M32R_CLUT224 - depends on M32R - default y - -+config LOGO_MAGEIA_CLUT224 -+ bool "224-color Mageia logo" -+ depends on LOGO -+ default y -+ - endif # LOGO -diff -Nurp linux-2.6.37.3/drivers/video/logo/logo.c linux-2.6.37.3.mga/drivers/video/logo/logo.c ---- linux-2.6.37.3/drivers/video/logo/logo.c 2011-01-05 02:50:19.000000000 +0200 -+++ linux-2.6.37.3.mga/drivers/video/logo/logo.c 2011-03-08 21:51:27.042063947 +0200 -@@ -63,6 +63,11 @@ const struct linux_logo * __init_refok f - } - - if (depth >= 8) { -+#ifdef CONFIG_LOGO_MAGEIA_CLUT224 -+ /* Mageia logo */ -+ logo = &logo_mageia_clut224; -+ return logo; -+#endif - #ifdef CONFIG_LOGO_LINUX_CLUT224 - /* Generic Linux logo */ - logo = &logo_linux_clut224; -diff -Nurp linux-2.6.37.3/drivers/video/logo/logo_mageia_clut224.ppm linux-2.6.37.3.mga/drivers/video/logo/logo_mageia_clut224.ppm ---- linux-2.6.37.3/drivers/video/logo/logo_mageia_clut224.ppm 1970-01-01 02:00:00.000000000 +0200 -+++ linux-2.6.37.3.mga/drivers/video/logo/logo_mageia_clut224.ppm 2011-03-08 23:47:47.000000000 +0200 -@@ -0,0 +1,883 @@ -+P3 -+80 80 -+255 -+0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 3 11 16 9 14 29 -+9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 -+9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 -+9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 -+9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 -+9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 -+9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 -+9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 -+9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 9 14 29 -+9 14 29 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 -+ -+0 0 0 0 0 0 0 0 0 0 0 0 8 23 42 32 55 114 37 56 117 37 56 117 -+37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 -+37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 -+37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 -+37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 -+37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 -+37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 -+37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 -+37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 37 56 117 -+37 56 117 37 56 117 18 45 91 9 14 29 0 0 0 0 0 0 0 0 0 0 0 0 -+ -+0 0 0 0 0 0 0 0 0 18 45 91 37 56 117 37 56 117 36 57 118 36 57 118 -+36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 -+36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 -+36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 -+36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 -+36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 -+36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 -+36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 -+36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 36 57 118 -+36 57 118 36 57 118 37 56 117 36 57 118 17 36 71 0 0 0 0 0 0 0 0 0 -+ -+0 0 0 3 11 16 18 45 91 35 58 120 35 58 119 35 58 119 35 58 119 35 58 119 -+35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 -+35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 -+35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 -+35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 -+35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 -+35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 -+35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 -+35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 35 58 119 -+35 58 119 35 58 119 35 58 119 35 58 119 35 58 120 17 36 71 0 0 0 0 0 0 -+ -+0 0 0 11 38 58 37 56 117 34 59 122 35 58 119 35 58 120 35 58 120 35 58 120 -+35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 -+35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 -+35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 -+35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 -+35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 -+35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 -+35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 -+35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 -+35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 35 58 120 9 14 29 0 0 0 -+ -+0 0 0 32 55 114 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 -+34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 -+34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 -+34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 -+34 59 122 34 59 122 34 59 122 35 58 119 63 96 153 63 96 153 63 96 153 34 59 122 -+34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 -+34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 -+34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 -+34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 -+34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 34 59 122 18 45 91 0 0 0 -+ -+8 23 42 34 59 122 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 -+33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 -+33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 -+33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 -+33 60 123 33 60 123 33 60 123 125 157 204 191 220 251 194 222 252 191 218 250 108 152 201 -+32 55 114 32 62 125 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 -+33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 -+33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 -+33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 -+33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 33 60 123 34 59 122 0 0 0 -+ -+11 38 58 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 -+32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 -+32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 -+32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 -+32 61 124 32 62 125 63 96 153 170 209 245 168 209 245 168 209 245 170 209 245 164 205 243 -+63 96 153 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 -+32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 -+32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 -+32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 -+32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 61 124 32 62 125 8 16 31 -+ -+17 36 71 33 60 123 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 -+32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 -+32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 -+32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 -+32 62 125 32 62 125 86 129 181 148 198 240 145 197 239 145 197 239 145 197 239 145 197 239 -+63 96 153 32 61 124 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 -+32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 -+32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 -+32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 -+32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 32 62 125 8 16 31 -+ -+11 38 58 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 -+31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 -+31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 -+31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 -+31 63 126 30 65 129 63 96 153 123 185 232 123 185 232 123 185 232 123 185 232 122 182 230 -+41 91 154 31 63 126 31 63 126 31 63 126 31 63 126 63 96 153 40 74 135 31 63 126 -+31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 -+31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 -+31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 -+31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 31 63 126 8 16 31 -+ -+17 36 71 31 63 126 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 -+30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 -+30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 -+30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 -+30 64 128 30 64 128 30 65 129 85 139 195 97 172 225 100 173 226 100 173 226 85 139 195 -+32 61 124 30 64 128 30 64 128 86 129 181 184 213 246 201 225 254 201 225 254 142 183 225 -+40 74 135 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 -+30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 -+30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 -+30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 30 64 128 8 16 31 -+ -+17 36 71 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 -+30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 -+30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 -+30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 -+30 65 129 30 65 129 29 66 130 31 63 126 58 114 175 58 114 175 41 91 154 29 66 130 -+30 65 129 28 68 132 40 74 135 178 210 243 176 212 247 173 211 246 176 212 247 176 212 247 -+125 157 204 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 -+30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 -+30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 -+30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 30 65 129 8 16 31 -+ -+17 36 71 30 64 128 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 -+29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 -+29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 -+29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 -+29 66 130 29 66 130 29 66 130 29 66 130 30 64 128 28 67 131 29 66 130 29 66 130 -+29 66 130 29 66 130 85 139 195 158 203 242 154 201 241 155 202 241 155 202 241 155 202 241 -+154 201 241 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 -+29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 -+29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 -+29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 29 66 130 6 18 34 -+ -+17 36 71 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 -+28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 -+28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 -+28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 -+28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 -+28 67 131 28 67 131 86 129 181 134 191 236 134 191 236 134 191 236 134 191 236 134 191 236 -+134 191 236 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 -+28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 -+28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 -+28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 28 67 131 6 18 34 -+ -+17 36 71 28 67 131 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 -+28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 -+28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 -+28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 -+28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 -+28 68 132 28 68 132 40 74 135 117 182 230 115 181 230 115 181 230 115 181 230 115 181 230 -+85 139 195 27 69 133 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 -+28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 -+28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 -+28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 28 68 132 6 18 34 -+ -+17 36 71 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 -+27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 -+27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 -+27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 -+27 69 133 27 69 133 27 69 133 27 69 133 26 71 136 63 96 153 108 152 201 142 183 225 -+86 129 181 27 69 133 27 69 133 58 114 175 95 170 224 95 170 224 97 172 225 77 152 208 -+41 91 154 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 -+27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 -+27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 -+27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 27 69 133 6 18 34 -+ -+11 38 71 27 69 133 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 -+26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 -+26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 -+26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 -+26 70 135 26 70 135 26 70 135 26 70 135 86 129 181 197 223 253 188 217 249 188 217 249 -+191 220 251 152 193 232 40 74 135 26 70 135 23 75 141 41 91 154 41 91 154 26 70 135 -+27 69 133 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 -+26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 -+26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 -+26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 26 70 135 6 18 34 -+ -+11 38 71 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 -+26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 -+26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 -+26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 -+26 71 136 26 71 136 26 70 135 41 91 154 172 210 246 170 209 245 170 209 245 170 209 245 -+168 209 245 178 210 243 85 139 195 26 71 136 26 71 136 25 72 137 26 71 136 26 71 136 -+26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 -+26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 -+26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 -+26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 26 71 136 6 18 34 -+ -+11 38 71 26 71 136 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 -+25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 -+25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 -+25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 -+25 72 137 25 72 137 25 72 137 86 129 181 151 200 240 152 200 240 152 200 240 152 200 240 -+152 200 240 151 200 240 122 172 221 27 69 133 24 73 138 25 72 137 25 72 137 25 72 137 -+25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 -+25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 -+25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 -+25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 25 72 137 6 18 34 -+ -+11 38 71 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 -+24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 -+24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 -+24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 -+24 73 138 24 73 138 25 72 137 58 114 175 134 191 236 134 191 236 134 191 236 134 191 236 -+134 191 236 134 191 236 108 152 201 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 -+24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 -+24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 -+24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 -+24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 24 73 138 6 18 34 -+ -+11 38 71 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 -+23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 -+23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 -+23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 -+23 74 139 23 74 139 23 74 139 41 91 154 115 181 230 115 181 230 115 181 230 115 181 230 -+115 181 230 115 181 230 60 128 188 24 73 138 23 74 139 23 74 139 23 74 139 23 74 139 -+23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 -+23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 -+23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 -+23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 23 74 139 5 19 36 -+ -+11 38 71 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 -+23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 -+23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 -+23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 -+23 75 141 23 75 141 23 75 141 23 74 139 58 114 175 97 172 225 97 172 225 97 172 225 -+97 172 225 77 152 208 24 73 138 23 75 141 41 91 154 125 157 204 152 193 232 142 183 225 -+86 129 181 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 -+23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 -+23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 -+23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 23 75 141 5 19 36 -+ -+11 38 71 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 -+22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 -+22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 -+22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 -+22 76 142 22 76 142 22 76 142 22 76 142 21 76 143 30 98 155 58 114 175 60 128 188 -+42 114 176 23 74 139 21 76 143 63 96 153 176 212 247 188 218 250 188 218 250 188 217 249 -+191 218 250 125 157 204 21 77 144 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 -+22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 -+22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 -+22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 22 76 142 5 19 36 -+ -+11 38 71 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 -+21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 -+21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 -+21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 23 75 141 -+58 114 175 125 157 204 152 193 232 108 152 201 41 91 154 21 77 144 21 77 144 21 76 143 -+21 76 143 21 76 143 21 76 143 131 179 222 172 210 246 172 210 246 172 210 246 172 210 246 -+172 210 246 170 209 245 86 129 181 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 -+21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 -+21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 -+21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 21 76 143 5 19 36 -+ -+11 38 71 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 -+21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 -+21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 -+21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 125 157 204 -+194 222 252 191 220 251 191 220 251 191 220 251 184 213 246 86 129 181 21 77 144 21 77 144 -+21 77 144 21 77 144 22 89 156 155 202 241 155 202 242 155 202 242 155 202 242 155 202 242 -+155 202 242 155 202 242 122 172 221 21 76 143 21 77 144 21 77 144 21 77 144 21 77 144 -+21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 -+21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 -+21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 21 77 144 5 19 36 -+ -+11 38 71 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 -+20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 -+20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 -+20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 21 77 144 85 139 195 176 212 247 -+176 212 247 176 212 247 176 212 247 176 212 247 176 212 247 164 205 243 41 91 154 20 78 145 -+20 78 145 20 78 145 41 91 154 140 193 237 140 193 237 140 193 237 140 193 237 140 193 237 -+137 192 236 143 192 235 100 169 221 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 -+20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 -+20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 -+20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 20 78 145 5 19 36 -+ -+11 38 71 19 80 148 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 -+19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 -+19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 -+19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 131 179 222 161 204 243 -+160 204 243 160 204 243 160 204 243 160 204 243 160 204 243 160 204 243 85 139 195 19 79 147 -+19 79 147 19 79 147 19 79 147 111 178 227 123 185 232 121 184 232 122 185 232 122 185 232 -+122 185 232 122 185 232 85 139 195 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 -+19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 -+19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 -+19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 19 79 147 5 19 36 -+ -+11 38 71 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 -+19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 -+19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 -+19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 145 196 239 145 196 239 -+145 196 239 145 196 239 145 196 239 145 196 239 145 196 239 145 196 239 85 139 195 19 80 148 -+19 80 148 19 80 148 19 79 147 60 128 188 106 176 228 106 176 228 106 176 228 106 176 228 -+106 176 228 100 172 225 22 89 156 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 -+19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 -+19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 -+19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 19 80 148 5 19 36 -+ -+11 38 71 17 82 150 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 -+18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 -+18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 -+18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 111 178 227 132 189 234 -+130 189 235 130 189 235 130 189 235 130 189 235 130 189 235 130 189 235 85 139 195 17 82 150 -+18 81 149 18 81 149 18 81 149 18 81 149 42 114 176 88 166 221 87 167 223 89 168 223 -+77 152 208 30 98 155 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 -+18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 -+18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 -+18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 18 81 149 5 19 36 -+ -+11 38 71 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 -+17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 -+17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 -+17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 16 83 151 85 139 195 115 181 230 -+115 181 230 115 181 230 115 181 230 115 181 230 117 182 230 111 178 227 42 114 176 17 82 150 -+17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 18 81 149 23 96 163 22 89 156 -+18 81 149 16 83 151 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 -+17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 -+17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 -+17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 17 82 150 4 21 38 -+ -+9 48 78 17 82 150 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 -+16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 -+16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 -+16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 22 89 156 83 162 217 -+100 172 225 100 173 226 100 173 226 100 173 226 100 173 226 62 142 198 19 79 147 16 83 151 -+16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 -+16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 -+16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 -+16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 -+16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 16 83 151 4 21 38 -+ -+9 48 78 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 -+16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 -+16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 -+16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 14 87 156 -+60 128 188 77 152 208 84 165 222 65 151 210 42 114 176 16 84 153 16 84 153 16 84 153 -+16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 -+16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 -+16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 -+16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 -+16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 16 84 153 4 21 38 -+ -+9 48 78 16 84 153 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 -+15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 -+15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 -+15 85 154 15 85 154 15 85 154 58 114 175 42 114 176 16 84 153 15 85 154 15 85 154 -+15 85 154 14 86 155 15 85 154 16 84 153 15 85 154 15 85 154 15 85 154 15 85 154 -+15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 -+15 85 154 15 85 154 15 85 154 58 114 175 42 114 176 16 83 151 15 85 154 15 85 154 -+15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 -+15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 -+15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 15 85 154 4 21 38 -+ -+9 48 78 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 -+14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 -+14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 -+15 85 154 42 114 176 178 210 243 204 226 255 204 226 255 178 210 243 42 114 176 14 86 155 -+14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 -+14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 -+14 86 155 85 139 195 191 218 250 204 226 255 201 225 254 142 183 225 23 96 163 14 86 155 -+14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 -+14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 -+14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 14 86 155 4 21 38 -+ -+9 48 78 14 86 155 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 -+14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 -+14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 -+42 114 176 191 218 250 201 225 254 201 225 254 201 225 254 201 225 254 201 225 254 108 152 201 -+13 88 157 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 -+14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 23 96 163 -+142 183 225 201 225 254 201 225 254 201 225 254 201 225 254 201 225 254 163 199 237 23 96 163 -+14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 -+14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 -+14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 14 87 156 4 21 38 -+ -+9 48 78 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 -+13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 -+13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 14 87 156 42 114 176 -+184 213 246 197 223 253 197 223 253 197 223 253 197 223 253 197 223 253 197 223 253 196 222 253 -+178 210 243 60 128 188 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 -+13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 23 96 163 91 153 206 184 213 246 -+197 223 253 197 223 253 197 223 253 197 223 253 197 223 253 197 223 253 197 223 253 163 199 237 -+23 96 163 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 -+13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 -+13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 13 88 157 4 21 38 -+ -+9 48 78 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 -+12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 -+12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 28 113 174 184 213 246 -+194 222 252 194 222 252 194 222 252 194 222 252 194 222 252 194 222 252 194 222 252 194 222 252 -+194 222 252 196 222 253 172 207 243 125 157 204 60 128 188 13 88 157 12 89 158 12 89 158 -+12 89 158 12 89 158 23 96 163 60 128 188 122 172 221 184 213 246 194 222 252 194 222 252 -+194 222 252 194 222 252 194 222 252 194 222 252 194 222 252 194 222 252 194 222 252 194 222 252 -+163 199 237 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 -+12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 -+12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 12 89 158 4 21 38 -+ -+9 48 78 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 -+12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 -+12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 13 88 157 163 199 237 191 220 251 -+191 220 251 191 220 251 191 220 251 191 220 251 191 220 251 191 220 251 191 220 251 191 220 251 -+191 220 251 191 220 251 191 220 251 188 218 250 191 218 250 191 220 251 178 210 243 152 193 232 -+142 183 225 191 220 251 191 220 251 194 222 252 191 220 251 191 220 251 191 220 251 191 220 251 -+191 220 251 191 220 251 191 220 251 191 220 251 191 220 251 191 220 251 191 220 251 191 220 251 -+185 217 250 125 157 204 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 -+12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 -+12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 12 90 160 1 24 42 -+ -+9 48 78 11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 -+11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 -+11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 91 153 206 188 218 250 188 218 250 -+188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 -+188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 -+188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 -+188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 188 218 250 -+188 218 250 188 218 250 60 128 188 12 89 158 11 91 161 11 91 161 11 91 161 11 91 161 -+11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 -+11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 11 91 161 1 24 42 -+ -+9 48 78 10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 -+10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 -+10 92 162 10 92 162 10 92 162 11 91 161 28 113 174 188 218 250 185 217 250 185 217 250 -+185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 -+185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 -+185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 -+185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 185 217 250 -+185 217 250 185 217 250 163 199 237 10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 -+10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 -+10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 10 92 162 1 24 42 -+ -+2 50 86 9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 -+9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 -+9 92 163 9 92 163 9 92 163 9 92 163 122 172 221 179 214 248 182 215 249 182 215 249 -+182 215 249 182 215 249 182 215 249 182 215 249 152 193 232 182 215 249 182 215 249 182 215 249 -+182 215 249 182 215 249 182 215 249 182 215 249 182 215 249 182 215 249 182 215 249 182 215 249 -+182 215 249 182 215 249 182 215 249 182 215 249 182 215 249 182 215 249 182 215 249 182 215 249 -+182 215 249 182 215 249 172 207 243 163 199 237 182 215 249 182 215 249 182 215 249 182 215 249 -+182 215 249 182 215 249 182 215 249 85 139 195 8 94 166 9 92 163 9 92 163 9 92 163 -+9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 -+9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 9 92 163 1 24 42 -+ -+9 48 78 9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 -+9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 -+9 93 164 9 93 164 9 92 163 28 113 174 179 214 248 179 214 248 179 214 248 179 214 248 -+179 214 248 179 214 248 179 214 248 122 172 221 11 91 161 40 129 186 142 183 225 179 214 248 -+179 214 248 179 214 248 179 214 248 179 214 248 179 214 248 179 214 248 179 214 248 179 214 248 -+179 214 248 179 214 248 179 214 248 179 214 248 179 214 248 179 214 248 179 214 248 179 214 248 -+176 212 247 122 172 221 28 113 174 18 102 171 163 199 237 179 214 248 179 214 248 179 214 248 -+179 214 248 179 214 248 179 214 248 154 201 241 9 93 164 9 93 164 9 93 164 9 93 164 -+9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 -+9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 9 93 164 1 24 42 -+ -+2 50 86 8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 -+8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 -+8 94 166 8 94 166 8 94 166 107 172 224 178 210 243 176 212 247 176 212 247 176 212 247 -+176 212 247 176 212 247 164 205 243 18 102 171 8 94 166 8 94 166 8 94 166 28 113 174 -+92 162 218 163 199 237 173 211 246 176 212 247 176 212 247 176 212 247 176 212 247 176 212 247 -+176 212 247 176 212 247 176 212 247 176 212 247 176 212 247 176 212 247 143 192 235 85 139 195 -+18 102 171 8 94 166 8 94 166 8 94 166 40 129 186 176 212 247 176 212 247 176 212 247 -+176 212 247 176 212 247 176 212 247 176 212 247 62 142 198 9 93 164 8 94 166 8 94 166 -+8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 -+8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 8 94 166 1 24 42 -+ -+2 50 86 7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 -+7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 -+7 95 167 7 95 167 8 94 166 161 204 243 173 211 246 173 211 246 173 211 246 173 211 246 -+172 210 246 178 210 243 62 142 198 7 95 167 7 95 167 7 95 167 7 95 167 8 94 166 -+8 94 166 8 94 166 28 119 185 85 139 195 92 162 218 131 179 222 131 179 222 131 179 222 -+131 179 222 131 179 222 131 179 222 91 153 206 62 142 198 28 113 174 7 95 167 7 96 168 -+7 95 167 7 95 167 7 95 167 7 96 168 9 93 164 107 172 224 173 211 246 173 211 246 -+173 211 246 173 211 246 173 211 246 173 211 246 122 172 221 7 95 167 7 95 167 7 95 167 -+7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 -+7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 7 95 167 1 24 42 -+ -+2 50 86 7 95 167 7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 -+7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 -+7 96 168 7 96 168 60 128 188 170 209 245 170 209 245 170 209 245 170 209 245 170 209 245 -+170 209 245 145 196 239 8 94 166 7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 -+7 96 168 7 96 168 7 96 168 6 97 169 7 96 168 7 96 168 6 97 169 7 96 168 -+6 97 169 7 96 168 6 97 169 7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 -+7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 28 113 174 170 209 245 170 209 245 -+170 209 245 170 209 245 170 209 245 170 209 245 170 209 245 18 102 171 7 96 168 7 96 168 -+7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 -+7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 7 96 168 1 24 42 -+ -+2 50 86 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 -+6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 -+6 97 169 7 96 168 92 162 218 167 207 244 167 207 244 167 207 244 167 207 244 167 207 244 -+167 207 244 91 153 206 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 -+6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 -+6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 -+6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 5 99 172 131 179 222 167 207 244 -+167 207 244 167 207 244 167 207 244 167 207 244 168 209 245 60 128 188 6 97 169 6 97 169 -+6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 -+6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 6 97 169 1 24 42 -+ -+2 50 86 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 -+5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 -+5 98 170 5 98 170 132 189 234 164 205 243 164 205 243 164 205 243 164 205 243 164 205 243 -+164 205 243 28 113 174 5 99 172 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 -+5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 -+5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 -+5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 62 142 198 164 205 243 -+164 205 243 164 205 243 164 205 243 164 205 243 164 205 243 92 162 218 5 98 170 5 98 170 -+5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 -+5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 5 98 170 1 24 42 -+ -+2 50 86 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 -+5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 -+5 99 172 5 99 172 161 204 243 161 204 243 161 204 243 161 204 243 161 204 243 161 204 243 -+139 191 235 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 -+5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 -+5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 -+5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 4 100 173 28 113 174 161 204 243 -+161 204 243 161 204 243 161 204 243 161 204 243 161 204 243 122 172 221 5 99 172 5 99 172 -+5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 -+5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 5 99 172 1 24 42 -+ -+2 50 86 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 -+4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 -+4 100 173 28 119 185 160 204 243 158 203 242 158 203 242 158 203 242 158 203 242 158 203 242 -+100 169 221 5 98 170 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 -+4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 -+4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 -+4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 3 101 174 139 191 235 -+158 203 242 158 203 242 158 203 242 158 203 242 158 203 242 148 198 240 4 100 173 4 100 173 -+4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 -+4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 4 100 173 1 24 42 -+ -+2 50 86 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 -+3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 -+3 101 174 40 129 186 154 201 241 154 201 241 154 201 241 154 201 241 154 201 241 154 201 241 -+77 152 208 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 -+3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 -+3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 -+3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 5 99 172 111 178 227 -+154 201 241 154 201 241 154 201 241 154 201 241 154 201 241 154 201 241 3 101 174 3 101 174 -+3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 -+3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 3 101 174 0 26 44 -+ -+2 50 86 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 -+3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 -+3 102 175 40 129 186 151 200 240 151 200 240 151 200 240 151 200 240 151 200 240 151 200 240 -+62 142 198 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 -+3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 -+3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 -+3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 107 172 224 -+151 200 240 151 200 240 151 200 240 151 200 240 151 200 240 151 200 240 3 102 175 3 102 175 -+3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 -+3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 3 102 175 0 26 44 -+ -+2 50 86 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 -+2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 -+1 104 177 40 129 186 148 198 240 148 198 240 148 198 240 148 198 240 148 198 240 148 198 240 -+40 129 186 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 -+2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 -+2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 -+2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 77 152 208 -+148 198 240 148 198 240 148 198 240 148 198 240 148 198 240 148 198 240 2 103 176 2 103 176 -+2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 -+2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 2 103 176 0 26 44 -+ -+2 50 86 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 -+1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 -+1 104 177 40 129 186 145 196 239 145 197 239 145 197 239 145 197 239 145 197 239 145 197 239 -+51 141 199 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 -+1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 -+1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 -+1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 100 169 221 -+145 196 239 145 197 239 145 197 239 145 197 239 145 197 239 145 197 239 1 104 177 1 104 177 -+1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 -+1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 1 104 177 0 26 44 -+ -+2 50 86 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 -+0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 -+1 106 180 27 129 189 145 196 239 140 193 237 140 193 237 140 193 237 140 193 237 140 193 237 -+77 152 208 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 -+0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 -+0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 -+0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 107 172 224 -+145 196 239 140 193 237 140 193 237 140 193 237 140 193 237 140 193 237 0 105 179 0 105 179 -+0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 -+0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 105 179 0 26 44 -+ -+4 57 93 0 105 179 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 -+1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 -+1 106 180 28 119 185 140 193 237 140 193 237 140 193 237 140 193 237 140 193 237 140 193 237 -+83 162 217 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 -+1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 -+1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 -+1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 122 182 230 -+140 193 237 140 193 237 140 193 237 140 193 237 140 193 237 132 189 234 1 106 180 1 106 180 -+1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 -+1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 1 106 180 0 26 44 -+ -+4 57 93 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 -+2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 -+2 108 181 2 108 181 137 192 236 137 192 236 137 192 236 137 192 236 137 192 236 137 192 236 -+111 178 227 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 -+2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 -+2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 -+2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 8 115 186 137 192 236 -+137 192 236 137 192 236 137 192 236 137 192 236 137 192 236 100 169 221 2 108 181 2 108 181 -+2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 -+2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 2 108 181 0 26 44 -+ -+4 57 93 2 108 181 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 -+4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 -+4 110 182 4 110 182 107 172 224 134 191 236 134 191 236 134 191 236 134 191 236 134 191 236 -+132 189 234 17 119 189 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 -+4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 -+4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 -+4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 51 141 199 134 191 236 -+134 191 236 134 191 236 134 191 236 134 191 236 134 191 236 77 152 208 4 110 182 4 110 182 -+4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 -+4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 4 110 182 0 26 44 -+ -+4 57 93 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 -+5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 -+5 112 184 5 112 184 83 162 217 130 189 234 130 189 234 130 189 234 130 189 234 130 189 234 -+127 187 234 65 151 210 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 -+5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 -+5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 -+5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 92 162 218 130 189 234 -+130 189 234 130 189 234 130 189 234 130 189 234 130 189 235 51 141 199 5 112 184 5 112 184 -+5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 -+5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 5 112 184 6 113 185 0 26 44 -+ -+4 57 93 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 -+6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 -+6 113 185 6 113 185 42 139 203 127 187 234 127 187 234 127 187 234 127 187 234 127 187 234 -+127 187 234 111 178 227 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 -+6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 -+6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 -+6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 19 124 193 127 187 234 127 187 234 -+127 187 234 127 187 234 127 187 234 127 187 234 127 187 234 17 119 189 6 113 185 6 113 185 -+6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 -+6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 6 113 185 3 30 48 -+ -+4 57 93 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 -+8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 -+8 115 186 8 115 186 17 119 189 117 182 230 124 186 233 124 186 233 124 186 233 124 186 233 -+124 186 233 124 186 233 51 141 199 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 -+8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 -+8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 -+8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 79 161 217 124 186 233 124 186 233 -+124 186 233 124 186 233 124 186 233 124 186 233 95 168 221 8 115 186 8 115 186 8 115 186 -+8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 -+8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 8 115 186 3 30 48 -+ -+4 57 93 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 -+9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 -+9 117 188 9 117 188 9 117 188 79 161 217 121 184 232 121 184 232 121 184 232 121 184 232 -+121 184 232 121 184 232 106 176 228 17 119 189 9 117 188 9 117 188 9 117 188 9 117 188 -+9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 -+9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 -+9 117 188 9 117 188 9 117 188 9 117 188 27 133 194 122 182 230 121 184 232 121 184 232 -+121 184 232 121 184 232 121 184 232 121 184 232 51 141 199 9 117 188 9 117 188 9 117 188 -+9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 -+9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 9 117 188 3 30 48 -+ -+4 57 93 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 -+11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 -+11 119 189 11 119 189 11 119 189 27 133 194 117 182 230 117 182 230 117 182 230 117 182 230 -+117 182 230 117 182 230 117 182 230 79 161 217 11 119 189 11 119 189 11 119 189 11 119 189 -+11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 -+11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 -+11 119 189 11 119 189 11 119 189 17 119 189 100 172 225 117 182 230 117 182 230 117 182 230 -+117 182 230 117 182 230 117 182 230 111 178 227 11 119 189 11 119 189 11 119 189 11 119 189 -+11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 -+11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 11 119 189 3 30 48 -+ -+4 57 93 13 122 191 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 -+12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 -+12 121 190 12 121 190 12 121 190 13 122 191 88 166 221 115 181 230 115 181 230 115 181 230 -+115 181 230 115 181 230 115 181 230 115 181 230 51 141 199 13 122 191 12 121 190 12 121 190 -+12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 -+12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 -+12 121 190 12 121 190 12 121 190 79 161 217 115 181 230 115 181 230 115 181 230 115 181 230 -+115 181 230 115 181 230 115 181 230 65 151 210 12 121 190 12 121 190 12 121 190 12 121 190 -+12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 -+12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 12 121 190 3 30 48 -+ -+4 57 93 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 -+13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 -+13 122 191 13 122 191 13 122 191 13 122 191 27 133 194 112 180 229 112 180 229 112 180 229 -+112 180 229 112 180 229 112 180 229 112 180 229 112 180 229 51 141 199 13 122 191 13 122 191 -+13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 -+13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 -+13 122 191 12 121 190 79 161 217 112 180 229 112 180 229 112 180 229 112 180 229 112 180 229 -+112 180 229 112 180 229 100 172 225 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 -+13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 -+13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 13 122 191 3 30 48 -+ -+12 68 101 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 -+15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 -+15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 65 151 210 109 178 229 109 178 229 -+109 178 229 109 178 229 109 178 229 109 178 229 109 178 229 109 178 229 65 151 210 15 124 193 -+15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 -+15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 -+17 128 195 79 161 217 109 178 229 109 178 229 109 178 229 109 178 229 109 178 229 109 178 229 -+109 178 229 109 178 229 42 139 203 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 -+15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 -+15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 15 124 193 3 30 48 -+ -+4 57 93 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 -+16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 -+16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 89 168 223 106 176 228 -+106 176 228 106 176 228 106 176 228 106 176 228 106 176 228 106 176 228 106 176 228 81 164 221 -+27 133 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 -+16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 42 139 203 -+94 170 224 106 176 228 106 176 228 106 176 228 106 176 228 106 176 228 106 176 228 106 176 228 -+106 176 228 65 151 210 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 -+16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 -+16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 16 126 194 3 30 48 -+ -+12 68 101 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 -+17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 -+17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 28 137 198 97 172 225 -+103 175 227 103 175 227 103 175 227 103 175 227 103 175 227 103 175 227 103 175 227 103 175 227 -+103 175 227 65 151 210 28 137 198 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 -+17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 42 139 203 79 161 217 103 175 227 -+103 175 227 103 175 227 103 175 227 103 175 227 103 175 227 103 175 227 103 175 227 103 175 227 -+88 166 221 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 -+17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 -+17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 17 128 195 3 30 48 -+ -+12 68 101 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 -+19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 -+19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 31 139 202 -+95 170 224 100 173 226 100 173 226 100 173 226 100 173 226 100 173 226 100 173 226 100 173 226 -+100 173 226 100 173 226 100 173 226 81 164 221 65 151 210 42 139 203 42 139 203 19 130 197 -+22 132 197 42 139 203 42 139 203 65 151 210 89 168 223 100 173 226 100 173 226 100 173 226 -+100 173 226 100 173 226 100 173 226 100 173 226 100 173 226 100 173 226 100 173 226 84 165 222 -+22 132 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 -+19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 -+19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 19 130 197 20 131 198 3 30 48 -+ -+12 68 101 19 130 197 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 -+20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 -+20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 -+31 139 202 93 169 223 97 172 225 97 172 225 97 172 225 97 172 225 97 172 225 97 172 225 -+97 172 225 97 172 225 97 172 225 97 172 225 97 172 225 97 172 225 97 172 225 97 172 225 -+97 172 225 97 172 225 97 172 225 97 172 225 97 172 225 97 172 225 97 172 225 97 172 225 -+97 172 225 97 172 225 97 172 225 97 172 225 97 172 225 97 172 225 81 164 221 23 135 201 -+20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 -+20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 -+20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 20 131 198 3 30 48 -+ -+12 68 101 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 -+21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 -+21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 -+23 135 201 31 139 202 89 168 223 94 170 224 94 170 224 94 170 224 94 170 224 94 170 224 -+94 170 224 94 170 224 94 170 224 94 170 224 94 170 224 94 170 224 94 170 224 94 170 224 -+94 170 224 94 170 224 94 170 224 94 170 224 94 170 224 94 170 224 94 170 224 94 170 224 -+94 170 224 94 170 224 94 170 224 94 170 224 94 170 224 81 164 221 24 137 202 21 133 199 -+21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 -+21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 -+21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 21 133 199 23 135 201 3 30 48 -+ -+12 68 101 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 -+23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 -+23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 -+22 130 192 21 125 186 28 122 176 77 152 208 89 168 223 90 169 224 90 169 224 90 169 224 -+90 169 224 90 169 224 90 169 224 90 169 224 90 169 224 90 169 224 90 169 224 90 169 224 -+90 169 224 90 169 224 90 169 224 90 169 224 90 169 224 90 169 224 90 169 224 90 169 224 -+90 169 224 90 169 224 90 169 224 90 169 224 62 142 198 17 118 175 21 125 186 22 132 197 -+23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 -+23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 -+23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 23 135 201 3 30 48 -+ -+12 68 101 24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 -+24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 -+24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 22 130 192 17 118 175 21 111 162 -+21 111 162 21 111 162 21 111 162 21 111 162 40 129 186 83 162 217 87 167 223 87 167 223 -+87 167 223 87 167 223 87 167 223 87 167 223 87 167 223 87 167 223 87 167 223 87 167 223 -+87 167 223 87 167 223 87 167 223 87 167 223 87 167 223 87 167 223 87 167 223 87 167 223 -+87 167 223 87 167 223 77 152 208 28 122 176 21 111 162 21 111 162 21 111 162 21 111 162 -+22 114 165 17 118 175 22 132 197 24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 -+24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 -+24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 24 137 202 26 139 203 3 30 48 -+ -+12 68 101 26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 -+26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 -+26 139 203 26 139 203 26 139 203 26 139 203 28 122 176 21 111 162 21 111 162 21 111 162 -+21 111 162 21 111 162 21 111 162 21 111 162 21 111 162 24 115 166 51 141 199 79 161 217 -+84 166 222 84 166 222 84 166 222 84 166 222 84 166 222 84 166 222 84 166 222 84 166 222 -+84 166 222 84 166 222 84 166 222 84 166 222 84 166 222 84 166 222 84 166 222 84 166 222 -+79 161 217 40 129 186 22 112 163 21 111 162 21 111 162 21 111 162 21 111 162 21 111 162 -+21 111 162 22 112 163 21 111 162 22 130 192 26 139 203 26 139 203 26 139 203 26 139 203 -+26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 -+26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 26 139 203 3 30 48 -+ -+9 48 78 27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 -+27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 -+27 140 204 27 140 204 27 140 204 27 140 204 17 118 175 22 112 163 22 112 163 22 112 163 -+22 112 163 22 112 163 22 112 163 22 112 163 22 112 163 22 112 163 22 112 163 21 111 162 -+40 129 186 62 142 198 79 161 217 81 164 221 81 164 221 81 164 221 81 164 221 81 164 221 -+81 164 221 81 164 221 81 164 221 81 164 221 81 164 221 79 161 217 62 142 198 28 122 176 -+22 112 163 22 112 163 22 112 163 22 112 163 22 112 163 22 112 163 22 112 163 22 112 163 -+22 112 163 22 112 163 22 112 163 21 125 186 27 140 204 27 140 204 27 140 204 27 140 204 -+27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 -+27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 27 140 204 4 18 26 -+ -+4 18 26 28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 -+28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 -+28 142 206 28 142 206 28 142 206 28 142 206 28 137 198 28 122 176 22 114 165 22 114 165 -+22 114 165 22 114 165 22 114 165 22 114 165 22 114 165 22 114 165 22 114 165 22 114 165 -+22 114 165 22 114 165 22 114 165 28 122 176 40 129 186 51 141 199 51 141 199 51 141 199 -+51 141 199 51 141 199 51 141 199 28 122 176 28 122 176 22 112 163 22 114 165 22 114 165 -+22 114 165 22 114 165 22 114 165 22 114 165 22 114 165 22 114 165 22 114 165 22 114 165 -+22 114 165 22 114 165 28 122 176 27 140 204 28 142 206 28 142 206 28 142 206 28 142 206 -+28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 -+28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 28 142 206 28 122 176 0 0 0 -+ -+0 0 0 19 91 130 30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 -+30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 -+30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 28 140 203 27 129 189 -+28 122 176 25 117 166 24 115 166 24 115 166 24 115 166 24 115 166 24 115 166 24 115 166 -+24 115 166 24 115 166 24 115 166 24 115 166 24 115 166 22 112 163 24 115 166 22 112 163 -+24 115 166 22 112 163 24 115 166 25 117 166 24 115 166 24 115 166 24 115 166 24 115 166 -+24 115 166 24 115 166 24 115 166 24 115 166 24 115 166 22 114 165 28 122 176 28 122 176 -+27 133 194 29 142 204 30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 -+30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 -+30 144 207 30 144 207 30 144 207 30 144 207 30 144 207 31 146 208 9 48 78 0 0 0 -+ -+0 0 0 4 18 26 28 137 198 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 -+31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 -+31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 -+31 146 208 32 148 210 30 144 206 28 137 198 27 133 194 27 129 189 27 129 189 28 122 176 -+28 122 176 28 122 176 25 117 166 25 117 166 25 117 166 25 117 166 25 117 166 25 117 166 -+25 117 166 25 117 166 25 117 166 25 117 166 25 117 166 25 117 166 28 122 176 28 122 176 -+28 122 176 27 129 189 27 129 189 28 137 198 28 137 198 31 146 208 31 146 208 31 146 208 -+31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 -+31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 -+31 146 208 31 146 208 31 146 208 31 146 208 31 146 208 25 117 166 0 0 0 0 0 0 -+ -+0 0 0 0 0 0 8 23 42 28 137 198 32 148 210 32 148 210 32 148 210 32 148 210 -+32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 -+32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 -+32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 -+32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 -+32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 -+32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 -+32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 -+32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 32 148 210 -+32 148 210 32 148 210 32 148 210 32 148 210 25 117 166 3 11 16 0 0 0 0 0 0 -+ -+0 0 0 0 0 0 0 0 0 4 18 26 19 91 130 34 149 211 34 149 211 34 149 211 -+34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 -+34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 -+34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 -+34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 -+34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 -+34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 -+34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 -+34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 34 149 211 -+34 149 211 34 149 211 31 139 202 18 76 106 3 11 16 0 0 0 0 0 0 0 0 0 -+ -+0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 4 18 26 9 48 78 18 76 106 -+18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 -+18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 -+18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 -+18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 -+18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 -+18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 -+18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 -+18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 18 76 106 -+18 76 106 11 38 58 3 11 16 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 -+ -diff -Nurp linux-2.6.37.3/drivers/video/logo/Makefile linux-2.6.37.3.mga/drivers/video/logo/Makefile ---- linux-2.6.37.3/drivers/video/logo/Makefile 2011-01-05 02:50:19.000000000 +0200 -+++ linux-2.6.37.3.mga/drivers/video/logo/Makefile 2011-03-08 21:51:35.728113700 +0200 -@@ -15,6 +15,7 @@ obj-$(CONFIG_LOGO_SUPERH_MONO) += logo_ - obj-$(CONFIG_LOGO_SUPERH_VGA16) += logo_superh_vga16.o - obj-$(CONFIG_LOGO_SUPERH_CLUT224) += logo_superh_clut224.o - obj-$(CONFIG_LOGO_M32R_CLUT224) += logo_m32r_clut224.o -+obj-$(CONFIG_LOGO_MAGEIA_CLUT224) += logo_mageia_clut224.o - - obj-$(CONFIG_SPU_BASE) += logo_spe_clut224.o - -diff -Nurp linux-2.6.37.3/include/linux/linux_logo.h linux-2.6.37.3.mga/include/linux/linux_logo.h ---- linux-2.6.37.3/include/linux/linux_logo.h 2011-01-05 02:50:19.000000000 +0200 -+++ linux-2.6.37.3.mga/include/linux/linux_logo.h 2011-03-08 21:51:20.263024073 +0200 -@@ -47,6 +47,7 @@ extern const struct linux_logo logo_supe - extern const struct linux_logo logo_superh_clut224; - extern const struct linux_logo logo_m32r_clut224; - extern const struct linux_logo logo_spe_clut224; -+extern const struct linux_logo logo_mageia_clut224; - - extern const struct linux_logo *fb_find_logo(int depth); - #ifdef CONFIG_FB_LOGO_EXTRA diff --git a/kernel/kernel/files/patches/mageia/x86-boot-video-80x25-if-break.patch b/kernel/kernel/files/patches/mageia/x86-boot-video-80x25-if-break.patch deleted file mode 100644 index e7e92f47..00000000 --- a/kernel/kernel/files/patches/mageia/x86-boot-video-80x25-if-break.patch +++ /dev/null @@ -1,24 +0,0 @@ -Automatically switches textmode if the user selects a wrong one. - -Original author of the idea/first patch is unknown. - -Signed-off-by: Herton Ronaldo Krzesinski -Signed-off-by: Luiz Fernando N. Capitulino - --- - arch/x86/boot/video.c | 4 ++-- - 1 file changed, 2 insertions(+), 2 deletions(-) - ---- a/arch/x86/boot/video.c -+++ b/arch/x86/boot/video.c -@@ -325,8 +325,8 @@ void set_video(void) - if (!set_mode(mode)) - break; - -- printf("Undefined video mode number: %x\n", mode); -- mode = ASK_VGA; -+ printf("Undefined video mode number: %x, jump to 80x25\n", mode); -+ mode = VIDEO_80x25; - } - boot_params.hdr.vid_mode = mode; - vesa_store_edid(); diff --git a/kernel/kernel/files/patches/mageia/x86-default_poweroff_up_machines.patch b/kernel/kernel/files/patches/mageia/x86-default_poweroff_up_machines.patch deleted file mode 100644 index 28ce1a0d..00000000 --- a/kernel/kernel/files/patches/mageia/x86-default_poweroff_up_machines.patch +++ /dev/null @@ -1,58 +0,0 @@ -From: Olaf Dabrunz -Subject: [apm] default to "power_off" when SMP kernel is used on single processo -r machines -Reference: SUSE221667 - -This patch turns on support for the APM power_off function by default when the -SMP kernel is used on single processor machines. - -It is a bit ugly to use a separate variable to make sure the default value is -only used when needed and the power_off variable is not initialized twice. But -I did not find a better way to do this with the way the current initialization -system works. - -Signed-off-by: Olaf Dabrunz - - - arch/x86/kernel/apm_32.c | 15 ++++++++++++++- - 1 file changed, 14 insertions(+), 1 deletion(-) - ---- a/arch/x86/kernel/apm_32.c -+++ b/arch/x86/kernel/apm_32.c -@@ -388,6 +388,7 @@ static bool smp __read_mostly; - static int apm_disabled = -1; - #ifdef CONFIG_SMP - static bool power_off; -+static int power_off_set; - #else - static bool power_off = 1; - #endif -@@ -1843,6 +1844,14 @@ static int apm(void *unused) - } - } - -+#ifdef CONFIG_SMP -+ if (!power_off_set) { -+ power_off = (num_online_cpus() == 1); -+ /* remember not to initialize (with default value) again */ -+ power_off_set = 1; -+ } -+#endif -+ - /* Install our power off handler.. */ - if (power_off) - pm_power_off = apm_power_off; -@@ -1886,8 +1895,12 @@ static int __init apm_setup(char *str) - if (strncmp(str, "debug", 5) == 0) - debug = !invert; - if ((strncmp(str, "power-off", 9) == 0) || -- (strncmp(str, "power_off", 9) == 0)) -+ (strncmp(str, "power_off", 9) == 0)) { - power_off = !invert; -+#ifdef CONFIG_SMP -+ power_off_set = 1; -+#endif -+ } - if (strncmp(str, "smp", 3) == 0) { - smp = !invert; - idle_threshold = 100; diff --git a/kernel/kernel/files/patches/mageia/x86-increase-default-minimum-vmalloc-area-by-64MB-to-192MB.patch b/kernel/kernel/files/patches/mageia/x86-increase-default-minimum-vmalloc-area-by-64MB-to-192MB.patch deleted file mode 100644 index 05d57ee2..00000000 --- a/kernel/kernel/files/patches/mageia/x86-increase-default-minimum-vmalloc-area-by-64MB-to-192MB.patch +++ /dev/null @@ -1,28 +0,0 @@ -From 2db91ae7c0862bc83c1fe8b8bd14b8de3e2c02b8 Mon Sep 17 00:00:00 2001 -From: Anssi Hannula -Date: Sat, 30 Apr 2011 17:09:04 +0300 -Subject: [PATCH] x86: increase default minimum vmalloc area by 64MB to 192MB - -This fixes issues like https://bugs.mageia.org/show_bug.cgi?id=904. - -Signed-off-by: Anssi Hannula ---- - arch/x86/mm/pgtable_32.c | 2 +- - 1 files changed, 1 insertions(+), 1 deletions(-) - -diff --git a/arch/x86/mm/pgtable_32.c b/arch/x86/mm/pgtable_32.c -index cac7184..5801fb7 100644 ---- a/arch/x86/mm/pgtable_32.c -+++ b/arch/x86/mm/pgtable_32.c -@@ -19,7 +19,7 @@ - #include - #include - --unsigned int __VMALLOC_RESERVE = 128 << 20; -+unsigned int __VMALLOC_RESERVE = 192 << 20; - - /* - * Associate a virtual page frame with a given physical page frame --- -1.7.3 - diff --git a/kernel/kernel/files/patches/mageia/x86-pci-toshiba-equium-a60-assign-busses.patch b/kernel/kernel/files/patches/mageia/x86-pci-toshiba-equium-a60-assign-busses.patch deleted file mode 100644 index f9b4b1c7..00000000 --- a/kernel/kernel/files/patches/mageia/x86-pci-toshiba-equium-a60-assign-busses.patch +++ /dev/null @@ -1,29 +0,0 @@ - -The Toshiba Equium A6 Laptop needs pci-assign-busses in order to detect -the Wireless card Netgear MA521 - -More info here: http://qa.mandriva.com/show_bug.cgi?id=18989 - -Signed-off-by: Thomas Backlund - ---- - arch/x86/pci/common.c | 8 ++++++++ - 1 file changed, 8 insertions(+) - ---- a/arch/x86/pci/common.c -+++ b/arch/x86/pci/common.c -@@ -245,6 +245,14 @@ static const struct dmi_system_id __devi - DMI_MATCH(DMI_PRODUCT_NAME, "SX20S"), - }, - }, -+ { -+ .callback = assign_all_busses, -+ .ident = "Toshiba Equium A6 Laptop", -+ .matches = { -+ DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), -+ DMI_MATCH(DMI_PRODUCT_NAME, "Equium A60"), -+ }, -+ }, - #endif /* __i386__ */ - { - .callback = set_bf_sort, diff --git a/kernel/kernel/files/patches/mageia/x86-pti-0070-nospec-Kill-array_index_nospec_mask_check.patch b/kernel/kernel/files/patches/mageia/x86-pti-0070-nospec-Kill-array_index_nospec_mask_check.patch deleted file mode 100644 index 4ae8d54f..00000000 --- a/kernel/kernel/files/patches/mageia/x86-pti-0070-nospec-Kill-array_index_nospec_mask_check.patch +++ /dev/null @@ -1,82 +0,0 @@ -From 1d91c1d2c80cb70e2e553845e278b87a960c04da Mon Sep 17 00:00:00 2001 -From: Dan Williams -Date: Fri, 16 Feb 2018 13:20:42 -0800 -Subject: [PATCH 70/77] nospec: Kill array_index_nospec_mask_check() - -There are multiple problems with the dynamic sanity checking in -array_index_nospec_mask_check(): - -* It causes unnecessary overhead in the 32-bit case since integer sized - @index values will no longer cause the check to be compiled away like - in the 64-bit case. - -* In the 32-bit case it may trigger with user controllable input when - the expectation is that should only trigger during development of new - kernel enabling. - -* The macro reuses the input parameter in multiple locations which is - broken if someone passes an expression like 'index++' to - array_index_nospec(). - -Reported-by: Linus Torvalds -Signed-off-by: Dan Williams -Cc: Andy Lutomirski -Cc: Arjan van de Ven -Cc: Borislav Petkov -Cc: Dave Hansen -Cc: David Woodhouse -Cc: Greg Kroah-Hartman -Cc: Josh Poimboeuf -Cc: Peter Zijlstra -Cc: Thomas Gleixner -Cc: Will Deacon -Cc: linux-arch@vger.kernel.org -Link: http://lkml.kernel.org/r/151881604278.17395.6605847763178076520.stgit@dwillia2-desk3.amr.corp.intel.com -Signed-off-by: Ingo Molnar ---- - include/linux/nospec.h | 22 +--------------------- - 1 file changed, 1 insertion(+), 21 deletions(-) - -diff --git a/include/linux/nospec.h b/include/linux/nospec.h -index fbc98e2c8228..d6701e34424f 100644 ---- a/include/linux/nospec.h -+++ b/include/linux/nospec.h -@@ -29,26 +29,6 @@ static inline unsigned long array_index_mask_nospec(unsigned long index, - } - #endif - --/* -- * Warn developers about inappropriate array_index_nospec() usage. -- * -- * Even if the CPU speculates past the WARN_ONCE branch, the -- * sign bit of @index is taken into account when generating the -- * mask. -- * -- * This warning is compiled out when the compiler can infer that -- * @index and @size are less than LONG_MAX. -- */ --#define array_index_mask_nospec_check(index, size) \ --({ \ -- if (WARN_ONCE(index > LONG_MAX || size > LONG_MAX, \ -- "array_index_nospec() limited to range of [0, LONG_MAX]\n")) \ -- _mask = 0; \ -- else \ -- _mask = array_index_mask_nospec(index, size); \ -- _mask; \ --}) -- - /* - * array_index_nospec - sanitize an array index after a bounds check - * -@@ -67,7 +47,7 @@ static inline unsigned long array_index_mask_nospec(unsigned long index, - ({ \ - typeof(index) _i = (index); \ - typeof(size) _s = (size); \ -- unsigned long _mask = array_index_mask_nospec_check(_i, _s); \ -+ unsigned long _mask = array_index_mask_nospec(_i, _s); \ - \ - BUILD_BUG_ON(sizeof(_i) > sizeof(long)); \ - BUILD_BUG_ON(sizeof(_s) > sizeof(long)); \ --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/x86-pti-0072-nospec-Include-asm-barrier.h-dependency.patch b/kernel/kernel/files/patches/mageia/x86-pti-0072-nospec-Include-asm-barrier.h-dependency.patch deleted file mode 100644 index ec39f3a9..00000000 --- a/kernel/kernel/files/patches/mageia/x86-pti-0072-nospec-Include-asm-barrier.h-dependency.patch +++ /dev/null @@ -1,48 +0,0 @@ -From eb6174f6d1be16b19cfa43dac296bfed003ce1a6 Mon Sep 17 00:00:00 2001 -From: Dan Williams -Date: Fri, 16 Feb 2018 13:20:54 -0800 -Subject: [PATCH 72/77] nospec: Include dependency - -The nospec.h header expects the per-architecture header file - to optionally define array_index_mask_nospec(). Include -that dependency to prevent inadvertent fallback to the default -array_index_mask_nospec() implementation. - -The default implementation may not provide a full mitigation -on architectures that perform data value speculation. - -Reported-by: Christian Borntraeger -Signed-off-by: Dan Williams -Cc: Andy Lutomirski -Cc: Arjan van de Ven -Cc: Borislav Petkov -Cc: Dave Hansen -Cc: David Woodhouse -Cc: Greg Kroah-Hartman -Cc: Josh Poimboeuf -Cc: Linus Torvalds -Cc: Peter Zijlstra -Cc: Thomas Gleixner -Cc: Will Deacon -Cc: linux-arch@vger.kernel.org -Link: http://lkml.kernel.org/r/151881605404.17395.1341935530792574707.stgit@dwillia2-desk3.amr.corp.intel.com -Signed-off-by: Ingo Molnar ---- - include/linux/nospec.h | 1 + - 1 file changed, 1 insertion(+) - -diff --git a/include/linux/nospec.h b/include/linux/nospec.h -index 172a19dc35ab..e791ebc65c9c 100644 ---- a/include/linux/nospec.h -+++ b/include/linux/nospec.h -@@ -5,6 +5,7 @@ - - #ifndef _LINUX_NOSPEC_H - #define _LINUX_NOSPEC_H -+#include - - /** - * array_index_mask_nospec() - generate a ~0 mask when index < size, 0 otherwise --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/x86-pti-0073-x86-microcode-Propagate-return-value-from-updating-f.patch b/kernel/kernel/files/patches/mageia/x86-pti-0073-x86-microcode-Propagate-return-value-from-updating-f.patch deleted file mode 100644 index 8145d620..00000000 --- a/kernel/kernel/files/patches/mageia/x86-pti-0073-x86-microcode-Propagate-return-value-from-updating-f.patch +++ /dev/null @@ -1,235 +0,0 @@ -From 3f1f576a195aa266813cbd4ca70291deb61e0129 Mon Sep 17 00:00:00 2001 -From: Borislav Petkov -Date: Fri, 16 Feb 2018 12:26:38 +0100 -Subject: [PATCH 73/77] x86/microcode: Propagate return value from updating - functions - -... so that callers can know when microcode was updated and act -accordingly. - -Tested-by: Ashok Raj -Signed-off-by: Borislav Petkov -Reviewed-by: Ashok Raj -Cc: Andy Lutomirski -Cc: Arjan van de Ven -Cc: Borislav Petkov -Cc: Dan Williams -Cc: Dave Hansen -Cc: David Woodhouse -Cc: Greg Kroah-Hartman -Cc: Josh Poimboeuf -Cc: Linus Torvalds -Cc: Peter Zijlstra -Cc: Thomas Gleixner -Link: http://lkml.kernel.org/r/20180216112640.11554-2-bp@alien8.de -Signed-off-by: Ingo Molnar ---- - arch/x86/include/asm/microcode.h | 9 +++++++-- - arch/x86/kernel/cpu/microcode/amd.c | 10 +++++----- - arch/x86/kernel/cpu/microcode/core.c | 33 +++++++++++++++++---------------- - arch/x86/kernel/cpu/microcode/intel.c | 10 +++++----- - 4 files changed, 34 insertions(+), 28 deletions(-) - -diff --git a/arch/x86/include/asm/microcode.h b/arch/x86/include/asm/microcode.h -index 55520cec8b27..7fb1047d61c7 100644 ---- a/arch/x86/include/asm/microcode.h -+++ b/arch/x86/include/asm/microcode.h -@@ -37,7 +37,12 @@ struct cpu_signature { - - struct device; - --enum ucode_state { UCODE_ERROR, UCODE_OK, UCODE_NFOUND }; -+enum ucode_state { -+ UCODE_OK = 0, -+ UCODE_UPDATED, -+ UCODE_NFOUND, -+ UCODE_ERROR, -+}; - - struct microcode_ops { - enum ucode_state (*request_microcode_user) (int cpu, -@@ -54,7 +59,7 @@ struct microcode_ops { - * are being called. - * See also the "Synchronization" section in microcode_core.c. - */ -- int (*apply_microcode) (int cpu); -+ enum ucode_state (*apply_microcode) (int cpu); - int (*collect_cpu_info) (int cpu, struct cpu_signature *csig); - }; - -diff --git a/arch/x86/kernel/cpu/microcode/amd.c b/arch/x86/kernel/cpu/microcode/amd.c -index 330b8462d426..a998e1a7d46f 100644 ---- a/arch/x86/kernel/cpu/microcode/amd.c -+++ b/arch/x86/kernel/cpu/microcode/amd.c -@@ -498,7 +498,7 @@ static unsigned int verify_patch_size(u8 family, u32 patch_size, - return patch_size; - } - --static int apply_microcode_amd(int cpu) -+static enum ucode_state apply_microcode_amd(int cpu) - { - struct cpuinfo_x86 *c = &cpu_data(cpu); - struct microcode_amd *mc_amd; -@@ -512,7 +512,7 @@ static int apply_microcode_amd(int cpu) - - p = find_patch(cpu); - if (!p) -- return 0; -+ return UCODE_NFOUND; - - mc_amd = p->data; - uci->mc = p->data; -@@ -523,13 +523,13 @@ static int apply_microcode_amd(int cpu) - if (rev >= mc_amd->hdr.patch_id) { - c->microcode = rev; - uci->cpu_sig.rev = rev; -- return 0; -+ return UCODE_OK; - } - - if (__apply_microcode_amd(mc_amd)) { - pr_err("CPU%d: update failed for patch_level=0x%08x\n", - cpu, mc_amd->hdr.patch_id); -- return -1; -+ return UCODE_ERROR; - } - pr_info("CPU%d: new patch_level=0x%08x\n", cpu, - mc_amd->hdr.patch_id); -@@ -537,7 +537,7 @@ static int apply_microcode_amd(int cpu) - uci->cpu_sig.rev = mc_amd->hdr.patch_id; - c->microcode = mc_amd->hdr.patch_id; - -- return 0; -+ return UCODE_UPDATED; - } - - static int install_equiv_cpu_table(const u8 *buf) -diff --git a/arch/x86/kernel/cpu/microcode/core.c b/arch/x86/kernel/cpu/microcode/core.c -index 319dd65f98a2..6fdaf7cf3182 100644 ---- a/arch/x86/kernel/cpu/microcode/core.c -+++ b/arch/x86/kernel/cpu/microcode/core.c -@@ -374,7 +374,7 @@ static int collect_cpu_info(int cpu) - } - - struct apply_microcode_ctx { -- int err; -+ enum ucode_state err; - }; - - static void apply_microcode_local(void *arg) -@@ -489,31 +489,29 @@ static void __exit microcode_dev_exit(void) - /* fake device for request_firmware */ - static struct platform_device *microcode_pdev; - --static int reload_for_cpu(int cpu) -+static enum ucode_state reload_for_cpu(int cpu) - { - struct ucode_cpu_info *uci = ucode_cpu_info + cpu; - enum ucode_state ustate; -- int err = 0; - - if (!uci->valid) -- return err; -+ return UCODE_OK; - - ustate = microcode_ops->request_microcode_fw(cpu, µcode_pdev->dev, true); -- if (ustate == UCODE_OK) -- apply_microcode_on_target(cpu); -- else -- if (ustate == UCODE_ERROR) -- err = -EINVAL; -- return err; -+ if (ustate != UCODE_OK) -+ return ustate; -+ -+ return apply_microcode_on_target(cpu); - } - - static ssize_t reload_store(struct device *dev, - struct device_attribute *attr, - const char *buf, size_t size) - { -+ enum ucode_state tmp_ret = UCODE_OK; - unsigned long val; -+ ssize_t ret = 0; - int cpu; -- ssize_t ret = 0, tmp_ret; - - ret = kstrtoul(buf, 0, &val); - if (ret) -@@ -526,15 +524,18 @@ static ssize_t reload_store(struct device *dev, - mutex_lock(µcode_mutex); - for_each_online_cpu(cpu) { - tmp_ret = reload_for_cpu(cpu); -- if (tmp_ret != 0) -+ if (tmp_ret > UCODE_NFOUND) { - pr_warn("Error reloading microcode on CPU %d\n", cpu); - -- /* save retval of the first encountered reload error */ -- if (!ret) -- ret = tmp_ret; -+ /* set retval for the first encountered reload error */ -+ if (!ret) -+ ret = -EINVAL; -+ } - } -- if (!ret) -+ -+ if (!ret && tmp_ret == UCODE_UPDATED) - perf_check_microcode(); -+ - mutex_unlock(µcode_mutex); - put_online_cpus(); - -diff --git a/arch/x86/kernel/cpu/microcode/intel.c b/arch/x86/kernel/cpu/microcode/intel.c -index a15db2b4e0d6..923054a6b760 100644 ---- a/arch/x86/kernel/cpu/microcode/intel.c -+++ b/arch/x86/kernel/cpu/microcode/intel.c -@@ -772,7 +772,7 @@ static int collect_cpu_info(int cpu_num, struct cpu_signature *csig) - return 0; - } - --static int apply_microcode_intel(int cpu) -+static enum ucode_state apply_microcode_intel(int cpu) - { - struct microcode_intel *mc; - struct ucode_cpu_info *uci; -@@ -782,7 +782,7 @@ static int apply_microcode_intel(int cpu) - - /* We should bind the task to the CPU */ - if (WARN_ON(raw_smp_processor_id() != cpu)) -- return -1; -+ return UCODE_ERROR; - - uci = ucode_cpu_info + cpu; - mc = uci->mc; -@@ -790,7 +790,7 @@ static int apply_microcode_intel(int cpu) - /* Look for a newer patch in our cache: */ - mc = find_patch(uci); - if (!mc) -- return 0; -+ return UCODE_NFOUND; - } - - /* write microcode via MSR 0x79 */ -@@ -801,7 +801,7 @@ static int apply_microcode_intel(int cpu) - if (rev != mc->hdr.rev) { - pr_err("CPU%d update to revision 0x%x failed\n", - cpu, mc->hdr.rev); -- return -1; -+ return UCODE_ERROR; - } - - if (rev != prev_rev) { -@@ -818,7 +818,7 @@ static int apply_microcode_intel(int cpu) - uci->cpu_sig.rev = rev; - c->microcode = rev; - -- return 0; -+ return UCODE_UPDATED; - } - - static enum ucode_state generic_load_microcode(int cpu, void *data, size_t size, --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/x86-pti-0074-x86-CPU-Add-a-microcode-loader-callback.patch b/kernel/kernel/files/patches/mageia/x86-pti-0074-x86-CPU-Add-a-microcode-loader-callback.patch deleted file mode 100644 index d131de54..00000000 --- a/kernel/kernel/files/patches/mageia/x86-pti-0074-x86-CPU-Add-a-microcode-loader-callback.patch +++ /dev/null @@ -1,90 +0,0 @@ -From 1008c52c09dcb23d93f8e0ea83a6246265d2cce0 Mon Sep 17 00:00:00 2001 -From: Borislav Petkov -Date: Fri, 16 Feb 2018 12:26:39 +0100 -Subject: [PATCH 74/77] x86/CPU: Add a microcode loader callback - -Add a callback function which the microcode loader calls when microcode -has been updated to a newer revision. Do the callback only when no error -was encountered during loading. - -Tested-by: Ashok Raj -Signed-off-by: Borislav Petkov -Reviewed-by: Ashok Raj -Cc: Andy Lutomirski -Cc: Arjan van de Ven -Cc: Borislav Petkov -Cc: Dan Williams -Cc: Dave Hansen -Cc: David Woodhouse -Cc: Greg Kroah-Hartman -Cc: Josh Poimboeuf -Cc: Linus Torvalds -Cc: Peter Zijlstra -Cc: Thomas Gleixner -Link: http://lkml.kernel.org/r/20180216112640.11554-3-bp@alien8.de -Signed-off-by: Ingo Molnar ---- - arch/x86/include/asm/processor.h | 1 + - arch/x86/kernel/cpu/common.c | 10 ++++++++++ - arch/x86/kernel/cpu/microcode/core.c | 8 ++++++-- - 3 files changed, 17 insertions(+), 2 deletions(-) - -diff --git a/arch/x86/include/asm/processor.h b/arch/x86/include/asm/processor.h -index 1bd9ed87606f..b0ccd4847a58 100644 ---- a/arch/x86/include/asm/processor.h -+++ b/arch/x86/include/asm/processor.h -@@ -977,4 +977,5 @@ bool xen_set_default_idle(void); - - void stop_this_cpu(void *dummy); - void df_debug(struct pt_regs *regs, long error_code); -+void microcode_check(void); - #endif /* _ASM_X86_PROCESSOR_H */ -diff --git a/arch/x86/kernel/cpu/common.c b/arch/x86/kernel/cpu/common.c -index 824aee0117bb..84f1cd88608b 100644 ---- a/arch/x86/kernel/cpu/common.c -+++ b/arch/x86/kernel/cpu/common.c -@@ -1749,3 +1749,13 @@ static int __init init_cpu_syscore(void) - return 0; - } - core_initcall(init_cpu_syscore); -+ -+/* -+ * The microcode loader calls this upon late microcode load to recheck features, -+ * only when microcode has been updated. Caller holds microcode_mutex and CPU -+ * hotplug lock. -+ */ -+void microcode_check(void) -+{ -+ perf_check_microcode(); -+} -diff --git a/arch/x86/kernel/cpu/microcode/core.c b/arch/x86/kernel/cpu/microcode/core.c -index 6fdaf7cf3182..aa1b9a422f2b 100644 ---- a/arch/x86/kernel/cpu/microcode/core.c -+++ b/arch/x86/kernel/cpu/microcode/core.c -@@ -509,6 +509,7 @@ static ssize_t reload_store(struct device *dev, - const char *buf, size_t size) - { - enum ucode_state tmp_ret = UCODE_OK; -+ bool do_callback = false; - unsigned long val; - ssize_t ret = 0; - int cpu; -@@ -531,10 +532,13 @@ static ssize_t reload_store(struct device *dev, - if (!ret) - ret = -EINVAL; - } -+ -+ if (tmp_ret == UCODE_UPDATED) -+ do_callback = true; - } - -- if (!ret && tmp_ret == UCODE_UPDATED) -- perf_check_microcode(); -+ if (!ret && do_callback) -+ microcode_check(); - - mutex_unlock(µcode_mutex); - put_online_cpus(); --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/x86-pti-0075-x86-CPU-Check-CPU-feature-bits-after-microcode-upgra.patch b/kernel/kernel/files/patches/mageia/x86-pti-0075-x86-CPU-Check-CPU-feature-bits-after-microcode-upgra.patch deleted file mode 100644 index 904ca0c0..00000000 --- a/kernel/kernel/files/patches/mageia/x86-pti-0075-x86-CPU-Check-CPU-feature-bits-after-microcode-upgra.patch +++ /dev/null @@ -1,64 +0,0 @@ -From 42ca8082e260dcfd8afa2afa6ec1940b9d41724c Mon Sep 17 00:00:00 2001 -From: Borislav Petkov -Date: Fri, 16 Feb 2018 12:26:40 +0100 -Subject: [PATCH 75/77] x86/CPU: Check CPU feature bits after microcode upgrade - -With some microcode upgrades, new CPUID features can become visible on -the CPU. Check what the kernel has mirrored now and issue a warning -hinting at possible things the user/admin can do to make use of the -newly visible features. - -Originally-by: Ashok Raj -Tested-by: Ashok Raj -Signed-off-by: Borislav Petkov -Reviewed-by: Ashok Raj -Cc: Andy Lutomirski -Cc: Arjan van de Ven -Cc: Borislav Petkov -Cc: Dan Williams -Cc: Dave Hansen -Cc: David Woodhouse -Cc: Greg Kroah-Hartman -Cc: Josh Poimboeuf -Cc: Linus Torvalds -Cc: Peter Zijlstra -Cc: Thomas Gleixner -Link: http://lkml.kernel.org/r/20180216112640.11554-4-bp@alien8.de -Signed-off-by: Ingo Molnar ---- - arch/x86/kernel/cpu/common.c | 20 ++++++++++++++++++++ - 1 file changed, 20 insertions(+) - -diff --git a/arch/x86/kernel/cpu/common.c b/arch/x86/kernel/cpu/common.c -index 84f1cd88608b..348cf4821240 100644 ---- a/arch/x86/kernel/cpu/common.c -+++ b/arch/x86/kernel/cpu/common.c -@@ -1757,5 +1757,25 @@ core_initcall(init_cpu_syscore); - */ - void microcode_check(void) - { -+ struct cpuinfo_x86 info; -+ - perf_check_microcode(); -+ -+ /* Reload CPUID max function as it might've changed. */ -+ info.cpuid_level = cpuid_eax(0); -+ -+ /* -+ * Copy all capability leafs to pick up the synthetic ones so that -+ * memcmp() below doesn't fail on that. The ones coming from CPUID will -+ * get overwritten in get_cpu_cap(). -+ */ -+ memcpy(&info.x86_capability, &boot_cpu_data.x86_capability, sizeof(info.x86_capability)); -+ -+ get_cpu_cap(&info); -+ -+ if (!memcmp(&info.x86_capability, &boot_cpu_data.x86_capability, sizeof(info.x86_capability))) -+ return; -+ -+ pr_warn("x86/CPU: CPU features have changed after loading microcode, but might not take effect.\n"); -+ pr_warn("x86/CPU: Please consider either early loading through initrd/built-in or a potential BIOS update.\n"); - } --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/x86-pti-0076-x86-entry-Reduce-the-code-footprint-of-the-idtentry-.patch b/kernel/kernel/files/patches/mageia/x86-pti-0076-x86-entry-Reduce-the-code-footprint-of-the-idtentry-.patch deleted file mode 100644 index 55cfe055..00000000 --- a/kernel/kernel/files/patches/mageia/x86-pti-0076-x86-entry-Reduce-the-code-footprint-of-the-idtentry-.patch +++ /dev/null @@ -1,140 +0,0 @@ -From 9e809d15d6b692fa061d74be7aaab1c79f6784b8 Mon Sep 17 00:00:00 2001 -From: Dominik Brodowski -Date: Wed, 14 Feb 2018 18:59:23 +0100 -Subject: [PATCH 76/77] x86/entry: Reduce the code footprint of the 'idtentry' - macro - -Play a little trick in the generic PUSH_AND_CLEAR_REGS macro -to insert the GP registers "above" the original return address. - -This allows us to (re-)insert the macro in error_entry() and -paranoid_entry() and to remove it from the idtentry macro. This -reduces the static footprint significantly: - - text data bss dec hex filename - 24307 0 0 24307 5ef3 entry_64.o-orig - 20987 0 0 20987 51fb entry_64.o - -Co-developed-by: Linus Torvalds -Signed-off-by: Dominik Brodowski -Cc: Andy Lutomirski -Cc: Arjan van de Ven -Cc: Borislav Petkov -Cc: Dan Williams -Cc: Dave Hansen -Cc: David Woodhouse -Cc: Greg Kroah-Hartman -Cc: Josh Poimboeuf -Cc: Linus Torvalds -Cc: Peter Zijlstra -Cc: Thomas Gleixner -Link: http://lkml.kernel.org/r/20180214175924.23065-2-linux@dominikbrodowski.net -[ Small tweaks to comments. ] -Signed-off-by: Ingo Molnar ---- - arch/x86/entry/calling.h | 11 ++++++++++- - arch/x86/entry/entry_64.S | 18 ++++++++---------- - 2 files changed, 18 insertions(+), 11 deletions(-) - -diff --git a/arch/x86/entry/calling.h b/arch/x86/entry/calling.h -index dce7092ab24a..196b6103edf6 100644 ---- a/arch/x86/entry/calling.h -+++ b/arch/x86/entry/calling.h -@@ -97,7 +97,7 @@ For 32-bit we have the following conventions - kernel is built with - - #define SIZEOF_PTREGS 21*8 - --.macro PUSH_AND_CLEAR_REGS rdx=%rdx rax=%rax -+.macro PUSH_AND_CLEAR_REGS rdx=%rdx rax=%rax save_ret=0 - /* - * Push registers and sanitize registers of values that a - * speculation attack might otherwise want to exploit. The -@@ -105,8 +105,14 @@ For 32-bit we have the following conventions - kernel is built with - * could be put to use in a speculative execution gadget. - * Interleave XOR with PUSH for better uop scheduling: - */ -+ .if \save_ret -+ pushq %rsi /* pt_regs->si */ -+ movq 8(%rsp), %rsi /* temporarily store the return address in %rsi */ -+ movq %rdi, 8(%rsp) /* pt_regs->di (overwriting original return address) */ -+ .else - pushq %rdi /* pt_regs->di */ - pushq %rsi /* pt_regs->si */ -+ .endif - pushq \rdx /* pt_regs->dx */ - pushq %rcx /* pt_regs->cx */ - pushq \rax /* pt_regs->ax */ -@@ -131,6 +137,9 @@ For 32-bit we have the following conventions - kernel is built with - pushq %r15 /* pt_regs->r15 */ - xorq %r15, %r15 /* nospec r15*/ - UNWIND_HINT_REGS -+ .if \save_ret -+ pushq %rsi /* return address on top of stack */ -+ .endif - .endm - - .macro POP_REGS pop_rdi=1 skip_r11rcx=0 -diff --git a/arch/x86/entry/entry_64.S b/arch/x86/entry/entry_64.S -index 8971bd64d515..77edc2390868 100644 ---- a/arch/x86/entry/entry_64.S -+++ b/arch/x86/entry/entry_64.S -@@ -875,12 +875,8 @@ ENTRY(\sym) - pushq $-1 /* ORIG_RAX: no syscall to restart */ - .endif - -- /* Save all registers in pt_regs */ -- PUSH_AND_CLEAR_REGS -- ENCODE_FRAME_POINTER -- - .if \paranoid < 2 -- testb $3, CS(%rsp) /* If coming from userspace, switch stacks */ -+ testb $3, CS-ORIG_RAX(%rsp) /* If coming from userspace, switch stacks */ - jnz .Lfrom_usermode_switch_stack_\@ - .endif - -@@ -1130,13 +1126,15 @@ idtentry machine_check do_mce has_error_code=0 paranoid=1 - #endif - - /* -- * Switch gs if needed. -+ * Save all registers in pt_regs, and switch gs if needed. - * Use slow, but surefire "are we in kernel?" check. - * Return: ebx=0: need swapgs on exit, ebx=1: otherwise - */ - ENTRY(paranoid_entry) - UNWIND_HINT_FUNC - cld -+ PUSH_AND_CLEAR_REGS save_ret=1 -+ ENCODE_FRAME_POINTER 8 - movl $1, %ebx - movl $MSR_GS_BASE, %ecx - rdmsr -@@ -1181,12 +1179,14 @@ ENTRY(paranoid_exit) - END(paranoid_exit) - - /* -- * Switch gs if needed. -+ * Save all registers in pt_regs, and switch GS if needed. - * Return: EBX=0: came from user mode; EBX=1: otherwise - */ - ENTRY(error_entry) -- UNWIND_HINT_REGS offset=8 -+ UNWIND_HINT_FUNC - cld -+ PUSH_AND_CLEAR_REGS save_ret=1 -+ ENCODE_FRAME_POINTER 8 - testb $3, CS+8(%rsp) - jz .Lerror_kernelspace - -@@ -1577,8 +1577,6 @@ end_repeat_nmi: - * frame to point back to repeat_nmi. - */ - pushq $-1 /* ORIG_RAX: no syscall to restart */ -- PUSH_AND_CLEAR_REGS -- ENCODE_FRAME_POINTER - - /* - * Use paranoid_entry to handle SWAPGS, but no need to use paranoid_exit --- -2.16.1 - diff --git a/kernel/kernel/files/patches/mageia/x86-pti-0077-x86-entry-64-Use-xorl-for-faster-register-clearing.patch b/kernel/kernel/files/patches/mageia/x86-pti-0077-x86-entry-64-Use-xorl-for-faster-register-clearing.patch deleted file mode 100644 index 1d59822c..00000000 --- a/kernel/kernel/files/patches/mageia/x86-pti-0077-x86-entry-64-Use-xorl-for-faster-register-clearing.patch +++ /dev/null @@ -1,202 +0,0 @@ -From ced5d0bf603fa0baee8ea889e1d70971fd210894 Mon Sep 17 00:00:00 2001 -From: Dominik Brodowski -Date: Wed, 14 Feb 2018 18:59:24 +0100 -Subject: [PATCH 77/77] x86/entry/64: Use 'xorl' for faster register clearing -MIME-Version: 1.0 -Content-Type: text/plain; charset=UTF-8 -Content-Transfer-Encoding: 8bit - -On some x86 CPU microarchitectures using 'xorq' to clear general-purpose -registers is slower than 'xorl'. As 'xorl' is sufficient to clear all -64 bits of these registers due to zero-extension [*], switch the x86 -64-bit entry code to use 'xorl'. - -No change in functionality and no change in code size. - -[*] According to Intel 64 and IA-32 Architecture Software Developer's - Manual, section 3.4.1.1, the result of 32-bit operands are "zero- - extended to a 64-bit result in the destination general-purpose - register." The AMD64 Architecture Programmer’s Manual Volume 3, - Appendix B.1, describes the same behaviour. - -Suggested-by: Denys Vlasenko -Signed-off-by: Dominik Brodowski -Cc: Andy Lutomirski -Cc: Arjan van de Ven -Cc: Borislav Petkov -Cc: Dan Williams -Cc: Dave Hansen -Cc: David Woodhouse -Cc: Greg Kroah-Hartman -Cc: Josh Poimboeuf -Cc: Linus Torvalds -Cc: Peter Zijlstra -Cc: Thomas Gleixner -Link: http://lkml.kernel.org/r/20180214175924.23065-3-linux@dominikbrodowski.net -[ Improved on the changelog a bit. ] -Signed-off-by: Ingo Molnar ---- - arch/x86/entry/calling.h | 16 ++++++------ - arch/x86/entry/entry_64_compat.S | 54 ++++++++++++++++++++-------------------- - 2 files changed, 35 insertions(+), 35 deletions(-) - -diff --git a/arch/x86/entry/calling.h b/arch/x86/entry/calling.h -index 196b6103edf6..5d10b7a85cad 100644 ---- a/arch/x86/entry/calling.h -+++ b/arch/x86/entry/calling.h -@@ -117,25 +117,25 @@ For 32-bit we have the following conventions - kernel is built with - pushq %rcx /* pt_regs->cx */ - pushq \rax /* pt_regs->ax */ - pushq %r8 /* pt_regs->r8 */ -- xorq %r8, %r8 /* nospec r8 */ -+ xorl %r8d, %r8d /* nospec r8 */ - pushq %r9 /* pt_regs->r9 */ -- xorq %r9, %r9 /* nospec r9 */ -+ xorl %r9d, %r9d /* nospec r9 */ - pushq %r10 /* pt_regs->r10 */ -- xorq %r10, %r10 /* nospec r10 */ -+ xorl %r10d, %r10d /* nospec r10 */ - pushq %r11 /* pt_regs->r11 */ -- xorq %r11, %r11 /* nospec r11*/ -+ xorl %r11d, %r11d /* nospec r11*/ - pushq %rbx /* pt_regs->rbx */ - xorl %ebx, %ebx /* nospec rbx*/ - pushq %rbp /* pt_regs->rbp */ - xorl %ebp, %ebp /* nospec rbp*/ - pushq %r12 /* pt_regs->r12 */ -- xorq %r12, %r12 /* nospec r12*/ -+ xorl %r12d, %r12d /* nospec r12*/ - pushq %r13 /* pt_regs->r13 */ -- xorq %r13, %r13 /* nospec r13*/ -+ xorl %r13d, %r13d /* nospec r13*/ - pushq %r14 /* pt_regs->r14 */ -- xorq %r14, %r14 /* nospec r14*/ -+ xorl %r14d, %r14d /* nospec r14*/ - pushq %r15 /* pt_regs->r15 */ -- xorq %r15, %r15 /* nospec r15*/ -+ xorl %r15d, %r15d /* nospec r15*/ - UNWIND_HINT_REGS - .if \save_ret - pushq %rsi /* return address on top of stack */ -diff --git a/arch/x86/entry/entry_64_compat.S b/arch/x86/entry/entry_64_compat.S -index fd65e016e413..364ea4a207be 100644 ---- a/arch/x86/entry/entry_64_compat.S -+++ b/arch/x86/entry/entry_64_compat.S -@@ -85,25 +85,25 @@ ENTRY(entry_SYSENTER_compat) - pushq %rcx /* pt_regs->cx */ - pushq $-ENOSYS /* pt_regs->ax */ - pushq $0 /* pt_regs->r8 = 0 */ -- xorq %r8, %r8 /* nospec r8 */ -+ xorl %r8d, %r8d /* nospec r8 */ - pushq $0 /* pt_regs->r9 = 0 */ -- xorq %r9, %r9 /* nospec r9 */ -+ xorl %r9d, %r9d /* nospec r9 */ - pushq $0 /* pt_regs->r10 = 0 */ -- xorq %r10, %r10 /* nospec r10 */ -+ xorl %r10d, %r10d /* nospec r10 */ - pushq $0 /* pt_regs->r11 = 0 */ -- xorq %r11, %r11 /* nospec r11 */ -+ xorl %r11d, %r11d /* nospec r11 */ - pushq %rbx /* pt_regs->rbx */ - xorl %ebx, %ebx /* nospec rbx */ - pushq %rbp /* pt_regs->rbp (will be overwritten) */ - xorl %ebp, %ebp /* nospec rbp */ - pushq $0 /* pt_regs->r12 = 0 */ -- xorq %r12, %r12 /* nospec r12 */ -+ xorl %r12d, %r12d /* nospec r12 */ - pushq $0 /* pt_regs->r13 = 0 */ -- xorq %r13, %r13 /* nospec r13 */ -+ xorl %r13d, %r13d /* nospec r13 */ - pushq $0 /* pt_regs->r14 = 0 */ -- xorq %r14, %r14 /* nospec r14 */ -+ xorl %r14d, %r14d /* nospec r14 */ - pushq $0 /* pt_regs->r15 = 0 */ -- xorq %r15, %r15 /* nospec r15 */ -+ xorl %r15d, %r15d /* nospec r15 */ - cld - - /* -@@ -224,25 +224,25 @@ GLOBAL(entry_SYSCALL_compat_after_hwframe) - pushq %rbp /* pt_regs->cx (stashed in bp) */ - pushq $-ENOSYS /* pt_regs->ax */ - pushq $0 /* pt_regs->r8 = 0 */ -- xorq %r8, %r8 /* nospec r8 */ -+ xorl %r8d, %r8d /* nospec r8 */ - pushq $0 /* pt_regs->r9 = 0 */ -- xorq %r9, %r9 /* nospec r9 */ -+ xorl %r9d, %r9d /* nospec r9 */ - pushq $0 /* pt_regs->r10 = 0 */ -- xorq %r10, %r10 /* nospec r10 */ -+ xorl %r10d, %r10d /* nospec r10 */ - pushq $0 /* pt_regs->r11 = 0 */ -- xorq %r11, %r11 /* nospec r11 */ -+ xorl %r11d, %r11d /* nospec r11 */ - pushq %rbx /* pt_regs->rbx */ - xorl %ebx, %ebx /* nospec rbx */ - pushq %rbp /* pt_regs->rbp (will be overwritten) */ - xorl %ebp, %ebp /* nospec rbp */ - pushq $0 /* pt_regs->r12 = 0 */ -- xorq %r12, %r12 /* nospec r12 */ -+ xorl %r12d, %r12d /* nospec r12 */ - pushq $0 /* pt_regs->r13 = 0 */ -- xorq %r13, %r13 /* nospec r13 */ -+ xorl %r13d, %r13d /* nospec r13 */ - pushq $0 /* pt_regs->r14 = 0 */ -- xorq %r14, %r14 /* nospec r14 */ -+ xorl %r14d, %r14d /* nospec r14 */ - pushq $0 /* pt_regs->r15 = 0 */ -- xorq %r15, %r15 /* nospec r15 */ -+ xorl %r15d, %r15d /* nospec r15 */ - - /* - * User mode is traced as though IRQs are on, and SYSENTER -@@ -298,9 +298,9 @@ sysret32_from_system_call: - */ - SWITCH_TO_USER_CR3_NOSTACK scratch_reg=%r8 scratch_reg2=%r9 - -- xorq %r8, %r8 -- xorq %r9, %r9 -- xorq %r10, %r10 -+ xorl %r8d, %r8d -+ xorl %r9d, %r9d -+ xorl %r10d, %r10d - swapgs - sysretl - END(entry_SYSCALL_compat) -@@ -358,25 +358,25 @@ ENTRY(entry_INT80_compat) - pushq %rcx /* pt_regs->cx */ - pushq $-ENOSYS /* pt_regs->ax */ - pushq $0 /* pt_regs->r8 = 0 */ -- xorq %r8, %r8 /* nospec r8 */ -+ xorl %r8d, %r8d /* nospec r8 */ - pushq $0 /* pt_regs->r9 = 0 */ -- xorq %r9, %r9 /* nospec r9 */ -+ xorl %r9d, %r9d /* nospec r9 */ - pushq $0 /* pt_regs->r10 = 0 */ -- xorq %r10, %r10 /* nospec r10 */ -+ xorl %r10d, %r10d /* nospec r10 */ - pushq $0 /* pt_regs->r11 = 0 */ -- xorq %r11, %r11 /* nospec r11 */ -+ xorl %r11d, %r11d /* nospec r11 */ - pushq %rbx /* pt_regs->rbx */ - xorl %ebx, %ebx /* nospec rbx */ - pushq %rbp /* pt_regs->rbp */ - xorl %ebp, %ebp /* nospec rbp */ - pushq %r12 /* pt_regs->r12 */ -- xorq %r12, %r12 /* nospec r12 */ -+ xorl %r12d, %r12d /* nospec r12 */ - pushq %r13 /* pt_regs->r13 */ -- xorq %r13, %r13 /* nospec r13 */ -+ xorl %r13d, %r13d /* nospec r13 */ - pushq %r14 /* pt_regs->r14 */ -- xorq %r14, %r14 /* nospec r14 */ -+ xorl %r14d, %r14d /* nospec r14 */ - pushq %r15 /* pt_regs->r15 */ -- xorq %r15, %r15 /* nospec r15 */ -+ xorl %r15d, %r15d /* nospec r15 */ - cld - - /* --- -2.16.1 - diff --git a/kernel/kernel/pspec.xml b/kernel/kernel/pspec.xml index c7288ffc..d40963bf 100644 --- a/kernel/kernel/pspec.xml +++ b/kernel/kernel/pspec.xml @@ -12,7 +12,7 @@ kernel The Linux kernel (the core of the Linux operating system) for Pisi Linux kernel contains the Linux kernel, the core of any Linux operating system. The kernel handles the basic functions of the operating system: memory allocation, process allocation, device input and output, etc. - https://mirrors.edge.kernel.org/pub/linux/kernel/v5.x/linux-5.5.tar.gz + https://mirrors.edge.kernel.org/pub/linux/kernel/v5.x/linux-5.6.tar.gz configs/kernel-x86_64-config scripts/generate-module-list @@ -33,12 +33,27 @@ - patches/linux/patch-5.5.15.xz + patches/linux/patch-5.6.4.xz - patches/mageia_5_5/fs-aufs-5.5.patch - patches/mageia_5_5/fs-aufs-5.5-modular.patch - patches/mageia_5_5/fs-vboxsf.patch - patches/mageia_5_5/CVE-2019-12379.patch + patches/mageia/fs-aufs-5.6.patch + patches/mageia/fs-aufs-5.6-modular.patch + patches/mageia/fs-aufs-5.6-fix.patch + patches/mageia/fs-exfat-remove-from-staging.patch + patches/mageia/fs-exfat-add-in-memory-and-on-disk-structures-and-heade.patch + patches/mageia/fs-exfat-add-super-block-operations.patch + patches/mageia/fs-exfat-add-inode-operations.patch + patches/mageia/fs-exfat-add-directory-operations.patch + patches/mageia/fs-exfat-add-file-operations.patch + patches/mageia/fs-exfat-add-fat-entry-operations.patch + patches/mageia/fs-exfat-add-bitmap-operations.patch + patches/mageia/fs-exfat-add-exfat-cache.patch + patches/mageia/fs-exfat-add-misc-operations.patch + patches/mageia/fs-exfat-add-nls-operations.patch + patches/mageia/fs-exfat-add-Kconfig-and-Makefile.patch + patches/mageia/fs-MAINTAINERS-add-exfat-filesystem.patch + patches/mageia/fs-exfat-update-file-system-parameter-handling.patch + patches/mageia/fs-exfat-add-module_alias_fs.patch + patches/mageia/CVE-2019-12379.patch @@ -97,6 +112,17 @@ + + 2020-04-13 + 5.6.4 + Version bump + security + + systemRestart + + Idris Kalp + idriskalp@gmail.com + 2020-04-03 5.5.15